fix(ble): Keep advertising in slected mode after connection closes

epicardium/ble/ble_main.c

@@ -600,7 +600,11 @@ static void bleProcMsg(bleMsg_t *pMsg)
       break;
 
     case DM_ADV_START_IND:
-      LOG_INFO("ble", "Advertisement started");
+      LOG_INFO("ble", "Advertisement started %u %u", advertising_mode, advertising_mode_target);
+      if(advertising_mode != advertising_mode_target) {
+        AppAdvStop();
+      }
+
       break;
 
     case DM_ADV_STOP_IND:
@@ -648,6 +652,12 @@ static void bleProcMsg(bleMsg_t *pMsg)
                    pMsg->dm.connClose.reason);
           break;
       }
+      /* Stack overwrites advertising mode after connection close.
+       * Force our desired mode.
+       */
+      advertising_mode = APP_MODE_NONE;
+      AppAdvStop();
+
       bleClose(pMsg);
       break;