Skip to content

Instantly share code, notes, and snippets.

@okalachev
Last active October 18, 2018 20:24
Show Gist options
  • Star 0 You must be signed in to star a gist
  • Fork 0 You must be signed in to fork a gist
  • Save okalachev/374553b1f171f2c518db8548e6530d9b to your computer and use it in GitHub Desktop.
Save okalachev/374553b1f171f2c518db8548e6530d9b to your computer and use it in GitHub Desktop.
import rospy
from clever import srv
from std_srvs.srv import Trigger
rospy.init_node('testflight')
navigate = rospy.ServiceProxy('navigate', srv.Navigate)
land = rospy.ServiceProxy('land', Trigger)
print navigate(x=0, y=0, z=1.3, frame_id='fcu_horiz', auto_arm=True)
rospy.sleep(5)
print navigate(x=0, y=0, z=1.3, frame_id='aruco_3', update_frame=True, yaw=3.14)
rospy.sleep(10)
print navigate(x=0, y=-2.5, z=1.3, speed=1.5, frame_id='aruco_3', update_frame=True, yaw=3.14)
rospy.sleep(3)
print navigate(x=0, y=0, z=1.3, speed=1.5, frame_id='aruco_5', update_frame=True, yaw=3.14)
rospy.sleep(4)
print land()
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment