mirror of
https://github.com/Dev-KATECH/ADM.git
synced 2026-06-10 16:24:11 +09:00
226 lines
5.1 KiB
Plaintext
226 lines
5.1 KiB
Plaintext
ACU_Motor_Logic ()
|
|
{
|
|
long unsigned int GV_VCU_Drive_Mode.14_1;
|
|
long unsigned int GV_VCU_ACU_long_Ctl_mode.15_2;
|
|
float GV_ACU_Drive_ACC_Cmd.16_3;
|
|
float _4;
|
|
long unsigned int GV_ACU_Vx_Command.18_5;
|
|
long unsigned int _6;
|
|
float _7;
|
|
|
|
<bb 2> [local count: 1073741824]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_Drive_Mode.14_1 = GV_VCU_Drive_Mode;
|
|
if (GV_VCU_Drive_Mode.14_1 == 0)
|
|
goto <bb 3>; [50.00%]
|
|
else
|
|
goto <bb 7>; [50.00%]
|
|
|
|
<bb 3> [local count: 536870913]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_ACU_long_Ctl_mode.15_2 = GV_VCU_ACU_long_Ctl_mode;
|
|
if (GV_VCU_ACU_long_Ctl_mode.15_2 == 1)
|
|
goto <bb 4>; [34.00%]
|
|
else
|
|
goto <bb 5>; [66.00%]
|
|
|
|
<bb 4> [local count: 182536110]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_ACU_Drive_ACC_Cmd.16_3 = GV_ACU_Drive_ACC_Cmd;
|
|
_4 = GV_ACU_Drive_ACC_Cmd.16_3 * 1.0e+1;
|
|
GV_VCU_TrqCmd = _4;
|
|
goto <bb 7>; [100.00%]
|
|
|
|
<bb 5> [local count: 354334802]:
|
|
# DEBUG BEGIN_STMT
|
|
if (GV_VCU_ACU_long_Ctl_mode.15_2 == 0)
|
|
goto <bb 6>; [50.00%]
|
|
else
|
|
goto <bb 7>; [50.00%]
|
|
|
|
<bb 6> [local count: 177167401]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_ACU_Vx_Command.18_5 = GV_ACU_Vx_Command;
|
|
_6 = GV_ACU_Vx_Command.18_5 / 5;
|
|
_7 = (float) _6;
|
|
GV_VCU_TrqCmd = _7;
|
|
|
|
<bb 7> [local count: 1073741824]:
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
RC_Motor_Logic ()
|
|
{
|
|
long unsigned int GV_VCU_Drive_Mode.8_1;
|
|
long unsigned int GV_VCU_RC_long_Ctl_mode.9_2;
|
|
long unsigned int GV_RC_Drive_ACC_Cmd.10_3;
|
|
long unsigned int _4;
|
|
float _5;
|
|
long unsigned int GV_RC_Vx_Command.12_6;
|
|
float _7;
|
|
float Motor_Tunning.13_8;
|
|
float _9;
|
|
|
|
<bb 2> [local count: 1073741823]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_Drive_Mode.8_1 = GV_VCU_Drive_Mode;
|
|
if (GV_VCU_Drive_Mode.8_1 == 1)
|
|
goto <bb 3>; [34.00%]
|
|
else
|
|
goto <bb 7>; [66.00%]
|
|
|
|
<bb 3> [local count: 365072220]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_RC_long_Ctl_mode.9_2 = GV_VCU_RC_long_Ctl_mode;
|
|
if (GV_VCU_RC_long_Ctl_mode.9_2 == 1)
|
|
goto <bb 4>; [34.00%]
|
|
else
|
|
goto <bb 5>; [66.00%]
|
|
|
|
<bb 4> [local count: 124124555]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_RC_Drive_ACC_Cmd.10_3 = GV_RC_Drive_ACC_Cmd;
|
|
_4 = GV_RC_Drive_ACC_Cmd.10_3 * 10;
|
|
_5 = (float) _4;
|
|
GV_VCU_TrqCmd = _5;
|
|
goto <bb 7>; [100.00%]
|
|
|
|
<bb 5> [local count: 240947665]:
|
|
# DEBUG BEGIN_STMT
|
|
if (GV_VCU_RC_long_Ctl_mode.9_2 == 0)
|
|
goto <bb 6>; [50.00%]
|
|
else
|
|
goto <bb 7>; [50.00%]
|
|
|
|
<bb 6> [local count: 120473832]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_RC_Vx_Command.12_6 = GV_RC_Vx_Command;
|
|
_7 = (float) GV_RC_Vx_Command.12_6;
|
|
Motor_Tunning.13_8 = Motor_Tunning;
|
|
_9 = _7 * Motor_Tunning.13_8;
|
|
GV_VCU_TrqCmd = _9;
|
|
|
|
<bb 7> [local count: 1073741824]:
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
Motor_init ()
|
|
{
|
|
long unsigned int GV_VCU_GearSelStat.0_1;
|
|
long unsigned int GV_VCU_BmsFlt.4_2;
|
|
long unsigned int GV_VCU_BmsHvSt.5_3;
|
|
long unsigned int GV_ACU_BMS_FltSta.6_4;
|
|
unsigned char GV_BMS_HVOn_STA.7_5;
|
|
long unsigned int _6;
|
|
|
|
<bb 2> [local count: 1073741821]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_GearSelStat.0_1 = GV_VCU_GearSelStat;
|
|
if (GV_VCU_GearSelStat.0_1 == 0)
|
|
goto <bb 3>; [50.00%]
|
|
else
|
|
goto <bb 4>; [50.00%]
|
|
|
|
<bb 3> [local count: 536870910]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_GearCmd = 7;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_MtrDir = 0;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_EPAM_Park_Request_to_EPC = 1;
|
|
goto <bb 10>; [100.00%]
|
|
|
|
<bb 4> [local count: 536870910]:
|
|
# DEBUG BEGIN_STMT
|
|
if (GV_VCU_GearSelStat.0_1 == 1)
|
|
goto <bb 5>; [34.00%]
|
|
else
|
|
goto <bb 6>; [66.00%]
|
|
|
|
<bb 5> [local count: 182536109]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_GearCmd = 2;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_MtrDir = 2;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_EPAM_Park_Request_to_EPC = 2;
|
|
goto <bb 10>; [100.00%]
|
|
|
|
<bb 6> [local count: 354334801]:
|
|
# DEBUG BEGIN_STMT
|
|
if (GV_VCU_GearSelStat.0_1 == 2)
|
|
goto <bb 7>; [34.00%]
|
|
else
|
|
goto <bb 8>; [66.00%]
|
|
|
|
<bb 7> [local count: 120473832]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_GearCmd = 3;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_MtrDir = 0;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_EPAM_Park_Request_to_EPC = 2;
|
|
goto <bb 10>; [100.00%]
|
|
|
|
<bb 8> [local count: 233860969]:
|
|
# DEBUG BEGIN_STMT
|
|
if (GV_VCU_GearSelStat.0_1 == 3)
|
|
goto <bb 9>; [34.00%]
|
|
else
|
|
goto <bb 10>; [66.00%]
|
|
|
|
<bb 9> [local count: 79512729]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_GearCmd = 4;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_MtrDir = 1;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_EPAM_Park_Request_to_EPC = 2;
|
|
|
|
<bb 10> [local count: 1073741823]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_BmsFlt.4_2 = GV_VCU_BmsFlt;
|
|
if (GV_VCU_BmsFlt.4_2 == 0)
|
|
goto <bb 11>; [50.00%]
|
|
else
|
|
goto <bb 13>; [50.00%]
|
|
|
|
<bb 11> [local count: 536870911]:
|
|
GV_VCU_BmsHvSt.5_3 = GV_VCU_BmsHvSt;
|
|
if (GV_VCU_BmsHvSt.5_3 == 1)
|
|
goto <bb 12>; [34.00%]
|
|
else
|
|
goto <bb 13>; [66.00%]
|
|
|
|
<bb 12> [local count: 182536110]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_PwrEnable = 1;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_ControlMode = 1;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_Ready = 1;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_TorqueContol = 1;
|
|
|
|
<bb 13> [local count: 1073741824]:
|
|
# DEBUG BEGIN_STMT
|
|
GV_ACU_BMS_FltSta.6_4 = GV_ACU_BMS_FltSta;
|
|
GV_VCU_BmsFlt = GV_ACU_BMS_FltSta.6_4;
|
|
# DEBUG BEGIN_STMT
|
|
GV_BMS_HVOn_STA.7_5 = GV_BMS_HVOn_STA;
|
|
_6 = (long unsigned int) GV_BMS_HVOn_STA.7_5;
|
|
GV_VCU_BmsHvSt = _6;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_PosTrqLimit = 80;
|
|
# DEBUG BEGIN_STMT
|
|
GV_VCU_NegTrqLimit = -5.0e+1;
|
|
return;
|
|
|
|
}
|
|
|
|
|