CN112067262B - 一种用于伺服驱动轴的跟踪误差估计方法 - Google Patents

一种用于伺服驱动轴的跟踪误差估计方法 Download PDF

Info

Publication number
CN112067262B
CN112067262B CN202010704258.5A CN202010704258A CN112067262B CN 112067262 B CN112067262 B CN 112067262B CN 202010704258 A CN202010704258 A CN 202010704258A CN 112067262 B CN112067262 B CN 112067262B
Authority
CN
China
Prior art keywords
tracking error
servo drive
drive shaft
formula
domain
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.)
Active
Application number
CN202010704258.5A
Other languages
English (en)
Other versions
CN112067262A (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.)
Tsinghua University
Original Assignee
Tsinghua 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 Tsinghua University filed Critical Tsinghua University
Priority to CN202010704258.5A priority Critical patent/CN112067262B/zh
Publication of CN112067262A publication Critical patent/CN112067262A/zh
Application granted granted Critical
Publication of CN112067262B publication Critical patent/CN112067262B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01MTESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
    • G01M13/00Testing of machine parts

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Feedback Control In General (AREA)
  • Numerical Control (AREA)

Abstract

本发明公开了一种用于伺服驱动轴的跟踪误差估计方法,属于机电一体化技术领域。该方法首先建立伺服驱动轴的控制系统模型,推导跟踪误差在拉普拉斯域中的完整表达式;进一步根据位移指令信号的成分特点,获得完整表达式的等效形式;最后通过拉普拉斯逆变换,在时域中对伺服驱动轴的跟踪误差进行估计。利用所提出的方法,在时域中实现了对伺服驱动轴跟踪误差的快速和精确估计,克服了传统方法操作困难、效率低下的问题,为现场工程技术人员提供了一种准确、便捷的工具。

Description

一种用于伺服驱动轴的跟踪误差估计方法
技术领域
本发明属于机电一体化技术领域,特别涉及伺服驱动轴的跟踪误差估计问题。
背景技术
伺服驱动轴包括直线进给轴与回转轴,是以数控机床为代表的先进制造装备的基本组成单元,用于实现高精度运动,在工业领域应用广泛。跟踪误差是评价伺服驱动轴性能的核心指标之一,对跟踪误差开展研究具有十分重要的意义。
在伺服驱动轴的实际应用过程中,工程技术人员需要对其跟踪误差进行有效估计,以判断伺服驱动轴的工作状态,并制定相应的性能改进方案。伺服驱动轴是复杂的机电一体化系统,对其跟踪误差进行有效估计具有较大难度。传统方法往往需要建立复杂的模型并借助工业软件进行仿真,虽然可以得到伺服驱动轴跟踪误差的估计结果,但操作难度大、效率低,无法在工业现场进行快速推广。因此,针对伺服驱动轴,如何提出一种快速、有效的跟踪误差估计方法,是亟待解决的关键问题。
发明内容
本发明的目的是通过提出一种用于伺服驱动轴的跟踪误差估计方法,在实际工程应用中实现对伺服驱动轴跟踪误差的快速、精确估计。
本发明的技术方案如下:
一种用于伺服驱动轴的跟踪误差估计方法,其特征在于该方法包括如下步骤:
1)建立伺服驱动轴的控制系统模型如下:
Figure GDA0003029659710000011
式中,Gpc、Gvc与Gp分别为伺服驱动轴的位置环控制器、速度环控制器与控制对象,Kpp为位置环控制器的比例增益,Kpv与Tv分别为速度环控制器的比例增益与积分时间常数,J为伺服驱动轴的负载惯量,s为拉普拉斯算子;
2)推导伺服驱动轴跟踪误差在拉普拉斯域中的完整表达式如下:
Figure GDA0003029659710000012
式中,ep(s)为拉普拉斯域中伺服驱动轴的跟踪误差,qr为位移指令信号,τd为干扰力矩,Kt为电机力矩系数;
3)根据qr的有效成分均位于低频段这一特性,建立等效关系如下:
JTvs3+KpvTvKts2+(KppKpvTv+Kpv)Kts+KppKpvKt≈KppKpvKt
4)根据等效关系,获得跟踪误差在拉普拉斯域中完整表达式的等效形式如下:
Figure GDA0003029659710000021
式中,
Figure GDA0003029659710000022
为拉普拉斯域中伺服驱动轴跟踪误差的等效;
5)对
Figure GDA0003029659710000023
进行拉普拉斯逆变换,最终利用下式在时域中对伺服驱动轴的跟踪误差进行估计:
Figure GDA0003029659710000024
式中,ep(t)为时域中伺服驱动轴的跟踪误差,t代表时间,
Figure GDA0003029659710000025
Figure GDA0003029659710000026
分别为速度、加速度及加加速度指令信号,
Figure GDA0003029659710000027
为干扰力矩的变化率。
本发明提出的一种用于伺服驱动轴的跟踪误差估计方法,具有以下优点及突出性的技术效果:利用所提出的方法,在时域中实现了对伺服驱动轴跟踪误差的快速和精准估计,克服了传统方法操作困难、效率低下的问题,为现场工程技术人员提供了一种准确、便捷的工具。
附图说明
图1为本发明一种用于伺服驱动轴的跟踪误差估计方法的流程图。
图2为一台数控机床的伺服驱动轴控制系统框图。
图3为使用本发明得到的数控机床伺服驱动轴的跟踪误差估计结果。
具体实施方式
以下结合附图及具体实施例对本发明作进一步详细说明。
图1所示为本发明的一种用于伺服驱动轴的跟踪误差估计方法的流程图,为了更加清楚的了解本发明,以数控机床伺服驱动轴控制系统为例进行说明。
参见图2,根据图2所示的数控机床伺服驱动轴控制系统框图,建立伺服驱动轴的控制系统模型如下:
Figure GDA0003029659710000031
式中,Gpc、Gvc与Gp分别为伺服驱动轴的位置环控制器、速度环控制器与控制对象,Kpp为位置环控制器的比例增益,Kpv与Tv分别为速度环控制器的比例增益与积分时间常数,J为伺服驱动轴的负载惯量,s为拉普拉斯算子;
2)推导伺服驱动轴跟踪误差在拉普拉斯域中的完整表达式如下:
ep(s)=ep1(s)+ep2(s) (2)
式中,ep(s)为拉普拉斯域中伺服驱动轴的跟踪误差,ep1(s)与ep2(s)分别为由位移指令信号与干扰力矩引起的跟踪误差,进一步将ep1(s)与ep2(s)写为:
Figure GDA0003029659710000032
Figure GDA0003029659710000033
式中,qr为位移指令信号,τd为干扰力矩,Kt为电机力矩系数;
3)将式带入式与式,得到ep1(s)与ep2(s)的表达式为:
Figure GDA0003029659710000034
Figure GDA0003029659710000035
4)在实际的数控加工过程中,位移指令信号qr中的有效成分均位于低频段,即满足:
|s|<s1 (7)
式中,||表示求模运算,s1为频率上限,其值接近于0;
5)根据式,忽略ep1(s)与ep2(s)分母中s的一阶项及其他高阶项,建立等效关系如下:
JTvs3+KpvTvKts2+(KppKpvTv+Kpv)Kts+KppKpvKt≈KppKpvKt (8)
6)将式带入式与式,得到:
Figure GDA0003029659710000036
Figure GDA0003029659710000041
式中,
Figure GDA0003029659710000042
Figure GDA0003029659710000043
分别为ep1(s)与ep2(s)的等效;
7)结合式、式与式,得到:
Figure GDA0003029659710000044
式中,
Figure GDA0003029659710000045
为拉普拉斯域中伺服驱动轴跟踪误差的等效;
8)对式进行拉普拉斯逆变换,得到:
Figure GDA0003029659710000046
式中,ep(t)为时域中驱动轴的跟踪误差,t代表时间,
Figure GDA0003029659710000047
Figure GDA0003029659710000048
分别为速度、加速度及加加速度指令信号,
Figure GDA0003029659710000049
为干扰力矩的变化率;
9)利用式在时域中对伺服驱动轴的跟踪误差进行估计,结果如图3所示,图3中的横坐标代表时间变化范围,单位为s,纵坐标代表驱动轴的跟踪误差,单位为mm;图3中的实线与虚线分别代表驱动轴跟踪误差的实际值与利用本方法得到的估计值;从结果中清楚地看到,驱动轴跟踪误差的估计值与实际值较为接近,因此,利用本发明所提出的方法,能够快速、有效地对驱动轴的跟踪误差进行估计。

Claims (1)

1.一种用于伺服驱动轴的跟踪误差估计方法,其特征在于该方法包括如下步骤:
1)建立伺服驱动轴的控制系统模型如下:
Figure FDA0003029659700000011
式中,Gpc、Gvc与Gp分别为伺服驱动轴的位置环控制器、速度环控制器与控制对象,Kpp为位置环控制器的比例增益,Kpv与Tv分别为速度环控制器的比例增益与积分时间常数,J为伺服驱动轴的负载惯量,s为拉普拉斯算子;
2)推导伺服驱动轴跟踪误差在拉普拉斯域中的完整表达式如下:
Figure FDA0003029659700000012
式中,ep(s)为拉普拉斯域中伺服驱动轴的跟踪误差,qr为位移指令信号,τd为干扰力矩,Kt为电机力矩系数;
3)根据qr的有效成分均位于低频段这一特性,即满足:|s|<s1,|s|表示qr的有效成分的频率,s为拉普拉斯算子,||表示求模运算,s1为频率上限,其值接近于0,建立等效关系如下:
JTvs3+KpvTvKts2+(KppKpvTv+Kpv)Kts+KppKpvKt≈KppKpvKt
4)根据等效关系,获得跟踪误差在拉普拉斯域中完整表达式的等效形式如下:
Figure FDA0003029659700000013
式中,
Figure FDA0003029659700000014
为拉普拉斯域中伺服驱动轴跟踪误差的等效;
5)对
Figure FDA0003029659700000015
进行拉普拉斯逆变换,最终利用下式在时域中对伺服驱动轴的跟踪误差进行估计:
Figure FDA0003029659700000016
式中,ep(t)为时域中伺服驱动轴的跟踪误差,t代表时间,
Figure FDA0003029659700000017
Figure FDA0003029659700000018
分别为速度、加速度及加加速度指令信号,
Figure FDA0003029659700000019
为干扰力矩的变化率。
CN202010704258.5A 2020-07-21 2020-07-21 一种用于伺服驱动轴的跟踪误差估计方法 Active CN112067262B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010704258.5A CN112067262B (zh) 2020-07-21 2020-07-21 一种用于伺服驱动轴的跟踪误差估计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010704258.5A CN112067262B (zh) 2020-07-21 2020-07-21 一种用于伺服驱动轴的跟踪误差估计方法

Publications (2)

Publication Number Publication Date
CN112067262A CN112067262A (zh) 2020-12-11
CN112067262B true CN112067262B (zh) 2021-08-06

Family

ID=73656075

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010704258.5A Active CN112067262B (zh) 2020-07-21 2020-07-21 一种用于伺服驱动轴的跟踪误差估计方法

Country Status (1)

Country Link
CN (1) CN112067262B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117033860B (zh) * 2023-08-31 2024-02-06 清华大学 驱动轴跟踪误差的参数敏感性分析方法及装置

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011244616A (ja) * 2010-05-19 2011-12-01 Sanyo Electric Co Ltd モータ制御装置及びモータ駆動システム
JP2012151925A (ja) * 2011-01-17 2012-08-09 Panasonic Corp モータ駆動装置の位置制御方法
CN103389646A (zh) * 2013-07-05 2013-11-13 西安交通大学 一种伺服进给系统闭环辨识方法
CN105159077A (zh) * 2015-08-24 2015-12-16 南京理工大学 直驱电机系统干扰补偿的有限时间连续滑模控制方法
CN107505914A (zh) * 2017-07-20 2017-12-22 西安交通大学 一种考虑滚珠丝杠进给系统高阶动态特性的高精运动控制方法
CN107892000A (zh) * 2017-10-20 2018-04-10 上海微小卫星工程中心 一种星地双光路对准的地面试验方法
CN109240269A (zh) * 2018-10-17 2019-01-18 清华大学 一种用于并联机构的动态性能分析方法
CN110865540A (zh) * 2019-11-28 2020-03-06 曾喆昭 一种互耦pi协同控制理论新方法
CN111427308A (zh) * 2020-02-29 2020-07-17 华南理工大学 一种用于数控平台轨迹规划的误差补偿综合控制方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011244616A (ja) * 2010-05-19 2011-12-01 Sanyo Electric Co Ltd モータ制御装置及びモータ駆動システム
JP2012151925A (ja) * 2011-01-17 2012-08-09 Panasonic Corp モータ駆動装置の位置制御方法
CN103389646A (zh) * 2013-07-05 2013-11-13 西安交通大学 一种伺服进给系统闭环辨识方法
CN105159077A (zh) * 2015-08-24 2015-12-16 南京理工大学 直驱电机系统干扰补偿的有限时间连续滑模控制方法
CN107505914A (zh) * 2017-07-20 2017-12-22 西安交通大学 一种考虑滚珠丝杠进给系统高阶动态特性的高精运动控制方法
CN107892000A (zh) * 2017-10-20 2018-04-10 上海微小卫星工程中心 一种星地双光路对准的地面试验方法
CN109240269A (zh) * 2018-10-17 2019-01-18 清华大学 一种用于并联机构的动态性能分析方法
CN110865540A (zh) * 2019-11-28 2020-03-06 曾喆昭 一种互耦pi协同控制理论新方法
CN111427308A (zh) * 2020-02-29 2020-07-17 华南理工大学 一种用于数控平台轨迹规划的误差补偿综合控制方法

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
An Experimental Study on the Dynamics Calibration of a 3-DOF Parallel Tool Head;Dong Wang等;《IEEE》;20191231;第24卷(第6期);1-11 *
Balancing of a Rotating Shaft using Computed Order Tracking;Chetna R. Koli等;《IEEE》;20200331;1-5 *
Rotation error modeling and compensation of spindle based on Clarke transformation in straightness error measurement of regular hexagon section shaft;Qingshun Kong等;《Measurement》;20200717;第166卷;1-10 *
交流伺服系统控制参数自整定策略研究;陈展鹏;《万方》;20111130;1-62 *
双轴跟踪转台伺服控制系统的建模及控制方法研究;崔宁豪;《中国优秀硕士学位论文全文数据库 信息科技辑》;20200715(第7期);I140-414 *

Also Published As

Publication number Publication date
CN112067262A (zh) 2020-12-11

Similar Documents

Publication Publication Date Title
CN104238572B (zh) 基于扰动补偿的电机伺服系统无抖动滑模位置控制方法
CN103071826B (zh) 一种高速高精多轴pcb数控钻床及其控制方法
CN102969971A (zh) 电动机控制装置
CN112067262B (zh) 一种用于伺服驱动轴的跟踪误差估计方法
CN104333285A (zh) 永磁同步电机准无传感器位置伺服控制装置及方法
CN113556067A (zh) 一种基于滑模与扰动补偿的低速直驱电机扰动抑制方法
CN110425220B (zh) 一种径向磁轴承改进抗扰动控制器的构造方法
CN106533291A (zh) 一种基于惯量辨识和负载转矩观测的速度环响应提升方法
CN203061919U (zh) 一种高速高精多轴pcb数控钻床
Khalid et al. Sensor less control of DC motor using Kalman filter for low cost CNC machine
Yang et al. Vibration suppression and over-quadrant error mitigation methods for a ball-screw driven servo system with dual-position feedback
CN105048922A (zh) 一种永磁同步直线电机稳定自适应鲁棒位置控制方法
CN103166561A (zh) 基于非光滑控制技术的永磁直线同步电机复合控制系统
CN116638544A (zh) 一种基于超局部模型的关节模组协同控制方法
CN105700470B (zh) 一种用于减小机床伺服进给系统跟踪误差的方法
CN104090577A (zh) 一种基于自抗扰的天线位置控制方法
CN112152539A (zh) 一种神经网络补偿电机负载力矩观测器实现方法
Zhu et al. Speed control of permanent magnet synchronous motor drives based on model predictive control
CN103413049B (zh) 基于机电耦合特性的并联机床结构优化参数值的获取方法
CN111610753B (zh) 一种双直线电机差动微进给伺服系统及控制方法
CN113890446A (zh) 基于LuGre模型的伺服控制系统的参数辨识方法
Breaz et al. Computer simulation for the study of CNC feed drives dynamic behavior and accuracy
Yamada et al. Precise external torque estimation for two-inertia system considering modeling errors
JP2004086434A (ja) 速度指令型同期制御装置
CN112564565A (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
GR01 Patent grant
GR01 Patent grant