去年秋天接手一个多轴协同运动项目,设备在低速点动时一切正常,一旦联动插补速度提上去,末端执行器的轨迹就会出现肉眼可见的波纹。示波器抓位置指令和反馈,发现指令本身是平滑的,反馈却每隔几毫秒规律性地顿一下。起初怀疑机械传动间隙,换了联轴器、重新打表、调整预紧,折腾了一周毫无改善。后来把控制器的任务调度日志打开,才看见一个几乎被所有人忽略的现象:速度环的采样时刻,在外环位置环每次执行完之后,会莫名其妙地漂移几十微秒,而且这个漂移量随速度指令大小变化。那一刻我才意识到,问题不在机械,也不在算法,而在几个控制环各自为政的采样节拍上。

这个坑值得展开讲透,因为它不像参数整定那样有现成口诀,也不像滤波器设计那样有公式可套。采样周期不一致带来的时序抖动,往往藏在“看起来都能跑”的系统里,平时不发作,一到高动态工况就现形。

先看一个典型的现场现象

虚构一个通用项目:一套三环控制的伺服驱动,电流环跑在底层中断里,速度环跑在定时任务里,位置环跑在更上层的通信周期任务里。三个环各自有独立的周期配置,电流环周期最短,速度环是其整数倍,位置环又是速度环的整数倍。从纸面参数看,倍数关系严丝合缝,理论上不会出现采样冲突。

但实际运行中,位置环任务的触发时刻并不完全由硬件定时器决定。它可能由通信接收中断触发,也可能由操作系统调度器唤醒。每次位置环执行时,它会读取当前位置、计算速度指令,然后把这个指令写入速度环的输入缓冲区。速度环下一次执行时,读取这个缓冲区,再计算电流指令。问题就出在这个“写入”和“读取”之间的时间关系上。

如果位置环写入时刻,恰好落在速度环采样时刻的临界点附近,速度环这次读到的可能是新指令,也可能是上一次的旧指令。更隐蔽的是,即使读到了新指令,由于两次写入之间的间隔本身有抖动,速度环实际使用的指令更新周期并不是恒定的位置环周期,而是在一个范围内波动。这个波动传递到电流环,再传递到电机转矩,最终表现为末端执行器的周期性顿挫。

为什么倍数关系救不了你

很多人以为,只要外环周期是内环周期的整数倍,时序就是确定的。这个认知只在理想情况下成立。实际系统中,有几个因素会破坏这个整数关系:

第一,任务触发源的差异。位置环可能由通信周期触发,速度环由硬件定时器触发,两者虽然频率成倍数,但相位关系不受控。每次通信周期到来时,速度环定时器可能已经跑了半个周期,也可能还差几个微秒才到下一个周期点。

第二,任务执行时间的波动。位置环内部要做坐标变换、加减速规划、甚至查表补偿,这些操作的执行时间随输入数据不同而变化。如果位置环执行时间偶尔超过预期,它写入速度环缓冲区的时刻就会后移,导致速度环这次采样到的指令“迟到”。

第三,中断嵌套和优先级抢占。电流环中断优先级最高,它随时可能打断速度环或位置环的执行。如果速度环正在读取指令缓冲区时被电流环中断打断,而中断服务程序又恰好修改了相关数据,就会读到不一致的数据。

第四,操作系统调度抖动。如果控制任务跑在实时操作系统上,任务唤醒到实际执行之间的延迟本身就有抖动,这个抖动通常在几微秒到几十微秒量级,足以让采样时刻偏离理论值。

这些因素单独看都不大,但叠加起来,就会让原本设计的整数倍采样关系在实际运行时退化成“平均意义上成倍数,瞬时关系随机”的状态。

现场怎么观察和判断

不要一上来就改代码。先做三件事,把现象坐实。

第一,用控制器内部的调试变量记录每个环的实际采样时刻。具体做法是:在每个环的任务入口处,读取一个高精度自由运行计数器的值,存入一个环形缓冲区。跑一段时间后,把缓冲区数据导出,计算相邻两次采样的间隔。如果位置环的采样间隔标准差明显大于零,而速度环的采样间隔标准差很小,说明抖动来自外环。

第二,同时记录速度环读取到的指令值和位置环写入的指令值。对比同一时刻的写入值和读取值,如果发现读取值有时是上一次的旧值,有时是本次的新值,且新旧交替的规律与速度指令大小相关,基本可以确认是采样相位漂移导致的指令更新抖动。

第三,观察抖动与速度指令的关联。如果设备在低速时抖动不明显,高速时抖动加剧,一个可能的原因是:高速时位置环计算量增大,执行时间变长,写入时刻后移更明显。另一个可能的原因是:高速时速度环的指令变化率更大,同样的采样时刻偏差,造成的指令误差更大。

这三个观察做完,你手里就有了一条完整的证据链:外环采样时刻抖动 → 内环读取到指令更新周期不稳定 → 转矩输出波动 → 机械末端抖动。

几种工程取舍方案

确认问题之后,怎么改,取决于你的系统约束和性能目标。下面几种方案,从简单到复杂排列,各有各的代价。

方案一:把外环写入和内环读取做成原子操作。具体说,就是让位置环在写入指令时,先关掉速度环的采样中断,写入完成后再打开。这个方案能消除“读到一半被改写”的问题,但消除不了相位漂移。如果抖动主要来自读写冲突,这个方案成本最低,改几行代码就能验证。

方案二:让内环采样时刻对齐外环写入时刻。做法是:外环写入完成后,立即触发一次内环采样,而不是等内环自己的定时器到点。这样内环的采样周期就完全跟随外环的写入周期,两者之间的相位差固定为零。代价是内环的采样周期会随外环执行时间波动,如果外环执行时间本身抖动大,内环的采样周期也会抖动。适用于外环执行时间稳定、内环对周期波动不敏感的场景。

方案三:在外环写入和内环读取之间加一级缓冲,用双缓冲或环形队列解耦。外环写入时操作一个缓冲区,内环读取时操作另一个缓冲区,通过指针切换来交换。这样外环的写入时刻抖动不会直接影响内环的读取时刻,内环始终按自己的节拍读取最新的完整数据。代价是引入一个采样周期的延迟,且需要仔细处理指针切换的原子性。

方案四:统一时基,把所有环的采样时刻都对齐到同一个硬件定时器。具体做法是:用一个硬件定时器产生最高优先级的时基中断,在这个中断里依次触发电流环、速度环、位置环的执行,或者至少让它们都基于同一个计数器来计算采样时刻。这个方案能从根源上消除相位漂移,但要求所有环的执行时间之和不超过时基周期,且对中断嵌套的管理要求很高。

方案五:如果外环是通信周期触发的,考虑让通信周期与内环定时器同源。比如让通信控制器使用同一个硬件定时器作为时基,这样通信周期的到来时刻与内环定时器有固定相位关系。很多通信外设支持这种同步模式,但需要在初始化时正确配置。

一个容易忽略的隐形陷阱

上面说的都是采样时刻的问题,但还有一个更隐蔽的陷阱:即使采样时刻完全对齐,如果内环读取指令后不是立即使用,而是经过了几次内部计算才输出,那么从“指令被读取”到“指令生效”之间的延迟也会抖动。这个延迟抖动同样会传递到转矩输出。

排查这个陷阱的方法是:在内环读取指令的地方打一个标记,在内环输出PWM更新的地方再打一个标记,测量两个标记之间的时间差。如果这个时间差本身波动较大,说明内环内部的处理流程存在不确定性,需要进一步定位是哪个环节引入了抖动。

常见的原因包括:内环内部有查表操作,表项访问时间不一致;内环内部有浮点运算,不同数据值的运算时间有差异;内环内部有分支判断,不同分支的执行路径长度不同。这些在低速时都不明显,高速时就会被放大。

调试时的一个实用技巧

如果你不确定抖动是来自采样时刻还是来自其他环节,可以做一个简单的注入实验:在位置环写入指令的地方,人为加入一个已知幅度和频率的微小扰动,然后观察末端执行器的响应。如果响应中出现了与注入扰动同频的抖动,说明从位置环到执行器的通道是通的,问题在通道内部。如果响应中没有出现同频抖动,说明通道对高频扰动有衰减,问题可能不在采样时刻,而在更前端的指令生成环节。

这个技巧的好处是,它不需要你拆开系统逐级测量,只需要在软件里加几行代码,就能快速缩小排查范围。

最后说一个判断原则

多环控制中的时序问题,有一个基本的判断原则:如果抖动频率与某个环的采样频率成整数倍关系,优先怀疑那个环的采样时刻有问题。如果抖动频率与多个环的采样频率都有关系,优先怀疑环间数据传递的时序有问题。如果抖动频率与速度指令大小相关,优先怀疑执行时间波动导致的采样相位漂移。

这个原则不能帮你直接定位到具体代码行,但能帮你快速排除大部分无关方向。剩下的,就是打开调试变量、抓数据、对比、验证,一步一步把抖动源逼出来。

关键词

核心关键词:采样、抖动、电流环、定时器、速度环、位置环、相位、补偿、精度、滤波

精准长尾关键词:先看一个典型的现场现象、现场怎么观察和判断、调试时的一个实用技巧、最后说一个判断原则、FOC控制算法详解、无刷电机调试、电流环调参、电机控制实战、SVPWM实现、电机参数辨识、FOC电流采样、无刷电机控制教程

Logo

openEuler 是由开放原子开源基金会孵化的全场景开源操作系统项目,面向数字基础设施四大核心场景(服务器、云计算、边缘计算、嵌入式),全面支持 ARM、x86、RISC-V、loongArch、PowerPC、SW-64 等多样性计算架构

更多推荐