mirror of https://github.com/ArduPilot/ardupilot
84 lines
2.2 KiB
Plaintext
84 lines
2.2 KiB
Plaintext
/*
|
|
generic Baro driver test
|
|
*/
|
|
#include <AP_Common.h>
|
|
#include <AP_Progmem.h>
|
|
#include <AP_Param.h>
|
|
#include <AP_Math.h>
|
|
#include <AP_HAL.h>
|
|
#include <AP_Buffer.h>
|
|
#include <Filter.h>
|
|
#include <AP_Baro.h>
|
|
#include <AP_HAL_AVR.h>
|
|
#include <AP_HAL_AVR_SITL.h>
|
|
#include <AP_HAL_Linux.h>
|
|
#include <AP_HAL_FLYMAPLE.h>
|
|
#include <AP_HAL_PX4.h>
|
|
#include <AP_HAL_Empty.h>
|
|
|
|
const AP_HAL::HAL& hal = AP_HAL_BOARD_DRIVER;
|
|
|
|
#define CONFIG_BARO HAL_BARO_DEFAULT
|
|
|
|
#if CONFIG_BARO == HAL_BARO_BMP085
|
|
static AP_Baro_BMP085 barometer;
|
|
#elif CONFIG_BARO == HAL_BARO_PX4
|
|
static AP_Baro_PX4 barometer;
|
|
#elif CONFIG_BARO == HAL_BARO_VRBRAIN
|
|
static AP_Baro_VRBRAIN barometer;
|
|
#elif CONFIG_BARO == HAL_BARO_HIL
|
|
static AP_Baro_HIL barometer;
|
|
#elif CONFIG_BARO == HAL_BARO_MS5611
|
|
static AP_Baro_MS5611 barometer(&AP_Baro_MS5611::i2c);
|
|
#elif CONFIG_BARO == HAL_BARO_MS5611_SPI
|
|
static AP_Baro_MS5611 barometer(&AP_Baro_MS5611::spi);
|
|
#else
|
|
#error Unrecognized CONFIG_BARO setting
|
|
#endif
|
|
|
|
static uint32_t timer;
|
|
|
|
void setup()
|
|
{
|
|
hal.console->println("Barometer library test");
|
|
|
|
hal.scheduler->delay(1000);
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_APM2
|
|
// disable CS on MPU6000
|
|
hal.gpio->pinMode(63, HAL_GPIO_OUTPUT);
|
|
hal.gpio->write(63, 1);
|
|
#endif
|
|
|
|
barometer.init();
|
|
barometer.calibrate();
|
|
|
|
timer = hal.scheduler->micros();
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
if((hal.scheduler->micros() - timer) > 100000UL) {
|
|
timer = hal.scheduler->micros();
|
|
barometer.read();
|
|
uint32_t read_time = hal.scheduler->micros() - timer;
|
|
if (!barometer.healthy) {
|
|
hal.console->println("not healthy");
|
|
return;
|
|
}
|
|
hal.console->print("Pressure:");
|
|
hal.console->print(barometer.get_pressure());
|
|
hal.console->print(" Temperature:");
|
|
hal.console->print(barometer.get_temperature());
|
|
hal.console->print(" Altitude:");
|
|
hal.console->print(barometer.get_altitude());
|
|
hal.console->printf(" climb=%.2f t=%u samples=%u",
|
|
barometer.get_climb_rate(),
|
|
(unsigned)read_time,
|
|
(unsigned)barometer.get_pressure_samples());
|
|
hal.console->println();
|
|
}
|
|
}
|
|
|
|
AP_HAL_MAIN();
|