mirror of
https://github.com/CopterExpress/clover.git
synced 2026-05-29 22:39:33 +00:00
38 lines
1.1 KiB
Python
38 lines
1.1 KiB
Python
# Information: https://clover.coex.tech/aruco
|
|
|
|
import rospy
|
|
from clover import srv
|
|
from std_srvs.srv import Trigger
|
|
|
|
rospy.init_node('flight')
|
|
|
|
get_telemetry = rospy.ServiceProxy('get_telemetry', srv.GetTelemetry)
|
|
navigate = rospy.ServiceProxy('navigate', srv.Navigate)
|
|
navigate_global = rospy.ServiceProxy('navigate_global', srv.NavigateGlobal)
|
|
set_position = rospy.ServiceProxy('set_position', srv.SetPosition)
|
|
set_velocity = rospy.ServiceProxy('set_velocity', srv.SetVelocity)
|
|
set_attitude = rospy.ServiceProxy('set_attitude', srv.SetAttitude)
|
|
set_rates = rospy.ServiceProxy('set_rates', srv.SetRates)
|
|
land = rospy.ServiceProxy('land', Trigger)
|
|
|
|
print('Take off and hover 1 m above the ground')
|
|
navigate(x=0, y=0, z=1, frame_id='body', auto_arm=True)
|
|
|
|
# Wait for 5 seconds
|
|
rospy.sleep(5)
|
|
|
|
print('Fly 1 meter above ArUco marker 0')
|
|
navigate(x=0, y=0, z=1, frame_id='aruco_0')
|
|
|
|
# Wait for 5 seconds
|
|
rospy.sleep(5)
|
|
|
|
print('Fly to x=1 y=1 z=1 relative to ArUco markers map')
|
|
navigate(x=1, y=1, z=1, frame_id='aruco_map')
|
|
|
|
# Wait for 5 seconds
|
|
rospy.sleep(5)
|
|
|
|
print('Perform landing')
|
|
land()
|