mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-19 02:13:35 +08:00
Fixed incorrect scaling of acceleration values
This commit is contained in:
@@ -87,9 +87,9 @@ int attitude_estimator_bm_update(struct sensor_combined_s *raw, float_vect3 *eul
|
||||
gyro_values.z = raw->gyro_rad_s[2];
|
||||
|
||||
float_vect3 accel_values;
|
||||
accel_values.x = raw->accelerometer_m_s2[0];
|
||||
accel_values.y = raw->accelerometer_m_s2[1];
|
||||
accel_values.z = raw->accelerometer_m_s2[2];
|
||||
accel_values.x = raw->accelerometer_m_s2[0] * 9.81f;
|
||||
accel_values.y = raw->accelerometer_m_s2[1] * 9.81f;
|
||||
accel_values.z = raw->accelerometer_m_s2[2] * 9.81f;
|
||||
|
||||
float_vect3 mag_values;
|
||||
mag_values.x = raw->magnetometer_ga[0]*100.0f;
|
||||
|
||||
Reference in New Issue
Block a user