CN115268369A - 一种龙门机床动梁交叉耦合控制方法 - Google Patents
一种龙门机床动梁交叉耦合控制方法 Download PDFInfo
- Publication number
- CN115268369A CN115268369A CN202210980682.1A CN202210980682A CN115268369A CN 115268369 A CN115268369 A CN 115268369A CN 202210980682 A CN202210980682 A CN 202210980682A CN 115268369 A CN115268369 A CN 115268369A
- Authority
- CN
- China
- Prior art keywords
- machine tool
- control
- gantry
- model
- servo
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 49
- 238000006880 cross-coupling reaction Methods 0.000 title claims abstract description 25
- 230000001360 synchronised effect Effects 0.000 claims abstract description 34
- 230000008569 process Effects 0.000 claims abstract description 18
- 239000011159 matrix material Substances 0.000 claims description 30
- 238000006073 displacement reaction Methods 0.000 claims description 12
- 238000013461 design Methods 0.000 claims description 9
- 238000013016 damping Methods 0.000 claims description 6
- 230000007246 mechanism Effects 0.000 claims description 6
- 238000005381 potential energy Methods 0.000 claims description 6
- 230000000694 effects Effects 0.000 claims description 4
- 238000004458 analytical method Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 claims description 3
- 230000009125 negative feedback regulation Effects 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims 1
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 11
- 230000008859 change Effects 0.000 description 3
- 238000003754 machining Methods 0.000 description 3
- 230000001629 suppression Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000013519 translation Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 230000004907 flux Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23Q—DETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
- B23Q1/00—Members which are comprised in the general build-up of a form of machine, particularly relatively large fixed members
- B23Q1/25—Movable or adjustable work or tool supports
- B23Q1/44—Movable or adjustable work or tool supports using particular mechanisms
- B23Q1/56—Movable or adjustable work or tool supports using particular mechanisms with sliding pairs only, the sliding pairs being the first two elements of the mechanism
- B23Q1/60—Movable or adjustable work or tool supports using particular mechanisms with sliding pairs only, the sliding pairs being the first two elements of the mechanism two sliding pairs only, the sliding pairs being the first two elements of the mechanism
- B23Q1/62—Movable or adjustable work or tool supports using particular mechanisms with sliding pairs only, the sliding pairs being the first two elements of the mechanism two sliding pairs only, the sliding pairs being the first two elements of the mechanism with perpendicular axes, e.g. cross-slides
- B23Q1/621—Movable or adjustable work or tool supports using particular mechanisms with sliding pairs only, the sliding pairs being the first two elements of the mechanism two sliding pairs only, the sliding pairs being the first two elements of the mechanism with perpendicular axes, e.g. cross-slides a single sliding pair followed perpendicularly by a single sliding pair
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/408—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by data handling or data format, e.g. reading, buffering or conversion of data
- G05B19/4086—Coordinate conversions; Other special calculations
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B6/00—Internal feedback arrangements for obtaining particular characteristics, e.g. proportional, integral or differential
- G05B6/02—Internal feedback arrangements for obtaining particular characteristics, e.g. proportional, integral or differential electric
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/13—Observer control, e.g. using Luenberger observers or Kalman filters
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/12—Observer control, e.g. using Luenberger observers or Kalman filters
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/04—Arrangements for controlling or regulating the speed or torque of more than one motor
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/34—Modelling or simulation for control purposes
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/35—Nc in input of data, input till input file format
- G05B2219/35356—Data handling
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2207/00—Indexing scheme relating to controlling arrangements characterised by the type of motor
- H02P2207/05—Synchronous machines, e.g. with permanent magnets or DC excitation
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Control Of Position Or Direction (AREA)
- Numerical Control (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种龙门机床动梁交叉耦合控制方法,涉及数控机床控制领域,该龙门机床动梁交叉耦合控制方法包括:步骤1:建立考虑横梁上滑枕的横梁动力学模型,同时将该模型进行化简用于观测器的设计;步骤2:按照单边伺服控制***参数整定的方法进行,使用相同控制参数的伺服***共同驱动横梁上下移动,实现同步控制,实现两端电机PID控制参数整定;与现有技术相比,本发明的有益效果是:本发明在实际应用于大型动梁式龙门加工中心不仅减小了横梁因机械结构差异而扭转产生的同步误差,并且解决了横梁移动部件在运动过程中造成的两侧负载不对称造成的同步误差,而且提高了***鲁棒性和稳定性。
Description
技术领域
本发明涉及数控机床控制领域,具体是一种龙门机床动梁交叉耦合控制方法。
背景技术
高端数控机床作为“工业母机”的核心,其结构和控制精度是影响其可靠性的关键一环,研究高端数控机床的共性关键技术,对推动我国制造业的发展有着重要作用。龙门加工中心作为一种常见的高端数控机床,其动梁式结构可以通过横梁移动完成大质量、大体积、形状不规则部件的加工,例如海上的大型潜艇、大型船舶的关键零部件等。
而动梁式龙门加工中心在实际应用中更加广泛,保证横梁运动时同步驱动精度是保证加工质量的关键。因此,研究横梁运动时同步驱动策略有着重要意义。
现有数控***的同步算法很少考虑横梁上移动部件运动过程中引起的横梁质心改变的问题,导致同步误差较大。横梁运动时两侧的同步误差会影响龙门机床的加工精度并降低***动态响应,需要改进。
发明内容
本发明的目的在于提供一种龙门机床动梁交叉耦合控制方法,以解决上述背景技术中提出的问题。
为实现上述目的,本发明提供如下技术方案:
一种龙门机床动梁交叉耦合控制方法,包括:
步骤1:建立考虑横梁上滑枕的横梁动力学模型,同时将该模型进行化简用于观测器的设计;
步骤2:按照单边伺服控制***参数整定的方法进行,实现两端电机PID控制参数整定,使用相同控制参数的伺服***共同驱动横梁上下移动(两侧的结构对称),实现同步控制;
步骤3:采用交叉耦合同步控制来反馈两轴之间的相互影响,并设计干扰观测器将输出补偿到相应的轴,构成另外一个闭环回路;
步骤4:设计干扰观测器,并对干扰进行补偿,提高***的鲁棒性的同时减小同步误差。
作为本发明再进一步的方案:步骤1包括:
步骤11:采用广义三自由度坐标系(Z,θ,Y)或位置坐标系(Z1,Z2,Y)建立横梁组合体的三自由度运动学模型;
步骤12:获取龙门横梁机构的横梁移动过程中的微分方程;
步骤13:对横梁移动过程中的微分方程进行化简。
作为本发明再进一步的方案:步骤11中:采用位置坐标系(Z1,Z2,Y)或广义三自由度坐标系(Z,θ,Y)建立横梁组合体的运动学模型:
两个模型可互相转换,其中:θ为横梁的偏转角度、L为横梁跨度、z为横梁平动位移量、y为移动部件距离横梁重心的位移量、z1和z2为两轴平动位移量。
作为本发明再进一步的方案:步骤12中:龙门横梁转动惯量J可以表示为:
根据拉格朗日方程建立横梁移动过程中的微分方程需要提前定义与其动态性相关的能量表达式,包括动能T、弹性势能V、瑞利耗散函数D、横梁质量M;移动部件质量m,表达式如下:
瑞利耗散函数D中:k1、k2分别为横梁两侧与滑座之间的摩擦系数、kbh为横梁与移动部件之间的摩擦系数;
由于龙门横梁为刚体结构,可认为势能不变,即:
V=0;(4)
对于广义三自由度坐标系(Z,θ,Y),其对应的广义力为:
其中,Fi和fi(i=1,2,3)是伺服电机驱动力和摩擦力(i=1,2,3分别代表沿Z,θ,Y方向)。
联合(2)~(5),代入到带耗散的拉格朗日方程(6)中:
其中:广义坐标qj=(Z,θ,Y);广义力Fj=(Fz,Fθ,Fy);L=T-V。;
龙门横梁机构的横梁移动过程中的微分方程可以表示为:
其中,M、C、K分别为质量矩阵、阻尼系数矩阵、刚度系数矩阵;H为科里奥利向心矩阵;广义坐标向量:q=(Z,θ,Y)T;广义力向量:F=(Fz,Fθ,Fy)T。
作为本发明再进一步的方案:步骤13中:龙门横梁在实际运动过程中,扭转角度θ很小(θ<0.0001rad),故可化简为cosθ≈1;sinθ≈0,则(7)中质量矩阵M中元素可近似为:
同理,科里奥利向心矩阵中所有元素可以忽略不计,即H≈0;取***动力学方程中关于z和θ两式进行分析,可以将(7)化简为:
Ms、Cs、Ks分别为化简后的质量矩阵、阻尼系数矩阵、刚度系数矩阵;化简后的广义坐标向量:qs=(Z,θ,Y)T;化简后的广义力向量:Fs=(Fz,Fθ,Fy)T。
(9)式中各矩阵形式如下:
对于y轴,其独立的运动学微分方程为:
作为本发明再进一步的方案:步骤2包括:
步骤21:构建伺服电机的控制模型;
步骤22:构建伺服***三环建模;
步骤23:完成伺服***三环参数整定。
作为本发明再进一步的方案:步骤21中:根据永磁电机在d-q坐标系下的数学模型,并选用id=0的控制方法实现d、q两轴解耦,得到在id=0控制方式下的永磁同步电机控制模型。
作为本发明再进一步的方案:步骤22中:步骤22中:基于永磁同步电机控制模型,对伺服控制***进行设计,电流环、速度环以及位置环是三个相互关联且基于PID控制器的闭环负反馈调节***,伺服控制***对电流环、速度环、位置环三环进行控制,达到控制电机的输出转矩、运行速度、输出位置的目的。
作为本发明再进一步的方案:步骤23中:龙门机床横梁双驱动两侧选用相同的电机,通过伺服***三环建模先进行单侧的伺服***的三环参数整定,然后用具有相同控制参数的两伺服***共同驱动龙门机床横梁,实现同步控制。
作为本发明再进一步的方案:步骤4中:DOB(干扰观测器)包括对象的传递函数P(s)、对象的名义模型Pn -1(s)、干扰观测值控制输入r、测量噪声ζ、低通滤波器Q(s),等效干扰d(外界干扰、名义模型的建模误差折合);
低通滤波器Q(s)的设计影响DOB的实际性能,故DOB的设计问题转化为低通滤波器Q(s)的设计问题,Q(s)的模型描述为:
其中,τ是时间常数(截止频率的倒数);N是分母阶数;M是分子阶数;N-M是相对阶;
Q(s)的阶次会影响***的稳定性,分母阶次越大,***越稳定,高阶次的Q(s)出现相位滞后现象,削弱对干扰的补偿作用;分子阶次增大会抵消相位滞后现象,提高***抗干扰能力,但会破坏***稳定性;
龙门横梁的同步控制***的名义模型Pn(s)可以通过基于最小二乘法的参数辨识原理获得,采集驱动力矩信号作为输入信号和横梁端的位移信号作为输出信号来对控制对象进行参数辨识。得到的名义模型Pn(s)如(13)所示:
以模型(13)作为两轴的名义模型,考虑控制精度、***鲁棒性和稳定性,在满足(12)的所有式子中,模型(14)的性能是最好的,其相对阶次为2,可以获得较好的抗干扰性能和噪音抑制性能。
模型(14)为Q31(s)型低通滤波器,时间常数选为τ=0.005s,可得:
与现有技术相比,本发明的有益效果是:本发明在实际应用于大型动梁式龙门加工中心不仅减小了横梁因机械结构差异而扭转产生的同步误差,并且解决了横梁移动部件在运动过程中造成的两侧负载不对称造成的同步误差,而且提高了***鲁棒性和稳定性。
附图说明
图1为一种龙门机床动梁交叉耦合控制方法的流程图。
图2为交叉耦合控制的原理图。
图3为龙门横梁同步驱动结构的示意图。
图4为永磁同步电机d-q坐标系下的控制结构图。
图5为伺服***的控制框图。
图6为电机三环参数的示意图。
图7为龙门机床交叉耦合同步控制结构示意图。
图8为DOB的内部结构图。
图9为横梁上移动部件运动过程中的同步误差示意图。
图10为阶跃干扰下PID控制器的同步误差示意图。
图11为阶跃干扰下DOB观测器的同步误差示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例,基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
请参阅图1,一种龙门机床动梁交叉耦合控制方法,包括:
步骤1:建立考虑横梁上滑枕的横梁动力学模型,同时将该模型进行化简用于观测器的设计;
步骤2:按照单边伺服控制***参数整定的方法进行,实现两端电机PID控制参数整定,使用相同控制参数的伺服***共同驱动横梁上下移动(两侧的结构对称),实现同步控制;
步骤3:采用交叉耦合同步控制来反馈两轴之间的相互影响,并设计干扰观测器将输出补偿到相应的轴,构成另外一个闭环回路;
步骤4:设计干扰观测器,并对干扰进行补偿,提高***的鲁棒性的同时减小同步误差。
在具体实施例中:横梁动力学模型中的两轴(横梁变化)变化通过干扰观测器将输出补偿到相应的轴,以此高***的鲁棒性的同时减小两轴的同步误差。其中交叉耦合如图2所示。
在步骤3中:伺服控制***主要包括电机以及所需设计的观测器,通过电机的三环参数整定以及观测器的观测结果进行驱动***的控制,驱动***包括由两根滚珠丝杠驱动的龙门横梁,其两端的位置信号可以由光栅尺以及编码器测得,并将位置信号反馈给伺服控制***,以此构建反馈补偿闭合回路。
在本实施例中:请参阅图3,步骤1包括:
步骤11:采用广义三自由度坐标系(Z,θ,Y)或位置坐标系(Z1,Z2,Y)建立横梁组合体的三自由度运动学模型;
步骤12:获取龙门横梁机构的横梁移动过程中的微分方程;
步骤13:对横梁移动过程中的微分方程进行化简。
两个模型可互相转换,其中:θ为横梁的偏转角度、L为横梁跨度、z为横梁平动位移量、y为移动部件距离横梁重心的位移量、z1和z2为两轴平动位移量、M为横梁质量、m为移动部件质量。
龙门横梁同步驱动结构一般由两个相同的伺服电机分别驱动Z1和Z2轴的滚珠丝杠带动横梁上下移动,同时横梁上的滑枕与刀架(下文统称为移动部件)在Y轴上移动,同时将其看作集中质量块,而横梁两侧运动不同步导致的最终结果为横梁会有小角度的扭转。
在本实施例中:请参阅图3,步骤12中:龙门横梁转动惯量J可以表示为:
根据拉格朗日方程建立横梁移动过程中的微分方程需要提前定义与其动态性相关的能量表达式,包括动能T、弹性势能V、瑞利耗散函数D、横梁质量M;移动部件质量m,表达式如下:
瑞利耗散函数D中:k1、k2分别为横梁两侧与滑座之间的摩擦系数、kbh为横梁与移动部件之间的摩擦系数;
由于龙门横梁为刚体结构,可认为势能不变,即:
V=0;(4)
对于广义三自由度坐标系(Z,θ,Y),其对应的广义力为:
其中,Fi和fi(i=1,2,3)是伺服电机驱动力和摩擦力(i=1,2,3分别代表沿Z,θ,Y方向)。
联合(2)~(5),代入到带耗散的拉格朗日方程(6)中:
其中:广义坐标qj=(Z,θ,Y);广义力Fj=(Fz,Fθ,Fy);L=T-V。;
龙门横梁机构的横梁移动过程中的微分方程可以表示为:
其中,M、C、K分别为质量矩阵、阻尼系数矩阵、刚度系数矩阵;H为科里奥利向心矩阵;广义坐标向量:q=(Z,θ,Y)T;广义力向量:F=(Fz,Fθ,Fy)T。
在本实施例中:请参阅图3,步骤13中:龙门横梁在实际运动过程中,扭转角度θ很小(θ<0.0001rad),故可化简为cosθ≈1;sinθ≈0,则(7)中质量矩阵M中元素可近似为:
同理,科里奥利向心矩阵中所有元素可以忽略不计,即H≈0;取***动力学方程中关于z和θ两式进行分析,可以将(7)化简为:
Ms、Cs、Ks分别为化简后的质量矩阵、阻尼系数矩阵、刚度系数矩阵;化简后的广义坐标向量:qs=(Z,θ,Y)T;化简后的广义力向量:Fs=(Fz,Fθ,Fy)T。
(9)式中各矩阵形式如下:
对于y轴,其独立的运动学微分方程为:
在本实施例中:步骤2包括:
步骤21:构建伺服电机的控制模型;
步骤22:构建伺服***三环建模;
步骤23:完成伺服***三环参数整定。
在本实施例中:请参阅图4,步骤21中:根据永磁电机在d-q坐标系下的数学模型,并选用id=0的控制方法实现d、q两轴解耦,得到在id=0控制方式下的永磁同步电机控制模型。
图4中:KE=npψf,称为电机反电动势系数。KT=1.5npψf,称为电机转矩常量(np为磁极对数;ψf为永磁体磁链)。
在本实施例中:请参阅图5,步骤22中:基于永磁同步电机控制模型,对伺服控制***进行设计,电流环、速度环以及位置环是三个相互关联且基于PID控制器的闭环负反馈调节***,伺服控制***对电流环、速度环、位置环三环进行控制,达到控制电机的输出转矩、运行速度、输出位置的目的。
在图5中电流环和速度环使用PI控制器,位置环使用P控制器,Kp、Kv、Ki分别为位置环、速度环、电流环的反馈系数。故电流环和速度环需要整定比例系数和积分时间常数,位置环只需整定比例系数。
在本实施例中:请参阅图6,步骤23中:龙门机床横梁双驱动两侧选用相同的电机,通过伺服***三环建模先进行单侧的伺服***的三环参数整定,然后用具有相同控制参数的两伺服***共同驱动龙门机床横梁,实现同步控制。
利用MATLAB/Simulink中的PID Tuner工具进行各参数的整定结果如图6所示。
在本实施例中:请参阅图7,步骤3中:龙门机床横梁同步驱动交叉耦合同步控制结构示意图如图7所示。伺服控制***主要包括电机以及所需设计的观测器,通过电机的三环参数整定以及观测器的观测结果进行驱动***的控制。驱动***主要包括由两根滚珠丝杠驱动的龙门横梁,其两端的位置信号可以由光栅尺以及编码器测得,并将位置信号反馈给伺服控制***。
在本实施例中:请参阅图8,步骤4中:DOB(干扰观测器)包括对象的传递函数P(s)、对象的名义模型Pn -1(s)、干扰观测值控制输入r、测量噪声ζ、低通滤波器Q(s),等效干扰d(外界干扰、名义模型的建模误差折合);
低通滤波器Q(s)的设计影响DOB的实际性能,故DOB的设计问题转化为低通滤波器Q(s)的设计问题,Q(s)的模型描述为:
其中,τ是时间常数(截止频率的倒数);N是分母阶数;M是分子阶数;N-M是相对阶;
Q(s)的阶次会影响***的稳定性,分母阶次越大,***越稳定,高阶次的Q(s)出现相位滞后现象,削弱对干扰的补偿作用;分子阶次增大会抵消相位滞后现象,提高***抗干扰能力,但会破坏***稳定性;
龙门横梁的同步控制***的名义模型Pn(s)可以通过基于最小二乘法的参数辨识原理获得,采集驱动力矩信号作为输入信号和横梁端的位移信号作为输出信号来对控制对象进行参数辨识。得到的名义模型Pn(s)如(13)所示:
以模型(13)作为两轴的名义模型,考虑控制精度、***鲁棒性和稳定性,在满足(12)的所有式子中,模型(14)的性能是最好的,其相对阶次为2,可以获得较好的抗干扰性能和噪音抑制性能。
模型(14)为Q31(s)型低通滤波器,时间常数选为τ=0.005s,可得:
在具体实施例中:请参阅图9、图10、图11,本控制算法经验证测试结果显示,使用DOB观测器可以对横梁质心变化产生的同步误差有很好的调节能力(图9),最大同步误差为0.33mm,相比于使用传统PID控制器的最大同步误差0.48mm有很好的补偿效果。当受到阶跃干扰时(图10、图11),采用DOB观测器的同步误差调节时间0.8s,虽大于PID控制器的0.5s;但同步误差最大值仅为0.24mm远小于PID控制器的0.4mm。上述结果表明:横梁同步控制的干扰抑制性能和***稳定性在加入DOB观测器后得到了显著提高。
对于本领域技术人员而言,显然本发明不限于上述示范性实施例的细节,而且在不背离本发明的精神或基本特征的情况下,能够以其他的具体形式实现本发明。因此,无论从哪一点来看,均应将实施例看作是示范性的,而且是非限制性的,本发明的范围由所附权利要求而不是上述说明限定,因此旨在将落在权利要求的等同要件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。
此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。
Claims (10)
1.一种龙门机床动梁交叉耦合控制方法,其特征在于:
该龙门机床动梁交叉耦合控制方法包括:
步骤1:建立考虑横梁上滑枕的横梁动力学模型,同时将该模型进行化简用于观测器的设计;
步骤2:按照单边伺服控制***参数整定的方法进行,实现两端电机PID控制参数整定;使用相同控制参数的伺服***共同驱动横梁上下移动,实现同步控制;
步骤3:采用交叉耦合同步控制来反馈两轴之间的相互影响,并设计干扰观测器将输出补偿到相应的轴,构成另外一个闭环回路;
步骤4:设计干扰观测器,并对干扰进行补偿,提高***的鲁棒性的同时减小同步误差。
2.根据权利要求1所述的龙门机床动梁交叉耦合控制方法,其特征在于,步骤1包括:
步骤11:采用广义三自由度坐标系或位置坐标系建立横梁组合体的三自由度运动学模型;
步骤12:获取龙门横梁机构的横梁移动过程中的微分方程;
步骤13:对横梁移动过程中的微分方程进行化简。
4.根据权利要求2所述的龙门机床动梁交叉耦合控制方法,其特征在于,步骤12中:龙门横梁转动惯量J表示为:
根据拉格朗日方程建立横梁移动过程中的微分方程需要提前定义与其动态性相关的能量表达式,包括动能T、弹性势能V、瑞利耗散函数D、横梁质量M;移动部件质量m,表达式如下:
瑞利耗散函数D中:k1、k2分别为横梁两侧与滑座之间的摩擦系数、kbh为横梁与移动部件之间的摩擦系数;
由于龙门横梁为刚体结构,势能不变,即:
V=0;
(4)
对于广义三自由度坐标系,其对应的广义力为:
其中,Fi和fi是伺服电机驱动力和摩擦力;
联合(2)~(5),代入到带耗散的拉格朗日方程(6)中:
其中:广义坐标qj=(Z,θ,Y);广义力Fj=(Fz,Fθ,Fy);L=T-V。;
龙门横梁机构的横梁移动过程中的微分方程表示为:
其中,M、C、K分别为质量矩阵、阻尼系数矩阵、刚度系数矩阵;H为科里奥利向心矩阵;广义坐标向量:q=(Z,θ,Y)T;广义力向量:F=(Fz,Fθ,Fy)T。
6.根据权利要求1所述的龙门机床动梁交叉耦合控制方法,其特征在于,步骤2包括:
步骤21:构建伺服电机的控制模型;
步骤22:构建伺服***三环建模;
步骤23:完成伺服***三环参数整定。
7.根据权利要求6所述的龙门机床动梁交叉耦合控制方法,其特征在于,步骤21中:根据永磁电机在d-q坐标系下的数学模型,并选用id=0的控制方法实现d、q两轴解耦,得到在id=0控制方式下的永磁同步电机控制模型。
8.根据权利要求6所述的龙门机床动梁交叉耦合控制方法,其特征在于,步骤22中:基于永磁同步电机控制模型,对伺服控制***进行设计,电流环、速度环以及位置环是三个相互关联且基于PID控制器的闭环负反馈调节***,伺服控制***对电流环、速度环、位置环三环进行控制,达到控制电机的输出转矩、运行速度、输出位置的目的。
9.根据权利要求6所述的龙门机床动梁交叉耦合控制方法,其特征在于,步骤23中:龙门机床横梁双驱动两侧选用相同的电机,通过伺服***三环建模先进行单侧的伺服***的三环参数整定,然后用具有相同控制参数的两伺服***共同驱动龙门机床横梁,实现同步控制。
10.根据权利要求1所述的龙门机床动梁交叉耦合控制方法,其特征在于,步骤4中:DOB包括对象的传递函数P(s)、对象的名义模型Pn -1(s)、干扰观测值控制输入r、测量噪声ζ、低通滤波器Q(s),等效干扰d;
低通滤波器Q(s)的设计影响DOB的实际性能,故DOB的设计问题转化为低通滤波器Q(s)的设计问题,Q(s)的模型描述为:
其中,τ是时间常数;N是分母阶数;M是分子阶数;N-M是相对阶;
Q(s)的阶次会影响***的稳定性,分母阶次越大,***越稳定,高阶次的Q(s)出现相位滞后现象,削弱对干扰的补偿作用;分子阶次增大会抵消相位滞后现象,提高***抗干扰能力,但会破坏***稳定性;
龙门横梁的同步控制***的名义模型Pn(s)通过基于最小二乘法的参数辨识原理获得,采集驱动力矩信号作为输入信号和横梁端的位移信号作为输出信号来对控制对象进行参数辨识。得到的名义模型Pn(s)如(13)所示:
以模型(13)作为两轴的名义模型,考虑控制精度、***鲁棒性和稳定性,在满足(12)的所有式子中,模型(14)的相对阶次为2;
模型(14)为Q31(s)型低通滤波器,时间常数为τ=0.005s,可得:
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210980682.1A CN115268369A (zh) | 2022-08-16 | 2022-08-16 | 一种龙门机床动梁交叉耦合控制方法 |
PCT/CN2023/111894 WO2024037394A1 (zh) | 2022-08-16 | 2023-08-09 | 一种龙门机床动梁交叉耦合控制方法 |
US18/508,333 US20240082966A1 (en) | 2022-08-16 | 2023-11-14 | Cross-coupling control method for moving beam of gantry machine tool |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210980682.1A CN115268369A (zh) | 2022-08-16 | 2022-08-16 | 一种龙门机床动梁交叉耦合控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115268369A true CN115268369A (zh) | 2022-11-01 |
Family
ID=83751360
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210980682.1A Pending CN115268369A (zh) | 2022-08-16 | 2022-08-16 | 一种龙门机床动梁交叉耦合控制方法 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20240082966A1 (zh) |
CN (1) | CN115268369A (zh) |
WO (1) | WO2024037394A1 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115580189A (zh) * | 2022-11-08 | 2023-01-06 | 哈尔滨工业大学 | 具有扰动抑制的高速龙门双驱同步控制方法及*** |
WO2024037394A1 (zh) * | 2022-08-16 | 2024-02-22 | 吉林大学 | 一种龙门机床动梁交叉耦合控制方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7680547B2 (en) * | 2006-06-08 | 2010-03-16 | Liu Hugh H T | Method, system and computer program for generic synchronized motion control for multiple dynamic systems |
CN107085373A (zh) * | 2017-06-01 | 2017-08-22 | 浙江工业大学 | 一种基于通信干扰观测器的网络化多轴运动控制***的交叉耦合控制方法 |
CN108363301B (zh) * | 2018-02-11 | 2020-12-18 | 台州学院 | 基于干扰观测滑模变结构的轮廓误差交叉耦合控制方法 |
TWI726498B (zh) * | 2019-11-22 | 2021-05-01 | 財團法人工業技術研究院 | 龍門機構線上慣量匹配同步控制方法 |
CN112904741A (zh) * | 2021-01-14 | 2021-06-04 | 上海交通大学 | 一种双驱龙门桁架***的高精度同步控制方法及*** |
CN115268369A (zh) * | 2022-08-16 | 2022-11-01 | 吉林大学 | 一种龙门机床动梁交叉耦合控制方法 |
-
2022
- 2022-08-16 CN CN202210980682.1A patent/CN115268369A/zh active Pending
-
2023
- 2023-08-09 WO PCT/CN2023/111894 patent/WO2024037394A1/zh unknown
- 2023-11-14 US US18/508,333 patent/US20240082966A1/en active Pending
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024037394A1 (zh) * | 2022-08-16 | 2024-02-22 | 吉林大学 | 一种龙门机床动梁交叉耦合控制方法 |
CN115580189A (zh) * | 2022-11-08 | 2023-01-06 | 哈尔滨工业大学 | 具有扰动抑制的高速龙门双驱同步控制方法及*** |
CN115580189B (zh) * | 2022-11-08 | 2023-07-25 | 哈尔滨工业大学 | 具有扰动抑制的高速龙门双驱同步控制方法及*** |
Also Published As
Publication number | Publication date |
---|---|
US20240082966A1 (en) | 2024-03-14 |
WO2024037394A1 (zh) | 2024-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108762096B (zh) | 一种基于离散型非线性级联扩张状态观测器的控制力矩陀螺框架***扰动抑制方法 | |
CN115268369A (zh) | 一种龙门机床动梁交叉耦合控制方法 | |
CN106338970B (zh) | 一种五轴联动数控机床伺服***控制方法 | |
CN102385342B (zh) | 虚拟轴机床并联机构运动控制的自适应动态滑模控制方法 | |
CN110716506A (zh) | 一种基于混合滑模控制的伺服***位置跟踪控制方法 | |
CN108536185B (zh) | 一种基于降阶级联扩张状态观测器的双框架磁悬浮cmg框架***参数优化方法 | |
CN110032142A (zh) | 基于数控加工路径最小化修正的轮廓误差预补偿方法 | |
CN110649845B (zh) | 基于鲁棒广义预测控制的光电转台位置跟踪控制方法 | |
CN110968037B (zh) | 一种减小多轴运动***轮廓误差的控制方法 | |
CN109657282A (zh) | 一种基于拉格朗日动力学的h型运动平台建模方法 | |
CN108983595B (zh) | 一种前馈控制器参数的自动整定方法 | |
CN111947959A (zh) | 一种电惯量模拟方法 | |
CN108453741A (zh) | 一种工业机器人柔性伺服控制方法 | |
CN104635621A (zh) | 基于现场总线的xy工作台过象限凸起补偿方法 | |
Rassudov et al. | Dynamic model exact tracking control of a permanent magnet synchronous motor | |
CN103309280B (zh) | 一种用于重型并联机床的双前馈控制*** | |
CN116442223A (zh) | 一种机械手***轨迹跟踪的非线性动态控制器设计方法 | |
Krishnamurthy et al. | Control design and implementation for sawyer motors used in manufacturing systems | |
Salihbegovic et al. | High performance disturbance observer based control of the nonlinear 2DOF helicopter system | |
Krishnamurthy et al. | Control design implementation for Sawyer motors used in manufacturing systems | |
Peukert et al. | Flexible coupling of drive and guide elements for parallel-driven feed axes to increase dynamics and accuracy of motion | |
Li et al. | Backstepping integral nonsingular terminal sliding mode based fault-tolerant control of dual-motor synchronous anti-backlash servo system with extended state observer | |
Dai et al. | Super-twisting sliding mode control design for electric dynamic load simulator | |
CN111293949B (zh) | 一种抗干扰电动六自由度并联机构控制方法 | |
CN112247984B (zh) | 一种变刚度关节轨迹跟踪控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |