Taking off routine. Start motors, fly 2cm away and turn off
Adjusted after field tests
Merge branch 'develop' of github.com:arjones/flyhydra into develop