static void c2_chartstep_c2_Quadsim(SFc2_QuadsimInstanceStruct *chartInstance) { int32_T c2_i4; real_T c2_Xin[16]; uint32_T c2_debug_family_var_map[40]; real_T c2_arm_l; real_T c2_craft_m; real_T c2_Ixx; real_T c2_Iyy; real_T c2_Izz; real_T c2_b; real_T c2_d; real_T c2_g; real_T c2_X_dot; real_T c2_Y_dot; real_T c2_Z_dot; real_T c2_Roll_dot; real_T c2_Pitch_dot; real_T c2_Yaw_dot; real_T c2_X; real_T c2_Y; real_T c2_Z; real_T c2_Roll; real_T c2_Pitch; real_T c2_Yaw; real_T c2_F; real_T c2_R; real_T c2_B; real_T c2_L; real_T c2_TF; real_T c2_TR; real_T c2_TB; real_T c2_TL; real_T c2_D; real_T c2_X_ddot; real_T c2_Y_ddot; real_T c2_z_craft_component; real_T c2_Z_ddot; real_T c2_Roll_ddot; real_T c2_Pitch_ddot; real_T c2_Yaw_ddot; real_T c2_nargin = 1.0; real_T c2_nargout = 1.0; real_T c2_Xout[12]; real_T c2_b_b; real_T c2_c_b; real_T c2_d_b; real_T c2_e_b; real_T c2_f_b; real_T c2_x; real_T c2_b_x; real_T c2_c_x; real_T c2_d_x; real_T c2_a; real_T c2_g_b; real_T c2_y; real_T c2_e_x; real_T c2_f_x; real_T c2_b_a; real_T c2_h_b; real_T c2_b_y; real_T c2_g_x; real_T c2_h_x; real_T c2_i_x; real_T c2_j_x; real_T c2_c_a; real_T c2_i_b; real_T c2_c_y; real_T c2_j_b; real_T c2_d_y; real_T c2_d_a; real_T c2_k_b; real_T c2_k_x; real_T c2_l_x; real_T c2_m_x; real_T c2_n_x; real_T c2_e_a; real_T c2_l_b; real_T c2_e_y; real_T c2_o_x; real_T c2_p_x; real_T c2_f_a; real_T c2_m_b; real_T c2_f_y; real_T c2_q_x; real_T c2_r_x; real_T c2_s_x; real_T c2_t_x; real_T c2_g_a; real_T c2_n_b; real_T c2_g_y; real_T c2_o_b; real_T c2_h_y; real_T c2_h_a; real_T c2_p_b; real_T c2_u_x; real_T c2_v_x; real_T c2_q_b; real_T c2_i_y; real_T c2_w_x; real_T c2_x_x; real_T c2_i_a; real_T c2_r_b; real_T c2_j_y; real_T c2_j_a; real_T c2_s_b; real_T c2_t_b; real_T c2_u_b; real_T c2_A; real_T c2_y_x; real_T c2_ab_x; int32_T c2_i5; real_T (*c2_b_Xout)[12]; real_T (*c2_b_Xin)[16]; c2_b_Xin = (real_T (*)[16])ssGetInputPortSignal(chartInstance->S, 0); c2_b_Xout = (real_T (*)[12])ssGetOutputPortSignal(chartInstance->S, 1); _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent); for (c2_i4 = 0; c2_i4 < 16; c2_i4++) { c2_Xin[c2_i4] = (*c2_b_Xin)[c2_i4]; } sf_debug_symbol_scope_push_eml(0U, 40U, 40U, c2_debug_family_names, c2_debug_family_var_map); sf_debug_symbol_scope_add_eml(&c2_arm_l, 0U, c2_c_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c2_craft_m, 1U, c2_c_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c2_Ixx, 2U, c2_c_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c2_Iyy, 3U, c2_c_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c2_Izz, 4U, c2_c_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c2_b, 5U, c2_c_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c2_d, 6U, c2_c_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(&c2_g, 7U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_X_dot, 8U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Y_dot, 9U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Z_dot, 10U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Roll_dot, 11U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Pitch_dot, 12U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Yaw_dot, 13U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_X, 14U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Y, 15U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Z, 16U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Roll, 17U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Pitch, 18U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Yaw, 19U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_F, 20U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_R, 21U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_B, 22U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_L, 23U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_TF, 24U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_TR, 25U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_TB, 26U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_TL, 27U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_D, 28U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_X_ddot, 29U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Y_ddot, 30U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_z_craft_component, 31U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Z_ddot, 32U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Roll_ddot, 33U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Pitch_ddot, 34U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_Yaw_ddot, 35U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_nargin, 36U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_nargout, 37U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml(c2_Xin, 38U, c2_b_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(c2_Xout, 39U, c2_sf_marshallOut, c2_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 3); c2_arm_l = 0.23; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 4); c2_craft_m = 0.95; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 5); c2_Ixx = 0.0075; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 6); c2_Iyy = 0.0075; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 7); c2_Izz = 0.013000000000000001; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 8); c2_b = 3.1299999999999995E-5; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 9); c2_d = 7.5E-7; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 10); c2_g = 9.81; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 13); c2_X_dot = c2_Xin[0]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 14); c2_Y_dot = c2_Xin[1]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 15); c2_Z_dot = c2_Xin[2]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 16); c2_Roll_dot = c2_Xin[3]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 17); c2_Pitch_dot = c2_Xin[4]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 18); c2_Yaw_dot = c2_Xin[5]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 19); c2_X = c2_Xin[6]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 20); c2_Y = c2_Xin[7]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 21); c2_Z = c2_Xin[8]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 22); c2_Roll = c2_Xin[9]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 23); c2_Pitch = c2_Xin[10]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 24); c2_Yaw = c2_Xin[11]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 33); c2_F = c2_Xin[12]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 34); c2_R = c2_Xin[13]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 35); c2_B = c2_Xin[14]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 36); c2_L = c2_Xin[15]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 39); c2_b_b = c2_mpower(chartInstance, c2_F); c2_TF = 3.1299999999999995E-5 * c2_b_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 40); c2_c_b = c2_mpower(chartInstance, c2_R); c2_TR = 3.1299999999999995E-5 * c2_c_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 41); c2_d_b = c2_mpower(chartInstance, c2_B); c2_TB = 3.1299999999999995E-5 * c2_d_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 42); c2_e_b = c2_mpower(chartInstance, c2_L); c2_TL = 3.1299999999999995E-5 * c2_e_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 43); c2_f_b = ((-c2_F + c2_R) - c2_B) + c2_L; c2_D = 7.5E-7 * c2_f_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 56); c2_x = c2_Roll; c2_b_x = c2_x; c2_b_x = muDoubleScalarCos(c2_b_x); c2_c_x = c2_Pitch; c2_d_x = c2_c_x; c2_d_x = muDoubleScalarSin(c2_d_x); c2_a = c2_b_x; c2_g_b = c2_d_x; c2_y = c2_a * c2_g_b; c2_e_x = c2_Yaw; c2_f_x = c2_e_x; c2_f_x = muDoubleScalarCos(c2_f_x); c2_b_a = c2_y; c2_h_b = c2_f_x; c2_b_y = c2_b_a * c2_h_b; c2_g_x = c2_Roll; c2_h_x = c2_g_x; c2_h_x = muDoubleScalarSin(c2_h_x); c2_i_x = c2_Yaw; c2_j_x = c2_i_x; c2_j_x = muDoubleScalarSin(c2_j_x); c2_c_a = c2_h_x; c2_i_b = c2_j_x; c2_c_y = c2_c_a * c2_i_b; c2_j_b = c2_b_y + c2_c_y; c2_d_y = 1.0526315789473684 * c2_j_b; c2_d_a = c2_d_y; c2_k_b = ((c2_TF + c2_TR) + c2_TB) + c2_TL; c2_X_ddot = c2_d_a * c2_k_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 57); c2_k_x = c2_Roll; c2_l_x = c2_k_x; c2_l_x = muDoubleScalarCos(c2_l_x); c2_m_x = c2_Pitch; c2_n_x = c2_m_x; c2_n_x = muDoubleScalarSin(c2_n_x); c2_e_a = c2_l_x; c2_l_b = c2_n_x; c2_e_y = c2_e_a * c2_l_b; c2_o_x = c2_Yaw; c2_p_x = c2_o_x; c2_p_x = muDoubleScalarSin(c2_p_x); c2_f_a = c2_e_y; c2_m_b = c2_p_x; c2_f_y = c2_f_a * c2_m_b; c2_q_x = c2_Roll; c2_r_x = c2_q_x; c2_r_x = muDoubleScalarSin(c2_r_x); c2_s_x = c2_Yaw; c2_t_x = c2_s_x; c2_t_x = muDoubleScalarCos(c2_t_x); c2_g_a = c2_r_x; c2_n_b = c2_t_x; c2_g_y = c2_g_a * c2_n_b; c2_o_b = c2_f_y + c2_g_y; c2_h_y = 1.0526315789473684 * c2_o_b; c2_h_a = c2_h_y; c2_p_b = ((c2_TF + c2_TR) + c2_TB) + c2_TL; c2_Y_ddot = c2_h_a * c2_p_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 58); c2_u_x = c2_Roll; c2_v_x = c2_u_x; c2_v_x = muDoubleScalarCos(c2_v_x); c2_q_b = c2_v_x; c2_i_y = 1.0526315789473684 * c2_q_b; c2_w_x = c2_Pitch; c2_x_x = c2_w_x; c2_x_x = muDoubleScalarCos(c2_x_x); c2_i_a = c2_i_y; c2_r_b = c2_x_x; c2_j_y = c2_i_a * c2_r_b; c2_j_a = c2_j_y; c2_s_b = ((c2_TF + c2_TR) + c2_TB) + c2_TL; c2_z_craft_component = c2_j_a * c2_s_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 59); c2_Z_ddot = c2_z_craft_component - c2_g; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 60); c2_t_b = -c2_TR + c2_TL; c2_Roll_ddot = 30.666666666666668 * c2_t_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 61); c2_u_b = c2_TF - c2_TB; c2_Pitch_ddot = 30.666666666666668 * c2_u_b; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 62); c2_A = c2_D; c2_y_x = c2_A; c2_ab_x = c2_y_x; c2_Yaw_ddot = c2_ab_x / 0.013000000000000001; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 65); c2_Xout[0] = c2_X_ddot; c2_Xout[1] = c2_Y_ddot; c2_Xout[2] = c2_Z_ddot; c2_Xout[3] = c2_Roll_ddot; c2_Xout[4] = c2_Pitch_ddot; c2_Xout[5] = c2_Yaw_ddot; c2_Xout[6] = c2_X_dot; c2_Xout[7] = c2_Y_dot; c2_Xout[8] = c2_Z_dot; c2_Xout[9] = c2_Roll_dot; c2_Xout[10] = c2_Pitch_dot; c2_Xout[11] = c2_Yaw_dot; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, -65); sf_debug_symbol_scope_pop(); for (c2_i5 = 0; c2_i5 < 12; c2_i5++) { (*c2_b_Xout)[c2_i5] = c2_Xout[c2_i5]; } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent); }
static void c2_chartstep_c2_Batman_Code(SFc2_Batman_CodeInstanceStruct *chartInstance) { int32_T c2_i5; uint32_T c2_msg[2]; int32_T c2_i6; uint16_T c2_cell_voltages_in[12]; uint32_T c2_debug_family_var_map[9]; uint16_T c2_x1; uint16_T c2_x2; uint16_T c2_x3; uint16_T c2_x4; real_T c2_nargin = 2.0; real_T c2_nargout = 1.0; uint16_T c2_cell_voltages_out[12]; uint32_T c2_a; uint32_T c2_a1; uint32_T c2_c; uint32_T c2_b; uint32_T c2_b_c; uint32_T c2_u0; uint32_T c2_b_a; uint32_T c2_b_a1; uint32_T c2_c_c; uint32_T c2_b_b; uint32_T c2_d_c; uint32_T c2_u1; uint32_T c2_c_a; uint32_T c2_c_a1; uint32_T c2_e_c; uint32_T c2_c_b; uint32_T c2_f_c; uint32_T c2_u2; uint32_T c2_d_a; uint32_T c2_d_a1; uint32_T c2_g_c; uint32_T c2_d_b; uint32_T c2_h_c; uint32_T c2_u3; int32_T c2_i7; int32_T c2_i8; uint16_T (*c2_b_cell_voltages_out)[12]; uint16_T (*c2_b_cell_voltages_in)[12]; uint32_T (*c2_b_msg)[2]; c2_b_cell_voltages_out = (uint16_T (*)[12])ssGetOutputPortSignal (chartInstance->S, 1); c2_b_cell_voltages_in = (uint16_T (*)[12])ssGetInputPortSignal (chartInstance->S, 1); c2_b_msg = (uint32_T (*)[2])ssGetInputPortSignal(chartInstance->S, 0); _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c2_sfEvent); for (c2_i5 = 0; c2_i5 < 2; c2_i5++) { c2_msg[c2_i5] = (*c2_b_msg)[c2_i5]; } for (c2_i6 = 0; c2_i6 < 12; c2_i6++) { c2_cell_voltages_in[c2_i6] = (*c2_b_cell_voltages_in)[c2_i6]; } sf_debug_symbol_scope_push_eml(0U, 9U, 9U, c2_debug_family_names, c2_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(&c2_x1, 0U, c2_d_sf_marshallOut, c2_c_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_x2, 1U, c2_d_sf_marshallOut, c2_c_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_x3, 2U, c2_d_sf_marshallOut, c2_c_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_x4, 3U, c2_d_sf_marshallOut, c2_c_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_nargin, 4U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_nargout, 5U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml(c2_msg, 6U, c2_b_sf_marshallOut); sf_debug_symbol_scope_add_eml(c2_cell_voltages_in, 7U, c2_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(c2_cell_voltages_out, 8U, c2_sf_marshallOut, c2_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 5); c2_a = c2_msg[0]; c2_a1 = c2_a; c2_c = c2_a1; c2_b = c2_c; c2_b_c = c2_b & 65535U; c2_u0 = c2_b_c; if (c2_u0 > 65535U) { c2_u0 = 65535U; } c2_x1 = (uint16_T)c2_u0; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 6); c2_b_a = c2_msg[0]; c2_b_a1 = c2_b_a; c2_c_c = c2_b_a1 >> 16U; c2_b_b = c2_c_c; c2_d_c = c2_b_b & 65535U; c2_u1 = c2_d_c; if (c2_u1 > 65535U) { c2_u1 = 65535U; } c2_x2 = (uint16_T)c2_u1; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 7); c2_c_a = c2_msg[1]; c2_c_a1 = c2_c_a; c2_e_c = c2_c_a1; c2_c_b = c2_e_c; c2_f_c = c2_c_b & 65535U; c2_u2 = c2_f_c; if (c2_u2 > 65535U) { c2_u2 = 65535U; } c2_x3 = (uint16_T)c2_u2; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 8); c2_d_a = c2_msg[1]; c2_d_a1 = c2_d_a; c2_g_c = c2_d_a1 >> 16U; c2_d_b = c2_g_c; c2_h_c = c2_d_b & 65535U; c2_u3 = c2_h_c; if (c2_u3 > 65535U) { c2_u3 = 65535U; } c2_x4 = (uint16_T)c2_u3; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 11); c2_cell_voltages_in[4] = c2_x1; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 12); c2_cell_voltages_in[5] = c2_x2; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 13); c2_cell_voltages_in[6] = c2_x3; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 14); c2_cell_voltages_in[7] = c2_x4; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 17); for (c2_i7 = 0; c2_i7 < 12; c2_i7++) { c2_cell_voltages_out[c2_i7] = c2_cell_voltages_in[c2_i7]; } _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, -17); sf_debug_symbol_scope_pop(); for (c2_i8 = 0; c2_i8 < 12; c2_i8++) { (*c2_b_cell_voltages_out)[c2_i8] = c2_cell_voltages_out[c2_i8]; } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c2_sfEvent); }
static void c2_chartstep_c2_gesamtmodell(SFc2_gesamtmodellInstanceStruct *chartInstance) { int32_T c2_i4; real_T c2_u[4]; uint32_T c2_debug_family_var_map[9]; real_T c2_T; real_T c2_phi; real_T c2_theta; real_T c2_psi; real_T c2_Mt[9]; real_T c2_nargin = 1.0; real_T c2_nargout = 1.0; real_T c2_y[3]; real_T c2_x; real_T c2_b_x; real_T c2_c_x; real_T c2_d_x; real_T c2_a; real_T c2_b; real_T c2_b_y; real_T c2_e_x; real_T c2_f_x; real_T c2_g_x; real_T c2_h_x; real_T c2_b_a; real_T c2_b_b; real_T c2_c_y; real_T c2_i_x; real_T c2_j_x; real_T c2_c_a; real_T c2_c_b; real_T c2_d_y; real_T c2_k_x; real_T c2_l_x; real_T c2_m_x; real_T c2_n_x; real_T c2_d_a; real_T c2_d_b; real_T c2_e_y; real_T c2_o_x; real_T c2_p_x; real_T c2_q_x; real_T c2_r_x; real_T c2_e_a; real_T c2_e_b; real_T c2_f_y; real_T c2_s_x; real_T c2_t_x; real_T c2_f_a; real_T c2_f_b; real_T c2_g_y; real_T c2_u_x; real_T c2_v_x; real_T c2_w_x; real_T c2_x_x; real_T c2_g_a; real_T c2_g_b; real_T c2_h_y; real_T c2_y_x; real_T c2_ab_x; real_T c2_bb_x; real_T c2_cb_x; real_T c2_h_a; real_T c2_h_b; real_T c2_i_y; real_T c2_db_x; real_T c2_eb_x; real_T c2_fb_x; real_T c2_gb_x; real_T c2_i_a; real_T c2_i_b; real_T c2_j_y; real_T c2_hb_x; real_T c2_ib_x; real_T c2_j_a; real_T c2_j_b; real_T c2_k_y; real_T c2_jb_x; real_T c2_kb_x; real_T c2_lb_x; real_T c2_mb_x; real_T c2_k_a; real_T c2_k_b; real_T c2_l_y; real_T c2_nb_x; real_T c2_ob_x; real_T c2_pb_x; real_T c2_qb_x; real_T c2_l_a; real_T c2_l_b; real_T c2_m_y; real_T c2_rb_x; real_T c2_sb_x; real_T c2_m_a; real_T c2_m_b; real_T c2_n_y; real_T c2_tb_x; real_T c2_ub_x; real_T c2_vb_x; real_T c2_wb_x; real_T c2_n_a; real_T c2_n_b; real_T c2_o_y; real_T c2_xb_x; real_T c2_yb_x; real_T c2_ac_x; real_T c2_bc_x; real_T c2_cc_x; real_T c2_dc_x; real_T c2_o_a; real_T c2_o_b; real_T c2_p_y; real_T c2_ec_x; real_T c2_fc_x; real_T c2_gc_x; real_T c2_hc_x; real_T c2_p_a; real_T c2_p_b; real_T c2_q_y; int32_T c2_i5; real_T c2_q_a[9]; real_T c2_q_b[3]; int32_T c2_i6; int32_T c2_i7; int32_T c2_i8; real_T c2_C[3]; int32_T c2_i9; int32_T c2_i10; int32_T c2_i11; int32_T c2_i12; int32_T c2_i13; int32_T c2_i14; int32_T c2_i15; real_T (*c2_r_y)[3]; real_T (*c2_b_u)[4]; c2_r_y = (real_T (*)[3])ssGetOutputPortSignal(chartInstance->S, 1); c2_b_u = (real_T (*)[4])ssGetInputPortSignal(chartInstance->S, 0); _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent); for (c2_i4 = 0; c2_i4 < 4; c2_i4++) { c2_u[c2_i4] = (*c2_b_u)[c2_i4]; } sf_debug_symbol_scope_push_eml(0U, 9U, 9U, c2_debug_family_names, c2_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(&c2_T, 0U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_phi, 1U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_theta, 2U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_psi, 3U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(c2_Mt, 4U, c2_d_sf_marshallOut, c2_c_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_nargin, 5U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_nargout, 6U, c2_c_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml(c2_u, 7U, c2_b_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(c2_y, 8U, c2_sf_marshallOut, c2_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 2); c2_T = c2_u[0]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 3); c2_phi = c2_u[1]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 4); c2_theta = c2_u[2]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 5); c2_psi = c2_u[3]; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 7); c2_x = c2_theta; c2_b_x = c2_x; c2_b_x = muDoubleScalarCos(c2_b_x); c2_c_x = c2_psi; c2_d_x = c2_c_x; c2_d_x = muDoubleScalarCos(c2_d_x); c2_a = c2_b_x; c2_b = c2_d_x; c2_b_y = c2_a * c2_b; c2_e_x = c2_phi; c2_f_x = c2_e_x; c2_f_x = muDoubleScalarSin(c2_f_x); c2_g_x = c2_theta; c2_h_x = c2_g_x; c2_h_x = muDoubleScalarSin(c2_h_x); c2_b_a = c2_f_x; c2_b_b = c2_h_x; c2_c_y = c2_b_a * c2_b_b; c2_i_x = c2_psi; c2_j_x = c2_i_x; c2_j_x = muDoubleScalarCos(c2_j_x); c2_c_a = c2_c_y; c2_c_b = c2_j_x; c2_d_y = c2_c_a * c2_c_b; c2_k_x = c2_phi; c2_l_x = c2_k_x; c2_l_x = muDoubleScalarCos(c2_l_x); c2_m_x = c2_psi; c2_n_x = c2_m_x; c2_n_x = muDoubleScalarSin(c2_n_x); c2_d_a = c2_l_x; c2_d_b = c2_n_x; c2_e_y = c2_d_a * c2_d_b; c2_o_x = c2_phi; c2_p_x = c2_o_x; c2_p_x = muDoubleScalarCos(c2_p_x); c2_q_x = c2_theta; c2_r_x = c2_q_x; c2_r_x = muDoubleScalarSin(c2_r_x); c2_e_a = c2_p_x; c2_e_b = c2_r_x; c2_f_y = c2_e_a * c2_e_b; c2_s_x = c2_psi; c2_t_x = c2_s_x; c2_t_x = muDoubleScalarCos(c2_t_x); c2_f_a = c2_f_y; c2_f_b = c2_t_x; c2_g_y = c2_f_a * c2_f_b; c2_u_x = c2_phi; c2_v_x = c2_u_x; c2_v_x = muDoubleScalarSin(c2_v_x); c2_w_x = c2_psi; c2_x_x = c2_w_x; c2_x_x = muDoubleScalarSin(c2_x_x); c2_g_a = c2_v_x; c2_g_b = c2_x_x; c2_h_y = c2_g_a * c2_g_b; c2_y_x = c2_theta; c2_ab_x = c2_y_x; c2_ab_x = muDoubleScalarCos(c2_ab_x); c2_bb_x = c2_psi; c2_cb_x = c2_bb_x; c2_cb_x = muDoubleScalarSin(c2_cb_x); c2_h_a = c2_ab_x; c2_h_b = c2_cb_x; c2_i_y = c2_h_a * c2_h_b; c2_db_x = c2_phi; c2_eb_x = c2_db_x; c2_eb_x = muDoubleScalarSin(c2_eb_x); c2_fb_x = c2_theta; c2_gb_x = c2_fb_x; c2_gb_x = muDoubleScalarSin(c2_gb_x); c2_i_a = c2_eb_x; c2_i_b = c2_gb_x; c2_j_y = c2_i_a * c2_i_b; c2_hb_x = c2_psi; c2_ib_x = c2_hb_x; c2_ib_x = muDoubleScalarSin(c2_ib_x); c2_j_a = c2_j_y; c2_j_b = c2_ib_x; c2_k_y = c2_j_a * c2_j_b; c2_jb_x = c2_phi; c2_kb_x = c2_jb_x; c2_kb_x = muDoubleScalarCos(c2_kb_x); c2_lb_x = c2_psi; c2_mb_x = c2_lb_x; c2_mb_x = muDoubleScalarCos(c2_mb_x); c2_k_a = c2_kb_x; c2_k_b = c2_mb_x; c2_l_y = c2_k_a * c2_k_b; c2_nb_x = c2_phi; c2_ob_x = c2_nb_x; c2_ob_x = muDoubleScalarCos(c2_ob_x); c2_pb_x = c2_theta; c2_qb_x = c2_pb_x; c2_qb_x = muDoubleScalarSin(c2_qb_x); c2_l_a = c2_ob_x; c2_l_b = c2_qb_x; c2_m_y = c2_l_a * c2_l_b; c2_rb_x = c2_psi; c2_sb_x = c2_rb_x; c2_sb_x = muDoubleScalarSin(c2_sb_x); c2_m_a = c2_m_y; c2_m_b = c2_sb_x; c2_n_y = c2_m_a * c2_m_b; c2_tb_x = c2_phi; c2_ub_x = c2_tb_x; c2_ub_x = muDoubleScalarSin(c2_ub_x); c2_vb_x = c2_psi; c2_wb_x = c2_vb_x; c2_wb_x = muDoubleScalarCos(c2_wb_x); c2_n_a = c2_ub_x; c2_n_b = c2_wb_x; c2_o_y = c2_n_a * c2_n_b; c2_xb_x = c2_theta; c2_yb_x = c2_xb_x; c2_yb_x = muDoubleScalarSin(c2_yb_x); c2_ac_x = c2_phi; c2_bc_x = c2_ac_x; c2_bc_x = muDoubleScalarSin(c2_bc_x); c2_cc_x = c2_theta; c2_dc_x = c2_cc_x; c2_dc_x = muDoubleScalarCos(c2_dc_x); c2_o_a = c2_bc_x; c2_o_b = c2_dc_x; c2_p_y = c2_o_a * c2_o_b; c2_ec_x = c2_phi; c2_fc_x = c2_ec_x; c2_fc_x = muDoubleScalarCos(c2_fc_x); c2_gc_x = c2_theta; c2_hc_x = c2_gc_x; c2_hc_x = muDoubleScalarCos(c2_hc_x); c2_p_a = c2_fc_x; c2_p_b = c2_hc_x; c2_q_y = c2_p_a * c2_p_b; c2_Mt[0] = c2_b_y; c2_Mt[3] = c2_d_y - c2_e_y; c2_Mt[6] = c2_g_y + c2_h_y; c2_Mt[1] = c2_i_y; c2_Mt[4] = c2_k_y + c2_l_y; c2_Mt[7] = c2_n_y - c2_o_y; c2_Mt[2] = -c2_yb_x; c2_Mt[5] = c2_p_y; c2_Mt[8] = c2_q_y; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 10); for (c2_i5 = 0; c2_i5 < 9; c2_i5++) { c2_q_a[c2_i5] = c2_Mt[c2_i5]; } c2_q_b[0] = 0.0; c2_q_b[1] = 0.0; c2_q_b[2] = c2_T; c2_eml_scalar_eg(chartInstance); c2_eml_scalar_eg(chartInstance); for (c2_i6 = 0; c2_i6 < 3; c2_i6++) { c2_y[c2_i6] = 0.0; } for (c2_i7 = 0; c2_i7 < 3; c2_i7++) { c2_y[c2_i7] = 0.0; } for (c2_i8 = 0; c2_i8 < 3; c2_i8++) { c2_C[c2_i8] = c2_y[c2_i8]; } for (c2_i9 = 0; c2_i9 < 3; c2_i9++) { c2_y[c2_i9] = c2_C[c2_i9]; } for (c2_i10 = 0; c2_i10 < 3; c2_i10++) { c2_C[c2_i10] = c2_y[c2_i10]; } for (c2_i11 = 0; c2_i11 < 3; c2_i11++) { c2_y[c2_i11] = c2_C[c2_i11]; } for (c2_i12 = 0; c2_i12 < 3; c2_i12++) { c2_y[c2_i12] = 0.0; c2_i13 = 0; for (c2_i14 = 0; c2_i14 < 3; c2_i14++) { c2_y[c2_i12] += c2_q_a[c2_i13 + c2_i12] * c2_q_b[c2_i14]; c2_i13 += 3; } } _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, -10); sf_debug_symbol_scope_pop(); for (c2_i15 = 0; c2_i15 < 3; c2_i15++) { (*c2_r_y)[c2_i15] = c2_y[c2_i15]; } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent); }