[发明专利]移动机器人的控制方法、装置、移动机器人和存储介质在审
申请号: | 202110670350.9 | 申请日: | 2021-03-11 |
公开(公告)号: | CN113433939A | 公开(公告)日: | 2021-09-24 |
发明(设计)人: | 徐玮;金超 | 申请(专利权)人: | 上海擎朗智能科技有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 北京品源专利代理有限公司 11332 | 代理人: | 孟金喆 |
地址: | 201206 上海市浦东新区中国(上*** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 移动 机器人 控制 方法 装置 机器 人和 存储 介质 | ||
1.一种移动机器人的控制方法,其特征在于,所述移动机器人上安装有激光雷达和惯性测量单元,所述激光雷达用于测量所述激光雷达距离路面的距离,所述惯性测量单元用于测量所述移动机器人当前的俯仰角度,所述方法包括:
当所述激光雷达获得的距离信息发生有效距离变化时,获取所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离;
根据所述固定距离、所述测量距离和所述激光雷达发射的光束的角度参数,预测前方路段相对所述移动机器人当前所在路面的倾斜角度;
基于所述倾斜角度和所述俯仰角度,确定前方路段的坡度;
根据所述坡度、所述坡度与所述移动机器人的坡度阈值的比较结果,控制所述移动机器人运动;
将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息。
2.根据权利要求1所述的方法,其特征在于,所述获取所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离,包括:
获取所述激光雷达发射的第一光束和第二光束在第一位置测得的距离当前路面的第一固定距离和第二固定距离;
获取所述激光雷达发射的第一光束和第二光束在第二位置测得的距离前方路段的第一测量距离和第二测量距离;
相应地,所述根据所述固定距离、所述测量距离和所述激光雷达发射的光束的角度参数,预测前方路段相对所述移动机器人当前所在路面的倾斜角度,包括:
根据所述第一固定距离、所述第二固定距离、所述第一测量距离、所述第二测量距离和所述第一光束与所述第二光束之间的夹角,计算所述前方路段相对当前路面的倾斜角度。
3.根据权利要求1所述的方法,其特征在于,所述坡度阈值包括最大上坡角度和最小下坡角度,所述根据所述坡度、所述坡度与所述移动机器人的坡度阈值的比较结果,控制所述移动机器人运动,包括:
根据所述坡度的正负情况,确定所述前方路段的上下坡情况,所述上下坡情况为上坡路段或下坡路段;
若所述前方路段为上坡路段,则确定所述坡度是否小于所述最大上坡角度;
若所述坡度小于所述最大上坡角度,则控制所述移动机器人上坡。
4.根据权利要求3所述的方法,其特征在于,所述控制所述移动机器人上坡,包括:
确定所述坡度与所述俯仰角度的大小关系,所述大小关系为大于、小于或等于;
若所述坡度大于所述俯仰角度,则增大所述移动机器人的牵引力;
若所述坡度小于所述俯仰角度,则增大所述移动机器人的速度;
若所述坡度等于所述俯仰角度,则保持所述移动机器人的牵引力和速度不变。
5.根据权利要求3所述的方法,其特征在于,所述方法还包括:
若所述前方路段为下坡路段,则确定所述坡度是否大于所述最小下坡角度;
若所述坡度大于所述最小下坡角度,则控制所述移动机器人下坡。
6.根据权利要求1-5任一项所述的方法,其特征在于,所述方法还包括:
对所述激光雷达的测量距离大于距离阈值的数据进行去除,并对测量距离进行拟合获得所述距离信息。
7.根据权利要求1-5任一项所述的方法,其特征在于,所述爬坡警示信息包括语音提醒或灯光提醒。
8.根据权利要求1-5任一项所述的方法,其特征在于,所述方法还包括:
当所述移动机器人经过所述坡度区域时,若基于所述倾斜角度和所述俯仰角度,确定前方路段无坡度,则将该坡度区域进行更新。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于上海擎朗智能科技有限公司,未经上海擎朗智能科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110670350.9/1.html,转载请声明来源钻瓜专利网。