Test HandleNext OK
This commit is contained in:
@@ -60,7 +60,10 @@ HalStatus MMR_CAN_SendScs(
|
|||||||
|
|
||||||
HalStatus MMR_CAN_HandleNextScs(CanHandle *hcan) {
|
HalStatus MMR_CAN_HandleNextScs(CanHandle *hcan) {
|
||||||
static int counter = 0;
|
static int counter = 0;
|
||||||
MmrCanScsEntry *entry = &__scsEntries[counter++ % MMR_CAN_SCS_ENTRIES_COUNT];
|
|
||||||
|
MmrCanScsEntry *entry = &__scsEntries[counter];
|
||||||
|
counter++;
|
||||||
|
counter %= MMR_CAN_SCS_ENTRIES_COUNT;
|
||||||
|
|
||||||
if (MMR_CAN_HeaderToBits(entry->header) == 0) {
|
if (MMR_CAN_HeaderToBits(entry->header) == 0) {
|
||||||
return HAL_OK;
|
return HAL_OK;
|
||||||
@@ -104,8 +107,8 @@ TimerRange getCurrentTime() {
|
|||||||
|
|
||||||
|
|
||||||
void maybeIncrementRTR(MmrCanScsEntry *entry) {
|
void maybeIncrementRTR(MmrCanScsEntry *entry) {
|
||||||
TimerRange delay =
|
TimerRange now = getCurrentTime();
|
||||||
getCurrentTime() - entry->counter;
|
TimerRange delay = now - entry->counter;
|
||||||
|
|
||||||
if (delay >= MMR_CAN_MAX_TIMEOUT) {
|
if (delay >= MMR_CAN_MAX_TIMEOUT) {
|
||||||
entry->rtr++;
|
entry->rtr++;
|
||||||
|
|||||||
Reference in New Issue
Block a user