[发明专利]送餐设备的下降控制方法、装置、送餐设备和存储介质在审
申请号: | 202011473742.8 | 申请日: | 2020-12-15 |
公开(公告)号: | CN112596520A | 公开(公告)日: | 2021-04-02 |
发明(设计)人: | 石弟军 | 申请(专利权)人: | 广东智源机器人科技有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02;A47G23/08 |
代理公司: | 广州华进联合专利商标代理有限公司 44224 | 代理人: | 关志琨 |
地址: | 528312 广东省*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 设备 下降 控制 方法 装置 存储 介质 | ||
1.一种送餐设备的下降控制方法,其特征在于,包括步骤:
输出下降控制指令;所述下降控制指令用于指示送餐设备的驱动机构依据预设下降规则执行下降动作;所述预设下降规则包括加速下降过程、定速下降过程和减速下降过程中的任意顺序组合;
在当前处于符合条件的下降过程,且检测到发生当前障碍事件,则响应于当前所述障碍事件,执行当前次障碍识别控制操作,以指示所述驱动机构停止下降动作,以及在当前所述障碍事件消失的情况下,指示所述驱动机构执行下降动作且更新当前次的设定位置;其中,所述符合条件的下降过程包括所述加速下降过程、所述定速下降过程中的至少一个过程;
在所述盛载装置到达所述当前次的设定位置之前,检测到下一次所述障碍事件,则执行下一次所述障碍识别控制操作。
2.根据权利要求1所述的送餐设备的下降控制方法,其特征在于,所述检测到发生当前障碍事件的步骤,包括:
获取所述盛载装置的当前位移量和当前速度,并判断所述当前位移量和所述当前速度是否满足预设条件;
若所述判断的结果为否,则确认发生所述当前障碍事件。
3.根据权利要求2所述的送餐设备的下降控制方法,其特征在于,所述判断所述当前位移量和所述当前速度是否满足预设条件的步骤,包括:
若所述当前位移量和所述当前速度满足以下公式,则确认所述当前位移量和所述当前速度满足预设条件;所述公式包括:
H-Ht=0.5*(Vt2/a)+Hs;
其中,所述H为下降总高度,所述Ht为所述当前位移量;Vt为所述当前速度;a为加速度;Hs为最小安全距离。
4.根据权利要求1所述的送餐设备的下降控制方法,其特征在于,当前次的设定位置为根据所述盛载装置的加速度、当前速度和当前位移量得到。
5.根据权利要求1所述的送餐设备的下降控制方法,其特征在于,所述下降控制方法还包括步骤:
在当前处于符合条件的下降过程且检测到发生当前晃动事件,则响应于当前所述晃动事件,执行当前次晃动控制操作,以指示所述驱动机构停止下降动作,以及在当前所述晃动事件消失的情况下,指示所述驱动机构执行下降动作其中,所述符合条件的下降过程包括所述加速下降过程、所述定速下降过程、所述减速下降过程中至少一个过程。
6.根据权利要求5所述的送餐设备的下降控制方法,其特征在于,所述下降控制方法还包括步骤:
获取所述盛载装置的姿态变化量,并在所述姿态变化量大于预设值的情况下确认所述盛载装置发生晃动事件。
7.根据权利要求6所述的送餐设备的下降控制方法,其特征在于,所述姿态变化量包括俯仰角变化量、偏航角变化量、滚转角变化量中至少一个;所述预设值包括第一阈值、第二阈值、第三阈值中至少一个;
所述在所述姿态变化量大于预设值的情况下确认所述盛载装置发生晃动事件的步骤包括:
若所述俯仰角变化量大于第一阈值,所述偏航角大于第二阈值,和/或所述滚转角变化量大于第三阈值,则确认所述盛载装置发生晃动事件。
8.根据权利要求5所述的送餐设备的下降控制方法,其特征在于,所述下降控制方法还包括步骤:
获取所述盛载装置的姿态变化量,并在所述姿态变化量满足预设条件的情况下确认所述晃动事件消失。
9.根据权利要求8所述的送餐设备的下降控制方法,其特征在于,所述姿态变化量包括俯仰角变化量、偏航角变化量和滚转角变化量;
所述预设条件包括所述俯仰角变化量、所述偏航角变化量、所述滚转角变化量之和小于设定值。
10.根据权利要求1所述的送餐设备的下降控制方法,其特征在于,所述下降控制方法还包括步骤:
在所述驱动机构发生故障的情况下,指示所述驱动机构停止下降动作。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广东智源机器人科技有限公司,未经广东智源机器人科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011473742.8/1.html,转载请声明来源钻瓜专利网。
- 上一篇:可翻转重型变速箱装配小车
- 下一篇:一种汽车零部件自动化双面高效车床