* [PATCH] monitor: Add initial support for BNEP
@ 2015-04-02 11:32 Gowtham Anandha Babu
2015-04-03 10:53 ` Grzegorz Kolodziejczyk
0 siblings, 1 reply; 6+ messages in thread
From: Gowtham Anandha Babu @ 2015-04-02 11:32 UTC (permalink / raw)
To: linux-bluetooth; +Cc: bharat.panda, cpgs, Gowtham Anandha Babu
> ACL Data RX: Handle 71 flags 0x02 dlen 11 [hci0] 17.739883
Channel: 64 len 7 [PSM 15 mode 0] {chan 0}
BNEP: Control (0x01|0)
01 02 11 16 11 15 ......
> ACL Data RX: Handle 71 flags 0x01 dlen 35 [hci0] 175.293028
Channel: 64 len 1532 [PSM 15 mode 0] {chan 0}
BNEP: General Ethernet (0x00|1)
00 00 00 00 00 00 00 00 00 00 00 00 08 00 00 0f ................
05 00 0c 03 00 00 20 00 00 03 00 00 20 00 00 3c ...... ..... ..<
> ACL Data RX: Handle 71 flags 0x01 dlen 12 [hci0] 145.825018
Channel: 64 len 1509 [PSM 15 mode 0] {chan 0}
BNEP: Compressed Ethernet Dest Only (0x04|0)
00 00 00 00 00 00 08 00 3c 3b 3a 39 38 37 36 35 ........<;:98765
34 33 32 31 30 2f 2e 2d 2c 2b 2a 29 28 27 26 25 43210/.-,+*)('&%
---
Makefile.tools | 1 +
android/Android.mk | 1 +
monitor/bnep.c | 116 +++++++++++++++++++++++++++++++++++++++++++++++++++++
monitor/bnep.h | 25 ++++++++++++
monitor/l2cap.c | 4 ++
5 files changed, 147 insertions(+)
create mode 100644 monitor/bnep.c
create mode 100644 monitor/bnep.h
diff --git a/Makefile.tools b/Makefile.tools
index b8dd90a..b37b774 100644
--- a/Makefile.tools
+++ b/Makefile.tools
@@ -28,6 +28,7 @@ monitor_btmon_SOURCES = monitor/main.c monitor/bt.h \
monitor/sdp.h monitor/sdp.c \
monitor/avctp.h monitor/avctp.c \
monitor/rfcomm.h monitor/rfcomm.c \
+ monitor/bnep.h monitor/bnep.c \
monitor/uuid.h monitor/uuid.c \
monitor/hwdb.h monitor/hwdb.c \
monitor/keys.h monitor/keys.c \
diff --git a/android/Android.mk b/android/Android.mk
index f218805..880e3ba 100644
--- a/android/Android.mk
+++ b/android/Android.mk
@@ -340,6 +340,7 @@ LOCAL_SRC_FILES := \
bluez/monitor/l2cap.c \
bluez/monitor/avctp.c \
bluez/monitor/rfcomm.c \
+ bluez/monitor/bnep.c \
bluez/monitor/uuid.c \
bluez/monitor/sdp.c \
bluez/monitor/vendor.c \
diff --git a/monitor/bnep.c b/monitor/bnep.c
new file mode 100644
index 0000000..1450f85
--- /dev/null
+++ b/monitor/bnep.c
@@ -0,0 +1,116 @@
+/*
+ *
+ * BlueZ - Bluetooth protocol stack for Linux
+ *
+ * Copyright (C) 2011-2014 Intel Corporation
+ * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
+ *
+ *
+ * This library is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Lesser General Public
+ * License as published by the Free Software Foundation; either
+ * version 2.1 of the License, or (at your option) any later version.
+ *
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+ * Lesser General Public License for more details.
+ *
+ * You should have received a copy of the GNU Lesser General Public
+ * License along with this library; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ *
+ */
+
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <ctype.h>
+#include <inttypes.h>
+
+#include "lib/bluetooth.h"
+
+#include "src/shared/util.h"
+#include "bt.h"
+#include "packet.h"
+#include "display.h"
+#include "l2cap.h"
+#include "uuid.h"
+#include "keys.h"
+#include "sdp.h"
+#include "bnep.h"
+
+#define GET_PKT_TYPE(type) (type & 0x7f)
+#define GET_EXTENSION(type) (type & 0x80)
+
+struct bnep_frame {
+ uint8_t type;
+ int extension;
+ struct l2cap_frame l2cap_frame;
+};
+
+struct bnep_data {
+ uint8_t type;
+ const char *str;
+};
+
+static const struct bnep_data bnep_table[] = {
+ { 0x00, "General Ethernet"},
+ { 0x01, "Control"},
+ { 0x02, "Compressed Ethernet"},
+ { 0x03, "Compressed Ethernet Src Only"},
+ { 0x04, "Compressed Ethernet Dest Only"},
+ { }
+};
+
+void bnep_packet(const struct l2cap_frame *frame)
+{
+ uint8_t type;
+ struct bnep_frame bnep_frame;
+ struct l2cap_frame *l2cap_frame;
+ const struct bnep_data *bnep_data = NULL;
+ const char *pdu_color, *pdu_str;
+ int i;
+
+ l2cap_frame_pull(&bnep_frame.l2cap_frame, frame, 0);
+ l2cap_frame = &bnep_frame.l2cap_frame;
+
+ if (!l2cap_frame_get_u8(l2cap_frame, &type))
+ goto fail;
+
+ bnep_frame.extension = GET_EXTENSION(type);
+ bnep_frame.type = GET_PKT_TYPE(type);
+
+ for (i = 0; bnep_table[i].str; i++) {
+ if (bnep_table[i].type == bnep_frame.type) {
+ bnep_data = &bnep_table[i];
+ break;
+ }
+ }
+
+ if (bnep_data) {
+ if (frame->in)
+ pdu_color = COLOR_MAGENTA;
+ else
+ pdu_color = COLOR_BLUE;
+ pdu_str = bnep_data->str;
+ } else {
+ pdu_color = COLOR_WHITE_BG;
+ pdu_str = "Unknown packet type";
+ }
+
+ print_indent(6, pdu_color, "BNEP: ", pdu_str, COLOR_OFF,
+ " (0x%02x|%s)", bnep_frame.type,
+ bnep_frame.extension ? "1" : "0");
+
+ packet_hexdump(l2cap_frame->data, l2cap_frame->size);
+ return;
+
+fail:
+ print_text(COLOR_ERROR, "frame too short");
+ packet_hexdump(frame->data, frame->size);
+}
diff --git a/monitor/bnep.h b/monitor/bnep.h
new file mode 100644
index 0000000..38340d6
--- /dev/null
+++ b/monitor/bnep.h
@@ -0,0 +1,25 @@
+/*
+ *
+ * BlueZ - Bluetooth protocol stack for Linux
+ *
+ * Copyright (C) 2011-2014 Intel Corporation
+ * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
+ *
+ *
+ * This library is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Lesser General Public
+ * License as published by the Free Software Foundation; either
+ * version 2.1 of the License, or (at your option) any later version.
+ *
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+ * Lesser General Public License for more details.
+ *
+ * You should have received a copy of the GNU Lesser General Public
+ * License along with this library; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ *
+ */
+
+void bnep_packet(const struct l2cap_frame *frame);
diff --git a/monitor/l2cap.c b/monitor/l2cap.c
index 5faa26f..fc565b1 100644
--- a/monitor/l2cap.c
+++ b/monitor/l2cap.c
@@ -43,6 +43,7 @@
#include "sdp.h"
#include "avctp.h"
#include "rfcomm.h"
+#include "bnep.h"
/* L2CAP Control Field bit masks */
#define L2CAP_CTRL_SAR_MASK 0xC000
@@ -2951,6 +2952,9 @@ static void l2cap_frame(uint16_t index, bool in, uint16_t handle,
case 0x0003:
rfcomm_packet(&frame);
break;
+ case 0x000f:
+ bnep_packet(&frame);
+ break;
case 0x001f:
att_packet(index, in, handle, cid, data, size);
break;
--
1.9.1
^ permalink raw reply related [flat|nested] 6+ messages in thread
* Re: [PATCH] monitor: Add initial support for BNEP
2015-04-02 11:32 [PATCH] monitor: Add initial support for BNEP Gowtham Anandha Babu
@ 2015-04-03 10:53 ` Grzegorz Kolodziejczyk
2015-04-06 5:42 ` Gowtham Anandha Babu
0 siblings, 1 reply; 6+ messages in thread
From: Grzegorz Kolodziejczyk @ 2015-04-03 10:53 UTC (permalink / raw)
To: Gowtham Anandha Babu; +Cc: linux-bluetooth, bharat.panda, cpgs
Hi Gowtham,
On 2 April 2015 at 13:32, Gowtham Anandha Babu <gowtham.ab@samsung.com> wrote:
>> ACL Data RX: Handle 71 flags 0x02 dlen 11 [hci0] 17.739883
> Channel: 64 len 7 [PSM 15 mode 0] {chan 0}
> BNEP: Control (0x01|0)
> 01 02 11 16 11 15 ......
>
>> ACL Data RX: Handle 71 flags 0x01 dlen 35 [hci0] 175.293028
> Channel: 64 len 1532 [PSM 15 mode 0] {chan 0}
> BNEP: General Ethernet (0x00|1)
> 00 00 00 00 00 00 00 00 00 00 00 00 08 00 00 0f ................
> 05 00 0c 03 00 00 20 00 00 03 00 00 20 00 00 3c ...... ..... ..<
>
>> ACL Data RX: Handle 71 flags 0x01 dlen 12 [hci0] 145.825018
> Channel: 64 len 1509 [PSM 15 mode 0] {chan 0}
> BNEP: Compressed Ethernet Dest Only (0x04|0)
> 00 00 00 00 00 00 08 00 3c 3b 3a 39 38 37 36 35 ........<;:98765
> 34 33 32 31 30 2f 2e 2d 2c 2b 2a 29 28 27 26 25 43210/.-,+*)('&%
> ---
> Makefile.tools | 1 +
> android/Android.mk | 1 +
> monitor/bnep.c | 116 +++++++++++++++++++++++++++++++++++++++++++++++++++++
> monitor/bnep.h | 25 ++++++++++++
> monitor/l2cap.c | 4 ++
> 5 files changed, 147 insertions(+)
> create mode 100644 monitor/bnep.c
> create mode 100644 monitor/bnep.h
>
> diff --git a/Makefile.tools b/Makefile.tools
> index b8dd90a..b37b774 100644
> --- a/Makefile.tools
> +++ b/Makefile.tools
> @@ -28,6 +28,7 @@ monitor_btmon_SOURCES = monitor/main.c monitor/bt.h \
> monitor/sdp.h monitor/sdp.c \
> monitor/avctp.h monitor/avctp.c \
> monitor/rfcomm.h monitor/rfcomm.c \
> + monitor/bnep.h monitor/bnep.c \
> monitor/uuid.h monitor/uuid.c \
> monitor/hwdb.h monitor/hwdb.c \
> monitor/keys.h monitor/keys.c \
> diff --git a/android/Android.mk b/android/Android.mk
> index f218805..880e3ba 100644
> --- a/android/Android.mk
> +++ b/android/Android.mk
> @@ -340,6 +340,7 @@ LOCAL_SRC_FILES := \
> bluez/monitor/l2cap.c \
> bluez/monitor/avctp.c \
> bluez/monitor/rfcomm.c \
> + bluez/monitor/bnep.c \
> bluez/monitor/uuid.c \
> bluez/monitor/sdp.c \
> bluez/monitor/vendor.c \
> diff --git a/monitor/bnep.c b/monitor/bnep.c
> new file mode 100644
> index 0000000..1450f85
> --- /dev/null
> +++ b/monitor/bnep.c
> @@ -0,0 +1,116 @@
> +/*
> + *
> + * BlueZ - Bluetooth protocol stack for Linux
> + *
> + * Copyright (C) 2011-2014 Intel Corporation
> + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
> + *
> + *
> + * This library is free software; you can redistribute it and/or
> + * modify it under the terms of the GNU Lesser General Public
> + * License as published by the Free Software Foundation; either
> + * version 2.1 of the License, or (at your option) any later version.
> + *
> + * This library is distributed in the hope that it will be useful,
> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
> + * Lesser General Public License for more details.
> + *
> + * You should have received a copy of the GNU Lesser General Public
> + * License along with this library; if not, write to the Free Software
> + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
> + *
> + */
> +
> +#ifdef HAVE_CONFIG_H
> +#include <config.h>
> +#endif
> +
> +#include <stdio.h>
> +#include <stdlib.h>
> +#include <string.h>
> +#include <ctype.h>
> +#include <inttypes.h>
> +
> +#include "lib/bluetooth.h"
> +
> +#include "src/shared/util.h"
> +#include "bt.h"
> +#include "packet.h"
> +#include "display.h"
> +#include "l2cap.h"
> +#include "uuid.h"
> +#include "keys.h"
> +#include "sdp.h"
> +#include "bnep.h"
> +
> +#define GET_PKT_TYPE(type) (type & 0x7f)
> +#define GET_EXTENSION(type) (type & 0x80)
> +
> +struct bnep_frame {
> + uint8_t type;
> + int extension;
> + struct l2cap_frame l2cap_frame;
> +};
> +
> +struct bnep_data {
> + uint8_t type;
> + const char *str;
> +};
> +
> +static const struct bnep_data bnep_table[] = {
> + { 0x00, "General Ethernet"},
> + { 0x01, "Control"},
> + { 0x02, "Compressed Ethernet"},
> + { 0x03, "Compressed Ethernet Src Only"},
> + { 0x04, "Compressed Ethernet Dest Only"},
> + { }
> +};
> +
> +void bnep_packet(const struct l2cap_frame *frame)
> +{
> + uint8_t type;
> + struct bnep_frame bnep_frame;
> + struct l2cap_frame *l2cap_frame;
> + const struct bnep_data *bnep_data = NULL;
> + const char *pdu_color, *pdu_str;
> + int i;
> +
> + l2cap_frame_pull(&bnep_frame.l2cap_frame, frame, 0);
> + l2cap_frame = &bnep_frame.l2cap_frame;
> +
> + if (!l2cap_frame_get_u8(l2cap_frame, &type))
> + goto fail;
> +
> + bnep_frame.extension = GET_EXTENSION(type);
> + bnep_frame.type = GET_PKT_TYPE(type);
> +
> + for (i = 0; bnep_table[i].str; i++) {
> + if (bnep_table[i].type == bnep_frame.type) {
> + bnep_data = &bnep_table[i];
> + break;
> + }
> + }
> +
> + if (bnep_data) {
> + if (frame->in)
> + pdu_color = COLOR_MAGENTA;
> + else
> + pdu_color = COLOR_BLUE;
> + pdu_str = bnep_data->str;
> + } else {
> + pdu_color = COLOR_WHITE_BG;
> + pdu_str = "Unknown packet type";
> + }
> +
> + print_indent(6, pdu_color, "BNEP: ", pdu_str, COLOR_OFF,
> + " (0x%02x|%s)", bnep_frame.type,
> + bnep_frame.extension ? "1" : "0");
> +
> + packet_hexdump(l2cap_frame->data, l2cap_frame->size);
> + return;
> +
> +fail:
> + print_text(COLOR_ERROR, "frame too short");
> + packet_hexdump(frame->data, frame->size);
> +}
> diff --git a/monitor/bnep.h b/monitor/bnep.h
> new file mode 100644
> index 0000000..38340d6
> --- /dev/null
> +++ b/monitor/bnep.h
> @@ -0,0 +1,25 @@
> +/*
> + *
> + * BlueZ - Bluetooth protocol stack for Linux
> + *
> + * Copyright (C) 2011-2014 Intel Corporation
> + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
> + *
> + *
> + * This library is free software; you can redistribute it and/or
> + * modify it under the terms of the GNU Lesser General Public
> + * License as published by the Free Software Foundation; either
> + * version 2.1 of the License, or (at your option) any later version.
> + *
> + * This library is distributed in the hope that it will be useful,
> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
> + * Lesser General Public License for more details.
> + *
> + * You should have received a copy of the GNU Lesser General Public
> + * License along with this library; if not, write to the Free Software
> + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
> + *
> + */
> +
> +void bnep_packet(const struct l2cap_frame *frame);
> diff --git a/monitor/l2cap.c b/monitor/l2cap.c
> index 5faa26f..fc565b1 100644
> --- a/monitor/l2cap.c
> +++ b/monitor/l2cap.c
> @@ -43,6 +43,7 @@
> #include "sdp.h"
> #include "avctp.h"
> #include "rfcomm.h"
> +#include "bnep.h"
>
> /* L2CAP Control Field bit masks */
> #define L2CAP_CTRL_SAR_MASK 0xC000
> @@ -2951,6 +2952,9 @@ static void l2cap_frame(uint16_t index, bool in, uint16_t handle,
> case 0x0003:
> rfcomm_packet(&frame);
> break;
> + case 0x000f:
> + bnep_packet(&frame);
> + break;
> case 0x001f:
> att_packet(index, in, handle, cid, data, size);
> break;
> --
> 1.9.1
>
> --
> To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
> the body of a message to majordomo@vger.kernel.org
> More majordomo info at http://vger.kernel.org/majordomo-info.html
I've tested it and for me it looks ok. For further development please
remember about frames with extension headers. It'll be also nice to
have specified frame sections/flags (e.g. control frame type, header
len).
BR,
Grzegorz
^ permalink raw reply [flat|nested] 6+ messages in thread
* RE: [PATCH] monitor: Add initial support for BNEP
2015-04-03 10:53 ` Grzegorz Kolodziejczyk
@ 2015-04-06 5:42 ` Gowtham Anandha Babu
2015-04-08 10:29 ` Gowtham Anandha Babu
0 siblings, 1 reply; 6+ messages in thread
From: Gowtham Anandha Babu @ 2015-04-06 5:42 UTC (permalink / raw)
To: 'Grzegorz Kolodziejczyk'
Cc: 'linux-bluetooth', bharat.panda, cpgs
Hi Grzegorz,
> -----Original Message-----
> From: linux-bluetooth-owner@vger.kernel.org [mailto:linux-bluetooth-
> owner@vger.kernel.org] On Behalf Of Grzegorz Kolodziejczyk
> Sent: Friday, April 03, 2015 4:23 PM
> To: Gowtham Anandha Babu
> Cc: linux-bluetooth; bharat.panda@samsung.com; cpgs@samsung.com
> Subject: Re: [PATCH] monitor: Add initial support for BNEP
>
> Hi Gowtham,
>
> On 2 April 2015 at 13:32, Gowtham Anandha Babu
> <gowtham.ab@samsung.com> wrote:
> >> ACL Data RX: Handle 71 flags 0x02 dlen 11
> [hci0] 17.739883
> > Channel: 64 len 7 [PSM 15 mode 0] {chan 0}
> > BNEP: Control (0x01|0)
> > 01 02 11 16 11 15 ......
> >
> >> ACL Data RX: Handle 71 flags 0x01 dlen 35
> [hci0] 175.293028
> > Channel: 64 len 1532 [PSM 15 mode 0] {chan 0}
> > BNEP: General Ethernet (0x00|1)
> > 00 00 00 00 00 00 00 00 00 00 00 00 08 00 00 0f ................
> > 05 00 0c 03 00 00 20 00 00 03 00 00 20 00 00 3c ...... .....
> > ..<
> >
> >> ACL Data RX: Handle 71 flags 0x01 dlen 12
> [hci0] 145.825018
> > Channel: 64 len 1509 [PSM 15 mode 0] {chan 0}
> > BNEP: Compressed Ethernet Dest Only (0x04|0)
> > 00 00 00 00 00 00 08 00 3c 3b 3a 39 38 37 36 35 ........<;:98765
> > 34 33 32 31 30 2f 2e 2d 2c 2b 2a 29 28 27 26 25
> > 43210/.-,+*)('&%
> > ---
> > Makefile.tools | 1 +
> > android/Android.mk | 1 +
> > monitor/bnep.c | 116
> +++++++++++++++++++++++++++++++++++++++++++++++++++++
> > monitor/bnep.h | 25 ++++++++++++
> > monitor/l2cap.c | 4 ++
> > 5 files changed, 147 insertions(+)
> > create mode 100644 monitor/bnep.c
> > create mode 100644 monitor/bnep.h
> >
> > diff --git a/Makefile.tools b/Makefile.tools index b8dd90a..b37b774
> > 100644
> > --- a/Makefile.tools
> > +++ b/Makefile.tools
> > @@ -28,6 +28,7 @@ monitor_btmon_SOURCES = monitor/main.c
> monitor/bt.h \
> > monitor/sdp.h monitor/sdp.c \
> > monitor/avctp.h monitor/avctp.c \
> > monitor/rfcomm.h monitor/rfcomm.c \
> > + monitor/bnep.h monitor/bnep.c \
> > monitor/uuid.h monitor/uuid.c \
> > monitor/hwdb.h monitor/hwdb.c \
> > monitor/keys.h monitor/keys.c \ diff
> > --git a/android/Android.mk b/android/Android.mk index f218805..880e3ba
> > 100644
> > --- a/android/Android.mk
> > +++ b/android/Android.mk
> > @@ -340,6 +340,7 @@ LOCAL_SRC_FILES := \
> > bluez/monitor/l2cap.c \
> > bluez/monitor/avctp.c \
> > bluez/monitor/rfcomm.c \
> > + bluez/monitor/bnep.c \
> > bluez/monitor/uuid.c \
> > bluez/monitor/sdp.c \
> > bluez/monitor/vendor.c \
> > diff --git a/monitor/bnep.c b/monitor/bnep.c new file mode 100644
> > index 0000000..1450f85
> > --- /dev/null
> > +++ b/monitor/bnep.c
> > @@ -0,0 +1,116 @@
> > +/*
> > + *
> > + * BlueZ - Bluetooth protocol stack for Linux
> > + *
> > + * Copyright (C) 2011-2014 Intel Corporation
> > + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
> > + *
> > + *
> > + * This library is free software; you can redistribute it and/or
> > + * modify it under the terms of the GNU Lesser General Public
> > + * License as published by the Free Software Foundation; either
> > + * version 2.1 of the License, or (at your option) any later version.
> > + *
> > + * This library is distributed in the hope that it will be useful,
> > + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
> GNU
> > + * Lesser General Public License for more details.
> > + *
> > + * You should have received a copy of the GNU Lesser General Public
> > + * License along with this library; if not, write to the Free
> > +Software
> > + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
> > +02110-1301 USA
> > + *
> > + */
> > +
> > +#ifdef HAVE_CONFIG_H
> > +#include <config.h>
> > +#endif
> > +
> > +#include <stdio.h>
> > +#include <stdlib.h>
> > +#include <string.h>
> > +#include <ctype.h>
> > +#include <inttypes.h>
> > +
> > +#include "lib/bluetooth.h"
> > +
> > +#include "src/shared/util.h"
> > +#include "bt.h"
> > +#include "packet.h"
> > +#include "display.h"
> > +#include "l2cap.h"
> > +#include "uuid.h"
> > +#include "keys.h"
> > +#include "sdp.h"
> > +#include "bnep.h"
> > +
> > +#define GET_PKT_TYPE(type) (type & 0x7f) #define
> GET_EXTENSION(type)
> > +(type & 0x80)
> > +
> > +struct bnep_frame {
> > + uint8_t type;
> > + int extension;
> > + struct l2cap_frame l2cap_frame; };
> > +
> > +struct bnep_data {
> > + uint8_t type;
> > + const char *str;
> > +};
> > +
> > +static const struct bnep_data bnep_table[] = {
> > + { 0x00, "General Ethernet"},
> > + { 0x01, "Control"},
> > + { 0x02, "Compressed Ethernet"},
> > + { 0x03, "Compressed Ethernet Src Only"},
> > + { 0x04, "Compressed Ethernet Dest Only"},
> > + { }
> > +};
> > +
> > +void bnep_packet(const struct l2cap_frame *frame) {
> > + uint8_t type;
> > + struct bnep_frame bnep_frame;
> > + struct l2cap_frame *l2cap_frame;
> > + const struct bnep_data *bnep_data = NULL;
> > + const char *pdu_color, *pdu_str;
> > + int i;
> > +
> > + l2cap_frame_pull(&bnep_frame.l2cap_frame, frame, 0);
> > + l2cap_frame = &bnep_frame.l2cap_frame;
> > +
> > + if (!l2cap_frame_get_u8(l2cap_frame, &type))
> > + goto fail;
> > +
> > + bnep_frame.extension = GET_EXTENSION(type);
> > + bnep_frame.type = GET_PKT_TYPE(type);
> > +
> > + for (i = 0; bnep_table[i].str; i++) {
> > + if (bnep_table[i].type == bnep_frame.type) {
> > + bnep_data = &bnep_table[i];
> > + break;
> > + }
> > + }
> > +
> > + if (bnep_data) {
> > + if (frame->in)
> > + pdu_color = COLOR_MAGENTA;
> > + else
> > + pdu_color = COLOR_BLUE;
> > + pdu_str = bnep_data->str;
> > + } else {
> > + pdu_color = COLOR_WHITE_BG;
> > + pdu_str = "Unknown packet type";
> > + }
> > +
> > + print_indent(6, pdu_color, "BNEP: ", pdu_str, COLOR_OFF,
> > + " (0x%02x|%s)", bnep_frame.type,
> > + bnep_frame.extension ? "1" : "0");
> > +
> > + packet_hexdump(l2cap_frame->data, l2cap_frame->size);
> > + return;
> > +
> > +fail:
> > + print_text(COLOR_ERROR, "frame too short");
> > + packet_hexdump(frame->data, frame->size); }
> > diff --git a/monitor/bnep.h b/monitor/bnep.h new file mode 100644
> > index 0000000..38340d6
> > --- /dev/null
> > +++ b/monitor/bnep.h
> > @@ -0,0 +1,25 @@
> > +/*
> > + *
> > + * BlueZ - Bluetooth protocol stack for Linux
> > + *
> > + * Copyright (C) 2011-2014 Intel Corporation
> > + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
> > + *
> > + *
> > + * This library is free software; you can redistribute it and/or
> > + * modify it under the terms of the GNU Lesser General Public
> > + * License as published by the Free Software Foundation; either
> > + * version 2.1 of the License, or (at your option) any later version.
> > + *
> > + * This library is distributed in the hope that it will be useful,
> > + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
> GNU
> > + * Lesser General Public License for more details.
> > + *
> > + * You should have received a copy of the GNU Lesser General Public
> > + * License along with this library; if not, write to the Free
> > +Software
> > + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
> > +02110-1301 USA
> > + *
> > + */
> > +
> > +void bnep_packet(const struct l2cap_frame *frame);
> > diff --git a/monitor/l2cap.c b/monitor/l2cap.c index 5faa26f..fc565b1
> > 100644
> > --- a/monitor/l2cap.c
> > +++ b/monitor/l2cap.c
> > @@ -43,6 +43,7 @@
> > #include "sdp.h"
> > #include "avctp.h"
> > #include "rfcomm.h"
> > +#include "bnep.h"
> >
> > /* L2CAP Control Field bit masks */
> > #define L2CAP_CTRL_SAR_MASK 0xC000
> > @@ -2951,6 +2952,9 @@ static void l2cap_frame(uint16_t index, bool in,
> uint16_t handle,
> > case 0x0003:
> > rfcomm_packet(&frame);
> > break;
> > + case 0x000f:
> > + bnep_packet(&frame);
> > + break;
> > case 0x001f:
> > att_packet(index, in, handle, cid, data, size);
> > break;
> > --
> > 1.9.1
> >
> > --
> > To unsubscribe from this list: send the line "unsubscribe
> > linux-bluetooth" in the body of a message to majordomo@vger.kernel.org
> > More majordomo info at http://vger.kernel.org/majordomo-info.html
>
> I've tested it and for me it looks ok. For further development please
> remember about frames with extension headers. It'll be also nice to have
> specified frame sections/flags (e.g. control frame type, header len).
>
Thanks for testing. I am planning to do in that way.
In the next set, all the BNEP packet type listed above will be handled.
Then only the extended headers will be handled.
Btw, complete support to handle the extended headers in kernel is done or yet to be completed?
Regards,
Gowtham Anandha Babu
> BR,
> Grzegorz
> --
> To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
> the body of a message to majordomo@vger.kernel.org More majordomo
> info at http://vger.kernel.org/majordomo-info.html
^ permalink raw reply [flat|nested] 6+ messages in thread
* RE: [PATCH] monitor: Add initial support for BNEP
2015-04-06 5:42 ` Gowtham Anandha Babu
@ 2015-04-08 10:29 ` Gowtham Anandha Babu
2015-04-08 12:14 ` Grzegorz Kolodziejczyk
0 siblings, 1 reply; 6+ messages in thread
From: Gowtham Anandha Babu @ 2015-04-08 10:29 UTC (permalink / raw)
To: 'linux-bluetooth'
Ping.
> -----Original Message-----
> From: linux-bluetooth-owner@vger.kernel.org [mailto:linux-bluetooth-
> owner@vger.kernel.org] On Behalf Of Gowtham Anandha Babu
> Sent: Monday, April 06, 2015 11:13 AM
> To: 'Grzegorz Kolodziejczyk'
> Cc: 'linux-bluetooth'; bharat.panda@samsung.com; cpgs@samsung.com
> Subject: RE: [PATCH] monitor: Add initial support for BNEP
>
> Hi Grzegorz,
>
> > -----Original Message-----
> > From: linux-bluetooth-owner@vger.kernel.org [mailto:linux-bluetooth-
> > owner@vger.kernel.org] On Behalf Of Grzegorz Kolodziejczyk
> > Sent: Friday, April 03, 2015 4:23 PM
> > To: Gowtham Anandha Babu
> > Cc: linux-bluetooth; bharat.panda@samsung.com; cpgs@samsung.com
> > Subject: Re: [PATCH] monitor: Add initial support for BNEP
> >
> > Hi Gowtham,
> >
> > On 2 April 2015 at 13:32, Gowtham Anandha Babu
> > <gowtham.ab@samsung.com> wrote:
> > >> ACL Data RX: Handle 71 flags 0x02 dlen 11
> > [hci0] 17.739883
> > > Channel: 64 len 7 [PSM 15 mode 0] {chan 0}
> > > BNEP: Control (0x01|0)
> > > 01 02 11 16 11 15 ......
> > >
> > >> ACL Data RX: Handle 71 flags 0x01 dlen 35
> > [hci0] 175.293028
> > > Channel: 64 len 1532 [PSM 15 mode 0] {chan 0}
> > > BNEP: General Ethernet (0x00|1)
> > > 00 00 00 00 00 00 00 00 00 00 00 00 08 00 00 0f ................
> > > 05 00 0c 03 00 00 20 00 00 03 00 00 20 00 00 3c ...... .....
> > > ..<
> > >
> > >> ACL Data RX: Handle 71 flags 0x01 dlen 12
> > [hci0] 145.825018
> > > Channel: 64 len 1509 [PSM 15 mode 0] {chan 0}
> > > BNEP: Compressed Ethernet Dest Only (0x04|0)
> > > 00 00 00 00 00 00 08 00 3c 3b 3a 39 38 37 36 35 ........<;:98765
> > > 34 33 32 31 30 2f 2e 2d 2c 2b 2a 29 28 27 26 25
> > > 43210/.-,+*)('&%
> > > ---
> > > Makefile.tools | 1 +
> > > android/Android.mk | 1 +
> > > monitor/bnep.c | 116
> > +++++++++++++++++++++++++++++++++++++++++++++++++++++
> > > monitor/bnep.h | 25 ++++++++++++
> > > monitor/l2cap.c | 4 ++
> > > 5 files changed, 147 insertions(+)
> > > create mode 100644 monitor/bnep.c
> > > create mode 100644 monitor/bnep.h
> > >
> > > diff --git a/Makefile.tools b/Makefile.tools index b8dd90a..b37b774
> > > 100644
> > > --- a/Makefile.tools
> > > +++ b/Makefile.tools
> > > @@ -28,6 +28,7 @@ monitor_btmon_SOURCES = monitor/main.c
> > monitor/bt.h \
> > > monitor/sdp.h monitor/sdp.c \
> > > monitor/avctp.h monitor/avctp.c \
> > > monitor/rfcomm.h monitor/rfcomm.c \
> > > + monitor/bnep.h monitor/bnep.c \
> > > monitor/uuid.h monitor/uuid.c \
> > > monitor/hwdb.h monitor/hwdb.c \
> > > monitor/keys.h monitor/keys.c \ diff
> > > --git a/android/Android.mk b/android/Android.mk index
> > > f218805..880e3ba
> > > 100644
> > > --- a/android/Android.mk
> > > +++ b/android/Android.mk
> > > @@ -340,6 +340,7 @@ LOCAL_SRC_FILES := \
> > > bluez/monitor/l2cap.c \
> > > bluez/monitor/avctp.c \
> > > bluez/monitor/rfcomm.c \
> > > + bluez/monitor/bnep.c \
> > > bluez/monitor/uuid.c \
> > > bluez/monitor/sdp.c \
> > > bluez/monitor/vendor.c \
> > > diff --git a/monitor/bnep.c b/monitor/bnep.c new file mode 100644
> > > index 0000000..1450f85
> > > --- /dev/null
> > > +++ b/monitor/bnep.c
> > > @@ -0,0 +1,116 @@
> > > +/*
> > > + *
> > > + * BlueZ - Bluetooth protocol stack for Linux
> > > + *
> > > + * Copyright (C) 2011-2014 Intel Corporation
> > > + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
> > > + *
> > > + *
> > > + * This library is free software; you can redistribute it and/or
> > > + * modify it under the terms of the GNU Lesser General Public
> > > + * License as published by the Free Software Foundation; either
> > > + * version 2.1 of the License, or (at your option) any later version.
> > > + *
> > > + * This library is distributed in the hope that it will be useful,
> > > + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> > > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
> > GNU
> > > + * Lesser General Public License for more details.
> > > + *
> > > + * You should have received a copy of the GNU Lesser General
> > > +Public
> > > + * License along with this library; if not, write to the Free
> > > +Software
> > > + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
> > > +02110-1301 USA
> > > + *
> > > + */
> > > +
> > > +#ifdef HAVE_CONFIG_H
> > > +#include <config.h>
> > > +#endif
> > > +
> > > +#include <stdio.h>
> > > +#include <stdlib.h>
> > > +#include <string.h>
> > > +#include <ctype.h>
> > > +#include <inttypes.h>
> > > +
> > > +#include "lib/bluetooth.h"
> > > +
> > > +#include "src/shared/util.h"
> > > +#include "bt.h"
> > > +#include "packet.h"
> > > +#include "display.h"
> > > +#include "l2cap.h"
> > > +#include "uuid.h"
> > > +#include "keys.h"
> > > +#include "sdp.h"
> > > +#include "bnep.h"
> > > +
> > > +#define GET_PKT_TYPE(type) (type & 0x7f) #define
> > GET_EXTENSION(type)
> > > +(type & 0x80)
> > > +
> > > +struct bnep_frame {
> > > + uint8_t type;
> > > + int extension;
> > > + struct l2cap_frame l2cap_frame; };
> > > +
> > > +struct bnep_data {
> > > + uint8_t type;
> > > + const char *str;
> > > +};
> > > +
> > > +static const struct bnep_data bnep_table[] = {
> > > + { 0x00, "General Ethernet"},
> > > + { 0x01, "Control"},
> > > + { 0x02, "Compressed Ethernet"},
> > > + { 0x03, "Compressed Ethernet Src Only"},
> > > + { 0x04, "Compressed Ethernet Dest Only"},
> > > + { }
> > > +};
> > > +
> > > +void bnep_packet(const struct l2cap_frame *frame) {
> > > + uint8_t type;
> > > + struct bnep_frame bnep_frame;
> > > + struct l2cap_frame *l2cap_frame;
> > > + const struct bnep_data *bnep_data = NULL;
> > > + const char *pdu_color, *pdu_str;
> > > + int i;
> > > +
> > > + l2cap_frame_pull(&bnep_frame.l2cap_frame, frame, 0);
> > > + l2cap_frame = &bnep_frame.l2cap_frame;
> > > +
> > > + if (!l2cap_frame_get_u8(l2cap_frame, &type))
> > > + goto fail;
> > > +
> > > + bnep_frame.extension = GET_EXTENSION(type);
> > > + bnep_frame.type = GET_PKT_TYPE(type);
> > > +
> > > + for (i = 0; bnep_table[i].str; i++) {
> > > + if (bnep_table[i].type == bnep_frame.type) {
> > > + bnep_data = &bnep_table[i];
> > > + break;
> > > + }
> > > + }
> > > +
> > > + if (bnep_data) {
> > > + if (frame->in)
> > > + pdu_color = COLOR_MAGENTA;
> > > + else
> > > + pdu_color = COLOR_BLUE;
> > > + pdu_str = bnep_data->str;
> > > + } else {
> > > + pdu_color = COLOR_WHITE_BG;
> > > + pdu_str = "Unknown packet type";
> > > + }
> > > +
> > > + print_indent(6, pdu_color, "BNEP: ", pdu_str, COLOR_OFF,
> > > + " (0x%02x|%s)", bnep_frame.type,
> > > + bnep_frame.extension ? "1" : "0");
> > > +
> > > + packet_hexdump(l2cap_frame->data, l2cap_frame->size);
> > > + return;
> > > +
> > > +fail:
> > > + print_text(COLOR_ERROR, "frame too short");
> > > + packet_hexdump(frame->data, frame->size); }
> > > diff --git a/monitor/bnep.h b/monitor/bnep.h new file mode 100644
> > > index 0000000..38340d6
> > > --- /dev/null
> > > +++ b/monitor/bnep.h
> > > @@ -0,0 +1,25 @@
> > > +/*
> > > + *
> > > + * BlueZ - Bluetooth protocol stack for Linux
> > > + *
> > > + * Copyright (C) 2011-2014 Intel Corporation
> > > + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
> > > + *
> > > + *
> > > + * This library is free software; you can redistribute it and/or
> > > + * modify it under the terms of the GNU Lesser General Public
> > > + * License as published by the Free Software Foundation; either
> > > + * version 2.1 of the License, or (at your option) any later version.
> > > + *
> > > + * This library is distributed in the hope that it will be useful,
> > > + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> > > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
> > GNU
> > > + * Lesser General Public License for more details.
> > > + *
> > > + * You should have received a copy of the GNU Lesser General
> > > +Public
> > > + * License along with this library; if not, write to the Free
> > > +Software
> > > + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
> > > +02110-1301 USA
> > > + *
> > > + */
> > > +
> > > +void bnep_packet(const struct l2cap_frame *frame);
> > > diff --git a/monitor/l2cap.c b/monitor/l2cap.c index
> > > 5faa26f..fc565b1
> > > 100644
> > > --- a/monitor/l2cap.c
> > > +++ b/monitor/l2cap.c
> > > @@ -43,6 +43,7 @@
> > > #include "sdp.h"
> > > #include "avctp.h"
> > > #include "rfcomm.h"
> > > +#include "bnep.h"
> > >
> > > /* L2CAP Control Field bit masks */
> > > #define L2CAP_CTRL_SAR_MASK 0xC000
> > > @@ -2951,6 +2952,9 @@ static void l2cap_frame(uint16_t index, bool
> > > in,
> > uint16_t handle,
> > > case 0x0003:
> > > rfcomm_packet(&frame);
> > > break;
> > > + case 0x000f:
> > > + bnep_packet(&frame);
> > > + break;
> > > case 0x001f:
> > > att_packet(index, in, handle, cid, data, size);
> > > break;
> > > --
> > > 1.9.1
> > >
> > > --
> > > To unsubscribe from this list: send the line "unsubscribe
> > > linux-bluetooth" in the body of a message to
> > > majordomo@vger.kernel.org More majordomo info at
> > > http://vger.kernel.org/majordomo-info.html
> >
> > I've tested it and for me it looks ok. For further development please
> > remember about frames with extension headers. It'll be also nice to
> > have specified frame sections/flags (e.g. control frame type, header len).
> >
>
> Thanks for testing. I am planning to do in that way.
> In the next set, all the BNEP packet type listed above will be handled.
> Then only the extended headers will be handled.
> Btw, complete support to handle the extended headers in kernel is done or
> yet to be completed?
>
> Regards,
> Gowtham Anandha Babu
>
> > BR,
> > Grzegorz
> > --
> > To unsubscribe from this list: send the line "unsubscribe
> > linux-bluetooth" in the body of a message to majordomo@vger.kernel.org
> > More majordomo info at http://vger.kernel.org/majordomo-info.html
>
> --
> To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
> the body of a message to majordomo@vger.kernel.org More majordomo
> info at http://vger.kernel.org/majordomo-info.html
^ permalink raw reply [flat|nested] 6+ messages in thread
* Re: [PATCH] monitor: Add initial support for BNEP
2015-04-08 10:29 ` Gowtham Anandha Babu
@ 2015-04-08 12:14 ` Grzegorz Kolodziejczyk
2015-04-10 14:26 ` Luiz Augusto von Dentz
0 siblings, 1 reply; 6+ messages in thread
From: Grzegorz Kolodziejczyk @ 2015-04-08 12:14 UTC (permalink / raw)
To: Gowtham Anandha Babu; +Cc: linux-bluetooth
Hi Gowtham,
On 8 April 2015 at 12:29, Gowtham Anandha Babu <gowtham.ab@samsung.com> wrote:
> Ping.
>
>> -----Original Message-----
>> From: linux-bluetooth-owner@vger.kernel.org [mailto:linux-bluetooth-
>> owner@vger.kernel.org] On Behalf Of Gowtham Anandha Babu
>> Sent: Monday, April 06, 2015 11:13 AM
>> To: 'Grzegorz Kolodziejczyk'
>> Cc: 'linux-bluetooth'; bharat.panda@samsung.com; cpgs@samsung.com
>> Subject: RE: [PATCH] monitor: Add initial support for BNEP
>>
>> Hi Grzegorz,
>>
>> > -----Original Message-----
>> > From: linux-bluetooth-owner@vger.kernel.org [mailto:linux-bluetooth-
>> > owner@vger.kernel.org] On Behalf Of Grzegorz Kolodziejczyk
>> > Sent: Friday, April 03, 2015 4:23 PM
>> > To: Gowtham Anandha Babu
>> > Cc: linux-bluetooth; bharat.panda@samsung.com; cpgs@samsung.com
>> > Subject: Re: [PATCH] monitor: Add initial support for BNEP
>> >
>> > Hi Gowtham,
>> >
>> > On 2 April 2015 at 13:32, Gowtham Anandha Babu
>> > <gowtham.ab@samsung.com> wrote:
>> > >> ACL Data RX: Handle 71 flags 0x02 dlen 11
>> > [hci0] 17.739883
>> > > Channel: 64 len 7 [PSM 15 mode 0] {chan 0}
>> > > BNEP: Control (0x01|0)
>> > > 01 02 11 16 11 15 ......
>> > >
>> > >> ACL Data RX: Handle 71 flags 0x01 dlen 35
>> > [hci0] 175.293028
>> > > Channel: 64 len 1532 [PSM 15 mode 0] {chan 0}
>> > > BNEP: General Ethernet (0x00|1)
>> > > 00 00 00 00 00 00 00 00 00 00 00 00 08 00 00 0f ................
>> > > 05 00 0c 03 00 00 20 00 00 03 00 00 20 00 00 3c ...... .....
>> > > ..<
>> > >
>> > >> ACL Data RX: Handle 71 flags 0x01 dlen 12
>> > [hci0] 145.825018
>> > > Channel: 64 len 1509 [PSM 15 mode 0] {chan 0}
>> > > BNEP: Compressed Ethernet Dest Only (0x04|0)
>> > > 00 00 00 00 00 00 08 00 3c 3b 3a 39 38 37 36 35 ........<;:98765
>> > > 34 33 32 31 30 2f 2e 2d 2c 2b 2a 29 28 27 26 25
>> > > 43210/.-,+*)('&%
>> > > ---
>> > > Makefile.tools | 1 +
>> > > android/Android.mk | 1 +
>> > > monitor/bnep.c | 116
>> > +++++++++++++++++++++++++++++++++++++++++++++++++++++
>> > > monitor/bnep.h | 25 ++++++++++++
>> > > monitor/l2cap.c | 4 ++
>> > > 5 files changed, 147 insertions(+)
>> > > create mode 100644 monitor/bnep.c
>> > > create mode 100644 monitor/bnep.h
>> > >
>> > > diff --git a/Makefile.tools b/Makefile.tools index b8dd90a..b37b774
>> > > 100644
>> > > --- a/Makefile.tools
>> > > +++ b/Makefile.tools
>> > > @@ -28,6 +28,7 @@ monitor_btmon_SOURCES = monitor/main.c
>> > monitor/bt.h \
>> > > monitor/sdp.h monitor/sdp.c \
>> > > monitor/avctp.h monitor/avctp.c \
>> > > monitor/rfcomm.h monitor/rfcomm.c \
>> > > + monitor/bnep.h monitor/bnep.c \
>> > > monitor/uuid.h monitor/uuid.c \
>> > > monitor/hwdb.h monitor/hwdb.c \
>> > > monitor/keys.h monitor/keys.c \ diff
>> > > --git a/android/Android.mk b/android/Android.mk index
>> > > f218805..880e3ba
>> > > 100644
>> > > --- a/android/Android.mk
>> > > +++ b/android/Android.mk
>> > > @@ -340,6 +340,7 @@ LOCAL_SRC_FILES := \
>> > > bluez/monitor/l2cap.c \
>> > > bluez/monitor/avctp.c \
>> > > bluez/monitor/rfcomm.c \
>> > > + bluez/monitor/bnep.c \
>> > > bluez/monitor/uuid.c \
>> > > bluez/monitor/sdp.c \
>> > > bluez/monitor/vendor.c \
>> > > diff --git a/monitor/bnep.c b/monitor/bnep.c new file mode 100644
>> > > index 0000000..1450f85
>> > > --- /dev/null
>> > > +++ b/monitor/bnep.c
>> > > @@ -0,0 +1,116 @@
>> > > +/*
>> > > + *
>> > > + * BlueZ - Bluetooth protocol stack for Linux
>> > > + *
>> > > + * Copyright (C) 2011-2014 Intel Corporation
>> > > + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
>> > > + *
>> > > + *
>> > > + * This library is free software; you can redistribute it and/or
>> > > + * modify it under the terms of the GNU Lesser General Public
>> > > + * License as published by the Free Software Foundation; either
>> > > + * version 2.1 of the License, or (at your option) any later version.
>> > > + *
>> > > + * This library is distributed in the hope that it will be useful,
>> > > + * but WITHOUT ANY WARRANTY; without even the implied warranty of
>> > > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
>> > GNU
>> > > + * Lesser General Public License for more details.
>> > > + *
>> > > + * You should have received a copy of the GNU Lesser General
>> > > +Public
>> > > + * License along with this library; if not, write to the Free
>> > > +Software
>> > > + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
>> > > +02110-1301 USA
>> > > + *
>> > > + */
>> > > +
>> > > +#ifdef HAVE_CONFIG_H
>> > > +#include <config.h>
>> > > +#endif
>> > > +
>> > > +#include <stdio.h>
>> > > +#include <stdlib.h>
>> > > +#include <string.h>
>> > > +#include <ctype.h>
>> > > +#include <inttypes.h>
>> > > +
>> > > +#include "lib/bluetooth.h"
>> > > +
>> > > +#include "src/shared/util.h"
>> > > +#include "bt.h"
>> > > +#include "packet.h"
>> > > +#include "display.h"
>> > > +#include "l2cap.h"
>> > > +#include "uuid.h"
>> > > +#include "keys.h"
>> > > +#include "sdp.h"
>> > > +#include "bnep.h"
>> > > +
>> > > +#define GET_PKT_TYPE(type) (type & 0x7f) #define
>> > GET_EXTENSION(type)
>> > > +(type & 0x80)
>> > > +
>> > > +struct bnep_frame {
>> > > + uint8_t type;
>> > > + int extension;
>> > > + struct l2cap_frame l2cap_frame; };
>> > > +
>> > > +struct bnep_data {
>> > > + uint8_t type;
>> > > + const char *str;
>> > > +};
>> > > +
>> > > +static const struct bnep_data bnep_table[] = {
>> > > + { 0x00, "General Ethernet"},
>> > > + { 0x01, "Control"},
>> > > + { 0x02, "Compressed Ethernet"},
>> > > + { 0x03, "Compressed Ethernet Src Only"},
>> > > + { 0x04, "Compressed Ethernet Dest Only"},
>> > > + { }
>> > > +};
>> > > +
>> > > +void bnep_packet(const struct l2cap_frame *frame) {
>> > > + uint8_t type;
>> > > + struct bnep_frame bnep_frame;
>> > > + struct l2cap_frame *l2cap_frame;
>> > > + const struct bnep_data *bnep_data = NULL;
>> > > + const char *pdu_color, *pdu_str;
>> > > + int i;
>> > > +
>> > > + l2cap_frame_pull(&bnep_frame.l2cap_frame, frame, 0);
>> > > + l2cap_frame = &bnep_frame.l2cap_frame;
>> > > +
>> > > + if (!l2cap_frame_get_u8(l2cap_frame, &type))
>> > > + goto fail;
>> > > +
>> > > + bnep_frame.extension = GET_EXTENSION(type);
>> > > + bnep_frame.type = GET_PKT_TYPE(type);
>> > > +
>> > > + for (i = 0; bnep_table[i].str; i++) {
>> > > + if (bnep_table[i].type == bnep_frame.type) {
>> > > + bnep_data = &bnep_table[i];
>> > > + break;
>> > > + }
>> > > + }
>> > > +
>> > > + if (bnep_data) {
>> > > + if (frame->in)
>> > > + pdu_color = COLOR_MAGENTA;
>> > > + else
>> > > + pdu_color = COLOR_BLUE;
>> > > + pdu_str = bnep_data->str;
>> > > + } else {
>> > > + pdu_color = COLOR_WHITE_BG;
>> > > + pdu_str = "Unknown packet type";
>> > > + }
>> > > +
>> > > + print_indent(6, pdu_color, "BNEP: ", pdu_str, COLOR_OFF,
>> > > + " (0x%02x|%s)", bnep_frame.type,
>> > > + bnep_frame.extension ? "1" : "0");
>> > > +
>> > > + packet_hexdump(l2cap_frame->data, l2cap_frame->size);
>> > > + return;
>> > > +
>> > > +fail:
>> > > + print_text(COLOR_ERROR, "frame too short");
>> > > + packet_hexdump(frame->data, frame->size); }
>> > > diff --git a/monitor/bnep.h b/monitor/bnep.h new file mode 100644
>> > > index 0000000..38340d6
>> > > --- /dev/null
>> > > +++ b/monitor/bnep.h
>> > > @@ -0,0 +1,25 @@
>> > > +/*
>> > > + *
>> > > + * BlueZ - Bluetooth protocol stack for Linux
>> > > + *
>> > > + * Copyright (C) 2011-2014 Intel Corporation
>> > > + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
>> > > + *
>> > > + *
>> > > + * This library is free software; you can redistribute it and/or
>> > > + * modify it under the terms of the GNU Lesser General Public
>> > > + * License as published by the Free Software Foundation; either
>> > > + * version 2.1 of the License, or (at your option) any later version.
>> > > + *
>> > > + * This library is distributed in the hope that it will be useful,
>> > > + * but WITHOUT ANY WARRANTY; without even the implied warranty of
>> > > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
>> > GNU
>> > > + * Lesser General Public License for more details.
>> > > + *
>> > > + * You should have received a copy of the GNU Lesser General
>> > > +Public
>> > > + * License along with this library; if not, write to the Free
>> > > +Software
>> > > + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
>> > > +02110-1301 USA
>> > > + *
>> > > + */
>> > > +
>> > > +void bnep_packet(const struct l2cap_frame *frame);
>> > > diff --git a/monitor/l2cap.c b/monitor/l2cap.c index
>> > > 5faa26f..fc565b1
>> > > 100644
>> > > --- a/monitor/l2cap.c
>> > > +++ b/monitor/l2cap.c
>> > > @@ -43,6 +43,7 @@
>> > > #include "sdp.h"
>> > > #include "avctp.h"
>> > > #include "rfcomm.h"
>> > > +#include "bnep.h"
>> > >
>> > > /* L2CAP Control Field bit masks */
>> > > #define L2CAP_CTRL_SAR_MASK 0xC000
>> > > @@ -2951,6 +2952,9 @@ static void l2cap_frame(uint16_t index, bool
>> > > in,
>> > uint16_t handle,
>> > > case 0x0003:
>> > > rfcomm_packet(&frame);
>> > > break;
>> > > + case 0x000f:
>> > > + bnep_packet(&frame);
>> > > + break;
>> > > case 0x001f:
>> > > att_packet(index, in, handle, cid, data, size);
>> > > break;
>> > > --
>> > > 1.9.1
>> > >
>> > > --
>> > > To unsubscribe from this list: send the line "unsubscribe
>> > > linux-bluetooth" in the body of a message to
>> > > majordomo@vger.kernel.org More majordomo info at
>> > > http://vger.kernel.org/majordomo-info.html
>> >
>> > I've tested it and for me it looks ok. For further development please
>> > remember about frames with extension headers. It'll be also nice to
>> > have specified frame sections/flags (e.g. control frame type, header len).
>> >
>>
>> Thanks for testing. I am planning to do in that way.
>> In the next set, all the BNEP packet type listed above will be handled.
Good to know.
>> Then only the extended headers will be handled.
>> Btw, complete support to handle the extended headers in kernel is done or
>> yet to be completed?
>>
Yes, now it is supported, latest bluetooth-next supports it.
>> Regards,
>> Gowtham Anandha Babu
>>
>> > BR,
>> > Grzegorz
>> > --
>> > To unsubscribe from this list: send the line "unsubscribe
>> > linux-bluetooth" in the body of a message to majordomo@vger.kernel.org
>> > More majordomo info at http://vger.kernel.org/majordomo-info.html
>>
>> --
>> To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
>> the body of a message to majordomo@vger.kernel.org More majordomo
>> info at http://vger.kernel.org/majordomo-info.html
>
> --
> To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
> the body of a message to majordomo@vger.kernel.org
> More majordomo info at http://vger.kernel.org/majordomo-info.html
Best regards,
Grzegorz
^ permalink raw reply [flat|nested] 6+ messages in thread
* Re: [PATCH] monitor: Add initial support for BNEP
2015-04-08 12:14 ` Grzegorz Kolodziejczyk
@ 2015-04-10 14:26 ` Luiz Augusto von Dentz
0 siblings, 0 replies; 6+ messages in thread
From: Luiz Augusto von Dentz @ 2015-04-10 14:26 UTC (permalink / raw)
To: Grzegorz Kolodziejczyk; +Cc: Gowtham Anandha Babu, linux-bluetooth
Hi Gowtham,
On Wed, Apr 8, 2015 at 3:14 PM, Grzegorz Kolodziejczyk
<grzegorz.kolodziejczyk@tieto.com> wrote:
> Hi Gowtham,
>
>
>
> On 8 April 2015 at 12:29, Gowtham Anandha Babu <gowtham.ab@samsung.com> wrote:
>> Ping.
>>
>>> -----Original Message-----
>>> From: linux-bluetooth-owner@vger.kernel.org [mailto:linux-bluetooth-
>>> owner@vger.kernel.org] On Behalf Of Gowtham Anandha Babu
>>> Sent: Monday, April 06, 2015 11:13 AM
>>> To: 'Grzegorz Kolodziejczyk'
>>> Cc: 'linux-bluetooth'; bharat.panda@samsung.com; cpgs@samsung.com
>>> Subject: RE: [PATCH] monitor: Add initial support for BNEP
>>>
>>> Hi Grzegorz,
>>>
>>> > -----Original Message-----
>>> > From: linux-bluetooth-owner@vger.kernel.org [mailto:linux-bluetooth-
>>> > owner@vger.kernel.org] On Behalf Of Grzegorz Kolodziejczyk
>>> > Sent: Friday, April 03, 2015 4:23 PM
>>> > To: Gowtham Anandha Babu
>>> > Cc: linux-bluetooth; bharat.panda@samsung.com; cpgs@samsung.com
>>> > Subject: Re: [PATCH] monitor: Add initial support for BNEP
>>> >
>>> > Hi Gowtham,
>>> >
>>> > On 2 April 2015 at 13:32, Gowtham Anandha Babu
>>> > <gowtham.ab@samsung.com> wrote:
>>> > >> ACL Data RX: Handle 71 flags 0x02 dlen 11
>>> > [hci0] 17.739883
>>> > > Channel: 64 len 7 [PSM 15 mode 0] {chan 0}
>>> > > BNEP: Control (0x01|0)
>>> > > 01 02 11 16 11 15 ......
>>> > >
>>> > >> ACL Data RX: Handle 71 flags 0x01 dlen 35
>>> > [hci0] 175.293028
>>> > > Channel: 64 len 1532 [PSM 15 mode 0] {chan 0}
>>> > > BNEP: General Ethernet (0x00|1)
>>> > > 00 00 00 00 00 00 00 00 00 00 00 00 08 00 00 0f ................
>>> > > 05 00 0c 03 00 00 20 00 00 03 00 00 20 00 00 3c ...... .....
>>> > > ..<
>>> > >
>>> > >> ACL Data RX: Handle 71 flags 0x01 dlen 12
>>> > [hci0] 145.825018
>>> > > Channel: 64 len 1509 [PSM 15 mode 0] {chan 0}
>>> > > BNEP: Compressed Ethernet Dest Only (0x04|0)
>>> > > 00 00 00 00 00 00 08 00 3c 3b 3a 39 38 37 36 35 ........<;:98765
>>> > > 34 33 32 31 30 2f 2e 2d 2c 2b 2a 29 28 27 26 25
>>> > > 43210/.-,+*)('&%
>>> > > ---
>>> > > Makefile.tools | 1 +
>>> > > android/Android.mk | 1 +
>>> > > monitor/bnep.c | 116
>>> > +++++++++++++++++++++++++++++++++++++++++++++++++++++
>>> > > monitor/bnep.h | 25 ++++++++++++
>>> > > monitor/l2cap.c | 4 ++
>>> > > 5 files changed, 147 insertions(+)
>>> > > create mode 100644 monitor/bnep.c
>>> > > create mode 100644 monitor/bnep.h
>>> > >
>>> > > diff --git a/Makefile.tools b/Makefile.tools index b8dd90a..b37b774
>>> > > 100644
>>> > > --- a/Makefile.tools
>>> > > +++ b/Makefile.tools
>>> > > @@ -28,6 +28,7 @@ monitor_btmon_SOURCES = monitor/main.c
>>> > monitor/bt.h \
>>> > > monitor/sdp.h monitor/sdp.c \
>>> > > monitor/avctp.h monitor/avctp.c \
>>> > > monitor/rfcomm.h monitor/rfcomm.c \
>>> > > + monitor/bnep.h monitor/bnep.c \
>>> > > monitor/uuid.h monitor/uuid.c \
>>> > > monitor/hwdb.h monitor/hwdb.c \
>>> > > monitor/keys.h monitor/keys.c \ diff
>>> > > --git a/android/Android.mk b/android/Android.mk index
>>> > > f218805..880e3ba
>>> > > 100644
>>> > > --- a/android/Android.mk
>>> > > +++ b/android/Android.mk
>>> > > @@ -340,6 +340,7 @@ LOCAL_SRC_FILES := \
>>> > > bluez/monitor/l2cap.c \
>>> > > bluez/monitor/avctp.c \
>>> > > bluez/monitor/rfcomm.c \
>>> > > + bluez/monitor/bnep.c \
>>> > > bluez/monitor/uuid.c \
>>> > > bluez/monitor/sdp.c \
>>> > > bluez/monitor/vendor.c \
>>> > > diff --git a/monitor/bnep.c b/monitor/bnep.c new file mode 100644
>>> > > index 0000000..1450f85
>>> > > --- /dev/null
>>> > > +++ b/monitor/bnep.c
>>> > > @@ -0,0 +1,116 @@
>>> > > +/*
>>> > > + *
>>> > > + * BlueZ - Bluetooth protocol stack for Linux
>>> > > + *
>>> > > + * Copyright (C) 2011-2014 Intel Corporation
>>> > > + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
>>> > > + *
>>> > > + *
>>> > > + * This library is free software; you can redistribute it and/or
>>> > > + * modify it under the terms of the GNU Lesser General Public
>>> > > + * License as published by the Free Software Foundation; either
>>> > > + * version 2.1 of the License, or (at your option) any later version.
>>> > > + *
>>> > > + * This library is distributed in the hope that it will be useful,
>>> > > + * but WITHOUT ANY WARRANTY; without even the implied warranty of
>>> > > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
>>> > GNU
>>> > > + * Lesser General Public License for more details.
>>> > > + *
>>> > > + * You should have received a copy of the GNU Lesser General
>>> > > +Public
>>> > > + * License along with this library; if not, write to the Free
>>> > > +Software
>>> > > + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
>>> > > +02110-1301 USA
>>> > > + *
>>> > > + */
>>> > > +
>>> > > +#ifdef HAVE_CONFIG_H
>>> > > +#include <config.h>
>>> > > +#endif
>>> > > +
>>> > > +#include <stdio.h>
>>> > > +#include <stdlib.h>
>>> > > +#include <string.h>
>>> > > +#include <ctype.h>
>>> > > +#include <inttypes.h>
>>> > > +
>>> > > +#include "lib/bluetooth.h"
>>> > > +
>>> > > +#include "src/shared/util.h"
>>> > > +#include "bt.h"
>>> > > +#include "packet.h"
>>> > > +#include "display.h"
>>> > > +#include "l2cap.h"
>>> > > +#include "uuid.h"
>>> > > +#include "keys.h"
>>> > > +#include "sdp.h"
>>> > > +#include "bnep.h"
>>> > > +
>>> > > +#define GET_PKT_TYPE(type) (type & 0x7f) #define
>>> > GET_EXTENSION(type)
>>> > > +(type & 0x80)
>>> > > +
>>> > > +struct bnep_frame {
>>> > > + uint8_t type;
>>> > > + int extension;
>>> > > + struct l2cap_frame l2cap_frame; };
>>> > > +
>>> > > +struct bnep_data {
>>> > > + uint8_t type;
>>> > > + const char *str;
>>> > > +};
>>> > > +
>>> > > +static const struct bnep_data bnep_table[] = {
>>> > > + { 0x00, "General Ethernet"},
>>> > > + { 0x01, "Control"},
>>> > > + { 0x02, "Compressed Ethernet"},
>>> > > + { 0x03, "Compressed Ethernet Src Only"},
>>> > > + { 0x04, "Compressed Ethernet Dest Only"},
>>> > > + { }
>>> > > +};
>>> > > +
>>> > > +void bnep_packet(const struct l2cap_frame *frame) {
>>> > > + uint8_t type;
>>> > > + struct bnep_frame bnep_frame;
>>> > > + struct l2cap_frame *l2cap_frame;
>>> > > + const struct bnep_data *bnep_data = NULL;
>>> > > + const char *pdu_color, *pdu_str;
>>> > > + int i;
>>> > > +
>>> > > + l2cap_frame_pull(&bnep_frame.l2cap_frame, frame, 0);
>>> > > + l2cap_frame = &bnep_frame.l2cap_frame;
>>> > > +
>>> > > + if (!l2cap_frame_get_u8(l2cap_frame, &type))
>>> > > + goto fail;
>>> > > +
>>> > > + bnep_frame.extension = GET_EXTENSION(type);
>>> > > + bnep_frame.type = GET_PKT_TYPE(type);
>>> > > +
>>> > > + for (i = 0; bnep_table[i].str; i++) {
>>> > > + if (bnep_table[i].type == bnep_frame.type) {
>>> > > + bnep_data = &bnep_table[i];
>>> > > + break;
>>> > > + }
>>> > > + }
>>> > > +
>>> > > + if (bnep_data) {
>>> > > + if (frame->in)
>>> > > + pdu_color = COLOR_MAGENTA;
>>> > > + else
>>> > > + pdu_color = COLOR_BLUE;
>>> > > + pdu_str = bnep_data->str;
>>> > > + } else {
>>> > > + pdu_color = COLOR_WHITE_BG;
>>> > > + pdu_str = "Unknown packet type";
>>> > > + }
>>> > > +
>>> > > + print_indent(6, pdu_color, "BNEP: ", pdu_str, COLOR_OFF,
>>> > > + " (0x%02x|%s)", bnep_frame.type,
>>> > > + bnep_frame.extension ? "1" : "0");
>>> > > +
>>> > > + packet_hexdump(l2cap_frame->data, l2cap_frame->size);
>>> > > + return;
>>> > > +
>>> > > +fail:
>>> > > + print_text(COLOR_ERROR, "frame too short");
>>> > > + packet_hexdump(frame->data, frame->size); }
>>> > > diff --git a/monitor/bnep.h b/monitor/bnep.h new file mode 100644
>>> > > index 0000000..38340d6
>>> > > --- /dev/null
>>> > > +++ b/monitor/bnep.h
>>> > > @@ -0,0 +1,25 @@
>>> > > +/*
>>> > > + *
>>> > > + * BlueZ - Bluetooth protocol stack for Linux
>>> > > + *
>>> > > + * Copyright (C) 2011-2014 Intel Corporation
>>> > > + * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
>>> > > + *
>>> > > + *
>>> > > + * This library is free software; you can redistribute it and/or
>>> > > + * modify it under the terms of the GNU Lesser General Public
>>> > > + * License as published by the Free Software Foundation; either
>>> > > + * version 2.1 of the License, or (at your option) any later version.
>>> > > + *
>>> > > + * This library is distributed in the hope that it will be useful,
>>> > > + * but WITHOUT ANY WARRANTY; without even the implied warranty of
>>> > > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
>>> > GNU
>>> > > + * Lesser General Public License for more details.
>>> > > + *
>>> > > + * You should have received a copy of the GNU Lesser General
>>> > > +Public
>>> > > + * License along with this library; if not, write to the Free
>>> > > +Software
>>> > > + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
>>> > > +02110-1301 USA
>>> > > + *
>>> > > + */
>>> > > +
>>> > > +void bnep_packet(const struct l2cap_frame *frame);
>>> > > diff --git a/monitor/l2cap.c b/monitor/l2cap.c index
>>> > > 5faa26f..fc565b1
>>> > > 100644
>>> > > --- a/monitor/l2cap.c
>>> > > +++ b/monitor/l2cap.c
>>> > > @@ -43,6 +43,7 @@
>>> > > #include "sdp.h"
>>> > > #include "avctp.h"
>>> > > #include "rfcomm.h"
>>> > > +#include "bnep.h"
>>> > >
>>> > > /* L2CAP Control Field bit masks */
>>> > > #define L2CAP_CTRL_SAR_MASK 0xC000
>>> > > @@ -2951,6 +2952,9 @@ static void l2cap_frame(uint16_t index, bool
>>> > > in,
>>> > uint16_t handle,
>>> > > case 0x0003:
>>> > > rfcomm_packet(&frame);
>>> > > break;
>>> > > + case 0x000f:
>>> > > + bnep_packet(&frame);
>>> > > + break;
>>> > > case 0x001f:
>>> > > att_packet(index, in, handle, cid, data, size);
>>> > > break;
>>> > > --
>>> > > 1.9.1
>>> > >
>>> > > --
>>> > > To unsubscribe from this list: send the line "unsubscribe
>>> > > linux-bluetooth" in the body of a message to
>>> > > majordomo@vger.kernel.org More majordomo info at
>>> > > http://vger.kernel.org/majordomo-info.html
>>> >
>>> > I've tested it and for me it looks ok. For further development please
>>> > remember about frames with extension headers. It'll be also nice to
>>> > have specified frame sections/flags (e.g. control frame type, header len).
>>> >
>>>
>>> Thanks for testing. I am planning to do in that way.
>>> In the next set, all the BNEP packet type listed above will be handled.
> Good to know.
>>> Then only the extended headers will be handled.
>>> Btw, complete support to handle the extended headers in kernel is done or
>>> yet to be completed?
>>>
> Yes, now it is supported, latest bluetooth-next supports it.
Applied, thanks.
--
Luiz Augusto von Dentz
^ permalink raw reply [flat|nested] 6+ messages in thread
end of thread, other threads:[~2015-04-10 14:26 UTC | newest]
Thread overview: 6+ messages (download: mbox.gz / follow: Atom feed)
-- links below jump to the message on this page --
2015-04-02 11:32 [PATCH] monitor: Add initial support for BNEP Gowtham Anandha Babu
2015-04-03 10:53 ` Grzegorz Kolodziejczyk
2015-04-06 5:42 ` Gowtham Anandha Babu
2015-04-08 10:29 ` Gowtham Anandha Babu
2015-04-08 12:14 ` Grzegorz Kolodziejczyk
2015-04-10 14:26 ` Luiz Augusto von Dentz
This is an external index of several public inboxes,
see mirroring instructions on how to clone and mirror
all data and code used by this external index.