Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
ble/services/URIBeaconConfigService.h@1042:21a86ac7f5b1, 2016-01-11 (annotated)
- Committer:
- vcoubard
- Date:
- Mon Jan 11 08:51:25 2016 +0000
- Revision:
- 1042:21a86ac7f5b1
- Parent:
- 1029:a5d0fec3b17c
- Child:
- 1053:ec4a5b9b254e
Synchronized with git rev 582789ea
Author: Vincent Coubard
Add function template makeFunctionPointer wich help to create
FunctionPointerWithContext<ContextType> instances.
Who changed what in which revision?
| User | Revision | Line number | New contents of line | 
|---|---|---|---|
| rgrover1 | 712:b04b5db36865 | 1 | /* mbed Microcontroller Library | 
| rgrover1 | 712:b04b5db36865 | 2 | * Copyright (c) 2006-2013 ARM Limited | 
| rgrover1 | 712:b04b5db36865 | 3 | * | 
| rgrover1 | 712:b04b5db36865 | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); | 
| rgrover1 | 712:b04b5db36865 | 5 | * you may not use this file except in compliance with the License. | 
| rgrover1 | 712:b04b5db36865 | 6 | * You may obtain a copy of the License at | 
| rgrover1 | 712:b04b5db36865 | 7 | * | 
| rgrover1 | 712:b04b5db36865 | 8 | * http://www.apache.org/licenses/LICENSE-2.0 | 
| rgrover1 | 712:b04b5db36865 | 9 | * | 
| rgrover1 | 712:b04b5db36865 | 10 | * Unless required by applicable law or agreed to in writing, software | 
| rgrover1 | 712:b04b5db36865 | 11 | * distributed under the License is distributed on an "AS IS" BASIS, | 
| rgrover1 | 712:b04b5db36865 | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. | 
| rgrover1 | 712:b04b5db36865 | 13 | * See the License for the specific language governing permissions and | 
| rgrover1 | 712:b04b5db36865 | 14 | * limitations under the License. | 
| rgrover1 | 712:b04b5db36865 | 15 | */ | 
| rgrover1 | 712:b04b5db36865 | 16 | |
| rgrover1 | 712:b04b5db36865 | 17 | #ifndef SERVICES_URIBEACONCONFIGSERVICE_H_ | 
| rgrover1 | 712:b04b5db36865 | 18 | #define SERVICES_URIBEACONCONFIGSERVICE_H_ | 
| rgrover1 | 712:b04b5db36865 | 19 | |
| rgrover1 | 712:b04b5db36865 | 20 | #include "ble/BLE.h" | 
| rgrover1 | 912:f728aa46e7df | 21 | |
| rgrover1 | 912:f728aa46e7df | 22 | #ifdef YOTTA_CFG_MBED_OS | 
| rgrover1 | 912:f728aa46e7df | 23 | #include "mbed-drivers/mbed.h" | 
| rgrover1 | 912:f728aa46e7df | 24 | #else | 
| rgrover1 | 712:b04b5db36865 | 25 | #include "mbed.h" | 
| rgrover1 | 912:f728aa46e7df | 26 | #endif | 
| rgrover1 | 712:b04b5db36865 | 27 | |
| rgrover1 | 712:b04b5db36865 | 28 | extern const uint8_t UUID_URI_BEACON_SERVICE[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 29 | extern const uint8_t UUID_LOCK_STATE_CHAR[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 30 | extern const uint8_t UUID_LOCK_CHAR[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 31 | extern const uint8_t UUID_UNLOCK_CHAR[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 32 | extern const uint8_t UUID_URI_DATA_CHAR[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 33 | extern const uint8_t UUID_FLAGS_CHAR[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 34 | extern const uint8_t UUID_ADV_POWER_LEVELS_CHAR[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 35 | extern const uint8_t UUID_TX_POWER_MODE_CHAR[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 36 | extern const uint8_t UUID_BEACON_PERIOD_CHAR[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 37 | extern const uint8_t UUID_RESET_CHAR[UUID::LENGTH_OF_LONG_UUID]; | 
| rgrover1 | 712:b04b5db36865 | 38 | |
| rgrover1 | 712:b04b5db36865 | 39 | extern const uint8_t BEACON_UUID[sizeof(UUID::ShortUUIDBytes_t)]; | 
| rgrover1 | 712:b04b5db36865 | 40 | |
| rgrover1 | 712:b04b5db36865 | 41 | /** | 
| rgrover1 | 712:b04b5db36865 | 42 | * @class URIBeaconConfigService | 
| rgrover1 | 712:b04b5db36865 | 43 | * @brief UriBeacon Configuration Service. Can be used to set URL, adjust power levels, and set flags. | 
| rgrover1 | 712:b04b5db36865 | 44 | * See http://uribeacon.org | 
| rgrover1 | 712:b04b5db36865 | 45 | * | 
| rgrover1 | 712:b04b5db36865 | 46 | */ | 
| rgrover1 | 712:b04b5db36865 | 47 | class URIBeaconConfigService { | 
| rgrover1 | 712:b04b5db36865 | 48 | public: | 
| rgrover1 | 712:b04b5db36865 | 49 | /** | 
| vcoubard | 1042:21a86ac7f5b1 | 50 | * @brief Transmission Power Modes for UriBeacon | 
| rgrover1 | 712:b04b5db36865 | 51 | */ | 
| vcoubard | 1042:21a86ac7f5b1 | 52 | static const uint8_t TX_POWER_MODE_LOWEST = 0; /*!< Lowest TX power mode */ | 
| vcoubard | 1042:21a86ac7f5b1 | 53 | static const uint8_t TX_POWER_MODE_LOW = 1; /*!< Low TX power mode */ | 
| vcoubard | 1042:21a86ac7f5b1 | 54 | static const uint8_t TX_POWER_MODE_MEDIUM = 2; /*!< Medium TX power mode */ | 
| vcoubard | 1042:21a86ac7f5b1 | 55 | static const uint8_t TX_POWER_MODE_HIGH = 3; /*!< High TX power mode */ | 
| vcoubard | 1042:21a86ac7f5b1 | 56 | static const unsigned NUM_POWER_MODES = 4; /*!< Number of Power Modes defined */ | 
| rgrover1 | 712:b04b5db36865 | 57 | |
| rgrover1 | 712:b04b5db36865 | 58 | static const int ADVERTISING_INTERVAL_MSEC = 1000; // Advertising interval for config service. | 
| vcoubard | 1042:21a86ac7f5b1 | 59 | static const int SERVICE_DATA_MAX = 31; // Maximum size of service data in ADV packets | 
| rgrover1 | 712:b04b5db36865 | 60 | |
| vcoubard | 1042:21a86ac7f5b1 | 61 | typedef uint8_t Lock_t[16]; /* 128 bits */ | 
| rgrover1 | 712:b04b5db36865 | 62 | typedef int8_t PowerLevels_t[NUM_POWER_MODES]; | 
| rgrover1 | 712:b04b5db36865 | 63 | |
| rgrover1 | 712:b04b5db36865 | 64 | static const int URI_DATA_MAX = 18; | 
| rgrover1 | 712:b04b5db36865 | 65 | typedef uint8_t UriData_t[URI_DATA_MAX]; | 
| rgrover1 | 712:b04b5db36865 | 66 | |
| rgrover1 | 712:b04b5db36865 | 67 | struct Params_t { | 
| rgrover1 | 712:b04b5db36865 | 68 | Lock_t lock; | 
| rgrover1 | 712:b04b5db36865 | 69 | uint8_t uriDataLength; | 
| rgrover1 | 712:b04b5db36865 | 70 | UriData_t uriData; | 
| rgrover1 | 712:b04b5db36865 | 71 | uint8_t flags; | 
| vcoubard | 1042:21a86ac7f5b1 | 72 | PowerLevels_t advPowerLevels; // Current value of AdvertisedPowerLevels | 
| vcoubard | 1042:21a86ac7f5b1 | 73 | uint8_t txPowerMode; // Firmware power levels used with setTxPower() | 
| rgrover1 | 712:b04b5db36865 | 74 | uint16_t beaconPeriod; | 
| rgrover1 | 712:b04b5db36865 | 75 | }; | 
| rgrover1 | 712:b04b5db36865 | 76 | |
| rgrover1 | 712:b04b5db36865 | 77 | /** | 
| rgrover1 | 712:b04b5db36865 | 78 | * @param[ref] ble | 
| rgrover1 | 712:b04b5db36865 | 79 | * BLE object for the underlying controller. | 
| rgrover1 | 712:b04b5db36865 | 80 | * @param[in/out] paramsIn | 
| rgrover1 | 712:b04b5db36865 | 81 | * Reference to application-visible beacon state, loaded | 
| rgrover1 | 712:b04b5db36865 | 82 | * from persistent storage at startup. | 
| rgrover1 | 712:b04b5db36865 | 83 | * @paramsP[in] resetToDefaultsFlag | 
| rgrover1 | 712:b04b5db36865 | 84 | * Applies to the state of the 'paramsIn' parameter. | 
| rgrover1 | 712:b04b5db36865 | 85 | * If true, it indicates that paramsIn is potentially | 
| rgrover1 | 712:b04b5db36865 | 86 | * un-initialized, and default values should be used | 
| rgrover1 | 712:b04b5db36865 | 87 | * instead. Otherwise, paramsIn overrides the defaults. | 
| rgrover1 | 712:b04b5db36865 | 88 | * @param[in] defaultUriDataIn | 
| vcoubard | 1042:21a86ac7f5b1 | 89 | * Default un-encoded URI; applies only if the resetToDefaultsFlag is true. | 
| rgrover1 | 712:b04b5db36865 | 90 | * @param[in] defaultAdvPowerLevelsIn | 
| vcoubard | 1042:21a86ac7f5b1 | 91 | * Default power-levels array; applies only if the resetToDefaultsFlag is true. | 
| rgrover1 | 712:b04b5db36865 | 92 | */ | 
| rgrover1 | 712:b04b5db36865 | 93 | URIBeaconConfigService(BLE &bleIn, | 
| rgrover1 | 712:b04b5db36865 | 94 | Params_t ¶msIn, | 
| rgrover1 | 712:b04b5db36865 | 95 | bool resetToDefaultsFlag, | 
| rgrover1 | 712:b04b5db36865 | 96 | const char *defaultURIDataIn, | 
| rgrover1 | 712:b04b5db36865 | 97 | PowerLevels_t &defaultAdvPowerLevelsIn) : | 
| rgrover1 | 712:b04b5db36865 | 98 | ble(bleIn), | 
| rgrover1 | 712:b04b5db36865 | 99 | params(paramsIn), | 
| rgrover1 | 712:b04b5db36865 | 100 | defaultUriDataLength(), | 
| rgrover1 | 712:b04b5db36865 | 101 | defaultUriData(), | 
| rgrover1 | 712:b04b5db36865 | 102 | defaultAdvPowerLevels(defaultAdvPowerLevelsIn), | 
| rgrover1 | 712:b04b5db36865 | 103 | initSucceeded(false), | 
| rgrover1 | 712:b04b5db36865 | 104 | resetFlag(), | 
| rgrover1 | 712:b04b5db36865 | 105 | lockedStateChar(UUID_LOCK_STATE_CHAR, &lockedState), | 
| rgrover1 | 712:b04b5db36865 | 106 | lockChar(UUID_LOCK_CHAR, ¶ms.lock), | 
| rgrover1 | 712:b04b5db36865 | 107 | uriDataChar(UUID_URI_DATA_CHAR, params.uriData, 0, URI_DATA_MAX, | 
| rgrover1 | 712:b04b5db36865 | 108 | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE), | 
| rgrover1 | 712:b04b5db36865 | 109 | unlockChar(UUID_UNLOCK_CHAR, ¶ms.lock), | 
| rgrover1 | 712:b04b5db36865 | 110 | flagsChar(UUID_FLAGS_CHAR, ¶ms.flags), | 
| rgrover1 | 712:b04b5db36865 | 111 | advPowerLevelsChar(UUID_ADV_POWER_LEVELS_CHAR, ¶ms.advPowerLevels), | 
| rgrover1 | 712:b04b5db36865 | 112 | txPowerModeChar(UUID_TX_POWER_MODE_CHAR, ¶ms.txPowerMode), | 
| rgrover1 | 712:b04b5db36865 | 113 | beaconPeriodChar(UUID_BEACON_PERIOD_CHAR, ¶ms.beaconPeriod), | 
| rgrover1 | 712:b04b5db36865 | 114 | resetChar(UUID_RESET_CHAR, &resetFlag) { | 
| rgrover1 | 712:b04b5db36865 | 115 | |
| rgrover1 | 712:b04b5db36865 | 116 | encodeURI(defaultURIDataIn, defaultUriData, defaultUriDataLength); | 
| rgrover1 | 712:b04b5db36865 | 117 | if (defaultUriDataLength > URI_DATA_MAX) { | 
| rgrover1 | 712:b04b5db36865 | 118 | return; | 
| rgrover1 | 712:b04b5db36865 | 119 | } | 
| rgrover1 | 712:b04b5db36865 | 120 | |
| rgrover1 | 712:b04b5db36865 | 121 | if (!resetToDefaultsFlag && (params.uriDataLength > URI_DATA_MAX)) { | 
| rgrover1 | 712:b04b5db36865 | 122 | resetToDefaultsFlag = true; | 
| rgrover1 | 712:b04b5db36865 | 123 | } | 
| rgrover1 | 712:b04b5db36865 | 124 | if (resetToDefaultsFlag) { | 
| rgrover1 | 712:b04b5db36865 | 125 | resetToDefaults(); | 
| rgrover1 | 712:b04b5db36865 | 126 | } else { | 
| rgrover1 | 712:b04b5db36865 | 127 | updateCharacteristicValues(); | 
| rgrover1 | 712:b04b5db36865 | 128 | } | 
| rgrover1 | 712:b04b5db36865 | 129 | |
| rgrover1 | 712:b04b5db36865 | 130 | lockedState = isLocked(); | 
| rgrover1 | 712:b04b5db36865 | 131 | |
| rgrover1 | 712:b04b5db36865 | 132 | lockChar.setWriteAuthorizationCallback(this, &URIBeaconConfigService::lockAuthorizationCallback); | 
| rgrover1 | 712:b04b5db36865 | 133 | unlockChar.setWriteAuthorizationCallback(this, &URIBeaconConfigService::unlockAuthorizationCallback); | 
| rgrover1 | 712:b04b5db36865 | 134 | uriDataChar.setWriteAuthorizationCallback(this, &URIBeaconConfigService::uriDataWriteAuthorizationCallback); | 
| rgrover1 | 712:b04b5db36865 | 135 | flagsChar.setWriteAuthorizationCallback(this, &URIBeaconConfigService::basicAuthorizationCallback<uint8_t>); | 
| rgrover1 | 712:b04b5db36865 | 136 | advPowerLevelsChar.setWriteAuthorizationCallback(this, &URIBeaconConfigService::basicAuthorizationCallback<PowerLevels_t>); | 
| rgrover1 | 712:b04b5db36865 | 137 | txPowerModeChar.setWriteAuthorizationCallback(this, &URIBeaconConfigService::powerModeAuthorizationCallback); | 
| rgrover1 | 712:b04b5db36865 | 138 | beaconPeriodChar.setWriteAuthorizationCallback(this, &URIBeaconConfigService::basicAuthorizationCallback<uint16_t>); | 
| rgrover1 | 712:b04b5db36865 | 139 | resetChar.setWriteAuthorizationCallback(this, &URIBeaconConfigService::basicAuthorizationCallback<uint8_t>); | 
| rgrover1 | 712:b04b5db36865 | 140 | |
| rgrover1 | 712:b04b5db36865 | 141 | static GattCharacteristic *charTable[] = { | 
| rgrover1 | 712:b04b5db36865 | 142 | &lockedStateChar, &lockChar, &unlockChar, &uriDataChar, | 
| rgrover1 | 712:b04b5db36865 | 143 | &flagsChar, &advPowerLevelsChar, &txPowerModeChar, &beaconPeriodChar, &resetChar | 
| rgrover1 | 712:b04b5db36865 | 144 | }; | 
| rgrover1 | 712:b04b5db36865 | 145 | |
| rgrover1 | 712:b04b5db36865 | 146 | GattService configService(UUID_URI_BEACON_SERVICE, charTable, sizeof(charTable) / sizeof(GattCharacteristic *)); | 
| rgrover1 | 712:b04b5db36865 | 147 | |
| rgrover1 | 712:b04b5db36865 | 148 | ble.addService(configService); | 
| rgrover1 | 712:b04b5db36865 | 149 | ble.onDataWritten(this, &URIBeaconConfigService::onDataWrittenCallback); | 
| rgrover1 | 712:b04b5db36865 | 150 | |
| vcoubard | 1042:21a86ac7f5b1 | 151 | setupURIBeaconConfigAdvertisements(); /* Setup advertising for the configService. */ | 
| rgrover1 | 712:b04b5db36865 | 152 | |
| rgrover1 | 712:b04b5db36865 | 153 | initSucceeded = true; | 
| rgrover1 | 712:b04b5db36865 | 154 | } | 
| rgrover1 | 712:b04b5db36865 | 155 | |
| rgrover1 | 712:b04b5db36865 | 156 | bool configuredSuccessfully(void) const { | 
| rgrover1 | 712:b04b5db36865 | 157 | return initSucceeded; | 
| rgrover1 | 712:b04b5db36865 | 158 | } | 
| rgrover1 | 712:b04b5db36865 | 159 | |
| vcoubard | 1042:21a86ac7f5b1 | 160 | /* Start out by advertising the configService for a limited time after | 
| vcoubard | 1042:21a86ac7f5b1 | 161 | * startup; and switch to the normal non-connectible beacon functionality | 
| vcoubard | 1042:21a86ac7f5b1 | 162 | * afterwards. */ | 
| rgrover1 | 712:b04b5db36865 | 163 | void setupURIBeaconConfigAdvertisements() | 
| rgrover1 | 712:b04b5db36865 | 164 | { | 
| rgrover1 | 712:b04b5db36865 | 165 | const char DEVICE_NAME[] = "mUriBeacon Config"; | 
| rgrover1 | 712:b04b5db36865 | 166 | |
| rgrover1 | 712:b04b5db36865 | 167 | ble.gap().clearAdvertisingPayload(); | 
| rgrover1 | 712:b04b5db36865 | 168 | |
| rgrover1 | 712:b04b5db36865 | 169 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE); | 
| rgrover1 | 712:b04b5db36865 | 170 | |
| rgrover1 | 1023:a072b59caddb | 171 | // UUID is in different order in the ADV frame (!) | 
| rgrover1 | 1023:a072b59caddb | 172 | uint8_t reversedServiceUUID[sizeof(UUID_URI_BEACON_SERVICE)]; | 
| rgrover1 | 1023:a072b59caddb | 173 | for (unsigned int i = 0; i < sizeof(UUID_URI_BEACON_SERVICE); i++) { | 
| rgrover1 | 1023:a072b59caddb | 174 | reversedServiceUUID[i] = UUID_URI_BEACON_SERVICE[sizeof(UUID_URI_BEACON_SERVICE) - i - 1]; | 
| rgrover1 | 1023:a072b59caddb | 175 | } | 
| rgrover1 | 1023:a072b59caddb | 176 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS, reversedServiceUUID, sizeof(reversedServiceUUID)); | 
| rgrover1 | 712:b04b5db36865 | 177 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_TAG); | 
| rgrover1 | 712:b04b5db36865 | 178 | ble.gap().accumulateScanResponse(GapAdvertisingData::COMPLETE_LOCAL_NAME, reinterpret_cast<const uint8_t *>(&DEVICE_NAME), sizeof(DEVICE_NAME)); | 
| rgrover1 | 712:b04b5db36865 | 179 | ble.gap().accumulateScanResponse(GapAdvertisingData::TX_POWER_LEVEL, | 
| rgrover1 | 712:b04b5db36865 | 180 | reinterpret_cast<uint8_t *>(&defaultAdvPowerLevels[URIBeaconConfigService::TX_POWER_MODE_LOW]), | 
| rgrover1 | 712:b04b5db36865 | 181 | sizeof(uint8_t)); | 
| rgrover1 | 712:b04b5db36865 | 182 | |
| rgrover1 | 712:b04b5db36865 | 183 | ble.gap().setTxPower(params.advPowerLevels[params.txPowerMode]); | 
| rgrover1 | 712:b04b5db36865 | 184 | ble.gap().setDeviceName(reinterpret_cast<const uint8_t *>(&DEVICE_NAME)); | 
| rgrover1 | 712:b04b5db36865 | 185 | ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); | 
| rgrover1 | 766:03f1a26f132f | 186 | ble.gap().setAdvertisingInterval(GapAdvertisingParams::MSEC_TO_ADVERTISEMENT_DURATION_UNITS(ADVERTISING_INTERVAL_MSEC)); | 
| rgrover1 | 712:b04b5db36865 | 187 | } | 
| rgrover1 | 712:b04b5db36865 | 188 | |
| vcoubard | 1042:21a86ac7f5b1 | 189 | /* Helper function to switch to the non-connectible normal mode for URIBeacon. This gets called after a timeout. */ | 
| rgrover1 | 712:b04b5db36865 | 190 | void setupURIBeaconAdvertisements() | 
| rgrover1 | 712:b04b5db36865 | 191 | { | 
| rgrover1 | 712:b04b5db36865 | 192 | /* Reinitialize the BLE stack. This will clear away the existing services and advertising state. */ | 
| rgrover1 | 712:b04b5db36865 | 193 | ble.shutdown(); | 
| rgrover1 | 712:b04b5db36865 | 194 | ble.init(); | 
| rgrover1 | 712:b04b5db36865 | 195 | |
| vcoubard | 1042:21a86ac7f5b1 | 196 | // Fields from the Service | 
| rgrover1 | 712:b04b5db36865 | 197 | unsigned beaconPeriod = params.beaconPeriod; | 
| rgrover1 | 712:b04b5db36865 | 198 | unsigned txPowerMode = params.txPowerMode; | 
| rgrover1 | 712:b04b5db36865 | 199 | unsigned uriDataLength = params.uriDataLength; | 
| rgrover1 | 712:b04b5db36865 | 200 | URIBeaconConfigService::UriData_t &uriData = params.uriData; | 
| rgrover1 | 712:b04b5db36865 | 201 | URIBeaconConfigService::PowerLevels_t &advPowerLevels = params.advPowerLevels; | 
| rgrover1 | 712:b04b5db36865 | 202 | uint8_t flags = params.flags; | 
| rgrover1 | 712:b04b5db36865 | 203 | |
| vcoubard | 1042:21a86ac7f5b1 | 204 | extern void saveURIBeaconConfigParams(const Params_t *paramsP); /* forward declaration; necessary to avoid a circular dependency. */ | 
| rgrover1 | 712:b04b5db36865 | 205 | saveURIBeaconConfigParams(¶ms); | 
| rgrover1 | 712:b04b5db36865 | 206 | |
| rgrover1 | 712:b04b5db36865 | 207 | ble.gap().clearAdvertisingPayload(); | 
| rgrover1 | 712:b04b5db36865 | 208 | ble.gap().setTxPower(params.advPowerLevels[params.txPowerMode]); | 
| rgrover1 | 712:b04b5db36865 | 209 | ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_NON_CONNECTABLE_UNDIRECTED); | 
| rgrover1 | 712:b04b5db36865 | 210 | ble.gap().setAdvertisingInterval(beaconPeriod); | 
| rgrover1 | 712:b04b5db36865 | 211 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE); | 
| rgrover1 | 712:b04b5db36865 | 212 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, BEACON_UUID, sizeof(BEACON_UUID)); | 
| rgrover1 | 712:b04b5db36865 | 213 | |
| rgrover1 | 787:2a6a8313f393 | 214 | uint8_t serviceData[SERVICE_DATA_MAX]; | 
| rgrover1 | 787:2a6a8313f393 | 215 | unsigned serviceDataLen = 0; | 
| rgrover1 | 712:b04b5db36865 | 216 | serviceData[serviceDataLen++] = BEACON_UUID[0]; | 
| rgrover1 | 712:b04b5db36865 | 217 | serviceData[serviceDataLen++] = BEACON_UUID[1]; | 
| rgrover1 | 712:b04b5db36865 | 218 | serviceData[serviceDataLen++] = flags; | 
| rgrover1 | 712:b04b5db36865 | 219 | serviceData[serviceDataLen++] = advPowerLevels[txPowerMode]; | 
| rgrover1 | 712:b04b5db36865 | 220 | for (unsigned j = 0; j < uriDataLength; j++) { | 
| rgrover1 | 712:b04b5db36865 | 221 | serviceData[serviceDataLen++] = uriData[j]; | 
| rgrover1 | 712:b04b5db36865 | 222 | } | 
| rgrover1 | 712:b04b5db36865 | 223 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA, serviceData, serviceDataLen); | 
| rgrover1 | 712:b04b5db36865 | 224 | } | 
| rgrover1 | 712:b04b5db36865 | 225 | |
| rgrover1 | 712:b04b5db36865 | 226 | private: | 
| vcoubard | 1042:21a86ac7f5b1 | 227 | // True if the lock bits are non-zero | 
| rgrover1 | 712:b04b5db36865 | 228 | bool isLocked() { | 
| rgrover1 | 712:b04b5db36865 | 229 | Lock_t testLock; | 
| rgrover1 | 712:b04b5db36865 | 230 | memset(testLock, 0, sizeof(Lock_t)); | 
| rgrover1 | 712:b04b5db36865 | 231 | return memcmp(params.lock, testLock, sizeof(Lock_t)); | 
| rgrover1 | 712:b04b5db36865 | 232 | } | 
| rgrover1 | 712:b04b5db36865 | 233 | |
| rgrover1 | 712:b04b5db36865 | 234 | /* | 
| rgrover1 | 712:b04b5db36865 | 235 | * This callback is invoked when a GATT client attempts to modify any of the | 
| vcoubard | 1042:21a86ac7f5b1 | 236 | * characteristics of this service. Attempts to do so are also applied to | 
| rgrover1 | 712:b04b5db36865 | 237 | * the internal state of this service object. | 
| rgrover1 | 712:b04b5db36865 | 238 | */ | 
| rgrover1 | 712:b04b5db36865 | 239 | void onDataWrittenCallback(const GattWriteCallbackParams *writeParams) { | 
| rgrover1 | 712:b04b5db36865 | 240 | uint16_t handle = writeParams->handle; | 
| rgrover1 | 712:b04b5db36865 | 241 | |
| rgrover1 | 712:b04b5db36865 | 242 | if (handle == lockChar.getValueHandle()) { | 
| vcoubard | 1042:21a86ac7f5b1 | 243 | // Validated earlier | 
| rgrover1 | 712:b04b5db36865 | 244 | memcpy(params.lock, writeParams->data, sizeof(Lock_t)); | 
| vcoubard | 1042:21a86ac7f5b1 | 245 | // use isLocked() in case bits are being set to all 0's | 
| rgrover1 | 712:b04b5db36865 | 246 | lockedState = isLocked(); | 
| rgrover1 | 712:b04b5db36865 | 247 | } else if (handle == unlockChar.getValueHandle()) { | 
| vcoubard | 1042:21a86ac7f5b1 | 248 | // Validated earlier | 
| rgrover1 | 712:b04b5db36865 | 249 | memset(params.lock, 0, sizeof(Lock_t)); | 
| rgrover1 | 712:b04b5db36865 | 250 | lockedState = false; | 
| rgrover1 | 712:b04b5db36865 | 251 | } else if (handle == uriDataChar.getValueHandle()) { | 
| rgrover1 | 712:b04b5db36865 | 252 | params.uriDataLength = writeParams->len; | 
| rgrover1 | 712:b04b5db36865 | 253 | memcpy(params.uriData, writeParams->data, params.uriDataLength); | 
| rgrover1 | 712:b04b5db36865 | 254 | } else if (handle == flagsChar.getValueHandle()) { | 
| rgrover1 | 712:b04b5db36865 | 255 | params.flags = *(writeParams->data); | 
| rgrover1 | 712:b04b5db36865 | 256 | } else if (handle == advPowerLevelsChar.getValueHandle()) { | 
| rgrover1 | 712:b04b5db36865 | 257 | memcpy(params.advPowerLevels, writeParams->data, sizeof(PowerLevels_t)); | 
| rgrover1 | 712:b04b5db36865 | 258 | } else if (handle == txPowerModeChar.getValueHandle()) { | 
| rgrover1 | 712:b04b5db36865 | 259 | params.txPowerMode = *(writeParams->data); | 
| rgrover1 | 712:b04b5db36865 | 260 | } else if (handle == beaconPeriodChar.getValueHandle()) { | 
| rgrover1 | 712:b04b5db36865 | 261 | params.beaconPeriod = *((uint16_t *)(writeParams->data)); | 
| rgrover1 | 712:b04b5db36865 | 262 | |
| vcoubard | 1042:21a86ac7f5b1 | 263 | /* Re-map beaconPeriod to within permissible bounds if necessary. */ | 
| rgrover1 | 712:b04b5db36865 | 264 | if (params.beaconPeriod != 0) { | 
| rgrover1 | 712:b04b5db36865 | 265 | bool paramsUpdated = false; | 
| rgrover1 | 712:b04b5db36865 | 266 | if (params.beaconPeriod < ble.gap().getMinAdvertisingInterval()) { | 
| rgrover1 | 712:b04b5db36865 | 267 | params.beaconPeriod = ble.gap().getMinAdvertisingInterval(); | 
| rgrover1 | 712:b04b5db36865 | 268 | paramsUpdated = true; | 
| rgrover1 | 712:b04b5db36865 | 269 | } else if (params.beaconPeriod > ble.gap().getMaxAdvertisingInterval()) { | 
| rgrover1 | 712:b04b5db36865 | 270 | params.beaconPeriod = ble.gap().getMaxAdvertisingInterval(); | 
| rgrover1 | 712:b04b5db36865 | 271 | paramsUpdated = true; | 
| rgrover1 | 712:b04b5db36865 | 272 | } | 
| rgrover1 | 712:b04b5db36865 | 273 | if (paramsUpdated) { | 
| rgrover1 | 728:997ba5e7b3b6 | 274 | ble.gattServer().write(beaconPeriodChar.getValueHandle(), reinterpret_cast<uint8_t *>(¶ms.beaconPeriod), sizeof(uint16_t)); | 
| rgrover1 | 712:b04b5db36865 | 275 | } | 
| rgrover1 | 712:b04b5db36865 | 276 | } | 
| rgrover1 | 712:b04b5db36865 | 277 | } else if (handle == resetChar.getValueHandle()) { | 
| rgrover1 | 712:b04b5db36865 | 278 | resetToDefaults(); | 
| rgrover1 | 712:b04b5db36865 | 279 | } | 
| rgrover1 | 712:b04b5db36865 | 280 | } | 
| rgrover1 | 712:b04b5db36865 | 281 | |
| rgrover1 | 712:b04b5db36865 | 282 | /* | 
| rgrover1 | 712:b04b5db36865 | 283 | * Reset the default values. | 
| rgrover1 | 712:b04b5db36865 | 284 | */ | 
| rgrover1 | 712:b04b5db36865 | 285 | void resetToDefaults(void) { | 
| rgrover1 | 712:b04b5db36865 | 286 | lockedState = false; | 
| rgrover1 | 712:b04b5db36865 | 287 | memset(params.lock, 0, sizeof(Lock_t)); | 
| rgrover1 | 712:b04b5db36865 | 288 | memcpy(params.uriData, defaultUriData, URI_DATA_MAX); | 
| rgrover1 | 712:b04b5db36865 | 289 | params.uriDataLength = defaultUriDataLength; | 
| rgrover1 | 712:b04b5db36865 | 290 | params.flags = 0; | 
| rgrover1 | 712:b04b5db36865 | 291 | memcpy(params.advPowerLevels, defaultAdvPowerLevels, sizeof(PowerLevels_t)); | 
| rgrover1 | 712:b04b5db36865 | 292 | params.txPowerMode = TX_POWER_MODE_LOW; | 
| rgrover1 | 712:b04b5db36865 | 293 | params.beaconPeriod = 1000; | 
| rgrover1 | 712:b04b5db36865 | 294 | updateCharacteristicValues(); | 
| rgrover1 | 712:b04b5db36865 | 295 | } | 
| rgrover1 | 712:b04b5db36865 | 296 | |
| rgrover1 | 712:b04b5db36865 | 297 | /* | 
| rgrover1 | 712:b04b5db36865 | 298 | * Internal helper function used to update the GATT database following any | 
| rgrover1 | 712:b04b5db36865 | 299 | * change to the internal state of the service object. | 
| rgrover1 | 712:b04b5db36865 | 300 | */ | 
| rgrover1 | 712:b04b5db36865 | 301 | void updateCharacteristicValues(void) { | 
| rgrover1 | 728:997ba5e7b3b6 | 302 | ble.gattServer().write(lockedStateChar.getValueHandle(), &lockedState, 1); | 
| rgrover1 | 728:997ba5e7b3b6 | 303 | ble.gattServer().write(uriDataChar.getValueHandle(), params.uriData, params.uriDataLength); | 
| rgrover1 | 728:997ba5e7b3b6 | 304 | ble.gattServer().write(flagsChar.getValueHandle(), ¶ms.flags, 1); | 
| rgrover1 | 728:997ba5e7b3b6 | 305 | ble.gattServer().write(beaconPeriodChar.getValueHandle(), | 
| rgrover1 | 712:b04b5db36865 | 306 | reinterpret_cast<uint8_t *>(¶ms.beaconPeriod), sizeof(uint16_t)); | 
| rgrover1 | 728:997ba5e7b3b6 | 307 | ble.gattServer().write(txPowerModeChar.getValueHandle(), ¶ms.txPowerMode, 1); | 
| rgrover1 | 728:997ba5e7b3b6 | 308 | ble.gattServer().write(advPowerLevelsChar.getValueHandle(), | 
| rgrover1 | 712:b04b5db36865 | 309 | reinterpret_cast<uint8_t *>(params.advPowerLevels), sizeof(PowerLevels_t)); | 
| rgrover1 | 712:b04b5db36865 | 310 | } | 
| rgrover1 | 712:b04b5db36865 | 311 | |
| rgrover1 | 728:997ba5e7b3b6 | 312 | protected: | 
| rgrover1 | 712:b04b5db36865 | 313 | void lockAuthorizationCallback(GattWriteAuthCallbackParams *authParams) { | 
| rgrover1 | 712:b04b5db36865 | 314 | if (lockedState) { | 
| rgrover1 | 712:b04b5db36865 | 315 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION; | 
| rgrover1 | 712:b04b5db36865 | 316 | } else if (authParams->len != sizeof(Lock_t)) { | 
| rgrover1 | 712:b04b5db36865 | 317 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_ATT_VAL_LENGTH; | 
| rgrover1 | 712:b04b5db36865 | 318 | } else if (authParams->offset != 0) { | 
| rgrover1 | 712:b04b5db36865 | 319 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET; | 
| rgrover1 | 712:b04b5db36865 | 320 | } else { | 
| rgrover1 | 712:b04b5db36865 | 321 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS; | 
| rgrover1 | 712:b04b5db36865 | 322 | } | 
| rgrover1 | 712:b04b5db36865 | 323 | } | 
| rgrover1 | 712:b04b5db36865 | 324 | |
| rgrover1 | 712:b04b5db36865 | 325 | |
| rgrover1 | 712:b04b5db36865 | 326 | void unlockAuthorizationCallback(GattWriteAuthCallbackParams *authParams) { | 
| rgrover1 | 712:b04b5db36865 | 327 | if (!lockedState) { | 
| rgrover1 | 712:b04b5db36865 | 328 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS; | 
| rgrover1 | 712:b04b5db36865 | 329 | } else if (authParams->len != sizeof(Lock_t)) { | 
| rgrover1 | 712:b04b5db36865 | 330 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_ATT_VAL_LENGTH; | 
| rgrover1 | 712:b04b5db36865 | 331 | } else if (authParams->offset != 0) { | 
| rgrover1 | 712:b04b5db36865 | 332 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET; | 
| rgrover1 | 712:b04b5db36865 | 333 | } else if (memcmp(authParams->data, params.lock, sizeof(Lock_t)) != 0) { | 
| rgrover1 | 712:b04b5db36865 | 334 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION; | 
| rgrover1 | 712:b04b5db36865 | 335 | } else { | 
| rgrover1 | 712:b04b5db36865 | 336 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS; | 
| rgrover1 | 712:b04b5db36865 | 337 | } | 
| rgrover1 | 712:b04b5db36865 | 338 | } | 
| rgrover1 | 712:b04b5db36865 | 339 | |
| rgrover1 | 712:b04b5db36865 | 340 | void uriDataWriteAuthorizationCallback(GattWriteAuthCallbackParams *authParams) { | 
| rgrover1 | 712:b04b5db36865 | 341 | if (lockedState) { | 
| rgrover1 | 712:b04b5db36865 | 342 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION; | 
| rgrover1 | 712:b04b5db36865 | 343 | } else if (authParams->offset != 0) { | 
| rgrover1 | 712:b04b5db36865 | 344 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET; | 
| rgrover1 | 712:b04b5db36865 | 345 | } else { | 
| rgrover1 | 712:b04b5db36865 | 346 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS; | 
| rgrover1 | 712:b04b5db36865 | 347 | } | 
| rgrover1 | 712:b04b5db36865 | 348 | } | 
| rgrover1 | 712:b04b5db36865 | 349 | |
| rgrover1 | 712:b04b5db36865 | 350 | void powerModeAuthorizationCallback(GattWriteAuthCallbackParams *authParams) { | 
| rgrover1 | 712:b04b5db36865 | 351 | if (lockedState) { | 
| rgrover1 | 712:b04b5db36865 | 352 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION; | 
| rgrover1 | 712:b04b5db36865 | 353 | } else if (authParams->len != sizeof(uint8_t)) { | 
| rgrover1 | 712:b04b5db36865 | 354 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_ATT_VAL_LENGTH; | 
| rgrover1 | 712:b04b5db36865 | 355 | } else if (authParams->offset != 0) { | 
| rgrover1 | 712:b04b5db36865 | 356 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET; | 
| rgrover1 | 712:b04b5db36865 | 357 | } else if (*((uint8_t *)authParams->data) >= NUM_POWER_MODES) { | 
| rgrover1 | 712:b04b5db36865 | 358 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_WRITE_NOT_PERMITTED; | 
| rgrover1 | 712:b04b5db36865 | 359 | } else { | 
| rgrover1 | 712:b04b5db36865 | 360 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS; | 
| rgrover1 | 712:b04b5db36865 | 361 | } | 
| rgrover1 | 712:b04b5db36865 | 362 | } | 
| rgrover1 | 712:b04b5db36865 | 363 | |
| rgrover1 | 712:b04b5db36865 | 364 | template <typename T> | 
| rgrover1 | 712:b04b5db36865 | 365 | void basicAuthorizationCallback(GattWriteAuthCallbackParams *authParams) { | 
| rgrover1 | 712:b04b5db36865 | 366 | if (lockedState) { | 
| rgrover1 | 712:b04b5db36865 | 367 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INSUF_AUTHORIZATION; | 
| rgrover1 | 712:b04b5db36865 | 368 | } else if (authParams->len != sizeof(T)) { | 
| rgrover1 | 712:b04b5db36865 | 369 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_ATT_VAL_LENGTH; | 
| rgrover1 | 712:b04b5db36865 | 370 | } else if (authParams->offset != 0) { | 
| rgrover1 | 712:b04b5db36865 | 371 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_ATTERR_INVALID_OFFSET; | 
| rgrover1 | 712:b04b5db36865 | 372 | } else { | 
| rgrover1 | 712:b04b5db36865 | 373 | authParams->authorizationReply = AUTH_CALLBACK_REPLY_SUCCESS; | 
| rgrover1 | 712:b04b5db36865 | 374 | } | 
| rgrover1 | 712:b04b5db36865 | 375 | } | 
| rgrover1 | 712:b04b5db36865 | 376 | |
| rgrover1 | 712:b04b5db36865 | 377 | protected: | 
| rgrover1 | 712:b04b5db36865 | 378 | BLE &ble; | 
| rgrover1 | 712:b04b5db36865 | 379 | Params_t ¶ms; | 
| rgrover1 | 712:b04b5db36865 | 380 | |
| vcoubard | 1042:21a86ac7f5b1 | 381 | size_t defaultUriDataLength; // Default value that is restored on reset | 
| vcoubard | 1042:21a86ac7f5b1 | 382 | UriData_t defaultUriData; // Default value that is restored on reset | 
| vcoubard | 1042:21a86ac7f5b1 | 383 | PowerLevels_t &defaultAdvPowerLevels; // Default value that is restored on reset | 
| rgrover1 | 712:b04b5db36865 | 384 | |
| rgrover1 | 712:b04b5db36865 | 385 | uint8_t lockedState; | 
| rgrover1 | 712:b04b5db36865 | 386 | bool initSucceeded; | 
| rgrover1 | 712:b04b5db36865 | 387 | uint8_t resetFlag; | 
| rgrover1 | 712:b04b5db36865 | 388 | |
| rgrover1 | 712:b04b5db36865 | 389 | ReadOnlyGattCharacteristic<uint8_t> lockedStateChar; | 
| rgrover1 | 712:b04b5db36865 | 390 | WriteOnlyGattCharacteristic<Lock_t> lockChar; | 
| rgrover1 | 712:b04b5db36865 | 391 | GattCharacteristic uriDataChar; | 
| rgrover1 | 712:b04b5db36865 | 392 | WriteOnlyGattCharacteristic<Lock_t> unlockChar; | 
| rgrover1 | 712:b04b5db36865 | 393 | ReadWriteGattCharacteristic<uint8_t> flagsChar; | 
| rgrover1 | 712:b04b5db36865 | 394 | ReadWriteGattCharacteristic<PowerLevels_t> advPowerLevelsChar; | 
| rgrover1 | 712:b04b5db36865 | 395 | ReadWriteGattCharacteristic<uint8_t> txPowerModeChar; | 
| rgrover1 | 712:b04b5db36865 | 396 | ReadWriteGattCharacteristic<uint16_t> beaconPeriodChar; | 
| rgrover1 | 712:b04b5db36865 | 397 | WriteOnlyGattCharacteristic<uint8_t> resetChar; | 
| rgrover1 | 712:b04b5db36865 | 398 | |
| rgrover1 | 712:b04b5db36865 | 399 | public: | 
| rgrover1 | 712:b04b5db36865 | 400 | /* | 
| vcoubard | 1042:21a86ac7f5b1 | 401 | * Encode a human-readable URI into the binary format defined by URIBeacon spec (https://github.com/google/uribeacon/tree/master/specification). | 
| rgrover1 | 712:b04b5db36865 | 402 | */ | 
| rgrover1 | 712:b04b5db36865 | 403 | static void encodeURI(const char *uriDataIn, UriData_t uriDataOut, size_t &sizeofURIDataOut) { | 
| rgrover1 | 712:b04b5db36865 | 404 | const char *prefixes[] = { | 
| rgrover1 | 712:b04b5db36865 | 405 | "http://www.", | 
| rgrover1 | 712:b04b5db36865 | 406 | "https://www.", | 
| rgrover1 | 712:b04b5db36865 | 407 | "http://", | 
| rgrover1 | 712:b04b5db36865 | 408 | "https://", | 
| rgrover1 | 712:b04b5db36865 | 409 | "urn:uuid:" | 
| rgrover1 | 712:b04b5db36865 | 410 | }; | 
| rgrover1 | 712:b04b5db36865 | 411 | const size_t NUM_PREFIXES = sizeof(prefixes) / sizeof(char *); | 
| rgrover1 | 712:b04b5db36865 | 412 | const char *suffixes[] = { | 
| rgrover1 | 712:b04b5db36865 | 413 | ".com/", | 
| rgrover1 | 712:b04b5db36865 | 414 | ".org/", | 
| rgrover1 | 712:b04b5db36865 | 415 | ".edu/", | 
| rgrover1 | 712:b04b5db36865 | 416 | ".net/", | 
| rgrover1 | 712:b04b5db36865 | 417 | ".info/", | 
| rgrover1 | 712:b04b5db36865 | 418 | ".biz/", | 
| rgrover1 | 712:b04b5db36865 | 419 | ".gov/", | 
| rgrover1 | 712:b04b5db36865 | 420 | ".com", | 
| rgrover1 | 712:b04b5db36865 | 421 | ".org", | 
| rgrover1 | 712:b04b5db36865 | 422 | ".edu", | 
| rgrover1 | 712:b04b5db36865 | 423 | ".net", | 
| rgrover1 | 712:b04b5db36865 | 424 | ".info", | 
| rgrover1 | 712:b04b5db36865 | 425 | ".biz", | 
| rgrover1 | 712:b04b5db36865 | 426 | ".gov" | 
| rgrover1 | 712:b04b5db36865 | 427 | }; | 
| rgrover1 | 712:b04b5db36865 | 428 | const size_t NUM_SUFFIXES = sizeof(suffixes) / sizeof(char *); | 
| rgrover1 | 712:b04b5db36865 | 429 | |
| rgrover1 | 712:b04b5db36865 | 430 | sizeofURIDataOut = 0; | 
| rgrover1 | 712:b04b5db36865 | 431 | memset(uriDataOut, 0, sizeof(UriData_t)); | 
| rgrover1 | 712:b04b5db36865 | 432 | |
| rgrover1 | 712:b04b5db36865 | 433 | if ((uriDataIn == NULL) || (strlen(uriDataIn) == 0)) { | 
| rgrover1 | 712:b04b5db36865 | 434 | return; | 
| rgrover1 | 712:b04b5db36865 | 435 | } | 
| rgrover1 | 712:b04b5db36865 | 436 | |
| rgrover1 | 712:b04b5db36865 | 437 | /* | 
| rgrover1 | 712:b04b5db36865 | 438 | * handle prefix | 
| rgrover1 | 712:b04b5db36865 | 439 | */ | 
| rgrover1 | 712:b04b5db36865 | 440 | for (unsigned i = 0; i < NUM_PREFIXES; i++) { | 
| rgrover1 | 712:b04b5db36865 | 441 | size_t prefixLen = strlen(prefixes[i]); | 
| rgrover1 | 712:b04b5db36865 | 442 | if (strncmp(uriDataIn, prefixes[i], prefixLen) == 0) { | 
| rgrover1 | 712:b04b5db36865 | 443 | uriDataOut[sizeofURIDataOut++] = i; | 
| rgrover1 | 712:b04b5db36865 | 444 | uriDataIn += prefixLen; | 
| rgrover1 | 712:b04b5db36865 | 445 | break; | 
| rgrover1 | 712:b04b5db36865 | 446 | } | 
| rgrover1 | 712:b04b5db36865 | 447 | } | 
| rgrover1 | 712:b04b5db36865 | 448 | |
| rgrover1 | 712:b04b5db36865 | 449 | /* | 
| vcoubard | 1042:21a86ac7f5b1 | 450 | * handle suffixes | 
| rgrover1 | 712:b04b5db36865 | 451 | */ | 
| rgrover1 | 712:b04b5db36865 | 452 | while (*uriDataIn && (sizeofURIDataOut < URI_DATA_MAX)) { | 
| rgrover1 | 712:b04b5db36865 | 453 | /* check for suffix match */ | 
| rgrover1 | 712:b04b5db36865 | 454 | unsigned i; | 
| rgrover1 | 712:b04b5db36865 | 455 | for (i = 0; i < NUM_SUFFIXES; i++) { | 
| rgrover1 | 712:b04b5db36865 | 456 | size_t suffixLen = strlen(suffixes[i]); | 
| rgrover1 | 712:b04b5db36865 | 457 | if (strncmp(uriDataIn, suffixes[i], suffixLen) == 0) { | 
| rgrover1 | 712:b04b5db36865 | 458 | uriDataOut[sizeofURIDataOut++] = i; | 
| rgrover1 | 712:b04b5db36865 | 459 | uriDataIn += suffixLen; | 
| vcoubard | 1042:21a86ac7f5b1 | 460 | break; /* from the for loop for checking against suffixes */ | 
| rgrover1 | 712:b04b5db36865 | 461 | } | 
| rgrover1 | 712:b04b5db36865 | 462 | } | 
| vcoubard | 1042:21a86ac7f5b1 | 463 | /* This is the default case where we've got an ordinary character which doesn't match a suffix. */ | 
| rgrover1 | 712:b04b5db36865 | 464 | if (i == NUM_SUFFIXES) { | 
| rgrover1 | 712:b04b5db36865 | 465 | uriDataOut[sizeofURIDataOut++] = *uriDataIn; | 
| rgrover1 | 712:b04b5db36865 | 466 | ++uriDataIn; | 
| rgrover1 | 712:b04b5db36865 | 467 | } | 
| rgrover1 | 712:b04b5db36865 | 468 | } | 
| rgrover1 | 712:b04b5db36865 | 469 | } | 
| rgrover1 | 712:b04b5db36865 | 470 | }; | 
| rgrover1 | 712:b04b5db36865 | 471 | |
| rgrover1 | 712:b04b5db36865 | 472 | #endif // SERVICES_URIBEACONCONFIGSERVICE_H_ |