面向稀疏感知环境的机器人自主导航控制方法及系统
本申请提供了面向稀疏感知环境的机器人自主导航控制方法及系统,涉及导航控制技术领域,方法包括:根据多模态感知数据的匹配质量识别感知退化方向;根据环境退化状态标识调整多源融合估计框架的权重配置并进行融合解算;基于融合位姿对稀疏障碍物膨胀生成安全避障区域,并构建全局拓扑路径;生成候选轨迹,根据位姿不确定性数据评估碰撞风险,并评估预期感知收益,生成偏航探索轨迹,并生成最优执行轨迹;根据位姿不确定性数据扩大碰撞安全包络并下调速度上限,基于扩大后的碰撞安全包络、速度上限及最优执行轨迹输出运动控制指令。通过本申请可实现环境退化感知与风险约束导航控制,达到提高定位稳定性与避障安全性的技术效果。