nfctool: sniffer: Handle Bluetooth Handover records

If the MIME string is "application/vnd.bluetooth.ep.oob" then the
Bluetooth OOB data is parsed and output appropriately.
AC and CR records are not parsed yet.

diff --git a/tools/nfctool/ndef-decode.c b/tools/nfctool/ndef-decode.c
index 94694bc..b79965f 100644 (file)
--- a/tools/nfctool/ndef-decode.c
+++ b/tools/nfctool/ndef-decode.c
@@ -20,10 +20,13 @@
  */
 
 #include <stdio.h>
+#include <stdint.h>
 #include <glib.h>
 #include <errno.h>
 #include <string.h>
 
+#include <near/types.h>
+
 #include "nfctool.h"
 #include "sniffer.h"
 #include "ndef-decode.h"
@@ -38,6 +41,17 @@
 
 #define ndef_printf_error(fmt, ...) print_indent(NDEF_MSG_INDENT, COLOR_ERROR, \
                                                fmt, ## __VA_ARGS__)
+
+#define ndef_printf_buffer(prefix, buf, buf_len) \
+do { \
+       int i; \
+       printf("%*c%s%s", NDEF_MSG_INDENT, ' ',                 \
+              use_color() ? NDEF_COLOR : "", (prefix));        \
+       for (i = 0; i < (buf_len); i++)                         \
+               printf("%02X ", (buf)[i]);                      \
+       printf("\n"); \
+} while(0)
+
 enum record_tnf {
        RECORD_TNF_EMPTY     = 0x00,
        RECORD_TNF_WELLKNOWN = 0x01,
@@ -59,6 +73,85 @@ static gchar *tnf_str[] = {
        "Reserved (0x07)"
 };
 
+/* BT EIR list */
+#define EIR_UUID128_ALL                0x07 /* 128-bit UUID, all listed */
+#define EIR_NAME_SHORT         0x08 /* shortened local name */
+#define EIR_NAME_COMPLETE      0x09 /* complete local name */
+
+/* Specific OOB EIRs */
+#define EIR_CLASS_OF_DEVICE    0x0D  /* class of device */
+#define EIR_SP_HASH            0x0E  /* simple pairing hash C */
+#define EIR_SP_RANDOMIZER      0x0F  /* simple pairing randomizer R */
+/* Optional EIRs */
+#define EIR_DEVICE_ID          0x10  /* device ID */
+#define EIR_SECURITY_MGR_FLAGS 0x11  /* security manager flags */
+
+static void ndef_print_bt_oob(guint8 *oob_data, guint32 oob_length)
+{
+       guint32 offset = 0;
+       guint16 length = near_get_le16(oob_data);
+       guint8 *bdaddr, eir_length, eir_type;
+       char *local_name;
+
+       if (length != oob_length) {
+               ndef_printf_error("Malformed Bluetooth OOB data");
+               return;
+       }
+
+       bdaddr = oob_data + 2;
+       offset = 8;
+
+       ndef_printf_msg("Bluetooth OOB Length: %d", length);
+       ndef_printf_msg("Bluetooth Address: %x:%x:%x:%x:%x:%x",
+                       bdaddr[5], bdaddr[4], bdaddr[3],
+                       bdaddr[2], bdaddr[1], bdaddr[0]);
+
+       while (offset < length) {
+               eir_length = oob_data[offset];
+               eir_type = oob_data[offset + 1];
+
+               if (eir_length + offset + 1 > length)
+                       break;
+
+               switch (eir_type) {
+               case EIR_NAME_SHORT:
+               case EIR_NAME_COMPLETE:
+                       local_name = g_try_malloc0(eir_length);
+                       if (local_name == NULL)
+                               break;
+
+                       g_snprintf(local_name, eir_length,
+                                       "%s", oob_data + offset + 2);
+
+                       ndef_printf_msg("Bluetooth local name: %s", local_name);
+                       g_free(local_name);
+                       break;
+
+               case EIR_CLASS_OF_DEVICE:
+                       ndef_printf_msg("Bluetooth CoD: 0x%02x-0x%02x-0x%02x",
+                                       oob_data[offset + 4],
+                                       oob_data[offset + 3],
+                                       oob_data[offset + 2]);
+                       break;
+
+               case EIR_SP_HASH:
+                       ndef_printf_buffer("Bluetooth Hash: ",
+                                       oob_data + offset + 2, eir_length - 1);
+                       break;
+
+               case EIR_SP_RANDOMIZER:
+                       ndef_printf_buffer("Bluetooth Randomizer: ",
+                                       oob_data + offset + 2, eir_length - 1);
+                       break;
+
+               default:
+                       break;
+               }
+
+               offset += eir_length + 1;
+       }
+}
+
 int ndef_print_records(guint8 *data, guint32 data_len)
 {
        gboolean mb, me, cf, sr, il;
@@ -97,6 +190,7 @@ int ndef_print_records(guint8 *data, guint32 data_len)
                type = NULL;
                id = NULL;
                payload = NULL;
+               mime_string = NULL;
 
                CHECK_OFFSET(2);
 
@@ -180,7 +274,6 @@ int ndef_print_records(guint8 *data, guint32 data_len)
                                                type_len + 1, "%s", type);
 
                                        ndef_printf_msg("Type: %s", mime_string);
-                                       g_free(mime_string);
                                        break;
                                }
 
@@ -201,10 +294,18 @@ int ndef_print_records(guint8 *data, guint32 data_len)
                }
 
                if (payload) {
-                       ndef_printf_msg("Payload:");
+                       if (mime_string != NULL) {
+                               if (strcmp(mime_string,
+                               "application/vnd.bluetooth.ep.oob") == 0)
+                                       ndef_print_bt_oob(payload, payload_len);
 
-                       sniffer_print_hexdump(stdout, payload, payload_len,
-                                             NDEF_HEX_INDENT, FALSE);
+                               g_free(mime_string);
+                       } else {
+                               ndef_printf_msg("Payload:");
+
+                               sniffer_print_hexdump(stdout, payload,
+                                       payload_len, NDEF_HEX_INDENT, FALSE);
+                       }
                }
 
                ndef_offset += record_offset;