CN112612270A - 传菜控制方法、装置、送餐设备和存储介质 - Google Patents

传菜控制方法、装置、送餐设备和存储介质 Download PDF

Info

Publication number
CN112612270A
CN112612270A CN202011473743.2A CN202011473743A CN112612270A CN 112612270 A CN112612270 A CN 112612270A CN 202011473743 A CN202011473743 A CN 202011473743A CN 112612270 A CN112612270 A CN 112612270A
Authority
CN
China
Prior art keywords
current
descending
driving mechanism
ascending
command
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202011473743.2A
Other languages
English (en)
Inventor
石弟军
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong Zhiyuan Robot Technology Co Ltd
Original Assignee
Guangdong Zhiyuan Robot Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangdong Zhiyuan Robot Technology Co Ltd filed Critical Guangdong Zhiyuan Robot Technology Co Ltd
Priority to CN202011473743.2A priority Critical patent/CN112612270A/zh
Publication of CN112612270A publication Critical patent/CN112612270A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0242Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47GHOUSEHOLD OR TABLE EQUIPMENT
    • A47G23/00Other table equipment
    • A47G23/08Food-conveying devices for tables; Movable or rotary food-serving devices
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0255Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

Abstract

本申请涉及一种传菜控制方法、装置、送餐设备和存储介质。其中,传菜控制方法,接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;确认当前装餐事件结束,输出第一上升命令;检测到送餐设备的盛载装置到达设定高度,指示送餐设备的行走机构动作以使盛载装置移动;在检测到盛载装置移动至目标位置的情况下,向驱动机构输出第二下降命令;检测到当前取餐事件结束,输出第二上升命令;第二上升命令用于指示驱动机构执行相应的上升动作。通过上述方法,可以使得餐品自动从厨房通过布置在天花板的送餐设备进行传菜,不仅节省传菜所需的空间,同时也能够提高传菜效率,提高了传菜的智能化水平。

Description

传菜控制方法、装置、送餐设备和存储介质
技术领域
本申请涉及餐厅送餐技术领域,特别是涉及一种传菜控制方法、装置、送餐设备和存储介质。
背景技术
随着智慧餐厅技术的发展,从厨房配菜区装菜,到行驶到指定餐桌送菜,需要送餐设备(三合一小车)安全、稳定、精确地执行每一个环节。在装菜送菜过程中,会产生吊篮上升、下降、开门、关门等动作,并且会和人有直接互动。
在实现过程中,发明人发现传统技术中至少存在如下问题:传统传菜控制方法存在安全性差、传菜效率低等问题。
发明内容
基于此,有必要针对上述技术问题,提供一种能够提高传菜效率和安全性的传菜控制方法、装置、送餐设备和存储介质。
为了实现上述目的,本发明实施例提供了一种传菜控制方法,包括步骤:
接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;第一下降命令用于指示送餐设备的驱动机构执行相应的下降动作;
确认当前装餐事件结束,输出第一上升命令;第一上升命令用于指示驱动机构执行相应的上升动作;
检测到送餐设备的盛载装置到达设定高度,指示送餐设备的行走机构动作以使盛载装置移动;在检测到盛载装置移动至目标位置的情况下,向驱动机构输出第二下降命令;第二下降命令用于指示驱动机构执行相应的下降动作;
检测到当前取餐事件结束,输出第二上升命令;第二上升命令用于指示驱动机构执行相应的上升动作。
上述技术方案中的一个技术方案具有如下优点和有益效果:
本申请提供的传菜控制方法,接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;确认当前装餐事件结束,输出第一上升命令;检测到送餐设备的盛载装置到达设定高度,指示送餐设备的行走机构动作以使盛载装置移动;并在检测到盛载装置到达目标位置的情况下,向驱动机构输出第二下降命令;检测到当前取餐事件结束,输出第二上升命令;第二上升命令用于指示驱动机构执行相应的上升动作。通过上述方法,可以使得餐品自动从厨房通过布置在天花板的送餐设备进行传菜,不仅节省传菜所需的空间,同时也能够提高传菜效率,提高了传菜的智能化水平。
一方面,本发明实施例还提供了一种送餐设备,包括处理器、盛载装置、驱动机构、行走机构;驱动机构与盛载装置机械连接,且与处理器电连接;处理器与行走机构电连接;
处理器执行计算机程序时实现上述任一项方法的步骤。
一方面,本发明实施例还提供了一种传菜控制装置,包括:
下降控制模块,用于接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;第一下降命令用于指示送餐设备的驱动机构执行相应的下降动作;
第一上升控制模块,用于确认当前装餐事件结束,输出第一上升命令;第一上升命令用于指示驱动机构执行相应的上升动作;
移动控制模块,用于检测到送餐设备的盛载装置到达设定高度,指示送餐设备的行走机构动作以使盛载装置移动;在检测到盛载装置移动至目标位置的情况下,向驱动机构输出第二下降命令;第二下降命令用于指示驱动机构执行相应的下降动作;
第二上升控制模块,用于检测到当前取餐事件结束,输出第二上升命令;第二上升命令用于指示驱动机构执行相应的上升动作。
另一方面,本发明实施例还提供了一种计算机可读存储介质,其上存储有计算机程序,其特征在于,计算机程序被处理器执行时实现上述任一项方法的步骤。
附图说明
通过阅读参照以下附图所作的对非限制性实施例所作的详细描述,本申请的其它特征、目的和优点将会变得更明显:
图1为一个实施例中传菜控制方法的第一示意性流程示意图;
图2为一个实施例中传菜控制方法的第二示意性流程示意图;
图3为一个实施例中传菜控制方法的第三示意性流程示意图;
图4为一个实施例中装菜流程的流程示意图;
图5为一个实施例中送菜流程的流程示意图;
图6为一个实施例中执行相应的下降动作的步骤的第一示意性流程示意图;
图7为一个实施例中检测到发生当前障碍事件的步骤的流程示意图;
图8为一个实施例中执行相应的下降动作的步骤的第二示意性流程示意图;
图9为一个实施例中执行相应的下降动作的步骤的第三示意性流程示意图;
图10为一个实施例中执行相应的上升动作的步骤的第一示意性流程示意图;
图11为一个实施例中执行相应的上升动作的步骤的第二示意性流程示意图;
图12为一个实施例中传菜控制方法的第四示意性流程示意图;
图13为一个实施例中传菜控制方法的第五示意性流程示意图;
图14为一个实施例中判断传动机构是否处于故障状态的步骤的流程示意图;
图15为一个实施例中检测第一绕绳机构和第二绕绳机构的动作量是否同步的步骤的流程示意图;
图16为一个实施例中执行相应的上升动作的步骤的第三示意性流程示意图;图17为一个实施例中送餐设备的结构框图;
图18为一个实施例中传菜控制装置的结构框图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。
在一个实施例中,如图1所示,提供了一种传菜控制方法,包括步骤:
S110,接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;第一下降命令用于指示送餐设备的驱动机构执行相应的下降动作;
其中,下降条件可以包括盛载装置处于关门状态,也可以包括发出关门指令;也即满足下降条件可以为检测到盛载装置处于关门状态,也可以为检测到已经发出关门指令。送餐指令可以由后台发出,也可以由服务人员通过终端发出。相应的下降动作可以包括本领域任意一种下降动作,具体可以包括加速、匀速和减速等动作的任意组合。送餐设备可以为本领域任意一种送餐的设备,在一个具体示例中,送餐设备包括用于装盛载物的盛载装置、用于控制升降的驱动机构、用于水平移动的行走机构以及用于进行控制的处理器;驱动机构与盛载装置机械连接,且与处理器电连接;处理器与行走机构电连接;需要说明的是,加速下降的过程中,其加速度需要小于重力加速器,以避免放绳速度快于盛载装置自有下降的速度,会导致传动机构出现异常。同时,减速下降的过程中,其减速度不宜过大,以增加传动机构的使用寿命。其中,传动机构可用于连接盛载装置和驱动机构。
进一步的,在送餐设备未接受到送餐指令时,可以停在等待区位置。当接收到送餐指令时,可以先停止对设于盛载装置的电池进行充电,在确认当前满足下降条件时,指示送餐设备的驱动机构执行下降动作;或在确认当前满足下降条件时,指示送餐设备的驱动机构行走到装餐位置,然后指示送餐设备的驱动机构执行下降动作。
S120,确认当前装餐事件结束,输出第一上升命令;第一上升命令用于指示驱动机构执行相应的上升动作;
其中,装餐事件可以指进行装餐的动作。需要说明的是,该装餐动作可以由人工进行,也可以由机器人进行装餐。上升动作可以包括本领域任意一种上升动作,具体可以包括加速、匀速和减速等动作的任意组合。需要说明的是,匀速运动的速度可以不同。
具体而言,可以采用本领域任意手段确认当前装餐事件结束,在一个具体示例中,确认当前装餐事件结束的步骤包括:接收到用于表征装餐完毕的信号,则确认当前装餐事件结束。在另一个具体示例中,确认当前装餐事件结束的步骤包括:在预设时长内未检测到装餐动作则确认当前装餐事件结束。
S130,检测到送餐设备的盛载装置到达设定高度,指示送餐设备的行走机构动作以使盛载装置移动;在检测到盛载装置移动至目标位置的情况下,向驱动机构输出第二下降命令;第二下降命令用于指示驱动机构执行相应的下降动作;
其中,目标位置为根据订单桌号得到,送餐指令包括订单桌号。在一个示例中,目标位置为订单桌号对应的桌子上方。在其中一个实施例中,目标位置为根据订单桌号得到。
具体而言,行走机构动作的同时,可以使得盛载装置随之进行移动。在检测到盛载装置移动至订单桌号对应的桌子上方时,指示驱动机构执行相应的下降动作。需要说明的是,第一下降命令和第二下降命令中的“第一”和“第二”并不构成对下降命令的限定,仅用于区分两次下降命令。第一下降命令对应的下降动作与第二下降命令对应的下降动作可以相同,也可以不同。
S140,检测到当前取餐事件结束,输出第二上升命令;第二上升命令用于指示驱动机构执行相应的上升动作。
其中,取餐事件可以指将承载物从盛载装置中取出的动作。
具体而言,可以采用本领域任意一种技术手段检测当前取餐事件结束。在其中一个实施例中,检测到当前取餐事件结束的步骤包括:检测到所述盛载装置处于空载状态,且所述空载状态的持续时长达到预设时长,则确认当前取餐事件结束。其中,空载状态为盛载装置上不存在盛载物。
需要说明的是,第一上升命令和第二上升命令中的“第一”和“第二”并不构成对下降命令的限定,仅用于区分两次上升命令。第一上升命令对应的上升动作与第二上升命令对应的上升动作可以相同,也可以不同。
上述传菜控制方法,接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;确认当前装餐事件结束,输出第一上升命令;检测到送餐设备的盛载装置到达设定高度,指示送餐设备的行走机构动作以使盛载装置移动;并在检测到盛载装置到达目标位置的情况下,向驱动机构输出第二下降命令;检测到当前取餐事件结束,输出第二上升命令;第二上升命令用于指示驱动机构执行相应的上升动作。通过上述方法,可以使得餐品自动从厨房通过布置在天花板的送餐设备进行传菜,不仅节省传菜所需的空间,同时也能够提高传菜效率,提高了传菜的智能化水平。
在一个实施例中,如图2所示,提供了一种传菜控制方法,包括步骤:
S210,接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;第一下降命令用于指示送餐设备的驱动机构执行相应的下降动作;
S220,确认当前装餐事件结束,输出第一上升命令;第一上升命令用于指示驱动机构执行相应的上升动作;
S230,检测到送餐设备的盛载装置到达设定高度,指示送餐设备的行走机构动作以使盛载装置移动;并在检测到盛载装置到达目标位置的情况下,向驱动机构输出第二下降命令;第二下降命令用于指示驱动机构执行相应的下降动作;
S240,检测到当前取餐事件结束,输出第二上升命令;第二上升命令用于指示驱动机构执行相应的上升动作。
其中,向驱动机构输出第二下降命令的步骤之后,还包括步骤:
S231,获取盛载装置的下降高度;
具体地,可以通过本领域任意一种技术手段获取下降高度。在一个具体示例中,可以通过距离检测传感器进行获取盛载装置的下降高度。
S233,检测到下降高度达到预设值,输出第一开门命令;第一开门命令用于指示盛载装置执行开门动作;
具体地,在检测到下降高度达到预设值,也即下降到预设高度,输出开门命令以使盛载装置开门,从而方便服务员或机器人进行装餐动作。
检测到当前取餐事件结束的步骤之后,传菜控制方法还包括步骤:
S241,输出第一关门命令;第一关门命令用于指示盛载装置执行关门动作。
具体的,在取餐事件结束后,指示盛载装置执行关门动作。
进一步的,在一个实施例中,向驱动机构输出第一下降命令的步骤之后,还包括步骤:
获取盛载装置的下降高度;
具体地,可以通过本领域任意一种技术手段获取下降高度。在一个具体示例中,可以通过距离检测传感器进行获取盛载装置的下降高度。
检测到下降高度达到预设值,输出第二开门命令;第二开门命令用于指示盛载装置执行开门动作;
具体地,在检测到下降高度达到预设值,也即下降到预设高度,输出开门命令以使盛载装置开门,从而方便服务员或机器人进行装餐动作。
确认当前装餐事件结束的步骤之后,传菜控制方法还包括步骤:
输出第二关门命令;第二关门命令用于指示盛载装置执行关门动作。
具体的,在取餐事件结束后,指示盛载装置执行关门动作。
在其中一个实施例中,如图3所示,传菜控制方法还包括步骤:
S310,检测送餐设备是否存在设备故障;
具体而言,可以采用本领域任意手段对送餐设备进行估值检测。设备故障包括电机故障、门故障和驱动机构故障。
S320,若检测的结果为是,则指示驱动机构停止动作。
具体的,若存在上述任一设备故障,也即存在电机故障、门故障和驱动机构故障中的任一个,指示驱动机构停止动作,从而停止装餐和送餐。
下面特结合一具体应用场景进行说明上述传菜控制方法,三合一小车(也即送餐设备)将ARV小车(也即上述行走机构)、装菜机构(也即盛载装置)、送菜机构(也即驱动机构)集成于一体;三合一小车(也即送餐设备)在空闲状态时,停留在等候区等待服务员装菜,服务员收到订单(也即上述送餐指令)后触发装菜流程(如图4所示):1.确保吊篮门关闭情况下(一般直接触发一次吊篮门关闭的指令),开始下降吊篮(也即盛载装置);2.吊篮下降过程中,实时检测有无故障(电机故障、门故障、驱动机构故障等),若有故障,直接停止装菜动作,并通知后台检修,若无故障,则直接下降到底部位置;3.打开吊篮门,等待装完菜(装完菜后,服务员会通过人机交互界面输入装菜完毕的信息);4.关闭吊篮门;5.吊篮上升(上升过程找那个也会检测有无故障,方法与2相同);6.吊篮上升到位,装菜完毕。
如图5所示,三合一小车装菜完毕后,会根据订单桌号自动行驶到目标桌号上面。到达目标桌号上面后,指令送菜流程。送菜流程与装菜流程相似,只是判断顾客是否取完菜是通过吊篮内置的菜品检测传感器的反馈信息判断。若吊篮控制器检测到连续3秒内菜品检测传感器均无信号反馈,可判定为顾客已取完菜。
在一个实施例中,如图6所示,执行相应的下降动作的步骤包括:
S610,输出下降控制指令;下降控制指令用于指示送餐设备的驱动机构依据预设下降规则执行下降动作;预设下降规则包括加速下降过程、定速下降过程和减速下降过程中的任意顺序组合;
其中,预设下降规则为设定的控制下降动作的规则,驱动机构执行下降控制指令时,依据预设下降规则进行动作。其中,加速下降过程可以是加速度为正的加速过程;定速下降过程可以是以某个定速进行下降的匀速运动过程;加速下降过程可以是加速度为负的减速过程。驱动机构可以是为送餐设备提供动力的部分,具体为提供盛载装置进行下降驱动力的设备。进一步的,盛载装置用于进行盛放餐品,其与驱动机构机械连接;驱动机构发生动作时,盛载装置跟随驱动机构的动作进行动作。设定位置为一个预设的位置,在到达此位置时需要进行减速以免到达底部位置(如,盛载装置下降最终所需到达的终点位置)时盛载装置仍具有较高的速度,进而造成设备碰撞。需要说明的是,该设定位置与底部位置不同,且可以进行调整。可见,对于该设定位置,其是用于在盛载装置到达该设定位置的情况下,指示驱动机构最后一段距离(设定位置与最终位置之间的距离)的减速下降动作,以令盛载装置在下降到最终位置时,其速度/速率处于预设速度范围内或预设速度数值,避免因盛载装置达到最终位置仍然具有较高的速度/速率,而导致发生盛载装置与其他设备碰撞或者拉扯到驱动机构而导致驱动机构受损害的情况。优选地,以令盛载装置在下降到最终位置时,其速度/速率为0。
具体的,预设下降规则预设下降规则包括加速下降过程、定速下降过程和减速下降过程中的任意顺序组合,例如预设上升规则可以为依次进行加速下降过程、定速下降过程和减速下降过程。需要说明的是,预设上升规则还可以包括其它合乎上升控制逻辑的顺序组合。
S620,在当前处于符合条件的下降过程,且检测到发生当前障碍事件,则响应于当前障碍事件,执行当前次障碍识别控制操作,以指示驱动机构停止下降动作,以及在当前障碍事件消失的情况下,指示驱动机构执行下降动作且更新当前次的设定位置;其中,符合条件的下降过程包括加速下降过程、定速下降过程中的至少一个过程;
具体的,符合条件的下降过程包括加速下降过程、定速下降过程中的至少一个过程,也即,加速下降过程和定速下降过程中可以出现有障碍识别控制操作,也可以不出现障碍识别控制操作。
进一步的,当前障碍事件可以指在盛载装置行进路线中出现障碍物,也可以指盛载装置下方的预设区域内出现障碍物,也可以指出现障碍物后按照预设下降规则继续运行会与障碍物发生碰撞的情况。可以采用本领域任意技术手段对是否发生当前障碍事件进行检测,例如可以在盛载装置的底部设置距离检测传感器(如:红外、超声波等距离传感器),又如:在距离检测传感器检测到障碍物中时,确认按照预设下降规则继续运行会与障碍物发生碰撞,若会发生碰撞则认为检测到发生当前障碍事件。如果检测到发生当前障碍事件,则进入本次的障碍识别控制操作,并指示驱动机构停止下降动作。
当前障碍事件消失可以指障碍物消失(也即目标区域未检测到障碍物),也可以指当前位移量和当前速度满足一定条件,使得减速到0的位置与障碍物仍保持安全距离。需要说明的是,安全距离可以为任意非0数值。当前障碍事件消失的情况下,指示驱动机构执行下降动作且更新当前次的设定位置。具体而言,当前次的设定位置为根据盛载装置的加速度当前速度和当前位移量得到的。在到达当前次的设定位置时,刚好
Figure BDA0002836898370000071
则吊篮直接以加速度a减速到停,便到达底部位置。其中a为加速度;V′d1为当前速度;H'd1为当前位移量。
S630,在盛载装置到达当前次的设定位置之前,检测到下一次障碍事件,则执行下一次障碍识别控制操作。
具体的,下一次的障碍识别控制包括在当前处于符合条件的下降过程,且检测到发生当前障碍事件,则响应于当前障碍事件,执行当前次障碍识别控制操作,以指示驱动机构停止下降动作,以及在当前障碍事件消失的情况下,指示驱动机构执行下降动作且更新下一次的设定位置(在到达下一次的设定位置时,刚好
Figure BDA0002836898370000081
其中a为加速度;V′d2为下一次速度;H'd2为下一次位移量)其中,符合条件的下降过程包括加速下降过程、定速下降过程中的至少一个过程;在盛载装置到达当前次的设定位置之前,如果检测不到下一次障碍事件,则在盛载装置到达该当前次的设定位置之后,确认进入减速下降过程。(需要注明的是,盛载装置到达当前次的设定位置时可以是加速过程中到达,也可以在匀速过程中到达)。
上述执行相应的下降动作的步骤,在当前处于符合条件的下降过程,且检测到发生当前障碍事件,则响应于当前所述障碍事件,执行当前次障碍识别控制操作,以指示所述驱动机构停止下降动作,以及在当前所述障碍事件消失的情况下,指示所述驱动机构执行下降动作且更新当前次的设定位置,在盛载装置到达当前次的设定位置之前,检测到下一次障碍事件,则执行下一次障碍识别控制操作。通过在下降过程中对下降速度进行优化,避免了发生碰撞其他障碍物的事故。通过在发生当前障碍事件时更新当前次的设定位置,以使得盛载装置到达当前次的设定位置时,进行减速至0时,刚好到达底部位置(也即终点位置),进一步提高了送餐设备的安全性。
在一个实施例中,如图7所示,检测到发生当前障碍事件的步骤,包括:
S710,获取盛载装置的当前位移量和当前速度,并判断当前位移量和当前速度是否满足预设条件;
具体的,可以通过本领域任意手段获取盛载装置的当前位移量和当前速度,例如通过速度传感器进行检测当前速度,并根据每一刻的速度以及时间获取盛载装置的当前位移量。预设条件可以为本领域任意一种条件,以使得从当前时刻开始减速到0的位置与障碍物仍保持安全距离。
S720,若判断的结果为否,则确认发生当前障碍事件。
具体的,在不满足预设条件的情况下,则确认发生当前障碍事件。
在一个具体示例中,若当前位移量和当前速度满足以下公式,则确认当前位移量和当前速度满足预设条件;公式包括:
H-Ht>=0.5*(Vt 2/a)+Hs
其中,H为下降总高度,Ht为当前位移量;Vt为当前速度;a为加速度;Hs为最小安全距离。
在一个实施例中,如图8所示,执行相应的下降动作的步骤还包括:
S640,在当前处于符合条件的下降过程且检测到发生当前晃动事件,则响应于当前晃动事件,执行当前次晃动控制操作,以指示驱动机构停止下降动作,以及在当前晃动事件消失的情况下,指示驱动机构执行下降动作其中,符合条件的下降过程包括加速下降过程、定速下降过程、减速下降过程中至少一个过程。
具体的,晃动事件可以指盛载装置进行晃动,而判断盛载装置发生当前晃动事件的条件可以根据实际情况进行设置,相应的判断当前晃动事件消失的条件也可以根据实际情况进行设置,在此不做具体限定。若当前处于符合条件的下降过程且送餐设备的盛载装置发生晃动事件,则响应于当前晃动事件,执行当前次的晃动控制操作,在进入本次的晃动控制操作时,则指示驱动机构停止下降动作。需要说明的是,指示驱动机构停止下降动作可以为指示驱动机构的电机停止工作,也可以为在指示驱动机构的电机停止工作的同时,指示制动机构进行制动,只要能实现盛载装置停止位移即可。进一步的,在指示驱动机构停止下降动作后,还需要对当前次的设定位置进行更新。具体而言,更新后的当前次的设定位置为根据盛载装置的加速度、当前速度和当前位移量得到的。在到达更新后的当前次的设定位置时,刚好
Figure BDA0002836898370000091
则吊篮直接以加速度a减速到停,便到达底部位置(也即终点位置)。其中a为加速度;V′d3为发生晃动事件情况下的当前速度;H'd3为发生晃动事件情况下的当前位移量。需要说明的是,当前次的晃动控制操作包括指示驱动机构停止下降动作,以及在当前晃动事件消失的情况下,指示驱动机构执行下降动作且对当前次的设定位置进行更新。
需要说明的是,在盛载装置到达更新后的当前次的设定位置之前,检测到下一次晃动事件,则执行下一次晃动控制操作。
在盛载装置到达当前次的设定位置之前,如果检测不到下一次障碍事件,则在盛载装置到达该当前次的设定位置之后,确认进入减速下降过程。上述下降控制方法,对下降速度进行进一步优化,可以避免盛载装置下降时由于不能及时停止而造成盛载装置与其他设备(如运载小车本体)的碰撞,通过对发生当前晃动时间进行速度控制,也进一步提高了送餐的安全性。
在其中一个实施例中,当前次的设定位置为根据盛载装置的加速度、当前速度和当前位移量得到;和/或,
预设下降规则为根据驱动机构的最大速度、驱动机构的最小速度以及下降高度得到;
具体的,为了使送餐效率最高,要使得整个送餐的时间最短,既可以根据驱动机构的最大速度、驱动机构的最小速度以及下降高度得到预设的下降规则。
和/或,如图9所示,执行相应的下降动作的步骤还包括:
S910,在接收到下降控制指令,确认进入加速下降过程;
S920,在检测到驱动机构的持续动作时间达到预设时长时,确认进入定速下降过程;
需要说明的是,预设时长可以根据加速度和最大速度进行计算。
S930,在检测到送餐设备的盛载装置达到设定位置时,确认进入减速下降过程。
在其中一个实施例中,如图10所示,执行相应的上升动作的步骤,包括:
S1010,检测到当前满足上升条件的情况下,输出上升控制命令;上升控制命令用于指示送餐设备的驱动机构依据预设上升规则动作;预设上升规则包括加速上升过程、第一定速上升过程、减速上升过程和第二定速上升过程中的任意顺序组合;
具体的,从厨房配菜区装菜,到行驶到指定餐桌送菜,需要三合一小车安全、稳定、精确地执行每一个环节。在装菜送菜过程中,会产生盛载装置(如吊篮)的上升、下降、开门、关门等动作。一般而言,送餐设备的上升控制发生于装菜完成时以及取菜完成时。
其中,上升条件可以根据具体场景进行设置,在此处并不做具体限定。预设上升规则为设定的控制上升动作的规则。其中,加速上升过程可以是加速度为正的加速过程;第一定速上升过程可以是以第一定速进行上升的过程;减速上升过程可以是加速度为负的加速过程。驱动机构可以为送餐设备提供动力的部分。
具体而言,预设上升规则可以包括加速上升过程、第一定速上升过程、减速上升过程和第二定速上升过程的任意顺序组合,例如预设上升规则可以为依次进行加速上升过程、第一定速上升过程、减速上升过程和第二定速上升过程;第一定速大于第二定速。需要说明的是,预设上升规则还可以包括依次进行加速上升过程、减速上升过程和第二定速上升过程等合乎上升控制逻辑的过程。需要说明的是,晃动控制操作的次数为根据实际晃动情况而定。
S1020,在当前处于符合条件的上升过程且检测到发生当前晃动事件,则响应于当前晃动事件,执行当前次晃动控制操作,以指示驱动机构停止上升动作,以及在当前晃动事件消失的情况下,指示驱动机构执行上升动作且更新当前次的设定位置;其中,符合条件的上升过程包括加速上升过程、第一定速上升过程、减速上升过程、第二定速上升过程中的至少一个过程;
其中,盛载装置用于进行盛放餐品,其与驱动机构机械连接;驱动机构发生动作时,盛载装置跟随驱动机构的动作进行动作。
具体的,晃动事件可以指盛载装置进行晃动,而判断盛载装置发生当前晃动事件的条件可以根据实际情况进行设置,相应的判断当前晃动事件消失的条件也可以根据实际情况进行设置,在此不做具体限定。若当前处于符合条件的上升过程且送餐设备的盛载装置发生晃动事件,则响应于当前晃动事件,执行当前次的晃动控制操作,在进入本次的晃动控制操作时,则指示驱动机构停止上升动作。需要说明的是,指示驱动机构停止上升动作可以为指示驱动机构的电机停止工作,也可以为在指示驱动机构的电机停止工作的同时,指示制动机构进行制动,只要能实现盛载装置停止位移即可。进一步的,在指示驱动机构停止上升动作后,还需要更新当前次的设定位置。具体而言,当前次的设定位置为根据盛载装置的加速度、当前速度和当前位移量得到的。在到达当前次的设定位置时,刚好
Figure BDA0002836898370000111
则吊篮直接以加速度a减速到停,便到达底部位置(也即终点位置)。其中a为加速度;V′d1为当前速度;H'd1为当前位移量。需要说明的是,当前次的晃动控制操作包括指示驱动机构停止上升动作,以及在当前晃动事件消失的情况下,指示驱动机构执行上升动作且更新当前次的设定位置。可见,对于该设定位置,其是用于在盛载装置到达该设定位置的情况下,指示驱动机构最后一段距离(设定位置与最终位置之间的距离)的减速上升动作,以令盛载装置在上升到最终位置时,其速度/速率处于预设速度范围内或预设速度数值,避免因盛载装置达到最终位置仍然具有较高的速度/速率,而导致发生盛载装置和驱动机构碰撞的情况。优选地,以令盛载装置以令盛载装置在上升到最终位置时,其速度/速率为0。
驱动机构的电机停止工作,此时盛载装置停止,当前晃动事件会随着时间消失。在当前晃动事件消失的情况下,则指示驱动机构执行上升动作。需要说明的是符合条件的上升过程包括所述加速上升过程、所述第一定速上升过程、所述减速上升过程、所述第二定速上升过程中的至少一个过程可以包括加速上升的过程、匀速上升的过程,也可以包括加速上升的过程、减速上升的过程,也可以包括加速上升的过程、匀速上升的过程和减速上升的过程,在此不做具体限定。
S1030,在盛载装置到达当前次的设定位置之前,检测到下一次晃动事件,则执行下一次晃动控制操作。
进一步的,在盛载装置到达当前次的设定位置之前,盛载装置在发生下一次晃动事件的情况下进入下一次晃动控制操作,也即指示所述驱动机构停止上升动作,以及在当前所述晃动事件消失的情况下,指示所述驱动机构执行上升动作且更新下一次的设定位置;在盛载装置到达当前次的设定位置之前,如果检测不到下一次障碍事件,则在盛载装置到达该当前次的设定位置之后,确认进入减速上升过程。在一个具体示例中,符合条件的上升过程包括所述减速上升过程和所述第二定速上升过程中的至少一个过程。换言之,在盛载装置(如:吊篮)上升的过程中,吊篮进行加速上升过程、第一定速上升过程中即使发生当前晃动事件,盛载装置也不会停止运动,以提高盛载装置的上升效率。在吊篮正常上升的过程中,会存有2个不同速度的定速上升过程,可以使得在提高上升效率的同时,避免吊篮基于惯性在停止上升控制时,仍会向上升一段而导致撞到传动机构。然后在第二定速上升的过程中,发生当前晃动事情的情况下,则指示驱动机构停止上升动作并在当前晃动事件消失的情况下,指示驱动机构执行上升动作。若发生下一次晃动事件则进入下一次晃动控制操作。如此反复循环,直到盛载装置达到目标位置。
上述执行相应的上升动作方法,在当前处于符合条件的上升过程且检测到发生当前晃动事件,执行当前次晃动控制操作,以指示所述驱动机构停止上升动作,以及在当前所述晃动事件消失的情况下,指示所述驱动机构执行上升动作且更新当前次的设定位置,通过对上升速度进行优化可以避免盛载装置上升时由于不能及时停止而造成盛载装置与其他设备(如运载小车本体)的碰撞。同时也进一步提高了送餐的安全性。
在其中一个实施例中,传菜控制方法还包括步骤:
获取盛载装置的姿态变化量,并在姿态变化量大于预设值的情况下确认盛载装置发生晃动事件;
具体的,可以通过本领域任意一种技术手段获取盛载装置的姿态变化量。例如:可以通过姿态传感器获取盛载装置的姿态变化量;姿态传感器可以包括陀螺仪等。需要说明的是,姿态变化量为当前姿态角与初始姿态角之差。其中,初始俯仰角、初始偏航角和输出滚转角可以为盛载装置静止不动时测量的角度。
在其中一个实施例中,姿态变化量包括俯仰角变化量、偏航角变化量、滚转角变化量中至少一个;预设值包括第一阈值、第二阈值、第三阈值中至少一个;
在姿态变化量大于预设值的情况下确认盛载装置发生晃动事件的步骤包括:
若俯仰角变化量大于第一阈值,偏航角大于第二阈值,和/或滚转角变化量大于第三阈值,则确认盛载装置发生晃动事件。
具体而言,可以通过本领域任意手段获取俯仰角变化量、偏航角变化量和滚转角变化量。例如接收陀螺仪传输的盛载装置的姿态角,并对姿态角进行换算处理,得到俯仰角、偏航角以及滚转角;俯仰角变化量为当前俯仰角和初始俯仰角之差;偏航角变化量为当前偏航角和初始偏航角之差;滚转角变化量为当前滚转角和初始滚转角之差。
而当以下任意一种情况或多种情况的组合出现时,则确认盛载装置发生晃动事件。该情况包括仰角变化量大于第一阈值;偏航角大于第二阈值;滚转角变化量大于第三阈值。具体的,第一阈值为1.5°,第二阈值为5°,第三阈值为6°。
进一步的,获得的俯仰角θ、偏航角ψ、滚转角φ的变化量可以衡量吊篮的晃动程度。由于吊篮顶部由左右两根绳子拉住,在绳子正常缠绕的情况下,吊篮沿左右方向摆动时,俯仰角θ并不会发生太大的变化。实测得到,当θ变化量大于1.5°,φ变化量大于5°,或ψ变化量大于6°时,吊篮晃动比较剧烈,需要减速停止吊篮上升。
根据钟摆效应盛载装置上升越高晃动也会更明显,送完菜后在盛载装置上升过程中因为没有负载,上升的稳定性变差,加上取菜时人为产生的晃动,也会加剧吊篮上升的不稳定性。而采用上述方法,可以有效控制晃动情况。
在其中一个实施例中,传菜控制方法还包括步骤:
获取盛载装置的姿态变化量,并在姿态变化量满足预设条件的情况下确认晃动事件消失。
其中,预设条件可以为本领域任意一种满足平衡要求的条件。例如:姿态变化量小于设定值,具体可以为俯仰角变化量、偏航角变化量和滚转角变化量中的任意一个小于设定值;可以为俯仰角变化量小于第一设定值,偏航角变化量小于第二设定值,滚转角变化量小于第三设定值。
在其中一个实施例中,姿态变化量包括俯仰角变化量、偏航角变化量和滚转角变化量;
预设条件包括俯仰角变化量、偏航角变化量、滚转角变化量之和小于设定值。
其中,俯仰角变化量为当前俯仰角和初始俯仰角之差;偏航角变化量为当前偏航角和初始偏航角之差;滚转角变化量为当前滚转角和初始滚转角之差。在一个具体示例中,设定值为9°。
在其中一个实施例中,执行相应的上升动作的步骤还包括:
接收到位检测信号的情况下,确认盛载装置到达目标位置并指示驱动机构停止动作;到位检测信号为到位检测传感器经盛载装置触发得到;
具体而言,可以通过本领域任意手段接收到位检测信号,考虑到绳子变形等因素,盛载装置上升到位不能完全以距离或时间来判断,需要设置在驱动机构上的到位检测传感器进行检测是否到位,具体也可以为在驱动机构的左右卷绕绳机构处各放置一个到位检测传感器。需要说明的是,到位检测传感器的量程大于盛载装置减速到0的过程中所上升的高度。
在其中一个实施例中,如图11所示,执行相应的上升动作的步骤还包括:
S1110,接收编码器传输的脉冲数量;其中,所述编码器设于所述驱动机构上,用于检测所述盛载装置的位移量;
其中,可以根据编码器传输的脉冲数量判断到位检测传感器是否损坏,若盛载装置正常上升到位,盛载装置从底部到顶部,读到编码器输出的脉冲数为
N=H*p/(2*π*r)±Δn
编码器同轴安装的转轮半径为r,编码器脉冲当量为p,Δn为允许的编码器输出误差,H为升降总高度。
S1120,若所述脉冲数量大于预设数量,则指示所述驱动机构停止动作。
具体的,若上升过程中读出的编码器脉冲数高于N,可认为到位检测传感器出现异常,需立即停止盛载装置的动作并上报后台检修。
在其中一个实施例中,传菜控制方法还包括步骤:
在驱动机构发生故障的情况下,指示驱动机构停止动作;
在其中一个实施例中,如图12所示,传菜控制方法还包括步骤:
S1210,判断传动机构是否处于故障状态;其中,所述驱动机构包括电机,以及分别连接所述电机和所述盛载装置的所述传动机构;
具体而言,可以通过本领域任意手段判断传动机构是否处于故障状态。需要说明的是,可以在驱动机构进行动作的情况下,判断传动机构是否处于故障状态。在一个具体示例中,也可以在所述驱动机构依据预设上升规则动作的过程中,判断传动机构是否处于故障状态。具体为,在驱动机构依据加速上升过程、第一定速上升过程、减速上升过程或第二定速上升过程进行动作的情况下,判断传动机构是否处于故障状态。
S1220,若所述判断的结果为是,则指示所述电机停止动作。
具体的,在传动机构是否处于故障状态的情况下,指示电机停止动作。
在其中一个实施例中,如图13所示,传菜控制方法还包括步骤:
S1310,检测所述驱动机构的电机是否发生故障;
具体的,可以通过本领域任意手段检测电极是否发生故障。
S1320,若所述检测的结果为是,则指示所述电机停止动作;
在其中一个实施例中,如图14所示,判断传动机构是否处于故障状态的步骤包括:
S1410,检测第一绕绳机构和第二绕绳机构的动作量是否同步;其中,传动机构包括第一绕绳机构和第二绕绳机构;
具体的,可以通过本领域任意一种手段检测第一绕绳机构和第二绕绳机构的动作量是否同步;判断同步的条件可以根据实际情况进行设定。
S1420,若检测的结果为否,则确认传动机构处于故障状态。
具体的,若第一绕绳机构和第二绕绳机构的动作量不同步,则盛载装置左右两端的绳子胡乱缠绕,并出现安全风险。
在其中一个实施例中,如图15所示,检测第一绕绳机构和第二绕绳机构的动作量是否同步的步骤包括:
S1510,获取第一编码器输出的脉冲数与第二编码器输出的脉冲数的差值;其中,第一编码器设于第一绕绳机构上;第二编码器设于第二绕绳机构;
S1520,若差值大于预设差值,则确认第一绕绳机构和第二绕绳机构的动作量不同步。
具体的,通过实时对比两个编码器的脉冲数差异便可分析出绕绳机构是否出现异常。这里设置脉冲差异同样为Δn(可通过实际应用场合修改)。当两个编码器输出的脉冲数大于Δn,则可认为绕绳机构出现异常,需人工修复机构问题,排除外故障之后再启动上升下降功能。
在其中一个实施例中,如图16所述,执行相应的上升动作的步骤还包括:
S1610,在检测到驱动机构的持续动作时间达到第一预设时长时,确认加速上升过程结束;
S1620,在检测到驱动机构的持续动作时间达到第二预设时长时,确认第一定速上升过程结束;
S1630,在检测到驱动机构的持续动作时间达到第三预设时长时,确认减速上升过程结束;
S1640,在接收到到位检测信号,确认第二定速上升过程结束。
应该理解的是,虽然图1-16的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图1-16中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
在一个实施例中,如图17所示,提供了一种送餐设备,包括处理器、盛载装置、驱动机构、行走机构;驱动机构与盛载装置机械连接,且与处理器电连接;处理器与行走机构电连接;
处理器执行计算机程序时实现上述任一项方法的步骤。
其中,盛载装置用于盛放餐品;驱动机构用于提供动力以使盛载装置进行升降动作;行走机构用于使得盛载装置进行水平移动;驱动机构与盛载装置机械连接,具体可以采用绳索进行连接。处理器可以对驱动机构和减速机构进行控制,执行上述上升控制方法的步骤。
在其中一个实施例中,送餐设备还包括设于盛载装置底部的距离检测传感器和设于盛载装置上的陀螺仪;
处理器接收陀螺仪传输的盛载装置的姿态角,并对姿态角进行换算处理,得到俯仰角、偏航角以及滚转角;
处理器根据俯仰角、偏航角和滚转角,判断送餐设备的盛载装置是否发生晃动事件。
具体而言,处理器可以将陀螺仪传输的姿态角进行处理,得到俯仰角、偏航角以及滚转角;具体的,处理器可以在俯仰角变化量、偏航角变化量、滚转角变化量之和小于设定值确认晃动时间消失,在俯仰角变化量大于第一阈值,偏航角大于第二阈值,和/或滚转角变化量大于第三阈值,则确认盛载装置发生晃动事件。
在其中一个实施例中,驱动机构包括电机,以及分别连接电机和盛载装置的传动机构;传动机构包括第一绕绳机构和第二绕绳机构;第一绕绳机构上设有第一编码器;第二绕绳机构设有第二编码器;
还包括设于第一绕绳机构的第一到位检测传感器,以及设于第二绕绳机构的第二到位检测传感器;
还包括设于所述盛载装置上的门机构;
还包括设于所述盛载装置底部的距离检测传感器;所述门结构和所述距离检测传感器均与所述处理器电连接。
具体的,通过到位检测传感器检测盛载装置是否到达目标位置。通过第一编码器和第二编码器判断到位检测传感器是否故障。通过比较第一编码器和第二编码器传输的脉冲数之差判断绕绳机构是否发生故障。距离检测传感器可以为本领域任意一种距离检测传感器;例如:红外传感器和超声波传感器;距离检测传感器用于检测是否发生当前障碍事件。门结构可以为本领域任意一种电动门。
在一个实施例中,如图18所示,提供了一种传菜控制装置,包括:
下降控制模块,用于接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;第一下降命令用于指示送餐设备的驱动机构执行相应的下降动作;
第一上升控制模块,用于确认当前装餐事件结束,输出第一上升命令;第一上升命令用于指示驱动机构执行相应的上升动作;
移动控制模块,用于检测到送餐设备的盛载装置到达设定高度,指示送餐设备的行走机构动作以使盛载装置移动;在检测到盛载装置移动至目标位置的情况下,向驱动机构输出第二下降命令;第二下降命令用于指示驱动机构执行相应的下降动作;
第二上升控制模块,用于检测到当前取餐事件结束,输出第二上升命令;第二上升命令用于指示驱动机构执行相应的上升动作。
关于传菜控制装置的具体限定可以参见上文中对于传菜控制方法的限定,在此不再赘述。上述传菜控制装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现以下步骤:
接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;第一下降命令用于指示送餐设备的驱动机构执行相应的下降动作;
确认当前装餐事件结束,输出第一上升命令;第一上升命令用于指示驱动机构执行相应的上升动作;
检测到送餐设备的盛载装置到达设定高度,指示送餐设备的行走机构动作以使盛载装置移动;并在检测到盛载装置到达目标位置的情况下,向驱动机构输出第二下降命令;第二下降命令用于指示驱动机构执行相应的下降动作;
检测到当前取餐事件结束,输出第二上升命令;第二上升命令用于指示驱动机构执行相应的上升动作。
在一个实施例中,检测到当前取餐事件结束的步骤被处理器执行时还实现以下步骤:
检测到预设时长内盛载装置均不存在盛载物,则确认当前取餐时间结束。
在一个实施例中,确认当前装餐事件结束的步骤被处理器执行时还实现以下步骤:
接收到用于表征装餐完毕的信号,则确认当前装餐事件结束。
在一个实施例中,向驱动机构输出第二下降命令的步骤被处理器执行之后还实现以下步骤:
获取盛载装置的下降高度;
检测到下降高度达到预设值,输出第一开门命令;第一开门命令用于指示盛载装置执行开门动作;
在一个实施例中,检测到当前取餐事件结束的步骤被处理器执行之后,还实现以下步骤:
输出第一关门命令;第一关门命令用于指示盛载装置执行关门动作。
在一个实施例中,向驱动机构输出第一下降命令的步骤被处理器执行之后还实现以下步骤:
获取盛载装置的下降高度;
检测到下降高度达到预设值,输出第二开门命令;第二开门命令用于指示盛载装置执行开门动作;
在一个实施例中,确认当前装餐事件结束的步骤被处理器执行之后还实现以下步骤:
输出第二关门命令;第二关门命令用于指示盛载装置执行关门动作。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:
检测送餐设备是否存在设备故障;
若检测的结果为是,则指示驱动机构停止动作。
在一个实施例中,执行相应的下降动作的步骤被处理器执行时还实现以下步骤:
输出下降控制指令;下降控制指令用于指示送餐设备的驱动机构依据预设下降规则执行下降动作;预设下降规则包括加速下降过程、定速下降过程和减速下降过程中的任意顺序组合;
在当前处于符合条件的下降过程,且检测到发生当前障碍事件,则响应于当前障碍事件,执行当前次障碍识别控制操作,以指示驱动机构停止下降动作,以及在当前障碍事件消失的情况下,指示驱动机构执行下降动作且更新当前次的设定位置;其中,符合条件的下降过程包括加速下降过程、定速下降过程中的至少一个过程;
在盛载装置到达当前次的设定位置之前,检测到下一次障碍事件,则执行下一次障碍识别控制操作。
在一个实施例中,执行相应的上升动作的步骤被处理器执行时还实现以下步骤:
检测到当前满足上升条件的情况下,输出上升控制命令;上升控制命令用于指示送餐设备的驱动机构依据预设上升规则动作;预设上升规则包括加速上升过程、第一定速上升过程、减速上升过程和第二定速上升过程中的任意顺序组合;
在当前处于符合条件的上升过程且检测到发生当前晃动事件,则响应于当前晃动事件,执行当前次晃动控制操作,以指示驱动机构停止上升动作,以及在当前晃动事件消失的情况下,指示驱动机构执行上升动作且更新当前次的设定位置;其中,符合条件的上升过程包括加速上升过程、第一定速上升过程、减速上升过程、第二定速上升过程中的至少一个过程;
在盛载装置到达当前次的设定位置之前,检测到下一次晃动事件,则执行下一次晃动控制操作。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线式动态随机存储器(Rambus DRAM,简称RDRAM)、以及接口动态随机存储器(DRDRAM)等。
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

Claims (20)

1.一种传菜控制方法,其特征在于,包括步骤:
接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;所述第一下降命令用于指示送餐设备的驱动机构执行相应的下降动作;
确认当前装餐事件结束,输出第一上升命令;所述第一上升命令用于指示所述驱动机构执行相应的上升动作;
检测到所述送餐设备的盛载装置到达设定高度,指示所述送餐设备的行走机构动作以使所述盛载装置移动;在检测到所述盛载装置移动至目标位置的情况下,向所述驱动机构输出第二下降命令;所述第二下降命令用于指示所述驱动机构执行相应的下降动作;
检测到当前取餐事件结束,输出第二上升命令;所述第二上升命令用于指示所述驱动机构执行相应的上升动作。
2.根据权利要求1所述的传菜控制方法,其特征在于,所述检测到当前取餐事件结束的步骤包括:
检测到所述盛载装置处于空载状态,且所述空载状态的持续时长达到预设时长,则确认当前取餐事件结束;
和/或,所述确认当前装餐事件结束的步骤包括:
接收到用于表征装餐完毕的信号,则确认当前装餐事件结束。
3.根据权利要求1所述的传菜控制方法,其特征在于,向所述驱动机构输出第二下降命令的步骤之后,还包括步骤:
获取所述盛载装置的下降高度;
检测到所述下降高度达到预设值,输出第一开门命令;所述第一开门命令用于指示所述盛载装置执行开门动作;
检测到当前取餐事件结束的步骤之后,还包括步骤:
输出第一关门命令;所述第一关门命令用于指示所述盛载装置执行关门动作。
4.根据权利要求1或3所述的传菜控制方法,其特征在于,向所述驱动机构输出第一下降命令的步骤之后,还包括步骤:
获取所述盛载装置的下降高度;
检测到所述下降高度达到预设值,输出第二开门命令;所述第二开门命令用于指示所述盛载装置执行开门动作;
确认当前装餐事件结束的步骤之后,传菜控制方法还包括步骤:
输出第二关门命令;所述第二关门命令用于指示所述盛载装置执行关门动作。
5.根据权利要求1所述的传菜控制方法,其特征在于,所述执行相应的下降动作的步骤包括:
输出下降控制指令;所述下降控制指令用于指示送餐设备的驱动机构依据预设下降规则执行下降动作;所述预设下降规则包括加速下降过程、定速下降过程和减速下降过程中的任意顺序组合;
在当前处于符合条件的下降过程,且检测到发生当前障碍事件,则响应于当前所述障碍事件,执行当前次障碍识别控制操作,以指示所述驱动机构停止下降动作,以及在当前所述障碍事件消失的情况下,指示所述驱动机构执行下降动作且更新当前次的设定位置;其中,所述符合条件的下降过程包括所述加速下降过程、所述定速下降过程中的至少一个过程;
在所述盛载装置到达所述当前次的设定位置之前,检测到下一次所述障碍事件,则执行下一次所述障碍识别控制操作。
6.根据权利要求5所述的传菜控制方法,其特征在于,所述检测到发生当前障碍事件的步骤,包括:
获取所述盛载装置的当前位移量和当前速度,并判断所述当前位移量和所述当前速度是否满足预设条件;
若所述判断的结果为否,则确认发生所述当前障碍事件;
其中,所述判断所述当前位移量和所述当前速度是否满足预设条件的步骤,包括:
若所述当前位移量和所述当前速度满足以下公式,则确认所述当前位移量和所述当前速度满足预设条件;所述公式包括:
H-Ht>=0.5*(Vt 2/a)+Hs
其中,所述H为下降总高度,所述Ht为所述当前位移量;Vt为所述当前速度;a为加速度;Hs为最小安全距离。
7.根据权利要求5所述的传菜控制方法,其特征在于,所述执行相应的下降动作的步骤还包括:
在当前处于符合条件的下降过程且检测到发生当前晃动事件,则响应于当前所述晃动事件,执行当前次晃动控制操作,以指示所述驱动机构停止下降动作,以及在当前所述晃动事件消失的情况下,指示所述驱动机构执行下降动作其中,所述符合条件的下降过程包括所述加速下降过程、所述定速下降过程、所述减速下降过程中至少一个过程。
8.根据权利要求5所述的传菜控制方法,其特征在于,所述当前次的设定位置为根据所述盛载装置的加速度、当前速度和当前位移量得到;和/或,
所述预设下降规则为根据所述驱动机构的最大速度、所述驱动机构的最小速度以及下降高度得到;和/或,
所述执行相应的下降动作的步骤还包括:
在接收到所述下降控制指令,确认进入所述加速下降过程;
在检测到驱动机构的持续动作时间达到预设时长时,确认进入所述定速下降过程;
在检测到所述送餐设备的盛载装置达到设定位置时,确认进入所述减速下降过程。
9.根据权利要求1所述的传菜控制方法,其特征在于,所述执行相应的上升动作的步骤,包括:
检测到当前满足上升条件的情况下,输出上升控制命令;所述上升控制命令用于指示送餐设备的驱动机构依据预设上升规则动作;所述预设上升规则包括加速上升过程、第一定速上升过程、减速上升过程和第二定速上升过程中的任意顺序组合;
在当前处于符合条件的上升过程且检测到发生当前晃动事件,则响应于当前所述晃动事件,执行当前次晃动控制操作,以指示所述驱动机构停止上升动作,以及在当前所述晃动事件消失的情况下,指示所述驱动机构执行上升动作且更新当前次的设定位置;其中,所述符合条件的上升过程包括所述加速上升过程、所述第一定速上升过程、所述减速上升过程、所述第二定速上升过程中的至少一个过程;
在所述盛载装置到达所述当前次的设定位置之前,检测到下一次所述晃动事件,则执行下一次所述晃动控制操作。
10.根据权利要求7或9所述的传菜控制方法,其特征在于,所述传菜控制方法还包括步骤:
获取所述盛载装置的姿态变化量,并在所述姿态变化量大于预设值的情况下确认所述盛载装置发生晃动事件;
其中,所述姿态变化量包括俯仰角变化量、偏航角变化量、滚转角变化量中至少一个;所述预设值包括第一阈值、第二阈值、第三阈值中至少一个;
所述在所述姿态变化量大于预设值的情况下确认所述盛载装置发生晃动事件的步骤包括:
若所述俯仰角变化量大于第一阈值,所述偏航角大于第二阈值,和/或所述滚转角变化量大于第三阈值,则确认所述盛载装置发生晃动事件。
11.根据权利要求7或9所述的传菜控制方法,其特征在于,所述传菜控制方法还包括步骤:
获取所述盛载装置的姿态变化量,并在所述姿态变化量满足预设条件的情况下确认所述晃动事件消失;
其中,所述姿态变化量包括俯仰角变化量、偏航角变化量和滚转角变化量;所述预设条件包括所述俯仰角变化量、所述偏航角变化量、所述滚转角变化量之和小于设定值。
12.根据权利要求9所述的传菜控制方法,其特征在于,所述执行相应的上升动作的步骤还包括:
接收到位检测信号的情况下,确认所述盛载装置到达目标位置并指示所述驱动机构停止动作;所述到位检测信号为到位检测传感器经所述盛载装置触发得到;
和/或,接收编码器传输的脉冲数量;其中,所述编码器设于所述驱动机构上,用于检测所述盛载装置的位移量;
若所述脉冲数量大于预设数量,则指示所述驱动机构停止动作。
13.根据权利要求1所述的传菜控制方法,其特征在于,所述传菜控制方法还包括步骤:
在所述驱动机构发生故障的情况下,指示所述驱动机构停止动作;和/或,
判断传动机构是否处于故障状态;其中,所述驱动机构包括电机,以及分别连接所述电机和所述盛载装置的所述传动机构;
若所述判断的结果为是,则指示所述电机停止动作;和/或,
检测所述驱动机构的电机是否发生故障;
若所述检测的结果为是,则指示所述电机停止动作;
其中,所述判断所述传动机构是否处于故障状态的步骤包括:
检测第一绕绳机构和第二绕绳机构的动作量是否同步;其中,所述传动机构包括所述第一绕绳机构和所述第二绕绳机构;
若所述检测的结果为否,则确认所述传动机构处于故障状态。
14.根据权利要求13所述的传菜控制方法,其特征在于,所述检测所述第一绕绳机构和第二绕绳机构的动作量是否同步的步骤包括:
获取第一编码器输出的脉冲数与第二编码器输出的脉冲数的差值;其中,所述第一编码器设于所述第一绕绳机构上;第二编码器设于所述第二绕绳机构;
若所述差值大于预设差值,则确认所述第一绕绳机构和第二绕绳机构的动作量不同步。
15.根据权利要求1所述的传菜控制方法,其特征在于,所述送餐指令包括订单桌号所述目标位置为根据所述订单桌号得到;和/或,所述下降条件包括所述盛载装置处于关门状态。
16.一种送餐设备,其特征在于,包括处理器、盛载装置、驱动机构、行走机构;所述驱动机构与所述盛载装置机械连接,且与所述处理器电连接;所述处理器与所述行走机构电连接;
所述处理器执行计算机程序时实现权利要求1至15中任一项所述方法的步骤。
17.根据权利要求16所述的送餐设备,其特征在于,所述送餐设备还包括设于所述盛载装置底部的距离检测传感器和设于所述盛载装置上的陀螺仪;
所述处理器接收所述陀螺仪传输的所述盛载装置的姿态角,并对所述姿态角进行换算处理,得到俯仰角、偏航角以及滚转角;
所述处理器根据所述俯仰角、所述偏航角和所述滚转角,判断所述送餐设备的盛载装置是否发生晃动事件。
18.根据权利要求16所述的送餐设备,其特征在于,所述驱动机构包括电机,以及分别连接所述电机和所述盛载装置的传动机构;所述传动机构包括第一绕绳机构和第二绕绳机构;所述第一绕绳机构上设有第一编码器;所述第二绕绳机构设有第二编码器;
还包括设于所述第一绕绳机构的第一到位检测传感器,以及设于所述第二绕绳机构的第二到位检测传感器;
还包括设于所述盛载装置上的门机构;
还包括设于所述盛载装置底部的距离检测传感器;所述门结构和所述距离检测传感器均与所述处理器电连接。
19.一种传菜控制装置,其特征在于,包括:
下降控制模块,用于接收到送餐指令且确认当前满足下降条件的情况下,输出第一下降命令;所述第一下降命令用于指示送餐设备的驱动机构执行相应的下降动作;
第一上升控制模块,用于确认当前装餐事件结束,输出第一上升命令;所述第一上升命令用于指示所述驱动机构执行相应的上升动作;
移动控制模块,用于检测到所述送餐设备的盛载装置到达设定高度,指示所述送餐设备的行走机构动作以使所述盛载装置移动;在检测到所述盛载装置移动至目标位置的情况下,向所述驱动机构输出第二下降命令;所述第二下降命令用于指示所述驱动机构执行相应的下降动作;
第二上升控制模块,用于检测到当前取餐事件结束,输出第二上升命令;所述第二上升命令用于指示所述驱动机构执行相应的上升动作。
20.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至15中任一项所述的方法的步骤。
CN202011473743.2A 2020-12-15 2020-12-15 传菜控制方法、装置、送餐设备和存储介质 Pending CN112612270A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011473743.2A CN112612270A (zh) 2020-12-15 2020-12-15 传菜控制方法、装置、送餐设备和存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011473743.2A CN112612270A (zh) 2020-12-15 2020-12-15 传菜控制方法、装置、送餐设备和存储介质

Publications (1)

Publication Number Publication Date
CN112612270A true CN112612270A (zh) 2021-04-06

Family

ID=75234286

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011473743.2A Pending CN112612270A (zh) 2020-12-15 2020-12-15 传菜控制方法、装置、送餐设备和存储介质

Country Status (1)

Country Link
CN (1) CN112612270A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115215065A (zh) * 2022-06-27 2022-10-21 武汉逸飞激光股份有限公司 一种升降控制方法、装置、电子设备及其多层输送线

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5924582A (en) * 1996-12-06 1999-07-20 Mitsubishi Heavy Industries, Ltd. Lowering collision avoidance device of crane
CN105668171A (zh) * 2016-03-31 2016-06-15 广东科技学院 传菜系统
CN106483985A (zh) * 2015-08-24 2017-03-08 第传动科技股份有限公司 用以控制升降设备的可携式装置及升降设备控制方法
CN106808478A (zh) * 2017-01-20 2017-06-09 刘建 一种高架轨道取送、餐机器人
CN108652343A (zh) * 2018-06-14 2018-10-16 辽宁科技大学 采用地表传菜的自动化点餐送餐系统
CN109077462A (zh) * 2018-05-31 2018-12-25 深圳市赛亿科技开发有限公司 一种智能餐厅送餐方法及系统
CN109124246A (zh) * 2017-06-19 2019-01-04 汪元生 一种能实现自动打菜自动消毒的立体垂直智能传菜机
CN110355766A (zh) * 2018-08-24 2019-10-22 北京京东振世信息技术有限公司 餐品派送装置、餐品派送系统及控制方法
CN110638295A (zh) * 2019-09-03 2020-01-03 严钟耀 一种智能餐厅用传菜收台系统
CN110833290A (zh) * 2019-12-12 2020-02-25 广东智源机器人科技有限公司 一种菜品传送的方法、装置及存储介质
CN111080193A (zh) * 2019-11-21 2020-04-28 深圳市赛为智能股份有限公司 餐品存取方法、装置、计算机设备及存储介质
CN111506085A (zh) * 2020-05-21 2020-08-07 广东智源机器人科技有限公司 机器人餐厅及送餐方法
CN111543836A (zh) * 2020-05-14 2020-08-18 广东智源机器人科技有限公司 智能送餐车

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5924582A (en) * 1996-12-06 1999-07-20 Mitsubishi Heavy Industries, Ltd. Lowering collision avoidance device of crane
CN106483985A (zh) * 2015-08-24 2017-03-08 第传动科技股份有限公司 用以控制升降设备的可携式装置及升降设备控制方法
CN105668171A (zh) * 2016-03-31 2016-06-15 广东科技学院 传菜系统
CN106808478A (zh) * 2017-01-20 2017-06-09 刘建 一种高架轨道取送、餐机器人
CN109124246A (zh) * 2017-06-19 2019-01-04 汪元生 一种能实现自动打菜自动消毒的立体垂直智能传菜机
CN109077462A (zh) * 2018-05-31 2018-12-25 深圳市赛亿科技开发有限公司 一种智能餐厅送餐方法及系统
CN108652343A (zh) * 2018-06-14 2018-10-16 辽宁科技大学 采用地表传菜的自动化点餐送餐系统
CN110355766A (zh) * 2018-08-24 2019-10-22 北京京东振世信息技术有限公司 餐品派送装置、餐品派送系统及控制方法
CN110638295A (zh) * 2019-09-03 2020-01-03 严钟耀 一种智能餐厅用传菜收台系统
CN111080193A (zh) * 2019-11-21 2020-04-28 深圳市赛为智能股份有限公司 餐品存取方法、装置、计算机设备及存储介质
CN110833290A (zh) * 2019-12-12 2020-02-25 广东智源机器人科技有限公司 一种菜品传送的方法、装置及存储介质
CN111543836A (zh) * 2020-05-14 2020-08-18 广东智源机器人科技有限公司 智能送餐车
CN111506085A (zh) * 2020-05-21 2020-08-07 广东智源机器人科技有限公司 机器人餐厅及送餐方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115215065A (zh) * 2022-06-27 2022-10-21 武汉逸飞激光股份有限公司 一种升降控制方法、装置、电子设备及其多层输送线

Similar Documents

Publication Publication Date Title
KR102612894B1 (ko) 엘리베이터 컴포넌트 격리 보장 시스템 및 운용 방법
US10196234B2 (en) Method for controlling unintended vertical speed and acceleration of an elevator
US10189676B2 (en) Apparatus for performing a rescue run in an elevator system by selecting rescue functions to utilize to perform the rescue run and a method of performing same
CN105980284B (zh) 电梯中的制动器操作管理
CN112612270A (zh) 传菜控制方法、装置、送餐设备和存储介质
JP5419936B2 (ja) 災害対応型エレベータシステム
JP5462836B2 (ja) エレベーター用制動装置及びエレベーター
EP3210923B1 (en) Advanced smooth rescue operation
JP5137614B2 (ja) エレベータ装置
JP2001114482A (ja) エレベータの停電時救出運転装置
JP6324303B2 (ja) 停電時のエレベータ非常救出運転装置
CN112612271A (zh) 运载物的传输方法、送餐设备和存储介质
CN112631291A (zh) 送餐设备的上升控制方法、装置、送餐设备和存储介质
JP7147900B1 (ja) エレベータ
CN112596520A (zh) 送餐设备的下降控制方法、装置、送餐设备和存储介质
CN109358553B (zh) 升降机运动控制方法及装置、升降机控制器及升降机系统
CN102015508B (zh) 电梯装置
JP6452925B1 (ja) エレベーター装置および非常止め装置の試験方法
CN113474275B (zh) 电梯的应急运转控制装置及方法
CN108439214B (zh) 岸桥的自动装卸方法
KR101707256B1 (ko) 건설 작업용 리프트 시스템 및 이의 제어 방법
KR101447399B1 (ko) 엘리베이터의 종단층 강제 감속장치
JP7449501B1 (ja) エレベータ
CN109019200B (zh) 组管理控制装置
CN114555506B (zh) 电梯系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination