|
@ -444,7 +444,7 @@ void ZCanCommnaderMaster::STM32_HAL_onCAN_RxFifo0MsgPending(CAN_HandleTypeDef *c |
|
|
*/ |
|
|
*/ |
|
|
if (nframe == frameId + 1) { |
|
|
if (nframe == frameId + 1) { |
|
|
rxbuf->dataIsReady = true; |
|
|
rxbuf->dataIsReady = true; |
|
|
if ((rxbuf->m_canPacketNum + 1) != rxbuf->m_npacket) rxbuf->lostpacket = true; |
|
|
|
|
|
|
|
|
if ((rxbuf->m_canPacketNum) != rxbuf->m_npacket) rxbuf->lostpacket = true; |
|
|
} |
|
|
} |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
@ -463,8 +463,11 @@ void ZCanCommnaderMaster::processReadyPacket(CanPacketRxBuffer *rxbuf) { |
|
|
dataoff += rxbuf->m_canPacket[i].pHeader.DLC; |
|
|
dataoff += rxbuf->m_canPacket[i].pHeader.DLC; |
|
|
rxbuf->rxdataSize = dataoff; |
|
|
rxbuf->rxdataSize = dataoff; |
|
|
} |
|
|
} |
|
|
ZLOGI(TAG, "rx %d %d", rxbuf->m_canPacketNum, rxbuf->m_npacket); |
|
|
|
|
|
callListener(rxbuf); |
|
|
|
|
|
|
|
|
if (rxbuf->lostpacket) { |
|
|
|
|
|
ZLOGE(TAG, "lostpacket %d %d", rxbuf->m_canPacketNum, rxbuf->m_npacket); |
|
|
|
|
|
} else { |
|
|
|
|
|
callListener(rxbuf); |
|
|
|
|
|
} |
|
|
rxbuf->dataIsReady = false; |
|
|
rxbuf->dataIsReady = false; |
|
|
} |
|
|
} |
|
|
void ZCanCommnaderMaster::loop() { |
|
|
void ZCanCommnaderMaster::loop() { |
|
|