|
|
|
@ -172,14 +172,14 @@ void* CIcomController::Entry()
|
|
|
|
|
|
|
|
|
|
|
|
case RTI_HEADER_ACK:
|
|
|
|
case RTI_HEADER_ACK:
|
|
|
|
if (buffer[2U] == 0x00U) {
|
|
|
|
if (buffer[2U] == 0x00U) {
|
|
|
|
wxLogMessage(wxT("RTI_HEADER_ACK"));
|
|
|
|
// wxLogMessage(wxT("RTI_HEADER_ACK"));
|
|
|
|
if (state == SI_HEADER) {
|
|
|
|
if (state == SI_HEADER) {
|
|
|
|
storeLength = 0U;
|
|
|
|
storeLength = 0U;
|
|
|
|
retryTimer.stop();
|
|
|
|
retryTimer.stop();
|
|
|
|
txSpace = true;
|
|
|
|
txSpace = true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
} else {
|
|
|
|
wxLogMessage(wxT("RTI_HEADER_NAK"));
|
|
|
|
// wxLogMessage(wxT("RTI_HEADER_NAK"));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
lostTimer.start();
|
|
|
|
lostTimer.start();
|
|
|
|
@ -187,14 +187,14 @@ void* CIcomController::Entry()
|
|
|
|
|
|
|
|
|
|
|
|
case RTI_DATA_ACK:
|
|
|
|
case RTI_DATA_ACK:
|
|
|
|
if (buffer[3U] == 0x00U) {
|
|
|
|
if (buffer[3U] == 0x00U) {
|
|
|
|
wxLogMessage(wxT("RTI_DATA_ACK - %02X"), buffer[2U]);
|
|
|
|
// wxLogMessage(wxT("RTI_DATA_ACK - %02X"), buffer[2U]);
|
|
|
|
if (state == SI_DATA && seqNo == buffer[2U]) {
|
|
|
|
if (state == SI_DATA && seqNo == buffer[2U]) {
|
|
|
|
storeLength = 0U;
|
|
|
|
storeLength = 0U;
|
|
|
|
retryTimer.stop();
|
|
|
|
retryTimer.stop();
|
|
|
|
txSpace = true;
|
|
|
|
txSpace = true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
} else {
|
|
|
|
wxLogMessage(wxT("RTI_DATA_NAK - %02X"), buffer[2U]);
|
|
|
|
// wxLogMessage(wxT("RTI_DATA_NAK - %02X"), buffer[2U]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
lostTimer.start();
|
|
|
|
lostTimer.start();
|
|
|
|
@ -209,7 +209,7 @@ void* CIcomController::Entry()
|
|
|
|
if (retryTimer.isRunning() && retryTimer.hasExpired() && connected) {
|
|
|
|
if (retryTimer.isRunning() && retryTimer.hasExpired() && connected) {
|
|
|
|
assert(storeLength > 0U);
|
|
|
|
assert(storeLength > 0U);
|
|
|
|
|
|
|
|
|
|
|
|
CUtils::dump(wxT("Re-Sending"), storeData, storeLength + 1U);
|
|
|
|
// CUtils::dump(wxT("Re-Sending"), storeData, storeLength + 1U);
|
|
|
|
|
|
|
|
|
|
|
|
int ret = m_serial.write(storeData, storeLength + 1U);
|
|
|
|
int ret = m_serial.write(storeData, storeLength + 1U);
|
|
|
|
if (ret != int(storeLength + 1U))
|
|
|
|
if (ret != int(storeLength + 1U))
|
|
|
|
@ -225,7 +225,7 @@ void* CIcomController::Entry()
|
|
|
|
storeLength = storeData[0U];
|
|
|
|
storeLength = storeData[0U];
|
|
|
|
m_txData.getData(storeData + 1U, storeLength);
|
|
|
|
m_txData.getData(storeData + 1U, storeLength);
|
|
|
|
|
|
|
|
|
|
|
|
CUtils::dump(wxT("Sending"), storeData, storeLength + 1U);
|
|
|
|
// CUtils::dump(wxT("Sending"), storeData, storeLength + 1U);
|
|
|
|
|
|
|
|
|
|
|
|
if (storeData[1U] == 0x20U) {
|
|
|
|
if (storeData[1U] == 0x20U) {
|
|
|
|
state = SI_HEADER;
|
|
|
|
state = SI_HEADER;
|
|
|
|
|