#include <LiquidCrystal.h>
LiquidCrystal lcd(8, 9, 4, 5, 6, 7);
#include <Servo.h> 
Servo myservo; 
int cont=0;
int LED=12;
int LED2=13;
int rele=A4;
#include <Adafruit_Fingerprint.h>
 
SoftwareSerial mySerial(2, 3);
Adafruit_Fingerprint finger = Adafruit_Fingerprint(&mySerial);
 
void setup()  
{
  lcd.begin(16, 2);   
  lcd.setCursor(0,0); //LCD ì»¤ì„œ ìœ„치 ì„¤ì •
  lcd.clear(); // LCD ì´ˆê¸°í™”
  myservo.attach(A5); // ì„œë³´ëª¨í„° attachì—ì„œ A5번엠연결
  pinMode(LED,OUTPUT); // 
  pinMode(LED2,OUTPUT);
  pinMode(rele,OUTPUT);
  digitalWrite(rele,0);
  Serial.begin(9600);
  
  while (!Serial);  // For Yun/Leo/Micro/Zero/...
  delay(100);
 
  //2
  Serial.println("\n\nfinger detecter");
  lcd.print("finger detecter");
   // set the data rate for the sensor serial port
  finger.begin(57600);
 
  if (finger.verifyPassword()) {
    Serial.println("Found fingerprint sensor!");
  } 
  else {
    Serial.println("Did not find fingerprint sensor :(");
    while (1) { delay(1); }
  }
 
  finger.getTemplateCount();
  Serial.print("Sensor contains "); 
  Serial.print(finger.templateCount); 
  Serial.println(" templates");
  Serial.println("Waiting for valid finger...");
  lcd.clear();
  }
 
 
//3
void loop()                     // run over and over again
{
  delay(50);
  getFingerprintIDez();
  
  digitalWrite(LED,cont);
  digitalWrite(LED2,!cont);
  digitalWrite(rele,cont);
  delay(50);
  lcd.setCursor(0, 0);
  lcd.print("Found ID #"); 
  lcd.print(finger.fingerID);  
  
  if(cont == 1){
    lcd.setCursor(0, 1);
    lcd.print("POWER = ON  ");
    myservo.write(0);
  }
  else{
    lcd.setCursor(0, 1);
    lcd.print("POWER = OFF ");   
    myservo.write(90);
  
  }
  //don't ned to run this at full speed.
}
 //4
uint8_t getFingerprintID() {
  uint8_t p = finger.getImage();
  switch (p) {
    case FINGERPRINT_OK:
      //Serial.println("Image taken");
      break;
    case FINGERPRINT_NOFINGER:
      //Serial.println("No finger detected");
      return p;
    case FINGERPRINT_PACKETRECIEVEERR:
      //Serial.println("Communication error");
      return p;
    case FINGERPRINT_IMAGEFAIL:
      //Serial.println("Imaging error");
      return p;
    default:
      //Serial.println("Unknown error");
      return p;
  }
 // 5
  // OK success!
 
  p = finger.image2Tz();
  switch (p) {
    case FINGERPRINT_OK:
      //Serial.println("Image converted");
      break;
    case FINGERPRINT_IMAGEMESS:
      //Serial.println("Image too messy");
      return p;
    case FINGERPRINT_PACKETRECIEVEERR:
      //Serial.println("Communication error");
      return p;
    case FINGERPRINT_FEATUREFAIL:
      //Serial.println("Could not find fingerprint features");
      return p;
    case FINGERPRINT_INVALIDIMAGE:
      //Serial.println("Could not find fingerprint features");
      return p;
    default:
      //Serial.println("Unknown error");
      return p;
  }
 
 
  //6
  // OK converted!
  p = finger.fingerFastSearch();
  if (p == FINGERPRINT_OK) {
    //Serial.println("Found a print match!");
  } else if (p == FINGERPRINT_PACKETRECIEVEERR) {
    //Serial.println("Communication error");
    return p;
  } else if (p == FINGERPRINT_NOTFOUND) {
    //Serial.println("Did not find a match");
    return p;
  } else {
    //Serial.println("Unknown error");
    return p;
  }   
  
  // found a match!
  Serial.print("Found ID #"); Serial.print(finger.fingerID); 
  Serial.print(" with confidence of "); Serial.println(finger.confidence); 
 
  return finger.fingerID;
}
 
 
// 7
// returns -1 if failed, otherwise returns ID #
int getFingerprintIDez() {
  uint8_t p = finger.getImage();
  if (p != FINGERPRINT_OK)  return -1;
 
  p = finger.image2Tz();
  if (p != FINGERPRINT_OK)  return -1;
 
  p = finger.fingerFastSearch();
  if (p != FINGERPRINT_OK)  return -1;
  
  // found a match!
  
  Serial.print("Found ID #"); Serial.print(finger.fingerID); 
  Serial.print(" with confidence of "); Serial.println(finger.confidence);
  if(finger.confidence >= 100){
  Serial.println("Identical" );
  cont=!cont;
   }
  else{
  Serial.println("retouch");  
  }
  Serial.println(cont);
  return finger.fingerID;
}