fix MSP acc scaling for ICM20649

This commit is contained in:
Brian Balogh 2017-09-01 10:59:39 -04:00
parent afec0258c7
commit 28d6702755
1 changed files with 3 additions and 1 deletions

View File

@ -750,8 +750,10 @@ static bool mspFcProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst)
if (acc.dev.acc_1G > 512*4) {
scale = 8;
} else if (acc.dev.acc_1G >= 512) {
} else if (acc.dev.acc_1G > 512*2) {
scale = 4;
} else if (acc.dev.acc_1G >= 512) {
scale = 2;
} else {
scale = 1;
}