• 결선도

• 코딩

#include <Servo.h>

Servo sv; //Servo에서 사용할 sv라는 대표변수 지정

int distance = 0; // 거리값을 저장할 변수

void setup() {

  Serial.begin(9600); // PC와의 시리얼 통신속도를 9600bps로 설정

  sv.attach(13); //서보모터는 13번 핀에 연결

}

void loop() {

  int volt = map(analogRead(A0), 0, 1023, 0, 5000); // 0~1023 사이 값을 갖는 아날로그 신호값을

  //  0~5000 (5V) 사이 값으로 변환

  distance = (27.61 / (volt - 0.1696)) * 1000; // 읽어들인 Voltage 값을 거리값(단위: cm)로 변환하는 공

  int a = map(distance, 10, 60, 0, 180); 

  Serial.print(distance);  //거리값을 시리얼모니터로 출력해줍니다.

  Serial.print(" cm");

  Serial.println(" ");

  sv.write(a); 

  delay(1000);

}