-
公开(公告)号:CN110686682A
公开(公告)日:2020-01-14
申请号:CN201911121352.1
申请日:2019-11-15
Applicant: 北京理工大学
Abstract: 本发明提供一种基于惯性系统的室内行人航向融合约束算法,根据行人的行走航向与行人所处道路航向之差的模值设定阈值,使用阈值来判断行人是否偏离室内地图的道路中心线航向。当行人的行走航向与行人所处道路航向之差的模值小于阈值,继续使用地图道路航向约束。当行人的行走航向与行人所处道路航向之差的模值大于阈值,判断行人是否处于直线行走状态。当行人处于直线行走状态时,采用行人行走方向航向约束。当行人处于非直线行走状态时,采用航向自约束算法,从而实现在不同室内场景地形和行人不同行走状态之下的航向角约束的目的。