請問大神 為什么程序 超聲波測距返回值一直是0.03 或0.05的錯(cuò)誤值

0皇霸天下0 2017-08-23 05:33:05 597  瀏覽

• #include <.h> const int trig = 8; // 觸發(fā)信號 const int echo = 5; // 反饋信號 #include Servo myservo0; float pos0 = 0; float i= 45; float S=100; void setup() { pinMode(echo， INPUT); pinMode(trig， OUTPUT); //觸發(fā)端... #include <.h> const int trig = 8; // 觸發(fā)信號 const int echo = 5; // 反饋信號 #include Servo myservo0; float pos0 = 0; float i= 45; float S=100; void setup() { pinMode(echo， INPUT); pinMode(trig， OUTPUT); //觸發(fā)端口設(shè)置為輸出，反饋端口設(shè)置為輸入 Serial.begin(9600); myservo0.attach(9); myservo1.attach(10); myservo2.attach(11); myservo3.attach(6);// attaches the servo on pin 9 to the servo object } void loop() { long IntervalTime=0; //定義一個(gè)時(shí)間變量 for(pos0 = i; pos0 < 48; pos0 += 0.5) // goes from 0 degrees to 180 degrees { // in steps of 1 degree myservo0.write(pos0); // tell servo to go to position in variable 'pos' delay(15); // waits 15ms for the servo to reach the position } i=pos0; for(pos1 = k; pos1 <73; pos1+= 0.5) // goes from 0 degrees to 180 degrees { // in steps of 1 degree myservo1.write(pos1); // tell servo to go to position in variable 'pos' delay(15); // waits 15ms for the servo to reach the position } k=pos1; while(S>15){ S=0; digitalWrite(trig， 1);//置高電平 delayMicroseconds(15);//延時(shí) 15us digitalWrite(trig， 0);//設(shè)為低電平 IntervalTime=pulseIn(echo， HIGH);//用自帶的函數(shù)采樣反饋的高電平的寬度， 單位 us float S=IntervalTime/58.00; //使用浮點(diǎn)計(jì)算出距離，單位 cm Serial.println(S);//通過串口輸出距離數(shù)值 IntervalTime=0;//對應(yīng)的數(shù)值清零。 delay(500);//延時(shí)間隔決定采樣的頻率，根據(jù)實(shí)際需要變換參數(shù) } 展開