The invention relates to the field of spatial positioning, in particular to an optical inertial fusion spatial positioning method, a positioning device and a positioning system. The method is as follows: laying infrared feature points in the space to be positioned and coding based on the layout mode; calibrating the infrared feature points to obtain the precise three-dimensional coordinates of the infrared feature points and storing them in the computing unit; wearing an infrared camera on the target, taking the image information of the infrared feature points based on the infrared camera on the target and the integrated transmission of the infrared camera itself. Sensor data, through optical and inertial fusion algorithm, locate the target. The positioning system comprises an infrared feature point, an infrared camera and a computing unit. The invention adopts the positioning method of optical and inertial fusion, which not only avoids the defects of poor anti-occlusion ability of optical positioning and inaccurate positioning of inertial positioning for a long time, but also reduces the system cost by reducing the number of cameras arranged in the system.
【技术实现步骤摘要】
一种光学惯性融合空间定位方法、定位设备及定位系统
本专利技术涉及空间定位领域,具体涉及一种光学惯性融合空间定位方法、定位设备及定位系统。
技术介绍
随着LBS、VR等领域的火热发展,空间定位技术近年来也备受关注且发展迅速。目前主流的室内空间定位技术包括激光定位技术,红外光学定位等。激光定位技术通过激光发射器每秒发射若干次的激光线面扫描定位空间,实现光敏传感器位置追踪。激光定位技术依靠马达带动激光线面旋转扫描定位空间,因此其帧率受限于马达转数。同一定位空间需要布设多台激光发射器以使得激光线面覆盖整个定位空间,为了实现激光发射信号的编码并且避免不同激光信号的干扰,激光定位技术采用多站分时扫描的方法,即同一定位空间中的不同激光发射器分时扫描,进一步限制了激光发射器的有效帧率。红外光学定位,在定位空间中布设多台红外相机,目标物佩戴可以自行发射红外光或者可以反射红外光的定位标识点来实现空间定位。红外光光学定位一直备受诟病的问题是成本过高,为了使得红外相机视角可以覆盖整个定位空间,一个定位空间中需要安装多台红外相机,而红外相机造价非常昂贵。为此,本专利技术提出了一种基于光学惯 ...
【技术保护点】
1.一种光学惯性融合空间定位方法,其特征在于,所述方法包括如下步骤:(S1)在待定位空间中布设红外特征点,基于布设方式编码;(S2)通过对所述红外特征点进行标定,获取所述红外特征点的精准三维坐标,并存储于计算单元;(S3)红外相机实时获取所述红外特征点的图像信息,并上传至计算单元;(S4)红外相机中惯性传感器实时获取目标物惯性数据,初步计算后上传至计算单元;(S5)计算单元基于图像信息,匹配识别所拍摄到红外特征点的编码及其精准三维坐标,基于两个或者多个红外特征点的三维坐标确定红外相机在定位空间中的位置,从而获得光学位置信息;(S6)计算单元将所述光学位置信息及所述惯性数据基 ...
【技术特征摘要】
1.一种光学惯性融合空间定位方法,其特征在于,所述方法包括如下步骤:(S1)在待定位空间中布设红外特征点,基于布设方式编码;(S2)通过对所述红外特征点进行标定,获取所述红外特征点的精准三维坐标,并存储于计算单元;(S3)红外相机实时获取所述红外特征点的图像信息,并上传至计算单元;(S4)红外相机中惯性传感器实时获取目标物惯性数据,初步计算后上传至计算单元;(S5)计算单元基于图像信息,匹配识别所拍摄到红外特征点的编码及其精准三维坐标,基于两个或者多个红外特征点的三维坐标确定红外相机在定位空间中的位置,从而获得光学位置信息;(S6)计算单元将所述光学位置信息及所述惯性数据基于卡尔曼滤波器进行融合,获得目标物在所述定位空间中的位置。2.根据权利要求1所述的光学惯性融合空间定位方法,其特征在于,所述方法还包括:(S7)获取目标物的实时位置信息后,计算单元再利用平滑滤波进行处理,从而输出平滑的目标物轨迹信息,进行应用。3.根据权利要求2所述的光学惯性融合空间定位方法,其特征在于,在步骤(S7)中,采用的平滑滤波为双指数滤波。4.根据权利要求1所述的光学惯性融合空间定位方法,其特征在于,在步骤(S1)中,所述红外特征点布设成多条直线等间距横纵相交的阵列式形态,具体如下:取相邻交点间的线段为一组红外特征点,每一组红外特征点数目固定,通过控制特征点之间的间距,使得该红外特征点组具有唯一的编码;同一条横直线或者同一条纵直线上,重复排布同一组红外特征点组;不同横直线、不同纵直线上排布不同的红外特征点组;保证每一条横直线、纵直线均具有唯一的编码。5.根据权利要求1所述的光学惯性融合空间定位方法,其特征在于,在步骤(S2)中,采用外部测量的方法对所述红外特征点进行标定;所述红外特征点的标定需要在定位空间搭建好后一次性标定完成,红外空间特征点实际位置不变,则不再另行标定。6.根据权利要求1所述的光学惯性融合空间定位方法,其特征在于,在步骤(S6)中,所述卡尔曼滤波器包括扩展卡尔曼滤波器EKF、无迹卡尔曼滤波器UKF、平方根容积卡尔曼滤波SCKF。7.根据权利要求1所...
【专利技术属性】
技术研发人员:黄永鑫,路晗,
申请(专利权)人:苏州炫感信息科技有限公司,
类型:发明
国别省市:北京,11
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。