用FPGA和Ego1开发板，从零搭建一个能识别红绿灯的超声波避障小车（含完整代码）
用FPGA和Ego1开发板打造红绿灯识别避障小车全流程实战
第一次接触FPGA时，我被它并行处理的能力深深吸引——想象一下，一个能同时处理摄像头数据、超声波测距和电机控制的芯片，这不正是智能小车的完美大脑吗？本文将带你用Ego1开发板，从零构建一个能识别红绿灯的超声波避障小车。不同于常见的单片机方案，FPGA的硬件并行特性让我们可以真正实现多传感器数据的同步处理。
1. 硬件架构设计与核心模块选型
1.1 Ego1开发板的优势与局限
Xilinx Artix-7芯片的Ego1开发板是FPGA初学者的理想选择，其特点包括：
- 内置USB-JTAG编程接口，省去额外下载器
- 4个PMOD接口方便扩展外设
- 但IO口驱动能力有限（仅12mA），需注意：
- 电机必须通过驱动板连接
- 超声波模块建议使用3.3V版本
关键外设对比表：
| 模块类型 | 推荐型号 | 工作电压 | 接口方式 | 注意事项 |
|---|---|---|---|---|
| 直流电机 | TT马达 | 3-6V | 需L298N驱动 | PWM频率建议1-5kHz |
| 舵机 | SG90 | 4.8-6V | 直接PWM控制 | 周期20ms，脉宽0.5-2.5ms |
| 超声波 | HC-SR04 | 5V | 需电平转换 | 测量周期建议≥60ms |
| 摄像头 | OpenMV Cam H7 | 3.3V | UART/I2C/GPIO | 色块识别延迟约30ms |
1.2 电源系统的实战经验
在面包板搭建阶段，我强烈建议采用双电源方案：
# 典型供电配置（实际使用需匹配具体元件） 锂电池组 -> 5V稳压模块 -> FPGA核心电路 -> 3.3V LDO -> 逻辑电平转换 -> 直接供电 -> 电机驱动板提示：电机启停时会产生电压波动，数字地和电机地之间应加0.1μF电容
2. FPGA逻辑设计：从并行处理到精准定时
2.1 多时钟域管理技巧
Ego1板载的100MHz时钟需要分频为不同用途：
// 时钟分频模块示例 module clk_divider( input clk_100M, output reg clk_1M = 0, output reg clk_10k = 0 ); reg [6:0] cnt_1M = 0; reg [12:0] cnt_10k = 0; always @(posedge clk_100M) begin // 生成1MHz时钟（用于超声波） if(cnt_1M == 49) begin cnt_1M <= 0; clk_1M <= ~clk_1M; end else cnt_1M <= cnt_1M + 1; // 生成10kHz时钟（用于PWM） if(cnt_10k == 4999) begin cnt_10k <= 0; clk_10k <= ~clk_10k; end else cnt_10k <= cnt_10k + 1; end endmodule2.2 超声波测距的Verilog实现
超声波模块的三大关键点：
- 触发信号时序 - 精确的10μs高脉冲
- 回波信号捕捉 - 使用高速计数器
- 距离计算优化 - 避免浮点运算
// 超声波测距核心代码片段 module ultrasonic( input clk_1M, // 1MHz时钟 output reg trig, input echo, output [15:0] distance ); reg [23:0] echo_cnt = 0; reg [7:0] state = 0; always @(posedge clk_1M) begin case(state) 0: begin // 初始化 trig <= 0; if(echo_cnt == 999_999) begin // 约1秒周期 state <= 1; echo_cnt <= 0; end else echo_cnt <= echo_cnt + 1; end 1: begin // 发送触发脉冲 trig <= 1; if(echo_cnt == 9) state <= 2; // 保持10μs echo_cnt <= echo_cnt + 1; end // ... 其余状态机代码 endcase end assign distance = echo_cnt[23:8] / 58; // 单位：厘米 endmodule3. 传感器融合与决策逻辑
3.1 红绿灯识别的状态机设计
OpenMV摄像头通过GPIO传递信号时，建议采用以下编码方案：
| 颜色状态 | GPIO1 | GPIO0 | 说明 |
|---|---|---|---|
| 红灯 | 0 | 0 | 立即停止 |
| 绿灯 | 0 | 1 | 正常行驶 |
| 黄灯 | 1 | 0 | 减速准备停止 |
| 无识别 | 1 | 1 | 安全模式 |
对应的FPGA状态转换逻辑：
graph TD A[初始状态] -->|绿灯| B(前进) B -->|红灯| C(刹车) C -->|绿灯| B B -->|障碍物| D(避障模式) D -->|安全距离| B3.2 避障算法的参数调优
通过实际测试得出的最佳参数组合：
超声波布局方案：
- 前向主探头：安装高度15cm，俯角10°
- 左右辅助探头：水平安装，间距8cm
避障阈值表：
| 距离范围 | 舵机转向角 | 电机PWM占空比 | 响应策略 |
|---|---|---|---|
| >80cm | 0° | 70% | 全速前进 |
| 40-80cm | ±15° | 50% | 小幅修正 |
| <40cm | ±30° | 30% | 紧急避让 |
| 两侧差>20cm | 偏向远侧 | 保持 | 主动避障 |
4. 调试技巧与性能优化
4.1 常见问题排查指南
在三次迭代中遇到的典型问题及解决方案：
PWM电机抖动
- 现象：电机运转不平稳伴有异响
- 排查：用逻辑分析仪捕获PWM波形
- 解决：将PWM频率从1kHz提升到5kHz
超声波数据跳变
- 现象：距离值偶尔突变
- 排查：添加数字滤波算法
// 移动平均滤波实现 reg [15:0] distance_buf[0:3]; always @(posedge clk) begin distance_buf[0] <= raw_distance; filtered_distance <= (distance_buf[0]+distance_buf[1] +distance_buf[2]+distance_buf[3]) >> 2; endOpenMV通信延迟
- 现象：颜色识别响应慢
- 优化：将UART通信改为GPIO直接触发
4.2 资源占用优化技巧
Artix-7 XC7A35T的资源利用率对比：
| 模块 | 原始方案(LUT) | 优化后(LUT) | 节省方法 |
|---|---|---|---|
| PWM生成 | 423 | 187 | 共用分频时钟 |
| 超声波 | 587 | 312 | 状态机简化 |
| 数码管 | 256 | 98 | 二进制压缩显示 |
| 总计 | 1266(37%) | 597(17%) | 资源共享 |
最后分享一个调试小技巧：在Verilog中添加在线调试信号，通过板载LED实时显示关键状态：
assign led = {color_detected, obstacle_near, motor_running};当看到LED[2]闪烁时，说明电机正在接收PWM信号，这种可视化调试能快速定位问题模块。