[发明专利]一种机器人上下坡控制方法、装置及机器人在审
申请号: | 202210133769.5 | 申请日: | 2022-02-14 |
公开(公告)号: | CN114625125A | 公开(公告)日: | 2022-06-14 |
发明(设计)人: | 田佳 | 申请(专利权)人: | 深圳拓邦股份有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 深圳市瑞方达知识产权事务所(普通合伙) 44314 | 代理人: | 张亚菊 |
地址: | 518000 广东省深圳市南山区粤*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 机器人 下坡 控制 方法 装置 | ||
本申请涉及一种机器人上下坡控制方法、装置及机器人,其中,机器人包括万向轮和驱动轮;控制方法包括:S1、驱动驱动轮以使机器人沿第一方向运行;S2、确认当前运行路径的坡度值是否大于第一预设值,若是则执行S3;否则执行S6;S3、判定机器人的上下坡状态,上坡时执行S4,下坡时执行S5;S4、判断机器人的当前状态是否满足第一预设条件,若是则执行S6,否则执行S7;S5、判断机器人的当前状态是否满足第二预设条件,若是则执行S6,否则执行S7;S6、以预设驱动方向继续驱动驱动轮;S7、调整机器人以使机器人的第一端和第二端朝向互换,并调整驱动轮的驱动方向以使机器人沿第二方向运行。实施本申请能够有效的避免机器人在上下坡过程出现侧翻。
技术领域
本申请涉及机器人技术领域,更具体地说,涉及一种机器人上下坡控制方法、装置及机器人。
背景技术
当前机器人的轮子设置通常为:设置一组用于驱动机器人移动的驱动轮和一组不带驱动只用于调整方向的万向轮,其万向轮通常设置在机器人的前面,即为前轮,驱动轮设置在机器人的后面,即为后轮。而机器人例如割草机器人由于重心的原因,其在爬坡过程中,其可能出现通过驱动轮后驱方式爬坡或者驱动轮前驱方式下坡的应用场景。如果是通过驱动轮后驱方式爬坡时,坡度一大,前轮容易悬空,会使得机器人头翘起来翻车;如果是驱动轮前驱下坡时,其在坡度较大时,可能机器人的尾巴翘起来翻车。
本申请要解决的技术问题在于,针对现有技术的上述部分技术缺陷,提供一种机器人上下坡控制方法、装置及机器人。
本申请解决其技术问题所采用的技术方案是:构造一种机器人上下坡控制方法,其中,所述机器人包括:设置于所述机器人的第一端的万向轮,设置于所述机器人的第二端并可驱动所述机器人移动的驱动轮,其中,所述第一端与所述第二端正相对;
所述控制方法包括以下步骤:
S1、以预设驱动方向驱动所述驱动轮以使所述机器人沿第一方向运行;
S2、监测所述机器人运行过程中、当前运行路径的坡度值,确认所述坡度值是否大于第一预设值,若是则执行步骤S3;否则执行步骤S6;
S3、获取所述当前运行路径的坡度方向,根据所述坡度方向判定所述机器人的上下坡状态,当所述机器人为上坡时,执行步骤S4,当所述机器人为下坡时,执行步骤S5;
S4、获取所述机器人的当前状态,以判断所述机器人的当前状态是否满足第一预设条件,若是则执行步骤S6,否则执行步骤S7;
S5、获取所述机器人的当前状态,以判断所述机器人的当前状态是否满足第二预设条件,若是则执行步骤S6,否则执行步骤S7;
S6、以所述预设驱动方向继续驱动所述驱动轮,并执行所述步骤S2;
S7、调整所述机器人以使所述机器人的第一端和第二端朝向互换,并调整所述驱动轮的驱动方向以使所述机器人沿第二方向运行,并执行所述步骤S2。
优选地,在本申请所述的机器人上下坡控制方法中,在所述步骤S4中,获取所述机器人的当前状态,以判断所述机器人的当前状态是否满足第一预设条件,包括:
S411、判断所述第一方向是否由所述第一端指向所述第二端,若是,则判定所述机器人的当前状态满足所述第一预设条件,否则判定所述机器人的当前状态不满足所述第一预设条件;
在所述步骤S7中,所述第二方向由所述第一端指向所述第二端。
优选地,在本申请所述的机器人上下坡控制方法中,在所述步骤S5中,获取所述机器人的当前状态,以判断所述机器人的当前状态是否满足第二预设条件,包括:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳拓邦股份有限公司,未经深圳拓邦股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202210133769.5/2.html,转载请声明来源钻瓜专利网。
- 上一篇:一种手势组合触发方法、装置、智能仿生手及存储介质
- 下一篇:一种重新投产产线