CN204790506U - 三轴运动平台改进型交叉耦合控制装置 - Google Patents
三轴运动平台改进型交叉耦合控制装置 Download PDFInfo
- Publication number
- CN204790506U CN204790506U CN201520498480.9U CN201520498480U CN204790506U CN 204790506 U CN204790506 U CN 204790506U CN 201520498480 U CN201520498480 U CN 201520498480U CN 204790506 U CN204790506 U CN 204790506U
- Authority
- CN
- China
- Prior art keywords
- circuit
- control
- ipm
- module
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000006880 cross-coupling reaction Methods 0.000 title claims abstract description 36
- 230000001105 regulatory effect Effects 0.000 claims abstract description 11
- 230000001276 controlling effect Effects 0.000 claims abstract description 6
- 238000005070 sampling Methods 0.000 claims description 29
- 230000001360 synchronised effect Effects 0.000 claims description 21
- 238000002955 isolation Methods 0.000 claims description 10
- 238000001914 filtration Methods 0.000 claims description 7
- 238000013461 design Methods 0.000 abstract description 12
- 239000013598 vector Substances 0.000 description 36
- 238000000034 method Methods 0.000 description 32
- 238000010586 diagram Methods 0.000 description 15
- 238000003754 machining Methods 0.000 description 9
- 238000012545 processing Methods 0.000 description 8
- 238000006243 chemical reaction Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 6
- 238000013459 approach Methods 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 5
- 238000012937 correction Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000009466 transformation Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 102100024061 Integrator complex subunit 1 Human genes 0.000 description 2
- 101710092857 Integrator complex subunit 1 Proteins 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 2
- 239000003990 capacitor Substances 0.000 description 2
- 239000003054 catalyst Substances 0.000 description 2
- 239000002131 composite material Substances 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 102100028043 Fibroblast growth factor 3 Human genes 0.000 description 1
- 108050002021 Integrator complex subunit 2 Proteins 0.000 description 1
- 235000010724 Wisteria floribunda Nutrition 0.000 description 1
- 238000010521 absorption reaction Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Feedback Control In General (AREA)
Abstract
一种三轴运动平台改进型交叉耦合控制装置,其特征在于:该装置包括主电路、控制电路和控制对象三部分;主电路包括交流调压模块、整流滤波模块和IPM逆变模块;本实用新型在三轴协调控制中采用一种轮廓误差估算法,建立三轴轮廓误差模型,改进了交叉耦合控制的结构,设计出三维空间轮廓误差控制器。
Description
技术领域:本实用新型提供一种三轴运动平台改进型交叉耦合控制装置及方法,属于数控技术领域。
背景技术:现代数控加工***中,两轴XY平台轮廓控制已无法满足人们对复杂元件的加工要求,因此引入三轴运动平台轮廓控制技术,以实现对空间三维零件轮廓的精密加工。三轴运动平台是受永磁同步直线电机直接驱动,避免了“滚珠+丝杠”的中间传动环节,提高***的加工效率。
实用新型内容:
实用新型目的:本实用新型提供一种三轴运动平台改进型交叉耦合控制装置及方法,其目的是解决以往的方式做存在的问题。
技术方案:本实用新型是通过以下技术方案实现的:
一种三轴运动平台改进型交叉耦合控制装置,其特征在于:该装置包括主电路、控制电路和控制对象三部分;主电路包括交流调压模块、整流滤波模块和IPM逆变模块;控制电路包括DSP处理器、电流采样电路、动子位置采样电路、电压调整电路、IPM隔离驱动电路和IPM保护电路;控制对象为三相永磁直线同步电机,机身装有光栅尺;电流采样电路、动子位置采样电路、电压调整电路、IPM隔离驱动电路和IPM保护电路均与DSP处理器连接,IPM隔离驱动电路和IPM保护电路与IPM逆变模块连接,电流采样电路通过霍尔传感器连接至三相永磁直线同步电机,电压调整电路连接交流调压模块,交流调压模块连接整流滤波模块,整流滤波模块连接IPM逆变模块,IPM逆变模块连接三相永磁直线同步电机,三相永磁直线同步电机上的光栅尺与动子位置采样电路连接。
利用上述的三轴运动平台改进型交叉耦合控制装置实施的三轴运动平台改进型交叉耦合控制方法,其特征在于:该方法采用一种轮廓误差估算法,来建立三轴运动平台的轮廓误差模型,并将单轴跟踪控制与三轴交叉耦合控制相结合,改进了以往的交叉耦合控制结构,从而保证了***单轴跟踪精度以及轮廓精度均趋近于零。
单轴跟踪控制,单轴跟踪控制采用位置—速度环双闭环控制方式,单轴跟踪控制***设计。
速度环采用具有前馈的伪微分反馈控制器,即PDFF控制器,其控制算法表示为:
其中kf为前馈补偿增益,ki为积分增益,kp为比例增益;速度环控制输入vd(s)与实际输出速度函数va(s)间的关系为:
扰动输入ξ(s)与实际输出速度函数va(s)间的关系为:
被控对象采用永磁同步直线电机,其传递函数为
其中,G0(s)=1/(Ms+B)为实际被控对象,Kf为电磁推力系数。
位置环采用比例控制器,系数为kx,因此整个单轴跟踪控制***的传递函数可表示为:
通过设置固定扰动ξ,能够验证***具有较强的抗干扰能力以及较快响应能力。
该方法的步骤如下:
本实用新型包括以下具体步骤:
步骤1:建立三轴运动平台轮廓误差模型:
三轴运动平台采用是由两两垂直的永磁同步直线电机(PMLSM),永磁直线同步电机械方程式为:
式中,Fe:电磁推力;M:永磁直线电机的动子和动子所带负载的总质量;iq为动子q轴电流;Kf:电磁推力系数;B:粘滞摩擦系数;F:***所受的总扰动力。v是动子速度;为动子加速度;
选取x(t)和v(t)为***状态变量,即PMLSM的状态方程可改写为
其中,v(t)是电机动子速度;u=iq表示电机的控制输入量;x(t)则为直线电机的位置输出。
因此,直接驱动三轴运动平台可以由三个2阶微分方程构成:
即表示成状态空间的形式为:
其中,z1(t)=[x1(t)x2(t)x3(t)]T, u=[u1u2u3]T,ρ=[F1F2F3]T,A11=0,A12=I,A21=0,A22=diag(-Bi/Mi),i=x,y,z,均为3×3矩阵;
步骤2:三轴运动平台轮廓误差模型建立:
在三轴运动平台中,轮廓误差模型估计的精度直接影响轮廓控制性能。假设三轴运动平台中为命令位置,P为实际位置,位置误差向量为轮廓误差向量为R0、R1为命令位置上的两点,分别记为R0(x0,y0,z0),R1(x1,y1,z1);Q点为命令位置向量上的一点,坐标记为Q(x,y,z)。点P到点R1的距离为位置误差向量表示成数学关系式的形式为:
向量为
由R0、R1和Q这三点推出命令位置线性方程式为:
假设实际位置P到命令位置的最短距离为向量因此向量为
向量与向量相互垂直,内积为零;即求出参数t代入到方程式(12)后可以得到坐标Q,坐标Q求出后可进一步求出轮廓误差值,最后推出轮廓误差为
由式(14)可知轮廓误差在x轴、y轴以及z轴的分量;
步骤三:轮廓误差的补偿器设计
为了减小轮廓误差,希望实际位置P能够向命令位置向量修正,除了修正位置误差向量在各轴分量Ex,Ey,Ez外,需另外补偿轮廓误差向量因此,选取向量作为实际位置到命令位置间轮廓误差的补偿,补偿量的多少取决于λ的大小。因此,把作为整个***的补偿量,实际位置到期望位置的补偿关系式为:
通过式(15),既可以补偿实际位置点P到期望位置点R1的跟踪误差,又可以补偿两点间的轮廓误差,使其趋近于命令位置。进而得到整个补偿量在各轴的分量:
通过式(16)可使得合成向量趋近于命令位置路径,其中λ为交叉耦合增益值,影响轮廓误差的修正速度。由合成向量的几何关系可知λ值愈大,愈偏向命令路径,修正轮廓误差向量的量就会大;
步骤4:单轴跟踪控制器设计
为了保证三轴的轮廓精度,单轴跟踪控制也是必不可少的,本实用新型中单轴跟踪控制采用速度环控制器和位置环控制器相结合的控制方式,速度环控制器采用PDFF控制方案,位置环控制器kx采用比例控制方式;
步骤5:轮廓控制器设计
由前面所提到的轮廓误差估计法,可知轮廓误差仅与命令位置和实际位置P有关,属于位置的几何关系,因此所设计的交叉耦合控制器位于控制***的位置回路部分,改进了以往的交叉耦合控制结构。
交叉耦合控制器的输入为三轴运动平台的给定位置Rx、Ry和Rz和每轴的跟踪误差Ex、Ey和Ez。ex、ey和ez是交叉耦合控制器输出的每一轴的轮廓误差分量。
本实用新型方法最终由嵌入DSP处理器中的控制程序实现,其控制过程按以下步骤执行:
步骤1***初始化;
步骤2允许TN1、TN2中断;
步骤3启动T1下溢中断;
步骤4程序数据初始化;
步骤5开总中断;
步骤6中断等待;
步骤7TN1中断处理子控制程序;
步骤8结束。
其中步骤7中T1中断处理子控制程序按以下步骤:
步骤1T1中断子控制程序;
步骤2保护现场;
步骤3判断是否已初始定位;是进入步骤4,否则进入步骤10;
步骤4电流采样,CLARK变换,PARK变换;
步骤5判断是否需要位置调节;否则进入步骤7;
步骤6位置调节中断处理子控制程序;
步骤7dq轴电流调节;
步骤8PARK逆变换;
步骤9计算CMPPx及PWM输出;
步骤10位置采样;
步骤11初始定位程序;
步骤12恢复现场;
步骤13中断返回。
其中步骤6中位置调节中断处理子控制程序按以下步骤:
步骤1位置调节中断子控制程序;
步骤2读取编码器值;
步骤3判断角度;
步骤4计算已走距离;
步骤5执行位置控制器;
步骤6计算电流命令并输出;
步骤7中断返回。
优点及效果:本实用新型提供一种三轴运动平台改进型交叉耦合控制装置及方法,随着人们对复杂元件要求的增加,多轴运动平台精密轮廓控制相比于以往具有代表性的两轴XY平台轮廓控制来说,多轴运动平台高性能轮廓加工的精密轮廓运动控制研究具有重要的现实意义和广阔的应用前景。并且多轴运动平台采用多个永磁同步直线电机直接驱动方式,避免了“滚珠+丝杠”的中间传动环节,使得负载仅受到直线电机的直接推力,消除了传统传动机构所产生的问题。实现了从直线电机到被控对象的零间隙传动,使直线电机成为高速、高精密伺服控制***的主要驱动方式。
针对现有控制技术中,对于复杂元件的轮廓控制精度存在的问题,本实用新型在三轴协调控制中采用一种轮廓误差估算法,建立三轴轮廓误差模型,改进了交叉耦合控制的结构,设计出三维空间轮廓误差控制器。
本实用新型所设计的控制器应用到一个直线电机驱动X-Y-Z轴的两两垂直的数控平台中。实验***如图2所示。该平台的位置被连接到每个驱动轴的线性编码器,线性编码器的传感器分辨率是0.1微米。每个驱动轴的速度被位置测量的反向差计算出来,这个采样周期为2毫秒。
本实用新型包括三轴运动平台轮廓误差模型建立,使得***能够完成空间的轮廓轨迹跟踪任务;单轴跟踪控制器设计,保证每轴跟踪误差在较小的范围内;轮廓控制器的设计,减小***的轮廓误差;轮廓误差模型几何关系,如图3所示;轮廓误差补偿量几何关系,如图4所示;单轴跟踪控制器设计,如图1所示;三轴轮廓控制器设计,如图5所示。
本实用新型主要以三轴运动平台为研究对象,通过控制三轴整体的轮廓误差来保证零件加工精度。为提高轮廓加工精度,许多学者致力于研究各种前馈、反馈控制策略以提高单轴跟踪精度,从而间接地提高轮廓运动控制精度。如前馈控制器,零相位误差跟踪控制器,PID控制,自适应控制,鲁棒控制等方法均能够减小单轴跟踪误差。但单轴跟踪误差的减小并不能够保证整体的轮廓精度。所以单轴跟踪控制与轴间协调控制是影响三轴运动平台***轮廓精度的两个重要因素。单轴跟踪控制采用位置环和速度环相结合的控制方法,位置环为比例控制,速度环为PDFF控制,能够保证单轴较快的响应速度及跟踪精度。为了提高轴间的协调性,轴间轮廓控制一般采用交叉耦合控制器(CCC)来协调由于参数不匹配所引起的动态性能差异,减小***的轮廓误差。针对这一问题,本实用新型采用一种轮廓误差估算法,建立三轴间的轮廓误差模型。并在此基础上改进了传统的交叉耦合控制结构,设计了三轴交叉耦合控制器,通过验证这种方法可以有效地提高三轴间的轮廓精度。
附图说明:
图1单轴跟踪控制***框图
图2为本实用新型设计的实验***
图3为直线轮廓误差向量几何关系图
图4为轮廓误差补偿几何关系图
图5三轴运动平台交叉耦合控制框图
图6为实现本实用新型所设计的永磁直线同步电机矢量控制***硬件结构硬件框图
图7为本实用新型方法中矢量控制***程序流程图
图8为本实用新型方法位置调节中断处理子控制程序流程图
图9为实现本实用新型的控制***原理图
(a)电机控制***主电路原理图
(b)A、B相电流采样电路原理图
(c)光栅尺信号采样电路原理图
(d)IPM硬件驱动电路原理图。
具体实施方式:下面结合附图对本实用新型做进一步的说明:
如图1所示,本实用新型提供一种三轴运动平台改进型交叉耦合控制装置及方法,(一)***硬件结构
实现本实用新型控制***主电路如图9(a)所示,调压电路采用反向调压模块EUV-25A-II,可实现0~220V隔离调压。整流滤波单元采用桥式不可控整流,大电容滤波,配合适当的阻容吸收电路,可以获得IPM工作所需的恒定直流电压。IPM采用富士公司6MBP50RA060智能功率模块,耐压600V,最大电流50A,最高工作频率20kHz。IPM用四组独立的15V驱动电源供电。主电源输入端子(P,N),输出端子(U,V,W),主端子用自带的螺钉固定,可实现电流传输。P、N为变频器的整流变换平滑滤波后的主电源输入端子,P为正端,N为负端,逆变器输出的三相交流电通过输出端子U、V、W接至电机。
本实用新型的控制电路的核心为TMS320F2812处理器,其配套的开发板包括目标只读存储器、模拟接口、eCAN接口、串行引导ROM、用户指示灯、复位电路、可配置为RS232/RS422/RS485的异步串口、SPI同步串口和片外256K*16位RAM。
实际控制***中电流采样采用LEM公司霍尔电流传感器LT58-S7。由两个霍尔电流传感器检测A、B相电流,得到电流信号,经过电流采样电路,转换成0~3.3V的电压信号,最后由TMS320LF2812的A/D转换模块转换成12位精度的二进制数,并保存在数值寄存器中。A、B相的电流采样电路如图9(b)所示。可调电阻VR2调节信号幅值,可调电阻VR1调节信号偏移量,通过对这两个电阻的调节,可以将信号调整到0~3.3V,再将其送入DSP的AD0、AD1管脚。图中的稳压管是为了防止送入DSP的信号超过3.3V,导致DSP被高压损坏。运算放大器采用OP27,电源接正负15V电压,在电压和地间接去耦电容。电路输入端接电容滤波,以去除高频信号干扰,提高采样精度。
光栅尺输出的A相和B相脉冲信号要通过快速光耦6N137对信号进行隔离,然后经过分压电路将信号电平由5V转换为3.3V,最后连接到DSP的两路正交编码脉冲接口QEP1和QEP2。电路原理如图9(c)所示。图9(d)给出了六路隔离驱动电路的原理图。需要指出的是IPM故障保护信号针对的是非重复瞬态故障,在本***中通过如下措施来实现:IPM的故障输出信号通过光耦接到DSP的引脚,以确保IPM发生故障时DSP及时将所有事件管理器输出脚置高阻态。
(二)***软件实现
本实用新型方法中矢量控制***程序流程图如图7所示。图8为本实用新型方法位置调节中断处理子控制程序流程图。软件的主程序包括***初始化;开INT1、INT2中断;允许定时器中断;定时器中断处理子程序。其中初始化程序包括关闭所有中断,DSP***初始化,变量初始化,事件管理器初始化、AD初始化和正交编码脉冲QEP初始化。中断服务子程序包括保护中断子程序和T1下溢中断服务子程序。其他部分如动子初始化定位,PID调节,矢量变换等都在定时器TI下溢中断处理子程序中执行。
IPM保护信号产生的保护中断响应属外部中断,INT1中断优先级比定时器T1的高。IPM会在过流、过压等异常情况自动发出保护信号,这一信号经转换连接到DSP的功率驱动保护引脚一旦有异常情况发生,DSP会进入保护中断子程序,首先禁止所有中断,然后封锁PWM输出使得电机马上停转,起到保护电机和IPM的作用。
矢量控制***的顺利启动,需要知道动子的初始位置,利用软件可以给电机的动子通一个幅值恒定的直流电,使定子产生一个恒定的磁场,这个磁场与转子的恒定磁场相互作用,使电机动子运动到两个磁链重合的位置。而动子初始定位、AD采样值的读取、电机动子位置的计算、坐标变换、PID调节、SVPWM波形比较值的产生都在T1下溢中断服务子程序中完成。
详细说明如下:
如图6所示,该装置包括主电路、控制电路和控制对象三部分;主电路包括交流调压模块、整流滤波模块和IPM逆变模块;控制电路包括DSP处理器、电流采样电路、动子位置采样电路、电压调整电路、IPM隔离驱动电路和IPM保护电路;控制对象为三相永磁直线同步电机,机身装有光栅尺;电流采样电路、动子位置采样电路、电压调整电路、IPM隔离驱动电路和IPM保护电路均与DSP处理器连接,IPM隔离驱动电路和IPM保护电路与IPM逆变模块连接,电流采样电路通过霍尔传感器连接至三相永磁直线同步电机,电压调整电路连接交流调压模块,交流调压模块连接整流滤波模块,整流滤波模块连接IPM逆变模块,IPM逆变模块连接三相永磁直线同步电机,三相永磁直线同步电机上的光栅尺与动子位置采样电路连接。
三轴运动平台改进型交叉耦合控制方法,该方法采用一种轮廓误差估算法,来建立三轴运动平台的轮廓误差模型,并将单轴跟踪控制与三轴交叉耦合控制相结合,改进了以往的交叉耦合控制结构,从而保证了***单轴跟踪精度以及轮廓精度均趋近于零。
单轴跟踪控制,采用位置环和速度环相结合的控制方式,单轴跟踪控制***设计如图1,1/(Ms+B)为实际被控对象,Kf为电磁推力系数,xr为输入的参考指令,xp为实际输出位置。单轴跟踪控制采用位置—速度环相结合的控制方式,位置环采用比例控制,速度环采用PDFF控制器,kx为位置环比例增益;速度环中kf为前馈补偿增益,ki为积分增益,kp为比例增益;ξ为外加扰动,通过设置固定扰动,能够验证***具有较强的抗干扰能力以及较快响应能力。
传统的轮廓加工中,一般仅针对于XY平面进行轮廓精度控制,很难延伸到三维空间,这对于实际的数控加工存在了很大的局限性。因此,采用一种轮廓误差估算法,建立了三轴运动平台空间轮廓误差模型。并根据权利要求中所述,采用改进的交叉耦合控制方法来改善轮廓跟踪性能,提高轮廓精度。
该方法的步骤如下:
本实用新型包括以下具体步骤:
步骤1:建立三轴运动平台轮廓误差模型:
三轴运动平台采用是由两两垂直的永磁同步直线电机(PMLSM),永磁直线同步电机械方程式为:
式中,Fe:电磁推力;M:永磁直线电机的动子和动子所带负载的总质量;iq为动子q轴电流;Kf:电磁推力系数;B:粘滞摩擦系数;F:***所受的总扰动力。v是动子速度;为动子加速度;
选取x(t)和v(t)为***状态变量,即PMLSM的状态方程可改写为
其中,v(t)是电机动子速度;u=iq表示电机的控制输入量;x(t)则为直线电机的位置输出。
因此,直接驱动三轴运动平台可以由三个2阶微分方程构成:
即表示成状态空间的形式为:
其中,z1(t)=[x1(t)x2(t)x3(t)]T, u=[u1u2u3]T,ρ=[F1F2F3]T,A11=0,A12=I,A21=0,A22=diag(-Bi/Mi),i=x,y,z,均为3×3矩阵;
步骤2:三轴运动平台轮廓误差模型建立:
在三轴运动平台中,轮廓误差模型估计的精度直接影响轮廓控制性能。图3为直线轮廓误差向量几何关系图。其中,为命令位置,P为实际位置,位置误差向量为轮廓误差向量为R0、R1为命令位置上的两点,分别记为R0(x0,y0,z0),R1(x1,y1,z1);实际位置P到命令位置R的最短距离为向量即为实际位置到参考位置的轮廓误差向量Q点坐标记为Q(x,y,z)。点P到点R1的距离为位置误差向量
由R0、R1和Q这三点推出命令位置线性方程式为:
由图4可知,向量与向量相互垂直,内积为零;即求出参数t代入到方程式(6)后可以得到坐标Q,坐标Q求出后可进一步求出轮廓误差值,最后推出轮廓误差为
由式(6)可知轮廓误差在x轴、y轴以及z轴的分量;
步骤三:轮廓误差的补偿器设计
根据图4,为了减小轮廓误差,希望实际位置P能够向命令位置向量修正,除了修正位置误差向量在各轴分量Ex,Ey,Ez外,需另外补偿轮廓误差向量由向量几何加减法可知,选取向量作为实际位置到命令位置间的补偿,使其趋近于命令位置。整个补偿量在各轴的分量可表示成:
通过式(7)可使得合成向量趋近于命令位置路径,其中λ为交叉耦合增益值,影响轮廓误差的修正速度。由合成向量的几何关系可知λ值愈大,愈偏向命令路径,修正轮廓误差向量的量就会大;
步骤4:单轴跟踪控制器设计
为了保证三轴的轮廓精度,单轴跟踪控制也是必不可少的,本实用新型中单轴跟踪控制采用速度环控制器和位置环控制器相结合的控制方式,速度环控制器采用PDFF控制方案,位置环控制器kx采用比例控制方式;
步骤5:轮廓控制器设计
由前面所提到的轮廓误差估计法,可知轮廓误差e仅与命令位置R和实际位置P有关,属于位置的几何关系,因此所设计的交叉耦合控制器位于控制***的位置回路部分,改进了以往的交叉耦合控制结构,结构框图如图5。
交叉耦合控制器的输入为三轴运动平台的给定位置Rx、Ry和Rz和每轴的跟踪误差Ex、Ey和Ez。ex、ey和ez是交叉耦合控制器输出的每一轴的轮廓误差分量。并且将本实用新型中所设计的三轴交叉耦合控制器结构框图与以往采用的结构框图相比较,本实用新型的轮廓误差补偿在位置回路控制器之前就已完成。由轮廓误差补偿量几何关系可知,当调整位置回路控制器内的增益值Kp时,会同时影响到轮廓误差补偿量其效果等同于调整的大小,而非方向,但此时的方向是由交叉耦合增益值λ的大小来决定。因此Kp与λ的调整是各自独立的,分别为大小和方向。而以往的交叉耦合控制器结构则是将补偿量置于控制器之后,当调整Kp时,其效果等同于在图3中仅调整的大小。因此,本实用新型中所提出的方法将轮廓误差补偿量的方向和大小均同时改变,增加了该结构图中位置回路增益Kp与交叉耦合增益λ间做最适当调整的匹配问题。
交叉耦合控制器的输入为三轴运动平台的给定位置Rx、Ry和Rz和每轴的跟踪误差Ex、Ey和Ez。ex、ey和ez是交叉耦合控制器输出的每一轴的轮廓误差分量。
本实用新型方法最终由嵌入DSP处理器中的控制程序实现,其控制过程按以下步骤执行:
步骤1***初始化;
步骤2允许TN1、TN2中断;
步骤3启动T1下溢中断;
步骤4程序数据初始化;
步骤5开总中断;
步骤6中断等待;
步骤7TN1中断处理子控制程序;
步骤8结束。
其中步骤7中T1中断处理子控制程序按以下步骤:
步骤1T1中断子控制程序;
步骤2保护现场;
步骤3判断是否已初始定位;是进入步骤4,否则进入步骤10;
步骤4电流采样,CLARK变换,PARK变换;
步骤5判断是否需要位置调节;否则进入步骤7;
步骤6位置调节中断处理子控制程序;
步骤7dq轴电流调节;
步骤8PARK逆变换;
步骤9计算CMPPx及PWM输出;
步骤10位置采样;
步骤11初始定位程序;
步骤12恢复现场;
步骤13中断返回。
其中步骤6中位置调节中断处理子控制程序按以下步骤:
步骤1位置调节中断子控制程序;
步骤2读取编码器值;
步骤3判断角度;
步骤4计算已走距离;
步骤5执行位置控制器;
步骤6计算电流命令并输出;
步骤7中断返回。
本实用新型针对直接驱动三轴运动平台,本实用新型的优点主要在于建立了三维空间轮廓误差模型以及对空间轮廓误差进行控制的方法。解决了在现代加工***中,人们对复杂元件的需求不断增加,却不能够满足复杂元件加工精度的问题。本实用新型主要针对减少单轴的跟踪误差以及轮廓误差。单轴跟踪误差利用了位置环控制器与速度环控制器相结合的控制方式,保证了单轴跟踪误差在良好的精度范围。三轴间轮廓误差的控制本实用新型主要提出了一种新的轮廓误差估计模型来估计轮廓误差,并将其应用到三轴交叉耦合轮廓控制器中,改进了三轴交叉耦合控制器的控制结构。通过上述两部分的结合,最终使得三轴运动平台***的轮廓误差趋近于零。
Claims (1)
1.一种三轴运动平台改进型交叉耦合控制装置,其特征在于:该装置包括主电路、控制电路和控制对象三部分;主电路包括交流调压模块、整流滤波模块和IPM逆变模块;控制电路包括DSP处理器、电流采样电路、动子位置采样电路、电压调整电路、IPM隔离驱动电路和IPM保护电路;控制对象为三相永磁直线同步电机,机身装有光栅尺;电流采样电路、动子位置采样电路、电压调整电路、IPM隔离驱动电路和IPM保护电路均与DSP处理器连接,IPM隔离驱动电路和IPM保护电路与IPM逆变模块连接,电流采样电路通过霍尔传感器连接至三相永磁直线同步电机,电压调整电路连接交流调压模块,交流调压模块连接整流滤波模块,整流滤波模块连接IPM逆变模块,IPM逆变模块连接三相永磁直线同步电机,三相永磁直线同步电机上的光栅尺与动子位置采样电路连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201520498480.9U CN204790506U (zh) | 2015-07-10 | 2015-07-10 | 三轴运动平台改进型交叉耦合控制装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201520498480.9U CN204790506U (zh) | 2015-07-10 | 2015-07-10 | 三轴运动平台改进型交叉耦合控制装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN204790506U true CN204790506U (zh) | 2015-11-18 |
Family
ID=54530518
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201520498480.9U Expired - Fee Related CN204790506U (zh) | 2015-07-10 | 2015-07-10 | 三轴运动平台改进型交叉耦合控制装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN204790506U (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104977901A (zh) * | 2015-07-10 | 2015-10-14 | 沈阳工业大学 | 三轴运动平台改进型交叉耦合控制装置及方法 |
-
2015
- 2015-07-10 CN CN201520498480.9U patent/CN204790506U/zh not_active Expired - Fee Related
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104977901A (zh) * | 2015-07-10 | 2015-10-14 | 沈阳工业大学 | 三轴运动平台改进型交叉耦合控制装置及方法 |
CN104977901B (zh) * | 2015-07-10 | 2017-11-07 | 沈阳工业大学 | 三轴运动平台改进型交叉耦合控制装置及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104977901B (zh) | 三轴运动平台改进型交叉耦合控制装置及方法 | |
CN107132759B (zh) | 一种直线电机驱动fts基于eso滑模改进重复控制方法 | |
CN101834554B (zh) | 用负载扰动补偿器并对其优化设定来提高加工精度的方法 | |
Lin et al. | Robust fuzzy neural network sliding-mode control for two-axis motion control system | |
CN104460518B (zh) | 基于模糊扰动补偿直接驱动xy平台轮廓控制装置及方法 | |
Yao et al. | Precision motion control for electro-hydraulic servo systems with noise alleviation: A desired compensation adaptive approach | |
Lee | Modeling and control of a three-dimensional overhead crane | |
CN102033508B (zh) | 提高直接驱动xy平台轮廓加工精度方法 | |
CN102145808B (zh) | 工业型激光导引agv的双闭环控制***及控制方法 | |
Mannava et al. | Optimal tracking control of motion systems | |
CN105786036A (zh) | 一种抑制转子动不平衡扰动的控制力矩陀螺框架控制***及方法 | |
CN108123648B (zh) | 基于线性矩阵不等式与滑模控制的直线伺服位置跟踪控制 | |
CN103414419A (zh) | 基于模糊rbf网络滑模的双直线电机轮廓补偿装置与方法 | |
CN102637011B (zh) | 基于坐标变换和参数调整直接驱动数控平台鲁棒控制方法及其控制*** | |
Zhao et al. | Adaptive neural network nonsingular fast terminal sliding mode control for permanent magnet linear synchronous motor | |
CN107505841B (zh) | 一种基于干扰估计器的机械臂姿态鲁棒控制方法 | |
CN107370431A (zh) | 一种工业机器人用永磁同步电机模糊自抗扰控制方法 | |
CN102707666B (zh) | 基于方向场的电机驱动xy平台轮廓加工控制装置及方法 | |
CN108712131A (zh) | 一种基于比例积分系数调节的电流前馈控制方法及装置 | |
CN105676780B (zh) | 基于模糊小脑模型关节控制器的xy运动平台轮廓控制装置 | |
CN104834219A (zh) | 一种基于经验模态分解的pmlsm驱动xy平台控制方法及*** | |
Liu et al. | Contour error pre-compensation for three-axis machine tools by using cross-coupled dynamic friction control | |
CN204790506U (zh) | 三轴运动平台改进型交叉耦合控制装置 | |
CN104485864B (zh) | 直接驱动伺服***的二阶滑模控制***及其控制方法 | |
CN108923711A (zh) | 一种伺服***零点校对的绝对值编码器调零方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20151118 Termination date: 20180710 |