#include "BluetoothSerial.h"
#include "time.h"
#include <Wire.h>
#include <Adafruit_MPU6050.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include "soc/timer_group_struct.h"
#include "soc/timer_group_reg.h"
//______________________________________________________________________________
#define LED_PIN 22
#define LOPLUS_PIN 33
#define LOMINUS_PIN 32
#define ECG_PIN A0
#define BATTERY_PIN A3
#define ECGLEN 500
#define ECGINTERVAL 4
//______________________________________________________________________________
BluetoothSerial ESP_BT;
Adafruit_MPU6050 mpu;
Adafruit_SSD1306 display(128, 64, &Wire, -1);
TaskHandle_t taskcheckEcg = NULL;
int BT_connected = false;
ulong ecgMillis = 0;
int connected = 0;
int lominus = 1;
int loplus = 1;
int chartData[ECGLEN];
int chartMax = 0;
int chartMin = 0;
int samplesSum = 0;
int SamplesCount = 0;
ulong batteryMillis = 88000;
int batteryPercentage = 0;
int batterySum = 0;
int batteryCount = 0;
ulong bpmMillis = 1000;
int bpmValue = 0;
int bpmDirection = 0;
int bmpCount = 0;
/*
RED RA negativ -IN LO-
YELLOW LA positive +IN LO+
GREEN RL
*/
const unsigned char iconStanding [] PROGMEM = {
// 'ludek', 17x48px
0x03, 0xe0, 0x00, 0x07, 0xf0, 0x00, 0x0f, 0xf8, 0x00, 0x0f, 0xf8, 0x00, 0x0f, 0xf8, 0x00, 0x0f,
0xf8, 0x00, 0x07, 0xf0, 0x00, 0x03, 0xe0, 0x00, 0x3f, 0xfe, 0x00, 0x7f, 0xff, 0x00, 0xff, 0xff,
0x80, 0xff, 0xff, 0x80, 0xff, 0xff, 0x80, 0xff, 0xff, 0x80, 0xef, 0xfb, 0x80, 0xef, 0xfb, 0x80,
0xef, 0xfb, 0x80, 0xef, 0xfb, 0x80, 0xef, 0xfb, 0x80, 0xef, 0xfb, 0x80, 0xef, 0xfb, 0x80, 0xef,
0xfb, 0x80, 0xef, 0xfb, 0x80, 0xef, 0xfb, 0x80, 0xef, 0xfb, 0x80, 0xef, 0xfb, 0x80, 0x6f, 0xfb,
0x00, 0x0f, 0xf8, 0x00, 0x0f, 0xf8, 0x00, 0x0f, 0xf8, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00,
0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f,
0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78,
0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x0f, 0x78, 0x00, 0x06, 0x30, 0x00
};
const unsigned char iconLay[] PROGMEM = {
// 'ludek2', 48x24px
0x00, 0x00, 0x00, 0x00, 0x03, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x07, 0xf8, 0x00, 0x00, 0x00, 0x00,
0x0f, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x0f, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x0f, 0xfc, 0x00, 0x00,
0x00, 0x00, 0x0f, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x0f, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x07, 0xfc,
0x00, 0x00, 0x00, 0x00, 0x03, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x0f, 0xe0, 0x00, 0x00, 0x38, 0x00,
0x3f, 0xe0, 0x00, 0x00, 0xfc, 0x00, 0x7f, 0xf0, 0x00, 0x01, 0xfe, 0x00, 0xff, 0xf0, 0x00, 0x03,
0xff, 0x01, 0xff, 0xf8, 0x00, 0x07, 0xff, 0x83, 0xff, 0xf8, 0x00, 0x0f, 0xff, 0xc7, 0xff, 0xfc,
0x00, 0x1f, 0xef, 0xef, 0xff, 0xfe, 0x00, 0x3f, 0xc7, 0xff, 0xfe, 0x3e, 0x00, 0x7f, 0x07, 0xff,
0xfc, 0x1f, 0x00, 0xfe, 0x03, 0xff, 0xf8, 0x0f, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfe, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xfc
};
const unsigned char iconHeart[] PROGMEM = {
// 'heart', 32x32px
0x1f, 0xfc, 0x1f, 0xf0, 0x3f, 0xfe, 0x3f, 0xfc, 0x7f, 0xff, 0xff, 0xfe, 0x7f, 0xff, 0xff, 0xff,
0x7f, 0xbf, 0xfe, 0xff, 0xfe, 0x0f, 0xf8, 0x1f, 0xfc, 0x07, 0xf0, 0x0f, 0xf8, 0x07, 0xf0, 0x07,
0xf0, 0x03, 0xe0, 0x07, 0xf0, 0x01, 0xc0, 0x07, 0xf8, 0x01, 0xc0, 0x07, 0xf8, 0x00, 0x80, 0x0f,
0xf8, 0x00, 0x00, 0x0f, 0xfc, 0x00, 0x00, 0x0f, 0x7e, 0x00, 0x00, 0x1f, 0x7e, 0x00, 0x00, 0x1f,
0x3f, 0x00, 0x00, 0x3f, 0x3f, 0x80, 0x00, 0x7e, 0x1f, 0x80, 0x00, 0xfe, 0x1f, 0xc0, 0x01, 0xfc,
0x0f, 0xe0, 0x03, 0xf8, 0x07, 0xf0, 0x07, 0xf0, 0x03, 0xf8, 0x0f, 0xe0, 0x01, 0xfc, 0x1f, 0xe0,
0x00, 0xfe, 0x3f, 0x80, 0x00, 0x7f, 0x7f, 0x80, 0x00, 0x3f, 0xfe, 0x00, 0x00, 0x1f, 0xfe, 0x00,
0x00, 0x0f, 0xfc, 0x00, 0x00, 0x07, 0xf8, 0x00, 0x00, 0x03, 0xe0, 0x00, 0x00, 0x01, 0xc0, 0x00
};
void wdt_reset()
{
TIMERG0.wdt_wprotect=TIMG_WDT_WKEY_VALUE;
TIMERG0.wdt_feed=1;
TIMERG0.wdt_wprotect=0;
}
//______________________________________________________________________________
void callback(esp_spp_cb_event_t event, esp_spp_cb_param_t *param)
{
if(event == ESP_SPP_SRV_OPEN_EVT)
{
Serial.println("Client Connected");
digitalWrite(LED_PIN, HIGH);
BT_connected = true;
}
if(event == ESP_SPP_CLOSE_EVT)
{
Serial.println("Client disconnected");
digitalWrite(LED_PIN, LOW);
BT_connected = false;
}
}
void checkBattery()
{
batterySum += analogRead(BATTERY_PIN);
batteryCount += 1;
ulong actMillis = millis();
if (actMillis > batteryMillis + 60 * 1000)
{
float voltage_value = (batterySum/batteryCount) / 221.86;
batteryPercentage = ((voltage_value - 2.9)/1.3) * 100;
if (batteryPercentage > 100) batteryPercentage = 100;
batteryMillis = actMillis;
batterySum = 0;
batteryCount = 0;
}
}
//______________________________________________________________________________
void displayHeader()
{
display.setCursor(0, 0);
display.setTextSize(1);
display.setTextColor(WHITE);
display.print("LunaECG ");
display.print(batteryPercentage, 1);
display.print("%");
display.setCursor(0, 54); //66X54
display.print("by pixel7");
}
void displayNoConnected()
{
display.setCursor(0, 9);
display.setTextSize(2);
display.setTextColor(WHITE);
switch (connected)
{
case 1:
display.println(" RED PAD");
break;
case 2:
display.println("GREEN PAD");
break;
case 3:
display.println("YELLOW PAD");
break;
}
display.println(" NOT");
display.println(" CONNECTED");
}
void displayMPUdata()
{
sensors_event_t a, g, temp;
mpu.getEvent(&a, &g, &temp);
if (a.acceleration.x > 6)
{
//lezy
display.drawBitmap(65, 27, iconLay, 48, 24, WHITE);
}
else
{
display.drawBitmap(80, 15, iconStanding, 17, 48, WHITE);
}
// display.setCursor(60, 11);
// display.print("x: ");
// display.print(a.acceleration.x, 1);
// display.setCursor(60, 22);
// display.print("y: ");
// display.println(a.acceleration.y, 1);
// display.setCursor(60, 33);
// display.print("z: ");
// display.println(a.acceleration.z, 1);
// display.println("Gyro - rps");
// display.print(g.gyro.x, 1);
// display.print(", ");
// display.print(g.gyro.y, 1);
// display.print(", ");
// display.print(g.gyro.z, 1);
// display.println("");
}
void displayChart(int width)
{
int temp = chartMax - chartMin;
if (temp == 0) temp = 63;
temp = 64 / temp;
if (temp == 0) temp = 63;
if (400 < chartMin && chartMin < 1250 && 2000 < chartMax && chartMax < 2450)
{
//górne 2000 do 2300
//dolne 700 min 950 max
for(int x =0; x< width; x++)
{
int y = 64- ((chartData[x]-chartMin)/temp) - 11;
if (y < 11)
{
display.drawPixel(x, 11, BLACK);
}
else
{
display.drawPixel(x, y, WHITE);
}
}
}
else
{
//display.drawBitmap(16, 20, iconHeart, 32, 32, WHITE);
}
display.setCursor(0, 20);
display.println(chartMax);
display.println(chartMin);
display.println(chartMax - chartMin);
display.println(chartData[0]);
display.setCursor(60, 0);
display.print(bpmValue);
display.print("bpm");
}
void displaySplash()
{
display.clearDisplay();
display.setTextSize(2);
display.setTextColor(WHITE);
display.setCursor(20, 0);
display.print("LunaECG");
display.display();
delay(100);
display.startscrollright(0x00, 0x0F);
delay(200);
display.stopscroll();
delay(1000);
display.clearDisplay();
}
void displayFrame()
{
display.clearDisplay();
checkBattery();
displayHeader();
if(connected == 0)
{
displayChart(55);
displayMPUdata();
}
else
{
displayNoConnected();
}
display.display();
}
//______________________________________________________________________________
void checkBMP(int samp, int actMillis)
{
if (samp < 1300 && bpmDirection == 0)
{
bpmDirection = 1;
int temp = 60000 / (actMillis - bpmMillis);
if (temp < 220 && temp > 30) bpmValue = temp;
bpmMillis = actMillis;
}
if (samp > 1600 && bpmDirection == 1)
{
bpmDirection = 0;
}
}
void checkEcg(void * parameter)
{
for(;;)
{
lominus = digitalRead(LOMINUS_PIN);
loplus = digitalRead(LOPLUS_PIN);
if((lominus == 0)||(loplus == 0))
{
int ecgAnalogRead = analogRead(ECG_PIN);
samplesSum += ecgAnalogRead;
SamplesCount += 1;
ulong actMillis = millis();
if (actMillis > ecgMillis + ECGINTERVAL)
{
chartMax = 0;
chartMin = 10000;
ecgMillis = actMillis;
for (int i = 0; i < (ECGLEN-1); i++)
{
int temp = chartData[i+1];
chartData[i] = temp;
if(temp > chartMax)chartMax = temp;
if(temp < chartMin)chartMin = temp;
}
int samp = samplesSum/SamplesCount;
chartData[ECGLEN-1] = samp;
if (BT_connected)
{
ESP_BT.println(samp);
}
Serial.println(samp);
checkBMP(samp, actMillis);
connected = 0;
samplesSum = 0;
SamplesCount = 0;
}
}
else
{
if (lominus == 1 && loplus == 0) connected = 1;
if (lominus == 0 && loplus == 1) connected = 2;
if (lominus == 1 && loplus == 1) connected = 3;
}
}
}
//______________________________________________________________________________
void setup()
{
pinMode(LED_PIN, OUTPUT);
pinMode(LOPLUS_PIN, INPUT);
pinMode(LOMINUS_PIN, INPUT);
Serial.begin(115200);
Wire.begin(23,19);
if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C, false, false))
Serial.println(F("SSD1306 allocation failed"));
displaySplash();
ESP_BT.register_callback(callback);
if(!ESP_BT.begin("Luna_ECG"))
Serial.println("An error occurred initializing Bluetooth");
if (!mpu.begin())
Serial.println("Sensor init failed");
xTaskCreatePinnedToCore(checkEcg, "checkEcg", 10000, NULL, 1, &taskcheckEcg, 0);
}
void loop()
{
displayFrame();
wdt_reset();
}
