发明名称 一种基于相对位姿测量的行人导航方法
摘要 本发明公开一种基于相对位姿测量的行人导航方法,涉及导航定位领域。该方法包括以下步骤:(1)在行人左右脚上分别安装3组相对位姿测量设备;(2)确定导航坐标系;(3)使用安装在左右脚鞋底的电子开关检测行人左右脚与地面的接触;(4)使用多目标测距电路和光学相机分别测量出左右脚坐标系之间的相对位姿,进而分别测量出左右脚前后两次接触地面时的相对位姿;使用左右脚上的9轴惯性测量单元分别测量出左右脚前后两次接触地面时的相对位姿;(5)将三组位姿测量结果进行数据融合,不断重复步骤(3)-(5)的位姿测量过程;(6)确定左右脚坐标系分别相对于导航坐标系的相对位置和相对姿态;(7)左右脚行进轨迹及其姿态的显示。
申请公布号 CN104251702A 申请公布日期 2014.12.31
申请号 CN201410477615.3 申请日期 2014.09.18
申请人 重庆大学 发明人 王韬;郑海升;王坤;谢晓姣;乔自士;谢芝茂;张潘;吴皓威;宗京京;蔡莹卓
分类号 G01C21/16(2006.01)I;G01C11/00(2006.01)I 主分类号 G01C21/16(2006.01)I
代理机构 代理人
主权项 一种基于相对位姿测量的行人导航方法,其特征在于:(1)在行人左右脚上分别安装3组相对位姿测量设备;(2)确定导航坐标系;(3)使用安装在左右脚鞋底的电子开关检测行人左右脚与地面的接触;(4)使用多目标测距电路和光学相机分别测量出左右脚坐标系之间的相对位姿,进而分别测量出左右脚前后两次接触地面时的相对位姿;使用左右脚上的9轴惯性测量单元分别测量出左右脚前后两次接触地面时的相对位姿;(5)将三组位姿测量结果进行数据融合,不断重复步骤(3)‑(5)的位姿测量过程;(6)确定左右脚坐标系分别相对于导航坐标系的相对位置和相对姿态;(7)左右脚行进轨迹及其姿态的显示。
地址 400044 重庆市沙坪坝区沙正街174号重庆大学A区通信与测控中心