首页Arduino循迹小车颜色感应代码

Arduino循迹小车颜色感应代码

时间: 2025-01-08 11:06:11 浏览: 57

Arduino循迹小车利用颜色传感器（如TCS34725、HC-SR04等）来识别路径的颜色，并通过程序控制电机的方向和速度来跟随指定的颜色线。以下是一个简单的代码示例，假设我们使用了IR反射式追踪传感器配合颜色传感器： ```cpp #include <Adafruit_TCS34725.h> #include <Servo.h> // 定义硬件连接 Adafruit_TCS34725 tcs = Adafruit_TCS34725(TCS34725_INTEGRATIONTIME_700MS, TCS34725_GAIN_1X); Servo motor; void setup() { Serial.begin(9600); // 初始化串口通信 motor.attach(9); // 连接电机到数字 pin 9 } void loop() { // 获取颜色传感器数据 uint16_t red, green, blue, clear; tcs.getRawData(&red, &green, &blue, &clear); // 计算色差或阈值，例如这里仅做简化判断红色接近白色 if (red > 1000 && red > green && red > blue) { // 红色接近白色，认为是目标颜色 motor.write(90); // 向前行驶 } else { motor.write(-90); // 反向行驶，尝试调整方向 } // 输出数据用于调试 Serial.print("Red: "); Serial.println(red); Serial.print("Green: "); Serial.println(green); Serial.print("Blue: "); Serial.println(blue); Serial.print("Clear: "); Serial.println(clear); delay(100); // 控制更新频率 }

阅读全文