一种自主系统定位方法、装置、计算机设备及存储介质

    公开(公告)号:CN117804448B

    公开(公告)日:2024-04-30

    申请号:CN202410200168.0

    申请日:2024-02-23

    Abstract: 本发明公开了一种自主系统定位方法、装置、计算机设备及存储介质。自主系统定位方法包括对自主系统的惯性测量数据进行状态预测以及运动补偿,并得到包含构造点的点云;将采集的超宽带数据和激光雷达特征点时间对齐和空间对齐,并记录与激光雷达特征点相对应的位置信息;基于超宽带数据补偿沿预定方向维度的激光雷达误差;计算当前迭代轮次中各个构造点的状态量预测值与各个构造点所属平面的测量值之间的残差;根据残差调整IESKF的迭代权重,并基于调整后的IESKF匹配构造点云并更新地图点。本发明利用IESKF将激光雷达特征点与IMU数据和超宽带数据进行融合,引入超宽带数据来补偿沿预定方向维度的激光雷达误差并在卡尔曼增益公式部分进行调整,提高了室内定位的性能。

    一种自主系统定位方法、装置、计算机设备及存储介质

    公开(公告)号:CN117804448A

    公开(公告)日:2024-04-02

    申请号:CN202410200168.0

    申请日:2024-02-23

    Abstract: 本发明公开了一种自主系统定位方法、装置、计算机设备及存储介质。自主系统定位方法包括对自主系统的惯性测量数据进行状态预测以及运动补偿,并得到包含构造点的点云;将采集的超宽带数据和激光雷达特征点时间对齐和空间对齐,并记录与激光雷达特征点相对应的位置信息;基于超宽带数据补偿沿预定方向维度的激光雷达误差;计算当前迭代轮次中各个构造点的状态量预测值与各个构造点所属平面的测量值之间的残差;根据残差调整IESKF的迭代权重,并基于调整后的IESKF匹配构造点云并更新地图点。本发明利用IESKF将激光雷达特征点与IMU数据和超宽带数据进行融合,引入超宽带数据来补偿沿预定方向维度的激光雷达误差并在卡尔曼增益公式部分进行调整,提高了室内定位的性能。

Patent Agency Ranking