mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-01 23:34:08 +08:00
36 lines
744 B
C++
36 lines
744 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)
|
|
{
|
|
airspeedSample airspeed_sample;
|
|
airspeed_sample.time_us = time;
|
|
airspeed_sample.eas2tas = _true_airspeed_data / _indicated_airspeed_data;
|
|
airspeed_sample.true_airspeed = _true_airspeed_data;
|
|
_ekf->setAirspeedData(airspeed_sample);
|
|
}
|
|
}
|
|
|
|
void Airspeed::setData(float true_airspeed, float indicated_airspeed)
|
|
{
|
|
_true_airspeed_data = true_airspeed;
|
|
_indicated_airspeed_data = indicated_airspeed;
|
|
}
|
|
|
|
} // namespace sensor
|
|
} // namespace sensor_simulator
|