From 412f016b94df0926e995c4aa59a6479bacc13ec9 Mon Sep 17 00:00:00 2001
From: iceman1001 <iceman@iuse.se>
Date: Mon, 16 Sep 2019 12:36:04 +0200
Subject: [PATCH] chg: 'lf t55xx config' - can set config based on a block0,
 offset and Q5

lf t55xx config c 000880E0 o 10     - sets a T55x7 w offset 10
lf t55xx config c 000880E0 o 6 Q5   - sets a Q5/T5555 w offset 6
---
 client/cmdlft55xx.c | 14 ++++++--------
 client/cmdlft55xx.h |  1 +
 2 files changed, 7 insertions(+), 8 deletions(-)

diff --git a/client/cmdlft55xx.c b/client/cmdlft55xx.c
index 6b42b4688..88c6b3162 100644
--- a/client/cmdlft55xx.c
+++ b/client/cmdlft55xx.c
@@ -519,6 +519,9 @@ void printT5xxHeader(uint8_t page) {
 }
 
 void SetConfigWithBlock0(uint32_t block0) {
+    SetConfigWithBlock0Ex(block0, 0, false);
+}
+void SetConfigWithBlock0Ex(uint32_t block0, uint8_t offset, bool Q5) {
     // T55x7
     uint32_t extend = (block0 >> (32 - 15)) & 0x01;
     uint32_t dbr;
@@ -541,10 +544,10 @@ void SetConfigWithBlock0(uint32_t block0) {
     else
         config.inverted = inv;
     
-    config.Q5 = 0;
+    config.Q5 = Q5;
     config.ST = sst;
     config.usepwd = pwd;
-    config.offset = 0;
+    config.offset = offset;
     config.block0 = block0;
 }
 
@@ -677,12 +680,7 @@ static int CmdT55xxSetConfig(const char *Cmd) {
     if (errors) return usage_t55xx_config();
 
     if ( gotconf ) {
-
-        // Q5  - to be implemented
-        
-        // T55x7
-        SetConfigWithBlock0(block0); 
-
+        SetConfigWithBlock0Ex(block0, config.offset, config.Q5); 
     } else {
         config.block0 = 0;
     }
diff --git a/client/cmdlft55xx.h b/client/cmdlft55xx.h
index 182377deb..d4e217372 100644
--- a/client/cmdlft55xx.h
+++ b/client/cmdlft55xx.h
@@ -132,6 +132,7 @@ void Set_t55xx_Config(t55xx_conf_block_t conf);
 int CmdLFT55XX(const char *Cmd);
 
 void SetConfigWithBlock0(uint32_t block0);
+void SetConfigWithBlock0Ex(uint32_t block0, uint8_t offset, bool Q5);
 
 char *GetPskCfStr(uint32_t id, bool q5);
 char *GetBitRateStr(uint32_t id, bool xmode);