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@14:e6029b780879, 2018-05-18 (annotated)

Committer:
DuyLionTran
Date:
Fri May 18 16:48:49 2018 +0000
Revision:
14:e6029b780879
Parent:
13:e6ddc458904e
Child:
15:00a1c0ea570c
value changed ok

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 14:e6029b780879 57
DuyLionTran 0:64ca984b3efd 58 /* ================== FUNCTION PROTOTYPES ==================== */
DuyLionTran 4:e44cd8682f1c 59 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *);
DuyLionTran 4:e44cd8682f1c 60 void onBleInitError(BLE &ble, ble_error_t error);
DuyLionTran 4:e44cd8682f1c 61 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params);
DuyLionTran 8:3384286a8498 62 void onDataWrittenCallback(const GattWriteCallbackParams *params);
DuyLionTran 4:e44cd8682f1c 63 void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context);
DuyLionTran 4:e44cd8682f1c 64
DuyLionTran 9:be09a9bf2e2e 65 void updatePayload(void);
DuyLionTran 4:e44cd8682f1c 66 void main_event(void);
DuyLionTran 4:e44cd8682f1c 67 void periodicCallback(void);
DuyLionTran 0:64ca984b3efd 68
DuyLionTran 0:64ca984b3efd 69 /* ==================== FUNCTION DETAILS ===================== */
DuyLionTran 0:64ca984b3efd 70 /* Restart Advertising on disconnection*/
DuyLionTran 0:64ca984b3efd 71 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *) {
DuyLionTran 0:64ca984b3efd 72 BLE::Instance().gap().startAdvertising();
DuyLionTran 8:3384286a8498 73 printf("Device disconnected with mobile/table\r\n");
DuyLionTran 0:64ca984b3efd 74 }
DuyLionTran 0:64ca984b3efd 75
DuyLionTran 9:be09a9bf2e2e 76 void updatePayload(void) {
DuyLionTran 9:be09a9bf2e2e 77 // Update the count in the SERVICE_DATA field of the advertising payload
DuyLionTran 9:be09a9bf2e2e 78 cnt++;
DuyLionTran 10:4e0f5173269e 79 uint8_t service_data[8];
DuyLionTran 10:4e0f5173269e 80 /* first 2 bytes are for service UUID */
DuyLionTran 9:be09a9bf2e2e 81 service_data[0] = HealthCareService::USER_DATA_SERVICE_UUID & 0xFF;
DuyLionTran 9:be09a9bf2e2e 82 service_data[1] = HealthCareService::USER_DATA_SERVICE_UUID >> 8;
DuyLionTran 10:4e0f5173269e 83 /* next 4 bytes are for client ID */
DuyLionTran 10:4e0f5173269e 84 service_data[2] = 0x07;
DuyLionTran 10:4e0f5173269e 85 service_data[3] = 0x09;
DuyLionTran 10:4e0f5173269e 86 service_data[4] = 0x9A;
DuyLionTran 10:4e0f5173269e 87 service_data[5] = 0xAC;
DuyLionTran 10:4e0f5173269e 88 /* last 2 bytes are sensor data */
DuyLionTran 10:4e0f5173269e 89 service_data[6] = cnt;
DuyLionTran 10:4e0f5173269e 90 service_data[7] = cnt;
DuyLionTran 9:be09a9bf2e2e 91 ble_error_t err = BLE::Instance().gap().updateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA, (uint8_t *)service_data, sizeof(service_data));
DuyLionTran 9:be09a9bf2e2e 92
DuyLionTran 9:be09a9bf2e2e 93 }
DuyLionTran 9:be09a9bf2e2e 94
DuyLionTran 0:64ca984b3efd 95 void main_event(void) {
DuyLionTran 0:64ca984b3efd 96 /* Do blocking calls or whatever is necessary for sensor polling.
DuyLionTran 0:64ca984b3efd 97 In our case, we simply update the Temperature measurement. */
DuyLionTran 13:e6ddc458904e 98 currentTemperature = (currentTemperature + 0.16 > 67.79) ? 35.69 : currentTemperature + 1.18;
DuyLionTran 8:3384286a8498 99 currentHRMCounter = (currentHRMCounter + 1 > 120) ? 80 : (currentHRMCounter + HRM_increasement);
DuyLionTran 9:be09a9bf2e2e 100 updatePayload();
DuyLionTran 11:5a4313edf10d 101
DuyLionTran 11:5a4313edf10d 102 /* sendCombinedTempAndHR = (currentTemperature * 100)* 1000 + currentHRMCounter */
DuyLionTran 12:dc974f6fed97 103 sendCombinedTempAndHR = currentTemperature * 1000; /* Temperature float to int conversion */
DuyLionTran 12:dc974f6fed97 104 sendCombinedTempAndHR = sendCombinedTempAndHR + (float)(currentHRMCounter/100.0);
DuyLionTran 11:5a4313edf10d 105 // printf("sendCombinedTempAndHR %d\r\n", sendCombinedTempAndHR);
DuyLionTran 12:dc974f6fed97 106 printf("sendCombinedTempAndHR %.2f\r\n\r\n", (float)sendCombinedTempAndHR);
DuyLionTran 4:e44cd8682f1c 107 if (BLE::Instance().gap().getState().connected) {
DuyLionTran 12:dc974f6fed97 108 HealthCareServicePtr->updateTemperature(sendCombinedTempAndHR);
DuyLionTran 4:e44cd8682f1c 109 HealthCareServicePtr->updateHeartRate(currentHRMCounter);
DuyLionTran 4:e44cd8682f1c 110 }
DuyLionTran 4:e44cd8682f1c 111
DuyLionTran 0:64ca984b3efd 112 }
DuyLionTran 0:64ca984b3efd 113
DuyLionTran 0:64ca984b3efd 114 void periodicCallback(void) {
DuyLionTran 4:e44cd8682f1c 115 /* call main_event immediately */
DuyLionTran 4:e44cd8682f1c 116 eventQueue.call(main_event);
DuyLionTran 0:64ca984b3efd 117 }
DuyLionTran 0:64ca984b3efd 118
DuyLionTran 0:64ca984b3efd 119 void printMacAddress() {
DuyLionTran 0:64ca984b3efd 120 /* Print out device MAC address to the console*/
DuyLionTran 0:64ca984b3efd 121 Gap::AddressType_t addr_type;
DuyLionTran 0:64ca984b3efd 122 Gap::Address_t address;
DuyLionTran 0:64ca984b3efd 123 BLE::Instance().gap().getAddress(&addr_type, address);
DuyLionTran 0:64ca984b3efd 124 printf("DEVICE MAC ADDRESS: ");
DuyLionTran 0:64ca984b3efd 125 for (int i = 5; i >= 1; i--) {
DuyLionTran 0:64ca984b3efd 126 printf("%02x:", address[i]);
DuyLionTran 0:64ca984b3efd 127 }
DuyLionTran 0:64ca984b3efd 128 printf("%02x\r\n", address[0]);
DuyLionTran 0:64ca984b3efd 129 }
DuyLionTran 0:64ca984b3efd 130
DuyLionTran 0:64ca984b3efd 131 void onBleInitError(BLE &ble, ble_error_t error) {
DuyLionTran 0:64ca984b3efd 132 /* Initialization error handling should go here */
DuyLionTran 8:3384286a8498 133 printf("BLE init error!\r\n");
DuyLionTran 8:3384286a8498 134 }
DuyLionTran 8:3384286a8498 135
DuyLionTran 8:3384286a8498 136 /**
DuyLionTran 8:3384286a8498 137 * This callback allows the HealthCareService to receive updates to the controlState Characteristic.
DuyLionTran 8:3384286a8498 138 *
DuyLionTran 8:3384286a8498 139 * @param[in] params
DuyLionTran 8:3384286a8498 140 * Information about the characterisitc being updated.
DuyLionTran 8:3384286a8498 141 */
DuyLionTran 8:3384286a8498 142 void onDataWrittenCallback(const GattWriteCallbackParams *params) {
DuyLionTran 8:3384286a8498 143 if ((params->handle == HealthCareServicePtr->getValueHandle()) && (params->len == 1)) {
DuyLionTran 14:e6029b780879 144 // uint8_t old_HRM_increasement = HRM_increasement;
DuyLionTran 14:e6029b780879 145 // HRM_increasement = *(params->data);
DuyLionTran 14:e6029b780879 146 // printf("Old data: %d\r\n, New data %d\r\n", old_HRM_increasement, HRM_increasement);
DuyLionTran 14:e6029b780879 147 uint8_t oldPosition = htsPosition;
DuyLionTran 14:e6029b780879 148 htsPosition = *(params->data);
DuyLionTran 14:e6029b780879 149 printf("Old data: %d\r\n, New data %d\r\n", oldPosition, htsPosition);
DuyLionTran 14:e6029b780879 150 if (BLE::Instance().gap().getState().connected) {
DuyLionTran 14:e6029b780879 151 HealthCareServicePtr->updateLocation(htsPosition);
DuyLionTran 14:e6029b780879 152 }
DuyLionTran 8:3384286a8498 153 }
DuyLionTran 0:64ca984b3efd 154 }
DuyLionTran 0:64ca984b3efd 155
DuyLionTran 0:64ca984b3efd 156 /**
DuyLionTran 0:64ca984b3efd 157 * @brief Callback triggered when the ble initialization process has finished
DuyLionTran 0:64ca984b3efd 158 */
DuyLionTran 0:64ca984b3efd 159 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params) {
DuyLionTran 0:64ca984b3efd 160 BLE& ble = params->ble;
DuyLionTran 0:64ca984b3efd 161 ble_error_t error = params->error;
DuyLionTran 0:64ca984b3efd 162
DuyLionTran 0:64ca984b3efd 163 if (error != BLE_ERROR_NONE) {
DuyLionTran 0:64ca984b3efd 164 onBleInitError(ble, error);
DuyLionTran 0:64ca984b3efd 165 return;
DuyLionTran 0:64ca984b3efd 166 }
DuyLionTran 0:64ca984b3efd 167
DuyLionTran 0:64ca984b3efd 168 /* Ensure that it is the default instance of BLE */
DuyLionTran 0:64ca984b3efd 169 if(ble.getInstanceID() != BLE::DEFAULT_INSTANCE) {
DuyLionTran 0:64ca984b3efd 170 return;
DuyLionTran 0:64ca984b3efd 171 }
DuyLionTran 8:3384286a8498 172 uint8_t initial_HRMIncreasement = 1;
DuyLionTran 0:64ca984b3efd 173 ble.gap().onDisconnection(disconnectionCallback);
DuyLionTran 8:3384286a8498 174 ble.gattServer().onDataWritten(onDataWrittenCallback);
DuyLionTran 8:3384286a8498 175
DuyLionTran 14:e6029b780879 176 HealthCareServicePtr = new HealthCareService(ble, currentTemperature, htsPosition,
DuyLionTran 11:5a4313edf10d 177 currentHRMCounter, HealthCareService::HRM_LOCATION_FINGER,
DuyLionTran 8:3384286a8498 178 initial_HRMIncreasement);
DuyLionTran 0:64ca984b3efd 179
DuyLionTran 0:64ca984b3efd 180 /* setup advertising */
DuyLionTran 0:64ca984b3efd 181 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
DuyLionTran 0:64ca984b3efd 182 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list));
DuyLionTran 2:16f6cfcd7505 183 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_THERMOMETER );
DuyLionTran 0:64ca984b3efd 184 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_HEART_RATE_SENSOR);
DuyLionTran 9:be09a9bf2e2e 185
DuyLionTran 9:be09a9bf2e2e 186 /* No need to display the device name */
DuyLionTran 9:be09a9bf2e2e 187 // ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME , (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME));
DuyLionTran 10:4e0f5173269e 188 uint8_t service_data[8];
DuyLionTran 9:be09a9bf2e2e 189 /* first 2 bytes are for service UUID */
DuyLionTran 9:be09a9bf2e2e 190 service_data[0] = HealthCareService::USER_DATA_SERVICE_UUID & 0xFF;
DuyLionTran 9:be09a9bf2e2e 191 service_data[1] = HealthCareService::USER_DATA_SERVICE_UUID >> 8;
DuyLionTran 10:4e0f5173269e 192 /* next 4 bytes are for client ID */
DuyLionTran 10:4e0f5173269e 193 service_data[2] = 0x07;
DuyLionTran 10:4e0f5173269e 194 service_data[3] = 0x09;
DuyLionTran 11:5a4313edf10d 195 service_data[4] = 0x89;
DuyLionTran 11:5a4313edf10d 196 service_data[5] = 0xAB;
DuyLionTran 9:be09a9bf2e2e 197 /* last 2 bytes are sensor data */
DuyLionTran 10:4e0f5173269e 198 service_data[6] = cnt;
DuyLionTran 10:4e0f5173269e 199 service_data[7] = cnt;
DuyLionTran 9:be09a9bf2e2e 200
DuyLionTran 9:be09a9bf2e2e 201 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::SERVICE_DATA , (uint8_t *)service_data, sizeof(service_data));
DuyLionTran 9:be09a9bf2e2e 202
DuyLionTran 0:64ca984b3efd 203 ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
DuyLionTran 13:e6ddc458904e 204 ble.gap().setAdvertisingInterval(1000); /* 1000ms. */
DuyLionTran 0:64ca984b3efd 205 ble.gap().startAdvertising();
DuyLionTran 0:64ca984b3efd 206
DuyLionTran 0:64ca984b3efd 207 printMacAddress();
DuyLionTran 8:3384286a8498 208 printf("BLE init successfully\r\n");
DuyLionTran 0:64ca984b3efd 209 }
DuyLionTran 0:64ca984b3efd 210
DuyLionTran 0:64ca984b3efd 211 void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context) {
DuyLionTran 0:64ca984b3efd 212 BLE &ble = BLE::Instance();
DuyLionTran 0:64ca984b3efd 213 eventQueue.call(Callback<void()>(&ble, &BLE::processEvents));
DuyLionTran 0:64ca984b3efd 214 }
DuyLionTran 0:64ca984b3efd 215
DuyLionTran 0:64ca984b3efd 216 /* MAIN FUNCTION */
DuyLionTran 0:64ca984b3efd 217 int main() {
DuyLionTran 4:e44cd8682f1c 218
DuyLionTran 4:e44cd8682f1c 219 serial.baud(115200);
DuyLionTran 4:e44cd8682f1c 220 printf("\r\n BODY WIRELESS SENSOR NETWORK\r\n");
DuyLionTran 4:e44cd8682f1c 221 /* call periodicCallback every 500ms */
DuyLionTran 13:e6ddc458904e 222 eventQueue.call_every(1000, periodicCallback);
DuyLionTran 4:e44cd8682f1c 223
DuyLionTran 4:e44cd8682f1c 224 /* init BLE */
DuyLionTran 0:64ca984b3efd 225 BLE &ble = BLE::Instance();
DuyLionTran 0:64ca984b3efd 226 ble.onEventsToProcess(scheduleBleEventsProcessing);
DuyLionTran 0:64ca984b3efd 227 ble.init(bleInitComplete);
DuyLionTran 4:e44cd8682f1c 228
DuyLionTran 4:e44cd8682f1c 229 /* dispatch the event queue */
DuyLionTran 0:64ca984b3efd 230 eventQueue.dispatch_forever();
DuyLionTran 0:64ca984b3efd 231
DuyLionTran 0:64ca984b3efd 232 return 0;
DuyLionTran 0:64ca984b3efd 233 }