Add airspeed sensor to sensor_simulator

This commit is contained in:
kamilritz
2020-01-09 15:46:34 +01:00
committed by Roman Bapst
parent 4044abdd20
commit 7ed6a437c7
23 changed files with 177 additions and 33 deletions
+32
View File
@@ -0,0 +1,32 @@
#include "airspeed.h"
namespace sensor_simulator
{
namespace sensor
{
Airspeed::Airspeed(std::shared_ptr<Ekf> ekf):Sensor(ekf)
{
}
Airspeed::~Airspeed()
{
}
void Airspeed::send(uint64_t time)
{
if(_true_airspeed_data > FLT_EPSILON && _indicated_airspeed_data > FLT_EPSILON)
{
float eas2tas = _true_airspeed_data / _indicated_airspeed_data;
_ekf->setAirspeedData(time, _true_airspeed_data, eas2tas);
}
}
void Airspeed::setData(float true_airspeed, float indicated_airspeed)
{
_true_airspeed_data = true_airspeed;
_indicated_airspeed_data = indicated_airspeed;
}
} // namespace sensor
} // namespace sensor_simulator