龙图腾网&IPTOP
- 微信扫码登录
- 账号密码登录
- 短信登录/注册
申请/专利权人：深圳亿嘉和科技研发有限公司
申请日：2021-07-14
公开（公告）日：2021-09-28
公开（公告）号：CN113447026A
主分类号：G01C21/20(20060101)
分类号：G01C21/20(20060101);G01C21/00(20060101)
优先权：
专利状态码：在审-实质审查的生效
法律状态：2021.10.22#实质审查的生效;2021.09.28#公开
摘要：本发明公开了适应动态环境变化的AMCL定位方法，包括步骤：1机器人运动获取观测数据，根据机器人坐标系在地图坐标系中的位姿将观测数据投影至地图坐标系下；2计算观测数据与离线地图的匹配度，并与设定阈值进行比对；3以各观测数据对应的机器人坐标系位姿为节点通过约束构建位姿图，以匹配度高于设定阈值的观测数据对应的节点为锚点，以匹配度低于设定阈值的观测数据对应的节点为优化项；4得到优化后的机器人坐标系位姿，得到更新后的离线地图；5机器人使用更新后的离线地图进行定位。本发明改善了原有的AMCL仅仅依赖离线地图进行定位，可以提高AMCL定位算法适应动态场景的能力，提升机器人定位的稳定性。
主权项：1.适应动态环境变化的AMCL定位方法，其特征在于：包括步骤：1机器人运动过程中通过测距传感器获取当前观测数据，根据当前机器人坐标系在地图坐标系中的位姿将当前观测数据投影至地图坐标系下；2计算当前观测数据与离线地图的匹配度，并与设定阈值进行比对；若匹配度高于设定阈值，则根据当前观测数据使用概率栅格更新算法更新当前离线地图，并缓存当前观测数据及当前机器人坐标系在地图坐标系的位姿；若匹配度低于设定阈值，则缓存当前观测数据和当前机器人坐标系在地图坐标系的位姿；3以各观测数据对应的机器人坐标系在地图坐标系的位姿为节点通过约束构建位姿图，其中，约束关系为各节点之间的相对位姿，以匹配度高于设定阈值的观测数据对应的节点为锚点，以匹配度低于设定阈值的观测数据对应的节点为优化项；4求解步骤3构建的位姿图得到优化后各观测数据对应的机器人坐标系在地图坐标系下的位姿，并将各观测数据投影至地图坐标系下，并使用概率栅格更新算法更新当前地图，得到更新后的离线地图；5机器人使用更新后的离线地图进行定位。
全文数据：
权利要求：
百度查询： 深圳亿嘉和科技研发有限公司 适应动态环境变化的AMCL定位方法
免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。
主营中国专利交易买卖与专利转让许可,高校科技成果推广与科技成果转化,知识产权运营管理与平台开发,科技人才专家库与科技猎头等科技服务
开放平台
担保交易
惠及多方
会员特惠
专属平台
适合多方
数据共享
功能齐全
皖公网安备 34010402703815号