Fixed gimbal lock in IMU angular rates formula
Updated QuadMotorTest to measure the motors characteristics