异构机器人遥操作系统位置和速度同步控制方法技术方案

本发明专利技术属于机器人遥操作控制技术领域。本发明专利技术公开了一种异构机器人遥操作系统位置和速度同步控制方法，主要步骤包括：施加作用力fh使主机器人产生位置信息xmaster和位置变化量；位置信息xmaster及主机器人位置变化量通过通讯网络传递给从机器人；从机器人运动并产生位置信息xslave；以主机器人位置信息xmaster控制从机器人位置信息xslave，实现主机器人和从机器人位置同步；以主机器人位置变化量控制从机器人的速度Vs，实现主机器人和从机器人速度同步。本发明专利技术实现了主机器人的位置信息控制从机器人在三维任务空间中的位置移动，同时也使主机器人在该过程中的位置变化量控制从机器人在三维任务空间中的速度变化，实现了从机器人的位置和速度与主机器人的位置和速度保持同步。

【技术实现步骤摘要】
异构机器人遥操作系统位置和速度同步控制方法
本专利技术属于机器人遥操作控制
特别涉及一种异构机器人遥操作系统位置和速度同步控制方法。
技术介绍
异构机器人遥操作系统将人的经验智慧与机器人的优势相结合，实现了人的行为能力与感知能力的延伸，让机器人能够代替人在复杂或恶劣环境中进行作业，从而可以避免对人体产生伤害，降低生产成本，提高生产效率。在太空、深海、医疗手术、矿工业以及核工业等领域得到了广泛应用。因此实现主机器人与从机器人的位置同步跟踪及对从机器人速度的精确控制，是机器人遥操作系统中最重要功能。异构机器人遥操作系统因其所使用的主机器人和从机器人型号和结构不同，搭建遥操作系统平台的方法不同。对于速度与位置控制方法，其中比较有代表性的为：文献[M.MamdouhandA.A.Ramadan,"Developmentofateleoperationsystemwithanewworkspacespanningtechnique,"2012IEEEInternationalConferenceonRoboticsandBiomimetics(ROBIO),Guangzhou,2012,pp.1570-1575.]主要利用主机器人端的额外开关变量来进行开关的切换，触发开关设定不同的模式，实现不同形式的主从机器人位置和速度的控制，以此达到主机器人在微小范围及大范围内对从机器人运动模式的控制。文献[FarkhatdinovI,RyuJH.Hybridposition-positionandposition-speedcommandstrategyforthebilateralteleoperationofamobilerobot[C].InternationalConferenceonControl,AutomationandSystems.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为从机器人在任务空间中的位置矢量，在机器人任务空间三维本文档来自技高网...

【技术保护点】
1.异构机器人遥操作系统位置和速度同步控制方法，其特征在于，包括如下步骤：施加作用力fh使主机器人产生位置信息xmaster和位置变化量；位置信息xmaster及主机器人位置变化量通过通讯网络传递给从机器人；从机器人运动并产生位置信息xslave；以主机器人位置信息xmaster控制从机器人位置信息xslave，实现主机器人和从机器人位置同步；以主机器人位置变化量控制从机器人的速度Vs，实现主机器人和从机器人速度同步。

【技术特征摘要】
1.异构机器人遥操作系统位置和速度同步控制方法，其特征在于，包括如下步骤：施加作用力fh使主机器人产生位置信息xmaster和位置变化量；位置信息xmaster及主机器人位置变化量通过通讯网络传递给从机器人；从机器人运动并产生位置信息xslave；以主机器人位置信息xmaster控制从机器人位置信息xslave，实现主机器人和从机器人位置同步；以主机器人位置变化量控制从机器人的速度Vs，实现主机器人和从机器人速度同步。2.根据权利要求1所述的异构机器人遥操作系统位置和速度同步控制方法，其特征在于，所述作用力fh为操作者施加的力。3.根据权利要求2所述的异构机器人遥操作系统位置和速度同步控制方法，其特征在于，还包括步骤：作用力fh使从机器人作用于目标物，并使从机器人产生作用于目标物的力fenvi，该力fenvi反馈给操作者，使其进行下一步操作。4.根据权利要求1～3任意一项所述的异构机器人遥操作系统位置和速度同步控制方法，其特征在于，所述主机器人位置信息xmaster为主机器人的三维空间坐标；所述从机器人位置信息xslave为从机器人任务空间的三...

【专利技术属性】
技术研发人员：刘霞，潘成伟，董秀成，
申请(专利权)人：西华大学，
类型：发明
国别省市：四川,51