CN107553485B - 一种人机交互过程中动态虚拟夹具的生成方法 - Google Patents
一种人机交互过程中动态虚拟夹具的生成方法 Download PDFInfo
- Publication number
- CN107553485B CN107553485B CN201710567819.XA CN201710567819A CN107553485B CN 107553485 B CN107553485 B CN 107553485B CN 201710567819 A CN201710567819 A CN 201710567819A CN 107553485 B CN107553485 B CN 107553485B
- Authority
- CN
- China
- Prior art keywords
- hand controller
- point
- target point
- moment
- dynamic
- 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
Images
Landscapes
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明涉及一种人机交互过程中动态虚拟夹具的生成方法,对于目标点位置跟踪,根据目标点位置设置虚拟夹具。能够针对于动态目标实时动态的生成虚拟夹具,适应更为复杂的任务要求,与现有技术相比,本发明具有如下有益效果:1)降低了操作者人为因素对于操作交互方式的影响;2)解决了操作者控制机械臂末端向动态目标点的逼近。
Description
技术领域
本发明属于操作交互控制领域,涉及一种人机交互过程中动态虚拟夹具的生成方法,可用于协助操作者在遥操作过程中更加精细化的操作,完成精确度要求较高的操作任务。
背景技术
遥操作技术及遥操作系统在过去的几十年里得到很大的发展。遥操作系统可以帮助操作者完成很多具有很大挑战性的作业任务,例如灾害救援、无人开采、危险物品处理、远程协助,远程医疗等。
遥操作过程中,末端机构执行操作者由交互系统发出的指令,进行相应的操作,并反馈回操作结果以及末端的工作状态,便于对末端状态进行预测。在遥操作过程中,精细化指令基本依靠操作者自身以相应的交互方式产生,很大程度上受到了操作者本身的限制。在现有的操作方式中,较多的使用了手控器作为主要的交互方式,而对于末端位置的控制,更多的需要靠操作者自身的观察来对末端进行相应的操作,而出于对人体机能的考虑,在精确度要求较高的操作任务中,仅仅依靠操作者自身对于末端的控制是不够的。为解决这个问题,确保操作者可以在指定时间里,更为精确的完成任务,研究者提出了一种虚拟夹具的概念。
虚拟夹具作为一种通用的引导方式,通过限制机器人末端运动位置,由虚拟环境产生抽象感官信息,力觉,触觉等信息,反馈给主端操作者,来达到辅助操作者完成精细化操作。
它是通过对机器人末端的期望运动进行约束作用来完成相应的辅助效果的。现有虚拟夹具的实现方法主要有:简单函数法、代理点法、势场法、非储能约束法、约束关节优化法、参考方向夹具法、机械式被动约束实现法等多种。对于一些场合的操作都有很明显的效果,但是对于空间动态目标点的虚拟夹具并没有很具体的实现策略,这对于操作要求而言依旧有些限制。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种人机交互过程中动态虚拟夹具的生成方法,对于空间动态虚拟夹具的生成方法提出一种较为可行的方案,对于需要操作者自身控制末端向目标动态位置移动的操作方式,生成动态实时更新的虚拟夹具,辅助操作者完成对末端的控制。
技术方案
一种人机交互过程中动态虚拟夹具的生成方法,其特征在于步骤如下:
步骤1、初始化操作:将手控器与其他相应的交互方式转换到同一个坐标系,使得手控器的位置与末端所在坐标系位置一一对应;
步骤2:获取t0时刻相应的目标点起始位置(Xd(t0),Yd(t0),Zd(t0))与速度信息Vd以及机器人末端的起始位置(Xe(t0),Ye(t0),Ze(t0));
步骤3:根据t0时刻目标点位置与机器人末端位置对t1时刻的机器人末端位置进行计算,得到下一时刻的位置(Xe(t1),Ye(t1),Ze(t1)),其方向由该时刻的末端位置点指向目标位置点:
其中:Ve选择保证机械臂运动稳定的最大速度;τ为相邻两个时刻的时间差;
步骤4:由目标点的动态信息,估算t1时刻的目标点位置(Xd(t1),Yd(t1),Zd(t1)),进而由得到的目标点位置利用式1对机器人末端位置进行t2时刻的估计(Xe(t2),Ye(t2),Ze(t2)),由此得到包括该时刻的三个机器人的末端位置:
步骤5:对步骤4计算所得的三个末端位置点进行Lagrange插值得到轨迹Ln(x),将轨迹Ln(x)映射到手控器所在的坐标系,得到更新的参考轨迹计;
步骤6:计算所得的参考轨迹的作用力,得到虚拟夹具
其中KGVF>0为设定的虚拟夹具的阻尼系数;其中KGVF>0为设定的虚拟夹具的阻尼系数;Pd为手控器期望移动位置点,设置为所得参考轨迹上的点;Pr为手控器实际移动位置点;RVF为手控器移动的位置偏差阈值;
步骤7:操作手控器进行移动,进入下一时刻后,重新进行步骤2-6,进行新的参考轨迹规划,直至操作结束。
有益效果
本发明提出的一种人机交互过程中动态虚拟夹具的生成方法,对于目标点位置跟踪,根据目标点位置设置虚拟夹具。能够针对于动态目标实时动态的生成虚拟夹具,适应更为复杂的任务要求,与现有技术相比,本发明具有如下有益效果:1)降低了操作者人为因素对于操作交互方式的影响;2)解决了操作者控制机械臂末端向动态目标点的逼近。
附图说明
图1:动态虚拟夹具生成策略流程图
具体实施方式
现结合实施例、附图对本发明作进一步描述:
本发明的目的在于解决空间遥操作任务中,针对于动态目标点,如何利用虚拟夹具辅助操作者完成对末端的位置控制,提出的一种动态虚拟夹具生成方法。具体是通过以下技术方案实现的:
步骤1:进行初始化操作,对选取的交互方式进行标定,进行位置在不同坐标系的统一。
步骤2:获取t0时刻相应的目标点起始位置(Xd(t0),Yd(t0),Zd(t0))与速度信息Vd以及机器人末端的起始位置(Xe(t0),Ye(t0),Ze(t0))。
步骤3:根据t0时刻目标点位置与机器人末端位置对t1时刻的机器人末端位置进行计算,得到(Xe(t1),Ye(t1),Ze(t1)),其方向由该时刻的末端位置点指向目标位置点。对于末端运动的速度选择,应选择保证机械臂运动稳定的最大速度Ve,对于手控器控制末端的运行速度也不能超过这个速度的阈值。计算方法如式(1)所示:
步骤4:由目标点的动态信息,估算t1时刻的目标点位置(Xd(t1),Yd(t1),Zd(t1)),进而由得到的目标点位置利用式对机器人末端位置进行t2时刻的估计(Xe(t2),Ye(t2),Ze(t2)),由此得到包括该时刻的三个机器人的末端位置。计算方法如(2)所示:
步骤5:由上个步骤计算所得的三个末端位置点进行Lagrange插值,计算方法如式(3)所示:
由上式得到Ln(x)即为所得的轨迹,将其映射到手控器所在的坐标系,得到更新的参考轨迹。
步骤6:针对所得的参考轨迹进行相应的虚拟夹具作用力计算:
其中KGVF>0为设定的虚拟夹具的阻尼系数;其中KGVF>0为设定的虚拟夹具的阻尼系数;Pd为手控器期望移动位置点,设置为所得参考轨迹上的点;Pr为手控器实际移动位置点,可由手控器相关函数获取;RVF为手控器移动的位置偏差阈值;大于阈值时设置力作用,小于等于该阈值时认为没有偏差,不设置力作用。
针对于所得的参考轨迹进行作用力设置,可以通过沿轨迹切线进行相应的作用力设定,将其进行相应的坐标变换设置在手控器坐标系中,使之只能沿轨迹方向运动,完成虚拟夹具的生成。
步骤7:操作手控器进行移动,根据指令时间,确定手控器末端速度,注意不要超限,进入下一时刻后,重新进行步骤2-6,进行新的参考轨迹规划,直至操作结束。
Claims (1)
1.一种人机交互过程中动态虚拟夹具的生成方法,其特征在于步骤如下:
步骤1、初始化操作:将手控器与其他相应的交互方式转换到同一个坐标系,使得手控器的位置与末端所在坐标系位置一一对应;
步骤2:获取t0时刻相应的目标点起始位置(Xd(t0),Yd(t0),Zd(t0))与速度信息Vd以及机器人末端的起始位置(Xe(t0),Ye(t0),Ze(t0));
步骤3:根据t0时刻目标点位置与机器人末端位置对t1时刻的机器人末端位置进行计算,得到下一时刻的位置(Xe(t1),Ye(t1),Ze(t1)),其方向由该时刻的末端位置点指向目标位置点:
其中:Ve选择保证机械臂运动稳定的最大速度;τ为相邻两个时刻的时间差;
步骤4:由目标点的动态信息,估算t1时刻的目标点位置(Xd(t1),Yd(t1),Zd(t1)),进而由得到的目标点位置利用式1对机器人末端位置进行t2时刻的估计(Xe(t2),Ye(t2),Ze(t2)),由此得到包括该时刻的三个机器人的末端位置:
步骤5:对步骤4计算所得的三个末端位置点进行Lagrange插值得到轨迹Ln(x),将轨迹Ln(x)映射到手控器所在的坐标系,得到更新的参考轨迹计;
步骤6:计算所得的参考轨迹的作用力,得到虚拟夹具
其中KGVF>0为设定的虚拟夹具的阻尼系数;Pd为手控器期望移动位置点,设置为所得参考轨迹上的点;Pr为手控器实际移动位置点;RVF为手控器移动的位置偏差阈值;
步骤7:操作手控器进行移动,进入下一时刻后,重新进行步骤2-6,进行新的参考轨迹规划,直至操作结束。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710567819.XA CN107553485B (zh) | 2017-07-13 | 2017-07-13 | 一种人机交互过程中动态虚拟夹具的生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710567819.XA CN107553485B (zh) | 2017-07-13 | 2017-07-13 | 一种人机交互过程中动态虚拟夹具的生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107553485A CN107553485A (zh) | 2018-01-09 |
CN107553485B true CN107553485B (zh) | 2020-05-12 |
Family
ID=60972703
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710567819.XA Active CN107553485B (zh) | 2017-07-13 | 2017-07-13 | 一种人机交互过程中动态虚拟夹具的生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107553485B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020010626A1 (zh) * | 2018-07-13 | 2020-01-16 | 深圳配天智能技术研究院有限公司 | 机器人的运动控制方法、机器人及机器人运动控制系统 |
CN109333497B (zh) * | 2018-11-30 | 2021-11-19 | 西华大学 | 一种带虚拟约束力的遥操作系统控制方法 |
CN110181517B (zh) * | 2019-06-21 | 2022-05-10 | 西北工业大学 | 一种基于虚拟夹具的双人遥操作训练方法 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ATE414594T1 (de) * | 2006-04-03 | 2008-12-15 | Abb Research Ltd | Vorrichtung und verfahren zur bahnerzeugung für einen industrieroboter |
KR101211601B1 (ko) * | 2010-11-05 | 2012-12-12 | 한국과학기술연구원 | 로봇의 양 팔을 이용해 물체를 잡기 위한 로봇의 동작 제어 시스템 및 제어 방법 |
JP5916320B2 (ja) * | 2011-08-31 | 2016-05-11 | 株式会社ハイボット | 遠隔操縦装置 |
US9849595B2 (en) * | 2015-02-06 | 2017-12-26 | Abb Schweiz Ag | Contact force limiting with haptic feedback for a tele-operated robot |
CN105242533B (zh) * | 2015-09-01 | 2017-11-28 | 西北工业大学 | 一种融合多信息的变导纳遥操作控制方法 |
CN106647260B (zh) * | 2016-11-18 | 2019-08-09 | 西北工业大学 | 一种基于相对阻抗的双臂遥操作自适应控制方法 |
CN109933097A (zh) * | 2016-11-21 | 2019-06-25 | 清华大学深圳研究生院 | 一种基于三维手势的空间机器人遥操作系统 |
CN106406098B (zh) * | 2016-11-22 | 2019-04-19 | 西北工业大学 | 一种机器人系统在未知环境下的人机交互控制方法 |
CN106625661B (zh) * | 2016-12-09 | 2019-08-09 | 北京邮电大学 | 一种基于osg的自适应虚拟夹具的构造方法 |
CN106873787A (zh) * | 2017-04-10 | 2017-06-20 | 武汉大学 | 一种用于虚拟手术仿真教学的手势交互系统及方法 |
-
2017
- 2017-07-13 CN CN201710567819.XA patent/CN107553485B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107553485A (zh) | 2018-01-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106945043B (zh) | 一种主从式遥操作手术机器人多臂协同控制系统 | |
Qi et al. | Kinematic control of continuum manipulators using a fuzzy-model-based approach | |
Sharifi et al. | Nonlinear model reference adaptive impedance control for human–robot interactions | |
US9149931B2 (en) | Robot system, robot control device and method for controlling robot | |
CN107553485B (zh) | 一种人机交互过程中动态虚拟夹具的生成方法 | |
US10821603B2 (en) | Methods and apparatus for robot control | |
JP2018514403A (ja) | ロボット操作を制御するシステムおよび方法 | |
CN111015649B (zh) | 一种驱控一体化控制系统 | |
CN103676787B (zh) | 一种用于运动控制系统的圆心模式空间圆弧插补方法 | |
CN106406098B (zh) | 一种机器人系统在未知环境下的人机交互控制方法 | |
CN102363301A (zh) | 机器人拟人手指自适应指尖力跟踪控制方法 | |
KR102030141B1 (ko) | 로봇의 팔꿈치 제어시스템 및 그 제어방법 | |
CN104260093A (zh) | 一种delta并联机械手控制系统 | |
CN110039561A (zh) | 基于点云的带电作业机器人遥操作人员培训系统及方法 | |
CN108472808B (zh) | 多个机器人的同步 | |
CN112894827B (zh) | 一种机械臂运动控制方法、系统、装置及可读存储介质 | |
KR101263487B1 (ko) | 로봇의 교시 장치 | |
CN108748150A (zh) | 面向机器人加工的低成本实时补偿装置及方法 | |
CN106292678B (zh) | 一种针对目标操作的空间机器人基座解耦控制方法 | |
CN205058074U (zh) | 一种机械臂空间定位设备 | |
RU2462745C1 (ru) | Система коррекции траектории движения манипулятора | |
CN113474130B (zh) | 利用机器人执行预先设定的任务的方法和系统 | |
RU2725930C1 (ru) | Комплекс копирующего управления манипуляторами антропоморфного робота | |
CN116276995B (zh) | 一种具有零空间避障能力的基于阻抗控制的人机协同方法 | |
Mihelj et al. | yControl-open architecture controller for Yaskawa Motoman MH5 robot |
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 |