From 10dc959f34deb2885432a3d09eb88fcaaf32c836 Mon Sep 17 00:00:00 2001
From: Philippe Teuwen <phil@teuwen.org>
Date: Sat, 18 May 2019 17:47:29 +0200
Subject: [PATCH] btfactory: reset role as well

---
 client/cmdusart.c | 18 ++++++++++++++++++
 1 file changed, 18 insertions(+)

diff --git a/client/cmdusart.c b/client/cmdusart.c
index 887849c9e..75d00d24c 100644
--- a/client/cmdusart.c
+++ b/client/cmdusart.c
@@ -353,6 +353,24 @@ static int CmdUsartBtFactory(const char *Cmd) {
         return PM3_EFATAL;
     }
 
+    memset(data, 0, sizeof(data));
+    len = 0;
+    string = "AT+ROLE=S";
+    PrintAndLogEx(SUCCESS, "TX (%3u):%.*s", strlen(string), strlen(string), string);
+
+    ret = usart_txrx((uint8_t *)string, strlen(string), data, &len, 1000);
+    if (ret == PM3_SUCCESS) {
+        PrintAndLogEx(SUCCESS, "RX (%3u):%.*s", len, len, data);
+        if (strcmp((char *)data, "OK+ROLE:S") == 0) {
+            PrintAndLogEx(SUCCESS, "Role set to " _GREEN_("Slave"));
+        } else {
+            PrintAndLogEx(WARNING, "Unexpected response to AT+ROLE=S: " _YELLOW_("%.*s"), len, data);
+        }
+    } else {
+        PrintAndLogEx(WARNING, "Lost contact with add-on, please try again");
+        return PM3_EFATAL;
+    }
+
     memset(data, 0, sizeof(data));
     len = 0;
     string = "AT+PIN1234";