基于Arduino的3路伺服TCS230颜色分拣机颜色检测故障排查

核心问题诊断 #

代码无法识别颜色的根源，是对TCS230传感器的引脚功能、读取逻辑完全误解，加上颜色判断逻辑严重不合理，具体问题如下：

1. TCS230引脚功能误用 #

TCS230的S0、S1是频率控制引脚（用于调整输出信号的频率缩放比例），并非颜色数据输入引脚。你错误地直接读取这两个引脚的脉冲，完全没用到传感器真正的颜色输出引脚OUT，这是最关键的错误。

2. 颜色通道切换与读取逻辑混乱 #

读取RGB通道时，需要通过S2、S3的电平组合切换对应滤镜，每次切换后从OUT引脚读取脉冲值。你当前的切换逻辑错误，导致读取的数值根本不对应颜色通道。

3. 颜色判断条件完全无效 #

你定义的RED_G=0、RED_B=0等固定值，而pulseIn返回的是正整数脉冲时长，green < 0这类条件永远无法成立，直接导致所有颜色判断失效。另外，TCS230的输出特性是：颜色越浅（反射光越强），脉冲时长越短；颜色越深则越长，你的比较逻辑完全搞反了方向。

4. 未初始化频率控制引脚 #

S0、S1需要设置固定电平来选择频率缩放比例，你只设置了引脚模式未赋值，导致传感器输出不稳定。

修复后的完整代码 #

#include <Servo.h>

// TCS230引脚定义（新增OUT引脚，这是颜色数据输出端）
#define TCS230_S0 4    // 频率控制引脚
#define TCS230_S1 5    // 频率控制引脚
#define TCS230_S2 6    // 通道选择引脚
#define TCS230_S3 7    // 通道选择引脚
#define TCS230_OUT 2   // 颜色数据输出引脚，需连接传感器OUT脚

// 伺服电机引脚
#define SERVO1 9
#define SERVO2 10
#define SERVO3 11

// 颜色判断阈值（实际校准后调整，示例值）
#define COLOR_THRESHOLD 80  // 通道差值大于此值判定为对应颜色

Servo servo1;
Servo servo2;
Servo servo3;

void setup() {
  // 初始化TCS230所有引脚
  pinMode(TCS230_S0, OUTPUT);
  pinMode(TCS230_S1, OUTPUT);
  pinMode(TCS230_S2, OUTPUT);
  pinMode(TCS230_S3, OUTPUT);
  pinMode(TCS230_OUT, INPUT);

  // 设置频率缩放为100%（HIGH+HIGH，适合多数场景）
  digitalWrite(TCS230_S0, HIGH);
  digitalWrite(TCS230_S1, HIGH);

  // 初始化伺服电机并复位到初始位置
  servo1.attach(SERVO1);
  servo2.attach(SERVO2);
  servo3.attach(SERVO3);
  servo1.write(90);
  servo2.write(90);
  servo3.write(90);
}

// 封装颜色通道读取函数，切换滤镜后读取OUT引脚脉冲
int readColorChannel(bool s2Level, bool s3Level) {
  digitalWrite(TCS230_S2, s2Level);
  digitalWrite(TCS230_S3, s3Level);
  delay(10);  // 等待滤镜切换稳定
  // 100ms超时，避免传感器无输出时程序卡死
  return pulseIn(TCS230_OUT, LOW, 100000);
}

void loop() {
  // 读取RGB三个通道的脉冲值
  int redValue = readColorChannel(LOW, LOW);
  int greenValue = readColorChannel(HIGH, HIGH);
  int blueValue = readColorChannel(LOW, HIGH);

  // 颜色判断逻辑：目标通道脉冲值远小于另外两个通道（符合TCS230输出特性）
  if (redValue < greenValue - COLOR_THRESHOLD && redValue < blueValue - COLOR_THRESHOLD) {
    // 识别到红色物体，触发伺服1分拣
    servo1.write(45);
    delay(1000);
    servo1.write(90);
    delay(1000);
  } 
  else if (greenValue < redValue - COLOR_THRESHOLD && greenValue < blueValue - COLOR_THRESHOLD) {
    // 识别到绿色物体，触发伺服2分拣
    servo2.write(45);
    delay(1000);
    servo2.write(90);
    delay(1000);
  } 
  else if (blueValue < redValue - COLOR_THRESHOLD && blueValue < greenValue - COLOR_THRESHOLD) {
    // 识别到蓝色物体，触发伺服3分拣
    servo3.write(45);
    delay(1000);
    servo3.write(90);
    delay(1000);
  }

  delay(500);  // 增加延迟，避免频繁检测
}

额外优化建议 #

1. 校准阈值：实际使用前，分别读取白色、红色、绿色、蓝色物体的RGB数值，根据实际值调整COLOR_THRESHOLD，提升识别准确率。
2. 环境光隔离：给传感器加装遮光罩，避免环境光干扰，尤其是强光环境下。
3. 传送带同步：增加红外对管等物体检测传感器，只有当物体到达分拣位置时才触发颜色检测，避免空检测浪费资源。

内容的提问来源于stack exchange，提问作者Sping