Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Scripting: Fix humpty bump

This commit is contained in:
MatthewHampsey 2022-10-24 14:05:56 +11:00 committed by Andrew Tridgell
parent 56c4794700
commit d011c8977f
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_Scripting/examples/Aerobatics/Trajectory/plane_aerobatics.lua
View File

@ -573,7 +573,7 @@ function humpty_bump(t, r, h, arg3, arg4)
pos = makeVector3f(3*r,0, -r -l + (T*t - 3*r*math.pi/2.0 -l))
roll = math.pi
elseif (t < (2*math.pi*r + 2*l)/T) then
pos = makeVector3f(2*r + r*math.cos(T*t/r - 3*math.pi/2 -2*l/r),0, -r + math.sin(T*t/r - 3*math.pi/2 -2*l/r))
pos = makeVector3f(2*r + r*math.cos(T*t/r - 3*math.pi/2 -2*l/r),0, -r + r*math.sin(T*t/r - 3*math.pi/2 -2*l/r))
roll = math.pi
else
pos = makeVector3f(2*r -(T*t - 2*r*math.pi - 2*l), 0, 0)