Showing
1 changed file
with
2 additions
and
7 deletions
... | @@ -11,7 +11,7 @@ posiRange = 10 # position (x, y) 변화 인지 거리 | ... | @@ -11,7 +11,7 @@ posiRange = 10 # position (x, y) 변화 인지 거리 |
11 | 11 | ||
12 | def setHeight(_sHeight, _master): | 12 | def setHeight(_sHeight, _master): |
13 | while True: | 13 | while True: |
14 | - _mHeight = _mlave.get_height() | 14 | + _mHeight = _master.get_height() |
15 | if _sHeight - errorRange <= _mHeight <= _sHeight + errorRange: | 15 | if _sHeight - errorRange <= _mHeight <= _sHeight + errorRange: |
16 | print('[hit]') | 16 | print('[hit]') |
17 | return | 17 | return |
... | @@ -48,12 +48,11 @@ def main(): | ... | @@ -48,12 +48,11 @@ def main(): |
48 | sPosition = slave.get_opt_flow_position() | 48 | sPosition = slave.get_opt_flow_position() |
49 | sHeight = slave.get_height() # slave고도 | 49 | sHeight = slave.get_height() # slave고도 |
50 | print("master [x={} y={} z={}] slave [x={} y={} z={}]" | 50 | print("master [x={} y={} z={}] slave [x={} y={} z={}]" |
51 | - .format(mPosition.X, mPosition.Y, mHeight, sPosition.X, sPosition. | 51 | + .format(mPosition.X, mPosition.Y, mHeight, sPosition.X, sPosition.Y, sHeight)) |
52 | 52 | ||
53 | # slave의 전 높이 대비 heightRange 만큼의 차이가 있으면 master가 움직이도록 | 53 | # slave의 전 높이 대비 heightRange 만큼의 차이가 있으면 master가 움직이도록 |
54 | if abs(sHeight - bHeight) > heightRange: | 54 | if abs(sHeight - bHeight) > heightRange: |
55 | print('[height change!]') | 55 | print('[height change!]') |
56 | - | ||
57 | setHeight(sHeight, master)# master의 높이 이동 | 56 | setHeight(sHeight, master)# master의 높이 이동 |
58 | 57 | ||
59 | # slave의 이전 좌표값 저장 | 58 | # slave의 이전 좌표값 저장 |
... | @@ -61,9 +60,5 @@ def main(): | ... | @@ -61,9 +60,5 @@ def main(): |
61 | 60 | ||
62 | 61 | ||
63 | 62 | ||
64 | - | ||
65 | if __name__ == '__main__': | 63 | if __name__ == '__main__': |
66 | main() | 64 | main() |
67 | - | ||
68 | - | ||
69 | - | ... | ... |
-
Please register or login to post a comment