[发明专利]自移动设备的避障控制方法及自移动设备有效
申请号: | 201810362958.3 | 申请日: | 2018-04-21 |
公开(公告)号: | CN108762247B | 公开(公告)日: | 2021-06-11 |
发明(设计)人: | 王时群;刘德;郑卓斌;王立磊 | 申请(专利权)人: | 广东宝乐机器人股份有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 518000 广东省深圳市*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 移动 设备 控制 方法 | ||
1.一种自移动设备的避障控制方法,其特征在于,避障控制方法包括:
S1:将自移动设备的行走路径分割为N个动作,并预设自移动设备完成每个动作所需持续时间阈值;且,N>1;
S2:自移动设备以任一动作为当前动作运动;
S3:判断当前动作是否处于异常状态,若处于异常状态则执行步骤S4;若未处于异常状态则返回步骤S2;
S4:检测当前动作持续时间是否满足对应动作的时间阈值,如果是则自移动设备执行步骤S5;如果否则返回步骤S2;
S5:执行下一动作,并返回步骤S2;
S6:重复步骤S2至S5,直到自移动设备完成行走路径或停止工作;
其中,在所述步骤S3中当前动作异常状态是基于自移动设备的轮组在工作时输出的电流值或转速值变化形成的障碍判断方法。
2.根据权利要求1所述自移动设备的避障控制方法,其特征在于,所述步骤S3中的判断当前动作是否处于异常的方法为:
S01:获取自移动设备执行当前动作在时刻T0的驱动机构的电流值I0;
S02:获取自移动设备执行当前动作在时刻T1的驱动机构的电流值I1;
S03:计算I0与I1的差值,若|I0-I1|≤I0,则当前动作为正常状态;若|I0-I1|>I0,则自当前动作为异常状态。
3.根据权利要求1所述自移动设备的避障控制方法,其特征在于,所述步骤S3中的判断当前动作是否处于异常的方法为:
S21:获取自移动设备执行当前动作在时刻T0的驱动机构的转速值V0;
S22:获取自移动设备执行当前动作在时刻T1的驱动机构的转速值V1;
S23:计算V0与V1的差值,若|V0-V1|≥V0,则自移动设备为正常状态;若|V0-V1|<V0,则自移动设备为异常状态。
4.根据权利要求1所述自移动设备的避障控制方法,其特征在于,所述步骤S3以预设间隔时间循环执行。
5.根据权利要求1所述自移动设备的避障控制方法,其特征在于,所述步骤S5中的下一动作的行进方向偏离当前动作的行进方向。
6.根据权利要求1所述自移动设备的避障控制方法,其特征在于,所述步骤S3和步骤S4可交换顺序。
7.一种自移动设备,其特征在于,包括:
存储模块,用于存储自移动设备的运行指令;
处理模块,根据权利要求1至6任一项所述避障控制方法以使自移动设备执行运行指令完成避障动作。
8.根据权利要求7所述的自移动设备,其特征在于,所述存储模块存储根据权利要求1至6任一项所述避障控制方法的运行指令。
9.根据权利要求7所述的自移动设备,其特征在于,所述自移动设备为扫地机器人、擦窗机器人或割草机器人。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广东宝乐机器人股份有限公司,未经广东宝乐机器人股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201810362958.3/1.html,转载请声明来源钻瓜专利网。