Adaptation of SMPIR for the Window Sensor Module of the Agile-IoT project.
Dependencies: BLE_API mbed nRF51822
Fork of SensorModulePIR by
main.cpp@13:0dc9a52cff66, 2017-07-07 (annotated)
- Committer:
- MisterGiet
- Date:
- Fri Jul 07 08:33:32 2017 +0000
- Revision:
- 13:0dc9a52cff66
- Parent:
- 12:92f008fe602c
- Child:
- 14:5a1467f7cfb2
Added Temp,Hum,Pres on Manufacturer advertising payload.; Added Temp,Hum,Pres data on BLE serial communication
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
waltercolitti | 0:eb280529b0ef | 1 | #include "mbed.h" |
MisterGiet | 3:53db6c57bb61 | 2 | #include "defineGPIOs.h" |
waltercolitti | 0:eb280529b0ef | 3 | #include "BLE.h" |
MisterGiet | 12:92f008fe602c | 4 | #include "HealthThermometerService.h" |
MisterGiet | 12:92f008fe602c | 5 | #include "BatteryService.h" |
MisterGiet | 12:92f008fe602c | 6 | #include "EnvironmentalService.h" |
MisterGiet | 10:29dbc6d316c3 | 7 | #include "HumidityMeasureService.h" |
waltercolitti | 0:eb280529b0ef | 8 | #include "PresenceDetectionService.h" |
waltercolitti | 0:eb280529b0ef | 9 | #include "ble_gatt.h" |
waltercolitti | 0:eb280529b0ef | 10 | #include "Si7020.h" |
MisterGiet | 3:53db6c57bb61 | 11 | #include "UARTService.h" |
MisterGiet | 3:53db6c57bb61 | 12 | #include <string.h> |
MisterGiet | 13:0dc9a52cff66 | 13 | //#include "DFUService.h" |
MisterGiet | 10:29dbc6d316c3 | 14 | |
MisterGiet | 3:53db6c57bb61 | 15 | // OFFSET TEMPERATURE CONFIGURATIONS: |
MisterGiet | 3:53db6c57bb61 | 16 | #define STANDARD -1 // Squared radar sensor module: -1ºC |
MisterGiet | 3:53db6c57bb61 | 17 | #define ZERO 0 // no offset |
MisterGiet | 3:53db6c57bb61 | 18 | #define OFFSET STANDARD |
MisterGiet | 3:53db6c57bb61 | 19 | |
MisterGiet | 13:0dc9a52cff66 | 20 | #define NEED_SERIAL_CONSOLE_OUTPUT 1 |
MisterGiet | 3:53db6c57bb61 | 21 | #if NEED_SERIAL_CONSOLE_OUTPUT |
MisterGiet | 3:53db6c57bb61 | 22 | Serial pc(PIN_TX, PIN_RX); |
MisterGiet | 3:53db6c57bb61 | 23 | #define SERIAL_DEBUG(...) { printf(__VA_ARGS__); } //Defaults to stdio without having to wirte pcUart explicitly |
MisterGiet | 3:53db6c57bb61 | 24 | #else |
MisterGiet | 3:53db6c57bb61 | 25 | #define SERIAL_DEBUG(...) /* nothing */ |
MisterGiet | 3:53db6c57bb61 | 26 | #endif |
MisterGiet | 3:53db6c57bb61 | 27 | |
MisterGiet | 10:29dbc6d316c3 | 28 | #define NEED_BLE_OUTPUT 1 // Set this if you need debug messages on the console; |
MisterGiet | 3:53db6c57bb61 | 29 | #if NEED_BLE_OUTPUT |
MisterGiet | 3:53db6c57bb61 | 30 | #define DEBUG(STR) { if (uart) uart->write(STR, strlen(STR)); } |
MisterGiet | 3:53db6c57bb61 | 31 | #else |
MisterGiet | 3:53db6c57bb61 | 32 | #define DEBUG(...) /* nothing */ |
MisterGiet | 3:53db6c57bb61 | 33 | #endif /* #if NEED_CONSOLE_OUTPUT */ |
MisterGiet | 3:53db6c57bb61 | 34 | |
MisterGiet | 3:53db6c57bb61 | 35 | I2C i2c(PIN_SDA, PIN_SCL); |
waltercolitti | 0:eb280529b0ef | 36 | Si7020 tempsensor(&i2c); |
waltercolitti | 0:eb280529b0ef | 37 | |
MisterGiet | 6:80f2517965bb | 38 | InterruptIn motion_pin(PIN_PRESENCE_RIGHT); |
MisterGiet | 6:80f2517965bb | 39 | DigitalIn pinR(PIN_PRESENCE_RIGHT, PullNone); |
MisterGiet | 6:80f2517965bb | 40 | DigitalOut ledB(PIN_BLED_PCB, 1); |
MisterGiet | 6:80f2517965bb | 41 | DigitalOut ledR(PIN_RLED_PCB, 1); |
MisterGiet | 3:53db6c57bb61 | 42 | |
MisterGiet | 6:80f2517965bb | 43 | bool presenceState = false; |
MisterGiet | 6:80f2517965bb | 44 | int presenceCounter = 0; |
MisterGiet | 6:80f2517965bb | 45 | //uint8_t presenceCounterBLE = 0; |
MisterGiet | 9:97d8ea1feeed | 46 | bool installMode = 0; |
MisterGiet | 5:173ffbf84b3a | 47 | bool battNotify = 1; |
MisterGiet | 5:173ffbf84b3a | 48 | static volatile bool triggerPresencePolling = false; |
MisterGiet | 5:173ffbf84b3a | 49 | |
MisterGiet | 5:173ffbf84b3a | 50 | |
MisterGiet | 5:173ffbf84b3a | 51 | /* BLE CONFIGURATION */ |
MisterGiet | 5:173ffbf84b3a | 52 | |
MisterGiet | 5:173ffbf84b3a | 53 | BLE ble; |
MisterGiet | 13:0dc9a52cff66 | 54 | static const char DEVICE_NAME[] = "SM00"; |
MisterGiet | 5:173ffbf84b3a | 55 | static const uint16_t uuid16_list[] = {GattService::UUID_HEALTH_THERMOMETER_SERVICE}; |
MisterGiet | 5:173ffbf84b3a | 56 | static volatile bool triggerSensorPolling = false; |
MisterGiet | 11:1186eb69af44 | 57 | static char fwversion[31] = "APP-2217"; |
MisterGiet | 11:1186eb69af44 | 58 | static uint8_t batteryLevel = 99; |
MisterGiet | 5:173ffbf84b3a | 59 | static int8_t TxPower = +4; |
MisterGiet | 10:29dbc6d316c3 | 60 | //static uint8_t humidity = 99; |
MisterGiet | 13:0dc9a52cff66 | 61 | static uint8_t ManufData[] = {0x01,0x02,0x03,0x04,0x05}; // Set up to 26B of advertising data to use for the Manufacturer data. |
MisterGiet | 12:92f008fe602c | 62 | //const static uint8_t ManufData[] = {0x01,0x02,0x03,0x04,0x05}; // Set up to 26B of advertising data to use for the Manufacturer data. |
MisterGiet | 5:173ffbf84b3a | 63 | |
MisterGiet | 10:29dbc6d316c3 | 64 | static HealthThermometerService *thermometerServicePtr = NULL;; |
MisterGiet | 10:29dbc6d316c3 | 65 | static EnvironmentalService* humidityTemperatureServicePtr = NULL; |
MisterGiet | 10:29dbc6d316c3 | 66 | static HumidityMeasureService *humidityService = NULL; |
MisterGiet | 10:29dbc6d316c3 | 67 | static PresenceDetectionService *presenceService = NULL; |
MisterGiet | 12:92f008fe602c | 68 | static BatteryService* batteryServicePtr = NULL;; |
MisterGiet | 5:173ffbf84b3a | 69 | UARTService *uart; |
MisterGiet | 5:173ffbf84b3a | 70 | |
MisterGiet | 5:173ffbf84b3a | 71 | // Firmware |
MisterGiet | 5:173ffbf84b3a | 72 | GattCharacteristic fwChars(GattCharacteristic::UUID_FIRMWARE_REVISION_STRING_CHAR, (uint8_t *)fwversion, sizeof(fwversion), sizeof(fwversion),GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ); |
MisterGiet | 5:173ffbf84b3a | 73 | GattCharacteristic *firmwareChars[] = {&fwChars }; |
MisterGiet | 5:173ffbf84b3a | 74 | GattService firmwareService(GattService::UUID_DEVICE_INFORMATION_SERVICE, firmwareChars, sizeof(firmwareChars) / sizeof(GattCharacteristic *)); |
MisterGiet | 5:173ffbf84b3a | 75 | |
MisterGiet | 5:173ffbf84b3a | 76 | //Power |
MisterGiet | 5:173ffbf84b3a | 77 | GattCharacteristic TxPowerChar(GattCharacteristic::UUID_TX_POWER_LEVEL_CHAR, (uint8_t*)&TxPower, sizeof(TxPower), sizeof(TxPower), GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ); |
MisterGiet | 5:173ffbf84b3a | 78 | GattCharacteristic *charTable[] = {&TxPowerChar}; |
MisterGiet | 5:173ffbf84b3a | 79 | GattService TxPowerService(GattService::UUID_TX_POWER_SERVICE, charTable, sizeof(charTable) / sizeof(GattCharacteristic *)); |
MisterGiet | 5:173ffbf84b3a | 80 | |
MisterGiet | 3:53db6c57bb61 | 81 | /* BATTERY MEASUREMENT */ |
MisterGiet | 3:53db6c57bb61 | 82 | void my_analogin_init(void) |
MisterGiet | 3:53db6c57bb61 | 83 | { |
MisterGiet | 3:53db6c57bb61 | 84 | NRF_ADC->ENABLE = ADC_ENABLE_ENABLE_Enabled; |
MisterGiet | 3:53db6c57bb61 | 85 | NRF_ADC->CONFIG = (ADC_CONFIG_RES_10bit << ADC_CONFIG_RES_Pos) | |
MisterGiet | 3:53db6c57bb61 | 86 | (ADC_CONFIG_INPSEL_SupplyOneThirdPrescaling << ADC_CONFIG_INPSEL_Pos) | |
MisterGiet | 3:53db6c57bb61 | 87 | (ADC_CONFIG_REFSEL_VBG << ADC_CONFIG_REFSEL_Pos) | |
MisterGiet | 3:53db6c57bb61 | 88 | (ADC_CONFIG_PSEL_Disabled << ADC_CONFIG_PSEL_Pos) | |
MisterGiet | 3:53db6c57bb61 | 89 | (ADC_CONFIG_EXTREFSEL_None << ADC_CONFIG_EXTREFSEL_Pos); |
MisterGiet | 3:53db6c57bb61 | 90 | } |
MisterGiet | 3:53db6c57bb61 | 91 | |
MisterGiet | 3:53db6c57bb61 | 92 | uint16_t my_analogin_read_u16(void) |
MisterGiet | 3:53db6c57bb61 | 93 | { |
MisterGiet | 3:53db6c57bb61 | 94 | NRF_ADC->CONFIG &= ~ADC_CONFIG_PSEL_Msk; |
MisterGiet | 3:53db6c57bb61 | 95 | NRF_ADC->CONFIG |= ADC_CONFIG_PSEL_Disabled << ADC_CONFIG_PSEL_Pos; |
MisterGiet | 3:53db6c57bb61 | 96 | NRF_ADC->TASKS_START = 1; |
MisterGiet | 3:53db6c57bb61 | 97 | while (((NRF_ADC->BUSY & ADC_BUSY_BUSY_Msk) >> ADC_BUSY_BUSY_Pos) == ADC_BUSY_BUSY_Busy) {}; |
MisterGiet | 3:53db6c57bb61 | 98 | return (uint16_t)NRF_ADC->RESULT; // 10 bit |
MisterGiet | 3:53db6c57bb61 | 99 | } |
waltercolitti | 0:eb280529b0ef | 100 | |
MisterGiet | 3:53db6c57bb61 | 101 | float getBatteryVolt (void) |
MisterGiet | 3:53db6c57bb61 | 102 | { |
MisterGiet | 3:53db6c57bb61 | 103 | float Vadc = (float)my_analogin_read_u16(); |
MisterGiet | 3:53db6c57bb61 | 104 | float Vref = 1.2; // Internal Vref |
MisterGiet | 3:53db6c57bb61 | 105 | float Vcc = 3 * 4 * Vref * Vadc / 1024.0; |
MisterGiet | 3:53db6c57bb61 | 106 | |
MisterGiet | 13:0dc9a52cff66 | 107 | // Debugging: |
MisterGiet | 13:0dc9a52cff66 | 108 | char message[10]; // 1B per Ascii character |
MisterGiet | 13:0dc9a52cff66 | 109 | sprintf (message, "VCC=%.2f;", Vcc); |
MisterGiet | 13:0dc9a52cff66 | 110 | DEBUG(message); |
MisterGiet | 13:0dc9a52cff66 | 111 | SERIAL_DEBUG(message); |
MisterGiet | 13:0dc9a52cff66 | 112 | |
MisterGiet | 3:53db6c57bb61 | 113 | return Vcc; |
MisterGiet | 3:53db6c57bb61 | 114 | } |
MisterGiet | 3:53db6c57bb61 | 115 | |
MisterGiet | 3:53db6c57bb61 | 116 | int getBatteryPercent () |
MisterGiet | 3:53db6c57bb61 | 117 | { |
MisterGiet | 4:de22f0d73c12 | 118 | float Vbat_min = 2; //2; |
MisterGiet | 3:53db6c57bb61 | 119 | float Vbat_max = 3; |
MisterGiet | 3:53db6c57bb61 | 120 | int battLevel = (int) ( ((getBatteryVolt()-Vbat_min) / (Vbat_max-Vbat_min)) *100); |
MisterGiet | 3:53db6c57bb61 | 121 | |
MisterGiet | 3:53db6c57bb61 | 122 | // To avoid values bigger than 100% |
MisterGiet | 3:53db6c57bb61 | 123 | if (battLevel > 100) { |
MisterGiet | 3:53db6c57bb61 | 124 | battLevel = 100; |
MisterGiet | 3:53db6c57bb61 | 125 | } |
MisterGiet | 3:53db6c57bb61 | 126 | |
MisterGiet | 4:de22f0d73c12 | 127 | // To avoid overflow due to a value lower than Vbat_min |
MisterGiet | 4:de22f0d73c12 | 128 | if (battLevel >= 250) { |
MisterGiet | 4:de22f0d73c12 | 129 | battLevel = 0; |
MisterGiet | 4:de22f0d73c12 | 130 | } |
MisterGiet | 4:de22f0d73c12 | 131 | |
MisterGiet | 13:0dc9a52cff66 | 132 | // Debugging: |
MisterGiet | 13:0dc9a52cff66 | 133 | char message[10]; // 1B per Ascii character |
MisterGiet | 13:0dc9a52cff66 | 134 | sprintf (message, "BAT=%i;", battLevel); |
MisterGiet | 13:0dc9a52cff66 | 135 | DEBUG(message); |
MisterGiet | 13:0dc9a52cff66 | 136 | SERIAL_DEBUG(message); |
MisterGiet | 13:0dc9a52cff66 | 137 | |
MisterGiet | 3:53db6c57bb61 | 138 | return battLevel; |
MisterGiet | 3:53db6c57bb61 | 139 | } |
MisterGiet | 3:53db6c57bb61 | 140 | |
MisterGiet | 3:53db6c57bb61 | 141 | void blinkLed (bool enable, int color) |
MisterGiet | 3:53db6c57bb61 | 142 | { |
MisterGiet | 3:53db6c57bb61 | 143 | if (enable) { |
MisterGiet | 3:53db6c57bb61 | 144 | if (color == 1) { |
MisterGiet | 3:53db6c57bb61 | 145 | ledB=0; |
MisterGiet | 3:53db6c57bb61 | 146 | wait(0.2); |
MisterGiet | 3:53db6c57bb61 | 147 | ledB=1; |
MisterGiet | 3:53db6c57bb61 | 148 | wait(0.2); |
MisterGiet | 3:53db6c57bb61 | 149 | } |
MisterGiet | 3:53db6c57bb61 | 150 | if (color == 2) { |
MisterGiet | 3:53db6c57bb61 | 151 | ledR=0; |
MisterGiet | 3:53db6c57bb61 | 152 | wait(0.2); |
MisterGiet | 3:53db6c57bb61 | 153 | ledR=1; |
MisterGiet | 3:53db6c57bb61 | 154 | wait(0.2); |
MisterGiet | 3:53db6c57bb61 | 155 | } |
MisterGiet | 3:53db6c57bb61 | 156 | } else { |
MisterGiet | 3:53db6c57bb61 | 157 | // do nothing if enable=0 |
MisterGiet | 3:53db6c57bb61 | 158 | } |
MisterGiet | 3:53db6c57bb61 | 159 | } |
waltercolitti | 0:eb280529b0ef | 160 | |
MisterGiet | 6:80f2517965bb | 161 | uint8_t updatePresenceCounter (int counts) |
MisterGiet | 6:80f2517965bb | 162 | { |
MisterGiet | 6:80f2517965bb | 163 | uint8_t uint8_counter; |
MisterGiet | 6:80f2517965bb | 164 | |
MisterGiet | 6:80f2517965bb | 165 | if (counts>=255) { |
MisterGiet | 6:80f2517965bb | 166 | uint8_counter = 255; |
MisterGiet | 6:80f2517965bb | 167 | |
MisterGiet | 6:80f2517965bb | 168 | } else { |
MisterGiet | 6:80f2517965bb | 169 | uint8_counter = uint8_t(counts); |
MisterGiet | 6:80f2517965bb | 170 | } |
MisterGiet | 6:80f2517965bb | 171 | |
MisterGiet | 12:92f008fe602c | 172 | // Debugging: |
MisterGiet | 12:92f008fe602c | 173 | char message[10]; // 1B per Ascii character |
MisterGiet | 12:92f008fe602c | 174 | sprintf (message, "PRES=%i;", uint8_counter); |
MisterGiet | 12:92f008fe602c | 175 | DEBUG(message); |
MisterGiet | 12:92f008fe602c | 176 | SERIAL_DEBUG(message); |
MisterGiet | 12:92f008fe602c | 177 | |
MisterGiet | 6:80f2517965bb | 178 | return uint8_counter; |
MisterGiet | 6:80f2517965bb | 179 | } |
MisterGiet | 6:80f2517965bb | 180 | |
MisterGiet | 10:29dbc6d316c3 | 181 | float getHumidity(void) |
waltercolitti | 0:eb280529b0ef | 182 | { |
MisterGiet | 10:29dbc6d316c3 | 183 | float hum; |
MisterGiet | 10:29dbc6d316c3 | 184 | if(tempsensor.getHumidity(&hum) != 0) { |
MisterGiet | 10:29dbc6d316c3 | 185 | SERIAL_DEBUG("Error getting humidity"); |
MisterGiet | 10:29dbc6d316c3 | 186 | hum = -1; |
MisterGiet | 10:29dbc6d316c3 | 187 | } |
waltercolitti | 0:eb280529b0ef | 188 | |
MisterGiet | 10:29dbc6d316c3 | 189 | // Debugging: |
MisterGiet | 12:92f008fe602c | 190 | char message[10]; // 1B per Ascii character |
MisterGiet | 13:0dc9a52cff66 | 191 | //sprintf (message, "HUM=%.2f;", hum); |
MisterGiet | 13:0dc9a52cff66 | 192 | sprintf (message, "HUM=%i;",(uint16_t)hum); |
MisterGiet | 12:92f008fe602c | 193 | SERIAL_DEBUG(message); |
MisterGiet | 10:29dbc6d316c3 | 194 | DEBUG(message); |
MisterGiet | 10:29dbc6d316c3 | 195 | |
MisterGiet | 10:29dbc6d316c3 | 196 | return hum; |
waltercolitti | 0:eb280529b0ef | 197 | } |
waltercolitti | 0:eb280529b0ef | 198 | |
waltercolitti | 0:eb280529b0ef | 199 | float getTemperature(void) |
waltercolitti | 0:eb280529b0ef | 200 | { |
MisterGiet | 3:53db6c57bb61 | 201 | float temp; |
MisterGiet | 4:de22f0d73c12 | 202 | |
MisterGiet | 3:53db6c57bb61 | 203 | if(tempsensor.getTemperature(&temp) != 0) { |
MisterGiet | 3:53db6c57bb61 | 204 | DEBUG("Error getting temperature"); |
MisterGiet | 3:53db6c57bb61 | 205 | temp = -1; |
MisterGiet | 3:53db6c57bb61 | 206 | } |
waltercolitti | 0:eb280529b0ef | 207 | |
MisterGiet | 3:53db6c57bb61 | 208 | // Adding offset: |
MisterGiet | 3:53db6c57bb61 | 209 | temp = temp + OFFSET; |
MisterGiet | 3:53db6c57bb61 | 210 | |
MisterGiet | 13:0dc9a52cff66 | 211 | // Debugging: |
MisterGiet | 13:0dc9a52cff66 | 212 | char msg[11]; // 1B per Ascii character |
MisterGiet | 13:0dc9a52cff66 | 213 | char msg2[10]; |
MisterGiet | 13:0dc9a52cff66 | 214 | sprintf (msg, "\nTEM=%.2f;", temp); |
MisterGiet | 13:0dc9a52cff66 | 215 | sprintf (msg2, "OFFSET=%i;",OFFSET); |
MisterGiet | 13:0dc9a52cff66 | 216 | SERIAL_DEBUG(msg); |
MisterGiet | 13:0dc9a52cff66 | 217 | DEBUG(msg); |
MisterGiet | 13:0dc9a52cff66 | 218 | SERIAL_DEBUG(msg2); |
MisterGiet | 13:0dc9a52cff66 | 219 | DEBUG(msg2); |
MisterGiet | 13:0dc9a52cff66 | 220 | |
MisterGiet | 3:53db6c57bb61 | 221 | return temp; |
waltercolitti | 0:eb280529b0ef | 222 | } |
waltercolitti | 0:eb280529b0ef | 223 | |
MisterGiet | 12:92f008fe602c | 224 | void updateManufData () |
MisterGiet | 12:92f008fe602c | 225 | { |
MisterGiet | 13:0dc9a52cff66 | 226 | float temp = getTemperature(); |
MisterGiet | 12:92f008fe602c | 227 | float hum = getHumidity(); |
MisterGiet | 13:0dc9a52cff66 | 228 | |
MisterGiet | 12:92f008fe602c | 229 | ManufData [1]= (uint8_t) temp; |
MisterGiet | 12:92f008fe602c | 230 | ManufData [2]= (uint8_t) ((temp -((uint8_t)temp))*100); |
MisterGiet | 13:0dc9a52cff66 | 231 | ManufData [3]= (uint8_t) hum; |
MisterGiet | 12:92f008fe602c | 232 | ManufData [4]= updatePresenceCounter(presenceCounter); |
MisterGiet | 13:0dc9a52cff66 | 233 | |
MisterGiet | 13:0dc9a52cff66 | 234 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA, ManufData, sizeof(ManufData)); |
MisterGiet | 13:0dc9a52cff66 | 235 | |
MisterGiet | 13:0dc9a52cff66 | 236 | // Debugging: |
MisterGiet | 13:0dc9a52cff66 | 237 | char message1[10]; // 1B per Ascii character |
MisterGiet | 13:0dc9a52cff66 | 238 | char message2[10]; // 1B per Ascii character |
MisterGiet | 13:0dc9a52cff66 | 239 | char message3[10]; // 1B per Ascii character |
MisterGiet | 13:0dc9a52cff66 | 240 | char message4[10]; // 1B per Ascii character |
MisterGiet | 13:0dc9a52cff66 | 241 | sprintf (message1, "MD1=%i;", ManufData [1]); |
MisterGiet | 13:0dc9a52cff66 | 242 | sprintf (message2, "MD2=%i;", ManufData [2]); |
MisterGiet | 13:0dc9a52cff66 | 243 | sprintf (message3, "MD3=%i;", ManufData [3]); |
MisterGiet | 13:0dc9a52cff66 | 244 | sprintf (message4, "MD4=%i;", ManufData [4]); |
MisterGiet | 13:0dc9a52cff66 | 245 | SERIAL_DEBUG(message1); |
MisterGiet | 13:0dc9a52cff66 | 246 | SERIAL_DEBUG(message2); |
MisterGiet | 13:0dc9a52cff66 | 247 | SERIAL_DEBUG(message3); |
MisterGiet | 13:0dc9a52cff66 | 248 | SERIAL_DEBUG(message4); |
MisterGiet | 13:0dc9a52cff66 | 249 | DEBUG(message1); |
MisterGiet | 13:0dc9a52cff66 | 250 | DEBUG(message2); |
MisterGiet | 13:0dc9a52cff66 | 251 | DEBUG(message3); |
MisterGiet | 13:0dc9a52cff66 | 252 | DEBUG(message4); |
MisterGiet | 12:92f008fe602c | 253 | } |
MisterGiet | 12:92f008fe602c | 254 | |
MisterGiet | 10:29dbc6d316c3 | 255 | /* Restart Advertising on disconnection*/ |
MisterGiet | 10:29dbc6d316c3 | 256 | void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params) |
MisterGiet | 3:53db6c57bb61 | 257 | { |
MisterGiet | 13:0dc9a52cff66 | 258 | SERIAL_DEBUG("\nDISCONNECTED\n"); |
MisterGiet | 10:29dbc6d316c3 | 259 | BLE::Instance().gap().startAdvertising(); |
MisterGiet | 10:29dbc6d316c3 | 260 | } |
MisterGiet | 3:53db6c57bb61 | 261 | |
MisterGiet | 13:0dc9a52cff66 | 262 | void connectionCallback(const Gap::ConnectionCallbackParams_t *params) |
MisterGiet | 13:0dc9a52cff66 | 263 | { |
MisterGiet | 13:0dc9a52cff66 | 264 | SERIAL_DEBUG("\nCONNECTED\n"); |
MisterGiet | 13:0dc9a52cff66 | 265 | } |
MisterGiet | 13:0dc9a52cff66 | 266 | |
MisterGiet | 10:29dbc6d316c3 | 267 | /** |
MisterGiet | 10:29dbc6d316c3 | 268 | * This function is called when the ble initialization process has failed |
MisterGiet | 10:29dbc6d316c3 | 269 | */ |
MisterGiet | 10:29dbc6d316c3 | 270 | void onBleInitError(BLE &ble, ble_error_t error) |
MisterGiet | 10:29dbc6d316c3 | 271 | { |
MisterGiet | 10:29dbc6d316c3 | 272 | /* Avoid compiler warnings */ |
MisterGiet | 10:29dbc6d316c3 | 273 | (void) ble; |
MisterGiet | 10:29dbc6d316c3 | 274 | (void) error; |
MisterGiet | 10:29dbc6d316c3 | 275 | /* Initialization error handling should go here */ |
MisterGiet | 3:53db6c57bb61 | 276 | } |
MisterGiet | 3:53db6c57bb61 | 277 | |
MisterGiet | 3:53db6c57bb61 | 278 | void onDataWrittenCallback(const GattWriteCallbackParams *params) |
waltercolitti | 0:eb280529b0ef | 279 | { |
MisterGiet | 6:80f2517965bb | 280 | int var = params->data[0]; |
MisterGiet | 6:80f2517965bb | 281 | |
MisterGiet | 6:80f2517965bb | 282 | if (var == 1) { |
MisterGiet | 9:97d8ea1feeed | 283 | blinkLed(installMode,1); |
MisterGiet | 3:53db6c57bb61 | 284 | SERIAL_DEBUG("BLE. Resetting presence\n"); |
MisterGiet | 6:80f2517965bb | 285 | presenceCounter = 0; |
MisterGiet | 6:80f2517965bb | 286 | //presenceCounterBLE = 0; |
MisterGiet | 6:80f2517965bb | 287 | triggerSensorPolling = true; // force update of all BLE services |
MisterGiet | 3:53db6c57bb61 | 288 | } |
MisterGiet | 3:53db6c57bb61 | 289 | |
MisterGiet | 6:80f2517965bb | 290 | if (var == 2) { |
MisterGiet | 3:53db6c57bb61 | 291 | blinkLed(1,1); |
MisterGiet | 3:53db6c57bb61 | 292 | blinkLed(1,1); |
MisterGiet | 3:53db6c57bb61 | 293 | SERIAL_DEBUG("BLE. All LEDs ON/OFF\n"); |
MisterGiet | 9:97d8ea1feeed | 294 | installMode = !installMode; |
MisterGiet | 3:53db6c57bb61 | 295 | } |
MisterGiet | 3:53db6c57bb61 | 296 | |
MisterGiet | 3:53db6c57bb61 | 297 | if (params->data[0] == 3) { |
MisterGiet | 3:53db6c57bb61 | 298 | blinkLed(1,1); |
MisterGiet | 3:53db6c57bb61 | 299 | blinkLed(1,1); |
MisterGiet | 3:53db6c57bb61 | 300 | blinkLed(1,1); |
MisterGiet | 3:53db6c57bb61 | 301 | SERIAL_DEBUG("BLE. Rebooting sensor\n"); |
MisterGiet | 3:53db6c57bb61 | 302 | wait(3); |
MisterGiet | 3:53db6c57bb61 | 303 | NVIC_SystemReset(); // SW Reset |
MisterGiet | 3:53db6c57bb61 | 304 | } |
MisterGiet | 12:92f008fe602c | 305 | |
MisterGiet | 12:92f008fe602c | 306 | if (params->data[0] == 4) { |
MisterGiet | 12:92f008fe602c | 307 | blinkLed(1,1); |
MisterGiet | 12:92f008fe602c | 308 | blinkLed(1,1); |
MisterGiet | 12:92f008fe602c | 309 | blinkLed(1,1); |
MisterGiet | 12:92f008fe602c | 310 | blinkLed(1,1); |
MisterGiet | 12:92f008fe602c | 311 | SERIAL_DEBUG("BLE. Rebooting sensor\n"); |
MisterGiet | 12:92f008fe602c | 312 | /* Enable over-the-air firmware updates. Instantiating DFUSservice introduces a |
MisterGiet | 12:92f008fe602c | 313 | * control characteristic which can be used to trigger the application to |
MisterGiet | 12:92f008fe602c | 314 | * handover control to a resident bootloader. */ |
MisterGiet | 13:0dc9a52cff66 | 315 | //DFUService dfu(ble); |
MisterGiet | 12:92f008fe602c | 316 | } |
waltercolitti | 0:eb280529b0ef | 317 | } |
waltercolitti | 0:eb280529b0ef | 318 | |
waltercolitti | 0:eb280529b0ef | 319 | /** |
waltercolitti | 0:eb280529b0ef | 320 | * Callback triggered when the ble initialization process has finished |
waltercolitti | 0:eb280529b0ef | 321 | */ |
waltercolitti | 0:eb280529b0ef | 322 | void bleInitComplete(BLE::InitializationCompleteCallbackContext *params) |
waltercolitti | 0:eb280529b0ef | 323 | { |
MisterGiet | 13:0dc9a52cff66 | 324 | SERIAL_DEBUG("BLE.Init \n"); |
MisterGiet | 3:53db6c57bb61 | 325 | |
MisterGiet | 3:53db6c57bb61 | 326 | BLE& ble = params->ble; |
waltercolitti | 0:eb280529b0ef | 327 | ble_error_t error = params->error; |
waltercolitti | 0:eb280529b0ef | 328 | |
waltercolitti | 0:eb280529b0ef | 329 | if (error != BLE_ERROR_NONE) { |
waltercolitti | 0:eb280529b0ef | 330 | /* In case of error, forward the error handling to onBleInitError */ |
waltercolitti | 0:eb280529b0ef | 331 | onBleInitError(ble, error); |
waltercolitti | 0:eb280529b0ef | 332 | return; |
waltercolitti | 0:eb280529b0ef | 333 | } |
waltercolitti | 0:eb280529b0ef | 334 | |
waltercolitti | 0:eb280529b0ef | 335 | /* Ensure that it is the default instance of BLE */ |
waltercolitti | 0:eb280529b0ef | 336 | if(ble.getInstanceID() != BLE::DEFAULT_INSTANCE) { |
waltercolitti | 0:eb280529b0ef | 337 | return; |
waltercolitti | 0:eb280529b0ef | 338 | } |
MisterGiet | 3:53db6c57bb61 | 339 | |
MisterGiet | 13:0dc9a52cff66 | 340 | ble.gap().onConnection(connectionCallback); |
MisterGiet | 3:53db6c57bb61 | 341 | ble.gap().onDisconnection(disconnectionCallback); |
waltercolitti | 0:eb280529b0ef | 342 | |
MisterGiet | 3:53db6c57bb61 | 343 | // Set Transmission power: |
MisterGiet | 3:53db6c57bb61 | 344 | ble.setTxPower(TxPower); |
MisterGiet | 3:53db6c57bb61 | 345 | |
MisterGiet | 3:53db6c57bb61 | 346 | //ble.gap().setScanParams(500, 400); |
waltercolitti | 0:eb280529b0ef | 347 | //ble.gap().startScan(advertisementCallback); |
MisterGiet | 3:53db6c57bb61 | 348 | |
waltercolitti | 0:eb280529b0ef | 349 | //BLE server setup |
waltercolitti | 0:eb280529b0ef | 350 | ble.gattServer().onDataWritten(onDataWrittenCallback); |
MisterGiet | 3:53db6c57bb61 | 351 | |
waltercolitti | 0:eb280529b0ef | 352 | //Setup primary services |
MisterGiet | 6:80f2517965bb | 353 | presenceService = new PresenceDetectionService(ble, updatePresenceCounter(presenceCounter)); |
MisterGiet | 10:29dbc6d316c3 | 354 | |
MisterGiet | 3:53db6c57bb61 | 355 | thermometerServicePtr = new HealthThermometerService(ble, getTemperature(), HealthThermometerService::LOCATION_EAR); |
MisterGiet | 3:53db6c57bb61 | 356 | humidityService = new HumidityMeasureService(ble, getHumidity()); |
MisterGiet | 10:29dbc6d316c3 | 357 | |
MisterGiet | 10:29dbc6d316c3 | 358 | humidityTemperatureServicePtr = new EnvironmentalService (ble); |
MisterGiet | 10:29dbc6d316c3 | 359 | batteryServicePtr = new BatteryService(ble, batteryLevel); |
MisterGiet | 10:29dbc6d316c3 | 360 | |
MisterGiet | 3:53db6c57bb61 | 361 | ble.addService(firmwareService); |
MisterGiet | 3:53db6c57bb61 | 362 | uart = new UARTService(ble); |
MisterGiet | 10:29dbc6d316c3 | 363 | //ble.addService(TxPowerService); |
MisterGiet | 3:53db6c57bb61 | 364 | |
MisterGiet | 3:53db6c57bb61 | 365 | /* setup advertising */ |
MisterGiet | 3:53db6c57bb61 | 366 | |
MisterGiet | 3:53db6c57bb61 | 367 | /* Sacrifice 3B of 31B to Advertising Flags */ |
waltercolitti | 0:eb280529b0ef | 368 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE); |
MisterGiet | 3:53db6c57bb61 | 369 | ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); |
MisterGiet | 3:53db6c57bb61 | 370 | |
MisterGiet | 3:53db6c57bb61 | 371 | /* Sacrifice 2B of 31B to AdvType overhead, rest goes to AdvData array you define */ |
MisterGiet | 3:53db6c57bb61 | 372 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA, ManufData, sizeof(ManufData)); |
MisterGiet | 3:53db6c57bb61 | 373 | ble.gap().accumulateAdvertisingPayloadTxPower(TxPower); |
waltercolitti | 0:eb280529b0ef | 374 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list)); |
MisterGiet | 3:53db6c57bb61 | 375 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_THERMOMETER); |
MisterGiet | 3:53db6c57bb61 | 376 | //ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME,(const uint8_t *)"BLE UART", sizeof("BLE UART") - 1); |
MisterGiet | 3:53db6c57bb61 | 377 | //ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS, (const uint8_t *)UARTServiceUUID_reversed, sizeof(UARTServiceUUID_reversed)); |
waltercolitti | 0:eb280529b0ef | 378 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME)); |
waltercolitti | 0:eb280529b0ef | 379 | |
MisterGiet | 3:53db6c57bb61 | 380 | ble.setAdvertisingInterval(1000); /* 1000ms */ |
MisterGiet | 3:53db6c57bb61 | 381 | ble.startAdvertising(); |
waltercolitti | 0:eb280529b0ef | 382 | } |
waltercolitti | 0:eb280529b0ef | 383 | |
waltercolitti | 0:eb280529b0ef | 384 | void periodicCallbackPresence(void) |
waltercolitti | 0:eb280529b0ef | 385 | { |
MisterGiet | 3:53db6c57bb61 | 386 | triggerPresencePolling = true; |
MisterGiet | 6:80f2517965bb | 387 | presenceState = true; |
waltercolitti | 0:eb280529b0ef | 388 | } |
waltercolitti | 0:eb280529b0ef | 389 | |
MisterGiet | 3:53db6c57bb61 | 390 | void periodicCallbackSensor (void) |
waltercolitti | 0:eb280529b0ef | 391 | { |
MisterGiet | 3:53db6c57bb61 | 392 | triggerSensorPolling = true; |
waltercolitti | 0:eb280529b0ef | 393 | } |
waltercolitti | 0:eb280529b0ef | 394 | |
MisterGiet | 6:80f2517965bb | 395 | void updateBLEservices () |
MisterGiet | 6:80f2517965bb | 396 | { |
MisterGiet | 6:80f2517965bb | 397 | thermometerServicePtr->updateTemperature(getTemperature()); |
MisterGiet | 6:80f2517965bb | 398 | humidityService->updateHumidity(getHumidity()); |
MisterGiet | 12:92f008fe602c | 399 | |
MisterGiet | 10:29dbc6d316c3 | 400 | humidityTemperatureServicePtr->updateTemperature (getTemperature()); |
MisterGiet | 10:29dbc6d316c3 | 401 | humidityTemperatureServicePtr->updateHumidity (getHumidity()); |
MisterGiet | 12:92f008fe602c | 402 | |
MisterGiet | 10:29dbc6d316c3 | 403 | batteryServicePtr->updateBatteryLevel(getBatteryPercent()); |
MisterGiet | 12:92f008fe602c | 404 | |
MisterGiet | 12:92f008fe602c | 405 | presenceService->updatePresence(updatePresenceCounter(presenceCounter)); |
MisterGiet | 12:92f008fe602c | 406 | |
MisterGiet | 12:92f008fe602c | 407 | // updateuart ? |
MisterGiet | 6:80f2517965bb | 408 | } |
MisterGiet | 6:80f2517965bb | 409 | |
waltercolitti | 0:eb280529b0ef | 410 | int main(void) |
MisterGiet | 3:53db6c57bb61 | 411 | { |
MisterGiet | 13:0dc9a52cff66 | 412 | SERIAL_DEBUG("\nSTART\n"); |
MisterGiet | 13:0dc9a52cff66 | 413 | DEBUG("\nSTART\n"); |
MisterGiet | 3:53db6c57bb61 | 414 | char pres_message[20]; |
MisterGiet | 3:53db6c57bb61 | 415 | |
MisterGiet | 13:0dc9a52cff66 | 416 | //Serial pc(PIN_TX, PIN_RX); |
MisterGiet | 13:0dc9a52cff66 | 417 | //pc.printf ("PIPPO\n"); |
MisterGiet | 3:53db6c57bb61 | 418 | blinkLed(1,1); |
MisterGiet | 3:53db6c57bb61 | 419 | |
MisterGiet | 3:53db6c57bb61 | 420 | //Ticker ticker_presence; |
MisterGiet | 3:53db6c57bb61 | 421 | //ticker_presence.attach(periodicCallbackPresence, 0.5); |
MisterGiet | 3:53db6c57bb61 | 422 | |
MisterGiet | 3:53db6c57bb61 | 423 | motion_pin.fall(&periodicCallbackPresence); |
MisterGiet | 3:53db6c57bb61 | 424 | |
waltercolitti | 0:eb280529b0ef | 425 | Ticker ticker_sensor; |
MisterGiet | 10:29dbc6d316c3 | 426 | ticker_sensor.attach(periodicCallbackSensor, 3); // 5 min |
MisterGiet | 3:53db6c57bb61 | 427 | |
waltercolitti | 0:eb280529b0ef | 428 | //BLE instance setup |
waltercolitti | 0:eb280529b0ef | 429 | BLE &bleptr = BLE::Instance(); |
waltercolitti | 0:eb280529b0ef | 430 | bleptr.init(bleInitComplete); |
MisterGiet | 3:53db6c57bb61 | 431 | |
MisterGiet | 3:53db6c57bb61 | 432 | /* |
MisterGiet | 3:53db6c57bb61 | 433 | //SpinWait for initialization to complete. This is necessary because the |
MisterGiet | 3:53db6c57bb61 | 434 | //BLE object is used in the main loop below. |
MisterGiet | 3:53db6c57bb61 | 435 | while (ble.hasInitialized() == false) { } |
MisterGiet | 3:53db6c57bb61 | 436 | */ |
MisterGiet | 3:53db6c57bb61 | 437 | |
waltercolitti | 0:eb280529b0ef | 438 | while (true) { |
MisterGiet | 3:53db6c57bb61 | 439 | |
MisterGiet | 3:53db6c57bb61 | 440 | /* Get Presence data: */ |
MisterGiet | 3:53db6c57bb61 | 441 | if(triggerPresencePolling) { |
MisterGiet | 3:53db6c57bb61 | 442 | triggerPresencePolling = false; |
MisterGiet | 3:53db6c57bb61 | 443 | |
MisterGiet | 6:80f2517965bb | 444 | // if presence is detected: |
MisterGiet | 6:80f2517965bb | 445 | if (presenceState) { |
MisterGiet | 10:29dbc6d316c3 | 446 | |
MisterGiet | 6:80f2517965bb | 447 | presenceCounter++; |
MisterGiet | 10:29dbc6d316c3 | 448 | |
MisterGiet | 6:80f2517965bb | 449 | // Update all BLE services for every presence detected: |
MisterGiet | 6:80f2517965bb | 450 | updateBLEservices(); |
MisterGiet | 3:53db6c57bb61 | 451 | |
MisterGiet | 3:53db6c57bb61 | 452 | // Debugging: |
MisterGiet | 9:97d8ea1feeed | 453 | blinkLed(installMode,1); |
MisterGiet | 6:80f2517965bb | 454 | SERIAL_DEBUG("Presence counter: %i\n", presenceCounter); |
MisterGiet | 6:80f2517965bb | 455 | sprintf (pres_message, "Pres=%i\n", presenceCounter); |
MisterGiet | 3:53db6c57bb61 | 456 | DEBUG(pres_message); |
MisterGiet | 3:53db6c57bb61 | 457 | |
MisterGiet | 6:80f2517965bb | 458 | presenceState=0; |
MisterGiet | 3:53db6c57bb61 | 459 | } |
MisterGiet | 3:53db6c57bb61 | 460 | |
MisterGiet | 6:80f2517965bb | 461 | // if no presence: |
MisterGiet | 3:53db6c57bb61 | 462 | else { |
MisterGiet | 3:53db6c57bb61 | 463 | SERIAL_DEBUG("."); |
MisterGiet | 3:53db6c57bb61 | 464 | } |
MisterGiet | 3:53db6c57bb61 | 465 | } |
MisterGiet | 3:53db6c57bb61 | 466 | |
MisterGiet | 13:0dc9a52cff66 | 467 | updateManufData (); // update advertising values |
MisterGiet | 13:0dc9a52cff66 | 468 | |
MisterGiet | 10:29dbc6d316c3 | 469 | /* Update BLE services if connected: */ |
waltercolitti | 0:eb280529b0ef | 470 | if (triggerSensorPolling && ble.getGapState().connected) { |
MisterGiet | 10:29dbc6d316c3 | 471 | |
MisterGiet | 6:80f2517965bb | 472 | // Quanto consuma quando sta leggendo la temperatura? |
waltercolitti | 0:eb280529b0ef | 473 | triggerSensorPolling = false; |
MisterGiet | 6:80f2517965bb | 474 | |
MisterGiet | 10:29dbc6d316c3 | 475 | updateBLEservices(); |
MisterGiet | 12:92f008fe602c | 476 | |
MisterGiet | 11:1186eb69af44 | 477 | /* |
MisterGiet | 4:de22f0d73c12 | 478 | // Red LED blinks if low battery, at every connection |
MisterGiet | 4:de22f0d73c12 | 479 | if (batteryLevel <= 10) { |
MisterGiet | 5:173ffbf84b3a | 480 | blinkLed(battNotify,2); |
MisterGiet | 4:de22f0d73c12 | 481 | } |
MisterGiet | 11:1186eb69af44 | 482 | */ |
MisterGiet | 12:92f008fe602c | 483 | |
MisterGiet | 3:53db6c57bb61 | 484 | } else { |
MisterGiet | 3:53db6c57bb61 | 485 | ble.waitForEvent(); |
waltercolitti | 0:eb280529b0ef | 486 | } |
MisterGiet | 13:0dc9a52cff66 | 487 | //SERIAL_DEBUG("\n"); |
MisterGiet | 13:0dc9a52cff66 | 488 | //DEBUG("\n"); |
waltercolitti | 0:eb280529b0ef | 489 | } |
MisterGiet | 6:80f2517965bb | 490 | } |