/* TA_Gradient::Update_GP_then_LRBG */
void Update_GP_then_LRBG_TA_Gradient(
/* TA_Gradient::Update_GP_then_LRBG::GP_in */GradientProfile_t_TrackAtlasTypes *GP_in,
/* TA_Gradient::Update_GP_then_LRBG::P27V1_in */P021_OBU_T_TM *P27V1_in,
/* TA_Gradient::Update_GP_then_LRBG::TrainPosition_in */trainPosition_T_TrainPosition_Types_Pck *TrainPosition_in,
outC_Update_GP_then_LRBG_TA_Gradient *outC)
{
kcg_copy_trainPosition_T_TrainPosition_Types_Pck(
&outC->_L4,
TrainPosition_in);
outC->_L13 = outC->_L4.LRBG.location.nominal;
kcg_copy_P021_OBU_T_TM(&outC->_L2, P27V1_in);
/* 1 */
_21_Convert_P21_to_DistancePr_TA_Gradient(&outC->_L2, &outC->Context_1);
kcg_copy_GradientProfile_t_TrackAtlasTypes(
&outC->_L6,
&outC->Context_1.GradientProfile);
kcg_copy_GradientProfile_t_TrackAtlasTypes(&outC->_L1, GP_in);
/* 1 */
Update_GP_per_LRBG_TA_Lib_internal(
&outC->_L6,
&outC->_L1,
&outC->_1_Context_1);
kcg_copy_GradientProfile_t_TrackAtlasTypes(
&outC->_L5,
&outC->_1_Context_1.GradientdProfile_out);
outC->_L11 = outC->_L4.prvLRBG.location.nominal;
outC->_L10 = outC->_L13 - outC->_L11;
/* 1 */
MoveGPSectionsToNewLRBGafter_TA_Lib_internal(
&outC->_L5,
outC->_L10,
&outC->_2_Context_1);
kcg_copy_GradientProfile_t_TrackAtlasTypes(
&outC->_L12,
&outC->_2_Context_1.ProfileOut);
kcg_copy_GradientProfile_t_TrackAtlasTypes(
&outC->new_profile_out,
&outC->_L12);
}
/* TM_conversions::C_P021_compr_onboard */
void C_P021_compr_onboard_TM_conversions(
/* TM_conversions::C_P021_compr_onboard::PacketData */CompressedPacketData_T_Common_Types_Pkg *PacketData,
/* TM_conversions::C_P021_compr_onboard::Metadata_Element */MetadataElement_T_Common_Types_Pkg *Metadata_Element,
outC_C_P021_compr_onboard_TM_conversions *outC)
{
kcg_bool _26_noname_1;
kcg_bool _25_noname_1;
/* TM_conversions::CAST_Int_to_Q_DIR::q_dir */ Q_DIR _24_q_dir_1;
/* TM_conversions::CAST_Int_to_Q_DIR::error */ kcg_bool _23_error_1;
/* TM_conversions::CAST_Int_to_Q_DIR::q_dir */ Q_DIR _22_q_dir_1;
/* TM_conversions::CAST_Int_to_Q_DIR::error */ kcg_bool _21_error_1;
/* TM_conversions::CAST_Int_to_Q_DIR::error */ kcg_bool _20_error_1;
/* TM_conversions::CAST_Int_to_Q_DIR::q_dir */ Q_DIR _19_q_dir_1;
/* TM_conversions::CAST_Int_to_Q_DIR::error */ kcg_bool _18_error_1;
/* TM_conversions::CAST_Int_to_Q_DIR::q_dir */ Q_DIR _17_q_dir_1;
/* TM_conversions::CAST_Int_to_Q_DIR::q_dir */ Q_DIR _16_q_dir_1;
/* TM_conversions::CAST_Int_to_Q_DIR::error */ kcg_bool _15_error_1;
/* TM_conversions::CAST_Int_to_Q_DIR::q_dir */ Q_DIR q_dir_1;
/* TM_conversions::CAST_Int_to_Q_DIR::error */ kcg_bool _14_error_1;
kcg_bool _13_noname_1;
kcg_bool _12_noname_1;
kcg_bool _11_noname_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::q_scale */ Q_SCALE _10_q_scale_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::error */ kcg_bool _9_error_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::q_scale */ Q_SCALE _8_q_scale_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::error */ kcg_bool _7_error_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::error */ kcg_bool _6_error_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::q_scale */ Q_SCALE _5_q_scale_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::error */ kcg_bool _4_error_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::q_scale */ Q_SCALE _3_q_scale_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::q_scale */ Q_SCALE _2_q_scale_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::error */ kcg_bool _1_error_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::q_scale */ Q_SCALE q_scale_1;
/* TM_conversions::CAST_Int_to_Q_SCALE::error */ kcg_bool error_1;
kcg_bool noname_1;
MetadataElement_T_Common_Types_Pkg noname;
kcg_int _27_noname;
kcg_copy_CompressedPacketData_T_Common_Types_Pkg(&outC->_L9, PacketData);
kcg_copy_array_int_5(&outC->_L1, (array_int_5 *) &outC->_L9[0]);
outC->_L31 = outC->_L1[4];
outC->_L30 = outC->_L1[3];
outC->_L29 = outC->_L1[2];
outC->_L28 = outC->_L1[1];
_27_noname = outC->_L29;
kcg_copy_array_int_99(&outC->_L32, (array_int_99 *) &outC->_L9[5]);
outC->_L27 = outC->_L1[0];
outC->nid_packet_int_1 = outC->_L27;
outC->_L1_120 = outC->nid_packet_int_1;
outC->nid_packet_1 = outC->_L1_120;
outC->_L12 = outC->nid_packet_1;
outC->_L21 = 21;
outC->_L22 = outC->_L12 == outC->_L21;
kcg_copy_MetadataElement_T_Common_Types_Pkg(&outC->_L20, Metadata_Element);
kcg_copy_MetadataElement_T_Common_Types_Pkg(&noname, &outC->_L20);
outC->q_dir_int_1 = outC->_L28;
outC->_6__L12_1 = outC->q_dir_int_1;
outC->q_dir_in_1 = outC->_6__L12_1;
outC->_8_IfBlock1_clock_1 = outC->q_dir_in_1 ==
INT_Q_DIR_nomiinal_TM_conversions;
if (outC->_8_IfBlock1_clock_1) {
outC->_L4_116_IfBlock1 = ENUM_Q_DIR_nominal_TM_conversions;
_24_q_dir_1 = outC->_L4_116_IfBlock1;
outC->q_dir_1 = _24_q_dir_1;
}
else {
outC->_15_else_clock_1_IfBlock1 = outC->q_dir_in_1 ==
INT_Q_DIR_reverse_TM_conversions;
if (outC->_15_else_clock_1_IfBlock1) {
outC->_L3_19_IfBlock1 = ENUM_Q_DIR_reverse_TM_conversions;
q_dir_1 = outC->_L3_19_IfBlock1;
_22_q_dir_1 = q_dir_1;
}
else {
outC->_10_else_clock_1_IfBlock1 = outC->q_dir_in_1 ==
INT_Q_DIR_both_TM_conversions;
if (outC->_10_else_clock_1_IfBlock1) {
outC->_L2_113_IfBlock1 = ENUM_Q_DIR_both_TM_conversions;
_19_q_dir_1 = outC->_L2_113_IfBlock1;
_16_q_dir_1 = _19_q_dir_1;
}
else {
outC->_L2_111_IfBlock1 = ENUM_Q_DIR_both_TM_conversions;
_17_q_dir_1 = outC->_L2_111_IfBlock1;
_16_q_dir_1 = _17_q_dir_1;
}
_22_q_dir_1 = _16_q_dir_1;
}
outC->q_dir_1 = _22_q_dir_1;
}
outC->_L11 = outC->q_dir_1;
outC->q_scale_int_1 = outC->_L30;
outC->_L2_1 = outC->q_scale_int_1;
outC->q_scale_in_1 = outC->_L2_1;
outC->IfBlock1_clock_1 = outC->q_scale_in_1 ==
INT_Q_SCALE_10cm_TM_conversions;
if (outC->IfBlock1_clock_1) {
outC->_L2_14_IfBlock1 = ENUM_Q_SCALE_10cm_TM_conversions;
_10_q_scale_1 = outC->_L2_14_IfBlock1;
outC->q_scale_1 = _10_q_scale_1;
}
else {
outC->_3_else_clock_1_IfBlock1 = outC->q_scale_in_1 ==
INT_Q_SCALE_1m_TM_conversions;
if (outC->_3_else_clock_1_IfBlock1) {
outC->_L1_1_IfBlock1 = ENUM_Q_SCALE_1m_TM_conversions;
q_scale_1 = outC->_L1_1_IfBlock1;
_8_q_scale_1 = q_scale_1;
}
else {
outC->else_clock_1_IfBlock1 = outC->q_scale_in_1 ==
INT_Q_SCALE_10m_TM_conversions;
if (outC->else_clock_1_IfBlock1) {
outC->_L1_12_IfBlock1 = ENUM_Q_SCALE_10m_TM_conversions;
_5_q_scale_1 = outC->_L1_12_IfBlock1;
_2_q_scale_1 = _5_q_scale_1;
}
else {
outC->_L1_11_IfBlock1 = ENUM_Q_SCALE_10cm_TM_conversions;
_3_q_scale_1 = outC->_L1_11_IfBlock1;
_2_q_scale_1 = _3_q_scale_1;
}
_8_q_scale_1 = _2_q_scale_1;
}
outC->q_scale_1 = _8_q_scale_1;
}
outC->_L4 = outC->q_scale_1;
outC->n_iter_int_1 = outC->_L31;
outC->_L1_1 = outC->n_iter_int_1;
outC->n_iter_1 = outC->_L1_1;
outC->_L7 = outC->n_iter_1;
/* 1 */
C_P021_unflatten_sections_TM_lib_internal(
outC->_L22,
outC->_L7,
&outC->_L32,
&outC->Context_1);
kcg_copy_P021_OBU_sectionlist_enum_T_TM(
&outC->_L5,
&outC->Context_1.sections);
outC->_L10.valid = outC->_L22;
outC->_L10.q_dir = outC->_L11;
outC->_L10.q_scale = outC->_L4;
outC->_L10.n_iter = outC->_L7;
kcg_copy_P021_OBU_sectionlist_enum_T_TM(&outC->_L10.sections, &outC->_L5);
kcg_copy_P021_OBU_T_TM(&outC->P021_onboard, &outC->_L10);
if (outC->IfBlock1_clock_1) {
outC->_L3_15_IfBlock1 = kcg_false;
_9_error_1 = outC->_L3_15_IfBlock1;
outC->error_1 = _9_error_1;
}
else {
if (outC->_3_else_clock_1_IfBlock1) {
outC->_L3_1_IfBlock1 = kcg_false;
error_1 = outC->_L3_1_IfBlock1;
_7_error_1 = error_1;
}
else {
if (outC->else_clock_1_IfBlock1) {
outC->_L4_1_IfBlock1 = kcg_false;
_6_error_1 = outC->_L4_1_IfBlock1;
_1_error_1 = _6_error_1;
}
else {
outC->_L2_1_IfBlock1 = kcg_true;
_4_error_1 = outC->_L2_1_IfBlock1;
_1_error_1 = _4_error_1;
}
_7_error_1 = _1_error_1;
}
outC->error_1 = _7_error_1;
}
outC->_L4_1 = outC->error_1;
noname_1 = outC->_L4_1;
outC->_L11_1 = 0;
outC->_L10_1 = outC->_L1_1 < outC->_L11_1;
_11_noname_1 = outC->_L10_1;
outC->_L9_1 = 31;
outC->_L12_1 = outC->_L1_1 > outC->_L9_1;
_12_noname_1 = outC->_L12_1;
if (outC->_8_IfBlock1_clock_1) {
outC->_L5_117_IfBlock1 = kcg_false;
_23_error_1 = outC->_L5_117_IfBlock1;
outC->_7_error_1 = _23_error_1;
}
else {
if (outC->_15_else_clock_1_IfBlock1) {
outC->_L5_1_IfBlock1 = kcg_false;
_14_error_1 = outC->_L5_1_IfBlock1;
_21_error_1 = _14_error_1;
}
else {
if (outC->_10_else_clock_1_IfBlock1) {
outC->_L4_114_IfBlock1 = kcg_false;
_20_error_1 = outC->_L4_114_IfBlock1;
_15_error_1 = _20_error_1;
}
else {
outC->_L1_112_IfBlock1 = kcg_true;
_18_error_1 = outC->_L1_112_IfBlock1;
_15_error_1 = _18_error_1;
}
_21_error_1 = _15_error_1;
}
outC->_7_error_1 = _21_error_1;
}
outC->_L13_1 = outC->_7_error_1;
_13_noname_1 = outC->_L13_1;
outC->_L5_1 = 0;
outC->_L4_119 = outC->_L1_120 < outC->_L5_1;
outC->_L3_1 = 256;
outC->_L2_118 = outC->_L1_120 > outC->_L3_1;
_25_noname_1 = outC->_L2_118;
_26_noname_1 = outC->_L4_119;
}
