From fbba97f9a6bea25a2db20c22a275caf193492a8f Mon Sep 17 00:00:00 2001 From: firestar5683 <168790843+firestar5683@users.noreply.github.com> Date: Fri, 8 May 2026 10:41:15 -0500 Subject: [PATCH] build --- common/libcommon.a | Bin 717272 -> 717272 bytes common/params_pyx.so | Bin 771872 -> 771872 bytes panda/board/obj/body_h7.bin.signed | Bin 85660 -> 85660 bytes panda/board/obj/body_h7/bootstub.elf | Bin 112692 -> 112692 bytes panda/board/obj/body_h7/main.bin | Bin 85524 -> 85524 bytes panda/board/obj/body_h7/main.elf | Bin 397824 -> 397824 bytes panda/board/obj/bootstub.body_h7.bin | Bin 12644 -> 12644 bytes panda/board/obj/bootstub.panda.bin | Bin 11068 -> 11068 bytes panda/board/obj/bootstub.panda_h7.bin | Bin 18784 -> 18784 bytes panda/board/obj/bootstub.panda_h7_remote.bin | Bin 18784 -> 18784 bytes panda/board/obj/bootstub.panda_jungle_h7.bin | Bin 13956 -> 13956 bytes panda/board/obj/bootstub.panda_remote.bin | Bin 11068 -> 11068 bytes panda/board/obj/gitversion.h | 2 +- panda/board/obj/panda.bin.signed | Bin 76432 -> 76432 bytes panda/board/obj/panda/bootstub.elf | Bin 100760 -> 100760 bytes panda/board/obj/panda/main.bin | Bin 76296 -> 76296 bytes panda/board/obj/panda/main.elf | Bin 359452 -> 359452 bytes panda/board/obj/panda_h7.bin.signed | Bin 93580 -> 93580 bytes panda/board/obj/panda_h7/bootstub.elf | Bin 152728 -> 152728 bytes panda/board/obj/panda_h7/main.bin | Bin 93444 -> 93444 bytes panda/board/obj/panda_h7/main.elf | Bin 441048 -> 441048 bytes panda/board/obj/panda_h7_remote.bin.signed | Bin 93516 -> 93516 bytes panda/board/obj/panda_h7_remote/bootstub.elf | Bin 152736 -> 152736 bytes panda/board/obj/panda_h7_remote/main.bin | Bin 93380 -> 93380 bytes panda/board/obj/panda_h7_remote/main.elf | Bin 441056 -> 441056 bytes panda/board/obj/panda_jungle_h7.bin.signed | Bin 87496 -> 87496 bytes panda/board/obj/panda_jungle_h7/bootstub.elf | Bin 123936 -> 123936 bytes panda/board/obj/panda_jungle_h7/main.bin | Bin 87360 -> 87360 bytes panda/board/obj/panda_jungle_h7/main.elf | Bin 401756 -> 401756 bytes panda/board/obj/panda_remote.bin.signed | Bin 76392 -> 76392 bytes panda/board/obj/panda_remote/bootstub.elf | Bin 100768 -> 100768 bytes panda/board/obj/panda_remote/main.bin | Bin 76256 -> 76256 bytes panda/board/obj/panda_remote/main.elf | Bin 359656 -> 359656 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 +- selfdrive/pandad/pandad | Bin 785576 -> 785576 bytes selfdrive/ui/ui | Bin 4408096 -> 4408096 bytes system/camerad/camerad | Bin 809248 -> 809248 bytes system/loggerd/bootlog | Bin 617808 -> 617808 bytes system/loggerd/encoderd | Bin 856944 -> 856944 bytes system/loggerd/loggerd | Bin 784168 -> 784168 bytes 44 files changed, 1347 insertions(+), 1347 deletions(-) diff --git a/common/libcommon.a b/common/libcommon.a index 5e5513f06023dae08caa419d29fa83f3fab5dfe1..6b7769ea8f3cf2fffa83fa068651c2d23e703a01 100644 GIT binary patch delta 55 zcmccdSo_9f?S?Ikb5=6)w9j412*gZ4%nZaVK+FonY(UHo#2i4(xqa?RE^7|};Zhku delta 55 zcmccdSo_9f?S?Ikb5=6yw9j412*gZ4%nZaVK+FonY(UHo#2i4(xqa?RE^7|}=CT=J diff --git a/common/params_pyx.so b/common/params_pyx.so index 0970e269f841d5820a747b8f45d88bb4d2646513..f09e148028fa05ea3a5334275d218a5e7cd7c5eb 100755 GIT binary patch delta 87 zcmZ3`r@x?2f5Qz%5uQEVvkF)*tStYqAhWQg>0ZUI%mdAD7~9`4GH!pv$aG;VBTxI@ h?My(-48$xz%nHP8K+F!r96-zo#9Z6=Zs$(s2LL5nDWL!W delta 87 zcmZ3`r@x?2f5Qz%k*nuTPN;o+qIddX%-!ixr;G01`1hgt4P*NoM#k-L7@00?Wz=ck hyPXM$nSq!Eh*^P{4T#x+m;;D8ftYLi-tFAU`~dk|EX4o- diff --git a/panda/board/obj/body_h7.bin.signed b/panda/board/obj/body_h7.bin.signed index 96027078694dbcddc7689b05b29103bd7eb8d8ab..c468f3f986830f9a229b14013619d760e47494ba 100644 GIT binary patch delta 153 zcmV;K0A~N3oduko1+cim2xU1oIbk_AW3#})T#SEdmo90itqy-^m8@{> z3z#Rfyn`H{&@r`=wYShUGM}p950S)pu$>_111s+hSlzb8r#$Jt{g?Ud delta 153 zcmV;K0A~N3oduko1+cim2xewvIA%69FtfnHT#SFLzqe&EQx{_m|9sI=y3D-r;HOQ$ zMd_<4IY|s)KV%}DsGI-nrJs32N4CaN7>)q5;=}-#=!h-&cwnhAN{*Dw@bxaEwx(V5 z;nEAQe}krZawn^>T(sMq2(8Vf$n~HFcgBp5@i$eHUfmj#hh9NyRR00?CSteSVC2u}(Fr)_nbnOZ7 delta 23 fcmbO-hjq#v)(txja-^lDSfrVm7;HXpFr)_nciRdW diff --git a/panda/board/obj/body_h7/main.elf b/panda/board/obj/body_h7/main.elf index e69f3eca30c69a6629dca14697ff35b8457e2f06..17fc477f37da19183e59e907dc0c57e14f0dc61a 100755 GIT binary patch delta 43 vcmZozBGIr!V#AJ$9I2LOmWh^T$;}5Ywja322*gZ4%nZaV+Yel1b#MRxvg8y+ delta 43 vcmZozBGIr!V#AJ$9BFAO7HMWC2F(X9wja322*gZ4%nZaV+Yel1b#MRxxbhTj diff --git a/panda/board/obj/bootstub.body_h7.bin b/panda/board/obj/bootstub.body_h7.bin index 16cf3ba47d82ced4b1db18d95df6de9228cdd530..4950c4a4ee49497e12672ca80bb1fee0e6c680a9 100755 GIT binary patch delta 21 ccmaEo^dxD6s}4u1rI}@-rCIW3UmbB)0AK|NJ^%m! delta 21 ccmaEo^dxD6s}4t6T8c%QnTf$>UmbB)0Alk8W&i*H diff --git a/panda/board/obj/bootstub.panda.bin b/panda/board/obj/bootstub.panda.bin index 695f0bba3e050505965534dc1ddfbfb5265445e9..b50a4b4f1d2e13b4c95798a1ecef4c4fa1bd4feb 100755 GIT binary patch delta 34 qcmdlJwkK?ZubN=0rI}@-rCGABi>p(pJ3|A*Zo9oo}u>b(fcndE8 delta 34 qcmdlJwkK?ZubN<5T8c%QnTdg}i>p(pJ3|A*Zo9oo}u>b(kZVOic diff --git a/panda/board/obj/bootstub.panda_h7.bin b/panda/board/obj/bootstub.panda_h7.bin index fe3c6bc068a3006e072df06c11b587ff9ec4079b..7b6dc5cc136b53f30b1765afbe8dcbfccdfda780 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$9I2LOmWh^T$(tuSpJxRCb7Bbw delta 23 fcmaDbiSfZC#tog$9BFAO7HMWC2Ad~3pJxRCc2Ef} diff --git a/panda/board/obj/bootstub.panda_h7_remote.bin b/panda/board/obj/bootstub.panda_h7_remote.bin index fe3c6bc068a3006e072df06c11b587ff9ec4079b..7b6dc5cc136b53f30b1765afbe8dcbfccdfda780 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$9I2LOmWh^T$(tuSpJxRCb7Bbw delta 23 fcmaDbiSfZC#tog$9BFAO7HMWC2Ad~3pJxRCc2Ef} diff --git a/panda/board/obj/bootstub.panda_jungle_h7.bin b/panda/board/obj/bootstub.panda_jungle_h7.bin index 321e9b2c7c85edfac9b102d209459bd46ce2d6ec..ff682d434fdef920318de6ebc082c3ad7c2382c8 100755 GIT binary patch delta 21 ccmZq4ZOPrR*MK9{(#$f^(kyxNQG@-g09~I5Gynhq delta 21 ccmZq4ZOPrR*MK7}EyW_u%*0^xQG@-g0AP&>TmS$7 diff --git a/panda/board/obj/bootstub.panda_remote.bin b/panda/board/obj/bootstub.panda_remote.bin index 695f0bba3e050505965534dc1ddfbfb5265445e9..b50a4b4f1d2e13b4c95798a1ecef4c4fa1bd4feb 100755 GIT binary patch delta 34 qcmdlJwkK?ZubN=0rI}@-rCGABi>p(pJ3|A*Zo9oo}u>b(fcndE8 delta 34 qcmdlJwkK?ZubN<5T8c%QnTdg}i>p(pJ3|A*Zo9oo}u>b(kZVOic diff --git a/panda/board/obj/gitversion.h b/panda/board/obj/gitversion.h index 4414046ee..cb28c39ee 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-ffd8f640-DEBUG"; +const uint8_t gitversion[19] = "DEV-e969a96c-DEBUG"; diff --git a/panda/board/obj/panda.bin.signed b/panda/board/obj/panda.bin.signed index 71dfe8199e19c7902b37b9e29fa718b9ea4ad089..ad26da870b8f52eda78c3a66a0e77bc684854b0b 100644 GIT binary patch delta 153 zcmV;K0A~M?)dY~$1h7P{2xU1oIbk_AW3x=H#C(5Bpbq!wqBR5^373nR`3JanSJ~_> zbo5-d=Y639c)br6Pu=AcxLrdt^Xk5-1AI$TGwCzHPV@0-jSuj=+_*ai+jK*QVyEch zyFngZo@IIA=)ZXsr1sX%pg^HM?b~uLAKi`4a`*N7i7#4<6qrx{x+1N!-)u1TyGE&N Hx_1G*m^e=` delta 153 zcmV;K0A~M?)dY~$1h7P{2xewvIA%69Ftbdp#C(53=z#7OS4NfZbdxUC1)8L`C6Bv| z{uMgFfzhPQhdZ?G-ZhG1gy4V2VrkHvSEgBbg02+oSwg~U5dQqR^Q0dveM%7N5M0Uj z;86bjFZ+M#OzFewepB+*@a*0Z+861Z0z}=?zt(tiB5BpQ*yM@ul@{$dA}B*!G~ diff --git a/panda/board/obj/panda/bootstub.elf b/panda/board/obj/panda/bootstub.elf index cbcf9bfdb7d5e713b510c77be7682918e696f343..c5ed739148d4ab094b789821f5888e00d24cdca8 100755 GIT binary patch delta 40 wcmbO+nQg{owhg{!f~l5fmWh^T$+|ACPND7$4GfbfnkqEcnQgB#W0VR8018G7ga7~l delta 40 wcmbO+nQg{owhg{!f@x_f7HMWC2D&b;PND7$4GfbfnkqEcnQgB#W0VR801w;@tN;K2 diff --git a/panda/board/obj/panda/main.bin b/panda/board/obj/panda/main.bin index 3b5af0d83575ed62a2fd71ace194e893173ea1b7..adc3084a93209b1ee5f17a00604ae21476c1525a 100755 GIT binary patch delta 23 fcmeCU!qRbtWrNFFj#NuC%S21F7_tXFYasmmC delta 23 fcmeCU!qRbtWrNFFjn0!F*F+9t zl%3=+*7Gx^LbQZZ7?CPQj~K&e)Bm&Gy!`USwTH&LSyY&l8Cvy~!H|9GQ!r_J9=q=? z9fd)%+hyZci4JCJ^j~x4L`7@P4;%rUR~Io6=Du$qLVV*Za`-1Q2szeMkO~#^-e-?C HAX))GZInnF delta 153 zcmV;K0A~M;+Xal<1+bjm2xewvIA%69FteoHXpes?YDk@-0F!RQ$x>Jto6O7HE@;O^ zI_I(drzJlIHC~uvG=w5DS<51CEMUGrtwDp8K@g6roWut7qSO;ZSkhBgf#24&ISq@e z9rTz=(@h2&(9ihX9cTbv3{@Q*72H~yKfaA?Dpps#ip~66F^TO~BJ37BItq|gf91UC HTp9s27%W9n diff --git a/panda/board/obj/panda_h7/bootstub.elf b/panda/board/obj/panda_h7/bootstub.elf index f7cf629a587202d0261233ca65ad0cb86f5d255d..dff1b1ef0c4720bd4df97514affc6d833d842498 100755 GIT binary patch delta 31 ncmbQSl5@sN&JCTx9I2LOmWh^T$;}gk+b0GyZl4&;#Lfr+zPt+I delta 31 ncmbQSl5@sN&JCTx9BFAO7HMWC2F(+L+b0GyZl4&;#Lfr+!s-hN diff --git a/panda/board/obj/panda_h7/main.bin b/panda/board/obj/panda_h7/main.bin index 7a2cfae582ca34534b2a52bc8c9d9ee8a15dd1b1..529ae9fb114ac5eaa1babd19cd66b48bb1dcee82 100755 GIT binary patch delta 23 fcmZp<#oBU?CSteSVB{wg5+rH#2BM>tIF*6XeY+v%0)#NMy>0A~Z delta 43 vcmccdRqDo9sSR`9a-^lDSfrVm7&I?=+rH#2BM>tIF*6XeY+v%0)#NMy?`jrA diff --git a/panda/board/obj/panda_h7_remote.bin.signed b/panda/board/obj/panda_h7_remote.bin.signed index 5f6df47b10842b74efad3665f14da632337a79bb..d5e1028717bbd17871e0d49306b7eb1f2a9cce22 100644 GIT binary patch delta 153 zcmV;K0A~Np+6Bzo1+ZM*2xU1oIbk_AW3y!4Xpes?kQoE${Q9!yGYUx!L%)3nL3koi zdr(toG5W4qJeI%JlL$Mvu)_v-SEa;LM4d8o-c$SdI4qk(DqW~b;f6=EPvxGZ)Ixq| zb(k#|6ktv=t%x=JN4!WO*o(1rnb|6YO9DK3_`NFRL!kE6Az)q|eAar>>y6y>CmZvl HYHtCfJa|aY delta 153 zcmV;K0A~Np+6Bzo1+ZM*2xewvIA%69FtcRcXpeuZE+)*){bI%CLf6x&So|v}P{t8w z;!#W!9-jgZrI}1+q&F~I@=R~_X7{#4>hVg3dc!eH&Y(*1SB+{pobV#4TfsS5BRe6` znS%9_A-i5anp220n@$^>?u@(YBCwZHPC5%Y%#B-~SUUnZo(= H%c22zrd>@P diff --git a/panda/board/obj/panda_h7_remote/bootstub.elf b/panda/board/obj/panda_h7_remote/bootstub.elf index bca14c65f5dad556af4407a9b72fa0b98dfdf92d..2520baa03b2e531326717a6992cc2f5e6d272294 100755 GIT binary patch delta 31 ncmZ3ml5@dI&JCTx9I2LOmWh^T$;}gk+b0GyZl4&;#Lox-z@!TK delta 31 ncmZ3ml5@dI&JCTx9BFAO7HMWC2F(+L+b0GyZl4&;#Lox-#L^2P diff --git a/panda/board/obj/panda_h7_remote/main.bin b/panda/board/obj/panda_h7_remote/main.bin index 928f28327d9d66a3043b3aac81aeb6933ba54a83..f2524feeff51fc251d0b0df1186fde06348a9ba3 100755 GIT binary patch delta 23 fcmX?dll90=)(tUtIZ`dnEE6rwk~gQ^P3Q*zfu#yr delta 23 fcmX?dll90=)(tUtInvTnEYi$O3^u3SP3Q*zgp&$^ diff --git a/panda/board/obj/panda_h7_remote/main.elf b/panda/board/obj/panda_h7_remote/main.elf index 9f8689b3ba0ed1fb80eb42403a321767e26f071d..da44041ff2a44f9b765cb8109139f86b785d858d 100755 GIT binary patch delta 43 vcmaFxRqDZ4sSPo2IZ`dnEE6rwlABZBwx_&h1Y#y2W(H!G?I~|rYt8}y%|sNm delta 43 vcmaFxRqDZ4sSPo2InvTnEYi$O44PBkwx_&h1Y#y2W(H!G?I~|rYt8}y(^3@N diff --git a/panda/board/obj/panda_jungle_h7.bin.signed b/panda/board/obj/panda_jungle_h7.bin.signed index 6029cb7ce3537826f5bf59bcf4cee41484aa8227..f581d20167c25d4bd4f05fba4f025700db603418 100644 GIT binary patch delta 153 zcmV;K0A~Nls|Cob1+ZAg2xU1oIbk_AW3yn!=#GCv25|aRSRbMAFC7#tjtK_1@&19R zU%q+2cv9Zs(CmJ(NZwI-`M$u?R=?UWivHNDhMdh;8f#>-2ym=fr&hlhozcXvVFzU-I8rUmEE6rwlADh@Y(MJ27`+$(pJ)pg delta 27 jcmZ2*f_=dW_6>U-IMUKmEYi$O44RKRY(MJ27`+$(qV@|v diff --git a/panda/board/obj/panda_jungle_h7/main.bin b/panda/board/obj/panda_jungle_h7/main.bin index 063945e87c75f4d320b0e99c4da7b20f34a36b6a..8e14c24555f64760e84c7b61f121dad8d7cbfd76 100755 GIT binary patch delta 23 fcmX@GiuJ%M)(sKII8rUmEE6rwk~b$Dd(Z~}c!LT& delta 23 fcmX@GiuJ%M)(sKIIMUKmEYi$O3^pemd(Z~}dvOY6 diff --git a/panda/board/obj/panda_jungle_h7/main.elf b/panda/board/obj/panda_jungle_h7/main.elf index 5ad65dd774fea529859e7b6b5baf0dff33cce80d..5e9d86e13e621a472c35fcb9663db5a4c4e11371 100755 GIT binary patch delta 43 vcmca}NaD^Ri476gI8rUmEE6rwlA9B*wI^I-1Y#y2W(H!G?FrXd|9AlauO<_M delta 43 vcmca}NaD^Ri476gIMUKmEYi$O44Mf2xU1oIbk_AW3wc!#C(5Skl+4!Np=TOUX_IfG#s}XmR6Xn z3wH2kltS6)hKO=r(^oyAd-~}LG9*Ml(!D~)(*`-lf2xewvIA%69Fta4B#C(6d?r4M398nhlXZ1D(x948>DupRF z7Ko8KQ6EvhAQ*C=_JYad_R*C~YZ{%So@W83A7tr0Ltc9UI=p=5z_uFE_{9U}3gdqO zXr$eM#zC(oF#%szS~zKVUdZA*TFk28?_4RBfk~T*b*2ByQt)75gItmeq}?PzIn*Fg HEmr~0W)(-z diff --git a/panda/board/obj/panda_remote/bootstub.elf b/panda/board/obj/panda_remote/bootstub.elf index 49f38658418c4568c4106ca5960b45befa7f6bfe..39030b6dccc774bc4d85e0b64c24b84b6d58fb80 100755 GIT binary patch delta 40 wcmZ25nQg&jwhg{!f~l5fmWh^T$+|ACPND7$4GfbfnkqEcnQgB#V^j(T01UnioB#j- delta 40 wcmZ25nQg&jwhg{!f@x_f7HMWC2D&b;PND7$4GfbfnkqEcnQgB#V^j(T01{LT!~g&Q diff --git a/panda/board/obj/panda_remote/main.bin b/panda/board/obj/panda_remote/main.bin index 67b3c600a9cabdf9cab08f0bd001f27c631cf421..45d8a540fa74cd5ba56339d029ef493876903b7d 100755 GIT binary patch delta 23 fcmaEGndQM{mJKp%IZ`dnEE6rwk~gcY-BSYqeSrz= delta 23 fcmaEGndQM{mJKp%InvTnEYi$O3^uE*-BSYqfNu&E diff --git a/panda/board/obj/panda_remote/main.elf b/panda/board/obj/panda_remote/main.elf index 195c891bc72b3f60d9350bcff29a7876a91069ec..728892884763a79f3f28b23d2935c37866198f64 100755 GIT binary patch delta 39 scmaFyQ}o48(G4 #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_5399948258775111327) { - err_fun(nom_x, delta_x, out_5399948258775111327); +void car_err_fun(double *nom_x, double *delta_x, double *out_2567017903067559466) { + err_fun(nom_x, delta_x, out_2567017903067559466); } -void car_inv_err_fun(double *nom_x, double *true_x, double *out_538771626761939485) { - inv_err_fun(nom_x, true_x, out_538771626761939485); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_1749285410370024184) { + inv_err_fun(nom_x, true_x, out_1749285410370024184); } -void car_H_mod_fun(double *state, double *out_6102609910614786292) { - H_mod_fun(state, out_6102609910614786292); +void car_H_mod_fun(double *state, double *out_8979551951706364182) { + H_mod_fun(state, out_8979551951706364182); } -void car_f_fun(double *state, double dt, double *out_667706195184437986) { - f_fun(state, dt, out_667706195184437986); +void car_f_fun(double *state, double dt, double *out_3674179640817441392) { + f_fun(state, dt, out_3674179640817441392); } -void car_F_fun(double *state, double dt, double *out_157487213156187863) { - F_fun(state, dt, out_157487213156187863); +void car_F_fun(double *state, double dt, double *out_258925546890284745) { + F_fun(state, dt, out_258925546890284745); } -void car_h_25(double *state, double *unused, double *out_7616837909277052709) { - h_25(state, unused, out_7616837909277052709); +void car_h_25(double *state, double *unused, double *out_5262304077966076166) { + h_25(state, unused, out_5262304077966076166); } -void car_H_25(double *state, double *unused, double *out_8821153513105273647) { - H_25(state, unused, out_8821153513105273647); +void car_H_25(double *state, double *unused, double *out_4563500296818522594) { + H_25(state, unused, out_4563500296818522594); } -void car_h_24(double *state, double *unused, double *out_3643618505328510339) { - h_24(state, unused, out_3643618505328510339); +void car_h_24(double *state, double *unused, double *out_2894074188837958464) { + h_24(state, unused, out_2894074188837958464); } -void car_H_24(double *state, double *unused, double *out_5263227914302950511) { - H_24(state, unused, out_5263227914302950511); +void car_H_24(double *state, double *unused, double *out_2012071509772995507) { + H_24(state, unused, out_2012071509772995507); } -void car_h_30(double *state, double *unused, double *out_6577068605668785750) { - h_30(state, unused, out_6577068605668785750); +void car_h_30(double *state, double *unused, double *out_9005980160461201074) { + h_30(state, unused, out_9005980160461201074); } -void car_H_30(double *state, double *unused, double *out_8950492460248513717) { - H_30(state, unused, out_8950492460248513717); +void car_H_30(double *state, double *unused, double *out_2045167338311273967) { + H_30(state, unused, out_2045167338311273967); } -void car_h_26(double *state, double *unused, double *out_5973752720992308233) { - h_26(state, unused, out_5973752720992308233); +void car_h_26(double *state, double *unused, double *out_8837448028571873025) { + h_26(state, unused, out_8837448028571873025); } -void car_H_26(double *state, double *unused, double *out_5884087241730221745) { - H_26(state, unused, out_5884087241730221745); +void car_H_26(double *state, double *unused, double *out_1258974327057721993) { + H_26(state, unused, out_1258974327057721993); } -void car_h_27(double *state, double *unused, double *out_8560347762178715144) { - h_27(state, unused, out_8560347762178715144); +void car_h_27(double *state, double *unused, double *out_6785398478329626304) { + h_27(state, unused, out_6785398478329626304); } -void car_H_27(double *state, double *unused, double *out_7321488301660612988) { - H_27(state, unused, out_7321488301660612988); +void car_H_27(double *state, double *unused, double *out_178426732872669250) { + H_27(state, unused, out_178426732872669250); } -void car_h_29(double *state, double *unused, double *out_1246518834812294588) { - h_29(state, unused, out_1246518834812294588); +void car_h_29(double *state, double *unused, double *out_8023896067125902962) { + h_29(state, unused, out_8023896067125902962); } -void car_H_29(double *state, double *unused, double *out_5608125574791061955) { - H_29(state, unused, out_5608125574791061955); +void car_H_29(double *state, double *unused, double *out_1534935993996881783) { + H_29(state, unused, out_1534935993996881783); } -void car_h_28(double *state, double *unused, double *out_7957031877502237627) { - h_28(state, unused, out_7957031877502237627); +void car_h_28(double *state, double *unused, double *out_5617654677253484567) { + h_28(state, unused, out_5617654677253484567); } -void car_H_28(double *state, double *unused, double *out_7571755846356388206) { - H_28(state, unused, out_7571755846356388206); +void car_H_28(double *state, double *unused, double *out_6617335011066412357) { + H_28(state, unused, out_6617335011066412357); } -void car_h_31(double *state, double *unused, double *out_7192456636178476557) { - h_31(state, unused, out_7192456636178476557); +void car_h_31(double *state, double *unused, double *out_9123987554394577818) { + h_31(state, unused, out_9123987554394577818); } -void car_H_31(double *state, double *unused, double *out_8790507551228313219) { - H_31(state, unused, out_8790507551228313219); +void car_H_31(double *state, double *unused, double *out_4532854334941562166) { + H_31(state, unused, out_4532854334941562166); } 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 29d14ec99..f3a9348bc 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_5399948258775111327); -void car_inv_err_fun(double *nom_x, double *true_x, double *out_538771626761939485); -void car_H_mod_fun(double *state, double *out_6102609910614786292); -void car_f_fun(double *state, double dt, double *out_667706195184437986); -void car_F_fun(double *state, double dt, double *out_157487213156187863); -void car_h_25(double *state, double *unused, double *out_7616837909277052709); -void car_H_25(double *state, double *unused, double *out_8821153513105273647); -void car_h_24(double *state, double *unused, double *out_3643618505328510339); -void car_H_24(double *state, double *unused, double *out_5263227914302950511); -void car_h_30(double *state, double *unused, double *out_6577068605668785750); -void car_H_30(double *state, double *unused, double *out_8950492460248513717); -void car_h_26(double *state, double *unused, double *out_5973752720992308233); -void car_H_26(double *state, double *unused, double *out_5884087241730221745); -void car_h_27(double *state, double *unused, double *out_8560347762178715144); -void car_H_27(double *state, double *unused, double *out_7321488301660612988); -void car_h_29(double *state, double *unused, double *out_1246518834812294588); -void car_H_29(double *state, double *unused, double *out_5608125574791061955); -void car_h_28(double *state, double *unused, double *out_7957031877502237627); -void car_H_28(double *state, double *unused, double *out_7571755846356388206); -void car_h_31(double *state, double *unused, double *out_7192456636178476557); -void car_H_31(double *state, double *unused, double *out_8790507551228313219); +void car_err_fun(double *nom_x, double *delta_x, double *out_2567017903067559466); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_1749285410370024184); +void car_H_mod_fun(double *state, double *out_8979551951706364182); +void car_f_fun(double *state, double dt, double *out_3674179640817441392); +void car_F_fun(double *state, double dt, double *out_258925546890284745); +void car_h_25(double *state, double *unused, double *out_5262304077966076166); +void car_H_25(double *state, double *unused, double *out_4563500296818522594); +void car_h_24(double *state, double *unused, double *out_2894074188837958464); +void car_H_24(double *state, double *unused, double *out_2012071509772995507); +void car_h_30(double *state, double *unused, double *out_9005980160461201074); +void car_H_30(double *state, double *unused, double *out_2045167338311273967); +void car_h_26(double *state, double *unused, double *out_8837448028571873025); +void car_H_26(double *state, double *unused, double *out_1258974327057721993); +void car_h_27(double *state, double *unused, double *out_6785398478329626304); +void car_H_27(double *state, double *unused, double *out_178426732872669250); +void car_h_29(double *state, double *unused, double *out_8023896067125902962); +void car_H_29(double *state, double *unused, double *out_1534935993996881783); +void car_h_28(double *state, double *unused, double *out_5617654677253484567); +void car_H_28(double *state, double *unused, double *out_6617335011066412357); +void car_h_31(double *state, double *unused, double *out_9123987554394577818); +void car_H_31(double *state, double *unused, double *out_4532854334941562166); 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 4d383c195..415e6382d 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_9170572944906816852) { - out_9170572944906816852[0] = delta_x[0] + nom_x[0]; - out_9170572944906816852[1] = delta_x[1] + nom_x[1]; - out_9170572944906816852[2] = delta_x[2] + nom_x[2]; - out_9170572944906816852[3] = delta_x[3] + nom_x[3]; - out_9170572944906816852[4] = delta_x[4] + nom_x[4]; - out_9170572944906816852[5] = delta_x[5] + nom_x[5]; - out_9170572944906816852[6] = delta_x[6] + nom_x[6]; - out_9170572944906816852[7] = delta_x[7] + nom_x[7]; - out_9170572944906816852[8] = delta_x[8] + nom_x[8]; - out_9170572944906816852[9] = delta_x[9] + nom_x[9]; - out_9170572944906816852[10] = delta_x[10] + nom_x[10]; - out_9170572944906816852[11] = delta_x[11] + nom_x[11]; - out_9170572944906816852[12] = delta_x[12] + nom_x[12]; - out_9170572944906816852[13] = delta_x[13] + nom_x[13]; - out_9170572944906816852[14] = delta_x[14] + nom_x[14]; - out_9170572944906816852[15] = delta_x[15] + nom_x[15]; - out_9170572944906816852[16] = delta_x[16] + nom_x[16]; - out_9170572944906816852[17] = delta_x[17] + nom_x[17]; +void err_fun(double *nom_x, double *delta_x, double *out_2526150130430510074) { + out_2526150130430510074[0] = delta_x[0] + nom_x[0]; + out_2526150130430510074[1] = delta_x[1] + nom_x[1]; + out_2526150130430510074[2] = delta_x[2] + nom_x[2]; + out_2526150130430510074[3] = delta_x[3] + nom_x[3]; + out_2526150130430510074[4] = delta_x[4] + nom_x[4]; + out_2526150130430510074[5] = delta_x[5] + nom_x[5]; + out_2526150130430510074[6] = delta_x[6] + nom_x[6]; + out_2526150130430510074[7] = delta_x[7] + nom_x[7]; + out_2526150130430510074[8] = delta_x[8] + nom_x[8]; + out_2526150130430510074[9] = delta_x[9] + nom_x[9]; + out_2526150130430510074[10] = delta_x[10] + nom_x[10]; + out_2526150130430510074[11] = delta_x[11] + nom_x[11]; + out_2526150130430510074[12] = delta_x[12] + nom_x[12]; + out_2526150130430510074[13] = delta_x[13] + nom_x[13]; + out_2526150130430510074[14] = delta_x[14] + nom_x[14]; + out_2526150130430510074[15] = delta_x[15] + nom_x[15]; + out_2526150130430510074[16] = delta_x[16] + nom_x[16]; + out_2526150130430510074[17] = delta_x[17] + nom_x[17]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_4867215415263963768) { - out_4867215415263963768[0] = -nom_x[0] + true_x[0]; - out_4867215415263963768[1] = -nom_x[1] + true_x[1]; - out_4867215415263963768[2] = -nom_x[2] + true_x[2]; - out_4867215415263963768[3] = -nom_x[3] + true_x[3]; - out_4867215415263963768[4] = -nom_x[4] + true_x[4]; - out_4867215415263963768[5] = -nom_x[5] + true_x[5]; - out_4867215415263963768[6] = -nom_x[6] + true_x[6]; - out_4867215415263963768[7] = -nom_x[7] + true_x[7]; - out_4867215415263963768[8] = -nom_x[8] + true_x[8]; - out_4867215415263963768[9] = -nom_x[9] + true_x[9]; - out_4867215415263963768[10] = -nom_x[10] + true_x[10]; - out_4867215415263963768[11] = -nom_x[11] + true_x[11]; - out_4867215415263963768[12] = -nom_x[12] + true_x[12]; - out_4867215415263963768[13] = -nom_x[13] + true_x[13]; - out_4867215415263963768[14] = -nom_x[14] + true_x[14]; - out_4867215415263963768[15] = -nom_x[15] + true_x[15]; - out_4867215415263963768[16] = -nom_x[16] + true_x[16]; - out_4867215415263963768[17] = -nom_x[17] + true_x[17]; +void inv_err_fun(double *nom_x, double *true_x, double *out_3515561648914426109) { + out_3515561648914426109[0] = -nom_x[0] + true_x[0]; + out_3515561648914426109[1] = -nom_x[1] + true_x[1]; + out_3515561648914426109[2] = -nom_x[2] + true_x[2]; + out_3515561648914426109[3] = -nom_x[3] + true_x[3]; + out_3515561648914426109[4] = -nom_x[4] + true_x[4]; + out_3515561648914426109[5] = -nom_x[5] + true_x[5]; + out_3515561648914426109[6] = -nom_x[6] + true_x[6]; + out_3515561648914426109[7] = -nom_x[7] + true_x[7]; + out_3515561648914426109[8] = -nom_x[8] + true_x[8]; + out_3515561648914426109[9] = -nom_x[9] + true_x[9]; + out_3515561648914426109[10] = -nom_x[10] + true_x[10]; + out_3515561648914426109[11] = -nom_x[11] + true_x[11]; + out_3515561648914426109[12] = -nom_x[12] + true_x[12]; + out_3515561648914426109[13] = -nom_x[13] + true_x[13]; + out_3515561648914426109[14] = -nom_x[14] + true_x[14]; + out_3515561648914426109[15] = -nom_x[15] + true_x[15]; + out_3515561648914426109[16] = -nom_x[16] + true_x[16]; + out_3515561648914426109[17] = -nom_x[17] + true_x[17]; } -void H_mod_fun(double *state, double *out_1396735664605592698) { - out_1396735664605592698[0] = 1.0; - out_1396735664605592698[1] = 0.0; - out_1396735664605592698[2] = 0.0; - out_1396735664605592698[3] = 0.0; - out_1396735664605592698[4] = 0.0; - out_1396735664605592698[5] = 0.0; - out_1396735664605592698[6] = 0.0; - out_1396735664605592698[7] = 0.0; - out_1396735664605592698[8] = 0.0; - out_1396735664605592698[9] = 0.0; - out_1396735664605592698[10] = 0.0; - out_1396735664605592698[11] = 0.0; - out_1396735664605592698[12] = 0.0; - out_1396735664605592698[13] = 0.0; - out_1396735664605592698[14] = 0.0; - out_1396735664605592698[15] = 0.0; - out_1396735664605592698[16] = 0.0; - out_1396735664605592698[17] = 0.0; - out_1396735664605592698[18] = 0.0; - out_1396735664605592698[19] = 1.0; - out_1396735664605592698[20] = 0.0; - out_1396735664605592698[21] = 0.0; - out_1396735664605592698[22] = 0.0; - out_1396735664605592698[23] = 0.0; - out_1396735664605592698[24] = 0.0; - out_1396735664605592698[25] = 0.0; - out_1396735664605592698[26] = 0.0; - out_1396735664605592698[27] = 0.0; - out_1396735664605592698[28] = 0.0; - out_1396735664605592698[29] = 0.0; - out_1396735664605592698[30] = 0.0; - out_1396735664605592698[31] = 0.0; - out_1396735664605592698[32] = 0.0; - out_1396735664605592698[33] = 0.0; - out_1396735664605592698[34] = 0.0; - out_1396735664605592698[35] = 0.0; - out_1396735664605592698[36] = 0.0; - out_1396735664605592698[37] = 0.0; - out_1396735664605592698[38] = 1.0; - out_1396735664605592698[39] = 0.0; - out_1396735664605592698[40] = 0.0; - out_1396735664605592698[41] = 0.0; - out_1396735664605592698[42] = 0.0; - out_1396735664605592698[43] = 0.0; - out_1396735664605592698[44] = 0.0; - out_1396735664605592698[45] = 0.0; - out_1396735664605592698[46] = 0.0; - out_1396735664605592698[47] = 0.0; - out_1396735664605592698[48] = 0.0; - out_1396735664605592698[49] = 0.0; - out_1396735664605592698[50] = 0.0; - out_1396735664605592698[51] = 0.0; - out_1396735664605592698[52] = 0.0; - out_1396735664605592698[53] = 0.0; - out_1396735664605592698[54] = 0.0; - out_1396735664605592698[55] = 0.0; - out_1396735664605592698[56] = 0.0; - out_1396735664605592698[57] = 1.0; - out_1396735664605592698[58] = 0.0; - out_1396735664605592698[59] = 0.0; - out_1396735664605592698[60] = 0.0; - out_1396735664605592698[61] = 0.0; - out_1396735664605592698[62] = 0.0; - out_1396735664605592698[63] = 0.0; - out_1396735664605592698[64] = 0.0; - out_1396735664605592698[65] = 0.0; - out_1396735664605592698[66] = 0.0; - out_1396735664605592698[67] = 0.0; - out_1396735664605592698[68] = 0.0; - out_1396735664605592698[69] = 0.0; - out_1396735664605592698[70] = 0.0; - out_1396735664605592698[71] = 0.0; - out_1396735664605592698[72] = 0.0; - out_1396735664605592698[73] = 0.0; - out_1396735664605592698[74] = 0.0; - out_1396735664605592698[75] = 0.0; - out_1396735664605592698[76] = 1.0; - out_1396735664605592698[77] = 0.0; - out_1396735664605592698[78] = 0.0; - out_1396735664605592698[79] = 0.0; - out_1396735664605592698[80] = 0.0; - out_1396735664605592698[81] = 0.0; - out_1396735664605592698[82] = 0.0; - out_1396735664605592698[83] = 0.0; - out_1396735664605592698[84] = 0.0; - out_1396735664605592698[85] = 0.0; - out_1396735664605592698[86] = 0.0; - out_1396735664605592698[87] = 0.0; - out_1396735664605592698[88] = 0.0; - out_1396735664605592698[89] = 0.0; - out_1396735664605592698[90] = 0.0; - out_1396735664605592698[91] = 0.0; - out_1396735664605592698[92] = 0.0; - out_1396735664605592698[93] = 0.0; - out_1396735664605592698[94] = 0.0; - out_1396735664605592698[95] = 1.0; - out_1396735664605592698[96] = 0.0; - out_1396735664605592698[97] = 0.0; - out_1396735664605592698[98] = 0.0; - out_1396735664605592698[99] = 0.0; - out_1396735664605592698[100] = 0.0; - out_1396735664605592698[101] = 0.0; - out_1396735664605592698[102] = 0.0; - out_1396735664605592698[103] = 0.0; - out_1396735664605592698[104] = 0.0; - out_1396735664605592698[105] = 0.0; - out_1396735664605592698[106] = 0.0; - out_1396735664605592698[107] = 0.0; - out_1396735664605592698[108] = 0.0; - out_1396735664605592698[109] = 0.0; - out_1396735664605592698[110] = 0.0; - out_1396735664605592698[111] = 0.0; - out_1396735664605592698[112] = 0.0; - out_1396735664605592698[113] = 0.0; - out_1396735664605592698[114] = 1.0; - out_1396735664605592698[115] = 0.0; - out_1396735664605592698[116] = 0.0; - out_1396735664605592698[117] = 0.0; - out_1396735664605592698[118] = 0.0; - out_1396735664605592698[119] = 0.0; - out_1396735664605592698[120] = 0.0; - out_1396735664605592698[121] = 0.0; - out_1396735664605592698[122] = 0.0; - out_1396735664605592698[123] = 0.0; - out_1396735664605592698[124] = 0.0; - out_1396735664605592698[125] = 0.0; - out_1396735664605592698[126] = 0.0; - out_1396735664605592698[127] = 0.0; - out_1396735664605592698[128] = 0.0; - out_1396735664605592698[129] = 0.0; - out_1396735664605592698[130] = 0.0; - out_1396735664605592698[131] = 0.0; - out_1396735664605592698[132] = 0.0; - out_1396735664605592698[133] = 1.0; - out_1396735664605592698[134] = 0.0; - out_1396735664605592698[135] = 0.0; - out_1396735664605592698[136] = 0.0; - out_1396735664605592698[137] = 0.0; - out_1396735664605592698[138] = 0.0; - out_1396735664605592698[139] = 0.0; - out_1396735664605592698[140] = 0.0; - out_1396735664605592698[141] = 0.0; - out_1396735664605592698[142] = 0.0; - out_1396735664605592698[143] = 0.0; - out_1396735664605592698[144] = 0.0; - out_1396735664605592698[145] = 0.0; - out_1396735664605592698[146] = 0.0; - out_1396735664605592698[147] = 0.0; - out_1396735664605592698[148] = 0.0; - out_1396735664605592698[149] = 0.0; - out_1396735664605592698[150] = 0.0; - out_1396735664605592698[151] = 0.0; - out_1396735664605592698[152] = 1.0; - out_1396735664605592698[153] = 0.0; - out_1396735664605592698[154] = 0.0; - out_1396735664605592698[155] = 0.0; - out_1396735664605592698[156] = 0.0; - out_1396735664605592698[157] = 0.0; - out_1396735664605592698[158] = 0.0; - out_1396735664605592698[159] = 0.0; - out_1396735664605592698[160] = 0.0; - out_1396735664605592698[161] = 0.0; - out_1396735664605592698[162] = 0.0; - out_1396735664605592698[163] = 0.0; - out_1396735664605592698[164] = 0.0; - out_1396735664605592698[165] = 0.0; - out_1396735664605592698[166] = 0.0; - out_1396735664605592698[167] = 0.0; - out_1396735664605592698[168] = 0.0; - out_1396735664605592698[169] = 0.0; - out_1396735664605592698[170] = 0.0; - out_1396735664605592698[171] = 1.0; - out_1396735664605592698[172] = 0.0; - out_1396735664605592698[173] = 0.0; - out_1396735664605592698[174] = 0.0; - out_1396735664605592698[175] = 0.0; - out_1396735664605592698[176] = 0.0; - out_1396735664605592698[177] = 0.0; - out_1396735664605592698[178] = 0.0; - out_1396735664605592698[179] = 0.0; - out_1396735664605592698[180] = 0.0; - out_1396735664605592698[181] = 0.0; - out_1396735664605592698[182] = 0.0; - out_1396735664605592698[183] = 0.0; - out_1396735664605592698[184] = 0.0; - out_1396735664605592698[185] = 0.0; - out_1396735664605592698[186] = 0.0; - out_1396735664605592698[187] = 0.0; - out_1396735664605592698[188] = 0.0; - out_1396735664605592698[189] = 0.0; - out_1396735664605592698[190] = 1.0; - out_1396735664605592698[191] = 0.0; - out_1396735664605592698[192] = 0.0; - out_1396735664605592698[193] = 0.0; - out_1396735664605592698[194] = 0.0; - out_1396735664605592698[195] = 0.0; - out_1396735664605592698[196] = 0.0; - out_1396735664605592698[197] = 0.0; - out_1396735664605592698[198] = 0.0; - out_1396735664605592698[199] = 0.0; - out_1396735664605592698[200] = 0.0; - out_1396735664605592698[201] = 0.0; - out_1396735664605592698[202] = 0.0; - out_1396735664605592698[203] = 0.0; - out_1396735664605592698[204] = 0.0; - out_1396735664605592698[205] = 0.0; - out_1396735664605592698[206] = 0.0; - out_1396735664605592698[207] = 0.0; - out_1396735664605592698[208] = 0.0; - out_1396735664605592698[209] = 1.0; - out_1396735664605592698[210] = 0.0; - out_1396735664605592698[211] = 0.0; - out_1396735664605592698[212] = 0.0; - out_1396735664605592698[213] = 0.0; - out_1396735664605592698[214] = 0.0; - out_1396735664605592698[215] = 0.0; - out_1396735664605592698[216] = 0.0; - out_1396735664605592698[217] = 0.0; - out_1396735664605592698[218] = 0.0; - out_1396735664605592698[219] = 0.0; - out_1396735664605592698[220] = 0.0; - out_1396735664605592698[221] = 0.0; - out_1396735664605592698[222] = 0.0; - out_1396735664605592698[223] = 0.0; - out_1396735664605592698[224] = 0.0; - out_1396735664605592698[225] = 0.0; - out_1396735664605592698[226] = 0.0; - out_1396735664605592698[227] = 0.0; - out_1396735664605592698[228] = 1.0; - out_1396735664605592698[229] = 0.0; - out_1396735664605592698[230] = 0.0; - out_1396735664605592698[231] = 0.0; - out_1396735664605592698[232] = 0.0; - out_1396735664605592698[233] = 0.0; - out_1396735664605592698[234] = 0.0; - out_1396735664605592698[235] = 0.0; - out_1396735664605592698[236] = 0.0; - out_1396735664605592698[237] = 0.0; - out_1396735664605592698[238] = 0.0; - out_1396735664605592698[239] = 0.0; - out_1396735664605592698[240] = 0.0; - out_1396735664605592698[241] = 0.0; - out_1396735664605592698[242] = 0.0; - out_1396735664605592698[243] = 0.0; - out_1396735664605592698[244] = 0.0; - out_1396735664605592698[245] = 0.0; - out_1396735664605592698[246] = 0.0; - out_1396735664605592698[247] = 1.0; - out_1396735664605592698[248] = 0.0; - out_1396735664605592698[249] = 0.0; - out_1396735664605592698[250] = 0.0; - out_1396735664605592698[251] = 0.0; - out_1396735664605592698[252] = 0.0; - out_1396735664605592698[253] = 0.0; - out_1396735664605592698[254] = 0.0; - out_1396735664605592698[255] = 0.0; - out_1396735664605592698[256] = 0.0; - out_1396735664605592698[257] = 0.0; - out_1396735664605592698[258] = 0.0; - out_1396735664605592698[259] = 0.0; - out_1396735664605592698[260] = 0.0; - out_1396735664605592698[261] = 0.0; - out_1396735664605592698[262] = 0.0; - out_1396735664605592698[263] = 0.0; - out_1396735664605592698[264] = 0.0; - out_1396735664605592698[265] = 0.0; - out_1396735664605592698[266] = 1.0; - out_1396735664605592698[267] = 0.0; - out_1396735664605592698[268] = 0.0; - out_1396735664605592698[269] = 0.0; - out_1396735664605592698[270] = 0.0; - out_1396735664605592698[271] = 0.0; - out_1396735664605592698[272] = 0.0; - out_1396735664605592698[273] = 0.0; - out_1396735664605592698[274] = 0.0; - out_1396735664605592698[275] = 0.0; - out_1396735664605592698[276] = 0.0; - out_1396735664605592698[277] = 0.0; - out_1396735664605592698[278] = 0.0; - out_1396735664605592698[279] = 0.0; - out_1396735664605592698[280] = 0.0; - out_1396735664605592698[281] = 0.0; - out_1396735664605592698[282] = 0.0; - out_1396735664605592698[283] = 0.0; - out_1396735664605592698[284] = 0.0; - out_1396735664605592698[285] = 1.0; - out_1396735664605592698[286] = 0.0; - out_1396735664605592698[287] = 0.0; - out_1396735664605592698[288] = 0.0; - out_1396735664605592698[289] = 0.0; - out_1396735664605592698[290] = 0.0; - out_1396735664605592698[291] = 0.0; - out_1396735664605592698[292] = 0.0; - out_1396735664605592698[293] = 0.0; - out_1396735664605592698[294] = 0.0; - out_1396735664605592698[295] = 0.0; - out_1396735664605592698[296] = 0.0; - out_1396735664605592698[297] = 0.0; - out_1396735664605592698[298] = 0.0; - out_1396735664605592698[299] = 0.0; - out_1396735664605592698[300] = 0.0; - out_1396735664605592698[301] = 0.0; - out_1396735664605592698[302] = 0.0; - out_1396735664605592698[303] = 0.0; - out_1396735664605592698[304] = 1.0; - out_1396735664605592698[305] = 0.0; - out_1396735664605592698[306] = 0.0; - out_1396735664605592698[307] = 0.0; - out_1396735664605592698[308] = 0.0; - out_1396735664605592698[309] = 0.0; - out_1396735664605592698[310] = 0.0; - out_1396735664605592698[311] = 0.0; - out_1396735664605592698[312] = 0.0; - out_1396735664605592698[313] = 0.0; - out_1396735664605592698[314] = 0.0; - out_1396735664605592698[315] = 0.0; - out_1396735664605592698[316] = 0.0; - out_1396735664605592698[317] = 0.0; - out_1396735664605592698[318] = 0.0; - out_1396735664605592698[319] = 0.0; - out_1396735664605592698[320] = 0.0; - out_1396735664605592698[321] = 0.0; - out_1396735664605592698[322] = 0.0; - out_1396735664605592698[323] = 1.0; +void H_mod_fun(double *state, double *out_6056162720073724257) { + out_6056162720073724257[0] = 1.0; + out_6056162720073724257[1] = 0.0; + out_6056162720073724257[2] = 0.0; + out_6056162720073724257[3] = 0.0; + out_6056162720073724257[4] = 0.0; + out_6056162720073724257[5] = 0.0; + out_6056162720073724257[6] = 0.0; + out_6056162720073724257[7] = 0.0; + out_6056162720073724257[8] = 0.0; + out_6056162720073724257[9] = 0.0; + out_6056162720073724257[10] = 0.0; + out_6056162720073724257[11] = 0.0; + out_6056162720073724257[12] = 0.0; + out_6056162720073724257[13] = 0.0; + out_6056162720073724257[14] = 0.0; + out_6056162720073724257[15] = 0.0; + out_6056162720073724257[16] = 0.0; + out_6056162720073724257[17] = 0.0; + out_6056162720073724257[18] = 0.0; + out_6056162720073724257[19] = 1.0; + out_6056162720073724257[20] = 0.0; + out_6056162720073724257[21] = 0.0; + out_6056162720073724257[22] = 0.0; + out_6056162720073724257[23] = 0.0; + out_6056162720073724257[24] = 0.0; + out_6056162720073724257[25] = 0.0; + out_6056162720073724257[26] = 0.0; + out_6056162720073724257[27] = 0.0; + out_6056162720073724257[28] = 0.0; + out_6056162720073724257[29] = 0.0; + out_6056162720073724257[30] = 0.0; + out_6056162720073724257[31] = 0.0; + out_6056162720073724257[32] = 0.0; + out_6056162720073724257[33] = 0.0; + out_6056162720073724257[34] = 0.0; + out_6056162720073724257[35] = 0.0; + out_6056162720073724257[36] = 0.0; + out_6056162720073724257[37] = 0.0; + out_6056162720073724257[38] = 1.0; + out_6056162720073724257[39] = 0.0; + out_6056162720073724257[40] = 0.0; + out_6056162720073724257[41] = 0.0; + out_6056162720073724257[42] = 0.0; + out_6056162720073724257[43] = 0.0; + out_6056162720073724257[44] = 0.0; + out_6056162720073724257[45] = 0.0; + out_6056162720073724257[46] = 0.0; + out_6056162720073724257[47] = 0.0; + out_6056162720073724257[48] = 0.0; + out_6056162720073724257[49] = 0.0; + out_6056162720073724257[50] = 0.0; + out_6056162720073724257[51] = 0.0; + out_6056162720073724257[52] = 0.0; + out_6056162720073724257[53] = 0.0; + out_6056162720073724257[54] = 0.0; + out_6056162720073724257[55] = 0.0; + out_6056162720073724257[56] = 0.0; + out_6056162720073724257[57] = 1.0; + out_6056162720073724257[58] = 0.0; + out_6056162720073724257[59] = 0.0; + out_6056162720073724257[60] = 0.0; + out_6056162720073724257[61] = 0.0; + out_6056162720073724257[62] = 0.0; + out_6056162720073724257[63] = 0.0; + out_6056162720073724257[64] = 0.0; + out_6056162720073724257[65] = 0.0; + out_6056162720073724257[66] = 0.0; + out_6056162720073724257[67] = 0.0; + out_6056162720073724257[68] = 0.0; + out_6056162720073724257[69] = 0.0; + out_6056162720073724257[70] = 0.0; + out_6056162720073724257[71] = 0.0; + out_6056162720073724257[72] = 0.0; + out_6056162720073724257[73] = 0.0; + out_6056162720073724257[74] = 0.0; + out_6056162720073724257[75] = 0.0; + out_6056162720073724257[76] = 1.0; + out_6056162720073724257[77] = 0.0; + out_6056162720073724257[78] = 0.0; + out_6056162720073724257[79] = 0.0; + out_6056162720073724257[80] = 0.0; + out_6056162720073724257[81] = 0.0; + out_6056162720073724257[82] = 0.0; + out_6056162720073724257[83] = 0.0; + out_6056162720073724257[84] = 0.0; + out_6056162720073724257[85] = 0.0; + out_6056162720073724257[86] = 0.0; + out_6056162720073724257[87] = 0.0; + out_6056162720073724257[88] = 0.0; + out_6056162720073724257[89] = 0.0; + out_6056162720073724257[90] = 0.0; + out_6056162720073724257[91] = 0.0; + out_6056162720073724257[92] = 0.0; + out_6056162720073724257[93] = 0.0; + out_6056162720073724257[94] = 0.0; + out_6056162720073724257[95] = 1.0; + out_6056162720073724257[96] = 0.0; + out_6056162720073724257[97] = 0.0; + out_6056162720073724257[98] = 0.0; + out_6056162720073724257[99] = 0.0; + out_6056162720073724257[100] = 0.0; + out_6056162720073724257[101] = 0.0; + out_6056162720073724257[102] = 0.0; + out_6056162720073724257[103] = 0.0; + out_6056162720073724257[104] = 0.0; + out_6056162720073724257[105] = 0.0; + out_6056162720073724257[106] = 0.0; + out_6056162720073724257[107] = 0.0; + out_6056162720073724257[108] = 0.0; + out_6056162720073724257[109] = 0.0; + out_6056162720073724257[110] = 0.0; + out_6056162720073724257[111] = 0.0; + out_6056162720073724257[112] = 0.0; + out_6056162720073724257[113] = 0.0; + out_6056162720073724257[114] = 1.0; + out_6056162720073724257[115] = 0.0; + out_6056162720073724257[116] = 0.0; + out_6056162720073724257[117] = 0.0; + out_6056162720073724257[118] = 0.0; + out_6056162720073724257[119] = 0.0; + out_6056162720073724257[120] = 0.0; + out_6056162720073724257[121] = 0.0; + out_6056162720073724257[122] = 0.0; + out_6056162720073724257[123] = 0.0; + out_6056162720073724257[124] = 0.0; + out_6056162720073724257[125] = 0.0; + out_6056162720073724257[126] = 0.0; + out_6056162720073724257[127] = 0.0; + out_6056162720073724257[128] = 0.0; + out_6056162720073724257[129] = 0.0; + out_6056162720073724257[130] = 0.0; + out_6056162720073724257[131] = 0.0; + out_6056162720073724257[132] = 0.0; + out_6056162720073724257[133] = 1.0; + out_6056162720073724257[134] = 0.0; + out_6056162720073724257[135] = 0.0; + out_6056162720073724257[136] = 0.0; + out_6056162720073724257[137] = 0.0; + out_6056162720073724257[138] = 0.0; + out_6056162720073724257[139] = 0.0; + out_6056162720073724257[140] = 0.0; + out_6056162720073724257[141] = 0.0; + out_6056162720073724257[142] = 0.0; + out_6056162720073724257[143] = 0.0; + out_6056162720073724257[144] = 0.0; + out_6056162720073724257[145] = 0.0; + out_6056162720073724257[146] = 0.0; + out_6056162720073724257[147] = 0.0; + out_6056162720073724257[148] = 0.0; + out_6056162720073724257[149] = 0.0; + out_6056162720073724257[150] = 0.0; + out_6056162720073724257[151] = 0.0; + out_6056162720073724257[152] = 1.0; + out_6056162720073724257[153] = 0.0; + out_6056162720073724257[154] = 0.0; + out_6056162720073724257[155] = 0.0; + out_6056162720073724257[156] = 0.0; + out_6056162720073724257[157] = 0.0; + out_6056162720073724257[158] = 0.0; + out_6056162720073724257[159] = 0.0; + out_6056162720073724257[160] = 0.0; + out_6056162720073724257[161] = 0.0; + out_6056162720073724257[162] = 0.0; + out_6056162720073724257[163] = 0.0; + out_6056162720073724257[164] = 0.0; + out_6056162720073724257[165] = 0.0; + out_6056162720073724257[166] = 0.0; + out_6056162720073724257[167] = 0.0; + out_6056162720073724257[168] = 0.0; + out_6056162720073724257[169] = 0.0; + out_6056162720073724257[170] = 0.0; + out_6056162720073724257[171] = 1.0; + out_6056162720073724257[172] = 0.0; + out_6056162720073724257[173] = 0.0; + out_6056162720073724257[174] = 0.0; + out_6056162720073724257[175] = 0.0; + out_6056162720073724257[176] = 0.0; + out_6056162720073724257[177] = 0.0; + out_6056162720073724257[178] = 0.0; + out_6056162720073724257[179] = 0.0; + out_6056162720073724257[180] = 0.0; + out_6056162720073724257[181] = 0.0; + out_6056162720073724257[182] = 0.0; + out_6056162720073724257[183] = 0.0; + out_6056162720073724257[184] = 0.0; + out_6056162720073724257[185] = 0.0; + out_6056162720073724257[186] = 0.0; + out_6056162720073724257[187] = 0.0; + out_6056162720073724257[188] = 0.0; + out_6056162720073724257[189] = 0.0; + out_6056162720073724257[190] = 1.0; + out_6056162720073724257[191] = 0.0; + out_6056162720073724257[192] = 0.0; + out_6056162720073724257[193] = 0.0; + out_6056162720073724257[194] = 0.0; + out_6056162720073724257[195] = 0.0; + out_6056162720073724257[196] = 0.0; + out_6056162720073724257[197] = 0.0; + out_6056162720073724257[198] = 0.0; + out_6056162720073724257[199] = 0.0; + out_6056162720073724257[200] = 0.0; + out_6056162720073724257[201] = 0.0; + out_6056162720073724257[202] = 0.0; + out_6056162720073724257[203] = 0.0; + out_6056162720073724257[204] = 0.0; + out_6056162720073724257[205] = 0.0; + out_6056162720073724257[206] = 0.0; + out_6056162720073724257[207] = 0.0; + out_6056162720073724257[208] = 0.0; + out_6056162720073724257[209] = 1.0; + out_6056162720073724257[210] = 0.0; + out_6056162720073724257[211] = 0.0; + out_6056162720073724257[212] = 0.0; + out_6056162720073724257[213] = 0.0; + out_6056162720073724257[214] = 0.0; + out_6056162720073724257[215] = 0.0; + out_6056162720073724257[216] = 0.0; + out_6056162720073724257[217] = 0.0; + out_6056162720073724257[218] = 0.0; + out_6056162720073724257[219] = 0.0; + out_6056162720073724257[220] = 0.0; + out_6056162720073724257[221] = 0.0; + out_6056162720073724257[222] = 0.0; + out_6056162720073724257[223] = 0.0; + out_6056162720073724257[224] = 0.0; + out_6056162720073724257[225] = 0.0; + out_6056162720073724257[226] = 0.0; + out_6056162720073724257[227] = 0.0; + out_6056162720073724257[228] = 1.0; + out_6056162720073724257[229] = 0.0; + out_6056162720073724257[230] = 0.0; + out_6056162720073724257[231] = 0.0; + out_6056162720073724257[232] = 0.0; + out_6056162720073724257[233] = 0.0; + out_6056162720073724257[234] = 0.0; + out_6056162720073724257[235] = 0.0; + out_6056162720073724257[236] = 0.0; + out_6056162720073724257[237] = 0.0; + out_6056162720073724257[238] = 0.0; + out_6056162720073724257[239] = 0.0; + out_6056162720073724257[240] = 0.0; + out_6056162720073724257[241] = 0.0; + out_6056162720073724257[242] = 0.0; + out_6056162720073724257[243] = 0.0; + out_6056162720073724257[244] = 0.0; + out_6056162720073724257[245] = 0.0; + out_6056162720073724257[246] = 0.0; + out_6056162720073724257[247] = 1.0; + out_6056162720073724257[248] = 0.0; + out_6056162720073724257[249] = 0.0; + out_6056162720073724257[250] = 0.0; + out_6056162720073724257[251] = 0.0; + out_6056162720073724257[252] = 0.0; + out_6056162720073724257[253] = 0.0; + out_6056162720073724257[254] = 0.0; + out_6056162720073724257[255] = 0.0; + out_6056162720073724257[256] = 0.0; + out_6056162720073724257[257] = 0.0; + out_6056162720073724257[258] = 0.0; + out_6056162720073724257[259] = 0.0; + out_6056162720073724257[260] = 0.0; + out_6056162720073724257[261] = 0.0; + out_6056162720073724257[262] = 0.0; + out_6056162720073724257[263] = 0.0; + out_6056162720073724257[264] = 0.0; + out_6056162720073724257[265] = 0.0; + out_6056162720073724257[266] = 1.0; + out_6056162720073724257[267] = 0.0; + out_6056162720073724257[268] = 0.0; + out_6056162720073724257[269] = 0.0; + out_6056162720073724257[270] = 0.0; + out_6056162720073724257[271] = 0.0; + out_6056162720073724257[272] = 0.0; + out_6056162720073724257[273] = 0.0; + out_6056162720073724257[274] = 0.0; + out_6056162720073724257[275] = 0.0; + out_6056162720073724257[276] = 0.0; + out_6056162720073724257[277] = 0.0; + out_6056162720073724257[278] = 0.0; + out_6056162720073724257[279] = 0.0; + out_6056162720073724257[280] = 0.0; + out_6056162720073724257[281] = 0.0; + out_6056162720073724257[282] = 0.0; + out_6056162720073724257[283] = 0.0; + out_6056162720073724257[284] = 0.0; + out_6056162720073724257[285] = 1.0; + out_6056162720073724257[286] = 0.0; + out_6056162720073724257[287] = 0.0; + out_6056162720073724257[288] = 0.0; + out_6056162720073724257[289] = 0.0; + out_6056162720073724257[290] = 0.0; + out_6056162720073724257[291] = 0.0; + out_6056162720073724257[292] = 0.0; + out_6056162720073724257[293] = 0.0; + out_6056162720073724257[294] = 0.0; + out_6056162720073724257[295] = 0.0; + out_6056162720073724257[296] = 0.0; + out_6056162720073724257[297] = 0.0; + out_6056162720073724257[298] = 0.0; + out_6056162720073724257[299] = 0.0; + out_6056162720073724257[300] = 0.0; + out_6056162720073724257[301] = 0.0; + out_6056162720073724257[302] = 0.0; + out_6056162720073724257[303] = 0.0; + out_6056162720073724257[304] = 1.0; + out_6056162720073724257[305] = 0.0; + out_6056162720073724257[306] = 0.0; + out_6056162720073724257[307] = 0.0; + out_6056162720073724257[308] = 0.0; + out_6056162720073724257[309] = 0.0; + out_6056162720073724257[310] = 0.0; + out_6056162720073724257[311] = 0.0; + out_6056162720073724257[312] = 0.0; + out_6056162720073724257[313] = 0.0; + out_6056162720073724257[314] = 0.0; + out_6056162720073724257[315] = 0.0; + out_6056162720073724257[316] = 0.0; + out_6056162720073724257[317] = 0.0; + out_6056162720073724257[318] = 0.0; + out_6056162720073724257[319] = 0.0; + out_6056162720073724257[320] = 0.0; + out_6056162720073724257[321] = 0.0; + out_6056162720073724257[322] = 0.0; + out_6056162720073724257[323] = 1.0; } -void f_fun(double *state, double dt, double *out_916482441408583797) { - out_916482441408583797[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_916482441408583797[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_916482441408583797[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_916482441408583797[3] = dt*state[12] + state[3]; - out_916482441408583797[4] = dt*state[13] + state[4]; - out_916482441408583797[5] = dt*state[14] + state[5]; - out_916482441408583797[6] = state[6]; - out_916482441408583797[7] = state[7]; - out_916482441408583797[8] = state[8]; - out_916482441408583797[9] = state[9]; - out_916482441408583797[10] = state[10]; - out_916482441408583797[11] = state[11]; - out_916482441408583797[12] = state[12]; - out_916482441408583797[13] = state[13]; - out_916482441408583797[14] = state[14]; - out_916482441408583797[15] = state[15]; - out_916482441408583797[16] = state[16]; - out_916482441408583797[17] = state[17]; +void f_fun(double *state, double dt, double *out_8780284750928315681) { + out_8780284750928315681[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_8780284750928315681[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_8780284750928315681[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_8780284750928315681[3] = dt*state[12] + state[3]; + out_8780284750928315681[4] = dt*state[13] + state[4]; + out_8780284750928315681[5] = dt*state[14] + state[5]; + out_8780284750928315681[6] = state[6]; + out_8780284750928315681[7] = state[7]; + out_8780284750928315681[8] = state[8]; + out_8780284750928315681[9] = state[9]; + out_8780284750928315681[10] = state[10]; + out_8780284750928315681[11] = state[11]; + out_8780284750928315681[12] = state[12]; + out_8780284750928315681[13] = state[13]; + out_8780284750928315681[14] = state[14]; + out_8780284750928315681[15] = state[15]; + out_8780284750928315681[16] = state[16]; + out_8780284750928315681[17] = state[17]; } -void F_fun(double *state, double dt, double *out_5639772936950525263) { - out_5639772936950525263[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_5639772936950525263[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_5639772936950525263[2] = 0; - out_5639772936950525263[3] = 0; - out_5639772936950525263[4] = 0; - out_5639772936950525263[5] = 0; - out_5639772936950525263[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_5639772936950525263[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_5639772936950525263[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_5639772936950525263[9] = 0; - out_5639772936950525263[10] = 0; - out_5639772936950525263[11] = 0; - out_5639772936950525263[12] = 0; - out_5639772936950525263[13] = 0; - out_5639772936950525263[14] = 0; - out_5639772936950525263[15] = 0; - out_5639772936950525263[16] = 0; - out_5639772936950525263[17] = 0; - out_5639772936950525263[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_5639772936950525263[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_5639772936950525263[20] = 0; - out_5639772936950525263[21] = 0; - out_5639772936950525263[22] = 0; - out_5639772936950525263[23] = 0; - out_5639772936950525263[24] = 0; - out_5639772936950525263[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_5639772936950525263[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_5639772936950525263[27] = 0; - out_5639772936950525263[28] = 0; - out_5639772936950525263[29] = 0; - out_5639772936950525263[30] = 0; - out_5639772936950525263[31] = 0; - out_5639772936950525263[32] = 0; - out_5639772936950525263[33] = 0; - out_5639772936950525263[34] = 0; - out_5639772936950525263[35] = 0; - out_5639772936950525263[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_5639772936950525263[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_5639772936950525263[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_5639772936950525263[39] = 0; - out_5639772936950525263[40] = 0; - out_5639772936950525263[41] = 0; - out_5639772936950525263[42] = 0; - out_5639772936950525263[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_5639772936950525263[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_5639772936950525263[45] = 0; - out_5639772936950525263[46] = 0; - out_5639772936950525263[47] = 0; - out_5639772936950525263[48] = 0; - out_5639772936950525263[49] = 0; - out_5639772936950525263[50] = 0; - out_5639772936950525263[51] = 0; - out_5639772936950525263[52] = 0; - out_5639772936950525263[53] = 0; - out_5639772936950525263[54] = 0; - out_5639772936950525263[55] = 0; - out_5639772936950525263[56] = 0; - out_5639772936950525263[57] = 1; - out_5639772936950525263[58] = 0; - out_5639772936950525263[59] = 0; - out_5639772936950525263[60] = 0; - out_5639772936950525263[61] = 0; - out_5639772936950525263[62] = 0; - out_5639772936950525263[63] = 0; - out_5639772936950525263[64] = 0; - out_5639772936950525263[65] = 0; - out_5639772936950525263[66] = dt; - out_5639772936950525263[67] = 0; - out_5639772936950525263[68] = 0; - out_5639772936950525263[69] = 0; - out_5639772936950525263[70] = 0; - out_5639772936950525263[71] = 0; - out_5639772936950525263[72] = 0; - out_5639772936950525263[73] = 0; - out_5639772936950525263[74] = 0; - out_5639772936950525263[75] = 0; - out_5639772936950525263[76] = 1; - out_5639772936950525263[77] = 0; - out_5639772936950525263[78] = 0; - out_5639772936950525263[79] = 0; - out_5639772936950525263[80] = 0; - out_5639772936950525263[81] = 0; - out_5639772936950525263[82] = 0; - out_5639772936950525263[83] = 0; - out_5639772936950525263[84] = 0; - out_5639772936950525263[85] = dt; - out_5639772936950525263[86] = 0; - out_5639772936950525263[87] = 0; - out_5639772936950525263[88] = 0; - out_5639772936950525263[89] = 0; - out_5639772936950525263[90] = 0; - out_5639772936950525263[91] = 0; - out_5639772936950525263[92] = 0; - out_5639772936950525263[93] = 0; - out_5639772936950525263[94] = 0; - out_5639772936950525263[95] = 1; - out_5639772936950525263[96] = 0; - out_5639772936950525263[97] = 0; - out_5639772936950525263[98] = 0; - out_5639772936950525263[99] = 0; - out_5639772936950525263[100] = 0; - out_5639772936950525263[101] = 0; - out_5639772936950525263[102] = 0; - out_5639772936950525263[103] = 0; - out_5639772936950525263[104] = dt; - out_5639772936950525263[105] = 0; - out_5639772936950525263[106] = 0; - out_5639772936950525263[107] = 0; - out_5639772936950525263[108] = 0; - out_5639772936950525263[109] = 0; - out_5639772936950525263[110] = 0; - out_5639772936950525263[111] = 0; - out_5639772936950525263[112] = 0; - out_5639772936950525263[113] = 0; - out_5639772936950525263[114] = 1; - out_5639772936950525263[115] = 0; - out_5639772936950525263[116] = 0; - out_5639772936950525263[117] = 0; - out_5639772936950525263[118] = 0; - out_5639772936950525263[119] = 0; - out_5639772936950525263[120] = 0; - out_5639772936950525263[121] = 0; - out_5639772936950525263[122] = 0; - out_5639772936950525263[123] = 0; - out_5639772936950525263[124] = 0; - out_5639772936950525263[125] = 0; - out_5639772936950525263[126] = 0; - out_5639772936950525263[127] = 0; - out_5639772936950525263[128] = 0; - out_5639772936950525263[129] = 0; - out_5639772936950525263[130] = 0; - out_5639772936950525263[131] = 0; - out_5639772936950525263[132] = 0; - out_5639772936950525263[133] = 1; - out_5639772936950525263[134] = 0; - out_5639772936950525263[135] = 0; - out_5639772936950525263[136] = 0; - out_5639772936950525263[137] = 0; - out_5639772936950525263[138] = 0; - out_5639772936950525263[139] = 0; - out_5639772936950525263[140] = 0; - out_5639772936950525263[141] = 0; - out_5639772936950525263[142] = 0; - out_5639772936950525263[143] = 0; - out_5639772936950525263[144] = 0; - out_5639772936950525263[145] = 0; - out_5639772936950525263[146] = 0; - out_5639772936950525263[147] = 0; - out_5639772936950525263[148] = 0; - out_5639772936950525263[149] = 0; - out_5639772936950525263[150] = 0; - out_5639772936950525263[151] = 0; - out_5639772936950525263[152] = 1; - out_5639772936950525263[153] = 0; - out_5639772936950525263[154] = 0; - out_5639772936950525263[155] = 0; - out_5639772936950525263[156] = 0; - out_5639772936950525263[157] = 0; - out_5639772936950525263[158] = 0; - out_5639772936950525263[159] = 0; - out_5639772936950525263[160] = 0; - out_5639772936950525263[161] = 0; - out_5639772936950525263[162] = 0; - out_5639772936950525263[163] = 0; - out_5639772936950525263[164] = 0; - out_5639772936950525263[165] = 0; - out_5639772936950525263[166] = 0; - out_5639772936950525263[167] = 0; - out_5639772936950525263[168] = 0; - out_5639772936950525263[169] = 0; - out_5639772936950525263[170] = 0; - out_5639772936950525263[171] = 1; - out_5639772936950525263[172] = 0; - out_5639772936950525263[173] = 0; - out_5639772936950525263[174] = 0; - out_5639772936950525263[175] = 0; - out_5639772936950525263[176] = 0; - out_5639772936950525263[177] = 0; - out_5639772936950525263[178] = 0; - out_5639772936950525263[179] = 0; - out_5639772936950525263[180] = 0; - out_5639772936950525263[181] = 0; - out_5639772936950525263[182] = 0; - out_5639772936950525263[183] = 0; - out_5639772936950525263[184] = 0; - out_5639772936950525263[185] = 0; - out_5639772936950525263[186] = 0; - out_5639772936950525263[187] = 0; - out_5639772936950525263[188] = 0; - out_5639772936950525263[189] = 0; - out_5639772936950525263[190] = 1; - out_5639772936950525263[191] = 0; - out_5639772936950525263[192] = 0; - out_5639772936950525263[193] = 0; - out_5639772936950525263[194] = 0; - out_5639772936950525263[195] = 0; - out_5639772936950525263[196] = 0; - out_5639772936950525263[197] = 0; - out_5639772936950525263[198] = 0; - out_5639772936950525263[199] = 0; - out_5639772936950525263[200] = 0; - out_5639772936950525263[201] = 0; - out_5639772936950525263[202] = 0; - out_5639772936950525263[203] = 0; - out_5639772936950525263[204] = 0; - out_5639772936950525263[205] = 0; - out_5639772936950525263[206] = 0; - out_5639772936950525263[207] = 0; - out_5639772936950525263[208] = 0; - out_5639772936950525263[209] = 1; - out_5639772936950525263[210] = 0; - out_5639772936950525263[211] = 0; - out_5639772936950525263[212] = 0; - out_5639772936950525263[213] = 0; - out_5639772936950525263[214] = 0; - out_5639772936950525263[215] = 0; - out_5639772936950525263[216] = 0; - out_5639772936950525263[217] = 0; - out_5639772936950525263[218] = 0; - out_5639772936950525263[219] = 0; - out_5639772936950525263[220] = 0; - out_5639772936950525263[221] = 0; - out_5639772936950525263[222] = 0; - out_5639772936950525263[223] = 0; - out_5639772936950525263[224] = 0; - out_5639772936950525263[225] = 0; - out_5639772936950525263[226] = 0; - out_5639772936950525263[227] = 0; - out_5639772936950525263[228] = 1; - out_5639772936950525263[229] = 0; - out_5639772936950525263[230] = 0; - out_5639772936950525263[231] = 0; - out_5639772936950525263[232] = 0; - out_5639772936950525263[233] = 0; - out_5639772936950525263[234] = 0; - out_5639772936950525263[235] = 0; - out_5639772936950525263[236] = 0; - out_5639772936950525263[237] = 0; - out_5639772936950525263[238] = 0; - out_5639772936950525263[239] = 0; - out_5639772936950525263[240] = 0; - out_5639772936950525263[241] = 0; - out_5639772936950525263[242] = 0; - out_5639772936950525263[243] = 0; - out_5639772936950525263[244] = 0; - out_5639772936950525263[245] = 0; - out_5639772936950525263[246] = 0; - out_5639772936950525263[247] = 1; - out_5639772936950525263[248] = 0; - out_5639772936950525263[249] = 0; - out_5639772936950525263[250] = 0; - out_5639772936950525263[251] = 0; - out_5639772936950525263[252] = 0; - out_5639772936950525263[253] = 0; - out_5639772936950525263[254] = 0; - out_5639772936950525263[255] = 0; - out_5639772936950525263[256] = 0; - out_5639772936950525263[257] = 0; - out_5639772936950525263[258] = 0; - out_5639772936950525263[259] = 0; - out_5639772936950525263[260] = 0; - out_5639772936950525263[261] = 0; - out_5639772936950525263[262] = 0; - out_5639772936950525263[263] = 0; - out_5639772936950525263[264] = 0; - out_5639772936950525263[265] = 0; - out_5639772936950525263[266] = 1; - out_5639772936950525263[267] = 0; - out_5639772936950525263[268] = 0; - out_5639772936950525263[269] = 0; - out_5639772936950525263[270] = 0; - out_5639772936950525263[271] = 0; - out_5639772936950525263[272] = 0; - out_5639772936950525263[273] = 0; - out_5639772936950525263[274] = 0; - out_5639772936950525263[275] = 0; - out_5639772936950525263[276] = 0; - out_5639772936950525263[277] = 0; - out_5639772936950525263[278] = 0; - out_5639772936950525263[279] = 0; - out_5639772936950525263[280] = 0; - out_5639772936950525263[281] = 0; - out_5639772936950525263[282] = 0; - out_5639772936950525263[283] = 0; - out_5639772936950525263[284] = 0; - out_5639772936950525263[285] = 1; - out_5639772936950525263[286] = 0; - out_5639772936950525263[287] = 0; - out_5639772936950525263[288] = 0; - out_5639772936950525263[289] = 0; - out_5639772936950525263[290] = 0; - out_5639772936950525263[291] = 0; - out_5639772936950525263[292] = 0; - out_5639772936950525263[293] = 0; - out_5639772936950525263[294] = 0; - out_5639772936950525263[295] = 0; - out_5639772936950525263[296] = 0; - out_5639772936950525263[297] = 0; - out_5639772936950525263[298] = 0; - out_5639772936950525263[299] = 0; - out_5639772936950525263[300] = 0; - out_5639772936950525263[301] = 0; - out_5639772936950525263[302] = 0; - out_5639772936950525263[303] = 0; - out_5639772936950525263[304] = 1; - out_5639772936950525263[305] = 0; - out_5639772936950525263[306] = 0; - out_5639772936950525263[307] = 0; - out_5639772936950525263[308] = 0; - out_5639772936950525263[309] = 0; - out_5639772936950525263[310] = 0; - out_5639772936950525263[311] = 0; - out_5639772936950525263[312] = 0; - out_5639772936950525263[313] = 0; - out_5639772936950525263[314] = 0; - out_5639772936950525263[315] = 0; - out_5639772936950525263[316] = 0; - out_5639772936950525263[317] = 0; - out_5639772936950525263[318] = 0; - out_5639772936950525263[319] = 0; - out_5639772936950525263[320] = 0; - out_5639772936950525263[321] = 0; - out_5639772936950525263[322] = 0; - out_5639772936950525263[323] = 1; +void F_fun(double *state, double dt, double *out_1516035527731464330) { + out_1516035527731464330[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_1516035527731464330[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_1516035527731464330[2] = 0; + out_1516035527731464330[3] = 0; + out_1516035527731464330[4] = 0; + out_1516035527731464330[5] = 0; + out_1516035527731464330[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_1516035527731464330[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_1516035527731464330[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_1516035527731464330[9] = 0; + out_1516035527731464330[10] = 0; + out_1516035527731464330[11] = 0; + out_1516035527731464330[12] = 0; + out_1516035527731464330[13] = 0; + out_1516035527731464330[14] = 0; + out_1516035527731464330[15] = 0; + out_1516035527731464330[16] = 0; + out_1516035527731464330[17] = 0; + out_1516035527731464330[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_1516035527731464330[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_1516035527731464330[20] = 0; + out_1516035527731464330[21] = 0; + out_1516035527731464330[22] = 0; + out_1516035527731464330[23] = 0; + out_1516035527731464330[24] = 0; + out_1516035527731464330[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_1516035527731464330[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_1516035527731464330[27] = 0; + out_1516035527731464330[28] = 0; + out_1516035527731464330[29] = 0; + out_1516035527731464330[30] = 0; + out_1516035527731464330[31] = 0; + out_1516035527731464330[32] = 0; + out_1516035527731464330[33] = 0; + out_1516035527731464330[34] = 0; + out_1516035527731464330[35] = 0; + out_1516035527731464330[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_1516035527731464330[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_1516035527731464330[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_1516035527731464330[39] = 0; + out_1516035527731464330[40] = 0; + out_1516035527731464330[41] = 0; + out_1516035527731464330[42] = 0; + out_1516035527731464330[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_1516035527731464330[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_1516035527731464330[45] = 0; + out_1516035527731464330[46] = 0; + out_1516035527731464330[47] = 0; + out_1516035527731464330[48] = 0; + out_1516035527731464330[49] = 0; + out_1516035527731464330[50] = 0; + out_1516035527731464330[51] = 0; + out_1516035527731464330[52] = 0; + out_1516035527731464330[53] = 0; + out_1516035527731464330[54] = 0; + out_1516035527731464330[55] = 0; + out_1516035527731464330[56] = 0; + out_1516035527731464330[57] = 1; + out_1516035527731464330[58] = 0; + out_1516035527731464330[59] = 0; + out_1516035527731464330[60] = 0; + out_1516035527731464330[61] = 0; + out_1516035527731464330[62] = 0; + out_1516035527731464330[63] = 0; + out_1516035527731464330[64] = 0; + out_1516035527731464330[65] = 0; + out_1516035527731464330[66] = dt; + out_1516035527731464330[67] = 0; + out_1516035527731464330[68] = 0; + out_1516035527731464330[69] = 0; + out_1516035527731464330[70] = 0; + out_1516035527731464330[71] = 0; + out_1516035527731464330[72] = 0; + out_1516035527731464330[73] = 0; + out_1516035527731464330[74] = 0; + out_1516035527731464330[75] = 0; + out_1516035527731464330[76] = 1; + out_1516035527731464330[77] = 0; + out_1516035527731464330[78] = 0; + out_1516035527731464330[79] = 0; + out_1516035527731464330[80] = 0; + out_1516035527731464330[81] = 0; + out_1516035527731464330[82] = 0; + out_1516035527731464330[83] = 0; + out_1516035527731464330[84] = 0; + out_1516035527731464330[85] = dt; + out_1516035527731464330[86] = 0; + out_1516035527731464330[87] = 0; + out_1516035527731464330[88] = 0; + out_1516035527731464330[89] = 0; + out_1516035527731464330[90] = 0; + out_1516035527731464330[91] = 0; + out_1516035527731464330[92] = 0; + out_1516035527731464330[93] = 0; + out_1516035527731464330[94] = 0; + out_1516035527731464330[95] = 1; + out_1516035527731464330[96] = 0; + out_1516035527731464330[97] = 0; + out_1516035527731464330[98] = 0; + out_1516035527731464330[99] = 0; + out_1516035527731464330[100] = 0; + out_1516035527731464330[101] = 0; + out_1516035527731464330[102] = 0; + out_1516035527731464330[103] = 0; + out_1516035527731464330[104] = dt; + out_1516035527731464330[105] = 0; + out_1516035527731464330[106] = 0; + out_1516035527731464330[107] = 0; + out_1516035527731464330[108] = 0; + out_1516035527731464330[109] = 0; + out_1516035527731464330[110] = 0; + out_1516035527731464330[111] = 0; + out_1516035527731464330[112] = 0; + out_1516035527731464330[113] = 0; + out_1516035527731464330[114] = 1; + out_1516035527731464330[115] = 0; + out_1516035527731464330[116] = 0; + out_1516035527731464330[117] = 0; + out_1516035527731464330[118] = 0; + out_1516035527731464330[119] = 0; + out_1516035527731464330[120] = 0; + out_1516035527731464330[121] = 0; + out_1516035527731464330[122] = 0; + out_1516035527731464330[123] = 0; + out_1516035527731464330[124] = 0; + out_1516035527731464330[125] = 0; + out_1516035527731464330[126] = 0; + out_1516035527731464330[127] = 0; + out_1516035527731464330[128] = 0; + out_1516035527731464330[129] = 0; + out_1516035527731464330[130] = 0; + out_1516035527731464330[131] = 0; + out_1516035527731464330[132] = 0; + out_1516035527731464330[133] = 1; + out_1516035527731464330[134] = 0; + out_1516035527731464330[135] = 0; + out_1516035527731464330[136] = 0; + out_1516035527731464330[137] = 0; + out_1516035527731464330[138] = 0; + out_1516035527731464330[139] = 0; + out_1516035527731464330[140] = 0; + out_1516035527731464330[141] = 0; + out_1516035527731464330[142] = 0; + out_1516035527731464330[143] = 0; + out_1516035527731464330[144] = 0; + out_1516035527731464330[145] = 0; + out_1516035527731464330[146] = 0; + out_1516035527731464330[147] = 0; + out_1516035527731464330[148] = 0; + out_1516035527731464330[149] = 0; + out_1516035527731464330[150] = 0; + out_1516035527731464330[151] = 0; + out_1516035527731464330[152] = 1; + out_1516035527731464330[153] = 0; + out_1516035527731464330[154] = 0; + out_1516035527731464330[155] = 0; + out_1516035527731464330[156] = 0; + out_1516035527731464330[157] = 0; + out_1516035527731464330[158] = 0; + out_1516035527731464330[159] = 0; + out_1516035527731464330[160] = 0; + out_1516035527731464330[161] = 0; + out_1516035527731464330[162] = 0; + out_1516035527731464330[163] = 0; + out_1516035527731464330[164] = 0; + out_1516035527731464330[165] = 0; + out_1516035527731464330[166] = 0; + out_1516035527731464330[167] = 0; + out_1516035527731464330[168] = 0; + out_1516035527731464330[169] = 0; + out_1516035527731464330[170] = 0; + out_1516035527731464330[171] = 1; + out_1516035527731464330[172] = 0; + out_1516035527731464330[173] = 0; + out_1516035527731464330[174] = 0; + out_1516035527731464330[175] = 0; + out_1516035527731464330[176] = 0; + out_1516035527731464330[177] = 0; + out_1516035527731464330[178] = 0; + out_1516035527731464330[179] = 0; + out_1516035527731464330[180] = 0; + out_1516035527731464330[181] = 0; + out_1516035527731464330[182] = 0; + out_1516035527731464330[183] = 0; + out_1516035527731464330[184] = 0; + out_1516035527731464330[185] = 0; + out_1516035527731464330[186] = 0; + out_1516035527731464330[187] = 0; + out_1516035527731464330[188] = 0; + out_1516035527731464330[189] = 0; + out_1516035527731464330[190] = 1; + out_1516035527731464330[191] = 0; + out_1516035527731464330[192] = 0; + out_1516035527731464330[193] = 0; + out_1516035527731464330[194] = 0; + out_1516035527731464330[195] = 0; + out_1516035527731464330[196] = 0; + out_1516035527731464330[197] = 0; + out_1516035527731464330[198] = 0; + out_1516035527731464330[199] = 0; + out_1516035527731464330[200] = 0; + out_1516035527731464330[201] = 0; + out_1516035527731464330[202] = 0; + out_1516035527731464330[203] = 0; + out_1516035527731464330[204] = 0; + out_1516035527731464330[205] = 0; + out_1516035527731464330[206] = 0; + out_1516035527731464330[207] = 0; + out_1516035527731464330[208] = 0; + out_1516035527731464330[209] = 1; + out_1516035527731464330[210] = 0; + out_1516035527731464330[211] = 0; + out_1516035527731464330[212] = 0; + out_1516035527731464330[213] = 0; + out_1516035527731464330[214] = 0; + out_1516035527731464330[215] = 0; + out_1516035527731464330[216] = 0; + out_1516035527731464330[217] = 0; + out_1516035527731464330[218] = 0; + out_1516035527731464330[219] = 0; + out_1516035527731464330[220] = 0; + out_1516035527731464330[221] = 0; + out_1516035527731464330[222] = 0; + out_1516035527731464330[223] = 0; + out_1516035527731464330[224] = 0; + out_1516035527731464330[225] = 0; + out_1516035527731464330[226] = 0; + out_1516035527731464330[227] = 0; + out_1516035527731464330[228] = 1; + out_1516035527731464330[229] = 0; + out_1516035527731464330[230] = 0; + out_1516035527731464330[231] = 0; + out_1516035527731464330[232] = 0; + out_1516035527731464330[233] = 0; + out_1516035527731464330[234] = 0; + out_1516035527731464330[235] = 0; + out_1516035527731464330[236] = 0; + out_1516035527731464330[237] = 0; + out_1516035527731464330[238] = 0; + out_1516035527731464330[239] = 0; + out_1516035527731464330[240] = 0; + out_1516035527731464330[241] = 0; + out_1516035527731464330[242] = 0; + out_1516035527731464330[243] = 0; + out_1516035527731464330[244] = 0; + out_1516035527731464330[245] = 0; + out_1516035527731464330[246] = 0; + out_1516035527731464330[247] = 1; + out_1516035527731464330[248] = 0; + out_1516035527731464330[249] = 0; + out_1516035527731464330[250] = 0; + out_1516035527731464330[251] = 0; + out_1516035527731464330[252] = 0; + out_1516035527731464330[253] = 0; + out_1516035527731464330[254] = 0; + out_1516035527731464330[255] = 0; + out_1516035527731464330[256] = 0; + out_1516035527731464330[257] = 0; + out_1516035527731464330[258] = 0; + out_1516035527731464330[259] = 0; + out_1516035527731464330[260] = 0; + out_1516035527731464330[261] = 0; + out_1516035527731464330[262] = 0; + out_1516035527731464330[263] = 0; + out_1516035527731464330[264] = 0; + out_1516035527731464330[265] = 0; + out_1516035527731464330[266] = 1; + out_1516035527731464330[267] = 0; + out_1516035527731464330[268] = 0; + out_1516035527731464330[269] = 0; + out_1516035527731464330[270] = 0; + out_1516035527731464330[271] = 0; + out_1516035527731464330[272] = 0; + out_1516035527731464330[273] = 0; + out_1516035527731464330[274] = 0; + out_1516035527731464330[275] = 0; + out_1516035527731464330[276] = 0; + out_1516035527731464330[277] = 0; + out_1516035527731464330[278] = 0; + out_1516035527731464330[279] = 0; + out_1516035527731464330[280] = 0; + out_1516035527731464330[281] = 0; + out_1516035527731464330[282] = 0; + out_1516035527731464330[283] = 0; + out_1516035527731464330[284] = 0; + out_1516035527731464330[285] = 1; + out_1516035527731464330[286] = 0; + out_1516035527731464330[287] = 0; + out_1516035527731464330[288] = 0; + out_1516035527731464330[289] = 0; + out_1516035527731464330[290] = 0; + out_1516035527731464330[291] = 0; + out_1516035527731464330[292] = 0; + out_1516035527731464330[293] = 0; + out_1516035527731464330[294] = 0; + out_1516035527731464330[295] = 0; + out_1516035527731464330[296] = 0; + out_1516035527731464330[297] = 0; + out_1516035527731464330[298] = 0; + out_1516035527731464330[299] = 0; + out_1516035527731464330[300] = 0; + out_1516035527731464330[301] = 0; + out_1516035527731464330[302] = 0; + out_1516035527731464330[303] = 0; + out_1516035527731464330[304] = 1; + out_1516035527731464330[305] = 0; + out_1516035527731464330[306] = 0; + out_1516035527731464330[307] = 0; + out_1516035527731464330[308] = 0; + out_1516035527731464330[309] = 0; + out_1516035527731464330[310] = 0; + out_1516035527731464330[311] = 0; + out_1516035527731464330[312] = 0; + out_1516035527731464330[313] = 0; + out_1516035527731464330[314] = 0; + out_1516035527731464330[315] = 0; + out_1516035527731464330[316] = 0; + out_1516035527731464330[317] = 0; + out_1516035527731464330[318] = 0; + out_1516035527731464330[319] = 0; + out_1516035527731464330[320] = 0; + out_1516035527731464330[321] = 0; + out_1516035527731464330[322] = 0; + out_1516035527731464330[323] = 1; } -void h_4(double *state, double *unused, double *out_5848855439961291946) { - out_5848855439961291946[0] = state[6] + state[9]; - out_5848855439961291946[1] = state[7] + state[10]; - out_5848855439961291946[2] = state[8] + state[11]; +void h_4(double *state, double *unused, double *out_4492721189395603550) { + out_4492721189395603550[0] = state[6] + state[9]; + out_4492721189395603550[1] = state[7] + state[10]; + out_4492721189395603550[2] = state[8] + state[11]; } -void H_4(double *state, double *unused, double *out_3290246568201368788) { - out_3290246568201368788[0] = 0; - out_3290246568201368788[1] = 0; - out_3290246568201368788[2] = 0; - out_3290246568201368788[3] = 0; - out_3290246568201368788[4] = 0; - out_3290246568201368788[5] = 0; - out_3290246568201368788[6] = 1; - out_3290246568201368788[7] = 0; - out_3290246568201368788[8] = 0; - out_3290246568201368788[9] = 1; - out_3290246568201368788[10] = 0; - out_3290246568201368788[11] = 0; - out_3290246568201368788[12] = 0; - out_3290246568201368788[13] = 0; - out_3290246568201368788[14] = 0; - out_3290246568201368788[15] = 0; - out_3290246568201368788[16] = 0; - out_3290246568201368788[17] = 0; - out_3290246568201368788[18] = 0; - out_3290246568201368788[19] = 0; - out_3290246568201368788[20] = 0; - out_3290246568201368788[21] = 0; - out_3290246568201368788[22] = 0; - out_3290246568201368788[23] = 0; - out_3290246568201368788[24] = 0; - out_3290246568201368788[25] = 1; - out_3290246568201368788[26] = 0; - out_3290246568201368788[27] = 0; - out_3290246568201368788[28] = 1; - out_3290246568201368788[29] = 0; - out_3290246568201368788[30] = 0; - out_3290246568201368788[31] = 0; - out_3290246568201368788[32] = 0; - out_3290246568201368788[33] = 0; - out_3290246568201368788[34] = 0; - out_3290246568201368788[35] = 0; - out_3290246568201368788[36] = 0; - out_3290246568201368788[37] = 0; - out_3290246568201368788[38] = 0; - out_3290246568201368788[39] = 0; - out_3290246568201368788[40] = 0; - out_3290246568201368788[41] = 0; - out_3290246568201368788[42] = 0; - out_3290246568201368788[43] = 0; - out_3290246568201368788[44] = 1; - out_3290246568201368788[45] = 0; - out_3290246568201368788[46] = 0; - out_3290246568201368788[47] = 1; - out_3290246568201368788[48] = 0; - out_3290246568201368788[49] = 0; - out_3290246568201368788[50] = 0; - out_3290246568201368788[51] = 0; - out_3290246568201368788[52] = 0; - out_3290246568201368788[53] = 0; +void H_4(double *state, double *unused, double *out_4858215238190826153) { + out_4858215238190826153[0] = 0; + out_4858215238190826153[1] = 0; + out_4858215238190826153[2] = 0; + out_4858215238190826153[3] = 0; + out_4858215238190826153[4] = 0; + out_4858215238190826153[5] = 0; + out_4858215238190826153[6] = 1; + out_4858215238190826153[7] = 0; + out_4858215238190826153[8] = 0; + out_4858215238190826153[9] = 1; + out_4858215238190826153[10] = 0; + out_4858215238190826153[11] = 0; + out_4858215238190826153[12] = 0; + out_4858215238190826153[13] = 0; + out_4858215238190826153[14] = 0; + out_4858215238190826153[15] = 0; + out_4858215238190826153[16] = 0; + out_4858215238190826153[17] = 0; + out_4858215238190826153[18] = 0; + out_4858215238190826153[19] = 0; + out_4858215238190826153[20] = 0; + out_4858215238190826153[21] = 0; + out_4858215238190826153[22] = 0; + out_4858215238190826153[23] = 0; + out_4858215238190826153[24] = 0; + out_4858215238190826153[25] = 1; + out_4858215238190826153[26] = 0; + out_4858215238190826153[27] = 0; + out_4858215238190826153[28] = 1; + out_4858215238190826153[29] = 0; + out_4858215238190826153[30] = 0; + out_4858215238190826153[31] = 0; + out_4858215238190826153[32] = 0; + out_4858215238190826153[33] = 0; + out_4858215238190826153[34] = 0; + out_4858215238190826153[35] = 0; + out_4858215238190826153[36] = 0; + out_4858215238190826153[37] = 0; + out_4858215238190826153[38] = 0; + out_4858215238190826153[39] = 0; + out_4858215238190826153[40] = 0; + out_4858215238190826153[41] = 0; + out_4858215238190826153[42] = 0; + out_4858215238190826153[43] = 0; + out_4858215238190826153[44] = 1; + out_4858215238190826153[45] = 0; + out_4858215238190826153[46] = 0; + out_4858215238190826153[47] = 1; + out_4858215238190826153[48] = 0; + out_4858215238190826153[49] = 0; + out_4858215238190826153[50] = 0; + out_4858215238190826153[51] = 0; + out_4858215238190826153[52] = 0; + out_4858215238190826153[53] = 0; } -void h_10(double *state, double *unused, double *out_3954090448202517665) { - out_3954090448202517665[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; - out_3954090448202517665[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; - out_3954090448202517665[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_558240635521768637) { + out_558240635521768637[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; + out_558240635521768637[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; + out_558240635521768637[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_1376781969837987839) { - out_1376781969837987839[0] = 0; - out_1376781969837987839[1] = 9.8100000000000005*cos(state[1]); - out_1376781969837987839[2] = 0; - out_1376781969837987839[3] = 0; - out_1376781969837987839[4] = -state[8]; - out_1376781969837987839[5] = state[7]; - out_1376781969837987839[6] = 0; - out_1376781969837987839[7] = state[5]; - out_1376781969837987839[8] = -state[4]; - out_1376781969837987839[9] = 0; - out_1376781969837987839[10] = 0; - out_1376781969837987839[11] = 0; - out_1376781969837987839[12] = 1; - out_1376781969837987839[13] = 0; - out_1376781969837987839[14] = 0; - out_1376781969837987839[15] = 1; - out_1376781969837987839[16] = 0; - out_1376781969837987839[17] = 0; - out_1376781969837987839[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); - out_1376781969837987839[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); - out_1376781969837987839[20] = 0; - out_1376781969837987839[21] = state[8]; - out_1376781969837987839[22] = 0; - out_1376781969837987839[23] = -state[6]; - out_1376781969837987839[24] = -state[5]; - out_1376781969837987839[25] = 0; - out_1376781969837987839[26] = state[3]; - out_1376781969837987839[27] = 0; - out_1376781969837987839[28] = 0; - out_1376781969837987839[29] = 0; - out_1376781969837987839[30] = 0; - out_1376781969837987839[31] = 1; - out_1376781969837987839[32] = 0; - out_1376781969837987839[33] = 0; - out_1376781969837987839[34] = 1; - out_1376781969837987839[35] = 0; - out_1376781969837987839[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); - out_1376781969837987839[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); - out_1376781969837987839[38] = 0; - out_1376781969837987839[39] = -state[7]; - out_1376781969837987839[40] = state[6]; - out_1376781969837987839[41] = 0; - out_1376781969837987839[42] = state[4]; - out_1376781969837987839[43] = -state[3]; - out_1376781969837987839[44] = 0; - out_1376781969837987839[45] = 0; - out_1376781969837987839[46] = 0; - out_1376781969837987839[47] = 0; - out_1376781969837987839[48] = 0; - out_1376781969837987839[49] = 0; - out_1376781969837987839[50] = 1; - out_1376781969837987839[51] = 0; - out_1376781969837987839[52] = 0; - out_1376781969837987839[53] = 1; +void H_10(double *state, double *unused, double *out_7377176961528777036) { + out_7377176961528777036[0] = 0; + out_7377176961528777036[1] = 9.8100000000000005*cos(state[1]); + out_7377176961528777036[2] = 0; + out_7377176961528777036[3] = 0; + out_7377176961528777036[4] = -state[8]; + out_7377176961528777036[5] = state[7]; + out_7377176961528777036[6] = 0; + out_7377176961528777036[7] = state[5]; + out_7377176961528777036[8] = -state[4]; + out_7377176961528777036[9] = 0; + out_7377176961528777036[10] = 0; + out_7377176961528777036[11] = 0; + out_7377176961528777036[12] = 1; + out_7377176961528777036[13] = 0; + out_7377176961528777036[14] = 0; + out_7377176961528777036[15] = 1; + out_7377176961528777036[16] = 0; + out_7377176961528777036[17] = 0; + out_7377176961528777036[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); + out_7377176961528777036[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); + out_7377176961528777036[20] = 0; + out_7377176961528777036[21] = state[8]; + out_7377176961528777036[22] = 0; + out_7377176961528777036[23] = -state[6]; + out_7377176961528777036[24] = -state[5]; + out_7377176961528777036[25] = 0; + out_7377176961528777036[26] = state[3]; + out_7377176961528777036[27] = 0; + out_7377176961528777036[28] = 0; + out_7377176961528777036[29] = 0; + out_7377176961528777036[30] = 0; + out_7377176961528777036[31] = 1; + out_7377176961528777036[32] = 0; + out_7377176961528777036[33] = 0; + out_7377176961528777036[34] = 1; + out_7377176961528777036[35] = 0; + out_7377176961528777036[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); + out_7377176961528777036[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); + out_7377176961528777036[38] = 0; + out_7377176961528777036[39] = -state[7]; + out_7377176961528777036[40] = state[6]; + out_7377176961528777036[41] = 0; + out_7377176961528777036[42] = state[4]; + out_7377176961528777036[43] = -state[3]; + out_7377176961528777036[44] = 0; + out_7377176961528777036[45] = 0; + out_7377176961528777036[46] = 0; + out_7377176961528777036[47] = 0; + out_7377176961528777036[48] = 0; + out_7377176961528777036[49] = 0; + out_7377176961528777036[50] = 1; + out_7377176961528777036[51] = 0; + out_7377176961528777036[52] = 0; + out_7377176961528777036[53] = 1; } -void h_13(double *state, double *unused, double *out_8116870387044428464) { - out_8116870387044428464[0] = state[3]; - out_8116870387044428464[1] = state[4]; - out_8116870387044428464[2] = state[5]; +void h_13(double *state, double *unused, double *out_3864223786954470726) { + out_3864223786954470726[0] = state[3]; + out_3864223786954470726[1] = state[4]; + out_3864223786954470726[2] = state[5]; } -void H_13(double *state, double *unused, double *out_77972742869035987) { - out_77972742869035987[0] = 0; - out_77972742869035987[1] = 0; - out_77972742869035987[2] = 0; - out_77972742869035987[3] = 1; - out_77972742869035987[4] = 0; - out_77972742869035987[5] = 0; - out_77972742869035987[6] = 0; - out_77972742869035987[7] = 0; - out_77972742869035987[8] = 0; - out_77972742869035987[9] = 0; - out_77972742869035987[10] = 0; - out_77972742869035987[11] = 0; - out_77972742869035987[12] = 0; - out_77972742869035987[13] = 0; - out_77972742869035987[14] = 0; - out_77972742869035987[15] = 0; - out_77972742869035987[16] = 0; - out_77972742869035987[17] = 0; - out_77972742869035987[18] = 0; - out_77972742869035987[19] = 0; - out_77972742869035987[20] = 0; - out_77972742869035987[21] = 0; - out_77972742869035987[22] = 1; - out_77972742869035987[23] = 0; - out_77972742869035987[24] = 0; - out_77972742869035987[25] = 0; - out_77972742869035987[26] = 0; - out_77972742869035987[27] = 0; - out_77972742869035987[28] = 0; - out_77972742869035987[29] = 0; - out_77972742869035987[30] = 0; - out_77972742869035987[31] = 0; - out_77972742869035987[32] = 0; - out_77972742869035987[33] = 0; - out_77972742869035987[34] = 0; - out_77972742869035987[35] = 0; - out_77972742869035987[36] = 0; - out_77972742869035987[37] = 0; - out_77972742869035987[38] = 0; - out_77972742869035987[39] = 0; - out_77972742869035987[40] = 0; - out_77972742869035987[41] = 1; - out_77972742869035987[42] = 0; - out_77972742869035987[43] = 0; - out_77972742869035987[44] = 0; - out_77972742869035987[45] = 0; - out_77972742869035987[46] = 0; - out_77972742869035987[47] = 0; - out_77972742869035987[48] = 0; - out_77972742869035987[49] = 0; - out_77972742869035987[50] = 0; - out_77972742869035987[51] = 0; - out_77972742869035987[52] = 0; - out_77972742869035987[53] = 0; +void H_13(double *state, double *unused, double *out_1645941412858493352) { + out_1645941412858493352[0] = 0; + out_1645941412858493352[1] = 0; + out_1645941412858493352[2] = 0; + out_1645941412858493352[3] = 1; + out_1645941412858493352[4] = 0; + out_1645941412858493352[5] = 0; + out_1645941412858493352[6] = 0; + out_1645941412858493352[7] = 0; + out_1645941412858493352[8] = 0; + out_1645941412858493352[9] = 0; + out_1645941412858493352[10] = 0; + out_1645941412858493352[11] = 0; + out_1645941412858493352[12] = 0; + out_1645941412858493352[13] = 0; + out_1645941412858493352[14] = 0; + out_1645941412858493352[15] = 0; + out_1645941412858493352[16] = 0; + out_1645941412858493352[17] = 0; + out_1645941412858493352[18] = 0; + out_1645941412858493352[19] = 0; + out_1645941412858493352[20] = 0; + out_1645941412858493352[21] = 0; + out_1645941412858493352[22] = 1; + out_1645941412858493352[23] = 0; + out_1645941412858493352[24] = 0; + out_1645941412858493352[25] = 0; + out_1645941412858493352[26] = 0; + out_1645941412858493352[27] = 0; + out_1645941412858493352[28] = 0; + out_1645941412858493352[29] = 0; + out_1645941412858493352[30] = 0; + out_1645941412858493352[31] = 0; + out_1645941412858493352[32] = 0; + out_1645941412858493352[33] = 0; + out_1645941412858493352[34] = 0; + out_1645941412858493352[35] = 0; + out_1645941412858493352[36] = 0; + out_1645941412858493352[37] = 0; + out_1645941412858493352[38] = 0; + out_1645941412858493352[39] = 0; + out_1645941412858493352[40] = 0; + out_1645941412858493352[41] = 1; + out_1645941412858493352[42] = 0; + out_1645941412858493352[43] = 0; + out_1645941412858493352[44] = 0; + out_1645941412858493352[45] = 0; + out_1645941412858493352[46] = 0; + out_1645941412858493352[47] = 0; + out_1645941412858493352[48] = 0; + out_1645941412858493352[49] = 0; + out_1645941412858493352[50] = 0; + out_1645941412858493352[51] = 0; + out_1645941412858493352[52] = 0; + out_1645941412858493352[53] = 0; } -void h_14(double *state, double *unused, double *out_2879136579664093334) { - out_2879136579664093334[0] = state[6]; - out_2879136579664093334[1] = state[7]; - out_2879136579664093334[2] = state[8]; +void h_14(double *state, double *unused, double *out_2242454366414003666) { + out_2242454366414003666[0] = state[6]; + out_2242454366414003666[1] = state[7]; + out_2242454366414003666[2] = state[8]; } -void H_14(double *state, double *unused, double *out_672994288138115741) { - out_672994288138115741[0] = 0; - out_672994288138115741[1] = 0; - out_672994288138115741[2] = 0; - out_672994288138115741[3] = 0; - out_672994288138115741[4] = 0; - out_672994288138115741[5] = 0; - out_672994288138115741[6] = 1; - out_672994288138115741[7] = 0; - out_672994288138115741[8] = 0; - out_672994288138115741[9] = 0; - out_672994288138115741[10] = 0; - out_672994288138115741[11] = 0; - out_672994288138115741[12] = 0; - out_672994288138115741[13] = 0; - out_672994288138115741[14] = 0; - out_672994288138115741[15] = 0; - out_672994288138115741[16] = 0; - out_672994288138115741[17] = 0; - out_672994288138115741[18] = 0; - out_672994288138115741[19] = 0; - out_672994288138115741[20] = 0; - out_672994288138115741[21] = 0; - out_672994288138115741[22] = 0; - out_672994288138115741[23] = 0; - out_672994288138115741[24] = 0; - out_672994288138115741[25] = 1; - out_672994288138115741[26] = 0; - out_672994288138115741[27] = 0; - out_672994288138115741[28] = 0; - out_672994288138115741[29] = 0; - out_672994288138115741[30] = 0; - out_672994288138115741[31] = 0; - out_672994288138115741[32] = 0; - out_672994288138115741[33] = 0; - out_672994288138115741[34] = 0; - out_672994288138115741[35] = 0; - out_672994288138115741[36] = 0; - out_672994288138115741[37] = 0; - out_672994288138115741[38] = 0; - out_672994288138115741[39] = 0; - out_672994288138115741[40] = 0; - out_672994288138115741[41] = 0; - out_672994288138115741[42] = 0; - out_672994288138115741[43] = 0; - out_672994288138115741[44] = 1; - out_672994288138115741[45] = 0; - out_672994288138115741[46] = 0; - out_672994288138115741[47] = 0; - out_672994288138115741[48] = 0; - out_672994288138115741[49] = 0; - out_672994288138115741[50] = 0; - out_672994288138115741[51] = 0; - out_672994288138115741[52] = 0; - out_672994288138115741[53] = 0; +void H_14(double *state, double *unused, double *out_7941003670486198449) { + out_7941003670486198449[0] = 0; + out_7941003670486198449[1] = 0; + out_7941003670486198449[2] = 0; + out_7941003670486198449[3] = 0; + out_7941003670486198449[4] = 0; + out_7941003670486198449[5] = 0; + out_7941003670486198449[6] = 1; + out_7941003670486198449[7] = 0; + out_7941003670486198449[8] = 0; + out_7941003670486198449[9] = 0; + out_7941003670486198449[10] = 0; + out_7941003670486198449[11] = 0; + out_7941003670486198449[12] = 0; + out_7941003670486198449[13] = 0; + out_7941003670486198449[14] = 0; + out_7941003670486198449[15] = 0; + out_7941003670486198449[16] = 0; + out_7941003670486198449[17] = 0; + out_7941003670486198449[18] = 0; + out_7941003670486198449[19] = 0; + out_7941003670486198449[20] = 0; + out_7941003670486198449[21] = 0; + out_7941003670486198449[22] = 0; + out_7941003670486198449[23] = 0; + out_7941003670486198449[24] = 0; + out_7941003670486198449[25] = 1; + out_7941003670486198449[26] = 0; + out_7941003670486198449[27] = 0; + out_7941003670486198449[28] = 0; + out_7941003670486198449[29] = 0; + out_7941003670486198449[30] = 0; + out_7941003670486198449[31] = 0; + out_7941003670486198449[32] = 0; + out_7941003670486198449[33] = 0; + out_7941003670486198449[34] = 0; + out_7941003670486198449[35] = 0; + out_7941003670486198449[36] = 0; + out_7941003670486198449[37] = 0; + out_7941003670486198449[38] = 0; + out_7941003670486198449[39] = 0; + out_7941003670486198449[40] = 0; + out_7941003670486198449[41] = 0; + out_7941003670486198449[42] = 0; + out_7941003670486198449[43] = 0; + out_7941003670486198449[44] = 1; + out_7941003670486198449[45] = 0; + out_7941003670486198449[46] = 0; + out_7941003670486198449[47] = 0; + out_7941003670486198449[48] = 0; + out_7941003670486198449[49] = 0; + out_7941003670486198449[50] = 0; + out_7941003670486198449[51] = 0; + out_7941003670486198449[52] = 0; + out_7941003670486198449[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_9170572944906816852) { - err_fun(nom_x, delta_x, out_9170572944906816852); +void pose_err_fun(double *nom_x, double *delta_x, double *out_2526150130430510074) { + err_fun(nom_x, delta_x, out_2526150130430510074); } -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_4867215415263963768) { - inv_err_fun(nom_x, true_x, out_4867215415263963768); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_3515561648914426109) { + inv_err_fun(nom_x, true_x, out_3515561648914426109); } -void pose_H_mod_fun(double *state, double *out_1396735664605592698) { - H_mod_fun(state, out_1396735664605592698); +void pose_H_mod_fun(double *state, double *out_6056162720073724257) { + H_mod_fun(state, out_6056162720073724257); } -void pose_f_fun(double *state, double dt, double *out_916482441408583797) { - f_fun(state, dt, out_916482441408583797); +void pose_f_fun(double *state, double dt, double *out_8780284750928315681) { + f_fun(state, dt, out_8780284750928315681); } -void pose_F_fun(double *state, double dt, double *out_5639772936950525263) { - F_fun(state, dt, out_5639772936950525263); +void pose_F_fun(double *state, double dt, double *out_1516035527731464330) { + F_fun(state, dt, out_1516035527731464330); } -void pose_h_4(double *state, double *unused, double *out_5848855439961291946) { - h_4(state, unused, out_5848855439961291946); +void pose_h_4(double *state, double *unused, double *out_4492721189395603550) { + h_4(state, unused, out_4492721189395603550); } -void pose_H_4(double *state, double *unused, double *out_3290246568201368788) { - H_4(state, unused, out_3290246568201368788); +void pose_H_4(double *state, double *unused, double *out_4858215238190826153) { + H_4(state, unused, out_4858215238190826153); } -void pose_h_10(double *state, double *unused, double *out_3954090448202517665) { - h_10(state, unused, out_3954090448202517665); +void pose_h_10(double *state, double *unused, double *out_558240635521768637) { + h_10(state, unused, out_558240635521768637); } -void pose_H_10(double *state, double *unused, double *out_1376781969837987839) { - H_10(state, unused, out_1376781969837987839); +void pose_H_10(double *state, double *unused, double *out_7377176961528777036) { + H_10(state, unused, out_7377176961528777036); } -void pose_h_13(double *state, double *unused, double *out_8116870387044428464) { - h_13(state, unused, out_8116870387044428464); +void pose_h_13(double *state, double *unused, double *out_3864223786954470726) { + h_13(state, unused, out_3864223786954470726); } -void pose_H_13(double *state, double *unused, double *out_77972742869035987) { - H_13(state, unused, out_77972742869035987); +void pose_H_13(double *state, double *unused, double *out_1645941412858493352) { + H_13(state, unused, out_1645941412858493352); } -void pose_h_14(double *state, double *unused, double *out_2879136579664093334) { - h_14(state, unused, out_2879136579664093334); +void pose_h_14(double *state, double *unused, double *out_2242454366414003666) { + h_14(state, unused, out_2242454366414003666); } -void pose_H_14(double *state, double *unused, double *out_672994288138115741) { - H_14(state, unused, out_672994288138115741); +void pose_H_14(double *state, double *unused, double *out_7941003670486198449) { + H_14(state, unused, out_7941003670486198449); } 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 8e75e5380..e7ae94715 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_9170572944906816852); -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_4867215415263963768); -void pose_H_mod_fun(double *state, double *out_1396735664605592698); -void pose_f_fun(double *state, double dt, double *out_916482441408583797); -void pose_F_fun(double *state, double dt, double *out_5639772936950525263); -void pose_h_4(double *state, double *unused, double *out_5848855439961291946); -void pose_H_4(double *state, double *unused, double *out_3290246568201368788); -void pose_h_10(double *state, double *unused, double *out_3954090448202517665); -void pose_H_10(double *state, double *unused, double *out_1376781969837987839); -void pose_h_13(double *state, double *unused, double *out_8116870387044428464); -void pose_H_13(double *state, double *unused, double *out_77972742869035987); -void pose_h_14(double *state, double *unused, double *out_2879136579664093334); -void pose_H_14(double *state, double *unused, double *out_672994288138115741); +void pose_err_fun(double *nom_x, double *delta_x, double *out_2526150130430510074); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_3515561648914426109); +void pose_H_mod_fun(double *state, double *out_6056162720073724257); +void pose_f_fun(double *state, double dt, double *out_8780284750928315681); +void pose_F_fun(double *state, double dt, double *out_1516035527731464330); +void pose_h_4(double *state, double *unused, double *out_4492721189395603550); +void pose_H_4(double *state, double *unused, double *out_4858215238190826153); +void pose_h_10(double *state, double *unused, double *out_558240635521768637); +void pose_H_10(double *state, double *unused, double *out_7377176961528777036); +void pose_h_13(double *state, double *unused, double *out_3864223786954470726); +void pose_H_13(double *state, double *unused, double *out_1645941412858493352); +void pose_h_14(double *state, double *unused, double *out_2242454366414003666); +void pose_H_14(double *state, double *unused, double *out_7941003670486198449); void pose_predict(double *in_x, double *in_P, double *in_Q, double dt); } \ No newline at end of file diff --git a/selfdrive/pandad/pandad b/selfdrive/pandad/pandad index bcbe70be3628f740de76fda762251493a53004b7..6a50ba1c4372cf11583ffcafa1ff8ae967fca446 100755 GIT binary patch delta 87 zcmZ4SQ-8%z{S7HhA~P$C`A(M>RL$DY&$9U4PlpNW$%V}oOzjm+jN2=in4Tyy^0ddQ gFaa?$5VHU=D-g2*F*^`*05K;Jb8U}R;r6}(0ObK5aR2}S delta 87 zcmZ4SQ-8%z{S7HhB7b*C%1O_4y}f6~;yCN&nq?~;cGNXjFtt}OF>bG5VtS&;sM8*+ g!UV+3K+FQftU$~L#Oy%K0mPg@%(XpMh1>fE0Qu-1%m4rY diff --git a/selfdrive/ui/ui b/selfdrive/ui/ui index 3d07c9f122447584b3e8d069f9980aa2a4743d65..288efafed5910fa4e4aa9b80d06a84809679aeb7 100755 GIT binary patch delta 675 zcmXxgJxmi}7{KxOPQAO*3VvJxt3V6ZmJcZkRjjoZ2jVD+BqXd|7;rMCQj!h?iX@GT z5o`>(fdmss+D@0axQT|y!pLAGF>x@s>c;=-(>M9$x%#f4uWGz3(jL^-^Bf;LS5Qi*qpCyl&c6El?`gO<3@u1%7z_JX+C)3%H0& zxC|RXw4(!^xPlO_;u^ZpjUI#%K`;7n9Z|Pjzwzu#$jUt3P)hryyrn5$J;m6hme+#| zu}qPxZORMTw_=*?zhOR+YF1uKeZ^dBo_+sY>Jl>`)!6zW^^jsq)jG0Lk0=LHjrn5p z5j9DiYFzz)$#2}IWyg%3$RqxGQ>x{xO8rBLOV!@aNOhQD@fBuH=}N6n z6=LB@e!@>qtjIb2!zVe%r*Ozy-mjaMy3GBtRAcM2)ZLO>h#`)C3}6sLxQSsTFoIjS fjZusti95K9aoj@+_mRc}WbhDKOt^00(cIoCR2Ihj delta 675 zcmXxg%`3xk9KiA4@5lBV=6PeDH_SZDvw56nDK`$vAK>D^QDX-OWug^3P?C0VP|ED| zDv`|1(A!ZuVVS?ERXu2(?dPCv34hu4ni7Z%=jU4165BVrSA#AXt2*q%q1f?iL zIVw)>8zrtM1Ju>+TcNNfT9fKgxQ~oL4kO*`En|oRg+Rq?(Nl zxu>06CHEo@MJ$OU{<>ND^cnBpWHle(%K9EMf*#bP0gY&a7tLrvE85VG4s@amK6Il8 Xz34+f2H?jahA@l~j2cF8Y~k(?fF07q diff --git a/system/camerad/camerad b/system/camerad/camerad index 41db831bb3eef76471839dc366f7c90ebe28ed6e..ef6a99b7db0631d966c72cc36bc7644150a91d31 100755 GIT binary patch delta 87 zcmZ3m$#B6Y!wo4+BDPaSX0A$7X1~F7=!0qX#EfHsbLTZzFm113Vl>&y$kV=dKO+z` f0WmWWvj8zG5VHX>I}mdKF((jnZC|^eyLcu5inu3< delta 87 zcmZ3m$#B6Y!wo4+BFwL6p4bzUHP_vplR@ntgWw0#zV7Aj3#>-b=ueNX9Qv< fAZ7+)79eH?Vm2UV2VxE&<^*D{?Q8dQ7taI$YBeV1 diff --git a/system/loggerd/bootlog b/system/loggerd/bootlog index 34cbc1f156a2d6fcf35034b245af8aa2267fef62..97fc9278904f1bb6c66a5bb6c4e19df61279f36c 100755 GIT binary patch delta 75 zcmca`OZCDn)eR|3B205-U(D*zu~JNOyDh)=!(0Wo7Ov(BrtK9>j8CRB^0dd!VgzC) XAZ7+)79eH?Vm2UV-yS=Qj8CRB>a@qsVgzC) XAZ7+)79eH?Vm2UV-yS=Q?QdDpuP)7NiSZ<*a(!PH*C#0bPp+bfuuznC%V jwC7qf12GE_vjQ<25VHd@2M}`tF&7YXZ_l;lVZH?b9=0PU diff --git a/system/loggerd/loggerd b/system/loggerd/loggerd index c6627a465eed1aa72099fa1f69a8a7855a1360ef..a72e60002040a673663717d6504674571f35e090 100755 GIT binary patch delta 86 zcmZ4SPJhKa{S7Hh!WB7ZHXQ%!%u;f4c8Gb$lNo!LerzshYA_E%`#GF9PwY}GYd-gT}U|=G0 delta 86 zcmZ4SPJhKa{S7Hh!mV3P?;LXLO|%NX5OzFL!do@-P;)s`dpQ&1_HrgBQ9DMR_Fe}j fAZ7+)79eH?Vm2UV2VxE&<^*D{?Y$1%v$p{N(tIE|