CN108983595A - 一种前馈控制器参数的自动整定方法 - Google Patents
一种前馈控制器参数的自动整定方法 Download PDFInfo
- Publication number
- CN108983595A CN108983595A CN201810793174.6A CN201810793174A CN108983595A CN 108983595 A CN108983595 A CN 108983595A CN 201810793174 A CN201810793174 A CN 201810793174A CN 108983595 A CN108983595 A CN 108983595A
- Authority
- CN
- China
- Prior art keywords
- servo motor
- motion profile
- same section
- feedforward
- executes
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 238000005259 measurement Methods 0.000 claims abstract description 5
- 230000001133 acceleration Effects 0.000 claims description 24
- 238000005070 sampling Methods 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 1
Classifications
-
- 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
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种前馈控制器参数的自动整定方法,步骤一、测量转角误差;步骤二、辨识前馈控制器参数增量;步骤三、前馈控制器参数执行同一段运动轨迹整定,采用本方法有利于提高前馈控制器参数的整定效率和自动化程度。
Description
技术领域
本发明涉及自动化领域,尤其涉及一种前馈控制器参数的自动整定方法。
背景技术
工业机器人位置环控制器普遍采用PID控制器。这种控制器结构简单、鲁棒性强、可靠性高,在工业控制过程中占有主导地位。
考虑到反馈控制存在一定的滞后性,在PID控制器的基础上添加速度、加速度前馈控制器实现复合控制,可显著提高伺服系统的跟随精度。图1是现有的前馈控制器参数的自动整定方法的前馈控制结构,对伺服电机期望转角θd做一阶微分并乘以速度前馈增益得到速度前馈控制器输出,对伺服电机期望转角θd做二阶微分并乘以加速度前馈增益得到加速度前馈控制器输出,二者与反馈控制器输出相加得到控制信号,输入给伺服驱动器实现复合控制。,伺服控制系统的性能与其控制参数密切相关,为了获得满意的控制效果与伺服性能,必须对控制参数进行整定与优化。然而,目前工业上对前馈控制器参数的整定,主要通过单轴实验手动调试速度、加速度前馈增益,极为依赖工程师的调试经验,效率低下且无法保证控制效果。因此,亟需一种适用于前馈控制器参数的自动整定方法,以提高前馈控制器参数的整定效率和自动化程度。
发明内容
本发明的目的在于克服已有技术的缺点,提供一种可自动辨识出前馈控制器的速度和加速度增益,进而有利于提高前馈控制器参数的整定效率和自动化程度的前馈控制器参数的自动整定方法。
本发明的一种前馈控制器参数的自动整定方法,包括以下步骤:
步骤一、测量转角误差,步骤为:
(11)利用角度编码器记录待整定控制器参数的驱动关节的伺服电机在不施加前馈控制与施加前馈控制两种情况下,在执行同一段运动轨迹时,在设定的各数据采集时刻的伺服电机实际转角;
(12)将与每次执行同一段运动轨迹的各数据采集时刻分别对应的伺服电机期望转角和与对伺服电机不施加前馈控制时在同时刻的实际转角相减得到对伺服电机不施加前馈控制转角误差将与每次执行同一段运动轨迹的各数据采集时刻分别对应的伺服电机期望转角和与对伺服电机施加前馈控制时在同时刻的实际转角相减得到对伺服电机施加前馈控制转角误差
(13)将分别对应同次执行同一段运动轨迹的各数据采集时刻的对伺服电机不施加前馈控制的转角误差与对伺服电机施加前馈控制的转角误差相减,得到式中i代表第i次执行同一段运动轨迹;
步骤二、辨识前馈控制器参数增量,步骤为:
(21)设定伺服电机的前馈控制器加速度前馈增益ai的初始值以及伺服电机的速度前馈增益bi的初始值;
(22)采集伺服电机在第i次执行同一运动轨迹时,不施加前馈控制转角误差与施加前馈控制的转角误差然后根据公式辨识前馈控制器参数增量Δpi:
所述的j为k的整数倍整数,j表示时间到达第j个采样周期,φj,i代表在第j时刻的观测矩阵,Ts—采样周期,N—采样周期个数,-对伺服电机施加与不施加前馈控制时第i次执行同一段运动轨迹在tj时刻的伺服电机转角误差之差;
ai—伺服电机第i次执行同一段运动轨迹的加速度前馈增益;
bi—伺服电机第i次执行同一段运动轨迹的速度前馈增益;
Δai—伺服电机第i次执行同一段运动轨迹的加速度前馈增益增量;
Δbi—伺服电机第i次执行同一段运动轨迹的速度前馈增益增量;
—第i次执行同一段运动轨迹时各数据采集时刻分别对应的伺服电机转角误差组成的矢量;
tj=jTs(j=1,2,…N)—表示时间到达第j个采样周期的时刻。
步骤三、前馈控制器参数执行同一段运动轨迹整定,步骤为:
(31)若伺服电机第i次执行同一段运动轨迹的加速度前馈增益增量Δai满足||Δai||≤εa且伺服电机第i次执行同一段运动轨迹的速度前馈增益增量Δbi满足||Δbi||≤εb,则驱动关节伺服电机的前馈控制器参数整定完毕;若伺服电机第i次执行同一段运动轨迹的加速度前馈增益增量Δai不满足||Δai||≤εa且伺服电机第i次执行同一段运动轨迹的速度前馈增益增量Δbi不满足||Δbi||≤εb,则根据公式ai+1=ai+Δai,bi+1=bi+Δbi,得到第i+1次执行同一段运动轨迹的加速度前馈增益ai+1与第i+1次执行同一段运动轨迹的速度前馈增益bi+1,然后执行步骤(32);
(32)令i=i+1,重复步骤二的(22)和步骤三。
本发明的优点在于,仅测量伺服电机不施加和施加前馈控制时的转角误差,便可自动辨识出前馈控制器的速度和加速度增益,进而有利于提高前馈控制器参数的整定效率和自动化程度。
附图说明
图1是已有的前馈控制器参数的自动整定方法的前馈控制结构框图;
图2是本发明的前馈控制器参数的自动整定方法的前馈控制器参数自动整定流程图。
具体实施方式
为了使本发明的技术方案更加清晰,以下结合附图对本发明做进一步详细说明。本发明的具体实施方式如下。
本发明核心在于利用不施加和第i次执行同一段运动轨迹中施加前馈控制的转角误差和该次执行同一段运动轨迹前馈控制器参数,便可通过最小二乘法辨识出前馈控制器参数增量,进而通过执行同一段运动轨迹使参数收敛至给定精度。
如图2所示的本发明的一种前馈控制器参数的自动整定方法,包括以下步骤:
步骤一、测量转角误差,步骤为:
(11)利用角度编码器记录待整定控制器参数的驱动关节的伺服电机在不施加前馈控制(n)与施加前馈控制(y)两种情况下,在执行同一段运动轨迹时,在设定的各数据采集时刻的伺服电机实际转角θa;
(12)将与每次执行同一段运动轨迹的各数据采集时刻分别对应的伺服电机期望转角θd和与对伺服电机不施加前馈控制(n)时在同时刻的实际转角相减得到对伺服电机不施加前馈控制转角误差将与每次执行同一段运动轨迹的各数据采集时刻分别对应的伺服电机期望转角和与对伺服电机施加前馈控制(y)时在同时刻的实际转角相减得到对伺服电机施加前馈控制转角误差
(13)将分别对应同次执行同一段运动轨迹的各数据采集时刻的对伺服电机不施加前馈控制(n)的转角误差与对伺服电机施加前馈控制(y)的转角误差相减,得到式中i代表第i次执行同一段运动轨迹;
步骤二、辨识前馈控制器参数增量,步骤为:
(21)设定伺服电机的前馈控制器加速度前馈增益ai的初始值以及伺服电机的速度前馈增益bi的初始值;
(22)采集伺服电机在第i次执行同一运动轨迹时,不施加前馈控制转角误差为与施加前馈控制的转角误差然后根据公式辨识前馈控制器参数增量Δpi:
所述的j为k的整数倍整数,j表示时间到达第j个采样周期,φj,i代表在第j时刻的观测矩阵,Ts—采样周期,N—采样周期个数,—对伺服电机施加与不施加前馈控制时第i次执行同一段运动轨迹在tj时刻的伺服电机转角误差之差;
ai—伺服电机第i次执行同一段运动轨迹的加速度前馈增益;
bi—伺服电机第i次执行同一段运动轨迹的速度前馈增益;
Δai—伺服电机第i次执行同一段运动轨迹的加速度前馈增益增量;
Δbi—伺服电机第i次执行同一段运动轨迹的速度前馈增益增量;
—第i次执行同一段运动轨迹时各数据采集时刻分别对应的伺服电机转角误差组成的矢量;
tj=jTs(j=1,2,…N)—表示时间到达第j个采样周期的时刻。
步骤三、前馈控制器参数执行同一段运动轨迹整定,步骤为:
(31)若伺服电机第i次执行同一段运动轨迹的加速度前馈增益增量Δai满足||Δai||≤εa且伺服电机第i次执行同一段运动轨迹的速度前馈增益增量Δbi满足||Δbi||≤εb,则驱动关节伺服电机的前馈控制器参数整定完毕;若伺服电机第i次执行同一段运动轨迹的加速度前馈增益增量Δai不满足||Δai||≤εa且伺服电机第i次执行同一段运动轨迹的速度前馈增益增量Δbi不满足||Δbi||≤εb,则根据公式ai+1=ai+Δai,bi+1=bi+Δbi,得到第i+1次执行同一段运动轨迹的加速度前馈增益ai+1与第i+1次执行同一段运动轨迹的速度前馈增益bi+1,然后执行步骤(32);
(32)令i=i+1,重复步骤二的(22)和步骤三。
本发明的优点在于,仅测量驱动关节伺服电机不施加和施加前馈控制时的转角误差,便可自动辨识出前馈控制器的速度和加速度增益,进而有利于提高前馈控制器参数的整定效率和自动化程度。
Claims (1)
1.一种前馈控制器参数的自动整定方法,其特征在于包括以下步骤:
步骤一、测量转角误差,步骤为:
(11)利用角度编码器记录待整定控制器参数的驱动关节的伺服电机在不施加前馈控制与施加前馈控制两种情况下,在执行同一段运动轨迹时,在设定的各数据采集时刻的伺服电机实际转角;
(12)将与每次执行同一段运动轨迹的各数据采集时刻分别对应的伺服电机期望转角和与对伺服电机不施加前馈控制时在同时刻的实际转角相减得到对伺服电机不施加前馈控制转角误差将与每次执行同一段运动轨迹的各数据采集时刻分别对应的伺服电机期望转角和与对伺服电机施加前馈控制时在同时刻的实际转角相减得到对伺服电机施加前馈控制转角误差
(13)将分别对应同次执行同一段运动轨迹的各数据采集时刻的对伺服电机不施加前馈控制的转角误差与对伺服电机施加前馈控制的转角误差相减,得到式中i代表第i次执行同一段运动轨迹;
步骤二、辨识前馈控制器参数增量,步骤为:
(21)设定伺服电机的前馈控制器加速度前馈增益ai的初始值以及伺服电机的速度前馈增益bi的初始值;
(22)采集伺服电机在第i次执行同一运动轨迹时,不施加前馈控制转角误差与施加前馈控制的转角误差然后根据公式辨识前馈控制器参数增量Δpi:
所述的j为k的整数倍整数,j表示时间到达第j个采样周期,φj,i代表在第j时刻的观测矩阵,Ts—采样周期,N—采样周期个数,—对伺服电机施加与不施加前馈控制时第i次执行同一段运动轨迹在tj时刻的伺服电机转角误差之差;
ai—伺服电机第i次执行同一段运动轨迹的加速度前馈增益;
bi—伺服电机第i次执行同一段运动轨迹的速度前馈增益;
Δai—伺服电机第i次执行同一段运动轨迹的加速度前馈增益增量;
Δbi—伺服电机第i次执行同一段运动轨迹的速度前馈增益增量;
—第i次执行同一段运动轨迹时各数据采集时刻分别对应的伺服电机转角误差组成的矢量;
tj=jTs(j=1,2,…N)—表示时间到达第j个采样周期的时刻。
步骤三、前馈控制器参数执行同一段运动轨迹整定,步骤为:
(31)若伺服电机第i次执行同一段运动轨迹的加速度前馈增益增量Δai满足||Δai||≤εa且伺服电机第i次执行同一段运动轨迹的速度前馈增益增量Δbi满足||Δbi||≤εb,则驱动关节伺服电机的前馈控制器参数整定完毕;若伺服电机第i次执行同一段运动轨迹的加速度前馈增益增量Δai不满足||Δai||≤εa且伺服电机第i次执行同一段运动轨迹的速度前馈增益增量Δbi不满足||Δbi||≤εb,则根据公式ai+1=ai+Δai,bi+1=bi+Δbi,得到第i+1次执行同一段运动轨迹的加速度前馈增益ai+1与第i+1次执行同一段运动轨迹的速度前馈增益bi+1,然后执行步骤(32);
(32)令i=i+1,重复步骤二的(22)和步骤三。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810793174.6A CN108983595B (zh) | 2018-07-18 | 2018-07-18 | 一种前馈控制器参数的自动整定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810793174.6A CN108983595B (zh) | 2018-07-18 | 2018-07-18 | 一种前馈控制器参数的自动整定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108983595A true CN108983595A (zh) | 2018-12-11 |
CN108983595B CN108983595B (zh) | 2021-04-20 |
Family
ID=64549650
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810793174.6A Active CN108983595B (zh) | 2018-07-18 | 2018-07-18 | 一种前馈控制器参数的自动整定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108983595B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109991934A (zh) * | 2019-03-10 | 2019-07-09 | 天津大学 | 一种时间最优的在线s型加减速规划方法 |
CN111505939A (zh) * | 2020-04-23 | 2020-08-07 | 清华大学 | 直线运动系统前馈控制器的参数整定方法 |
CN112906263A (zh) * | 2021-01-28 | 2021-06-04 | 天津大学 | 含制孔分层损伤的复合材料层合板强度预测方法 |
CN113805596A (zh) * | 2021-09-27 | 2021-12-17 | 深圳市英威腾电气股份有限公司 | 一种控制器的位置调控方法、装置、设备及介质 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1963702A (zh) * | 2005-11-11 | 2007-05-16 | 株式会社日立产机系统 | 电动机控制装置的自动调整法及装置 |
EP1887442A1 (en) * | 2006-08-10 | 2008-02-13 | Robert Bosch Gmbh | Method of automatically tuning motor controller and motor controller |
CN103713516A (zh) * | 2013-12-17 | 2014-04-09 | 华中科技大学 | 一种基于pdff的交流伺服驱动器控制参数自整定方法 |
CN104063584A (zh) * | 2014-06-10 | 2014-09-24 | 国家电网公司 | 一种汽轮机调速系统控制参数整定方法 |
CN105739301A (zh) * | 2016-02-18 | 2016-07-06 | 江西洪都航空工业集团有限责任公司 | 一种参数可自整定的电机控制器的控制方法 |
CN106054595A (zh) * | 2016-06-12 | 2016-10-26 | 广东工业大学 | 一种用于调整前馈参数的方法和系统 |
CN106773685A (zh) * | 2016-12-08 | 2017-05-31 | 国家电网公司 | 一种用于风电偏航系统的角度pi控制器整定方法 |
CN107490958A (zh) * | 2017-07-31 | 2017-12-19 | 天津大学 | 一种五自由度混联机器人的模糊自适应控制方法 |
CN107842908A (zh) * | 2017-09-26 | 2018-03-27 | 国网浙江省电力公司杭州供电公司 | 一种基于环境参数补偿的实时供热负荷控制方法 |
CN108107738A (zh) * | 2018-02-08 | 2018-06-01 | 上海机电工程研究所 | 变采样率非线性驱动惯性稳定跟踪控制系统及方法 |
-
2018
- 2018-07-18 CN CN201810793174.6A patent/CN108983595B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1963702A (zh) * | 2005-11-11 | 2007-05-16 | 株式会社日立产机系统 | 电动机控制装置的自动调整法及装置 |
EP1887442A1 (en) * | 2006-08-10 | 2008-02-13 | Robert Bosch Gmbh | Method of automatically tuning motor controller and motor controller |
CN103713516A (zh) * | 2013-12-17 | 2014-04-09 | 华中科技大学 | 一种基于pdff的交流伺服驱动器控制参数自整定方法 |
CN104063584A (zh) * | 2014-06-10 | 2014-09-24 | 国家电网公司 | 一种汽轮机调速系统控制参数整定方法 |
CN105739301A (zh) * | 2016-02-18 | 2016-07-06 | 江西洪都航空工业集团有限责任公司 | 一种参数可自整定的电机控制器的控制方法 |
CN106054595A (zh) * | 2016-06-12 | 2016-10-26 | 广东工业大学 | 一种用于调整前馈参数的方法和系统 |
CN106773685A (zh) * | 2016-12-08 | 2017-05-31 | 国家电网公司 | 一种用于风电偏航系统的角度pi控制器整定方法 |
CN107490958A (zh) * | 2017-07-31 | 2017-12-19 | 天津大学 | 一种五自由度混联机器人的模糊自适应控制方法 |
CN107842908A (zh) * | 2017-09-26 | 2018-03-27 | 国网浙江省电力公司杭州供电公司 | 一种基于环境参数补偿的实时供热负荷控制方法 |
CN108107738A (zh) * | 2018-02-08 | 2018-06-01 | 上海机电工程研究所 | 变采样率非线性驱动惯性稳定跟踪控制系统及方法 |
Non-Patent Citations (4)
Title |
---|
李占贤: "高速轻型并联机械手关键技术及样机建造", 《中国博士学位论文全文数据库·信息科技辑》 * |
杨志永等: "基于全域优化的高速并联机械手控制器参数整定", 《机械工程学报》 * |
杨志永等: "并联机构主模块伺服系统参数辨识与整定泳", 《机械工程学报》 * |
黄有起等: "DELTA 机构控制器参数整定方法研究", 《机械设计与制造》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109991934A (zh) * | 2019-03-10 | 2019-07-09 | 天津大学 | 一种时间最优的在线s型加减速规划方法 |
CN111505939A (zh) * | 2020-04-23 | 2020-08-07 | 清华大学 | 直线运动系统前馈控制器的参数整定方法 |
CN111505939B (zh) * | 2020-04-23 | 2021-09-21 | 清华大学 | 直线运动系统前馈控制器的参数整定方法 |
CN112906263A (zh) * | 2021-01-28 | 2021-06-04 | 天津大学 | 含制孔分层损伤的复合材料层合板强度预测方法 |
CN113805596A (zh) * | 2021-09-27 | 2021-12-17 | 深圳市英威腾电气股份有限公司 | 一种控制器的位置调控方法、装置、设备及介质 |
Also Published As
Publication number | Publication date |
---|---|
CN108983595B (zh) | 2021-04-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108983595A (zh) | 一种前馈控制器参数的自动整定方法 | |
CN109382828B (zh) | 一种基于示教学习的机器人轴孔装配系统及方法 | |
Zhang et al. | Tracking control of ball screw drives using ADRC and equivalent-error-model-based feedforward control | |
Song et al. | A dual-stage control system for high-speed, ultra-precise linear motion | |
US11036193B2 (en) | Method for compensating for coriolis, centrifugal and gravitational couples in a movement simulator and system comprising a movement simulator | |
CN107991882A (zh) | 压电陶瓷执行器精度控制装置的设计方法及精度控制系统 | |
CN109828468A (zh) | 一种针对磁滞非线性机器人系统的控制方法 | |
Zareinejad et al. | Development of a piezo‐actuated micro‐teleoperation system for cell manipulation | |
CN113485123A (zh) | 一种小行程纳米级运动台的频域自适应迭代学习控制方法 | |
Hayashi et al. | Projection-based iterative learning control for ball-screw-driven stage with consideration of rolling friction compensation | |
Lin et al. | Observer-based robust controller design and realization of a gantry stage | |
Zheng et al. | Nonlinear feedback control of a dual-stage actuator system for reduced settling time | |
Liu et al. | Robust control of dual-linear-motor-driven gantry stage for coordinated contouring tasks based on feed velocity | |
CN114114928B (zh) | 一种压电微定位平台的固定时间自适应事件触发控制方法 | |
CN116339141A (zh) | 一种机械臂全局固定时间轨迹跟踪滑模控制方法 | |
Post et al. | A robust nonlinear observation strategy for the control of flexible manipulators | |
CN109184925A (zh) | 基于自适应积分终端滑模技术的电子节气门控制方法 | |
CN109581862A (zh) | 内嵌扰动估计补偿算法的驱动器 | |
Liu et al. | Dynamic visual servoing of robots in uncalibrated environments | |
CN114952858A (zh) | 一种基于摩擦补偿控制的工业机器人轨迹跟踪方法和系统 | |
Yin et al. | Robust position control of series elastic actuator with sliding mode like and disturbance observer | |
Susanto et al. | Adaptive friction compensation: application to a robotic manipulator | |
Cao et al. | Output-based adaptive iterative learning control of uncertain linear systems applied to a wafer stage | |
Li et al. | Feedforward coefficient identification and nonlinear composite feedback control with applications to 3-DOF planar motor | |
Zhang et al. | Novel dynamic microactuation method for tracking-error reduction of permanent magnet linear synchronous motors |
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 |