forked from Archive/PX4-Autopilot
df wrappers: fix invalid NaN to int16 conversion (set to 0 instead)
The result of this conversion is undefined!
This commit is contained in:
parent
a7ef9b4954
commit
61f7470e7e
|
@ -279,9 +279,9 @@ int DfAK8963Wrapper::_publish(struct mag_sensor_data &data)
|
|||
mag_report.timestamp = hrt_absolute_time();
|
||||
|
||||
// TODO: remove these (or get the values)
|
||||
mag_report.x_raw = NAN;
|
||||
mag_report.y_raw = NAN;
|
||||
mag_report.z_raw = NAN;
|
||||
mag_report.x_raw = 0;
|
||||
mag_report.y_raw = 0;
|
||||
mag_report.z_raw = 0;
|
||||
|
||||
math::Vector<3> mag_val(data.field_x_ga, data.field_y_ga, data.field_z_ga);
|
||||
|
||||
|
|
|
@ -278,9 +278,9 @@ int DfHmc9250Wrapper::_publish(struct mag_sensor_data &data)
|
|||
data.field_y_ga = tmp;
|
||||
|
||||
// TODO: remove these (or get the values)
|
||||
mag_report.x_raw = NAN;
|
||||
mag_report.y_raw = NAN;
|
||||
mag_report.z_raw = NAN;
|
||||
mag_report.x_raw = 0;
|
||||
mag_report.y_raw = 0;
|
||||
mag_report.z_raw = 0;
|
||||
|
||||
math::Vector<3> mag_val(data.field_x_ga,
|
||||
data.field_y_ga,
|
||||
|
|
|
@ -640,18 +640,18 @@ int DfLsm9ds1Wrapper::_publish(struct imu_sensor_data &data)
|
|||
}
|
||||
|
||||
// TODO: remove these (or get the values)
|
||||
gyro_report.x_raw = NAN;
|
||||
gyro_report.y_raw = NAN;
|
||||
gyro_report.z_raw = NAN;
|
||||
gyro_report.x_raw = 0;
|
||||
gyro_report.y_raw = 0;
|
||||
gyro_report.z_raw = 0;
|
||||
|
||||
accel_report.x_raw = NAN;
|
||||
accel_report.y_raw = NAN;
|
||||
accel_report.z_raw = NAN;
|
||||
accel_report.x_raw = 0;
|
||||
accel_report.y_raw = 0;
|
||||
accel_report.z_raw = 0;
|
||||
|
||||
if (_mag_enabled) {
|
||||
mag_report.x_raw = NAN;
|
||||
mag_report.y_raw = NAN;
|
||||
mag_report.z_raw = NAN;
|
||||
mag_report.x_raw = 0;
|
||||
mag_report.y_raw = 0;
|
||||
mag_report.z_raw = 0;
|
||||
}
|
||||
|
||||
math::Vector<3> gyro_val_filt;
|
||||
|
|
|
@ -501,13 +501,13 @@ int DfMPU6050Wrapper::_publish(struct imu_sensor_data &data)
|
|||
accel_report.device_id = m_id.dev_id;
|
||||
|
||||
// TODO: remove these (or get the values)
|
||||
gyro_report.x_raw = NAN;
|
||||
gyro_report.y_raw = NAN;
|
||||
gyro_report.z_raw = NAN;
|
||||
gyro_report.x_raw = 0;
|
||||
gyro_report.y_raw = 0;
|
||||
gyro_report.z_raw = 0;
|
||||
|
||||
accel_report.x_raw = NAN;
|
||||
accel_report.y_raw = NAN;
|
||||
accel_report.z_raw = NAN;
|
||||
accel_report.x_raw = 0;
|
||||
accel_report.y_raw = 0;
|
||||
accel_report.z_raw = 0;
|
||||
|
||||
math::Vector<3> gyro_val_filt;
|
||||
math::Vector<3> accel_val_filt;
|
||||
|
|
|
@ -661,18 +661,18 @@ int DfMpu9250Wrapper::_publish(struct imu_sensor_data &data)
|
|||
}
|
||||
|
||||
// TODO: remove these (or get the values)
|
||||
gyro_report.x_raw = NAN;
|
||||
gyro_report.y_raw = NAN;
|
||||
gyro_report.z_raw = NAN;
|
||||
gyro_report.x_raw = 0;
|
||||
gyro_report.y_raw = 0;
|
||||
gyro_report.z_raw = 0;
|
||||
|
||||
accel_report.x_raw = NAN;
|
||||
accel_report.y_raw = NAN;
|
||||
accel_report.z_raw = NAN;
|
||||
accel_report.x_raw = 0;
|
||||
accel_report.y_raw = 0;
|
||||
accel_report.z_raw = 0;
|
||||
|
||||
if (_mag_enabled) {
|
||||
mag_report.x_raw = NAN;
|
||||
mag_report.y_raw = NAN;
|
||||
mag_report.z_raw = NAN;
|
||||
mag_report.x_raw = 0;
|
||||
mag_report.y_raw = 0;
|
||||
mag_report.z_raw = 0;
|
||||
}
|
||||
|
||||
math::Vector<3> gyro_val_filt;
|
||||
|
|
Loading…
Reference in New Issue