Scott Jenson / Mbed 2 deprecated BLE_EddystoneBeaconConfigService_Button

Button initiated config service

Dependencies:   BLE_API_EddystoneConfigService_2 mbed nRF51822

Fork of BLE_EddystoneBeaconConfigService_3 by URIBeacon

EddystoneConfigService.h@23:05e9bb3b13af, 2015-07-23 (annotated)

Committer:
mbedAustin
Date:
Thu Jul 23 20:17:11 2015 +0000
Revision:
23:05e9bb3b13af
Child:
25:e20bed9e466f
Renamed ZipBeacon->Eddystone, everything compiles and continues to work just fine.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbedAustin 23:05e9bb3b13af 1 /* mbed Microcontroller Library
mbedAustin 23:05e9bb3b13af 2 * Copyright (c) 2006-2013 ARM Limited
mbedAustin 23:05e9bb3b13af 3 *
mbedAustin 23:05e9bb3b13af 4 * Licensed under the Apache License, Version 2.0 (the "License");
mbedAustin 23:05e9bb3b13af 5 * you may not use this file except in compliance with the License.
mbedAustin 23:05e9bb3b13af 6 * You may obtain a copy of the License at
mbedAustin 23:05e9bb3b13af 7 *
mbedAustin 23:05e9bb3b13af 8 * http://www.apache.org/licenses/LICENSE-2.0
mbedAustin 23:05e9bb3b13af 9 *
mbedAustin 23:05e9bb3b13af 10 * Unless required by applicable law or agreed to in writing, software
mbedAustin 23:05e9bb3b13af 11 * distributed under the License is distributed on an "AS IS" BASIS,
mbedAustin 23:05e9bb3b13af 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
mbedAustin 23:05e9bb3b13af 13 * See the License for the specific language governing permissions and
mbedAustin 23:05e9bb3b13af 14 * limitations under the License.
mbedAustin 23:05e9bb3b13af 15 */
mbedAustin 23:05e9bb3b13af 16
mbedAustin 23:05e9bb3b13af 17 #ifndef SERVICES_ZIPBEACONCONFIGSERVICE_H_
mbedAustin 23:05e9bb3b13af 18 #define SERVICES_ZIPBEACONCONFIGSERVICE_H_
mbedAustin 23:05e9bb3b13af 19
mbedAustin 23:05e9bb3b13af 20 #include "mbed.h"
mbedAustin 23:05e9bb3b13af 21 #include "ble/BLE.h"
mbedAustin 23:05e9bb3b13af 22
mbedAustin 23:05e9bb3b13af 23
mbedAustin 23:05e9bb3b13af 24 #define UUID_URI_BEACON(FIRST, SECOND) { \
mbedAustin 23:05e9bb3b13af 25 0xee, 0x0c, FIRST, SECOND, 0x87, 0x86, 0x40, 0xba, \
mbedAustin 23:05e9bb3b13af 26 0xab, 0x96, 0x99, 0xb9, 0x1a, 0xc9, 0x81, 0xd8, \
mbedAustin 23:05e9bb3b13af 27 }
mbedAustin 23:05e9bb3b13af 28
mbedAustin 23:05e9bb3b13af 29 static const uint8_t UUID_URI_BEACON_SERVICE[] = UUID_URI_BEACON(0x20, 0x80);
mbedAustin 23:05e9bb3b13af 30 static const uint8_t UUID_LOCK_STATE_CHAR[] = UUID_URI_BEACON(0x20, 0x81);
mbedAustin 23:05e9bb3b13af 31 static const uint8_t UUID_LOCK_CHAR[] = UUID_URI_BEACON(0x20, 0x82);
mbedAustin 23:05e9bb3b13af 32 static const uint8_t UUID_UNLOCK_CHAR[] = UUID_URI_BEACON(0x20, 0x83);
mbedAustin 23:05e9bb3b13af 33 static const uint8_t UUID_URI_DATA_CHAR[] = UUID_URI_BEACON(0x20, 0x84);
mbedAustin 23:05e9bb3b13af 34 static const uint8_t UUID_FLAGS_CHAR[] = UUID_URI_BEACON(0x20, 0x85);
mbedAustin 23:05e9bb3b13af 35 static const uint8_t UUID_ADV_POWER_LEVELS_CHAR[] = UUID_URI_BEACON(0x20, 0x86);
mbedAustin 23:05e9bb3b13af 36 static const uint8_t UUID_TX_POWER_MODE_CHAR[] = UUID_URI_BEACON(0x20, 0x87);
mbedAustin 23:05e9bb3b13af 37 static const uint8_t UUID_BEACON_PERIOD_CHAR[] = UUID_URI_BEACON(0x20, 0x88);
mbedAustin 23:05e9bb3b13af 38 static const uint8_t UUID_RESET_CHAR[] = UUID_URI_BEACON(0x20, 0x89);
mbedAustin 23:05e9bb3b13af 39 static const uint8_t BEACON_EDDYSTONE[] = {0xAA, 0xFE};
mbedAustin 23:05e9bb3b13af 40
mbedAustin 23:05e9bb3b13af 41 //Debug is disabled by default
mbedAustin 23:05e9bb3b13af 42 #if 0
mbedAustin 23:05e9bb3b13af 43 #define DBG(x, ...) printf("[EddyStone: DBG]"x" \t[%s,%d]\r\n", ##__VA_ARGS__,__FILE__,__LINE__);
mbedAustin 23:05e9bb3b13af 44 #define WARN(x, ...) printf("[EddyStone: WARN]"x" \t[%s,%d]\r\n", ##__VA_ARGS__,__FILE__,__LINE__);
mbedAustin 23:05e9bb3b13af 45 #define ERR(x, ...) printf("[EddyStone: ERR]"x" \t[%s,%d]\r\n", ##__VA_ARGS__,__FILE__,__LINE__);
mbedAustin 23:05e9bb3b13af 46 #else
mbedAustin 23:05e9bb3b13af 47 #define DBG(x, ...) //wait_us(10);
mbedAustin 23:05e9bb3b13af 48 #define WARN(x, ...) //wait_us(10);
mbedAustin 23:05e9bb3b13af 49 #define ERR(x, ...)
mbedAustin 23:05e9bb3b13af 50 #endif
mbedAustin 23:05e9bb3b13af 51
mbedAustin 23:05e9bb3b13af 52 /**
mbedAustin 23:05e9bb3b13af 53 * @class EddystoneConfigService
mbedAustin 23:05e9bb3b13af 54 * @brief Eddystone Configuration Service. Can be used to set URL, adjust power levels, and set flags.
mbedAustin 23:05e9bb3b13af 55 * See http://uribeacon.org
mbedAustin 23:05e9bb3b13af 56 *
mbedAustin 23:05e9bb3b13af 57 */
mbedAustin 23:05e9bb3b13af 58 class EddystoneConfigService
mbedAustin 23:05e9bb3b13af 59 {
mbedAustin 23:05e9bb3b13af 60 public:
mbedAustin 23:05e9bb3b13af 61 /**
mbedAustin 23:05e9bb3b13af 62 * @brief Transmission Power Modes for UriBeacon
mbedAustin 23:05e9bb3b13af 63 */
mbedAustin 23:05e9bb3b13af 64 static const uint8_t TX_POWER_MODE_LOWEST = 0; /*!< Lowest TX power mode */
mbedAustin 23:05e9bb3b13af 65 static const uint8_t TX_POWER_MODE_LOW = 1; /*!< Low TX power mode */
mbedAustin 23:05e9bb3b13af 66 static const uint8_t TX_POWER_MODE_MEDIUM = 2; /*!< Medium TX power mode */
mbedAustin 23:05e9bb3b13af 67 static const uint8_t TX_POWER_MODE_HIGH = 3; /*!< High TX power mode */
mbedAustin 23:05e9bb3b13af 68 static const unsigned int NUM_POWER_MODES = 4; /*!< Number of Power Modes defined */
mbedAustin 23:05e9bb3b13af 69
mbedAustin 23:05e9bb3b13af 70 static const int ADVERTISING_INTERVAL_MSEC = 1000; // Advertising interval for config service.
mbedAustin 23:05e9bb3b13af 71 static const int SERVICE_DATA_MAX = 31; // Maximum size of service data in ADV packets
mbedAustin 23:05e9bb3b13af 72
mbedAustin 23:05e9bb3b13af 73 typedef uint8_t Lock_t[16]; /* 128 bits */
mbedAustin 23:05e9bb3b13af 74 typedef int8_t PowerLevels_t[NUM_POWER_MODES];
mbedAustin 23:05e9bb3b13af 75
mbedAustin 23:05e9bb3b13af 76 // There are currently 3 subframes defined, URI, UID, and TLM
mbedAustin 23:05e9bb3b13af 77 #define EDDYSTONE_MAX_FRAMETYPE 3
mbedAustin 23:05e9bb3b13af 78 void (*frames[EDDYSTONE_MAX_FRAMETYPE])(uint8_t *, uint32_t);
mbedAustin 23:05e9bb3b13af 79 uint8_t frameIndex;
mbedAustin 23:05e9bb3b13af 80 static const int URI_DATA_MAX = 18;
mbedAustin 23:05e9bb3b13af 81 typedef uint8_t UriData_t[URI_DATA_MAX];
mbedAustin 23:05e9bb3b13af 82
mbedAustin 23:05e9bb3b13af 83 // UID Frame Type subfields
mbedAustin 23:05e9bb3b13af 84 static const int UID_NAMESPACEID_SIZE = 10;
mbedAustin 23:05e9bb3b13af 85 typedef uint8_t UIDNamespaceID_t[UID_NAMESPACEID_SIZE];
mbedAustin 23:05e9bb3b13af 86 static const int UID_INSTANCEID_SIZE = 6;
mbedAustin 23:05e9bb3b13af 87 typedef uint8_t UIDInstanceID_t[UID_INSTANCEID_SIZE];
mbedAustin 23:05e9bb3b13af 88
mbedAustin 23:05e9bb3b13af 89 // Eddystone Frame Type ID
mbedAustin 23:05e9bb3b13af 90 static const uint8_t FRAME_TYPE_UID = 0x00;
mbedAustin 23:05e9bb3b13af 91 static const uint8_t FRAME_TYPE_URL = 0x10;
mbedAustin 23:05e9bb3b13af 92 static const uint8_t FRAME_TYPE_TLM = 0x20;
mbedAustin 23:05e9bb3b13af 93
mbedAustin 23:05e9bb3b13af 94 static const uint8_t FRAME_SIZE_TLM = 14; // TLM frame is a constant 14Bytes
mbedAustin 23:05e9bb3b13af 95 static const uint8_t FRAME_SIZE_UID = 20; // includes RFU bytes
mbedAustin 23:05e9bb3b13af 96
mbedAustin 23:05e9bb3b13af 97 struct Params_t {
mbedAustin 23:05e9bb3b13af 98 Lock_t lock;
mbedAustin 23:05e9bb3b13af 99 uint8_t uriDataLength;
mbedAustin 23:05e9bb3b13af 100 UriData_t uriData;
mbedAustin 23:05e9bb3b13af 101 uint8_t flags;
mbedAustin 23:05e9bb3b13af 102 PowerLevels_t advPowerLevels; // Current value of AdvertisedPowerLevels
mbedAustin 23:05e9bb3b13af 103 uint8_t txPowerMode; // Firmware power levels used with setTxPower()
mbedAustin 23:05e9bb3b13af 104 uint16_t beaconPeriod;
mbedAustin 23:05e9bb3b13af 105 uint8_t tlmVersion; // version of TLM packet
mbedAustin 23:05e9bb3b13af 106 UIDNamespaceID_t uidNamespaceID; // UUID type, Namespace ID, 10B
mbedAustin 23:05e9bb3b13af 107 UIDInstanceID_t uidInstanceID; // UUID type, Instance ID, 6B
mbedAustin 23:05e9bb3b13af 108 };
mbedAustin 23:05e9bb3b13af 109
mbedAustin 23:05e9bb3b13af 110 /**
mbedAustin 23:05e9bb3b13af 111 * @param[ref] ble
mbedAustin 23:05e9bb3b13af 112 * BLEDevice object for the underlying controller.
mbedAustin 23:05e9bb3b13af 113 * @param[in/out] paramsIn
mbedAustin 23:05e9bb3b13af 114 * Reference to application-visible beacon state, loaded
mbedAustin 23:05e9bb3b13af 115 * from persistent storage at startup.
mbedAustin 23:05e9bb3b13af 116 * @paramsP[in] resetToDefaultsFlag
mbedAustin 23:05e9bb3b13af 117 * Applies to the state of the 'paramsIn' parameter.
mbedAustin 23:05e9bb3b13af 118 * If true, it indicates that paramsIn is potentially
mbedAustin 23:05e9bb3b13af 119 * un-initialized, and default values should be used
mbedAustin 23:05e9bb3b13af 120 * instead. Otherwise, paramsIn overrides the defaults.
mbedAustin 23:05e9bb3b13af 121 * @param[in] defaultUriDataIn
mbedAustin 23:05e9bb3b13af 122 * Default un-encoded URI; applies only if the resetToDefaultsFlag is true.
mbedAustin 23:05e9bb3b13af 123 * @param[in] defaultAdvPowerLevelsIn
mbedAustin 23:05e9bb3b13af 124 * Default power-levels array; applies only if the resetToDefaultsFlag is true.
mbedAustin 23:05e9bb3b13af 125 */
mbedAustin 23:05e9bb3b13af 126 EddystoneConfigService(BLEDevice &bleIn,
mbedAustin 23:05e9bb3b13af 127 Params_t &paramsIn,
mbedAustin 23:05e9bb3b13af 128 bool resetToDefaultsFlag,
mbedAustin 23:05e9bb3b13af 129 const char *defaultURIDataIn,
mbedAustin 23:05e9bb3b13af 130 PowerLevels_t &defaultAdvPowerLevelsIn) :
mbedAustin 23:05e9bb3b13af 131 ble(bleIn),
mbedAustin 23:05e9bb3b13af 132 params(paramsIn),
mbedAustin 23:05e9bb3b13af 133 defaultUriDataLength(),
mbedAustin 23:05e9bb3b13af 134 defaultUriData(),
mbedAustin 23:05e9bb3b13af 135 defaultAdvPowerLevels(defaultAdvPowerLevelsIn),
mbedAustin 23:05e9bb3b13af 136 initSucceeded(false),
mbedAustin 23:05e9bb3b13af 137 resetFlag(),
mbedAustin 23:05e9bb3b13af 138 lockedStateChar(UUID_LOCK_STATE_CHAR, &lockedState),
mbedAustin 23:05e9bb3b13af 139 lockChar(UUID_LOCK_CHAR, &params.lock),
mbedAustin 23:05e9bb3b13af 140 uriDataChar(UUID_URI_DATA_CHAR, params.uriData, 0, URI_DATA_MAX,
mbedAustin 23:05e9bb3b13af 141 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE),
mbedAustin 23:05e9bb3b13af 142 unlockChar(UUID_UNLOCK_CHAR, &params.lock),
mbedAustin 23:05e9bb3b13af 143 flagsChar(UUID_FLAGS_CHAR, &params.flags),
mbedAustin 23:05e9bb3b13af 144 advPowerLevelsChar(UUID_ADV_POWER_LEVELS_CHAR, &params.advPowerLevels),
mbedAustin 23:05e9bb3b13af 145 txPowerModeChar(UUID_TX_POWER_MODE_CHAR, &params.txPowerMode),
mbedAustin 23:05e9bb3b13af 146 beaconPeriodChar(UUID_BEACON_PERIOD_CHAR, &params.beaconPeriod),
mbedAustin 23:05e9bb3b13af 147 resetChar(UUID_RESET_CHAR, &resetFlag) {
mbedAustin 23:05e9bb3b13af 148
mbedAustin 23:05e9bb3b13af 149 encodeURI(defaultURIDataIn, defaultUriData, defaultUriDataLength); // encode URL to URL Formatting
mbedAustin 23:05e9bb3b13af 150 if (defaultUriDataLength > URI_DATA_MAX) {
mbedAustin 23:05e9bb3b13af 151 return;
mbedAustin 23:05e9bb3b13af 152 }
mbedAustin 23:05e9bb3b13af 153
mbedAustin 23:05e9bb3b13af 154 if (!resetToDefaultsFlag && (params.uriDataLength > URI_DATA_MAX)) {
mbedAustin 23:05e9bb3b13af 155 resetToDefaultsFlag = true;
mbedAustin 23:05e9bb3b13af 156 }
mbedAustin 23:05e9bb3b13af 157 if (resetToDefaultsFlag) {
mbedAustin 23:05e9bb3b13af 158 resetToDefaults();
mbedAustin 23:05e9bb3b13af 159 } else {
mbedAustin 23:05e9bb3b13af 160 updateCharacteristicValues();
mbedAustin 23:05e9bb3b13af 161 }
mbedAustin 23:05e9bb3b13af 162
mbedAustin 23:05e9bb3b13af 163 lockedState = isLocked();
mbedAustin 23:05e9bb3b13af 164
mbedAustin 23:05e9bb3b13af 165 lockChar.setWriteAuthorizationCallback(this, &EddystoneConfigService::lockAuthorizationCallback);
mbedAustin 23:05e9bb3b13af 166 unlockChar.setWriteAuthorizationCallback(this, &EddystoneConfigService::unlockAuthorizationCallback);
mbedAustin 23:05e9bb3b13af 167 uriDataChar.setWriteAuthorizationCallback(this, &EddystoneConfigService::uriDataWriteAuthorizationCallback);
mbedAustin 23:05e9bb3b13af 168 flagsChar.setWriteAuthorizationCallback(this, &EddystoneConfigService::basicAuthorizationCallback<uint8_t>);
mbedAustin 23:05e9bb3b13af 169 advPowerLevelsChar.setWriteAuthorizationCallback(this, &EddystoneConfigService::basicAuthorizationCallback<PowerLevels_t>);
mbedAustin 23:05e9bb3b13af 170 txPowerModeChar.setWriteAuthorizationCallback(this, &EddystoneConfigService::powerModeAuthorizationCallback);
mbedAustin 23:05e9bb3b13af 171 beaconPeriodChar.setWriteAuthorizationCallback(this, &EddystoneConfigService::basicAuthorizationCallback<uint16_t>);
mbedAustin 23:05e9bb3b13af 172 resetChar.setWriteAuthorizationCallback(this, &EddystoneConfigService::basicAuthorizationCallback<uint8_t>);
mbedAustin 23:05e9bb3b13af 173
mbedAustin 23:05e9bb3b13af 174 static GattCharacteristic *charTable[] = {
mbedAustin 23:05e9bb3b13af 175 &lockedStateChar, &lockChar, &unlockChar, &uriDataChar,
mbedAustin 23:05e9bb3b13af 176 &flagsChar, &advPowerLevelsChar, &txPowerModeChar, &beaconPeriodChar, &resetChar
mbedAustin 23:05e9bb3b13af 177 };
mbedAustin 23:05e9bb3b13af 178
mbedAustin 23:05e9bb3b13af 179 GattService configService(UUID_URI_BEACON_SERVICE, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));
mbedAustin 23:05e9bb3b13af 180
mbedAustin 23:05e9bb3b13af 181 ble.addService(configService);
mbedAustin 23:05e9bb3b13af 182 ble.onDataWritten(this, &EddystoneConfigService::onDataWrittenCallback);
mbedAustin 23:05e9bb3b13af 183
mbedAustin 23:05e9bb3b13af 184 setupEddystoneConfigAdvertisements(); /* Setup advertising for the configService. */
mbedAustin 23:05e9bb3b13af 185
mbedAustin 23:05e9bb3b13af 186 initSucceeded = true;
mbedAustin 23:05e9bb3b13af 187 }
mbedAustin 23:05e9bb3b13af 188
mbedAustin 23:05e9bb3b13af 189 bool configuredSuccessfully(void) const {
mbedAustin 23:05e9bb3b13af 190 return initSucceeded;
mbedAustin 23:05e9bb3b13af 191 }
mbedAustin 23:05e9bb3b13af 192
mbedAustin 23:05e9bb3b13af 193 /* Start out by advertising the configService for a limited time after
mbedAustin 23:05e9bb3b13af 194 * startup; and switch to the normal non-connectible beacon functionality
mbedAustin 23:05e9bb3b13af 195 * afterwards. */
mbedAustin 23:05e9bb3b13af 196 void setupEddystoneConfigAdvertisements() {
mbedAustin 23:05e9bb3b13af 197 const char DEVICE_NAME[] = "eddystone Config";
mbedAustin 23:05e9bb3b13af 198
mbedAustin 23:05e9bb3b13af 199 ble.clearAdvertisingPayload();
mbedAustin 23:05e9bb3b13af 200
mbedAustin 23:05e9bb3b13af 201 ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
mbedAustin 23:05e9bb3b13af 202
mbedAustin 23:05e9bb3b13af 203 // UUID is in different order in the ADV frame (!)
mbedAustin 23:05e9bb3b13af 204 uint8_t reversedServiceUUID[sizeof(UUID_URI_BEACON_SERVICE)];
mbedAustin 23:05e9bb3b13af 205 for (unsigned int i = 0; i < sizeof(UUID_URI_BEACON_SERVICE); i++) {
mbedAustin 23:05e9bb3b13af 206 reversedServiceUUID[i] = UUID_URI_BEACON_SERVICE[sizeof(UUID_URI_BEACON_SERVICE) - i - 1];
mbedAustin 23:05e9bb3b13af 207 }
mbedAustin 23:05e9bb3b13af 208 ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS, reversedServiceUUID, sizeof(reversedServiceUUID));
mbedAustin 23:05e9bb3b13af 209 ble.accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_TAG);
mbedAustin 23:05e9bb3b13af 210 ble.accumulateScanResponse(GapAdvertisingData::COMPLETE_LOCAL_NAME, reinterpret_cast<const uint8_t *>(&DEVICE_NAME), sizeof(DEVICE_NAME));
mbedAustin 23:05e9bb3b13af 211 ble.accumulateScanResponse(
mbedAustin 23:05e9bb3b13af 212 GapAdvertisingData::TX_POWER_LEVEL,
mbedAustin 23:05e9bb3b13af 213 reinterpret_cast<uint8_t *>(&defaultAdvPowerLevels[EddystoneConfigService::TX_POWER_MODE_LOW]),
mbedAustin 23:05e9bb3b13af 214 sizeof(uint8_t));
mbedAustin 23:05e9bb3b13af 215
mbedAustin 23:05e9bb3b13af 216 ble.setTxPower(params.advPowerLevels[params.txPowerMode]);
mbedAustin 23:05e9bb3b13af 217 ble.setDeviceName(reinterpret_cast<const uint8_t *>(&DEVICE_NAME));
mbedAustin 23:05e9bb3b13af 218 ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
mbedAustin 23:05e9bb3b13af 219 ble.setAdvertisingInterval(Gap::MSEC_TO_ADVERTISEMENT_DURATION_UNITS(ADVERTISING_INTERVAL_MSEC));
mbedAustin 23:05e9bb3b13af 220 }
mbedAustin 23:05e9bb3b13af 221
mbedAustin 23:05e9bb3b13af 222 /*
mbedAustin 23:05e9bb3b13af 223 * Set Eddystone UID Frame information.
mbedAustin 23:05e9bb3b13af 224 * @param[in] power TX Power in dB measured at 0 meters from the device. Range of -100 to +20 dB.
mbedAustin 23:05e9bb3b13af 225 * @param namespaceID 10B namespace ID
mbedAustin 23:05e9bb3b13af 226 * @param instanceID 6B instance ID
mbedAustin 23:05e9bb3b13af 227 * @param RFU 2B of RFU, initialized to 0x0000 and not broadcast, included for future reference.
mbedAustin 23:05e9bb3b13af 228 *
mbedAustin 23:05e9bb3b13af 229 */
mbedAustin 23:05e9bb3b13af 230 void setUIDFrameData(int8_t power, UIDNamespaceID_t namespaceID, UIDInstanceID_t instanceID, uint16_t RFU = 0x0000) {
mbedAustin 23:05e9bb3b13af 231 if(power > 20) {
mbedAustin 23:05e9bb3b13af 232 power = 20;
mbedAustin 23:05e9bb3b13af 233 }
mbedAustin 23:05e9bb3b13af 234 if(power < -100) {
mbedAustin 23:05e9bb3b13af 235 power = -100;
mbedAustin 23:05e9bb3b13af 236 }
mbedAustin 23:05e9bb3b13af 237 defaultUidPower = power;
mbedAustin 23:05e9bb3b13af 238 memcpy(defaultUidNamespaceID, namespaceID, UID_NAMESPACEID_SIZE);
mbedAustin 23:05e9bb3b13af 239 memcpy(defaultUidInstanceID, instanceID, UID_INSTANCEID_SIZE);
mbedAustin 23:05e9bb3b13af 240 uidRFU = (uint16_t)RFU; // this is probably bad form, but it doesnt really matter yet.
mbedAustin 23:05e9bb3b13af 241 return;
mbedAustin 23:05e9bb3b13af 242 }
mbedAustin 23:05e9bb3b13af 243
mbedAustin 23:05e9bb3b13af 244 /*
mbedAustin 23:05e9bb3b13af 245 * Construct UID frame from private variables
mbedAustin 23:05e9bb3b13af 246 * @param[in/out] Data pointer to array to store constructed frame in
mbedAustin 23:05e9bb3b13af 247 * @param[in] maxSize number of bytes left in array, effectively how much emtpy space is available to write to
mbedAustin 23:05e9bb3b13af 248 * @return number of bytes used. negative number indicates error message.
mbedAustin 23:05e9bb3b13af 249 */
mbedAustin 23:05e9bb3b13af 250 int constructUIDFrame(uint8_t * Data, uint8_t maxSize) {
mbedAustin 23:05e9bb3b13af 251
mbedAustin 23:05e9bb3b13af 252 int index = 0;
mbedAustin 23:05e9bb3b13af 253 Data[index++] = FRAME_TYPE_UID; // 1B Type
mbedAustin 23:05e9bb3b13af 254 if(defaultUidPower > 20) {
mbedAustin 23:05e9bb3b13af 255 defaultUidPower = 20; // enforce range of vaild values.
mbedAustin 23:05e9bb3b13af 256 }
mbedAustin 23:05e9bb3b13af 257 if(defaultUidPower < -100) {
mbedAustin 23:05e9bb3b13af 258 defaultUidPower = -100;
mbedAustin 23:05e9bb3b13af 259 }
mbedAustin 23:05e9bb3b13af 260 Data[index++] = defaultUidPower; // 1B Power @ 0meter
mbedAustin 23:05e9bb3b13af 261 for(int x = 0; x < UID_NAMESPACEID_SIZE; x++) { // 10B Namespce ID
mbedAustin 23:05e9bb3b13af 262 Data[index++] = defaultUidNamespaceID[x];
mbedAustin 23:05e9bb3b13af 263 }
mbedAustin 23:05e9bb3b13af 264 for(int x = 0; x< UID_INSTANCEID_SIZE; x++) { // 6B Instance ID
mbedAustin 23:05e9bb3b13af 265 Data[index++] = defaultUidInstanceID[x];
mbedAustin 23:05e9bb3b13af 266 }
mbedAustin 23:05e9bb3b13af 267 if(0 != uidRFU) { // 2B RFU, include if non-zero, otherwise ignore
mbedAustin 23:05e9bb3b13af 268 Data[index++] = (uint8_t)(uidRFU >> 0);
mbedAustin 23:05e9bb3b13af 269 Data[index++] = (uint8_t)(uidRFU >> 8);
mbedAustin 23:05e9bb3b13af 270 }
mbedAustin 23:05e9bb3b13af 271 DBG("construcUIDFrame %d, %d",maxSize,index);
mbedAustin 23:05e9bb3b13af 272 return index;
mbedAustin 23:05e9bb3b13af 273 }
mbedAustin 23:05e9bb3b13af 274
mbedAustin 23:05e9bb3b13af 275 /*
mbedAustin 23:05e9bb3b13af 276 * Set Eddystone URL Frame information.
mbedAustin 23:05e9bb3b13af 277 * @param[in] power TX Power in dB measured at 0 meters from the device.
mbedAustin 23:05e9bb3b13af 278 * @param url URL to encode
mbedAustin 23:05e9bb3b13af 279 * @return false on success, true on failure.
mbedAustin 23:05e9bb3b13af 280 */
mbedAustin 23:05e9bb3b13af 281 bool setURLFrameData(int8_t power, const char * url) {
mbedAustin 23:05e9bb3b13af 282 defaultUrlPower = power;
mbedAustin 23:05e9bb3b13af 283 encodeURI(url, defaultUriData, defaultUriDataLength); // encode URL to URL Formatting
mbedAustin 23:05e9bb3b13af 284 if (defaultUriDataLength > URI_DATA_MAX) {
mbedAustin 23:05e9bb3b13af 285 return true; // error, URL is too big
mbedAustin 23:05e9bb3b13af 286 }
mbedAustin 23:05e9bb3b13af 287 return false;
mbedAustin 23:05e9bb3b13af 288 }
mbedAustin 23:05e9bb3b13af 289
mbedAustin 23:05e9bb3b13af 290 /*
mbedAustin 23:05e9bb3b13af 291 * Construct URL frame from private variables
mbedAustin 23:05e9bb3b13af 292 * @param[in/out] Data pointer to array to store constructed frame in
mbedAustin 23:05e9bb3b13af 293 * @param[in] maxSize number of bytes left in array, effectively how much emtpy space is available to write to
mbedAustin 23:05e9bb3b13af 294 * @return number of bytes used. negative number indicates error message.
mbedAustin 23:05e9bb3b13af 295 */
mbedAustin 23:05e9bb3b13af 296 int constructURLFrame(uint8_t * Data, uint8_t maxSize) {
mbedAustin 23:05e9bb3b13af 297 int index = 0;
mbedAustin 23:05e9bb3b13af 298 Data[index++] = FRAME_TYPE_URL; // 1B Type
mbedAustin 23:05e9bb3b13af 299 Data[index++] = params.txPowerMode; // 1B TX Power
mbedAustin 23:05e9bb3b13af 300 for(int x = 0; x < defaultUriDataLength; x++) { // 18B of URL Prefix + encoded URL
mbedAustin 23:05e9bb3b13af 301 Data[index++] = defaultUriData[x];
mbedAustin 23:05e9bb3b13af 302 }
mbedAustin 23:05e9bb3b13af 303 DBG("constructURLFrame: %d, %d",maxSize,index);
mbedAustin 23:05e9bb3b13af 304 return index;
mbedAustin 23:05e9bb3b13af 305 }
mbedAustin 23:05e9bb3b13af 306
mbedAustin 23:05e9bb3b13af 307 /*
mbedAustin 23:05e9bb3b13af 308 * Set Eddystone TLM Frame information.
mbedAustin 23:05e9bb3b13af 309 * @param[in] Version of the TLM beacon data format
mbedAustin 23:05e9bb3b13af 310 * @param batteryVoltage in milivolts
mbedAustin 23:05e9bb3b13af 311 * @param beaconTemp in 8.8 floating point notation
mbedAustin 23:05e9bb3b13af 312 *
mbedAustin 23:05e9bb3b13af 313 */
mbedAustin 23:05e9bb3b13af 314 void setTLMFrameData(uint8_t version, uint16_t batteryVoltage, uint16_t beaconTemp, uint32_t pduCount = 0, uint32_t timeSinceBoot = 0) {
mbedAustin 23:05e9bb3b13af 315 TlmVersion = version;
mbedAustin 23:05e9bb3b13af 316 TlmBatteryVoltage = batteryVoltage;
mbedAustin 23:05e9bb3b13af 317 TlmBeaconTemp = beaconTemp;
mbedAustin 23:05e9bb3b13af 318 TlmPduCount = pduCount; // reset
mbedAustin 23:05e9bb3b13af 319 TlmTimeSinceBoot = timeSinceBoot; // reset
mbedAustin 23:05e9bb3b13af 320 return;
mbedAustin 23:05e9bb3b13af 321 }
mbedAustin 23:05e9bb3b13af 322
mbedAustin 23:05e9bb3b13af 323 /*
mbedAustin 23:05e9bb3b13af 324 * Construct TLM frame from private variables
mbedAustin 23:05e9bb3b13af 325 * @param[in/out] Data pointer to array to store constructed frame in
mbedAustin 23:05e9bb3b13af 326 * @param[in] maxSize number of bytes left in array, effectively how much emtpy space is available to write to
mbedAustin 23:05e9bb3b13af 327 * @return number of bytes used. negative number indicates error message.
mbedAustin 23:05e9bb3b13af 328 */
mbedAustin 23:05e9bb3b13af 329 int constructTLMFrame(uint8_t * Data, uint8_t maxSize) {
mbedAustin 23:05e9bb3b13af 330 int index = 0;
mbedAustin 23:05e9bb3b13af 331 Data[index++] = FRAME_TYPE_TLM; // Eddystone frame type = Telemetry
mbedAustin 23:05e9bb3b13af 332 Data[index++] = TlmVersion; // TLM Version Number
mbedAustin 23:05e9bb3b13af 333 Data[index++] = (uint8_t)(TlmBatteryVoltage>>8); // Battery Voltage[0]
mbedAustin 23:05e9bb3b13af 334 Data[index++] = (uint8_t)(TlmBatteryVoltage>>0); // Battery Voltage[1]
mbedAustin 23:05e9bb3b13af 335 Data[index++] = (uint8_t)(TlmBeaconTemp>>8); // Beacon Temp[0]
mbedAustin 23:05e9bb3b13af 336 Data[index++] = (uint8_t)(TlmBeaconTemp>>0); // Beacon Temp[1]
mbedAustin 23:05e9bb3b13af 337 Data[index++] = (uint8_t)(TlmPduCount>>24); // PDU Count [0]
mbedAustin 23:05e9bb3b13af 338 Data[index++] = (uint8_t)(TlmPduCount>>16); // PDU Count [1]
mbedAustin 23:05e9bb3b13af 339 Data[index++] = (uint8_t)(TlmPduCount>>8); // PDU Count [2]
mbedAustin 23:05e9bb3b13af 340 Data[index++] = (uint8_t)(TlmPduCount>>0); // PDU Count [3]
mbedAustin 23:05e9bb3b13af 341 Data[index++] = (uint8_t)(TlmTimeSinceBoot>>24); // Time Since Boot [0]
mbedAustin 23:05e9bb3b13af 342 Data[index++] = (uint8_t)(TlmTimeSinceBoot>>16); // Time Since Boot [1]
mbedAustin 23:05e9bb3b13af 343 Data[index++] = (uint8_t)(TlmTimeSinceBoot>>8); // Time Since Boot [2]
mbedAustin 23:05e9bb3b13af 344 Data[index++] = (uint8_t)(TlmTimeSinceBoot>>0); // Time Since Boot [3]
mbedAustin 23:05e9bb3b13af 345 DBG("constructURLFrame: %d, %d",maxSize,index);
mbedAustin 23:05e9bb3b13af 346 return index;
mbedAustin 23:05e9bb3b13af 347 }
mbedAustin 23:05e9bb3b13af 348
mbedAustin 23:05e9bb3b13af 349 /*
mbedAustin 23:05e9bb3b13af 350 * Update the TLM frame battery voltage value
mbedAustin 23:05e9bb3b13af 351 * @param[in] voltagemv Voltage to update the TLM field battery voltage with (in mV)
mbedAustin 23:05e9bb3b13af 352 * @return nothing
mbedAustin 23:05e9bb3b13af 353 */
mbedAustin 23:05e9bb3b13af 354 void updateTlmBatteryVoltage(uint16_t voltagemv) {
mbedAustin 23:05e9bb3b13af 355 TlmBatteryVoltage = voltagemv;
mbedAustin 23:05e9bb3b13af 356 return;
mbedAustin 23:05e9bb3b13af 357 }
mbedAustin 23:05e9bb3b13af 358
mbedAustin 23:05e9bb3b13af 359 /*
mbedAustin 23:05e9bb3b13af 360 * Update the TLM frame beacon temperature
mbedAustin 23:05e9bb3b13af 361 * @param[in] temp Temperature of beacon (in 8.8fpn)
mbedAustin 23:05e9bb3b13af 362 * @return nothing
mbedAustin 23:05e9bb3b13af 363 */
mbedAustin 23:05e9bb3b13af 364 void updateTlmBeaconTemp(uint16_t temp) {
mbedAustin 23:05e9bb3b13af 365 TlmBeaconTemp = temp;
mbedAustin 23:05e9bb3b13af 366 return;
mbedAustin 23:05e9bb3b13af 367 }
mbedAustin 23:05e9bb3b13af 368
mbedAustin 23:05e9bb3b13af 369 /*
mbedAustin 23:05e9bb3b13af 370 * Update the TLM frame PDU Count field
mbedAustin 23:05e9bb3b13af 371 * @param[in] pduCount Number of Advertisiting frames sent since powerup
mbedAustin 23:05e9bb3b13af 372 * @return nothing
mbedAustin 23:05e9bb3b13af 373 */
mbedAustin 23:05e9bb3b13af 374 void updateTlmPduCount(uint32_t pduCount) {
mbedAustin 23:05e9bb3b13af 375 TlmPduCount = pduCount;
mbedAustin 23:05e9bb3b13af 376 return;
mbedAustin 23:05e9bb3b13af 377 }
mbedAustin 23:05e9bb3b13af 378
mbedAustin 23:05e9bb3b13af 379 /*
mbedAustin 23:05e9bb3b13af 380 * Update the TLM frame Time since boot in 0.1s incriments
mbedAustin 23:05e9bb3b13af 381 * @param[in] timeSinceBoot Time since boot in 0.1s incriments
mbedAustin 23:05e9bb3b13af 382 * @return nothing
mbedAustin 23:05e9bb3b13af 383 */
mbedAustin 23:05e9bb3b13af 384 void updateTlmTimeSinceBoot(uint32_t timeSinceBoot) {
mbedAustin 23:05e9bb3b13af 385 TlmTimeSinceBoot = timeSinceBoot;
mbedAustin 23:05e9bb3b13af 386 return;
mbedAustin 23:05e9bb3b13af 387 }
mbedAustin 23:05e9bb3b13af 388
mbedAustin 23:05e9bb3b13af 389 /*
mbedAustin 23:05e9bb3b13af 390 * callback function, called every 0.1s, incriments the TimeSinceBoot field in the TLM frame
mbedAustin 23:05e9bb3b13af 391 * @return nothing
mbedAustin 23:05e9bb3b13af 392 */
mbedAustin 23:05e9bb3b13af 393 void tsbCallback(void) {
mbedAustin 23:05e9bb3b13af 394 TlmTimeSinceBoot++;
mbedAustin 23:05e9bb3b13af 395 }
mbedAustin 23:05e9bb3b13af 396
mbedAustin 23:05e9bb3b13af 397 /*
mbedAustin 23:05e9bb3b13af 398 * Update advertising data
mbedAustin 23:05e9bb3b13af 399 * @return true on success, false on failure
mbedAustin 23:05e9bb3b13af 400 */
mbedAustin 23:05e9bb3b13af 401 bool updateAdvPacket(uint8_t serviceData[], unsigned serviceDataLen) {
mbedAustin 23:05e9bb3b13af 402 // Fields from the Service
mbedAustin 23:05e9bb3b13af 403 DBG("Updating AdvFrame: %d", serviceDataLen);
mbedAustin 23:05e9bb3b13af 404 // printf("\r\n");
mbedAustin 23:05e9bb3b13af 405 // for(int x = 0; x<serviceDataLen; x++) {
mbedAustin 23:05e9bb3b13af 406 // printf("%2.2x:",serviceData[x]);
mbedAustin 23:05e9bb3b13af 407 // }
mbedAustin 23:05e9bb3b13af 408 // printf("\r\n");
mbedAustin 23:05e9bb3b13af 409 ble.clearAdvertisingPayload();
mbedAustin 23:05e9bb3b13af 410 ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
mbedAustin 23:05e9bb3b13af 411 ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, BEACON_EDDYSTONE, sizeof(BEACON_EDDYSTONE));
mbedAustin 23:05e9bb3b13af 412 ble.accumulateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA, serviceData, serviceDataLen);
mbedAustin 23:05e9bb3b13af 413
mbedAustin 23:05e9bb3b13af 414 return true;
mbedAustin 23:05e9bb3b13af 415 }
mbedAustin 23:05e9bb3b13af 416
mbedAustin 23:05e9bb3b13af 417 /*
mbedAustin 23:05e9bb3b13af 418 * State machine for switching out frames.
mbedAustin 23:05e9bb3b13af 419 * This function is called by the radioNotificationCallback when a frame needs to get swapped out.
mbedAustin 23:05e9bb3b13af 420 * This function exists because of time constraints in the radioNotificationCallback, so it is effectively
mbedAustin 23:05e9bb3b13af 421 * broken up into two functions.
mbedAustin 23:05e9bb3b13af 422 */
mbedAustin 23:05e9bb3b13af 423 void swapOutFrames(void) {
mbedAustin 23:05e9bb3b13af 424 uint8_t serviceData[SERVICE_DATA_MAX];
mbedAustin 23:05e9bb3b13af 425 unsigned serviceDataLen = 0;
mbedAustin 23:05e9bb3b13af 426 //hard code in the eddystone UUID
mbedAustin 23:05e9bb3b13af 427 serviceData[serviceDataLen++] = BEACON_EDDYSTONE[0];
mbedAustin 23:05e9bb3b13af 428 serviceData[serviceDataLen++] = BEACON_EDDYSTONE[1];
mbedAustin 23:05e9bb3b13af 429
mbedAustin 23:05e9bb3b13af 430 switch(frameIndex) {
mbedAustin 23:05e9bb3b13af 431 case 0:
mbedAustin 23:05e9bb3b13af 432 // TLM frame
mbedAustin 23:05e9bb3b13af 433 serviceDataLen += constructTLMFrame(serviceData+serviceDataLen,20);
mbedAustin 23:05e9bb3b13af 434 DBG("\t Swapping in TLM Frame: len=%d",serviceDataLen);
mbedAustin 23:05e9bb3b13af 435 updateAdvPacket(serviceData,serviceDataLen);
mbedAustin 23:05e9bb3b13af 436 frameIndex++;
mbedAustin 23:05e9bb3b13af 437 break;
mbedAustin 23:05e9bb3b13af 438 case 1:
mbedAustin 23:05e9bb3b13af 439 // URL Frame
mbedAustin 23:05e9bb3b13af 440 serviceDataLen += constructURLFrame(serviceData+serviceDataLen,20);
mbedAustin 23:05e9bb3b13af 441 DBG("\t Swapping in URL Frame: len=%d ",serviceDataLen);
mbedAustin 23:05e9bb3b13af 442 updateAdvPacket(serviceData,serviceDataLen);
mbedAustin 23:05e9bb3b13af 443 switchFlag = false;
mbedAustin 23:05e9bb3b13af 444 frameIndex++;
mbedAustin 23:05e9bb3b13af 445 break;
mbedAustin 23:05e9bb3b13af 446 case 2:
mbedAustin 23:05e9bb3b13af 447 // UID Frame
mbedAustin 23:05e9bb3b13af 448 serviceDataLen += constructUIDFrame(serviceData+serviceDataLen,20);
mbedAustin 23:05e9bb3b13af 449 DBG("\t Swapping in UID Frame: len=%d",serviceDataLen);
mbedAustin 23:05e9bb3b13af 450 updateAdvPacket(serviceData,serviceDataLen);
mbedAustin 23:05e9bb3b13af 451 switchFlag = false;
mbedAustin 23:05e9bb3b13af 452 frameIndex++;
mbedAustin 23:05e9bb3b13af 453 break;
mbedAustin 23:05e9bb3b13af 454 }
mbedAustin 23:05e9bb3b13af 455 }
mbedAustin 23:05e9bb3b13af 456
mbedAustin 23:05e9bb3b13af 457 /*
mbedAustin 23:05e9bb3b13af 458 * Callback from onRadioNotification(), used to update the PDUCounter and process next state.
mbedAustin 23:05e9bb3b13af 459 */
mbedAustin 23:05e9bb3b13af 460 #define EDDYSTONE_SWAPFRAME_DELAYMS 1
mbedAustin 23:05e9bb3b13af 461 void radioNotificationCallback(bool radioActive) {
mbedAustin 23:05e9bb3b13af 462 //DBG("RadioNotificationCallback : %d, %d, %d, %d",radioActive,frameIndex,TlmPduCount,TlmTimeSinceBoot);
mbedAustin 23:05e9bb3b13af 463 // Update PDUCount
mbedAustin 23:05e9bb3b13af 464 TlmPduCount++;
mbedAustin 23:05e9bb3b13af 465 frameIndex = frameIndex % EDDYSTONE_MAX_FRAMETYPE;
mbedAustin 23:05e9bb3b13af 466
mbedAustin 23:05e9bb3b13af 467
mbedAustin 23:05e9bb3b13af 468 // True just before an frame is sent, fale just after a frame is sent
mbedAustin 23:05e9bb3b13af 469 if(radioActive) {
mbedAustin 23:05e9bb3b13af 470 // Do Nothing
mbedAustin 23:05e9bb3b13af 471 } else {
mbedAustin 23:05e9bb3b13af 472 // state machine to control which packet is being sent
mbedAustin 23:05e9bb3b13af 473 switch(frameIndex) {
mbedAustin 23:05e9bb3b13af 474 case 0:
mbedAustin 23:05e9bb3b13af 475 switchFrame.attach_us(this, &EddystoneConfigService::swapOutFrames, EDDYSTONE_SWAPFRAME_DELAYMS);
mbedAustin 23:05e9bb3b13af 476 switchFlag = true;
mbedAustin 23:05e9bb3b13af 477 break;
mbedAustin 23:05e9bb3b13af 478 case 1:
mbedAustin 23:05e9bb3b13af 479 // switch out packets
mbedAustin 23:05e9bb3b13af 480 if(switchFlag) {
mbedAustin 23:05e9bb3b13af 481 switchFrame.attach_us(this, &EddystoneConfigService::swapOutFrames, EDDYSTONE_SWAPFRAME_DELAYMS);
mbedAustin 23:05e9bb3b13af 482 switchFlag = false;
mbedAustin 23:05e9bb3b13af 483 } else {
mbedAustin 23:05e9bb3b13af 484 if((TlmPduCount % 10) == 0) { // every 10 adv packets switch the frame
mbedAustin 23:05e9bb3b13af 485 switchFlag = true;
mbedAustin 23:05e9bb3b13af 486 }
mbedAustin 23:05e9bb3b13af 487 }
mbedAustin 23:05e9bb3b13af 488 break;
mbedAustin 23:05e9bb3b13af 489 case 2:
mbedAustin 23:05e9bb3b13af 490 // switch out packets
mbedAustin 23:05e9bb3b13af 491 if(switchFlag) {
mbedAustin 23:05e9bb3b13af 492 switchFrame.attach_us(this, &EddystoneConfigService::swapOutFrames, EDDYSTONE_SWAPFRAME_DELAYMS);
mbedAustin 23:05e9bb3b13af 493 switchFlag = false;
mbedAustin 23:05e9bb3b13af 494 } else {
mbedAustin 23:05e9bb3b13af 495 if((TlmPduCount % 10) == 0) { // every 10 adv packets switch the frame
mbedAustin 23:05e9bb3b13af 496 switchFlag = true;
mbedAustin 23:05e9bb3b13af 497 }
mbedAustin 23:05e9bb3b13af 498 }
mbedAustin 23:05e9bb3b13af 499 break;
mbedAustin 23:05e9bb3b13af 500 }
mbedAustin 23:05e9bb3b13af 501 }
mbedAustin 23:05e9bb3b13af 502
mbedAustin 23:05e9bb3b13af 503 return;
mbedAustin 23:05e9bb3b13af 504 }
mbedAustin 23:05e9bb3b13af 505
mbedAustin 23:05e9bb3b13af 506 /* Helper function to switch to the non-connectible normal mode for Eddystone. This gets called after a timeout. */
mbedAustin 23:05e9bb3b13af 507 void setupEddystoneAdvertisements() {
mbedAustin 23:05e9bb3b13af 508 DBG("Switching Config -> adv");
mbedAustin 23:05e9bb3b13af 509 uint8_t serviceData[SERVICE_DATA_MAX];
mbedAustin 23:05e9bb3b13af 510 unsigned serviceDataLen = 0;
mbedAustin 23:05e9bb3b13af 511 unsigned beaconPeriod = params.beaconPeriod;
mbedAustin 23:05e9bb3b13af 512 unsigned txPowerMode = params.txPowerMode;
mbedAustin 23:05e9bb3b13af 513 unsigned uriDataLength = params.uriDataLength;
mbedAustin 23:05e9bb3b13af 514
mbedAustin 23:05e9bb3b13af 515 EddystoneConfigService::UriData_t &uriData = params.uriData;
mbedAustin 23:05e9bb3b13af 516 EddystoneConfigService::PowerLevels_t &advPowerLevels = params.advPowerLevels;
mbedAustin 23:05e9bb3b13af 517
mbedAustin 23:05e9bb3b13af 518 // Initialize Frame transition
mbedAustin 23:05e9bb3b13af 519 frameIndex = 2;
mbedAustin 23:05e9bb3b13af 520 uidRFU = 0;
mbedAustin 23:05e9bb3b13af 521 switchFlag = true;
mbedAustin 23:05e9bb3b13af 522
mbedAustin 23:05e9bb3b13af 523
mbedAustin 23:05e9bb3b13af 524 /* Reinitialize the BLE stack. This will clear away the existing services and advertising state. */
mbedAustin 23:05e9bb3b13af 525 ble.shutdown();
mbedAustin 23:05e9bb3b13af 526 ble.init();
mbedAustin 23:05e9bb3b13af 527 ble.setTxPower(params.advPowerLevels[params.txPowerMode]);
mbedAustin 23:05e9bb3b13af 528 ble.setAdvertisingType(GapAdvertisingParams::ADV_NON_CONNECTABLE_UNDIRECTED);
mbedAustin 23:05e9bb3b13af 529 ble.setAdvertisingInterval(beaconPeriod);
mbedAustin 23:05e9bb3b13af 530 extern void saveURIBeaconConfigParams(const Params_t *paramsP); /* forward declaration; necessary to avoid a circular dependency. */
mbedAustin 23:05e9bb3b13af 531 saveURIBeaconConfigParams(&params);
mbedAustin 23:05e9bb3b13af 532
mbedAustin 23:05e9bb3b13af 533 setTLMFrameData(0x00,0x2222,0x3333,0x01,0x02); // Initialize TLM Data, for testing, remove for release
mbedAustin 23:05e9bb3b13af 534 updateTlmPduCount(0);
mbedAustin 23:05e9bb3b13af 535 updateTlmTimeSinceBoot(0);
mbedAustin 23:05e9bb3b13af 536
mbedAustin 23:05e9bb3b13af 537 // Construct TLM Frame in initial advertising.
mbedAustin 23:05e9bb3b13af 538 serviceData[serviceDataLen++] = BEACON_EDDYSTONE[0];
mbedAustin 23:05e9bb3b13af 539 serviceData[serviceDataLen++] = BEACON_EDDYSTONE[1];
mbedAustin 23:05e9bb3b13af 540 serviceDataLen += constructURLFrame(serviceData+serviceDataLen,SERVICE_DATA_MAX);
mbedAustin 23:05e9bb3b13af 541
mbedAustin 23:05e9bb3b13af 542 updateAdvPacket(serviceData, serviceDataLen);
mbedAustin 23:05e9bb3b13af 543 ble.gap().startAdvertising();
mbedAustin 23:05e9bb3b13af 544 ble.gap().onRadioNotification(this,&EddystoneConfigService::radioNotificationCallback);
mbedAustin 23:05e9bb3b13af 545 timeSinceBootTick.attach(this,&EddystoneConfigService::tsbCallback,0.1); // incriment the TimeSinceBoot ticker every 0.1s
mbedAustin 23:05e9bb3b13af 546 }
mbedAustin 23:05e9bb3b13af 547
mbedAustin 23:05e9bb3b13af 548 private:
mbedAustin 23:05e9bb3b13af 549 // True if the lock bits are non-zero
mbedAustin 23:05e9bb3b13af 550 bool isLocked() {
mbedAustin 23:05e9bb3b13af 551 Lock_t testLock;
mbedAustin 23:05e9bb3b13af 552 memset(testLock, 0, sizeof(Lock_t));
mbedAustin 23:05e9bb3b13af 553 return memcmp(params.lock, testLock, sizeof(Lock_t));
mbedAustin 23:05e9bb3b13af 554 }
mbedAustin 23:05e9bb3b13af 555
mbedAustin 23:05e9bb3b13af 556 /*
mbedAustin 23:05e9bb3b13af 557 * This callback is invoked when a GATT client attempts to modify any of the
mbedAustin 23:05e9bb3b13af 558 * characteristics of this service. Attempts to do so are also applied to
mbedAustin 23:05e9bb3b13af 559 * the internal state of this service object.
mbedAustin 23:05e9bb3b13af 560 */
mbedAustin 23:05e9bb3b13af 561 void onDataWrittenCallback(const GattWriteCallbackParams *writeParams) {
mbedAustin 23:05e9bb3b13af 562 uint16_t handle = writeParams->handle;
mbedAustin 23:05e9bb3b13af 563
mbedAustin 23:05e9bb3b13af 564 if (handle == lockChar.getValueHandle()) {
mbedAustin 23:05e9bb3b13af 565 // Validated earlier
mbedAustin 23:05e9bb3b13af 566 memcpy(params.lock, writeParams->data, sizeof(Lock_t));
mbedAustin 23:05e9bb3b13af 567 // use isLocked() in case bits are being set to all 0's
mbedAustin 23:05e9bb3b13af 568 lockedState = isLocked();
mbedAustin 23:05e9bb3b13af 569 } else if (handle == unlockChar.getValueHandle()) {
mbedAustin 23:05e9bb3b13af 570 // Validated earlier
mbedAustin 23:05e9bb3b13af 571 memset(params.lock, 0, sizeof(Lock_t));
mbedAustin 23:05e9bb3b13af 572 lockedState = false;
mbedAustin 23:05e9bb3b13af 573 } else if (handle == uriDataChar.getValueHandle()) {
mbedAustin 23:05e9bb3b13af 574 params.uriDataLength = writeParams->len;
mbedAustin 23:05e9bb3b13af 575 memcpy(params.uriData, writeParams->data, params.uriDataLength);
mbedAustin 23:05e9bb3b13af 576 } else if (handle == flagsChar.getValueHandle()) {
mbedAustin 23:05e9bb3b13af 577 params.flags = *(writeParams->data);
mbedAustin 23:05e9bb3b13af 578 } else if (handle == advPowerLevelsChar.getValueHandle()) {
mbedAustin 23:05e9bb3b13af 579 memcpy(params.advPowerLevels, writeParams->data, sizeof(PowerLevels_t));
mbedAustin 23:05e9bb3b13af 580 } else if (handle == txPowerModeChar.getValueHandle()) {
mbedAustin 23:05e9bb3b13af 581 params.txPowerMode = *(writeParams->data);
mbedAustin 23:05e9bb3b13af 582 } else if (handle == beaconPeriodChar.getValueHandle()) {
mbedAustin 23:05e9bb3b13af 583 params.beaconPeriod = *((uint16_t *)(writeParams->data));
mbedAustin 23:05e9bb3b13af 584
mbedAustin 23:05e9bb3b13af 585 /* Re-map beaconPeriod to within permissible bounds if necessary. */
mbedAustin 23:05e9bb3b13af 586 if (params.beaconPeriod != 0) {
mbedAustin 23:05e9bb3b13af 587 bool paramsUpdated = false;
mbedAustin 23:05e9bb3b13af 588 if (params.beaconPeriod < ble.getMinAdvertisingInterval()) {
mbedAustin 23:05e9bb3b13af 589 params.beaconPeriod = ble.getMinAdvertisingInterval();
mbedAustin 23:05e9bb3b13af 590 paramsUpdated = true;
mbedAustin 23:05e9bb3b13af 591 } else if (params.beaconPeriod > ble.getMaxAdvertisingInterval()) {
mbedAustin 23:05e9bb3b13af 592 params.beaconPeriod = ble.getMaxAdvertisingInterval();
mbedAustin 23:05e9bb3b13af 593 paramsUpdated = true;
mbedAustin 23:05e9bb3b13af 594 }
mbedAustin 23:05e9bb3b13af 595 if (paramsUpdated) {
mbedAustin 23:05e9bb3b13af 596 ble.updateCharacteristicValue(beaconPeriodChar.getValueHandle(), reinterpret_cast<uint8_t *>(&params.beaconPeriod), sizeof(uint16_t));
mbedAustin 23:05e9bb3b13af 597 }
mbedAustin 23:05e9bb3b13af 598 }
mbedAustin 23:05e9bb3b13af 599 } else if (handle == resetChar.getValueHandle()) {
mbedAustin 23:05e9bb3b13af 600 resetToDefaults();
mbedAustin 23:05e9bb3b13af 601 }
mbedAustin 23:05e9bb3b13af 602 }
mbedAustin 23:05e9bb3b13af 603
mbedAustin 23:05e9bb3b13af 604 /*
mbedAustin 23:05e9bb3b13af 605 * Reset the default values.
mbedAustin 23:05e9bb3b13af 606 */
mbedAustin 23:05e9bb3b13af 607 void resetToDefaults(void) {
mbedAustin 23:05e9bb3b13af 608 lockedState = false;
mbedAustin 23:05e9bb3b13af 609 memset(params.lock, 0, sizeof(Lock_t));
mbedAustin 23:05e9bb3b13af 610 memcpy(params.uriData, defaultUriData, URI_DATA_MAX);
mbedAustin 23:05e9bb3b13af 611 params.uriDataLength = defaultUriDataLength;
mbedAustin 23:05e9bb3b13af 612 params.flags = 0;
mbedAustin 23:05e9bb3b13af 613 memcpy(params.advPowerLevels, defaultAdvPowerLevels, sizeof(PowerLevels_t));
mbedAustin 23:05e9bb3b13af 614 params.txPowerMode = TX_POWER_MODE_LOW;
mbedAustin 23:05e9bb3b13af 615 params.beaconPeriod = 1000;
mbedAustin 23:05e9bb3b13af 616 memcpy(params.uidNamespaceID, defaultUidNamespaceID, UID_NAMESPACEID_SIZE);
mbedAustin 23:05e9bb3b13af 617 memcpy(params.uidInstanceID, defaultUidInstanceID, UID_INSTANCEID_SIZE);
mbedAustin 23:05e9bb3b13af 618 params.tlmVersion = 0;
mbedAustin 23:05e9bb3b13af 619 updateCharacteristicValues();
mbedAustin 23:05e9bb3b13af 620 }
mbedAustin 23:05e9bb3b13af 621
mbedAustin 23:05e9bb3b13af 622 /*
mbedAustin 23:05e9bb3b13af 623 * Internal helper function used to update the GATT database following any
mbedAustin 23:05e9bb3b13af 624 * change to the internal state of the service object.
mbedAustin 23:05e9bb3b13af 625 */
mbedAustin 23:05e9bb3b13af 626 void updateCharacteristicValues(void) {
mbedAustin 23:05e9bb3b13af 627 ble.updateCharacteristicValue(lockedStateChar.getValueHandle(), &lockedState, 1);
mbedAustin 23:05e9bb3b13af 628 ble.updateCharacteristicValue(uriDataChar.getValueHandle(), params.uriData, params.uriDataLength);
mbedAustin 23:05e9bb3b13af 629 ble.updateCharacteristicValue(flagsChar.getValueHandle(), &params.flags, 1);
mbedAustin 23:05e9bb3b13af 630 ble.updateCharacteristicValue(beaconPeriodChar.getValueHandle(),
mbedAustin 23:05e9bb3b13af 631 reinterpret_cast<uint8_t *>(&params.beaconPeriod), sizeof(uint16_t));
mbedAustin 23:05e9bb3b13af 632 ble.updateCharacteristicValue(txPowerModeChar.getValueHandle(), &params.txPowerMode, 1);
mbedAustin 23:05e9bb3b13af 633 ble.updateCharacteristicValue(advPowerLevelsChar.getValueHandle(),
mbedAustin 23:05e9bb3b13af 634 reinterpret_cast<uint8_t *>(params.advPowerLevels), sizeof(PowerLevels_t));
mbedAustin 23:05e9bb3b13af 635 }
mbedAustin 23:05e9bb3b13af 636
mbedAustin 23:05e9bb3b13af 637 private:
mbedAustin 23:05e9bb3b13af 638 void lockAuthorizationCallback(GattWriteAuthCallbackParams *authParams) {
mbedAustin 23:05e9bb3b13af 639 if (lockedState) {
mbedAustin 23:05e9bb3b13af 640 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION;
mbedAustin 23:05e9bb3b13af 641 } else if (authParams->len != sizeof(Lock_t)) {
mbedAustin 23:05e9bb3b13af 642 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_ATT_VAL_LENGTH;
mbedAustin 23:05e9bb3b13af 643 } else if (authParams->offset != 0) {
mbedAustin 23:05e9bb3b13af 644 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET;
mbedAustin 23:05e9bb3b13af 645 } else {
mbedAustin 23:05e9bb3b13af 646 authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS;
mbedAustin 23:05e9bb3b13af 647 }
mbedAustin 23:05e9bb3b13af 648 }
mbedAustin 23:05e9bb3b13af 649
mbedAustin 23:05e9bb3b13af 650
mbedAustin 23:05e9bb3b13af 651 void unlockAuthorizationCallback(GattWriteAuthCallbackParams *authParams) {
mbedAustin 23:05e9bb3b13af 652 if (!lockedState) {
mbedAustin 23:05e9bb3b13af 653 authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS;
mbedAustin 23:05e9bb3b13af 654 } else if (authParams->len != sizeof(Lock_t)) {
mbedAustin 23:05e9bb3b13af 655 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_ATT_VAL_LENGTH;
mbedAustin 23:05e9bb3b13af 656 } else if (authParams->offset != 0) {
mbedAustin 23:05e9bb3b13af 657 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET;
mbedAustin 23:05e9bb3b13af 658 } else if (memcmp(authParams->data, params.lock, sizeof(Lock_t)) != 0) {
mbedAustin 23:05e9bb3b13af 659 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION;
mbedAustin 23:05e9bb3b13af 660 } else {
mbedAustin 23:05e9bb3b13af 661 authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS;
mbedAustin 23:05e9bb3b13af 662 }
mbedAustin 23:05e9bb3b13af 663 }
mbedAustin 23:05e9bb3b13af 664
mbedAustin 23:05e9bb3b13af 665 void uriDataWriteAuthorizationCallback(GattWriteAuthCallbackParams *authParams) {
mbedAustin 23:05e9bb3b13af 666 if (lockedState) {
mbedAustin 23:05e9bb3b13af 667 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION;
mbedAustin 23:05e9bb3b13af 668 } else if (authParams->offset != 0) {
mbedAustin 23:05e9bb3b13af 669 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET;
mbedAustin 23:05e9bb3b13af 670 } else {
mbedAustin 23:05e9bb3b13af 671 authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS;
mbedAustin 23:05e9bb3b13af 672 }
mbedAustin 23:05e9bb3b13af 673 }
mbedAustin 23:05e9bb3b13af 674
mbedAustin 23:05e9bb3b13af 675 void powerModeAuthorizationCallback(GattWriteAuthCallbackParams *authParams) {
mbedAustin 23:05e9bb3b13af 676 if (lockedState) {
mbedAustin 23:05e9bb3b13af 677 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION;
mbedAustin 23:05e9bb3b13af 678 } else if (authParams->len != sizeof(uint8_t)) {
mbedAustin 23:05e9bb3b13af 679 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_ATT_VAL_LENGTH;
mbedAustin 23:05e9bb3b13af 680 } else if (authParams->offset != 0) {
mbedAustin 23:05e9bb3b13af 681 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET;
mbedAustin 23:05e9bb3b13af 682 } else if (*((uint8_t *)authParams->data) >= NUM_POWER_MODES) {
mbedAustin 23:05e9bb3b13af 683 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_WRITE_NOT_PERMITTED;
mbedAustin 23:05e9bb3b13af 684 } else {
mbedAustin 23:05e9bb3b13af 685 authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS;
mbedAustin 23:05e9bb3b13af 686 }
mbedAustin 23:05e9bb3b13af 687 }
mbedAustin 23:05e9bb3b13af 688
mbedAustin 23:05e9bb3b13af 689 template <typename T>
mbedAustin 23:05e9bb3b13af 690 void basicAuthorizationCallback(GattWriteAuthCallbackParams *authParams) {
mbedAustin 23:05e9bb3b13af 691 if (lockedState) {
mbedAustin 23:05e9bb3b13af 692 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION;
mbedAustin 23:05e9bb3b13af 693 } else if (authParams->len != sizeof(T)) {
mbedAustin 23:05e9bb3b13af 694 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_ATT_VAL_LENGTH;
mbedAustin 23:05e9bb3b13af 695 } else if (authParams->offset != 0) {
mbedAustin 23:05e9bb3b13af 696 authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET;
mbedAustin 23:05e9bb3b13af 697 } else {
mbedAustin 23:05e9bb3b13af 698 authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS;
mbedAustin 23:05e9bb3b13af 699 }
mbedAustin 23:05e9bb3b13af 700 }
mbedAustin 23:05e9bb3b13af 701
mbedAustin 23:05e9bb3b13af 702 BLEDevice &ble;
mbedAustin 23:05e9bb3b13af 703 Params_t &params;
mbedAustin 23:05e9bb3b13af 704 Ticker callbackTick;
mbedAustin 23:05e9bb3b13af 705 Ticker timeSinceBootTick;
mbedAustin 23:05e9bb3b13af 706 Timeout switchFrame;
mbedAustin 23:05e9bb3b13af 707 // Default value that is restored on reset
mbedAustin 23:05e9bb3b13af 708 size_t defaultUriDataLength;
mbedAustin 23:05e9bb3b13af 709 UriData_t defaultUriData;
mbedAustin 23:05e9bb3b13af 710 UIDNamespaceID_t defaultUidNamespaceID;
mbedAustin 23:05e9bb3b13af 711 UIDInstanceID_t defaultUidInstanceID;
mbedAustin 23:05e9bb3b13af 712 int8_t defaultUidPower;
mbedAustin 23:05e9bb3b13af 713 int8_t defaultUrlPower;
mbedAustin 23:05e9bb3b13af 714 uint16_t uidRFU;
mbedAustin 23:05e9bb3b13af 715 // Default value that is restored on reset
mbedAustin 23:05e9bb3b13af 716 PowerLevels_t &defaultAdvPowerLevels;
mbedAustin 23:05e9bb3b13af 717 uint8_t lockedState;
mbedAustin 23:05e9bb3b13af 718 bool initSucceeded;
mbedAustin 23:05e9bb3b13af 719 uint8_t resetFlag;
mbedAustin 23:05e9bb3b13af 720 bool switchFlag;
mbedAustin 23:05e9bb3b13af 721
mbedAustin 23:05e9bb3b13af 722 // Private Variables for Telemetry Data
mbedAustin 23:05e9bb3b13af 723 uint8_t TlmVersion;
mbedAustin 23:05e9bb3b13af 724 volatile uint16_t TlmBatteryVoltage;
mbedAustin 23:05e9bb3b13af 725 volatile uint16_t TlmBeaconTemp;
mbedAustin 23:05e9bb3b13af 726 volatile uint32_t TlmPduCount;
mbedAustin 23:05e9bb3b13af 727 volatile uint32_t TlmTimeSinceBoot;
mbedAustin 23:05e9bb3b13af 728
mbedAustin 23:05e9bb3b13af 729 ReadOnlyGattCharacteristic<uint8_t> lockedStateChar;
mbedAustin 23:05e9bb3b13af 730 WriteOnlyGattCharacteristic<Lock_t> lockChar;
mbedAustin 23:05e9bb3b13af 731 GattCharacteristic uriDataChar;
mbedAustin 23:05e9bb3b13af 732 WriteOnlyGattCharacteristic<Lock_t> unlockChar;
mbedAustin 23:05e9bb3b13af 733 ReadWriteGattCharacteristic<uint8_t> flagsChar;
mbedAustin 23:05e9bb3b13af 734 ReadWriteGattCharacteristic<PowerLevels_t> advPowerLevelsChar;
mbedAustin 23:05e9bb3b13af 735 ReadWriteGattCharacteristic<uint8_t> txPowerModeChar;
mbedAustin 23:05e9bb3b13af 736 ReadWriteGattCharacteristic<uint16_t> beaconPeriodChar;
mbedAustin 23:05e9bb3b13af 737 WriteOnlyGattCharacteristic<uint8_t> resetChar;
mbedAustin 23:05e9bb3b13af 738
mbedAustin 23:05e9bb3b13af 739 public:
mbedAustin 23:05e9bb3b13af 740 /*
mbedAustin 23:05e9bb3b13af 741 * Encode a human-readable URI into the binary format defined by URIBeacon spec (https://github.com/google/uribeacon/tree/master/specification).
mbedAustin 23:05e9bb3b13af 742 */
mbedAustin 23:05e9bb3b13af 743 static void encodeURI(const char *uriDataIn, UriData_t uriDataOut, size_t &sizeofURIDataOut) {
mbedAustin 23:05e9bb3b13af 744 const char *prefixes[] = {
mbedAustin 23:05e9bb3b13af 745 "http://www.",
mbedAustin 23:05e9bb3b13af 746 "https://www.",
mbedAustin 23:05e9bb3b13af 747 "http://",
mbedAustin 23:05e9bb3b13af 748 "https://",
mbedAustin 23:05e9bb3b13af 749 };
mbedAustin 23:05e9bb3b13af 750 const size_t NUM_PREFIXES = sizeof(prefixes) / sizeof(char *);
mbedAustin 23:05e9bb3b13af 751 const char *suffixes[] = {
mbedAustin 23:05e9bb3b13af 752 ".com/",
mbedAustin 23:05e9bb3b13af 753 ".org/",
mbedAustin 23:05e9bb3b13af 754 ".edu/",
mbedAustin 23:05e9bb3b13af 755 ".net/",
mbedAustin 23:05e9bb3b13af 756 ".info/",
mbedAustin 23:05e9bb3b13af 757 ".biz/",
mbedAustin 23:05e9bb3b13af 758 ".gov/",
mbedAustin 23:05e9bb3b13af 759 ".com",
mbedAustin 23:05e9bb3b13af 760 ".org",
mbedAustin 23:05e9bb3b13af 761 ".edu",
mbedAustin 23:05e9bb3b13af 762 ".net",
mbedAustin 23:05e9bb3b13af 763 ".info",
mbedAustin 23:05e9bb3b13af 764 ".biz",
mbedAustin 23:05e9bb3b13af 765 ".gov"
mbedAustin 23:05e9bb3b13af 766 };
mbedAustin 23:05e9bb3b13af 767 const size_t NUM_SUFFIXES = sizeof(suffixes) / sizeof(char *);
mbedAustin 23:05e9bb3b13af 768
mbedAustin 23:05e9bb3b13af 769 sizeofURIDataOut = 0;
mbedAustin 23:05e9bb3b13af 770 memset(uriDataOut, 0, sizeof(UriData_t));
mbedAustin 23:05e9bb3b13af 771
mbedAustin 23:05e9bb3b13af 772 if ((uriDataIn == NULL) || (strlen(uriDataIn) == 0)) {
mbedAustin 23:05e9bb3b13af 773 return;
mbedAustin 23:05e9bb3b13af 774 }
mbedAustin 23:05e9bb3b13af 775
mbedAustin 23:05e9bb3b13af 776 /*
mbedAustin 23:05e9bb3b13af 777 * handle prefix
mbedAustin 23:05e9bb3b13af 778 */
mbedAustin 23:05e9bb3b13af 779 for (unsigned i = 0; i < NUM_PREFIXES; i++) {
mbedAustin 23:05e9bb3b13af 780 size_t prefixLen = strlen(prefixes[i]);
mbedAustin 23:05e9bb3b13af 781 if (strncmp(uriDataIn, prefixes[i], prefixLen) == 0) {
mbedAustin 23:05e9bb3b13af 782 uriDataOut[sizeofURIDataOut++] = i;
mbedAustin 23:05e9bb3b13af 783 uriDataIn += prefixLen;
mbedAustin 23:05e9bb3b13af 784 break;
mbedAustin 23:05e9bb3b13af 785 }
mbedAustin 23:05e9bb3b13af 786 }
mbedAustin 23:05e9bb3b13af 787
mbedAustin 23:05e9bb3b13af 788 /*
mbedAustin 23:05e9bb3b13af 789 * handle suffixes
mbedAustin 23:05e9bb3b13af 790 */
mbedAustin 23:05e9bb3b13af 791 while (*uriDataIn && (sizeofURIDataOut < URI_DATA_MAX)) {
mbedAustin 23:05e9bb3b13af 792 /* check for suffix match */
mbedAustin 23:05e9bb3b13af 793 unsigned i;
mbedAustin 23:05e9bb3b13af 794 for (i = 0; i < NUM_SUFFIXES; i++) {
mbedAustin 23:05e9bb3b13af 795 size_t suffixLen = strlen(suffixes[i]);
mbedAustin 23:05e9bb3b13af 796 if (strncmp(uriDataIn, suffixes[i], suffixLen) == 0) {
mbedAustin 23:05e9bb3b13af 797 uriDataOut[sizeofURIDataOut++] = i;
mbedAustin 23:05e9bb3b13af 798 uriDataIn += suffixLen;
mbedAustin 23:05e9bb3b13af 799 break; /* from the for loop for checking against suffixes */
mbedAustin 23:05e9bb3b13af 800 }
mbedAustin 23:05e9bb3b13af 801 }
mbedAustin 23:05e9bb3b13af 802 /* This is the default case where we've got an ordinary character which doesn't match a suffix. */
mbedAustin 23:05e9bb3b13af 803 if (i == NUM_SUFFIXES) {
mbedAustin 23:05e9bb3b13af 804 uriDataOut[sizeofURIDataOut++] = *uriDataIn;
mbedAustin 23:05e9bb3b13af 805 ++uriDataIn;
mbedAustin 23:05e9bb3b13af 806 }
mbedAustin 23:05e9bb3b13af 807 }
mbedAustin 23:05e9bb3b13af 808 }
mbedAustin 23:05e9bb3b13af 809 };
mbedAustin 23:05e9bb3b13af 810
mbedAustin 23:05e9bb3b13af 811 #endif // SERVICES_ZIPBEACONCONFIGSERVICE_H_