add code to load/save configuration in eeprom

[protos/xbee-avr.git] / main.c

diff --git a/main.c b/main.c
index 0e52717..20e26b0 100644 (file)
--- a/main.c
+++ b/main.c
@@ -52,6 +52,8 @@
 #include <rdline.h>
 #include <timer.h>
 
+#include "eeprom_config.h"
+#include "beep.h"
 #include "main.h"
 
 struct xbeeboard xbeeboard;
@@ -246,7 +248,7 @@ int xbee_recv_data(struct xbee_recv_hdr *recvframe, unsigned len)
                        val += 512;
                        spi_servo_set(0, val);
                        break;
-                                 }
+               }
                case RC_PROTO_TYPE_RANGE: {
                        struct rc_proto_range *rcr =
                                (struct rc_proto_range *) recvframe->data;
@@ -588,6 +590,8 @@ static void main_timer_interrupt(void)
        static uint16_t cycles;
        static uint8_t cpt;
 
+       cpt++;
+
        /* interrupt every 2048 cycles */
        cycles += 2048;
        if (cycles >= 12000) {
@@ -601,6 +605,11 @@ static void main_timer_interrupt(void)
        else
                LED1_OFF();
 
+       if (cpt & beep_mask)
+               BUZZER_ON();
+       else
+               BUZZER_OFF();
+
        /* call scheduler every 682us with interrupt unlocked */
        sei();
        if ((cpt & 0x3) == 0)
@@ -614,7 +623,7 @@ int main(void)
        int8_t err;
        struct xbee_dev dev;
 
-       DDRA = 0x07; /* LEDs */
+       DDRA = 0x07 /* LEDs */ | 0x10 /* buzzer */;
 
        uart_init();
        uart_register_rx_event(CMDLINE_UART, emergency);
@@ -627,6 +636,7 @@ int main(void)
 
        cmdline_init();
        spi_servo_init();
+       beep_init();
 
        printf_P(PSTR("\r\n"));
        rdline_newline(&xbeeboard.rdl, xbeeboard.prompt);
@@ -651,9 +661,9 @@ int main(void)
                fprintf(stderr, "cannot register default channel\n");
                return -1;
        }
-
        sei();
 
+       eeprom_load_config();
        xbee_mainloop();
        return 0;
 }