Showing
1 changed file
with
12 additions
and
3 deletions
... | @@ -26,18 +26,17 @@ def setHeight(_sHeight, _master): | ... | @@ -26,18 +26,17 @@ def setHeight(_sHeight, _master): |
26 | 26 | ||
27 | def main(): | 27 | def main(): |
28 | master = CoDrone.CoDrone() | 28 | master = CoDrone.CoDrone() |
29 | - master.connect("None", "COM3", False) | 29 | + master.connect("None", "COM7", False) |
30 | slave = CoDrone.CoDrone() | 30 | slave = CoDrone.CoDrone() |
31 | slave.connect("None", "COM5", False) | 31 | slave.connect("None", "COM5", False) |
32 | 32 | ||
33 | 33 | ||
34 | master.takeoff()#master 드론 이륙 | 34 | master.takeoff()#master 드론 이륙 |
35 | slave.takeoff()#slave 드론 이륙 | 35 | slave.takeoff()#slave 드론 이륙 |
36 | - slave.hover(60) | ||
37 | bHeight = slave.get_height() # bHeight = slave의 높이 | 36 | bHeight = slave.get_height() # bHeight = slave의 높이 |
38 | 37 | ||
39 | # slave의 이전 좌표값(움직임 추적용) 초기화 | 38 | # slave의 이전 좌표값(움직임 추적용) 초기화 |
40 | - bHeight = 0 | 39 | + # bHeight = 0 |
41 | 40 | ||
42 | 41 | ||
43 | while True: | 42 | while True: |
... | @@ -50,6 +49,16 @@ def main(): | ... | @@ -50,6 +49,16 @@ def main(): |
50 | print("master [x={} y={} z={}] slave [x={} y={} z={}]" | 49 | print("master [x={} y={} z={}] slave [x={} y={} z={}]" |
51 | .format(mPosition.X, mPosition.Y, mHeight, sPosition.X, sPosition.Y, sHeight)) | 50 | .format(mPosition.X, mPosition.Y, mHeight, sPosition.X, sPosition.Y, sHeight)) |
52 | 51 | ||
52 | + if keyboard.is_pressed('q'): # 키보드에서 'q'가 입력되면 while문 탈출 | ||
53 | + print('[Keyboard input occur: Quit!]') | ||
54 | + # 착륙에 성공할 때까지 LED 효과 | ||
55 | + master.arm_default_pattern(0, 125, 155, Mode.DOUBLE_BLINK, 10) | ||
56 | + slave.arm_default_pattern(0, 125, 155, Mode.DOUBLE_BLINK, 10) | ||
57 | + break | ||
58 | + elif not slave.isConnected(): # slave 연결이 끊기면 프로그램 종료 | ||
59 | + print('[Slave Disconnected]') | ||
60 | + return | ||
61 | + | ||
53 | # slave의 전 높이 대비 heightRange 만큼의 차이가 있으면 master가 움직이도록 | 62 | # slave의 전 높이 대비 heightRange 만큼의 차이가 있으면 master가 움직이도록 |
54 | if abs(sHeight - bHeight) > heightRange: | 63 | if abs(sHeight - bHeight) > heightRange: |
55 | print('[height change!]') | 64 | print('[height change!]') | ... | ... |
-
Please register or login to post a comment