From 1336343dfba2241180d90857a18eafcb520ced4e Mon Sep 17 00:00:00 2001
From: Eric Helgeson <erichelgeson@gmail.com>
Date: Thu, 1 Dec 2022 14:28:50 -0600
Subject: [PATCH] Merge pull request #194 from mynameistroy/troy/cdb_length_fix

added a full lookup table for cdb length
---
 F4_BlueSCSI/BlueSCSI.h      | 14 ++++++++++++++
 F4_BlueSCSI/F4_BlueSCSI.ino |  3 +--
 2 files changed, 15 insertions(+), 2 deletions(-)

diff --git a/F4_BlueSCSI/BlueSCSI.h b/F4_BlueSCSI/BlueSCSI.h
index 9296c85..27ecab1 100644
--- a/F4_BlueSCSI/BlueSCSI.h
+++ b/F4_BlueSCSI/BlueSCSI.h
@@ -347,5 +347,19 @@ typedef __attribute__((aligned(4))) struct _SCSI_DEVICE
   uint8_t       m_sector_offset;          // optical sector offset for missing sync header
 } SCSI_DEVICE;
 
+static byte cdb_len_lookup[] = {
+  6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,
+  10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,
+  10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,
+  10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,
+  10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,
+  10,10,10,10,10,10,10,10,10,10,10,10,10,16,16,16,16,16,16,16,16,
+  16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,
+  16,16,16,12,12,12,12,12,12,12,12,12,12,12,12,12,12,12,12,12,12,
+  12,12,12,12,12,12,12,12,12,12,12,12,12,12,10,10,10,10,10,10,10,
+  10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,
+  10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,
+  10,10,10,10,10,10,10,10,10,10,10,10,10,10
+};
 
 #endif
diff --git a/F4_BlueSCSI/F4_BlueSCSI.ino b/F4_BlueSCSI/F4_BlueSCSI.ino
index bbaeb1c..5fe6584 100644
--- a/F4_BlueSCSI/F4_BlueSCSI.ino
+++ b/F4_BlueSCSI/F4_BlueSCSI.ino
@@ -1229,8 +1229,7 @@ void loop()
 
   LOGHEX(cmd[0]);
   // Command length selection, reception
-  static const int cmd_class_len[8]={6,10,10,6,6,12,6,6};
-  len = cmd_class_len[cmd[0] >> 5];
+  len = cdb_len_lookup[cmd[0]];
   cmd[1] = readHandshake(); LOG(":");LOGHEX(cmd[1]);
   cmd[2] = readHandshake(); LOG(":");LOGHEX(cmd[2]);
   cmd[3] = readHandshake(); LOG(":");LOGHEX(cmd[3]);