From 87a47c626b5372ab7667915a4e7b60d93c8abd2e Mon Sep 17 00:00:00 2001
From: Pol Henarejos <pol.henarejos@cttc.es>
Date: Mon, 21 Feb 2022 13:26:30 +0100
Subject: [PATCH] Fix with extended LE.

Signed-off-by: Pol Henarejos <pol.henarejos@cttc.es>
---
 hsm2040.c | 3 +--
 1 file changed, 1 insertion(+), 2 deletions(-)

diff --git a/hsm2040.c b/hsm2040.c
index 51c5209..9f799d4 100644
--- a/hsm2040.c
+++ b/hsm2040.c
@@ -1146,8 +1146,7 @@ static int end_cmd_apdu_data (struct ep_out *epo, size_t orig_len)
         goto error;
     //len is the length after lc (whole APDU = len+5)
     if (c->a->cmd_apdu_head[4] == 0 && len >= 2) { //extended
-        len -= 2;
-        if (len == 0) {
+        if (len == 2) {
             c->a->expected_res_size = (c->a->cmd_apdu_head[5] << 8) | c->a->cmd_apdu_head[6];
             if (c->a->expected_res_size == 0)
                 c->a->expected_res_size = 0xffff+1;