Duy tran / Mbed OS HealthCare_Graduation

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   PulseSensor GSM Thermometer KalmanFilter

Application/main.cpp@16:0325e647496f, 2018-05-23 (annotated)

Committer:
DuyLionTran
Date:
Wed May 23 17:33:11 2018 +0000
Revision:
16:0325e647496f
Parent:
15:00a1c0ea570c
Child:
17:b7c2db3e7282
HTS Type and HRM Location can be changed by use through BLE

Who changed what in which revision?

UserRevisionLine numberNew contents of line
DuyLionTran 0:64ca984b3efd 1 /**
DuyLionTran 2:16f6cfcd7505 2 * This is the project for "BLE HealthCare". The device is attached on any patient's body at will.
DuyLionTran 0:64ca984b3efd 3
DuyLionTran 0:64ca984b3efd 4 * Revision:
DuyLionTran 2:16f6cfcd7505 5 * version 0.8 02-12-2018
DuyLionTran 2:16f6cfcd7505 6 * version 0.8.5 02-14-2018
DuyLionTran 4:e44cd8682f1c 7 * version 0.9 02-15-2018 Pulse sensor and thermometer added
DuyLionTran 4:e44cd8682f1c 8 * version 0.9.5 02-16-2018 Calculation for pulse sensor and thermometer. GSM library added
DuyLionTran 6:26a4b005cb75 9 * version 0.9.6 02-21-2018 Update mbed-os
DuyLionTran 7:d8032114995b 10 * version 0.9.6 02-21-2018 Some modification for LM35
DuyLionTran 8:3384286a8498 11 * version 0.9.8 03-04-2018 Data receiving from client device added
DuyLionTran 9:be09a9bf2e2e 12 * version 1.0 03-09-2018 Some minor bugs fixed
DuyLionTran 10:4e0f5173269e 13 * version 1.0.5 03-09-2018 Some minor bugs fixed
DuyLionTran 0:64ca984b3efd 14
DuyLionTran 0:64ca984b3efd 15 /* ======================== INCLUDES ========================= */
DuyLionTran 0:64ca984b3efd 16 #include <events/mbed_events.h>
DuyLionTran 0:64ca984b3efd 17 #include <mbed.h>
DuyLionTran 0:64ca984b3efd 18 #include "ble/BLE.h"
DuyLionTran 0:64ca984b3efd 19 #include "ble_healthcare_service.h"
DuyLionTran 5:c12c16c0d2ea 20 #include "GSM.h"
DuyLionTran 4:e44cd8682f1c 21 #include "LM35.h"
DuyLionTran 3:9b552b775c6e 22 #include "PulseSensor.h"
DuyLionTran 0:64ca984b3efd 23
DuyLionTran 4:e44cd8682f1c 24
DuyLionTran 4:e44cd8682f1c 25
DuyLionTran 0:64ca984b3efd 26 /* ======================== DEFINES ========================== */
DuyLionTran 4:e44cd8682f1c 27 #define PULSE_SENSOR_PIN A0
DuyLionTran 4:e44cd8682f1c 28 #define THERM_SENSOR_PIN A1
DuyLionTran 0:64ca984b3efd 29
DuyLionTran 0:64ca984b3efd 30 /* ======================= VARIABLES ========================= */
DuyLionTran 0:64ca984b3efd 31 /* GLOBAL VARIABLES */
DuyLionTran 0:64ca984b3efd 32 static float currentTemperature = 39.6;
DuyLionTran 0:64ca984b3efd 33 static uint8_t currentHRMCounter = 80;
DuyLionTran 11:5a4313edf10d 34 static float sendCombinedTempAndHR;
DuyLionTran 0:64ca984b3efd 35
DuyLionTran 0:64ca984b3efd 36 /* PRIVATE VARIABLES */
DuyLionTran 8:3384286a8498 37 uint8_t HRM_increasement = 1;
DuyLionTran 9:be09a9bf2e2e 38 uint8_t cnt;
DuyLionTran 8:3384286a8498 39
DuyLionTran 9:be09a9bf2e2e 40 /* No need to display the device name */
DuyLionTran 9:be09a9bf2e2e 41 //const static char DEVICE_NAME[] = "BODY SENSOR";
DuyLionTran 9:be09a9bf2e2e 42
DuyLionTran 8:3384286a8498 43 static const uint16_t uuid16_list[] = {GattService::UUID_HEART_RATE_SERVICE,
DuyLionTran 8:3384286a8498 44 GattService::UUID_HEALTH_THERMOMETER_SERVICE,
DuyLionTran 9:be09a9bf2e2e 45 HealthCareService::USER_DATA_SERVICE_UUID,
DuyLionTran 9:be09a9bf2e2e 46 HealthCareService::DEVICE_INFO_SERVICE_UUID
DuyLionTran 9:be09a9bf2e2e 47 };
DuyLionTran 0:64ca984b3efd 48
DuyLionTran 0:64ca984b3efd 49 /* STRUCTS/CLASSESS */
DuyLionTran 0:64ca984b3efd 50 static EventQueue eventQueue(EVENTS_EVENT_SIZE * 20);
DuyLionTran 0:64ca984b3efd 51 HealthCareService *HealthCareServicePtr;
DuyLionTran 3:9b552b775c6e 52 //PulseSensor PulseSensor();
DuyLionTran 0:64ca984b3efd 53
DuyLionTran 4:e44cd8682f1c 54 Serial serial(USBTX, USBRX);
DuyLionTran 4:e44cd8682f1c 55
DuyLionTran 14:e6029b780879 56 uint8_t htsPosition = HealthCareService::HealthCareService::TEMPERATURE_LOCATION_FINGER;
DuyLionTran 15:00a1c0ea570c 57 uint8_t hrmPosition = HealthCareService::HealthCareService::HRM_LOCATION_FINGER;
DuyLionTran 14:e6029b780879 58
DuyLionTran 0:64ca984b3efd 59 /* ================== FUNCTION PROTOTYPES ==================== */
DuyLionTran 4:e44cd8682f1c 60 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *);
DuyLionTran 4:e44cd8682f1c 61 void onBleInitError(BLE &ble, ble_error_t error);
DuyLionTran 4:e44cd8682f1c 62 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params);
DuyLionTran 8:3384286a8498 63 void onDataWrittenCallback(const GattWriteCallbackParams *params);
DuyLionTran 4:e44cd8682f1c 64 void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context);
DuyLionTran 4:e44cd8682f1c 65
DuyLionTran 9:be09a9bf2e2e 66 void updatePayload(void);
DuyLionTran 4:e44cd8682f1c 67 void main_event(void);
DuyLionTran 4:e44cd8682f1c 68 void periodicCallback(void);
DuyLionTran 0:64ca984b3efd 69
DuyLionTran 0:64ca984b3efd 70 /* ==================== FUNCTION DETAILS ===================== */
DuyLionTran 0:64ca984b3efd 71 /* Restart Advertising on disconnection*/
DuyLionTran 0:64ca984b3efd 72 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *) {
DuyLionTran 0:64ca984b3efd 73 BLE::Instance().gap().startAdvertising();
DuyLionTran 8:3384286a8498 74 printf("Device disconnected with mobile/table\r\n");
DuyLionTran 0:64ca984b3efd 75 }
DuyLionTran 0:64ca984b3efd 76
DuyLionTran 9:be09a9bf2e2e 77 void updatePayload(void) {
DuyLionTran 9:be09a9bf2e2e 78 // Update the count in the SERVICE_DATA field of the advertising payload
DuyLionTran 9:be09a9bf2e2e 79 cnt++;
DuyLionTran 10:4e0f5173269e 80 uint8_t service_data[8];
DuyLionTran 10:4e0f5173269e 81 /* first 2 bytes are for service UUID */
DuyLionTran 9:be09a9bf2e2e 82 service_data[0] = HealthCareService::USER_DATA_SERVICE_UUID & 0xFF;
DuyLionTran 9:be09a9bf2e2e 83 service_data[1] = HealthCareService::USER_DATA_SERVICE_UUID >> 8;
DuyLionTran 10:4e0f5173269e 84 /* next 4 bytes are for client ID */
DuyLionTran 10:4e0f5173269e 85 service_data[2] = 0x07;
DuyLionTran 10:4e0f5173269e 86 service_data[3] = 0x09;
DuyLionTran 10:4e0f5173269e 87 service_data[4] = 0x9A;
DuyLionTran 10:4e0f5173269e 88 service_data[5] = 0xAC;
DuyLionTran 10:4e0f5173269e 89 /* last 2 bytes are sensor data */
DuyLionTran 10:4e0f5173269e 90 service_data[6] = cnt;
DuyLionTran 10:4e0f5173269e 91 service_data[7] = cnt;
DuyLionTran 9:be09a9bf2e2e 92 ble_error_t err = BLE::Instance().gap().updateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA, (uint8_t *)service_data, sizeof(service_data));
DuyLionTran 9:be09a9bf2e2e 93
DuyLionTran 9:be09a9bf2e2e 94 }
DuyLionTran 9:be09a9bf2e2e 95
DuyLionTran 0:64ca984b3efd 96 void main_event(void) {
DuyLionTran 0:64ca984b3efd 97 /* Do blocking calls or whatever is necessary for sensor polling.
DuyLionTran 0:64ca984b3efd 98 In our case, we simply update the Temperature measurement. */
DuyLionTran 13:e6ddc458904e 99 currentTemperature = (currentTemperature + 0.16 > 67.79) ? 35.69 : currentTemperature + 1.18;
DuyLionTran 8:3384286a8498 100 currentHRMCounter = (currentHRMCounter + 1 > 120) ? 80 : (currentHRMCounter + HRM_increasement);
DuyLionTran 9:be09a9bf2e2e 101 updatePayload();
DuyLionTran 11:5a4313edf10d 102
DuyLionTran 11:5a4313edf10d 103 /* sendCombinedTempAndHR = (currentTemperature * 100)* 1000 + currentHRMCounter */
DuyLionTran 12:dc974f6fed97 104 sendCombinedTempAndHR = currentTemperature * 1000; /* Temperature float to int conversion */
DuyLionTran 12:dc974f6fed97 105 sendCombinedTempAndHR = sendCombinedTempAndHR + (float)(currentHRMCounter/100.0);
DuyLionTran 11:5a4313edf10d 106 // printf("sendCombinedTempAndHR %d\r\n", sendCombinedTempAndHR);
DuyLionTran 16:0325e647496f 107 // printf("sendCombinedTempAndHR %.2f\r\n\r\n", (float)sendCombinedTempAndHR);
DuyLionTran 4:e44cd8682f1c 108 if (BLE::Instance().gap().getState().connected) {
DuyLionTran 12:dc974f6fed97 109 HealthCareServicePtr->updateTemperature(sendCombinedTempAndHR);
DuyLionTran 4:e44cd8682f1c 110 HealthCareServicePtr->updateHeartRate(currentHRMCounter);
DuyLionTran 4:e44cd8682f1c 111 }
DuyLionTran 4:e44cd8682f1c 112
DuyLionTran 0:64ca984b3efd 113 }
DuyLionTran 0:64ca984b3efd 114
DuyLionTran 0:64ca984b3efd 115 void periodicCallback(void) {
DuyLionTran 4:e44cd8682f1c 116 /* call main_event immediately */
DuyLionTran 4:e44cd8682f1c 117 eventQueue.call(main_event);
DuyLionTran 0:64ca984b3efd 118 }
DuyLionTran 0:64ca984b3efd 119
DuyLionTran 0:64ca984b3efd 120 void printMacAddress() {
DuyLionTran 0:64ca984b3efd 121 /* Print out device MAC address to the console*/
DuyLionTran 0:64ca984b3efd 122 Gap::AddressType_t addr_type;
DuyLionTran 0:64ca984b3efd 123 Gap::Address_t address;
DuyLionTran 0:64ca984b3efd 124 BLE::Instance().gap().getAddress(&addr_type, address);
DuyLionTran 0:64ca984b3efd 125 printf("DEVICE MAC ADDRESS: ");
DuyLionTran 0:64ca984b3efd 126 for (int i = 5; i >= 1; i--) {
DuyLionTran 0:64ca984b3efd 127 printf("%02x:", address[i]);
DuyLionTran 0:64ca984b3efd 128 }
DuyLionTran 0:64ca984b3efd 129 printf("%02x\r\n", address[0]);
DuyLionTran 0:64ca984b3efd 130 }
DuyLionTran 0:64ca984b3efd 131
DuyLionTran 0:64ca984b3efd 132 void onBleInitError(BLE &ble, ble_error_t error) {
DuyLionTran 0:64ca984b3efd 133 /* Initialization error handling should go here */
DuyLionTran 8:3384286a8498 134 printf("BLE init error!\r\n");
DuyLionTran 8:3384286a8498 135 }
DuyLionTran 8:3384286a8498 136
DuyLionTran 8:3384286a8498 137 /**
DuyLionTran 8:3384286a8498 138 * This callback allows the HealthCareService to receive updates to the controlState Characteristic.
DuyLionTran 8:3384286a8498 139 *
DuyLionTran 8:3384286a8498 140 * @param[in] params
DuyLionTran 8:3384286a8498 141 * Information about the characterisitc being updated.
DuyLionTran 8:3384286a8498 142 */
DuyLionTran 8:3384286a8498 143 void onDataWrittenCallback(const GattWriteCallbackParams *params) {
DuyLionTran 16:0325e647496f 144 // printf("Write callback, value %d\r\n", *(params->data));
DuyLionTran 16:0325e647496f 145 if ((params->handle == HealthCareServicePtr->getTypeHandle()) && (params->len >= 1)) {
DuyLionTran 14:e6029b780879 146 uint8_t oldPosition = htsPosition;
DuyLionTran 14:e6029b780879 147 htsPosition = *(params->data);
DuyLionTran 16:0325e647496f 148 printf("Old type: %d, New type %d\r\n", oldPosition, htsPosition);
DuyLionTran 16:0325e647496f 149 HealthCareServicePtr->updateType(htsPosition);
DuyLionTran 8:3384286a8498 150 }
DuyLionTran 16:0325e647496f 151 if ((params->handle == HealthCareServicePtr->getLocationHandle()) && (params->len >= 1)) {
DuyLionTran 16:0325e647496f 152 uint8_t oldPosition = hrmPosition;
DuyLionTran 16:0325e647496f 153 hrmPosition = *(params->data);
DuyLionTran 16:0325e647496f 154 printf("Old location: %d, New location %d\r\n", oldPosition, hrmPosition);
DuyLionTran 16:0325e647496f 155 HealthCareServicePtr->updateLocation(hrmPosition);
DuyLionTran 16:0325e647496f 156 }
DuyLionTran 0:64ca984b3efd 157 }
DuyLionTran 0:64ca984b3efd 158
DuyLionTran 0:64ca984b3efd 159 /**
DuyLionTran 0:64ca984b3efd 160 * @brief Callback triggered when the ble initialization process has finished
DuyLionTran 0:64ca984b3efd 161 */
DuyLionTran 0:64ca984b3efd 162 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params) {
DuyLionTran 0:64ca984b3efd 163 BLE& ble = params->ble;
DuyLionTran 0:64ca984b3efd 164 ble_error_t error = params->error;
DuyLionTran 0:64ca984b3efd 165
DuyLionTran 0:64ca984b3efd 166 if (error != BLE_ERROR_NONE) {
DuyLionTran 0:64ca984b3efd 167 onBleInitError(ble, error);
DuyLionTran 0:64ca984b3efd 168 return;
DuyLionTran 0:64ca984b3efd 169 }
DuyLionTran 0:64ca984b3efd 170
DuyLionTran 0:64ca984b3efd 171 /* Ensure that it is the default instance of BLE */
DuyLionTran 0:64ca984b3efd 172 if(ble.getInstanceID() != BLE::DEFAULT_INSTANCE) {
DuyLionTran 0:64ca984b3efd 173 return;
DuyLionTran 0:64ca984b3efd 174 }
DuyLionTran 8:3384286a8498 175 uint8_t initial_HRMIncreasement = 1;
DuyLionTran 0:64ca984b3efd 176 ble.gap().onDisconnection(disconnectionCallback);
DuyLionTran 8:3384286a8498 177 ble.gattServer().onDataWritten(onDataWrittenCallback);
DuyLionTran 8:3384286a8498 178
DuyLionTran 14:e6029b780879 179 HealthCareServicePtr = new HealthCareService(ble, currentTemperature, htsPosition,
DuyLionTran 15:00a1c0ea570c 180 currentHRMCounter, hrmPosition,
DuyLionTran 8:3384286a8498 181 initial_HRMIncreasement);
DuyLionTran 0:64ca984b3efd 182
DuyLionTran 0:64ca984b3efd 183 /* setup advertising */
DuyLionTran 0:64ca984b3efd 184 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
DuyLionTran 0:64ca984b3efd 185 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list));
DuyLionTran 2:16f6cfcd7505 186 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_THERMOMETER );
DuyLionTran 0:64ca984b3efd 187 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_HEART_RATE_SENSOR);
DuyLionTran 9:be09a9bf2e2e 188
DuyLionTran 9:be09a9bf2e2e 189 /* No need to display the device name */
DuyLionTran 9:be09a9bf2e2e 190 // ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME , (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME));
DuyLionTran 10:4e0f5173269e 191 uint8_t service_data[8];
DuyLionTran 9:be09a9bf2e2e 192 /* first 2 bytes are for service UUID */
DuyLionTran 9:be09a9bf2e2e 193 service_data[0] = HealthCareService::USER_DATA_SERVICE_UUID & 0xFF;
DuyLionTran 9:be09a9bf2e2e 194 service_data[1] = HealthCareService::USER_DATA_SERVICE_UUID >> 8;
DuyLionTran 10:4e0f5173269e 195 /* next 4 bytes are for client ID */
DuyLionTran 10:4e0f5173269e 196 service_data[2] = 0x07;
DuyLionTran 10:4e0f5173269e 197 service_data[3] = 0x09;
DuyLionTran 11:5a4313edf10d 198 service_data[4] = 0x89;
DuyLionTran 11:5a4313edf10d 199 service_data[5] = 0xAB;
DuyLionTran 9:be09a9bf2e2e 200 /* last 2 bytes are sensor data */
DuyLionTran 10:4e0f5173269e 201 service_data[6] = cnt;
DuyLionTran 10:4e0f5173269e 202 service_data[7] = cnt;
DuyLionTran 9:be09a9bf2e2e 203
DuyLionTran 9:be09a9bf2e2e 204 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA , (uint8_t *)service_data, sizeof(service_data));
DuyLionTran 9:be09a9bf2e2e 205
DuyLionTran 0:64ca984b3efd 206 ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
DuyLionTran 13:e6ddc458904e 207 ble.gap().setAdvertisingInterval(1000); /* 1000ms. */
DuyLionTran 0:64ca984b3efd 208 ble.gap().startAdvertising();
DuyLionTran 0:64ca984b3efd 209
DuyLionTran 0:64ca984b3efd 210 printMacAddress();
DuyLionTran 8:3384286a8498 211 printf("BLE init successfully\r\n");
DuyLionTran 0:64ca984b3efd 212 }
DuyLionTran 0:64ca984b3efd 213
DuyLionTran 0:64ca984b3efd 214 void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context) {
DuyLionTran 0:64ca984b3efd 215 BLE &ble = BLE::Instance();
DuyLionTran 0:64ca984b3efd 216 eventQueue.call(Callback<void()>(&ble, &BLE::processEvents));
DuyLionTran 0:64ca984b3efd 217 }
DuyLionTran 0:64ca984b3efd 218
DuyLionTran 0:64ca984b3efd 219 /* MAIN FUNCTION */
DuyLionTran 0:64ca984b3efd 220 int main() {
DuyLionTran 4:e44cd8682f1c 221
DuyLionTran 4:e44cd8682f1c 222 serial.baud(115200);
DuyLionTran 4:e44cd8682f1c 223 printf("\r\n BODY WIRELESS SENSOR NETWORK\r\n");
DuyLionTran 4:e44cd8682f1c 224 /* call periodicCallback every 500ms */
DuyLionTran 13:e6ddc458904e 225 eventQueue.call_every(1000, periodicCallback);
DuyLionTran 4:e44cd8682f1c 226
DuyLionTran 4:e44cd8682f1c 227 /* init BLE */
DuyLionTran 0:64ca984b3efd 228 BLE &ble = BLE::Instance();
DuyLionTran 0:64ca984b3efd 229 ble.onEventsToProcess(scheduleBleEventsProcessing);
DuyLionTran 0:64ca984b3efd 230 ble.init(bleInitComplete);
DuyLionTran 4:e44cd8682f1c 231
DuyLionTran 4:e44cd8682f1c 232 /* dispatch the event queue */
DuyLionTran 0:64ca984b3efd 233 eventQueue.dispatch_forever();
DuyLionTran 0:64ca984b3efd 234
DuyLionTran 0:64ca984b3efd 235 return 0;
DuyLionTran 0:64ca984b3efd 236 }