Jurica Resetar / Mbed OS iBeacon acnsensa

aconno acnsensa project for iOS devices with iBeacon packets support.

Dependencies:   LSM9DS1 Si7006A20 aconno_SEGGER_RTT aconno_bsp adc52832_common

main.cpp@20:fc639ef579b6, 2018-08-02 (annotated)

Committer:
jurica238814
Date:
Thu Aug 02 10:38:30 2018 +0200
Branch:
noSensors
Revision:
20:fc639ef579b6
Parent:
18:442bc914996b
Child:
22:3710de547ff1
sensors excluded

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jurica238814 16:e86a91db0b72 1 /*
jurica238814 16:e86a91db0b72 2 * aconno.de
jurica238814 16:e86a91db0b72 3 * Made by Jurica Resetar
jurica238814 16:e86a91db0b72 4 * Edited by Karlo Milicevic
jurica238814 16:e86a91db0b72 5 * Edited by Dominik Bartolovic
jurica238814 16:e86a91db0b72 6 * All right reserved
jurica238814 16:e86a91db0b72 7 *
jurica238814 16:e86a91db0b72 8 */
jurica238814 16:e86a91db0b72 9
jurica238814 16:e86a91db0b72 10 #include "mbed.h"
jurica238814 16:e86a91db0b72 11 #include "ble/BLE.h"
jurica238814 16:e86a91db0b72 12 #include "acd52832_bsp.h"
jurica238814 16:e86a91db0b72 13 #include "GapAdvertisingData.h"
jurica238814 16:e86a91db0b72 14 #include "Si7006A20.h"
jurica238814 16:e86a91db0b72 15 #include "LSM9DS1.h"
jurica238814 16:e86a91db0b72 16 #include "math.h"
jurica238814 16:e86a91db0b72 17 #include "nrf52_digital.h"
jurica238814 16:e86a91db0b72 18 #include "adc52832_common/utilities.h"
jurica238814 16:e86a91db0b72 19 #include "MPL115A1.h"
jurica238814 16:e86a91db0b72 20 #include "acd_nrf52_saadc.h"
jurica238814 16:e86a91db0b72 21 #include "service.h"
jurica238814 16:e86a91db0b72 22 #include <events/mbed_events.h>
jurica238814 16:e86a91db0b72 23
jurica238814 16:e86a91db0b72 24 #define V0 0.47 /* In volts */
jurica238814 16:e86a91db0b72 25 #define TC 0.01 /* In volts */
jurica238814 16:e86a91db0b72 26 #define VCC (3.6)
jurica238814 16:e86a91db0b72 27 #define VALUE_TO_PERCENTAGE (100)
jurica238814 16:e86a91db0b72 28 #define WAKEUP_TIME_DELAY_MS (150)
jurica238814 16:e86a91db0b72 29 #define APPLICATION_ID (0xCF170059)
jurica238814 16:e86a91db0b72 30
jurica238814 16:e86a91db0b72 31 #define ADC_REFERENCE (3.6f) /* adc reference voltage */
jurica238814 16:e86a91db0b72 32 #define ADC_RESOLUTION (1024) /* 10-bit adc */
jurica238814 16:e86a91db0b72 33
jurica238814 16:e86a91db0b72 34 #define I2C_DATA (p19)
jurica238814 16:e86a91db0b72 35 #define I2C_CLK (p20)
jurica238814 16:e86a91db0b72 36 #define SPI_MISO (p5)
jurica238814 16:e86a91db0b72 37 #define SPI_MOSI (p3)
jurica238814 16:e86a91db0b72 38 #define SPI_SCLK (p4)
jurica238814 16:e86a91db0b72 39
jurica238814 16:e86a91db0b72 40 #define DEBUG (0)
jurica238814 16:e86a91db0b72 41 #define DEBUG_PRINT (1)
jurica238814 16:e86a91db0b72 42 #define SLEEP_TIME (0.150) /* Sleep time in seconds */
jurica238814 16:e86a91db0b72 43 #define WAKE_UP_TIME (0.150) /* Awake time in ms */
jurica238814 16:e86a91db0b72 44 #define ADV_INTERVAL (1000) /* Advertising interval in ms */
jurica238814 16:e86a91db0b72 45 #define GO_TO_SLEEP (0)
jurica238814 16:e86a91db0b72 46 /* Sleep flag: 0 -> Device will not go to sleep, 1 -> Will go to sleep mode */
jurica238814 16:e86a91db0b72 47 #define CALIBRATION_STEPS (20)
jurica238814 16:e86a91db0b72 48 #define TX_POWER_DB (4)
jurica238814 16:e86a91db0b72 49 #define INVERT_AXES (0)
jurica238814 16:e86a91db0b72 50
jurica238814 16:e86a91db0b72 51 uint8_t gConnected = 0;
jurica238814 20:fc639ef579b6 52 DigitalOut aliveLed(p23);
jurica238814 20:fc639ef579b6 53 DigitalOut connectedLed(p24);
jurica238814 16:e86a91db0b72 54
jurica238814 16:e86a91db0b72 55 static EventQueue eventQueue(32 * EVENTS_EVENT_SIZE);
jurica238814 16:e86a91db0b72 56 uint8_t myMacAddress[6] = {};
jurica238814 16:e86a91db0b72 57 MACService *macServicePtr;
jurica238814 16:e86a91db0b72 58
jurica238814 16:e86a91db0b72 59 #if DEBUG_PRINT
jurica238814 16:e86a91db0b72 60 #include "SEGGER_RTT.h"
jurica238814 16:e86a91db0b72 61 #define printf(...) SEGGER_RTT_printf(0, __VA_ARGS__)
jurica238814 16:e86a91db0b72 62 #else
jurica238814 16:e86a91db0b72 63 #define printf(...)
jurica238814 16:e86a91db0b72 64 #endif
jurica238814 16:e86a91db0b72 65
jurica238814 16:e86a91db0b72 66 static bool sleepFlag = true;
jurica238814 16:e86a91db0b72 67
jurica238814 16:e86a91db0b72 68 static vector3_s memsAccelerometerInit;
jurica238814 16:e86a91db0b72 69 static vector3_s memsGyroscopeInit;
jurica238814 16:e86a91db0b72 70 static vector3_s memsMagnetometerInit;
jurica238814 16:e86a91db0b72 71
jurica238814 16:e86a91db0b72 72 static GapAdvertisingData adv_data = GapAdvertisingData();
jurica238814 16:e86a91db0b72 73
jurica238814 16:e86a91db0b72 74 typedef struct __attribute__((packed, aligned(1)))
jurica238814 16:e86a91db0b72 75 {
jurica238814 16:e86a91db0b72 76 uint16_t appleID;
jurica238814 16:e86a91db0b72 77 uint8_t secondID;
jurica238814 16:e86a91db0b72 78 uint8_t DataSize;
jurica238814 16:e86a91db0b72 79 uint8_t UUID[18];
jurica238814 16:e86a91db0b72 80 uint8_t major;
jurica238814 16:e86a91db0b72 81 uint8_t minor;
jurica238814 16:e86a91db0b72 82 int8_t RSSI;
jurica238814 16:e86a91db0b72 83 }IBeaconMSD;
jurica238814 16:e86a91db0b72 84
jurica238814 16:e86a91db0b72 85 struct __attribute__((packed, aligned(1))) advertising_packet
jurica238814 16:e86a91db0b72 86 {
jurica238814 16:e86a91db0b72 87 uint32_t header;
jurica238814 16:e86a91db0b72 88 uint8_t type;
jurica238814 16:e86a91db0b72 89 union{
jurica238814 16:e86a91db0b72 90 struct{
jurica238814 16:e86a91db0b72 91 int16_t gyroscope[3];
jurica238814 16:e86a91db0b72 92 int16_t accelerometer[3];
jurica238814 16:e86a91db0b72 93 int16_t magnetometer[3];
jurica238814 16:e86a91db0b72 94 uint16_t acc_lsb_value;
jurica238814 16:e86a91db0b72 95 };
jurica238814 16:e86a91db0b72 96 struct{
jurica238814 16:e86a91db0b72 97 float temperature;
jurica238814 16:e86a91db0b72 98 float humidity;
jurica238814 16:e86a91db0b72 99 float pressure;
jurica238814 16:e86a91db0b72 100 float light;
jurica238814 16:e86a91db0b72 101 uint8_t battery;
jurica238814 16:e86a91db0b72 102 };
jurica238814 16:e86a91db0b72 103 };
jurica238814 16:e86a91db0b72 104 };
jurica238814 16:e86a91db0b72 105
jurica238814 16:e86a91db0b72 106 void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context)
jurica238814 16:e86a91db0b72 107 {
jurica238814 16:e86a91db0b72 108 BLE &ble = context->ble;
jurica238814 16:e86a91db0b72 109 eventQueue.call(Callback<void()>(&ble, &BLE::processEvents));
jurica238814 16:e86a91db0b72 110 }
jurica238814 16:e86a91db0b72 111
jurica238814 16:e86a91db0b72 112 static advertising_packet advertisementPacket;
jurica238814 16:e86a91db0b72 113 IBeaconMSD ibeaconMSD;
jurica238814 16:e86a91db0b72 114
jurica238814 16:e86a91db0b72 115 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params)
jurica238814 16:e86a91db0b72 116 {
jurica238814 16:e86a91db0b72 117 // Restart Advertising on disconnection
jurica238814 16:e86a91db0b72 118 gConnected = 0;
jurica238814 20:fc639ef579b6 119 connectedLed = 1;
jurica238814 16:e86a91db0b72 120 BLE::Instance().gap().startAdvertising();
jurica238814 16:e86a91db0b72 121 }
jurica238814 16:e86a91db0b72 122
jurica238814 16:e86a91db0b72 123 void onConnectionCallback(const Gap::ConnectionCallbackParams_t *params)
jurica238814 16:e86a91db0b72 124 {
jurica238814 16:e86a91db0b72 125 printf("Connection callback.\n");
jurica238814 20:fc639ef579b6 126 connectedLed = 0;
jurica238814 16:e86a91db0b72 127 gConnected = 1;
jurica238814 16:e86a91db0b72 128 }
jurica238814 16:e86a91db0b72 129
jurica238814 16:e86a91db0b72 130 /**
jurica238814 16:e86a91db0b72 131 * Callback triggered when the ble initialization process has finished
jurica238814 16:e86a91db0b72 132 */
jurica238814 16:e86a91db0b72 133 void bleInitCompleteSensors(BLE::InitializationCompleteCallbackContext *params)
jurica238814 16:e86a91db0b72 134 {
jurica238814 16:e86a91db0b72 135 BLE& ble = params->ble;
jurica238814 16:e86a91db0b72 136 ble_error_t error = params->error;
jurica238814 16:e86a91db0b72 137
jurica238814 16:e86a91db0b72 138 if (error != BLE_ERROR_NONE){
jurica238814 16:e86a91db0b72 139 return;
jurica238814 16:e86a91db0b72 140 }
jurica238814 16:e86a91db0b72 141
jurica238814 16:e86a91db0b72 142 /* Ensure that it is the default instance of BLE */
jurica238814 16:e86a91db0b72 143 if(ble.getInstanceID() != BLE::DEFAULT_INSTANCE){
jurica238814 16:e86a91db0b72 144 return;
jurica238814 16:e86a91db0b72 145 }
jurica238814 16:e86a91db0b72 146
jurica238814 18:442bc914996b 147 uint8_t mac[6] = {0,0,0,0,0,0};
jurica238814 16:e86a91db0b72 148 BLEProtocol::AddressType_t temp_address_type;
jurica238814 16:e86a91db0b72 149 ble.gap().getAddress(&temp_address_type, myMacAddress);
jurica238814 16:e86a91db0b72 150 macServicePtr = new MACService(ble, mac);
jurica238814 16:e86a91db0b72 151 macServicePtr->updateMacAddress(myMacAddress); // Update MAC address
jurica238814 16:e86a91db0b72 152
jurica238814 16:e86a91db0b72 153 ble.gap().onConnection(onConnectionCallback);
jurica238814 16:e86a91db0b72 154 ble.gap().onDisconnection(disconnectionCallback);
jurica238814 16:e86a91db0b72 155
jurica238814 16:e86a91db0b72 156 /* setup advertising */
jurica238814 16:e86a91db0b72 157 ble.gap().accumulateAdvertisingPayload(
jurica238814 16:e86a91db0b72 158 GapAdvertisingData::BREDR_NOT_SUPPORTED);
jurica238814 16:e86a91db0b72 159 ble.gap().accumulateAdvertisingPayload(
jurica238814 16:e86a91db0b72 160 GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA,
jurica238814 16:e86a91db0b72 161 (uint8_t *)&advertisementPacket, sizeof(advertisementPacket));
jurica238814 16:e86a91db0b72 162 ble.gap().setAdvertisingType(
jurica238814 16:e86a91db0b72 163 GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
jurica238814 16:e86a91db0b72 164 ble.gap().setAdvertisingInterval(ADV_INTERVAL);
jurica238814 18:442bc914996b 165 printf("Init started....\t\t");
jurica238814 17:18f4bf2a368a 166 ble.gap().setTxPower(TX_POWER_DB); // Set TX power to TX_POWER_DB
jurica238814 16:e86a91db0b72 167 ble.gap().startAdvertising();
jurica238814 18:442bc914996b 168 printf("Init done.\n");
jurica238814 16:e86a91db0b72 169 }
jurica238814 16:e86a91db0b72 170
jurica238814 16:e86a91db0b72 171 void updateData(){
jurica238814 16:e86a91db0b72 172 static uint8_t advertisementType = 0;
jurica238814 16:e86a91db0b72 173 int16_t temp_acc[3];
jurica238814 16:e86a91db0b72 174 BLE &ble = BLE::Instance();
jurica238814 16:e86a91db0b72 175
jurica238814 16:e86a91db0b72 176 if(!advertisementType && !gConnected)
jurica238814 16:e86a91db0b72 177 {
jurica238814 16:e86a91db0b72 178 printf("Sensor format 1.\n");
jurica238814 18:442bc914996b 179 ble.gap().clearAdvertisingPayload();
jurica238814 18:442bc914996b 180 /* setup advertising */
jurica238814 18:442bc914996b 181 ble.gap().accumulateAdvertisingPayload(
jurica238814 18:442bc914996b 182 GapAdvertisingData::BREDR_NOT_SUPPORTED);
jurica238814 18:442bc914996b 183 ble.gap().accumulateAdvertisingPayload(
jurica238814 18:442bc914996b 184 GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA,
jurica238814 18:442bc914996b 185 (uint8_t *)&advertisementPacket, sizeof(advertisementPacket));
jurica238814 18:442bc914996b 186 ble.gap().setAdvertisingType(
jurica238814 18:442bc914996b 187 GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
jurica238814 18:442bc914996b 188
jurica238814 16:e86a91db0b72 189 adv_data = ble.getAdvertisingData();
jurica238814 16:e86a91db0b72 190 advertisementPacket.type = 0x00;
jurica238814 16:e86a91db0b72 191 advertisementPacket.acc_lsb_value = (0xF9E);
jurica238814 16:e86a91db0b72 192 // ^--- That's in ug cuz MSB is 1
jurica238814 16:e86a91db0b72 193 #if INVERT_AXES
jurica238814 16:e86a91db0b72 194 advertisementPacket.accelerometer[0] = temp_acc[1];
jurica238814 16:e86a91db0b72 195 advertisementPacket.accelerometer[1] = temp_acc[0];
jurica238814 16:e86a91db0b72 196 advertisementPacket.accelerometer[2] = temp_acc[2];
jurica238814 16:e86a91db0b72 197 #endif
jurica238814 16:e86a91db0b72 198
jurica238814 16:e86a91db0b72 199 adv_data.updateData(adv_data.MANUFACTURER_SPECIFIC_DATA,
jurica238814 16:e86a91db0b72 200 (uint8_t *)&advertisementPacket, sizeof(advertisementPacket));
jurica238814 16:e86a91db0b72 201 ble.setAdvertisingData(adv_data);
jurica238814 16:e86a91db0b72 202 }
jurica238814 16:e86a91db0b72 203 else if (advertisementType == 1 && !gConnected)
jurica238814 16:e86a91db0b72 204 {
jurica238814 16:e86a91db0b72 205 printf("Sensor format 2.\n");
jurica238814 16:e86a91db0b72 206 adv_data = ble.getAdvertisingData();
jurica238814 16:e86a91db0b72 207 advertisementPacket.type = 0x01;
jurica238814 20:fc639ef579b6 208 advertisementPacket.temperature = 0.23;
jurica238814 16:e86a91db0b72 209
jurica238814 16:e86a91db0b72 210 adv_data.updateData(adv_data.MANUFACTURER_SPECIFIC_DATA,
jurica238814 16:e86a91db0b72 211 (uint8_t *)&advertisementPacket, sizeof(advertisementPacket));
jurica238814 16:e86a91db0b72 212 ble.setAdvertisingData(adv_data);
jurica238814 16:e86a91db0b72 213 }
jurica238814 16:e86a91db0b72 214
jurica238814 16:e86a91db0b72 215 else if (!gConnected)
jurica238814 16:e86a91db0b72 216 {
jurica238814 16:e86a91db0b72 217 printf("Beacon format!\n");
jurica238814 18:442bc914996b 218 ble.gap().clearAdvertisingPayload();
jurica238814 18:442bc914996b 219 ble.gap().accumulateAdvertisingPayload(
jurica238814 18:442bc914996b 220 GapAdvertisingData::BREDR_NOT_SUPPORTED);
jurica238814 18:442bc914996b 221 ble.gap().accumulateAdvertisingPayload(
jurica238814 18:442bc914996b 222 GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA,
jurica238814 18:442bc914996b 223 (uint8_t*)&ibeaconMSD, sizeof(ibeaconMSD));
jurica238814 18:442bc914996b 224 ble.gap().startAdvertising();
jurica238814 16:e86a91db0b72 225 }
jurica238814 16:e86a91db0b72 226 if(++advertisementType > 2) advertisementType = 0;
jurica238814 16:e86a91db0b72 227 }
jurica238814 16:e86a91db0b72 228
jurica238814 20:fc639ef579b6 229 void blinky()
jurica238814 20:fc639ef579b6 230 {
jurica238814 20:fc639ef579b6 231 aliveLed = !aliveLed;
jurica238814 20:fc639ef579b6 232 }
jurica238814 20:fc639ef579b6 233
jurica238814 16:e86a91db0b72 234 int main()
jurica238814 16:e86a91db0b72 235 {
jurica238814 16:e86a91db0b72 236 printf("Main started.\n");
jurica238814 16:e86a91db0b72 237
jurica238814 16:e86a91db0b72 238 Thread bleT;
jurica238814 16:e86a91db0b72 239
jurica238814 20:fc639ef579b6 240 connectedLed = 1;
jurica238814 16:e86a91db0b72 241
jurica238814 16:e86a91db0b72 242 advertisementPacket.header = APPLICATION_ID;
jurica238814 16:e86a91db0b72 243
jurica238814 16:e86a91db0b72 244 ibeaconMSD.appleID = 0x004C;
jurica238814 16:e86a91db0b72 245 ibeaconMSD.secondID = 0x02;
jurica238814 16:e86a91db0b72 246 ibeaconMSD.DataSize = 0x15;
jurica238814 16:e86a91db0b72 247 ibeaconMSD.UUID[0] = 0x11;
jurica238814 16:e86a91db0b72 248 ibeaconMSD.UUID[1] = 0x22;
jurica238814 16:e86a91db0b72 249 ibeaconMSD.UUID[2] = 0x33;
jurica238814 16:e86a91db0b72 250 ibeaconMSD.RSSI = -4;
jurica238814 16:e86a91db0b72 251
jurica238814 16:e86a91db0b72 252 BLE &ble = BLE::Instance();
jurica238814 16:e86a91db0b72 253 ble.init(bleInitCompleteSensors);
jurica238814 16:e86a91db0b72 254 while(ble.hasInitialized() == false){
jurica238814 16:e86a91db0b72 255 /* spin loop */
jurica238814 16:e86a91db0b72 256 }
jurica238814 16:e86a91db0b72 257 ble.onEventsToProcess(scheduleBleEventsProcessing);
jurica238814 16:e86a91db0b72 258
jurica238814 20:fc639ef579b6 259 eventQueue.call_every(500, blinky);
jurica238814 18:442bc914996b 260 eventQueue.call_every(500, updateData);
jurica238814 16:e86a91db0b72 261
jurica238814 16:e86a91db0b72 262 // This call stops main thread
jurica238814 16:e86a91db0b72 263 eventQueue.dispatch_forever();
jurica238814 16:e86a91db0b72 264
jurica238814 16:e86a91db0b72 265 }