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