Matlab imu position. So adding an IMU seems to help estimate position.