一种运动控制系统及其位置控制方法 技术领域 本发明属先进控制领域, 具体涉及高速高精度加工的基础技术之一的运动控制系 统。基于数据流关联控制, 本发明为开放式数控系统提出一种高性能运动控制系统及其位 置控制方法。
技术背景
开放式数控系统、 高性能运动控制系统、 高精度传感器是高速高精度加工的基础 技术。
在机床的数字控制中, 运动控制系统主要用于控制伺服电机的转速与转角。所谓 转速控制又称速度模式, 也就是速度控制, 用于控制主轴的转速 ; 所谓转角控制又称位置模 式, 也就是位置控制, 用于控制坐标轴的位移。
由位置环、 速度环、 电流环构成的 PID 控制器是运动控制系统的基本技术方案。速 度环中的速度增益和速度积分时间常数、 位置环中的比例系数增益是需要调整的基本参 数。这些参数值, 取决于机械系统中运动副的摩擦力与运动部件的惯量、 进给速度与加速 度、 切削力、 电机的转子惯量与输出惯量等众多外部因素以及运动控制系统内部的时滞。 从 公开的统计资料来看, 数控设备中 75%以上的故障出自运动控制系统, 其主要原因在于, 这 些因素都是非线性的, 在加工过程中必然产生上述参数值的漂移, 从而导致工件的加工精 度超差。
在工程技术中, 运动控制系统又称为伺服驱动装置, 数控系统与运动控制系统之 间的界面则称为运动控制接口。本发明涉及位置模式的运动控制系统, 其接收与执行的 数字控制信息为坐标轴的离散位置信息, 位置反馈信息由运动控制系统内的嵌式入系统处 理。
运动控制系统的基本问题是单轴的高精度随动控制与多轴联动的协调控制。 面对 上述种种非线性因素所产生的非线性复杂性, 根据现代控制理论与基于 IEEE 定义的现有 开放式数控系统, 综述文献 《高性能运动控制在数控系统中的应用综述》 (《信息与控制》 , 2003 年第 3 期, 作者 : 王军平, 王安, 敬忠良, 陈全世 ) 评述了现有运动控制系统在高速高精 度加工方面存在的主要问题与发展方向。
1、 复合控制问题
在非线性多变量系统中的应用申, 复合控制成为当前控制领域的一个研究热点。
所谓复合控制就是在 PID 控制的基础上, 结合其他控制算法构建复合控制器。这 些附加的补偿控制算法通过在线实时调整位置环与速度环的参数, 用于抑制种种非线性扰 动所产生的影响。
系统辨识、 建立误差补偿数学模型与误差补偿方程、 确定误差补偿控制算法与补 偿控制器, 是现有复合控制的基本技术方案。
由于环境因素 ( 系统输入的随机扰动与传感器的测量噪声 ) 的不确定性与模型因 素 ( 数学模型的参数与结构 ) 的不确定性, 对于具有非线性、 强耦合、 不确定性的复杂系统,很难从理论上进行性能设计和分析, 实验数据成为系统辨识的基础, 只有高质量的实验数 据才能获得良好的数学模型, 开发者只能利用历史经验、 简化的理论公式、 实验数据来确定 模型的结构和定义模型的参数, 再经过线性化处理得到简化的误差补偿数学模型与误差补 偿方程, 进而设计误差补偿控制算法, 实时计算轮廓误差完成误差的实时补偿。
因而, “面向实际工业过程的特点研究发展各种对模型要求低、 在线计算简单方 便、 实时性好、 控制效果佳的控制新算法” 成为现有复合控制技术的发展方向。
2、 时滞问题
时滞是工业过程中固有的特性, 是物理系统中的最难控制的动态环节。任何过程 都有时滞, 静态下的时滞称为静态时滞。种种非线性因素所产生的非线性复杂性与不确定 性都使时滞发生变化, 形成动态时滞, 导致坐标轴不同步而产生轮廓误差。 当数控系统应用 高速加工时, 进给速度大大提高, 时滞产生的坐标轴不同步使工件的轮廓误差显著增加。 动 态时滞导致的坐标轴不同步所产生的轮廓误差是影响加工精度的重要因素。
为了解决因动态时滞导致的多轴不同步所产生的轮廓误差, 交叉耦合控制 (Cross Coupling Control, CCC) 成为现有数字控制技术中的关键技术。所谓交叉耦合控制是将伺 服驱动装置的实际位移量两两相互耦合, 通过适当的误差数学模型, 在线计算轮廓误差, 完 成轮廓误差的实时补偿。
对于三轴及三轴以上的多轴系统, 由于交叉耦合控制必然产生组合爆炸, 一般只 能用于 2 轴系统。 因而, 采用零相差跟踪控制原理 (Zero phase error tracking control, ZPETC) 结合前馈控制 (look-ahead), 提高单轴随动控制的精度, 成为解决时滞的技术途径 之一。
发明人认为, 现有运动控制系统存在下述缺陷。
1、 现有运动控制系统的技术方法
上述综述文献认为, “控制策略的实现问题实际上就是开放式体系结构的研究, 这 也是实现高性能、 智能化数控的关键技术” , 控制策略对用户的开放性成为运动控制系统的 研究重点。
现有运动控制系统的基本控制方法是, 将现代控制理论的研究方法, 系统辨识、 建 立数学模型、 推导微分方程等过程形式化, 套换为技术方法。为叙述方便, 将这种方法简称 为理论形式化方法。
对于运动控制系统中的非线性复杂性, 这种方法很难从理论上进行性能设计和分 析, 整个控制结构的确定缺乏理论依据, 多是凭借开发者的经验选定。 系统辨识获得的实验 数据、 数学模型、 微分方程组均依赖具体控制对象及其具体环境, 都必须进行线性化处理。 这种方法所得到的结论只是宏观性质的指导性意见, 导致参数调整特别困难, 缺乏广泛的 实用性, 与工程技术领域的技术方法差异很大。 特别是, 这种方法势必导致运动控制系统成 为所谓的专家型系统, 即只有精通现代控制理论且实际经验丰富的专家才能开发的系统, 用户无法进行二次开发, 从而完全丧失了开放性。
另一方面, 现有开放式数控系统基于 IEEE 关于开放式数控系统的定义, 完全被 IEEE 定义 “计算机化” , 成为需要配置实时操作系统的通用计算机系统, 数控软件系统则只 是其中的一个专用应用系统。 实时操作系统中关于内外资源的管理机制以及关于内外环境 变化的应变机制与插补迭代控制算法的运算规则紧密耦合在一起构成一种普适的数字控制方法即插补迭代控制方法。
囿于 IEEE 定义, 现有运动控制系统遵循插补迭代控制方法的基本原则, 力求寻找 误差补偿数学模型、 建立误差补偿方程、 研发在线计算简单、 实时性好、 控制效果佳的插补 迭代控制算法。这种方法不仅难以充分利用某个变量的未来信息与历史信息, 更难以处理 多个变量的未来信息与历史信息。
2、 运动控制接口
现 有 运 动 控 制 系 统 通 过 现 场 总 线 (Field bus) 与 数 控 系 统 连 接, 国标 “GB/T 18759.2-2006·机械电气设备·开放式数控系统·第 2 部分体系结构” 设置了 5.6 款, 要 求支持各类现场总线 ( 例如 CAN、 Profibus、 Sercos 等 ), 国标 《GB/T 18759.3-2009·机械 电气设备·开放式数控系统·第 3 部分 : 总线接口与通信协议》 进一步对现场总线予以规 范。为此, 现有运动控制系统必须耗费大量实时计算资源处理通信周期掌控下的实时通信 任务。
3、 标准化问题
在基于 IEEE 定义的现有运动控制系统中, 位置环在其采样周期中读取位置指令 时, 必须与数控系统的插补周期严格保持同步。 换言之, 现有运动控制系统只能与同品牌的 数控系统匹配, 不具备互换性。 这样一来, 插补周期与通信周期便成为制约现有运动控制系 统标准化的难以逾越的障碍。
本发明基于数据流关联控制, 从上述方面重新审视运动控制系统及其位置控制方法。 发明内容 本发明基于数据流关联控制, 为开放式数控系统提出一种开放的标准化的运动控 制系统及其位置控制方法。本发明采用联动接口接收联动命令, 在轴联动表文件中配置特 征表与调整表, 从而舍弃现有技术中的理论形式化方法, 将工程技术领域处理非线性多变 量的常规技术手段引入运动控制系统, 提出一种存储信息控制方法。对于负载的确定性变 化所产生的动态时滞与位置误差, 本发明在电流环中设置电流前馈控制, 为控制动态时滞 提供了一种新的技术手段。
本发明的技术方案说明如下。
一种运动控制系统, 其特征在于, 包括 PID 控制器, 文件存储器, 扇区分析模块, 联 动接口, 串行接口 ;
所述 PID 控制器包括位置环、 速度环、 电流环及传感器, 用于控制伺服电机的转 角;
所述文件存储器通过所述串行接口与上位机连接, 用于接收并存储所述上位机 发送的轴联动表文件 ; 所述轴联动表文件包括轴联动表 ; 所述轴联动表用于存储坐标值增 量, 控制坐标轴产生轴位移 ;
所述扇区分析模块用于读取所述轴联动表文件中的数字控制信息 ;
所述联动接口用于接收上位机发送的联动命令 ; 所述联动命令为一个同步脉冲 ;
所述串行接口用于接收上位机发送的所述轴联动表。
进一步地, 所述串行接口包括现场总线、 RS232 与 RS485 接口、 USB 接口、 移动存储
器、 无线接口。
进一步地, 所述轴联动表文件还包括特征表 ; 所述特征表用于标识该坐标轴的逻 辑属性 ; 所述逻辑属性包括进给当量、 数据的字节数。
进一步地, 所述轴联动表文件还包括伺服参数的调整表 ; 所述伺服参数包括位置 环比例系数、 速度环比例系数、 速度环积分常数、 速度前馈系数、 加速度前馈系数、 电流前馈 增量、 电子齿轮传动比等 ; 所述调整表用于标识所述伺服参数的调整方向与调整量
进一步地, 所述伺服参数还包括电流前馈增量 ; 对于电流环的每个采样周期, 所述 电流前馈增量为电流给定值的修正量。
进一步地, 所述运动控制系统, 其特征还在于, 对于每个预期要调控的坐标值增 量, 设置相应的调整表。
进一步地, 所述运动控制系统, 其特征还在于, 所述电流前馈增量按照下述公式估 算:
ΔIi, (i = 1, ..., n, j = 1, ..., m) j = KifΔFi, x/m
式中, ΔIi, j 为电流前馈增量,
ΔFi, x 为坐标轴的进给速度增量, m 为速度环采样周期中包含的电流环采样周期的个数,
n 为轴联动表中坐标值增量的个数,
Kif 为修正系数。
一种运动控制的位置控制方法, 其特征在于, 包括下述步骤 :
步骤 1、 轴联动表接收存储步骤
所述步骤 1 用于所述串行接口从上位机接收所述轴联动表并存储在所述文件存 储器中 ;
步骤 2、 逻辑属性设置步骤
所述步骤 2 用于所述扇区分析模块从所述文件存储器读取特征表, 设置坐标轴的 逻辑属性 ;
所述逻辑属性包括进给当量、 数据的字节数。
步骤 3、 联动命令接收步骤,
所述联动接口从上位机接收所述联动命令 ;
步骤 4、 伺服参数设置步骤,
所述扇区分析模块从所述文件存储器读取调整表, 设置并调整伺服参数 ;
所述伺服参数包括位置环比例系数、 速度环比例系数、 速度环积分常数、 速度前馈 系数、 加速度前馈系数、 电流前馈增量、 电子齿轮传动比 ;
步骤 5、 位置环写入步骤,
所述扇区分析模块从所述轴联动表读取坐标值增量并写入位置环, 驱动坐标轴进 给, 直至所述轴联动表的终点。
进一步地, 所述位置控制方法, 其特征还在于, 对于每个需要调控的坐标值增量, 在电流环的每个采样周期, 根据电流前馈增量 ΔIi, x 修正电流给定值。
本发明与现有技术对比所具有的有益效果是 :
1、 从公开的统计资料来看, 数控系统中 75%以上的故障出自运动控制系统 ( 伺服
驱动装置 )。
在基于 IEEE 定义的现有运动控制系统中, 运动控制系统通过现场总线与数控系 统连接。为此, 现有运动控制系统必须耗费大量实时计算资源处理通信周期掌控下的实时 通信任务。
本发明基于数据流关联控制, 所提出的运动控制系统通过实时联动接口和非实时 串行接口与数控系统连接。所述运动控制系统通过联动接口接收上位机发送的联动命令。 在发送端, 联动接口类似按 Δti(i = 1, ..., n) 的节律不断地单向传输状态字的并行接口 ; 在接收端, 一个运动控制系统分别与联动接口的一个数据位连接, 类似一根中断控制线。
因而, 本发明提出的运动控制系统无须设置通信周期, 实时通信接口极为简单, 节 省了大量实时计算资源, 维护调试方便, 显著提高了运动控制系统的可靠性。
2、 高性能运动控制系统是高速高精度加工的基础技术。 现有运动控制系统采用 64 位高速 DSP 芯片, 具有强大的信息处理能力。然而, 由于电流环中的矢量控制算法以及其它 种种 PID 复合控制算法都是实时算法, 实时计算资源极为稀缺, “在线计算简单方便、 实时性 好” 的控制算法始终是现有技术的发展方向。
在基于 IEEE 定义的现有运动控制系统中, 运动控制系统通过现场总线接收数控 系统发送的数字控制信息。 特别是, 按照插补周期的节律, 坐标轴的离散位置信息在实时插 补迭代过程中生成并在通信周期掌控下的实时通信过程中发送给运动控制系统, 加工刀路 曲线所需要的历史信息湮灭了, 其未来信息则弄巧成拙, 需要高速程序预处理技术来预先 挖掘。 在本发明中, 除联动命令外, 在轴联动表文件中事先配置了运动控制系统所需要 的其它全部数字控制信息, 包括刀路曲线的历史信息、 当前信息与未来信息, 坐标轴的逻辑 属性与运动学 / 动力学特征、 伺服参数的调整策略等。
所述轴联动表文件采用符合 FAT 等标准文件系统的标准文件格式, 可以携带加工 刀路曲线所需要的全部数字控制信息。
与基于 IEEE 定义的现有运动控制系统对比, 本发明通过联动接口与轴联动表文 件两方面显著节省了实时计算资源, 克服了前馈环节的采样周期长、 算法复杂等缺陷, 为研 发新算法创造了有利条件。
3、 时滞是工业过程中固有的特性, 是物理系统中的最难控制的动态环节。
在刀路曲线的加工过程中, 坐标轴的轴向进给力随曲率的变化而变化, 从而导致 坐标轴的负载随曲率的变化而变化, 这是坐标轴的离散运动必然产生的结果。负载的确定 性变化所产生的动态时滞成为 PID 控制器的内生变量。
在基于 IEEE 定义的现有运动控制系统中, 负载的确定性变化与 PID 控制的基本原 理相悖, 既使采用速度、 加速度前馈控制, 也不可能校正速度环的采样周期内经电流环而累 积的动态时滞与位置误差。
本发明在电流环中设置电流前馈增量, 对于电流环的每个采样周期, 调整电流前 馈增量以补偿负载的确定性变化所产生的动态时滞与位置误差, 为控制动态时滞提供了一 种新的技术手段。
4、 在基于 IEEE 定义的现有运动控制系统中, 将现代控制理论的研究方法, 系统辨 识、 建立数学模型、 推导微分方程等过程形式化, 套换为技术方法即理论形式化方法。这种
方法导致现有运动控制系统成为所谓的专家型系统, 即只有精通现代控制理论且实际经验 丰富的专家才能开发的系统, 用户无法进行二次开发, 从而完全丧失了开放性。
本发明将工程技术领域处理非线性多变量的常规技术手段引入运动控制系统, 在 轴联动表文件中配置特征表与调整表, 提出一种存储信息控制方法。所述特征表与调整表 包括刀路曲线的历史信息、 当前信息与未来信息, 坐标轴的逻辑属性与运动学 / 动力学特 征、 伺服参数的调整策略等, 对用户完全开放。因此。本发明所提出的运动控制系统及其位 置控制方法是完全开放的。
5、 标准化
现有运动控制系统基于 IEEE 定义, 位置环在其采样周期中读取位置指令时, 必须 与数控系统的插补周期严格保持同步。换言之, 现有运动控制系统只能与同品牌的数控系 统匹配, 不具备互换性, 难以标准化。
本发明基于数据流关联控制, 其上位机不存在插补周期, 所提出的运动控制系统 可以与任何上位机连接, 是一种通用的运动控制系统, 从根本上解决了运动控制系统的标 准化问题。 附图说明
图 1 为一种运动控制系统的体系结构示意图。 具体实施方式
众所周知, 在机械系统的数字控制过程中, 所谓实时过程就是控制相关坐标轴联 动以合成刀路曲线 (Tool Path)。所谓数字控制就是将刀路曲线离散为坐标轴所需要的离 散位置信息并以一定的时间间隔发送给伺服驱动装置, 控制坐标轴的合成位移。
在一般情况下, 设联动的坐标轴为 X、 y、 Z、 A、 B 等 5 轴, 刀路曲线为 X、 y、 Z、 A、 B等 5 个变量的函数。将 X、 y、 Z、 A、 B 等 5 个伺服驱动装置接收的坐标值增量依时序列为表 1。
表1
表 1 中, 时间 T 被离散分割为 n 个区间 : Δt1, ..., Δtn, X、 y、 Z、 A、 B 等 5 个变量 在 Δti 内的坐标值增量为 ΔXi、 Δyi、 ΔZi、 ΔAi、 ΔBi。
不失一般性, 将 Δti(i = 1, ..., n) 称之为刀路曲线的 T 分割。微线段 ΔLi(ΔXi、 Δyi、 ΔZi、 ΔAi、 ΔBi) 称之为刀路曲线的 L 分割。
在实时控制过程中, X 轴首先进给 ΔX1, 经过 Δt1 后再进给 ΔX2, 直到 ΔXn, y、 Z、 A、 B、 W、 E、 H 等轴也是如此。因而, Δtn 是冗余的故舍去。另外, 为了统一控制步骤, 增加 Δt0。Δt0 与刀路曲线无关, 可适当设定, 例如, 将 Δt0 设定为 Δtn。将下标 0, 1, ..., n-1 调整为 1, ..., n。为叙述的方便起见, 且有别于插补周期, 将 T 分割中的 Δti(i = 1, ..., n) 称之为控制节律。
申请人的在先专利申请 《一 种 计 算 机 辅 助 数 字 控 制 方 法 与 系 统》 ( 申请号 : 201010536800.7) 基于数据流关联控制, 按照数字控制信息的生成、 分配、 发送、 执行的控制 流程配置控制资源, 将计算机数字控制 CNC(Computer Numerical Control) 发展为计算机 辅助数字控制 CANC(Computer Aided Numerical Control), 采用离散几何规划生成刀路曲 线的 L 分割并存储在联动表中, 采用离散运动规划生成刀路曲线的 T 分割并存储在随动表 中; 所述 L 分割用于控制坐标轴联动产生合成位移 ; 所述 T 分割用于控制所述轴位移之间 的时间间隔。
PC 系统的核心任务是, 将压缩在刀路曲线与进给速度中的数字控制信息解压, 制 造刀路曲线的关联数据流, 也就是规划刀路曲线的 L 分割与 T 分割。在数据流关联控制中, L 分割的规划过程与 T 分割的规划过程为非实时过程。
在基于 IEEE 定义的现有开放式数控系统中, T 分割 Δti(i = 1, ..., n) 为实时 操作系统的分时周期, 是等长的, 称之为插补周期。在数据流关联控制中, T 分割 Δti(i = 1, ..., n) 不是等长的。T 分割与 L 分割仅取决于刀路曲线的几何特征与坐标轴的运动学 / 动力学特征, 与实时操作系统的分时周期无关。 按照不同的控制目的, 针对刀路曲线的曲率 变化所产生的时变特性, L 分割与 T 分割可以将刀路曲线的几何特征与坐标轴的运动学 / 动 力学特征充分精细化, 涉及曲线的非欧化误差、 微线段 ΔL1, ..., ΔLn 之间的运动平稳性、加减速控制等, 还在 L 分割中对传动链之间的反向间隙、 螺距误差、 不垂直度与不平行度误 差等确定性误差进行补偿。
随动表中设置状态字, 用于标识该段曲线中联动的坐标轴。 状态字为一个字节, 字 节的位数可以为 32、 16、 8。例如, 8 位状态字可指定 8 个联动的坐标轴。从低位到高位, 状 态字的每位控制一个坐标轴的使能状态及数据通道。例如, 状态字 “11100000” 指定 X、 y、 Z 等 3 轴、 状态字 “00011000” 指定 A、 B 等 2 轴。状态字的位数与个数为用户参数。
显然, 还可以按照联动的坐标轴, 将联动表中的 L 分割 ΔLi(ΔXi、 Δyi、 ΔZi、 ΔAi、 ΔBi) 按 ΔXi、 Δyi、 ΔZi、 ΔAi、 ΔBi 分离为 5 个独立的轴联动表, 例如, 关于 ΔXi(i = 1, ..., n) 的 X 轴联动表, 关于 Δyi(i = 1, ..., n) 的 y 轴联动表, 等等。进而, 如果将 X、 y、 Z、 A、 B 等 5 个坐标轴的轴联动表事先分配给 X、 y、 Z、 A、 B 等运动控制系统, 轴联动表的分配过程 则转化为非实时过程。
数字控制信息分配过程非实时化后, 在刀路曲线的实时控制过程中, 为控制相关 坐标轴进行联动, 只须按照状态字指定的坐标轴向相关运动控制系统发送同步脉冲。为叙 述简单起见, 将状态字控制下的这组同步脉冲称之为联动命令。
这样一来, 所谓刀路曲线的实时控制过程, 就是按照随动表中的控制节律 Δti(i = 1, ..., n), 在状态字的控制下, 向运动控制系统单向发送联动命令 ; 相关运动控制系统 只须跟随联动命令, 将其轴联动表中的坐标值增量逐次写入位置环, 驱动相应坐标轴联动 产生合成位移。
运动控制系统通过串行接口接收数控系统发送的轴联动表。 所述串行接口可以是 任何标准串行接口, 包括现场总线、 RS232 与 RS485 接口、 USB 接口、 移动存储器、 无线接口 等。
运动控制系统通过联动接口接收数控系统发送的联动命令。在发送端, 联动接口 类似按 Δti(i = 1, ..., n) 的节律不断地单向传输状态字的并行接口 ; 在接收端, 一个运动控制系统分别与联动接口的一个数据位连接, 类似一根中断控制线。
文件系统是在磁盘上组织文件的方法。例如, FAT(File Allocation Table) 是一 种广泛使用的标准文件系统。
在本发明中, 轴联动表采用符合 FAT 等标准文件系统的标准文件格式, 可以携带 加工刀路曲线所需要的全部数字控制信息。 每个运动控制系统设置一个文件存储器用于接 收并存储轴联动表文件, 并配置扇区分析模块, 用于完成文件管理的全部功能 : 打开、 新建 或删除文件、 枚举和搜索文件、 支持长文件名等。
综上所述, 本发明为开放式数控系统提出一种运动控制系统, 如图 1, 包括 PID 控 制器, 文件存储器, 扇区分析模块, 联动接口, 串行接口。
PID 控制器中包括位置环、 速度环、 电流环及传感器, 用于控制伺服电机的转角 ;
文件存储器通过串行接口与上位机连接, 用于接收并存储上位机发送的轴联动 表; 轴联动表用于存储坐标轴的 L 分割分量, 控制该坐标轴产生轴位移。
扇区分析模块用于读取轴联动表中的坐标值增量及其他数字控制信息 ;
联动接口用于接收上位机发送的联动命令 ; 所述联动命令为一个同步脉冲。
在基于 IEEE 定义的现有开放式数控系统中, 插补迭代算法要求每个坐标轴必须 具有相同的逻辑属性。一旦坐标坐标轴的逻辑属性不同, 例如, 进给当量 ( 纳米、 微米等 ) 不同、 数据的字节数不同等, 数控系统的功能与结构都要发生相应的变化。 每个轴联动表文件中设置特征表, 用于标识微线段 ΔLi 中坐标轴的逻辑属性 ; 坐 标轴的逻辑属性包括进给当量 ( 纳米、 微米等 )、 数据所占的字节数等。 因此, 在一次加工过 程中, 允许每个联动轴具有不同的进给当量、 不同的数据字节数, 以适应高速高精度加工的 需要。
为了减小动态时滞的影响以提高单轴随动控制的精度, 在基于 IEEE 定义的现有 开放式数控系统中, 一方面在数控系统中采用高速程序预处理技术以获得前馈控制所要求 的前馈信息, 另一方面在运动控制系统中采用带前馈控制的复合控制, 仿照现代控制理论 的研究方法, 通过系统辨识、 在线智能预报模型、 误差补偿方程、 误差控制算法来构建技术 方案。
前馈控制是一种预测控制。在基于 IEEE 定义的现有开放式数控系统中, 前馈信息 的处理和预测相当困难, 需要一个高速缓存以便对多达 2500 ~ 5000 个程序段进行高速预 处理, 以预览刀路曲线上的曲率变化与进给速度变化。高速程序预处理技术遂成为现有数 控技术中的一项关键技术 ( 见国家 “高档数控机床与基础制造装备” 2009 年度科技重大专 项 “课题 18 全数字高档数控装置” )。此外, 现有前馈控制还存在前馈环节的采样周期长、 算法较复杂等缺陷。
在影响动态时滞的诸多非线性因素中, 切削力变化所产生的轴的负载变化是一个 重要因素。
在刀路曲线的加工过程中, 刀路曲线的曲率变化导致进给方向与进给速度的变 化, 例如, 在铣削圆弧时, 由于在铣削过程中刀具进给方向的不断变化, X 轴与 y 轴的进给速 度与轴向进给力必然随之不断变化。 换言之, 在刀路曲线的加工过程中, 坐标轴的负载变化 并不是扰动, 而是坐标轴的离散运动必然产生的确定性变化。
发明人发现, PID 控制原理与负载的确定性变化存在矛盾, 这是产生动态时滞的一
个重要原因。
PID 控制的基本原理是解决外部扰动下的输出稳定性。
在 PID 控制中, 电流环为内环, 其采样周期一般为几十微秒, 速度环的采样周期一 般为数几微秒。在速度环的一个采样周期内, 速度环输出的电流给定值是不变的。一个速 度环的采样周期中大约包含 10 个电流环采样周期。对于电流环而言, 在电流环的一个采样 周期内, 当负载增大导致相电流增大时, 电流环的电流负反馈则迫使相电流在电流环的下 一个采样周期内维持不变。负载增大是坐标轴的离散运动产生的确定性变化, 能量守恒要 求伺服电机增加能量的输出。 然而, 相电流不变则能量不可能增加, 能量不足必然导致轴的 位移减小, 即做功的时间变长, 从而产生时滞与位置误差。 反之, 负载减小时, 能量守恒迫使 伺服电机的输出能量必然减少, 相电流不变则能量不可能减少, 多余的能量必然导致轴的 位移增加, 做功的时间变短。
现有运动控制系统通常采用前馈控制, 在速度环的输出中加入加速度前馈, 通过 调节加速度前馈系数来调节进给速度。 这就意味着, 在速度环的一个采样周期内, 10 来个电 流环的采样周期中所产生的时滞与位置误差无法调控而逐步累积。 调控只能事后由下一个 速度环完成。 换言之, 在速度环的一个采样周期内, 速度环对负载的确定性变化丧失了调控 能力。因而, 负载的确定性变化所产生的动态时滞是现有运动控制系统内生的。 这里, 在电流环中设置电流前馈控制。 对于电流环的每个采样周期, 调整电流前馈 增量以补偿负载的确定性变化所产生的动态时滞与位置误差。
电流前馈增量的估算方法如下。
设 m 为速度环采样周期中包含的电流环采样周期的个数, ΔXi 为位置环的当前位 置设定值, ΔXi/Δti 为当前进给速度, ΔXi+1/Δti+1 为下一个进给速度, 二者之差则为在速 度环的当前采样周期中的进给速度增量, 记为 ΔFi,x。ΔXi+1/Δti+1 大于 ΔXi/Δti, ΔFi,x 为正, 反之, ΔFi, 对于电流环的每个采样周期, 电流给定值的修正量与 ΔFi, x 为负。显然, x/ m 有关, 也与其他一些因素有关, 例如, 速度环、 电流环的特定控制算法, 工件材料, 进给量等 等。
设 Kif 为修正系数, KifΔFi, 以 ΔIi, i = 1, ..., n, x/m 称之为电流前馈增量, j 表之, j = 1, ..., m, 其中, n 为轴联动表中坐标值增量的个数。
在工程技术领域, 许多误差并非是完全随机的, 误差中的若干信息是可预期的。 例 如, X 方向的进给量增大, X 轴的负载必然增大, 其增量的数值也在确定的范围内。这种误差 可称之为准确定性误差。
众所周知, 对于非线性多变量的复杂问题, 所有的方程都是在某种简化背景中的 方程即某种经验方程, 所有的公式都是在某种简化背景中的某种经验公式。在工程技术领 域, 处理非线性多变量产生的准确定性误差时, 其常规技术手段则是根据实验数据直接编 制 “技术手册” , 通过查表选用具有一定安全系数的工艺参数, 再经过模拟实际应用环境通 过试验反复试凑, 得到合理的工艺参数。对于用户而言, 也必须经过模拟实际应用环境, 通 过试验反复试凑得到修正系数 Kif 的实际值。
计算机的本质是 “存储程序控制” , 将计算机要做的工作程序以及相关的数据事先 存储起来, 需要时予以执行。现代计算机系统已不再是单纯的数值计算机, 而是具有强大 信息处理能力的信息处理机, 不只是程序被事先存储, 各种形式的信息也以一定的格式事
先存储起来, 先存后用, “存储程序控制” 的观念被推广, 成为一种普适的 “存储信息控制方 法” 。
形象地讲, 存储信息控制方法是以空间换时间。 在处理复杂的非线性控制问题时, 对于其中的准确定性误差, 存储信息控制将可预期的控制信息统统事先存储起来, 如同对 数表、 三角函数表那样, 需要时进行查找并予以校正, 从而显著简化控制算法, 提高实时性 与控制效果。
显然, 存储信息控制方法与工程技术领域处理非线性多变量的常规技术手段是吻 合的。本发明舍弃现有的理论形式化方法, 将工程技术领域处理非线性多变量的常规技术 手段引入运动控制系统以扩展存储信息控制方法, 其思路是, 以经典的位置环、 速度环、 电 流环的 PID 控制器与前馈控制器 ( 加速度前馈、 速度前馈 ) 构成复合控制器, 以位置环比例 系数、 速度环比例系数、 速度环积分常数、 速度前馈系数、 加速度前馈系数、 电流前馈增量、 电子齿轮传动比等作为伺服参数。针对具体控制对象及其具体环境, 根据 “技术手册” , 在 离散几何规划与离散运动规划时, 对相应的微线段 ΔXi, 事先标识伺服参数的调整策略, 例 如, 所述伺服参数的调整方向 ( 增大或减小 ) 与调整量等。
因而, 在每个轴联动表文件中设置伺服参数调整表, 针对每个需要调控的微线段 ΔXi, 调整表用于标识上述伺服参数的调整方向与调整量。用户在使用过程中, 经过反复试 凑, 针对具体控制对象完善具体环境中的调整量。
运动控制系统接收联动表文件后进行初始化, 将轴联动表的首地址写入 L 指针 ; 根据轴联动表文件中的特征表, 设置坐标轴的逻辑属性 ; 设置执行标志。
运动控制系统接收联动命令后, 跟随联动命令, 根据 L 指针从轴联动表中读取 ΔXi, 查看与 ΔXi 链接的调整表, 对相应的伺服参数进行调整, 再将 ΔXi 写入位置环, 驱动 坐标轴进给 ; L 指针加 1, 直至轴联动表的终点 (L 指针等于轴联动表的末地址 ), 关闭执行 标志, 准备执行下一条刀路曲线的轴联动表。
对于 ΔXi, 在电流环的每个采样周期, 实施电流前馈控制, 对电流给定值按 ΔIi,x 予以修正。
基于上述技术方案, 本发明为运动控制提出一种位置控制方法, 包括以下步骤。
步骤 1 用于串行接口从上位机接收轴联动表并存储在文件存储器中 ;
步骤 2 用于扇区分析模块从文件存储器读取特征表, 设置坐标轴的逻辑属性 ; 设 置执行标志 ;
步骤 3 用于联动接口从上位机接收所述联动命令 ;
步骤 4 用于扇区分析模块从文件存储器读取调整表, 设置并调整伺服参数 ;
步骤 5 用于扇区分析模块从轴联动表读取坐标值增量并写入位置环, 驱动坐标轴 进给 ; 如果到达轴联动表的终点, 则关闭执行标志 ; 否则, 重复步骤 3 至步骤 5。
为补偿负载的确定性变化所产生的动态时滞与位置误差, 对于每个需要调控的微 线段 ΔXi, 在电流环的每个采样周期, 根据电流前馈增量 ΔIi, x 修正电流给定值。
以上内容是结合具体的优选实施方式对本发明所作的进一步详细说明, 不能认定 本发明的具体实施只局限于这些说明。对于本发明所属技术领域的普通技术人员来说, 在 不脱离本发明构思的前提下, 还可以做出若干简单推演或替换, 都应当视为属于本发明的 保护范围。