diff --git a/profiles/input/hog-lib.c b/profiles/input/hog-lib.c
index 0b375fe..5af99fc 100644
--- a/profiles/input/hog-lib.c
+++ b/profiles/input/hog-lib.c
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
+#include <inttypes.h>
#include <glib.h>
struct bt_uhid *uhid;
int uhid_fd;
bool uhid_created;
- gboolean has_report_id;
+ uint64_t uhid_flags;
uint16_t bcdhid;
uint8_t bcountrycode;
uint16_t proto_mode_handle;
struct report {
struct bt_hog *hog;
+ bool numbered;
uint8_t id;
uint8_t type;
uint16_t handle;
ev.type = UHID_INPUT;
buf = ev.u.input.data;
- if (hog->has_report_id) {
+ if (report->numbered) {
buf[0] = report->id;
len = MIN(len, sizeof(ev.u.input.data) - 1);
memcpy(buf + 1, pdu, len);
if (ra->type != rb->type)
return ra->type - rb->type;
- /* skip id check in case of report id 0 */
- if (!rb->id)
+ /* skip id check in case of reports not being numbered */
+ if (!ra->numbered && !rb->numbered)
return 0;
/* ..then by id */
struct report cmp;
GSList *l;
+ memset(&cmp, 0, sizeof(cmp));
cmp.type = type;
- cmp.id = hog->has_report_id ? id : 0;
+ cmp.id = id;
+
+ switch (type) {
+ case HOG_REPORT_TYPE_FEATURE:
+ if (hog->flags & UHID_DEV_NUMBERED_FEATURE_REPORTS)
+ cmp.numbered = true;
+ break;
+ case HOG_REPORT_TYPE_OUTPUT:
+ if (hog->flags & UHID_DEV_NUMBERED_OUTPUT_REPORTS)
+ cmp.numbered = true;
+ break;
+ case HOG_REPORT_TYPE_INPUT:
+ if (hog->flags & UHID_DEV_NUMBERED_INPUT_REPORTS)
+ cmp.numbered = true;
+ break;
+ }
l = g_slist_find_custom(hog->reports, &cmp, report_cmp);
data = ev->u.output.data;
size = ev->u.output.size;
- if (hog->has_report_id && size > 0) {
+
+ if (report->numbered && size > 0) {
data++;
--size;
}
data, size, NULL, NULL);
}
+static void set_numbered(void *data, void *user_data)
+{
+ struct report *report = data;
+ struct bt_hog *hog = user_data;
+
+ switch (report->type) {
+ case HOG_REPORT_TYPE_INPUT:
+ if (hog->uhid_flags & UHID_DEV_NUMBERED_INPUT_REPORTS)
+ report->numbered = true;
+ break;
+ case HOG_REPORT_TYPE_OUTPUT:
+ if (hog->uhid_flags & UHID_DEV_NUMBERED_OUTPUT_REPORTS)
+ report->numbered = true;
+ break;
+ case HOG_REPORT_TYPE_FEATURE:
+ if (hog->uhid_flags & UHID_DEV_NUMBERED_FEATURE_REPORTS)
+ report->numbered = true;
+ break;
+ }
+}
+
+static void start_flags(struct uhid_event *ev, void *user_data)
+{
+ struct bt_hog *hog = user_data;
+
+ hog->uhid_flags = ev->u.start.dev_flags;
+
+ DBG("uHID device flags: 0x%16" PRIx64, hog->uhid_flags);
+
+ if (hog->uhid_flags)
+ g_slist_foreach(hog->reports, set_numbered, hog);
+}
+
static void set_report_cb(guint8 status, const guint8 *pdu,
guint16 plen, gpointer user_data)
{
data = ev->u.set_report.data;
size = ev->u.set_report.size;
- if (hog->has_report_id && size > 0) {
+
+ if (report->numbered && size > 0) {
data++;
--size;
}
}
static void report_reply(struct bt_hog *hog, uint8_t status, uint8_t id,
- uint16_t len, const uint8_t *data)
+ bool numbered, uint16_t len, const uint8_t *data)
{
struct uhid_event rsp;
int err;
if (status)
goto done;
- if (hog->has_report_id && len > 0) {
+ if (numbered && len > 0) {
rsp.u.get_report_reply.size = len + 1;
rsp.u.get_report_reply.data[0] = id;
memcpy(&rsp.u.get_report_reply.data[1], data, len);
++pdu;
exit:
- report_reply(hog, status, report->id, len, pdu);
+ report_reply(hog, status, report->id, report->numbered, len, pdu);
}
static void get_report(struct uhid_event *ev, void *user_data)
fail:
/* reply with an error on failure */
- report_reply(hog, err, 0, 0, NULL);
-}
-
-static bool get_descriptor_item_info(uint8_t *buf, ssize_t blen, ssize_t *len,
- bool *is_long)
-{
- if (!blen)
- return false;
-
- *is_long = (buf[0] == 0xfe);
-
- if (*is_long) {
- if (blen < 3)
- return false;
-
- /*
- * long item:
- * byte 0 -> 0xFE
- * byte 1 -> data size
- * byte 2 -> tag
- * + data
- */
-
- *len = buf[1] + 3;
- } else {
- uint8_t b_size;
-
- /*
- * short item:
- * byte 0[1..0] -> data size (=0, 1, 2, 4)
- * byte 0[3..2] -> type
- * byte 0[7..4] -> tag
- * + data
- */
-
- b_size = buf[0] & 0x03;
- *len = (b_size ? 1 << (b_size - 1) : 0) + 1;
- }
-
- /* item length should be no more than input buffer length */
- return *len <= blen;
-}
-
-static char *item2string(char *str, uint8_t *buf, uint8_t len)
-{
- char *p = str;
- int i;
-
- /*
- * Since long item tags are not defined except for vendor ones, we
- * just ensure that short items are printed properly (up to 5 bytes).
- */
- for (i = 0; i < 6 && i < len; i++)
- p += sprintf(p, " %02x", buf[i]);
-
- /*
- * If there are some data left, just add continuation mark to indicate
- * this.
- */
- if (i < len)
- sprintf(p, " ...");
-
- return str;
+ report_reply(hog, err, 0, false, 0, NULL);
}
static bool input_dequeue(const void *data, const void *match_data)
}
static void uhid_create(struct bt_hog *hog, uint8_t *report_map,
- ssize_t report_map_len)
+ size_t report_map_len)
{
uint8_t *value = report_map;
struct uhid_event ev;
- ssize_t vlen = report_map_len;
- char itemstr[20]; /* 5x3 (data) + 4 (continuation) + 1 (null) */
+ size_t vlen = report_map_len;
int i, err;
GError *gerr = NULL;
- DBG("Report MAP:");
- for (i = 0; i < vlen;) {
- ssize_t ilen = 0;
- bool long_item = false;
-
- if (get_descriptor_item_info(&value[i], vlen - i, &ilen,
- &long_item)) {
- /* Report ID is short item with prefix 100001xx */
- if (!long_item && (value[i] & 0xfc) == 0x84)
- hog->has_report_id = TRUE;
-
- DBG("\t%s", item2string(itemstr, &value[i], ilen));
-
- i += ilen;
- } else {
- error("Report Map parsing failed at %d", i);
-
- /* Just print remaining items at once and break */
- DBG("\t%s", item2string(itemstr, &value[i], vlen - i));
- break;
- }
+ if (vlen > sizeof(ev.u.create2.rd_data)) {
+ error("Report MAP too big: %zu > %zu", vlen,
+ sizeof(ev.u.create2.rd_data));
+ return;
}
/* create uHID device */
memset(&ev, 0, sizeof(ev));
- ev.type = UHID_CREATE;
+ ev.type = UHID_CREATE2;
bt_io_get(g_attrib_get_channel(hog->attrib), &gerr,
- BT_IO_OPT_SOURCE, ev.u.create.phys,
- BT_IO_OPT_DEST, ev.u.create.uniq,
+ BT_IO_OPT_SOURCE, ev.u.create2.phys,
+ BT_IO_OPT_DEST, ev.u.create2.uniq,
BT_IO_OPT_INVALID);
- /* Phys + uniq are the same size (hw address type) */
- for (i = 0;
- i < (int)sizeof(ev.u.create.phys) && ev.u.create.phys[i] != 0;
- ++i) {
- ev.u.create.phys[i] = tolower(ev.u.create.phys[i]);
- ev.u.create.uniq[i] = tolower(ev.u.create.uniq[i]);
- }
-
if (gerr) {
error("Failed to connection details: %s", gerr->message);
g_error_free(gerr);
return;
}
- strncpy((char *) ev.u.create.name, hog->name,
- sizeof(ev.u.create.name) - 1);
- ev.u.create.vendor = hog->vendor;
- ev.u.create.product = hog->product;
- ev.u.create.version = hog->version;
- ev.u.create.country = hog->bcountrycode;
- ev.u.create.bus = BUS_BLUETOOTH;
- ev.u.create.rd_data = value;
- ev.u.create.rd_size = vlen;
+ /* Phys + uniq are the same size (hw address type) */
+ for (i = 0;
+ i < (int)sizeof(ev.u.create2.phys) && ev.u.create2.phys[i] != 0;
+ ++i) {
+ ev.u.create2.phys[i] = tolower(ev.u.create2.phys[i]);
+ ev.u.create2.uniq[i] = tolower(ev.u.create2.uniq[i]);
+ }
+
+ strncpy((char *) ev.u.create2.name, hog->name,
+ sizeof(ev.u.create2.name) - 1);
+ ev.u.create2.vendor = hog->vendor;
+ ev.u.create2.product = hog->product;
+ ev.u.create2.version = hog->version;
+ ev.u.create2.country = hog->bcountrycode;
+ ev.u.create2.bus = BUS_BLUETOOTH;
+ ev.u.create2.rd_size = vlen;
+
+ memcpy(ev.u.create2.rd_data, value, vlen);
err = bt_uhid_send(hog->uhid, &ev);
if (err < 0) {
return;
}
+ bt_uhid_register(hog->uhid, UHID_START, start_flags, hog);
bt_uhid_register(hog->uhid, UHID_OUTPUT, forward_report, hog);
bt_uhid_register(hog->uhid, UHID_GET_REPORT, get_report, hog);
bt_uhid_register(hog->uhid, UHID_SET_REPORT, set_report, hog);
remove_gatt_req(req, status);
- DBG("HoG inspecting report map");
-
if (status != 0) {
error("Report Map read failed: %s", att_ecode2str(status));
return;