// 거리 = 시간 X 속력
// 초음파 속력 : 공기중에는 초당 340m 이동 함
// 1s x 340m/s =340m = 초당 340m 거리
// 왕복 구간이므로 수신값 / 2를 해야 됨 = 즉 340 /2 = 170m/sec(초당 초음파와 실제 물체간의 거리)
// cm = 측정값 * 340 / 10000 / 2;
#include "My_Arduino_GPIO_Lib_V1_6.h"
const int trig_pin = 4;
const int echo_pin = 2;
#define ry 7
void setup() {
// put your setup code here, to run once:
//초음파 센서
pinMode(trig_pin, OUTPUT);
pinMode(echo_pin, INPUT);
// 릴레이
pnMode(ry, OUTPUT);
Serial.begin(115200);
}
void loop() {
// put your main code here, to run repeatedly:
// 릴레이 ON
d_out(ry, 1);
//초음파
d_out(trig_pin, 1);
delayMicroseconds(10);
digitalWrite(trig_pin,0);
long distance = pulseIn(echo_pin, 1) / 58;
Serial.print(distance);
Serial.println("cm");
delay(500);
//릴레이 OFF
d_out(ry, 0);
delay(500);
}