diff --git a/src/main/sensors/acceleration.c b/src/main/sensors/acceleration.c index a9036a1bec..1e55b3dd94 100644 --- a/src/main/sensors/acceleration.c +++ b/src/main/sensors/acceleration.c @@ -219,7 +219,7 @@ void updateAccelerationReadings(rollAndPitchTrims_t *rollAndPitchTrims) } } - alignSensors(accSmooth, accSmooth, accAlign); + alignSensors(accSmooth, accAlign); if (!isAccelerationCalibrationComplete()) { performAcclerationCalibration(rollAndPitchTrims); diff --git a/src/main/sensors/boardalignment.c b/src/main/sensors/boardalignment.c index 57917e8a12..4221d3b488 100644 --- a/src/main/sensors/boardalignment.c +++ b/src/main/sensors/boardalignment.c @@ -62,13 +62,12 @@ static void alignBoard(int32_t *vec) vec[Z] = lrintf(boardRotation[0][Z] * x + boardRotation[1][Z] * y + boardRotation[2][Z] * z); } -void alignSensors(const int32_t *src, int32_t *dest, uint8_t rotation) +void alignSensors(int32_t *dest, uint8_t rotation) { - const int32_t x = src[X]; - const int32_t y = src[Y]; - const int32_t z = src[Z]; + const int32_t x = dest[X]; + const int32_t y = dest[Y]; + const int32_t z = dest[Z]; - // note src and dest may point to the same address switch (rotation) { default: case CW0_DEG: diff --git a/src/main/sensors/boardalignment.h b/src/main/sensors/boardalignment.h index e1e704be03..b1ab74cdf9 100644 --- a/src/main/sensors/boardalignment.h +++ b/src/main/sensors/boardalignment.h @@ -23,5 +23,5 @@ typedef struct boardAlignment_s { int32_t yawDegrees; } boardAlignment_t; -void alignSensors(const int32_t *src, int32_t *dest, uint8_t rotation); +void alignSensors(int32_t *dest, uint8_t rotation); void initBoardAlignment(const boardAlignment_t *boardAlignment); diff --git a/src/main/sensors/compass.c b/src/main/sensors/compass.c index 5b4000e282..7354be73fe 100644 --- a/src/main/sensors/compass.c +++ b/src/main/sensors/compass.c @@ -62,7 +62,7 @@ void compassUpdate(uint32_t currentTime, flightDynamicsTrims_t *magZero) mag.read(magADCRaw); for (axis = 0; axis < XYZ_AXIS_COUNT; axis++) magADC[axis] = magADCRaw[axis]; // int32_t copy to work with - alignSensors(magADC, magADC, magAlign); + alignSensors(magADC, magAlign); if (STATE(CALIBRATE_MAG)) { tCal = currentTime; diff --git a/src/main/sensors/gyro.c b/src/main/sensors/gyro.c index 5ed678e103..0af158fe99 100644 --- a/src/main/sensors/gyro.c +++ b/src/main/sensors/gyro.c @@ -170,7 +170,7 @@ void gyroUpdate(void) gyroADC[Y] = gyroADCRaw[Y]; gyroADC[Z] = gyroADCRaw[Z]; - alignSensors(gyroADC, gyroADC, gyroAlign); + alignSensors(gyroADC, gyroAlign); if (!isGyroCalibrationComplete()) { performGyroCalibration(gyroConfig->gyroMovementCalibrationThreshold);