|
|
|
@ -644,6 +644,7 @@ int DfLsm9ds1Wrapper::_publish(struct imu_sensor_data &data)
@@ -644,6 +644,7 @@ int DfLsm9ds1Wrapper::_publish(struct imu_sensor_data &data)
|
|
|
|
|
mag_report.range_ga = -1.0f; |
|
|
|
|
mag_report.device_id = m_id.dev_id; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// TODO: remove these (or get the values)
|
|
|
|
|
gyro_report.x_raw = NAN; |
|
|
|
|
gyro_report.y_raw = NAN; |
|
|
|
@ -710,6 +711,7 @@ int DfLsm9ds1Wrapper::_publish(struct imu_sensor_data &data)
@@ -710,6 +711,7 @@ int DfLsm9ds1Wrapper::_publish(struct imu_sensor_data &data)
|
|
|
|
|
if (_mag_topic != nullptr) { |
|
|
|
|
orb_publish(ORB_ID(sensor_mag), _mag_topic, &mag_report); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* Notify anyone waiting for data. */ |
|
|
|
|
DevMgr::updateNotify(*this); |
|
|
|
|
|
|
|
|
|