1 files changed, 3 insertions, 0 deletions
diff --git a/src/phLibNfc_SE.c b/src/phLibNfc_SE.c
index 2cdb24e..0ccfce6 100644
--- a/src/phLibNfc_SE.c
+++ b/src/phLibNfc_SE.c
@@ -470,6 +470,7 @@ NFCSTATUS phLibNfc_SE_SetMode ( phLibNfc_Handle             hSE_Handle,
     }
     else 
     {
+        phLibNfc_eSE_ActivationMode originalMode = pLibContext->sSeContext.eActivatedMode;
         switch(eActivation_mode)
         {
             case phLibNfc_SE_ActModeVirtual: 
@@ -655,6 +656,8 @@ NFCSTATUS phLibNfc_SE_SetMode ( phLibNfc_Handle             hSE_Handle,
         }
         else
         {
+            // Restore original mode
+            pLibContext->sSeContext.eActivatedMode = originalMode;
             Status = NFCSTATUS_FAILED;
         }
     }