[发明专利]一种基于红外基准点的室内与地下空间定位方法在审
申请号: | 202111004267.4 | 申请日: | 2021-08-30 |
公开(公告)号: | CN113739803A | 公开(公告)日: | 2021-12-03 |
发明(设计)人: | 何成龙;蔚保国;易卿武;郝菁;刘天豪 | 申请(专利权)人: | 中国电子科技集团公司第五十四研究所 |
主分类号: | G01C21/20 | 分类号: | G01C21/20;G01S5/16;G06F17/16 |
代理公司: | 河北东尚律师事务所 13124 | 代理人: | 王文庆 |
地址: | 050081 河北省石家庄市中山西路5*** | 国省代码: | 河北;13 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 红外 基准点 室内 地下 空间 定位 方法 | ||
1.一种基于红外基准点的室内与地下空间定位方法,其特征在于,包括以下步骤:
(1)在室内或地下空间的顶部区域以非对称方式设置n个安装点,n≥4;每个安装点安装1个点状红外节点设备,观测区域内可观测到不低于4个点状红外节点设备;
(2)记录各安装点的空间坐标[xi,yi,zi]i=1~n,记为矩阵
(3)将地点k处可观测到的点状红外节点的ID号的集合记为可观测特征组Ak,全部的可观测特征数组记为{A1~Ak};
(4)接收机通过内嵌的红外摄像头拍摄顶部区域,当接收机获取的实时热成像图像中存在m个点状红外节点设备且m不低于4时,检测m个节点在实时热成像图像的投影坐标[xj,yj]j=1~m,记为转到步骤(5);若m小于4,则转到步骤(7);
(5)设接收机位置为P=[x0,y0,z0],接收机基于{A1~Ak}中包含有m个点状红外节点设备的可观测特征组子集{Aq},遍历与全部潜在可观测到的点状红外节点设备的相对位置矩阵基于PnP映射关系检测是否存在有效解,当存在有效解时得到的[x0,y0,z0]即为接收机的空间定位解;
(6)获取有效解后根据PnP映射算法得到的姿态信息对本地惯性器件进行校准,返回步骤(4)进行下一时刻定位;
(7)通过惯性推算实现移动过程中定位,或将可观测到的点状红外节点设备作为特征点基于SLAM算法实现移动过程中定位,返回步骤(4)进行下一时刻定位。
2.一种基于红外基准点的室内与地下空间定位方法,其特征在于,包括以下步骤:
(1)在室内或地下空间的顶部区域以非对称方式设置n个安装点,每个安装点安装1个赋形红外节点设备,每个赋形红外节点设备具有多个发光体,观测区域内可观测到不低于1个赋形红外节点设备;
(2)记录各安装点的空间坐标[xi,yi,zi]i=1~n,记为矩阵
(3)记录赋形红外节点设备的f个发光体采样点在自身坐标系的空间矩阵以及安装在安装点后其自身坐标系和绝对坐标系的转换矩阵D;
(4)接收机通过内嵌的红外摄像头拍摄顶部区域,当接收机获取的实时热成像图像中存在1个赋形红外节点设备时,检测赋形红外节点设备在实时热成像图像中所成图形的m个采样点的投影坐标[xj,yj]j=1~m,记为转到步骤(5);若未拍摄到完整的赋形红外节点设备,则转到步骤(7);
(5)设接收机位置为P=[x0,y0,z0],接收机基于各赋形红外节点设备的空间矩阵C和转换矩阵D,遍历与全部潜在可观测到的赋形红外节点设备采样点的相对位置矩阵基于PnP映射关系检测是否存在有效解,当存在有效解时得到的[x0,y0,z0]即为接收机的空间定位解;
(6)获取有效解后根据PnP映射算法得到的姿态信息对本地惯性器件进行校准,返回步骤(4)进行下一时刻定位;
(7)通过惯性推算实现移动过程中定位,或将可观测到的赋形红外节点设备中多个采样点作为特征点基于SLAM算法实现移动过程中定位,返回步骤(4)进行下一时刻定位。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国电子科技集团公司第五十四研究所,未经中国电子科技集团公司第五十四研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111004267.4/1.html,转载请声明来源钻瓜专利网。