// MCU BASIC: https://www.basic4mcu.com
// DateTime : 2020-04-28 오후 6:08:50
// by Ok-Hyun Park
//
#include <Wire.h>
#include <Adafruit_MLX90614.h>
#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd(0x3F,16,2);
Adafruit_MLX90614 mlx=Adafruit_MLX90614();
//
#include <Servo.h>
Servo myservo1;
Servo myservo2;
//
int trig=6,echo=7;
//
void setup(){
  pinMode(trig,OUTPUT); pinMode(echo,INPUT);
  myservo1.attach(9);
  myservo2.attach(10);
  lcd.init(); lcd.backlight();
  mlx.begin();
  Serial.begin(9600);
}
//
void loop(){
  digitalWrite(trig,HIGH); delayMicroseconds(10); digitalWrite(trig,LOW);
  unsigned long duration=pulseIn(echo,HIGH);
  float distance=duration/29.0/2.0;
  if(distance<10){ myservo1.write(180); myservo2.write(0); }
  else           { myservo1.write(0); myservo2.write(180); }
  //
  String strTemp=String("");
  strTemp+=(int)(mlx.readObjectTempC());
  lcd.setCursor(2,0); lcd.print("Temperature");
  lcd.setCursor(6,1); lcd.print(strTemp);
  lcd.setCursor(8,1); lcd.print("'C");
  delay(1000);
}