本发明属于光学定位和计算机视觉，尤其涉及一种基于光学定位技术的桌面级刚体定位设备及方法。
背景技术：
1、在刚体空间定位领域，目前存在使用红外光的大型光学式动作捕捉系统和使用超带宽距离测量的定位方案，但两者均无法满足桌面级刚体定位的微小型与高精度双重需求。所以，在桌面级刚体定位领域，尚未存在典型产品。
2、刚体的三维空间定位技术是多个领域的基础技术之一，目前的空间定位技术大致分为光学定位与距离定位两种主流方法。光学定位技术，顾名思义，是通过光学原理来完成物体的捕捉和定位的。是通过光学镜头捕捉固定在人体或是物体上面的标识物的位置信息来完成动作姿态捕捉。光学定位依靠一整套精密而复杂的光学摄像头来实现，它通过计算机视觉原理，由多个高速摄像机从不同角度对目标特征点进行跟踪来完成空间定位。光学定位技术可分为被动式和主动式两种。这个分类是从标识物来区别的。主动式是指标识物是主动发光甚至可以自带编码的，这样镜头在视野中可以通过标识物自身发光来观测它，并记录捕捉到其的运动轨迹。而被动式光学动作捕捉是通过镜头本身自带的灯板发出特定波长的光，照射到标识物上，标识物是通过特殊反光处理，可以反射镜头灯板发出的光，这样镜头就能在视野里捕捉记录该标识物的运动轨迹。
3、目前主流的光学定位技术主要是使用红外光进行光学定位，这是因为红外光在光谱中的分布较少，不容易被其他光源影响。此外，由于光学定位技术主要用于动作捕捉系统、大型移动机器人空间定位等应用领域，而红外光的功率提升，能够有效提升反射率，从而形成镜头视野里的明显光点。另外，主流的动作捕捉系统，比如来自英国vicon公司[1]和中国nokov公司[2]的红外光学动作捕捉系统，均使用被动式定位，这是因为这种方法不需要主动供电，而且可以增加任意数量的标识点来增加准确度和鲁棒性。
4、然而，这种主流的“红外光+被动定位”的模式，不适用于桌面级刚体定位，这是因为桌面级设备一般应用在不到5平方米的空间里，在这种空间内无法安装笨重、庞大的红外动作捕捉系统设备。此外，主流的动作捕捉系统价格相当昂贵，中国nokov公司的一套完整定位设备需要几万甚至十几万人民币，英国vicon公司的动作捕捉系统更是高达几十万甚至数百万，如果应用到普通的桌面级设备上，性价比极低。
5、除了光学定位技术之外，还存在使用距离测量进行空间定位的方案。这种方案一般使用特定频段的电磁信号测量待定位物体与基站之间的距离，然后利用多个基站得到的多个距离计算物体的空间位置。以该技术为基础的定位方案被称为距离测量定位技术，如基于超带宽（ultra-bandwidth）技术的定位系统。虽然该方法所使用的设备比较轻便，容易部署，且价格较为低廉，但uwb的精度有限，只能实现十几厘米或几十厘米的定位精度，无法满足桌面级设备的高精度定位需求，因此，也不适用于桌面级刚体定位。
6、因此基于现有的光学定位技术方案仍旧存在昂贵、笨重、精度有限的问题，亟需一种能够为桌面级设备提供了稳定、精确、鲁棒的定位技术平台。
技术实现思路
1、针对现有技术的不足，本发明的目的是提供一种基于光学定位技术的桌面级刚体定位设备及方法，包括硬件设备与软件算法设计方法。本发明使得桌面级设备的空间定位成为可能，为虚拟现实与增强现实、机器人技术和游戏与娱乐产业提供了定位基础。以解决相关技术中存在的光学定位中仍旧存在昂贵、笨重、精度有限的技术问题。
2、本发明的技术方案如下：
3、本发明第一个方面，提供了一种基于光学定位技术的桌面级刚体定位设备，包括一个定位盒子、磨砂黑色玻璃纤维平台、用于放置无人机的透明亚克力平台以及连接磨砂黑色玻璃纤维平台与透明亚克力平台的磨砂黑色聚氯乙烯支柱；
4、所述定位盒子包括三个相同的鱼眼相机模组、计算单元模组、电源模组和数据与连接线隐藏盒；所述计算单元模组通过usb连接线与三个鱼眼相机模组电连，起到供电与数据传输的双重作用；所述电源模组是用于为计算单元模组供电；所述数据与连接线隐藏盒设置于定位盒子一侧，用于盛装数据与连接线；所述定位盒子的三个鱼眼相机模组固定设置于磨砂黑色玻璃纤维平台下方，所述磨砂黑色玻璃纤维平台的四角与四根磨砂黑色聚氯乙烯支柱螺纹连接，所述四根磨砂黑色聚氯乙烯支柱与透明亚克力平台的四角垂直固定连接。
5、具体地，所述鱼眼相机模组由相机镜头、滤光片和成像模块组成；用于识别待定位物体装备的发光元件。
6、进一步地，所述相机镜头为185°鱼眼镜头，能够观察所需的定位的范围。
7、进一步地，所述滤光片为紫外滤光片，用于滤除日常的可见光波段，且滤光后只留下波段为390-400nm的光线。
8、进一步地，所述成像模块为高光谱范围cmos成像芯片，且要求分辨率大于1080p。
9、进一步地，所述鱼眼相机模组的位置排布是使用三角定位的方法确定刚体的三维空间位置，并将其分布为一个不等边的三角形；防止出现奇异点和影响系统定位精度。
10、本发明第三个方面，还提供了一种基于光学定位技术的桌面级刚体定位方法，包括以下步骤：
11、（1）多物体定位初始化：
12、由于紫外光的检测点是匿名的，在放入多个待定位物体时，没有办法确定相机图片的紫外检测点对应到哪个待定位物体；因此需要输入待定位物体的尺度未知的相对位置，具体而言，如果放入个待定位物体，则需要输入每个待定位物体在所有物体中的相对位置：
13、；
14、其中代表第 i个待定位物体在所有物体中的相对位置，该需求通过在定位盒子的透明亚克力平台上设置标识并要求使用者将待定位物体放置在这些标识上来满足；与定位盒子上安装的三个鱼眼相机模组对应，鱼眼相机模组会检测待定位物体发出的紫外光线，并得到3组方位测量，其表达式为：
15、；
16、其中，代表第m个鱼眼相机模组获得的第 i个方位测量，且已通过定位盒子的提前设计与外部参数标定获得鱼眼相机模组的绝对位置，其中；
17、再进行多物体定位初始化，以相对位置与方位测量为输入，并对数据关联与位置求解，不断迭代直到收敛；
18、（2）多目标像素追踪：
19、由于每个鱼眼相机模组都会检测到多个光点，鱼眼相机模组之间的光点需要有正确的数据关联才能进行正确的位置解算；因此在多物体定位初始化成功之后，还对每个鱼眼相机模组检测到的多个光点进行跟踪；具体而言，在上一帧的光点检测结果基础上，计算一个的数据矩阵，其中是光点的数量，由于前后两帧的光点数量是相同的；数据矩阵的元素，表示该帧的第i个光点与上一帧的第j个光点的欧式距离；基于该数据矩阵，使用二分图匹配的经典算法进行前后帧光点的数据关联；
20、（3）位置计算：
21、当三个鱼眼相机模组对一个刚体的检测结果是正确时，进行空间三维位置计算获得该物体的空间三维位置，所述空间三维位置计算由如下表达式获得：
22、；其中，为待定位物体的绝对位置；为鱼眼相机模组的绝对位置，为对第i个待标定物体的方位观测位置；最后通过闭式求解得到全局最优解。
23、具体地，所述步骤（1）中多物体定位初始化，具体包括以下子步骤：
24、（1.1）将待定位物体的绝对位置初始化为待定位物体相对位置；
25、（1.2）利用鱼眼相机模组绝对位置和待定位物体的绝对位置反算每个待定位物体的期望方位测量；
26、（1.3）计算期望方位测量与实际方位测量的差，按照匈牙利算法建立匹配；
27、（1.4）利用匹配上的实际方位测量计算物体位置，并以此更新待定位物体的绝对位置；
28、（1.5）迭代直到期望方位测量的差与实际方位测量的差低于设定阈值，迭代结束，返回待定位物体的绝对位置。
29、本发明第三个方面，提供了一种电子设备，包括：
30、一个或多个处理器；
31、存储器，用于存储一个或多个程序；
32、当所述一个或多个程序被所述一个或多个处理器执行，使得所述一个或多个处理器实现所述的基于光学定位技术的桌面级刚体定位方法。
33、本发明第四个方面，一种计算机可读存储介质，其上存储有计算机指令，该指令被处理器执行时实现所述基于光学定位技术的桌面级刚体定位方法的步骤。
34、本发明的有益效果如下：
35、本发明的光学定位系统采用了先进的光学传感技术和精密的算法，与传统的红外光动作捕捉系统和uwb定位系统相比，具有更高的定位精度和更强的环境适应性；通过使用特殊设计的光学元件和高级图像处理算法，本系统可以更准确地捕捉和解析物体表面的光学特征，实现高精度的三维空间定位，即使在光线复杂或有障碍物遮挡的环境中也能保持稳定性；针对桌面级应用的需求，本发明的装置设计更为紧凑，生产成本较低，更适合小型化产品和消费级市场。
1.一种基于光学定位技术的桌面级刚体定位设备，其特征在于，包括一个定位盒子、磨砂黑色玻璃纤维平台、用于放置无人机的透明亚克力平台以及连接磨砂黑色玻璃纤维平台与透明亚克力平台的磨砂黑色聚氯乙烯支柱；
2.根据权利要求1所述的一种基于光学定位技术的桌面级刚体定位设备，其特征在于，所述鱼眼相机模组由相机镜头、滤光片和成像模块组成；用于识别待定位物体装备的发光元件。
3.根据权利要求2所述的一种基于光学定位技术的桌面级刚体定位设备，其特征在于，所述相机镜头为185°鱼眼镜头，能够观察所需的定位的范围。
4.根据权利要求2所述的一种基于光学定位技术的桌面级刚体定位设备，其特征在于，所述滤光片为紫外滤光片，用于滤除日常的可见光波段，且滤光后只留下波段为390-400nm的光线。
5.根据权利要求2所述的一种基于光学定位技术的桌面级刚体定位设备，其特征在于，所述成像模块为高光谱范围cmos成像芯片，且要求分辨率大于1080p。
6.根据权利要求1所述的一种基于光学定位技术的桌面级刚体定位设备，其特征在于，所述鱼眼相机模组的位置排布是使用三角定位的方法确定刚体的三维空间位置，并将其分布为一个不等边的三角形；防止出现奇异点和影响系统定位精度。
7.如权利要求1-6任一项所述的一种基于光学定位技术的桌面级刚体定位设备的定位方法，其特征在于，包括以下步骤：
8.根据权利要求7所述的一种基于光学定位技术的桌面级刚体定位方法，其特征在于，所述步骤（1）中多物体定位初始化，具体包括以下子步骤：
9.一种电子设备，其特征在于，包括：
10.一种计算机可读存储介质，其上存储有计算机指令，其特征在于，该指令被处理器执行时实现如权利要求7-8中任一项所述基于光学定位技术的桌面级刚体定位方法的步骤。
