Improvements to QuadMotorTest