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"
58 struct imuboard imuboard;
59 volatile uint32_t global_ms;
61 /* global xbee device */
62 struct xbee_dev *xbee_dev;
66 #define BOOTLOADER_ADDR 0x3f000
67 if (pgm_read_byte_far(BOOTLOADER_ADDR) == 0xff) {
68 printf_P(PSTR("Bootloader is not present\r\n"));
72 /* ... very specific :( */
86 /* __asm__ __volatile__ ("ldi r31,0xf8\n"); */
87 /* __asm__ __volatile__ ("ldi r30,0x00\n"); */
88 /* __asm__ __volatile__ ("eijmp\n"); */
91 /* return time in milliseconds on unsigned 16 bits */
92 uint16_t get_time_ms(void)
102 static void main_timer_interrupt(void)
104 static uint16_t cycles;
105 static uint8_t stack = 0;
106 static uint8_t cpt = 0;
110 if (global_ms & 0x80)
115 if ((cpt & 0x03) != 0)
118 /* the following code is only called one interrupt among 4: every 682us
119 * (at 12 Mhz) = 8192 cycles */
121 if (cycles >= 12000) {
130 if ((cpt & 0x3) == 0)
131 callout_manage(&imuboard.intr_cm);
143 DDRB = 0x18 /* LEDs */;
146 uart_register_rx_event(CMDLINE_UART, emergency);
148 fdevopen(cmdline_dev_send, cmdline_dev_recv);
150 timer0_register_OV_intr(main_timer_interrupt);
152 callout_mgr_init(&imuboard.intr_cm, get_time_ms);
156 error_register_emerg(mylog);
157 error_register_error(mylog);
158 error_register_warning(mylog);
159 error_register_notice(mylog);
160 error_register_debug(mylog);
162 /* communication with mpu6050 */
167 eeprom_load_config();
169 printf_P(PSTR("\r\n"));
170 rdline_newline(&imuboard.rdl, imuboard.prompt);