Updated parameters, recalibrating IMU and testing results.