★ FEATURED ARTICLE 干运动控制这行很少人能绕开“运动模式”这道坎。我最早接触运动控制卡是从那款国产运动控制卡开始的当时手边只有一份转载来的学习笔记上面把运动模式分成点位运动、插补运动、电子齿轮、电子凸轮几类我一边看手册一边在设备上调才慢慢把这些模式串起来。这篇就按我自己的理解重新整理一遍把原笔记里比较笼统的地方补足也把实际调试时的参数和注意事项一起放进来适合刚开始接触运动控制卡的工程师、调试人员和搞自动化设备的同学参考。很多刚入门的朋友上来就问点位、直线、圆弧怎么发结果看手册越看越迷糊。原因其实不难理解运动模式不是一个个孤立的指令而是控制卡内部运动规划算法对外表现出的套路。在讲点位、插补这些名词之前先想清楚控制卡在整套系统里到底干了什么后面学起来会顺畅很多。1. 运动控制卡到底在控制什么1.1 一张卡把“算法”和“执行”分开一套典型的运动控制系统从上到下大致是工控机或者PC作为上位机负责界面、工艺逻辑、数据处理运动控制卡插在主机里通过PCI或PCIe总线接收上位机指令控制卡输出脉冲或模拟量给驱动器驱动器放大信号驱动电机电机带动丝杠、同步带或者齿轮箱最终推动工作台编码器把电机或负载的位置反馈给控制卡形成一个闭环。控制卡最核心的价值不是“发脉冲”而是把运动规划这件事从上位机里拆出来放到一片带实时处理能力的硬件上做。CPU里的操作系统调度有随机延迟你不可能用通用系统精确保证每1毫秒发一次脉冲但控制卡上的目标规划器和插补器可以。点位运动、直线插补、圆弧插补、电子齿轮、电子凸轮这些运动模式本质上都是控制卡固化的运动规划算法收到用户的目标位置和速度参数后把它拆成一个个控制周期需要的指令值再平滑地下发给驱动器。所以学习运动模式不要只记指令长什么样要理解每一类模式背后解决的是什么问题。1.2 上手前先建立三个概念我建议在跑第一个例子之前先花半小时把三个基础概念弄清楚否则后面大概率要反复返工。第一个是“轴”和“坐标系”。控制卡通常把每个电机输出通道定义为一个轴轴可以映射到笛卡尔坐标系的X、Y、Z方向也可以单独使用。多轴插补时几个轴组合在一起形成虚拟坐标系比如XY平面、XZ平面圆弧插补还要指定旋转方向。这个映射关系写错动作就会完全对不上。第二个是“脉冲当量”也就是一个脉冲对应负载移动多少距离。这个值直接决定速度、位置的单位换算。举个例子一台步进电机带动丝杠丝杠导程5毫米驱动器细分后电机转一圈需要2000个脉冲那么每个脉冲对应的位移是5除以2000等于0.0025毫米。如果工艺要求运动速度100毫米每秒换算下来就是100除以0.0025等于40000个脉冲每秒也就是40kHz的脉冲频率。加速度同样要换算1000毫米每二次方秒对应40万脉冲每二次方秒。很多卡配置界面支持直接填毫米和毫米每秒但底层仍然是按脉冲来算的设定单位比和电子齿轮比时一定要把这个换算关系核对一遍。第三个是“控制周期”。控制卡不是一次性把整段运动指令全灌给驱动器而是每个固定时间间隔计算一次目标位置、速度和电流指令常见周期在125微秒到1毫秒之间。插补模式下卡还会按更细的插补周期去切分轨迹。控制周期决定了系统的响应上限也决定了缓冲区的容量规划后面讲连续插补时会再提到。2. 运动模式全景先分清单轴和多轴运动模式看着很多但按照参与运动的轴数和轴之间的关系其实是清晰可分的。2.1 单轴点位运动模式点位运动是最基础的模式目标就是让某一个轴从当前位置走到指定的目标位置过程只关心起点、终点和速度不关心中间轨迹。典型应用是点胶机的点胶头、贴片机的吸嘴、料盘定位这类动作对路径形状没有要求只要快速准确地到位。点位运动里有两个重要分支绝对运动和相对运动。绝对运动的终点坐标以机械原点为参照比如“移动到第50毫米处”相对运动的终点以当前点为参照比如“从当前位置再前进10毫米”。刚上手时最容易犯的错误就是把两种模式混着用设备一换料或者中途手动移动过绝对坐标就再也不准了。我的习惯是如果单机设备每次都从原点启动优先用绝对运动如果在一条流水线上反复执行同样的一段增量动作用相对运动更省事。点位运动的“怎么走”由速度规划曲线决定。最简单的梯形加减速先匀加速、再匀速、最后匀减速三段速度曲线拼起来像一个梯形。参数只要给最大速度、加速度和减速度。梯形曲线实现简单但加速和减速切换时加速度有突变机械上会感觉到“顿”一下。S形加减速在加速和减速阶段继续对加速度做斜率限制加加速度被约束运动过程更平滑适合高速高精度场合。不少控制卡还会提供“急停”指令急停不是普通的减速停止而是忽略速度规划直接快速刹停这个指令的减速度和停止后的处理逻辑需要单独设置。2.2 多轴联动插补模式多轴联动和“多轴同时动”不是一回事。点位模式下我也可以让两个轴同时启动但它们的终点和速度是各自按自己参数走的没有轨迹约束关系。插补模式则要求控制卡在运动过程中不断计算各轴指令让最终合成的轨迹是一条数学上连续的直线、圆弧或者更复杂的曲线。直线插补最简单一块XY平台从A点移动到B点总位移是LX方向分量是dxY方向分量是dy。如果合成速度是V那么X轴的速度分量就是V乘以dx除以LY轴的速度分量是V乘以dy除以L。两个轴按这个比例同时进给实际走出来的就是一条斜线。只要这个比例保持住电机步调就一致轨迹就不会歪。圆弧插补比直线稍复杂核心是指定圆心、半径和旋转方向。常见的方式有两种一种是给定圆弧终点和圆心坐标另一种是给定终点和半径。圆弧一定要分清顺时针还是逆时针方向反了会跑到另一个半圆上去。连续多段圆弧拼接时段与段的切点处如果速度规划处理不好会产生停顿或过切所以现在稍微上点档次的卡都支持连续插补和前瞻功能。连续插补的价值在于“段间不减速”。普通分段运动是一段走完停下来再开始下一段效率低而且起停冲击大。连续插补允许用户把几十条线段、圆弧一次性写入控制卡的插补缓冲区卡内部自动处理段间速度衔接。前瞻功能会提前预读后续几段轨迹判断拐角大小把拐角比较大的地方提前减速能平滑通过的小拐角则保持速度。这样雕出来的图案更光滑切割效率也更高。2.3 同步运动模式第三大类是同步运动模式常用于两个或多个轴必须保持严格运动关系的场合。电子齿轮本质上是一个比例跟随器从轴的位置和主轴位置保持固定比例。主轴可以是一个实轴也可以是从外部编码器输入的内容甚至可以是虚拟轴。比如送料辊和切刀之间要求严格N比M同步就把送料轴设为主轴切刀轴设为从轴电子齿轮比设为某个比例。主轴正向转从轴立刻跟着正向转主轴反向从轴也反向。比例可以是2比1、5比3这类整数也可以是小数。电子凸轮跟电子齿轮的区别在于它不是简单的固定比例而是一个非线性映射关系从轴位置按一张凸轮表随主轴位置变化。传统机械凸轮是通过凸轮轮廓把主轴的旋转转化为从轴的往复或特定曲线运动改工艺就要换凸轮电子凸轮把轮廓曲线数字化到一张表里改表就能改动作。模切机、印刷机、飞剪机里大量用到这类模式。主轴转过某个角度时从轴应该移动到什么位置都由凸轮表里的数据点决定数据点之间由控制卡自动做线性插值。3. 每种模式怎么配置和调用这里我按常见控制卡的类C接口风格写示意代码各家厂商的函数名和参数顺序不一样但思路是通用的。重点放在参数背后怎么理解而不是背某个API。3.1 点位运动的参数明细点位运动需要关注的参数主要有目标位置、运行速度、加速度、减速度和平滑时间。我把这些参数和常见注意事项整理在下表参数含义常见问题目标位置绝对或相对终点绝对/相对模式搞混运行速度最大进给速度单位是脉冲/秒还是毫米/秒加速度速度上升的快慢单位是脉冲/秒²还是时间ms减速度停止时的速度下降快慢减速度过小会冲过头平滑时间S形曲线的过渡时间设太大会延长运动时间很多控制卡的加速度参数不是直接填加速度值而是填“加速时间”意思是速度从0加到最大速度需要多少毫秒。假设最高速度是60000脉冲每秒加速时间设为200毫秒那实际加速度就是60000除以0.2秒等于300000脉冲每秒的平方。两个参数表达方式不同但换算起来很简单关键是不要对着参数名瞎猜。一个典型的点位运动过程是初始化板卡复位所有轴把轴配置成脉冲加方向输出方式设置每单位距离对应的脉冲数然后设置速度曲线最后调用绝对定位指令。下面的代码片段演示了这个过程// 伪代码接口以实际厂商手册为准 int handle board_open(0); board_reset(handle); // 第0轴配置成脉冲方向模式编码器反馈 set_pulse_mode(handle, 0, PULSE_DIR); set_feedback_mode(handle, 0, ENCODER_AB); // 每毫米2000脉冲目标单位用毫米 set_pulse_per_unit(handle, 0, 2000.0); // 梯形加减速加速时间100ms减速时间100ms set_profile(handle, 0, TRAPEZ, 100, 100); // 绝对定位移动到50mm处速度100mm/s move_abs(handle, 0, 50.0, 100.0); // 等待运动完成 wait_done(handle, 0, 3000); board_close(handle);有人会问为什么不是发完move只读就立刻干别的事因为点位运动是异步的move指令只是把目标位置和速度写进控制卡的规划器真正运动要持续几百毫秒甚至更久。程序里可以在一个带超时的等待函数上等运动完成也可以注册运动完成中断来回调刷新界面。不要自己空转死等容易占用CPU。3.2 插补运动要理解“缓冲区”插补运动的调用方式和点位运动差别很大。点位运动是一条一条发指令插补运动则往往要先建立一个缓冲区把多条线段写进去再统一启动。这么做是为了让控制卡的插补器在高速执行时总能从缓冲区里取到下一段轨迹不至于因为上位机偶尔调度慢造成轨迹中断。直线插补的通用流程大致是这样先建立插补列表设置好起点或采用当前坐标作为起点然后逐条添加线段、圆弧段最后结束列表并启动运动。示意代码如下// 建立插补列表从当前点开始 start_line_list(handle, PLANE_XY, 0); // 添加线段到(20, 0)进给速度200mm/s add_line(handle, 20.0, 0.0, 200.0); // 添加圆弧圆心(10,0)逆时针半圆回到(0,0) add_arc(handle, 10.0, 0.0, -1, 200.0); // 再加一条线段回到(0,20) add_line(handle, 0.0, 20.0, 200.0); // 结束列表并启动连续插补 end_list(handle); start_list(handle);连续插补时段与段之间的速度衔接不完全由你给的每段速度决定而是由前瞻算法决定。如果你的每段速度差异过大或者拐角小于卡认为的安全角度实际速度会低于设定值这时候不要急着怀疑算法有问题先检查一下是不是给的前瞻缓冲区太小或者段长度太短根本不够加速到设定速度。插补缓冲区是共享的一边往里写一边被执行如果写入太快、缓冲区写满函数可能会阻塞等待也可能返回一个缓冲区已满的错误。在线加工时比较规范的做法是轮询缓冲区空余容量空闲空间超过一定阈值再继续往里面写入下一批轨迹避免一次性把所有G代码都灌进去导致缓冲区溢出或者卡死。3.3 电子齿轮和电子凸轮怎么设电子齿轮模式的配置步骤比插补更简洁。核心是选择主轴、从轴和比例。主轴通常可以是控制卡上的某个编码器输入口也可以是一个虚拟主轴或实轴。方向要特别留意很多电子齿轮问题不是比例算错了而是主从方向反了结果从轴一直往一个方向飞出直到撞上硬限位才停。安全起见启用电子齿轮前先让主轴低速空跑观察从轴的方向和比例是否符合预期。示意代码如下// 从轴1跟随主轴0比例为2:1 set_gear(handle, slave1, master0, ratio_n2, ratio_m1); enable_gear(handle, 1); // 需要时可以随时取消 disable_gear(handle, 1);电子凸轮配置比电子齿轮多一张凸轮表。凸轮表本质上是一个二维数组每行包含两个值主轴相位和从轴位置。主轴相位可以是编码器位置或者角度从轴位置是这一相位点对应的输出位置。表里数据点之间的密度决定精度点太稀从轴动作会像折线不平滑点太密占用内存多而且写表时间也长一般取足以覆盖动作特征的均匀间隔就行。示意代码如下// 定义凸轮表10个点主轴范围0~36000脉冲 float cam_table[10][2] { {0, 0}, {4000, 100}, {8000, 300}, // ... 其他点 {36000, 0} }; // 从轴1跟随主轴0加载凸轮表并启用 set_cam_master(handle, slave1, master0); load_cam_table(handle, 1, cam_table, 10); enable_cam(handle, 1);启用电子凸轮前一定要先把主轴和从轴的当前相位关系对好。如果主从轴已经处在某个偏离凸轮表起点的位置直接使能凸轮从轴可能会瞬间跳到凸轮表对应相位的位置产生一次非常危险的冲击。很多卡支持“从当前位置开始执行”或“先同步再启动”的选项先用起来别偷懒。4. 踩过的坑和排查方法这部分是我自己整理出来的高频问题。每个做运动控制的人早晚都会遇到提前知道排查思路能省大量时间。4.1 电机抖动或者啸叫电机抖动不一定来自运动控制卡很多情况是驱动器增益太高或者机械共振但运动模式参数设置不合理时也会触发。梯形加减速中加速度设置过大起步瞬间相当于给电机一个阶跃速度指令机械间隙和惯量冲击会把抖动放大。S形平滑时间设得太短也一样会产生冲击。排查思路先把速度降到很低比如最大速度的10%看看还抖不抖。如果低速不抖高速抖优先查加减速参数和机械共振频率如果低速也抖重点查驱动器增益、编码器极性、脉冲波形质量。运动控制卡里的“滤波参数”是另一个容易忽略的点控制周期越短系统对噪声越敏感适当放宽滤波或者增加平滑时间会有效果。4.2 跟随误差大或者直接飞车跟随误差大的典型表现是上位机已经下发了目标位置伺服驱动器却始终跟不上或者报“跟随误差超限”报警。最常见的原因是电子齿轮比和机械传动比不匹配。我调试一台送料设备时从轴速度和主轴视觉上差了一大截检查后才发现驱动器的电子齿轮比和控制卡里的电子齿轮比重复设置了两层比例被乘了一道。飞车是另一种危险情况从轴不受控地往一个方向猛跑。原因通常是编码器方向跟电机方向相反导致负反馈变成了正反馈或者电子齿轮方向配置错误。排查时按顺序做断开放到执行机构的负载让电机空转屏蔽运动指令用手转主轴看从轴反馈是否同步变化再对比编码器实际计数和指令脉冲数。跑之前一定把软限位和硬限位都打开飞车不能靠手去挡。4.3 轨迹过切、圆弧不圆连续插补最典型的问题是过切或者拐角处“圆过头”。原因往往是前瞻功能没开或者前瞻的加速度限制设得太大速度降不下来。把运动轨迹导入控制卡自带的跟踪显示工具里看速度曲线如果拐角处速度没降就是前瞻没生效。圆弧不圆要先看两点一是圆心坐标和方向用半径模式画超过180度的圆弧时因为同一个半径可能对应两个方向的圆弧不指定圆心的话容易画反二是圆弧终点的公差设置有的控制卡允许用户设置弦高误差或终点允许误差误差给得太松圆会严重变形。另外如果圆弧插补用的控制周期和插补周期不一样注意看圆弧指令是否按插补周期切分不然输出会一抖一抖。4.4 回零和限位不好使回零看起来简单实际坑最多。很多设备开机第一步就是回原点原点找不准后面全白搭。常见回零方式是寻找原点开关的边沿再停在编码器索引脉冲上。如果设备初始位置已经在原点开关上高速找零时反方向寻找会找不到信号。控制卡一般都有“起始点已在原点信号上时先离开再重新找零”的模式需要确认启用。限位逻辑也值得单独说。正负硬件限位是接到控制卡的IO输入上的极性可能是常开也可能是常闭。接线时把常闭串联一旦断线就会被识别为触发限位反而安全。软件限位要配合坐标系使用点位运动前先检查目标位置是否越界插补模式中如果线段终点越界不同卡的处理方式不一样有的会报警有的只是忽略搞不清时先手动验证。5. 学习路线和扩展方向5.1 建议按这个顺序练不要一上来就搞电子凸轮那样很容易被概念绕晕。我给新人建议的练习顺序是先让电机转起来学会使能和停止然后写点位运动分别试绝对和相对定位接着加简单IO联动比如到位后启动气缸再做XY平台的直线和圆弧插补然后开连续插补画一个正方形加圆角最后再碰电子齿轮和电子凸轮。每一步都做出现象再往下走。点位运动没搞懂插补时的速度和单位换算会算错插补没搞懂电子齿轮的同步概念也不容易吃透。运动控制这东西看十遍不如跑一遍“能动”和“懂了”之间差着好几个调试现场。5.2 三个可以自己做的小实验第一个实验在XY平台上画一个边长50毫米的正方形。手动计算每个顶点坐标用直线插补画完四条边再把四个直角改成R5的圆弧观察连续插补的轨迹差异。这个实验能一次性练到直线、圆弧、连续插补和速度衔接。第二个实验用一个手摇编码器作为主轴接控制卡的外部编码器输入另一个电机作为从轴设置电子齿轮比为1比1然后摇动主轴观察从轴是否跟手同步。再改成2比1熟悉比例对速度和位置的影响。第三个实验用电子凸轮模拟一个飞剪动作。设主轴每转一圈从轴完成一次“前进到某个位置、等待、退回原点”的运动。把凸轮表的点画出来观察加减速是否平滑。通过这个实验你会真正理解为什么电子凸轮能替代机械凸轮。5.3 后续可以往哪些方向走运动模式本身的框架是固定的但组合起来可以做出很多复杂系统。点位加视觉可以做对位贴合插补加G代码解析可以做桌面CNC电子齿轮加双驱可以做成龙门同步两个电机同步驱动一根梁防止“扭”电子凸轮加张力控制可以做成印刷机的套准系统。再往后就是运动规划层面比如B样条轨迹、速度前瞻的算法参数调优、振动抑制、轨迹误差补偿。这时你会发现运动控制卡的API只是入口真正深入下去是机械、电机、驱动器、工艺算法交叉的领域。我个人学这一套下来的体会是别贪多先把点位和插补吃透再摸同步模式。有一回我在调电子凸轮时主轴信号没接对从轴直接全速冲出去幸好硬限位挡得快从那以后凡是切同步模式我都会先让主轴低速空转一圈确认相位和方向没问题才敢上速度。这个习惯现在一直保留着也希望这篇整理能帮你绕开我踩过的这些坑。
阅读完成 · 觉得有帮助？
