Skip to content

Commit 9fcebfe

Browse files
committed
LP-590 Zero BoardLevelTrim values while doing GyroBias calibration
1 parent 1ab7956 commit 9fcebfe

1 file changed

Lines changed: 7 additions & 3 deletions

File tree

ground/gcs/src/plugins/config/calibration/gyrobiascalibrationmodel.cpp

Lines changed: 7 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -69,9 +69,13 @@ void GyroBiasCalibrationModel::start()
6969
// Disable gyro bias correction while calibrating
7070
attitudeSettingsData.BiasCorrectGyro = AttitudeSettings::BIASCORRECTGYRO_FALSE;
7171
// Zero board rotation
72-
attitudeSettingsData.BoardRotation[AttitudeSettings::BOARDROTATION_YAW] = 0;
73-
attitudeSettingsData.BoardRotation[AttitudeSettings::BOARDROTATION_ROLL] = 0;
74-
attitudeSettingsData.BoardRotation[AttitudeSettings::BOARDROTATION_PITCH] = 0;
72+
attitudeSettingsData.BoardRotation[AttitudeSettings::BOARDROTATION_YAW] = 0;
73+
attitudeSettingsData.BoardRotation[AttitudeSettings::BOARDROTATION_ROLL] = 0;
74+
attitudeSettingsData.BoardRotation[AttitudeSettings::BOARDROTATION_PITCH] = 0;
75+
// Zero board level trim
76+
attitudeSettingsData.BoardLevelTrim[AttitudeSettings::BOARDLEVELTRIM_ROLL] = 0;
77+
attitudeSettingsData.BoardLevelTrim[AttitudeSettings::BOARDLEVELTRIM_PITCH] = 0;
78+
7579
attitudeSettings->setData(attitudeSettingsData);
7680

7781
UAVObject::Metadata gyroStateMetadata = gyroState->getMetadata();

0 commit comments

Comments
 (0)