Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-10 09:58:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

SITL: Wire in random noise and fixed drift for the SITL barometer

Browse Source
This commit is contained in:
Ben Nizette 2013-11-24 20:18:33 +11:00 committed by Andrew Tridgell
parent 59a54aae20
commit f4d349eff8
1 changed files with 9 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
libraries/AP_HAL_AVR_SITL/sitl_barometer.cpp
View File

@ -31,18 +31,24 @@ void SITL_State::_update_barometer(float altitude)
{ {
static uint32_t last_update; static uint32_t last_update;
float sim_alt = altitude;
if (_barometer == NULL) { if (_barometer == NULL) {
// this sketch doesn't use a barometer // this sketch doesn't use a barometer
return; return;
} }
// 80Hz, to match the real APM2 barometer // 80Hz, to match the real APM2 barometer
if (hal.scheduler->millis() - last_update < 12) { uint32_t now = hal.scheduler->millis();
if ((now - last_update) < 12) {
return; return;
} }
last_update = hal.scheduler->millis(); last_update = now;
_barometer->setHIL(altitude); sim_alt += _sitl->baro_drift * now / 1000;
sim_alt += _sitl->baro_noise * _rand_float();
_barometer->setHIL(sim_alt);
} }
#endif #endif