Устройство предупреждения о повышенной температуре тела

#include <Wire.h>

//LED

#include <FastLED.h>

#define LED_TYPE  WS2811

#define COLOR_ORDER GRB

#define NUM_LEDS  6

CRGB leds[NUM_LEDS];

#define DATA_PIN  2

#define  SSD1306_BLACK  0

#define  SSD1306_WHITE  1

#define  SSD1306_INVERSE  2

#define BRIGHTNESS     96

int indexLight=0;

bool interruptOccurred = false;

void interruptCallback(){

  interruptOccurred = true;

}

//range sensor

#include <VL53L1X.h>

VL53L1X RangeSensor;

//thermal camera

#include <Adafruit_MLX90614.h>

Adafruit_MLX90614 MLX90614 = Adafruit_MLX90614();

//lcd screen

#include <ArducamSSD1306.h>  // Modification of Adafruit_SSD1306 for ESP8266 compatibility

#define OLED_RESET 16 // Pin 15 -RESET digital signal

#define LOGO16_GLCD_HEIGHT 16

#define LOGO16_GLCD_WIDTH 16

ArducamSSD1306 display(OLED_RESET); // FOR I2C

//timer motion

unsigned long DELAY_TIME = 5000; // 5 sec

unsigned long delayStart = 0; // the time the delay started

bool delayRunning = false; // true if still waiting for delay to finish

void setup() {

 //serial monitor

 Serial.begin(115200);

 Wire.begin();

 Wire.setClock(400000); // use 400 kHz I2C

 InitRangeSensor();

 //buzzer

 pinMode(5, OUTPUT);

 //motion

 pinMode(1, INPUT);

 //thermal camera

 MLX90614.begin();  

 //led

 FastLED.addLeds<LED_TYPE,DATA_PIN,COLOR_ORDER>(leds, NUM_LEDS).setCorrection(TypicalLEDStrip);

 FastLED.setBrightness(BRIGHTNESS);  

 //blue led

 setcolor(3);

 // start measuring time for motion sensor

 delayStart = millis();

 //LCD display init

 display.begin(); // Switch OLED

 display.clearDisplay();

 display.setTextSize(2);

 display.setTextColor(WHITE);

 display.display();

 ShowLabel("Init...");

 //ConnectWifi();

}

void loop() {

 indexLight++;

 int Motion = digitalRead(1);

 double range=RangeSensor.ranging_data.range_mm;

 range=RangeSensor.read();

 Serial.println(range);

 if ((Motion) || (range<700)){

  delayStart = millis();

  //Serial.println("Motion");

  }

 else{

  //Serial.println("No presence");

 }

 if (millis() - delayStart < DELAY_TIME) 

 {

  //double TempObject=MLX90614.readObjectTemp();

  double TempObject=MLX90614.readObjectTempC();

  Serial.println(TempObject);

  if (range<700)

  {

   ShowMeasures(TempObject,range);

   if (TempObject>32) 

   {

    //tone(5, 1000);

    setcolor(1);

   }

   else if (TempObject>29) 

   {

    setcolor(4);

    //noTone(5); 

    //indexLight=0;

   }

   else 

   {

    setcolor(2);

    //noTone(5); 

   }

  }

  else{

   setcolor(5);

   //noTone(5); 

   ShowLabel("Too far");

  }

  delay(200);

 }

 else

 {

  //noTone(5);

  setcolor(0);

  ShowLabel("No Motion");

  }

}

void InitRangeSensor()

{

// Enable the data ready interrupts

 /*sensor.enableInterruptOnDataReady();

 sensor.startMeasurement();*/

 RangeSensor.setTimeout(500);

 if (!RangeSensor.init())

 {

  Serial.println("Failed to detect and initialize sensor!");

  while (1);

 }

 // Use long distance mode and allow up to 50000 us (50 ms) for a measurement.

 // You can change these settings to adjust the performance of the sensor, but

 // the minimum timing budget is 20 ms for short distance mode and 33 ms for

 // medium and long distance modes. See the VL53L1X datasheet for more

 // information on range and timing limits.

 RangeSensor.setDistanceMode(VL53L1X::Long);

 RangeSensor.setMeasurementTimingBudget(50000);


 // Start continuous readings at a rate of one measurement every 50 ms (the

 // inter-measurement period). This period should be at least as long as the

 // timing budget.

 RangeSensor.startContinuous(50);

 }

void setcolor(int Color)

{

 double Rvalue1=255, Rvalue2=128;

 for (int i=0;i<NUM_LEDS;i++)

 {

  if (Color==0) //off

   leds[i] = CRGB(0,0,0);

  else if (Color==1) //red

   leds[i] = CRGB(255,0,0);

  else if (Color==2) //Green

   leds[i] = CRGB(0,255,0);

  else if (Color==3) //Blue

   leds[i] = CRGB(0,0,255);

  else if (Color==4) //yellow

   leds[i] = CRGB(255,128,0); 

  else if (Color==5) //white

   leds[i] = CRGB(255,255,255); 

 }

 FastLED.show();  

 //delay(17);

}

double getcolorintensity(int timelength,int NumLed,int Compression,int LedCycle)

{

 double Rvalue = 0.5*pow(((sin(-1.570796+(1.047198*NumLed)+(timelength*6.28319/LedCycle))+1)/2),Compression);

 return Rvalue;

}

void ShowMeasures(double temperature, double range)

{

 display.clearDisplay();

 display.setCursor(10,20);

 display.print(temperature);

 display.setCursor(55,20);

 display.print(" C");

 String stringOne = String(range/10,0)+" cm"; 

 display.setCursor(10,40);

 display.print(stringOne);

 display.display();

}

void ShowLabel(char Label[])

{

 display.clearDisplay();

 display.setCursor(5,30);

 display.print(Label);

 display.display();

}

void testdrawline() {

 int16_t i;

 display.clearDisplay(); // Clear display buffer

 for(i=0; i<display.width(); i+=4) {

  display.drawLine(0, 0, i, display.height()-1, SSD1306_WHITE);

  display.display(); // Update screen with each newly-drawn line

  delay(1);

 }

 for(i=0; i<display.height(); i+=4) {

  display.drawLine(0, 0, display.width()-1, i, SSD1306_WHITE);

  display.display();

  delay(1);

 }

 delay(250);

 display.clearDisplay();

 for(i=0; i<display.width(); i+=4) {

  display.drawLine(0, display.height()-1, i, 0, SSD1306_WHITE);

  display.display();

  delay(1);

 }

 for(i=display.height()-1; i>=0; i-=4) {

  display.drawLine(0, display.height()-1, display.width()-1, i, SSD1306_WHITE);

  display.display();

  delay(1);

 }

 delay(250);

 display.clearDisplay();

 for(i=display.width()-1; i>=0; i-=4) {

  display.drawLine(display.width()-1, display.height()-1, i, 0, SSD1306_WHITE);

  display.display();

  delay(1);

 }

 for(i=display.height()-1; i>=0; i-=4) {

  display.drawLine(display.width()-1, display.height()-1, 0, i, SSD1306_WHITE);

  display.display();

  delay(1);

 }

 delay(250);

 display.clearDisplay();

 for(i=0; i<display.height(); i+=4) {

  display.drawLine(display.width()-1, 0, 0, i, SSD1306_WHITE);

  display.display();

  delay(1);

 }

 for(i=0; i<display.width(); i+=4) {

  display.drawLine(display.width()-1, 0, i, display.height()-1, SSD1306_WHITE);

  display.display();

  delay(1);

 }

 delay(2000); // Pause for 2 seconds

}