You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
32 lines
630 B
32 lines
630 B
#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
|
|
|