Arduino 全向麦克纳姆轮机器人：PS2 手柄遥控 + 自主避障

项目亮点

基于 **Arduino Mega 2560** 构建**四轮全向麦克纳姆轮底盘**，实现**全向移动 (前进/后退/平移/旋转/斜向)** 与**原地旋转**。双控模式：**PS2 手柄 (2.4G 无线) 手动遥控** + **超声波/红外多传感器融合自主避障**。采用 **TB6612FNG 双 H 桥驱动 4 路 TT 减速电机 (带编码器)**，PID 闭环控速，里程计融合 IMU (MPU6050) 实现基础定位。适合 ROS 入门、SLAM 算法验证、服务机器人原型开发。

硬件清单 (BOM)

麦克纳姆轮运动学核心

四轮速度矢量合成：

// vx: 前进+, vy: 左平移+, ω: 逆时针旋转+
// L = 半轴距, W = 半轮距, R = 轮半径
float v_fl = (vx - vy - (L+W)*omega) / R;  // 前左
float v_fr = (vx + vy + (L+W)*omega) / R;  // 前右
float v_rl = (vx + vy - (L+W)*omega) / R;  // 后左
float v_rr = (vx - vy + (L+W)*omega) / R;  // 后右

映射为电机 PWM：PWM = constrain(v * Kp + integral * Ki + derivative * Kd, -255, 255)，编码器读取中断计数计算实时速度闭环。

PS2 手柄映射 (双摇杆 + 方向键)

自主避障策略 (行为栈/子串和法)

1. 数据融合：4 路超声波中位数滤波 + 红外近场触发，生成极坐标障碍物地图 (角度分辨率 45°)
2. 势场法简化：目标方向引力 + 障碍物斥力矢量叠加，输出期望 vx, vy, ω
3. 行为优先级：紧急停车 (红外触发) > 避障转向 > 目标导航 > 原地待机
4. 陷阱处理：连续 3s 无有效路径 → 后退 + 原地大角度旋转探索

软件架构 (模块化 .ino 分文件)

• Config.h：引脚定义、PID 参数、几何参数、阈值
• Motor.cpp/h：TB6612 驱动封装、编码器中断 (PinChangeInterrupt)、PID 速度环
• Kinematics.cpp/h：运动学正/逆解、速度限幅、死区补偿
• PS2_Controller.cpp/h：PS2X 库封装、手柄状态机、按键消抖
• Sensors.cpp/h：超声波定时触发 (避免串扰)、红外读取、MPU6050 DMP 姿态
• Navigator.cpp/h：避障势场、里程计积分 (x,y,θ)、路径规划接口
• Main.ino：setup() 初始化所有模块，loop() 10ms 周期调度

调试与标定流程

1. 编码器极性：单轮前进，串口打印计数符号，修正 A/B 相接线
2. 麦克纳姆轮安装验证：发送纯 vx → 四轮同向；纯 vy → 对角轮同向、另两轮反向；纯 ω → 同侧轮同向、异侧反向
3. PID 调参：目标速度阶跃响应，示波器/串口绘图观察超调/稳态误差，Ziegler-Nichols 粗调后手动微调
4. IMU 校准：静止采样 2000 次求零偏，六面体标定加速度计/陀螺仪比例因子
5. 超声波串扰消除：错峰触发 (间隔 25ms)、中位数滤波 (5 次取中)

ROS 衔接准备 (为后续迁移铺路)

• 串口协议标准化：ros_serial 兼容帧格式 0xFF 0xFE len cmd data... chk
• 发布话题：/odom (nav_msgs/Odometry)、/imu/data (sensor_msgs/Imu)、/scan (sensor_msgs/LaserScan 模拟)、/battery (sensor_msgs/BatteryState)
• 订阅话题：/cmd_vel (geometry_msgs/Twist)、/mode (std_msgs/UInt8)
• Mega 2560 内存受限，建议后续迁移 **ESP32/STM32 + micro-ROS** 或 **树莓派 4B + Mega 从机** 架构

安全与规范

• 3S LiPo 必配平衡充电器、防火袋、低压报警 (3.5V/节)
• 麦克纳姆轮滚子易缠毛发/细线，定期清理
• 超声波盲区 (0–2cm) 由红外补盲，防撞条物理缓冲
• 代码看门狗 (WDT) 复位，防止跑飞

项目资源

完整模块化代码、原理图 (KiCad)、STL 文件、PS2 手柄库、标定脚本、ROS 串口协议文档已开源，欢迎贡献 PID 自调参、SLAM 接口等改进。