diff --git a/openpilot/selfdrive/locationd/models/generated/car.cpp b/openpilot/selfdrive/locationd/models/generated/car.cpp index 8ebd5bcf08..01245b208c 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_4009510058988412331) { - out_4009510058988412331[0] = delta_x[0] + nom_x[0]; - out_4009510058988412331[1] = delta_x[1] + nom_x[1]; - out_4009510058988412331[2] = delta_x[2] + nom_x[2]; - out_4009510058988412331[3] = delta_x[3] + nom_x[3]; - out_4009510058988412331[4] = delta_x[4] + nom_x[4]; - out_4009510058988412331[5] = delta_x[5] + nom_x[5]; - out_4009510058988412331[6] = delta_x[6] + nom_x[6]; - out_4009510058988412331[7] = delta_x[7] + nom_x[7]; - out_4009510058988412331[8] = delta_x[8] + nom_x[8]; +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 inv_err_fun(double *nom_x, double *true_x, double *out_211208841364349865) { - out_211208841364349865[0] = -nom_x[0] + true_x[0]; - out_211208841364349865[1] = -nom_x[1] + true_x[1]; - out_211208841364349865[2] = -nom_x[2] + true_x[2]; - out_211208841364349865[3] = -nom_x[3] + true_x[3]; - out_211208841364349865[4] = -nom_x[4] + true_x[4]; - out_211208841364349865[5] = -nom_x[5] + true_x[5]; - out_211208841364349865[6] = -nom_x[6] + true_x[6]; - out_211208841364349865[7] = -nom_x[7] + true_x[7]; - out_211208841364349865[8] = -nom_x[8] + true_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 H_mod_fun(double *state, double *out_8439691916014613669) { - out_8439691916014613669[0] = 1.0; - out_8439691916014613669[1] = 0.0; - out_8439691916014613669[2] = 0.0; - out_8439691916014613669[3] = 0.0; - out_8439691916014613669[4] = 0.0; - out_8439691916014613669[5] = 0.0; - out_8439691916014613669[6] = 0.0; - out_8439691916014613669[7] = 0.0; - out_8439691916014613669[8] = 0.0; - out_8439691916014613669[9] = 0.0; - out_8439691916014613669[10] = 1.0; - out_8439691916014613669[11] = 0.0; - out_8439691916014613669[12] = 0.0; - out_8439691916014613669[13] = 0.0; - out_8439691916014613669[14] = 0.0; - out_8439691916014613669[15] = 0.0; - out_8439691916014613669[16] = 0.0; - out_8439691916014613669[17] = 0.0; - out_8439691916014613669[18] = 0.0; - out_8439691916014613669[19] = 0.0; - out_8439691916014613669[20] = 1.0; - out_8439691916014613669[21] = 0.0; - out_8439691916014613669[22] = 0.0; - out_8439691916014613669[23] = 0.0; - out_8439691916014613669[24] = 0.0; - out_8439691916014613669[25] = 0.0; - out_8439691916014613669[26] = 0.0; - out_8439691916014613669[27] = 0.0; - out_8439691916014613669[28] = 0.0; - out_8439691916014613669[29] = 0.0; - out_8439691916014613669[30] = 1.0; - out_8439691916014613669[31] = 0.0; - out_8439691916014613669[32] = 0.0; - out_8439691916014613669[33] = 0.0; - out_8439691916014613669[34] = 0.0; - out_8439691916014613669[35] = 0.0; - out_8439691916014613669[36] = 0.0; - out_8439691916014613669[37] = 0.0; - out_8439691916014613669[38] = 0.0; - out_8439691916014613669[39] = 0.0; - out_8439691916014613669[40] = 1.0; - out_8439691916014613669[41] = 0.0; - out_8439691916014613669[42] = 0.0; - out_8439691916014613669[43] = 0.0; - out_8439691916014613669[44] = 0.0; - out_8439691916014613669[45] = 0.0; - out_8439691916014613669[46] = 0.0; - out_8439691916014613669[47] = 0.0; - out_8439691916014613669[48] = 0.0; - out_8439691916014613669[49] = 0.0; - out_8439691916014613669[50] = 1.0; - out_8439691916014613669[51] = 0.0; - out_8439691916014613669[52] = 0.0; - out_8439691916014613669[53] = 0.0; - out_8439691916014613669[54] = 0.0; - out_8439691916014613669[55] = 0.0; - out_8439691916014613669[56] = 0.0; - out_8439691916014613669[57] = 0.0; - out_8439691916014613669[58] = 0.0; - out_8439691916014613669[59] = 0.0; - out_8439691916014613669[60] = 1.0; - out_8439691916014613669[61] = 0.0; - out_8439691916014613669[62] = 0.0; - out_8439691916014613669[63] = 0.0; - out_8439691916014613669[64] = 0.0; - out_8439691916014613669[65] = 0.0; - out_8439691916014613669[66] = 0.0; - out_8439691916014613669[67] = 0.0; - out_8439691916014613669[68] = 0.0; - out_8439691916014613669[69] = 0.0; - out_8439691916014613669[70] = 1.0; - out_8439691916014613669[71] = 0.0; - out_8439691916014613669[72] = 0.0; - out_8439691916014613669[73] = 0.0; - out_8439691916014613669[74] = 0.0; - out_8439691916014613669[75] = 0.0; - out_8439691916014613669[76] = 0.0; - out_8439691916014613669[77] = 0.0; - out_8439691916014613669[78] = 0.0; - out_8439691916014613669[79] = 0.0; - out_8439691916014613669[80] = 1.0; +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 f_fun(double *state, double dt, double *out_2756758349190389597) { - out_2756758349190389597[0] = state[0]; - out_2756758349190389597[1] = state[1]; - out_2756758349190389597[2] = state[2]; - out_2756758349190389597[3] = state[3]; - out_2756758349190389597[4] = state[4]; - out_2756758349190389597[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_2756758349190389597[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_2756758349190389597[7] = state[7]; - out_2756758349190389597[8] = state[8]; +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_6650625153394168514) { - out_6650625153394168514[0] = 1; - out_6650625153394168514[1] = 0; - out_6650625153394168514[2] = 0; - out_6650625153394168514[3] = 0; - out_6650625153394168514[4] = 0; - out_6650625153394168514[5] = 0; - out_6650625153394168514[6] = 0; - out_6650625153394168514[7] = 0; - out_6650625153394168514[8] = 0; - out_6650625153394168514[9] = 0; - out_6650625153394168514[10] = 1; - out_6650625153394168514[11] = 0; - out_6650625153394168514[12] = 0; - out_6650625153394168514[13] = 0; - out_6650625153394168514[14] = 0; - out_6650625153394168514[15] = 0; - out_6650625153394168514[16] = 0; - out_6650625153394168514[17] = 0; - out_6650625153394168514[18] = 0; - out_6650625153394168514[19] = 0; - out_6650625153394168514[20] = 1; - out_6650625153394168514[21] = 0; - out_6650625153394168514[22] = 0; - out_6650625153394168514[23] = 0; - out_6650625153394168514[24] = 0; - out_6650625153394168514[25] = 0; - out_6650625153394168514[26] = 0; - out_6650625153394168514[27] = 0; - out_6650625153394168514[28] = 0; - out_6650625153394168514[29] = 0; - out_6650625153394168514[30] = 1; - out_6650625153394168514[31] = 0; - out_6650625153394168514[32] = 0; - out_6650625153394168514[33] = 0; - out_6650625153394168514[34] = 0; - out_6650625153394168514[35] = 0; - out_6650625153394168514[36] = 0; - out_6650625153394168514[37] = 0; - out_6650625153394168514[38] = 0; - out_6650625153394168514[39] = 0; - out_6650625153394168514[40] = 1; - out_6650625153394168514[41] = 0; - out_6650625153394168514[42] = 0; - out_6650625153394168514[43] = 0; - out_6650625153394168514[44] = 0; - out_6650625153394168514[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_6650625153394168514[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); - out_6650625153394168514[47] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_6650625153394168514[48] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_6650625153394168514[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_6650625153394168514[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; - out_6650625153394168514[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); - out_6650625153394168514[52] = dt*stiffness_front*state[0]/(mass*state[1]); - out_6650625153394168514[53] = -9.8100000000000005*dt; - out_6650625153394168514[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_6650625153394168514[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); - out_6650625153394168514[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_6650625153394168514[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_6650625153394168514[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_6650625153394168514[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); - out_6650625153394168514[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_6650625153394168514[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_6650625153394168514[62] = 0; - out_6650625153394168514[63] = 0; - out_6650625153394168514[64] = 0; - out_6650625153394168514[65] = 0; - out_6650625153394168514[66] = 0; - out_6650625153394168514[67] = 0; - out_6650625153394168514[68] = 0; - out_6650625153394168514[69] = 0; - out_6650625153394168514[70] = 1; - out_6650625153394168514[71] = 0; - out_6650625153394168514[72] = 0; - out_6650625153394168514[73] = 0; - out_6650625153394168514[74] = 0; - out_6650625153394168514[75] = 0; - out_6650625153394168514[76] = 0; - out_6650625153394168514[77] = 0; - out_6650625153394168514[78] = 0; - out_6650625153394168514[79] = 0; - out_6650625153394168514[80] = 1; +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 h_25(double *state, double *unused, double *out_5235044060477467306) { - out_5235044060477467306[0] = state[6]; +void h_25(double *state, double *unused, double *out_8566352363547608598) { + out_8566352363547608598[0] = state[6]; } -void H_25(double *state, double *unused, double *out_3510029197804907996) { - out_3510029197804907996[0] = 0; - out_3510029197804907996[1] = 0; - out_3510029197804907996[2] = 0; - out_3510029197804907996[3] = 0; - out_3510029197804907996[4] = 0; - out_3510029197804907996[5] = 0; - out_3510029197804907996[6] = 1; - out_3510029197804907996[7] = 0; - out_3510029197804907996[8] = 0; +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_24(double *state, double *unused, double *out_8680530398976897528) { - out_8680530398976897528[0] = state[4]; - out_8680530398976897528[1] = state[5]; +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_1358785667222798856) { - out_1358785667222798856[0] = 0; - out_1358785667222798856[1] = 0; - out_1358785667222798856[2] = 0; - out_1358785667222798856[3] = 0; - out_1358785667222798856[4] = 1; - out_1358785667222798856[5] = 0; - out_1358785667222798856[6] = 0; - out_1358785667222798856[7] = 0; - out_1358785667222798856[8] = 0; - out_1358785667222798856[9] = 0; - out_1358785667222798856[10] = 0; - out_1358785667222798856[11] = 0; - out_1358785667222798856[12] = 0; - out_1358785667222798856[13] = 0; - out_1358785667222798856[14] = 1; - out_1358785667222798856[15] = 0; - out_1358785667222798856[16] = 0; - out_1358785667222798856[17] = 0; +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_30(double *state, double *unused, double *out_8872493588731489656) { - out_8872493588731489656[0] = state[4]; +void h_30(double *state, double *unused, double *out_2652619336876860225) { + out_2652619336876860225[0] = state[4]; } -void H_30(double *state, double *unused, double *out_1017667132322700202) { - out_1017667132322700202[0] = 0; - out_1017667132322700202[1] = 0; - out_1017667132322700202[2] = 0; - out_1017667132322700202[3] = 0; - out_1017667132322700202[4] = 1; - out_1017667132322700202[5] = 0; - out_1017667132322700202[6] = 0; - out_1017667132322700202[7] = 0; - out_1017667132322700202[8] = 0; +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_26(double *state, double *unused, double *out_6537464433533729275) { - out_6537464433533729275[0] = state[7]; +void h_26(double *state, double *unused, double *out_1745332744404768787) { + out_1745332744404768787[0] = state[7]; } -void H_26(double *state, double *unused, double *out_231474121069148228) { - out_231474121069148228[0] = 0; - out_231474121069148228[1] = 0; - out_231474121069148228[2] = 0; - out_231474121069148228[3] = 0; - out_231474121069148228[4] = 0; - out_231474121069148228[5] = 0; - out_231474121069148228[6] = 0; - out_231474121069148228[7] = 1; - out_231474121069148228[8] = 0; +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_27(double *state, double *unused, double *out_6419457039600352531) { - out_6419457039600352531[0] = state[3]; +void h_27(double *state, double *unused, double *out_4878718442501097373) { + out_4878718442501097373[0] = state[3]; } -void H_27(double *state, double *unused, double *out_1205926938861243015) { - out_1205926938861243015[0] = 0; - out_1205926938861243015[1] = 0; - out_1205926938861243015[2] = 0; - out_1205926938861243015[3] = 1; - out_1205926938861243015[4] = 0; - out_1205926938861243015[5] = 0; - out_1205926938861243015[6] = 0; - out_1205926938861243015[7] = 0; - out_1205926938861243015[8] = 0; +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_29(double *state, double *unused, double *out_7182045753995808696) { - out_7182045753995808696[0] = state[1]; +void h_29(double *state, double *unused, double *out_1709109483975197790) { + out_1709109483975197790[0] = state[1]; } -void H_29(double *state, double *unused, double *out_507435788008308018) { - out_507435788008308018[0] = 0; - out_507435788008308018[1] = 1; - out_507435788008308018[2] = 0; - out_507435788008308018[3] = 0; - out_507435788008308018[4] = 0; - out_507435788008308018[5] = 0; - out_507435788008308018[6] = 0; - out_507435788008308018[7] = 0; - out_507435788008308018[8] = 0; +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_28(double *state, double *unused, double *out_651026969752255553) { - out_651026969752255553[0] = state[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_5589834805077838592) { - out_5589834805077838592[0] = 1; - out_5589834805077838592[1] = 0; - out_5589834805077838592[2] = 0; - out_5589834805077838592[3] = 0; - out_5589834805077838592[4] = 0; - out_5589834805077838592[5] = 0; - out_5589834805077838592[6] = 0; - out_5589834805077838592[7] = 0; - out_5589834805077838592[8] = 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_31(double *state, double *unused, double *out_5089524236256812335) { - out_5089524236256812335[0] = state[8]; +void h_31(double *state, double *unused, double *out_4928902835293586248) { + out_4928902835293586248[0] = state[8]; } -void H_31(double *state, double *unused, double *out_3540675159681868424) { - out_3540675159681868424[0] = 0; - out_3540675159681868424[1] = 0; - out_3540675159681868424[2] = 0; - out_3540675159681868424[3] = 0; - out_3540675159681868424[4] = 0; - out_3540675159681868424[5] = 0; - out_3540675159681868424[6] = 0; - out_3540675159681868424[7] = 0; - out_3540675159681868424[8] = 1; +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; } #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_4009510058988412331) { - err_fun(nom_x, delta_x, out_4009510058988412331); +void car_err_fun(double *nom_x, double *delta_x, double *out_6338568395475486083) { + err_fun(nom_x, delta_x, out_6338568395475486083); } -void car_inv_err_fun(double *nom_x, double *true_x, double *out_211208841364349865) { - inv_err_fun(nom_x, true_x, out_211208841364349865); +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_H_mod_fun(double *state, double *out_8439691916014613669) { - H_mod_fun(state, out_8439691916014613669); +void car_H_mod_fun(double *state, double *out_823602999692946123) { + H_mod_fun(state, out_823602999692946123); } -void car_f_fun(double *state, double dt, double *out_2756758349190389597) { - f_fun(state, dt, out_2756758349190389597); +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_6650625153394168514) { - F_fun(state, dt, out_6650625153394168514); +void car_F_fun(double *state, double dt, double *out_5472890640690018040) { + F_fun(state, dt, out_5472890640690018040); } -void car_h_25(double *state, double *unused, double *out_5235044060477467306) { - h_25(state, unused, out_5235044060477467306); +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_3510029197804907996) { - H_25(state, unused, out_3510029197804907996); +void car_H_25(double *state, double *unused, double *out_5673419960197083828) { + H_25(state, unused, out_5673419960197083828); } -void car_h_24(double *state, double *unused, double *out_8680530398976897528) { - h_24(state, unused, out_8680530398976897528); +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_1358785667222798856) { - H_24(state, unused, out_1358785667222798856); +void car_H_24(double *state, double *unused, double *out_5330649520523751468) { + H_24(state, unused, out_5330649520523751468); } -void car_h_30(double *state, double *unused, double *out_8872493588731489656) { - h_30(state, unused, out_8872493588731489656); +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_1017667132322700202) { - H_30(state, unused, out_1017667132322700202); +void car_H_30(double *state, double *unused, double *out_8245627783384859590) { + H_30(state, unused, out_8245627783384859590); } -void car_h_26(double *state, double *unused, double *out_6537464433533729275) { - h_26(state, unused, out_6537464433533729275); +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_231474121069148228) { - H_26(state, unused, out_231474121069148228); +void car_H_26(double *state, double *unused, double *out_9031820794638411564) { + H_26(state, unused, out_9031820794638411564); } -void car_h_27(double *state, double *unused, double *out_6419457039600352531) { - h_27(state, unused, out_6419457039600352531); +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_1205926938861243015) { - H_27(state, unused, out_1205926938861243015); +void car_H_27(double *state, double *unused, double *out_7977522219140748809) { + H_27(state, unused, out_7977522219140748809); } -void car_h_29(double *state, double *unused, double *out_7182045753995808696) { - h_29(state, unused, out_7182045753995808696); +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_507435788008308018) { - H_29(state, unused, out_507435788008308018); +void car_H_29(double *state, double *unused, double *out_8755859127699251774) { + H_29(state, unused, out_8755859127699251774); } -void car_h_28(double *state, double *unused, double *out_651026969752255553) { - h_28(state, unused, out_651026969752255553); +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_5589834805077838592) { - H_28(state, unused, out_5589834805077838592); +void car_H_28(double *state, double *unused, double *out_3673460110629721200) { + H_28(state, unused, out_3673460110629721200); } -void car_h_31(double *state, double *unused, double *out_5089524236256812335) { - h_31(state, unused, out_5089524236256812335); +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_3540675159681868424) { - H_31(state, unused, out_3540675159681868424); +void car_H_31(double *state, double *unused, double *out_5642773998320123400) { + H_31(state, unused, out_5642773998320123400); } 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 a8902b0499..e71be460b2 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_4009510058988412331); -void car_inv_err_fun(double *nom_x, double *true_x, double *out_211208841364349865); -void car_H_mod_fun(double *state, double *out_8439691916014613669); -void car_f_fun(double *state, double dt, double *out_2756758349190389597); -void car_F_fun(double *state, double dt, double *out_6650625153394168514); -void car_h_25(double *state, double *unused, double *out_5235044060477467306); -void car_H_25(double *state, double *unused, double *out_3510029197804907996); -void car_h_24(double *state, double *unused, double *out_8680530398976897528); -void car_H_24(double *state, double *unused, double *out_1358785667222798856); -void car_h_30(double *state, double *unused, double *out_8872493588731489656); -void car_H_30(double *state, double *unused, double *out_1017667132322700202); -void car_h_26(double *state, double *unused, double *out_6537464433533729275); -void car_H_26(double *state, double *unused, double *out_231474121069148228); -void car_h_27(double *state, double *unused, double *out_6419457039600352531); -void car_H_27(double *state, double *unused, double *out_1205926938861243015); -void car_h_29(double *state, double *unused, double *out_7182045753995808696); -void car_H_29(double *state, double *unused, double *out_507435788008308018); -void car_h_28(double *state, double *unused, double *out_651026969752255553); -void car_H_28(double *state, double *unused, double *out_5589834805077838592); -void car_h_31(double *state, double *unused, double *out_5089524236256812335); -void car_H_31(double *state, double *unused, double *out_3540675159681868424); +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_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 ae74ed8029..c63170e5cc 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 831703963e..c44f51993d 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 a78f60eab1..e5bb2a85e1 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_7825504593440143444) { - out_7825504593440143444[0] = delta_x[0] + nom_x[0]; - out_7825504593440143444[1] = delta_x[1] + nom_x[1]; - out_7825504593440143444[2] = delta_x[2] + nom_x[2]; - out_7825504593440143444[3] = delta_x[3] + nom_x[3]; - out_7825504593440143444[4] = delta_x[4] + nom_x[4]; - out_7825504593440143444[5] = delta_x[5] + nom_x[5]; - out_7825504593440143444[6] = delta_x[6] + nom_x[6]; - out_7825504593440143444[7] = delta_x[7] + nom_x[7]; - out_7825504593440143444[8] = delta_x[8] + nom_x[8]; - out_7825504593440143444[9] = delta_x[9] + nom_x[9]; - out_7825504593440143444[10] = delta_x[10] + nom_x[10]; - out_7825504593440143444[11] = delta_x[11] + nom_x[11]; - out_7825504593440143444[12] = delta_x[12] + nom_x[12]; - out_7825504593440143444[13] = delta_x[13] + nom_x[13]; - out_7825504593440143444[14] = delta_x[14] + nom_x[14]; - out_7825504593440143444[15] = delta_x[15] + nom_x[15]; - out_7825504593440143444[16] = delta_x[16] + nom_x[16]; - out_7825504593440143444[17] = delta_x[17] + nom_x[17]; +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 inv_err_fun(double *nom_x, double *true_x, double *out_6707226023055995729) { - out_6707226023055995729[0] = -nom_x[0] + true_x[0]; - out_6707226023055995729[1] = -nom_x[1] + true_x[1]; - out_6707226023055995729[2] = -nom_x[2] + true_x[2]; - out_6707226023055995729[3] = -nom_x[3] + true_x[3]; - out_6707226023055995729[4] = -nom_x[4] + true_x[4]; - out_6707226023055995729[5] = -nom_x[5] + true_x[5]; - out_6707226023055995729[6] = -nom_x[6] + true_x[6]; - out_6707226023055995729[7] = -nom_x[7] + true_x[7]; - out_6707226023055995729[8] = -nom_x[8] + true_x[8]; - out_6707226023055995729[9] = -nom_x[9] + true_x[9]; - out_6707226023055995729[10] = -nom_x[10] + true_x[10]; - out_6707226023055995729[11] = -nom_x[11] + true_x[11]; - out_6707226023055995729[12] = -nom_x[12] + true_x[12]; - out_6707226023055995729[13] = -nom_x[13] + true_x[13]; - out_6707226023055995729[14] = -nom_x[14] + true_x[14]; - out_6707226023055995729[15] = -nom_x[15] + true_x[15]; - out_6707226023055995729[16] = -nom_x[16] + true_x[16]; - out_6707226023055995729[17] = -nom_x[17] + true_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 H_mod_fun(double *state, double *out_4618881527044107692) { - out_4618881527044107692[0] = 1.0; - out_4618881527044107692[1] = 0.0; - out_4618881527044107692[2] = 0.0; - out_4618881527044107692[3] = 0.0; - out_4618881527044107692[4] = 0.0; - out_4618881527044107692[5] = 0.0; - out_4618881527044107692[6] = 0.0; - out_4618881527044107692[7] = 0.0; - out_4618881527044107692[8] = 0.0; - out_4618881527044107692[9] = 0.0; - out_4618881527044107692[10] = 0.0; - out_4618881527044107692[11] = 0.0; - out_4618881527044107692[12] = 0.0; - out_4618881527044107692[13] = 0.0; - out_4618881527044107692[14] = 0.0; - out_4618881527044107692[15] = 0.0; - out_4618881527044107692[16] = 0.0; - out_4618881527044107692[17] = 0.0; - out_4618881527044107692[18] = 0.0; - out_4618881527044107692[19] = 1.0; - out_4618881527044107692[20] = 0.0; - out_4618881527044107692[21] = 0.0; - out_4618881527044107692[22] = 0.0; - out_4618881527044107692[23] = 0.0; - out_4618881527044107692[24] = 0.0; - out_4618881527044107692[25] = 0.0; - out_4618881527044107692[26] = 0.0; - out_4618881527044107692[27] = 0.0; - out_4618881527044107692[28] = 0.0; - out_4618881527044107692[29] = 0.0; - out_4618881527044107692[30] = 0.0; - out_4618881527044107692[31] = 0.0; - out_4618881527044107692[32] = 0.0; - out_4618881527044107692[33] = 0.0; - out_4618881527044107692[34] = 0.0; - out_4618881527044107692[35] = 0.0; - out_4618881527044107692[36] = 0.0; - out_4618881527044107692[37] = 0.0; - out_4618881527044107692[38] = 1.0; - out_4618881527044107692[39] = 0.0; - out_4618881527044107692[40] = 0.0; - out_4618881527044107692[41] = 0.0; - out_4618881527044107692[42] = 0.0; - out_4618881527044107692[43] = 0.0; - out_4618881527044107692[44] = 0.0; - out_4618881527044107692[45] = 0.0; - out_4618881527044107692[46] = 0.0; - out_4618881527044107692[47] = 0.0; - out_4618881527044107692[48] = 0.0; - out_4618881527044107692[49] = 0.0; - out_4618881527044107692[50] = 0.0; - out_4618881527044107692[51] = 0.0; - out_4618881527044107692[52] = 0.0; - out_4618881527044107692[53] = 0.0; - out_4618881527044107692[54] = 0.0; - out_4618881527044107692[55] = 0.0; - out_4618881527044107692[56] = 0.0; - out_4618881527044107692[57] = 1.0; - out_4618881527044107692[58] = 0.0; - out_4618881527044107692[59] = 0.0; - out_4618881527044107692[60] = 0.0; - out_4618881527044107692[61] = 0.0; - out_4618881527044107692[62] = 0.0; - out_4618881527044107692[63] = 0.0; - out_4618881527044107692[64] = 0.0; - out_4618881527044107692[65] = 0.0; - out_4618881527044107692[66] = 0.0; - out_4618881527044107692[67] = 0.0; - out_4618881527044107692[68] = 0.0; - out_4618881527044107692[69] = 0.0; - out_4618881527044107692[70] = 0.0; - out_4618881527044107692[71] = 0.0; - out_4618881527044107692[72] = 0.0; - out_4618881527044107692[73] = 0.0; - out_4618881527044107692[74] = 0.0; - out_4618881527044107692[75] = 0.0; - out_4618881527044107692[76] = 1.0; - out_4618881527044107692[77] = 0.0; - out_4618881527044107692[78] = 0.0; - out_4618881527044107692[79] = 0.0; - out_4618881527044107692[80] = 0.0; - out_4618881527044107692[81] = 0.0; - out_4618881527044107692[82] = 0.0; - out_4618881527044107692[83] = 0.0; - out_4618881527044107692[84] = 0.0; - out_4618881527044107692[85] = 0.0; - out_4618881527044107692[86] = 0.0; - out_4618881527044107692[87] = 0.0; - out_4618881527044107692[88] = 0.0; - out_4618881527044107692[89] = 0.0; - out_4618881527044107692[90] = 0.0; - out_4618881527044107692[91] = 0.0; - out_4618881527044107692[92] = 0.0; - out_4618881527044107692[93] = 0.0; - out_4618881527044107692[94] = 0.0; - out_4618881527044107692[95] = 1.0; - out_4618881527044107692[96] = 0.0; - out_4618881527044107692[97] = 0.0; - out_4618881527044107692[98] = 0.0; - out_4618881527044107692[99] = 0.0; - out_4618881527044107692[100] = 0.0; - out_4618881527044107692[101] = 0.0; - out_4618881527044107692[102] = 0.0; - out_4618881527044107692[103] = 0.0; - out_4618881527044107692[104] = 0.0; - out_4618881527044107692[105] = 0.0; - out_4618881527044107692[106] = 0.0; - out_4618881527044107692[107] = 0.0; - out_4618881527044107692[108] = 0.0; - out_4618881527044107692[109] = 0.0; - out_4618881527044107692[110] = 0.0; - out_4618881527044107692[111] = 0.0; - out_4618881527044107692[112] = 0.0; - out_4618881527044107692[113] = 0.0; - out_4618881527044107692[114] = 1.0; - out_4618881527044107692[115] = 0.0; - out_4618881527044107692[116] = 0.0; - out_4618881527044107692[117] = 0.0; - out_4618881527044107692[118] = 0.0; - out_4618881527044107692[119] = 0.0; - out_4618881527044107692[120] = 0.0; - out_4618881527044107692[121] = 0.0; - out_4618881527044107692[122] = 0.0; - out_4618881527044107692[123] = 0.0; - out_4618881527044107692[124] = 0.0; - out_4618881527044107692[125] = 0.0; - out_4618881527044107692[126] = 0.0; - out_4618881527044107692[127] = 0.0; - out_4618881527044107692[128] = 0.0; - out_4618881527044107692[129] = 0.0; - out_4618881527044107692[130] = 0.0; - out_4618881527044107692[131] = 0.0; - out_4618881527044107692[132] = 0.0; - out_4618881527044107692[133] = 1.0; - out_4618881527044107692[134] = 0.0; - out_4618881527044107692[135] = 0.0; - out_4618881527044107692[136] = 0.0; - out_4618881527044107692[137] = 0.0; - out_4618881527044107692[138] = 0.0; - out_4618881527044107692[139] = 0.0; - out_4618881527044107692[140] = 0.0; - out_4618881527044107692[141] = 0.0; - out_4618881527044107692[142] = 0.0; - out_4618881527044107692[143] = 0.0; - out_4618881527044107692[144] = 0.0; - out_4618881527044107692[145] = 0.0; - out_4618881527044107692[146] = 0.0; - out_4618881527044107692[147] = 0.0; - out_4618881527044107692[148] = 0.0; - out_4618881527044107692[149] = 0.0; - out_4618881527044107692[150] = 0.0; - out_4618881527044107692[151] = 0.0; - out_4618881527044107692[152] = 1.0; - out_4618881527044107692[153] = 0.0; - out_4618881527044107692[154] = 0.0; - out_4618881527044107692[155] = 0.0; - out_4618881527044107692[156] = 0.0; - out_4618881527044107692[157] = 0.0; - out_4618881527044107692[158] = 0.0; - out_4618881527044107692[159] = 0.0; - out_4618881527044107692[160] = 0.0; - out_4618881527044107692[161] = 0.0; - out_4618881527044107692[162] = 0.0; - out_4618881527044107692[163] = 0.0; - out_4618881527044107692[164] = 0.0; - out_4618881527044107692[165] = 0.0; - out_4618881527044107692[166] = 0.0; - out_4618881527044107692[167] = 0.0; - out_4618881527044107692[168] = 0.0; - out_4618881527044107692[169] = 0.0; - out_4618881527044107692[170] = 0.0; - out_4618881527044107692[171] = 1.0; - out_4618881527044107692[172] = 0.0; - out_4618881527044107692[173] = 0.0; - out_4618881527044107692[174] = 0.0; - out_4618881527044107692[175] = 0.0; - out_4618881527044107692[176] = 0.0; - out_4618881527044107692[177] = 0.0; - out_4618881527044107692[178] = 0.0; - out_4618881527044107692[179] = 0.0; - out_4618881527044107692[180] = 0.0; - out_4618881527044107692[181] = 0.0; - out_4618881527044107692[182] = 0.0; - out_4618881527044107692[183] = 0.0; - out_4618881527044107692[184] = 0.0; - out_4618881527044107692[185] = 0.0; - out_4618881527044107692[186] = 0.0; - out_4618881527044107692[187] = 0.0; - out_4618881527044107692[188] = 0.0; - out_4618881527044107692[189] = 0.0; - out_4618881527044107692[190] = 1.0; - out_4618881527044107692[191] = 0.0; - out_4618881527044107692[192] = 0.0; - out_4618881527044107692[193] = 0.0; - out_4618881527044107692[194] = 0.0; - out_4618881527044107692[195] = 0.0; - out_4618881527044107692[196] = 0.0; - out_4618881527044107692[197] = 0.0; - out_4618881527044107692[198] = 0.0; - out_4618881527044107692[199] = 0.0; - out_4618881527044107692[200] = 0.0; - out_4618881527044107692[201] = 0.0; - out_4618881527044107692[202] = 0.0; - out_4618881527044107692[203] = 0.0; - out_4618881527044107692[204] = 0.0; - out_4618881527044107692[205] = 0.0; - out_4618881527044107692[206] = 0.0; - out_4618881527044107692[207] = 0.0; - out_4618881527044107692[208] = 0.0; - out_4618881527044107692[209] = 1.0; - out_4618881527044107692[210] = 0.0; - out_4618881527044107692[211] = 0.0; - out_4618881527044107692[212] = 0.0; - out_4618881527044107692[213] = 0.0; - out_4618881527044107692[214] = 0.0; - out_4618881527044107692[215] = 0.0; - out_4618881527044107692[216] = 0.0; - out_4618881527044107692[217] = 0.0; - out_4618881527044107692[218] = 0.0; - out_4618881527044107692[219] = 0.0; - out_4618881527044107692[220] = 0.0; - out_4618881527044107692[221] = 0.0; - out_4618881527044107692[222] = 0.0; - out_4618881527044107692[223] = 0.0; - out_4618881527044107692[224] = 0.0; - out_4618881527044107692[225] = 0.0; - out_4618881527044107692[226] = 0.0; - out_4618881527044107692[227] = 0.0; - out_4618881527044107692[228] = 1.0; - out_4618881527044107692[229] = 0.0; - out_4618881527044107692[230] = 0.0; - out_4618881527044107692[231] = 0.0; - out_4618881527044107692[232] = 0.0; - out_4618881527044107692[233] = 0.0; - out_4618881527044107692[234] = 0.0; - out_4618881527044107692[235] = 0.0; - out_4618881527044107692[236] = 0.0; - out_4618881527044107692[237] = 0.0; - out_4618881527044107692[238] = 0.0; - out_4618881527044107692[239] = 0.0; - out_4618881527044107692[240] = 0.0; - out_4618881527044107692[241] = 0.0; - out_4618881527044107692[242] = 0.0; - out_4618881527044107692[243] = 0.0; - out_4618881527044107692[244] = 0.0; - out_4618881527044107692[245] = 0.0; - out_4618881527044107692[246] = 0.0; - out_4618881527044107692[247] = 1.0; - out_4618881527044107692[248] = 0.0; - out_4618881527044107692[249] = 0.0; - out_4618881527044107692[250] = 0.0; - out_4618881527044107692[251] = 0.0; - out_4618881527044107692[252] = 0.0; - out_4618881527044107692[253] = 0.0; - out_4618881527044107692[254] = 0.0; - out_4618881527044107692[255] = 0.0; - out_4618881527044107692[256] = 0.0; - out_4618881527044107692[257] = 0.0; - out_4618881527044107692[258] = 0.0; - out_4618881527044107692[259] = 0.0; - out_4618881527044107692[260] = 0.0; - out_4618881527044107692[261] = 0.0; - out_4618881527044107692[262] = 0.0; - out_4618881527044107692[263] = 0.0; - out_4618881527044107692[264] = 0.0; - out_4618881527044107692[265] = 0.0; - out_4618881527044107692[266] = 1.0; - out_4618881527044107692[267] = 0.0; - out_4618881527044107692[268] = 0.0; - out_4618881527044107692[269] = 0.0; - out_4618881527044107692[270] = 0.0; - out_4618881527044107692[271] = 0.0; - out_4618881527044107692[272] = 0.0; - out_4618881527044107692[273] = 0.0; - out_4618881527044107692[274] = 0.0; - out_4618881527044107692[275] = 0.0; - out_4618881527044107692[276] = 0.0; - out_4618881527044107692[277] = 0.0; - out_4618881527044107692[278] = 0.0; - out_4618881527044107692[279] = 0.0; - out_4618881527044107692[280] = 0.0; - out_4618881527044107692[281] = 0.0; - out_4618881527044107692[282] = 0.0; - out_4618881527044107692[283] = 0.0; - out_4618881527044107692[284] = 0.0; - out_4618881527044107692[285] = 1.0; - out_4618881527044107692[286] = 0.0; - out_4618881527044107692[287] = 0.0; - out_4618881527044107692[288] = 0.0; - out_4618881527044107692[289] = 0.0; - out_4618881527044107692[290] = 0.0; - out_4618881527044107692[291] = 0.0; - out_4618881527044107692[292] = 0.0; - out_4618881527044107692[293] = 0.0; - out_4618881527044107692[294] = 0.0; - out_4618881527044107692[295] = 0.0; - out_4618881527044107692[296] = 0.0; - out_4618881527044107692[297] = 0.0; - out_4618881527044107692[298] = 0.0; - out_4618881527044107692[299] = 0.0; - out_4618881527044107692[300] = 0.0; - out_4618881527044107692[301] = 0.0; - out_4618881527044107692[302] = 0.0; - out_4618881527044107692[303] = 0.0; - out_4618881527044107692[304] = 1.0; - out_4618881527044107692[305] = 0.0; - out_4618881527044107692[306] = 0.0; - out_4618881527044107692[307] = 0.0; - out_4618881527044107692[308] = 0.0; - out_4618881527044107692[309] = 0.0; - out_4618881527044107692[310] = 0.0; - out_4618881527044107692[311] = 0.0; - out_4618881527044107692[312] = 0.0; - out_4618881527044107692[313] = 0.0; - out_4618881527044107692[314] = 0.0; - out_4618881527044107692[315] = 0.0; - out_4618881527044107692[316] = 0.0; - out_4618881527044107692[317] = 0.0; - out_4618881527044107692[318] = 0.0; - out_4618881527044107692[319] = 0.0; - out_4618881527044107692[320] = 0.0; - out_4618881527044107692[321] = 0.0; - out_4618881527044107692[322] = 0.0; - out_4618881527044107692[323] = 1.0; +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 f_fun(double *state, double dt, double *out_6488051035785602820) { - out_6488051035785602820[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_6488051035785602820[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_6488051035785602820[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_6488051035785602820[3] = dt*state[12] + state[3]; - out_6488051035785602820[4] = dt*state[13] + state[4]; - out_6488051035785602820[5] = dt*state[14] + state[5]; - out_6488051035785602820[6] = state[6]; - out_6488051035785602820[7] = state[7]; - out_6488051035785602820[8] = state[8]; - out_6488051035785602820[9] = state[9]; - out_6488051035785602820[10] = state[10]; - out_6488051035785602820[11] = state[11]; - out_6488051035785602820[12] = state[12]; - out_6488051035785602820[13] = state[13]; - out_6488051035785602820[14] = state[14]; - out_6488051035785602820[15] = state[15]; - out_6488051035785602820[16] = state[16]; - out_6488051035785602820[17] = state[17]; +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_733896468910208221) { - out_733896468910208221[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_733896468910208221[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_733896468910208221[2] = 0; - out_733896468910208221[3] = 0; - out_733896468910208221[4] = 0; - out_733896468910208221[5] = 0; - out_733896468910208221[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_733896468910208221[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_733896468910208221[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_733896468910208221[9] = 0; - out_733896468910208221[10] = 0; - out_733896468910208221[11] = 0; - out_733896468910208221[12] = 0; - out_733896468910208221[13] = 0; - out_733896468910208221[14] = 0; - out_733896468910208221[15] = 0; - out_733896468910208221[16] = 0; - out_733896468910208221[17] = 0; - out_733896468910208221[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_733896468910208221[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_733896468910208221[20] = 0; - out_733896468910208221[21] = 0; - out_733896468910208221[22] = 0; - out_733896468910208221[23] = 0; - out_733896468910208221[24] = 0; - out_733896468910208221[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_733896468910208221[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_733896468910208221[27] = 0; - out_733896468910208221[28] = 0; - out_733896468910208221[29] = 0; - out_733896468910208221[30] = 0; - out_733896468910208221[31] = 0; - out_733896468910208221[32] = 0; - out_733896468910208221[33] = 0; - out_733896468910208221[34] = 0; - out_733896468910208221[35] = 0; - out_733896468910208221[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_733896468910208221[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_733896468910208221[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_733896468910208221[39] = 0; - out_733896468910208221[40] = 0; - out_733896468910208221[41] = 0; - out_733896468910208221[42] = 0; - out_733896468910208221[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_733896468910208221[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_733896468910208221[45] = 0; - out_733896468910208221[46] = 0; - out_733896468910208221[47] = 0; - out_733896468910208221[48] = 0; - out_733896468910208221[49] = 0; - out_733896468910208221[50] = 0; - out_733896468910208221[51] = 0; - out_733896468910208221[52] = 0; - out_733896468910208221[53] = 0; - out_733896468910208221[54] = 0; - out_733896468910208221[55] = 0; - out_733896468910208221[56] = 0; - out_733896468910208221[57] = 1; - out_733896468910208221[58] = 0; - out_733896468910208221[59] = 0; - out_733896468910208221[60] = 0; - out_733896468910208221[61] = 0; - out_733896468910208221[62] = 0; - out_733896468910208221[63] = 0; - out_733896468910208221[64] = 0; - out_733896468910208221[65] = 0; - out_733896468910208221[66] = dt; - out_733896468910208221[67] = 0; - out_733896468910208221[68] = 0; - out_733896468910208221[69] = 0; - out_733896468910208221[70] = 0; - out_733896468910208221[71] = 0; - out_733896468910208221[72] = 0; - out_733896468910208221[73] = 0; - out_733896468910208221[74] = 0; - out_733896468910208221[75] = 0; - out_733896468910208221[76] = 1; - out_733896468910208221[77] = 0; - out_733896468910208221[78] = 0; - out_733896468910208221[79] = 0; - out_733896468910208221[80] = 0; - out_733896468910208221[81] = 0; - out_733896468910208221[82] = 0; - out_733896468910208221[83] = 0; - out_733896468910208221[84] = 0; - out_733896468910208221[85] = dt; - out_733896468910208221[86] = 0; - out_733896468910208221[87] = 0; - out_733896468910208221[88] = 0; - out_733896468910208221[89] = 0; - out_733896468910208221[90] = 0; - out_733896468910208221[91] = 0; - out_733896468910208221[92] = 0; - out_733896468910208221[93] = 0; - out_733896468910208221[94] = 0; - out_733896468910208221[95] = 1; - out_733896468910208221[96] = 0; - out_733896468910208221[97] = 0; - out_733896468910208221[98] = 0; - out_733896468910208221[99] = 0; - out_733896468910208221[100] = 0; - out_733896468910208221[101] = 0; - out_733896468910208221[102] = 0; - out_733896468910208221[103] = 0; - out_733896468910208221[104] = dt; - out_733896468910208221[105] = 0; - out_733896468910208221[106] = 0; - out_733896468910208221[107] = 0; - out_733896468910208221[108] = 0; - out_733896468910208221[109] = 0; - out_733896468910208221[110] = 0; - out_733896468910208221[111] = 0; - out_733896468910208221[112] = 0; - out_733896468910208221[113] = 0; - out_733896468910208221[114] = 1; - out_733896468910208221[115] = 0; - out_733896468910208221[116] = 0; - out_733896468910208221[117] = 0; - out_733896468910208221[118] = 0; - out_733896468910208221[119] = 0; - out_733896468910208221[120] = 0; - out_733896468910208221[121] = 0; - out_733896468910208221[122] = 0; - out_733896468910208221[123] = 0; - out_733896468910208221[124] = 0; - out_733896468910208221[125] = 0; - out_733896468910208221[126] = 0; - out_733896468910208221[127] = 0; - out_733896468910208221[128] = 0; - out_733896468910208221[129] = 0; - out_733896468910208221[130] = 0; - out_733896468910208221[131] = 0; - out_733896468910208221[132] = 0; - out_733896468910208221[133] = 1; - out_733896468910208221[134] = 0; - out_733896468910208221[135] = 0; - out_733896468910208221[136] = 0; - out_733896468910208221[137] = 0; - out_733896468910208221[138] = 0; - out_733896468910208221[139] = 0; - out_733896468910208221[140] = 0; - out_733896468910208221[141] = 0; - out_733896468910208221[142] = 0; - out_733896468910208221[143] = 0; - out_733896468910208221[144] = 0; - out_733896468910208221[145] = 0; - out_733896468910208221[146] = 0; - out_733896468910208221[147] = 0; - out_733896468910208221[148] = 0; - out_733896468910208221[149] = 0; - out_733896468910208221[150] = 0; - out_733896468910208221[151] = 0; - out_733896468910208221[152] = 1; - out_733896468910208221[153] = 0; - out_733896468910208221[154] = 0; - out_733896468910208221[155] = 0; - out_733896468910208221[156] = 0; - out_733896468910208221[157] = 0; - out_733896468910208221[158] = 0; - out_733896468910208221[159] = 0; - out_733896468910208221[160] = 0; - out_733896468910208221[161] = 0; - out_733896468910208221[162] = 0; - out_733896468910208221[163] = 0; - out_733896468910208221[164] = 0; - out_733896468910208221[165] = 0; - out_733896468910208221[166] = 0; - out_733896468910208221[167] = 0; - out_733896468910208221[168] = 0; - out_733896468910208221[169] = 0; - out_733896468910208221[170] = 0; - out_733896468910208221[171] = 1; - out_733896468910208221[172] = 0; - out_733896468910208221[173] = 0; - out_733896468910208221[174] = 0; - out_733896468910208221[175] = 0; - out_733896468910208221[176] = 0; - out_733896468910208221[177] = 0; - out_733896468910208221[178] = 0; - out_733896468910208221[179] = 0; - out_733896468910208221[180] = 0; - out_733896468910208221[181] = 0; - out_733896468910208221[182] = 0; - out_733896468910208221[183] = 0; - out_733896468910208221[184] = 0; - out_733896468910208221[185] = 0; - out_733896468910208221[186] = 0; - out_733896468910208221[187] = 0; - out_733896468910208221[188] = 0; - out_733896468910208221[189] = 0; - out_733896468910208221[190] = 1; - out_733896468910208221[191] = 0; - out_733896468910208221[192] = 0; - out_733896468910208221[193] = 0; - out_733896468910208221[194] = 0; - out_733896468910208221[195] = 0; - out_733896468910208221[196] = 0; - out_733896468910208221[197] = 0; - out_733896468910208221[198] = 0; - out_733896468910208221[199] = 0; - out_733896468910208221[200] = 0; - out_733896468910208221[201] = 0; - out_733896468910208221[202] = 0; - out_733896468910208221[203] = 0; - out_733896468910208221[204] = 0; - out_733896468910208221[205] = 0; - out_733896468910208221[206] = 0; - out_733896468910208221[207] = 0; - out_733896468910208221[208] = 0; - out_733896468910208221[209] = 1; - out_733896468910208221[210] = 0; - out_733896468910208221[211] = 0; - out_733896468910208221[212] = 0; - out_733896468910208221[213] = 0; - out_733896468910208221[214] = 0; - out_733896468910208221[215] = 0; - out_733896468910208221[216] = 0; - out_733896468910208221[217] = 0; - out_733896468910208221[218] = 0; - out_733896468910208221[219] = 0; - out_733896468910208221[220] = 0; - out_733896468910208221[221] = 0; - out_733896468910208221[222] = 0; - out_733896468910208221[223] = 0; - out_733896468910208221[224] = 0; - out_733896468910208221[225] = 0; - out_733896468910208221[226] = 0; - out_733896468910208221[227] = 0; - out_733896468910208221[228] = 1; - out_733896468910208221[229] = 0; - out_733896468910208221[230] = 0; - out_733896468910208221[231] = 0; - out_733896468910208221[232] = 0; - out_733896468910208221[233] = 0; - out_733896468910208221[234] = 0; - out_733896468910208221[235] = 0; - out_733896468910208221[236] = 0; - out_733896468910208221[237] = 0; - out_733896468910208221[238] = 0; - out_733896468910208221[239] = 0; - out_733896468910208221[240] = 0; - out_733896468910208221[241] = 0; - out_733896468910208221[242] = 0; - out_733896468910208221[243] = 0; - out_733896468910208221[244] = 0; - out_733896468910208221[245] = 0; - out_733896468910208221[246] = 0; - out_733896468910208221[247] = 1; - out_733896468910208221[248] = 0; - out_733896468910208221[249] = 0; - out_733896468910208221[250] = 0; - out_733896468910208221[251] = 0; - out_733896468910208221[252] = 0; - out_733896468910208221[253] = 0; - out_733896468910208221[254] = 0; - out_733896468910208221[255] = 0; - out_733896468910208221[256] = 0; - out_733896468910208221[257] = 0; - out_733896468910208221[258] = 0; - out_733896468910208221[259] = 0; - out_733896468910208221[260] = 0; - out_733896468910208221[261] = 0; - out_733896468910208221[262] = 0; - out_733896468910208221[263] = 0; - out_733896468910208221[264] = 0; - out_733896468910208221[265] = 0; - out_733896468910208221[266] = 1; - out_733896468910208221[267] = 0; - out_733896468910208221[268] = 0; - out_733896468910208221[269] = 0; - out_733896468910208221[270] = 0; - out_733896468910208221[271] = 0; - out_733896468910208221[272] = 0; - out_733896468910208221[273] = 0; - out_733896468910208221[274] = 0; - out_733896468910208221[275] = 0; - out_733896468910208221[276] = 0; - out_733896468910208221[277] = 0; - out_733896468910208221[278] = 0; - out_733896468910208221[279] = 0; - out_733896468910208221[280] = 0; - out_733896468910208221[281] = 0; - out_733896468910208221[282] = 0; - out_733896468910208221[283] = 0; - out_733896468910208221[284] = 0; - out_733896468910208221[285] = 1; - out_733896468910208221[286] = 0; - out_733896468910208221[287] = 0; - out_733896468910208221[288] = 0; - out_733896468910208221[289] = 0; - out_733896468910208221[290] = 0; - out_733896468910208221[291] = 0; - out_733896468910208221[292] = 0; - out_733896468910208221[293] = 0; - out_733896468910208221[294] = 0; - out_733896468910208221[295] = 0; - out_733896468910208221[296] = 0; - out_733896468910208221[297] = 0; - out_733896468910208221[298] = 0; - out_733896468910208221[299] = 0; - out_733896468910208221[300] = 0; - out_733896468910208221[301] = 0; - out_733896468910208221[302] = 0; - out_733896468910208221[303] = 0; - out_733896468910208221[304] = 1; - out_733896468910208221[305] = 0; - out_733896468910208221[306] = 0; - out_733896468910208221[307] = 0; - out_733896468910208221[308] = 0; - out_733896468910208221[309] = 0; - out_733896468910208221[310] = 0; - out_733896468910208221[311] = 0; - out_733896468910208221[312] = 0; - out_733896468910208221[313] = 0; - out_733896468910208221[314] = 0; - out_733896468910208221[315] = 0; - out_733896468910208221[316] = 0; - out_733896468910208221[317] = 0; - out_733896468910208221[318] = 0; - out_733896468910208221[319] = 0; - out_733896468910208221[320] = 0; - out_733896468910208221[321] = 0; - out_733896468910208221[322] = 0; - out_733896468910208221[323] = 1; +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 h_4(double *state, double *unused, double *out_8117165171672920878) { - out_8117165171672920878[0] = state[6] + state[9]; - out_8117165171672920878[1] = state[7] + state[10]; - out_8117165171672920878[2] = state[8] + state[11]; +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_2162528408027234243) { - out_2162528408027234243[0] = 0; - out_2162528408027234243[1] = 0; - out_2162528408027234243[2] = 0; - out_2162528408027234243[3] = 0; - out_2162528408027234243[4] = 0; - out_2162528408027234243[5] = 0; - out_2162528408027234243[6] = 1; - out_2162528408027234243[7] = 0; - out_2162528408027234243[8] = 0; - out_2162528408027234243[9] = 1; - out_2162528408027234243[10] = 0; - out_2162528408027234243[11] = 0; - out_2162528408027234243[12] = 0; - out_2162528408027234243[13] = 0; - out_2162528408027234243[14] = 0; - out_2162528408027234243[15] = 0; - out_2162528408027234243[16] = 0; - out_2162528408027234243[17] = 0; - out_2162528408027234243[18] = 0; - out_2162528408027234243[19] = 0; - out_2162528408027234243[20] = 0; - out_2162528408027234243[21] = 0; - out_2162528408027234243[22] = 0; - out_2162528408027234243[23] = 0; - out_2162528408027234243[24] = 0; - out_2162528408027234243[25] = 1; - out_2162528408027234243[26] = 0; - out_2162528408027234243[27] = 0; - out_2162528408027234243[28] = 1; - out_2162528408027234243[29] = 0; - out_2162528408027234243[30] = 0; - out_2162528408027234243[31] = 0; - out_2162528408027234243[32] = 0; - out_2162528408027234243[33] = 0; - out_2162528408027234243[34] = 0; - out_2162528408027234243[35] = 0; - out_2162528408027234243[36] = 0; - out_2162528408027234243[37] = 0; - out_2162528408027234243[38] = 0; - out_2162528408027234243[39] = 0; - out_2162528408027234243[40] = 0; - out_2162528408027234243[41] = 0; - out_2162528408027234243[42] = 0; - out_2162528408027234243[43] = 0; - out_2162528408027234243[44] = 1; - out_2162528408027234243[45] = 0; - out_2162528408027234243[46] = 0; - out_2162528408027234243[47] = 1; - out_2162528408027234243[48] = 0; - out_2162528408027234243[49] = 0; - out_2162528408027234243[50] = 0; - out_2162528408027234243[51] = 0; - out_2162528408027234243[52] = 0; - out_2162528408027234243[53] = 0; +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_10(double *state, double *unused, double *out_2185975476059121463) { - out_2185975476059121463[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; - out_2185975476059121463[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; - out_2185975476059121463[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_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_3758056759224999810) { - out_3758056759224999810[0] = 0; - out_3758056759224999810[1] = 9.8100000000000005*cos(state[1]); - out_3758056759224999810[2] = 0; - out_3758056759224999810[3] = 0; - out_3758056759224999810[4] = -state[8]; - out_3758056759224999810[5] = state[7]; - out_3758056759224999810[6] = 0; - out_3758056759224999810[7] = state[5]; - out_3758056759224999810[8] = -state[4]; - out_3758056759224999810[9] = 0; - out_3758056759224999810[10] = 0; - out_3758056759224999810[11] = 0; - out_3758056759224999810[12] = 1; - out_3758056759224999810[13] = 0; - out_3758056759224999810[14] = 0; - out_3758056759224999810[15] = 1; - out_3758056759224999810[16] = 0; - out_3758056759224999810[17] = 0; - out_3758056759224999810[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); - out_3758056759224999810[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); - out_3758056759224999810[20] = 0; - out_3758056759224999810[21] = state[8]; - out_3758056759224999810[22] = 0; - out_3758056759224999810[23] = -state[6]; - out_3758056759224999810[24] = -state[5]; - out_3758056759224999810[25] = 0; - out_3758056759224999810[26] = state[3]; - out_3758056759224999810[27] = 0; - out_3758056759224999810[28] = 0; - out_3758056759224999810[29] = 0; - out_3758056759224999810[30] = 0; - out_3758056759224999810[31] = 1; - out_3758056759224999810[32] = 0; - out_3758056759224999810[33] = 0; - out_3758056759224999810[34] = 1; - out_3758056759224999810[35] = 0; - out_3758056759224999810[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); - out_3758056759224999810[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); - out_3758056759224999810[38] = 0; - out_3758056759224999810[39] = -state[7]; - out_3758056759224999810[40] = state[6]; - out_3758056759224999810[41] = 0; - out_3758056759224999810[42] = state[4]; - out_3758056759224999810[43] = -state[3]; - out_3758056759224999810[44] = 0; - out_3758056759224999810[45] = 0; - out_3758056759224999810[46] = 0; - out_3758056759224999810[47] = 0; - out_3758056759224999810[48] = 0; - out_3758056759224999810[49] = 0; - out_3758056759224999810[50] = 1; - out_3758056759224999810[51] = 0; - out_3758056759224999810[52] = 0; - out_3758056759224999810[53] = 1; +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_13(double *state, double *unused, double *out_5359065950265790886) { - out_5359065950265790886[0] = state[3]; - out_5359065950265790886[1] = state[4]; - out_5359065950265790886[2] = state[5]; +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_1049745417305098558) { - out_1049745417305098558[0] = 0; - out_1049745417305098558[1] = 0; - out_1049745417305098558[2] = 0; - out_1049745417305098558[3] = 1; - out_1049745417305098558[4] = 0; - out_1049745417305098558[5] = 0; - out_1049745417305098558[6] = 0; - out_1049745417305098558[7] = 0; - out_1049745417305098558[8] = 0; - out_1049745417305098558[9] = 0; - out_1049745417305098558[10] = 0; - out_1049745417305098558[11] = 0; - out_1049745417305098558[12] = 0; - out_1049745417305098558[13] = 0; - out_1049745417305098558[14] = 0; - out_1049745417305098558[15] = 0; - out_1049745417305098558[16] = 0; - out_1049745417305098558[17] = 0; - out_1049745417305098558[18] = 0; - out_1049745417305098558[19] = 0; - out_1049745417305098558[20] = 0; - out_1049745417305098558[21] = 0; - out_1049745417305098558[22] = 1; - out_1049745417305098558[23] = 0; - out_1049745417305098558[24] = 0; - out_1049745417305098558[25] = 0; - out_1049745417305098558[26] = 0; - out_1049745417305098558[27] = 0; - out_1049745417305098558[28] = 0; - out_1049745417305098558[29] = 0; - out_1049745417305098558[30] = 0; - out_1049745417305098558[31] = 0; - out_1049745417305098558[32] = 0; - out_1049745417305098558[33] = 0; - out_1049745417305098558[34] = 0; - out_1049745417305098558[35] = 0; - out_1049745417305098558[36] = 0; - out_1049745417305098558[37] = 0; - out_1049745417305098558[38] = 0; - out_1049745417305098558[39] = 0; - out_1049745417305098558[40] = 0; - out_1049745417305098558[41] = 1; - out_1049745417305098558[42] = 0; - out_1049745417305098558[43] = 0; - out_1049745417305098558[44] = 0; - out_1049745417305098558[45] = 0; - out_1049745417305098558[46] = 0; - out_1049745417305098558[47] = 0; - out_1049745417305098558[48] = 0; - out_1049745417305098558[49] = 0; - out_1049745417305098558[50] = 0; - out_1049745417305098558[51] = 0; - out_1049745417305098558[52] = 0; - out_1049745417305098558[53] = 0; +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_14(double *state, double *unused, double *out_2243166911667620430) { - out_2243166911667620430[0] = state[6]; - out_2243166911667620430[1] = state[7]; - out_2243166911667620430[2] = state[8]; +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_1800712448312250286) { - out_1800712448312250286[0] = 0; - out_1800712448312250286[1] = 0; - out_1800712448312250286[2] = 0; - out_1800712448312250286[3] = 0; - out_1800712448312250286[4] = 0; - out_1800712448312250286[5] = 0; - out_1800712448312250286[6] = 1; - out_1800712448312250286[7] = 0; - out_1800712448312250286[8] = 0; - out_1800712448312250286[9] = 0; - out_1800712448312250286[10] = 0; - out_1800712448312250286[11] = 0; - out_1800712448312250286[12] = 0; - out_1800712448312250286[13] = 0; - out_1800712448312250286[14] = 0; - out_1800712448312250286[15] = 0; - out_1800712448312250286[16] = 0; - out_1800712448312250286[17] = 0; - out_1800712448312250286[18] = 0; - out_1800712448312250286[19] = 0; - out_1800712448312250286[20] = 0; - out_1800712448312250286[21] = 0; - out_1800712448312250286[22] = 0; - out_1800712448312250286[23] = 0; - out_1800712448312250286[24] = 0; - out_1800712448312250286[25] = 1; - out_1800712448312250286[26] = 0; - out_1800712448312250286[27] = 0; - out_1800712448312250286[28] = 0; - out_1800712448312250286[29] = 0; - out_1800712448312250286[30] = 0; - out_1800712448312250286[31] = 0; - out_1800712448312250286[32] = 0; - out_1800712448312250286[33] = 0; - out_1800712448312250286[34] = 0; - out_1800712448312250286[35] = 0; - out_1800712448312250286[36] = 0; - out_1800712448312250286[37] = 0; - out_1800712448312250286[38] = 0; - out_1800712448312250286[39] = 0; - out_1800712448312250286[40] = 0; - out_1800712448312250286[41] = 0; - out_1800712448312250286[42] = 0; - out_1800712448312250286[43] = 0; - out_1800712448312250286[44] = 1; - out_1800712448312250286[45] = 0; - out_1800712448312250286[46] = 0; - out_1800712448312250286[47] = 0; - out_1800712448312250286[48] = 0; - out_1800712448312250286[49] = 0; - out_1800712448312250286[50] = 0; - out_1800712448312250286[51] = 0; - out_1800712448312250286[52] = 0; - out_1800712448312250286[53] = 0; +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; } #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_7825504593440143444) { - err_fun(nom_x, delta_x, out_7825504593440143444); +void pose_err_fun(double *nom_x, double *delta_x, double *out_3009922513179117509) { + err_fun(nom_x, delta_x, out_3009922513179117509); } -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_6707226023055995729) { - inv_err_fun(nom_x, true_x, out_6707226023055995729); +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_H_mod_fun(double *state, double *out_4618881527044107692) { - H_mod_fun(state, out_4618881527044107692); +void pose_H_mod_fun(double *state, double *out_5701585413794445279) { + H_mod_fun(state, out_5701585413794445279); } -void pose_f_fun(double *state, double dt, double *out_6488051035785602820) { - f_fun(state, dt, out_6488051035785602820); +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_733896468910208221) { - F_fun(state, dt, out_733896468910208221); +void pose_F_fun(double *state, double dt, double *out_4695823766962492888) { + F_fun(state, dt, out_4695823766962492888); } -void pose_h_4(double *state, double *unused, double *out_8117165171672920878) { - h_4(state, unused, out_8117165171672920878); +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_2162528408027234243) { - H_4(state, unused, out_2162528408027234243); +void pose_H_4(double *state, double *unused, double *out_146496392957513442) { + H_4(state, unused, out_146496392957513442); } -void pose_h_10(double *state, double *unused, double *out_2185975476059121463) { - h_10(state, unused, out_2185975476059121463); +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_3758056759224999810) { - H_10(state, unused, out_3758056759224999810); +void pose_H_10(double *state, double *unused, double *out_3097566833981104856) { + H_10(state, unused, out_3097566833981104856); } -void pose_h_13(double *state, double *unused, double *out_5359065950265790886) { - h_13(state, unused, out_5359065950265790886); +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_1049745417305098558) { - H_13(state, unused, out_1049745417305098558); +void pose_H_13(double *state, double *unused, double *out_3065777432374819359) { + H_13(state, unused, out_3065777432374819359); } -void pose_h_14(double *state, double *unused, double *out_2243166911667620430) { - h_14(state, unused, out_2243166911667620430); +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_1800712448312250286) { - H_14(state, unused, out_1800712448312250286); +void pose_H_14(double *state, double *unused, double *out_3816744463381971087) { + H_14(state, unused, out_3816744463381971087); } 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 d960546b30..c63ba53c22 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_7825504593440143444); -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_6707226023055995729); -void pose_H_mod_fun(double *state, double *out_4618881527044107692); -void pose_f_fun(double *state, double dt, double *out_6488051035785602820); -void pose_F_fun(double *state, double dt, double *out_733896468910208221); -void pose_h_4(double *state, double *unused, double *out_8117165171672920878); -void pose_H_4(double *state, double *unused, double *out_2162528408027234243); -void pose_h_10(double *state, double *unused, double *out_2185975476059121463); -void pose_H_10(double *state, double *unused, double *out_3758056759224999810); -void pose_h_13(double *state, double *unused, double *out_5359065950265790886); -void pose_H_13(double *state, double *unused, double *out_1049745417305098558); -void pose_h_14(double *state, double *unused, double *out_2243166911667620430); -void pose_H_14(double *state, double *unused, double *out_1800712448312250286); +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_predict(double *in_x, double *in_P, double *in_Q, double dt); } \ No newline at end of file diff --git a/openpilot/selfdrive/pandad/pandad b/openpilot/selfdrive/pandad/pandad index 4bc7af17c7..9e1a03d988 100755 Binary files a/openpilot/selfdrive/pandad/pandad and b/openpilot/selfdrive/pandad/pandad differ diff --git a/panda/board/obj/body_h7.bin.signed b/panda/board/obj/body_h7.bin.signed index aac0a6e36e..1f394c5424 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 9e9da548c8..bbb41e6024 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 a2c80d5571..bc64625812 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 6b17a788b4..ce2dc3e973 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 7a2f1551dc..585fb61b66 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-78f3d03d-P92eb5651-DEBUG"; +const uint8_t gitversion[29] = "DEV-5ae3e638-P92eb5651-DEBUG"; diff --git a/panda/board/obj/panda.bin.signed b/panda/board/obj/panda.bin.signed index ff4c685595..080379fcf3 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 9608d9b4f0..247a6dd97a 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 2bcfc366fb..58dcc329f2 100644 --- a/panda/board/obj/version +++ b/panda/board/obj/version @@ -1 +1 @@ -DEV-78f3d03d-P92eb5651-DEBUG \ No newline at end of file +DEV-5ae3e638-P92eb5651-DEBUG \ No newline at end of file diff --git a/panda/tests/libpanda/libpanda.so b/panda/tests/libpanda/libpanda.so index 450cb216da..ecb475d0cc 100755 Binary files a/panda/tests/libpanda/libpanda.so and b/panda/tests/libpanda/libpanda.so differ diff --git a/prebuilt.json b/prebuilt.json index d0a964d726..65396730af 100644 --- a/prebuilt.json +++ b/prebuilt.json @@ -1 +1 @@ -{"protected_inventory_sha256": "584b8cd8b4b167ed95a8848e04e56223748f1f90ee06c235fbb7bacdfe67eeee", "schema_version": 1} +{"protected_inventory_sha256": "0e6cd9a94340b868348fec46de506788a0b56e7811b0dfb6f6b707eb2a312fae", "schema_version": 1}