Skip to content

Instantly share code, notes, and snippets.

Embed
What would you like to do?
ros-takeoff-hover-land.py
#!/usr/bin/env python
import rospy
from mavros_msgs.srv import SetMode
from mavros_msgs.srv import CommandBool
from mavros_msgs.srv import CommandTOL
import time
rospy.init_node('mavros_takeoff_python')
rate = rospy.Rate(10)
# Set Mode
print "\nSetting Mode"
rospy.wait_for_service('/mavros/set_mode')
try:
change_mode = rospy.ServiceProxy('/mavros/set_mode', SetMode)
response = change_mode(custom_mode="ALT_HOLD")
rospy.loginfo(response)
except rospy.ServiceException as e:
print("Set mode failed: %s" %e)
# Arm
print "\nArming"
rospy.wait_for_service('/mavros/cmd/arming')
try:
arming_cl = rospy.ServiceProxy('/mavros/cmd/arming', CommandBool)
response = arming_cl(value = True)
rospy.loginfo(response)
except rospy.ServiceException as e:
print("Arming failed: %s" %e)
# Takeoff
print "\nTaking off"
rospy.wait_for_service('/mavros/cmd/takeoff')
try:
takeoff_cl = rospy.ServiceProxy('/mavros/cmd/takeoff', CommandTOL)
response = takeoff_cl(altitude=10, latitude=0, longitude=0, min_pitch=0, yaw=0)
rospy.loginfo(response)
except rospy.ServiceException as e:
print("Takeoff failed: %s" %e)
print "\nHovering..."
time.sleep(5)
# Land
print "\nLanding"
rospy.wait_for_service('/mavros/cmd/land')
try:
takeoff_cl = rospy.ServiceProxy('/mavros/cmd/land', CommandTOL)
response = takeoff_cl(altitude=10, latitude=0, longitude=0, min_pitch=0, yaw=0)
rospy.loginfo(response)
except rospy.ServiceException as e:
print("Landing failed: %s" %e)
# Disarm
print "\nDisarming"
rospy.wait_for_service('/mavros/cmd/arming')
try:
arming_cl = rospy.ServiceProxy('/mavros/cmd/arming', CommandBool)
response = arming_cl(value = False)
rospy.loginfo(response)
except rospy.ServiceException as e:
print("Disarming failed: %s" %e)
@DiegoHerrera1890

This comment has been minimized.

Copy link

@DiegoHerrera1890 DiegoHerrera1890 commented Dec 7, 2019

hi! Thanks for sharing.
I run your code but when is running "takeoff" appears
FCU: Takeoff denied! please disarm and retry
FCU: Landing denied! please land manually

@Nvs05

This comment has been minimized.

Copy link

@Nvs05 Nvs05 commented Dec 20, 2019

I am experiencing the same as DiegoHerrera, I tried the same code in c++ and works, but in python does not takeoff.
LasQuesadillasVanConQueso

@DiegoHerrera1890

This comment has been minimized.

Copy link

@DiegoHerrera1890 DiegoHerrera1890 commented Dec 20, 2019

I am experiencing the same as DiegoHerrera, I tried the same code in c++ and works, but in python does not takeoff.
LasQuesadillasVanConQueso

Hello! I brought the drone out of the building and now is working well. I was testing the drone inside a building(my laboratory) and the problem was with the GPS. Outside is working well.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment