Add BLEDevice.manufacturerData

Author: makisin

src/BLEDevice.cpp

@@ -19,6 +19,7 @@
 
 #include "utility/ATT.h"
 #include "utility/BLEUuid.h"
+#include "utility/BLEManufacturerData.h"
 #include "utility/HCI.h"
 
 #include "remote/BLERemoteDevice.h"
@@ -85,6 +86,11 @@ bool BLEDevice::hasLocalName() const
   return (localName().length() > 0);
 }
 
+bool BLEDevice::hasManufacturerData() const
+{
+  return (manufacturerData().length() > 0);
+}
+
 bool BLEDevice::hasAdvertisedServiceUuid() const
 {
   return hasAdvertisedServiceUuid(0);
@@ -146,6 +152,25 @@ String BLEDevice::localName() const
   return localName;
 }
 
+String BLEDevice::manufacturerData() const
+{
+  String manufacturerData = "";
+
+  for (int i = 0; i < _eirDataLength;) {
+    int eirLength = _eirData[i++];
+    int eirType = _eirData[i++];
+
+    if (eirType == 0xFF) {
+      manufacturerData = BLEManufacturerData::manufacturerDataToString(&_eirData[i], eirLength);
+      break;
+    }
+
+    i += (eirLength - 1);
+  }
+
+  return manufacturerData;
+}
+
 String BLEDevice::advertisedServiceUuid() const
 {
   return advertisedServiceUuid(0);

src/BLEDevice.h

@@ -50,12 +50,14 @@ class BLEDevice {
   virtual String address() const;
 
   bool hasLocalName() const;
-    
+  bool hasManufacturerData() const;
+
   bool hasAdvertisedServiceUuid() const;
   bool hasAdvertisedServiceUuid(int index) const;
   int advertisedServiceUuidCount() const;
 
   String localName() const;
+  String manufacturerData() const;
   String advertisedServiceUuid() const;
   String advertisedServiceUuid(int index) const;
 

src/utility/BLEManufacturerData.cpp

@@ -0,0 +1,40 @@
+/*
+  This file is part of the ArduinoBLE library.
+  Copyright (c) 2018 Arduino SA. All rights reserved.
+
+  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 Street, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#include <stdlib.h>
+#include <string.h>
+
+#include "BLEManufacturerData.h"
+
+const char* BLEManufacturerData::manufacturerDataToString(const uint8_t* data, uint8_t length)
+{
+  static char manufacturerData[32 * 2 + 1];
+  char* c = manufacturerData;
+
+  for (int i = 0; i < length - 1; i++) {
+    uint8_t b = data[i];
+
+    utoa(b >> 4, c++, 16);
+    utoa(b & 0x0f, c++, 16);
+  }
+
+  *c = '\0';
+
+  return manufacturerData;
+}

src/utility/BLEManufacturerData.h

@@ -0,0 +1,31 @@
+/*
+  This file is part of the ArduinoBLE library.
+  Copyright (c) 2018 Arduino SA. All rights reserved.
+
+  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 Street, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#ifndef _BLE_MANUFACTURER_DATA_H_
+#define _BLE_MANUFACTURER_DATA_H_
+
+#include <Arduino.h>
+
+class BLEManufacturerData
+{
+public:
+  static const char* manufacturerDataToString(const uint8_t* data, uint8_t length);
+};
+
+#endif