CN106625661B - 一种基于osg的自适应虚拟夹具的构造方法 - Google Patents
一种基于osg的自适应虚拟夹具的构造方法 Download PDFInfo
- Publication number
- CN106625661B CN106625661B CN201611127746.4A CN201611127746A CN106625661B CN 106625661 B CN106625661 B CN 106625661B CN 201611127746 A CN201611127746 A CN 201611127746A CN 106625661 B CN106625661 B CN 106625661B
- Authority
- CN
- China
- Prior art keywords
- point
- virtual
- clamp
- virtual clamp
- key point
- 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
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
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- 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/1679—Programme controls characterised by the tasks executed
- B25J9/1689—Teleoperation
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Image Generation (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
本发明公开一种基于OSG的自适应虚拟夹具的构造方法。针对机器人遥操作虚拟训练领域,虚拟夹具可以帮助实现快速定位和保障安全。本发明提出的一种自适应虚拟夹具的构建策略,针对不用环境条件构建适合的虚拟夹具,以虚拟夹具的构建效率,从而提高整个虚拟操作的效率。从目标物体想从起始点运动到目的点,通过OSG的碰撞检测库中射线检测方法检测两点之间是否有其他物体,若不存在则建立简单形状如圆柱体的虚拟夹具,否则自适应地构建一条安全且路径较短的虚拟管道的虚拟夹具。本发明相对传统方法的虚拟夹具形状单一和不变性,有更好的鲁棒性和通用性,而且最大限度地降低虚拟夹具建模的复杂度,从而大大提高***效率。
Description
技术领域
机器人遥操作虚拟维护训练***。
背景技术
虚拟夹具是遥操作领域中一个很重要的辅助手段,特别是控制机械臂在虚拟场景中运动的时候,虚拟夹具可以限制机械臂的运动空间,并利用一定的虚拟夹具的引导算法来导引机械臂手部的运动,从而帮助操作者控制机器人能够更好更快的完成任务,提高工作效率。虚拟夹具在基于虚拟场景的机器人遥操作***已经得到了较好的应用和发展。然而传统的虚拟夹具存在诸多的弊端:不能根据环境变化调节虚拟夹具结构,不同的环境下需要更换虚拟夹具。
虽然虚拟夹具具有各种各样的形态,但是其最终目的都是为了能让目标执行器能够在虚拟夹具内部的安全范围内运动,将机械臂末端在靠近目的地的过程中,避免其穿出虚拟夹具从而和外部环境发生碰撞,这样可以很好地保护机械臂。本文提出了自适应虚拟夹具的方法,具有根据环境变化动态调整虚拟夹具的功能。可以不需要对虚拟夹具进行建模,而是当外界变化的时候,可以自适应的调整夹具的形态,来调整机械臂的运动策略。
发明内容
本发明的目的是通过一定的策略选择合适形状的虚拟夹具和复杂情况下虚拟管道状虚拟夹具的构建过程。
本发明采用如下的技术方案:构建具有力反馈的OSG虚拟仿真环境,通过力反馈设备控制机械臂末端运动,给定机械臂末端的起始点和目标点,要让机械臂从起始点运动到目标点,先通过OSG碰撞检测库的射线穿透的方法,判断两点之间是否存在障碍物,若不存在则建立简单形状如圆柱体的虚拟夹具,否则通过射线穿透方法确定出障碍物的尺寸,然后在障碍物的周围确定出一个一系列安全关键点,然后只需要构建起始点到关键点、关键点之间和关键点到目标点的虚拟管道即可。
本发明的优点有:
本发明虚拟夹具的形状可以自适应环境的变化,环境简单则建立简约夹具,环境复杂就建立管道夹具,并且复杂情况下能够确定出一条安全且较短的路径,相比传统单一的虚拟夹具方法,大大提高了虚拟夹具的构建效率和操作效率。
附图说明
图1是虚拟夹具选择策略图
图2是虚拟管道空间位姿确定策略流程图
图3是未知环境下,通过递归算法找出安全的关键点来确定虚拟管道的空间位姿示意图
具体实施方式
射线检测技术是本专利需要使用的检测技术。OSG三维引擎库里面提供了osgUtil工具类,它可以判断一条射线是否和物体相交,若相交的情况下能够提供相交点准确位置信息。虚拟场景中的射线是碰撞检测相交测试的基础,然而线段又提供了一种定义射线的方法,当相交发生的时候,可以通过检测线段的相交情况来检测射线相交并且执行响应的操作。osgUtil交点类提供了射线或者线段与场景中的三维模型相交的信息,即具体的碰撞点的世界坐标下的位置坐标和碰撞的法线方向。通过给定起始点和终点,建立它们之间的射线即可判断该射线对应的线段之间是否存在其他的模型。
在OSG中射线检测方法具体实现如下:(1)建立起点和终点之间的射线,PointA和PointB分别表示起点和终点,即osg::ref_ptr<osg::LineSegment>line=newosg::LineSegment(pointA,pointB);(2)将射线加入到相交遍历器中,即osgUtil::IntersectVisitor ivMul;ivMul.addLineSegment(line);(3)判断射线是否与模型相交,即如果ivMul.hits()返回true则相交,否则不相交;(4)如果相交,求出第一个碰撞点,由ivMul.getHitList(line)可以得到与模型的一系列碰撞点的迭代的集合,然后遍历迭代器即可求得所有的碰撞点的信息,即osgUtil::IntersectVisitor::HitList::iterator it,point=it->getWorldIntersectPoint();求出每个点和起始点A的距离,然后将距离最短的点作为第一个碰撞点即图3中的P点输出。
每次虚拟物体在起始点向目标点靠近的过程中,可以通过射线检测技术判断是否有障碍物体。如果它们之间没有其他的障碍物,证明物体在运动的过程中不会发生和其他的物体的碰撞,因此选用简单的圆柱体即可,其中圆柱体的两端分别为起始点和目标点,这样便可以快速引导物体运动到目标点,因为圆柱体比较单一、相对简单,所以虚拟夹具的算法复杂度比较低,性能也互相对提高。如果射线和其他的障碍物模型发生相交,证明环境中起始点和目标点之间存在一定的障碍物,这种情况,本文选用管道虚拟夹具,绕过障碍物,辅助物体到达目标点,其选择策略如图1所示。具体虚拟管道空间位姿确定策略流程如图2所示。
未知环境虚拟管道确定示意图如图3所示,这里A表示目标物体的起始点,B表示物体的目标点。在虚拟场景中,操作者意图通过手控设备控制机械臂末端直接从A运动到B,通过形状选择的步骤可以通过射线穿透法发现AB射线之间存在相交的模型,即为障碍物。并且很容易确定射线和障碍物的相交点P的位置,由图3所示,确定出一系列的关键点P1、P2、P3…Pn,然后将虚拟管道AP1,P1P2,P2P3…PnB的管道拼接起来即可完成整个虚拟管道的构建。
对于每个关键点的确定,根据算法流程,先确定出此时障碍物的上方、左侧,右侧、下方的安全点P1,P11,P12,P13,其中P1和P13点在直线AB和z轴组成的平面上,P11和P12为过P点且垂直于上述平面的平面上。然后比较∠PAP1、∠PAP11、∠PAP12和∠PAP13的大小,将最小的角度对应的点作为关键点。下面介绍P1点的具体求解方法,
假设A(x1,y1,z1),B(x2,y2,z2),通过射线AB和障碍物,可求得与障碍物相交点P(x3,y3,z3)。由于ABP1平面是平行于Z轴的,则 平面ABP1的法向量如式(1)
垂直于AB射线的并且过B的向量为:
在图3中,B1、B2、B3、B4等点是在向量方向上距离B点10单位、20单位、30单位、40单位成等差数列的距离。已知B点和很容易可以求得B1、B2、B3、B4…Bn等的点坐标。此时,依次求得射线AB1、AB2、AB3、AB4、...ABn,计算是否与障碍物相交,直到当n=k时,射线不再与障碍物相交。如图3所示的情况下,n=4时,ABn不再与障碍物相交,在两个三角形ABB4和APP1中,由三角形相似性得到
考虑到虚拟管道的有一定的宽度,因此设置P1点在此基础上再偏移一定的阈值e,即满足
PP1=PP1+e (4)
根据P点坐标、PP1距离即可求得P1点坐标。
P11,P12和P13的求解类似方法和P1类似,将这四个点比较得到对应的点作为第一个关键点,将其设为P1,已知P1关键点位置,检测该关键点和目标点之间是否有障碍物,如果是,确定下一个关键点P2,其求解方法和求解P1方法相似,将P1点作为A点,使用递归的方法求解即可,否则退出递归即可。这样便可以确定出所有的关键点P1、P2…Pn。然后构建A、P1、P2…Pn、B相邻点构成的管道,拼接起来即可完成虚拟管道的空间位置确定。自此自适应虚拟夹具的形状选择空间位置均可以确定下来。
Claims (1)
1.一种基于OSG的自适应虚拟夹具的构造方法,其特征在于,具体构建过程包括以下步骤:1)根据起始点和目标点,构建它们之间的虚拟夹具,确定选择虚拟夹具形状的方法;2)针对步骤1)中复杂情况下虚拟夹具采用虚拟管道,确定虚拟管道空间位姿;所述步骤1)中确定选择虚拟夹具形状的方法是:在起始点A和目标点B之间,通过OSG的射线检测技术,确定它们之间是否存在障碍物,如果没有障碍物,则选择简单的圆柱体形状虚拟夹具,如果存在障碍物,则选用虚拟管道状的虚拟夹具;所述步骤2)中确定虚拟管道空间位姿的方法是:采用射线穿透检测方法,先确定出第一个障碍物周围的关键点,如果这个关键点和目标点之间检测得到没有其他障碍物,关键点求取完毕,否则,确定出这个关键点和目标点之间的下一关键点,如此迭代求出一系列的关键点,然后构建起始点与关键点、关键点与关键点以及关键点与目标点之间的虚拟管道,最后将上述虚拟管道拼接起来即可完成整个虚拟管道的构建;确定第一个障碍物周围的关键点的方法如下:在起始点A和目标点B之间存在障碍物,确定射线AB和障碍物的相交点P的位置;然后确定出此时障碍物的上方、左侧、右侧、下方的安全点P1、P11、P12、P13,其中P1和P13点在射线AB和z轴组成的平面一上,P11和P12为过P点且垂直于所述平面一的平面二上,比较∠PAP1、∠PAP11、∠PAP12和∠PAP13的大小,将最小的角度对应的安全点作为关键点,以同样的方法求出其它的关键点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611127746.4A CN106625661B (zh) | 2016-12-09 | 2016-12-09 | 一种基于osg的自适应虚拟夹具的构造方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611127746.4A CN106625661B (zh) | 2016-12-09 | 2016-12-09 | 一种基于osg的自适应虚拟夹具的构造方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106625661A CN106625661A (zh) | 2017-05-10 |
CN106625661B true CN106625661B (zh) | 2019-08-09 |
Family
ID=58825811
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611127746.4A Active CN106625661B (zh) | 2016-12-09 | 2016-12-09 | 一种基于osg的自适应虚拟夹具的构造方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106625661B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107553485B (zh) * | 2017-07-13 | 2020-05-12 | 西北工业大学 | 一种人机交互过程中动态虚拟夹具的生成方法 |
CN108015767B (zh) * | 2017-11-30 | 2020-09-15 | 北京邮电大学 | 一种空间机械臂应急操作方法 |
CN110181517B (zh) * | 2019-06-21 | 2022-05-10 | 西北工业大学 | 一种基于虚拟夹具的双人遥操作训练方法 |
CN116013113B (zh) * | 2022-12-20 | 2024-02-23 | 西南交通大学 | 一种无人机航线安全检测方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102622461A (zh) * | 2011-09-07 | 2012-08-01 | 华南理工大学 | 一种根据三维可行路径生成三维管道的方法 |
CN105242533A (zh) * | 2015-09-01 | 2016-01-13 | 西北工业大学 | 一种融合多信息的变导纳遥操作控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140320629A1 (en) * | 2013-01-24 | 2014-10-30 | University Of Washington Through Its Center For Commericialization | Haptically-Enabled Co-Robotics for Underwater Tasks |
-
2016
- 2016-12-09 CN CN201611127746.4A patent/CN106625661B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102622461A (zh) * | 2011-09-07 | 2012-08-01 | 华南理工大学 | 一种根据三维可行路径生成三维管道的方法 |
CN105242533A (zh) * | 2015-09-01 | 2016-01-13 | 西北工业大学 | 一种融合多信息的变导纳遥操作控制方法 |
Non-Patent Citations (3)
Title |
---|
基于OSG的海底溢油多维动态可视化技术研究;李小龙,曹金凤;《海岸工程》;20150331;第34卷(第1期);第20-28页 * |
基于模型校正的空间机器人遥操作技术研究;陈圣旺;《中国优秀硕士学位论文全文数据库信息科技辑》;20140131(第1期);第140-274页 * |
空间机器人一体化仿真***的研究与实现;牟宗高,徐文福,孟得山;《宇航学报》;20130831;第34卷(第8期);第1084-1090页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106625661A (zh) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106625661B (zh) | 一种基于osg的自适应虚拟夹具的构造方法 | |
CN110228069A (zh) | 一种机械臂在线避障运动规划方法 | |
JP6606442B2 (ja) | 移動体の経路計画生成装置 | |
Wang et al. | Application of Dijkstra algorithm in robot path-planning | |
WO2018176596A1 (zh) | 基于权重改进粒子群算法的无人自行车路径规划方法 | |
CN105867381B (zh) | 一种基于概率地图的工业机器人路径搜索优化算法 | |
CN109709945A (zh) | 一种基于障碍物分类的路径规划方法、装置及机器人 | |
Kim et al. | Path planning for a tethered mobile robot | |
CN104155974A (zh) | 一种用于机器人快速避碰的路径规划方法及设备 | |
CN110509279A (zh) | 一种仿人机械臂的运动路径规划方法及*** | |
Shiltagh et al. | Optimal path planning for intelligent mobile robot navigation using modified particle swarm optimization | |
CN108972549A (zh) | 基于Kinect深度摄像头的工业机械臂实时避障规划抓取*** | |
Di et al. | Local path planning of mobile robot based on artificial potential field | |
KR20190080771A (ko) | 가상 현실을 위한 장거리 상호 작용들을 위한 시스템들 및 방법들 | |
Yokoyama et al. | Success weighted by completion time: A dynamics-aware evaluation criteria for embodied navigation | |
Hou et al. | Simulation research for mobile robot path planning based on improved artificial potential field method recommended by the AsiaSim | |
Jeffril et al. | The integration of fuzzy logic and artificial neural network methods for mobile robot obstacle avoidance in a static environment | |
Suliman et al. | Mobile robot position estimation using the Kalman filter | |
CN116661502B (zh) | 一种智能农业无人机路径规划方法 | |
CN104776968B (zh) | 一种多关节模型穿透深度的计算方法 | |
CN115981311A (zh) | 一种复杂管道检修机器人路径规划方法及*** | |
Vikerimark et al. | Reactive obstacle avoidance for mobile robots that operate in confined 3d workspaces | |
Rajvanshi et al. | An efficient potential-function based path-planning algorithm for mobile robots in dynamic environments with moving targets | |
Zhao et al. | Improved ant colony optimization algorithm and its application for path planning of mobile robot in 3-D space | |
Sun et al. | Apf-Bug-Based Intelligent Path Planning for Autonomous Vehicle with High Precision in Complex Environment |
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 |