CN103862473A - 基于从端本地数据的波变量位移跟踪控制方法 - Google Patents
基于从端本地数据的波变量位移跟踪控制方法 Download PDFInfo
- Publication number
- CN103862473A CN103862473A CN201410075423.XA CN201410075423A CN103862473A CN 103862473 A CN103862473 A CN 103862473A CN 201410075423 A CN201410075423 A CN 201410075423A CN 103862473 A CN103862473 A CN 103862473A
- Authority
- CN
- China
- Prior art keywords
- wave
- terminal
- main side
- variable
- signal
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J3/00—Manipulators of master-slave type, i.e. both controlling unit and controlled unit perform corresponding spatial movements
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开一种基于从端本地数据的波变量位移跟踪控制方法,旨在解决在有时延条件下,波变量引起主端机、从端机的跟踪偏差的技术问题,本发明的方法是针对有时延的波变量主从遥操作系统,根据从端机的本地数据,对波变量变换引起的主从遥操作系统中主端机、从端机的位移偏差进行补偿,使得从端机的速度和位移都能准确地跟踪主端机的速度和位移,以提高主从遥操作系统的稳定性及跟踪性能。
Description
技术领域
本发明涉及远程主从遥操作系统操作机器人控制技术领域,尤其涉及有时延的波变量主从遥操作系统操作机器人跟踪控制技术中基于从端本地数据的波变量位移跟踪控制方法。
背景技术
主从遥操作系统的工作模式是可以将人手延伸到人类很难到达或是对人有害的环境中去执行任务。但是主从遥操作系统操作机器人之间进行数据通信时之间存在有一定的时延。这种时延会导致主从遥操作系统的不稳定。而波变量转换能够解决主端机、从端机之间因数据通信时延导致的系统不稳定的问题,并能获得任意时延下的稳定遥操作。但是波变量的转换会引起从端机的速度命令信号偏离主机械臂的速度,从而造成从端机的实际速度偏离主端机的速度,而且随着时延的增大,相应的速度偏离也将增大。在通信时延为T的波变量主从遥操作系统中,从端机的速度命令为:
从端机的速度命令信号与理想的速度命令信号之间的偏差为:
这偏差是由于波变换引起的,最后将导致主从端机器人的实际速度产生偏差。本发明的主要目的在于解决有时延条件下,波变量引起的主从遥操作机器人之间的跟踪偏差问题。
发明内容
本发明的目的在于克服现有技术的不足,适应现实需要,提供一种基于从端本地数据的波变量位移跟踪控制方法,旨在解决有时延条件下,波变量主从遥操作系统引起的跟踪偏差的技术问题。
为了实现本发明的目的,本发明所采用的技术方案为:
设计一种基于从端本地数据的波变量位移跟踪控制方法,设定主端机的速度为,主端机接收到操作者对其的力反馈信号为f mc ,从端机产生的速度命令信号为,从端机中速度PI控制器输出的用于控制从端机的作用力信号为;包括以下步骤:
上述步骤中的波变换滤波器为。
上述步骤中所述逆波变换满足:. 其中。 将从端机产生的速度命令信号和从端机产生的力反馈信号信号经过波变换得到从端反馈波变量;所述从端反馈波变量满足: ;将,和分别经过拉氏变换为、、;所述步骤、中的、信号与信号经过拉氏变换后的、、与拉氏变换后的信号满足:
上述速度PI控制器比例系数为B,积分系数为K。
本发明的有益效果在于:
本发明的方法是针对有时延的波变量主从遥操作系统,根据从端机的本地数据,设计前向波变量校正器对波变量主从遥操作系统的主从速度偏差进行补偿,使从端机的速度和位移都能准确地跟踪主端机的速度和位移,以提高主从遥操作系统的稳定性及跟踪性能。
本发明的特点是构成前向波变量校正器的数据都来源于从端机本地数据,容易实现;相应的前向波变量校正器能够实现从端机速度命令信号成为理想的速度命令信号,即滞后且经过滤波的主端机的速度信号,以提高位移跟踪的准确性,而且能应用于在任意时延下的主从遥操作机器人控制,包括地面精确实时遥控太空或深海的机器人或机器臂完成异物清除,设备修理等操作。
基于本发明的方法使得从端机的实际速度跟踪于滤波和滞后的主端机实际速度。消除了波变换引起的主从遥操作系统存在的跟踪偏差,同时又继承波变换能保证任意时延下主从遥操作系统无源性即稳定性的特点。
附图说明
图1为基于本发明的波变量主从遥操作系统位移跟踪控制器设计的主从遥操作系统示意图;
具体实施方式
下面结合附图和实施例对本发明进一步说明:
实施例:一种基于从端本地数据的波变量位移跟踪控制方法。参见图1。在有通信时延的波变量主从遥操作系统中,从端机的速度命令与理想的速度命令信号之间的偏差为:
本发明实施例是基于波变换的主从遥操作系统操作机器人控制系统,包括主端机上的主机器人及主端计算机控制系统,从端机上的从端机器人及从端计算机控制系统,主端机与从端机之间通过通信网络连接进行数据传输,本方法基于从端本地数据的波变量位移跟踪控制方法,包括以下步骤:
将从端机产生的速度命令信号和从端机产生的作用力信号经过波变换得到从端反馈波变量;所述从端反馈波变量满足: ;将,和分别经过拉氏变换为、、;所述步骤、中的、信号与信号经过拉氏变换后的、、与拉氏变换后的信号满足:
本实施例对以上步骤说明如下:主端机、从端机之间通信的网络时延为T。在波变量传递的前向通道上,滤波器之后,设计一个基于从端本地数据的前向波变量校正器,实现波变量主从遥操作系统主端机与从端机之间速度与位移的理想跟踪,具体前向波变量校正器设计及应用方法如图1所示。在主端机,通过主端波变换控制器将主端机的速度及主端机接收到的力反馈信号f mc 经过主端波变换控制器进行波变换转换成主端机的主端前向波变量并满足:。
拉氏变换后的波变换方程如下:
其中,b是波阻抗;是从主端机到从端机的前向波变量。是上述步骤的波变换滤波器。是从端机PI控制器产生的作用力信号,也是要反馈到主端机的作用力信号,是环境对从端机的作用力。在从端机通过其内的前向波变量校正器及速度PI控制器,来实现从端机的实际速度跟踪于期望速度命令信号。将从端机的速度命令信号和从端机的力反馈信号信号经过波变换得到从端反馈波变量;所述从端反馈波变量满足:
基于本方法所设计的主从遥操作系统能够使从端机的机械臂的速度命令信号变成理想的速度命令信号,即滞后和经过滤波后的主机械臂速度。从而使从端机的实际速度跟踪于滞后且滤波后的主端机的实际速度,消除波变换造成的主端机、从端机的跟踪误差。
本实施例中未提到相关参数及转换方法均为本领域中公知及常用技术,在此不再一一赘述。
本发明的实施例公布的是较佳的实施例,但并不局限于此,本领域的普通技术人员,极易根据上述实施例,领会本发明的精神,并做出不同的引申和变化,但只要不脱离本发明的精神,都在本发明的保护范围内。
Claims (7)
1.一种基于从端本地数据的波变量位移跟踪控制方法,其特征在于,首先设定主端机的速度为 ,主端机接收到操作者对其的力反馈信号为f mc ,从端机产生的速度命令信号为,从端机中速度PI控制器输出的控制从端机的作用力信号为;包括以下步骤:
7.如权利要求1所述的基于从端本地数据的波变量位移跟踪控制方法:其特征在于,所述速度PI控制器的比例系数为B,积分系数为K。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410075423.XA CN103862473A (zh) | 2014-03-04 | 2014-03-04 | 基于从端本地数据的波变量位移跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410075423.XA CN103862473A (zh) | 2014-03-04 | 2014-03-04 | 基于从端本地数据的波变量位移跟踪控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103862473A true CN103862473A (zh) | 2014-06-18 |
Family
ID=50901794
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410075423.XA Pending CN103862473A (zh) | 2014-03-04 | 2014-03-04 | 基于从端本地数据的波变量位移跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103862473A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104385271A (zh) * | 2014-09-06 | 2015-03-04 | 华北电力大学 | 基于互联网的遥操作机器人无源控制方法 |
CN105353616A (zh) * | 2015-11-17 | 2016-02-24 | 西北工业大学 | 一种基于波变量的定时延遥操作控制方法 |
CN105459118A (zh) * | 2016-01-07 | 2016-04-06 | 北京邮电大学 | 一种基于主端力缓冲的波变量四通道双边控制方法 |
CN106019981A (zh) * | 2016-05-16 | 2016-10-12 | 西北工业大学 | 一种用于时延非对称双人遥操作系统的稳定控制方法 |
CN108423427A (zh) * | 2018-03-05 | 2018-08-21 | 菲尼克斯(南京)智能制造技术工程有限公司 | 真空吸取装置和方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4011437A (en) * | 1975-09-12 | 1977-03-08 | Cincinnati Milacron, Inc. | Method and apparatus for compensating for unprogrammed changes in relative position between a machine and workpiece |
US20020123826A1 (en) * | 2001-01-30 | 2002-09-05 | Nec Corporation | Robot, robot control system, and program for the same |
CN102686366A (zh) * | 2010-08-31 | 2012-09-19 | 松下电器产业株式会社 | 主从机器人的控制装置及控制方法、主从机器人、控制程序、以及集成电子电路 |
CN102825603A (zh) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | 网络遥操作机器人系统及时延克服方法 |
-
2014
- 2014-03-04 CN CN201410075423.XA patent/CN103862473A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4011437A (en) * | 1975-09-12 | 1977-03-08 | Cincinnati Milacron, Inc. | Method and apparatus for compensating for unprogrammed changes in relative position between a machine and workpiece |
US20020123826A1 (en) * | 2001-01-30 | 2002-09-05 | Nec Corporation | Robot, robot control system, and program for the same |
CN102686366A (zh) * | 2010-08-31 | 2012-09-19 | 松下电器产业株式会社 | 主从机器人的控制装置及控制方法、主从机器人、控制程序、以及集成电子电路 |
CN102825603A (zh) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | 网络遥操作机器人系统及时延克服方法 |
Non-Patent Citations (4)
Title |
---|
张永林等: "时延遥操作系统控制的波变量法", 《信息与控制》, vol. 36, no. 5, 31 October 2007 (2007-10-31) * |
胡凌燕: "时延力反馈遥操作系统的跟踪性能及稳定性能研究", 《中国博士学位论文全文数据库 信息科技辑》, no. 6, 15 June 2012 (2012-06-15) * |
胡凌燕等: "PI控制的有时延遥操作系统仿真平台的建立", 《南昌大学学报》, vol. 35, no. 1, 28 February 2011 (2011-02-28) * |
赵迪等: "基于波变量的力反馈遥操作研究", 《华中科技大学学报》, vol. 39, no. 4, 30 April 2011 (2011-04-30) * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104385271A (zh) * | 2014-09-06 | 2015-03-04 | 华北电力大学 | 基于互联网的遥操作机器人无源控制方法 |
CN105353616A (zh) * | 2015-11-17 | 2016-02-24 | 西北工业大学 | 一种基于波变量的定时延遥操作控制方法 |
CN105459118A (zh) * | 2016-01-07 | 2016-04-06 | 北京邮电大学 | 一种基于主端力缓冲的波变量四通道双边控制方法 |
CN105459118B (zh) * | 2016-01-07 | 2018-05-22 | 北京邮电大学 | 一种基于主端力缓冲的波变量四通道双边控制方法 |
CN106019981A (zh) * | 2016-05-16 | 2016-10-12 | 西北工业大学 | 一种用于时延非对称双人遥操作系统的稳定控制方法 |
CN108423427A (zh) * | 2018-03-05 | 2018-08-21 | 菲尼克斯(南京)智能制造技术工程有限公司 | 真空吸取装置和方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103862473A (zh) | 基于从端本地数据的波变量位移跟踪控制方法 | |
CN104950677B (zh) | 基于反演滑模控制的机械臂系统饱和补偿控制方法 | |
CN103831831B (zh) | 具有时变时延的非线性遥操作系统位置和力跟踪控制系统 | |
CN105772917B (zh) | 一种三关节点焊机器人轨迹跟踪控制方法 | |
CN111037550B (zh) | 一种冗余度机械臂运动控制的解决方法 | |
WO2019100891A1 (zh) | 一种机器人运动规划的拓展解集对偶神经网络解决方法 | |
WO2018160267A3 (en) | Cloud based robotic control systems and methods | |
CN103901889A (zh) | 一种基于蓝牙通信的多机器人编队控制路径跟踪方法 | |
CN103869773A (zh) | 基于主端机的力反馈控制器校正反馈力的方法 | |
CN105522578B (zh) | 面向零力控制的模拟转矩控制方法以及系统 | |
CN105353616A (zh) | 一种基于波变量的定时延遥操作控制方法 | |
CN103389650A (zh) | 四通道遥操作系统的双边未知死区自适应控制系统 | |
WO2019139133A1 (ja) | モデル予測制御のための制御パラメータの設定方法 | |
CN102707671A (zh) | 应用于工具机的加工路径最佳化方法 | |
Wu et al. | Precise contour following for biaxial systems via an A-type iterative learning cross-coupled control algorithm | |
CN106737661A (zh) | 一种时延力反馈遥控机器人的自调整控制系统 | |
Kristalny et al. | On the decentralized H 2 optimal control of bilateral teleoperation systems with time delays | |
CN103802113A (zh) | 基于任务和样条曲线的工业机器人路径规划方法 | |
CN102427341B (zh) | 基于卡尔曼滤波的远程迭代学习控制系统传输噪声抑制方法 | |
WO2018209860A1 (zh) | 解耦控制方法、装置、机器人及存储介质 | |
CN204515479U (zh) | 一种基于EtherCAT总线的8轴机器人控制系统 | |
CN104564913A (zh) | 并联六自由度转台液压控制系统 | |
CN108021061A (zh) | 一种信号采集及控制系统 | |
Cheng et al. | Consensus of multiple Euler-Lagrange systems using one Euler-Lagrange System’s velocity measurements | |
CN105549392A (zh) | 一种伺服系统的非线性补偿控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20140618 |