|
@@ -495,6 +495,7 @@ uint8_t TimeBuf[7] = {0x20,0x21,0x12,0x29,0x13,0x28,0x55};
|
|
|
float e2;
|
|
|
float laterval;
|
|
|
uni_YeweiToPlatForm uni_YeweiToPlatFormt;
|
|
|
+int LiquidSenSorStatus;
|
|
|
/* USER CODE END Header_Task_Usart_GetAllSensorData */
|
|
|
void Task_Usart2_Collector(void const *argument)
|
|
|
{
|
|
@@ -503,6 +504,8 @@ void Task_Usart2_Collector(void const *argument)
|
|
|
int count=0;
|
|
|
int retry;
|
|
|
float flo_Data=0;
|
|
|
+ int got_crc_error = 0;
|
|
|
+ int got_no_answer = 0;
|
|
|
/* Infinite loop */
|
|
|
int i001 = 0;
|
|
|
tmrForRemoteCali=SPAN_RemoteCali_INTERVAL;
|
|
@@ -534,6 +537,8 @@ void Task_Usart2_Collector(void const *argument)
|
|
|
ModbusCRC_Check = (ModbusCRC_Check << 8) | USART2_RX_BUF[USART2_RX_BUF[2] + 3];
|
|
|
if (ModbusCRC == ModbusCRC_Check)
|
|
|
{
|
|
|
+ got_no_answer = 0;
|
|
|
+ got_crc_error = 0;
|
|
|
uni_YeweiToPlatFormt.farray[0] = USART2_RX_BUF[4];
|
|
|
uni_YeweiToPlatFormt.farray[1] = USART2_RX_BUF[3];
|
|
|
uni_YeweiToPlatFormt.farray[2] = USART2_RX_BUF[6];
|
|
@@ -577,10 +582,22 @@ void Task_Usart2_Collector(void const *argument)
|
|
|
}
|
|
|
}
|
|
|
flo_Data = uni_YeweiToPlatFormt.flo_Data;
|
|
|
+ }else {
|
|
|
+ got_crc_error++;
|
|
|
}
|
|
|
}
|
|
|
+ }else{
|
|
|
+ got_no_answer++;
|
|
|
}
|
|
|
}
|
|
|
+
|
|
|
+ if (got_no_answer > 150) {
|
|
|
+ LiquidSenSorStatus = 500;
|
|
|
+ }else if (got_crc_error > 150) {
|
|
|
+ LiquidSenSorStatus = 501;
|
|
|
+ }else{
|
|
|
+ LiquidSenSorStatus = 0;
|
|
|
+ }
|
|
|
|
|
|
#if 0
|
|
|
//HAL_GPIO_TogglePin(GPIOC, DWI_Pin); //¸´Î»¿´ÃŹ·sp706
|
|
@@ -2503,7 +2520,10 @@ void DisplayRunInfo(uint32_t FunDebugCode000)
|
|
|
break;
|
|
|
|
|
|
default:
|
|
|
- Len001RunInfo = sprintf((char *)bufText01Password, " code=%5d\r\n",FunDebugCode000);
|
|
|
+ if (LiquidSenSorStatus>0)
|
|
|
+ Len001RunInfo = sprintf((char *)bufText01Password, " Ecode=%5d\r\n",LiquidSenSorStatus);
|
|
|
+ else
|
|
|
+ Len001RunInfo = sprintf((char *)bufText01Password, " code=%5d\r\n",FunDebugCode000);
|
|
|
break;
|
|
|
}
|
|
|
|