bugfix: rtt fsm won't work at none stage.

This commit is contained in:
Gatsby Van
2023-12-21 23:16:47 +08:00
parent 0a535af392
commit 4455e29be6
+3 -3
View File
@@ -112,7 +112,7 @@ static void RTT_StageUpdate(L2_RTT_FSM* rttFsmPtr, L2_RTT_SATGE newSatge) {
void RTT_Reset(L2_RTT_FSM* rttFsmPtr){ void RTT_Reset(L2_RTT_FSM* rttFsmPtr){
ASSERT(rttFsmPtr != NULL); ASSERT(rttFsmPtr != NULL);
memset(&(rttFsmPtr->rttRecord), 0x00, sizeof(RTT_RECORD)); memset(&(rttFsmPtr->rttRecord), 0x00, sizeof(RTT_RECORD));
rttFsmPtr->rttStatge = RTT_NONE_STAGE; rttFsmPtr->rttStatge = RTT_REQ1;
rttFsmPtr->isR1Valid = false; rttFsmPtr->isR1Valid = false;
rttFsmPtr->isR2Valid = false; rttFsmPtr->isR2Valid = false;
rttFsmPtr->isR3Valid = false; rttFsmPtr->isR3Valid = false;
@@ -353,7 +353,7 @@ int32_t RTT_FsmUpdate(L2_INST* instPtr, L2_TOR_TYPE torType) {
DBG_INFO("Tr4-timeH:%08X.\n", rttRecord->Tr4.int_part); DBG_INFO("Tr4-timeH:%08X.\n", rttRecord->Tr4.int_part);
DBG_INFO("TroundA-timeL:%08X.\n", rttRecord->TroundA.frac_part); DBG_INFO("TroundA-timeL:%08X.\n", rttRecord->TroundA.frac_part);
DBG_INFO("TroundA-timeH:%08X.\n", rttRecord->TroundA.int_part); DBG_INFO("TroundA-timeH:%08X.\n", rttRecord->TroundA.int_part);
RTT_StageUpdate(rttFsmPtr, RTT_NONE_STAGE); RTT_StageUpdate(rttFsmPtr, RTT_REQ1);
DBG_INFO("RTT procedure end...\n"); DBG_INFO("RTT procedure end...\n");
} }
else{ else{
@@ -477,7 +477,7 @@ int32_t RTT_FsmUpdate(L2_INST* instPtr, L2_TOR_TYPE torType) {
// Prepare data for sending. // Prepare data for sending.
rttFsmPtr->timeStamp = rttRecord->TreplyB; rttFsmPtr->timeStamp = rttRecord->TreplyB;
rttFsmPtr->doppler = rttRecord->dopplerR3; rttFsmPtr->doppler = rttRecord->dopplerR3;
RTT_StageUpdate(rttFsmPtr, RTT_NONE_STAGE); RTT_StageUpdate(rttFsmPtr, RTT_REQ1);
DBG_INFO("RTT procedure end...\n"); DBG_INFO("RTT procedure end...\n");
} }
else{ else{