一种三轴超声波辅助下的行人自主定位导航方法

    公开(公告)号:CN115655269B

    公开(公告)日:2024-12-06

    申请号:CN202211386612.X

    申请日:2022-11-07

    Abstract: 本发明请求保护一种三轴超声波辅助下的行人自主定位导航方法:该方法首先利用三轴超声波模块来辅助六轴姿态仪(三轴陀螺仪和三轴加速度计)的滑动均值斜坡法判定行人步行前脚掌的零速率区间,然后利用加速度计和陀螺仪的数据分别进行扩展卡尔曼滤波和卡尔曼滤波解算出两组姿态角,并使用自适应互补滤波融合。最后利用超声波测距传感器测量的足间距离作为观测值进行扩展卡尔曼滤波,校准导航姿态、速度和位置,进而实现精准的人员的定位导航。本发明能够在行人步行的动态过程中,准确判断前脚掌的零速率区间,并能自适应调节导航姿态的融合权重,校准和更新行人足部的导航姿态、速度和位置信息。

    一种三轴超声波辅助下的行人自主定位导航方法

    公开(公告)号:CN115655269A

    公开(公告)日:2023-01-31

    申请号:CN202211386612.X

    申请日:2022-11-07

    Abstract: 本发明请求保护一种三轴超声波辅助下的行人自主定位导航方法:该方法首先利用三轴超声波模块来辅助六轴姿态仪(三轴陀螺仪和三轴加速度计)的滑动均值斜坡法判定行人步行前脚掌的零速率区间,然后利用加速度计和陀螺仪的数据分别进行扩展卡尔曼滤波和卡尔曼滤波解算出两组姿态角,并使用自适应互补滤波融合。最后利用超声波测距传感器测量的足间距离作为观测值进行扩展卡尔曼滤波,校准导航姿态、速度和位置,进而实现精准的人员的定位导航。本发明能够在行人步行的动态过程中,准确判断前脚掌的零速率区间,并能自适应调节导航姿态的融合权重,校准和更新行人足部的导航姿态、速度和位置信息。

Patent Agency Ranking