mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-07 16:38:30 -04:00
291369db7f
this gives us separate backends for PX4, analog and I2C. This allows the MS airspeed sensor to work on Linux, and it should work on APM2 as well.
72 lines
1.8 KiB
Plaintext
72 lines
1.8 KiB
Plaintext
/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
|
|
/*
|
|
This program 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 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
This program 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 this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
/*
|
|
* Airspeed.pde - airspeed example sketch
|
|
*
|
|
*/
|
|
|
|
#include <AP_Common.h>
|
|
#include <AP_Progmem.h>
|
|
#include <AP_Param.h>
|
|
#include <AP_Math.h>
|
|
#include <AP_HAL.h>
|
|
#include <AP_HAL_AVR.h>
|
|
#include <AP_HAL_Linux.h>
|
|
#include <AP_HAL_Empty.h>
|
|
#include <AP_ADC.h>
|
|
#include <AP_ADC_AnalogSource.h>
|
|
#include <Filter.h>
|
|
#include <AP_Buffer.h>
|
|
#include <AP_Airspeed.h>
|
|
#include <AP_Vehicle.h>
|
|
#include <AP_Notify.h>
|
|
#include <DataFlash.h>
|
|
#include <GCS_MAVLink.h>
|
|
#include <AP_GPS.h>
|
|
#include <AP_InertialSensor.h>
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_APM1
|
|
AP_ADC_ADS7844 apm1_adc;
|
|
#endif
|
|
|
|
const AP_HAL::HAL& hal = AP_HAL_BOARD_DRIVER;
|
|
|
|
static AP_Vehicle::FixedWing aparm;
|
|
|
|
AP_Airspeed airspeed(aparm);
|
|
|
|
void setup()
|
|
{
|
|
hal.console->println("ArduPilot Airspeed library test");
|
|
|
|
airspeed.init();
|
|
airspeed.calibrate();
|
|
}
|
|
|
|
void loop(void)
|
|
{
|
|
static uint32_t timer;
|
|
if((hal.scheduler->millis() - timer) > 100) {
|
|
timer = hal.scheduler->millis();
|
|
airspeed.read();
|
|
hal.console->printf("airspeed %.2f\n", airspeed.get_airspeed());
|
|
}
|
|
hal.scheduler->delay(1);
|
|
}
|
|
|
|
AP_HAL_MAIN();
|