From 14eb27e0d98abcbc15175783d3805fae8b8aa518 Mon Sep 17 00:00:00 2001
From: Gunnar Skjold <gunnar.skjold@gmail.com>
Date: Tue, 19 Mar 2024 21:50:09 +0100
Subject: [PATCH] crc

---
 lib/AmsDecoder/src/crc.cpp | 12 +++++-------
 1 file changed, 5 insertions(+), 7 deletions(-)

diff --git a/lib/AmsDecoder/src/crc.cpp b/lib/AmsDecoder/src/crc.cpp
index 52825c1e..af3018bf 100644
--- a/lib/AmsDecoder/src/crc.cpp
+++ b/lib/AmsDecoder/src/crc.cpp
@@ -34,14 +34,13 @@ uint16_t crc16 (const uint8_t *p, int len) {
     return crc;
 }
 
-uint16_t crc16_1021(const uint8_t *p, int len)
-{
-	uint16_t crc = 0x0000;
-	for(uint16_t i = 0; i < len; i++) {
-		uint16_t mask = 0x80;
+uint16_t crc16_1021(const uint8_t *p, int len) {
+	uint32_t crc = 0x0000;
+	for(int i = 0; i < len; i++) {
+		int mask = 0x80;
 		while(mask > 0) {
 			crc <<= 1;
-			if (p[i] & mask) {
+			if (p[i] & mask){
 				crc |= 1;
 			}
 			mask>>=1;
@@ -52,5 +51,4 @@ uint16_t crc16_1021(const uint8_t *p, int len)
 		}
 	}
 	return crc;
-
 }