mirror of
https://gitee.com/xiaohuolufeihua/bizhang_-obav.git
synced 2026-05-21 01:12:11 +00:00
df wrappers: fix invalid NaN to int16 conversion (set to 0 instead)
The result of this conversion is undefined!
This commit is contained in:
@@ -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;
|
||||
|
||||
Reference in New Issue
Block a user