Showing
1 changed file
with
35 additions
and
0 deletions
yujin_test/setPosition.py
0 → 100644
| 1 | +import CoDrone | ||
| 2 | +from CoDrone.system import Direction | ||
| 3 | + | ||
| 4 | + | ||
| 5 | +def getPosition(drone): | ||
| 6 | + position = drone.get_opt_flow_position() # 상대좌표 (시작 0,0) | ||
| 7 | + height = drone.get_height() # 고 | ||
| 8 | + print("x={} y={} z={}".format(position.X, position.Y, height)) # 단위(mm) | ||
| 9 | + | ||
| 10 | + | ||
| 11 | +def main(): | ||
| 12 | + drone = CoDrone.CoDrone() | ||
| 13 | + drone.connect() | ||
| 14 | + | ||
| 15 | + drone.takeoff() | ||
| 16 | + getPosition(drone) | ||
| 17 | + drone.move(-5, 4, 0, 0) # move(roll 좌우, pitch 전후, yaw, throttle) | ||
| 18 | + # drone.go(Direction.FORWARD, 0.5) | ||
| 19 | + # print('forward') | ||
| 20 | + # getPosition(drone) | ||
| 21 | + # drone.go(Direction.LEFT, 1) | ||
| 22 | + # print('left') | ||
| 23 | + getPosition(drone) | ||
| 24 | + drone.hover(3) | ||
| 25 | + getPosition(drone) | ||
| 26 | + print('land') | ||
| 27 | + getPosition(drone) | ||
| 28 | + drone.land() | ||
| 29 | + | ||
| 30 | + | ||
| 31 | +if __name__ == '__main__': | ||
| 32 | + main() | ||
| 33 | + | ||
| 34 | + | ||
| 35 | + |
-
Please register or login to post a comment