Updated quadcopter test code prior to actual flight...

*start ominous music...*