一种减小多轴运动系统轮廓误差的控制方法技术方案

一种减小多轴运动系统轮廓误差的控制方法，在传统单电机位置、速度、电流三闭环级联控制结构的基础上，将多轴运动系统的轮廓误差和跟踪误差作为该多轴运动系统的控制目标，通过预测模型对多轴运动系统及对应的功率变换器建模，采用模型预测方法设计整体位置‑电流预测控制器，得到当前时刻的控制量，再通过扩张状态观测器观测多轴运动系统位置环的扰动情况，并根据扰动情况对控制量进行优化，从而减小多轴运动系统轮廓误差本，先估计，后消除，提高了整体的控制精度。发明专利技术的一种减小多轴运动系统轮廓误差的控制方法，不仅简化了控制结构，而且可以使多轴运动系统间的位置同步效果良好，获得较好的轮廓跟踪性能。

A control method to reduce the profile error of multi axis motion system

【技术实现步骤摘要】
一种减小多轴运动系统轮廓误差的控制方法
本专利技术涉及一种多轴运动系统轮廓误差。特别是涉及一种减小多轴运动系统轮廓误差的控制方法。
技术介绍
在数控机床轮廓加工、机器人等小功率场合，永磁同步电机交流伺服系统以其精度高、响应快等优点得到了广泛应用。在切削加工过程中，各轴之间同步性能的好坏直接决定了产品的优劣，故控制目标是使多轴运动系统之间保持较好的同步性能，减小系统的轮廓误差。但由于各位置环参数不匹配、非线性轮廓的复杂程度以及外部干扰等因素，使得驱动轴运动不协调，造成系统轮廓误差较大，不能满足生产加工的需求。因此，研究高性能的多轴轮廓控制策略，更具有普遍的现实意义和广阔的应用前景。轮廓误差的大小，反映了多电机各位置是否达到预定的位置，而且反映各位置之间的配比，直接决定了加工产品的质量。提高多轴运动系统的轮廓精度，可以概括为以下两种方法：第一，通过控制单轴的跟踪误差来改善多轴整体轮廓精度，比如基本前馈控制、零相位误差跟踪控制、逆补偿滤波控制等。但就加工轮廓而言，其轨迹是多轴协调运动合成的结果，整体精度的提高涉及到每个给进轴动态性能和轴间匹配。所以，轮廓误差指标比单轴误差指标更重要。第二，通过加强轴间耦合作用来提高整体轮廓精度。以Koren.Y为首提出的交叉耦合控制(CCC)结构，直接以消除轮廓误差为控制目标，根据计算出的轮廓误差生成控制信号，再通过耦合算子将其分配到单轴控制回路，通过交叉耦合保证各轴之间的同步性，从而减小轮廓误差。所以传统控制中，通常采用交叉耦合与提高单轴动态响应相结合的结构，以实现多轴轮廓控制。例如，单轴采用三闭环级联控制，每环采用比例积分(PI)控制器，轴间采用比例(P)形式的CCC+PI结构，但是此种方法鲁棒性较差。随着数字信号处理器的发展，模型预测控制(modelpredictivecontrol，MPC)处理多输入多输出变量(MIMO)突显出优势，作为一种滚动时域优化控制方法已经得到广泛应用。它不仅动态响应快，还允许非线性和约束以直接的方式结合到控制定律中，仅在一个循环中包含嵌套控制循环。有研究者提出一个使用预测控制和自适应进给率的方法，用于稳态情况的MPC实现了高精度的跟踪，同时也在暂态提高了跟踪精度。也有研究者提出一种显式模型预测控制的方法，考虑到阶跃和斜坡参考信号，把单积分和双积分加入到价值函数中用于控制算法设计，跟踪效果较好，也降低了在线计算量大的问题。但这些方法没有考虑到模型预测控制算法对系统模型的依赖，而系统模型不准确，势必会影响系统的精确度。
技术实现思路
本专利技术所要解决的技术问题是，提供一种可以使多轴运动系统间的位置同步效果良好，获得较好的轮廓跟踪性能的减小多轴运动系统轮廓误差的控制方法。本专利技术所采用的技术方案是：一种减小多轴运动系统轮廓误差的控制方法，将多轴运动系统的轮廓误差和跟踪误差作为该多轴运动系统的控制目标，通过预测模型对多轴运动系统及对应的功率变换器建模，得到当前时刻的控制量，再通过扩张状态观测器观测多轴运动系统位置环的扰动情况，并根据扰动情况对控制量进行优化，从而减小多轴运动系统轮廓误差，具体包括以下步骤：1)建立电机实际机械角度的预测模型，如下：Y＝Hy(ki)+F2Δx(ki)+G2ΔIq其中，ki表示采样时刻，Δ＝1-z-1，表示当前时刻与前一时刻的采样差值，z-1表示后移算子，y(ki)为第ki个采样周期多轴运动系统的位置，Δx(ki)＝[Δθ(ki)Δθ(ki-1)Δiq(ki-1)]T，包含多轴运动系统第ki个采样周期的位置增量、第(ki-1)个采样周期的位置增量、第(ki-1)个采样周期的电流增量，ΔIq＝[ΔiqT(ki)ΔiqT(ki+1)…ΔiqT(ki+Nc-1)]T，表示控制增量，Y＝[yT(ki+1)yT(ki+2)…yT(ki+Np)]T，表示电机机械角度，单位为rad，H＝[I3×3I3×3…I3×3]T，表示由3行3列单位矩阵组成的矩阵，其中，Y为电机实际机械角度，ΔIq为控制增量，Δiq为未来控制增量，I3×3表示3行3列的单位矩阵，l表示变化范围从1到Np的变量，A是状态变量矩阵、B是系统输入矩阵、C是系统输出矩阵，Np表示预测域，Nc表示控制域，一般Np≥Nc；2)根据预测模型将多轴运动系统的轮廓误差和跟踪误差作为总的控制目标，在保证轮廓精度的同时减小跟踪误差；3)对多轴运动系统位置进行多步预测，通过最小化价值函数，得到当前时刻的控制增量，通过后验约束限制得到当前时刻的控制量；4)建立扩张状态观测器如下：其中，z1、z2、z3分别是机械角度，单位为rad，机械角速度，单位为rad/s，扰动变化的观测值，r1、r2、r3是等式系数，b为常数，θ是电机机械位置，是电流补偿值，z1、z2、z3的上标表示求导；令λ(s)＝|sI-(D1-RD3)|＝s3+r1s2+r2s+r3等于期望误差(s+p0)3，得其中，p0为扩张状态观测器的闭环极点的负数；5)采用扩张状态观测器对多轴运动系统位置二阶微分模型中扰动项进行观测，通过线性比例微分反馈控制律，得到补偿控制量；6)用补偿控制量实时优化当前时刻控制量，优化矢量控制的参考值，实现对目标的控制。本专利技术的一种减小多轴运动系统轮廓误差的控制方法，不仅简化了控制结构，而且可以使多轴运动系统间的位置同步效果良好，获得较好的轮廓跟踪性能。本专利技术的控制方法可靠性较高，而且模型预测方法带有动态性能好的特点，可实现多步预测，而且控制结构紧凑，仅需对软件部分加以改动即可应用，无需增加硬件成本。具有如下效果：1、本专利技术的方法在传统单电机位置、电流三闭环级联控制结构的基础上，将多轴运动系统中的多台电机及其功率变换器进行建模，将多电机建立耦合关系，采用模型预测方法设计位置-电流预测控制器，解决了传统方法结构比较冗余、参数调节繁琐的问题。2、本专利技术的方法不仅考虑同步误差，同时把跟踪误差考虑在内，在保证单轴跟踪误差的前提下，减小了系统的同步误差。3、本专利技术的方法通过设计ESO观测器对系统位置环内外扰动进行观测，以补偿量的形式增加到模型预测算法中，提高了系统的扰动抑制效果，保证了稳态时的同步性能，又提高了瞬态情况下的同步性能，适用于不同工况，更具普遍性。4、本专利技术的方法不仅适用于空间直线，而且也适用于轨迹变化较大的空间曲线。附图说明图1是本专利技术一种减小多轴运动系统轮廓误差的控制方法的流程图；图2是为多轴运动系统跟踪的空间曲线轮廓图；图3是多轴运动系统的机构示意图。具体实施方式下面结合实施例和附图对本专利技术的一种减小多轴运动系统轮廓误差的控制方法做出详细说明。本专利技术的一种减小多轴运动系统轮廓误差的控制方法，将MPC应用于多轴运动系统轮廓误差控制，为实现对给定轨迹快速稳定地跟踪效果，通过对多轴运动系统中的多台电机及其逆变器建模，把轮廓误差、跟踪误差和控制变量增量引入到价本文档来自技高网...

【技术保护点】
1.一种减小多轴运动系统轮廓误差的控制方法，其特征在于，将多轴运动系统的轮廓误差和跟踪误差作为该多轴运动系统的控制目标，通过预测模型对多轴运动系统及对应的功率变换器建模，得到当前时刻的控制量，再通过扩张状态观测器观测多轴运动系统位置环的扰动情况，并根据扰动情况对控制量进行优化，从而减小多轴运动系统轮廓误差，具体包括以下步骤：/n1)建立电机实际机械角度的预测模型，如下：/nY＝Hy(k

【技术特征摘要】
1.一种减小多轴运动系统轮廓误差的控制方法，其特征在于，将多轴运动系统的轮廓误差和跟踪误差作为该多轴运动系统的控制目标，通过预测模型对多轴运动系统及对应的功率变换器建模，得到当前时刻的控制量，再通过扩张状态观测器观测多轴运动系统位置环的扰动情况，并根据扰动情况对控制量进行优化，从而减小多轴运动系统轮廓误差，具体包括以下步骤：
1)建立电机实际机械角度的预测模型，如下：
Y＝Hy(ki)+F2Δx(ki)+G2ΔIq
其中，ki表示采样时刻，Δ＝1-z-1，表示当前时刻与前一时刻的采样差值，z-1表示后移算子，y(ki)为第ki个采样周期多轴运动系统的位置，Δx(ki)＝[Δθ(ki)Δθ(ki-1)Δiq(ki-1)]T，包含多轴运动系统第ki个采样周期的位置增量、第(ki-1)个采样周期的位置增量、第(ki-1)个采样周期的电流增量，ΔIq＝[ΔiqT(ki)ΔiqT(ki+1)…ΔiqT(ki+Nc-1)]T，表示控制增量，Y＝[yT(ki+1)yT(ki+2)…yT(ki+Np)]T，表示电机机械角度，单位为rad，H＝[I3×3I3×3…I3×3]T，表示由3行3列单位矩阵组成的矩阵，



其中，Y为电机实际机械角度，ΔIq为控制增量，Δiq为未来控制增量，I3×3表示3行3列的单位矩阵，l表示变化范围从1到Np的变量，A是状态变量矩阵、B是系统输入矩阵、C是系统输出矩阵，Np表示预测域，Nc表示控制域，一般Np≥Nc；
2)根据预测模型将多轴运动系统的轮廓误差和跟踪误差作为总的控制目标，在保证轮廓精度的同时减小跟踪误差；
3)对多轴运动系统位置进行多步预测，通过最小化价值函数，得到当前时刻的控制增量，通过后验约束限制得到当前时刻的控制量；
4)建立扩张状态观测器如下：



其中，z1、z2、z3分别是机械角度，单位为rad，机械角速度，单位为rad/s，扰动变化的观测值，r1、r2、r3是等式系数，b为常数，θ是电机机械位置，是电流补偿值，z1、z2、z3的上标表示求导；
令λ(s)＝|sI-(D1-RD3)|＝s3+r1s2+r2s+r3等于期望误差(s+p0)3，得
r1＝3p0，
其中，p0为扩张状态观测器的闭环极点的负数；
5)采用扩张状态观测器对多轴运动系统位置二阶微分模型中扰动项进行观测，通过线性比例微分反馈控制律，得到补偿控制量；
6)用补偿控制量实时优化当前时刻控制量，优化矢量控制的参考值，实现对目标的控制。


2.根据权利要求1所述的一种减小多轴运动系统轮廓误差的控制方法，其特征在于，步骤2)所述的在保证轮廓精度的同时减小跟踪误差，是通过如下价值函数公式实现：



式中，g表示价值函数，Θ*为电机机械角度给定序列，单位为rad，Y表示电机机械角度，单位为rad，N为给定轨迹期望位置的法向量，ΔIq为控制增量，Qc、Qa、Qu分别为同步误差、跟踪误差和控制增量的权重系数。


3.根据权利要求1所述的一种减小多轴运动系统轮廓误差的控制方法，其特征在于，步骤3)所述的通过最小化价值函数，得到当前时刻的控制增量是：令得到当前控制增量：



其中，ΔIq为控制增量，Qc、Qa、Qu分别为同步误差、跟踪误差和控制增量的权重系数，N为给定轨迹期望位置的法向量，Θ*为电机机械角度给定序列...

【专利技术属性】
技术研发人员：陈炜，刘达，史婷娜，夏长亮，
申请(专利权)人：天津工业大学，
类型：发明
国别省市：天津;12