Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-06-04 05:42:49 +08:00
Code Issues Actions 25 Packages Projects Releases Wiki Activity

[ardrone] use gpio API instead of system call

Browse Source
This commit is contained in:
Gautier Hattenberger
2014-07-08 13:57:02 +02:00
parent eca8dafa1d
commit 3bc524b27a
1 changed files with 11 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/airborne/boards/ardrone/navdata.c
+10 -3
View File
@@ -41,10 +41,14 @@
#include "navdata.h" #include "navdata.h"
#include "subsystems/ins.h" #include "subsystems/ins.h"
#include "subsystems/abi.h" #include "subsystems/abi.h"
#include "mcu_periph/gpio.h"
#define NAVDATA_PACKET_SIZE 60 #define NAVDATA_PACKET_SIZE 60
#define NAVDATA_START_BYTE 0x3a #define NAVDATA_START_BYTE 0x3a
#define ARDRONE_GPIO_PORT 0x32524
#define ARDRONE_GPIO_PIN_NAVDATA 177
static inline bool_t acquire_baro_calibration(void); static inline bool_t acquire_baro_calibration(void);
static void navdata_cropbuffer(int cropsize); static void navdata_cropbuffer(int cropsize);
@@ -209,6 +213,10 @@ bool_t navdata_init()
nav_port.isInitialized = TRUE; nav_port.isInitialized = TRUE;
nav_port.last_packet_number = 0; nav_port.last_packet_number = 0;
// set navboard gpio control
gpio_setup_output(ARDRONE_GPIO_PORT, ARDRONE_GPIO_PIN_NAVDATA);
gpio_set(ARDRONE_GPIO_PORT,ARDRONE_GPIO_PIN_NAVDATA);
#if PERIODIC_TELEMETRY #if PERIODIC_TELEMETRY
register_periodic_telemetry(DefaultPeriodic, "ARDRONE_NAVDATA", send_navdata); register_periodic_telemetry(DefaultPeriodic, "ARDRONE_NAVDATA", send_navdata);
#endif #endif
@@ -282,7 +290,6 @@ static void mag_freeze_check(void) {
// from daren.g.lee paparazzi-l 20140530 // from daren.g.lee paparazzi-l 20140530
static int16_t LastMagValue = 0; static int16_t LastMagValue = 0;
static int MagFreezeCounter = 0; static int MagFreezeCounter = 0;
// int SysRet;
// printf("lm: %d, mx: %d, mfc: %d\n", LastMagValue, navdata.mx, MagFreezeCounter); // printf("lm: %d, mx: %d, mfc: %d\n", LastMagValue, navdata.mx, MagFreezeCounter);
@@ -299,8 +306,8 @@ static void mag_freeze_check(void) {
navdata_write(&cmd, 1); navdata_write(&cmd, 1);
// do the navboard reset via GPIOs // do the navboard reset via GPIOs
system("gpio 177 -d lo 0 &"); // GPIO used to reset PIC gpio_clear(ARDRONE_GPIO_PORT, ARDRONE_GPIO_PIN_NAVDATA);
system("gpio 177 -d lo 1 &"); gpio_set(ARDRONE_GPIO_PORT, ARDRONE_GPIO_PIN_NAVDATA);
// wait 20ms to retrieve data // wait 20ms to retrieve data
usleep(20000); usleep(20000);