monitor: Add basic decoding for SDP transactions

1 files changed, 32 insertions, 0 deletions

diff --git a/monitor/l2cap.h b/monitor/l2cap.h
index 503bacaf9..30bcb6a5e 100644
--- a/monitor/l2cap.h
+++ b/monitor/l2cap.h
@@ -25,5 +25,37 @@
 #include <stdint.h>
 #include <stdbool.h>
 
+struct l2cap_frame {
+	uint16_t index;
+	bool in;
+	uint16_t handle;
+	uint16_t cid;
+	const void *data;
+	uint16_t size;
+};
+
+static inline void l2cap_frame_init(struct l2cap_frame *frame,
+				uint16_t index, bool in, uint16_t handle,
+				uint16_t cid, const void *data, uint16_t size)
+{
+	frame->index  = index;
+	frame->in     = in;
+	frame->handle = handle;
+	frame->cid    = cid;
+	frame->data   = data;
+	frame->size   = size;
+}
+
+static inline void l2cap_frame_pull(struct l2cap_frame *frame,
+				const struct l2cap_frame *source, uint16_t len)
+{
+	frame->index   = source->index;
+	frame->in      = source->in;
+	frame->handle  = source->handle;
+	frame->cid     = source->cid;
+	frame->data    = source->data + len;
+	frame->size    = source->size - len;
+}
+
 void l2cap_packet(uint16_t index, bool in, uint16_t handle, uint8_t flags,
 					const void *data, uint16_t size);