Commit d754359a authored by 李冠华's avatar 李冠华

feat:混动车型增加刀盘档位指示灯工作逻辑

parent c5d63a95
......@@ -17,6 +17,7 @@ void Data_Gear_KL15_Init(void)
void Data_Gear_Cutterhead_Service(void)
{
#if (PART_NUMBER == RMR42E_60)
uint8_t Signal1 = Get_CAN_Num_BMCU_BladeSpeedGear();
uint8_t Signal2 = Get_CAN_Num_BMCU_ErrorGrage();
// uint8_t MBMS_StatBattWorkState = Get_CAN_CH0_ID_18203220_Sig_MBMS_StatBattWorkState();
......@@ -44,6 +45,35 @@ void Data_Gear_Cutterhead_Service(void)
Gear.CutterheadValid = 0x0U;
Gear.CutterHeadNum = 0U;
}
#else
uint8_t Signal = Get_CAN_CH0_ID_220_Sig_VCU_BladeSpdGear();
if ((Common_Get_IG_Sts() == COMMON_POWER_ON) && (System_Indicator_CANFlag != 1))
{
if (CAN_MSG_Status(&CAN_CH0_CanMsgOp, Co_Can_ConvertSubID_CAN_CH0(CAN_CH0_ID_CAN_0x220_Msg)) == CAN_SIG_NORMAL)
{
if (Signal == 0U)
{
Gear.CutterHeadNum = Gear_L;
}
else if (Signal == 1U)
{
Gear.CutterHeadNum = Gear_H;
}
else
{
Gear.CutterHeadNum = 0U;
}
Gear.CutterheadValid = 0x1U;
}
}
else
{
Gear.CutterheadValid = 0x0U;
Gear.CutterHeadNum = 0U;
}
#endif
}
void Data_Gear_Service(void)
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment