CopterExpress/clover
1
0
Fork 0
mirror of https://github.com/CopterExpress/clover.git synced 2026-05-26 11:43:25 +00:00
Code Issues Packages Projects Releases Wiki Activity

Add heading towards flight into autotest_flight

Browse Source
This commit is contained in:
Oleg Kalachev
2022-12-29 05:51:57 +03:00
parent 7cbd7e5d3f
commit b0021583c2
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
clover/src/autotest/autotest_flight.py
View File

@@ -2,7 +2,7 @@
import rospy
import math
from math import nan
from math import nan, inf
import signal
import sys
from clover import srv
@@ -92,8 +92,8 @@ set_yaw_rate(yaw_rate=-1)
rospy.sleep(2 * math.pi)
set_position(frame_id='body')
input('Return to start point [enter]')
navigate_wait(x=start.x, y=start.y, z=start.z, yaw=start.yaw, speed=1, frame_id='map')
input('Return to start point heading forward [enter]')
navigate_wait(x=start.x, y=start.y, z=start.z, yaw=inf, speed=1, frame_id='map')
input('Land [enter]')
land()