STM32F103六自由度机械臂拖动示教与轨迹复现实战解析

六自由度机械臂搭配 STM32F103，最值得先跑通的功能不是花式动作，而是“把人对机械臂的拖动过程记录下来，再让机械臂自动复现同一段轨迹”。这类教学项目听起来复杂，真正拆开以后其实分三块：机械结构、角度采集、轨迹回放。对学习嵌入式或者机器人控制的人来说，用这套小机械臂做示教操作，能把单片机 PWM 输出、ADC 采样、状态机切换、数据存储全部串起来，完成度比单纯点灯和呼吸灯高很多。

这篇内容面向正在组装、或者已经装好六轴机械臂但还没有打通“拖动示教 + 轨迹复现”的开发者。如果你手里的机械臂也使用 STM32F103 控制板，下面的思路可以直接套用；如果你还没确定材料包里有没有角度反馈机构，那更要先把系统架构看清楚，再决定要不要为示教功能增加传感器。

1. 拖动示教到底在做什么，它和普通舵机控制有什么区别

1.1 六个自由度不是简单“六个舵机”，而是从底座到手腕的姿态链

很多初学者会把六自由度机械臂直接理解为“给六个舵机发 PWM 就行”，这个理解在复现固定动作时勉强够用，但一进入示教操作就会出问题。

六自由度的“自由度”指的是机械臂末端在空间中能完成独立运动方向的个数。要让夹爪末端到达某个位置，同时保持一个特定姿态，通常需要六个旋转关节参与：底座负责水平回转，肩部和肘部负责把手臂抬到不同高度，手腕部分负责末端姿态调整。每一个关节都影响末端，所以只是按固定时间顺序转动六个舵机，很容易出现末端位置偏差。

拖动示教里的四个字“拖动示教”，实际含义是：人用手直接移动机械臂的各个关节，机械臂系统实时记录每个关节的角度，之后播放给执行器，让机械臂重新走一遍同样的轨迹。

1.2 拖动示教与遥控示教的本质区别：实时读取关节角度

普通舵机控制流程非常单向：单片机计算目标角度，输出 PWM 脉宽，舵机转到对应位置。系统只关心“我发了什么角度”，不关心“关节实际在哪”。

拖动示教反过来，首先要能感知“关节在哪”。也就是说，每个自由度除了执行舵机，还必须有一个角度反馈源，比如电位器、霍尔角度传感器、编码器，或者舵机内部的可反馈角度数据。

人手动拖动关节时，关节角度发生变化，STM32F103 通过 ADC 或通信接口读取到这些角度，把它们记录下来。这跟遥控示教不同：遥控示教是操作者用按键、摇杆给目标角度，机械臂自己移动；拖动示教则是操作者直接改变机械臂姿态，系统跟随记录。

正是这个差异决定了硬件选型。如果材料包里的机械臂只有舵机，没有独立的关节角度反馈，那它能做的是“设定路径复现”，而不是“拖动示教”。想补足，常见做法是在每个活动关节处加装一个电位器，把角度变化转换成电压变化，再交给 STM32F103 的 ADC 通道读取。

1.3 记录轨迹和复现轨迹的最小工作流程

完整的最小流程可以拆成三步。

第一步是进入示教模式。此时舵机不主动驱动，或者只保持很小的阻尼，操作者用手拖动机械臂到起点。

第二步是边拖边记录。系统以固定采样周期读取角度，把六路角度打包成一条轨迹数据，放入缓冲区或者写入存储。

第三步是退出示教，进入复现模式。STM32F103 从轨迹第一条数据开始，把存储的关节角度逐点发送给对应舵机，让机械臂按同样的顺序走一遍。

这里要特别注意：复现不可能做到逐采样点立即到达。舵机存在物理转动时间，轨迹中相邻两个点角度差太大，舵机就追不上，表现出来就是轨迹被拉平或者爆音抖动。所以记录时最好控制拖动速度，复现时给每段运动留足执行时间。

2. 用 STM32F103 组装机械臂，先别急着焊电路，先算清关节和接口

2.1 控制核心选择：STM32F103 什么时候够用，什么时候必须换

STM32F103 是六自由度机械臂里非常常见的主控。它带有多路定时器、多路 ADC、UART、SPI、Flash，处理这种微型桌面机械臂的控制循环足够。

但先说清楚边界：如果只是做拖动示教和轨迹复现，STM32F103 很合适。它不需要 Linux 那样复杂的文件系统，不依赖大内存。普通工程里用片内 Flash 保存几条轨迹，用定时器产生多路 PWM，用 ADC 读取角度，完全符合轻量控制器的定位。

如果后续要做视觉识别、路径规划、逆运动学实时解算、三维模型渲染，还要同时处理摄像头画面，那 STM32F103 的资源会非常紧张。这时候建议把上位机逻辑放到 PC、树莓派或者 ESP 之类的通信模块上，STM32F103 只做底层舵机控制和数据采集。主控不是越强越好，关键是任务分层清楚。

2.2 每个关节的两类组件：角度反馈与执行驱动

在设计电路之前，先给机械臂的六个关节做一张表格，把每个关节的反馈方式和驱动方式标出来。下面是我常用的规划格式：

这张表不是机械结构图，而是控制系统设计图。你不需要在第一次接线时把六个电位器和六个舵机全部接满，可以先用 J1、J2、J3 三个轴做 Demo，确认信号方向和角度映射正确，再扩展到六轴。直接一口气接完，一旦某个方向的电压接反，会花大量时间排查。

2.3 舵机、供电、信号线：最容易烧板的三个细节

我在实际测试中踩过最多的问题不是代码逻辑，而是供电和信号接线。

第一，舵机供电和单片机供电要分开。六自由度机械臂的动作集中在瞬间启动和停止，电流峰值明显。如果舵机直接从 STM32F103 最小系统的 3.3V 取电，电压一旦被拉低，单片机大概率复位。常见做法是：外部电源给舵机供电，STM32F103 通过稳压模块单独供电，两边共地。

第二，舵机信号线不能随意接到 5V 单片机的 IO 口。STM32F103 的普通 GPIO 是 3.3V 电平，很多航模舵机信号端能兼容 3.3V，但部分舵机在信号高电平低于某个阈值时工作不稳定，或者需要电平转换。接之前一定看舵机规格。对输入角度反馈的电位器也是一样，如果电位器供电是 5V，ADC 输入引脚不一定能直接承受 5V 电压，要确认 IO 是否容忍 5V，或者用分压电路把电压降到 3.3V 以内。很多“角度漂移”“读数乱跳”问题，源头不是 ADC 代码，而是引脚输入电压超过手册范围。

第三，信号线尽量短。舵机 PWM 信号频率不高，但如果把舵机信号线跟舵机电源线捆在一起穿过关节，会受到电机启停干扰，导致舵机偶尔抽动。组装时我习惯让信号线和电源线分走两侧，或者至少用双绞方式减少噪声。

3. 机械装配顺序与拖动示教矛盾的处理

3.1 先把基座固定好，再往上装肩、肘、腕

机械装配的顺序直接影响示教手感。如果底座还放在桌面上晃，拖动机械臂时整个结构都会偏，记录到的角度数据自然不稳定。

我的建议是从底座固定开始装。底座是整个力传递的起点，可以先安装到底板或桌面夹具，然后依次装肩部、大臂、肘部、前臂、腕部、夹爪。每一步装完都做一次手动转动测试，确认关节转动顺畅，没有螺丝顶死、齿轮卡顿、线材缠绕。

这里要注意一个反直觉点：组装时如果把所有螺丝都拧到最紧，关节摩擦会很大，演示记录时手感很生硬；如果太松，关节会下垂，复现轨迹时舵机要额外出力去补偿重力。合适的松紧度是：机械臂静止时能保持住当前姿态，但操作者用手推动时不需要用很大力气。

3.2 让关节有“顺手可拖动”的状态

不是所有舵机都能在马达停止时被轻松反向转动。有些舵机带有减速齿轮箱，内部阻力很大，强行拖动容易损坏齿轮。这时候就需要在机械设计上留出手动拖动通道。

常见的方案有两种。一种是在每个关节上安装独立的角度传感器，舵机驱动结构可以脱开；另一种是给舵机设计一个离合器结构。如果材料包本身不支持这两种结构，那“拖动示教”就要改为“逐关节设定模式”，也就是操作者不直接同时拖动整条手臂，而是通过上位机发送角度，驱动舵机逐轴运动，记录路径点。

如果你手里的机械臂是可以直接拖动的类型，请先小角度测试：捏住末端轻轻移动，观察舵机有没有异常卡顿。如果听到齿轮打滑或者咔咔声，马上停下，检查执行机构是否与减速齿轮已经脱离。

3.3 手动拖动之前必须做限位检查和配平

六自由度机械臂在自由拖动状态下，人手可以把它摆到很多极限位置，比如手腕向后翻转超过 180 度，或者大臂压到桌面。机械限位如果存在，强行拖过去会损坏结构件。所以在接通演示模式之前，先手动把所有关节从最小位置转到最大位置，记录每一路 ADC 读数，在软件里设置角度限制。

如果某个关节在自然状态下会往下垂，说明重心没有平衡好。对桌面级小机械臂来说，最直接的办法是把舵机回程扭矩调低，或者在结构设计中把大臂保持在一个既不会低垂又不会过重的区间。硬件装配阶段不要追求“零下垂”，那是复杂工业机械臂才需要仔细配平的内容。小型舵机本身有保持扭矩，复现模式下伺服闭环可以维持姿态。

4. STM32F103 端功能拆解：角度采集、舵机输出、主流程切换

4.1 ADC 采样的六个通道，如何映射成关节角度

假设每个关节使用电位器作为角度反馈，电位器两端接参考电压，中间抽头接 STM32F103 的 ADC 通道。电位器转到一个位置，ADC 读到对应的电压，程序把这个裸 ADC 值换算成角度。

换算公式并不复杂：

float angle = (float)adc_value / 4096.0f * 300.0f - 150.0f;

这个式子只是示意。具体乘以多少、减去多少，取决于电位器量程和机械臂关节的实际角度范围。很多 DIY 项目会直接用 ADC 原始值作为记录数据，后续播放时也发送同样的比较值。这种方法能跑通演示，但代码可读性差，也不方便做限位和轨迹缩放。建议第一次调试就做“ADC 值到关节角度”的标定。

标定方法很简单：把该关节手动转到机械零点，记录一次 ADC 值；再转到已知角度，比如 90 度，记录一次 ADC 值。用两组数据算出比例和偏移量。最少两点标定就能工作，如果电位器线性度一般，可以用三点标定，中间点用来修正非线性。

4.2 舵机控制信号用定时器 PWM，不推荐靠延时翻转 GPIO

很多人会用延时函数模拟舵机脉冲，让 PA1、PA3 这类引脚不断翻转。这个办法看起来容易，实际很占 CPU，还会让你没法稳定做 ADC 采样。因为舵机需要周期性收到 50Hz 左右的脉冲信号，一旦主循环被其他延时阻塞，舵机信号会出现抖动。

STM32F103 上有多个定时器，输出比较通道可以产生独立 PWM。用定时器做主时钟，每个通道各输出一路脉宽，完全不需要在主循环里计算每个引脚的翻转时间。如果接了六路舵机，可以选一个定时器的六个通道，或者两个定时器各接三路。

从这次项目的角度考虑，推荐按这样安排：

如果你对定时器输出占空比的理解还不熟练，可以先只给一个舵机做 PWM 输出测试，用逻辑分析仪观察周期和脉宽，再扩展到多路。

4.3 三种任务模式：待机、示教记录、复现播放

机械臂主程序建议设置成清晰的模式状态，不要把所有逻辑写进一个大 while 循环。代码里可以抽象出三个模式：

typedef enum { MODE_IDLE, MODE_TEACH, MODE_PLAY } SystemMode;

待机模式下，机械臂不执行轨迹，但系统仍然周期读取角度，主要用于初始化和手动校准。

示教模式下，系统把 ADC 读取到的当前角度写入缓冲区。此时如果你直接用舵机驱动，需要注意：进入示教前要把舵机驱动目标和当前角度同步，否则舵机会强行跳到某个目标值，跟人手动拖动的力对抗。我的做法是示教时关闭舵机输出，或者让舵机进入低功耗保持状态，只依靠角度反馈采集数据。

复现模式下，系统从缓冲区读取轨迹点，形成 PWM 目标值，平滑发送给舵机。这里要有“当前舵机角度”和“目标舵机角度”两种状态，不能直接把缓冲区的历史值一次性发送。

5. 示教数据该怎么记，记完怎样才能完整复现

5.1 记录关节角还是记录笛卡尔坐标，选择决定后续难度

轨迹复现不是只能记“末端在空间里的直线路径”。对多数教学项目来说，更简单有效的方法是记录每个关节的角度。

关节角记录方式的优点是采集容易。你只需要在每一采样周期读六个 ADC 值，存成一条六维数据。复现时同样按照六路角度发送给舵机即可。因为舵机是旋转关节，本身接收的就是角度目标，所以这种记录方式天然匹配底层执行单元。

如果要记录笛卡尔坐标，比如让机械臂末端走一条直线、画一个圆，那就必须引入正运动学和逆运动学。正运动学可以根据关节角度求末端位置，逆运动学要根据末端位置反推六路关节角。六自由度机械臂的逆运动学解算需要处理多解、奇异点问题，复杂度明显高很多。对这个工程演示阶段来说，先不要把问题扩大化。

5.2 采样周期、缓冲区和存储策略

记录轨迹时，采样周期不是越小越好。下面是我常用的判断思路：

单片机的缓冲区如果只写在 RAM 数组里，掉电后数据会丢失。如果想实现“记录一段轨迹，断电重启后还能复现”，就需要把数据写入非易失存储。

STM32F103 没有专门的模拟 EEPROM，但可以通过片内 Flash 模拟 EEPROM 用法，把一条轨迹分成固定大小的扇区保存。要注意 Flash 擦写次数和写入方式。不要每次采样都直接写 Flash，高频擦写会缩短寿命；更好的做法是先把一段轨迹缓存到 RAM，等操作者按下“结束记录”后，批量写入 Flash。

5.3 复现时给舵机加平滑过渡，不要让轨迹突然跳变

直接播放录制轨迹最常见的现象是：机械臂开局狂抖，或者从当前姿态瞬间跳到轨迹第一帧。

原因是录制起点和播放时的机械臂当前姿态不一致。如果当前机械臂停在 0 度，而轨迹第一帧是 45 度，复现代码直接把 45 度发给舵机，舵机会猛冲，看起来就像突然抽搐。

解决办法是先做一个“回零”或“回到起始点”的过渡过程。可以设定一个较慢的步进速度，从当前角度逐渐逼近轨迹第一帧，再开始播放实际轨迹。同样，在播放最后一段后，不要立刻中断输出，要让舵机保持最后一帧角度，避免回复到初始状态导致突然弹回。

平滑过渡处理示例：

for (float t = 0; t <= 1.0f; t += step) { output = current_angle + (target_angle - current_angle) * t; setServoAngle(channel, output); delay(10); }

这只是基础线性插值，实际工程还可以用梯形速度规划或者 S 曲线。对桌面六轴来说，线性插值加适当延迟通常已经足够。关键在两段之间不要出现角度跳变。

5.4 如果需要多段轨迹，先设计好编号

有些复现任务不只是播放一段，而是要把“拿起物件”“移动到高点”“放到另一边”三段轨迹串起来。这种情况建议先规定每个轨迹段的编号、结束条件、下一段跳转目标，而不是把所有点堆成一个长数组。

我习惯把轨迹抽象成一个小结构：

typedef struct { uint8_t id; uint8_t point_count; uint16_t sample_rate; uint16_t joint_angles[6][MAX_POINTS]; } Trajectory;

工程里用结构体管理比较直观。每段轨迹保存时，要同时保存采样率，因为回放时只有知道每两个点的间隔时间，才能控制舵机动作速度。

6. 把最小 Demo 扩展成可连续运行的桌面机械臂

6.1 用 Flash 存储多段轨迹，实现掉电保存

最小闭环跑通后，你要问自己的下一个问题是：这段轨迹能不能在断电后继续使用？

如果只存 RAM，演示时一拔电就丢。想保存，先把 STM32F103 的 Flash 划分看明白。不同容量的 F103 芯片 Flash 大小不同，页大小和地址布局也不一样。写 Flash 前必须确认具体型号。建议先把项目放到真实芯片上，读出其容量，再做存储规划。

写入 Flash 过程有几个容易踩的坑。第一，执行 Flash 写操作时，不能同时从同一块 Flash 取指令，所以部分情况下需要把写入函数放在 RAM 中执行。第二，擦除最小单位是页，不能像 RAM 那样单字节随便改。如果轨迹数据不大，可以分配固定大小的一块区域，每段轨迹从区域开头依次写入，而不是频繁擦写。

对多数演示场景，可以把存储做成“简易日志”：第一段写在地址 A，第二段写在地址 A+偏移。如果用户重新记录新轨迹，先擦除整块区域再从头写。这种模式实现简单，还能避免 Flash 频繁擦写。

6.2 增加上位机串口调试：帧格式、校验、启停命令

机械臂拖动演示时，如果没有任何上位机界面，你很难知道当前 MCU 处于哪个模式，也不方便查看每一路角度值。这时最简单的方法是添加一条 UART 调试链路。

把角度数据、当前模式、采样状态通过串口输出到电脑，可以快速判断是采集端问题还是舵机端问题。串口消息建议设计成带帧头、长度、数据、校验的形式，不要直接把裸 ADC 值用 printf 无限打印。因为高频率打印会占用主循环时间，可能导致采样周期不稳定。

封装一个简单的命令行：输入teach start进入示教，输入teach stop停止并保存，输入play 1播放第一段轨迹。从工程角度看，这个命令行比把模式切换全部放在按钮上更容易调试。因为按钮需要消抖、状态指示、长按/短按区分，命令行把这些逻辑统一到了串口层。

6.3 如果需要逆运动学，主控只做运动执行更合理

当你不再满足于点对点复现，而是希望机械臂末端能从 A 点自动经过 B 点和 C 点，绘制出直线或者圆弧时，就要考虑加入逆运动学。但 STM32F103 直接跑实时逆运动学，不是不可能，而是容易让代码变得很紧。比较好的方案是把逆运动学放在 PC 端上位机完成，然后用统一的关节角度协议下发给 STM32F103。MCU 端只处理 DAC 采集和舵机播放，不再承担复杂运动学解算。

这样做还有一个好处：上位机可以显示 3D 模型，实时反馈机械臂姿态，方便观察轨迹是否合理。STM32F103 作为执行控制器仍然保持高实时性。对学习 Robotic 的人来说，这套“上位机方案 + 下位机执行”的架构更接近实际项目结构。

7. 常见问题与排查链路：先看现象，再查输入/输出

7.1 启动后机械臂乱动：先查供电和初始化状态

机械臂启动瞬间乱动，很多人的第一反应是代码 bug，但实际更常见的是供电不足和初始化顺序不对。

先看供电：如果用 USB 线给 STM32F103 供电，再通过 3.3V 引脚拉舵机，开机瞬间电压跌落会把控制系统拉复位。表现就是舵机“咔咔”响或者机械臂突然运动一下又停止。

再看初始化顺序：舵机 PWM 输出是否在 GPIO 配置和 ADC 配置完成之前就开启了？如果 PWM 先开启，而舵机目标角度数组还是全 0 或者随机值，机械臂就会朝一个意想不到的角度猛转。规范做法是先把所有角度变量初始化成当前机械姿态，再开启 PWM 输出。这里也可以使用“先让舵机进入不输出状态，完成所有校准后再使能”的机制。

7.2 角度读取跳动 / 复现轨迹偏移：先查定位与映射

复现轨迹偏移，并不代表记录数据坏了。它往往是示教时 ADC 映射关系和复现时 PWM 映射关系不一致造成的。

演示教时，我们记录电位器 ADC 值，然后乘以系数得到关节角度；播放时，又把关节角度转换成舵机脉宽。这个“ADC 值→角度→脉宽”链路里有两个映射需要同时校准。如果只校准了采集端，没校准输出端，机械臂位置就会偏。

排查步骤可以是：先手动设置一个固定关节角度，检查舵机是否转到肉眼可见的同一位置。比如让肩部关节变成 90 度，再用尺子或量角器确认。如果读数一直接近但差一点，优先怀疑 PWM 最小脉宽和最大脉宽设置不正确。不同舵机的脉宽范围有差异，不能拿 0.5ms~2.5ms 直接套用在所有舵机上。

7.3 舵机 PWM 输出不到满量程，先确认定时器周期和比较值范围

有朋友用 STM32F103 定时器输出 PWM，调试时发现舵机角度怎么也到不了 180 度，看起来像 PWM 始终只输出到一部分量程。

这个问题的重点不在舵机，而在定时器定时和占空比计算。PWM 高电平时间由“比较值 / 自动重载值 * 定时器周期”决定。如果自动重载值设置得不合适，比较值写到最大也到不了 2.5ms。先不要直接加大比较值，应该按照以下链路排查：

1. 确认定时器时钟频率。
2. 确认自动重载值，计算 PWM 周期是否约 20ms。
3. 确认比较值范围，换算成高低电平时间。
4. 用逻辑分析仪在舵机信号引脚上直接测脉宽。

逻辑分析仪测量时，如果转动目标角度 0 度到 180 度，高电平时间能在 0.5ms 到 2.5ms 范围均匀变化，那代码就没问题。如果最大输出只有 1.5ms，说明自动重载值和比较值映射没有拉开范围。这个排查同样适用于 DMA 方式输出多路 PWM，引脚换了但计算逻辑一样。

7.4 拖动记录一段时间后卡死或掉数据：先查缓冲区与存储节奏

如果记录刚开始正常，十几秒后 STM32F103 不再响应，大概率不是舵机问题，而是存储或者缓冲区设计问题。

先检查缓冲区是否越界。记录过程中每采样一次就往数组里写一组六路数据。如果数组上限是 200 条，你却记录了 500 条，写指针越界后可能把其他变量覆盖掉，造成各种诡异现象。解决办法是先固定缓冲区最大点数，采样时检查索引，到达上限就自动停止记录或者覆盖最旧数据。

如果采样时不写数组，而是每采一个点就擦写一次 Flash，卡死概率会更高。Flash 擦除和写入耗时较久，主循环一直等待，就会错过后面的采样。建议的节奏是，“高速采集进 RAM，停止记录后一次性写入 Flash”。这样既保证采样连续性，也避免频繁擦写。

7.5 示教模式时舵机仍跟手阻力大：确认进入模式后的驱动状态

最后一个常见误区是示教记录时，舵机仍然需要用力反推才能移动。很多人以为把舵机目标值设为当前角度就够，但实际上舵机的闭环控制器仍会试图回到目标角，人一推它，它就会反推。

让关节进入手动可拖状态，关键是让舵机停在一个“被控制但不主动回正”的状态，或者完全切断驱动。通道的电平不能是高阻抗噪声，必须稳定在 0V 或者一个安全电平。某些舵机对低电平和高电平的响应不同，直接悬空会导致舵机抽搐，这种状态不能被当作示教模式。

如果机械结构不支持脱开，另一种方案是采用“虚拟示教”：在电脑上位机里拖动三维模型，系统算出关节运动轨迹，再发给单片机执行。严格说这不是物理拖动示教，但同样可以达到“记录—复现”的教学目标，而且不需要改动机械结构。

六自由度机械臂这个项目真正有价值的地方，并不是让几个舵机按顺序转，而是让你理解机器人控制中的“感知、决策、执行”闭环。STM32F103 适合承担这个闭环里的执行层；拖动示教则是连接人和机器人最直观的交互方式。如果你正在做这类组装项目，建议先把单轴校准做完，再做三轴记录，最后扩展成六轴整体复现。每一步都能确认结果，后面的故障就会少很多。