fix folders
This commit is contained in:
20
EGOTech/fisher/yolol/autopilot/autopilot_advanced.yolol
Normal file
20
EGOTech/fisher/yolol/autopilot/autopilot_advanced.yolol
Normal file
@@ -0,0 +1,20 @@
|
||||
if:AutoPilot<1 and :Nav<1theng=0 f=0 goto1end ap=:AutoPilot
|
||||
r=20 pt=15 yt=15 ep=1.05 ed=5000 et=5000 t=:Turtle :Cruise=0
|
||||
ifg>0then:Avoidance=1else:Avoidance=0end
|
||||
xD=:wx-:ex yD=:wy-:ey zD=:wz-:ez Dt=sqrt(xD^2+yD^2+zD^2)
|
||||
iff<1thenx0=:ex y0=:ey z0=:ez Do=Dt f=1 r=0end
|
||||
da=sqrt((:ex-x0)^2+(:ey-y0)^2+(:ez-z0)^2) d0=d1 d1=Dt v1=d0-d1
|
||||
dx=(Do-da)*ep+ed ifDt>dx or :cas>0thens=1 :cas=0end
|
||||
ifs>0then:FCUForward=0 ifabs v1<15thenf=0 g=0 s=0 goto1endend
|
||||
e=10^6 ds=e*sqrt((:fx-:ex)^2+(:fy-:ey)^2+(:fz-:ez)^2) Dd=ds/Dt
|
||||
xs=:ex+Dd*xD/e ys=:ey+Dd*yD/e zs=:ez+Dd*zD/e vr=xs-:fx vs=ys-:fy
|
||||
vt=zs-:fz vj=:gx-:ex vk=:gy-:ey vl=:gz-:ez va=:fx-:ex vb=:fy-:ey
|
||||
vc=:fz-:ez vx=vk*vc-vb*vl vy=-(vj*vc-va*vl) vz=vj*vb+va*vk
|
||||
pj=vr*vj+vs*vk+vt*vl px=vr*vx+vs*vy+vz*vt a=pj>-r b=px>-r c=pj<-r
|
||||
n="\n" :dd=Do-da+n+Dt+n+v1+"\npj:"+pj+" px:"+px+" r:"+r+" g:"+g d=pj>r
|
||||
ifDt<et then:AutoPilot=0 :FCUForward=0end ifg>0thengoto1end h=pj<r
|
||||
ifa*h*b*(px<r)theng=ap :FCUForward=t*ap :Nav=0 goto1end j=px>r k=px<-r
|
||||
ifc then:FcuRotationalPitch=pt end ifd then:FcuRotationalPitch=-pt end
|
||||
ifj then:FcuRotationalYaw=yt end
|
||||
ifk then:FcuRotationalYaw=-yt end goto1
|
||||
// Original by fixerid
|
||||
@@ -0,0 +1,3 @@
|
||||
n="\n" :target=n+n+"X: "+:wx+n+"Y: "+:wy+n+"Z: "+:wz
|
||||
if:load_ap<1thengoto1end
|
||||
:wx=:nx :wy=:ny :wz=:nz :load_ap=0 goto1
|
||||
13
EGOTech/fisher/yolol/autopilot/isan_3in1_basic.yolol
Normal file
13
EGOTech/fisher/yolol/autopilot/isan_3in1_basic.yolol
Normal file
@@ -0,0 +1,13 @@
|
||||
a="origin_" b=a+"north" c=a+"south" d=a+"east" :kt=b goto2
|
||||
a+="west" e=160000 f=8*e g=f*3/13 h=2*e i=h*13/19 j=f*3/19 k=h*13/3
|
||||
l=1000000 m=l-:ke m*=m n=l-:kf n*=n o=l-:kg o*=o :kt=c
|
||||
p=q r=s t=u
|
||||
v=l-:ke v*=v w=l-:kf w*=w x=l-:kg x*=x :kt=d
|
||||
:ex=(m+v)/f+y/g-z/j :ey=v/h-m/i+(y+z)/k :ez=(y+z-m-v)/e
|
||||
y=l-:ke y*=y q=l-:kf q*=q s=l-:kg s*=s :kt=a
|
||||
:fx=(n+w)/f+p/g-aa/j :fy=w/h-n/i+(p+aa)/k :fz=(p+aa-n-w)/e
|
||||
z=l-:ke z*=z aa=l-:kf aa*=aa u=l-:kg u*=u :kt=b
|
||||
:gx=(o+x)/f+r/g-t/j :gy=x/h-o/i+(r+t)/k :gz=(r+t-o-x)/e goto3
|
||||
|
||||
// based on ISAN v2.5 by Collective
|
||||
// Compass by Firestar99
|
||||
Reference in New Issue
Block a user