23조 - 스물셋

#include <Servo.h> #include <Wire.h> #include <hd44780.h> #include<hd44780ioClass/hd44780_I2Cexp.h> Servo servo_45c4; hd44780_I2Cexp lcd; int value=0; int angle = 0; int trig =12; int echo=13; float distance = 0; float duration =0; void setup() { // put your setup code here, to run once: Serial.begin(9600); servo_45c4.attach(8); lcd.begin(16,2); pinMode(2,INPUT_PULLUP); pinMode(3,INPUT_PULLUP); pinMode(4,INPUT_PULLUP); pinMode(5,INPUT_PULLUP); pinMode(trig, OUTPUT); pinMode(echo, INPUT); } void loop() { // 초음파 센서를 통해 측정값(trig)값을 받아들이고 거리를 계산하는 코드 digitalWrite(trig,HIGH); delay(1); digitalWrite(trig,LOW); duration = pulseIn(echo,HIGH); distance = ((float)(duration * 340) / 10000) / 2 ; //value값이 0 이고 측정거리가 5 보다 작은면 ==> 한명이 탑승해있고 헬멧을 착용한 상태 if(value ==0 && (distance >5) ) { lcd.init(); //LCD클리어 lcd.setCursor(0,0); //각 코드의 문구를 각각 LCD에 축력 lcd.print("Kickboard in use"); lcd.setCursor(0,1); lcd.print("plz hemlt,alone"); angle +=20; //각도 20씩 증가시켜 회전 180도가 되면 0으로 reset if(angle ==180) angle =0; } servo_45c4.write(angle); if(distance<5 ) //초음파 측정거리가 5이상일 경우 => 헬멧을 쓰지 않았을 경우 { lcd.init(); //LCD클리어 lcd.setCursor(0,0); //각문구를 LCD화면에 출력 lcd.print("not wearing"); lcd.setCursor(1,1); lcd.print("a helmet"); } if(distance >5) //초음파 거리가 5이하 일경우 => 헬멧을 쓰고있을경우 { value = check_press(); //혼자 탑승하였는지를 확인 하는 함수를 통해 value값을 확인 delay(1000); //1초 딜레이 } } int check_press() { //키패드 변수 선언 int key1S = digitalRead(2); int key2S = digitalRead(3); int key3S = digitalRead(4); int key4S = digitalRead(5); //초음파 거리 출력 Serial.print(distance); Serial.println(" "); // 키패드가 모두 눌려졌을 경우 => 두명이상 탑승할 경우 if( (!(key1S)&&!(key2S)&&!(key3S)&&!(key4S)) ) { lcd.init(); //LCD클리어 아래의 코드 LCD출력 lcd.setCursor(0,0); lcd.print("only one ride"); return 10; //value값 10 리턴 } else return 0; //아닐경우 => 혼자 탈경우 value값 0리턴 }