#include <SPI.h>
#include <Wire.h>
#include <Adafruit_MLX90614.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

// LCD初期設定
#define SCREEN_WIDTH 128 // OLED display width, in pixels
#define SCREEN_HEIGHT 32 // OLED display height, in pixels
// Declaration for an SSD1306 display connected to I2C (SDA, SCL pins)
#define OLED_RESET     4 // Reset pin # (or -1 if sharing Arduino reset pin)
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

//超音波距離センサ定数設定
#define TrigPin 8 // Trig Pin定義
#define EchoPin 9 // Echo Pin定義
#define OK_DISTANCE 7.0 // 測定は7cm以内

// スピーカー定数設定
#define BEATTIME 500 //音を出している時間(msec)
#define SPEAKER 12 //スピーカーの出力ピン番号]
#define OK_SOUND 1046.502
#define NG_SOUND 500.0

// 温度センサー初期設定
#define TEMP_THRESHOLD 37.0
#define ADJUST_TEMP 3.7
Adafruit_MLX90614 mlx = Adafruit_MLX90614();


//初期設定
void setup() {
  Serial.begin(9600);
  mlx.begin();
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  pinMode( TrigPin, OUTPUT ); //デジタル入出力のTrigpinをOUTPUTに指定
  pinMode( EchoPin, INPUT ); //デジタル入出力のEchopinをINPUTに指定
  display.setTextColor(SSD1306_WHITE); // Draw white text
  display_text("Temp?");

}

//ループ関数
void loop() {
  float temp;

  temp = mlx.readObjectTempC();
  Serial.print("Temp, ");
  Serial.println(temp); //シリアルモニタに計算した距離を表示

  if(is_distance_ok()){
    temp = read_temp_sensor() + ADJUST_TEMP;
    display_temp(temp);
    if(temp < TEMP_THRESHOLD){
      play_sound(OK_SOUND, 100, 2);
      delay(3000);
      display_text("Temp?");
    }else{
      play_sound(NG_SOUND, 500, 2);
      delay(3000);
      display_text("Temp?");
    }
  }else if(temp > 28.0){
    play_sound(NG_SOUND, 100, 5);
    display_text("Too far!");
    delay(500);
  }
  delay(500);
}

void play_sound(float freq, int beattime, int number){
  for(int i=0; i<number; i++){
    tone(SPEAKER,freq,beattime) ; // ド
    delay(beattime);
  }
}

void display_text(char* text){
      display.clearDisplay();
      display.setTextSize(2);      // Normal 2x2 pixel scale
      display.setCursor(0, 0);     // Start at top-left corner
      display.cp437(true);         // Use full 256 char 'Code Page 437' font
      display.print(text);
      display.display();
}

void display_temp(float number){
      display.clearDisplay();
      display.setTextSize(4);      // Normal 4x4 pixel scale
      display.setCursor(0, 0);     // Start at top-left corner
      display.cp437(true);         // Use full 256 char 'Code Page 437' font
      display.print(number);
      display.display();
}

int is_distance_ok(){
  float ProDelay = 0; //Echo出力のHigh期間を格納する変数
  float Distance = 0; //計算した距離を格納する変数

  digitalWrite(TrigPin, LOW); //TrigpinからLOWを出力
  delayMicroseconds(10); //10μs待機

  //超音波を出力するためのトリガ信号生成
  digitalWrite( TrigPin, HIGH ); //トリガ信号Highパルスエッジ
  delayMicroseconds( 10 ); //トリガ信号パルス幅10μsを生成
  digitalWrite( TrigPin, LOW ); //トリガ信号Lowパルスエッジ

  ProDelay = pulseIn( EchoPin, HIGH ); //Echopinに入力されるEchoピンのHigh期間を測定
  Distance = 340*ProDelay/2/10000; // 音速340m/sとして距離の計算とcmへの換算
  Serial.print("Distance, "); //わかりやすくするため、シリアルモニタにDistance：を表示
  Serial.println(Distance); //シリアルモニタに計算した距離を表示
  if(Distance > 0 && Distance < OK_DISTANCE){
    return 1;
  }else{
    return 0;
  }
}

float read_temp_sensor(){
  float temp_old;
  float temp_new;

  temp_old = mlx.readObjectTempC();
  for(int i=0; i<8; i++){
    temp_new = mlx.readObjectTempC();
    if(temp_new > temp_old){
      temp_new = temp_old;
    }
    delay(50);
  }
  Serial.print("Temp_fixed, ");
  Serial.println(temp_new); //シリアルモニタに測定した体温を表示

  return temp_new;
}