From 9c51a6024e4cfc470dba40b2a8221ca05e8b8e7b Mon Sep 17 00:00:00 2001 From: firestar5683 <168790843+firestar5683@users.noreply.github.com> Date: Sun, 7 Jun 2026 15:21:10 -0500 Subject: [PATCH] build --- common/libcommon.a | Bin 739360 -> 739360 bytes common/params_pyx.so | Bin 771872 -> 771872 bytes panda/board/obj/body_h7.bin.signed | Bin 89796 -> 89796 bytes panda/board/obj/body_h7/bootstub.elf | Bin 112692 -> 112692 bytes panda/board/obj/body_h7/main.bin | Bin 89660 -> 89660 bytes panda/board/obj/body_h7/main.elf | Bin 403536 -> 403536 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 81212 -> 81212 bytes panda/board/obj/panda/bootstub.elf | Bin 100760 -> 100760 bytes panda/board/obj/panda/main.bin | Bin 81076 -> 81076 bytes panda/board/obj/panda/main.elf | Bin 366400 -> 366400 bytes panda/board/obj/panda_h7.bin.signed | Bin 97824 -> 97824 bytes panda/board/obj/panda_h7/bootstub.elf | Bin 152728 -> 152728 bytes panda/board/obj/panda_h7/main.bin | Bin 97688 -> 97688 bytes panda/board/obj/panda_h7/main.elf | Bin 446700 -> 446700 bytes panda/board/obj/panda_h7_remote.bin.signed | Bin 97760 -> 97760 bytes panda/board/obj/panda_h7_remote/bootstub.elf | Bin 152736 -> 152736 bytes panda/board/obj/panda_h7_remote/main.bin | Bin 97624 -> 97624 bytes panda/board/obj/panda_h7_remote/main.elf | Bin 446708 -> 446708 bytes panda/board/obj/panda_jungle_h7.bin.signed | Bin 91784 -> 91784 bytes panda/board/obj/panda_jungle_h7/bootstub.elf | Bin 123936 -> 123936 bytes panda/board/obj/panda_jungle_h7/main.bin | Bin 91648 -> 91648 bytes panda/board/obj/panda_jungle_h7/main.elf | Bin 407384 -> 407384 bytes panda/board/obj/panda_remote.bin.signed | Bin 81172 -> 81172 bytes panda/board/obj/panda_remote/bootstub.elf | Bin 100768 -> 100768 bytes panda/board/obj/panda_remote/main.bin | Bin 81036 -> 81036 bytes panda/board/obj/panda_remote/main.elf | Bin 366604 -> 366604 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 4406584 -> 4406584 bytes system/camerad/camerad | Bin 874136 -> 874136 bytes system/loggerd/bootlog | Bin 617808 -> 617808 bytes system/loggerd/encoderd | Bin 856944 -> 856944 bytes system/loggerd/loggerd | Bin 793048 -> 793048 bytes 44 files changed, 1347 insertions(+), 1347 deletions(-) diff --git a/common/libcommon.a b/common/libcommon.a index 5ed0eacdc6524547151922e540c6485caa5616ff..e96bbf07ed837ba973b83296dc7fd2cbb1d79d89 100644 GIT binary patch delta 56 zcmZ25L3hCf-3==`8O54ccDAqVWCUU+AZ7+)79eH?Vm2UV2VxE&=G?xrldF6m0MN4; AJ^%m! delta 56 zcmZ25L3hCf-3==`8QGdwcDAqVWCUU+AZ7+)79eH?Vm2UV2VxE&=G?xrldF6m0L{}G AE&u=k diff --git a/common/params_pyx.so b/common/params_pyx.so index ff164851a42d4c2add7b0d9e9e1fed83aab3ae77..f8206f0323183d1fab98be7db2baad6063293fea 100755 GIT binary patch delta 83 zcmZ3`r@x?2f5Qz%kqc|jHJoRZS)^*R>!R%J=wd(4F9)07Ft)#81Yss1W(HywAZ7(( dHXvr-{)UkwKf c2E^>!-!O87oCLBRPjdh<=XS@_T=#zi0NPk1LI3~& diff --git a/panda/board/obj/body_h7.bin.signed b/panda/board/obj/body_h7.bin.signed index 07c4d2be645058b57a241ee886057e80b73fd61d..ba85860982499b7b3718be266c9b2baa7b7bb874 100644 GIT binary patch delta 153 zcmV;K0A~Nhy#>U*1+XZ=2x4VpGBh@0HnT9n6rF#jKnX^c!WJ%0Ddz9&H>l#yx+Mm< z)RivZjlRpoCjzun+Fmj?Z~T$vsA!U*1+XZ=2w^riH8^ErIkPaq6rF!ilK1wZ9bRpn+zH@vsbH9ICG(-r zF5w;;3(ZERVWt8OsGPN87lA+Si-?=p*t~GdwjVe(liF-mGukV#27az#n8-fTaW$zQ z8oN8YV=ElP9+)&p7)2A1GMyru?nNqii!ccy|4qX8`U)HW=h}^0SXjhKms%6S{|n5( Hs;B|9J_AR5 diff --git a/panda/board/obj/body_h7/bootstub.elf b/panda/board/obj/body_h7/bootstub.elf index a5ed97a19a8828cfb3f8c9958d81595008d381e1..60704c763107ed5938005e4a84855bef848bb062 100755 GIT binary patch delta 27 jcmdn;fo;nNwhgW}97(CkMkZ#-X3f4f+kI^qpH~9_o@)x6 delta 27 jcmdn;fo;nNwhgW}9EoP;rWUD5md(C4+kI^qpH~9_n|lg) diff --git a/panda/board/obj/body_h7/main.bin b/panda/board/obj/body_h7/main.bin index 2cccf5882e96275d82ca92f3b74ddff769cd889d..7b942223fa6549d196212384ebdfbbd70f42dc52 100755 GIT binary patch delta 23 fcmdn9hjq^$)(sj5Ig(P7jZDmv%{Chxt<8 delta 21 ccmaEo^dxD6s}4t^nYpP&YLewp(pJ3|A*Zo9oo}u>b(j9ScqX delta 34 qcmdlJwkK?ZubN<@nYpP&YLca{i>p(pJ3|A*Zo9oo}u>b(e=?f|V diff --git a/panda/board/obj/bootstub.panda_h7.bin b/panda/board/obj/bootstub.panda_h7.bin index b36931b2b5713780b73a6ea28d858f4fda959c76..16d2c03d6e5357f12fc2c883589c3d959749d13b 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$97(CkMkZ#-W}7EEpJxRCb#w_O delta 23 fcmaDbiSfZC#tog$9EoP;rWUD5mYXL!pJxRCa})^y diff --git a/panda/board/obj/bootstub.panda_h7_remote.bin b/panda/board/obj/bootstub.panda_h7_remote.bin index b36931b2b5713780b73a6ea28d858f4fda959c76..16d2c03d6e5357f12fc2c883589c3d959749d13b 100755 GIT binary patch delta 23 fcmaDbiSfZC#tog$97(CkMkZ#-W}7EEpJxRCb#w_O delta 23 fcmaDbiSfZC#tog$9EoP;rWUD5mYXL!pJxRCa})^y diff --git a/panda/board/obj/bootstub.panda_jungle_h7.bin b/panda/board/obj/bootstub.panda_jungle_h7.bin index c215cf5ad704960daccff3597a4fd671e3b04f86..620ff08e39abe2ac3bcbbe7a1f1432ee2394e2ca 100755 GIT binary patch delta 21 ccmZq4ZOPrR*MK7_HQC6-EZJ=HQG@-g0AH~PQvd(} delta 21 ccmZq4ZOPrR*MK9@%-qx>HOX@GQG@-g09{cCF8}}l diff --git a/panda/board/obj/bootstub.panda_remote.bin b/panda/board/obj/bootstub.panda_remote.bin index 9e25af20eeff1e399c24048dec2099f8f875a9a9..0d70c78297e87735fad19bfd8ec1df232625e399 100755 GIT binary patch delta 34 qcmdlJwkK?ZubN;|YO;}uS+bd~i>p(pJ3|A*Zo9oo}u>b(j9ScqX delta 34 qcmdlJwkK?ZubN<@nYpP&YLca{i>p(pJ3|A*Zo9oo}u>b(e=?f|V diff --git a/panda/board/obj/gitversion.h b/panda/board/obj/gitversion.h index b9e6ea572..0e678651d 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-a6758eb9-DEBUG"; +const uint8_t gitversion[19] = "DEV-bec246c6-DEBUG"; diff --git a/panda/board/obj/panda.bin.signed b/panda/board/obj/panda.bin.signed index efb3df3cb1921bdea68c13316787851f7335b9e8..e753bd02d78ec80775383a5ea785d1a4138d7f45 100644 GIT binary patch delta 153 zcmV;K0A~NZ`UJfC1h81J2x4VpGBh@0HnU)`T#SD!k>SM7ZHZ({ax@HJQY*zIfJ>Ff zJYQdJ1=xR5$rqxkr=&XDZXa;6Cj^WkFWz7ol*Qobz+a+`{QI$rfV67g&IrNNCIYMs zXG|VJ%AQc%tql-P(qr0xSj9GKGpTo+tw!<6yKYg<*q$S3SZ-J($vv`ZdNrA|L871r H(u@HzqQ6M4 delta 153 zcmV;K0A~NZ`UJfC1h81J2w^riH8^ErIkRA}T#SDqkzGIsWAfxA84E^=ZtL0~+l@o> zTZZ=H95SRVQ34y}S7~23to^IIfb>~X%d0bpIG`=?p~7W+W~&d8m&7v%x#(prN6htU ziVL+W?VX!PJ8VgkYfd#zJrxJdpl>vT?8%eUY@m&07?ubMYC0V*|J^j4uA^3%A#8>E Hq?7^5R18Od diff --git a/panda/board/obj/panda/bootstub.elf b/panda/board/obj/panda/bootstub.elf index 06b9612877d4106088909bcb2805392e7d4e5ffc..1f9b8029dd4be26800a44cf47dd04277879514c9 100755 GIT binary patch delta 40 wcmbO+nQg{owhg{!f=Q{#MkZ#-X1Xq}PND7$4GfbfnkqEcnQgB#W0VR801jsiqW}N^ delta 40 wcmbO+nQg{owhg{!f{AA4rWUD5mbxykPND7$4GfbfnkqEcnQgB#W0VR8012ZEe*gdg diff --git a/panda/board/obj/panda/main.bin b/panda/board/obj/panda/main.bin index de2cfa972af3b02eb69a2126e8b1eee99e4b6752..d4dc20dde78bea7e9cc9386d463ebed0b1c78895 100755 GIT binary patch delta 23 fcmdn;lV!_KmJJabIFeG6jZDmv%{C`&2(X%c7U!> zru!Tw5Fnw|MXu`7=Q)|0=u>^cFlizuO#~6zAjmpZ{mQ7@sWwLW=o*J-}(w z!#8kjW*2%|d*k^*av*oK@CwQ2jr9qcmpuR?1^5E!PJcGMl#K`?FNm`JinnO;DqRT5 Hky8N;nOsKl delta 153 zcmV;K0A~N7`~{%=1+aMC2w^riH8^ErIkSM>AfSJKzvSyWvK^RHTmpK;6E_VrRnn-? z(T>m~T)tK=kFzGIwg{($YUuY_F=Eidu5O|P|H6zYYTk8%v)ADgh>J zHg}Po`1-}|OSA<8ltFI*4W@#vhxBWZH90%d$?O^3X>^S8uroeCiR!yR3+(TkelkFkPgRqw~k7VOCLJ7@ve@MhBxAtKKr@KYN;vhub0= zfT?X_m0-s@*$N}-{A-M=o~O5bP$BRD4T+296;iDXqct(Ef(v6iQ1FRZmwZ5X*7M{Z HM{)t=;B83v delta 153 zcmV;K0A~N-`vu_p1+X~X2w^riH8^ErIkQ0BAfSJBK+NEa9k9z>b#t8#<6my$Ada|} z^bQE@Q?Fb+NCxem<;3hTrR{aUMnld-)jTG0AeJqf3dikst2)*r!)Hy^O^?5a8Bzk?r_HZfrkw@GG^I)%UpQ1wLj&)c8*S}6 Hu}%S@hF(e5 diff --git a/panda/board/obj/panda_h7_remote/bootstub.elf b/panda/board/obj/panda_h7_remote/bootstub.elf index e10fb434b20974d59c95cbfe967eee8d4e8e62de..22e68c15d04aaa73aac676aa9a624f4fe70b0697 100755 GIT binary patch delta 31 ncmZ3ml5@dI&JCTx97(CkMkZ#-X3Z0W+b0GyZl4&;#Lox-!>$V$ delta 31 ncmZ3ml5@dI&JCTx9EoP;rWUD5mdz7`+b0GyZl4&;#Lox-z%B~( diff --git a/panda/board/obj/panda_h7_remote/main.bin b/panda/board/obj/panda_h7_remote/main.bin index fa7f634e742f481cfe745fd1a888b7e722a54311..f0e7cd7ba4fc7f8498ea6770c2835e08b77a371d 100755 GIT binary patch delta 23 fcmccdi}l7Y)(sYSIg(P7jZDmv%{DvSl~@1(i46*4 delta 23 fcmccdi}l7Y)(sYSITFpxO)XNBEH^vcl~@1(hOG)e diff --git a/panda/board/obj/panda_h7_remote/main.elf b/panda/board/obj/panda_h7_remote/main.elf index 7426bda24c3bc8253d73bbf52428769fc76f4e13..1cae10572c9e22cfb93ee6a71e5af00114badde0 100755 GIT binary patch delta 43 vcmeyeQ2NV4=?xZdIg(P7jZDmv&6*wFwmZCK1Y#y2W(H!G?GA5Qw>$;_tm_k} delta 43 vcmeyeQ2NV4=?xZdITFpxO)XNBESnwPwmZCK1Y#y2W(H!G?GA5Qw>$;_r@Iq_ diff --git a/panda/board/obj/panda_jungle_h7.bin.signed b/panda/board/obj/panda_jungle_h7.bin.signed index 02500de028731ae512dda807e25a91d00308b5a4..76b2edd5fdd25d4271dfb1b5b05ee45f9b030a23 100644 GIT binary patch delta 153 zcmV;K0A~M)%>{_f1+ZYo2x4VpGBh@0HnV8Ppr3yY^cV5bc^y)ny;aBnRyx6cO`VoE z^?(^TdF-KtWOeNkV@Y}qV|gwA(_a68CSD5M6C5@b#b2;?vJf4-6d5qrI4DiXH={|) zRv3~pu%Qzj=43C;YX&jr4jCn!D~7BF^K`_<1}@=CLhlp8INVl6L-oNqa$Q(1mD delta 153 zcmV;K0A~M)%>{_f1+ZYo2w^riH8^ErIkRZSpr3yZ4sHN`)h3UmR(1wjbwKj zHde7DO5#Wh;v$XGUV~Zuhm#C&4PduTD=z2Q1sfXS&58rV&vX7F*AwWLe%ZFquNYnL zn$g(u4JZ>B%ug1%@_7E^JO+n-CoU-IFeG6jZDmv&6U-I1jX*)TF=XMEy{LxqC9k zX&w-V&P1+<>n&6&6<@-cLaOj>*n-jOU}0}SQEi#V1kZv4Tzfxven6L{-<9*dk$es3 H4^;u+G2u&> delta 153 zcmV;K0A~M``UI5v1h6o$2w^riH8^ErIkPyhT#SDdo|-?4sM5Q^%-&Xsb_ZnFg}SY2 zLkqW5NG1IO2@^`n7J}vkl^{0dp9uL_F>Mx~k^CwXd3vMegv&nlogZ+qpFco&XO#-I z;%7rmWcSwSkE?jOR+5LFwMA@bL}jqw;N&=GA;Qs{jT2q%H}Z@RJ4KfX3A_ZgbPkWI HRWJdtU%W?x diff --git a/panda/board/obj/panda_remote/bootstub.elf b/panda/board/obj/panda_remote/bootstub.elf index 877ce6665dc3ebd39880694cb1f0679b8492a51c..cedacfc0b3de8888779977eed54c23ea594d5d61 100755 GIT binary patch delta 40 wcmZ25nQg&jwhg{!f=Q{#MkZ#-X1Xq}PND7$4GfbfnkqEcnQgB#V^j(T01)2{y8r+H delta 40 wcmZ25nQg&jwhg{!f{AA4rWUD5mbxykPND7$4GfbfnkqEcnQgB#V^j(T01O)pmjD0& diff --git a/panda/board/obj/panda_remote/main.bin b/panda/board/obj/panda_remote/main.bin index 1855aa0e4761a8bbc7667634b8fce629ef6dee60..a420dab7fcbba22d3a927d030d895a10c9b9c683 100755 GIT binary patch delta 23 ecmeDA$_Y delta 23 ecmeDA$ #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_8838314869193199803) { - err_fun(nom_x, delta_x, out_8838314869193199803); +void car_err_fun(double *nom_x, double *delta_x, double *out_3499577995962015470) { + err_fun(nom_x, delta_x, out_3499577995962015470); } -void car_inv_err_fun(double *nom_x, double *true_x, double *out_1156535968876491631) { - inv_err_fun(nom_x, true_x, out_1156535968876491631); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_7704661140039100406) { + inv_err_fun(nom_x, true_x, out_7704661140039100406); } -void car_H_mod_fun(double *state, double *out_7297179764193114402) { - H_mod_fun(state, out_7297179764193114402); +void car_H_mod_fun(double *state, double *out_3593592511346668572) { + H_mod_fun(state, out_3593592511346668572); } -void car_f_fun(double *state, double dt, double *out_6025394122966474126) { - f_fun(state, dt, out_6025394122966474126); +void car_f_fun(double *state, double dt, double *out_5138495986546656101) { + f_fun(state, dt, out_5138495986546656101); } -void car_F_fun(double *state, double dt, double *out_2902406519648293307) { - F_fun(state, dt, out_2902406519648293307); +void car_F_fun(double *state, double dt, double *out_9094696385837044219) { + F_fun(state, dt, out_9094696385837044219); } -void car_h_25(double *state, double *unused, double *out_3236700917680503454) { - h_25(state, unused, out_3236700917680503454); +void car_h_25(double *state, double *unused, double *out_1209975406708631015) { + h_25(state, unused, out_1209975406708631015); } -void car_H_25(double *state, double *unused, double *out_1896008461719122835) { - H_25(state, unused, out_1896008461719122835); +void car_H_25(double *state, double *unused, double *out_4098926953546965284) { + H_25(state, unused, out_4098926953546965284); } -void car_h_24(double *state, double *unused, double *out_457181241716230531) { - h_24(state, unused, out_457181241716230531); +void car_h_24(double *state, double *unused, double *out_5058461778376183297) { + h_24(state, unused, out_5058461778376183297); } -void car_H_24(double *state, double *unused, double *out_4068658060724622401) { - H_24(state, unused, out_4068658060724622401); +void car_H_24(double *state, double *unused, double *out_4943923562330660683) { + H_24(state, unused, out_4943923562330660683); } -void car_h_30(double *state, double *unused, double *out_7446777899208375721) { - h_30(state, unused, out_7446777899208375721); +void car_h_30(double *state, double *unused, double *out_5560859819641719921) { + h_30(state, unused, out_5560859819641719921); } -void car_H_30(double *state, double *unused, double *out_5020681879772493920) { - H_30(state, unused, out_5020681879772493920); +void car_H_30(double *state, double *unused, double *out_7431126778670969577) { + H_30(state, unused, out_7431126778670969577); } -void car_h_26(double *state, double *unused, double *out_8390287752110038156) { - h_26(state, unused, out_8390287752110038156); +void car_h_26(double *state, double *unused, double *out_4617349966740057486) { + h_26(state, unused, out_4617349966740057486); } -void car_H_26(double *state, double *unused, double *out_5637511780593179059) { - H_26(state, unused, out_5637511780593179059); +void car_H_26(double *state, double *unused, double *out_4755781017657277188) { + H_26(state, unused, out_4755781017657277188); } -void car_h_27(double *state, double *unused, double *out_7774899721600347349) { - h_27(state, unused, out_7774899721600347349); +void car_h_27(double *state, double *unused, double *out_6211648674369476660) { + h_27(state, unused, out_6211648674369476660); } -void car_H_27(double *state, double *unused, double *out_2845918567972069009) { - H_27(state, unused, out_2845918567972069009); +void car_H_27(double *state, double *unused, double *out_8840853983238157128) { + H_27(state, unused, out_8840853983238157128); } -void car_h_29(double *state, double *unused, double *out_8050093783884853238) { - h_29(state, unused, out_8050093783884853238); +void car_h_29(double *state, double *unused, double *out_559186551980874276) { + h_29(state, unused, out_559186551980874276); } -void car_H_29(double *state, double *unused, double *out_1132555841102517976) { - H_29(state, unused, out_1132555841102517976); +void car_H_29(double *state, double *unused, double *out_6920895434356577393) { + H_29(state, unused, out_6920895434356577393); } -void car_h_28(double *state, double *unused, double *out_1375858204186498203) { - h_28(state, unused, out_1375858204186498203); +void car_h_28(double *state, double *unused, double *out_7233422131679229311) { + h_28(state, unused, out_7233422131679229311); } -void car_H_28(double *state, double *unused, double *out_3949843175967012598) { - H_28(state, unused, out_3949843175967012598); +void car_H_28(double *state, double *unused, double *out_6443449622283443649) { + H_28(state, unused, out_6443449622283443649); } -void car_h_31(double *state, double *unused, double *out_7176856938506309920) { - h_31(state, unused, out_7176856938506309920); +void car_h_31(double *state, double *unused, double *out_8973240663529303456) { + h_31(state, unused, out_8973240663529303456); } -void car_H_31(double *state, double *unused, double *out_1865362499842162407) { - H_31(state, unused, out_1865362499842162407); +void car_H_31(double *state, double *unused, double *out_4129572915423925712) { + H_31(state, unused, out_4129572915423925712); } 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 d3bd6bc90..4bde03742 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_8838314869193199803); -void car_inv_err_fun(double *nom_x, double *true_x, double *out_1156535968876491631); -void car_H_mod_fun(double *state, double *out_7297179764193114402); -void car_f_fun(double *state, double dt, double *out_6025394122966474126); -void car_F_fun(double *state, double dt, double *out_2902406519648293307); -void car_h_25(double *state, double *unused, double *out_3236700917680503454); -void car_H_25(double *state, double *unused, double *out_1896008461719122835); -void car_h_24(double *state, double *unused, double *out_457181241716230531); -void car_H_24(double *state, double *unused, double *out_4068658060724622401); -void car_h_30(double *state, double *unused, double *out_7446777899208375721); -void car_H_30(double *state, double *unused, double *out_5020681879772493920); -void car_h_26(double *state, double *unused, double *out_8390287752110038156); -void car_H_26(double *state, double *unused, double *out_5637511780593179059); -void car_h_27(double *state, double *unused, double *out_7774899721600347349); -void car_H_27(double *state, double *unused, double *out_2845918567972069009); -void car_h_29(double *state, double *unused, double *out_8050093783884853238); -void car_H_29(double *state, double *unused, double *out_1132555841102517976); -void car_h_28(double *state, double *unused, double *out_1375858204186498203); -void car_H_28(double *state, double *unused, double *out_3949843175967012598); -void car_h_31(double *state, double *unused, double *out_7176856938506309920); -void car_H_31(double *state, double *unused, double *out_1865362499842162407); +void car_err_fun(double *nom_x, double *delta_x, double *out_3499577995962015470); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_7704661140039100406); +void car_H_mod_fun(double *state, double *out_3593592511346668572); +void car_f_fun(double *state, double dt, double *out_5138495986546656101); +void car_F_fun(double *state, double dt, double *out_9094696385837044219); +void car_h_25(double *state, double *unused, double *out_1209975406708631015); +void car_H_25(double *state, double *unused, double *out_4098926953546965284); +void car_h_24(double *state, double *unused, double *out_5058461778376183297); +void car_H_24(double *state, double *unused, double *out_4943923562330660683); +void car_h_30(double *state, double *unused, double *out_5560859819641719921); +void car_H_30(double *state, double *unused, double *out_7431126778670969577); +void car_h_26(double *state, double *unused, double *out_4617349966740057486); +void car_H_26(double *state, double *unused, double *out_4755781017657277188); +void car_h_27(double *state, double *unused, double *out_6211648674369476660); +void car_H_27(double *state, double *unused, double *out_8840853983238157128); +void car_h_29(double *state, double *unused, double *out_559186551980874276); +void car_H_29(double *state, double *unused, double *out_6920895434356577393); +void car_h_28(double *state, double *unused, double *out_7233422131679229311); +void car_H_28(double *state, double *unused, double *out_6443449622283443649); +void car_h_31(double *state, double *unused, double *out_8973240663529303456); +void car_H_31(double *state, double *unused, double *out_4129572915423925712); 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 bce0de7d5..19675ff39 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_4833077353004324467) { - out_4833077353004324467[0] = delta_x[0] + nom_x[0]; - out_4833077353004324467[1] = delta_x[1] + nom_x[1]; - out_4833077353004324467[2] = delta_x[2] + nom_x[2]; - out_4833077353004324467[3] = delta_x[3] + nom_x[3]; - out_4833077353004324467[4] = delta_x[4] + nom_x[4]; - out_4833077353004324467[5] = delta_x[5] + nom_x[5]; - out_4833077353004324467[6] = delta_x[6] + nom_x[6]; - out_4833077353004324467[7] = delta_x[7] + nom_x[7]; - out_4833077353004324467[8] = delta_x[8] + nom_x[8]; - out_4833077353004324467[9] = delta_x[9] + nom_x[9]; - out_4833077353004324467[10] = delta_x[10] + nom_x[10]; - out_4833077353004324467[11] = delta_x[11] + nom_x[11]; - out_4833077353004324467[12] = delta_x[12] + nom_x[12]; - out_4833077353004324467[13] = delta_x[13] + nom_x[13]; - out_4833077353004324467[14] = delta_x[14] + nom_x[14]; - out_4833077353004324467[15] = delta_x[15] + nom_x[15]; - out_4833077353004324467[16] = delta_x[16] + nom_x[16]; - out_4833077353004324467[17] = delta_x[17] + nom_x[17]; +void err_fun(double *nom_x, double *delta_x, double *out_4711793940499862270) { + out_4711793940499862270[0] = delta_x[0] + nom_x[0]; + out_4711793940499862270[1] = delta_x[1] + nom_x[1]; + out_4711793940499862270[2] = delta_x[2] + nom_x[2]; + out_4711793940499862270[3] = delta_x[3] + nom_x[3]; + out_4711793940499862270[4] = delta_x[4] + nom_x[4]; + out_4711793940499862270[5] = delta_x[5] + nom_x[5]; + out_4711793940499862270[6] = delta_x[6] + nom_x[6]; + out_4711793940499862270[7] = delta_x[7] + nom_x[7]; + out_4711793940499862270[8] = delta_x[8] + nom_x[8]; + out_4711793940499862270[9] = delta_x[9] + nom_x[9]; + out_4711793940499862270[10] = delta_x[10] + nom_x[10]; + out_4711793940499862270[11] = delta_x[11] + nom_x[11]; + out_4711793940499862270[12] = delta_x[12] + nom_x[12]; + out_4711793940499862270[13] = delta_x[13] + nom_x[13]; + out_4711793940499862270[14] = delta_x[14] + nom_x[14]; + out_4711793940499862270[15] = delta_x[15] + nom_x[15]; + out_4711793940499862270[16] = delta_x[16] + nom_x[16]; + out_4711793940499862270[17] = delta_x[17] + nom_x[17]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_4980437301453189923) { - out_4980437301453189923[0] = -nom_x[0] + true_x[0]; - out_4980437301453189923[1] = -nom_x[1] + true_x[1]; - out_4980437301453189923[2] = -nom_x[2] + true_x[2]; - out_4980437301453189923[3] = -nom_x[3] + true_x[3]; - out_4980437301453189923[4] = -nom_x[4] + true_x[4]; - out_4980437301453189923[5] = -nom_x[5] + true_x[5]; - out_4980437301453189923[6] = -nom_x[6] + true_x[6]; - out_4980437301453189923[7] = -nom_x[7] + true_x[7]; - out_4980437301453189923[8] = -nom_x[8] + true_x[8]; - out_4980437301453189923[9] = -nom_x[9] + true_x[9]; - out_4980437301453189923[10] = -nom_x[10] + true_x[10]; - out_4980437301453189923[11] = -nom_x[11] + true_x[11]; - out_4980437301453189923[12] = -nom_x[12] + true_x[12]; - out_4980437301453189923[13] = -nom_x[13] + true_x[13]; - out_4980437301453189923[14] = -nom_x[14] + true_x[14]; - out_4980437301453189923[15] = -nom_x[15] + true_x[15]; - out_4980437301453189923[16] = -nom_x[16] + true_x[16]; - out_4980437301453189923[17] = -nom_x[17] + true_x[17]; +void inv_err_fun(double *nom_x, double *true_x, double *out_8790106481935061031) { + out_8790106481935061031[0] = -nom_x[0] + true_x[0]; + out_8790106481935061031[1] = -nom_x[1] + true_x[1]; + out_8790106481935061031[2] = -nom_x[2] + true_x[2]; + out_8790106481935061031[3] = -nom_x[3] + true_x[3]; + out_8790106481935061031[4] = -nom_x[4] + true_x[4]; + out_8790106481935061031[5] = -nom_x[5] + true_x[5]; + out_8790106481935061031[6] = -nom_x[6] + true_x[6]; + out_8790106481935061031[7] = -nom_x[7] + true_x[7]; + out_8790106481935061031[8] = -nom_x[8] + true_x[8]; + out_8790106481935061031[9] = -nom_x[9] + true_x[9]; + out_8790106481935061031[10] = -nom_x[10] + true_x[10]; + out_8790106481935061031[11] = -nom_x[11] + true_x[11]; + out_8790106481935061031[12] = -nom_x[12] + true_x[12]; + out_8790106481935061031[13] = -nom_x[13] + true_x[13]; + out_8790106481935061031[14] = -nom_x[14] + true_x[14]; + out_8790106481935061031[15] = -nom_x[15] + true_x[15]; + out_8790106481935061031[16] = -nom_x[16] + true_x[16]; + out_8790106481935061031[17] = -nom_x[17] + true_x[17]; } -void H_mod_fun(double *state, double *out_4718726566615345673) { - out_4718726566615345673[0] = 1.0; - out_4718726566615345673[1] = 0.0; - out_4718726566615345673[2] = 0.0; - out_4718726566615345673[3] = 0.0; - out_4718726566615345673[4] = 0.0; - out_4718726566615345673[5] = 0.0; - out_4718726566615345673[6] = 0.0; - out_4718726566615345673[7] = 0.0; - out_4718726566615345673[8] = 0.0; - out_4718726566615345673[9] = 0.0; - out_4718726566615345673[10] = 0.0; - out_4718726566615345673[11] = 0.0; - out_4718726566615345673[12] = 0.0; - out_4718726566615345673[13] = 0.0; - out_4718726566615345673[14] = 0.0; - out_4718726566615345673[15] = 0.0; - out_4718726566615345673[16] = 0.0; - out_4718726566615345673[17] = 0.0; - out_4718726566615345673[18] = 0.0; - out_4718726566615345673[19] = 1.0; - out_4718726566615345673[20] = 0.0; - out_4718726566615345673[21] = 0.0; - out_4718726566615345673[22] = 0.0; - out_4718726566615345673[23] = 0.0; - out_4718726566615345673[24] = 0.0; - out_4718726566615345673[25] = 0.0; - out_4718726566615345673[26] = 0.0; - out_4718726566615345673[27] = 0.0; - out_4718726566615345673[28] = 0.0; - out_4718726566615345673[29] = 0.0; - out_4718726566615345673[30] = 0.0; - out_4718726566615345673[31] = 0.0; - out_4718726566615345673[32] = 0.0; - out_4718726566615345673[33] = 0.0; - out_4718726566615345673[34] = 0.0; - out_4718726566615345673[35] = 0.0; - out_4718726566615345673[36] = 0.0; - out_4718726566615345673[37] = 0.0; - out_4718726566615345673[38] = 1.0; - out_4718726566615345673[39] = 0.0; - out_4718726566615345673[40] = 0.0; - out_4718726566615345673[41] = 0.0; - out_4718726566615345673[42] = 0.0; - out_4718726566615345673[43] = 0.0; - out_4718726566615345673[44] = 0.0; - out_4718726566615345673[45] = 0.0; - out_4718726566615345673[46] = 0.0; - out_4718726566615345673[47] = 0.0; - out_4718726566615345673[48] = 0.0; - out_4718726566615345673[49] = 0.0; - out_4718726566615345673[50] = 0.0; - out_4718726566615345673[51] = 0.0; - out_4718726566615345673[52] = 0.0; - out_4718726566615345673[53] = 0.0; - out_4718726566615345673[54] = 0.0; - out_4718726566615345673[55] = 0.0; - out_4718726566615345673[56] = 0.0; - out_4718726566615345673[57] = 1.0; - out_4718726566615345673[58] = 0.0; - out_4718726566615345673[59] = 0.0; - out_4718726566615345673[60] = 0.0; - out_4718726566615345673[61] = 0.0; - out_4718726566615345673[62] = 0.0; - out_4718726566615345673[63] = 0.0; - out_4718726566615345673[64] = 0.0; - out_4718726566615345673[65] = 0.0; - out_4718726566615345673[66] = 0.0; - out_4718726566615345673[67] = 0.0; - out_4718726566615345673[68] = 0.0; - out_4718726566615345673[69] = 0.0; - out_4718726566615345673[70] = 0.0; - out_4718726566615345673[71] = 0.0; - out_4718726566615345673[72] = 0.0; - out_4718726566615345673[73] = 0.0; - out_4718726566615345673[74] = 0.0; - out_4718726566615345673[75] = 0.0; - out_4718726566615345673[76] = 1.0; - out_4718726566615345673[77] = 0.0; - out_4718726566615345673[78] = 0.0; - out_4718726566615345673[79] = 0.0; - out_4718726566615345673[80] = 0.0; - out_4718726566615345673[81] = 0.0; - out_4718726566615345673[82] = 0.0; - out_4718726566615345673[83] = 0.0; - out_4718726566615345673[84] = 0.0; - out_4718726566615345673[85] = 0.0; - out_4718726566615345673[86] = 0.0; - out_4718726566615345673[87] = 0.0; - out_4718726566615345673[88] = 0.0; - out_4718726566615345673[89] = 0.0; - out_4718726566615345673[90] = 0.0; - out_4718726566615345673[91] = 0.0; - out_4718726566615345673[92] = 0.0; - out_4718726566615345673[93] = 0.0; - out_4718726566615345673[94] = 0.0; - out_4718726566615345673[95] = 1.0; - out_4718726566615345673[96] = 0.0; - out_4718726566615345673[97] = 0.0; - out_4718726566615345673[98] = 0.0; - out_4718726566615345673[99] = 0.0; - out_4718726566615345673[100] = 0.0; - out_4718726566615345673[101] = 0.0; - out_4718726566615345673[102] = 0.0; - out_4718726566615345673[103] = 0.0; - out_4718726566615345673[104] = 0.0; - out_4718726566615345673[105] = 0.0; - out_4718726566615345673[106] = 0.0; - out_4718726566615345673[107] = 0.0; - out_4718726566615345673[108] = 0.0; - out_4718726566615345673[109] = 0.0; - out_4718726566615345673[110] = 0.0; - out_4718726566615345673[111] = 0.0; - out_4718726566615345673[112] = 0.0; - out_4718726566615345673[113] = 0.0; - out_4718726566615345673[114] = 1.0; - out_4718726566615345673[115] = 0.0; - out_4718726566615345673[116] = 0.0; - out_4718726566615345673[117] = 0.0; - out_4718726566615345673[118] = 0.0; - out_4718726566615345673[119] = 0.0; - out_4718726566615345673[120] = 0.0; - out_4718726566615345673[121] = 0.0; - out_4718726566615345673[122] = 0.0; - out_4718726566615345673[123] = 0.0; - out_4718726566615345673[124] = 0.0; - out_4718726566615345673[125] = 0.0; - out_4718726566615345673[126] = 0.0; - out_4718726566615345673[127] = 0.0; - out_4718726566615345673[128] = 0.0; - out_4718726566615345673[129] = 0.0; - out_4718726566615345673[130] = 0.0; - out_4718726566615345673[131] = 0.0; - out_4718726566615345673[132] = 0.0; - out_4718726566615345673[133] = 1.0; - out_4718726566615345673[134] = 0.0; - out_4718726566615345673[135] = 0.0; - out_4718726566615345673[136] = 0.0; - out_4718726566615345673[137] = 0.0; - out_4718726566615345673[138] = 0.0; - out_4718726566615345673[139] = 0.0; - out_4718726566615345673[140] = 0.0; - out_4718726566615345673[141] = 0.0; - out_4718726566615345673[142] = 0.0; - out_4718726566615345673[143] = 0.0; - out_4718726566615345673[144] = 0.0; - out_4718726566615345673[145] = 0.0; - out_4718726566615345673[146] = 0.0; - out_4718726566615345673[147] = 0.0; - out_4718726566615345673[148] = 0.0; - out_4718726566615345673[149] = 0.0; - out_4718726566615345673[150] = 0.0; - out_4718726566615345673[151] = 0.0; - out_4718726566615345673[152] = 1.0; - out_4718726566615345673[153] = 0.0; - out_4718726566615345673[154] = 0.0; - out_4718726566615345673[155] = 0.0; - out_4718726566615345673[156] = 0.0; - out_4718726566615345673[157] = 0.0; - out_4718726566615345673[158] = 0.0; - out_4718726566615345673[159] = 0.0; - out_4718726566615345673[160] = 0.0; - out_4718726566615345673[161] = 0.0; - out_4718726566615345673[162] = 0.0; - out_4718726566615345673[163] = 0.0; - out_4718726566615345673[164] = 0.0; - out_4718726566615345673[165] = 0.0; - out_4718726566615345673[166] = 0.0; - out_4718726566615345673[167] = 0.0; - out_4718726566615345673[168] = 0.0; - out_4718726566615345673[169] = 0.0; - out_4718726566615345673[170] = 0.0; - out_4718726566615345673[171] = 1.0; - out_4718726566615345673[172] = 0.0; - out_4718726566615345673[173] = 0.0; - out_4718726566615345673[174] = 0.0; - out_4718726566615345673[175] = 0.0; - out_4718726566615345673[176] = 0.0; - out_4718726566615345673[177] = 0.0; - out_4718726566615345673[178] = 0.0; - out_4718726566615345673[179] = 0.0; - out_4718726566615345673[180] = 0.0; - out_4718726566615345673[181] = 0.0; - out_4718726566615345673[182] = 0.0; - out_4718726566615345673[183] = 0.0; - out_4718726566615345673[184] = 0.0; - out_4718726566615345673[185] = 0.0; - out_4718726566615345673[186] = 0.0; - out_4718726566615345673[187] = 0.0; - out_4718726566615345673[188] = 0.0; - out_4718726566615345673[189] = 0.0; - out_4718726566615345673[190] = 1.0; - out_4718726566615345673[191] = 0.0; - out_4718726566615345673[192] = 0.0; - out_4718726566615345673[193] = 0.0; - out_4718726566615345673[194] = 0.0; - out_4718726566615345673[195] = 0.0; - out_4718726566615345673[196] = 0.0; - out_4718726566615345673[197] = 0.0; - out_4718726566615345673[198] = 0.0; - out_4718726566615345673[199] = 0.0; - out_4718726566615345673[200] = 0.0; - out_4718726566615345673[201] = 0.0; - out_4718726566615345673[202] = 0.0; - out_4718726566615345673[203] = 0.0; - out_4718726566615345673[204] = 0.0; - out_4718726566615345673[205] = 0.0; - out_4718726566615345673[206] = 0.0; - out_4718726566615345673[207] = 0.0; - out_4718726566615345673[208] = 0.0; - out_4718726566615345673[209] = 1.0; - out_4718726566615345673[210] = 0.0; - out_4718726566615345673[211] = 0.0; - out_4718726566615345673[212] = 0.0; - out_4718726566615345673[213] = 0.0; - out_4718726566615345673[214] = 0.0; - out_4718726566615345673[215] = 0.0; - out_4718726566615345673[216] = 0.0; - out_4718726566615345673[217] = 0.0; - out_4718726566615345673[218] = 0.0; - out_4718726566615345673[219] = 0.0; - out_4718726566615345673[220] = 0.0; - out_4718726566615345673[221] = 0.0; - out_4718726566615345673[222] = 0.0; - out_4718726566615345673[223] = 0.0; - out_4718726566615345673[224] = 0.0; - out_4718726566615345673[225] = 0.0; - out_4718726566615345673[226] = 0.0; - out_4718726566615345673[227] = 0.0; - out_4718726566615345673[228] = 1.0; - out_4718726566615345673[229] = 0.0; - out_4718726566615345673[230] = 0.0; - out_4718726566615345673[231] = 0.0; - out_4718726566615345673[232] = 0.0; - out_4718726566615345673[233] = 0.0; - out_4718726566615345673[234] = 0.0; - out_4718726566615345673[235] = 0.0; - out_4718726566615345673[236] = 0.0; - out_4718726566615345673[237] = 0.0; - out_4718726566615345673[238] = 0.0; - out_4718726566615345673[239] = 0.0; - out_4718726566615345673[240] = 0.0; - out_4718726566615345673[241] = 0.0; - out_4718726566615345673[242] = 0.0; - out_4718726566615345673[243] = 0.0; - out_4718726566615345673[244] = 0.0; - out_4718726566615345673[245] = 0.0; - out_4718726566615345673[246] = 0.0; - out_4718726566615345673[247] = 1.0; - out_4718726566615345673[248] = 0.0; - out_4718726566615345673[249] = 0.0; - out_4718726566615345673[250] = 0.0; - out_4718726566615345673[251] = 0.0; - out_4718726566615345673[252] = 0.0; - out_4718726566615345673[253] = 0.0; - out_4718726566615345673[254] = 0.0; - out_4718726566615345673[255] = 0.0; - out_4718726566615345673[256] = 0.0; - out_4718726566615345673[257] = 0.0; - out_4718726566615345673[258] = 0.0; - out_4718726566615345673[259] = 0.0; - out_4718726566615345673[260] = 0.0; - out_4718726566615345673[261] = 0.0; - out_4718726566615345673[262] = 0.0; - out_4718726566615345673[263] = 0.0; - out_4718726566615345673[264] = 0.0; - out_4718726566615345673[265] = 0.0; - out_4718726566615345673[266] = 1.0; - out_4718726566615345673[267] = 0.0; - out_4718726566615345673[268] = 0.0; - out_4718726566615345673[269] = 0.0; - out_4718726566615345673[270] = 0.0; - out_4718726566615345673[271] = 0.0; - out_4718726566615345673[272] = 0.0; - out_4718726566615345673[273] = 0.0; - out_4718726566615345673[274] = 0.0; - out_4718726566615345673[275] = 0.0; - out_4718726566615345673[276] = 0.0; - out_4718726566615345673[277] = 0.0; - out_4718726566615345673[278] = 0.0; - out_4718726566615345673[279] = 0.0; - out_4718726566615345673[280] = 0.0; - out_4718726566615345673[281] = 0.0; - out_4718726566615345673[282] = 0.0; - out_4718726566615345673[283] = 0.0; - out_4718726566615345673[284] = 0.0; - out_4718726566615345673[285] = 1.0; - out_4718726566615345673[286] = 0.0; - out_4718726566615345673[287] = 0.0; - out_4718726566615345673[288] = 0.0; - out_4718726566615345673[289] = 0.0; - out_4718726566615345673[290] = 0.0; - out_4718726566615345673[291] = 0.0; - out_4718726566615345673[292] = 0.0; - out_4718726566615345673[293] = 0.0; - out_4718726566615345673[294] = 0.0; - out_4718726566615345673[295] = 0.0; - out_4718726566615345673[296] = 0.0; - out_4718726566615345673[297] = 0.0; - out_4718726566615345673[298] = 0.0; - out_4718726566615345673[299] = 0.0; - out_4718726566615345673[300] = 0.0; - out_4718726566615345673[301] = 0.0; - out_4718726566615345673[302] = 0.0; - out_4718726566615345673[303] = 0.0; - out_4718726566615345673[304] = 1.0; - out_4718726566615345673[305] = 0.0; - out_4718726566615345673[306] = 0.0; - out_4718726566615345673[307] = 0.0; - out_4718726566615345673[308] = 0.0; - out_4718726566615345673[309] = 0.0; - out_4718726566615345673[310] = 0.0; - out_4718726566615345673[311] = 0.0; - out_4718726566615345673[312] = 0.0; - out_4718726566615345673[313] = 0.0; - out_4718726566615345673[314] = 0.0; - out_4718726566615345673[315] = 0.0; - out_4718726566615345673[316] = 0.0; - out_4718726566615345673[317] = 0.0; - out_4718726566615345673[318] = 0.0; - out_4718726566615345673[319] = 0.0; - out_4718726566615345673[320] = 0.0; - out_4718726566615345673[321] = 0.0; - out_4718726566615345673[322] = 0.0; - out_4718726566615345673[323] = 1.0; +void H_mod_fun(double *state, double *out_3710500625877642434) { + out_3710500625877642434[0] = 1.0; + out_3710500625877642434[1] = 0.0; + out_3710500625877642434[2] = 0.0; + out_3710500625877642434[3] = 0.0; + out_3710500625877642434[4] = 0.0; + out_3710500625877642434[5] = 0.0; + out_3710500625877642434[6] = 0.0; + out_3710500625877642434[7] = 0.0; + out_3710500625877642434[8] = 0.0; + out_3710500625877642434[9] = 0.0; + out_3710500625877642434[10] = 0.0; + out_3710500625877642434[11] = 0.0; + out_3710500625877642434[12] = 0.0; + out_3710500625877642434[13] = 0.0; + out_3710500625877642434[14] = 0.0; + out_3710500625877642434[15] = 0.0; + out_3710500625877642434[16] = 0.0; + out_3710500625877642434[17] = 0.0; + out_3710500625877642434[18] = 0.0; + out_3710500625877642434[19] = 1.0; + out_3710500625877642434[20] = 0.0; + out_3710500625877642434[21] = 0.0; + out_3710500625877642434[22] = 0.0; + out_3710500625877642434[23] = 0.0; + out_3710500625877642434[24] = 0.0; + out_3710500625877642434[25] = 0.0; + out_3710500625877642434[26] = 0.0; + out_3710500625877642434[27] = 0.0; + out_3710500625877642434[28] = 0.0; + out_3710500625877642434[29] = 0.0; + out_3710500625877642434[30] = 0.0; + out_3710500625877642434[31] = 0.0; + out_3710500625877642434[32] = 0.0; + out_3710500625877642434[33] = 0.0; + out_3710500625877642434[34] = 0.0; + out_3710500625877642434[35] = 0.0; + out_3710500625877642434[36] = 0.0; + out_3710500625877642434[37] = 0.0; + out_3710500625877642434[38] = 1.0; + out_3710500625877642434[39] = 0.0; + out_3710500625877642434[40] = 0.0; + out_3710500625877642434[41] = 0.0; + out_3710500625877642434[42] = 0.0; + out_3710500625877642434[43] = 0.0; + out_3710500625877642434[44] = 0.0; + out_3710500625877642434[45] = 0.0; + out_3710500625877642434[46] = 0.0; + out_3710500625877642434[47] = 0.0; + out_3710500625877642434[48] = 0.0; + out_3710500625877642434[49] = 0.0; + out_3710500625877642434[50] = 0.0; + out_3710500625877642434[51] = 0.0; + out_3710500625877642434[52] = 0.0; + out_3710500625877642434[53] = 0.0; + out_3710500625877642434[54] = 0.0; + out_3710500625877642434[55] = 0.0; + out_3710500625877642434[56] = 0.0; + out_3710500625877642434[57] = 1.0; + out_3710500625877642434[58] = 0.0; + out_3710500625877642434[59] = 0.0; + out_3710500625877642434[60] = 0.0; + out_3710500625877642434[61] = 0.0; + out_3710500625877642434[62] = 0.0; + out_3710500625877642434[63] = 0.0; + out_3710500625877642434[64] = 0.0; + out_3710500625877642434[65] = 0.0; + out_3710500625877642434[66] = 0.0; + out_3710500625877642434[67] = 0.0; + out_3710500625877642434[68] = 0.0; + out_3710500625877642434[69] = 0.0; + out_3710500625877642434[70] = 0.0; + out_3710500625877642434[71] = 0.0; + out_3710500625877642434[72] = 0.0; + out_3710500625877642434[73] = 0.0; + out_3710500625877642434[74] = 0.0; + out_3710500625877642434[75] = 0.0; + out_3710500625877642434[76] = 1.0; + out_3710500625877642434[77] = 0.0; + out_3710500625877642434[78] = 0.0; + out_3710500625877642434[79] = 0.0; + out_3710500625877642434[80] = 0.0; + out_3710500625877642434[81] = 0.0; + out_3710500625877642434[82] = 0.0; + out_3710500625877642434[83] = 0.0; + out_3710500625877642434[84] = 0.0; + out_3710500625877642434[85] = 0.0; + out_3710500625877642434[86] = 0.0; + out_3710500625877642434[87] = 0.0; + out_3710500625877642434[88] = 0.0; + out_3710500625877642434[89] = 0.0; + out_3710500625877642434[90] = 0.0; + out_3710500625877642434[91] = 0.0; + out_3710500625877642434[92] = 0.0; + out_3710500625877642434[93] = 0.0; + out_3710500625877642434[94] = 0.0; + out_3710500625877642434[95] = 1.0; + out_3710500625877642434[96] = 0.0; + out_3710500625877642434[97] = 0.0; + out_3710500625877642434[98] = 0.0; + out_3710500625877642434[99] = 0.0; + out_3710500625877642434[100] = 0.0; + out_3710500625877642434[101] = 0.0; + out_3710500625877642434[102] = 0.0; + out_3710500625877642434[103] = 0.0; + out_3710500625877642434[104] = 0.0; + out_3710500625877642434[105] = 0.0; + out_3710500625877642434[106] = 0.0; + out_3710500625877642434[107] = 0.0; + out_3710500625877642434[108] = 0.0; + out_3710500625877642434[109] = 0.0; + out_3710500625877642434[110] = 0.0; + out_3710500625877642434[111] = 0.0; + out_3710500625877642434[112] = 0.0; + out_3710500625877642434[113] = 0.0; + out_3710500625877642434[114] = 1.0; + out_3710500625877642434[115] = 0.0; + out_3710500625877642434[116] = 0.0; + out_3710500625877642434[117] = 0.0; + out_3710500625877642434[118] = 0.0; + out_3710500625877642434[119] = 0.0; + out_3710500625877642434[120] = 0.0; + out_3710500625877642434[121] = 0.0; + out_3710500625877642434[122] = 0.0; + out_3710500625877642434[123] = 0.0; + out_3710500625877642434[124] = 0.0; + out_3710500625877642434[125] = 0.0; + out_3710500625877642434[126] = 0.0; + out_3710500625877642434[127] = 0.0; + out_3710500625877642434[128] = 0.0; + out_3710500625877642434[129] = 0.0; + out_3710500625877642434[130] = 0.0; + out_3710500625877642434[131] = 0.0; + out_3710500625877642434[132] = 0.0; + out_3710500625877642434[133] = 1.0; + out_3710500625877642434[134] = 0.0; + out_3710500625877642434[135] = 0.0; + out_3710500625877642434[136] = 0.0; + out_3710500625877642434[137] = 0.0; + out_3710500625877642434[138] = 0.0; + out_3710500625877642434[139] = 0.0; + out_3710500625877642434[140] = 0.0; + out_3710500625877642434[141] = 0.0; + out_3710500625877642434[142] = 0.0; + out_3710500625877642434[143] = 0.0; + out_3710500625877642434[144] = 0.0; + out_3710500625877642434[145] = 0.0; + out_3710500625877642434[146] = 0.0; + out_3710500625877642434[147] = 0.0; + out_3710500625877642434[148] = 0.0; + out_3710500625877642434[149] = 0.0; + out_3710500625877642434[150] = 0.0; + out_3710500625877642434[151] = 0.0; + out_3710500625877642434[152] = 1.0; + out_3710500625877642434[153] = 0.0; + out_3710500625877642434[154] = 0.0; + out_3710500625877642434[155] = 0.0; + out_3710500625877642434[156] = 0.0; + out_3710500625877642434[157] = 0.0; + out_3710500625877642434[158] = 0.0; + out_3710500625877642434[159] = 0.0; + out_3710500625877642434[160] = 0.0; + out_3710500625877642434[161] = 0.0; + out_3710500625877642434[162] = 0.0; + out_3710500625877642434[163] = 0.0; + out_3710500625877642434[164] = 0.0; + out_3710500625877642434[165] = 0.0; + out_3710500625877642434[166] = 0.0; + out_3710500625877642434[167] = 0.0; + out_3710500625877642434[168] = 0.0; + out_3710500625877642434[169] = 0.0; + out_3710500625877642434[170] = 0.0; + out_3710500625877642434[171] = 1.0; + out_3710500625877642434[172] = 0.0; + out_3710500625877642434[173] = 0.0; + out_3710500625877642434[174] = 0.0; + out_3710500625877642434[175] = 0.0; + out_3710500625877642434[176] = 0.0; + out_3710500625877642434[177] = 0.0; + out_3710500625877642434[178] = 0.0; + out_3710500625877642434[179] = 0.0; + out_3710500625877642434[180] = 0.0; + out_3710500625877642434[181] = 0.0; + out_3710500625877642434[182] = 0.0; + out_3710500625877642434[183] = 0.0; + out_3710500625877642434[184] = 0.0; + out_3710500625877642434[185] = 0.0; + out_3710500625877642434[186] = 0.0; + out_3710500625877642434[187] = 0.0; + out_3710500625877642434[188] = 0.0; + out_3710500625877642434[189] = 0.0; + out_3710500625877642434[190] = 1.0; + out_3710500625877642434[191] = 0.0; + out_3710500625877642434[192] = 0.0; + out_3710500625877642434[193] = 0.0; + out_3710500625877642434[194] = 0.0; + out_3710500625877642434[195] = 0.0; + out_3710500625877642434[196] = 0.0; + out_3710500625877642434[197] = 0.0; + out_3710500625877642434[198] = 0.0; + out_3710500625877642434[199] = 0.0; + out_3710500625877642434[200] = 0.0; + out_3710500625877642434[201] = 0.0; + out_3710500625877642434[202] = 0.0; + out_3710500625877642434[203] = 0.0; + out_3710500625877642434[204] = 0.0; + out_3710500625877642434[205] = 0.0; + out_3710500625877642434[206] = 0.0; + out_3710500625877642434[207] = 0.0; + out_3710500625877642434[208] = 0.0; + out_3710500625877642434[209] = 1.0; + out_3710500625877642434[210] = 0.0; + out_3710500625877642434[211] = 0.0; + out_3710500625877642434[212] = 0.0; + out_3710500625877642434[213] = 0.0; + out_3710500625877642434[214] = 0.0; + out_3710500625877642434[215] = 0.0; + out_3710500625877642434[216] = 0.0; + out_3710500625877642434[217] = 0.0; + out_3710500625877642434[218] = 0.0; + out_3710500625877642434[219] = 0.0; + out_3710500625877642434[220] = 0.0; + out_3710500625877642434[221] = 0.0; + out_3710500625877642434[222] = 0.0; + out_3710500625877642434[223] = 0.0; + out_3710500625877642434[224] = 0.0; + out_3710500625877642434[225] = 0.0; + out_3710500625877642434[226] = 0.0; + out_3710500625877642434[227] = 0.0; + out_3710500625877642434[228] = 1.0; + out_3710500625877642434[229] = 0.0; + out_3710500625877642434[230] = 0.0; + out_3710500625877642434[231] = 0.0; + out_3710500625877642434[232] = 0.0; + out_3710500625877642434[233] = 0.0; + out_3710500625877642434[234] = 0.0; + out_3710500625877642434[235] = 0.0; + out_3710500625877642434[236] = 0.0; + out_3710500625877642434[237] = 0.0; + out_3710500625877642434[238] = 0.0; + out_3710500625877642434[239] = 0.0; + out_3710500625877642434[240] = 0.0; + out_3710500625877642434[241] = 0.0; + out_3710500625877642434[242] = 0.0; + out_3710500625877642434[243] = 0.0; + out_3710500625877642434[244] = 0.0; + out_3710500625877642434[245] = 0.0; + out_3710500625877642434[246] = 0.0; + out_3710500625877642434[247] = 1.0; + out_3710500625877642434[248] = 0.0; + out_3710500625877642434[249] = 0.0; + out_3710500625877642434[250] = 0.0; + out_3710500625877642434[251] = 0.0; + out_3710500625877642434[252] = 0.0; + out_3710500625877642434[253] = 0.0; + out_3710500625877642434[254] = 0.0; + out_3710500625877642434[255] = 0.0; + out_3710500625877642434[256] = 0.0; + out_3710500625877642434[257] = 0.0; + out_3710500625877642434[258] = 0.0; + out_3710500625877642434[259] = 0.0; + out_3710500625877642434[260] = 0.0; + out_3710500625877642434[261] = 0.0; + out_3710500625877642434[262] = 0.0; + out_3710500625877642434[263] = 0.0; + out_3710500625877642434[264] = 0.0; + out_3710500625877642434[265] = 0.0; + out_3710500625877642434[266] = 1.0; + out_3710500625877642434[267] = 0.0; + out_3710500625877642434[268] = 0.0; + out_3710500625877642434[269] = 0.0; + out_3710500625877642434[270] = 0.0; + out_3710500625877642434[271] = 0.0; + out_3710500625877642434[272] = 0.0; + out_3710500625877642434[273] = 0.0; + out_3710500625877642434[274] = 0.0; + out_3710500625877642434[275] = 0.0; + out_3710500625877642434[276] = 0.0; + out_3710500625877642434[277] = 0.0; + out_3710500625877642434[278] = 0.0; + out_3710500625877642434[279] = 0.0; + out_3710500625877642434[280] = 0.0; + out_3710500625877642434[281] = 0.0; + out_3710500625877642434[282] = 0.0; + out_3710500625877642434[283] = 0.0; + out_3710500625877642434[284] = 0.0; + out_3710500625877642434[285] = 1.0; + out_3710500625877642434[286] = 0.0; + out_3710500625877642434[287] = 0.0; + out_3710500625877642434[288] = 0.0; + out_3710500625877642434[289] = 0.0; + out_3710500625877642434[290] = 0.0; + out_3710500625877642434[291] = 0.0; + out_3710500625877642434[292] = 0.0; + out_3710500625877642434[293] = 0.0; + out_3710500625877642434[294] = 0.0; + out_3710500625877642434[295] = 0.0; + out_3710500625877642434[296] = 0.0; + out_3710500625877642434[297] = 0.0; + out_3710500625877642434[298] = 0.0; + out_3710500625877642434[299] = 0.0; + out_3710500625877642434[300] = 0.0; + out_3710500625877642434[301] = 0.0; + out_3710500625877642434[302] = 0.0; + out_3710500625877642434[303] = 0.0; + out_3710500625877642434[304] = 1.0; + out_3710500625877642434[305] = 0.0; + out_3710500625877642434[306] = 0.0; + out_3710500625877642434[307] = 0.0; + out_3710500625877642434[308] = 0.0; + out_3710500625877642434[309] = 0.0; + out_3710500625877642434[310] = 0.0; + out_3710500625877642434[311] = 0.0; + out_3710500625877642434[312] = 0.0; + out_3710500625877642434[313] = 0.0; + out_3710500625877642434[314] = 0.0; + out_3710500625877642434[315] = 0.0; + out_3710500625877642434[316] = 0.0; + out_3710500625877642434[317] = 0.0; + out_3710500625877642434[318] = 0.0; + out_3710500625877642434[319] = 0.0; + out_3710500625877642434[320] = 0.0; + out_3710500625877642434[321] = 0.0; + out_3710500625877642434[322] = 0.0; + out_3710500625877642434[323] = 1.0; } -void f_fun(double *state, double dt, double *out_2093259032196707743) { - out_2093259032196707743[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_2093259032196707743[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_2093259032196707743[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_2093259032196707743[3] = dt*state[12] + state[3]; - out_2093259032196707743[4] = dt*state[13] + state[4]; - out_2093259032196707743[5] = dt*state[14] + state[5]; - out_2093259032196707743[6] = state[6]; - out_2093259032196707743[7] = state[7]; - out_2093259032196707743[8] = state[8]; - out_2093259032196707743[9] = state[9]; - out_2093259032196707743[10] = state[10]; - out_2093259032196707743[11] = state[11]; - out_2093259032196707743[12] = state[12]; - out_2093259032196707743[13] = state[13]; - out_2093259032196707743[14] = state[14]; - out_2093259032196707743[15] = state[15]; - out_2093259032196707743[16] = state[16]; - out_2093259032196707743[17] = state[17]; +void f_fun(double *state, double dt, double *out_5725984385602899057) { + out_5725984385602899057[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_5725984385602899057[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_5725984385602899057[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_5725984385602899057[3] = dt*state[12] + state[3]; + out_5725984385602899057[4] = dt*state[13] + state[4]; + out_5725984385602899057[5] = dt*state[14] + state[5]; + out_5725984385602899057[6] = state[6]; + out_5725984385602899057[7] = state[7]; + out_5725984385602899057[8] = state[8]; + out_5725984385602899057[9] = state[9]; + out_5725984385602899057[10] = state[10]; + out_5725984385602899057[11] = state[11]; + out_5725984385602899057[12] = state[12]; + out_5725984385602899057[13] = state[13]; + out_5725984385602899057[14] = state[14]; + out_5725984385602899057[15] = state[15]; + out_5725984385602899057[16] = state[16]; + out_5725984385602899057[17] = state[17]; } -void F_fun(double *state, double dt, double *out_7597852127146355968) { - out_7597852127146355968[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_7597852127146355968[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_7597852127146355968[2] = 0; - out_7597852127146355968[3] = 0; - out_7597852127146355968[4] = 0; - out_7597852127146355968[5] = 0; - out_7597852127146355968[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_7597852127146355968[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_7597852127146355968[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_7597852127146355968[9] = 0; - out_7597852127146355968[10] = 0; - out_7597852127146355968[11] = 0; - out_7597852127146355968[12] = 0; - out_7597852127146355968[13] = 0; - out_7597852127146355968[14] = 0; - out_7597852127146355968[15] = 0; - out_7597852127146355968[16] = 0; - out_7597852127146355968[17] = 0; - out_7597852127146355968[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_7597852127146355968[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_7597852127146355968[20] = 0; - out_7597852127146355968[21] = 0; - out_7597852127146355968[22] = 0; - out_7597852127146355968[23] = 0; - out_7597852127146355968[24] = 0; - out_7597852127146355968[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_7597852127146355968[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_7597852127146355968[27] = 0; - out_7597852127146355968[28] = 0; - out_7597852127146355968[29] = 0; - out_7597852127146355968[30] = 0; - out_7597852127146355968[31] = 0; - out_7597852127146355968[32] = 0; - out_7597852127146355968[33] = 0; - out_7597852127146355968[34] = 0; - out_7597852127146355968[35] = 0; - out_7597852127146355968[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_7597852127146355968[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_7597852127146355968[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_7597852127146355968[39] = 0; - out_7597852127146355968[40] = 0; - out_7597852127146355968[41] = 0; - out_7597852127146355968[42] = 0; - out_7597852127146355968[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_7597852127146355968[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_7597852127146355968[45] = 0; - out_7597852127146355968[46] = 0; - out_7597852127146355968[47] = 0; - out_7597852127146355968[48] = 0; - out_7597852127146355968[49] = 0; - out_7597852127146355968[50] = 0; - out_7597852127146355968[51] = 0; - out_7597852127146355968[52] = 0; - out_7597852127146355968[53] = 0; - out_7597852127146355968[54] = 0; - out_7597852127146355968[55] = 0; - out_7597852127146355968[56] = 0; - out_7597852127146355968[57] = 1; - out_7597852127146355968[58] = 0; - out_7597852127146355968[59] = 0; - out_7597852127146355968[60] = 0; - out_7597852127146355968[61] = 0; - out_7597852127146355968[62] = 0; - out_7597852127146355968[63] = 0; - out_7597852127146355968[64] = 0; - out_7597852127146355968[65] = 0; - out_7597852127146355968[66] = dt; - out_7597852127146355968[67] = 0; - out_7597852127146355968[68] = 0; - out_7597852127146355968[69] = 0; - out_7597852127146355968[70] = 0; - out_7597852127146355968[71] = 0; - out_7597852127146355968[72] = 0; - out_7597852127146355968[73] = 0; - out_7597852127146355968[74] = 0; - out_7597852127146355968[75] = 0; - out_7597852127146355968[76] = 1; - out_7597852127146355968[77] = 0; - out_7597852127146355968[78] = 0; - out_7597852127146355968[79] = 0; - out_7597852127146355968[80] = 0; - out_7597852127146355968[81] = 0; - out_7597852127146355968[82] = 0; - out_7597852127146355968[83] = 0; - out_7597852127146355968[84] = 0; - out_7597852127146355968[85] = dt; - out_7597852127146355968[86] = 0; - out_7597852127146355968[87] = 0; - out_7597852127146355968[88] = 0; - out_7597852127146355968[89] = 0; - out_7597852127146355968[90] = 0; - out_7597852127146355968[91] = 0; - out_7597852127146355968[92] = 0; - out_7597852127146355968[93] = 0; - out_7597852127146355968[94] = 0; - out_7597852127146355968[95] = 1; - out_7597852127146355968[96] = 0; - out_7597852127146355968[97] = 0; - out_7597852127146355968[98] = 0; - out_7597852127146355968[99] = 0; - out_7597852127146355968[100] = 0; - out_7597852127146355968[101] = 0; - out_7597852127146355968[102] = 0; - out_7597852127146355968[103] = 0; - out_7597852127146355968[104] = dt; - out_7597852127146355968[105] = 0; - out_7597852127146355968[106] = 0; - out_7597852127146355968[107] = 0; - out_7597852127146355968[108] = 0; - out_7597852127146355968[109] = 0; - out_7597852127146355968[110] = 0; - out_7597852127146355968[111] = 0; - out_7597852127146355968[112] = 0; - out_7597852127146355968[113] = 0; - out_7597852127146355968[114] = 1; - out_7597852127146355968[115] = 0; - out_7597852127146355968[116] = 0; - out_7597852127146355968[117] = 0; - out_7597852127146355968[118] = 0; - out_7597852127146355968[119] = 0; - out_7597852127146355968[120] = 0; - out_7597852127146355968[121] = 0; - out_7597852127146355968[122] = 0; - out_7597852127146355968[123] = 0; - out_7597852127146355968[124] = 0; - out_7597852127146355968[125] = 0; - out_7597852127146355968[126] = 0; - out_7597852127146355968[127] = 0; - out_7597852127146355968[128] = 0; - out_7597852127146355968[129] = 0; - out_7597852127146355968[130] = 0; - out_7597852127146355968[131] = 0; - out_7597852127146355968[132] = 0; - out_7597852127146355968[133] = 1; - out_7597852127146355968[134] = 0; - out_7597852127146355968[135] = 0; - out_7597852127146355968[136] = 0; - out_7597852127146355968[137] = 0; - out_7597852127146355968[138] = 0; - out_7597852127146355968[139] = 0; - out_7597852127146355968[140] = 0; - out_7597852127146355968[141] = 0; - out_7597852127146355968[142] = 0; - out_7597852127146355968[143] = 0; - out_7597852127146355968[144] = 0; - out_7597852127146355968[145] = 0; - out_7597852127146355968[146] = 0; - out_7597852127146355968[147] = 0; - out_7597852127146355968[148] = 0; - out_7597852127146355968[149] = 0; - out_7597852127146355968[150] = 0; - out_7597852127146355968[151] = 0; - out_7597852127146355968[152] = 1; - out_7597852127146355968[153] = 0; - out_7597852127146355968[154] = 0; - out_7597852127146355968[155] = 0; - out_7597852127146355968[156] = 0; - out_7597852127146355968[157] = 0; - out_7597852127146355968[158] = 0; - out_7597852127146355968[159] = 0; - out_7597852127146355968[160] = 0; - out_7597852127146355968[161] = 0; - out_7597852127146355968[162] = 0; - out_7597852127146355968[163] = 0; - out_7597852127146355968[164] = 0; - out_7597852127146355968[165] = 0; - out_7597852127146355968[166] = 0; - out_7597852127146355968[167] = 0; - out_7597852127146355968[168] = 0; - out_7597852127146355968[169] = 0; - out_7597852127146355968[170] = 0; - out_7597852127146355968[171] = 1; - out_7597852127146355968[172] = 0; - out_7597852127146355968[173] = 0; - out_7597852127146355968[174] = 0; - out_7597852127146355968[175] = 0; - out_7597852127146355968[176] = 0; - out_7597852127146355968[177] = 0; - out_7597852127146355968[178] = 0; - out_7597852127146355968[179] = 0; - out_7597852127146355968[180] = 0; - out_7597852127146355968[181] = 0; - out_7597852127146355968[182] = 0; - out_7597852127146355968[183] = 0; - out_7597852127146355968[184] = 0; - out_7597852127146355968[185] = 0; - out_7597852127146355968[186] = 0; - out_7597852127146355968[187] = 0; - out_7597852127146355968[188] = 0; - out_7597852127146355968[189] = 0; - out_7597852127146355968[190] = 1; - out_7597852127146355968[191] = 0; - out_7597852127146355968[192] = 0; - out_7597852127146355968[193] = 0; - out_7597852127146355968[194] = 0; - out_7597852127146355968[195] = 0; - out_7597852127146355968[196] = 0; - out_7597852127146355968[197] = 0; - out_7597852127146355968[198] = 0; - out_7597852127146355968[199] = 0; - out_7597852127146355968[200] = 0; - out_7597852127146355968[201] = 0; - out_7597852127146355968[202] = 0; - out_7597852127146355968[203] = 0; - out_7597852127146355968[204] = 0; - out_7597852127146355968[205] = 0; - out_7597852127146355968[206] = 0; - out_7597852127146355968[207] = 0; - out_7597852127146355968[208] = 0; - out_7597852127146355968[209] = 1; - out_7597852127146355968[210] = 0; - out_7597852127146355968[211] = 0; - out_7597852127146355968[212] = 0; - out_7597852127146355968[213] = 0; - out_7597852127146355968[214] = 0; - out_7597852127146355968[215] = 0; - out_7597852127146355968[216] = 0; - out_7597852127146355968[217] = 0; - out_7597852127146355968[218] = 0; - out_7597852127146355968[219] = 0; - out_7597852127146355968[220] = 0; - out_7597852127146355968[221] = 0; - out_7597852127146355968[222] = 0; - out_7597852127146355968[223] = 0; - out_7597852127146355968[224] = 0; - out_7597852127146355968[225] = 0; - out_7597852127146355968[226] = 0; - out_7597852127146355968[227] = 0; - out_7597852127146355968[228] = 1; - out_7597852127146355968[229] = 0; - out_7597852127146355968[230] = 0; - out_7597852127146355968[231] = 0; - out_7597852127146355968[232] = 0; - out_7597852127146355968[233] = 0; - out_7597852127146355968[234] = 0; - out_7597852127146355968[235] = 0; - out_7597852127146355968[236] = 0; - out_7597852127146355968[237] = 0; - out_7597852127146355968[238] = 0; - out_7597852127146355968[239] = 0; - out_7597852127146355968[240] = 0; - out_7597852127146355968[241] = 0; - out_7597852127146355968[242] = 0; - out_7597852127146355968[243] = 0; - out_7597852127146355968[244] = 0; - out_7597852127146355968[245] = 0; - out_7597852127146355968[246] = 0; - out_7597852127146355968[247] = 1; - out_7597852127146355968[248] = 0; - out_7597852127146355968[249] = 0; - out_7597852127146355968[250] = 0; - out_7597852127146355968[251] = 0; - out_7597852127146355968[252] = 0; - out_7597852127146355968[253] = 0; - out_7597852127146355968[254] = 0; - out_7597852127146355968[255] = 0; - out_7597852127146355968[256] = 0; - out_7597852127146355968[257] = 0; - out_7597852127146355968[258] = 0; - out_7597852127146355968[259] = 0; - out_7597852127146355968[260] = 0; - out_7597852127146355968[261] = 0; - out_7597852127146355968[262] = 0; - out_7597852127146355968[263] = 0; - out_7597852127146355968[264] = 0; - out_7597852127146355968[265] = 0; - out_7597852127146355968[266] = 1; - out_7597852127146355968[267] = 0; - out_7597852127146355968[268] = 0; - out_7597852127146355968[269] = 0; - out_7597852127146355968[270] = 0; - out_7597852127146355968[271] = 0; - out_7597852127146355968[272] = 0; - out_7597852127146355968[273] = 0; - out_7597852127146355968[274] = 0; - out_7597852127146355968[275] = 0; - out_7597852127146355968[276] = 0; - out_7597852127146355968[277] = 0; - out_7597852127146355968[278] = 0; - out_7597852127146355968[279] = 0; - out_7597852127146355968[280] = 0; - out_7597852127146355968[281] = 0; - out_7597852127146355968[282] = 0; - out_7597852127146355968[283] = 0; - out_7597852127146355968[284] = 0; - out_7597852127146355968[285] = 1; - out_7597852127146355968[286] = 0; - out_7597852127146355968[287] = 0; - out_7597852127146355968[288] = 0; - out_7597852127146355968[289] = 0; - out_7597852127146355968[290] = 0; - out_7597852127146355968[291] = 0; - out_7597852127146355968[292] = 0; - out_7597852127146355968[293] = 0; - out_7597852127146355968[294] = 0; - out_7597852127146355968[295] = 0; - out_7597852127146355968[296] = 0; - out_7597852127146355968[297] = 0; - out_7597852127146355968[298] = 0; - out_7597852127146355968[299] = 0; - out_7597852127146355968[300] = 0; - out_7597852127146355968[301] = 0; - out_7597852127146355968[302] = 0; - out_7597852127146355968[303] = 0; - out_7597852127146355968[304] = 1; - out_7597852127146355968[305] = 0; - out_7597852127146355968[306] = 0; - out_7597852127146355968[307] = 0; - out_7597852127146355968[308] = 0; - out_7597852127146355968[309] = 0; - out_7597852127146355968[310] = 0; - out_7597852127146355968[311] = 0; - out_7597852127146355968[312] = 0; - out_7597852127146355968[313] = 0; - out_7597852127146355968[314] = 0; - out_7597852127146355968[315] = 0; - out_7597852127146355968[316] = 0; - out_7597852127146355968[317] = 0; - out_7597852127146355968[318] = 0; - out_7597852127146355968[319] = 0; - out_7597852127146355968[320] = 0; - out_7597852127146355968[321] = 0; - out_7597852127146355968[322] = 0; - out_7597852127146355968[323] = 1; +void F_fun(double *state, double dt, double *out_3503616768446574438) { + out_3503616768446574438[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_3503616768446574438[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_3503616768446574438[2] = 0; + out_3503616768446574438[3] = 0; + out_3503616768446574438[4] = 0; + out_3503616768446574438[5] = 0; + out_3503616768446574438[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_3503616768446574438[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_3503616768446574438[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_3503616768446574438[9] = 0; + out_3503616768446574438[10] = 0; + out_3503616768446574438[11] = 0; + out_3503616768446574438[12] = 0; + out_3503616768446574438[13] = 0; + out_3503616768446574438[14] = 0; + out_3503616768446574438[15] = 0; + out_3503616768446574438[16] = 0; + out_3503616768446574438[17] = 0; + out_3503616768446574438[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_3503616768446574438[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_3503616768446574438[20] = 0; + out_3503616768446574438[21] = 0; + out_3503616768446574438[22] = 0; + out_3503616768446574438[23] = 0; + out_3503616768446574438[24] = 0; + out_3503616768446574438[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_3503616768446574438[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_3503616768446574438[27] = 0; + out_3503616768446574438[28] = 0; + out_3503616768446574438[29] = 0; + out_3503616768446574438[30] = 0; + out_3503616768446574438[31] = 0; + out_3503616768446574438[32] = 0; + out_3503616768446574438[33] = 0; + out_3503616768446574438[34] = 0; + out_3503616768446574438[35] = 0; + out_3503616768446574438[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_3503616768446574438[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_3503616768446574438[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_3503616768446574438[39] = 0; + out_3503616768446574438[40] = 0; + out_3503616768446574438[41] = 0; + out_3503616768446574438[42] = 0; + out_3503616768446574438[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_3503616768446574438[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_3503616768446574438[45] = 0; + out_3503616768446574438[46] = 0; + out_3503616768446574438[47] = 0; + out_3503616768446574438[48] = 0; + out_3503616768446574438[49] = 0; + out_3503616768446574438[50] = 0; + out_3503616768446574438[51] = 0; + out_3503616768446574438[52] = 0; + out_3503616768446574438[53] = 0; + out_3503616768446574438[54] = 0; + out_3503616768446574438[55] = 0; + out_3503616768446574438[56] = 0; + out_3503616768446574438[57] = 1; + out_3503616768446574438[58] = 0; + out_3503616768446574438[59] = 0; + out_3503616768446574438[60] = 0; + out_3503616768446574438[61] = 0; + out_3503616768446574438[62] = 0; + out_3503616768446574438[63] = 0; + out_3503616768446574438[64] = 0; + out_3503616768446574438[65] = 0; + out_3503616768446574438[66] = dt; + out_3503616768446574438[67] = 0; + out_3503616768446574438[68] = 0; + out_3503616768446574438[69] = 0; + out_3503616768446574438[70] = 0; + out_3503616768446574438[71] = 0; + out_3503616768446574438[72] = 0; + out_3503616768446574438[73] = 0; + out_3503616768446574438[74] = 0; + out_3503616768446574438[75] = 0; + out_3503616768446574438[76] = 1; + out_3503616768446574438[77] = 0; + out_3503616768446574438[78] = 0; + out_3503616768446574438[79] = 0; + out_3503616768446574438[80] = 0; + out_3503616768446574438[81] = 0; + out_3503616768446574438[82] = 0; + out_3503616768446574438[83] = 0; + out_3503616768446574438[84] = 0; + out_3503616768446574438[85] = dt; + out_3503616768446574438[86] = 0; + out_3503616768446574438[87] = 0; + out_3503616768446574438[88] = 0; + out_3503616768446574438[89] = 0; + out_3503616768446574438[90] = 0; + out_3503616768446574438[91] = 0; + out_3503616768446574438[92] = 0; + out_3503616768446574438[93] = 0; + out_3503616768446574438[94] = 0; + out_3503616768446574438[95] = 1; + out_3503616768446574438[96] = 0; + out_3503616768446574438[97] = 0; + out_3503616768446574438[98] = 0; + out_3503616768446574438[99] = 0; + out_3503616768446574438[100] = 0; + out_3503616768446574438[101] = 0; + out_3503616768446574438[102] = 0; + out_3503616768446574438[103] = 0; + out_3503616768446574438[104] = dt; + out_3503616768446574438[105] = 0; + out_3503616768446574438[106] = 0; + out_3503616768446574438[107] = 0; + out_3503616768446574438[108] = 0; + out_3503616768446574438[109] = 0; + out_3503616768446574438[110] = 0; + out_3503616768446574438[111] = 0; + out_3503616768446574438[112] = 0; + out_3503616768446574438[113] = 0; + out_3503616768446574438[114] = 1; + out_3503616768446574438[115] = 0; + out_3503616768446574438[116] = 0; + out_3503616768446574438[117] = 0; + out_3503616768446574438[118] = 0; + out_3503616768446574438[119] = 0; + out_3503616768446574438[120] = 0; + out_3503616768446574438[121] = 0; + out_3503616768446574438[122] = 0; + out_3503616768446574438[123] = 0; + out_3503616768446574438[124] = 0; + out_3503616768446574438[125] = 0; + out_3503616768446574438[126] = 0; + out_3503616768446574438[127] = 0; + out_3503616768446574438[128] = 0; + out_3503616768446574438[129] = 0; + out_3503616768446574438[130] = 0; + out_3503616768446574438[131] = 0; + out_3503616768446574438[132] = 0; + out_3503616768446574438[133] = 1; + out_3503616768446574438[134] = 0; + out_3503616768446574438[135] = 0; + out_3503616768446574438[136] = 0; + out_3503616768446574438[137] = 0; + out_3503616768446574438[138] = 0; + out_3503616768446574438[139] = 0; + out_3503616768446574438[140] = 0; + out_3503616768446574438[141] = 0; + out_3503616768446574438[142] = 0; + out_3503616768446574438[143] = 0; + out_3503616768446574438[144] = 0; + out_3503616768446574438[145] = 0; + out_3503616768446574438[146] = 0; + out_3503616768446574438[147] = 0; + out_3503616768446574438[148] = 0; + out_3503616768446574438[149] = 0; + out_3503616768446574438[150] = 0; + out_3503616768446574438[151] = 0; + out_3503616768446574438[152] = 1; + out_3503616768446574438[153] = 0; + out_3503616768446574438[154] = 0; + out_3503616768446574438[155] = 0; + out_3503616768446574438[156] = 0; + out_3503616768446574438[157] = 0; + out_3503616768446574438[158] = 0; + out_3503616768446574438[159] = 0; + out_3503616768446574438[160] = 0; + out_3503616768446574438[161] = 0; + out_3503616768446574438[162] = 0; + out_3503616768446574438[163] = 0; + out_3503616768446574438[164] = 0; + out_3503616768446574438[165] = 0; + out_3503616768446574438[166] = 0; + out_3503616768446574438[167] = 0; + out_3503616768446574438[168] = 0; + out_3503616768446574438[169] = 0; + out_3503616768446574438[170] = 0; + out_3503616768446574438[171] = 1; + out_3503616768446574438[172] = 0; + out_3503616768446574438[173] = 0; + out_3503616768446574438[174] = 0; + out_3503616768446574438[175] = 0; + out_3503616768446574438[176] = 0; + out_3503616768446574438[177] = 0; + out_3503616768446574438[178] = 0; + out_3503616768446574438[179] = 0; + out_3503616768446574438[180] = 0; + out_3503616768446574438[181] = 0; + out_3503616768446574438[182] = 0; + out_3503616768446574438[183] = 0; + out_3503616768446574438[184] = 0; + out_3503616768446574438[185] = 0; + out_3503616768446574438[186] = 0; + out_3503616768446574438[187] = 0; + out_3503616768446574438[188] = 0; + out_3503616768446574438[189] = 0; + out_3503616768446574438[190] = 1; + out_3503616768446574438[191] = 0; + out_3503616768446574438[192] = 0; + out_3503616768446574438[193] = 0; + out_3503616768446574438[194] = 0; + out_3503616768446574438[195] = 0; + out_3503616768446574438[196] = 0; + out_3503616768446574438[197] = 0; + out_3503616768446574438[198] = 0; + out_3503616768446574438[199] = 0; + out_3503616768446574438[200] = 0; + out_3503616768446574438[201] = 0; + out_3503616768446574438[202] = 0; + out_3503616768446574438[203] = 0; + out_3503616768446574438[204] = 0; + out_3503616768446574438[205] = 0; + out_3503616768446574438[206] = 0; + out_3503616768446574438[207] = 0; + out_3503616768446574438[208] = 0; + out_3503616768446574438[209] = 1; + out_3503616768446574438[210] = 0; + out_3503616768446574438[211] = 0; + out_3503616768446574438[212] = 0; + out_3503616768446574438[213] = 0; + out_3503616768446574438[214] = 0; + out_3503616768446574438[215] = 0; + out_3503616768446574438[216] = 0; + out_3503616768446574438[217] = 0; + out_3503616768446574438[218] = 0; + out_3503616768446574438[219] = 0; + out_3503616768446574438[220] = 0; + out_3503616768446574438[221] = 0; + out_3503616768446574438[222] = 0; + out_3503616768446574438[223] = 0; + out_3503616768446574438[224] = 0; + out_3503616768446574438[225] = 0; + out_3503616768446574438[226] = 0; + out_3503616768446574438[227] = 0; + out_3503616768446574438[228] = 1; + out_3503616768446574438[229] = 0; + out_3503616768446574438[230] = 0; + out_3503616768446574438[231] = 0; + out_3503616768446574438[232] = 0; + out_3503616768446574438[233] = 0; + out_3503616768446574438[234] = 0; + out_3503616768446574438[235] = 0; + out_3503616768446574438[236] = 0; + out_3503616768446574438[237] = 0; + out_3503616768446574438[238] = 0; + out_3503616768446574438[239] = 0; + out_3503616768446574438[240] = 0; + out_3503616768446574438[241] = 0; + out_3503616768446574438[242] = 0; + out_3503616768446574438[243] = 0; + out_3503616768446574438[244] = 0; + out_3503616768446574438[245] = 0; + out_3503616768446574438[246] = 0; + out_3503616768446574438[247] = 1; + out_3503616768446574438[248] = 0; + out_3503616768446574438[249] = 0; + out_3503616768446574438[250] = 0; + out_3503616768446574438[251] = 0; + out_3503616768446574438[252] = 0; + out_3503616768446574438[253] = 0; + out_3503616768446574438[254] = 0; + out_3503616768446574438[255] = 0; + out_3503616768446574438[256] = 0; + out_3503616768446574438[257] = 0; + out_3503616768446574438[258] = 0; + out_3503616768446574438[259] = 0; + out_3503616768446574438[260] = 0; + out_3503616768446574438[261] = 0; + out_3503616768446574438[262] = 0; + out_3503616768446574438[263] = 0; + out_3503616768446574438[264] = 0; + out_3503616768446574438[265] = 0; + out_3503616768446574438[266] = 1; + out_3503616768446574438[267] = 0; + out_3503616768446574438[268] = 0; + out_3503616768446574438[269] = 0; + out_3503616768446574438[270] = 0; + out_3503616768446574438[271] = 0; + out_3503616768446574438[272] = 0; + out_3503616768446574438[273] = 0; + out_3503616768446574438[274] = 0; + out_3503616768446574438[275] = 0; + out_3503616768446574438[276] = 0; + out_3503616768446574438[277] = 0; + out_3503616768446574438[278] = 0; + out_3503616768446574438[279] = 0; + out_3503616768446574438[280] = 0; + out_3503616768446574438[281] = 0; + out_3503616768446574438[282] = 0; + out_3503616768446574438[283] = 0; + out_3503616768446574438[284] = 0; + out_3503616768446574438[285] = 1; + out_3503616768446574438[286] = 0; + out_3503616768446574438[287] = 0; + out_3503616768446574438[288] = 0; + out_3503616768446574438[289] = 0; + out_3503616768446574438[290] = 0; + out_3503616768446574438[291] = 0; + out_3503616768446574438[292] = 0; + out_3503616768446574438[293] = 0; + out_3503616768446574438[294] = 0; + out_3503616768446574438[295] = 0; + out_3503616768446574438[296] = 0; + out_3503616768446574438[297] = 0; + out_3503616768446574438[298] = 0; + out_3503616768446574438[299] = 0; + out_3503616768446574438[300] = 0; + out_3503616768446574438[301] = 0; + out_3503616768446574438[302] = 0; + out_3503616768446574438[303] = 0; + out_3503616768446574438[304] = 1; + out_3503616768446574438[305] = 0; + out_3503616768446574438[306] = 0; + out_3503616768446574438[307] = 0; + out_3503616768446574438[308] = 0; + out_3503616768446574438[309] = 0; + out_3503616768446574438[310] = 0; + out_3503616768446574438[311] = 0; + out_3503616768446574438[312] = 0; + out_3503616768446574438[313] = 0; + out_3503616768446574438[314] = 0; + out_3503616768446574438[315] = 0; + out_3503616768446574438[316] = 0; + out_3503616768446574438[317] = 0; + out_3503616768446574438[318] = 0; + out_3503616768446574438[319] = 0; + out_3503616768446574438[320] = 0; + out_3503616768446574438[321] = 0; + out_3503616768446574438[322] = 0; + out_3503616768446574438[323] = 1; } -void h_4(double *state, double *unused, double *out_89080864518885864) { - out_89080864518885864[0] = state[6] + state[9]; - out_89080864518885864[1] = state[7] + state[10]; - out_89080864518885864[2] = state[8] + state[11]; +void h_4(double *state, double *unused, double *out_3803432647309987328) { + out_3803432647309987328[0] = state[6] + state[9]; + out_3803432647309987328[1] = state[7] + state[10]; + out_3803432647309987328[2] = state[8] + state[11]; } -void H_4(double *state, double *unused, double *out_946919356771438101) { - out_946919356771438101[0] = 0; - out_946919356771438101[1] = 0; - out_946919356771438101[2] = 0; - out_946919356771438101[3] = 0; - out_946919356771438101[4] = 0; - out_946919356771438101[5] = 0; - out_946919356771438101[6] = 1; - out_946919356771438101[7] = 0; - out_946919356771438101[8] = 0; - out_946919356771438101[9] = 1; - out_946919356771438101[10] = 0; - out_946919356771438101[11] = 0; - out_946919356771438101[12] = 0; - out_946919356771438101[13] = 0; - out_946919356771438101[14] = 0; - out_946919356771438101[15] = 0; - out_946919356771438101[16] = 0; - out_946919356771438101[17] = 0; - out_946919356771438101[18] = 0; - out_946919356771438101[19] = 0; - out_946919356771438101[20] = 0; - out_946919356771438101[21] = 0; - out_946919356771438101[22] = 0; - out_946919356771438101[23] = 0; - out_946919356771438101[24] = 0; - out_946919356771438101[25] = 1; - out_946919356771438101[26] = 0; - out_946919356771438101[27] = 0; - out_946919356771438101[28] = 1; - out_946919356771438101[29] = 0; - out_946919356771438101[30] = 0; - out_946919356771438101[31] = 0; - out_946919356771438101[32] = 0; - out_946919356771438101[33] = 0; - out_946919356771438101[34] = 0; - out_946919356771438101[35] = 0; - out_946919356771438101[36] = 0; - out_946919356771438101[37] = 0; - out_946919356771438101[38] = 0; - out_946919356771438101[39] = 0; - out_946919356771438101[40] = 0; - out_946919356771438101[41] = 0; - out_946919356771438101[42] = 0; - out_946919356771438101[43] = 0; - out_946919356771438101[44] = 1; - out_946919356771438101[45] = 0; - out_946919356771438101[46] = 0; - out_946919356771438101[47] = 1; - out_946919356771438101[48] = 0; - out_946919356771438101[49] = 0; - out_946919356771438101[50] = 0; - out_946919356771438101[51] = 0; - out_946919356771438101[52] = 0; - out_946919356771438101[53] = 0; +void H_4(double *state, double *unused, double *out_7950155699686530755) { + out_7950155699686530755[0] = 0; + out_7950155699686530755[1] = 0; + out_7950155699686530755[2] = 0; + out_7950155699686530755[3] = 0; + out_7950155699686530755[4] = 0; + out_7950155699686530755[5] = 0; + out_7950155699686530755[6] = 1; + out_7950155699686530755[7] = 0; + out_7950155699686530755[8] = 0; + out_7950155699686530755[9] = 1; + out_7950155699686530755[10] = 0; + out_7950155699686530755[11] = 0; + out_7950155699686530755[12] = 0; + out_7950155699686530755[13] = 0; + out_7950155699686530755[14] = 0; + out_7950155699686530755[15] = 0; + out_7950155699686530755[16] = 0; + out_7950155699686530755[17] = 0; + out_7950155699686530755[18] = 0; + out_7950155699686530755[19] = 0; + out_7950155699686530755[20] = 0; + out_7950155699686530755[21] = 0; + out_7950155699686530755[22] = 0; + out_7950155699686530755[23] = 0; + out_7950155699686530755[24] = 0; + out_7950155699686530755[25] = 1; + out_7950155699686530755[26] = 0; + out_7950155699686530755[27] = 0; + out_7950155699686530755[28] = 1; + out_7950155699686530755[29] = 0; + out_7950155699686530755[30] = 0; + out_7950155699686530755[31] = 0; + out_7950155699686530755[32] = 0; + out_7950155699686530755[33] = 0; + out_7950155699686530755[34] = 0; + out_7950155699686530755[35] = 0; + out_7950155699686530755[36] = 0; + out_7950155699686530755[37] = 0; + out_7950155699686530755[38] = 0; + out_7950155699686530755[39] = 0; + out_7950155699686530755[40] = 0; + out_7950155699686530755[41] = 0; + out_7950155699686530755[42] = 0; + out_7950155699686530755[43] = 0; + out_7950155699686530755[44] = 1; + out_7950155699686530755[45] = 0; + out_7950155699686530755[46] = 0; + out_7950155699686530755[47] = 1; + out_7950155699686530755[48] = 0; + out_7950155699686530755[49] = 0; + out_7950155699686530755[50] = 0; + out_7950155699686530755[51] = 0; + out_7950155699686530755[52] = 0; + out_7950155699686530755[53] = 0; } -void h_10(double *state, double *unused, double *out_2699740651616676276) { - out_2699740651616676276[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; - out_2699740651616676276[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; - out_2699740651616676276[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_477421004614984104) { + out_477421004614984104[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; + out_477421004614984104[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; + out_477421004614984104[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_8679455089612648559) { - out_8679455089612648559[0] = 0; - out_8679455089612648559[1] = 9.8100000000000005*cos(state[1]); - out_8679455089612648559[2] = 0; - out_8679455089612648559[3] = 0; - out_8679455089612648559[4] = -state[8]; - out_8679455089612648559[5] = state[7]; - out_8679455089612648559[6] = 0; - out_8679455089612648559[7] = state[5]; - out_8679455089612648559[8] = -state[4]; - out_8679455089612648559[9] = 0; - out_8679455089612648559[10] = 0; - out_8679455089612648559[11] = 0; - out_8679455089612648559[12] = 1; - out_8679455089612648559[13] = 0; - out_8679455089612648559[14] = 0; - out_8679455089612648559[15] = 1; - out_8679455089612648559[16] = 0; - out_8679455089612648559[17] = 0; - out_8679455089612648559[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); - out_8679455089612648559[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); - out_8679455089612648559[20] = 0; - out_8679455089612648559[21] = state[8]; - out_8679455089612648559[22] = 0; - out_8679455089612648559[23] = -state[6]; - out_8679455089612648559[24] = -state[5]; - out_8679455089612648559[25] = 0; - out_8679455089612648559[26] = state[3]; - out_8679455089612648559[27] = 0; - out_8679455089612648559[28] = 0; - out_8679455089612648559[29] = 0; - out_8679455089612648559[30] = 0; - out_8679455089612648559[31] = 1; - out_8679455089612648559[32] = 0; - out_8679455089612648559[33] = 0; - out_8679455089612648559[34] = 1; - out_8679455089612648559[35] = 0; - out_8679455089612648559[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); - out_8679455089612648559[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); - out_8679455089612648559[38] = 0; - out_8679455089612648559[39] = -state[7]; - out_8679455089612648559[40] = state[6]; - out_8679455089612648559[41] = 0; - out_8679455089612648559[42] = state[4]; - out_8679455089612648559[43] = -state[3]; - out_8679455089612648559[44] = 0; - out_8679455089612648559[45] = 0; - out_8679455089612648559[46] = 0; - out_8679455089612648559[47] = 0; - out_8679455089612648559[48] = 0; - out_8679455089612648559[49] = 0; - out_8679455089612648559[50] = 1; - out_8679455089612648559[51] = 0; - out_8679455089612648559[52] = 0; - out_8679455089612648559[53] = 1; +void H_10(double *state, double *unused, double *out_8536057142137197060) { + out_8536057142137197060[0] = 0; + out_8536057142137197060[1] = 9.8100000000000005*cos(state[1]); + out_8536057142137197060[2] = 0; + out_8536057142137197060[3] = 0; + out_8536057142137197060[4] = -state[8]; + out_8536057142137197060[5] = state[7]; + out_8536057142137197060[6] = 0; + out_8536057142137197060[7] = state[5]; + out_8536057142137197060[8] = -state[4]; + out_8536057142137197060[9] = 0; + out_8536057142137197060[10] = 0; + out_8536057142137197060[11] = 0; + out_8536057142137197060[12] = 1; + out_8536057142137197060[13] = 0; + out_8536057142137197060[14] = 0; + out_8536057142137197060[15] = 1; + out_8536057142137197060[16] = 0; + out_8536057142137197060[17] = 0; + out_8536057142137197060[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); + out_8536057142137197060[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); + out_8536057142137197060[20] = 0; + out_8536057142137197060[21] = state[8]; + out_8536057142137197060[22] = 0; + out_8536057142137197060[23] = -state[6]; + out_8536057142137197060[24] = -state[5]; + out_8536057142137197060[25] = 0; + out_8536057142137197060[26] = state[3]; + out_8536057142137197060[27] = 0; + out_8536057142137197060[28] = 0; + out_8536057142137197060[29] = 0; + out_8536057142137197060[30] = 0; + out_8536057142137197060[31] = 1; + out_8536057142137197060[32] = 0; + out_8536057142137197060[33] = 0; + out_8536057142137197060[34] = 1; + out_8536057142137197060[35] = 0; + out_8536057142137197060[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); + out_8536057142137197060[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); + out_8536057142137197060[38] = 0; + out_8536057142137197060[39] = -state[7]; + out_8536057142137197060[40] = state[6]; + out_8536057142137197060[41] = 0; + out_8536057142137197060[42] = state[4]; + out_8536057142137197060[43] = -state[3]; + out_8536057142137197060[44] = 0; + out_8536057142137197060[45] = 0; + out_8536057142137197060[46] = 0; + out_8536057142137197060[47] = 0; + out_8536057142137197060[48] = 0; + out_8536057142137197060[49] = 0; + out_8536057142137197060[50] = 1; + out_8536057142137197060[51] = 0; + out_8536057142137197060[52] = 0; + out_8536057142137197060[53] = 1; } -void h_13(double *state, double *unused, double *out_622335723485041042) { - out_622335723485041042[0] = state[3]; - out_622335723485041042[1] = state[4]; - out_622335723485041042[2] = state[5]; +void h_13(double *state, double *unused, double *out_1243321013145270066) { + out_1243321013145270066[0] = state[3]; + out_1243321013145270066[1] = state[4]; + out_1243321013145270066[2] = state[5]; } -void H_13(double *state, double *unused, double *out_2265354468560894700) { - out_2265354468560894700[0] = 0; - out_2265354468560894700[1] = 0; - out_2265354468560894700[2] = 0; - out_2265354468560894700[3] = 1; - out_2265354468560894700[4] = 0; - out_2265354468560894700[5] = 0; - out_2265354468560894700[6] = 0; - out_2265354468560894700[7] = 0; - out_2265354468560894700[8] = 0; - out_2265354468560894700[9] = 0; - out_2265354468560894700[10] = 0; - out_2265354468560894700[11] = 0; - out_2265354468560894700[12] = 0; - out_2265354468560894700[13] = 0; - out_2265354468560894700[14] = 0; - out_2265354468560894700[15] = 0; - out_2265354468560894700[16] = 0; - out_2265354468560894700[17] = 0; - out_2265354468560894700[18] = 0; - out_2265354468560894700[19] = 0; - out_2265354468560894700[20] = 0; - out_2265354468560894700[21] = 0; - out_2265354468560894700[22] = 1; - out_2265354468560894700[23] = 0; - out_2265354468560894700[24] = 0; - out_2265354468560894700[25] = 0; - out_2265354468560894700[26] = 0; - out_2265354468560894700[27] = 0; - out_2265354468560894700[28] = 0; - out_2265354468560894700[29] = 0; - out_2265354468560894700[30] = 0; - out_2265354468560894700[31] = 0; - out_2265354468560894700[32] = 0; - out_2265354468560894700[33] = 0; - out_2265354468560894700[34] = 0; - out_2265354468560894700[35] = 0; - out_2265354468560894700[36] = 0; - out_2265354468560894700[37] = 0; - out_2265354468560894700[38] = 0; - out_2265354468560894700[39] = 0; - out_2265354468560894700[40] = 0; - out_2265354468560894700[41] = 1; - out_2265354468560894700[42] = 0; - out_2265354468560894700[43] = 0; - out_2265354468560894700[44] = 0; - out_2265354468560894700[45] = 0; - out_2265354468560894700[46] = 0; - out_2265354468560894700[47] = 0; - out_2265354468560894700[48] = 0; - out_2265354468560894700[49] = 0; - out_2265354468560894700[50] = 0; - out_2265354468560894700[51] = 0; - out_2265354468560894700[52] = 0; - out_2265354468560894700[53] = 0; +void H_13(double *state, double *unused, double *out_8514757619368374859) { + out_8514757619368374859[0] = 0; + out_8514757619368374859[1] = 0; + out_8514757619368374859[2] = 0; + out_8514757619368374859[3] = 1; + out_8514757619368374859[4] = 0; + out_8514757619368374859[5] = 0; + out_8514757619368374859[6] = 0; + out_8514757619368374859[7] = 0; + out_8514757619368374859[8] = 0; + out_8514757619368374859[9] = 0; + out_8514757619368374859[10] = 0; + out_8514757619368374859[11] = 0; + out_8514757619368374859[12] = 0; + out_8514757619368374859[13] = 0; + out_8514757619368374859[14] = 0; + out_8514757619368374859[15] = 0; + out_8514757619368374859[16] = 0; + out_8514757619368374859[17] = 0; + out_8514757619368374859[18] = 0; + out_8514757619368374859[19] = 0; + out_8514757619368374859[20] = 0; + out_8514757619368374859[21] = 0; + out_8514757619368374859[22] = 1; + out_8514757619368374859[23] = 0; + out_8514757619368374859[24] = 0; + out_8514757619368374859[25] = 0; + out_8514757619368374859[26] = 0; + out_8514757619368374859[27] = 0; + out_8514757619368374859[28] = 0; + out_8514757619368374859[29] = 0; + out_8514757619368374859[30] = 0; + out_8514757619368374859[31] = 0; + out_8514757619368374859[32] = 0; + out_8514757619368374859[33] = 0; + out_8514757619368374859[34] = 0; + out_8514757619368374859[35] = 0; + out_8514757619368374859[36] = 0; + out_8514757619368374859[37] = 0; + out_8514757619368374859[38] = 0; + out_8514757619368374859[39] = 0; + out_8514757619368374859[40] = 0; + out_8514757619368374859[41] = 1; + out_8514757619368374859[42] = 0; + out_8514757619368374859[43] = 0; + out_8514757619368374859[44] = 0; + out_8514757619368374859[45] = 0; + out_8514757619368374859[46] = 0; + out_8514757619368374859[47] = 0; + out_8514757619368374859[48] = 0; + out_8514757619368374859[49] = 0; + out_8514757619368374859[50] = 0; + out_8514757619368374859[51] = 0; + out_8514757619368374859[52] = 0; + out_8514757619368374859[53] = 0; } -void h_14(double *state, double *unused, double *out_299516174209740344) { - out_299516174209740344[0] = state[6]; - out_299516174209740344[1] = state[7]; - out_299516174209740344[2] = state[8]; +void h_14(double *state, double *unused, double *out_7694485530011040401) { + out_7694485530011040401[0] = state[6]; + out_7694485530011040401[1] = state[7]; + out_7694485530011040401[2] = state[8]; } -void H_14(double *state, double *unused, double *out_3016321499568046428) { - out_3016321499568046428[0] = 0; - out_3016321499568046428[1] = 0; - out_3016321499568046428[2] = 0; - out_3016321499568046428[3] = 0; - out_3016321499568046428[4] = 0; - out_3016321499568046428[5] = 0; - out_3016321499568046428[6] = 1; - out_3016321499568046428[7] = 0; - out_3016321499568046428[8] = 0; - out_3016321499568046428[9] = 0; - out_3016321499568046428[10] = 0; - out_3016321499568046428[11] = 0; - out_3016321499568046428[12] = 0; - out_3016321499568046428[13] = 0; - out_3016321499568046428[14] = 0; - out_3016321499568046428[15] = 0; - out_3016321499568046428[16] = 0; - out_3016321499568046428[17] = 0; - out_3016321499568046428[18] = 0; - out_3016321499568046428[19] = 0; - out_3016321499568046428[20] = 0; - out_3016321499568046428[21] = 0; - out_3016321499568046428[22] = 0; - out_3016321499568046428[23] = 0; - out_3016321499568046428[24] = 0; - out_3016321499568046428[25] = 1; - out_3016321499568046428[26] = 0; - out_3016321499568046428[27] = 0; - out_3016321499568046428[28] = 0; - out_3016321499568046428[29] = 0; - out_3016321499568046428[30] = 0; - out_3016321499568046428[31] = 0; - out_3016321499568046428[32] = 0; - out_3016321499568046428[33] = 0; - out_3016321499568046428[34] = 0; - out_3016321499568046428[35] = 0; - out_3016321499568046428[36] = 0; - out_3016321499568046428[37] = 0; - out_3016321499568046428[38] = 0; - out_3016321499568046428[39] = 0; - out_3016321499568046428[40] = 0; - out_3016321499568046428[41] = 0; - out_3016321499568046428[42] = 0; - out_3016321499568046428[43] = 0; - out_3016321499568046428[44] = 1; - out_3016321499568046428[45] = 0; - out_3016321499568046428[46] = 0; - out_3016321499568046428[47] = 0; - out_3016321499568046428[48] = 0; - out_3016321499568046428[49] = 0; - out_3016321499568046428[50] = 0; - out_3016321499568046428[51] = 0; - out_3016321499568046428[52] = 0; - out_3016321499568046428[53] = 0; +void H_14(double *state, double *unused, double *out_4867367267391158459) { + out_4867367267391158459[0] = 0; + out_4867367267391158459[1] = 0; + out_4867367267391158459[2] = 0; + out_4867367267391158459[3] = 0; + out_4867367267391158459[4] = 0; + out_4867367267391158459[5] = 0; + out_4867367267391158459[6] = 1; + out_4867367267391158459[7] = 0; + out_4867367267391158459[8] = 0; + out_4867367267391158459[9] = 0; + out_4867367267391158459[10] = 0; + out_4867367267391158459[11] = 0; + out_4867367267391158459[12] = 0; + out_4867367267391158459[13] = 0; + out_4867367267391158459[14] = 0; + out_4867367267391158459[15] = 0; + out_4867367267391158459[16] = 0; + out_4867367267391158459[17] = 0; + out_4867367267391158459[18] = 0; + out_4867367267391158459[19] = 0; + out_4867367267391158459[20] = 0; + out_4867367267391158459[21] = 0; + out_4867367267391158459[22] = 0; + out_4867367267391158459[23] = 0; + out_4867367267391158459[24] = 0; + out_4867367267391158459[25] = 1; + out_4867367267391158459[26] = 0; + out_4867367267391158459[27] = 0; + out_4867367267391158459[28] = 0; + out_4867367267391158459[29] = 0; + out_4867367267391158459[30] = 0; + out_4867367267391158459[31] = 0; + out_4867367267391158459[32] = 0; + out_4867367267391158459[33] = 0; + out_4867367267391158459[34] = 0; + out_4867367267391158459[35] = 0; + out_4867367267391158459[36] = 0; + out_4867367267391158459[37] = 0; + out_4867367267391158459[38] = 0; + out_4867367267391158459[39] = 0; + out_4867367267391158459[40] = 0; + out_4867367267391158459[41] = 0; + out_4867367267391158459[42] = 0; + out_4867367267391158459[43] = 0; + out_4867367267391158459[44] = 1; + out_4867367267391158459[45] = 0; + out_4867367267391158459[46] = 0; + out_4867367267391158459[47] = 0; + out_4867367267391158459[48] = 0; + out_4867367267391158459[49] = 0; + out_4867367267391158459[50] = 0; + out_4867367267391158459[51] = 0; + out_4867367267391158459[52] = 0; + out_4867367267391158459[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_4833077353004324467) { - err_fun(nom_x, delta_x, out_4833077353004324467); +void pose_err_fun(double *nom_x, double *delta_x, double *out_4711793940499862270) { + err_fun(nom_x, delta_x, out_4711793940499862270); } -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_4980437301453189923) { - inv_err_fun(nom_x, true_x, out_4980437301453189923); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_8790106481935061031) { + inv_err_fun(nom_x, true_x, out_8790106481935061031); } -void pose_H_mod_fun(double *state, double *out_4718726566615345673) { - H_mod_fun(state, out_4718726566615345673); +void pose_H_mod_fun(double *state, double *out_3710500625877642434) { + H_mod_fun(state, out_3710500625877642434); } -void pose_f_fun(double *state, double dt, double *out_2093259032196707743) { - f_fun(state, dt, out_2093259032196707743); +void pose_f_fun(double *state, double dt, double *out_5725984385602899057) { + f_fun(state, dt, out_5725984385602899057); } -void pose_F_fun(double *state, double dt, double *out_7597852127146355968) { - F_fun(state, dt, out_7597852127146355968); +void pose_F_fun(double *state, double dt, double *out_3503616768446574438) { + F_fun(state, dt, out_3503616768446574438); } -void pose_h_4(double *state, double *unused, double *out_89080864518885864) { - h_4(state, unused, out_89080864518885864); +void pose_h_4(double *state, double *unused, double *out_3803432647309987328) { + h_4(state, unused, out_3803432647309987328); } -void pose_H_4(double *state, double *unused, double *out_946919356771438101) { - H_4(state, unused, out_946919356771438101); +void pose_H_4(double *state, double *unused, double *out_7950155699686530755) { + H_4(state, unused, out_7950155699686530755); } -void pose_h_10(double *state, double *unused, double *out_2699740651616676276) { - h_10(state, unused, out_2699740651616676276); +void pose_h_10(double *state, double *unused, double *out_477421004614984104) { + h_10(state, unused, out_477421004614984104); } -void pose_H_10(double *state, double *unused, double *out_8679455089612648559) { - H_10(state, unused, out_8679455089612648559); +void pose_H_10(double *state, double *unused, double *out_8536057142137197060) { + H_10(state, unused, out_8536057142137197060); } -void pose_h_13(double *state, double *unused, double *out_622335723485041042) { - h_13(state, unused, out_622335723485041042); +void pose_h_13(double *state, double *unused, double *out_1243321013145270066) { + h_13(state, unused, out_1243321013145270066); } -void pose_H_13(double *state, double *unused, double *out_2265354468560894700) { - H_13(state, unused, out_2265354468560894700); +void pose_H_13(double *state, double *unused, double *out_8514757619368374859) { + H_13(state, unused, out_8514757619368374859); } -void pose_h_14(double *state, double *unused, double *out_299516174209740344) { - h_14(state, unused, out_299516174209740344); +void pose_h_14(double *state, double *unused, double *out_7694485530011040401) { + h_14(state, unused, out_7694485530011040401); } -void pose_H_14(double *state, double *unused, double *out_3016321499568046428) { - H_14(state, unused, out_3016321499568046428); +void pose_H_14(double *state, double *unused, double *out_4867367267391158459) { + H_14(state, unused, out_4867367267391158459); } 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 8f8c8c533..030a926d9 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_4833077353004324467); -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_4980437301453189923); -void pose_H_mod_fun(double *state, double *out_4718726566615345673); -void pose_f_fun(double *state, double dt, double *out_2093259032196707743); -void pose_F_fun(double *state, double dt, double *out_7597852127146355968); -void pose_h_4(double *state, double *unused, double *out_89080864518885864); -void pose_H_4(double *state, double *unused, double *out_946919356771438101); -void pose_h_10(double *state, double *unused, double *out_2699740651616676276); -void pose_H_10(double *state, double *unused, double *out_8679455089612648559); -void pose_h_13(double *state, double *unused, double *out_622335723485041042); -void pose_H_13(double *state, double *unused, double *out_2265354468560894700); -void pose_h_14(double *state, double *unused, double *out_299516174209740344); -void pose_H_14(double *state, double *unused, double *out_3016321499568046428); +void pose_err_fun(double *nom_x, double *delta_x, double *out_4711793940499862270); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_8790106481935061031); +void pose_H_mod_fun(double *state, double *out_3710500625877642434); +void pose_f_fun(double *state, double dt, double *out_5725984385602899057); +void pose_F_fun(double *state, double dt, double *out_3503616768446574438); +void pose_h_4(double *state, double *unused, double *out_3803432647309987328); +void pose_H_4(double *state, double *unused, double *out_7950155699686530755); +void pose_h_10(double *state, double *unused, double *out_477421004614984104); +void pose_H_10(double *state, double *unused, double *out_8536057142137197060); +void pose_h_13(double *state, double *unused, double *out_1243321013145270066); +void pose_H_13(double *state, double *unused, double *out_8514757619368374859); +void pose_h_14(double *state, double *unused, double *out_7694485530011040401); +void pose_H_14(double *state, double *unused, double *out_4867367267391158459); 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 e796f620c62670ab9b1150a16997376f1eda76b9..039f9a99690b6a2deaf0edd569e5033d86ab2677 100755 GIT binary patch delta 87 zcmZ4SQ-8%z{S7HhB9*#(cU*sSeNo-4r<31m30j3(>N_@9Ftt}OF#<7&W(HywAZ7(( gHXvr-UctoCu!~Ww{pTJIAm#*OuI)efaId!q09a%r@Bjb+ delta 87 zcmZ4SQ-8%z{S7HhBHX+`|A#X&g`K)m`a!`>GXpUT5VHa? g8xXT^uVCV6*u}`!{&Nop5OV@C*Y=-#xYyeQ02cNmQ2+n{ diff --git a/selfdrive/ui/ui b/selfdrive/ui/ui index 582c7144a27de103cc7f9789d6be60148afecb1a..8940bc2f5033e955c6a51e8c7a53e901d7982f43 100755 GIT binary patch delta 655 zcmXxg&ufx#9KiAC`{ewQ+xp>;<=UpR^wCvoYt_o!)WpMXU5fsIlr9|`E{L%OD$%v1 zhzyd^ZHo>HH)f<9PbgB=c>gcJQ3z#vZHG|u2GTyVn!FNSaq zJ`CeLMlgyo_z}Q3g1CT-2-Wg>xTKV~s4U@{vKV`ZJ~LaLOHx;vFMHR%Z%TbuUO6^g%Vy5Q$}MX(lZ**U7dQNJ{wbtr)sXN6=%RmHCOyCkO;|eBm6;qhT gHO$~TZr~50uHv1ONa4 delta 655 zcmXxgKTH#09LDi`&;C^`l~!v}Dv0G;RA>dMEv2mx!m2|P5repdaIK&Zm6UQ6m2Ie|Y{vFMuxffWO*J*^Qkwg7it%o}YTCs%a3+OYJh0)E?$7Nu6&NB-NQOkM_RZ?WE1a@?y*IJ*}E^RDP*dASZ`zlQblC zJd{IbOcFNzzw5kJmStKRXLw(p@Wh&uy55&0eLxbCRIT0#No>u2iJjpsNqfriwh`rX z?@_&wTL1V(>bsi8w^^6Kf i2E^>!E0{PYTxJw&=e))N#GF9P1;pIjIj`~bHvj-IpCGdU delta 91 zcmbQS)^x^N(+w$1BA2RGReMWrysaQR?aOvkDdDWJ({{}jOzjm+j6e*cnSq!Eh*^P{ i4T#ydS1@r*xXj4b&UuXkh&h3n3y8V5b6(@=ZvX%s-XL25 diff --git a/system/loggerd/bootlog b/system/loggerd/bootlog index 9f056f95dd5c332cca9711e5e7eff0dfd43caaee..2464eb7c226a05d94ffa7f3cb5d99213004dd278 100755 GIT binary patch delta 75 zcmca`OZCDn)eR|3BCVQPUsIIo{@4p;y|iB6GcofdQ+{&=Q+ovyBM^gVW*}w(V%F^y YOl%ov8O7Qko@WDM_U#YPbL7tj0Hcr|t^fc4 delta 75 zcmca`OZCDn)eR|3B38mNw;r``*9?_iy!LmpzowsRe06gLQ+ovyBM^gVW*}w(V%F^y XOl%ov8QIz&o(Ey}?GMj$mVgzCk%?!jWK+Fon iY(UHo#2nizm^cF}8O7R9R&xR|7Z7uAKUvMQd^!N+FeAhO delta 91 zcmeyc%;du|lMN|MB35fA9ceq!+#>dk<;3dZj?WWU@&q?mFtt}OF#<7&W(HywAZ7(( iHXvpPVvg+CgjBM>Et2u#~3y8V5pRDFtJ{Kf e2E^>kE0{Ra8O7QwGdX~m6NtICS7vg@ZvX&wsvXw= delta 86 zcmcby+2F=zgAFN6A|}5cZdZ&hU7^O+e>i3H