CN108818533B - 异构机器人遥操作***位置和速度同步控制方法 - Google Patents
异构机器人遥操作***位置和速度同步控制方法 Download PDFInfo
- Publication number
- CN108818533B CN108818533B CN201810680814.2A CN201810680814A CN108818533B CN 108818533 B CN108818533 B CN 108818533B CN 201810680814 A CN201810680814 A CN 201810680814A CN 108818533 B CN108818533 B CN 108818533B
- Authority
- CN
- China
- Prior art keywords
- robot
- slave
- master
- task space
- main
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 21
- 230000001360 synchronised effect Effects 0.000 title claims abstract description 14
- 238000004891 communication Methods 0.000 claims abstract description 7
- 239000004576 sand Substances 0.000 abstract description 3
- 238000004886 process control Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 6
- 238000011161 development Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000005065 mining Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- 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
-
- 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
-
- 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/1679—Programme controls characterised by the tasks executed
-
- 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/1679—Programme controls characterised by the tasks executed
- B25J9/1689—Teleoperation
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明属于机器人遥操作控制技术领域。本发明公开了一种异构机器人遥操作***位置和速度同步控制方法,主要步骤包括:施加作用力fh使主机器人产生位置信息xmaster和位置变化量;位置信息xmaster及主机器人位置变化量通过通讯网络传递给从机器人;从机器人运动并产生位置信息xslave;以主机器人位置信息xmaster控制从机器人位置信息xslave,实现主机器人和从机器人位置同步;以主机器人位置变化量控制从机器人的速度Vs,实现主机器人和从机器人速度同步。本发明实现了主机器人的位置信息控制从机器人在三维任务空间中的位置移动,同时也使主机器人在该过程中的位置变化量控制从机器人在三维任务空间中的速度变化,实现了从机器人的位置和速度与主机器人的位置和速度保持同步。
Description
技术领域
本发明属于机器人遥操作控制技术领域。特别涉及一种异构机器人遥操作***位置和速度同步控制方法。
背景技术
异构机器人遥操作***将人的经验智慧与机器人的优势相结合,实现了人的行为能力与感知能力的延伸,让机器人能够代替人在复杂或恶劣环境中进行作业,从而可以避免对人体产生伤害,降低生产成本,提高生产效率。在太空、深海、医疗手术、矿工业以及核工业等领域得到了广泛应用。因此实现主机器人与从机器人的位置同步跟踪及对从机器人速度的精确控制,是机器人遥操作***中最重要功能。
异构机器人遥操作***因其所使用的主机器人和从机器人型号和结构不同,搭建遥操作***平台的方法不同。对于速度与位置控制方法,其中比较有代表性的为:文献[M.Mamdouh and A.A.Ramadan,"Development of a teleoperation system with a newworkspace spanning technique,"2012IEEE International Conference on Roboticsand Biomimetics(ROBIO),Guangzhou,2012,pp.1570-1575.]主要利用主机器人端的额外开关变量来进行开关的切换,触发开关设定不同的模式,实现不同形式的主从机器人位置和速度的控制,以此达到主机器人在微小范围及大范围内对从机器人运动模式的控制。文献[Farkhatdinov I,Ryu J H.Hybrid position-position and position-speed commandstrategy for the bilateral teleoperation of a mobile robot[C].InternationalConference on Control,Automation and Systems.IEEE,2007:2442-2447.]针对轮式移动机器人的远程导航遥操作***,提出了一种位置-位置和位置-速度模式的混合控制方法,通过对两种模式的切换以实现在二维平面上主机器人对轮式移动机器人的位置或者对其线速度、航向角度的控制。
这些方法存在的不足之处主要在于需要手动进行开关的切换,增加了异构遥操作***控制的复杂性,对于从机器人的操作也缺乏灵活性。
发明内容
本发明的主要目的在于提供一种异构机器人遥操作***位置和速度同步控制方法,以改善异构型机器人遥操作***的操作性能。
为了实现上述目的,根据本发明具体实施方式的一个方面,提供了一种异构机器人遥操作***位置和速度同步控制方法,其特征在于,包括如下步骤:
施加作用力fh使主机器人产生位置信息xmaster和位置变化量;
位置信息xmaster及主机器人位置变化量通过通讯网络传递给从机器人;
从机器人运动并产生位置信息xslave;
以主机器人位置信息xmaster控制从机器人位置信息xslave,实现主机器人和从机器人位置同步;
以主机器人位置变化量控制从机器人的速度Vs,实现主机器人和从机器人速度同步。
进一步的,所述作用力fh为操作者施加的力。
进一步的,还包括步骤:
作用力fh使从机器人作用于目标物,并使从机器人产生作用于目标物的力fenvi,该力fenvi反馈给操作者,使其进行下一步操作。
进一步的,所述主机器人位置信息xmaster为主机器人的三维空间坐标;所述从机器人位置信息xslave为从机器人任务空间的三维空间坐标。
进一步的,所述主机器人位置信息xmaster和从机器人位置信息xslave满足关系式:
其中,xm,ym,zm为主机器人在任务空间中的位置矢量;xs,ys,zs为从机器人在任务空间中的位置矢量;在机器人任务空间三维坐标中,xm对应xs;ys对应zm;zs对应ym;kx,ky,kz为主机器人在任务空间中的比例常数;λx,λy,λz为主机器人在任务空间中的参数常量。
进一步的,所述主机器人位置变化量与从机器人的速度Vs满足关系式:
其中,vzx,vzy,vxy代表从机器人在任务空间中各三维坐标上的速度;k1,k2,k3为从机器人在任务空间中各三维坐标上速度变化的比例常数;h1,h2,h3分别代表主机器人在任务空间中zx,zy,xy三维坐标上的位置取值;Δxm,Δzm,Δym分别表示主机器人在任务空间中的坐标轴x,z,y上的单位时间位置变化量;xd,zd,yd为主机器人在任务空间中各坐标上限定的边界常量值。
本发明的有益效果是,克服了现有技术中需要手动切换模式的问题,利用操作者作用于主机器人的力,使主机器人产生位置信息,实现主机器人的位置信息控制从机器人在三维任务空间中的位置移动,同时也使主机器人在该过程中的位置变化量控制从机器人在三维任务空间中的速度变化,实现从机器人的位置和速度与主机器人的位置和速度保持同步,从而使从机器人更为精确、快速地作用于目标物。
下面结合附图和具体实施方式对本发明做进一步的说明。本发明附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
构成本申请的一部分的附图用来提供对本发明的进一步理解,本发明的具体实施方式、示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明控制原理示意图;
图2为位置-位置控制示意图;
图3为主机器人任务空间中的三维坐标示意图;
图4为从机器人任务空间中的三维坐标示意图;
图5为位置-速度控制示意图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的具体实施方式、实施例以及其中的特征可以相互组合。现将参考附图并结合以下内容详细说明本发明。
为了使本领域技术人员更好的理解本发明方案,下面将结合本发明具体实施方式、实施例中的附图,对本发明具体实施方式、实施例中的技术方案进行清楚、完整的描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的具体实施方式、实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施方式、实施例,都应当属于本发明保护的范围。
实施例
本发明异构机器人遥操作***位置与速度同步控制方法,操作原理如图1所示,包括操作者、主机器人、计算机、通信网络、从机器人和目标物。操作者作用于主机器人的力fh,使主机器人产生位置信息xmaster和位置变化量,位置信息xmaster及主机器人位置变化量通过通讯网络传递给从机器人;从而控制从机器人在三维任务空间中的位置xslave,使主机器人在该过程中的位置变化量控制从机器人在三维任务空间中的速度Vs,实现从机器人的位置和速度与主机器人的位置和速度保持同步。使从机器人更精确地作用于目标物,并使从机器人产生作用于目标物的力fenvi,经过通信网络将该力fenvi反馈给操作者端,使其进行下一步操作。
主从机器人位置-位置的同步控制,如图2所示。
操作者作用于主机器人的力fh,使主机器人产生位置信息xmaster,经过通信网络进行信息传递,使从机器人运动并产生位置信息xslave,并使从机器人产生作用于目标物的力fenvi,从而实现了主机器人对从机器人位置-位置的同步控制,其公式为:
其中,xm,ym,zm为主机器人在任务空间中的位置矢量;xs,ys,zs为从机器人在任务空间中的位置矢量,在机器人任务空间三维坐标中xm对应xs;ys对应zm;zs对应ym;kx,ky,kz为主机器人在任务空间中的比例常数,λx,λy,λz为主机器人在任务空间中参数常量,主从机器人在任务空间中的三维坐标示意图分别如图3和4所示。
主从机器人的位置-速度控制,如图5所示。
通过操作主机器人进行位置移动,此时主机器人移动产生的位置信息xmaster的变化量转化为从机器人的速度信息Vs,使从机器人更精确地作用于目标物,并使从机器人产生作用于目标物的力fenvi。从而达到主从机器人的速度同步,实现了利用主机器人的位置对从机器人的速度控制。
主从机器人的位置-速度控制分如下三种情况:
情况1
当从机器人到目标物的距离L大于等于设定的从机器人到目标物的安全距离常量Lp(即L≥Lp)时,表明从机器人的距离目标物在安全距离之外,此时主机器人在任务空间中的速度Vm大于等于所设定的主机器人的正常速度常量Vp(即Vm≥Vp),从机器人的实时速度参数Vs大于等于从机器人的正常速度常量Vq(即Vs≥Vq)。
情况2
当从机器人到目标物的距离L小于设定的从机器人到目标物的安全距离常量Lp(即L<Lp)时,表明从机器人的距离目标物在设定的安全距离以内,此时操作者通过操作主机器人进行位置移动,通过位置-速度控制实现主从机器人的速度同步,而达到从机器人在有限范围内进行位置的小幅度移动的目的,此时主机器人在任务空间中的速度Vm小于所设定的主机器人的正常速度常量Vp(即Vm<Vp)时,从机器人的实时速度参数Vs小于从机器人的正常速度常量Vq(即Vs<Vq)时。
主从机器人位置-速度的同步控制,公式为:
其中,主从机器人任务空间中的三维坐标示意图分别如图3和4所示。Vm,Vs代表从机器人的速度,vzx,vzy,vxy代表从机器人在任务空间中各三维坐标上的速度,k1,k2,k3为从机器人在任务空间中各三维坐标上速度变化的比例常数,h1,h2,h3分别代表主机器人在任务空间中zx,zy,xy三维坐标上的位置取值,Δxm,Δzm,Δym分别表示主机器人在任务空间中的坐标轴x,z,y上的单位时间位置变化量,xd,zd,yd为主机器人在任务空间中各坐标上限定的边界常量值,即主机器人在此常量值范围内进行微小移动时,从机器人的速度将不跟随产生变化,以防止因人手抖动而造成的误差操作。
Claims (4)
1.异构机器人遥操作***位置和速度同步控制方法,其特征在于,包括如下步骤:
施加作用力fh使主机器人产生位置信息xmaster和位置变化量;
位置信息xmaster及主机器人位置变化量通过通讯网络传递给从机器人;
从机器人运动并产生位置信息xslave;
以主机器人位置信息xmaster控制从机器人位置信息xslave,实现主机器人和从机器人位置同步;
以主机器人位置变化量控制从机器人的速度Vs,实现主机器人和从机器人速度同步;
所述主机器人位置信息xmaster为主机器人的三维空间坐标;所述从机器人位置信息xslave为从机器人任务空间的三维空间坐标;
所述主机器人位置变化量与从机器人的速度Vs满足关系式:
其中,vzx,vzy,vxy代表从机器人在任务空间中各三维坐标上的速度;k1,k2,k3为从机器人在任务空间中各三维坐标上速度变化的比例常数;h1,h2,h3分别代表主机器人在任务空间中zx,zy,xy三维坐标上的位置取值;△xm,△zm,△ym分别表示主机器人在任务空间中的坐标轴x,z,y上的单位时间位置变化量;xd,zd,yd为主机器人在任务空间中各坐标上限定的边界常量值。
2.根据权利要求1所述的异构机器人遥操作***位置和速度同步控制方法,其特征在于,所述作用力fh为操作者施加的力。
3.根据权利要求2所述的异构机器人遥操作***位置和速度同步控制方法,其特征在于,还包括步骤:
作用力fh使从机器人作用于目标物,并使从机器人产生作用于目标物的力fenvi,该力fenvi反馈给操作者,使其进行下一步操作。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810680814.2A CN108818533B (zh) | 2018-06-27 | 2018-06-27 | 异构机器人遥操作***位置和速度同步控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810680814.2A CN108818533B (zh) | 2018-06-27 | 2018-06-27 | 异构机器人遥操作***位置和速度同步控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108818533A CN108818533A (zh) | 2018-11-16 |
CN108818533B true CN108818533B (zh) | 2021-05-18 |
Family
ID=64139031
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810680814.2A Active CN108818533B (zh) | 2018-06-27 | 2018-06-27 | 异构机器人遥操作***位置和速度同步控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108818533B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109333497B (zh) * | 2018-11-30 | 2021-11-19 | 西华大学 | 一种带虚拟约束力的遥操作***控制方法 |
CN111427264B (zh) * | 2020-03-15 | 2021-12-14 | 中国地质大学(武汉) | 一种复杂遥操作技术的神经自适应固定时间控制方法 |
CN111745643A (zh) * | 2020-05-28 | 2020-10-09 | 西华大学 | 主机器人和从机器人遥操作***位置控制方法 |
CN113021344A (zh) * | 2021-03-19 | 2021-06-25 | 南开大学 | 一种主从异构型遥操作机器人工作空间映射方法 |
US20220371186A1 (en) * | 2021-05-19 | 2022-11-24 | Guangzhou Institute of advanced technology | Dual-robot position/force multivariate-data-driven method using reinforcement learning |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01147939A (ja) * | 1987-12-04 | 1989-06-09 | Fujitsu Ltd | ロボット制御方式 |
CN101132336A (zh) * | 2007-10-17 | 2008-02-27 | 中国人民解放军国防科学技术大学 | 异构多核处理器高速异步互连通信网络 |
CN103273489A (zh) * | 2013-05-10 | 2013-09-04 | 上海大学 | 基于主从遥操作机械臂的机器人控制***及方法 |
CN106003034A (zh) * | 2016-06-16 | 2016-10-12 | 深圳先进技术研究院 | 一种主从式机器人控制***及控制方法 |
CN106272484A (zh) * | 2016-10-09 | 2017-01-04 | 福州大学 | 一种多异构工业机器人控制*** |
CN107717994A (zh) * | 2017-11-08 | 2018-02-23 | 西安交通大学 | 基于主从空间映射的主从异构机器人通用控制方法及*** |
-
2018
- 2018-06-27 CN CN201810680814.2A patent/CN108818533B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01147939A (ja) * | 1987-12-04 | 1989-06-09 | Fujitsu Ltd | ロボット制御方式 |
CN101132336A (zh) * | 2007-10-17 | 2008-02-27 | 中国人民解放军国防科学技术大学 | 异构多核处理器高速异步互连通信网络 |
CN103273489A (zh) * | 2013-05-10 | 2013-09-04 | 上海大学 | 基于主从遥操作机械臂的机器人控制***及方法 |
CN106003034A (zh) * | 2016-06-16 | 2016-10-12 | 深圳先进技术研究院 | 一种主从式机器人控制***及控制方法 |
CN106272484A (zh) * | 2016-10-09 | 2017-01-04 | 福州大学 | 一种多异构工业机器人控制*** |
CN107717994A (zh) * | 2017-11-08 | 2018-02-23 | 西安交通大学 | 基于主从空间映射的主从异构机器人通用控制方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN108818533A (zh) | 2018-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108818533B (zh) | 异构机器人遥操作***位置和速度同步控制方法 | |
CN106003034B (zh) | 一种主从式机器人控制***及控制方法 | |
CN107877517B (zh) | 基于CyberForce遥操作机械臂的运动映射方法 | |
CN110825076B (zh) | 基于视线和力反馈的移动机器人编队导航半自主控制方法 | |
CN104808668B (zh) | 基于力信息的多移动机器人协作搬运平板状物体方法 | |
US20160279788A1 (en) | Master-Slave System | |
CN109669479A (zh) | 一种基于事件触发的移动机器人轨迹跟踪控制方法 | |
CN105242533A (zh) | 一种融合多信息的变导纳遥操作控制方法 | |
CN104950885A (zh) | 一种基于视觉和力觉反馈的uav群双边遥操作控制***及其方法 | |
Li et al. | A hybrid visual servo control method for simultaneously controlling a nonholonomic mobile and a manipulator | |
CN110039561A (zh) | 基于点云的带电作业机器人遥操作人员培训***及方法 | |
CN102922522A (zh) | 多自由度电液伺服遥操纵机械手力反馈控制方法 | |
CN114571469A (zh) | 一种机械臂零空间实时避障控制方法及*** | |
Yu et al. | Gesture-based telemanipulation of a humanoid robot for home service tasks | |
Pepe et al. | A hybrid teleoperation control scheme for a single-arm mobile manipulator with omnidirectional wheels | |
Cefalo et al. | Sensor-based task-constrained motion planning using model predictive control | |
CN107553485B (zh) | 一种人机交互过程中动态虚拟夹具的生成方法 | |
CN111745643A (zh) | 主机器人和从机器人遥操作***位置控制方法 | |
Gonzalez et al. | Smooth transition-based control of encounter-type haptic devices | |
Gou et al. | Workspace mapping method based on edge drifting for the teleoperation system | |
CN115533899A (zh) | 一种基于力反馈的主从异构遥操作工作空间映射方法 | |
CN112077841B (zh) | 一种提升机器人手臂操纵精度的多关节联动方法及*** | |
Bipin et al. | Autonomous navigation of generic quadrocopter with minimum time trajectory planning and control | |
CN113021344A (zh) | 一种主从异构型遥操作机器人工作空间映射方法 | |
CN112936258A (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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20240118 Address after: 230000 floor 1, building 2, phase I, e-commerce Park, Jinggang Road, Shushan Economic Development Zone, Hefei City, Anhui Province Patentee after: Dragon totem Technology (Hefei) Co.,Ltd. Address before: 610039 No. 999, golden week Road, Chengdu, Sichuan, Jinniu District Patentee before: XIHUA University |
|
TR01 | Transfer of patent right |