altos/stmf0: Re-implement fast ADC code for stmf0
[fw/altos] / src / usbtrng-v2.0 / ao_usbtrng.c
1 /*
2  * Copyright © 2014 Keith Packard <keithp@keithp.com>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; version 2 of the License.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License along
14  * with this program; if not, write to the Free Software Foundation, Inc.,
15  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
16  */
17
18 #include <ao.h>
19 #include <ao_adc_fast.h>
20 #include <ao_crc.h>
21
22 static void
23 ao_trng_fetch(void)
24 {
25         static uint16_t *buffer[2];
26         uint32_t        kbytes = 1;
27         uint32_t        count;
28         int             usb_buf_id;
29         int             i;
30         uint16_t        *buf;
31         uint32_t        *rnd;
32
33         if (!buffer[0]) {
34                 buffer[0] = ao_usb_alloc();
35                 buffer[1] = ao_usb_alloc();
36                 if (!buffer[0])
37                         return;
38         }
39
40         ao_cmd_decimal();
41         if (ao_cmd_status == ao_cmd_success)
42                 kbytes = ao_cmd_lex_u32;
43         else
44                 ao_cmd_status = ao_cmd_success;
45         usb_buf_id = 0;
46         count = kbytes * (1024/AO_USB_IN_SIZE);
47
48         ao_crc_reset();
49
50         ao_led_on(AO_LED_GREEN);
51         while (count--) {
52                 buf = buffer[usb_buf_id];
53 //              printf ("before get: head %3d tail %3d running %d\n", ao_adc_ring_head, ao_adc_ring_tail, ao_adc_running); flush();
54                 rnd = (uint32_t *) ao_adc_get(AO_USB_IN_SIZE);  /* one 16-bit value per output byte */
55 //              printf ("after get: head %3d tail %3d running %d\n", ao_adc_ring_head, ao_adc_ring_tail, ao_adc_running); flush();
56                 for (i = 0; i < 32; i++)
57                         *buf++ = ao_crc_in_32_out_16(*rnd++);
58                 ao_adc_ack(AO_USB_IN_SIZE);
59 //              printf ("after ack: head %3d tail %3d running %d\n", ao_adc_ring_head, ao_adc_ring_tail, ao_adc_running); flush();
60                 ao_led_toggle(AO_LED_GREEN|AO_LED_RED);
61                 ao_usb_write(buffer[usb_buf_id], AO_USB_IN_SIZE);
62                 ao_led_toggle(AO_LED_GREEN|AO_LED_RED);
63                 usb_buf_id = 1-usb_buf_id;
64         }
65         ao_led_off(AO_LED_GREEN|AO_LED_RED);
66         flush();
67 }
68
69 static const struct ao_cmds usbtrng_cmds[] = {
70         { ao_trng_fetch,        "f <kbytes>\0Fetch a block of numbers" },
71         { 0, NULL },
72 };
73
74 void main(void)
75 {
76         ao_led_init(LEDS_AVAILABLE);
77         ao_led_on(AO_LED_RED);
78         ao_clock_init();
79         ao_task_init();
80         ao_timer_init();
81         ao_dma_init();
82         ao_adc_init();
83         ao_crc_init();
84
85         ao_cmd_init();
86
87         ao_usb_init();
88
89         ao_cmd_register(usbtrng_cmds);
90         ao_led_off(AO_LED_RED);
91
92         ao_start_scheduler();
93 }