Med Matrix Sentinel Wearable

#define I2C_SCL 7
#define SOS_BUTTON_PIN 4
#define GSM_TX_PIN 21
#define LORA_MISO_PIN 3
#define LORA_SCK_PIN 0
#define LORA_RESET_PIN 2
#define LORA_DIO0_PIN 5
#define TINY_GSM_MODEM_SIM808
#include <Arduino.h>
#include <Wire.h>
#include <SPI.h>
#include <LoRa.h>
#include <BLEDevice.h>
#include <BLEServer.h>
#include <BLEUtils.h>
#include <BLE2902.h>
#include <Adafruit_DRV2605.h>
#include <Adafruit_ADXL345_U.h>
#include <Adafruit_TMP117.h>
#include <Adafruit_BME280.h>
#include <TinyGsmClient.h>
#include <SparkFun_BMV080_Arduino_Library.h>
#include "maxm86161.h"


// Forward declarations
int pm25ToAqi(float p);
void buzz(uint8_t effect);
void publish();
void setRisk(String r);
void loraTransmit(const char *kind);
void updateGps(uint32_t timeoutMs);
void sendSms(const char *why);
void emergency(const char *why);
void sample();
void sampleAir();
void evaluate();
void setupBle();

constexpr int I2C_SDA = 6, I2C_SCL = 7, SOS_BUTTON_PIN = 4;
constexpr int GSM_RX_PIN = 20, GSM_TX_PIN = 21;
constexpr int LORA_MOSI_PIN = 10, LORA_MISO_PIN = 3, LORA_SCK_PIN = 0;
constexpr int LORA_NSS_PIN = 1, LORA_RESET_PIN = 2, LORA_DIO0_PIN = 5;
constexpr uint32_t SAMPLE_MS = 100, AIR_MS = 1000, SOS_HOLD_MS = 2000;
constexpr uint32_t GPS_PERIOD_MS = 20UL * 60UL * 1000UL;
constexpr uint32_t LORA_BEACON_MS = 15UL * 60UL * 1000UL;
constexpr float FALL_G = 2.35f, HIGH_SKIN_C = 38.0f, HIGH_AIR_C = 40.0f;
constexpr uint8_t BMV080_ADDR = 0x57;
constexpr long LORA_FREQUENCY_HZ = 866000000;
const char EMERGENCY_NUMBER[] = "+918739951837";
const char BLE_SERVICE_UUID[] = "6b5b1c4d-6b86-4d4b-8b19-5f1c3a020001";
const char BLE_STATUS_UUID[] = "6b5b1c4d-6b86-4d4b-8b19-5f1c3a020002";

Adafruit_DRV2605 haptic;
Adafruit_ADXL345_Unified accel(12345);
Adafruit_TMP117 tmp117;
Adafruit_BME280 bme;
SparkFunBMV080 bmv080;
HardwareSerial modemSerial(1);
TinyGsm modem(modemSerial);
BLECharacteristic *statusChar = nullptr;
bool hapticOK=false, accelOK=false, tmpOK=false, bmeOK=false, pmOK=false, modemOK=false, loraOK=false;
bool sos=false, smsSent=false, alertSent=false;
uint32_t buttonAt=0, lastSample=0, lastAir=0, lastGps=0, lastBeacon=0;
float hr=0, spo2=0, skinC=0, airC=0, humidity=0, pm25=0, motionG=1;
int aqi=-1;
String risk="STARTING", latitude="", longitude="";

int pm25ToAqi(float p) {
  if (p < 0) return -1;
  struct B{float cl,ch;int il,ih;}; const B b[]={{0,12,0,50},{12.1,35.4,51,100},{35.5,55.4,101,150},{55.5,150.4,151,200},{150.5,250.4,201,300},{250.5,350.4,301,400},{350.5,500.4,401,500}};
  p=floorf(p*10)/10; if(p>500.4) return 500; for(auto &x:b) if(p>=x.cl&&p<=x.ch) return round(((float)(x.ih-x.il)/(x.ch-x.cl))*(p-x.cl)+x.il); return -1;
}
void buzz(uint8_t effect){if(hapticOK){haptic.setWaveform(0,effect);haptic.setWaveform(1,0);haptic.go();}}
void publish(){if(!statusChar)return; String m="state="+risk+",hr="+String(hr,0)+",spo2="+String(spo2,0)+",skinC="+String(skinC,1)+",airC="+String(airC,1)+",humidity="+String(humidity,0)+",pm25="+String(pm25,1)+",aqi="+String(aqi)+",lat="+latitude+",lon="+longitude;statusChar->setValue(m.c_str());statusChar->notify();}
void setRisk(String r){if(r==risk)return;risk=r;if(r=="SOS")buzz(82);else if(r=="ALERT")buzz(47);publish();}
void loraTransmit(const char *kind){if(!loraOK)return; LoRa.beginPacket();LoRa.print("SENTINEL,");LoRa.print(kind);LoRa.print(",");LoRa.print(aqi);LoRa.print(",");LoRa.print(latitude);LoRa.print(",");LoRa.print(longitude);LoRa.endPacket();}
void updateGps(uint32_t timeoutMs){if(!modemOK)return; modem.sendAT("+CGNSPWR=1"); uint32_t until=millis()+timeoutMs; while(millis()<until){modem.sendAT("+CGNSINF");String line=modemSerial.readStringUntil('\n');if(line.indexOf("+CGNSINF:")>=0){int fields=0,start=line.indexOf(':')+1;String f[10];for(int i=start;i<(int)line.length()&&fields<10;i++){if(line[i]==','){fields++;continue;}f[fields]+=line[i];}if(f[1]=="1"&&f[3].length()>3&&f[4].length()>3){latitude=f[3];longitude=f[4];break;}}delay(1000);} modem.sendAT("+CGNSPWR=0"); publish();}
void sendSms(const char *why){if(smsSent||!modemOK)return;String t="Med Matrix Sentinel "+String(why)+". HR "+String(hr,0)+" bpm, SpO2 trend "+String(spo2,0)+"%, AQI "+String(aqi)+", GPS "+latitude+","+longitude+".";if(modem.sendSMS(EMERGENCY_NUMBER,t))smsSent=true;}
void emergency(const char *why){if(alertSent)return;alertSent=true;setRisk("SOS");updateGps(30000);loraTransmit("SOS");sendSms(why);}
void sample(){hrm_loop_process();int h=hrm_get_heart_rate(),o=hrm_get_spo2();if(h>=35&&h<=220)hr=h;if(o>=70&&o<=100)spo2=o;if(accelOK){sensors_event_t e;accel.getEvent(&e);motionG=sqrtf(e.acceleration.x*e.acceleration.x+e.acceleration.y*e.acceleration.y+e.acceleration.z*e.acceleration.z)/SENSORS_GRAVITY_STANDARD;if(motionG>=FALL_G)emergency("possible fall");}if(tmpOK){sensors_event_t e;tmp117.getEvent(&e);if(e.temperature>15&&e.temperature<45)skinC=e.temperature;}if(bmeOK){airC=bme.readTemperature();humidity=bme.readHumidity();}}
void sampleAir(){if(!pmOK||millis()-lastAir<AIR_MS)return;lastAir=millis();if(bmv080.readSensor()){pm25=bmv080.PM25();aqi=pm25ToAqi(pm25);publish();}}
void evaluate(){if(sos||alertSent)return;bool bad=hr>=130||(hr>=35&&hr<=40)||(spo2>=70&&spo2<=90)||skinC>=HIGH_SKIN_C||airC>=HIGH_AIR_C||aqi>=151;setRisk(bad?"ALERT":"OK");}
void setupBle(){BLEDevice::init("MedMatrix-Sentinel");BLEServer *s=BLEDevice::createServer();BLEService *v=s->createService(BLE_SERVICE_UUID);statusChar=v->createCharacteristic(BLE_STATUS_UUID,BLECharacteristic::PROPERTY_READ|BLECharacteristic::PROPERTY_NOTIFY);statusChar->addDescriptor(new BLE2902());v->start();BLEAdvertising *a=BLEDevice::getAdvertising();a->addServiceUUID(BLE_SERVICE_UUID);a->start();}
void setup(){Serial.begin(115200);pinMode(SOS_BUTTON_PIN,INPUT_PULLUP);Wire.begin(I2C_SDA,I2C_SCL);hrm_init();hapticOK=haptic.begin();if(hapticOK)haptic.selectLibrary(1);accelOK=accel.begin();if(accelOK)accel.setRange(ADXL345_RANGE_16_G);tmpOK=tmp117.begin();bmeOK=bme.begin(0x77);pmOK=bmv080.begin(BMV080_ADDR,Wire);if(pmOK){bmv080.init();pmOK=bmv080.setMode(SF_BMV080_MODE_CONTINUOUS);}modemSerial.begin(9600,SERIAL_8N1,GSM_RX_PIN,GSM_TX_PIN);delay(3000);modemOK=modem.testAT(10000);if(modemOK)modem.sendAT("+CMGF=1");SPI.begin(LORA_SCK_PIN,LORA_MISO_PIN,LORA_MOSI_PIN,LORA_NSS_PIN);LoRa.setPins(LORA_NSS_PIN,LORA_RESET_PIN,LORA_DIO0_PIN);loraOK=LoRa.begin(LORA_FREQUENCY_HZ);setupBle();setRisk("OK");buzz(1);}
void loop(){uint32_t n=millis();if(digitalRead(SOS_BUTTON_PIN)==LOW){if(!buttonAt)buttonAt=n;if(!sos&&n-buttonAt>=SOS_HOLD_MS){sos=true;emergency("SOS button held");}}else{buttonAt=0;sos=false;}if(n-lastSample>=SAMPLE_MS){lastSample=n;sample();sampleAir();evaluate();}if(n-lastGps>=GPS_PERIOD_MS){lastGps=n;updateGps(10000);}if(n-lastBeacon>=LORA_BEACON_MS){lastBeacon=n;loraTransmit("BEACON");}}