Added in IMU into simulation