Improved motors test structure
Further motor test sketch improvements
Made all-in-one IMU debug function
Use new IMU debug function in IMU test sketch
Improved quadcopter sketch