#include <Wire.h>
#include "MAX30100_PulseOximeter.h"

#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <Fonts/Picopixel.h>

#define OLED_RESET LED_BUILTIN // 4 // Reset pin # (or -1 if sharing Arduino reset pin)
#define SCREEN_ADDRESS 0x3C ///< See datasheet for Address; 0x3D for 128x64, 0x3C for 128x32

Adafruit_SSD1306 display(128, 64, &Wire ,OLED_RESET);
//Adafruit_SSD1306 display(OLED_RESET);

#define REPORTING_PERIOD_MS     500
// PulseOximeter is the higher level interface to the sensor
// it offers:
//  * beat detection reporting
//  * heart rate calculation
//  * SpO2 (oxidation level) calculation
PulseOximeter pox;

uint32_t tsLastReport = 0;
// Callback (registered below) fired when a pulse is detected

static const unsigned char test_bits[] PROGMEM = {
  0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
  0x1f, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0x80, 0x00, 0x00, 0x00, 0x01, 0xff, 0xff, 
  0xe0, 0x00, 0x00, 0x00, 0x0f, 0x80, 0x00, 0x78, 0x00, 0x00, 0x00, 0x1f, 0x07, 0xf8, 0x3c, 0x00, 
  0x00, 0x00, 0x3c, 0x3f, 0xfe, 0x1e, 0x00, 0x00, 0x00, 0x78, 0xff, 0xff, 0x87, 0x00, 0x00, 0x00, 
  0x73, 0xe0, 0x03, 0xf0, 0x00, 0x00, 0x00, 0x0f, 0x80, 0x00, 0xf8, 0x00, 0x00, 0x00, 0x0f, 0x0f, 
  0xf8, 0x78, 0x00, 0x00, 0x00, 0x1c, 0x7f, 0xff, 0x8e, 0x00, 0x00, 0x00, 0x38, 0xf8, 0x07, 0x87, 
  0x00, 0x00, 0x00, 0x71, 0xe0, 0x03, 0xc7, 0x00, 0x00, 0x00, 0x73, 0xc1, 0xc0, 0xe3, 0x80, 0x00, 
  0x00, 0xe7, 0x1f, 0xfc, 0x78, 0x00, 0x00, 0x01, 0xcf, 0x3e, 0x3e, 0x38, 0x00, 0x00, 0x00, 0x8e, 
  0x78, 0x0f, 0x38, 0x00, 0x00, 0x00, 0x0e, 0xf0, 0x03, 0x9c, 0x80, 0x00, 0x00, 0x18, 0xe7, 0xf1, 
  0x8c, 0xc0, 0x00, 0x00, 0x39, 0xcf, 0xf9, 0xce, 0xc0, 0x00, 0x00, 0x71, 0x9e, 0x3c, 0xc6, 0xc0, 
  0x00, 0x01, 0xe3, 0x1c, 0x1c, 0xc6, 0xe0, 0x00, 0x01, 0xc7, 0x18, 0x8c, 0xc6, 0xe0, 0x00, 0x01, 
  0x8f, 0x39, 0xcc, 0xc6, 0xe0, 0x00, 0x00, 0x0e, 0x71, 0xcc, 0xcc, 0xe0, 0x00, 0x00, 0x3c, 0xe3, 
  0x8c, 0xcc, 0xe0, 0x00, 0x00, 0x78, 0xe3, 0x1c, 0xcc, 0xe0, 0x00, 0x00, 0xf1, 0xc7, 0x1d, 0xcc, 
  0xe0, 0x00, 0x01, 0xc7, 0x9e, 0x39, 0x9c, 0xc0, 0x00, 0x01, 0x8f, 0x1e, 0x31, 0x98, 0xc0, 0x00, 
  0x00, 0x0f, 0x1c, 0x71, 0x98, 0xc0, 0x00, 0x00, 0x3e, 0x38, 0xe1, 0x9c, 0xc0, 0x00, 0x00, 0x70, 
  0xe1, 0xdd, 0x8c, 0x00, 0x00, 0x01, 0xf0, 0xe3, 0xdd, 0x8e, 0x00, 0x00, 0x01, 0xc3, 0xc7, 0x9d, 
  0x87, 0x00, 0x00, 0x00, 0x0f, 0x1e, 0x38, 0xc7, 0x80, 0x00, 0x00, 0x0f, 0x1e, 0x38, 0xe3, 0x80, 
  0x00, 0x00, 0x3c, 0x38, 0x38, 0x70, 0x00, 0x00, 0x00, 0x78, 0x70, 0x1c, 0x78, 0x00, 0x00, 0x00, 
  0x61, 0xe7, 0x9c, 0x1e, 0x00, 0x00, 0x00, 0x03, 0xdf, 0xce, 0x04, 0x00, 0x00, 0x00, 0x07, 0x9f, 
  0xc7, 0x00, 0x00, 0x00, 0x00, 0x0f, 0x3c, 0xe3, 0x80, 0x00, 0x00, 0x00, 0x00, 0x30, 0x61, 0x00, 
  0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x20, 0x00, 0x00, 0x00, 
  0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
};

void onBeatDetected()
{
Serial.println("Beat!");
}
void setup()
{
  Serial.begin(115200);
  Serial.println("SSD1306 128x64 OLED TEST");
  // SSD1306_SWITCHCAPVCC = generate display voltage from 3.3V internally
  display.begin(SSD1306_SWITCHCAPVCC, SCREEN_ADDRESS);
  
  //display.setFont(&Picopixel);    
  lcd_start(pox.begin());
  delay(2000);
  if (!pox.begin()) {
    Serial.println("FAILED");
    for(;;);
  } else {
    Serial.println("SUCCESS");
  }
  // The default current for the IR LED is 50mA and it could be changed
  //   by uncommenting the following line. Check MAX30100_Registers.h for all the
  //   available options.
  pox.setIRLedCurrent(MAX30100_LED_CURR_50MA);
  // Register a callback for the beat detection
  pox.setOnBeatDetectedCallback(onBeatDetected);
}
void loop()
{
  pox.update();
  int bpm = 0;
  int spo2 = 0;
  // Asynchronously dump heart rate and oxidation levels to the serial
  // For both, a value of 0 means "invalid"
  if (millis() - tsLastReport > REPORTING_PERIOD_MS) {
    //Serial.print("Heart rate:");
    bpm = pox.getHeartRate();
    spo2 = pox.getSpO2();
    Serial.println(bpm);
    //Serial.print("bpm / SpO2:");
    Serial.println(spo2);
    //Serial.println("%");
    tsLastReport = millis();
    lcd(bpm, spo2);
  }
}

void lcd(int hr , int spo2)
{ 
display.clearDisplay();
if(hr==0 || spo2==0 )
    { 
    display.setTextSize(1);
    display.setTextColor(WHITE);
    display.setCursor(0, 0);  
    display.print("MAX30100 Oximeter...");
    display.drawBitmap( 70, 16, test_bits, 50, 50, WHITE);
    display.setTextSize(3);
    display.setCursor(0, 25);  
    display.print("Scan");     
    } 
else
    {  
    display.setTextSize(1);
    display.setTextColor(WHITE);
    display.setCursor(0, 0);
    display.println("MAX30100 Oximeter...");
    display.setTextSize(2);
    display.println("");
    display.setCursor(0, 20);  //تنظیم موقعیت جهت نمایش داده
    display.print("S:");  //عبارت s بیانگر اکسیژن خون است
    display.print(spo2);
    display.setTextSize(1);display.print(" %");display.setTextSize(2);
    display.setCursor(0, 46);   //تنظیم موقعیت صفحه برای نمایش متغیر ضربان قلب
    display.print("H:");  
    display.print(hr);
    display.setTextSize(1);display.print(" BPM");display.setTextSize(2); 
    }
display.display(); 
//pox.resume();    
}

void lcd_start(bool check)
{
display.clearDisplay();
display.setTextSize(2);
display.setTextColor(WHITE);
display.setCursor(0, 0);
display.println("MAX30100.."); 
display.setTextSize(2); 
display.setTextColor(WHITE);
display.setCursor(0, 20);
while (!check) 
    {
    display.print("FAILED!!!");  
    display.display(); 
    ESP.restart();
    } 
if(check) 
    {
    display.println("SUCCESS>>");  
    }       
display.setTextSize(1);
display.setTextColor(WHITE);     
display.setCursor(28, 50);
display.print(">WELCOME<");     
display.display();    
}