mirror of
https://github.com/espressif/esp-idf.git
synced 2026-09-22 13:01:16 +03:00
fix(nimble): Fix nimble HID service discovery
This commit is contained in:
Submodule components/bt/host/nimble/nimble updated: 64f0616d3b...511b4eb9cd
@@ -428,6 +428,9 @@ static void read_device_services(esp_hidh_dev_t *dev)
|
||||
dev->config.report_maps = NULL;
|
||||
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++) {
|
||||
@@ -467,6 +470,7 @@ static void read_device_services(esp_hidh_dev_t *dev)
|
||||
for (uint16_t c = 0; c < ccount; c++) {
|
||||
cuuid = ble_uuid_u16(&char_result[c].uuid.u);
|
||||
chandle = char_result[c].val_handle;
|
||||
report = NULL;
|
||||
ESP_LOGD(TAG, " CHAR:(%d), handle: %d, perm: 0x%02x, uuid: 0x%04x",
|
||||
c + 1, chandle, char_result[c].properties, cuuid);
|
||||
if (suuid == BLE_SVC_GAP_UUID16) {
|
||||
@@ -514,21 +518,22 @@ static void read_device_services(esp_hidh_dev_t *dev)
|
||||
}
|
||||
}
|
||||
}
|
||||
continue;
|
||||
} else {
|
||||
if (cuuid == BLE_SVC_HID_CHR_UUID16_PROTOCOL_MODE) {
|
||||
if (char_result[c].properties & BLE_GATT_CHR_PROP_READ) {
|
||||
if (read_char(dev->ble.conn_id, chandle, &rdata, &rlen) == 0 && rlen) {
|
||||
dev->protocol_mode[hidindex] = *((uint8_t *)rdata);
|
||||
free(rdata);
|
||||
rdata = NULL;
|
||||
}
|
||||
}
|
||||
continue;
|
||||
} else if (suuid == BLE_SVC_HID_UUID16) {
|
||||
if (cuuid == BLE_SVC_HID_CHR_UUID16_PROTOCOL_MODE) {
|
||||
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) {
|
||||
dev->protocol_mode[hidindex] = *((uint8_t *)rdata);
|
||||
}
|
||||
free(rdata);
|
||||
rdata = NULL;
|
||||
}
|
||||
continue;
|
||||
}
|
||||
if (cuuid == BLE_SVC_HID_CHR_UUID16_REPORT_MAP) {
|
||||
if (char_result[c].properties & BLE_GATT_CHR_PROP_READ) {
|
||||
} else if (cuuid == BLE_SVC_HID_CHR_UUID16_REPORT_MAP) {
|
||||
if ((char_result[c].properties & BLE_GATT_CHR_PROP_READ) != 0
|
||||
&& dev->config.report_maps != NULL && hidindex < dev->config.report_maps_len) {
|
||||
if (read_char(dev->ble.conn_id, chandle, &rdata, &rlen) == 0 && rlen) {
|
||||
uint8_t *copy = nimble_hidh_dup_bytes(rdata, rlen);
|
||||
if (copy) {
|
||||
@@ -537,41 +542,38 @@ static void read_device_services(esp_hidh_dev_t *dev)
|
||||
dev->config.report_maps[hidindex].len = rlen;
|
||||
}
|
||||
}
|
||||
continue;
|
||||
} 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) {
|
||||
report = (esp_hidh_dev_report_t *)malloc(sizeof(esp_hidh_dev_report_t));
|
||||
if (report == NULL) {
|
||||
ESP_LOGE(TAG, "malloc esp_hidh_dev_report_t failed");
|
||||
goto done;
|
||||
}
|
||||
report->next = NULL;
|
||||
report->permissions = char_result[c].properties;
|
||||
report->handle = chandle;
|
||||
report->ccc_handle = 0;
|
||||
report->report_id = 0;
|
||||
report->map_index = hidindex;
|
||||
if (cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_KBD_INP) {
|
||||
report->protocol_mode = ESP_HID_PROTOCOL_MODE_BOOT;
|
||||
report->report_type = ESP_HID_REPORT_TYPE_INPUT;
|
||||
report->usage = ESP_HID_USAGE_KEYBOARD;
|
||||
report->value_len = 8;
|
||||
} else if (cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_KBD_OUT) {
|
||||
report->protocol_mode = ESP_HID_PROTOCOL_MODE_BOOT;
|
||||
report->report_type = ESP_HID_REPORT_TYPE_OUTPUT;
|
||||
report->usage = ESP_HID_USAGE_KEYBOARD;
|
||||
report->value_len = 8;
|
||||
} else if (cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_MOUSE_INP) {
|
||||
report->protocol_mode = ESP_HID_PROTOCOL_MODE_BOOT;
|
||||
report->report_type = ESP_HID_REPORT_TYPE_INPUT;
|
||||
report->usage = ESP_HID_USAGE_MOUSE;
|
||||
report->value_len = 8;
|
||||
} else {
|
||||
report->protocol_mode = ESP_HID_PROTOCOL_MODE_REPORT;
|
||||
report->report_type = 0;
|
||||
report->usage = ESP_HID_USAGE_GENERIC;
|
||||
report->value_len = 0;
|
||||
}
|
||||
free(rdata);
|
||||
rdata = NULL;
|
||||
}
|
||||
continue;
|
||||
} 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) {
|
||||
report = (esp_hidh_dev_report_t *)malloc(sizeof(esp_hidh_dev_report_t));
|
||||
if (report == NULL) {
|
||||
ESP_LOGE(TAG, "malloc esp_hidh_dev_report_t failed");
|
||||
goto done;
|
||||
}
|
||||
report->next = NULL;
|
||||
report->permissions = char_result[c].properties;
|
||||
report->handle = chandle;
|
||||
report->ccc_handle = 0;
|
||||
report->report_id = 0;
|
||||
report->map_index = hidindex;
|
||||
if (cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_KBD_INP) {
|
||||
report->protocol_mode = ESP_HID_PROTOCOL_MODE_BOOT;
|
||||
report->report_type = ESP_HID_REPORT_TYPE_INPUT;
|
||||
report->usage = ESP_HID_USAGE_KEYBOARD;
|
||||
report->value_len = 8;
|
||||
} else if (cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_KBD_OUT) {
|
||||
report->protocol_mode = ESP_HID_PROTOCOL_MODE_BOOT;
|
||||
report->report_type = ESP_HID_REPORT_TYPE_OUTPUT;
|
||||
report->usage = ESP_HID_USAGE_KEYBOARD;
|
||||
report->value_len = 8;
|
||||
} else if (cuuid == BLE_SVC_HID_CHR_UUID16_BOOT_MOUSE_INP) {
|
||||
report->protocol_mode = ESP_HID_PROTOCOL_MODE_BOOT;
|
||||
report->report_type = ESP_HID_REPORT_TYPE_INPUT;
|
||||
report->usage = ESP_HID_USAGE_MOUSE;
|
||||
report->value_len = 8;
|
||||
} else {
|
||||
report->protocol_mode = ESP_HID_PROTOCOL_MODE_REPORT;
|
||||
report->report_type = 0;
|
||||
@@ -581,6 +583,8 @@ static void read_device_services(esp_hidh_dev_t *dev)
|
||||
} else {
|
||||
continue;
|
||||
}
|
||||
} else {
|
||||
continue;
|
||||
}
|
||||
struct ble_gatt_dsc descr_result[HIDH_MAX_DSCS];
|
||||
uint16_t num_dsc = HIDH_MAX_DSCS;
|
||||
|
||||
Reference in New Issue
Block a user