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

Make gyroDataIndex const

Browse source
This commit is contained in:
Steve Evans 2021-12-28 21:56:45 +00:00
parent e2f73cd7e5
commit 2d770f747e
1 changed files with 4 additions and 4 deletions
Download patch file Download diff file Expand all files Collapse all files

8
src/main/drivers/accgyro/accgyro_mpu.c
View file

@ -325,13 +325,13 @@ bool mpuGyroReadSPI(gyroDev_t *gyro)
case GYRO_EXTI_INT_DMA: case GYRO_EXTI_INT_DMA:
{ {
// Acc and gyro data may not be continuous (MPU6xxx has temperature in between) // Acc and gyro data may not be continuous (MPU6xxx has temperature in between)
uint8_t gyroDataIndex = ((gyro->gyroDataReg - gyro->accDataReg) >> 1) + 1; const uint8_t gyroDataIndex = ((gyro->gyroDataReg - gyro->accDataReg) >> 1) + 1;
// If read was triggered in interrupt don't bother waiting. The worst that could happen is that we pick // If read was triggered in interrupt don't bother waiting. The worst that could happen is that we pick
// up an old value. // up an old value.
gyro->gyroADCRaw[X] = __builtin_bswap16(gyroData[gyroDataIndex++]); gyro->gyroADCRaw[X] = __builtin_bswap16(gyroData[gyroDataIndex]);
gyro->gyroADCRaw[Y] = __builtin_bswap16(gyroData[gyroDataIndex++]); gyro->gyroADCRaw[Y] = __builtin_bswap16(gyroData[gyroDataIndex + 1]);
gyro->gyroADCRaw[Z] = __builtin_bswap16(gyroData[gyroDataIndex]); gyro->gyroADCRaw[Z] = __builtin_bswap16(gyroData[gyroDataIndex + 2]);
break; break;
} }