|
|
@ -114,8 +114,13 @@ static void Custom_ModuleHandler(const Msg_t *pstMsg) |
|
|
static int iLeft_Compensation = 0; |
|
|
static int iLeft_Compensation = 0; |
|
|
static int iRight_Compensation = 0; |
|
|
static int iRight_Compensation = 0; |
|
|
static int iVehicleSpeed = 1; |
|
|
static int iVehicleSpeed = 1; |
|
|
|
|
|
static int iIsStopOffPaint = 0; |
|
|
switch (pstMsg->m_uiMsgID) |
|
|
switch (pstMsg->m_uiMsgID) |
|
|
{ |
|
|
{ |
|
|
|
|
|
case CUSTOM_SET_STOP_OFF_PAINT: |
|
|
|
|
|
{ |
|
|
|
|
|
iIsStopOffPaint = 1; |
|
|
|
|
|
} |
|
|
case CUSTOM_GET_DAEMON_CODE: |
|
|
case CUSTOM_GET_DAEMON_CODE: |
|
|
{ |
|
|
{ |
|
|
if (pstMsg->m_uiDataLen >= sizeof(int32_t)) |
|
|
if (pstMsg->m_uiDataLen >= sizeof(int32_t)) |
|
|
@ -358,12 +363,16 @@ static void Custom_ModuleHandler(const Msg_t *pstMsg) |
|
|
if (g_stPV.RunMode == 1) |
|
|
if (g_stPV.RunMode == 1) |
|
|
{ |
|
|
{ |
|
|
if (g_stMK32.CH6_SC == -1000) |
|
|
if (g_stMK32.CH6_SC == -1000) |
|
|
|
|
|
{ |
|
|
|
|
|
if (0 == iIsStopOffPaint) |
|
|
{ |
|
|
{ |
|
|
g_Paint_State = 0; |
|
|
g_Paint_State = 0; |
|
|
MsgCenter_SendTo(MODULE_NAME_CUSTOM, CUSTOM_CMD_PAINTGUN, &g_Paint_State, sizeof(int)); |
|
|
MsgCenter_SendTo(MODULE_NAME_CUSTOM, CUSTOM_CMD_PAINTGUN, &g_Paint_State, sizeof(int)); |
|
|
} |
|
|
} |
|
|
|
|
|
} |
|
|
else |
|
|
else |
|
|
{ |
|
|
{ |
|
|
|
|
|
iIsStopOffPaint = 0; |
|
|
g_Paint_State = 1; |
|
|
g_Paint_State = 1; |
|
|
MsgCenter_SendTo(MODULE_NAME_CUSTOM, CUSTOM_CMD_PAINTGUN, &g_Paint_State, sizeof(int)); |
|
|
MsgCenter_SendTo(MODULE_NAME_CUSTOM, CUSTOM_CMD_PAINTGUN, &g_Paint_State, sizeof(int)); |
|
|
} |
|
|
} |
|
|
|