ตัวอย่างงานที่ใช้โปรแกรม Arduino
void setup(){
pinMode(TriggerPin,OUTPUT);
pinMode(EchoPin,INPUT);
Serial.begin(9600);
}
pinMode(TriggerPin,OUTPUT);
pinMode(EchoPin,INPUT);
Serial.begin(9600);
}
void loop(){
digitalWrite(TriggerPin, LOW);
delayMicroseconds(2);
digitalWrite(TriggerPin, HIGH);
delayMicroseconds(10);
digitalWrite(TriggerPin, LOW);
digitalWrite(TriggerPin, LOW);
delayMicroseconds(2);
digitalWrite(TriggerPin, HIGH);
delayMicroseconds(10);
digitalWrite(TriggerPin, LOW);
Duration = pulseIn(EchoPin,HIGH);
// returns the Duration in microseconds
long Distance_mm = Distance(Duration);
// returns the Duration in microseconds
long Distance_mm = Distance(Duration);
Serial.print(“Distance = “);
Serial.print(Distance_mm);
Serial.println(” mm”);
Serial.print(Distance_mm);
Serial.println(” mm”);
delay(1000);
}
}
long Distance(long time)
{
{
long DistanceCalc;
DistanceCalc = ((time /2.9) / 2);
//DistanceCalc = time / 74 / 2;
return DistanceCalc;
}
DistanceCalc = ((time /2.9) / 2);
//DistanceCalc = time / 74 / 2;
return DistanceCalc;
}
ไม่มีความคิดเห็น:
แสดงความคิดเห็น