From d8b8afce994ba8f02d7123e47ca2a0e46c21ee02 Mon Sep 17 00:00:00 2001
From: Gwenhael Goavec-Merou <gwenhael.goavec-merou@trabucayre.com>
Date: Mon, 18 Oct 2021 07:34:27 +0200
Subject: [PATCH] spiFlash: fix len_to_bp mask

---
 src/spiFlash.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/spiFlash.cpp b/src/spiFlash.cpp
index d7c5e1d..e2dd11c 100644
--- a/src/spiFlash.cpp
+++ b/src/spiFlash.cpp
@@ -436,7 +436,7 @@ uint8_t SPIFlash::len_to_bp(uint32_t len)
 	/* reconstruct code based on each BPx bit */
 	uint8_t tmp = 0;
 	for (int i = 0; i < 4; i++)
-		if (bp >> i)
+		if (bp & (1 << i))
 			tmp |= _flash_model->bp_offset[i];
 
 	return tmp;