Changed imu names to mpu6000