Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-23 09:08:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_InertialSensor: fixed primary accel/gyro in replay

Browse Source
This commit is contained in:
Andrew Tridgell 2015-05-11 11:16:57 +10:00
parent 64a55c908f
commit 8bf2baef70
1 changed files with 6 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/AP_InertialSensor/AP_InertialSensor.cpp
View File

@ -1237,6 +1237,9 @@ void AP_InertialSensor::set_accel(uint8_t instance, const Vector3f &accel)
if (_accel_count <= instance) {
_accel_count = instance+1;
}
if (!_accel_healthy[_primary_accel]) {
_primary_accel = instance;
}
}
}
@ -1253,6 +1256,9 @@ void AP_InertialSensor::set_gyro(uint8_t instance, const Vector3f &gyro)
_gyro_count = instance+1;
_gyro_cal_ok[instance] = true;
}
if (!_accel_healthy[_primary_accel]) {
_primary_accel = instance;
}
}
}