我的机械臂动起来了：基于STM32F103和SG90舵机，从接线到代码调试的全记录-编程实验室

从零构建二自由度机械臂：STM32F103与SG90舵机的实战指南

1. 项目缘起与核心器件选型

去年夏天，我在清理工作室时偶然发现了几只闲置的SG90舵机。这些橙色外壳的小家伙让我萌生了一个想法：能否用它们搭配手头的STM32F103开发板，打造一个简易的二自由度机械臂？这个看似简单的想法，最终演变成了一场充满挑战与惊喜的嵌入式系统实战之旅。

SG90舵机作为创客圈内的"国民级"执行器件，其核心优势在于：

性价比突出：单价不足20元，却具备位置反馈功能
控制简单：标准50Hz PWM信号即可驱动
扭矩适中：1.5kg·cm扭矩足以支撑小型机械结构

与之配合的STM32F103RCT6开发板，则是嵌入式入门者的经典选择：

主要参数： - ARM Cortex-M3内核 - 72MHz主频 - 16个PWM输出通道 - 丰富的GPIO资源

2. 硬件架构设计与避坑实践

2.1 供电系统的关键细节

初次连接时，我犯了个典型错误——直接使用开发板的USB供电驱动两个舵机。当机械臂试图举起一支马克笔时，舵机突然出现"抽搐"现象。这个教训让我明白：

多舵机系统的供电要点：

独立电源供电（推荐5V/2A以上）
共地处理（连接开发板与电源地线）
加装大容量电容（470μF以上）滤除电压波动

实测发现：当两个舵机同时动作时，瞬时电流可能突破1A。使用示波器观察，电源电压会出现0.8V左右的跌落。

2.2 信号线布局的艺术

PWM信号线看似简单，却暗藏玄机。我的第二次失败是使用30cm长的杜邦线连接舵机，结果出现：

角度控制不精确
偶尔出现异常抖动

优化方案：

// 硬件PWM配置示例（TIM3通道1） 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); // 定时器基础配置（50Hz PWM） TIM_TimeBaseStructure.TIM_Period = 19999; // 20ms周期 TIM_TimeBaseStructure.TIM_Prescaler = 71; // 72MHz/(71+1)=1MHz TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); // PWM模式配置 TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; TIM_OCInitStructure.TIM_Pulse = 1500; // 初始1.5ms脉宽 TIM_OC1Init(TIM3, &TIM_OCInitStructure); TIM_Cmd(TIM3, ENABLE); }

3. 软件控制的核心算法

3.1 角度到脉宽的精确映射

SG90的理论控制范围是0-180°，但实测发现不同舵机存在个体差异。我开发了校准程序：

// 舵机校准函数 void Servo_Calibrate(uint8_t channel) { uint16_t pulse_min = 500; // 0.5ms uint16_t pulse_max = 2500; // 2.5ms for(int angle=0; angle<=180; angle+=10){ uint16_t pulse = pulse_min + (angle * (pulse_max-pulse_min)/180); PWM_SetPulse(channel, pulse); HAL_Delay(500); } }

3.2 运动轨迹规划

直接设置目标角度会导致机械臂动作生硬。通过引入缓动算法，运动变得流畅自然：

// 二次缓动函数 float easeOutQuad(float t) { return t*(2-t); } void SmoothMove(uint8_t channel, float start_angle, float end_angle, uint16_t duration) { uint32_t start_time = HAL_GetTick(); while(HAL_GetTick()-start_time < duration){ float progress = (float)(HAL_GetTick()-start_time)/duration; float current_angle = start_angle + (end_angle-start_angle)*easeOutQuad(progress); PWM_SetAngle(channel, current_angle); HAL_Delay(10); } }

4. 机械结构设计与优化

4.1 3D打印件设计要点

经过三次迭代，我的机械臂结构优化路径如下：

版本	特点	问题	改进
V1	单层结构	刚性不足	增加加强筋
V2	全封闭设计	散热不良	增加通风孔
V3	模块化连接	拆装不便	改用磁吸接口

4.2 配重与力矩平衡

在末端执行器加装摄像头时，发现第二个关节出现"点头"现象。解决方案：

在前臂添加配重块
改用金属齿轮舵机（MG90S）
降低运动速度

5. 人机交互实现

5.1 摇杆控制方案

采用PS2摇杆模块作为输入设备，其ADC值转换为角度：

#define JOYSTICK_DEADZONE 50 uint8_t Joystick_GetAngle(uint16_t adc_val) { if(adc_val < 1024/2 - JOYSTICK_DEADZONE){ return 90 + (adc_val * 90)/(1024/2 - JOYSTICK_DEADZONE); } else if(adc_val > 1024/2 + JOYSTICK_DEADZONE){ return 90 + ((adc_val - 1024/2 - JOYSTICK_DEADZONE) * 90)/(1024/2 - JOYSTICK_DEADZONE); } return 90; // 中位值 }

5.2 手机蓝牙控制

通过HC-05模块实现手机APP控制，协议设计如下：

字节	含义
0	帧头(0xFF)
1	通道号
2	角度高字节
3	角度低字节
4	校验和

6. 进阶技巧与性能提升

6.1 多舵机同步控制

传统顺序控制会导致机械臂动作不连贯。采用定时器中断实现同步：

// 在定时器中断中更新所有通道 void TIM2_IRQHandler(void) { if(TIM_GetITStatus(TIM2, TIM_IT_Update)){ static uint8_t count = 0; if(++count >= 20){ // 50Hz更新 count = 0; for(int i=0; i<SERVO_NUM; i++){ PWM_SetPulse(i, target_pulse[i]); } } TIM_ClearITPendingBit(TIM2, TIM_IT_Update); } }

6.2 负载自适应算法

通过检测电流变化判断是否发生堵转：

#define CURRENT_THRESHOLD 800 // mA void Safety_Check(void) { uint16_t current = ADC_Read(CURRENT_SENSOR_CH); if(current > CURRENT_THRESHOLD){ PWM_DisableAll(); Buzzer_Alert(); } }

在完成这个项目后，最让我惊喜的不是最终成品的机械臂能完成多少动作，而是在解决各种意外问题时积累的实战经验。比如发现用热熔胶固定舵机齿轮能有效消除回程间隙，这个技巧现在已经成为我的秘密武器。嵌入式开发的魅力，往往就藏在这些看似微不足道的细节之中。