이유진

키보드를 통한 착륙 코드 (드론 1대)

1 +# 드론 착륙 by 키보드; 테스트 코드 (드론 1대용)
2 +import CoDrone
3 +import keyboard
4 +
5 +
6 +def getPosition(drone):
7 + position = drone.get_opt_flow_position() # 상대좌표 (시작 0,0)
8 + height = drone.get_height() # 고
9 + print("x={} y={} z={}".format(position.X, position.Y, height)) # 단위(mm)
10 +
11 +
12 +def main():
13 + drone = CoDrone.CoDrone()
14 + drone.connect()
15 +
16 + drone.takeoff() # 이륙
17 +
18 + while True:
19 + getPosition(drone)
20 + if keyboard.is_pressed('q'): # 키보드에서 'q'가 입력되면 while문 탈출
21 + print('Keyboard input occur: Quit!')
22 + break
23 + elif not drone.isConnected(): # 연결이 끊기면 프로그램 종료
24 + print('Disconnected')
25 + return
26 +
27 + print('드론을 착륙시킵니다.')
28 + drone.arm_pattern() # LED 효과
29 + print('Land')
30 + drone.land() # 착륙
31 + drone.disconnect() # 연결해제
32 +
33 +
34 +if __name__ == '__main__':
35 + main()
36 +
37 +
38 +