/* TargetLimits_Pkg::SDMLimitLocations */ void SDMLimitLocations_TargetLimits_Pkg( /* TargetLimits_Pkg::SDMLimitLocations::MRSP_Profile */ MRSP_internal_T_TargetManagement_types *MRSP_Profile, /* TargetLimits_Pkg::SDMLimitLocations::odometry */ Odometry_real_T_SDM_Types_Pkg *odometry, /* TargetLimits_Pkg::SDMLimitLocations::trainLocations */ TrainLocations_real_T_SDM_Types_Pkg *trainLocations, /* TargetLimits_Pkg::SDMLimitLocations::targetCollection */ TargetCollection_T_TargetManagement_types *targetCollection, /* TargetLimits_Pkg::SDMLimitLocations::curveCollection */ CurveCollection_T_CalcBrakingCurves_types *curveCollection, /* TargetLimits_Pkg::SDMLimitLocations::v_release */ V_internal_real_Type_SDM_Types_Pkg v_release, /* TargetLimits_Pkg::SDMLimitLocations::V_ura */ V_internal_real_Type_SDM_Types_Pkg V_ura, /* TargetLimits_Pkg::SDMLimitLocations::inhibitUnderReadingCompensation */ Q_NVINHSMICPERM inhibitUnderReadingCompensation, /* TargetLimits_Pkg::SDMLimitLocations::isTractionCutOffImplemented */ kcg_bool isTractionCutOffImplemented, /* TargetLimits_Pkg::SDMLimitLocations::T_traction_cut_off */ T_internal_real_Type_SDM_Types_Pkg T_traction_cut_off, /* TargetLimits_Pkg::SDMLimitLocations::T_be */ T_internal_real_Type_SDM_Types_Pkg T_be, /* TargetLimits_Pkg::SDMLimitLocations::T_bs */ T_internal_real_Type_SDM_Types_Pkg T_bs, /* TargetLimits_Pkg::SDMLimitLocations::locations */ SDM_Locations_T_SDM_Types_Pkg *locations, /* TargetLimits_Pkg::SDMLimitLocations::MostRestrictiveTarget */ Target_real_T_TargetManagement_types *MostRestrictiveTarget, /* TargetLimits_Pkg::SDMLimitLocations::FLOIisSBI1 */ kcg_bool *FLOIisSBI1, /* TargetLimits_Pkg::SDMLimitLocations::v_target */ V_internal_real_Type_SDM_Types_Pkg *v_target, /* TargetLimits_Pkg::SDMLimitLocations::v_MRSP */ V_internal_real_Type_SDM_Types_Pkg *v_MRSP, /* TargetLimits_Pkg::SDMLimitLocations::v_P_SBD */ V_internal_real_Type_SDM_Types_Pkg *v_P_SBD, /* TargetLimits_Pkg::SDMLimitLocations::v_P_EBD */ V_internal_real_Type_SDM_Types_Pkg *v_P_EBD, /* TargetLimits_Pkg::SDMLimitLocations::v_P_EBD_valid */ kcg_bool *v_P_EBD_valid) { V_internal_real_Type_SDM_Types_Pkg tmp; /* TargetLimits_Pkg::SDMLimitLocations::D_bec */ L_internal_real_Type_SDM_Types_Pkg D_bec; /* TargetLimits_Pkg::SDMLimitLocations::SBDcurve */ ParabolaCurve_T_CalcBrakingCurves_types SBDcurve; /* TargetLimits_Pkg::SDMLimitLocations::EBDcurve */ ParabolaCurve_T_CalcBrakingCurves_types EBDcurve; /* TargetLimits_Pkg::SDMLimitLocations::T_Traction */ T_internal_real_Type_SDM_Types_Pkg T_Traction; /* TargetLimits_Pkg::SDMLimitLocations::T_berem */ T_internal_real_Type_SDM_Types_Pkg T_berem; /* TargetLimits_Pkg::SDMLimitLocations::DpiE */ L_internal_real_Type_SDM_Types_Pkg DpiE; /* TargetLimits_Pkg::SDMLimitLocations::DpiS */ L_internal_real_Type_SDM_Types_Pkg DpiS; /* TargetLimits_Pkg::SDMLimitLocations::V_dt */ TractionDeltaTriple_TargetLimits_Pkg V_dt; /* TargetLimits_Pkg::SDMLimitLocations::D_SBI2 */ L_internal_real_Type_SDM_Types_Pkg D_SBI2; /* TargetLimits_Pkg::SDMLimitLocations::GUICurveEnabled */ kcg_bool GUICurveEnabled; /* TargetLimits_Pkg::SDMLimitLocations::GUIcurve */ ParabolaCurve_T_CalcBrakingCurves_types GUIcurve; /* TargetLimits_Pkg::SDMLimitLocations::SBI2val */ kcg_bool SBI2val; /* TargetLimits_Pkg::SDMLimitLocations::_L18 */ L_internal_real_Type_SDM_Types_Pkg _L18; /* TargetLimits_Pkg::SDMLimitLocations::_L23 */ L_internal_real_Type_SDM_Types_Pkg _L23; /* TargetLimits_Pkg::SDMLimitLocations::_L21 */ L_internal_real_Type_SDM_Types_Pkg _L21; /* TargetLimits_Pkg::SDMLimitLocations::_L25 */ V_internal_real_Type_SDM_Types_Pkg _L25; /* TargetLimits_Pkg::SDMLimitLocations::_L26 */ V_internal_real_Type_SDM_Types_Pkg _L26; /* TargetLimits_Pkg::SDMLimitLocations::_L343 */ kcg_bool _L343; /* TargetLimits_Pkg::SDMLimitLocations::_L642 */ kcg_bool _L642; /* 1 */ surplusTractionDeltas_TargetLimits_Pkg( (*odometry).acceleration, inhibitUnderReadingCompensation, isTractionCutOffImplemented, T_traction_cut_off, T_be, V_ura, T_bs, &T_Traction, &T_berem, &V_dt); /* 2 */ TargetSelector_TargetLimits_Pkg( (*odometry).speed.v_safeNominal, targetCollection, curveCollection, T_bs, T_Traction, T_berem, &V_dt, MostRestrictiveTarget, &EBDcurve, &SBDcurve, &GUIcurve, &GUICurveEnabled, v_target, &_L23, &D_bec, &SBI2val, &D_SBI2); (*locations).d_EBI_of_V_est = D_SBI2 + (*odometry).speed.v_safeNominal * T_bs; (*locations).d_eoa = _L23; (*locations).d_svl = D_bec; *v_P_SBD = /* 1 */ P_SpeedRelatedToSBD_SDM_Types_Pkg( GUICurveEnabled, (*trainLocations).d_est_frontendPos, (*odometry).speed.v_safeNominal, &GUIcurve, T_bs, &SBDcurve, _L23); /* 1 */ v_bec_TargetLimits_Pkg( (*odometry).speed.v_safeNominal, *v_target, T_Traction, T_berem, &V_dt, &_L25, &D_bec); /* 1 */ P_SpeedRelatedToEBD_SDM_Types_Pkg( (*trainLocations).d_maxSafeFrontEndPos, (*trainLocations).d_maxSafeFrontEndPos, (*odometry).speed.v_safeNominal, &EBDcurve, &GUIcurve, T_bs, *v_target, GUICurveEnabled, D_bec, _L25, v_P_EBD, v_P_EBD_valid); *v_MRSP = /* 1 */ getMRSFromMRSP_SDM_Types_Pkg( MRSP_Profile, (*trainLocations).d_maxSafeFrontEndPos); /* 2 */ MRSPPreindicationSelector_TargetLimits_Pkg( MRSP_Profile, &SBDcurve, &GUIcurve, GUICurveEnabled, 0.0, 0.0, T_bs, &DpiS, &_L343); (*locations).SBD_preindication_location = DpiS; (*locations).Preindication_SBD_location_valid = _L343; /* 1 */ d_P_target_TargetLimits_Pkg( &EBDcurve, *v_target, T_Traction, T_berem, T_bs, &_L343, &(*locations).d_P_of_V_target); /* 1 */ MRSPPreindicationSelector_TargetLimits_Pkg( MRSP_Profile, &EBDcurve, &GUIcurve, GUICurveEnabled, T_Traction, T_berem, T_bs, &DpiE, &_L343); (*locations).EBD_preindication_location = DpiE; (*locations).Preindication_EBD_location_valid = _L343; /* 1 */ d_RSM_start_TargetLimits_Pkg( v_release, T_Traction, T_berem, &EBDcurve, &SBDcurve, (*trainLocations).d_maxSafeFrontEndPos, (*trainLocations).d_est_frontendPos, T_bs, T_bs, &_L18, &(*locations).EBD_RSM_start_location, &_L21, &_L343, &_L642); (*locations).SBD_RSM_start_location = _L21; (*locations).RSM_start_location_EBD_valid = _L343; (*locations).RSM_start_location_SBD_valid = _L642; /* 1 */ v_SBI2_TargetLimits_Pkg( &EBDcurve, (*odometry).speed.v_safeNominal, *v_target, _L25, (*trainLocations).d_maxSafeFrontEndPos, D_bec, T_bs, &_L26, &_L343); (*locations).SBI2_of_V_est = _L26; /* 1 */ v_SBI1_TargetLimits_Pkg( &SBDcurve, (*odometry).speed.v_safeNominal, (*trainLocations).d_est_frontendPos, _L23, T_bs, &_L25, &_L642); (*locations).SBI1_of_V_est = _L25; /* 1 */ d_SBI1_TargetLimits_Pkg( &SBDcurve, (*odometry).speed.v_safeNominal, T_bs, &_L343, &_L18); /* 2 */ d_limits_TargetLimits_Pkg( (*odometry).speed.v_safeNominal, _L343, _L18, SBI2val, D_SBI2, (*trainLocations).d_est_frontendPos, (*trainLocations).d_maxSafeFrontEndPos, T_bs, &GUIcurve, GUICurveEnabled, &(*locations).d_I_of_V_est, &_L23, &D_bec, &_L21, FLOIisSBI1); (*locations).d_P_of_V_est = _L23; (*locations).d_W_of_V_est = D_bec; (*locations).d_FLOI_of_V_est = _L21; if (*FLOIisSBI1) { (*locations).d_I_of_V_MRSP = DpiS; tmp = _L25; } else { (*locations).d_I_of_V_MRSP = DpiE; tmp = _L26; } (*locations).FLOI_of_V_est = tmp; }
/* TargetLimits_Pkg::TargetIterator */ void TargetIterator_TargetLimits_Pkg( /* TargetLimits_Pkg::TargetIterator::index */ kcg_int index, /* TargetLimits_Pkg::TargetIterator::Akku_in */ TargetIteratorAkku_TargetLimits *Akku_in, /* TargetLimits_Pkg::TargetIterator::target */ Target_real_T_TargetManagement_ *target, /* TargetLimits_Pkg::TargetIterator::targetCurve */ ParabolaCurve_T_CalcBrakingCurv *targetCurve, /* TargetLimits_Pkg::TargetIterator::trainData_int */ trainData_internal_t_SDM_Types_ *trainData_int, /* TargetLimits_Pkg::TargetIterator::odometry */ odometry_T_Obu_BasicTypes_Pkg *odometry, /* TargetLimits_Pkg::TargetIterator::T_b */ t_Brake_t_SDMModelPkg *T_b, /* TargetLimits_Pkg::TargetIterator::D_maxsafefront */ L_internal_real_Type_SDM_Types_ D_maxsafefront, /* TargetLimits_Pkg::TargetIterator::GUIcurve */ ParabolaCurve_T_CalcBrakingCurv *GUIcurve, /* TargetLimits_Pkg::TargetIterator::guiCurveEnabled */ kcg_bool guiCurveEnabled, /* TargetLimits_Pkg::TargetIterator::goOn */ kcg_bool *goOn, /* TargetLimits_Pkg::TargetIterator::Akku_out */ TargetIteratorAkku_TargetLimits *Akku_out) { /* TargetLimits_Pkg::TargetIterator */ static V_internal_real_Type_SDM_Types_ tmp1; /* TargetLimits_Pkg::TargetIterator */ static kcg_bool tmp; /* TargetLimits_Pkg::TargetIterator::_L2 */ static L_internal_real_Type_SDM_Types_ _L2; /* TargetLimits_Pkg::TargetIterator::_L1 */ static kcg_bool _L1; /* TargetLimits_Pkg::TargetIterator::_L74 */ static bec_t_TargetLimits_Pkg _L74; /* TargetLimits_Pkg::TargetIterator::_L73 */ static T_trac_t_TargetLimits_Pkg _L73; /* TargetLimits_Pkg::TargetIterator::_L72 */ static V_internal_real_Type_SDM_Types_ _L72; /* TargetLimits_Pkg::TargetIterator::_L71 */ static V_internal_real_Type_SDM_Types_ _L71; /* TargetLimits_Pkg::TargetIterator::_L102 */ static kcg_bool _L102; /* TargetLimits_Pkg::TargetIterator::_L111 */ static kcg_real _L111; /* TargetLimits_Pkg::TargetIterator::_L110 */ static kcg_bool _L110; *goOn = invalid_TargetManagement_types != (*target).targetType; /* 1 */ surplusTractionDeltas_TargetLim( trainData_int, odometry, T_b, (*target).speed, &(*Akku_in).T, &_L74, &_L71, &_L73, &_L72); /* ck_goOn */ if (*goOn) { /* 1 */ v_SBI2_TargetLimits_Pkg( targetCurve, _L71, (*target).speed, &_L74, D_maxsafefront, T_driver_SDM_Types_Pkg, guiCurveEnabled, GUIcurve, &_L73, &tmp, &tmp1); /* 1 */ d_SBI2_TargetLimits_Pkg(targetCurve, &_L74, _L71, &_L73, &_L1, &_L2); } else { tmp = kcg_false; _L1 = kcg_false; _L2 = - 1.0; tmp1 = 0.0; } /* 1 */ selectLEValid_TargetLimits_Pkg( (kcg_bool) ((*Akku_in).V_P_MRDT_index >= 0), (*Akku_in).V_P_MRDT_ebd, tmp, tmp1, &_L102, &_L110, &_L111); tmp = /* 1 */ isLEValid_TargetLimits_Pkg( (kcg_bool) (invalid_TargetManagement_types != (*Akku_in).ttype), (*Akku_in).SBI2, _L1, _L2); /* 1 */ if (tmp) { kcg_copy_TargetIteratorAkku_Tar(Akku_out, Akku_in); } else { (*Akku_out).SBI2 = _L2; (*Akku_out).index = index; kcg_copy_bec_t_TargetLimits_Pkg(&(*Akku_out).bec, &_L74); (*Akku_out).V_est = _L71; kcg_copy_T_trac_t_TargetLimits_(&(*Akku_out).T, &_L73); (*Akku_out).V_ura = _L72; (*Akku_out).V_P_MRDT_ebd = (*Akku_in).V_P_MRDT_ebd; (*Akku_out).V_P_MRDT_index = (*Akku_in).V_P_MRDT_index; /* 2 */ if (_L1) { (*Akku_out).ttype = (*target).targetType; } else { (*Akku_out).ttype = invalid_TargetManagement_types; } } /* 3 */ if (_L102 | !_L110) { (*Akku_out).V_P_MRDT_index = (*Akku_in).V_P_MRDT_index; } else { (*Akku_out).V_P_MRDT_index = index; } (*Akku_out).V_P_MRDT_ebd = _L111; }