简介大疆 GM6020 与 GM6623 电机配合 DR16 遥控器的云台电机控制系统设计与实现是一套可直接用于毕业设计或课程设计的完整项目资料。项目面向自动化、人工智能、电子信息等专业高校学生也可供科研人员和嵌入式爱好者参考。压缩包内含190个文件以 C 语言底层驱动、Python 辅助脚本、JS 前端交互及 JSON 配置为核心附带项目报告、多张说明图片与工程配置文件整体仅2.58MB。内容覆盖串口通信、ADC 采样、时钟芯片、温湿度采集等嵌入式常用模块从电机驱动到遥控指令解析均有完整代码支撑系统框图、测试流程与调试记录也在文档中有所体现。项目报告详述了硬件选型、控制策略与实验数据便于复现与答辩目录按功能模块组织可在此基础上增加传感器、调整控制算法或接入其他平台。已有93人学习浏览适合具备一定嵌入式基础的学习者借鉴也可作为项目初期展示与课程设计验收的重要素材。1. 大疆云台电机控制6020 加 6623 加 DR16 为什么适合做毕设大疆云台电机控制方向的毕设最常见的一套组合就是 GM6020 与 GM6623 当执行器DR16 遥控器作为给定来源再由一块 STM32 把姿态闭环串起来。它解决的问题非常具体云台固定在车上或桌面上底盘被人碰一下、电机抖动一下相机要在几十毫秒内被拉回原姿态遥控器推杆时云台要平滑跟随而不是猛地撞到限位。这比“让电机转起来”难一个量级但回报也直接——PID、CAN 通信、串口接收、姿态解算四个东西在这里全部碰齐恰好是很多嵌入式岗位的日常。适合正在做毕业设计的学生也适合刚接触 RoboMaster 电机体系、想从零搭一套云台的开发者。2. 云台控制架构6020/6623 怎么分工IMU 姿态闭环怎么串起来2.1 选型依据6020 是“带大脑的关节”6623 是“出力气的手臂”GM6020 是集成驱动的一体化电机内置 FOC 控制器一条 CAN 总线就能读到它的角度、速度、力矩反馈也可以直接给它发力矩、速度或位置指令。对开发者来说它等于一个“自带驱动器的完整关节”省掉了自己写 FOC 的环节非常适合当作云台偏航轴的主力执行器。偏航轴需要的是快速响应和精确回中6020 的内置驱动能把这部分做得非常干净。GM6623 则相反它是一颗裸电机不带驱动必须配 C610 或 C615 电调才能工作在 CAN 总线里。6623 的特点是大扭矩、大过载能力适合放在俯仰轴。云台的俯仰轴要顶着一个前置的相机重心经常还不在转轴上静态不平衡力矩很大如果让 6020 单独扛电流会经常逼近限幅6623 配合减速机构就从容很多。我一般会建议这样分工偏航用 6020俯仰用 6623 加电调两轴各占一条 CAN 总线既避免 ID 冲突也方便独立调试。这套选型还有一个隐性好处6020 和 6623/电调两套方案的控制方式不一样前者是电机自己闭环后者是电调只跑电流环上层 PID 全在自己手里。一个项目里同时接触两种控制粒度对写毕设报告来说反而是加分项因为它逼着作者把“电流环—速度环—角度环”这条链路彻底讲清楚。2.2 姿态闭环数据流IMU 到角度环再到速度环最后落到力矩云台控制的本质是一个串级PID外环稳住角度内环稳住角速度。常见的实现里IMUMPU6050 或 ICM42670 这类放在云台末端靠近相机的位置以 1kHz 的频率输出陀螺仪角速度同时以 500Hz 左右输出解算后的欧拉角。遥控器 DR16 给出的目标角度进来之后角度环先算一次目标角度减当前角度乘以比例系数输出一个“期望角速度”这个期望角速度再进内环和陀螺仪实际角速度相减经 PD 运算得到最终力矩发给 6020 或 6623 电调。数据流看起来简单实现时容易乱的地方在坐标系。偏航角以 IMU 的 Z 轴为准俯仰角以 Y 轴为准如果 IMU 安装方向和电机零点方向不一致解算出来的角度会和实际机械位置差一个固定偏移表现出来就是云台指向歪的而且 PID 怎么调都压不住稳态误差。我一般会在上电初始化时做一次“角度零点校准”把电机机械零点对应的 IMU 读数记录下来之后所有角度都减去这个偏移。代码结构上用定时器中断驱动控制环比用主循环轮询要稳得多// 假设 TIM6 每 1ms 进入一次中断 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim-Instance TIM6) { // 1kHz先读陀螺仪原始角速度 gyro_read_raw(gyro_x, gyro_y, gyro_z); // 500Hz隔一拍再做角度环减轻运算压力 if (control_tick % 2 0) { imu_attitude_update(); // 更新欧拉角 angle_loop(); // 外环 P角度 - 目标角速度 } speed_loop(); // 内环 PD角速度 - 力矩 can_send_all_motors(); // 通过 CAN 发出电机指令 } }这里最关键的是“先读传感器再算控制最后发指令”的执行顺序。如果反过来先发指令再读传感器控制环就多了一个周期的纯延迟云台会在高速扰动下出现“越想稳住越抖”的情况。2.3 控制周期分配陀螺仪环最快遥控最慢CAN 发送卡中间云台系统的三个数据源速度不同陀螺仪能跑到 1kHz 到 8kHz角度环受 IMU 解算速度限制通常 500Hz 就够DR16 遥控器实际刷新率约为 100HzCAN 总线发送一帧电机指令并按 1kHz 执行的可行性由电机自身决定。我习惯把控制环分成三档1kHz 的陀螺仪采样和速度环、500Hz 的角度环、100Hz 的遥控目标更新。遥控目标没必要每一个控制周期都读取。DR16 摇杆推过来是人的动作带宽很低在 1ms 的周期里重复读只会让控制目标频繁跳动。更好做法是遥控通道值由串口 DMA 中断更新到一个全局变量角度环每隔 10ms 取一次快照换算成角度目标。这样遥控噪声不会被直接怼进 PID云台动作也更平滑。如果用了 RTOS我建议给陀螺仪环开最高优先级角度环次之CAN 发送可以放到定时器回调里而不是独立线程。裸机定时器方案对毕设来说完全够用也更容易在报告里画时序图。一个值得注意的细节是6020 的反馈报文每个电机占 8 字节且反馈频率和发送频率一致如果 CAN 总线以 1kHz 发送中断里也要保证在下一个周期前把反馈读完否则等下一个 SOF 时数据已经失效半拍。3. 硬件搭建与 CAN 总线配置从 DR16 反相串口到电调线缆长短3.1 DR16 遥控链路SBUS 反相、对频和 UART 参数DR16 接收机和大疆遥控器配对之后输出的是 SBUS 协议信号。SBUS 的物理层是反相的 TTL 串口波特率 1000008 个数位偶校验2 个停止位。也就是说接收机的默认输出电平逻辑和普通 UART 恰好相反直接把它接到 STM32 的 RX 引脚上会受到一帧乱码而不是有效数据。解决反向问题有两种常见做法一是加一片 74HC04 反相器或三极管反相电路把信号电平翻过来再接 MCU二是用大疆官方的 RoboMaster 开发板这类板子通常已经把 SBUS 反相电路做在板上了直接找板子丝印上的 DBUS 接口即可。我这里给出一份最直接的 UART 初始化配置适合无反相电路、自己接了一颗反相器的情况// DR16 - SBUS - 反相器 - PA10 (USART1_RX) // 波特率 1000008 数据位偶校验2 停止位 void dr16_uart_init(void) { __HAL_RCC_GPIOA_CLK_ENABLE(); __HAL_RCC_USART1_CLK_ENABLE(); GPIO_InitTypeDef gpio {0}; gpio.Pin GPIO_PIN_10; // PA10 接收 SBUS gpio.Mode GPIO_MODE_AF_PP; gpio.Pull GPIO_PULLUP; gpio.Speed GPIO_SPEED_FREQ_HIGH; gpio.Alternate GPIO_AF7_USART1; HAL_GPIO_Init(GPIOA, gpio); huart1.Instance USART1; huart1.Init.BaudRate 100000; // SBUS 专用波特率不是 115200 huart1.Init.WordLength UART_WORDLENGTH_8B; huart1.Init.Parity UART_PARITY_EVEN; // 偶校验不能省 huart1.Init.StopBits UART_STOPBITS_2; // 2 个停止位 huart1.Init.Mode UART_MODE_TX_RX; huart1.Init.HwFlowCtl UART_HWCONTROL_NONE; HUART1_Init(huart1); __HAL_UART_ENABLE_IT(huart1, UART_IT_IDLE); // 空闲中断一帧收完再处理 }这份配置里最坑的其实是 100000 这个波特率。很多人按 115200 初始化发现能收到帧头 0x0F但后面字节全错位因为 SBUS 的位时序和通用串口不一样。额外提醒一句接收机对频时要把遥控器靠近接收机按住接收机 Bind 键上电再长按遥控器背面的对频按钮几秒后接收机指示灯常亮才算成功。3.2 CAN 组网电机 ID、控制帧和终端电阻云台的 CAN 组网建议按电机类型分两条总线CAN1 挂 6020 偏航电机CAN2 挂 6623 对应的 C610 电调。这样做的最大好处是隔离故障6020 全速 1kHz 收发时如果还挤着电调总线负载很容易超过安全值。C610 电调和 6020 都是 CAN 标准帧但因为它们的控制帧 ID 规则不同混在一条总线上容易把控制字节发给错误的设备。6020 的控制帧是 0x1FF 和 0x2FF一帧可以同时携带 4 个电机的力矩值反馈帧则在 0x205 到 0x208 附近按电机 ID 偏移。C610 电调的控制帧是 0x200一帧拖 4 个电调的电流指令反馈帧的 ID 则由电调上的 ID 拨码决定通常是 0x201 起步。两条总线隔离之后你只需要关心每条总线上自己的 ID 分配。终端电阻也是一个容易被忽略的点。CAN 总线要求在物理线路两端各有一个 120Ω 终端电阻云台上电气设备少很多开发者会漏接。常见的 RoboMaster 开发板板载了 120Ω 电阻并通过跳线帽启用使用前先确认两个跳线帽是否插好。如果云台和底盘之间线比较长优先让总线上最远端的设备启用终端电阻而不是在中间加否则总线反射会变成随机偶发故障这种玄学问题最难查。3.3 电调 CAN 线不够长怎么办C610 这类原厂电调的线非常短比一根筷子长不了多少而云台的主控通常固定在底盘电调装在俯仰关节上两者之间隔着转动轴。遇到这种情况我一般直接把原厂线剪掉重新压接一对硅胶软线线长留出转动所需的一倍余量并套上蛇皮管防磨损。硅胶线的优势是柔软在云台反复转动时不易疲劳断裂。如果云台偏航轴需要连续旋转超过一圈软线方案也会出问题——线会被绞断。这种场景就是用滑环或导电环把 CAN_H、CAN_L、24V 电源、GND 四根线穿过滑环。上滑环之后要注意 CAN 总线经过滑环时接触电阻会变大终端电阻不要放在滑环另一端而是放在主控端这样即使接触偶有松动链路还能维持。走线有一个容易被忽略的原则电机动力线不要和 CAN 信号线捆在一起走。6020 和 6623 在急加速时动力线上会灌入很大的瞬态电流干扰 CAN 差分信号。我见过云台一转相机就花屏、电机偶尔报错的问题最后发现是动力线和 CAN 线在蛇皮管里捆了 30 厘米。把它们分开走问题当场消失。4. 固件实现SBUS 解析、电机指令帧与 PID 调参起点4.1 按位拆出 11 个通道SBUS 解码代码DR16 遥控器作为给定设备时最重要的就是把摇杆位置变成角度目标。SBUS 一帧 25 字节第一个字节是帧头 0x0F最后一个字节是帧尾 0x00中间 22 字节装 16 个通道每个通道 11bit按位连续拼接。要拿到前 8 个通道的值逐位提取是最直观、也最容易验证的写法#define SBUS_FRAME_LEN 25 #define SBUS_HEADER 0x0F #define SBUS_FOOTER 0x00 uint8_t sbus_buf[SBUS_FRAME_LEN]; uint16_t rc_ch[8]; void sbus_parse(uint8_t *buf, uint16_t *ch, uint8_t ch_cnt) { uint16_t byte_idx 1; // 跳过帧头从数据区开始 uint8_t bit_pos 0; for (uint8_t i 0; i ch_cnt; i) { uint16_t val 0; for (uint8_t j 0; j 11; j) { val | ((buf[byte_idx] bit_pos) 0x01) j; bit_pos; if (bit_pos 8) { bit_pos 0; byte_idx; } } ch[i] val; } }这段代码从 buf[1] 开始逐位读取每取完 8bit 就跳到下一个字节连续拼出 11bit 的通道值。逻辑简单到可以直接和示波器的逻辑分析仪比对不会出错。需要注意 ch_cnt 不要超过 8否则会越界读缓冲区编译器开不开检查就听天由命了。解析完成后DR16 摇杆的典型范围在 364 到 1684 之间中位约 1024。把通道值映射成云台角度目标的常用做法是float rc_to_angle(uint16_t rc_value) { int16_t diff (int16_t)rc_value - 1024; // 中位归零 if (diff -30 diff 30) diff 0; // 摇杆回中死区防抖 float angle diff * (40.0f / 600.0f); // 最大约 40 度 return angle; }角度映射的系数 40/600 意思是摇杆从中心推满大约 600 个 LSB对应 40 度角度范围。这个范围要根据实际云台机械限位去调如果云台只能转 30 度就把 40 改成 30。死区 30 适合大多数摇杆如果遥控器摇杆本身有些虚位死区可以放到 50。4.2 电机指令帧6020 和 6623 电调的数据封装CAN 指令封装是这套系统里最容易抄错的地方。6020 的控制数据按帧发送每一帧最多携带 4 个电机的目标值每个电机占 2 字节发送时低字节在前。6623 走 C610 电调时控制帧结构和字段含义与 6020 不完全一样电流指令的范围也以电调手册为准。写代码时我习惯把电机控制量封装成一个结构体然后统一丢给 CAN 发送函数typedef enum { MODE_VOLTAGE 0, // 力矩/电压模式 MODE_SPEED 1, // 速度模式 MODE_POS 2, // 位置模式 } motor_mode_t; typedef struct { uint8_t motor_index; // 1~4控制帧里的位置 motor_mode_t mode; int16_t voltage_or_torque; // 力矩值范围按电机文档 int16_t speed_rpm; // 速度模式目标 int16_t angle_089; // 位置模式目标注意量纲 } motor_cmd_t; void motor_cmd_encode(motor_cmd_t *cmd, uint8_t frame_data[8]) { // 每个电机占 2 字节低字节在前不同模式复用同一字节段 // 具体字段含义以官方电机驱动为准 uint16_t target 0; switch (cmd-mode) { case MODE_VOLTAGE: target (uint16_t)cmd-voltage_or_torque; break; case MODE_SPEED: target (uint16_t)cmd-speed_rpm; break; case MODE_POS: target (uint16_t)cmd-angle_089; break; } frame_data[(cmd-motor_index - 1) * 2] target 0xFF; frame_data[(cmd-motor_index - 1) * 2 1] (target 8) 0xFF; }框架意义上的“低字节在前、每电机 2 字节”是对的但每个电机的模式字到底是写在单独的字节还是复用 2 字节的高位不同批次固件有差异。初调时务必先单独给电机发一小段固定值看它转不转、往哪转再相信代码里的字段布局。最常翻车的一点是“使能时序”。大疆电机上电后不会立刻响应目标值必须持续收到控制帧才会退出保护状态。很多人初始化时只发一帧数据电机没反应于是怀疑接线坏了。正确做法是在上电后就以 1kHz 周期持续发送零目标值让电机先进入受控状态再慢慢加控制量。4.3 PID 调参起点先内环后外环量纲决定参数云台两轴都是串级 PID调参顺序严格固定先调内环速度环再调外环角度环。内环不稳怎么调外环都是白费。速度环输入是期望角速度反馈是陀螺仪的 rad/s 或 deg/s输出是电机指令值。角度环输入是期望角度反馈是 IMU 欧拉角输出给速度环当目标。两者量纲不同调节参数不能直接套别人云台的数。我给出一个经过多套云台验证的起始参数表单位是标准化的 IMU 输出角度用度角速度用度每秒电机指令映射为归一化 ±1 满量程控制环作用对象比例 P积分 I微分 D备注角度环偏航角度3.0~6.000.1~0.3一般不加 I位置型误差由外环包住速度环偏航角速度0.3~0.80.02~0.050.05~0.15D 太大会放大陀螺噪声角度环俯仰角度4.0~8.000.2~0.5俯仰静不平衡时适当加大速度环俯仰角速度0.5~1.20.03~0.080.1~0.26623 响应比 6020 慢P 可更大这里偏航和俯仰参数不同是因为 6623 带减速后等效惯量更大同样的角度误差需要更大角速度目标。如果云台抖动先把 D 减半再看如果回中慢加外环 P。切忌同时动两个参数否则翻车了都不知道是哪笔账。// 内环 PD 实现dt 固定 1ms float speed_loop_update(float target_deg_s, float gyro_deg_s) { float err target_deg_s - gyro_deg_s; float d_term (err - last_speed_err) * 0.001f; // 微分直接用误差变化率 last_speed_err err; return speed_kp * err speed_kd * d_term; }微分项用“误差变化率”而不是“反馈变化率”的好处是目标值突变时不会产生微分尖峰。遥控器快速推杆时如果目标角速度阶跃前者只输出一次短暂冲击后者会把整个阶跃放大成爆音一样的力矩毛刺。这个写法是云台不抖的一个小秘诀。5. 云台控制避坑5 个高发问题逐一排查5.1 DR16 串口收到乱码通道值乱跳现象串口助手能收到数据但内容除了帧头 0x0F 正确以外其余字节都是 0xFF 或乱序摇杆怎么推通道值都不按 364-1684 变化。原因SBUS 是反相信号DR16 输出的电平直接进 UART会在每一位上产生一个比特级反转导致整帧错位。另一个高频原因是波特率配错把 100000 设成了 115200。解决先加反相器确认 PA10 收到的波形是“空闲为高、起始位为低”的标准 UART 电平然后把波特率、偶校验、双停止位三项全部按 SBUS 规范配好。我在调试时会先在初始化里把 100000 波特率单独打印出来错了直接看空闲中断接收的字节数是不是 25。5.2 6020 能收到反馈但输出没劲云台用手能捏住现象CAN 反馈值是正常的PID 输出也到了满量程的一半但电机就是软绵绵的用手一捏就停。原因最常见的是 6020 工作在力矩模式而峰值电流限幅一直被默认为很小的值或者控制帧发送周期太慢电机因为“丢帧保护”降低了输出能力。解决上电后先把 6020 的电流限幅参数调到接近峰值再初始化 PID 输出限幅CAN 发送周期固定到 1kHz不要用主循环里不带节流的方式发。验证方法很简单电机堵转时看一眼反馈里的电流值如果电流一直顶不到限幅说明限幅配置没生效。5.3 上电瞬间云台直接朝一边打满撞到机械限位现象刚通电时俯仰或偏航轴线自己猛地转到最大角度咔一声撞停。原因IMU 上电后需要一小段时间才能输出稳定的欧拉角这段时间里角度环的误差是“目标 0 度减原始乱数”误差巨大PID 输出瞬间饱和电机就往一个方向死推。另一个常见原因是电机反馈零点没校准目标角度和实际角度差了 180 度。解决初始化流程里增加“IMU 数据有效”的等待未就绪前禁止发送任何控制指令只持续发零力矩让电机制动角度环目标值在第一个有效角度读数到来后再启用。软件软启动也是必要的PID 输出从 0 开始用 200ms 左右的斜坡慢慢加到目标哪怕姿态解算有偏差也不会猛撞限位。5.4 俯仰一动偏航跟着抖现象拨动俯仰摇杆或给俯仰轴一个阶跃信号时偏航轴也会出现明显的同步抖动幅度不大但频率很高。原因云台的重心没落在偏航转轴上。俯仰电机用力时会给偏航轴带来一个反向力矩扰动如果偏航角度环刚度不够这个扰动就会变成可见的抖动。这种情况调偏航 PID 参数永远调不好因为问题根本在机械配平。解决把云台断电手动转动俯仰轴如果云台会自然滑向某个角度说明重心偏了。先在俯仰轴对面加配重让云台在任何角度都能停住再回来调偏航 PID。部分云台允许软件补偿把俯仰电机的实际力矩乘一个耦合系数前馈到偏航速度环目标上这个技巧对已经无法加配重的狭窄结构很有效。5.5 遥控器一关云台朝一个方向转死现象关掉遥控器电源之后云台没有停在原地而是突然全速转向某个方向甚至撞限位。原因DR16 失联后接收机输出的 SBUS 帧会持续保持最后一次的有效通道值同时把第 23 字节的失联标志位和 fail-safe 标志位置位。如果程序只解析通道值不检查这两个标志位就会把“保持最后一刻”的摇杆值当成真实指令于是云台追着一个固定的目标角度跑到限位。解决在 SBUS 解析时额外检测失控标志位一旦发现失联立刻让角度环目标锁定在当前角度同时把电机输出降到安全范围而不是继续追目标。下面这段逻辑可以放在角度环更新之前// sbus_buf[23] 的 bit2 为 fail-safebit3 为 lost frame bool sbus_link_lost (sbus_buf[23] 0x0C) ! 0; if (sbus_link_lost) { yaw_target current_yaw_angle; // 锁在当前角度 pitch_target current_pitch_angle; } else { yaw_target rc_to_angle(rc_ch[0]); pitch_target rc_to_angle(rc_ch[1]); }失联时锁角度是一个保守策略云台不会自己动也不会失去姿态。如果要求更高级的失效保护可以让云台主动回中位但回中速度要放慢避免失联瞬间出现一次猛转。这个坑在答辩演示时最容易暴露因为演示现场通常有关遥控器的环节。6. 验证你的云台用波形确认闭环性能的一个实测套路调完 PID 不等于云台就做好了还得用数据证明它真的稳。我的验证套路分三步第一步通过串口把角度环目标、实际角度、速度环输出三路数据以 500Hz 打印出来用串口绘图工具或者 Python 脚本画成波形。先看静态云台静止时目标角度和实际角度的误差是否稳定在 ±0.5 度以内波形有没有高频毛刺。如果毛刺接近陀螺仪噪声水平说明微分项可能放大了传感器噪声需要降低速度环的 D 或者加一阶低通滤波。第二步做阶跃响应。遥控器快速推杆让角度目标从 0 度跳到 20 度看实际角度的跟踪曲线。一个基本合格的云台应该在 200ms 到 400ms 内跟上目标超调量小于 10%并且没有来回震荡。如果曲线一直在目标值附近振荡把角度环 P 减半如果跟踪太慢说明角度环 P 不够或者内环速度环限幅太小。第三步做抗扰测试。云台锁定在一个角度用手轻推一下相机然后立刻松开观察波形回到目标值的时间。回到目标的时间越短越好但不能以振荡为代价。还有个很多人不做的实验用风扇对着云台吹人为制造持续的随机扰动看相机画面是否还能保持稳定。这一项最能体现云台控制系统的实际价值。我自己的教训是调参顺序一定不能乱先检查机械重心再验证 IMU 零点最后才动 PID。很多自以为“PID 参数有问题”的云台最后都是配重或零点先出了问题白白浪费一整天和一堆“玄学参数”。建议你在项目报告里也按这个顺序记录调试过程而不是按代码文件的顺序写这样指导老师更容易看明白你的工程思路。希望帮到你。本文还有配套的精品资源点击获取