diff --git a/sw/airborne/booz/test/booz2_test_ami.c b/sw/airborne/booz/test/booz2_test_ami.c deleted file mode 100644 index c2c61193b4..0000000000 --- a/sw/airborne/booz/test/booz2_test_ami.c +++ /dev/null @@ -1,107 +0,0 @@ -/* - * $Id$ - * - * Copyright (C) 2008-2009 Antoine Drouin - * - * This file is part of paparazzi. - * - * paparazzi is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2, or (at your option) - * any later version. - * - * paparazzi is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with paparazzi; see the file COPYING. If not, write to - * the Free Software Foundation, 59 Temple Place - Suite 330, - * Boston, MA 02111-1307, USA. - */ - -#include - -#include "std.h" -#include "init_hw.h" -#include "sys_time.h" -#include "led.h" -#include "uart.h" -#include "messages.h" -#include "downlink.h" - -#include "i2c.h" -#include "AMI601.h" - -#include "interrupt_hw.h" - -static inline void main_init( void ); -static inline void main_periodic_task( void ); -static inline void main_event_task( void ); - -static inline void on_mag(void); - -int main( void ) { - main_init(); - while(1) { - if (sys_time_periodic()) - main_periodic_task(); - main_event_task(); - } - return 0; -} - -static inline void main_init( void ) { - hw_init(); - sys_time_init(); - led_init(); - - LED_ON(4); - // LED_ON(5); - // LED_ON(6); - // LED_ON(7); - - uart1_init(); - -#if 0 - /* set P0.11 and P0.14 to I2C1 */ - IO0DIR |= 1<< 11 | 1 << 14; - IO0CLR = 1 << 11; - IO0CLR = 1 << 14; -#endif - - - i2c1_init(); - ami601_init(); - - int_enable(); -} - -static inline void main_periodic_task( void ) { - //#if 0 - RunOnceEvery(100, { - LED_TOGGLE(4); - }); - // uint16_t foo = ami601_status; - // DOWNLINK_SEND_BOOT(&foo); - //#endif - // if (cpu_time_sec > 2) - ami601_read(); - -} - -static inline void main_event_task( void ) { - - AMI601Event(on_mag); - -} - -static inline void on_mag(void) { - LED_TOGGLE(4); - ami601_status = AMI601_IDLE; - DOWNLINK_SEND_IMU_MAG_RAW(&ami601_val[0], - &ami601_val[2], - &ami601_val[4]); - -}