-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathtakeoff_and_land.py
58 lines (45 loc) · 1.54 KB
/
takeoff_and_land.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
from dronekit import connect, VehicleMode, LocationGlobalRelative
import time
import socket
import argparse
try:
def connectMyCopter():
parser = argparse.ArgumentParser(description='commands')
parser.add_argument('--connect')
args = parser.parse_args()
connection_string = args.connect
vehicle = connect(connection_string, wait_ready=True)
return vehicle
def arm_and_takeoff(target_altitude):
while not vehicle.is_armable:
print("waiting for vehicle to become armable")
time.sleep(1)
vehicle.mode = VehicleMode("GUIDED")
while vehicle.mode!="GUIDED":
print("waiting for vehicle to enter guided")
time.sleep(1)
vehicle.armed=True
while vehicle.armed==False:
print("waiting to arm vehicle")
time.sleep(1)
vehicle.simple_takeoff(target_altitude)
while True:
print("Current Altitude: ", vehicle.location.global_relative_frame.alt)
if vehicle.location.global_relative_frame.alt>target_altitude*0.95:
break
time.sleep(1)
print("target alt reached")
return None
vehicle=connectMyCopter()
print("taking off...")
vehicle.mode=VehicleMode("GUIDED")
arm_and_takeoff(2)
vehicle.mode=VehicleMode("LAND")
time.sleep(2)
print("End of function")
print("copter vers: ", vehicle.version)
while True:
time.sleep(2)
vehicle.close()
except Exception():
print("error")