|
|
@@ -785,7 +785,11 @@ void Uart1_Ack_new(void) {
|
|
|
g_ucU1TX_Data[2] = 1;
|
|
|
g_ucU1TX_Data[3] = g_uiFrmLth & 0xff;
|
|
|
g_ucU1TX_Data[4] = EnmErrCode_errTimeOut;
|
|
|
- g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data, g_uiFrmLth - 1);
|
|
|
+ g_ucU1TX_Data[5] = (unsigned char)Check(g_ucU1TX_Data, g_uiFrmLth - 1);
|
|
|
+ g_uiUart2_No = 0;
|
|
|
+ g_ucHeaderFlag2 = 0;
|
|
|
+ g_ucUART2_flag = 0;
|
|
|
+ g_BUSY2 = 0;
|
|
|
for (unsigned int n = 0; n < g_ucU1TX_Data[3]; n++) {
|
|
|
UART1SEND(g_ucU1TX_Data[n]);
|
|
|
}
|
|
|
@@ -815,7 +819,11 @@ void Uart1_Ack_new(void) {
|
|
|
for (unsigned int i = 5; i < g_ucU1RX_Data[3]; i++) {
|
|
|
g_ucU3TX_Data[i] = g_ucU1RX_Data[i-1];
|
|
|
}
|
|
|
- g_uiFrmLth = g_ucU3TX_Data[4];
|
|
|
+ g_uiFrmLth = g_ucU3TX_Data[4];
|
|
|
+ g_uiUart3_No = 0;
|
|
|
+ g_ucHeaderFlag3 = 0;
|
|
|
+ g_ucUART3_flag = 0;
|
|
|
+ g_BUSY3 = 0;
|
|
|
g_ucU3TX_Data[g_uiFrmLth - 1] =
|
|
|
(unsigned char)Check(g_ucU3TX_Data, g_uiFrmLth - 1);
|
|
|
for (unsigned int n = 0; n < g_ucU3TX_Data[4]; n++) {
|
|
|
@@ -840,7 +848,7 @@ void Uart1_Ack_new(void) {
|
|
|
g_ucU1TX_Data[3] = g_ucU3RX_Data[4] - 1;
|
|
|
g_uiFrmLth = g_ucU1TX_Data[3];
|
|
|
for (unsigned int i = 4; i < g_ucU3RX_Data[4]; i++) {
|
|
|
- g_ucU1TX_Data[i] = g_ucU4RX_Data[i + 1];
|
|
|
+ g_ucU1TX_Data[i] = g_ucU3RX_Data[i + 1];
|
|
|
}
|
|
|
baseSys_st &= ~SYS_ST_MOTOROFFLINE;
|
|
|
}
|