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>
56 #include "eeprom_config.h"
59 #include "gps_venus.h"
65 #include "../common/i2c_commands.h"
66 #include "i2c_protocol.h"
70 struct imuboard imuboard;
71 volatile uint32_t global_ms;
75 #define BOOTLOADER_ADDR 0x3f000
76 if (pgm_read_byte_far(BOOTLOADER_ADDR) == 0xff) {
77 printf_P(PSTR("Bootloader is not present\r\n"));
81 /* ... very specific :( */
95 /* __asm__ __volatile__ ("ldi r31,0xf8\n"); */
96 /* __asm__ __volatile__ ("ldi r30,0x00\n"); */
97 /* __asm__ __volatile__ ("eijmp\n"); */
100 /* return time in milliseconds on unsigned 16 bits */
101 uint16_t get_time_ms(void)
111 static void main_timer_interrupt(void)
113 static uint16_t cycles;
114 static uint8_t stack = 0;
115 static uint8_t cpt = 0;
119 if (global_ms & 0x80)
124 if ((cpt & 0x03) != 0)
127 /* the following code is only called one interrupt among 4: every 682us
128 * (at 12 Mhz) = 8192 cycles */
130 if (cycles >= 12000) {
139 if ((cpt & 0x3) == 0)
140 callout_manage(&imuboard.intr_cm);
148 DDRB = 0x18 /* LEDs */;
151 uart_register_rx_event(CMDLINE_UART, emergency);
153 fdevopen(cmdline_dev_send, cmdline_dev_recv);
155 timer0_register_OV_intr(main_timer_interrupt);
157 callout_mgr_init(&imuboard.intr_cm, get_time_ms);
161 printf_P(PSTR("starting...\r\n"));
164 c = uart_recv_nowait(0);
166 printf("%x\n", (uint8_t)c);
172 error_register_emerg(mylog);
173 error_register_error(mylog);
174 error_register_warning(mylog);
175 error_register_notice(mylog);
176 error_register_debug(mylog);
178 /* communication with mpu6050 */
181 /* i2c hw to communicate with mainboard */
182 i2c_init(I2C_MODE_SLAVE, I2C_IMUBOARD_ADDR);
184 i2c_register_recv_event(i2c_recvevent);
185 i2c_register_send_event(i2c_sendevent);
188 printf_P(PSTR("starting...\r\n"));
189 eeprom_load_config();
193 printf_P(PSTR("\r\n"));
194 rdline_newline(&imuboard.rdl, imuboard.prompt);
204 imuboard.flags |= IMUBOARD_F_BOOT_OK;