아두이노로 초음파센서(SRF05) 제어하기
스케치소스:
// Sonar Sensor
int echo = 3; // Echo Port
int trig = 2; // Trigger Port
unsigned long duration;
float distance;
void setup()
{
Serial.begin(9600);
pinMode(echo, INPUT);
pinMode(trig, OUTPUT);
}
void loop()
{
// Trigger Signal Output
digitalWrite(trig, HIGH);
delay(10);
digitalWrite(trig, LOW);
// Echo Signal Input
duration = pulseIn(echo, HIGH);
// Calcurate distance
distance = ((float)(340 * duration) / 10000 )/ 2;
Serial.print(distance);
Serial.println("cm");
delay(100);
}
'Arduino' 카테고리의 다른 글
fritzing-아두이노 사용자라면 한번쯤 사용해볼만한 시뮬레이션 프로그램 (0) | 2014.08.23 |
---|