이유진

높이 동기화

# step1 : 높이조정
import CoDrone
import keyboard
from CoDrone.system import Direction
from CoDrone.system import Mode
from time import sleep
errorRange = 50 # 오차범위
moveRange = 150 # 움직였다고 판단할 거리
heightRange = 70 # 움직였다고 판단할 거리 height
# 키보드로 콘솔창에 'q'를 누르면 드론이 착륙하게 만드는 코드
def stop(_master, _slave):
if keyboard.is_pressed('q'): # 키보드에서 'q'가 입력되면 while문 탈출
print('[Keyboard input occur: Quit!]')
# 착륙에 성공할 때까지 LED 효과
# 착륙시작시 LED 효과
_master.arm_default_pattern(0, 125, 155, Mode.DOUBLE_BLINK, 10)
_slave.arm_default_pattern(0, 125, 155, Mode.DOUBLE_BLINK, 10)
return True
......@@ -38,11 +39,9 @@ def setHeight(_master, _mHeight, _slave):
return
elif _sHeight < _mHeight - errorRange:
_slave.go(Direction.UP, 0, 100)
# sleep(0.2)
print('[up]')
elif _sHeight > _mHeight + errorRange:
_slave.go(Direction.DOWN, 0, 100)
# sleep(0.2)
print('[down]')
......@@ -70,6 +69,7 @@ def main():
.format(mPosition.X, mPosition.Y, mHeight, sPosition.X, sPosition.Y, sHeight)) # 좌표출력/단위(mm)
if stop(master, slave):
print('드론을 착륙시킵니다.')
break
# master의 전 높이 대비 +- moveRange 만큼의 차이가 있으면 slave가 움직이도록
......@@ -80,10 +80,10 @@ def main():
slave.arm_strobe()
setHeight(master, mHeight, slave)
print('Land')
slave.land() # 착륙
master.arm_off()
slave.arm_off()
print('Land')
slave.land() # 착륙
# 연결해제 -> 여기까지 성공했다면 배터리 안 빼도 다시 연결 됩니다.
slave.disconnect()
......