|
|
至少需要一个arduino pro mini,把1脚接到apm声呐输入
2脚接trig,3脚接echo
100欧电阻和100uf电容并联后接到1脚和地之间,下拉和稳压。代码如下
int OutPin = 1;
int TrigPin = 2;
int EchoPin = 3;
float dis;
int dis255;
void setup()
{ pinMode(OutPin, OUTPUT);
pinMode(TrigPin, OUTPUT);
pinMode(EchoPin, INPUT);
}
void loop()
{
digitalWrite(TrigPin, LOW);
delayMicroseconds(2);
digitalWrite(TrigPin, HIGH);
delayMicroseconds(10);
digitalWrite(TrigPin, LOW);
dis = pulseIn(EchoPin, HIGH) / 58.00; //cm
dis255= dis*255 /300 //0-300cm
analogWrite(OutPin,dis255);
}
|
|