mmr/can
Archived
1
0
Fork 0
Code Issues Pull Requests Activity

Cycle mailboxes

Browse Source
This commit is contained in:
Stefano Calabretti
2022-05-07 14:48:54 +02:00
parent efdd4655a3
commit 94589c07d7
1 changed files with 11 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Src/mmr_can_send.c
+11 -2
View File
@@ -23,9 +23,13 @@ static uint8_t computeFramesToSend(MmrCanPacket *packet);
static uint8_t computeNextMessageLength(MmrCanPacket *packet); static uint8_t computeNextMessageLength(MmrCanPacket *packet);
static void setMessageType(TransmissionParams *header, MmrCanMessageType type); static void setMessageType(TransmissionParams *header, MmrCanMessageType type);
static void syncHeaders(TransmissionParams *tp); static void syncHeaders(TransmissionParams *tp);
static CanMailbox *getNextMailbox();
static CanMailbox __mailbox; #define MAILBOXES_COUNT 3
static CanMailbox __mailboxes[MAILBOXES_COUNT] = {};
static uint8_t __currentMailbox = 0;
HalStatus MMR_CAN_Send(CanHandle *hcan, MmrCanPacket packet) { HalStatus MMR_CAN_Send(CanHandle *hcan, MmrCanPacket packet) {
@@ -108,11 +112,16 @@ static HalStatus send(TransmissionParams *tp) {
tp->handle, tp->handle,
&tp->headers.tx, &tp->headers.tx,
tp->packet->data, tp->packet->data,
&__mailbox getNextMailbox()
); );
} }
static CanMailbox *getNextMailbox() {
return &__mailboxes[__currentMailbox++ % MAILBOXES_COUNT];
}
static void syncHeaders(TransmissionParams *tp) { static void syncHeaders(TransmissionParams *tp) {
tp->headers.tx.ExtId = MMR_CAN_HeaderToBits(tp->headers.mmr); tp->headers.tx.ExtId = MMR_CAN_HeaderToBits(tp->headers.mmr);
} }