diff --git a/openpilot/selfdrive/locationd/models/generated/car.cpp b/openpilot/selfdrive/locationd/models/generated/car.cpp index 56b1811501..06ea3aaad3 100644 --- a/openpilot/selfdrive/locationd/models/generated/car.cpp +++ b/openpilot/selfdrive/locationd/models/generated/car.cpp @@ -45,326 +45,326 @@ const static double MAHA_THRESH_31 = 3.8414588206941227; * * * This file is part of 'ekf' * ******************************************************************************/ -void err_fun(double *nom_x, double *delta_x, double *out_1014334527327209848) { - out_1014334527327209848[0] = delta_x[0] + nom_x[0]; - out_1014334527327209848[1] = delta_x[1] + nom_x[1]; - out_1014334527327209848[2] = delta_x[2] + nom_x[2]; - out_1014334527327209848[3] = delta_x[3] + nom_x[3]; - out_1014334527327209848[4] = delta_x[4] + nom_x[4]; - out_1014334527327209848[5] = delta_x[5] + nom_x[5]; - out_1014334527327209848[6] = delta_x[6] + nom_x[6]; - out_1014334527327209848[7] = delta_x[7] + nom_x[7]; - out_1014334527327209848[8] = delta_x[8] + nom_x[8]; +void err_fun(double *nom_x, double *delta_x, double *out_2633990546043802948) { + out_2633990546043802948[0] = delta_x[0] + nom_x[0]; + out_2633990546043802948[1] = delta_x[1] + nom_x[1]; + out_2633990546043802948[2] = delta_x[2] + nom_x[2]; + out_2633990546043802948[3] = delta_x[3] + nom_x[3]; + out_2633990546043802948[4] = delta_x[4] + nom_x[4]; + out_2633990546043802948[5] = delta_x[5] + nom_x[5]; + out_2633990546043802948[6] = delta_x[6] + nom_x[6]; + out_2633990546043802948[7] = delta_x[7] + nom_x[7]; + out_2633990546043802948[8] = delta_x[8] + nom_x[8]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_3206419511188405682) { - out_3206419511188405682[0] = -nom_x[0] + true_x[0]; - out_3206419511188405682[1] = -nom_x[1] + true_x[1]; - out_3206419511188405682[2] = -nom_x[2] + true_x[2]; - out_3206419511188405682[3] = -nom_x[3] + true_x[3]; - out_3206419511188405682[4] = -nom_x[4] + true_x[4]; - out_3206419511188405682[5] = -nom_x[5] + true_x[5]; - out_3206419511188405682[6] = -nom_x[6] + true_x[6]; - out_3206419511188405682[7] = -nom_x[7] + true_x[7]; - out_3206419511188405682[8] = -nom_x[8] + true_x[8]; +void inv_err_fun(double *nom_x, double *true_x, double *out_1648181344021920920) { + out_1648181344021920920[0] = -nom_x[0] + true_x[0]; + out_1648181344021920920[1] = -nom_x[1] + true_x[1]; + out_1648181344021920920[2] = -nom_x[2] + true_x[2]; + out_1648181344021920920[3] = -nom_x[3] + true_x[3]; + out_1648181344021920920[4] = -nom_x[4] + true_x[4]; + out_1648181344021920920[5] = -nom_x[5] + true_x[5]; + out_1648181344021920920[6] = -nom_x[6] + true_x[6]; + out_1648181344021920920[7] = -nom_x[7] + true_x[7]; + out_1648181344021920920[8] = -nom_x[8] + true_x[8]; } -void H_mod_fun(double *state, double *out_992849709061666640) { - out_992849709061666640[0] = 1.0; - out_992849709061666640[1] = 0.0; - out_992849709061666640[2] = 0.0; - out_992849709061666640[3] = 0.0; - out_992849709061666640[4] = 0.0; - out_992849709061666640[5] = 0.0; - out_992849709061666640[6] = 0.0; - out_992849709061666640[7] = 0.0; - out_992849709061666640[8] = 0.0; - out_992849709061666640[9] = 0.0; - out_992849709061666640[10] = 1.0; - out_992849709061666640[11] = 0.0; - out_992849709061666640[12] = 0.0; - out_992849709061666640[13] = 0.0; - out_992849709061666640[14] = 0.0; - out_992849709061666640[15] = 0.0; - out_992849709061666640[16] = 0.0; - out_992849709061666640[17] = 0.0; - out_992849709061666640[18] = 0.0; - out_992849709061666640[19] = 0.0; - out_992849709061666640[20] = 1.0; - out_992849709061666640[21] = 0.0; - out_992849709061666640[22] = 0.0; - out_992849709061666640[23] = 0.0; - out_992849709061666640[24] = 0.0; - out_992849709061666640[25] = 0.0; - out_992849709061666640[26] = 0.0; - out_992849709061666640[27] = 0.0; - out_992849709061666640[28] = 0.0; - out_992849709061666640[29] = 0.0; - out_992849709061666640[30] = 1.0; - out_992849709061666640[31] = 0.0; - out_992849709061666640[32] = 0.0; - out_992849709061666640[33] = 0.0; - out_992849709061666640[34] = 0.0; - out_992849709061666640[35] = 0.0; - out_992849709061666640[36] = 0.0; - out_992849709061666640[37] = 0.0; - out_992849709061666640[38] = 0.0; - out_992849709061666640[39] = 0.0; - out_992849709061666640[40] = 1.0; - out_992849709061666640[41] = 0.0; - out_992849709061666640[42] = 0.0; - out_992849709061666640[43] = 0.0; - out_992849709061666640[44] = 0.0; - out_992849709061666640[45] = 0.0; - out_992849709061666640[46] = 0.0; - out_992849709061666640[47] = 0.0; - out_992849709061666640[48] = 0.0; - out_992849709061666640[49] = 0.0; - out_992849709061666640[50] = 1.0; - out_992849709061666640[51] = 0.0; - out_992849709061666640[52] = 0.0; - out_992849709061666640[53] = 0.0; - out_992849709061666640[54] = 0.0; - out_992849709061666640[55] = 0.0; - out_992849709061666640[56] = 0.0; - out_992849709061666640[57] = 0.0; - out_992849709061666640[58] = 0.0; - out_992849709061666640[59] = 0.0; - out_992849709061666640[60] = 1.0; - out_992849709061666640[61] = 0.0; - out_992849709061666640[62] = 0.0; - out_992849709061666640[63] = 0.0; - out_992849709061666640[64] = 0.0; - out_992849709061666640[65] = 0.0; - out_992849709061666640[66] = 0.0; - out_992849709061666640[67] = 0.0; - out_992849709061666640[68] = 0.0; - out_992849709061666640[69] = 0.0; - out_992849709061666640[70] = 1.0; - out_992849709061666640[71] = 0.0; - out_992849709061666640[72] = 0.0; - out_992849709061666640[73] = 0.0; - out_992849709061666640[74] = 0.0; - out_992849709061666640[75] = 0.0; - out_992849709061666640[76] = 0.0; - out_992849709061666640[77] = 0.0; - out_992849709061666640[78] = 0.0; - out_992849709061666640[79] = 0.0; - out_992849709061666640[80] = 1.0; +void H_mod_fun(double *state, double *out_6471050303960736584) { + out_6471050303960736584[0] = 1.0; + out_6471050303960736584[1] = 0.0; + out_6471050303960736584[2] = 0.0; + out_6471050303960736584[3] = 0.0; + out_6471050303960736584[4] = 0.0; + out_6471050303960736584[5] = 0.0; + out_6471050303960736584[6] = 0.0; + out_6471050303960736584[7] = 0.0; + out_6471050303960736584[8] = 0.0; + out_6471050303960736584[9] = 0.0; + out_6471050303960736584[10] = 1.0; + out_6471050303960736584[11] = 0.0; + out_6471050303960736584[12] = 0.0; + out_6471050303960736584[13] = 0.0; + out_6471050303960736584[14] = 0.0; + out_6471050303960736584[15] = 0.0; + out_6471050303960736584[16] = 0.0; + out_6471050303960736584[17] = 0.0; + out_6471050303960736584[18] = 0.0; + out_6471050303960736584[19] = 0.0; + out_6471050303960736584[20] = 1.0; + out_6471050303960736584[21] = 0.0; + out_6471050303960736584[22] = 0.0; + out_6471050303960736584[23] = 0.0; + out_6471050303960736584[24] = 0.0; + out_6471050303960736584[25] = 0.0; + out_6471050303960736584[26] = 0.0; + out_6471050303960736584[27] = 0.0; + out_6471050303960736584[28] = 0.0; + out_6471050303960736584[29] = 0.0; + out_6471050303960736584[30] = 1.0; + out_6471050303960736584[31] = 0.0; + out_6471050303960736584[32] = 0.0; + out_6471050303960736584[33] = 0.0; + out_6471050303960736584[34] = 0.0; + out_6471050303960736584[35] = 0.0; + out_6471050303960736584[36] = 0.0; + out_6471050303960736584[37] = 0.0; + out_6471050303960736584[38] = 0.0; + out_6471050303960736584[39] = 0.0; + out_6471050303960736584[40] = 1.0; + out_6471050303960736584[41] = 0.0; + out_6471050303960736584[42] = 0.0; + out_6471050303960736584[43] = 0.0; + out_6471050303960736584[44] = 0.0; + out_6471050303960736584[45] = 0.0; + out_6471050303960736584[46] = 0.0; + out_6471050303960736584[47] = 0.0; + out_6471050303960736584[48] = 0.0; + out_6471050303960736584[49] = 0.0; + out_6471050303960736584[50] = 1.0; + out_6471050303960736584[51] = 0.0; + out_6471050303960736584[52] = 0.0; + out_6471050303960736584[53] = 0.0; + out_6471050303960736584[54] = 0.0; + out_6471050303960736584[55] = 0.0; + out_6471050303960736584[56] = 0.0; + out_6471050303960736584[57] = 0.0; + out_6471050303960736584[58] = 0.0; + out_6471050303960736584[59] = 0.0; + out_6471050303960736584[60] = 1.0; + out_6471050303960736584[61] = 0.0; + out_6471050303960736584[62] = 0.0; + out_6471050303960736584[63] = 0.0; + out_6471050303960736584[64] = 0.0; + out_6471050303960736584[65] = 0.0; + out_6471050303960736584[66] = 0.0; + out_6471050303960736584[67] = 0.0; + out_6471050303960736584[68] = 0.0; + out_6471050303960736584[69] = 0.0; + out_6471050303960736584[70] = 1.0; + out_6471050303960736584[71] = 0.0; + out_6471050303960736584[72] = 0.0; + out_6471050303960736584[73] = 0.0; + out_6471050303960736584[74] = 0.0; + out_6471050303960736584[75] = 0.0; + out_6471050303960736584[76] = 0.0; + out_6471050303960736584[77] = 0.0; + out_6471050303960736584[78] = 0.0; + out_6471050303960736584[79] = 0.0; + out_6471050303960736584[80] = 1.0; } -void f_fun(double *state, double dt, double *out_7284810420003339157) { - out_7284810420003339157[0] = state[0]; - out_7284810420003339157[1] = state[1]; - out_7284810420003339157[2] = state[2]; - out_7284810420003339157[3] = state[3]; - out_7284810420003339157[4] = state[4]; - out_7284810420003339157[5] = dt*((-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]))*state[6] - 9.8100000000000005*state[8] + stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*state[1]) + (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*state[4])) + state[5]; - out_7284810420003339157[6] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*state[4])) + state[6]; - out_7284810420003339157[7] = state[7]; - out_7284810420003339157[8] = state[8]; +void f_fun(double *state, double dt, double *out_3688269730868187383) { + out_3688269730868187383[0] = state[0]; + out_3688269730868187383[1] = state[1]; + out_3688269730868187383[2] = state[2]; + out_3688269730868187383[3] = state[3]; + out_3688269730868187383[4] = state[4]; + out_3688269730868187383[5] = dt*((-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]))*state[6] - 9.8100000000000005*state[8] + stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*state[1]) + (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*state[4])) + state[5]; + out_3688269730868187383[6] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*state[4])) + state[6]; + out_3688269730868187383[7] = state[7]; + out_3688269730868187383[8] = state[8]; } -void F_fun(double *state, double dt, double *out_8279640069865100833) { - out_8279640069865100833[0] = 1; - out_8279640069865100833[1] = 0; - out_8279640069865100833[2] = 0; - out_8279640069865100833[3] = 0; - out_8279640069865100833[4] = 0; - out_8279640069865100833[5] = 0; - out_8279640069865100833[6] = 0; - out_8279640069865100833[7] = 0; - out_8279640069865100833[8] = 0; - out_8279640069865100833[9] = 0; - out_8279640069865100833[10] = 1; - out_8279640069865100833[11] = 0; - out_8279640069865100833[12] = 0; - out_8279640069865100833[13] = 0; - out_8279640069865100833[14] = 0; - out_8279640069865100833[15] = 0; - out_8279640069865100833[16] = 0; - out_8279640069865100833[17] = 0; - out_8279640069865100833[18] = 0; - out_8279640069865100833[19] = 0; - out_8279640069865100833[20] = 1; - out_8279640069865100833[21] = 0; - out_8279640069865100833[22] = 0; - out_8279640069865100833[23] = 0; - out_8279640069865100833[24] = 0; - out_8279640069865100833[25] = 0; - out_8279640069865100833[26] = 0; - out_8279640069865100833[27] = 0; - out_8279640069865100833[28] = 0; - out_8279640069865100833[29] = 0; - out_8279640069865100833[30] = 1; - out_8279640069865100833[31] = 0; - out_8279640069865100833[32] = 0; - out_8279640069865100833[33] = 0; - out_8279640069865100833[34] = 0; - out_8279640069865100833[35] = 0; - out_8279640069865100833[36] = 0; - out_8279640069865100833[37] = 0; - out_8279640069865100833[38] = 0; - out_8279640069865100833[39] = 0; - out_8279640069865100833[40] = 1; - out_8279640069865100833[41] = 0; - out_8279640069865100833[42] = 0; - out_8279640069865100833[43] = 0; - out_8279640069865100833[44] = 0; - out_8279640069865100833[45] = dt*(stiffness_front*(-state[2] - state[3] + state[7])/(mass*state[1]) + (-stiffness_front - stiffness_rear)*state[5]/(mass*state[4]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[6]/(mass*state[4])); - out_8279640069865100833[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); - out_8279640069865100833[47] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_8279640069865100833[48] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_8279640069865100833[49] = dt*((-1 - (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*pow(state[4], 2)))*state[6] - (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*pow(state[4], 2))); - out_8279640069865100833[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; - out_8279640069865100833[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); - out_8279640069865100833[52] = dt*stiffness_front*state[0]/(mass*state[1]); - out_8279640069865100833[53] = -9.8100000000000005*dt; - out_8279640069865100833[54] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front - pow(center_to_rear, 2)*stiffness_rear)*state[6]/(rotational_inertia*state[4])); - out_8279640069865100833[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); - out_8279640069865100833[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_8279640069865100833[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_8279640069865100833[58] = dt*(-(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*pow(state[4], 2)) - (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*pow(state[4], 2))); - out_8279640069865100833[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); - out_8279640069865100833[60] = dt*(-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])/(rotational_inertia*state[4]) + 1; - out_8279640069865100833[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_8279640069865100833[62] = 0; - out_8279640069865100833[63] = 0; - out_8279640069865100833[64] = 0; - out_8279640069865100833[65] = 0; - out_8279640069865100833[66] = 0; - out_8279640069865100833[67] = 0; - out_8279640069865100833[68] = 0; - out_8279640069865100833[69] = 0; - out_8279640069865100833[70] = 1; - out_8279640069865100833[71] = 0; - out_8279640069865100833[72] = 0; - out_8279640069865100833[73] = 0; - out_8279640069865100833[74] = 0; - out_8279640069865100833[75] = 0; - out_8279640069865100833[76] = 0; - out_8279640069865100833[77] = 0; - out_8279640069865100833[78] = 0; - out_8279640069865100833[79] = 0; - out_8279640069865100833[80] = 1; +void F_fun(double *state, double dt, double *out_9019266380936848145) { + out_9019266380936848145[0] = 1; + out_9019266380936848145[1] = 0; + out_9019266380936848145[2] = 0; + out_9019266380936848145[3] = 0; + out_9019266380936848145[4] = 0; + out_9019266380936848145[5] = 0; + out_9019266380936848145[6] = 0; + out_9019266380936848145[7] = 0; + out_9019266380936848145[8] = 0; + out_9019266380936848145[9] = 0; + out_9019266380936848145[10] = 1; + out_9019266380936848145[11] = 0; + out_9019266380936848145[12] = 0; + out_9019266380936848145[13] = 0; + out_9019266380936848145[14] = 0; + out_9019266380936848145[15] = 0; + out_9019266380936848145[16] = 0; + out_9019266380936848145[17] = 0; + out_9019266380936848145[18] = 0; + out_9019266380936848145[19] = 0; + out_9019266380936848145[20] = 1; + out_9019266380936848145[21] = 0; + out_9019266380936848145[22] = 0; + out_9019266380936848145[23] = 0; + out_9019266380936848145[24] = 0; + out_9019266380936848145[25] = 0; + out_9019266380936848145[26] = 0; + out_9019266380936848145[27] = 0; + out_9019266380936848145[28] = 0; + out_9019266380936848145[29] = 0; + out_9019266380936848145[30] = 1; + out_9019266380936848145[31] = 0; + out_9019266380936848145[32] = 0; + out_9019266380936848145[33] = 0; + out_9019266380936848145[34] = 0; + out_9019266380936848145[35] = 0; + out_9019266380936848145[36] = 0; + out_9019266380936848145[37] = 0; + out_9019266380936848145[38] = 0; + out_9019266380936848145[39] = 0; + out_9019266380936848145[40] = 1; + out_9019266380936848145[41] = 0; + out_9019266380936848145[42] = 0; + out_9019266380936848145[43] = 0; + out_9019266380936848145[44] = 0; + out_9019266380936848145[45] = dt*(stiffness_front*(-state[2] - state[3] + state[7])/(mass*state[1]) + (-stiffness_front - stiffness_rear)*state[5]/(mass*state[4]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[6]/(mass*state[4])); + out_9019266380936848145[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); + out_9019266380936848145[47] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_9019266380936848145[48] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_9019266380936848145[49] = dt*((-1 - (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*pow(state[4], 2)))*state[6] - (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*pow(state[4], 2))); + out_9019266380936848145[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; + out_9019266380936848145[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); + out_9019266380936848145[52] = dt*stiffness_front*state[0]/(mass*state[1]); + out_9019266380936848145[53] = -9.8100000000000005*dt; + out_9019266380936848145[54] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front - pow(center_to_rear, 2)*stiffness_rear)*state[6]/(rotational_inertia*state[4])); + out_9019266380936848145[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); + out_9019266380936848145[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_9019266380936848145[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_9019266380936848145[58] = dt*(-(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*pow(state[4], 2)) - (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*pow(state[4], 2))); + out_9019266380936848145[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); + out_9019266380936848145[60] = dt*(-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])/(rotational_inertia*state[4]) + 1; + out_9019266380936848145[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_9019266380936848145[62] = 0; + out_9019266380936848145[63] = 0; + out_9019266380936848145[64] = 0; + out_9019266380936848145[65] = 0; + out_9019266380936848145[66] = 0; + out_9019266380936848145[67] = 0; + out_9019266380936848145[68] = 0; + out_9019266380936848145[69] = 0; + out_9019266380936848145[70] = 1; + out_9019266380936848145[71] = 0; + out_9019266380936848145[72] = 0; + out_9019266380936848145[73] = 0; + out_9019266380936848145[74] = 0; + out_9019266380936848145[75] = 0; + out_9019266380936848145[76] = 0; + out_9019266380936848145[77] = 0; + out_9019266380936848145[78] = 0; + out_9019266380936848145[79] = 0; + out_9019266380936848145[80] = 1; } -void h_25(double *state, double *unused, double *out_8642135170742394965) { - out_8642135170742394965[0] = state[6]; +void h_25(double *state, double *unused, double *out_797744778366010140) { + out_797744778366010140[0] = state[6]; } -void H_25(double *state, double *unused, double *out_8200338516850570597) { - out_8200338516850570597[0] = 0; - out_8200338516850570597[1] = 0; - out_8200338516850570597[2] = 0; - out_8200338516850570597[3] = 0; - out_8200338516850570597[4] = 0; - out_8200338516850570597[5] = 0; - out_8200338516850570597[6] = 1; - out_8200338516850570597[7] = 0; - out_8200338516850570597[8] = 0; +void H_25(double *state, double *unused, double *out_1567358478776071744) { + out_1567358478776071744[0] = 0; + out_1567358478776071744[1] = 0; + out_1567358478776071744[2] = 0; + out_1567358478776071744[3] = 0; + out_1567358478776071744[4] = 0; + out_1567358478776071744[5] = 0; + out_1567358478776071744[6] = 1; + out_1567358478776071744[7] = 0; + out_1567358478776071744[8] = 0; } -void h_24(double *state, double *unused, double *out_9197263242363141624) { - out_9197263242363141624[0] = state[4]; - out_9197263242363141624[1] = state[5]; +void h_24(double *state, double *unused, double *out_190155790201239850) { + out_190155790201239850[0] = state[4]; + out_190155790201239850[1] = state[5]; } -void H_24(double *state, double *unused, double *out_1027726669218624628) { - out_1027726669218624628[0] = 0; - out_1027726669218624628[1] = 0; - out_1027726669218624628[2] = 0; - out_1027726669218624628[3] = 0; - out_1027726669218624628[4] = 1; - out_1027726669218624628[5] = 0; - out_1027726669218624628[6] = 0; - out_1027726669218624628[7] = 0; - out_1027726669218624628[8] = 0; - out_1027726669218624628[9] = 0; - out_1027726669218624628[10] = 0; - out_1027726669218624628[11] = 0; - out_1027726669218624628[12] = 0; - out_1027726669218624628[13] = 0; - out_1027726669218624628[14] = 1; - out_1027726669218624628[15] = 0; - out_1027726669218624628[16] = 0; - out_1027726669218624628[17] = 0; +void H_24(double *state, double *unused, double *out_5549681630173839642) { + out_5549681630173839642[0] = 0; + out_5549681630173839642[1] = 0; + out_5549681630173839642[2] = 0; + out_5549681630173839642[3] = 0; + out_5549681630173839642[4] = 1; + out_5549681630173839642[5] = 0; + out_5549681630173839642[6] = 0; + out_5549681630173839642[7] = 0; + out_5549681630173839642[8] = 0; + out_5549681630173839642[9] = 0; + out_5549681630173839642[10] = 0; + out_5549681630173839642[11] = 0; + out_5549681630173839642[12] = 0; + out_5549681630173839642[13] = 0; + out_5549681630173839642[14] = 1; + out_5549681630173839642[15] = 0; + out_5549681630173839642[16] = 0; + out_5549681630173839642[17] = 0; } -void h_30(double *state, double *unused, double *out_8720849294696219296) { - out_8720849294696219296[0] = state[4]; +void h_30(double *state, double *unused, double *out_8511282010659690294) { + out_8511282010659690294[0] = state[4]; } -void H_30(double *state, double *unused, double *out_5718709226731372821) { - out_5718709226731372821[0] = 0; - out_5718709226731372821[1] = 0; - out_5718709226731372821[2] = 0; - out_5718709226731372821[3] = 0; - out_5718709226731372821[4] = 1; - out_5718709226731372821[5] = 0; - out_5718709226731372821[6] = 0; - out_5718709226731372821[7] = 0; - out_5718709226731372821[8] = 0; +void H_30(double *state, double *unused, double *out_5349331862715545011) { + out_5349331862715545011[0] = 0; + out_5349331862715545011[1] = 0; + out_5349331862715545011[2] = 0; + out_5349331862715545011[3] = 0; + out_5349331862715545011[4] = 1; + out_5349331862715545011[5] = 0; + out_5349331862715545011[6] = 0; + out_5349331862715545011[7] = 0; + out_5349331862715545011[8] = 0; } -void h_26(double *state, double *unused, double *out_4724221511352486675) { - out_4724221511352486675[0] = state[7]; +void h_26(double *state, double *unused, double *out_5186767263433807506) { + out_5186767263433807506[0] = state[7]; } -void H_26(double *state, double *unused, double *out_6504902237984924795) { - out_6504902237984924795[0] = 0; - out_6504902237984924795[1] = 0; - out_6504902237984924795[2] = 0; - out_6504902237984924795[3] = 0; - out_6504902237984924795[4] = 0; - out_6504902237984924795[5] = 0; - out_6504902237984924795[6] = 0; - out_6504902237984924795[7] = 1; - out_6504902237984924795[8] = 0; +void H_26(double *state, double *unused, double *out_1737167490984728857) { + out_1737167490984728857[0] = 0; + out_1737167490984728857[1] = 0; + out_1737167490984728857[2] = 0; + out_1737167490984728857[3] = 0; + out_1737167490984728857[4] = 0; + out_1737167490984728857[5] = 0; + out_1737167490984728857[6] = 0; + out_1737167490984728857[7] = 1; + out_1737167490984728857[8] = 0; } -void h_27(double *state, double *unused, double *out_2893523921247530795) { - out_2893523921247530795[0] = state[3]; +void h_27(double *state, double *unused, double *out_3402150099174707791) { + out_3402150099174707791[0] = state[3]; } -void H_27(double *state, double *unused, double *out_7942303297915316038) { - out_7942303297915316038[0] = 0; - out_7942303297915316038[1] = 0; - out_7942303297915316038[2] = 0; - out_7942303297915316038[3] = 1; - out_7942303297915316038[4] = 0; - out_7942303297915316038[5] = 0; - out_7942303297915316038[6] = 0; - out_7942303297915316038[7] = 0; - out_7942303297915316038[8] = 0; +void H_27(double *state, double *unused, double *out_3174568550915120100) { + out_3174568550915120100[0] = 0; + out_3174568550915120100[1] = 0; + out_3174568550915120100[2] = 0; + out_3174568550915120100[3] = 1; + out_3174568550915120100[4] = 0; + out_3174568550915120100[5] = 0; + out_3174568550915120100[6] = 0; + out_3174568550915120100[7] = 0; + out_3174568550915120100[8] = 0; } -void h_29(double *state, double *unused, double *out_2618329858963024906) { - out_2618329858963024906[0] = state[1]; +void h_29(double *state, double *unused, double *out_2753297096665952338) { + out_2753297096665952338[0] = state[1]; } -void H_29(double *state, double *unused, double *out_6228940571045765005) { - out_6228940571045765005[0] = 0; - out_6228940571045765005[1] = 1; - out_6228940571045765005[2] = 0; - out_6228940571045765005[3] = 0; - out_6228940571045765005[4] = 0; - out_6228940571045765005[5] = 0; - out_6228940571045765005[6] = 0; - out_6228940571045765005[7] = 0; - out_6228940571045765005[8] = 0; +void H_29(double *state, double *unused, double *out_5859563207029937195) { + out_5859563207029937195[0] = 0; + out_5859563207029937195[1] = 1; + out_5859563207029937195[2] = 0; + out_5859563207029937195[3] = 0; + out_5859563207029937195[4] = 0; + out_5859563207029937195[5] = 0; + out_5859563207029937195[6] = 0; + out_5859563207029937195[7] = 0; + out_5859563207029937195[8] = 0; } -void h_28(double *state, double *unused, double *out_8550457448668955042) { - out_8550457448668955042[0] = state[0]; +void h_28(double *state, double *unused, double *out_6022818472511333083) { + out_6022818472511333083[0] = state[0]; } -void H_28(double *state, double *unused, double *out_1146541553976234431) { - out_1146541553976234431[0] = 1; - out_1146541553976234431[1] = 0; - out_1146541553976234431[2] = 0; - out_1146541553976234431[3] = 0; - out_1146541553976234431[4] = 0; - out_1146541553976234431[5] = 0; - out_1146541553976234431[6] = 0; - out_1146541553976234431[7] = 0; - out_1146541553976234431[8] = 0; +void H_28(double *state, double *unused, double *out_3621193193023961507) { + out_3621193193023961507[0] = 1; + out_3621193193023961507[1] = 0; + out_3621193193023961507[2] = 0; + out_3621193193023961507[3] = 0; + out_3621193193023961507[4] = 0; + out_3621193193023961507[5] = 0; + out_3621193193023961507[6] = 0; + out_3621193193023961507[7] = 0; + out_3621193193023961507[8] = 0; } -void h_31(double *state, double *unused, double *out_7603820894445690215) { - out_7603820894445690215[0] = state[8]; +void h_31(double *state, double *unused, double *out_8679017429120059325) { + out_8679017429120059325[0] = state[8]; } -void H_31(double *state, double *unused, double *out_8169692554973610169) { - out_8169692554973610169[0] = 0; - out_8169692554973610169[1] = 0; - out_8169692554973610169[2] = 0; - out_8169692554973610169[3] = 0; - out_8169692554973610169[4] = 0; - out_8169692554973610169[5] = 0; - out_8169692554973610169[6] = 0; - out_8169692554973610169[7] = 0; - out_8169692554973610169[8] = 1; +void H_31(double *state, double *unused, double *out_5509316771735745509) { + out_5509316771735745509[0] = 0; + out_5509316771735745509[1] = 0; + out_5509316771735745509[2] = 0; + out_5509316771735745509[3] = 0; + out_5509316771735745509[4] = 0; + out_5509316771735745509[5] = 0; + out_5509316771735745509[6] = 0; + out_5509316771735745509[7] = 0; + out_5509316771735745509[8] = 1; } #include #include @@ -518,68 +518,68 @@ void car_update_28(double *in_x, double *in_P, double *in_z, double *in_R, doubl void car_update_31(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea) { update<1, 3, 0>(in_x, in_P, h_31, H_31, NULL, in_z, in_R, in_ea, MAHA_THRESH_31); } -void car_err_fun(double *nom_x, double *delta_x, double *out_1014334527327209848) { - err_fun(nom_x, delta_x, out_1014334527327209848); +void car_err_fun(double *nom_x, double *delta_x, double *out_2633990546043802948) { + err_fun(nom_x, delta_x, out_2633990546043802948); } -void car_inv_err_fun(double *nom_x, double *true_x, double *out_3206419511188405682) { - inv_err_fun(nom_x, true_x, out_3206419511188405682); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_1648181344021920920) { + inv_err_fun(nom_x, true_x, out_1648181344021920920); } -void car_H_mod_fun(double *state, double *out_992849709061666640) { - H_mod_fun(state, out_992849709061666640); +void car_H_mod_fun(double *state, double *out_6471050303960736584) { + H_mod_fun(state, out_6471050303960736584); } -void car_f_fun(double *state, double dt, double *out_7284810420003339157) { - f_fun(state, dt, out_7284810420003339157); +void car_f_fun(double *state, double dt, double *out_3688269730868187383) { + f_fun(state, dt, out_3688269730868187383); } -void car_F_fun(double *state, double dt, double *out_8279640069865100833) { - F_fun(state, dt, out_8279640069865100833); +void car_F_fun(double *state, double dt, double *out_9019266380936848145) { + F_fun(state, dt, out_9019266380936848145); } -void car_h_25(double *state, double *unused, double *out_8642135170742394965) { - h_25(state, unused, out_8642135170742394965); +void car_h_25(double *state, double *unused, double *out_797744778366010140) { + h_25(state, unused, out_797744778366010140); } -void car_H_25(double *state, double *unused, double *out_8200338516850570597) { - H_25(state, unused, out_8200338516850570597); +void car_H_25(double *state, double *unused, double *out_1567358478776071744) { + H_25(state, unused, out_1567358478776071744); } -void car_h_24(double *state, double *unused, double *out_9197263242363141624) { - h_24(state, unused, out_9197263242363141624); +void car_h_24(double *state, double *unused, double *out_190155790201239850) { + h_24(state, unused, out_190155790201239850); } -void car_H_24(double *state, double *unused, double *out_1027726669218624628) { - H_24(state, unused, out_1027726669218624628); +void car_H_24(double *state, double *unused, double *out_5549681630173839642) { + H_24(state, unused, out_5549681630173839642); } -void car_h_30(double *state, double *unused, double *out_8720849294696219296) { - h_30(state, unused, out_8720849294696219296); +void car_h_30(double *state, double *unused, double *out_8511282010659690294) { + h_30(state, unused, out_8511282010659690294); } -void car_H_30(double *state, double *unused, double *out_5718709226731372821) { - H_30(state, unused, out_5718709226731372821); +void car_H_30(double *state, double *unused, double *out_5349331862715545011) { + H_30(state, unused, out_5349331862715545011); } -void car_h_26(double *state, double *unused, double *out_4724221511352486675) { - h_26(state, unused, out_4724221511352486675); +void car_h_26(double *state, double *unused, double *out_5186767263433807506) { + h_26(state, unused, out_5186767263433807506); } -void car_H_26(double *state, double *unused, double *out_6504902237984924795) { - H_26(state, unused, out_6504902237984924795); +void car_H_26(double *state, double *unused, double *out_1737167490984728857) { + H_26(state, unused, out_1737167490984728857); } -void car_h_27(double *state, double *unused, double *out_2893523921247530795) { - h_27(state, unused, out_2893523921247530795); +void car_h_27(double *state, double *unused, double *out_3402150099174707791) { + h_27(state, unused, out_3402150099174707791); } -void car_H_27(double *state, double *unused, double *out_7942303297915316038) { - H_27(state, unused, out_7942303297915316038); +void car_H_27(double *state, double *unused, double *out_3174568550915120100) { + H_27(state, unused, out_3174568550915120100); } -void car_h_29(double *state, double *unused, double *out_2618329858963024906) { - h_29(state, unused, out_2618329858963024906); +void car_h_29(double *state, double *unused, double *out_2753297096665952338) { + h_29(state, unused, out_2753297096665952338); } -void car_H_29(double *state, double *unused, double *out_6228940571045765005) { - H_29(state, unused, out_6228940571045765005); +void car_H_29(double *state, double *unused, double *out_5859563207029937195) { + H_29(state, unused, out_5859563207029937195); } -void car_h_28(double *state, double *unused, double *out_8550457448668955042) { - h_28(state, unused, out_8550457448668955042); +void car_h_28(double *state, double *unused, double *out_6022818472511333083) { + h_28(state, unused, out_6022818472511333083); } -void car_H_28(double *state, double *unused, double *out_1146541553976234431) { - H_28(state, unused, out_1146541553976234431); +void car_H_28(double *state, double *unused, double *out_3621193193023961507) { + H_28(state, unused, out_3621193193023961507); } -void car_h_31(double *state, double *unused, double *out_7603820894445690215) { - h_31(state, unused, out_7603820894445690215); +void car_h_31(double *state, double *unused, double *out_8679017429120059325) { + h_31(state, unused, out_8679017429120059325); } -void car_H_31(double *state, double *unused, double *out_8169692554973610169) { - H_31(state, unused, out_8169692554973610169); +void car_H_31(double *state, double *unused, double *out_5509316771735745509) { + H_31(state, unused, out_5509316771735745509); } 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/openpilot/selfdrive/locationd/models/generated/car.h b/openpilot/selfdrive/locationd/models/generated/car.h index a5c58382bc..5fed943d99 100644 --- a/openpilot/selfdrive/locationd/models/generated/car.h +++ b/openpilot/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_1014334527327209848); -void car_inv_err_fun(double *nom_x, double *true_x, double *out_3206419511188405682); -void car_H_mod_fun(double *state, double *out_992849709061666640); -void car_f_fun(double *state, double dt, double *out_7284810420003339157); -void car_F_fun(double *state, double dt, double *out_8279640069865100833); -void car_h_25(double *state, double *unused, double *out_8642135170742394965); -void car_H_25(double *state, double *unused, double *out_8200338516850570597); -void car_h_24(double *state, double *unused, double *out_9197263242363141624); -void car_H_24(double *state, double *unused, double *out_1027726669218624628); -void car_h_30(double *state, double *unused, double *out_8720849294696219296); -void car_H_30(double *state, double *unused, double *out_5718709226731372821); -void car_h_26(double *state, double *unused, double *out_4724221511352486675); -void car_H_26(double *state, double *unused, double *out_6504902237984924795); -void car_h_27(double *state, double *unused, double *out_2893523921247530795); -void car_H_27(double *state, double *unused, double *out_7942303297915316038); -void car_h_29(double *state, double *unused, double *out_2618329858963024906); -void car_H_29(double *state, double *unused, double *out_6228940571045765005); -void car_h_28(double *state, double *unused, double *out_8550457448668955042); -void car_H_28(double *state, double *unused, double *out_1146541553976234431); -void car_h_31(double *state, double *unused, double *out_7603820894445690215); -void car_H_31(double *state, double *unused, double *out_8169692554973610169); +void car_err_fun(double *nom_x, double *delta_x, double *out_2633990546043802948); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_1648181344021920920); +void car_H_mod_fun(double *state, double *out_6471050303960736584); +void car_f_fun(double *state, double dt, double *out_3688269730868187383); +void car_F_fun(double *state, double dt, double *out_9019266380936848145); +void car_h_25(double *state, double *unused, double *out_797744778366010140); +void car_H_25(double *state, double *unused, double *out_1567358478776071744); +void car_h_24(double *state, double *unused, double *out_190155790201239850); +void car_H_24(double *state, double *unused, double *out_5549681630173839642); +void car_h_30(double *state, double *unused, double *out_8511282010659690294); +void car_H_30(double *state, double *unused, double *out_5349331862715545011); +void car_h_26(double *state, double *unused, double *out_5186767263433807506); +void car_H_26(double *state, double *unused, double *out_1737167490984728857); +void car_h_27(double *state, double *unused, double *out_3402150099174707791); +void car_H_27(double *state, double *unused, double *out_3174568550915120100); +void car_h_29(double *state, double *unused, double *out_2753297096665952338); +void car_H_29(double *state, double *unused, double *out_5859563207029937195); +void car_h_28(double *state, double *unused, double *out_6022818472511333083); +void car_H_28(double *state, double *unused, double *out_3621193193023961507); +void car_h_31(double *state, double *unused, double *out_8679017429120059325); +void car_H_31(double *state, double *unused, double *out_5509316771735745509); 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/openpilot/selfdrive/locationd/models/generated/libcar.so b/openpilot/selfdrive/locationd/models/generated/libcar.so index 4a8a78eb46..4233fb3c77 100755 Binary files a/openpilot/selfdrive/locationd/models/generated/libcar.so and b/openpilot/selfdrive/locationd/models/generated/libcar.so differ diff --git a/openpilot/selfdrive/locationd/models/generated/libpose.so b/openpilot/selfdrive/locationd/models/generated/libpose.so index f34d88d1ae..62d12cec94 100755 Binary files a/openpilot/selfdrive/locationd/models/generated/libpose.so and b/openpilot/selfdrive/locationd/models/generated/libpose.so differ diff --git a/openpilot/selfdrive/locationd/models/generated/pose.cpp b/openpilot/selfdrive/locationd/models/generated/pose.cpp index d4db047681..5c229af101 100644 --- a/openpilot/selfdrive/locationd/models/generated/pose.cpp +++ b/openpilot/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_5912021845748559900) { - out_5912021845748559900[0] = delta_x[0] + nom_x[0]; - out_5912021845748559900[1] = delta_x[1] + nom_x[1]; - out_5912021845748559900[2] = delta_x[2] + nom_x[2]; - out_5912021845748559900[3] = delta_x[3] + nom_x[3]; - out_5912021845748559900[4] = delta_x[4] + nom_x[4]; - out_5912021845748559900[5] = delta_x[5] + nom_x[5]; - out_5912021845748559900[6] = delta_x[6] + nom_x[6]; - out_5912021845748559900[7] = delta_x[7] + nom_x[7]; - out_5912021845748559900[8] = delta_x[8] + nom_x[8]; - out_5912021845748559900[9] = delta_x[9] + nom_x[9]; - out_5912021845748559900[10] = delta_x[10] + nom_x[10]; - out_5912021845748559900[11] = delta_x[11] + nom_x[11]; - out_5912021845748559900[12] = delta_x[12] + nom_x[12]; - out_5912021845748559900[13] = delta_x[13] + nom_x[13]; - out_5912021845748559900[14] = delta_x[14] + nom_x[14]; - out_5912021845748559900[15] = delta_x[15] + nom_x[15]; - out_5912021845748559900[16] = delta_x[16] + nom_x[16]; - out_5912021845748559900[17] = delta_x[17] + nom_x[17]; +void err_fun(double *nom_x, double *delta_x, double *out_2521549048397866319) { + out_2521549048397866319[0] = delta_x[0] + nom_x[0]; + out_2521549048397866319[1] = delta_x[1] + nom_x[1]; + out_2521549048397866319[2] = delta_x[2] + nom_x[2]; + out_2521549048397866319[3] = delta_x[3] + nom_x[3]; + out_2521549048397866319[4] = delta_x[4] + nom_x[4]; + out_2521549048397866319[5] = delta_x[5] + nom_x[5]; + out_2521549048397866319[6] = delta_x[6] + nom_x[6]; + out_2521549048397866319[7] = delta_x[7] + nom_x[7]; + out_2521549048397866319[8] = delta_x[8] + nom_x[8]; + out_2521549048397866319[9] = delta_x[9] + nom_x[9]; + out_2521549048397866319[10] = delta_x[10] + nom_x[10]; + out_2521549048397866319[11] = delta_x[11] + nom_x[11]; + out_2521549048397866319[12] = delta_x[12] + nom_x[12]; + out_2521549048397866319[13] = delta_x[13] + nom_x[13]; + out_2521549048397866319[14] = delta_x[14] + nom_x[14]; + out_2521549048397866319[15] = delta_x[15] + nom_x[15]; + out_2521549048397866319[16] = delta_x[16] + nom_x[16]; + out_2521549048397866319[17] = delta_x[17] + nom_x[17]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_8843896357291937735) { - out_8843896357291937735[0] = -nom_x[0] + true_x[0]; - out_8843896357291937735[1] = -nom_x[1] + true_x[1]; - out_8843896357291937735[2] = -nom_x[2] + true_x[2]; - out_8843896357291937735[3] = -nom_x[3] + true_x[3]; - out_8843896357291937735[4] = -nom_x[4] + true_x[4]; - out_8843896357291937735[5] = -nom_x[5] + true_x[5]; - out_8843896357291937735[6] = -nom_x[6] + true_x[6]; - out_8843896357291937735[7] = -nom_x[7] + true_x[7]; - out_8843896357291937735[8] = -nom_x[8] + true_x[8]; - out_8843896357291937735[9] = -nom_x[9] + true_x[9]; - out_8843896357291937735[10] = -nom_x[10] + true_x[10]; - out_8843896357291937735[11] = -nom_x[11] + true_x[11]; - out_8843896357291937735[12] = -nom_x[12] + true_x[12]; - out_8843896357291937735[13] = -nom_x[13] + true_x[13]; - out_8843896357291937735[14] = -nom_x[14] + true_x[14]; - out_8843896357291937735[15] = -nom_x[15] + true_x[15]; - out_8843896357291937735[16] = -nom_x[16] + true_x[16]; - out_8843896357291937735[17] = -nom_x[17] + true_x[17]; +void inv_err_fun(double *nom_x, double *true_x, double *out_4368796387448451064) { + out_4368796387448451064[0] = -nom_x[0] + true_x[0]; + out_4368796387448451064[1] = -nom_x[1] + true_x[1]; + out_4368796387448451064[2] = -nom_x[2] + true_x[2]; + out_4368796387448451064[3] = -nom_x[3] + true_x[3]; + out_4368796387448451064[4] = -nom_x[4] + true_x[4]; + out_4368796387448451064[5] = -nom_x[5] + true_x[5]; + out_4368796387448451064[6] = -nom_x[6] + true_x[6]; + out_4368796387448451064[7] = -nom_x[7] + true_x[7]; + out_4368796387448451064[8] = -nom_x[8] + true_x[8]; + out_4368796387448451064[9] = -nom_x[9] + true_x[9]; + out_4368796387448451064[10] = -nom_x[10] + true_x[10]; + out_4368796387448451064[11] = -nom_x[11] + true_x[11]; + out_4368796387448451064[12] = -nom_x[12] + true_x[12]; + out_4368796387448451064[13] = -nom_x[13] + true_x[13]; + out_4368796387448451064[14] = -nom_x[14] + true_x[14]; + out_4368796387448451064[15] = -nom_x[15] + true_x[15]; + out_4368796387448451064[16] = -nom_x[16] + true_x[16]; + out_4368796387448451064[17] = -nom_x[17] + true_x[17]; } -void H_mod_fun(double *state, double *out_2688320196777535589) { - out_2688320196777535589[0] = 1.0; - out_2688320196777535589[1] = 0.0; - out_2688320196777535589[2] = 0.0; - out_2688320196777535589[3] = 0.0; - out_2688320196777535589[4] = 0.0; - out_2688320196777535589[5] = 0.0; - out_2688320196777535589[6] = 0.0; - out_2688320196777535589[7] = 0.0; - out_2688320196777535589[8] = 0.0; - out_2688320196777535589[9] = 0.0; - out_2688320196777535589[10] = 0.0; - out_2688320196777535589[11] = 0.0; - out_2688320196777535589[12] = 0.0; - out_2688320196777535589[13] = 0.0; - out_2688320196777535589[14] = 0.0; - out_2688320196777535589[15] = 0.0; - out_2688320196777535589[16] = 0.0; - out_2688320196777535589[17] = 0.0; - out_2688320196777535589[18] = 0.0; - out_2688320196777535589[19] = 1.0; - out_2688320196777535589[20] = 0.0; - out_2688320196777535589[21] = 0.0; - out_2688320196777535589[22] = 0.0; - out_2688320196777535589[23] = 0.0; - out_2688320196777535589[24] = 0.0; - out_2688320196777535589[25] = 0.0; - out_2688320196777535589[26] = 0.0; - out_2688320196777535589[27] = 0.0; - out_2688320196777535589[28] = 0.0; - out_2688320196777535589[29] = 0.0; - out_2688320196777535589[30] = 0.0; - out_2688320196777535589[31] = 0.0; - out_2688320196777535589[32] = 0.0; - out_2688320196777535589[33] = 0.0; - out_2688320196777535589[34] = 0.0; - out_2688320196777535589[35] = 0.0; - out_2688320196777535589[36] = 0.0; - out_2688320196777535589[37] = 0.0; - out_2688320196777535589[38] = 1.0; - out_2688320196777535589[39] = 0.0; - out_2688320196777535589[40] = 0.0; - out_2688320196777535589[41] = 0.0; - out_2688320196777535589[42] = 0.0; - out_2688320196777535589[43] = 0.0; - out_2688320196777535589[44] = 0.0; - out_2688320196777535589[45] = 0.0; - out_2688320196777535589[46] = 0.0; - out_2688320196777535589[47] = 0.0; - out_2688320196777535589[48] = 0.0; - out_2688320196777535589[49] = 0.0; - out_2688320196777535589[50] = 0.0; - out_2688320196777535589[51] = 0.0; - out_2688320196777535589[52] = 0.0; - out_2688320196777535589[53] = 0.0; - out_2688320196777535589[54] = 0.0; - out_2688320196777535589[55] = 0.0; - out_2688320196777535589[56] = 0.0; - out_2688320196777535589[57] = 1.0; - out_2688320196777535589[58] = 0.0; - out_2688320196777535589[59] = 0.0; - out_2688320196777535589[60] = 0.0; - out_2688320196777535589[61] = 0.0; - out_2688320196777535589[62] = 0.0; - out_2688320196777535589[63] = 0.0; - out_2688320196777535589[64] = 0.0; - out_2688320196777535589[65] = 0.0; - out_2688320196777535589[66] = 0.0; - out_2688320196777535589[67] = 0.0; - out_2688320196777535589[68] = 0.0; - out_2688320196777535589[69] = 0.0; - out_2688320196777535589[70] = 0.0; - out_2688320196777535589[71] = 0.0; - out_2688320196777535589[72] = 0.0; - out_2688320196777535589[73] = 0.0; - out_2688320196777535589[74] = 0.0; - out_2688320196777535589[75] = 0.0; - out_2688320196777535589[76] = 1.0; - out_2688320196777535589[77] = 0.0; - out_2688320196777535589[78] = 0.0; - out_2688320196777535589[79] = 0.0; - out_2688320196777535589[80] = 0.0; - out_2688320196777535589[81] = 0.0; - out_2688320196777535589[82] = 0.0; - out_2688320196777535589[83] = 0.0; - out_2688320196777535589[84] = 0.0; - out_2688320196777535589[85] = 0.0; - out_2688320196777535589[86] = 0.0; - out_2688320196777535589[87] = 0.0; - out_2688320196777535589[88] = 0.0; - out_2688320196777535589[89] = 0.0; - out_2688320196777535589[90] = 0.0; - out_2688320196777535589[91] = 0.0; - out_2688320196777535589[92] = 0.0; - out_2688320196777535589[93] = 0.0; - out_2688320196777535589[94] = 0.0; - out_2688320196777535589[95] = 1.0; - out_2688320196777535589[96] = 0.0; - out_2688320196777535589[97] = 0.0; - out_2688320196777535589[98] = 0.0; - out_2688320196777535589[99] = 0.0; - out_2688320196777535589[100] = 0.0; - out_2688320196777535589[101] = 0.0; - out_2688320196777535589[102] = 0.0; - out_2688320196777535589[103] = 0.0; - out_2688320196777535589[104] = 0.0; - out_2688320196777535589[105] = 0.0; - out_2688320196777535589[106] = 0.0; - out_2688320196777535589[107] = 0.0; - out_2688320196777535589[108] = 0.0; - out_2688320196777535589[109] = 0.0; - out_2688320196777535589[110] = 0.0; - out_2688320196777535589[111] = 0.0; - out_2688320196777535589[112] = 0.0; - out_2688320196777535589[113] = 0.0; - out_2688320196777535589[114] = 1.0; - out_2688320196777535589[115] = 0.0; - out_2688320196777535589[116] = 0.0; - out_2688320196777535589[117] = 0.0; - out_2688320196777535589[118] = 0.0; - out_2688320196777535589[119] = 0.0; - out_2688320196777535589[120] = 0.0; - out_2688320196777535589[121] = 0.0; - out_2688320196777535589[122] = 0.0; - out_2688320196777535589[123] = 0.0; - out_2688320196777535589[124] = 0.0; - out_2688320196777535589[125] = 0.0; - out_2688320196777535589[126] = 0.0; - out_2688320196777535589[127] = 0.0; - out_2688320196777535589[128] = 0.0; - out_2688320196777535589[129] = 0.0; - out_2688320196777535589[130] = 0.0; - out_2688320196777535589[131] = 0.0; - out_2688320196777535589[132] = 0.0; - out_2688320196777535589[133] = 1.0; - out_2688320196777535589[134] = 0.0; - out_2688320196777535589[135] = 0.0; - out_2688320196777535589[136] = 0.0; - out_2688320196777535589[137] = 0.0; - out_2688320196777535589[138] = 0.0; - out_2688320196777535589[139] = 0.0; - out_2688320196777535589[140] = 0.0; - out_2688320196777535589[141] = 0.0; - out_2688320196777535589[142] = 0.0; - out_2688320196777535589[143] = 0.0; - out_2688320196777535589[144] = 0.0; - out_2688320196777535589[145] = 0.0; - out_2688320196777535589[146] = 0.0; - out_2688320196777535589[147] = 0.0; - out_2688320196777535589[148] = 0.0; - out_2688320196777535589[149] = 0.0; - out_2688320196777535589[150] = 0.0; - out_2688320196777535589[151] = 0.0; - out_2688320196777535589[152] = 1.0; - out_2688320196777535589[153] = 0.0; - out_2688320196777535589[154] = 0.0; - out_2688320196777535589[155] = 0.0; - out_2688320196777535589[156] = 0.0; - out_2688320196777535589[157] = 0.0; - out_2688320196777535589[158] = 0.0; - out_2688320196777535589[159] = 0.0; - out_2688320196777535589[160] = 0.0; - out_2688320196777535589[161] = 0.0; - out_2688320196777535589[162] = 0.0; - out_2688320196777535589[163] = 0.0; - out_2688320196777535589[164] = 0.0; - out_2688320196777535589[165] = 0.0; - out_2688320196777535589[166] = 0.0; - out_2688320196777535589[167] = 0.0; - out_2688320196777535589[168] = 0.0; - out_2688320196777535589[169] = 0.0; - out_2688320196777535589[170] = 0.0; - out_2688320196777535589[171] = 1.0; - out_2688320196777535589[172] = 0.0; - out_2688320196777535589[173] = 0.0; - out_2688320196777535589[174] = 0.0; - out_2688320196777535589[175] = 0.0; - out_2688320196777535589[176] = 0.0; - out_2688320196777535589[177] = 0.0; - out_2688320196777535589[178] = 0.0; - out_2688320196777535589[179] = 0.0; - out_2688320196777535589[180] = 0.0; - out_2688320196777535589[181] = 0.0; - out_2688320196777535589[182] = 0.0; - out_2688320196777535589[183] = 0.0; - out_2688320196777535589[184] = 0.0; - out_2688320196777535589[185] = 0.0; - out_2688320196777535589[186] = 0.0; - out_2688320196777535589[187] = 0.0; - out_2688320196777535589[188] = 0.0; - out_2688320196777535589[189] = 0.0; - out_2688320196777535589[190] = 1.0; - out_2688320196777535589[191] = 0.0; - out_2688320196777535589[192] = 0.0; - out_2688320196777535589[193] = 0.0; - out_2688320196777535589[194] = 0.0; - out_2688320196777535589[195] = 0.0; - out_2688320196777535589[196] = 0.0; - out_2688320196777535589[197] = 0.0; - out_2688320196777535589[198] = 0.0; - out_2688320196777535589[199] = 0.0; - out_2688320196777535589[200] = 0.0; - out_2688320196777535589[201] = 0.0; - out_2688320196777535589[202] = 0.0; - out_2688320196777535589[203] = 0.0; - out_2688320196777535589[204] = 0.0; - out_2688320196777535589[205] = 0.0; - out_2688320196777535589[206] = 0.0; - out_2688320196777535589[207] = 0.0; - out_2688320196777535589[208] = 0.0; - out_2688320196777535589[209] = 1.0; - out_2688320196777535589[210] = 0.0; - out_2688320196777535589[211] = 0.0; - out_2688320196777535589[212] = 0.0; - out_2688320196777535589[213] = 0.0; - out_2688320196777535589[214] = 0.0; - out_2688320196777535589[215] = 0.0; - out_2688320196777535589[216] = 0.0; - out_2688320196777535589[217] = 0.0; - out_2688320196777535589[218] = 0.0; - out_2688320196777535589[219] = 0.0; - out_2688320196777535589[220] = 0.0; - out_2688320196777535589[221] = 0.0; - out_2688320196777535589[222] = 0.0; - out_2688320196777535589[223] = 0.0; - out_2688320196777535589[224] = 0.0; - out_2688320196777535589[225] = 0.0; - out_2688320196777535589[226] = 0.0; - out_2688320196777535589[227] = 0.0; - out_2688320196777535589[228] = 1.0; - out_2688320196777535589[229] = 0.0; - out_2688320196777535589[230] = 0.0; - out_2688320196777535589[231] = 0.0; - out_2688320196777535589[232] = 0.0; - out_2688320196777535589[233] = 0.0; - out_2688320196777535589[234] = 0.0; - out_2688320196777535589[235] = 0.0; - out_2688320196777535589[236] = 0.0; - out_2688320196777535589[237] = 0.0; - out_2688320196777535589[238] = 0.0; - out_2688320196777535589[239] = 0.0; - out_2688320196777535589[240] = 0.0; - out_2688320196777535589[241] = 0.0; - out_2688320196777535589[242] = 0.0; - out_2688320196777535589[243] = 0.0; - out_2688320196777535589[244] = 0.0; - out_2688320196777535589[245] = 0.0; - out_2688320196777535589[246] = 0.0; - out_2688320196777535589[247] = 1.0; - out_2688320196777535589[248] = 0.0; - out_2688320196777535589[249] = 0.0; - out_2688320196777535589[250] = 0.0; - out_2688320196777535589[251] = 0.0; - out_2688320196777535589[252] = 0.0; - out_2688320196777535589[253] = 0.0; - out_2688320196777535589[254] = 0.0; - out_2688320196777535589[255] = 0.0; - out_2688320196777535589[256] = 0.0; - out_2688320196777535589[257] = 0.0; - out_2688320196777535589[258] = 0.0; - out_2688320196777535589[259] = 0.0; - out_2688320196777535589[260] = 0.0; - out_2688320196777535589[261] = 0.0; - out_2688320196777535589[262] = 0.0; - out_2688320196777535589[263] = 0.0; - out_2688320196777535589[264] = 0.0; - out_2688320196777535589[265] = 0.0; - out_2688320196777535589[266] = 1.0; - out_2688320196777535589[267] = 0.0; - out_2688320196777535589[268] = 0.0; - out_2688320196777535589[269] = 0.0; - out_2688320196777535589[270] = 0.0; - out_2688320196777535589[271] = 0.0; - out_2688320196777535589[272] = 0.0; - out_2688320196777535589[273] = 0.0; - out_2688320196777535589[274] = 0.0; - out_2688320196777535589[275] = 0.0; - out_2688320196777535589[276] = 0.0; - out_2688320196777535589[277] = 0.0; - out_2688320196777535589[278] = 0.0; - out_2688320196777535589[279] = 0.0; - out_2688320196777535589[280] = 0.0; - out_2688320196777535589[281] = 0.0; - out_2688320196777535589[282] = 0.0; - out_2688320196777535589[283] = 0.0; - out_2688320196777535589[284] = 0.0; - out_2688320196777535589[285] = 1.0; - out_2688320196777535589[286] = 0.0; - out_2688320196777535589[287] = 0.0; - out_2688320196777535589[288] = 0.0; - out_2688320196777535589[289] = 0.0; - out_2688320196777535589[290] = 0.0; - out_2688320196777535589[291] = 0.0; - out_2688320196777535589[292] = 0.0; - out_2688320196777535589[293] = 0.0; - out_2688320196777535589[294] = 0.0; - out_2688320196777535589[295] = 0.0; - out_2688320196777535589[296] = 0.0; - out_2688320196777535589[297] = 0.0; - out_2688320196777535589[298] = 0.0; - out_2688320196777535589[299] = 0.0; - out_2688320196777535589[300] = 0.0; - out_2688320196777535589[301] = 0.0; - out_2688320196777535589[302] = 0.0; - out_2688320196777535589[303] = 0.0; - out_2688320196777535589[304] = 1.0; - out_2688320196777535589[305] = 0.0; - out_2688320196777535589[306] = 0.0; - out_2688320196777535589[307] = 0.0; - out_2688320196777535589[308] = 0.0; - out_2688320196777535589[309] = 0.0; - out_2688320196777535589[310] = 0.0; - out_2688320196777535589[311] = 0.0; - out_2688320196777535589[312] = 0.0; - out_2688320196777535589[313] = 0.0; - out_2688320196777535589[314] = 0.0; - out_2688320196777535589[315] = 0.0; - out_2688320196777535589[316] = 0.0; - out_2688320196777535589[317] = 0.0; - out_2688320196777535589[318] = 0.0; - out_2688320196777535589[319] = 0.0; - out_2688320196777535589[320] = 0.0; - out_2688320196777535589[321] = 0.0; - out_2688320196777535589[322] = 0.0; - out_2688320196777535589[323] = 1.0; +void H_mod_fun(double *state, double *out_4711938499332200676) { + out_4711938499332200676[0] = 1.0; + out_4711938499332200676[1] = 0.0; + out_4711938499332200676[2] = 0.0; + out_4711938499332200676[3] = 0.0; + out_4711938499332200676[4] = 0.0; + out_4711938499332200676[5] = 0.0; + out_4711938499332200676[6] = 0.0; + out_4711938499332200676[7] = 0.0; + out_4711938499332200676[8] = 0.0; + out_4711938499332200676[9] = 0.0; + out_4711938499332200676[10] = 0.0; + out_4711938499332200676[11] = 0.0; + out_4711938499332200676[12] = 0.0; + out_4711938499332200676[13] = 0.0; + out_4711938499332200676[14] = 0.0; + out_4711938499332200676[15] = 0.0; + out_4711938499332200676[16] = 0.0; + out_4711938499332200676[17] = 0.0; + out_4711938499332200676[18] = 0.0; + out_4711938499332200676[19] = 1.0; + out_4711938499332200676[20] = 0.0; + out_4711938499332200676[21] = 0.0; + out_4711938499332200676[22] = 0.0; + out_4711938499332200676[23] = 0.0; + out_4711938499332200676[24] = 0.0; + out_4711938499332200676[25] = 0.0; + out_4711938499332200676[26] = 0.0; + out_4711938499332200676[27] = 0.0; + out_4711938499332200676[28] = 0.0; + out_4711938499332200676[29] = 0.0; + out_4711938499332200676[30] = 0.0; + out_4711938499332200676[31] = 0.0; + out_4711938499332200676[32] = 0.0; + out_4711938499332200676[33] = 0.0; + out_4711938499332200676[34] = 0.0; + out_4711938499332200676[35] = 0.0; + out_4711938499332200676[36] = 0.0; + out_4711938499332200676[37] = 0.0; + out_4711938499332200676[38] = 1.0; + out_4711938499332200676[39] = 0.0; + out_4711938499332200676[40] = 0.0; + out_4711938499332200676[41] = 0.0; + out_4711938499332200676[42] = 0.0; + out_4711938499332200676[43] = 0.0; + out_4711938499332200676[44] = 0.0; + out_4711938499332200676[45] = 0.0; + out_4711938499332200676[46] = 0.0; + out_4711938499332200676[47] = 0.0; + out_4711938499332200676[48] = 0.0; + out_4711938499332200676[49] = 0.0; + out_4711938499332200676[50] = 0.0; + out_4711938499332200676[51] = 0.0; + out_4711938499332200676[52] = 0.0; + out_4711938499332200676[53] = 0.0; + out_4711938499332200676[54] = 0.0; + out_4711938499332200676[55] = 0.0; + out_4711938499332200676[56] = 0.0; + out_4711938499332200676[57] = 1.0; + out_4711938499332200676[58] = 0.0; + out_4711938499332200676[59] = 0.0; + out_4711938499332200676[60] = 0.0; + out_4711938499332200676[61] = 0.0; + out_4711938499332200676[62] = 0.0; + out_4711938499332200676[63] = 0.0; + out_4711938499332200676[64] = 0.0; + out_4711938499332200676[65] = 0.0; + out_4711938499332200676[66] = 0.0; + out_4711938499332200676[67] = 0.0; + out_4711938499332200676[68] = 0.0; + out_4711938499332200676[69] = 0.0; + out_4711938499332200676[70] = 0.0; + out_4711938499332200676[71] = 0.0; + out_4711938499332200676[72] = 0.0; + out_4711938499332200676[73] = 0.0; + out_4711938499332200676[74] = 0.0; + out_4711938499332200676[75] = 0.0; + out_4711938499332200676[76] = 1.0; + out_4711938499332200676[77] = 0.0; + out_4711938499332200676[78] = 0.0; + out_4711938499332200676[79] = 0.0; + out_4711938499332200676[80] = 0.0; + out_4711938499332200676[81] = 0.0; + out_4711938499332200676[82] = 0.0; + out_4711938499332200676[83] = 0.0; + out_4711938499332200676[84] = 0.0; + out_4711938499332200676[85] = 0.0; + out_4711938499332200676[86] = 0.0; + out_4711938499332200676[87] = 0.0; + out_4711938499332200676[88] = 0.0; + out_4711938499332200676[89] = 0.0; + out_4711938499332200676[90] = 0.0; + out_4711938499332200676[91] = 0.0; + out_4711938499332200676[92] = 0.0; + out_4711938499332200676[93] = 0.0; + out_4711938499332200676[94] = 0.0; + out_4711938499332200676[95] = 1.0; + out_4711938499332200676[96] = 0.0; + out_4711938499332200676[97] = 0.0; + out_4711938499332200676[98] = 0.0; + out_4711938499332200676[99] = 0.0; + out_4711938499332200676[100] = 0.0; + out_4711938499332200676[101] = 0.0; + out_4711938499332200676[102] = 0.0; + out_4711938499332200676[103] = 0.0; + out_4711938499332200676[104] = 0.0; + out_4711938499332200676[105] = 0.0; + out_4711938499332200676[106] = 0.0; + out_4711938499332200676[107] = 0.0; + out_4711938499332200676[108] = 0.0; + out_4711938499332200676[109] = 0.0; + out_4711938499332200676[110] = 0.0; + out_4711938499332200676[111] = 0.0; + out_4711938499332200676[112] = 0.0; + out_4711938499332200676[113] = 0.0; + out_4711938499332200676[114] = 1.0; + out_4711938499332200676[115] = 0.0; + out_4711938499332200676[116] = 0.0; + out_4711938499332200676[117] = 0.0; + out_4711938499332200676[118] = 0.0; + out_4711938499332200676[119] = 0.0; + out_4711938499332200676[120] = 0.0; + out_4711938499332200676[121] = 0.0; + out_4711938499332200676[122] = 0.0; + out_4711938499332200676[123] = 0.0; + out_4711938499332200676[124] = 0.0; + out_4711938499332200676[125] = 0.0; + out_4711938499332200676[126] = 0.0; + out_4711938499332200676[127] = 0.0; + out_4711938499332200676[128] = 0.0; + out_4711938499332200676[129] = 0.0; + out_4711938499332200676[130] = 0.0; + out_4711938499332200676[131] = 0.0; + out_4711938499332200676[132] = 0.0; + out_4711938499332200676[133] = 1.0; + out_4711938499332200676[134] = 0.0; + out_4711938499332200676[135] = 0.0; + out_4711938499332200676[136] = 0.0; + out_4711938499332200676[137] = 0.0; + out_4711938499332200676[138] = 0.0; + out_4711938499332200676[139] = 0.0; + out_4711938499332200676[140] = 0.0; + out_4711938499332200676[141] = 0.0; + out_4711938499332200676[142] = 0.0; + out_4711938499332200676[143] = 0.0; + out_4711938499332200676[144] = 0.0; + out_4711938499332200676[145] = 0.0; + out_4711938499332200676[146] = 0.0; + out_4711938499332200676[147] = 0.0; + out_4711938499332200676[148] = 0.0; + out_4711938499332200676[149] = 0.0; + out_4711938499332200676[150] = 0.0; + out_4711938499332200676[151] = 0.0; + out_4711938499332200676[152] = 1.0; + out_4711938499332200676[153] = 0.0; + out_4711938499332200676[154] = 0.0; + out_4711938499332200676[155] = 0.0; + out_4711938499332200676[156] = 0.0; + out_4711938499332200676[157] = 0.0; + out_4711938499332200676[158] = 0.0; + out_4711938499332200676[159] = 0.0; + out_4711938499332200676[160] = 0.0; + out_4711938499332200676[161] = 0.0; + out_4711938499332200676[162] = 0.0; + out_4711938499332200676[163] = 0.0; + out_4711938499332200676[164] = 0.0; + out_4711938499332200676[165] = 0.0; + out_4711938499332200676[166] = 0.0; + out_4711938499332200676[167] = 0.0; + out_4711938499332200676[168] = 0.0; + out_4711938499332200676[169] = 0.0; + out_4711938499332200676[170] = 0.0; + out_4711938499332200676[171] = 1.0; + out_4711938499332200676[172] = 0.0; + out_4711938499332200676[173] = 0.0; + out_4711938499332200676[174] = 0.0; + out_4711938499332200676[175] = 0.0; + out_4711938499332200676[176] = 0.0; + out_4711938499332200676[177] = 0.0; + out_4711938499332200676[178] = 0.0; + out_4711938499332200676[179] = 0.0; + out_4711938499332200676[180] = 0.0; + out_4711938499332200676[181] = 0.0; + out_4711938499332200676[182] = 0.0; + out_4711938499332200676[183] = 0.0; + out_4711938499332200676[184] = 0.0; + out_4711938499332200676[185] = 0.0; + out_4711938499332200676[186] = 0.0; + out_4711938499332200676[187] = 0.0; + out_4711938499332200676[188] = 0.0; + out_4711938499332200676[189] = 0.0; + out_4711938499332200676[190] = 1.0; + out_4711938499332200676[191] = 0.0; + out_4711938499332200676[192] = 0.0; + out_4711938499332200676[193] = 0.0; + out_4711938499332200676[194] = 0.0; + out_4711938499332200676[195] = 0.0; + out_4711938499332200676[196] = 0.0; + out_4711938499332200676[197] = 0.0; + out_4711938499332200676[198] = 0.0; + out_4711938499332200676[199] = 0.0; + out_4711938499332200676[200] = 0.0; + out_4711938499332200676[201] = 0.0; + out_4711938499332200676[202] = 0.0; + out_4711938499332200676[203] = 0.0; + out_4711938499332200676[204] = 0.0; + out_4711938499332200676[205] = 0.0; + out_4711938499332200676[206] = 0.0; + out_4711938499332200676[207] = 0.0; + out_4711938499332200676[208] = 0.0; + out_4711938499332200676[209] = 1.0; + out_4711938499332200676[210] = 0.0; + out_4711938499332200676[211] = 0.0; + out_4711938499332200676[212] = 0.0; + out_4711938499332200676[213] = 0.0; + out_4711938499332200676[214] = 0.0; + out_4711938499332200676[215] = 0.0; + out_4711938499332200676[216] = 0.0; + out_4711938499332200676[217] = 0.0; + out_4711938499332200676[218] = 0.0; + out_4711938499332200676[219] = 0.0; + out_4711938499332200676[220] = 0.0; + out_4711938499332200676[221] = 0.0; + out_4711938499332200676[222] = 0.0; + out_4711938499332200676[223] = 0.0; + out_4711938499332200676[224] = 0.0; + out_4711938499332200676[225] = 0.0; + out_4711938499332200676[226] = 0.0; + out_4711938499332200676[227] = 0.0; + out_4711938499332200676[228] = 1.0; + out_4711938499332200676[229] = 0.0; + out_4711938499332200676[230] = 0.0; + out_4711938499332200676[231] = 0.0; + out_4711938499332200676[232] = 0.0; + out_4711938499332200676[233] = 0.0; + out_4711938499332200676[234] = 0.0; + out_4711938499332200676[235] = 0.0; + out_4711938499332200676[236] = 0.0; + out_4711938499332200676[237] = 0.0; + out_4711938499332200676[238] = 0.0; + out_4711938499332200676[239] = 0.0; + out_4711938499332200676[240] = 0.0; + out_4711938499332200676[241] = 0.0; + out_4711938499332200676[242] = 0.0; + out_4711938499332200676[243] = 0.0; + out_4711938499332200676[244] = 0.0; + out_4711938499332200676[245] = 0.0; + out_4711938499332200676[246] = 0.0; + out_4711938499332200676[247] = 1.0; + out_4711938499332200676[248] = 0.0; + out_4711938499332200676[249] = 0.0; + out_4711938499332200676[250] = 0.0; + out_4711938499332200676[251] = 0.0; + out_4711938499332200676[252] = 0.0; + out_4711938499332200676[253] = 0.0; + out_4711938499332200676[254] = 0.0; + out_4711938499332200676[255] = 0.0; + out_4711938499332200676[256] = 0.0; + out_4711938499332200676[257] = 0.0; + out_4711938499332200676[258] = 0.0; + out_4711938499332200676[259] = 0.0; + out_4711938499332200676[260] = 0.0; + out_4711938499332200676[261] = 0.0; + out_4711938499332200676[262] = 0.0; + out_4711938499332200676[263] = 0.0; + out_4711938499332200676[264] = 0.0; + out_4711938499332200676[265] = 0.0; + out_4711938499332200676[266] = 1.0; + out_4711938499332200676[267] = 0.0; + out_4711938499332200676[268] = 0.0; + out_4711938499332200676[269] = 0.0; + out_4711938499332200676[270] = 0.0; + out_4711938499332200676[271] = 0.0; + out_4711938499332200676[272] = 0.0; + out_4711938499332200676[273] = 0.0; + out_4711938499332200676[274] = 0.0; + out_4711938499332200676[275] = 0.0; + out_4711938499332200676[276] = 0.0; + out_4711938499332200676[277] = 0.0; + out_4711938499332200676[278] = 0.0; + out_4711938499332200676[279] = 0.0; + out_4711938499332200676[280] = 0.0; + out_4711938499332200676[281] = 0.0; + out_4711938499332200676[282] = 0.0; + out_4711938499332200676[283] = 0.0; + out_4711938499332200676[284] = 0.0; + out_4711938499332200676[285] = 1.0; + out_4711938499332200676[286] = 0.0; + out_4711938499332200676[287] = 0.0; + out_4711938499332200676[288] = 0.0; + out_4711938499332200676[289] = 0.0; + out_4711938499332200676[290] = 0.0; + out_4711938499332200676[291] = 0.0; + out_4711938499332200676[292] = 0.0; + out_4711938499332200676[293] = 0.0; + out_4711938499332200676[294] = 0.0; + out_4711938499332200676[295] = 0.0; + out_4711938499332200676[296] = 0.0; + out_4711938499332200676[297] = 0.0; + out_4711938499332200676[298] = 0.0; + out_4711938499332200676[299] = 0.0; + out_4711938499332200676[300] = 0.0; + out_4711938499332200676[301] = 0.0; + out_4711938499332200676[302] = 0.0; + out_4711938499332200676[303] = 0.0; + out_4711938499332200676[304] = 1.0; + out_4711938499332200676[305] = 0.0; + out_4711938499332200676[306] = 0.0; + out_4711938499332200676[307] = 0.0; + out_4711938499332200676[308] = 0.0; + out_4711938499332200676[309] = 0.0; + out_4711938499332200676[310] = 0.0; + out_4711938499332200676[311] = 0.0; + out_4711938499332200676[312] = 0.0; + out_4711938499332200676[313] = 0.0; + out_4711938499332200676[314] = 0.0; + out_4711938499332200676[315] = 0.0; + out_4711938499332200676[316] = 0.0; + out_4711938499332200676[317] = 0.0; + out_4711938499332200676[318] = 0.0; + out_4711938499332200676[319] = 0.0; + out_4711938499332200676[320] = 0.0; + out_4711938499332200676[321] = 0.0; + out_4711938499332200676[322] = 0.0; + out_4711938499332200676[323] = 1.0; } -void f_fun(double *state, double dt, double *out_650263676124789422) { - out_650263676124789422[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_650263676124789422[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_650263676124789422[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_650263676124789422[3] = dt*state[12] + state[3]; - out_650263676124789422[4] = dt*state[13] + state[4]; - out_650263676124789422[5] = dt*state[14] + state[5]; - out_650263676124789422[6] = state[6]; - out_650263676124789422[7] = state[7]; - out_650263676124789422[8] = state[8]; - out_650263676124789422[9] = state[9]; - out_650263676124789422[10] = state[10]; - out_650263676124789422[11] = state[11]; - out_650263676124789422[12] = state[12]; - out_650263676124789422[13] = state[13]; - out_650263676124789422[14] = state[14]; - out_650263676124789422[15] = state[15]; - out_650263676124789422[16] = state[16]; - out_650263676124789422[17] = state[17]; +void f_fun(double *state, double dt, double *out_3583623669529018238) { + out_3583623669529018238[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_3583623669529018238[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_3583623669529018238[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_3583623669529018238[3] = dt*state[12] + state[3]; + out_3583623669529018238[4] = dt*state[13] + state[4]; + out_3583623669529018238[5] = dt*state[14] + state[5]; + out_3583623669529018238[6] = state[6]; + out_3583623669529018238[7] = state[7]; + out_3583623669529018238[8] = state[8]; + out_3583623669529018238[9] = state[9]; + out_3583623669529018238[10] = state[10]; + out_3583623669529018238[11] = state[11]; + out_3583623669529018238[12] = state[12]; + out_3583623669529018238[13] = state[13]; + out_3583623669529018238[14] = state[14]; + out_3583623669529018238[15] = state[15]; + out_3583623669529018238[16] = state[16]; + out_3583623669529018238[17] = state[17]; } -void F_fun(double *state, double dt, double *out_7315646842237993430) { - out_7315646842237993430[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_7315646842237993430[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_7315646842237993430[2] = 0; - out_7315646842237993430[3] = 0; - out_7315646842237993430[4] = 0; - out_7315646842237993430[5] = 0; - out_7315646842237993430[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_7315646842237993430[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_7315646842237993430[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_7315646842237993430[9] = 0; - out_7315646842237993430[10] = 0; - out_7315646842237993430[11] = 0; - out_7315646842237993430[12] = 0; - out_7315646842237993430[13] = 0; - out_7315646842237993430[14] = 0; - out_7315646842237993430[15] = 0; - out_7315646842237993430[16] = 0; - out_7315646842237993430[17] = 0; - out_7315646842237993430[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_7315646842237993430[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_7315646842237993430[20] = 0; - out_7315646842237993430[21] = 0; - out_7315646842237993430[22] = 0; - out_7315646842237993430[23] = 0; - out_7315646842237993430[24] = 0; - out_7315646842237993430[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_7315646842237993430[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_7315646842237993430[27] = 0; - out_7315646842237993430[28] = 0; - out_7315646842237993430[29] = 0; - out_7315646842237993430[30] = 0; - out_7315646842237993430[31] = 0; - out_7315646842237993430[32] = 0; - out_7315646842237993430[33] = 0; - out_7315646842237993430[34] = 0; - out_7315646842237993430[35] = 0; - out_7315646842237993430[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_7315646842237993430[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_7315646842237993430[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_7315646842237993430[39] = 0; - out_7315646842237993430[40] = 0; - out_7315646842237993430[41] = 0; - out_7315646842237993430[42] = 0; - out_7315646842237993430[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_7315646842237993430[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_7315646842237993430[45] = 0; - out_7315646842237993430[46] = 0; - out_7315646842237993430[47] = 0; - out_7315646842237993430[48] = 0; - out_7315646842237993430[49] = 0; - out_7315646842237993430[50] = 0; - out_7315646842237993430[51] = 0; - out_7315646842237993430[52] = 0; - out_7315646842237993430[53] = 0; - out_7315646842237993430[54] = 0; - out_7315646842237993430[55] = 0; - out_7315646842237993430[56] = 0; - out_7315646842237993430[57] = 1; - out_7315646842237993430[58] = 0; - out_7315646842237993430[59] = 0; - out_7315646842237993430[60] = 0; - out_7315646842237993430[61] = 0; - out_7315646842237993430[62] = 0; - out_7315646842237993430[63] = 0; - out_7315646842237993430[64] = 0; - out_7315646842237993430[65] = 0; - out_7315646842237993430[66] = dt; - out_7315646842237993430[67] = 0; - out_7315646842237993430[68] = 0; - out_7315646842237993430[69] = 0; - out_7315646842237993430[70] = 0; - out_7315646842237993430[71] = 0; - out_7315646842237993430[72] = 0; - out_7315646842237993430[73] = 0; - out_7315646842237993430[74] = 0; - out_7315646842237993430[75] = 0; - out_7315646842237993430[76] = 1; - out_7315646842237993430[77] = 0; - out_7315646842237993430[78] = 0; - out_7315646842237993430[79] = 0; - out_7315646842237993430[80] = 0; - out_7315646842237993430[81] = 0; - out_7315646842237993430[82] = 0; - out_7315646842237993430[83] = 0; - out_7315646842237993430[84] = 0; - out_7315646842237993430[85] = dt; - out_7315646842237993430[86] = 0; - out_7315646842237993430[87] = 0; - out_7315646842237993430[88] = 0; - out_7315646842237993430[89] = 0; - out_7315646842237993430[90] = 0; - out_7315646842237993430[91] = 0; - out_7315646842237993430[92] = 0; - out_7315646842237993430[93] = 0; - out_7315646842237993430[94] = 0; - out_7315646842237993430[95] = 1; - out_7315646842237993430[96] = 0; - out_7315646842237993430[97] = 0; - out_7315646842237993430[98] = 0; - out_7315646842237993430[99] = 0; - out_7315646842237993430[100] = 0; - out_7315646842237993430[101] = 0; - out_7315646842237993430[102] = 0; - out_7315646842237993430[103] = 0; - out_7315646842237993430[104] = dt; - out_7315646842237993430[105] = 0; - out_7315646842237993430[106] = 0; - out_7315646842237993430[107] = 0; - out_7315646842237993430[108] = 0; - out_7315646842237993430[109] = 0; - out_7315646842237993430[110] = 0; - out_7315646842237993430[111] = 0; - out_7315646842237993430[112] = 0; - out_7315646842237993430[113] = 0; - out_7315646842237993430[114] = 1; - out_7315646842237993430[115] = 0; - out_7315646842237993430[116] = 0; - out_7315646842237993430[117] = 0; - out_7315646842237993430[118] = 0; - out_7315646842237993430[119] = 0; - out_7315646842237993430[120] = 0; - out_7315646842237993430[121] = 0; - out_7315646842237993430[122] = 0; - out_7315646842237993430[123] = 0; - out_7315646842237993430[124] = 0; - out_7315646842237993430[125] = 0; - out_7315646842237993430[126] = 0; - out_7315646842237993430[127] = 0; - out_7315646842237993430[128] = 0; - out_7315646842237993430[129] = 0; - out_7315646842237993430[130] = 0; - out_7315646842237993430[131] = 0; - out_7315646842237993430[132] = 0; - out_7315646842237993430[133] = 1; - out_7315646842237993430[134] = 0; - out_7315646842237993430[135] = 0; - out_7315646842237993430[136] = 0; - out_7315646842237993430[137] = 0; - out_7315646842237993430[138] = 0; - out_7315646842237993430[139] = 0; - out_7315646842237993430[140] = 0; - out_7315646842237993430[141] = 0; - out_7315646842237993430[142] = 0; - out_7315646842237993430[143] = 0; - out_7315646842237993430[144] = 0; - out_7315646842237993430[145] = 0; - out_7315646842237993430[146] = 0; - out_7315646842237993430[147] = 0; - out_7315646842237993430[148] = 0; - out_7315646842237993430[149] = 0; - out_7315646842237993430[150] = 0; - out_7315646842237993430[151] = 0; - out_7315646842237993430[152] = 1; - out_7315646842237993430[153] = 0; - out_7315646842237993430[154] = 0; - out_7315646842237993430[155] = 0; - out_7315646842237993430[156] = 0; - out_7315646842237993430[157] = 0; - out_7315646842237993430[158] = 0; - out_7315646842237993430[159] = 0; - out_7315646842237993430[160] = 0; - out_7315646842237993430[161] = 0; - out_7315646842237993430[162] = 0; - out_7315646842237993430[163] = 0; - out_7315646842237993430[164] = 0; - out_7315646842237993430[165] = 0; - out_7315646842237993430[166] = 0; - out_7315646842237993430[167] = 0; - out_7315646842237993430[168] = 0; - out_7315646842237993430[169] = 0; - out_7315646842237993430[170] = 0; - out_7315646842237993430[171] = 1; - out_7315646842237993430[172] = 0; - out_7315646842237993430[173] = 0; - out_7315646842237993430[174] = 0; - out_7315646842237993430[175] = 0; - out_7315646842237993430[176] = 0; - out_7315646842237993430[177] = 0; - out_7315646842237993430[178] = 0; - out_7315646842237993430[179] = 0; - out_7315646842237993430[180] = 0; - out_7315646842237993430[181] = 0; - out_7315646842237993430[182] = 0; - out_7315646842237993430[183] = 0; - out_7315646842237993430[184] = 0; - out_7315646842237993430[185] = 0; - out_7315646842237993430[186] = 0; - out_7315646842237993430[187] = 0; - out_7315646842237993430[188] = 0; - out_7315646842237993430[189] = 0; - out_7315646842237993430[190] = 1; - out_7315646842237993430[191] = 0; - out_7315646842237993430[192] = 0; - out_7315646842237993430[193] = 0; - out_7315646842237993430[194] = 0; - out_7315646842237993430[195] = 0; - out_7315646842237993430[196] = 0; - out_7315646842237993430[197] = 0; - out_7315646842237993430[198] = 0; - out_7315646842237993430[199] = 0; - out_7315646842237993430[200] = 0; - out_7315646842237993430[201] = 0; - out_7315646842237993430[202] = 0; - out_7315646842237993430[203] = 0; - out_7315646842237993430[204] = 0; - out_7315646842237993430[205] = 0; - out_7315646842237993430[206] = 0; - out_7315646842237993430[207] = 0; - out_7315646842237993430[208] = 0; - out_7315646842237993430[209] = 1; - out_7315646842237993430[210] = 0; - out_7315646842237993430[211] = 0; - out_7315646842237993430[212] = 0; - out_7315646842237993430[213] = 0; - out_7315646842237993430[214] = 0; - out_7315646842237993430[215] = 0; - out_7315646842237993430[216] = 0; - out_7315646842237993430[217] = 0; - out_7315646842237993430[218] = 0; - out_7315646842237993430[219] = 0; - out_7315646842237993430[220] = 0; - out_7315646842237993430[221] = 0; - out_7315646842237993430[222] = 0; - out_7315646842237993430[223] = 0; - out_7315646842237993430[224] = 0; - out_7315646842237993430[225] = 0; - out_7315646842237993430[226] = 0; - out_7315646842237993430[227] = 0; - out_7315646842237993430[228] = 1; - out_7315646842237993430[229] = 0; - out_7315646842237993430[230] = 0; - out_7315646842237993430[231] = 0; - out_7315646842237993430[232] = 0; - out_7315646842237993430[233] = 0; - out_7315646842237993430[234] = 0; - out_7315646842237993430[235] = 0; - out_7315646842237993430[236] = 0; - out_7315646842237993430[237] = 0; - out_7315646842237993430[238] = 0; - out_7315646842237993430[239] = 0; - out_7315646842237993430[240] = 0; - out_7315646842237993430[241] = 0; - out_7315646842237993430[242] = 0; - out_7315646842237993430[243] = 0; - out_7315646842237993430[244] = 0; - out_7315646842237993430[245] = 0; - out_7315646842237993430[246] = 0; - out_7315646842237993430[247] = 1; - out_7315646842237993430[248] = 0; - out_7315646842237993430[249] = 0; - out_7315646842237993430[250] = 0; - out_7315646842237993430[251] = 0; - out_7315646842237993430[252] = 0; - out_7315646842237993430[253] = 0; - out_7315646842237993430[254] = 0; - out_7315646842237993430[255] = 0; - out_7315646842237993430[256] = 0; - out_7315646842237993430[257] = 0; - out_7315646842237993430[258] = 0; - out_7315646842237993430[259] = 0; - out_7315646842237993430[260] = 0; - out_7315646842237993430[261] = 0; - out_7315646842237993430[262] = 0; - out_7315646842237993430[263] = 0; - out_7315646842237993430[264] = 0; - out_7315646842237993430[265] = 0; - out_7315646842237993430[266] = 1; - out_7315646842237993430[267] = 0; - out_7315646842237993430[268] = 0; - out_7315646842237993430[269] = 0; - out_7315646842237993430[270] = 0; - out_7315646842237993430[271] = 0; - out_7315646842237993430[272] = 0; - out_7315646842237993430[273] = 0; - out_7315646842237993430[274] = 0; - out_7315646842237993430[275] = 0; - out_7315646842237993430[276] = 0; - out_7315646842237993430[277] = 0; - out_7315646842237993430[278] = 0; - out_7315646842237993430[279] = 0; - out_7315646842237993430[280] = 0; - out_7315646842237993430[281] = 0; - out_7315646842237993430[282] = 0; - out_7315646842237993430[283] = 0; - out_7315646842237993430[284] = 0; - out_7315646842237993430[285] = 1; - out_7315646842237993430[286] = 0; - out_7315646842237993430[287] = 0; - out_7315646842237993430[288] = 0; - out_7315646842237993430[289] = 0; - out_7315646842237993430[290] = 0; - out_7315646842237993430[291] = 0; - out_7315646842237993430[292] = 0; - out_7315646842237993430[293] = 0; - out_7315646842237993430[294] = 0; - out_7315646842237993430[295] = 0; - out_7315646842237993430[296] = 0; - out_7315646842237993430[297] = 0; - out_7315646842237993430[298] = 0; - out_7315646842237993430[299] = 0; - out_7315646842237993430[300] = 0; - out_7315646842237993430[301] = 0; - out_7315646842237993430[302] = 0; - out_7315646842237993430[303] = 0; - out_7315646842237993430[304] = 1; - out_7315646842237993430[305] = 0; - out_7315646842237993430[306] = 0; - out_7315646842237993430[307] = 0; - out_7315646842237993430[308] = 0; - out_7315646842237993430[309] = 0; - out_7315646842237993430[310] = 0; - out_7315646842237993430[311] = 0; - out_7315646842237993430[312] = 0; - out_7315646842237993430[313] = 0; - out_7315646842237993430[314] = 0; - out_7315646842237993430[315] = 0; - out_7315646842237993430[316] = 0; - out_7315646842237993430[317] = 0; - out_7315646842237993430[318] = 0; - out_7315646842237993430[319] = 0; - out_7315646842237993430[320] = 0; - out_7315646842237993430[321] = 0; - out_7315646842237993430[322] = 0; - out_7315646842237993430[323] = 1; +void F_fun(double *state, double dt, double *out_147281941884768427) { + out_147281941884768427[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_147281941884768427[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_147281941884768427[2] = 0; + out_147281941884768427[3] = 0; + out_147281941884768427[4] = 0; + out_147281941884768427[5] = 0; + out_147281941884768427[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_147281941884768427[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_147281941884768427[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_147281941884768427[9] = 0; + out_147281941884768427[10] = 0; + out_147281941884768427[11] = 0; + out_147281941884768427[12] = 0; + out_147281941884768427[13] = 0; + out_147281941884768427[14] = 0; + out_147281941884768427[15] = 0; + out_147281941884768427[16] = 0; + out_147281941884768427[17] = 0; + out_147281941884768427[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_147281941884768427[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_147281941884768427[20] = 0; + out_147281941884768427[21] = 0; + out_147281941884768427[22] = 0; + out_147281941884768427[23] = 0; + out_147281941884768427[24] = 0; + out_147281941884768427[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_147281941884768427[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_147281941884768427[27] = 0; + out_147281941884768427[28] = 0; + out_147281941884768427[29] = 0; + out_147281941884768427[30] = 0; + out_147281941884768427[31] = 0; + out_147281941884768427[32] = 0; + out_147281941884768427[33] = 0; + out_147281941884768427[34] = 0; + out_147281941884768427[35] = 0; + out_147281941884768427[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_147281941884768427[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_147281941884768427[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_147281941884768427[39] = 0; + out_147281941884768427[40] = 0; + out_147281941884768427[41] = 0; + out_147281941884768427[42] = 0; + out_147281941884768427[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_147281941884768427[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_147281941884768427[45] = 0; + out_147281941884768427[46] = 0; + out_147281941884768427[47] = 0; + out_147281941884768427[48] = 0; + out_147281941884768427[49] = 0; + out_147281941884768427[50] = 0; + out_147281941884768427[51] = 0; + out_147281941884768427[52] = 0; + out_147281941884768427[53] = 0; + out_147281941884768427[54] = 0; + out_147281941884768427[55] = 0; + out_147281941884768427[56] = 0; + out_147281941884768427[57] = 1; + out_147281941884768427[58] = 0; + out_147281941884768427[59] = 0; + out_147281941884768427[60] = 0; + out_147281941884768427[61] = 0; + out_147281941884768427[62] = 0; + out_147281941884768427[63] = 0; + out_147281941884768427[64] = 0; + out_147281941884768427[65] = 0; + out_147281941884768427[66] = dt; + out_147281941884768427[67] = 0; + out_147281941884768427[68] = 0; + out_147281941884768427[69] = 0; + out_147281941884768427[70] = 0; + out_147281941884768427[71] = 0; + out_147281941884768427[72] = 0; + out_147281941884768427[73] = 0; + out_147281941884768427[74] = 0; + out_147281941884768427[75] = 0; + out_147281941884768427[76] = 1; + out_147281941884768427[77] = 0; + out_147281941884768427[78] = 0; + out_147281941884768427[79] = 0; + out_147281941884768427[80] = 0; + out_147281941884768427[81] = 0; + out_147281941884768427[82] = 0; + out_147281941884768427[83] = 0; + out_147281941884768427[84] = 0; + out_147281941884768427[85] = dt; + out_147281941884768427[86] = 0; + out_147281941884768427[87] = 0; + out_147281941884768427[88] = 0; + out_147281941884768427[89] = 0; + out_147281941884768427[90] = 0; + out_147281941884768427[91] = 0; + out_147281941884768427[92] = 0; + out_147281941884768427[93] = 0; + out_147281941884768427[94] = 0; + out_147281941884768427[95] = 1; + out_147281941884768427[96] = 0; + out_147281941884768427[97] = 0; + out_147281941884768427[98] = 0; + out_147281941884768427[99] = 0; + out_147281941884768427[100] = 0; + out_147281941884768427[101] = 0; + out_147281941884768427[102] = 0; + out_147281941884768427[103] = 0; + out_147281941884768427[104] = dt; + out_147281941884768427[105] = 0; + out_147281941884768427[106] = 0; + out_147281941884768427[107] = 0; + out_147281941884768427[108] = 0; + out_147281941884768427[109] = 0; + out_147281941884768427[110] = 0; + out_147281941884768427[111] = 0; + out_147281941884768427[112] = 0; + out_147281941884768427[113] = 0; + out_147281941884768427[114] = 1; + out_147281941884768427[115] = 0; + out_147281941884768427[116] = 0; + out_147281941884768427[117] = 0; + out_147281941884768427[118] = 0; + out_147281941884768427[119] = 0; + out_147281941884768427[120] = 0; + out_147281941884768427[121] = 0; + out_147281941884768427[122] = 0; + out_147281941884768427[123] = 0; + out_147281941884768427[124] = 0; + out_147281941884768427[125] = 0; + out_147281941884768427[126] = 0; + out_147281941884768427[127] = 0; + out_147281941884768427[128] = 0; + out_147281941884768427[129] = 0; + out_147281941884768427[130] = 0; + out_147281941884768427[131] = 0; + out_147281941884768427[132] = 0; + out_147281941884768427[133] = 1; + out_147281941884768427[134] = 0; + out_147281941884768427[135] = 0; + out_147281941884768427[136] = 0; + out_147281941884768427[137] = 0; + out_147281941884768427[138] = 0; + out_147281941884768427[139] = 0; + out_147281941884768427[140] = 0; + out_147281941884768427[141] = 0; + out_147281941884768427[142] = 0; + out_147281941884768427[143] = 0; + out_147281941884768427[144] = 0; + out_147281941884768427[145] = 0; + out_147281941884768427[146] = 0; + out_147281941884768427[147] = 0; + out_147281941884768427[148] = 0; + out_147281941884768427[149] = 0; + out_147281941884768427[150] = 0; + out_147281941884768427[151] = 0; + out_147281941884768427[152] = 1; + out_147281941884768427[153] = 0; + out_147281941884768427[154] = 0; + out_147281941884768427[155] = 0; + out_147281941884768427[156] = 0; + out_147281941884768427[157] = 0; + out_147281941884768427[158] = 0; + out_147281941884768427[159] = 0; + out_147281941884768427[160] = 0; + out_147281941884768427[161] = 0; + out_147281941884768427[162] = 0; + out_147281941884768427[163] = 0; + out_147281941884768427[164] = 0; + out_147281941884768427[165] = 0; + out_147281941884768427[166] = 0; + out_147281941884768427[167] = 0; + out_147281941884768427[168] = 0; + out_147281941884768427[169] = 0; + out_147281941884768427[170] = 0; + out_147281941884768427[171] = 1; + out_147281941884768427[172] = 0; + out_147281941884768427[173] = 0; + out_147281941884768427[174] = 0; + out_147281941884768427[175] = 0; + out_147281941884768427[176] = 0; + out_147281941884768427[177] = 0; + out_147281941884768427[178] = 0; + out_147281941884768427[179] = 0; + out_147281941884768427[180] = 0; + out_147281941884768427[181] = 0; + out_147281941884768427[182] = 0; + out_147281941884768427[183] = 0; + out_147281941884768427[184] = 0; + out_147281941884768427[185] = 0; + out_147281941884768427[186] = 0; + out_147281941884768427[187] = 0; + out_147281941884768427[188] = 0; + out_147281941884768427[189] = 0; + out_147281941884768427[190] = 1; + out_147281941884768427[191] = 0; + out_147281941884768427[192] = 0; + out_147281941884768427[193] = 0; + out_147281941884768427[194] = 0; + out_147281941884768427[195] = 0; + out_147281941884768427[196] = 0; + out_147281941884768427[197] = 0; + out_147281941884768427[198] = 0; + out_147281941884768427[199] = 0; + out_147281941884768427[200] = 0; + out_147281941884768427[201] = 0; + out_147281941884768427[202] = 0; + out_147281941884768427[203] = 0; + out_147281941884768427[204] = 0; + out_147281941884768427[205] = 0; + out_147281941884768427[206] = 0; + out_147281941884768427[207] = 0; + out_147281941884768427[208] = 0; + out_147281941884768427[209] = 1; + out_147281941884768427[210] = 0; + out_147281941884768427[211] = 0; + out_147281941884768427[212] = 0; + out_147281941884768427[213] = 0; + out_147281941884768427[214] = 0; + out_147281941884768427[215] = 0; + out_147281941884768427[216] = 0; + out_147281941884768427[217] = 0; + out_147281941884768427[218] = 0; + out_147281941884768427[219] = 0; + out_147281941884768427[220] = 0; + out_147281941884768427[221] = 0; + out_147281941884768427[222] = 0; + out_147281941884768427[223] = 0; + out_147281941884768427[224] = 0; + out_147281941884768427[225] = 0; + out_147281941884768427[226] = 0; + out_147281941884768427[227] = 0; + out_147281941884768427[228] = 1; + out_147281941884768427[229] = 0; + out_147281941884768427[230] = 0; + out_147281941884768427[231] = 0; + out_147281941884768427[232] = 0; + out_147281941884768427[233] = 0; + out_147281941884768427[234] = 0; + out_147281941884768427[235] = 0; + out_147281941884768427[236] = 0; + out_147281941884768427[237] = 0; + out_147281941884768427[238] = 0; + out_147281941884768427[239] = 0; + out_147281941884768427[240] = 0; + out_147281941884768427[241] = 0; + out_147281941884768427[242] = 0; + out_147281941884768427[243] = 0; + out_147281941884768427[244] = 0; + out_147281941884768427[245] = 0; + out_147281941884768427[246] = 0; + out_147281941884768427[247] = 1; + out_147281941884768427[248] = 0; + out_147281941884768427[249] = 0; + out_147281941884768427[250] = 0; + out_147281941884768427[251] = 0; + out_147281941884768427[252] = 0; + out_147281941884768427[253] = 0; + out_147281941884768427[254] = 0; + out_147281941884768427[255] = 0; + out_147281941884768427[256] = 0; + out_147281941884768427[257] = 0; + out_147281941884768427[258] = 0; + out_147281941884768427[259] = 0; + out_147281941884768427[260] = 0; + out_147281941884768427[261] = 0; + out_147281941884768427[262] = 0; + out_147281941884768427[263] = 0; + out_147281941884768427[264] = 0; + out_147281941884768427[265] = 0; + out_147281941884768427[266] = 1; + out_147281941884768427[267] = 0; + out_147281941884768427[268] = 0; + out_147281941884768427[269] = 0; + out_147281941884768427[270] = 0; + out_147281941884768427[271] = 0; + out_147281941884768427[272] = 0; + out_147281941884768427[273] = 0; + out_147281941884768427[274] = 0; + out_147281941884768427[275] = 0; + out_147281941884768427[276] = 0; + out_147281941884768427[277] = 0; + out_147281941884768427[278] = 0; + out_147281941884768427[279] = 0; + out_147281941884768427[280] = 0; + out_147281941884768427[281] = 0; + out_147281941884768427[282] = 0; + out_147281941884768427[283] = 0; + out_147281941884768427[284] = 0; + out_147281941884768427[285] = 1; + out_147281941884768427[286] = 0; + out_147281941884768427[287] = 0; + out_147281941884768427[288] = 0; + out_147281941884768427[289] = 0; + out_147281941884768427[290] = 0; + out_147281941884768427[291] = 0; + out_147281941884768427[292] = 0; + out_147281941884768427[293] = 0; + out_147281941884768427[294] = 0; + out_147281941884768427[295] = 0; + out_147281941884768427[296] = 0; + out_147281941884768427[297] = 0; + out_147281941884768427[298] = 0; + out_147281941884768427[299] = 0; + out_147281941884768427[300] = 0; + out_147281941884768427[301] = 0; + out_147281941884768427[302] = 0; + out_147281941884768427[303] = 0; + out_147281941884768427[304] = 1; + out_147281941884768427[305] = 0; + out_147281941884768427[306] = 0; + out_147281941884768427[307] = 0; + out_147281941884768427[308] = 0; + out_147281941884768427[309] = 0; + out_147281941884768427[310] = 0; + out_147281941884768427[311] = 0; + out_147281941884768427[312] = 0; + out_147281941884768427[313] = 0; + out_147281941884768427[314] = 0; + out_147281941884768427[315] = 0; + out_147281941884768427[316] = 0; + out_147281941884768427[317] = 0; + out_147281941884768427[318] = 0; + out_147281941884768427[319] = 0; + out_147281941884768427[320] = 0; + out_147281941884768427[321] = 0; + out_147281941884768427[322] = 0; + out_147281941884768427[323] = 1; } -void h_4(double *state, double *unused, double *out_2905496685476842828) { - out_2905496685476842828[0] = state[6] + state[9]; - out_2905496685476842828[1] = state[7] + state[10]; - out_2905496685476842828[2] = state[8] + state[11]; +void h_4(double *state, double *unused, double *out_8338357592566013610) { + out_8338357592566013610[0] = state[6] + state[9]; + out_8338357592566013610[1] = state[7] + state[10]; + out_8338357592566013610[2] = state[8] + state[11]; } -void H_4(double *state, double *unused, double *out_5413221642194876961) { - out_5413221642194876961[0] = 0; - out_5413221642194876961[1] = 0; - out_5413221642194876961[2] = 0; - out_5413221642194876961[3] = 0; - out_5413221642194876961[4] = 0; - out_5413221642194876961[5] = 0; - out_5413221642194876961[6] = 1; - out_5413221642194876961[7] = 0; - out_5413221642194876961[8] = 0; - out_5413221642194876961[9] = 1; - out_5413221642194876961[10] = 0; - out_5413221642194876961[11] = 0; - out_5413221642194876961[12] = 0; - out_5413221642194876961[13] = 0; - out_5413221642194876961[14] = 0; - out_5413221642194876961[15] = 0; - out_5413221642194876961[16] = 0; - out_5413221642194876961[17] = 0; - out_5413221642194876961[18] = 0; - out_5413221642194876961[19] = 0; - out_5413221642194876961[20] = 0; - out_5413221642194876961[21] = 0; - out_5413221642194876961[22] = 0; - out_5413221642194876961[23] = 0; - out_5413221642194876961[24] = 0; - out_5413221642194876961[25] = 1; - out_5413221642194876961[26] = 0; - out_5413221642194876961[27] = 0; - out_5413221642194876961[28] = 1; - out_5413221642194876961[29] = 0; - out_5413221642194876961[30] = 0; - out_5413221642194876961[31] = 0; - out_5413221642194876961[32] = 0; - out_5413221642194876961[33] = 0; - out_5413221642194876961[34] = 0; - out_5413221642194876961[35] = 0; - out_5413221642194876961[36] = 0; - out_5413221642194876961[37] = 0; - out_5413221642194876961[38] = 0; - out_5413221642194876961[39] = 0; - out_5413221642194876961[40] = 0; - out_5413221642194876961[41] = 0; - out_5413221642194876961[42] = 0; - out_5413221642194876961[43] = 0; - out_5413221642194876961[44] = 1; - out_5413221642194876961[45] = 0; - out_5413221642194876961[46] = 0; - out_5413221642194876961[47] = 1; - out_5413221642194876961[48] = 0; - out_5413221642194876961[49] = 0; - out_5413221642194876961[50] = 0; - out_5413221642194876961[51] = 0; - out_5413221642194876961[52] = 0; - out_5413221642194876961[53] = 0; +void H_4(double *state, double *unused, double *out_940131289488293104) { + out_940131289488293104[0] = 0; + out_940131289488293104[1] = 0; + out_940131289488293104[2] = 0; + out_940131289488293104[3] = 0; + out_940131289488293104[4] = 0; + out_940131289488293104[5] = 0; + out_940131289488293104[6] = 1; + out_940131289488293104[7] = 0; + out_940131289488293104[8] = 0; + out_940131289488293104[9] = 1; + out_940131289488293104[10] = 0; + out_940131289488293104[11] = 0; + out_940131289488293104[12] = 0; + out_940131289488293104[13] = 0; + out_940131289488293104[14] = 0; + out_940131289488293104[15] = 0; + out_940131289488293104[16] = 0; + out_940131289488293104[17] = 0; + out_940131289488293104[18] = 0; + out_940131289488293104[19] = 0; + out_940131289488293104[20] = 0; + out_940131289488293104[21] = 0; + out_940131289488293104[22] = 0; + out_940131289488293104[23] = 0; + out_940131289488293104[24] = 0; + out_940131289488293104[25] = 1; + out_940131289488293104[26] = 0; + out_940131289488293104[27] = 0; + out_940131289488293104[28] = 1; + out_940131289488293104[29] = 0; + out_940131289488293104[30] = 0; + out_940131289488293104[31] = 0; + out_940131289488293104[32] = 0; + out_940131289488293104[33] = 0; + out_940131289488293104[34] = 0; + out_940131289488293104[35] = 0; + out_940131289488293104[36] = 0; + out_940131289488293104[37] = 0; + out_940131289488293104[38] = 0; + out_940131289488293104[39] = 0; + out_940131289488293104[40] = 0; + out_940131289488293104[41] = 0; + out_940131289488293104[42] = 0; + out_940131289488293104[43] = 0; + out_940131289488293104[44] = 1; + out_940131289488293104[45] = 0; + out_940131289488293104[46] = 0; + out_940131289488293104[47] = 1; + out_940131289488293104[48] = 0; + out_940131289488293104[49] = 0; + out_940131289488293104[50] = 0; + out_940131289488293104[51] = 0; + out_940131289488293104[52] = 0; + out_940131289488293104[53] = 0; } -void h_10(double *state, double *unused, double *out_1191620274986758585) { - out_1191620274986758585[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; - out_1191620274986758585[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; - out_1191620274986758585[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_8345234452777105931) { + out_8345234452777105931[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; + out_8345234452777105931[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; + out_8345234452777105931[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_1027777997724036985) { - out_1027777997724036985[0] = 0; - out_1027777997724036985[1] = 9.8100000000000005*cos(state[1]); - out_1027777997724036985[2] = 0; - out_1027777997724036985[3] = 0; - out_1027777997724036985[4] = -state[8]; - out_1027777997724036985[5] = state[7]; - out_1027777997724036985[6] = 0; - out_1027777997724036985[7] = state[5]; - out_1027777997724036985[8] = -state[4]; - out_1027777997724036985[9] = 0; - out_1027777997724036985[10] = 0; - out_1027777997724036985[11] = 0; - out_1027777997724036985[12] = 1; - out_1027777997724036985[13] = 0; - out_1027777997724036985[14] = 0; - out_1027777997724036985[15] = 1; - out_1027777997724036985[16] = 0; - out_1027777997724036985[17] = 0; - out_1027777997724036985[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); - out_1027777997724036985[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); - out_1027777997724036985[20] = 0; - out_1027777997724036985[21] = state[8]; - out_1027777997724036985[22] = 0; - out_1027777997724036985[23] = -state[6]; - out_1027777997724036985[24] = -state[5]; - out_1027777997724036985[25] = 0; - out_1027777997724036985[26] = state[3]; - out_1027777997724036985[27] = 0; - out_1027777997724036985[28] = 0; - out_1027777997724036985[29] = 0; - out_1027777997724036985[30] = 0; - out_1027777997724036985[31] = 1; - out_1027777997724036985[32] = 0; - out_1027777997724036985[33] = 0; - out_1027777997724036985[34] = 1; - out_1027777997724036985[35] = 0; - out_1027777997724036985[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); - out_1027777997724036985[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); - out_1027777997724036985[38] = 0; - out_1027777997724036985[39] = -state[7]; - out_1027777997724036985[40] = state[6]; - out_1027777997724036985[41] = 0; - out_1027777997724036985[42] = state[4]; - out_1027777997724036985[43] = -state[3]; - out_1027777997724036985[44] = 0; - out_1027777997724036985[45] = 0; - out_1027777997724036985[46] = 0; - out_1027777997724036985[47] = 0; - out_1027777997724036985[48] = 0; - out_1027777997724036985[49] = 0; - out_1027777997724036985[50] = 1; - out_1027777997724036985[51] = 0; - out_1027777997724036985[52] = 0; - out_1027777997724036985[53] = 1; +void H_10(double *state, double *unused, double *out_1248319787069001495) { + out_1248319787069001495[0] = 0; + out_1248319787069001495[1] = 9.8100000000000005*cos(state[1]); + out_1248319787069001495[2] = 0; + out_1248319787069001495[3] = 0; + out_1248319787069001495[4] = -state[8]; + out_1248319787069001495[5] = state[7]; + out_1248319787069001495[6] = 0; + out_1248319787069001495[7] = state[5]; + out_1248319787069001495[8] = -state[4]; + out_1248319787069001495[9] = 0; + out_1248319787069001495[10] = 0; + out_1248319787069001495[11] = 0; + out_1248319787069001495[12] = 1; + out_1248319787069001495[13] = 0; + out_1248319787069001495[14] = 0; + out_1248319787069001495[15] = 1; + out_1248319787069001495[16] = 0; + out_1248319787069001495[17] = 0; + out_1248319787069001495[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); + out_1248319787069001495[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); + out_1248319787069001495[20] = 0; + out_1248319787069001495[21] = state[8]; + out_1248319787069001495[22] = 0; + out_1248319787069001495[23] = -state[6]; + out_1248319787069001495[24] = -state[5]; + out_1248319787069001495[25] = 0; + out_1248319787069001495[26] = state[3]; + out_1248319787069001495[27] = 0; + out_1248319787069001495[28] = 0; + out_1248319787069001495[29] = 0; + out_1248319787069001495[30] = 0; + out_1248319787069001495[31] = 1; + out_1248319787069001495[32] = 0; + out_1248319787069001495[33] = 0; + out_1248319787069001495[34] = 1; + out_1248319787069001495[35] = 0; + out_1248319787069001495[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); + out_1248319787069001495[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); + out_1248319787069001495[38] = 0; + out_1248319787069001495[39] = -state[7]; + out_1248319787069001495[40] = state[6]; + out_1248319787069001495[41] = 0; + out_1248319787069001495[42] = state[4]; + out_1248319787069001495[43] = -state[3]; + out_1248319787069001495[44] = 0; + out_1248319787069001495[45] = 0; + out_1248319787069001495[46] = 0; + out_1248319787069001495[47] = 0; + out_1248319787069001495[48] = 0; + out_1248319787069001495[49] = 0; + out_1248319787069001495[50] = 1; + out_1248319787069001495[51] = 0; + out_1248319787069001495[52] = 0; + out_1248319787069001495[53] = 1; } -void h_13(double *state, double *unused, double *out_7783237198684558375) { - out_7783237198684558375[0] = state[3]; - out_7783237198684558375[1] = state[4]; - out_7783237198684558375[2] = state[5]; +void h_13(double *state, double *unused, double *out_1047798615184752827) { + out_1047798615184752827[0] = state[3]; + out_1047798615184752827[1] = state[4]; + out_1047798615184752827[2] = state[5]; } -void H_13(double *state, double *unused, double *out_2200947816862544160) { - out_2200947816862544160[0] = 0; - out_2200947816862544160[1] = 0; - out_2200947816862544160[2] = 0; - out_2200947816862544160[3] = 1; - out_2200947816862544160[4] = 0; - out_2200947816862544160[5] = 0; - out_2200947816862544160[6] = 0; - out_2200947816862544160[7] = 0; - out_2200947816862544160[8] = 0; - out_2200947816862544160[9] = 0; - out_2200947816862544160[10] = 0; - out_2200947816862544160[11] = 0; - out_2200947816862544160[12] = 0; - out_2200947816862544160[13] = 0; - out_2200947816862544160[14] = 0; - out_2200947816862544160[15] = 0; - out_2200947816862544160[16] = 0; - out_2200947816862544160[17] = 0; - out_2200947816862544160[18] = 0; - out_2200947816862544160[19] = 0; - out_2200947816862544160[20] = 0; - out_2200947816862544160[21] = 0; - out_2200947816862544160[22] = 1; - out_2200947816862544160[23] = 0; - out_2200947816862544160[24] = 0; - out_2200947816862544160[25] = 0; - out_2200947816862544160[26] = 0; - out_2200947816862544160[27] = 0; - out_2200947816862544160[28] = 0; - out_2200947816862544160[29] = 0; - out_2200947816862544160[30] = 0; - out_2200947816862544160[31] = 0; - out_2200947816862544160[32] = 0; - out_2200947816862544160[33] = 0; - out_2200947816862544160[34] = 0; - out_2200947816862544160[35] = 0; - out_2200947816862544160[36] = 0; - out_2200947816862544160[37] = 0; - out_2200947816862544160[38] = 0; - out_2200947816862544160[39] = 0; - out_2200947816862544160[40] = 0; - out_2200947816862544160[41] = 1; - out_2200947816862544160[42] = 0; - out_2200947816862544160[43] = 0; - out_2200947816862544160[44] = 0; - out_2200947816862544160[45] = 0; - out_2200947816862544160[46] = 0; - out_2200947816862544160[47] = 0; - out_2200947816862544160[48] = 0; - out_2200947816862544160[49] = 0; - out_2200947816862544160[50] = 0; - out_2200947816862544160[51] = 0; - out_2200947816862544160[52] = 0; - out_2200947816862544160[53] = 0; +void H_13(double *state, double *unused, double *out_375529369806449000) { + out_375529369806449000[0] = 0; + out_375529369806449000[1] = 0; + out_375529369806449000[2] = 0; + out_375529369806449000[3] = 1; + out_375529369806449000[4] = 0; + out_375529369806449000[5] = 0; + out_375529369806449000[6] = 0; + out_375529369806449000[7] = 0; + out_375529369806449000[8] = 0; + out_375529369806449000[9] = 0; + out_375529369806449000[10] = 0; + out_375529369806449000[11] = 0; + out_375529369806449000[12] = 0; + out_375529369806449000[13] = 0; + out_375529369806449000[14] = 0; + out_375529369806449000[15] = 0; + out_375529369806449000[16] = 0; + out_375529369806449000[17] = 0; + out_375529369806449000[18] = 0; + out_375529369806449000[19] = 0; + out_375529369806449000[20] = 0; + out_375529369806449000[21] = 0; + out_375529369806449000[22] = 1; + out_375529369806449000[23] = 0; + out_375529369806449000[24] = 0; + out_375529369806449000[25] = 0; + out_375529369806449000[26] = 0; + out_375529369806449000[27] = 0; + out_375529369806449000[28] = 0; + out_375529369806449000[29] = 0; + out_375529369806449000[30] = 0; + out_375529369806449000[31] = 0; + out_375529369806449000[32] = 0; + out_375529369806449000[33] = 0; + out_375529369806449000[34] = 0; + out_375529369806449000[35] = 0; + out_375529369806449000[36] = 0; + out_375529369806449000[37] = 0; + out_375529369806449000[38] = 0; + out_375529369806449000[39] = 0; + out_375529369806449000[40] = 0; + out_375529369806449000[41] = 1; + out_375529369806449000[42] = 0; + out_375529369806449000[43] = 0; + out_375529369806449000[44] = 0; + out_375529369806449000[45] = 0; + out_375529369806449000[46] = 0; + out_375529369806449000[47] = 0; + out_375529369806449000[48] = 0; + out_375529369806449000[49] = 0; + out_375529369806449000[50] = 0; + out_375529369806449000[51] = 0; + out_375529369806449000[52] = 0; + out_375529369806449000[53] = 0; } -void h_14(double *state, double *unused, double *out_1027602586512413166) { - out_1027602586512413166[0] = state[6]; - out_1027602586512413166[1] = state[7]; - out_1027602586512413166[2] = state[8]; +void h_14(double *state, double *unused, double *out_4235679239024063539) { + out_4235679239024063539[0] = state[6]; + out_4235679239024063539[1] = state[7]; + out_4235679239024063539[2] = state[8]; } -void H_14(double *state, double *unused, double *out_1449980785855392432) { - out_1449980785855392432[0] = 0; - out_1449980785855392432[1] = 0; - out_1449980785855392432[2] = 0; - out_1449980785855392432[3] = 0; - out_1449980785855392432[4] = 0; - out_1449980785855392432[5] = 0; - out_1449980785855392432[6] = 1; - out_1449980785855392432[7] = 0; - out_1449980785855392432[8] = 0; - out_1449980785855392432[9] = 0; - out_1449980785855392432[10] = 0; - out_1449980785855392432[11] = 0; - out_1449980785855392432[12] = 0; - out_1449980785855392432[13] = 0; - out_1449980785855392432[14] = 0; - out_1449980785855392432[15] = 0; - out_1449980785855392432[16] = 0; - out_1449980785855392432[17] = 0; - out_1449980785855392432[18] = 0; - out_1449980785855392432[19] = 0; - out_1449980785855392432[20] = 0; - out_1449980785855392432[21] = 0; - out_1449980785855392432[22] = 0; - out_1449980785855392432[23] = 0; - out_1449980785855392432[24] = 0; - out_1449980785855392432[25] = 1; - out_1449980785855392432[26] = 0; - out_1449980785855392432[27] = 0; - out_1449980785855392432[28] = 0; - out_1449980785855392432[29] = 0; - out_1449980785855392432[30] = 0; - out_1449980785855392432[31] = 0; - out_1449980785855392432[32] = 0; - out_1449980785855392432[33] = 0; - out_1449980785855392432[34] = 0; - out_1449980785855392432[35] = 0; - out_1449980785855392432[36] = 0; - out_1449980785855392432[37] = 0; - out_1449980785855392432[38] = 0; - out_1449980785855392432[39] = 0; - out_1449980785855392432[40] = 0; - out_1449980785855392432[41] = 0; - out_1449980785855392432[42] = 0; - out_1449980785855392432[43] = 0; - out_1449980785855392432[44] = 1; - out_1449980785855392432[45] = 0; - out_1449980785855392432[46] = 0; - out_1449980785855392432[47] = 0; - out_1449980785855392432[48] = 0; - out_1449980785855392432[49] = 0; - out_1449980785855392432[50] = 0; - out_1449980785855392432[51] = 0; - out_1449980785855392432[52] = 0; - out_1449980785855392432[53] = 0; +void H_14(double *state, double *unused, double *out_4022919721783665400) { + out_4022919721783665400[0] = 0; + out_4022919721783665400[1] = 0; + out_4022919721783665400[2] = 0; + out_4022919721783665400[3] = 0; + out_4022919721783665400[4] = 0; + out_4022919721783665400[5] = 0; + out_4022919721783665400[6] = 1; + out_4022919721783665400[7] = 0; + out_4022919721783665400[8] = 0; + out_4022919721783665400[9] = 0; + out_4022919721783665400[10] = 0; + out_4022919721783665400[11] = 0; + out_4022919721783665400[12] = 0; + out_4022919721783665400[13] = 0; + out_4022919721783665400[14] = 0; + out_4022919721783665400[15] = 0; + out_4022919721783665400[16] = 0; + out_4022919721783665400[17] = 0; + out_4022919721783665400[18] = 0; + out_4022919721783665400[19] = 0; + out_4022919721783665400[20] = 0; + out_4022919721783665400[21] = 0; + out_4022919721783665400[22] = 0; + out_4022919721783665400[23] = 0; + out_4022919721783665400[24] = 0; + out_4022919721783665400[25] = 1; + out_4022919721783665400[26] = 0; + out_4022919721783665400[27] = 0; + out_4022919721783665400[28] = 0; + out_4022919721783665400[29] = 0; + out_4022919721783665400[30] = 0; + out_4022919721783665400[31] = 0; + out_4022919721783665400[32] = 0; + out_4022919721783665400[33] = 0; + out_4022919721783665400[34] = 0; + out_4022919721783665400[35] = 0; + out_4022919721783665400[36] = 0; + out_4022919721783665400[37] = 0; + out_4022919721783665400[38] = 0; + out_4022919721783665400[39] = 0; + out_4022919721783665400[40] = 0; + out_4022919721783665400[41] = 0; + out_4022919721783665400[42] = 0; + out_4022919721783665400[43] = 0; + out_4022919721783665400[44] = 1; + out_4022919721783665400[45] = 0; + out_4022919721783665400[46] = 0; + out_4022919721783665400[47] = 0; + out_4022919721783665400[48] = 0; + out_4022919721783665400[49] = 0; + out_4022919721783665400[50] = 0; + out_4022919721783665400[51] = 0; + out_4022919721783665400[52] = 0; + out_4022919721783665400[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_5912021845748559900) { - err_fun(nom_x, delta_x, out_5912021845748559900); +void pose_err_fun(double *nom_x, double *delta_x, double *out_2521549048397866319) { + err_fun(nom_x, delta_x, out_2521549048397866319); } -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_8843896357291937735) { - inv_err_fun(nom_x, true_x, out_8843896357291937735); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_4368796387448451064) { + inv_err_fun(nom_x, true_x, out_4368796387448451064); } -void pose_H_mod_fun(double *state, double *out_2688320196777535589) { - H_mod_fun(state, out_2688320196777535589); +void pose_H_mod_fun(double *state, double *out_4711938499332200676) { + H_mod_fun(state, out_4711938499332200676); } -void pose_f_fun(double *state, double dt, double *out_650263676124789422) { - f_fun(state, dt, out_650263676124789422); +void pose_f_fun(double *state, double dt, double *out_3583623669529018238) { + f_fun(state, dt, out_3583623669529018238); } -void pose_F_fun(double *state, double dt, double *out_7315646842237993430) { - F_fun(state, dt, out_7315646842237993430); +void pose_F_fun(double *state, double dt, double *out_147281941884768427) { + F_fun(state, dt, out_147281941884768427); } -void pose_h_4(double *state, double *unused, double *out_2905496685476842828) { - h_4(state, unused, out_2905496685476842828); +void pose_h_4(double *state, double *unused, double *out_8338357592566013610) { + h_4(state, unused, out_8338357592566013610); } -void pose_H_4(double *state, double *unused, double *out_5413221642194876961) { - H_4(state, unused, out_5413221642194876961); +void pose_H_4(double *state, double *unused, double *out_940131289488293104) { + H_4(state, unused, out_940131289488293104); } -void pose_h_10(double *state, double *unused, double *out_1191620274986758585) { - h_10(state, unused, out_1191620274986758585); +void pose_h_10(double *state, double *unused, double *out_8345234452777105931) { + h_10(state, unused, out_8345234452777105931); } -void pose_H_10(double *state, double *unused, double *out_1027777997724036985) { - H_10(state, unused, out_1027777997724036985); +void pose_H_10(double *state, double *unused, double *out_1248319787069001495) { + H_10(state, unused, out_1248319787069001495); } -void pose_h_13(double *state, double *unused, double *out_7783237198684558375) { - h_13(state, unused, out_7783237198684558375); +void pose_h_13(double *state, double *unused, double *out_1047798615184752827) { + h_13(state, unused, out_1047798615184752827); } -void pose_H_13(double *state, double *unused, double *out_2200947816862544160) { - H_13(state, unused, out_2200947816862544160); +void pose_H_13(double *state, double *unused, double *out_375529369806449000) { + H_13(state, unused, out_375529369806449000); } -void pose_h_14(double *state, double *unused, double *out_1027602586512413166) { - h_14(state, unused, out_1027602586512413166); +void pose_h_14(double *state, double *unused, double *out_4235679239024063539) { + h_14(state, unused, out_4235679239024063539); } -void pose_H_14(double *state, double *unused, double *out_1449980785855392432) { - H_14(state, unused, out_1449980785855392432); +void pose_H_14(double *state, double *unused, double *out_4022919721783665400) { + H_14(state, unused, out_4022919721783665400); } 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/openpilot/selfdrive/locationd/models/generated/pose.h b/openpilot/selfdrive/locationd/models/generated/pose.h index 49896d141c..00fb226953 100644 --- a/openpilot/selfdrive/locationd/models/generated/pose.h +++ b/openpilot/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_5912021845748559900); -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_8843896357291937735); -void pose_H_mod_fun(double *state, double *out_2688320196777535589); -void pose_f_fun(double *state, double dt, double *out_650263676124789422); -void pose_F_fun(double *state, double dt, double *out_7315646842237993430); -void pose_h_4(double *state, double *unused, double *out_2905496685476842828); -void pose_H_4(double *state, double *unused, double *out_5413221642194876961); -void pose_h_10(double *state, double *unused, double *out_1191620274986758585); -void pose_H_10(double *state, double *unused, double *out_1027777997724036985); -void pose_h_13(double *state, double *unused, double *out_7783237198684558375); -void pose_H_13(double *state, double *unused, double *out_2200947816862544160); -void pose_h_14(double *state, double *unused, double *out_1027602586512413166); -void pose_H_14(double *state, double *unused, double *out_1449980785855392432); +void pose_err_fun(double *nom_x, double *delta_x, double *out_2521549048397866319); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_4368796387448451064); +void pose_H_mod_fun(double *state, double *out_4711938499332200676); +void pose_f_fun(double *state, double dt, double *out_3583623669529018238); +void pose_F_fun(double *state, double dt, double *out_147281941884768427); +void pose_h_4(double *state, double *unused, double *out_8338357592566013610); +void pose_H_4(double *state, double *unused, double *out_940131289488293104); +void pose_h_10(double *state, double *unused, double *out_8345234452777105931); +void pose_H_10(double *state, double *unused, double *out_1248319787069001495); +void pose_h_13(double *state, double *unused, double *out_1047798615184752827); +void pose_H_13(double *state, double *unused, double *out_375529369806449000); +void pose_h_14(double *state, double *unused, double *out_4235679239024063539); +void pose_H_14(double *state, double *unused, double *out_4022919721783665400); void pose_predict(double *in_x, double *in_P, double *in_Q, double dt); } \ No newline at end of file diff --git a/panda/board/obj/body_h7.bin.signed b/panda/board/obj/body_h7.bin.signed index a1c34e6508..8a7272b83a 100644 Binary files a/panda/board/obj/body_h7.bin.signed and b/panda/board/obj/body_h7.bin.signed differ diff --git a/panda/board/obj/bootstub.body_h7.bin b/panda/board/obj/bootstub.body_h7.bin index c3fb78d7c4..c1e915be76 100644 Binary files a/panda/board/obj/bootstub.body_h7.bin and b/panda/board/obj/bootstub.body_h7.bin differ diff --git a/panda/board/obj/bootstub.panda.bin b/panda/board/obj/bootstub.panda.bin index 33f9595068..01a62e0ea6 100644 Binary files a/panda/board/obj/bootstub.panda.bin and b/panda/board/obj/bootstub.panda.bin differ diff --git a/panda/board/obj/bootstub.panda_can_ignition_only.bin b/panda/board/obj/bootstub.panda_can_ignition_only.bin index 33f9595068..01a62e0ea6 100644 Binary files a/panda/board/obj/bootstub.panda_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_h7.bin b/panda/board/obj/bootstub.panda_h7.bin index 93f718bd68..7adbc26d40 100644 Binary files a/panda/board/obj/bootstub.panda_h7.bin and b/panda/board/obj/bootstub.panda_h7.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin index 93f718bd68..7adbc26d40 100644 Binary files a/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_hkg_remote.bin b/panda/board/obj/bootstub.panda_h7_hkg_remote.bin index 93f718bd68..7adbc26d40 100644 Binary files a/panda/board/obj/bootstub.panda_h7_hkg_remote.bin and b/panda/board/obj/bootstub.panda_h7_hkg_remote.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin index 93f718bd68..7adbc26d40 100644 Binary files a/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_remote.bin b/panda/board/obj/bootstub.panda_h7_remote.bin index 93f718bd68..7adbc26d40 100644 Binary files a/panda/board/obj/bootstub.panda_h7_remote.bin and b/panda/board/obj/bootstub.panda_h7_remote.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin index 93f718bd68..7adbc26d40 100644 Binary files a/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_tesla_wake.bin b/panda/board/obj/bootstub.panda_h7_tesla_wake.bin index 93f718bd68..7adbc26d40 100644 Binary files a/panda/board/obj/bootstub.panda_h7_tesla_wake.bin and b/panda/board/obj/bootstub.panda_h7_tesla_wake.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_tesla_wake_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_tesla_wake_can_ignition_only.bin index 93f718bd68..7adbc26d40 100644 Binary files a/panda/board/obj/bootstub.panda_h7_tesla_wake_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_h7_tesla_wake_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_hkg_remote.bin b/panda/board/obj/bootstub.panda_hkg_remote.bin index 33f9595068..01a62e0ea6 100644 Binary files a/panda/board/obj/bootstub.panda_hkg_remote.bin and b/panda/board/obj/bootstub.panda_hkg_remote.bin differ diff --git a/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin index 33f9595068..01a62e0ea6 100644 Binary files a/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_remote.bin b/panda/board/obj/bootstub.panda_remote.bin index 33f9595068..01a62e0ea6 100644 Binary files a/panda/board/obj/bootstub.panda_remote.bin and b/panda/board/obj/bootstub.panda_remote.bin differ diff --git a/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin index 33f9595068..01a62e0ea6 100644 Binary files a/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_tesla_wake.bin b/panda/board/obj/bootstub.panda_tesla_wake.bin index 33f9595068..01a62e0ea6 100644 Binary files a/panda/board/obj/bootstub.panda_tesla_wake.bin and b/panda/board/obj/bootstub.panda_tesla_wake.bin differ diff --git a/panda/board/obj/bootstub.panda_tesla_wake_can_ignition_only.bin b/panda/board/obj/bootstub.panda_tesla_wake_can_ignition_only.bin index 33f9595068..01a62e0ea6 100644 Binary files a/panda/board/obj/bootstub.panda_tesla_wake_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_tesla_wake_can_ignition_only.bin differ diff --git a/panda/board/obj/gitversion.h b/panda/board/obj/gitversion.h index b3fd7b1de3..e844548dd0 100644 --- a/panda/board/obj/gitversion.h +++ b/panda/board/obj/gitversion.h @@ -1,4 +1,4 @@ #pragma once extern const uint8_t gitversion[29]; -const uint8_t gitversion[29] = "DEV-46fdb2d8-Pf38f504f-DEBUG"; +const uint8_t gitversion[29] = "DEV-5114f466-Pf38f504f-DEBUG"; diff --git a/panda/board/obj/panda.bin.signed b/panda/board/obj/panda.bin.signed index 92d8415ae2..053f29f5e1 100644 Binary files a/panda/board/obj/panda.bin.signed and b/panda/board/obj/panda.bin.signed differ diff --git a/panda/board/obj/panda_can_ignition_only.bin.signed b/panda/board/obj/panda_can_ignition_only.bin.signed index 7cbc12455a..263dff3d13 100644 Binary files a/panda/board/obj/panda_can_ignition_only.bin.signed and b/panda/board/obj/panda_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_h7.bin.signed b/panda/board/obj/panda_h7.bin.signed index 3b7c8b4c7a..910b6d8b60 100644 Binary files a/panda/board/obj/panda_h7.bin.signed and b/panda/board/obj/panda_h7.bin.signed differ diff --git a/panda/board/obj/panda_h7_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_can_ignition_only.bin.signed index 9868590b87..5d3693bdac 100644 Binary files a/panda/board/obj/panda_h7_can_ignition_only.bin.signed and b/panda/board/obj/panda_h7_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_h7_hkg_remote.bin.signed b/panda/board/obj/panda_h7_hkg_remote.bin.signed index bf2a0056a8..861c32272a 100644 Binary files a/panda/board/obj/panda_h7_hkg_remote.bin.signed and b/panda/board/obj/panda_h7_hkg_remote.bin.signed differ diff --git a/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed index 272fc7ef21..bd3abf5ce9 100644 Binary files a/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed and b/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_h7_remote.bin.signed b/panda/board/obj/panda_h7_remote.bin.signed index 2698f22360..dd566d8d92 100644 Binary files a/panda/board/obj/panda_h7_remote.bin.signed and b/panda/board/obj/panda_h7_remote.bin.signed differ diff --git a/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed index 52dfaec7a8..d5a180b6b9 100644 Binary files a/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed and b/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_h7_tesla_wake.bin.signed b/panda/board/obj/panda_h7_tesla_wake.bin.signed index a51d191db1..4c2549ea5d 100644 Binary files a/panda/board/obj/panda_h7_tesla_wake.bin.signed and b/panda/board/obj/panda_h7_tesla_wake.bin.signed differ diff --git a/panda/board/obj/panda_h7_tesla_wake_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_tesla_wake_can_ignition_only.bin.signed index 3ce274f391..4d401e1cef 100644 Binary files a/panda/board/obj/panda_h7_tesla_wake_can_ignition_only.bin.signed and b/panda/board/obj/panda_h7_tesla_wake_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_hkg_remote.bin.signed b/panda/board/obj/panda_hkg_remote.bin.signed index 0118ad9ab3..a1a4f47e2c 100644 Binary files a/panda/board/obj/panda_hkg_remote.bin.signed and b/panda/board/obj/panda_hkg_remote.bin.signed differ diff --git a/panda/board/obj/panda_hkg_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_hkg_remote_can_ignition_only.bin.signed index e4f50cc1d4..9e8258f700 100644 Binary files a/panda/board/obj/panda_hkg_remote_can_ignition_only.bin.signed and b/panda/board/obj/panda_hkg_remote_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_remote.bin.signed b/panda/board/obj/panda_remote.bin.signed index 726ac5864b..b2b1495687 100644 Binary files a/panda/board/obj/panda_remote.bin.signed and b/panda/board/obj/panda_remote.bin.signed differ diff --git a/panda/board/obj/panda_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_remote_can_ignition_only.bin.signed index fb8d96f847..1575cec69f 100644 Binary files a/panda/board/obj/panda_remote_can_ignition_only.bin.signed and b/panda/board/obj/panda_remote_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_tesla_wake.bin.signed b/panda/board/obj/panda_tesla_wake.bin.signed index 9dc0d07d59..a6524ecee1 100644 Binary files a/panda/board/obj/panda_tesla_wake.bin.signed and b/panda/board/obj/panda_tesla_wake.bin.signed differ diff --git a/panda/board/obj/panda_tesla_wake_can_ignition_only.bin.signed b/panda/board/obj/panda_tesla_wake_can_ignition_only.bin.signed index 3827f7e873..d2b447682a 100644 Binary files a/panda/board/obj/panda_tesla_wake_can_ignition_only.bin.signed and b/panda/board/obj/panda_tesla_wake_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/version b/panda/board/obj/version index 59e30c646b..e602cb3fc9 100644 --- a/panda/board/obj/version +++ b/panda/board/obj/version @@ -1 +1 @@ -DEV-46fdb2d8-Pf38f504f-DEBUG \ No newline at end of file +DEV-5114f466-Pf38f504f-DEBUG \ No newline at end of file diff --git a/prebuilt.json b/prebuilt.json index 07589ed83c..a811240241 100644 --- a/prebuilt.json +++ b/prebuilt.json @@ -1 +1 @@ -{"protected_inventory_sha256": "757c8498e732d366dd42351205a7c16d119d8c6e956816a5ae46ee6a786c6cb4", "schema_version": 1} +{"protected_inventory_sha256": "f93faae2636d10177c5b2f99480fcc4f5709bbe74a90d44ca029e6e7526075b7", "schema_version": 1}