Added dynamics constraints to allow gyro and accelerometer calibration, and prevent drift due to pre-takeoff FDM usage