From da1820b7db1bc961175543b8478614eb26efb812 Mon Sep 17 00:00:00 2001 From: firestar5683 <168790843+firestar5683@users.noreply.github.com> Date: Sun, 4 Oct 2026 19:01:23 -0500 Subject: [PATCH] Build --- .../locationd/models/generated/car.cpp | 684 +++--- .../locationd/models/generated/car.h | 42 +- .../locationd/models/generated/libcar.so | Bin 24120528 -> 24120520 bytes .../locationd/models/generated/libpose.so | Bin 20605632 -> 20605632 bytes .../locationd/models/generated/pose.cpp | 1938 ++++++++--------- .../locationd/models/generated/pose.h | 26 +- panda/board/obj/body_h7.bin.signed | Bin 181572 -> 181572 bytes panda/board/obj/bootstub.body_h7.bin | Bin 12128 -> 12128 bytes panda/board/obj/bootstub.panda.bin | Bin 11112 -> 11112 bytes panda/board/obj/bootstub.panda_h7.bin | Bin 18952 -> 18952 bytes panda/board/obj/gitversion.h | 2 +- panda/board/obj/panda.bin.signed | Bin 172336 -> 172336 bytes panda/board/obj/panda_h7.bin.signed | Bin 182280 -> 182280 bytes panda/board/obj/version | 2 +- prebuilt.json | 2 +- 15 files changed, 1348 insertions(+), 1348 deletions(-) diff --git a/openpilot/selfdrive/locationd/models/generated/car.cpp b/openpilot/selfdrive/locationd/models/generated/car.cpp index 01245b208c..a74e703482 100644 --- a/openpilot/selfdrive/locationd/models/generated/car.cpp +++ b/openpilot/selfdrive/locationd/models/generated/car.cpp @@ -45,326 +45,326 @@ const static double MAHA_THRESH_31 = 3.8414588206941227; * * * This file is part of 'ekf' * ******************************************************************************/ -void err_fun(double *nom_x, double *delta_x, double *out_6338568395475486083) { - out_6338568395475486083[0] = delta_x[0] + nom_x[0]; - out_6338568395475486083[1] = delta_x[1] + nom_x[1]; - out_6338568395475486083[2] = delta_x[2] + nom_x[2]; - out_6338568395475486083[3] = delta_x[3] + nom_x[3]; - out_6338568395475486083[4] = delta_x[4] + nom_x[4]; - out_6338568395475486083[5] = delta_x[5] + nom_x[5]; - out_6338568395475486083[6] = delta_x[6] + nom_x[6]; - out_6338568395475486083[7] = delta_x[7] + nom_x[7]; - out_6338568395475486083[8] = delta_x[8] + nom_x[8]; +void err_fun(double *nom_x, double *delta_x, double *out_408914854931955974) { + out_408914854931955974[0] = delta_x[0] + nom_x[0]; + out_408914854931955974[1] = delta_x[1] + nom_x[1]; + out_408914854931955974[2] = delta_x[2] + nom_x[2]; + out_408914854931955974[3] = delta_x[3] + nom_x[3]; + out_408914854931955974[4] = delta_x[4] + nom_x[4]; + out_408914854931955974[5] = delta_x[5] + nom_x[5]; + out_408914854931955974[6] = delta_x[6] + nom_x[6]; + out_408914854931955974[7] = delta_x[7] + nom_x[7]; + out_408914854931955974[8] = delta_x[8] + nom_x[8]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_5410100343915451790) { - out_5410100343915451790[0] = -nom_x[0] + true_x[0]; - out_5410100343915451790[1] = -nom_x[1] + true_x[1]; - out_5410100343915451790[2] = -nom_x[2] + true_x[2]; - out_5410100343915451790[3] = -nom_x[3] + true_x[3]; - out_5410100343915451790[4] = -nom_x[4] + true_x[4]; - out_5410100343915451790[5] = -nom_x[5] + true_x[5]; - out_5410100343915451790[6] = -nom_x[6] + true_x[6]; - out_5410100343915451790[7] = -nom_x[7] + true_x[7]; - out_5410100343915451790[8] = -nom_x[8] + true_x[8]; +void inv_err_fun(double *nom_x, double *true_x, double *out_177131998479136517) { + out_177131998479136517[0] = -nom_x[0] + true_x[0]; + out_177131998479136517[1] = -nom_x[1] + true_x[1]; + out_177131998479136517[2] = -nom_x[2] + true_x[2]; + out_177131998479136517[3] = -nom_x[3] + true_x[3]; + out_177131998479136517[4] = -nom_x[4] + true_x[4]; + out_177131998479136517[5] = -nom_x[5] + true_x[5]; + out_177131998479136517[6] = -nom_x[6] + true_x[6]; + out_177131998479136517[7] = -nom_x[7] + true_x[7]; + out_177131998479136517[8] = -nom_x[8] + true_x[8]; } -void H_mod_fun(double *state, double *out_823602999692946123) { - out_823602999692946123[0] = 1.0; - out_823602999692946123[1] = 0.0; - out_823602999692946123[2] = 0.0; - out_823602999692946123[3] = 0.0; - out_823602999692946123[4] = 0.0; - out_823602999692946123[5] = 0.0; - out_823602999692946123[6] = 0.0; - out_823602999692946123[7] = 0.0; - out_823602999692946123[8] = 0.0; - out_823602999692946123[9] = 0.0; - out_823602999692946123[10] = 1.0; - out_823602999692946123[11] = 0.0; - out_823602999692946123[12] = 0.0; - out_823602999692946123[13] = 0.0; - out_823602999692946123[14] = 0.0; - out_823602999692946123[15] = 0.0; - out_823602999692946123[16] = 0.0; - out_823602999692946123[17] = 0.0; - out_823602999692946123[18] = 0.0; - out_823602999692946123[19] = 0.0; - out_823602999692946123[20] = 1.0; - out_823602999692946123[21] = 0.0; - out_823602999692946123[22] = 0.0; - out_823602999692946123[23] = 0.0; - out_823602999692946123[24] = 0.0; - out_823602999692946123[25] = 0.0; - out_823602999692946123[26] = 0.0; - out_823602999692946123[27] = 0.0; - out_823602999692946123[28] = 0.0; - out_823602999692946123[29] = 0.0; - out_823602999692946123[30] = 1.0; - out_823602999692946123[31] = 0.0; - out_823602999692946123[32] = 0.0; - out_823602999692946123[33] = 0.0; - out_823602999692946123[34] = 0.0; - out_823602999692946123[35] = 0.0; - out_823602999692946123[36] = 0.0; - out_823602999692946123[37] = 0.0; - out_823602999692946123[38] = 0.0; - out_823602999692946123[39] = 0.0; - out_823602999692946123[40] = 1.0; - out_823602999692946123[41] = 0.0; - out_823602999692946123[42] = 0.0; - out_823602999692946123[43] = 0.0; - out_823602999692946123[44] = 0.0; - out_823602999692946123[45] = 0.0; - out_823602999692946123[46] = 0.0; - out_823602999692946123[47] = 0.0; - out_823602999692946123[48] = 0.0; - out_823602999692946123[49] = 0.0; - out_823602999692946123[50] = 1.0; - out_823602999692946123[51] = 0.0; - out_823602999692946123[52] = 0.0; - out_823602999692946123[53] = 0.0; - out_823602999692946123[54] = 0.0; - out_823602999692946123[55] = 0.0; - out_823602999692946123[56] = 0.0; - out_823602999692946123[57] = 0.0; - out_823602999692946123[58] = 0.0; - out_823602999692946123[59] = 0.0; - out_823602999692946123[60] = 1.0; - out_823602999692946123[61] = 0.0; - out_823602999692946123[62] = 0.0; - out_823602999692946123[63] = 0.0; - out_823602999692946123[64] = 0.0; - out_823602999692946123[65] = 0.0; - out_823602999692946123[66] = 0.0; - out_823602999692946123[67] = 0.0; - out_823602999692946123[68] = 0.0; - out_823602999692946123[69] = 0.0; - out_823602999692946123[70] = 1.0; - out_823602999692946123[71] = 0.0; - out_823602999692946123[72] = 0.0; - out_823602999692946123[73] = 0.0; - out_823602999692946123[74] = 0.0; - out_823602999692946123[75] = 0.0; - out_823602999692946123[76] = 0.0; - out_823602999692946123[77] = 0.0; - out_823602999692946123[78] = 0.0; - out_823602999692946123[79] = 0.0; - out_823602999692946123[80] = 1.0; +void H_mod_fun(double *state, double *out_612188567970168411) { + out_612188567970168411[0] = 1.0; + out_612188567970168411[1] = 0.0; + out_612188567970168411[2] = 0.0; + out_612188567970168411[3] = 0.0; + out_612188567970168411[4] = 0.0; + out_612188567970168411[5] = 0.0; + out_612188567970168411[6] = 0.0; + out_612188567970168411[7] = 0.0; + out_612188567970168411[8] = 0.0; + out_612188567970168411[9] = 0.0; + out_612188567970168411[10] = 1.0; + out_612188567970168411[11] = 0.0; + out_612188567970168411[12] = 0.0; + out_612188567970168411[13] = 0.0; + out_612188567970168411[14] = 0.0; + out_612188567970168411[15] = 0.0; + out_612188567970168411[16] = 0.0; + out_612188567970168411[17] = 0.0; + out_612188567970168411[18] = 0.0; + out_612188567970168411[19] = 0.0; + out_612188567970168411[20] = 1.0; + out_612188567970168411[21] = 0.0; + out_612188567970168411[22] = 0.0; + out_612188567970168411[23] = 0.0; + out_612188567970168411[24] = 0.0; + out_612188567970168411[25] = 0.0; + out_612188567970168411[26] = 0.0; + out_612188567970168411[27] = 0.0; + out_612188567970168411[28] = 0.0; + out_612188567970168411[29] = 0.0; + out_612188567970168411[30] = 1.0; + out_612188567970168411[31] = 0.0; + out_612188567970168411[32] = 0.0; + out_612188567970168411[33] = 0.0; + out_612188567970168411[34] = 0.0; + out_612188567970168411[35] = 0.0; + out_612188567970168411[36] = 0.0; + out_612188567970168411[37] = 0.0; + out_612188567970168411[38] = 0.0; + out_612188567970168411[39] = 0.0; + out_612188567970168411[40] = 1.0; + out_612188567970168411[41] = 0.0; + out_612188567970168411[42] = 0.0; + out_612188567970168411[43] = 0.0; + out_612188567970168411[44] = 0.0; + out_612188567970168411[45] = 0.0; + out_612188567970168411[46] = 0.0; + out_612188567970168411[47] = 0.0; + out_612188567970168411[48] = 0.0; + out_612188567970168411[49] = 0.0; + out_612188567970168411[50] = 1.0; + out_612188567970168411[51] = 0.0; + out_612188567970168411[52] = 0.0; + out_612188567970168411[53] = 0.0; + out_612188567970168411[54] = 0.0; + out_612188567970168411[55] = 0.0; + out_612188567970168411[56] = 0.0; + out_612188567970168411[57] = 0.0; + out_612188567970168411[58] = 0.0; + out_612188567970168411[59] = 0.0; + out_612188567970168411[60] = 1.0; + out_612188567970168411[61] = 0.0; + out_612188567970168411[62] = 0.0; + out_612188567970168411[63] = 0.0; + out_612188567970168411[64] = 0.0; + out_612188567970168411[65] = 0.0; + out_612188567970168411[66] = 0.0; + out_612188567970168411[67] = 0.0; + out_612188567970168411[68] = 0.0; + out_612188567970168411[69] = 0.0; + out_612188567970168411[70] = 1.0; + out_612188567970168411[71] = 0.0; + out_612188567970168411[72] = 0.0; + out_612188567970168411[73] = 0.0; + out_612188567970168411[74] = 0.0; + out_612188567970168411[75] = 0.0; + out_612188567970168411[76] = 0.0; + out_612188567970168411[77] = 0.0; + out_612188567970168411[78] = 0.0; + out_612188567970168411[79] = 0.0; + out_612188567970168411[80] = 1.0; } -void f_fun(double *state, double dt, double *out_5252072111533144957) { - out_5252072111533144957[0] = state[0]; - out_5252072111533144957[1] = state[1]; - out_5252072111533144957[2] = state[2]; - out_5252072111533144957[3] = state[3]; - out_5252072111533144957[4] = state[4]; - out_5252072111533144957[5] = dt*((-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]))*state[6] - 9.8100000000000005*state[8] + stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*state[1]) + (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*state[4])) + state[5]; - out_5252072111533144957[6] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*state[4])) + state[6]; - out_5252072111533144957[7] = state[7]; - out_5252072111533144957[8] = state[8]; +void f_fun(double *state, double dt, double *out_1999864885543950499) { + out_1999864885543950499[0] = state[0]; + out_1999864885543950499[1] = state[1]; + out_1999864885543950499[2] = state[2]; + out_1999864885543950499[3] = state[3]; + out_1999864885543950499[4] = state[4]; + out_1999864885543950499[5] = dt*((-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]))*state[6] - 9.8100000000000005*state[8] + stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*state[1]) + (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*state[4])) + state[5]; + out_1999864885543950499[6] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*state[4])) + state[6]; + out_1999864885543950499[7] = state[7]; + out_1999864885543950499[8] = state[8]; } -void F_fun(double *state, double dt, double *out_5472890640690018040) { - out_5472890640690018040[0] = 1; - out_5472890640690018040[1] = 0; - out_5472890640690018040[2] = 0; - out_5472890640690018040[3] = 0; - out_5472890640690018040[4] = 0; - out_5472890640690018040[5] = 0; - out_5472890640690018040[6] = 0; - out_5472890640690018040[7] = 0; - out_5472890640690018040[8] = 0; - out_5472890640690018040[9] = 0; - out_5472890640690018040[10] = 1; - out_5472890640690018040[11] = 0; - out_5472890640690018040[12] = 0; - out_5472890640690018040[13] = 0; - out_5472890640690018040[14] = 0; - out_5472890640690018040[15] = 0; - out_5472890640690018040[16] = 0; - out_5472890640690018040[17] = 0; - out_5472890640690018040[18] = 0; - out_5472890640690018040[19] = 0; - out_5472890640690018040[20] = 1; - out_5472890640690018040[21] = 0; - out_5472890640690018040[22] = 0; - out_5472890640690018040[23] = 0; - out_5472890640690018040[24] = 0; - out_5472890640690018040[25] = 0; - out_5472890640690018040[26] = 0; - out_5472890640690018040[27] = 0; - out_5472890640690018040[28] = 0; - out_5472890640690018040[29] = 0; - out_5472890640690018040[30] = 1; - out_5472890640690018040[31] = 0; - out_5472890640690018040[32] = 0; - out_5472890640690018040[33] = 0; - out_5472890640690018040[34] = 0; - out_5472890640690018040[35] = 0; - out_5472890640690018040[36] = 0; - out_5472890640690018040[37] = 0; - out_5472890640690018040[38] = 0; - out_5472890640690018040[39] = 0; - out_5472890640690018040[40] = 1; - out_5472890640690018040[41] = 0; - out_5472890640690018040[42] = 0; - out_5472890640690018040[43] = 0; - out_5472890640690018040[44] = 0; - out_5472890640690018040[45] = dt*(stiffness_front*(-state[2] - state[3] + state[7])/(mass*state[1]) + (-stiffness_front - stiffness_rear)*state[5]/(mass*state[4]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[6]/(mass*state[4])); - out_5472890640690018040[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); - out_5472890640690018040[47] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_5472890640690018040[48] = -dt*stiffness_front*state[0]/(mass*state[1]); - out_5472890640690018040[49] = dt*((-1 - (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*pow(state[4], 2)))*state[6] - (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*pow(state[4], 2))); - out_5472890640690018040[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; - out_5472890640690018040[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); - out_5472890640690018040[52] = dt*stiffness_front*state[0]/(mass*state[1]); - out_5472890640690018040[53] = -9.8100000000000005*dt; - out_5472890640690018040[54] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front - pow(center_to_rear, 2)*stiffness_rear)*state[6]/(rotational_inertia*state[4])); - out_5472890640690018040[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); - out_5472890640690018040[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_5472890640690018040[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_5472890640690018040[58] = dt*(-(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*pow(state[4], 2)) - (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*pow(state[4], 2))); - out_5472890640690018040[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); - out_5472890640690018040[60] = dt*(-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])/(rotational_inertia*state[4]) + 1; - out_5472890640690018040[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); - out_5472890640690018040[62] = 0; - out_5472890640690018040[63] = 0; - out_5472890640690018040[64] = 0; - out_5472890640690018040[65] = 0; - out_5472890640690018040[66] = 0; - out_5472890640690018040[67] = 0; - out_5472890640690018040[68] = 0; - out_5472890640690018040[69] = 0; - out_5472890640690018040[70] = 1; - out_5472890640690018040[71] = 0; - out_5472890640690018040[72] = 0; - out_5472890640690018040[73] = 0; - out_5472890640690018040[74] = 0; - out_5472890640690018040[75] = 0; - out_5472890640690018040[76] = 0; - out_5472890640690018040[77] = 0; - out_5472890640690018040[78] = 0; - out_5472890640690018040[79] = 0; - out_5472890640690018040[80] = 1; +void F_fun(double *state, double dt, double *out_3889473353313594997) { + out_3889473353313594997[0] = 1; + out_3889473353313594997[1] = 0; + out_3889473353313594997[2] = 0; + out_3889473353313594997[3] = 0; + out_3889473353313594997[4] = 0; + out_3889473353313594997[5] = 0; + out_3889473353313594997[6] = 0; + out_3889473353313594997[7] = 0; + out_3889473353313594997[8] = 0; + out_3889473353313594997[9] = 0; + out_3889473353313594997[10] = 1; + out_3889473353313594997[11] = 0; + out_3889473353313594997[12] = 0; + out_3889473353313594997[13] = 0; + out_3889473353313594997[14] = 0; + out_3889473353313594997[15] = 0; + out_3889473353313594997[16] = 0; + out_3889473353313594997[17] = 0; + out_3889473353313594997[18] = 0; + out_3889473353313594997[19] = 0; + out_3889473353313594997[20] = 1; + out_3889473353313594997[21] = 0; + out_3889473353313594997[22] = 0; + out_3889473353313594997[23] = 0; + out_3889473353313594997[24] = 0; + out_3889473353313594997[25] = 0; + out_3889473353313594997[26] = 0; + out_3889473353313594997[27] = 0; + out_3889473353313594997[28] = 0; + out_3889473353313594997[29] = 0; + out_3889473353313594997[30] = 1; + out_3889473353313594997[31] = 0; + out_3889473353313594997[32] = 0; + out_3889473353313594997[33] = 0; + out_3889473353313594997[34] = 0; + out_3889473353313594997[35] = 0; + out_3889473353313594997[36] = 0; + out_3889473353313594997[37] = 0; + out_3889473353313594997[38] = 0; + out_3889473353313594997[39] = 0; + out_3889473353313594997[40] = 1; + out_3889473353313594997[41] = 0; + out_3889473353313594997[42] = 0; + out_3889473353313594997[43] = 0; + out_3889473353313594997[44] = 0; + out_3889473353313594997[45] = dt*(stiffness_front*(-state[2] - state[3] + state[7])/(mass*state[1]) + (-stiffness_front - stiffness_rear)*state[5]/(mass*state[4]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[6]/(mass*state[4])); + out_3889473353313594997[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2)); + out_3889473353313594997[47] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_3889473353313594997[48] = -dt*stiffness_front*state[0]/(mass*state[1]); + out_3889473353313594997[49] = dt*((-1 - (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*pow(state[4], 2)))*state[6] - (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*pow(state[4], 2))); + out_3889473353313594997[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1; + out_3889473353313594997[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4])); + out_3889473353313594997[52] = dt*stiffness_front*state[0]/(mass*state[1]); + out_3889473353313594997[53] = -9.8100000000000005*dt; + out_3889473353313594997[54] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front - pow(center_to_rear, 2)*stiffness_rear)*state[6]/(rotational_inertia*state[4])); + out_3889473353313594997[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2)); + out_3889473353313594997[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_3889473353313594997[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_3889473353313594997[58] = dt*(-(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*pow(state[4], 2)) - (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*pow(state[4], 2))); + out_3889473353313594997[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]); + out_3889473353313594997[60] = dt*(-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])/(rotational_inertia*state[4]) + 1; + out_3889473353313594997[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]); + out_3889473353313594997[62] = 0; + out_3889473353313594997[63] = 0; + out_3889473353313594997[64] = 0; + out_3889473353313594997[65] = 0; + out_3889473353313594997[66] = 0; + out_3889473353313594997[67] = 0; + out_3889473353313594997[68] = 0; + out_3889473353313594997[69] = 0; + out_3889473353313594997[70] = 1; + out_3889473353313594997[71] = 0; + out_3889473353313594997[72] = 0; + out_3889473353313594997[73] = 0; + out_3889473353313594997[74] = 0; + out_3889473353313594997[75] = 0; + out_3889473353313594997[76] = 0; + out_3889473353313594997[77] = 0; + out_3889473353313594997[78] = 0; + out_3889473353313594997[79] = 0; + out_3889473353313594997[80] = 1; } -void h_25(double *state, double *unused, double *out_8566352363547608598) { - out_8566352363547608598[0] = state[6]; +void h_25(double *state, double *unused, double *out_4691870608107024689) { + out_4691870608107024689[0] = state[6]; } -void H_25(double *state, double *unused, double *out_5673419960197083828) { - out_5673419960197083828[0] = 0; - out_5673419960197083828[1] = 0; - out_5673419960197083828[2] = 0; - out_5673419960197083828[3] = 0; - out_5673419960197083828[4] = 0; - out_5673419960197083828[5] = 0; - out_5673419960197083828[6] = 1; - out_5673419960197083828[7] = 0; - out_5673419960197083828[8] = 0; +void H_25(double *state, double *unused, double *out_4135237206615533559) { + out_4135237206615533559[0] = 0; + out_4135237206615533559[1] = 0; + out_4135237206615533559[2] = 0; + out_4135237206615533559[3] = 0; + out_4135237206615533559[4] = 0; + out_4135237206615533559[5] = 0; + out_4135237206615533559[6] = 1; + out_4135237206615533559[7] = 0; + out_4135237206615533559[8] = 0; } -void h_24(double *state, double *unused, double *out_1105741821560728000) { - out_1105741821560728000[0] = state[4]; - out_1105741821560728000[1] = state[5]; +void h_24(double *state, double *unused, double *out_7256933575834984536) { + out_7256933575834984536[0] = state[4]; + out_7256933575834984536[1] = state[5]; } -void H_24(double *state, double *unused, double *out_5330649520523751468) { - out_5330649520523751468[0] = 0; - out_5330649520523751468[1] = 0; - out_5330649520523751468[2] = 0; - out_5330649520523751468[3] = 0; - out_5330649520523751468[4] = 1; - out_5330649520523751468[5] = 0; - out_5330649520523751468[6] = 0; - out_5330649520523751468[7] = 0; - out_5330649520523751468[8] = 0; - out_5330649520523751468[9] = 0; - out_5330649520523751468[10] = 0; - out_5330649520523751468[11] = 0; - out_5330649520523751468[12] = 0; - out_5330649520523751468[13] = 0; - out_5330649520523751468[14] = 1; - out_5330649520523751468[15] = 0; - out_5330649520523751468[16] = 0; - out_5330649520523751468[17] = 0; +void H_24(double *state, double *unused, double *out_3151171335774219891) { + out_3151171335774219891[0] = 0; + out_3151171335774219891[1] = 0; + out_3151171335774219891[2] = 0; + out_3151171335774219891[3] = 0; + out_3151171335774219891[4] = 1; + out_3151171335774219891[5] = 0; + out_3151171335774219891[6] = 0; + out_3151171335774219891[7] = 0; + out_3151171335774219891[8] = 0; + out_3151171335774219891[9] = 0; + out_3151171335774219891[10] = 0; + out_3151171335774219891[11] = 0; + out_3151171335774219891[12] = 0; + out_3151171335774219891[13] = 0; + out_3151171335774219891[14] = 1; + out_3151171335774219891[15] = 0; + out_3151171335774219891[16] = 0; + out_3151171335774219891[17] = 0; } -void h_30(double *state, double *unused, double *out_2652619336876860225) { - out_2652619336876860225[0] = state[4]; +void h_30(double *state, double *unused, double *out_6984038239252175991) { + out_6984038239252175991[0] = state[4]; } -void H_30(double *state, double *unused, double *out_8245627783384859590) { - out_8245627783384859590[0] = 0; - out_8245627783384859590[1] = 0; - out_8245627783384859590[2] = 0; - out_8245627783384859590[3] = 0; - out_8245627783384859590[4] = 1; - out_8245627783384859590[5] = 0; - out_8245627783384859590[6] = 0; - out_8245627783384859590[7] = 0; - out_8245627783384859590[8] = 0; +void H_30(double *state, double *unused, double *out_2781453134876083196) { + out_2781453134876083196[0] = 0; + out_2781453134876083196[1] = 0; + out_2781453134876083196[2] = 0; + out_2781453134876083196[3] = 0; + out_2781453134876083196[4] = 1; + out_2781453134876083196[5] = 0; + out_2781453134876083196[6] = 0; + out_2781453134876083196[7] = 0; + out_2781453134876083196[8] = 0; } -void h_26(double *state, double *unused, double *out_1745332744404768787) { - out_1745332744404768787[0] = state[7]; +void h_26(double *state, double *unused, double *out_8151782040328317728) { + out_8151782040328317728[0] = state[7]; } -void H_26(double *state, double *unused, double *out_9031820794638411564) { - out_9031820794638411564[0] = 0; - out_9031820794638411564[1] = 0; - out_9031820794638411564[2] = 0; - out_9031820794638411564[3] = 0; - out_9031820794638411564[4] = 0; - out_9031820794638411564[5] = 0; - out_9031820794638411564[6] = 0; - out_9031820794638411564[7] = 1; - out_9031820794638411564[8] = 0; +void H_26(double *state, double *unused, double *out_830711236854732958) { + out_830711236854732958[0] = 0; + out_830711236854732958[1] = 0; + out_830711236854732958[2] = 0; + out_830711236854732958[3] = 0; + out_830711236854732958[4] = 0; + out_830711236854732958[5] = 0; + out_830711236854732958[6] = 0; + out_830711236854732958[7] = 1; + out_830711236854732958[8] = 0; } -void h_27(double *state, double *unused, double *out_4878718442501097373) { - out_4878718442501097373[0] = state[3]; +void h_27(double *state, double *unused, double *out_6382318442842705649) { + out_6382318442842705649[0] = state[3]; } -void H_27(double *state, double *unused, double *out_7977522219140748809) { - out_7977522219140748809[0] = 0; - out_7977522219140748809[1] = 0; - out_7977522219140748809[2] = 0; - out_7977522219140748809[3] = 1; - out_7977522219140748809[4] = 0; - out_7977522219140748809[5] = 0; - out_7977522219140748809[6] = 0; - out_7977522219140748809[7] = 0; - out_7977522219140748809[8] = 0; +void H_27(double *state, double *unused, double *out_606689823075658285) { + out_606689823075658285[0] = 0; + out_606689823075658285[1] = 0; + out_606689823075658285[2] = 0; + out_606689823075658285[3] = 1; + out_606689823075658285[4] = 0; + out_606689823075658285[5] = 0; + out_606689823075658285[6] = 0; + out_606689823075658285[7] = 0; + out_606689823075658285[8] = 0; } -void h_29(double *state, double *unused, double *out_1709109483975197790) { - out_1709109483975197790[0] = state[1]; +void h_29(double *state, double *unused, double *out_205509483633589514) { + out_205509483633589514[0] = state[1]; } -void H_29(double *state, double *unused, double *out_8755859127699251774) { - out_8755859127699251774[0] = 0; - out_8755859127699251774[1] = 1; - out_8755859127699251774[2] = 0; - out_8755859127699251774[3] = 0; - out_8755859127699251774[4] = 0; - out_8755859127699251774[5] = 0; - out_8755859127699251774[6] = 0; - out_8755859127699251774[7] = 0; - out_8755859127699251774[8] = 0; +void H_29(double *state, double *unused, double *out_3291684479190475380) { + out_3291684479190475380[0] = 0; + out_3291684479190475380[1] = 1; + out_3291684479190475380[2] = 0; + out_3291684479190475380[3] = 0; + out_3291684479190475380[4] = 0; + out_3291684479190475380[5] = 0; + out_3291684479190475380[6] = 0; + out_3291684479190475380[7] = 0; + out_3291684479190475380[8] = 0; } -void h_28(double *state, double *unused, double *out_2770626730810236969) { - out_2770626730810236969[0] = state[0]; +void h_28(double *state, double *unused, double *out_1380645175181860004) { + out_1380645175181860004[0] = state[0]; } -void H_28(double *state, double *unused, double *out_3673460110629721200) { - out_3673460110629721200[0] = 1; - out_3673460110629721200[1] = 0; - out_3673460110629721200[2] = 0; - out_3673460110629721200[3] = 0; - out_3673460110629721200[4] = 0; - out_3673460110629721200[5] = 0; - out_3673460110629721200[6] = 0; - out_3673460110629721200[7] = 0; - out_3673460110629721200[8] = 0; +void H_28(double *state, double *unused, double *out_1790714537879055194) { + out_1790714537879055194[0] = 1; + out_1790714537879055194[1] = 0; + out_1790714537879055194[2] = 0; + out_1790714537879055194[3] = 0; + out_1790714537879055194[4] = 0; + out_1790714537879055194[5] = 0; + out_1790714537879055194[6] = 0; + out_1790714537879055194[7] = 0; + out_1790714537879055194[8] = 0; } -void h_31(double *state, double *unused, double *out_4928902835293586248) { - out_4928902835293586248[0] = state[8]; +void h_31(double *state, double *unused, double *out_4534683939755895544) { + out_4534683939755895544[0] = state[8]; } -void H_31(double *state, double *unused, double *out_5642773998320123400) { - out_5642773998320123400[0] = 0; - out_5642773998320123400[1] = 0; - out_5642773998320123400[2] = 0; - out_5642773998320123400[3] = 0; - out_5642773998320123400[4] = 0; - out_5642773998320123400[5] = 0; - out_5642773998320123400[6] = 0; - out_5642773998320123400[7] = 0; - out_5642773998320123400[8] = 1; +void H_31(double *state, double *unused, double *out_4104591244738573131) { + out_4104591244738573131[0] = 0; + out_4104591244738573131[1] = 0; + out_4104591244738573131[2] = 0; + out_4104591244738573131[3] = 0; + out_4104591244738573131[4] = 0; + out_4104591244738573131[5] = 0; + out_4104591244738573131[6] = 0; + out_4104591244738573131[7] = 0; + out_4104591244738573131[8] = 1; } #include #include @@ -518,68 +518,68 @@ void car_update_28(double *in_x, double *in_P, double *in_z, double *in_R, doubl void car_update_31(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea) { update<1, 3, 0>(in_x, in_P, h_31, H_31, NULL, in_z, in_R, in_ea, MAHA_THRESH_31); } -void car_err_fun(double *nom_x, double *delta_x, double *out_6338568395475486083) { - err_fun(nom_x, delta_x, out_6338568395475486083); +void car_err_fun(double *nom_x, double *delta_x, double *out_408914854931955974) { + err_fun(nom_x, delta_x, out_408914854931955974); } -void car_inv_err_fun(double *nom_x, double *true_x, double *out_5410100343915451790) { - inv_err_fun(nom_x, true_x, out_5410100343915451790); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_177131998479136517) { + inv_err_fun(nom_x, true_x, out_177131998479136517); } -void car_H_mod_fun(double *state, double *out_823602999692946123) { - H_mod_fun(state, out_823602999692946123); +void car_H_mod_fun(double *state, double *out_612188567970168411) { + H_mod_fun(state, out_612188567970168411); } -void car_f_fun(double *state, double dt, double *out_5252072111533144957) { - f_fun(state, dt, out_5252072111533144957); +void car_f_fun(double *state, double dt, double *out_1999864885543950499) { + f_fun(state, dt, out_1999864885543950499); } -void car_F_fun(double *state, double dt, double *out_5472890640690018040) { - F_fun(state, dt, out_5472890640690018040); +void car_F_fun(double *state, double dt, double *out_3889473353313594997) { + F_fun(state, dt, out_3889473353313594997); } -void car_h_25(double *state, double *unused, double *out_8566352363547608598) { - h_25(state, unused, out_8566352363547608598); +void car_h_25(double *state, double *unused, double *out_4691870608107024689) { + h_25(state, unused, out_4691870608107024689); } -void car_H_25(double *state, double *unused, double *out_5673419960197083828) { - H_25(state, unused, out_5673419960197083828); +void car_H_25(double *state, double *unused, double *out_4135237206615533559) { + H_25(state, unused, out_4135237206615533559); } -void car_h_24(double *state, double *unused, double *out_1105741821560728000) { - h_24(state, unused, out_1105741821560728000); +void car_h_24(double *state, double *unused, double *out_7256933575834984536) { + h_24(state, unused, out_7256933575834984536); } -void car_H_24(double *state, double *unused, double *out_5330649520523751468) { - H_24(state, unused, out_5330649520523751468); +void car_H_24(double *state, double *unused, double *out_3151171335774219891) { + H_24(state, unused, out_3151171335774219891); } -void car_h_30(double *state, double *unused, double *out_2652619336876860225) { - h_30(state, unused, out_2652619336876860225); +void car_h_30(double *state, double *unused, double *out_6984038239252175991) { + h_30(state, unused, out_6984038239252175991); } -void car_H_30(double *state, double *unused, double *out_8245627783384859590) { - H_30(state, unused, out_8245627783384859590); +void car_H_30(double *state, double *unused, double *out_2781453134876083196) { + H_30(state, unused, out_2781453134876083196); } -void car_h_26(double *state, double *unused, double *out_1745332744404768787) { - h_26(state, unused, out_1745332744404768787); +void car_h_26(double *state, double *unused, double *out_8151782040328317728) { + h_26(state, unused, out_8151782040328317728); } -void car_H_26(double *state, double *unused, double *out_9031820794638411564) { - H_26(state, unused, out_9031820794638411564); +void car_H_26(double *state, double *unused, double *out_830711236854732958) { + H_26(state, unused, out_830711236854732958); } -void car_h_27(double *state, double *unused, double *out_4878718442501097373) { - h_27(state, unused, out_4878718442501097373); +void car_h_27(double *state, double *unused, double *out_6382318442842705649) { + h_27(state, unused, out_6382318442842705649); } -void car_H_27(double *state, double *unused, double *out_7977522219140748809) { - H_27(state, unused, out_7977522219140748809); +void car_H_27(double *state, double *unused, double *out_606689823075658285) { + H_27(state, unused, out_606689823075658285); } -void car_h_29(double *state, double *unused, double *out_1709109483975197790) { - h_29(state, unused, out_1709109483975197790); +void car_h_29(double *state, double *unused, double *out_205509483633589514) { + h_29(state, unused, out_205509483633589514); } -void car_H_29(double *state, double *unused, double *out_8755859127699251774) { - H_29(state, unused, out_8755859127699251774); +void car_H_29(double *state, double *unused, double *out_3291684479190475380) { + H_29(state, unused, out_3291684479190475380); } -void car_h_28(double *state, double *unused, double *out_2770626730810236969) { - h_28(state, unused, out_2770626730810236969); +void car_h_28(double *state, double *unused, double *out_1380645175181860004) { + h_28(state, unused, out_1380645175181860004); } -void car_H_28(double *state, double *unused, double *out_3673460110629721200) { - H_28(state, unused, out_3673460110629721200); +void car_H_28(double *state, double *unused, double *out_1790714537879055194) { + H_28(state, unused, out_1790714537879055194); } -void car_h_31(double *state, double *unused, double *out_4928902835293586248) { - h_31(state, unused, out_4928902835293586248); +void car_h_31(double *state, double *unused, double *out_4534683939755895544) { + h_31(state, unused, out_4534683939755895544); } -void car_H_31(double *state, double *unused, double *out_5642773998320123400) { - H_31(state, unused, out_5642773998320123400); +void car_H_31(double *state, double *unused, double *out_4104591244738573131) { + H_31(state, unused, out_4104591244738573131); } void car_predict(double *in_x, double *in_P, double *in_Q, double dt) { predict(in_x, in_P, in_Q, dt); diff --git a/openpilot/selfdrive/locationd/models/generated/car.h b/openpilot/selfdrive/locationd/models/generated/car.h index e71be460b2..fe6e10607f 100644 --- a/openpilot/selfdrive/locationd/models/generated/car.h +++ b/openpilot/selfdrive/locationd/models/generated/car.h @@ -9,27 +9,27 @@ void car_update_27(double *in_x, double *in_P, double *in_z, double *in_R, doubl void car_update_29(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); void car_update_28(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); void car_update_31(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); -void car_err_fun(double *nom_x, double *delta_x, double *out_6338568395475486083); -void car_inv_err_fun(double *nom_x, double *true_x, double *out_5410100343915451790); -void car_H_mod_fun(double *state, double *out_823602999692946123); -void car_f_fun(double *state, double dt, double *out_5252072111533144957); -void car_F_fun(double *state, double dt, double *out_5472890640690018040); -void car_h_25(double *state, double *unused, double *out_8566352363547608598); -void car_H_25(double *state, double *unused, double *out_5673419960197083828); -void car_h_24(double *state, double *unused, double *out_1105741821560728000); -void car_H_24(double *state, double *unused, double *out_5330649520523751468); -void car_h_30(double *state, double *unused, double *out_2652619336876860225); -void car_H_30(double *state, double *unused, double *out_8245627783384859590); -void car_h_26(double *state, double *unused, double *out_1745332744404768787); -void car_H_26(double *state, double *unused, double *out_9031820794638411564); -void car_h_27(double *state, double *unused, double *out_4878718442501097373); -void car_H_27(double *state, double *unused, double *out_7977522219140748809); -void car_h_29(double *state, double *unused, double *out_1709109483975197790); -void car_H_29(double *state, double *unused, double *out_8755859127699251774); -void car_h_28(double *state, double *unused, double *out_2770626730810236969); -void car_H_28(double *state, double *unused, double *out_3673460110629721200); -void car_h_31(double *state, double *unused, double *out_4928902835293586248); -void car_H_31(double *state, double *unused, double *out_5642773998320123400); +void car_err_fun(double *nom_x, double *delta_x, double *out_408914854931955974); +void car_inv_err_fun(double *nom_x, double *true_x, double *out_177131998479136517); +void car_H_mod_fun(double *state, double *out_612188567970168411); +void car_f_fun(double *state, double dt, double *out_1999864885543950499); +void car_F_fun(double *state, double dt, double *out_3889473353313594997); +void car_h_25(double *state, double *unused, double *out_4691870608107024689); +void car_H_25(double *state, double *unused, double *out_4135237206615533559); +void car_h_24(double *state, double *unused, double *out_7256933575834984536); +void car_H_24(double *state, double *unused, double *out_3151171335774219891); +void car_h_30(double *state, double *unused, double *out_6984038239252175991); +void car_H_30(double *state, double *unused, double *out_2781453134876083196); +void car_h_26(double *state, double *unused, double *out_8151782040328317728); +void car_H_26(double *state, double *unused, double *out_830711236854732958); +void car_h_27(double *state, double *unused, double *out_6382318442842705649); +void car_H_27(double *state, double *unused, double *out_606689823075658285); +void car_h_29(double *state, double *unused, double *out_205509483633589514); +void car_H_29(double *state, double *unused, double *out_3291684479190475380); +void car_h_28(double *state, double *unused, double *out_1380645175181860004); +void car_H_28(double *state, double *unused, double *out_1790714537879055194); +void car_h_31(double *state, double *unused, double *out_4534683939755895544); +void car_H_31(double *state, double *unused, double *out_4104591244738573131); void car_predict(double *in_x, double *in_P, double *in_Q, double dt); void car_set_mass(double x); void car_set_rotational_inertia(double x); diff --git a/openpilot/selfdrive/locationd/models/generated/libcar.so b/openpilot/selfdrive/locationd/models/generated/libcar.so index c63170e5ccc5d01eac047419621fba5f2feff31a..4018d296366adc26e40760be92c79f28f8672797 100755 GIT binary patch delta 16646 zcmciJWqedu^zQLIgy0_BnWMoP7u;QnLvbmgxD=PcDei<~0|kn^Yp~)JhvHT!S{w=# zxWDQBf9|{c^4=HUwNGZ|oU`{@Yabv9XMWz7`Y5KjsX2p}0DL(Va zlE1rc+h^2$I^wCuJe6M(1R^PdkPOL@0x6LSsgVY0kq+sR0U41A!N`m($ck*pjvUB| zT*!?)$cuc)j{@+(fC&pW9JmNUK@>t^6hTpZgHVJa91(~_6rvG>*lkZ0*R+4OLV;%n zy-F5XwOX>ku;Den4GIig6Id;%(6$x>azP6GK*pHW z_#xGT@-Zvs`Hz@cs=z5jhWoP`_?j=t-}E8FgYu3kI6e-=P#h&t5~WZYWl$F7P#zUf z5tUFGRZtbxP#rZ;6SYtq-=Yrcq8{p_0UDwa8lwrmLsK+EbF@H9v_fmNL0h!L_h^rJ zbifbjh)(E?F6fGG=#C!fiC*{-z0n7K(GUGG00S`ygE0hN48<@E#|VtXD2&D!{DiR> zhw+$ziI{}Rn1ZR8hUu7rnV5wH%*M}{gSnW8`B(rS7Ge>8!D1}IQv8Z#SdJA~iB(vQ zHCT&vSdR_Zh)vjxE!c`}*p408iCx%@J=lvx?8AN>z(E|sZ#ax2IErI9juSYEQ}`XH zaRz5`4(D+J7jX%f@dvKpDz4!=Zr~hg|-U+aL1yLtcN# z=MVY)p@2Vl{K4=C(;qBHaD2iG4${Gp&f6!M3{{!qjpiu%Jh{t)U9Vg3;A4-x(l z=?_u<5bX~!{t)XAasE)uABy`!34bW*52gH}v_F*bhqC@q&L7JALj`}R=ns|rp|U?z z@rSDZP|Y8z`$G+XsOb;2{Gql#eCrQ&{GqNt)boe>{?Nc58u~*ce`xFvP5j|Ie`u;i z9xbZ;eWu9J*toFB*r>?3h_JY*sJNKOggUo<1ryi4XeQagG2v0saS;(wF;TG*k#Vt+ zQ4!I;)+w8*SVI00or4q8XKOAySEjI-m@rP~{g}A0i0G)W7+;m}=5jJchlPj5#zsZQ z#KnY$MaM>lh53f@h7}wc9TyfG6B->F8x|T98Xg%P8|Qn;J6V0FiRptQ!y=->BVxis zqoc#3qL@I`|9;;JjtGki3*&aoDJC*JERN~_cg-xmQW4FSAvl^@ghs@MN5q9kg@?sN z#qoY?-m!wiV`9TtKv+a%Yz#MM!qNYonbo(B_tOW*a^;xV@K8<<=iQi?@L1nj|CyO$ zBSK@s!onk>$x}>3cwAKM|D2dF(tl#K|8`-qk&)rCk>N3+QPGiczOuYyWr}A0v2nZ` z8WR;A6&oHK^*<+0_Mez3JTxjQG%hkWBAVsI#zloi`ZoB_3+5jFbotX67aAE86%iZy zKPP_u?~Y--5FN>MqrzgtVxvPtLnD0!qWouu#l$gJmKhVvQB+h|T;zXeX7P39{fwES zBFJ?_Ttr+d%Vk&(Ws|D6~a78)597Z%PuTgI!CvXsB;swQ&4LKKquI<}5iTWv`Eow0I|p7^rH$LqD; zB&O=X>1kET*RXfIMue2Q=j!5?z<@4{9~c`l=Ght;Fp9AZV^+qtjD{~spLmT)*(`a8 zzTFWR;Pp-8>v|b;huNyVComx0KvxNjNqz5leV}UidiIT%R~-{yF~$TcGO^%5R+v%G ze03+pt9HuW*IlKm8x*kLx00_Xt6XBSiSg={PR$e7&gGNIR6X(1qIeZbqQ4W9EQyzq zMtu_P^<*W3iYK<;7q3nEHED9rJMl`)d8dQ2rOh~YJ+r=DC}0~7V6v~=-yN9EeBWNi zdTBR|HFf@7p@3uW3k76L%=^59Hl@<=#B(1yXmUi#;;d~{nn-fovB(d)mPd~gD^>qN z1FNg${viok)=}sHNawQ@y#jHjiz{(_=+)G63t6Y z71~XKNhDvo@NS9-O8dgpIA0}>-)kt(j&7=~Mv0>t=gONn%A*&E8tqYg%7v)2LsWc)*H_F6DDCAX3p|@^fLz~(?$l&XADd5DD`Y+iBdm%lxvPhRp)wiA4}#j zk@-w=fk&Ir-RIGt=(W(Jb11NgiQyp*{NmB_#U71X!e^IyRQp$t(k&xX7_r==JS#l9 zidx>4qy;5bc{Cn-@e^BeY5#zLn;hTAXN+6z(ML>NEHJhYnk~9%gQ3vD-ZIUMF%jHS^6ebDqIi#_Gh(BIif-qSS68D2c=k$sMto~Ju6 zkg|)U^b%X@GHLw7qZ(J32vS{R<`{XM9dW~>6gSzj$ajl#k>obp607fcG25iFX{=dFRmrEXPLle9z>!1qReb*`v0`@%0qU!pry6{{sj0 z{~?`N{lTN}KC;F;<3Rk|5B~F2p7^lr6|m za56*d@Lh64H?cMapGj$GFXB@fN|xHt;M88;;NTVJr7=_^t)cYk3>8F@^jsu^p}V-5 z(NO(NhO!46+Jau04gH+OP-s>|d$2kiH_vXUV-7=ZPD8ul%f)1J8#;&adFX?@hV~;W zpP|EekK*3^+!zlqt$?8l9^Sxi!%%zEP*#g$RIv>mz$(YkHkZ$Y82VVy(CNa4t`y_FoJ7F85$IAC}%7SisQJLp+?0G9V=nzGrlQl$m_R-@Cdm|krr$z&5Fx% zlk$dERxmWOqM_(Y+zc^Q$OL9oHFOYts1qYkx0Xk9~_unl`~07no}&rm5;hg+Z3 zpg6|h5<(gn>Wy148XD?{KX4nv8<9oa#Op?0>fG4Sebj1VXeSDOXJ|TdHZ`;XMl){G zoD=Y}g`xf}4K-_Js8ef0&vCd7ebLrXcTB+w+{0rGZbuJ&Z)gq5wC8+mi8oZIgQ4|5 z7~1M31a&kt3;8-3+JP#a4P8a|E_66ncQw?mo1uSEzK5Yn$ko%(Y!vN9Hc$sGO{)rQWa{u&wz?bp&f=(^6(j~IYO>*<$`bUT`%JqF+)CT?Q)Y$gL+ z$lg|-J>G4GPHtzGJE_?&YP{Rfz`dk5kreJ@3+^{`2aoX&njD~U@cTjP{Tt~&OiGVX zf@6l39_J<}*gdCs5dBVfpEmRf$<8nlTz*m^U@GHZ$amI|T_GUAdpRS2rQ(Z4ScX@4 zk51=!qTxB-Am@29fp(aWBglHeP*se=9@rPz0eFN0m)Pg{5d*OeyRjdc8zc?Le3^S( zrvBgEbhU&pj-ls}fPkxvA%8Gqbi_WqMeG&ojw!f^LRZNceqpjV86TqEHTF1~U8g)q zaf7EHhGQybA>~ba0pl^}CiPEyi}axq>SF-LU>Xu`(?l43$57xs8Vo6MF=dF-GG;(d zID-6t8u|_2-lrT`{eZ3e7dzsip%&gp)E2WIv+tj<~?LiV=4jZ(we%3Ea^;5MPPbUKf=mrDp@8|U-50QsV~8%SGzNtDwM_45>(7; z>M>GfGxZ+VvYWbtxE!XAqeV_m#-v=P3g$M|CJ&R#XQ~H2qJMr<_wk~DsUaRyv4*J* zIE@x2lR-YqR8HH}AK2h{O$EEAjv`G6tHrv4rkWHo6W3W$F}$N3*aPUW+wVCC=1eXjzQZ<9ly$Q+Z05>Qj;| zl;XIwsjhf|;bka6SyQv|5p~O%nuq-5O)W$23Z@nyT}4w(k%xbb#xqXGHT3VtAG4KA zm8fiLbrn-vu@6Ua4!No_iOPf)_=G;yOhr{Ubr)t0Q_(1gYG{Jsnq&jN)-rYDSZsi| zHl_L2RHiznPGV_YR#uO+*EjVFCmNU<)sX8qGL^ltsh3#Q#MH>|OqFbEs!TKLU%NTA zMQ{shhc_)vRc&QzCDhtfd>c~}+mhCHjNkKF+``9HA$o>0e7oTRUq3^}_GATRP#wK6 z9JBEYe#J3d#2q|q?=@AggQ>BFLd^u!=aHkb>c^$2Aw9+)tG_h*p2*?O?5$rsq7pao5qFVozCQD&;zJ9)8t>kWG}(g z_}QkOqvg+(2;OCLOwFBZs`5Nj_I%QWaSKef@|k=a$kfb*^u!{{fzV$VF=H{EjqoL0 z6ju?ulx!j8ucmt96pAe~<-H#Oh@^*VjP)ck{_=n(t#H&Y>pxe1+Eu%HO=yZqI@3Q)PypAS+vghyfJV4L`Q*Yt>i`6`&Y>z0*W11MPpYXIq z&!?u|q3bj5^EZ>kad@6n|IUPDFWAF~MJ3chTmSJ(8WFW$vlZX)P(r!4ruO68cdQJ} z-kTcykEzQaOl|u}|9mnv_Fq$DKJ#?@!fLVq;tvZ; z)htUBY)i>qOI1TG9V%!kSz$}VidZ^W)KaNXOGCpfeG0cUIKonrNK3u(7Hy*}t;f}9 zOI2bmO-122OH0wFn5DGEEoCcVsbxt^!@Z>}Jul78%Ubf5v-C@OR#(wd&q|hNR<`tW z6@Hvk)zZdlmh#oGRIVl~sb%S0ZA+!=aKXAvxSqx1mJ2qtv=Yf0kqP{X%8gkmPBmen zO}Sw+GTnkqw6v7iihGu9W2s|XOJm#NdrMo}v$_tJI{jejbw^A2J6l@bh17So)V#Z; zaXpx9FH1Yo`$tQEBfdAU^|7=IHTzN$%wHMuC;UlgVynx^_Gs~zy?aQkw(Ov$Wp`KER8;F$v#4@Q0=It zy$C->8IDu7lT6|iJ#(5#oT1^)(RddurMN_0FIy`12iLs9=dY5ZP>3I-kl` z`ZWB!GOeu>>12 z#=LM5hL-4uK{$qha9iH|grX>c%D98|5w_|?+KPxGBbXg+t6B^fi?wwZwc?l{`W7S2 z#cjoupnNXhCuV$tT_u@BDO*+W0&Zzrml0gX)yrm8Je^%h~FLW0+sw){P2W zxFRQ4vh@h3D)Zqgwj!(AdWhZC_&$DhTYsZi4O?aKH$EV9O;(7T$XVOgl5c6eI<|J! z<-B^f9@n>ZuL0$0$h8`g^(NH6$agdd9-&rKTPx708LL2n=C%%DWD8b;9xXW$OIz96 zhV88>Q5))xf7^2N?``#I&m!V&P47T&{9vm=M;a9G5YWk%*_ljsv2_~_ynm;yvek32 ztyx%%W4MGJms18jU@SbuRy%kn6MV?bzf?`KQ512gg7QOcg%7h8i$5`WxGm2JQiM$GZN`0M8$+XEI(|c*pU5mcW63I(;W!i6!{`}D{ZI4>2pBt#x*+d(Tk-ge z1ruzAPNeG*GKsGdFqxF%0UAu9QKz!qa1KYN*?Ny{BZmdFn@%Inplq{Pb%L#5f3~H$ zwyw^j(HGE=3vCTs#I|0{Dl06pb!90tTSgj}^UzqyMNn-OD?q0;w&ty4_Umm;+`xX` zWUD{cpi=z;y2UtSv#pX_m=q48{#LdkQg5@B1FtZ9I}M37JGjqI?BZeM-EAv+udS+y z%xWJ`!u_^BVch{{c#sZ1L~o$rZ>0P%jfbEkOa`8#tOkv+9eI!0{Di~SQ8YNtduMI6 zWju*4Cu|MHb;O>umEsgl32!{%Azoq6?@Zvdt?syrVrOhkfX#(sPzw(*_Z(XZ1JCmi zy1+_M`6AcBC!DxM<6UM_e~`_qJTP<+tfe(9XcCZ?y~Ri z(TIOibJVzRYYr+u;AR-`7iD(d5)~a)sN`sQWqx(3ilcK?9rdf`s77^1 zA8@+{tEuUzVJ%0|wOJ8{f9oh;9VUlQm{iwMwt9{xVrG5LYv4$Y9DU!I1vPPW_B*oF z)KSUijw-hBlB$-DHneh-rH!LJZ5<73=kPaShi?v$ws=S1VLZ;@a|bf>gQIpG9ffyt z^bS`$v+^#awkwnCMtZwDD$~PJ)1HoY_aXy7lD*z!sgJ|A;vH@7=jcU$K0naWI`1Gy z1&5FlCemZ5qi)0a;BZGvN05<`e0Y?jw4>>RF*FOxjdhfK96d7L(QFi(;OHb;PjvJb z`c88646C*tURXTQ1ax#c&D;!;1 z>1gpPR==7BuBQGy*RXZgIy#PA>l{78$MvjY11s9-=)fkn*=AOQyjvX2K$mSa-gaub zgNyH^##pk;QN7)cPNTsddS);6P2^hGxR0&8pT<4FeUSYiE4i$w~n&Dqy8HRE8aW0 z`41icfmMH^VbBj@|5B3AtRAJlP#PqBW#s{`g5>HqWJ=9vlkr4&+w#HT>XqZhO3zdKmU(4T^SY^#aAq{UA{T&>Y2kuTvzi$TwOr1f=m#9qCz1i ziDiXd)hpskMO`h&!f#x44R!Sy!^8Pas|Y3<>FO60i((S!9PR2On#H*M{GadzGh$s8 ziF36L)r+}0gS^FEwJ720Nl8{$%GG`JD($Lb8CPk`y1IhrW~KuU3;A~&n#>JIi+ zW)W3fg;#YIUCq^w>aHHwaFwo>tDZQC?6qBa`w*&rON#2SlDe*T)nk_RxoHD_)1jfO z$VQ~BG5@=v2`l)HSvPf6tC_3r%_&I>S0h`x>eI^A?AETvwQ;q&t*Zs?Td{d;ip zo~}CJOfOe!f24E>?Cq*$AF|NbRc}ngD(pcUz8l^b12GJvFuou4pUT0K{>&JMaSE64 zV1TPn&_HgE3`jPJ=0f_xOau;=;3fXSSHurtLfC>E7{NWd3}qsyGmKq>s>8V#9(xII z5jKJgk91|C5OR;AR->6IdW|8C$Um0u9!HwTyP7+}Rmw?BWU{LtacPRH7gKqC8cj9b z)$tkJU?x9ypXI7t0$UOpXVZMh{uI3R%~1v$d`cV$M2O|Dy7GwjU;9I`(W}5gT0< z9~%%*lCjE0>R*?GCRn(M6>VnAY;m;?m$uUN+gu$(rR~gm2VK0ARqUo85Q!UTwTFho z5@g>?N--|c)qs6$>;2Rif8Zwm#ACd~2P8c}ZBiUyJ0TOYAvY}aLIQ5!E!=~yzQYh~ z#8xCd#Ai_iF(`|HIEN>AgAe!&{l@3e2qUlte|QNzW%L+%5Q^%Uj19Psz#}vt@}eO| zV>2$`8D1TA^&X$m_ZYkAIFH>EJQEOh(p77eI_0VxYW~gw(Cjp2fw$8c>VKB{pW}n) zT|L4}yvG*=T;TUEvFQq_XUvX#D2zB%MnkkiPk1pNKVt>9A`!=N7FTcw&+zsF_18sK zhkOXZH@MH6#TYB20_x#gv_NO{$54#MWXy&SzhW)6U^nt#a&>_51Tt~W^NiPV4^Qy= zBK2R#!Dr0m!^w~y*^mz*2tzTHM@=+BYxKf!jK>Ttz%s1I4jjO7oWm8|#zQ>Edjwpj zv|d6gWI|4OP#6&?hO(%FI%tg6_yIl87yk3dU8n<)96^qc;Y?i!qpq4g7n)6XQJO;=}@2%<&3r#14Fqqe#RNoWcd%z@K=A zxA+%9oSz1nk@G6`&(DF4!iYjiR6=buL<>x(KYB3^MjwpEWX!@`{DKu&hi%w{{?~XK zG9JTeT*M7Lz%#tYCoe&Ka3y03#tayMLwuc$@i=2XMjJ&CiIOOfY8Z#QXo@!Ih#u&N zVHk_en1;DnjMdnLJ@6hT{Eoj6aGlg3EAk@*;V6y@sELMXi4N$20T_V^m0WTgdzqdP!3g42Tk$$ zCOyH}5#8`324E;gVLYZH;Rf|zz`;_i#CmMSP9)+Gj^Q*e;wonsxfECz;y*P#o zxQ(ZH2i>By2u3bAyjB$6XhJDeLTwnlSqPCRi3+HJ`e=%_=!72Vha)^Y`e7)t@`uq> zMlY|A#zf4-JS@Q)Y{qUJ!pU3I|2zj*aTky95+9I?Ef;W`Cl%7s2dNm-U>p*#6q}G4 zSz*9J1fozL6;Tfjkl_wnnXwf*pd)(S_L6!IhF~bhViuNQBlh6{&fpyG;2vJ#4Fb7n z5Yi(DJcvXk)Q1n7upg&!15fY)$?wuDUP1wcp){(Z9(rORMq(mn!H4D8fSovqlembR z_zN%a0ZHzWHRM7xYTi?k%PGhwX+#xc-5^Eq&roKVk09sX9Lj{V9KS$%{_jX8r1!Fl{2UZSBp&d$lv0f4Q4@918eK7|MFI6?9E~ZM zk7Zbcoj8IMIFD<%hbMRkr3g_Pj?N3Af8>bD?YivjtqMqqP z_zwj%2;L!mh7e_ii*VG-7^0>)Unf~WSH`|DGSOtXfxEbmCukfTqIT$tUKorqn2uDG zeJB=d-<=NK6g<7VQY9YZ=;IG z3m+dB9`ZyZp2#Nw{E-j=2t*$6t}$26C6PAfJv#*;l~(vcg72dHX*pZ``3 z4)9O9Eg*MN|APY(7YWEYt>4g?24240-G6I9fk3WYF(7BffZTzV{y%=@tr(y{|1+%1 zlhl7rzgGeInMmG$C*olu|Ifcl^1pAf>H4sk^a0U1lll)GFgS6k0Qr9;W29&F0H(vN znCAy^nACs5fWf}3`oHE&PM9=ca6rxxc}B;e5DKFRilP{bqXbH#6iVYqltEdPLwQs{ zMN~p%R6$i#Lv_?ZP1M3q_!+fP2X#>o_0a$g(Fl#v1WnNl&Cvoa(F&~*i#BMBcK8MD z(E-1rBRZiox}Yn%p*wn@Cwieb`k*iRp+5$|i-8z~!5D&}7>3~(f!{C^qc9p{Fc#x5 z9ux38CSnpMV+y8X8m40gW?~j*V-Eg69Ohyk=3@aCVi6YOPb|SwEW=+|julvmRalKR zSc`R7j}6#}P1uYr*otk~jvd&Ec!*QIzNu0uIoWWU~ z!+Bi5MO?yVT)|cRjcd4$8@P#ExQ#owi+i|_2Y85o@Cc9b1W)k{&+!5;@d~f;25<2W z@9_a2@d=;t1z+(E-$&;et?}@M1is+!3kiK8z!w62A(1a6_Jt(Akkl8F`9gAENZ|`9 zeIb=Er1ph0zL3@z()mJqU&!DK8GRv>FJ$(GEWVJ{7qa<6c3;Th3qSZmPG8973%Py4 z;|qo_n7&~7g6#{AFSx!CI>C;p}H^B@P(SbP|Fv7@`ay$p|&s7@rAm+P|p|Y`$7Z7b8At#R_P+c z!lEN0qr+k%!lNR>qa%Z(!=}}^8J8!1#fyfLoh~FKI3g-MBsw%CA~HBCG&(pqIPPUw za}}Dl>r>k_ajCO6QucT^QzIqMmM$VZBse5EI4nFYCL|&}A|xs%IIe7HBROfKL&GA2 zLt|oMB4a{h!XraM!{Rinqte9{nBGw-Oaqy`}Zm@{=G^}a2RYQPLxM>?1^UnR3r6_n80O12 z$qwPHn5fW@P|E*5nTX~2bZKKkqho?YqbXZVSVVMWX!w8A9ry3cSu*bs784U478*>| z!+H5Wo@tRTB9t0&LDCWy77|X$qT+5XY^XBhy^)PXXzUA3e4(i?H1mb#iuXpgP_r0X zjb4nQ)WMN4!NDQX!QsKvn&lr7Hm&-wX8Fh0>eNDnmcGzR@wGa&){grD0sCAfj?Yjh zR&}KOaUJT$%F*HYDU7qE$8jO`V^v&_;yN?tOtSNas{}dx{Hnyy;Oj~OsvCc=NvwWR zhVr*v)x;0TgF;9a*Q!~pT4-bZVa9R+dJ&fr*zV~&mfexn#mFlJ+H!RW?)<@^yznk5QS^)3E>L*vHwh*hmLxkGGK+u`q* zuCJ?Uj7j2N@_1iWiR;iaR$g_Cf65r;ub6nNFDp!=S8-Lw#Hw17-G94ES~I}!K-?m} z9cdBjS&LY@_jENlLJ`VadbEajX1obv1{c#h0wqR(&g}<@g;_+ltW67k=@D_KM#z zwS)e$RAYSG?Hv@~cKfgD7@=J8mtX#>@k!FW+3PA}<}C6cHx9-3{`{+q5QWCg$=6Xg zR3ff_{*KC|t#MNr>*!VdQ{UGKG%r3NxTE|NC@?NbXh($wqTNfAS)^d(}jqs@PZyvQ7rvM6 z9-Tp=2_CKe-J=N;J^FQ$N3+mjvPYe!cr*Y*FcOn+9k1{nUyxv`$E!qBJxYNL$cmh> z5RO79jq<3BYN&;uQ4dAY1hFWKPh7MGV_S4UXY@or44~D9Fpk7{Ov2QuUXNySP&7rj z-ye*j(>zK(omryz43DzU^r+%2kM3j9Y$h^?N&ex{dUTHS=pMSw_2?`-^OzX^!QS~E zEnVQz@P(Ya$fN3uJxcW_nZnQ|9{sS?qpPUqT}E0^^e>ObARc4cf{S|l`Q707KE7e} za*sY^+zOA(l^*Rx>?)5wV9aWd60Y&+G#ak;=os>@^JodqA!e!1XY7Ba7YS zk@p&*(`JtXw|I0O&A0L*L~LW`xQQ~`J?epSJ4hcI?)2y}8pV?-jN0Xqy_*T3)22l}%5Ym9F(IhCJZhC?3Z#{!P4 zFt$P*=L}<RY}s&q9}obgArKwmUH zMsFPVXxIslws=pHzEeDSnwp(qrf2EQbFBEhM|m!=?Jjy$|B^>FE_?JEsjhmo5hMSm zsjjio>mJRAd4ty?(M^voV9hO$7T)&g)*Z@tm(<_$sP%o1GCg1mquWDz<{#?6ju8Eb z3*s7TJ|?aBjJZ#k%u`bKjEg__$nPbSK=5mij5qYkTN()^lceygg3lb+en+XW0-MnD zJzIB^zh6z1J;cwfd_4uT@a{eJ|HeVR58MnsGHW#XZgZ0RDz{p=d%w*#it^4m7kLO%fTpgLR2HCyAlGXrI(jvSfw^C-d?I z2k$X2xuF^<45d$Ls2~!h;v%UHJ;0qbhU%p?lp~#?t>~5B&>tBLMPxLz2Wv9%=9vw3 z%wi~iRzth7FdLJ}Zs;N=rsXzN!NU{SZ5aB+G?dNa z7*%XT2eH~QwB6;LAVc5t7&@2F(DnRWxFF958=4u)8-{Vs2t$J+4dskxK`|T`GSslJ zp%X<6B`9hr97EyVN_d7`#YhXb7H7pJd6UwHR{dybWEn$+%kpL@Ql3m;Mg>EM(6=Hh zsAOnCWkZds7&59Fs)s3(>vQ{_r0|wy% zYSf^1h^T33Gqz(74&oT1YZ)qy>d5~St3e5j!BrIa*-#(cgojHp8vaR(pj zc&T$;Lyu6ao}qXYtZ!&KayBru5pF}?q!BN`yT*nFG%?hysi98I486h8=JZ7iL)|e2 zEAbG|F}Ni?)XLCWlxfZDu{G9E?KXxsv^BKNOGw(z&@7n07}|*{?G4>P_YQRUuQV6h zb~L0;hRSy~Gzq!77@C8yu4Dt%&=4iN8G3l}#pAsxQy-4;6;XYu z|6@Xdeui%1M1Mm)2ar~>5;2eq3^FtpA%l4iC5EtlP-rOKk37RjGjb1Sl_TgQ?EQ^} zjAS8*97T3V({N)9?ZDu%hWyEN@^OZK!?s?>;&YRYUp>&#yNaM;52HCq%#a%#-5pm($1n3s6U%BBF7xci&lRa8Wm^g z)m%dt=CRU~^Qp-Kw$MUDOBNZ5Tg*-4PcFEGEx6QBzGbWo>;Gb9%MD#Zy%jVRepyNH zpzA6_z2U{;)%43+x*g5%3%odliR;)s>&d_dvbT|Yk9U)y)0>&)R%*758t*VPa3|@F zCxyG%g1Zgf$8&r|<2^JE&hDk&`$_)+QhJCI95%G<2yb$f-E*89(FwZyq#?gk-09E^ z7a#xVH1?B)l$AVfi461sfV$^C1#9{*pE*r zdYQUo3a%jd3K_$nO!f}rQ?$Lx9!ImkDGyRydfVk__KkW_Dhf1gi zFUDXRX5XZVF#49E#CK>gq{NjZK}yS*0XgA;1s8cy0ON2B)?GtK@bf*&ai8ssIS<$o z4-K{O{zGjs>k<3@FcEBT)iV>5&Ur{7oH2 z>V&5DAyI&-E%-CgRP{urf)blbnZ(p}v`%U&X)>NemgJ^pBV7tpcab%vsi{bu%2aRU zNns%)w-%Apz>BXbq9fxoJfzQfUeL#t7m>ZUT)Fm)QsYO=Cgr2QvT?{Vs9Q=@8g z{W?spuBmreUC-3W`ld=XFjb}@_5Z06wMFK})D9n;n5x>;)G7ovGu6JisfjH}YfHvf zoQu2oo-|0WaEf0qJm%|H$k>{!pbV;`7e-(X{={E6fh)L=SFOFK>b5b}s2xr6i>aEw zn%dQo)ps#9xvQyJ-Fc%PtiG42xZb8B`;a~??n_Vfqh$TL5LyplL>SkbGtkuS!8GYm znr{Seh#P40o2hPCjHmD$NgsI$+mLNE4TayvnA!@BWjmreR^uZ&jiakE11qo_)_7B0 zkl}ZB4o*zu!jot&1W%?1P2gETFRywUCSA28u2sTS&RsR8O2i@jp#1#CKF)LVqCf zQeKZ-%NUnY|05g}`HPgH(sF8p(JM@Sz?PL{WECq~&0dAIhTVazYuTz8wvL<1dQuO2 zqp7u&66(A1BINEvn>X4Xec{esA&rrcwuUgO?zN_2v2oTT2TOf@;pq|TViewLkt%jd|# zd2T)zn9M~}wJw?Z;WAtM3KRDd693HwubEnhw%4ii4OW5mH|cbAy2azSS^XUzN8`Kf z`Fq?Cko3N(PgwYX)jXtZ|4^1kG%;E~=5G0fa^N$%KIMI$F-e?+^PJaoCM0{o9!61A zLT$A19lxXzUzz&pHCyowHzkyNYw7@ge#gqt?7gYMA58uI(bV=&^v`EgnJh(Sw)6uc@3y7nuBEC$mJa8!lq{d6;rT5c zDqyK}u%%%kmi)pj4Mw7HOMUPOZ6Yjfz>P>tRiZ6TMM#XLWr!_gDQ#g(*^5|eS=7=9 zZ!t@6iu2|rEe$PY>Ce)vu8gIgWi8DtXX%gfmL^xQw5g&cv$CafRai+?OBbtI`mqKV ztjUCHS=?^9U~NmQkgN`wz(1&5mzCm7Jr>%4H*83z8I(Yh$TXTT36>S+d$&TG4^j|7xjuC;sr%naOsw6pudLEWJki?mX7R(k|5ONl7rb z7uV@ciIB0crIP)~WPh$PfJGe5t+8Z&j+grXK9G|KS-LdXQr#iE7_Em=5;Pvh3x-?j zjCmt0HT#YJ7|DbXG0M^oWEf-V?O0Mh-ctVGDa%AlttMM4Jk`>qX%_z`;I&wbdNVDh znPsWyY_c`S()K@?#q7D1U><2)U@6}sYW^orE+M_kc#dDt_FG{oXr-mg7_^FWR$DrW zgKH?wS{f0v)>$gE-qJmE*+7anTJqmStv6e$xP{uI?N&?nHg*8IY-b1Tu=LSOSiRHI z&3Njzn~vPW8|<}IXP>18`z?(=U@7lGYK3ZtEbT?qVajlXvK?a*$LX1qOyU#`cZSA0 zXDP)6dg-F2;+MGQWzN4sCa==@f76WDEj_zo>BKE2bBFo|-s8#pY_W$t`H!U@k1bVy zVyVPaOSzxXbkEs>c=UoMd`azIQG(Z&vc9pj5QX0Ins*kz%OSNN>6=e%xz8-(D?8zv zrH9|ShHNcNVC$y8t)>CCW(V5Jp4e91B(_(VlG;k2+}7k2woawARXw$>8&wpOK5Ac_v$T(IvC3cZkhmYXP!mwN(idFbAjc9m%uXT0M>* zShIU=Rpg8D*o#v+Y}NX~R)U2gcrL zoZnVK{w#2-fUWrjZM6ut^%7r^f!}mr<TXvl8@Z!V9sisjcnU(Tox`r|wWo-n^BqzO7kAtgY#7=#93v z>bIjo@fiWX*a~V-COg==hX&qXsXwZBwB_H4Cd8)BthNg$cBLd3)ye-_|TF!3kW&mWxUJ9y5jvu+?-#F5=ik zTVJqg=petglW4@rlx-@jo@VQ>8MXpv*}5^CM*o9`oNH_NJht@$R#{=8t?P@J*`K6w z2{(;p)E3qLVg=~5!q&W1%zm}4iEG%;>ue3cT9o}Mx9&2|SZ}M;1}23=sJD@=h}4^G z{ebtFvzdm(+AX}#R&3*Dg_Ay$Ki*a71(^~7=1Kf-gTZM9)MjV?!R4Z|%IJ!UJ#ahej|_JpT+k3A=tz)4%( zaRbFqapyu_E>r}y@ECK?u$3_ItgY~KtOS+Ma~=3y;GTh57n#&0vU!EO=2csD{kuh@#OX~MVMCEqcL_qINKU=p9$4WB9B7h7lX>8q`B-)yz|PW=!2 zIakBfl(;`XO0X zNAuv9%~1f7B2#upmGB$ZAWaTOK`4jDn2UH^$49LE!O;sW$mwWgE=OUx9VPTQ>V?Jz z6EGdEg14IG=qVc7j&9;7$5C0A2?ROnlE>j25Ua@NC}n<*F{%KoEa>PVrUpBT4RPdz zI+}pXI2y*qBOGOpbksGQ%r`i6UzSxps34XQdST#Xe~r(7^=Fgf_uq%6o@ z%h5#4{E657>?p8~qjq&!P(4Q%>XW4gj!HFhRI#y_R5fw5v8ki1%^i7KI2zv4;U{5- zUk;GASVv7T0q2pREtx^vc8;Qcar7BC+OzTwr1n=P*OByga#W_Xqo!RP?e0njx{E-BcZ_e-QXuY?eqk;oS2@~lt&{4NRoH*FgvLR$-C?^kdly*3MFoI@5 zxsi^NkD^CLJDP*yV;r4E>#>fWpx-!0UlBcle)!!{pNSk#qQ55d=@87G;_&BpM}ww1 z(lqM-D`7hlPInZ8A!s$j(de0uTF#=AXH)+NC4aH{7dqy3JAD?T*f&{tkL(C-sfzTG+IUt-PDY z-NXAJ$6m^_k6mo&>xXsD9Kk=kJ8^L4Q795<$iqj zMy`$^Qvz2d{avk2$R~g>IKb7CKv!21xhjy@RiY%W_F#5WS6Py|DxcitcfnDMFv*^8C}I;F?(cgR3z)T{X_d>o7LAtGpgpf52n7nrZO&|DvWV*W#i`X!9am z!z+i2xUS|0xw?$vd6*#nL4~|b63g?ss+-?cU;$Svu&AJ`uEBiPD#X=@P(E1|#zezi z{fXicOah%FU42KhD3`zg6a1rH%|K|3tL>;>hz}*eD9neainw}Fl+_h;^$5L+yQ)~i zRoarSuH#K9J|^@dDaGY7yjfXS_p!Geizx3Zs)DP+6WS0HQO%XN zFQIC6QdEPL)O5A07PI_`H~pDUI@ER*Q-_q*bycMvE2z(`8@Q^~&{g+Fl%%n%kxg9n zZR%=HGd_jd+|`;Et`@X(wZE0CO|6+!ELm*h>S$d_v?9E@MIDmas! z25v7+^CnGLSi)q5C*Kh~_;5pvm86hT=G#6`ToM|?wq{bUEBXo%mi z7S|AXfQi6^hy!GyItP=n5x0=|APolt4KNy8a2c=g{*bFLNN||0#)u=_YL9XsK;$u3 ztx@{8t8S=yf(4-2NlJlErzrVpN`8j(&boSbmJWT#!58?S<93Tw*nF9EGvf&d#KxYiVFpS1z z%)vtZg>~49-LNjWI>>kmnYiX9##?xZ7x;knNWghBkqqASgzPX;0Ffw;@~DZ1XpLSN zfeDy_1z3&^*olKUiHo?7dw7aB_=13oloqLw2|3|hr2ZisM58#$q6%uG5nAI{^gurh z#TZP1%|+)hF2)M1$9C+)QJlq9+(n{GeEf#-ExsWQU#COvOVqy+2OY5hOR)|+aR4W9 z0oQRK&+rc45J-=tL?+~fgMuiGbXRCX#_~wZab?DuXo^^LM;~~-grOLNnOMWW;X5(T zLoQxuV+qGAu?aiT4#%+%$8ZLhaU1{O6+S_{HYw5|3v$9jUWA|!yrl@0@Dm!K1*X#^ zy%-0hFGgcBW??S=#7eBkcI?4`tK0z@Pv9J`;5HuP6+Xa^a{{r7;}nb;u2O$52Zwne zJL5@4lQAzs5ra}Fk7^i?I%tYmbVLvI$8e0p7EHrjEWsLV#vUBSSv*0&-(==*>Yt4R z3k48`5~zThXn>aJfFAJTH~fy7ScsL_gvIy?yRaWea1!Tn1vhXHkMIKT@Wpq*qX?}L z;HPWU3u%!Bx!|AxB2WY+Q4Up58%>em20g*p5#7)mUJS!1Ou$sk#sVzEDr|sv8zCP1 za2O|W4p(pk_wX1m@d4ivaNSjMq(fGCkOv`%K}l3VO*B9=v_VI7Lm&7d@H+KR!9iYx zq7X`OX9t%TZltv}|1owuQA38W8 z2BlB|HBb*t(FUE+1O0J~n@4{PLpHt{O=TR);#U?bvj2&Zucckl#n@ePUYkTv8&Vbnr948{yB!V2ugSuD9r z$?ow3$vrPOp8HJT0X2C@$3EuU;uE?Yk>sjq|vSYq*XpxPUXbja#^fXZVD#NDvq#Z*D?CgrgQ( z;#YJ>FZ9I#jKnxh!91+S7VN=Te!`uEgB%}2)}2|D78f{vi}d{ekW5I=A}q#&h{5A? z)W0+bCGau5oVlV;qesn2+UHi+CKvDO|!$Jj4rpMquI~r9m!)qAaST7FwYP z`k;SeZ;%FZFa*Of5@Rp{lQ0!CFdK20k40F5%{YcgJ`op(WmtjL*oz4__(&$>Ej-6N z`0=rw#7KseNaH1>M^3ckzhZ|D;$Ji zG|c2dI)Fwgg7g6!QwFJLD(b(9a2ubIK6Q|?AwQx}H%$;9Kn>E_8i9UY8T-LaOOxR? z9^esPpi#OYwMAF-!eETSbflv0a~YT8O9B4V0^<_CkL*epR9DCO;u7wm8(!iw5~UAP za-77x3_(hfF-V=U4mWWZ|KK^^!#@-0L{8+(6co3+4gWE5QYWQ|-_FsKc?yeLnzWOm z^dasRV{vVc%bkodf#3JI<{T8$iMV;b2lO=V*1zMDxZKJAJz;uWa}J7WN8CI{=l=j+ Ch1tpg diff --git a/openpilot/selfdrive/locationd/models/generated/libpose.so b/openpilot/selfdrive/locationd/models/generated/libpose.so index c44f51993d17a88b27abeca7b1edcf68232d86dd..928fc3abc54cc215043148b229a8454b5a6ad317 100755 GIT binary patch delta 16387 zcmciJWt0?G*!KIY83uQEcO4hp-66QUJ3#_88VK$VgG+D;4ub_J5ZpCbAUIvpRm1tu zv(|Y&oOQmw@5=h^UEN)^Yw!EMcgxB|rcYA`pp?7)g*6$&ef=kP@ko8flOg>5v{7kP(@X8Cj4O*^nJM zkQ2F(8+niy`H&w4P!NSs7)4MN#ZVk2P!gq3`oMcn(BpoYb0_;grCz|uI)QltlGO=F zGa)c{KzCjocs3wtZ-6&nvVcp&zXX;{R41@_oxt360`n!R`+xD3_y2pt{M^1YlPSp* z>jeHEe|2Eq(4fG2*>Wcf@QwcR{}-kyyH5lm7$FEn7{U>ONJJqTWl$F7P#zUf5tUFG zRZtbxP#rZ;6SYtqbx;@eP#+D@5RK3nP0$q0@DrM&1zMsNTB8lxq8-|!13ID;I-?7^ zq8qxS2YR9xdZQ2eq96KW00v?Z24e_@Vi;hd;0%2XGLFa2Q8$6vuEJu{eQ~IEB+VgFkT==Wreua1obq z8CUQZuHqX0#&z7lP29q5+`(Pk!+ku!Lp;J`Ji${u!*jgAKX{2(c#SuBi+}MB@9`f# z;3GcaGrr&}zTrE3Fkr%h4L=;Xh{KQRyH9v#Bfd!x-vq=r3FDi<_$E<&lQ_Of65k|^ zZ<56~$>W<8@lDG3CRKcsI=)F0-=vLi(#1FFMxrjHB>4+#s32oDPm362bk z2#SghT|BqO^~#GIT^*Y(W>cwRo{Ed}{4pYRY*6*Wp5Hd64-X5ChzyPl4U3M92#pSj z4hav6dDfzgr&O%{uCV8RqVypl5s}eR(eYVm|Xp`k0)aGMIZogM&hXg2N+%BZ4AA!-JwD!lFWBKK<{f;ZfnyQK7+M zVZo8noEa7!9vYJ-!T&pQL{La1Lxyn?ZEy%D#035Cr{TdtQBe_G8pMsGB11z$!e@{9 zR@g&RB)%yc-xP~)ipMu4;+vA5*fHNqc^2NR8Wk4Bl%hhyBSIpggTjKsqM{YQ*2v)K z@Tm9|#?Lz}G%7qO_*k@uck*INEkKI`&$rP)|*dCtFOGpioa?Ptn*)^vgY-A~6qxLp>Eebz*XagnDv& zR>zj3ZyM;i8apR4)YHe4u~ddQwS)($kQ>)x(nN=Px_C0h4yCUd=y?=#v_h!otEW}$ zu8N_a8!0?nV<*)M^#pj5-l-6$#ajYo$IPkEz-cpQ@$2mN0QJA+D&39%b&dJP`@eWH z#SCl^>hXGJ$9|%Z4Dc+8Ez%^^lRky#W=y&EjGc5xsyJ2gB~Cr$TJUcVV6$fu3Wr=RbvcyyZP(Vr!KO_k674IXF9NP`HOC!V?=cDAF_Fj3>?P z&EZj=*v;Y5p2#dL>}maIPvT^0`;eKAJ^oc+^g)GKvqiM0O%;;TY+1BtcGlHJ4CU+p zU4_vF>+u!YVjMod^D}Abjd#R*H+k^EMTX>yhl~1kE1^o~lhe*L;pUz|a5ueH) z^(pZ&pAH@){{xQu6cOuFV+5TblqY@4cgm-tr^zn{p5fv@eY%e{=eQ}Vp68kiTyv2K zU82a){W4LwLhiBPFFw0Up|d?M;W?>??@F*#Ly7WF`|suP`a{) zHlTSqE+}tkKQdM{lpVd{$D~Sza#c389TlrEAi7rNM%4^mK&R^5u!ft6A>Rgw})HC#-m*!S|Lt7gdifCx)DaJKow)mwnJ)SpVGJMI(iwl{G zs4)FROh@HrhWNik1FHG8ud zsE?taaSsjpaveHhWnc1tii4}D(~tc3H*|aeAsc8YU=TM!o56-+QECV)!MLG@ejjEi z^Kb?pVJHqCMjHAtipl;$v_>0RKgQ6xv4#$NIe#1z8Bdxg82S|zCmK3~dXqSJ5+`(< zY{&-(34S#cI)#W#HS`4z68%P9;2^@LaW2kIH`ImVY(B%#Z9GKPnTDFoVzRRhrJTci zcr({fhk1m4zM&b&w!qL*Xd%UoPTs4oOb!Mv;$*y7OqiBX%}Wi%TIsP`(_iysQnu86vguBRiog%>q zoP&+v8*Cf=j_0U*)6gGCb&Dd!EG)%pJj64+!tA;U6@8nCVIPv;AsT7oRE@qD%8m6( zqd1s~$4GydoZ@%vz*p41XJ{^(GHZuE(S1V`5Qk9@2rCLbG*l9+u@n1H_z}^<792$J z$A-$FD+Xf;Hh5`v;g2V*7VDp~&z~F0kHTnFIZnmtOCbtnQ2~`v4K=X|FHzwIX+X<= z2r+uUr21bm$=5s|-jH6be9JEQ*U*4>MD0Ck-SHn){gHw~;ZKHQkohx}`i1BFS3@SA zd^7auJ0Zn4?DiQNWElF*qzG+8&HNOf!)mYx$8iz2F(i&c#uL1UiQPYl8oJB$%95#F z9#cMSO<*b}z*OCYriulcN|(sg8w^QoDrXW?#}Ja#)Io$KGnFj4sj4`Q=oF@QU_dHU zEmNCnm4?^onwGKBnOcK<=}n!-;0&hbVM<1?so|MSjln(i&ul7D7E?P>C9A1dD3aaO z?Hs0R=QMQ(ZE~5qjHJ0u<-+hPaq5j98v|63*Co&hZQ#W;?7>Og!85!>l02p|cxm#W z1lA%;UQ>%vCm*ZJZz>K43b2BLrX0K}WNLR|Q&WqWs!`O`5&TumRLA0sQ^Hge97Cg$ ztPWXAnaWn$)MFeAGL<*j)Law@G4%l6yrHZP7sE{b9B%5T2vg-FO{I@AwFX?ap z*Ik{W_cbP+O-+r!1WdyMJVEki)B;X7^OEPEOeJn^>M$<1FqNYfH^;v?-0qjTM^oiGneyXaXH!eM5XG*h!n+Z{?xwC|R}WJIdzxz4%T(&# zraoXtA12$^RDEwha^K(7dt4e|YWhG^y$6x+!4%jKQx~v#sHvXAOx66^RN!z18DXm6 zNb)#}NR2j?eJs^Ij>t_g_3I>4#$<|kDmVSj)U9bOXojgnXggn5H08T^Q1%d2 zionCn6!#H+gu=m7R5;2mLDyrZ{z0bWre>jBEDtSIIYAAe|4CDkr%a_fO~Iko8MYl# z{7J~s>nsnhb3_Vj&a)f57kGeNGIa{yQ1&u|{zWxkHPz)BA;-+Wc>-Riux^?fcZ;0g zX6xYM9i9buO-;N<3h$fRkMa*pxmfkr5&0{HJUQ4O+S?Yqf@aDIaq=2P`u<=ttOKUN^kfny+!rUC8MJydh zWKm1U5M0dCIP5EKsYFRj!;z(wrNwAl+EVHui)Xo|K_QlEh4NmQrTy3!ZmCLyrIRQU z$xV6vf3nn~g{28CEg7vyQ5z=S z*3zkVEU<&6&K{J=)6&#g3^<$c&7q&m3g=n6 zhgI_}`LJbyrH>0O^MfT3{+*C+W2W0JJ=$TZ-7YG4x1|DmE%n();r+qN4^V^$Em?;c{D`F!M=e!4ZfQ!a zrNk#KH8^GIuhT5>3_A$J{o)>86!mX^M^booE>-})mf|3v=3upPcqfZr^o^I2MBSh{600h{XeTPp0b z=i@B>`@_;a*{bicbs2RN*gPL>?Fg_{Goh`gSQp6WiEJ4NN@A;PQd^^v*;<_3mhaAY zT}ol=0q&;s+WL~pR%jYq2T(Jutt+UM&ekrOwPwS`EC7MfNKldYFx-x9Cj48)x3zUrrx3qUd+}4 zgcrB<8na8-Dp1na1)MF#ib~t;bz75AH^f%jP+PI+7iOz^xUGZ{wob!|WVO+@YLv0n zr7Wv0XKQ_V7E!_0xQe!NRkF1m1uENG4!4Re@7rp&F4nMBycQqUwl%Pht!i~`jjU&D zOMP228nB9nwgxn^`GJJ3woRCIQ(Kp?rkSm%pKK**ZYy64TYJ%@rL85cc-@AHv}L93 zY<+8QYivhbXFAzx(1pczWis7KOAp(t4?S&#^|p1q4=d?sYgT_-HwV~iKZw~6wpD7V zt)asR+s~|a1Zf#*EAub5){Z76WB7~|9vR2YCfJ%ekZ?=w3vlTFd zacA-#uFWDEvw0sm=5TShIX3^VZmaw}TSXSw`fVYDF1B@RiLDdM2>l9MDOM5g7;?VG z)}ggbY`v|(jkZ2*BBxtymD_4-U)Cmyr(FT(-hI46wWz{@jT(ZXsg0yTQOH`O}lFA-8EacuiJ{eNmy^&ns|o+ z@7cO~pKBl5%Kq3^qNlccJR|%sNW(w2R=u+I<25UOYpdQn()6FLWgl$)`iVmQ%mlyM ziug|c^BEMDN#1Q+nfw$MesOH&cDX59#@V`$o!YaSq>+Ai%E~ ze2I+fV(RnsJXZA03mehtSaBu(a5IrPVLoW~~| zOYWC}Z7KXZh&(C%s`n#6$LV{d@+)g9YdHrgZ z-meY3=t4gL%`*5kl3%>s$>`UTOn$Y>?AL32MRI;mb&TIQWu(uF{3wCe7=qzA13$87 z^{Xf%Q3VgNH5(Jo?pLWCLR0;WtP*2O_?5e)Ujd~!7rjgSl`F{4&wpqR z2K)IRLca#$XA}tat2F9h2Qq~D)hOJr`w@QKiX;_Letn51{AHPVIVM@2!7BLGv?5Wg zoR$KDkj+wWoqB~G1u#vcsT3tC8zjh;9-TjI|y&f#6C-+4bZ!hwQUvL@*iuU$vJnHx1LL5Qzz7!2N z%}f6)7XB>#M_;oaRgFvN)SvA)fcinIfrK3i2Km($cTi_ATM-$C5`IL$TYQ*bZIG}} zSDmMCINYx{BUtq)zmkpitJ@gADiEdBSX@qe)J7xwI zKa-T9=q$gk&h|_5m^?nu_w!UGwMe^&0&f3ZRq5jvk^h~G*{2w^go4353|i_}&SeaQ zGRxUoD~Qla!new=7cpG8nu)CO>*iY0v5p9=_p9v&Ca{sZK-x`y728ZC@C`M#@ZRs# z6>4A;(rhK|TUpr&4jOJF+wt9qR6( z1`x?Owa@`J_Ut3Ne^78}u%Dh$r4*o=WI>#LutD{7Q0+9f3W^ zspMF{!cX8NH^=HzoPXM{e-M6#lwt0leic5;Rz2s}zVn3s0_R>N*O&d8cEzu~fBBX9 z8jt0_{aSzBuPZmmfAB4~&}}Agho{_KR&n32p%47J`_M1XWAgvRuUSvo@6Y_o@q*R< z!}fYf_+FEmH>Bh(Tk~Iv^Sxg!|KsWSfpI=k<)3+$d|_*U^(*i@4;&xw8HC^D*S#(fM=i5Ex{N(J9F5B9C?J=kb*P-% z(JqALakSY>vnsD6<#%)w845bu0dFBkc?vs9Sj5o^^eO5ncQHp_aj3YXf+ZXcLXVP; zE|hW4j6Qb74 z;TKTcu(_k7Er?hvQitDKJ1W!0QQ@|Zu3}R=N7LIoYTd!nGfe8}c$KCTt3Vv4cjn?Q zj?#4{+}#{a>+a}#55n8aQNP}Vu@AZIORoEoy8(`R4|H^EkfY~=NyAVE9_HxJpIO~- zN99K{;Zcqb{K9*qsiCnf%b%`iiXE&34|Y-)yBtOCc64fwqeS~0&HaPO?03}hpriGNSlAJwbJWq;V~(PaJ315V zD9K62oqx*Fozo2Xr=yK$3DbE;!!A&em#FB=40grQCH(#u;l9dy*N6g||4nfr({*+X z=HoF=-*EKdrlX6u96i15X!jj<&s|4B_sI8scFY5I1$sOra*xRW*+-5RJ$6+338BI2 zr=0Z6(JQoi?&uyWy`TpE;U+H~b$!K3Uo#0TeBj^1I>cdw)BK1XNK*l<+Oq-ZSms_p1Fe)f}B$I%m%a*0eF zujOhuYI$54=##+Jdo&AhRU)CQT!F5tCUSK>vC9vrT%AYpq^?$DZ8BHSlDle=!qvEx zu8Mk7yYi-Sbs??GH=nLbW^nZZ!I|jMIkT$@SzPtb%Ana?ei`9v9rEUIwH<|W(!)W4 z+^+WLaplSDYF|EAi}Jf_Ux2X+y6RWRRb*ja7jZSX7{7BY?&{x?+`DRNS3`qcT?}!x zG|bi8a92a3U6m{As!cgpY05J=Hdo-}imvihaS!ld2RgfY-o@3Uu8h&0 z8~1QkswZLYMS6O>YS_ossJ^a#?nf&6yIMKGOMV8rIy1=Cr@`cLh^s8aTz;73s?uPZ(#KsUA5cfs{3YFhtX_{t2j*k-BqTou71I7#wc|PUp3r?J7OP+BR`X`l+awu}vRWv%IJ8s}P{yOI>`+0WHd2$%RK^08B;HvLM zwg<-J-X(sKbeS6>=r32PuDa@gE{MJ6YWLsd6km}1x~rTxg*$kFXLyNs_>6=%**z$P zl88VJ?=7|&I-xHHqWf)fjRAL<2&N$6U003K5*=_3sqVSTi1K)WEBBem115%o52*zd zdc=;wPne6*kEsPr$LJ^IzyDKaiW|>dg+1q~^n$|phlj&UQt`@FuQyEOt*e`ec;~9o zd)`Ne53Y)Ro(U*|k_f>#ticxS#W5IY;CIyn12GIEF$P=wA=HZ8(SIye^5B@L~p*;W`q;Q6Ff8Ug-aW6=Ed5B98yYdg9b3L7cYZ zXh57QC5%(kz&Jhd(!9W1e8Lwv*pNI<0g2+23~7-I#Sx8KXpXKJgfWmM5{~0AN?^T zWXwP5|H3Ui!b_~dM@->dGjW_(9uATsEwUp&N+28+Q5#Ls4MQ;ozhVxSVlB2}ACBS- zF5x=v;~C!K3%a2Q?x-B^ui#F!~~>gplS5;u?%al z1-o$&CvYBr;~VbbIo=@-O2%K&dTHvQE#_bmR%0vn;s{RT5^mrDUf>#3_hA96u0^il~of=!_ol_N5twk(h$G-d)v>eil+PNO~;fcsbT%D_Y<%cHPWFUz&p`R7Nc{!ek1h8~p(E#0ZSXRLsNzEXNvb z!A|r^8K*z!kKiQE;VSOp30~qqe8mdbNRX2J_vOOmwr(LfqxMlR$>QItj$ zs^A~~l&T(mV>Cw_bV3jG#bAuUSWLzY%*A4?#G2G`6}6Frt=NVAIEs@vhby>&`*?=e z_<-+lkT6Zm+-uREY~J$Bq$=v5F`A<-o^#S0d_+oKXFv`VKnaASGrFS>24WN@V-A*K z19ssE&fx|g;SIjRPD2$ZNXusCMMmUAL6k%UlJQwOWJduMM<~jo3hJNAgTB>**2V1chhj9`Ya1D3y6b{ei*Ys~8^8A_pD+Z+_ zN0@7{9i#%PVU=!PB`h%uOsrPzcmIDkVqkBhj6 z2lyB7;e*msh{%qTD2qy{fks%4o$wx~S;xOPcufBv93MIZ zp?pLpKlv^|$O^KZ3bCrf+zc*O6=9{wQ!GyHN-$W-IMpr1_P|3JrKzQ09>XE5K9omp z7?FzLOKT*>7)7B*vxqX}e{Wf4j%&Du2Y7~8c#Dtt3JWfNAfOx%AEZG>6hR_nK`s

atkG~ZAzr{92`xSNRlAL8IR&f^Lm;w{cL{jM+co{HQQ zS&$D!5RNLSfd*)f_UMj57>y}dgv~gLv$%i=KaEPCrHD3h zyan5_8-Kt+0sd671j0}mHPHag(FOf53ga;q^ALkA2;?6!Wk!A!M(C^t#tKjv z=P|fCkK`JBXNqApDYRM)iXAwIr+5tu0kxS}9VUh?_d`^Xz7`xDs!M8d8fS4C(e-%p zp&^>pBmeC==!u~yMuCi`pNg}kq^0!J_yV+oehc>DBpTrg?%)O9U`Kr(E)CeOXx@-- zvGFH1Hs)F1l-F2^b=Zmn_%r^y)EgW;Z5lVflP6DXi96Arp>sX2W7hO6*#VPJiv0{t6Yti5ocPUT;6sJ(!wOElB-;tdO z_b0#m+5Nho{{Ii&=giLToH^&Zt}_VQ-i z>Ba}=4(i5>gHQX1><#keOA&N&*r(uW%uzAgdz-Hgd+lxh(a`CP!{D-9u-g#l~5T~ zP!-is9W_uBwNM*%P#5)39}UnDjqp7hqY0X#8Gb->v_MO=LTj`^TeQQEXpau)h)(E? zF6fGG=#C!fiC*Z9KIn^n=#K#yh(Y)XgE0g{F$}};Ge%$}MqxC@z=yFIhw+$ziI{}R zn1ZR8hUu7rnV5yyn1i{Phxu55g;<2eSb|@$6w9z2E3gu)5R27VgSA+P_1J)o*o0rP z8C$Rw+prxwuoJtm8+))9`>-Dea1e*^8xG?Lj^cM5LmZCd1Ww`)oWg0G!C9Qcd0fCn z{E17rjK6RNS8)y3aRWDT3%79xcX1E*@c<9;2#@guPw_XN;W=L5C0^klyv7^6#XJ0q z|L`6k@DZQz8DH=fei$%e!A1ZMT*TwsjNQjQbCA#^N@#)-n#2iBa6*$Lp-Gz1Bui+L zCp0M%nv@Ams)QzWLX#$;Nt@85OK8$3G#L__j0sJqgeG%BlO>_an$ToRXtF0XITD)h z5}KR|O|FC{cS4gVp~;)jVq%}RDC;R5XTL4txtAnEOcY~Ag@=ZPhJ}SkMTSL($G-Yh#1okzEIK+e zEY#}_iwf~FK)5$5w#?@uo`6 z8|IA)j}DFTM#RLXOO$YR$d~_J?G1?vjS3Hm@_N0YG4wH!u^|cX|G!s9hcak*c%;|M zwNarV(NS}JTt`zhp(&Qo6i;YMBs3)xno^!P-Lx@CVWVF{C6CD~F5*{59 zse~0VPDr>nGTa*)N)t`|WBzwOJTfLCnt4V>vdr)pq7}Ww^Qvm$C3DXLcE?Lo+5Eo>6d#vg<~IudOejqwPSOK zc|CbNtKursHx2e&iklzh_4M{+E}1D_&G9W`yi(EU!sXZuF%n<=GrJxxUvEJgV(blktZzH?v!xt4{;+pdp!k`c>ao8)zj-a_&NP|O$`kR&aaPfkT14dyKqlE zPmqY%J{W1~HzbDbn{OGab6WQ6Kb1`8c~pjHgXilG1!xjAu^v zRYeWu@Ap+j&>8FT8QEgvdH=Sjd)%$%F`gocJTv3sSH^g@dV)i$#VaUwM{JBI;JF>U zWpxZmFC6=cew{C(n_uNn8DmLed-`q|gGFhjmGt{CpZ9Lizr#k3Q+4;NAolQ?>hx`K znDe9P7vcox_tF1}5BLfj-;k(>U&-Ni_xqHZ1Cx_mYa2?>aTa99Dg4sYui?G?8ra*f zLw)?3)7P(q{rqas->)PC{91?p1N{mb#LZFdC$7N<^c>7J$T7sPj6?luJsRw}eytkMAQSw0GLa8W@+QDD; z?hLsR4} ztBJ-MCcM_K`&hJ&>(={~VFQzbZzJh~g-M%8!LOWqNAqPfE8gN)y{&`0FlAhgQVmT<6-P?q~Ne$ zXW%>HSIkkrf`9kx!0+V0?=io^wIid*t>$6MW!T--mw1J@PB{V+MP|?)aODJ@;$sON#Xs z`F`!!_&0uyc*n~B^{dl+7WKie(Vs}oXX?uL)vsiJzs4DUbuj&UWRWl1uj*Kc3y5(1 z+8oc!WoT+5L!W~Tbx&gGT2ezbQy3b7Z7|U#l|c;|s*%pn;S7cfXEL-ri=m|142{ZR zsAo#r-RGcONki4}0%=Mas)FX|is7XV zsf?j#_!MGjXsDqEVTNKc-phnhEu4uVPXrM{+DJnikuAzlu4qHo@foRNh!`5+35J&S z8A?~q&^k0L&jl3>?L)>&hO(mvER3&gC}$NzTT!7Z1ENzkZdBdSS+uXg4Qm?uh%vPc z1u(BR(ZF^b#=ts;4x&$8Lmlcdnfiv_`e?2eOolI6 zd2l{UQ5B*ehiRzP%+O!x@&l7;&O-1B2FkZIbg32Nqgrc2P4NNr60K2&){ZuGdW@k%K0ZH|iHsx7;|)zjg$agEqV7aK zJCP4`o@D3?Y-qBf&?!V@s-X|Ck$4()fddGe&S!CIhM|rWXS11xZr~oO%rf--Y$iL$ zP|CTS!^?Sw+RZ2Q3k*$1wuOe4ARb*85e460uKXPITg->?bO~Ylg=$`EX!bHDvz(Qn z$_fU?la-_@*3hEWhKj6Z73&N=SkJ^avL!be`fjtKid)#qTe;yjigpJzveVGjT}*s8 zTW&A4wvQcmfV3SX{~r!f?S~2V5ku#W8ftxv+{IA?Ck%N{5{W<9yQesJhJAgOB0X=Y zZLs4pAZg8fMOm!Zm7jLY~?O?qF-FV7VsgXUO+jmUA;P_L`xe-#Joa2~gi z@ft;fp*Rf_Wv;Vr@GG96&J9C*k?JNzikVn~Rk(-8c#b*s5-aK!5yKuNzfCmK@eLz= zca$IFlZJCJ84r;D4mriI*oKd&b(ewAm|5HOiSHR23kSpR6IK*_V5kIEVLSGq&_kky zO*nvJj|@el69!;0*7<05VDDpAi?vVK=YJc@heBvrC0@noOCl06D3400iW=B}XDI)S zG@$u&LW~|SsQ#Bs@)ggAe@HKuzh)P_G1T`hQF}-JxBW|1zo(#3=!2n^$o!E?{lxSA zvmrkoelc|aD<00O_kDcF$8oJ2z zi41Fp$J7^WPGo9jkf}O}O%)9`l`e^?ml&AT)OX2D9YIKPQwI=|!c?-9rmElsqEeaK zhQ4V`HBW1*MLJ%iQ+meAU@8`QGnzVs0hvtA#iYzWzSGZQY9wx>PgYZjvzgkC%Gpgl zN8#^G-N!4amKMw%)YWh#BNsTHUh z!%fkqtf{AHQ;vv~H`N}ek*|WO{`d>iD>Cs)rZQDFbqNcrm|9cS)P`zIwz{cPc#f+z z2!BmeA8V2SEwxRpt7FQ*=(?sd*5k$~R^QZYyhdaLQ^!!Jp{bLo-N@8Yr2L+I@)a>F zeKpL$?Q5=%(|>79I-8mrim{lA`FM!r&8P*OXyzl&KbQ(`Zt4&&v@n&U6*tE}IMbRi zwlU>tT~(di61H}x^dq^%%J!z(b}&`8qbUowJDFPCnJ9KKtU)v zPgALTnR|?0zu|#gXsfiO!eVs%RPvxf5OkJPOf@YdJh-R})m72|B=I|PQ z=aT<_Y5LAHbr{7Lm>RZ-qQZbBrkX4>wHM`=GZ^;c944$_qIkcO!B(-wV#zh`<3AK% zO)cO$>aH=>4nJWEmg5`hucco{{-3TV%o|LZ7{Ad}_$F3?Zoe|s6-P~XgTWT-0fwuc7G_=@Hj}r&jL1=%F#Ukk;Q(X`FO#Q(@ z%x_dFf(|oN+=2H9g@Z>Zf0SKkHD^8mSM>Nq|j=1&H_Of~;ys^b+xju}^Z0$!uAZkQT# zlbqjT>)_mNo&|SIjk`+<@0r?%a`#OIu=Ihc#t%&udBpX&gYu6_8*ZV&6H{B^`ynCpYAW+HLWMlfsbmDbV8y8Nk{rHbkHh%KREal)5+B~O6W%e&e@WSYrbfJHi+(Uw z>7%JMpD4o5)Bw(ZG4;z=wzHpc44yG2JIUg~WRw4YY#xaLR^m|UF8ei})qFEmL6*Wj zmJ%nj6u`wGOD7XsnjdUwS`tgGl3MycnWenREoDt%=`#kUv@|@Gr5UL$t@B#Sn9owG{FXZ66-F1Zl%$}g1u)UHkfqg_RoGGkUlDGO z(4v-(BBGe3BPdhc(irS1VX1g2OGA*Qw53I8UB*)C5Q}HIrT$@-YI->rZfPI(L|CdE zX(sh*4-;x?Ku|}-sdrO&{aO0+y_BXTiHr4AjqzM~~iXUnHyT`aBZNSlsa+rP+}F~#ewJqT zx0GT4DZn=j8EC2HAXfg9rI5iyZ-}J~LrEQu43?PdBP>OYwB(?}C{i<;*JCU# zB<-KDeJoAyahx1)=>rZnV!KQ_l{#|6L&k|Dd3lm&sY1nd0{uP$WuVRt0tbPp>^sTjYW*sZv zK-F$!mA_Ken=Spdg^+GzrrRyu-(jiEE-HAprTlv>_1s6{?Pui&DZ)dRjNcgih^1pk zEmb^bX;Pe};1ibWpS1MnA1v?`I|x6Ww)7VMGeqR9rRV3!|Ml}!>IGJbS{E(tK&3y4 z1j<~p)af#j`O8v)tJKFeF1pS(yJ>0TEpmB>h}^aG?jD8pz*6;xmaaYG=1-{hr!4Gm zOU<5Jn(~6hys}jLAByg^rQ~ldEqQ0@!oTFd<$G5Cf&71BJA9@9zgSA=w-jqwx^6N7 zo9Yc%D&(@~<1PL3&C*=is^_tF0d*4DJRfXr3$j%sv8_i~6U_TbY<)%PWVSjbw>3P4 ztwkwq`EP&K`Bb*<;#O*(tq*Bzg{HH$A2rh3x`>JyY+c6vjJDpOKxSL7uq+GjW#z_b zp3T;w?6%f_XKPX}TQ76l>XFx0a6X%F<7}P6g#3J_fUSQDa%~}7jSAaxu&s!#W<_l^ z_7!9B;EtxRI-(`vaPMiU&Yo^1ghHdy{c~OTuocWYV&3tTm9HwHx2Jw6(Yu zuiG$@wydQSU*H1CnZ-^OyY@wR46AoP=LwVO=Hr`Rep z&DP=RwmdT#cNXVxc{b6Q!+GSG%f+4N+WcGHR=N4M3NN%ZWf6lev330yTgR3W`W3cP ztRmd8wepg!sejpeeZ|&|Yqlb8 z5Y}6^#@%MXyS6UfZ{!bHr& zX?%u)0-DbEcd6+sVge50RAPQu9UPD!1Cj)kB56R!lLmZhoGhR%NSi#MA=rSVDFP~s zKA46x_zy=?2J{tMQU!DXxl;#J|67ob(sxZ0P}Z~oJ%)>J>6jFh3we_DuM`9#yxD#5m4Rl0xFr4h+v*CS3uQrGgzL0?xR*-W{3g#2y^~`LJ9!GPKp3Mge^J_`fkMOYEOpi0qzV&URyv4GN-V3inEGN4?g0`ipRv*=MK zpqwEAe*QyqAT+=~2m|Ve!N~6os1#~r8#06k)G#8TJCOlhk0KS(0ey%e{NodRy||j+y^RMYpF=U?R9fKqU~3BX7&7HvMdz!AE#HGD&{y zGMRoZmSYPxbP8x;=YW=>W*0t-iCu|Sw*bFQBmdo5P!H~lEWV!P5kKPuzM@Dk@`8H3 zxe&i0c^`^~o93aPh($xCxAZmoQq?$*_Wjs?{iz?M8bH{gfdO^GP1GL5Rz!xugdgGX z6&n&zDO4B2@7U`q;4@ZCFiFcT%61p7; z@GG)_lKjq&z^-Fda$G>(<2b?1vFaqB|0AHk;XOslFz0kYh0d^5&jz&T9HBqYXD^WJ zKLeV2DWKh#1Im1b$MV&H)?N$f;&mop<|bR{78AJ5Q|=C{xEIi%`vKj05YV@W|m9ex|;s4=ppbaWT7sT_4o%~%+b#!=I>jw+;clrp`e1!$AO=cq+S zNAJ-j6US(ao|zr3#61LManu6eP0Hb@`FD;kU{_8@ z!*e^4 zro5vo6&!ghajtk}N3*Ipno!lzi)zfiIw7jbo3$J*s_kfI9img05Z7~5r-7r&4IQm( z#H7A=;TA-!6{*9N){dgvI4acE(IsqX=V;oGj#{>N^cdqi zI6kH6$SUAqS|={<>?mCq!rj%;)NYPGcPG3(9rf--7<-e;KIFPDx$Ez!#{fsy2ReE( zh%^jl;31Cw7|QB~IV$%v6CUAc|47b_qK3w>FrTB%V~OB6A~?ZO=tNGeoaAWhWQt}g zGo9vW-gF9Q21PQ6b~%dJ?dbR(M~U}2nzNtC9B}mGAxCR}V_`># z&QV9Bes>gg%+bj>M@deQ|9K}J-TZ?APdi$FhA^FT^wW6?@&Xn8CxcybbRNH6Cft8< z?g~*rv#S&rGF@ZGU>+Xe#C1pSZa6x3)6t__j&|N=_uO$*`Y!pt$Bwzru0YoZMD8K^ zKlRYj!bgruJtj0*^@I;Sb@Uu9{&sX56`xT9&$-D9N1a}>(pO9Z3;uER3Wr`h`tuE` zdCLUek-mQ&<^9jm5(F^tJ)!^TsP-pEjXpE!FOFVg;a8udYJNwj(8zF9*Q97H_NwjZ zC zxLSieIbCfTwjg5_a@D)AtB4}JF6wGPaen7m!qq>e zT=}Y$aWyE^)wwWNOTt~fif}bB##PyJu3D9Mm8JrNV`D`oTFF)J%B~h5WffN|kg}?) zNoZM(n^bq@VpR=Sb!)onSj*Mj+O9lxUCpoOYD#?;+Q8M`hAzM8b~UfD>(ft7T(xNG z^7DCDothDaA6))H>1r*iws7?kQ(LmSR<3fjc2&ELt7>gs^=n7ye`J;IUCrs>>TpL_ z`#ZUM(%IGhE{xHQ8+UhAvIk-ANqTy@YS7!&@II~v_aznmTrKbKBR>ONogC=uzd_{j zCs$d9@PE*Tx~e#gC=7Si?Pn%7!qx1NuBMN2bzn5%9m5K^_VQSAJkFJY_2XSNo4_O| z5>3pU#6*yG3JaL(>Nm0&`{&QW`m`5>T z#C%sd7O+}mUPzDdMXm}g=CcS|;%XBf!T811jis(qFK4nCzk=GpoRv%trB|^S`0mg| z$Fg$7t|mll$RReab+vAttD)JXZ2cI9C57FU_Jy80P6kZ+r- z-_UG3sld=3jEDL=S?De%yNA>v?_O8C_LBd}`xtCLTj~HaKj_Lj#G8l7J6<2*W=EOe z@2)Pw#hGIa7RL&XyDD{pJfC#+0muGeOP+ESdYVc{Srk6wDheIY1y}I|f1Y)f{T#dJ z961cdigrkH~fkEjJq!-&U>-{%Q4#nq>-!v5x|^o+uI&copasd(wC z`#((NwX16gf9tB@JI*7+f3AwY=LR3B_>XKScs^0ExPYObsroNeI3|B}CBLg}C}Z$^ zK_`>^o8Uw~^!dgLF$^EU z*HVr0#H&@Jcx}bupmX&bafBioRZts^(Fz^W9sMy3 zW09VLrqa*DFNnn^?8E^a!x{XAPq>XIcnt^fNaahxjnEpiu@I}U8N2ZtPT)MQ;x3-z zH9o>ZB5EZCG9U*EBOayUg^MUuKs_`;2Xuw67fpW*!z9G_>Y_IEGm$bCtHc71mtrk8 z;|CnVP8`JVIE72Nfrog3clZhii5Vva(jg0SqEIUGUy6fBR6X@z9kL@oN+28+P!o;N z5*^VCKVcLmVGfpJE#{#Twqh6d<1pfI8W(T{x9|YF;mh+iv7U192A^O-X^95XATx3z zABvz9B2gKC^Ixgz(ljL^OvfB7!g9o>CI9O=*o+<6hr@`&X<0U@AgwnIW=`-Rx6hH}tBN^|dLv|lceiTC}Vo({i@jaTO z9S-ua=z#&4%NLz-^j$dL8-p+c<1h{Lu@q~t8M|=^aX5?1xP?dX**vFTaPSK86ytmP zkLaI)ykR#iD^ospRemB1_tSHJ#k-K=j+LUClQt_%&nk|ES_*#Zy z3Z?49SiP6Wa5#~Qjd$7Ni{T|CBfyu!cmeWWoEfD2D~9!N-o zj3|u6$by{6kD@4vFhrs(Dq~PKewa<)9BnZeGqD~iD^Mfd{7Oe3iHxXj@%>*NzL%@Y zi!ekW1{F{RHBbi)&=^h75Oq-#&G7?Tp%eOHAckTQ*5Oy2#U1>O*La8b_*8-XyBs9q zZ+em=GYX;dshELMe3QA9ejT>s7Q5;o{ZX93Mcl)y zgx5{K>I3~ZB==QfP~=5ncu^VEQ6J6F7G2OEBQOaIu@Q%H3TJT_Z}1;J;tLGeaG}bi z5=oH)so_gUlMz{v9XU}Fm9YgG`46bMkq-qCg-wt6FZA?3pfh@5Fh;?L@tB0ESb&%O zwN%DzMYVzBP1uT^*jt7D|CNLMRe6XY43$s=_0bF+(Hq0z!(`0GN^C+9f83NA`A`fI zxB(ll-NTGUx>AA{EB1Ww}-Uci8-4il@(#IX5Zm@3fMgpGss z$SqFb6fPjDK2JV0Kohh@Hw;2i>SF}`WSl82Euo*v7ocUGIM{?eh(kkM#7#WKOKfYv z!=)kn70nv)Z8!eF`o=u#oAMgVu?Cy5AAjH~9yN_$(9x4WuH@|)&)|8U7qM%4l=Vb; imc-trujDBbo4sd3-#NC`|N3#UOaIrei@i(#>i+?}la+Y@ diff --git a/openpilot/selfdrive/locationd/models/generated/pose.cpp b/openpilot/selfdrive/locationd/models/generated/pose.cpp index e5bb2a85e1..a00a465811 100644 --- a/openpilot/selfdrive/locationd/models/generated/pose.cpp +++ b/openpilot/selfdrive/locationd/models/generated/pose.cpp @@ -17,961 +17,961 @@ const static double MAHA_THRESH_14 = 7.814727903251177; * * * This file is part of 'ekf' * ******************************************************************************/ -void err_fun(double *nom_x, double *delta_x, double *out_3009922513179117509) { - out_3009922513179117509[0] = delta_x[0] + nom_x[0]; - out_3009922513179117509[1] = delta_x[1] + nom_x[1]; - out_3009922513179117509[2] = delta_x[2] + nom_x[2]; - out_3009922513179117509[3] = delta_x[3] + nom_x[3]; - out_3009922513179117509[4] = delta_x[4] + nom_x[4]; - out_3009922513179117509[5] = delta_x[5] + nom_x[5]; - out_3009922513179117509[6] = delta_x[6] + nom_x[6]; - out_3009922513179117509[7] = delta_x[7] + nom_x[7]; - out_3009922513179117509[8] = delta_x[8] + nom_x[8]; - out_3009922513179117509[9] = delta_x[9] + nom_x[9]; - out_3009922513179117509[10] = delta_x[10] + nom_x[10]; - out_3009922513179117509[11] = delta_x[11] + nom_x[11]; - out_3009922513179117509[12] = delta_x[12] + nom_x[12]; - out_3009922513179117509[13] = delta_x[13] + nom_x[13]; - out_3009922513179117509[14] = delta_x[14] + nom_x[14]; - out_3009922513179117509[15] = delta_x[15] + nom_x[15]; - out_3009922513179117509[16] = delta_x[16] + nom_x[16]; - out_3009922513179117509[17] = delta_x[17] + nom_x[17]; +void err_fun(double *nom_x, double *delta_x, double *out_5436717349763929250) { + out_5436717349763929250[0] = delta_x[0] + nom_x[0]; + out_5436717349763929250[1] = delta_x[1] + nom_x[1]; + out_5436717349763929250[2] = delta_x[2] + nom_x[2]; + out_5436717349763929250[3] = delta_x[3] + nom_x[3]; + out_5436717349763929250[4] = delta_x[4] + nom_x[4]; + out_5436717349763929250[5] = delta_x[5] + nom_x[5]; + out_5436717349763929250[6] = delta_x[6] + nom_x[6]; + out_5436717349763929250[7] = delta_x[7] + nom_x[7]; + out_5436717349763929250[8] = delta_x[8] + nom_x[8]; + out_5436717349763929250[9] = delta_x[9] + nom_x[9]; + out_5436717349763929250[10] = delta_x[10] + nom_x[10]; + out_5436717349763929250[11] = delta_x[11] + nom_x[11]; + out_5436717349763929250[12] = delta_x[12] + nom_x[12]; + out_5436717349763929250[13] = delta_x[13] + nom_x[13]; + out_5436717349763929250[14] = delta_x[14] + nom_x[14]; + out_5436717349763929250[15] = delta_x[15] + nom_x[15]; + out_5436717349763929250[16] = delta_x[16] + nom_x[16]; + out_5436717349763929250[17] = delta_x[17] + nom_x[17]; } -void inv_err_fun(double *nom_x, double *true_x, double *out_975857412122476284) { - out_975857412122476284[0] = -nom_x[0] + true_x[0]; - out_975857412122476284[1] = -nom_x[1] + true_x[1]; - out_975857412122476284[2] = -nom_x[2] + true_x[2]; - out_975857412122476284[3] = -nom_x[3] + true_x[3]; - out_975857412122476284[4] = -nom_x[4] + true_x[4]; - out_975857412122476284[5] = -nom_x[5] + true_x[5]; - out_975857412122476284[6] = -nom_x[6] + true_x[6]; - out_975857412122476284[7] = -nom_x[7] + true_x[7]; - out_975857412122476284[8] = -nom_x[8] + true_x[8]; - out_975857412122476284[9] = -nom_x[9] + true_x[9]; - out_975857412122476284[10] = -nom_x[10] + true_x[10]; - out_975857412122476284[11] = -nom_x[11] + true_x[11]; - out_975857412122476284[12] = -nom_x[12] + true_x[12]; - out_975857412122476284[13] = -nom_x[13] + true_x[13]; - out_975857412122476284[14] = -nom_x[14] + true_x[14]; - out_975857412122476284[15] = -nom_x[15] + true_x[15]; - out_975857412122476284[16] = -nom_x[16] + true_x[16]; - out_975857412122476284[17] = -nom_x[17] + true_x[17]; +void inv_err_fun(double *nom_x, double *true_x, double *out_2267989734965085487) { + out_2267989734965085487[0] = -nom_x[0] + true_x[0]; + out_2267989734965085487[1] = -nom_x[1] + true_x[1]; + out_2267989734965085487[2] = -nom_x[2] + true_x[2]; + out_2267989734965085487[3] = -nom_x[3] + true_x[3]; + out_2267989734965085487[4] = -nom_x[4] + true_x[4]; + out_2267989734965085487[5] = -nom_x[5] + true_x[5]; + out_2267989734965085487[6] = -nom_x[6] + true_x[6]; + out_2267989734965085487[7] = -nom_x[7] + true_x[7]; + out_2267989734965085487[8] = -nom_x[8] + true_x[8]; + out_2267989734965085487[9] = -nom_x[9] + true_x[9]; + out_2267989734965085487[10] = -nom_x[10] + true_x[10]; + out_2267989734965085487[11] = -nom_x[11] + true_x[11]; + out_2267989734965085487[12] = -nom_x[12] + true_x[12]; + out_2267989734965085487[13] = -nom_x[13] + true_x[13]; + out_2267989734965085487[14] = -nom_x[14] + true_x[14]; + out_2267989734965085487[15] = -nom_x[15] + true_x[15]; + out_2267989734965085487[16] = -nom_x[16] + true_x[16]; + out_2267989734965085487[17] = -nom_x[17] + true_x[17]; } -void H_mod_fun(double *state, double *out_5701585413794445279) { - out_5701585413794445279[0] = 1.0; - out_5701585413794445279[1] = 0.0; - out_5701585413794445279[2] = 0.0; - out_5701585413794445279[3] = 0.0; - out_5701585413794445279[4] = 0.0; - out_5701585413794445279[5] = 0.0; - out_5701585413794445279[6] = 0.0; - out_5701585413794445279[7] = 0.0; - out_5701585413794445279[8] = 0.0; - out_5701585413794445279[9] = 0.0; - out_5701585413794445279[10] = 0.0; - out_5701585413794445279[11] = 0.0; - out_5701585413794445279[12] = 0.0; - out_5701585413794445279[13] = 0.0; - out_5701585413794445279[14] = 0.0; - out_5701585413794445279[15] = 0.0; - out_5701585413794445279[16] = 0.0; - out_5701585413794445279[17] = 0.0; - out_5701585413794445279[18] = 0.0; - out_5701585413794445279[19] = 1.0; - out_5701585413794445279[20] = 0.0; - out_5701585413794445279[21] = 0.0; - out_5701585413794445279[22] = 0.0; - out_5701585413794445279[23] = 0.0; - out_5701585413794445279[24] = 0.0; - out_5701585413794445279[25] = 0.0; - out_5701585413794445279[26] = 0.0; - out_5701585413794445279[27] = 0.0; - out_5701585413794445279[28] = 0.0; - out_5701585413794445279[29] = 0.0; - out_5701585413794445279[30] = 0.0; - out_5701585413794445279[31] = 0.0; - out_5701585413794445279[32] = 0.0; - out_5701585413794445279[33] = 0.0; - out_5701585413794445279[34] = 0.0; - out_5701585413794445279[35] = 0.0; - out_5701585413794445279[36] = 0.0; - out_5701585413794445279[37] = 0.0; - out_5701585413794445279[38] = 1.0; - out_5701585413794445279[39] = 0.0; - out_5701585413794445279[40] = 0.0; - out_5701585413794445279[41] = 0.0; - out_5701585413794445279[42] = 0.0; - out_5701585413794445279[43] = 0.0; - out_5701585413794445279[44] = 0.0; - out_5701585413794445279[45] = 0.0; - out_5701585413794445279[46] = 0.0; - out_5701585413794445279[47] = 0.0; - out_5701585413794445279[48] = 0.0; - out_5701585413794445279[49] = 0.0; - out_5701585413794445279[50] = 0.0; - out_5701585413794445279[51] = 0.0; - out_5701585413794445279[52] = 0.0; - out_5701585413794445279[53] = 0.0; - out_5701585413794445279[54] = 0.0; - out_5701585413794445279[55] = 0.0; - out_5701585413794445279[56] = 0.0; - out_5701585413794445279[57] = 1.0; - out_5701585413794445279[58] = 0.0; - out_5701585413794445279[59] = 0.0; - out_5701585413794445279[60] = 0.0; - out_5701585413794445279[61] = 0.0; - out_5701585413794445279[62] = 0.0; - out_5701585413794445279[63] = 0.0; - out_5701585413794445279[64] = 0.0; - out_5701585413794445279[65] = 0.0; - out_5701585413794445279[66] = 0.0; - out_5701585413794445279[67] = 0.0; - out_5701585413794445279[68] = 0.0; - out_5701585413794445279[69] = 0.0; - out_5701585413794445279[70] = 0.0; - out_5701585413794445279[71] = 0.0; - out_5701585413794445279[72] = 0.0; - out_5701585413794445279[73] = 0.0; - out_5701585413794445279[74] = 0.0; - out_5701585413794445279[75] = 0.0; - out_5701585413794445279[76] = 1.0; - out_5701585413794445279[77] = 0.0; - out_5701585413794445279[78] = 0.0; - out_5701585413794445279[79] = 0.0; - out_5701585413794445279[80] = 0.0; - out_5701585413794445279[81] = 0.0; - out_5701585413794445279[82] = 0.0; - out_5701585413794445279[83] = 0.0; - out_5701585413794445279[84] = 0.0; - out_5701585413794445279[85] = 0.0; - out_5701585413794445279[86] = 0.0; - out_5701585413794445279[87] = 0.0; - out_5701585413794445279[88] = 0.0; - out_5701585413794445279[89] = 0.0; - out_5701585413794445279[90] = 0.0; - out_5701585413794445279[91] = 0.0; - out_5701585413794445279[92] = 0.0; - out_5701585413794445279[93] = 0.0; - out_5701585413794445279[94] = 0.0; - out_5701585413794445279[95] = 1.0; - out_5701585413794445279[96] = 0.0; - out_5701585413794445279[97] = 0.0; - out_5701585413794445279[98] = 0.0; - out_5701585413794445279[99] = 0.0; - out_5701585413794445279[100] = 0.0; - out_5701585413794445279[101] = 0.0; - out_5701585413794445279[102] = 0.0; - out_5701585413794445279[103] = 0.0; - out_5701585413794445279[104] = 0.0; - out_5701585413794445279[105] = 0.0; - out_5701585413794445279[106] = 0.0; - out_5701585413794445279[107] = 0.0; - out_5701585413794445279[108] = 0.0; - out_5701585413794445279[109] = 0.0; - out_5701585413794445279[110] = 0.0; - out_5701585413794445279[111] = 0.0; - out_5701585413794445279[112] = 0.0; - out_5701585413794445279[113] = 0.0; - out_5701585413794445279[114] = 1.0; - out_5701585413794445279[115] = 0.0; - out_5701585413794445279[116] = 0.0; - out_5701585413794445279[117] = 0.0; - out_5701585413794445279[118] = 0.0; - out_5701585413794445279[119] = 0.0; - out_5701585413794445279[120] = 0.0; - out_5701585413794445279[121] = 0.0; - out_5701585413794445279[122] = 0.0; - out_5701585413794445279[123] = 0.0; - out_5701585413794445279[124] = 0.0; - out_5701585413794445279[125] = 0.0; - out_5701585413794445279[126] = 0.0; - out_5701585413794445279[127] = 0.0; - out_5701585413794445279[128] = 0.0; - out_5701585413794445279[129] = 0.0; - out_5701585413794445279[130] = 0.0; - out_5701585413794445279[131] = 0.0; - out_5701585413794445279[132] = 0.0; - out_5701585413794445279[133] = 1.0; - out_5701585413794445279[134] = 0.0; - out_5701585413794445279[135] = 0.0; - out_5701585413794445279[136] = 0.0; - out_5701585413794445279[137] = 0.0; - out_5701585413794445279[138] = 0.0; - out_5701585413794445279[139] = 0.0; - out_5701585413794445279[140] = 0.0; - out_5701585413794445279[141] = 0.0; - out_5701585413794445279[142] = 0.0; - out_5701585413794445279[143] = 0.0; - out_5701585413794445279[144] = 0.0; - out_5701585413794445279[145] = 0.0; - out_5701585413794445279[146] = 0.0; - out_5701585413794445279[147] = 0.0; - out_5701585413794445279[148] = 0.0; - out_5701585413794445279[149] = 0.0; - out_5701585413794445279[150] = 0.0; - out_5701585413794445279[151] = 0.0; - out_5701585413794445279[152] = 1.0; - out_5701585413794445279[153] = 0.0; - out_5701585413794445279[154] = 0.0; - out_5701585413794445279[155] = 0.0; - out_5701585413794445279[156] = 0.0; - out_5701585413794445279[157] = 0.0; - out_5701585413794445279[158] = 0.0; - out_5701585413794445279[159] = 0.0; - out_5701585413794445279[160] = 0.0; - out_5701585413794445279[161] = 0.0; - out_5701585413794445279[162] = 0.0; - out_5701585413794445279[163] = 0.0; - out_5701585413794445279[164] = 0.0; - out_5701585413794445279[165] = 0.0; - out_5701585413794445279[166] = 0.0; - out_5701585413794445279[167] = 0.0; - out_5701585413794445279[168] = 0.0; - out_5701585413794445279[169] = 0.0; - out_5701585413794445279[170] = 0.0; - out_5701585413794445279[171] = 1.0; - out_5701585413794445279[172] = 0.0; - out_5701585413794445279[173] = 0.0; - out_5701585413794445279[174] = 0.0; - out_5701585413794445279[175] = 0.0; - out_5701585413794445279[176] = 0.0; - out_5701585413794445279[177] = 0.0; - out_5701585413794445279[178] = 0.0; - out_5701585413794445279[179] = 0.0; - out_5701585413794445279[180] = 0.0; - out_5701585413794445279[181] = 0.0; - out_5701585413794445279[182] = 0.0; - out_5701585413794445279[183] = 0.0; - out_5701585413794445279[184] = 0.0; - out_5701585413794445279[185] = 0.0; - out_5701585413794445279[186] = 0.0; - out_5701585413794445279[187] = 0.0; - out_5701585413794445279[188] = 0.0; - out_5701585413794445279[189] = 0.0; - out_5701585413794445279[190] = 1.0; - out_5701585413794445279[191] = 0.0; - out_5701585413794445279[192] = 0.0; - out_5701585413794445279[193] = 0.0; - out_5701585413794445279[194] = 0.0; - out_5701585413794445279[195] = 0.0; - out_5701585413794445279[196] = 0.0; - out_5701585413794445279[197] = 0.0; - out_5701585413794445279[198] = 0.0; - out_5701585413794445279[199] = 0.0; - out_5701585413794445279[200] = 0.0; - out_5701585413794445279[201] = 0.0; - out_5701585413794445279[202] = 0.0; - out_5701585413794445279[203] = 0.0; - out_5701585413794445279[204] = 0.0; - out_5701585413794445279[205] = 0.0; - out_5701585413794445279[206] = 0.0; - out_5701585413794445279[207] = 0.0; - out_5701585413794445279[208] = 0.0; - out_5701585413794445279[209] = 1.0; - out_5701585413794445279[210] = 0.0; - out_5701585413794445279[211] = 0.0; - out_5701585413794445279[212] = 0.0; - out_5701585413794445279[213] = 0.0; - out_5701585413794445279[214] = 0.0; - out_5701585413794445279[215] = 0.0; - out_5701585413794445279[216] = 0.0; - out_5701585413794445279[217] = 0.0; - out_5701585413794445279[218] = 0.0; - out_5701585413794445279[219] = 0.0; - out_5701585413794445279[220] = 0.0; - out_5701585413794445279[221] = 0.0; - out_5701585413794445279[222] = 0.0; - out_5701585413794445279[223] = 0.0; - out_5701585413794445279[224] = 0.0; - out_5701585413794445279[225] = 0.0; - out_5701585413794445279[226] = 0.0; - out_5701585413794445279[227] = 0.0; - out_5701585413794445279[228] = 1.0; - out_5701585413794445279[229] = 0.0; - out_5701585413794445279[230] = 0.0; - out_5701585413794445279[231] = 0.0; - out_5701585413794445279[232] = 0.0; - out_5701585413794445279[233] = 0.0; - out_5701585413794445279[234] = 0.0; - out_5701585413794445279[235] = 0.0; - out_5701585413794445279[236] = 0.0; - out_5701585413794445279[237] = 0.0; - out_5701585413794445279[238] = 0.0; - out_5701585413794445279[239] = 0.0; - out_5701585413794445279[240] = 0.0; - out_5701585413794445279[241] = 0.0; - out_5701585413794445279[242] = 0.0; - out_5701585413794445279[243] = 0.0; - out_5701585413794445279[244] = 0.0; - out_5701585413794445279[245] = 0.0; - out_5701585413794445279[246] = 0.0; - out_5701585413794445279[247] = 1.0; - out_5701585413794445279[248] = 0.0; - out_5701585413794445279[249] = 0.0; - out_5701585413794445279[250] = 0.0; - out_5701585413794445279[251] = 0.0; - out_5701585413794445279[252] = 0.0; - out_5701585413794445279[253] = 0.0; - out_5701585413794445279[254] = 0.0; - out_5701585413794445279[255] = 0.0; - out_5701585413794445279[256] = 0.0; - out_5701585413794445279[257] = 0.0; - out_5701585413794445279[258] = 0.0; - out_5701585413794445279[259] = 0.0; - out_5701585413794445279[260] = 0.0; - out_5701585413794445279[261] = 0.0; - out_5701585413794445279[262] = 0.0; - out_5701585413794445279[263] = 0.0; - out_5701585413794445279[264] = 0.0; - out_5701585413794445279[265] = 0.0; - out_5701585413794445279[266] = 1.0; - out_5701585413794445279[267] = 0.0; - out_5701585413794445279[268] = 0.0; - out_5701585413794445279[269] = 0.0; - out_5701585413794445279[270] = 0.0; - out_5701585413794445279[271] = 0.0; - out_5701585413794445279[272] = 0.0; - out_5701585413794445279[273] = 0.0; - out_5701585413794445279[274] = 0.0; - out_5701585413794445279[275] = 0.0; - out_5701585413794445279[276] = 0.0; - out_5701585413794445279[277] = 0.0; - out_5701585413794445279[278] = 0.0; - out_5701585413794445279[279] = 0.0; - out_5701585413794445279[280] = 0.0; - out_5701585413794445279[281] = 0.0; - out_5701585413794445279[282] = 0.0; - out_5701585413794445279[283] = 0.0; - out_5701585413794445279[284] = 0.0; - out_5701585413794445279[285] = 1.0; - out_5701585413794445279[286] = 0.0; - out_5701585413794445279[287] = 0.0; - out_5701585413794445279[288] = 0.0; - out_5701585413794445279[289] = 0.0; - out_5701585413794445279[290] = 0.0; - out_5701585413794445279[291] = 0.0; - out_5701585413794445279[292] = 0.0; - out_5701585413794445279[293] = 0.0; - out_5701585413794445279[294] = 0.0; - out_5701585413794445279[295] = 0.0; - out_5701585413794445279[296] = 0.0; - out_5701585413794445279[297] = 0.0; - out_5701585413794445279[298] = 0.0; - out_5701585413794445279[299] = 0.0; - out_5701585413794445279[300] = 0.0; - out_5701585413794445279[301] = 0.0; - out_5701585413794445279[302] = 0.0; - out_5701585413794445279[303] = 0.0; - out_5701585413794445279[304] = 1.0; - out_5701585413794445279[305] = 0.0; - out_5701585413794445279[306] = 0.0; - out_5701585413794445279[307] = 0.0; - out_5701585413794445279[308] = 0.0; - out_5701585413794445279[309] = 0.0; - out_5701585413794445279[310] = 0.0; - out_5701585413794445279[311] = 0.0; - out_5701585413794445279[312] = 0.0; - out_5701585413794445279[313] = 0.0; - out_5701585413794445279[314] = 0.0; - out_5701585413794445279[315] = 0.0; - out_5701585413794445279[316] = 0.0; - out_5701585413794445279[317] = 0.0; - out_5701585413794445279[318] = 0.0; - out_5701585413794445279[319] = 0.0; - out_5701585413794445279[320] = 0.0; - out_5701585413794445279[321] = 0.0; - out_5701585413794445279[322] = 0.0; - out_5701585413794445279[323] = 1.0; +void H_mod_fun(double *state, double *out_7252406541217060893) { + out_7252406541217060893[0] = 1.0; + out_7252406541217060893[1] = 0.0; + out_7252406541217060893[2] = 0.0; + out_7252406541217060893[3] = 0.0; + out_7252406541217060893[4] = 0.0; + out_7252406541217060893[5] = 0.0; + out_7252406541217060893[6] = 0.0; + out_7252406541217060893[7] = 0.0; + out_7252406541217060893[8] = 0.0; + out_7252406541217060893[9] = 0.0; + out_7252406541217060893[10] = 0.0; + out_7252406541217060893[11] = 0.0; + out_7252406541217060893[12] = 0.0; + out_7252406541217060893[13] = 0.0; + out_7252406541217060893[14] = 0.0; + out_7252406541217060893[15] = 0.0; + out_7252406541217060893[16] = 0.0; + out_7252406541217060893[17] = 0.0; + out_7252406541217060893[18] = 0.0; + out_7252406541217060893[19] = 1.0; + out_7252406541217060893[20] = 0.0; + out_7252406541217060893[21] = 0.0; + out_7252406541217060893[22] = 0.0; + out_7252406541217060893[23] = 0.0; + out_7252406541217060893[24] = 0.0; + out_7252406541217060893[25] = 0.0; + out_7252406541217060893[26] = 0.0; + out_7252406541217060893[27] = 0.0; + out_7252406541217060893[28] = 0.0; + out_7252406541217060893[29] = 0.0; + out_7252406541217060893[30] = 0.0; + out_7252406541217060893[31] = 0.0; + out_7252406541217060893[32] = 0.0; + out_7252406541217060893[33] = 0.0; + out_7252406541217060893[34] = 0.0; + out_7252406541217060893[35] = 0.0; + out_7252406541217060893[36] = 0.0; + out_7252406541217060893[37] = 0.0; + out_7252406541217060893[38] = 1.0; + out_7252406541217060893[39] = 0.0; + out_7252406541217060893[40] = 0.0; + out_7252406541217060893[41] = 0.0; + out_7252406541217060893[42] = 0.0; + out_7252406541217060893[43] = 0.0; + out_7252406541217060893[44] = 0.0; + out_7252406541217060893[45] = 0.0; + out_7252406541217060893[46] = 0.0; + out_7252406541217060893[47] = 0.0; + out_7252406541217060893[48] = 0.0; + out_7252406541217060893[49] = 0.0; + out_7252406541217060893[50] = 0.0; + out_7252406541217060893[51] = 0.0; + out_7252406541217060893[52] = 0.0; + out_7252406541217060893[53] = 0.0; + out_7252406541217060893[54] = 0.0; + out_7252406541217060893[55] = 0.0; + out_7252406541217060893[56] = 0.0; + out_7252406541217060893[57] = 1.0; + out_7252406541217060893[58] = 0.0; + out_7252406541217060893[59] = 0.0; + out_7252406541217060893[60] = 0.0; + out_7252406541217060893[61] = 0.0; + out_7252406541217060893[62] = 0.0; + out_7252406541217060893[63] = 0.0; + out_7252406541217060893[64] = 0.0; + out_7252406541217060893[65] = 0.0; + out_7252406541217060893[66] = 0.0; + out_7252406541217060893[67] = 0.0; + out_7252406541217060893[68] = 0.0; + out_7252406541217060893[69] = 0.0; + out_7252406541217060893[70] = 0.0; + out_7252406541217060893[71] = 0.0; + out_7252406541217060893[72] = 0.0; + out_7252406541217060893[73] = 0.0; + out_7252406541217060893[74] = 0.0; + out_7252406541217060893[75] = 0.0; + out_7252406541217060893[76] = 1.0; + out_7252406541217060893[77] = 0.0; + out_7252406541217060893[78] = 0.0; + out_7252406541217060893[79] = 0.0; + out_7252406541217060893[80] = 0.0; + out_7252406541217060893[81] = 0.0; + out_7252406541217060893[82] = 0.0; + out_7252406541217060893[83] = 0.0; + out_7252406541217060893[84] = 0.0; + out_7252406541217060893[85] = 0.0; + out_7252406541217060893[86] = 0.0; + out_7252406541217060893[87] = 0.0; + out_7252406541217060893[88] = 0.0; + out_7252406541217060893[89] = 0.0; + out_7252406541217060893[90] = 0.0; + out_7252406541217060893[91] = 0.0; + out_7252406541217060893[92] = 0.0; + out_7252406541217060893[93] = 0.0; + out_7252406541217060893[94] = 0.0; + out_7252406541217060893[95] = 1.0; + out_7252406541217060893[96] = 0.0; + out_7252406541217060893[97] = 0.0; + out_7252406541217060893[98] = 0.0; + out_7252406541217060893[99] = 0.0; + out_7252406541217060893[100] = 0.0; + out_7252406541217060893[101] = 0.0; + out_7252406541217060893[102] = 0.0; + out_7252406541217060893[103] = 0.0; + out_7252406541217060893[104] = 0.0; + out_7252406541217060893[105] = 0.0; + out_7252406541217060893[106] = 0.0; + out_7252406541217060893[107] = 0.0; + out_7252406541217060893[108] = 0.0; + out_7252406541217060893[109] = 0.0; + out_7252406541217060893[110] = 0.0; + out_7252406541217060893[111] = 0.0; + out_7252406541217060893[112] = 0.0; + out_7252406541217060893[113] = 0.0; + out_7252406541217060893[114] = 1.0; + out_7252406541217060893[115] = 0.0; + out_7252406541217060893[116] = 0.0; + out_7252406541217060893[117] = 0.0; + out_7252406541217060893[118] = 0.0; + out_7252406541217060893[119] = 0.0; + out_7252406541217060893[120] = 0.0; + out_7252406541217060893[121] = 0.0; + out_7252406541217060893[122] = 0.0; + out_7252406541217060893[123] = 0.0; + out_7252406541217060893[124] = 0.0; + out_7252406541217060893[125] = 0.0; + out_7252406541217060893[126] = 0.0; + out_7252406541217060893[127] = 0.0; + out_7252406541217060893[128] = 0.0; + out_7252406541217060893[129] = 0.0; + out_7252406541217060893[130] = 0.0; + out_7252406541217060893[131] = 0.0; + out_7252406541217060893[132] = 0.0; + out_7252406541217060893[133] = 1.0; + out_7252406541217060893[134] = 0.0; + out_7252406541217060893[135] = 0.0; + out_7252406541217060893[136] = 0.0; + out_7252406541217060893[137] = 0.0; + out_7252406541217060893[138] = 0.0; + out_7252406541217060893[139] = 0.0; + out_7252406541217060893[140] = 0.0; + out_7252406541217060893[141] = 0.0; + out_7252406541217060893[142] = 0.0; + out_7252406541217060893[143] = 0.0; + out_7252406541217060893[144] = 0.0; + out_7252406541217060893[145] = 0.0; + out_7252406541217060893[146] = 0.0; + out_7252406541217060893[147] = 0.0; + out_7252406541217060893[148] = 0.0; + out_7252406541217060893[149] = 0.0; + out_7252406541217060893[150] = 0.0; + out_7252406541217060893[151] = 0.0; + out_7252406541217060893[152] = 1.0; + out_7252406541217060893[153] = 0.0; + out_7252406541217060893[154] = 0.0; + out_7252406541217060893[155] = 0.0; + out_7252406541217060893[156] = 0.0; + out_7252406541217060893[157] = 0.0; + out_7252406541217060893[158] = 0.0; + out_7252406541217060893[159] = 0.0; + out_7252406541217060893[160] = 0.0; + out_7252406541217060893[161] = 0.0; + out_7252406541217060893[162] = 0.0; + out_7252406541217060893[163] = 0.0; + out_7252406541217060893[164] = 0.0; + out_7252406541217060893[165] = 0.0; + out_7252406541217060893[166] = 0.0; + out_7252406541217060893[167] = 0.0; + out_7252406541217060893[168] = 0.0; + out_7252406541217060893[169] = 0.0; + out_7252406541217060893[170] = 0.0; + out_7252406541217060893[171] = 1.0; + out_7252406541217060893[172] = 0.0; + out_7252406541217060893[173] = 0.0; + out_7252406541217060893[174] = 0.0; + out_7252406541217060893[175] = 0.0; + out_7252406541217060893[176] = 0.0; + out_7252406541217060893[177] = 0.0; + out_7252406541217060893[178] = 0.0; + out_7252406541217060893[179] = 0.0; + out_7252406541217060893[180] = 0.0; + out_7252406541217060893[181] = 0.0; + out_7252406541217060893[182] = 0.0; + out_7252406541217060893[183] = 0.0; + out_7252406541217060893[184] = 0.0; + out_7252406541217060893[185] = 0.0; + out_7252406541217060893[186] = 0.0; + out_7252406541217060893[187] = 0.0; + out_7252406541217060893[188] = 0.0; + out_7252406541217060893[189] = 0.0; + out_7252406541217060893[190] = 1.0; + out_7252406541217060893[191] = 0.0; + out_7252406541217060893[192] = 0.0; + out_7252406541217060893[193] = 0.0; + out_7252406541217060893[194] = 0.0; + out_7252406541217060893[195] = 0.0; + out_7252406541217060893[196] = 0.0; + out_7252406541217060893[197] = 0.0; + out_7252406541217060893[198] = 0.0; + out_7252406541217060893[199] = 0.0; + out_7252406541217060893[200] = 0.0; + out_7252406541217060893[201] = 0.0; + out_7252406541217060893[202] = 0.0; + out_7252406541217060893[203] = 0.0; + out_7252406541217060893[204] = 0.0; + out_7252406541217060893[205] = 0.0; + out_7252406541217060893[206] = 0.0; + out_7252406541217060893[207] = 0.0; + out_7252406541217060893[208] = 0.0; + out_7252406541217060893[209] = 1.0; + out_7252406541217060893[210] = 0.0; + out_7252406541217060893[211] = 0.0; + out_7252406541217060893[212] = 0.0; + out_7252406541217060893[213] = 0.0; + out_7252406541217060893[214] = 0.0; + out_7252406541217060893[215] = 0.0; + out_7252406541217060893[216] = 0.0; + out_7252406541217060893[217] = 0.0; + out_7252406541217060893[218] = 0.0; + out_7252406541217060893[219] = 0.0; + out_7252406541217060893[220] = 0.0; + out_7252406541217060893[221] = 0.0; + out_7252406541217060893[222] = 0.0; + out_7252406541217060893[223] = 0.0; + out_7252406541217060893[224] = 0.0; + out_7252406541217060893[225] = 0.0; + out_7252406541217060893[226] = 0.0; + out_7252406541217060893[227] = 0.0; + out_7252406541217060893[228] = 1.0; + out_7252406541217060893[229] = 0.0; + out_7252406541217060893[230] = 0.0; + out_7252406541217060893[231] = 0.0; + out_7252406541217060893[232] = 0.0; + out_7252406541217060893[233] = 0.0; + out_7252406541217060893[234] = 0.0; + out_7252406541217060893[235] = 0.0; + out_7252406541217060893[236] = 0.0; + out_7252406541217060893[237] = 0.0; + out_7252406541217060893[238] = 0.0; + out_7252406541217060893[239] = 0.0; + out_7252406541217060893[240] = 0.0; + out_7252406541217060893[241] = 0.0; + out_7252406541217060893[242] = 0.0; + out_7252406541217060893[243] = 0.0; + out_7252406541217060893[244] = 0.0; + out_7252406541217060893[245] = 0.0; + out_7252406541217060893[246] = 0.0; + out_7252406541217060893[247] = 1.0; + out_7252406541217060893[248] = 0.0; + out_7252406541217060893[249] = 0.0; + out_7252406541217060893[250] = 0.0; + out_7252406541217060893[251] = 0.0; + out_7252406541217060893[252] = 0.0; + out_7252406541217060893[253] = 0.0; + out_7252406541217060893[254] = 0.0; + out_7252406541217060893[255] = 0.0; + out_7252406541217060893[256] = 0.0; + out_7252406541217060893[257] = 0.0; + out_7252406541217060893[258] = 0.0; + out_7252406541217060893[259] = 0.0; + out_7252406541217060893[260] = 0.0; + out_7252406541217060893[261] = 0.0; + out_7252406541217060893[262] = 0.0; + out_7252406541217060893[263] = 0.0; + out_7252406541217060893[264] = 0.0; + out_7252406541217060893[265] = 0.0; + out_7252406541217060893[266] = 1.0; + out_7252406541217060893[267] = 0.0; + out_7252406541217060893[268] = 0.0; + out_7252406541217060893[269] = 0.0; + out_7252406541217060893[270] = 0.0; + out_7252406541217060893[271] = 0.0; + out_7252406541217060893[272] = 0.0; + out_7252406541217060893[273] = 0.0; + out_7252406541217060893[274] = 0.0; + out_7252406541217060893[275] = 0.0; + out_7252406541217060893[276] = 0.0; + out_7252406541217060893[277] = 0.0; + out_7252406541217060893[278] = 0.0; + out_7252406541217060893[279] = 0.0; + out_7252406541217060893[280] = 0.0; + out_7252406541217060893[281] = 0.0; + out_7252406541217060893[282] = 0.0; + out_7252406541217060893[283] = 0.0; + out_7252406541217060893[284] = 0.0; + out_7252406541217060893[285] = 1.0; + out_7252406541217060893[286] = 0.0; + out_7252406541217060893[287] = 0.0; + out_7252406541217060893[288] = 0.0; + out_7252406541217060893[289] = 0.0; + out_7252406541217060893[290] = 0.0; + out_7252406541217060893[291] = 0.0; + out_7252406541217060893[292] = 0.0; + out_7252406541217060893[293] = 0.0; + out_7252406541217060893[294] = 0.0; + out_7252406541217060893[295] = 0.0; + out_7252406541217060893[296] = 0.0; + out_7252406541217060893[297] = 0.0; + out_7252406541217060893[298] = 0.0; + out_7252406541217060893[299] = 0.0; + out_7252406541217060893[300] = 0.0; + out_7252406541217060893[301] = 0.0; + out_7252406541217060893[302] = 0.0; + out_7252406541217060893[303] = 0.0; + out_7252406541217060893[304] = 1.0; + out_7252406541217060893[305] = 0.0; + out_7252406541217060893[306] = 0.0; + out_7252406541217060893[307] = 0.0; + out_7252406541217060893[308] = 0.0; + out_7252406541217060893[309] = 0.0; + out_7252406541217060893[310] = 0.0; + out_7252406541217060893[311] = 0.0; + out_7252406541217060893[312] = 0.0; + out_7252406541217060893[313] = 0.0; + out_7252406541217060893[314] = 0.0; + out_7252406541217060893[315] = 0.0; + out_7252406541217060893[316] = 0.0; + out_7252406541217060893[317] = 0.0; + out_7252406541217060893[318] = 0.0; + out_7252406541217060893[319] = 0.0; + out_7252406541217060893[320] = 0.0; + out_7252406541217060893[321] = 0.0; + out_7252406541217060893[322] = 0.0; + out_7252406541217060893[323] = 1.0; } -void f_fun(double *state, double dt, double *out_7100436431164388549) { - out_7100436431164388549[0] = atan2((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), -(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1])); - out_7100436431164388549[1] = asin(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8])); - out_7100436431164388549[2] = atan2(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), -(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2])); - out_7100436431164388549[3] = dt*state[12] + state[3]; - out_7100436431164388549[4] = dt*state[13] + state[4]; - out_7100436431164388549[5] = dt*state[14] + state[5]; - out_7100436431164388549[6] = state[6]; - out_7100436431164388549[7] = state[7]; - out_7100436431164388549[8] = state[8]; - out_7100436431164388549[9] = state[9]; - out_7100436431164388549[10] = state[10]; - out_7100436431164388549[11] = state[11]; - out_7100436431164388549[12] = state[12]; - out_7100436431164388549[13] = state[13]; - out_7100436431164388549[14] = state[14]; - out_7100436431164388549[15] = state[15]; - out_7100436431164388549[16] = state[16]; - out_7100436431164388549[17] = state[17]; +void f_fun(double *state, double dt, double *out_7195877540201438501) { + out_7195877540201438501[0] = atan2((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), -(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1])); + out_7195877540201438501[1] = asin(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8])); + out_7195877540201438501[2] = atan2(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), -(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2])); + out_7195877540201438501[3] = dt*state[12] + state[3]; + out_7195877540201438501[4] = dt*state[13] + state[4]; + out_7195877540201438501[5] = dt*state[14] + state[5]; + out_7195877540201438501[6] = state[6]; + out_7195877540201438501[7] = state[7]; + out_7195877540201438501[8] = state[8]; + out_7195877540201438501[9] = state[9]; + out_7195877540201438501[10] = state[10]; + out_7195877540201438501[11] = state[11]; + out_7195877540201438501[12] = state[12]; + out_7195877540201438501[13] = state[13]; + out_7195877540201438501[14] = state[14]; + out_7195877540201438501[15] = state[15]; + out_7195877540201438501[16] = state[16]; + out_7195877540201438501[17] = state[17]; } -void F_fun(double *state, double dt, double *out_4695823766962492888) { - out_4695823766962492888[0] = ((-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*cos(state[0])*cos(state[1]) - sin(state[0])*cos(dt*state[6])*cos(dt*state[7])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + ((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*cos(state[0])*cos(state[1]) - sin(dt*state[6])*sin(state[0])*cos(dt*state[7])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_4695823766962492888[1] = ((-sin(dt*state[6])*sin(dt*state[8]) - sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*cos(state[1]) - (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*sin(state[1]) - sin(state[1])*cos(dt*state[6])*cos(dt*state[7])*cos(state[0]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*sin(state[1]) + (-sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) + sin(dt*state[8])*cos(dt*state[6]))*cos(state[1]) - sin(dt*state[6])*sin(state[1])*cos(dt*state[7])*cos(state[0]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_4695823766962492888[2] = 0; - out_4695823766962492888[3] = 0; - out_4695823766962492888[4] = 0; - out_4695823766962492888[5] = 0; - out_4695823766962492888[6] = (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(dt*cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*sin(dt*state[8]) - dt*sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-dt*sin(dt*state[6])*cos(dt*state[8]) + dt*sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) - dt*cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (dt*sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_4695823766962492888[7] = (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[6])*sin(dt*state[7])*cos(state[0])*cos(state[1]) + dt*sin(dt*state[6])*sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) - dt*sin(dt*state[6])*sin(state[1])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[7])*cos(dt*state[6])*cos(state[0])*cos(state[1]) + dt*sin(dt*state[8])*sin(state[0])*cos(dt*state[6])*cos(dt*state[7])*cos(state[1]) - dt*sin(state[1])*cos(dt*state[6])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_4695823766962492888[8] = ((dt*sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + dt*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (dt*sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + ((dt*sin(dt*state[6])*sin(dt*state[8]) + dt*sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*cos(dt*state[8]) + dt*sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); - out_4695823766962492888[9] = 0; - out_4695823766962492888[10] = 0; - out_4695823766962492888[11] = 0; - out_4695823766962492888[12] = 0; - out_4695823766962492888[13] = 0; - out_4695823766962492888[14] = 0; - out_4695823766962492888[15] = 0; - out_4695823766962492888[16] = 0; - out_4695823766962492888[17] = 0; - out_4695823766962492888[18] = (-sin(dt*state[7])*sin(state[0])*cos(state[1]) - sin(dt*state[8])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); - out_4695823766962492888[19] = (-sin(dt*state[7])*sin(state[1])*cos(state[0]) + sin(dt*state[8])*sin(state[0])*sin(state[1])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); - out_4695823766962492888[20] = 0; - out_4695823766962492888[21] = 0; - out_4695823766962492888[22] = 0; - out_4695823766962492888[23] = 0; - out_4695823766962492888[24] = 0; - out_4695823766962492888[25] = (dt*sin(dt*state[7])*sin(dt*state[8])*sin(state[0])*cos(state[1]) - dt*sin(dt*state[7])*sin(state[1])*cos(dt*state[8]) + dt*cos(dt*state[7])*cos(state[0])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); - out_4695823766962492888[26] = (-dt*sin(dt*state[8])*sin(state[1])*cos(dt*state[7]) - dt*sin(state[0])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); - out_4695823766962492888[27] = 0; - out_4695823766962492888[28] = 0; - out_4695823766962492888[29] = 0; - out_4695823766962492888[30] = 0; - out_4695823766962492888[31] = 0; - out_4695823766962492888[32] = 0; - out_4695823766962492888[33] = 0; - out_4695823766962492888[34] = 0; - out_4695823766962492888[35] = 0; - out_4695823766962492888[36] = ((sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[7]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[7]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_4695823766962492888[37] = (-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(-sin(dt*state[7])*sin(state[2])*cos(state[0])*cos(state[1]) + sin(dt*state[8])*sin(state[0])*sin(state[2])*cos(dt*state[7])*cos(state[1]) - sin(state[1])*sin(state[2])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*(-sin(dt*state[7])*cos(state[0])*cos(state[1])*cos(state[2]) + sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1])*cos(state[2]) - sin(state[1])*cos(dt*state[7])*cos(dt*state[8])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_4695823766962492888[38] = ((-sin(state[0])*sin(state[2]) - sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (-sin(state[0])*sin(state[1])*sin(state[2]) - cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_4695823766962492888[39] = 0; - out_4695823766962492888[40] = 0; - out_4695823766962492888[41] = 0; - out_4695823766962492888[42] = 0; - out_4695823766962492888[43] = (-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(dt*(sin(state[0])*cos(state[2]) - sin(state[1])*sin(state[2])*cos(state[0]))*cos(dt*state[7]) - dt*(sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[7])*sin(dt*state[8]) - dt*sin(dt*state[7])*sin(state[2])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*(dt*(-sin(state[0])*sin(state[2]) - sin(state[1])*cos(state[0])*cos(state[2]))*cos(dt*state[7]) - dt*(sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[7])*sin(dt*state[8]) - dt*sin(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_4695823766962492888[44] = (dt*(sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*cos(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*sin(state[2])*cos(dt*state[7])*cos(state[1]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + (dt*(sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*cos(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[7])*cos(state[1])*cos(state[2]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); - out_4695823766962492888[45] = 0; - out_4695823766962492888[46] = 0; - out_4695823766962492888[47] = 0; - out_4695823766962492888[48] = 0; - out_4695823766962492888[49] = 0; - out_4695823766962492888[50] = 0; - out_4695823766962492888[51] = 0; - out_4695823766962492888[52] = 0; - out_4695823766962492888[53] = 0; - out_4695823766962492888[54] = 0; - out_4695823766962492888[55] = 0; - out_4695823766962492888[56] = 0; - out_4695823766962492888[57] = 1; - out_4695823766962492888[58] = 0; - out_4695823766962492888[59] = 0; - out_4695823766962492888[60] = 0; - out_4695823766962492888[61] = 0; - out_4695823766962492888[62] = 0; - out_4695823766962492888[63] = 0; - out_4695823766962492888[64] = 0; - out_4695823766962492888[65] = 0; - out_4695823766962492888[66] = dt; - out_4695823766962492888[67] = 0; - out_4695823766962492888[68] = 0; - out_4695823766962492888[69] = 0; - out_4695823766962492888[70] = 0; - out_4695823766962492888[71] = 0; - out_4695823766962492888[72] = 0; - out_4695823766962492888[73] = 0; - out_4695823766962492888[74] = 0; - out_4695823766962492888[75] = 0; - out_4695823766962492888[76] = 1; - out_4695823766962492888[77] = 0; - out_4695823766962492888[78] = 0; - out_4695823766962492888[79] = 0; - out_4695823766962492888[80] = 0; - out_4695823766962492888[81] = 0; - out_4695823766962492888[82] = 0; - out_4695823766962492888[83] = 0; - out_4695823766962492888[84] = 0; - out_4695823766962492888[85] = dt; - out_4695823766962492888[86] = 0; - out_4695823766962492888[87] = 0; - out_4695823766962492888[88] = 0; - out_4695823766962492888[89] = 0; - out_4695823766962492888[90] = 0; - out_4695823766962492888[91] = 0; - out_4695823766962492888[92] = 0; - out_4695823766962492888[93] = 0; - out_4695823766962492888[94] = 0; - out_4695823766962492888[95] = 1; - out_4695823766962492888[96] = 0; - out_4695823766962492888[97] = 0; - out_4695823766962492888[98] = 0; - out_4695823766962492888[99] = 0; - out_4695823766962492888[100] = 0; - out_4695823766962492888[101] = 0; - out_4695823766962492888[102] = 0; - out_4695823766962492888[103] = 0; - out_4695823766962492888[104] = dt; - out_4695823766962492888[105] = 0; - out_4695823766962492888[106] = 0; - out_4695823766962492888[107] = 0; - out_4695823766962492888[108] = 0; - out_4695823766962492888[109] = 0; - out_4695823766962492888[110] = 0; - out_4695823766962492888[111] = 0; - out_4695823766962492888[112] = 0; - out_4695823766962492888[113] = 0; - out_4695823766962492888[114] = 1; - out_4695823766962492888[115] = 0; - out_4695823766962492888[116] = 0; - out_4695823766962492888[117] = 0; - out_4695823766962492888[118] = 0; - out_4695823766962492888[119] = 0; - out_4695823766962492888[120] = 0; - out_4695823766962492888[121] = 0; - out_4695823766962492888[122] = 0; - out_4695823766962492888[123] = 0; - out_4695823766962492888[124] = 0; - out_4695823766962492888[125] = 0; - out_4695823766962492888[126] = 0; - out_4695823766962492888[127] = 0; - out_4695823766962492888[128] = 0; - out_4695823766962492888[129] = 0; - out_4695823766962492888[130] = 0; - out_4695823766962492888[131] = 0; - out_4695823766962492888[132] = 0; - out_4695823766962492888[133] = 1; - out_4695823766962492888[134] = 0; - out_4695823766962492888[135] = 0; - out_4695823766962492888[136] = 0; - out_4695823766962492888[137] = 0; - out_4695823766962492888[138] = 0; - out_4695823766962492888[139] = 0; - out_4695823766962492888[140] = 0; - out_4695823766962492888[141] = 0; - out_4695823766962492888[142] = 0; - out_4695823766962492888[143] = 0; - out_4695823766962492888[144] = 0; - out_4695823766962492888[145] = 0; - out_4695823766962492888[146] = 0; - out_4695823766962492888[147] = 0; - out_4695823766962492888[148] = 0; - out_4695823766962492888[149] = 0; - out_4695823766962492888[150] = 0; - out_4695823766962492888[151] = 0; - out_4695823766962492888[152] = 1; - out_4695823766962492888[153] = 0; - out_4695823766962492888[154] = 0; - out_4695823766962492888[155] = 0; - out_4695823766962492888[156] = 0; - out_4695823766962492888[157] = 0; - out_4695823766962492888[158] = 0; - out_4695823766962492888[159] = 0; - out_4695823766962492888[160] = 0; - out_4695823766962492888[161] = 0; - out_4695823766962492888[162] = 0; - out_4695823766962492888[163] = 0; - out_4695823766962492888[164] = 0; - out_4695823766962492888[165] = 0; - out_4695823766962492888[166] = 0; - out_4695823766962492888[167] = 0; - out_4695823766962492888[168] = 0; - out_4695823766962492888[169] = 0; - out_4695823766962492888[170] = 0; - out_4695823766962492888[171] = 1; - out_4695823766962492888[172] = 0; - out_4695823766962492888[173] = 0; - out_4695823766962492888[174] = 0; - out_4695823766962492888[175] = 0; - out_4695823766962492888[176] = 0; - out_4695823766962492888[177] = 0; - out_4695823766962492888[178] = 0; - out_4695823766962492888[179] = 0; - out_4695823766962492888[180] = 0; - out_4695823766962492888[181] = 0; - out_4695823766962492888[182] = 0; - out_4695823766962492888[183] = 0; - out_4695823766962492888[184] = 0; - out_4695823766962492888[185] = 0; - out_4695823766962492888[186] = 0; - out_4695823766962492888[187] = 0; - out_4695823766962492888[188] = 0; - out_4695823766962492888[189] = 0; - out_4695823766962492888[190] = 1; - out_4695823766962492888[191] = 0; - out_4695823766962492888[192] = 0; - out_4695823766962492888[193] = 0; - out_4695823766962492888[194] = 0; - out_4695823766962492888[195] = 0; - out_4695823766962492888[196] = 0; - out_4695823766962492888[197] = 0; - out_4695823766962492888[198] = 0; - out_4695823766962492888[199] = 0; - out_4695823766962492888[200] = 0; - out_4695823766962492888[201] = 0; - out_4695823766962492888[202] = 0; - out_4695823766962492888[203] = 0; - out_4695823766962492888[204] = 0; - out_4695823766962492888[205] = 0; - out_4695823766962492888[206] = 0; - out_4695823766962492888[207] = 0; - out_4695823766962492888[208] = 0; - out_4695823766962492888[209] = 1; - out_4695823766962492888[210] = 0; - out_4695823766962492888[211] = 0; - out_4695823766962492888[212] = 0; - out_4695823766962492888[213] = 0; - out_4695823766962492888[214] = 0; - out_4695823766962492888[215] = 0; - out_4695823766962492888[216] = 0; - out_4695823766962492888[217] = 0; - out_4695823766962492888[218] = 0; - out_4695823766962492888[219] = 0; - out_4695823766962492888[220] = 0; - out_4695823766962492888[221] = 0; - out_4695823766962492888[222] = 0; - out_4695823766962492888[223] = 0; - out_4695823766962492888[224] = 0; - out_4695823766962492888[225] = 0; - out_4695823766962492888[226] = 0; - out_4695823766962492888[227] = 0; - out_4695823766962492888[228] = 1; - out_4695823766962492888[229] = 0; - out_4695823766962492888[230] = 0; - out_4695823766962492888[231] = 0; - out_4695823766962492888[232] = 0; - out_4695823766962492888[233] = 0; - out_4695823766962492888[234] = 0; - out_4695823766962492888[235] = 0; - out_4695823766962492888[236] = 0; - out_4695823766962492888[237] = 0; - out_4695823766962492888[238] = 0; - out_4695823766962492888[239] = 0; - out_4695823766962492888[240] = 0; - out_4695823766962492888[241] = 0; - out_4695823766962492888[242] = 0; - out_4695823766962492888[243] = 0; - out_4695823766962492888[244] = 0; - out_4695823766962492888[245] = 0; - out_4695823766962492888[246] = 0; - out_4695823766962492888[247] = 1; - out_4695823766962492888[248] = 0; - out_4695823766962492888[249] = 0; - out_4695823766962492888[250] = 0; - out_4695823766962492888[251] = 0; - out_4695823766962492888[252] = 0; - out_4695823766962492888[253] = 0; - out_4695823766962492888[254] = 0; - out_4695823766962492888[255] = 0; - out_4695823766962492888[256] = 0; - out_4695823766962492888[257] = 0; - out_4695823766962492888[258] = 0; - out_4695823766962492888[259] = 0; - out_4695823766962492888[260] = 0; - out_4695823766962492888[261] = 0; - out_4695823766962492888[262] = 0; - out_4695823766962492888[263] = 0; - out_4695823766962492888[264] = 0; - out_4695823766962492888[265] = 0; - out_4695823766962492888[266] = 1; - out_4695823766962492888[267] = 0; - out_4695823766962492888[268] = 0; - out_4695823766962492888[269] = 0; - out_4695823766962492888[270] = 0; - out_4695823766962492888[271] = 0; - out_4695823766962492888[272] = 0; - out_4695823766962492888[273] = 0; - out_4695823766962492888[274] = 0; - out_4695823766962492888[275] = 0; - out_4695823766962492888[276] = 0; - out_4695823766962492888[277] = 0; - out_4695823766962492888[278] = 0; - out_4695823766962492888[279] = 0; - out_4695823766962492888[280] = 0; - out_4695823766962492888[281] = 0; - out_4695823766962492888[282] = 0; - out_4695823766962492888[283] = 0; - out_4695823766962492888[284] = 0; - out_4695823766962492888[285] = 1; - out_4695823766962492888[286] = 0; - out_4695823766962492888[287] = 0; - out_4695823766962492888[288] = 0; - out_4695823766962492888[289] = 0; - out_4695823766962492888[290] = 0; - out_4695823766962492888[291] = 0; - out_4695823766962492888[292] = 0; - out_4695823766962492888[293] = 0; - out_4695823766962492888[294] = 0; - out_4695823766962492888[295] = 0; - out_4695823766962492888[296] = 0; - out_4695823766962492888[297] = 0; - out_4695823766962492888[298] = 0; - out_4695823766962492888[299] = 0; - out_4695823766962492888[300] = 0; - out_4695823766962492888[301] = 0; - out_4695823766962492888[302] = 0; - out_4695823766962492888[303] = 0; - out_4695823766962492888[304] = 1; - out_4695823766962492888[305] = 0; - out_4695823766962492888[306] = 0; - out_4695823766962492888[307] = 0; - out_4695823766962492888[308] = 0; - out_4695823766962492888[309] = 0; - out_4695823766962492888[310] = 0; - out_4695823766962492888[311] = 0; - out_4695823766962492888[312] = 0; - out_4695823766962492888[313] = 0; - out_4695823766962492888[314] = 0; - out_4695823766962492888[315] = 0; - out_4695823766962492888[316] = 0; - out_4695823766962492888[317] = 0; - out_4695823766962492888[318] = 0; - out_4695823766962492888[319] = 0; - out_4695823766962492888[320] = 0; - out_4695823766962492888[321] = 0; - out_4695823766962492888[322] = 0; - out_4695823766962492888[323] = 1; +void F_fun(double *state, double dt, double *out_2191763838467757291) { + out_2191763838467757291[0] = ((-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*cos(state[0])*cos(state[1]) - sin(state[0])*cos(dt*state[6])*cos(dt*state[7])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + ((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*cos(state[0])*cos(state[1]) - sin(dt*state[6])*sin(state[0])*cos(dt*state[7])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_2191763838467757291[1] = ((-sin(dt*state[6])*sin(dt*state[8]) - sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*cos(state[1]) - (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*sin(state[1]) - sin(state[1])*cos(dt*state[6])*cos(dt*state[7])*cos(state[0]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*sin(state[1]) + (-sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) + sin(dt*state[8])*cos(dt*state[6]))*cos(state[1]) - sin(dt*state[6])*sin(state[1])*cos(dt*state[7])*cos(state[0]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_2191763838467757291[2] = 0; + out_2191763838467757291[3] = 0; + out_2191763838467757291[4] = 0; + out_2191763838467757291[5] = 0; + out_2191763838467757291[6] = (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(dt*cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*sin(dt*state[8]) - dt*sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-dt*sin(dt*state[6])*cos(dt*state[8]) + dt*sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) - dt*cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (dt*sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_2191763838467757291[7] = (-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[6])*sin(dt*state[7])*cos(state[0])*cos(state[1]) + dt*sin(dt*state[6])*sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) - dt*sin(dt*state[6])*sin(state[1])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + (-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))*(-dt*sin(dt*state[7])*cos(dt*state[6])*cos(state[0])*cos(state[1]) + dt*sin(dt*state[8])*sin(state[0])*cos(dt*state[6])*cos(dt*state[7])*cos(state[1]) - dt*sin(state[1])*cos(dt*state[6])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_2191763838467757291[8] = ((dt*sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + dt*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (dt*sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]))*(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)) + ((dt*sin(dt*state[6])*sin(dt*state[8]) + dt*sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (-dt*sin(dt*state[6])*cos(dt*state[8]) + dt*sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]))*(-(sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) + (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) - sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/(pow(-(sin(dt*state[6])*sin(dt*state[8]) + sin(dt*state[7])*cos(dt*state[6])*cos(dt*state[8]))*sin(state[1]) + (-sin(dt*state[6])*cos(dt*state[8]) + sin(dt*state[7])*sin(dt*state[8])*cos(dt*state[6]))*sin(state[0])*cos(state[1]) + cos(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2) + pow((sin(dt*state[6])*sin(dt*state[7])*sin(dt*state[8]) + cos(dt*state[6])*cos(dt*state[8]))*sin(state[0])*cos(state[1]) - (sin(dt*state[6])*sin(dt*state[7])*cos(dt*state[8]) - sin(dt*state[8])*cos(dt*state[6]))*sin(state[1]) + sin(dt*state[6])*cos(dt*state[7])*cos(state[0])*cos(state[1]), 2)); + out_2191763838467757291[9] = 0; + out_2191763838467757291[10] = 0; + out_2191763838467757291[11] = 0; + out_2191763838467757291[12] = 0; + out_2191763838467757291[13] = 0; + out_2191763838467757291[14] = 0; + out_2191763838467757291[15] = 0; + out_2191763838467757291[16] = 0; + out_2191763838467757291[17] = 0; + out_2191763838467757291[18] = (-sin(dt*state[7])*sin(state[0])*cos(state[1]) - sin(dt*state[8])*cos(dt*state[7])*cos(state[0])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); + out_2191763838467757291[19] = (-sin(dt*state[7])*sin(state[1])*cos(state[0]) + sin(dt*state[8])*sin(state[0])*sin(state[1])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); + out_2191763838467757291[20] = 0; + out_2191763838467757291[21] = 0; + out_2191763838467757291[22] = 0; + out_2191763838467757291[23] = 0; + out_2191763838467757291[24] = 0; + out_2191763838467757291[25] = (dt*sin(dt*state[7])*sin(dt*state[8])*sin(state[0])*cos(state[1]) - dt*sin(dt*state[7])*sin(state[1])*cos(dt*state[8]) + dt*cos(dt*state[7])*cos(state[0])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); + out_2191763838467757291[26] = (-dt*sin(dt*state[8])*sin(state[1])*cos(dt*state[7]) - dt*sin(state[0])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/sqrt(1 - pow(sin(dt*state[7])*cos(state[0])*cos(state[1]) - sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1]) + sin(state[1])*cos(dt*state[7])*cos(dt*state[8]), 2)); + out_2191763838467757291[27] = 0; + out_2191763838467757291[28] = 0; + out_2191763838467757291[29] = 0; + out_2191763838467757291[30] = 0; + out_2191763838467757291[31] = 0; + out_2191763838467757291[32] = 0; + out_2191763838467757291[33] = 0; + out_2191763838467757291[34] = 0; + out_2191763838467757291[35] = 0; + out_2191763838467757291[36] = ((sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[7]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[7]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_2191763838467757291[37] = (-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(-sin(dt*state[7])*sin(state[2])*cos(state[0])*cos(state[1]) + sin(dt*state[8])*sin(state[0])*sin(state[2])*cos(dt*state[7])*cos(state[1]) - sin(state[1])*sin(state[2])*cos(dt*state[7])*cos(dt*state[8]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*(-sin(dt*state[7])*cos(state[0])*cos(state[1])*cos(state[2]) + sin(dt*state[8])*sin(state[0])*cos(dt*state[7])*cos(state[1])*cos(state[2]) - sin(state[1])*cos(dt*state[7])*cos(dt*state[8])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_2191763838467757291[38] = ((-sin(state[0])*sin(state[2]) - sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (-sin(state[0])*sin(state[1])*sin(state[2]) - cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_2191763838467757291[39] = 0; + out_2191763838467757291[40] = 0; + out_2191763838467757291[41] = 0; + out_2191763838467757291[42] = 0; + out_2191763838467757291[43] = (-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))*(dt*(sin(state[0])*cos(state[2]) - sin(state[1])*sin(state[2])*cos(state[0]))*cos(dt*state[7]) - dt*(sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[7])*sin(dt*state[8]) - dt*sin(dt*state[7])*sin(state[2])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + ((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))*(dt*(-sin(state[0])*sin(state[2]) - sin(state[1])*cos(state[0])*cos(state[2]))*cos(dt*state[7]) - dt*(sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[7])*sin(dt*state[8]) - dt*sin(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_2191763838467757291[44] = (dt*(sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*cos(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*sin(state[2])*cos(dt*state[7])*cos(state[1]))*(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)) + (dt*(sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*cos(dt*state[7])*cos(dt*state[8]) - dt*sin(dt*state[8])*cos(dt*state[7])*cos(state[1])*cos(state[2]))*((-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) - (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) - sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]))/(pow(-(sin(state[0])*sin(state[2]) + sin(state[1])*cos(state[0])*cos(state[2]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*cos(state[2]) - sin(state[2])*cos(state[0]))*sin(dt*state[8])*cos(dt*state[7]) + cos(dt*state[7])*cos(dt*state[8])*cos(state[1])*cos(state[2]), 2) + pow(-(-sin(state[0])*cos(state[2]) + sin(state[1])*sin(state[2])*cos(state[0]))*sin(dt*state[7]) + (sin(state[0])*sin(state[1])*sin(state[2]) + cos(state[0])*cos(state[2]))*sin(dt*state[8])*cos(dt*state[7]) + sin(state[2])*cos(dt*state[7])*cos(dt*state[8])*cos(state[1]), 2)); + out_2191763838467757291[45] = 0; + out_2191763838467757291[46] = 0; + out_2191763838467757291[47] = 0; + out_2191763838467757291[48] = 0; + out_2191763838467757291[49] = 0; + out_2191763838467757291[50] = 0; + out_2191763838467757291[51] = 0; + out_2191763838467757291[52] = 0; + out_2191763838467757291[53] = 0; + out_2191763838467757291[54] = 0; + out_2191763838467757291[55] = 0; + out_2191763838467757291[56] = 0; + out_2191763838467757291[57] = 1; + out_2191763838467757291[58] = 0; + out_2191763838467757291[59] = 0; + out_2191763838467757291[60] = 0; + out_2191763838467757291[61] = 0; + out_2191763838467757291[62] = 0; + out_2191763838467757291[63] = 0; + out_2191763838467757291[64] = 0; + out_2191763838467757291[65] = 0; + out_2191763838467757291[66] = dt; + out_2191763838467757291[67] = 0; + out_2191763838467757291[68] = 0; + out_2191763838467757291[69] = 0; + out_2191763838467757291[70] = 0; + out_2191763838467757291[71] = 0; + out_2191763838467757291[72] = 0; + out_2191763838467757291[73] = 0; + out_2191763838467757291[74] = 0; + out_2191763838467757291[75] = 0; + out_2191763838467757291[76] = 1; + out_2191763838467757291[77] = 0; + out_2191763838467757291[78] = 0; + out_2191763838467757291[79] = 0; + out_2191763838467757291[80] = 0; + out_2191763838467757291[81] = 0; + out_2191763838467757291[82] = 0; + out_2191763838467757291[83] = 0; + out_2191763838467757291[84] = 0; + out_2191763838467757291[85] = dt; + out_2191763838467757291[86] = 0; + out_2191763838467757291[87] = 0; + out_2191763838467757291[88] = 0; + out_2191763838467757291[89] = 0; + out_2191763838467757291[90] = 0; + out_2191763838467757291[91] = 0; + out_2191763838467757291[92] = 0; + out_2191763838467757291[93] = 0; + out_2191763838467757291[94] = 0; + out_2191763838467757291[95] = 1; + out_2191763838467757291[96] = 0; + out_2191763838467757291[97] = 0; + out_2191763838467757291[98] = 0; + out_2191763838467757291[99] = 0; + out_2191763838467757291[100] = 0; + out_2191763838467757291[101] = 0; + out_2191763838467757291[102] = 0; + out_2191763838467757291[103] = 0; + out_2191763838467757291[104] = dt; + out_2191763838467757291[105] = 0; + out_2191763838467757291[106] = 0; + out_2191763838467757291[107] = 0; + out_2191763838467757291[108] = 0; + out_2191763838467757291[109] = 0; + out_2191763838467757291[110] = 0; + out_2191763838467757291[111] = 0; + out_2191763838467757291[112] = 0; + out_2191763838467757291[113] = 0; + out_2191763838467757291[114] = 1; + out_2191763838467757291[115] = 0; + out_2191763838467757291[116] = 0; + out_2191763838467757291[117] = 0; + out_2191763838467757291[118] = 0; + out_2191763838467757291[119] = 0; + out_2191763838467757291[120] = 0; + out_2191763838467757291[121] = 0; + out_2191763838467757291[122] = 0; + out_2191763838467757291[123] = 0; + out_2191763838467757291[124] = 0; + out_2191763838467757291[125] = 0; + out_2191763838467757291[126] = 0; + out_2191763838467757291[127] = 0; + out_2191763838467757291[128] = 0; + out_2191763838467757291[129] = 0; + out_2191763838467757291[130] = 0; + out_2191763838467757291[131] = 0; + out_2191763838467757291[132] = 0; + out_2191763838467757291[133] = 1; + out_2191763838467757291[134] = 0; + out_2191763838467757291[135] = 0; + out_2191763838467757291[136] = 0; + out_2191763838467757291[137] = 0; + out_2191763838467757291[138] = 0; + out_2191763838467757291[139] = 0; + out_2191763838467757291[140] = 0; + out_2191763838467757291[141] = 0; + out_2191763838467757291[142] = 0; + out_2191763838467757291[143] = 0; + out_2191763838467757291[144] = 0; + out_2191763838467757291[145] = 0; + out_2191763838467757291[146] = 0; + out_2191763838467757291[147] = 0; + out_2191763838467757291[148] = 0; + out_2191763838467757291[149] = 0; + out_2191763838467757291[150] = 0; + out_2191763838467757291[151] = 0; + out_2191763838467757291[152] = 1; + out_2191763838467757291[153] = 0; + out_2191763838467757291[154] = 0; + out_2191763838467757291[155] = 0; + out_2191763838467757291[156] = 0; + out_2191763838467757291[157] = 0; + out_2191763838467757291[158] = 0; + out_2191763838467757291[159] = 0; + out_2191763838467757291[160] = 0; + out_2191763838467757291[161] = 0; + out_2191763838467757291[162] = 0; + out_2191763838467757291[163] = 0; + out_2191763838467757291[164] = 0; + out_2191763838467757291[165] = 0; + out_2191763838467757291[166] = 0; + out_2191763838467757291[167] = 0; + out_2191763838467757291[168] = 0; + out_2191763838467757291[169] = 0; + out_2191763838467757291[170] = 0; + out_2191763838467757291[171] = 1; + out_2191763838467757291[172] = 0; + out_2191763838467757291[173] = 0; + out_2191763838467757291[174] = 0; + out_2191763838467757291[175] = 0; + out_2191763838467757291[176] = 0; + out_2191763838467757291[177] = 0; + out_2191763838467757291[178] = 0; + out_2191763838467757291[179] = 0; + out_2191763838467757291[180] = 0; + out_2191763838467757291[181] = 0; + out_2191763838467757291[182] = 0; + out_2191763838467757291[183] = 0; + out_2191763838467757291[184] = 0; + out_2191763838467757291[185] = 0; + out_2191763838467757291[186] = 0; + out_2191763838467757291[187] = 0; + out_2191763838467757291[188] = 0; + out_2191763838467757291[189] = 0; + out_2191763838467757291[190] = 1; + out_2191763838467757291[191] = 0; + out_2191763838467757291[192] = 0; + out_2191763838467757291[193] = 0; + out_2191763838467757291[194] = 0; + out_2191763838467757291[195] = 0; + out_2191763838467757291[196] = 0; + out_2191763838467757291[197] = 0; + out_2191763838467757291[198] = 0; + out_2191763838467757291[199] = 0; + out_2191763838467757291[200] = 0; + out_2191763838467757291[201] = 0; + out_2191763838467757291[202] = 0; + out_2191763838467757291[203] = 0; + out_2191763838467757291[204] = 0; + out_2191763838467757291[205] = 0; + out_2191763838467757291[206] = 0; + out_2191763838467757291[207] = 0; + out_2191763838467757291[208] = 0; + out_2191763838467757291[209] = 1; + out_2191763838467757291[210] = 0; + out_2191763838467757291[211] = 0; + out_2191763838467757291[212] = 0; + out_2191763838467757291[213] = 0; + out_2191763838467757291[214] = 0; + out_2191763838467757291[215] = 0; + out_2191763838467757291[216] = 0; + out_2191763838467757291[217] = 0; + out_2191763838467757291[218] = 0; + out_2191763838467757291[219] = 0; + out_2191763838467757291[220] = 0; + out_2191763838467757291[221] = 0; + out_2191763838467757291[222] = 0; + out_2191763838467757291[223] = 0; + out_2191763838467757291[224] = 0; + out_2191763838467757291[225] = 0; + out_2191763838467757291[226] = 0; + out_2191763838467757291[227] = 0; + out_2191763838467757291[228] = 1; + out_2191763838467757291[229] = 0; + out_2191763838467757291[230] = 0; + out_2191763838467757291[231] = 0; + out_2191763838467757291[232] = 0; + out_2191763838467757291[233] = 0; + out_2191763838467757291[234] = 0; + out_2191763838467757291[235] = 0; + out_2191763838467757291[236] = 0; + out_2191763838467757291[237] = 0; + out_2191763838467757291[238] = 0; + out_2191763838467757291[239] = 0; + out_2191763838467757291[240] = 0; + out_2191763838467757291[241] = 0; + out_2191763838467757291[242] = 0; + out_2191763838467757291[243] = 0; + out_2191763838467757291[244] = 0; + out_2191763838467757291[245] = 0; + out_2191763838467757291[246] = 0; + out_2191763838467757291[247] = 1; + out_2191763838467757291[248] = 0; + out_2191763838467757291[249] = 0; + out_2191763838467757291[250] = 0; + out_2191763838467757291[251] = 0; + out_2191763838467757291[252] = 0; + out_2191763838467757291[253] = 0; + out_2191763838467757291[254] = 0; + out_2191763838467757291[255] = 0; + out_2191763838467757291[256] = 0; + out_2191763838467757291[257] = 0; + out_2191763838467757291[258] = 0; + out_2191763838467757291[259] = 0; + out_2191763838467757291[260] = 0; + out_2191763838467757291[261] = 0; + out_2191763838467757291[262] = 0; + out_2191763838467757291[263] = 0; + out_2191763838467757291[264] = 0; + out_2191763838467757291[265] = 0; + out_2191763838467757291[266] = 1; + out_2191763838467757291[267] = 0; + out_2191763838467757291[268] = 0; + out_2191763838467757291[269] = 0; + out_2191763838467757291[270] = 0; + out_2191763838467757291[271] = 0; + out_2191763838467757291[272] = 0; + out_2191763838467757291[273] = 0; + out_2191763838467757291[274] = 0; + out_2191763838467757291[275] = 0; + out_2191763838467757291[276] = 0; + out_2191763838467757291[277] = 0; + out_2191763838467757291[278] = 0; + out_2191763838467757291[279] = 0; + out_2191763838467757291[280] = 0; + out_2191763838467757291[281] = 0; + out_2191763838467757291[282] = 0; + out_2191763838467757291[283] = 0; + out_2191763838467757291[284] = 0; + out_2191763838467757291[285] = 1; + out_2191763838467757291[286] = 0; + out_2191763838467757291[287] = 0; + out_2191763838467757291[288] = 0; + out_2191763838467757291[289] = 0; + out_2191763838467757291[290] = 0; + out_2191763838467757291[291] = 0; + out_2191763838467757291[292] = 0; + out_2191763838467757291[293] = 0; + out_2191763838467757291[294] = 0; + out_2191763838467757291[295] = 0; + out_2191763838467757291[296] = 0; + out_2191763838467757291[297] = 0; + out_2191763838467757291[298] = 0; + out_2191763838467757291[299] = 0; + out_2191763838467757291[300] = 0; + out_2191763838467757291[301] = 0; + out_2191763838467757291[302] = 0; + out_2191763838467757291[303] = 0; + out_2191763838467757291[304] = 1; + out_2191763838467757291[305] = 0; + out_2191763838467757291[306] = 0; + out_2191763838467757291[307] = 0; + out_2191763838467757291[308] = 0; + out_2191763838467757291[309] = 0; + out_2191763838467757291[310] = 0; + out_2191763838467757291[311] = 0; + out_2191763838467757291[312] = 0; + out_2191763838467757291[313] = 0; + out_2191763838467757291[314] = 0; + out_2191763838467757291[315] = 0; + out_2191763838467757291[316] = 0; + out_2191763838467757291[317] = 0; + out_2191763838467757291[318] = 0; + out_2191763838467757291[319] = 0; + out_2191763838467757291[320] = 0; + out_2191763838467757291[321] = 0; + out_2191763838467757291[322] = 0; + out_2191763838467757291[323] = 1; } -void h_4(double *state, double *unused, double *out_2886213327032254372) { - out_2886213327032254372[0] = state[6] + state[9]; - out_2886213327032254372[1] = state[7] + state[10]; - out_2886213327032254372[2] = state[8] + state[11]; +void h_4(double *state, double *unused, double *out_6710764914604440332) { + out_6710764914604440332[0] = state[6] + state[9]; + out_6710764914604440332[1] = state[7] + state[10]; + out_6710764914604440332[2] = state[8] + state[11]; } -void H_4(double *state, double *unused, double *out_146496392957513442) { - out_146496392957513442[0] = 0; - out_146496392957513442[1] = 0; - out_146496392957513442[2] = 0; - out_146496392957513442[3] = 0; - out_146496392957513442[4] = 0; - out_146496392957513442[5] = 0; - out_146496392957513442[6] = 1; - out_146496392957513442[7] = 0; - out_146496392957513442[8] = 0; - out_146496392957513442[9] = 1; - out_146496392957513442[10] = 0; - out_146496392957513442[11] = 0; - out_146496392957513442[12] = 0; - out_146496392957513442[13] = 0; - out_146496392957513442[14] = 0; - out_146496392957513442[15] = 0; - out_146496392957513442[16] = 0; - out_146496392957513442[17] = 0; - out_146496392957513442[18] = 0; - out_146496392957513442[19] = 0; - out_146496392957513442[20] = 0; - out_146496392957513442[21] = 0; - out_146496392957513442[22] = 0; - out_146496392957513442[23] = 0; - out_146496392957513442[24] = 0; - out_146496392957513442[25] = 1; - out_146496392957513442[26] = 0; - out_146496392957513442[27] = 0; - out_146496392957513442[28] = 1; - out_146496392957513442[29] = 0; - out_146496392957513442[30] = 0; - out_146496392957513442[31] = 0; - out_146496392957513442[32] = 0; - out_146496392957513442[33] = 0; - out_146496392957513442[34] = 0; - out_146496392957513442[35] = 0; - out_146496392957513442[36] = 0; - out_146496392957513442[37] = 0; - out_146496392957513442[38] = 0; - out_146496392957513442[39] = 0; - out_146496392957513442[40] = 0; - out_146496392957513442[41] = 0; - out_146496392957513442[42] = 0; - out_146496392957513442[43] = 0; - out_146496392957513442[44] = 1; - out_146496392957513442[45] = 0; - out_146496392957513442[46] = 0; - out_146496392957513442[47] = 1; - out_146496392957513442[48] = 0; - out_146496392957513442[49] = 0; - out_146496392957513442[50] = 0; - out_146496392957513442[51] = 0; - out_146496392957513442[52] = 0; - out_146496392957513442[53] = 0; +void H_4(double *state, double *unused, double *out_9072105267123357754) { + out_9072105267123357754[0] = 0; + out_9072105267123357754[1] = 0; + out_9072105267123357754[2] = 0; + out_9072105267123357754[3] = 0; + out_9072105267123357754[4] = 0; + out_9072105267123357754[5] = 0; + out_9072105267123357754[6] = 1; + out_9072105267123357754[7] = 0; + out_9072105267123357754[8] = 0; + out_9072105267123357754[9] = 1; + out_9072105267123357754[10] = 0; + out_9072105267123357754[11] = 0; + out_9072105267123357754[12] = 0; + out_9072105267123357754[13] = 0; + out_9072105267123357754[14] = 0; + out_9072105267123357754[15] = 0; + out_9072105267123357754[16] = 0; + out_9072105267123357754[17] = 0; + out_9072105267123357754[18] = 0; + out_9072105267123357754[19] = 0; + out_9072105267123357754[20] = 0; + out_9072105267123357754[21] = 0; + out_9072105267123357754[22] = 0; + out_9072105267123357754[23] = 0; + out_9072105267123357754[24] = 0; + out_9072105267123357754[25] = 1; + out_9072105267123357754[26] = 0; + out_9072105267123357754[27] = 0; + out_9072105267123357754[28] = 1; + out_9072105267123357754[29] = 0; + out_9072105267123357754[30] = 0; + out_9072105267123357754[31] = 0; + out_9072105267123357754[32] = 0; + out_9072105267123357754[33] = 0; + out_9072105267123357754[34] = 0; + out_9072105267123357754[35] = 0; + out_9072105267123357754[36] = 0; + out_9072105267123357754[37] = 0; + out_9072105267123357754[38] = 0; + out_9072105267123357754[39] = 0; + out_9072105267123357754[40] = 0; + out_9072105267123357754[41] = 0; + out_9072105267123357754[42] = 0; + out_9072105267123357754[43] = 0; + out_9072105267123357754[44] = 1; + out_9072105267123357754[45] = 0; + out_9072105267123357754[46] = 0; + out_9072105267123357754[47] = 1; + out_9072105267123357754[48] = 0; + out_9072105267123357754[49] = 0; + out_9072105267123357754[50] = 0; + out_9072105267123357754[51] = 0; + out_9072105267123357754[52] = 0; + out_9072105267123357754[53] = 0; } -void h_10(double *state, double *unused, double *out_1449862159655962354) { - out_1449862159655962354[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; - out_1449862159655962354[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; - out_1449862159655962354[2] = -9.8100000000000005*cos(state[0])*cos(state[1]) - state[3]*state[7] + state[4]*state[6] + state[14] + state[17]; +void h_10(double *state, double *unused, double *out_5397643117837077736) { + out_5397643117837077736[0] = 9.8100000000000005*sin(state[1]) - state[4]*state[8] + state[5]*state[7] + state[12] + state[15]; + out_5397643117837077736[1] = -9.8100000000000005*sin(state[0])*cos(state[1]) + state[3]*state[8] - state[5]*state[6] + state[13] + state[16]; + out_5397643117837077736[2] = -9.8100000000000005*cos(state[0])*cos(state[1]) - state[3]*state[7] + state[4]*state[6] + state[14] + state[17]; } -void H_10(double *state, double *unused, double *out_3097566833981104856) { - out_3097566833981104856[0] = 0; - out_3097566833981104856[1] = 9.8100000000000005*cos(state[1]); - out_3097566833981104856[2] = 0; - out_3097566833981104856[3] = 0; - out_3097566833981104856[4] = -state[8]; - out_3097566833981104856[5] = state[7]; - out_3097566833981104856[6] = 0; - out_3097566833981104856[7] = state[5]; - out_3097566833981104856[8] = -state[4]; - out_3097566833981104856[9] = 0; - out_3097566833981104856[10] = 0; - out_3097566833981104856[11] = 0; - out_3097566833981104856[12] = 1; - out_3097566833981104856[13] = 0; - out_3097566833981104856[14] = 0; - out_3097566833981104856[15] = 1; - out_3097566833981104856[16] = 0; - out_3097566833981104856[17] = 0; - out_3097566833981104856[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); - out_3097566833981104856[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); - out_3097566833981104856[20] = 0; - out_3097566833981104856[21] = state[8]; - out_3097566833981104856[22] = 0; - out_3097566833981104856[23] = -state[6]; - out_3097566833981104856[24] = -state[5]; - out_3097566833981104856[25] = 0; - out_3097566833981104856[26] = state[3]; - out_3097566833981104856[27] = 0; - out_3097566833981104856[28] = 0; - out_3097566833981104856[29] = 0; - out_3097566833981104856[30] = 0; - out_3097566833981104856[31] = 1; - out_3097566833981104856[32] = 0; - out_3097566833981104856[33] = 0; - out_3097566833981104856[34] = 1; - out_3097566833981104856[35] = 0; - out_3097566833981104856[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); - out_3097566833981104856[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); - out_3097566833981104856[38] = 0; - out_3097566833981104856[39] = -state[7]; - out_3097566833981104856[40] = state[6]; - out_3097566833981104856[41] = 0; - out_3097566833981104856[42] = state[4]; - out_3097566833981104856[43] = -state[3]; - out_3097566833981104856[44] = 0; - out_3097566833981104856[45] = 0; - out_3097566833981104856[46] = 0; - out_3097566833981104856[47] = 0; - out_3097566833981104856[48] = 0; - out_3097566833981104856[49] = 0; - out_3097566833981104856[50] = 1; - out_3097566833981104856[51] = 0; - out_3097566833981104856[52] = 0; - out_3097566833981104856[53] = 1; +void H_10(double *state, double *unused, double *out_8486068256269040489) { + out_8486068256269040489[0] = 0; + out_8486068256269040489[1] = 9.8100000000000005*cos(state[1]); + out_8486068256269040489[2] = 0; + out_8486068256269040489[3] = 0; + out_8486068256269040489[4] = -state[8]; + out_8486068256269040489[5] = state[7]; + out_8486068256269040489[6] = 0; + out_8486068256269040489[7] = state[5]; + out_8486068256269040489[8] = -state[4]; + out_8486068256269040489[9] = 0; + out_8486068256269040489[10] = 0; + out_8486068256269040489[11] = 0; + out_8486068256269040489[12] = 1; + out_8486068256269040489[13] = 0; + out_8486068256269040489[14] = 0; + out_8486068256269040489[15] = 1; + out_8486068256269040489[16] = 0; + out_8486068256269040489[17] = 0; + out_8486068256269040489[18] = -9.8100000000000005*cos(state[0])*cos(state[1]); + out_8486068256269040489[19] = 9.8100000000000005*sin(state[0])*sin(state[1]); + out_8486068256269040489[20] = 0; + out_8486068256269040489[21] = state[8]; + out_8486068256269040489[22] = 0; + out_8486068256269040489[23] = -state[6]; + out_8486068256269040489[24] = -state[5]; + out_8486068256269040489[25] = 0; + out_8486068256269040489[26] = state[3]; + out_8486068256269040489[27] = 0; + out_8486068256269040489[28] = 0; + out_8486068256269040489[29] = 0; + out_8486068256269040489[30] = 0; + out_8486068256269040489[31] = 1; + out_8486068256269040489[32] = 0; + out_8486068256269040489[33] = 0; + out_8486068256269040489[34] = 1; + out_8486068256269040489[35] = 0; + out_8486068256269040489[36] = 9.8100000000000005*sin(state[0])*cos(state[1]); + out_8486068256269040489[37] = 9.8100000000000005*sin(state[1])*cos(state[0]); + out_8486068256269040489[38] = 0; + out_8486068256269040489[39] = -state[7]; + out_8486068256269040489[40] = state[6]; + out_8486068256269040489[41] = 0; + out_8486068256269040489[42] = state[4]; + out_8486068256269040489[43] = -state[3]; + out_8486068256269040489[44] = 0; + out_8486068256269040489[45] = 0; + out_8486068256269040489[46] = 0; + out_8486068256269040489[47] = 0; + out_8486068256269040489[48] = 0; + out_8486068256269040489[49] = 0; + out_8486068256269040489[50] = 1; + out_8486068256269040489[51] = 0; + out_8486068256269040489[52] = 0; + out_8486068256269040489[53] = 1; } -void h_13(double *state, double *unused, double *out_2970086023674538452) { - out_2970086023674538452[0] = state[3]; - out_2970086023674538452[1] = state[4]; - out_2970086023674538452[2] = state[5]; +void h_13(double *state, double *unused, double *out_1020156160635096483) { + out_1020156160635096483[0] = state[3]; + out_1020156160635096483[1] = state[4]; + out_1020156160635096483[2] = state[5]; } -void H_13(double *state, double *unused, double *out_3065777432374819359) { - out_3065777432374819359[0] = 0; - out_3065777432374819359[1] = 0; - out_3065777432374819359[2] = 0; - out_3065777432374819359[3] = 1; - out_3065777432374819359[4] = 0; - out_3065777432374819359[5] = 0; - out_3065777432374819359[6] = 0; - out_3065777432374819359[7] = 0; - out_3065777432374819359[8] = 0; - out_3065777432374819359[9] = 0; - out_3065777432374819359[10] = 0; - out_3065777432374819359[11] = 0; - out_3065777432374819359[12] = 0; - out_3065777432374819359[13] = 0; - out_3065777432374819359[14] = 0; - out_3065777432374819359[15] = 0; - out_3065777432374819359[16] = 0; - out_3065777432374819359[17] = 0; - out_3065777432374819359[18] = 0; - out_3065777432374819359[19] = 0; - out_3065777432374819359[20] = 0; - out_3065777432374819359[21] = 0; - out_3065777432374819359[22] = 1; - out_3065777432374819359[23] = 0; - out_3065777432374819359[24] = 0; - out_3065777432374819359[25] = 0; - out_3065777432374819359[26] = 0; - out_3065777432374819359[27] = 0; - out_3065777432374819359[28] = 0; - out_3065777432374819359[29] = 0; - out_3065777432374819359[30] = 0; - out_3065777432374819359[31] = 0; - out_3065777432374819359[32] = 0; - out_3065777432374819359[33] = 0; - out_3065777432374819359[34] = 0; - out_3065777432374819359[35] = 0; - out_3065777432374819359[36] = 0; - out_3065777432374819359[37] = 0; - out_3065777432374819359[38] = 0; - out_3065777432374819359[39] = 0; - out_3065777432374819359[40] = 0; - out_3065777432374819359[41] = 1; - out_3065777432374819359[42] = 0; - out_3065777432374819359[43] = 0; - out_3065777432374819359[44] = 0; - out_3065777432374819359[45] = 0; - out_3065777432374819359[46] = 0; - out_3065777432374819359[47] = 0; - out_3065777432374819359[48] = 0; - out_3065777432374819359[49] = 0; - out_3065777432374819359[50] = 0; - out_3065777432374819359[51] = 0; - out_3065777432374819359[52] = 0; - out_3065777432374819359[53] = 0; +void H_13(double *state, double *unused, double *out_5859831441791024953) { + out_5859831441791024953[0] = 0; + out_5859831441791024953[1] = 0; + out_5859831441791024953[2] = 0; + out_5859831441791024953[3] = 1; + out_5859831441791024953[4] = 0; + out_5859831441791024953[5] = 0; + out_5859831441791024953[6] = 0; + out_5859831441791024953[7] = 0; + out_5859831441791024953[8] = 0; + out_5859831441791024953[9] = 0; + out_5859831441791024953[10] = 0; + out_5859831441791024953[11] = 0; + out_5859831441791024953[12] = 0; + out_5859831441791024953[13] = 0; + out_5859831441791024953[14] = 0; + out_5859831441791024953[15] = 0; + out_5859831441791024953[16] = 0; + out_5859831441791024953[17] = 0; + out_5859831441791024953[18] = 0; + out_5859831441791024953[19] = 0; + out_5859831441791024953[20] = 0; + out_5859831441791024953[21] = 0; + out_5859831441791024953[22] = 1; + out_5859831441791024953[23] = 0; + out_5859831441791024953[24] = 0; + out_5859831441791024953[25] = 0; + out_5859831441791024953[26] = 0; + out_5859831441791024953[27] = 0; + out_5859831441791024953[28] = 0; + out_5859831441791024953[29] = 0; + out_5859831441791024953[30] = 0; + out_5859831441791024953[31] = 0; + out_5859831441791024953[32] = 0; + out_5859831441791024953[33] = 0; + out_5859831441791024953[34] = 0; + out_5859831441791024953[35] = 0; + out_5859831441791024953[36] = 0; + out_5859831441791024953[37] = 0; + out_5859831441791024953[38] = 0; + out_5859831441791024953[39] = 0; + out_5859831441791024953[40] = 0; + out_5859831441791024953[41] = 1; + out_5859831441791024953[42] = 0; + out_5859831441791024953[43] = 0; + out_5859831441791024953[44] = 0; + out_5859831441791024953[45] = 0; + out_5859831441791024953[46] = 0; + out_5859831441791024953[47] = 0; + out_5859831441791024953[48] = 0; + out_5859831441791024953[49] = 0; + out_5859831441791024953[50] = 0; + out_5859831441791024953[51] = 0; + out_5859831441791024953[52] = 0; + out_5859831441791024953[53] = 0; } -void h_14(double *state, double *unused, double *out_2307174073331940796) { - out_2307174073331940796[0] = state[6]; - out_2307174073331940796[1] = state[7]; - out_2307174073331940796[2] = state[8]; +void h_14(double *state, double *unused, double *out_6027370464870412024) { + out_6027370464870412024[0] = state[6]; + out_6027370464870412024[1] = state[7]; + out_6027370464870412024[2] = state[8]; } -void H_14(double *state, double *unused, double *out_3816744463381971087) { - out_3816744463381971087[0] = 0; - out_3816744463381971087[1] = 0; - out_3816744463381971087[2] = 0; - out_3816744463381971087[3] = 0; - out_3816744463381971087[4] = 0; - out_3816744463381971087[5] = 0; - out_3816744463381971087[6] = 1; - out_3816744463381971087[7] = 0; - out_3816744463381971087[8] = 0; - out_3816744463381971087[9] = 0; - out_3816744463381971087[10] = 0; - out_3816744463381971087[11] = 0; - out_3816744463381971087[12] = 0; - out_3816744463381971087[13] = 0; - out_3816744463381971087[14] = 0; - out_3816744463381971087[15] = 0; - out_3816744463381971087[16] = 0; - out_3816744463381971087[17] = 0; - out_3816744463381971087[18] = 0; - out_3816744463381971087[19] = 0; - out_3816744463381971087[20] = 0; - out_3816744463381971087[21] = 0; - out_3816744463381971087[22] = 0; - out_3816744463381971087[23] = 0; - out_3816744463381971087[24] = 0; - out_3816744463381971087[25] = 1; - out_3816744463381971087[26] = 0; - out_3816744463381971087[27] = 0; - out_3816744463381971087[28] = 0; - out_3816744463381971087[29] = 0; - out_3816744463381971087[30] = 0; - out_3816744463381971087[31] = 0; - out_3816744463381971087[32] = 0; - out_3816744463381971087[33] = 0; - out_3816744463381971087[34] = 0; - out_3816744463381971087[35] = 0; - out_3816744463381971087[36] = 0; - out_3816744463381971087[37] = 0; - out_3816744463381971087[38] = 0; - out_3816744463381971087[39] = 0; - out_3816744463381971087[40] = 0; - out_3816744463381971087[41] = 0; - out_3816744463381971087[42] = 0; - out_3816744463381971087[43] = 0; - out_3816744463381971087[44] = 1; - out_3816744463381971087[45] = 0; - out_3816744463381971087[46] = 0; - out_3816744463381971087[47] = 0; - out_3816744463381971087[48] = 0; - out_3816744463381971087[49] = 0; - out_3816744463381971087[50] = 0; - out_3816744463381971087[51] = 0; - out_3816744463381971087[52] = 0; - out_3816744463381971087[53] = 0; +void H_14(double *state, double *unused, double *out_5108864410783873225) { + out_5108864410783873225[0] = 0; + out_5108864410783873225[1] = 0; + out_5108864410783873225[2] = 0; + out_5108864410783873225[3] = 0; + out_5108864410783873225[4] = 0; + out_5108864410783873225[5] = 0; + out_5108864410783873225[6] = 1; + out_5108864410783873225[7] = 0; + out_5108864410783873225[8] = 0; + out_5108864410783873225[9] = 0; + out_5108864410783873225[10] = 0; + out_5108864410783873225[11] = 0; + out_5108864410783873225[12] = 0; + out_5108864410783873225[13] = 0; + out_5108864410783873225[14] = 0; + out_5108864410783873225[15] = 0; + out_5108864410783873225[16] = 0; + out_5108864410783873225[17] = 0; + out_5108864410783873225[18] = 0; + out_5108864410783873225[19] = 0; + out_5108864410783873225[20] = 0; + out_5108864410783873225[21] = 0; + out_5108864410783873225[22] = 0; + out_5108864410783873225[23] = 0; + out_5108864410783873225[24] = 0; + out_5108864410783873225[25] = 1; + out_5108864410783873225[26] = 0; + out_5108864410783873225[27] = 0; + out_5108864410783873225[28] = 0; + out_5108864410783873225[29] = 0; + out_5108864410783873225[30] = 0; + out_5108864410783873225[31] = 0; + out_5108864410783873225[32] = 0; + out_5108864410783873225[33] = 0; + out_5108864410783873225[34] = 0; + out_5108864410783873225[35] = 0; + out_5108864410783873225[36] = 0; + out_5108864410783873225[37] = 0; + out_5108864410783873225[38] = 0; + out_5108864410783873225[39] = 0; + out_5108864410783873225[40] = 0; + out_5108864410783873225[41] = 0; + out_5108864410783873225[42] = 0; + out_5108864410783873225[43] = 0; + out_5108864410783873225[44] = 1; + out_5108864410783873225[45] = 0; + out_5108864410783873225[46] = 0; + out_5108864410783873225[47] = 0; + out_5108864410783873225[48] = 0; + out_5108864410783873225[49] = 0; + out_5108864410783873225[50] = 0; + out_5108864410783873225[51] = 0; + out_5108864410783873225[52] = 0; + out_5108864410783873225[53] = 0; } #include #include @@ -1113,44 +1113,44 @@ void pose_update_13(double *in_x, double *in_P, double *in_z, double *in_R, doub void pose_update_14(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea) { update<3, 3, 0>(in_x, in_P, h_14, H_14, NULL, in_z, in_R, in_ea, MAHA_THRESH_14); } -void pose_err_fun(double *nom_x, double *delta_x, double *out_3009922513179117509) { - err_fun(nom_x, delta_x, out_3009922513179117509); +void pose_err_fun(double *nom_x, double *delta_x, double *out_5436717349763929250) { + err_fun(nom_x, delta_x, out_5436717349763929250); } -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_975857412122476284) { - inv_err_fun(nom_x, true_x, out_975857412122476284); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_2267989734965085487) { + inv_err_fun(nom_x, true_x, out_2267989734965085487); } -void pose_H_mod_fun(double *state, double *out_5701585413794445279) { - H_mod_fun(state, out_5701585413794445279); +void pose_H_mod_fun(double *state, double *out_7252406541217060893) { + H_mod_fun(state, out_7252406541217060893); } -void pose_f_fun(double *state, double dt, double *out_7100436431164388549) { - f_fun(state, dt, out_7100436431164388549); +void pose_f_fun(double *state, double dt, double *out_7195877540201438501) { + f_fun(state, dt, out_7195877540201438501); } -void pose_F_fun(double *state, double dt, double *out_4695823766962492888) { - F_fun(state, dt, out_4695823766962492888); +void pose_F_fun(double *state, double dt, double *out_2191763838467757291) { + F_fun(state, dt, out_2191763838467757291); } -void pose_h_4(double *state, double *unused, double *out_2886213327032254372) { - h_4(state, unused, out_2886213327032254372); +void pose_h_4(double *state, double *unused, double *out_6710764914604440332) { + h_4(state, unused, out_6710764914604440332); } -void pose_H_4(double *state, double *unused, double *out_146496392957513442) { - H_4(state, unused, out_146496392957513442); +void pose_H_4(double *state, double *unused, double *out_9072105267123357754) { + H_4(state, unused, out_9072105267123357754); } -void pose_h_10(double *state, double *unused, double *out_1449862159655962354) { - h_10(state, unused, out_1449862159655962354); +void pose_h_10(double *state, double *unused, double *out_5397643117837077736) { + h_10(state, unused, out_5397643117837077736); } -void pose_H_10(double *state, double *unused, double *out_3097566833981104856) { - H_10(state, unused, out_3097566833981104856); +void pose_H_10(double *state, double *unused, double *out_8486068256269040489) { + H_10(state, unused, out_8486068256269040489); } -void pose_h_13(double *state, double *unused, double *out_2970086023674538452) { - h_13(state, unused, out_2970086023674538452); +void pose_h_13(double *state, double *unused, double *out_1020156160635096483) { + h_13(state, unused, out_1020156160635096483); } -void pose_H_13(double *state, double *unused, double *out_3065777432374819359) { - H_13(state, unused, out_3065777432374819359); +void pose_H_13(double *state, double *unused, double *out_5859831441791024953) { + H_13(state, unused, out_5859831441791024953); } -void pose_h_14(double *state, double *unused, double *out_2307174073331940796) { - h_14(state, unused, out_2307174073331940796); +void pose_h_14(double *state, double *unused, double *out_6027370464870412024) { + h_14(state, unused, out_6027370464870412024); } -void pose_H_14(double *state, double *unused, double *out_3816744463381971087) { - H_14(state, unused, out_3816744463381971087); +void pose_H_14(double *state, double *unused, double *out_5108864410783873225) { + H_14(state, unused, out_5108864410783873225); } void pose_predict(double *in_x, double *in_P, double *in_Q, double dt) { predict(in_x, in_P, in_Q, dt); diff --git a/openpilot/selfdrive/locationd/models/generated/pose.h b/openpilot/selfdrive/locationd/models/generated/pose.h index c63ba53c22..e123de8e2e 100644 --- a/openpilot/selfdrive/locationd/models/generated/pose.h +++ b/openpilot/selfdrive/locationd/models/generated/pose.h @@ -5,18 +5,18 @@ void pose_update_4(double *in_x, double *in_P, double *in_z, double *in_R, doubl void pose_update_10(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); void pose_update_13(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); void pose_update_14(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea); -void pose_err_fun(double *nom_x, double *delta_x, double *out_3009922513179117509); -void pose_inv_err_fun(double *nom_x, double *true_x, double *out_975857412122476284); -void pose_H_mod_fun(double *state, double *out_5701585413794445279); -void pose_f_fun(double *state, double dt, double *out_7100436431164388549); -void pose_F_fun(double *state, double dt, double *out_4695823766962492888); -void pose_h_4(double *state, double *unused, double *out_2886213327032254372); -void pose_H_4(double *state, double *unused, double *out_146496392957513442); -void pose_h_10(double *state, double *unused, double *out_1449862159655962354); -void pose_H_10(double *state, double *unused, double *out_3097566833981104856); -void pose_h_13(double *state, double *unused, double *out_2970086023674538452); -void pose_H_13(double *state, double *unused, double *out_3065777432374819359); -void pose_h_14(double *state, double *unused, double *out_2307174073331940796); -void pose_H_14(double *state, double *unused, double *out_3816744463381971087); +void pose_err_fun(double *nom_x, double *delta_x, double *out_5436717349763929250); +void pose_inv_err_fun(double *nom_x, double *true_x, double *out_2267989734965085487); +void pose_H_mod_fun(double *state, double *out_7252406541217060893); +void pose_f_fun(double *state, double dt, double *out_7195877540201438501); +void pose_F_fun(double *state, double dt, double *out_2191763838467757291); +void pose_h_4(double *state, double *unused, double *out_6710764914604440332); +void pose_H_4(double *state, double *unused, double *out_9072105267123357754); +void pose_h_10(double *state, double *unused, double *out_5397643117837077736); +void pose_H_10(double *state, double *unused, double *out_8486068256269040489); +void pose_h_13(double *state, double *unused, double *out_1020156160635096483); +void pose_H_13(double *state, double *unused, double *out_5859831441791024953); +void pose_h_14(double *state, double *unused, double *out_6027370464870412024); +void pose_H_14(double *state, double *unused, double *out_5108864410783873225); void pose_predict(double *in_x, double *in_P, double *in_Q, double dt); } \ No newline at end of file diff --git a/panda/board/obj/body_h7.bin.signed b/panda/board/obj/body_h7.bin.signed index 1f394c5424ae24b21aaf59e01c613ae41b8b6115..b6e82c9b52c74a66ab48b25e77be0c3fd9200590 100644 GIT binary patch delta 160 zcmV;R0AK&aiVMVw3xKo%Y@i4@V>DwpV>2*^bf5vZbf5xIB!8-EP6wJf^u{azCczn!HV*g&E?TS!pQcJp4{Z63 z3w}7XnW{pRS@L57(!v8`Cm)17zXkqaxf3FY5wFCi$S?hqu&UBx^lLoJsb~M7Ez|hX O?khb`SHMR{B?0na{YVP{ delta 160 zcmV;R0AK&aiVMVw3xKo%Y@i4=VP!LAHZwSfbf5vZbf5xIB!4ZJuUg-nGP`GH@Sun3 z21KZ9EG>{0FHXy4W(i(onKR{|FoG;J^v08kH2ft^Rn*M4LB=`BB>5-a5jNYZGS17b zHOmGi2#G;Myzbn^><1v@a=-WnH(~kwX^ZbgptS7H`)5Gw459V|D5pC~?j#>Ns3wU@ O)e2O`&u=)kx&gD2O-oe( diff --git a/panda/board/obj/bootstub.body_h7.bin b/panda/board/obj/bootstub.body_h7.bin index bbb41e6024f6a75721c63ef20d4ea09608407783..8ae8e61912ba4b5f601ba50c3e59806f4d786de4 100755 GIT binary patch delta 21 dcmaD5_aJV=W-ShjWRqlzWMhNPyS0|G003w)2!j9s delta 21 dcmaD5_aJV=W-SiW#8l%{Gh>U*yS0|G003x;2!{Xw diff --git a/panda/board/obj/bootstub.panda.bin b/panda/board/obj/bootstub.panda.bin index bc646258122716dfad62f1db195043fc7927de16..4bcfeefb0ef0a6443316ccae36b3f5cd9cb698ce 100755 GIT binary patch delta 21 ccmaD6_9ARUp&ExpvPrTz>% delta 21 ccmaD6_9ARUp&Ey2VybbfnX$#@O11Ya0As!gMF0Q* diff --git a/panda/board/obj/bootstub.panda_h7.bin b/panda/board/obj/bootstub.panda_h7.bin index ce2dc3e9739850caaf8c2dc14af4c768307ab0ec..07c85f4b8edfae680eacc5a70f8a17bebb09252b 100755 GIT binary patch delta 23 ecmeB}!q_o|af6`?hefhUvPH77!DdUB^Q-_}^9P&& delta 23 ecmeB}!q_o|af6`?hiPJ}ajKcI#b!&F^Q-_~Ob4I< diff --git a/panda/board/obj/gitversion.h b/panda/board/obj/gitversion.h index 585fb61b66..6b66b37d3e 100644 --- a/panda/board/obj/gitversion.h +++ b/panda/board/obj/gitversion.h @@ -1,4 +1,4 @@ #pragma once extern const uint8_t gitversion[29]; -const uint8_t gitversion[29] = "DEV-5ae3e638-P92eb5651-DEBUG"; +const uint8_t gitversion[29] = "DEV-8c4c8c30-P92eb5651-DEBUG"; diff --git a/panda/board/obj/panda.bin.signed b/panda/board/obj/panda.bin.signed index 080379fcf304b5988f7e2af6aed3640698dbfa87..85a12f44812c7d7b279253a0e58e10e2f51b9b84 100644 GIT binary patch delta 160 zcmV;R0AK&G!V0j$3V^f$1bhfMV>DwpV>2*^4158%415BlB!86-Y-f(2&=k-IEy-zD zQAW>i|FF2>GlL$hASQl!1z~J5)EaB%7yE(iT%A9&IMB$hU~JGZGZxG1xDp03S$0R7 zl{|w}EcQ@QozT(`L7CSw&&>15`sj+<=6VQ2nt1@e`Y&SF(f~dhoJLE;s{Jvo0@b9U O!JSo8pvYYKjse2T$V&JC delta 160 zcmV;R0AK&G!V0j$3V^f$1bhfJVP!LAHZwSf4158%415BlB!5ML(x^@X;s-)y(%&JE zR3m0)d;NcyhIcaW_r&(!Q#x1HKvBl@@|_rtqwFlN#3Tm@$%1zg2Dh4|KAyBf0IxI; zNenARaF*D{hmm67bA3xKo%sGtZqV>DwpV>2*^u%H3Au%H6iCVzdXbp3hmQoPk8a&{6E zh$7zrv^33dF%tO&te&};b^&laR0v`UA3xKo%sGtZnVP!LAHZwSfu%H3Au%H6iCV#oE;mrlBx445tHIF+w z!(%N@NXikwt#7A1-!Jat)%NgX=CSW2Q4ixCN}^jCvpsyl2&wj|UIme*SkI@G^8e(w zPQq?3Si@XM_F$ULoJ