|
@@ -24,6 +24,7 @@ uint8_t ALL_TxBuf[70] = {0};
|
|
|
|
|
|
|
|
|
KZQ_Inf kzq_inf;
|
|
|
+extern uint16_t Uart_len_TouChuan;
|
|
|
|
|
|
#include "stm32f1xx_hal.h"
|
|
|
|
|
@@ -60,30 +61,36 @@ uint16_t Read_CangState(uint8_t* pTx)
|
|
|
/*************第一组阀门状态***************/
|
|
|
|
|
|
if(phdf[HDF_Start+1].HDF_Error)
|
|
|
- pTx[18] = State_Error;
|
|
|
+ pTx[18] = State_Error;
|
|
|
else
|
|
|
- pTx[18] = Get_DFState(HDF_Start+1); //获取罐仓1号底阀状态
|
|
|
+ pTx[18] = Get_DFState(HDF_Start+1); //获取罐仓1号底阀状态
|
|
|
|
|
|
if(pxyf[XYF_Start+1].XYF_Error)
|
|
|
- pTx[19] = State_Error;
|
|
|
+ pTx[19] = State_Error;
|
|
|
else
|
|
|
- pTx[19] = pxyf[XYF_Start+1].XYF_State1; //获取罐仓1号卸油阀状态 pxyf[XYF_Start+1].XYF_Data1[0] ;
|
|
|
+ pTx[19] = pxyf[XYF_Start+1].XYF_State1; //获取罐仓1号卸油阀状态 pxyf[XYF_Start+1].XYF_Data1[0] ;
|
|
|
tickMain=HAL_GetTick();
|
|
|
if(prkg[RKG_Start+1].RKDG_Error)
|
|
|
{
|
|
|
- pTx[20] = State_Error;
|
|
|
- pTx[21] = State_Error;
|
|
|
+ pTx[20] = State_Error;
|
|
|
+ pTx[21] = State_Error;
|
|
|
+
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- pTx[20] = prkg[RKG_Start+1].RKDG_State; //获取罐仓1号人孔大盖状态
|
|
|
- pTx[21] = prkg[RKG_Start+1].RKXG_State; //获取罐仓1号人孔小盖状态
|
|
|
+ pTx[20] = prkg[RKG_Start+1].RKDG_State; //获取罐仓1号人孔大盖状态
|
|
|
+ pTx[21] = prkg[RKG_Start+1].RKXG_State; //获取罐仓1号人孔小盖状态
|
|
|
+
|
|
|
}
|
|
|
+
|
|
|
if(pxyf[XYF_Start+1].XYF_Error)
|
|
|
pTx[22] = State_Error;
|
|
|
else
|
|
|
pTx[22] = pxyf[XYF_Start+1].XYF_State2; //获取罐仓1号卸尽状态
|
|
|
+
|
|
|
|
|
|
+
|
|
|
+ //新增壁挂油传感器状态 邵磊明20210916
|
|
|
if(pBGY[BGY_Start+1].BGY_Error)
|
|
|
{
|
|
|
pTx[23] = State_Error;
|
|
@@ -92,9 +99,9 @@ uint16_t Read_CangState(uint8_t* pTx)
|
|
|
{
|
|
|
pTx[23] = pBGY[BGY_Start+1].BGY_State;
|
|
|
}
|
|
|
-
|
|
|
+ //新增油气回收传感器状态 邵磊明20210918
|
|
|
pTx[24] = pYqhuishou[1].Yqhuishou_SSWD[0];
|
|
|
-
|
|
|
+ //新增智能海底阀传感器状态 邵磊明20210919
|
|
|
if(phdf[HDF_Start+1].HDF_Error)
|
|
|
pTx[25] = (phdf[HDF_Start+1].HDF_Data[1]);
|
|
|
else
|
|
@@ -112,8 +119,8 @@ uint16_t Read_CangState(uint8_t* pTx)
|
|
|
}
|
|
|
else
|
|
|
pTx[28] = 0xA5;
|
|
|
-// if(pcang->XYF_Num[Cang_Num - 1] > 1)
|
|
|
-// {
|
|
|
+ if(pcang->XYF_Num[Cang_Num - 1] > 1)
|
|
|
+ {
|
|
|
if( pxyf[XYF_Start+2].XYF_Error)
|
|
|
{
|
|
|
pTx[29] = State_Error;
|
|
@@ -124,12 +131,12 @@ uint16_t Read_CangState(uint8_t* pTx)
|
|
|
pTx[29] = pxyf[XYF_Start+2].XYF_State1; //获取罐仓2号卸油阀状态
|
|
|
pTx[32] = pxyf[XYF_Start+2].XYF_State2; //获取罐仓2号卸尽状态
|
|
|
}
|
|
|
-// }
|
|
|
-// else
|
|
|
-// {
|
|
|
-// pTx[29] = 0xA5;
|
|
|
-// pTx[32] = 0xA5;
|
|
|
-// }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ pTx[29] = 0xA5;
|
|
|
+ pTx[32] = 0xA5;
|
|
|
+ }
|
|
|
if(pcang->RKG_Num[Cang_Num - 1] > 1)
|
|
|
{
|
|
|
if(prkg[RKG_Start+2].RKDG_Error)
|
|
@@ -306,11 +313,11 @@ void Sen_CangState_old(uint8_t* F_STATE)
|
|
|
|
|
|
|
|
|
for(k = 0;k < 8;k++) //查询1-8仓状态
|
|
|
- {
|
|
|
- //for(k = 0;k < 8;k++) //查询1-8仓 状态 开始
|
|
|
+ {//for(k = 0;k < 8;k++) //查询1-8仓 状态 开始
|
|
|
i = k*2;
|
|
|
F_STATE[5+i] = 0x00;
|
|
|
F_STATE[6+i] = 0x00;
|
|
|
+ j = 0;
|
|
|
while(j < pcang->RKG_Num[k]) //查询1-8仓所有人孔盖数据
|
|
|
{
|
|
|
if(prkg[j+1+RKG_Num].RKDG_Error)
|
|
@@ -326,41 +333,44 @@ void Sen_CangState_old(uint8_t* F_STATE)
|
|
|
F_STATE[5+i] |= BIT2;
|
|
|
}
|
|
|
j++;
|
|
|
- RKG_Num++;
|
|
|
+ //RKG_Num++;
|
|
|
}
|
|
|
+ RKG_Num+=j;
|
|
|
j = 0;
|
|
|
- while(j < 2)//卸油阀状态或运算pcang->XYF_Num[k]
|
|
|
+ while(j < pcang->XYF_Num[k])////卸油阀状态或运算
|
|
|
{
|
|
|
- if(pxyf[j+1+i].XYF_Error)
|
|
|
+ if(pxyf[j+1+XYF_Num].XYF_Error)
|
|
|
{
|
|
|
F_STATE[5+i] |= BIT8;
|
|
|
F_STATE[6+i] |= 0x55;
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- if(pxyf[j+1+i].XYF_State1)
|
|
|
+ if(pxyf[j+1+XYF_Num].XYF_State1)
|
|
|
F_STATE[5+i] |= BIT4;
|
|
|
- if(pxyf[j+1+i].XYF_State2)
|
|
|
+ if(pxyf[j+1+XYF_Num].XYF_State2)
|
|
|
F_STATE[6+i] = BIT1;//1;
|
|
|
}
|
|
|
j++;
|
|
|
- XYF_Num++;
|
|
|
+ // XYF_Num++;
|
|
|
}
|
|
|
+ XYF_Num+=j;
|
|
|
j = 0;
|
|
|
|
|
|
-
|
|
|
while(j < pcang->HDF_Num[k])
|
|
|
{
|
|
|
if(Get_DFState(j+1+HDF_Num) == 1)
|
|
|
F_STATE[5+i] |= BIT3;
|
|
|
else if(Get_DFState(j+1+HDF_Num) == 0)
|
|
|
- F_STATE[5+i] &= ~BIT3;
|
|
|
+ {
|
|
|
+ ;//F_STATE[5+i] &= ~BIT3;
|
|
|
+ }
|
|
|
else
|
|
|
F_STATE[5+i] &= BIT7;
|
|
|
j++;
|
|
|
- HDF_Num++;
|
|
|
+
|
|
|
}
|
|
|
-
|
|
|
+ HDF_Num+=j;
|
|
|
|
|
|
j = 0;
|
|
|
}////for(k = 0;k < 8;k++) //查询1-8仓 状态 结束
|
|
@@ -2394,7 +2404,7 @@ uint16_t Read_CangSensorData_2(uint8_t* pTx)
|
|
|
*/
|
|
|
uint16_t Read_CangSensorData_1(uint8_t* pTx)//邵磊明增加
|
|
|
{
|
|
|
-//传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
|
|
|
+ //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
|
|
|
// Angle_Inf* pangle = &angle_inf;
|
|
|
TEM_Inf* ptem = tem_inf;
|
|
|
// KZQ_Inf* pkzq = &kzq_inf;
|
|
@@ -2416,13 +2426,13 @@ uint16_t Read_CangSensorData_1(uint8_t* pTx)//
|
|
|
uint8_t Cang_Num = 1,i = 0,HDF_Start = 0,XYF_Start = 0,RKG_Start = 0,BGY_Start = 0;
|
|
|
if(Cang_Num < 1 ||Cang_Num > 8)
|
|
|
return 0;
|
|
|
- for(i = 0;i < Cang_Num - 1;i++)
|
|
|
- {
|
|
|
+ for(i = 0;i < Cang_Num - 1;i++)
|
|
|
+ {
|
|
|
HDF_Start += pcang->HDF_Num[i];
|
|
|
XYF_Start += pcang->XYF_Num[i];
|
|
|
RKG_Start += pcang->RKG_Num[i];
|
|
|
BGY_Start += pcang->BGY_Num[i];
|
|
|
- }
|
|
|
+ }
|
|
|
for(i = 0;i < 4;i++) //铅封
|
|
|
{
|
|
|
pTx[16+i] = 0;
|
|
@@ -2481,23 +2491,23 @@ uint16_t Read_CangSensorData_1(uint8_t* pTx)//
|
|
|
pTx[52+8] = pxyf[XYF_Start+1].XYF_State2; //获取罐仓1号卸尽状态
|
|
|
|
|
|
|
|
|
- //pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
|
|
|
+ // pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
|
|
|
pTx[37+8] = 0;
|
|
|
pTx[38+8] = 0;
|
|
|
pTx[39+8] = 0;
|
|
|
- //pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
|
|
|
+ // pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
|
|
|
pTx[41+8] = 0;
|
|
|
pTx[42+8] = 0;
|
|
|
pTx[43+8] = 0;
|
|
|
- //pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
|
|
|
+ // pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
|
|
|
pTx[45+8] = 0;
|
|
|
pTx[46+8] = 0;
|
|
|
pTx[47+8] = 0;
|
|
|
- //pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
|
|
|
+ // pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
|
|
|
pTx[49+8] = 0;
|
|
|
pTx[50+8] = 0;
|
|
|
pTx[51+8] = 0;
|
|
|
- //pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
|
|
|
+ // pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
|
|
|
pTx[53+8] = 0;
|
|
|
pTx[54+8] = 0;
|
|
|
pTx[55+8] = 0;
|
|
@@ -3101,6 +3111,7 @@ uint16_t Angle_SetZero(uint8_t* pTx)
|
|
|
XYF_TxBuf[3] = 0x01;
|
|
|
XYF_TxBuf[4] = 0x00;
|
|
|
XYF_TxBuf[5] = 0x08;
|
|
|
+ Uart_len_TouChuan=6;
|
|
|
}
|
|
|
else
|
|
|
{
|
|
@@ -3182,6 +3193,7 @@ uint16_t XYF_SetOFF(uint8_t* pTx)
|
|
|
XYF_TxBuf[i++] = 0x0D;
|
|
|
XYF_TxBuf[i++] = 0x0A;
|
|
|
}*/
|
|
|
+ Uart_len_TouChuan=i;
|
|
|
}
|
|
|
else
|
|
|
return 0;
|
|
@@ -3226,6 +3238,7 @@ uint16_t XYF_SetThreshold(uint8_t* pTx)
|
|
|
// XYF_TxBuf[i++] = 0x0D;
|
|
|
// XYF_TxBuf[i++] = 0x0A;
|
|
|
}
|
|
|
+ Uart_len_TouChuan=i;
|
|
|
}
|
|
|
else
|
|
|
return 0;
|
|
@@ -3248,25 +3261,26 @@ uint16_t HDF_Set_CloseVal(uint8_t* pTx)
|
|
|
{
|
|
|
pkzq->USE_XYF = 1;
|
|
|
|
|
|
- ALL_TxBuf[i++] = pkzq->data_buf[17];
|
|
|
- ALL_TxBuf[i++] = 0x06;
|
|
|
- ALL_TxBuf[i++] = 0x10;
|
|
|
- ALL_TxBuf[i++] = pkzq->data_buf[19];
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = pkzq->data_buf[17];
|
|
|
+ XYF_TxBuf[i++] = 0x06;
|
|
|
+ XYF_TxBuf[i++] = 0x10;
|
|
|
+ XYF_TxBuf[i++] = pkzq->data_buf[19];
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
|
|
|
- ModBusCRC = LIB_CRC_MODBUS(ALL_TxBuf,14);
|
|
|
+ ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf,14);
|
|
|
|
|
|
- ALL_TxBuf[i++] = ModBusCRC>>8;
|
|
|
- ALL_TxBuf[i++] = ModBusCRC&0xff;
|
|
|
+ XYF_TxBuf[i++] = ModBusCRC>>8;
|
|
|
+ XYF_TxBuf[i++] = ModBusCRC&0xff;
|
|
|
+ Uart_len_TouChuan=i;
|
|
|
|
|
|
}
|
|
|
else
|
|
@@ -3290,26 +3304,26 @@ uint16_t HDF_Set_Gain(uint8_t* pTx)
|
|
|
{
|
|
|
pkzq->USE_XYF = 1;
|
|
|
|
|
|
- ALL_TxBuf[i++] = pkzq->data_buf[17];
|
|
|
- ALL_TxBuf[i++] = 0x06;
|
|
|
- ALL_TxBuf[i++] = 0x12;
|
|
|
- ALL_TxBuf[i++] = pkzq->data_buf[19];
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = pkzq->data_buf[17];
|
|
|
+ XYF_TxBuf[i++] = 0x06;
|
|
|
+ XYF_TxBuf[i++] = 0x12;
|
|
|
+ XYF_TxBuf[i++] = pkzq->data_buf[19];
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
|
|
|
- ModBusCRC = LIB_CRC_MODBUS(ALL_TxBuf,14);
|
|
|
+ ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf,14);
|
|
|
|
|
|
- ALL_TxBuf[i++] = ModBusCRC>>8;
|
|
|
- ALL_TxBuf[i++] = ModBusCRC&0xff;
|
|
|
-
|
|
|
+ XYF_TxBuf[i++] = ModBusCRC>>8;
|
|
|
+ XYF_TxBuf[i++] = ModBusCRC&0xff;
|
|
|
+ Uart_len_TouChuan=i;
|
|
|
}
|
|
|
else
|
|
|
return 0;
|
|
@@ -3333,26 +3347,26 @@ uint16_t HDF_Reset(uint8_t* pTx)
|
|
|
{
|
|
|
pkzq->USE_XYF = 1;
|
|
|
|
|
|
- ALL_TxBuf[i++] = pkzq->data_buf[17];
|
|
|
- ALL_TxBuf[i++] = 0x06;
|
|
|
- ALL_TxBuf[i++] = 0x00;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = pkzq->data_buf[17];
|
|
|
+ XYF_TxBuf[i++] = 0x06;
|
|
|
+ XYF_TxBuf[i++] = 0x00;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
|
|
|
- ModBusCRC = LIB_CRC_MODBUS(ALL_TxBuf,14);
|
|
|
+ ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf,14);
|
|
|
|
|
|
- ALL_TxBuf[i++] = ModBusCRC>>8;
|
|
|
- ALL_TxBuf[i++] = ModBusCRC&0xff;
|
|
|
-
|
|
|
+ XYF_TxBuf[i++] = ModBusCRC>>8;
|
|
|
+ XYF_TxBuf[i++] = ModBusCRC&0xff;
|
|
|
+ Uart_len_TouChuan=i;
|
|
|
}
|
|
|
else
|
|
|
return 0;
|
|
@@ -3378,26 +3392,26 @@ uint16_t HDF_Set_Threshold(uint8_t* pTx)
|
|
|
{
|
|
|
pkzq->USE_XYF = 1;
|
|
|
|
|
|
- ALL_TxBuf[i++] = pkzq->data_buf[17];
|
|
|
- ALL_TxBuf[i++] = 0x06;
|
|
|
- ALL_TxBuf[i++] = 0x14;
|
|
|
- ALL_TxBuf[i++] = pkzq->data_buf[18];
|
|
|
- ALL_TxBuf[i++] = pkzq->data_buf[19];
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
- ALL_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = pkzq->data_buf[17];
|
|
|
+ XYF_TxBuf[i++] = 0x06;
|
|
|
+ XYF_TxBuf[i++] = 0x14;
|
|
|
+ XYF_TxBuf[i++] = pkzq->data_buf[18];
|
|
|
+ XYF_TxBuf[i++] = pkzq->data_buf[19];
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
+ XYF_TxBuf[i++] = 0xA5;
|
|
|
|
|
|
- ModBusCRC = LIB_CRC_MODBUS(ALL_TxBuf,14);
|
|
|
+ ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf,14);
|
|
|
|
|
|
- ALL_TxBuf[i++] = ModBusCRC>>8;
|
|
|
- ALL_TxBuf[i++] = ModBusCRC&0xff;
|
|
|
-
|
|
|
+ XYF_TxBuf[i++] = ModBusCRC>>8;
|
|
|
+ XYF_TxBuf[i++] = ModBusCRC&0xff;
|
|
|
+ Uart_len_TouChuan=i;
|
|
|
}
|
|
|
else
|
|
|
return 0;
|
|
@@ -3419,7 +3433,7 @@ uint16_t RKG_SetZero(uint8_t* pTx)
|
|
|
{
|
|
|
if(pkzq->data_buf[7] == 0x06)
|
|
|
{
|
|
|
- pkzq->USE_RKG = 1;
|
|
|
+
|
|
|
if(pcang->RKG_Type == 1)
|
|
|
{
|
|
|
// RKG_TxBuf[i++] = 0x0D;
|
|
@@ -3447,6 +3461,8 @@ uint16_t RKG_SetZero(uint8_t* pTx)
|
|
|
// RKG_TxBuf[i++] = 0x0D;
|
|
|
// RKG_TxBuf[i++] = 0x0A;
|
|
|
}
|
|
|
+ Uart_len_TouChuan=i;
|
|
|
+ pkzq->USE_RKG = 1;
|
|
|
}
|
|
|
else
|
|
|
return 0;
|
|
@@ -3629,13 +3645,16 @@ uint16_t CJQ_SetConfig(uint8_t* pTx)
|
|
|
Flash_buf[i] = pkzq->data_buf[16+i];
|
|
|
}
|
|
|
if(pkzq->data_buf[7] == 0x06)
|
|
|
+ {
|
|
|
Flash_WriteBytes(Flash_buf,ADDR_CANG_NUM,pTx[11]);
|
|
|
+ Cang_Init();
|
|
|
+ }
|
|
|
Flash_ReadBytes(Flash_buf,ADDR_CANG_NUM,pTx[11]);
|
|
|
- Cang_Init();
|
|
|
+
|
|
|
for(i = 0;i < pkzq->data_buf[11];i++)
|
|
|
{
|
|
|
- if((Flash_buf[i] != pkzq->data_buf[16+i])&&(pkzq->data_buf[7] == 0x06))
|
|
|
- return 0;
|
|
|
+ //if((Flash_buf[i] != pkzq->data_buf[16+i])&&(pkzq->data_buf[7] == 0x06))
|
|
|
+ // return 0;
|
|
|
pTx[16+i] = Flash_buf[i];
|
|
|
}
|
|
|
return 1;
|
|
@@ -3687,13 +3706,18 @@ uint16_t XYF_SetTypeNum(uint8_t* pTx)
|
|
|
Flash_buf[i] = pkzq->data_buf[16+i];
|
|
|
}
|
|
|
if(pkzq->data_buf[7] == 0x06)
|
|
|
+ {
|
|
|
Flash_WriteBytes(Flash_buf,ADDR_XYFSENSOR_TYPE,1);
|
|
|
+ }
|
|
|
Flash_ReadBytes(Flash_buf,ADDR_XYFSENSOR_TYPE,1);
|
|
|
pTx[16] = Flash_buf[0];
|
|
|
if(Flash_buf[0] < 5)
|
|
|
pcang->XYF_Type = Flash_buf[0];
|
|
|
if(pkzq->data_buf[7] == 0x06)
|
|
|
+ {
|
|
|
Flash_WriteBytes(Flash_buf+1,ADDR_XYF_NUM,8);
|
|
|
+ }
|
|
|
+
|
|
|
Flash_ReadBytes(Flash_buf+1,ADDR_XYF_NUM,8);
|
|
|
|
|
|
for(i = 0;i < pkzq->data_buf[11];i++)
|
|
@@ -3782,13 +3806,9 @@ uint16_t Level_SetCalvalue(uint8_t* pTx)
|
|
|
Flash_buf[1] = pkzq->data_buf[18]<<8|pkzq->data_buf[19];
|
|
|
Flash_buf[2] = pkzq->data_buf[20]<<8|pkzq->data_buf[21];
|
|
|
Flash_buf[3] = pkzq->data_buf[22]<<8|pkzq->data_buf[23];
|
|
|
- Flash_buf[4] = pkzq->data_buf[24]<<8|pkzq->data_buf[25];
|
|
|
- Flash_buf[5] = pkzq->data_buf[26]<<8|pkzq->data_buf[27];
|
|
|
- Flash_buf[6] = pkzq->data_buf[28]<<8|pkzq->data_buf[29];
|
|
|
- Flash_buf[7] = pkzq->data_buf[30]<<8|pkzq->data_buf[31];
|
|
|
if(pkzq->data_buf[7] == 0x06)
|
|
|
- Flash_WriteBytes(Flash_buf,CANG1_LEVEL_CAL,8);
|
|
|
- Flash_ReadBytes(Flash_buf,CANG1_LEVEL_CAL,8);
|
|
|
+ Flash_WriteBytes(Flash_buf,CANG1_LEVEL_CAL,4);
|
|
|
+ Flash_ReadBytes(Flash_buf,CANG1_LEVEL_CAL,4);
|
|
|
|
|
|
pTx[16] = Flash_buf[0]>>8;
|
|
|
pTx[17] = Flash_buf[0]&0xFF;
|
|
@@ -3797,15 +3817,7 @@ uint16_t Level_SetCalvalue(uint8_t* pTx)
|
|
|
pTx[20] = Flash_buf[2]>>8;
|
|
|
pTx[21] = Flash_buf[2]&0xFF;
|
|
|
pTx[22] = Flash_buf[3]>>8;
|
|
|
- pTx[23] = Flash_buf[3]&0xFF;
|
|
|
- pTx[24] = Flash_buf[4]>>8;
|
|
|
- pTx[25] = Flash_buf[4]&0xFF;
|
|
|
- pTx[26] = Flash_buf[5]>>8;
|
|
|
- pTx[27] = Flash_buf[5]&0xFF;
|
|
|
- pTx[28] = Flash_buf[6]>>8;
|
|
|
- pTx[29] = Flash_buf[6]&0xFF;
|
|
|
- pTx[30] = Flash_buf[7]>>8;
|
|
|
- pTx[31] = Flash_buf[7]&0xFF;
|
|
|
+ pTx[23] = Flash_buf[4]&0xFF;
|
|
|
|
|
|
|
|
|
if((pTx[16] == pkzq->data_buf[16])&&(pTx[17] == pkzq->data_buf[17])&&(pkzq->data_buf[7] == 0x06))
|
|
@@ -3822,18 +3834,6 @@ uint16_t Level_SetCalvalue(uint8_t* pTx)
|
|
|
hex_to_float2.arr1[0] = pkzq->data_buf[23];
|
|
|
plevel[2].Level_Cal_zero = hex_to_float2.Ldcal_zero_temp1;
|
|
|
__NOP();
|
|
|
- hex_to_float2.arr1[3] = pkzq->data_buf[24];
|
|
|
- hex_to_float2.arr1[2] = pkzq->data_buf[25];
|
|
|
- hex_to_float2.arr1[1] = pkzq->data_buf[26];
|
|
|
- hex_to_float2.arr1[0] = pkzq->data_buf[27];
|
|
|
- plevel[3].Level_Cal_zero = hex_to_float2.Ldcal_zero_temp1;
|
|
|
- __NOP();
|
|
|
- hex_to_float2.arr1[3] = pkzq->data_buf[28];
|
|
|
- hex_to_float2.arr1[2] = pkzq->data_buf[29];
|
|
|
- hex_to_float2.arr1[1] = pkzq->data_buf[30];
|
|
|
- hex_to_float2.arr1[0] = pkzq->data_buf[31];
|
|
|
- plevel[4].Level_Cal_zero = hex_to_float2.Ldcal_zero_temp1;
|
|
|
- __NOP();
|
|
|
//hex_to_float2.Ldcal_zero_temp1 = plevel[2].Level_Cal_zero;
|
|
|
return 1;
|
|
|
}
|
|
@@ -3868,12 +3868,12 @@ uint16_t Tem_SetType(uint8_t* pTx)
|
|
|
KZQ_Inf* pkzq = &kzq_inf;
|
|
|
uint16_t Flash_buf[20] = {0};
|
|
|
|
|
|
- Flash_buf[0] = pkzq->data_buf[16]<<8|pkzq->data_buf[17];
|
|
|
+ Flash_buf[0] = pkzq->data_buf[17]<<8|pkzq->data_buf[16];
|
|
|
if(pkzq->data_buf[7] == 0x06)
|
|
|
Flash_WriteBytes(Flash_buf,ADDR_TEM_TYPE,1);
|
|
|
Flash_ReadBytes(Flash_buf,ADDR_TEM_TYPE,1);
|
|
|
- pTx[16] = Flash_buf[0]>>8;
|
|
|
- pTx[17] = Flash_buf[0]&0xFF;
|
|
|
+ pTx[17] = Flash_buf[0]>>8;
|
|
|
+ pTx[16] = Flash_buf[0]&0xFF;
|
|
|
|
|
|
if(Flash_buf[0] != 0xFFFF)
|
|
|
pcang->Temperture = Flash_buf[0];
|