mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-02 04:54:06 +08:00
31 lines
393 B
C++
31 lines
393 B
C++
#include "mag.h"
|
|
|
|
namespace sensor_simulator
|
|
{
|
|
namespace sensor
|
|
{
|
|
|
|
Mag::Mag(std::shared_ptr<Ekf> ekf):Sensor(ekf)
|
|
{
|
|
}
|
|
|
|
Mag::~Mag()
|
|
{
|
|
}
|
|
|
|
void Mag::send(uint32_t time)
|
|
{
|
|
float mag[3];
|
|
_mag_data.copyTo(mag);
|
|
_ekf->setMagData(time,mag);
|
|
_time_last_data_sent = time;
|
|
}
|
|
|
|
void Mag::setData(const Vector3f& mag)
|
|
{
|
|
_mag_data = mag;
|
|
}
|
|
|
|
} // namespace sensor
|
|
} // namespace sensor_simulator::sensor
|