简介：这是一套基于STM32RCT6微控制器、利用PS2手柄控制四轮全向轮小车的完整工程资源。项目从手柄信号解析、电机PWM调速到全向轮运动逻辑均有详细代码实现，适合学习STM32库函数开发、嵌入式电机控制及无线遥控小车的开发者参考。压缩包共233个文件，包含大量C源文件、H头文件及编译生成的O、HEX、AXF等文件，同时提供BSP板级支持包、USER应用层代码、Keil工程构建脚本与README说明，便于直接查阅工程结构和二次开发。包体约8.28MB，小巧完整。目前已有744人学习下载，项目涉及PS2通信协议、全向轮运动学、定时器PWM输出等关键知识点，代码注释清晰，目录组织规范，可作为课程设计、毕业设计或机器人入门实战的良好范例。 做四电机小车这个项目，最难的不是“让电机转起来”，而是“让四个电机配合得像一个整体”。我早期调试这么一套底盘时，每次改完参数都要弯腰去按车上的复位键，再跑一遍流程观察动作，效率低到让人抓狂。后来把 PS2 手柄接上去，人坐在电脑前遥控小车跑几圈，很多运动学问题和 PID 参数问题一下就暴露出来了，调试效率翻倍。这也是到今天为止，PS2 手柄加 4 电机小车依然是电赛、工创赛、毕设和各类课程设计里最常用组合的原因。
这篇文章就把整个链路拆开来讲：从“4 电机到底该怎么理解”开始，到硬件接线、PS2 协议解析、麦克纳姆轮运动学解算、PID 速度闭环，最后落到联调阶段的真实排错过程。无论你用的是 STM32F103C8T6 还是 ZET6，是直接做全向底盘还是普通四驱差速，内容都能直接参考。
1. 选型之前先想清楚：你的“4电机”到底是哪种布局
很多朋友一看到“4 电机小车”就直接进入硬件采购环节，结果轮子买回来才发现控制策略完全搞错了方向。实际上“4 电机”至少对应三种完全不同的底盘结构，代码实现难度也是天差地别。
第一种是普通四驱车，四个轮子各带一个电机，但左右两侧的电机成组控制。这种底盘本质上是两路独立驱动，转向靠左右轮的转速差完成。控制代码只需要两路 PWM、两路方向引脚，运动学上没有任何需要解算的东西。第二种是履带式底盘，看起来是四个电机，实际上左侧两个并联、右侧两个并联，同样退化成两路控制。第三种就是麦克纳姆轮全向底盘，四个轮子必须独立控制转速和方向，通过四个轮子速度矢量的组合，让整车实现前后、横移、斜向和原地旋转。这才是真正意义上“需要 4 路独立控制”的 4 电机小车。
我的建议是，如果你做的是搬运、循迹、避障这类场景，普通四驱加差速转向完全够用，没必要给自己增加运动学解算的负担。但如果场地狭窄、要求全向移动，比如物流小车、竞赛中需要侧向入位、原地掉头，麦克纳姆轮就是更合适的选择。这篇文章后面的内容都基于麦克纳姆轮方案展开，普通四驱的读者可以跳过第 4 章，其他章节基本相同。
整套系统的选型我给出一个经过验证的组合：主控用 STM32F103 系列，手柄用 PS2 无线手柄加接收模块，电机选带霍尔编码器的直流减速电机，比如 JGB37-520、MG310 这类，驱动芯片用两片 TB6612，每片带两个电机。这套组合成本不高、资料多、稳定性也足够，是当前 DIY 和竞赛场景里最不容易踩坑的一套配置。
2. 硬件接线与供电设计：PS2接收模块、TB6612和4路电机的连接细节
2.1 PS2 接收模块的六根线
PS2 接收模块是整套系统里很多人第一次见到就懵的东西，模块上引出的引脚一般是 VCC、GND、DAT、CMD、CS、CLK。它本质上是 PS2 手柄的扩展接收器，把无线手柄的数据用类似 SPI 的协议和单片机通信，而不是直接输出模拟电压。
接线分两组来记忆：DAT、CMD、CS、CLK 这四根是通信线，对应软件模拟 SPI 的 MISO、MOSI、NSS、SCK；VCC 和 GND 是电源。我用 F103C8T6 时的接法是 DAT 接 PA6、CMD 接 PA7、CS 接 PA4、CLK 接 PA5，也就是把 PS2 接收模块挂到 SPI1 的默认引脚上。如果你想让通信线更灵活，完全可以用软件模拟时序，接任意 GPIO，这样不会和其他外设冲突。
模块供电这里必须单独强调：PS2 接收模块多数是 3.3V 供电，接 5V 很容易烧模块。上电之前先看模块丝印，是 3.3V 就老老实实接 3.3V。同时一定要和单片机共地，也就是模块的 GND 和主板 GND 连在一起，否则通信电平根本没有参考基准，表现就是数据时好时坏。
2.2 TB6612 和 4 路电机的接线
TB6612 比第一代常用的 L298N 好用太多，体积小、效率高、发热低。一片 TB6612 有两个通道，每个通道控制一个电机，所以 4 个电机正好用两片。
关于 TB6612 的引脚，重点记这几个：VM 接电池正极，VCC 接 3.3V 或 5V 逻辑电源，STBY 必须接高电平，否则芯片完全不工作。每个通道有 AIN1、AIN2、PWMA 三个控制脚，AIN1/AIN2 决定方向，PWMA 决定速度。比如 AIN1=1、AIN2=0 时电机正转，反过来就是反转；PWMA 上的 PWM 占空比决定有效电压的大小。输出端 A01、A02 直接接电机两根线，如果发现电机转向和预期相反，把这两根线对调即可。
PWM 频率我建议设置在 10kHz 到 20kHz 之间，这个范围既避开了听觉敏感区，也适合 TB6612 这类芯片的开关特性。4 路 PWM 在 F103 上可以用定时器的四个通道输出，比如 TIM2 的 CH1 到 CH4，方向引脚随便找四个 GPIO 就行。如果你用的是不带编码器的电机，到此接线就结束了；如果带编码器，每个电机还要接 A、B 两相到单片机的定时器输入引脚。
2.3 电源分配是硬件里最容易埋雷的地方
四电机小车的电源问题比想象中严重得多。四个电机同时启动的瞬间电流可以轻松达到 2A 甚至更高，如果电池电压直接被压到单片机复位电压以下，就会出现一推摇杆就重启的诡异现象。
我的做法是分三路供电：电池正极直接进 TB6612 的 VM，负责电机供电；电池同时经过 5V 稳压模块给逻辑电路供电；3.3V 再由 5V 通过 LDO 得到，给 STM32 和 PS2 接收模块。注意 STM32 和 PS2 模块不要从 TB6612 板载的 5V 引脚取电，那个引脚的电流能力有限，驱动负载稍大会把电压拉垮。电池和所有低压模块的 GND 必须全部共地，共地是一切正常工作的前提。
如果实测发现电压跌落严重，在电源输入端并联一个大电解电容，比如 470μF 以上，再并一个 100nF 陶瓷电容，分别吸收低频纹波和高频噪声。这个习惯能解决非常多“莫名其妙复位”的疑难杂症。
3. PS2手柄通信协议：从0x01配置到9字节数据帧的完整解析
3.1 为什么选择 PS2 手柄而不是自制遥控器
市场上很多 2.4G 遥控器套件只有几个按键和两个摇杆，买回来发现协议不公开、信号不稳定，甚至两套设备会互相干扰。PS2 手柄在老玩家手里积累了大量开源的通信代码，按键、模拟摇杆、震动等功能都有现成的解析方案，搭配几十块钱的接收模块，稳定性和可定制性远超市面上大部分玩具遥控器。
更关键的是 PS2 手柄有两个模拟摇杆，也就是四个模拟量输入，这对麦克纳姆轮底盘来说非常合适：一个摇杆控制前后和横移，另一个摇杆控制旋转，操作起来极其自然。
3.2 通信时序和两个关键前提
PS2 接收模块和单片机之间用类似 SPI 的时序通信，主机（单片机）拉低 CS，然后通过 CMD 线发送命令，同时从 DAT 线读取数据。两件事是同时进行的：每发送一个字节的命令，就会从 DAT 上读回一个字节的数据。时钟频率不要太高，一般 250kHz 左右就足够，也就是每一位约 4 微秒，一帧 9 个字节的全部传输时间不到 1 毫秒，对小车控制来说完全够用。
这里有两个特别容易翻车的前提。第一，手柄必须处于模拟模式，手柄中央的 ANALOG 键按下后，指示灯从红色变成绿色，摇杆才输出模拟量。红灯状态下摇杆虽然也能动，但读回来的值会退化成方向键的开关量，或者始终是中间值。第二，代码里必须先在通信时发送 0x01 让手柄进入配置模式，再发送 0x42 读取帧数据。跳过配置直接读，很多模块只能拿到按键数据，摇杆模拟量是无效的。
3.3 数据帧布局和按键映射
完整读回来的一帧数据是 10 个字节，习惯上用一个 10 字节数组保存，每个字节的含义如下。
uint8_t buf[10]; // buf[0] : 状态字节，0x00 表示正常，0x79 表示模拟模式生效 // buf[1] : 按键组1 // buf[2] : 按键组2 // buf[3] : 按键组3（通常忽略） // buf[4] : 保留字节 0x00 // buf[5] : 保留字节 0xFF // buf[6] : 右摇杆 X 轴 // buf[7] : 右摇杆 Y 轴 // buf[8] : 左摇杆 X 轴 // buf[9] : 左摇杆 Y 轴按键组的位定义要记住一个反直觉的规则：按键按下时对应位是 0，松开时是 1。比如 buf[1] 的 0x10 位代表方向键上的 UP，判断 UP 按下，就要判断(buf[1] & 0x10) == 0。buf[2] 里常用的有 0x10 代表三角键、0x20 代表圆圈键、0x40 代表叉键、0x80 代表方块键。
摇杆的原始值是 0 到 255，静止时在 128 附近。为了方便控制，代码里通常先减 128，得到 -128 到 127 的有符号数，再配合死区处理，效果就很直观。
下面是我实际用过的软件模拟 SPI 读帧代码，不依赖硬件 SPI，任何 GPIO 都能跑：
#define PS2_DAT HAL_GPIO_ReadPin(GPIOA, GPIO_PIN_6) #define PS2_CMD_H HAL_GPIO_WritePin(GPIOA, GPIO_PIN_7, GPIO_PIN_SET) #define PS2_CMD_L HAL_GPIO_WritePin(GPIOA, GPIO_PIN_7, GPIO_PIN_RESET) #define PS2_CLK_H HAL_GPIO_WritePin(GPIOA, GPIO_PIN_5, GPIO_PIN_SET) #define PS2_CLK_L HAL_GPIO_WritePin(GPIOA, GPIO_PIN_5, GPIO_PIN_RESET) #define PS2_CS_H HAL_GPIO_WritePin(GPIOA, GPIO_PIN_4, GPIO_PIN_SET) #define PS2_CS_L HAL_GPIO_WritePin(GPIOA, GPIO_PIN_4, GPIO_PIN_RESET) uint8_t PS2_Xfer(uint8_t tx) { uint8_t rx = 0; for (uint8_t i = 0; i < 8; i++) { if (tx & 0x80) PS2_CMD_H; else PS2_CMD_L; tx <<= 1; PS2_CLK_H; delay_us(4); rx <<= 1; if (PS2_DAT) rx |= 0x01; PS2_CLK_L; delay_us(4); } return rx; } void PS2_ReadFrame(uint8_t buf[10]) { PS2_CS_L; buf[0] = PS2_Xfer(0x01); // 进入配置模式 buf[1] = PS2_Xfer(0x42); // 读取数据命令 for (uint8_t i = 2; i < 10; i++) buf[i] = PS2_Xfer(0x00); PS2_CS_H; }每次调用的间隔建议控制在 10ms 以上，不要连续高频调用，否则偶尔会出现数据错位。如果读回来的 buf[0] 一直是 0xFF 之类异常值，先检查供电和接线，再检查手柄是不是绿灯模式。
4. 四轮转速分配：麦克纳姆轮运动学解算与摇杆映射
4.1 麦克纳姆轮为什么能横移
麦克纳姆轮的每个轮子外圈都套着一圈可以自由转动的小滚子，小滚子的轴线与轮子轴线呈 45 度角。轮子转动时，地面给轮子的摩擦力会被滚子分解成两个方向的分量，其中一部分推动小车沿轮子轴向移动。四个轮子以不同速度和方向转动时，各个轮子的摩擦力分量在小车中心合成，就得到了任意方向的合力。
决定全向控制成败的有一个硬规则：麦克纳姆轮分为左旋和右旋两种，安装时必须保证对角线上的两个轮子同一种旋向。左前和右后是同一种，右前和左后是另一种。买轮子时商家会标注 A 型和 B 型，或者直接叫左旋右旋，一定不要搞混。装反了表现就是小车一推前进键就往斜上角跑，非常明显。
4.2 逆运动学公式
麦克纳姆轮底盘的控制核心是把“我想要小车以什么速度走”翻译成“四个轮子分别以什么速度转”，这一步叫逆运动学解算。用底盘正前方为 Y 正方向、正右方为 X 正方向、逆时针旋转为 ω 正方向，四个轮子线速度参考计算公式如下：
lf = vy - vx - L * wz; // 左前轮 rf = vy + vx + L * wz; // 右前轮 lr = vy + vx - L * wz; // 左后轮 rr = vy - vx + L * wz; // 右后轮其中 vy 是纵向目标速度，vx 是横向目标速度，wz 是旋转角速度。L 是底盘中心到轮子的等效距离，取横向半距和纵向半距之和，单位随便，只要所有轮子一致就行。公式算出来的值如果符号不同，代表的物理意义就是轮子转向不同。
这段公式虽然看起来简单，但有两点必须提醒。第一，不同资料里符号约定可能完全不同，这是麦克纳姆轮资料里最容易让新手困惑的地方。不要迷信公式的符号，上电后一定做分项验证：只给 vy，四个轮子应该同向同速；只给 vx，应该是两侧轮子反向；只给 wz，四个轮子应该呈对角对称方向转动。哪个分量方向反了，就把对应变量的符号取反，不要改电机接线。第二，公式没有除以轮子半径，因为我们在闭环控制中直接用这个值作为目标转速的相对大小，最后会通过一个标定系数映射到编码器目标脉冲。
4.3 手柄摇杆到目标速度的映射
手柄映射我用的是左手管平移、右手管旋转的方案：左摇杆 Y 轴控制 vy，左摇杆 X 轴控制 vx，右摇杆 X 轴控制 wz，右摇杆 Y 轴可以空着或定义为备用。读取摇杆后减 128，再做死区处理：绝对值小于 10 就归零，避免摇杆没有完全回中导致小车一直缓慢移动。
int16_t lx = buf[8] - 128; int16_t ly = buf[9] - 128; int16_t rx = buf[6] - 128; if (abs(lx) < 10) lx = 0; if (abs(ly) < 10) ly = 0; if (abs(rx) < 10) rx = 0; float vy = ly / 128.0f * MAX_SPEED; float vx = lx / 128.0f * MAX_SPEED; float wz = rx / 128.0f * MAX_TURN;MAX_SPEED 和 MAX_TURN 是小车的最高速度和最大旋转速度，根据你的电机能力和场地大小设定。刚开始调试时一定要限制得小一点，比如最大速度只给目标转速的 30%，否则小车一推手柄就飞出去，根本没有反应时间观察问题。
4.4 标定系数 K：把轮速映射成编码器目标脉冲
闭环控制里，速度的单位是编码器脉冲数而不是米每秒。因此需要一个标定系数 K，把运动学解算出来的速度值映射到编码器的目标脉冲数。标定方法很简单：给某个轮子一个固定的 PWM 占空比，比如 40%，让轮子空转，用编码器测出每 10ms 的脉冲数，然后用这个数除以对应的速度值，就是 K。
这么做的好处是彻底绕开了轮子直径、减速比、编码器线数这些繁琐的换算，直接用实验数据把所有物理参数一次性吸收进 K 里。4 个轮子因为机械差异，K 值可能略有不同，分别标定即可。
5. 速度闭环：编码器测速与PID调参的实战记录
5.1 为什么四个轮子必须上闭环
麦克纳姆轮小车的运动学解算成立的前提，是四个轮子实际转速和期望转速严格一致。但现实很残酷：四个电机之间存在个体差异，左右两侧摩擦阻力也不完全相等，相同占空比下的实际转速可能相差 5% 到 10%。在开环状态下，这 5% 的偏差会让小车在前进时逐渐走偏，在横移时变成斜线，在旋转时一个方向轻一个方向重。所以四个轮子全部要上速度闭环。
速度闭环的架构是外环直接对轮子转速做 PID 控制：期望速度来自运动学解算，实际速度来自编码器反馈，PID 输出是 PWM 占空比。整个控制周期我习惯设在 10ms，也就是每 10ms 采样一次编码器计数差值，更新一次 PID 输出。
5.2 编码器测速的两条路
带编码器的直流减速电机，编码器输出 A、B 两相正交方波。STM32 上有两种常见测速方法。
第一种是定时器编码器模式。F103 的 TIM1、TIM2、TIM3、TIM4 都支持编码器接口，把 A 相接到 CH1、B 相接到 CH2，配置成编码器模式后，CNT 寄存器会自动根据 A、B 相位差进行加减计数。这样测到的值自带正负号，方向判断不需要额外逻辑，四路编码器正好用四个定时器。
第二种是外部中断加定时器统计。只接 A 相到外部中断引脚，每来一个上升沿就把计数加一，方向用 B 相电平来判断。这种方法省定时器，但每个轮的计数都要占一个外部中断，干扰多的时候边沿容易丢。
我推荐用第一种，省心且可靠。采样代码如下：
// 定时器中断，每 10ms 调用一次 void Speed_Sample_Task(void) { speed_lf = (int16_t)TIM1->CNT; // 10ms 内的脉冲差值 speed_rf = (int16_t)TIM2->CNT; speed_lr = (int16_t)TIM3->CNT; speed_rr = (int16_t)TIM4->CNT; TIM1->CNT = 0; TIM2->CNT = 0; TIM3->CNT = 0; TIM4->CNT = 0; }5.3 增量式PID实现和限幅
四路轮子各自用一个 PID 实例，互不干扰。我用的是增量式 PID，输出是 PWM 占空比的增量，这种写法天然适合电机控制场景，因为输出不会在目标值突变时产生过大跳变。
typedef struct { float Kp, Ki, Kd; float err, last_err, prev_err; float out; } PID_t; float PID_Update(PID_t *pid, float target, float actual) { float err = target - actual; float d_err = err - pid->last_err; float inc = pid->Kp * d_err + pid->Ki * err + pid->Kd * (err - 2.0f * pid->last_err + pid->prev_err); pid->prev_err = pid->last_err; pid->last_err = err; pid->out += inc; if (pid->out > 999) pid->out = 999; // PWM 限幅 if (pid->out < -999) pid->out = -999; return pid->out; }速度值的正负号代表方向，PID 输出的正负号也代表方向。最终输出到驱动板时，根据符号切换 AIN1/AIN2，再取绝对值为占空比，就能把方向控制和速度控制拆开。
5.4 调参顺序和死区补偿
调参我强烈建议先单轮后整车。把四个轮子全部架空，代码里先只给左前轮一个固定目标速度，用一个轮子把 Kp 调到一个合适范围，再把参数复制给其他三个轮子。Kp 偏小表现是轮子转速跟不上目标、响应肉肉的；Kp 偏大表现是轮子转速震荡、有嗡嗡声。Kp 调到基本不震荡后，再逐步加 Ki 消除静差。Kd 在电机控制里通常作用不大，我一般直接用很小的值或者不用。
还有一个特别容易忽略的细节是 PWM 死区。直流减速电机存在启动死区，占空比低于某个值比如 10% 时轴根本不动，PID 积分在这个区间会不断累积，等到占空比终于超过死区时，电机突然猛地一冲。处理办法是在 PID 输出后加一个判断：如果目标速度不为零但实际速度为零，就把输出抬升到死区之上，同时限制积分累积。这个补偿逻辑看起来简单，但对低速微调场景帮助极大。
6. 联调踩坑实录：从“乱转”到“指哪打哪”的排查过程
6.1 小车前进时原地画圈，四个轮子方向“打架”
这是麦克纳姆轮小车最经典的问题，几乎每个第一次装车的人都会遇到。现象是按下前进键后，小车不往前走，而是在原地转圈或者斜着跑。排查链路是：先拆掉运动学，给四个轮子分别发送相同的正转指令，逐个确认电机本身转向是否一致、编码器反馈是否为正。如果这里没问题，再检查轮子旋向安装是否满足“对角线同型”规则。
我遇到过一个隐蔽的坑：四个轮子接线时有两根线插反了，导致右前和左后两个轮子的电机正转方向相反，前进指令下两个轮子向前推、两个轮子向后拽，车自然就在原地打转了。解决办法是在每个轮子的电机线上贴上标签，把 IN1、IN2 的正反逻辑在代码里统一，不要靠物理换线解决。
6.2 摇杆推“前进”却变成横移
手柄映射到 vx、vy 的通道如果接反，就会出现这个现象。左摇杆本来是前后推，结果因为摇杆 Y 轴被当成 vx 用了，前后推变成了横移。这是纯逻辑层面的错误，检查主循环里手柄摇杆和运动学输入参数的对应关系即可。这类问题用我前面说的“分项验证法”很好定位：单独推前后，看是不是只有 vy 有值；单独推左右，看是不是只有 vx 有值；单独转右摇杆，看是不是只有 wz 有值。
6.3 手柄偶尔失灵或数据全是 0xFF
排查顺序依次是供电、接线、时序。先是 PS2 接收模块的 VCC 有没有稳定在 3.3V，别用万用表量空载电压，要带模块实测；然后是 DAT、CMD、CLK、CS 四根线是否接触良好，杜邦线松动会引起偶发失联；最后是通信时序，确认时钟频率是否过高、CS 拉低前后延时是否足够。还有一个很容易被忽略的点：手柄和接收模块刚上电时有时需要几秒配对时间，代码里开机后先延时 200ms 再初始化，能减少很多莫名其妙的首次通信失败。
6.4 一推摇杆小车就重启
这个现象基本可以断定是电源问题。四个电机同时加速时电流冲击很大，电池电压被瞬间拉低，单片机的供电一旦跌破复位阈值就重启。排查时先用示波器或者万用表看电机启动瞬间的电池电压，如果发现压降超过 0.5V，就在电池输出端并联 470μF 以上电解电容。再确认一下 STM32 的供电有没有和电机驱动共用同一根线，如果共用，把逻辑供电独立分出来，用粗一点的导线单独接到稳压模块。
6.5 转弯方向老是反
这通常不是硬件问题，而是运动学公式中 wz 的符号约定和实际电机方向相反。解决方法是把wz变量取反，或者把左右侧轮子的旋转效应互换。改代码比改结构要快得多，不需要动任何接线。
调试到最后分享一个小技巧：把所有联调测试做成一个手柄按键菜单。按键 A 触发单轮自检，依次验证四个轮子的电机和编码器方向；按键 B 触发纯前后运动；按键 C 触发纯横移运动；按键 D 触发原地旋转。每次上电先跑一遍这个菜单，确认所有硬件正常后再进入正式控制逻辑。这个习惯帮我省掉了至少 80% 的硬件排查时间，强烈推荐你也这样做。
本文还有配套的精品资源，点击获取
