From 35118546038eda8b2717644a6aa509e58c92ef2c Mon Sep 17 00:00:00 2001 From: StarPilot Build Bot <168790843+firestar5683@users.noreply.github.com> Date: Tue, 18 Aug 2026 23:00:36 +0000 Subject: [PATCH] build --- cereal/libcereal.a | Bin 645532 -> 645556 bytes panda/board/obj/body_h7.bin.signed | Bin 108688 -> 108688 bytes panda/board/obj/body_h7/bootstub.elf | Bin 112692 -> 112692 bytes panda/board/obj/body_h7/main.bin | Bin 108552 -> 108552 bytes panda/board/obj/body_h7/main.elf | Bin 454576 -> 454576 bytes panda/board/obj/bootstub.body_h7.bin | Bin 12644 -> 12644 bytes panda/board/obj/bootstub.panda.bin | Bin 11068 -> 11068 bytes .../obj/bootstub.panda_can_ignition_only.bin | Bin 11068 -> 11068 bytes panda/board/obj/bootstub.panda_h7.bin | Bin 18784 -> 18784 bytes .../bootstub.panda_h7_can_ignition_only.bin | Bin 18784 -> 18784 bytes .../obj/bootstub.panda_h7_hkg_remote.bin | Bin 18784 -> 18784 bytes ....panda_h7_hkg_remote_can_ignition_only.bin | Bin 18784 -> 18784 bytes panda/board/obj/bootstub.panda_h7_remote.bin | Bin 18784 -> 18784 bytes ...stub.panda_h7_remote_can_ignition_only.bin | Bin 18784 -> 18784 bytes panda/board/obj/bootstub.panda_hkg_remote.bin | Bin 11068 -> 11068 bytes ...tub.panda_hkg_remote_can_ignition_only.bin | Bin 11068 -> 11068 bytes panda/board/obj/bootstub.panda_jungle_h7.bin | Bin 13956 -> 13956 bytes panda/board/obj/bootstub.panda_remote.bin | Bin 11068 -> 11068 bytes ...ootstub.panda_remote_can_ignition_only.bin | Bin 11068 -> 11068 bytes panda/board/obj/gitversion.h | 2 +- panda/board/obj/panda.bin.signed | Bin 94756 -> 94756 bytes panda/board/obj/panda/bootstub.elf | Bin 100760 -> 100760 bytes panda/board/obj/panda/main.bin | Bin 94620 -> 94620 bytes panda/board/obj/panda/main.elf | Bin 405972 -> 405972 bytes .../obj/panda_can_ignition_only.bin.signed | Bin 94736 -> 94736 bytes .../obj/panda_can_ignition_only/bootstub.elf | Bin 100780 -> 100780 bytes .../obj/panda_can_ignition_only/main.bin | Bin 94600 -> 94600 bytes .../obj/panda_can_ignition_only/main.elf | Bin 405804 -> 405804 bytes panda/board/obj/panda_h7.bin.signed | Bin 116644 -> 116644 bytes panda/board/obj/panda_h7/bootstub.elf | Bin 152728 -> 152728 bytes panda/board/obj/panda_h7/main.bin | Bin 116508 -> 116508 bytes panda/board/obj/panda_h7/main.elf | Bin 498040 -> 498040 bytes .../obj/panda_h7_can_ignition_only.bin.signed | Bin 116624 -> 116624 bytes .../panda_h7_can_ignition_only/bootstub.elf | Bin 152748 -> 152748 bytes .../obj/panda_h7_can_ignition_only/main.bin | Bin 116488 -> 116488 bytes .../obj/panda_h7_can_ignition_only/main.elf | Bin 497884 -> 497884 bytes .../board/obj/panda_h7_hkg_remote.bin.signed | Bin 116740 -> 116740 bytes .../obj/panda_h7_hkg_remote/bootstub.elf | Bin 152740 -> 152740 bytes panda/board/obj/panda_h7_hkg_remote/main.bin | Bin 116604 -> 116604 bytes panda/board/obj/panda_h7_hkg_remote/main.elf | Bin 498484 -> 498484 bytes ...h7_hkg_remote_can_ignition_only.bin.signed | Bin 116732 -> 116732 bytes .../bootstub.elf | Bin 152760 -> 152760 bytes .../main.bin | Bin 116596 -> 116596 bytes .../main.elf | Bin 498348 -> 498348 bytes panda/board/obj/panda_h7_remote.bin.signed | Bin 116580 -> 116580 bytes panda/board/obj/panda_h7_remote/bootstub.elf | Bin 152736 -> 152736 bytes panda/board/obj/panda_h7_remote/main.bin | Bin 116444 -> 116444 bytes panda/board/obj/panda_h7_remote/main.elf | Bin 497980 -> 497980 bytes ...nda_h7_remote_can_ignition_only.bin.signed | Bin 116560 -> 116560 bytes .../bootstub.elf | Bin 152756 -> 152756 bytes .../main.bin | Bin 116424 -> 116424 bytes .../main.elf | Bin 497824 -> 497824 bytes panda/board/obj/panda_hkg_remote.bin.signed | Bin 94848 -> 94848 bytes panda/board/obj/panda_hkg_remote/bootstub.elf | Bin 100772 -> 100772 bytes panda/board/obj/panda_hkg_remote/main.bin | Bin 94712 -> 94712 bytes panda/board/obj/panda_hkg_remote/main.elf | Bin 406392 -> 406392 bytes ...da_hkg_remote_can_ignition_only.bin.signed | Bin 94840 -> 94840 bytes .../bootstub.elf | Bin 100792 -> 100792 bytes .../main.bin | Bin 94704 -> 94704 bytes .../main.elf | Bin 406252 -> 406252 bytes panda/board/obj/panda_jungle_h7.bin.signed | Bin 110584 -> 110584 bytes panda/board/obj/panda_jungle_h7/bootstub.elf | Bin 123936 -> 123936 bytes panda/board/obj/panda_jungle_h7/main.bin | Bin 110448 -> 110448 bytes panda/board/obj/panda_jungle_h7/main.elf | Bin 462600 -> 462600 bytes panda/board/obj/panda_remote.bin.signed | Bin 94716 -> 94716 bytes panda/board/obj/panda_remote/bootstub.elf | Bin 100768 -> 100768 bytes panda/board/obj/panda_remote/main.bin | Bin 94580 -> 94580 bytes panda/board/obj/panda_remote/main.elf | Bin 406076 -> 406076 bytes .../panda_remote_can_ignition_only.bin.signed | Bin 94696 -> 94696 bytes .../bootstub.elf | Bin 100788 -> 100788 bytes .../panda_remote_can_ignition_only/main.bin | Bin 94560 -> 94560 bytes .../panda_remote_can_ignition_only/main.elf | Bin 405908 -> 405908 bytes panda/board/obj/version | 2 +- selfdrive/locationd/models/generated/car.cpp | 684 +++--- selfdrive/locationd/models/generated/car.h | 42 +- selfdrive/locationd/models/generated/pose.cpp | 1938 ++++++++--------- selfdrive/locationd/models/generated/pose.h | 26 +- 77 files changed, 1347 insertions(+), 1347 deletions(-) diff --git a/cereal/libcereal.a b/cereal/libcereal.a index a320768b4c454042a73b42cc63e790ff129ced94..bb8ee498af56bb27650404ff542c6a70214a6906 100644 GIT binary patch delta 8618 zcmc&&c~q6xwLjl*J}xQ-f&&+oL1M%>L86Tq2heIjqXDZ4XpG>HVxo9)1SdeE0pkE7 zY;e3J+CWqUG&wlcOKMx_3l?o-MKeg%tAfX|`vV6y2QRb0oP#-dy!( z!)VkU%OJ&h#JcGBzD1?KvmJ@gPE0C#za>bCIP&|Jg*%noV(2pEH$A+6nYLuf)OibS zW65ubGFn6zD%VtX-9Q=?rUcQZiTKljlunekT^U3_Bx#*!lkU}t1}xG$QFgG_Nts?$ zv&Ns|?&ly{^eBR>Jc_~Zh&85$0dv~K` zFV#W;#Y(ubVIX7LAUeBVA0fx`7sbWOGYa<_#MtYisYDs87-@L+9!$4=kj}-$-d##a z=_TfsD*ZLXXE0+^2Ggid0NKZQNhnx+wNr^wxGR#eY|&@8@=O=Lb|_=N6*Fs;jtXzY z^W$P+t#X9(Zc&WgB0L9+pVuirC`KC$BZtd)BWMTcwE4Jl!iX8pm@!IBKB0{9F(!>< zOdUmgrfWeI?(5ZsvQH?z#n%nW2E|x6nz8qzDX3Wq6a{}!0yI84nz0ITs7dLs@Pl~n zAwD~+Jg4x_@N5;mnw1`$Ux;C>D~{ybx~V$w}zti?!(W2`!kf>Mx@d(k%DRQ&1scgj_M6i}6Dx~t6L zM)d^7X1z$0Gxb0b|3InsGOAu+EN2q!S)q*(V>I=1#aKUyvGJ2BO)kBC9%dJ^Q12w> zayk0cdL1rM%d#T?mJmp2k{v?{b)d!*6HifZ3 z(bQk<@5O_rG8QBL=V>*U8{?)icK9U<3PJKW`>W50zYJ3=4dcj5jBS3|OyuA#6&rDY z+Ex5zv|6w6!j~BvEq0Gp!!)0oB#;^vwza^soUg;&(s3b$d57%}oy^@z^L&SPx5xI0_*_vOEw&)7!c zvqU|i@-443Hd8b$Q@=6z>;;VV6{l9KVTRE^jj^;eI$MJJ%Nmy~SG&=mT(#C%3?$U% zu9MK;R972D9~(AEI&HC|I`KD6t~k3O1NWK6hZ~z4qY(ME=9@ z7q)j*M}RRWld;B38qU3f#MG1O0LA$88pcA_Qq?5vrG2N=qY4j$<61HEwAw@E*?7J! z*3_%d`ExCYv0sQ&e^$T2JD(~w% zz`w|Mk3iKnZ@kA3ak1}9^#_Gt17Wz>?^Lhqe8by}MTpI})T0xTX4w6W^&^^%=35vAYH4Y`0OH6SKYYy=qg9G62)Iy6Y#F-d8`i7)e_h zd!oQyZ82BXhUh#Tj(5avLz|%+f5)?>RQ#iZ_K{(Hy^XO$MdmiR=BK@)88tyaxvNQI^ezW1}BeWr1`J(-dJugNkXk&F_;;$Gx{~lFcPy>a1nr7F0I=si& zDtu)dc!y%RS9dWtNgJZ@92n1v-P5&>ig5wYTBWF(p*^k}g%ynbSkYd{S(55i$yku+ zm7-1b<-HFw_L*3it`+G=SIm>0?>Om+LyH{ur6kb-v z*aNXUQ~QOl&yTf?<<*%qtNB3wi z^zaFHFm|KCbQ^BEg&fx`k8$-3W7oyNM(uv{wzod6u!nKhh`==_aA`{q=io ztzu07BV)fgPitSsNs)a|i{{3}X7r`=vcU(7>;I!&wiv%XkA8H4wxq%9nxQY~Y=m9F zIo)D*+@)Rhlbv|S7I=xFz4ZeY8jap&P>wLZ>GcY zq*(K!{=kceUuP^qta({~PUn^{8GBKjnxSio@e4e^=4`LQEBXR&Bh|^+fUoK7Mr@Ot zcd?|~UejMP_@J*D`&8Uopzl=p7(5>mo741X6ra!W-1!@GZriAJy?6JLE;vl$n{oBf zYu*=TOQ4e^)o8}6wnUX@1 z%eNVe{hQf>(e8ujsrC9}qA*AQLNQ+W8+Og#+-J7fo~ut)_!(Gy>DHV2W!}Zb*h0~? zUiVjxbUfd4(d`9#P)Vw6l$pAZ=#!`8jd~x@_b#eRvOFW^=j*c+{@<|77EK%B$mg~( z<|nRi(pTxmwr?4G?2eg8Gt{)Wa6oumquN{-oCdUnc#BLQH1T#*Qkc?UB)KgrAzC*gXo1ldYJfXmmZ_=c$iDX zz&(1dVwB=p{a$>ySHGlk{d;*aDt<@rKT{b-^*`!;l~lU%qdr)16e_p98 zF2vv1;ubzj$tK(?2P*|MUy4{NlOmNGrLfU`1(Z5UQlXVnz6!0GZa`DneG1h0t4cIw zYOp3#iv~_IdFu%6qy!ztVN@eEgpnG;a8O*7k6WOUNar|=;S_1W7)vQqR8XN5byP3K zMQSrZaZ!SoThw^LFNE$(Q9&^lx5$^mLFc4!lGWQSQl!YEN^kfzkaq`&3Yy;m#&D{U zqK@uMV=^Umgcd;M9ic_wM*%b!#Yu663On&xs^t)U+ldcSEmhRphmV(We1KL^jT8ZN zUy5jo>Fge=yfgA{pmUvJtS0MY5Q&r`MFv$q21+7%`?@C@dgp z&6Mv44eRCyW(HXwhp~ZD9*41->ZMjn-u}=^X}&)+C)G$TgZ#QcOQj?!98@kv2;Jxc z%t>)wAyTPQ3MA3Z?J&QaT*)}v(TxwnBpRV2%zX*wQBrq^SUT1nVG>CRfEG;Ypq zwMe6bynDJuR8L?5l+zPfHnmDoM=`x%45$2F(BkO^gzC#_LJ-EaQDG3kI%<(3oI-;k z8fd;0c~lb&4=4GBKyy-(6d6<=BK_k?4aE+|0)@(jo<<*qq6`t#7K%I&r#Cz!D5p1E z5~)#Y_o!bOv|*Gkg_Dkj!DuJz6MO}-DtrQ31GPN?%uZ2#+#;tBj8~|&4`L#XC!u9f z`je=eFVXQQF+TQ5UpE-n7asShurD~V)F!ofiVBCYQBF9FsnjY(DaG`|y7?Za#r=@5 zi^}`SWvHdE`?;qR_Y_=QR0yG31YLRx);x;p4=XlYe?)LmE40Au-)Oj4;52vtWh{Rk zV+!NUa)!nXKxG>!e}FrQa|7UXks=2|s}q?6`C}uksi#e^a6eNj3hr}wOr`SI`SVtn z!!%bs0=r0g1MskqOgQ{;Q$F+_Mk#M#EOdZ3cz3y`Qj4Xi1^hI`{RJp=Hl;5FmQDE! zkxl`flUf1YkXkH7ra_CPxHM>~R46sk!3GTM~{G6}bC zi&2SWlw5xD{vX`B7;|@0%o4XKUxHY}I-6vBpl7UM6uA^Eyb4R*Q>nLHFT%lkS4)5s+yQpRvVkMH_augkXdO2c+4>ZZiy*$a`l(GV`Vh5Y>l}F%Ms+Vv@ zM7wv8r*{Q~W&o~>Z1;WyuA>~l*m#Ym@XN&V&AI=UyJYEkz|e;BPz4;TrgkF_VXOaOhP^k?Gi)`b20-$tx#QZ^yQY>M23 zkansxMd)TkzVZ*#)e-6Giu!JbYcu(6!9D(5ih;v>VGbnN^vSIHXvd2{$|fo#xZ!u(y~lZaV_&?3 zp#mu8U5p<<`R`&xygvJ&WmDWfXgKHhAt{{m`@jsRsQtjgDQ7>hc)BmOc#8QInvyR! z?<%FSo`c{Pc>Y%?s*NJwLnIr;y@#z@*R`D;=gG!+fH6X71;`k$0_28}cJc&Ias$-> z#%A%Wbnls%N|egk*Cg8~dXk-Vt`f1F5hfh+!lQ89`-p{K0q2E~>K+VdF=g}l)E4r7jqlztfGdnqQ_lHf_cM@luwxT960dc!DFYEEjYhO3jjYp`f` z%Bg|TPOUY3E7mT(*1d$sYJoLSMaNFapCz>vcvAlUtfdJj z-Fu||Bv2e|Cy|uvs2QtZre`di>!+l%pxRT?Sm$+i4_{P2LVZIM8yYot*4R#!rbU4!oXtmmFX>P@@CB z@zk##1I1HPJ<4;D&ea3ENH^+%)rq)|cvc6<#*g`n2T%uVhH+YDU(=-wV?0(hG}CyN zF0RBsTNY#*1GL!nI_Mg3V-#9v(rS1)s7#7jYJt$MJd7W) z2Jr(ZX$`QcR0g41HqfOt#wbe6lG&`q0QiT)S^yy%XorlLN-a delta 8033 zcmc&&dsLOh+Mo9_uaKe}MFUI%ErmjZ%%zqVYDY0I!BGp!3)@Sn32wZCH$W`GOKv25 zKtVTF3P&MOb3ntOE0oo?+W}33%8pu{17$AA?0mm@Up?R2{&iZb*4b-qe)HU)nR(`! zVIMg>pz!d3iYJYtkay97PGWZt|a z##rjSMT-`%WNgX2xu6)EYfpN5-V*Acr`&6#3}o!*fnsK!vR*MdKujM*L7Eyw(>eZJ z+NJcQp`^4K34<8BI!Fx4S5|5K-yj|qWxJHk3jZn+j>X6#Ww4*&7{ZtsLS64cdM-yN zKXM*}eNCnECO;05P9v+7+r>+VlovSn8qV040*u}&{~F_a#EfH#ruYoLpRx9ljP*pK zfpqE??_0%&NwjJ-6T*7etd#D?#c zJG}Uq@r>;iWtWw~im?x4*CX^`l@he$X{6@*R_!YKUs3vUzV{KvV#TDZ%KM$TYa(My zMITMYVyv9R*f24Yt4}I?#AL<_M3JF(R*WKyJ0^?rPU^iXpYkYUZ;SKZ>eUcq_Foz6 zGL_0FVbxz7rVbWE!__9kuuWxb@H9$7t%&;utC+&jX^a(%qG9S)gTMS3V`-x3A+?8Y zWIoPVWE`EFpazLg$Edo-hs4PZIXhOps`J6|j8%!V6Vx*Xf7i~~NKx}w^^DHnoXyxc zQS`XFTICbwFjg=6JfUt@`ALi)5M|TV7ZqbR3U2T`I&nn{qLbfYg|^RBSLl4mJjR|A zK6BI_HY0ukV`~;t*U4UkMf_5AqiUotWbDyJRuzqCh2`n3s*kv5g<5PFQx`E7ko5oS z>E5LF5z2EWxI_pNA?dR65{GAcn7ZB?J)+;<6M z8-!1;+E3+K7%vh-^3+VuS1n^~p{UuZUR8L~a>lr*DOA7Kj7}?1aVu!|CLD`J*(i&z zT?aamRL}VHX{n4I7n5F7Cn)@#wTyKaMK$UtiqUf&V~%xn zE=d_74!y3PQ}_~annhln`alok=XA#Yl0pCU!B)nEdizmpveHHPeWo5%jIS~o`y`uo zPtyWL^XFF*++S?HEKLV(W$Yi~>=n6@n=u|I5ej8qX|YtWBJqB@H_;wjHGM%UIW`b}ih-{SGqrk$5&)%hkDG z8Dp=AJ}b0b#W;-d#&X%GM~EL+Y9|z9b2(!_9I|XbP1WwR@wP*Ztr9+)v^j>c{s?2s ztE^V=f>ZPB%GXuN{Vdz9J=2>9)-rZR^f{*W>t^tolou_@kSfl9Es^I{h{*bXp zM9mesMH4?_>{YS0U3-%Ak#3wZiN#YmHKA zQeXXm7jHbxSh~1&m)=h?Hk@Is?u^y*9}d?)hM^Wqo3U~H_o^IjcCd*WGK zC1TQj`Yw(4ImcL$_+hC2fNB(DeC3?Lr7>IMv%h34Smce=59mI9o00C<*8Ovdl=DUp zkuX}1>&&lw#aOhcnWW z0cX^=X1}8JEEI#h0I1h={SE$?ZyAddXQ%6%z4;Rt7z+}KPwBaa5qycU4=>5<$}HC) zF*;G7sTlWxz2_30GbG!AxL+mdSGXHoCeAL_(E`-(7&|F`aOh|`4`KYC7`a5(G~+{z z&wp>;WmXejzg$138UOg6F?%abzN!R@^i;jE6aV0!jNLD0WaxLR{K0==lf~9deW_v` z#aL}M%ZFUaxWyu}bRR0pz^fznS$&&fv@$lUmGFibK|3?_ZX)tI{auC60sE4;wo&F& zi17t6DO*SNevk3gHcEO5Gf7CrnncY}JBxms_0JUkSQ}%SxVA-Kt@8~(GNy>NIr>kk z!GFT+f6D!>El@aL&|@^C7>sXB#?gG;p%~wS_PtCqdw2zsvp}EEdt8<)bFDx>u5$Hf z#-h;2^-P72#yE?>zn#7))cc8zyY*3uu?gJEKZ_6d=%-bF1%ykK?bYv|p#)RYzx4r1 zOrFB;Q5y3i@i#cn&c`XPyi)v)$ZO-Xl=&1Z#VM2_A%ZF;#88WbIPz7Y;-X{~R5}$) zs)`hi-=kh=r+YO%QwgOU4cusI0~ZjY!?l|h=wJp@gQVbwTW&a18mX9r8ATT*(?;VB zFe4~cf|E)mxTr}&EqQl>N+T_>prI4&yvWxJ;G}p9iY1iLMG0<-^fnYLMU}-_Br0Q*viejH)H&PXS#(HIiLIJ(YIhv((mubc+ukq_&pP{XTrG z^y34mlNuy2^6d%;rTDI9sOqlByMiuCWHAyO+LVAEor;Hw;+|(ec1Pb#56+_7q zN~l_b7b!g{4An_M61_}=j9zjlqv=pDJ_wU&0SPz0w?gQkWC;;;>Q=akq5ywT zp_J+ms*&m>=6_g>tK@GRV!cAeppxl%!A%UucrF}F7hMraMP)NU}jO|9egFSD!l_#1$o~ISr)}wP;e)h_0(}E zd?Jnhpb{v%Kh~{%2YuWh@lhuOOrd=M44bKR0CXbAI~3F~ij@#Y1)*TZP=|zciVwrS zwU^VTFeKba)nRfQDoMS|oR0l2m^4x;Ky5urKT58HV($hQ1$Q?*G*X8}jSAN9*+ zfa`5^FMLY6Tc{|Ed0~hRf*3Q4UBq7p_$Km|0rPS9$xm|+3vVdTr{Y9DE+7Thq5LHH zS$IR7LP`?E5xCdnr}-vv1lgrH<{L|#(9^;j);I;lxy)R)@yozO880)lXOy>p{!3HO$i#7tFC|`PjhLGE45b>n3>_ z1wO}T1~`vgx4%j5q@3pv%t>v}nG^QjhzYZr>&ka~I%AXpF-o;%qgk=OS(sGCTb6Qr zxTiAuK^9I?#XFW*{@fxzH;SQxlx+CQCwn#m=Tj=EfT)w#l?Qn$M^T$pPN3LLSmFd~ zkPt17h5JExAxG zp$ z%h?HoD2m*Lr4D_ROdz#{*bZH;fFs{2L_aE;mk0bkjxOP$9eq@Zt zH>dzx;C1CkJe83^36v|SvINQ%)F3Gbg_W8$6JLs~@GdHa%uN?d;m93fISQWW=?G8K zzrhsm;=f@EI4cMEO8F*Re}Ipb_}&3rt>_R3`F>e<2W1PLYPoVu_H>1(+p02@wLjIB zA+SF+m6>Z4Qf|V6awLU1D>r2w<%o)w^9mA77+ z2VzXCtpcWQ3aNx?78O*2i5Gk&--eCIK4k94sYBSxij|h5`YE1{D#(7=w5dCcs9Drx zQNxeGZ5Ay!0=Mn%7>1CE9uO~en;n{T@{j0s)5@+2c#*=r+ zaXvPn@s;c5(>=`_>C|!gl&_?FUz7i{RnqL&umn+uEp^)rPjy^MuOU%%s2Ze=Tf0UY zAEozdr14Sur3NMFpyU&fIw<=Dbm!B>6PO0h?CY3RBjvnqT9&?!!kPc36(%^rGt7Jn zspa3Tmk}7k5-0A`heFIxJvqgQXlg+f%uglsBO4 z681NE+AYAAll;*GNHj9VcwN14k$y}u#%c*cdhV>HeJHB8qSN$L!%uC0j+Uev52Ddm zrWz07V6;ilDRLDcj*=y0Q6+#J&?kMh5su3*ay9s9mH>)a1^!#$Q^ab+i`rKk!^p83 zyoc9-*SZS4lr_dMw8Y9au!^8I3H5mKN#iwAycXgSR0)RCDt!+i|8<5xR3q0xr`6P1 z2e++jpGcjQ|II~#exWs>q1}sWm^p9KDS(1-QJ4>BP>TE;V zaJcdH=XG2i&lQyc9l*$DF^w6YbDsV|m|0`DTlob(OZ*Bf`UwU+-x4JZ!dAkdXlJ#l zMPN;ESt~bE9f;Sm*q#)RrxlmWu0gvboYYvR?;{L5M7|Yx(MfL*c48lqKlj!b%)Jy3 HgiHa8^A$wP delta 153 zcmV;K0A~M?(FTyw2Cz`$2sk%lIc8)vVzXG|xWs>*7(tx0{B}u^iRbEd zHZ!4{S7q3LIoFjhaI(JndtqsitQfu}v5{jqGx{WjP6Q!Gp#Z0DB%ZmAuzs$%KSVdg zMG`qKE#4@7NFehw<6}ru#TVM-XxqH@paik%ma8svu-V=ErVkpxu|Vauj`-Xj@tF~bnShuXh*`Erd}fXK0|2HY6PEx0 delta 43 tcmdmRUwQ)&1$^ePFi)~fOEFDqj`-Xj@tF~bnShuXh*`Erd}fXK0|2-)6gB_= diff --git a/panda/board/obj/bootstub.body_h7.bin b/panda/board/obj/bootstub.body_h7.bin index 42532a42923ae9fe0ff89363f8bfa40f74453850..0f0238c48b938606f9bee10715eb8377068b9ff9 100755 GIT binary patch delta 21 ccmaEo^dxD6s}6^Osj;zPqPfLpUmbB)09#xJ$^ZZW delta 21 ccmaEo^dxD6s}6^Sd6H#XifPhjUmbB)0ATp(pJ3|A*Zo9oo}u>b(U>k7L7 delta 34 qcmdlJwkK?ZubQBRd6H#XifNLri>p(pJ3|A*Zo9oo}u>b(iq6=C8 diff --git a/panda/board/obj/bootstub.panda_can_ignition_only.bin b/panda/board/obj/bootstub.panda_can_ignition_only.bin index 31ecf6cd89d7c7d2ade057fce2331dbc1e48a1ab..123a77159119f0a51484120e0e0f78f52bb233e0 100755 GIT binary patch delta 34 qcmdlJwkK?ZubQBNsj;zPqPc~xi>p(pJ3|A*Zo9oo}u>b(U>k7L7 delta 34 qcmdlJwkK?ZubQBRd6H#XifNLri>p(pJ3|A*Zo9oo}u>b(iq6=C8 diff --git a/panda/board/obj/bootstub.panda_h7.bin b/panda/board/obj/bootstub.panda_h7.bin index 8a5bda6e5444e5061edfbb192c98ae5deb383a03..44e121d7e87e960d30d0dcfed88e2948aa3ca095 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$90sPw#)gUJ7MmwJpJxRCZn+4O delta 23 fcmaDbiSfZC#tog$92VwDmT4)bNt-7+pJxRCbX^HC diff --git a/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin index 8a5bda6e5444e5061edfbb192c98ae5deb383a03..44e121d7e87e960d30d0dcfed88e2948aa3ca095 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$90sPw#)gUJ7MmwJpJxRCZn+4O delta 23 fcmaDbiSfZC#tog$92VwDmT4)bNt-7+pJxRCbX^HC diff --git a/panda/board/obj/bootstub.panda_h7_hkg_remote.bin b/panda/board/obj/bootstub.panda_h7_hkg_remote.bin index 8a5bda6e5444e5061edfbb192c98ae5deb383a03..44e121d7e87e960d30d0dcfed88e2948aa3ca095 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$90sPw#)gUJ7MmwJpJxRCZn+4O delta 23 fcmaDbiSfZC#tog$92VwDmT4)bNt-7+pJxRCbX^HC diff --git a/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin index 8a5bda6e5444e5061edfbb192c98ae5deb383a03..44e121d7e87e960d30d0dcfed88e2948aa3ca095 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$90sPw#)gUJ7MmwJpJxRCZn+4O delta 23 fcmaDbiSfZC#tog$92VwDmT4)bNt-7+pJxRCbX^HC diff --git a/panda/board/obj/bootstub.panda_h7_remote.bin b/panda/board/obj/bootstub.panda_h7_remote.bin index 8a5bda6e5444e5061edfbb192c98ae5deb383a03..44e121d7e87e960d30d0dcfed88e2948aa3ca095 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$90sPw#)gUJ7MmwJpJxRCZn+4O delta 23 fcmaDbiSfZC#tog$92VwDmT4)bNt-7+pJxRCbX^HC diff --git a/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin index 8a5bda6e5444e5061edfbb192c98ae5deb383a03..44e121d7e87e960d30d0dcfed88e2948aa3ca095 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$90sPw#)gUJ7MmwJpJxRCZn+4O delta 23 fcmaDbiSfZC#tog$92VwDmT4)bNt-7+pJxRCbX^HC diff --git a/panda/board/obj/bootstub.panda_hkg_remote.bin b/panda/board/obj/bootstub.panda_hkg_remote.bin index 31ecf6cd89d7c7d2ade057fce2331dbc1e48a1ab..123a77159119f0a51484120e0e0f78f52bb233e0 100755 GIT binary patch delta 34 qcmdlJwkK?ZubQBNsj;zPqPc~xi>p(pJ3|A*Zo9oo}u>b(U>k7L7 delta 34 qcmdlJwkK?ZubQBRd6H#XifNLri>p(pJ3|A*Zo9oo}u>b(iq6=C8 diff --git a/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin index 31ecf6cd89d7c7d2ade057fce2331dbc1e48a1ab..123a77159119f0a51484120e0e0f78f52bb233e0 100755 GIT binary patch delta 34 qcmdlJwkK?ZubQBNsj;zPqPc~xi>p(pJ3|A*Zo9oo}u>b(U>k7L7 delta 34 qcmdlJwkK?ZubQBRd6H#XifNLri>p(pJ3|A*Zo9oo}u>b(iq6=C8 diff --git a/panda/board/obj/bootstub.panda_jungle_h7.bin b/panda/board/obj/bootstub.panda_jungle_h7.bin index f7d9ca13a075ae023989664a7006876cb9894796..71a334a7f0f4782cd946f7abb6c5ead042113d91 100755 GIT binary patch delta 21 ccmZq4ZOPrR*MP&o)Y#ZC(cEJ5QG@-g09f`1zyJUM delta 21 ccmZq4ZOPrR*MP&qJjpUG#WZR2QG@-g0A891UjP6A diff --git a/panda/board/obj/bootstub.panda_remote.bin b/panda/board/obj/bootstub.panda_remote.bin index 31ecf6cd89d7c7d2ade057fce2331dbc1e48a1ab..123a77159119f0a51484120e0e0f78f52bb233e0 100755 GIT binary patch delta 34 qcmdlJwkK?ZubQBNsj;zPqPc~xi>p(pJ3|A*Zo9oo}u>b(U>k7L7 delta 34 qcmdlJwkK?ZubQBRd6H#XifNLri>p(pJ3|A*Zo9oo}u>b(iq6=C8 diff --git a/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin index 31ecf6cd89d7c7d2ade057fce2331dbc1e48a1ab..123a77159119f0a51484120e0e0f78f52bb233e0 100755 GIT binary patch delta 34 qcmdlJwkK?ZubQBNsj;zPqPc~xi>p(pJ3|A*Zo9oo}u>b(U>k7L7 delta 34 qcmdlJwkK?ZubQBRd6H#XifNLri>p(pJ3|A*Zo9oo}u>b(iq6=C8 diff --git a/panda/board/obj/gitversion.h b/panda/board/obj/gitversion.h index 22a332116..7d607d164 100644 --- a/panda/board/obj/gitversion.h +++ b/panda/board/obj/gitversion.h @@ -1,2 +1,2 @@ extern const uint8_t gitversion[19]; -const uint8_t gitversion[19] = "DEV-87b9fd5b-DEBUG"; +const uint8_t gitversion[19] = "DEV-05331a78-DEBUG"; diff --git a/panda/board/obj/panda.bin.signed b/panda/board/obj/panda.bin.signed index bfaed189226e116847b58e3177961a02d9587e75..fa44921f743f2a16574e094493d7ab81377f6d93 100644 GIT binary patch delta 153 zcmV;K0A~NBGcjQ|II}RvbgF-`^7yLayv~Q3tyAY=p2aUtQ-1<4 z$@x~uah>PAxic<1#)gUJ7P>C3PND7$4GfbfnkqEcnQgB#W0VR80R7qw5C8xG delta 40 wcmbO+nQg{owhg{!f)?gUmT4)bNxCksPND7$4GfbfnkqEcnQgB#W0VR801g}suK)l5 diff --git a/panda/board/obj/panda/main.bin b/panda/board/obj/panda/main.bin index b5fe959626a2af9995e7d93deb40b6e5ae69d4ec..352e971cbe9db7c9fb7fddce168862e8c1c67457 100755 GIT binary patch delta 23 fcmbR9n03x$)(slRISfpVjSUmcEjAk*&shZka&-wj delta 23 fcmbR9n03x$)(slRIV{YREYngGcjQ|II|qbbgF-+MzOs@T@rW5mKK83`(W)X_ZV&Y zVc}APir%7FI5&n#<>c#WCf4>OSC3nRzhjw~) zvh$S!1oQw9qP8_C-&2{*r`T13dG{wR7oXER*ko!BMhth|e2b&yO-AIEbWQGg*8Npj HiTVL(G0{ts delta 153 zcmV;K0A~M?|XH-|?5D+D{XKW4GgBsqWSz*P^FfMfB|`is>@lQcw#m_&-R5B%Aq|RcvMt zb!4oIhZ$wqi4l^u!f)L1+L>#mx7paj>eni3xOx55bd8A;fmt0&+E`@9#s~>SXw$z# H5X%9R5sXXk diff --git a/panda/board/obj/panda_can_ignition_only/bootstub.elf b/panda/board/obj/panda_can_ignition_only/bootstub.elf index d85464e9c2ecb3af93f26b6066c5891cd81a1a30..ffdc3fd002f2abdaf0ee0846d517f7a07c58a674 100755 GIT binary patch delta 40 wcmZ28nQhHvwhg{!f(E9>#)gUJ7P>C3PND7$4GfbfnkqEcnQgB#W7G=<00b2bOaK4? delta 40 wcmZ28nQhHvwhg{!f)?gUmT4)bNxCksPND7$4GfbfnkqEcnQgB#W7G=<02D|J>i_@% diff --git a/panda/board/obj/panda_can_ignition_only/main.bin b/panda/board/obj/panda_can_ignition_only/main.bin index bf8b9e9bcc0e5b54398c0a4e44d2f47cfb079645..fe9804259d03489805815cac8cad3d31b7a0d2d3 100755 GIT binary patch delta 23 fcmeBp%-Zpob%V%p4g*tTW5Yyqi_J2}b5;QWZHWl% delta 23 fcmeBp%-Zpob%V%p4h!=n%d`~Jq|GwNb5;QWb1eyr diff --git a/panda/board/obj/panda_can_ignition_only/main.elf b/panda/board/obj/panda_can_ignition_only/main.elf index 6eca0deb0b3ec11dea69b69c2571b12763d0c613..a3caa90539413baffa0e66f4b7d89fddc5b26ae9 100755 GIT binary patch delta 43 ucmZ4UNMg++i47vxISfpVjSUmcEt+Mnx652-1Y#y2W(H!G?K0O{1)>0XcMv@Q delta 43 ucmZ4UNMg++i47vxIV{YREYng0phY;KV diff --git a/panda/board/obj/panda_h7.bin.signed b/panda/board/obj/panda_h7.bin.signed index 217b526e5099538ba0e12f5d63dfef5ed7b47779..892625d06711ab65d89cfeeb2bad3c0fc7c30efb 100644 GIT binary patch delta 153 zcmV;K0A~NBj|ZfW2e4TG2rxA>GcjQ|IJ02?#K(UDMN7fcEk0pGI-UxywpOb>Ahn#t z5POp?S5cgF_uM%u)uWSfgGSbp5qwT3>vA;920cuDxpp*;l2k!jB;!wW1YT2aoXLg} zqK5f&aA@z?Lebc@yL@$Ko8Q8V$K+jU+7?U$&_H+Mv`x-x>cFhJ2`XdC!~M2S)-CRn H=p_NY@3BgS delta 153 zcmV;K0A~NBj|ZfW2e4TG2sk%lIc8)vVzXfX#K(U@cU}>!zzu)4VRl z5wu7{%kh4dBuu~RuAr;JvI`ca{i8ghs(NRA#h(SZ&`FjU+pif-kt|%mMQqEqdaFfPH)&Ft^zKw!u?2QXz{SoeWaWcd^d2DmsM|koyDI_ HwDtj%5Cu&g diff --git a/panda/board/obj/panda_h7/bootstub.elf b/panda/board/obj/panda_h7/bootstub.elf index 8cb28440ca490e7b0807457642850951e3a93a90..a3af4fcb97d52f3829aaca74e14339b99dc37531 100755 GIT binary patch delta 31 ncmbQSl5@sN&JCTx90sPw#)gUJ7R?ib+b0GyZl4&;#Lfr+wsQ(? delta 31 ncmbQSl5@sN&JCTx92VwDmT4)bNzD_3+b0GyZl4&;#Lfr+!4C@z diff --git a/panda/board/obj/panda_h7/main.bin b/panda/board/obj/panda_h7/main.bin index ea4b1a1d6dbed2ab987c5ee7c51a33268abe12e5..587e84bb9d54efba94d8473ed999f5689a72d4c3 100755 GIT binary patch delta 23 fcmbQ!$3CZzeM7{54g*tTW5Yyqi_HoD_Z$ZRZIcPp delta 23 fcmbQ!$3CZzeM7{54h!=n%d`~Jq|FKc_Z$ZRb2kcd diff --git a/panda/board/obj/panda_h7/main.elf b/panda/board/obj/panda_h7/main.elf index fd785e39d1562229d898b9d2010db94533703a9d..21eea0d35df28858db62f83213e31cca98afbb3f 100755 GIT binary patch delta 50 ycmeydN$$rcxrQx_5&RqmrpCsGiRKpV3H*#e%ml>DK+FQftU%1RJ%OKHq6+}0gbt|y delta 50 ycmeydN$$rcxrQx_5&Rq$=1G=mDW*y73H*#e%ml>DK+FQftU%1RJ%OKHq6+}LuMbE7 diff --git a/panda/board/obj/panda_h7_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_can_ignition_only.bin.signed index 7e517da4ae27769497045beaed9694a60598ad9a..277bb3250f8201bf6f8177246239dcca74b7e59a 100644 GIT binary patch delta 153 zcmV;K0A~M?j|Y&C2e3r{2rxA>GcjQ|II~Ru#K(WNBg3-iaP^Xe!R~&VV|ydSUeJsk zH%pvFXi)tq;ZAj0=N`&!c>rk&hmC?g%S*p?tfPd@ zOJV)QSox>nHnWC{A$N0=v~7V_-3NL)M6S4a1JO0Ej1tTFF$LDBaNKkl*@!zx0C?2r z$~3}&J%|6lgeH2fzaDv40XY3Xt4dwLgwgomy;X!9?WBAW(-|2sK|`_c!j0d*s4V<1 H{l@_gX^TuY diff --git a/panda/board/obj/panda_h7_can_ignition_only/bootstub.elf b/panda/board/obj/panda_h7_can_ignition_only/bootstub.elf index b48c52b567f5fdadbe5ee4ae262dc1c3ea0ecd66..217266bed44668866d498bc80cdca918cc4e1870 100755 GIT binary patch delta 31 ncmZ3pl5@>U&JCTx90sPw#)gUJ7R?ib+b0GyZl4&;B+Uo_yEh7{ delta 31 ncmZ3pl5@>U&JCTx92VwDmT4)bNzD_3+b0GyZl4&;B+Uo_#nTH& diff --git a/panda/board/obj/panda_h7_can_ignition_only/main.bin b/panda/board/obj/panda_h7_can_ignition_only/main.bin index ba0c3e573403311113b6b12f26ecc33d2b60d033..ad35b7108ab4d8933b69c0e6a95bc412f6bf3c51 100755 GIT binary patch delta 23 ecmeC^WAEr=-{A6}!@$(o*f7!DVzbZxJ;woPrwM}q delta 23 ecmeC^WAEr=-{A6}!@@ktGA+e4X|vD&J;woVO9~DK+FQftU%1R-G`rjLMH%__zp$@ delta 50 ycmcb!QSQ!0xrQx_F8mx8=1G=mDW*y7KKzV8%ml>DK+FQftU%1R-G`rjLMH&GBM#*N diff --git a/panda/board/obj/panda_h7_hkg_remote.bin.signed b/panda/board/obj/panda_h7_hkg_remote.bin.signed index 728a15363bc79105d2f70822eeb8ec51b439673f..7eebe34a57c319cdf8cbd5a6eda0d03ee163aacf 100644 GIT binary patch delta 153 zcmV;K0A~M$kOzd22e7#R2rxA>GcjQ|IJ3b2#K(W9S2x`_+=<_Oa#31S=mhxfv1G*n zR1HiWQSS&2Ec{e#cHIBF`QbGxZJ9s95gFNgXnL902fHb`IwN3}X5itds5(Q0@dn0B z+OlOo?1RFj(kKVBOp02$cK)8#NCclsSHGw;=`l5>J_-K(7?*Q@gh^Us+i=m0c(I@l H09OH@Kpjdo delta 153 zcmV;K0A~M$kOzd22e7#R2sk%lIc8)vVza>i#K(V=mu_^O)9Dt8_&ZJ5WWE(Iw`A3Y z_XG{!`oOXeF+Vi@F6UF^NSr(ju&c7SQKTSW0tx)&PagS39yj05(~(Dkx}4`0-Sy2L z&eHr^Qz9s*$b~ojp3du|i6f6$Z0(YWHJep~)Y3t)psM1Oa5RtSh5-X*{ABgSH9kvV H_gVoKf8tKB diff --git a/panda/board/obj/panda_h7_hkg_remote/bootstub.elf b/panda/board/obj/panda_h7_hkg_remote/bootstub.elf index e2b55314199e5d3312b17640ef11d94731f7159f..29d0eb6d9e4c8e7677a011fecbd15339130ee620 100755 GIT binary patch delta 31 ncmZ3ol5@#Q&JCTx90sPw#)gUJ7R?ib+b0GyZl4&;B+Li^xlam_ delta 31 ncmZ3ol5@#Q&JCTx92VwDmT4)bNzD_3+b0GyZl4&;B+Li^!|Mw$ diff --git a/panda/board/obj/panda_h7_hkg_remote/main.bin b/panda/board/obj/panda_h7_hkg_remote/main.bin index d337035a700832ed0066c6121d27c3bbc62ede7c..7bca68276341a54c3a405b1ce6309dec2f1ef315 100755 GIT binary patch delta 23 fcmey<$Nr~}eZ!9b90sPw#)gUJ7MlWCJxrQx_JNP*aOpT2V6U{B!5AZVrF%u9o12GE_vjQ>O_5=LvCEWna^$~^u delta 50 ycmdn8O>WCJxrQx_JNP*)%#$qBQcRQD5AZVrF%u9o12GE_vjQ>O_5=LvCEWnwAQB}2 diff --git a/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed index 08ecf759ce6cf2ef2ddfa74396cac829264efa9c..4b2f56fd7faf776cb7d608e778539ebc3cca5334 100644 GIT binary patch delta 153 zcmV;K0A~OEj|cpZ2e7dJ2rxA>GcjQ|IJ3C_#K(WV)O1~19Gp(N+T=Nd*R8&1dxjNj zeF5|gTea4y86tQR?v&R07yU(%GhzAe5UKiZ8F)%+3}xgq?V_Y$BRe=8LLYB~L=|M; z2vqosC*uqE9Oz;KLOs$YS}s((vj delta 153 zcmV;K0A~OEj|cpZ2e7dJ2sk%lIc8)vVzapa#K(V7*-0fT*`zGmlP~MDL$d!k`L*DF zo1)8O_A@5V2R4^#qP`&H%Y=)EBYA^s2Kk(zeY`?9hFN=x8{B2yy5ez4-!!pdtTp9g z>Gko7muS}g=WSC(OOtQzKNDB^#UuRuP_g^KICJ(OyFI<$ou<=qy1-QMr(s@hHw|mE HEZzb5xB*jb diff --git a/panda/board/obj/panda_h7_hkg_remote_can_ignition_only/bootstub.elf b/panda/board/obj/panda_h7_hkg_remote_can_ignition_only/bootstub.elf index 48e270a9032fdf04eba2273e53adeab7dcd244d0..e9ede69cf4863e9978f6d5fc0072663644b0ffc8 100755 GIT binary patch delta 31 ncmdn7l5@vO&JCTx90sPw#)gUJ7R?ib+b0GyZl4&;q|OKcz7q<~ delta 31 ncmdn7l5@vO&JCTx92VwDmT4)bNzD_3+b0GyZl4&;q|OKc$gc}* diff --git a/panda/board/obj/panda_h7_hkg_remote_can_ignition_only/main.bin b/panda/board/obj/panda_h7_hkg_remote_can_ignition_only/main.bin index d47f17cbd3ec126f91e3a8c08db76ef4c4f59e16..906613ab1986fe600d67ebbd2b8797945a756cd1 100755 GIT binary patch delta 23 fcmey;$Nr^{eZz+T90sPw#)gUJ7Mpkc-*X%QgF6c| delta 23 fcmey;$Nr^{eZz+T92VwDmT4)bNt<{4-*X%Qh~Ep+ diff --git a/panda/board/obj/panda_h7_hkg_remote_can_ignition_only/main.elf b/panda/board/obj/panda_h7_hkg_remote_can_ignition_only/main.elf index fa6f777ccc21924076748239d095006d7ba9470b..d0f07b439a25c9b2bf9d9ece25c1d004bb2a4ad3 100755 GIT binary patch delta 50 ycmZ3pRc_5zxrQx_8~8a4OpT2V6U{B!cknX;F%u9o12GE_vjQ>O_8t7}U%CLqjS;f| delta 50 ycmZ3pRc_5zxrQx_8~8aa%#$qBQcRQDcknX;F%u9o12GE_vjQ>O_8t7}U%CLjtAt92e26b2rxA>GcjQ|II|%C#K(U+p~Q4ZeBE-^+qbTAt;hywOUCn2 zBfkNM@FUWgzhbv>9UAs?ks%N~`)Hk>%EH3^yB5u|@S)y$NP9`Fx2fYOLc8y5u3h!| zHh@1@EF1QLZVHZ)xFMskcat_}KoVP@#Bc$T^!8Zs(Y9NATCO9qoI;TM3FDJUBX43< HyyXGqVb@Nl delta 153 zcmV;K0A~N>jtAt92e26b2sk%lIc8)vVzVIs#K(WT)hZ$AtnC$JOSIdgOxx3!8C^7J zOHX8SF0Dj#$DL;FY}UR&k_osmtTCADqmrQc(1cl#f=vtcSn2(y?SqyG5=OQ zlYYAaVkz&o4TlKZ6H^47lt*GiH#nY}G!K|Cq$u70?+zT}1i<`NT9Slr*0)<-lGelO HW_baHLf1)e diff --git a/panda/board/obj/panda_h7_remote/bootstub.elf b/panda/board/obj/panda_h7_remote/bootstub.elf index c2275ab00ae291eaae693f41a743348321aff1a0..63e3dadfa9fefd5e6ccb74cf1f705cc6c7262209 100755 GIT binary patch delta 31 ncmZ3ml5@dI&JCTx90sPw#)gUJ7R?ib+b0GyZl4&;#Lox-xLXQ^ delta 31 ncmZ3ml5@dI&JCTx92VwDmT4)bNzD_3+b0GyZl4&;#Lox-!uJa# diff --git a/panda/board/obj/panda_h7_remote/main.bin b/panda/board/obj/panda_h7_remote/main.bin index ece5058802d9a86014b5578b78853395f876d8db..64b45f237257c40313bbd699c0198c9a26d5f79d 100755 GIT binary patch delta 23 fcmcc9%YLVqeS^e*4g*tTW5Yyqi_HrE_Z$ZRb1DhZ delta 23 fcmcc9%YLVqeS^e*4h!=n%d`~Jq|FNd_Z$ZRc+LuN diff --git a/panda/board/obj/panda_h7_remote/main.elf b/panda/board/obj/panda_h7_remote/main.elf index f0dd24f716c573bc8b72f39f6ac1a442be766c5f..5b43e2446148a0d0f03d2e34dce5b010cdad36c1 100755 GIT binary patch delta 50 ycmdn9Np8<3xrQx_68sznrpCsGiRKpV3jB;f%ml>DK+FQftU%1RU4frnrV9XQ&DK+FQftU%1RU4frnrV9Xl`wY|o diff --git a/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed index 6a83bbdad18adfba79d9fc6e9be91ce401a6b2df..865cbd54b566d447109830438085a22eb58ebf13 100644 GIT binary patch delta 153 zcmV;K0A~Ntjt9_=2e1VH2rxA>GcjQ|II|4@#K(WIl`P8E%#G2}nw~2L09clZ0EJ)^_X`?x_4gorSp~VMiBoIxy2D!Za}|7EzH`_r%**>mj*Hj z%nM3%%L}mdZ6ZLqmP*GE*NUO#7Trnna3Ph(!}&Zs=#w2&VdJ0!=f#YB1yB~~AU!le HUOoXE22DsS delta 153 zcmV;K0A~Ntjt9_=2e1VH2sk%lIc8)vVzUhY#K(UP#1$-0zI)z6iX3PGFYLm>@y=#R zC;UWrFSh_OG*{r_NZ5QD8cd-rMsf#cce358l+CijyO)D7i?K2TJfu(cCz1_K5rlKeyfE0CZD3g1!oqYUJdX@dBE=>A86d}mnZ4DYJDQbvGyq{;IgU58h3jJ%& He5nENvByS0 diff --git a/panda/board/obj/panda_h7_remote_can_ignition_only/bootstub.elf b/panda/board/obj/panda_h7_remote_can_ignition_only/bootstub.elf index 477df37fd95f7f22b25f1f1dd97dbf399c6ebfb1..d4384ad755d24cd640b5a936f17a24ff80d7fa88 100755 GIT binary patch delta 31 ncmdn8l5@*S&JCTx90sPw#)gUJ7R?ib+b0GyZl4&;q|68ay&np} delta 31 ncmdn8l5@*S&JCTx92VwDmT4)bNzD_3+b0GyZl4&;q|68a$GZz) diff --git a/panda/board/obj/panda_h7_remote_can_ignition_only/main.bin b/panda/board/obj/panda_h7_remote_can_ignition_only/main.bin index 57b6d856376186142c5b65820e7fec270b0eeea3..020e5a8ab82ee3fda13a818ffaa2b57079960e9b 100755 GIT binary patch delta 23 fcmX@n%YLGleFMvX4g*tTW5Yyqi_JX$_Z$ZRZaxWt delta 23 fcmX@n%YLGleFMvX4h!=n%d`~Jq|H44_Z$ZRbK(jh diff --git a/panda/board/obj/panda_h7_remote_can_ignition_only/main.elf b/panda/board/obj/panda_h7_remote_can_ignition_only/main.elf index 0d6c4b85e7a83109b4af93a5461079abcf1cd060..989ea1df37e0d386526284eb85d92520048f2985 100755 GIT binary patch delta 50 ycmZ3mQEtITxrQx_Ec_e>rpCsGiRKpVJp7D6%ml>DK+FQftU%1Rorj-&N+$qPL<`aY delta 50 ycmZ3mQEtITxrQx_Ec_f6=1G=mDW*y7Jp7D6%ml>DK+FQftU%1Rorj-&N+$qkZwzq& diff --git a/panda/board/obj/panda_hkg_remote.bin.signed b/panda/board/obj/panda_hkg_remote.bin.signed index b789ae2e40ceeb20445efa3b07fd0917817795d7..94b7cdbd8bd86614c74531c4b954316fd0792e26 100644 GIT binary patch delta 153 zcmV;K0A~MyGcjQ|IJ1n$bgF;3-~|^LFz8-SfTNE`{vgvNb&phx zb6ErLQ?Uw1@tCguf}Gq5x)d4pt9-st!iOQ#Y*9S35F*Gc(unCw2Dgq?`p{?$toq*E zN!H*>Vc4!s3BT(uAJpJ)CW^c$Zc~w`-^nVlU)uZz;R_10N90Vw2A|;o=18x^YABhX H&h-IG{9Q}R delta 153 zcmV;K0A~My9{lo!qxa)3?&tbl zy{vR^5!>DnP4Wo82sipHPdru`kWX7yhxa3l8aRTz_#)gUJ7P>C3PND7$4GfbfnkqEcnQgB#V^j+U00Es0Gynhq delta 40 wcmZ27nQh5rwhg{!f)?gUmT4)bNxCksPND7$4GfbfnkqEcnQgB#V^j+U01?m((*OVf diff --git a/panda/board/obj/panda_hkg_remote/main.bin b/panda/board/obj/panda_hkg_remote/main.bin index 6d54266466bb8ab94cbd124ddf2a834fe9317e97..51b60de7c4b45c819fad57b1882820c2364eaa7e 100755 GIT binary patch delta 23 fcmezInDxhF)(tJkISfpVjSUmcEjITY&shZki5Uv4 delta 23 fcmezInDxhF)(tJkIV{YREYngGcjQ|IJ1PubgF+}>i8{pQ71TzeVJi}YyRZ7qjB!d z3P*d5G6}4b*OwH7@Nf2>K}76xXO}z&%ba^~&hIS4DM(hh@&Cc%v??6M;}di delta 153 zcmV;K0A~OA22KBOFAM9e%}X?(g(oyXDog)x6$CtrfiKCIr~1;9D8o^02kuSK zpZmI-eVQVSN8khqElY9t*d__zie(`FQo__&=7hXp3KcySdT+V5Is2$3WBZXenr=ZW HBp3mP!%IgL diff --git a/panda/board/obj/panda_hkg_remote_can_ignition_only/bootstub.elf b/panda/board/obj/panda_hkg_remote_can_ignition_only/bootstub.elf index 6e9e59a54fde6b453d888c091a204a44f68c8080..8da866bf859660b07ea6e4e49740aeb3f244a0ba 100755 GIT binary patch delta 40 wcmdlnnQg~pwhg{!f(E9>#)gUJ7P>C3PND7$4GfbfnkqEcnQgB#W3&ne00+qoZ~y=R delta 40 wcmdlnnQg~pwhg{!f)?gUmT4)bNxCksPND7$4GfbfnkqEcnQgB#W3&ne02llX4*&oF diff --git a/panda/board/obj/panda_hkg_remote_can_ignition_only/main.bin b/panda/board/obj/panda_hkg_remote_can_ignition_only/main.bin index 0ea3c85fe10527158c2810f9e76fb0b7a6707078..0b59a33b5432f7d9b0254c6a19dd576f3ac8a65a 100755 GIT binary patch delta 23 fcmezHnDxVB)(thsISfpVjSUmcEjG6t&shZkhan1# delta 23 fcmezHnDxVB)(thsIV{YREYng;&shZkjKvEp diff --git a/panda/board/obj/panda_hkg_remote_can_ignition_only/main.elf b/panda/board/obj/panda_hkg_remote_can_ignition_only/main.elf index 719075f5353ebf30b1793f8874858bae705bc856..394a62db96466475c2001e4fcce40bba41f14b8f 100755 GIT binary patch delta 43 ucmaF!RN~E3i48T^ISfpVjSUmcEt*@dx3^qp1Y#y2W(H!G?Jd_?Gok^)qZ9N1 delta 43 ucmaF!RN~E3i48T^IV{YREYngK2CyvX2rxA>GcjQ|II}e9M8|(l?o<}RqA2R=TgBU&4-L~jKr zN7a&lec4^^{g!cY1Iin)rt@6;@uzSE*0Uc5v=}cJK@MhKX~+HgzB8qncFOFk`cVw4 z4IFSXcZ8SKCGbDG=#|N4l3<45%0`A3&nMPnA4JF`4*aQPxouZG`zGq-|I)B2{Ih`W Ho^t`)&1g=4 delta 153 zcmV;K0A~OA-v;>K2CyvX2sk%lIc8)vVzV^pM8|&*)HdkUzSqnfYl}D2*dUf(L87|= zczfJg$+(k?AaWQ_P)-g-%pS!LnjiFaM{SOZvNgVvb5k)qpWfA|jxx55WaaGWpXKtB zg>6~@@bq0Bqeo+fM#jd}ku&I#aMOb4!6$TOP*Pz<1CwV9;mhON@VxHff*9{uLh__X H*Wm${0m@Ha diff --git a/panda/board/obj/panda_jungle_h7/bootstub.elf b/panda/board/obj/panda_jungle_h7/bootstub.elf index 42d698998cb6e463ceb942f588605521afe43070..be53f5116e730d632b2e6ff69e04999ee30937bd 100755 GIT binary patch delta 27 jcmZ2*f_=dW_6>U-I1EgUjSUmcEt-!yY(MJ27`+$(nC}Xs delta 27 jcmZ2*f_=dW_6>U-I4sPQEYngNinJi12}Ny7V+l)kzf~;qpIc ztbrSk#W-45C6_FDj^SIE5V8_BmqBI4rcontgL3TXHG|VF-;UCZ38D zaT)J(R%in#&!tL%$fLX>It<$1_m!@5TK;AiDJuTugs+GmtEkPO3&fTYH=8yP%jBJG GNdZ}wG(`IV delta 152 zcmV;J0B8UF;|2WV1)#?WI5%QBW@I&Dvk1p@s(*zwo3nFNGXt~E|J+X!+6x%+eqwlS zLS1lCOIQ}a)#)gUJ7P>C3PND7$4GfbfnkqEcnQgB#V^j(T003bOC;$Ke delta 40 wcmZ25nQg&jwhg{!f)?gUmT4)bNxCksPND7$4GfbfnkqEcnQgB#V^j(T01%W6#{d8T diff --git a/panda/board/obj/panda_remote/main.bin b/panda/board/obj/panda_remote/main.bin index 01d944bf95248d9b79a363063f837b7a365660d6..fcbefe86c4bc7321a11493fa3fffa5d00c6ca334 100755 GIT binary patch delta 22 ecmezJi1o`O)&<8o3`~uU4HL~RHgg=$Sp@)ijR}eX delta 22 ecmezJi1o`O)&<8oEX6Hgg=$Sp@)oF$yUF diff --git a/panda/board/obj/panda_remote/main.elf b/panda/board/obj/panda_remote/main.elf index 0e46330a030dbae5b2e7851f04597f2cde216c75..02bb67a2d1a40055580314081c3784f3a582d473 100755 GIT binary patch delta 42 tcmdn6nmMkwb6jTxVkRJF24a@&9M@S*q5*+@5QzW) diff --git a/panda/board/obj/panda_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_remote_can_ignition_only.bin.signed index 838becc69a04315615ad643756e074279f4b759d..33ed58882978d0ddb8be289dd9e6ac4eb47c7a98 100644 GIT binary patch delta 153 zcmV;K0A~N_;|1vB1+eVK2rxA>GcjQ|IJ5M|bgF-eR6mOM(X@)yl$YRE!IV*?B*5Z>P~3W<;wgMTtVtBw@>K8Tk_=N;d3m|v6u!YU>pK-B3LP1K3-s;`d#Ha%1c;efSIYdci3x?su>>)&ZyHiMyg-@_v62FyREb Hd(8n;kCaMN diff --git a/panda/board/obj/panda_remote_can_ignition_only/bootstub.elf b/panda/board/obj/panda_remote_can_ignition_only/bootstub.elf index 7c24ba1a7e4ce30ff5b0fa996102bdcfb35ca3c0..7d14e3e04e77848f655180e88de8543bae9e9642 100755 GIT binary patch delta 40 wcmdlonQhBtwhg{!f(E9>#)gUJ7P>C3PND7$4GfbfnkqEcnQgB#V>Al}00xZ=WB>pF delta 40 wcmdlonQhBtwhg{!f)?gUmT4)bNxCksPND7$4GfbfnkqEcnQgB#V>Al}02aUv0{{R3 diff --git a/panda/board/obj/panda_remote_can_ignition_only/main.bin b/panda/board/obj/panda_remote_can_ignition_only/main.bin index be9167e9636f27e1bfce0e29932d830f30e7dd02..6554f8bb391643d6602edf0aff24acfa820424a8 100755 GIT binary patch delta 23 fcmaFxi1ooE)(vltaTu5y8yhB?TWtPvEN2w}jP?si delta 23 fcmaFxi1ooE)(vltaafoqS*E3!CT;$5EN2w}l9~(W diff --git a/panda/board/obj/panda_remote_can_ignition_only/main.elf b/panda/board/obj/panda_remote_can_ignition_only/main.elf index 372fb4119a2d47c5004e0fa42f40af964029c6ba..64b751685a7293fa3f52c5d3a1bfabc3b32cc90f 100755 GIT binary patch delta 43 vcmbR8SYpa!i4AYAaTu5y8yhB?TQq;U*8b%hBM>tIF*6XeZ2xkNbwLyW+#(i$ delta 43 vcmbR8SYpa!i4AYAaafoqS*E3!CN+P#*8b%hBM>tIF*6XeZ2xkNbwLyW?lKo2 diff --git a/panda/board/obj/version b/panda/board/obj/version index 6743b4741..fa37b4096 100644 --- a/panda/board/obj/version +++ b/panda/board/obj/version @@ -1 +1 @@ -DEV-87b9fd5b-DEBUG \ No newline at end of file +DEV-05331a78-DEBUG \ No newline at end of file diff --git a/selfdrive/locationd/models/generated/car.cpp b/selfdrive/locationd/models/generated/car.cpp index ca764e88f..4aa300cda 100644 --- a/selfdrive/locationd/models/generated/car.cpp +++ b/selfdrive/locationd/models/generated/car.cpp @@ -45,326 +45,326 @@ const static double MAHA_THRESH_31 = 3.8414588206941227; * * * This file is part of 'ekf' * ******************************************************************************/ -void err_fun(double *nom_x, double *delta_x, double *out_395710906661730109) { - out_395710906661730109[0] = delta_x[0] + nom_x[0]; - out_395710906661730109[1] = delta_x[1] + nom_x[1]; - out_395710906661730109[2] = delta_x[2] + nom_x[2]; - out_395710906661730109[3] = delta_x[3] + nom_x[3]; - out_395710906661730109[4] = delta_x[4] + nom_x[4]; - out_395710906661730109[5] = delta_x[5] + nom_x[5]; - out_395710906661730109[6] = delta_x[6] + nom_x[6]; - out_395710906661730109[7] = delta_x[7] + nom_x[7]; - out_395710906661730109[8] = delta_x[8] + nom_x[8]; +void err_fun(double *nom_x, double *delta_x, double *out_5232047554535600109) { + out_5232047554535600109[0] = delta_x[0] + nom_x[0]; + out_5232047554535600109[1] = delta_x[1] + nom_x[1]; + out_5232047554535600109[2] = delta_x[2] + nom_x[2]; + out_5232047554535600109[3] = delta_x[3] + nom_x[3]; + out_5232047554535600109[4] = delta_x[4] + nom_x[4]; + out_5232047554535600109[5] = delta_x[5] + nom_x[5]; + out_5232047554535600109[6] = delta_x[6] + nom_x[6]; + out_5232047554535600109[7] = delta_x[7] + nom_x[7]; + out_5232047554535600109[8] = delta_x[8] + nom_x[8]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_6370952191766860566) { - out_6370952191766860566[0] = -nom_x[0] + true_x[0]; - out_6370952191766860566[1] = -nom_x[1] + true_x[1]; - out_6370952191766860566[2] = -nom_x[2] + true_x[2]; - out_6370952191766860566[3] = -nom_x[3] + true_x[3]; - out_6370952191766860566[4] = -nom_x[4] + true_x[4]; - out_6370952191766860566[5] = -nom_x[5] + true_x[5]; - out_6370952191766860566[6] = -nom_x[6] + true_x[6]; - out_6370952191766860566[7] = -nom_x[7] + true_x[7]; - out_6370952191766860566[8] = -nom_x[8] + true_x[8]; +void inv_err_fun(double *nom_x, double *true_x, double *out_5926361318328117466) { + out_5926361318328117466[0] = -nom_x[0] + true_x[0]; + out_5926361318328117466[1] = -nom_x[1] + true_x[1]; + out_5926361318328117466[2] = -nom_x[2] + true_x[2]; + out_5926361318328117466[3] = -nom_x[3] + true_x[3]; + out_5926361318328117466[4] = -nom_x[4] + true_x[4]; + out_5926361318328117466[5] = -nom_x[5] + true_x[5]; + out_5926361318328117466[6] = -nom_x[6] + true_x[6]; + out_5926361318328117466[7] = -nom_x[7] + true_x[7]; + out_5926361318328117466[8] = -nom_x[8] + true_x[8]; } -void H_mod_fun(double *state, double *out_8610422609060100183) { - out_8610422609060100183[0] = 1.0; - out_8610422609060100183[1] = 0.0; - out_8610422609060100183[2] = 0.0; - out_8610422609060100183[3] = 0.0; - out_8610422609060100183[4] = 0.0; - out_8610422609060100183[5] = 0.0; - out_8610422609060100183[6] = 0.0; - out_8610422609060100183[7] = 0.0; - out_8610422609060100183[8] = 0.0; - out_8610422609060100183[9] = 0.0; - out_8610422609060100183[10] = 1.0; - out_8610422609060100183[11] = 0.0; - out_8610422609060100183[12] = 0.0; - out_8610422609060100183[13] = 0.0; - out_8610422609060100183[14] = 0.0; - out_8610422609060100183[15] = 0.0; - out_8610422609060100183[16] = 0.0; - out_8610422609060100183[17] = 0.0; - out_8610422609060100183[18] = 0.0; - out_8610422609060100183[19] = 0.0; - out_8610422609060100183[20] = 1.0; - out_8610422609060100183[21] = 0.0; - out_8610422609060100183[22] = 0.0; - out_8610422609060100183[23] = 0.0; - out_8610422609060100183[24] = 0.0; - out_8610422609060100183[25] = 0.0; - out_8610422609060100183[26] = 0.0; - out_8610422609060100183[27] = 0.0; - out_8610422609060100183[28] = 0.0; - out_8610422609060100183[29] = 0.0; - out_8610422609060100183[30] = 1.0; - out_8610422609060100183[31] = 0.0; - out_8610422609060100183[32] = 0.0; - out_8610422609060100183[33] = 0.0; - out_8610422609060100183[34] = 0.0; - out_8610422609060100183[35] = 0.0; - out_8610422609060100183[36] = 0.0; - out_8610422609060100183[37] = 0.0; - out_8610422609060100183[38] = 0.0; - out_8610422609060100183[39] = 0.0; - out_8610422609060100183[40] = 1.0; - out_8610422609060100183[41] = 0.0; - out_8610422609060100183[42] = 0.0; - out_8610422609060100183[43] = 0.0; - out_8610422609060100183[44] = 0.0; - out_8610422609060100183[45] = 0.0; - out_8610422609060100183[46] = 0.0; - out_8610422609060100183[47] = 0.0; - out_8610422609060100183[48] = 0.0; - out_8610422609060100183[49] = 0.0; - out_8610422609060100183[50] = 1.0; - out_8610422609060100183[51] = 0.0; - out_8610422609060100183[52] = 0.0; - out_8610422609060100183[53] = 0.0; - out_8610422609060100183[54] = 0.0; - out_8610422609060100183[55] = 0.0; - out_8610422609060100183[56] = 0.0; - out_8610422609060100183[57] = 0.0; - out_8610422609060100183[58] = 0.0; - out_8610422609060100183[59] = 0.0; - out_8610422609060100183[60] = 1.0; - out_8610422609060100183[61] = 0.0; - out_8610422609060100183[62] = 0.0; - out_8610422609060100183[63] = 0.0; - out_8610422609060100183[64] = 0.0; - out_8610422609060100183[65] = 0.0; - out_8610422609060100183[66] = 0.0; - out_8610422609060100183[67] = 0.0; - out_8610422609060100183[68] = 0.0; - out_8610422609060100183[69] = 0.0; - out_8610422609060100183[70] = 1.0; - out_8610422609060100183[71] = 0.0; - out_8610422609060100183[72] = 0.0; - out_8610422609060100183[73] = 0.0; - out_8610422609060100183[74] = 0.0; - out_8610422609060100183[75] = 0.0; - out_8610422609060100183[76] = 0.0; - out_8610422609060100183[77] = 0.0; - out_8610422609060100183[78] = 0.0; - out_8610422609060100183[79] = 0.0; - out_8610422609060100183[80] = 1.0; +void H_mod_fun(double *state, double *out_8663045025294862621) { + out_8663045025294862621[0] = 1.0; + out_8663045025294862621[1] = 0.0; + out_8663045025294862621[2] = 0.0; + out_8663045025294862621[3] = 0.0; + out_8663045025294862621[4] = 0.0; + out_8663045025294862621[5] = 0.0; + out_8663045025294862621[6] = 0.0; + out_8663045025294862621[7] = 0.0; + out_8663045025294862621[8] = 0.0; + out_8663045025294862621[9] = 0.0; + out_8663045025294862621[10] = 1.0; + out_8663045025294862621[11] = 0.0; + out_8663045025294862621[12] = 0.0; + out_8663045025294862621[13] = 0.0; + out_8663045025294862621[14] = 0.0; + out_8663045025294862621[15] = 0.0; + out_8663045025294862621[16] = 0.0; + out_8663045025294862621[17] = 0.0; + out_8663045025294862621[18] = 0.0; + out_8663045025294862621[19] = 0.0; + out_8663045025294862621[20] = 1.0; + out_8663045025294862621[21] = 0.0; + out_8663045025294862621[22] = 0.0; + out_8663045025294862621[23] = 0.0; + out_8663045025294862621[24] = 0.0; + out_8663045025294862621[25] = 0.0; + out_8663045025294862621[26] = 0.0; + out_8663045025294862621[27] = 0.0; + out_8663045025294862621[28] = 0.0; + out_8663045025294862621[29] = 0.0; + out_8663045025294862621[30] = 1.0; + out_8663045025294862621[31] = 0.0; + out_8663045025294862621[32] = 0.0; + out_8663045025294862621[33] = 0.0; + out_8663045025294862621[34] = 0.0; + out_8663045025294862621[35] = 0.0; + out_8663045025294862621[36] = 0.0; + out_8663045025294862621[37] = 0.0; + out_8663045025294862621[38] = 0.0; + out_8663045025294862621[39] = 0.0; + out_8663045025294862621[40] = 1.0; + out_8663045025294862621[41] = 0.0; + out_8663045025294862621[42] = 0.0; + out_8663045025294862621[43] = 0.0; + out_8663045025294862621[44] = 0.0; + out_8663045025294862621[45] = 0.0; + out_8663045025294862621[46] = 0.0; + out_8663045025294862621[47] = 0.0; + out_8663045025294862621[48] = 0.0; + out_8663045025294862621[49] = 0.0; + out_8663045025294862621[50] = 1.0; + out_8663045025294862621[51] = 0.0; + out_8663045025294862621[52] = 0.0; + out_8663045025294862621[53] = 0.0; + out_8663045025294862621[54] = 0.0; + out_8663045025294862621[55] = 0.0; + out_8663045025294862621[56] = 0.0; + out_8663045025294862621[57] = 0.0; + out_8663045025294862621[58] = 0.0; + out_8663045025294862621[59] = 0.0; + out_8663045025294862621[60] = 1.0; + out_8663045025294862621[61] = 0.0; + out_8663045025294862621[62] = 0.0; + out_8663045025294862621[63] = 0.0; + out_8663045025294862621[64] = 0.0; + out_8663045025294862621[65] = 0.0; + out_8663045025294862621[66] = 0.0; + out_8663045025294862621[67] = 0.0; + out_8663045025294862621[68] = 0.0; + out_8663045025294862621[69] = 0.0; + out_8663045025294862621[70] = 1.0; + out_8663045025294862621[71] = 0.0; + out_8663045025294862621[72] = 0.0; + out_8663045025294862621[73] = 0.0; + out_8663045025294862621[74] = 0.0; + out_8663045025294862621[75] = 0.0; + out_8663045025294862621[76] = 0.0; + out_8663045025294862621[77] = 0.0; + out_8663045025294862621[78] = 0.0; + out_8663045025294862621[79] = 0.0; + out_8663045025294862621[80] = 1.0; } -void f_fun(double *state, double dt, double *out_7209711513462721716) { - out_7209711513462721716[0] = state[0]; - out_7209711513462721716[1] = state[1]; - out_7209711513462721716[2] = state[2]; - out_7209711513462721716[3] = state[3]; - out_7209711513462721716[4] = state[4]; - out_7209711513462721716[5] = dt*((-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]))*state[6] - 9.8100000000000005*state[8] + stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*state[1]) + (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*state[4])) + state[5]; - out_7209711513462721716[6] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*state[4])) + state[6]; - out_7209711513462721716[7] = state[7]; - out_7209711513462721716[8] = state[8]; +void f_fun(double *state, double dt, double *out_4712382669747920854) { + out_4712382669747920854[0] = state[0]; + out_4712382669747920854[1] = state[1]; + out_4712382669747920854[2] = state[2]; + out_4712382669747920854[3] = state[3]; + out_4712382669747920854[4] = state[4]; + out_4712382669747920854[5] = dt*((-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]))*state[6] - 9.8100000000000005*state[8] + stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*state[1]) + (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*state[4])) + state[5]; + out_4712382669747920854[6] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*state[4])) + state[6]; + out_4712382669747920854[7] = state[7]; + out_4712382669747920854[8] = state[8]; } -void F_fun(double *state, double dt, double *out_832953036043329844) { - out_832953036043329844[0] = 1; - out_832953036043329844[1] = 0; - out_832953036043329844[2] = 0; - out_832953036043329844[3] = 0; - out_832953036043329844[4] = 0; - out_832953036043329844[5] = 0; - out_832953036043329844[6] = 0; - out_832953036043329844[7] = 0; - out_832953036043329844[8] = 0; - out_832953036043329844[9] = 0; - out_832953036043329844[10] = 1; - out_832953036043329844[11] = 0; - out_832953036043329844[12] = 0; - out_832953036043329844[13] = 0; - out_832953036043329844[14] = 0; - out_832953036043329844[15] = 0; - out_832953036043329844[16] = 0; - out_832953036043329844[17] = 0; - out_832953036043329844[18] = 0; - out_832953036043329844[19] = 0; - out_832953036043329844[20] = 1; - out_832953036043329844[21] = 0; - out_832953036043329844[22] = 0; - out_832953036043329844[23] = 0; - out_832953036043329844[24] = 0; - out_832953036043329844[25] = 0; - out_832953036043329844[26] = 0; - out_832953036043329844[27] = 0; - out_832953036043329844[28] = 0; - out_832953036043329844[29] = 0; - out_832953036043329844[30] = 1; - out_832953036043329844[31] = 0; - out_832953036043329844[32] = 0; - out_832953036043329844[33] = 0; - out_832953036043329844[34] = 0; - out_832953036043329844[35] = 0; - out_832953036043329844[36] = 0; - out_832953036043329844[37] = 0; - out_832953036043329844[38] = 0; - out_832953036043329844[39] = 0; - out_832953036043329844[40] = 1; - out_832953036043329844[41] = 0; - out_832953036043329844[42] = 0; - out_832953036043329844[43] = 0; - out_832953036043329844[44] = 0; - out_832953036043329844[45] = dt*(stiffness_front*(-state[2] - state[3] + state[7])/(mass*state[1]) + (-stiffness_front - stiffness_rear)*state[5]/(mass*state[4]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[6]/(mass*state[4])); - out_832953036043329844[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); - out_832953036043329844[47] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_832953036043329844[48] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_832953036043329844[49] = dt*((-1 - (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*pow(state[4], 2)))*state[6] - (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*pow(state[4], 2))); - out_832953036043329844[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; - out_832953036043329844[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); - out_832953036043329844[52] = dt*stiffness_front*state[0]/(mass*state[1]); - out_832953036043329844[53] = -9.8100000000000005*dt; - out_832953036043329844[54] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front - pow(center_to_rear, 2)*stiffness_rear)*state[6]/(rotational_inertia*state[4])); - out_832953036043329844[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); - out_832953036043329844[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_832953036043329844[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_832953036043329844[58] = dt*(-(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*pow(state[4], 2)) - (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*pow(state[4], 2))); - out_832953036043329844[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); - out_832953036043329844[60] = dt*(-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])/(rotational_inertia*state[4]) + 1; - out_832953036043329844[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_832953036043329844[62] = 0; - out_832953036043329844[63] = 0; - out_832953036043329844[64] = 0; - out_832953036043329844[65] = 0; - out_832953036043329844[66] = 0; - out_832953036043329844[67] = 0; - out_832953036043329844[68] = 0; - out_832953036043329844[69] = 0; - out_832953036043329844[70] = 1; - out_832953036043329844[71] = 0; - out_832953036043329844[72] = 0; - out_832953036043329844[73] = 0; - out_832953036043329844[74] = 0; - out_832953036043329844[75] = 0; - out_832953036043329844[76] = 0; - out_832953036043329844[77] = 0; - out_832953036043329844[78] = 0; - out_832953036043329844[79] = 0; - out_832953036043329844[80] = 1; +void F_fun(double *state, double dt, double *out_6132820248099245599) { + out_6132820248099245599[0] = 1; + out_6132820248099245599[1] = 0; + out_6132820248099245599[2] = 0; + out_6132820248099245599[3] = 0; + out_6132820248099245599[4] = 0; + out_6132820248099245599[5] = 0; + out_6132820248099245599[6] = 0; + out_6132820248099245599[7] = 0; + out_6132820248099245599[8] = 0; + out_6132820248099245599[9] = 0; + out_6132820248099245599[10] = 1; + out_6132820248099245599[11] = 0; + out_6132820248099245599[12] = 0; + out_6132820248099245599[13] = 0; + out_6132820248099245599[14] = 0; + out_6132820248099245599[15] = 0; + out_6132820248099245599[16] = 0; + out_6132820248099245599[17] = 0; + out_6132820248099245599[18] = 0; + out_6132820248099245599[19] = 0; + out_6132820248099245599[20] = 1; + out_6132820248099245599[21] = 0; + out_6132820248099245599[22] = 0; + out_6132820248099245599[23] = 0; + out_6132820248099245599[24] = 0; + out_6132820248099245599[25] = 0; + out_6132820248099245599[26] = 0; + out_6132820248099245599[27] = 0; + out_6132820248099245599[28] = 0; + out_6132820248099245599[29] = 0; + out_6132820248099245599[30] = 1; + out_6132820248099245599[31] = 0; + out_6132820248099245599[32] = 0; + out_6132820248099245599[33] = 0; + out_6132820248099245599[34] = 0; + out_6132820248099245599[35] = 0; + out_6132820248099245599[36] = 0; + out_6132820248099245599[37] = 0; + out_6132820248099245599[38] = 0; + out_6132820248099245599[39] = 0; + out_6132820248099245599[40] = 1; + out_6132820248099245599[41] = 0; + out_6132820248099245599[42] = 0; + out_6132820248099245599[43] = 0; + out_6132820248099245599[44] = 0; + out_6132820248099245599[45] = dt*(stiffness_front*(-state[2] - state[3] + state[7])/(mass*state[1]) + (-stiffness_front - stiffness_rear)*state[5]/(mass*state[4]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[6]/(mass*state[4])); + out_6132820248099245599[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); + out_6132820248099245599[47] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_6132820248099245599[48] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_6132820248099245599[49] = dt*((-1 - (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*pow(state[4], 2)))*state[6] - (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*pow(state[4], 2))); + out_6132820248099245599[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; + out_6132820248099245599[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); + out_6132820248099245599[52] = dt*stiffness_front*state[0]/(mass*state[1]); + out_6132820248099245599[53] = -9.8100000000000005*dt; + out_6132820248099245599[54] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front - pow(center_to_rear, 2)*stiffness_rear)*state[6]/(rotational_inertia*state[4])); + out_6132820248099245599[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); + out_6132820248099245599[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_6132820248099245599[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_6132820248099245599[58] = dt*(-(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*pow(state[4], 2)) - (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*pow(state[4], 2))); + out_6132820248099245599[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); + out_6132820248099245599[60] = dt*(-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])/(rotational_inertia*state[4]) + 1; + out_6132820248099245599[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_6132820248099245599[62] = 0; + out_6132820248099245599[63] = 0; + out_6132820248099245599[64] = 0; + out_6132820248099245599[65] = 0; + out_6132820248099245599[66] = 0; + out_6132820248099245599[67] = 0; + out_6132820248099245599[68] = 0; + out_6132820248099245599[69] = 0; + out_6132820248099245599[70] = 1; + out_6132820248099245599[71] = 0; + out_6132820248099245599[72] = 0; + out_6132820248099245599[73] = 0; + out_6132820248099245599[74] = 0; + out_6132820248099245599[75] = 0; + out_6132820248099245599[76] = 0; + out_6132820248099245599[77] = 0; + out_6132820248099245599[78] = 0; + out_6132820248099245599[79] = 0; + out_6132820248099245599[80] = 1; } -void h_25(double *state, double *unused, double *out_6217004965884737485) { - out_6217004965884737485[0] = state[6]; +void h_25(double *state, double *unused, double *out_8954572363719808224) { + out_8954572363719808224[0] = state[6]; } -void H_25(double *state, double *unused, double *out_2113399649170070232) { - out_2113399649170070232[0] = 0; - out_2113399649170070232[1] = 0; - out_2113399649170070232[2] = 0; - out_2113399649170070232[3] = 0; - out_2113399649170070232[4] = 0; - out_2113399649170070232[5] = 0; - out_2113399649170070232[6] = 1; - out_2113399649170070232[7] = 0; - out_2113399649170070232[8] = 0; +void H_25(double *state, double *unused, double *out_6260718398425197318) { + out_6260718398425197318[0] = 0; + out_6260718398425197318[1] = 0; + out_6260718398425197318[2] = 0; + out_6260718398425197318[3] = 0; + out_6260718398425197318[4] = 0; + out_6260718398425197318[5] = 0; + out_6260718398425197318[6] = 1; + out_6260718398425197318[7] = 0; + out_6260718398425197318[8] = 0; } -void h_24(double *state, double *unused, double *out_724420575405524496) { - out_724420575405524496[0] = state[4]; - out_724420575405524496[1] = state[5]; +void h_24(double *state, double *unused, double *out_573451915361062774) { + out_573451915361062774[0] = state[4]; + out_573451915361062774[1] = state[5]; } -void H_24(double *state, double *unused, double *out_2755415215857636620) { - out_2755415215857636620[0] = 0; - out_2755415215857636620[1] = 0; - out_2755415215857636620[2] = 0; - out_2755415215857636620[3] = 0; - out_2755415215857636620[4] = 1; - out_2755415215857636620[5] = 0; - out_2755415215857636620[6] = 0; - out_2755415215857636620[7] = 0; - out_2755415215857636620[8] = 0; - out_2755415215857636620[9] = 0; - out_2755415215857636620[10] = 0; - out_2755415215857636620[11] = 0; - out_2755415215857636620[12] = 0; - out_2755415215857636620[13] = 0; - out_2755415215857636620[14] = 1; - out_2755415215857636620[15] = 0; - out_2755415215857636620[16] = 0; - out_2755415215857636620[17] = 0; +void H_24(double *state, double *unused, double *out_8433367997430696884) { + out_8433367997430696884[0] = 0; + out_8433367997430696884[1] = 0; + out_8433367997430696884[2] = 0; + out_8433367997430696884[3] = 0; + out_8433367997430696884[4] = 1; + out_8433367997430696884[5] = 0; + out_8433367997430696884[6] = 0; + out_8433367997430696884[7] = 0; + out_8433367997430696884[8] = 0; + out_8433367997430696884[9] = 0; + out_8433367997430696884[10] = 0; + out_8433367997430696884[11] = 0; + out_8433367997430696884[12] = 0; + out_8433367997430696884[13] = 0; + out_8433367997430696884[14] = 1; + out_8433367997430696884[15] = 0; + out_8433367997430696884[16] = 0; + out_8433367997430696884[17] = 0; } -void h_30(double *state, double *unused, double *out_5458903881474463195) { - out_5458903881474463195[0] = state[4]; +void h_30(double *state, double *unused, double *out_995511028726003400) { + out_995511028726003400[0] = state[4]; } -void H_30(double *state, double *unused, double *out_2414296680957537966) { - out_2414296680957537966[0] = 0; - out_2414296680957537966[1] = 0; - out_2414296680957537966[2] = 0; - out_2414296680957537966[3] = 0; - out_2414296680957537966[4] = 1; - out_2414296680957537966[5] = 0; - out_2414296680957537966[6] = 0; - out_2414296680957537966[7] = 0; - out_2414296680957537966[8] = 0; +void H_30(double *state, double *unused, double *out_655971943066419437) { + out_655971943066419437[0] = 0; + out_655971943066419437[1] = 0; + out_655971943066419437[2] = 0; + out_655971943066419437[3] = 0; + out_655971943066419437[4] = 1; + out_655971943066419437[5] = 0; + out_655971943066419437[6] = 0; + out_655971943066419437[7] = 0; + out_655971943066419437[8] = 0; } -void h_26(double *state, double *unused, double *out_7645972956349057858) { - out_7645972956349057858[0] = state[7]; +void h_26(double *state, double *unused, double *out_8430654463154704213) { + out_8430654463154704213[0] = state[7]; } -void H_26(double *state, double *unused, double *out_1628103669703985992) { - out_1628103669703985992[0] = 0; - out_1628103669703985992[1] = 0; - out_1628103669703985992[2] = 0; - out_1628103669703985992[3] = 0; - out_1628103669703985992[4] = 0; - out_1628103669703985992[5] = 0; - out_1628103669703985992[6] = 0; - out_1628103669703985992[7] = 1; - out_1628103669703985992[8] = 0; +void H_26(double *state, double *unused, double *out_8444522356410298074) { + out_8444522356410298074[0] = 0; + out_8444522356410298074[1] = 0; + out_8444522356410298074[2] = 0; + out_8444522356410298074[3] = 0; + out_8444522356410298074[4] = 0; + out_8444522356410298074[5] = 0; + out_8444522356410298074[6] = 0; + out_8444522356410298074[7] = 1; + out_8444522356410298074[8] = 0; } -void h_27(double *state, double *unused, double *out_2579304498381259655) { - out_2579304498381259655[0] = state[3]; +void h_27(double *state, double *unused, double *out_8548661857088080957) { + out_8548661857088080957[0] = state[3]; } -void H_27(double *state, double *unused, double *out_190702609773594749) { - out_190702609773594749[0] = 0; - out_190702609773594749[1] = 0; - out_190702609773594749[2] = 0; - out_190702609773594749[3] = 1; - out_190702609773594749[4] = 0; - out_190702609773594749[5] = 0; - out_190702609773594749[6] = 0; - out_190702609773594749[7] = 0; - out_190702609773594749[8] = 0; +void H_27(double *state, double *unused, double *out_1518791368734005474) { + out_1518791368734005474[0] = 0; + out_1518791368734005474[1] = 0; + out_1518791368734005474[2] = 0; + out_1518791368734005474[3] = 1; + out_1518791368734005474[4] = 0; + out_1518791368734005474[5] = 0; + out_1518791368734005474[6] = 0; + out_1518791368734005474[7] = 0; + out_1518791368734005474[8] = 0; } -void h_29(double *state, double *unused, double *out_7986166924574242776) { - out_7986166924574242776[0] = state[1]; +void h_29(double *state, double *unused, double *out_589055427595770225) { + out_589055427595770225[0] = state[1]; } -void H_29(double *state, double *unused, double *out_1904065336643145782) { - out_1904065336643145782[0] = 0; - out_1904065336643145782[1] = 1; - out_1904065336643145782[2] = 0; - out_1904065336643145782[3] = 0; - out_1904065336643145782[4] = 0; - out_1904065336643145782[5] = 0; - out_1904065336643145782[6] = 0; - out_1904065336643145782[7] = 0; - out_1904065336643145782[8] = 0; +void H_29(double *state, double *unused, double *out_3232154095603556507) { + out_3232154095603556507[0] = 0; + out_3232154095603556507[1] = 1; + out_3232154095603556507[2] = 0; + out_3232154095603556507[3] = 0; + out_3232154095603556507[4] = 0; + out_3232154095603556507[5] = 0; + out_3232154095603556507[6] = 0; + out_3232154095603556507[7] = 0; + out_3232154095603556507[8] = 0; } -void h_28(double *state, double *unused, double *out_3819737019032589491) { - out_3819737019032589491[0] = state[0]; +void h_28(double *state, double *unused, double *out_7867012193673341893) { + out_7867012193673341893[0] = state[0]; } -void H_28(double *state, double *unused, double *out_6986464353712676356) { - out_6986464353712676356[0] = 1; - out_6986464353712676356[1] = 0; - out_6986464353712676356[2] = 0; - out_6986464353712676356[3] = 0; - out_6986464353712676356[4] = 0; - out_6986464353712676356[5] = 0; - out_6986464353712676356[6] = 0; - out_6986464353712676356[7] = 0; - out_6986464353712676356[8] = 0; +void H_28(double *state, double *unused, double *out_8314553112673087081) { + out_8314553112673087081[0] = 1; + out_8314553112673087081[1] = 0; + out_8314553112673087081[2] = 0; + out_8314553112673087081[3] = 0; + out_8314553112673087081[4] = 0; + out_8314553112673087081[5] = 0; + out_8314553112673087081[6] = 0; + out_8314553112673087081[7] = 0; + out_8314553112673087081[8] = 0; } -void h_31(double *state, double *unused, double *out_6059818297533608340) { - out_6059818297533608340[0] = state[8]; +void h_31(double *state, double *unused, double *out_2027016737343401600) { + out_2027016737343401600[0] = state[8]; } -void H_31(double *state, double *unused, double *out_2254311771937337468) { - out_2254311771937337468[0] = 0; - out_2254311771937337468[1] = 0; - out_2254311771937337468[2] = 0; - out_2254311771937337468[3] = 0; - out_2254311771937337468[4] = 0; - out_2254311771937337468[5] = 0; - out_2254311771937337468[6] = 0; - out_2254311771937337468[7] = 0; - out_2254311771937337468[8] = 1; +void H_31(double *state, double *unused, double *out_6230072436548236890) { + out_6230072436548236890[0] = 0; + out_6230072436548236890[1] = 0; + out_6230072436548236890[2] = 0; + out_6230072436548236890[3] = 0; + out_6230072436548236890[4] = 0; + out_6230072436548236890[5] = 0; + out_6230072436548236890[6] = 0; + out_6230072436548236890[7] = 0; + out_6230072436548236890[8] = 1; } #include #include @@ -518,68 +518,68 @@ void car_update_28(double *in_x, double *in_P, double *in_z, double *in_R, doubl void car_update_31(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea) { update<1, 3, 0>(in_x, in_P, h_31, H_31, NULL, in_z, in_R, in_ea, MAHA_THRESH_31); } -void car_err_fun(double *nom_x, double *delta_x, double *out_395710906661730109) { - err_fun(nom_x, delta_x, out_395710906661730109); +void car_err_fun(double *nom_x, double *delta_x, double *out_5232047554535600109) { + err_fun(nom_x, delta_x, out_5232047554535600109); } -void car_inv_err_fun(double *nom_x, double *true_x, double *out_6370952191766860566) { - inv_err_fun(nom_x, true_x, out_6370952191766860566); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_5926361318328117466) { + inv_err_fun(nom_x, true_x, out_5926361318328117466); } -void car_H_mod_fun(double *state, double *out_8610422609060100183) { - H_mod_fun(state, out_8610422609060100183); +void car_H_mod_fun(double *state, double *out_8663045025294862621) { + H_mod_fun(state, out_8663045025294862621); } -void car_f_fun(double *state, double dt, double *out_7209711513462721716) { - f_fun(state, dt, out_7209711513462721716); +void car_f_fun(double *state, double dt, double *out_4712382669747920854) { + f_fun(state, dt, out_4712382669747920854); } -void car_F_fun(double *state, double dt, double *out_832953036043329844) { - F_fun(state, dt, out_832953036043329844); +void car_F_fun(double *state, double dt, double *out_6132820248099245599) { + F_fun(state, dt, out_6132820248099245599); } -void car_h_25(double *state, double *unused, double *out_6217004965884737485) { - h_25(state, unused, out_6217004965884737485); +void car_h_25(double *state, double *unused, double *out_8954572363719808224) { + h_25(state, unused, out_8954572363719808224); } -void car_H_25(double *state, double *unused, double *out_2113399649170070232) { - H_25(state, unused, out_2113399649170070232); +void car_H_25(double *state, double *unused, double *out_6260718398425197318) { + H_25(state, unused, out_6260718398425197318); } -void car_h_24(double *state, double *unused, double *out_724420575405524496) { - h_24(state, unused, out_724420575405524496); +void car_h_24(double *state, double *unused, double *out_573451915361062774) { + h_24(state, unused, out_573451915361062774); } -void car_H_24(double *state, double *unused, double *out_2755415215857636620) { - H_24(state, unused, out_2755415215857636620); +void car_H_24(double *state, double *unused, double *out_8433367997430696884) { + H_24(state, unused, out_8433367997430696884); } -void car_h_30(double *state, double *unused, double *out_5458903881474463195) { - h_30(state, unused, out_5458903881474463195); +void car_h_30(double *state, double *unused, double *out_995511028726003400) { + h_30(state, unused, out_995511028726003400); } -void car_H_30(double *state, double *unused, double *out_2414296680957537966) { - H_30(state, unused, out_2414296680957537966); +void car_H_30(double *state, double *unused, double *out_655971943066419437) { + H_30(state, unused, out_655971943066419437); } -void car_h_26(double *state, double *unused, double *out_7645972956349057858) { - h_26(state, unused, out_7645972956349057858); +void car_h_26(double *state, double *unused, double *out_8430654463154704213) { + h_26(state, unused, out_8430654463154704213); } -void car_H_26(double *state, double *unused, double *out_1628103669703985992) { - H_26(state, unused, out_1628103669703985992); +void car_H_26(double *state, double *unused, double *out_8444522356410298074) { + H_26(state, unused, out_8444522356410298074); } -void car_h_27(double *state, double *unused, double *out_2579304498381259655) { - h_27(state, unused, out_2579304498381259655); +void car_h_27(double *state, double *unused, double *out_8548661857088080957) { + h_27(state, unused, out_8548661857088080957); } -void car_H_27(double *state, double *unused, double *out_190702609773594749) { - H_27(state, unused, out_190702609773594749); +void car_H_27(double *state, double *unused, double *out_1518791368734005474) { + H_27(state, unused, out_1518791368734005474); } -void car_h_29(double *state, double *unused, double *out_7986166924574242776) { - h_29(state, unused, out_7986166924574242776); +void car_h_29(double *state, double *unused, double *out_589055427595770225) { + h_29(state, unused, out_589055427595770225); } -void car_H_29(double *state, double *unused, double *out_1904065336643145782) { - H_29(state, unused, out_1904065336643145782); +void car_H_29(double *state, double *unused, double *out_3232154095603556507) { + H_29(state, unused, out_3232154095603556507); } -void car_h_28(double *state, double *unused, double *out_3819737019032589491) { - h_28(state, unused, out_3819737019032589491); +void car_h_28(double *state, double *unused, double *out_7867012193673341893) { + h_28(state, unused, out_7867012193673341893); } -void car_H_28(double *state, double *unused, double *out_6986464353712676356) { - H_28(state, unused, out_6986464353712676356); +void car_H_28(double *state, double *unused, double *out_8314553112673087081) { + H_28(state, unused, out_8314553112673087081); } -void car_h_31(double *state, double *unused, double *out_6059818297533608340) { - h_31(state, unused, out_6059818297533608340); +void car_h_31(double *state, double *unused, double *out_2027016737343401600) { + h_31(state, unused, out_2027016737343401600); } -void car_H_31(double *state, double *unused, double *out_2254311771937337468) { - H_31(state, unused, out_2254311771937337468); +void car_H_31(double *state, double *unused, double *out_6230072436548236890) { + H_31(state, unused, out_6230072436548236890); } void car_predict(double *in_x, double *in_P, double *in_Q, double dt) { predict(in_x, in_P, in_Q, dt); diff --git a/selfdrive/locationd/models/generated/car.h b/selfdrive/locationd/models/generated/car.h index a8745b522..822c39660 100644 --- a/selfdrive/locationd/models/generated/car.h +++ b/selfdrive/locationd/models/generated/car.h @@ -9,27 +9,27 @@ void car_update_27(double *in_x, double *in_P, double *in_z, double *in_R, doubl void car_update_29(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); void car_update_28(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); void car_update_31(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); -void car_err_fun(double *nom_x, double *delta_x, double *out_395710906661730109); -void car_inv_err_fun(double *nom_x, double *true_x, double *out_6370952191766860566); -void car_H_mod_fun(double *state, double *out_8610422609060100183); -void car_f_fun(double *state, double dt, double *out_7209711513462721716); -void car_F_fun(double *state, double dt, double *out_832953036043329844); -void car_h_25(double *state, double *unused, double *out_6217004965884737485); -void car_H_25(double *state, double *unused, double *out_2113399649170070232); -void car_h_24(double *state, double *unused, double *out_724420575405524496); -void car_H_24(double *state, double *unused, double *out_2755415215857636620); -void car_h_30(double *state, double *unused, double *out_5458903881474463195); -void car_H_30(double *state, double *unused, double *out_2414296680957537966); -void car_h_26(double *state, double *unused, double *out_7645972956349057858); -void car_H_26(double *state, double *unused, double *out_1628103669703985992); -void car_h_27(double *state, double *unused, double *out_2579304498381259655); -void car_H_27(double *state, double *unused, double *out_190702609773594749); -void car_h_29(double *state, double *unused, double *out_7986166924574242776); -void car_H_29(double *state, double *unused, double *out_1904065336643145782); -void car_h_28(double *state, double *unused, double *out_3819737019032589491); -void car_H_28(double *state, double *unused, double *out_6986464353712676356); -void car_h_31(double *state, double *unused, double *out_6059818297533608340); -void car_H_31(double *state, double *unused, double *out_2254311771937337468); +void car_err_fun(double *nom_x, double *delta_x, double *out_5232047554535600109); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_5926361318328117466); +void car_H_mod_fun(double *state, double *out_8663045025294862621); +void car_f_fun(double *state, double dt, double *out_4712382669747920854); +void car_F_fun(double *state, double dt, double *out_6132820248099245599); +void car_h_25(double *state, double *unused, double *out_8954572363719808224); +void car_H_25(double *state, double *unused, double *out_6260718398425197318); +void car_h_24(double *state, double *unused, double *out_573451915361062774); +void car_H_24(double *state, double *unused, double *out_8433367997430696884); +void car_h_30(double *state, double *unused, double *out_995511028726003400); +void car_H_30(double *state, double *unused, double *out_655971943066419437); +void car_h_26(double *state, double *unused, double *out_8430654463154704213); +void car_H_26(double *state, double *unused, double *out_8444522356410298074); +void car_h_27(double *state, double *unused, double *out_8548661857088080957); +void car_H_27(double *state, double *unused, double *out_1518791368734005474); +void car_h_29(double *state, double *unused, double *out_589055427595770225); +void car_H_29(double *state, double *unused, double *out_3232154095603556507); +void car_h_28(double *state, double *unused, double *out_7867012193673341893); +void car_H_28(double *state, double *unused, double *out_8314553112673087081); +void car_h_31(double *state, double *unused, double *out_2027016737343401600); +void car_H_31(double *state, double *unused, double *out_6230072436548236890); void car_predict(double *in_x, double *in_P, double *in_Q, double dt); void car_set_mass(double x); void car_set_rotational_inertia(double x); diff --git a/selfdrive/locationd/models/generated/pose.cpp b/selfdrive/locationd/models/generated/pose.cpp index 565724cd0..b03c81f4f 100644 --- a/selfdrive/locationd/models/generated/pose.cpp +++ b/selfdrive/locationd/models/generated/pose.cpp @@ -17,961 +17,961 @@ const static double MAHA_THRESH_14 = 7.814727903251177; * * * This file is part of 'ekf' * ******************************************************************************/ -void err_fun(double *nom_x, double *delta_x, double *out_3597460724364137401) { - out_3597460724364137401[0] = delta_x[0] + nom_x[0]; - out_3597460724364137401[1] = delta_x[1] + nom_x[1]; - out_3597460724364137401[2] = delta_x[2] + nom_x[2]; - out_3597460724364137401[3] = delta_x[3] + nom_x[3]; - out_3597460724364137401[4] = delta_x[4] + nom_x[4]; - out_3597460724364137401[5] = delta_x[5] + nom_x[5]; - out_3597460724364137401[6] = delta_x[6] + nom_x[6]; - out_3597460724364137401[7] = delta_x[7] + nom_x[7]; - out_3597460724364137401[8] = delta_x[8] + nom_x[8]; - out_3597460724364137401[9] = delta_x[9] + nom_x[9]; - out_3597460724364137401[10] = delta_x[10] + nom_x[10]; - out_3597460724364137401[11] = delta_x[11] + nom_x[11]; - out_3597460724364137401[12] = delta_x[12] + nom_x[12]; - out_3597460724364137401[13] = delta_x[13] + nom_x[13]; - out_3597460724364137401[14] = delta_x[14] + nom_x[14]; - out_3597460724364137401[15] = delta_x[15] + nom_x[15]; - out_3597460724364137401[16] = delta_x[16] + nom_x[16]; - out_3597460724364137401[17] = delta_x[17] + nom_x[17]; +void err_fun(double *nom_x, double *delta_x, double *out_4038237010904669995) { + out_4038237010904669995[0] = delta_x[0] + nom_x[0]; + out_4038237010904669995[1] = delta_x[1] + nom_x[1]; + out_4038237010904669995[2] = delta_x[2] + nom_x[2]; + out_4038237010904669995[3] = delta_x[3] + nom_x[3]; + out_4038237010904669995[4] = delta_x[4] + nom_x[4]; + out_4038237010904669995[5] = delta_x[5] + nom_x[5]; + out_4038237010904669995[6] = delta_x[6] + nom_x[6]; + out_4038237010904669995[7] = delta_x[7] + nom_x[7]; + out_4038237010904669995[8] = delta_x[8] + nom_x[8]; + out_4038237010904669995[9] = delta_x[9] + nom_x[9]; + out_4038237010904669995[10] = delta_x[10] + nom_x[10]; + out_4038237010904669995[11] = delta_x[11] + nom_x[11]; + out_4038237010904669995[12] = delta_x[12] + nom_x[12]; + out_4038237010904669995[13] = delta_x[13] + nom_x[13]; + out_4038237010904669995[14] = delta_x[14] + nom_x[14]; + out_4038237010904669995[15] = delta_x[15] + nom_x[15]; + out_4038237010904669995[16] = delta_x[16] + nom_x[16]; + out_4038237010904669995[17] = delta_x[17] + nom_x[17]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_1062002485999931142) { - out_1062002485999931142[0] = -nom_x[0] + true_x[0]; - out_1062002485999931142[1] = -nom_x[1] + true_x[1]; - out_1062002485999931142[2] = -nom_x[2] + true_x[2]; - out_1062002485999931142[3] = -nom_x[3] + true_x[3]; - out_1062002485999931142[4] = -nom_x[4] + true_x[4]; - out_1062002485999931142[5] = -nom_x[5] + true_x[5]; - out_1062002485999931142[6] = -nom_x[6] + true_x[6]; - out_1062002485999931142[7] = -nom_x[7] + true_x[7]; - out_1062002485999931142[8] = -nom_x[8] + true_x[8]; - out_1062002485999931142[9] = -nom_x[9] + true_x[9]; - out_1062002485999931142[10] = -nom_x[10] + true_x[10]; - out_1062002485999931142[11] = -nom_x[11] + true_x[11]; - out_1062002485999931142[12] = -nom_x[12] + true_x[12]; - out_1062002485999931142[13] = -nom_x[13] + true_x[13]; - out_1062002485999931142[14] = -nom_x[14] + true_x[14]; - out_1062002485999931142[15] = -nom_x[15] + true_x[15]; - out_1062002485999931142[16] = -nom_x[16] + true_x[16]; - out_1062002485999931142[17] = -nom_x[17] + true_x[17]; +void inv_err_fun(double *nom_x, double *true_x, double *out_2572217743337337909) { + out_2572217743337337909[0] = -nom_x[0] + true_x[0]; + out_2572217743337337909[1] = -nom_x[1] + true_x[1]; + out_2572217743337337909[2] = -nom_x[2] + true_x[2]; + out_2572217743337337909[3] = -nom_x[3] + true_x[3]; + out_2572217743337337909[4] = -nom_x[4] + true_x[4]; + out_2572217743337337909[5] = -nom_x[5] + true_x[5]; + out_2572217743337337909[6] = -nom_x[6] + true_x[6]; + out_2572217743337337909[7] = -nom_x[7] + true_x[7]; + out_2572217743337337909[8] = -nom_x[8] + true_x[8]; + out_2572217743337337909[9] = -nom_x[9] + true_x[9]; + out_2572217743337337909[10] = -nom_x[10] + true_x[10]; + out_2572217743337337909[11] = -nom_x[11] + true_x[11]; + out_2572217743337337909[12] = -nom_x[12] + true_x[12]; + out_2572217743337337909[13] = -nom_x[13] + true_x[13]; + out_2572217743337337909[14] = -nom_x[14] + true_x[14]; + out_2572217743337337909[15] = -nom_x[15] + true_x[15]; + out_2572217743337337909[16] = -nom_x[16] + true_x[16]; + out_2572217743337337909[17] = -nom_x[17] + true_x[17]; } -void H_mod_fun(double *state, double *out_4662972867475177241) { - out_4662972867475177241[0] = 1.0; - out_4662972867475177241[1] = 0.0; - out_4662972867475177241[2] = 0.0; - out_4662972867475177241[3] = 0.0; - out_4662972867475177241[4] = 0.0; - out_4662972867475177241[5] = 0.0; - out_4662972867475177241[6] = 0.0; - out_4662972867475177241[7] = 0.0; - out_4662972867475177241[8] = 0.0; - out_4662972867475177241[9] = 0.0; - out_4662972867475177241[10] = 0.0; - out_4662972867475177241[11] = 0.0; - out_4662972867475177241[12] = 0.0; - out_4662972867475177241[13] = 0.0; - out_4662972867475177241[14] = 0.0; - out_4662972867475177241[15] = 0.0; - out_4662972867475177241[16] = 0.0; - out_4662972867475177241[17] = 0.0; - out_4662972867475177241[18] = 0.0; - out_4662972867475177241[19] = 1.0; - out_4662972867475177241[20] = 0.0; - out_4662972867475177241[21] = 0.0; - out_4662972867475177241[22] = 0.0; - out_4662972867475177241[23] = 0.0; - out_4662972867475177241[24] = 0.0; - out_4662972867475177241[25] = 0.0; - out_4662972867475177241[26] = 0.0; - out_4662972867475177241[27] = 0.0; - out_4662972867475177241[28] = 0.0; - out_4662972867475177241[29] = 0.0; - out_4662972867475177241[30] = 0.0; - out_4662972867475177241[31] = 0.0; - out_4662972867475177241[32] = 0.0; - out_4662972867475177241[33] = 0.0; - out_4662972867475177241[34] = 0.0; - out_4662972867475177241[35] = 0.0; - out_4662972867475177241[36] = 0.0; - out_4662972867475177241[37] = 0.0; - out_4662972867475177241[38] = 1.0; - out_4662972867475177241[39] = 0.0; - out_4662972867475177241[40] = 0.0; - out_4662972867475177241[41] = 0.0; - out_4662972867475177241[42] = 0.0; - out_4662972867475177241[43] = 0.0; - out_4662972867475177241[44] = 0.0; - out_4662972867475177241[45] = 0.0; - out_4662972867475177241[46] = 0.0; - out_4662972867475177241[47] = 0.0; - out_4662972867475177241[48] = 0.0; - out_4662972867475177241[49] = 0.0; - out_4662972867475177241[50] = 0.0; - out_4662972867475177241[51] = 0.0; - out_4662972867475177241[52] = 0.0; - out_4662972867475177241[53] = 0.0; - out_4662972867475177241[54] = 0.0; - out_4662972867475177241[55] = 0.0; - out_4662972867475177241[56] = 0.0; - out_4662972867475177241[57] = 1.0; - out_4662972867475177241[58] = 0.0; - out_4662972867475177241[59] = 0.0; - out_4662972867475177241[60] = 0.0; - out_4662972867475177241[61] = 0.0; - out_4662972867475177241[62] = 0.0; - out_4662972867475177241[63] = 0.0; - out_4662972867475177241[64] = 0.0; - out_4662972867475177241[65] = 0.0; - out_4662972867475177241[66] = 0.0; - out_4662972867475177241[67] = 0.0; - out_4662972867475177241[68] = 0.0; - out_4662972867475177241[69] = 0.0; - out_4662972867475177241[70] = 0.0; - out_4662972867475177241[71] = 0.0; - out_4662972867475177241[72] = 0.0; - out_4662972867475177241[73] = 0.0; - out_4662972867475177241[74] = 0.0; - out_4662972867475177241[75] = 0.0; - out_4662972867475177241[76] = 1.0; - out_4662972867475177241[77] = 0.0; - out_4662972867475177241[78] = 0.0; - out_4662972867475177241[79] = 0.0; - out_4662972867475177241[80] = 0.0; - out_4662972867475177241[81] = 0.0; - out_4662972867475177241[82] = 0.0; - out_4662972867475177241[83] = 0.0; - out_4662972867475177241[84] = 0.0; - out_4662972867475177241[85] = 0.0; - out_4662972867475177241[86] = 0.0; - out_4662972867475177241[87] = 0.0; - out_4662972867475177241[88] = 0.0; - out_4662972867475177241[89] = 0.0; - out_4662972867475177241[90] = 0.0; - out_4662972867475177241[91] = 0.0; - out_4662972867475177241[92] = 0.0; - out_4662972867475177241[93] = 0.0; - out_4662972867475177241[94] = 0.0; - out_4662972867475177241[95] = 1.0; - out_4662972867475177241[96] = 0.0; - out_4662972867475177241[97] = 0.0; - out_4662972867475177241[98] = 0.0; - out_4662972867475177241[99] = 0.0; - out_4662972867475177241[100] = 0.0; - out_4662972867475177241[101] = 0.0; - out_4662972867475177241[102] = 0.0; - out_4662972867475177241[103] = 0.0; - out_4662972867475177241[104] = 0.0; - out_4662972867475177241[105] = 0.0; - out_4662972867475177241[106] = 0.0; - out_4662972867475177241[107] = 0.0; - out_4662972867475177241[108] = 0.0; - out_4662972867475177241[109] = 0.0; - out_4662972867475177241[110] = 0.0; - out_4662972867475177241[111] = 0.0; - out_4662972867475177241[112] = 0.0; - out_4662972867475177241[113] = 0.0; - out_4662972867475177241[114] = 1.0; - out_4662972867475177241[115] = 0.0; - out_4662972867475177241[116] = 0.0; - out_4662972867475177241[117] = 0.0; - out_4662972867475177241[118] = 0.0; - out_4662972867475177241[119] = 0.0; - out_4662972867475177241[120] = 0.0; - out_4662972867475177241[121] = 0.0; - out_4662972867475177241[122] = 0.0; - out_4662972867475177241[123] = 0.0; - out_4662972867475177241[124] = 0.0; - out_4662972867475177241[125] = 0.0; - out_4662972867475177241[126] = 0.0; - out_4662972867475177241[127] = 0.0; - out_4662972867475177241[128] = 0.0; - out_4662972867475177241[129] = 0.0; - out_4662972867475177241[130] = 0.0; - out_4662972867475177241[131] = 0.0; - out_4662972867475177241[132] = 0.0; - out_4662972867475177241[133] = 1.0; - out_4662972867475177241[134] = 0.0; - out_4662972867475177241[135] = 0.0; - out_4662972867475177241[136] = 0.0; - out_4662972867475177241[137] = 0.0; - out_4662972867475177241[138] = 0.0; - out_4662972867475177241[139] = 0.0; - out_4662972867475177241[140] = 0.0; - out_4662972867475177241[141] = 0.0; - out_4662972867475177241[142] = 0.0; - out_4662972867475177241[143] = 0.0; - out_4662972867475177241[144] = 0.0; - out_4662972867475177241[145] = 0.0; - out_4662972867475177241[146] = 0.0; - out_4662972867475177241[147] = 0.0; - out_4662972867475177241[148] = 0.0; - out_4662972867475177241[149] = 0.0; - out_4662972867475177241[150] = 0.0; - out_4662972867475177241[151] = 0.0; - out_4662972867475177241[152] = 1.0; - out_4662972867475177241[153] = 0.0; - out_4662972867475177241[154] = 0.0; - out_4662972867475177241[155] = 0.0; - out_4662972867475177241[156] = 0.0; - out_4662972867475177241[157] = 0.0; - out_4662972867475177241[158] = 0.0; - out_4662972867475177241[159] = 0.0; - out_4662972867475177241[160] = 0.0; - out_4662972867475177241[161] = 0.0; - out_4662972867475177241[162] = 0.0; - out_4662972867475177241[163] = 0.0; - out_4662972867475177241[164] = 0.0; - out_4662972867475177241[165] = 0.0; - out_4662972867475177241[166] = 0.0; - out_4662972867475177241[167] = 0.0; - out_4662972867475177241[168] = 0.0; - out_4662972867475177241[169] = 0.0; - out_4662972867475177241[170] = 0.0; - out_4662972867475177241[171] = 1.0; - out_4662972867475177241[172] = 0.0; - out_4662972867475177241[173] = 0.0; - out_4662972867475177241[174] = 0.0; - out_4662972867475177241[175] = 0.0; - out_4662972867475177241[176] = 0.0; - out_4662972867475177241[177] = 0.0; - out_4662972867475177241[178] = 0.0; - out_4662972867475177241[179] = 0.0; - out_4662972867475177241[180] = 0.0; - out_4662972867475177241[181] = 0.0; - out_4662972867475177241[182] = 0.0; - out_4662972867475177241[183] = 0.0; - out_4662972867475177241[184] = 0.0; - out_4662972867475177241[185] = 0.0; - out_4662972867475177241[186] = 0.0; - out_4662972867475177241[187] = 0.0; - out_4662972867475177241[188] = 0.0; - out_4662972867475177241[189] = 0.0; - out_4662972867475177241[190] = 1.0; - out_4662972867475177241[191] = 0.0; - out_4662972867475177241[192] = 0.0; - out_4662972867475177241[193] = 0.0; - out_4662972867475177241[194] = 0.0; - out_4662972867475177241[195] = 0.0; - out_4662972867475177241[196] = 0.0; - out_4662972867475177241[197] = 0.0; - out_4662972867475177241[198] = 0.0; - out_4662972867475177241[199] = 0.0; - out_4662972867475177241[200] = 0.0; - out_4662972867475177241[201] = 0.0; - out_4662972867475177241[202] = 0.0; - out_4662972867475177241[203] = 0.0; - out_4662972867475177241[204] = 0.0; - out_4662972867475177241[205] = 0.0; - out_4662972867475177241[206] = 0.0; - out_4662972867475177241[207] = 0.0; - out_4662972867475177241[208] = 0.0; - out_4662972867475177241[209] = 1.0; - out_4662972867475177241[210] = 0.0; - out_4662972867475177241[211] = 0.0; - out_4662972867475177241[212] = 0.0; - out_4662972867475177241[213] = 0.0; - out_4662972867475177241[214] = 0.0; - out_4662972867475177241[215] = 0.0; - out_4662972867475177241[216] = 0.0; - out_4662972867475177241[217] = 0.0; - out_4662972867475177241[218] = 0.0; - out_4662972867475177241[219] = 0.0; - out_4662972867475177241[220] = 0.0; - out_4662972867475177241[221] = 0.0; - out_4662972867475177241[222] = 0.0; - out_4662972867475177241[223] = 0.0; - out_4662972867475177241[224] = 0.0; - out_4662972867475177241[225] = 0.0; - out_4662972867475177241[226] = 0.0; - out_4662972867475177241[227] = 0.0; - out_4662972867475177241[228] = 1.0; - out_4662972867475177241[229] = 0.0; - out_4662972867475177241[230] = 0.0; - out_4662972867475177241[231] = 0.0; - out_4662972867475177241[232] = 0.0; - out_4662972867475177241[233] = 0.0; - out_4662972867475177241[234] = 0.0; - out_4662972867475177241[235] = 0.0; - out_4662972867475177241[236] = 0.0; - out_4662972867475177241[237] = 0.0; - out_4662972867475177241[238] = 0.0; - out_4662972867475177241[239] = 0.0; - out_4662972867475177241[240] = 0.0; - out_4662972867475177241[241] = 0.0; - out_4662972867475177241[242] = 0.0; - out_4662972867475177241[243] = 0.0; - out_4662972867475177241[244] = 0.0; - out_4662972867475177241[245] = 0.0; - out_4662972867475177241[246] = 0.0; - out_4662972867475177241[247] = 1.0; - out_4662972867475177241[248] = 0.0; - out_4662972867475177241[249] = 0.0; - out_4662972867475177241[250] = 0.0; - out_4662972867475177241[251] = 0.0; - out_4662972867475177241[252] = 0.0; - out_4662972867475177241[253] = 0.0; - out_4662972867475177241[254] = 0.0; - out_4662972867475177241[255] = 0.0; - out_4662972867475177241[256] = 0.0; - out_4662972867475177241[257] = 0.0; - out_4662972867475177241[258] = 0.0; - out_4662972867475177241[259] = 0.0; - out_4662972867475177241[260] = 0.0; - out_4662972867475177241[261] = 0.0; - out_4662972867475177241[262] = 0.0; - out_4662972867475177241[263] = 0.0; - out_4662972867475177241[264] = 0.0; - out_4662972867475177241[265] = 0.0; - out_4662972867475177241[266] = 1.0; - out_4662972867475177241[267] = 0.0; - out_4662972867475177241[268] = 0.0; - out_4662972867475177241[269] = 0.0; - out_4662972867475177241[270] = 0.0; - out_4662972867475177241[271] = 0.0; - out_4662972867475177241[272] = 0.0; - out_4662972867475177241[273] = 0.0; - out_4662972867475177241[274] = 0.0; - out_4662972867475177241[275] = 0.0; - out_4662972867475177241[276] = 0.0; - out_4662972867475177241[277] = 0.0; - out_4662972867475177241[278] = 0.0; - out_4662972867475177241[279] = 0.0; - out_4662972867475177241[280] = 0.0; - out_4662972867475177241[281] = 0.0; - out_4662972867475177241[282] = 0.0; - out_4662972867475177241[283] = 0.0; - out_4662972867475177241[284] = 0.0; - out_4662972867475177241[285] = 1.0; - out_4662972867475177241[286] = 0.0; - out_4662972867475177241[287] = 0.0; - out_4662972867475177241[288] = 0.0; - out_4662972867475177241[289] = 0.0; - out_4662972867475177241[290] = 0.0; - out_4662972867475177241[291] = 0.0; - out_4662972867475177241[292] = 0.0; - out_4662972867475177241[293] = 0.0; - out_4662972867475177241[294] = 0.0; - out_4662972867475177241[295] = 0.0; - out_4662972867475177241[296] = 0.0; - out_4662972867475177241[297] = 0.0; - out_4662972867475177241[298] = 0.0; - out_4662972867475177241[299] = 0.0; - out_4662972867475177241[300] = 0.0; - out_4662972867475177241[301] = 0.0; - out_4662972867475177241[302] = 0.0; - out_4662972867475177241[303] = 0.0; - out_4662972867475177241[304] = 1.0; - out_4662972867475177241[305] = 0.0; - out_4662972867475177241[306] = 0.0; - out_4662972867475177241[307] = 0.0; - out_4662972867475177241[308] = 0.0; - out_4662972867475177241[309] = 0.0; - out_4662972867475177241[310] = 0.0; - out_4662972867475177241[311] = 0.0; - out_4662972867475177241[312] = 0.0; - out_4662972867475177241[313] = 0.0; - out_4662972867475177241[314] = 0.0; - out_4662972867475177241[315] = 0.0; - out_4662972867475177241[316] = 0.0; - out_4662972867475177241[317] = 0.0; - out_4662972867475177241[318] = 0.0; - out_4662972867475177241[319] = 0.0; - out_4662972867475177241[320] = 0.0; - out_4662972867475177241[321] = 0.0; - out_4662972867475177241[322] = 0.0; - out_4662972867475177241[323] = 1.0; +void H_mod_fun(double *state, double *out_362240871876916223) { + out_362240871876916223[0] = 1.0; + out_362240871876916223[1] = 0.0; + out_362240871876916223[2] = 0.0; + out_362240871876916223[3] = 0.0; + out_362240871876916223[4] = 0.0; + out_362240871876916223[5] = 0.0; + out_362240871876916223[6] = 0.0; + out_362240871876916223[7] = 0.0; + out_362240871876916223[8] = 0.0; + out_362240871876916223[9] = 0.0; + out_362240871876916223[10] = 0.0; + out_362240871876916223[11] = 0.0; + out_362240871876916223[12] = 0.0; + out_362240871876916223[13] = 0.0; + out_362240871876916223[14] = 0.0; + out_362240871876916223[15] = 0.0; + out_362240871876916223[16] = 0.0; + out_362240871876916223[17] = 0.0; + out_362240871876916223[18] = 0.0; + out_362240871876916223[19] = 1.0; + out_362240871876916223[20] = 0.0; + out_362240871876916223[21] = 0.0; + out_362240871876916223[22] = 0.0; + out_362240871876916223[23] = 0.0; + out_362240871876916223[24] = 0.0; + out_362240871876916223[25] = 0.0; + out_362240871876916223[26] = 0.0; + out_362240871876916223[27] = 0.0; + out_362240871876916223[28] = 0.0; + out_362240871876916223[29] = 0.0; + out_362240871876916223[30] = 0.0; + out_362240871876916223[31] = 0.0; + out_362240871876916223[32] = 0.0; + out_362240871876916223[33] = 0.0; + out_362240871876916223[34] = 0.0; + out_362240871876916223[35] = 0.0; + out_362240871876916223[36] = 0.0; + out_362240871876916223[37] = 0.0; + out_362240871876916223[38] = 1.0; + out_362240871876916223[39] = 0.0; + out_362240871876916223[40] = 0.0; + out_362240871876916223[41] = 0.0; + out_362240871876916223[42] = 0.0; + out_362240871876916223[43] = 0.0; + out_362240871876916223[44] = 0.0; + out_362240871876916223[45] = 0.0; + out_362240871876916223[46] = 0.0; + out_362240871876916223[47] = 0.0; + out_362240871876916223[48] = 0.0; + out_362240871876916223[49] = 0.0; + out_362240871876916223[50] = 0.0; + out_362240871876916223[51] = 0.0; + out_362240871876916223[52] = 0.0; + out_362240871876916223[53] = 0.0; + out_362240871876916223[54] = 0.0; + out_362240871876916223[55] = 0.0; + out_362240871876916223[56] = 0.0; + out_362240871876916223[57] = 1.0; + out_362240871876916223[58] = 0.0; + out_362240871876916223[59] = 0.0; + out_362240871876916223[60] = 0.0; + out_362240871876916223[61] = 0.0; + out_362240871876916223[62] = 0.0; + out_362240871876916223[63] = 0.0; + out_362240871876916223[64] = 0.0; + out_362240871876916223[65] = 0.0; + out_362240871876916223[66] = 0.0; + out_362240871876916223[67] = 0.0; + out_362240871876916223[68] = 0.0; + out_362240871876916223[69] = 0.0; + out_362240871876916223[70] = 0.0; + out_362240871876916223[71] = 0.0; + out_362240871876916223[72] = 0.0; + out_362240871876916223[73] = 0.0; + out_362240871876916223[74] = 0.0; + out_362240871876916223[75] = 0.0; + out_362240871876916223[76] = 1.0; + out_362240871876916223[77] = 0.0; + out_362240871876916223[78] = 0.0; + out_362240871876916223[79] = 0.0; + out_362240871876916223[80] = 0.0; + out_362240871876916223[81] = 0.0; + out_362240871876916223[82] = 0.0; + out_362240871876916223[83] = 0.0; + out_362240871876916223[84] = 0.0; + out_362240871876916223[85] = 0.0; + out_362240871876916223[86] = 0.0; + out_362240871876916223[87] = 0.0; + out_362240871876916223[88] = 0.0; + out_362240871876916223[89] = 0.0; + out_362240871876916223[90] = 0.0; + out_362240871876916223[91] = 0.0; + out_362240871876916223[92] = 0.0; + out_362240871876916223[93] = 0.0; + out_362240871876916223[94] = 0.0; + out_362240871876916223[95] = 1.0; + out_362240871876916223[96] = 0.0; + out_362240871876916223[97] = 0.0; + out_362240871876916223[98] = 0.0; + out_362240871876916223[99] = 0.0; + out_362240871876916223[100] = 0.0; + out_362240871876916223[101] = 0.0; + out_362240871876916223[102] = 0.0; + out_362240871876916223[103] = 0.0; + out_362240871876916223[104] = 0.0; + out_362240871876916223[105] = 0.0; + out_362240871876916223[106] = 0.0; + out_362240871876916223[107] = 0.0; + out_362240871876916223[108] = 0.0; + out_362240871876916223[109] = 0.0; + out_362240871876916223[110] = 0.0; + out_362240871876916223[111] = 0.0; + out_362240871876916223[112] = 0.0; + out_362240871876916223[113] = 0.0; + out_362240871876916223[114] = 1.0; + out_362240871876916223[115] = 0.0; + out_362240871876916223[116] = 0.0; + out_362240871876916223[117] = 0.0; + out_362240871876916223[118] = 0.0; + out_362240871876916223[119] = 0.0; + out_362240871876916223[120] = 0.0; + out_362240871876916223[121] = 0.0; + out_362240871876916223[122] = 0.0; + out_362240871876916223[123] = 0.0; + out_362240871876916223[124] = 0.0; + out_362240871876916223[125] = 0.0; + out_362240871876916223[126] = 0.0; + out_362240871876916223[127] = 0.0; + out_362240871876916223[128] = 0.0; + out_362240871876916223[129] = 0.0; + out_362240871876916223[130] = 0.0; + out_362240871876916223[131] = 0.0; + out_362240871876916223[132] = 0.0; + out_362240871876916223[133] = 1.0; + out_362240871876916223[134] = 0.0; + out_362240871876916223[135] = 0.0; + out_362240871876916223[136] = 0.0; + out_362240871876916223[137] = 0.0; + out_362240871876916223[138] = 0.0; + out_362240871876916223[139] = 0.0; + out_362240871876916223[140] = 0.0; + out_362240871876916223[141] = 0.0; + out_362240871876916223[142] = 0.0; + out_362240871876916223[143] = 0.0; + out_362240871876916223[144] = 0.0; + out_362240871876916223[145] = 0.0; + out_362240871876916223[146] = 0.0; + out_362240871876916223[147] = 0.0; + out_362240871876916223[148] = 0.0; + out_362240871876916223[149] = 0.0; + out_362240871876916223[150] = 0.0; + out_362240871876916223[151] = 0.0; + out_362240871876916223[152] = 1.0; + out_362240871876916223[153] = 0.0; + out_362240871876916223[154] = 0.0; + out_362240871876916223[155] = 0.0; + out_362240871876916223[156] = 0.0; + out_362240871876916223[157] = 0.0; + out_362240871876916223[158] = 0.0; + out_362240871876916223[159] = 0.0; + out_362240871876916223[160] = 0.0; + out_362240871876916223[161] = 0.0; + out_362240871876916223[162] = 0.0; + out_362240871876916223[163] = 0.0; + out_362240871876916223[164] = 0.0; + out_362240871876916223[165] = 0.0; + out_362240871876916223[166] = 0.0; + out_362240871876916223[167] = 0.0; + out_362240871876916223[168] = 0.0; + out_362240871876916223[169] = 0.0; + out_362240871876916223[170] = 0.0; + out_362240871876916223[171] = 1.0; + out_362240871876916223[172] = 0.0; + out_362240871876916223[173] = 0.0; + out_362240871876916223[174] = 0.0; + out_362240871876916223[175] = 0.0; + out_362240871876916223[176] = 0.0; + out_362240871876916223[177] = 0.0; + out_362240871876916223[178] = 0.0; + out_362240871876916223[179] = 0.0; + out_362240871876916223[180] = 0.0; + out_362240871876916223[181] = 0.0; + out_362240871876916223[182] = 0.0; + out_362240871876916223[183] = 0.0; + out_362240871876916223[184] = 0.0; + out_362240871876916223[185] = 0.0; + out_362240871876916223[186] = 0.0; + out_362240871876916223[187] = 0.0; + out_362240871876916223[188] = 0.0; + out_362240871876916223[189] = 0.0; + out_362240871876916223[190] = 1.0; + out_362240871876916223[191] = 0.0; + out_362240871876916223[192] = 0.0; + out_362240871876916223[193] = 0.0; + out_362240871876916223[194] = 0.0; + out_362240871876916223[195] = 0.0; + out_362240871876916223[196] = 0.0; + out_362240871876916223[197] = 0.0; + out_362240871876916223[198] = 0.0; + out_362240871876916223[199] = 0.0; + out_362240871876916223[200] = 0.0; + out_362240871876916223[201] = 0.0; + out_362240871876916223[202] = 0.0; + out_362240871876916223[203] = 0.0; + out_362240871876916223[204] = 0.0; + out_362240871876916223[205] = 0.0; + out_362240871876916223[206] = 0.0; + out_362240871876916223[207] = 0.0; + out_362240871876916223[208] = 0.0; + out_362240871876916223[209] = 1.0; + out_362240871876916223[210] = 0.0; + out_362240871876916223[211] = 0.0; + out_362240871876916223[212] = 0.0; + out_362240871876916223[213] = 0.0; + out_362240871876916223[214] = 0.0; + out_362240871876916223[215] = 0.0; + out_362240871876916223[216] = 0.0; + out_362240871876916223[217] = 0.0; + out_362240871876916223[218] = 0.0; + out_362240871876916223[219] = 0.0; + out_362240871876916223[220] = 0.0; + out_362240871876916223[221] = 0.0; + out_362240871876916223[222] = 0.0; + out_362240871876916223[223] = 0.0; + out_362240871876916223[224] = 0.0; + out_362240871876916223[225] = 0.0; + out_362240871876916223[226] = 0.0; + out_362240871876916223[227] = 0.0; + out_362240871876916223[228] = 1.0; + out_362240871876916223[229] = 0.0; + out_362240871876916223[230] = 0.0; + out_362240871876916223[231] = 0.0; + out_362240871876916223[232] = 0.0; + out_362240871876916223[233] = 0.0; + out_362240871876916223[234] = 0.0; + out_362240871876916223[235] = 0.0; + out_362240871876916223[236] = 0.0; + out_362240871876916223[237] = 0.0; + out_362240871876916223[238] = 0.0; + out_362240871876916223[239] = 0.0; + out_362240871876916223[240] = 0.0; + out_362240871876916223[241] = 0.0; + out_362240871876916223[242] = 0.0; + out_362240871876916223[243] = 0.0; + out_362240871876916223[244] = 0.0; + out_362240871876916223[245] = 0.0; + out_362240871876916223[246] = 0.0; + out_362240871876916223[247] = 1.0; + out_362240871876916223[248] = 0.0; + out_362240871876916223[249] = 0.0; + out_362240871876916223[250] = 0.0; + out_362240871876916223[251] = 0.0; + out_362240871876916223[252] = 0.0; + out_362240871876916223[253] = 0.0; + out_362240871876916223[254] = 0.0; + out_362240871876916223[255] = 0.0; + out_362240871876916223[256] = 0.0; + out_362240871876916223[257] = 0.0; + out_362240871876916223[258] = 0.0; + out_362240871876916223[259] = 0.0; + out_362240871876916223[260] = 0.0; + out_362240871876916223[261] = 0.0; + out_362240871876916223[262] = 0.0; + out_362240871876916223[263] = 0.0; + out_362240871876916223[264] = 0.0; + out_362240871876916223[265] = 0.0; + out_362240871876916223[266] = 1.0; + out_362240871876916223[267] = 0.0; + out_362240871876916223[268] = 0.0; + out_362240871876916223[269] = 0.0; + out_362240871876916223[270] = 0.0; + out_362240871876916223[271] = 0.0; + out_362240871876916223[272] = 0.0; + out_362240871876916223[273] = 0.0; + out_362240871876916223[274] = 0.0; + out_362240871876916223[275] = 0.0; + out_362240871876916223[276] = 0.0; + out_362240871876916223[277] = 0.0; + out_362240871876916223[278] = 0.0; + out_362240871876916223[279] = 0.0; + out_362240871876916223[280] = 0.0; + out_362240871876916223[281] = 0.0; + out_362240871876916223[282] = 0.0; + out_362240871876916223[283] = 0.0; + out_362240871876916223[284] = 0.0; + out_362240871876916223[285] = 1.0; + out_362240871876916223[286] = 0.0; + out_362240871876916223[287] = 0.0; + out_362240871876916223[288] = 0.0; + out_362240871876916223[289] = 0.0; + out_362240871876916223[290] = 0.0; + out_362240871876916223[291] = 0.0; + out_362240871876916223[292] = 0.0; + out_362240871876916223[293] = 0.0; + out_362240871876916223[294] = 0.0; + out_362240871876916223[295] = 0.0; + out_362240871876916223[296] = 0.0; + out_362240871876916223[297] = 0.0; + out_362240871876916223[298] = 0.0; + out_362240871876916223[299] = 0.0; + out_362240871876916223[300] = 0.0; + out_362240871876916223[301] = 0.0; + out_362240871876916223[302] = 0.0; + out_362240871876916223[303] = 0.0; + out_362240871876916223[304] = 1.0; + out_362240871876916223[305] = 0.0; + out_362240871876916223[306] = 0.0; + out_362240871876916223[307] = 0.0; + out_362240871876916223[308] = 0.0; + out_362240871876916223[309] = 0.0; + out_362240871876916223[310] = 0.0; + out_362240871876916223[311] = 0.0; + out_362240871876916223[312] = 0.0; + out_362240871876916223[313] = 0.0; + out_362240871876916223[314] = 0.0; + out_362240871876916223[315] = 0.0; + out_362240871876916223[316] = 0.0; + out_362240871876916223[317] = 0.0; + out_362240871876916223[318] = 0.0; + out_362240871876916223[319] = 0.0; + out_362240871876916223[320] = 0.0; + out_362240871876916223[321] = 0.0; + out_362240871876916223[322] = 0.0; + out_362240871876916223[323] = 1.0; } -void f_fun(double *state, double dt, double *out_3840229658681249647) { - out_3840229658681249647[0] = atan2((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), -(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1])); - out_3840229658681249647[1] = asin(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8])); - out_3840229658681249647[2] = atan2(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), -(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2])); - out_3840229658681249647[3] = dt*state[12] + state[3]; - out_3840229658681249647[4] = dt*state[13] + state[4]; - out_3840229658681249647[5] = dt*state[14] + state[5]; - out_3840229658681249647[6] = state[6]; - out_3840229658681249647[7] = state[7]; - out_3840229658681249647[8] = state[8]; - out_3840229658681249647[9] = state[9]; - out_3840229658681249647[10] = state[10]; - out_3840229658681249647[11] = state[11]; - out_3840229658681249647[12] = state[12]; - out_3840229658681249647[13] = state[13]; - out_3840229658681249647[14] = state[14]; - out_3840229658681249647[15] = state[15]; - out_3840229658681249647[16] = state[16]; - out_3840229658681249647[17] = state[17]; +void f_fun(double *state, double dt, double *out_844759421205290898) { + out_844759421205290898[0] = atan2((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), -(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1])); + out_844759421205290898[1] = asin(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8])); + out_844759421205290898[2] = atan2(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), -(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2])); + out_844759421205290898[3] = dt*state[12] + state[3]; + out_844759421205290898[4] = dt*state[13] + state[4]; + out_844759421205290898[5] = dt*state[14] + state[5]; + out_844759421205290898[6] = state[6]; + out_844759421205290898[7] = state[7]; + out_844759421205290898[8] = state[8]; + out_844759421205290898[9] = state[9]; + out_844759421205290898[10] = state[10]; + out_844759421205290898[11] = state[11]; + out_844759421205290898[12] = state[12]; + out_844759421205290898[13] = state[13]; + out_844759421205290898[14] = state[14]; + out_844759421205290898[15] = state[15]; + out_844759421205290898[16] = state[16]; + out_844759421205290898[17] = state[17]; } -void F_fun(double *state, double dt, double *out_8220635292339759608) { - out_8220635292339759608[0] = ((-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*cos(state[0])*cos(state[1]) - sin(state[0])*cos(dt*state[6])*cos(dt*state[7])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + ((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*cos(state[0])*cos(state[1]) - sin(dt*state[6])*sin(state[0])*cos(dt*state[7])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_8220635292339759608[1] = ((-sin(dt*state[6])*sin(dt*state[8]) - sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*cos(state[1]) - (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*sin(state[1]) - sin(state[1])*cos(dt*state[6])*cos(dt*state[7])*cos(state[0]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*sin(state[1]) + (-sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) + sin(dt*state[8])*cos(dt*state[6]))*cos(state[1]) - sin(dt*state[6])*sin(state[1])*cos(dt*state[7])*cos(state[0]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_8220635292339759608[2] = 0; - out_8220635292339759608[3] = 0; - out_8220635292339759608[4] = 0; - out_8220635292339759608[5] = 0; - out_8220635292339759608[6] = (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(dt*cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*sin(dt*state[8]) - dt*sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-dt*sin(dt*state[6])*cos(dt*state[8]) + dt*sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) - dt*cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (dt*sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_8220635292339759608[7] = (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[6])*sin(dt*state[7])*cos(state[0])*cos(state[1]) + dt*sin(dt*state[6])*sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) - dt*sin(dt*state[6])*sin(state[1])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[7])*cos(dt*state[6])*cos(state[0])*cos(state[1]) + dt*sin(dt*state[8])*sin(state[0])*cos(dt*state[6])*cos(dt*state[7])*cos(state[1]) - dt*sin(state[1])*cos(dt*state[6])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_8220635292339759608[8] = ((dt*sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + dt*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (dt*sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + ((dt*sin(dt*state[6])*sin(dt*state[8]) + dt*sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*cos(dt*state[8]) + dt*sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_8220635292339759608[9] = 0; - out_8220635292339759608[10] = 0; - out_8220635292339759608[11] = 0; - out_8220635292339759608[12] = 0; - out_8220635292339759608[13] = 0; - out_8220635292339759608[14] = 0; - out_8220635292339759608[15] = 0; - out_8220635292339759608[16] = 0; - out_8220635292339759608[17] = 0; - out_8220635292339759608[18] = (-sin(dt*state[7])*sin(state[0])*cos(state[1]) - sin(dt*state[8])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); - out_8220635292339759608[19] = (-sin(dt*state[7])*sin(state[1])*cos(state[0]) + sin(dt*state[8])*sin(state[0])*sin(state[1])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); - out_8220635292339759608[20] = 0; - out_8220635292339759608[21] = 0; - out_8220635292339759608[22] = 0; - out_8220635292339759608[23] = 0; - out_8220635292339759608[24] = 0; - out_8220635292339759608[25] = (dt*sin(dt*state[7])*sin(dt*state[8])*sin(state[0])*cos(state[1]) - dt*sin(dt*state[7])*sin(state[1])*cos(dt*state[8]) + dt*cos(dt*state[7])*cos(state[0])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); - out_8220635292339759608[26] = (-dt*sin(dt*state[8])*sin(state[1])*cos(dt*state[7]) - dt*sin(state[0])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); - out_8220635292339759608[27] = 0; - out_8220635292339759608[28] = 0; - out_8220635292339759608[29] = 0; - out_8220635292339759608[30] = 0; - out_8220635292339759608[31] = 0; - out_8220635292339759608[32] = 0; - out_8220635292339759608[33] = 0; - out_8220635292339759608[34] = 0; - out_8220635292339759608[35] = 0; - out_8220635292339759608[36] = ((sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[7]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[7]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_8220635292339759608[37] = (-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(-sin(dt*state[7])*sin(state[2])*cos(state[0])*cos(state[1]) + sin(dt*state[8])*sin(state[0])*sin(state[2])*cos(dt*state[7])*cos(state[1]) - sin(state[1])*sin(state[2])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*(-sin(dt*state[7])*cos(state[0])*cos(state[1])*cos(state[2]) + sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1])*cos(state[2]) - sin(state[1])*cos(dt*state[7])*cos(dt*state[8])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_8220635292339759608[38] = ((-sin(state[0])*sin(state[2]) - sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (-sin(state[0])*sin(state[1])*sin(state[2]) - cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_8220635292339759608[39] = 0; - out_8220635292339759608[40] = 0; - out_8220635292339759608[41] = 0; - out_8220635292339759608[42] = 0; - out_8220635292339759608[43] = (-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(dt*(sin(state[0])*cos(state[2]) - sin(state[1])*sin(state[2])*cos(state[0]))*cos(dt*state[7]) - dt*(sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[7])*sin(dt*state[8]) - dt*sin(dt*state[7])*sin(state[2])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*(dt*(-sin(state[0])*sin(state[2]) - sin(state[1])*cos(state[0])*cos(state[2]))*cos(dt*state[7]) - dt*(sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[7])*sin(dt*state[8]) - dt*sin(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_8220635292339759608[44] = (dt*(sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*cos(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*sin(state[2])*cos(dt*state[7])*cos(state[1]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + (dt*(sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*cos(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[7])*cos(state[1])*cos(state[2]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_8220635292339759608[45] = 0; - out_8220635292339759608[46] = 0; - out_8220635292339759608[47] = 0; - out_8220635292339759608[48] = 0; - out_8220635292339759608[49] = 0; - out_8220635292339759608[50] = 0; - out_8220635292339759608[51] = 0; - out_8220635292339759608[52] = 0; - out_8220635292339759608[53] = 0; - out_8220635292339759608[54] = 0; - out_8220635292339759608[55] = 0; - out_8220635292339759608[56] = 0; - out_8220635292339759608[57] = 1; - out_8220635292339759608[58] = 0; - out_8220635292339759608[59] = 0; - out_8220635292339759608[60] = 0; - out_8220635292339759608[61] = 0; - out_8220635292339759608[62] = 0; - out_8220635292339759608[63] = 0; - out_8220635292339759608[64] = 0; - out_8220635292339759608[65] = 0; - out_8220635292339759608[66] = dt; - out_8220635292339759608[67] = 0; - out_8220635292339759608[68] = 0; - out_8220635292339759608[69] = 0; - out_8220635292339759608[70] = 0; - out_8220635292339759608[71] = 0; - out_8220635292339759608[72] = 0; - out_8220635292339759608[73] = 0; - out_8220635292339759608[74] = 0; - out_8220635292339759608[75] = 0; - out_8220635292339759608[76] = 1; - out_8220635292339759608[77] = 0; - out_8220635292339759608[78] = 0; - out_8220635292339759608[79] = 0; - out_8220635292339759608[80] = 0; - out_8220635292339759608[81] = 0; - out_8220635292339759608[82] = 0; - out_8220635292339759608[83] = 0; - out_8220635292339759608[84] = 0; - out_8220635292339759608[85] = dt; - out_8220635292339759608[86] = 0; - out_8220635292339759608[87] = 0; - out_8220635292339759608[88] = 0; - out_8220635292339759608[89] = 0; - out_8220635292339759608[90] = 0; - out_8220635292339759608[91] = 0; - out_8220635292339759608[92] = 0; - out_8220635292339759608[93] = 0; - out_8220635292339759608[94] = 0; - out_8220635292339759608[95] = 1; - out_8220635292339759608[96] = 0; - out_8220635292339759608[97] = 0; - out_8220635292339759608[98] = 0; - out_8220635292339759608[99] = 0; - out_8220635292339759608[100] = 0; - out_8220635292339759608[101] = 0; - out_8220635292339759608[102] = 0; - out_8220635292339759608[103] = 0; - out_8220635292339759608[104] = dt; - out_8220635292339759608[105] = 0; - out_8220635292339759608[106] = 0; - out_8220635292339759608[107] = 0; - out_8220635292339759608[108] = 0; - out_8220635292339759608[109] = 0; - out_8220635292339759608[110] = 0; - out_8220635292339759608[111] = 0; - out_8220635292339759608[112] = 0; - out_8220635292339759608[113] = 0; - out_8220635292339759608[114] = 1; - out_8220635292339759608[115] = 0; - out_8220635292339759608[116] = 0; - out_8220635292339759608[117] = 0; - out_8220635292339759608[118] = 0; - out_8220635292339759608[119] = 0; - out_8220635292339759608[120] = 0; - out_8220635292339759608[121] = 0; - out_8220635292339759608[122] = 0; - out_8220635292339759608[123] = 0; - out_8220635292339759608[124] = 0; - out_8220635292339759608[125] = 0; - out_8220635292339759608[126] = 0; - out_8220635292339759608[127] = 0; - out_8220635292339759608[128] = 0; - out_8220635292339759608[129] = 0; - out_8220635292339759608[130] = 0; - out_8220635292339759608[131] = 0; - out_8220635292339759608[132] = 0; - out_8220635292339759608[133] = 1; - out_8220635292339759608[134] = 0; - out_8220635292339759608[135] = 0; - out_8220635292339759608[136] = 0; - out_8220635292339759608[137] = 0; - out_8220635292339759608[138] = 0; - out_8220635292339759608[139] = 0; - out_8220635292339759608[140] = 0; - out_8220635292339759608[141] = 0; - out_8220635292339759608[142] = 0; - out_8220635292339759608[143] = 0; - out_8220635292339759608[144] = 0; - out_8220635292339759608[145] = 0; - out_8220635292339759608[146] = 0; - out_8220635292339759608[147] = 0; - out_8220635292339759608[148] = 0; - out_8220635292339759608[149] = 0; - out_8220635292339759608[150] = 0; - out_8220635292339759608[151] = 0; - out_8220635292339759608[152] = 1; - out_8220635292339759608[153] = 0; - out_8220635292339759608[154] = 0; - out_8220635292339759608[155] = 0; - out_8220635292339759608[156] = 0; - out_8220635292339759608[157] = 0; - out_8220635292339759608[158] = 0; - out_8220635292339759608[159] = 0; - out_8220635292339759608[160] = 0; - out_8220635292339759608[161] = 0; - out_8220635292339759608[162] = 0; - out_8220635292339759608[163] = 0; - out_8220635292339759608[164] = 0; - out_8220635292339759608[165] = 0; - out_8220635292339759608[166] = 0; - out_8220635292339759608[167] = 0; - out_8220635292339759608[168] = 0; - out_8220635292339759608[169] = 0; - out_8220635292339759608[170] = 0; - out_8220635292339759608[171] = 1; - out_8220635292339759608[172] = 0; - out_8220635292339759608[173] = 0; - out_8220635292339759608[174] = 0; - out_8220635292339759608[175] = 0; - out_8220635292339759608[176] = 0; - out_8220635292339759608[177] = 0; - out_8220635292339759608[178] = 0; - out_8220635292339759608[179] = 0; - out_8220635292339759608[180] = 0; - out_8220635292339759608[181] = 0; - out_8220635292339759608[182] = 0; - out_8220635292339759608[183] = 0; - out_8220635292339759608[184] = 0; - out_8220635292339759608[185] = 0; - out_8220635292339759608[186] = 0; - out_8220635292339759608[187] = 0; - out_8220635292339759608[188] = 0; - out_8220635292339759608[189] = 0; - out_8220635292339759608[190] = 1; - out_8220635292339759608[191] = 0; - out_8220635292339759608[192] = 0; - out_8220635292339759608[193] = 0; - out_8220635292339759608[194] = 0; - out_8220635292339759608[195] = 0; - out_8220635292339759608[196] = 0; - out_8220635292339759608[197] = 0; - out_8220635292339759608[198] = 0; - out_8220635292339759608[199] = 0; - out_8220635292339759608[200] = 0; - out_8220635292339759608[201] = 0; - out_8220635292339759608[202] = 0; - out_8220635292339759608[203] = 0; - out_8220635292339759608[204] = 0; - out_8220635292339759608[205] = 0; - out_8220635292339759608[206] = 0; - out_8220635292339759608[207] = 0; - out_8220635292339759608[208] = 0; - out_8220635292339759608[209] = 1; - out_8220635292339759608[210] = 0; - out_8220635292339759608[211] = 0; - out_8220635292339759608[212] = 0; - out_8220635292339759608[213] = 0; - out_8220635292339759608[214] = 0; - out_8220635292339759608[215] = 0; - out_8220635292339759608[216] = 0; - out_8220635292339759608[217] = 0; - out_8220635292339759608[218] = 0; - out_8220635292339759608[219] = 0; - out_8220635292339759608[220] = 0; - out_8220635292339759608[221] = 0; - out_8220635292339759608[222] = 0; - out_8220635292339759608[223] = 0; - out_8220635292339759608[224] = 0; - out_8220635292339759608[225] = 0; - out_8220635292339759608[226] = 0; - out_8220635292339759608[227] = 0; - out_8220635292339759608[228] = 1; - out_8220635292339759608[229] = 0; - out_8220635292339759608[230] = 0; - out_8220635292339759608[231] = 0; - out_8220635292339759608[232] = 0; - out_8220635292339759608[233] = 0; - out_8220635292339759608[234] = 0; - out_8220635292339759608[235] = 0; - out_8220635292339759608[236] = 0; - out_8220635292339759608[237] = 0; - out_8220635292339759608[238] = 0; - out_8220635292339759608[239] = 0; - out_8220635292339759608[240] = 0; - out_8220635292339759608[241] = 0; - out_8220635292339759608[242] = 0; - out_8220635292339759608[243] = 0; - out_8220635292339759608[244] = 0; - out_8220635292339759608[245] = 0; - out_8220635292339759608[246] = 0; - out_8220635292339759608[247] = 1; - out_8220635292339759608[248] = 0; - out_8220635292339759608[249] = 0; - out_8220635292339759608[250] = 0; - out_8220635292339759608[251] = 0; - out_8220635292339759608[252] = 0; - out_8220635292339759608[253] = 0; - out_8220635292339759608[254] = 0; - out_8220635292339759608[255] = 0; - out_8220635292339759608[256] = 0; - out_8220635292339759608[257] = 0; - out_8220635292339759608[258] = 0; - out_8220635292339759608[259] = 0; - out_8220635292339759608[260] = 0; - out_8220635292339759608[261] = 0; - out_8220635292339759608[262] = 0; - out_8220635292339759608[263] = 0; - out_8220635292339759608[264] = 0; - out_8220635292339759608[265] = 0; - out_8220635292339759608[266] = 1; - out_8220635292339759608[267] = 0; - out_8220635292339759608[268] = 0; - out_8220635292339759608[269] = 0; - out_8220635292339759608[270] = 0; - out_8220635292339759608[271] = 0; - out_8220635292339759608[272] = 0; - out_8220635292339759608[273] = 0; - out_8220635292339759608[274] = 0; - out_8220635292339759608[275] = 0; - out_8220635292339759608[276] = 0; - out_8220635292339759608[277] = 0; - out_8220635292339759608[278] = 0; - out_8220635292339759608[279] = 0; - out_8220635292339759608[280] = 0; - out_8220635292339759608[281] = 0; - out_8220635292339759608[282] = 0; - out_8220635292339759608[283] = 0; - out_8220635292339759608[284] = 0; - out_8220635292339759608[285] = 1; - out_8220635292339759608[286] = 0; - out_8220635292339759608[287] = 0; - out_8220635292339759608[288] = 0; - out_8220635292339759608[289] = 0; - out_8220635292339759608[290] = 0; - out_8220635292339759608[291] = 0; - out_8220635292339759608[292] = 0; - out_8220635292339759608[293] = 0; - out_8220635292339759608[294] = 0; - out_8220635292339759608[295] = 0; - out_8220635292339759608[296] = 0; - out_8220635292339759608[297] = 0; - out_8220635292339759608[298] = 0; - out_8220635292339759608[299] = 0; - out_8220635292339759608[300] = 0; - out_8220635292339759608[301] = 0; - out_8220635292339759608[302] = 0; - out_8220635292339759608[303] = 0; - out_8220635292339759608[304] = 1; - out_8220635292339759608[305] = 0; - out_8220635292339759608[306] = 0; - out_8220635292339759608[307] = 0; - out_8220635292339759608[308] = 0; - out_8220635292339759608[309] = 0; - out_8220635292339759608[310] = 0; - out_8220635292339759608[311] = 0; - out_8220635292339759608[312] = 0; - out_8220635292339759608[313] = 0; - out_8220635292339759608[314] = 0; - out_8220635292339759608[315] = 0; - out_8220635292339759608[316] = 0; - out_8220635292339759608[317] = 0; - out_8220635292339759608[318] = 0; - out_8220635292339759608[319] = 0; - out_8220635292339759608[320] = 0; - out_8220635292339759608[321] = 0; - out_8220635292339759608[322] = 0; - out_8220635292339759608[323] = 1; +void F_fun(double *state, double dt, double *out_3409614379123282877) { + out_3409614379123282877[0] = ((-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*cos(state[0])*cos(state[1]) - sin(state[0])*cos(dt*state[6])*cos(dt*state[7])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + ((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*cos(state[0])*cos(state[1]) - sin(dt*state[6])*sin(state[0])*cos(dt*state[7])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_3409614379123282877[1] = ((-sin(dt*state[6])*sin(dt*state[8]) - sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*cos(state[1]) - (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*sin(state[1]) - sin(state[1])*cos(dt*state[6])*cos(dt*state[7])*cos(state[0]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*sin(state[1]) + (-sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) + sin(dt*state[8])*cos(dt*state[6]))*cos(state[1]) - sin(dt*state[6])*sin(state[1])*cos(dt*state[7])*cos(state[0]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_3409614379123282877[2] = 0; + out_3409614379123282877[3] = 0; + out_3409614379123282877[4] = 0; + out_3409614379123282877[5] = 0; + out_3409614379123282877[6] = (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(dt*cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*sin(dt*state[8]) - dt*sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-dt*sin(dt*state[6])*cos(dt*state[8]) + dt*sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) - dt*cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (dt*sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_3409614379123282877[7] = (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[6])*sin(dt*state[7])*cos(state[0])*cos(state[1]) + dt*sin(dt*state[6])*sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) - dt*sin(dt*state[6])*sin(state[1])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[7])*cos(dt*state[6])*cos(state[0])*cos(state[1]) + dt*sin(dt*state[8])*sin(state[0])*cos(dt*state[6])*cos(dt*state[7])*cos(state[1]) - dt*sin(state[1])*cos(dt*state[6])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_3409614379123282877[8] = ((dt*sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + dt*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (dt*sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + ((dt*sin(dt*state[6])*sin(dt*state[8]) + dt*sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*cos(dt*state[8]) + dt*sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_3409614379123282877[9] = 0; + out_3409614379123282877[10] = 0; + out_3409614379123282877[11] = 0; + out_3409614379123282877[12] = 0; + out_3409614379123282877[13] = 0; + out_3409614379123282877[14] = 0; + out_3409614379123282877[15] = 0; + out_3409614379123282877[16] = 0; + out_3409614379123282877[17] = 0; + out_3409614379123282877[18] = (-sin(dt*state[7])*sin(state[0])*cos(state[1]) - sin(dt*state[8])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); + out_3409614379123282877[19] = (-sin(dt*state[7])*sin(state[1])*cos(state[0]) + sin(dt*state[8])*sin(state[0])*sin(state[1])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); + out_3409614379123282877[20] = 0; + out_3409614379123282877[21] = 0; + out_3409614379123282877[22] = 0; + out_3409614379123282877[23] = 0; + out_3409614379123282877[24] = 0; + out_3409614379123282877[25] = (dt*sin(dt*state[7])*sin(dt*state[8])*sin(state[0])*cos(state[1]) - dt*sin(dt*state[7])*sin(state[1])*cos(dt*state[8]) + dt*cos(dt*state[7])*cos(state[0])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); + out_3409614379123282877[26] = (-dt*sin(dt*state[8])*sin(state[1])*cos(dt*state[7]) - dt*sin(state[0])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); + out_3409614379123282877[27] = 0; + out_3409614379123282877[28] = 0; + out_3409614379123282877[29] = 0; + out_3409614379123282877[30] = 0; + out_3409614379123282877[31] = 0; + out_3409614379123282877[32] = 0; + out_3409614379123282877[33] = 0; + out_3409614379123282877[34] = 0; + out_3409614379123282877[35] = 0; + out_3409614379123282877[36] = ((sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[7]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[7]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_3409614379123282877[37] = (-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(-sin(dt*state[7])*sin(state[2])*cos(state[0])*cos(state[1]) + sin(dt*state[8])*sin(state[0])*sin(state[2])*cos(dt*state[7])*cos(state[1]) - sin(state[1])*sin(state[2])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*(-sin(dt*state[7])*cos(state[0])*cos(state[1])*cos(state[2]) + sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1])*cos(state[2]) - sin(state[1])*cos(dt*state[7])*cos(dt*state[8])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_3409614379123282877[38] = ((-sin(state[0])*sin(state[2]) - sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (-sin(state[0])*sin(state[1])*sin(state[2]) - cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_3409614379123282877[39] = 0; + out_3409614379123282877[40] = 0; + out_3409614379123282877[41] = 0; + out_3409614379123282877[42] = 0; + out_3409614379123282877[43] = (-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(dt*(sin(state[0])*cos(state[2]) - sin(state[1])*sin(state[2])*cos(state[0]))*cos(dt*state[7]) - dt*(sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[7])*sin(dt*state[8]) - dt*sin(dt*state[7])*sin(state[2])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*(dt*(-sin(state[0])*sin(state[2]) - sin(state[1])*cos(state[0])*cos(state[2]))*cos(dt*state[7]) - dt*(sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[7])*sin(dt*state[8]) - dt*sin(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_3409614379123282877[44] = (dt*(sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*cos(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*sin(state[2])*cos(dt*state[7])*cos(state[1]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + (dt*(sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*cos(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[7])*cos(state[1])*cos(state[2]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_3409614379123282877[45] = 0; + out_3409614379123282877[46] = 0; + out_3409614379123282877[47] = 0; + out_3409614379123282877[48] = 0; + out_3409614379123282877[49] = 0; + out_3409614379123282877[50] = 0; + out_3409614379123282877[51] = 0; + out_3409614379123282877[52] = 0; + out_3409614379123282877[53] = 0; + out_3409614379123282877[54] = 0; + out_3409614379123282877[55] = 0; + out_3409614379123282877[56] = 0; + out_3409614379123282877[57] = 1; + out_3409614379123282877[58] = 0; + out_3409614379123282877[59] = 0; + out_3409614379123282877[60] = 0; + out_3409614379123282877[61] = 0; + out_3409614379123282877[62] = 0; + out_3409614379123282877[63] = 0; + out_3409614379123282877[64] = 0; + out_3409614379123282877[65] = 0; + out_3409614379123282877[66] = dt; + out_3409614379123282877[67] = 0; + out_3409614379123282877[68] = 0; + out_3409614379123282877[69] = 0; + out_3409614379123282877[70] = 0; + out_3409614379123282877[71] = 0; + out_3409614379123282877[72] = 0; + out_3409614379123282877[73] = 0; + out_3409614379123282877[74] = 0; + out_3409614379123282877[75] = 0; + out_3409614379123282877[76] = 1; + out_3409614379123282877[77] = 0; + out_3409614379123282877[78] = 0; + out_3409614379123282877[79] = 0; + out_3409614379123282877[80] = 0; + out_3409614379123282877[81] = 0; + out_3409614379123282877[82] = 0; + out_3409614379123282877[83] = 0; + out_3409614379123282877[84] = 0; + out_3409614379123282877[85] = dt; + out_3409614379123282877[86] = 0; + out_3409614379123282877[87] = 0; + out_3409614379123282877[88] = 0; + out_3409614379123282877[89] = 0; + out_3409614379123282877[90] = 0; + out_3409614379123282877[91] = 0; + out_3409614379123282877[92] = 0; + out_3409614379123282877[93] = 0; + out_3409614379123282877[94] = 0; + out_3409614379123282877[95] = 1; + out_3409614379123282877[96] = 0; + out_3409614379123282877[97] = 0; + out_3409614379123282877[98] = 0; + out_3409614379123282877[99] = 0; + out_3409614379123282877[100] = 0; + out_3409614379123282877[101] = 0; + out_3409614379123282877[102] = 0; + out_3409614379123282877[103] = 0; + out_3409614379123282877[104] = dt; + out_3409614379123282877[105] = 0; + out_3409614379123282877[106] = 0; + out_3409614379123282877[107] = 0; + out_3409614379123282877[108] = 0; + out_3409614379123282877[109] = 0; + out_3409614379123282877[110] = 0; + out_3409614379123282877[111] = 0; + out_3409614379123282877[112] = 0; + out_3409614379123282877[113] = 0; + out_3409614379123282877[114] = 1; + out_3409614379123282877[115] = 0; + out_3409614379123282877[116] = 0; + out_3409614379123282877[117] = 0; + out_3409614379123282877[118] = 0; + out_3409614379123282877[119] = 0; + out_3409614379123282877[120] = 0; + out_3409614379123282877[121] = 0; + out_3409614379123282877[122] = 0; + out_3409614379123282877[123] = 0; + out_3409614379123282877[124] = 0; + out_3409614379123282877[125] = 0; + out_3409614379123282877[126] = 0; + out_3409614379123282877[127] = 0; + out_3409614379123282877[128] = 0; + out_3409614379123282877[129] = 0; + out_3409614379123282877[130] = 0; + out_3409614379123282877[131] = 0; + out_3409614379123282877[132] = 0; + out_3409614379123282877[133] = 1; + out_3409614379123282877[134] = 0; + out_3409614379123282877[135] = 0; + out_3409614379123282877[136] = 0; + out_3409614379123282877[137] = 0; + out_3409614379123282877[138] = 0; + out_3409614379123282877[139] = 0; + out_3409614379123282877[140] = 0; + out_3409614379123282877[141] = 0; + out_3409614379123282877[142] = 0; + out_3409614379123282877[143] = 0; + out_3409614379123282877[144] = 0; + out_3409614379123282877[145] = 0; + out_3409614379123282877[146] = 0; + out_3409614379123282877[147] = 0; + out_3409614379123282877[148] = 0; + out_3409614379123282877[149] = 0; + out_3409614379123282877[150] = 0; + out_3409614379123282877[151] = 0; + out_3409614379123282877[152] = 1; + out_3409614379123282877[153] = 0; + out_3409614379123282877[154] = 0; + out_3409614379123282877[155] = 0; + out_3409614379123282877[156] = 0; + out_3409614379123282877[157] = 0; + out_3409614379123282877[158] = 0; + out_3409614379123282877[159] = 0; + out_3409614379123282877[160] = 0; + out_3409614379123282877[161] = 0; + out_3409614379123282877[162] = 0; + out_3409614379123282877[163] = 0; + out_3409614379123282877[164] = 0; + out_3409614379123282877[165] = 0; + out_3409614379123282877[166] = 0; + out_3409614379123282877[167] = 0; + out_3409614379123282877[168] = 0; + out_3409614379123282877[169] = 0; + out_3409614379123282877[170] = 0; + out_3409614379123282877[171] = 1; + out_3409614379123282877[172] = 0; + out_3409614379123282877[173] = 0; + out_3409614379123282877[174] = 0; + out_3409614379123282877[175] = 0; + out_3409614379123282877[176] = 0; + out_3409614379123282877[177] = 0; + out_3409614379123282877[178] = 0; + out_3409614379123282877[179] = 0; + out_3409614379123282877[180] = 0; + out_3409614379123282877[181] = 0; + out_3409614379123282877[182] = 0; + out_3409614379123282877[183] = 0; + out_3409614379123282877[184] = 0; + out_3409614379123282877[185] = 0; + out_3409614379123282877[186] = 0; + out_3409614379123282877[187] = 0; + out_3409614379123282877[188] = 0; + out_3409614379123282877[189] = 0; + out_3409614379123282877[190] = 1; + out_3409614379123282877[191] = 0; + out_3409614379123282877[192] = 0; + out_3409614379123282877[193] = 0; + out_3409614379123282877[194] = 0; + out_3409614379123282877[195] = 0; + out_3409614379123282877[196] = 0; + out_3409614379123282877[197] = 0; + out_3409614379123282877[198] = 0; + out_3409614379123282877[199] = 0; + out_3409614379123282877[200] = 0; + out_3409614379123282877[201] = 0; + out_3409614379123282877[202] = 0; + out_3409614379123282877[203] = 0; + out_3409614379123282877[204] = 0; + out_3409614379123282877[205] = 0; + out_3409614379123282877[206] = 0; + out_3409614379123282877[207] = 0; + out_3409614379123282877[208] = 0; + out_3409614379123282877[209] = 1; + out_3409614379123282877[210] = 0; + out_3409614379123282877[211] = 0; + out_3409614379123282877[212] = 0; + out_3409614379123282877[213] = 0; + out_3409614379123282877[214] = 0; + out_3409614379123282877[215] = 0; + out_3409614379123282877[216] = 0; + out_3409614379123282877[217] = 0; + out_3409614379123282877[218] = 0; + out_3409614379123282877[219] = 0; + out_3409614379123282877[220] = 0; + out_3409614379123282877[221] = 0; + out_3409614379123282877[222] = 0; + out_3409614379123282877[223] = 0; + out_3409614379123282877[224] = 0; + out_3409614379123282877[225] = 0; + out_3409614379123282877[226] = 0; + out_3409614379123282877[227] = 0; + out_3409614379123282877[228] = 1; + out_3409614379123282877[229] = 0; + out_3409614379123282877[230] = 0; + out_3409614379123282877[231] = 0; + out_3409614379123282877[232] = 0; + out_3409614379123282877[233] = 0; + out_3409614379123282877[234] = 0; + out_3409614379123282877[235] = 0; + out_3409614379123282877[236] = 0; + out_3409614379123282877[237] = 0; + out_3409614379123282877[238] = 0; + out_3409614379123282877[239] = 0; + out_3409614379123282877[240] = 0; + out_3409614379123282877[241] = 0; + out_3409614379123282877[242] = 0; + out_3409614379123282877[243] = 0; + out_3409614379123282877[244] = 0; + out_3409614379123282877[245] = 0; + out_3409614379123282877[246] = 0; + out_3409614379123282877[247] = 1; + out_3409614379123282877[248] = 0; + out_3409614379123282877[249] = 0; + out_3409614379123282877[250] = 0; + out_3409614379123282877[251] = 0; + out_3409614379123282877[252] = 0; + out_3409614379123282877[253] = 0; + out_3409614379123282877[254] = 0; + out_3409614379123282877[255] = 0; + out_3409614379123282877[256] = 0; + out_3409614379123282877[257] = 0; + out_3409614379123282877[258] = 0; + out_3409614379123282877[259] = 0; + out_3409614379123282877[260] = 0; + out_3409614379123282877[261] = 0; + out_3409614379123282877[262] = 0; + out_3409614379123282877[263] = 0; + out_3409614379123282877[264] = 0; + out_3409614379123282877[265] = 0; + out_3409614379123282877[266] = 1; + out_3409614379123282877[267] = 0; + out_3409614379123282877[268] = 0; + out_3409614379123282877[269] = 0; + out_3409614379123282877[270] = 0; + out_3409614379123282877[271] = 0; + out_3409614379123282877[272] = 0; + out_3409614379123282877[273] = 0; + out_3409614379123282877[274] = 0; + out_3409614379123282877[275] = 0; + out_3409614379123282877[276] = 0; + out_3409614379123282877[277] = 0; + out_3409614379123282877[278] = 0; + out_3409614379123282877[279] = 0; + out_3409614379123282877[280] = 0; + out_3409614379123282877[281] = 0; + out_3409614379123282877[282] = 0; + out_3409614379123282877[283] = 0; + out_3409614379123282877[284] = 0; + out_3409614379123282877[285] = 1; + out_3409614379123282877[286] = 0; + out_3409614379123282877[287] = 0; + out_3409614379123282877[288] = 0; + out_3409614379123282877[289] = 0; + out_3409614379123282877[290] = 0; + out_3409614379123282877[291] = 0; + out_3409614379123282877[292] = 0; + out_3409614379123282877[293] = 0; + out_3409614379123282877[294] = 0; + out_3409614379123282877[295] = 0; + out_3409614379123282877[296] = 0; + out_3409614379123282877[297] = 0; + out_3409614379123282877[298] = 0; + out_3409614379123282877[299] = 0; + out_3409614379123282877[300] = 0; + out_3409614379123282877[301] = 0; + out_3409614379123282877[302] = 0; + out_3409614379123282877[303] = 0; + out_3409614379123282877[304] = 1; + out_3409614379123282877[305] = 0; + out_3409614379123282877[306] = 0; + out_3409614379123282877[307] = 0; + out_3409614379123282877[308] = 0; + out_3409614379123282877[309] = 0; + out_3409614379123282877[310] = 0; + out_3409614379123282877[311] = 0; + out_3409614379123282877[312] = 0; + out_3409614379123282877[313] = 0; + out_3409614379123282877[314] = 0; + out_3409614379123282877[315] = 0; + out_3409614379123282877[316] = 0; + out_3409614379123282877[317] = 0; + out_3409614379123282877[318] = 0; + out_3409614379123282877[319] = 0; + out_3409614379123282877[320] = 0; + out_3409614379123282877[321] = 0; + out_3409614379123282877[322] = 0; + out_3409614379123282877[323] = 1; } -void h_4(double *state, double *unused, double *out_2097936204583725179) { - out_2097936204583725179[0] = state[6] + state[9]; - out_2097936204583725179[1] = state[7] + state[10]; - out_2097936204583725179[2] = state[8] + state[11]; +void h_4(double *state, double *unused, double *out_3761995773053554002) { + out_3761995773053554002[0] = state[6] + state[9]; + out_3761995773053554002[1] = state[7] + state[10]; + out_3761995773053554002[2] = state[8] + state[11]; } -void H_4(double *state, double *unused, double *out_4839409540176553033) { - out_4839409540176553033[0] = 0; - out_4839409540176553033[1] = 0; - out_4839409540176553033[2] = 0; - out_4839409540176553033[3] = 0; - out_4839409540176553033[4] = 0; - out_4839409540176553033[5] = 0; - out_4839409540176553033[6] = 1; - out_4839409540176553033[7] = 0; - out_4839409540176553033[8] = 0; - out_4839409540176553033[9] = 1; - out_4839409540176553033[10] = 0; - out_4839409540176553033[11] = 0; - out_4839409540176553033[12] = 0; - out_4839409540176553033[13] = 0; - out_4839409540176553033[14] = 0; - out_4839409540176553033[15] = 0; - out_4839409540176553033[16] = 0; - out_4839409540176553033[17] = 0; - out_4839409540176553033[18] = 0; - out_4839409540176553033[19] = 0; - out_4839409540176553033[20] = 0; - out_4839409540176553033[21] = 0; - out_4839409540176553033[22] = 0; - out_4839409540176553033[23] = 0; - out_4839409540176553033[24] = 0; - out_4839409540176553033[25] = 1; - out_4839409540176553033[26] = 0; - out_4839409540176553033[27] = 0; - out_4839409540176553033[28] = 1; - out_4839409540176553033[29] = 0; - out_4839409540176553033[30] = 0; - out_4839409540176553033[31] = 0; - out_4839409540176553033[32] = 0; - out_4839409540176553033[33] = 0; - out_4839409540176553033[34] = 0; - out_4839409540176553033[35] = 0; - out_4839409540176553033[36] = 0; - out_4839409540176553033[37] = 0; - out_4839409540176553033[38] = 0; - out_4839409540176553033[39] = 0; - out_4839409540176553033[40] = 0; - out_4839409540176553033[41] = 0; - out_4839409540176553033[42] = 0; - out_4839409540176553033[43] = 0; - out_4839409540176553033[44] = 1; - out_4839409540176553033[45] = 0; - out_4839409540176553033[46] = 0; - out_4839409540176553033[47] = 1; - out_4839409540176553033[48] = 0; - out_4839409540176553033[49] = 0; - out_4839409540176553033[50] = 0; - out_4839409540176553033[51] = 0; - out_4839409540176553033[52] = 0; - out_4839409540176553033[53] = 0; +void H_4(double *state, double *unused, double *out_4790277513162164512) { + out_4790277513162164512[0] = 0; + out_4790277513162164512[1] = 0; + out_4790277513162164512[2] = 0; + out_4790277513162164512[3] = 0; + out_4790277513162164512[4] = 0; + out_4790277513162164512[5] = 0; + out_4790277513162164512[6] = 1; + out_4790277513162164512[7] = 0; + out_4790277513162164512[8] = 0; + out_4790277513162164512[9] = 1; + out_4790277513162164512[10] = 0; + out_4790277513162164512[11] = 0; + out_4790277513162164512[12] = 0; + out_4790277513162164512[13] = 0; + out_4790277513162164512[14] = 0; + out_4790277513162164512[15] = 0; + out_4790277513162164512[16] = 0; + out_4790277513162164512[17] = 0; + out_4790277513162164512[18] = 0; + out_4790277513162164512[19] = 0; + out_4790277513162164512[20] = 0; + out_4790277513162164512[21] = 0; + out_4790277513162164512[22] = 0; + out_4790277513162164512[23] = 0; + out_4790277513162164512[24] = 0; + out_4790277513162164512[25] = 1; + out_4790277513162164512[26] = 0; + out_4790277513162164512[27] = 0; + out_4790277513162164512[28] = 1; + out_4790277513162164512[29] = 0; + out_4790277513162164512[30] = 0; + out_4790277513162164512[31] = 0; + out_4790277513162164512[32] = 0; + out_4790277513162164512[33] = 0; + out_4790277513162164512[34] = 0; + out_4790277513162164512[35] = 0; + out_4790277513162164512[36] = 0; + out_4790277513162164512[37] = 0; + out_4790277513162164512[38] = 0; + out_4790277513162164512[39] = 0; + out_4790277513162164512[40] = 0; + out_4790277513162164512[41] = 0; + out_4790277513162164512[42] = 0; + out_4790277513162164512[43] = 0; + out_4790277513162164512[44] = 1; + out_4790277513162164512[45] = 0; + out_4790277513162164512[46] = 0; + out_4790277513162164512[47] = 1; + out_4790277513162164512[48] = 0; + out_4790277513162164512[49] = 0; + out_4790277513162164512[50] = 0; + out_4790277513162164512[51] = 0; + out_4790277513162164512[52] = 0; + out_4790277513162164512[53] = 0; } -void h_10(double *state, double *unused, double *out_29444642201375045) { - out_29444642201375045[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; - out_29444642201375045[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; - out_29444642201375045[2] = -9.8100000000000005*cos(state[0])*cos(state[1]) - state[3]*state[7] + state[4]*state[6] + state[14] + state[17]; +void h_10(double *state, double *unused, double *out_1433439433765456745) { + out_1433439433765456745[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; + out_1433439433765456745[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; + out_1433439433765456745[2] = -9.8100000000000005*cos(state[0])*cos(state[1]) - state[3]*state[7] + state[4]*state[6] + state[14] + state[17]; } -void H_10(double *state, double *unused, double *out_1070049335288984001) { - out_1070049335288984001[0] = 0; - out_1070049335288984001[1] = 9.8100000000000005*cos(state[1]); - out_1070049335288984001[2] = 0; - out_1070049335288984001[3] = 0; - out_1070049335288984001[4] = -state[8]; - out_1070049335288984001[5] = state[7]; - out_1070049335288984001[6] = 0; - out_1070049335288984001[7] = state[5]; - out_1070049335288984001[8] = -state[4]; - out_1070049335288984001[9] = 0; - out_1070049335288984001[10] = 0; - out_1070049335288984001[11] = 0; - out_1070049335288984001[12] = 1; - out_1070049335288984001[13] = 0; - out_1070049335288984001[14] = 0; - out_1070049335288984001[15] = 1; - out_1070049335288984001[16] = 0; - out_1070049335288984001[17] = 0; - out_1070049335288984001[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); - out_1070049335288984001[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); - out_1070049335288984001[20] = 0; - out_1070049335288984001[21] = state[8]; - out_1070049335288984001[22] = 0; - out_1070049335288984001[23] = -state[6]; - out_1070049335288984001[24] = -state[5]; - out_1070049335288984001[25] = 0; - out_1070049335288984001[26] = state[3]; - out_1070049335288984001[27] = 0; - out_1070049335288984001[28] = 0; - out_1070049335288984001[29] = 0; - out_1070049335288984001[30] = 0; - out_1070049335288984001[31] = 1; - out_1070049335288984001[32] = 0; - out_1070049335288984001[33] = 0; - out_1070049335288984001[34] = 1; - out_1070049335288984001[35] = 0; - out_1070049335288984001[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); - out_1070049335288984001[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); - out_1070049335288984001[38] = 0; - out_1070049335288984001[39] = -state[7]; - out_1070049335288984001[40] = state[6]; - out_1070049335288984001[41] = 0; - out_1070049335288984001[42] = state[4]; - out_1070049335288984001[43] = -state[3]; - out_1070049335288984001[44] = 0; - out_1070049335288984001[45] = 0; - out_1070049335288984001[46] = 0; - out_1070049335288984001[47] = 0; - out_1070049335288984001[48] = 0; - out_1070049335288984001[49] = 0; - out_1070049335288984001[50] = 1; - out_1070049335288984001[51] = 0; - out_1070049335288984001[52] = 0; - out_1070049335288984001[53] = 1; +void H_10(double *state, double *unused, double *out_2492873908575038793) { + out_2492873908575038793[0] = 0; + out_2492873908575038793[1] = 9.8100000000000005*cos(state[1]); + out_2492873908575038793[2] = 0; + out_2492873908575038793[3] = 0; + out_2492873908575038793[4] = -state[8]; + out_2492873908575038793[5] = state[7]; + out_2492873908575038793[6] = 0; + out_2492873908575038793[7] = state[5]; + out_2492873908575038793[8] = -state[4]; + out_2492873908575038793[9] = 0; + out_2492873908575038793[10] = 0; + out_2492873908575038793[11] = 0; + out_2492873908575038793[12] = 1; + out_2492873908575038793[13] = 0; + out_2492873908575038793[14] = 0; + out_2492873908575038793[15] = 1; + out_2492873908575038793[16] = 0; + out_2492873908575038793[17] = 0; + out_2492873908575038793[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); + out_2492873908575038793[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); + out_2492873908575038793[20] = 0; + out_2492873908575038793[21] = state[8]; + out_2492873908575038793[22] = 0; + out_2492873908575038793[23] = -state[6]; + out_2492873908575038793[24] = -state[5]; + out_2492873908575038793[25] = 0; + out_2492873908575038793[26] = state[3]; + out_2492873908575038793[27] = 0; + out_2492873908575038793[28] = 0; + out_2492873908575038793[29] = 0; + out_2492873908575038793[30] = 0; + out_2492873908575038793[31] = 1; + out_2492873908575038793[32] = 0; + out_2492873908575038793[33] = 0; + out_2492873908575038793[34] = 1; + out_2492873908575038793[35] = 0; + out_2492873908575038793[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); + out_2492873908575038793[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); + out_2492873908575038793[38] = 0; + out_2492873908575038793[39] = -state[7]; + out_2492873908575038793[40] = state[6]; + out_2492873908575038793[41] = 0; + out_2492873908575038793[42] = state[4]; + out_2492873908575038793[43] = -state[3]; + out_2492873908575038793[44] = 0; + out_2492873908575038793[45] = 0; + out_2492873908575038793[46] = 0; + out_2492873908575038793[47] = 0; + out_2492873908575038793[48] = 0; + out_2492873908575038793[49] = 0; + out_2492873908575038793[50] = 1; + out_2492873908575038793[51] = 0; + out_2492873908575038793[52] = 0; + out_2492873908575038793[53] = 1; } -void h_13(double *state, double *unused, double *out_61045813616994293) { - out_61045813616994293[0] = state[3]; - out_61045813616994293[1] = state[4]; - out_61045813616994293[2] = state[5]; +void h_13(double *state, double *unused, double *out_7701755112567992010) { + out_7701755112567992010[0] = state[3]; + out_7701755112567992010[1] = state[4]; + out_7701755112567992010[2] = state[5]; } -void H_13(double *state, double *unused, double *out_8051683365508885834) { - out_8051683365508885834[0] = 0; - out_8051683365508885834[1] = 0; - out_8051683365508885834[2] = 0; - out_8051683365508885834[3] = 1; - out_8051683365508885834[4] = 0; - out_8051683365508885834[5] = 0; - out_8051683365508885834[6] = 0; - out_8051683365508885834[7] = 0; - out_8051683365508885834[8] = 0; - out_8051683365508885834[9] = 0; - out_8051683365508885834[10] = 0; - out_8051683365508885834[11] = 0; - out_8051683365508885834[12] = 0; - out_8051683365508885834[13] = 0; - out_8051683365508885834[14] = 0; - out_8051683365508885834[15] = 0; - out_8051683365508885834[16] = 0; - out_8051683365508885834[17] = 0; - out_8051683365508885834[18] = 0; - out_8051683365508885834[19] = 0; - out_8051683365508885834[20] = 0; - out_8051683365508885834[21] = 0; - out_8051683365508885834[22] = 1; - out_8051683365508885834[23] = 0; - out_8051683365508885834[24] = 0; - out_8051683365508885834[25] = 0; - out_8051683365508885834[26] = 0; - out_8051683365508885834[27] = 0; - out_8051683365508885834[28] = 0; - out_8051683365508885834[29] = 0; - out_8051683365508885834[30] = 0; - out_8051683365508885834[31] = 0; - out_8051683365508885834[32] = 0; - out_8051683365508885834[33] = 0; - out_8051683365508885834[34] = 0; - out_8051683365508885834[35] = 0; - out_8051683365508885834[36] = 0; - out_8051683365508885834[37] = 0; - out_8051683365508885834[38] = 0; - out_8051683365508885834[39] = 0; - out_8051683365508885834[40] = 0; - out_8051683365508885834[41] = 1; - out_8051683365508885834[42] = 0; - out_8051683365508885834[43] = 0; - out_8051683365508885834[44] = 0; - out_8051683365508885834[45] = 0; - out_8051683365508885834[46] = 0; - out_8051683365508885834[47] = 0; - out_8051683365508885834[48] = 0; - out_8051683365508885834[49] = 0; - out_8051683365508885834[50] = 0; - out_8051683365508885834[51] = 0; - out_8051683365508885834[52] = 0; - out_8051683365508885834[53] = 0; +void H_13(double *state, double *unused, double *out_8002551338494497313) { + out_8002551338494497313[0] = 0; + out_8002551338494497313[1] = 0; + out_8002551338494497313[2] = 0; + out_8002551338494497313[3] = 1; + out_8002551338494497313[4] = 0; + out_8002551338494497313[5] = 0; + out_8002551338494497313[6] = 0; + out_8002551338494497313[7] = 0; + out_8002551338494497313[8] = 0; + out_8002551338494497313[9] = 0; + out_8002551338494497313[10] = 0; + out_8002551338494497313[11] = 0; + out_8002551338494497313[12] = 0; + out_8002551338494497313[13] = 0; + out_8002551338494497313[14] = 0; + out_8002551338494497313[15] = 0; + out_8002551338494497313[16] = 0; + out_8002551338494497313[17] = 0; + out_8002551338494497313[18] = 0; + out_8002551338494497313[19] = 0; + out_8002551338494497313[20] = 0; + out_8002551338494497313[21] = 0; + out_8002551338494497313[22] = 1; + out_8002551338494497313[23] = 0; + out_8002551338494497313[24] = 0; + out_8002551338494497313[25] = 0; + out_8002551338494497313[26] = 0; + out_8002551338494497313[27] = 0; + out_8002551338494497313[28] = 0; + out_8002551338494497313[29] = 0; + out_8002551338494497313[30] = 0; + out_8002551338494497313[31] = 0; + out_8002551338494497313[32] = 0; + out_8002551338494497313[33] = 0; + out_8002551338494497313[34] = 0; + out_8002551338494497313[35] = 0; + out_8002551338494497313[36] = 0; + out_8002551338494497313[37] = 0; + out_8002551338494497313[38] = 0; + out_8002551338494497313[39] = 0; + out_8002551338494497313[40] = 0; + out_8002551338494497313[41] = 1; + out_8002551338494497313[42] = 0; + out_8002551338494497313[43] = 0; + out_8002551338494497313[44] = 0; + out_8002551338494497313[45] = 0; + out_8002551338494497313[46] = 0; + out_8002551338494497313[47] = 0; + out_8002551338494497313[48] = 0; + out_8002551338494497313[49] = 0; + out_8002551338494497313[50] = 0; + out_8002551338494497313[51] = 0; + out_8002551338494497313[52] = 0; + out_8002551338494497313[53] = 0; } -void h_14(double *state, double *unused, double *out_8545162578881105562) { - out_8545162578881105562[0] = state[6]; - out_8545162578881105562[1] = state[7]; - out_8545162578881105562[2] = state[8]; +void h_14(double *state, double *unused, double *out_3517024732190759371) { + out_3517024732190759371[0] = state[6]; + out_3517024732190759371[1] = state[7]; + out_3517024732190759371[2] = state[8]; } -void H_14(double *state, double *unused, double *out_4404293013531669434) { - out_4404293013531669434[0] = 0; - out_4404293013531669434[1] = 0; - out_4404293013531669434[2] = 0; - out_4404293013531669434[3] = 0; - out_4404293013531669434[4] = 0; - out_4404293013531669434[5] = 0; - out_4404293013531669434[6] = 1; - out_4404293013531669434[7] = 0; - out_4404293013531669434[8] = 0; - out_4404293013531669434[9] = 0; - out_4404293013531669434[10] = 0; - out_4404293013531669434[11] = 0; - out_4404293013531669434[12] = 0; - out_4404293013531669434[13] = 0; - out_4404293013531669434[14] = 0; - out_4404293013531669434[15] = 0; - out_4404293013531669434[16] = 0; - out_4404293013531669434[17] = 0; - out_4404293013531669434[18] = 0; - out_4404293013531669434[19] = 0; - out_4404293013531669434[20] = 0; - out_4404293013531669434[21] = 0; - out_4404293013531669434[22] = 0; - out_4404293013531669434[23] = 0; - out_4404293013531669434[24] = 0; - out_4404293013531669434[25] = 1; - out_4404293013531669434[26] = 0; - out_4404293013531669434[27] = 0; - out_4404293013531669434[28] = 0; - out_4404293013531669434[29] = 0; - out_4404293013531669434[30] = 0; - out_4404293013531669434[31] = 0; - out_4404293013531669434[32] = 0; - out_4404293013531669434[33] = 0; - out_4404293013531669434[34] = 0; - out_4404293013531669434[35] = 0; - out_4404293013531669434[36] = 0; - out_4404293013531669434[37] = 0; - out_4404293013531669434[38] = 0; - out_4404293013531669434[39] = 0; - out_4404293013531669434[40] = 0; - out_4404293013531669434[41] = 0; - out_4404293013531669434[42] = 0; - out_4404293013531669434[43] = 0; - out_4404293013531669434[44] = 1; - out_4404293013531669434[45] = 0; - out_4404293013531669434[46] = 0; - out_4404293013531669434[47] = 0; - out_4404293013531669434[48] = 0; - out_4404293013531669434[49] = 0; - out_4404293013531669434[50] = 0; - out_4404293013531669434[51] = 0; - out_4404293013531669434[52] = 0; - out_4404293013531669434[53] = 0; +void H_14(double *state, double *unused, double *out_1707489080866792216) { + out_1707489080866792216[0] = 0; + out_1707489080866792216[1] = 0; + out_1707489080866792216[2] = 0; + out_1707489080866792216[3] = 0; + out_1707489080866792216[4] = 0; + out_1707489080866792216[5] = 0; + out_1707489080866792216[6] = 1; + out_1707489080866792216[7] = 0; + out_1707489080866792216[8] = 0; + out_1707489080866792216[9] = 0; + out_1707489080866792216[10] = 0; + out_1707489080866792216[11] = 0; + out_1707489080866792216[12] = 0; + out_1707489080866792216[13] = 0; + out_1707489080866792216[14] = 0; + out_1707489080866792216[15] = 0; + out_1707489080866792216[16] = 0; + out_1707489080866792216[17] = 0; + out_1707489080866792216[18] = 0; + out_1707489080866792216[19] = 0; + out_1707489080866792216[20] = 0; + out_1707489080866792216[21] = 0; + out_1707489080866792216[22] = 0; + out_1707489080866792216[23] = 0; + out_1707489080866792216[24] = 0; + out_1707489080866792216[25] = 1; + out_1707489080866792216[26] = 0; + out_1707489080866792216[27] = 0; + out_1707489080866792216[28] = 0; + out_1707489080866792216[29] = 0; + out_1707489080866792216[30] = 0; + out_1707489080866792216[31] = 0; + out_1707489080866792216[32] = 0; + out_1707489080866792216[33] = 0; + out_1707489080866792216[34] = 0; + out_1707489080866792216[35] = 0; + out_1707489080866792216[36] = 0; + out_1707489080866792216[37] = 0; + out_1707489080866792216[38] = 0; + out_1707489080866792216[39] = 0; + out_1707489080866792216[40] = 0; + out_1707489080866792216[41] = 0; + out_1707489080866792216[42] = 0; + out_1707489080866792216[43] = 0; + out_1707489080866792216[44] = 1; + out_1707489080866792216[45] = 0; + out_1707489080866792216[46] = 0; + out_1707489080866792216[47] = 0; + out_1707489080866792216[48] = 0; + out_1707489080866792216[49] = 0; + out_1707489080866792216[50] = 0; + out_1707489080866792216[51] = 0; + out_1707489080866792216[52] = 0; + out_1707489080866792216[53] = 0; } #include #include @@ -1113,44 +1113,44 @@ void pose_update_13(double *in_x, double *in_P, double *in_z, double *in_R, doub void pose_update_14(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea) { update<3, 3, 0>(in_x, in_P, h_14, H_14, NULL, in_z, in_R, in_ea, MAHA_THRESH_14); } -void pose_err_fun(double *nom_x, double *delta_x, double *out_3597460724364137401) { - err_fun(nom_x, delta_x, out_3597460724364137401); +void pose_err_fun(double *nom_x, double *delta_x, double *out_4038237010904669995) { + err_fun(nom_x, delta_x, out_4038237010904669995); } -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_1062002485999931142) { - inv_err_fun(nom_x, true_x, out_1062002485999931142); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_2572217743337337909) { + inv_err_fun(nom_x, true_x, out_2572217743337337909); } -void pose_H_mod_fun(double *state, double *out_4662972867475177241) { - H_mod_fun(state, out_4662972867475177241); +void pose_H_mod_fun(double *state, double *out_362240871876916223) { + H_mod_fun(state, out_362240871876916223); } -void pose_f_fun(double *state, double dt, double *out_3840229658681249647) { - f_fun(state, dt, out_3840229658681249647); +void pose_f_fun(double *state, double dt, double *out_844759421205290898) { + f_fun(state, dt, out_844759421205290898); } -void pose_F_fun(double *state, double dt, double *out_8220635292339759608) { - F_fun(state, dt, out_8220635292339759608); +void pose_F_fun(double *state, double dt, double *out_3409614379123282877) { + F_fun(state, dt, out_3409614379123282877); } -void pose_h_4(double *state, double *unused, double *out_2097936204583725179) { - h_4(state, unused, out_2097936204583725179); +void pose_h_4(double *state, double *unused, double *out_3761995773053554002) { + h_4(state, unused, out_3761995773053554002); } -void pose_H_4(double *state, double *unused, double *out_4839409540176553033) { - H_4(state, unused, out_4839409540176553033); +void pose_H_4(double *state, double *unused, double *out_4790277513162164512) { + H_4(state, unused, out_4790277513162164512); } -void pose_h_10(double *state, double *unused, double *out_29444642201375045) { - h_10(state, unused, out_29444642201375045); +void pose_h_10(double *state, double *unused, double *out_1433439433765456745) { + h_10(state, unused, out_1433439433765456745); } -void pose_H_10(double *state, double *unused, double *out_1070049335288984001) { - H_10(state, unused, out_1070049335288984001); +void pose_H_10(double *state, double *unused, double *out_2492873908575038793) { + H_10(state, unused, out_2492873908575038793); } -void pose_h_13(double *state, double *unused, double *out_61045813616994293) { - h_13(state, unused, out_61045813616994293); +void pose_h_13(double *state, double *unused, double *out_7701755112567992010) { + h_13(state, unused, out_7701755112567992010); } -void pose_H_13(double *state, double *unused, double *out_8051683365508885834) { - H_13(state, unused, out_8051683365508885834); +void pose_H_13(double *state, double *unused, double *out_8002551338494497313) { + H_13(state, unused, out_8002551338494497313); } -void pose_h_14(double *state, double *unused, double *out_8545162578881105562) { - h_14(state, unused, out_8545162578881105562); +void pose_h_14(double *state, double *unused, double *out_3517024732190759371) { + h_14(state, unused, out_3517024732190759371); } -void pose_H_14(double *state, double *unused, double *out_4404293013531669434) { - H_14(state, unused, out_4404293013531669434); +void pose_H_14(double *state, double *unused, double *out_1707489080866792216) { + H_14(state, unused, out_1707489080866792216); } void pose_predict(double *in_x, double *in_P, double *in_Q, double dt) { predict(in_x, in_P, in_Q, dt); diff --git a/selfdrive/locationd/models/generated/pose.h b/selfdrive/locationd/models/generated/pose.h index 36a57ae50..af3f0c622 100644 --- a/selfdrive/locationd/models/generated/pose.h +++ b/selfdrive/locationd/models/generated/pose.h @@ -5,18 +5,18 @@ void pose_update_4(double *in_x, double *in_P, double *in_z, double *in_R, doubl void pose_update_10(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); void pose_update_13(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); void pose_update_14(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); -void pose_err_fun(double *nom_x, double *delta_x, double *out_3597460724364137401); -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_1062002485999931142); -void pose_H_mod_fun(double *state, double *out_4662972867475177241); -void pose_f_fun(double *state, double dt, double *out_3840229658681249647); -void pose_F_fun(double *state, double dt, double *out_8220635292339759608); -void pose_h_4(double *state, double *unused, double *out_2097936204583725179); -void pose_H_4(double *state, double *unused, double *out_4839409540176553033); -void pose_h_10(double *state, double *unused, double *out_29444642201375045); -void pose_H_10(double *state, double *unused, double *out_1070049335288984001); -void pose_h_13(double *state, double *unused, double *out_61045813616994293); -void pose_H_13(double *state, double *unused, double *out_8051683365508885834); -void pose_h_14(double *state, double *unused, double *out_8545162578881105562); -void pose_H_14(double *state, double *unused, double *out_4404293013531669434); +void pose_err_fun(double *nom_x, double *delta_x, double *out_4038237010904669995); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_2572217743337337909); +void pose_H_mod_fun(double *state, double *out_362240871876916223); +void pose_f_fun(double *state, double dt, double *out_844759421205290898); +void pose_F_fun(double *state, double dt, double *out_3409614379123282877); +void pose_h_4(double *state, double *unused, double *out_3761995773053554002); +void pose_H_4(double *state, double *unused, double *out_4790277513162164512); +void pose_h_10(double *state, double *unused, double *out_1433439433765456745); +void pose_H_10(double *state, double *unused, double *out_2492873908575038793); +void pose_h_13(double *state, double *unused, double *out_7701755112567992010); +void pose_H_13(double *state, double *unused, double *out_8002551338494497313); +void pose_h_14(double *state, double *unused, double *out_3517024732190759371); +void pose_H_14(double *state, double *unused, double *out_1707489080866792216); void pose_predict(double *in_x, double *in_P, double *in_Q, double dt); } \ No newline at end of file