diff --git a/openpilot/selfdrive/locationd/models/generated/car.cpp b/openpilot/selfdrive/locationd/models/generated/car.cpp index b459a81eb8..88ffce511c 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_191040875433637227) { - out_191040875433637227[0] = delta_x[0] + nom_x[0]; - out_191040875433637227[1] = delta_x[1] + nom_x[1]; - out_191040875433637227[2] = delta_x[2] + nom_x[2]; - out_191040875433637227[3] = delta_x[3] + nom_x[3]; - out_191040875433637227[4] = delta_x[4] + nom_x[4]; - out_191040875433637227[5] = delta_x[5] + nom_x[5]; - out_191040875433637227[6] = delta_x[6] + nom_x[6]; - out_191040875433637227[7] = delta_x[7] + nom_x[7]; - out_191040875433637227[8] = delta_x[8] + nom_x[8]; +void err_fun(double *nom_x, double *delta_x, double *out_2204053027494663001) { + out_2204053027494663001[0] = delta_x[0] + nom_x[0]; + out_2204053027494663001[1] = delta_x[1] + nom_x[1]; + out_2204053027494663001[2] = delta_x[2] + nom_x[2]; + out_2204053027494663001[3] = delta_x[3] + nom_x[3]; + out_2204053027494663001[4] = delta_x[4] + nom_x[4]; + out_2204053027494663001[5] = delta_x[5] + nom_x[5]; + out_2204053027494663001[6] = delta_x[6] + nom_x[6]; + out_2204053027494663001[7] = delta_x[7] + nom_x[7]; + out_2204053027494663001[8] = delta_x[8] + nom_x[8]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_449478399145670770) { - out_449478399145670770[0] = -nom_x[0] + true_x[0]; - out_449478399145670770[1] = -nom_x[1] + true_x[1]; - out_449478399145670770[2] = -nom_x[2] + true_x[2]; - out_449478399145670770[3] = -nom_x[3] + true_x[3]; - out_449478399145670770[4] = -nom_x[4] + true_x[4]; - out_449478399145670770[5] = -nom_x[5] + true_x[5]; - out_449478399145670770[6] = -nom_x[6] + true_x[6]; - out_449478399145670770[7] = -nom_x[7] + true_x[7]; - out_449478399145670770[8] = -nom_x[8] + true_x[8]; +void inv_err_fun(double *nom_x, double *true_x, double *out_2041279983635365065) { + out_2041279983635365065[0] = -nom_x[0] + true_x[0]; + out_2041279983635365065[1] = -nom_x[1] + true_x[1]; + out_2041279983635365065[2] = -nom_x[2] + true_x[2]; + out_2041279983635365065[3] = -nom_x[3] + true_x[3]; + out_2041279983635365065[4] = -nom_x[4] + true_x[4]; + out_2041279983635365065[5] = -nom_x[5] + true_x[5]; + out_2041279983635365065[6] = -nom_x[6] + true_x[6]; + out_2041279983635365065[7] = -nom_x[7] + true_x[7]; + out_2041279983635365065[8] = -nom_x[8] + true_x[8]; } -void H_mod_fun(double *state, double *out_2217112053847292599) { - out_2217112053847292599[0] = 1.0; - out_2217112053847292599[1] = 0.0; - out_2217112053847292599[2] = 0.0; - out_2217112053847292599[3] = 0.0; - out_2217112053847292599[4] = 0.0; - out_2217112053847292599[5] = 0.0; - out_2217112053847292599[6] = 0.0; - out_2217112053847292599[7] = 0.0; - out_2217112053847292599[8] = 0.0; - out_2217112053847292599[9] = 0.0; - out_2217112053847292599[10] = 1.0; - out_2217112053847292599[11] = 0.0; - out_2217112053847292599[12] = 0.0; - out_2217112053847292599[13] = 0.0; - out_2217112053847292599[14] = 0.0; - out_2217112053847292599[15] = 0.0; - out_2217112053847292599[16] = 0.0; - out_2217112053847292599[17] = 0.0; - out_2217112053847292599[18] = 0.0; - out_2217112053847292599[19] = 0.0; - out_2217112053847292599[20] = 1.0; - out_2217112053847292599[21] = 0.0; - out_2217112053847292599[22] = 0.0; - out_2217112053847292599[23] = 0.0; - out_2217112053847292599[24] = 0.0; - out_2217112053847292599[25] = 0.0; - out_2217112053847292599[26] = 0.0; - out_2217112053847292599[27] = 0.0; - out_2217112053847292599[28] = 0.0; - out_2217112053847292599[29] = 0.0; - out_2217112053847292599[30] = 1.0; - out_2217112053847292599[31] = 0.0; - out_2217112053847292599[32] = 0.0; - out_2217112053847292599[33] = 0.0; - out_2217112053847292599[34] = 0.0; - out_2217112053847292599[35] = 0.0; - out_2217112053847292599[36] = 0.0; - out_2217112053847292599[37] = 0.0; - out_2217112053847292599[38] = 0.0; - out_2217112053847292599[39] = 0.0; - out_2217112053847292599[40] = 1.0; - out_2217112053847292599[41] = 0.0; - out_2217112053847292599[42] = 0.0; - out_2217112053847292599[43] = 0.0; - out_2217112053847292599[44] = 0.0; - out_2217112053847292599[45] = 0.0; - out_2217112053847292599[46] = 0.0; - out_2217112053847292599[47] = 0.0; - out_2217112053847292599[48] = 0.0; - out_2217112053847292599[49] = 0.0; - out_2217112053847292599[50] = 1.0; - out_2217112053847292599[51] = 0.0; - out_2217112053847292599[52] = 0.0; - out_2217112053847292599[53] = 0.0; - out_2217112053847292599[54] = 0.0; - out_2217112053847292599[55] = 0.0; - out_2217112053847292599[56] = 0.0; - out_2217112053847292599[57] = 0.0; - out_2217112053847292599[58] = 0.0; - out_2217112053847292599[59] = 0.0; - out_2217112053847292599[60] = 1.0; - out_2217112053847292599[61] = 0.0; - out_2217112053847292599[62] = 0.0; - out_2217112053847292599[63] = 0.0; - out_2217112053847292599[64] = 0.0; - out_2217112053847292599[65] = 0.0; - out_2217112053847292599[66] = 0.0; - out_2217112053847292599[67] = 0.0; - out_2217112053847292599[68] = 0.0; - out_2217112053847292599[69] = 0.0; - out_2217112053847292599[70] = 1.0; - out_2217112053847292599[71] = 0.0; - out_2217112053847292599[72] = 0.0; - out_2217112053847292599[73] = 0.0; - out_2217112053847292599[74] = 0.0; - out_2217112053847292599[75] = 0.0; - out_2217112053847292599[76] = 0.0; - out_2217112053847292599[77] = 0.0; - out_2217112053847292599[78] = 0.0; - out_2217112053847292599[79] = 0.0; - out_2217112053847292599[80] = 1.0; +void H_mod_fun(double *state, double *out_7031372799249316450) { + out_7031372799249316450[0] = 1.0; + out_7031372799249316450[1] = 0.0; + out_7031372799249316450[2] = 0.0; + out_7031372799249316450[3] = 0.0; + out_7031372799249316450[4] = 0.0; + out_7031372799249316450[5] = 0.0; + out_7031372799249316450[6] = 0.0; + out_7031372799249316450[7] = 0.0; + out_7031372799249316450[8] = 0.0; + out_7031372799249316450[9] = 0.0; + out_7031372799249316450[10] = 1.0; + out_7031372799249316450[11] = 0.0; + out_7031372799249316450[12] = 0.0; + out_7031372799249316450[13] = 0.0; + out_7031372799249316450[14] = 0.0; + out_7031372799249316450[15] = 0.0; + out_7031372799249316450[16] = 0.0; + out_7031372799249316450[17] = 0.0; + out_7031372799249316450[18] = 0.0; + out_7031372799249316450[19] = 0.0; + out_7031372799249316450[20] = 1.0; + out_7031372799249316450[21] = 0.0; + out_7031372799249316450[22] = 0.0; + out_7031372799249316450[23] = 0.0; + out_7031372799249316450[24] = 0.0; + out_7031372799249316450[25] = 0.0; + out_7031372799249316450[26] = 0.0; + out_7031372799249316450[27] = 0.0; + out_7031372799249316450[28] = 0.0; + out_7031372799249316450[29] = 0.0; + out_7031372799249316450[30] = 1.0; + out_7031372799249316450[31] = 0.0; + out_7031372799249316450[32] = 0.0; + out_7031372799249316450[33] = 0.0; + out_7031372799249316450[34] = 0.0; + out_7031372799249316450[35] = 0.0; + out_7031372799249316450[36] = 0.0; + out_7031372799249316450[37] = 0.0; + out_7031372799249316450[38] = 0.0; + out_7031372799249316450[39] = 0.0; + out_7031372799249316450[40] = 1.0; + out_7031372799249316450[41] = 0.0; + out_7031372799249316450[42] = 0.0; + out_7031372799249316450[43] = 0.0; + out_7031372799249316450[44] = 0.0; + out_7031372799249316450[45] = 0.0; + out_7031372799249316450[46] = 0.0; + out_7031372799249316450[47] = 0.0; + out_7031372799249316450[48] = 0.0; + out_7031372799249316450[49] = 0.0; + out_7031372799249316450[50] = 1.0; + out_7031372799249316450[51] = 0.0; + out_7031372799249316450[52] = 0.0; + out_7031372799249316450[53] = 0.0; + out_7031372799249316450[54] = 0.0; + out_7031372799249316450[55] = 0.0; + out_7031372799249316450[56] = 0.0; + out_7031372799249316450[57] = 0.0; + out_7031372799249316450[58] = 0.0; + out_7031372799249316450[59] = 0.0; + out_7031372799249316450[60] = 1.0; + out_7031372799249316450[61] = 0.0; + out_7031372799249316450[62] = 0.0; + out_7031372799249316450[63] = 0.0; + out_7031372799249316450[64] = 0.0; + out_7031372799249316450[65] = 0.0; + out_7031372799249316450[66] = 0.0; + out_7031372799249316450[67] = 0.0; + out_7031372799249316450[68] = 0.0; + out_7031372799249316450[69] = 0.0; + out_7031372799249316450[70] = 1.0; + out_7031372799249316450[71] = 0.0; + out_7031372799249316450[72] = 0.0; + out_7031372799249316450[73] = 0.0; + out_7031372799249316450[74] = 0.0; + out_7031372799249316450[75] = 0.0; + out_7031372799249316450[76] = 0.0; + out_7031372799249316450[77] = 0.0; + out_7031372799249316450[78] = 0.0; + out_7031372799249316450[79] = 0.0; + out_7031372799249316450[80] = 1.0; } -void f_fun(double *state, double dt, double *out_5425352922863285243) { - out_5425352922863285243[0] = state[0]; - out_5425352922863285243[1] = state[1]; - out_5425352922863285243[2] = state[2]; - out_5425352922863285243[3] = state[3]; - out_5425352922863285243[4] = state[4]; - out_5425352922863285243[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_5425352922863285243[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_5425352922863285243[7] = state[7]; - out_5425352922863285243[8] = state[8]; +void f_fun(double *state, double dt, double *out_1116747486686820994) { + out_1116747486686820994[0] = state[0]; + out_1116747486686820994[1] = state[1]; + out_1116747486686820994[2] = state[2]; + out_1116747486686820994[3] = state[3]; + out_1116747486686820994[4] = state[4]; + out_1116747486686820994[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_1116747486686820994[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_1116747486686820994[7] = state[7]; + out_1116747486686820994[8] = state[8]; } -void F_fun(double *state, double dt, double *out_5183523293737892740) { - out_5183523293737892740[0] = 1; - out_5183523293737892740[1] = 0; - out_5183523293737892740[2] = 0; - out_5183523293737892740[3] = 0; - out_5183523293737892740[4] = 0; - out_5183523293737892740[5] = 0; - out_5183523293737892740[6] = 0; - out_5183523293737892740[7] = 0; - out_5183523293737892740[8] = 0; - out_5183523293737892740[9] = 0; - out_5183523293737892740[10] = 1; - out_5183523293737892740[11] = 0; - out_5183523293737892740[12] = 0; - out_5183523293737892740[13] = 0; - out_5183523293737892740[14] = 0; - out_5183523293737892740[15] = 0; - out_5183523293737892740[16] = 0; - out_5183523293737892740[17] = 0; - out_5183523293737892740[18] = 0; - out_5183523293737892740[19] = 0; - out_5183523293737892740[20] = 1; - out_5183523293737892740[21] = 0; - out_5183523293737892740[22] = 0; - out_5183523293737892740[23] = 0; - out_5183523293737892740[24] = 0; - out_5183523293737892740[25] = 0; - out_5183523293737892740[26] = 0; - out_5183523293737892740[27] = 0; - out_5183523293737892740[28] = 0; - out_5183523293737892740[29] = 0; - out_5183523293737892740[30] = 1; - out_5183523293737892740[31] = 0; - out_5183523293737892740[32] = 0; - out_5183523293737892740[33] = 0; - out_5183523293737892740[34] = 0; - out_5183523293737892740[35] = 0; - out_5183523293737892740[36] = 0; - out_5183523293737892740[37] = 0; - out_5183523293737892740[38] = 0; - out_5183523293737892740[39] = 0; - out_5183523293737892740[40] = 1; - out_5183523293737892740[41] = 0; - out_5183523293737892740[42] = 0; - out_5183523293737892740[43] = 0; - out_5183523293737892740[44] = 0; - out_5183523293737892740[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_5183523293737892740[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); - out_5183523293737892740[47] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_5183523293737892740[48] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_5183523293737892740[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_5183523293737892740[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; - out_5183523293737892740[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); - out_5183523293737892740[52] = dt*stiffness_front*state[0]/(mass*state[1]); - out_5183523293737892740[53] = -9.8100000000000005*dt; - out_5183523293737892740[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_5183523293737892740[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); - out_5183523293737892740[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_5183523293737892740[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_5183523293737892740[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_5183523293737892740[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); - out_5183523293737892740[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_5183523293737892740[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_5183523293737892740[62] = 0; - out_5183523293737892740[63] = 0; - out_5183523293737892740[64] = 0; - out_5183523293737892740[65] = 0; - out_5183523293737892740[66] = 0; - out_5183523293737892740[67] = 0; - out_5183523293737892740[68] = 0; - out_5183523293737892740[69] = 0; - out_5183523293737892740[70] = 1; - out_5183523293737892740[71] = 0; - out_5183523293737892740[72] = 0; - out_5183523293737892740[73] = 0; - out_5183523293737892740[74] = 0; - out_5183523293737892740[75] = 0; - out_5183523293737892740[76] = 0; - out_5183523293737892740[77] = 0; - out_5183523293737892740[78] = 0; - out_5183523293737892740[79] = 0; - out_5183523293737892740[80] = 1; +void F_fun(double *state, double dt, double *out_4929085835885003775) { + out_4929085835885003775[0] = 1; + out_4929085835885003775[1] = 0; + out_4929085835885003775[2] = 0; + out_4929085835885003775[3] = 0; + out_4929085835885003775[4] = 0; + out_4929085835885003775[5] = 0; + out_4929085835885003775[6] = 0; + out_4929085835885003775[7] = 0; + out_4929085835885003775[8] = 0; + out_4929085835885003775[9] = 0; + out_4929085835885003775[10] = 1; + out_4929085835885003775[11] = 0; + out_4929085835885003775[12] = 0; + out_4929085835885003775[13] = 0; + out_4929085835885003775[14] = 0; + out_4929085835885003775[15] = 0; + out_4929085835885003775[16] = 0; + out_4929085835885003775[17] = 0; + out_4929085835885003775[18] = 0; + out_4929085835885003775[19] = 0; + out_4929085835885003775[20] = 1; + out_4929085835885003775[21] = 0; + out_4929085835885003775[22] = 0; + out_4929085835885003775[23] = 0; + out_4929085835885003775[24] = 0; + out_4929085835885003775[25] = 0; + out_4929085835885003775[26] = 0; + out_4929085835885003775[27] = 0; + out_4929085835885003775[28] = 0; + out_4929085835885003775[29] = 0; + out_4929085835885003775[30] = 1; + out_4929085835885003775[31] = 0; + out_4929085835885003775[32] = 0; + out_4929085835885003775[33] = 0; + out_4929085835885003775[34] = 0; + out_4929085835885003775[35] = 0; + out_4929085835885003775[36] = 0; + out_4929085835885003775[37] = 0; + out_4929085835885003775[38] = 0; + out_4929085835885003775[39] = 0; + out_4929085835885003775[40] = 1; + out_4929085835885003775[41] = 0; + out_4929085835885003775[42] = 0; + out_4929085835885003775[43] = 0; + out_4929085835885003775[44] = 0; + out_4929085835885003775[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_4929085835885003775[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); + out_4929085835885003775[47] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_4929085835885003775[48] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_4929085835885003775[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_4929085835885003775[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; + out_4929085835885003775[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); + out_4929085835885003775[52] = dt*stiffness_front*state[0]/(mass*state[1]); + out_4929085835885003775[53] = -9.8100000000000005*dt; + out_4929085835885003775[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_4929085835885003775[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); + out_4929085835885003775[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_4929085835885003775[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_4929085835885003775[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_4929085835885003775[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); + out_4929085835885003775[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_4929085835885003775[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_4929085835885003775[62] = 0; + out_4929085835885003775[63] = 0; + out_4929085835885003775[64] = 0; + out_4929085835885003775[65] = 0; + out_4929085835885003775[66] = 0; + out_4929085835885003775[67] = 0; + out_4929085835885003775[68] = 0; + out_4929085835885003775[69] = 0; + out_4929085835885003775[70] = 1; + out_4929085835885003775[71] = 0; + out_4929085835885003775[72] = 0; + out_4929085835885003775[73] = 0; + out_4929085835885003775[74] = 0; + out_4929085835885003775[75] = 0; + out_4929085835885003775[76] = 0; + out_4929085835885003775[77] = 0; + out_4929085835885003775[78] = 0; + out_4929085835885003775[79] = 0; + out_4929085835885003775[80] = 1; } -void h_25(double *state, double *unused, double *out_1323322140775861569) { - out_1323322140775861569[0] = state[6]; +void h_25(double *state, double *unused, double *out_3988698768583113995) { + out_3988698768583113995[0] = state[6]; } -void H_25(double *state, double *unused, double *out_2722446496047589311) { - out_2722446496047589311[0] = 0; - out_2722446496047589311[1] = 0; - out_2722446496047589311[2] = 0; - out_2722446496047589311[3] = 0; - out_2722446496047589311[4] = 0; - out_2722446496047589311[5] = 0; - out_2722446496047589311[6] = 1; - out_2722446496047589311[7] = 0; - out_2722446496047589311[8] = 0; +void H_25(double *state, double *unused, double *out_3508392149259824773) { + out_3508392149259824773[0] = 0; + out_3508392149259824773[1] = 0; + out_3508392149259824773[2] = 0; + out_3508392149259824773[3] = 0; + out_3508392149259824773[4] = 0; + out_3508392149259824773[5] = 0; + out_3508392149259824773[6] = 1; + out_3508392149259824773[7] = 0; + out_3508392149259824773[8] = 0; } -void h_24(double *state, double *unused, double *out_9087948729282653086) { - out_9087948729282653086[0] = state[4]; - out_9087948729282653086[1] = state[5]; +void h_24(double *state, double *unused, double *out_4767470784617198679) { + out_4767470784617198679[0] = state[4]; + out_4767470784617198679[1] = state[5]; } -void H_24(double *state, double *unused, double *out_3567443104831284710) { - out_3567443104831284710[0] = 0; - out_3567443104831284710[1] = 0; - out_3567443104831284710[2] = 0; - out_3567443104831284710[3] = 0; - out_3567443104831284710[4] = 1; - out_3567443104831284710[5] = 0; - out_3567443104831284710[6] = 0; - out_3567443104831284710[7] = 0; - out_3567443104831284710[8] = 0; - out_3567443104831284710[9] = 0; - out_3567443104831284710[10] = 0; - out_3567443104831284710[11] = 0; - out_3567443104831284710[12] = 0; - out_3567443104831284710[13] = 0; - out_3567443104831284710[14] = 1; - out_3567443104831284710[15] = 0; - out_3567443104831284710[16] = 0; - out_3567443104831284710[17] = 0; +void H_24(double *state, double *unused, double *out_8254901476226333807) { + out_8254901476226333807[0] = 0; + out_8254901476226333807[1] = 0; + out_8254901476226333807[2] = 0; + out_8254901476226333807[3] = 0; + out_8254901476226333807[4] = 1; + out_8254901476226333807[5] = 0; + out_8254901476226333807[6] = 0; + out_8254901476226333807[7] = 0; + out_8254901476226333807[8] = 0; + out_8254901476226333807[9] = 0; + out_8254901476226333807[10] = 0; + out_8254901476226333807[11] = 0; + out_8254901476226333807[12] = 0; + out_8254901476226333807[13] = 0; + out_8254901476226333807[14] = 1; + out_8254901476226333807[15] = 0; + out_8254901476226333807[16] = 0; + out_8254901476226333807[17] = 0; } -void h_30(double *state, double *unused, double *out_1374282254885888156) { - out_1374282254885888156[0] = state[4]; +void h_30(double *state, double *unused, double *out_7626148296837136345) { + out_7626148296837136345[0] = state[4]; } -void H_30(double *state, double *unused, double *out_8807607236170345550) { - out_8807607236170345550[0] = 0; - out_8807607236170345550[1] = 0; - out_8807607236170345550[2] = 0; - out_8807607236170345550[3] = 0; - out_8807607236170345550[4] = 1; - out_8807607236170345550[5] = 0; - out_8807607236170345550[6] = 0; - out_8807607236170345550[7] = 0; - out_8807607236170345550[8] = 0; +void H_30(double *state, double *unused, double *out_3408298192231791982) { + out_3408298192231791982[0] = 0; + out_3408298192231791982[1] = 0; + out_3408298192231791982[2] = 0; + out_3408298192231791982[3] = 0; + out_3408298192231791982[4] = 1; + out_3408298192231791982[5] = 0; + out_3408298192231791982[6] = 0; + out_3408298192231791982[7] = 0; + out_3408298192231791982[8] = 0; } -void h_26(double *state, double *unused, double *out_2542026055962029893) { - out_2542026055962029893[0] = state[7]; +void h_26(double *state, double *unused, double *out_2624475029176290700) { + out_2624475029176290700[0] = state[7]; } -void H_26(double *state, double *unused, double *out_1019056822826466913) { - out_1019056822826466913[0] = 0; - out_1019056822826466913[1] = 0; - out_1019056822826466913[2] = 0; - out_1019056822826466913[3] = 0; - out_1019056822826466913[4] = 0; - out_1019056822826466913[5] = 0; - out_1019056822826466913[6] = 0; - out_1019056822826466913[7] = 1; - out_1019056822826466913[8] = 0; +void H_26(double *state, double *unused, double *out_7249895468133880997) { + out_7249895468133880997[0] = 0; + out_7249895468133880997[1] = 0; + out_7249895468133880997[2] = 0; + out_7249895468133880997[3] = 0; + out_7249895468133880997[4] = 0; + out_7249895468133880997[5] = 0; + out_7249895468133880997[6] = 0; + out_7249895468133880997[7] = 1; + out_7249895468133880997[8] = 0; } -void h_27(double *state, double *unused, double *out_1281083180032836082) { - out_1281083180032836082[0] = state[3]; +void h_27(double *state, double *unused, double *out_572425478934043979) { + out_572425478934043979[0] = state[3]; } -void H_27(double *state, double *unused, double *out_7464373525738781155) { - out_7464373525738781155[0] = 0; - out_7464373525738781155[1] = 0; - out_7464373525738781155[2] = 0; - out_7464373525738781155[3] = 1; - out_7464373525738781155[4] = 0; - out_7464373525738781155[5] = 0; - out_7464373525738781155[6] = 0; - out_7464373525738781155[7] = 0; - out_7464373525738781155[8] = 0; +void H_27(double *state, double *unused, double *out_1233534880431367071) { + out_1233534880431367071[0] = 0; + out_1233534880431367071[1] = 0; + out_1233534880431367071[2] = 0; + out_1233534880431367071[3] = 1; + out_1233534880431367071[4] = 0; + out_1233534880431367071[5] = 0; + out_1233534880431367071[6] = 0; + out_1233534880431367071[7] = 0; + out_1233534880431367071[8] = 0; } -void h_29(double *state, double *unused, double *out_1438269848383965227) { - out_1438269848383965227[0] = state[1]; +void h_29(double *state, double *unused, double *out_5818922509211569626) { + out_5818922509211569626[0] = state[1]; } -void H_29(double *state, double *unused, double *out_8297375891855953366) { - out_8297375891855953366[0] = 0; - out_8297375891855953366[1] = 1; - out_8297375891855953366[2] = 0; - out_8297375891855953366[3] = 0; - out_8297375891855953366[4] = 0; - out_8297375891855953366[5] = 0; - out_8297375891855953366[6] = 0; - out_8297375891855953366[7] = 0; - out_8297375891855953366[8] = 0; +void H_29(double *state, double *unused, double *out_3918529536546184166) { + out_3918529536546184166[0] = 0; + out_3918529536546184166[1] = 1; + out_3918529536546184166[2] = 0; + out_3918529536546184166[3] = 0; + out_3918529536546184166[4] = 0; + out_3918529536546184166[5] = 0; + out_3918529536546184166[6] = 0; + out_3918529536546184166[7] = 0; + out_3918529536546184166[8] = 0; } -void h_28(double *state, double *unused, double *out_677767295356358565) { - out_677767295356358565[0] = state[0]; +void h_28(double *state, double *unused, double *out_4389954518747249253) { + out_4389954518747249253[0] = state[0]; } -void H_28(double *state, double *unused, double *out_668611781799699548) { - out_668611781799699548[0] = 1; - out_668611781799699548[1] = 0; - out_668611781799699548[2] = 0; - out_668611781799699548[3] = 0; - out_668611781799699548[4] = 0; - out_668611781799699548[5] = 0; - out_668611781799699548[6] = 0; - out_668611781799699548[7] = 0; - out_668611781799699548[8] = 0; +void H_28(double *state, double *unused, double *out_5562226863507714536) { + out_5562226863507714536[0] = 1; + out_5562226863507714536[1] = 0; + out_5562226863507714536[2] = 0; + out_5562226863507714536[3] = 0; + out_5562226863507714536[4] = 0; + out_5562226863507714536[5] = 0; + out_5562226863507714536[6] = 0; + out_5562226863507714536[7] = 0; + out_5562226863507714536[8] = 0; } -void h_31(double *state, double *unused, double *out_2538361335652640083) { - out_2538361335652640083[0] = state[8]; +void h_31(double *state, double *unused, double *out_3713504706298608106) { + out_3713504706298608106[0] = state[8]; } -void H_31(double *state, double *unused, double *out_2753092457924549739) { - out_2753092457924549739[0] = 0; - out_2753092457924549739[1] = 0; - out_2753092457924549739[2] = 0; - out_2753092457924549739[3] = 0; - out_2753092457924549739[4] = 0; - out_2753092457924549739[5] = 0; - out_2753092457924549739[6] = 0; - out_2753092457924549739[7] = 0; - out_2753092457924549739[8] = 1; +void H_31(double *state, double *unused, double *out_3477746187382864345) { + out_3477746187382864345[0] = 0; + out_3477746187382864345[1] = 0; + out_3477746187382864345[2] = 0; + out_3477746187382864345[3] = 0; + out_3477746187382864345[4] = 0; + out_3477746187382864345[5] = 0; + out_3477746187382864345[6] = 0; + out_3477746187382864345[7] = 0; + out_3477746187382864345[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_191040875433637227) { - err_fun(nom_x, delta_x, out_191040875433637227); +void car_err_fun(double *nom_x, double *delta_x, double *out_2204053027494663001) { + err_fun(nom_x, delta_x, out_2204053027494663001); } -void car_inv_err_fun(double *nom_x, double *true_x, double *out_449478399145670770) { - inv_err_fun(nom_x, true_x, out_449478399145670770); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_2041279983635365065) { + inv_err_fun(nom_x, true_x, out_2041279983635365065); } -void car_H_mod_fun(double *state, double *out_2217112053847292599) { - H_mod_fun(state, out_2217112053847292599); +void car_H_mod_fun(double *state, double *out_7031372799249316450) { + H_mod_fun(state, out_7031372799249316450); } -void car_f_fun(double *state, double dt, double *out_5425352922863285243) { - f_fun(state, dt, out_5425352922863285243); +void car_f_fun(double *state, double dt, double *out_1116747486686820994) { + f_fun(state, dt, out_1116747486686820994); } -void car_F_fun(double *state, double dt, double *out_5183523293737892740) { - F_fun(state, dt, out_5183523293737892740); +void car_F_fun(double *state, double dt, double *out_4929085835885003775) { + F_fun(state, dt, out_4929085835885003775); } -void car_h_25(double *state, double *unused, double *out_1323322140775861569) { - h_25(state, unused, out_1323322140775861569); +void car_h_25(double *state, double *unused, double *out_3988698768583113995) { + h_25(state, unused, out_3988698768583113995); } -void car_H_25(double *state, double *unused, double *out_2722446496047589311) { - H_25(state, unused, out_2722446496047589311); +void car_H_25(double *state, double *unused, double *out_3508392149259824773) { + H_25(state, unused, out_3508392149259824773); } -void car_h_24(double *state, double *unused, double *out_9087948729282653086) { - h_24(state, unused, out_9087948729282653086); +void car_h_24(double *state, double *unused, double *out_4767470784617198679) { + h_24(state, unused, out_4767470784617198679); } -void car_H_24(double *state, double *unused, double *out_3567443104831284710) { - H_24(state, unused, out_3567443104831284710); +void car_H_24(double *state, double *unused, double *out_8254901476226333807) { + H_24(state, unused, out_8254901476226333807); } -void car_h_30(double *state, double *unused, double *out_1374282254885888156) { - h_30(state, unused, out_1374282254885888156); +void car_h_30(double *state, double *unused, double *out_7626148296837136345) { + h_30(state, unused, out_7626148296837136345); } -void car_H_30(double *state, double *unused, double *out_8807607236170345550) { - H_30(state, unused, out_8807607236170345550); +void car_H_30(double *state, double *unused, double *out_3408298192231791982) { + H_30(state, unused, out_3408298192231791982); } -void car_h_26(double *state, double *unused, double *out_2542026055962029893) { - h_26(state, unused, out_2542026055962029893); +void car_h_26(double *state, double *unused, double *out_2624475029176290700) { + h_26(state, unused, out_2624475029176290700); } -void car_H_26(double *state, double *unused, double *out_1019056822826466913) { - H_26(state, unused, out_1019056822826466913); +void car_H_26(double *state, double *unused, double *out_7249895468133880997) { + H_26(state, unused, out_7249895468133880997); } -void car_h_27(double *state, double *unused, double *out_1281083180032836082) { - h_27(state, unused, out_1281083180032836082); +void car_h_27(double *state, double *unused, double *out_572425478934043979) { + h_27(state, unused, out_572425478934043979); } -void car_H_27(double *state, double *unused, double *out_7464373525738781155) { - H_27(state, unused, out_7464373525738781155); +void car_H_27(double *state, double *unused, double *out_1233534880431367071) { + H_27(state, unused, out_1233534880431367071); } -void car_h_29(double *state, double *unused, double *out_1438269848383965227) { - h_29(state, unused, out_1438269848383965227); +void car_h_29(double *state, double *unused, double *out_5818922509211569626) { + h_29(state, unused, out_5818922509211569626); } -void car_H_29(double *state, double *unused, double *out_8297375891855953366) { - H_29(state, unused, out_8297375891855953366); +void car_H_29(double *state, double *unused, double *out_3918529536546184166) { + H_29(state, unused, out_3918529536546184166); } -void car_h_28(double *state, double *unused, double *out_677767295356358565) { - h_28(state, unused, out_677767295356358565); +void car_h_28(double *state, double *unused, double *out_4389954518747249253) { + h_28(state, unused, out_4389954518747249253); } -void car_H_28(double *state, double *unused, double *out_668611781799699548) { - H_28(state, unused, out_668611781799699548); +void car_H_28(double *state, double *unused, double *out_5562226863507714536) { + H_28(state, unused, out_5562226863507714536); } -void car_h_31(double *state, double *unused, double *out_2538361335652640083) { - h_31(state, unused, out_2538361335652640083); +void car_h_31(double *state, double *unused, double *out_3713504706298608106) { + h_31(state, unused, out_3713504706298608106); } -void car_H_31(double *state, double *unused, double *out_2753092457924549739) { - H_31(state, unused, out_2753092457924549739); +void car_H_31(double *state, double *unused, double *out_3477746187382864345) { + H_31(state, unused, out_3477746187382864345); } 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 e8e655b7ae..2a9f834416 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_191040875433637227); -void car_inv_err_fun(double *nom_x, double *true_x, double *out_449478399145670770); -void car_H_mod_fun(double *state, double *out_2217112053847292599); -void car_f_fun(double *state, double dt, double *out_5425352922863285243); -void car_F_fun(double *state, double dt, double *out_5183523293737892740); -void car_h_25(double *state, double *unused, double *out_1323322140775861569); -void car_H_25(double *state, double *unused, double *out_2722446496047589311); -void car_h_24(double *state, double *unused, double *out_9087948729282653086); -void car_H_24(double *state, double *unused, double *out_3567443104831284710); -void car_h_30(double *state, double *unused, double *out_1374282254885888156); -void car_H_30(double *state, double *unused, double *out_8807607236170345550); -void car_h_26(double *state, double *unused, double *out_2542026055962029893); -void car_H_26(double *state, double *unused, double *out_1019056822826466913); -void car_h_27(double *state, double *unused, double *out_1281083180032836082); -void car_H_27(double *state, double *unused, double *out_7464373525738781155); -void car_h_29(double *state, double *unused, double *out_1438269848383965227); -void car_H_29(double *state, double *unused, double *out_8297375891855953366); -void car_h_28(double *state, double *unused, double *out_677767295356358565); -void car_H_28(double *state, double *unused, double *out_668611781799699548); -void car_h_31(double *state, double *unused, double *out_2538361335652640083); -void car_H_31(double *state, double *unused, double *out_2753092457924549739); +void car_err_fun(double *nom_x, double *delta_x, double *out_2204053027494663001); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_2041279983635365065); +void car_H_mod_fun(double *state, double *out_7031372799249316450); +void car_f_fun(double *state, double dt, double *out_1116747486686820994); +void car_F_fun(double *state, double dt, double *out_4929085835885003775); +void car_h_25(double *state, double *unused, double *out_3988698768583113995); +void car_H_25(double *state, double *unused, double *out_3508392149259824773); +void car_h_24(double *state, double *unused, double *out_4767470784617198679); +void car_H_24(double *state, double *unused, double *out_8254901476226333807); +void car_h_30(double *state, double *unused, double *out_7626148296837136345); +void car_H_30(double *state, double *unused, double *out_3408298192231791982); +void car_h_26(double *state, double *unused, double *out_2624475029176290700); +void car_H_26(double *state, double *unused, double *out_7249895468133880997); +void car_h_27(double *state, double *unused, double *out_572425478934043979); +void car_H_27(double *state, double *unused, double *out_1233534880431367071); +void car_h_29(double *state, double *unused, double *out_5818922509211569626); +void car_H_29(double *state, double *unused, double *out_3918529536546184166); +void car_h_28(double *state, double *unused, double *out_4389954518747249253); +void car_H_28(double *state, double *unused, double *out_5562226863507714536); +void car_h_31(double *state, double *unused, double *out_3713504706298608106); +void car_H_31(double *state, double *unused, double *out_3477746187382864345); 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 12bcef9855..28a491bf9a 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 e81bbcb5f5..2f67e91607 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 623cabd857..312f52e334 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_8386835163844872263) { - out_8386835163844872263[0] = delta_x[0] + nom_x[0]; - out_8386835163844872263[1] = delta_x[1] + nom_x[1]; - out_8386835163844872263[2] = delta_x[2] + nom_x[2]; - out_8386835163844872263[3] = delta_x[3] + nom_x[3]; - out_8386835163844872263[4] = delta_x[4] + nom_x[4]; - out_8386835163844872263[5] = delta_x[5] + nom_x[5]; - out_8386835163844872263[6] = delta_x[6] + nom_x[6]; - out_8386835163844872263[7] = delta_x[7] + nom_x[7]; - out_8386835163844872263[8] = delta_x[8] + nom_x[8]; - out_8386835163844872263[9] = delta_x[9] + nom_x[9]; - out_8386835163844872263[10] = delta_x[10] + nom_x[10]; - out_8386835163844872263[11] = delta_x[11] + nom_x[11]; - out_8386835163844872263[12] = delta_x[12] + nom_x[12]; - out_8386835163844872263[13] = delta_x[13] + nom_x[13]; - out_8386835163844872263[14] = delta_x[14] + nom_x[14]; - out_8386835163844872263[15] = delta_x[15] + nom_x[15]; - out_8386835163844872263[16] = delta_x[16] + nom_x[16]; - out_8386835163844872263[17] = delta_x[17] + nom_x[17]; +void err_fun(double *nom_x, double *delta_x, double *out_7675941765646048454) { + out_7675941765646048454[0] = delta_x[0] + nom_x[0]; + out_7675941765646048454[1] = delta_x[1] + nom_x[1]; + out_7675941765646048454[2] = delta_x[2] + nom_x[2]; + out_7675941765646048454[3] = delta_x[3] + nom_x[3]; + out_7675941765646048454[4] = delta_x[4] + nom_x[4]; + out_7675941765646048454[5] = delta_x[5] + nom_x[5]; + out_7675941765646048454[6] = delta_x[6] + nom_x[6]; + out_7675941765646048454[7] = delta_x[7] + nom_x[7]; + out_7675941765646048454[8] = delta_x[8] + nom_x[8]; + out_7675941765646048454[9] = delta_x[9] + nom_x[9]; + out_7675941765646048454[10] = delta_x[10] + nom_x[10]; + out_7675941765646048454[11] = delta_x[11] + nom_x[11]; + out_7675941765646048454[12] = delta_x[12] + nom_x[12]; + out_7675941765646048454[13] = delta_x[13] + nom_x[13]; + out_7675941765646048454[14] = delta_x[14] + nom_x[14]; + out_7675941765646048454[15] = delta_x[15] + nom_x[15]; + out_7675941765646048454[16] = delta_x[16] + nom_x[16]; + out_7675941765646048454[17] = delta_x[17] + nom_x[17]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_5826204590882848019) { - out_5826204590882848019[0] = -nom_x[0] + true_x[0]; - out_5826204590882848019[1] = -nom_x[1] + true_x[1]; - out_5826204590882848019[2] = -nom_x[2] + true_x[2]; - out_5826204590882848019[3] = -nom_x[3] + true_x[3]; - out_5826204590882848019[4] = -nom_x[4] + true_x[4]; - out_5826204590882848019[5] = -nom_x[5] + true_x[5]; - out_5826204590882848019[6] = -nom_x[6] + true_x[6]; - out_5826204590882848019[7] = -nom_x[7] + true_x[7]; - out_5826204590882848019[8] = -nom_x[8] + true_x[8]; - out_5826204590882848019[9] = -nom_x[9] + true_x[9]; - out_5826204590882848019[10] = -nom_x[10] + true_x[10]; - out_5826204590882848019[11] = -nom_x[11] + true_x[11]; - out_5826204590882848019[12] = -nom_x[12] + true_x[12]; - out_5826204590882848019[13] = -nom_x[13] + true_x[13]; - out_5826204590882848019[14] = -nom_x[14] + true_x[14]; - out_5826204590882848019[15] = -nom_x[15] + true_x[15]; - out_5826204590882848019[16] = -nom_x[16] + true_x[16]; - out_5826204590882848019[17] = -nom_x[17] + true_x[17]; +void inv_err_fun(double *nom_x, double *true_x, double *out_6578985106349638079) { + out_6578985106349638079[0] = -nom_x[0] + true_x[0]; + out_6578985106349638079[1] = -nom_x[1] + true_x[1]; + out_6578985106349638079[2] = -nom_x[2] + true_x[2]; + out_6578985106349638079[3] = -nom_x[3] + true_x[3]; + out_6578985106349638079[4] = -nom_x[4] + true_x[4]; + out_6578985106349638079[5] = -nom_x[5] + true_x[5]; + out_6578985106349638079[6] = -nom_x[6] + true_x[6]; + out_6578985106349638079[7] = -nom_x[7] + true_x[7]; + out_6578985106349638079[8] = -nom_x[8] + true_x[8]; + out_6578985106349638079[9] = -nom_x[9] + true_x[9]; + out_6578985106349638079[10] = -nom_x[10] + true_x[10]; + out_6578985106349638079[11] = -nom_x[11] + true_x[11]; + out_6578985106349638079[12] = -nom_x[12] + true_x[12]; + out_6578985106349638079[13] = -nom_x[13] + true_x[13]; + out_6578985106349638079[14] = -nom_x[14] + true_x[14]; + out_6578985106349638079[15] = -nom_x[15] + true_x[15]; + out_6578985106349638079[16] = -nom_x[16] + true_x[16]; + out_6578985106349638079[17] = -nom_x[17] + true_x[17]; } -void H_mod_fun(double *state, double *out_7521593534267777079) { - out_7521593534267777079[0] = 1.0; - out_7521593534267777079[1] = 0.0; - out_7521593534267777079[2] = 0.0; - out_7521593534267777079[3] = 0.0; - out_7521593534267777079[4] = 0.0; - out_7521593534267777079[5] = 0.0; - out_7521593534267777079[6] = 0.0; - out_7521593534267777079[7] = 0.0; - out_7521593534267777079[8] = 0.0; - out_7521593534267777079[9] = 0.0; - out_7521593534267777079[10] = 0.0; - out_7521593534267777079[11] = 0.0; - out_7521593534267777079[12] = 0.0; - out_7521593534267777079[13] = 0.0; - out_7521593534267777079[14] = 0.0; - out_7521593534267777079[15] = 0.0; - out_7521593534267777079[16] = 0.0; - out_7521593534267777079[17] = 0.0; - out_7521593534267777079[18] = 0.0; - out_7521593534267777079[19] = 1.0; - out_7521593534267777079[20] = 0.0; - out_7521593534267777079[21] = 0.0; - out_7521593534267777079[22] = 0.0; - out_7521593534267777079[23] = 0.0; - out_7521593534267777079[24] = 0.0; - out_7521593534267777079[25] = 0.0; - out_7521593534267777079[26] = 0.0; - out_7521593534267777079[27] = 0.0; - out_7521593534267777079[28] = 0.0; - out_7521593534267777079[29] = 0.0; - out_7521593534267777079[30] = 0.0; - out_7521593534267777079[31] = 0.0; - out_7521593534267777079[32] = 0.0; - out_7521593534267777079[33] = 0.0; - out_7521593534267777079[34] = 0.0; - out_7521593534267777079[35] = 0.0; - out_7521593534267777079[36] = 0.0; - out_7521593534267777079[37] = 0.0; - out_7521593534267777079[38] = 1.0; - out_7521593534267777079[39] = 0.0; - out_7521593534267777079[40] = 0.0; - out_7521593534267777079[41] = 0.0; - out_7521593534267777079[42] = 0.0; - out_7521593534267777079[43] = 0.0; - out_7521593534267777079[44] = 0.0; - out_7521593534267777079[45] = 0.0; - out_7521593534267777079[46] = 0.0; - out_7521593534267777079[47] = 0.0; - out_7521593534267777079[48] = 0.0; - out_7521593534267777079[49] = 0.0; - out_7521593534267777079[50] = 0.0; - out_7521593534267777079[51] = 0.0; - out_7521593534267777079[52] = 0.0; - out_7521593534267777079[53] = 0.0; - out_7521593534267777079[54] = 0.0; - out_7521593534267777079[55] = 0.0; - out_7521593534267777079[56] = 0.0; - out_7521593534267777079[57] = 1.0; - out_7521593534267777079[58] = 0.0; - out_7521593534267777079[59] = 0.0; - out_7521593534267777079[60] = 0.0; - out_7521593534267777079[61] = 0.0; - out_7521593534267777079[62] = 0.0; - out_7521593534267777079[63] = 0.0; - out_7521593534267777079[64] = 0.0; - out_7521593534267777079[65] = 0.0; - out_7521593534267777079[66] = 0.0; - out_7521593534267777079[67] = 0.0; - out_7521593534267777079[68] = 0.0; - out_7521593534267777079[69] = 0.0; - out_7521593534267777079[70] = 0.0; - out_7521593534267777079[71] = 0.0; - out_7521593534267777079[72] = 0.0; - out_7521593534267777079[73] = 0.0; - out_7521593534267777079[74] = 0.0; - out_7521593534267777079[75] = 0.0; - out_7521593534267777079[76] = 1.0; - out_7521593534267777079[77] = 0.0; - out_7521593534267777079[78] = 0.0; - out_7521593534267777079[79] = 0.0; - out_7521593534267777079[80] = 0.0; - out_7521593534267777079[81] = 0.0; - out_7521593534267777079[82] = 0.0; - out_7521593534267777079[83] = 0.0; - out_7521593534267777079[84] = 0.0; - out_7521593534267777079[85] = 0.0; - out_7521593534267777079[86] = 0.0; - out_7521593534267777079[87] = 0.0; - out_7521593534267777079[88] = 0.0; - out_7521593534267777079[89] = 0.0; - out_7521593534267777079[90] = 0.0; - out_7521593534267777079[91] = 0.0; - out_7521593534267777079[92] = 0.0; - out_7521593534267777079[93] = 0.0; - out_7521593534267777079[94] = 0.0; - out_7521593534267777079[95] = 1.0; - out_7521593534267777079[96] = 0.0; - out_7521593534267777079[97] = 0.0; - out_7521593534267777079[98] = 0.0; - out_7521593534267777079[99] = 0.0; - out_7521593534267777079[100] = 0.0; - out_7521593534267777079[101] = 0.0; - out_7521593534267777079[102] = 0.0; - out_7521593534267777079[103] = 0.0; - out_7521593534267777079[104] = 0.0; - out_7521593534267777079[105] = 0.0; - out_7521593534267777079[106] = 0.0; - out_7521593534267777079[107] = 0.0; - out_7521593534267777079[108] = 0.0; - out_7521593534267777079[109] = 0.0; - out_7521593534267777079[110] = 0.0; - out_7521593534267777079[111] = 0.0; - out_7521593534267777079[112] = 0.0; - out_7521593534267777079[113] = 0.0; - out_7521593534267777079[114] = 1.0; - out_7521593534267777079[115] = 0.0; - out_7521593534267777079[116] = 0.0; - out_7521593534267777079[117] = 0.0; - out_7521593534267777079[118] = 0.0; - out_7521593534267777079[119] = 0.0; - out_7521593534267777079[120] = 0.0; - out_7521593534267777079[121] = 0.0; - out_7521593534267777079[122] = 0.0; - out_7521593534267777079[123] = 0.0; - out_7521593534267777079[124] = 0.0; - out_7521593534267777079[125] = 0.0; - out_7521593534267777079[126] = 0.0; - out_7521593534267777079[127] = 0.0; - out_7521593534267777079[128] = 0.0; - out_7521593534267777079[129] = 0.0; - out_7521593534267777079[130] = 0.0; - out_7521593534267777079[131] = 0.0; - out_7521593534267777079[132] = 0.0; - out_7521593534267777079[133] = 1.0; - out_7521593534267777079[134] = 0.0; - out_7521593534267777079[135] = 0.0; - out_7521593534267777079[136] = 0.0; - out_7521593534267777079[137] = 0.0; - out_7521593534267777079[138] = 0.0; - out_7521593534267777079[139] = 0.0; - out_7521593534267777079[140] = 0.0; - out_7521593534267777079[141] = 0.0; - out_7521593534267777079[142] = 0.0; - out_7521593534267777079[143] = 0.0; - out_7521593534267777079[144] = 0.0; - out_7521593534267777079[145] = 0.0; - out_7521593534267777079[146] = 0.0; - out_7521593534267777079[147] = 0.0; - out_7521593534267777079[148] = 0.0; - out_7521593534267777079[149] = 0.0; - out_7521593534267777079[150] = 0.0; - out_7521593534267777079[151] = 0.0; - out_7521593534267777079[152] = 1.0; - out_7521593534267777079[153] = 0.0; - out_7521593534267777079[154] = 0.0; - out_7521593534267777079[155] = 0.0; - out_7521593534267777079[156] = 0.0; - out_7521593534267777079[157] = 0.0; - out_7521593534267777079[158] = 0.0; - out_7521593534267777079[159] = 0.0; - out_7521593534267777079[160] = 0.0; - out_7521593534267777079[161] = 0.0; - out_7521593534267777079[162] = 0.0; - out_7521593534267777079[163] = 0.0; - out_7521593534267777079[164] = 0.0; - out_7521593534267777079[165] = 0.0; - out_7521593534267777079[166] = 0.0; - out_7521593534267777079[167] = 0.0; - out_7521593534267777079[168] = 0.0; - out_7521593534267777079[169] = 0.0; - out_7521593534267777079[170] = 0.0; - out_7521593534267777079[171] = 1.0; - out_7521593534267777079[172] = 0.0; - out_7521593534267777079[173] = 0.0; - out_7521593534267777079[174] = 0.0; - out_7521593534267777079[175] = 0.0; - out_7521593534267777079[176] = 0.0; - out_7521593534267777079[177] = 0.0; - out_7521593534267777079[178] = 0.0; - out_7521593534267777079[179] = 0.0; - out_7521593534267777079[180] = 0.0; - out_7521593534267777079[181] = 0.0; - out_7521593534267777079[182] = 0.0; - out_7521593534267777079[183] = 0.0; - out_7521593534267777079[184] = 0.0; - out_7521593534267777079[185] = 0.0; - out_7521593534267777079[186] = 0.0; - out_7521593534267777079[187] = 0.0; - out_7521593534267777079[188] = 0.0; - out_7521593534267777079[189] = 0.0; - out_7521593534267777079[190] = 1.0; - out_7521593534267777079[191] = 0.0; - out_7521593534267777079[192] = 0.0; - out_7521593534267777079[193] = 0.0; - out_7521593534267777079[194] = 0.0; - out_7521593534267777079[195] = 0.0; - out_7521593534267777079[196] = 0.0; - out_7521593534267777079[197] = 0.0; - out_7521593534267777079[198] = 0.0; - out_7521593534267777079[199] = 0.0; - out_7521593534267777079[200] = 0.0; - out_7521593534267777079[201] = 0.0; - out_7521593534267777079[202] = 0.0; - out_7521593534267777079[203] = 0.0; - out_7521593534267777079[204] = 0.0; - out_7521593534267777079[205] = 0.0; - out_7521593534267777079[206] = 0.0; - out_7521593534267777079[207] = 0.0; - out_7521593534267777079[208] = 0.0; - out_7521593534267777079[209] = 1.0; - out_7521593534267777079[210] = 0.0; - out_7521593534267777079[211] = 0.0; - out_7521593534267777079[212] = 0.0; - out_7521593534267777079[213] = 0.0; - out_7521593534267777079[214] = 0.0; - out_7521593534267777079[215] = 0.0; - out_7521593534267777079[216] = 0.0; - out_7521593534267777079[217] = 0.0; - out_7521593534267777079[218] = 0.0; - out_7521593534267777079[219] = 0.0; - out_7521593534267777079[220] = 0.0; - out_7521593534267777079[221] = 0.0; - out_7521593534267777079[222] = 0.0; - out_7521593534267777079[223] = 0.0; - out_7521593534267777079[224] = 0.0; - out_7521593534267777079[225] = 0.0; - out_7521593534267777079[226] = 0.0; - out_7521593534267777079[227] = 0.0; - out_7521593534267777079[228] = 1.0; - out_7521593534267777079[229] = 0.0; - out_7521593534267777079[230] = 0.0; - out_7521593534267777079[231] = 0.0; - out_7521593534267777079[232] = 0.0; - out_7521593534267777079[233] = 0.0; - out_7521593534267777079[234] = 0.0; - out_7521593534267777079[235] = 0.0; - out_7521593534267777079[236] = 0.0; - out_7521593534267777079[237] = 0.0; - out_7521593534267777079[238] = 0.0; - out_7521593534267777079[239] = 0.0; - out_7521593534267777079[240] = 0.0; - out_7521593534267777079[241] = 0.0; - out_7521593534267777079[242] = 0.0; - out_7521593534267777079[243] = 0.0; - out_7521593534267777079[244] = 0.0; - out_7521593534267777079[245] = 0.0; - out_7521593534267777079[246] = 0.0; - out_7521593534267777079[247] = 1.0; - out_7521593534267777079[248] = 0.0; - out_7521593534267777079[249] = 0.0; - out_7521593534267777079[250] = 0.0; - out_7521593534267777079[251] = 0.0; - out_7521593534267777079[252] = 0.0; - out_7521593534267777079[253] = 0.0; - out_7521593534267777079[254] = 0.0; - out_7521593534267777079[255] = 0.0; - out_7521593534267777079[256] = 0.0; - out_7521593534267777079[257] = 0.0; - out_7521593534267777079[258] = 0.0; - out_7521593534267777079[259] = 0.0; - out_7521593534267777079[260] = 0.0; - out_7521593534267777079[261] = 0.0; - out_7521593534267777079[262] = 0.0; - out_7521593534267777079[263] = 0.0; - out_7521593534267777079[264] = 0.0; - out_7521593534267777079[265] = 0.0; - out_7521593534267777079[266] = 1.0; - out_7521593534267777079[267] = 0.0; - out_7521593534267777079[268] = 0.0; - out_7521593534267777079[269] = 0.0; - out_7521593534267777079[270] = 0.0; - out_7521593534267777079[271] = 0.0; - out_7521593534267777079[272] = 0.0; - out_7521593534267777079[273] = 0.0; - out_7521593534267777079[274] = 0.0; - out_7521593534267777079[275] = 0.0; - out_7521593534267777079[276] = 0.0; - out_7521593534267777079[277] = 0.0; - out_7521593534267777079[278] = 0.0; - out_7521593534267777079[279] = 0.0; - out_7521593534267777079[280] = 0.0; - out_7521593534267777079[281] = 0.0; - out_7521593534267777079[282] = 0.0; - out_7521593534267777079[283] = 0.0; - out_7521593534267777079[284] = 0.0; - out_7521593534267777079[285] = 1.0; - out_7521593534267777079[286] = 0.0; - out_7521593534267777079[287] = 0.0; - out_7521593534267777079[288] = 0.0; - out_7521593534267777079[289] = 0.0; - out_7521593534267777079[290] = 0.0; - out_7521593534267777079[291] = 0.0; - out_7521593534267777079[292] = 0.0; - out_7521593534267777079[293] = 0.0; - out_7521593534267777079[294] = 0.0; - out_7521593534267777079[295] = 0.0; - out_7521593534267777079[296] = 0.0; - out_7521593534267777079[297] = 0.0; - out_7521593534267777079[298] = 0.0; - out_7521593534267777079[299] = 0.0; - out_7521593534267777079[300] = 0.0; - out_7521593534267777079[301] = 0.0; - out_7521593534267777079[302] = 0.0; - out_7521593534267777079[303] = 0.0; - out_7521593534267777079[304] = 1.0; - out_7521593534267777079[305] = 0.0; - out_7521593534267777079[306] = 0.0; - out_7521593534267777079[307] = 0.0; - out_7521593534267777079[308] = 0.0; - out_7521593534267777079[309] = 0.0; - out_7521593534267777079[310] = 0.0; - out_7521593534267777079[311] = 0.0; - out_7521593534267777079[312] = 0.0; - out_7521593534267777079[313] = 0.0; - out_7521593534267777079[314] = 0.0; - out_7521593534267777079[315] = 0.0; - out_7521593534267777079[316] = 0.0; - out_7521593534267777079[317] = 0.0; - out_7521593534267777079[318] = 0.0; - out_7521593534267777079[319] = 0.0; - out_7521593534267777079[320] = 0.0; - out_7521593534267777079[321] = 0.0; - out_7521593534267777079[322] = 0.0; - out_7521593534267777079[323] = 1.0; +void H_mod_fun(double *state, double *out_8249219982215908455) { + out_8249219982215908455[0] = 1.0; + out_8249219982215908455[1] = 0.0; + out_8249219982215908455[2] = 0.0; + out_8249219982215908455[3] = 0.0; + out_8249219982215908455[4] = 0.0; + out_8249219982215908455[5] = 0.0; + out_8249219982215908455[6] = 0.0; + out_8249219982215908455[7] = 0.0; + out_8249219982215908455[8] = 0.0; + out_8249219982215908455[9] = 0.0; + out_8249219982215908455[10] = 0.0; + out_8249219982215908455[11] = 0.0; + out_8249219982215908455[12] = 0.0; + out_8249219982215908455[13] = 0.0; + out_8249219982215908455[14] = 0.0; + out_8249219982215908455[15] = 0.0; + out_8249219982215908455[16] = 0.0; + out_8249219982215908455[17] = 0.0; + out_8249219982215908455[18] = 0.0; + out_8249219982215908455[19] = 1.0; + out_8249219982215908455[20] = 0.0; + out_8249219982215908455[21] = 0.0; + out_8249219982215908455[22] = 0.0; + out_8249219982215908455[23] = 0.0; + out_8249219982215908455[24] = 0.0; + out_8249219982215908455[25] = 0.0; + out_8249219982215908455[26] = 0.0; + out_8249219982215908455[27] = 0.0; + out_8249219982215908455[28] = 0.0; + out_8249219982215908455[29] = 0.0; + out_8249219982215908455[30] = 0.0; + out_8249219982215908455[31] = 0.0; + out_8249219982215908455[32] = 0.0; + out_8249219982215908455[33] = 0.0; + out_8249219982215908455[34] = 0.0; + out_8249219982215908455[35] = 0.0; + out_8249219982215908455[36] = 0.0; + out_8249219982215908455[37] = 0.0; + out_8249219982215908455[38] = 1.0; + out_8249219982215908455[39] = 0.0; + out_8249219982215908455[40] = 0.0; + out_8249219982215908455[41] = 0.0; + out_8249219982215908455[42] = 0.0; + out_8249219982215908455[43] = 0.0; + out_8249219982215908455[44] = 0.0; + out_8249219982215908455[45] = 0.0; + out_8249219982215908455[46] = 0.0; + out_8249219982215908455[47] = 0.0; + out_8249219982215908455[48] = 0.0; + out_8249219982215908455[49] = 0.0; + out_8249219982215908455[50] = 0.0; + out_8249219982215908455[51] = 0.0; + out_8249219982215908455[52] = 0.0; + out_8249219982215908455[53] = 0.0; + out_8249219982215908455[54] = 0.0; + out_8249219982215908455[55] = 0.0; + out_8249219982215908455[56] = 0.0; + out_8249219982215908455[57] = 1.0; + out_8249219982215908455[58] = 0.0; + out_8249219982215908455[59] = 0.0; + out_8249219982215908455[60] = 0.0; + out_8249219982215908455[61] = 0.0; + out_8249219982215908455[62] = 0.0; + out_8249219982215908455[63] = 0.0; + out_8249219982215908455[64] = 0.0; + out_8249219982215908455[65] = 0.0; + out_8249219982215908455[66] = 0.0; + out_8249219982215908455[67] = 0.0; + out_8249219982215908455[68] = 0.0; + out_8249219982215908455[69] = 0.0; + out_8249219982215908455[70] = 0.0; + out_8249219982215908455[71] = 0.0; + out_8249219982215908455[72] = 0.0; + out_8249219982215908455[73] = 0.0; + out_8249219982215908455[74] = 0.0; + out_8249219982215908455[75] = 0.0; + out_8249219982215908455[76] = 1.0; + out_8249219982215908455[77] = 0.0; + out_8249219982215908455[78] = 0.0; + out_8249219982215908455[79] = 0.0; + out_8249219982215908455[80] = 0.0; + out_8249219982215908455[81] = 0.0; + out_8249219982215908455[82] = 0.0; + out_8249219982215908455[83] = 0.0; + out_8249219982215908455[84] = 0.0; + out_8249219982215908455[85] = 0.0; + out_8249219982215908455[86] = 0.0; + out_8249219982215908455[87] = 0.0; + out_8249219982215908455[88] = 0.0; + out_8249219982215908455[89] = 0.0; + out_8249219982215908455[90] = 0.0; + out_8249219982215908455[91] = 0.0; + out_8249219982215908455[92] = 0.0; + out_8249219982215908455[93] = 0.0; + out_8249219982215908455[94] = 0.0; + out_8249219982215908455[95] = 1.0; + out_8249219982215908455[96] = 0.0; + out_8249219982215908455[97] = 0.0; + out_8249219982215908455[98] = 0.0; + out_8249219982215908455[99] = 0.0; + out_8249219982215908455[100] = 0.0; + out_8249219982215908455[101] = 0.0; + out_8249219982215908455[102] = 0.0; + out_8249219982215908455[103] = 0.0; + out_8249219982215908455[104] = 0.0; + out_8249219982215908455[105] = 0.0; + out_8249219982215908455[106] = 0.0; + out_8249219982215908455[107] = 0.0; + out_8249219982215908455[108] = 0.0; + out_8249219982215908455[109] = 0.0; + out_8249219982215908455[110] = 0.0; + out_8249219982215908455[111] = 0.0; + out_8249219982215908455[112] = 0.0; + out_8249219982215908455[113] = 0.0; + out_8249219982215908455[114] = 1.0; + out_8249219982215908455[115] = 0.0; + out_8249219982215908455[116] = 0.0; + out_8249219982215908455[117] = 0.0; + out_8249219982215908455[118] = 0.0; + out_8249219982215908455[119] = 0.0; + out_8249219982215908455[120] = 0.0; + out_8249219982215908455[121] = 0.0; + out_8249219982215908455[122] = 0.0; + out_8249219982215908455[123] = 0.0; + out_8249219982215908455[124] = 0.0; + out_8249219982215908455[125] = 0.0; + out_8249219982215908455[126] = 0.0; + out_8249219982215908455[127] = 0.0; + out_8249219982215908455[128] = 0.0; + out_8249219982215908455[129] = 0.0; + out_8249219982215908455[130] = 0.0; + out_8249219982215908455[131] = 0.0; + out_8249219982215908455[132] = 0.0; + out_8249219982215908455[133] = 1.0; + out_8249219982215908455[134] = 0.0; + out_8249219982215908455[135] = 0.0; + out_8249219982215908455[136] = 0.0; + out_8249219982215908455[137] = 0.0; + out_8249219982215908455[138] = 0.0; + out_8249219982215908455[139] = 0.0; + out_8249219982215908455[140] = 0.0; + out_8249219982215908455[141] = 0.0; + out_8249219982215908455[142] = 0.0; + out_8249219982215908455[143] = 0.0; + out_8249219982215908455[144] = 0.0; + out_8249219982215908455[145] = 0.0; + out_8249219982215908455[146] = 0.0; + out_8249219982215908455[147] = 0.0; + out_8249219982215908455[148] = 0.0; + out_8249219982215908455[149] = 0.0; + out_8249219982215908455[150] = 0.0; + out_8249219982215908455[151] = 0.0; + out_8249219982215908455[152] = 1.0; + out_8249219982215908455[153] = 0.0; + out_8249219982215908455[154] = 0.0; + out_8249219982215908455[155] = 0.0; + out_8249219982215908455[156] = 0.0; + out_8249219982215908455[157] = 0.0; + out_8249219982215908455[158] = 0.0; + out_8249219982215908455[159] = 0.0; + out_8249219982215908455[160] = 0.0; + out_8249219982215908455[161] = 0.0; + out_8249219982215908455[162] = 0.0; + out_8249219982215908455[163] = 0.0; + out_8249219982215908455[164] = 0.0; + out_8249219982215908455[165] = 0.0; + out_8249219982215908455[166] = 0.0; + out_8249219982215908455[167] = 0.0; + out_8249219982215908455[168] = 0.0; + out_8249219982215908455[169] = 0.0; + out_8249219982215908455[170] = 0.0; + out_8249219982215908455[171] = 1.0; + out_8249219982215908455[172] = 0.0; + out_8249219982215908455[173] = 0.0; + out_8249219982215908455[174] = 0.0; + out_8249219982215908455[175] = 0.0; + out_8249219982215908455[176] = 0.0; + out_8249219982215908455[177] = 0.0; + out_8249219982215908455[178] = 0.0; + out_8249219982215908455[179] = 0.0; + out_8249219982215908455[180] = 0.0; + out_8249219982215908455[181] = 0.0; + out_8249219982215908455[182] = 0.0; + out_8249219982215908455[183] = 0.0; + out_8249219982215908455[184] = 0.0; + out_8249219982215908455[185] = 0.0; + out_8249219982215908455[186] = 0.0; + out_8249219982215908455[187] = 0.0; + out_8249219982215908455[188] = 0.0; + out_8249219982215908455[189] = 0.0; + out_8249219982215908455[190] = 1.0; + out_8249219982215908455[191] = 0.0; + out_8249219982215908455[192] = 0.0; + out_8249219982215908455[193] = 0.0; + out_8249219982215908455[194] = 0.0; + out_8249219982215908455[195] = 0.0; + out_8249219982215908455[196] = 0.0; + out_8249219982215908455[197] = 0.0; + out_8249219982215908455[198] = 0.0; + out_8249219982215908455[199] = 0.0; + out_8249219982215908455[200] = 0.0; + out_8249219982215908455[201] = 0.0; + out_8249219982215908455[202] = 0.0; + out_8249219982215908455[203] = 0.0; + out_8249219982215908455[204] = 0.0; + out_8249219982215908455[205] = 0.0; + out_8249219982215908455[206] = 0.0; + out_8249219982215908455[207] = 0.0; + out_8249219982215908455[208] = 0.0; + out_8249219982215908455[209] = 1.0; + out_8249219982215908455[210] = 0.0; + out_8249219982215908455[211] = 0.0; + out_8249219982215908455[212] = 0.0; + out_8249219982215908455[213] = 0.0; + out_8249219982215908455[214] = 0.0; + out_8249219982215908455[215] = 0.0; + out_8249219982215908455[216] = 0.0; + out_8249219982215908455[217] = 0.0; + out_8249219982215908455[218] = 0.0; + out_8249219982215908455[219] = 0.0; + out_8249219982215908455[220] = 0.0; + out_8249219982215908455[221] = 0.0; + out_8249219982215908455[222] = 0.0; + out_8249219982215908455[223] = 0.0; + out_8249219982215908455[224] = 0.0; + out_8249219982215908455[225] = 0.0; + out_8249219982215908455[226] = 0.0; + out_8249219982215908455[227] = 0.0; + out_8249219982215908455[228] = 1.0; + out_8249219982215908455[229] = 0.0; + out_8249219982215908455[230] = 0.0; + out_8249219982215908455[231] = 0.0; + out_8249219982215908455[232] = 0.0; + out_8249219982215908455[233] = 0.0; + out_8249219982215908455[234] = 0.0; + out_8249219982215908455[235] = 0.0; + out_8249219982215908455[236] = 0.0; + out_8249219982215908455[237] = 0.0; + out_8249219982215908455[238] = 0.0; + out_8249219982215908455[239] = 0.0; + out_8249219982215908455[240] = 0.0; + out_8249219982215908455[241] = 0.0; + out_8249219982215908455[242] = 0.0; + out_8249219982215908455[243] = 0.0; + out_8249219982215908455[244] = 0.0; + out_8249219982215908455[245] = 0.0; + out_8249219982215908455[246] = 0.0; + out_8249219982215908455[247] = 1.0; + out_8249219982215908455[248] = 0.0; + out_8249219982215908455[249] = 0.0; + out_8249219982215908455[250] = 0.0; + out_8249219982215908455[251] = 0.0; + out_8249219982215908455[252] = 0.0; + out_8249219982215908455[253] = 0.0; + out_8249219982215908455[254] = 0.0; + out_8249219982215908455[255] = 0.0; + out_8249219982215908455[256] = 0.0; + out_8249219982215908455[257] = 0.0; + out_8249219982215908455[258] = 0.0; + out_8249219982215908455[259] = 0.0; + out_8249219982215908455[260] = 0.0; + out_8249219982215908455[261] = 0.0; + out_8249219982215908455[262] = 0.0; + out_8249219982215908455[263] = 0.0; + out_8249219982215908455[264] = 0.0; + out_8249219982215908455[265] = 0.0; + out_8249219982215908455[266] = 1.0; + out_8249219982215908455[267] = 0.0; + out_8249219982215908455[268] = 0.0; + out_8249219982215908455[269] = 0.0; + out_8249219982215908455[270] = 0.0; + out_8249219982215908455[271] = 0.0; + out_8249219982215908455[272] = 0.0; + out_8249219982215908455[273] = 0.0; + out_8249219982215908455[274] = 0.0; + out_8249219982215908455[275] = 0.0; + out_8249219982215908455[276] = 0.0; + out_8249219982215908455[277] = 0.0; + out_8249219982215908455[278] = 0.0; + out_8249219982215908455[279] = 0.0; + out_8249219982215908455[280] = 0.0; + out_8249219982215908455[281] = 0.0; + out_8249219982215908455[282] = 0.0; + out_8249219982215908455[283] = 0.0; + out_8249219982215908455[284] = 0.0; + out_8249219982215908455[285] = 1.0; + out_8249219982215908455[286] = 0.0; + out_8249219982215908455[287] = 0.0; + out_8249219982215908455[288] = 0.0; + out_8249219982215908455[289] = 0.0; + out_8249219982215908455[290] = 0.0; + out_8249219982215908455[291] = 0.0; + out_8249219982215908455[292] = 0.0; + out_8249219982215908455[293] = 0.0; + out_8249219982215908455[294] = 0.0; + out_8249219982215908455[295] = 0.0; + out_8249219982215908455[296] = 0.0; + out_8249219982215908455[297] = 0.0; + out_8249219982215908455[298] = 0.0; + out_8249219982215908455[299] = 0.0; + out_8249219982215908455[300] = 0.0; + out_8249219982215908455[301] = 0.0; + out_8249219982215908455[302] = 0.0; + out_8249219982215908455[303] = 0.0; + out_8249219982215908455[304] = 1.0; + out_8249219982215908455[305] = 0.0; + out_8249219982215908455[306] = 0.0; + out_8249219982215908455[307] = 0.0; + out_8249219982215908455[308] = 0.0; + out_8249219982215908455[309] = 0.0; + out_8249219982215908455[310] = 0.0; + out_8249219982215908455[311] = 0.0; + out_8249219982215908455[312] = 0.0; + out_8249219982215908455[313] = 0.0; + out_8249219982215908455[314] = 0.0; + out_8249219982215908455[315] = 0.0; + out_8249219982215908455[316] = 0.0; + out_8249219982215908455[317] = 0.0; + out_8249219982215908455[318] = 0.0; + out_8249219982215908455[319] = 0.0; + out_8249219982215908455[320] = 0.0; + out_8249219982215908455[321] = 0.0; + out_8249219982215908455[322] = 0.0; + out_8249219982215908455[323] = 1.0; } -void f_fun(double *state, double dt, double *out_8190127916652503129) { - out_8190127916652503129[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_8190127916652503129[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_8190127916652503129[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_8190127916652503129[3] = dt*state[12] + state[3]; - out_8190127916652503129[4] = dt*state[13] + state[4]; - out_8190127916652503129[5] = dt*state[14] + state[5]; - out_8190127916652503129[6] = state[6]; - out_8190127916652503129[7] = state[7]; - out_8190127916652503129[8] = state[8]; - out_8190127916652503129[9] = state[9]; - out_8190127916652503129[10] = state[10]; - out_8190127916652503129[11] = state[11]; - out_8190127916652503129[12] = state[12]; - out_8190127916652503129[13] = state[13]; - out_8190127916652503129[14] = state[14]; - out_8190127916652503129[15] = state[15]; - out_8190127916652503129[16] = state[16]; - out_8190127916652503129[17] = state[17]; +void f_fun(double *state, double dt, double *out_741196485394149917) { + out_741196485394149917[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_741196485394149917[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_741196485394149917[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_741196485394149917[3] = dt*state[12] + state[3]; + out_741196485394149917[4] = dt*state[13] + state[4]; + out_741196485394149917[5] = dt*state[14] + state[5]; + out_741196485394149917[6] = state[6]; + out_741196485394149917[7] = state[7]; + out_741196485394149917[8] = state[8]; + out_741196485394149917[9] = state[9]; + out_741196485394149917[10] = state[10]; + out_741196485394149917[11] = state[11]; + out_741196485394149917[12] = state[12]; + out_741196485394149917[13] = state[13]; + out_741196485394149917[14] = state[14]; + out_741196485394149917[15] = state[15]; + out_741196485394149917[16] = state[16]; + out_741196485394149917[17] = state[17]; } -void F_fun(double *state, double dt, double *out_8302830792992532360) { - out_8302830792992532360[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_8302830792992532360[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_8302830792992532360[2] = 0; - out_8302830792992532360[3] = 0; - out_8302830792992532360[4] = 0; - out_8302830792992532360[5] = 0; - out_8302830792992532360[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_8302830792992532360[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_8302830792992532360[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_8302830792992532360[9] = 0; - out_8302830792992532360[10] = 0; - out_8302830792992532360[11] = 0; - out_8302830792992532360[12] = 0; - out_8302830792992532360[13] = 0; - out_8302830792992532360[14] = 0; - out_8302830792992532360[15] = 0; - out_8302830792992532360[16] = 0; - out_8302830792992532360[17] = 0; - out_8302830792992532360[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_8302830792992532360[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_8302830792992532360[20] = 0; - out_8302830792992532360[21] = 0; - out_8302830792992532360[22] = 0; - out_8302830792992532360[23] = 0; - out_8302830792992532360[24] = 0; - out_8302830792992532360[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_8302830792992532360[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_8302830792992532360[27] = 0; - out_8302830792992532360[28] = 0; - out_8302830792992532360[29] = 0; - out_8302830792992532360[30] = 0; - out_8302830792992532360[31] = 0; - out_8302830792992532360[32] = 0; - out_8302830792992532360[33] = 0; - out_8302830792992532360[34] = 0; - out_8302830792992532360[35] = 0; - out_8302830792992532360[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_8302830792992532360[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_8302830792992532360[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_8302830792992532360[39] = 0; - out_8302830792992532360[40] = 0; - out_8302830792992532360[41] = 0; - out_8302830792992532360[42] = 0; - out_8302830792992532360[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_8302830792992532360[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_8302830792992532360[45] = 0; - out_8302830792992532360[46] = 0; - out_8302830792992532360[47] = 0; - out_8302830792992532360[48] = 0; - out_8302830792992532360[49] = 0; - out_8302830792992532360[50] = 0; - out_8302830792992532360[51] = 0; - out_8302830792992532360[52] = 0; - out_8302830792992532360[53] = 0; - out_8302830792992532360[54] = 0; - out_8302830792992532360[55] = 0; - out_8302830792992532360[56] = 0; - out_8302830792992532360[57] = 1; - out_8302830792992532360[58] = 0; - out_8302830792992532360[59] = 0; - out_8302830792992532360[60] = 0; - out_8302830792992532360[61] = 0; - out_8302830792992532360[62] = 0; - out_8302830792992532360[63] = 0; - out_8302830792992532360[64] = 0; - out_8302830792992532360[65] = 0; - out_8302830792992532360[66] = dt; - out_8302830792992532360[67] = 0; - out_8302830792992532360[68] = 0; - out_8302830792992532360[69] = 0; - out_8302830792992532360[70] = 0; - out_8302830792992532360[71] = 0; - out_8302830792992532360[72] = 0; - out_8302830792992532360[73] = 0; - out_8302830792992532360[74] = 0; - out_8302830792992532360[75] = 0; - out_8302830792992532360[76] = 1; - out_8302830792992532360[77] = 0; - out_8302830792992532360[78] = 0; - out_8302830792992532360[79] = 0; - out_8302830792992532360[80] = 0; - out_8302830792992532360[81] = 0; - out_8302830792992532360[82] = 0; - out_8302830792992532360[83] = 0; - out_8302830792992532360[84] = 0; - out_8302830792992532360[85] = dt; - out_8302830792992532360[86] = 0; - out_8302830792992532360[87] = 0; - out_8302830792992532360[88] = 0; - out_8302830792992532360[89] = 0; - out_8302830792992532360[90] = 0; - out_8302830792992532360[91] = 0; - out_8302830792992532360[92] = 0; - out_8302830792992532360[93] = 0; - out_8302830792992532360[94] = 0; - out_8302830792992532360[95] = 1; - out_8302830792992532360[96] = 0; - out_8302830792992532360[97] = 0; - out_8302830792992532360[98] = 0; - out_8302830792992532360[99] = 0; - out_8302830792992532360[100] = 0; - out_8302830792992532360[101] = 0; - out_8302830792992532360[102] = 0; - out_8302830792992532360[103] = 0; - out_8302830792992532360[104] = dt; - out_8302830792992532360[105] = 0; - out_8302830792992532360[106] = 0; - out_8302830792992532360[107] = 0; - out_8302830792992532360[108] = 0; - out_8302830792992532360[109] = 0; - out_8302830792992532360[110] = 0; - out_8302830792992532360[111] = 0; - out_8302830792992532360[112] = 0; - out_8302830792992532360[113] = 0; - out_8302830792992532360[114] = 1; - out_8302830792992532360[115] = 0; - out_8302830792992532360[116] = 0; - out_8302830792992532360[117] = 0; - out_8302830792992532360[118] = 0; - out_8302830792992532360[119] = 0; - out_8302830792992532360[120] = 0; - out_8302830792992532360[121] = 0; - out_8302830792992532360[122] = 0; - out_8302830792992532360[123] = 0; - out_8302830792992532360[124] = 0; - out_8302830792992532360[125] = 0; - out_8302830792992532360[126] = 0; - out_8302830792992532360[127] = 0; - out_8302830792992532360[128] = 0; - out_8302830792992532360[129] = 0; - out_8302830792992532360[130] = 0; - out_8302830792992532360[131] = 0; - out_8302830792992532360[132] = 0; - out_8302830792992532360[133] = 1; - out_8302830792992532360[134] = 0; - out_8302830792992532360[135] = 0; - out_8302830792992532360[136] = 0; - out_8302830792992532360[137] = 0; - out_8302830792992532360[138] = 0; - out_8302830792992532360[139] = 0; - out_8302830792992532360[140] = 0; - out_8302830792992532360[141] = 0; - out_8302830792992532360[142] = 0; - out_8302830792992532360[143] = 0; - out_8302830792992532360[144] = 0; - out_8302830792992532360[145] = 0; - out_8302830792992532360[146] = 0; - out_8302830792992532360[147] = 0; - out_8302830792992532360[148] = 0; - out_8302830792992532360[149] = 0; - out_8302830792992532360[150] = 0; - out_8302830792992532360[151] = 0; - out_8302830792992532360[152] = 1; - out_8302830792992532360[153] = 0; - out_8302830792992532360[154] = 0; - out_8302830792992532360[155] = 0; - out_8302830792992532360[156] = 0; - out_8302830792992532360[157] = 0; - out_8302830792992532360[158] = 0; - out_8302830792992532360[159] = 0; - out_8302830792992532360[160] = 0; - out_8302830792992532360[161] = 0; - out_8302830792992532360[162] = 0; - out_8302830792992532360[163] = 0; - out_8302830792992532360[164] = 0; - out_8302830792992532360[165] = 0; - out_8302830792992532360[166] = 0; - out_8302830792992532360[167] = 0; - out_8302830792992532360[168] = 0; - out_8302830792992532360[169] = 0; - out_8302830792992532360[170] = 0; - out_8302830792992532360[171] = 1; - out_8302830792992532360[172] = 0; - out_8302830792992532360[173] = 0; - out_8302830792992532360[174] = 0; - out_8302830792992532360[175] = 0; - out_8302830792992532360[176] = 0; - out_8302830792992532360[177] = 0; - out_8302830792992532360[178] = 0; - out_8302830792992532360[179] = 0; - out_8302830792992532360[180] = 0; - out_8302830792992532360[181] = 0; - out_8302830792992532360[182] = 0; - out_8302830792992532360[183] = 0; - out_8302830792992532360[184] = 0; - out_8302830792992532360[185] = 0; - out_8302830792992532360[186] = 0; - out_8302830792992532360[187] = 0; - out_8302830792992532360[188] = 0; - out_8302830792992532360[189] = 0; - out_8302830792992532360[190] = 1; - out_8302830792992532360[191] = 0; - out_8302830792992532360[192] = 0; - out_8302830792992532360[193] = 0; - out_8302830792992532360[194] = 0; - out_8302830792992532360[195] = 0; - out_8302830792992532360[196] = 0; - out_8302830792992532360[197] = 0; - out_8302830792992532360[198] = 0; - out_8302830792992532360[199] = 0; - out_8302830792992532360[200] = 0; - out_8302830792992532360[201] = 0; - out_8302830792992532360[202] = 0; - out_8302830792992532360[203] = 0; - out_8302830792992532360[204] = 0; - out_8302830792992532360[205] = 0; - out_8302830792992532360[206] = 0; - out_8302830792992532360[207] = 0; - out_8302830792992532360[208] = 0; - out_8302830792992532360[209] = 1; - out_8302830792992532360[210] = 0; - out_8302830792992532360[211] = 0; - out_8302830792992532360[212] = 0; - out_8302830792992532360[213] = 0; - out_8302830792992532360[214] = 0; - out_8302830792992532360[215] = 0; - out_8302830792992532360[216] = 0; - out_8302830792992532360[217] = 0; - out_8302830792992532360[218] = 0; - out_8302830792992532360[219] = 0; - out_8302830792992532360[220] = 0; - out_8302830792992532360[221] = 0; - out_8302830792992532360[222] = 0; - out_8302830792992532360[223] = 0; - out_8302830792992532360[224] = 0; - out_8302830792992532360[225] = 0; - out_8302830792992532360[226] = 0; - out_8302830792992532360[227] = 0; - out_8302830792992532360[228] = 1; - out_8302830792992532360[229] = 0; - out_8302830792992532360[230] = 0; - out_8302830792992532360[231] = 0; - out_8302830792992532360[232] = 0; - out_8302830792992532360[233] = 0; - out_8302830792992532360[234] = 0; - out_8302830792992532360[235] = 0; - out_8302830792992532360[236] = 0; - out_8302830792992532360[237] = 0; - out_8302830792992532360[238] = 0; - out_8302830792992532360[239] = 0; - out_8302830792992532360[240] = 0; - out_8302830792992532360[241] = 0; - out_8302830792992532360[242] = 0; - out_8302830792992532360[243] = 0; - out_8302830792992532360[244] = 0; - out_8302830792992532360[245] = 0; - out_8302830792992532360[246] = 0; - out_8302830792992532360[247] = 1; - out_8302830792992532360[248] = 0; - out_8302830792992532360[249] = 0; - out_8302830792992532360[250] = 0; - out_8302830792992532360[251] = 0; - out_8302830792992532360[252] = 0; - out_8302830792992532360[253] = 0; - out_8302830792992532360[254] = 0; - out_8302830792992532360[255] = 0; - out_8302830792992532360[256] = 0; - out_8302830792992532360[257] = 0; - out_8302830792992532360[258] = 0; - out_8302830792992532360[259] = 0; - out_8302830792992532360[260] = 0; - out_8302830792992532360[261] = 0; - out_8302830792992532360[262] = 0; - out_8302830792992532360[263] = 0; - out_8302830792992532360[264] = 0; - out_8302830792992532360[265] = 0; - out_8302830792992532360[266] = 1; - out_8302830792992532360[267] = 0; - out_8302830792992532360[268] = 0; - out_8302830792992532360[269] = 0; - out_8302830792992532360[270] = 0; - out_8302830792992532360[271] = 0; - out_8302830792992532360[272] = 0; - out_8302830792992532360[273] = 0; - out_8302830792992532360[274] = 0; - out_8302830792992532360[275] = 0; - out_8302830792992532360[276] = 0; - out_8302830792992532360[277] = 0; - out_8302830792992532360[278] = 0; - out_8302830792992532360[279] = 0; - out_8302830792992532360[280] = 0; - out_8302830792992532360[281] = 0; - out_8302830792992532360[282] = 0; - out_8302830792992532360[283] = 0; - out_8302830792992532360[284] = 0; - out_8302830792992532360[285] = 1; - out_8302830792992532360[286] = 0; - out_8302830792992532360[287] = 0; - out_8302830792992532360[288] = 0; - out_8302830792992532360[289] = 0; - out_8302830792992532360[290] = 0; - out_8302830792992532360[291] = 0; - out_8302830792992532360[292] = 0; - out_8302830792992532360[293] = 0; - out_8302830792992532360[294] = 0; - out_8302830792992532360[295] = 0; - out_8302830792992532360[296] = 0; - out_8302830792992532360[297] = 0; - out_8302830792992532360[298] = 0; - out_8302830792992532360[299] = 0; - out_8302830792992532360[300] = 0; - out_8302830792992532360[301] = 0; - out_8302830792992532360[302] = 0; - out_8302830792992532360[303] = 0; - out_8302830792992532360[304] = 1; - out_8302830792992532360[305] = 0; - out_8302830792992532360[306] = 0; - out_8302830792992532360[307] = 0; - out_8302830792992532360[308] = 0; - out_8302830792992532360[309] = 0; - out_8302830792992532360[310] = 0; - out_8302830792992532360[311] = 0; - out_8302830792992532360[312] = 0; - out_8302830792992532360[313] = 0; - out_8302830792992532360[314] = 0; - out_8302830792992532360[315] = 0; - out_8302830792992532360[316] = 0; - out_8302830792992532360[317] = 0; - out_8302830792992532360[318] = 0; - out_8302830792992532360[319] = 0; - out_8302830792992532360[320] = 0; - out_8302830792992532360[321] = 0; - out_8302830792992532360[322] = 0; - out_8302830792992532360[323] = 1; +void F_fun(double *state, double dt, double *out_914245573923806659) { + out_914245573923806659[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_914245573923806659[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_914245573923806659[2] = 0; + out_914245573923806659[3] = 0; + out_914245573923806659[4] = 0; + out_914245573923806659[5] = 0; + out_914245573923806659[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_914245573923806659[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_914245573923806659[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_914245573923806659[9] = 0; + out_914245573923806659[10] = 0; + out_914245573923806659[11] = 0; + out_914245573923806659[12] = 0; + out_914245573923806659[13] = 0; + out_914245573923806659[14] = 0; + out_914245573923806659[15] = 0; + out_914245573923806659[16] = 0; + out_914245573923806659[17] = 0; + out_914245573923806659[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_914245573923806659[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_914245573923806659[20] = 0; + out_914245573923806659[21] = 0; + out_914245573923806659[22] = 0; + out_914245573923806659[23] = 0; + out_914245573923806659[24] = 0; + out_914245573923806659[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_914245573923806659[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_914245573923806659[27] = 0; + out_914245573923806659[28] = 0; + out_914245573923806659[29] = 0; + out_914245573923806659[30] = 0; + out_914245573923806659[31] = 0; + out_914245573923806659[32] = 0; + out_914245573923806659[33] = 0; + out_914245573923806659[34] = 0; + out_914245573923806659[35] = 0; + out_914245573923806659[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_914245573923806659[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_914245573923806659[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_914245573923806659[39] = 0; + out_914245573923806659[40] = 0; + out_914245573923806659[41] = 0; + out_914245573923806659[42] = 0; + out_914245573923806659[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_914245573923806659[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_914245573923806659[45] = 0; + out_914245573923806659[46] = 0; + out_914245573923806659[47] = 0; + out_914245573923806659[48] = 0; + out_914245573923806659[49] = 0; + out_914245573923806659[50] = 0; + out_914245573923806659[51] = 0; + out_914245573923806659[52] = 0; + out_914245573923806659[53] = 0; + out_914245573923806659[54] = 0; + out_914245573923806659[55] = 0; + out_914245573923806659[56] = 0; + out_914245573923806659[57] = 1; + out_914245573923806659[58] = 0; + out_914245573923806659[59] = 0; + out_914245573923806659[60] = 0; + out_914245573923806659[61] = 0; + out_914245573923806659[62] = 0; + out_914245573923806659[63] = 0; + out_914245573923806659[64] = 0; + out_914245573923806659[65] = 0; + out_914245573923806659[66] = dt; + out_914245573923806659[67] = 0; + out_914245573923806659[68] = 0; + out_914245573923806659[69] = 0; + out_914245573923806659[70] = 0; + out_914245573923806659[71] = 0; + out_914245573923806659[72] = 0; + out_914245573923806659[73] = 0; + out_914245573923806659[74] = 0; + out_914245573923806659[75] = 0; + out_914245573923806659[76] = 1; + out_914245573923806659[77] = 0; + out_914245573923806659[78] = 0; + out_914245573923806659[79] = 0; + out_914245573923806659[80] = 0; + out_914245573923806659[81] = 0; + out_914245573923806659[82] = 0; + out_914245573923806659[83] = 0; + out_914245573923806659[84] = 0; + out_914245573923806659[85] = dt; + out_914245573923806659[86] = 0; + out_914245573923806659[87] = 0; + out_914245573923806659[88] = 0; + out_914245573923806659[89] = 0; + out_914245573923806659[90] = 0; + out_914245573923806659[91] = 0; + out_914245573923806659[92] = 0; + out_914245573923806659[93] = 0; + out_914245573923806659[94] = 0; + out_914245573923806659[95] = 1; + out_914245573923806659[96] = 0; + out_914245573923806659[97] = 0; + out_914245573923806659[98] = 0; + out_914245573923806659[99] = 0; + out_914245573923806659[100] = 0; + out_914245573923806659[101] = 0; + out_914245573923806659[102] = 0; + out_914245573923806659[103] = 0; + out_914245573923806659[104] = dt; + out_914245573923806659[105] = 0; + out_914245573923806659[106] = 0; + out_914245573923806659[107] = 0; + out_914245573923806659[108] = 0; + out_914245573923806659[109] = 0; + out_914245573923806659[110] = 0; + out_914245573923806659[111] = 0; + out_914245573923806659[112] = 0; + out_914245573923806659[113] = 0; + out_914245573923806659[114] = 1; + out_914245573923806659[115] = 0; + out_914245573923806659[116] = 0; + out_914245573923806659[117] = 0; + out_914245573923806659[118] = 0; + out_914245573923806659[119] = 0; + out_914245573923806659[120] = 0; + out_914245573923806659[121] = 0; + out_914245573923806659[122] = 0; + out_914245573923806659[123] = 0; + out_914245573923806659[124] = 0; + out_914245573923806659[125] = 0; + out_914245573923806659[126] = 0; + out_914245573923806659[127] = 0; + out_914245573923806659[128] = 0; + out_914245573923806659[129] = 0; + out_914245573923806659[130] = 0; + out_914245573923806659[131] = 0; + out_914245573923806659[132] = 0; + out_914245573923806659[133] = 1; + out_914245573923806659[134] = 0; + out_914245573923806659[135] = 0; + out_914245573923806659[136] = 0; + out_914245573923806659[137] = 0; + out_914245573923806659[138] = 0; + out_914245573923806659[139] = 0; + out_914245573923806659[140] = 0; + out_914245573923806659[141] = 0; + out_914245573923806659[142] = 0; + out_914245573923806659[143] = 0; + out_914245573923806659[144] = 0; + out_914245573923806659[145] = 0; + out_914245573923806659[146] = 0; + out_914245573923806659[147] = 0; + out_914245573923806659[148] = 0; + out_914245573923806659[149] = 0; + out_914245573923806659[150] = 0; + out_914245573923806659[151] = 0; + out_914245573923806659[152] = 1; + out_914245573923806659[153] = 0; + out_914245573923806659[154] = 0; + out_914245573923806659[155] = 0; + out_914245573923806659[156] = 0; + out_914245573923806659[157] = 0; + out_914245573923806659[158] = 0; + out_914245573923806659[159] = 0; + out_914245573923806659[160] = 0; + out_914245573923806659[161] = 0; + out_914245573923806659[162] = 0; + out_914245573923806659[163] = 0; + out_914245573923806659[164] = 0; + out_914245573923806659[165] = 0; + out_914245573923806659[166] = 0; + out_914245573923806659[167] = 0; + out_914245573923806659[168] = 0; + out_914245573923806659[169] = 0; + out_914245573923806659[170] = 0; + out_914245573923806659[171] = 1; + out_914245573923806659[172] = 0; + out_914245573923806659[173] = 0; + out_914245573923806659[174] = 0; + out_914245573923806659[175] = 0; + out_914245573923806659[176] = 0; + out_914245573923806659[177] = 0; + out_914245573923806659[178] = 0; + out_914245573923806659[179] = 0; + out_914245573923806659[180] = 0; + out_914245573923806659[181] = 0; + out_914245573923806659[182] = 0; + out_914245573923806659[183] = 0; + out_914245573923806659[184] = 0; + out_914245573923806659[185] = 0; + out_914245573923806659[186] = 0; + out_914245573923806659[187] = 0; + out_914245573923806659[188] = 0; + out_914245573923806659[189] = 0; + out_914245573923806659[190] = 1; + out_914245573923806659[191] = 0; + out_914245573923806659[192] = 0; + out_914245573923806659[193] = 0; + out_914245573923806659[194] = 0; + out_914245573923806659[195] = 0; + out_914245573923806659[196] = 0; + out_914245573923806659[197] = 0; + out_914245573923806659[198] = 0; + out_914245573923806659[199] = 0; + out_914245573923806659[200] = 0; + out_914245573923806659[201] = 0; + out_914245573923806659[202] = 0; + out_914245573923806659[203] = 0; + out_914245573923806659[204] = 0; + out_914245573923806659[205] = 0; + out_914245573923806659[206] = 0; + out_914245573923806659[207] = 0; + out_914245573923806659[208] = 0; + out_914245573923806659[209] = 1; + out_914245573923806659[210] = 0; + out_914245573923806659[211] = 0; + out_914245573923806659[212] = 0; + out_914245573923806659[213] = 0; + out_914245573923806659[214] = 0; + out_914245573923806659[215] = 0; + out_914245573923806659[216] = 0; + out_914245573923806659[217] = 0; + out_914245573923806659[218] = 0; + out_914245573923806659[219] = 0; + out_914245573923806659[220] = 0; + out_914245573923806659[221] = 0; + out_914245573923806659[222] = 0; + out_914245573923806659[223] = 0; + out_914245573923806659[224] = 0; + out_914245573923806659[225] = 0; + out_914245573923806659[226] = 0; + out_914245573923806659[227] = 0; + out_914245573923806659[228] = 1; + out_914245573923806659[229] = 0; + out_914245573923806659[230] = 0; + out_914245573923806659[231] = 0; + out_914245573923806659[232] = 0; + out_914245573923806659[233] = 0; + out_914245573923806659[234] = 0; + out_914245573923806659[235] = 0; + out_914245573923806659[236] = 0; + out_914245573923806659[237] = 0; + out_914245573923806659[238] = 0; + out_914245573923806659[239] = 0; + out_914245573923806659[240] = 0; + out_914245573923806659[241] = 0; + out_914245573923806659[242] = 0; + out_914245573923806659[243] = 0; + out_914245573923806659[244] = 0; + out_914245573923806659[245] = 0; + out_914245573923806659[246] = 0; + out_914245573923806659[247] = 1; + out_914245573923806659[248] = 0; + out_914245573923806659[249] = 0; + out_914245573923806659[250] = 0; + out_914245573923806659[251] = 0; + out_914245573923806659[252] = 0; + out_914245573923806659[253] = 0; + out_914245573923806659[254] = 0; + out_914245573923806659[255] = 0; + out_914245573923806659[256] = 0; + out_914245573923806659[257] = 0; + out_914245573923806659[258] = 0; + out_914245573923806659[259] = 0; + out_914245573923806659[260] = 0; + out_914245573923806659[261] = 0; + out_914245573923806659[262] = 0; + out_914245573923806659[263] = 0; + out_914245573923806659[264] = 0; + out_914245573923806659[265] = 0; + out_914245573923806659[266] = 1; + out_914245573923806659[267] = 0; + out_914245573923806659[268] = 0; + out_914245573923806659[269] = 0; + out_914245573923806659[270] = 0; + out_914245573923806659[271] = 0; + out_914245573923806659[272] = 0; + out_914245573923806659[273] = 0; + out_914245573923806659[274] = 0; + out_914245573923806659[275] = 0; + out_914245573923806659[276] = 0; + out_914245573923806659[277] = 0; + out_914245573923806659[278] = 0; + out_914245573923806659[279] = 0; + out_914245573923806659[280] = 0; + out_914245573923806659[281] = 0; + out_914245573923806659[282] = 0; + out_914245573923806659[283] = 0; + out_914245573923806659[284] = 0; + out_914245573923806659[285] = 1; + out_914245573923806659[286] = 0; + out_914245573923806659[287] = 0; + out_914245573923806659[288] = 0; + out_914245573923806659[289] = 0; + out_914245573923806659[290] = 0; + out_914245573923806659[291] = 0; + out_914245573923806659[292] = 0; + out_914245573923806659[293] = 0; + out_914245573923806659[294] = 0; + out_914245573923806659[295] = 0; + out_914245573923806659[296] = 0; + out_914245573923806659[297] = 0; + out_914245573923806659[298] = 0; + out_914245573923806659[299] = 0; + out_914245573923806659[300] = 0; + out_914245573923806659[301] = 0; + out_914245573923806659[302] = 0; + out_914245573923806659[303] = 0; + out_914245573923806659[304] = 1; + out_914245573923806659[305] = 0; + out_914245573923806659[306] = 0; + out_914245573923806659[307] = 0; + out_914245573923806659[308] = 0; + out_914245573923806659[309] = 0; + out_914245573923806659[310] = 0; + out_914245573923806659[311] = 0; + out_914245573923806659[312] = 0; + out_914245573923806659[313] = 0; + out_914245573923806659[314] = 0; + out_914245573923806659[315] = 0; + out_914245573923806659[316] = 0; + out_914245573923806659[317] = 0; + out_914245573923806659[318] = 0; + out_914245573923806659[319] = 0; + out_914245573923806659[320] = 0; + out_914245573923806659[321] = 0; + out_914245573923806659[322] = 0; + out_914245573923806659[323] = 1; } -void h_4(double *state, double *unused, double *out_6664200415740758039) { - out_6664200415740758039[0] = state[6] + state[9]; - out_6664200415740758039[1] = state[7] + state[10]; - out_6664200415740758039[2] = state[8] + state[11]; +void h_4(double *state, double *unused, double *out_1661592600804563205) { + out_1661592600804563205[0] = state[6] + state[9]; + out_1661592600804563205[1] = state[7] + state[10]; + out_1661592600804563205[2] = state[8] + state[11]; } -void H_4(double *state, double *unused, double *out_5772632154402693802) { - out_5772632154402693802[0] = 0; - out_5772632154402693802[1] = 0; - out_5772632154402693802[2] = 0; - out_5772632154402693802[3] = 0; - out_5772632154402693802[4] = 0; - out_5772632154402693802[5] = 0; - out_5772632154402693802[6] = 1; - out_5772632154402693802[7] = 0; - out_5772632154402693802[8] = 0; - out_5772632154402693802[9] = 1; - out_5772632154402693802[10] = 0; - out_5772632154402693802[11] = 0; - out_5772632154402693802[12] = 0; - out_5772632154402693802[13] = 0; - out_5772632154402693802[14] = 0; - out_5772632154402693802[15] = 0; - out_5772632154402693802[16] = 0; - out_5772632154402693802[17] = 0; - out_5772632154402693802[18] = 0; - out_5772632154402693802[19] = 0; - out_5772632154402693802[20] = 0; - out_5772632154402693802[21] = 0; - out_5772632154402693802[22] = 0; - out_5772632154402693802[23] = 0; - out_5772632154402693802[24] = 0; - out_5772632154402693802[25] = 1; - out_5772632154402693802[26] = 0; - out_5772632154402693802[27] = 0; - out_5772632154402693802[28] = 1; - out_5772632154402693802[29] = 0; - out_5772632154402693802[30] = 0; - out_5772632154402693802[31] = 0; - out_5772632154402693802[32] = 0; - out_5772632154402693802[33] = 0; - out_5772632154402693802[34] = 0; - out_5772632154402693802[35] = 0; - out_5772632154402693802[36] = 0; - out_5772632154402693802[37] = 0; - out_5772632154402693802[38] = 0; - out_5772632154402693802[39] = 0; - out_5772632154402693802[40] = 0; - out_5772632154402693802[41] = 0; - out_5772632154402693802[42] = 0; - out_5772632154402693802[43] = 0; - out_5772632154402693802[44] = 1; - out_5772632154402693802[45] = 0; - out_5772632154402693802[46] = 0; - out_5772632154402693802[47] = 1; - out_5772632154402693802[48] = 0; - out_5772632154402693802[49] = 0; - out_5772632154402693802[50] = 0; - out_5772632154402693802[51] = 0; - out_5772632154402693802[52] = 0; - out_5772632154402693802[53] = 0; +void H_4(double *state, double *unused, double *out_3634592945286592091) { + out_3634592945286592091[0] = 0; + out_3634592945286592091[1] = 0; + out_3634592945286592091[2] = 0; + out_3634592945286592091[3] = 0; + out_3634592945286592091[4] = 0; + out_3634592945286592091[5] = 0; + out_3634592945286592091[6] = 1; + out_3634592945286592091[7] = 0; + out_3634592945286592091[8] = 0; + out_3634592945286592091[9] = 1; + out_3634592945286592091[10] = 0; + out_3634592945286592091[11] = 0; + out_3634592945286592091[12] = 0; + out_3634592945286592091[13] = 0; + out_3634592945286592091[14] = 0; + out_3634592945286592091[15] = 0; + out_3634592945286592091[16] = 0; + out_3634592945286592091[17] = 0; + out_3634592945286592091[18] = 0; + out_3634592945286592091[19] = 0; + out_3634592945286592091[20] = 0; + out_3634592945286592091[21] = 0; + out_3634592945286592091[22] = 0; + out_3634592945286592091[23] = 0; + out_3634592945286592091[24] = 0; + out_3634592945286592091[25] = 1; + out_3634592945286592091[26] = 0; + out_3634592945286592091[27] = 0; + out_3634592945286592091[28] = 1; + out_3634592945286592091[29] = 0; + out_3634592945286592091[30] = 0; + out_3634592945286592091[31] = 0; + out_3634592945286592091[32] = 0; + out_3634592945286592091[33] = 0; + out_3634592945286592091[34] = 0; + out_3634592945286592091[35] = 0; + out_3634592945286592091[36] = 0; + out_3634592945286592091[37] = 0; + out_3634592945286592091[38] = 0; + out_3634592945286592091[39] = 0; + out_3634592945286592091[40] = 0; + out_3634592945286592091[41] = 0; + out_3634592945286592091[42] = 0; + out_3634592945286592091[43] = 0; + out_3634592945286592091[44] = 1; + out_3634592945286592091[45] = 0; + out_3634592945286592091[46] = 0; + out_3634592945286592091[47] = 1; + out_3634592945286592091[48] = 0; + out_3634592945286592091[49] = 0; + out_3634592945286592091[50] = 0; + out_3634592945286592091[51] = 0; + out_3634592945286592091[52] = 0; + out_3634592945286592091[53] = 0; } -void h_10(double *state, double *unused, double *out_2232580687525306632) { - out_2232580687525306632[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; - out_2232580687525306632[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; - out_2232580687525306632[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_1540829144479980375) { + out_1540829144479980375[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; + out_1540829144479980375[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; + out_1540829144479980375[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_1994505413045679835) { - out_1994505413045679835[0] = 0; - out_1994505413045679835[1] = 9.8100000000000005*cos(state[1]); - out_1994505413045679835[2] = 0; - out_1994505413045679835[3] = 0; - out_1994505413045679835[4] = -state[8]; - out_1994505413045679835[5] = state[7]; - out_1994505413045679835[6] = 0; - out_1994505413045679835[7] = state[5]; - out_1994505413045679835[8] = -state[4]; - out_1994505413045679835[9] = 0; - out_1994505413045679835[10] = 0; - out_1994505413045679835[11] = 0; - out_1994505413045679835[12] = 1; - out_1994505413045679835[13] = 0; - out_1994505413045679835[14] = 0; - out_1994505413045679835[15] = 1; - out_1994505413045679835[16] = 0; - out_1994505413045679835[17] = 0; - out_1994505413045679835[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); - out_1994505413045679835[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); - out_1994505413045679835[20] = 0; - out_1994505413045679835[21] = state[8]; - out_1994505413045679835[22] = 0; - out_1994505413045679835[23] = -state[6]; - out_1994505413045679835[24] = -state[5]; - out_1994505413045679835[25] = 0; - out_1994505413045679835[26] = state[3]; - out_1994505413045679835[27] = 0; - out_1994505413045679835[28] = 0; - out_1994505413045679835[29] = 0; - out_1994505413045679835[30] = 0; - out_1994505413045679835[31] = 1; - out_1994505413045679835[32] = 0; - out_1994505413045679835[33] = 0; - out_1994505413045679835[34] = 1; - out_1994505413045679835[35] = 0; - out_1994505413045679835[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); - out_1994505413045679835[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); - out_1994505413045679835[38] = 0; - out_1994505413045679835[39] = -state[7]; - out_1994505413045679835[40] = state[6]; - out_1994505413045679835[41] = 0; - out_1994505413045679835[42] = state[4]; - out_1994505413045679835[43] = -state[3]; - out_1994505413045679835[44] = 0; - out_1994505413045679835[45] = 0; - out_1994505413045679835[46] = 0; - out_1994505413045679835[47] = 0; - out_1994505413045679835[48] = 0; - out_1994505413045679835[49] = 0; - out_1994505413045679835[50] = 1; - out_1994505413045679835[51] = 0; - out_1994505413045679835[52] = 0; - out_1994505413045679835[53] = 1; +void H_10(double *state, double *unused, double *out_3859318150895892325) { + out_3859318150895892325[0] = 0; + out_3859318150895892325[1] = 9.8100000000000005*cos(state[1]); + out_3859318150895892325[2] = 0; + out_3859318150895892325[3] = 0; + out_3859318150895892325[4] = -state[8]; + out_3859318150895892325[5] = state[7]; + out_3859318150895892325[6] = 0; + out_3859318150895892325[7] = state[5]; + out_3859318150895892325[8] = -state[4]; + out_3859318150895892325[9] = 0; + out_3859318150895892325[10] = 0; + out_3859318150895892325[11] = 0; + out_3859318150895892325[12] = 1; + out_3859318150895892325[13] = 0; + out_3859318150895892325[14] = 0; + out_3859318150895892325[15] = 1; + out_3859318150895892325[16] = 0; + out_3859318150895892325[17] = 0; + out_3859318150895892325[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); + out_3859318150895892325[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); + out_3859318150895892325[20] = 0; + out_3859318150895892325[21] = state[8]; + out_3859318150895892325[22] = 0; + out_3859318150895892325[23] = -state[6]; + out_3859318150895892325[24] = -state[5]; + out_3859318150895892325[25] = 0; + out_3859318150895892325[26] = state[3]; + out_3859318150895892325[27] = 0; + out_3859318150895892325[28] = 0; + out_3859318150895892325[29] = 0; + out_3859318150895892325[30] = 0; + out_3859318150895892325[31] = 1; + out_3859318150895892325[32] = 0; + out_3859318150895892325[33] = 0; + out_3859318150895892325[34] = 1; + out_3859318150895892325[35] = 0; + out_3859318150895892325[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); + out_3859318150895892325[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); + out_3859318150895892325[38] = 0; + out_3859318150895892325[39] = -state[7]; + out_3859318150895892325[40] = state[6]; + out_3859318150895892325[41] = 0; + out_3859318150895892325[42] = state[4]; + out_3859318150895892325[43] = -state[3]; + out_3859318150895892325[44] = 0; + out_3859318150895892325[45] = 0; + out_3859318150895892325[46] = 0; + out_3859318150895892325[47] = 0; + out_3859318150895892325[48] = 0; + out_3859318150895892325[49] = 0; + out_3859318150895892325[50] = 1; + out_3859318150895892325[51] = 0; + out_3859318150895892325[52] = 0; + out_3859318150895892325[53] = 1; } -void h_13(double *state, double *unused, double *out_1739439411373720736) { - out_1739439411373720736[0] = state[3]; - out_1739439411373720736[1] = state[4]; - out_1739439411373720736[2] = state[5]; +void h_13(double *state, double *unused, double *out_1494548337638663963) { + out_1494548337638663963[0] = state[3]; + out_1494548337638663963[1] = state[4]; + out_1494548337638663963[2] = state[5]; } -void H_13(double *state, double *unused, double *out_2560358329070361001) { - out_2560358329070361001[0] = 0; - out_2560358329070361001[1] = 0; - out_2560358329070361001[2] = 0; - out_2560358329070361001[3] = 1; - out_2560358329070361001[4] = 0; - out_2560358329070361001[5] = 0; - out_2560358329070361001[6] = 0; - out_2560358329070361001[7] = 0; - out_2560358329070361001[8] = 0; - out_2560358329070361001[9] = 0; - out_2560358329070361001[10] = 0; - out_2560358329070361001[11] = 0; - out_2560358329070361001[12] = 0; - out_2560358329070361001[13] = 0; - out_2560358329070361001[14] = 0; - out_2560358329070361001[15] = 0; - out_2560358329070361001[16] = 0; - out_2560358329070361001[17] = 0; - out_2560358329070361001[18] = 0; - out_2560358329070361001[19] = 0; - out_2560358329070361001[20] = 0; - out_2560358329070361001[21] = 0; - out_2560358329070361001[22] = 1; - out_2560358329070361001[23] = 0; - out_2560358329070361001[24] = 0; - out_2560358329070361001[25] = 0; - out_2560358329070361001[26] = 0; - out_2560358329070361001[27] = 0; - out_2560358329070361001[28] = 0; - out_2560358329070361001[29] = 0; - out_2560358329070361001[30] = 0; - out_2560358329070361001[31] = 0; - out_2560358329070361001[32] = 0; - out_2560358329070361001[33] = 0; - out_2560358329070361001[34] = 0; - out_2560358329070361001[35] = 0; - out_2560358329070361001[36] = 0; - out_2560358329070361001[37] = 0; - out_2560358329070361001[38] = 0; - out_2560358329070361001[39] = 0; - out_2560358329070361001[40] = 0; - out_2560358329070361001[41] = 1; - out_2560358329070361001[42] = 0; - out_2560358329070361001[43] = 0; - out_2560358329070361001[44] = 0; - out_2560358329070361001[45] = 0; - out_2560358329070361001[46] = 0; - out_2560358329070361001[47] = 0; - out_2560358329070361001[48] = 0; - out_2560358329070361001[49] = 0; - out_2560358329070361001[50] = 0; - out_2560358329070361001[51] = 0; - out_2560358329070361001[52] = 0; - out_2560358329070361001[53] = 0; +void H_13(double *state, double *unused, double *out_422319119954259290) { + out_422319119954259290[0] = 0; + out_422319119954259290[1] = 0; + out_422319119954259290[2] = 0; + out_422319119954259290[3] = 1; + out_422319119954259290[4] = 0; + out_422319119954259290[5] = 0; + out_422319119954259290[6] = 0; + out_422319119954259290[7] = 0; + out_422319119954259290[8] = 0; + out_422319119954259290[9] = 0; + out_422319119954259290[10] = 0; + out_422319119954259290[11] = 0; + out_422319119954259290[12] = 0; + out_422319119954259290[13] = 0; + out_422319119954259290[14] = 0; + out_422319119954259290[15] = 0; + out_422319119954259290[16] = 0; + out_422319119954259290[17] = 0; + out_422319119954259290[18] = 0; + out_422319119954259290[19] = 0; + out_422319119954259290[20] = 0; + out_422319119954259290[21] = 0; + out_422319119954259290[22] = 1; + out_422319119954259290[23] = 0; + out_422319119954259290[24] = 0; + out_422319119954259290[25] = 0; + out_422319119954259290[26] = 0; + out_422319119954259290[27] = 0; + out_422319119954259290[28] = 0; + out_422319119954259290[29] = 0; + out_422319119954259290[30] = 0; + out_422319119954259290[31] = 0; + out_422319119954259290[32] = 0; + out_422319119954259290[33] = 0; + out_422319119954259290[34] = 0; + out_422319119954259290[35] = 0; + out_422319119954259290[36] = 0; + out_422319119954259290[37] = 0; + out_422319119954259290[38] = 0; + out_422319119954259290[39] = 0; + out_422319119954259290[40] = 0; + out_422319119954259290[41] = 1; + out_422319119954259290[42] = 0; + out_422319119954259290[43] = 0; + out_422319119954259290[44] = 0; + out_422319119954259290[45] = 0; + out_422319119954259290[46] = 0; + out_422319119954259290[47] = 0; + out_422319119954259290[48] = 0; + out_422319119954259290[49] = 0; + out_422319119954259290[50] = 0; + out_422319119954259290[51] = 0; + out_422319119954259290[52] = 0; + out_422319119954259290[53] = 0; } -void h_14(double *state, double *unused, double *out_2162487226046509469) { - out_2162487226046509469[0] = state[6]; - out_2162487226046509469[1] = state[7]; - out_2162487226046509469[2] = state[8]; +void h_14(double *state, double *unused, double *out_4998597365434596125) { + out_4998597365434596125[0] = state[6]; + out_4998597365434596125[1] = state[7]; + out_4998597365434596125[2] = state[8]; } -void H_14(double *state, double *unused, double *out_1809391298063209273) { - out_1809391298063209273[0] = 0; - out_1809391298063209273[1] = 0; - out_1809391298063209273[2] = 0; - out_1809391298063209273[3] = 0; - out_1809391298063209273[4] = 0; - out_1809391298063209273[5] = 0; - out_1809391298063209273[6] = 1; - out_1809391298063209273[7] = 0; - out_1809391298063209273[8] = 0; - out_1809391298063209273[9] = 0; - out_1809391298063209273[10] = 0; - out_1809391298063209273[11] = 0; - out_1809391298063209273[12] = 0; - out_1809391298063209273[13] = 0; - out_1809391298063209273[14] = 0; - out_1809391298063209273[15] = 0; - out_1809391298063209273[16] = 0; - out_1809391298063209273[17] = 0; - out_1809391298063209273[18] = 0; - out_1809391298063209273[19] = 0; - out_1809391298063209273[20] = 0; - out_1809391298063209273[21] = 0; - out_1809391298063209273[22] = 0; - out_1809391298063209273[23] = 0; - out_1809391298063209273[24] = 0; - out_1809391298063209273[25] = 1; - out_1809391298063209273[26] = 0; - out_1809391298063209273[27] = 0; - out_1809391298063209273[28] = 0; - out_1809391298063209273[29] = 0; - out_1809391298063209273[30] = 0; - out_1809391298063209273[31] = 0; - out_1809391298063209273[32] = 0; - out_1809391298063209273[33] = 0; - out_1809391298063209273[34] = 0; - out_1809391298063209273[35] = 0; - out_1809391298063209273[36] = 0; - out_1809391298063209273[37] = 0; - out_1809391298063209273[38] = 0; - out_1809391298063209273[39] = 0; - out_1809391298063209273[40] = 0; - out_1809391298063209273[41] = 0; - out_1809391298063209273[42] = 0; - out_1809391298063209273[43] = 0; - out_1809391298063209273[44] = 1; - out_1809391298063209273[45] = 0; - out_1809391298063209273[46] = 0; - out_1809391298063209273[47] = 0; - out_1809391298063209273[48] = 0; - out_1809391298063209273[49] = 0; - out_1809391298063209273[50] = 0; - out_1809391298063209273[51] = 0; - out_1809391298063209273[52] = 0; - out_1809391298063209273[53] = 0; +void H_14(double *state, double *unused, double *out_328647911052892438) { + out_328647911052892438[0] = 0; + out_328647911052892438[1] = 0; + out_328647911052892438[2] = 0; + out_328647911052892438[3] = 0; + out_328647911052892438[4] = 0; + out_328647911052892438[5] = 0; + out_328647911052892438[6] = 1; + out_328647911052892438[7] = 0; + out_328647911052892438[8] = 0; + out_328647911052892438[9] = 0; + out_328647911052892438[10] = 0; + out_328647911052892438[11] = 0; + out_328647911052892438[12] = 0; + out_328647911052892438[13] = 0; + out_328647911052892438[14] = 0; + out_328647911052892438[15] = 0; + out_328647911052892438[16] = 0; + out_328647911052892438[17] = 0; + out_328647911052892438[18] = 0; + out_328647911052892438[19] = 0; + out_328647911052892438[20] = 0; + out_328647911052892438[21] = 0; + out_328647911052892438[22] = 0; + out_328647911052892438[23] = 0; + out_328647911052892438[24] = 0; + out_328647911052892438[25] = 1; + out_328647911052892438[26] = 0; + out_328647911052892438[27] = 0; + out_328647911052892438[28] = 0; + out_328647911052892438[29] = 0; + out_328647911052892438[30] = 0; + out_328647911052892438[31] = 0; + out_328647911052892438[32] = 0; + out_328647911052892438[33] = 0; + out_328647911052892438[34] = 0; + out_328647911052892438[35] = 0; + out_328647911052892438[36] = 0; + out_328647911052892438[37] = 0; + out_328647911052892438[38] = 0; + out_328647911052892438[39] = 0; + out_328647911052892438[40] = 0; + out_328647911052892438[41] = 0; + out_328647911052892438[42] = 0; + out_328647911052892438[43] = 0; + out_328647911052892438[44] = 1; + out_328647911052892438[45] = 0; + out_328647911052892438[46] = 0; + out_328647911052892438[47] = 0; + out_328647911052892438[48] = 0; + out_328647911052892438[49] = 0; + out_328647911052892438[50] = 0; + out_328647911052892438[51] = 0; + out_328647911052892438[52] = 0; + out_328647911052892438[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_8386835163844872263) { - err_fun(nom_x, delta_x, out_8386835163844872263); +void pose_err_fun(double *nom_x, double *delta_x, double *out_7675941765646048454) { + err_fun(nom_x, delta_x, out_7675941765646048454); } -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_5826204590882848019) { - inv_err_fun(nom_x, true_x, out_5826204590882848019); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_6578985106349638079) { + inv_err_fun(nom_x, true_x, out_6578985106349638079); } -void pose_H_mod_fun(double *state, double *out_7521593534267777079) { - H_mod_fun(state, out_7521593534267777079); +void pose_H_mod_fun(double *state, double *out_8249219982215908455) { + H_mod_fun(state, out_8249219982215908455); } -void pose_f_fun(double *state, double dt, double *out_8190127916652503129) { - f_fun(state, dt, out_8190127916652503129); +void pose_f_fun(double *state, double dt, double *out_741196485394149917) { + f_fun(state, dt, out_741196485394149917); } -void pose_F_fun(double *state, double dt, double *out_8302830792992532360) { - F_fun(state, dt, out_8302830792992532360); +void pose_F_fun(double *state, double dt, double *out_914245573923806659) { + F_fun(state, dt, out_914245573923806659); } -void pose_h_4(double *state, double *unused, double *out_6664200415740758039) { - h_4(state, unused, out_6664200415740758039); +void pose_h_4(double *state, double *unused, double *out_1661592600804563205) { + h_4(state, unused, out_1661592600804563205); } -void pose_H_4(double *state, double *unused, double *out_5772632154402693802) { - H_4(state, unused, out_5772632154402693802); +void pose_H_4(double *state, double *unused, double *out_3634592945286592091) { + H_4(state, unused, out_3634592945286592091); } -void pose_h_10(double *state, double *unused, double *out_2232580687525306632) { - h_10(state, unused, out_2232580687525306632); +void pose_h_10(double *state, double *unused, double *out_1540829144479980375) { + h_10(state, unused, out_1540829144479980375); } -void pose_H_10(double *state, double *unused, double *out_1994505413045679835) { - H_10(state, unused, out_1994505413045679835); +void pose_H_10(double *state, double *unused, double *out_3859318150895892325) { + H_10(state, unused, out_3859318150895892325); } -void pose_h_13(double *state, double *unused, double *out_1739439411373720736) { - h_13(state, unused, out_1739439411373720736); +void pose_h_13(double *state, double *unused, double *out_1494548337638663963) { + h_13(state, unused, out_1494548337638663963); } -void pose_H_13(double *state, double *unused, double *out_2560358329070361001) { - H_13(state, unused, out_2560358329070361001); +void pose_H_13(double *state, double *unused, double *out_422319119954259290) { + H_13(state, unused, out_422319119954259290); } -void pose_h_14(double *state, double *unused, double *out_2162487226046509469) { - h_14(state, unused, out_2162487226046509469); +void pose_h_14(double *state, double *unused, double *out_4998597365434596125) { + h_14(state, unused, out_4998597365434596125); } -void pose_H_14(double *state, double *unused, double *out_1809391298063209273) { - H_14(state, unused, out_1809391298063209273); +void pose_H_14(double *state, double *unused, double *out_328647911052892438) { + H_14(state, unused, out_328647911052892438); } 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 2d2b3dc2b7..480fb69893 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_8386835163844872263); -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_5826204590882848019); -void pose_H_mod_fun(double *state, double *out_7521593534267777079); -void pose_f_fun(double *state, double dt, double *out_8190127916652503129); -void pose_F_fun(double *state, double dt, double *out_8302830792992532360); -void pose_h_4(double *state, double *unused, double *out_6664200415740758039); -void pose_H_4(double *state, double *unused, double *out_5772632154402693802); -void pose_h_10(double *state, double *unused, double *out_2232580687525306632); -void pose_H_10(double *state, double *unused, double *out_1994505413045679835); -void pose_h_13(double *state, double *unused, double *out_1739439411373720736); -void pose_H_13(double *state, double *unused, double *out_2560358329070361001); -void pose_h_14(double *state, double *unused, double *out_2162487226046509469); -void pose_H_14(double *state, double *unused, double *out_1809391298063209273); +void pose_err_fun(double *nom_x, double *delta_x, double *out_7675941765646048454); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_6578985106349638079); +void pose_H_mod_fun(double *state, double *out_8249219982215908455); +void pose_f_fun(double *state, double dt, double *out_741196485394149917); +void pose_F_fun(double *state, double dt, double *out_914245573923806659); +void pose_h_4(double *state, double *unused, double *out_1661592600804563205); +void pose_H_4(double *state, double *unused, double *out_3634592945286592091); +void pose_h_10(double *state, double *unused, double *out_1540829144479980375); +void pose_H_10(double *state, double *unused, double *out_3859318150895892325); +void pose_h_13(double *state, double *unused, double *out_1494548337638663963); +void pose_H_13(double *state, double *unused, double *out_422319119954259290); +void pose_h_14(double *state, double *unused, double *out_4998597365434596125); +void pose_H_14(double *state, double *unused, double *out_328647911052892438); 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 7cd9da3eb9..f3df37c24c 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 80ddacfab5..85b543a213 100755 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 9d0ce60d3c..6ba4f7917d 100755 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_h7.bin b/panda/board/obj/bootstub.panda_h7.bin index 7305462369..e73c7b8228 100755 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/gitversion.h b/panda/board/obj/gitversion.h index 10fa394d29..f2fccb78e8 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-a2602aa3-P92eb5651-DEBUG"; +const uint8_t gitversion[29] = "DEV-44048a30-P92eb5651-DEBUG"; diff --git a/panda/board/obj/panda.bin.signed b/panda/board/obj/panda.bin.signed index 99c8a84de5..86520efeca 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_h7.bin.signed b/panda/board/obj/panda_h7.bin.signed index 5c7d45ec6f..f041cf886f 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/version b/panda/board/obj/version index d37ab1e53b..59b446040c 100644 --- a/panda/board/obj/version +++ b/panda/board/obj/version @@ -1 +1 @@ -DEV-a2602aa3-P92eb5651-DEBUG \ No newline at end of file +DEV-44048a30-P92eb5651-DEBUG \ No newline at end of file diff --git a/prebuilt.json b/prebuilt.json index 5a1de5c40b..162fe7c640 100644 --- a/prebuilt.json +++ b/prebuilt.json @@ -1 +1 @@ -{"protected_inventory_sha256": "c2e4e536170d6b29ca3772814021cac69f5e5cf68514fc1a4c6eb513fe34a671", "schema_version": 1} +{"protected_inventory_sha256": "b4e686661d5f6afd9c25218e0374c35fc155aca5019ba5f579cd5f71341dda93", "schema_version": 1}