Decrease telemetry rate on the pad to 1/sec instead of 20/sec

[fw/altos] / ao_test.c

diff --git a/ao_test.c b/ao_test.c
index 5d50ab8332e13c1cc4d02b027e07c7639016b884..6d005ff6dcfae80a2414c152d766f3785812b5d4 100644 (file)
--- a/ao_test.c
+++ b/ao_test.c
@@ -50,7 +50,7 @@ blink_0(void)
 void
 blink_1(void)
 {
-       static struct ao_adc adc;
+       static __xdata struct ao_adc adc;
 
        for (;;) {
                ao_sleep(&ao_adc_ring);
@@ -74,7 +74,7 @@ wakeup(void)
 void
 beep(void)
 {
-       static struct ao_adc adc;
+       static __xdata struct ao_adc adc;
 
        for (;;) {
                ao_delay(AO_SEC_TO_TICKS(1));
@@ -87,13 +87,13 @@ beep(void)
 void
 echo(void)
 {
-       uint8_t c;
+       char    c;
        for (;;) {
+               ao_usb_flush();
                c = ao_usb_getchar();
                ao_usb_putchar(c);
                if (c == '\r')
                        ao_usb_putchar('\n');
-               ao_usb_flush();
        }
 }
 
@@ -104,10 +104,16 @@ main(void)
        while (!(SLEEP & SLEEP_XOSC_STB))
                ;
 
-       ao_add_task(&blink_0_task, blink_0);
-       ao_add_task(&blink_1_task, blink_1);
-       ao_add_task(&wakeup_task, wakeup);
-       ao_add_task(&beep_task, beep);
+//     ao_add_task(&blink_0_task, blink_0);
+//     ao_add_task(&blink_1_task, blink_1);
+//     ao_add_task(&wakeup_task, wakeup);
+//     ao_add_task(&beep_task, beep);
        ao_add_task(&echo_task, echo);
+       ao_timer_init();
+       ao_adc_init();
+       ao_beep_init();
+       ao_led_init();
+       ao_usb_init();
+       
        ao_start_scheduler();
 }