arduino用tcrt5000的代码
时间: 2024-01-08 16:03:20 浏览: 147
用tcrt5000传感器和STC89c52的简单循迹小车代码
以下是基于 Arduino 的 TCRT5000 循迹模块的代码示例:
```C++
int leftPin = 2; // 左传感器引脚
int rightPin = 3; // 右传感器引脚
void setup() {
pinMode(leftPin, INPUT);
pinMode(rightPin, INPUT);
Serial.begin(9600); // 初始化串口通信
}
void loop() {
// 读取传感器值
int leftValue = digitalRead(leftPin);
int rightValue = digitalRead(rightPin);
// 判断传感器值
if (leftValue == LOW && rightValue == LOW) {
Serial.println("Both on black");
// 如果两个传感器都在黑线上,停止运动
} else if (leftValue == LOW && rightValue == HIGH) {
Serial.println("Turn right");
// 如果左边传感器在黑线上,右边传感器不在黑线上,向右转
} else if (leftValue == HIGH && rightValue == LOW) {
Serial.println("Turn left");
// 如果右边传感器在黑线上,左边传感器不在黑线上,向左转
} else {
Serial.println("Both off black");
// 如果两个传感器都不在黑线上,继续直行
}
}
```
在上述代码中,引脚 `leftPin` 和 `rightPin` 分别连接到 TCRT5000 循迹模块的左传感器和右传感器引脚。通过 `digitalRead()` 函数读取传感器的值,并根据传感器的值判断小车或机器人的行驶方向。最后,通过串口通信将判断结果输出到串口监视器中。
阅读全文