我在树莓派上的C++应用程序出现问题。此脚本应在终止前打印一次以厘米为单位的距离。但它也应该检查超声波传感器是否连接,如果没有,脚本应该断开。我怎么能那样做?有没有办法为getCM()方法设置超时,或者有其他人可以解决这个问题?这是代码:
...
void setup() {
wiringPiSetup();
pinMode(TRIG_R, OUTPUT);
pinMode(ECHO_R, INPUT);
digitalWrite(TRIG_F, LOW);
delay(30);
}
int getCM() {
digitalWrite(TRIG_R, HIGH);
delayMicroseconds(20);
digitalWrite(TRIG_R, LOW);
//Wait for echo start
while(digitalRead(ECHO_R) == LOW);
//Wait for echo end
long startTime = micros();
while(digitalRead(ECHO_R) == HIGH);
long travelTime = micros() - startTime;
int distance = travelTime / 58;
return distance;
}
int main(void) {
setup();
printf("Distance: %dcmn", getCM());
return 0;
}
提前感谢
Tim
提前检查超声波传感器,如果不了解更多关于传感器的信息,任何人都无法提出太多建议。如果通信纯粹是比特切换,那么如果没有更多的硬件,你可能无法判断。
对于第二部分,超时getCM
,向digitalRead
循环添加一个额外条件以强制退出。例如:
int timeout = <read timeout goes here>;
while((digitalRead(ECHO_R) == LOW)&&(--timeout));
if (!timeout)
{
return -1; // Should never be able to read less than blanking distance
// from an ultrasonic sensor. -1 is certainly out of range.
}
在main
中,您可以打印出-1,也可以检查-1并打印出更好的错误消息。为了更清楚起见,第二个循环可以在失败时return -2;
,这样您就可以知道什么失败了。