초음파센서+LCD+서보모터

#include<Servo.h>

#include <Wire.h>

#include <LiquidCrystal_I2C.h>

LiquidCrystal_I2C lcd(0x27,16,2);

const int servo_pin=10;

const int trig_pin=11;

const int echo_pin=12;

Servo myservo;

void setup() {

pinMode(trig_pin, OUTPUT);

pinMode(echo_pin, INPUT);

Serial.begin(9600);

myservo.attach(servo_pin);

myservo.write(0);

lcd.init();

lcd.backlight();

}

void loop() {

digitalWrite(trig_pin,HIGH);

delayMicroseconds(1000);

digitalWrite(trig_pin,LOW);

long duration=pulseIn(echo_pin,HIGH);

long distance=(duration/2)/29.1;

Serial.print(distance);

Serial.println("cm");

lcd.print("HEIGHT");

lcd.print(distance);

lcd.print("cm");

lcd.begin(16,2);

delay(500);

if(distance<10){

myservo.write(0);

delay(1000);

myservo.write(180);

delay(1000);

}

}