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