手把手教你用STM32F103驱动麦克纳姆轮小车：从TB6612接线到PID调参全流程

STM32F103麦克纳姆轮小车实战指南：从硬件搭建到PID调优

第一次接触麦克纳姆轮时，我被它那违反直觉的运动方式震撼了——四个轮子各自朝不同方向旋转，却能实现车体的精准平移。这种独特的运动特性让麦克纳姆轮在狭窄空间作业、全向移动机器人等领域大放异彩。本文将带你从零开始，用STM32F103这款经典单片机搭建一个完整的麦克纳姆轮控制系统。不同于单纯的理论讲解，我们会重点关注那些实际开发中真正会遇到的问题：如何避免TB6612驱动芯片的常见接线错误？编码器读数出现跳变怎么处理？PID参数整定有哪些实用技巧？

1. 硬件系统搭建

1.1 麦克纳姆轮机械结构解析

麦克纳姆轮的核心秘密在于轮缘45度排列的辊子。当轮子旋转时，这些辊子会产生斜向的摩擦力分量。四个轮子按特定组合排列（通常两个左旋轮、两个右旋轮），通过协调各轮转速和转向，就能合成任意方向的移动。

关键参数对比表：

实际组装时要注意：

• 确保四个轮子的辊子朝向正确（左旋和右旋轮交替安装）
• 轮子与车体连接处要留出足够间隙，避免辊子转动时摩擦车架
• 推荐使用3D打印或CNC加工的车体，保证结构刚度

1.2 TB6612驱动电路详解

TB6612相比常用的L298N具有明显优势：

• 效率更高（MOSFET vs 三极管）
• 无需外接散热片
• 内置保护电路（过热、低压）

典型接线图：

STM32 GPIO ──┬─→ PWMA (PWM信号) ├─→ AIN1 (方向控制) └─→ AIN2 (方向控制) TB6612 AO1 ──→ 电机正极 TB6612 AO2 ──→ 电机负极 VM ────────→ 7.2V锂电池 VCC ───────→ 3.3V逻辑电源 GND ───────→ 共地

注意：实际调试中发现，若VM电压超过10V，建议在电机两端并联续流二极管（如1N5819），防止关断时的反向电动势损坏芯片。

常见问题排查：

• 电机不转：先检查STBY引脚是否接高电平
• 电机抖动：PWM频率建议设置在10-20kHz，避免可闻噪声
• 发热异常：检查是否有多余焊锡导致短路

2. 电机基础驱动实现

2.1 PWM调速原理与实践

STM32的定时器可以方便地生成PWM信号。以下是一个典型的PWM初始化代码：

// TIM3_CH1 PWM初始化 void PWM_Init(void) { GPIO_InitTypeDef GPIO_InitStructure; TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_OCInitTypeDef TIM_OCInitStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); // GPIOA6配置为复用推挽输出 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOA, &GPIO_InitStructure); // 定时器基础设置：10kHz PWM TIM_TimeBaseStructure.TIM_Period = 999; // ARR值 TIM_TimeBaseStructure.TIM_Prescaler = 71; // 72MHz/(71+1)=1MHz TIM_TimeBaseStructure.TIM_ClockDivision = 0; TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); // PWM模式配置 TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; TIM_OCInitStructure.TIM_Pulse = 0; // 初始占空比0% TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; TIM_OC1Init(TIM3, &TIM_OCInitStructure); TIM_Cmd(TIM3, ENABLE); TIM_CtrlPWMOutputs(TIM3, ENABLE); }

实际调试技巧：

• 使用逻辑分析仪观察PWM波形，确保频率和占空比符合预期
• 逐步增加占空比，观察电机启动时的最小有效值（通常约15-20%）
• 注意电机堵转电流，必要时增加电流检测保护

2.2 电机正反转控制逻辑

TB6612的真值表如下：

对应的控制函数实现：

void Motor_Set(int motor, int speed) { speed = constrain(speed, -255, 255); // 限制速度范围 if(motor == MOTOR_A) { if(speed > 0) { GPIO_WriteBit(GPIOA, AIN1_PIN, Bit_SET); GPIO_WriteBit(GPIOA, AIN2_PIN, Bit_RESET); } else { GPIO_WriteBit(GPIOA, AIN1_PIN, Bit_RESET); GPIO_WriteBit(GPIOA, AIN2_PIN, Bit_SET); } TIM_SetCompare1(TIM3, abs(speed)); // 设置PWM占空比 } // 其他电机类似... }

3. 编码器数据采集与处理

3.1 正交编码器工作原理

光电编码器通过光栅盘和光电传感器产生两路相位差90°的方波（A相和B相）。STM32的定时器可以直接解码这种正交信号，无需外部中断处理。

编码器模式特点：

• 自动识别转向（根据A/B相相位关系）
• 支持4倍频计数（在每个边沿计数）
• 16位计数器（0-65535）

初始化代码示例：

void Encoder_Init(TIM_TypeDef* TIMx) { TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_ICInitTypeDef TIM_ICInitStructure; // 定时器时钟使能 if(TIMx == TIM2) RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); if(TIMx == TIM3) RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); // 编码器接口配置 TIM_TimeBaseStructInit(&TIM_TimeBaseStructure); TIM_TimeBaseStructure.TIM_Prescaler = 0; TIM_TimeBaseStructure.TIM_Period = 0xFFFF; TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1; TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIMx, &TIM_TimeBaseStructure); TIM_EncoderInterfaceConfig(TIMx, TIM_EncoderMode_TI12, TIM_ICPolarity_Rising, TIM_ICPolarity_Rising); TIM_ICStructInit(&TIM_ICInitStructure); TIM_ICInitStructure.TIM_ICFilter = 10; // 滤波器减少噪声 TIM_ICInit(TIMx, &TIM_ICInitStructure); TIM_Cmd(TIMx, ENABLE); }

3.2 速度计算与滤波

通过定时中断定期读取编码器计数值，可以计算电机转速：

// 在1ms定时中断中 void TIM2_IRQHandler(void) { if(TIM_GetITStatus(TIM2, TIM_IT_Update) != RESET) { static int32_t last_count[4] = {0}; int16_t current_count = TIM_GetCounter(ENCODER_TIM); // 处理计数器溢出 velocity = (current_count - last_count[motor]) * 1000 / sample_time; last_count[motor] = current_count; // 低通滤波 filtered_velocity = 0.8 * filtered_velocity + 0.2 * velocity; TIM_ClearITPendingBit(TIM2, TIM_IT_Update); } }

常见问题解决方案：

• 计数跳变：增加硬件滤波（RC电路）和软件滤波（中值滤波）
• 方向错误：检查编码器A/B相接线是否反接
• 速度波动大：适当增加采样周期或调整滤波器参数

4. PID控制算法实现

4.1 位置式PID实现

位置式PID适合需要精确位置控制的场景，如定点停车：

typedef struct { float Kp, Ki, Kd; float integral; float last_error; } PID_Controller; float PID_Compute(PID_Controller* pid, float setpoint, float input) { float error = setpoint - input; // 积分项抗饱和 pid->integral += error; if(pid->integral > INTEGRAL_LIMIT) pid->integral = INTEGRAL_LIMIT; else if(pid->integral < -INTEGRAL_LIMIT) pid->integral = -INTEGRAL_LIMIT; // 微分项（避免设定值突变导致的微分冲击） float derivative = error - pid->last_error; float output = pid->Kp * error + pid->Ki * pid->integral + pid->Kd * derivative; pid->last_error = error; return output; }

4.2 增量式PID调参技巧

增量式PID更适合速度控制，具有抗积分饱和、手动/自动切换无冲击等优点：

float Incremental_PID_Compute(PID_Controller* pid, float setpoint, float input) { static float prev_error = 0, prev_prev_error = 0; float error = setpoint - input; float delta = pid->Kp * (error - prev_error) + pid->Ki * error + pid->Kd * (error - 2*prev_error + prev_prev_error); prev_prev_error = prev_error; prev_error = error; return delta; }

PID参数整定步骤：

1. 初始化所有参数为0
2. 先调P：逐步增大Kp直到系统出现等幅振荡，然后取该值的50-60%
3. 再调D：增加Kd抑制超调，注意过大的Kd会导致高频抖动
4. 最后调I：适当增加Ki消除静差，但过大的Ki会引起积分饱和

提示：实际调试时，可以先用Ziegler-Nichols方法估算初始参数，再微调。记录每次参数调整后的响应曲线非常有助于分析。

4.3 运动学解算实现

麦克纳姆轮的运动控制需要将车体速度分解到四个轮子上：

void Mecanum_Calculate(float vx, float vy, float omega, float* wheel_speeds) { // 参数说明： // vx,vy: 车体坐标系下的平移速度 // omega: 旋转角速度(rad/s) // L: 轮距/2, W: 轴距/2 wheel_speeds[0] = vx - vy - (L+W)*omega; // 右前轮 wheel_speeds[1] = vx + vy + (L+W)*omega; // 左前轮 wheel_speeds[2] = vx + vy - (L+W)*omega; // 右后轮 wheel_speeds[3] = vx - vy + (L+W)*omega; // 左后轮 // 归一化处理 float max_speed = 0; for(int i=0; i<4; i++) { max_speed = fmaxf(max_speed, fabsf(wheel_speeds[i])); } if(max_speed > MAX_SPEED) { for(int i=0; i<4; i++) { wheel_speeds[i] = wheel_speeds[i] * MAX_SPEED / max_speed; } } }

实际项目中，建议先用遥控器手动测试各方向运动，确认运动学模型正确后再实现自动控制。遇到轮子打滑或运动不线性时，检查机械结构是否对称、轮子接地是否均匀。