Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-05-20 19:36:19 +08:00
Code Issues Actions 29 Packages Projects Releases Wiki Activity

superseded by sw/airborne/test/peripherals/test_ami.c

Browse Source
This commit is contained in:
Antoine Drouin
2010-09-14 14:57:56 +00:00
parent 7a47c8877f
commit b7aefebec0
1 changed files with 0 additions and 107 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/airborne/booz/test/booz2_test_ami.c
-107
View File
@@ -1,107 +0,0 @@
/*
* $Id$
*
* Copyright (C) 2008-2009 Antoine Drouin <poinix@gmail.com>
*
* 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 <inttypes.h>
#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]);
}