subsys: bluetooth: services: ble_hrs_client: add event

Add body sensor location event

Signed-off-by: Sondre Pettersen <sondre.pettersen@nordicsemi.no>
Co-authored-by: Asil Zogby <asil.zogby@nordicsemi.no>

Author: sondrep

include/bm/bluetooth/services/ble_hrs_client.h

@@ -56,6 +56,7 @@ enum ble_hrs_client_evt_type {
 	 *  received from the peer.
 	 */
 	BLE_HRS_CLIENT_EVT_HRM_NOTIFICATION,
+	BLE_HRS_CLIENT_EVT_BSL_UPDATE,
 	/** Error. */
 	BLE_HRS_CLIENT_EVT_ERROR,
 };
@@ -80,6 +81,8 @@ struct ble_hrs_handles {
 	uint16_t hrm_cccd_handle;
 	/** Handle of the Heart Rate Measurement characteristic, as provided by the SoftDevice. */
 	uint16_t hrm_handle;
+	uint16_t bsl_handle;
+	uint16_t bsl_cccd_handle;
 };
 
 /**
@@ -95,9 +98,12 @@ struct ble_hrs_client_evt {
 		struct {
 			/** Handles related to the Heart Rate, found on the peer device. */
 			struct ble_hrs_handles handles;
+			uint8_t body_sensor_location;
 		} discovery_complete;
 		/** @ref BLE_HRS_CLIENT_EVT_HRM_NOTIFICATION event data. */
 		struct ble_hrs_measurement hrm_notification;
+
+		uint8_t body_sensor_location;
 		/** @ref BLE_HRS_CLIENT_EVT_ERROR event data. */
 		struct {
 			/** Error reason */

subsys/bluetooth/services/ble_hrs_client/ble_hrs_client.c

@@ -119,6 +119,8 @@ static void on_disconnected(struct ble_hrs_client *hrs_client, const ble_evt_t *
 		hrs_client->conn_handle = BLE_CONN_HANDLE_INVALID;
 		hrs_client->handles.hrm_cccd_handle = BLE_GATT_HANDLE_INVALID;
 		hrs_client->handles.hrm_handle = BLE_GATT_HANDLE_INVALID;
+		hrs_client->handles.bsl_cccd_handle = BLE_GATT_HANDLE_INVALID;
+		hrs_client->handles.bsl_handle = BLE_GATT_HANDLE_INVALID;
 	}
 }
 
@@ -152,7 +154,16 @@ void ble_hrs_on_db_disc_evt(struct ble_hrs_client *hrs_client,
 				db_char->cccd_handle;
 			hrs_client_evt.discovery_complete.handles.hrm_handle =
 				db_char->characteristic.handle_value;
-			break;
+		}
+		else if (db_char->characteristic.uuid.uuid == BLE_UUID_BODY_SENSOR_LOCATION_CHAR) {
+			hrs_client_evt.discovery_complete.handles.bsl_cccd_handle = db_char->cccd_handle;
+			hrs_client_evt.discovery_complete.handles.bsl_handle = db_char->characteristic.handle_value;
+			ble_gatts_value_t val = {
+				.p_value = &hrs_client_evt.discovery_complete.body_sensor_location,
+				.len = sizeof(hrs_client_evt.discovery_complete.body_sensor_location),
+			};
+			//LOG_INF("sd_ble_gatts_value_get returned %#x, location = %u" ,sd_ble_gatts_value_get(db_discovery_evt->conn_handle, db_char->characteristic.handle_value, &val), hrs_client_evt.discovery_complete.body_sensor_location);
+			sd_ble_gattc_read(db_discovery_evt->conn_handle,  db_char->characteristic.handle_value, 0);
 		}
 	}
 
@@ -194,6 +205,27 @@ uint32_t ble_hrs_client_init(struct ble_hrs_client *hrs_client,
 	return ble_db_discovery_service_register(hrs_client_config->db_discovery, &hrs_uuid);
 }
 
+static void on_read_rsp(struct ble_hrs_client *hrs_client, const ble_evt_t *ble_evt) {
+
+	const ble_gattc_evt_read_rsp_t *read_rsp = &ble_evt->evt.gattc_evt.params.read_rsp;
+	struct ble_hrs_client_evt evt = {.conn_handle = ble_evt->evt.gattc_evt.conn_handle, .evt_type = BLE_HRS_CLIENT_EVT_BSL_UPDATE, .body_sensor_location = ble_evt->evt.gattc_evt.params.read_rsp.data[0]};
+
+	if (hrs_client->conn_handle != ble_evt->evt.gattc_evt.conn_handle) {
+		return;
+	}
+
+	/* Check if this is a heart rate notification. */
+	if (read_rsp->handle != hrs_client->handles.bsl_handle) {
+		return;
+	}
+
+	if (read_rsp->len < 1) {
+		return;
+	}
+
+	hrs_client->evt_handler(hrs_client, &evt);
+}
+
 void ble_hrs_client_on_ble_evt(const ble_evt_t *ble_evt, void *hrs_client)
 {
 	__ASSERT(ble_evt, "BLE event is NULL");
@@ -204,8 +236,15 @@ void ble_hrs_client_on_ble_evt(const ble_evt_t *ble_evt, void *hrs_client)
 		on_hvx(hrs_client, ble_evt);
 		break;
 	case BLE_GAP_EVT_DISCONNECTED:
+		const ble_gap_evt_t *gap_evt = &ble_evt->evt.gap_evt;
+		if (gap_evt->params.connected.role != BLE_GAP_ROLE_CENTRAL){
+			return;
+		}
 		on_disconnected(hrs_client, ble_evt);
 		break;
+	case BLE_GATTC_EVT_READ_RSP:
+		on_read_rsp(hrs_client, ble_evt);
+		break;
 	default:
 		break;
 	}