bluetooth: services: ble_hrs_client: add bsl 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,8 @@ enum ble_hrs_client_evt_type {
 	 *  received from the peer.
 	 */
 	BLE_HRS_CLIENT_EVT_HRM_NOTIFICATION,
+	/** Event indicating that the Body Sensor Location characteristic was received from the peer */
+	BLE_HRS_CLIENT_EVT_BSL_UPDATE,
 	/** Error. */
 	BLE_HRS_CLIENT_EVT_ERROR,
 };
@@ -80,6 +82,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;
+	/** Handle of the Body Sensor Location characteristic, as provided by the SoftDevice */
+	uint16_t bsl_handle;
 };
 
 /**
@@ -98,6 +102,8 @@ struct ble_hrs_client_evt {
 		} discovery_complete;
 		/** @ref BLE_HRS_CLIENT_EVT_HRM_NOTIFICATION event data. */
 		struct ble_hrs_measurement hrm_notification;
+		/** @ref BLE_HRS_CLIENT_EVT_BSL_UPDATE event data. */
+		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,7 @@ 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_handle = BLE_GATT_HANDLE_INVALID;
 	}
 }
 
@@ -152,7 +153,12 @@ 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_handle =
+				db_char->characteristic.handle_value;
+			sd_ble_gattc_read(db_discovery_evt->conn_handle,
+				db_char->characteristic.handle_value, 0);
 		}
 	}
 
@@ -194,18 +200,52 @@ 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 body sensor location response. */
+	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");
 	__ASSERT(hrs_client, "HRS central instance is NULL");
 
+	if (ble_evt->header.evt_id >= BLE_GAP_EVT_BASE &&
+	    ble_evt->header.evt_id <= BLE_GAP_EVT_LAST &&
+	    ble_evt->evt.gap_evt.params.connected.role != BLE_GAP_ROLE_CENTRAL) {
+		return;
+	}
+
 	switch (ble_evt->header.evt_id) {
 	case BLE_GATTC_EVT_HVX:
 		on_hvx(hrs_client, ble_evt);
 		break;
 	case BLE_GAP_EVT_DISCONNECTED:
 		on_disconnected(hrs_client, ble_evt);
 		break;
+	case BLE_GATTC_EVT_READ_RSP:
+		on_read_rsp(hrs_client, ble_evt);
+		break;
 	default:
 		break;
 	}