当前位置：首页 > news >正文

基于STM32与HJ-XJ5的五路灰度传感器PID巡线实战解析

news 2026/6/4 12:09:12

1. 五路灰度传感器与STM32的硬件连接实战

第一次用HJ-XJ5传感器时，我犯了个低级错误——把电源接反了。这个五路灰度传感器虽然看起来简单，但接线时有些细节必须注意。传感器左侧标有L2、L1，中间是M，右侧是R1、R2，这个排列顺序直接影响后续的巡线算法设计。

具体接线时，VCC接5V电源，GND接地，五个信号输出端建议这样连接：

L2 → PC13
L1 → PC4
M → PE6
R1 → PE5
R2 → PA4

这里有个坑要注意：STM32的IO口需要配置为上拉输入模式。我在调试时发现，如果使用浮空输入，传感器输出会不稳定。建议在CubeMX里直接配置，代码示例如下：

void MX_GPIO_Init(void) { GPIO_InitTypeDef GPIO_InitStruct = {0}; __HAL_RCC_GPIOC_CLK_ENABLE(); __HAL_RCC_GPIOE_CLK_ENABLE(); __HAL_RCC_GPIOA_CLK_ENABLE(); // L2配置 GPIO_InitStruct.Pin = GPIO_PIN_13; GPIO_InitStruct.Mode = GPIO_MODE_INPUT; GPIO_InitStruct.Pull = GPIO_PULLUP; HAL_GPIO_Init(GPIOC, &GPIO_InitStruct); // 其他引脚类似配置... }

传感器安装高度对检测效果影响巨大。经过多次测试，建议距离地面1-2cm为最佳。太高会导致检测灵敏度下降，太低容易刮擦地面。可以用尼龙柱固定，既绝缘又方便调节高度。

2. 传感器数据采集与处理技巧

刚开始我用简单的数字量读取（0/1），发现小车总是"醉驾"似的左右摇摆。后来改用ADC读取模拟量，效果立竿见影。HJ-XJ5虽然输出的是数字信号，但内部其实是模拟检测，我们可以通过改造电路获取模拟值。

具体方法是断开传感器板上的比较器电路，直接取出前级信号。改造后代码需要增加ADC采集部分：

void Get_Gray_Values(void) { HAL_ADC_Start(&hadc1); L2_Value = HAL_ADC_GetValue(&hadc1); // 其他通道类似... // 归一化处理 L2_Norm = (float)L2_Value / 4096.0f * 3.3f; }

实测中发现三个常见问题及解决方案：

环境光干扰：强光下误检测。解决方法是在传感器上方加装遮光罩，我用黑色热缩管效果就不错。
地面反光：亮面地板会导致误触发。贴层磨砂膜在地面检测区域即可解决。
响应延迟：软件上可以加20ms的采样间隔，硬件方面建议在信号线上加104电容滤波。

3. PID巡线算法的嵌入式实现

PID控制听起来高大上，实际用起来就像骑自行车——调平衡的过程。位置式PID公式看起来复杂：

pwm = Kp*e(k) + Ki*∑e(k) + Kd[e(k)-e(k-1)]

但在代码里实现并不难。先定义PID结构体：

typedef struct { float Kp, Ki, Kd; int Error1; // 上次误差 int Error2; // 上上次误差 int Error_sum; // 误差累计 } PID_TypeDef;

巡线偏差计算是关键。我用的加权算法效果很好：

int Calculate_Error(void) { if(L1==0 && M==1 && R1==0) return 0; // 居中 if(L1==0 && M==1 && R1==1) return 400; if(L1==0 && M==0 && R1==1) return 500; // 其他情况类似... }

调参经验分享：

先调Kp让小车能基本循迹，但会有振荡
再加Kd抑制振荡，像给小车"踩刹车"
最后调Ki消除静态误差，但要小心积分饱和
测试时建议先用小数值（Kp=0.5，Ki=0.01，Kd=0.3）

4. 电机控制与系统整合

PID输出最终要转化为电机控制。我用的是PWM驱动直流电机，这里有个重要技巧——对左右电机采用差速控制。当检测到向左偏时，应该左轮减速、右轮加速。

电机驱动代码片段：

void Motor_Control(int pwm) { // 限制PWM范围 pwm = (pwm > 1000) ? 1000 : (pwm < -1000) ? -1000 : pwm; if(pwm > 0) { // 右转 __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_3, pwm); // 右轮 __HAL_TIM_SET_COMPARE(&htim4, TIM_CHANNEL_3, 1000); // 左轮 } else { // 左转 __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_3, 1000); __HAL_TIM_SET_COMPARE(&htim4, TIM_CHANNEL_3, -pwm); } }

系统整合时要注意几个关键点：