mirror of https://github.com/ArduPilot/ardupilot
49 lines
783 B
C++
49 lines
783 B
C++
/*
|
|
SITL handling
|
|
|
|
This simulates a barometer
|
|
|
|
Andrew Tridgell November 2011
|
|
*/
|
|
|
|
#include <AP_HAL.h>
|
|
#include <AP_Math.h>
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_AVR_SITL
|
|
|
|
#include "AP_HAL_AVR_SITL.h"
|
|
|
|
using namespace AVR_SITL;
|
|
|
|
extern const AP_HAL::HAL& hal;
|
|
|
|
#include <unistd.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <stdint.h>
|
|
#include <math.h>
|
|
|
|
/*
|
|
setup the barometer with new input
|
|
altitude is in meters
|
|
*/
|
|
void SITL_State::_update_barometer(float altitude)
|
|
{
|
|
static uint32_t last_update;
|
|
|
|
if (_barometer == NULL) {
|
|
// this sketch doesn't use a barometer
|
|
return;
|
|
}
|
|
|
|
// 80Hz, to match the real APM2 barometer
|
|
if (hal.scheduler->millis() - last_update < 12) {
|
|
return;
|
|
}
|
|
last_update = hal.scheduler->millis();
|
|
|
|
_barometer->setHIL(altitude);
|
|
}
|
|
|
|
#endif
|