/* TargetLimits_Pkg::d_RSM_start */
void d_RSM_start_TargetLimits_Pkg(
/* TargetLimits_Pkg::d_RSM_start::V_release */ V_internal_real_Type_SDM_Types_ V_release,
/* TargetLimits_Pkg::d_RSM_start::EBDcurve */ ParabolaCurve_T_CalcBrakingCurv *EBDcurve,
/* TargetLimits_Pkg::d_RSM_start::SBDcurve */ ParabolaCurve_T_CalcBrakingCurv *SBDcurve,
/* TargetLimits_Pkg::d_RSM_start::d_maxsafefront */ L_internal_real_Type_SDM_Types_ d_maxsafefront,
/* TargetLimits_Pkg::d_RSM_start::d_est */ L_internal_real_Type_SDM_Types_ d_est,
/* TargetLimits_Pkg::d_RSM_start::T */ T_trac_t_TargetLimits_Pkg *T,
/* TargetLimits_Pkg::d_RSM_start::D_FLOI */ L_internal_real_Type_SDM_Types_ *D_FLOI,
/* TargetLimits_Pkg::d_RSM_start::D_SBI2 */ L_internal_real_Type_SDM_Types_ *D_SBI2,
/* TargetLimits_Pkg::d_RSM_start::D_SBI1 */ L_internal_real_Type_SDM_Types_ *D_SBI1,
/* TargetLimits_Pkg::d_RSM_start::valid_SBI2 */ kcg_bool *valid_SBI2,
/* TargetLimits_Pkg::d_RSM_start::valid_SBI1 */ kcg_bool *valid_SBI1)
{
/* TargetLimits_Pkg::d_RSM_start */
static kcg_bool tmp;
/* 2 */
d_EBI_non_est_TargetLimits_Pkg(V_release, EBDcurve, T, D_SBI2, valid_SBI2);
/* 1 */ d_SBI1_TargetLimits_Pkg(SBDcurve, V_release, T, valid_SBI1, D_SBI1);
tmp = /* 1 */
isLEValid_TargetLimits_Pkg(
*valid_SBI2,
d_maxsafefront - d_est,
*valid_SBI1,
*D_SBI2 - *D_SBI1);
/* 1 */ if (tmp) {
*D_FLOI = *D_SBI1;
}
else {
*D_FLOI = *D_SBI2;
}
}
/* TargetLimits_Pkg::d_limits */
void d_limits_TargetLimits_Pkg(
/* TargetLimits_Pkg::d_limits::V_est */ V_internal_real_Type_SDM_Types_Pkg V_est,
/* TargetLimits_Pkg::d_limits::SBDcurve */ ParabolaCurve_T_CalcBrakingCurves_types *SBDcurve,
/* TargetLimits_Pkg::d_limits::SBI2valid */ kcg_bool SBI2valid,
/* TargetLimits_Pkg::d_limits::D_SBI2_V_est */ L_internal_real_Type_SDM_Types_Pkg D_SBI2_V_est,
/* TargetLimits_Pkg::d_limits::D_estfront */ L_internal_real_Type_SDM_Types_Pkg D_estfront,
/* TargetLimits_Pkg::d_limits::D_maxsafefront */ L_internal_real_Type_SDM_Types_Pkg D_maxsafefront,
/* TargetLimits_Pkg::d_limits::T */ T_trac_t_TargetLimits_Pkg *T,
/* TargetLimits_Pkg::d_limits::GUIcurve */ ParabolaCurve_T_CalcBrakingCurves_types *GUIcurve,
/* TargetLimits_Pkg::d_limits::guiCurveEnabled */ kcg_bool guiCurveEnabled,
/* TargetLimits_Pkg::d_limits::D_I */ L_internal_real_Type_SDM_Types_Pkg *D_I,
/* TargetLimits_Pkg::d_limits::D_P */ L_internal_real_Type_SDM_Types_Pkg *D_P,
/* TargetLimits_Pkg::d_limits::D_W */ L_internal_real_Type_SDM_Types_Pkg *D_W,
/* TargetLimits_Pkg::d_limits::D_FLOI */ L_internal_real_Type_SDM_Types_Pkg *D_FLOI,
/* TargetLimits_Pkg::d_limits::FLOIisSBI1 */ kcg_bool *FLOIisSBI1)
{
/* TargetLimits_Pkg::d_limits */
static kcg_bool tmp1;
/* TargetLimits_Pkg::d_limits */
static L_internal_real_Type_SDM_Types_Pkg tmp;
/* TargetLimits_Pkg::d_limits::_L31 */
static kcg_bool _L31;
/* TargetLimits_Pkg::d_limits::_L37 */
static kcg_bool _L37;
/* 1 */ d_SBI1_TargetLimits_Pkg(SBDcurve, V_est, T, &tmp1, &tmp);
*FLOIisSBI1 = /* 2 */
isLEValid_TargetLimits_Pkg(
tmp1,
tmp - D_estfront,
SBI2valid,
D_SBI2_V_est - D_maxsafefront);
/* 1 */ if (*FLOIisSBI1) {
*D_FLOI = tmp;
}
else {
*D_FLOI = D_SBI2_V_est;
}
*D_W = *D_FLOI - T_warning_SDM_Types_Pkg * V_est;
/* ck_guiCurveEnabled */ if (guiCurveEnabled) {
/* 1 */
getLocationOnCurve_CalcBrakingCurves_types(GUIcurve, V_est, &tmp1, &tmp);
}
else {
tmp1 = kcg_false;
tmp = 0.0;
}
/* 1 */
selectLEValid_TargetLimits_Pkg(
kcg_true,
*D_FLOI - V_est * T_driver_SDM_Types_Pkg,
tmp1,
tmp,
&_L31,
&_L37,
D_P);
*D_I = *D_P - V_est * (*T).indication;
}
/* 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;
}
