2 * Copyright (c) 2011, Olivier MATZ <zer0@droids-corp.org>
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
7 * * Redistributions of source code must retain the above copyright
8 * notice, this list of conditions and the following disclaimer.
9 * * Redistributions in binary form must reproduce the above copyright
10 * notice, this list of conditions and the following disclaimer in the
11 * documentation and/or other materials provided with the distribution.
12 * * Neither the name of the University of California, Berkeley nor the
13 * names of its contributors may be used to endorse or promote products
14 * derived from this software without specific prior written permission.
16 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND ANY
17 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
18 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
19 * DISCLAIMED. IN NO EVENT SHALL THE REGENTS AND CONTRIBUTORS BE LIABLE FOR ANY
20 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
21 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
23 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
25 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 * avrdude -p atmega1284p -P usb -c avrispmkii -U lfuse:w:0xff:m -U hfuse:w:0x91:m -U efuse:w:0xff:m
30 * -> it failed but I answered y, then make reset and it was ok
34 #include <aversive/queue.h>
35 #include <aversive/endian.h>
36 #include <aversive/wait.h>
37 #include <aversive/error.h>
55 #include "eeprom_config.h"
56 #include "gps_venus.h"
60 struct imuboard imuboard;
61 volatile uint32_t global_ms;
63 /* global xbee device */
64 struct xbee_dev *xbee_dev;
68 #define BOOTLOADER_ADDR 0x3f000
69 if (pgm_read_byte_far(BOOTLOADER_ADDR) == 0xff) {
70 printf_P(PSTR("Bootloader is not present\r\n"));
74 /* ... very specific :( */
88 /* __asm__ __volatile__ ("ldi r31,0xf8\n"); */
89 /* __asm__ __volatile__ ("ldi r30,0x00\n"); */
90 /* __asm__ __volatile__ ("eijmp\n"); */
93 /* return time in milliseconds on unsigned 16 bits */
94 uint16_t get_time_ms(void)
104 static void main_timer_interrupt(void)
106 static uint16_t cycles;
107 static uint8_t stack = 0;
108 static uint8_t cpt = 0;
112 if (global_ms & 0x80)
117 if ((cpt & 0x03) != 0)
120 /* the following code is only called one interrupt among 4: every 682us
121 * (at 12 Mhz) = 8192 cycles */
123 if (cycles >= 12000) {
132 if ((cpt & 0x3) == 0)
133 callout_manage(&imuboard.intr_cm);
145 DDRB = 0x18 /* LEDs */;
148 uart_register_rx_event(CMDLINE_UART, emergency);
150 fdevopen(cmdline_dev_send, cmdline_dev_recv);
152 timer0_register_OV_intr(main_timer_interrupt);
154 callout_mgr_init(&imuboard.intr_cm, get_time_ms);
158 error_register_emerg(mylog);
159 error_register_error(mylog);
160 error_register_warning(mylog);
161 error_register_notice(mylog);
162 error_register_debug(mylog);
164 /* communication with mpu6050 */
169 eeprom_load_config();
173 printf_P(PSTR("\r\n"));
174 rdline_newline(&imuboard.rdl, imuboard.prompt);