이유진

Update step3.py

...@@ -9,7 +9,7 @@ errorRange = 50 # 오차범위 ...@@ -9,7 +9,7 @@ errorRange = 50 # 오차범위
9 heightRange = 30 # 움직였다고 판단할 거리 height 9 heightRange = 30 # 움직였다고 판단할 거리 height
10 posiRange = 10 # position (x, y) 변화 인지 거리 10 posiRange = 10 # position (x, y) 변화 인지 거리
11 11
12 -def setHeight(_sHeight, _master): 12 +def heightFeedback(_sHeight, _master):
13 while True: 13 while True:
14 _mHeight = _master.get_height() 14 _mHeight = _master.get_height()
15 if _sHeight - errorRange <= _mHeight <= _sHeight + errorRange: 15 if _sHeight - errorRange <= _mHeight <= _sHeight + errorRange:
...@@ -63,7 +63,7 @@ def main(): ...@@ -63,7 +63,7 @@ def main():
63 # slave의 전 높이 대비 heightRange 만큼의 차이가 있으면 master가 움직이도록 63 # slave의 전 높이 대비 heightRange 만큼의 차이가 있으면 master가 움직이도록
64 if abs(sHeight - bHeight) > heightRange: 64 if abs(sHeight - bHeight) > heightRange:
65 print('[height change!]') 65 print('[height change!]')
66 - setHeight(sHeight, master)# master의 높이 이동 66 + heightFeedback(sHeight, master)# master의 높이 이동
67 67
68 # slave의 이전 좌표값 저장 68 # slave의 이전 좌표값 저장
69 bHeight = sHeight 69 bHeight = sHeight
......