Uncommented Wait for Connection in test_stabilize

With this change, test_stabilize will wait for a connection to be established before entering the main loop.
Merge branch 'master' of https://github.com/quadcopter5/quadcopter