summaryrefslogtreecommitdiff
path: root/monitor/att.c
diff options
context:
space:
mode:
authorLuiz Augusto von Dentz <luiz.von.dentz@intel.com>2022-05-20 15:51:42 -0700
committerLuiz Augusto von Dentz <luiz.von.dentz@intel.com>2022-05-26 13:57:48 -0700
commit13bdb9f3bee1763143ec5af4db3bb4e213261fe7 (patch)
treed45c551e0d6127908e450d6edd9ad582439ccb9d /monitor/att.c
parent53c28e3d868396fe5676751a44171dd67a7255a0 (diff)
downloadbluez-13bdb9f3bee1763143ec5af4db3bb4e213261fe7.tar.gz
monitor/att: Add decoding support for PAC Sink/Source
This adds decoding support for PAC Sink/Source attributes: < ACL Data TX: Handle 42 flags 0x00 dlen 9 Channel: 64 len 5 sdu 3 [PSM 39 mode Enhanced Credit (0x81)] {chan 0} ATT: Read Request (0x0a) len 2 Handle: 0x0017 Type: Sink PAC (0x2bc9) > ACL Data RX: Handle 42 flags 0x02 dlen 31 Channel: 65 len 27 sdu 25 [PSM 39 mode Enhanced Credit (0x81)] {chan 0} Value: 010600000000100301ff0002020302030305041e00f00000 Number of PAC(s): 1 PAC #0: Codec: LC3 (0x06) Codec Specific Configuration #0: len 0x03 type 0x01 Codec Specific Configuration: ff00 Codec Specific Configuration #1: len 0x02 type 0x02 Codec Specific Configuration: 03 Codec Specific Configuration #2: len 0x02 type 0x03 Codec Specific Configuration: 03 Codec Specific Configuration #3: len 0x05 type 0x04 Codec Specific Configuration: 1e00f000
Diffstat (limited to 'monitor/att.c')
-rw-r--r--monitor/att.c92
1 files changed, 92 insertions, 0 deletions
diff --git a/monitor/att.c b/monitor/att.c
index 0223af210..de27ee42c 100644
--- a/monitor/att.c
+++ b/monitor/att.c
@@ -247,6 +247,96 @@ static void ccc_write(const struct l2cap_frame *frame)
print_ccc_value(frame);
}
+static void print_pac(const struct l2cap_frame *frame)
+{
+ uint8_t num = 0, i;
+
+ if (!l2cap_frame_get_u8((void *)frame, &num)) {
+ print_text(COLOR_ERROR, "Number of PAC(s): invalid size");
+ goto done;
+ }
+
+ print_field(" Number of PAC(s): %u", num);
+
+ for (i = 0; i < num; i++) {
+ uint8_t codec_id;
+ uint16_t codec_cid, codec_vid;
+ struct bt_hci_lv_data *cc;
+ struct bt_hci_lv_data *meta;
+
+ print_field(" PAC #%u:", i);
+
+ if (!l2cap_frame_get_u8((void *)frame, &codec_id)) {
+ print_text(COLOR_ERROR, "Codec: invalid size");
+ goto done;
+ }
+
+ packet_print_codec_id(" Codec", codec_id);
+
+ if (!l2cap_frame_get_le16((void *)frame, &codec_cid)) {
+ print_text(COLOR_ERROR,
+ "Codec Company ID: invalid size");
+ goto done;
+ }
+
+ if (!l2cap_frame_get_le16((void *)frame, &codec_vid)) {
+ print_text(COLOR_ERROR,
+ "Codec Vendor ID: invalid size");
+ goto done;
+ }
+
+ if (codec_id == 0xff) {
+ print_field(" Codec Company ID: %s (0x%04x)",
+ bt_compidtostr(codec_cid),
+ codec_cid);
+ print_field(" Codec Vendor ID: 0x%04x", codec_vid);
+ }
+
+ cc = l2cap_frame_pull((void *)frame, frame, sizeof(*cc));
+ if (!cc) {
+ print_text(COLOR_ERROR,
+ "Codec Specific Configuration: invalid size");
+ goto done;
+ }
+
+ if (!l2cap_frame_pull((void *)frame, frame, cc->len)) {
+ print_text(COLOR_ERROR,
+ "Codec Specific Configuration: invalid size");
+ goto done;
+ }
+
+ packet_print_ltv(" Codec Specific Configuration", cc->data,
+ cc->len);
+
+ meta = l2cap_frame_pull((void *)frame, frame, sizeof(*meta));
+ if (!meta) {
+ print_text(COLOR_ERROR, "Metadata: invalid size");
+ goto done;
+ }
+
+ if (!l2cap_frame_pull((void *)frame, frame, meta->len)) {
+ print_text(COLOR_ERROR, "Metadata: invalid size");
+ goto done;
+ }
+
+ packet_print_ltv(" Metadata", meta->data, meta->len);
+ }
+
+done:
+ if (frame->size)
+ print_hex_field(" Data", frame->data, frame->size);
+}
+
+static void pac_read(const struct l2cap_frame *frame)
+{
+ print_pac(frame);
+}
+
+static void pac_notify(const struct l2cap_frame *frame)
+{
+ print_pac(frame);
+}
+
#define GATT_HANDLER(_uuid, _read, _write, _notify) \
{ \
.uuid = { \
@@ -265,6 +355,8 @@ struct gatt_handler {
void (*notify)(const struct l2cap_frame *frame);
} gatt_handlers[] = {
GATT_HANDLER(0x2902, ccc_read, ccc_write, NULL),
+ GATT_HANDLER(0x2bc9, pac_read, NULL, pac_notify),
+ GATT_HANDLER(0x2bcb, pac_read, NULL, pac_notify),
};
static struct gatt_handler *get_handler(struct gatt_db_attribute *attr)