fix(nimble): Fix nimble HID service discovery

This commit is contained in:
Astha Verma
2026-09-09 14:09:04 +05:30
parent 16cd970a43
commit 5048d40e1b
2 changed files with 52 additions and 48 deletions
+16 -12
View File
@@ -428,6 +428,9 @@ static void read_device_services(esp_hidh_dev_t *dev)
dev->config.report_maps = NULL; dev->config.report_maps = NULL;
goto done; goto done;
} }
/* HOGP defaults to Report Protocol Mode; the Protocol Mode
* characteristic is often write-only, so it cannot be read back. */
memset(dev->protocol_mode, ESP_HID_PROTOCOL_MODE_REPORT, dev->config.report_maps_len);
} }
for (uint16_t s = 0; s < svc_count; s++) { for (uint16_t s = 0; s < svc_count; s++) {
@@ -467,6 +470,7 @@ static void read_device_services(esp_hidh_dev_t *dev)
for (uint16_t c = 0; c < ccount; c++) { for (uint16_t c = 0; c < ccount; c++) {
cuuid = ble_uuid_u16(&char_result[c].uuid.u); cuuid = ble_uuid_u16(&char_result[c].uuid.u);
chandle = char_result[c].val_handle; chandle = char_result[c].val_handle;
report = NULL;
ESP_LOGD(TAG, " CHAR:(%d), handle: %d, perm: 0x%02x, uuid: 0x%04x", ESP_LOGD(TAG, " CHAR:(%d), handle: %d, perm: 0x%02x, uuid: 0x%04x",
c + 1, chandle, char_result[c].properties, cuuid); c + 1, chandle, char_result[c].properties, cuuid);
if (suuid == BLE_SVC_GAP_UUID16) { if (suuid == BLE_SVC_GAP_UUID16) {
@@ -514,21 +518,22 @@ static void read_device_services(esp_hidh_dev_t *dev)
} }
} }
} }
}
continue; continue;
} else { } else if (suuid == BLE_SVC_HID_UUID16) {
if (cuuid == BLE_SVC_HID_CHR_UUID16_PROTOCOL_MODE) { if (cuuid == BLE_SVC_HID_CHR_UUID16_PROTOCOL_MODE) {
if (char_result[c].properties & BLE_GATT_CHR_PROP_READ) { if ((char_result[c].properties & BLE_GATT_CHR_PROP_READ) != 0
&& dev->protocol_mode != NULL && hidindex < dev->config.report_maps_len) {
if (read_char(dev->ble.conn_id, chandle, &rdata, &rlen) == 0 && rlen) { if (read_char(dev->ble.conn_id, chandle, &rdata, &rlen) == 0 && rlen) {
dev->protocol_mode[hidindex] = *((uint8_t *)rdata); dev->protocol_mode[hidindex] = *((uint8_t *)rdata);
}
free(rdata); free(rdata);
rdata = NULL; rdata = NULL;
} }
}
}
continue; continue;
} } else if (cuuid == BLE_SVC_HID_CHR_UUID16_REPORT_MAP) {
if (cuuid == BLE_SVC_HID_CHR_UUID16_REPORT_MAP) { if ((char_result[c].properties & BLE_GATT_CHR_PROP_READ) != 0
if (char_result[c].properties & BLE_GATT_CHR_PROP_READ) { && dev->config.report_maps != NULL && hidindex < dev->config.report_maps_len) {
if (read_char(dev->ble.conn_id, chandle, &rdata, &rlen) == 0 && rlen) { if (read_char(dev->ble.conn_id, chandle, &rdata, &rlen) == 0 && rlen) {
uint8_t *copy = nimble_hidh_dup_bytes(rdata, rlen); uint8_t *copy = nimble_hidh_dup_bytes(rdata, rlen);
if (copy) { if (copy) {
@@ -537,6 +542,9 @@ static void read_device_services(esp_hidh_dev_t *dev)
dev->config.report_maps[hidindex].len = rlen; dev->config.report_maps[hidindex].len = rlen;
} }
} }
free(rdata);
rdata = NULL;
}
continue; continue;
} else if (cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_KBD_INP || cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_KBD_OUT } else if (cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_KBD_INP || cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_KBD_OUT
|| cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_MOUSE_INP || cuuid == BLE_SVC_HID_CHR_UUID16_RPT) { || cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_MOUSE_INP || cuuid == BLE_SVC_HID_CHR_UUID16_RPT) {
@@ -573,15 +581,11 @@ static void read_device_services(esp_hidh_dev_t *dev)
report->value_len = 0; report->value_len = 0;
} }
} else { } else {
report->protocol_mode = ESP_HID_PROTOCOL_MODE_REPORT; continue;
report->report_type = 0;
report->usage = ESP_HID_USAGE_GENERIC;
report->value_len = 0;
} }
} else { } else {
continue; continue;
} }
}
struct ble_gatt_dsc descr_result[HIDH_MAX_DSCS]; struct ble_gatt_dsc descr_result[HIDH_MAX_DSCS];
uint16_t num_dsc = HIDH_MAX_DSCS; uint16_t num_dsc = HIDH_MAX_DSCS;
uint16_t chr_end_handle; uint16_t chr_end_handle;