面向遥操作手眼协调的交互控制方法技术

本发明专利技术公开了一种面向遥操作手眼协调的交互控制方法，用于解决现有人机交互控制方法实用性差的技术问题。技术方案是基于坐标系的转换，操作者通过交换设备控制场景对象运动时，首先将场景对象的位姿由世界坐标系转换到相机坐标系中，然后在相机坐标系中按预期运动加上交互设备的进动量，得到新的相机坐标系位姿坐标，最后将新得到的位姿坐标由相机坐标系转换到世界坐标系中用以控制场景对象的实际运动。本发明专利技术实现了遥操作过程的手眼协调，即交互操作的过程中场景对象的运动不受操作者观察场景视角变换的影响，与交互设备的运动一致，降低遥操作难度，实用性好。

【技术实现步骤摘要】
面向遥操作手眼协调的交互控制方法
本专利技术涉及一种人机交互控制方法，特别是涉及一种面向遥操作手眼协调的交互控制方法。
技术介绍
文献“遥操作机器人系统主从控制策略，江苏科技大学学报(自然科学版)，2013，Vol27(8)，p643-647”公开了一种主从式遥操作机器人系统的控制方法。该方法采用增量式位置控制方式，以主手的增量来控制从手的运动，较有效地避免了初始回原点的繁琐。当操作操作者直接观察被操作环境信息时与操作者通过图像设备观察被操作环境信息时，主从间位置对应不同，通过调整比例控制增益矩阵，进行主手与实际环境或主手与图像设备的坐标匹配，建立主端和从端的工作空间映射有较好的视觉临场感。文献所述方法只是基于操作者直接观察环境信息与通过图像设备观察环境信息的不同，通过比例控制增益系数简单建立了主手与实际环境或主手与图像设备的工作空间映射，而没有给出当操作者观察被操作环境信息观察视角变化时，建立主从端工作空间映射的方法，没有实现主从端工作空间映射不受观察视角变化的影响，始终运动一致，适用范围不广，操作难度较大。
技术实现思路
为了克服现有人机交互控制方法实用性差的不足，本专利技术提供一种面向遥操作手眼协调的交互控制方法。该方法基于坐标系的转换，操作者通过交换设备控制场景对象运动时，首先将场景对象的位姿由世界坐标系转换到相机坐标系中，然后在相机坐标系中按预期运动加上交互设备的进动量，得到新的相机坐标系位姿坐标，最后将新得到的位姿坐标由相机坐标系转换到世界坐标系中用以控制场景对象的实际运动。本专利技术实现了遥操作过程的手眼协调，即交互操作的过程中场景对象的运动不受操作者观察场景视角变换的影响，与交互设备的运动一致，降低遥操作难度，实用性好。本专利技术解决其技术问题所采用的技术方案是：一种面向遥操作手眼协调的交互控制方法，其特点是包括以下步骤：步骤一、交互设备数据采集，在手控器运动过程中，等时间间隔采集手控器的实时位置信息Pcn；将采集到的手控器实时位置信息Pcn与前一时刻位姿信息Pcn-1作差得到手控器进动量ΔP；将进动量ΔP按照ΔP0＝k*ΔP映射为机械臂末端的初始运动指令ΔP0，其中，k为操作比例系数。△P0＝k*△P(1)步骤二、结合交互操作坐标系到相机坐标系的转换矩阵Rx，对初始运动指令ΔP0进行转换处理，得到相机坐标系中的运动指令ΔP1。△P1＝△P0*Rx(2)步骤三、结合相机坐标系在世界坐标系的位姿矩阵C，对相机坐标系中的运动指令ΔP1进行转换处理，得到世界坐标系中的运动指令ΔP2。在交互过程中，操作者观察到的视景由相机在世界坐标系中的位置姿态决定，而相机的位置姿态矩阵取决于三个要素：即相机视线方向、相机中心的位置、相机的正向朝向，这三个要素就能确定相机在世界坐标系中的位置姿态。当观察视角转换时，本质是相机在世界坐标系中的位置姿态发生了变化，相机坐标系在世界坐标系中的方向也随之发生变化。将步骤二中得到的运动量从相机坐标系转换到世界坐标系，需要用到相机矩阵的逆矩阵C-1。此外，由于交互设备用动量矩阵为1x3矩阵，因此需要构建一个1x4的矩阵D。D＝[△P10](4)△P2＝DC-1(5)步骤四、将世界坐标系中的运动指令ΔP2通过运动映射得到机械臂末端的最终运动量ΔP3，生成整个交互过程的遥操作指令。将步骤三得到的世界坐标系运动指令ΔP2展开得到ΔP2为1x4矩阵，其前三列元素为场景对象末端的最终运动量，通过运动映射取ΔP2前三列元素生成ΔP3，简化表示如下：△P3＝[△x△y△z](6)其中，Δx、Δy、Δz分别表示场景对象末端在世界坐标系中三个坐标轴方向的运动量，至此，用以实现手眼协调的遥操作指令生成。步骤五、利用步骤四生成的遥操作指令驱动机械臂运动，实现手眼协调。场景对象末端的实时位置记为Pjn，下一时刻的位置为Pjn+1，则通过场景对象实时末端位置驱动场景对象运动，实现遥操作过程的手眼协调。本专利技术的有益效果是：该方法基于坐标系的转换，操作者通过交换设备控制场景对象运动时，首先将场景对象的位姿由世界坐标系转换到相机坐标系中，然后在相机坐标系中按预期运动加上交互设备的进动量，得到新的相机坐标系位姿坐标，最后将新得到的位姿坐标由相机坐标系转换到世界坐标系中用以控制场景对象的实际运动。本专利技术实现了遥操作过程的手眼协调，即交互操作的过程中场景对象的运动不受操作者观察场景视角变换的影响，与交互设备的运动一致，降低遥操作难度，实用性好。下面结合具体实施方式对本专利技术作详细说明。具体实施方式为详细介绍本专利技术的内容，需要对3个常用坐标系的定义进行阐述：(1)世界坐标系Oworld：世界坐标系是整个系统的参考坐标系，用来描述场景中对象模型的实际运动，相当于基坐标系，场景对象的运动都是基于世界坐标系来进行描述。(2)相机坐标系Ocamera：相机坐标系用来描述遥操作视景，当操作者观察视角变换时，本质是相机在世界坐标系中的位置姿态发生了变化。当观察视角变换时，相机坐标系在世界坐标系中的位姿发生变化,但它相对于计算机屏幕的方向不变。(3)交互操作坐标系(即手控器坐标系)Ointeraction：交互设备坐标系用来描述遥操作过程中交互设备的运动，当观察视角变换时，交互设备在世界坐标系中的位置姿态将发生变化，但它相对于计算机屏幕的方向不变。为验证本专利技术所提出的面向遥操作手眼协调的操作技术的有效性，本专利技术结合三维图形开发环境OSG(OpenSenceGraph)和交互工具NovintFalcon手控器，基于对虚拟视景中IRB120机械臂运动的控制进行仿真演示验证，具体实施方式如下：步骤一、交互设备数据采集，以手控器向上运动为例，在手控器运动过程中等时间间隔采集得到手控器的实时位置姿态信息Pcn；将采集到的手控器实时位姿信息Pcn与前一时刻位姿信息Pcn-1作差得到手控器进动量ΔP；将进动量ΔP按照ΔP0＝k*ΔP映射为机械臂末端的初始运动指令ΔP0，其中k为操作比例系数，手控器末端运动量单位为米，虚拟场景中机械臂末端运动量单位为毫米，操作比例系数k＝1000，当手控器末端向上运动0.1米时，初始运动指令为△P0＝k*△P＝[00100](1)步骤二、结合交互操作坐标系到相机坐标系的转换矩阵Rx，对初始运动指令ΔP0进行转换处理，得到相机坐标系中的运动指令ΔP1。通过对交互设备坐标系与相机坐标系的位置关系分析可知，当观察视角变换时，交互设备坐标系与相机坐标系在世界坐标系中的相对方向没有发生变化，由交互设备坐标系沿X轴旋转90度即可与相机坐标系方向一致。步骤三、结合相机坐标系在世界坐标系的位姿矩阵C，对相机坐标系中的运动指令ΔP1进行转换处理，得到世界坐标系中的运动指令ΔP2。当正视场景时，相机在世界坐标系中的位姿矩阵为C。由于交互设备用动量矩阵为1x3矩阵，需要构建一个1x4的矩阵D。D＝[△P10]＝[010000](4)△P2＝DC-1＝[001000](5)步骤四、将世界坐标系中的运动指令ΔP2通过运动映射得到机械臂末端的最终运动量ΔP3，生成整个交互过程的遥操作指令。△P3＝[△x△y△z]＝[00100](6)其中，Δx、Δy、Δz分别表示场景对象末端在世界坐标系中三个坐标轴方向的运动量，至此，用以实现手眼协调的遥操作本文档来自技高网...

【技术保护点】
1.一种面向遥操作手眼协调的交互控制方法，其特征在于包括以下步骤：步骤一、交互设备数据采集，在手控器运动过程中，等时间间隔采集手控器的实时位置信息Pc

【技术特征摘要】
1.一种面向遥操作手眼协调的交互控制方法，其特征在于包括以下步骤：步骤一、交互设备数据采集，在手控器运动过程中，等时间间隔采集手控器的实时位置信息Pcn；将采集到的手控器实时位置信息Pcn与前一时刻位姿信息Pcn-1作差得到手控器进动量ΔP；将进动量ΔP按照ΔP0＝k*ΔP映射为机械臂末端的初始运动指令ΔP0，其中，k为操作比例系数；ΔP0＝k*ΔP(1)步骤二、结合交互操作坐标系到相机坐标系的转换矩阵Rx，对初始运动指令ΔP0进行转换处理，得到相机坐标系中的运动指令ΔP1；ΔP1＝ΔP0*Rx(2)步骤三、结合相机坐标系在世界坐标系的位姿矩阵C，对相机坐标系中的运动指令ΔP1进行转换处理，得到世界坐标系中的运动指令ΔP2；在交互过程中，操作者观察到的视景由相机在世界坐标系中的位置姿态决定，而相机的位置姿态矩阵取决于三个要素：即相机视线方向、相机中心的位置、相机的正向朝向，这三个要素就能确定相机在世界坐标系中的位置姿态；当观察视角转换时，本质是相机在世界坐标系中的位置姿...

【专利技术属性】
技术研发人员：刘正雄，司继康，黄攀峰，任瑾力，孟中杰，董刚奇，张夷斋，张帆，鹿振宇，常海涛，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西,61