diff --git a/openpilot/selfdrive/locationd/models/generated/car.cpp b/openpilot/selfdrive/locationd/models/generated/car.cpp index a4cc40a5ff..f4020a9e71 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_9110105061904509225) { - out_9110105061904509225[0] = delta_x[0] + nom_x[0]; - out_9110105061904509225[1] = delta_x[1] + nom_x[1]; - out_9110105061904509225[2] = delta_x[2] + nom_x[2]; - out_9110105061904509225[3] = delta_x[3] + nom_x[3]; - out_9110105061904509225[4] = delta_x[4] + nom_x[4]; - out_9110105061904509225[5] = delta_x[5] + nom_x[5]; - out_9110105061904509225[6] = delta_x[6] + nom_x[6]; - out_9110105061904509225[7] = delta_x[7] + nom_x[7]; - out_9110105061904509225[8] = delta_x[8] + nom_x[8]; +void err_fun(double *nom_x, double *delta_x, double *out_3628762341002155077) { + out_3628762341002155077[0] = delta_x[0] + nom_x[0]; + out_3628762341002155077[1] = delta_x[1] + nom_x[1]; + out_3628762341002155077[2] = delta_x[2] + nom_x[2]; + out_3628762341002155077[3] = delta_x[3] + nom_x[3]; + out_3628762341002155077[4] = delta_x[4] + nom_x[4]; + out_3628762341002155077[5] = delta_x[5] + nom_x[5]; + out_3628762341002155077[6] = delta_x[6] + nom_x[6]; + out_3628762341002155077[7] = delta_x[7] + nom_x[7]; + out_3628762341002155077[8] = delta_x[8] + nom_x[8]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_3235904000805918128) { - out_3235904000805918128[0] = -nom_x[0] + true_x[0]; - out_3235904000805918128[1] = -nom_x[1] + true_x[1]; - out_3235904000805918128[2] = -nom_x[2] + true_x[2]; - out_3235904000805918128[3] = -nom_x[3] + true_x[3]; - out_3235904000805918128[4] = -nom_x[4] + true_x[4]; - out_3235904000805918128[5] = -nom_x[5] + true_x[5]; - out_3235904000805918128[6] = -nom_x[6] + true_x[6]; - out_3235904000805918128[7] = -nom_x[7] + true_x[7]; - out_3235904000805918128[8] = -nom_x[8] + true_x[8]; +void inv_err_fun(double *nom_x, double *true_x, double *out_8326913521565900806) { + out_8326913521565900806[0] = -nom_x[0] + true_x[0]; + out_8326913521565900806[1] = -nom_x[1] + true_x[1]; + out_8326913521565900806[2] = -nom_x[2] + true_x[2]; + out_8326913521565900806[3] = -nom_x[3] + true_x[3]; + out_8326913521565900806[4] = -nom_x[4] + true_x[4]; + out_8326913521565900806[5] = -nom_x[5] + true_x[5]; + out_8326913521565900806[6] = -nom_x[6] + true_x[6]; + out_8326913521565900806[7] = -nom_x[7] + true_x[7]; + out_8326913521565900806[8] = -nom_x[8] + true_x[8]; } -void H_mod_fun(double *state, double *out_6378495611849220177) { - out_6378495611849220177[0] = 1.0; - out_6378495611849220177[1] = 0.0; - out_6378495611849220177[2] = 0.0; - out_6378495611849220177[3] = 0.0; - out_6378495611849220177[4] = 0.0; - out_6378495611849220177[5] = 0.0; - out_6378495611849220177[6] = 0.0; - out_6378495611849220177[7] = 0.0; - out_6378495611849220177[8] = 0.0; - out_6378495611849220177[9] = 0.0; - out_6378495611849220177[10] = 1.0; - out_6378495611849220177[11] = 0.0; - out_6378495611849220177[12] = 0.0; - out_6378495611849220177[13] = 0.0; - out_6378495611849220177[14] = 0.0; - out_6378495611849220177[15] = 0.0; - out_6378495611849220177[16] = 0.0; - out_6378495611849220177[17] = 0.0; - out_6378495611849220177[18] = 0.0; - out_6378495611849220177[19] = 0.0; - out_6378495611849220177[20] = 1.0; - out_6378495611849220177[21] = 0.0; - out_6378495611849220177[22] = 0.0; - out_6378495611849220177[23] = 0.0; - out_6378495611849220177[24] = 0.0; - out_6378495611849220177[25] = 0.0; - out_6378495611849220177[26] = 0.0; - out_6378495611849220177[27] = 0.0; - out_6378495611849220177[28] = 0.0; - out_6378495611849220177[29] = 0.0; - out_6378495611849220177[30] = 1.0; - out_6378495611849220177[31] = 0.0; - out_6378495611849220177[32] = 0.0; - out_6378495611849220177[33] = 0.0; - out_6378495611849220177[34] = 0.0; - out_6378495611849220177[35] = 0.0; - out_6378495611849220177[36] = 0.0; - out_6378495611849220177[37] = 0.0; - out_6378495611849220177[38] = 0.0; - out_6378495611849220177[39] = 0.0; - out_6378495611849220177[40] = 1.0; - out_6378495611849220177[41] = 0.0; - out_6378495611849220177[42] = 0.0; - out_6378495611849220177[43] = 0.0; - out_6378495611849220177[44] = 0.0; - out_6378495611849220177[45] = 0.0; - out_6378495611849220177[46] = 0.0; - out_6378495611849220177[47] = 0.0; - out_6378495611849220177[48] = 0.0; - out_6378495611849220177[49] = 0.0; - out_6378495611849220177[50] = 1.0; - out_6378495611849220177[51] = 0.0; - out_6378495611849220177[52] = 0.0; - out_6378495611849220177[53] = 0.0; - out_6378495611849220177[54] = 0.0; - out_6378495611849220177[55] = 0.0; - out_6378495611849220177[56] = 0.0; - out_6378495611849220177[57] = 0.0; - out_6378495611849220177[58] = 0.0; - out_6378495611849220177[59] = 0.0; - out_6378495611849220177[60] = 1.0; - out_6378495611849220177[61] = 0.0; - out_6378495611849220177[62] = 0.0; - out_6378495611849220177[63] = 0.0; - out_6378495611849220177[64] = 0.0; - out_6378495611849220177[65] = 0.0; - out_6378495611849220177[66] = 0.0; - out_6378495611849220177[67] = 0.0; - out_6378495611849220177[68] = 0.0; - out_6378495611849220177[69] = 0.0; - out_6378495611849220177[70] = 1.0; - out_6378495611849220177[71] = 0.0; - out_6378495611849220177[72] = 0.0; - out_6378495611849220177[73] = 0.0; - out_6378495611849220177[74] = 0.0; - out_6378495611849220177[75] = 0.0; - out_6378495611849220177[76] = 0.0; - out_6378495611849220177[77] = 0.0; - out_6378495611849220177[78] = 0.0; - out_6378495611849220177[79] = 0.0; - out_6378495611849220177[80] = 1.0; +void H_mod_fun(double *state, double *out_1936405662837462559) { + out_1936405662837462559[0] = 1.0; + out_1936405662837462559[1] = 0.0; + out_1936405662837462559[2] = 0.0; + out_1936405662837462559[3] = 0.0; + out_1936405662837462559[4] = 0.0; + out_1936405662837462559[5] = 0.0; + out_1936405662837462559[6] = 0.0; + out_1936405662837462559[7] = 0.0; + out_1936405662837462559[8] = 0.0; + out_1936405662837462559[9] = 0.0; + out_1936405662837462559[10] = 1.0; + out_1936405662837462559[11] = 0.0; + out_1936405662837462559[12] = 0.0; + out_1936405662837462559[13] = 0.0; + out_1936405662837462559[14] = 0.0; + out_1936405662837462559[15] = 0.0; + out_1936405662837462559[16] = 0.0; + out_1936405662837462559[17] = 0.0; + out_1936405662837462559[18] = 0.0; + out_1936405662837462559[19] = 0.0; + out_1936405662837462559[20] = 1.0; + out_1936405662837462559[21] = 0.0; + out_1936405662837462559[22] = 0.0; + out_1936405662837462559[23] = 0.0; + out_1936405662837462559[24] = 0.0; + out_1936405662837462559[25] = 0.0; + out_1936405662837462559[26] = 0.0; + out_1936405662837462559[27] = 0.0; + out_1936405662837462559[28] = 0.0; + out_1936405662837462559[29] = 0.0; + out_1936405662837462559[30] = 1.0; + out_1936405662837462559[31] = 0.0; + out_1936405662837462559[32] = 0.0; + out_1936405662837462559[33] = 0.0; + out_1936405662837462559[34] = 0.0; + out_1936405662837462559[35] = 0.0; + out_1936405662837462559[36] = 0.0; + out_1936405662837462559[37] = 0.0; + out_1936405662837462559[38] = 0.0; + out_1936405662837462559[39] = 0.0; + out_1936405662837462559[40] = 1.0; + out_1936405662837462559[41] = 0.0; + out_1936405662837462559[42] = 0.0; + out_1936405662837462559[43] = 0.0; + out_1936405662837462559[44] = 0.0; + out_1936405662837462559[45] = 0.0; + out_1936405662837462559[46] = 0.0; + out_1936405662837462559[47] = 0.0; + out_1936405662837462559[48] = 0.0; + out_1936405662837462559[49] = 0.0; + out_1936405662837462559[50] = 1.0; + out_1936405662837462559[51] = 0.0; + out_1936405662837462559[52] = 0.0; + out_1936405662837462559[53] = 0.0; + out_1936405662837462559[54] = 0.0; + out_1936405662837462559[55] = 0.0; + out_1936405662837462559[56] = 0.0; + out_1936405662837462559[57] = 0.0; + out_1936405662837462559[58] = 0.0; + out_1936405662837462559[59] = 0.0; + out_1936405662837462559[60] = 1.0; + out_1936405662837462559[61] = 0.0; + out_1936405662837462559[62] = 0.0; + out_1936405662837462559[63] = 0.0; + out_1936405662837462559[64] = 0.0; + out_1936405662837462559[65] = 0.0; + out_1936405662837462559[66] = 0.0; + out_1936405662837462559[67] = 0.0; + out_1936405662837462559[68] = 0.0; + out_1936405662837462559[69] = 0.0; + out_1936405662837462559[70] = 1.0; + out_1936405662837462559[71] = 0.0; + out_1936405662837462559[72] = 0.0; + out_1936405662837462559[73] = 0.0; + out_1936405662837462559[74] = 0.0; + out_1936405662837462559[75] = 0.0; + out_1936405662837462559[76] = 0.0; + out_1936405662837462559[77] = 0.0; + out_1936405662837462559[78] = 0.0; + out_1936405662837462559[79] = 0.0; + out_1936405662837462559[80] = 1.0; } -void f_fun(double *state, double dt, double *out_6959068607126581523) { - out_6959068607126581523[0] = state[0]; - out_6959068607126581523[1] = state[1]; - out_6959068607126581523[2] = state[2]; - out_6959068607126581523[3] = state[3]; - out_6959068607126581523[4] = state[4]; - out_6959068607126581523[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_6959068607126581523[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_6959068607126581523[7] = state[7]; - out_6959068607126581523[8] = state[8]; +void f_fun(double *state, double dt, double *out_5241560014263660552) { + out_5241560014263660552[0] = state[0]; + out_5241560014263660552[1] = state[1]; + out_5241560014263660552[2] = state[2]; + out_5241560014263660552[3] = state[3]; + out_5241560014263660552[4] = state[4]; + out_5241560014263660552[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_5241560014263660552[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_5241560014263660552[7] = state[7]; + out_5241560014263660552[8] = state[8]; } -void F_fun(double *state, double dt, double *out_321314453042049537) { - out_321314453042049537[0] = 1; - out_321314453042049537[1] = 0; - out_321314453042049537[2] = 0; - out_321314453042049537[3] = 0; - out_321314453042049537[4] = 0; - out_321314453042049537[5] = 0; - out_321314453042049537[6] = 0; - out_321314453042049537[7] = 0; - out_321314453042049537[8] = 0; - out_321314453042049537[9] = 0; - out_321314453042049537[10] = 1; - out_321314453042049537[11] = 0; - out_321314453042049537[12] = 0; - out_321314453042049537[13] = 0; - out_321314453042049537[14] = 0; - out_321314453042049537[15] = 0; - out_321314453042049537[16] = 0; - out_321314453042049537[17] = 0; - out_321314453042049537[18] = 0; - out_321314453042049537[19] = 0; - out_321314453042049537[20] = 1; - out_321314453042049537[21] = 0; - out_321314453042049537[22] = 0; - out_321314453042049537[23] = 0; - out_321314453042049537[24] = 0; - out_321314453042049537[25] = 0; - out_321314453042049537[26] = 0; - out_321314453042049537[27] = 0; - out_321314453042049537[28] = 0; - out_321314453042049537[29] = 0; - out_321314453042049537[30] = 1; - out_321314453042049537[31] = 0; - out_321314453042049537[32] = 0; - out_321314453042049537[33] = 0; - out_321314453042049537[34] = 0; - out_321314453042049537[35] = 0; - out_321314453042049537[36] = 0; - out_321314453042049537[37] = 0; - out_321314453042049537[38] = 0; - out_321314453042049537[39] = 0; - out_321314453042049537[40] = 1; - out_321314453042049537[41] = 0; - out_321314453042049537[42] = 0; - out_321314453042049537[43] = 0; - out_321314453042049537[44] = 0; - out_321314453042049537[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_321314453042049537[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); - out_321314453042049537[47] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_321314453042049537[48] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_321314453042049537[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_321314453042049537[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; - out_321314453042049537[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); - out_321314453042049537[52] = dt*stiffness_front*state[0]/(mass*state[1]); - out_321314453042049537[53] = -9.8100000000000005*dt; - out_321314453042049537[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_321314453042049537[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); - out_321314453042049537[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_321314453042049537[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_321314453042049537[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_321314453042049537[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); - out_321314453042049537[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_321314453042049537[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_321314453042049537[62] = 0; - out_321314453042049537[63] = 0; - out_321314453042049537[64] = 0; - out_321314453042049537[65] = 0; - out_321314453042049537[66] = 0; - out_321314453042049537[67] = 0; - out_321314453042049537[68] = 0; - out_321314453042049537[69] = 0; - out_321314453042049537[70] = 1; - out_321314453042049537[71] = 0; - out_321314453042049537[72] = 0; - out_321314453042049537[73] = 0; - out_321314453042049537[74] = 0; - out_321314453042049537[75] = 0; - out_321314453042049537[76] = 0; - out_321314453042049537[77] = 0; - out_321314453042049537[78] = 0; - out_321314453042049537[79] = 0; - out_321314453042049537[80] = 1; +void F_fun(double *state, double dt, double *out_8799266228203575332) { + out_8799266228203575332[0] = 1; + out_8799266228203575332[1] = 0; + out_8799266228203575332[2] = 0; + out_8799266228203575332[3] = 0; + out_8799266228203575332[4] = 0; + out_8799266228203575332[5] = 0; + out_8799266228203575332[6] = 0; + out_8799266228203575332[7] = 0; + out_8799266228203575332[8] = 0; + out_8799266228203575332[9] = 0; + out_8799266228203575332[10] = 1; + out_8799266228203575332[11] = 0; + out_8799266228203575332[12] = 0; + out_8799266228203575332[13] = 0; + out_8799266228203575332[14] = 0; + out_8799266228203575332[15] = 0; + out_8799266228203575332[16] = 0; + out_8799266228203575332[17] = 0; + out_8799266228203575332[18] = 0; + out_8799266228203575332[19] = 0; + out_8799266228203575332[20] = 1; + out_8799266228203575332[21] = 0; + out_8799266228203575332[22] = 0; + out_8799266228203575332[23] = 0; + out_8799266228203575332[24] = 0; + out_8799266228203575332[25] = 0; + out_8799266228203575332[26] = 0; + out_8799266228203575332[27] = 0; + out_8799266228203575332[28] = 0; + out_8799266228203575332[29] = 0; + out_8799266228203575332[30] = 1; + out_8799266228203575332[31] = 0; + out_8799266228203575332[32] = 0; + out_8799266228203575332[33] = 0; + out_8799266228203575332[34] = 0; + out_8799266228203575332[35] = 0; + out_8799266228203575332[36] = 0; + out_8799266228203575332[37] = 0; + out_8799266228203575332[38] = 0; + out_8799266228203575332[39] = 0; + out_8799266228203575332[40] = 1; + out_8799266228203575332[41] = 0; + out_8799266228203575332[42] = 0; + out_8799266228203575332[43] = 0; + out_8799266228203575332[44] = 0; + out_8799266228203575332[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_8799266228203575332[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); + out_8799266228203575332[47] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_8799266228203575332[48] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_8799266228203575332[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_8799266228203575332[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; + out_8799266228203575332[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); + out_8799266228203575332[52] = dt*stiffness_front*state[0]/(mass*state[1]); + out_8799266228203575332[53] = -9.8100000000000005*dt; + out_8799266228203575332[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_8799266228203575332[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); + out_8799266228203575332[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_8799266228203575332[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_8799266228203575332[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_8799266228203575332[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); + out_8799266228203575332[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_8799266228203575332[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_8799266228203575332[62] = 0; + out_8799266228203575332[63] = 0; + out_8799266228203575332[64] = 0; + out_8799266228203575332[65] = 0; + out_8799266228203575332[66] = 0; + out_8799266228203575332[67] = 0; + out_8799266228203575332[68] = 0; + out_8799266228203575332[69] = 0; + out_8799266228203575332[70] = 1; + out_8799266228203575332[71] = 0; + out_8799266228203575332[72] = 0; + out_8799266228203575332[73] = 0; + out_8799266228203575332[74] = 0; + out_8799266228203575332[75] = 0; + out_8799266228203575332[76] = 0; + out_8799266228203575332[77] = 0; + out_8799266228203575332[78] = 0; + out_8799266228203575332[79] = 0; + out_8799266228203575332[80] = 1; } -void h_25(double *state, double *unused, double *out_8974464392655101919) { - out_8974464392655101919[0] = state[6]; +void h_25(double *state, double *unused, double *out_1070812002986692230) { + out_1070812002986692230[0] = state[6]; } -void H_25(double *state, double *unused, double *out_3393338321313619400) { - out_3393338321313619400[0] = 0; - out_3393338321313619400[1] = 0; - out_3393338321313619400[2] = 0; - out_3393338321313619400[3] = 0; - out_3393338321313619400[4] = 0; - out_3393338321313619400[5] = 0; - out_3393338321313619400[6] = 1; - out_3393338321313619400[7] = 0; - out_3393338321313619400[8] = 0; +void H_25(double *state, double *unused, double *out_7317150184959851820) { + out_7317150184959851820[0] = 0; + out_7317150184959851820[1] = 0; + out_7317150184959851820[2] = 0; + out_7317150184959851820[3] = 0; + out_7317150184959851820[4] = 0; + out_7317150184959851820[5] = 0; + out_7317150184959851820[6] = 1; + out_7317150184959851820[7] = 0; + out_7317150184959851820[8] = 0; } -void h_24(double *state, double *unused, double *out_1301839241695337441) { - out_1301839241695337441[0] = state[4]; - out_1301839241695337441[1] = state[5]; +void h_24(double *state, double *unused, double *out_8298197210527653023) { + out_8298197210527653023[0] = state[4]; + out_8298197210527653023[1] = state[5]; } -void H_24(double *state, double *unused, double *out_5081154757182723591) { - out_5081154757182723591[0] = 0; - out_5081154757182723591[1] = 0; - out_5081154757182723591[2] = 0; - out_5081154757182723591[3] = 0; - out_5081154757182723591[4] = 1; - out_5081154757182723591[5] = 0; - out_5081154757182723591[6] = 0; - out_5081154757182723591[7] = 0; - out_5081154757182723591[8] = 0; - out_5081154757182723591[9] = 0; - out_5081154757182723591[10] = 0; - out_5081154757182723591[11] = 0; - out_5081154757182723591[12] = 0; - out_5081154757182723591[13] = 0; - out_5081154757182723591[14] = 1; - out_5081154757182723591[15] = 0; - out_5081154757182723591[16] = 0; - out_5081154757182723591[17] = 0; +void H_24(double *state, double *unused, double *out_5144500585954352254) { + out_5144500585954352254[0] = 0; + out_5144500585954352254[1] = 0; + out_5144500585954352254[2] = 0; + out_5144500585954352254[3] = 0; + out_5144500585954352254[4] = 1; + out_5144500585954352254[5] = 0; + out_5144500585954352254[6] = 0; + out_5144500585954352254[7] = 0; + out_5144500585954352254[8] = 0; + out_5144500585954352254[9] = 0; + out_5144500585954352254[10] = 0; + out_5144500585954352254[11] = 0; + out_5144500585954352254[12] = 0; + out_5144500585954352254[13] = 0; + out_5144500585954352254[14] = 1; + out_5144500585954352254[15] = 0; + out_5144500585954352254[16] = 0; + out_5144500585954352254[17] = 0; } -void h_30(double *state, double *unused, double *out_8870861523441086143) { - out_8870861523441086143[0] = state[4]; +void h_30(double *state, double *unused, double *out_5700023223363658706) { + out_5700023223363658706[0] = state[4]; } -void H_30(double *state, double *unused, double *out_5911671279820868027) { - out_5911671279820868027[0] = 0; - out_5911671279820868027[1] = 0; - out_5911671279820868027[2] = 0; - out_5911671279820868027[3] = 0; - out_5911671279820868027[4] = 1; - out_5911671279820868027[5] = 0; - out_5911671279820868027[6] = 0; - out_5911671279820868027[7] = 0; - out_5911671279820868027[8] = 0; +void H_30(double *state, double *unused, double *out_8611260930242451169) { + out_8611260930242451169[0] = 0; + out_8611260930242451169[1] = 0; + out_8611260930242451169[2] = 0; + out_8611260930242451169[3] = 0; + out_8611260930242451169[4] = 1; + out_8611260930242451169[5] = 0; + out_8611260930242451169[6] = 0; + out_8611260930242451169[7] = 0; + out_8611260930242451169[8] = 0; } -void h_26(double *state, double *unused, double *out_8267545638764608626) { - out_8267545638764608626[0] = state[7]; +void h_26(double *state, double *unused, double *out_8348768769064263898) { + out_8348768769064263898[0] = state[7]; } -void H_26(double *state, double *unused, double *out_348164997560436824) { - out_348164997560436824[0] = 0; - out_348164997560436824[1] = 0; - out_348164997560436824[2] = 0; - out_348164997560436824[3] = 0; - out_348164997560436824[4] = 0; - out_348164997560436824[5] = 0; - out_348164997560436824[6] = 0; - out_348164997560436824[7] = 1; - out_348164997560436824[8] = 0; +void H_26(double *state, double *unused, double *out_7825067918988899195) { + out_7825067918988899195[0] = 0; + out_7825067918988899195[1] = 0; + out_7825067918988899195[2] = 0; + out_7825067918988899195[3] = 0; + out_7825067918988899195[4] = 0; + out_7825067918988899195[5] = 0; + out_7825067918988899195[6] = 0; + out_7825067918988899195[7] = 1; + out_7825067918988899195[8] = 0; } -void h_27(double *state, double *unused, double *out_1339523744063128545) { - out_1339523744063128545[0] = state[3]; +void h_27(double *state, double *unused, double *out_6986442756720554566) { + out_6986442756720554566[0] = state[3]; } -void H_27(double *state, double *unused, double *out_3736907968020443116) { - out_3736907968020443116[0] = 0; - out_3736907968020443116[1] = 0; - out_3736907968020443116[2] = 0; - out_3736907968020443116[3] = 1; - out_3736907968020443116[4] = 0; - out_3736907968020443116[5] = 0; - out_3736907968020443116[6] = 0; - out_3736907968020443116[7] = 0; - out_3736907968020443116[8] = 0; +void H_27(double *state, double *unused, double *out_6387666859058507952) { + out_6387666859058507952[0] = 0; + out_6387666859058507952[1] = 0; + out_6387666859058507952[2] = 0; + out_6387666859058507952[3] = 1; + out_6387666859058507952[4] = 0; + out_6387666859058507952[5] = 0; + out_6387666859058507952[6] = 0; + out_6387666859058507952[7] = 0; + out_6387666859058507952[8] = 0; } -void h_29(double *state, double *unused, double *out_111107648565754622) { - out_111107648565754622[0] = state[1]; +void h_29(double *state, double *unused, double *out_546427834096514762) { + out_546427834096514762[0] = state[1]; } -void H_29(double *state, double *unused, double *out_6421902624135260211) { - out_6421902624135260211[0] = 0; - out_6421902624135260211[1] = 1; - out_6421902624135260211[2] = 0; - out_6421902624135260211[3] = 0; - out_6421902624135260211[4] = 0; - out_6421902624135260211[5] = 0; - out_6421902624135260211[6] = 0; - out_6421902624135260211[7] = 0; - out_6421902624135260211[8] = 0; +void H_29(double *state, double *unused, double *out_8101029585928058985) { + out_8101029585928058985[0] = 0; + out_8101029585928058985[1] = 1; + out_8101029585928058985[2] = 0; + out_8101029585928058985[3] = 0; + out_8101029585928058985[4] = 0; + out_8101029585928058985[5] = 0; + out_8101029585928058985[6] = 0; + out_8101029585928058985[7] = 0; + out_8101029585928058985[8] = 0; } -void h_28(double *state, double *unused, double *out_1253116090841068673) { - out_1253116090841068673[0] = state[0]; +void h_28(double *state, double *unused, double *out_5128975417745875440) { + out_5128975417745875440[0] = state[0]; } -void H_28(double *state, double *unused, double *out_1339503607065729637) { - out_1339503607065729637[0] = 1; - out_1339503607065729637[1] = 0; - out_1339503607065729637[2] = 0; - out_1339503607065729637[3] = 0; - out_1339503607065729637[4] = 0; - out_1339503607065729637[5] = 0; - out_1339503607065729637[6] = 0; - out_1339503607065729637[7] = 0; - out_1339503607065729637[8] = 0; +void H_28(double *state, double *unused, double *out_5263315470711962057) { + out_5263315470711962057[0] = 1; + out_5263315470711962057[1] = 0; + out_5263315470711962057[2] = 0; + out_5263315470711962057[3] = 0; + out_5263315470711962057[4] = 0; + out_5263315470711962057[5] = 0; + out_5263315470711962057[6] = 0; + out_5263315470711962057[7] = 0; + out_5263315470711962057[8] = 0; } -void h_31(double *state, double *unused, double *out_1211199135834429478) { - out_1211199135834429478[0] = state[8]; +void h_31(double *state, double *unused, double *out_2521443395615575397) { + out_2521443395615575397[0] = state[8]; } -void H_31(double *state, double *unused, double *out_974373099793788300) { - out_974373099793788300[0] = 0; - out_974373099793788300[1] = 0; - out_974373099793788300[2] = 0; - out_974373099793788300[3] = 0; - out_974373099793788300[4] = 0; - out_974373099793788300[5] = 0; - out_974373099793788300[6] = 0; - out_974373099793788300[7] = 0; - out_974373099793788300[8] = 1; +void H_31(double *state, double *unused, double *out_8451276021222250671) { + out_8451276021222250671[0] = 0; + out_8451276021222250671[1] = 0; + out_8451276021222250671[2] = 0; + out_8451276021222250671[3] = 0; + out_8451276021222250671[4] = 0; + out_8451276021222250671[5] = 0; + out_8451276021222250671[6] = 0; + out_8451276021222250671[7] = 0; + out_8451276021222250671[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_9110105061904509225) { - err_fun(nom_x, delta_x, out_9110105061904509225); +void car_err_fun(double *nom_x, double *delta_x, double *out_3628762341002155077) { + err_fun(nom_x, delta_x, out_3628762341002155077); } -void car_inv_err_fun(double *nom_x, double *true_x, double *out_3235904000805918128) { - inv_err_fun(nom_x, true_x, out_3235904000805918128); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_8326913521565900806) { + inv_err_fun(nom_x, true_x, out_8326913521565900806); } -void car_H_mod_fun(double *state, double *out_6378495611849220177) { - H_mod_fun(state, out_6378495611849220177); +void car_H_mod_fun(double *state, double *out_1936405662837462559) { + H_mod_fun(state, out_1936405662837462559); } -void car_f_fun(double *state, double dt, double *out_6959068607126581523) { - f_fun(state, dt, out_6959068607126581523); +void car_f_fun(double *state, double dt, double *out_5241560014263660552) { + f_fun(state, dt, out_5241560014263660552); } -void car_F_fun(double *state, double dt, double *out_321314453042049537) { - F_fun(state, dt, out_321314453042049537); +void car_F_fun(double *state, double dt, double *out_8799266228203575332) { + F_fun(state, dt, out_8799266228203575332); } -void car_h_25(double *state, double *unused, double *out_8974464392655101919) { - h_25(state, unused, out_8974464392655101919); +void car_h_25(double *state, double *unused, double *out_1070812002986692230) { + h_25(state, unused, out_1070812002986692230); } -void car_H_25(double *state, double *unused, double *out_3393338321313619400) { - H_25(state, unused, out_3393338321313619400); +void car_H_25(double *state, double *unused, double *out_7317150184959851820) { + H_25(state, unused, out_7317150184959851820); } -void car_h_24(double *state, double *unused, double *out_1301839241695337441) { - h_24(state, unused, out_1301839241695337441); +void car_h_24(double *state, double *unused, double *out_8298197210527653023) { + h_24(state, unused, out_8298197210527653023); } -void car_H_24(double *state, double *unused, double *out_5081154757182723591) { - H_24(state, unused, out_5081154757182723591); +void car_H_24(double *state, double *unused, double *out_5144500585954352254) { + H_24(state, unused, out_5144500585954352254); } -void car_h_30(double *state, double *unused, double *out_8870861523441086143) { - h_30(state, unused, out_8870861523441086143); +void car_h_30(double *state, double *unused, double *out_5700023223363658706) { + h_30(state, unused, out_5700023223363658706); } -void car_H_30(double *state, double *unused, double *out_5911671279820868027) { - H_30(state, unused, out_5911671279820868027); +void car_H_30(double *state, double *unused, double *out_8611260930242451169) { + H_30(state, unused, out_8611260930242451169); } -void car_h_26(double *state, double *unused, double *out_8267545638764608626) { - h_26(state, unused, out_8267545638764608626); +void car_h_26(double *state, double *unused, double *out_8348768769064263898) { + h_26(state, unused, out_8348768769064263898); } -void car_H_26(double *state, double *unused, double *out_348164997560436824) { - H_26(state, unused, out_348164997560436824); +void car_H_26(double *state, double *unused, double *out_7825067918988899195) { + H_26(state, unused, out_7825067918988899195); } -void car_h_27(double *state, double *unused, double *out_1339523744063128545) { - h_27(state, unused, out_1339523744063128545); +void car_h_27(double *state, double *unused, double *out_6986442756720554566) { + h_27(state, unused, out_6986442756720554566); } -void car_H_27(double *state, double *unused, double *out_3736907968020443116) { - H_27(state, unused, out_3736907968020443116); +void car_H_27(double *state, double *unused, double *out_6387666859058507952) { + H_27(state, unused, out_6387666859058507952); } -void car_h_29(double *state, double *unused, double *out_111107648565754622) { - h_29(state, unused, out_111107648565754622); +void car_h_29(double *state, double *unused, double *out_546427834096514762) { + h_29(state, unused, out_546427834096514762); } -void car_H_29(double *state, double *unused, double *out_6421902624135260211) { - H_29(state, unused, out_6421902624135260211); +void car_H_29(double *state, double *unused, double *out_8101029585928058985) { + H_29(state, unused, out_8101029585928058985); } -void car_h_28(double *state, double *unused, double *out_1253116090841068673) { - h_28(state, unused, out_1253116090841068673); +void car_h_28(double *state, double *unused, double *out_5128975417745875440) { + h_28(state, unused, out_5128975417745875440); } -void car_H_28(double *state, double *unused, double *out_1339503607065729637) { - H_28(state, unused, out_1339503607065729637); +void car_H_28(double *state, double *unused, double *out_5263315470711962057) { + H_28(state, unused, out_5263315470711962057); } -void car_h_31(double *state, double *unused, double *out_1211199135834429478) { - h_31(state, unused, out_1211199135834429478); +void car_h_31(double *state, double *unused, double *out_2521443395615575397) { + h_31(state, unused, out_2521443395615575397); } -void car_H_31(double *state, double *unused, double *out_974373099793788300) { - H_31(state, unused, out_974373099793788300); +void car_H_31(double *state, double *unused, double *out_8451276021222250671) { + H_31(state, unused, out_8451276021222250671); } 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 331da441fd..b813b61caa 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_9110105061904509225); -void car_inv_err_fun(double *nom_x, double *true_x, double *out_3235904000805918128); -void car_H_mod_fun(double *state, double *out_6378495611849220177); -void car_f_fun(double *state, double dt, double *out_6959068607126581523); -void car_F_fun(double *state, double dt, double *out_321314453042049537); -void car_h_25(double *state, double *unused, double *out_8974464392655101919); -void car_H_25(double *state, double *unused, double *out_3393338321313619400); -void car_h_24(double *state, double *unused, double *out_1301839241695337441); -void car_H_24(double *state, double *unused, double *out_5081154757182723591); -void car_h_30(double *state, double *unused, double *out_8870861523441086143); -void car_H_30(double *state, double *unused, double *out_5911671279820868027); -void car_h_26(double *state, double *unused, double *out_8267545638764608626); -void car_H_26(double *state, double *unused, double *out_348164997560436824); -void car_h_27(double *state, double *unused, double *out_1339523744063128545); -void car_H_27(double *state, double *unused, double *out_3736907968020443116); -void car_h_29(double *state, double *unused, double *out_111107648565754622); -void car_H_29(double *state, double *unused, double *out_6421902624135260211); -void car_h_28(double *state, double *unused, double *out_1253116090841068673); -void car_H_28(double *state, double *unused, double *out_1339503607065729637); -void car_h_31(double *state, double *unused, double *out_1211199135834429478); -void car_H_31(double *state, double *unused, double *out_974373099793788300); +void car_err_fun(double *nom_x, double *delta_x, double *out_3628762341002155077); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_8326913521565900806); +void car_H_mod_fun(double *state, double *out_1936405662837462559); +void car_f_fun(double *state, double dt, double *out_5241560014263660552); +void car_F_fun(double *state, double dt, double *out_8799266228203575332); +void car_h_25(double *state, double *unused, double *out_1070812002986692230); +void car_H_25(double *state, double *unused, double *out_7317150184959851820); +void car_h_24(double *state, double *unused, double *out_8298197210527653023); +void car_H_24(double *state, double *unused, double *out_5144500585954352254); +void car_h_30(double *state, double *unused, double *out_5700023223363658706); +void car_H_30(double *state, double *unused, double *out_8611260930242451169); +void car_h_26(double *state, double *unused, double *out_8348768769064263898); +void car_H_26(double *state, double *unused, double *out_7825067918988899195); +void car_h_27(double *state, double *unused, double *out_6986442756720554566); +void car_H_27(double *state, double *unused, double *out_6387666859058507952); +void car_h_29(double *state, double *unused, double *out_546427834096514762); +void car_H_29(double *state, double *unused, double *out_8101029585928058985); +void car_h_28(double *state, double *unused, double *out_5128975417745875440); +void car_H_28(double *state, double *unused, double *out_5263315470711962057); +void car_h_31(double *state, double *unused, double *out_2521443395615575397); +void car_H_31(double *state, double *unused, double *out_8451276021222250671); 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 7213bd49f4..4b4416c79b 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 7503dcce0c..c024f1fe4a 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 53cde61750..2d0115f68c 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_1960240961147461763) { - out_1960240961147461763[0] = delta_x[0] + nom_x[0]; - out_1960240961147461763[1] = delta_x[1] + nom_x[1]; - out_1960240961147461763[2] = delta_x[2] + nom_x[2]; - out_1960240961147461763[3] = delta_x[3] + nom_x[3]; - out_1960240961147461763[4] = delta_x[4] + nom_x[4]; - out_1960240961147461763[5] = delta_x[5] + nom_x[5]; - out_1960240961147461763[6] = delta_x[6] + nom_x[6]; - out_1960240961147461763[7] = delta_x[7] + nom_x[7]; - out_1960240961147461763[8] = delta_x[8] + nom_x[8]; - out_1960240961147461763[9] = delta_x[9] + nom_x[9]; - out_1960240961147461763[10] = delta_x[10] + nom_x[10]; - out_1960240961147461763[11] = delta_x[11] + nom_x[11]; - out_1960240961147461763[12] = delta_x[12] + nom_x[12]; - out_1960240961147461763[13] = delta_x[13] + nom_x[13]; - out_1960240961147461763[14] = delta_x[14] + nom_x[14]; - out_1960240961147461763[15] = delta_x[15] + nom_x[15]; - out_1960240961147461763[16] = delta_x[16] + nom_x[16]; - out_1960240961147461763[17] = delta_x[17] + nom_x[17]; +void err_fun(double *nom_x, double *delta_x, double *out_2136964252019170465) { + out_2136964252019170465[0] = delta_x[0] + nom_x[0]; + out_2136964252019170465[1] = delta_x[1] + nom_x[1]; + out_2136964252019170465[2] = delta_x[2] + nom_x[2]; + out_2136964252019170465[3] = delta_x[3] + nom_x[3]; + out_2136964252019170465[4] = delta_x[4] + nom_x[4]; + out_2136964252019170465[5] = delta_x[5] + nom_x[5]; + out_2136964252019170465[6] = delta_x[6] + nom_x[6]; + out_2136964252019170465[7] = delta_x[7] + nom_x[7]; + out_2136964252019170465[8] = delta_x[8] + nom_x[8]; + out_2136964252019170465[9] = delta_x[9] + nom_x[9]; + out_2136964252019170465[10] = delta_x[10] + nom_x[10]; + out_2136964252019170465[11] = delta_x[11] + nom_x[11]; + out_2136964252019170465[12] = delta_x[12] + nom_x[12]; + out_2136964252019170465[13] = delta_x[13] + nom_x[13]; + out_2136964252019170465[14] = delta_x[14] + nom_x[14]; + out_2136964252019170465[15] = delta_x[15] + nom_x[15]; + out_2136964252019170465[16] = delta_x[16] + nom_x[16]; + out_2136964252019170465[17] = delta_x[17] + nom_x[17]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_2311725942617102893) { - out_2311725942617102893[0] = -nom_x[0] + true_x[0]; - out_2311725942617102893[1] = -nom_x[1] + true_x[1]; - out_2311725942617102893[2] = -nom_x[2] + true_x[2]; - out_2311725942617102893[3] = -nom_x[3] + true_x[3]; - out_2311725942617102893[4] = -nom_x[4] + true_x[4]; - out_2311725942617102893[5] = -nom_x[5] + true_x[5]; - out_2311725942617102893[6] = -nom_x[6] + true_x[6]; - out_2311725942617102893[7] = -nom_x[7] + true_x[7]; - out_2311725942617102893[8] = -nom_x[8] + true_x[8]; - out_2311725942617102893[9] = -nom_x[9] + true_x[9]; - out_2311725942617102893[10] = -nom_x[10] + true_x[10]; - out_2311725942617102893[11] = -nom_x[11] + true_x[11]; - out_2311725942617102893[12] = -nom_x[12] + true_x[12]; - out_2311725942617102893[13] = -nom_x[13] + true_x[13]; - out_2311725942617102893[14] = -nom_x[14] + true_x[14]; - out_2311725942617102893[15] = -nom_x[15] + true_x[15]; - out_2311725942617102893[16] = -nom_x[16] + true_x[16]; - out_2311725942617102893[17] = -nom_x[17] + true_x[17]; +void inv_err_fun(double *nom_x, double *true_x, double *out_1227563649279098162) { + out_1227563649279098162[0] = -nom_x[0] + true_x[0]; + out_1227563649279098162[1] = -nom_x[1] + true_x[1]; + out_1227563649279098162[2] = -nom_x[2] + true_x[2]; + out_1227563649279098162[3] = -nom_x[3] + true_x[3]; + out_1227563649279098162[4] = -nom_x[4] + true_x[4]; + out_1227563649279098162[5] = -nom_x[5] + true_x[5]; + out_1227563649279098162[6] = -nom_x[6] + true_x[6]; + out_1227563649279098162[7] = -nom_x[7] + true_x[7]; + out_1227563649279098162[8] = -nom_x[8] + true_x[8]; + out_1227563649279098162[9] = -nom_x[9] + true_x[9]; + out_1227563649279098162[10] = -nom_x[10] + true_x[10]; + out_1227563649279098162[11] = -nom_x[11] + true_x[11]; + out_1227563649279098162[12] = -nom_x[12] + true_x[12]; + out_1227563649279098162[13] = -nom_x[13] + true_x[13]; + out_1227563649279098162[14] = -nom_x[14] + true_x[14]; + out_1227563649279098162[15] = -nom_x[15] + true_x[15]; + out_1227563649279098162[16] = -nom_x[16] + true_x[16]; + out_1227563649279098162[17] = -nom_x[17] + true_x[17]; } -void H_mod_fun(double *state, double *out_3907531448917969471) { - out_3907531448917969471[0] = 1.0; - out_3907531448917969471[1] = 0.0; - out_3907531448917969471[2] = 0.0; - out_3907531448917969471[3] = 0.0; - out_3907531448917969471[4] = 0.0; - out_3907531448917969471[5] = 0.0; - out_3907531448917969471[6] = 0.0; - out_3907531448917969471[7] = 0.0; - out_3907531448917969471[8] = 0.0; - out_3907531448917969471[9] = 0.0; - out_3907531448917969471[10] = 0.0; - out_3907531448917969471[11] = 0.0; - out_3907531448917969471[12] = 0.0; - out_3907531448917969471[13] = 0.0; - out_3907531448917969471[14] = 0.0; - out_3907531448917969471[15] = 0.0; - out_3907531448917969471[16] = 0.0; - out_3907531448917969471[17] = 0.0; - out_3907531448917969471[18] = 0.0; - out_3907531448917969471[19] = 1.0; - out_3907531448917969471[20] = 0.0; - out_3907531448917969471[21] = 0.0; - out_3907531448917969471[22] = 0.0; - out_3907531448917969471[23] = 0.0; - out_3907531448917969471[24] = 0.0; - out_3907531448917969471[25] = 0.0; - out_3907531448917969471[26] = 0.0; - out_3907531448917969471[27] = 0.0; - out_3907531448917969471[28] = 0.0; - out_3907531448917969471[29] = 0.0; - out_3907531448917969471[30] = 0.0; - out_3907531448917969471[31] = 0.0; - out_3907531448917969471[32] = 0.0; - out_3907531448917969471[33] = 0.0; - out_3907531448917969471[34] = 0.0; - out_3907531448917969471[35] = 0.0; - out_3907531448917969471[36] = 0.0; - out_3907531448917969471[37] = 0.0; - out_3907531448917969471[38] = 1.0; - out_3907531448917969471[39] = 0.0; - out_3907531448917969471[40] = 0.0; - out_3907531448917969471[41] = 0.0; - out_3907531448917969471[42] = 0.0; - out_3907531448917969471[43] = 0.0; - out_3907531448917969471[44] = 0.0; - out_3907531448917969471[45] = 0.0; - out_3907531448917969471[46] = 0.0; - out_3907531448917969471[47] = 0.0; - out_3907531448917969471[48] = 0.0; - out_3907531448917969471[49] = 0.0; - out_3907531448917969471[50] = 0.0; - out_3907531448917969471[51] = 0.0; - out_3907531448917969471[52] = 0.0; - out_3907531448917969471[53] = 0.0; - out_3907531448917969471[54] = 0.0; - out_3907531448917969471[55] = 0.0; - out_3907531448917969471[56] = 0.0; - out_3907531448917969471[57] = 1.0; - out_3907531448917969471[58] = 0.0; - out_3907531448917969471[59] = 0.0; - out_3907531448917969471[60] = 0.0; - out_3907531448917969471[61] = 0.0; - out_3907531448917969471[62] = 0.0; - out_3907531448917969471[63] = 0.0; - out_3907531448917969471[64] = 0.0; - out_3907531448917969471[65] = 0.0; - out_3907531448917969471[66] = 0.0; - out_3907531448917969471[67] = 0.0; - out_3907531448917969471[68] = 0.0; - out_3907531448917969471[69] = 0.0; - out_3907531448917969471[70] = 0.0; - out_3907531448917969471[71] = 0.0; - out_3907531448917969471[72] = 0.0; - out_3907531448917969471[73] = 0.0; - out_3907531448917969471[74] = 0.0; - out_3907531448917969471[75] = 0.0; - out_3907531448917969471[76] = 1.0; - out_3907531448917969471[77] = 0.0; - out_3907531448917969471[78] = 0.0; - out_3907531448917969471[79] = 0.0; - out_3907531448917969471[80] = 0.0; - out_3907531448917969471[81] = 0.0; - out_3907531448917969471[82] = 0.0; - out_3907531448917969471[83] = 0.0; - out_3907531448917969471[84] = 0.0; - out_3907531448917969471[85] = 0.0; - out_3907531448917969471[86] = 0.0; - out_3907531448917969471[87] = 0.0; - out_3907531448917969471[88] = 0.0; - out_3907531448917969471[89] = 0.0; - out_3907531448917969471[90] = 0.0; - out_3907531448917969471[91] = 0.0; - out_3907531448917969471[92] = 0.0; - out_3907531448917969471[93] = 0.0; - out_3907531448917969471[94] = 0.0; - out_3907531448917969471[95] = 1.0; - out_3907531448917969471[96] = 0.0; - out_3907531448917969471[97] = 0.0; - out_3907531448917969471[98] = 0.0; - out_3907531448917969471[99] = 0.0; - out_3907531448917969471[100] = 0.0; - out_3907531448917969471[101] = 0.0; - out_3907531448917969471[102] = 0.0; - out_3907531448917969471[103] = 0.0; - out_3907531448917969471[104] = 0.0; - out_3907531448917969471[105] = 0.0; - out_3907531448917969471[106] = 0.0; - out_3907531448917969471[107] = 0.0; - out_3907531448917969471[108] = 0.0; - out_3907531448917969471[109] = 0.0; - out_3907531448917969471[110] = 0.0; - out_3907531448917969471[111] = 0.0; - out_3907531448917969471[112] = 0.0; - out_3907531448917969471[113] = 0.0; - out_3907531448917969471[114] = 1.0; - out_3907531448917969471[115] = 0.0; - out_3907531448917969471[116] = 0.0; - out_3907531448917969471[117] = 0.0; - out_3907531448917969471[118] = 0.0; - out_3907531448917969471[119] = 0.0; - out_3907531448917969471[120] = 0.0; - out_3907531448917969471[121] = 0.0; - out_3907531448917969471[122] = 0.0; - out_3907531448917969471[123] = 0.0; - out_3907531448917969471[124] = 0.0; - out_3907531448917969471[125] = 0.0; - out_3907531448917969471[126] = 0.0; - out_3907531448917969471[127] = 0.0; - out_3907531448917969471[128] = 0.0; - out_3907531448917969471[129] = 0.0; - out_3907531448917969471[130] = 0.0; - out_3907531448917969471[131] = 0.0; - out_3907531448917969471[132] = 0.0; - out_3907531448917969471[133] = 1.0; - out_3907531448917969471[134] = 0.0; - out_3907531448917969471[135] = 0.0; - out_3907531448917969471[136] = 0.0; - out_3907531448917969471[137] = 0.0; - out_3907531448917969471[138] = 0.0; - out_3907531448917969471[139] = 0.0; - out_3907531448917969471[140] = 0.0; - out_3907531448917969471[141] = 0.0; - out_3907531448917969471[142] = 0.0; - out_3907531448917969471[143] = 0.0; - out_3907531448917969471[144] = 0.0; - out_3907531448917969471[145] = 0.0; - out_3907531448917969471[146] = 0.0; - out_3907531448917969471[147] = 0.0; - out_3907531448917969471[148] = 0.0; - out_3907531448917969471[149] = 0.0; - out_3907531448917969471[150] = 0.0; - out_3907531448917969471[151] = 0.0; - out_3907531448917969471[152] = 1.0; - out_3907531448917969471[153] = 0.0; - out_3907531448917969471[154] = 0.0; - out_3907531448917969471[155] = 0.0; - out_3907531448917969471[156] = 0.0; - out_3907531448917969471[157] = 0.0; - out_3907531448917969471[158] = 0.0; - out_3907531448917969471[159] = 0.0; - out_3907531448917969471[160] = 0.0; - out_3907531448917969471[161] = 0.0; - out_3907531448917969471[162] = 0.0; - out_3907531448917969471[163] = 0.0; - out_3907531448917969471[164] = 0.0; - out_3907531448917969471[165] = 0.0; - out_3907531448917969471[166] = 0.0; - out_3907531448917969471[167] = 0.0; - out_3907531448917969471[168] = 0.0; - out_3907531448917969471[169] = 0.0; - out_3907531448917969471[170] = 0.0; - out_3907531448917969471[171] = 1.0; - out_3907531448917969471[172] = 0.0; - out_3907531448917969471[173] = 0.0; - out_3907531448917969471[174] = 0.0; - out_3907531448917969471[175] = 0.0; - out_3907531448917969471[176] = 0.0; - out_3907531448917969471[177] = 0.0; - out_3907531448917969471[178] = 0.0; - out_3907531448917969471[179] = 0.0; - out_3907531448917969471[180] = 0.0; - out_3907531448917969471[181] = 0.0; - out_3907531448917969471[182] = 0.0; - out_3907531448917969471[183] = 0.0; - out_3907531448917969471[184] = 0.0; - out_3907531448917969471[185] = 0.0; - out_3907531448917969471[186] = 0.0; - out_3907531448917969471[187] = 0.0; - out_3907531448917969471[188] = 0.0; - out_3907531448917969471[189] = 0.0; - out_3907531448917969471[190] = 1.0; - out_3907531448917969471[191] = 0.0; - out_3907531448917969471[192] = 0.0; - out_3907531448917969471[193] = 0.0; - out_3907531448917969471[194] = 0.0; - out_3907531448917969471[195] = 0.0; - out_3907531448917969471[196] = 0.0; - out_3907531448917969471[197] = 0.0; - out_3907531448917969471[198] = 0.0; - out_3907531448917969471[199] = 0.0; - out_3907531448917969471[200] = 0.0; - out_3907531448917969471[201] = 0.0; - out_3907531448917969471[202] = 0.0; - out_3907531448917969471[203] = 0.0; - out_3907531448917969471[204] = 0.0; - out_3907531448917969471[205] = 0.0; - out_3907531448917969471[206] = 0.0; - out_3907531448917969471[207] = 0.0; - out_3907531448917969471[208] = 0.0; - out_3907531448917969471[209] = 1.0; - out_3907531448917969471[210] = 0.0; - out_3907531448917969471[211] = 0.0; - out_3907531448917969471[212] = 0.0; - out_3907531448917969471[213] = 0.0; - out_3907531448917969471[214] = 0.0; - out_3907531448917969471[215] = 0.0; - out_3907531448917969471[216] = 0.0; - out_3907531448917969471[217] = 0.0; - out_3907531448917969471[218] = 0.0; - out_3907531448917969471[219] = 0.0; - out_3907531448917969471[220] = 0.0; - out_3907531448917969471[221] = 0.0; - out_3907531448917969471[222] = 0.0; - out_3907531448917969471[223] = 0.0; - out_3907531448917969471[224] = 0.0; - out_3907531448917969471[225] = 0.0; - out_3907531448917969471[226] = 0.0; - out_3907531448917969471[227] = 0.0; - out_3907531448917969471[228] = 1.0; - out_3907531448917969471[229] = 0.0; - out_3907531448917969471[230] = 0.0; - out_3907531448917969471[231] = 0.0; - out_3907531448917969471[232] = 0.0; - out_3907531448917969471[233] = 0.0; - out_3907531448917969471[234] = 0.0; - out_3907531448917969471[235] = 0.0; - out_3907531448917969471[236] = 0.0; - out_3907531448917969471[237] = 0.0; - out_3907531448917969471[238] = 0.0; - out_3907531448917969471[239] = 0.0; - out_3907531448917969471[240] = 0.0; - out_3907531448917969471[241] = 0.0; - out_3907531448917969471[242] = 0.0; - out_3907531448917969471[243] = 0.0; - out_3907531448917969471[244] = 0.0; - out_3907531448917969471[245] = 0.0; - out_3907531448917969471[246] = 0.0; - out_3907531448917969471[247] = 1.0; - out_3907531448917969471[248] = 0.0; - out_3907531448917969471[249] = 0.0; - out_3907531448917969471[250] = 0.0; - out_3907531448917969471[251] = 0.0; - out_3907531448917969471[252] = 0.0; - out_3907531448917969471[253] = 0.0; - out_3907531448917969471[254] = 0.0; - out_3907531448917969471[255] = 0.0; - out_3907531448917969471[256] = 0.0; - out_3907531448917969471[257] = 0.0; - out_3907531448917969471[258] = 0.0; - out_3907531448917969471[259] = 0.0; - out_3907531448917969471[260] = 0.0; - out_3907531448917969471[261] = 0.0; - out_3907531448917969471[262] = 0.0; - out_3907531448917969471[263] = 0.0; - out_3907531448917969471[264] = 0.0; - out_3907531448917969471[265] = 0.0; - out_3907531448917969471[266] = 1.0; - out_3907531448917969471[267] = 0.0; - out_3907531448917969471[268] = 0.0; - out_3907531448917969471[269] = 0.0; - out_3907531448917969471[270] = 0.0; - out_3907531448917969471[271] = 0.0; - out_3907531448917969471[272] = 0.0; - out_3907531448917969471[273] = 0.0; - out_3907531448917969471[274] = 0.0; - out_3907531448917969471[275] = 0.0; - out_3907531448917969471[276] = 0.0; - out_3907531448917969471[277] = 0.0; - out_3907531448917969471[278] = 0.0; - out_3907531448917969471[279] = 0.0; - out_3907531448917969471[280] = 0.0; - out_3907531448917969471[281] = 0.0; - out_3907531448917969471[282] = 0.0; - out_3907531448917969471[283] = 0.0; - out_3907531448917969471[284] = 0.0; - out_3907531448917969471[285] = 1.0; - out_3907531448917969471[286] = 0.0; - out_3907531448917969471[287] = 0.0; - out_3907531448917969471[288] = 0.0; - out_3907531448917969471[289] = 0.0; - out_3907531448917969471[290] = 0.0; - out_3907531448917969471[291] = 0.0; - out_3907531448917969471[292] = 0.0; - out_3907531448917969471[293] = 0.0; - out_3907531448917969471[294] = 0.0; - out_3907531448917969471[295] = 0.0; - out_3907531448917969471[296] = 0.0; - out_3907531448917969471[297] = 0.0; - out_3907531448917969471[298] = 0.0; - out_3907531448917969471[299] = 0.0; - out_3907531448917969471[300] = 0.0; - out_3907531448917969471[301] = 0.0; - out_3907531448917969471[302] = 0.0; - out_3907531448917969471[303] = 0.0; - out_3907531448917969471[304] = 1.0; - out_3907531448917969471[305] = 0.0; - out_3907531448917969471[306] = 0.0; - out_3907531448917969471[307] = 0.0; - out_3907531448917969471[308] = 0.0; - out_3907531448917969471[309] = 0.0; - out_3907531448917969471[310] = 0.0; - out_3907531448917969471[311] = 0.0; - out_3907531448917969471[312] = 0.0; - out_3907531448917969471[313] = 0.0; - out_3907531448917969471[314] = 0.0; - out_3907531448917969471[315] = 0.0; - out_3907531448917969471[316] = 0.0; - out_3907531448917969471[317] = 0.0; - out_3907531448917969471[318] = 0.0; - out_3907531448917969471[319] = 0.0; - out_3907531448917969471[320] = 0.0; - out_3907531448917969471[321] = 0.0; - out_3907531448917969471[322] = 0.0; - out_3907531448917969471[323] = 1.0; +void H_mod_fun(double *state, double *out_497819547195898390) { + out_497819547195898390[0] = 1.0; + out_497819547195898390[1] = 0.0; + out_497819547195898390[2] = 0.0; + out_497819547195898390[3] = 0.0; + out_497819547195898390[4] = 0.0; + out_497819547195898390[5] = 0.0; + out_497819547195898390[6] = 0.0; + out_497819547195898390[7] = 0.0; + out_497819547195898390[8] = 0.0; + out_497819547195898390[9] = 0.0; + out_497819547195898390[10] = 0.0; + out_497819547195898390[11] = 0.0; + out_497819547195898390[12] = 0.0; + out_497819547195898390[13] = 0.0; + out_497819547195898390[14] = 0.0; + out_497819547195898390[15] = 0.0; + out_497819547195898390[16] = 0.0; + out_497819547195898390[17] = 0.0; + out_497819547195898390[18] = 0.0; + out_497819547195898390[19] = 1.0; + out_497819547195898390[20] = 0.0; + out_497819547195898390[21] = 0.0; + out_497819547195898390[22] = 0.0; + out_497819547195898390[23] = 0.0; + out_497819547195898390[24] = 0.0; + out_497819547195898390[25] = 0.0; + out_497819547195898390[26] = 0.0; + out_497819547195898390[27] = 0.0; + out_497819547195898390[28] = 0.0; + out_497819547195898390[29] = 0.0; + out_497819547195898390[30] = 0.0; + out_497819547195898390[31] = 0.0; + out_497819547195898390[32] = 0.0; + out_497819547195898390[33] = 0.0; + out_497819547195898390[34] = 0.0; + out_497819547195898390[35] = 0.0; + out_497819547195898390[36] = 0.0; + out_497819547195898390[37] = 0.0; + out_497819547195898390[38] = 1.0; + out_497819547195898390[39] = 0.0; + out_497819547195898390[40] = 0.0; + out_497819547195898390[41] = 0.0; + out_497819547195898390[42] = 0.0; + out_497819547195898390[43] = 0.0; + out_497819547195898390[44] = 0.0; + out_497819547195898390[45] = 0.0; + out_497819547195898390[46] = 0.0; + out_497819547195898390[47] = 0.0; + out_497819547195898390[48] = 0.0; + out_497819547195898390[49] = 0.0; + out_497819547195898390[50] = 0.0; + out_497819547195898390[51] = 0.0; + out_497819547195898390[52] = 0.0; + out_497819547195898390[53] = 0.0; + out_497819547195898390[54] = 0.0; + out_497819547195898390[55] = 0.0; + out_497819547195898390[56] = 0.0; + out_497819547195898390[57] = 1.0; + out_497819547195898390[58] = 0.0; + out_497819547195898390[59] = 0.0; + out_497819547195898390[60] = 0.0; + out_497819547195898390[61] = 0.0; + out_497819547195898390[62] = 0.0; + out_497819547195898390[63] = 0.0; + out_497819547195898390[64] = 0.0; + out_497819547195898390[65] = 0.0; + out_497819547195898390[66] = 0.0; + out_497819547195898390[67] = 0.0; + out_497819547195898390[68] = 0.0; + out_497819547195898390[69] = 0.0; + out_497819547195898390[70] = 0.0; + out_497819547195898390[71] = 0.0; + out_497819547195898390[72] = 0.0; + out_497819547195898390[73] = 0.0; + out_497819547195898390[74] = 0.0; + out_497819547195898390[75] = 0.0; + out_497819547195898390[76] = 1.0; + out_497819547195898390[77] = 0.0; + out_497819547195898390[78] = 0.0; + out_497819547195898390[79] = 0.0; + out_497819547195898390[80] = 0.0; + out_497819547195898390[81] = 0.0; + out_497819547195898390[82] = 0.0; + out_497819547195898390[83] = 0.0; + out_497819547195898390[84] = 0.0; + out_497819547195898390[85] = 0.0; + out_497819547195898390[86] = 0.0; + out_497819547195898390[87] = 0.0; + out_497819547195898390[88] = 0.0; + out_497819547195898390[89] = 0.0; + out_497819547195898390[90] = 0.0; + out_497819547195898390[91] = 0.0; + out_497819547195898390[92] = 0.0; + out_497819547195898390[93] = 0.0; + out_497819547195898390[94] = 0.0; + out_497819547195898390[95] = 1.0; + out_497819547195898390[96] = 0.0; + out_497819547195898390[97] = 0.0; + out_497819547195898390[98] = 0.0; + out_497819547195898390[99] = 0.0; + out_497819547195898390[100] = 0.0; + out_497819547195898390[101] = 0.0; + out_497819547195898390[102] = 0.0; + out_497819547195898390[103] = 0.0; + out_497819547195898390[104] = 0.0; + out_497819547195898390[105] = 0.0; + out_497819547195898390[106] = 0.0; + out_497819547195898390[107] = 0.0; + out_497819547195898390[108] = 0.0; + out_497819547195898390[109] = 0.0; + out_497819547195898390[110] = 0.0; + out_497819547195898390[111] = 0.0; + out_497819547195898390[112] = 0.0; + out_497819547195898390[113] = 0.0; + out_497819547195898390[114] = 1.0; + out_497819547195898390[115] = 0.0; + out_497819547195898390[116] = 0.0; + out_497819547195898390[117] = 0.0; + out_497819547195898390[118] = 0.0; + out_497819547195898390[119] = 0.0; + out_497819547195898390[120] = 0.0; + out_497819547195898390[121] = 0.0; + out_497819547195898390[122] = 0.0; + out_497819547195898390[123] = 0.0; + out_497819547195898390[124] = 0.0; + out_497819547195898390[125] = 0.0; + out_497819547195898390[126] = 0.0; + out_497819547195898390[127] = 0.0; + out_497819547195898390[128] = 0.0; + out_497819547195898390[129] = 0.0; + out_497819547195898390[130] = 0.0; + out_497819547195898390[131] = 0.0; + out_497819547195898390[132] = 0.0; + out_497819547195898390[133] = 1.0; + out_497819547195898390[134] = 0.0; + out_497819547195898390[135] = 0.0; + out_497819547195898390[136] = 0.0; + out_497819547195898390[137] = 0.0; + out_497819547195898390[138] = 0.0; + out_497819547195898390[139] = 0.0; + out_497819547195898390[140] = 0.0; + out_497819547195898390[141] = 0.0; + out_497819547195898390[142] = 0.0; + out_497819547195898390[143] = 0.0; + out_497819547195898390[144] = 0.0; + out_497819547195898390[145] = 0.0; + out_497819547195898390[146] = 0.0; + out_497819547195898390[147] = 0.0; + out_497819547195898390[148] = 0.0; + out_497819547195898390[149] = 0.0; + out_497819547195898390[150] = 0.0; + out_497819547195898390[151] = 0.0; + out_497819547195898390[152] = 1.0; + out_497819547195898390[153] = 0.0; + out_497819547195898390[154] = 0.0; + out_497819547195898390[155] = 0.0; + out_497819547195898390[156] = 0.0; + out_497819547195898390[157] = 0.0; + out_497819547195898390[158] = 0.0; + out_497819547195898390[159] = 0.0; + out_497819547195898390[160] = 0.0; + out_497819547195898390[161] = 0.0; + out_497819547195898390[162] = 0.0; + out_497819547195898390[163] = 0.0; + out_497819547195898390[164] = 0.0; + out_497819547195898390[165] = 0.0; + out_497819547195898390[166] = 0.0; + out_497819547195898390[167] = 0.0; + out_497819547195898390[168] = 0.0; + out_497819547195898390[169] = 0.0; + out_497819547195898390[170] = 0.0; + out_497819547195898390[171] = 1.0; + out_497819547195898390[172] = 0.0; + out_497819547195898390[173] = 0.0; + out_497819547195898390[174] = 0.0; + out_497819547195898390[175] = 0.0; + out_497819547195898390[176] = 0.0; + out_497819547195898390[177] = 0.0; + out_497819547195898390[178] = 0.0; + out_497819547195898390[179] = 0.0; + out_497819547195898390[180] = 0.0; + out_497819547195898390[181] = 0.0; + out_497819547195898390[182] = 0.0; + out_497819547195898390[183] = 0.0; + out_497819547195898390[184] = 0.0; + out_497819547195898390[185] = 0.0; + out_497819547195898390[186] = 0.0; + out_497819547195898390[187] = 0.0; + out_497819547195898390[188] = 0.0; + out_497819547195898390[189] = 0.0; + out_497819547195898390[190] = 1.0; + out_497819547195898390[191] = 0.0; + out_497819547195898390[192] = 0.0; + out_497819547195898390[193] = 0.0; + out_497819547195898390[194] = 0.0; + out_497819547195898390[195] = 0.0; + out_497819547195898390[196] = 0.0; + out_497819547195898390[197] = 0.0; + out_497819547195898390[198] = 0.0; + out_497819547195898390[199] = 0.0; + out_497819547195898390[200] = 0.0; + out_497819547195898390[201] = 0.0; + out_497819547195898390[202] = 0.0; + out_497819547195898390[203] = 0.0; + out_497819547195898390[204] = 0.0; + out_497819547195898390[205] = 0.0; + out_497819547195898390[206] = 0.0; + out_497819547195898390[207] = 0.0; + out_497819547195898390[208] = 0.0; + out_497819547195898390[209] = 1.0; + out_497819547195898390[210] = 0.0; + out_497819547195898390[211] = 0.0; + out_497819547195898390[212] = 0.0; + out_497819547195898390[213] = 0.0; + out_497819547195898390[214] = 0.0; + out_497819547195898390[215] = 0.0; + out_497819547195898390[216] = 0.0; + out_497819547195898390[217] = 0.0; + out_497819547195898390[218] = 0.0; + out_497819547195898390[219] = 0.0; + out_497819547195898390[220] = 0.0; + out_497819547195898390[221] = 0.0; + out_497819547195898390[222] = 0.0; + out_497819547195898390[223] = 0.0; + out_497819547195898390[224] = 0.0; + out_497819547195898390[225] = 0.0; + out_497819547195898390[226] = 0.0; + out_497819547195898390[227] = 0.0; + out_497819547195898390[228] = 1.0; + out_497819547195898390[229] = 0.0; + out_497819547195898390[230] = 0.0; + out_497819547195898390[231] = 0.0; + out_497819547195898390[232] = 0.0; + out_497819547195898390[233] = 0.0; + out_497819547195898390[234] = 0.0; + out_497819547195898390[235] = 0.0; + out_497819547195898390[236] = 0.0; + out_497819547195898390[237] = 0.0; + out_497819547195898390[238] = 0.0; + out_497819547195898390[239] = 0.0; + out_497819547195898390[240] = 0.0; + out_497819547195898390[241] = 0.0; + out_497819547195898390[242] = 0.0; + out_497819547195898390[243] = 0.0; + out_497819547195898390[244] = 0.0; + out_497819547195898390[245] = 0.0; + out_497819547195898390[246] = 0.0; + out_497819547195898390[247] = 1.0; + out_497819547195898390[248] = 0.0; + out_497819547195898390[249] = 0.0; + out_497819547195898390[250] = 0.0; + out_497819547195898390[251] = 0.0; + out_497819547195898390[252] = 0.0; + out_497819547195898390[253] = 0.0; + out_497819547195898390[254] = 0.0; + out_497819547195898390[255] = 0.0; + out_497819547195898390[256] = 0.0; + out_497819547195898390[257] = 0.0; + out_497819547195898390[258] = 0.0; + out_497819547195898390[259] = 0.0; + out_497819547195898390[260] = 0.0; + out_497819547195898390[261] = 0.0; + out_497819547195898390[262] = 0.0; + out_497819547195898390[263] = 0.0; + out_497819547195898390[264] = 0.0; + out_497819547195898390[265] = 0.0; + out_497819547195898390[266] = 1.0; + out_497819547195898390[267] = 0.0; + out_497819547195898390[268] = 0.0; + out_497819547195898390[269] = 0.0; + out_497819547195898390[270] = 0.0; + out_497819547195898390[271] = 0.0; + out_497819547195898390[272] = 0.0; + out_497819547195898390[273] = 0.0; + out_497819547195898390[274] = 0.0; + out_497819547195898390[275] = 0.0; + out_497819547195898390[276] = 0.0; + out_497819547195898390[277] = 0.0; + out_497819547195898390[278] = 0.0; + out_497819547195898390[279] = 0.0; + out_497819547195898390[280] = 0.0; + out_497819547195898390[281] = 0.0; + out_497819547195898390[282] = 0.0; + out_497819547195898390[283] = 0.0; + out_497819547195898390[284] = 0.0; + out_497819547195898390[285] = 1.0; + out_497819547195898390[286] = 0.0; + out_497819547195898390[287] = 0.0; + out_497819547195898390[288] = 0.0; + out_497819547195898390[289] = 0.0; + out_497819547195898390[290] = 0.0; + out_497819547195898390[291] = 0.0; + out_497819547195898390[292] = 0.0; + out_497819547195898390[293] = 0.0; + out_497819547195898390[294] = 0.0; + out_497819547195898390[295] = 0.0; + out_497819547195898390[296] = 0.0; + out_497819547195898390[297] = 0.0; + out_497819547195898390[298] = 0.0; + out_497819547195898390[299] = 0.0; + out_497819547195898390[300] = 0.0; + out_497819547195898390[301] = 0.0; + out_497819547195898390[302] = 0.0; + out_497819547195898390[303] = 0.0; + out_497819547195898390[304] = 1.0; + out_497819547195898390[305] = 0.0; + out_497819547195898390[306] = 0.0; + out_497819547195898390[307] = 0.0; + out_497819547195898390[308] = 0.0; + out_497819547195898390[309] = 0.0; + out_497819547195898390[310] = 0.0; + out_497819547195898390[311] = 0.0; + out_497819547195898390[312] = 0.0; + out_497819547195898390[313] = 0.0; + out_497819547195898390[314] = 0.0; + out_497819547195898390[315] = 0.0; + out_497819547195898390[316] = 0.0; + out_497819547195898390[317] = 0.0; + out_497819547195898390[318] = 0.0; + out_497819547195898390[319] = 0.0; + out_497819547195898390[320] = 0.0; + out_497819547195898390[321] = 0.0; + out_497819547195898390[322] = 0.0; + out_497819547195898390[323] = 1.0; } -void f_fun(double *state, double dt, double *out_322024657666628683) { - out_322024657666628683[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_322024657666628683[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_322024657666628683[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_322024657666628683[3] = dt*state[12] + state[3]; - out_322024657666628683[4] = dt*state[13] + state[4]; - out_322024657666628683[5] = dt*state[14] + state[5]; - out_322024657666628683[6] = state[6]; - out_322024657666628683[7] = state[7]; - out_322024657666628683[8] = state[8]; - out_322024657666628683[9] = state[9]; - out_322024657666628683[10] = state[10]; - out_322024657666628683[11] = state[11]; - out_322024657666628683[12] = state[12]; - out_322024657666628683[13] = state[13]; - out_322024657666628683[14] = state[14]; - out_322024657666628683[15] = state[15]; - out_322024657666628683[16] = state[16]; - out_322024657666628683[17] = state[17]; +void f_fun(double *state, double dt, double *out_4587333856526582363) { + out_4587333856526582363[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_4587333856526582363[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_4587333856526582363[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_4587333856526582363[3] = dt*state[12] + state[3]; + out_4587333856526582363[4] = dt*state[13] + state[4]; + out_4587333856526582363[5] = dt*state[14] + state[5]; + out_4587333856526582363[6] = state[6]; + out_4587333856526582363[7] = state[7]; + out_4587333856526582363[8] = state[8]; + out_4587333856526582363[9] = state[9]; + out_4587333856526582363[10] = state[10]; + out_4587333856526582363[11] = state[11]; + out_4587333856526582363[12] = state[12]; + out_4587333856526582363[13] = state[13]; + out_4587333856526582363[14] = state[14]; + out_4587333856526582363[15] = state[15]; + out_4587333856526582363[16] = state[16]; + out_4587333856526582363[17] = state[17]; } -void F_fun(double *state, double dt, double *out_842370593129636931) { - out_842370593129636931[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_842370593129636931[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_842370593129636931[2] = 0; - out_842370593129636931[3] = 0; - out_842370593129636931[4] = 0; - out_842370593129636931[5] = 0; - out_842370593129636931[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_842370593129636931[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_842370593129636931[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_842370593129636931[9] = 0; - out_842370593129636931[10] = 0; - out_842370593129636931[11] = 0; - out_842370593129636931[12] = 0; - out_842370593129636931[13] = 0; - out_842370593129636931[14] = 0; - out_842370593129636931[15] = 0; - out_842370593129636931[16] = 0; - out_842370593129636931[17] = 0; - out_842370593129636931[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_842370593129636931[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_842370593129636931[20] = 0; - out_842370593129636931[21] = 0; - out_842370593129636931[22] = 0; - out_842370593129636931[23] = 0; - out_842370593129636931[24] = 0; - out_842370593129636931[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_842370593129636931[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_842370593129636931[27] = 0; - out_842370593129636931[28] = 0; - out_842370593129636931[29] = 0; - out_842370593129636931[30] = 0; - out_842370593129636931[31] = 0; - out_842370593129636931[32] = 0; - out_842370593129636931[33] = 0; - out_842370593129636931[34] = 0; - out_842370593129636931[35] = 0; - out_842370593129636931[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_842370593129636931[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_842370593129636931[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_842370593129636931[39] = 0; - out_842370593129636931[40] = 0; - out_842370593129636931[41] = 0; - out_842370593129636931[42] = 0; - out_842370593129636931[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_842370593129636931[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_842370593129636931[45] = 0; - out_842370593129636931[46] = 0; - out_842370593129636931[47] = 0; - out_842370593129636931[48] = 0; - out_842370593129636931[49] = 0; - out_842370593129636931[50] = 0; - out_842370593129636931[51] = 0; - out_842370593129636931[52] = 0; - out_842370593129636931[53] = 0; - out_842370593129636931[54] = 0; - out_842370593129636931[55] = 0; - out_842370593129636931[56] = 0; - out_842370593129636931[57] = 1; - out_842370593129636931[58] = 0; - out_842370593129636931[59] = 0; - out_842370593129636931[60] = 0; - out_842370593129636931[61] = 0; - out_842370593129636931[62] = 0; - out_842370593129636931[63] = 0; - out_842370593129636931[64] = 0; - out_842370593129636931[65] = 0; - out_842370593129636931[66] = dt; - out_842370593129636931[67] = 0; - out_842370593129636931[68] = 0; - out_842370593129636931[69] = 0; - out_842370593129636931[70] = 0; - out_842370593129636931[71] = 0; - out_842370593129636931[72] = 0; - out_842370593129636931[73] = 0; - out_842370593129636931[74] = 0; - out_842370593129636931[75] = 0; - out_842370593129636931[76] = 1; - out_842370593129636931[77] = 0; - out_842370593129636931[78] = 0; - out_842370593129636931[79] = 0; - out_842370593129636931[80] = 0; - out_842370593129636931[81] = 0; - out_842370593129636931[82] = 0; - out_842370593129636931[83] = 0; - out_842370593129636931[84] = 0; - out_842370593129636931[85] = dt; - out_842370593129636931[86] = 0; - out_842370593129636931[87] = 0; - out_842370593129636931[88] = 0; - out_842370593129636931[89] = 0; - out_842370593129636931[90] = 0; - out_842370593129636931[91] = 0; - out_842370593129636931[92] = 0; - out_842370593129636931[93] = 0; - out_842370593129636931[94] = 0; - out_842370593129636931[95] = 1; - out_842370593129636931[96] = 0; - out_842370593129636931[97] = 0; - out_842370593129636931[98] = 0; - out_842370593129636931[99] = 0; - out_842370593129636931[100] = 0; - out_842370593129636931[101] = 0; - out_842370593129636931[102] = 0; - out_842370593129636931[103] = 0; - out_842370593129636931[104] = dt; - out_842370593129636931[105] = 0; - out_842370593129636931[106] = 0; - out_842370593129636931[107] = 0; - out_842370593129636931[108] = 0; - out_842370593129636931[109] = 0; - out_842370593129636931[110] = 0; - out_842370593129636931[111] = 0; - out_842370593129636931[112] = 0; - out_842370593129636931[113] = 0; - out_842370593129636931[114] = 1; - out_842370593129636931[115] = 0; - out_842370593129636931[116] = 0; - out_842370593129636931[117] = 0; - out_842370593129636931[118] = 0; - out_842370593129636931[119] = 0; - out_842370593129636931[120] = 0; - out_842370593129636931[121] = 0; - out_842370593129636931[122] = 0; - out_842370593129636931[123] = 0; - out_842370593129636931[124] = 0; - out_842370593129636931[125] = 0; - out_842370593129636931[126] = 0; - out_842370593129636931[127] = 0; - out_842370593129636931[128] = 0; - out_842370593129636931[129] = 0; - out_842370593129636931[130] = 0; - out_842370593129636931[131] = 0; - out_842370593129636931[132] = 0; - out_842370593129636931[133] = 1; - out_842370593129636931[134] = 0; - out_842370593129636931[135] = 0; - out_842370593129636931[136] = 0; - out_842370593129636931[137] = 0; - out_842370593129636931[138] = 0; - out_842370593129636931[139] = 0; - out_842370593129636931[140] = 0; - out_842370593129636931[141] = 0; - out_842370593129636931[142] = 0; - out_842370593129636931[143] = 0; - out_842370593129636931[144] = 0; - out_842370593129636931[145] = 0; - out_842370593129636931[146] = 0; - out_842370593129636931[147] = 0; - out_842370593129636931[148] = 0; - out_842370593129636931[149] = 0; - out_842370593129636931[150] = 0; - out_842370593129636931[151] = 0; - out_842370593129636931[152] = 1; - out_842370593129636931[153] = 0; - out_842370593129636931[154] = 0; - out_842370593129636931[155] = 0; - out_842370593129636931[156] = 0; - out_842370593129636931[157] = 0; - out_842370593129636931[158] = 0; - out_842370593129636931[159] = 0; - out_842370593129636931[160] = 0; - out_842370593129636931[161] = 0; - out_842370593129636931[162] = 0; - out_842370593129636931[163] = 0; - out_842370593129636931[164] = 0; - out_842370593129636931[165] = 0; - out_842370593129636931[166] = 0; - out_842370593129636931[167] = 0; - out_842370593129636931[168] = 0; - out_842370593129636931[169] = 0; - out_842370593129636931[170] = 0; - out_842370593129636931[171] = 1; - out_842370593129636931[172] = 0; - out_842370593129636931[173] = 0; - out_842370593129636931[174] = 0; - out_842370593129636931[175] = 0; - out_842370593129636931[176] = 0; - out_842370593129636931[177] = 0; - out_842370593129636931[178] = 0; - out_842370593129636931[179] = 0; - out_842370593129636931[180] = 0; - out_842370593129636931[181] = 0; - out_842370593129636931[182] = 0; - out_842370593129636931[183] = 0; - out_842370593129636931[184] = 0; - out_842370593129636931[185] = 0; - out_842370593129636931[186] = 0; - out_842370593129636931[187] = 0; - out_842370593129636931[188] = 0; - out_842370593129636931[189] = 0; - out_842370593129636931[190] = 1; - out_842370593129636931[191] = 0; - out_842370593129636931[192] = 0; - out_842370593129636931[193] = 0; - out_842370593129636931[194] = 0; - out_842370593129636931[195] = 0; - out_842370593129636931[196] = 0; - out_842370593129636931[197] = 0; - out_842370593129636931[198] = 0; - out_842370593129636931[199] = 0; - out_842370593129636931[200] = 0; - out_842370593129636931[201] = 0; - out_842370593129636931[202] = 0; - out_842370593129636931[203] = 0; - out_842370593129636931[204] = 0; - out_842370593129636931[205] = 0; - out_842370593129636931[206] = 0; - out_842370593129636931[207] = 0; - out_842370593129636931[208] = 0; - out_842370593129636931[209] = 1; - out_842370593129636931[210] = 0; - out_842370593129636931[211] = 0; - out_842370593129636931[212] = 0; - out_842370593129636931[213] = 0; - out_842370593129636931[214] = 0; - out_842370593129636931[215] = 0; - out_842370593129636931[216] = 0; - out_842370593129636931[217] = 0; - out_842370593129636931[218] = 0; - out_842370593129636931[219] = 0; - out_842370593129636931[220] = 0; - out_842370593129636931[221] = 0; - out_842370593129636931[222] = 0; - out_842370593129636931[223] = 0; - out_842370593129636931[224] = 0; - out_842370593129636931[225] = 0; - out_842370593129636931[226] = 0; - out_842370593129636931[227] = 0; - out_842370593129636931[228] = 1; - out_842370593129636931[229] = 0; - out_842370593129636931[230] = 0; - out_842370593129636931[231] = 0; - out_842370593129636931[232] = 0; - out_842370593129636931[233] = 0; - out_842370593129636931[234] = 0; - out_842370593129636931[235] = 0; - out_842370593129636931[236] = 0; - out_842370593129636931[237] = 0; - out_842370593129636931[238] = 0; - out_842370593129636931[239] = 0; - out_842370593129636931[240] = 0; - out_842370593129636931[241] = 0; - out_842370593129636931[242] = 0; - out_842370593129636931[243] = 0; - out_842370593129636931[244] = 0; - out_842370593129636931[245] = 0; - out_842370593129636931[246] = 0; - out_842370593129636931[247] = 1; - out_842370593129636931[248] = 0; - out_842370593129636931[249] = 0; - out_842370593129636931[250] = 0; - out_842370593129636931[251] = 0; - out_842370593129636931[252] = 0; - out_842370593129636931[253] = 0; - out_842370593129636931[254] = 0; - out_842370593129636931[255] = 0; - out_842370593129636931[256] = 0; - out_842370593129636931[257] = 0; - out_842370593129636931[258] = 0; - out_842370593129636931[259] = 0; - out_842370593129636931[260] = 0; - out_842370593129636931[261] = 0; - out_842370593129636931[262] = 0; - out_842370593129636931[263] = 0; - out_842370593129636931[264] = 0; - out_842370593129636931[265] = 0; - out_842370593129636931[266] = 1; - out_842370593129636931[267] = 0; - out_842370593129636931[268] = 0; - out_842370593129636931[269] = 0; - out_842370593129636931[270] = 0; - out_842370593129636931[271] = 0; - out_842370593129636931[272] = 0; - out_842370593129636931[273] = 0; - out_842370593129636931[274] = 0; - out_842370593129636931[275] = 0; - out_842370593129636931[276] = 0; - out_842370593129636931[277] = 0; - out_842370593129636931[278] = 0; - out_842370593129636931[279] = 0; - out_842370593129636931[280] = 0; - out_842370593129636931[281] = 0; - out_842370593129636931[282] = 0; - out_842370593129636931[283] = 0; - out_842370593129636931[284] = 0; - out_842370593129636931[285] = 1; - out_842370593129636931[286] = 0; - out_842370593129636931[287] = 0; - out_842370593129636931[288] = 0; - out_842370593129636931[289] = 0; - out_842370593129636931[290] = 0; - out_842370593129636931[291] = 0; - out_842370593129636931[292] = 0; - out_842370593129636931[293] = 0; - out_842370593129636931[294] = 0; - out_842370593129636931[295] = 0; - out_842370593129636931[296] = 0; - out_842370593129636931[297] = 0; - out_842370593129636931[298] = 0; - out_842370593129636931[299] = 0; - out_842370593129636931[300] = 0; - out_842370593129636931[301] = 0; - out_842370593129636931[302] = 0; - out_842370593129636931[303] = 0; - out_842370593129636931[304] = 1; - out_842370593129636931[305] = 0; - out_842370593129636931[306] = 0; - out_842370593129636931[307] = 0; - out_842370593129636931[308] = 0; - out_842370593129636931[309] = 0; - out_842370593129636931[310] = 0; - out_842370593129636931[311] = 0; - out_842370593129636931[312] = 0; - out_842370593129636931[313] = 0; - out_842370593129636931[314] = 0; - out_842370593129636931[315] = 0; - out_842370593129636931[316] = 0; - out_842370593129636931[317] = 0; - out_842370593129636931[318] = 0; - out_842370593129636931[319] = 0; - out_842370593129636931[320] = 0; - out_842370593129636931[321] = 0; - out_842370593129636931[322] = 0; - out_842370593129636931[323] = 1; +void F_fun(double *state, double dt, double *out_494582711598413239) { + out_494582711598413239[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_494582711598413239[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_494582711598413239[2] = 0; + out_494582711598413239[3] = 0; + out_494582711598413239[4] = 0; + out_494582711598413239[5] = 0; + out_494582711598413239[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_494582711598413239[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_494582711598413239[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_494582711598413239[9] = 0; + out_494582711598413239[10] = 0; + out_494582711598413239[11] = 0; + out_494582711598413239[12] = 0; + out_494582711598413239[13] = 0; + out_494582711598413239[14] = 0; + out_494582711598413239[15] = 0; + out_494582711598413239[16] = 0; + out_494582711598413239[17] = 0; + out_494582711598413239[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_494582711598413239[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_494582711598413239[20] = 0; + out_494582711598413239[21] = 0; + out_494582711598413239[22] = 0; + out_494582711598413239[23] = 0; + out_494582711598413239[24] = 0; + out_494582711598413239[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_494582711598413239[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_494582711598413239[27] = 0; + out_494582711598413239[28] = 0; + out_494582711598413239[29] = 0; + out_494582711598413239[30] = 0; + out_494582711598413239[31] = 0; + out_494582711598413239[32] = 0; + out_494582711598413239[33] = 0; + out_494582711598413239[34] = 0; + out_494582711598413239[35] = 0; + out_494582711598413239[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_494582711598413239[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_494582711598413239[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_494582711598413239[39] = 0; + out_494582711598413239[40] = 0; + out_494582711598413239[41] = 0; + out_494582711598413239[42] = 0; + out_494582711598413239[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_494582711598413239[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_494582711598413239[45] = 0; + out_494582711598413239[46] = 0; + out_494582711598413239[47] = 0; + out_494582711598413239[48] = 0; + out_494582711598413239[49] = 0; + out_494582711598413239[50] = 0; + out_494582711598413239[51] = 0; + out_494582711598413239[52] = 0; + out_494582711598413239[53] = 0; + out_494582711598413239[54] = 0; + out_494582711598413239[55] = 0; + out_494582711598413239[56] = 0; + out_494582711598413239[57] = 1; + out_494582711598413239[58] = 0; + out_494582711598413239[59] = 0; + out_494582711598413239[60] = 0; + out_494582711598413239[61] = 0; + out_494582711598413239[62] = 0; + out_494582711598413239[63] = 0; + out_494582711598413239[64] = 0; + out_494582711598413239[65] = 0; + out_494582711598413239[66] = dt; + out_494582711598413239[67] = 0; + out_494582711598413239[68] = 0; + out_494582711598413239[69] = 0; + out_494582711598413239[70] = 0; + out_494582711598413239[71] = 0; + out_494582711598413239[72] = 0; + out_494582711598413239[73] = 0; + out_494582711598413239[74] = 0; + out_494582711598413239[75] = 0; + out_494582711598413239[76] = 1; + out_494582711598413239[77] = 0; + out_494582711598413239[78] = 0; + out_494582711598413239[79] = 0; + out_494582711598413239[80] = 0; + out_494582711598413239[81] = 0; + out_494582711598413239[82] = 0; + out_494582711598413239[83] = 0; + out_494582711598413239[84] = 0; + out_494582711598413239[85] = dt; + out_494582711598413239[86] = 0; + out_494582711598413239[87] = 0; + out_494582711598413239[88] = 0; + out_494582711598413239[89] = 0; + out_494582711598413239[90] = 0; + out_494582711598413239[91] = 0; + out_494582711598413239[92] = 0; + out_494582711598413239[93] = 0; + out_494582711598413239[94] = 0; + out_494582711598413239[95] = 1; + out_494582711598413239[96] = 0; + out_494582711598413239[97] = 0; + out_494582711598413239[98] = 0; + out_494582711598413239[99] = 0; + out_494582711598413239[100] = 0; + out_494582711598413239[101] = 0; + out_494582711598413239[102] = 0; + out_494582711598413239[103] = 0; + out_494582711598413239[104] = dt; + out_494582711598413239[105] = 0; + out_494582711598413239[106] = 0; + out_494582711598413239[107] = 0; + out_494582711598413239[108] = 0; + out_494582711598413239[109] = 0; + out_494582711598413239[110] = 0; + out_494582711598413239[111] = 0; + out_494582711598413239[112] = 0; + out_494582711598413239[113] = 0; + out_494582711598413239[114] = 1; + out_494582711598413239[115] = 0; + out_494582711598413239[116] = 0; + out_494582711598413239[117] = 0; + out_494582711598413239[118] = 0; + out_494582711598413239[119] = 0; + out_494582711598413239[120] = 0; + out_494582711598413239[121] = 0; + out_494582711598413239[122] = 0; + out_494582711598413239[123] = 0; + out_494582711598413239[124] = 0; + out_494582711598413239[125] = 0; + out_494582711598413239[126] = 0; + out_494582711598413239[127] = 0; + out_494582711598413239[128] = 0; + out_494582711598413239[129] = 0; + out_494582711598413239[130] = 0; + out_494582711598413239[131] = 0; + out_494582711598413239[132] = 0; + out_494582711598413239[133] = 1; + out_494582711598413239[134] = 0; + out_494582711598413239[135] = 0; + out_494582711598413239[136] = 0; + out_494582711598413239[137] = 0; + out_494582711598413239[138] = 0; + out_494582711598413239[139] = 0; + out_494582711598413239[140] = 0; + out_494582711598413239[141] = 0; + out_494582711598413239[142] = 0; + out_494582711598413239[143] = 0; + out_494582711598413239[144] = 0; + out_494582711598413239[145] = 0; + out_494582711598413239[146] = 0; + out_494582711598413239[147] = 0; + out_494582711598413239[148] = 0; + out_494582711598413239[149] = 0; + out_494582711598413239[150] = 0; + out_494582711598413239[151] = 0; + out_494582711598413239[152] = 1; + out_494582711598413239[153] = 0; + out_494582711598413239[154] = 0; + out_494582711598413239[155] = 0; + out_494582711598413239[156] = 0; + out_494582711598413239[157] = 0; + out_494582711598413239[158] = 0; + out_494582711598413239[159] = 0; + out_494582711598413239[160] = 0; + out_494582711598413239[161] = 0; + out_494582711598413239[162] = 0; + out_494582711598413239[163] = 0; + out_494582711598413239[164] = 0; + out_494582711598413239[165] = 0; + out_494582711598413239[166] = 0; + out_494582711598413239[167] = 0; + out_494582711598413239[168] = 0; + out_494582711598413239[169] = 0; + out_494582711598413239[170] = 0; + out_494582711598413239[171] = 1; + out_494582711598413239[172] = 0; + out_494582711598413239[173] = 0; + out_494582711598413239[174] = 0; + out_494582711598413239[175] = 0; + out_494582711598413239[176] = 0; + out_494582711598413239[177] = 0; + out_494582711598413239[178] = 0; + out_494582711598413239[179] = 0; + out_494582711598413239[180] = 0; + out_494582711598413239[181] = 0; + out_494582711598413239[182] = 0; + out_494582711598413239[183] = 0; + out_494582711598413239[184] = 0; + out_494582711598413239[185] = 0; + out_494582711598413239[186] = 0; + out_494582711598413239[187] = 0; + out_494582711598413239[188] = 0; + out_494582711598413239[189] = 0; + out_494582711598413239[190] = 1; + out_494582711598413239[191] = 0; + out_494582711598413239[192] = 0; + out_494582711598413239[193] = 0; + out_494582711598413239[194] = 0; + out_494582711598413239[195] = 0; + out_494582711598413239[196] = 0; + out_494582711598413239[197] = 0; + out_494582711598413239[198] = 0; + out_494582711598413239[199] = 0; + out_494582711598413239[200] = 0; + out_494582711598413239[201] = 0; + out_494582711598413239[202] = 0; + out_494582711598413239[203] = 0; + out_494582711598413239[204] = 0; + out_494582711598413239[205] = 0; + out_494582711598413239[206] = 0; + out_494582711598413239[207] = 0; + out_494582711598413239[208] = 0; + out_494582711598413239[209] = 1; + out_494582711598413239[210] = 0; + out_494582711598413239[211] = 0; + out_494582711598413239[212] = 0; + out_494582711598413239[213] = 0; + out_494582711598413239[214] = 0; + out_494582711598413239[215] = 0; + out_494582711598413239[216] = 0; + out_494582711598413239[217] = 0; + out_494582711598413239[218] = 0; + out_494582711598413239[219] = 0; + out_494582711598413239[220] = 0; + out_494582711598413239[221] = 0; + out_494582711598413239[222] = 0; + out_494582711598413239[223] = 0; + out_494582711598413239[224] = 0; + out_494582711598413239[225] = 0; + out_494582711598413239[226] = 0; + out_494582711598413239[227] = 0; + out_494582711598413239[228] = 1; + out_494582711598413239[229] = 0; + out_494582711598413239[230] = 0; + out_494582711598413239[231] = 0; + out_494582711598413239[232] = 0; + out_494582711598413239[233] = 0; + out_494582711598413239[234] = 0; + out_494582711598413239[235] = 0; + out_494582711598413239[236] = 0; + out_494582711598413239[237] = 0; + out_494582711598413239[238] = 0; + out_494582711598413239[239] = 0; + out_494582711598413239[240] = 0; + out_494582711598413239[241] = 0; + out_494582711598413239[242] = 0; + out_494582711598413239[243] = 0; + out_494582711598413239[244] = 0; + out_494582711598413239[245] = 0; + out_494582711598413239[246] = 0; + out_494582711598413239[247] = 1; + out_494582711598413239[248] = 0; + out_494582711598413239[249] = 0; + out_494582711598413239[250] = 0; + out_494582711598413239[251] = 0; + out_494582711598413239[252] = 0; + out_494582711598413239[253] = 0; + out_494582711598413239[254] = 0; + out_494582711598413239[255] = 0; + out_494582711598413239[256] = 0; + out_494582711598413239[257] = 0; + out_494582711598413239[258] = 0; + out_494582711598413239[259] = 0; + out_494582711598413239[260] = 0; + out_494582711598413239[261] = 0; + out_494582711598413239[262] = 0; + out_494582711598413239[263] = 0; + out_494582711598413239[264] = 0; + out_494582711598413239[265] = 0; + out_494582711598413239[266] = 1; + out_494582711598413239[267] = 0; + out_494582711598413239[268] = 0; + out_494582711598413239[269] = 0; + out_494582711598413239[270] = 0; + out_494582711598413239[271] = 0; + out_494582711598413239[272] = 0; + out_494582711598413239[273] = 0; + out_494582711598413239[274] = 0; + out_494582711598413239[275] = 0; + out_494582711598413239[276] = 0; + out_494582711598413239[277] = 0; + out_494582711598413239[278] = 0; + out_494582711598413239[279] = 0; + out_494582711598413239[280] = 0; + out_494582711598413239[281] = 0; + out_494582711598413239[282] = 0; + out_494582711598413239[283] = 0; + out_494582711598413239[284] = 0; + out_494582711598413239[285] = 1; + out_494582711598413239[286] = 0; + out_494582711598413239[287] = 0; + out_494582711598413239[288] = 0; + out_494582711598413239[289] = 0; + out_494582711598413239[290] = 0; + out_494582711598413239[291] = 0; + out_494582711598413239[292] = 0; + out_494582711598413239[293] = 0; + out_494582711598413239[294] = 0; + out_494582711598413239[295] = 0; + out_494582711598413239[296] = 0; + out_494582711598413239[297] = 0; + out_494582711598413239[298] = 0; + out_494582711598413239[299] = 0; + out_494582711598413239[300] = 0; + out_494582711598413239[301] = 0; + out_494582711598413239[302] = 0; + out_494582711598413239[303] = 0; + out_494582711598413239[304] = 1; + out_494582711598413239[305] = 0; + out_494582711598413239[306] = 0; + out_494582711598413239[307] = 0; + out_494582711598413239[308] = 0; + out_494582711598413239[309] = 0; + out_494582711598413239[310] = 0; + out_494582711598413239[311] = 0; + out_494582711598413239[312] = 0; + out_494582711598413239[313] = 0; + out_494582711598413239[314] = 0; + out_494582711598413239[315] = 0; + out_494582711598413239[316] = 0; + out_494582711598413239[317] = 0; + out_494582711598413239[318] = 0; + out_494582711598413239[319] = 0; + out_494582711598413239[320] = 0; + out_494582711598413239[321] = 0; + out_494582711598413239[322] = 0; + out_494582711598413239[323] = 1; } -void h_4(double *state, double *unused, double *out_2597862681562698782) { - out_2597862681562698782[0] = state[6] + state[9]; - out_2597862681562698782[1] = state[7] + state[10]; - out_2597862681562698782[2] = state[8] + state[11]; +void h_4(double *state, double *unused, double *out_916469630118270672) { + out_916469630118270672[0] = state[6] + state[9]; + out_916469630118270672[1] = state[7] + state[10]; + out_916469630118270672[2] = state[8] + state[11]; } -void H_4(double *state, double *unused, double *out_7753124876646203718) { - out_7753124876646203718[0] = 0; - out_7753124876646203718[1] = 0; - out_7753124876646203718[2] = 0; - out_7753124876646203718[3] = 0; - out_7753124876646203718[4] = 0; - out_7753124876646203718[5] = 0; - out_7753124876646203718[6] = 1; - out_7753124876646203718[7] = 0; - out_7753124876646203718[8] = 0; - out_7753124876646203718[9] = 1; - out_7753124876646203718[10] = 0; - out_7753124876646203718[11] = 0; - out_7753124876646203718[12] = 0; - out_7753124876646203718[13] = 0; - out_7753124876646203718[14] = 0; - out_7753124876646203718[15] = 0; - out_7753124876646203718[16] = 0; - out_7753124876646203718[17] = 0; - out_7753124876646203718[18] = 0; - out_7753124876646203718[19] = 0; - out_7753124876646203718[20] = 0; - out_7753124876646203718[21] = 0; - out_7753124876646203718[22] = 0; - out_7753124876646203718[23] = 0; - out_7753124876646203718[24] = 0; - out_7753124876646203718[25] = 1; - out_7753124876646203718[26] = 0; - out_7753124876646203718[27] = 0; - out_7753124876646203718[28] = 1; - out_7753124876646203718[29] = 0; - out_7753124876646203718[30] = 0; - out_7753124876646203718[31] = 0; - out_7753124876646203718[32] = 0; - out_7753124876646203718[33] = 0; - out_7753124876646203718[34] = 0; - out_7753124876646203718[35] = 0; - out_7753124876646203718[36] = 0; - out_7753124876646203718[37] = 0; - out_7753124876646203718[38] = 0; - out_7753124876646203718[39] = 0; - out_7753124876646203718[40] = 0; - out_7753124876646203718[41] = 0; - out_7753124876646203718[42] = 0; - out_7753124876646203718[43] = 0; - out_7753124876646203718[44] = 1; - out_7753124876646203718[45] = 0; - out_7753124876646203718[46] = 0; - out_7753124876646203718[47] = 1; - out_7753124876646203718[48] = 0; - out_7753124876646203718[49] = 0; - out_7753124876646203718[50] = 0; - out_7753124876646203718[51] = 0; - out_7753124876646203718[52] = 0; - out_7753124876646203718[53] = 0; +void H_4(double *state, double *unused, double *out_1695767029078796494) { + out_1695767029078796494[0] = 0; + out_1695767029078796494[1] = 0; + out_1695767029078796494[2] = 0; + out_1695767029078796494[3] = 0; + out_1695767029078796494[4] = 0; + out_1695767029078796494[5] = 0; + out_1695767029078796494[6] = 1; + out_1695767029078796494[7] = 0; + out_1695767029078796494[8] = 0; + out_1695767029078796494[9] = 1; + out_1695767029078796494[10] = 0; + out_1695767029078796494[11] = 0; + out_1695767029078796494[12] = 0; + out_1695767029078796494[13] = 0; + out_1695767029078796494[14] = 0; + out_1695767029078796494[15] = 0; + out_1695767029078796494[16] = 0; + out_1695767029078796494[17] = 0; + out_1695767029078796494[18] = 0; + out_1695767029078796494[19] = 0; + out_1695767029078796494[20] = 0; + out_1695767029078796494[21] = 0; + out_1695767029078796494[22] = 0; + out_1695767029078796494[23] = 0; + out_1695767029078796494[24] = 0; + out_1695767029078796494[25] = 1; + out_1695767029078796494[26] = 0; + out_1695767029078796494[27] = 0; + out_1695767029078796494[28] = 1; + out_1695767029078796494[29] = 0; + out_1695767029078796494[30] = 0; + out_1695767029078796494[31] = 0; + out_1695767029078796494[32] = 0; + out_1695767029078796494[33] = 0; + out_1695767029078796494[34] = 0; + out_1695767029078796494[35] = 0; + out_1695767029078796494[36] = 0; + out_1695767029078796494[37] = 0; + out_1695767029078796494[38] = 0; + out_1695767029078796494[39] = 0; + out_1695767029078796494[40] = 0; + out_1695767029078796494[41] = 0; + out_1695767029078796494[42] = 0; + out_1695767029078796494[43] = 0; + out_1695767029078796494[44] = 1; + out_1695767029078796494[45] = 0; + out_1695767029078796494[46] = 0; + out_1695767029078796494[47] = 1; + out_1695767029078796494[48] = 0; + out_1695767029078796494[49] = 0; + out_1695767029078796494[50] = 0; + out_1695767029078796494[51] = 0; + out_1695767029078796494[52] = 0; + out_1695767029078796494[53] = 0; } -void h_10(double *state, double *unused, double *out_9148864414269485495) { - out_9148864414269485495[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; - out_9148864414269485495[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; - out_9148864414269485495[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_8613013218873323766) { + out_8613013218873323766[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; + out_8613013218873323766[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; + out_8613013218873323766[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_2721278627709812660) { - out_2721278627709812660[0] = 0; - out_2721278627709812660[1] = 9.8100000000000005*cos(state[1]); - out_2721278627709812660[2] = 0; - out_2721278627709812660[3] = 0; - out_2721278627709812660[4] = -state[8]; - out_2721278627709812660[5] = state[7]; - out_2721278627709812660[6] = 0; - out_2721278627709812660[7] = state[5]; - out_2721278627709812660[8] = -state[4]; - out_2721278627709812660[9] = 0; - out_2721278627709812660[10] = 0; - out_2721278627709812660[11] = 0; - out_2721278627709812660[12] = 1; - out_2721278627709812660[13] = 0; - out_2721278627709812660[14] = 0; - out_2721278627709812660[15] = 1; - out_2721278627709812660[16] = 0; - out_2721278627709812660[17] = 0; - out_2721278627709812660[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); - out_2721278627709812660[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); - out_2721278627709812660[20] = 0; - out_2721278627709812660[21] = state[8]; - out_2721278627709812660[22] = 0; - out_2721278627709812660[23] = -state[6]; - out_2721278627709812660[24] = -state[5]; - out_2721278627709812660[25] = 0; - out_2721278627709812660[26] = state[3]; - out_2721278627709812660[27] = 0; - out_2721278627709812660[28] = 0; - out_2721278627709812660[29] = 0; - out_2721278627709812660[30] = 0; - out_2721278627709812660[31] = 1; - out_2721278627709812660[32] = 0; - out_2721278627709812660[33] = 0; - out_2721278627709812660[34] = 1; - out_2721278627709812660[35] = 0; - out_2721278627709812660[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); - out_2721278627709812660[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); - out_2721278627709812660[38] = 0; - out_2721278627709812660[39] = -state[7]; - out_2721278627709812660[40] = state[6]; - out_2721278627709812660[41] = 0; - out_2721278627709812660[42] = state[4]; - out_2721278627709812660[43] = -state[3]; - out_2721278627709812660[44] = 0; - out_2721278627709812660[45] = 0; - out_2721278627709812660[46] = 0; - out_2721278627709812660[47] = 0; - out_2721278627709812660[48] = 0; - out_2721278627709812660[49] = 0; - out_2721278627709812660[50] = 1; - out_2721278627709812660[51] = 0; - out_2721278627709812660[52] = 0; - out_2721278627709812660[53] = 1; +void H_10(double *state, double *unused, double *out_4891296382714452251) { + out_4891296382714452251[0] = 0; + out_4891296382714452251[1] = 9.8100000000000005*cos(state[1]); + out_4891296382714452251[2] = 0; + out_4891296382714452251[3] = 0; + out_4891296382714452251[4] = -state[8]; + out_4891296382714452251[5] = state[7]; + out_4891296382714452251[6] = 0; + out_4891296382714452251[7] = state[5]; + out_4891296382714452251[8] = -state[4]; + out_4891296382714452251[9] = 0; + out_4891296382714452251[10] = 0; + out_4891296382714452251[11] = 0; + out_4891296382714452251[12] = 1; + out_4891296382714452251[13] = 0; + out_4891296382714452251[14] = 0; + out_4891296382714452251[15] = 1; + out_4891296382714452251[16] = 0; + out_4891296382714452251[17] = 0; + out_4891296382714452251[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); + out_4891296382714452251[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); + out_4891296382714452251[20] = 0; + out_4891296382714452251[21] = state[8]; + out_4891296382714452251[22] = 0; + out_4891296382714452251[23] = -state[6]; + out_4891296382714452251[24] = -state[5]; + out_4891296382714452251[25] = 0; + out_4891296382714452251[26] = state[3]; + out_4891296382714452251[27] = 0; + out_4891296382714452251[28] = 0; + out_4891296382714452251[29] = 0; + out_4891296382714452251[30] = 0; + out_4891296382714452251[31] = 1; + out_4891296382714452251[32] = 0; + out_4891296382714452251[33] = 0; + out_4891296382714452251[34] = 1; + out_4891296382714452251[35] = 0; + out_4891296382714452251[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); + out_4891296382714452251[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); + out_4891296382714452251[38] = 0; + out_4891296382714452251[39] = -state[7]; + out_4891296382714452251[40] = state[6]; + out_4891296382714452251[41] = 0; + out_4891296382714452251[42] = state[4]; + out_4891296382714452251[43] = -state[3]; + out_4891296382714452251[44] = 0; + out_4891296382714452251[45] = 0; + out_4891296382714452251[46] = 0; + out_4891296382714452251[47] = 0; + out_4891296382714452251[48] = 0; + out_4891296382714452251[49] = 0; + out_4891296382714452251[50] = 1; + out_4891296382714452251[51] = 0; + out_4891296382714452251[52] = 0; + out_4891296382714452251[53] = 1; } -void h_13(double *state, double *unused, double *out_4889610167345451391) { - out_4889610167345451391[0] = state[3]; - out_4889610167345451391[1] = state[4]; - out_4889610167345451391[2] = state[5]; +void h_13(double *state, double *unused, double *out_1875641267677564388) { + out_1875641267677564388[0] = state[3]; + out_1875641267677564388[1] = state[4]; + out_1875641267677564388[2] = state[5]; } -void H_13(double *state, double *unused, double *out_7481345371731015097) { - out_7481345371731015097[0] = 0; - out_7481345371731015097[1] = 0; - out_7481345371731015097[2] = 0; - out_7481345371731015097[3] = 1; - out_7481345371731015097[4] = 0; - out_7481345371731015097[5] = 0; - out_7481345371731015097[6] = 0; - out_7481345371731015097[7] = 0; - out_7481345371731015097[8] = 0; - out_7481345371731015097[9] = 0; - out_7481345371731015097[10] = 0; - out_7481345371731015097[11] = 0; - out_7481345371731015097[12] = 0; - out_7481345371731015097[13] = 0; - out_7481345371731015097[14] = 0; - out_7481345371731015097[15] = 0; - out_7481345371731015097[16] = 0; - out_7481345371731015097[17] = 0; - out_7481345371731015097[18] = 0; - out_7481345371731015097[19] = 0; - out_7481345371731015097[20] = 0; - out_7481345371731015097[21] = 0; - out_7481345371731015097[22] = 1; - out_7481345371731015097[23] = 0; - out_7481345371731015097[24] = 0; - out_7481345371731015097[25] = 0; - out_7481345371731015097[26] = 0; - out_7481345371731015097[27] = 0; - out_7481345371731015097[28] = 0; - out_7481345371731015097[29] = 0; - out_7481345371731015097[30] = 0; - out_7481345371731015097[31] = 0; - out_7481345371731015097[32] = 0; - out_7481345371731015097[33] = 0; - out_7481345371731015097[34] = 0; - out_7481345371731015097[35] = 0; - out_7481345371731015097[36] = 0; - out_7481345371731015097[37] = 0; - out_7481345371731015097[38] = 0; - out_7481345371731015097[39] = 0; - out_7481345371731015097[40] = 0; - out_7481345371731015097[41] = 1; - out_7481345371731015097[42] = 0; - out_7481345371731015097[43] = 0; - out_7481345371731015097[44] = 0; - out_7481345371731015097[45] = 0; - out_7481345371731015097[46] = 0; - out_7481345371731015097[47] = 0; - out_7481345371731015097[48] = 0; - out_7481345371731015097[49] = 0; - out_7481345371731015097[50] = 0; - out_7481345371731015097[51] = 0; - out_7481345371731015097[52] = 0; - out_7481345371731015097[53] = 0; +void H_13(double *state, double *unused, double *out_4908040854411129295) { + out_4908040854411129295[0] = 0; + out_4908040854411129295[1] = 0; + out_4908040854411129295[2] = 0; + out_4908040854411129295[3] = 1; + out_4908040854411129295[4] = 0; + out_4908040854411129295[5] = 0; + out_4908040854411129295[6] = 0; + out_4908040854411129295[7] = 0; + out_4908040854411129295[8] = 0; + out_4908040854411129295[9] = 0; + out_4908040854411129295[10] = 0; + out_4908040854411129295[11] = 0; + out_4908040854411129295[12] = 0; + out_4908040854411129295[13] = 0; + out_4908040854411129295[14] = 0; + out_4908040854411129295[15] = 0; + out_4908040854411129295[16] = 0; + out_4908040854411129295[17] = 0; + out_4908040854411129295[18] = 0; + out_4908040854411129295[19] = 0; + out_4908040854411129295[20] = 0; + out_4908040854411129295[21] = 0; + out_4908040854411129295[22] = 1; + out_4908040854411129295[23] = 0; + out_4908040854411129295[24] = 0; + out_4908040854411129295[25] = 0; + out_4908040854411129295[26] = 0; + out_4908040854411129295[27] = 0; + out_4908040854411129295[28] = 0; + out_4908040854411129295[29] = 0; + out_4908040854411129295[30] = 0; + out_4908040854411129295[31] = 0; + out_4908040854411129295[32] = 0; + out_4908040854411129295[33] = 0; + out_4908040854411129295[34] = 0; + out_4908040854411129295[35] = 0; + out_4908040854411129295[36] = 0; + out_4908040854411129295[37] = 0; + out_4908040854411129295[38] = 0; + out_4908040854411129295[39] = 0; + out_4908040854411129295[40] = 0; + out_4908040854411129295[41] = 1; + out_4908040854411129295[42] = 0; + out_4908040854411129295[43] = 0; + out_4908040854411129295[44] = 0; + out_4908040854411129295[45] = 0; + out_4908040854411129295[46] = 0; + out_4908040854411129295[47] = 0; + out_4908040854411129295[48] = 0; + out_4908040854411129295[49] = 0; + out_4908040854411129295[50] = 0; + out_4908040854411129295[51] = 0; + out_4908040854411129295[52] = 0; + out_4908040854411129295[53] = 0; } -void h_14(double *state, double *unused, double *out_4191467436296733347) { - out_4191467436296733347[0] = state[6]; - out_4191467436296733347[1] = state[7]; - out_4191467436296733347[2] = state[8]; +void h_14(double *state, double *unused, double *out_8565313325299850314) { + out_8565313325299850314[0] = state[6]; + out_8565313325299850314[1] = state[7]; + out_8565313325299850314[2] = state[8]; } -void H_14(double *state, double *unused, double *out_4670336444350831422) { - out_4670336444350831422[0] = 0; - out_4670336444350831422[1] = 0; - out_4670336444350831422[2] = 0; - out_4670336444350831422[3] = 0; - out_4670336444350831422[4] = 0; - out_4670336444350831422[5] = 0; - out_4670336444350831422[6] = 1; - out_4670336444350831422[7] = 0; - out_4670336444350831422[8] = 0; - out_4670336444350831422[9] = 0; - out_4670336444350831422[10] = 0; - out_4670336444350831422[11] = 0; - out_4670336444350831422[12] = 0; - out_4670336444350831422[13] = 0; - out_4670336444350831422[14] = 0; - out_4670336444350831422[15] = 0; - out_4670336444350831422[16] = 0; - out_4670336444350831422[17] = 0; - out_4670336444350831422[18] = 0; - out_4670336444350831422[19] = 0; - out_4670336444350831422[20] = 0; - out_4670336444350831422[21] = 0; - out_4670336444350831422[22] = 0; - out_4670336444350831422[23] = 0; - out_4670336444350831422[24] = 0; - out_4670336444350831422[25] = 1; - out_4670336444350831422[26] = 0; - out_4670336444350831422[27] = 0; - out_4670336444350831422[28] = 0; - out_4670336444350831422[29] = 0; - out_4670336444350831422[30] = 0; - out_4670336444350831422[31] = 0; - out_4670336444350831422[32] = 0; - out_4670336444350831422[33] = 0; - out_4670336444350831422[34] = 0; - out_4670336444350831422[35] = 0; - out_4670336444350831422[36] = 0; - out_4670336444350831422[37] = 0; - out_4670336444350831422[38] = 0; - out_4670336444350831422[39] = 0; - out_4670336444350831422[40] = 0; - out_4670336444350831422[41] = 0; - out_4670336444350831422[42] = 0; - out_4670336444350831422[43] = 0; - out_4670336444350831422[44] = 1; - out_4670336444350831422[45] = 0; - out_4670336444350831422[46] = 0; - out_4670336444350831422[47] = 0; - out_4670336444350831422[48] = 0; - out_4670336444350831422[49] = 0; - out_4670336444350831422[50] = 0; - out_4670336444350831422[51] = 0; - out_4670336444350831422[52] = 0; - out_4670336444350831422[53] = 0; +void H_14(double *state, double *unused, double *out_1387021403216575802) { + out_1387021403216575802[0] = 0; + out_1387021403216575802[1] = 0; + out_1387021403216575802[2] = 0; + out_1387021403216575802[3] = 0; + out_1387021403216575802[4] = 0; + out_1387021403216575802[5] = 0; + out_1387021403216575802[6] = 1; + out_1387021403216575802[7] = 0; + out_1387021403216575802[8] = 0; + out_1387021403216575802[9] = 0; + out_1387021403216575802[10] = 0; + out_1387021403216575802[11] = 0; + out_1387021403216575802[12] = 0; + out_1387021403216575802[13] = 0; + out_1387021403216575802[14] = 0; + out_1387021403216575802[15] = 0; + out_1387021403216575802[16] = 0; + out_1387021403216575802[17] = 0; + out_1387021403216575802[18] = 0; + out_1387021403216575802[19] = 0; + out_1387021403216575802[20] = 0; + out_1387021403216575802[21] = 0; + out_1387021403216575802[22] = 0; + out_1387021403216575802[23] = 0; + out_1387021403216575802[24] = 0; + out_1387021403216575802[25] = 1; + out_1387021403216575802[26] = 0; + out_1387021403216575802[27] = 0; + out_1387021403216575802[28] = 0; + out_1387021403216575802[29] = 0; + out_1387021403216575802[30] = 0; + out_1387021403216575802[31] = 0; + out_1387021403216575802[32] = 0; + out_1387021403216575802[33] = 0; + out_1387021403216575802[34] = 0; + out_1387021403216575802[35] = 0; + out_1387021403216575802[36] = 0; + out_1387021403216575802[37] = 0; + out_1387021403216575802[38] = 0; + out_1387021403216575802[39] = 0; + out_1387021403216575802[40] = 0; + out_1387021403216575802[41] = 0; + out_1387021403216575802[42] = 0; + out_1387021403216575802[43] = 0; + out_1387021403216575802[44] = 1; + out_1387021403216575802[45] = 0; + out_1387021403216575802[46] = 0; + out_1387021403216575802[47] = 0; + out_1387021403216575802[48] = 0; + out_1387021403216575802[49] = 0; + out_1387021403216575802[50] = 0; + out_1387021403216575802[51] = 0; + out_1387021403216575802[52] = 0; + out_1387021403216575802[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_1960240961147461763) { - err_fun(nom_x, delta_x, out_1960240961147461763); +void pose_err_fun(double *nom_x, double *delta_x, double *out_2136964252019170465) { + err_fun(nom_x, delta_x, out_2136964252019170465); } -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_2311725942617102893) { - inv_err_fun(nom_x, true_x, out_2311725942617102893); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_1227563649279098162) { + inv_err_fun(nom_x, true_x, out_1227563649279098162); } -void pose_H_mod_fun(double *state, double *out_3907531448917969471) { - H_mod_fun(state, out_3907531448917969471); +void pose_H_mod_fun(double *state, double *out_497819547195898390) { + H_mod_fun(state, out_497819547195898390); } -void pose_f_fun(double *state, double dt, double *out_322024657666628683) { - f_fun(state, dt, out_322024657666628683); +void pose_f_fun(double *state, double dt, double *out_4587333856526582363) { + f_fun(state, dt, out_4587333856526582363); } -void pose_F_fun(double *state, double dt, double *out_842370593129636931) { - F_fun(state, dt, out_842370593129636931); +void pose_F_fun(double *state, double dt, double *out_494582711598413239) { + F_fun(state, dt, out_494582711598413239); } -void pose_h_4(double *state, double *unused, double *out_2597862681562698782) { - h_4(state, unused, out_2597862681562698782); +void pose_h_4(double *state, double *unused, double *out_916469630118270672) { + h_4(state, unused, out_916469630118270672); } -void pose_H_4(double *state, double *unused, double *out_7753124876646203718) { - H_4(state, unused, out_7753124876646203718); +void pose_H_4(double *state, double *unused, double *out_1695767029078796494) { + H_4(state, unused, out_1695767029078796494); } -void pose_h_10(double *state, double *unused, double *out_9148864414269485495) { - h_10(state, unused, out_9148864414269485495); +void pose_h_10(double *state, double *unused, double *out_8613013218873323766) { + h_10(state, unused, out_8613013218873323766); } -void pose_H_10(double *state, double *unused, double *out_2721278627709812660) { - H_10(state, unused, out_2721278627709812660); +void pose_H_10(double *state, double *unused, double *out_4891296382714452251) { + H_10(state, unused, out_4891296382714452251); } -void pose_h_13(double *state, double *unused, double *out_4889610167345451391) { - h_13(state, unused, out_4889610167345451391); +void pose_h_13(double *state, double *unused, double *out_1875641267677564388) { + h_13(state, unused, out_1875641267677564388); } -void pose_H_13(double *state, double *unused, double *out_7481345371731015097) { - H_13(state, unused, out_7481345371731015097); +void pose_H_13(double *state, double *unused, double *out_4908040854411129295) { + H_13(state, unused, out_4908040854411129295); } -void pose_h_14(double *state, double *unused, double *out_4191467436296733347) { - h_14(state, unused, out_4191467436296733347); +void pose_h_14(double *state, double *unused, double *out_8565313325299850314) { + h_14(state, unused, out_8565313325299850314); } -void pose_H_14(double *state, double *unused, double *out_4670336444350831422) { - H_14(state, unused, out_4670336444350831422); +void pose_H_14(double *state, double *unused, double *out_1387021403216575802) { + H_14(state, unused, out_1387021403216575802); } 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 4999321aa9..29dab1eeeb 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_1960240961147461763); -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_2311725942617102893); -void pose_H_mod_fun(double *state, double *out_3907531448917969471); -void pose_f_fun(double *state, double dt, double *out_322024657666628683); -void pose_F_fun(double *state, double dt, double *out_842370593129636931); -void pose_h_4(double *state, double *unused, double *out_2597862681562698782); -void pose_H_4(double *state, double *unused, double *out_7753124876646203718); -void pose_h_10(double *state, double *unused, double *out_9148864414269485495); -void pose_H_10(double *state, double *unused, double *out_2721278627709812660); -void pose_h_13(double *state, double *unused, double *out_4889610167345451391); -void pose_H_13(double *state, double *unused, double *out_7481345371731015097); -void pose_h_14(double *state, double *unused, double *out_4191467436296733347); -void pose_H_14(double *state, double *unused, double *out_4670336444350831422); +void pose_err_fun(double *nom_x, double *delta_x, double *out_2136964252019170465); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_1227563649279098162); +void pose_H_mod_fun(double *state, double *out_497819547195898390); +void pose_f_fun(double *state, double dt, double *out_4587333856526582363); +void pose_F_fun(double *state, double dt, double *out_494582711598413239); +void pose_h_4(double *state, double *unused, double *out_916469630118270672); +void pose_H_4(double *state, double *unused, double *out_1695767029078796494); +void pose_h_10(double *state, double *unused, double *out_8613013218873323766); +void pose_H_10(double *state, double *unused, double *out_4891296382714452251); +void pose_h_13(double *state, double *unused, double *out_1875641267677564388); +void pose_H_13(double *state, double *unused, double *out_4908040854411129295); +void pose_h_14(double *state, double *unused, double *out_8565313325299850314); +void pose_H_14(double *state, double *unused, double *out_1387021403216575802); void pose_predict(double *in_x, double *in_P, double *in_Q, double dt); } \ No newline at end of file diff --git a/openpilot/selfdrive/pandad/pandad b/openpilot/selfdrive/pandad/pandad index 092c009984..50e52b05ff 100755 Binary files a/openpilot/selfdrive/pandad/pandad and b/openpilot/selfdrive/pandad/pandad differ diff --git a/panda/board/obj/body_h7.bin.signed b/panda/board/obj/body_h7.bin.signed index ed686e16d8..db17cd6a5e 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 efeee0c0f1..6954ef6806 100644 Binary files a/panda/board/obj/bootstub.body_h7.bin and b/panda/board/obj/bootstub.body_h7.bin differ diff --git a/panda/board/obj/bootstub.panda.bin b/panda/board/obj/bootstub.panda.bin index 8f1e458eeb..ff112f127e 100644 Binary files a/panda/board/obj/bootstub.panda.bin and b/panda/board/obj/bootstub.panda.bin differ diff --git a/panda/board/obj/bootstub.panda_can_ignition_only.bin b/panda/board/obj/bootstub.panda_can_ignition_only.bin index 8f1e458eeb..ff112f127e 100644 Binary files a/panda/board/obj/bootstub.panda_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_h7.bin b/panda/board/obj/bootstub.panda_h7.bin index 0cc8ce700b..306049c644 100644 Binary files a/panda/board/obj/bootstub.panda_h7.bin and b/panda/board/obj/bootstub.panda_h7.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin index 0cc8ce700b..306049c644 100644 Binary files a/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_h7_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_hkg_remote.bin b/panda/board/obj/bootstub.panda_h7_hkg_remote.bin index 0cc8ce700b..306049c644 100644 Binary files a/panda/board/obj/bootstub.panda_h7_hkg_remote.bin and b/panda/board/obj/bootstub.panda_h7_hkg_remote.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin index 0cc8ce700b..306049c644 100644 Binary files a/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_h7_hkg_remote_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_remote.bin b/panda/board/obj/bootstub.panda_h7_remote.bin index 0cc8ce700b..306049c644 100644 Binary files a/panda/board/obj/bootstub.panda_h7_remote.bin and b/panda/board/obj/bootstub.panda_h7_remote.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin index 0cc8ce700b..306049c644 100644 Binary files a/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_h7_remote_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_tesla_wake.bin b/panda/board/obj/bootstub.panda_h7_tesla_wake.bin index 0cc8ce700b..306049c644 100644 Binary files a/panda/board/obj/bootstub.panda_h7_tesla_wake.bin and b/panda/board/obj/bootstub.panda_h7_tesla_wake.bin differ diff --git a/panda/board/obj/bootstub.panda_h7_tesla_wake_can_ignition_only.bin b/panda/board/obj/bootstub.panda_h7_tesla_wake_can_ignition_only.bin index 0cc8ce700b..306049c644 100644 Binary files a/panda/board/obj/bootstub.panda_h7_tesla_wake_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_h7_tesla_wake_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_hkg_remote.bin b/panda/board/obj/bootstub.panda_hkg_remote.bin index 8f1e458eeb..ff112f127e 100644 Binary files a/panda/board/obj/bootstub.panda_hkg_remote.bin and b/panda/board/obj/bootstub.panda_hkg_remote.bin differ diff --git a/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin index 8f1e458eeb..ff112f127e 100644 Binary files a/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_hkg_remote_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_remote.bin b/panda/board/obj/bootstub.panda_remote.bin index 8f1e458eeb..ff112f127e 100644 Binary files a/panda/board/obj/bootstub.panda_remote.bin and b/panda/board/obj/bootstub.panda_remote.bin differ diff --git a/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin b/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin index 8f1e458eeb..ff112f127e 100644 Binary files a/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_remote_can_ignition_only.bin differ diff --git a/panda/board/obj/bootstub.panda_tesla_wake.bin b/panda/board/obj/bootstub.panda_tesla_wake.bin index 8f1e458eeb..ff112f127e 100644 Binary files a/panda/board/obj/bootstub.panda_tesla_wake.bin and b/panda/board/obj/bootstub.panda_tesla_wake.bin differ diff --git a/panda/board/obj/bootstub.panda_tesla_wake_can_ignition_only.bin b/panda/board/obj/bootstub.panda_tesla_wake_can_ignition_only.bin index 8f1e458eeb..ff112f127e 100644 Binary files a/panda/board/obj/bootstub.panda_tesla_wake_can_ignition_only.bin and b/panda/board/obj/bootstub.panda_tesla_wake_can_ignition_only.bin differ diff --git a/panda/board/obj/gitversion.h b/panda/board/obj/gitversion.h index 0dab1ab8ef..fecc76ea24 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-10be50fd-Pa5919516-DEBUG"; +const uint8_t gitversion[29] = "DEV-f334ac06-Pa5919516-DEBUG"; diff --git a/panda/board/obj/panda.bin.signed b/panda/board/obj/panda.bin.signed index d381be5f2d..bf025fe14f 100644 Binary files a/panda/board/obj/panda.bin.signed and b/panda/board/obj/panda.bin.signed differ diff --git a/panda/board/obj/panda_can_ignition_only.bin.signed b/panda/board/obj/panda_can_ignition_only.bin.signed index 084110f9f1..24a4a0c7d2 100644 Binary files a/panda/board/obj/panda_can_ignition_only.bin.signed and b/panda/board/obj/panda_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_h7.bin.signed b/panda/board/obj/panda_h7.bin.signed index 7c9046083e..bf811750c2 100644 Binary files a/panda/board/obj/panda_h7.bin.signed and b/panda/board/obj/panda_h7.bin.signed differ diff --git a/panda/board/obj/panda_h7_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_can_ignition_only.bin.signed index bb0158f769..838f519ae1 100644 Binary files a/panda/board/obj/panda_h7_can_ignition_only.bin.signed and b/panda/board/obj/panda_h7_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_h7_hkg_remote.bin.signed b/panda/board/obj/panda_h7_hkg_remote.bin.signed index 48d0629423..277010621c 100644 Binary files a/panda/board/obj/panda_h7_hkg_remote.bin.signed and b/panda/board/obj/panda_h7_hkg_remote.bin.signed differ diff --git a/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed index 19ed5912af..11bbacc78d 100644 Binary files a/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed and b/panda/board/obj/panda_h7_hkg_remote_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_h7_remote.bin.signed b/panda/board/obj/panda_h7_remote.bin.signed index 0a2254366b..8ccbc984b5 100644 Binary files a/panda/board/obj/panda_h7_remote.bin.signed and b/panda/board/obj/panda_h7_remote.bin.signed differ diff --git a/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed index a375c705dd..039aaf987f 100644 Binary files a/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed and b/panda/board/obj/panda_h7_remote_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_h7_tesla_wake.bin.signed b/panda/board/obj/panda_h7_tesla_wake.bin.signed index e449e30d32..3a75a1a0e3 100644 Binary files a/panda/board/obj/panda_h7_tesla_wake.bin.signed and b/panda/board/obj/panda_h7_tesla_wake.bin.signed differ diff --git a/panda/board/obj/panda_h7_tesla_wake_can_ignition_only.bin.signed b/panda/board/obj/panda_h7_tesla_wake_can_ignition_only.bin.signed index 06673ebe1e..2a4680293e 100644 Binary files a/panda/board/obj/panda_h7_tesla_wake_can_ignition_only.bin.signed and b/panda/board/obj/panda_h7_tesla_wake_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_hkg_remote.bin.signed b/panda/board/obj/panda_hkg_remote.bin.signed index 61fcb40024..f5e4870ff0 100644 Binary files a/panda/board/obj/panda_hkg_remote.bin.signed and b/panda/board/obj/panda_hkg_remote.bin.signed differ diff --git a/panda/board/obj/panda_hkg_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_hkg_remote_can_ignition_only.bin.signed index 074e2c13e6..face8c24e5 100644 Binary files a/panda/board/obj/panda_hkg_remote_can_ignition_only.bin.signed and b/panda/board/obj/panda_hkg_remote_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_remote.bin.signed b/panda/board/obj/panda_remote.bin.signed index 55e15e3749..8d384fc503 100644 Binary files a/panda/board/obj/panda_remote.bin.signed and b/panda/board/obj/panda_remote.bin.signed differ diff --git a/panda/board/obj/panda_remote_can_ignition_only.bin.signed b/panda/board/obj/panda_remote_can_ignition_only.bin.signed index b94c43e10a..9175aa85c2 100644 Binary files a/panda/board/obj/panda_remote_can_ignition_only.bin.signed and b/panda/board/obj/panda_remote_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/panda_tesla_wake.bin.signed b/panda/board/obj/panda_tesla_wake.bin.signed index 81e0e6794c..28d3c46449 100644 Binary files a/panda/board/obj/panda_tesla_wake.bin.signed and b/panda/board/obj/panda_tesla_wake.bin.signed differ diff --git a/panda/board/obj/panda_tesla_wake_can_ignition_only.bin.signed b/panda/board/obj/panda_tesla_wake_can_ignition_only.bin.signed index b445c9d24b..23c1d74e60 100644 Binary files a/panda/board/obj/panda_tesla_wake_can_ignition_only.bin.signed and b/panda/board/obj/panda_tesla_wake_can_ignition_only.bin.signed differ diff --git a/panda/board/obj/version b/panda/board/obj/version index b09919368c..d2509dfd0d 100644 --- a/panda/board/obj/version +++ b/panda/board/obj/version @@ -1 +1 @@ -DEV-10be50fd-Pa5919516-DEBUG \ No newline at end of file +DEV-f334ac06-Pa5919516-DEBUG \ No newline at end of file diff --git a/panda/tests/libpanda/libpanda.so b/panda/tests/libpanda/libpanda.so index 86e5ade4d9..515b797a50 100755 Binary files a/panda/tests/libpanda/libpanda.so and b/panda/tests/libpanda/libpanda.so differ diff --git a/prebuilt.json b/prebuilt.json index 3d6f7fc013..a06543a19b 100644 --- a/prebuilt.json +++ b/prebuilt.json @@ -1 +1 @@ -{"protected_inventory_sha256": "190ce74e5c83c3f492d83bedede452217edaa5d744a81c8338007831cad2bde9", "schema_version": 1} +{"protected_inventory_sha256": "7bc040c488aa09db669af719cf7b89d56abb049e3b2bca0c1da0446477ddbd45", "schema_version": 1}