From 11ad36fd895a8c3a58f80135c9a6916ac55f66d2 Mon Sep 17 00:00:00 2001
From: Stefano Calabretti <StefanoCalabretti@outlook.it>
Date: Mon, 7 Mar 2022 00:30:14 +0100
Subject: [PATCH] Fix wrong bit shifts

---
 Src/mmr_can_header.c | 14 +++++++-------
 1 file changed, 7 insertions(+), 7 deletions(-)

diff --git a/Src/mmr_can_header.c b/Src/mmr_can_header.c
index bf05a3e..f3e4d1d 100644
--- a/Src/mmr_can_header.c
+++ b/Src/mmr_can_header.c
@@ -4,18 +4,18 @@
 
 uint32_t MMR_CAN_HeaderToBits(MmrCanHeader header) {
   return 0
-  | ((uint32_t)header.priority << 26)
-  | ((uint32_t)header.messageId << 23)
-  | ((uint32_t)header.senderId << 13)
-  | ((uint32_t)header.seqNumber << 3)
-  | ((uint32_t)header.messageType);
+    | ((uint32_t)header.priority << 26)
+    | ((uint32_t)header.messageId << 16)
+    | ((uint32_t)header.senderId << 6)
+    | ((uint32_t)header.seqNumber << 3)
+    | ((uint32_t)header.messageType);
 }
 
 MmrCanHeader MMR_CAN_HeaderFromBits(uint32_t bits) {
   return (MmrCanHeader) {
     .priority = bits >> 26,
-    .messageId = bits >> 23,
-    .senderId = bits >> 13,
+    .messageId = bits >> 16,
+    .senderId = bits >> 6,
     .seqNumber = bits >> 3,
     .messageType = bits,
   };