一种基于相对位姿测量的行人导航方法

专利类型：发明专利

语言：中文

申请号：CN201410477615.3

申请日：20140918

发明人：王韬郑海升王坤谢晓姣乔自士谢芝茂张潘吴皓威宗京京蔡莹卓

申请人：重庆大学

申请人地址：400044 重庆市沙坪坝区沙正街174号重庆大学A区通信与测控中心

公开日：20141231

公开号：CN104251702A

代理人：

代理机构：

摘　　要：本发明公开一种基于相对位姿测量的行人导航方法,涉及导航定位领域。该方法包括以下步骤：(1)在行人左右脚上分别安装3组相对位姿测量设备；(2)确定导航坐标系；(3)使用安装在左右脚鞋底的电子开关检测行人左右脚与地面的接触；(4)使用多目标测距电路和光学相机分别测量出左右脚坐标系之间的相对位姿,进而分别测量出左右脚前后两次接触地面时的相对位姿；使用左右脚上的9轴惯性测量单元分别测量出左右脚前后两次接触地面时的相对位姿；(5)将三组位姿测量结果进行数据融合,不断重复步骤(3)-(5)的位姿测量过程；(6)确定左右脚坐标系分别相对于导航坐标系的相对位置和相对姿态；(7)左右脚行进轨迹及其姿态的显示。

主权项：一种基于相对位姿测量的行人导航方法,其特征在于：(1)在行人左右脚上分别安装3组相对位姿测量设备；(2)确定导航坐标系；(3)使用安装在左右脚鞋底的电子开关检测行人左右脚与地面的接触；(4)使用多目标测距电路和光学相机分别测量出左右脚坐标系之间的相对位姿,进而分别测量出左右脚前后两次接触地面时的相对位姿；使用左右脚上的9轴惯性测量单元分别测量出左右脚前后两次接触地面时的相对位姿；(5)将三组位姿测量结果进行数据融合,不断重复步骤(3)?(5)的位姿测量过程；(6)确定左右脚坐标系分别相对于导航坐标系的相对位置和相对姿态；(7)左右脚行进轨迹及其姿态的显示。

关键词：位姿测量;位姿;导航坐标系;脚坐标系;接触地面;行人导航;测量;惯性测量单元;测距电路;导航定位;电子开关;光学相机;数据融合;行进轨迹;多目标;组位;检测;重复

法律状态：

IPC专利分类号：G01C21/16;G01C11/00