aconno acnsensa project for iOS devices with iBeacon packets support.
Dependencies: LSM9DS1 Si7006A20 aconno_SEGGER_RTT aconno_bsp adc52832_common
main.cpp@1:326ce5e200fb, 2017-12-13 (annotated)
- Committer:
- Dautor
- Date:
- Wed Dec 13 09:37:21 2017 +0000
- Revision:
- 1:326ce5e200fb
- Parent:
- 0:12899fa39f88
- Child:
- 2:c0654c5fb771
Code refactoring.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
jurica238814 | 0:12899fa39f88 | 1 | /* |
jurica238814 | 0:12899fa39f88 | 2 | * aconno.de |
jurica238814 | 0:12899fa39f88 | 3 | * Made by Jurica Resetar |
Dautor | 1:326ce5e200fb | 4 | * Edited by Karlo Milicevic |
jurica238814 | 0:12899fa39f88 | 5 | * All right reserved |
jurica238814 | 0:12899fa39f88 | 6 | * |
jurica238814 | 0:12899fa39f88 | 7 | */ |
jurica238814 | 0:12899fa39f88 | 8 | |
jurica238814 | 0:12899fa39f88 | 9 | #include "mbed.h" |
jurica238814 | 0:12899fa39f88 | 10 | #include "ble/BLE.h" |
jurica238814 | 0:12899fa39f88 | 11 | #include "acd52832_bsp.h" |
jurica238814 | 0:12899fa39f88 | 12 | #include "GapAdvertisingData.h" |
jurica238814 | 0:12899fa39f88 | 13 | #include "Si7006A20.h" |
jurica238814 | 0:12899fa39f88 | 14 | #include "LSM9DS1.h" |
jurica238814 | 0:12899fa39f88 | 15 | #include "math.h" |
jurica238814 | 0:12899fa39f88 | 16 | #include "nrf52_digital.h" |
Dautor | 1:326ce5e200fb | 17 | #include "adc52832_common/utilities.h" |
Dautor | 1:326ce5e200fb | 18 | #include "MPL115A1.h" |
jurica238814 | 0:12899fa39f88 | 19 | |
jurica238814 | 0:12899fa39f88 | 20 | #define V0 0.47 /* In volts */ |
jurica238814 | 0:12899fa39f88 | 21 | #define TC 0.01 /* In volts */ |
jurica238814 | 0:12899fa39f88 | 22 | #define VCC (3.6) |
Dautor | 1:326ce5e200fb | 23 | #define VALUE_TO_PERCENTAGE (100) |
Dautor | 1:326ce5e200fb | 24 | #define WAKEUP_TIME_DELAY_MS (150) |
Dautor | 1:326ce5e200fb | 25 | #define APPLICATION_ID (0xCF170059) |
Dautor | 1:326ce5e200fb | 26 | |
Dautor | 1:326ce5e200fb | 27 | #define I2C_DATA (p19) |
Dautor | 1:326ce5e200fb | 28 | #define I2C_CLK (p20) |
Dautor | 1:326ce5e200fb | 29 | #define SPI_MISO (p5) |
Dautor | 1:326ce5e200fb | 30 | #define SPI_MOSI (p3) |
Dautor | 1:326ce5e200fb | 31 | #define SPI_SCLK (p4) |
jurica238814 | 0:12899fa39f88 | 32 | |
jurica238814 | 0:12899fa39f88 | 33 | #define DEBUG_PRINT (0) |
jurica238814 | 0:12899fa39f88 | 34 | #define SLEEP_TIME (0.150) /* Sleep time in seconds */ |
jurica238814 | 0:12899fa39f88 | 35 | #define WAKE_UP_TIME (0.150) /* Awake time in ms */ |
jurica238814 | 0:12899fa39f88 | 36 | #define ADV_INTERVAL (100) /* Advertising interval in ms */ |
jurica238814 | 0:12899fa39f88 | 37 | #define GO_TO_SLEEP (0) /* Sleep flag: 0 -> Device will not go to sleep, 1 -> Will go to sleep mode */ |
Dautor | 1:326ce5e200fb | 38 | #define CALIBRATION_STEPS 20 |
jurica238814 | 0:12899fa39f88 | 39 | |
Dautor | 1:326ce5e200fb | 40 | static AnalogIn temperature(ADC_TEMP); |
Dautor | 1:326ce5e200fb | 41 | static AnalogIn light(ADC_LIGHT); |
Dautor | 1:326ce5e200fb | 42 | static NRF52_DigitalOut lightPower(p28); |
Dautor | 1:326ce5e200fb | 43 | static NRF52_DigitalOut temperaturePower(p31); |
Dautor | 1:326ce5e200fb | 44 | static NRF52_DigitalOut shdn(p6); |
Dautor | 1:326ce5e200fb | 45 | static NRF52_DigitalOut led(p23); |
Dautor | 1:326ce5e200fb | 46 | static NRF52_DigitalOut power(p2); |
Dautor | 1:326ce5e200fb | 47 | static NRF52_DigitalOut cs(p7); |
Dautor | 1:326ce5e200fb | 48 | static Si7006 *si; |
Dautor | 1:326ce5e200fb | 49 | static LSM9DS1 *mems; |
Dautor | 1:326ce5e200fb | 50 | static SPI *spi; |
Dautor | 1:326ce5e200fb | 51 | static MPL115A1 *mpl115a1; |
jurica238814 | 0:12899fa39f88 | 52 | |
jurica238814 | 0:12899fa39f88 | 53 | #if DEBUG_PRINT |
jurica238814 | 0:12899fa39f88 | 54 | #include "nrf52_uart.h" |
Dautor | 1:326ce5e200fb | 55 | NRF52_UART serial = NRF52_UART(p25, p26, Baud9600); //Tx, RX BaudRate |
jurica238814 | 0:12899fa39f88 | 56 | char buffer[256] = {0}; |
jurica238814 | 0:12899fa39f88 | 57 | #define SEND(...) {uint8_t len = sprintf(buffer, __VA_ARGS__); serial.send(buffer, len);} |
Dautor | 1:326ce5e200fb | 58 | #define SENDN(...) {uint8_t len = sprintf(buffer "\n\r", __VA_ARGS__); serial.send(buffer, len);} |
jurica238814 | 0:12899fa39f88 | 59 | #else |
jurica238814 | 0:12899fa39f88 | 60 | #define SEND(...); |
Dautor | 1:326ce5e200fb | 61 | #define SENDN(...); |
jurica238814 | 0:12899fa39f88 | 62 | #endif |
jurica238814 | 0:12899fa39f88 | 63 | |
Dautor | 1:326ce5e200fb | 64 | static bool sleepFlag = true; |
jurica238814 | 0:12899fa39f88 | 65 | |
Dautor | 1:326ce5e200fb | 66 | static vector3_s memsAccInit; |
Dautor | 1:326ce5e200fb | 67 | static vector3_s memsGyrInit; |
Dautor | 1:326ce5e200fb | 68 | static vector3_s memsMagInit; |
jurica238814 | 0:12899fa39f88 | 69 | |
Dautor | 1:326ce5e200fb | 70 | static BLE &ble = BLE::Instance(); |
Dautor | 1:326ce5e200fb | 71 | static GapAdvertisingData adv_data = GapAdvertisingData(); |
jurica238814 | 0:12899fa39f88 | 72 | |
Dautor | 1:326ce5e200fb | 73 | struct __attribute__((packed, aligned(1))) advertising_packet{ |
Dautor | 1:326ce5e200fb | 74 | uint32_t header; |
Dautor | 1:326ce5e200fb | 75 | uint8_t type; |
Dautor | 1:326ce5e200fb | 76 | union{ |
Dautor | 1:326ce5e200fb | 77 | struct{ |
Dautor | 1:326ce5e200fb | 78 | int16_t gyr[3]; |
Dautor | 1:326ce5e200fb | 79 | int16_t acc[3]; |
Dautor | 1:326ce5e200fb | 80 | int16_t mag[3]; |
Dautor | 1:326ce5e200fb | 81 | }; |
Dautor | 1:326ce5e200fb | 82 | struct{ |
Dautor | 1:326ce5e200fb | 83 | float temperature; |
Dautor | 1:326ce5e200fb | 84 | float humidity; |
Dautor | 1:326ce5e200fb | 85 | float pressure; |
Dautor | 1:326ce5e200fb | 86 | float light; |
Dautor | 1:326ce5e200fb | 87 | }; |
Dautor | 1:326ce5e200fb | 88 | }; |
Dautor | 1:326ce5e200fb | 89 | }; |
Dautor | 1:326ce5e200fb | 90 | static advertising_packet advPacket; |
jurica238814 | 0:12899fa39f88 | 91 | |
jurica238814 | 0:12899fa39f88 | 92 | void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params){ |
Dautor | 1:326ce5e200fb | 93 | // Restart Advertising on disconnection |
jurica238814 | 0:12899fa39f88 | 94 | BLE::Instance().gap().startAdvertising(); |
jurica238814 | 0:12899fa39f88 | 95 | } |
jurica238814 | 0:12899fa39f88 | 96 | |
jurica238814 | 0:12899fa39f88 | 97 | /** |
jurica238814 | 0:12899fa39f88 | 98 | * Function for waking the core up |
jurica238814 | 0:12899fa39f88 | 99 | */ |
Dautor | 1:326ce5e200fb | 100 | void wakeMeUp(){ |
Dautor | 1:326ce5e200fb | 101 | sleepFlag = false; |
Dautor | 1:326ce5e200fb | 102 | } |
jurica238814 | 0:12899fa39f88 | 103 | |
jurica238814 | 0:12899fa39f88 | 104 | void onBleInitError(BLE &ble, ble_error_t error){ |
jurica238814 | 0:12899fa39f88 | 105 | /* Avoid compiler warnings */ |
jurica238814 | 0:12899fa39f88 | 106 | (void) ble; |
jurica238814 | 0:12899fa39f88 | 107 | (void) error; |
jurica238814 | 0:12899fa39f88 | 108 | } |
jurica238814 | 0:12899fa39f88 | 109 | |
jurica238814 | 0:12899fa39f88 | 110 | /** |
jurica238814 | 0:12899fa39f88 | 111 | * Callback triggered when the ble initialization process has finished |
jurica238814 | 0:12899fa39f88 | 112 | */ |
jurica238814 | 0:12899fa39f88 | 113 | void bleInitComplete(BLE::InitializationCompleteCallbackContext *params){ |
jurica238814 | 0:12899fa39f88 | 114 | BLE& ble = params->ble; |
jurica238814 | 0:12899fa39f88 | 115 | ble_error_t error = params->error; |
jurica238814 | 0:12899fa39f88 | 116 | |
jurica238814 | 0:12899fa39f88 | 117 | if (error != BLE_ERROR_NONE) { |
jurica238814 | 0:12899fa39f88 | 118 | onBleInitError(ble, error); |
jurica238814 | 0:12899fa39f88 | 119 | return; |
jurica238814 | 0:12899fa39f88 | 120 | } |
jurica238814 | 0:12899fa39f88 | 121 | |
jurica238814 | 0:12899fa39f88 | 122 | /* Ensure that it is the default instance of BLE */ |
jurica238814 | 0:12899fa39f88 | 123 | if(ble.getInstanceID() != BLE::DEFAULT_INSTANCE) { |
jurica238814 | 0:12899fa39f88 | 124 | return; |
jurica238814 | 0:12899fa39f88 | 125 | } |
jurica238814 | 0:12899fa39f88 | 126 | |
jurica238814 | 0:12899fa39f88 | 127 | ble.gap().onDisconnection(disconnectionCallback); |
jurica238814 | 0:12899fa39f88 | 128 | |
jurica238814 | 0:12899fa39f88 | 129 | /* setup advertising */ |
jurica238814 | 0:12899fa39f88 | 130 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED); |
Dautor | 1:326ce5e200fb | 131 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA, (uint8_t *)&advPacket, sizeof(advPacket)); |
jurica238814 | 0:12899fa39f88 | 132 | ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_NON_CONNECTABLE_UNDIRECTED); |
jurica238814 | 0:12899fa39f88 | 133 | ble.gap().setAdvertisingInterval(ADV_INTERVAL); |
jurica238814 | 0:12899fa39f88 | 134 | ble.gap().startAdvertising(); |
jurica238814 | 0:12899fa39f88 | 135 | } |
jurica238814 | 0:12899fa39f88 | 136 | |
Dautor | 1:326ce5e200fb | 137 | float getLight(){ |
Dautor | 1:326ce5e200fb | 138 | return light.read() * VALUE_TO_PERCENTAGE; |
jurica238814 | 0:12899fa39f88 | 139 | } |
jurica238814 | 0:12899fa39f88 | 140 | |
jurica238814 | 0:12899fa39f88 | 141 | float voltage2temp(float vOut){ |
jurica238814 | 0:12899fa39f88 | 142 | return ((float)vOut - (float)V0)/((float)TC); |
jurica238814 | 0:12899fa39f88 | 143 | } |
jurica238814 | 0:12899fa39f88 | 144 | |
Dautor | 1:326ce5e200fb | 145 | float getTemperature(){ |
Dautor | 1:326ce5e200fb | 146 | return voltage2temp(temperature.read()*(float)VCC); |
jurica238814 | 0:12899fa39f88 | 147 | } |
jurica238814 | 0:12899fa39f88 | 148 | |
Dautor | 1:326ce5e200fb | 149 | float getHumidity(){ |
Dautor | 1:326ce5e200fb | 150 | float result; |
Dautor | 1:326ce5e200fb | 151 | si->getHumidity(&result); |
Dautor | 1:326ce5e200fb | 152 | return result; |
jurica238814 | 0:12899fa39f88 | 153 | } |
jurica238814 | 0:12899fa39f88 | 154 | |
Dautor | 1:326ce5e200fb | 155 | void readGyr(vector3_s *gyro_data){ |
Dautor | 1:326ce5e200fb | 156 | mems->readGyro((int16_t *)gyro_data); |
Dautor | 1:326ce5e200fb | 157 | *gyro_data -= memsGyrInit; |
jurica238814 | 0:12899fa39f88 | 158 | } |
jurica238814 | 0:12899fa39f88 | 159 | |
Dautor | 1:326ce5e200fb | 160 | void readAcc(vector3_s *acc_data){ |
Dautor | 1:326ce5e200fb | 161 | mems->readAcc((int16_t *)acc_data); |
Dautor | 1:326ce5e200fb | 162 | *acc_data -= memsAccInit; |
jurica238814 | 0:12899fa39f88 | 163 | } |
jurica238814 | 0:12899fa39f88 | 164 | |
Dautor | 1:326ce5e200fb | 165 | void readMag(vector3_s *magneto_data){ |
Dautor | 1:326ce5e200fb | 166 | mems->readMag((int16_t *)magneto_data); |
Dautor | 1:326ce5e200fb | 167 | *magneto_data -= memsMagInit; |
jurica238814 | 0:12899fa39f88 | 168 | } |
jurica238814 | 0:12899fa39f88 | 169 | |
jurica238814 | 0:12899fa39f88 | 170 | void calibrateAcc(){ |
Dautor | 1:326ce5e200fb | 171 | vector3_s acc_data; |
Dautor | 1:326ce5e200fb | 172 | for(uint8_t counter = 0; counter < CALIBRATION_STEPS; ++counter){ |
Dautor | 1:326ce5e200fb | 173 | readAcc(&acc_data); |
Dautor | 1:326ce5e200fb | 174 | memsAccInit += acc_data; |
jurica238814 | 0:12899fa39f88 | 175 | } |
Dautor | 1:326ce5e200fb | 176 | memsAccInit /= CALIBRATION_STEPS; |
jurica238814 | 0:12899fa39f88 | 177 | } |
jurica238814 | 0:12899fa39f88 | 178 | |
Dautor | 1:326ce5e200fb | 179 | void calibrateGyr(){ |
Dautor | 1:326ce5e200fb | 180 | vector3_s gyro_data; |
Dautor | 1:326ce5e200fb | 181 | for(uint8_t counter = 0; counter < CALIBRATION_STEPS; ++counter){ |
Dautor | 1:326ce5e200fb | 182 | readGyr(&gyro_data); |
Dautor | 1:326ce5e200fb | 183 | memsGyrInit += gyro_data; |
jurica238814 | 0:12899fa39f88 | 184 | } |
Dautor | 1:326ce5e200fb | 185 | memsGyrInit /= CALIBRATION_STEPS; |
jurica238814 | 0:12899fa39f88 | 186 | } |
jurica238814 | 0:12899fa39f88 | 187 | |
jurica238814 | 0:12899fa39f88 | 188 | void calibrateMag(){ |
Dautor | 1:326ce5e200fb | 189 | vector3_s mag_data; |
Dautor | 1:326ce5e200fb | 190 | for(uint8_t counter = 0; counter < CALIBRATION_STEPS; ++counter){ |
Dautor | 1:326ce5e200fb | 191 | readMag(&mag_data); |
Dautor | 1:326ce5e200fb | 192 | memsMagInit += mag_data; |
jurica238814 | 0:12899fa39f88 | 193 | } |
Dautor | 1:326ce5e200fb | 194 | memsMagInit /= CALIBRATION_STEPS; |
jurica238814 | 0:12899fa39f88 | 195 | } |
jurica238814 | 0:12899fa39f88 | 196 | |
jurica238814 | 0:12899fa39f88 | 197 | void updateData(){ |
jurica238814 | 0:12899fa39f88 | 198 | static uint8_t adv_type = 0; |
jurica238814 | 0:12899fa39f88 | 199 | |
Dautor | 1:326ce5e200fb | 200 | if(adv_type < 1){ |
Dautor | 1:326ce5e200fb | 201 | advPacket.type = 0x00; |
Dautor | 1:326ce5e200fb | 202 | readGyr((vector3_s *)advPacket.gyr); |
Dautor | 1:326ce5e200fb | 203 | readAcc((vector3_s *)advPacket.acc); |
Dautor | 1:326ce5e200fb | 204 | readMag((vector3_s *)advPacket.mag); |
jurica238814 | 0:12899fa39f88 | 205 | } |
jurica238814 | 0:12899fa39f88 | 206 | else{ |
Dautor | 1:326ce5e200fb | 207 | advPacket.type = 0x01; |
Dautor | 1:326ce5e200fb | 208 | advPacket.temperature = getTemperature(); |
Dautor | 1:326ce5e200fb | 209 | advPacket.light = getLight(); |
Dautor | 1:326ce5e200fb | 210 | advPacket.humidity = getHumidity(); |
Dautor | 1:326ce5e200fb | 211 | advPacket.pressure = mpl115a1->getPressure(); |
jurica238814 | 0:12899fa39f88 | 212 | } |
Dautor | 1:326ce5e200fb | 213 | if(++adv_type > 2) adv_type = 0; |
jurica238814 | 0:12899fa39f88 | 214 | |
jurica238814 | 0:12899fa39f88 | 215 | adv_data = ble.getAdvertisingData(); |
Dautor | 1:326ce5e200fb | 216 | adv_data.updateData(adv_data.MANUFACTURER_SPECIFIC_DATA, (uint8_t *)&advPacket, sizeof(advPacket)); |
jurica238814 | 0:12899fa39f88 | 217 | ble.setAdvertisingData(adv_data); |
jurica238814 | 0:12899fa39f88 | 218 | } |
jurica238814 | 0:12899fa39f88 | 219 | |
jurica238814 | 0:12899fa39f88 | 220 | |
Dautor | 1:326ce5e200fb | 221 | int main(){ |
jurica238814 | 0:12899fa39f88 | 222 | power = 1; |
Dautor | 1:326ce5e200fb | 223 | wait_ms(WAKEUP_TIME_DELAY_MS); |
jurica238814 | 0:12899fa39f88 | 224 | temperaturePower = 1; |
jurica238814 | 0:12899fa39f88 | 225 | lightPower = 1; |
Dautor | 1:326ce5e200fb | 226 | shdn = 1; // Wake up the pressure sensor |
Dautor | 1:326ce5e200fb | 227 | |
Dautor | 1:326ce5e200fb | 228 | advPacket.header = APPLICATION_ID; |
Dautor | 1:326ce5e200fb | 229 | |
Dautor | 1:326ce5e200fb | 230 | ble.init(bleInitComplete); |
jurica238814 | 0:12899fa39f88 | 231 | |
Dautor | 1:326ce5e200fb | 232 | I2C i2c(I2C_DATA, I2C_CLK); |
Dautor | 1:326ce5e200fb | 233 | si = new Si7006(&i2c); |
Dautor | 1:326ce5e200fb | 234 | mems = new LSM9DS1(i2c); |
Dautor | 1:326ce5e200fb | 235 | spi = new SPI(SPI_MOSI, SPI_MISO, SPI_SCLK); |
Dautor | 1:326ce5e200fb | 236 | mpl115a1 = new MPL115A1(*spi, cs); |
jurica238814 | 0:12899fa39f88 | 237 | |
jurica238814 | 0:12899fa39f88 | 238 | mems->startAcc(); |
jurica238814 | 0:12899fa39f88 | 239 | mems->startGyro(); |
jurica238814 | 0:12899fa39f88 | 240 | mems->startMag(); |
jurica238814 | 0:12899fa39f88 | 241 | |
jurica238814 | 0:12899fa39f88 | 242 | led = 1; |
jurica238814 | 0:12899fa39f88 | 243 | |
jurica238814 | 0:12899fa39f88 | 244 | Ticker ticker; |
Dautor | 1:326ce5e200fb | 245 | ticker.attach(wakeMeUp, SLEEP_TIME); // Wake the device up |
jurica238814 | 0:12899fa39f88 | 246 | |
Dautor | 1:326ce5e200fb | 247 | while(ble.hasInitialized() == false); /* spin loop */ |
Dautor | 1:326ce5e200fb | 248 | while(true){ |
Dautor | 1:326ce5e200fb | 249 | if (sleepFlag && GO_TO_SLEEP){ |
Dautor | 1:326ce5e200fb | 250 | ble.gap().stopAdvertising(); |
Dautor | 1:326ce5e200fb | 251 | sleep(); |
Dautor | 1:326ce5e200fb | 252 | ble.waitForEvent(); |
Dautor | 1:326ce5e200fb | 253 | } |
Dautor | 1:326ce5e200fb | 254 | else{ |
Dautor | 1:326ce5e200fb | 255 | // I'm awake |
Dautor | 1:326ce5e200fb | 256 | updateData(); |
Dautor | 1:326ce5e200fb | 257 | ble.gap().startAdvertising(); |
Dautor | 1:326ce5e200fb | 258 | wait_ms(WAKE_UP_TIME); |
Dautor | 1:326ce5e200fb | 259 | sleepFlag = true; |
jurica238814 | 0:12899fa39f88 | 260 | } |
jurica238814 | 0:12899fa39f88 | 261 | } |
jurica238814 | 0:12899fa39f88 | 262 | } |