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.
35 lines
744 B
35 lines
744 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) |
|
{ |
|
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
|
|
|