// MCU BASIC: https://www.basic4mcu.com
// DateTime : 2019-07-26 오후 5:07:02
// by Ok-Hyun Park
//
#include <LiquidCrystal.h>
LiquidCrystal lcd(12,11,5,4,3,2);
//
#define A_motor_L_BUTTON  24
#define A_motor_R_BUTTON  6
#define A_motor_S_BUTTON  22
//
int A_motor_L=7,A_motor_R=8,A_motor_S=9,ledPower=10,dustPin=A5;
//
int mode='L',position=0,target=0; // 초기 LEFT 위치에서 시작한다고 가정 
//
void m_L(){ digitalWrite(A_motor_L,1); digitalWrite(A_motor_R,0); }  
void m_R(){ digitalWrite(A_motor_L,0); digitalWrite(A_motor_R,1); }
void m_S(){ digitalWrite(A_motor_L,0); digitalWrite(A_motor_R,0); }
//
void setup(){
  pinMode(ledPower,OUTPUT);
  pinMode(A_motor_L,OUTPUT); pinMode(A_motor_R,OUTPUT);
  analogWrite(A_motor_S,100);
  lcd.begin(16,2); lcd.print("Air Quality!");
}
//
void loop(){
  delay(1000);
  //
  digitalWrite(ledPower,0);          delayMicroseconds(280);
  float dustVal=analogRead(dustPin); delayMicroseconds(40);
  digitalWrite(ledPower,1);          delayMicroseconds(9680);
  //
  float dustDensity=(0.172*(dustVal*(5/1024.0))-0.0999)*1000;
  lcd.setCursor(0,1); lcd.print("Dust: "); lcd.print(dustDensity); lcd.print("ug/m3    ");  
  //------------------------------------------------------------
  if(dustDensity>500){
    if(mode!='L'){ mode='L'; target=0; }
  }
  else if(dustDensity<80){
    if(mode!='R'){ mode='R'; target=5; }
  }
  //------------------------------------------------------------
  if(digitalRead(A_motor_L_BUTTON)){ mode='L'; target=0; }
  if(digitalRead(A_motor_R_BUTTON)){ mode='R'; target=5; }
  if(digitalRead(A_motor_S_BUTTON)){ mode='S'; }
  //
  if(mode=='S'){
    m_S();
  }
  else{ // mode='L' or mode='R'
    if     (position<target){ position++; m_R(); }
    else if(position>target){ position--; m_L(); }
    else                    { mode='S';   m_S(); } // position==target
  }
}