mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-02 03:04:07 +08:00
33 lines
630 B
C++
33 lines
630 B
C++
#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
|