diff --git a/.gitignore b/.gitignore
index a6424b5..e8370bb 100644
--- a/.gitignore
+++ b/.gitignore
@@ -1,3 +1,4 @@
 out
 .cproject
 .project
+.cortex-debug.*.json
diff --git a/.vscode/launch.json b/.vscode/launch.json
new file mode 100644
index 0000000..7b0c5c3
--- /dev/null
+++ b/.vscode/launch.json
@@ -0,0 +1,29 @@
+{
+    // Use IntelliSense to learn about possible attributes.
+    // Hover to view descriptions of existing attributes.
+    // For more information, visit: https://go.microsoft.com/fwlink/?linkid=830387
+    "version": "0.2.0",
+    "configurations": [
+        {
+            "name": "Cortex Debug",
+            "cwd": "${workspaceRoot}",
+            "executable": "${workspaceRoot}/BMLite_example/out/bmlite_demo",
+            "request": "launch",
+            "type": "cortex-debug",
+            "servertype": "jlink",
+            "device": "nRF52840_xxAA",
+            "interface": "swd",
+            "runToMain": true,
+
+            // "postLaunchCommands": [
+            //   "flush regs",
+            //   "load"
+            // ],
+            // "postRestartCommands": [
+            //   "flush regs",
+            //   "load"
+            // ],
+            "gdbTarget": "/opt/SEGGER/JLink/JLinkGDBServer"
+        }
+    ]
+}
\ No newline at end of file
diff --git a/BMLite_example/src/main.c b/BMLite_example/src/main.c
index 587300a..54ab7bf 100644
--- a/BMLite_example/src/main.c
+++ b/BMLite_example/src/main.c
@@ -124,6 +124,8 @@ int main (int argc, char **argv)
                 continue;
             }
             hal_set_leds(BMLITE_LED_STATUS_MATCH, match);
+            res = sensor_wait_finger_not_present(&hcp_chain, 0);
+
         }
     }
 }
diff --git a/BMLite_sdk/src/bmlite_if.c b/BMLite_sdk/src/bmlite_if.c
index c20ea70..f626a28 100644
--- a/BMLite_sdk/src/bmlite_if.c
+++ b/BMLite_sdk/src/bmlite_if.c
@@ -197,9 +197,6 @@ fpc_bep_result_t bep_identify_finger(HCP_comm_t *chain, uint32_t timeout, uint16
         // Delay for possible updating template on BM-Lite
         hal_timebase_busy_wait(50);
     }
-
-    bep_result = sensor_wait_finger_not_present(chain, 0);
-
 exit:
     bmlite_on_identify_finish();
     return bep_result;