#include <FPS_GT511C3.h>
#include <SoftwareSerial.h>
#include <Servo.h>
#include <LiquidCrystal.h>


Servo sv; //서브모터 변수 설정 (▲서브모터)
int sensor=9; // 센서의 signal 선을 7번에 연결(★인체감지)
int LCD_LED = 10; // LCD백라이트 조절(●LCD)
LiquidCrystal LCD(12,11,7,6,5,4); //(●LCD)
FPS_GT511C3 fps(2, 3); //지문인식 핀

void setup()
{
sv.attach(8); //(▲서브모터)
pinMode(sensor, INPUT); //(★인체감지)
pinMode(LCD_LED, OUTPUT); //LCD백라이트(●LCD)

Serial.begin(9600); // 통신속도 9600bps로 시리얼 통신 시작
while(!Serial);
Serial.println("통신 연결 완료!");

LCD.begin(16,2); //LCD 크기 설정(●LCD)
}


void loop(){
int val= digitalRead(sensor); //(★인체감지)

if(val==1){
LCD.clear(); //(●LCD)
LCD.print("WELCOME");//(●LCD)
LCD.setCursor(0,1); //(●LCD)
LCD.print("Put Your finger");//(●LCD)
digitalWrite(LCD_LED,HIGH); //(●LCD)

Serial.println("감지 O");
delay(100);

fps.Open();
fps.SetLED(true);

//지문인식센서=========
if(fps.IsPressFinger()){
fps.CaptureFinger(false);
int id = fps.Identify1_N();
if (id < 200) {  //지문인식이 되었을 때
Serial.print("Verified ID:");
Serial.println(id);
LCD.clear();
LCD.setCursor(0,0);
LCD.print(" Verified!");
sv.write(180);//=============(지문인식 완료 됬을 때 ▲서보모터)
} else { //지문이 저장한 것과 다를때
Serial.println("Finger not found");
LCD.clear();
LCD.setCursor(0,0);
LCD.print("Who are you?");
}
} else { //기본 대기 상태
Serial.println("Please press finger");
}
}
else//=================================== 인체감지 없을 때
{
Serial.println("감지 X");
delay(100);

LCD.clear();
fps.Close();
fps.SetLED(false);
digitalWrite(LCD_LED,LOW);

sv.write(0);
}
}

저 코딩으로 컴파일 할 시에 서보모터가 계속 떨림 현상(?)이 일어납니다ㅠㅠ 또한 지문인식을 하였을 때 LCD에 출력이 되지 않더라고요.. 이 부분에 대해서 어떻게 하면 될지 죄송스럽게 여쭤봅니다