Mpu9250 Position Tracking