三轴运动平台改进型交叉耦合控制装置及方法制造方法及图纸

一种三轴运动平台改进型交叉耦合控制装置及方法，其特征在于：该装置包括主电路、控制电路和控制对象三部分；主电路包括交流调压模块、整流滤波模块和IPM逆变模块；本发明专利技术在三轴协调控制中采用一种轮廓误差估算法，建立三轴轮廓误差模型，改进了交叉耦合控制的结构，设计出三维空间轮廓误差控制器。

【技术实现步骤摘要】

：本专利技术提供一种=轴运动平台改进型交叉禪合控制装置及方法，属于 数控。[000引
技术介绍
观代数控加工系统中，两轴XY平台轮廓控制已无法满足人们对复杂元 件的加工要求，因此引入=轴运动平台轮廓控制技术，W实现对空间=维零件轮廓的精密 加工。=轴运动平台是受永磁同步直线电机直接驱动，避免了 "滚珠+丝杠"的中间传动环 节，提高系统的加工效率。
技术实现思路
： 专利技术目的：本专利技术提供一种=轴运动平台改进型交叉禪合控制装置及方法，其目 的是解决W往的方式做存在的问题。 技术方案；本专利技术是通过W下技术方案实现的： 一种=轴运动平台改进型交叉禪合控制装置，其特征在于：该装置包括主电路、控 制电路和控制对象=部分；主电路包括交流调压模块、整流滤波模块和IPM逆变模块；控制 电路包括DSP处理器、电流采样电路、动子位置采样电路、电压调整电路、IPM隔离驱动电路 和IPM保护电路追制对象为立相永磁直线同步电机，机身装有光栅尺；电流采样电路、动 子位置采样电路、电压调整电路、IPM隔离驱动电路和IPM保护电路均与DSP处理器连接， IPM隔离驱动电路和IPM保护电路与IPM逆变模块连接，电流采样电路通过霍尔传感器连接 至=相永磁直线同步电机，电压调整电路连接交流调压模块，交流调压模块连接整流滤波 模块，整流滤波模块连接IPM逆变模块，IPM逆变模块连接=相永磁直线同步电机，=相永 磁直线同步电机上的光栅尺与动子位置采样电路连接。 利用上述的=轴运动平台改进型交叉禪合控制装置实施的=轴运动平台改进型 交叉禪合控制方法，其特征在于；该方法采用一种轮廓误差估算法，来建立=轴运动平台的 轮廓误差模型，并将单轴跟踪控制与=轴交叉禪合控制相结合，改进了W往的交叉禪合控 制结构，从而保证了系统单轴跟踪精度W及轮廓精度均趋近于零。 单轴跟踪控制，单轴跟踪控制采用位置一速度环双闭环控制方式，单轴跟踪控制 系统设计。[000引速度环采用具有前馈的伪微分反馈控制器，即PDFF控制器，其控制算法表示为：( 1 ) 其中kf为前馈补偿增益，ki为积分增益，kp为比例增益；速度环控制输入Vd(s)与 实际输出速度函数Vg(S)间的关系为：(2)[001引扰动输入C(S)与实际输出速度函数Vg(s)间的关系为：[001 引 被控对象采用永磁同步直线电机，其传递函数为 其中，Gu(s) =l/(Ms+B)为实际被控对象，Kf为电磁推力系数。 位置环采用比例控制器，系数为k,，因此整个单轴跟踪控制系统的传递函数可表 示为：[001 引 通过设置固定扰动C，能够验证系统具有较强的抗干扰能力W及较快响应能力。 该方法的步骤如下： 本专利技术包括W下具体步骤： 步骤1 ;建立=轴运动平台轮廓误差模型：S轴运动平台采用是由两两垂直的永磁同步直线电机（PMLSM)，永磁直线同步电 机械方程式为：(6)[002引式中，Fe;电磁推力；M;永磁直线电机的动子和动子所带负载的总质量；i。为动子q轴电流；Kf;电磁推力系数；B;粘滞摩擦系数；F;系统所受的总扰动力。V是动子速度；V 为动子加速度； 选取X(t)和V(t)为系统状态变量，即PMLSM的状态方程可改写为[002引其中，v(t)是电机动子速度；U=i。表示电机的控制输入量；xU)则为直线电机 的位置输出。 因此，直接驱动S轴运动平台可W由S个2阶微分方程构成： 即表示成状态空间的形式为：(9)T，z:(〇 =T，u=T，p=T，Aii= 0,A。=I，A21= 0,A22=diag(-Bi/Mi)，i=X,y,z，均为 3X3 矩 阵； 步骤2 轴运动平台轮廓误差模型建立： 在=轴运动平台中，轮廓误差模型估计的精度直接影响轮廓控制性能。假设=轴 运动平台中i为命令位置，P为实际位置，位置误差向量为丘，轮廓误差向量为e;R。、Ri为 命令位置上的两点，分别记为R〇(x〇,y〇,z〇)，Ri(Xi,y。Zi) ;Q点为命令位置向量哀上的一点， 坐标记为Q(x，y，Z)。点P到点Ri的距离为位置误差向量怎，表示成数学关系式的形式为： 由R。、Ri和Q该立点推出命令位置线性方程式为：。2) 假设实际位置P到命令位置哀的最短距离为向量戶0，因此向量为(13) 向量7^与向量度相互垂直，内积为零；即7运.哀=0;求出参数t代入到方程式 (12)后可W得到坐标Q，坐标Q求出后可进一步求出轮廓误差值，最后推出轮廓误差e为 由式（14)可知轮廓误差e在X轴、y轴W及Z轴的分量； 步骤轮廓误差的补偿器设计 为了减小轮廓误差，希望实际位置P能够向命令位置向量另修正，除了修正位置误 差向量左在各轴分量E,，Ey，氏外，需另外补偿轮廓误差向量'g。因此，选取向量很作为实际 位置到命令位置间轮廓误差e的补偿，补偿量的多少取决于A的大小。因此，把C作为整个 系统的补偿量，实际位置到期望位置的补偿关系式为： C= ￡ + ^? (1日）通过式（15)，既可W补偿实际位置点P到期望位置点Ri的跟踪误差，又可W补偿 两点间的轮廓误差，使其趋近于命令位置。进而得到整个补偿量C在各轴的分量： 通过式（16)可使得合成向量C趋近于命令位置路径，其中人为交叉禪合增益值， 影响轮廓误差的修正速度。由合成向量C的几何关系可知A值愈大，C愈偏向命令路径， 修正轮廓误差向量'g的量就会大； 步骤4 ;单轴跟踪控制器设计 为了保证=轴的轮廓精度，单轴跟踪控制也是必不可少的，本专利技术中单轴跟踪控 制采用速度环控制器和位置环控制器相结合的控制方式，速度环控制器采用PDFF控制方 案，位置环控制器ky采用比例控制方式； 步骤5 ;轮廓控制器设计 由前面所提到的轮廓误差估计法，可知轮廓误差e仅与命令位置哀和实际位置P 有关，属于位置的几何关系，因此所设计的交叉禪合控制器位于控制系统的位置回路部分， 改进了W往的交叉禪合控制结构。 交叉禪合控制器的输入为立轴运动平台的给定位置Rx、Ry和RZ和每轴的跟踪误差 Ey、Ey和Ee,、和e,是交叉禪合控制器输出的每一轴的轮廓误差分量。 本专利技术方法最终由嵌入DSP处理器中的控制程序实现，其控制过程按W下步骤执 行：[005引步骤1系统初始化；步骤2允许TN1、TN2中断； 步骤3启动T1下溢中断； 步骤4程序数据初始化；[00创步骤5开总中断； 步骤6中断等待； 步骤7TN1中断处理子控制程序； 步骤8结束。 其中步骤7中T1中断处理子控制程序按W下步骤： 步骤1T1中断子控制程序； 步骤2保护现场； 步骤3判断是否已初始定位；是进入步骤4,否则进入步骤10 ; 步骤4电流采样，化A服变换，PA服变换； 步骤5判断是否需要位置调节；否则进入步骤7 ; 步骤6位置调节中断处理子控制程序； 步骤7dq轴电当前第1页1 2 3 4 本文档来自技高网...

【技术保护点】
一种三轴运动平台改进型交叉耦合控制装置，其特征在于：该装置包括主电路、控制电路和控制对象三部分；主电路包括交流调压模块、整流滤波模块和IPM逆变模块；控制电路包括DSP处理器、电流采样电路、动子位置采样电路、电压调整电路、IPM隔离驱动电路和IPM保护电路；控制对象为三相永磁直线同步电机，机身装有光栅尺；电流采样电路、动子位置采样电路、电压调整电路、IPM隔离驱动电路和IPM保护电路均与DSP处理器连接，IPM隔离驱动电路和IPM保护电路与IPM逆变模块连接，电流采样电路通过霍尔传感器连接至三相永磁直线同步电机，电压调整电路连接交流调压模块，交流调压模块连接整流滤波模块，整流滤波模块连接IPM逆变模块，IPM逆变模块连接三相永磁直线同步电机，三相永磁直线同步电机上的光栅尺与动子位置采样电路连接。

【技术特征摘要】

【专利技术属性】
技术研发人员：王丽梅，蔺威威，
申请(专利权)人：沈阳工业大学，
类型：发明
国别省市：辽宁;21