SpO2 algorithm used in MAX30101 onboard MAX32620HSP. Algorithm is not perfect but it works

Dependencies:   mbed MAX14720 USBDevice

Files at this revision

API Documentation at this revision

Comitter:
douqan93
Date:
Thu Mar 28 08:07:54 2019 +0000
Commit message:
This program for MAX32620HSP's onboard SpO2 sensor (MAX30101). Algorithm is not perfect but it works.

Changed in this revision

MAX14720.lib Show annotated file Show diff for this revision Revisions of this file
MAX30001/MAX30001/MAX30001.cpp Show annotated file Show diff for this revision Revisions of this file
MAX30001/MAX30001/MAX30001.h Show annotated file Show diff for this revision Revisions of this file
MAX30102/MAX30102.cpp Show annotated file Show diff for this revision Revisions of this file
MAX30102/MAX30102.h Show annotated file Show diff for this revision Revisions of this file
System/System.cpp Show annotated file Show diff for this revision Revisions of this file
System/System.h Show annotated file Show diff for this revision Revisions of this file
USBDevice.lib Show annotated file Show diff for this revision Revisions of this file
algorithm/algorithm.cpp Show annotated file Show diff for this revision Revisions of this file
algorithm/algorithm.h Show annotated file Show diff for this revision Revisions of this file
main.cpp Show annotated file Show diff for this revision Revisions of this file
mbed.bld Show annotated file Show diff for this revision Revisions of this file
diff -r 000000000000 -r af4d13000e95 MAX14720.lib
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MAX14720.lib	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,1 @@
+https://developer.mbed.org/teams/MaximIntegrated/code/MAX14720/#2c3f2da51c5d
diff -r 000000000000 -r af4d13000e95 MAX30001/MAX30001/MAX30001.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MAX30001/MAX30001/MAX30001.cpp	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,1317 @@
+
+/*******************************************************************************
+ * Copyright (C) 2016 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"
+#include "MAX30001.h"
+
+MAX30001 *MAX30001::instance = NULL;
+
+//******************************************************************************
+MAX30001::MAX30001(PinName mosi, PinName miso, PinName sclk, PinName cs) {
+  spi = new SPI(mosi, miso, sclk, cs);
+  spi->frequency(3000000);
+  spi_owner = true;
+  functionpointer.attach(&spiHandler);
+  onDataAvailableCallback = NULL;
+  instance = this;
+}
+
+//******************************************************************************
+MAX30001::MAX30001(SPI *_spi) {
+  spi = _spi;
+  spi->frequency(3000000);
+  spi_owner = false;
+  functionpointer.attach(&spiHandler);
+  onDataAvailableCallback = NULL;
+  instance = this;
+}
+
+//******************************************************************************
+MAX30001::~MAX30001(void) {
+  if (spi_owner) {
+    delete spi;
+  }
+}
+
+//******************************************************************************
+int MAX30001::max30001_Rbias_FMSTR_Init(uint8_t En_rbias, uint8_t Rbiasv,
+                                        uint8_t Rbiasp, uint8_t Rbiasn,
+                                        uint8_t Fmstr) {
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_rbias = En_rbias;
+  max30001_cnfg_gen.bit.rbiasv   = Rbiasv;
+  max30001_cnfg_gen.bit.rbiasp   = Rbiasp;
+  max30001_cnfg_gen.bit.rbiasn   = Rbiasn;
+  max30001_cnfg_gen.bit.fmstr    = Fmstr;
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_CAL_InitStart(uint8_t En_Vcal, uint8_t Vmode,
+                                     uint8_t Vmag, uint8_t Fcal, uint16_t Thigh,
+                                     uint8_t Fifty) {
+  // CNFG_CAL
+  if (max30001_reg_read(CNFG_CAL, &max30001_cnfg_cal.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_cal.bit.vmode = Vmode;
+  max30001_cnfg_cal.bit.vmag  = Vmag;
+  max30001_cnfg_cal.bit.fcal  = Fcal;
+  max30001_cnfg_cal.bit.thigh = Thigh;
+  max30001_cnfg_cal.bit.fifty = Fifty;
+
+  if (max30001_reg_write(CNFG_CAL, max30001_cnfg_cal.all) == -1) {
+    return -1;
+  }
+
+  // RTOS uses a 32768HZ clock.  32768ticks represents 1secs.  1sec/10 =
+  // 100msecs.
+  wait(1.0 / 10.0);
+
+  if (max30001_reg_read(CNFG_CAL, &max30001_cnfg_cal.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_cal.bit.en_vcal = En_Vcal;
+
+  if (max30001_reg_write(CNFG_CAL, max30001_cnfg_cal.all) == -1) {
+    return -1;
+  }
+
+  // RTOS uses a 32768HZ clock.  32768ticks represents 1secs.  1sec/10 =
+  // 100msecs.
+  wait(1.0 / 10.0);
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_CAL_Stop(void) {
+
+  if (max30001_reg_read(CNFG_CAL, &max30001_cnfg_cal.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_cal.bit.en_vcal = 0; // Disable VCAL, all other settings are left unaffected
+
+  if (max30001_reg_write(CNFG_CAL, max30001_cnfg_cal.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+//******************************************************************************
+//******************************************************************************
+int MAX30001::max30001_INT_assignment(max30001_intrpt_Location_t en_enint_loc,     max30001_intrpt_Location_t en_eovf_loc,  max30001_intrpt_Location_t en_fstint_loc,
+		                      max30001_intrpt_Location_t en_dcloffint_loc, max30001_intrpt_Location_t en_bint_loc,  max30001_intrpt_Location_t en_bovf_loc,
+		                      max30001_intrpt_Location_t en_bover_loc,     max30001_intrpt_Location_t en_bundr_loc, max30001_intrpt_Location_t en_bcgmon_loc,
+		                      max30001_intrpt_Location_t en_pint_loc,      max30001_intrpt_Location_t en_povf_loc,  max30001_intrpt_Location_t en_pedge_loc,
+		                      max30001_intrpt_Location_t en_lonint_loc,    max30001_intrpt_Location_t en_rrint_loc, max30001_intrpt_Location_t en_samp_loc,
+		                      max30001_intrpt_type_t  intb_Type,           max30001_intrpt_type_t int2b_Type)
+
+
+{
+  // INT1
+
+  if (max30001_reg_read(EN_INT, &max30001_en_int.all) == -1) {
+    return -1;
+  }
+
+  // max30001_en_int2.bit.en_pint       = 0b1;  // Keep this off...
+
+  max30001_en_int.bit.en_eint = 0b1 & en_enint_loc;
+  max30001_en_int.bit.en_eovf = 0b1 & en_eovf_loc;
+  max30001_en_int.bit.en_fstint = 0b1 & en_fstint_loc;
+
+  max30001_en_int.bit.en_dcloffint = 0b1 & en_dcloffint_loc;
+  max30001_en_int.bit.en_bint = 0b1 & en_bint_loc;
+  max30001_en_int.bit.en_bovf = 0b1 & en_bovf_loc;
+
+  max30001_en_int.bit.en_bover = 0b1 & en_bover_loc;
+  max30001_en_int.bit.en_bundr = 0b1 & en_bundr_loc;
+  max30001_en_int.bit.en_bcgmon = 0b1 & en_bcgmon_loc;
+
+  max30001_en_int.bit.en_pint = 0b1 & en_pint_loc;
+  max30001_en_int.bit.en_povf = 0b1 & en_povf_loc;
+  max30001_en_int.bit.en_pedge = 0b1 & en_pedge_loc;
+
+  max30001_en_int.bit.en_lonint = 0b1 & en_lonint_loc;
+  max30001_en_int.bit.en_rrint = 0b1 & en_rrint_loc;
+  max30001_en_int.bit.en_samp = 0b1 & en_samp_loc;
+
+  max30001_en_int.bit.intb_type = int2b_Type;
+
+  if (max30001_reg_write(EN_INT, max30001_en_int.all) == -1) {
+    return -1;
+  }
+
+  // INT2
+
+  if (max30001_reg_read(EN_INT2, &max30001_en_int2.all) == -1) {
+    return -1;
+  }
+
+  max30001_en_int2.bit.en_eint   = 0b1 & (en_enint_loc >> 1);
+  max30001_en_int2.bit.en_eovf   = 0b1 & (en_eovf_loc >> 1);
+  max30001_en_int2.bit.en_fstint = 0b1 & (en_fstint_loc >> 1);
+
+  max30001_en_int2.bit.en_dcloffint = 0b1 & (en_dcloffint_loc >> 1);
+  max30001_en_int2.bit.en_bint      = 0b1 & (en_bint_loc >> 1);
+  max30001_en_int2.bit.en_bovf      = 0b1 & (en_bovf_loc >> 1);
+
+  max30001_en_int2.bit.en_bover  = 0b1 & (en_bover_loc >> 1);
+  max30001_en_int2.bit.en_bundr  = 0b1 & (en_bundr_loc >> 1);
+  max30001_en_int2.bit.en_bcgmon = 0b1 & (en_bcgmon_loc >> 1);
+
+  max30001_en_int2.bit.en_pint  = 0b1 & (en_pint_loc >> 1);
+  max30001_en_int2.bit.en_povf  = 0b1 & (en_povf_loc >> 1);
+  max30001_en_int2.bit.en_pedge = 0b1 & (en_pedge_loc >> 1);
+
+  max30001_en_int2.bit.en_lonint = 0b1 & (en_lonint_loc >> 1);
+  max30001_en_int2.bit.en_rrint  = 0b1 & (en_rrint_loc >> 1);
+  max30001_en_int2.bit.en_samp   = 0b1 & (en_samp_loc >> 1);
+
+  max30001_en_int2.bit.intb_type = intb_Type;
+
+  if (max30001_reg_write(EN_INT2, max30001_en_int2.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_ECG_InitStart(uint8_t En_ecg, uint8_t Openp,
+                                     uint8_t Openn, uint8_t Pol,
+                                     uint8_t Calp_sel, uint8_t Caln_sel,
+                                     uint8_t E_fit, uint8_t Rate, uint8_t Gain,
+                                     uint8_t Dhpf, uint8_t Dlpf) {
+
+  // CNFG_EMUX
+
+  if (max30001_reg_read(CNFG_EMUX, &max30001_cnfg_emux.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_emux.bit.openp    = Openp;
+  max30001_cnfg_emux.bit.openn    = Openn;
+  max30001_cnfg_emux.bit.pol      = Pol;
+  max30001_cnfg_emux.bit.calp_sel = Calp_sel;
+  max30001_cnfg_emux.bit.caln_sel = Caln_sel;
+
+  if (max30001_reg_write(CNFG_EMUX, max30001_cnfg_emux.all) == -1) {
+    return -1;
+  }
+
+  /**** ENABLE CHANNELS ****/
+  // CNFG_GEN
+
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_ecg = En_ecg; // 0b1
+
+  // fmstr is default
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  /**** Wait for PLL Lock & References to settle down ****/
+
+  max30001_timeout = 0;
+
+  do {
+    if (max30001_reg_read(STATUS, &max30001_status.all) == -1) // Wait and spin for PLL to lock...
+    {
+      return -1;
+    }
+  } while (max30001_status.bit.pllint == 1 && max30001_timeout++ <= 1000);
+
+  // MNGR_INT
+
+  if (max30001_reg_read(MNGR_INT, &max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  max30001_mngr_int.bit.e_fit = E_fit; // 31
+
+  if (max30001_reg_write(MNGR_INT, max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  // CNFG_ECG
+
+  if (max30001_reg_read(CNFG_ECG, &max30001_cnfg_ecg.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_ecg.bit.rate = Rate; 
+  max30001_cnfg_ecg.bit.gain = Gain;
+  max30001_cnfg_ecg.bit.dhpf = Dhpf;
+  max30001_cnfg_ecg.bit.dlpf = Dlpf;
+
+  if (max30001_reg_write(CNFG_ECG, max30001_cnfg_ecg.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_ECGFast_Init(uint8_t Clr_Fast, uint8_t Fast, uint8_t Fast_Th) {
+  if (max30001_reg_read(MNGR_INT, &max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  max30001_mngr_int.bit.clr_fast = Clr_Fast;
+
+  if (max30001_reg_write(MNGR_INT, max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  if (max30001_reg_read(MNGR_DYN, &max30001_mngr_dyn.all) == -1) {
+    return -1;
+  }
+
+  max30001_mngr_dyn.bit.fast = Fast;
+  max30001_mngr_dyn.bit.fast_th = Fast_Th;
+
+  if (max30001_reg_write(MNGR_INT, max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_Stop_ECG(void) {
+
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_ecg = 0; // Stop ECG
+
+  // fmstr is default
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_PACE_InitStart(uint8_t En_pace, uint8_t Clr_pedge,
+                                      uint8_t Pol, uint8_t Gn_diff_off,
+                                      uint8_t Gain, uint8_t Aout_lbw,
+                                      uint8_t Aout, uint8_t Dacp,
+                                      uint8_t Dacn) {
+
+  /**** SET MASTER FREQUENCY, ENABLE CHANNELS ****/
+
+  // CNFG_GEN
+
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_pace = En_pace; // 0b1;
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  /**** Wait for PLL Lock & References to settle down ****/
+  max30001_timeout = 0;
+
+  do {
+    if (max30001_reg_read(STATUS, &max30001_status.all) ==
+        -1) // Wait and spin for PLL to lock...
+    {
+      return -1;
+    }
+
+  } while (max30001_status.bit.pllint == 1 && max30001_timeout++ <= 1000);
+
+  // MNGR_INT
+
+  if (max30001_reg_read(MNGR_INT, &max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  max30001_mngr_int.bit.clr_pedge = Clr_pedge; // 0b0;
+
+  if (max30001_reg_write(MNGR_INT, max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  /* Put: CNFG_PACE */
+
+  max30001_reg_read(CNFG_PACE, &max30001_cnfg_pace.all);
+
+  max30001_cnfg_pace.bit.pol         = Pol;         
+  max30001_cnfg_pace.bit.gn_diff_off = Gn_diff_off;
+  max30001_cnfg_pace.bit.gain        = Gain;
+  max30001_cnfg_pace.bit.aout_lbw    = Aout_lbw;
+  max30001_cnfg_pace.bit.aout        = Aout;
+  max30001_cnfg_pace.bit.dacp        = Dacp;
+  max30001_cnfg_pace.bit.dacn        = Dacn;
+
+  max30001_reg_write(CNFG_PACE, max30001_cnfg_pace.all);
+
+  return 0;
+}
+//******************************************************************************
+int MAX30001::max30001_Stop_PACE(void) {
+
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_pace = 0; // Stop PACE
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_BIOZ_InitStart(
+    uint8_t En_bioz, uint8_t Openp, uint8_t Openn, uint8_t Calp_sel,
+    uint8_t Caln_sel, uint8_t CG_mode, uint8_t B_fit, uint8_t Rate,
+    uint8_t Ahpf, uint8_t Ext_rbias, uint8_t Gain, uint8_t Dhpf, uint8_t Dlpf,
+    uint8_t Fcgen, uint8_t Cgmon, uint8_t Cgmag, uint8_t Phoff) {
+
+  // CNFG_BMUX
+
+  if (max30001_reg_read(CNFG_BMUX, &max30001_cnfg_bmux.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_bmux.bit.openp    = Openp;       // 0b1;
+  max30001_cnfg_bmux.bit.openn    = Openn;       // 0b1;
+  max30001_cnfg_bmux.bit.calp_sel = Calp_sel; // 0b10;
+  max30001_cnfg_bmux.bit.caln_sel = Caln_sel; // 0b11;
+  max30001_cnfg_bmux.bit.cg_mode  = CG_mode;   // 0b00;
+
+  if (max30001_reg_write(CNFG_BMUX, max30001_cnfg_bmux.all) == -1) {
+    return -1;
+  }
+
+  /**** SET MASTER FREQUENCY, ENABLE CHANNELS ****/
+
+  // CNFG_GEN
+
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_bioz = En_bioz;
+
+  // fmstr is default
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  /**** Wait for PLL Lock & References to settle down ****/
+
+  max30001_timeout = 0;
+
+  do {
+    if (max30001_reg_read(STATUS, &max30001_status.all) ==
+        -1) // Wait and spin for PLL to lock...
+    {
+      return -1;
+    }
+
+  } while (max30001_status.bit.pllint == 1 && max30001_timeout++ <= 1000);
+
+  /**** Start of CNFG_BIOZ ****/
+
+  // MNGR_INT
+
+  if (max30001_reg_read(MNGR_INT, &max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  max30001_mngr_int.bit.b_fit = B_fit; //;
+
+  if (max30001_reg_write(MNGR_INT, max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  // CNFG_BIOZ
+
+  if (max30001_reg_read(CNFG_BIOZ, &max30001_cnfg_bioz.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_bioz.bit.rate      = Rate;
+  max30001_cnfg_bioz.bit.ahpf      = Ahpf;
+  max30001_cnfg_bioz.bit.ext_rbias = Ext_rbias;
+  max30001_cnfg_bioz.bit.gain      = Gain;
+  max30001_cnfg_bioz.bit.dhpf      = Dhpf;
+  max30001_cnfg_bioz.bit.dlpf      = Dlpf;
+  max30001_cnfg_bioz.bit.fcgen     = Fcgen;
+  max30001_cnfg_bioz.bit.cgmon     = Cgmon;
+  max30001_cnfg_bioz.bit.cgmag     = Cgmag;
+  max30001_cnfg_bioz.bit.phoff     = Phoff;
+
+  if (max30001_reg_write(CNFG_BIOZ, max30001_cnfg_bioz.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_Stop_BIOZ(void) {
+
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_bioz = 0; // Stop BIOZ
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_BIOZ_InitBist(uint8_t En_bist, uint8_t Rnom,
+                                     uint8_t Rmod, uint8_t Fbist) {
+
+  // CNFG_BMUX
+
+  if (max30001_reg_read(CNFG_BMUX, &max30001_cnfg_bmux.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_bmux.bit.en_bist = En_bist;
+  max30001_cnfg_bmux.bit.rnom = Rnom;
+  max30001_cnfg_bmux.bit.rmod = Rmod;
+  max30001_cnfg_bmux.bit.fbist = Fbist;
+
+  if (max30001_reg_write(CNFG_BMUX, max30001_cnfg_bmux.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+//******************************************************************************
+int MAX30001::max30001_RtoR_InitStart(uint8_t En_rtor, uint8_t Wndw,
+                                      uint8_t Gain, uint8_t Pavg, uint8_t Ptsf,
+                                      uint8_t Hoff, uint8_t Ravg, uint8_t Rhsf,
+                                      uint8_t Clr_rrint) {
+
+  // MNGR_INT
+
+  if (max30001_reg_read(MNGR_INT, &max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  max30001_mngr_int.bit.clr_rrint =
+      Clr_rrint; // 0b01 & 0b00 are for interrupt mode...
+  // 0b10 is for monitoring mode... it just overwrites the data...
+
+  if (max30001_reg_write(MNGR_INT, max30001_mngr_int.all) == -1) {
+    return -1;
+  }
+
+  // RTOR1
+  if (max30001_reg_read(CNFG_RTOR1, &max30001_cnfg_rtor1.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_rtor1.bit.wndw = Wndw;
+  max30001_cnfg_rtor1.bit.gain = Gain;
+  max30001_cnfg_rtor1.bit.en_rtor = En_rtor;
+  max30001_cnfg_rtor1.bit.pavg = Pavg;
+  max30001_cnfg_rtor1.bit.ptsf = Ptsf;
+
+  if (max30001_reg_write(CNFG_RTOR1, max30001_cnfg_rtor1.all) == -1) {
+    return -1;
+  }
+  // RTOR2
+
+  if (max30001_reg_read(CNFG_RTOR2, &max30001_cnfg_rtor2.all) == -1) {
+    return -1;
+  }
+  max30001_cnfg_rtor2.bit.hoff = Hoff;
+  max30001_cnfg_rtor2.bit.ravg = Ravg;
+  max30001_cnfg_rtor2.bit.rhsf = Rhsf;
+
+  if (max30001_reg_write(CNFG_RTOR2, max30001_cnfg_rtor2.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_Stop_RtoR(void) {
+
+  if (max30001_reg_read(CNFG_RTOR1, &max30001_cnfg_rtor1.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_rtor1.bit.en_rtor = 0; // Stop RtoR
+
+  if (max30001_reg_write(CNFG_RTOR1, max30001_cnfg_rtor1.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_PLL_lock(void) {
+  // Spin to see PLLint become zero to indicate a lock.
+
+  max30001_timeout = 0;
+
+  do {
+    if (max30001_reg_read(STATUS, &max30001_status.all) ==
+        -1) // Wait and spin for PLL to lock...
+    {
+      return -1;
+    }
+
+  } while (max30001_status.bit.pllint == 1 && max30001_timeout++ <= 1000);
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_sw_rst(void) {
+  // SW reset for the MAX30001 chip
+
+  if (max30001_reg_write(SW_RST, 0x000000) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_synch(void) { // For synchronization
+  if (max30001_reg_write(SYNCH, 0x000000) == -1) {
+    return -1;
+  }
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max300001_fifo_rst(void) { // Resets the FIFO
+  if (max30001_reg_write(FIFO_RST, 0x000000) == -1) {
+    return -1;
+  }
+  return 0;
+}
+
+//******************************************************************************
+// int MAX30001::max30001_reg_write(uint8_t addr, uint32_t data)
+int MAX30001::max30001_reg_write(MAX30001_REG_map_t addr, uint32_t data) {
+
+  uint8_t result[4];
+  uint8_t data_array[4];
+  int32_t success = 0;
+
+  data_array[0] = (addr << 1) & 0xff;
+
+  data_array[3] = data & 0xff;
+  data_array[2] = (data >> 8) & 0xff;
+  data_array[1] = (data >> 16) & 0xff;
+
+  success = SPI_Transmit(&data_array[0], 4, &result[0], 4);
+
+  if (success != 0) {
+    return -1;
+  } else {
+    return 0;
+  }
+}
+
+//******************************************************************************
+// int MAX30001::max30001_reg_read(uint8_t addr, uint32_t *return_data)
+int MAX30001::max30001_reg_read(MAX30001_REG_map_t addr,
+                                uint32_t *return_data) {
+  uint8_t result[4];
+  uint8_t data_array[1];
+  int32_t success = 0;
+
+  data_array[0] = ((addr << 1) & 0xff) | 1; // For Read, Or with 1
+  success = SPI_Transmit(&data_array[0], 1, &result[0], 4);
+  *return_data = /*result[0] + */ (uint32_t)(result[1] << 16) +
+                 (result[2] << 8) + result[3];
+  if (success != 0) {
+    return -1;
+  } else {
+    return 0;
+  }
+}
+
+//******************************************************************************
+int MAX30001::max30001_Enable_DcLeadOFF_Init(int8_t En_dcloff, int8_t Ipol,
+                                             int8_t Imag, int8_t Vth) {
+  //  the leads are not touching the body
+
+  // CNFG_EMUX, Set ECGP and ECGN for external hook up...
+
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_dcloff = En_dcloff;
+  max30001_cnfg_gen.bit.ipol = Ipol;
+  max30001_cnfg_gen.bit.imag = Imag;
+  max30001_cnfg_gen.bit.vth = Vth;
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_Disable_DcLeadOFF(void) {
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_dcloff = 0; // Turned off the dc lead off.
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_BIOZ_Enable_ACLeadOFF_Init(uint8_t En_bloff,
+                                                  uint8_t Bloff_hi_it,
+                                                  uint8_t Bloff_lo_it) {
+
+  // CNFG_GEN
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_bloff = En_bloff;
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  // MNGR_DYN
+  if (max30001_reg_read(MNGR_DYN, &max30001_mngr_dyn.all) == -1) {
+    return -1;
+  }
+
+  max30001_mngr_dyn.bit.bloff_hi_it = Bloff_hi_it;
+  max30001_mngr_dyn.bit.bloff_lo_it = Bloff_lo_it;
+
+  if (max30001_reg_write(MNGR_DYN, max30001_mngr_dyn.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_BIOZ_Disable_ACleadOFF(void) {
+  // CNFG_GEN
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_bloff = 0b0; // Turns of the BIOZ AC Lead OFF feature
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+
+//******************************************************************************
+int MAX30001::max30001_BIOZ_Enable_BCGMON(void) {
+  // CNFG_BIOZ
+  if (max30001_reg_read(CNFG_BIOZ, &max30001_cnfg_bioz.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_bioz.bit.cgmon = 1;
+
+  if (max30001_reg_write(CNFG_BIOZ, max30001_cnfg_bioz.all) == -1) {
+    return -1;
+  }
+
+  max30001_reg_read(CNFG_BIOZ, &max30001_cnfg_bioz.all);
+
+  return 0;
+}
+
+#if 1
+//******************************************************************************
+int MAX30001::max30001_Enable_LeadON(int8_t Channel) // Channel: ECG = 0b01, BIOZ = 0b10, Disable = 0b00
+{
+
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_ecg  = 0b0;
+  max30001_cnfg_gen.bit.en_bioz = 0b0;
+  max30001_cnfg_gen.bit.en_pace = 0b0;
+
+  max30001_cnfg_gen.bit.en_ulp_lon = Channel; // BIOZ ULP lead on detection...
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all);
+
+  max30001_reg_read(STATUS, &max30001_status.all);
+
+  return 0;
+}
+//******************************************************************************
+int MAX30001::max30001_Disable_LeadON(void) {
+
+  if (max30001_reg_read(CNFG_GEN, &max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  max30001_cnfg_gen.bit.en_ulp_lon = 0b0;
+
+  if (max30001_reg_write(CNFG_GEN, max30001_cnfg_gen.all) == -1) {
+    return -1;
+  }
+
+  return 0;
+}
+#endif
+//******************************************************************************
+#define LEADOFF_SERVICE_TIME 0x2000 // 0x1000 = 1 second
+#define LEADOFF_NUMSTATES 2
+uint32_t leadoffState = 0;
+uint32_t max30001_LeadOffoldTime = 0;
+void MAX30001::max30001_ServiceLeadoff(uint32_t currentTime) {
+
+  uint32_t delta_Time;
+
+  delta_Time = currentTime - max30001_LeadOffoldTime;
+
+  if (delta_Time > LEADOFF_SERVICE_TIME) {
+    switch (leadoffState) {
+    case 0: /* switch to ECG DC Lead OFF */
+      max30001_Enable_DcLeadOFF_Init(0b01, 0b0, 0b001, 0b00);
+      break;
+
+    case 1: /* switch to BIOZ DC Lead OFF */
+      max30001_Enable_DcLeadOFF_Init(0b10, 0b0, 0b001, 0b00);
+      break;
+    }
+
+    leadoffState++;
+    leadoffState %= LEADOFF_NUMSTATES;
+
+    max30001_LeadOffoldTime = currentTime;
+  }
+}
+//******************************************************************************
+#define LEADON_SERVICE_TIME 0x2000 // 0x1000 = 1 second
+#define LEADON_NUMSTATES 2
+uint32_t leadOnState = 0;
+uint32_t max30001_LeadOnoldTime = 0;
+void MAX30001::max30001_ServiceLeadON(uint32_t currentTime) {
+
+  uint32_t delta_Time;
+
+  delta_Time = currentTime - max30001_LeadOnoldTime;
+
+  if (delta_Time > LEADON_SERVICE_TIME) {
+    switch (leadOnState) {
+    case 0: /* switch to ECG DC Lead ON */
+      max30001_Enable_LeadON(0b01);
+      break;
+
+    case 1: /* switch to BIOZ DC Lead ON */
+      max30001_Enable_LeadON(0b10);
+      break;
+    }
+
+    leadOnState++;
+    leadOnState %= LEADON_NUMSTATES;
+
+    max30001_LeadOnoldTime = currentTime;
+  }
+}
+
+//******************************************************************************
+int MAX30001::max30001_FIFO_LeadONOff_Read(void) {
+
+  uint8_t result[32 * 3]; // 32words - 3bytes each
+
+  uint8_t data_array[4];
+  int32_t success = 0;
+  int i, j;
+
+  uint32_t total_databytes;
+  uint8_t i_index;
+  uint8_t data_chunk;
+  uint8_t loop_logic;
+
+  uint8_t etag, ptag, btag;
+
+  uint8_t adr;
+
+  int8_t ReadAllPaceOnce;
+
+  static uint8_t dcloffint_OneShot = 0;
+  static uint8_t acloffint_OneShot = 0;
+  static uint8_t bcgmon_OneShot = 0;
+  static uint8_t acleadon_OneShot = 0;
+
+  int8_t ret_val;
+
+  if (max30001_status.bit.eint == 1 || max30001_status.bit.pint == 1) {
+    adr = ECG_FIFO_BURST;
+    data_array[0] = ((adr << 1) & 0xff) | 1;
+
+    // The SPI routine only sends out data of 32 bytes in size.  Therefore the
+    // data is being read in
+    // smaller chunks in this routine...
+
+    total_databytes = (max30001_mngr_int.bit.e_fit + 1) * 3;
+
+    i_index = 0;
+    loop_logic = 1;
+
+    while (loop_logic) {
+      if (total_databytes > 30) {
+        data_chunk = 30;
+        total_databytes = total_databytes - 30;
+      } else {
+        data_chunk = total_databytes;
+        loop_logic = 0;
+      }
+
+      /* The extra 1 byte is for the extra byte that comes out of the SPI */
+      success = SPI_Transmit(&data_array[0], 1, &result[i_index], (data_chunk + 1)); // Make a copy of the FIFO over here...
+
+      if (success != 0) {
+        return -1;
+      }
+
+      /* This is important, because every transaction above creates an empty
+       * redundant data at result[0] */
+      for (j = i_index; j < (data_chunk + i_index); j++) /* get rid of the 1 extra byte by moving the whole array up one */
+      {
+        result[j] = result[j + 1];
+      }
+
+      i_index = i_index + 30; /* point to the next array location to put the data in */
+    }
+
+    ReadAllPaceOnce = 0;
+
+    /* Put the content of the FIFO based on the EFIT value, We ignore the
+     * result[0] and start concatenating indexes: 1,2,3 - 4,5,6 - 7,8,9 -  */
+    for (i = 0, j = 0; i < max30001_mngr_int.bit.e_fit + 1; i++, j = j + 3) // index1=23-16 bit, index2=15-8 bit, index3=7-0 bit
+    {
+      max30001_ECG_FIFO_buffer[i] = ((uint32_t)result[j] << 16) + (result[j + 1] << 8) + result[j + 2];
+
+      etag = (0b00111000 & result[j + 2]) >> 3;
+      ptag = 0b00000111 & result[j + 2];
+
+      if (ptag != 0b111 && ReadAllPaceOnce == 0) {
+
+        ReadAllPaceOnce = 1; // This will prevent extra read of PACE, once group
+                             // 0-5 is read ONCE.
+
+        adr = PACE0_FIFO_BURST;
+
+        data_array[0] = ((adr << 1) & 0xff) | 1; // For Read Or with 1
+
+        success = SPI_Transmit(&data_array[0], 1, &result[0], 10);
+
+        max30001_PACE[0] = (uint32_t)(result[1] << 16) + (result[2] << 8) + result[3];
+        max30001_PACE[1] = (uint32_t)(result[4] << 16) + (result[5] << 8) + result[6];
+        max30001_PACE[2] = (uint32_t)(result[7] << 16) + (result[8] << 8) + result[9];
+
+        adr = PACE1_FIFO_BURST;
+
+        data_array[0] = ((adr << 1) & 0xff) | 1; // For Read Or with 1
+
+        success = SPI_Transmit(&data_array[0], 1, &result[0], 10);
+
+        max30001_PACE[3] = (uint32_t)(result[1] << 16) + (result[2] << 8) + result[3];
+        max30001_PACE[4] = (uint32_t)(result[4] << 16) + (result[5] << 8) + result[6];
+        max30001_PACE[5] = (uint32_t)(result[7] << 16) + (result[8] << 8) + result[9];
+
+        adr = PACE2_FIFO_BURST;
+
+        data_array[0] = ((adr << 1) & 0xff) | 1; // For Read Or with 1
+
+        success = SPI_Transmit(&data_array[0], 1, &result[0], 10);
+
+        max30001_PACE[6] = (uint32_t)(result[1] << 16) + (result[2] << 8) + result[3];
+        max30001_PACE[7] = (uint32_t)(result[4] << 16) + (result[5] << 8) + result[6];
+        max30001_PACE[8] = (uint32_t)(result[7] << 16) + (result[8] << 8) + result[9];
+
+        adr = PACE3_FIFO_BURST;
+
+        data_array[0] = ((adr << 1) & 0xff) | 1; // For Read Or with 1
+
+        success = SPI_Transmit(&data_array[0], 1, &result[0], 10);
+
+        max30001_PACE[9]  = (uint32_t)(result[1] << 16) + (result[2] << 8) + result[3];
+        max30001_PACE[10] = (uint32_t)(result[4] << 16) + (result[5] << 8) + result[6];
+        max30001_PACE[11] = (uint32_t)(result[7] << 16) + (result[8] << 8) + result[9];
+
+        adr = PACE4_FIFO_BURST;
+
+        data_array[0] = ((adr << 1) & 0xff) | 1; // For Read Or with 1
+
+        success = SPI_Transmit(&data_array[0], 1, &result[0], 10);
+
+        max30001_PACE[12] = (uint32_t)(result[1] << 16) + (result[2] << 8) + result[3];
+        max30001_PACE[13] = (uint32_t)(result[4] << 16) + (result[5] << 8) + result[6];
+        max30001_PACE[14] = (uint32_t)(result[7] << 16) + (result[8] << 8) + result[9];
+
+        adr = PACE5_FIFO_BURST;
+
+        data_array[0] = ((adr << 1) & 0xff) | 1; // For Read Or with 1
+
+        success = SPI_Transmit(&data_array[0], 1, &result[0], 10);
+
+        max30001_PACE[15] = (uint32_t)(result[1] << 16) + (result[2] << 8) + result[3];
+        max30001_PACE[16] = (uint32_t)(result[4] << 16) + (result[5] << 8) + result[6];
+        max30001_PACE[17] = (uint32_t)(result[7] << 16) + (result[8] << 8) + result[9];
+
+        dataAvailable(MAX30001_DATA_PACE, max30001_PACE, 18); // Send out the Pace data once only
+      }
+    }
+
+    if (etag != 0b110) {
+
+      dataAvailable(MAX30001_DATA_ECG, max30001_ECG_FIFO_buffer, (max30001_mngr_int.bit.e_fit + 1));
+    }
+
+  } /* End of ECG init */
+
+  /* RtoR */
+
+  if (max30001_status.bit.rrint == 1) {
+    if (max30001_reg_read(RTOR, &max30001_RtoR_data) == -1) {
+      return -1;
+    }
+
+    max30001_RtoR_data = (0x00FFFFFF & max30001_RtoR_data) >> 10;
+
+    hspValMax30001.R2R = (uint16_t)max30001_RtoR_data;
+    hspValMax30001.fmstr = (uint16_t)max30001_cnfg_gen.bit.fmstr;
+
+    dataAvailable(MAX30001_DATA_RTOR, &max30001_RtoR_data, 1);
+  }
+
+  // Handling BIOZ data...
+
+  if (max30001_status.bit.bint == 1) {
+    adr = 0x22;
+    data_array[0] = ((adr << 1) & 0xff) | 1;
+
+    /* [(BFIT+1)*3byte]+1extra byte due to the addr */
+
+    if (SPI_Transmit(&data_array[0], 1, &result[0],((max30001_mngr_int.bit.b_fit + 1) * 3) + 1) == -1) // Make a copy of the FIFO over here...
+
+    {
+      return -1;
+    }
+
+    btag = 0b00000111 & result[3];
+
+    /* Put the content of the FIFO based on the BFIT value, We ignore the
+     * result[0] and start concatenating indexes: 1,2,3 - 4,5,6 - 7,8,9 -  */
+    for (i = 0, j = 0; i < max30001_mngr_int.bit.b_fit + 1; i++, j = j + 3) // index1=23-16 bit, index2=15-8 bit, index3=7-0 bit
+    {
+      max30001_BIOZ_FIFO_buffer[i] = ((uint32_t)result[j + 1] << 16) + (result[j + 2] << 8) + result[j + 3];
+    }
+
+    if (btag != 0b110) {
+      dataAvailable(MAX30001_DATA_BIOZ, max30001_BIOZ_FIFO_buffer, 8);
+    }
+  }
+
+  ret_val = 0;
+
+  if (max30001_status.bit.dcloffint == 1) // ECG/BIOZ Lead Off
+  {
+    dcloffint_OneShot = 1;
+    max30001_DCLeadOff = 0;
+    max30001_DCLeadOff = max30001_DCLeadOff | (max30001_cnfg_gen.bit.en_dcloff << 8) | (max30001_status.all & 0x00000F);
+    dataAvailable(MAX30001_DATA_LEADOFF_DC, &max30001_DCLeadOff, 1);
+    // Do a FIFO Reset
+    max30001_reg_write(FIFO_RST, 0x000000);
+
+    ret_val = 0b100;
+
+  } else if (dcloffint_OneShot == 1 && max30001_status.bit.dcloffint == 0) // Just send once when it comes out of dc lead off
+  {
+    max30001_DCLeadOff = 0;
+    max30001_DCLeadOff = max30001_DCLeadOff | (max30001_cnfg_gen.bit.en_dcloff << 8) | (max30001_status.all & 0x00000F);
+    dataAvailable(MAX30001_DATA_LEADOFF_DC, &max30001_DCLeadOff, 1);
+    dcloffint_OneShot = 0;
+  }
+
+  if (max30001_status.bit.bover == 1 || max30001_status.bit.bundr == 1) // BIOZ AC Lead Off
+  {
+    acloffint_OneShot = 1;
+    max30001_ACLeadOff = 0;
+    max30001_ACLeadOff =
+        max30001_ACLeadOff | ((max30001_status.all & 0x030000) >> 16);
+    dataAvailable(MAX30001_DATA_LEADOFF_AC, &max30001_ACLeadOff, 1);
+    // Do a FIFO Reset
+    max30001_reg_write(FIFO_RST, 0x000000);
+
+    ret_val = 0b1000;
+  } else if (acloffint_OneShot == 1 && max30001_status.bit.bover == 0 && max30001_status.bit.bundr == 0) // Just send once when it comes out of ac lead off
+  {
+    max30001_ACLeadOff = 0;
+    max30001_ACLeadOff = max30001_ACLeadOff | ((max30001_status.all & 0x030000) >> 16);
+    dataAvailable(MAX30001_DATA_LEADOFF_AC, &max30001_ACLeadOff, 1);
+    acloffint_OneShot = 0;
+  }
+
+  if (max30001_status.bit.bcgmon == 1) // BIOZ BCGMON check
+  {
+    bcgmon_OneShot = 1;
+    max30001_bcgmon = 0;
+    max30001_bcgmon = max30001_bcgmon | ((max30001_status.all & 0x000030) >> 4);
+    dataAvailable(MAX30001_DATA_BCGMON, &max30001_bcgmon, 1);
+    // Do a FIFO Reset
+    max30001_reg_write(FIFO_RST, 0x000000);
+
+    ret_val = 0b10000;
+  } else if (bcgmon_OneShot == 1 && max30001_status.bit.bcgmon == 0) {
+    max30001_bcgmon = 0;
+    max30001_bcgmon = max30001_bcgmon | ((max30001_status.all & 0x000030) >> 4);
+    bcgmon_OneShot = 0;
+    dataAvailable(MAX30001_DATA_BCGMON, &max30001_bcgmon, 1);
+  }
+
+#if 0
+if(max30001_status.bit.lonint == 1)   // AC LeadON Check
+{
+	max30001_LeadOn = 0;
+	max30001_reg_read(STATUS,&max30001_status.all);        // Reading is important
+	max30001_LeadOn = max30001_LeadOn | (max30001_cnfg_gen.bit.en_ulp_lon << 8) | ((max30001_status.all & 0x000800) >> 11);  // 0b01 will mean ECG Lead On, 0b10 will mean BIOZ Lead On
+    // LEAD ON has been detected... Now take actions
+}
+#endif
+
+  if (max30001_status.bit.lonint == 1 &&
+      acleadon_OneShot == 0) // AC LeadON Check, when lead is on
+  {
+    max30001_LeadOn = 0;
+    max30001_reg_read(STATUS, &max30001_status.all); // Reading is important
+    max30001_LeadOn =
+        max30001_LeadOn | (max30001_cnfg_gen.bit.en_ulp_lon << 8) |
+        ((max30001_status.all & 0x000800) >>
+         11); // 0b01 will mean ECG Lead On, 0b10 will mean BIOZ Lead On
+
+    // LEAD ON has been detected... Now take actions
+    acleadon_OneShot = 1;
+    dataAvailable(MAX30001_DATA_ACLEADON, &max30001_LeadOn, 1); // One shot data will be sent...
+  } else if (max30001_status.bit.lonint == 0 && acleadon_OneShot == 1) {
+    max30001_LeadOn = 0;
+    max30001_reg_read(STATUS, &max30001_status.all);
+    max30001_LeadOn =
+        max30001_LeadOn | (max30001_cnfg_gen.bit.en_ulp_lon << 8) | ((max30001_status.all & 0x000800) >> 11); // 0b01 will mean ECG Lead On, 0b10 will mean BIOZ Lead On
+    dataAvailable(MAX30001_DATA_ACLEADON, &max30001_LeadOn, 1); // One shot data will be sent...
+    acleadon_OneShot = 0;
+  }
+
+  return ret_val;
+}
+
+//******************************************************************************
+
+int MAX30001::max30001_int_handler(void) {
+
+  static uint32_t InitReset = 0;
+
+  int8_t return_value;
+
+  max30001_reg_read(STATUS, &max30001_status.all);
+
+  // Inital Reset and any FIFO over flow invokes a FIFO reset
+  if (InitReset == 0 || max30001_status.bit.eovf == 1 || max30001_status.bit.bovf == 1 || max30001_status.bit.povf == 1) {
+    // Do a FIFO Reset
+    max30001_reg_write(FIFO_RST, 0x000000);
+
+    InitReset++;
+    return 2;
+  }
+
+  return_value = 0;
+
+  // The four data handling goes on over here
+  if (max30001_status.bit.eint == 1 || max30001_status.bit.pint == 1 || max30001_status.bit.bint == 1 || max30001_status.bit.rrint == 1) {
+    return_value = return_value | max30001_FIFO_LeadONOff_Read();
+  }
+
+  // ECG/BIOZ DC Lead Off test
+  if (max30001_status.bit.dcloffint == 1) {
+    return_value = return_value | max30001_FIFO_LeadONOff_Read();
+  }
+
+  // BIOZ AC Lead Off test
+  if (max30001_status.bit.bover == 1 || max30001_status.bit.bundr == 1) {
+    return_value = return_value | max30001_FIFO_LeadONOff_Read();
+  }
+
+  // BIOZ DRVP/N test using BCGMON.
+  if (max30001_status.bit.bcgmon == 1) {
+    return_value = return_value | max30001_FIFO_LeadONOff_Read();
+  }
+
+  if (max30001_status.bit.lonint == 1) // ECG Lead ON test: i.e. the leads are touching the body...
+  {
+
+    max30001_FIFO_LeadONOff_Read();
+  }
+
+  return return_value;
+}
+
+/// function pointer to the async callback
+static event_callback_t functionpointer;
+/// flag used to indicate an async xfer has taken place
+static volatile int xferFlag = 0;
+
+/**
+* @brief Callback handler for SPI async events
+* @param events description of event that occurred
+*/
+static void spiHandler(int events) { xferFlag = 1; }
+
+/**
+* @brief Transmit and recieve QUAD SPI data
+* @param tx_buf pointer to transmit byte buffer
+* @param tx_size number of bytes to transmit
+* @param rx_buf pointer to the recieve buffer
+* @param rx_size number of bytes to recieve
+*/
+int MAX30001::SPI_Transmit(const uint8_t *tx_buf, uint32_t tx_size, uint8_t *rx_buf, uint32_t rx_size) {
+  xferFlag = 0;
+  int i;
+  for (i = 0; i < sizeof(buffer); i++) {
+    if (i < tx_size)
+      buffer[i] = tx_buf[i];
+    else
+      buffer[i] = 0xFF;
+  }
+  spi->transfer<uint8_t>(buffer, (int)rx_size, rx_buf, (int)rx_size, spiHandler /* functionpointer */);
+  while (xferFlag == 0);
+  return 0;
+}
+
+//******************************************************************************
+void MAX30001::max30001_ReadHeartrateData(max30001_t *_hspValMax30001) {
+  _hspValMax30001->R2R = hspValMax30001.R2R;
+  _hspValMax30001->fmstr = hspValMax30001.fmstr;
+}
+
+//******************************************************************************
+void MAX30001::onDataAvailable(PtrFunction _onDataAvailable) {
+  onDataAvailableCallback = _onDataAvailable;
+}
+
+/**
+* @brief Used to notify an external function that interrupt data is available
+* @param id type of data available
+* @param buffer 32-bit buffer that points to the data
+* @param length length of 32-bit elements available
+*/
+void MAX30001::dataAvailable(uint32_t id, uint32_t *buffer, uint32_t length) {
+  if (onDataAvailableCallback != NULL) {
+    (*onDataAvailableCallback)(id, buffer, length);
+  }
+}
+
+/**
+* @brief Callback handler for SPI async events
+* @param events description of event that occurred
+*/
+void MAX30001::spiHandler(int events) { xferFlag = 1; }
+
+//******************************************************************************
+static int allowInterrupts = 0;
+
+void MAX30001Mid_IntB_Handler(void) {
+  if (allowInterrupts == 0) return;
+  MAX30001::instance->max30001_int_handler();
+}
+
+void MAX30001Mid_Int2B_Handler(void) {
+  if (allowInterrupts == 0) return;
+  MAX30001::instance->max30001_int_handler();
+}
+
+void MAX30001_AllowInterrupts(int state) { 
+allowInterrupts = state; 
+}
diff -r 000000000000 -r af4d13000e95 MAX30001/MAX30001/MAX30001.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MAX30001/MAX30001/MAX30001.h	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,1076 @@
+/*******************************************************************************
+* Copyright (C) 2015 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.
+*******************************************************************************/
+/*
+ * max30001.h
+ *
+ *  Created on: Oct 9, 2015
+ *      Author: faisal.tariq
+ */
+
+#ifndef MAX30001_H_
+#define MAX30001_H_
+
+#include "mbed.h"
+
+#define mbed_COMPLIANT // Uncomment to Use timer for MAX30001 FCLK (for mbed)
+                       // Comment to use the RTC clock
+
+#define ASYNC_SPI_BUFFER_SIZE (32 * 3) // Maximimum buffer size for async byte transfers
+
+// Defines for data callbacks
+#define MAX30001_DATA_ECG        0x30
+#define MAX30001_DATA_PACE       0x31
+#define MAX30001_DATA_RTOR       0x32
+#define MAX30001_DATA_BIOZ       0x33
+#define MAX30001_DATA_LEADOFF_DC 0x34
+#define MAX30001_DATA_LEADOFF_AC 0x35
+#define MAX30001_DATA_BCGMON     0x36
+#define MAX30001_DATA_ACLEADON   0x37
+
+#define MAX30001_SPI_MASTER_PORT 0
+#define MAX30001_SPI_SS_INDEX    0
+
+#define MAX30001_INT_PORT_B      3
+#define MAX30001_INT_PIN_B       6
+
+#define MAX30001_INT_PORT_2B     4
+#define MAX30001_INT_PIN_2B      5
+
+#define MAX30001_INT_PORT_FCLK   1
+#define MAX30001_INT_PIN_FCLK    7
+
+#define MAX30001_FUNC_SEL_TMR    2 // 0=FW Control, 1= Pulse Train, 2=Timer
+
+#define MAX30001_INDEX    3
+#define MAX30001_POLARITY 0
+#define MAX30001_PERIOD   30518
+#define MAX30001_CYCLE    50
+
+#define MAX30001_IOMUX_IO_ENABLE 1
+
+#define MAX30001_SPI_PORT            0
+#define MAX30001_CS_PIN              0
+#define MAX30001_CS_POLARITY         0
+#define MAX30001_CS_ACTIVITY_DELAY   0
+#define MAX30001_CS_INACTIVITY_DELAY 0
+#define MAX30001_CLK_HI              1
+#define MAX30001_CLK_LOW             1
+#define MAX30001_ALT_CLK             0
+#define MAX30001_CLK_POLARITY        0
+#define MAX30001_CLK_PHASE           0
+#define MAX30001_WRITE               1
+#define MAX30001_READ                0
+
+#define MAX30001_INT_PORT_B  3
+#define MAX30001INT_PIN_B    6
+
+void MAX30001_AllowInterrupts(int state);
+
+/**
+* Maxim Integrated MAX30001 ECG/BIOZ chip
+*/
+class MAX30001 {
+
+public:
+  typedef enum { // MAX30001 Register addresses
+    STATUS     = 0x01,
+    EN_INT     = 0x02,
+    EN_INT2    = 0x03,
+    MNGR_INT   = 0x04,
+    MNGR_DYN   = 0x05,
+    SW_RST     = 0x08,
+    SYNCH      = 0x09,
+    FIFO_RST   = 0x0A,
+    INFO       = 0x0F,
+    CNFG_GEN   = 0x10,
+    CNFG_CAL   = 0x12,
+    CNFG_EMUX  = 0x14,
+    CNFG_ECG   = 0x15,
+    CNFG_BMUX  = 0x17,
+    CNFG_BIOZ  = 0x18,
+    CNFG_PACE  = 0x1A,
+    CNFG_RTOR1 = 0x1D,
+    CNFG_RTOR2 = 0x1E,
+
+    // Data locations
+    ECG_FIFO_BURST = 0x20,
+    ECG_FIFO       = 0x21,
+    FIFO_BURST     = 0x22,
+    BIOZ_FIFO      = 0x23,
+    RTOR           = 0x25,
+
+    PACE0_FIFO_BURST = 0x30,
+    PACE0_A          = 0x31,
+    PACE0_B          = 0x32,
+    PACE0_C          = 0x33,
+
+    PACE1_FIFO_BURST = 0x34,
+    PACE1_A          = 0x35,
+    PACE1_B          = 0x36,
+    PACE1_C          = 0x37,
+
+    PACE2_FIFO_BURST = 0x38,
+    PACE2_A          = 0x39,
+    PACE2_B          = 0x3A,
+    PACE2_C          = 0x3B,
+
+    PACE3_FIFO_BURST = 0x3C,
+    PACE3_A          = 0x3D,
+    PACE3_B          = 0x3E,
+    PACE3_C          = 0x3F,
+
+    PACE4_FIFO_BURST = 0x40,
+    PACE4_A          = 0x41,
+    PACE4_B          = 0x42,
+    PACE4_C          = 0x43,
+
+    PACE5_FIFO_BURST = 0x44,
+    PACE5_A          = 0x45,
+    PACE5_B          = 0x46,
+    PACE5_C          = 0x47,
+
+  } MAX30001_REG_map_t;
+
+  /**
+   * @brief STATUS (0x01) 
+   */
+  union max30001_status_reg {
+    uint32_t all;
+
+    struct {
+      uint32_t loff_nl : 1;
+      uint32_t loff_nh : 1;
+      uint32_t loff_pl : 1;
+      uint32_t loff_ph : 1;
+
+      uint32_t bcgmn     : 1;
+      uint32_t bcgmp     : 1;
+      uint32_t reserved1 : 1;
+      uint32_t reserved2 : 1;
+
+      uint32_t pllint : 1;
+      uint32_t samp   : 1;
+      uint32_t rrint  : 1;
+      uint32_t lonint : 1;
+
+      uint32_t pedge  : 1;
+      uint32_t povf   : 1;
+      uint32_t pint   : 1;
+      uint32_t bcgmon : 1;
+
+      uint32_t bundr : 1;
+      uint32_t bover : 1;
+      uint32_t bovf  : 1;
+      uint32_t bint  : 1;
+
+      uint32_t dcloffint : 1;
+      uint32_t fstint    : 1;
+      uint32_t eovf      : 1;
+      uint32_t eint      : 1;
+
+      uint32_t reserved : 8;
+
+    } bit;
+
+  } max30001_status;
+
+  
+  /**
+   * @brief EN_INT (0x02) 
+   */
+
+  union max30001_en_int_reg {
+    uint32_t all;
+
+    struct {
+      uint32_t intb_type : 2;
+      uint32_t reserved1 : 1;
+      uint32_t reserved2 : 1;
+
+      uint32_t reserved3 : 1;
+      uint32_t reserved4 : 1;
+      uint32_t reserved5 : 1;
+      uint32_t reserved6 : 1;
+
+      uint32_t en_pllint : 1;
+      uint32_t en_samp   : 1;
+      uint32_t en_rrint  : 1;
+      uint32_t en_lonint : 1;
+
+      uint32_t en_pedge  : 1;
+      uint32_t en_povf   : 1;
+      uint32_t en_pint   : 1;
+      uint32_t en_bcgmon : 1;
+
+      uint32_t en_bundr : 1;
+      uint32_t en_bover : 1;
+      uint32_t en_bovf  : 1;
+      uint32_t en_bint  : 1;
+
+      uint32_t en_dcloffint : 1;
+      uint32_t en_fstint    : 1;
+      uint32_t en_eovf      : 1;
+      uint32_t en_eint      : 1;
+
+      uint32_t reserved : 8;
+
+    } bit;
+
+  } max30001_en_int;
+
+  
+  /**
+   * @brief EN_INT2 (0x03) 
+   */  
+  union max30001_en_int2_reg {
+    uint32_t all;
+
+    struct {
+      uint32_t intb_type : 2;
+      uint32_t reserved1 : 1;
+      uint32_t reserved2 : 1;
+
+      uint32_t reserved3 : 1;
+      uint32_t reserved4 : 1;
+      uint32_t reserved5 : 1;
+      uint32_t reserved6 : 1;
+
+      uint32_t en_pllint : 1;
+      uint32_t en_samp   : 1;
+      uint32_t en_rrint  : 1;
+      uint32_t en_lonint : 1;
+
+      uint32_t en_pedge  : 1;
+      uint32_t en_povf   : 1;
+      uint32_t en_pint   : 1;
+      uint32_t en_bcgmon : 1;
+
+      uint32_t en_bundr  : 1;
+      uint32_t en_bover  : 1;
+      uint32_t en_bovf   : 1;
+      uint32_t en_bint   : 1;
+
+      uint32_t en_dcloffint : 1;
+      uint32_t en_fstint    : 1;
+      uint32_t en_eovf      : 1;
+      uint32_t en_eint      : 1;
+
+      uint32_t reserved : 8;
+
+    } bit;
+
+  } max30001_en_int2;
+
+  /**
+   * @brief MNGR_INT (0x04) 
+   */  
+  union max30001_mngr_int_reg {
+    uint32_t all;
+
+    struct {
+      uint32_t samp_it   : 2;
+      uint32_t clr_samp  : 1;
+      uint32_t clr_pedge : 1;
+      uint32_t clr_rrint : 2;
+      uint32_t clr_fast  : 1;
+      uint32_t reserved1 : 1;
+      uint32_t reserved2 : 4;
+      uint32_t reserved3 : 4;
+
+      uint32_t b_fit     : 3;
+      uint32_t e_fit     : 5;
+
+      uint32_t reserved : 8;
+
+    } bit;
+
+  } max30001_mngr_int;
+
+   /**
+   * @brief MNGR_DYN (0x05) 
+   */ 
+  union max30001_mngr_dyn_reg {
+    uint32_t all;
+
+    struct {
+      uint32_t bloff_lo_it : 8;
+      uint32_t bloff_hi_it : 8;
+      uint32_t fast_th     : 6;
+      uint32_t fast        : 2;
+      uint32_t reserved    : 8;
+    } bit;
+
+  } max30001_mngr_dyn;
+
+  // 0x08
+  // uint32_t max30001_sw_rst;
+
+  // 0x09
+  // uint32_t max30001_synch;
+
+  // 0x0A
+  // uint32_t max30001_fifo_rst;
+
+  
+   /**
+   * @brief INFO (0x0F) 
+   */
+  union max30001_info_reg {
+    uint32_t all;
+    struct {
+      uint32_t serial    : 12;
+      uint32_t part_id   : 2;
+      uint32_t sample    : 1;
+      uint32_t reserved1 : 1;
+      uint32_t rev_id    : 4;
+      uint32_t pattern   : 4;
+      uint32_t reserved  : 8;
+    } bit;
+
+  } max30001_info;
+
+   /**
+   * @brief CNFG_GEN (0x10) 
+   */
+  union max30001_cnfg_gen_reg {
+    uint32_t all;
+    struct {
+      uint32_t rbiasn     : 1;
+      uint32_t rbiasp     : 1;
+      uint32_t rbiasv     : 2;
+      uint32_t en_rbias   : 2;
+      uint32_t vth        : 2;
+      uint32_t imag       : 3;
+      uint32_t ipol       : 1;
+      uint32_t en_dcloff  : 2;
+      uint32_t en_bloff   : 2;
+      uint32_t reserved1  : 1;
+      uint32_t en_pace    : 1;
+      uint32_t en_bioz    : 1;
+      uint32_t en_ecg     : 1;
+      uint32_t fmstr      : 2;
+      uint32_t en_ulp_lon : 2;
+      uint32_t reserved : 8;
+    } bit;
+
+  } max30001_cnfg_gen;
+
+  
+   /**
+   * @brief CNFG_CAL (0x12) 
+   */  
+  union max30001_cnfg_cal_reg {
+    uint32_t all;
+    struct {
+      uint32_t thigh     : 11;
+      uint32_t fifty     : 1;
+      uint32_t fcal      : 3;
+      uint32_t reserved1 : 5;
+      uint32_t vmag      : 1;
+      uint32_t vmode     : 1;
+      uint32_t en_vcal   : 1;
+      uint32_t reserved2 : 1;
+      uint32_t reserved  : 8;
+    } bit;
+
+  } max30001_cnfg_cal;
+
+   /**
+   * @brief CNFG_EMUX  (0x14) 
+   */
+  union max30001_cnfg_emux_reg {
+    uint32_t all;
+    struct {
+      uint32_t reserved1 : 16;
+      uint32_t caln_sel  : 2;
+      uint32_t calp_sel  : 2;
+      uint32_t openn     : 1;
+      uint32_t openp     : 1;
+      uint32_t reserved2 : 1;
+      uint32_t pol       : 1;
+      uint32_t reserved : 8;
+    } bit;
+
+  } max30001_cnfg_emux;
+
+  
+   /**
+   * @brief CNFG_ECG   (0x15) 
+   */  
+  union max30001_cnfg_ecg_reg {
+    uint32_t all;
+    struct {
+      uint32_t reserved1 : 12;
+      uint32_t dlpf      : 2;
+      uint32_t dhpf      : 1;
+      uint32_t reserved2 : 1;
+      uint32_t gain      : 2;
+      uint32_t reserved3 : 4;
+      uint32_t rate      : 2;
+
+      uint32_t reserved  : 8;
+    } bit;
+
+  } max30001_cnfg_ecg;
+
+   /**
+   * @brief CNFG_BMUX   (0x17) 
+   */  
+  union max30001_cnfg_bmux_reg {
+    uint32_t all;
+    struct {
+      uint32_t fbist     : 2;
+      uint32_t reserved1 : 2;
+      uint32_t rmod      : 3;
+      uint32_t reserved2 : 1;
+      uint32_t rnom      : 3;
+      uint32_t en_bist   : 1;
+      uint32_t cg_mode   : 2;
+      uint32_t reserved3 : 2;
+      uint32_t caln_sel  : 2;
+      uint32_t calp_sel  : 2;
+      uint32_t openn     : 1;
+      uint32_t openp     : 1;
+      uint32_t reserved4 : 2;
+      uint32_t reserved : 8;
+    } bit;
+
+  } max30001_cnfg_bmux;
+
+   /**
+   * @brief CNFG_BIOZ   (0x18) 
+   */ 
+  union max30001_bioz_reg {
+    uint32_t all;
+    struct {
+      uint32_t phoff     : 4;
+      uint32_t cgmag     : 3;
+      uint32_t cgmon     : 1;
+      uint32_t fcgen     : 4;
+      uint32_t dlpf      : 2;
+      uint32_t dhpf      : 2;
+      uint32_t gain      : 2;
+      uint32_t reserved1 : 1;
+      uint32_t ext_rbias : 1;
+      uint32_t ahpf      : 3;
+      uint32_t rate      : 1;
+      uint32_t reserved : 8;
+    } bit;
+
+  } max30001_cnfg_bioz;
+
+  
+   /**
+   * @brief CNFG_PACE   (0x1A) 
+   */   
+  union max30001_cnfg_pace_reg {
+    uint32_t all;
+
+    struct {
+      uint32_t dacn        : 4;
+      uint32_t dacp        : 4;
+      uint32_t reserved1   : 4;
+      uint32_t aout        : 2;
+      uint32_t aout_lbw    : 1;
+      uint32_t reserved2   : 1;
+      uint32_t gain        : 3;
+      uint32_t gn_diff_off : 1;
+      uint32_t reserved3   : 3;
+      uint32_t pol         : 1;
+      uint32_t reserved    : 8;
+    } bit;
+
+  } max30001_cnfg_pace;
+
+   /**
+   * @brief CNFG_RTOR1   (0x1D) 
+   */   
+  union max30001_cnfg_rtor1_reg {
+    uint32_t all;
+    struct {
+      uint32_t reserved1 : 8;
+      uint32_t ptsf      : 4;
+      uint32_t pavg      : 2;
+      uint32_t reserved2 : 1;
+      uint32_t en_rtor   : 1;
+      uint32_t gain      : 4;
+      uint32_t wndw      : 4;
+      uint32_t reserved : 8;
+    } bit;
+
+  } max30001_cnfg_rtor1;
+
+   /**
+   * @brief CNFG_RTOR2 (0x1E) 
+   */   
+  union max30001_cnfg_rtor2_reg {
+    uint32_t all;
+    struct {
+      uint32_t reserved1 : 8;
+      uint32_t rhsf      : 3;
+      uint32_t reserved2 : 1;
+      uint32_t ravg      : 2;
+      uint32_t reserved3 : 2;
+      uint32_t hoff      : 6;
+      uint32_t reserved4 : 2;
+      uint32_t reserved : 8;
+    } bit;
+
+  } max30001_cnfg_rtor2;
+
+  /*********************************************************************************/
+
+  typedef enum {
+    MAX30001_NO_INT = 0, // No interrupt
+    MAX30001_INT_B  = 1,  // INTB selected for interrupt
+    MAX30001_INT_2B = 2  // INT2B selected for interrupt
+  } max30001_intrpt_Location_t;
+
+  typedef enum {
+    MAX30001_INT_DISABLED = 0b00,
+    MAX30001_INT_CMOS     = 0b01,
+    MAX30001_INT_ODN      = 0b10,
+    MAX30001_INT_ODNR     = 0b11
+  } max30001_intrpt_type_t;
+
+  typedef enum {          // Input Polarity selection
+    MAX30001_NON_INV = 0, // Non-Inverted
+    MAX30001_INV     = 1      // Inverted
+  } max30001_emux_pol;
+
+  typedef enum {              // OPENP and OPENN setting
+    MAX30001_ECG_CON_AFE = 0, // ECGx is connected to AFE channel
+    MAX30001_ECG_ISO_AFE = 1  // ECGx is isolated from AFE channel
+  } max30001_emux_openx;
+
+  typedef enum {                // EMUX_CALP_SEL & EMUX_CALN_SEL
+    MAX30001_NO_CAL_SIG = 0b00, // No calibration signal is applied
+    MAX30001_INPT_VMID  = 0b01,  // Input is connected to VMID
+    MAX30001_INPT_VCALP = 0b10, // Input is connected to VCALP
+    MAX30001_INPT_VCALN = 0b11  // Input is connected to VCALN
+  } max30001_emux_calx_sel;
+
+  typedef enum {                     // EN_ECG, EN_BIOZ, EN_PACE
+    MAX30001_CHANNEL_DISABLED = 0b0, //
+    MAX30001_CHANNEL_ENABLED = 0b1
+  } max30001_en_feature;
+
+  /*********************************************************************************/
+  // Data
+  uint32_t max30001_ECG_FIFO_buffer[32]; // (303 for internal test)
+  uint32_t max30001_BIOZ_FIFO_buffer[8]; // (303 for internal test)
+
+  uint32_t max30001_PACE[18]; // Pace Data 0-5
+
+  uint32_t max30001_RtoR_data; // This holds the RtoR data
+
+  uint32_t max30001_DCLeadOff; // This holds the LeadOff data, Last 4 bits give
+                               // the status, BIT3=LOFF_PH, BIT2=LOFF_PL,
+                               // BIT1=LOFF_NH, BIT0=LOFF_NL
+                               // 8th and 9th bits tell Lead off is due to ECG or BIOZ.  
+                               // 0b01 = ECG Lead Off and 0b10 = BIOZ Lead off
+
+  uint32_t max30001_ACLeadOff; // This gives the state of the BIOZ AC Lead Off
+                               // state.  BIT 1 = BOVER,   BIT 0 = BUNDR
+
+  uint32_t max30001_bcgmon; // This holds the BCGMON data, BIT 1 = BCGMP, BIT0 =
+                            // BCGMN
+
+  uint32_t max30001_LeadOn; // This holds the LeadOn data, BIT1 = BIOZ Lead ON,
+                            // BIT0 = ECG Lead ON, BIT8= Lead On Status Bit
+
+  uint32_t max30001_timeout; // If the PLL does not respond, timeout and get out.
+
+  typedef struct { // Creating a structure for BLE data
+    int16_t R2R;
+    int16_t fmstr;
+  } max30001_t;
+
+  max30001_t hspValMax30001; // R2R, FMSTR
+
+  /**
+  * @brief Constructor that accepts pin names for the SPI interface
+  * @param spi pointer to the mbed SPI object
+  */
+  MAX30001(SPI *spi);
+
+  /**
+  * @brief Constructor that accepts pin names for the SPI interface
+  * @param mosi master out slave in pin name
+  * @param miso master in slave out pin name
+  * @param sclk serial clock pin name
+  * @param cs chip select pin name
+  */
+  MAX30001(PinName mosi, PinName miso, PinName sclk, PinName cs);
+
+  /**
+   * MAX30001 destructor
+   */
+  ~MAX30001(void);
+
+  /**
+   * @brief This function sets up the Resistive Bias mode and also selects the master clock frequency.
+   * @brief Uses Register: CNFG_GEN-0x10
+   * @param En_rbias: Enable and Select Resitive Lead Bias Mode
+   * @param Rbiasv: Resistive Bias Mode Value Selection
+   * @param Rbiasp: Enables Resistive Bias on Positive Input
+   * @param Rbiasn: Enables Resistive Bias on Negative Input
+   * @param Fmstr: Selects Master Clock Frequency
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+  */
+  int max30001_Rbias_FMSTR_Init(uint8_t En_rbias, uint8_t Rbiasv,
+                                uint8_t Rbiasp, uint8_t Rbiasn, uint8_t Fmstr);
+
+  /**
+   * @brief This function uses sets up the calibration signal internally.  If it is desired to use the internal signal, then
+   * @brief this function must be called and the registers set, prior to setting the CALP_SEL and CALN_SEL in the ECG_InitStart
+   * @brief and BIOZ_InitStart functions.
+   * @brief Uses Register: CNFG_CAL-0x12
+   * @param En_Vcal: Calibration Source (VCALP and VCALN) Enable
+   * @param Vmode:   Calibration Source Mode Selection
+   * @param Vmag:    Calibration Source Magnitude Selection (VMAG)
+   * @param Fcal:    Calibration Source Frequency Selection (FCAL)
+   * @param Thigh:   Calibration Source Time High Selection
+   * @param Fifty:   Calibration Source Duty Cycle Mode Selection
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_CAL_InitStart(uint8_t En_Vcal, uint8_t Vmode, uint8_t Vmag,
+                             uint8_t Fcal, uint16_t Thigh, uint8_t Fifty);
+
+  /**
+   * @brief This function disables the VCAL signal
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   */
+  int max30001_CAL_Stop(void);
+
+  /**
+   * @brief This function handles the assignment of the two interrupt pins (INTB & INT2B) with various
+   * @brief functions/behaviors  of the MAX30001.  Also, each pin can be configured for different drive capability.
+   * @brief Uses Registers: EN_INT-0x02 and EN_INT2-0x03.
+   * @param max30001_intrpt_Locatio_t  <argument>:  All the arguments with the aforementioned enumeration essentially
+   *        can be configured to generate an interrupt on either INTB or INT2B or NONE.
+   * @param max30001_intrpt_type_t  intb_Type:  INTB Port Type (EN_INT Selections).
+   * @param max30001_intrpt_type _t int2b_Type:   INT2B Port Type (EN_INT2 Selections)
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+     int max30001_INT_assignment(max30001_intrpt_Location_t en_enint_loc,     max30001_intrpt_Location_t en_eovf_loc,  max30001_intrpt_Location_t en_fstint_loc,
+		                 max30001_intrpt_Location_t en_dcloffint_loc, max30001_intrpt_Location_t en_bint_loc,  max30001_intrpt_Location_t en_bovf_loc,
+		                 max30001_intrpt_Location_t en_bover_loc,     max30001_intrpt_Location_t en_bundr_loc, max30001_intrpt_Location_t en_bcgmon_loc,
+		                 max30001_intrpt_Location_t en_pint_loc,      max30001_intrpt_Location_t en_povf_loc,  max30001_intrpt_Location_t en_pedge_loc,
+		                 max30001_intrpt_Location_t en_lonint_loc,    max30001_intrpt_Location_t en_rrint_loc, max30001_intrpt_Location_t en_samp_loc,
+		                 max30001_intrpt_type_t  intb_Type,           max30001_intrpt_type_t int2b_Type);
+
+
+
+  /**
+   * @brief For MAX30001/3 ONLY
+   * @brief This function sets up the MAX30001 for the ECG measurements.
+   * @brief Registers used:  CNFG_EMUX, CNFG_GEN, MNGR_INT, CNFG_ECG.
+   * @param En_ecg: ECG Channel Enable <CNFG_GEN register bits>
+   * @param Openp: Open the ECGN Input Switch (most often used for testing and calibration studies) <CNFG_EMUX register bits>
+   * @param Openn: Open the ECGN Input Switch (most often used for testing and calibration studies) <CNFG_EMUX register bits>
+   * @param Calp_sel: ECGP Calibration Selection <CNFG_EMUX register bits>
+   * @param Caln_sel: ECGN Calibration Selection <CNFG_EMUX register bits>
+   * @param E_fit: ECG FIFO Interrupt Threshold (issues EINT based on number of unread FIFO records) <CNFG_GEN register bits>
+   * @param Clr_rrint: RTOR R Detect Interrupt (RRINT) Clear Behavior <CNFG_GEN register bits>
+   * @param Rate: ECG Data Rate
+   * @param Gain: ECG Channel Gain Setting
+   * @param Dhpf: ECG Channel Digital High Pass Filter Cutoff Frequency
+   * @param Dlpf:  ECG Channel Digital Low Pass Filter Cutoff Frequency
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_ECG_InitStart(uint8_t En_ecg, uint8_t Openp, uint8_t Openn,
+                             uint8_t Pol, uint8_t Calp_sel, uint8_t Caln_sel,
+                             uint8_t E_fit, uint8_t Rate, uint8_t Gain,
+                             uint8_t Dhpf, uint8_t Dlpf);
+
+  /**
+   * @brief For MAX30001/3 ONLY
+   * @brief This function enables the Fast mode feature of the ECG.
+   * @brief Registers used: MNGR_INT-0x04, MNGR_DYN-0x05
+   * @param Clr_Fast: FAST MODE Interrupt Clear Behavior <MNGR_INT Register>
+   * @param Fast: ECG Channel Fast Recovery Mode Selection (ECG High Pass Filter Bypass) <MNGR_DYN Register>
+   * @param Fast_Th: Automatic Fast Recovery Threshold
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_ECGFast_Init(uint8_t Clr_Fast, uint8_t Fast, uint8_t Fast_Th);
+
+  /**
+  * @brief For MAX30001/3 ONLY
+  * @brief This function disables the ECG.
+  * @brief Uses Register CNFG_GEN-0x10.
+  * @returns 0-if no error.  A non-zero value indicates an error.
+  *
+  */
+  int max30001_Stop_ECG(void);
+
+  /**
+   *  @brief For MAX30001 ONLY
+   *  @brief This function sets up the MAX30001 for pace signal detection.
+   *  @brief If both PACE and BIOZ are turned ON, then make sure Fcgen is set for 80K or 40K in the
+   *  @brief max30001_BIOZ_InitStart() function.  However, if Only PACE is on but BIOZ off, then Fcgen can be set
+   *  @brief for 80K only, in the max30001_BIOZ_InitStart() function
+   *  @brief Registers used: MNGR_INT-0x04, CNFG_GEN-0x37, CNFG_PACE-0x1A.
+   *  @param En_pace : PACE Channel Enable <CNFG_GEN Register>
+   *  @param Clr_pedge : PACE Edge Detect Interrupt (PEDGE) Clear Behavior <MNGR_INT Register>
+   *  @param Pol: PACE Input Polarity Selection <CNFG_PACE Register>
+   *  @param Gn_diff_off: PACE Differentiator Mode <CNFG_PACE Register>
+   *  @param Gain: PACE Channel Gain Selection <CNFG_PACE Register>
+   *  @param Aout_lbw:  PACE Analog Output Buffer Bandwidth Mode <CNFG_PACE Register>
+   *  @param Aout: PACE Single Ended Analog Output Buffer Signal Monitoring Selection <CNFG_PACE Register>
+   *  @param Dacp (4bits): PACE Detector Positive Comparator Threshold <CNFG_PACE Register>
+   *  @param Dacn(4bits): PACE Detector Negative Comparator Threshold <CNFG_PACE Register>
+   *  @returns 0-if no error.  A non-zero value indicates an error <CNFG_PACE Register>
+   *
+   */
+  int max30001_PACE_InitStart(uint8_t En_pace, uint8_t Clr_pedge, uint8_t Pol,
+                              uint8_t Gn_diff_off, uint8_t Gain,
+                              uint8_t Aout_lbw, uint8_t Aout, uint8_t Dacp,
+                              uint8_t Dacn);
+
+  /**
+   *@brief For MAX30001 ONLY
+   *@param This function disables the PACE.  Uses Register CNFG_GEN-0x10.
+   *@returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_Stop_PACE(void);
+
+  /**
+   * @brief For MAX30001/2 ONLY
+   * @brief This function sets up the MAX30001 for BIOZ measurement.
+   * @brief Registers used: MNGR_INT-0x04, CNFG_GEN-0X10, CNFG_BMUX-0x17,CNFG_BIOZ-0x18.
+   * @param En_bioz: BIOZ Channel Enable <CNFG_GEN Register>
+   * @param Openp: Open the BIP Input Switch <CNFG_BMUX Register>
+   * @param Openn: Open the BIN Input Switch <CNFG_BMUX Register>
+   * @param Calp_sel: BIP Calibration Selection <CNFG_BMUX Register>
+   * @param Caln_sel: BIN Calibration Selection <CNFG_BMUX Register>
+   * @param CG_mode:  BIOZ Current Generator Mode Selection <CNFG_BMUX Register>
+   * @param B_fit:  BIOZ FIFO Interrupt Threshold (issues BINT based on number of unread FIFO records) <MNGR_INT Register>
+   * @param Rate: BIOZ Data Rate <CNFG_BIOZ Register>
+   * @param Ahpf: BIOZ/PACE Channel Analog High Pass Filter Cutoff Frequency and Bypass <CNFG_BIOZ Register>
+   * @param Ext_rbias:  External Resistor Bias Enable <CNFG_BIOZ Register>
+   * @param Gain: BIOZ Channel Gain Setting <CNFG_BIOZ Register>
+   * @param Dhpf: BIOZ Channel Digital High Pass Filter Cutoff Frequency <CNFG_BIOZ Register>
+   * @param Dlpf:  BIOZ Channel Digital Low Pass Filter Cutoff Frequency <CNFG_BIOZ Register>
+   * @param Fcgen:  BIOZ Current Generator Modulation Frequency <CNFG_BIOZ Register>
+   * @param Cgmon:  BIOZ Current Generator Monitor <CNFG_BIOZ Register>
+   * @param Cgmag:  BIOZ Current Generator Magnitude <CNFG_BIOZ Register>
+   * @param Phoff: BIOZ Current Generator Modulation Phase Offset <CNFG_BIOZ Register>
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_BIOZ_InitStart(uint8_t En_bioz, uint8_t Openp, uint8_t Openn,
+                              uint8_t Calp_sel, uint8_t Caln_sel,
+                              uint8_t CG_mode,
+                              /* uint8_t En_bioz,*/ uint8_t B_fit, uint8_t Rate,
+                              uint8_t Ahpf, uint8_t Ext_rbias, uint8_t Gain,
+                              uint8_t Dhpf, uint8_t Dlpf, uint8_t Fcgen,
+                              uint8_t Cgmon, uint8_t Cgmag, uint8_t Phoff);
+
+  /**
+   * @brief For MAX30001/2 ONLY
+   * @brief This function disables the BIOZ.  Uses Register CNFG_GEN-0x10.
+   * @returns 0-if no error.  A non-zero value indicates an error.
+       * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_Stop_BIOZ(void);
+
+  /**
+   * @brief For MAX30001/2 ONLY
+   * @brief BIOZ modulated Resistance Built-in-Self-Test, Registers used: CNFG_BMUX-0x17
+   * @param En_bist: Enable Modulated Resistance Built-in-Self-test <CNFG_BMUX Register>
+   * @param Rnom: BIOZ RMOD BIST Nominal Resistance Selection <CNFG_BMUX Register>
+   * @param Rmod: BIOZ RMOD BIST Modulated Resistance Selection <CNFG_BMUX Register>
+   * @param Fbist: BIOZ RMOD BIST Frequency Selection <CNFG_BMUX Register>
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_BIOZ_InitBist(uint8_t En_bist, uint8_t Rnom, uint8_t Rmod,
+                             uint8_t Fbist);
+
+  /**
+   * @brief For MAX30001/3/4 ONLY
+   * @brief Sets up the device for RtoR measurement
+   * @param EN_rtor: ECG RTOR Detection Enable <RTOR1 Register>
+   * @param Wndw: R to R Window Averaging (Window Width = RTOR_WNDW[3:0]*8mS) <RTOR1 Register>
+   * @param Gain: R to R Gain (where Gain = 2^RTOR_GAIN[3:0], plus an auto-scale option) <RTOR1 Register>
+   * @param Pavg: R to R Peak Averaging Weight Factor <RTOR1 Register>
+   * @param Ptsf: R to R Peak Threshold Scaling Factor <RTOR1 Register>
+   * @param Hoff: R to R minimum Hold Off <RTOR2 Register>
+   * @param Ravg: R to R Interval Averaging Weight Factor <RTOR2 Register>
+   * @param Rhsf: R to R Interval Hold Off Scaling Factor <RTOR2 Register>
+   * @param Clr_rrint: RTOR Detect Interrupt Clear behaviour <MNGR_INT Register>
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_RtoR_InitStart(uint8_t En_rtor, uint8_t Wndw, uint8_t Gain,
+                              uint8_t Pavg, uint8_t Ptsf, uint8_t Hoff,
+                              uint8_t Ravg, uint8_t Rhsf, uint8_t Clr_rrint);
+
+  /**
+   * @brief For MAX30001/3/4 ONLY
+   * @brief This function disables the RtoR.  Uses Register CNFG_RTOR1-0x1D
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_Stop_RtoR(void);
+
+  /**
+   * @brief This is a function that waits for the PLL to lock; once a lock is achieved it exits out. (For convenience only)
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_PLL_lock(void);
+
+  /**
+   * @brief This function causes the MAX30001 to reset.  Uses Register SW_RST-0x08
+   * @return 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_sw_rst(void);
+
+  /**
+   * @brief This function provides a SYNCH operation.  Uses Register SYCNH-0x09. Please refer to the data sheet for
+   * @brief the details on how to use this.
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_synch(void);
+
+  /**
+   * @brief This function performs a FIFO Reset.  Uses Register FIFO_RST-0x0A. Please refer to the data sheet
+   * @brief for the details on how to use this.
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   */
+  int max300001_fifo_rst(void);
+
+  /**
+   *
+   * @brief This is a callback function which collects all the data from the ECG, BIOZ, PACE and RtoR. It also handles
+   * @brief Lead On/Off.  This  function is passed through the argument of max30001_COMMinit().
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_int_handler(void);
+
+  /**
+   * @brief This is function called from the max30001_int_handler() function and processes all the ECG, BIOZ, PACE
+   * @brief and the RtoR data and sticks them in appropriate arrays and variables each unsigned 32 bits.
+   * @param ECG data will be in the array (input): max30001_ECG_FIFO_buffer[]
+   * @param Pace data will be in the array (input): max30001_PACE[]
+   * @param RtoRdata will be in the variable (input): max30001_RtoR_data
+   * @param BIOZ data will be in the array (input): max30001_BIOZ_FIFO_buffer[]
+   * @param global  max30001_ECG_FIFO_buffer[]
+   * @param global  max30001_PACE[]
+   * @param global  max30001_BIOZ_FIFO_buffer[]
+   * @param global  max30001_RtoR_data
+   * @param global  max30001_DCLeadOff
+   * @param global  max30001_ACLeadOff
+   * @param global  max30001_LeadON
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_FIFO_LeadONOff_Read(void);
+
+  /**
+   * @brief This function allows writing to a register.
+   * @param addr:  Address of the register to write to
+   * @param data:  24-bit data read from the register.
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_reg_write(MAX30001_REG_map_t addr, uint32_t data);
+
+  /**
+   * @brief This function allows reading from a register
+   * @param addr:   Address of the register to read from.
+   * @param *return_data: pointer to the value read from the register.
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_reg_read(MAX30001_REG_map_t addr, uint32_t *return_data);
+
+  /**
+   * @brief This function enables the DC Lead Off detection. Either ECG or BIOZ can be detected, one at a time.
+   * @brief Registers Used:  CNFG_GEN-0x10
+   * @param En_dcloff: BIOZ Digital Lead Off Detection Enable
+   * @param Ipol: DC Lead Off Current Polarity (if current sources are enabled/connected)
+   * @param Imag: DC Lead off current Magnitude Selection
+   * @param Vth: DC Lead Off Voltage Threshold Selection
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_Enable_DcLeadOFF_Init(int8_t En_dcloff, int8_t Ipol, int8_t Imag,
+                                     int8_t Vth);
+
+  /**
+   * @brief This function disables the DC Lead OFF feature, whichever is active.
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_Disable_DcLeadOFF(void);
+
+  /**
+   * @brief This function sets up the BIOZ for AC Lead Off test.
+   * @brief Registers Used:  CNFG_GEN-0x10, MNGR_DYN-0x05
+   * @param En_bloff: BIOZ Digital Lead Off Detection Enable <CNFG_GEN register>
+   * @param Bloff_hi_it:      DC Lead Off Current Polarity (if current sources are enabled/connected) <MNGR_DYN register>
+   * @param Bloff_lo_it:      DC Lead off current Magnitude Selection <MNGR_DYN register>
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_BIOZ_Enable_ACLeadOFF_Init(uint8_t En_bloff, uint8_t Bloff_hi_it,
+                                          uint8_t Bloff_lo_it);
+
+  /**
+   * @brief This function Turns of the BIOZ AC Lead OFF feature
+   * @brief Registers Used:  CNFG_GEN-0x10
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_BIOZ_Disable_ACleadOFF(void);
+
+  /**
+   * @brief This function enables the Current Gnerator Monitor
+   * @brief Registers Used:  CNFG_BIOZ-0x18
+   * @returns 0-if no error.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_BIOZ_Enable_BCGMON(void);
+
+  /**
+   *
+   * @brief This function enables the Lead ON detection. Either ECG or BIOZ can be detected, one at a time.
+   * @brief Also, the en_bioz, en_ecg, en_pace setting is saved so that when this feature is disabled through the
+   * @brief max30001_Disable_LeadON() function (or otherwise) the enable/disable state of those features can be retrieved.
+   * @param Channel: ECG or BIOZ detection
+   * @returns 0-if everything is good.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_Enable_LeadON(int8_t Channel);
+
+  /**
+   * @brief This function turns off the Lead ON feature, whichever one is active.  Also, retrieves the en_bioz,
+   * @brief en_ecg, en_pace and sets it back to as it was.
+   * @param 0-if everything is good.  A non-zero value indicates an error.
+   *
+   */
+  int max30001_Disable_LeadON(void);
+
+  /**
+   *
+   * @brief This function is toggled every 2 seconds to switch between ECG Lead ON and BIOZ Lead ON detect
+   * @brief Adjust LEADOFF_SERVICE_TIME to determine the duration between the toggles.
+   * @param CurrentTime - This gets fed the time by RTC_GetValue function
+   *
+   */
+  void max30001_ServiceLeadON(uint32_t currentTime);
+
+  /**
+   *
+   * @brief This function is toggled every 2 seconds to switch between ECG DC Lead Off and BIOZ DC Lead Off
+   * @brief Adjust LEADOFF_SERVICE_TIME to determine the duration between the toggles.
+   * @param CurrentTime - This gets fed the time by RTC_GetValue function
+   *
+   */
+  void max30001_ServiceLeadoff(uint32_t currentTime);
+
+  /**
+   *
+   * @brief This function sets current RtoR values and fmstr values in a pointer structure
+   * @param hspValMax30001 - Pointer to a structure where to store the values
+   *
+   */
+  void max30001_ReadHeartrateData(max30001_t *_hspValMax30001);
+
+  /**
+   * @brief type definition for data interrupt
+   */
+  typedef void (*PtrFunction)(uint32_t id, uint32_t *buffer, uint32_t length);
+
+  /**
+   * @brief Used to connect a callback for when interrupt data is available
+   */
+  void onDataAvailable(PtrFunction _onDataAvailable);
+
+  static MAX30001 *instance;
+
+private:
+  void dataAvailable(uint32_t id, uint32_t *buffer, uint32_t length);
+  /// interrupt handler for async spi events
+  static void spiHandler(int events);
+  /// wrapper method to transmit and recieve SPI data
+  int SPI_Transmit(const uint8_t *tx_buf, uint32_t tx_size, uint8_t *rx_buf,
+                   uint32_t rx_size);
+
+  /// pointer to mbed SPI object
+  SPI *spi;
+  /// is this object the owner of the spi object
+  bool spi_owner;
+  /// buffer to use for async transfers
+  uint8_t buffer[ASYNC_SPI_BUFFER_SIZE];
+  /// function pointer to the async callback
+  event_callback_t functionpointer;
+  /// callback function when interrupt data is available
+  PtrFunction onDataAvailableCallback;
+
+}; // End of MAX30001 Class
+
+/**
+ * @brief Preventive measure used to dismiss interrupts that fire too early during
+ * @brief initialization on INTB line
+ *
+ */
+void MAX30001Mid_IntB_Handler(void);
+
+/**
+ * @brief Preventive measure used to dismiss interrupts that fire too early during
+ * @brief initialization on INT2B line
+ *
+ */
+void MAX30001Mid_Int2B_Handler(void);
+
+/**
+ * @brief Allows Interrupts to be accepted as valid.
+ * @param state: 1-Allow interrupts, Any-Don't allow interrupts.
+ *
+ */
+void MAX30001_AllowInterrupts(int state);
+
+#endif /* MAX30001_H_ */
diff -r 000000000000 -r af4d13000e95 MAX30102/MAX30102.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MAX30102/MAX30102.cpp	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,258 @@
+/** \file max30102.cpp ******************************************************
+*
+* Project: MAXREFDES117#
+* Filename: max30102.cpp
+* Description: This module is an embedded controller driver for the MAX30102
+*
+*
+* --------------------------------------------------------------------
+*
+* This code follows the following naming conventions:
+*
+* char              ch_pmod_value
+* char (array)      s_pmod_s_string[16]
+* float             f_pmod_value
+* int32_t           n_pmod_value
+* int32_t (array)   an_pmod_value[16]
+* int16_t           w_pmod_value
+* int16_t (array)   aw_pmod_value[16]
+* uint16_t          uw_pmod_value
+* uint16_t (array)  auw_pmod_value[16]
+* uint8_t           uch_pmod_value
+* uint8_t (array)   auch_pmod_buffer[16]
+* uint32_t          un_pmod_value
+* int32_t *         pn_pmod_value
+*
+* ------------------------------------------------------------------------- */
+/*******************************************************************************
+* Copyright (C) 2016 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"
+#include "MAX30102.h"
+
+#ifdef TARGET_MAX32600MBED
+I2C i2c(I2C1_SDA, I2C1_SCL);
+#else
+I2C i2c(I2C2_SDA, I2C2_SCL);
+#endif
+
+bool maxim_max30102_write_reg(uint8_t uch_addr, uint8_t uch_data)
+/**
+* \brief        Write a value to a MAX30102 register
+* \par          Details
+*               This function writes a value to a MAX30102 register
+*
+* \param[in]    uch_addr    - register address
+* \param[in]    uch_data    - register data
+*
+* \retval       true on success
+*/
+{
+  char ach_i2c_data[2];
+  ach_i2c_data[0]=uch_addr;
+  ach_i2c_data[1]=uch_data;
+  
+  if(i2c.write(I2C_WRITE_ADDR, ach_i2c_data, 2, false)==0)
+    return true;
+  else
+    return false;
+}
+
+bool maxim_max30102_read_reg(uint8_t uch_addr, uint8_t *puch_data)
+/**
+* \brief        Read a MAX30102 register
+* \par          Details
+*               This function reads a MAX30102 register
+*
+* \param[in]    uch_addr    - register address
+* \param[out]   puch_data    - pointer that stores the register data
+*
+* \retval       true on success
+*/
+{
+  char ch_i2c_data;
+  ch_i2c_data=uch_addr;
+  if(i2c.write(I2C_WRITE_ADDR, &ch_i2c_data, 1, true)!=0)
+    return false;
+  if(i2c.read(I2C_READ_ADDR, &ch_i2c_data, 1, false)==0)
+  {
+    *puch_data=(uint8_t) ch_i2c_data;
+    return true;
+  }
+  else
+    return false;
+}
+bool maxim_max30102_soft_init()
+  /**
+  * \brief        Initialize the MAX30102
+  * \par          Details
+  *               This function initializes the MAX30102
+  *
+  * \param        None
+  *
+  * \retval       true on success
+  */
+{
+  if(!maxim_max30102_write_reg(REG_INTR_ENABLE_1,0xC0)) // INTR setting
+    return false;
+  if(!maxim_max30102_write_reg(REG_INTR_ENABLE_2,0x00))
+    return false;
+  if(!maxim_max30102_write_reg(REG_FIFO_WR_PTR,0x00))  //FIFO_WR_PTR[4:0]
+    return false;
+  if(!maxim_max30102_write_reg(REG_OVF_COUNTER,0x00))  //OVF_COUNTER[4:0]
+    return false;
+  if(!maxim_max30102_write_reg(REG_FIFO_RD_PTR,0x00))  //FIFO_RD_PTR[4:0]
+    return false;
+  if(!maxim_max30102_write_reg(REG_FIFO_CONFIG,0x0f))  //sample avg = 1, fifo rollover=false, fifo almost full = 17
+    return false;
+  if(!maxim_max30102_write_reg(REG_MODE_CONFIG,0x03))   //0x02 for Red only, 0x03 for SpO2 mode 0x07 multimode LED
+    return false;
+  if(!maxim_max30102_write_reg(REG_SPO2_CONFIG,0x47))  // SPO2_ADC range = 4096nA, SPO2 sample rate (100 Hz), LED pulseWidth (400uS)
+    return false;
+  if(!maxim_max30102_write_reg(REG_LED1_PA,0x00))   //Choose value for ~ 7mA for LED1
+    return false;
+  if(!maxim_max30102_write_reg(REG_LED2_PA,0x69))   // Choose value for ~ 7mA for LED2
+    return false;
+  if(!maxim_max30102_write_reg(REG_PILOT_PA,0x00))   // Choose value for ~ 25mA for Pilot LED
+    return false;
+  if(!maxim_max30102_write_reg(REG_PROX_INT_THRESH, 0x21)) 
+    return false;     
+  return true;
+}
+bool maxim_max30102_init()
+/**
+* \brief        Initialize the MAX30102
+* \par          Details
+*               This function initializes the MAX30102
+*
+* \param        None
+*
+* \retval       true on success
+*/
+{
+  if(!maxim_max30102_write_reg(REG_INTR_ENABLE_1,0xD0)) // INTR setting
+    return false;
+  if(!maxim_max30102_write_reg(REG_INTR_ENABLE_2,0x00))
+    return false;
+  if(!maxim_max30102_write_reg(REG_FIFO_WR_PTR,0x00))  //FIFO_WR_PTR[4:0]
+    return false;
+  if(!maxim_max30102_write_reg(REG_OVF_COUNTER,0x00))  //OVF_COUNTER[4:0]
+    return false;
+  if(!maxim_max30102_write_reg(REG_FIFO_RD_PTR,0x00))  //FIFO_RD_PTR[4:0]
+    return false;
+  if(!maxim_max30102_write_reg(REG_FIFO_CONFIG,0x0f))  //sample avg = 1, fifo rollover=false, fifo almost full = 17
+    return false;
+  if(!maxim_max30102_write_reg(REG_MODE_CONFIG,0x03))   //0x02 for Red only, 0x03 for SpO2 mode 0x07 multimode LED
+    return false;
+  if(!maxim_max30102_write_reg(REG_SPO2_CONFIG,0x47))  // SPO2_ADC range = 4096nA, SPO2 sample rate (100 Hz), LED pulseWidth (400uS)
+    return false;
+  
+  if(!maxim_max30102_write_reg(REG_LED1_PA,0x3C))   //Choose value for ~ 7mA for LED1
+    return false;
+  if(!maxim_max30102_write_reg(REG_LED2_PA,0x69))   // Choose value for ~ 7mA for LED2
+    return false;
+  if(!maxim_max30102_write_reg(REG_PILOT_PA,0x7f))   // Choose value for ~ 25mA for Pilot LED
+    return false;
+  if(!maxim_max30102_write_reg(REG_PROX_INT_THRESH, 0x21)) 
+    return false;  
+  return true;  
+}
+
+bool maxim_max30102_read_fifo(uint32_t *pun_red_led, uint32_t *pun_ir_led)
+/**
+* \brief        Read a set of samples from the MAX30102 FIFO register
+* \par          Details
+*               This function reads a set of samples from the MAX30102 FIFO register
+*
+* \param[out]   *pun_red_led   - pointer that stores the red LED reading data
+* \param[out]   *pun_ir_led    - pointer that stores the IR LED reading data
+*
+* \retval       true on success
+*/
+{
+  uint32_t un_temp;
+  unsigned char uch_temp;
+  *pun_red_led=0;
+  *pun_ir_led=0;
+  char ach_i2c_data[6];
+  
+  //read and clear status register
+  maxim_max30102_read_reg(REG_INTR_STATUS_1, &uch_temp);
+  maxim_max30102_read_reg(REG_INTR_STATUS_2, &uch_temp);
+  
+  ach_i2c_data[0]=REG_FIFO_DATA;
+  if(i2c.write(I2C_WRITE_ADDR, ach_i2c_data, 1, true)!=0)
+    return false;
+  if(i2c.read(I2C_READ_ADDR, ach_i2c_data, 6, false)!=0)
+  {
+    return false;
+  }
+  un_temp=(unsigned char) ach_i2c_data[0];
+  un_temp<<=16;
+  *pun_red_led+=un_temp;
+  un_temp=(unsigned char) ach_i2c_data[1];
+  un_temp<<=8;
+  *pun_red_led+=un_temp;
+  un_temp=(unsigned char) ach_i2c_data[2];
+  *pun_red_led+=un_temp;
+  
+  un_temp=(unsigned char) ach_i2c_data[3];
+  un_temp<<=16;
+  *pun_ir_led+=un_temp;
+  un_temp=(unsigned char) ach_i2c_data[4];
+  un_temp<<=8;
+  *pun_ir_led+=un_temp;
+  un_temp=(unsigned char) ach_i2c_data[5];
+  *pun_ir_led+=un_temp;
+  *pun_red_led&=0x03FFFF;  //Mask MSB [23:18]
+  *pun_ir_led&=0x03FFFF;  //Mask MSB [23:18]
+  
+  
+  return true;
+}
+
+bool maxim_max30102_reset()
+/**
+* \brief        Reset the MAX30102
+* \par          Details
+*               This function resets the MAX30102
+*
+* \param        None
+*
+* \retval       true on success
+*/
+{
+    if(!maxim_max30102_write_reg(REG_MODE_CONFIG,0x40))
+        return false;
+    else
+        return true;    
+}
diff -r 000000000000 -r af4d13000e95 MAX30102/MAX30102.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MAX30102/MAX30102.h	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,98 @@
+/** \file max30102.h ******************************************************
+*
+* Project: MAXREFDES117#
+* Filename: max30102.h
+* Description: This module is an embedded controller driver header file for MAX30102
+*
+*
+* --------------------------------------------------------------------
+*
+* This code follows the following naming conventions:
+*
+* char              ch_pmod_value
+* char (array)      s_pmod_s_string[16]
+* float             f_pmod_value
+* int32_t           n_pmod_value
+* int32_t (array)   an_pmod_value[16]
+* int16_t           w_pmod_value
+* int16_t (array)   aw_pmod_value[16]
+* uint16_t          uw_pmod_value
+* uint16_t (array)  auw_pmod_value[16]
+* uint8_t           uch_pmod_value
+* uint8_t (array)   auch_pmod_buffer[16]
+* uint32_t          un_pmod_value
+* int32_t *         pn_pmod_value
+*
+* ------------------------------------------------------------------------- */
+/*******************************************************************************
+* Copyright (C) 2016 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 MAX30102_H_
+#define MAX30102_H_
+
+#include "mbed.h"
+
+#define I2C_WRITE_ADDR 0xAE
+#define I2C_READ_ADDR 0xAF
+
+//register addresses
+#define REG_INTR_STATUS_1 0x00
+#define REG_INTR_STATUS_2 0x01
+#define REG_INTR_ENABLE_1 0x02
+#define REG_INTR_ENABLE_2 0x03
+#define REG_FIFO_WR_PTR 0x04
+#define REG_OVF_COUNTER 0x05
+#define REG_FIFO_RD_PTR 0x06
+#define REG_FIFO_DATA 0x07
+#define REG_FIFO_CONFIG 0x08
+#define REG_MODE_CONFIG 0x09
+#define REG_SPO2_CONFIG 0x0A
+#define REG_LED1_PA 0x0C
+#define REG_LED2_PA 0x0D
+#define REG_PILOT_PA 0x10
+#define REG_MULTI_LED_CTRL1 0x11
+#define REG_MULTI_LED_CTRL2 0x12
+#define REG_TEMP_INTR 0x1F
+#define REG_TEMP_FRAC 0x20
+#define REG_TEMP_CONFIG 0x21
+#define REG_PROX_INT_THRESH 0x30
+#define REG_REV_ID 0xFE
+#define REG_PART_ID 0xFF
+
+bool maxim_max30102_init();
+bool maxim_max30102_soft_init();
+bool maxim_max30102_read_fifo(uint32_t *pun_red_led, uint32_t *pun_ir_led);
+bool maxim_max30102_write_reg(uint8_t uch_addr, uint8_t uch_data);
+bool maxim_max30102_read_reg(uint8_t uch_addr, uint8_t *puch_data);
+bool maxim_max30102_reset(void);
+
+#endif /* MAX30102_H_ */
\ No newline at end of file
diff -r 000000000000 -r af4d13000e95 System/System.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/System/System.cpp	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,43 @@
+/*******************************************************************************
+ * Copyright (C) 2016 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"
+
+//******************************************************************************
+void I2CM_Init_Reset(uint8_t index, int speed) {
+  mxc_i2cm_regs_t *regs = MXC_I2CM_GET_I2CM(index);
+  /* reset module */
+  regs->ctrl = MXC_F_I2CM_CTRL_MSTR_RESET_EN;
+  regs->ctrl = 0;
+  /* enable tx_fifo and rx_fifo */
+  regs->ctrl |= (MXC_F_I2CM_CTRL_TX_FIFO_EN | MXC_F_I2CM_CTRL_RX_FIFO_EN);
+}
diff -r 000000000000 -r af4d13000e95 System/System.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/System/System.h	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,41 @@
+/*******************************************************************************
+ * Copyright (C) 2016 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 _SYSTEM_H_
+#define _SYSTEM_H_
+
+/**
+* This issues a reset to the I2C Peripheral 
+*/
+void I2CM_Init_Reset(uint8_t index, int speed);
+
+#endif // _SYSTEM_H_
diff -r 000000000000 -r af4d13000e95 USBDevice.lib
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/USBDevice.lib	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,1 @@
+https://os.mbed.com/teams/MaximIntegrated/code/USBDevice/#dad310740b28
diff -r 000000000000 -r af4d13000e95 algorithm/algorithm.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/algorithm/algorithm.cpp	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,363 @@
+/** \file algorithm.cpp ******************************************************
+*
+* Project: MAXREFDES117#
+* Filename: algorithm.cpp
+* Description: This module calculates the heart rate/SpO2 level
+*
+*
+* --------------------------------------------------------------------
+*
+* This code follows the following naming conventions:
+*
+* char              ch_pmod_value
+* char (array)      s_pmod_s_string[16]
+* float             f_pmod_value
+* int32_t           n_pmod_value
+* int32_t (array)   an_pmod_value[16]
+* int16_t           w_pmod_value
+* int16_t (array)   aw_pmod_value[16]
+* uint16_t          uw_pmod_value
+* uint16_t (array)  auw_pmod_value[16]
+* uint8_t           uch_pmod_value
+* uint8_t (array)   auch_pmod_buffer[16]
+* uint32_t          un_pmod_value
+* int32_t *         pn_pmod_value
+*
+* ------------------------------------------------------------------------- */
+/*******************************************************************************
+* Copyright (C) 2016 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 "algorithm.h"
+#include "mbed.h"
+
+void maxim_heart_rate_and_oxygen_saturation(uint32_t *pun_ir_buffer,  int32_t n_ir_buffer_length, uint32_t *pun_red_buffer, int32_t *pn_spo2, int8_t *pch_spo2_valid, 
+                              int32_t *pn_heart_rate, int8_t  *pch_hr_valid)
+/**
+* \brief        Calculate the heart rate and SpO2 level
+* \par          Details
+*               By detecting  peaks of PPG cycle and corresponding AC/DC of red/infra-red signal, the ratio for the SPO2 is computed.
+*               Since this algorithm is aiming for Arm M0/M3. formaula for SPO2 did not achieve the accuracy due to register overflow.
+*               Thus, accurate SPO2 is precalculated and save longo uch_spo2_table[] per each ratio.
+*
+* \param[in]    *pun_ir_buffer           - IR sensor data buffer
+* \param[in]    n_ir_buffer_length      - IR sensor data buffer length
+* \param[in]    *pun_red_buffer          - Red sensor data buffer
+* \param[out]    *pn_spo2                - Calculated SpO2 value
+* \param[out]    *pch_spo2_valid         - 1 if the calculated SpO2 value is valid
+* \param[out]    *pn_heart_rate          - Calculated heart rate value
+* \param[out]    *pch_hr_valid           - 1 if the calculated heart rate value is valid
+*
+* \retval       None
+*/
+{
+    uint32_t un_ir_mean ,un_only_once ;
+    int32_t k ,n_i_ratio_count;
+    int32_t i,s ,m, n_exact_ir_valley_locs_count ,n_middle_idx;
+    int32_t n_th1, n_npks,n_c_min;      
+    int32_t an_ir_valley_locs[15] ;
+    int32_t an_exact_ir_valley_locs[15] ;
+    int32_t an_dx_peak_locs[15] ;
+    int32_t n_peak_interval_sum;
+    
+    int32_t n_y_ac, n_x_ac;
+    int32_t n_spo2_calc; 
+    int32_t n_y_dc_max, n_x_dc_max; 
+    int32_t n_y_dc_max_idx, n_x_dc_max_idx; 
+    int32_t an_ratio[5],n_ratio_average; 
+    int32_t n_nume,  n_denom ;
+    // remove DC of ir signal    
+    un_ir_mean =0; 
+    for (k=0 ; k<n_ir_buffer_length ; k++ ) un_ir_mean += pun_ir_buffer[k] ;
+    un_ir_mean =un_ir_mean/n_ir_buffer_length ;
+    for (k=0 ; k<n_ir_buffer_length ; k++ )  an_x[k] =  pun_ir_buffer[k] - un_ir_mean ; 
+    
+    // 4 pt Moving Average
+    for(k=0; k< BUFFER_SIZE-MA4_SIZE; k++){
+        n_denom= ( an_x[k]+an_x[k+1]+ an_x[k+2]+ an_x[k+3]);
+        an_x[k]=  n_denom/(int32_t)4; 
+    }
+
+    // get difference of smoothed IR signal
+    
+    for( k=0; k<BUFFER_SIZE-MA4_SIZE-1;  k++)
+        an_dx[k]= (an_x[k+1]- an_x[k]);
+
+    // 2-pt Moving Average to an_dx
+    for(k=0; k< BUFFER_SIZE-MA4_SIZE-2; k++){
+        an_dx[k] =  ( an_dx[k]+an_dx[k+1])/2 ;
+    }
+    
+    // hamming window
+    // flip wave form so that we can detect valley with peak detector
+    for ( i=0 ; i<BUFFER_SIZE-HAMMING_SIZE-MA4_SIZE-2 ;i++){
+        s= 0;
+        for( k=i; k<i+ HAMMING_SIZE ;k++){
+            s -= an_dx[k] *auw_hamm[k-i] ; 
+                     }
+        an_dx[i]= s/ (int32_t)1146; // divide by sum of auw_hamm 
+    }
+
+ 
+    n_th1=0; // threshold calculation
+    for ( k=0 ; k<BUFFER_SIZE-HAMMING_SIZE ;k++){
+        n_th1 += ((an_dx[k]>0)? an_dx[k] : ((int32_t)0-an_dx[k])) ;
+    }
+    n_th1= n_th1/ ( BUFFER_SIZE-HAMMING_SIZE);
+    // peak location is acutally index for sharpest location of raw signal since we flipped the signal         
+    maxim_find_peaks( an_dx_peak_locs, &n_npks, an_dx, BUFFER_SIZE-HAMMING_SIZE, n_th1, 8, 5 );//peak_height, peak_distance, max_num_peaks 
+
+    n_peak_interval_sum =0;
+    if (n_npks>=2){
+        for (k=1; k<n_npks; k++)
+            n_peak_interval_sum += (an_dx_peak_locs[k]-an_dx_peak_locs[k -1]);
+        n_peak_interval_sum=n_peak_interval_sum/(n_npks-1);
+        *pn_heart_rate=(int32_t)(6000/n_peak_interval_sum);// beats per minutes
+        *pch_hr_valid  = 1;
+    }
+    else  {
+        *pn_heart_rate = -999;
+        *pch_hr_valid  = 0;
+    }
+            
+    for ( k=0 ; k<n_npks ;k++)
+        an_ir_valley_locs[k]=an_dx_peak_locs[k]+HAMMING_SIZE/2; 
+
+
+    // raw value : RED(=y) and IR(=X)
+    // we need to assess DC and AC value of ir and red PPG. 
+    for (k=0 ; k<n_ir_buffer_length ; k++ )  {
+        an_x[k] =  pun_ir_buffer[k] ; 
+        an_y[k] =  pun_red_buffer[k] ; 
+    }
+
+    // find precise min near an_ir_valley_locs
+    n_exact_ir_valley_locs_count =0; 
+    for(k=0 ; k<n_npks ;k++){
+        un_only_once =1;
+        m=an_ir_valley_locs[k];
+        n_c_min= 16777216;//2^24;
+        if (m+5 <  BUFFER_SIZE-HAMMING_SIZE  && m-5 >0){
+            for(i= m-5;i<m+5; i++)
+                if (an_x[i]<n_c_min){
+                    if (un_only_once >0){
+                       un_only_once =0;
+                   } 
+                   n_c_min= an_x[i] ;
+                   an_exact_ir_valley_locs[k]=i;
+                }
+            if (un_only_once ==0)
+                n_exact_ir_valley_locs_count ++ ;
+        }
+    }
+    if (n_exact_ir_valley_locs_count <2 ){
+       *pn_spo2 =  -999 ; // do not use SPO2 since signal ratio is out of range
+       *pch_spo2_valid  = 0; 
+       return;
+    }
+    // 4 pt MA
+    for(k=0; k< BUFFER_SIZE-MA4_SIZE; k++){
+        an_x[k]=( an_x[k]+an_x[k+1]+ an_x[k+2]+ an_x[k+3])/(int32_t)4;
+        an_y[k]=( an_y[k]+an_y[k+1]+ an_y[k+2]+ an_y[k+3])/(int32_t)4;
+    }
+
+    //using an_exact_ir_valley_locs , find ir-red DC andir-red AC for SPO2 calibration ratio
+    //finding AC/DC maximum of raw ir * red between two valley locations
+    n_ratio_average =0; 
+    n_i_ratio_count =0; 
+    
+    for(k=0; k< 5; k++) an_ratio[k]=0;
+    for (k=0; k< n_exact_ir_valley_locs_count; k++){
+        if (an_exact_ir_valley_locs[k] > BUFFER_SIZE ){             
+            *pn_spo2 =  -999 ; // do not use SPO2 since valley loc is out of range
+            *pch_spo2_valid  = 0; 
+            return;
+        }
+    }
+    // find max between two valley locations 
+    // and use ratio betwen AC compoent of Ir & Red and DC compoent of Ir & Red for SPO2 
+
+    for (k=0; k< n_exact_ir_valley_locs_count-1; k++){
+        n_y_dc_max= -16777216 ; 
+        n_x_dc_max= - 16777216; 
+        if (an_exact_ir_valley_locs[k+1]-an_exact_ir_valley_locs[k] >10){
+            for (i=an_exact_ir_valley_locs[k]; i< an_exact_ir_valley_locs[k+1]; i++){
+                if (an_x[i]> n_x_dc_max) {n_x_dc_max =an_x[i];n_x_dc_max_idx =i; }
+                if (an_y[i]> n_y_dc_max) {n_y_dc_max =an_y[i];n_y_dc_max_idx=i;}
+            }
+            n_y_ac= (an_y[an_exact_ir_valley_locs[k+1]] - an_y[an_exact_ir_valley_locs[k] ] )*(n_y_dc_max_idx -an_exact_ir_valley_locs[k]); //red
+            n_y_ac=  an_y[an_exact_ir_valley_locs[k]] + n_y_ac/ (an_exact_ir_valley_locs[k+1] - an_exact_ir_valley_locs[k])  ; 
+        
+        
+            n_y_ac=  an_y[n_y_dc_max_idx] - n_y_ac;    // subracting linear DC compoenents from raw 
+            n_x_ac= (an_x[an_exact_ir_valley_locs[k+1]] - an_x[an_exact_ir_valley_locs[k] ] )*(n_x_dc_max_idx -an_exact_ir_valley_locs[k]); // ir
+            n_x_ac=  an_x[an_exact_ir_valley_locs[k]] + n_x_ac/ (an_exact_ir_valley_locs[k+1] - an_exact_ir_valley_locs[k]); 
+            n_x_ac=  an_x[n_y_dc_max_idx] - n_x_ac;      // subracting linear DC compoenents from raw 
+            n_nume=( n_y_ac *n_x_dc_max)>>7 ; //prepare X100 to preserve floating value
+            n_denom= ( n_x_ac *n_y_dc_max)>>7;
+            if (n_denom>0  && n_i_ratio_count <5 &&  n_nume != 0)
+            {   
+                an_ratio[n_i_ratio_count]= (n_nume*100)/n_denom ; //formular is ( n_y_ac *n_x_dc_max) / ( n_x_ac *n_y_dc_max) ;
+                n_i_ratio_count++;
+            }
+        }
+    }
+
+    maxim_sort_ascend(an_ratio, n_i_ratio_count);
+    n_middle_idx= n_i_ratio_count/2;
+
+    if (n_middle_idx >1)
+        n_ratio_average =( an_ratio[n_middle_idx-1] +an_ratio[n_middle_idx])/2; // use median
+    else
+        n_ratio_average = an_ratio[n_middle_idx ];
+
+    if( n_ratio_average>2 && n_ratio_average <184){
+        n_spo2_calc= uch_spo2_table[n_ratio_average] ;
+        *pn_spo2 = n_spo2_calc ;
+        *pch_spo2_valid  = 1;//  float_SPO2 =  -45.060*n_ratio_average* n_ratio_average/10000 + 30.354 *n_ratio_average/100 + 94.845 ;  // for comparison with table
+    }
+    else{
+        *pn_spo2 =  -999 ; // do not use SPO2 since signal ratio is out of range
+        *pch_spo2_valid  = 0; 
+    }
+}
+
+
+void maxim_find_peaks(int32_t *pn_locs, int32_t *pn_npks, int32_t *pn_x, int32_t n_size, int32_t n_min_height, int32_t n_min_distance, int32_t n_max_num)
+/**
+* \brief        Find peaks
+* \par          Details
+*               Find at most MAX_NUM peaks above MIN_HEIGHT separated by at least MIN_DISTANCE
+*
+* \retval       None
+*/
+{
+    maxim_peaks_above_min_height( pn_locs, pn_npks, pn_x, n_size, n_min_height );
+    maxim_remove_close_peaks( pn_locs, pn_npks, pn_x, n_min_distance );
+    *pn_npks = min( *pn_npks, n_max_num );
+}
+
+void maxim_peaks_above_min_height(int32_t *pn_locs, int32_t *pn_npks, int32_t  *pn_x, int32_t n_size, int32_t n_min_height)
+/**
+* \brief        Find peaks above n_min_height
+* \par          Details
+*               Find all peaks above MIN_HEIGHT
+*
+* \retval       None
+*/
+{
+    int32_t i = 1, n_width;
+    *pn_npks = 0;
+    
+    while (i < n_size-1){
+        if (pn_x[i] > n_min_height && pn_x[i] > pn_x[i-1]){            // find left edge of potential peaks
+            n_width = 1;
+            while (i+n_width < n_size && pn_x[i] == pn_x[i+n_width])    // find flat peaks
+                n_width++;
+            if (pn_x[i] > pn_x[i+n_width] && (*pn_npks) < 15 ){                            // find right edge of peaks
+                pn_locs[(*pn_npks)++] = i;        
+                // for flat peaks, peak location is left edge
+                i += n_width+1;
+            }
+            else
+                i += n_width;
+        }
+        else
+            i++;
+    }
+}
+
+
+void maxim_remove_close_peaks(int32_t *pn_locs, int32_t *pn_npks, int32_t *pn_x,int32_t n_min_distance)
+/**
+* \brief        Remove peaks
+* \par          Details
+*               Remove peaks separated by less than MIN_DISTANCE
+*
+* \retval       None
+*/
+{
+    
+    int32_t i, j, n_old_npks, n_dist;
+    
+    /* Order peaks from large to small */
+    maxim_sort_indices_descend( pn_x, pn_locs, *pn_npks );
+
+    for ( i = -1; i < *pn_npks; i++ ){
+        n_old_npks = *pn_npks;
+        *pn_npks = i+1;
+        for ( j = i+1; j < n_old_npks; j++ ){
+            n_dist =  pn_locs[j] - ( i == -1 ? -1 : pn_locs[i] ); // lag-zero peak of autocorr is at index -1
+            if ( n_dist > n_min_distance || n_dist < -n_min_distance )
+                pn_locs[(*pn_npks)++] = pn_locs[j];
+        }
+    }
+
+    // Resort indices longo ascending order
+    maxim_sort_ascend( pn_locs, *pn_npks );
+}
+
+void maxim_sort_ascend(int32_t *pn_x,int32_t n_size) 
+/**
+* \brief        Sort array
+* \par          Details
+*               Sort array in ascending order (insertion sort algorithm)
+*
+* \retval       None
+*/
+{
+    int32_t i, j, n_temp;
+    for (i = 1; i < n_size; i++) {
+        n_temp = pn_x[i];
+        for (j = i; j > 0 && n_temp < pn_x[j-1]; j--)
+            pn_x[j] = pn_x[j-1];
+        pn_x[j] = n_temp;
+    }
+}
+
+void maxim_sort_indices_descend(int32_t *pn_x, int32_t *pn_indx, int32_t n_size)
+/**
+* \brief        Sort indices
+* \par          Details
+*               Sort indices according to descending order (insertion sort algorithm)
+*
+* \retval       None
+*/ 
+{
+    int32_t i, j, n_temp;
+    for (i = 1; i < n_size; i++) {
+        n_temp = pn_indx[i];
+        for (j = i; j > 0 && pn_x[n_temp] > pn_x[pn_indx[j-1]]; j--)
+            pn_indx[j] = pn_indx[j-1];
+        pn_indx[j] = n_temp;
+    }
+}
+
diff -r 000000000000 -r af4d13000e95 algorithm/algorithm.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/algorithm/algorithm.h	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,100 @@
+/** \file algorithm.h ******************************************************
+*
+* Project: MAXREFDES117#
+* Filename: algorithm.c
+* Description: This module is the heart rate/SpO2 calculation algorithm header file
+*
+* Revision History:
+*\n 1-18-2016 Rev 01.00 SK Initial release.
+*\n
+*
+* --------------------------------------------------------------------
+*
+* This code follows the following naming conventions:
+*
+*\n char              ch_pmod_value
+*\n char (array)      s_pmod_s_string[16]
+*\n float             f_pmod_value
+*\n int32_t           n_pmod_value
+*\n int32_t (array)   an_pmod_value[16]
+*\n int16_t           w_pmod_value
+*\n int16_t (array)   aw_pmod_value[16]
+*\n uint16_t          uw_pmod_value
+*\n uint16_t (array)  auw_pmod_value[16]
+*\n uint8_t           uch_pmod_value
+*\n uint8_t (array)   auch_pmod_buffer[16]
+*\n uint32_t          un_pmod_value
+*\n int32_t *         pn_pmod_value
+*
+* ------------------------------------------------------------------------- */
+/*******************************************************************************
+* Copyright (C) 2015 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 ALGORITHM_H_
+#define ALGORITHM_H_
+
+#include "mbed.h"
+
+#define true 1
+#define false 0
+#define FS 100
+#define BUFFER_SIZE  (FS* 5) 
+#define HR_FIFO_SIZE 7
+#define MA4_SIZE  4 // DO NOT CHANGE
+#define HAMMING_SIZE  5// DO NOT CHANGE
+#define min(x,y) ((x) < (y) ? (x) : (y))
+
+const uint16_t auw_hamm[31]={ 41,    276,    512,    276,     41 }; //Hamm=  long16(512* hamming(5)');
+//SPO2table is computed as  -45.060*ratioAverage* ratioAverage + 30.354 *ratioAverage + 94.845 ;
+const uint8_t uch_spo2_table[184]={ 95, 95, 95, 96, 96, 96, 97, 97, 97, 97, 97, 98, 98, 98, 98, 98, 99, 99, 99, 99, 
+                            99, 99, 99, 99, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 100, 
+                            100, 100, 100, 100, 99, 99, 99, 99, 99, 99, 99, 99, 98, 98, 98, 98, 98, 98, 97, 97, 
+                            97, 97, 96, 96, 96, 96, 95, 95, 95, 94, 94, 94, 93, 93, 93, 92, 92, 92, 91, 91, 
+                            90, 90, 89, 89, 89, 88, 88, 87, 87, 86, 86, 85, 85, 84, 84, 83, 82, 82, 81, 81, 
+                            80, 80, 79, 78, 78, 77, 76, 76, 75, 74, 74, 73, 72, 72, 71, 70, 69, 69, 68, 67, 
+                            66, 66, 65, 64, 63, 62, 62, 61, 60, 59, 58, 57, 56, 56, 55, 54, 53, 52, 51, 50, 
+                            49, 48, 47, 46, 45, 44, 43, 42, 41, 40, 39, 38, 37, 36, 35, 34, 33, 31, 30, 29, 
+                            28, 27, 26, 25, 23, 22, 21, 20, 19, 17, 16, 15, 14, 12, 11, 10, 9, 7, 6, 5, 
+                            3, 2, 1 } ;
+static  int32_t an_dx[ BUFFER_SIZE-MA4_SIZE]; // delta
+static  int32_t an_x[ BUFFER_SIZE]; //ir
+static  int32_t an_y[ BUFFER_SIZE]; //red
+
+
+void maxim_heart_rate_and_oxygen_saturation(uint32_t *pun_ir_buffer ,  int32_t n_ir_buffer_length, uint32_t *pun_red_buffer ,   int32_t *pn_spo2, int8_t *pch_spo2_valid ,  int32_t *pn_heart_rate , int8_t  *pch_hr_valid);
+void maxim_find_peaks( int32_t *pn_locs, int32_t *pn_npks,  int32_t *pn_x, int32_t n_size, int32_t n_min_height, int32_t n_min_distance, int32_t n_max_num );
+void maxim_peaks_above_min_height( int32_t *pn_locs, int32_t *pn_npks,  int32_t *pn_x, int32_t n_size, int32_t n_min_height );
+void maxim_remove_close_peaks( int32_t *pn_locs, int32_t *pn_npks,   int32_t  *pn_x, int32_t n_min_distance );
+void maxim_sort_ascend( int32_t *pn_x, int32_t n_size );
+void maxim_sort_indices_descend(  int32_t  *pn_x, int32_t *pn_indx, int32_t n_size);
+
+#endif /* ALGORITHM_H_ */
\ No newline at end of file
diff -r 000000000000 -r af4d13000e95 main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,144 @@
+#include "mbed.h"
+#include "MAX14720.h"
+#include "MAX30102.h"
+#include "USBSerial.h"
+#include "System.h"
+#include "algorithm.h"
+
+/// define the HVOUT Boost Voltage default for the MAX14720 PMIC
+#define HVOUT_VOLTAGE 4500 // set to 4500 mV
+
+#define MAX14720_I2C_SLAVE_ADDR (0x54)
+
+#define MAX_BRIGHTNESS 255
+
+uint32_t aun_ir_buffer[500]; //IR LED sensor data
+int32_t n_ir_buffer_length;    //data length
+uint32_t aun_red_buffer[500];    //Red LED sensor data
+int32_t n_sp02; //SPO2 value
+int8_t ch_spo2_valid;   //indicator to show if the SP02 calculation is valid
+int32_t n_heart_rate;   //heart rate value
+int8_t  ch_hr_valid;    //indicator to show if the heart rate calculation is valid
+uint8_t uch_dummy;
+
+//Serial pc(USBTX, USBRX);    //initializes the serial port
+/// Define with Maxim VID and a Maxim assigned PID, set to version 0x0001 and non-blocking
+
+USBSerial usbSerial(0x0b6a, 0x0122, 0x0001, false);
+
+/// I2C Master 2
+I2C i2c2(I2C2_SDA, I2C2_SCL); // used by MAX14720, MAX30101, LIS2DH
+/// SPI Master 0 with SPI0_SS for use with MAX30001
+
+MAX14720 max14720(&i2c2, MAX14720_I2C_SLAVE_ADDR);
+DigitalOut led(LED1); 
+DigitalIn INT(P4_0);
+int main(){
+//---------------------------------------------------
+  // hold results for returning functions
+    int result;
+    // initialize HVOUT on the MAX14720 PMIC
+    result = max14720.init();
+    if (result == MAX14720_ERROR){
+        printf("Error initializing MAX14720");
+    }
+    max14720.boostEn = MAX14720::BOOST_ENABLED;
+    max14720.boostSetVoltage(HVOUT_VOLTAGE);
+//--------------------------------------------------- 
+    uint32_t un_min, un_max, un_prev_data;  //variables to calculate the on-board LED brightness that reflects the heartbeats
+    int i;
+    int32_t n_brightness;
+    float f_temp;
+    long unBlockedValue = 0;
+    
+    maxim_max30102_reset(); //resets the MAX30102
+    wait(1);
+    maxim_max30102_init();  //initializes the MAX30102
+        
+    n_brightness=0;
+    un_min=0x3FFFF;
+    un_max=0;
+  
+    n_ir_buffer_length=500; //buffer length of 100 stores 5 seconds of samples running at 100sps
+    
+    //read the first 500 samples, and determine the signal range
+    for(i=0;i<n_ir_buffer_length;i++)
+    {
+        while(INT.read()==1);   //wait until the interrupt pin asserts
+        
+        maxim_max30102_read_fifo((aun_red_buffer+i), (aun_ir_buffer+i));  //read from MAX30102 FIFO
+            
+        if(un_min>aun_red_buffer[i])
+            un_min=aun_red_buffer[i];    //update signal min
+        if(un_max<aun_red_buffer[i])
+            un_max=aun_red_buffer[i];    //update signal max
+        /*usbSerial.printf("red=");
+        usbSerial.printf("%i", aun_red_buffer[i]);
+        usbSerial.printf(", ir=");
+        usbSerial.printf("%i\n\r", aun_ir_buffer[i]);*/
+    }
+    un_prev_data=aun_red_buffer[i];
+    
+    
+    //calculate heart rate and SpO2 after first 500 samples (first 5 seconds of samples)
+    maxim_heart_rate_and_oxygen_saturation(aun_ir_buffer, n_ir_buffer_length, aun_red_buffer, &n_sp02, &ch_spo2_valid, &n_heart_rate, &ch_hr_valid); 
+    
+    //Continuously taking samples from MAX30102.  Heart rate and SpO2 are calculated every 1 second
+  
+  
+  while (1) {
+        i=0;
+        un_min=0x3FFFF;
+        un_max=0;
+        
+        //dumping the first 100 sets of samples in the memory and shift the last 400 sets of samples to the top
+        for(i=200;i<500;i++)
+        {
+            aun_red_buffer[i-200]=aun_red_buffer[i];
+            aun_ir_buffer[i-200]=aun_ir_buffer[i];
+            
+            //update the signal min and max
+            if(un_min>aun_red_buffer[i])
+            un_min=aun_red_buffer[i];
+            if(un_max<aun_red_buffer[i])
+            un_max=aun_red_buffer[i];
+        }
+        
+        //take 100 sets of samples before calculating the heart rate.
+        for(i=300;i<500;i++)
+        {
+            un_prev_data=aun_red_buffer[i-1];
+            while(INT.read()==1);
+            maxim_max30102_read_fifo((aun_red_buffer+i), (aun_ir_buffer+i));
+        
+            if(aun_red_buffer[i]>un_prev_data)
+            {
+                f_temp=aun_red_buffer[i]-un_prev_data;
+                f_temp/=(un_max-un_min);
+                f_temp*=MAX_BRIGHTNESS;
+                n_brightness-=(int)f_temp;
+                if(n_brightness<0)
+                    n_brightness=0;
+            }
+            else
+            {
+                f_temp=un_prev_data-aun_red_buffer[i];
+                f_temp/=(un_max-un_min);
+                f_temp*=MAX_BRIGHTNESS;
+                n_brightness+=(int)f_temp;
+                if(n_brightness>MAX_BRIGHTNESS)
+                    n_brightness=MAX_BRIGHTNESS;
+            }
+            //send samples and calculation result to terminal program through UART
+            /*usbSerial.printf("red=");
+            usbSerial.printf("%i", aun_red_buffer[i]);
+            usbSerial.printf(", ir=");
+            usbSerial.printf("%i", aun_ir_buffer[i]);*/
+            usbSerial.printf("HR=%i\t", n_heart_rate); 
+            //usbSerial.printf("HRvalid=%i, ", ch_hr_valid);
+            usbSerial.printf("SpO2=%i\n\r", n_sp02);
+            //usbSerial.printf("SPO2Valid=%i\n\r", ch_spo2_valid);
+        }
+        maxim_heart_rate_and_oxygen_saturation(aun_ir_buffer, n_ir_buffer_length, aun_red_buffer, &n_sp02, &ch_spo2_valid, &n_heart_rate, &ch_hr_valid); 
+  } 
+}
\ No newline at end of file
diff -r 000000000000 -r af4d13000e95 mbed.bld
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mbed.bld	Thu Mar 28 08:07:54 2019 +0000
@@ -0,0 +1,1 @@
+https://os.mbed.com/users/mbed_official/code/mbed/builds/84c0a372a020
\ No newline at end of file