diff --git a/openpilot/selfdrive/locationd/models/generated/car.cpp b/openpilot/selfdrive/locationd/models/generated/car.cpp index 01245b208c..a74e703482 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_6338568395475486083) { - out_6338568395475486083[0] = delta_x[0] + nom_x[0]; - out_6338568395475486083[1] = delta_x[1] + nom_x[1]; - out_6338568395475486083[2] = delta_x[2] + nom_x[2]; - out_6338568395475486083[3] = delta_x[3] + nom_x[3]; - out_6338568395475486083[4] = delta_x[4] + nom_x[4]; - out_6338568395475486083[5] = delta_x[5] + nom_x[5]; - out_6338568395475486083[6] = delta_x[6] + nom_x[6]; - out_6338568395475486083[7] = delta_x[7] + nom_x[7]; - out_6338568395475486083[8] = delta_x[8] + nom_x[8]; +void err_fun(double *nom_x, double *delta_x, double *out_408914854931955974) { + out_408914854931955974[0] = delta_x[0] + nom_x[0]; + out_408914854931955974[1] = delta_x[1] + nom_x[1]; + out_408914854931955974[2] = delta_x[2] + nom_x[2]; + out_408914854931955974[3] = delta_x[3] + nom_x[3]; + out_408914854931955974[4] = delta_x[4] + nom_x[4]; + out_408914854931955974[5] = delta_x[5] + nom_x[5]; + out_408914854931955974[6] = delta_x[6] + nom_x[6]; + out_408914854931955974[7] = delta_x[7] + nom_x[7]; + out_408914854931955974[8] = delta_x[8] + nom_x[8]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_5410100343915451790) { - out_5410100343915451790[0] = -nom_x[0] + true_x[0]; - out_5410100343915451790[1] = -nom_x[1] + true_x[1]; - out_5410100343915451790[2] = -nom_x[2] + true_x[2]; - out_5410100343915451790[3] = -nom_x[3] + true_x[3]; - out_5410100343915451790[4] = -nom_x[4] + true_x[4]; - out_5410100343915451790[5] = -nom_x[5] + true_x[5]; - out_5410100343915451790[6] = -nom_x[6] + true_x[6]; - out_5410100343915451790[7] = -nom_x[7] + true_x[7]; - out_5410100343915451790[8] = -nom_x[8] + true_x[8]; +void inv_err_fun(double *nom_x, double *true_x, double *out_177131998479136517) { + out_177131998479136517[0] = -nom_x[0] + true_x[0]; + out_177131998479136517[1] = -nom_x[1] + true_x[1]; + out_177131998479136517[2] = -nom_x[2] + true_x[2]; + out_177131998479136517[3] = -nom_x[3] + true_x[3]; + out_177131998479136517[4] = -nom_x[4] + true_x[4]; + out_177131998479136517[5] = -nom_x[5] + true_x[5]; + out_177131998479136517[6] = -nom_x[6] + true_x[6]; + out_177131998479136517[7] = -nom_x[7] + true_x[7]; + out_177131998479136517[8] = -nom_x[8] + true_x[8]; } -void H_mod_fun(double *state, double *out_823602999692946123) { - out_823602999692946123[0] = 1.0; - out_823602999692946123[1] = 0.0; - out_823602999692946123[2] = 0.0; - out_823602999692946123[3] = 0.0; - out_823602999692946123[4] = 0.0; - out_823602999692946123[5] = 0.0; - out_823602999692946123[6] = 0.0; - out_823602999692946123[7] = 0.0; - out_823602999692946123[8] = 0.0; - out_823602999692946123[9] = 0.0; - out_823602999692946123[10] = 1.0; - out_823602999692946123[11] = 0.0; - out_823602999692946123[12] = 0.0; - out_823602999692946123[13] = 0.0; - out_823602999692946123[14] = 0.0; - out_823602999692946123[15] = 0.0; - out_823602999692946123[16] = 0.0; - out_823602999692946123[17] = 0.0; - out_823602999692946123[18] = 0.0; - out_823602999692946123[19] = 0.0; - out_823602999692946123[20] = 1.0; - out_823602999692946123[21] = 0.0; - out_823602999692946123[22] = 0.0; - out_823602999692946123[23] = 0.0; - out_823602999692946123[24] = 0.0; - out_823602999692946123[25] = 0.0; - out_823602999692946123[26] = 0.0; - out_823602999692946123[27] = 0.0; - out_823602999692946123[28] = 0.0; - out_823602999692946123[29] = 0.0; - out_823602999692946123[30] = 1.0; - out_823602999692946123[31] = 0.0; - out_823602999692946123[32] = 0.0; - out_823602999692946123[33] = 0.0; - out_823602999692946123[34] = 0.0; - out_823602999692946123[35] = 0.0; - out_823602999692946123[36] = 0.0; - out_823602999692946123[37] = 0.0; - out_823602999692946123[38] = 0.0; - out_823602999692946123[39] = 0.0; - out_823602999692946123[40] = 1.0; - out_823602999692946123[41] = 0.0; - out_823602999692946123[42] = 0.0; - out_823602999692946123[43] = 0.0; - out_823602999692946123[44] = 0.0; - out_823602999692946123[45] = 0.0; - out_823602999692946123[46] = 0.0; - out_823602999692946123[47] = 0.0; - out_823602999692946123[48] = 0.0; - out_823602999692946123[49] = 0.0; - out_823602999692946123[50] = 1.0; - out_823602999692946123[51] = 0.0; - out_823602999692946123[52] = 0.0; - out_823602999692946123[53] = 0.0; - out_823602999692946123[54] = 0.0; - out_823602999692946123[55] = 0.0; - out_823602999692946123[56] = 0.0; - out_823602999692946123[57] = 0.0; - out_823602999692946123[58] = 0.0; - out_823602999692946123[59] = 0.0; - out_823602999692946123[60] = 1.0; - out_823602999692946123[61] = 0.0; - out_823602999692946123[62] = 0.0; - out_823602999692946123[63] = 0.0; - out_823602999692946123[64] = 0.0; - out_823602999692946123[65] = 0.0; - out_823602999692946123[66] = 0.0; - out_823602999692946123[67] = 0.0; - out_823602999692946123[68] = 0.0; - out_823602999692946123[69] = 0.0; - out_823602999692946123[70] = 1.0; - out_823602999692946123[71] = 0.0; - out_823602999692946123[72] = 0.0; - out_823602999692946123[73] = 0.0; - out_823602999692946123[74] = 0.0; - out_823602999692946123[75] = 0.0; - out_823602999692946123[76] = 0.0; - out_823602999692946123[77] = 0.0; - out_823602999692946123[78] = 0.0; - out_823602999692946123[79] = 0.0; - out_823602999692946123[80] = 1.0; +void H_mod_fun(double *state, double *out_612188567970168411) { + out_612188567970168411[0] = 1.0; + out_612188567970168411[1] = 0.0; + out_612188567970168411[2] = 0.0; + out_612188567970168411[3] = 0.0; + out_612188567970168411[4] = 0.0; + out_612188567970168411[5] = 0.0; + out_612188567970168411[6] = 0.0; + out_612188567970168411[7] = 0.0; + out_612188567970168411[8] = 0.0; + out_612188567970168411[9] = 0.0; + out_612188567970168411[10] = 1.0; + out_612188567970168411[11] = 0.0; + out_612188567970168411[12] = 0.0; + out_612188567970168411[13] = 0.0; + out_612188567970168411[14] = 0.0; + out_612188567970168411[15] = 0.0; + out_612188567970168411[16] = 0.0; + out_612188567970168411[17] = 0.0; + out_612188567970168411[18] = 0.0; + out_612188567970168411[19] = 0.0; + out_612188567970168411[20] = 1.0; + out_612188567970168411[21] = 0.0; + out_612188567970168411[22] = 0.0; + out_612188567970168411[23] = 0.0; + out_612188567970168411[24] = 0.0; + out_612188567970168411[25] = 0.0; + out_612188567970168411[26] = 0.0; + out_612188567970168411[27] = 0.0; + out_612188567970168411[28] = 0.0; + out_612188567970168411[29] = 0.0; + out_612188567970168411[30] = 1.0; + out_612188567970168411[31] = 0.0; + out_612188567970168411[32] = 0.0; + out_612188567970168411[33] = 0.0; + out_612188567970168411[34] = 0.0; + out_612188567970168411[35] = 0.0; + out_612188567970168411[36] = 0.0; + out_612188567970168411[37] = 0.0; + out_612188567970168411[38] = 0.0; + out_612188567970168411[39] = 0.0; + out_612188567970168411[40] = 1.0; + out_612188567970168411[41] = 0.0; + out_612188567970168411[42] = 0.0; + out_612188567970168411[43] = 0.0; + out_612188567970168411[44] = 0.0; + out_612188567970168411[45] = 0.0; + out_612188567970168411[46] = 0.0; + out_612188567970168411[47] = 0.0; + out_612188567970168411[48] = 0.0; + out_612188567970168411[49] = 0.0; + out_612188567970168411[50] = 1.0; + out_612188567970168411[51] = 0.0; + out_612188567970168411[52] = 0.0; + out_612188567970168411[53] = 0.0; + out_612188567970168411[54] = 0.0; + out_612188567970168411[55] = 0.0; + out_612188567970168411[56] = 0.0; + out_612188567970168411[57] = 0.0; + out_612188567970168411[58] = 0.0; + out_612188567970168411[59] = 0.0; + out_612188567970168411[60] = 1.0; + out_612188567970168411[61] = 0.0; + out_612188567970168411[62] = 0.0; + out_612188567970168411[63] = 0.0; + out_612188567970168411[64] = 0.0; + out_612188567970168411[65] = 0.0; + out_612188567970168411[66] = 0.0; + out_612188567970168411[67] = 0.0; + out_612188567970168411[68] = 0.0; + out_612188567970168411[69] = 0.0; + out_612188567970168411[70] = 1.0; + out_612188567970168411[71] = 0.0; + out_612188567970168411[72] = 0.0; + out_612188567970168411[73] = 0.0; + out_612188567970168411[74] = 0.0; + out_612188567970168411[75] = 0.0; + out_612188567970168411[76] = 0.0; + out_612188567970168411[77] = 0.0; + out_612188567970168411[78] = 0.0; + out_612188567970168411[79] = 0.0; + out_612188567970168411[80] = 1.0; } -void f_fun(double *state, double dt, double *out_5252072111533144957) { - out_5252072111533144957[0] = state[0]; - out_5252072111533144957[1] = state[1]; - out_5252072111533144957[2] = state[2]; - out_5252072111533144957[3] = state[3]; - out_5252072111533144957[4] = state[4]; - out_5252072111533144957[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_5252072111533144957[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_5252072111533144957[7] = state[7]; - out_5252072111533144957[8] = state[8]; +void f_fun(double *state, double dt, double *out_1999864885543950499) { + out_1999864885543950499[0] = state[0]; + out_1999864885543950499[1] = state[1]; + out_1999864885543950499[2] = state[2]; + out_1999864885543950499[3] = state[3]; + out_1999864885543950499[4] = state[4]; + out_1999864885543950499[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_1999864885543950499[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_1999864885543950499[7] = state[7]; + out_1999864885543950499[8] = state[8]; } -void F_fun(double *state, double dt, double *out_5472890640690018040) { - out_5472890640690018040[0] = 1; - out_5472890640690018040[1] = 0; - out_5472890640690018040[2] = 0; - out_5472890640690018040[3] = 0; - out_5472890640690018040[4] = 0; - out_5472890640690018040[5] = 0; - out_5472890640690018040[6] = 0; - out_5472890640690018040[7] = 0; - out_5472890640690018040[8] = 0; - out_5472890640690018040[9] = 0; - out_5472890640690018040[10] = 1; - out_5472890640690018040[11] = 0; - out_5472890640690018040[12] = 0; - out_5472890640690018040[13] = 0; - out_5472890640690018040[14] = 0; - out_5472890640690018040[15] = 0; - out_5472890640690018040[16] = 0; - out_5472890640690018040[17] = 0; - out_5472890640690018040[18] = 0; - out_5472890640690018040[19] = 0; - out_5472890640690018040[20] = 1; - out_5472890640690018040[21] = 0; - out_5472890640690018040[22] = 0; - out_5472890640690018040[23] = 0; - out_5472890640690018040[24] = 0; - out_5472890640690018040[25] = 0; - out_5472890640690018040[26] = 0; - out_5472890640690018040[27] = 0; - out_5472890640690018040[28] = 0; - out_5472890640690018040[29] = 0; - out_5472890640690018040[30] = 1; - out_5472890640690018040[31] = 0; - out_5472890640690018040[32] = 0; - out_5472890640690018040[33] = 0; - out_5472890640690018040[34] = 0; - out_5472890640690018040[35] = 0; - out_5472890640690018040[36] = 0; - out_5472890640690018040[37] = 0; - out_5472890640690018040[38] = 0; - out_5472890640690018040[39] = 0; - out_5472890640690018040[40] = 1; - out_5472890640690018040[41] = 0; - out_5472890640690018040[42] = 0; - out_5472890640690018040[43] = 0; - out_5472890640690018040[44] = 0; - out_5472890640690018040[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_5472890640690018040[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); - out_5472890640690018040[47] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_5472890640690018040[48] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_5472890640690018040[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_5472890640690018040[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; - out_5472890640690018040[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); - out_5472890640690018040[52] = dt*stiffness_front*state[0]/(mass*state[1]); - out_5472890640690018040[53] = -9.8100000000000005*dt; - out_5472890640690018040[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_5472890640690018040[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); - out_5472890640690018040[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_5472890640690018040[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_5472890640690018040[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_5472890640690018040[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); - out_5472890640690018040[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_5472890640690018040[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_5472890640690018040[62] = 0; - out_5472890640690018040[63] = 0; - out_5472890640690018040[64] = 0; - out_5472890640690018040[65] = 0; - out_5472890640690018040[66] = 0; - out_5472890640690018040[67] = 0; - out_5472890640690018040[68] = 0; - out_5472890640690018040[69] = 0; - out_5472890640690018040[70] = 1; - out_5472890640690018040[71] = 0; - out_5472890640690018040[72] = 0; - out_5472890640690018040[73] = 0; - out_5472890640690018040[74] = 0; - out_5472890640690018040[75] = 0; - out_5472890640690018040[76] = 0; - out_5472890640690018040[77] = 0; - out_5472890640690018040[78] = 0; - out_5472890640690018040[79] = 0; - out_5472890640690018040[80] = 1; +void F_fun(double *state, double dt, double *out_3889473353313594997) { + out_3889473353313594997[0] = 1; + out_3889473353313594997[1] = 0; + out_3889473353313594997[2] = 0; + out_3889473353313594997[3] = 0; + out_3889473353313594997[4] = 0; + out_3889473353313594997[5] = 0; + out_3889473353313594997[6] = 0; + out_3889473353313594997[7] = 0; + out_3889473353313594997[8] = 0; + out_3889473353313594997[9] = 0; + out_3889473353313594997[10] = 1; + out_3889473353313594997[11] = 0; + out_3889473353313594997[12] = 0; + out_3889473353313594997[13] = 0; + out_3889473353313594997[14] = 0; + out_3889473353313594997[15] = 0; + out_3889473353313594997[16] = 0; + out_3889473353313594997[17] = 0; + out_3889473353313594997[18] = 0; + out_3889473353313594997[19] = 0; + out_3889473353313594997[20] = 1; + out_3889473353313594997[21] = 0; + out_3889473353313594997[22] = 0; + out_3889473353313594997[23] = 0; + out_3889473353313594997[24] = 0; + out_3889473353313594997[25] = 0; + out_3889473353313594997[26] = 0; + out_3889473353313594997[27] = 0; + out_3889473353313594997[28] = 0; + out_3889473353313594997[29] = 0; + out_3889473353313594997[30] = 1; + out_3889473353313594997[31] = 0; + out_3889473353313594997[32] = 0; + out_3889473353313594997[33] = 0; + out_3889473353313594997[34] = 0; + out_3889473353313594997[35] = 0; + out_3889473353313594997[36] = 0; + out_3889473353313594997[37] = 0; + out_3889473353313594997[38] = 0; + out_3889473353313594997[39] = 0; + out_3889473353313594997[40] = 1; + out_3889473353313594997[41] = 0; + out_3889473353313594997[42] = 0; + out_3889473353313594997[43] = 0; + out_3889473353313594997[44] = 0; + out_3889473353313594997[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_3889473353313594997[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); + out_3889473353313594997[47] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_3889473353313594997[48] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_3889473353313594997[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_3889473353313594997[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; + out_3889473353313594997[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); + out_3889473353313594997[52] = dt*stiffness_front*state[0]/(mass*state[1]); + out_3889473353313594997[53] = -9.8100000000000005*dt; + out_3889473353313594997[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_3889473353313594997[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); + out_3889473353313594997[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_3889473353313594997[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_3889473353313594997[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_3889473353313594997[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); + out_3889473353313594997[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_3889473353313594997[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_3889473353313594997[62] = 0; + out_3889473353313594997[63] = 0; + out_3889473353313594997[64] = 0; + out_3889473353313594997[65] = 0; + out_3889473353313594997[66] = 0; + out_3889473353313594997[67] = 0; + out_3889473353313594997[68] = 0; + out_3889473353313594997[69] = 0; + out_3889473353313594997[70] = 1; + out_3889473353313594997[71] = 0; + out_3889473353313594997[72] = 0; + out_3889473353313594997[73] = 0; + out_3889473353313594997[74] = 0; + out_3889473353313594997[75] = 0; + out_3889473353313594997[76] = 0; + out_3889473353313594997[77] = 0; + out_3889473353313594997[78] = 0; + out_3889473353313594997[79] = 0; + out_3889473353313594997[80] = 1; } -void h_25(double *state, double *unused, double *out_8566352363547608598) { - out_8566352363547608598[0] = state[6]; +void h_25(double *state, double *unused, double *out_4691870608107024689) { + out_4691870608107024689[0] = state[6]; } -void H_25(double *state, double *unused, double *out_5673419960197083828) { - out_5673419960197083828[0] = 0; - out_5673419960197083828[1] = 0; - out_5673419960197083828[2] = 0; - out_5673419960197083828[3] = 0; - out_5673419960197083828[4] = 0; - out_5673419960197083828[5] = 0; - out_5673419960197083828[6] = 1; - out_5673419960197083828[7] = 0; - out_5673419960197083828[8] = 0; +void H_25(double *state, double *unused, double *out_4135237206615533559) { + out_4135237206615533559[0] = 0; + out_4135237206615533559[1] = 0; + out_4135237206615533559[2] = 0; + out_4135237206615533559[3] = 0; + out_4135237206615533559[4] = 0; + out_4135237206615533559[5] = 0; + out_4135237206615533559[6] = 1; + out_4135237206615533559[7] = 0; + out_4135237206615533559[8] = 0; } -void h_24(double *state, double *unused, double *out_1105741821560728000) { - out_1105741821560728000[0] = state[4]; - out_1105741821560728000[1] = state[5]; +void h_24(double *state, double *unused, double *out_7256933575834984536) { + out_7256933575834984536[0] = state[4]; + out_7256933575834984536[1] = state[5]; } -void H_24(double *state, double *unused, double *out_5330649520523751468) { - out_5330649520523751468[0] = 0; - out_5330649520523751468[1] = 0; - out_5330649520523751468[2] = 0; - out_5330649520523751468[3] = 0; - out_5330649520523751468[4] = 1; - out_5330649520523751468[5] = 0; - out_5330649520523751468[6] = 0; - out_5330649520523751468[7] = 0; - out_5330649520523751468[8] = 0; - out_5330649520523751468[9] = 0; - out_5330649520523751468[10] = 0; - out_5330649520523751468[11] = 0; - out_5330649520523751468[12] = 0; - out_5330649520523751468[13] = 0; - out_5330649520523751468[14] = 1; - out_5330649520523751468[15] = 0; - out_5330649520523751468[16] = 0; - out_5330649520523751468[17] = 0; +void H_24(double *state, double *unused, double *out_3151171335774219891) { + out_3151171335774219891[0] = 0; + out_3151171335774219891[1] = 0; + out_3151171335774219891[2] = 0; + out_3151171335774219891[3] = 0; + out_3151171335774219891[4] = 1; + out_3151171335774219891[5] = 0; + out_3151171335774219891[6] = 0; + out_3151171335774219891[7] = 0; + out_3151171335774219891[8] = 0; + out_3151171335774219891[9] = 0; + out_3151171335774219891[10] = 0; + out_3151171335774219891[11] = 0; + out_3151171335774219891[12] = 0; + out_3151171335774219891[13] = 0; + out_3151171335774219891[14] = 1; + out_3151171335774219891[15] = 0; + out_3151171335774219891[16] = 0; + out_3151171335774219891[17] = 0; } -void h_30(double *state, double *unused, double *out_2652619336876860225) { - out_2652619336876860225[0] = state[4]; +void h_30(double *state, double *unused, double *out_6984038239252175991) { + out_6984038239252175991[0] = state[4]; } -void H_30(double *state, double *unused, double *out_8245627783384859590) { - out_8245627783384859590[0] = 0; - out_8245627783384859590[1] = 0; - out_8245627783384859590[2] = 0; - out_8245627783384859590[3] = 0; - out_8245627783384859590[4] = 1; - out_8245627783384859590[5] = 0; - out_8245627783384859590[6] = 0; - out_8245627783384859590[7] = 0; - out_8245627783384859590[8] = 0; +void H_30(double *state, double *unused, double *out_2781453134876083196) { + out_2781453134876083196[0] = 0; + out_2781453134876083196[1] = 0; + out_2781453134876083196[2] = 0; + out_2781453134876083196[3] = 0; + out_2781453134876083196[4] = 1; + out_2781453134876083196[5] = 0; + out_2781453134876083196[6] = 0; + out_2781453134876083196[7] = 0; + out_2781453134876083196[8] = 0; } -void h_26(double *state, double *unused, double *out_1745332744404768787) { - out_1745332744404768787[0] = state[7]; +void h_26(double *state, double *unused, double *out_8151782040328317728) { + out_8151782040328317728[0] = state[7]; } -void H_26(double *state, double *unused, double *out_9031820794638411564) { - out_9031820794638411564[0] = 0; - out_9031820794638411564[1] = 0; - out_9031820794638411564[2] = 0; - out_9031820794638411564[3] = 0; - out_9031820794638411564[4] = 0; - out_9031820794638411564[5] = 0; - out_9031820794638411564[6] = 0; - out_9031820794638411564[7] = 1; - out_9031820794638411564[8] = 0; +void H_26(double *state, double *unused, double *out_830711236854732958) { + out_830711236854732958[0] = 0; + out_830711236854732958[1] = 0; + out_830711236854732958[2] = 0; + out_830711236854732958[3] = 0; + out_830711236854732958[4] = 0; + out_830711236854732958[5] = 0; + out_830711236854732958[6] = 0; + out_830711236854732958[7] = 1; + out_830711236854732958[8] = 0; } -void h_27(double *state, double *unused, double *out_4878718442501097373) { - out_4878718442501097373[0] = state[3]; +void h_27(double *state, double *unused, double *out_6382318442842705649) { + out_6382318442842705649[0] = state[3]; } -void H_27(double *state, double *unused, double *out_7977522219140748809) { - out_7977522219140748809[0] = 0; - out_7977522219140748809[1] = 0; - out_7977522219140748809[2] = 0; - out_7977522219140748809[3] = 1; - out_7977522219140748809[4] = 0; - out_7977522219140748809[5] = 0; - out_7977522219140748809[6] = 0; - out_7977522219140748809[7] = 0; - out_7977522219140748809[8] = 0; +void H_27(double *state, double *unused, double *out_606689823075658285) { + out_606689823075658285[0] = 0; + out_606689823075658285[1] = 0; + out_606689823075658285[2] = 0; + out_606689823075658285[3] = 1; + out_606689823075658285[4] = 0; + out_606689823075658285[5] = 0; + out_606689823075658285[6] = 0; + out_606689823075658285[7] = 0; + out_606689823075658285[8] = 0; } -void h_29(double *state, double *unused, double *out_1709109483975197790) { - out_1709109483975197790[0] = state[1]; +void h_29(double *state, double *unused, double *out_205509483633589514) { + out_205509483633589514[0] = state[1]; } -void H_29(double *state, double *unused, double *out_8755859127699251774) { - out_8755859127699251774[0] = 0; - out_8755859127699251774[1] = 1; - out_8755859127699251774[2] = 0; - out_8755859127699251774[3] = 0; - out_8755859127699251774[4] = 0; - out_8755859127699251774[5] = 0; - out_8755859127699251774[6] = 0; - out_8755859127699251774[7] = 0; - out_8755859127699251774[8] = 0; +void H_29(double *state, double *unused, double *out_3291684479190475380) { + out_3291684479190475380[0] = 0; + out_3291684479190475380[1] = 1; + out_3291684479190475380[2] = 0; + out_3291684479190475380[3] = 0; + out_3291684479190475380[4] = 0; + out_3291684479190475380[5] = 0; + out_3291684479190475380[6] = 0; + out_3291684479190475380[7] = 0; + out_3291684479190475380[8] = 0; } -void h_28(double *state, double *unused, double *out_2770626730810236969) { - out_2770626730810236969[0] = state[0]; +void h_28(double *state, double *unused, double *out_1380645175181860004) { + out_1380645175181860004[0] = state[0]; } -void H_28(double *state, double *unused, double *out_3673460110629721200) { - out_3673460110629721200[0] = 1; - out_3673460110629721200[1] = 0; - out_3673460110629721200[2] = 0; - out_3673460110629721200[3] = 0; - out_3673460110629721200[4] = 0; - out_3673460110629721200[5] = 0; - out_3673460110629721200[6] = 0; - out_3673460110629721200[7] = 0; - out_3673460110629721200[8] = 0; +void H_28(double *state, double *unused, double *out_1790714537879055194) { + out_1790714537879055194[0] = 1; + out_1790714537879055194[1] = 0; + out_1790714537879055194[2] = 0; + out_1790714537879055194[3] = 0; + out_1790714537879055194[4] = 0; + out_1790714537879055194[5] = 0; + out_1790714537879055194[6] = 0; + out_1790714537879055194[7] = 0; + out_1790714537879055194[8] = 0; } -void h_31(double *state, double *unused, double *out_4928902835293586248) { - out_4928902835293586248[0] = state[8]; +void h_31(double *state, double *unused, double *out_4534683939755895544) { + out_4534683939755895544[0] = state[8]; } -void H_31(double *state, double *unused, double *out_5642773998320123400) { - out_5642773998320123400[0] = 0; - out_5642773998320123400[1] = 0; - out_5642773998320123400[2] = 0; - out_5642773998320123400[3] = 0; - out_5642773998320123400[4] = 0; - out_5642773998320123400[5] = 0; - out_5642773998320123400[6] = 0; - out_5642773998320123400[7] = 0; - out_5642773998320123400[8] = 1; +void H_31(double *state, double *unused, double *out_4104591244738573131) { + out_4104591244738573131[0] = 0; + out_4104591244738573131[1] = 0; + out_4104591244738573131[2] = 0; + out_4104591244738573131[3] = 0; + out_4104591244738573131[4] = 0; + out_4104591244738573131[5] = 0; + out_4104591244738573131[6] = 0; + out_4104591244738573131[7] = 0; + out_4104591244738573131[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_6338568395475486083) { - err_fun(nom_x, delta_x, out_6338568395475486083); +void car_err_fun(double *nom_x, double *delta_x, double *out_408914854931955974) { + err_fun(nom_x, delta_x, out_408914854931955974); } -void car_inv_err_fun(double *nom_x, double *true_x, double *out_5410100343915451790) { - inv_err_fun(nom_x, true_x, out_5410100343915451790); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_177131998479136517) { + inv_err_fun(nom_x, true_x, out_177131998479136517); } -void car_H_mod_fun(double *state, double *out_823602999692946123) { - H_mod_fun(state, out_823602999692946123); +void car_H_mod_fun(double *state, double *out_612188567970168411) { + H_mod_fun(state, out_612188567970168411); } -void car_f_fun(double *state, double dt, double *out_5252072111533144957) { - f_fun(state, dt, out_5252072111533144957); +void car_f_fun(double *state, double dt, double *out_1999864885543950499) { + f_fun(state, dt, out_1999864885543950499); } -void car_F_fun(double *state, double dt, double *out_5472890640690018040) { - F_fun(state, dt, out_5472890640690018040); +void car_F_fun(double *state, double dt, double *out_3889473353313594997) { + F_fun(state, dt, out_3889473353313594997); } -void car_h_25(double *state, double *unused, double *out_8566352363547608598) { - h_25(state, unused, out_8566352363547608598); +void car_h_25(double *state, double *unused, double *out_4691870608107024689) { + h_25(state, unused, out_4691870608107024689); } -void car_H_25(double *state, double *unused, double *out_5673419960197083828) { - H_25(state, unused, out_5673419960197083828); +void car_H_25(double *state, double *unused, double *out_4135237206615533559) { + H_25(state, unused, out_4135237206615533559); } -void car_h_24(double *state, double *unused, double *out_1105741821560728000) { - h_24(state, unused, out_1105741821560728000); +void car_h_24(double *state, double *unused, double *out_7256933575834984536) { + h_24(state, unused, out_7256933575834984536); } -void car_H_24(double *state, double *unused, double *out_5330649520523751468) { - H_24(state, unused, out_5330649520523751468); +void car_H_24(double *state, double *unused, double *out_3151171335774219891) { + H_24(state, unused, out_3151171335774219891); } -void car_h_30(double *state, double *unused, double *out_2652619336876860225) { - h_30(state, unused, out_2652619336876860225); +void car_h_30(double *state, double *unused, double *out_6984038239252175991) { + h_30(state, unused, out_6984038239252175991); } -void car_H_30(double *state, double *unused, double *out_8245627783384859590) { - H_30(state, unused, out_8245627783384859590); +void car_H_30(double *state, double *unused, double *out_2781453134876083196) { + H_30(state, unused, out_2781453134876083196); } -void car_h_26(double *state, double *unused, double *out_1745332744404768787) { - h_26(state, unused, out_1745332744404768787); +void car_h_26(double *state, double *unused, double *out_8151782040328317728) { + h_26(state, unused, out_8151782040328317728); } -void car_H_26(double *state, double *unused, double *out_9031820794638411564) { - H_26(state, unused, out_9031820794638411564); +void car_H_26(double *state, double *unused, double *out_830711236854732958) { + H_26(state, unused, out_830711236854732958); } -void car_h_27(double *state, double *unused, double *out_4878718442501097373) { - h_27(state, unused, out_4878718442501097373); +void car_h_27(double *state, double *unused, double *out_6382318442842705649) { + h_27(state, unused, out_6382318442842705649); } -void car_H_27(double *state, double *unused, double *out_7977522219140748809) { - H_27(state, unused, out_7977522219140748809); +void car_H_27(double *state, double *unused, double *out_606689823075658285) { + H_27(state, unused, out_606689823075658285); } -void car_h_29(double *state, double *unused, double *out_1709109483975197790) { - h_29(state, unused, out_1709109483975197790); +void car_h_29(double *state, double *unused, double *out_205509483633589514) { + h_29(state, unused, out_205509483633589514); } -void car_H_29(double *state, double *unused, double *out_8755859127699251774) { - H_29(state, unused, out_8755859127699251774); +void car_H_29(double *state, double *unused, double *out_3291684479190475380) { + H_29(state, unused, out_3291684479190475380); } -void car_h_28(double *state, double *unused, double *out_2770626730810236969) { - h_28(state, unused, out_2770626730810236969); +void car_h_28(double *state, double *unused, double *out_1380645175181860004) { + h_28(state, unused, out_1380645175181860004); } -void car_H_28(double *state, double *unused, double *out_3673460110629721200) { - H_28(state, unused, out_3673460110629721200); +void car_H_28(double *state, double *unused, double *out_1790714537879055194) { + H_28(state, unused, out_1790714537879055194); } -void car_h_31(double *state, double *unused, double *out_4928902835293586248) { - h_31(state, unused, out_4928902835293586248); +void car_h_31(double *state, double *unused, double *out_4534683939755895544) { + h_31(state, unused, out_4534683939755895544); } -void car_H_31(double *state, double *unused, double *out_5642773998320123400) { - H_31(state, unused, out_5642773998320123400); +void car_H_31(double *state, double *unused, double *out_4104591244738573131) { + H_31(state, unused, out_4104591244738573131); } 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 e71be460b2..fe6e10607f 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_6338568395475486083); -void car_inv_err_fun(double *nom_x, double *true_x, double *out_5410100343915451790); -void car_H_mod_fun(double *state, double *out_823602999692946123); -void car_f_fun(double *state, double dt, double *out_5252072111533144957); -void car_F_fun(double *state, double dt, double *out_5472890640690018040); -void car_h_25(double *state, double *unused, double *out_8566352363547608598); -void car_H_25(double *state, double *unused, double *out_5673419960197083828); -void car_h_24(double *state, double *unused, double *out_1105741821560728000); -void car_H_24(double *state, double *unused, double *out_5330649520523751468); -void car_h_30(double *state, double *unused, double *out_2652619336876860225); -void car_H_30(double *state, double *unused, double *out_8245627783384859590); -void car_h_26(double *state, double *unused, double *out_1745332744404768787); -void car_H_26(double *state, double *unused, double *out_9031820794638411564); -void car_h_27(double *state, double *unused, double *out_4878718442501097373); -void car_H_27(double *state, double *unused, double *out_7977522219140748809); -void car_h_29(double *state, double *unused, double *out_1709109483975197790); -void car_H_29(double *state, double *unused, double *out_8755859127699251774); -void car_h_28(double *state, double *unused, double *out_2770626730810236969); -void car_H_28(double *state, double *unused, double *out_3673460110629721200); -void car_h_31(double *state, double *unused, double *out_4928902835293586248); -void car_H_31(double *state, double *unused, double *out_5642773998320123400); +void car_err_fun(double *nom_x, double *delta_x, double *out_408914854931955974); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_177131998479136517); +void car_H_mod_fun(double *state, double *out_612188567970168411); +void car_f_fun(double *state, double dt, double *out_1999864885543950499); +void car_F_fun(double *state, double dt, double *out_3889473353313594997); +void car_h_25(double *state, double *unused, double *out_4691870608107024689); +void car_H_25(double *state, double *unused, double *out_4135237206615533559); +void car_h_24(double *state, double *unused, double *out_7256933575834984536); +void car_H_24(double *state, double *unused, double *out_3151171335774219891); +void car_h_30(double *state, double *unused, double *out_6984038239252175991); +void car_H_30(double *state, double *unused, double *out_2781453134876083196); +void car_h_26(double *state, double *unused, double *out_8151782040328317728); +void car_H_26(double *state, double *unused, double *out_830711236854732958); +void car_h_27(double *state, double *unused, double *out_6382318442842705649); +void car_H_27(double *state, double *unused, double *out_606689823075658285); +void car_h_29(double *state, double *unused, double *out_205509483633589514); +void car_H_29(double *state, double *unused, double *out_3291684479190475380); +void car_h_28(double *state, double *unused, double *out_1380645175181860004); +void car_H_28(double *state, double *unused, double *out_1790714537879055194); +void car_h_31(double *state, double *unused, double *out_4534683939755895544); +void car_H_31(double *state, double *unused, double *out_4104591244738573131); 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 c63170e5cc..4018d29636 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 c44f51993d..928fc3abc5 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 e5bb2a85e1..a00a465811 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_3009922513179117509) { - out_3009922513179117509[0] = delta_x[0] + nom_x[0]; - out_3009922513179117509[1] = delta_x[1] + nom_x[1]; - out_3009922513179117509[2] = delta_x[2] + nom_x[2]; - out_3009922513179117509[3] = delta_x[3] + nom_x[3]; - out_3009922513179117509[4] = delta_x[4] + nom_x[4]; - out_3009922513179117509[5] = delta_x[5] + nom_x[5]; - out_3009922513179117509[6] = delta_x[6] + nom_x[6]; - out_3009922513179117509[7] = delta_x[7] + nom_x[7]; - out_3009922513179117509[8] = delta_x[8] + nom_x[8]; - out_3009922513179117509[9] = delta_x[9] + nom_x[9]; - out_3009922513179117509[10] = delta_x[10] + nom_x[10]; - out_3009922513179117509[11] = delta_x[11] + nom_x[11]; - out_3009922513179117509[12] = delta_x[12] + nom_x[12]; - out_3009922513179117509[13] = delta_x[13] + nom_x[13]; - out_3009922513179117509[14] = delta_x[14] + nom_x[14]; - out_3009922513179117509[15] = delta_x[15] + nom_x[15]; - out_3009922513179117509[16] = delta_x[16] + nom_x[16]; - out_3009922513179117509[17] = delta_x[17] + nom_x[17]; +void err_fun(double *nom_x, double *delta_x, double *out_5436717349763929250) { + out_5436717349763929250[0] = delta_x[0] + nom_x[0]; + out_5436717349763929250[1] = delta_x[1] + nom_x[1]; + out_5436717349763929250[2] = delta_x[2] + nom_x[2]; + out_5436717349763929250[3] = delta_x[3] + nom_x[3]; + out_5436717349763929250[4] = delta_x[4] + nom_x[4]; + out_5436717349763929250[5] = delta_x[5] + nom_x[5]; + out_5436717349763929250[6] = delta_x[6] + nom_x[6]; + out_5436717349763929250[7] = delta_x[7] + nom_x[7]; + out_5436717349763929250[8] = delta_x[8] + nom_x[8]; + out_5436717349763929250[9] = delta_x[9] + nom_x[9]; + out_5436717349763929250[10] = delta_x[10] + nom_x[10]; + out_5436717349763929250[11] = delta_x[11] + nom_x[11]; + out_5436717349763929250[12] = delta_x[12] + nom_x[12]; + out_5436717349763929250[13] = delta_x[13] + nom_x[13]; + out_5436717349763929250[14] = delta_x[14] + nom_x[14]; + out_5436717349763929250[15] = delta_x[15] + nom_x[15]; + out_5436717349763929250[16] = delta_x[16] + nom_x[16]; + out_5436717349763929250[17] = delta_x[17] + nom_x[17]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_975857412122476284) { - out_975857412122476284[0] = -nom_x[0] + true_x[0]; - out_975857412122476284[1] = -nom_x[1] + true_x[1]; - out_975857412122476284[2] = -nom_x[2] + true_x[2]; - out_975857412122476284[3] = -nom_x[3] + true_x[3]; - out_975857412122476284[4] = -nom_x[4] + true_x[4]; - out_975857412122476284[5] = -nom_x[5] + true_x[5]; - out_975857412122476284[6] = -nom_x[6] + true_x[6]; - out_975857412122476284[7] = -nom_x[7] + true_x[7]; - out_975857412122476284[8] = -nom_x[8] + true_x[8]; - out_975857412122476284[9] = -nom_x[9] + true_x[9]; - out_975857412122476284[10] = -nom_x[10] + true_x[10]; - out_975857412122476284[11] = -nom_x[11] + true_x[11]; - out_975857412122476284[12] = -nom_x[12] + true_x[12]; - out_975857412122476284[13] = -nom_x[13] + true_x[13]; - out_975857412122476284[14] = -nom_x[14] + true_x[14]; - out_975857412122476284[15] = -nom_x[15] + true_x[15]; - out_975857412122476284[16] = -nom_x[16] + true_x[16]; - out_975857412122476284[17] = -nom_x[17] + true_x[17]; +void inv_err_fun(double *nom_x, double *true_x, double *out_2267989734965085487) { + out_2267989734965085487[0] = -nom_x[0] + true_x[0]; + out_2267989734965085487[1] = -nom_x[1] + true_x[1]; + out_2267989734965085487[2] = -nom_x[2] + true_x[2]; + out_2267989734965085487[3] = -nom_x[3] + true_x[3]; + out_2267989734965085487[4] = -nom_x[4] + true_x[4]; + out_2267989734965085487[5] = -nom_x[5] + true_x[5]; + out_2267989734965085487[6] = -nom_x[6] + true_x[6]; + out_2267989734965085487[7] = -nom_x[7] + true_x[7]; + out_2267989734965085487[8] = -nom_x[8] + true_x[8]; + out_2267989734965085487[9] = -nom_x[9] + true_x[9]; + out_2267989734965085487[10] = -nom_x[10] + true_x[10]; + out_2267989734965085487[11] = -nom_x[11] + true_x[11]; + out_2267989734965085487[12] = -nom_x[12] + true_x[12]; + out_2267989734965085487[13] = -nom_x[13] + true_x[13]; + out_2267989734965085487[14] = -nom_x[14] + true_x[14]; + out_2267989734965085487[15] = -nom_x[15] + true_x[15]; + out_2267989734965085487[16] = -nom_x[16] + true_x[16]; + out_2267989734965085487[17] = -nom_x[17] + true_x[17]; } -void H_mod_fun(double *state, double *out_5701585413794445279) { - out_5701585413794445279[0] = 1.0; - out_5701585413794445279[1] = 0.0; - out_5701585413794445279[2] = 0.0; - out_5701585413794445279[3] = 0.0; - out_5701585413794445279[4] = 0.0; - out_5701585413794445279[5] = 0.0; - out_5701585413794445279[6] = 0.0; - out_5701585413794445279[7] = 0.0; - out_5701585413794445279[8] = 0.0; - out_5701585413794445279[9] = 0.0; - out_5701585413794445279[10] = 0.0; - out_5701585413794445279[11] = 0.0; - out_5701585413794445279[12] = 0.0; - out_5701585413794445279[13] = 0.0; - out_5701585413794445279[14] = 0.0; - out_5701585413794445279[15] = 0.0; - out_5701585413794445279[16] = 0.0; - out_5701585413794445279[17] = 0.0; - out_5701585413794445279[18] = 0.0; - out_5701585413794445279[19] = 1.0; - out_5701585413794445279[20] = 0.0; - out_5701585413794445279[21] = 0.0; - out_5701585413794445279[22] = 0.0; - out_5701585413794445279[23] = 0.0; - out_5701585413794445279[24] = 0.0; - out_5701585413794445279[25] = 0.0; - out_5701585413794445279[26] = 0.0; - out_5701585413794445279[27] = 0.0; - out_5701585413794445279[28] = 0.0; - out_5701585413794445279[29] = 0.0; - out_5701585413794445279[30] = 0.0; - out_5701585413794445279[31] = 0.0; - out_5701585413794445279[32] = 0.0; - out_5701585413794445279[33] = 0.0; - out_5701585413794445279[34] = 0.0; - out_5701585413794445279[35] = 0.0; - out_5701585413794445279[36] = 0.0; - out_5701585413794445279[37] = 0.0; - out_5701585413794445279[38] = 1.0; - out_5701585413794445279[39] = 0.0; - out_5701585413794445279[40] = 0.0; - out_5701585413794445279[41] = 0.0; - out_5701585413794445279[42] = 0.0; - out_5701585413794445279[43] = 0.0; - out_5701585413794445279[44] = 0.0; - out_5701585413794445279[45] = 0.0; - out_5701585413794445279[46] = 0.0; - out_5701585413794445279[47] = 0.0; - out_5701585413794445279[48] = 0.0; - out_5701585413794445279[49] = 0.0; - out_5701585413794445279[50] = 0.0; - out_5701585413794445279[51] = 0.0; - out_5701585413794445279[52] = 0.0; - out_5701585413794445279[53] = 0.0; - out_5701585413794445279[54] = 0.0; - out_5701585413794445279[55] = 0.0; - out_5701585413794445279[56] = 0.0; - out_5701585413794445279[57] = 1.0; - out_5701585413794445279[58] = 0.0; - out_5701585413794445279[59] = 0.0; - out_5701585413794445279[60] = 0.0; - out_5701585413794445279[61] = 0.0; - out_5701585413794445279[62] = 0.0; - out_5701585413794445279[63] = 0.0; - out_5701585413794445279[64] = 0.0; - out_5701585413794445279[65] = 0.0; - out_5701585413794445279[66] = 0.0; - out_5701585413794445279[67] = 0.0; - out_5701585413794445279[68] = 0.0; - out_5701585413794445279[69] = 0.0; - out_5701585413794445279[70] = 0.0; - out_5701585413794445279[71] = 0.0; - out_5701585413794445279[72] = 0.0; - out_5701585413794445279[73] = 0.0; - out_5701585413794445279[74] = 0.0; - out_5701585413794445279[75] = 0.0; - out_5701585413794445279[76] = 1.0; - out_5701585413794445279[77] = 0.0; - out_5701585413794445279[78] = 0.0; - out_5701585413794445279[79] = 0.0; - out_5701585413794445279[80] = 0.0; - out_5701585413794445279[81] = 0.0; - out_5701585413794445279[82] = 0.0; - out_5701585413794445279[83] = 0.0; - out_5701585413794445279[84] = 0.0; - out_5701585413794445279[85] = 0.0; - out_5701585413794445279[86] = 0.0; - out_5701585413794445279[87] = 0.0; - out_5701585413794445279[88] = 0.0; - out_5701585413794445279[89] = 0.0; - out_5701585413794445279[90] = 0.0; - out_5701585413794445279[91] = 0.0; - out_5701585413794445279[92] = 0.0; - out_5701585413794445279[93] = 0.0; - out_5701585413794445279[94] = 0.0; - out_5701585413794445279[95] = 1.0; - out_5701585413794445279[96] = 0.0; - out_5701585413794445279[97] = 0.0; - out_5701585413794445279[98] = 0.0; - out_5701585413794445279[99] = 0.0; - out_5701585413794445279[100] = 0.0; - out_5701585413794445279[101] = 0.0; - out_5701585413794445279[102] = 0.0; - out_5701585413794445279[103] = 0.0; - out_5701585413794445279[104] = 0.0; - out_5701585413794445279[105] = 0.0; - out_5701585413794445279[106] = 0.0; - out_5701585413794445279[107] = 0.0; - out_5701585413794445279[108] = 0.0; - out_5701585413794445279[109] = 0.0; - out_5701585413794445279[110] = 0.0; - out_5701585413794445279[111] = 0.0; - out_5701585413794445279[112] = 0.0; - out_5701585413794445279[113] = 0.0; - out_5701585413794445279[114] = 1.0; - out_5701585413794445279[115] = 0.0; - out_5701585413794445279[116] = 0.0; - out_5701585413794445279[117] = 0.0; - out_5701585413794445279[118] = 0.0; - out_5701585413794445279[119] = 0.0; - out_5701585413794445279[120] = 0.0; - out_5701585413794445279[121] = 0.0; - out_5701585413794445279[122] = 0.0; - out_5701585413794445279[123] = 0.0; - out_5701585413794445279[124] = 0.0; - out_5701585413794445279[125] = 0.0; - out_5701585413794445279[126] = 0.0; - out_5701585413794445279[127] = 0.0; - out_5701585413794445279[128] = 0.0; - out_5701585413794445279[129] = 0.0; - out_5701585413794445279[130] = 0.0; - out_5701585413794445279[131] = 0.0; - out_5701585413794445279[132] = 0.0; - out_5701585413794445279[133] = 1.0; - out_5701585413794445279[134] = 0.0; - out_5701585413794445279[135] = 0.0; - out_5701585413794445279[136] = 0.0; - out_5701585413794445279[137] = 0.0; - out_5701585413794445279[138] = 0.0; - out_5701585413794445279[139] = 0.0; - out_5701585413794445279[140] = 0.0; - out_5701585413794445279[141] = 0.0; - out_5701585413794445279[142] = 0.0; - out_5701585413794445279[143] = 0.0; - out_5701585413794445279[144] = 0.0; - out_5701585413794445279[145] = 0.0; - out_5701585413794445279[146] = 0.0; - out_5701585413794445279[147] = 0.0; - out_5701585413794445279[148] = 0.0; - out_5701585413794445279[149] = 0.0; - out_5701585413794445279[150] = 0.0; - out_5701585413794445279[151] = 0.0; - out_5701585413794445279[152] = 1.0; - out_5701585413794445279[153] = 0.0; - out_5701585413794445279[154] = 0.0; - out_5701585413794445279[155] = 0.0; - out_5701585413794445279[156] = 0.0; - out_5701585413794445279[157] = 0.0; - out_5701585413794445279[158] = 0.0; - out_5701585413794445279[159] = 0.0; - out_5701585413794445279[160] = 0.0; - out_5701585413794445279[161] = 0.0; - out_5701585413794445279[162] = 0.0; - out_5701585413794445279[163] = 0.0; - out_5701585413794445279[164] = 0.0; - out_5701585413794445279[165] = 0.0; - out_5701585413794445279[166] = 0.0; - out_5701585413794445279[167] = 0.0; - out_5701585413794445279[168] = 0.0; - out_5701585413794445279[169] = 0.0; - out_5701585413794445279[170] = 0.0; - out_5701585413794445279[171] = 1.0; - out_5701585413794445279[172] = 0.0; - out_5701585413794445279[173] = 0.0; - out_5701585413794445279[174] = 0.0; - out_5701585413794445279[175] = 0.0; - out_5701585413794445279[176] = 0.0; - out_5701585413794445279[177] = 0.0; - out_5701585413794445279[178] = 0.0; - out_5701585413794445279[179] = 0.0; - out_5701585413794445279[180] = 0.0; - out_5701585413794445279[181] = 0.0; - out_5701585413794445279[182] = 0.0; - out_5701585413794445279[183] = 0.0; - out_5701585413794445279[184] = 0.0; - out_5701585413794445279[185] = 0.0; - out_5701585413794445279[186] = 0.0; - out_5701585413794445279[187] = 0.0; - out_5701585413794445279[188] = 0.0; - out_5701585413794445279[189] = 0.0; - out_5701585413794445279[190] = 1.0; - out_5701585413794445279[191] = 0.0; - out_5701585413794445279[192] = 0.0; - out_5701585413794445279[193] = 0.0; - out_5701585413794445279[194] = 0.0; - out_5701585413794445279[195] = 0.0; - out_5701585413794445279[196] = 0.0; - out_5701585413794445279[197] = 0.0; - out_5701585413794445279[198] = 0.0; - out_5701585413794445279[199] = 0.0; - out_5701585413794445279[200] = 0.0; - out_5701585413794445279[201] = 0.0; - out_5701585413794445279[202] = 0.0; - out_5701585413794445279[203] = 0.0; - out_5701585413794445279[204] = 0.0; - out_5701585413794445279[205] = 0.0; - out_5701585413794445279[206] = 0.0; - out_5701585413794445279[207] = 0.0; - out_5701585413794445279[208] = 0.0; - out_5701585413794445279[209] = 1.0; - out_5701585413794445279[210] = 0.0; - out_5701585413794445279[211] = 0.0; - out_5701585413794445279[212] = 0.0; - out_5701585413794445279[213] = 0.0; - out_5701585413794445279[214] = 0.0; - out_5701585413794445279[215] = 0.0; - out_5701585413794445279[216] = 0.0; - out_5701585413794445279[217] = 0.0; - out_5701585413794445279[218] = 0.0; - out_5701585413794445279[219] = 0.0; - out_5701585413794445279[220] = 0.0; - out_5701585413794445279[221] = 0.0; - out_5701585413794445279[222] = 0.0; - out_5701585413794445279[223] = 0.0; - out_5701585413794445279[224] = 0.0; - out_5701585413794445279[225] = 0.0; - out_5701585413794445279[226] = 0.0; - out_5701585413794445279[227] = 0.0; - out_5701585413794445279[228] = 1.0; - out_5701585413794445279[229] = 0.0; - out_5701585413794445279[230] = 0.0; - out_5701585413794445279[231] = 0.0; - out_5701585413794445279[232] = 0.0; - out_5701585413794445279[233] = 0.0; - out_5701585413794445279[234] = 0.0; - out_5701585413794445279[235] = 0.0; - out_5701585413794445279[236] = 0.0; - out_5701585413794445279[237] = 0.0; - out_5701585413794445279[238] = 0.0; - out_5701585413794445279[239] = 0.0; - out_5701585413794445279[240] = 0.0; - out_5701585413794445279[241] = 0.0; - out_5701585413794445279[242] = 0.0; - out_5701585413794445279[243] = 0.0; - out_5701585413794445279[244] = 0.0; - out_5701585413794445279[245] = 0.0; - out_5701585413794445279[246] = 0.0; - out_5701585413794445279[247] = 1.0; - out_5701585413794445279[248] = 0.0; - out_5701585413794445279[249] = 0.0; - out_5701585413794445279[250] = 0.0; - out_5701585413794445279[251] = 0.0; - out_5701585413794445279[252] = 0.0; - out_5701585413794445279[253] = 0.0; - out_5701585413794445279[254] = 0.0; - out_5701585413794445279[255] = 0.0; - out_5701585413794445279[256] = 0.0; - out_5701585413794445279[257] = 0.0; - out_5701585413794445279[258] = 0.0; - out_5701585413794445279[259] = 0.0; - out_5701585413794445279[260] = 0.0; - out_5701585413794445279[261] = 0.0; - out_5701585413794445279[262] = 0.0; - out_5701585413794445279[263] = 0.0; - out_5701585413794445279[264] = 0.0; - out_5701585413794445279[265] = 0.0; - out_5701585413794445279[266] = 1.0; - out_5701585413794445279[267] = 0.0; - out_5701585413794445279[268] = 0.0; - out_5701585413794445279[269] = 0.0; - out_5701585413794445279[270] = 0.0; - out_5701585413794445279[271] = 0.0; - out_5701585413794445279[272] = 0.0; - out_5701585413794445279[273] = 0.0; - out_5701585413794445279[274] = 0.0; - out_5701585413794445279[275] = 0.0; - out_5701585413794445279[276] = 0.0; - out_5701585413794445279[277] = 0.0; - out_5701585413794445279[278] = 0.0; - out_5701585413794445279[279] = 0.0; - out_5701585413794445279[280] = 0.0; - out_5701585413794445279[281] = 0.0; - out_5701585413794445279[282] = 0.0; - out_5701585413794445279[283] = 0.0; - out_5701585413794445279[284] = 0.0; - out_5701585413794445279[285] = 1.0; - out_5701585413794445279[286] = 0.0; - out_5701585413794445279[287] = 0.0; - out_5701585413794445279[288] = 0.0; - out_5701585413794445279[289] = 0.0; - out_5701585413794445279[290] = 0.0; - out_5701585413794445279[291] = 0.0; - out_5701585413794445279[292] = 0.0; - out_5701585413794445279[293] = 0.0; - out_5701585413794445279[294] = 0.0; - out_5701585413794445279[295] = 0.0; - out_5701585413794445279[296] = 0.0; - out_5701585413794445279[297] = 0.0; - out_5701585413794445279[298] = 0.0; - out_5701585413794445279[299] = 0.0; - out_5701585413794445279[300] = 0.0; - out_5701585413794445279[301] = 0.0; - out_5701585413794445279[302] = 0.0; - out_5701585413794445279[303] = 0.0; - out_5701585413794445279[304] = 1.0; - out_5701585413794445279[305] = 0.0; - out_5701585413794445279[306] = 0.0; - out_5701585413794445279[307] = 0.0; - out_5701585413794445279[308] = 0.0; - out_5701585413794445279[309] = 0.0; - out_5701585413794445279[310] = 0.0; - out_5701585413794445279[311] = 0.0; - out_5701585413794445279[312] = 0.0; - out_5701585413794445279[313] = 0.0; - out_5701585413794445279[314] = 0.0; - out_5701585413794445279[315] = 0.0; - out_5701585413794445279[316] = 0.0; - out_5701585413794445279[317] = 0.0; - out_5701585413794445279[318] = 0.0; - out_5701585413794445279[319] = 0.0; - out_5701585413794445279[320] = 0.0; - out_5701585413794445279[321] = 0.0; - out_5701585413794445279[322] = 0.0; - out_5701585413794445279[323] = 1.0; +void H_mod_fun(double *state, double *out_7252406541217060893) { + out_7252406541217060893[0] = 1.0; + out_7252406541217060893[1] = 0.0; + out_7252406541217060893[2] = 0.0; + out_7252406541217060893[3] = 0.0; + out_7252406541217060893[4] = 0.0; + out_7252406541217060893[5] = 0.0; + out_7252406541217060893[6] = 0.0; + out_7252406541217060893[7] = 0.0; + out_7252406541217060893[8] = 0.0; + out_7252406541217060893[9] = 0.0; + out_7252406541217060893[10] = 0.0; + out_7252406541217060893[11] = 0.0; + out_7252406541217060893[12] = 0.0; + out_7252406541217060893[13] = 0.0; + out_7252406541217060893[14] = 0.0; + out_7252406541217060893[15] = 0.0; + out_7252406541217060893[16] = 0.0; + out_7252406541217060893[17] = 0.0; + out_7252406541217060893[18] = 0.0; + out_7252406541217060893[19] = 1.0; + out_7252406541217060893[20] = 0.0; + out_7252406541217060893[21] = 0.0; + out_7252406541217060893[22] = 0.0; + out_7252406541217060893[23] = 0.0; + out_7252406541217060893[24] = 0.0; + out_7252406541217060893[25] = 0.0; + out_7252406541217060893[26] = 0.0; + out_7252406541217060893[27] = 0.0; + out_7252406541217060893[28] = 0.0; + out_7252406541217060893[29] = 0.0; + out_7252406541217060893[30] = 0.0; + out_7252406541217060893[31] = 0.0; + out_7252406541217060893[32] = 0.0; + out_7252406541217060893[33] = 0.0; + out_7252406541217060893[34] = 0.0; + out_7252406541217060893[35] = 0.0; + out_7252406541217060893[36] = 0.0; + out_7252406541217060893[37] = 0.0; + out_7252406541217060893[38] = 1.0; + out_7252406541217060893[39] = 0.0; + out_7252406541217060893[40] = 0.0; + out_7252406541217060893[41] = 0.0; + out_7252406541217060893[42] = 0.0; + out_7252406541217060893[43] = 0.0; + out_7252406541217060893[44] = 0.0; + out_7252406541217060893[45] = 0.0; + out_7252406541217060893[46] = 0.0; + out_7252406541217060893[47] = 0.0; + out_7252406541217060893[48] = 0.0; + out_7252406541217060893[49] = 0.0; + out_7252406541217060893[50] = 0.0; + out_7252406541217060893[51] = 0.0; + out_7252406541217060893[52] = 0.0; + out_7252406541217060893[53] = 0.0; + out_7252406541217060893[54] = 0.0; + out_7252406541217060893[55] = 0.0; + out_7252406541217060893[56] = 0.0; + out_7252406541217060893[57] = 1.0; + out_7252406541217060893[58] = 0.0; + out_7252406541217060893[59] = 0.0; + out_7252406541217060893[60] = 0.0; + out_7252406541217060893[61] = 0.0; + out_7252406541217060893[62] = 0.0; + out_7252406541217060893[63] = 0.0; + out_7252406541217060893[64] = 0.0; + out_7252406541217060893[65] = 0.0; + out_7252406541217060893[66] = 0.0; + out_7252406541217060893[67] = 0.0; + out_7252406541217060893[68] = 0.0; + out_7252406541217060893[69] = 0.0; + out_7252406541217060893[70] = 0.0; + out_7252406541217060893[71] = 0.0; + out_7252406541217060893[72] = 0.0; + out_7252406541217060893[73] = 0.0; + out_7252406541217060893[74] = 0.0; + out_7252406541217060893[75] = 0.0; + out_7252406541217060893[76] = 1.0; + out_7252406541217060893[77] = 0.0; + out_7252406541217060893[78] = 0.0; + out_7252406541217060893[79] = 0.0; + out_7252406541217060893[80] = 0.0; + out_7252406541217060893[81] = 0.0; + out_7252406541217060893[82] = 0.0; + out_7252406541217060893[83] = 0.0; + out_7252406541217060893[84] = 0.0; + out_7252406541217060893[85] = 0.0; + out_7252406541217060893[86] = 0.0; + out_7252406541217060893[87] = 0.0; + out_7252406541217060893[88] = 0.0; + out_7252406541217060893[89] = 0.0; + out_7252406541217060893[90] = 0.0; + out_7252406541217060893[91] = 0.0; + out_7252406541217060893[92] = 0.0; + out_7252406541217060893[93] = 0.0; + out_7252406541217060893[94] = 0.0; + out_7252406541217060893[95] = 1.0; + out_7252406541217060893[96] = 0.0; + out_7252406541217060893[97] = 0.0; + out_7252406541217060893[98] = 0.0; + out_7252406541217060893[99] = 0.0; + out_7252406541217060893[100] = 0.0; + out_7252406541217060893[101] = 0.0; + out_7252406541217060893[102] = 0.0; + out_7252406541217060893[103] = 0.0; + out_7252406541217060893[104] = 0.0; + out_7252406541217060893[105] = 0.0; + out_7252406541217060893[106] = 0.0; + out_7252406541217060893[107] = 0.0; + out_7252406541217060893[108] = 0.0; + out_7252406541217060893[109] = 0.0; + out_7252406541217060893[110] = 0.0; + out_7252406541217060893[111] = 0.0; + out_7252406541217060893[112] = 0.0; + out_7252406541217060893[113] = 0.0; + out_7252406541217060893[114] = 1.0; + out_7252406541217060893[115] = 0.0; + out_7252406541217060893[116] = 0.0; + out_7252406541217060893[117] = 0.0; + out_7252406541217060893[118] = 0.0; + out_7252406541217060893[119] = 0.0; + out_7252406541217060893[120] = 0.0; + out_7252406541217060893[121] = 0.0; + out_7252406541217060893[122] = 0.0; + out_7252406541217060893[123] = 0.0; + out_7252406541217060893[124] = 0.0; + out_7252406541217060893[125] = 0.0; + out_7252406541217060893[126] = 0.0; + out_7252406541217060893[127] = 0.0; + out_7252406541217060893[128] = 0.0; + out_7252406541217060893[129] = 0.0; + out_7252406541217060893[130] = 0.0; + out_7252406541217060893[131] = 0.0; + out_7252406541217060893[132] = 0.0; + out_7252406541217060893[133] = 1.0; + out_7252406541217060893[134] = 0.0; + out_7252406541217060893[135] = 0.0; + out_7252406541217060893[136] = 0.0; + out_7252406541217060893[137] = 0.0; + out_7252406541217060893[138] = 0.0; + out_7252406541217060893[139] = 0.0; + out_7252406541217060893[140] = 0.0; + out_7252406541217060893[141] = 0.0; + out_7252406541217060893[142] = 0.0; + out_7252406541217060893[143] = 0.0; + out_7252406541217060893[144] = 0.0; + out_7252406541217060893[145] = 0.0; + out_7252406541217060893[146] = 0.0; + out_7252406541217060893[147] = 0.0; + out_7252406541217060893[148] = 0.0; + out_7252406541217060893[149] = 0.0; + out_7252406541217060893[150] = 0.0; + out_7252406541217060893[151] = 0.0; + out_7252406541217060893[152] = 1.0; + out_7252406541217060893[153] = 0.0; + out_7252406541217060893[154] = 0.0; + out_7252406541217060893[155] = 0.0; + out_7252406541217060893[156] = 0.0; + out_7252406541217060893[157] = 0.0; + out_7252406541217060893[158] = 0.0; + out_7252406541217060893[159] = 0.0; + out_7252406541217060893[160] = 0.0; + out_7252406541217060893[161] = 0.0; + out_7252406541217060893[162] = 0.0; + out_7252406541217060893[163] = 0.0; + out_7252406541217060893[164] = 0.0; + out_7252406541217060893[165] = 0.0; + out_7252406541217060893[166] = 0.0; + out_7252406541217060893[167] = 0.0; + out_7252406541217060893[168] = 0.0; + out_7252406541217060893[169] = 0.0; + out_7252406541217060893[170] = 0.0; + out_7252406541217060893[171] = 1.0; + out_7252406541217060893[172] = 0.0; + out_7252406541217060893[173] = 0.0; + out_7252406541217060893[174] = 0.0; + out_7252406541217060893[175] = 0.0; + out_7252406541217060893[176] = 0.0; + out_7252406541217060893[177] = 0.0; + out_7252406541217060893[178] = 0.0; + out_7252406541217060893[179] = 0.0; + out_7252406541217060893[180] = 0.0; + out_7252406541217060893[181] = 0.0; + out_7252406541217060893[182] = 0.0; + out_7252406541217060893[183] = 0.0; + out_7252406541217060893[184] = 0.0; + out_7252406541217060893[185] = 0.0; + out_7252406541217060893[186] = 0.0; + out_7252406541217060893[187] = 0.0; + out_7252406541217060893[188] = 0.0; + out_7252406541217060893[189] = 0.0; + out_7252406541217060893[190] = 1.0; + out_7252406541217060893[191] = 0.0; + out_7252406541217060893[192] = 0.0; + out_7252406541217060893[193] = 0.0; + out_7252406541217060893[194] = 0.0; + out_7252406541217060893[195] = 0.0; + out_7252406541217060893[196] = 0.0; + out_7252406541217060893[197] = 0.0; + out_7252406541217060893[198] = 0.0; + out_7252406541217060893[199] = 0.0; + out_7252406541217060893[200] = 0.0; + out_7252406541217060893[201] = 0.0; + out_7252406541217060893[202] = 0.0; + out_7252406541217060893[203] = 0.0; + out_7252406541217060893[204] = 0.0; + out_7252406541217060893[205] = 0.0; + out_7252406541217060893[206] = 0.0; + out_7252406541217060893[207] = 0.0; + out_7252406541217060893[208] = 0.0; + out_7252406541217060893[209] = 1.0; + out_7252406541217060893[210] = 0.0; + out_7252406541217060893[211] = 0.0; + out_7252406541217060893[212] = 0.0; + out_7252406541217060893[213] = 0.0; + out_7252406541217060893[214] = 0.0; + out_7252406541217060893[215] = 0.0; + out_7252406541217060893[216] = 0.0; + out_7252406541217060893[217] = 0.0; + out_7252406541217060893[218] = 0.0; + out_7252406541217060893[219] = 0.0; + out_7252406541217060893[220] = 0.0; + out_7252406541217060893[221] = 0.0; + out_7252406541217060893[222] = 0.0; + out_7252406541217060893[223] = 0.0; + out_7252406541217060893[224] = 0.0; + out_7252406541217060893[225] = 0.0; + out_7252406541217060893[226] = 0.0; + out_7252406541217060893[227] = 0.0; + out_7252406541217060893[228] = 1.0; + out_7252406541217060893[229] = 0.0; + out_7252406541217060893[230] = 0.0; + out_7252406541217060893[231] = 0.0; + out_7252406541217060893[232] = 0.0; + out_7252406541217060893[233] = 0.0; + out_7252406541217060893[234] = 0.0; + out_7252406541217060893[235] = 0.0; + out_7252406541217060893[236] = 0.0; + out_7252406541217060893[237] = 0.0; + out_7252406541217060893[238] = 0.0; + out_7252406541217060893[239] = 0.0; + out_7252406541217060893[240] = 0.0; + out_7252406541217060893[241] = 0.0; + out_7252406541217060893[242] = 0.0; + out_7252406541217060893[243] = 0.0; + out_7252406541217060893[244] = 0.0; + out_7252406541217060893[245] = 0.0; + out_7252406541217060893[246] = 0.0; + out_7252406541217060893[247] = 1.0; + out_7252406541217060893[248] = 0.0; + out_7252406541217060893[249] = 0.0; + out_7252406541217060893[250] = 0.0; + out_7252406541217060893[251] = 0.0; + out_7252406541217060893[252] = 0.0; + out_7252406541217060893[253] = 0.0; + out_7252406541217060893[254] = 0.0; + out_7252406541217060893[255] = 0.0; + out_7252406541217060893[256] = 0.0; + out_7252406541217060893[257] = 0.0; + out_7252406541217060893[258] = 0.0; + out_7252406541217060893[259] = 0.0; + out_7252406541217060893[260] = 0.0; + out_7252406541217060893[261] = 0.0; + out_7252406541217060893[262] = 0.0; + out_7252406541217060893[263] = 0.0; + out_7252406541217060893[264] = 0.0; + out_7252406541217060893[265] = 0.0; + out_7252406541217060893[266] = 1.0; + out_7252406541217060893[267] = 0.0; + out_7252406541217060893[268] = 0.0; + out_7252406541217060893[269] = 0.0; + out_7252406541217060893[270] = 0.0; + out_7252406541217060893[271] = 0.0; + out_7252406541217060893[272] = 0.0; + out_7252406541217060893[273] = 0.0; + out_7252406541217060893[274] = 0.0; + out_7252406541217060893[275] = 0.0; + out_7252406541217060893[276] = 0.0; + out_7252406541217060893[277] = 0.0; + out_7252406541217060893[278] = 0.0; + out_7252406541217060893[279] = 0.0; + out_7252406541217060893[280] = 0.0; + out_7252406541217060893[281] = 0.0; + out_7252406541217060893[282] = 0.0; + out_7252406541217060893[283] = 0.0; + out_7252406541217060893[284] = 0.0; + out_7252406541217060893[285] = 1.0; + out_7252406541217060893[286] = 0.0; + out_7252406541217060893[287] = 0.0; + out_7252406541217060893[288] = 0.0; + out_7252406541217060893[289] = 0.0; + out_7252406541217060893[290] = 0.0; + out_7252406541217060893[291] = 0.0; + out_7252406541217060893[292] = 0.0; + out_7252406541217060893[293] = 0.0; + out_7252406541217060893[294] = 0.0; + out_7252406541217060893[295] = 0.0; + out_7252406541217060893[296] = 0.0; + out_7252406541217060893[297] = 0.0; + out_7252406541217060893[298] = 0.0; + out_7252406541217060893[299] = 0.0; + out_7252406541217060893[300] = 0.0; + out_7252406541217060893[301] = 0.0; + out_7252406541217060893[302] = 0.0; + out_7252406541217060893[303] = 0.0; + out_7252406541217060893[304] = 1.0; + out_7252406541217060893[305] = 0.0; + out_7252406541217060893[306] = 0.0; + out_7252406541217060893[307] = 0.0; + out_7252406541217060893[308] = 0.0; + out_7252406541217060893[309] = 0.0; + out_7252406541217060893[310] = 0.0; + out_7252406541217060893[311] = 0.0; + out_7252406541217060893[312] = 0.0; + out_7252406541217060893[313] = 0.0; + out_7252406541217060893[314] = 0.0; + out_7252406541217060893[315] = 0.0; + out_7252406541217060893[316] = 0.0; + out_7252406541217060893[317] = 0.0; + out_7252406541217060893[318] = 0.0; + out_7252406541217060893[319] = 0.0; + out_7252406541217060893[320] = 0.0; + out_7252406541217060893[321] = 0.0; + out_7252406541217060893[322] = 0.0; + out_7252406541217060893[323] = 1.0; } -void f_fun(double *state, double dt, double *out_7100436431164388549) { - out_7100436431164388549[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_7100436431164388549[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_7100436431164388549[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_7100436431164388549[3] = dt*state[12] + state[3]; - out_7100436431164388549[4] = dt*state[13] + state[4]; - out_7100436431164388549[5] = dt*state[14] + state[5]; - out_7100436431164388549[6] = state[6]; - out_7100436431164388549[7] = state[7]; - out_7100436431164388549[8] = state[8]; - out_7100436431164388549[9] = state[9]; - out_7100436431164388549[10] = state[10]; - out_7100436431164388549[11] = state[11]; - out_7100436431164388549[12] = state[12]; - out_7100436431164388549[13] = state[13]; - out_7100436431164388549[14] = state[14]; - out_7100436431164388549[15] = state[15]; - out_7100436431164388549[16] = state[16]; - out_7100436431164388549[17] = state[17]; +void f_fun(double *state, double dt, double *out_7195877540201438501) { + out_7195877540201438501[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_7195877540201438501[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_7195877540201438501[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_7195877540201438501[3] = dt*state[12] + state[3]; + out_7195877540201438501[4] = dt*state[13] + state[4]; + out_7195877540201438501[5] = dt*state[14] + state[5]; + out_7195877540201438501[6] = state[6]; + out_7195877540201438501[7] = state[7]; + out_7195877540201438501[8] = state[8]; + out_7195877540201438501[9] = state[9]; + out_7195877540201438501[10] = state[10]; + out_7195877540201438501[11] = state[11]; + out_7195877540201438501[12] = state[12]; + out_7195877540201438501[13] = state[13]; + out_7195877540201438501[14] = state[14]; + out_7195877540201438501[15] = state[15]; + out_7195877540201438501[16] = state[16]; + out_7195877540201438501[17] = state[17]; } -void F_fun(double *state, double dt, double *out_4695823766962492888) { - out_4695823766962492888[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_4695823766962492888[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_4695823766962492888[2] = 0; - out_4695823766962492888[3] = 0; - out_4695823766962492888[4] = 0; - out_4695823766962492888[5] = 0; - out_4695823766962492888[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_4695823766962492888[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_4695823766962492888[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_4695823766962492888[9] = 0; - out_4695823766962492888[10] = 0; - out_4695823766962492888[11] = 0; - out_4695823766962492888[12] = 0; - out_4695823766962492888[13] = 0; - out_4695823766962492888[14] = 0; - out_4695823766962492888[15] = 0; - out_4695823766962492888[16] = 0; - out_4695823766962492888[17] = 0; - out_4695823766962492888[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_4695823766962492888[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_4695823766962492888[20] = 0; - out_4695823766962492888[21] = 0; - out_4695823766962492888[22] = 0; - out_4695823766962492888[23] = 0; - out_4695823766962492888[24] = 0; - out_4695823766962492888[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_4695823766962492888[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_4695823766962492888[27] = 0; - out_4695823766962492888[28] = 0; - out_4695823766962492888[29] = 0; - out_4695823766962492888[30] = 0; - out_4695823766962492888[31] = 0; - out_4695823766962492888[32] = 0; - out_4695823766962492888[33] = 0; - out_4695823766962492888[34] = 0; - out_4695823766962492888[35] = 0; - out_4695823766962492888[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_4695823766962492888[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_4695823766962492888[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_4695823766962492888[39] = 0; - out_4695823766962492888[40] = 0; - out_4695823766962492888[41] = 0; - out_4695823766962492888[42] = 0; - out_4695823766962492888[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_4695823766962492888[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_4695823766962492888[45] = 0; - out_4695823766962492888[46] = 0; - out_4695823766962492888[47] = 0; - out_4695823766962492888[48] = 0; - out_4695823766962492888[49] = 0; - out_4695823766962492888[50] = 0; - out_4695823766962492888[51] = 0; - out_4695823766962492888[52] = 0; - out_4695823766962492888[53] = 0; - out_4695823766962492888[54] = 0; - out_4695823766962492888[55] = 0; - out_4695823766962492888[56] = 0; - out_4695823766962492888[57] = 1; - out_4695823766962492888[58] = 0; - out_4695823766962492888[59] = 0; - out_4695823766962492888[60] = 0; - out_4695823766962492888[61] = 0; - out_4695823766962492888[62] = 0; - out_4695823766962492888[63] = 0; - out_4695823766962492888[64] = 0; - out_4695823766962492888[65] = 0; - out_4695823766962492888[66] = dt; - out_4695823766962492888[67] = 0; - out_4695823766962492888[68] = 0; - out_4695823766962492888[69] = 0; - out_4695823766962492888[70] = 0; - out_4695823766962492888[71] = 0; - out_4695823766962492888[72] = 0; - out_4695823766962492888[73] = 0; - out_4695823766962492888[74] = 0; - out_4695823766962492888[75] = 0; - out_4695823766962492888[76] = 1; - out_4695823766962492888[77] = 0; - out_4695823766962492888[78] = 0; - out_4695823766962492888[79] = 0; - out_4695823766962492888[80] = 0; - out_4695823766962492888[81] = 0; - out_4695823766962492888[82] = 0; - out_4695823766962492888[83] = 0; - out_4695823766962492888[84] = 0; - out_4695823766962492888[85] = dt; - out_4695823766962492888[86] = 0; - out_4695823766962492888[87] = 0; - out_4695823766962492888[88] = 0; - out_4695823766962492888[89] = 0; - out_4695823766962492888[90] = 0; - out_4695823766962492888[91] = 0; - out_4695823766962492888[92] = 0; - out_4695823766962492888[93] = 0; - out_4695823766962492888[94] = 0; - out_4695823766962492888[95] = 1; - out_4695823766962492888[96] = 0; - out_4695823766962492888[97] = 0; - out_4695823766962492888[98] = 0; - out_4695823766962492888[99] = 0; - out_4695823766962492888[100] = 0; - out_4695823766962492888[101] = 0; - out_4695823766962492888[102] = 0; - out_4695823766962492888[103] = 0; - out_4695823766962492888[104] = dt; - out_4695823766962492888[105] = 0; - out_4695823766962492888[106] = 0; - out_4695823766962492888[107] = 0; - out_4695823766962492888[108] = 0; - out_4695823766962492888[109] = 0; - out_4695823766962492888[110] = 0; - out_4695823766962492888[111] = 0; - out_4695823766962492888[112] = 0; - out_4695823766962492888[113] = 0; - out_4695823766962492888[114] = 1; - out_4695823766962492888[115] = 0; - out_4695823766962492888[116] = 0; - out_4695823766962492888[117] = 0; - out_4695823766962492888[118] = 0; - out_4695823766962492888[119] = 0; - out_4695823766962492888[120] = 0; - out_4695823766962492888[121] = 0; - out_4695823766962492888[122] = 0; - out_4695823766962492888[123] = 0; - out_4695823766962492888[124] = 0; - out_4695823766962492888[125] = 0; - out_4695823766962492888[126] = 0; - out_4695823766962492888[127] = 0; - out_4695823766962492888[128] = 0; - out_4695823766962492888[129] = 0; - out_4695823766962492888[130] = 0; - out_4695823766962492888[131] = 0; - out_4695823766962492888[132] = 0; - out_4695823766962492888[133] = 1; - out_4695823766962492888[134] = 0; - out_4695823766962492888[135] = 0; - out_4695823766962492888[136] = 0; - out_4695823766962492888[137] = 0; - out_4695823766962492888[138] = 0; - out_4695823766962492888[139] = 0; - out_4695823766962492888[140] = 0; - out_4695823766962492888[141] = 0; - out_4695823766962492888[142] = 0; - out_4695823766962492888[143] = 0; - out_4695823766962492888[144] = 0; - out_4695823766962492888[145] = 0; - out_4695823766962492888[146] = 0; - out_4695823766962492888[147] = 0; - out_4695823766962492888[148] = 0; - out_4695823766962492888[149] = 0; - out_4695823766962492888[150] = 0; - out_4695823766962492888[151] = 0; - out_4695823766962492888[152] = 1; - out_4695823766962492888[153] = 0; - out_4695823766962492888[154] = 0; - out_4695823766962492888[155] = 0; - out_4695823766962492888[156] = 0; - out_4695823766962492888[157] = 0; - out_4695823766962492888[158] = 0; - out_4695823766962492888[159] = 0; - out_4695823766962492888[160] = 0; - out_4695823766962492888[161] = 0; - out_4695823766962492888[162] = 0; - out_4695823766962492888[163] = 0; - out_4695823766962492888[164] = 0; - out_4695823766962492888[165] = 0; - out_4695823766962492888[166] = 0; - out_4695823766962492888[167] = 0; - out_4695823766962492888[168] = 0; - out_4695823766962492888[169] = 0; - out_4695823766962492888[170] = 0; - out_4695823766962492888[171] = 1; - out_4695823766962492888[172] = 0; - out_4695823766962492888[173] = 0; - out_4695823766962492888[174] = 0; - out_4695823766962492888[175] = 0; - out_4695823766962492888[176] = 0; - out_4695823766962492888[177] = 0; - out_4695823766962492888[178] = 0; - out_4695823766962492888[179] = 0; - out_4695823766962492888[180] = 0; - out_4695823766962492888[181] = 0; - out_4695823766962492888[182] = 0; - out_4695823766962492888[183] = 0; - out_4695823766962492888[184] = 0; - out_4695823766962492888[185] = 0; - out_4695823766962492888[186] = 0; - out_4695823766962492888[187] = 0; - out_4695823766962492888[188] = 0; - out_4695823766962492888[189] = 0; - out_4695823766962492888[190] = 1; - out_4695823766962492888[191] = 0; - out_4695823766962492888[192] = 0; - out_4695823766962492888[193] = 0; - out_4695823766962492888[194] = 0; - out_4695823766962492888[195] = 0; - out_4695823766962492888[196] = 0; - out_4695823766962492888[197] = 0; - out_4695823766962492888[198] = 0; - out_4695823766962492888[199] = 0; - out_4695823766962492888[200] = 0; - out_4695823766962492888[201] = 0; - out_4695823766962492888[202] = 0; - out_4695823766962492888[203] = 0; - out_4695823766962492888[204] = 0; - out_4695823766962492888[205] = 0; - out_4695823766962492888[206] = 0; - out_4695823766962492888[207] = 0; - out_4695823766962492888[208] = 0; - out_4695823766962492888[209] = 1; - out_4695823766962492888[210] = 0; - out_4695823766962492888[211] = 0; - out_4695823766962492888[212] = 0; - out_4695823766962492888[213] = 0; - out_4695823766962492888[214] = 0; - out_4695823766962492888[215] = 0; - out_4695823766962492888[216] = 0; - out_4695823766962492888[217] = 0; - out_4695823766962492888[218] = 0; - out_4695823766962492888[219] = 0; - out_4695823766962492888[220] = 0; - out_4695823766962492888[221] = 0; - out_4695823766962492888[222] = 0; - out_4695823766962492888[223] = 0; - out_4695823766962492888[224] = 0; - out_4695823766962492888[225] = 0; - out_4695823766962492888[226] = 0; - out_4695823766962492888[227] = 0; - out_4695823766962492888[228] = 1; - out_4695823766962492888[229] = 0; - out_4695823766962492888[230] = 0; - out_4695823766962492888[231] = 0; - out_4695823766962492888[232] = 0; - out_4695823766962492888[233] = 0; - out_4695823766962492888[234] = 0; - out_4695823766962492888[235] = 0; - out_4695823766962492888[236] = 0; - out_4695823766962492888[237] = 0; - out_4695823766962492888[238] = 0; - out_4695823766962492888[239] = 0; - out_4695823766962492888[240] = 0; - out_4695823766962492888[241] = 0; - out_4695823766962492888[242] = 0; - out_4695823766962492888[243] = 0; - out_4695823766962492888[244] = 0; - out_4695823766962492888[245] = 0; - out_4695823766962492888[246] = 0; - out_4695823766962492888[247] = 1; - out_4695823766962492888[248] = 0; - out_4695823766962492888[249] = 0; - out_4695823766962492888[250] = 0; - out_4695823766962492888[251] = 0; - out_4695823766962492888[252] = 0; - out_4695823766962492888[253] = 0; - out_4695823766962492888[254] = 0; - out_4695823766962492888[255] = 0; - out_4695823766962492888[256] = 0; - out_4695823766962492888[257] = 0; - out_4695823766962492888[258] = 0; - out_4695823766962492888[259] = 0; - out_4695823766962492888[260] = 0; - out_4695823766962492888[261] = 0; - out_4695823766962492888[262] = 0; - out_4695823766962492888[263] = 0; - out_4695823766962492888[264] = 0; - out_4695823766962492888[265] = 0; - out_4695823766962492888[266] = 1; - out_4695823766962492888[267] = 0; - out_4695823766962492888[268] = 0; - out_4695823766962492888[269] = 0; - out_4695823766962492888[270] = 0; - out_4695823766962492888[271] = 0; - out_4695823766962492888[272] = 0; - out_4695823766962492888[273] = 0; - out_4695823766962492888[274] = 0; - out_4695823766962492888[275] = 0; - out_4695823766962492888[276] = 0; - out_4695823766962492888[277] = 0; - out_4695823766962492888[278] = 0; - out_4695823766962492888[279] = 0; - out_4695823766962492888[280] = 0; - out_4695823766962492888[281] = 0; - out_4695823766962492888[282] = 0; - out_4695823766962492888[283] = 0; - out_4695823766962492888[284] = 0; - out_4695823766962492888[285] = 1; - out_4695823766962492888[286] = 0; - out_4695823766962492888[287] = 0; - out_4695823766962492888[288] = 0; - out_4695823766962492888[289] = 0; - out_4695823766962492888[290] = 0; - out_4695823766962492888[291] = 0; - out_4695823766962492888[292] = 0; - out_4695823766962492888[293] = 0; - out_4695823766962492888[294] = 0; - out_4695823766962492888[295] = 0; - out_4695823766962492888[296] = 0; - out_4695823766962492888[297] = 0; - out_4695823766962492888[298] = 0; - out_4695823766962492888[299] = 0; - out_4695823766962492888[300] = 0; - out_4695823766962492888[301] = 0; - out_4695823766962492888[302] = 0; - out_4695823766962492888[303] = 0; - out_4695823766962492888[304] = 1; - out_4695823766962492888[305] = 0; - out_4695823766962492888[306] = 0; - out_4695823766962492888[307] = 0; - out_4695823766962492888[308] = 0; - out_4695823766962492888[309] = 0; - out_4695823766962492888[310] = 0; - out_4695823766962492888[311] = 0; - out_4695823766962492888[312] = 0; - out_4695823766962492888[313] = 0; - out_4695823766962492888[314] = 0; - out_4695823766962492888[315] = 0; - out_4695823766962492888[316] = 0; - out_4695823766962492888[317] = 0; - out_4695823766962492888[318] = 0; - out_4695823766962492888[319] = 0; - out_4695823766962492888[320] = 0; - out_4695823766962492888[321] = 0; - out_4695823766962492888[322] = 0; - out_4695823766962492888[323] = 1; +void F_fun(double *state, double dt, double *out_2191763838467757291) { + out_2191763838467757291[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_2191763838467757291[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_2191763838467757291[2] = 0; + out_2191763838467757291[3] = 0; + out_2191763838467757291[4] = 0; + out_2191763838467757291[5] = 0; + out_2191763838467757291[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_2191763838467757291[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_2191763838467757291[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_2191763838467757291[9] = 0; + out_2191763838467757291[10] = 0; + out_2191763838467757291[11] = 0; + out_2191763838467757291[12] = 0; + out_2191763838467757291[13] = 0; + out_2191763838467757291[14] = 0; + out_2191763838467757291[15] = 0; + out_2191763838467757291[16] = 0; + out_2191763838467757291[17] = 0; + out_2191763838467757291[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_2191763838467757291[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_2191763838467757291[20] = 0; + out_2191763838467757291[21] = 0; + out_2191763838467757291[22] = 0; + out_2191763838467757291[23] = 0; + out_2191763838467757291[24] = 0; + out_2191763838467757291[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_2191763838467757291[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_2191763838467757291[27] = 0; + out_2191763838467757291[28] = 0; + out_2191763838467757291[29] = 0; + out_2191763838467757291[30] = 0; + out_2191763838467757291[31] = 0; + out_2191763838467757291[32] = 0; + out_2191763838467757291[33] = 0; + out_2191763838467757291[34] = 0; + out_2191763838467757291[35] = 0; + out_2191763838467757291[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_2191763838467757291[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_2191763838467757291[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_2191763838467757291[39] = 0; + out_2191763838467757291[40] = 0; + out_2191763838467757291[41] = 0; + out_2191763838467757291[42] = 0; + out_2191763838467757291[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_2191763838467757291[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_2191763838467757291[45] = 0; + out_2191763838467757291[46] = 0; + out_2191763838467757291[47] = 0; + out_2191763838467757291[48] = 0; + out_2191763838467757291[49] = 0; + out_2191763838467757291[50] = 0; + out_2191763838467757291[51] = 0; + out_2191763838467757291[52] = 0; + out_2191763838467757291[53] = 0; + out_2191763838467757291[54] = 0; + out_2191763838467757291[55] = 0; + out_2191763838467757291[56] = 0; + out_2191763838467757291[57] = 1; + out_2191763838467757291[58] = 0; + out_2191763838467757291[59] = 0; + out_2191763838467757291[60] = 0; + out_2191763838467757291[61] = 0; + out_2191763838467757291[62] = 0; + out_2191763838467757291[63] = 0; + out_2191763838467757291[64] = 0; + out_2191763838467757291[65] = 0; + out_2191763838467757291[66] = dt; + out_2191763838467757291[67] = 0; + out_2191763838467757291[68] = 0; + out_2191763838467757291[69] = 0; + out_2191763838467757291[70] = 0; + out_2191763838467757291[71] = 0; + out_2191763838467757291[72] = 0; + out_2191763838467757291[73] = 0; + out_2191763838467757291[74] = 0; + out_2191763838467757291[75] = 0; + out_2191763838467757291[76] = 1; + out_2191763838467757291[77] = 0; + out_2191763838467757291[78] = 0; + out_2191763838467757291[79] = 0; + out_2191763838467757291[80] = 0; + out_2191763838467757291[81] = 0; + out_2191763838467757291[82] = 0; + out_2191763838467757291[83] = 0; + out_2191763838467757291[84] = 0; + out_2191763838467757291[85] = dt; + out_2191763838467757291[86] = 0; + out_2191763838467757291[87] = 0; + out_2191763838467757291[88] = 0; + out_2191763838467757291[89] = 0; + out_2191763838467757291[90] = 0; + out_2191763838467757291[91] = 0; + out_2191763838467757291[92] = 0; + out_2191763838467757291[93] = 0; + out_2191763838467757291[94] = 0; + out_2191763838467757291[95] = 1; + out_2191763838467757291[96] = 0; + out_2191763838467757291[97] = 0; + out_2191763838467757291[98] = 0; + out_2191763838467757291[99] = 0; + out_2191763838467757291[100] = 0; + out_2191763838467757291[101] = 0; + out_2191763838467757291[102] = 0; + out_2191763838467757291[103] = 0; + out_2191763838467757291[104] = dt; + out_2191763838467757291[105] = 0; + out_2191763838467757291[106] = 0; + out_2191763838467757291[107] = 0; + out_2191763838467757291[108] = 0; + out_2191763838467757291[109] = 0; + out_2191763838467757291[110] = 0; + out_2191763838467757291[111] = 0; + out_2191763838467757291[112] = 0; + out_2191763838467757291[113] = 0; + out_2191763838467757291[114] = 1; + out_2191763838467757291[115] = 0; + out_2191763838467757291[116] = 0; + out_2191763838467757291[117] = 0; + out_2191763838467757291[118] = 0; + out_2191763838467757291[119] = 0; + out_2191763838467757291[120] = 0; + out_2191763838467757291[121] = 0; + out_2191763838467757291[122] = 0; + out_2191763838467757291[123] = 0; + out_2191763838467757291[124] = 0; + out_2191763838467757291[125] = 0; + out_2191763838467757291[126] = 0; + out_2191763838467757291[127] = 0; + out_2191763838467757291[128] = 0; + out_2191763838467757291[129] = 0; + out_2191763838467757291[130] = 0; + out_2191763838467757291[131] = 0; + out_2191763838467757291[132] = 0; + out_2191763838467757291[133] = 1; + out_2191763838467757291[134] = 0; + out_2191763838467757291[135] = 0; + out_2191763838467757291[136] = 0; + out_2191763838467757291[137] = 0; + out_2191763838467757291[138] = 0; + out_2191763838467757291[139] = 0; + out_2191763838467757291[140] = 0; + out_2191763838467757291[141] = 0; + out_2191763838467757291[142] = 0; + out_2191763838467757291[143] = 0; + out_2191763838467757291[144] = 0; + out_2191763838467757291[145] = 0; + out_2191763838467757291[146] = 0; + out_2191763838467757291[147] = 0; + out_2191763838467757291[148] = 0; + out_2191763838467757291[149] = 0; + out_2191763838467757291[150] = 0; + out_2191763838467757291[151] = 0; + out_2191763838467757291[152] = 1; + out_2191763838467757291[153] = 0; + out_2191763838467757291[154] = 0; + out_2191763838467757291[155] = 0; + out_2191763838467757291[156] = 0; + out_2191763838467757291[157] = 0; + out_2191763838467757291[158] = 0; + out_2191763838467757291[159] = 0; + out_2191763838467757291[160] = 0; + out_2191763838467757291[161] = 0; + out_2191763838467757291[162] = 0; + out_2191763838467757291[163] = 0; + out_2191763838467757291[164] = 0; + out_2191763838467757291[165] = 0; + out_2191763838467757291[166] = 0; + out_2191763838467757291[167] = 0; + out_2191763838467757291[168] = 0; + out_2191763838467757291[169] = 0; + out_2191763838467757291[170] = 0; + out_2191763838467757291[171] = 1; + out_2191763838467757291[172] = 0; + out_2191763838467757291[173] = 0; + out_2191763838467757291[174] = 0; + out_2191763838467757291[175] = 0; + out_2191763838467757291[176] = 0; + out_2191763838467757291[177] = 0; + out_2191763838467757291[178] = 0; + out_2191763838467757291[179] = 0; + out_2191763838467757291[180] = 0; + out_2191763838467757291[181] = 0; + out_2191763838467757291[182] = 0; + out_2191763838467757291[183] = 0; + out_2191763838467757291[184] = 0; + out_2191763838467757291[185] = 0; + out_2191763838467757291[186] = 0; + out_2191763838467757291[187] = 0; + out_2191763838467757291[188] = 0; + out_2191763838467757291[189] = 0; + out_2191763838467757291[190] = 1; + out_2191763838467757291[191] = 0; + out_2191763838467757291[192] = 0; + out_2191763838467757291[193] = 0; + out_2191763838467757291[194] = 0; + out_2191763838467757291[195] = 0; + out_2191763838467757291[196] = 0; + out_2191763838467757291[197] = 0; + out_2191763838467757291[198] = 0; + out_2191763838467757291[199] = 0; + out_2191763838467757291[200] = 0; + out_2191763838467757291[201] = 0; + out_2191763838467757291[202] = 0; + out_2191763838467757291[203] = 0; + out_2191763838467757291[204] = 0; + out_2191763838467757291[205] = 0; + out_2191763838467757291[206] = 0; + out_2191763838467757291[207] = 0; + out_2191763838467757291[208] = 0; + out_2191763838467757291[209] = 1; + out_2191763838467757291[210] = 0; + out_2191763838467757291[211] = 0; + out_2191763838467757291[212] = 0; + out_2191763838467757291[213] = 0; + out_2191763838467757291[214] = 0; + out_2191763838467757291[215] = 0; + out_2191763838467757291[216] = 0; + out_2191763838467757291[217] = 0; + out_2191763838467757291[218] = 0; + out_2191763838467757291[219] = 0; + out_2191763838467757291[220] = 0; + out_2191763838467757291[221] = 0; + out_2191763838467757291[222] = 0; + out_2191763838467757291[223] = 0; + out_2191763838467757291[224] = 0; + out_2191763838467757291[225] = 0; + out_2191763838467757291[226] = 0; + out_2191763838467757291[227] = 0; + out_2191763838467757291[228] = 1; + out_2191763838467757291[229] = 0; + out_2191763838467757291[230] = 0; + out_2191763838467757291[231] = 0; + out_2191763838467757291[232] = 0; + out_2191763838467757291[233] = 0; + out_2191763838467757291[234] = 0; + out_2191763838467757291[235] = 0; + out_2191763838467757291[236] = 0; + out_2191763838467757291[237] = 0; + out_2191763838467757291[238] = 0; + out_2191763838467757291[239] = 0; + out_2191763838467757291[240] = 0; + out_2191763838467757291[241] = 0; + out_2191763838467757291[242] = 0; + out_2191763838467757291[243] = 0; + out_2191763838467757291[244] = 0; + out_2191763838467757291[245] = 0; + out_2191763838467757291[246] = 0; + out_2191763838467757291[247] = 1; + out_2191763838467757291[248] = 0; + out_2191763838467757291[249] = 0; + out_2191763838467757291[250] = 0; + out_2191763838467757291[251] = 0; + out_2191763838467757291[252] = 0; + out_2191763838467757291[253] = 0; + out_2191763838467757291[254] = 0; + out_2191763838467757291[255] = 0; + out_2191763838467757291[256] = 0; + out_2191763838467757291[257] = 0; + out_2191763838467757291[258] = 0; + out_2191763838467757291[259] = 0; + out_2191763838467757291[260] = 0; + out_2191763838467757291[261] = 0; + out_2191763838467757291[262] = 0; + out_2191763838467757291[263] = 0; + out_2191763838467757291[264] = 0; + out_2191763838467757291[265] = 0; + out_2191763838467757291[266] = 1; + out_2191763838467757291[267] = 0; + out_2191763838467757291[268] = 0; + out_2191763838467757291[269] = 0; + out_2191763838467757291[270] = 0; + out_2191763838467757291[271] = 0; + out_2191763838467757291[272] = 0; + out_2191763838467757291[273] = 0; + out_2191763838467757291[274] = 0; + out_2191763838467757291[275] = 0; + out_2191763838467757291[276] = 0; + out_2191763838467757291[277] = 0; + out_2191763838467757291[278] = 0; + out_2191763838467757291[279] = 0; + out_2191763838467757291[280] = 0; + out_2191763838467757291[281] = 0; + out_2191763838467757291[282] = 0; + out_2191763838467757291[283] = 0; + out_2191763838467757291[284] = 0; + out_2191763838467757291[285] = 1; + out_2191763838467757291[286] = 0; + out_2191763838467757291[287] = 0; + out_2191763838467757291[288] = 0; + out_2191763838467757291[289] = 0; + out_2191763838467757291[290] = 0; + out_2191763838467757291[291] = 0; + out_2191763838467757291[292] = 0; + out_2191763838467757291[293] = 0; + out_2191763838467757291[294] = 0; + out_2191763838467757291[295] = 0; + out_2191763838467757291[296] = 0; + out_2191763838467757291[297] = 0; + out_2191763838467757291[298] = 0; + out_2191763838467757291[299] = 0; + out_2191763838467757291[300] = 0; + out_2191763838467757291[301] = 0; + out_2191763838467757291[302] = 0; + out_2191763838467757291[303] = 0; + out_2191763838467757291[304] = 1; + out_2191763838467757291[305] = 0; + out_2191763838467757291[306] = 0; + out_2191763838467757291[307] = 0; + out_2191763838467757291[308] = 0; + out_2191763838467757291[309] = 0; + out_2191763838467757291[310] = 0; + out_2191763838467757291[311] = 0; + out_2191763838467757291[312] = 0; + out_2191763838467757291[313] = 0; + out_2191763838467757291[314] = 0; + out_2191763838467757291[315] = 0; + out_2191763838467757291[316] = 0; + out_2191763838467757291[317] = 0; + out_2191763838467757291[318] = 0; + out_2191763838467757291[319] = 0; + out_2191763838467757291[320] = 0; + out_2191763838467757291[321] = 0; + out_2191763838467757291[322] = 0; + out_2191763838467757291[323] = 1; } -void h_4(double *state, double *unused, double *out_2886213327032254372) { - out_2886213327032254372[0] = state[6] + state[9]; - out_2886213327032254372[1] = state[7] + state[10]; - out_2886213327032254372[2] = state[8] + state[11]; +void h_4(double *state, double *unused, double *out_6710764914604440332) { + out_6710764914604440332[0] = state[6] + state[9]; + out_6710764914604440332[1] = state[7] + state[10]; + out_6710764914604440332[2] = state[8] + state[11]; } -void H_4(double *state, double *unused, double *out_146496392957513442) { - out_146496392957513442[0] = 0; - out_146496392957513442[1] = 0; - out_146496392957513442[2] = 0; - out_146496392957513442[3] = 0; - out_146496392957513442[4] = 0; - out_146496392957513442[5] = 0; - out_146496392957513442[6] = 1; - out_146496392957513442[7] = 0; - out_146496392957513442[8] = 0; - out_146496392957513442[9] = 1; - out_146496392957513442[10] = 0; - out_146496392957513442[11] = 0; - out_146496392957513442[12] = 0; - out_146496392957513442[13] = 0; - out_146496392957513442[14] = 0; - out_146496392957513442[15] = 0; - out_146496392957513442[16] = 0; - out_146496392957513442[17] = 0; - out_146496392957513442[18] = 0; - out_146496392957513442[19] = 0; - out_146496392957513442[20] = 0; - out_146496392957513442[21] = 0; - out_146496392957513442[22] = 0; - out_146496392957513442[23] = 0; - out_146496392957513442[24] = 0; - out_146496392957513442[25] = 1; - out_146496392957513442[26] = 0; - out_146496392957513442[27] = 0; - out_146496392957513442[28] = 1; - out_146496392957513442[29] = 0; - out_146496392957513442[30] = 0; - out_146496392957513442[31] = 0; - out_146496392957513442[32] = 0; - out_146496392957513442[33] = 0; - out_146496392957513442[34] = 0; - out_146496392957513442[35] = 0; - out_146496392957513442[36] = 0; - out_146496392957513442[37] = 0; - out_146496392957513442[38] = 0; - out_146496392957513442[39] = 0; - out_146496392957513442[40] = 0; - out_146496392957513442[41] = 0; - out_146496392957513442[42] = 0; - out_146496392957513442[43] = 0; - out_146496392957513442[44] = 1; - out_146496392957513442[45] = 0; - out_146496392957513442[46] = 0; - out_146496392957513442[47] = 1; - out_146496392957513442[48] = 0; - out_146496392957513442[49] = 0; - out_146496392957513442[50] = 0; - out_146496392957513442[51] = 0; - out_146496392957513442[52] = 0; - out_146496392957513442[53] = 0; +void H_4(double *state, double *unused, double *out_9072105267123357754) { + out_9072105267123357754[0] = 0; + out_9072105267123357754[1] = 0; + out_9072105267123357754[2] = 0; + out_9072105267123357754[3] = 0; + out_9072105267123357754[4] = 0; + out_9072105267123357754[5] = 0; + out_9072105267123357754[6] = 1; + out_9072105267123357754[7] = 0; + out_9072105267123357754[8] = 0; + out_9072105267123357754[9] = 1; + out_9072105267123357754[10] = 0; + out_9072105267123357754[11] = 0; + out_9072105267123357754[12] = 0; + out_9072105267123357754[13] = 0; + out_9072105267123357754[14] = 0; + out_9072105267123357754[15] = 0; + out_9072105267123357754[16] = 0; + out_9072105267123357754[17] = 0; + out_9072105267123357754[18] = 0; + out_9072105267123357754[19] = 0; + out_9072105267123357754[20] = 0; + out_9072105267123357754[21] = 0; + out_9072105267123357754[22] = 0; + out_9072105267123357754[23] = 0; + out_9072105267123357754[24] = 0; + out_9072105267123357754[25] = 1; + out_9072105267123357754[26] = 0; + out_9072105267123357754[27] = 0; + out_9072105267123357754[28] = 1; + out_9072105267123357754[29] = 0; + out_9072105267123357754[30] = 0; + out_9072105267123357754[31] = 0; + out_9072105267123357754[32] = 0; + out_9072105267123357754[33] = 0; + out_9072105267123357754[34] = 0; + out_9072105267123357754[35] = 0; + out_9072105267123357754[36] = 0; + out_9072105267123357754[37] = 0; + out_9072105267123357754[38] = 0; + out_9072105267123357754[39] = 0; + out_9072105267123357754[40] = 0; + out_9072105267123357754[41] = 0; + out_9072105267123357754[42] = 0; + out_9072105267123357754[43] = 0; + out_9072105267123357754[44] = 1; + out_9072105267123357754[45] = 0; + out_9072105267123357754[46] = 0; + out_9072105267123357754[47] = 1; + out_9072105267123357754[48] = 0; + out_9072105267123357754[49] = 0; + out_9072105267123357754[50] = 0; + out_9072105267123357754[51] = 0; + out_9072105267123357754[52] = 0; + out_9072105267123357754[53] = 0; } -void h_10(double *state, double *unused, double *out_1449862159655962354) { - out_1449862159655962354[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; - out_1449862159655962354[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; - out_1449862159655962354[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_5397643117837077736) { + out_5397643117837077736[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; + out_5397643117837077736[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; + out_5397643117837077736[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_3097566833981104856) { - out_3097566833981104856[0] = 0; - out_3097566833981104856[1] = 9.8100000000000005*cos(state[1]); - out_3097566833981104856[2] = 0; - out_3097566833981104856[3] = 0; - out_3097566833981104856[4] = -state[8]; - out_3097566833981104856[5] = state[7]; - out_3097566833981104856[6] = 0; - out_3097566833981104856[7] = state[5]; - out_3097566833981104856[8] = -state[4]; - out_3097566833981104856[9] = 0; - out_3097566833981104856[10] = 0; - out_3097566833981104856[11] = 0; - out_3097566833981104856[12] = 1; - out_3097566833981104856[13] = 0; - out_3097566833981104856[14] = 0; - out_3097566833981104856[15] = 1; - out_3097566833981104856[16] = 0; - out_3097566833981104856[17] = 0; - out_3097566833981104856[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); - out_3097566833981104856[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); - out_3097566833981104856[20] = 0; - out_3097566833981104856[21] = state[8]; - out_3097566833981104856[22] = 0; - out_3097566833981104856[23] = -state[6]; - out_3097566833981104856[24] = -state[5]; - out_3097566833981104856[25] = 0; - out_3097566833981104856[26] = state[3]; - out_3097566833981104856[27] = 0; - out_3097566833981104856[28] = 0; - out_3097566833981104856[29] = 0; - out_3097566833981104856[30] = 0; - out_3097566833981104856[31] = 1; - out_3097566833981104856[32] = 0; - out_3097566833981104856[33] = 0; - out_3097566833981104856[34] = 1; - out_3097566833981104856[35] = 0; - out_3097566833981104856[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); - out_3097566833981104856[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); - out_3097566833981104856[38] = 0; - out_3097566833981104856[39] = -state[7]; - out_3097566833981104856[40] = state[6]; - out_3097566833981104856[41] = 0; - out_3097566833981104856[42] = state[4]; - out_3097566833981104856[43] = -state[3]; - out_3097566833981104856[44] = 0; - out_3097566833981104856[45] = 0; - out_3097566833981104856[46] = 0; - out_3097566833981104856[47] = 0; - out_3097566833981104856[48] = 0; - out_3097566833981104856[49] = 0; - out_3097566833981104856[50] = 1; - out_3097566833981104856[51] = 0; - out_3097566833981104856[52] = 0; - out_3097566833981104856[53] = 1; +void H_10(double *state, double *unused, double *out_8486068256269040489) { + out_8486068256269040489[0] = 0; + out_8486068256269040489[1] = 9.8100000000000005*cos(state[1]); + out_8486068256269040489[2] = 0; + out_8486068256269040489[3] = 0; + out_8486068256269040489[4] = -state[8]; + out_8486068256269040489[5] = state[7]; + out_8486068256269040489[6] = 0; + out_8486068256269040489[7] = state[5]; + out_8486068256269040489[8] = -state[4]; + out_8486068256269040489[9] = 0; + out_8486068256269040489[10] = 0; + out_8486068256269040489[11] = 0; + out_8486068256269040489[12] = 1; + out_8486068256269040489[13] = 0; + out_8486068256269040489[14] = 0; + out_8486068256269040489[15] = 1; + out_8486068256269040489[16] = 0; + out_8486068256269040489[17] = 0; + out_8486068256269040489[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); + out_8486068256269040489[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); + out_8486068256269040489[20] = 0; + out_8486068256269040489[21] = state[8]; + out_8486068256269040489[22] = 0; + out_8486068256269040489[23] = -state[6]; + out_8486068256269040489[24] = -state[5]; + out_8486068256269040489[25] = 0; + out_8486068256269040489[26] = state[3]; + out_8486068256269040489[27] = 0; + out_8486068256269040489[28] = 0; + out_8486068256269040489[29] = 0; + out_8486068256269040489[30] = 0; + out_8486068256269040489[31] = 1; + out_8486068256269040489[32] = 0; + out_8486068256269040489[33] = 0; + out_8486068256269040489[34] = 1; + out_8486068256269040489[35] = 0; + out_8486068256269040489[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); + out_8486068256269040489[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); + out_8486068256269040489[38] = 0; + out_8486068256269040489[39] = -state[7]; + out_8486068256269040489[40] = state[6]; + out_8486068256269040489[41] = 0; + out_8486068256269040489[42] = state[4]; + out_8486068256269040489[43] = -state[3]; + out_8486068256269040489[44] = 0; + out_8486068256269040489[45] = 0; + out_8486068256269040489[46] = 0; + out_8486068256269040489[47] = 0; + out_8486068256269040489[48] = 0; + out_8486068256269040489[49] = 0; + out_8486068256269040489[50] = 1; + out_8486068256269040489[51] = 0; + out_8486068256269040489[52] = 0; + out_8486068256269040489[53] = 1; } -void h_13(double *state, double *unused, double *out_2970086023674538452) { - out_2970086023674538452[0] = state[3]; - out_2970086023674538452[1] = state[4]; - out_2970086023674538452[2] = state[5]; +void h_13(double *state, double *unused, double *out_1020156160635096483) { + out_1020156160635096483[0] = state[3]; + out_1020156160635096483[1] = state[4]; + out_1020156160635096483[2] = state[5]; } -void H_13(double *state, double *unused, double *out_3065777432374819359) { - out_3065777432374819359[0] = 0; - out_3065777432374819359[1] = 0; - out_3065777432374819359[2] = 0; - out_3065777432374819359[3] = 1; - out_3065777432374819359[4] = 0; - out_3065777432374819359[5] = 0; - out_3065777432374819359[6] = 0; - out_3065777432374819359[7] = 0; - out_3065777432374819359[8] = 0; - out_3065777432374819359[9] = 0; - out_3065777432374819359[10] = 0; - out_3065777432374819359[11] = 0; - out_3065777432374819359[12] = 0; - out_3065777432374819359[13] = 0; - out_3065777432374819359[14] = 0; - out_3065777432374819359[15] = 0; - out_3065777432374819359[16] = 0; - out_3065777432374819359[17] = 0; - out_3065777432374819359[18] = 0; - out_3065777432374819359[19] = 0; - out_3065777432374819359[20] = 0; - out_3065777432374819359[21] = 0; - out_3065777432374819359[22] = 1; - out_3065777432374819359[23] = 0; - out_3065777432374819359[24] = 0; - out_3065777432374819359[25] = 0; - out_3065777432374819359[26] = 0; - out_3065777432374819359[27] = 0; - out_3065777432374819359[28] = 0; - out_3065777432374819359[29] = 0; - out_3065777432374819359[30] = 0; - out_3065777432374819359[31] = 0; - out_3065777432374819359[32] = 0; - out_3065777432374819359[33] = 0; - out_3065777432374819359[34] = 0; - out_3065777432374819359[35] = 0; - out_3065777432374819359[36] = 0; - out_3065777432374819359[37] = 0; - out_3065777432374819359[38] = 0; - out_3065777432374819359[39] = 0; - out_3065777432374819359[40] = 0; - out_3065777432374819359[41] = 1; - out_3065777432374819359[42] = 0; - out_3065777432374819359[43] = 0; - out_3065777432374819359[44] = 0; - out_3065777432374819359[45] = 0; - out_3065777432374819359[46] = 0; - out_3065777432374819359[47] = 0; - out_3065777432374819359[48] = 0; - out_3065777432374819359[49] = 0; - out_3065777432374819359[50] = 0; - out_3065777432374819359[51] = 0; - out_3065777432374819359[52] = 0; - out_3065777432374819359[53] = 0; +void H_13(double *state, double *unused, double *out_5859831441791024953) { + out_5859831441791024953[0] = 0; + out_5859831441791024953[1] = 0; + out_5859831441791024953[2] = 0; + out_5859831441791024953[3] = 1; + out_5859831441791024953[4] = 0; + out_5859831441791024953[5] = 0; + out_5859831441791024953[6] = 0; + out_5859831441791024953[7] = 0; + out_5859831441791024953[8] = 0; + out_5859831441791024953[9] = 0; + out_5859831441791024953[10] = 0; + out_5859831441791024953[11] = 0; + out_5859831441791024953[12] = 0; + out_5859831441791024953[13] = 0; + out_5859831441791024953[14] = 0; + out_5859831441791024953[15] = 0; + out_5859831441791024953[16] = 0; + out_5859831441791024953[17] = 0; + out_5859831441791024953[18] = 0; + out_5859831441791024953[19] = 0; + out_5859831441791024953[20] = 0; + out_5859831441791024953[21] = 0; + out_5859831441791024953[22] = 1; + out_5859831441791024953[23] = 0; + out_5859831441791024953[24] = 0; + out_5859831441791024953[25] = 0; + out_5859831441791024953[26] = 0; + out_5859831441791024953[27] = 0; + out_5859831441791024953[28] = 0; + out_5859831441791024953[29] = 0; + out_5859831441791024953[30] = 0; + out_5859831441791024953[31] = 0; + out_5859831441791024953[32] = 0; + out_5859831441791024953[33] = 0; + out_5859831441791024953[34] = 0; + out_5859831441791024953[35] = 0; + out_5859831441791024953[36] = 0; + out_5859831441791024953[37] = 0; + out_5859831441791024953[38] = 0; + out_5859831441791024953[39] = 0; + out_5859831441791024953[40] = 0; + out_5859831441791024953[41] = 1; + out_5859831441791024953[42] = 0; + out_5859831441791024953[43] = 0; + out_5859831441791024953[44] = 0; + out_5859831441791024953[45] = 0; + out_5859831441791024953[46] = 0; + out_5859831441791024953[47] = 0; + out_5859831441791024953[48] = 0; + out_5859831441791024953[49] = 0; + out_5859831441791024953[50] = 0; + out_5859831441791024953[51] = 0; + out_5859831441791024953[52] = 0; + out_5859831441791024953[53] = 0; } -void h_14(double *state, double *unused, double *out_2307174073331940796) { - out_2307174073331940796[0] = state[6]; - out_2307174073331940796[1] = state[7]; - out_2307174073331940796[2] = state[8]; +void h_14(double *state, double *unused, double *out_6027370464870412024) { + out_6027370464870412024[0] = state[6]; + out_6027370464870412024[1] = state[7]; + out_6027370464870412024[2] = state[8]; } -void H_14(double *state, double *unused, double *out_3816744463381971087) { - out_3816744463381971087[0] = 0; - out_3816744463381971087[1] = 0; - out_3816744463381971087[2] = 0; - out_3816744463381971087[3] = 0; - out_3816744463381971087[4] = 0; - out_3816744463381971087[5] = 0; - out_3816744463381971087[6] = 1; - out_3816744463381971087[7] = 0; - out_3816744463381971087[8] = 0; - out_3816744463381971087[9] = 0; - out_3816744463381971087[10] = 0; - out_3816744463381971087[11] = 0; - out_3816744463381971087[12] = 0; - out_3816744463381971087[13] = 0; - out_3816744463381971087[14] = 0; - out_3816744463381971087[15] = 0; - out_3816744463381971087[16] = 0; - out_3816744463381971087[17] = 0; - out_3816744463381971087[18] = 0; - out_3816744463381971087[19] = 0; - out_3816744463381971087[20] = 0; - out_3816744463381971087[21] = 0; - out_3816744463381971087[22] = 0; - out_3816744463381971087[23] = 0; - out_3816744463381971087[24] = 0; - out_3816744463381971087[25] = 1; - out_3816744463381971087[26] = 0; - out_3816744463381971087[27] = 0; - out_3816744463381971087[28] = 0; - out_3816744463381971087[29] = 0; - out_3816744463381971087[30] = 0; - out_3816744463381971087[31] = 0; - out_3816744463381971087[32] = 0; - out_3816744463381971087[33] = 0; - out_3816744463381971087[34] = 0; - out_3816744463381971087[35] = 0; - out_3816744463381971087[36] = 0; - out_3816744463381971087[37] = 0; - out_3816744463381971087[38] = 0; - out_3816744463381971087[39] = 0; - out_3816744463381971087[40] = 0; - out_3816744463381971087[41] = 0; - out_3816744463381971087[42] = 0; - out_3816744463381971087[43] = 0; - out_3816744463381971087[44] = 1; - out_3816744463381971087[45] = 0; - out_3816744463381971087[46] = 0; - out_3816744463381971087[47] = 0; - out_3816744463381971087[48] = 0; - out_3816744463381971087[49] = 0; - out_3816744463381971087[50] = 0; - out_3816744463381971087[51] = 0; - out_3816744463381971087[52] = 0; - out_3816744463381971087[53] = 0; +void H_14(double *state, double *unused, double *out_5108864410783873225) { + out_5108864410783873225[0] = 0; + out_5108864410783873225[1] = 0; + out_5108864410783873225[2] = 0; + out_5108864410783873225[3] = 0; + out_5108864410783873225[4] = 0; + out_5108864410783873225[5] = 0; + out_5108864410783873225[6] = 1; + out_5108864410783873225[7] = 0; + out_5108864410783873225[8] = 0; + out_5108864410783873225[9] = 0; + out_5108864410783873225[10] = 0; + out_5108864410783873225[11] = 0; + out_5108864410783873225[12] = 0; + out_5108864410783873225[13] = 0; + out_5108864410783873225[14] = 0; + out_5108864410783873225[15] = 0; + out_5108864410783873225[16] = 0; + out_5108864410783873225[17] = 0; + out_5108864410783873225[18] = 0; + out_5108864410783873225[19] = 0; + out_5108864410783873225[20] = 0; + out_5108864410783873225[21] = 0; + out_5108864410783873225[22] = 0; + out_5108864410783873225[23] = 0; + out_5108864410783873225[24] = 0; + out_5108864410783873225[25] = 1; + out_5108864410783873225[26] = 0; + out_5108864410783873225[27] = 0; + out_5108864410783873225[28] = 0; + out_5108864410783873225[29] = 0; + out_5108864410783873225[30] = 0; + out_5108864410783873225[31] = 0; + out_5108864410783873225[32] = 0; + out_5108864410783873225[33] = 0; + out_5108864410783873225[34] = 0; + out_5108864410783873225[35] = 0; + out_5108864410783873225[36] = 0; + out_5108864410783873225[37] = 0; + out_5108864410783873225[38] = 0; + out_5108864410783873225[39] = 0; + out_5108864410783873225[40] = 0; + out_5108864410783873225[41] = 0; + out_5108864410783873225[42] = 0; + out_5108864410783873225[43] = 0; + out_5108864410783873225[44] = 1; + out_5108864410783873225[45] = 0; + out_5108864410783873225[46] = 0; + out_5108864410783873225[47] = 0; + out_5108864410783873225[48] = 0; + out_5108864410783873225[49] = 0; + out_5108864410783873225[50] = 0; + out_5108864410783873225[51] = 0; + out_5108864410783873225[52] = 0; + out_5108864410783873225[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_3009922513179117509) { - err_fun(nom_x, delta_x, out_3009922513179117509); +void pose_err_fun(double *nom_x, double *delta_x, double *out_5436717349763929250) { + err_fun(nom_x, delta_x, out_5436717349763929250); } -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_975857412122476284) { - inv_err_fun(nom_x, true_x, out_975857412122476284); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_2267989734965085487) { + inv_err_fun(nom_x, true_x, out_2267989734965085487); } -void pose_H_mod_fun(double *state, double *out_5701585413794445279) { - H_mod_fun(state, out_5701585413794445279); +void pose_H_mod_fun(double *state, double *out_7252406541217060893) { + H_mod_fun(state, out_7252406541217060893); } -void pose_f_fun(double *state, double dt, double *out_7100436431164388549) { - f_fun(state, dt, out_7100436431164388549); +void pose_f_fun(double *state, double dt, double *out_7195877540201438501) { + f_fun(state, dt, out_7195877540201438501); } -void pose_F_fun(double *state, double dt, double *out_4695823766962492888) { - F_fun(state, dt, out_4695823766962492888); +void pose_F_fun(double *state, double dt, double *out_2191763838467757291) { + F_fun(state, dt, out_2191763838467757291); } -void pose_h_4(double *state, double *unused, double *out_2886213327032254372) { - h_4(state, unused, out_2886213327032254372); +void pose_h_4(double *state, double *unused, double *out_6710764914604440332) { + h_4(state, unused, out_6710764914604440332); } -void pose_H_4(double *state, double *unused, double *out_146496392957513442) { - H_4(state, unused, out_146496392957513442); +void pose_H_4(double *state, double *unused, double *out_9072105267123357754) { + H_4(state, unused, out_9072105267123357754); } -void pose_h_10(double *state, double *unused, double *out_1449862159655962354) { - h_10(state, unused, out_1449862159655962354); +void pose_h_10(double *state, double *unused, double *out_5397643117837077736) { + h_10(state, unused, out_5397643117837077736); } -void pose_H_10(double *state, double *unused, double *out_3097566833981104856) { - H_10(state, unused, out_3097566833981104856); +void pose_H_10(double *state, double *unused, double *out_8486068256269040489) { + H_10(state, unused, out_8486068256269040489); } -void pose_h_13(double *state, double *unused, double *out_2970086023674538452) { - h_13(state, unused, out_2970086023674538452); +void pose_h_13(double *state, double *unused, double *out_1020156160635096483) { + h_13(state, unused, out_1020156160635096483); } -void pose_H_13(double *state, double *unused, double *out_3065777432374819359) { - H_13(state, unused, out_3065777432374819359); +void pose_H_13(double *state, double *unused, double *out_5859831441791024953) { + H_13(state, unused, out_5859831441791024953); } -void pose_h_14(double *state, double *unused, double *out_2307174073331940796) { - h_14(state, unused, out_2307174073331940796); +void pose_h_14(double *state, double *unused, double *out_6027370464870412024) { + h_14(state, unused, out_6027370464870412024); } -void pose_H_14(double *state, double *unused, double *out_3816744463381971087) { - H_14(state, unused, out_3816744463381971087); +void pose_H_14(double *state, double *unused, double *out_5108864410783873225) { + H_14(state, unused, out_5108864410783873225); } 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 c63ba53c22..e123de8e2e 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_3009922513179117509); -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_975857412122476284); -void pose_H_mod_fun(double *state, double *out_5701585413794445279); -void pose_f_fun(double *state, double dt, double *out_7100436431164388549); -void pose_F_fun(double *state, double dt, double *out_4695823766962492888); -void pose_h_4(double *state, double *unused, double *out_2886213327032254372); -void pose_H_4(double *state, double *unused, double *out_146496392957513442); -void pose_h_10(double *state, double *unused, double *out_1449862159655962354); -void pose_H_10(double *state, double *unused, double *out_3097566833981104856); -void pose_h_13(double *state, double *unused, double *out_2970086023674538452); -void pose_H_13(double *state, double *unused, double *out_3065777432374819359); -void pose_h_14(double *state, double *unused, double *out_2307174073331940796); -void pose_H_14(double *state, double *unused, double *out_3816744463381971087); +void pose_err_fun(double *nom_x, double *delta_x, double *out_5436717349763929250); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_2267989734965085487); +void pose_H_mod_fun(double *state, double *out_7252406541217060893); +void pose_f_fun(double *state, double dt, double *out_7195877540201438501); +void pose_F_fun(double *state, double dt, double *out_2191763838467757291); +void pose_h_4(double *state, double *unused, double *out_6710764914604440332); +void pose_H_4(double *state, double *unused, double *out_9072105267123357754); +void pose_h_10(double *state, double *unused, double *out_5397643117837077736); +void pose_H_10(double *state, double *unused, double *out_8486068256269040489); +void pose_h_13(double *state, double *unused, double *out_1020156160635096483); +void pose_H_13(double *state, double *unused, double *out_5859831441791024953); +void pose_h_14(double *state, double *unused, double *out_6027370464870412024); +void pose_H_14(double *state, double *unused, double *out_5108864410783873225); void pose_predict(double *in_x, double *in_P, double *in_Q, double dt); } \ No newline at end of file diff --git a/panda/board/obj/body_h7.bin.signed b/panda/board/obj/body_h7.bin.signed index 1f394c5424..b6e82c9b52 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 bbb41e6024..8ae8e61912 100755 Binary files a/panda/board/obj/bootstub.body_h7.bin and b/panda/board/obj/bootstub.body_h7.bin differ diff --git a/panda/board/obj/bootstub.panda.bin b/panda/board/obj/bootstub.panda.bin index bc64625812..4bcfeefb0e 100755 Binary files a/panda/board/obj/bootstub.panda.bin and b/panda/board/obj/bootstub.panda.bin differ diff --git a/panda/board/obj/bootstub.panda_h7.bin b/panda/board/obj/bootstub.panda_h7.bin index ce2dc3e973..07c85f4b8e 100755 Binary files a/panda/board/obj/bootstub.panda_h7.bin and b/panda/board/obj/bootstub.panda_h7.bin differ diff --git a/panda/board/obj/gitversion.h b/panda/board/obj/gitversion.h index 585fb61b66..6b66b37d3e 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-5ae3e638-P92eb5651-DEBUG"; +const uint8_t gitversion[29] = "DEV-8c4c8c30-P92eb5651-DEBUG"; diff --git a/panda/board/obj/panda.bin.signed b/panda/board/obj/panda.bin.signed index 080379fcf3..85a12f4481 100644 Binary files a/panda/board/obj/panda.bin.signed and b/panda/board/obj/panda.bin.signed differ diff --git a/panda/board/obj/panda_h7.bin.signed b/panda/board/obj/panda_h7.bin.signed index 247a6dd97a..5570748359 100644 Binary files a/panda/board/obj/panda_h7.bin.signed and b/panda/board/obj/panda_h7.bin.signed differ diff --git a/panda/board/obj/version b/panda/board/obj/version index 58dcc329f2..27c11e5202 100644 --- a/panda/board/obj/version +++ b/panda/board/obj/version @@ -1 +1 @@ -DEV-5ae3e638-P92eb5651-DEBUG \ No newline at end of file +DEV-8c4c8c30-P92eb5651-DEBUG \ No newline at end of file diff --git a/prebuilt.json b/prebuilt.json index 65396730af..e7c13115bc 100644 --- a/prebuilt.json +++ b/prebuilt.json @@ -1 +1 @@ -{"protected_inventory_sha256": "0e6cd9a94340b868348fec46de506788a0b56e7811b0dfb6f6b707eb2a312fae", "schema_version": 1} +{"protected_inventory_sha256": "834c282cf95a1d7707b6173dacdbb1957a9239d4a8ed71f3776562a257f37787", "schema_version": 1}