CN106625661B - 一种基于osg的自适应虚拟夹具的构造方法 - Google Patents

Abstract

本发明公开一种基于OSG的自适应虚拟夹具的构造方法。针对机器人遥操作虚拟训练领域，虚拟夹具可以帮助实现快速定位和保障安全。本发明提出的一种自适应虚拟夹具的构建策略，针对不用环境条件构建适合的虚拟夹具，以虚拟夹具的构建效率，从而提高整个虚拟操作的效率。从目标物体想从起始点运动到目的点，通过OSG的碰撞检测库中射线检测方法检测两点之间是否有其他物体，若不存在则建立简单形状如圆柱体的虚拟夹具，否则自适应地构建一条安全且路径较短的虚拟管道的虚拟夹具。本发明相对传统方法的虚拟夹具形状单一和不变性，有更好的鲁棒性和通用性，而且最大限度地降低虚拟夹具建模的复杂度，从而大大提高系统效率。

Description

一种基于OSG的自适应虚拟夹具的构造方法

技术领域

机器人遥操作虚拟维护训练系统。

背景技术

虚拟夹具是遥操作领域中一个很重要的辅助手段，特别是控制机械臂在虚拟场景中运动的时候，虚拟夹具可以限制机械臂的运动空间，并利用一定的虚拟夹具的引导算法来导引机械臂手部的运动，从而帮助操作者控制机器人能够更好更快的完成任务，提高工作效率。虚拟夹具在基于虚拟场景的机器人遥操作系统已经得到了较好的应用和发展。然而传统的虚拟夹具存在诸多的弊端：不能根据环境变化调节虚拟夹具结构，不同的环境下需要更换虚拟夹具。

虽然虚拟夹具具有各种各样的形态，但是其最终目的都是为了能让目标执行器能够在虚拟夹具内部的安全范围内运动，将机械臂末端在靠近目的地的过程中，避免其穿出虚拟夹具从而和外部环境发生碰撞，这样可以很好地保护机械臂。本文提出了自适应虚拟夹具的方法，具有根据环境变化动态调整虚拟夹具的功能。可以不需要对虚拟夹具进行建模，而是当外界变化的时候，可以自适应的调整夹具的形态，来调整机械臂的运动策略。

发明内容

本发明的目的是通过一定的策略选择合适形状的虚拟夹具和复杂情况下虚拟管道状虚拟夹具的构建过程。

本发明采用如下的技术方案：构建具有力反馈的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所示，确定出一系列的关键点P₁、P₂、P₃…P_n，然后将虚拟管道AP₁，P₁P₂，P₂P₃…P_nB的管道拼接起来即可完成整个虚拟管道的构建。

对于每个关键点的确定，根据算法流程，先确定出此时障碍物的上方、左侧，右侧、下方的安全点P₁,P₁₁,P₁₂,P₁₃，其中P₁和P₁₃点在直线AB和z轴组成的平面上，P₁₁和P₁₂为过P点且垂直于上述平面的平面上。然后比较∠PAP₁、∠PAP₁₁、∠PAP₁₂和∠PAP₁₃的大小，将最小的角度对应的点作为关键点。下面介绍P₁点的具体求解方法，

假设A(x1,y1,z1),B(x2,y2,z2),通过射线AB和障碍物，可求得与障碍物相交点P(x3,y3,z3)。由于ABP₁平面是平行于Z轴的，则 平面ABP₁的法向量如式(1)

垂直于AB射线的并且过B的向量为：

在图3中，B₁、B₂、B₃、B₄等点是在向量方向上距离B点10单位、20单位、30单位、40单位成等差数列的距离。已知B点和很容易可以求得B₁、B₂、B₃、B₄…Bn等的点坐标。此时，依次求得射线AB₁、AB₂、AB₃、AB₄、...AB_n，计算是否与障碍物相交，直到当n＝k时，射线不再与障碍物相交。如图3所示的情况下，n＝4时，AB_n不再与障碍物相交，在两个三角形ABB₄和APP₁中，由三角形相似性得到

考虑到虚拟管道的有一定的宽度，因此设置P₁点在此基础上再偏移一定的阈值e，即满足

PP₁＝PP₁+e (4)

根据P点坐标、PP₁距离即可求得P₁点坐标。

P₁₁，P₁₂和P₁₃的求解类似方法和P₁类似，将这四个点比较得到对应的点作为第一个关键点，将其设为P₁，已知P₁关键点位置，检测该关键点和目标点之间是否有障碍物，如果是，确定下一个关键点P₂，其求解方法和求解P₁方法相似，将P₁点作为A点，使用递归的方法求解即可，否则退出递归即可。这样便可以确定出所有的关键点P₁、P₂…P_n。然后构建A、P₁、P₂…P_n、B相邻点构成的管道，拼接起来即可完成虚拟管道的空间位置确定。自此自适应虚拟夹具的形状选择空间位置均可以确定下来。

Claims (1)

1.一种基于OSG的自适应虚拟夹具的构造方法，其特征在于，具体构建过程包括以下步骤：1)根据起始点和目标点，构建它们之间的虚拟夹具，确定选择虚拟夹具形状的方法；2)针对步骤1)中复杂情况下虚拟夹具采用虚拟管道，确定虚拟管道空间位姿；所述步骤1)中确定选择虚拟夹具形状的方法是：在起始点A和目标点B之间，通过OSG的射线检测技术，确定它们之间是否存在障碍物，如果没有障碍物，则选择简单的圆柱体形状虚拟夹具，如果存在障碍物，则选用虚拟管道状的虚拟夹具；所述步骤2)中确定虚拟管道空间位姿的方法是：采用射线穿透检测方法，先确定出第一个障碍物周围的关键点，如果这个关键点和目标点之间检测得到没有其他障碍物，关键点求取完毕，否则，确定出这个关键点和目标点之间的下一关键点，如此迭代求出一系列的关键点，然后构建起始点与关键点、关键点与关键点以及关键点与目标点之间的虚拟管道，最后将上述虚拟管道拼接起来即可完成整个虚拟管道的构建；确定第一个障碍物周围的关键点的方法如下：在起始点A和目标点B之间存在障碍物，确定射线AB和障碍物的相交点P的位置；然后确定出此时障碍物的上方、左侧、右侧、下方的安全点P₁、P₁₁、P₁₂、P₁₃，其中P₁和P₁₃点在射线AB和z轴组成的平面一上，P₁₁和P₁₂为过P点且垂直于所述平面一的平面二上，比较∠PAP₁、∠PAP₁₁、∠PAP₁₂和∠PAP₁₃的大小，将最小的角度对应的安全点作为关键点，以同样的方法求出其它的关键点。