mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-06-27 14:00:35 +08:00
Add airspeed sensor to sensor_simulator
This commit is contained in:
@@ -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
|
||||
Reference in New Issue
Block a user