简介面向嵌入式开发者与机器人爱好者这是一份基于STM32F103C8T6的六轴机械臂工程示例重点演示目标位置抓取功能的软件实现适合学习STM32外设控制、机械臂运动学或正在寻找可移植参考代码的读者。压缩包共851个文件、约23.2MB主体为515个C源文件与194个头文件同时包含Keil工程配置uvprojx/uvoptx、编译产物hex/axf、CubeMX的ioc引脚配置、Python辅助脚本以及线性插值等DSP算法相关源码便于在真实板卡上烧录验证也能帮助理解轨迹规划与插补计算环节。项目文件分层较清晰从电机驱动、传感器读取到上层抓取逻辑均有涉及可据此梳理六轴机械臂的整机控制流程。内容预览中还可见arm_common_tables、arm_dct4_init等CMSIS-DSP文件说明工程集成了ARM官方数学库对需要开展机械臂运动控制或伺服调参的开发者有参考价值。目前已有377人浏览学习适合STM32机械臂相关课题的入门与二次开发。 我不止一次被人问到STM32F103C8T6这种“小蓝板”到底能不能驱动六轴机械臂做目标位置抓取我的回答是能而且如果只是配合舵机来做离线/半自动抓取这颗Cortex-M3芯片的性价比高到离谱。这篇文章就是把我自己做的一个完整项目拆开来讲从stm32c8t6原理图设计、六轴机械臂DH参数建模到目标位置抓取的代码实例全部摊开说清楚。适合手里有F103C8T6最小板、想入门机械臂控制或者已经能点灯但不知道怎么把舵机和坐标运算串起来的读者。1. 项目概述与整体方案设计1.1 为什么是STM32F103C8T6而不是ESP32或Arduino先说结论STM32F103C8T6做六轴舵机机械臂的控制核心完全够用而且比Arduino更稳比ESP32更适合学习底层原理。很多人习惯用Arduino UNO做机械臂图它库多、写起来简单。但真到了六轴场景Arduino UNO的AVR核心在处理运动学运算时明显吃力尤其是逆解运算里大量三角函数和矩阵运算精度和速度都打折扣。而STM32F103C8T6主频72MHz带硬件乘法器和32位数据处理能力算4x4齐次变换矩阵的几个乘法只需要微秒级跑几百Hz的控制循环毫无压力。有人会问那为什么不直接用ESP32还能带WiFi做无线控制。我的考量是这样如果目标只是“把机械臂跑起来并实现指定坐标抓取”那么STM32的裸机开发流程反而更清晰——PWM定时器、串口DMA、GPIO中断每一步都能直观理解不受RTOS和网络协议栈干扰。用ESP32当然可以做远程控制那属于另一个项目方向。做六轴机械臂先把核心运动学吃透比什么都重要。1.2 六轴机械臂的整机架构这个项目的机械结构我选的是常见的铝合金六轴机械臂套件关节分布是底座旋转轴J1、大臂俯仰J2、小臂俯仰J3、腕部旋转J4、腕部俯仰J5、末端法兰旋转J6。驱动方式全部采用舵机型号上J1用大扭矩MG996R55kg·cm级别的甚至更好J2/J3也至少用MG996R级别J4/J5/J6可以用SG90或者MG90S级别的小舵机。为什么这么分配因为越靠近基座的关节承受的力矩越大J1到J3需要对抗整个臂的重量和负载力矩不够会发抖、丢步甚至烧舵机。控制系统核心就一块STM32F103C8T6最小系统板配上舵机驱动板或者自己用三极管/ULN2003搭的PWM驱动电路。整机供电用12V转5V的稳压模块舵机直接从5V供电取电STM32板子可以共用5V但要注意舵机启动瞬间电流可能冲到2A以上所以电源余量至少4A起步否则一通电就会系统复位。整体工作流程这样上位机串口下发目标位置的X/Y/Z坐标和末端姿态角度 → STM32读入后做逆运动学解算得到六个关节的目标角度 → 定时器产生PWM信号驱动舵机逐关节转动 → 末端夹爪到位后根据IO反馈或延时控制夹爪闭合完成抓取。2. 硬件设计stm32c8t6原理图与关键电路2.1 核心最小系统的原理图要点STM32F103C8T6虽然很多模块板都做好了但如果你要自己画板或者排查硬件问题有几个原理图节点要特别注意供电部分VDD接3.3VVDDA接3.3V并串一个磁珠或10Ω电阻做滤波这是ADC稳定工作的前提。VSS和VSSA接地。复位电路NRST引脚接10kΩ上拉电阻到3.3V并联一个100nF电容到地形成典型的RC复位电路。如果复位引脚悬空芯片上电偶尔会进不了正常状态。启动模式BOOT0和BOOT1必须通过10kΩ电阻下拉到地这样芯片从Flash启动。很多新手画板时忘了给BOOT0加下拉电阻导致程序下载后必须手动触碰引脚才能从Flash运行非常坑。晶振电路8MHz主晶振两端接两个20pF负载电容电容另一端接地。如果是用内部RC振荡器HSI可以省掉外部晶振但做机械臂这种对时序精度有要求的项目建议用外部晶振串口波特率会更准。下载接口SWD接口只需SWDIO、SWCLK、GND三根线加上3.3V就是四根。SWD比JTAG省IO调试六轴机械臂时IO本来就紧张建议直接引SWD。如果你用的是一块钱一块的蓝色Pill板其实这些都不用管板厂已经把最小系统做好了。但只要你外接舵机驱动、电源模块和通信接口就必须在自己的布板上把原理图链路画清楚。2.2 舵机PWM驱动电路怎么做六轴加一个夹爪共需要至少7路PWM信号。STM32F103C8T6的TIM1、TIM2、TIM3、TIM4加起来有比较多的PWM通道通常我这样分配外设通道用途TIM1CH1~CH4J1~J4舵机TIM2CH1~CH3J5、J6、夹爪USART1TX/RX上位机通信PA0~PA2GPIO输入夹爪到位限位开关舵机的信号线直接接IO口吗不行。虽然舵机信号线理论上只需要3.3V的高电平就能识别但工程上最好在信号线上串联一个几百欧姆的电阻再并联一个10kΩ下拉电阻到地。原因有二第一舵机信号线长的时候会引入噪声串电阻可以抑制振铃第二舵机内部的电路板是独立的如果舵机损坏串接电阻能保护MCU引脚不被反灌电压打坏。我实际调试时遇到过舵机内部短路直接把一个IO口烧了就是因为没加保护后来所有信号线都串联了330Ω电阻再没出过问题。电源部分必须是星型布线12V输入 → 稳压模块 → 5V母线 → 舵机电源线和MCU电源线分别从母线引出。千万不能让舵机的电流回路经过MCU的地线否则舵机转动时地线抖动MCU的ADC和串口通信会被干扰得乱七八糟。我自己第一次试的时候舵机一转到某个角度串口就会收到乱码就是因为共地回路太长。3. 运动学建模六轴机械臂DH参数推导3.1 DH参数表怎么建立要说清楚“目标位置抓取”核心就是坐标系的转换。六轴机械臂的每一个关节都是一个旋转自由度要搞明白末端执行器在世界坐标系下的位置就需要建立每个关节的坐标系然后一步步变换过去。DH参数Denavit-Hartenberg就是描述相邻关节坐标系之间相对关系的四个参数关节角θ、连杆偏移d、连杆长度a、连杆扭角α。具体到我用的这款六轴机械臂我测出来的DH参数表大致是这样不同机械臂的结构尺寸不一样需要实际测量关节θ变量d (mm)a (mm)αJ1θ11200-90°J2θ201500°J3θ301200°J4θ4800-90°J5θ50090°J6θ66000°这里a值就是相邻两个关节轴之间的连杆长度也就是大臂和小臂的实际长度。d值是沿着关节轴方向的偏移量底座高度和腕部到法兰的距离都体现在d里。α值的正负号很关键它决定了坐标变换矩阵里旋转分量的方向。在建立DH表的时候最容易忽略的是“零点位置定义”。我调试时发现很多舵机安装完成后软件里设置的0°和机械结构的0°并不对应。比如J2大臂理论上应该垂直向上是0°但舵机装上去后可能开机就是30°。所以DH表里的θ变量最好加上一个安装偏置角即软件角度 目标角度 舵机安装偏置。这个偏置在调试时用水平尺或角度尺标定别偷懒。3.2 正运动学从角度到坐标正运动学就是已知六个关节角求末端执行器的位置和姿态。标准做法是把每个关节的齐次变换矩阵相乘T_06 T_01 * T_12 * T_23 * T_34 * T_45 * T_56每个T矩阵的通用形式是| cosθ -sinθ*cosα sinθ*sinα a*cosθ | | sinθ cosθ*cosα -cosθ*sinα a*sinθ | | 0 sinα cosα d | | 0 0 0 1 |代码里我不建议用二维数组硬算而是先用辅助函数解耦// 计算单个DH变换矩阵 // 输入关节角theta_rad, 偏移d, 杆长a, 扭角alpha_rad // 输出4x4旋转平移矩阵mat[4][4] void dh_matrix(float theta_rad, float d, float a, float alpha_rad, float mat[4][4]) { float ct cosf(theta_rad); float st sinf(theta_rad); float ca cosf(alpha_rad); float sa sinf(alpha_rad); mat[0][0] ct; mat[0][1] -st * ca; mat[0][2] st * sa; mat[0][3] a * ct; mat[1][0] st; mat[1][1] ct * ca; mat[1][2] -ct * sa; mat[1][3] a * st; mat[2][0] 0.0f; mat[2][1] sa; mat[2][2] ca; mat[2][3] d; mat[3][0] 0.0f; mat[3][1] 0.0f; mat[3][2] 0.0f; mat[3][3] 1.0f; }然后把六个矩阵依次相乘取最后结果的第4列前三个元素就是末端在世界坐标系下的X、Y、Z坐标。这里有个数值细节矩阵乘法最好用双精度还是单精度我的经验是在STM32F103C8T6上用float就够因为机械臂本身的机械误差和舵机精度大概1°~2°远大于单精度浮点的舍入误差。但是如果做定点数优化精度反而不够所以我强烈建议直接开FPUSTM32F103没有硬件FPU但因为F103C8T6是Cortex-M3浮点运算靠软件库用编译器的数学库就行不必为精度焦虑。3.3 逆运动学从坐标反推关节角目标位置抓取最难的一步是给你一个X、Y、Z坐标让机械臂自动算出六个关节各该转多少度。这个问题叫逆解方法很多几何法、代数法、迭代法。对于六轴机械臂我推荐先用**代数法解析法**理解关节间解耦逻辑再在代码里用几何法简化前三个关节的计算。在解析法中有一个关键概念腕部解耦。对于大多数六轴机械臂J4、J5、J6三个轴的交点都在同一个点称为腕部中心点。这样末端位置只与J1、J2、J3相关而J4、J5、J6只影响末端姿态不影响位置。因此逆解步骤可以拆分为根据目标末端位置和姿态计算腕部中心坐标。腕部中心只由前三个关节决定先用几何法解出θ1、θ2、θ3。根据目标姿态和前三个角度解出θ4、θ5、θ6。实际代码里我通常会先做“简化为Pitch轴运动平面”的几何解算。假设J1旋转后机械臂在一个垂直平面内工作那问题就变成了一个二连杆大臂加小臂加一个俯仰角的问题。// 逆解函数输入目标坐标x,y,z输出六个关节角度 // 返回0成功-1表示目标不可达 int inverse_kinematics(float x, float y, float z, float angles_deg[6]) { // 1. 计算J1旋转角atan2(y, x) float theta1 atan2f(y, x); // 2. 转换到机械臂平面坐标系 float r sqrtf(x * x y * y); // 水平投影距离 float s z - BASE_HEIGHT; // 去除底座高度后的垂直高度 // 3. 计算J2、J3二连杆逆解余弦定理 float L1 ARM_UPPER_LENGTH; // 大臂长度 float L2 ARM_LOWER_LENGTH; // 小臂长度 float link_dist sqrtf(r * r s * s); if (link_dist L1 L2 || link_dist fabsf(L1 - L2)) { return -1; // 超出可达范围 } float cos_alpha (L1 * L1 link_dist * link_dist - L2 * L2) / (2.0f * L1 * link_dist); float alpha acosf(cos_alpha); // 大臂与连线夹角 float beta atan2f(s, r); // 连线与水平面的夹角 float theta2 beta alpha; // 大臂角需要根据实际安装方向调整符号 float cos_gamma (L1 * L1 L2 * L2 - link_dist * link_dist) / (2.0f * L1 * L2); float gamma acosf(cos_gamma); float theta3 gamma - (float)M_PI; // 小臂相对大臂的角度 // 4. 姿态角解算根据期望的腕部俯仰角决定θ4/θ5/θ6 // 这里默认末端TCP垂直于工作平面简化处理 float theta4 0.0f; float theta5 -(theta2 theta3); // 腕部俯仰补偿使末端保持固定姿态 float theta6 0.0f; // 5. 角度转换为度并加上偏置 angles_deg[0] theta1 * 180.0f / (float)M_PI; angles_deg[1] theta2 * 180.0f / (float)M_PI; angles_deg[2] theta3 * 180.0f / (float)M_PI; angles_deg[3] theta4 * 180.0f / (float)M_PI; angles_deg[4] theta5 * 180.0f / (float)M_PI; angles_deg[5] theta6 * 180.0f / (float)M_PI; return 0; }这个代码是高度简化的但已经能完成核心目标给定一个平面内的坐标解出六根轴角度。实际项目中你还需要考虑多种姿态解的选择比如肘上肘下解、奇异点规避、关节限位判断。我在电控上增加了一个逻辑逆解算出来的每一个角度在发送到PWM之前都必须过一遍限位表任何一个关节超出机械限位直接放弃当前目标返回错误避免舵机堵转烧毁。3.4 轨迹插补为什么也要写在STM32里坐标到位后如果直接硬跳六个舵机会同时猛转轻则抖动重则烧舵机、晃断结构件。所以目标位置抓取的完整流程中必须有轨迹插补这一步。最简单的做法是线性插值把起点到终点的路径分成N个中间点每个控制周期比如20ms输出一个中间点对应的六个角度舵机平滑转动。// 线性插值函数从当前角度数组cur[]插值到目标角度数组tar[] // 插值步数step越大越平滑但执行时间越长 void interpolate_angles(float cur[6], float tar[6], int step) { float delta[6]; for (int i 0; i 6; i) { delta[i] (tar[i] - cur[i]) / step; } for (int s 1; s step; s) { float tmp[6]; for (int i 0; i 6; i) { tmp[i] cur[i] delta[i] * s; } set_servo_angles(tmp); // 六路PWM同时更新 delay_ms(20); } }这个函数在STM32上跑起来关键是“六路PWM同时更新”。用HAL库的话对应调用__HAL_TIM_SET_COMPARE同时设置六个通道或者更底层地直接操作TIMx-CCR1~CCR4寄存器保证一个控制周期内六路信号同步更新否则舵机会出现滞后错位末端轨迹会歪。4. 目标位置抓取的代码实例4.1 主程序框架状态机写法机械臂代码不建议写成一坨顺序执行的流水账最好用状态机来管理整个抓取流程。因为机械臂会收到各种各样的指令可能正在转动时又来一个急停命令如果没有状态机逻辑会乱成一锅粥。我的主状态机大致这样IDLE空闲 → MOVE_TO_PREPARE移动到预备点 → MOVE_TO_TARGET移动到目标点 → GRASP闭合夹爪 → MOVE_TO_PLACE移动到放置点 → RELEASE释放夹爪 → 回到IDLE每个状态用枚举变量管理主循环不断轮询状态和外部命令。STM32F103C8T6的72MHz跑这个循环绰绰有余不需要RTOS裸机就够了。核心价值是状态机把“坐标运算”和“动作执行”解耦即使逆解运算偶尔卡个几毫秒也不影响舵机PWM的实时输出。4.2 PWM初始化与角度映射舵机的控制原理很简单20ms周期内高电平脉宽1ms对应0°2ms对应180°不同舵机略有差异。STM32的定时器PWM输出就是干的这个活。以TIM1的CH1为例初始化关键代码如下void servo_pwm_init(void) { // 开启TIM1和GPIO时钟 RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); GPIO_InitTypeDef gpio; gpio.GPIO_Pin GPIO_Pin_8; // TIM1_CH1默认映射到PA8 gpio.GPIO_Mode GPIO_Mode_AF_PP; // 复用推挽输出 gpio.GPIO_Speed GPIO_Speed_50MHz; GPIO_Init(GPIOA, gpio); // 定时器配置72MHz分频后得到1MHz计数频率周期20ms TIM_TimeBaseInitTypeDef tim; TIM_TimeBaseStructInit(tim); tim.TIM_Prescaler 72 - 1; // 72MHz / 72 1MHz计数周期1us tim.TIM_Period 20000 - 1; // 20ms周期即20ms刷新一次 TIM_TimeBaseInit(TIM1, tim); // PWM通道配置 TIM_OCInitTypeDef oc; TIM_OCStructInit(oc); oc.TIM_OCMode TIM_OCMode_PWM1; oc.TIM_OutputState TIM_OutputState_Enable; oc.TIM_Pulse 1500; // 初始脉宽1.5ms舵机中位 TIM_OC1Init(TIM1, oc); TIM_Cmd(TIM1, ENABLE); TIM_CtrlPWMOutputs(TIM1, ENABLE); // 高级定时器必须开主输出 }这里有两个容易踩的坑。第一个TIM1是高级定时器PWM配置完成后必须调用TIM_CtrlPWMOutputs(TIM1, ENABLE)否则PA8上没有波形输出很多人查了半天发现寄存器都没问题就是忘了这一步。第二个PSC分频值72-1是因为STM32的时钟树72MHz分频后要得到1MHz的计数时钟这样每计一个数就是1微秒脉冲宽度直接以微秒为单位计算非常直观。角度转换就很简单了// 角度转脉宽0°对应500us180°对应2500us线性映射 uint32_t angle_to_pulse(float angle_deg) { return (uint32_t)(500 angle_deg * 2000.0f / 180.0f); }考虑到实际舵机的线性度并没有理论那么完美我建议在手爪抓取的关键点位做一次校准确定实际脉宽和真实角度的对应关系修正比例系数。4.3 夹爪抓取逻辑与限位反馈目标位置抓取的“抓”字不是简单地把夹爪闭合它涉及到位控制和力控制。用舵机做夹爪时我们不能直接控制夹持力只能控制角度。所以我一般会给夹爪加到位检测两个IO口接微动开关或光电传感器检测夹爪闭合是否碰到物体。代码逻辑是这样// 执行抓取动作 void grasp_action(void) { // 先张开夹爪到最大位置 set_servo_angle(GRIPPER_CHANNEL, GRIPPER_OPEN_ANGLE); delay_ms(300); // 缓慢闭合 for (float ang GRIPPER_OPEN_ANGLE; ang GRIPPER_CLOSE_ANGLE; ang - 1.0f) { set_servo_angle(GRIPPER_CHANNEL, ang); delay_ms(15); // 如果检测到夹爪夹到物体立即停止 if (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_0) 0) // 限位触发为低电平 { break; } } }这一步的细节很重要。如果没有到位检测当物体尺寸小于预期时夹爪会直接闭到底舵机堵转发热用不了几次就烧了。有了限位开关之后舵机夹持力控制在刚好碰到物体的位置寿命长得多。4.4 串口协议与上位机命令设计配合上位机调度串口协议要尽量简单可靠。我的协议格式是帧头(0xAA 0x55) 命令字(1字节) 数据长度(1字节) 数据(N字节) 校验和(1字节)常用的命令字#define CMD_MOVE_LINEAR 0x01 // 线性轨迹运动到坐标 #define CMD_MOVE_JOINT 0x02 // 关节角直接运动 #define CMD_GRASP 0x03 // 执行抓取 #define CMD_RELEASE 0x04 // 执行释放 #define CMD_GET_POSE 0x05 // 查询当前末端坐标数据部分直接用float类型的X/Y/Z坐标上位机只要按照四字节小端格式发就行。接收用串口中断缓冲区的方式不要在中断里做逆解而是把整帧数据解析完成后置一个标志位主循环里再统一处理。这样即使上位机连续发数据也不会因为运算超时而丢帧。5. 调试记录与常见问题排查5.1 舵机抖动、复位、烧IO的常见排查我把自己踩过的坑和网友问得最多的问题整理成一个速查表现象可能原因排查方法上电后STM32反复复位舵机启动瞬间电流拉低5V电压换大功率5V电源4A以上在舵机电源端加大电容舵机到位后嗡嗡响/抖动PWM周期不稳定或脉宽恰好在中点附近检查定时器分频是否配置正确用示波器看PWM波形给舵机加死区设置串口收到乱码共地问题/波特率不准用外部晶振MCU与USB转TTL共地把波特率降到9600测试逆解结果角度跳变DH参数符号定义错误或安装偏置未标定单关节逐个测量实际角度与软件角度差六轴动作但末端位置不准机械回差/舵机负载下垂J2/J3换更大扭矩舵机在多圈运动中记录累计误差IO口/MCU烧毁舵机堵转反灌电流信号线串联电阻电源用地隔离这里最容易被轻视的是“舵机堵转”。当某个关节因为机械限位或者逆解错误被命令转到物理极限之外舵机会持续堵转电流飙升、发热然后通过信号线把毛刺传回MCU。轻则复位重则烧IO。所以我在每个关节角度输出前都做限位检查并且在舵机电源和MCU电源之间加了一个低阻值的PTC自恢复保险丝电流异常时自动断开舵机电源MCU保持正常运行还能在串口打印故障信息。5.2 目标位置不可达怎么处理目标位置抓取时最容易遇到的问题上位机给了一个坐标但逆解返回-1机械臂完全没反应。这时候很多人的第一反应是代码bug但实际上大多数情况是“目标点不在机械臂的可达空间内”。可达空间受机械臂DH参数中的a、d值和关节限位共同决定。我之前用一版DH参数时J2的限位是0°~90°导致机械臂只能向前上方伸后方和下方区域的坐标永远不可达。这不是逆解的错误是物理约束。处理策略是在串口返回中增加一个状态码0xEE表示目标不可达上位机可以根据返回值在界面上提示用户调整目标点位置。同时把当前可达空间的半径计算出来做成表格反馈给上位机这样软件层面能自动筛选合法坐标。5.3 调优心得从“能跑”到“好用”整个项目做完我最大的体会是六轴机械臂的难点不在“驱动舵机”而在“让末端准确到达目标”。要做到这一点少不了几步调试第一是角度零偏标定。每个舵机安装后先用简单的测试程序逐个归零用角度尺量出实际偏差写进一个数组里。之后所有逆解角度输出前都加上这组偏置。这一步可以解决大部分位置偏到姥姥家的问题。第二是夹爪中心点TCP标定。DH表里的末端坐标系原点在哪决定了下发坐标的含义。我在调试时用一个尖头笔装在夹爪上手动控制机械臂去点桌面上的几个已知坐标点反过来修正DH参数里的d值腕部偏移。用三五个点做最小二乘拟合精度能提高一个量级。第三是轨迹速度的控制。舵机机械臂不像伺服电机没有闭环反馈所以运动速度必须保守。我一般让末端最大线速度限制在20~30mm/s太快了不仅末端轨迹会明显偏移急停时还会因为惯性导致整机晃动。这个速度对桌面级的抓取演示完全够用。最后再分享一个小技巧调试时一定不要直接从“上位机发坐标”开始。先用串口助手手动下发关节角命令让机械臂逐个关节动起来确认每个轴方向正确、限位可靠再切换到正运动学模式输入一组已知角度确认计算的末端坐标和真实位置吻合最后才跑逆解和完整抓取流程。这个顺序看着多花了时间实际上能帮你少排查无数个脑溢血级别的bug。本文还有配套的精品资源点击获取
简介面向嵌入式开发者与机器人爱好者这是一份基于STM32F103C8T6的六轴机械臂工程示例重点演示目标位置抓取功能的软件实现适合学习STM32外设控制、机械臂运动学或正在寻找可移植参考代码的读者。压缩包共851个文件、约23.2MB主体为515个C源文件与194个头文件同时包含Keil工程配置uvprojx/uvoptx、编译产物hex/axf、CubeMX的ioc引脚配置、Python辅助脚本以及线性插值等DSP算法相关源码便于在真实板卡上烧录验证也能帮助理解轨迹规划与插补计算环节。项目文件分层较清晰从电机驱动、传感器读取到上层抓取逻辑均有涉及可据此梳理六轴机械臂的整机控制流程。内容预览中还可见arm_common_tables、arm_dct4_init等CMSIS-DSP文件说明工程集成了ARM官方数学库对需要开展机械臂运动控制或伺服调参的开发者有参考价值。目前已有377人浏览学习适合STM32机械臂相关课题的入门与二次开发。 我不止一次被人问到STM32F103C8T6这种“小蓝板”到底能不能驱动六轴机械臂做目标位置抓取我的回答是能而且如果只是配合舵机来做离线/半自动抓取这颗Cortex-M3芯片的性价比高到离谱。这篇文章就是把我自己做的一个完整项目拆开来讲从stm32c8t6原理图设计、六轴机械臂DH参数建模到目标位置抓取的代码实例全部摊开说清楚。适合手里有F103C8T6最小板、想入门机械臂控制或者已经能点灯但不知道怎么把舵机和坐标运算串起来的读者。1. 项目概述与整体方案设计1.1 为什么是STM32F103C8T6而不是ESP32或Arduino先说结论STM32F103C8T6做六轴舵机机械臂的控制核心完全够用而且比Arduino更稳比ESP32更适合学习底层原理。很多人习惯用Arduino UNO做机械臂图它库多、写起来简单。但真到了六轴场景Arduino UNO的AVR核心在处理运动学运算时明显吃力尤其是逆解运算里大量三角函数和矩阵运算精度和速度都打折扣。而STM32F103C8T6主频72MHz带硬件乘法器和32位数据处理能力算4x4齐次变换矩阵的几个乘法只需要微秒级跑几百Hz的控制循环毫无压力。有人会问那为什么不直接用ESP32还能带WiFi做无线控制。我的考量是这样如果目标只是“把机械臂跑起来并实现指定坐标抓取”那么STM32的裸机开发流程反而更清晰——PWM定时器、串口DMA、GPIO中断每一步都能直观理解不受RTOS和网络协议栈干扰。用ESP32当然可以做远程控制那属于另一个项目方向。做六轴机械臂先把核心运动学吃透比什么都重要。1.2 六轴机械臂的整机架构这个项目的机械结构我选的是常见的铝合金六轴机械臂套件关节分布是底座旋转轴J1、大臂俯仰J2、小臂俯仰J3、腕部旋转J4、腕部俯仰J5、末端法兰旋转J6。驱动方式全部采用舵机型号上J1用大扭矩MG996R55kg·cm级别的甚至更好J2/J3也至少用MG996R级别J4/J5/J6可以用SG90或者MG90S级别的小舵机。为什么这么分配因为越靠近基座的关节承受的力矩越大J1到J3需要对抗整个臂的重量和负载力矩不够会发抖、丢步甚至烧舵机。控制系统核心就一块STM32F103C8T6最小系统板配上舵机驱动板或者自己用三极管/ULN2003搭的PWM驱动电路。整机供电用12V转5V的稳压模块舵机直接从5V供电取电STM32板子可以共用5V但要注意舵机启动瞬间电流可能冲到2A以上所以电源余量至少4A起步否则一通电就会系统复位。整体工作流程这样上位机串口下发目标位置的X/Y/Z坐标和末端姿态角度 → STM32读入后做逆运动学解算得到六个关节的目标角度 → 定时器产生PWM信号驱动舵机逐关节转动 → 末端夹爪到位后根据IO反馈或延时控制夹爪闭合完成抓取。2. 硬件设计stm32c8t6原理图与关键电路2.1 核心最小系统的原理图要点STM32F103C8T6虽然很多模块板都做好了但如果你要自己画板或者排查硬件问题有几个原理图节点要特别注意供电部分VDD接3.3VVDDA接3.3V并串一个磁珠或10Ω电阻做滤波这是ADC稳定工作的前提。VSS和VSSA接地。复位电路NRST引脚接10kΩ上拉电阻到3.3V并联一个100nF电容到地形成典型的RC复位电路。如果复位引脚悬空芯片上电偶尔会进不了正常状态。启动模式BOOT0和BOOT1必须通过10kΩ电阻下拉到地这样芯片从Flash启动。很多新手画板时忘了给BOOT0加下拉电阻导致程序下载后必须手动触碰引脚才能从Flash运行非常坑。晶振电路8MHz主晶振两端接两个20pF负载电容电容另一端接地。如果是用内部RC振荡器HSI可以省掉外部晶振但做机械臂这种对时序精度有要求的项目建议用外部晶振串口波特率会更准。下载接口SWD接口只需SWDIO、SWCLK、GND三根线加上3.3V就是四根。SWD比JTAG省IO调试六轴机械臂时IO本来就紧张建议直接引SWD。如果你用的是一块钱一块的蓝色Pill板其实这些都不用管板厂已经把最小系统做好了。但只要你外接舵机驱动、电源模块和通信接口就必须在自己的布板上把原理图链路画清楚。2.2 舵机PWM驱动电路怎么做六轴加一个夹爪共需要至少7路PWM信号。STM32F103C8T6的TIM1、TIM2、TIM3、TIM4加起来有比较多的PWM通道通常我这样分配外设通道用途TIM1CH1~CH4J1~J4舵机TIM2CH1~CH3J5、J6、夹爪USART1TX/RX上位机通信PA0~PA2GPIO输入夹爪到位限位开关舵机的信号线直接接IO口吗不行。虽然舵机信号线理论上只需要3.3V的高电平就能识别但工程上最好在信号线上串联一个几百欧姆的电阻再并联一个10kΩ下拉电阻到地。原因有二第一舵机信号线长的时候会引入噪声串电阻可以抑制振铃第二舵机内部的电路板是独立的如果舵机损坏串接电阻能保护MCU引脚不被反灌电压打坏。我实际调试时遇到过舵机内部短路直接把一个IO口烧了就是因为没加保护后来所有信号线都串联了330Ω电阻再没出过问题。电源部分必须是星型布线12V输入 → 稳压模块 → 5V母线 → 舵机电源线和MCU电源线分别从母线引出。千万不能让舵机的电流回路经过MCU的地线否则舵机转动时地线抖动MCU的ADC和串口通信会被干扰得乱七八糟。我自己第一次试的时候舵机一转到某个角度串口就会收到乱码就是因为共地回路太长。3. 运动学建模六轴机械臂DH参数推导3.1 DH参数表怎么建立要说清楚“目标位置抓取”核心就是坐标系的转换。六轴机械臂的每一个关节都是一个旋转自由度要搞明白末端执行器在世界坐标系下的位置就需要建立每个关节的坐标系然后一步步变换过去。DH参数Denavit-Hartenberg就是描述相邻关节坐标系之间相对关系的四个参数关节角θ、连杆偏移d、连杆长度a、连杆扭角α。具体到我用的这款六轴机械臂我测出来的DH参数表大致是这样不同机械臂的结构尺寸不一样需要实际测量关节θ变量d (mm)a (mm)αJ1θ11200-90°J2θ201500°J3θ301200°J4θ4800-90°J5θ50090°J6θ66000°这里a值就是相邻两个关节轴之间的连杆长度也就是大臂和小臂的实际长度。d值是沿着关节轴方向的偏移量底座高度和腕部到法兰的距离都体现在d里。α值的正负号很关键它决定了坐标变换矩阵里旋转分量的方向。在建立DH表的时候最容易忽略的是“零点位置定义”。我调试时发现很多舵机安装完成后软件里设置的0°和机械结构的0°并不对应。比如J2大臂理论上应该垂直向上是0°但舵机装上去后可能开机就是30°。所以DH表里的θ变量最好加上一个安装偏置角即软件角度 目标角度 舵机安装偏置。这个偏置在调试时用水平尺或角度尺标定别偷懒。3.2 正运动学从角度到坐标正运动学就是已知六个关节角求末端执行器的位置和姿态。标准做法是把每个关节的齐次变换矩阵相乘T_06 T_01 * T_12 * T_23 * T_34 * T_45 * T_56每个T矩阵的通用形式是| cosθ -sinθ*cosα sinθ*sinα a*cosθ | | sinθ cosθ*cosα -cosθ*sinα a*sinθ | | 0 sinα cosα d | | 0 0 0 1 |代码里我不建议用二维数组硬算而是先用辅助函数解耦// 计算单个DH变换矩阵 // 输入关节角theta_rad, 偏移d, 杆长a, 扭角alpha_rad // 输出4x4旋转平移矩阵mat[4][4] void dh_matrix(float theta_rad, float d, float a, float alpha_rad, float mat[4][4]) { float ct cosf(theta_rad); float st sinf(theta_rad); float ca cosf(alpha_rad); float sa sinf(alpha_rad); mat[0][0] ct; mat[0][1] -st * ca; mat[0][2] st * sa; mat[0][3] a * ct; mat[1][0] st; mat[1][1] ct * ca; mat[1][2] -ct * sa; mat[1][3] a * st; mat[2][0] 0.0f; mat[2][1] sa; mat[2][2] ca; mat[2][3] d; mat[3][0] 0.0f; mat[3][1] 0.0f; mat[3][2] 0.0f; mat[3][3] 1.0f; }然后把六个矩阵依次相乘取最后结果的第4列前三个元素就是末端在世界坐标系下的X、Y、Z坐标。这里有个数值细节矩阵乘法最好用双精度还是单精度我的经验是在STM32F103C8T6上用float就够因为机械臂本身的机械误差和舵机精度大概1°~2°远大于单精度浮点的舍入误差。但是如果做定点数优化精度反而不够所以我强烈建议直接开FPUSTM32F103没有硬件FPU但因为F103C8T6是Cortex-M3浮点运算靠软件库用编译器的数学库就行不必为精度焦虑。3.3 逆运动学从坐标反推关节角目标位置抓取最难的一步是给你一个X、Y、Z坐标让机械臂自动算出六个关节各该转多少度。这个问题叫逆解方法很多几何法、代数法、迭代法。对于六轴机械臂我推荐先用**代数法解析法**理解关节间解耦逻辑再在代码里用几何法简化前三个关节的计算。在解析法中有一个关键概念腕部解耦。对于大多数六轴机械臂J4、J5、J6三个轴的交点都在同一个点称为腕部中心点。这样末端位置只与J1、J2、J3相关而J4、J5、J6只影响末端姿态不影响位置。因此逆解步骤可以拆分为根据目标末端位置和姿态计算腕部中心坐标。腕部中心只由前三个关节决定先用几何法解出θ1、θ2、θ3。根据目标姿态和前三个角度解出θ4、θ5、θ6。实际代码里我通常会先做“简化为Pitch轴运动平面”的几何解算。假设J1旋转后机械臂在一个垂直平面内工作那问题就变成了一个二连杆大臂加小臂加一个俯仰角的问题。// 逆解函数输入目标坐标x,y,z输出六个关节角度 // 返回0成功-1表示目标不可达 int inverse_kinematics(float x, float y, float z, float angles_deg[6]) { // 1. 计算J1旋转角atan2(y, x) float theta1 atan2f(y, x); // 2. 转换到机械臂平面坐标系 float r sqrtf(x * x y * y); // 水平投影距离 float s z - BASE_HEIGHT; // 去除底座高度后的垂直高度 // 3. 计算J2、J3二连杆逆解余弦定理 float L1 ARM_UPPER_LENGTH; // 大臂长度 float L2 ARM_LOWER_LENGTH; // 小臂长度 float link_dist sqrtf(r * r s * s); if (link_dist L1 L2 || link_dist fabsf(L1 - L2)) { return -1; // 超出可达范围 } float cos_alpha (L1 * L1 link_dist * link_dist - L2 * L2) / (2.0f * L1 * link_dist); float alpha acosf(cos_alpha); // 大臂与连线夹角 float beta atan2f(s, r); // 连线与水平面的夹角 float theta2 beta alpha; // 大臂角需要根据实际安装方向调整符号 float cos_gamma (L1 * L1 L2 * L2 - link_dist * link_dist) / (2.0f * L1 * L2); float gamma acosf(cos_gamma); float theta3 gamma - (float)M_PI; // 小臂相对大臂的角度 // 4. 姿态角解算根据期望的腕部俯仰角决定θ4/θ5/θ6 // 这里默认末端TCP垂直于工作平面简化处理 float theta4 0.0f; float theta5 -(theta2 theta3); // 腕部俯仰补偿使末端保持固定姿态 float theta6 0.0f; // 5. 角度转换为度并加上偏置 angles_deg[0] theta1 * 180.0f / (float)M_PI; angles_deg[1] theta2 * 180.0f / (float)M_PI; angles_deg[2] theta3 * 180.0f / (float)M_PI; angles_deg[3] theta4 * 180.0f / (float)M_PI; angles_deg[4] theta5 * 180.0f / (float)M_PI; angles_deg[5] theta6 * 180.0f / (float)M_PI; return 0; }这个代码是高度简化的但已经能完成核心目标给定一个平面内的坐标解出六根轴角度。实际项目中你还需要考虑多种姿态解的选择比如肘上肘下解、奇异点规避、关节限位判断。我在电控上增加了一个逻辑逆解算出来的每一个角度在发送到PWM之前都必须过一遍限位表任何一个关节超出机械限位直接放弃当前目标返回错误避免舵机堵转烧毁。3.4 轨迹插补为什么也要写在STM32里坐标到位后如果直接硬跳六个舵机会同时猛转轻则抖动重则烧舵机、晃断结构件。所以目标位置抓取的完整流程中必须有轨迹插补这一步。最简单的做法是线性插值把起点到终点的路径分成N个中间点每个控制周期比如20ms输出一个中间点对应的六个角度舵机平滑转动。// 线性插值函数从当前角度数组cur[]插值到目标角度数组tar[] // 插值步数step越大越平滑但执行时间越长 void interpolate_angles(float cur[6], float tar[6], int step) { float delta[6]; for (int i 0; i 6; i) { delta[i] (tar[i] - cur[i]) / step; } for (int s 1; s step; s) { float tmp[6]; for (int i 0; i 6; i) { tmp[i] cur[i] delta[i] * s; } set_servo_angles(tmp); // 六路PWM同时更新 delay_ms(20); } }这个函数在STM32上跑起来关键是“六路PWM同时更新”。用HAL库的话对应调用__HAL_TIM_SET_COMPARE同时设置六个通道或者更底层地直接操作TIMx-CCR1~CCR4寄存器保证一个控制周期内六路信号同步更新否则舵机会出现滞后错位末端轨迹会歪。4. 目标位置抓取的代码实例4.1 主程序框架状态机写法机械臂代码不建议写成一坨顺序执行的流水账最好用状态机来管理整个抓取流程。因为机械臂会收到各种各样的指令可能正在转动时又来一个急停命令如果没有状态机逻辑会乱成一锅粥。我的主状态机大致这样IDLE空闲 → MOVE_TO_PREPARE移动到预备点 → MOVE_TO_TARGET移动到目标点 → GRASP闭合夹爪 → MOVE_TO_PLACE移动到放置点 → RELEASE释放夹爪 → 回到IDLE每个状态用枚举变量管理主循环不断轮询状态和外部命令。STM32F103C8T6的72MHz跑这个循环绰绰有余不需要RTOS裸机就够了。核心价值是状态机把“坐标运算”和“动作执行”解耦即使逆解运算偶尔卡个几毫秒也不影响舵机PWM的实时输出。4.2 PWM初始化与角度映射舵机的控制原理很简单20ms周期内高电平脉宽1ms对应0°2ms对应180°不同舵机略有差异。STM32的定时器PWM输出就是干的这个活。以TIM1的CH1为例初始化关键代码如下void servo_pwm_init(void) { // 开启TIM1和GPIO时钟 RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); GPIO_InitTypeDef gpio; gpio.GPIO_Pin GPIO_Pin_8; // TIM1_CH1默认映射到PA8 gpio.GPIO_Mode GPIO_Mode_AF_PP; // 复用推挽输出 gpio.GPIO_Speed GPIO_Speed_50MHz; GPIO_Init(GPIOA, gpio); // 定时器配置72MHz分频后得到1MHz计数频率周期20ms TIM_TimeBaseInitTypeDef tim; TIM_TimeBaseStructInit(tim); tim.TIM_Prescaler 72 - 1; // 72MHz / 72 1MHz计数周期1us tim.TIM_Period 20000 - 1; // 20ms周期即20ms刷新一次 TIM_TimeBaseInit(TIM1, tim); // PWM通道配置 TIM_OCInitTypeDef oc; TIM_OCStructInit(oc); oc.TIM_OCMode TIM_OCMode_PWM1; oc.TIM_OutputState TIM_OutputState_Enable; oc.TIM_Pulse 1500; // 初始脉宽1.5ms舵机中位 TIM_OC1Init(TIM1, oc); TIM_Cmd(TIM1, ENABLE); TIM_CtrlPWMOutputs(TIM1, ENABLE); // 高级定时器必须开主输出 }这里有两个容易踩的坑。第一个TIM1是高级定时器PWM配置完成后必须调用TIM_CtrlPWMOutputs(TIM1, ENABLE)否则PA8上没有波形输出很多人查了半天发现寄存器都没问题就是忘了这一步。第二个PSC分频值72-1是因为STM32的时钟树72MHz分频后要得到1MHz的计数时钟这样每计一个数就是1微秒脉冲宽度直接以微秒为单位计算非常直观。角度转换就很简单了// 角度转脉宽0°对应500us180°对应2500us线性映射 uint32_t angle_to_pulse(float angle_deg) { return (uint32_t)(500 angle_deg * 2000.0f / 180.0f); }考虑到实际舵机的线性度并没有理论那么完美我建议在手爪抓取的关键点位做一次校准确定实际脉宽和真实角度的对应关系修正比例系数。4.3 夹爪抓取逻辑与限位反馈目标位置抓取的“抓”字不是简单地把夹爪闭合它涉及到位控制和力控制。用舵机做夹爪时我们不能直接控制夹持力只能控制角度。所以我一般会给夹爪加到位检测两个IO口接微动开关或光电传感器检测夹爪闭合是否碰到物体。代码逻辑是这样// 执行抓取动作 void grasp_action(void) { // 先张开夹爪到最大位置 set_servo_angle(GRIPPER_CHANNEL, GRIPPER_OPEN_ANGLE); delay_ms(300); // 缓慢闭合 for (float ang GRIPPER_OPEN_ANGLE; ang GRIPPER_CLOSE_ANGLE; ang - 1.0f) { set_servo_angle(GRIPPER_CHANNEL, ang); delay_ms(15); // 如果检测到夹爪夹到物体立即停止 if (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_0) 0) // 限位触发为低电平 { break; } } }这一步的细节很重要。如果没有到位检测当物体尺寸小于预期时夹爪会直接闭到底舵机堵转发热用不了几次就烧了。有了限位开关之后舵机夹持力控制在刚好碰到物体的位置寿命长得多。4.4 串口协议与上位机命令设计配合上位机调度串口协议要尽量简单可靠。我的协议格式是帧头(0xAA 0x55) 命令字(1字节) 数据长度(1字节) 数据(N字节) 校验和(1字节)常用的命令字#define CMD_MOVE_LINEAR 0x01 // 线性轨迹运动到坐标 #define CMD_MOVE_JOINT 0x02 // 关节角直接运动 #define CMD_GRASP 0x03 // 执行抓取 #define CMD_RELEASE 0x04 // 执行释放 #define CMD_GET_POSE 0x05 // 查询当前末端坐标数据部分直接用float类型的X/Y/Z坐标上位机只要按照四字节小端格式发就行。接收用串口中断缓冲区的方式不要在中断里做逆解而是把整帧数据解析完成后置一个标志位主循环里再统一处理。这样即使上位机连续发数据也不会因为运算超时而丢帧。5. 调试记录与常见问题排查5.1 舵机抖动、复位、烧IO的常见排查我把自己踩过的坑和网友问得最多的问题整理成一个速查表现象可能原因排查方法上电后STM32反复复位舵机启动瞬间电流拉低5V电压换大功率5V电源4A以上在舵机电源端加大电容舵机到位后嗡嗡响/抖动PWM周期不稳定或脉宽恰好在中点附近检查定时器分频是否配置正确用示波器看PWM波形给舵机加死区设置串口收到乱码共地问题/波特率不准用外部晶振MCU与USB转TTL共地把波特率降到9600测试逆解结果角度跳变DH参数符号定义错误或安装偏置未标定单关节逐个测量实际角度与软件角度差六轴动作但末端位置不准机械回差/舵机负载下垂J2/J3换更大扭矩舵机在多圈运动中记录累计误差IO口/MCU烧毁舵机堵转反灌电流信号线串联电阻电源用地隔离这里最容易被轻视的是“舵机堵转”。当某个关节因为机械限位或者逆解错误被命令转到物理极限之外舵机会持续堵转电流飙升、发热然后通过信号线把毛刺传回MCU。轻则复位重则烧IO。所以我在每个关节角度输出前都做限位检查并且在舵机电源和MCU电源之间加了一个低阻值的PTC自恢复保险丝电流异常时自动断开舵机电源MCU保持正常运行还能在串口打印故障信息。5.2 目标位置不可达怎么处理目标位置抓取时最容易遇到的问题上位机给了一个坐标但逆解返回-1机械臂完全没反应。这时候很多人的第一反应是代码bug但实际上大多数情况是“目标点不在机械臂的可达空间内”。可达空间受机械臂DH参数中的a、d值和关节限位共同决定。我之前用一版DH参数时J2的限位是0°~90°导致机械臂只能向前上方伸后方和下方区域的坐标永远不可达。这不是逆解的错误是物理约束。处理策略是在串口返回中增加一个状态码0xEE表示目标不可达上位机可以根据返回值在界面上提示用户调整目标点位置。同时把当前可达空间的半径计算出来做成表格反馈给上位机这样软件层面能自动筛选合法坐标。5.3 调优心得从“能跑”到“好用”整个项目做完我最大的体会是六轴机械臂的难点不在“驱动舵机”而在“让末端准确到达目标”。要做到这一点少不了几步调试第一是角度零偏标定。每个舵机安装后先用简单的测试程序逐个归零用角度尺量出实际偏差写进一个数组里。之后所有逆解角度输出前都加上这组偏置。这一步可以解决大部分位置偏到姥姥家的问题。第二是夹爪中心点TCP标定。DH表里的末端坐标系原点在哪决定了下发坐标的含义。我在调试时用一个尖头笔装在夹爪上手动控制机械臂去点桌面上的几个已知坐标点反过来修正DH参数里的d值腕部偏移。用三五个点做最小二乘拟合精度能提高一个量级。第三是轨迹速度的控制。舵机机械臂不像伺服电机没有闭环反馈所以运动速度必须保守。我一般让末端最大线速度限制在20~30mm/s太快了不仅末端轨迹会明显偏移急停时还会因为惯性导致整机晃动。这个速度对桌面级的抓取演示完全够用。最后再分享一个小技巧调试时一定不要直接从“上位机发坐标”开始。先用串口助手手动下发关节角命令让机械臂逐个关节动起来确认每个轴方向正确、限位可靠再切换到正运动学模式输入一组已知角度确认计算的末端坐标和真实位置吻合最后才跑逆解和完整抓取流程。这个顺序看着多花了时间实际上能帮你少排查无数个脑溢血级别的bug。本文还有配套的精品资源点击获取
