add "LE Device Address" 0x1B to advertising data types

Fork of BLE_API by Bluetooth Low Energy

Revision:
784:1e817a72a166
Parent:
783:9959291e9a3f
Child:
785:c74f567162d4
--- a/ble/services/EddystoneService.h	Tue Aug 11 15:13:13 2015 +0100
+++ b/ble/services/EddystoneService.h	Tue Aug 11 15:13:13 2015 +0100
@@ -22,17 +22,22 @@
 
 static const uint8_t BEACON_EDDYSTONE[] = {0xAA, 0xFE};
 
+//Debug is disabled by default
 #if 0
-#define INFO(MSG, ...) printf("[EddyStone: INFO]" MSG " \t[%s,%d]\r\n", ##__VA_ARGS__, __FILE__, __LINE__);
-#define DBG(MSG, ...)  printf("[EddyStone: DBG]"  MSG " \t[%s,%d]\r\n", ##__VA_ARGS__, __FILE__, __LINE__);
-#define WARN(MSG, ...) printf("[EddyStone: WARN]" MSG " \t[%s,%d]\r\n", ##__VA_ARGS__, __FILE__, __LINE__);
-#define ERR(MSG, ...)  printf("[EddyStone: ERR]"  MSG " \t[%s,%d]\r\n", ##__VA_ARGS__, __FILE__, __LINE__);
+#define DBG(x, ...)  printf("[EddyStone: DBG]"x" \t[%s,%d]\r\n", ##__VA_ARGS__,__FILE__,__LINE__);
+#define WARN(x, ...) printf("[EddyStone: WARN]"x" \t[%s,%d]\r\n", ##__VA_ARGS__,__FILE__,__LINE__);
+#define ERR(x, ...)  printf("[EddyStone: ERR]"x" \t[%s,%d]\r\n", ##__VA_ARGS__,__FILE__,__LINE__);
 #else
-#define INFO(MSG, ...)
-#define DBG(MSG, ...)
-#define WARN(MSG, ...)
-#define ERR(MSG, ...)
-#endif // if 0
+#define DBG(x, ...) //wait_us(10);
+#define WARN(x, ...) //wait_us(10);
+#define ERR(x, ...)
+#endif
+
+#if 0
+#define INFO(x, ...)  printf("[EddyStone: INFO]"x" \t[%s,%d]\r\n", ##__VA_ARGS__,__FILE__,__LINE__);
+#else
+#define INFO(x, ...)
+#endif
 
 /**
 * @class Eddystone
@@ -43,222 +48,94 @@
 class EddystoneService
 {
 public:
-    static const unsigned ADVERTISING_INTERVAL_MSEC = 1000; // Advertising interval for config service.
-    static const size_t   SERVICE_DATA_MAX          = 31;   // Maximum size of service data in ADV packets
+    /**
+     * @brief Transmission Power Modes for UriBeacon
+     */
+
+    static const int ADVERTISING_INTERVAL_MSEC = 1000;  // Advertising interval for config service.
+    static const int SERVICE_DATA_MAX = 31;             // Maximum size of service data in ADV packets
 
-    static const size_t URI_DATA_MAX = 18;
-    typedef uint8_t UriData_t[URI_DATA_MAX];
+    // There are currently 3 subframes defined, URI, UID, and TLM
+#define EDDYSTONE_MAX_FRAMETYPE 3
+    void (*frames[EDDYSTONE_MAX_FRAMETYPE])(uint8_t *, uint32_t);
+    uint8_t frameIndex;
+    static const int URI_DATA_MAX = 18;
+    typedef uint8_t  UriData_t[URI_DATA_MAX];
 
     // UID Frame Type subfields
-    static const size_t UID_NAMESPACEID_SIZE = 10;
-    static const size_t UID_INSTANCEID_SIZE  = 6;
-    typedef uint8_t UIDNamespaceID_t[UID_NAMESPACEID_SIZE];
-    typedef uint8_t UIDInstanceID_t[UID_INSTANCEID_SIZE];
+    static const int UID_NAMESPACEID_SIZE = 10;
+    typedef uint8_t  UIDNamespaceID_t[UID_NAMESPACEID_SIZE];
+    static const int UID_INSTANCEID_SIZE = 6;
+    typedef uint8_t  UIDInstanceID_t[UID_INSTANCEID_SIZE];
 
     // Eddystone Frame Type ID
-    enum {
-        FRAME_TYPE_UID = 0x00,
-        FRAME_TYPE_URL = 0x10,
-        FRAME_TYPE_TLM = 0x20,
-        NUM_FRAMETYPES = 3
-    };
+    static const uint8_t FRAME_TYPE_UID = 0x00;
+    static const uint8_t FRAME_TYPE_URL = 0x10;
+    static const uint8_t FRAME_TYPE_TLM = 0x20;
 
+    static const uint8_t FRAME_SIZE_TLM = 14; // TLM frame is a constant 14Bytes
     static const uint8_t FRAME_SIZE_UID = 20; // includes RFU bytes
-    static const uint8_t FRAME_SIZE_TLM = 14; // TLM frame is a constant 14Bytes
 
-public:
-    /**
-     * Constructor: sets up the parameters used by the Eddystone beacon.
-     * This function should be used in lieu of the config service.
-     *
-     * @param bleIn
-     *            ble object for the underlying controller.
-     * @oaram interval
-     *            This is is how often broadcasts are made (in units of milliseconds).
-     * @param txPowerLevel
-     *            The broadcasting power level (in dbM).
-     * @param UIDNamespaceID
-     *            10-Byte Namespace UUID.
-     * @param UIDInstanceID
-     *            6-Byte Instance UUID.
-     * @param url
-     *            Shortened URL to broadcast (pass in as a string).
-     * @param tlmVersion
-     *            version of telemetry data field to use (default to 0x00).
-     */
-    EddystoneService(BLEDevice     &bleIn,
-                     uint16_t       interval       = 100,
-                     uint8_t        txPowerLevel   = 0,
-                     const uint8_t *UIDNamespaceID = NULL,
-                     const uint8_t *UIDInstanceID  = NULL,
-                     const char    *url            = NULL,
-                     uint8_t        tlmVersion     = 0) :
-        ble(bleIn),
-        uidIsSet(false),
-        urlIsSet(false),
-        frameIndex(0),
-        uidRFU(0),
-        switchFlag(true),
-        TlmPduCount(0),
-        TlmTimeSinceBoot(0)
-    {
-        // Check optional frames, set their 'isSet' flags appropriately
-        if ((UIDNamespaceID != NULL) & (UIDInstanceID != NULL)) {
-            setUIDFrameData(txPowerLevel, UIDNamespaceID, UIDInstanceID);
-            uidIsSet = true;
-        } else if (url != NULL) {
-            setURLFrameData(txPowerLevel, url);
-            urlIsSet = true;
-        } else {
-            // Default TLM frame to version 0x00, start all values at zero to be spec compliant.
-            setTLMFrameData(tlmVersion, 0x00, 0x00);
+    /*
+    *  Set Eddystone UID Frame information.
+    *  @param[in] power   TX Power in dB measured at 0 meters from the device. Range of -100 to +20 dB.
+    *  @param namespaceID 10B namespace ID
+    *  @param instanceID  6B instance ID
+    *  @param RFU         2B of RFU, initialized to 0x0000 and not broadcast, included for future reference.
+    *
+    */
+    void setUIDFrameData(int8_t power, UIDNamespaceID_t namespaceID, UIDInstanceID_t instanceID, uint16_t RFU = 0x0000) {
+        if(power > 20) {
+            power = 20;
         }
-
-        ble.gap().setTxPower(txPowerLevel);
-        ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_NON_CONNECTABLE_UNDIRECTED);
-        ble.gap().setAdvertisingInterval(interval);
-
-        ble.gap().clearAdvertisingPayload();
-        ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
-        ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, BEACON_EDDYSTONE, sizeof(BEACON_EDDYSTONE));
-
-        // Construct TLM Frame in initial advertising.
-        uint8_t  serviceData[SERVICE_DATA_MAX];
-        unsigned serviceDataLen = 0;
-        serviceData[serviceDataLen++] = BEACON_EDDYSTONE[0];
-        serviceData[serviceDataLen++] = BEACON_EDDYSTONE[1];
-        serviceDataLen               += constructTLMFrame(serviceData + serviceDataLen, SERVICE_DATA_MAX);
-        ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA, serviceData, serviceDataLen);
-
-        ble.gap().startAdvertising();
-        ble.gap().onRadioNotification(this, &EddystoneService::radioNotificationCallback);
-
-        timeSinceBootTick.attach(this, &EddystoneService::tsbCallback, 0.1); // increment the TimeSinceBoot ticker every 0.1s
+        if(power < -100) {
+            power = -100;
+        }
+        defaultUidPower = power;
+        memcpy(defaultUidNamespaceID, namespaceID, UID_NAMESPACEID_SIZE);
+        memcpy(defaultUidInstanceID,  instanceID,  UID_INSTANCEID_SIZE);
+        uidRFU = (uint16_t)RFU; // this is probably bad form, but it doesnt really matter yet.
+        return;
     }
 
     /*
-     *  Update the TLM frame battery voltage value
-     *  @param[in] voltagemv Voltage to update the TLM field battery voltage with (in mV)
-     *  @return nothing
-     */
-    void updateTlmBatteryVoltage(uint16_t voltagemv) {
-        TlmBatteryVoltage = voltagemv;
-    }
-
-    /*
-     *  Update the TLM frame beacon temperature
-     *  @param[in] temp Temperature of beacon (in 8.8fpn)
-     *  @return nothing
-     */
-    void updateTlmBeaconTemp(uint16_t temp) {
-        TlmBeaconTemp = temp;
-    }
-
-    /*
-     *  Update the TLM frame PDU Count field
-     *  @param[in] pduCount Number of Advertising frames sent since power-up
-     */
-    void updateTlmPduCount(uint32_t pduCount) {
-        TlmPduCount = pduCount;
-    }
-
-    /*
-     *  Update the TLM frame Time since boot in 0.1s increments
-     *  @param[in] timeSinceBoot Time since boot in 0.1s increments
-     */
-    void updateTlmTimeSinceBoot(uint32_t timeSinceBoot) {
-        TlmTimeSinceBoot = timeSinceBoot;
-    }
-
-protected:
-    /*
-     *  callback function, called every 0.1s, increments the TimeSinceBoot field in the TLM frame
-     */
-    virtual void tsbCallback(void) {
-        TlmTimeSinceBoot++;
-    }
+    *  Construct UID frame from private variables
+    *  @param[in/out] Data pointer to array to store constructed frame in
+    *  @param[in] maxSize number of bytes left in array, effectively how much emtpy space is available to write to
+    *  @return number of bytes used. negative number indicates error message.
+    */
+    int constructUIDFrame(uint8_t * Data, uint8_t maxSize) {
 
-private:
-    /*
-     *  Set Eddystone UID Frame information.
-     *
-     *  @param[in] power   TX Power in dB measured at 0 meters from the device. Range of -100 to +20 dB.
-     *  @param namespaceID 10B namespace ID
-     *  @param instanceID  6B instance ID
-     *  @param RFU         2B of RFU, initialized to 0x0000 and not broadcast, included for future reference.
-     */
-    void setUIDFrameData(int8_t power, const UIDNamespaceID_t namespaceID, const UIDInstanceID_t instanceID, uint16_t RFU = 0x0000) {
-        if (power > 20) {
-            power = 20;
-        }
-        if (power < -100) {
-            power = -100;
+        int index = 0;
+        Data[index++] = FRAME_TYPE_UID;                     // 1B  Type
+        if(defaultUidPower > 20) {
+            defaultUidPower = 20;   // enforce range of vaild values.
         }
-        defaultUidPower = power;
-
-        memcpy(defaultUidNamespaceID, namespaceID, UID_NAMESPACEID_SIZE);
-        memcpy(defaultUidInstanceID,  instanceID,  UID_INSTANCEID_SIZE);
-
-        uidRFU = (uint16_t)RFU; // this is probably bad form, but it doesn't really matter yet.
-    }
-
-    /**
-     *  Construct UID frame from private variables
-     *
-     *  @param[in,out] data
-     *                     pointer to array to store constructed frame in
-     *  @param[in]     maxSize
-     *                     number of bytes left in array, effectively how much empty space is available to write to
-     *
-     *  @return number of bytes used. negative number indicates error message.
-     */
-    int constructUIDFrame(uint8_t *data, uint8_t maxSize) {
-        if (maxSize < FRAME_SIZE_UID) {
-            return -1;
-        }
-
-        unsigned index = 0;
-        data[index++] = FRAME_TYPE_UID; // 1B  Type
-
-        if (defaultUidPower > 20) { // enforce range of valid values.
-            defaultUidPower = 20;
-        }
-        if (defaultUidPower < -100) {
+        if(defaultUidPower < -100) {
             defaultUidPower = -100;
         }
-        data[index++] = defaultUidPower; // 1B  Power @ 0meter
-
-        for (size_t x = 0; x < UID_NAMESPACEID_SIZE; x++) { // 10B Namespce ID
-            data[index++] = defaultUidNamespaceID[x];
+        Data[index++] = defaultUidPower;                    // 1B  Power @ 0meter
+        for(int x = 0; x < UID_NAMESPACEID_SIZE; x++) {     // 10B Namespce ID
+            Data[index++] = defaultUidNamespaceID[x];
         }
-
-        for (size_t x = 0; x< UID_INSTANCEID_SIZE; x++) { // 6B  Instance ID
-            data[index++] = defaultUidInstanceID[x];
+        for(int x = 0; x< UID_INSTANCEID_SIZE; x++) {       // 6B  Instance ID
+            Data[index++] = defaultUidInstanceID[x];
         }
-
-        if (uidRFU) { // 2B RFU, include if non-zero, otherwise ignore
-            data[index++] = (uint8_t)(uidRFU >> 0);
-            data[index++] = (uint8_t)(uidRFU >> 8);
+        if(0 != uidRFU) {                                // 2B RFU, include if non-zero, otherwise ignore
+            Data[index++] = (uint8_t)(uidRFU >> 0);
+            Data[index++] = (uint8_t)(uidRFU >> 8);
         }
-
+        DBG("construcUIDFrame %d, %d",maxSize,index);
         return index;
     }
 
     /*
-     * Update advertising data
-     * @return true on success, false on failure
-     */
-    bool updateAdvPacket(const uint8_t serviceData[], unsigned serviceDataLen) {
-        return (ble.gap().updateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA, serviceData, serviceDataLen) == BLE_ERROR_NONE);
-    }
-
-    /*
-     *  Set Eddystone URL Frame information.
-     *  @param[in] power   TX Power in dB measured at 0 meters from the device.
-     *  @param url         URL to encode
-     *  @return            false on success, true on failure.
-     */
-    bool setURLFrameData(int8_t power, const char *url) {
+    *  Set Eddystone URL Frame information.
+    *  @param[in] power   TX Power in dB measured at 0 meters from the device.
+    *  @param url         URL to encode
+    *  @return            false on success, true on failure.
+    */
+    bool setURLFrameData(int8_t power, const char * url) {
         defaultUrlPower = power;
         encodeURL(url, defaultUriData, defaultUriDataLength); // encode URL to URL Formatting
         if (defaultUriDataLength > URI_DATA_MAX) {
@@ -267,203 +144,325 @@
         return false;
     }
 
-    /**
-     *  Construct URL frame from private variables.
-     *
-     *  @param[in,out] data
-     *                     pointer to array to store constructed frame in
-     *  @param[in]     maxSize
-     *                     number of bytes left in array, effectively how much empty space is available to write to.
-     *
-     *  @return number of bytes used. negative number indicates error message.
-     */
-    int constructURLFrame(uint8_t *data, uint8_t maxSize) {
-        if (maxSize < (1 + 1 + defaultUriDataLength)) {
-            return -1;
+    /*
+    *  Construct URL frame from private variables
+    *  @param[in/out] Data pointer to array to store constructed frame in
+    *  @param[in] maxSize number of bytes left in array, effectively how much emtpy space is available to write to
+    *  @return number of bytes used. negative number indicates error message.
+    */
+    int constructURLFrame(uint8_t * Data, uint8_t maxSize) {
+        int index = 0;
+        Data[index++] = FRAME_TYPE_URL;                     // 1B  Type
+        Data[index++] = defaultUrlPower;                    // 1B  TX Power
+        for(int x = 0; x < defaultUriDataLength; x++) {     // 18B of URL Prefix + encoded URL
+            Data[index++] = defaultUriData[x];
         }
+        DBG("constructURLFrame: %d, %d",maxSize,index);
+        return index;
+    }
 
-        unsigned index = 0;
-        data[index++] = FRAME_TYPE_URL;                     // 1B  Type
-        data[index++] = defaultUrlPower;                    // 1B  TX Power
-        for (size_t x = 0; x < defaultUriDataLength; x++) { // 18B of URL Prefix + encoded URL
-            data[index++] = defaultUriData[x];
-        }
+    /*
+    *  Set Eddystone TLM Frame information.
+    *  @param[in] Version    of the TLM beacon data format
+    *  @param batteryVoltage in milivolts
+    *  @param beaconTemp     in 8.8 floating point notation
+    *
+    */
+    void setTLMFrameData(uint8_t version, uint16_t batteryVoltage, uint16_t beaconTemp, uint32_t pduCount = 0, uint32_t timeSinceBoot = 0) {
+        TlmVersion = version;
+        TlmBatteryVoltage = batteryVoltage;
+        TlmBeaconTemp = beaconTemp;
+        TlmPduCount = pduCount; // reset
+        TlmTimeSinceBoot = timeSinceBoot; // reset
+        return;
+    }
 
+    /*
+    *  Construct TLM frame from private variables
+    *  @param[in/out] Data pointer to array to store constructed frame in
+    *  @param[in] maxSize number of bytes left in array, effectively how much emtpy space is available to write to
+    *  @return number of bytes used. negative number indicates error message.
+    */
+    int constructTLMFrame(uint8_t * Data, uint8_t maxSize) {
+        int index = 0;
+        Data[index++] = FRAME_TYPE_TLM;                    // Eddystone frame type = Telemetry
+        Data[index++] = TlmVersion;                        // TLM Version Number
+        Data[index++] = (uint8_t)(TlmBatteryVoltage>>8);   // Battery Voltage[0]
+        Data[index++] = (uint8_t)(TlmBatteryVoltage>>0);   // Battery Voltage[1]
+        Data[index++] = (uint8_t)(TlmBeaconTemp>>8);       // Beacon Temp[0]
+        Data[index++] = (uint8_t)(TlmBeaconTemp>>0);       // Beacon Temp[1]
+        Data[index++] = (uint8_t)(TlmPduCount>>24);         // PDU Count [0]
+        Data[index++] = (uint8_t)(TlmPduCount>>16);         // PDU Count [1]
+        Data[index++] = (uint8_t)(TlmPduCount>>8);        // PDU Count [2]
+        Data[index++] = (uint8_t)(TlmPduCount>>0);        // PDU Count [3]
+        Data[index++] = (uint8_t)(TlmTimeSinceBoot>>24);    // Time Since Boot [0]
+        Data[index++] = (uint8_t)(TlmTimeSinceBoot>>16);    // Time Since Boot [1]
+        Data[index++] = (uint8_t)(TlmTimeSinceBoot>>8);   // Time Since Boot [2]
+        Data[index++] = (uint8_t)(TlmTimeSinceBoot>>0);   // Time Since Boot [3]
+        DBG("constructURLFrame: %d, %d",maxSize,index);
         return index;
     }
 
     /*
-     *  Set Eddystone TLM Frame information.
-     *  @param[in] Version    of the TLM beacon data format
-     *  @param batteryVoltage in millivolts
-     *  @param beaconTemp     in 8.8 floating point notation
-     *
-     */
-    void setTLMFrameData(uint8_t version, uint16_t batteryVoltage, uint16_t beaconTemp, uint32_t pduCount = 0, uint32_t timeSinceBoot = 0) {
-        TlmVersion        = version;
-        TlmBatteryVoltage = batteryVoltage;
-        TlmBeaconTemp     = beaconTemp;
-        TlmPduCount       = pduCount; // reset
-        TlmTimeSinceBoot  = timeSinceBoot; // reset
+    *  Update the TLM frame battery voltage value
+    *  @param[in] voltagemv Voltage to update the TLM field battery voltage with (in mV)
+    *  @return nothing
+    */
+    void updateTlmBatteryVoltage(uint16_t voltagemv) {
+        TlmBatteryVoltage = voltagemv;
+        return;
+    }
+
+    /*
+    *  Update the TLM frame beacon temperature
+    *  @param[in] temp Temperature of beacon (in 8.8fpn)
+    *  @return nothing
+    */
+    void updateTlmBeaconTemp(uint16_t temp) {
+        TlmBeaconTemp = temp;
+        return;
+    }
+
+    /*
+    *  Update the TLM frame PDU Count field
+    *  @param[in] pduCount Number of Advertisiting frames sent since powerup
+    *  @return nothing
+    */
+    void updateTlmPduCount(uint32_t pduCount) {
+        TlmPduCount = pduCount;
+        return;
     }
 
     /*
-     *  Construct TLM frame from private variables
-     *  @param[in,out] data
-     *                     pointer to array to store constructed frame in
-     *  @param[in]     maxSize
-     *                     number of bytes left in array, effectively how much empty space is available to write to.
-     *
-     *  @return number of bytes used. negative number indicates error message.
-     */
-    int constructTLMFrame(uint8_t *data, uint8_t maxSize) {
-        if (maxSize < FRAME_SIZE_TLM) {
-            return -1;
-        }
+    *  Update the TLM frame Time since boot in 0.1s incriments
+    *  @param[in] timeSinceBoot Time since boot in 0.1s incriments
+    *  @return nothing
+    */
+    void updateTlmTimeSinceBoot(uint32_t timeSinceBoot) {
+        TlmTimeSinceBoot = timeSinceBoot;
+        return;
+    }
 
-        unsigned index = 0;
-        data[index++] = FRAME_TYPE_TLM;                    // Eddystone frame type = Telemetry
-        data[index++] = TlmVersion;                        // TLM Version Number
-        data[index++] = (uint8_t)(TlmBatteryVoltage >> 8); // Battery Voltage[0]
-        data[index++] = (uint8_t)(TlmBatteryVoltage >> 0); // Battery Voltage[1]
-        data[index++] = (uint8_t)(TlmBeaconTemp >> 8);     // Beacon Temp[0]
-        data[index++] = (uint8_t)(TlmBeaconTemp >> 0);     // Beacon Temp[1]
-        data[index++] = (uint8_t)(TlmPduCount >> 24);      // PDU Count [0]
-        data[index++] = (uint8_t)(TlmPduCount >> 16);      // PDU Count [1]
-        data[index++] = (uint8_t)(TlmPduCount >> 8);       // PDU Count [2]
-        data[index++] = (uint8_t)(TlmPduCount >> 0);       // PDU Count [3]
-        data[index++] = (uint8_t)(TlmTimeSinceBoot >> 24); // Time Since Boot [0]
-        data[index++] = (uint8_t)(TlmTimeSinceBoot >> 16); // Time Since Boot [1]
-        data[index++] = (uint8_t)(TlmTimeSinceBoot >> 8);  // Time Since Boot [2]
-        data[index++] = (uint8_t)(TlmTimeSinceBoot >> 0);  // Time Since Boot [3]
-
-        return index;
+    /*
+    *  callback function, called every 0.1s, incriments the TimeSinceBoot field in the TLM frame
+    *  @return nothing
+    */
+    void tsbCallback(void) {
+        TlmTimeSinceBoot++;
     }
 
     /*
-     *   State machine for switching out frames.
-     *   This function is called by the radioNotificationCallback when a frame needs to get swapped out.
-     *   This function exists because of time constraints in the radioNotificationCallback, so it is effectively
-     *   broken up into two functions.
-     */
+    * Update advertising data
+    * @return true on success, false on failure
+    */
+    bool updateAdvPacket(uint8_t serviceData[], unsigned serviceDataLen) {
+        // Fields from the Service
+        DBG("Updating AdvFrame: %d", serviceDataLen);
+//        printf("\r\n");
+//        for(int x = 0; x<serviceDataLen; x++) {
+//            printf("%2.2x:",serviceData[x]);
+//        }
+//        printf("\r\n");
+        ble.clearAdvertisingPayload();
+        ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
+        ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, BEACON_EDDYSTONE, sizeof(BEACON_EDDYSTONE));
+        ble.accumulateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA, serviceData, serviceDataLen);
+
+        return true;
+    }
+
+    /*
+    *   State machine for switching out frames.
+    *   This function is called by the radioNotificationCallback when a frame needs to get swapped out.
+    *   This function exists because of time constraints in the radioNotificationCallback, so it is effectively
+    *   broken up into two functions.
+    */
     void swapOutFrames(void) {
         uint8_t serviceData[SERVICE_DATA_MAX];
-
-        //hard code in the Eddystone UUID
         unsigned serviceDataLen = 0;
+        //hard code in the eddystone UUID
         serviceData[serviceDataLen++] = BEACON_EDDYSTONE[0];
         serviceData[serviceDataLen++] = BEACON_EDDYSTONE[1];
 
         // if certain frames are not enabled, then skip them. Worst case TLM is always enabled
-        switch (frameIndex) {
+        switch(frameIndex) {
             case 1:
                 // URL Frame
-                if (urlIsSet) {
-                    INFO("Swapping in URL Frame: Power: %d", defaultUrlPower);
-                    serviceDataLen += constructURLFrame(serviceData + serviceDataLen, 20);
-                    DBG("\t Swapping in URL Frame: len=%d ", serviceDataLen);
-                    updateAdvPacket(serviceData, serviceDataLen);
+                if(urlIsSet) {
+                    INFO("Swapping in URL Frame: Power: %d",defaultUrlPower);
+                    serviceDataLen += constructURLFrame(serviceData+serviceDataLen,20);
+                    DBG("\t Swapping in URL Frame: len=%d ",serviceDataLen);
+                    updateAdvPacket(serviceData,serviceDataLen);
                     switchFlag = false;
                     frameIndex++;
                     break;
                 }
-
             case 2:
                 // UID Frame
-                if (uidIsSet) {
-                    INFO("Swapping in UID Frame: Power: %d", defaultUidPower);
-                    serviceDataLen += constructUIDFrame(serviceData + serviceDataLen, 20);
-                    DBG("\t Swapping in UID Frame: len=%d", serviceDataLen);
-                    updateAdvPacket(serviceData, serviceDataLen);
+                if(uidIsSet) {
+                    INFO("Swapping in UID Frame: Power: %d",defaultUidPower);
+                    serviceDataLen += constructUIDFrame(serviceData+serviceDataLen,20);
+                    DBG("\t Swapping in UID Frame: len=%d",serviceDataLen);
+                    updateAdvPacket(serviceData,serviceDataLen);
                     switchFlag = false;
                     frameIndex++;
                     break;
                 }
-
             default:
                 // TLM frame
-                INFO("Swapping in TLM Frame: version=%x, Batt=%d, Temp = %d, PDUCnt = %d, TimeSinceBoot=%d",
-                     TlmVersion,
-                     TlmBatteryVoltage,
-                     TlmBeaconTemp,
-                     TlmPduCount,
-                     TlmTimeSinceBoot);
-                serviceDataLen += constructTLMFrame(serviceData + serviceDataLen, 20);
-                DBG("\t Swapping in TLM Frame: len=%d", serviceDataLen);
-                updateAdvPacket(serviceData, serviceDataLen);
+                INFO("Swapping in TLM Frame: version=%x, Batt=%d, Temp = %d, PDUCnt = %d, TimeSinceBoot=%d",TlmVersion, TlmBatteryVoltage, TlmBeaconTemp, TlmPduCount, TlmTimeSinceBoot);
+                serviceDataLen += constructTLMFrame(serviceData+serviceDataLen,20);
+                DBG("\t Swapping in TLM Frame: len=%d",serviceDataLen);
+                updateAdvPacket(serviceData,serviceDataLen);
                 frameIndex++;
                 break;
         }
     }
 
     /*
-     *  Callback from onRadioNotification(), used to update the PDUCounter and process next state.
-     */
+    *  Callback from onRadioNotification(), used to update the PDUCounter and process next state.
+    */
+#define EDDYSTONE_SWAPFRAME_DELAYMS 1
     void radioNotificationCallback(bool radioActive) {
-        static const unsigned EDDYSTONE_SWAPFRAME_DELAYMS = 1;
-
+        //DBG("RadioNotificationCallback : %d, %d, %d, %d",radioActive,frameIndex,TlmPduCount,TlmTimeSinceBoot);
         // Update PDUCount
         TlmPduCount++;
-        frameIndex = frameIndex % NUM_FRAMETYPES;
+        frameIndex = frameIndex % EDDYSTONE_MAX_FRAMETYPE;
+
 
-        if (!radioActive) { // false just after a frame is sent
+        // True just before an frame is sent, fale just after a frame is sent
+        if(radioActive) {
+            // Do Nothing
+        } else {
             // state machine to control which packet is being sent
-            switch (frameIndex) {
+            switch(frameIndex) {
                 case 0: // TLM Frame
                     switchFrame.attach_us(this, &EddystoneService::swapOutFrames, EDDYSTONE_SWAPFRAME_DELAYMS);
                     switchFlag = true;
                     break;
-
                 case 1: // URL Frame
                     // switch out packets
-                    if (switchFlag) {
+                    if(switchFlag) {
                         switchFrame.attach_us(this, &EddystoneService::swapOutFrames, EDDYSTONE_SWAPFRAME_DELAYMS);
                         switchFlag = false;
                     } else {
-                        if ((TlmPduCount % 10) == 0) { // every 10 adv packets switch the frame
+                        if((TlmPduCount % 10) == 0) { // every 10 adv packets switch the frame
                             switchFlag = true;
                         }
                     }
                     break;
-
                 case 2: // UIDFrame
                     // switch out packets
-                    if (switchFlag) {
+                    if(switchFlag ) {
                         switchFrame.attach_us(this, &EddystoneService::swapOutFrames, EDDYSTONE_SWAPFRAME_DELAYMS);
                         switchFlag = false;
                     } else {
-                        if ((TlmPduCount % 10) == 0) { // every 10 adv packets switch the frame
+                        if((TlmPduCount % 10) == 0) { // every 10 adv packets switch the frame
                             switchFlag = true;
                         }
                     }
                     break;
             }
         }
+
+        return;
+    }
+
+    /*
+    *   This function explicityly sets the parameters used by the Eddystone beacon.
+    *   this function should be used in leu of the config service.
+    *
+    *   @param bleIn ble object used to broadcast eddystone information
+    *   @oaram beaconPeriodus is how often ble broadcasts are mde, in mili seconds
+    *   @param txPowerLevel sets the broadcasting power level.
+    *   @param uidNamespaceID 10Byte Namespace UUID
+    *   @param uidInstanceID  6Byte  Instance UUID
+    *   @param url shortened URL to broadcast (pass in as a string)
+    *   @param urlLen length of shortened url
+    *   @param tlmVersion version of telemetry data field to use (default to 0x00)
+    *
+    */
+    EddystoneService(BLEDevice       &bleIn,
+              uint16_t        beaconPeriodus = 100,
+              uint8_t         txPowerLevel = 0,
+              uint8_t *       uidNamespaceID = NULL,
+              uint8_t *       uidInstanceID = NULL,
+              const char *    url = NULL,
+              uint8_t         urlLen = 0,
+              uint8_t         tlmVersion = 0) :
+              ble(bleIn)
+    { 
+        uint8_t serviceData[SERVICE_DATA_MAX];
+        unsigned serviceDataLen = 0;
+        ERR("This function is not fully implemented yet, dont use it!!");
+        // Check optional frames, set their 'isSet' flags appropriately
+        if((uidNamespaceID != NULL) & (uidInstanceID != NULL)) {
+            uidIsSet = true;
+            setUIDFrameData(txPowerLevel,uidNamespaceID, uidInstanceID);
+        } else {
+            uidIsSet = false;
+        }
+        if(url != NULL) {
+            urlIsSet = true;
+            setURLFrameData(txPowerLevel,url);
+        } else {
+            uidIsSet = false;
+        }
+        // Default TLM frame to version 0x00, start all values at zero to be spec compliant.
+        setTLMFrameData(tlmVersion, 0x00,0x00);
+
+        // Initialize Frame transition
+        frameIndex = 0;
+        uidRFU = 0;
+        switchFlag = true;
+
+        /* Reinitialize the BLE stack. This will clear away the existing services and advertising state. */
+        ble.shutdown();
+        ble.init();
+        ble.setTxPower(txPowerLevel);
+        ble.setAdvertisingType(GapAdvertisingParams::ADV_NON_CONNECTABLE_UNDIRECTED);
+        ble.setAdvertisingInterval(beaconPeriodus);
+
+        // Make double sure the PDUCount and TimeSinceBoot fields are set to zero at reset
+        updateTlmPduCount(0);
+        updateTlmTimeSinceBoot(0);
+
+        // Construct TLM Frame in initial advertising.
+        serviceData[serviceDataLen++] = BEACON_EDDYSTONE[0];
+        serviceData[serviceDataLen++] = BEACON_EDDYSTONE[1];
+        serviceDataLen += constructTLMFrame(serviceData+serviceDataLen,SERVICE_DATA_MAX);
+
+        updateAdvPacket(serviceData, serviceDataLen);
+        ble.gap().startAdvertising();
+        ble.gap().onRadioNotification(this,&EddystoneService::radioNotificationCallback);
+        timeSinceBootTick.attach(this,&EddystoneService::tsbCallback,0.1); // incriment the TimeSinceBoot ticker every 0.1s
+
     }
 
 private:
-    BLEDevice         &ble;
-    Ticker            timeSinceBootTick;
-    Timeout           switchFrame;
-    // Default value that is restored on reset
-    size_t            defaultUriDataLength;
-    UriData_t         defaultUriData;
-    UIDNamespaceID_t  defaultUidNamespaceID;
-    UIDInstanceID_t   defaultUidInstanceID;
-    int8_t            defaultUidPower;
-    int8_t            defaultUrlPower;
-    unsigned          frameIndex;
-    uint16_t          uidRFU;
-    bool              uidIsSet;
-    bool              urlIsSet;
-    bool              switchFlag;
+
 
-    // Private Variables for Telemetry Data
-    uint8_t           TlmVersion;
-    volatile uint16_t TlmBatteryVoltage;
-    volatile uint16_t TlmBeaconTemp;
-    volatile uint32_t TlmPduCount;
-    volatile uint32_t TlmTimeSinceBoot;
+    BLEDevice           &ble;
+    Ticker              timeSinceBootTick;
+    Timeout             switchFrame;
+// Default value that is restored on reset
+    size_t              defaultUriDataLength;
+    UriData_t           defaultUriData;
+    UIDNamespaceID_t    defaultUidNamespaceID;
+    UIDInstanceID_t     defaultUidInstanceID;
+    int8_t              defaultUidPower;
+    int8_t              defaultUrlPower;
+    uint16_t            uidRFU;
+    bool                uidIsSet;
+    bool                urlIsSet;
+    bool switchFlag;
+
+// Private Variables for Telemetry Data
+    uint8_t                      TlmVersion;
+    volatile uint16_t            TlmBatteryVoltage;
+    volatile uint16_t            TlmBeaconTemp;
+    volatile uint32_t            TlmPduCount;
+    volatile uint32_t            TlmTimeSinceBoot;
 
 public:
     /*