From: Luiz Augusto von Dentz <[email protected]>
This adds GMAS attribute decoders.
---
monitor/att.c | 135 ++++++++++++++++++++++++++++++++++++++++++++++++++
1 file changed, 135 insertions(+)
diff --git a/monitor/att.c b/monitor/att.c
index 39ea5d6dac5a..9db273223352 100644
--- a/monitor/att.c
+++ b/monitor/att.c
@@ -3195,6 +3195,140 @@ static void bcast_audio_scan_cp_write(const struct l2cap_frame *frame)
print_bcast_audio_scan_cp_cmd(frame);
}
+static const struct bitfield_data gmap_role_table[] = {
+ { 0, "Unicast Game Gateway (UGG) (0x0001)" },
+ { 1, "Unicast Game Terminal (UGT) (0x0002)" },
+ { 2, "Broadcast Game Sender (BGS) (0x0004)" },
+ { 3, "Broadcast Game Receiver (BGR) (0x0008)" },
+ { }
+};
+
+static void gmap_role_read(const struct l2cap_frame *frame)
+{
+ uint8_t role;
+ uint8_t mask;
+
+ if (!l2cap_frame_get_u8((void *)frame, &role)) {
+ print_text(COLOR_ERROR, " invalid size");
+ return;
+ }
+
+ print_field(" Role: 0x%2.2x", role);
+
+ mask = print_bitfield(6, role, gmap_role_table);
+ if (mask)
+ print_text(COLOR_WHITE_BG, " Unknown fields (0x%2.2x)",
+ mask);
+}
+
+static const struct bitfield_data ugg_features_table[] = {
+ { 0, "UGG Multiplex (0x0001)" },
+ { 1, "UGG 96 kbps Source (0x0002)" },
+ { 2, "UGG Multilink (0x0004)" },
+ { }
+};
+
+static void ugg_features_read(const struct l2cap_frame *frame)
+{
+ uint8_t value;
+ uint8_t mask;
+
+ if (!l2cap_frame_get_u8((void *)frame, &value)) {
+ print_text(COLOR_ERROR, " invalid size");
+ return;
+ }
+
+ print_field(" Value: 0x%2.2x", value);
+
+ mask = print_bitfield(6, value, ugg_features_table);
+ if (mask)
+ print_text(COLOR_WHITE_BG, " Unknown fields (0x%2.2x)",
+ mask);
+}
+
+static const struct bitfield_data ugt_features_table[] = {
+ { 0, "UGT Source (0x0001)" },
+ { 1, "UGT 80 kbps Source (0x0002)" },
+ { 2, "UGT Sink (0x0004)" },
+ { 3, "UGT 64 kbps Sink (0x0008)" },
+ { 4, "UGT Multiplex (0x0010)" },
+ { 5, "UGT Multisink (0x0020)" },
+ { 6, "UGT Multisource (0x0040)" },
+ { }
+};
+
+static void ugt_features_read(const struct l2cap_frame *frame)
+{
+ uint8_t value;
+ uint8_t mask;
+
+ if (!l2cap_frame_get_u8((void *)frame, &value)) {
+ print_text(COLOR_ERROR, " invalid size");
+ return;
+ }
+
+ print_field(" Value: 0x%2.2x", value);
+
+ mask = print_bitfield(6, value, ugt_features_table);
+ if (mask)
+ print_text(COLOR_WHITE_BG, " Unknown fields (0x%2.2x)",
+ mask);
+}
+
+static const struct bitfield_data bgs_features_table[] = {
+ { 0, "BGS 96 kbps (0x0001)" },
+ { }
+};
+
+static void bgs_features_read(const struct l2cap_frame *frame)
+{
+ uint8_t value;
+ uint8_t mask;
+
+ if (!l2cap_frame_get_u8((void *)frame, &value)) {
+ print_text(COLOR_ERROR, " invalid size");
+ return;
+ }
+
+ print_field(" Value: 0x%2.2x", value);
+
+ mask = print_bitfield(6, value, bgs_features_table);
+ if (mask)
+ print_text(COLOR_WHITE_BG, " Unknown fields (0x%2.2x)",
+ mask);
+}
+
+static const struct bitfield_data bgr_features_table[] = {
+ { 0, "BGR Multisink (0x0001)" },
+ { 1, "BGR Multiplex (0x0002)" },
+ { }
+};
+
+static void bgr_features_read(const struct l2cap_frame *frame)
+{
+ uint8_t value;
+ uint8_t mask;
+
+ if (!l2cap_frame_get_u8((void *)frame, &value)) {
+ print_text(COLOR_ERROR, " invalid size");
+ return;
+ }
+
+ print_field(" Value: 0x%2.2x", value);
+
+ mask = print_bitfield(6, value, bgr_features_table);
+ if (mask)
+ print_text(COLOR_WHITE_BG, " Unknown fields (0x%2.2x)",
+ mask);
+}
+
+#define GMAS \
+ GATT_HANDLER(0x2c00, gmap_role_read, NULL, NULL), \
+ GATT_HANDLER(0x2c01, ugg_features_read, NULL, NULL), \
+ GATT_HANDLER(0x2c02, ugt_features_read, NULL, NULL), \
+ GATT_HANDLER(0x2c02, bgs_features_read, NULL, NULL), \
+ GATT_HANDLER(0x2c03, bgr_features_read, NULL, NULL)
+
#define GATT_HANDLER(_uuid, _read, _write, _notify) \
{ \
.uuid = { \
@@ -3255,6 +3389,7 @@ struct gatt_handler {
GATT_HANDLER(0x2bc7, NULL, bcast_audio_scan_cp_write, NULL),
GATT_HANDLER(0x2bc8, bcast_recv_state_read, NULL,
bcast_recv_state_notify),
+ GMAS
};
static struct gatt_handler *get_handler_uuid(const bt_uuid_t *uuid)
--
2.42.0