买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

龙图腾网恭喜东南大学申请的专利一种基于先验轨迹辅助的微惯性/轮速计组合导航方法获国家发明授权专利权，本发明授权专利权由国家知识产权局授予，授权公告号为：CN115727845B 。

龙图腾网通过国家知识产权局官网在2025-04-08发布的发明授权授权公告中获悉：该发明授权的专利申请号/专利号为：202211467464.4，技术领域涉及：G01C21/16；该发明授权一种基于先验轨迹辅助的微惯性/轮速计组合导航方法是由徐晓苏;仲灵通;姚逸卿;周帅设计研发完成，并于2022-11-22向国家知识产权局提交的专利申请。

本一种基于先验轨迹辅助的微惯性/轮速计组合导航方法在说明书摘要公布了：本发明公开了一种基于先验轨迹辅助的微惯性轮速计组合导航方法，具体包括以下步骤：首先建立先验地图库；接着进行先验轨迹辅助导航初始化，包括相对地图原点的微惯性轮速计组合导航；旋转和平移导航轨迹进行地图匹配获取对应路段的先验轨迹；将先验轨迹反旋转和平移至地图原点，先验轨迹点与组合导航轨迹点进行最近点匹配；回溯进行基于最近先验轨迹点位置辅助的组合导航；对修正后的相对位置和姿态绝对化处理；最后重复利用绝对位置从先验地图库中获取先验轨迹，进行基于最近先验轨迹点位置辅助的组合导航，直至导航结束。本发明有效修正了微惯性轮速计组合导航结果，弥补了依靠微惯性和轮速计无法进行全局定位定向的缺陷。

本发明授权一种基于先验轨迹辅助的微惯性/轮速计组合导航方法在权利要求书中公布了：1.一种基于先验轨迹辅助的微惯性轮速计组合导航方法，其特征在于，具体包括以下步骤：步骤S1：建立区域先验地图库，地图库包含道路边界和先验轨迹点；步骤S2：进行先验轨迹辅助导航初始化；步骤S3：利用组合导航输出的绝对位置从先验地图库中获取先验轨迹，经最近点匹配获取最近匹配点辅助微惯性轮速计组合导航，重复该步骤直至导航结束，所述步骤S2具体包括以下过程：S2.1载体在已建好地图库的区域行驶一段路程，同时进行相对地图原点的微惯性轮速计组合导航，得到该段路程相对地图原点的位置轨迹和相对地图坐标轴的姿态序列，其中，组合导航采用经典卡尔曼滤波算法，组合系统状态空间模型为 系统状态向量X选择惯导系统的失准角φ、速度误差δvn、定位误差δpn、陀螺仪相关漂移加速度计相关偏值作为状态，F为系统矩阵，G为系统噪声输入矩阵，W为系统噪声向量，为微惯性导航解算的载体系速度，为轮速计测量的载体系速度，与的差值作为卡尔曼滤波的观测向量Z，H为量测矩阵，V为观测噪声向量，为导航坐标系n与载体坐标系b的转换矩阵，组合导航过程充分利用车辆的非完整约束；S2.2利用微惯性轮速计组合导航轨迹与载体真实运动轨迹的相似性原理，将导航轨迹经旋转和平移后进行地图匹配来获取对应路段的先验轨迹点；S2.3利用步骤S2.2中的旋转和平移将先验轨迹反旋转和平移至地图原点： 其中，为全局先验轨迹点，R和t分别为步骤S2.2中的旋转矩阵和平移向量，为经反旋转和平移后得到的相对地图原点的先验轨迹点；S2.4进行先验轨迹点与微惯性轮速计组合导航轨迹点的最近点匹配： 其中，为第j个相对地图原点的微惯性轮速计组合导航轨迹点，为第i个相对地图原点的先验轨迹点，选择组合导航轨迹点中与先验轨迹点距离最近的点作为最近匹配点；S2.5回溯进行基于最近先验轨迹点位置辅助的微惯性轮速计组合导航，得到修正后的相对位置和姿态，其中，组合导航仍采用经典卡尔曼滤波算法，状态向量及状态方程与步骤S2.1所述相同，量测向量及量测方程变为 其中，为与相匹配的组合导航位置；S2.6对修正后的相对位置和姿态进行全局化处理，即经旋转和平移后得到绝对位置和姿态： 其中，和分别为组合导航绝对位置和姿态，和分别为修正后的相对地图原点的组合导航位置和姿态。

如需购买、转让、实施、许可或投资类似专利技术，可联系本专利的申请人或专利权人东南大学，其通讯地址为：210096 江苏省南京市玄武区四牌楼2号；或者联系龙图腾网官方客服，联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。