5학년 1반

5학년 1반

  • 선생님 : 김중한
  • 학생수 : 남 16명 / 여 16명

[로봇프로그래밍] 초음파센서 - 로봇의 눈
이름 지규선 등록일 16.06.08 조회수 55
첨부파일
int trigPin = 8;
int echoPin = 7;
float v = 331.5 + 0.6 * 20; 
void setup()
{
  Serial.begin(9600);
  pinMode(trigPin, OUTPUT); 
  pinMode(echoPin, INPUT); 
}
float distanceM() {
  // send sound pulse
  digitalWrite(trigPin, LOW);
  delayMicroseconds(3);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(5);
  digitalWrite(trigPin, LOW);
  // listen for echo
  float tUs = pulseIn(echoPin, HIGH); 
  float t = tUs / 1000.0 / 1000.0 / 2; 
  float d = t * v; 
  return d * 100; 
}
void loop() //
{
  int d = distanceM();
  Serial.println(d);
  delay(100);
}
이전글 빛센서 + 서보 모터 (2)
다음글 아두이노 성공!

목록