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