Revision 13:fba77a5d0fa0, committed 2018-06-28

Comitter:

Mahir Ozturk

Date:

Thu Jun 28 15:47:24 2018 +0300

Parent:

12:1300cb0f6274

Child:

14:37542841f707

Commit message:

* Move each sensor applications to corresponding *_app.cpp files
* Increase notification period to 12 seconds
* Change platform name to "Maxim HMS"
* Remove unused mem_debug.cpp and mem_debug.h files
* Code cleaning

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ble_comm.cpp	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,25 @@
+/*
+ * ble_comm.cpp
+ *
+ *  Created on: Jun 21, 2018
+ *      Author: Mahir.Ozturk
+ */
+/******************************************************************************/
+#include <mbed.h>
+#include "ble_comm.h"
+
+Mutex ble_mutex;
+
+ble_error_t bleGattAttrWrite(GattAttribute::Handle_t handle, const uint8_t *value, uint16_t size)
+{
+	BLE &ble = BLE::Instance();
+	ble_error_t ret;
+
+	ble_mutex.lock();
+
+	ret = ble.gattServer().write(handle, value, size);
+
+	ble_mutex.unlock();
+
+	return ret;
+}

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ble_comm.h	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,15 @@
+/*
+ * ble_comm.h
+ *
+ *  Created on: Jun 21, 2018
+ *      Author: Mahir.Ozturk
+ */
+
+#ifndef BLE_COMM_H_
+#define BLE_COMM_H_
+
+#include <ble/BLE.h>
+
+ble_error_t bleGattAttrWrite(GattAttribute::Handle_t handle, const uint8_t *value, uint16_t size);
+
+#endif /* BLE_COMM_H_ */

--- a/config.h	Wed May 09 08:32:29 2018 +0000
+++ b/config.h	Thu Jun 28 15:47:24 2018 +0300
@@ -1,10 +1,10 @@
-#define MAXIM_PLATFORM_NAME "Pegasus-IoT"
+#define MAXIM_PLATFORM_NAME "Maxim HMS"
 #define BLE_SUPPORT
 #define LIB_MAX30205
-#define MAX30205_BLE_NOTIFY_PERIOD_SEC 5
+#define MAX30205_BLE_NOTIFY_PERIOD_SEC 12
 #define LIB_MAX113XX_PIXI
-#define MAX113XX_PIXI_BLE_NOTIFY_PERIOD_SEC 5
+#define MAX113XX_PIXI_BLE_NOTIFY_PERIOD_SEC 12
 #define LIB_MAX30003
-#define MAX30003_BLE_NOTIFY_PERIOD_SEC 5
+#define MAX30003_BLE_NOTIFY_PERIOD_SEC 12
 #define LIB_MAX30101
-#define MAX30101_BLE_NOTIFY_PERIOD_SEC 5
+#define MAX30101_BLE_NOTIFY_PERIOD_SEC 12

--- a/main.cpp	Wed May 09 08:32:29 2018 +0000
+++ b/main.cpp	Thu Jun 28 15:47:24 2018 +0300
@@ -37,24 +37,19 @@
 #include "ble/BLE.h"
 #include "ble/Gap.h"
 #include "max32630fthr.h"
-
-#if defined(LIB_MAX30003)
-#include "MAX30003.h"
+#if defined(LIB_MAX30205)
+#	include "max30205_app.h"
+#endif
+#if defined(LIB_MAX30101)
+#	include "max30101_app.h"
 #endif
-
-#if defined(LIB_MAX30205)
-#include "MAX30205.h"
+#if defined(LIB_MAX30003)
+#	include "max30003_app.h"
+#endif
+#if defined(LIB_MAX113XX_PIXI)
+#	include "max113xx_pixi_app.h"
 #endif
 
-#if defined(LIB_MAX30101)
-#include "MAX30101.h"
-#include "max30101_algo.h"
-#endif
-
-#if defined(LIB_MAX113XX_PIXI)
-#include "MAX113XX_Pixi.h"
-#include "MAX11301Hex.h"
-#endif
 
 /******************************************************************************/
 
@@ -92,49 +87,42 @@
 static uint8_t RGBLedInitValue[] = {LED_OFF, LED_OFF, LED_OFF};
 ReadWriteArrayGattCharacteristic<uint8_t, sizeof(RGBLedInitValue)> gattCharRGBLed(uuidRGBLED, RGBLedInitValue);
 
-#if defined(LIB_MAX30003_ECG)
-UUID uuidECG("00001524-1d66-11e8-b467-0ed5f89f718b");
-static int16_t ECGInitValue = 0xABCD;
-ReadOnlyGattCharacteristic<int16_t> gattCharECG(uuidECG, &ECGInitValue,
-									GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
-#else
+#if defined(LIB_MAX30003)
 UUID uuidBPM("00001524-1d66-11e8-b467-0ed5f89f718b");
-static float BPMInitValue = 0.0;
+static float BPMInitValue;
 ReadOnlyGattCharacteristic<float> gattCharBPM(uuidBPM, &BPMInitValue,
 									GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
 #endif
 
 #if defined(LIB_MAX30101)
 UUID uuidHeartRate("00001525-1d66-11e8-b467-0ed5f89f718b");
-static uint16_t HeartRateInitValue = 0xEEFF;
+static uint16_t HeartRateInitValue;
 ReadOnlyGattCharacteristic<uint16_t> gattCharHeartRate(uuidHeartRate, &HeartRateInitValue,
 									 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
 
 UUID uuidSPO2("00001526-1d66-11e8-b467-0ed5f89f718b");
-static uint16_t SPO2InitValue = 0xAABB;
+static uint16_t SPO2InitValue;
 ReadOnlyGattCharacteristic<uint16_t> gattCharSPO2(uuidSPO2, &SPO2InitValue,
 									 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
 #endif
 
 #if defined(LIB_MAX113XX_PIXI)
 UUID uuidADC("00001527-1d66-11e8-b467-0ed5f89f718b");
-static float ADCInitValue = 0;
+static float ADCInitValue;
 ReadOnlyGattCharacteristic<float> gattCharADC(uuidADC, &ADCInitValue,
 									 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
 #endif
 
 #if defined(LIB_MAX30205)
 UUID uuidTemp("00001528-1d66-11e8-b467-0ed5f89f718b");
-static float TempInitValue = 26.5;
+static float TempInitValue;
 ReadOnlyGattCharacteristic<float> gattCharTemp(uuidTemp, &TempInitValue,
 								  GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
 #endif
 
 /* Set up custom service */
 GattCharacteristic *characteristics[] = {&gattCharRGBLed, &gattCharButtonPressedNotify,
-#if defined(LIB_MAX30003_ECG)
-										 &gattCharECG,
-#else
+#if defined(LIB_MAX30003)
 										 &gattCharBPM,
 #endif
 #if defined(LIB_MAX30205)
@@ -153,24 +141,8 @@
 
 /******************************************************************************/
 
-Mutex ble_mutex;
-
 static EventQueue eventQueue(/* event count */ 10 * /* event size */ 32);
 
-ble_error_t bleGattAttrWrite(GattAttribute::Handle_t handle, const uint8_t *value, uint16_t size)
-{
-	BLE &ble = BLE::Instance();
-	ble_error_t ret;
-
-	ble_mutex.lock();
-
-	ret = ble.gattServer().write(handle, value, size);
-
-	ble_mutex.unlock();
-
-	return ret;
-}
-
 void updateButtonState(uint8_t newState) {
 	printf("Button pressed...\r\n");
 	bleGattAttrWrite(gattCharButtonPressedNotify.getValueHandle(), (uint8_t *)&newState, sizeof(uint8_t));
@@ -257,701 +229,67 @@
 	eventQueue.call(Callback<void()>(&ble, &BLE::processEvents));
 }
 
-/******************************************************************************
- ************** MAX30205EVSYS *************************************************
- ******************************************************************************/
-#if defined(LIB_MAX30205)
-
-MAX30205 max30205_temp_sensor(i2c1, 0x48);	/* New MAX30205 on i2cBus */
-
-Thread thread_max30205_reader;
-
-bool max30205_config(MAX30205 &temp_sensor){
-
-	int rc = 0;
-
-	MAX30205::Configuration_u temp_cfg;
-	temp_cfg.all = 0;
-	temp_cfg.bits.shutdown = 1;     // Shutdown mode
-	temp_cfg.bits.comp_int = 1;     // Interrupt mode
-	temp_cfg.bits.os_polarity = 0;  // Active low OS
-	temp_cfg.bits.fault_queue = 1;  // Two faults for OS condition
-	temp_cfg.bits.data_format = 0;  // Normal data format
-	temp_cfg.bits.timeout = 0;      // I2C timeout reset enabled
-	temp_cfg.bits.one_shot = 0;     // Start with one-shot = 0
-
-	rc = temp_sensor.writeConfiguration(temp_cfg);  // Write config to MAX30205
-
-	return rc;
-}
-
-void max30205_reader_task()
-{
-	int rc = max30205_config(max30205_temp_sensor);   // Configure sensor, return 0 on success
-
-	MAX30205::Configuration_u temp_cfg;
-	uint16_t rawTemperatureRead;
-	float temperature;
-
-	temp_cfg.all = 0;
-
-	daplink.printf("Starting MAX30205 Temperature Demo Application...\r\n");
-
-	while (1) {
-		if (rc == 0) {
-			/* Send one-shot cmd to begin conversion */
-			temp_cfg.bits.one_shot = 1;
-			rc = max30205_temp_sensor.writeConfiguration(temp_cfg);
-
-			Thread::wait(50);
-
-			/* Read the temperature data */
-			rc = max30205_temp_sensor.readTemperature(rawTemperatureRead);
-
-			/* Convert temp data to Celsius */
-			temperature = max30205_temp_sensor.toCelsius(rawTemperatureRead);
-
-			bleGattAttrWrite(gattCharTemp.getValueHandle(), (uint8_t *)&temperature, sizeof(temperature));
-			daplink.printf("Temperature is %2.3f deg. C\r\n", temperature);
-
-			Thread::wait(MAX30205_BLE_NOTIFY_PERIOD_SEC * 1000);
-
-		} else {
-			daplink.printf("Something went wrong, check the I2C bus and power connections...\r\n");
-
-			return;
-		}
-	}
-}
-#endif
-
-/******************************************************************************
- ************** MAX30101WING **************************************************
- ******************************************************************************/
-#if defined(LIB_MAX30101)
-#define MAX30101_IRQ_ASSERTED_ID	1
-
-//variable for the algorithm
-uint16_t sampleRate = 100;
-uint16_t compSpO2 = 1;
-int16_t ir_ac_comp = 0;
-int16_t red_ac_comp = 0;
-int16_t green_ac_comp = 0;
-int16_t ir_ac_mag = 0;
-int16_t red_ac_mag = 0;
-int16_t green_ac_mag = 0;
-uint16_t HRbpm2 = 0;
-uint16_t SpO2B = 0;
-uint16_t DRdy = 0;
-
-//declare large variables outside of main
-uint32_t redData[500];//set array to max fifo size
-uint32_t irData[500];//set array to max fifo size
-uint32_t greenData[500];//set array to max fifo size
-
-Thread thread_max30101_reader;
-
-bool max30101_config(MAX30101 &op_sensor)
-{
-	//Reset Device
-	MAX30101::ModeConfiguration_u modeConfig;
-	modeConfig.all = 0;
-	modeConfig.bits.reset = 1;
-	modeConfig.bits.mode = MAX30101::MultiLedMode;     // Sets SPO2 Mode
-	int32_t rc = op_sensor.setModeConfiguration(modeConfig);
-
-	//enable MAX30101 interrupts
-	MAX30101::InterruptBitField_u ints;
-	if (rc == 0) {
-		ints.all = 0;
-		ints.bits.a_full = 1;       // Enable FIFO almost full interrupt
-		ints.bits.ppg_rdy =1;       //Enables an interrupt when a new sample is ready
-		rc = op_sensor.enableInterrupts(ints);
-	}
-
-	//configure FIFO
-	MAX30101::FIFO_Configuration_u fifoConfig;
-	if (rc == 0) {
-		fifoConfig.all = 0;
-		fifoConfig.bits.fifo_a_full = 10;                            // Max level of 17 samples
-		fifoConfig.bits.sample_average = MAX30101::AveragedSamples_0;// Average 0 samples
-		rc = op_sensor.setFIFOConfiguration(fifoConfig);
-	}
-
-	MAX30101::SpO2Configuration_u spo2Config;
-	if (rc == 0) {
-		spo2Config.all = 0;                                 // clears register
-		spo2Config.bits.spo2_adc_range = 1;                 //sets resolution to 4096 nAfs
-		spo2Config.bits.spo2_sr = MAX30101::SR_100_Hz;     // SpO2 SR = 100Hz
-		spo2Config.bits.led_pw = MAX30101::PW_3;            // 18-bit ADC resolution ~400us
-		rc = op_sensor.setSpO2Configuration(spo2Config);
-	}
-
-	//Set time slots for LEDS
-	MAX30101::ModeControlReg_u multiLED;
-	if (rc == 0) {
-		//sets timing for control register 1
-		multiLED.bits.lo_slot=1;
-		multiLED.bits.hi_slot=2;
-		rc = op_sensor.setMultiLEDModeControl(MAX30101::ModeControlReg1, multiLED);
-		if (rc == 0) {
-			multiLED.bits.lo_slot=3;
-			multiLED.bits.hi_slot=0;
-			rc = op_sensor.setMultiLEDModeControl(MAX30101::ModeControlReg2, multiLED);
-		}
-	}
-
-	//Set LED drive currents
-	if (rc == 0) {
-		// Heart Rate only, 1 LED channel, Pulse amp. = ~7mA
-		rc = op_sensor.setLEDPulseAmplitude(MAX30101::LED1_PA, 0x24);
-		//To include SPO2, 2 LED channel, Pulse amp. ~7mA
-		if (rc == 0) {
-			rc = op_sensor.setLEDPulseAmplitude(MAX30101::LED2_PA, 0x24);
-		}
-		if (rc == 0) {
-			rc = op_sensor.setLEDPulseAmplitude(MAX30101::LED3_PA, 0x24);
-		}
-	}
-
-	//Set operating mode
-	modeConfig.all = 0;
-	if (rc == 0) {
-		modeConfig.bits.mode = MAX30101::MultiLedMode;     // Sets multiLED mode
-		rc = op_sensor.setModeConfiguration(modeConfig);
-	}
-
-	return rc;
-}
-
-void max30101wing_pmic_config(I2C & i2c_bus, DigitalOut & pmic_en)
-{
-	const uint8_t PMIC_ADRS = 0x54;
-	const uint8_t BBB_EXTRA_ADRS = 0x1C;
-	const uint8_t BOOST_VOLTAGE = 0x05;
-
-	char data_buff[] = {BBB_EXTRA_ADRS, 0x40};    //BBBExtra register address
-	//and data to enable passive
-	//pull down.
-	i2c_bus.write(PMIC_ADRS, data_buff,2);        //write to BBBExtra register
-
-	data_buff[0] = BOOST_VOLTAGE;
-	data_buff[1] = 0x08;                          //Boost voltage configuration
-	//register followed by data
-	//to set voltage to 4.5V 1f
-	pmic_en = 0;                                  //disables VLED 08
-	i2c_bus.write(PMIC_ADRS, data_buff,2);        //write to BBBExtra register
-	pmic_en = 1;                                  //enables VLED
-}
-
-/* Op Sensor FIFO nearly full callback */
-void max30101_intr_callback()
-{
-	thread_max30101_reader.signal_set(MAX30101_IRQ_ASSERTED_ID);
-}
-
-void max30101_reader_task()
-{
-	InterruptIn op_sensor_int(P3_2);				// Config P3_2 as int. in for
-	op_sensor_int.fall(max30101_intr_callback);		// FIFO ready interrupt
-
-	DigitalOut VLED_EN(P3_3,0);						//Enable for VLEDs
-	max30101wing_pmic_config(i2c1, VLED_EN);
-
-	MAX30101 op_sensor(i2c1);						// Create new MAX30101 on i2cBus
-	int rc = max30101_config(op_sensor);			// Config sensor, return 0 on success
-
-	MAX30101::InterruptBitField_u ints;				// Read interrupt status to clear
-	rc = op_sensor.getInterruptStatus(ints);		// power on interrupt
-
-	uint8_t fifoData[MAX30101::MAX_FIFO_BYTES];
-	uint16_t idx, readBytes;
-	uint16_t HRTemp;
-	uint16_t spo2Temp;
-
-	uint16_t lastValidHR = 0;
-	uint16_t lastValidSPO2 = 0;
-
-	int r=0; //counter for redData position
-	int ir=0; //counter for irData position
-	int g =0; //counter for greenData position
-	int c=0; //counter to print values
-
-	daplink.printf("Starting MAX30101 HeartRate / SPO2 Demo Application...\r\n");
-	daplink.printf("Please wait a few seconds while data is being collected.\r\n");
-
-	Timer bleNotifyTimer;
-
-	bleNotifyTimer.start();
-
-	while (1) {
-		if (rc == 0) {
-			/* Check if op_sensor interrupt asserted */
-			Thread::signal_wait(MAX30101_IRQ_ASSERTED_ID);
-
-			/* Read interrupt status to clear interrupt */
-			rc = op_sensor.getInterruptStatus(ints);
-
-			/* Confirms proper read prior to executing */
-			if (rc == 0) {
-				// Read FIFO
-				rc = op_sensor.readFIFO(MAX30101::ThreeLedChannels, fifoData, readBytes);
-
-				if (rc == 0) {
-					/* Convert read bytes into samples */
-					for (idx = 0; idx < readBytes; idx+=9) {
-						if (r >= 500 || ir >= 500 || g >= 500) {
-							daplink.printf("Overflow! r=%d ir=%d g=%d\r\n", r, ir, g);
-							break;
-						}
-
-						if (readBytes >= (idx + 8)) {
-							redData[r++] = ((fifoData[idx] << 16) | (fifoData[idx + 1] << 8) | (fifoData[idx + 2])) & 0x03FFFF;
-							irData[ir++] = ((fifoData[idx + 3] << 16) | (fifoData[idx + 4] << 8) | (fifoData[idx + 5])) & 0x03FFFF;
-							greenData[g++] = ((fifoData[idx + 6] << 16) | (fifoData[idx + 7] << 8) | (fifoData[idx + 8])) & 0x03FFFF;
-						}
-					}
-
-					if ((r >= 500) && (ir >= 500) && (g >= 500)) {/* checks to make sure there are 500 */
-						/* samples in data buffers */
-
-						/* runs the heart rate and SpO2 algorithm */
-						for (c = 0, HRTemp = 0; c < r; c++) {
-							HRSpO2Func(irData[c], redData[c],greenData[c], c,sampleRate, compSpO2,
-									   &ir_ac_comp,&red_ac_comp, &green_ac_comp, &ir_ac_mag,&red_ac_mag,
-									   &green_ac_mag, &HRbpm2,&SpO2B,&DRdy);
-							if (DRdy) {
-								HRTemp = HRbpm2;
-								spo2Temp = SpO2B;
-							}
-						}
-
-						/* If the above algorithm returns a valid heart rate on the last sample, it is printed */
-						if (DRdy == 1) {
-							daplink.printf("Heart Rate = %i\r\n",HRbpm2);
-							daplink.printf("SPO2 = %i\r\n",SpO2B);
-							lastValidHR = HRbpm2;
-							lastValidSPO2 = SpO2B;
-						} else if (HRTemp != 0) { /* if a valid heart was calculated at all, it is printed */
-							daplink.printf("Heart Rate = %i\r\n",HRTemp);
-							daplink.printf("SPO2 = %i\r\n",spo2Temp);
-							lastValidHR = HRTemp;
-							lastValidSPO2 = spo2Temp;
-						} else {
-							daplink.printf("Calculation failed...waiting for more samples...\r\n");
-							daplink.printf("Please keep your finger on the MAX30101 sensor with minimal movement.\r\n");
-						}
-
-						/* dump the first hundred samples after calculation */
-						for (c = 100; c < 500; c++) {
-							redData[c - 100] = redData[c];
-							irData[c - 100] = irData[c];
-							greenData[c - 100] = greenData[c];
-						}
-
-						/* reset counters */
-						r = 400;
-						ir = 400;
-						g = 400;
-					}
-
-					if (bleNotifyTimer.read_ms() >= (MAX30101_BLE_NOTIFY_PERIOD_SEC * 1000)) {
-						bleGattAttrWrite(gattCharHeartRate.getValueHandle(), (uint8_t *)&lastValidHR, sizeof(lastValidHR));
-						bleGattAttrWrite(gattCharSPO2.getValueHandle(), (uint8_t *)&lastValidSPO2, sizeof(lastValidSPO2));
-						bleNotifyTimer.reset();
-					}
-				}
-			}
-		} else { // If rc != 0, a communication error has occurred
-
-			daplink.printf("Something went wrong, "
-					  "check the I2C bus or power connections... \r\n");
-
-			return;
-		}
-
-	}
-}
-#endif
-
-/******************************************************************************
-************** MAX30003WING (ECG) *********************************************
- ******************************************************************************/
-#if defined(LIB_MAX30003_ECG)
-#define MAX30003_IRQ_ASSERTED_SIGNAL_ID	1
-
-MAX30003 max30003(spim2, SPI2_SS);		/* MAX30003WING board */
-
-Thread thread_max30003_reader;
-
-void ecg_config(MAX30003& ecgAFE) {
-	// Reset ECG to clear registers
-	ecgAFE.writeRegister( MAX30003::SW_RST , 0);
-
-	// General config register setting
-	MAX30003::GeneralConfiguration_u CNFG_GEN_r;
-	CNFG_GEN_r.bits.en_ecg = 1;     // Enable ECG channel
-	CNFG_GEN_r.bits.rbiasn = 1;     // Enable resistive bias on negative input
-	CNFG_GEN_r.bits.rbiasp = 1;     // Enable resistive bias on positive input
-	CNFG_GEN_r.bits.en_rbias = 1;   // Enable resistive bias
-	CNFG_GEN_r.bits.imag = 2;       // Current magnitude = 10nA
-	CNFG_GEN_r.bits.en_dcloff = 1;  // Enable DC lead-off detection
-	ecgAFE.writeRegister( MAX30003::CNFG_GEN , CNFG_GEN_r.all);
-
-
-	// ECG Config register setting
-	MAX30003::ECGConfiguration_u CNFG_ECG_r;
-	CNFG_ECG_r.bits.dlpf = 1;       // Digital LPF cutoff = 40Hz
-	CNFG_ECG_r.bits.dhpf = 1;       // Digital HPF cutoff = 0.5Hz
-	CNFG_ECG_r.bits.gain = 3;       // ECG gain = 160V/V
-	CNFG_ECG_r.bits.rate = 2;       // Sample rate = 128 sps
-	ecgAFE.writeRegister( MAX30003::CNFG_ECG , CNFG_ECG_r.all);
-
-
-	//R-to-R configuration
-	MAX30003::RtoR1Configuration_u CNFG_RTOR_r;
-	CNFG_RTOR_r.bits.en_rtor = 1;           // Enable R-to-R detection
-	ecgAFE.writeRegister( MAX30003::CNFG_RTOR1 , CNFG_RTOR_r.all);
-
-
-	//Manage interrupts register setting
-	MAX30003::ManageInterrupts_u MNG_INT_r;
-	MNG_INT_r.bits.efit = 0b00011;          // Assert EINT w/ 4 unread samples
-	MNG_INT_r.bits.clr_rrint = 0b01;        // Clear R-to-R on RTOR reg. read back
-	ecgAFE.writeRegister( MAX30003::MNGR_INT , MNG_INT_r.all);
-
-
-	//Enable interrupts register setting
-	MAX30003::EnableInterrupts_u EN_INT_r;
-	EN_INT_r.all = 0;
-	EN_INT_r.bits.en_eint = 1;              // Enable EINT interrupt
-	EN_INT_r.bits.en_rrint = 0;             // Disable R-to-R interrupt
-	EN_INT_r.bits.intb_type = 3;            // Open-drain NMOS with internal pullup
-	ecgAFE.writeRegister( MAX30003::EN_INT , EN_INT_r.all);
-
-
-	//Dyanmic modes config
-	MAX30003::ManageDynamicModes_u MNG_DYN_r;
-	MNG_DYN_r.bits.fast = 0;                // Fast recovery mode disabled
-	ecgAFE.writeRegister( MAX30003::MNGR_DYN , MNG_DYN_r.all);
-
-	// MUX Config
-	MAX30003::MuxConfiguration_u CNFG_MUX_r;
-	CNFG_MUX_r.bits.openn = 0;          // Connect ECGN to AFE channel
-	CNFG_MUX_r.bits.openp = 0;          // Connect ECGP to AFE channel
-	ecgAFE.writeRegister( MAX30003::CNFG_EMUX , CNFG_MUX_r.all);
-
-	return;
-}
-
-/* ECG FIFO nearly full callback */
-void ecgFIFO_callback()  {
-	thread_max30003_reader.signal_set(MAX30003_IRQ_ASSERTED_SIGNAL_ID);
-}
-
-void max30003_reader_task()
-{
-	// Constants
-	const int EINT_STATUS_MASK = 1 << 23;
-	const int FIFO_OVF_MASK = 0x7;
-	const int FIFO_VALID_SAMPLE_MASK = 0x0;
-	const int FIFO_FAST_SAMPLE_MASK = 0x1;
-	const int ETAG_BITS_MASK = 0x7;
-
-	uint32_t ecgFIFO, readECGSamples, idx, ETAG[32], status;
-
-	InterruptIn ecgFIFO_int(P5_4);					// Config P5_4 as int. in for the
-	ecgFIFO_int.fall(&ecgFIFO_callback);			// ecg FIFO almost full interrupt
-
-	SPI spiBus(SPI2_MOSI, SPI2_MISO, SPI2_SCK);		// SPI bus, P5_1 = MOSI,
-													// P5_2 = MISO, P5_0 = SCK
-
-	MAX30003 ecgAFE(spiBus, P5_3);					// New MAX30003 on spiBus, CS = P5_3
-	ecg_config(ecgAFE);								// Config ECG
-
-	ecgAFE.writeRegister( MAX30003::SYNCH , 0);
-
-	daplink.printf("Starting MAX30003 ECG Demo Application...\r\n");
-
-	while (1) {
-
-		// Read back ECG samples from the FIFO
-		thread_max30003_reader.signal_wait(MAX30003_IRQ_ASSERTED_SIGNAL_ID);
-
-		status = ecgAFE.readRegister( MAX30003::STATUS );      // Read the STATUS register
-
-		// Check if EINT interrupt asserted
-		if ( ( status & EINT_STATUS_MASK ) == EINT_STATUS_MASK ) {
-
-			readECGSamples = 0;                        // Reset sample counter
-
-			do {
-				ecgFIFO = ecgAFE.readRegister( MAX30003::ECG_FIFO );       // Read FIFO
-				ETAG[readECGSamples] = ( ecgFIFO >> 3 ) & ETAG_BITS_MASK;  // Isolate ETAG
-				readECGSamples++;                                          // Increment sample counter
-
-			// Check that sample is not last sample in FIFO
-			} while ( ETAG[readECGSamples-1] == FIFO_VALID_SAMPLE_MASK ||
-					  ETAG[readECGSamples-1] == FIFO_FAST_SAMPLE_MASK );
-
-			// Check if FIFO has overflowed
-			if( ETAG[readECGSamples - 1] == FIFO_OVF_MASK ){
-				ecgAFE.writeRegister( MAX30003::FIFO_RST , 0); // Reset FIFO
-				rLED = 1;//notifies the user that an over flow occured
-			}
-
-			// Print results
-			for( idx = 0; idx < readECGSamples; idx++ ) {
-				daplink.printf("%6d\r\n", ecgSample[idx]);
-
-				bleGattAttrWrite(gattCharECG.getValueHandle(),
-						(uint8_t *)&ecgSample[idx], sizeof(ecgSample[idx]));
-			}
-		}
-	}
-}
-
-#endif
-
-/******************************************************************************
-************** MAX30003WING (BPM) *********************************************
-*******************************************************************************/
-#if defined(LIB_MAX30003)
-
-#define MAX30003_IRQ_ASSERTED_SIGNAL_ID	1
-
-MAX30003 max30003(spim2, SPI2_SS);		/* MAX30003WING board */
-
-Thread thread_max30003_reader;
-
-/* ECG FIFO nearly full callback */
-void ecgFIFO_callback()
-{
-	thread_max30003_reader.signal_set(MAX30003_IRQ_ASSERTED_SIGNAL_ID);
-}
-
-void ecg_config(MAX30003& ecgAFE)
-{
-	// Reset ECG to clear registers
-	ecgAFE.writeRegister( MAX30003::SW_RST , 0);
-
-	// General config register setting
-	MAX30003::GeneralConfiguration_u CNFG_GEN_r;
-	CNFG_GEN_r.bits.en_ecg = 1;     // Enable ECG channel
-	CNFG_GEN_r.bits.rbiasn = 1;     // Enable resistive bias on negative input
-	CNFG_GEN_r.bits.rbiasp = 1;     // Enable resistive bias on positive input
-	CNFG_GEN_r.bits.en_rbias = 1;   // Enable resistive bias
-	CNFG_GEN_r.bits.imag = 2;       // Current magnitude = 10nA
-	CNFG_GEN_r.bits.en_dcloff = 1;  // Enable DC lead-off detection
-	ecgAFE.writeRegister( MAX30003::CNFG_GEN , CNFG_GEN_r.all);
-
-
-	// ECG Config register setting
-	MAX30003::ECGConfiguration_u CNFG_ECG_r;
-	CNFG_ECG_r.bits.dlpf = 1;       // Digital LPF cutoff = 40Hz
-	CNFG_ECG_r.bits.dhpf = 1;       // Digital HPF cutoff = 0.5Hz
-	CNFG_ECG_r.bits.gain = 3;       // ECG gain = 160V/V
-	CNFG_ECG_r.bits.rate = 2;       // Sample rate = 128 sps
-	ecgAFE.writeRegister( MAX30003::CNFG_ECG , CNFG_ECG_r.all);
-
-
-	//R-to-R configuration
-	MAX30003::RtoR1Configuration_u CNFG_RTOR_r;
-	CNFG_RTOR_r.bits.wndw = 0b0011;         // WNDW = 96ms
-	CNFG_RTOR_r.bits.rgain = 0b1111;        // Auto-scale gain
-	CNFG_RTOR_r.bits.pavg = 0b11;           // 16-average
-	CNFG_RTOR_r.bits.ptsf = 0b0011;         // PTSF = 4/16
-	CNFG_RTOR_r.bits.en_rtor = 1;           // Enable R-to-R detection
-	ecgAFE.writeRegister( MAX30003::CNFG_RTOR1 , CNFG_RTOR_r.all);
-
-
-	//Manage interrupts register setting
-	MAX30003::ManageInterrupts_u MNG_INT_r;
-	MNG_INT_r.bits.efit = 0b00011;          // Assert EINT w/ 4 unread samples
-	MNG_INT_r.bits.clr_rrint = 0b01;        // Clear R-to-R on RTOR reg. read back
-	ecgAFE.writeRegister( MAX30003::MNGR_INT , MNG_INT_r.all);
-
-
-	//Enable interrupts register setting
-	MAX30003::EnableInterrupts_u EN_INT_r;
-	EN_INT_r.bits.en_eint = 1;              // Enable EINT interrupt
-	EN_INT_r.bits.en_rrint = 1;             // Enable R-to-R interrupt
-	EN_INT_r.bits.intb_type = 3;            // Open-drain NMOS with internal pullup
-	ecgAFE.writeRegister( MAX30003::EN_INT , EN_INT_r.all);
-
-
-	//Dyanmic modes config
-	MAX30003::ManageDynamicModes_u MNG_DYN_r;
-	MNG_DYN_r.bits.fast = 0;                // Fast recovery mode disabled
-	ecgAFE.writeRegister( MAX30003::MNGR_DYN , MNG_DYN_r.all);
-
-	// MUX Config
-	MAX30003::MuxConfiguration_u CNFG_MUX_r;
-	CNFG_MUX_r.bits.openn = 0;          // Connect ECGN to AFE channel
-	CNFG_MUX_r.bits.openp = 0;          // Connect ECGP to AFE channel
-	ecgAFE.writeRegister( MAX30003::CNFG_EMUX , CNFG_MUX_r.all);
-
-	return;
-}
-
-void max30003_reader_task()
-{
-	// Constants
-	const int EINT_STATUS = 1 << 23;
-	const int RTOR_STATUS = 1 << 10;
-	const int RTOR_REG_OFFSET = 10;
-	const float RTOR_LSB_RES = 0.0078125f;
-	const int FIFO_OVF = 0x7;
-	const int FIFO_VALID_SAMPLE = 0x0;
-	const int FIFO_FAST_SAMPLE = 0x1;
-	const int ETAG_BITS = 0x7;
-
-	uint32_t ecgFIFO, RtoR, readECGSamples, ETAG[32], status;
-	float BPM;
-	Timer bleNotifyTimer;
-
-	InterruptIn ecgFIFO_int(P5_4);          // Config P5_4 as int. in for the
-	ecgFIFO_int.fall(&ecgFIFO_callback);    // ecg FIFO almost full interrupt
-
-	ecg_config(max30003);                   // Config ECG
-
-	max30003.writeRegister( MAX30003::SYNCH , 0);
-
-	bleNotifyTimer.start();
-	while (1) {
-		// Read back ECG samples from the FIFO
-		thread_max30003_reader.signal_wait(MAX30003_IRQ_ASSERTED_SIGNAL_ID);
-
-		while (1) {
-			/* Read back ECG samples from the FIFO */
-			status = max30003.readRegister( MAX30003::STATUS );      // Read the STATUS register
-
-			if ((status & (RTOR_STATUS | EINT_STATUS)) == 0) {
-				break;
-			}
-
-			// Check if R-to-R interrupt asserted
-			if ((status & RTOR_STATUS) == RTOR_STATUS) {
-
-				daplink.printf("R-to-R Interrupt \r\n");
-
-				// Read RtoR register
-				RtoR = max30003.readRegister( MAX30003::RTOR ) >>  RTOR_REG_OFFSET;
-
-				// Convert to BPM
-				BPM = 1.0f / ( RtoR * RTOR_LSB_RES / 60.0f );
-
-				daplink.printf("BPM: %.2f\r\n", BPM);
-
-				if (bleNotifyTimer.read_ms() >=  (MAX30003_BLE_NOTIFY_PERIOD_SEC * 1000)) {
-					bleGattAttrWrite(gattCharBPM.getValueHandle(), (uint8_t *)&BPM, sizeof(BPM));
-					bleNotifyTimer.reset();
-				}
-			}
-
-			// Check if EINT interrupt asserted
-			if ((status & EINT_STATUS) == EINT_STATUS) {
-				readECGSamples = 0;	// Reset sample counter
-
-				do {
-					ecgFIFO = max30003.readRegister( MAX30003::ECG_FIFO );	// Read FIFO
-					ETAG[readECGSamples] = ( ecgFIFO >> 3 ) & ETAG_BITS;	// Isolate ETAG
-					readECGSamples++;										// Increment sample counter
-
-				// Check that sample is not last sample in FIFO
-				} while (ETAG[readECGSamples-1] == FIFO_VALID_SAMPLE ||
-						  ETAG[readECGSamples-1] == FIFO_FAST_SAMPLE);
-
-				// Check if FIFO has overflowed
-				if (ETAG[readECGSamples - 1] == FIFO_OVF){
-					max30003.writeRegister( MAX30003::FIFO_RST , 0); // Reset FIFO
-					rLED = 1;
-				}
-			}
-		}
-
-    }
-}
-
-#endif
-
-/******************************************************************************
-************** MAX11301WING ***************************************************
-*******************************************************************************/
-#if defined(LIB_MAX113XX_PIXI)
-
-#define MAX113XX_DATA_READ_PERIOD_MSEC	2000
-#define MAX113XX_I2C_ADDRESS	0x38
-
-Thread thread_max11301_reader;
-
-void max11301_reader_task()
-{
-	uint16_t adcData;
-	float adcVoltage;
-
-	MAX113XX_I2C pixi(i2c1, MAX113XX_I2C::MAX11301, MAX113XX_I2C_ADDRESS, P5_5);
-
-	pixi.dacWrite(MAX113XX_Pixi::PORT0, 0x000);    // Pixi PORT0 is -5V
-	pixi.dacWrite(MAX113XX_Pixi::PORT1, 0xFFF);    // Pixi PORT1 is +5V
-
-	daplink.printf("Starting MAX11301 PIXI ADC Demo Application...\r\n");
-
-	while (1) {
-		pixi.singleEndedADCRead(MAX113XX_Pixi::PORT9, adcData);    // Read value from PORT9
-		adcVoltage = -5 + 2.442e-3  * adcData;                     // Convert ADC val. to a voltage
-
-		daplink.printf("ADC Read is : %i,\tVoltage is %1.3f V \r\n", adcData, adcVoltage);
-
-		bleGattAttrWrite(gattCharADC.getValueHandle(), (uint8_t *)&adcVoltage, sizeof(adcVoltage));
-
-		Thread::wait(MAX113XX_PIXI_BLE_NOTIFY_PERIOD_SEC * 1000);
-	}
-}
-#endif
-
-/******************************************************************************
- ******************************************************************************
- ******************************************************************************/
-
 int main()
 {
 	osStatus status;
-	rLED = LED_OFF; gLED = LED_OFF; bLED = LED_OFF; // red
+	rLED = LED_OFF; gLED = LED_OFF; bLED = LED_OFF;
 
 	aliveLedEventId = eventQueue.call_every(1000, blinkCallback);
 
-	daplink.printf("Initializing BLE service...\r\n");
+	printf("Initializing BLE service...\r\n");
 
 	BLE &ble = BLE::Instance();
 	ble.onEventsToProcess(scheduleBleEventsProcessing);
 	ble.init(bleInitComplete);
 
 #if defined(LIB_MAX30205)
-	status = thread_max30205_reader.start(max30205_reader_task);
+	Thread thread_max30205_reader;
+	struct max30205_reader_task_args args_max30205 = {
+			i2c1,
+			gattCharTemp.getValueHandle(),
+			MAX30205_BLE_NOTIFY_PERIOD_SEC};
+	status = thread_max30205_reader.start(callback(max30205_reader_task, &args_max30205));
 	if (status != osOK) {
-		daplink.printf("Starting thread_max30205_reader thread failed(%d)!\r\n", status);
+		printf("Starting thread_max30205_reader thread failed(%ld)!\r\n", status);
 	}
 #endif
 
 #if defined(LIB_MAX30101)
-	status = thread_max30101_reader.start(max30101_reader_task);
+	Thread thread_max30101_reader;
+	struct max30101_reader_task_args args_max30101 = {
+			&thread_max30101_reader,
+			i2c1, P3_2, P3_3,
+			gattCharHeartRate.getValueHandle(),
+			gattCharSPO2.getValueHandle(),
+			MAX30101_BLE_NOTIFY_PERIOD_SEC};
+	status = thread_max30101_reader.start(callback(max30101_reader_task, &args_max30101));
 	if (status != osOK) {
-		daplink.printf("Starting thread_max30205_reader thread failed(%d)!\r\n", status);
+		printf("Starting thread_max30205_reader thread failed(%ld)!\r\n", status);
 	}
 #endif
 
 #if defined(LIB_MAX30003)
-	status = thread_max30003_reader.start(max30003_reader_task);
+	Thread thread_max30003_reader;
+	struct max30003_reader_task_args args_max30003 = {
+			&thread_max30003_reader,
+			spim2, SPI2_SS,
+			gattCharBPM.getValueHandle(),
+			MAX30003_BLE_NOTIFY_PERIOD_SEC};
+	status = thread_max30003_reader.start(callback(max30003_reader_task, &args_max30003));
 	if (status != osOK) {
-		daplink.printf("Starting thread_max30205_reader thread failed(%d)!\r\n", status);
+		printf("Starting thread_max30205_reader thread failed(%ld)!\r\n", status);
 	}
 #endif
 
 #if defined(LIB_MAX113XX_PIXI)
-	status = thread_max11301_reader.start(max11301_reader_task);
+	Thread thread_max11301_reader;
+	struct max11301_reader_task_args args_max11301 = {
+			i2c1,
+			gattCharADC.getValueHandle(),
+			MAX113XX_PIXI_BLE_NOTIFY_PERIOD_SEC};
+	status = thread_max11301_reader.start(callback(max11301_reader_task, &args_max11301));
 	if (status != osOK) {
-		daplink.printf("Starting thread_max30205_reader thread failed(%d)!\r\n", status);
+		printf("Starting thread_max30205_reader thread failed(%ld)!\r\n", status);
 	}
 #endif
 

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/max113xx_pixi_app.cpp	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,39 @@
+/*
+ * max113xx_pixi_app.cpp
+ *
+ *  Created on: Jun 20, 2018
+ *      Author: Mahir.Ozturk
+ */
+#include <mbed.h>
+#include "max113xx_pixi_app.h"
+#include "MAX113XX_Pixi.h"
+#include "MAX11301Hex.h"
+#include "ble_comm.h"
+
+#define MAX113XX_DATA_READ_PERIOD_MSEC	2000
+#define MAX113XX_I2C_ADDRESS	0x38
+
+void max11301_reader_task(struct max11301_reader_task_args *args)
+{
+	uint16_t adcData;
+	float adcVoltage;
+
+	MAX113XX_I2C pixi(args->i2cBus, MAX113XX_I2C::MAX11301, MAX113XX_I2C_ADDRESS, P5_5);
+
+	pixi.dacWrite(MAX113XX_Pixi::PORT0, 0x000);    // Pixi PORT0 is -5V
+	pixi.dacWrite(MAX113XX_Pixi::PORT1, 0xFFF);    // Pixi PORT1 is +5V
+
+	printf("Starting MAX11301 PIXI ADC Demo Application...\r\n");
+
+	while (1) {
+		pixi.singleEndedADCRead(MAX113XX_Pixi::PORT9, adcData);    // Read value from PORT9
+		adcVoltage = -5 + 2.442e-3  * adcData;                     // Convert ADC val. to a voltage
+
+		printf("ADC Read is : %i,\tVoltage is %1.3f V \r\n", adcData, adcVoltage);
+
+		bleGattAttrWrite(args->gatt, (uint8_t *)&adcVoltage, sizeof(adcVoltage));
+
+		Thread::wait(args->notify_period_sec * 1000);
+	}
+}
+

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/max113xx_pixi_app.h	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,21 @@
+/*
+ * max113xx_pixi_app.h
+ *
+ *  Created on: Jun 20, 2018
+ *      Author: Mahir.Ozturk
+ */
+
+#ifndef MAX113XX_PIXI_APP_H_
+#define MAX113XX_PIXI_APP_H_
+
+#include "ble_comm.h"
+
+struct max11301_reader_task_args {
+	I2C &i2cBus;
+	GattAttribute::Handle_t gatt;
+	int notify_period_sec;
+};
+
+void max11301_reader_task(struct max11301_reader_task_args *args);
+
+#endif /* MAX113XX_PIXI_APP_H_ */

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/max30003_app.cpp	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,166 @@
+/*
+ * max30003_app.c
+ *
+ *  Created on: Jun 20, 2018
+ *      Author: Mahir.Ozturk
+ */
+#include <mbed.h>
+#include "max30003_app.h"
+#include "MAX30003.h"
+
+#define MAX30003_IRQ_ASSERTED_SIGNAL_ID	1
+
+static Thread *thread = 0;
+
+/* ECG FIFO nearly full callback */
+void ecgFIFO_callback()  {
+	if (thread != 0) {
+		thread->signal_set(MAX30003_IRQ_ASSERTED_SIGNAL_ID);
+	}
+}
+
+void ecg_config(MAX30003& ecgAFE)
+{
+	// Reset ECG to clear registers
+	ecgAFE.writeRegister( MAX30003::SW_RST , 0);
+
+	// General config register setting
+	MAX30003::GeneralConfiguration_u CNFG_GEN_r;
+	CNFG_GEN_r.bits.en_ecg = 1;     // Enable ECG channel
+	CNFG_GEN_r.bits.rbiasn = 1;     // Enable resistive bias on negative input
+	CNFG_GEN_r.bits.rbiasp = 1;     // Enable resistive bias on positive input
+	CNFG_GEN_r.bits.en_rbias = 1;   // Enable resistive bias
+	CNFG_GEN_r.bits.imag = 2;       // Current magnitude = 10nA
+	CNFG_GEN_r.bits.en_dcloff = 1;  // Enable DC lead-off detection
+	ecgAFE.writeRegister( MAX30003::CNFG_GEN , CNFG_GEN_r.all);
+
+
+	// ECG Config register setting
+	MAX30003::ECGConfiguration_u CNFG_ECG_r;
+	CNFG_ECG_r.bits.dlpf = 1;       // Digital LPF cutoff = 40Hz
+	CNFG_ECG_r.bits.dhpf = 1;       // Digital HPF cutoff = 0.5Hz
+	CNFG_ECG_r.bits.gain = 3;       // ECG gain = 160V/V
+	CNFG_ECG_r.bits.rate = 2;       // Sample rate = 128 sps
+	ecgAFE.writeRegister( MAX30003::CNFG_ECG , CNFG_ECG_r.all);
+
+
+	//R-to-R configuration
+	MAX30003::RtoR1Configuration_u CNFG_RTOR_r;
+	CNFG_RTOR_r.bits.wndw = 0b0011;         // WNDW = 96ms
+	CNFG_RTOR_r.bits.rgain = 0b1111;        // Auto-scale gain
+	CNFG_RTOR_r.bits.pavg = 0b11;           // 16-average
+	CNFG_RTOR_r.bits.ptsf = 0b0011;         // PTSF = 4/16
+	CNFG_RTOR_r.bits.en_rtor = 1;           // Enable R-to-R detection
+	ecgAFE.writeRegister( MAX30003::CNFG_RTOR1 , CNFG_RTOR_r.all);
+
+
+	//Manage interrupts register setting
+	MAX30003::ManageInterrupts_u MNG_INT_r;
+	MNG_INT_r.bits.efit = 0b00011;          // Assert EINT w/ 4 unread samples
+	MNG_INT_r.bits.clr_rrint = 0b01;        // Clear R-to-R on RTOR reg. read back
+	ecgAFE.writeRegister( MAX30003::MNGR_INT , MNG_INT_r.all);
+
+
+	//Enable interrupts register setting
+	MAX30003::EnableInterrupts_u EN_INT_r;
+	EN_INT_r.bits.en_eint = 1;              // Enable EINT interrupt
+	EN_INT_r.bits.en_rrint = 1;             // Enable R-to-R interrupt
+	EN_INT_r.bits.intb_type = 3;            // Open-drain NMOS with internal pullup
+	ecgAFE.writeRegister( MAX30003::EN_INT , EN_INT_r.all);
+
+
+	//Dyanmic modes config
+	MAX30003::ManageDynamicModes_u MNG_DYN_r;
+	MNG_DYN_r.bits.fast = 0;                // Fast recovery mode disabled
+	ecgAFE.writeRegister( MAX30003::MNGR_DYN , MNG_DYN_r.all);
+
+	// MUX Config
+	MAX30003::MuxConfiguration_u CNFG_MUX_r;
+	CNFG_MUX_r.bits.openn = 0;          // Connect ECGN to AFE channel
+	CNFG_MUX_r.bits.openp = 0;          // Connect ECGP to AFE channel
+	ecgAFE.writeRegister( MAX30003::CNFG_EMUX , CNFG_MUX_r.all);
+
+	return;
+}
+
+void max30003_reader_task(struct max30003_reader_task_args *args)
+{
+	// Constants
+	const int EINT_STATUS = 1 << 23;
+	const int RTOR_STATUS = 1 << 10;
+	const int RTOR_REG_OFFSET = 10;
+	const float RTOR_LSB_RES = 0.0078125f;
+	const int FIFO_OVF = 0x7;
+	const int FIFO_VALID_SAMPLE = 0x0;
+	const int FIFO_FAST_SAMPLE = 0x1;
+	const int ETAG_BITS = 0x7;
+
+	uint32_t ecgFIFO, RtoR, readECGSamples, ETAG[32], status;
+	float BPM;
+	Timer bleNotifyTimer;
+
+	thread = args->self;
+
+	MAX30003 max30003(args->spiBus, args->spiCS);		/* MAX30003WING board */
+
+	InterruptIn ecgFIFO_int(P5_4);          // Config P5_4 as int. in for the
+	ecgFIFO_int.fall(&ecgFIFO_callback);    // ecg FIFO almost full interrupt
+
+	ecg_config(max30003);                   // Config ECG
+
+	max30003.writeRegister( MAX30003::SYNCH , 0);
+
+	bleNotifyTimer.start();
+	while (1) {
+		// Read back ECG samples from the FIFO
+		thread->signal_wait(MAX30003_IRQ_ASSERTED_SIGNAL_ID);
+
+		while (1) {
+			/* Read back ECG samples from the FIFO */
+			status = max30003.readRegister( MAX30003::STATUS );      // Read the STATUS register
+
+			if ((status & (RTOR_STATUS | EINT_STATUS)) == 0) {
+				break;
+			}
+
+			// Check if R-to-R interrupt asserted
+			if ((status & RTOR_STATUS) == RTOR_STATUS) {
+
+				// printf("R-to-R Interrupt \r\n");
+
+				// Read RtoR register
+				RtoR = max30003.readRegister(MAX30003::RTOR) >>  RTOR_REG_OFFSET;
+
+				// Convert to BPM
+				BPM = 1.0f / ( RtoR * RTOR_LSB_RES / 60.0f );
+
+				if (bleNotifyTimer.read_ms() >= (args->notify_period_sec * 1000)) {
+					printf("BPM: %.2f\r\n", BPM);
+					bleGattAttrWrite(args->gatt, (uint8_t *)&BPM, sizeof(BPM));
+					bleNotifyTimer.reset();
+				}
+			}
+
+			// Check if EINT interrupt asserted
+			if ((status & EINT_STATUS) == EINT_STATUS) {
+				readECGSamples = 0;	// Reset sample counter
+
+				do {
+					ecgFIFO = max30003.readRegister( MAX30003::ECG_FIFO );	// Read FIFO
+					ETAG[readECGSamples] = ( ecgFIFO >> 3 ) & ETAG_BITS;	// Isolate ETAG
+					readECGSamples++;										// Increment sample counter
+
+				// Check that sample is not last sample in FIFO
+				} while (ETAG[readECGSamples-1] == FIFO_VALID_SAMPLE ||
+						ETAG[readECGSamples-1] == FIFO_FAST_SAMPLE);
+
+				// Check if FIFO has overflowed
+				if (ETAG[readECGSamples - 1] == FIFO_OVF){
+					max30003.writeRegister( MAX30003::FIFO_RST , 0); // Reset FIFO
+				}
+			}
+		}
+    }
+}
+
+

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/max30003_app.h	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,23 @@
+/*
+ * max30003_app.h
+ *
+ *  Created on: Jun 20, 2018
+ *      Author: Mahir.Ozturk
+ */
+
+#ifndef MAX30003_APP_H_
+#define MAX30003_APP_H_
+
+#include "ble_comm.h"
+
+struct max30003_reader_task_args {
+	Thread *self;
+	SPI &spiBus;
+	PinName spiCS;
+	GattAttribute::Handle_t gatt;
+	int notify_period_sec;
+};
+
+void max30003_reader_task(struct max30003_reader_task_args *args);
+
+#endif /* MAX30003_APP_H_ */

--- a/max30101_algo.cpp	Wed May 09 08:32:29 2018 +0000
+++ b/max30101_algo.cpp	Thu Jun 28 15:47:24 2018 +0300
@@ -108,10 +108,10 @@
 	int16_t bufferIdx1,  bufferIdx2;
 	int16_t maxFIFO, IdxMaxFIFO ;
 	int16_t HRperiod2, HRComp2, deltaHR;
-	int16_t cSpO2, SpO2;
+	int16_t cSpO2 = 0, SpO2;
 
 	int16_t HrCount = 0, HrSum = 0, meanGreenMagFIFOcounter = 0;
-	int16_t SPO2D, meanHrQ;
+	int16_t SPO2D = 0, meanHrQ;
 	int16_t dx[99], cumsumX[99];
 	static int16_t SPO2QueCounter = 0 ; //, lastDisplayedHrValue;
 

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/max30101_app.cpp	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,270 @@
+/*
+ * max30101_app.cpp
+ *
+ *  Created on: Jun 20, 2018
+ *      Author: Mahir.Ozturk
+ */
+#include <mbed.h>
+#include "max30101_app.h"
+#include "MAX30101.h"
+#include "max30101_algo.h"
+
+#define MAX30101_IRQ_ASSERTED_ID	1
+
+#define MAX30101_BUFFER_LEN			500
+
+static Thread *thread = 0;
+
+//variable for the algorithm
+uint16_t sampleRate = 100;
+uint16_t compSpO2 = 1;
+int16_t ir_ac_comp = 0;
+int16_t red_ac_comp = 0;
+int16_t green_ac_comp = 0;
+int16_t ir_ac_mag = 0;
+int16_t red_ac_mag = 0;
+int16_t green_ac_mag = 0;
+uint16_t HRbpm2 = 0;
+uint16_t SpO2B = 0;
+uint16_t DRdy = 0;
+
+//declare large variables outside of main
+uint32_t redData[MAX30101_BUFFER_LEN];//set array to max fifo size
+uint32_t irData[MAX30101_BUFFER_LEN];//set array to max fifo size
+uint32_t greenData[MAX30101_BUFFER_LEN];//set array to max fifo size
+
+bool max30101_config(MAX30101 &op_sensor)
+{
+	//Reset Device
+	MAX30101::ModeConfiguration_u modeConfig;
+	modeConfig.all = 0;
+	modeConfig.bits.reset = 1;
+	modeConfig.bits.mode = MAX30101::MultiLedMode;     // Sets SPO2 Mode
+	int32_t rc = op_sensor.setModeConfiguration(modeConfig);
+
+	//enable MAX30101 interrupts
+	MAX30101::InterruptBitField_u ints;
+	if (rc == 0) {
+		ints.all = 0;
+		ints.bits.a_full = 1;       // Enable FIFO almost full interrupt
+		ints.bits.ppg_rdy =1;       //Enables an interrupt when a new sample is ready
+		rc = op_sensor.enableInterrupts(ints);
+	}
+
+	//configure FIFO
+	MAX30101::FIFO_Configuration_u fifoConfig;
+	if (rc == 0) {
+		fifoConfig.all = 0;
+		fifoConfig.bits.fifo_a_full = 10;                            // Max level of 17 samples
+		fifoConfig.bits.sample_average = MAX30101::AveragedSamples_0;// Average 0 samples
+		rc = op_sensor.setFIFOConfiguration(fifoConfig);
+	}
+
+	MAX30101::SpO2Configuration_u spo2Config;
+	if (rc == 0) {
+		spo2Config.all = 0;                                 // clears register
+		spo2Config.bits.spo2_adc_range = 1;                 //sets resolution to 4096 nAfs
+		spo2Config.bits.spo2_sr = MAX30101::SR_100_Hz;     // SpO2 SR = 100Hz
+		spo2Config.bits.led_pw = MAX30101::PW_3;            // 18-bit ADC resolution ~400us
+		rc = op_sensor.setSpO2Configuration(spo2Config);
+	}
+
+	//Set time slots for LEDS
+	MAX30101::ModeControlReg_u multiLED;
+	if (rc == 0) {
+		//sets timing for control register 1
+		multiLED.bits.lo_slot=1;
+		multiLED.bits.hi_slot=2;
+		rc = op_sensor.setMultiLEDModeControl(MAX30101::ModeControlReg1, multiLED);
+		if (rc == 0) {
+			multiLED.bits.lo_slot=3;
+			multiLED.bits.hi_slot=0;
+			rc = op_sensor.setMultiLEDModeControl(MAX30101::ModeControlReg2, multiLED);
+		}
+	}
+
+	//Set LED drive currents
+	if (rc == 0) {
+		// Heart Rate only, 1 LED channel, Pulse amp. = ~7mA
+		rc = op_sensor.setLEDPulseAmplitude(MAX30101::LED1_PA, 0x24);
+		//To include SPO2, 2 LED channel, Pulse amp. ~7mA
+		if (rc == 0) {
+			rc = op_sensor.setLEDPulseAmplitude(MAX30101::LED2_PA, 0x24);
+		}
+		if (rc == 0) {
+			rc = op_sensor.setLEDPulseAmplitude(MAX30101::LED3_PA, 0x24);
+		}
+	}
+
+	//Set operating mode
+	modeConfig.all = 0;
+	if (rc == 0) {
+		modeConfig.bits.mode = MAX30101::MultiLedMode;     // Sets multiLED mode
+		rc = op_sensor.setModeConfiguration(modeConfig);
+	}
+
+	return rc;
+}
+
+void max30101wing_pmic_config(I2C & i2c_bus, DigitalOut & pmic_en)
+{
+	const uint8_t PMIC_ADRS = 0x54;
+	const uint8_t BBB_EXTRA_ADRS = 0x1C;
+	const uint8_t BOOST_VOLTAGE = 0x05;
+
+	char data_buff[] = {BBB_EXTRA_ADRS, 0x40};    //BBBExtra register address
+	//and data to enable passive
+	//pull down.
+	i2c_bus.write(PMIC_ADRS, data_buff,2);        //write to BBBExtra register
+
+	data_buff[0] = BOOST_VOLTAGE;
+	data_buff[1] = 0x08;                          //Boost voltage configuration
+	//register followed by data
+	//to set voltage to 4.5V 1f
+	pmic_en = 0;                                  //disables VLED 08
+	i2c_bus.write(PMIC_ADRS, data_buff,2);        //write to BBBExtra register
+	pmic_en = 1;                                  //enables VLED
+}
+
+/* Op Sensor FIFO nearly full callback */
+void max30101_intr_callback()
+{
+	if (thread != 0) {
+		thread->signal_set(MAX30101_IRQ_ASSERTED_ID);
+	}
+}
+
+void max30101_reader_task(struct max30101_reader_task_args *args)
+{
+	InterruptIn op_sensor_int(args->pinIntr);		// Config P3_2 as int. in for
+	op_sensor_int.fall(max30101_intr_callback);		// FIFO ready interrupt
+
+	DigitalOut VLED_EN(args->pinVLED,0);			//Enable for VLEDs
+	max30101wing_pmic_config(args->i2cBus, VLED_EN);
+
+	MAX30101 op_sensor(args->i2cBus);				// Create new MAX30101 on i2cBus
+	int rc = max30101_config(op_sensor);			// Config sensor, return 0 on success
+
+	MAX30101::InterruptBitField_u ints;				// Read interrupt status to clear
+	rc = op_sensor.getInterruptStatus(ints);		// power on interrupt
+
+	thread = args->self;
+
+	uint8_t fifoData[MAX30101::MAX_FIFO_BYTES];
+	uint16_t idx, readBytes;
+	uint16_t HRTemp;
+	uint16_t spo2Temp;
+
+	uint16_t lastValidHR = 0;
+	uint16_t lastValidSPO2 = 0;
+
+	int r=0; //counter for redData position
+	int ir=0; //counter for irData position
+	int g =0; //counter for greenData position
+	int c=0; //counter to print values
+
+	int consecCalcFailCnt = 0;
+
+	printf("Starting MAX30101 HeartRate / SPO2 Demo Application...\r\n");
+	printf("Please wait a few seconds while data is being collected.\r\n");
+
+	Timer bleNotifyTimer;
+
+	bleNotifyTimer.start();
+
+	while (1) {
+		if (rc == 0) {
+			/* Check if op_sensor interrupt asserted */
+			thread->signal_wait(MAX30101_IRQ_ASSERTED_ID);
+
+			/* Read interrupt status to clear interrupt */
+			rc = op_sensor.getInterruptStatus(ints);
+
+			/* Confirms proper read prior to executing */
+			if (rc == 0) {
+				// Read FIFO
+				rc = op_sensor.readFIFO(MAX30101::ThreeLedChannels, fifoData, readBytes);
+
+				if (rc == 0) {
+					/* Convert read bytes into samples */
+					for (idx = 0; idx < readBytes; idx+=9) {
+						if (r >= 500 || ir >= 500 || g >= 500) {
+							printf("Overflow! r=%d ir=%d g=%d\r\n", r, ir, g);
+							break;
+						}
+
+						if (readBytes >= (idx + 8)) {
+							redData[r++] = ((fifoData[idx] << 16) | (fifoData[idx + 1] << 8) | (fifoData[idx + 2])) & 0x03FFFF;
+							irData[ir++] = ((fifoData[idx + 3] << 16) | (fifoData[idx + 4] << 8) | (fifoData[idx + 5])) & 0x03FFFF;
+							greenData[g++] = ((fifoData[idx + 6] << 16) | (fifoData[idx + 7] << 8) | (fifoData[idx + 8])) & 0x03FFFF;
+						}
+					}
+
+					if ((r >= MAX30101_BUFFER_LEN) && (ir >= MAX30101_BUFFER_LEN) && (g >= MAX30101_BUFFER_LEN)) {/* checks to make sure there are 500 */
+						/* samples in data buffers */
+
+						/* runs the heart rate and SpO2 algorithm */
+						for (c = 0, HRTemp = 0; c < r; c++) {
+							HRSpO2Func(irData[c], redData[c],greenData[c], c,sampleRate, compSpO2,
+									   &ir_ac_comp,&red_ac_comp, &green_ac_comp, &ir_ac_mag,&red_ac_mag,
+									   &green_ac_mag, &HRbpm2,&SpO2B,&DRdy);
+							if (DRdy) {
+								HRTemp = HRbpm2;
+								spo2Temp = SpO2B;
+							}
+						}
+
+						/* If the above algorithm returns a valid heart rate on the last sample, it is printed */
+						if (DRdy == 1) {
+							printf("Heart Rate = %i\r\n",HRbpm2);
+							printf("SPO2 = %i\r\n",SpO2B);
+							lastValidHR = HRbpm2;
+							lastValidSPO2 = SpO2B;
+							consecCalcFailCnt = 0;
+						} else if (HRTemp != 0) { /* if a valid heart was calculated at all, it is printed */
+							printf("Heart Rate = %i\r\n",HRTemp);
+							printf("SPO2 = %i\r\n",spo2Temp);
+							lastValidHR = HRTemp;
+							lastValidSPO2 = spo2Temp;
+							consecCalcFailCnt = 0;
+						} else {
+							consecCalcFailCnt++;
+							if (consecCalcFailCnt >= 10) {
+								printf("Calculation failed...waiting for more samples...\r\n");
+								printf("Please keep your finger on the MAX30101 sensor with minimal movement.\r\n");
+								consecCalcFailCnt = 0;
+							}
+						}
+
+						/* dump the first hundred samples after calculation */
+						for (c = 100; c < 500; c++) {
+							redData[c - 100] = redData[c];
+							irData[c - 100] = irData[c];
+							greenData[c - 100] = greenData[c];
+						}
+
+						/* reset counters */
+						r = 400;
+						ir = 400;
+						g = 400;
+					}
+
+					if (bleNotifyTimer.read_ms() >= (args->notify_period_sec * 1000)) {
+						bleGattAttrWrite(args->gattHeartRate, (uint8_t *)&lastValidHR, sizeof(lastValidHR));
+						bleGattAttrWrite(args->gattSPO2, (uint8_t *)&lastValidSPO2, sizeof(lastValidSPO2));
+						bleNotifyTimer.reset();
+					}
+				}
+			}
+		} else { // If rc != 0, a communication error has occurred
+
+			printf("Something went wrong, "
+					  "check the I2C bus or power connections... \r\n");
+
+			return;
+		}
+
+	}
+}
+
+

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/max30101_app.h	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,25 @@
+/*
+ * max30101_app.h
+ *
+ *  Created on: Jun 20, 2018
+ *      Author: Mahir.Ozturk
+ */
+
+#ifndef MAX30101_APP_H_
+#define MAX30101_APP_H_
+
+#include "ble_comm.h"
+
+struct max30101_reader_task_args {
+	Thread *self;
+	I2C &i2cBus;
+	PinName pinIntr;
+	PinName pinVLED;
+	GattAttribute::Handle_t gattHeartRate;
+	GattAttribute::Handle_t gattSPO2;
+	int notify_period_sec;
+};
+
+void max30101_reader_task(struct max30101_reader_task_args *args);
+
+#endif /* MAX30101_APP_H_ */

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/max30205_app.cpp	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,71 @@
+/*
+ * max30205_app.c
+ *
+ *  Created on: Jun 20, 2018
+ *      Author: Mahir.Ozturk
+ */
+#include <mbed.h>
+#include "max30205_app.h"
+#include "MAX30205.h"
+
+bool max30205_config(MAX30205 &temp_sensor){
+
+	int rc = 0;
+
+	MAX30205::Configuration_u temp_cfg;
+	temp_cfg.all = 0;
+	temp_cfg.bits.shutdown = 1;     // Shutdown mode
+	temp_cfg.bits.comp_int = 1;     // Interrupt mode
+	temp_cfg.bits.os_polarity = 0;  // Active low OS
+	temp_cfg.bits.fault_queue = 1;  // Two faults for OS condition
+	temp_cfg.bits.data_format = 0;  // Normal data format
+	temp_cfg.bits.timeout = 0;      // I2C timeout reset enabled
+	temp_cfg.bits.one_shot = 0;     // Start with one-shot = 0
+
+	rc = temp_sensor.writeConfiguration(temp_cfg);  // Write config to MAX30205
+
+	return rc;
+}
+
+void max30205_reader_task(struct max30205_reader_task_args *args)
+{
+	MAX30205 max30205_temp_sensor(args->i2cBus, 0x48);	/* New MAX30205 on i2cBus */
+
+	int rc = max30205_config(max30205_temp_sensor);   // Configure sensor, return 0 on success
+
+	MAX30205::Configuration_u temp_cfg;
+	uint16_t rawTemperatureRead;
+	float temperature;
+
+	temp_cfg.all = 0;
+
+	printf("Starting MAX30205 Temperature Demo Application...\r\n");
+
+	while (1) {
+		if (rc == 0) {
+			/* Send one-shot cmd to begin conversion */
+			temp_cfg.bits.one_shot = 1;
+			rc = max30205_temp_sensor.writeConfiguration(temp_cfg);
+
+			Thread::wait(50);
+
+			/* Read the temperature data */
+			rc = max30205_temp_sensor.readTemperature(rawTemperatureRead);
+
+			/* Convert temp data to Celsius */
+			temperature = max30205_temp_sensor.toCelsius(rawTemperatureRead);
+
+			bleGattAttrWrite(args->gatt, (uint8_t *)&temperature, sizeof(temperature));
+			printf("Temperature is %2.3f deg. C\r\n", temperature);
+
+			Thread::wait(args->notify_period_sec * 1000);
+
+		} else {
+			printf("Something went wrong, check the I2C bus and power connections...\r\n");
+
+			return;
+		}
+	}
+}
+
+

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/max30205_app.h	Thu Jun 28 15:47:24 2018 +0300
@@ -0,0 +1,21 @@
+/*
+ * max30205_app.h
+ *
+ *  Created on: Jun 20, 2018
+ *      Author: Mahir.Ozturk
+ */
+
+#ifndef MAX30205_APP_H_
+#define MAX30205_APP_H_
+
+#include "ble_comm.h"
+
+struct max30205_reader_task_args {
+	I2C &i2cBus;
+	GattAttribute::Handle_t gatt;
+	int notify_period_sec;
+};
+
+void max30205_reader_task(struct max30205_reader_task_args *args);
+
+#endif /* MAX30205_APP_H_ */

--- a/mem_debug.cpp	Wed May 09 08:32:29 2018 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,91 +0,0 @@
-/*******************************************************************************
-* Copyright (C) 2018 Maxim Integrated Products, Inc., All Rights Reserved.
-*
-* Permission is hereby granted, free of charge, to any person obtaining a
-* copy of this software and associated documentation files (the "Software"),
-* to deal in the Software without restriction, including without limitation
-* the rights to use, copy, modify, merge, publish, distribute, sublicense,
-* and/or sell copies of the Software, and to permit persons to whom the
-* Software is furnished to do so, subject to the following conditions:
-*
-* The above copyright notice and this permission notice shall be included
-* in all copies or substantial portions of the Software.
-*
-* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
-* OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
-* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
-* IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
-* OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
-* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
-* OTHER DEALINGS IN THE SOFTWARE.
-*
-* Except as contained in this notice, the name of Maxim Integrated
-* Products, Inc. shall not be used except as stated in the Maxim Integrated
-* Products, Inc. Branding Policy.
-*
-* The mere transfer of this software does not imply any licenses
-* of trade secrets, proprietary technology, copyrights, patents,
-* trademarks, maskwork rights, or any other form of intellectual
-* property whatsoever. Maxim Integrated Products, Inc. retains all
-* ownership rights.
-*******************************************************************************
-*/
-
-#include "mbed.h"
-
-#if defined(MBED_MEM_TRACING_ENABLED )
-#include "mbed_mem_trace.h"
-#endif /* MBED_MEM_TRACING_ENABLED */
-
-#if defined(MBED_HEAP_STATS_ENABLED)
-#include "mbed_stats.h"
-#endif /* MBED_HEAP_STATS_ENABLED */
-
-#if defined(MBED_STACK_STATS_ENABLED)
-#include "cmsis_os.h"
-#endif /* MBED_STACK_STATS_ENABLED */
-
-
-void mbed_mem_debug_init()
-{
-#if defined(MBED_MEM_TRACING_ENABLED )
-	mbed_mem_trace_set_callback(mbed_mem_trace_default_callback);
-#endif /* MBED_MEM_TRACING_ENABLED */
-}
-
-#if defined(MBED_HEAP_STATS_ENABLED)
-void mbed_heap_stats(const char* func, int line)
-{
-	mbed_stats_heap_t heap_stats;
-	mbed_stats_heap_get(&heap_stats);
-	printf("  HEAP current: %lu, max: %lu, cumulative: %lu bytes (%s:%d)\n",
-	       heap_stats.current_size,
-	       heap_stats.max_size,
-	       heap_stats.total_size,
-	       func, line);
-}
-#endif /* MBED_HEAP_STATS_ENABLED */
-
-#if defined(MBED_STACK_STATS_ENABLED)
-void mbed_stack_stats(const char* func, int line)
-{
-	osThreadId main_id = osThreadGetId();
-
-	osEvent info;
-	info = _osThreadGetInfo(main_id, osThreadInfoStackSize);
-	if (info.status != osOK) {
-		printf("Could not get stack size (%s:%d)\n", func, line);
-	}
-	uint32_t stack_size = (uint32_t)info.value.v;
-	info = _osThreadGetInfo(main_id, osThreadInfoStackMax);
-	if (info.status != osOK) {
-		printf("Could not get max stack (%s:%d)\n", func, line);
-	}
-	uint32_t max_stack = (uint32_t)info.value.v;
-
-	printf("  STACK used: %li, max: %li bytes (%s:%d)\n",
-	       max_stack,
-	       stack_size,
-	       func, line);
-}
-#endif /* MBED_STACK_STATS_ENABLED */

--- a/mem_debug.h	Wed May 09 08:32:29 2018 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,53 +0,0 @@
-/*******************************************************************************
-* Copyright (C) 2018 Maxim Integrated Products, Inc., All Rights Reserved.
-*
-* Permission is hereby granted, free of charge, to any person obtaining a
-* copy of this software and associated documentation files (the "Software"),
-* to deal in the Software without restriction, including without limitation
-* the rights to use, copy, modify, merge, publish, distribute, sublicense,
-* and/or sell copies of the Software, and to permit persons to whom the
-* Software is furnished to do so, subject to the following conditions:
-*
-* The above copyright notice and this permission notice shall be included
-* in all copies or substantial portions of the Software.
-*
-* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
-* OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
-* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
-* IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
-* OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
-* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
-* OTHER DEALINGS IN THE SOFTWARE.
-*
-* Except as contained in this notice, the name of Maxim Integrated
-* Products, Inc. shall not be used except as stated in the Maxim Integrated
-* Products, Inc. Branding Policy.
-*
-* The mere transfer of this software does not imply any licenses
-* of trade secrets, proprietary technology, copyrights, patents,
-* trademarks, maskwork rights, or any other form of intellectual
-* property whatsoever. Maxim Integrated Products, Inc. retains all
-* ownership rights.
-*******************************************************************************
-*/
-
-#ifndef _MEM_DEBUG_H_
-#define _MEM_DEBUG_H_
-
-void mbed_mem_debug_init();
-void mbed_heap_stats(const char* func, int line);
-void mbed_stack_stats(const char* func, int line);
-
-#if defined(MBED_HEAP_STATS_ENABLED)
-#define SHOW_MBED_HEAP_STATS mbed_heap_stats(__func__, __LINE__)
-#else
-#define SHOW_MBED_HEAP_STATS
-#endif /* MBED_HEAP_STATS_ENABLED */
-
-#if defined(MBED_STACK_STATS_ENABLED)
-#define SHOW_MBED_STACK_STATS mbed_stack_stats(__func__, __LINE__)
-#else
-#define SHOW_MBED_STACK_STATS
-#endif /* MBED_STACK_STATS_ENABLED */
-
-#endif /* MEM_DEBUG */