Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-20 06:45:16 +03:00
Code Issues Wiki Activity

don't rotate D or A, it reverses their sign inappropriately

Browse source
This commit is contained in:
ctzsnooze 2024-10-22 00:19:50 +11:00
parent 1a81b3cdf3
commit 5e81ff6977
1 changed files with 9 additions and 9 deletions
Download patch file Download diff file Expand all files Collapse all files

18
src/main/flight/autopilot.c
View file

@ -331,15 +331,15 @@ bool positionControl(void) {
posHold.pitchI = rotatedPitchI;
// rotate smoothed DA factors
const float rotatedRollD = rollD * cosDeltaHeading + pitchD * sinDeltaHeading;
const float rotatedPitchD = pitchD * cosDeltaHeading - rollD * sinDeltaHeading;
rollD = rotatedRollD;
pitchD = rotatedPitchD;
const float rotatedRollA = rollA * cosDeltaHeading + pitchA * sinDeltaHeading;
const float rotatedPitchA = pitchA * cosDeltaHeading - rollA * sinDeltaHeading;
rollA = rotatedRollA;
pitchA = rotatedPitchA;
// const float rotatedRollD = rollD * cosDeltaHeading + pitchD * sinDeltaHeading;
// const float rotatedPitchD = pitchD * cosDeltaHeading - rollD * sinDeltaHeading;
// rollD = rotatedRollD;
// pitchD = rotatedPitchD;
//
// const float rotatedRollA = rollA * cosDeltaHeading + pitchA * sinDeltaHeading;
// const float rotatedPitchA = pitchA * cosDeltaHeading - rollA * sinDeltaHeading;
// rollA = rotatedRollA;
// pitchA = rotatedPitchA;
// limit sum of D and A because otherwise too aggressive if entering at speed
float rollDA = rollD + rollA;