Add remove service

chegewara · chegewara · commit eead14aff146 · 2018-06-19T08:36:58.000+02:00
diff --git a/cpp_utils/BLEServer.cpp b/cpp_utils/BLEServer.cpp
@@ -323,6 +323,14 @@ void BLEServer::setCallbacks(BLEServerCallbacks* pCallbacks) {
 	m_pServerCallbacks = pCallbacks;
 } // setCallbacks
 
+/*
+ * Remove service
+ */
+void BLEServer::removeService(BLEService *service) {
+	esp_ble_gatts_delete_service(handle);
+	uint16_t handle = service->getHandle();
+	m_serviceMap->removeService(service);
+}
 
 /**
  * @brief Start advertising.
diff --git a/cpp_utils/BLEServer.h b/cpp_utils/BLEServer.h
@@ -42,6 +42,7 @@ class BLEServiceMap {
 	std::string toString();
 	BLEService* getFirst();
 	BLEService* getNext();
+	void 		removeService(BLEService *service);
 
 private:
 	std::map<uint16_t, BLEService*>    m_handleMap;
@@ -61,7 +62,7 @@ class BLEServer {
 	BLEAdvertising* getAdvertising();
 	void            setCallbacks(BLEServerCallbacks* pCallbacks);
 	void            startAdvertising();
-
+	void 			removeService(BLEService *service);
 
 private:
 	BLEServer();
diff --git a/cpp_utils/BLEServiceMap.cpp b/cpp_utils/BLEServiceMap.cpp
@@ -120,4 +120,9 @@ BLEService* BLEServiceMap::getNext() {
 	return pRet;
 } // getNext
 
+void BLEServiceMap::removeService(BLEService *service){
+	m_handleMap->erase(serice->getHandle());
+	m_uuidMap->erase(service);
+}
+
 #endif /* CONFIG_BT_ENABLED */
