mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-18 13:55:18 +03:00
Split up imuUpdate for gyro and acc
This commit is contained in:
parent
81299e34de
commit
b3f0bd1402
3 changed files with 14 additions and 17 deletions
|
@ -425,12 +425,14 @@ static void imuCalculateEstimatedAttitude(void)
|
|||
imuCalculateAcceleration(deltaT); // rotate acc vector into earth frame
|
||||
}
|
||||
|
||||
void imuUpdate(rollAndPitchTrims_t *accelerometerTrims, uint8_t imuUpdateSensors)
|
||||
void imuUpdateGyro(void)
|
||||
{
|
||||
if (imuUpdateSensors == ONLY_GYRO || imuUpdateSensors == ACC_AND_GYRO) {
|
||||
gyroUpdate();
|
||||
}
|
||||
if (sensors(SENSOR_ACC) && (!imuUpdateSensors == ONLY_GYRO)) {
|
||||
gyroUpdate();
|
||||
}
|
||||
|
||||
void imuUpdateAcc(rollAndPitchTrims_t *accelerometerTrims)
|
||||
{
|
||||
if (sensors(SENSOR_ACC)) {
|
||||
updateAccelerationReadings(accelerometerTrims);
|
||||
imuCalculateEstimatedAttitude();
|
||||
} else {
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue