exit()
box.close()
print('init finish-------------------------------')
# box.drop()
# sleep(1)
while 1:
try:
start_signal = gpio.read(PIN.STATE)
if start_signal and not mode_auto:
gpio.write(PIN.BUZZER, 0)
mode_auto = 1
# auto run
print('mission start')
controller.record.start()
plane.mc(DC.LOITER)
plane.arm()
plane.take_off(55, 16 * 8)
plane.take_off(100, 10 * 8)
plane.idle(5)
controller.mission_start()
box.close()
plane.land()
plane.mc(DC.STABLIZE)
plane.disarm()
controller.stop()
print('mission completed')
break
else:
if not start_signal:
mode_auto = 0
# print(start_signal)
