基于尺码先验的电磁交互手套初始定位方法与流程

摘要: 本发明涉及电磁追踪,特别是基于尺码先验的电磁交互手套初始定位方法。背景技术:1、电磁追踪技术因其具有无光学遮挡、可穿戴、全天候等优点,已被用于交互手套中。现有的...
基于尺码先验的电磁交互手套初始定位方法与流程

本发明涉及电磁追踪,特别是基于尺码先验的电磁交互手套初始定位方法。

背景技术:

1、电磁追踪技术因其具有无光学遮挡、可穿戴、全天候等优点,已被用于交互手套中。现有的电磁交互手套在手背固连发射线圈,在腕部与各手指指尖固连接收器,电磁交互手套的解算单元则根据多通道磁场测量值,求解各接收端相对发射源的六自由度(6dof)位姿,并进一步映射出手部三维骨架姿态。

2、在近场条件下,常用磁偶极子模型描述发射源磁场。设发射磁矩为,第路接收端相对发射源的位置矢量为,则磁场强度为,而由测得磁场反求属于非线性逆问题。由于偶极子场对位置存在对称性与高度非线性,目标函数在三维空间中常出现多个局部极小值。部分解在数学上满足场方程,但相对真实位置呈镜像对称(镜像解)或落在手套结构不可达区域(越界解)。若不加以消除,系统在开机时无法确定手指确切姿态,后续跟踪易发散或出现“穿模/翻转”。

3、现有技术中,消除多解、完成初始定位的常见方法包括人工辅助校准法、相位/极性检测法、纯数值多起点搜索和事后几何过滤法。人工辅助校准法指开机时要求佩戴者做出特定姿态,如手掌平放、握拳、对准标定板,由人工确认或光学辅助建立初值,但该方法破坏了“开机即用”体验,且现场部署成本高。相位/极性检测法指利用发射激励相位、多轴线圈极性或额外参考传感器区分象限,但该方法对硬件一致性、相位标定与温度漂移敏感,系统复杂度与成本上升。纯数值多起点搜索指在全空间布设大量初值并行优化,再按残差选最优,但该方法计算量大,且当镜像根残差接近时仍可能误选,缺乏可解释的结构硬约束。事后几何过滤法指先无约束求多根,再用可达域剔除,但该方法未把尺码结构先验在解算阶段作为边界条件嵌入电磁信号矩阵方程,初始化搜索空间仍偏大,且对腕部—五指多通道一致性零点映射利用不充分。

技术实现思路

1、本发明的主要目的是提出一种基于尺码先验的电磁交互手套初始定位方法,无需人工校准即可实现高精度初始定位,初始化搜索空间更小,成本更低。

2、本发明通过以下技术方案实现:

3、基于尺码先验的电磁交互手套初始定位方法,电磁交互手套包括设置于手背的发射线圈、设置于腕部的腕部接收器和分别设置于各指尖的指尖接收器,初始定位方法包括如下步骤:

4、步骤s1、电磁交互手套开机时获取预先标定的尺码先验信息,并基于腕部接收器和各指尖接收器的测量数据获取电磁信号矩阵,其中,尺码先验信息包括所述电磁交互手套的发射线圈到腕部接收器以及各指尖接收器的三维矢量距离;

5、步骤s2、在解算电磁信号矩阵以反演腕部接收器以及各指尖接收器相对发射线圈的三维位置时,根据尺码先验信息获取边界条件,并结合多通道结构一致性,剔除物理不可达的镜像解和/或越界解,得到腕部接收器与各指尖接收器对应的唯一物理可行解;

6、步骤s3、基于所述唯一物理可行解,完成三维坐标零点映射以及开机初始定位。

7、进一步的,所述步骤s1中,标定所述尺码先验信息的过程为:对于每一手套尺码档位,在出厂或者个性化标定阶段,在电磁交互手套的标准伸展构型下,测定发射线圈原点到腕部接收器以及各指尖接收器的标准三维矢量距离为,并定义标称距离与标称方向,则所述尺码先验信息表示为,、分别为设定的距离容差和方向锥半顶角,,,表示腕部接收器序号,依次表示拇、食、中、环、小指指尖接收器序号。

8、进一步的,所述步骤s1中,电磁交互手套包括存储先验结构模型库的非易失存储单元,先验结构模型库中包含预先标定的分别对应于各手套尺码档位的尺码先验信息,模型库表示为,为手套尺码档位集合。

9、进一步的,所述步骤s1中,所述电磁信号矩阵表示为,其中,,表示第i个接收器在第m个周期的测量数据,表示周期数量,表示腕部接收器在m个周期内的平均测量数据。

10、进一步的,所述步骤s2中,解算电磁信号矩阵的优化问题表示为,其中,为在第i个接收器位置处由磁偶极子模型正演得到的磁场,为距离壳约束,表示为,为所解算的第i个接收器相对发射线圈的三维位置,为方向约束,表示为,为腕部指尖相对距离约束,表示为,,表示腕部与第个指尖接收器的相对距离的允许偏差容差,上标表示当前手套尺码档位,、、、分别表示第i个接收器对应于当前手套尺码档位的标称距离、距离容差、标称方向、方向锥半顶角,表示所解算的第个指尖接收器相对发射线圈的三维位置,表示所解算的腕部接收器相对发射线圈的三维位置,表示对应于当前手套尺码档位,发射线圈原点到第个指尖接收器的标称距离,表示对应于当前手套尺码档位,发射线圈原点到腕部接收器的标称距离。

11、进一步的,所述步骤s2中,在对所述优化问题求解中,为便于将其嵌入非线性最小二乘求解器,将约束条件并入优化问题的目标函数,得到无约束罚函数,对无约束罚函数求驻点,得到各接收器对应的初步候选解,其中,分别表示标称距离偏差项的罚权重、方向偏离标称方向项的罚权重、腕部与各指尖相对距离偏差项的罚权重,均大于0,。

12、进一步的,所述步骤s2中,在满足约束条件时,采用球坐标参数化,将每个接收器对应的求解由三维位置搜索降为二维球面,或二维球面上由方向锥截取的球面片。

13、进一步的,所述步骤s2中,结合多通道结构一致性,得到各通道对应的唯一物理可行解为,其中,为多通道结构一致性残差,表示为,为对第i个接收器的初步候选解进行结构可行性筛选后得到的候选解,为可行性指示函数,为从各接收器对应的候选解中获取的联合候选解,分别表示距离壳权重系数、腕部指尖相对结构权重系数、场拟合项系数,取值均大于0。

14、进一步的,所述步骤s2中,求取初步候选解的过程中,采用径向搜索域,其中,为第i个接收器径向搜索距离的下界,具体表示为,为第i个接收器径向搜索距离的上界,具体表示为,为真空磁导率,为发射线圈的等效磁矩模长。

15、进一步的,所述步骤s3具体包括:

16、利用腕部接收器对应的唯一物理可行解与中指或者食指对应的唯一物理可行解构建开机零点坐标系的正交基,以确定初始姿态矩阵,并形成零点映射变换,其中,以发射线圈几何中心为开机零点坐标系的原点,、、为正交基,,,,,;

17、由唯一物理可行解经反向运动学得到手指关节角,以作为姿态初始值;

18、输出,开机初始定位完成。

19、由上述对本发明的描述可知,与现有技术相比,本发明具有如下有益效果:

20、本发明的磁交互手套包括设置于手背的发射线圈、设置于腕部的腕部接收器和分别设置于各指尖的指尖接收器,电磁交互手套开机时获取预先标定的尺码先验信息,并基于腕部接收器和各指尖接收器的测量数据获取电磁信号矩阵,其中,尺码先验信息包括所述电磁交互手套的发射线圈到腕部接收器以及各指尖接收器的三维矢量距离;在解算电磁信号矩阵以反演腕部接收器以及各指尖接收器相对发射线圈的三维位置时,根据尺码先验信息获取边界条件,并结合多通道结构一致性,剔除物理不可达的镜像解和/或越界解,得到腕部接收器与各指尖接收器对应的唯一物理可行解,基于所述唯一物理可行解,完成三维坐标零点映射以及开机初始定位。将手套的尺码先验信息作为边界条件参与电磁信号矩阵的解算,使求解轨迹在迭代早期即离开镜像盆底,减小初始化搜索空间,更快地确定唯一解,实现在不增加用户动作、不强制依赖额外相位硬件的前提下,完成电磁追踪手套的开机多解消除以及三维坐标零点映射,提升用户体验,不必为区分镜像象限增设额外相位检测链路、多轴极性硬件或参考传感器,从而降低硬件一致性要求、相位标定工作量以及对温度漂移的敏感度,进而降低系统复杂度与成本。