Hi Grzegorz, > -----Original Message----- > From: linux-bluetooth-owner@xxxxxxxxxxxxxxx [mailto:linux-bluetooth- > owner@xxxxxxxxxxxxxxx] On Behalf Of Grzegorz Kolodziejczyk > Sent: Friday, April 03, 2015 4:23 PM > To: Gowtham Anandha Babu > Cc: linux-bluetooth; bharat.panda@xxxxxxxxxxx; cpgs@xxxxxxxxxxx > Subject: Re: [PATCH] monitor: Add initial support for BNEP > > Hi Gowtham, > > On 2 April 2015 at 13:32, Gowtham Anandha Babu > <gowtham.ab@xxxxxxxxxxx> 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@xxxxxxxxxxxx> > > + * > > + * > > + * 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@xxxxxxxxxxxx> > > + * > > + * > > + * 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@xxxxxxxxxxxxxxx > > 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@xxxxxxxxxxxxxxx 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@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html
