STM32F103二维云台设计：从PWM控制到平滑算法的完整实现

简介：本资源是一套基于STM32F103微控制器的二维云台舵机控制系统完整工程，面向嵌入式初学者与课程设计实践者，解决舵机精准角度控制、PWM信号生成及多轴协同驱动等典型问题，适用于智能云台、视觉跟踪、机器人云台模块等应用场景。压缩包共189个文件，含33个C源文件（如stm32f10x_tim.c、usart.c等外设驱动）、34个头文件（.h）、35个编译目标文件（.o）及35个依赖文件（.d），另有uvprojx工程配置、axf可执行镜像、hex烧录文件及map链接映射等关键构建产物，整体大小6.74MB。目前已有8724人学习下载。读者可直接导入Keil MDK环境运行，完整获取CORE底层驱动、USER应用逻辑、HARDWARE硬件接口说明及SYSTEM系统库集成方案，尤其包含TIM定时器PWM输出配置、双舵机俯仰/偏航协同控制算法及标准外设库（FWLib）调用范例，是掌握STM32舵机控制全流程的高复用性参考工程。

1. 项目缘起：从“动起来”到“指哪打哪”的跨越

很多朋友在玩单片机控制舵机时，可能都满足于让舵机简单地转个角度，比如让一个舵机从0度转到180度，再转回来。这确实能实现“动起来”的效果，但当我们想做一个能追踪目标、或者让摄像头稳定指向某个方向的装置时，单个舵机的单轴运动就显得力不从心了。这时候，二维云台就成了一个自然而然的选择。它本质上就是两个舵机的组合，一个负责水平方向的转动（我们常叫它“航向轴”或“Yaw轴”），另一个负责垂直方向的俯仰（我们叫它“俯仰轴”或“Pitch轴”），两个轴正交安装，就能实现指向空间任意一个方向的能力。

我这次做的这个基于STM32F103的二维云台项目，就是想解决这个“指哪打哪”的问题。STM32F103这颗芯片大家太熟悉了，性价比高，资源丰富，特别是它的定时器功能非常强大，用来产生精准的PWM信号控制舵机是再合适不过了。网上关于单个舵机的教程很多，但把两个舵机协调起来做成一个稳定、可控的云台系统，其中涉及的机械结构、控制逻辑、电源处理等细节，还是有不少坑要踩的。这个项目就是把我从选型、画板、写代码到调试的完整过程记录下来，特别是那些容易忽略但又至关重要的点，比如如何避免两个舵机同时动作时的电源抖动，如何设计一个平滑的运动算法让云台转动更“柔顺”而不是“抽搐”。

2. 核心硬件选型与电路设计考量

做硬件项目，第一步永远是选型和画原理图。这一步的决策直接决定了后续调试的难度和最终系统的性能上限。

2.1 主控芯片：为什么依然是STM32F103C8T6？

在众多STM32型号中，我依然选择了经典的“蓝桥杯”神器——STM32F103C8T6。原因很实在：第一，资源完全够用。控制两个舵机只需要两个定时器的两个PWM通道，F103的定时器资源绰绰有余。第二，生态极其完善。无论是标准库、HAL库还是寄存器版本的资料都一抓一大把，遇到问题几乎都能找到解决方案。第三，成本低廉。核心板价格已经非常透明，自己画最小系统板也很简单。

这里有个细节要注意，就是芯片的供电。F103的核心电压是3.3V，但它的IO口可以容忍5V输入。这意味着我们可以用5V逻辑电平去控制一些模块，兼容性更好。但在设计电源时，一定要保证3.3V的LDO（低压差线性稳压器）有足够的电流余量，除了芯片本身，还要考虑外围电路如LED、串口转换芯片等的耗电。

2.2 舵机选择：扭矩、速度与供电的平衡

舵机是云台的执行机构，它的选型至关重要。主要看几个参数：

1. 工作电压：最常见的是4.8V~6.8V。我们通常按5V或6V来设计电源。电压越高，在同一型号下，舵机的输出扭矩和转速通常会略有提升，但发热和损耗也会增加。
2. 扭矩：单位是kg·cm。意思是舵机输出轴在距离中心1厘米处能吊起多重的物体。对于云台来说，你需要估算一下自己设计的云台支架、摄像头或其他负载的重量和力臂，然后留出至少1.5到2倍的余量来选择扭矩。比如负载估计需要2kg·cm的扭矩，那么最好选择一个扭矩在3-4kg·cm以上的舵机，以保证在快速启停时仍有足够动力，避免出现“失步”或抖动。
3. 速度：单位是秒/60度。指的是舵机在无负载情况下转动60度所需要的时间。这个参数影响云台的响应速度。对于追踪等应用，当然希望速度越快越好，但高速舵机通常价格更贵，功耗也更大。
4. 尺寸和重量：云台本身需要两个舵机叠加，尺寸和重量直接影响整体结构和另一个舵机的负载。需要权衡。

我这次选用的是两款常见的MG90S金属齿轮舵机。它的标称扭矩是1.8kg·cm（4.8V）或2.2kg·cm（6.0V），速度0.11s/60°（4.8V）或0.09s/60°（6.0V）。对于负载不重（比如一个小型摄像头或激光笔）的云台来说，这个性能是足够的。而且金属齿轮比塑料齿轮更耐用，不容易扫齿。

注意：舵机的参数标称往往是在理想条件下测得的。实际使用中，特别是装上负载后，速度和扭矩都会打折扣。购买时最好选择信誉好的品牌，并做好实测验证。

2.3 电源电路设计：最容易被低估的环节

云台系统最大的电流消耗就来自两个舵机。单个舵机在空载静止时电流可能只有几十毫安，但在堵转（即输出轴被卡住无法转动）或快速启动的瞬间，电流可以轻松飙升到1A甚至更高。两个舵机如果同时动作，对电源的瞬间冲击是很大的。

很多初学者直接用USB口的5V（最大500mA）或者一个普通的7805线性稳压器来给整个系统供电，结果就是云台一动，单片机就复位，或者舵机动作无力、抖动异常。这就是典型的电源功率不足、动态响应跟不上导致的。

我的解决方案是电源分路和加大电容：

1. 分路供电：将舵机的供电（5V或6V）与单片机和其它逻辑电路的供电（3.3V/5V）在源头分开。例如，使用一个7.4V的锂电池，通过一个DC-DC降压模块（如MP1584EN）降压到6V给舵机供电；同时，再从6V输出端，通过一个低压差的LDO（如AMS1117-3.3）降压到3.3V给单片机供电。这样，舵机工作时的大电流波动不会直接影响到单片机的核心电压。
2. 大容量电容储能：在给舵机供电的6V电源正负极之间，并联一个大容量的电解电容（如470μF ~ 1000μF，耐压16V以上），再并联一个0.1μF的陶瓷电容用于滤除高频噪声。这个大电容就像一个“小水池”，在舵机突然需要大电流时，可以快速提供能量，平滑电压波动，避免电源电压被瞬间拉低。
3. 走线要粗：连接舵机电源和地的PCB走线或者导线一定要足够粗，以减少线路阻抗带来的压降。

我的实际电路是：一节7.4V 2200mAh的锂电池 -> MP1584EN可调降压模块（输出调至6.0V）-> （此处并联1000μF电解电容和0.1μF陶瓷电容）-> 分别给两个舵机供电。同时，从6.0V输出接AMS1117-3.3给STM32供电。

2.4 通信与调试接口预留

为了方便调试和后续扩展，以下接口建议务必留出：

1. 串口（UART）：连接一个CH340G之类的USB转TTL芯片，引出TX（PA9）、RX（PA10）到排针。这是程序下载、打印调试信息（printf）的生命线。
2. SWD下载口：留出标准的SWDIO和SWCLK接口（对应PA13和PA14），用于ST-Link/V2调试器连接，进行程序下载和单步调试。这比串口ISP下载方便太多了。
3. 预留IO口：除了控制两个舵机的PWM引脚，再多引出几个GPIO到排针，方便后续接按键、超声波模块、蓝牙模块等。
4. 电源指示灯和用户LED：简单的电源指示灯（接3.3V）和一颗由单片机控制的LED（比如接PC13），在调试时能提供最直观的状态反馈。

3. STM32的PWM配置：精度与稳定性的基石

舵机的控制信号是一个周期为20ms（50Hz），脉冲宽度在0.5ms到2.5ms之间的PWM波。脉冲宽度对应着舵机输出轴的位置（通常对应0度到180度）。STM32的通用定时器（TIM2, TIM3, TIM4等）非常适合产生这种信号。

3.1 定时器与PWM模式选择

以使用TIM3的通道1（PA6）和通道2（PA7）控制两个舵机为例。我们使用标准库进行配置，思路同样适用于HAL库。

首先，核心是计算定时器的预分频器（PSC）和自动重装载值（ARR），这两个值决定了PWM波的频率。我们的目标是产生50Hz（周期20ms）的PWM。

假设系统时钟（SYSCLK）是72MHz（这是F103常见配置）。定时器的时钟源经过预分频器后，得到计数器时钟CK_CNT = SYSCLK / (PSC + 1)。

我们希望PWM周期是20ms，即计数器从0计数到ARR值的时间是20ms。所以有：(ARR + 1) / CK_CNT = 0.02秒

为了获得较高的角度控制分辨率，我们希望ARR尽可能大。但同时，ARR是一个16位寄存器（对于通用定时器），最大值是65535。我们需要在分辨率和计算方便之间权衡。

一个常见的配置是：设置PSC = 7199。那么CK_CNT = 72,000,000 / (7199 + 1) = 10,000 Hz = 10 kHz。 此时，计数器每计数一次是0.1ms。要让周期为20ms（即200个0.1ms），则ARR应设置为199。 因为周期 = (ARR + 1) * (1 / CK_CNT) = 200 * 0.0001s = 0.02s。

这样，我们就得到了一个10kHz的计数器时钟，和200个计数周期的PWM周期。脉冲宽度（控制舵机角度）通过改变捕获/比较寄存器（CCR）的值来实现。CCR的值范围是0到ARR（即0-199）。

• 0.5ms脉冲宽度对应 CCR = 0.5ms / 0.1ms = 5
• 1.5ms脉冲宽度对应 CCR = 1.5ms / 0.1ms = 15 （中点，通常对应90度）
• 2.5ms脉冲宽度对应 CCR = 2.5ms / 0.1ms = 25

所以，CCR值从5到25，理论上对应舵机0到180度。分辨率是 180度 / (25-5) = 9度/步，这个分辨率比较粗糙。为了更精细的控制，我们可以提高CK_CNT频率。

另一种更高分辨率的配置：设置PSC = 719，则CK_CNT = 72,000,000 / 720 = 100,000 Hz = 100 kHz。计数器每步0.01ms。 此时，周期20ms需要 ARR = (0.02s / 0.00001s) - 1 = 2000 - 1 = 1999。

• 0.5ms -> CCR = 50
• 1.5ms -> CCR = 150
• 2.5ms -> CCR = 250

角度分辨率变为 180度 / (250-50) = 0.9度/步，控制就精细多了。我采用的是这种配置。

3.2 代码实现：标准库配置示例

以下是基于标准库的核心配置代码：

#include "stm32f10x.h" void PWM_Init(void) { GPIO_InitTypeDef GPIO_InitStructure; TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_OCInitTypeDef TIM_OCInitStructure; // 1. 开启时钟 RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_AFIO, ENABLE); RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); // 2. 配置GPIO为复用推挽输出 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7; // TIM3_CH1, TIM3_CH2 GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; // 复用推挽输出 GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOA, &GPIO_InitStructure); // 3. 配置定时器时基 TIM_TimeBaseStructure.TIM_Period = 1999; // ARR值，决定周期 TIM_TimeBaseStructure.TIM_Prescaler = 719; // PSC值，72M/(719+1)=100kHz TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1; TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; // 向上计数模式 TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); // 4. 配置PWM模式 (通道1和通道2) TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; // PWM模式1 TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; // 输出使能 TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; // 输出极性高，有效电平为高 TIM_OCInitStructure.TIM_Pulse = 0; // 初始占空比，CCR值，后面动态设置 TIM_OC1Init(TIM3, &TIM_OCInitStructure); // 初始化通道1 TIM_OC2Init(TIM3, &TIM_OCInitStructure); // 初始化通道2 // 使能预装载寄存器（保证CCR更新在下一个周期生效，避免中间产生毛刺） TIM_OC1PreloadConfig(TIM3, TIM_OCPreload_Enable); TIM_OC2PreloadConfig(TIM3, TIM_OCPreload_Enable); TIM_ARRPreloadConfig(TIM3, ENABLE); // 使能ARR预装载 // 5. 启动定时器 TIM_Cmd(TIM3, ENABLE); } // 设置舵机角度的函数 // servo_id: 0-舵机1(PA6), 1-舵机2(PA7) // angle: 目标角度，范围0-180 void Set_Servo_Angle(uint8_t servo_id, float angle) { uint16_t ccr_val; // 将角度映射到CCR值。根据计算，0度->CCR=50, 180度->CCR=250 // 线性映射公式：CCR = 50 + angle * (200 / 180.0) = 50 + angle * (10/9) ccr_val = (uint16_t)(50 + angle * 200.0 / 180.0); // 添加软件限幅，防止超出有效范围损坏舵机 if (ccr_val < 50) ccr_val = 50; if (ccr_val > 250) ccr_val = 250; if (servo_id == 0) { TIM_SetCompare1(TIM3, ccr_val); // 设置TIM3通道1的CCR值 } else if (servo_id == 1) { TIM_SetCompare2(TIM3, ccr_val); // 设置TIM3通道2的CCR值 } }

这段代码里有两个关键点：

1. TIM_OCPreload_Enable和TIM_ARRPreload_Enable的使能，这保证了当我们修改CCR或ARR值时，新值会在下一个PWM周期生效，而不是立即生效，从而避免了当前周期内产生不完整的脉冲，导致舵机抖动。
2. Set_Servo_Angle函数里的软件限幅。虽然我们计算了理论范围，但实际舵机可能有细微差异，或者用户输入了错误的角度值。强制将CCR值限制在50-250这个安全区间内，是保护舵机齿轮不过度扭转导致损坏的好习惯。

4. 机械结构设计与组装：精度与刚性的保证

硬件电路和驱动代码准备好了，接下来就是让想法变成实物。二维云台的机械结构看似简单，但设计不好会严重影响控制精度和稳定性。

4.1 常见结构方案对比

1. 叠罗汉式（上下结构）：这是最简单的方式。一个舵机作为底座，负责水平旋转（Yaw轴）。在它的舵盘上，通过一个L形支架或U形支架，安装第二个负责俯仰（Pitch轴）的舵机。这种结构简单，但重心较高，俯仰舵机及其负载的重量全部由航向舵机承担。如果负载较重，航向舵机在快速启停时容易晃动，整体稳定性稍差。
2. 十字交叉式（十字盘结构）：两个舵机呈十字形交叉安装，一个负责左右，一个负责上下，负载安装在交叉中心。这种结构重心相对集中，两个舵机分担负载，动态性能更好。但结构设计和加工稍微复杂一些。
3. 一体化云台支架：网上有售很多3D打印或CNC加工的专用二维云台支架。这类支架通常考虑了走线、限位和安装孔位，是快速成型的最佳选择。我这次就选用了一种常见的3D打印尼龙材质支架，它属于改良的叠罗汉式，但为俯仰舵机设计了下沉空间，降低了重心。

我的建议是，如果你是第一次做，为了省事和保证效果，可以直接购买现成的云台支架。如果想挑战自己，用亚克力板或铝板自己激光切割/折弯设计一个十字交叉结构，也是很好的学习过程。

4.2 组装过程中的关键细节

组装不是拧上螺丝就行，几个细节决定了云台是“玩具”还是“工具”。

1. 舵盘与支架的固定：舵机自带的塑料舵盘和支架之间的连接一定要牢固。建议在舵盘和支架之间使用螺丝+螺母对锁，而不是仅仅把螺丝拧进塑料舵盘的螺纹里。塑料螺纹在反复受力下很容易滑丝。如果支架是3D打印的，可以在设计时预留沉孔，让螺母嵌进去。
2. 线缆管理：两个舵机有三根线（电源正、电源负、信号线）。凌乱的线缆不仅难看，更容易在转动时被缠绕、拉扯，导致接触不良甚至扯断。可以用扎带或热缩管将线缆整理好，并预留出足够的活动长度。理想情况是，线缆从云台中心或底座内部穿过。
3. 限位考虑：虽然我们的软件做了限幅，但机械限位是最后的安全保障。特别是俯仰轴，要避免舵机旋转角度过大，导致摄像头或负载撞到下面的底座。可以在支架设计上增加物理挡块，或者在软件上设置比实际机械范围更小的安全角度范围（比如只允许俯仰20度到160度）。
4. 重心调试：组装完成后，用手轻轻拨动云台各轴，应该感觉平衡、顺滑，没有明显的“一头沉”现象。如果俯仰轴前端（装摄像头的一端）太重，会导致俯仰舵机始终需要出力来对抗重力，增加功耗和发热，影响精度。可以通过在支架后端配重（比如粘一小块配重块）来调整平衡。

5. 控制软件进阶：从“能动”到“好用”

让两个舵机动起来只是第一步。一个“好用”的云台控制系统，还需要解决运动平滑性、坐标转换、甚至简单的反馈控制等问题。

5.1 运动平滑算法：告别“步进电机”式的抖动

如果你直接调用Set_Servo_Angle(0, 0);和Set_Servo_Angle(0, 90);，舵机会“唰”一下从0度跳到90度。这种瞬时的大跨度位置变更，会让舵机以最大速度冲过去，产生很大的惯性冲击，导致云台整体晃动，摄像头画面剧烈抖动。

我们需要一个“平滑移动”的算法，让舵机匀速地、或者以某种平滑的曲线（如S型曲线）从一个角度运动到另一个角度。最常用的是线性插值。

思路是：每隔一小段时间（比如10ms），计算一次舵机当前应该到达的“中间角度”，然后逐步设置过去，直到到达目标角度。

typedef struct { float current_angle; // 当前角度 float target_angle; // 目标角度 float step_angle; // 每次更新的步进角度 uint8_t is_moving; // 运动标志位 } ServoCtrl_t; ServoCtrl_t servo_yaw, servo_pitch; // 定义两个舵机的控制结构体 // 初始化 void Servo_Ctrl_Init(void) { servo_yaw.current_angle = 90.0f; servo_yaw.target_angle = 90.0f; servo_yaw.step_angle = 1.0f; // 每步1度 servo_yaw.is_moving = 0; Set_Servo_Angle(0, 90.0f); // 初始化到90度 servo_pitch.current_angle = 90.0f; servo_pitch.target_angle = 90.0f; servo_pitch.step_angle = 1.0f; servo_pitch.is_moving = 0; Set_Servo_Angle(1, 90.0f); } // 设置目标角度，并启动平滑移动 void Set_Servo_Target(ServoCtrl_t *servo, uint8_t id, float target) { if (target < 0.0f) target = 0.0f; if (target > 180.0f) target = 180.0f; servo->target_angle = target; servo->is_moving = 1; } // 在定时器中断（例如1ms或10ms一次）中调用此函数 void Servo_Update_Handler(void) { // 更新Yaw轴 if (servo_yaw.is_moving) { if (fabs(servo_yaw.current_angle - servo_yaw.target_angle) <= servo_yaw.step_angle) { // 已经非常接近目标，直接设置到目标并停止运动 servo_yaw.current_angle = servo_yaw.target_angle; servo_yaw.is_moving = 0; } else { // 计算下一步的方向 if (servo_yaw.current_angle < servo_yaw.target_angle) { servo_yaw.current_angle += servo_yaw.step_angle; } else { servo_yaw.current_angle -= servo_yaw.step_angle; } } Set_Servo_Angle(0, servo_yaw.current_angle); } // 更新Pitch轴，逻辑同上 if (servo_pitch.is_moving) { if (fabs(servo_pitch.current_angle - servo_pitch.target_angle) <= servo_pitch.step_angle) { servo_pitch.current_angle = servo_pitch.target_angle; servo_pitch.is_moving = 0; } else { if (servo_pitch.current_angle < servo_pitch.target_angle) { servo_pitch.current_angle += servo_pitch.step_angle; } else { servo_pitch.current_angle -= servo_pitch.step_angle; } } Set_Servo_Angle(1, servo_pitch.current_angle); } }

这样，当你调用Set_Servo_Target(&servo_yaw, 0, 45.0f);时，云台会以每步1度的速度，平滑地从当前位置转动到45度位置。step_angle和定时器中断的周期共同决定了运动速度。你可以通过调整这两个参数来控制云台转动的快慢。

更高级的算法可以使用S型速度曲线（加速-匀速-减速），让启动和停止更柔和，但这需要更复杂的数学计算（如正弦函数、多项式），对单片机性能有一定要求。对于大多数应用，线性插值已经能带来质的提升。

5.2 坐标系转换：从“角度”到“指向”

在一些高级应用中，比如让云台始终指向空间中的一个（x, y, z）坐标点（例如基于OpenCV的人脸追踪），我们需要进行坐标系转换。

假设云台底座中心为原点O，航向角为θ（Yaw，绕Z轴旋转），俯仰角为φ（Pitch，绕旋转后的Y轴旋转）。摄像头光轴初始指向正前方（比如X轴正方向）。那么，经过旋转后，摄像头光轴指向的单位向量可以通过旋转矩阵计算：

R = R_z(θ) * R_y(φ) （注意旋转顺序，先绕Z轴转θ，再绕新的Y轴转φ） 指向向量 V = R * [1, 0, 0]^T

反过来，如果我们知道一个目标点相对于云台原点的坐标（Tx, Ty, Tz），想要云台指向它，就需要反解出θ和φ：

水平距离 d = sqrt(Tx^2 + Tz^2) 俯仰角 φ = atan2(Ty, d) // atan2返回弧度值，需转换为角度 航向角 θ = atan2(Tz, Tx) // 注意这里atan2的参数顺序，取决于你的坐标系定义

在STM32上计算atan2和sqrt可以使用数学库math.h，但会消耗不少CPU时间。对于实时性要求不高的场合可以接受。如果要求高，可以预先计算好查找表，或者使用定点数运算库来优化。

#include <math.h> #define PI 3.1415926535f // 根据目标坐标（相对于云台中心）计算所需舵机角度 // 坐标系假设：X轴向前，Y轴向左，Z轴向上。云台初始指向+X方向。 void Calculate_Angles_From_Target(float tx, float ty, float tz, float *yaw_angle, float *pitch_angle) { float d = sqrtf(tx*tx + tz*tz); // 计算俯仰角（Pitch），转换为度 *pitch_angle = atan2f(ty, d) * 180.0f / PI; // 计算航向角（Yaw），转换为度 *yaw_angle = atan2f(tz, tx) * 180.0f / PI; // 注意：这是数学上的atan2(y,x)，对应我们的(tz, tx) // 将角度映射到舵机的0-180度范围（假设舵机中点在90度） // 这里需要根据你的云台机械零位和正方向定义进行调整 *yaw_angle += 90.0f; // 举例：如果atan2结果-90~90度对应舵机0~180度 *pitch_angle += 90.0f; // 限幅 if (*yaw_angle < 0.0f) *yaw_angle = 0.0f; if (*yaw_angle > 180.0f) *yaw_angle = 180.0f; if (*pitch_angle < 0.0f) *pitch_angle = 0.0f; if (*pitch_angle > 180.0f) *pitch_angle = 180.0f; }

5.3 引入反馈与控制：让云台更“听话”

上面的开环控制假设舵机总能精确到达我们指定的角度。但实际上，舵机有误差，负载变化会导致位置偏移，齿轮有回差。要获得更高精度的控制，可以引入反馈环节。

1. 电位器反馈（模拟舵机内部）：普通舵机内部就有一个电位器作为位置传感器，但信号不对外引出。有些“数码舵机”或“总线舵机”会通过串口或PWM反馈当前角度。如果使用这种舵机，就可以实现闭环控制：单片机读取实际角度，与目标角度比较，通过PID算法计算出修正后的PWM占空比，驱动舵机消除误差。
2. 外部传感器反馈：在云台末端安装一个绝对角度传感器（如AS5600磁编码器），直接测量云台输出轴的实际角度。这样就能构成一个真正的外环闭环控制系统，精度最高，能有效克服齿轮回差和负载扰动。

实现一个简单的比例（P）控制器示例：

float Kp = 0.5f; // 比例系数，需要调试 float target_angle, current_angle, error, control_output; uint16_t ccr_base = 150; // 中点对应的CCR值 uint16_t ccr_output; // 假设通过某种方式（如总线读取、编码器读取）获得了current_angle void PID_Update(void) { error = target_angle - current_angle; control_output = Kp * error; // 比例控制 // 将控制输出叠加到中点的CCR值上 ccr_output = ccr_base + (uint16_t)control_output; // 限幅 if (ccr_output < 50) ccr_output = 50; if (ccr_output > 250) ccr_output = 250; TIM_SetCompare1(TIM3, ccr_output); }

这只是一个最基础的例子。完整的PID（比例-积分-微分）控制器能提供更稳定、更快速且无静差的控制效果，但参数整定（调Kp， Ki， Kd）是一个需要耐心和经验的过程。

6. 系统集成与调试实战

当硬件、机械、基础驱动和进阶算法都准备好后，就需要把它们集成起来，并解决实际运行中出现的各种问题。

6.1 上电顺序与初始化

一个稳定的启动流程很重要：

1. 先给单片机核心板上电，让程序跑起来，完成GPIO、定时器、串口等初始化。此时PWM输出可能是默认的低电平或高电平。
2. 然后再给舵机供电模块上电。这一点非常关键！如果先给舵机上电，而单片机的IO口还处于未初始化状态（可能是高阻态或不确定电平），舵机可能会收到杂乱的信号，产生“抽搐”现象，可能损坏齿轮。
3. 在程序初始化最后，再使能PWM输出，并将舵机缓慢移动到安全初始位置（比如90度）。

可以在单片机的一个GPIO上控制一个MOS管，作为舵机电源的开关，从而实现软件控制的上电顺序。

6.2 通信与上位机调试

光靠单片机自己运行，我们很难知道它内部状态如何。建立一个简单的串口通信协议，用于接收控制指令和发送状态数据，能极大提升调试效率。

可以定义简单的文本协议，例如：

• 发送Y90P45\n表示设置Yaw轴到90度，Pitch轴到45度。
• 发送S\n表示请求返回当前角度，单片机回复C Y:87.5 P:46.2\n。

在电脑端，可以用串口助手手动发送，或者用Python的pyserial库配合tkinter或PyQt写一个简单的图形化上位机，用滑块实时控制云台角度，非常直观。

# Python上位机示例片段 (使用pyserial和tkinter) import serial import tkinter as tk def send_angle(): yaw = slider_yaw.get() pitch = slider_pitch.get() cmd = f"Y{yaw:.1f}P{pitch:.1f}\n" ser.write(cmd.encode()) ser = serial.Serial('COM3', 115200, timeout=1) root = tk.Tk() slider_yaw = tk.Scale(root, from_=0, to=180, orient=tk.HORIZONTAL, command=lambda x: send_angle()) slider_pitch = tk.Scale(root, from_=0, to=180, orient=tk.HORIZONTAL, command=lambda x: send_angle()) # ... 布局和启动

6.3 典型问题排查清单

调试过程中，你可能会遇到以下问题，这里提供一个排查思路：

现象	可能原因	排查方法
舵机完全不转，无反应	1. 电源未接通或电压不足。 2. 信号线接错（接入了地线或电源）。 3. PWM信号未产生或参数错误。	1. 用万用表测量舵机接口电压是否在4.8V-6V之间。 2. 检查接线：棕色/黑色-地，红色-电源，橙色/白色-信号。 3. 用示波器或逻辑分析仪检查PWM引脚是否有正确的50Hz、0.5-2.5ms脉宽信号。没有则检查代码配置。
舵机抖动、啸叫、发热	1. 电源功率不足，导致电压被拉低。 2. PWM信号受到严重干扰。 3. 机械结构卡死，舵机堵转。	1. 测量舵机动作瞬间的电源电压，看是否跌落到4.5V以下。加大电源功率或电容。 2. 检查信号线是否远离电源线，尝试在信号线靠近单片机端加一个100-500欧姆的电阻。 3. 断开舵盘，用手转动输出轴，检查是否顺畅。
云台运动不流畅，有卡顿	1. 平滑算法未启用或参数设置不当（步长太大或更新太慢）。 2. 主循环或定时器中断被其他任务阻塞。 3. 机械结构摩擦过大或螺丝拧得太紧。	1. 检查Servo_Update_Handler是否被定期调用，调整step_angle和调用周期。 2. 优化代码，避免在中断或主循环中进行耗时操作（如浮点运算、延时）。 3. 重新调整机械结构，确保转动顺滑。
角度不准，有固定偏差	1. 舵机中位（1.5ms）不精确。 2. 机械安装存在零位偏差。 3. 角度映射公式计算有误。	1. 发送1.5ms脉宽（CCR=150），观察舵机是否在物理中位。如有偏差，在软件中补偿一个固定值（如ccr_compensate）。 2. 重新安装舵盘，确保在90度指令时，云台臂处于设计的零位。 3. 用示波器测量不同角度指令下的实际脉宽，验证映射公式。
两个舵机同时动时，其中一个乱动或复位	1. 电源问题，大电流导致电压跌落，单片机复位。 2. 地线干扰。	1.这是最常见的问题！必须按2.3节优化电源设计，加大电容，分路供电。 2. 确保所有地线（单片机地、舵机电源地、电池地）良好共地，走线粗短。

6.4 进阶功能拓展思路

当基础云台稳定工作后，你可以尝试添加更多功能，让它变成一个真正的项目：

1. 自动追踪：结合OpenMV、K210或树莓派等视觉模块，识别特定颜色或人脸，计算出目标在图像中的偏移量，转换为云台需要转动的角度，实现自动追踪。
2. 无线控制：接入蓝牙模块（如HC-05/06）或Wi-Fi模块（如ESP-01S），用手机APP或电脑进行无线控制。
3. 姿态稳定：加入MPU6050等惯性测量单元（IMU），读取云台自身的姿态角，当底座发生倾斜或晃动时，反方向控制舵机，使云台顶部的摄像头保持水平稳定。
4. 路径规划：让云台按照预设的路径（如扫描一个矩形区域）自动运动，可用于安防巡检或全景拍照。

这个基于STM32F103的二维云台项目，从最基础的PWM信号生成，到电源、机械、平滑控制、坐标转换的层层深入，几乎涵盖了一个小型运动控制系统的所有核心环节。它就像一块很好的敲门砖，打通了软件和硬件、算法和实物的界限。调试过程中，示波器观察波形、万用表测量电压、串口打印数据，这些手段的综合运用，才是解决工程问题的真正能力。希望这份详细的记录，能帮你少走弯路，更快地做出自己手中那个“指哪打哪”的云台。

本文还有配套的精品资源，点击获取