Nakatafu ☆ / Mbed 2 deprecated BLE_Lightning_sensor

BLE Lightning sensor for Nordic NRF51822 based module

Dependencies:   AS3935 AS3935_ext BLE_API mbed nRF51822 nrf51_rtc

main.cpp@1:a4119049dd99, 2015-08-27 (annotated)

Committer:
takafuminaka
Date:
Thu Aug 27 16:18:20 2015 +0000
Revision:
1:a4119049dd99
Parent:
0:371bcac81ea2
Child:
2:e1e638cbf972
temporary save on 2015/08/28; ??????HTM by InTempSensor????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
takafuminaka 0:371bcac81ea2 1 /*
takafuminaka 0:371bcac81ea2 2
takafuminaka 0:371bcac81ea2 3 */
takafuminaka 0:371bcac81ea2 4
takafuminaka 0:371bcac81ea2 5 #include "mbed.h"
takafuminaka 1:a4119049dd99 6 #include "BLE.h"
takafuminaka 0:371bcac81ea2 7 #include "nrf51_rtc.h"
takafuminaka 0:371bcac81ea2 8 #include "AS3935_ext.h"
takafuminaka 0:371bcac81ea2 9
takafuminaka 1:a4119049dd99 10 #include "nrf_soc.h" // for internal Thermo sensoer
takafuminaka 1:a4119049dd99 11
takafuminaka 1:a4119049dd99 12 #define NEED_CONSOLE_OUTPUT 1 /* Set this if you need debug messages on the console;
takafuminaka 1:a4119049dd99 13 * it will have an impact on code-size and power consumption. */
takafuminaka 1:a4119049dd99 14
takafuminaka 1:a4119049dd99 15 #if NEED_CONSOLE_OUTPUT
takafuminaka 1:a4119049dd99 16 Serial pc(USBTX, USBRX);
takafuminaka 1:a4119049dd99 17 #define DEBUG(...) { pc.printf(__VA_ARGS__); }
takafuminaka 1:a4119049dd99 18 #else
takafuminaka 1:a4119049dd99 19 #define DEBUG(...) /* nothing */
takafuminaka 1:a4119049dd99 20 #endif /* #if NEED_CONSOLE_OUTPUT */
takafuminaka 1:a4119049dd99 21
takafuminaka 1:a4119049dd99 22 // Prepare BLE device
takafuminaka 1:a4119049dd99 23 BLEDevice ble;
takafuminaka 1:a4119049dd99 24 const static char DEVICE_NAME[] = "BLE-LITNING-S";
takafuminaka 1:a4119049dd99 25
takafuminaka 1:a4119049dd99 26 /* Health Thermometer Service */
takafuminaka 1:a4119049dd99 27 /* Service: https://developer.bluetooth.org/gatt/services/Pages/ServiceViewer.aspx?u=org.bluetooth.service.health_thermometer.xml */
takafuminaka 1:a4119049dd99 28 /* HTM Char: https://developer.bluetooth.org/gatt/characteristics/Pages/CharacteristicViewer.aspx?u=org.bluetooth.characteristic.temperature_measurement.xml */
takafuminaka 1:a4119049dd99 29 uint8_t thermTempPayload[5] = { 0, 0, 0, 0, 0 };
takafuminaka 1:a4119049dd99 30
takafuminaka 1:a4119049dd99 31 GattCharacteristic tempChar (GattCharacteristic::UUID_TEMPERATURE_MEASUREMENT_CHAR,
takafuminaka 1:a4119049dd99 32 thermTempPayload, sizeof(thermTempPayload), sizeof(thermTempPayload),
takafuminaka 1:a4119049dd99 33 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE);
takafuminaka 1:a4119049dd99 34 GattCharacteristic *htmChars[] = {&tempChar, };
takafuminaka 1:a4119049dd99 35 GattService htmService(GattService::UUID_HEALTH_THERMOMETER_SERVICE, htmChars,
takafuminaka 1:a4119049dd99 36 sizeof(htmChars) / sizeof(GattCharacteristic *));
takafuminaka 1:a4119049dd99 37
takafuminaka 1:a4119049dd99 38 /* Original Thermometer Service */
takafuminaka 1:a4119049dd99 39 /* with nRF51822 internal thermal sensor */
takafuminaka 1:a4119049dd99 40 uint8_t internalTempPayload[5] = { 0, 0, 0, 0, 0 };
takafuminaka 1:a4119049dd99 41
takafuminaka 1:a4119049dd99 42 GattCharacteristic internalTempChar (GattCharacteristic::UUID_TEMPERATURE_MEASUREMENT_CHAR + 0x2000,
takafuminaka 1:a4119049dd99 43 internalTempPayload, sizeof(internalTempPayload), sizeof(internalTempPayload),
takafuminaka 1:a4119049dd99 44 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_INDICATE);
takafuminaka 1:a4119049dd99 45 GattCharacteristic *itmChars[] = {&internalTempChar, };
takafuminaka 1:a4119049dd99 46 GattService itmService(GattService::UUID_HEALTH_THERMOMETER_SERVICE + 0x2000, itmChars,
takafuminaka 1:a4119049dd99 47 sizeof(itmChars) / sizeof(GattCharacteristic *));
takafuminaka 1:a4119049dd99 48
takafuminaka 1:a4119049dd99 49 /* Battery Level Service */
takafuminaka 1:a4119049dd99 50 uint8_t batt = 98; /* Battery level */
takafuminaka 1:a4119049dd99 51 uint8_t read_batt = 0; /* Variable to hold battery level reads */
takafuminaka 1:a4119049dd99 52 static uint8_t bpm2[1] = {batt};
takafuminaka 1:a4119049dd99 53 GattCharacteristic battLevel ( GattCharacteristic::UUID_BATTERY_LEVEL_CHAR, bpm2, sizeof(bpm2), sizeof(bpm2),
takafuminaka 1:a4119049dd99 54 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY |
takafuminaka 1:a4119049dd99 55 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ);
takafuminaka 1:a4119049dd99 56 GattCharacteristic *battChars[] = {&battLevel, };
takafuminaka 1:a4119049dd99 57 GattService battService(GattService::UUID_BATTERY_SERVICE, battChars, sizeof(battChars) / sizeof(GattCharacteristic *));
takafuminaka 1:a4119049dd99 58
takafuminaka 1:a4119049dd99 59 static const uint16_t uuid16_list[] = {GattService::UUID_HEALTH_THERMOMETER_SERVICE, GattService::UUID_BATTERY_SERVICE, GattService::UUID_HEALTH_THERMOMETER_SERVICE + 0x2000 };
takafuminaka 1:a4119049dd99 60
takafuminaka 1:a4119049dd99 61 static volatile bool triggerSensorPolling = false; /* set to high periodically to indicate to the main thread that
takafuminaka 1:a4119049dd99 62 * polling is necessary. */
takafuminaka 1:a4119049dd99 63 static Gap::ConnectionParams_t connectionParams;
takafuminaka 1:a4119049dd99 64
takafuminaka 1:a4119049dd99 65 uint32_t quick_ieee11073_from_float(float temperature);
takafuminaka 1:a4119049dd99 66
takafuminaka 1:a4119049dd99 67 void Update_Values();
takafuminaka 1:a4119049dd99 68
takafuminaka 1:a4119049dd99 69
takafuminaka 1:a4119049dd99 70 // Prepare LED device
takafuminaka 1:a4119049dd99 71 DigitalOut led1(LED1);
takafuminaka 1:a4119049dd99 72 DigitalOut led2(LED2);
takafuminaka 1:a4119049dd99 73
takafuminaka 0:371bcac81ea2 74 AS3935_ext Lightning(I2C_SDA0,I2C_SCL0,0x00,P0_23);
takafuminaka 0:371bcac81ea2 75 InterruptIn IntLightning(P0_23); //IRQ AS3935
takafuminaka 0:371bcac81ea2 76
takafuminaka 0:371bcac81ea2 77 // used for the example only, not required for rtc use
takafuminaka 0:371bcac81ea2 78 DigitalIn button1(BUTTON1); // used to trigger the time report
takafuminaka 0:371bcac81ea2 79 InterruptIn button1Press(BUTTON1);
takafuminaka 0:371bcac81ea2 80
takafuminaka 0:371bcac81ea2 81
takafuminaka 0:371bcac81ea2 82 time_t example_time() {
takafuminaka 0:371bcac81ea2 83 // set an intial time
takafuminaka 0:371bcac81ea2 84 // ...not really necessary for this example, but it beats setting it to 0 or some non-obvious large integer (# of seconds since 1/1/1970)
takafuminaka 0:371bcac81ea2 85 time_t rawtime=0;
takafuminaka 0:371bcac81ea2 86
takafuminaka 0:371bcac81ea2 87 struct tm * init_timeinfo;
takafuminaka 0:371bcac81ea2 88
takafuminaka 0:371bcac81ea2 89 // initialize time
takafuminaka 0:371bcac81ea2 90 init_timeinfo = localtime(&rawtime); // note: must initialize the struct with this before trying to set components
takafuminaka 0:371bcac81ea2 91 // ...else code goes into the weeds!!
takafuminaka 0:371bcac81ea2 92 init_timeinfo->tm_sec = 0;
takafuminaka 0:371bcac81ea2 93 init_timeinfo->tm_min = 0;
takafuminaka 0:371bcac81ea2 94 init_timeinfo->tm_hour = 0;
takafuminaka 0:371bcac81ea2 95 init_timeinfo->tm_mon = 0;
takafuminaka 0:371bcac81ea2 96 init_timeinfo->tm_mday = 1;
takafuminaka 0:371bcac81ea2 97 init_timeinfo->tm_year = 0;
takafuminaka 0:371bcac81ea2 98
takafuminaka 0:371bcac81ea2 99 char date[24];
takafuminaka 0:371bcac81ea2 100 strftime(date,sizeof(date),"%H:%M:%S on %m/%d/%G",init_timeinfo);
takafuminaka 1:a4119049dd99 101 DEBUG("Initial time set is %s.\r\n",date);
takafuminaka 0:371bcac81ea2 102
takafuminaka 0:371bcac81ea2 103 // compute the proper value for time in time_t type
takafuminaka 0:371bcac81ea2 104 rawtime = mktime(init_timeinfo);
takafuminaka 0:371bcac81ea2 105 return rawtime;
takafuminaka 0:371bcac81ea2 106 }
takafuminaka 1:a4119049dd99 107
takafuminaka 0:371bcac81ea2 108 void print_time() {
takafuminaka 0:371bcac81ea2 109 // called when a button is pushed, this prints the current time to the USB-connected console
takafuminaka 0:371bcac81ea2 110
takafuminaka 0:371bcac81ea2 111 time_t rawtime=rtc.time();
takafuminaka 0:371bcac81ea2 112
takafuminaka 0:371bcac81ea2 113 // massage the time into a human-friendly format for printing
takafuminaka 0:371bcac81ea2 114 struct tm * timeinfo;
takafuminaka 0:371bcac81ea2 115 timeinfo = localtime(&rawtime);
takafuminaka 0:371bcac81ea2 116 char date[24];
takafuminaka 0:371bcac81ea2 117 strftime(date,sizeof(date),"%H:%M:%S on %m/%d/%G",timeinfo);
takafuminaka 1:a4119049dd99 118 DEBUG("The current time is %s.(%d)\r\n",date,rawtime);
takafuminaka 0:371bcac81ea2 119 }
takafuminaka 0:371bcac81ea2 120
takafuminaka 1:a4119049dd99 121 void periodic_update() {
takafuminaka 0:371bcac81ea2 122 // for use as interrupt routine, to insure that RTC is updated periodically
takafuminaka 0:371bcac81ea2 123 // ...if rtc is not read before the underlying counter rolls over (typically 512 seconds), the RTC value will be wrong
takafuminaka 0:371bcac81ea2 124 // ...ideally this would be done as part of the nrf51_rtc method, but I couldn't get it to behave (see nrf51_rtc.cpp for details)
takafuminaka 0:371bcac81ea2 125 rtc.time();
takafuminaka 1:a4119049dd99 126 Lightning.lightningDistanceKm();
takafuminaka 1:a4119049dd99 127 led1 = !led1;
takafuminaka 1:a4119049dd99 128
takafuminaka 1:a4119049dd99 129 triggerSensorPolling = true;
takafuminaka 0:371bcac81ea2 130 // print_time();
takafuminaka 0:371bcac81ea2 131 }
takafuminaka 0:371bcac81ea2 132
takafuminaka 0:371bcac81ea2 133 void DetectLightning()
takafuminaka 0:371bcac81ea2 134 {
takafuminaka 0:371bcac81ea2 135 char OriginInt;
takafuminaka 0:371bcac81ea2 136 time_t rawtime=rtc.time();
takafuminaka 0:371bcac81ea2 137 struct tm * timeinfo;
takafuminaka 0:371bcac81ea2 138 timeinfo = localtime(&rawtime);
takafuminaka 0:371bcac81ea2 139 char date[24];
takafuminaka 0:371bcac81ea2 140 int distance;
takafuminaka 0:371bcac81ea2 141
takafuminaka 0:371bcac81ea2 142 strftime(date,sizeof(date),"%H:%M:%S on %m/%d/%G",timeinfo);
takafuminaka 0:371bcac81ea2 143
takafuminaka 0:371bcac81ea2 144 wait_ms(2); //on attend 2ms préconisation constructeur
takafuminaka 0:371bcac81ea2 145 OriginInt = Lightning.interruptSource();
takafuminaka 0:371bcac81ea2 146 distance = Lightning.lightningDistanceKm();
takafuminaka 0:371bcac81ea2 147
takafuminaka 1:a4119049dd99 148 if (OriginInt == 1) {
takafuminaka 1:a4119049dd99 149 led2 = !led2;
takafuminaka 1:a4119049dd99 150 DEBUG("%24s : Noise level too high. %d km\r\n",date,distance);
takafuminaka 0:371bcac81ea2 151 }
takafuminaka 0:371bcac81ea2 152 if (OriginInt == 4) {
takafuminaka 1:a4119049dd99 153 led2 = !led2;
takafuminaka 1:a4119049dd99 154 DEBUG("%24s : Disturber detected. %d km\r\n",date,distance);
takafuminaka 0:371bcac81ea2 155 }
takafuminaka 0:371bcac81ea2 156 if (OriginInt == 8) {
takafuminaka 1:a4119049dd99 157 led2 = !led2;
takafuminaka 1:a4119049dd99 158 DEBUG("%24s : Lightning interrupt %d km\r\n",date,distance);
takafuminaka 0:371bcac81ea2 159 }
takafuminaka 0:371bcac81ea2 160 }
takafuminaka 0:371bcac81ea2 161
takafuminaka 1:a4119049dd99 162 void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason) // Mod
takafuminaka 1:a4119049dd99 163 {
takafuminaka 1:a4119049dd99 164 DEBUG("Disconnected handle %u!\n\r", handle);
takafuminaka 1:a4119049dd99 165 DEBUG("Restarting the advertising process\n\r");
takafuminaka 1:a4119049dd99 166 led2 = 0;
takafuminaka 1:a4119049dd99 167 ble.gap().startAdvertising();
takafuminaka 1:a4119049dd99 168 }
takafuminaka 1:a4119049dd99 169
takafuminaka 1:a4119049dd99 170 void onConnectionCallback(const Gap::ConnectionCallbackParams_t *params)
takafuminaka 1:a4119049dd99 171 {
takafuminaka 1:a4119049dd99 172 DEBUG("connected. Got handle %u\r\n", params->handle);
takafuminaka 1:a4119049dd99 173
takafuminaka 1:a4119049dd99 174 connectionParams.slaveLatency = 1;
takafuminaka 1:a4119049dd99 175 led2 = 1;
takafuminaka 1:a4119049dd99 176 if (ble.gap().updateConnectionParams(params->handle, &connectionParams) != BLE_ERROR_NONE) {
takafuminaka 1:a4119049dd99 177 DEBUG("failed to update connection paramter\r\n");
takafuminaka 1:a4119049dd99 178 }
takafuminaka 1:a4119049dd99 179
takafuminaka 1:a4119049dd99 180 }
takafuminaka 0:371bcac81ea2 181
takafuminaka 0:371bcac81ea2 182 int main(void)
takafuminaka 0:371bcac81ea2 183 {
takafuminaka 1:a4119049dd99 184 led1=0;
takafuminaka 1:a4119049dd99 185 led2=0;
takafuminaka 0:371bcac81ea2 186 int hz=0;
takafuminaka 0:371bcac81ea2 187
takafuminaka 0:371bcac81ea2 188 //initialisations
takafuminaka 1:a4119049dd99 189 DEBUG("reset\r\n");
takafuminaka 0:371bcac81ea2 190 Lightning.reset();
takafuminaka 1:a4119049dd99 191 DEBUG("setTuneCap as 5\r\n");
takafuminaka 0:371bcac81ea2 192 Lightning.setTuneCap(5); // Tuning Parameter
takafuminaka 1:a4119049dd99 193 DEBUG("powerup\r\n");
takafuminaka 0:371bcac81ea2 194 Lightning.powerUp();
takafuminaka 1:a4119049dd99 195 DEBUG("setOutdoors\r\n");
takafuminaka 1:a4119049dd99 196 Lightning.setOutdoors(); // Set Device into Outdoor mode
takafuminaka 0:371bcac81ea2 197
takafuminaka 1:a4119049dd99 198 DEBUG("Auto Calibration Start\r\n");
takafuminaka 0:371bcac81ea2 199 float minerr = 100;
takafuminaka 0:371bcac81ea2 200 int fincap = 7;
takafuminaka 0:371bcac81ea2 201 for(int i=0;i<16;i++) {
takafuminaka 0:371bcac81ea2 202 Lightning.setTuneCap(i); // Tuning Parameter
takafuminaka 0:371bcac81ea2 203 hz = Lightning.MeasureLCOFreq();
takafuminaka 0:371bcac81ea2 204 float err = (hz-500000.)/500000.*100.;
takafuminaka 1:a4119049dd99 205 DEBUG("%d : hz=%10d Hz (%5.2f%%)\r\n",i,hz,err);
takafuminaka 0:371bcac81ea2 206 if ( abs(err) < minerr ) {
takafuminaka 0:371bcac81ea2 207 minerr = abs(err);
takafuminaka 0:371bcac81ea2 208 fincap = i;
takafuminaka 0:371bcac81ea2 209 }
takafuminaka 0:371bcac81ea2 210 }
takafuminaka 0:371bcac81ea2 211 Lightning.setTuneCap(fincap); // Tuning Parameter
takafuminaka 0:371bcac81ea2 212 wait_ms(100);
takafuminaka 0:371bcac81ea2 213 hz = Lightning.MeasureLCOFreq();
takafuminaka 0:371bcac81ea2 214 float err = (hz-500000.)/500000.*100.;
takafuminaka 1:a4119049dd99 215 DEBUG("Final %d : hz=%10d Hz (%5.2f%%)\r\n",fincap,hz,err);
takafuminaka 0:371bcac81ea2 216
takafuminaka 1:a4119049dd99 217 DEBUG("Auto Calibration finished\r\n");
takafuminaka 0:371bcac81ea2 218
takafuminaka 0:371bcac81ea2 219 // user selectable, any time < 512 seconds is OK
takafuminaka 0:371bcac81ea2 220 #define PERIODIC_UPDATE 1
takafuminaka 0:371bcac81ea2 221 Ticker rtc_ticker;
takafuminaka 1:a4119049dd99 222 rtc_ticker.attach(&periodic_update, PERIODIC_UPDATE);
takafuminaka 0:371bcac81ea2 223
takafuminaka 0:371bcac81ea2 224 time_t initial_time = example_time();
takafuminaka 0:371bcac81ea2 225 rtc.set_time(initial_time);
takafuminaka 0:371bcac81ea2 226
takafuminaka 0:371bcac81ea2 227 button1Press.fall(&print_time); // when button1 is pressed, this calls rtc.time() and prints it
takafuminaka 0:371bcac81ea2 228
takafuminaka 0:371bcac81ea2 229 IntLightning.rise(&DetectLightning);
takafuminaka 0:371bcac81ea2 230
takafuminaka 1:a4119049dd99 231 ble.init();
takafuminaka 1:a4119049dd99 232 ble.gap().onDisconnection(disconnectionCallback);
takafuminaka 1:a4119049dd99 233 ble.gap().onConnection(onConnectionCallback);
takafuminaka 1:a4119049dd99 234
takafuminaka 1:a4119049dd99 235 ble.gap().getPreferredConnectionParams(&connectionParams);
takafuminaka 1:a4119049dd99 236
takafuminaka 1:a4119049dd99 237 /* setup advertising */
takafuminaka 1:a4119049dd99 238 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
takafuminaka 1:a4119049dd99 239 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t*)uuid16_list, sizeof(uuid16_list));
takafuminaka 1:a4119049dd99 240 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_THERMOMETER);
takafuminaka 1:a4119049dd99 241
takafuminaka 1:a4119049dd99 242 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME));
takafuminaka 1:a4119049dd99 243
takafuminaka 1:a4119049dd99 244 ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
takafuminaka 1:a4119049dd99 245 ble.gap().setAdvertisingInterval(160); /* 100ms; in multiples of 0.625ms. */
takafuminaka 1:a4119049dd99 246 ble.gap().startAdvertising();
takafuminaka 1:a4119049dd99 247
takafuminaka 1:a4119049dd99 248 ble.gattServer().addService(htmService);
takafuminaka 1:a4119049dd99 249 ble.gattServer().addService(battService);
takafuminaka 1:a4119049dd99 250
takafuminaka 1:a4119049dd99 251
takafuminaka 0:371bcac81ea2 252 while (true) {
takafuminaka 1:a4119049dd99 253 if (triggerSensorPolling) {
takafuminaka 1:a4119049dd99 254 triggerSensorPolling = false;
takafuminaka 1:a4119049dd99 255
takafuminaka 1:a4119049dd99 256 Update_Values();
takafuminaka 1:a4119049dd99 257
takafuminaka 1:a4119049dd99 258 } else {
takafuminaka 1:a4119049dd99 259 ble.waitForEvent();
takafuminaka 1:a4119049dd99 260 }
takafuminaka 0:371bcac81ea2 261 }
takafuminaka 0:371bcac81ea2 262 }
takafuminaka 1:a4119049dd99 263
takafuminaka 1:a4119049dd99 264 void Update_Values()
takafuminaka 1:a4119049dd99 265 {
takafuminaka 1:a4119049dd99 266 /* Update the temperature. Note that we need to convert to an ieee11073 format float. */
takafuminaka 1:a4119049dd99 267
takafuminaka 1:a4119049dd99 268 int32_t p_temp;
takafuminaka 1:a4119049dd99 269 sd_temp_get(&p_temp);
takafuminaka 1:a4119049dd99 270 float temperature = float(p_temp)/4.;
takafuminaka 1:a4119049dd99 271 temperature -= 14.; // It should be changed device by device.
takafuminaka 1:a4119049dd99 272
takafuminaka 1:a4119049dd99 273 // DEBUG("temp:%f\n\r", temperature);
takafuminaka 1:a4119049dd99 274 uint32_t temp_ieee11073 = quick_ieee11073_from_float(temperature);
takafuminaka 1:a4119049dd99 275 memcpy(thermTempPayload+1, &temp_ieee11073, 4);
takafuminaka 1:a4119049dd99 276
takafuminaka 1:a4119049dd99 277 /* Battery Service Update */
takafuminaka 1:a4119049dd99 278 /* Update battery level */
takafuminaka 1:a4119049dd99 279 //ble.getGattServer().updateValue(battLevel.handle, (uint8_t*)&batt, sizeof(batt));
takafuminaka 1:a4119049dd99 280 /* Decrement the battery level. */
takafuminaka 1:a4119049dd99 281 batt <=50 ? batt=100 : batt--;;
takafuminaka 1:a4119049dd99 282 bpm2[0] = batt;
takafuminaka 1:a4119049dd99 283
takafuminaka 1:a4119049dd99 284 if (ble.gap().getState().connected ) {
takafuminaka 1:a4119049dd99 285 ble.gattServer().write(tempChar.getValueAttribute().getHandle(), thermTempPayload, sizeof(thermTempPayload));
takafuminaka 1:a4119049dd99 286 ble.gattServer().write(battLevel.getValueAttribute().getHandle(), (uint8_t *)&batt, sizeof(batt));
takafuminaka 1:a4119049dd99 287 }
takafuminaka 1:a4119049dd99 288 }
takafuminaka 1:a4119049dd99 289
takafuminaka 1:a4119049dd99 290 /**
takafuminaka 1:a4119049dd99 291 * @brief A very quick conversion between a float temperature and 11073-20601 FLOAT-Type.
takafuminaka 1:a4119049dd99 292 * @param temperature The temperature as a float.
takafuminaka 1:a4119049dd99 293 * @return The temperature in 11073-20601 FLOAT-Type format.
takafuminaka 1:a4119049dd99 294 */
takafuminaka 1:a4119049dd99 295 uint32_t quick_ieee11073_from_float(float temperature)
takafuminaka 1:a4119049dd99 296 {
takafuminaka 1:a4119049dd99 297 uint8_t exponent = 0xFE; //exponent is -2
takafuminaka 1:a4119049dd99 298 uint32_t mantissa = (uint32_t)(temperature*100);
takafuminaka 1:a4119049dd99 299
takafuminaka 1:a4119049dd99 300 return ( ((uint32_t)exponent) << 24) | mantissa;
takafuminaka 1:a4119049dd99 301 }