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

Cleaned up matrix rotation.

Browse source
This commit is contained in:
mikeller 2021-04-26 23:10:00 +12:00
parent 76b6415d34
commit 55cf26ebbc
4 changed files with 5 additions and 56 deletions
Download patch file Download diff file Expand all files Collapse all files

6
src/main/sensors/boardalignment.c
View file

@ -64,14 +64,14 @@ void initBoardAlignment(const boardAlignment_t *boardAlignment)
buildRotationMatrix(&rotationAngles, &boardRotation);
}
static FAST_CODE void alignBoard(float *vec)
static void alignBoard(float *vec)
{
applyRotation(vec, &boardRotation);
applyMatrixRotation(vec, &boardRotation);
}
FAST_CODE_NOINLINE void alignSensorViaMatrix(float *dest, fp_rotationMatrix_t* sensorRotationMatrix)
{
applyRotation(dest, sensorRotationMatrix);
applyMatrixRotation(dest, sensorRotationMatrix);
if (!standardBoardAlignment) {
alignBoard(dest);