CN103869773A - 基于主端机的力反馈控制器校正反馈力的方法 - Google Patents
基于主端机的力反馈控制器校正反馈力的方法 Download PDFInfo
- Publication number
- CN103869773A CN103869773A CN201410075986.9A CN201410075986A CN103869773A CN 103869773 A CN103869773 A CN 103869773A CN 201410075986 A CN201410075986 A CN 201410075986A CN 103869773 A CN103869773 A CN 103869773A
- Authority
- CN
- China
- Prior art keywords
- force
- main side
- feedback controller
- robot
- machine
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Manipulator (AREA)
Abstract
本发明公开一种基于主端机的力反馈控制器校正反馈力的方法,旨在解决反馈到主端机滞后的力反馈使主端机产生不正确运动,造成主从遥操作***不稳定的技术问题,本方法在于不需要测量和估算操作者施加的力,仅需要确定传递到主端机上的从端机器人与环境交互作用力,和主端机器人的运动速度即可能够提高遥操作稳定的同时,提高主从遥操作***的透明性。
Description
技术领域
本发明涉及远程主从遥操作***操作机器人控制技术领域,尤其涉及有时延和力反馈的主从遥操作***主从机器人控制技术中基于主端机的力反馈控制器校正反馈力的方法。
背景技术
主从遥操作***的工作模式是可以将人手延伸到人类很难到达或是对人有害的环境中去执行任务。主从遥操作***即在主端机操作者操作主端机处的机器人进行一个动作,在远处任务现场从端机处的机器人跟随主端机处的机器人进行相同的动作,并与任务现场的环境接触,为了使操作者有身临其境的感觉,需要将从端机处的机器人与环境交互的信息传递到主端机上,让操作者感知到。如果从端机处的机器人与主端机处的机器人速度及受到的反馈力是完全一样的,则相应的遥操作是透明的。由于主从遥操作***操作机器人之间通过网络连接,其间的数据通信存在有一定的时延。这种时延会引起带力反馈的主从遥操作***不稳定。
在实际应用过程中,尤其是从端机器人在水下作业或从端机器人与环境交互时,从端机处的机器人受到的作用力通常是阻碍其运动的。如果主从遥操作***完全透明,主端机与从端机各处的机器人的运动和受到作用力与从端机处的机器人完全一致,因此传递到主端机的作用力与其处的机器人的运动方向也相反。但在实际应用中由于网络数据传输存在时延,传递到主端机处的机器人上的作用力可能不是阻碍其运动,而与其运动方向相同,这样就使本来是负反馈的控制变成正反馈,造成整个遥操作***的不稳定。
发明内容
本发明的目的在于克服现有技术的不足,适应现实需要,提供一种基于主端机的力反馈控制器校正反馈力的方法,旨在解决反馈到主端机滞后的反馈力致使主端机产生不正确运动,造成主从遥操作***不稳定的技术问题。
为了实现本发明的目的,本发明采用的技术方案为:
设计一种基于主端机的力反馈控制器校正反馈力的方法,所述力反馈控制器进行力反馈的校正包括如下步骤:设定v m 为主端机检测到的主端机器人的速度, 为从端机传递到主端机的作用力;
所述步骤②、③相应的力反馈控制器按下式执行:。
本发明的有益效果在于:
本发明在主从遥操作***的主端机上设计一个力反馈控制器,它根据主端机反馈的运动方向和从端机反馈到其上的作用力方向判断引起***不稳定的反馈力是否需要过滤当前时刻的反馈力;其的优点在于不需要测量和估算操作者施加的力,仅需要确定传递到主端机的作用力和主端机的运动速度即可。在实际应用中本发明的力反馈控制方法很容易实现,且能够在保证***稳定的同时,提高主从遥操作***的透明性;而且解决了有时延条件下主从遥操作***中由于反馈力引起的***不稳定问题,在提高主从遥操作***稳定性的同时,改善了主从遥操作***的透明性。且能应用于在任意时延下的主从遥操作***操作机器人与环境接触时的控制,包括地面精确实时遥控太空或深海的机器人或机器臂完成异物清除,设备修理等操作。
附图说明
图1为基于本力反馈控制器的校正方法所设计的主从遥操作***示意图。
具体实施方式
下面结合附图和实施例对本发明进一步说明:
实施例:一种基于主端机的力反馈控制器校正反馈力的方法;该方法应用于的主端机包括主端机器人、主端机器人内部的主端控制计算机及力反馈控制器;从端机包括从端机器人、从端机器人内部的从端控制计算机及从端速度跟踪控制器;主端机与从端机建立网络通信。
本实施例将对以上内容详细说明如下:
在主端机,主端机器人在人的操作下进行一定的运动。主端机器人的运动速度及位移通过通信网络传递到从端机器人上,作为从端机器人的速度命令信号,从端机器人在速度控制器的作用下按照期望的轨迹与环境交互。从端机器人与环境交互力通过通信网络传递到主端机上,并使操作者能感觉到。
本发明实施例将以主从遥操作***操作机械臂控制机构进行说明,包括主端机机械臂,从端机机械臂。各机械臂之间通过通信网络连接起来。相应的网络通信时延为T。在主端机操作者操作机械臂打磨一个表面。在远处任务现场端从端机机械臂跟随主端机处的机械臂进行打磨,并将与物体表面之间的作用力反馈到主端机处的操作者手上,使操作者能感觉到打磨力,以正确的操作施加力,以免用力过大将物体弄破,或用力过小没打磨到。由于主从遥操作***中主端机与从端机之间通过通信网络连接,其间的数据通信存在时延T。设定vm,vsc,vs分别是主端机的速度、从端机的期望速度、从端机的实际速度;,,,分别是传递到主端机的作用力、力反馈控制器输出的作用力、操作者施加的力以及作用在主端机上的力;是从端的控制力。T是指数据在主端机、从端机之间的传输时延。即主端机的机械臂速度与从端机的机械臂作用力之间关系如下公式所示:
具体力反馈控制器的算法如下:当传递到主端机的作用力和主端机处运动方向v m 一致时,相应的作用力会引起***不稳定,则这个作用力被过滤掉;当传递到主端机上的作用力和主端机运动方向v m 相反时,这个作用力是正确的,保持不变。相应力反馈控制器的可以按式
本发明的特点在于:在于不需要测量和估算操作者施加的力,力反馈控制器的输入信号为主端机本地信号:传递到主端机的作用力和主端机的运动速度v m ,易于实现。该控制器能够提高该***的透明性和同时改善***的稳定性。
本发明的实施例公布的是较佳的实施例,但并不局限于此,本领域的普通技术人员,极易根据上述实施例,领会本发明的精神,并做出不同的引申和变化,但只要不脱离本发明的精神,都在本发明的保护范围内。
Claims (2)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410075986.9A CN103869773A (zh) | 2014-03-04 | 2014-03-04 | 基于主端机的力反馈控制器校正反馈力的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410075986.9A CN103869773A (zh) | 2014-03-04 | 2014-03-04 | 基于主端机的力反馈控制器校正反馈力的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103869773A true CN103869773A (zh) | 2014-06-18 |
Family
ID=50908416
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410075986.9A Pending CN103869773A (zh) | 2014-03-04 | 2014-03-04 | 基于主端机的力反馈控制器校正反馈力的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103869773A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104808668A (zh) * | 2015-04-28 | 2015-07-29 | 东南大学 | 基于力信息的多移动机器人协作搬运平板状物体方法 |
CN106737661A (zh) * | 2016-11-21 | 2017-05-31 | 电子科技大学 | 一种时延力反馈遥控机器人的自调整控制*** |
CN107223219A (zh) * | 2016-09-26 | 2017-09-29 | 深圳市大疆创新科技有限公司 | 控制方法、控制设备和运载*** |
CN105373652B (zh) * | 2015-10-23 | 2018-12-07 | 南昌大学 | 手术稳定控制的仿真方法 |
CN110007601A (zh) * | 2019-05-06 | 2019-07-12 | 广东工业大学 | 一种双边遥操作***的控制装置和设备 |
CN110842910A (zh) * | 2018-08-21 | 2020-02-28 | 精工爱普生株式会社 | 机器人***、机器人及控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101373380A (zh) * | 2008-07-14 | 2009-02-25 | 浙江大学 | 一种仿人机器人控制***及机器人操纵方法 |
CN201638053U (zh) * | 2009-12-31 | 2010-11-17 | 重庆工商职业学院 | 巡检机器人 |
US7965276B1 (en) * | 2000-03-09 | 2011-06-21 | Immersion Corporation | Force output adjustment in force feedback devices based on user contact |
EP2089783B1 (en) * | 2006-10-25 | 2012-03-28 | The Boeing Company | System and method for haptics-enabled teleoperation of vehicles |
CN103123468A (zh) * | 2011-11-18 | 2013-05-29 | 南京航空航天大学 | 三轴天线测试机器人伺服控制器 |
-
2014
- 2014-03-04 CN CN201410075986.9A patent/CN103869773A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7965276B1 (en) * | 2000-03-09 | 2011-06-21 | Immersion Corporation | Force output adjustment in force feedback devices based on user contact |
EP2089783B1 (en) * | 2006-10-25 | 2012-03-28 | The Boeing Company | System and method for haptics-enabled teleoperation of vehicles |
CN101373380A (zh) * | 2008-07-14 | 2009-02-25 | 浙江大学 | 一种仿人机器人控制***及机器人操纵方法 |
CN201638053U (zh) * | 2009-12-31 | 2010-11-17 | 重庆工商职业学院 | 巡检机器人 |
CN103123468A (zh) * | 2011-11-18 | 2013-05-29 | 南京航空航天大学 | 三轴天线测试机器人伺服控制器 |
Non-Patent Citations (1)
Title |
---|
胡凌燕: ""时延反馈遥操作***的跟踪性能及稳定性研究"", 《中国博士学位论文全文数据库 信息科技辑》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104808668A (zh) * | 2015-04-28 | 2015-07-29 | 东南大学 | 基于力信息的多移动机器人协作搬运平板状物体方法 |
CN105373652B (zh) * | 2015-10-23 | 2018-12-07 | 南昌大学 | 手术稳定控制的仿真方法 |
CN107223219A (zh) * | 2016-09-26 | 2017-09-29 | 深圳市大疆创新科技有限公司 | 控制方法、控制设备和运载*** |
US11092975B2 (en) | 2016-09-26 | 2021-08-17 | SZ DJI Technology Co., Ltd. | Control method, control device, and carrier system |
US11724805B2 (en) | 2016-09-26 | 2023-08-15 | SZ DJI Technology Co., Ltd. | Control method, control device, and carrier system |
CN106737661A (zh) * | 2016-11-21 | 2017-05-31 | 电子科技大学 | 一种时延力反馈遥控机器人的自调整控制*** |
CN106737661B (zh) * | 2016-11-21 | 2019-03-01 | 电子科技大学 | 一种时延力反馈遥控机器人的自调整控制*** |
CN110842910A (zh) * | 2018-08-21 | 2020-02-28 | 精工爱普生株式会社 | 机器人***、机器人及控制方法 |
CN110842910B (zh) * | 2018-08-21 | 2023-01-13 | 精工爱普生株式会社 | 机器人***、机器人及控制方法 |
CN110007601A (zh) * | 2019-05-06 | 2019-07-12 | 广东工业大学 | 一种双边遥操作***的控制装置和设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103869773A (zh) | 基于主端机的力反馈控制器校正反馈力的方法 | |
CN106003034B (zh) | 一种主从式机器人控制***及控制方法 | |
Li et al. | Comments on the paper: Robust controllers design with finite time convergence for rigid spacecraft attitude tracking control | |
SG10201803528TA (en) | System and method for immersive cave application | |
CN103713579B (zh) | 一种工业机器人作业方法 | |
WO2017115385A3 (en) | System and method for operating and controlling a hyper configurable humanoid robot to perform multiple applications in various work environments | |
CN105242533A (zh) | 一种融合多信息的变导纳遥操作控制方法 | |
JP2017027501A (ja) | 工作機械とロボットのリアルタイム干渉確認システム | |
CN101887264B (zh) | 基于触觉传感器的遥操作机器人力觉临场感控制方法 | |
CN108638052A (zh) | 一种闭链式多臂机器人柔顺控制方法 | |
EP3919864A3 (en) | Method and apparatus for processing map data | |
CN104647385A (zh) | 定位*** | |
CN103862473A (zh) | 基于从端本地数据的波变量位移跟踪控制方法 | |
CN107696036B (zh) | 一种仿人机械臂用的拖动示教器 | |
CN107553485B (zh) | 一种人机交互过程中动态虚拟夹具的生成方法 | |
CN103383552A (zh) | 一种任意平面圆弧插补运动控制器及其控制方法 | |
CN111615437A (zh) | 用于机器人加工的方法和装置 | |
CN204515479U (zh) | 一种基于EtherCAT总线的8轴机器人控制*** | |
CN204725516U (zh) | 一种适用于流水线作业的单视觉配合多机器人定位*** | |
CN103543677A (zh) | 一种配药机器人的回零控制***及其实现方法 | |
Xu et al. | Point-cloud-based model-mediated teleoperation | |
CN205844881U (zh) | 基于opc环网柜自动装配流水线控制装置 | |
CN106445193B (zh) | 一种基于手机操控的激光笔演示*** | |
WO2023086524A3 (en) | Systems and methods for real-time control of a robot using a robot animation system | |
CN105437231A (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 | ||
C12 | Rejection of a patent application after its publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20140618 |