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

Use mpif

Browse source
This commit is contained in:
ctzsnooze 2024-10-17 12:04:24 +11:00
parent 7c85c9a7e7
commit 8dacb1708f
1 changed files with 2 additions and 2 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -229,7 +229,7 @@ bool positionControl(float deadband) {
}
// Calculate distance error proportions for pitch and roll
const float errorAngleRadians = normalisedErrorAngle * (M_PI / 180.0f);
const float errorAngleRadians = normalisedErrorAngle * (M_PIf / 180.0f);
const float rollProportion = -sin_approx(errorAngleRadians); // + 1 when target is left, -1 when to right, of the craft
const float pitchProportion = cos_approx(errorAngleRadians); // + 1 when target is ahead, -1 when behind, the craft
@ -302,7 +302,7 @@ bool positionControl(float deadband) {
} else if (deltaHeading < -180.0f) {
deltaHeading += 360.0f; // Wrap around if less than -180
}
float deltaHeadingRadians = deltaHeading * (M_PI / 180.0f); // Convert to radians
float deltaHeadingRadians = deltaHeading * (M_PIf / 180.0f); // Convert to radians
float cosDeltaHeading = cos_approx(deltaHeadingRadians);
float sinDeltaHeading = sin_approx(deltaHeadingRadians);