Wang Xinglu / BLE_API

High level Bluetooth Low Energy API and radio abstraction layer

Dependencies:   nRF51822

Dependents:   LinkNode_LIS3DH

Fork of BLE_API by Bluetooth Low Energy

Diff: GapAdvertisingData.cpp

Revision:
14:6ea5d1012a64
Parent:
7:5e1f0d7f7c7d
Child:
18:86fe1e247a54
--- a/GapAdvertisingData.cpp	Wed Dec 18 06:22:35 2013 +0000
+++ b/GapAdvertisingData.cpp	Wed Dec 18 11:52:37 2013 +0000
@@ -60,9 +60,18 @@
     /*       value is exclusive or not (flags, etc.) */
     
     /* Make sure we don't exceed the 31 byte payload limit */
-    if (_payloadLen + len >= GAP_ADVERTISING_DATA_MAX_PAYLOAD)
+    if (_payloadLen + len + 2 >= GAP_ADVERTISING_DATA_MAX_PAYLOAD)
         return BLE_ERROR_BUFFER_OVERFLOW;
+
+    /* Field length */
+    memset(&_payload[_payloadLen], len+1, 1);
+    _payloadLen++;
     
+    /* Field ID */
+    memset(&_payload[_payloadLen], (uint8_t)advDataType, 1); 
+    _payloadLen++;
+       
+    /* Payload */
     memcpy(&_payload[_payloadLen], payload, len);
     _payloadLen += len;