CN110515349A - 伺服进给系统的两轴交叉耦合控制器算法 - Google Patents

伺服进给系统的两轴交叉耦合控制器算法 Download PDF

Info

Publication number
CN110515349A
CN110515349A CN201910745996.1A CN201910745996A CN110515349A CN 110515349 A CN110515349 A CN 110515349A CN 201910745996 A CN201910745996 A CN 201910745996A CN 110515349 A CN110515349 A CN 110515349A
Authority
CN
China
Prior art keywords
axis
cross
controller
contour error
coupling controller
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.)
Granted
Application number
CN201910745996.1A
Other languages
English (en)
Other versions
CN110515349B (zh
Inventor
王国锋
盛延亮
曹增欢
赵云龙
安华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianjin University
Original Assignee
Tianjin University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Tianjin University filed Critical Tianjin University
Priority to CN201910745996.1A priority Critical patent/CN110515349B/zh
Publication of CN110515349A publication Critical patent/CN110515349A/zh
Application granted granted Critical
Publication of CN110515349B publication Critical patent/CN110515349B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/404Numerical 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 control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/35Nc in input of data, input till input file format
    • G05B2219/35408Calculate new position data from actual data to compensate for contour error

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)
  • Numerical Control (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

本发明公开了一种伺服进给系统的两轴交叉耦合控制器算法,步骤1、采集X轴和Y轴各自的跟随误差信号,计算伺服系统两轴在跟随误差信号经过轮廓误差数学模型之后输出的轮廓误差值ε;步骤2、计算轮廓误差值ε经过交叉耦合控制器后的轮廓误差放大值;步骤3、将计算得到的轮廓误差放大值U通过对应轴的补偿增益系数解耦,得到对应的交叉耦合控制器输出信号εx和εy;步骤4、将交叉耦合控制器的各轴输出信号补偿给伺服进给系统。与现有技术相比,本发明充分考虑到双轴伺服平台联动时由于各轴之间不匹配的动态特性导致的系统的轮廓误差;并基于此问题,对双轴联动时的曲线轮。

Description

伺服进给系统的两轴交叉耦合控制器算法
技术领域
本发明涉及伺服轮廓精度技术领域,特别是涉及利用交叉耦合算法来提高多轴协调运动时的轮廓精度的方法。
背景技术
由滚珠丝杠组成的双轴联动伺服进给系统广泛应用于各种机电一体化装置,如精密加工,纺织和轧钢等设备。在双轴联动伺服进给系统中,要想从整体上提高系统的轮廓精度,在考虑减少单轴跟踪误差的同时,还必须考虑两轴之间的位置同步性能。在工业生产中,机械装配误差、干扰以及轴与轴间不平衡的负载等诸多因素都会引起多轴系统的同步轮廓误差。因此在减小单轴跟随误差的同时,还需要采取一定的措施建立轴与轴之间沟通的桥梁,提高双轴联动时的协调程度,从而使得伺服进给系统能够以高精度运行。
国内外针对双轴同步协调控制的主要研究成果如下:为了减小双轴运行时的轮廓精度,早期多使用并行和主从协调控制策略。在并行协调控制中,当其中一个轴在外部干扰的作用下而无法正常运行时,与它联动的轴并不能做出相应的调节;在主从协调控制的情况下,当主轴受到外界干扰时,从动轴却可以随之做出相应的调节以保证系统的轮廓精度,而当从动轴受外界干扰时,主动轴则不会有任何反应,即该控制策略只能单向起作用。鉴于并行与主从模式各自的缺点,交叉耦合控制技术应运而生。其结构相对复杂一点儿,但它适用于协调要求高的场合,系统中任一轴受到干扰,都会做出调节,可提供更佳的协调性能。
为保证伺服进给系统能够实现更高的运动精度,满足企业生产等多领域的应用要求,研究伺服进给系统的精度补偿与交叉耦合控制具有重大意义。
发明内容
针对伺服系统在加工过程中因各轴动态特性差异引起的轮廓误差,本发明提出了一种伺服进给系统的两轴交叉耦合控制器算法,使用轮廓误差模型实时计算系统此时的轮廓误差值,从而计算得到轮廓误差的补偿量;之后,通过补偿增益系数对该补偿值进行解耦后,将解耦后的数值依次分配到对应的轴上,从而实现两轴联动时轮廓误差的交叉耦合控制。
本发明的一种伺服进给系统的两轴交叉耦合控制器算法,该算法包括以下步骤:
步骤1、采集X轴和Y轴各自的跟随误差信号,计算伺服系统两轴在跟随误差信号经过轮廓误差数学模型之后输出的轮廓误差值ε:
ε=-Exsinθ+Ey cosθ (1)
其中,Ex和Ey分别为X轴和Y轴的跟随误差信号;其中dy和dx分别为X轴和Y轴的位移微元,ε为伺服系统当前轮廓误差值;
步骤2、计算轮廓误差值ε经过交叉耦合控制器后的轮廓误差放大值:
U=Kpccε (2)
其中,Kpcc为交叉耦合控制器的比例增益,U为计算出的轮廓误差放大值;
步骤3、将计算得到的轮廓误差放大值U通过对应轴的补偿增益系数解耦,得到对应的交叉耦合控制器输出信号εx和εy
其中,εx和εy分别为交叉耦合控制器对X轴的输出分量和Y轴的输出分量,Cx和Cy分别是X轴补偿增益和Y轴补偿增益。当补偿增益Cx和Cy为固定值时为传统交叉耦合控制器;
此时补偿的轮廓误差分量在各轴分别表示为:
步骤4、将交叉耦合控制器的各轴输出信号补偿给伺服进给系统:
其中,ux0和uy0分别为伺服系统原X轴和Y轴位置控制算法输出值,ux和uy分别为X轴和Y轴电流环的输入信号,是X轴和Y轴原位置控制算法输出值与交叉耦合控制算法输出的叠加值,亦即两轴经补偿修正后控制器算法输出的控制律;交叉耦合控制器输出信号εx和εy将与伺服进给系统的位置环控制器的控制律进行求和叠加,共同作为伺服进给系统速度环的输入信号,叠加值ux和uy与速度环反馈的差值即电机的输入电压信号。
所述步骤3还包括变增益交叉耦合控制器的输出情况,相应的补偿增益Cx和Cy随着加工轨迹上期望点与坐标轴的夹角θ的变化而实时变化,当补偿增益系数Cx=-sinθ和Cy=cosθ时,为轮廓误差控制的最优选择参数。
与现有技术相比,本发明充分考虑到双轴伺服平台联动时由于各轴之间不匹配的动态特性导致的系统的轮廓误差;并基于此问题,对双轴联动时的曲线轮廓误差进行数学建模,在此基础上设计交叉耦合控制算法以提高系统运行时的轮廓精度。
附图说明
图1为本发明的伺服进给系统的两轴交叉耦合控制器算法模型示意图;
图2为伺服进给系统加工过程中的任意曲线轮廓误差定义示意图;
图3为伺服进给系统从轮廓轨迹指令到实际输出的变增益交叉耦合控制器示意图;
图4为有无交叉耦合控制算法作用下的圆弧运动轨迹误差分布图(a)有交叉耦合控制算法作用下;(b)有无交叉耦合控制算法作用下。
具体实施方式
下面将结合附图对本发明的实施方式作进一步的详细描述。
如图1所示的伺服进给系统的两轴交叉耦合控制器算法模型示意图。该算法模型通过采集X轴和Y轴各自的跟随误差信号,使用轮廓误差模型实时计算系统此时的轮廓误差值;再由交叉耦合控制器对该轮廓误差值进行控制,从而计算得到轮廓误差的补偿量;之后通过补偿增益系数对该补偿值进行解耦后,将解耦后的数值依次分配到对应的轴上,从而实现两轴联动时轮廓误差的交叉耦合控制。
本发明的一种伺服系统两轴交叉耦合控制算法,该算法包括以下步骤:
步骤1、计算伺服系统两轴在跟随误差信号经过轮廓误差数学模型之后输出的轮廓误差值ε:
ε=-Exsinθ+Ey cosθ (1)
其中,Ex和Ey分别为X轴和Y轴的跟随误差信号;其中dy和dx分别为X轴和Y轴的位移微元,ε为伺服系统当前轮廓误差值。当两轴(X轴和Y轴)进行直线插补时,公式(1)取等式。如图2所示为伺服进给系统加工过程中的任意曲线轮廓误差定义示意图;当两轴(X轴和Y轴)进行任意曲线轮廓插补时,轮廓误差ε为图2中M点至该曲线的距离。过点J作该曲线的内切圆,此时J点的曲率半径则对应着该内切圆的半径。将该伺服系统当前轮廓误差值ε近似表示为用M点和O点的距离减去内切圆半径的值er
步骤2、计算轮廓误差值ε经过交叉耦合控制器后的轮廓误差放大值:
U=Kpccε (2)
其中,Kpcc为交叉耦合控制器的比例增益,U为轮廓误差放大值;
步骤3、将计算得到的轮廓误差放大值通过对应轴的补偿增益系数解耦,得到对应的交叉耦合控制器输出信号εx和εy
其中,εx和εy分别为交叉耦合控制器对X轴的输出分量和Y轴的输出分量,Cx和Cy分别是X轴补偿增益和Y轴补偿增益。当补偿增益系数Cx和Cy为固定值时为传统交叉耦合控制器;而此处补偿增益Cx和Cy会随着加工轨迹上期望点与坐标轴的夹角θ的变化而实时变化,即为变增益交叉耦合控制器。当补偿增益系数Cx=-sinθ和Cy=cosθ时,可以很好地实现对系统轮廓误差的控制。
系统在运行过程中,若θ为一定值即系统直线运行时,交叉耦合控制器只需要每次补偿相同的值就能保证系统的轮廓精度;而当系统的运动轨迹比较复杂,即θ一直处于变化之中时,补偿增益系数也要随之不断地变化来降低系统的轮廓误差。此时补偿的轮廓误差分量在各轴分别表示为:
步骤4、将交叉耦合控制器的各轴输出信号补偿给伺服进给系统:
其中,ux0和uy0分别为伺服系统原X轴和Y轴位置控制算法输出值,一般为位置环PID算法的输出值。ux和uy分别为X轴和Y轴电流环的输入信号,是X轴和Y轴原位置控制算法输出值与交叉耦合控制算法输出的叠加值,亦即两轴经补偿修正后控制器算法输出的控制律。交叉耦合控制器输出信号εx和εy单位为V,其将与伺服进给系统的位置环控制器的控制律进行求和叠加,共同作为伺服进给系统速度环的输入信号,叠加值ux和uy与速度环反馈的差值即电机的输入电压信号。

Claims (2)

1.一种伺服进给系统的两轴交叉耦合控制器算法,其特征在于,该算法包括以下步骤:
步骤1、采集X轴和Y轴各自的跟随误差信号,计算伺服系统两轴在跟随误差信号经过轮廓误差数学模型之后输出的轮廓误差值ε:
ε=-Exsinθ+Eycosθ (1)
其中,Ex和Ey分别为X轴和Y轴的跟随误差信号;其中dy和dx分别为X轴和Y轴的位移微元,ε为伺服系统当前轮廓误差值;
步骤2、计算轮廓误差值ε经过交叉耦合控制器后的轮廓误差放大值:
U=Kpccε (2)
其中,Kpcc为交叉耦合控制器的比例增益,U为轮廓误差放大值;
步骤3、将计算得到的轮廓误差放大值U通过对应轴的补偿增益系数解耦,得到对应的交叉耦合控制器输出信号εx和εy
其中,εx和εy分别为交叉耦合控制器对X轴的输出分量和Y轴的输出分量,Cx和Cy分别是X轴补偿增益和Y轴补偿增益。当补偿增益Cx和Cy为固定值时为传统交叉耦合控制器;
此时补偿的轮廓误差分量在各轴分别表示为:
步骤4、将交叉耦合控制器的各轴输出信号补偿给伺服进给系统:
其中,ux0和uy0分别为伺服进给系统的X轴位置控制器和Y轴位置控制器的输出,ux和uy分别为X轴和Y轴电流环的输入信号,是X轴位置控制器和Y轴位置控制器的输出与交叉耦合控制器的输出的叠加值;交叉耦合控制器输出信号εx和εy将与伺服进给系统的位置环控制器的控制律进行求和叠加,共同作为伺服进给系统速度环的输入信号,叠加值ux和uy与速度环反馈的差值即电机的输入电压信号。
2.如权利要求1所述的一种伺服进给系统的两轴交叉耦合控制器算法,其特征在于,所述步骤3还包括变增益交叉耦合控制器的输出情况,相应的补偿增益Cx和Cy随着加工轨迹上期望点与坐标轴的夹角θ的变化而实时变化,当补偿增益系数Cx=-sinθ和Cy=cosθ时,为轮廓误差控制的最优选择参数。
CN201910745996.1A 2019-08-13 2019-08-13 伺服进给系统的两轴交叉耦合控制器算法 Active CN110515349B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910745996.1A CN110515349B (zh) 2019-08-13 2019-08-13 伺服进给系统的两轴交叉耦合控制器算法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910745996.1A CN110515349B (zh) 2019-08-13 2019-08-13 伺服进给系统的两轴交叉耦合控制器算法

Publications (2)

Publication Number Publication Date
CN110515349A true CN110515349A (zh) 2019-11-29
CN110515349B CN110515349B (zh) 2022-04-29

Family

ID=68625730

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910745996.1A Active CN110515349B (zh) 2019-08-13 2019-08-13 伺服进给系统的两轴交叉耦合控制器算法

Country Status (1)

Country Link
CN (1) CN110515349B (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111590570A (zh) * 2020-05-15 2020-08-28 西安航空职业技术学院 一种同步交叉耦合机器人轮廓控制方法
CN111624943A (zh) * 2020-05-15 2020-09-04 西安航空职业技术学院 一种位置环交叉耦合机器人轮廓控制方法
CN112286139A (zh) * 2020-09-24 2021-01-29 台州学院 基于神经网络和扰动观测的运动系统轮廓控制方法及系统
CN112363399A (zh) * 2020-11-24 2021-02-12 华南理工大学 用于数控加工中交叉耦合控制器增益参数寻优的控制方法
CN112578666A (zh) * 2020-11-25 2021-03-30 北京无线电测量研究所 一种天线伺服调转的控制方法和系统
CN112596389A (zh) * 2020-12-18 2021-04-02 杭州电子科技大学 基于闭环交叉耦合迭代学习的水晶研磨控制方法与系统
CN114102612A (zh) * 2022-01-24 2022-03-01 河北工业大学 一种机器人末端路径轮廓误差控制方法
CN115185231A (zh) * 2022-07-14 2022-10-14 哈硕永业精密机械(苏州)有限公司 一种双主轴双z轴立式加工中心的自动控制系统
CN115586745A (zh) * 2022-10-19 2023-01-10 江苏集萃精凯高端装备技术有限公司 精密加工设备的控制方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102323790A (zh) * 2011-07-15 2012-01-18 浙江工业大学 两轴数控系统的串级型迭代学习交叉耦合轮廓误差控制方法
CN104898564A (zh) * 2015-05-04 2015-09-09 大连理工大学 一种降低三轴联动轮廓误差的方法
CN106843146A (zh) * 2017-03-09 2017-06-13 大连理工大学 一种自适应变增益轮廓误差补偿方法
CN108363301A (zh) * 2018-02-11 2018-08-03 台州学院 基于干扰观测滑模变结构的轮廓误差交叉耦合控制方法
CN108363293A (zh) * 2018-02-13 2018-08-03 台州学院 一种基于pid控制的交叉耦合控制算法和系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102323790A (zh) * 2011-07-15 2012-01-18 浙江工业大学 两轴数控系统的串级型迭代学习交叉耦合轮廓误差控制方法
CN104898564A (zh) * 2015-05-04 2015-09-09 大连理工大学 一种降低三轴联动轮廓误差的方法
CN106843146A (zh) * 2017-03-09 2017-06-13 大连理工大学 一种自适应变增益轮廓误差补偿方法
CN108363301A (zh) * 2018-02-11 2018-08-03 台州学院 基于干扰观测滑模变结构的轮廓误差交叉耦合控制方法
CN108363293A (zh) * 2018-02-13 2018-08-03 台州学院 一种基于pid控制的交叉耦合控制算法和系统

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111624943A (zh) * 2020-05-15 2020-09-04 西安航空职业技术学院 一种位置环交叉耦合机器人轮廓控制方法
CN111590570A (zh) * 2020-05-15 2020-08-28 西安航空职业技术学院 一种同步交叉耦合机器人轮廓控制方法
CN111624943B (zh) * 2020-05-15 2023-07-07 西安航空职业技术学院 一种位置环交叉耦合机器人轮廓控制方法
CN111590570B (zh) * 2020-05-15 2022-08-05 西安航空职业技术学院 一种同步交叉耦合机器人轮廓控制方法
CN112286139B (zh) * 2020-09-24 2021-10-15 台州学院 基于神经网络和扰动观测的运动系统轮廓控制方法及系统
CN112286139A (zh) * 2020-09-24 2021-01-29 台州学院 基于神经网络和扰动观测的运动系统轮廓控制方法及系统
CN112363399A (zh) * 2020-11-24 2021-02-12 华南理工大学 用于数控加工中交叉耦合控制器增益参数寻优的控制方法
CN112578666A (zh) * 2020-11-25 2021-03-30 北京无线电测量研究所 一种天线伺服调转的控制方法和系统
CN112596389B (zh) * 2020-12-18 2022-05-17 杭州电子科技大学 基于闭环交叉耦合迭代学习的水晶研磨控制方法与系统
CN112596389A (zh) * 2020-12-18 2021-04-02 杭州电子科技大学 基于闭环交叉耦合迭代学习的水晶研磨控制方法与系统
CN114102612A (zh) * 2022-01-24 2022-03-01 河北工业大学 一种机器人末端路径轮廓误差控制方法
CN114102612B (zh) * 2022-01-24 2022-05-03 河北工业大学 一种机器人末端路径轮廓误差控制方法
CN115185231A (zh) * 2022-07-14 2022-10-14 哈硕永业精密机械(苏州)有限公司 一种双主轴双z轴立式加工中心的自动控制系统
CN115586745A (zh) * 2022-10-19 2023-01-10 江苏集萃精凯高端装备技术有限公司 精密加工设备的控制方法

Also Published As

Publication number Publication date
CN110515349B (zh) 2022-04-29

Similar Documents

Publication Publication Date Title
CN110515349B (zh) 伺服进给系统的两轴交叉耦合控制器算法
CN108363301B (zh) 基于干扰观测滑模变结构的轮廓误差交叉耦合控制方法
CN104166372B (zh) 一种进给系统双位置环反馈的抗扰控制器
CN106338970B (zh) 一种五轴联动数控机床伺服系统控制方法
CN110032142B (zh) 基于数控加工路径最小化修正的轮廓误差预补偿方法
CN110488749B (zh) 一种多轴运动系统的轮廓误差控制器及其控制方法
CN108363293B (zh) 一种基于pid控制的交叉耦合控制算法和系统
CN108614425A (zh) 移动机器人自适应积分滑模控制方法
CN113156819B (zh) 协调打磨机械臂系统自适应神经网络同步阻抗控制方法
CN103869748B (zh) 非圆曲面xy直驱加工廓形误差交叉耦合控制系统及方法
Wang et al. Accelerated iteration algorithm based contouring error estimation for multiaxis motion control
CN106200553B (zh) 随动与轮廓误差在线协同补偿方法
CN109901511B (zh) 一种伺服系统轮廓误差的控制算法
CN107589720A (zh) 一种等效平面交叉耦合控制方法
Wang et al. A new synchronous error control method for CNC machine tools with dual-driving systems
CN111673742A (zh) 一种工业机器人轨迹跟踪控制算法
CN105929791B (zh) 平面直角坐标运动系统的直接轮廓控制方法
CN108490874B (zh) 一种双轴运动控制系统的非线性pid交叉耦合控制方法
CN102566466A (zh) 三自由度球面并联机构姿态闭环控制方法
CN108724195B (zh) 一种针对机器人的耦合前馈控制方法
CN111590570B (zh) 一种同步交叉耦合机器人轮廓控制方法
CN106020125B (zh) 一种基于速度连续的工业机器人运动学算法
CN116107262B (zh) 一种基于数控加工路径全局解析重构的轮廓误差预补偿方法
CN108873820B (zh) 一种从动轴参考指令实时修正的多轴速率伺服系统同步控制方法
Yeh et al. Design of perfectly matched zero-phase error tracking control for multi-axis motion control systems

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
GR01 Patent grant
GR01 Patent grant