diff options
-rw-r--r-- | driver/accelgyro_bmi160.c | 6 |
1 files changed, 2 insertions, 4 deletions
diff --git a/driver/accelgyro_bmi160.c b/driver/accelgyro_bmi160.c index 3a6ee8b86f..77856e6118 100644 --- a/driver/accelgyro_bmi160.c +++ b/driver/accelgyro_bmi160.c @@ -919,9 +919,7 @@ static int bmi160_decode_header(struct motion_sensor_t *s, size += (i == MOTIONSENSE_TYPE_MAG ? 8 : 6); } if (*bp + size > BUFFER_END(bmi160_buffer)) { - /* frame is not complete, it - * will be retransmitted. - */ + /* frame is not complete, it will be retransmitted. */ *bp = BUFFER_END(bmi160_buffer); return 1; } @@ -935,7 +933,7 @@ static int bmi160_decode_header(struct motion_sensor_t *s, vector.data[X] = v[X]; vector.data[Y] = v[Y]; vector.data[Z] = v[Z]; - vector.sensor_num = i; + vector.sensor_num = i + (s - motion_sensors); motion_sense_fifo_add_unit(&vector, s + i, 3); *bp += (i == MOTIONSENSE_TYPE_MAG ? 8 : 6); } |