mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-02-26 17:53:59 -04:00
uncrustify libraries/AP_AHRS/examples/AHRS_Test/AHRS_Test.pde
This commit is contained in:
parent
fc11f7e3f0
commit
6327305116
@ -41,10 +41,10 @@ AP_Compass_HMC5843 compass;
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifdef APM2_HARDWARE
|
#ifdef APM2_HARDWARE
|
||||||
AP_InertialSensor_MPU6000 ins( 53 );
|
AP_InertialSensor_MPU6000 ins( 53 );
|
||||||
# else
|
# else
|
||||||
AP_ADC_ADS7844 adc;
|
AP_ADC_ADS7844 adc;
|
||||||
AP_InertialSensor_Oilpan ins( &adc );
|
AP_InertialSensor_Oilpan ins( &adc );
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
static GPS *g_gps;
|
static GPS *g_gps;
|
||||||
@ -62,24 +62,24 @@ AP_Baro_BMP085_HIL barometer;
|
|||||||
|
|
||||||
|
|
||||||
#ifdef APM2_HARDWARE
|
#ifdef APM2_HARDWARE
|
||||||
# define A_LED_PIN 27
|
# define A_LED_PIN 27
|
||||||
# define C_LED_PIN 25
|
# define C_LED_PIN 25
|
||||||
# define LED_ON LOW
|
# define LED_ON LOW
|
||||||
# define LED_OFF HIGH
|
# define LED_OFF HIGH
|
||||||
# define MAG_ORIENTATION AP_COMPASS_APM2_SHIELD
|
# define MAG_ORIENTATION AP_COMPASS_APM2_SHIELD
|
||||||
#else
|
#else
|
||||||
# define A_LED_PIN 37
|
# define A_LED_PIN 37
|
||||||
# define C_LED_PIN 35
|
# define C_LED_PIN 35
|
||||||
# define LED_ON HIGH
|
# define LED_ON HIGH
|
||||||
# define LED_OFF LOW
|
# define LED_OFF LOW
|
||||||
# define MAG_ORIENTATION AP_COMPASS_COMPONENTS_DOWN_PINS_FORWARD
|
# define MAG_ORIENTATION AP_COMPASS_COMPONENTS_DOWN_PINS_FORWARD
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|
||||||
static void flash_leds(bool on)
|
static void flash_leds(bool on)
|
||||||
{
|
{
|
||||||
digitalWrite(A_LED_PIN, on?LED_OFF:LED_ON);
|
digitalWrite(A_LED_PIN, on ? LED_OFF : LED_ON);
|
||||||
digitalWrite(C_LED_PIN, on?LED_ON:LED_OFF);
|
digitalWrite(C_LED_PIN, on ? LED_ON : LED_OFF);
|
||||||
}
|
}
|
||||||
|
|
||||||
void setup(void)
|
void setup(void)
|
||||||
@ -158,7 +158,7 @@ void loop(void)
|
|||||||
ToDeg(drift.x),
|
ToDeg(drift.x),
|
||||||
ToDeg(drift.y),
|
ToDeg(drift.y),
|
||||||
ToDeg(drift.z),
|
ToDeg(drift.z),
|
||||||
compass.use_for_yaw()?ToDeg(heading):0.0,
|
compass.use_for_yaw() ? ToDeg(heading) : 0.0,
|
||||||
(1.0e6*counter)/(now-last_print));
|
(1.0e6*counter)/(now-last_print));
|
||||||
last_print = now;
|
last_print = now;
|
||||||
counter = 0;
|
counter = 0;
|
||||||
|
Loading…
Reference in New Issue
Block a user