correction of calculation for throttle angle correction (should really just replace with cosf() at some point
This commit is contained in:
parent
4790bfc451
commit
4972770907
|
@ -315,7 +315,7 @@ static void getEstimatedAttitude(void)
|
|||
acc_calc(deltaT); // rotate acc vector into earth frame
|
||||
|
||||
if (cfg.throttle_angle_correction) {
|
||||
int cosZ = EstG.V.Z / acc_1G * 100.0f;
|
||||
int cosZ = EstG.V.Z / (acc_1G * 100.0f);
|
||||
throttleAngleCorrection = cfg.throttle_angle_correction * constrain(100 - cosZ, 0, 100) / 8;
|
||||
}
|
||||
}
|
||||
|
|
Loading…
Reference in New Issue