Trajectory generation algorithm of inertial navigation based on smart phone
-
摘要: 针对传统的手机惯性导航技术存在无法精确计步和计算步长的问题,提出了一种基于智能手机的惯性导航轨迹生成算法。该算法根据智能手机上三轴加速度传感器捕捉的人走路时产生的三轴加速度,利用基于Mealy状态机的计步算法计算人所走过的步数,并获得每一步的起止时间戳;根据三轴陀螺仪所获取的数据及每一步的起止时间戳,结合指南针读数,计算人走过的每一步所发生的方向变化;根据不同步长的人行走时所产生的不同加速度,基于最小二乘法估计人的步长;根据路径起点的坐标,结合步长及方向变化,计算人走过的每一步相对于路径起点的坐标,得到人的运动轨迹。仿真结果表明该算法能够达到较高的惯性导航精度。Abstract: In view of problem that traditional inertial navigation technology of mobile phone is unable to calculate steps or step length accurately, a trajectory generation algorithm of inertial navigation based on smart phone was put forward. The walking steps of people are calculated by use of step counting algorithm based on Mealy state machine according to three-axis accelerations of walking people captured by three-axis acceleration sensor of smart phone, and start-stop timestamp of each step is gotten. Direction change of each step is calculated according to data of three-axis gyroscope and the start-stop timestamp of each step combined with compass reading. Step length is estimated based on the least square method considering different acceleration of walking people with different step length. Coordinate relative to starting point of each step is calculated on the basis of coordinate of the starting point, step length and direction change, so as to get movement trajectory of people. The simulation result shows that the algorithm can achieve high accuracy of inertial navigation.
-
Key words:
- inertial navigation /
- navigation trajectory /
- smart phone /
- three-axis gyroscope
点击查看大图
计量
- 文章访问数: 36
- HTML全文浏览量: 6
- PDF下载量: 5
- 被引次数: 0