diff --git a/src/sensor_mpu9250.c b/src/sensor_mpu9250.c index 4e11a999fcde..fa8fa51ec863 100644 --- a/src/sensor_mpu9250.c +++ b/src/sensor_mpu9250.c @@ -56,14 +56,6 @@ enum { static struct task_wake mpu9250_wake; -static void -read_mpu(struct i2cdev_s *i2c, uint8_t reg_len, uint8_t *reg - , uint8_t read_len, uint8_t *read) -{ - int ret = i2c_dev_read(i2c, reg_len, reg, read_len, read); - i2c_shutdown_on_err(ret); -} - static void autodetect_mpu_icm(struct mpu9250 *mp) { @@ -114,6 +106,14 @@ mp9250_reschedule_timer(struct mpu9250 *mp) irq_enable(); } +static void +read_mpu(struct i2cdev_s *i2c, uint8_t reg_len, uint8_t *reg + , uint8_t read_len, uint8_t *read) +{ + int ret = i2c_dev_read(i2c, reg_len, reg, read_len, read); + i2c_shutdown_on_err(ret); +} + // Reads the fifo byte count from the device. static uint16_t get_fifo_status(struct mpu9250 *mp)