CN114690762A - 货叉碰撞处理方法、装置、机器人、设备、介质及产品 - Google Patents
货叉碰撞处理方法、装置、机器人、设备、介质及产品 Download PDFInfo
- Publication number
- CN114690762A CN114690762A CN202011637451.8A CN202011637451A CN114690762A CN 114690762 A CN114690762 A CN 114690762A CN 202011637451 A CN202011637451 A CN 202011637451A CN 114690762 A CN114690762 A CN 114690762A
- Authority
- CN
- China
- Prior art keywords
- fork
- collision
- determining
- type
- strategy
- 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
Links
- 238000003672 processing method Methods 0.000 title claims abstract description 16
- 238000012545 processing Methods 0.000 claims abstract description 121
- 238000000034 method Methods 0.000 claims abstract description 47
- 230000033001 locomotion Effects 0.000 claims description 100
- 230000015654 memory Effects 0.000 claims description 27
- 238000004590 computer program Methods 0.000 claims description 12
- 230000009471 action Effects 0.000 abstract description 15
- 238000012423 maintenance Methods 0.000 abstract description 8
- 230000008569 process Effects 0.000 description 19
- 230000008859 change Effects 0.000 description 15
- 238000010586 diagram Methods 0.000 description 15
- 230000004888 barrier function Effects 0.000 description 13
- 230000000694 effects Effects 0.000 description 12
- 230000007246 mechanism Effects 0.000 description 12
- 238000007726 management method Methods 0.000 description 7
- 230000009467 reduction Effects 0.000 description 4
- 238000001514 detection method Methods 0.000 description 3
- 230000003068 static effect Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000008602 contraction Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000011521 glass Substances 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000000712 assembly Effects 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 230000003139 buffering effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0227—Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
- B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
- B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
- B66F9/075—Constructional features or details
- B66F9/0755—Position control; Position detectors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
- B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
- B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
- B66F9/063—Automatically guided
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
- B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
- B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
- B66F9/075—Constructional features or details
- B66F9/12—Platforms; Forks; Other load supporting or gripping members
- B66F9/122—Platforms; Forks; Other load supporting or gripping members longitudinally movable
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/0055—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot with safety arrangements
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/0088—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
Abstract
本申请提供一种货叉碰撞处理方法、装置、机器人、设备、介质及产品,方法包括:当检测到机器人的货叉发生碰撞时,确定碰撞类型;根据碰撞类型确定货叉碰撞处理策略;根据货叉碰撞处理策略处理货叉碰撞。本申请中,在检测到货叉发生碰撞时,首先确定货叉发生碰撞的碰撞类型,然后根据确定的碰撞类型来确定货叉碰撞处理策略,最后,根据确定的货叉碰撞处理策略来对货叉碰撞事件进行处理。相比于机器人继续控制货叉执行动作的做法,本申请在发生货叉碰撞时可以根据碰撞类型来处理货叉碰撞事件,从而可以有效保护货叉,防止货叉发生损坏,降低设备维护成本。
Description
技术领域
本申请涉及智能仓储技术领域,尤其涉及一种货叉碰撞处理方法、装置、机器人、设备、介质及产品。
背景技术
随着智能仓储技术的发展,仓库通常采用机器人来进行货物的搬运、存放等处理,相比于人工的处理方式,机器人进行货物处理的效率更高。
现有技术中,用于进行货物搬运等处理的机器人通常设置有用于进行取货的货叉,机器人可以控制货叉执行伸缩、旋转等动作,从而使得货叉可以取出不同方位的货物,或者,将货物放置在货架的不同位置。
然而,在机器人周围存在障碍物时,容易出现货叉与障碍物碰撞的情况,此时,若机器人继续控制货叉执行动作,容易造成货叉损坏,从而导致设备维护成本增加。
发明内容
本申请提供一种货叉碰撞处理方法、装置、机器人、设备、介质及产品,可以有效保护货叉,防止货叉发生损坏,降低设备维护成本。
第一方面,本申请提供一种货叉碰撞处理方法,包括:
当检测到机器人的货叉发生碰撞时,确定碰撞类型;
根据碰撞类型确定货叉碰撞处理策略;
根据所述货叉碰撞处理策略处理货叉碰撞。
在一些实施例中,所述碰撞类型包括伸缩臂伸出碰撞和伸缩臂未伸出碰撞。
在一些实施例中,所述碰撞类型为伸缩臂未伸出碰撞,所述根据碰撞类型确定货叉碰撞处理策略,包括:
根据所述碰撞类型确定第一碰撞处理策略;或,
根据所述碰撞类型确定第二碰撞处理策略;
其中,所述第一碰撞处理策略包括:控制货叉的运动速度为零;
所述第二碰撞处理策略包括:控制货叉的运动速度为零,以及控制用于驱动所述货叉旋转的第一驱动元件停止驱动所述货叉旋转,以使得所述货叉处于自由旋转状态。
在一些实施例中,在所述货叉装有货物时,根据所述碰撞类型确定所述第一碰撞处理策略;
在所述货叉未装有货物时,根据所述碰撞类型确定所述第二碰撞处理策略。
在一些实施例中,所述碰撞类型为伸缩臂伸出碰撞,所述根据碰撞类型确定货叉碰撞处理策略,包括:
根据所述碰撞类型确定第三碰撞处理策略;或,
根据所述碰撞类型确定第四碰撞处理策略;或,
根据所述碰撞类型确定第五碰撞处理策略;或,
根据所述碰撞类型确定第六碰撞处理策略;
其中,所述第三碰撞处理策略包括:控制伸缩臂的伸缩速度为零;
所述第四碰撞处理策略包括:控制伸缩臂的伸缩速度为零,以及控制用于驱动所述货叉旋转的第一驱动元件停止驱动所述货叉旋转,以使得所述货叉处于自由旋转状态;
所述第五碰撞处理策略包括:控制伸缩臂的伸缩速度为零,以及控制用于驱动所述伸缩臂伸缩的第二驱动元件停止驱动所述伸缩臂伸缩,以使得所述伸缩臂处于自由伸缩状态;
所述第六碰撞处理策略包括:控制伸缩臂的伸缩速度为零,控制用于驱动所述货叉旋转的第一驱动元件停止驱动所述货叉旋转,以使得所述货叉处于自由旋转状态,以及控制用于驱动所述伸缩臂伸缩的第二驱动元件停止驱动所述伸缩臂伸缩,以使得所述伸缩臂处于自由伸缩状态。
在一些实施例中,在所述货叉装有货物时,根据所述碰撞类型确定所述第三碰撞处理策略;
在所述货叉未装有货物时,根据所述碰撞类型确定所述第四碰撞处理策略,或,确定所述第五碰撞处理策略,或,确定所述第六碰撞处理策略。
在一些实施例中,按照如下至少一种方式确定机器人的货叉发生碰撞:
驱动元件的工作电流的增大幅度达到第一预设阈值,且达到所述第一预设阈值的持续时间达到第一预设时长;或,
所述货叉的运动速度的减小幅度达到第二预设阈值;或,
所述驱动元件的工作电流的增大幅度达到第三预设阈值,且达到所述第三预设阈值的持续时间达到第二预设时长,以及,所述货叉的运动速度的减小幅度达到第四预设阈值;或,
设置于所述货叉的压力传感器检测到的压力的变化幅度达到第五预设阈值;
其中,所述驱动元件包括用于驱动所述货叉旋转的第一驱动元件、用于驱动伸缩臂伸缩的第二驱动元件以及用于驱动所述货叉升降的第三驱动元件中的至少一种。
在一些实施例中,还包括:
在检测到机器人的货叉发生碰撞后,对碰撞的障碍物进行识别,并根据识别结果对所述障碍物进行处理。
在一些实施例中,所述根据识别结果对所述障碍物进行处理,包括:
在所述障碍物为货物时,根据所述识别结果确定所述障碍物的货物类型;
根据所述障碍物的货物类型,将所述障碍物搬运至对应的货物存放位置。
在一些实施例中,还包括:
在检测到所述货叉即将发生碰撞时,执行货叉碰撞避让策略。
在一些实施例中,按照如下方式确定机器人的货叉即将发生碰撞:
基于所述货叉与障碍物之间的距离,以及所述货叉的当前运动状态,确定所述障碍物在所述货叉的运动路径上。
在一些实施例中,所述执行货叉碰撞避让策略,包括:
根据障碍物的位置,调整所述货叉的位置,以使得所述货叉不与所述障碍物发生碰撞。
在一些实施例中,所述根据障碍物的位置,调整所述货叉的位置,以使得所述货叉不与所述障碍物发生碰撞,包括:
在所述障碍物位于所述货叉的运动路径上时,对所述货叉的运动路径进行调整,以使得所述障碍物不在所述货叉的运动路径上;或者,
在所述障碍物位于所述货叉的运动路径上时,控制所述货叉沿所述运动路径运动至预设位置,并输出障碍物提示信息,其中,所述预设位置为所述运动路径上距离所述障碍物预设距离的位置。
第二方面,本申请提供一种货叉碰撞处理装置,包括:
类型确定模块,用于当检测到机器人的货叉发生碰撞时,确定碰撞类型;
策略确定模块,用于根据碰撞类型确定货叉碰撞处理策略;
碰撞处理模块,用于根据所述货叉碰撞处理策略处理货叉碰撞。
第三方面,本申请提供一种机器人,包括:货叉,以及上述的货叉碰撞处理装置。
第四方面,本申请提供一种计算机设备,包括:存储器,处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述程序时实现上述的货叉碰撞处理方法。
第五方面,本申请提供一种计算机可读存储介质,所述计算机可读存储介质中存储有计算机执行指令,所述计算机执行指令被处理器执行时用于实现上述的货叉碰撞处理方法。
第六方面,本申请提供一种计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现上述的货叉碰撞处理方法。
本申请提供的货叉碰撞处理方法、装置、机器人、设备、介质及产品,方法包括:当检测到机器人的货叉发生碰撞时,确定碰撞类型;根据碰撞类型确定货叉碰撞处理策略;根据货叉碰撞处理策略处理货叉碰撞。本申请中,在检测到货叉发生碰撞时,首先确定货叉发生碰撞的碰撞类型,然后根据确定的碰撞类型来确定货叉碰撞处理策略,最后,根据确定的货叉碰撞处理策略来对货叉碰撞事件进行处理。相比于机器人继续控制货叉执行动作的做法,本申请在发生货叉碰撞时可以根据碰撞类型来处理货叉碰撞事件,从而可以有效保护货叉,防止货叉发生损坏,降低设备维护成本。
附图说明
此处的附图被并入说明书中并构成本说明书的一部分,示出了符合本公开的实施例,并与说明书一起用于解释本公开的原理。
图1为本申请实施例提供的货叉碰撞处理方法的一种应用场景图;
图2A为本申请一个实施例提供的机器人的结构示意图;
图2B为本申请图2A所示实施例中的一种货叉的结构示意图;
图2C为本申请图2A所示实施例中的一种货叉的结构示意图;
图2D为本申请图2A所示实施例中另一种货叉的结构示意图;
图3为本申请实施例提供的货叉碰撞处理方法的示意图;
图4为本申请实施例中货叉与障碍物的位置关系的示例图;
图5a为控制终端控制货叉避让障碍物的示意图;
图5b为控制终端控制货叉避让障碍物的另一示意图;
图6为本申请实施例提供的货叉碰撞处理装置的示意图;
图7为本申请实施例提供的计算机设备的示意图。
通过上述附图,已示出本公开明确的实施例,后文中将有更详细的描述。这些附图和文字描述并不是为了通过任何方式限制本公开构思的范围,而是通过参考特定实施例为本领域技术人员说明本公开的概念。
具体实施方式
这里将详细地对示例性实施例进行说明,其示例表示在附图中。下面的描述涉及附图时,除非另有表示,不同附图中的相同数字表示相同或相似的要素。以下示例性实施例中所描述的实施方式并不代表与本申请相一致的所有实施方式。相反,它们仅是与如所附权利要求书中所详述的、本申请的一些方面相一致的装置和方法的例子。
下面对本申请实施例的应用场景进行解释:
图1为本申请实施例提供的货叉碰撞处理方法的一种应用场景图,如图1所示,本申请实施例提供的货叉碰撞处理方法可以运行在机器人上,也可以运行在电子设备上,如计算机、服务器等,还可以由仓库管理设备执行或者由仓储系统中的其他设备执行。智能仓储系统100采用机器人110进行货架120上货物的提取和/或存放,采用仓库管理设备130对机器人110进行路径规划、状态监控和调度等,以使机器人110移动至设定位置进行货物的提取或存放,仓库管理设备130中还存储有货架120的各个库位的存放信息以及货物的基本信息,以便于进行仓库管理。当仓储系统100存在订单任务时,由机器人110将订单任务对应位于货架120的一个或多个货物121搬运至输送操作台区域140,以完成该订单任务。
图2A为本申请一个实施例提供的机器人的结构示意图,如图2A所示,机器人80包括移动底盘83,存储货架82,货叉84,升降组件81。其中,存储货架82、货叉84以及升降组件81均安装于所述移动底盘83,以及在存储货架82上设置若干存储单元。升降组件81包括第三驱动元件,第三驱动元件可以用于驱动货叉84进行升降移动,使货叉84对准存储货架82上的任意一个存储单元,或者对准货架和/或货物。货叉84能以竖直方向为轴进行旋转而调整朝向,以对准至存储单元,或者对准货架和/或货物。货叉84用于执行货物的装载或卸除,以在货架与存储单元之间进行货物的搬运。
示例性的,存储货架82可以选择性的配置或不配置,在不配置存储货架82时,机器人80在搬运货物期间,货物是存放在货叉84的容置空间内。
上述实施例中的机器人80可以执行本申请任意实施例提供的货叉碰撞处理方法中涉及货叉碰撞处理的步骤,以实现对机器人货叉的保护,避免货叉损坏。
在机器人80执行存放货物任务的过程中,机器人80移动至货物被指定的存放空间的位置,通过调节组件,如旋转机构,配合货叉84,将目标物从机器人本体81的存储单元搬运至货架上。
示例性的,图2B为本申请图2A所示实施例中的一种货叉的结构示意图。
示例性的,货叉84通过旋转机构85安装于托架86,旋转机构85上连接有第一驱动元件87,第一驱动元件87用于驱动旋转机构85带动货叉84相对于托架86绕一竖直轴线旋转,以对准存储单元,或者对准货架和/或货物。货叉84用于在存储单元与货架之间搬运货物。若货叉84未对准货架和/或货物,可通过第一驱动元件87驱动旋转机构85带动货叉84相对于托架86旋转,以保证货叉84对准货架和/或货物。
示例性的,图2C为本申请图2A所示实施例中的一种货叉的结构示意图,请配合图2B利于理解。如图2C所示,货叉84包括托板841和伸缩臂组件。托板841用于放置货物,可以为一水平设置的平板。伸缩臂组件用于将托板841所放置的货物推出托板841或者将货物拉至托板841。伸缩臂组件包括伸缩臂843、固定推杆842以及活动推杆844。伸缩臂843包括左伸缩臂与右伸缩臂,伸缩臂843可水平地伸出,伸缩臂843在垂直于伸缩臂843的伸出方向且平行于托板841的方向上,位于托板841的一侧。伸缩臂843由第二驱动元件提供动力,由链轮机构传递动力,根据实际情况,链轮机构可以替换成带轮机构,丝杠机构等传动机构驱动。固定推杆842及活动推杆844皆安装于伸缩臂843,固定推杆842及活动推杆844可随伸缩臂843一并伸出。固定推杆842与托板841位于伸缩臂843的同一侧,在伸缩臂843伸出时,所述固定推杆842用于将货物从托板841上推出。活动推杆844可收入伸缩臂843,当活动推杆844未收入伸缩臂843时,活动推杆844、固定推杆842以及托板841三者皆位于伸缩臂843的同一侧,并且活动推杆844位于固定推杆842沿伸缩臂843的伸出方向上。活动推杆844可直接由电机驱动,根据实际情况,也可通过如齿轮组,连杆机构等传动机构传递动力。当活动推杆844未收入伸缩臂,并且伸缩臂843缩回时,活动推杆844用于将货物拉至托板841。
示例性的,货叉84的固定推杆842,可以设计如同活动推杆844的指杆结构。
示例性的,货叉84可以设计为伸缩臂组件的间距宽度为可调的结构。在存/取货物的时候,可因应着货物尺寸调整伸缩臂组件的间距宽度。
示例性的,该货叉84还可以包括转向结构,如转盘,该转向结构可以用于改变放置于其托板841上的货物的朝向。图2D为本申请图2A所示实施例中另一种货叉的结构示意图,结合图2D和图2C可知,货叉84还可以包括一个转向结构,即图2D中的转盘845,以改变放置于其托板841上的货物的朝向。
现有技术中,机器人可以通过第一驱动元件控制货叉进行旋转,通过第二驱动元件控制货叉的伸缩臂进行伸缩,通过第三驱动元件控制货叉进行升降,其中,第一驱动元件、第二驱动元件以及第三驱动元件具体可以是电机、马达(例如液压马达等)、气缸等。然而,在上述运动过程中,若机器人周围存在障碍物时,容易出现货叉与障碍物碰撞的情况。在发生碰撞以后,若机器人继续控制货叉执行旋转、伸缩或者升降的动作,则容易造成货叉损坏,从而导致设备维护成本增加。
基于此,本申请的主要构思为:机器人可以对货叉进行碰撞检测,在检测到货叉发生碰撞时,可以根据伸缩臂当前是否处于伸出状态来确定货叉发生碰撞的碰撞类型,然后根据确定的碰撞类型来确定货叉碰撞处理策略,最后,根据确定的货叉碰撞处理策略来对货叉碰撞事件进行处理。相比于机器人继续控制货叉执行旋转、伸缩或者升降的动作的做法,本申请在发生货叉碰撞时可以根据碰撞类型来处理货叉碰撞事件,从而有效保护货叉,防止货叉发生损坏,降低设备维护成本。
下面以具体地实施例对本申请的技术方案以及本申请的技术方案如何解决上述技术问题进行详细说明。下面这几个具体的实施例可以相互结合,对于相同或相似的概念或过程可能在某些实施例中不再赘述。下面将结合附图,对本申请的实施例进行描述。
可以理解,本申请中货叉碰撞处理方法的处理步骤可以由终端、电子设备(如计算机或者服务器)或者图1所示的仓库管理设备实现。其中,终端具体可以是设置于机器人内部以用于控制机器人的控制终端。
图3为本申请实施例提供的货叉碰撞处理方法的示意图,以货叉碰撞处理方法应用于机器人的控制终端为例进行解释说明,如图3所示,该方法主要包括以下步骤:
S100、当检测到机器人的货叉发生碰撞时,确定碰撞类型;
控制终端在检测到机器人的货叉发生碰撞时,首先可以基于货叉包含的结构的当前状态来确定货叉的碰撞类型,货叉包含的结构例如可以是伸缩臂等,伸缩臂的当前状态包括伸缩臂处于伸出状态或者未伸缩状态。其中,伸缩臂的不同状态可以用于将托板所放置的货物推出托板或者将货物拉至托板。
S200、根据碰撞类型确定货叉碰撞处理策略;
在确定碰撞类型之后,控制终端进一步根据碰撞类型来确定对应的货叉碰撞处理策略。具体的,针对不同的碰撞类型,其对应的货叉碰撞处理策略不同。
S300、根据货叉碰撞处理策略处理货叉碰撞。
控制终端在确定货叉碰撞处理策略后,根据确定的货叉碰撞处理策略对货叉碰撞事件进行处理,针对不同的碰撞类型,其对应的货叉碰撞处理策略不同,相应的,对货叉碰撞事件的处理也不同。
本实施例提供一种货叉碰撞处理方法,在检测到货叉发生碰撞时,首先确定货叉发生碰撞的碰撞类型,然后根据确定的碰撞类型来确定货叉碰撞处理策略,最后,根据确定的货叉碰撞处理策略来对货叉碰撞事件进行处理。相比于机器人继续控制货叉执行动作的做法,本申请在发生货叉碰撞时可以根据碰撞类型来处理货叉碰撞事件,从而可以有效保护货叉,防止货叉发生损坏,降低设备维护成本。
在一些实施例中,碰撞类型包括伸缩臂伸出碰撞和伸缩臂未伸出碰撞。
具体的,在控制终端检测到货叉发生碰撞时,若伸缩臂处于伸出状态,则确定碰撞类型为伸缩臂伸出碰撞;若伸缩臂处于未伸出状态,则确定碰撞类型为伸缩臂未伸出碰撞。从而,通过根据伸缩臂的工作状态来确定碰撞类型,可以便于确定货叉碰撞处理策略,以起到保护货叉的目的。
在一些实施例中,碰撞类型为伸缩臂未伸出碰撞,根据碰撞类型确定货叉碰撞处理策略,包括:根据碰撞类型确定第一碰撞处理策略;或,根据碰撞类型确定第二碰撞处理策略。
其中,第一碰撞处理策略包括:控制货叉的运动速度为零;
第二碰撞处理策略包括:控制货叉的运动速度为零,以及控制用于驱动货叉旋转的第一驱动元件停止驱动货叉旋转,以使得货叉处于自由旋转状态。
在控制终端检测到货叉发生碰撞时,若伸缩臂处于未伸出状态,则确定碰撞类型为伸缩臂未伸出碰撞。此时,控制终端可以确定货叉碰撞处理策略为第一碰撞处理策略或者第二碰撞处理策略。
具体的,第一碰撞处理策略包括:控制货叉的运动速度为零,具体是指通过紧急制动等方式使得货叉的运动速度在短时间内降为零。货叉的运动速度具体可以包括货叉的升降速度、伸缩移动速度以及旋转速度,货叉的运动速度为零即货叉的升降速度为零、伸缩移动速度为零以及旋转速度为零,也就是说,此时控制终端控制货叉处于静止状态,从而避免货叉继续与障碍物发生进一步的碰撞。
第二碰撞处理策略是在第一碰撞处理策略的基础上,进一步控制用于驱动货叉旋转的第一驱动元件停止驱动货叉旋转,以使得货叉处于自由旋转状态。其中,自由旋转状态是指若货叉继续受到外力,则货叉可以在外力的作用下,沿着固定的旋转轴进行旋转,以起到缓解外力的作用,从而,即使货叉继续受到外力,也可以通过进行自由旋转来对外力进行缓解,以避免对货叉造成损坏,最终使货叉以及机器人处于稳态。
在一些实施例中,控制终端可以根据货叉中是否装有货物来确定货叉碰撞处理策略为第一碰撞处理策略还是第二碰撞处理策略。
具体的,在确定货叉当前装有货物时,控制终端确定货叉碰撞处理策略为第一碰撞处理策略,即控制终端控制货叉处于静止状态,一方面,可以避免货叉继续与障碍物发生进一步的碰撞,另外,若货叉继续受到外力,货叉仍维持可以维持静止状态,从而可以避免出现由于外力使得货叉的状态发生变化从而导致货物掉落的情况,进而保证货物安全。
例如,若货叉内装有玻璃制品等易碎品,通过控制货叉维持静止状态,可以避免出现由于外力导致易碎品掉落的情况,以保证货物安全。
另外,在确定货叉当前未装有货物时,控制终端确定货叉碰撞处理策略为第二碰撞处理策略,即此时货叉处于自由旋转状态。由于当前货叉未装有货物,即使货叉在外力作用下发生旋转,也不会出现货物掉落的情况,从而避免财产损失。
在一些实施例中,在货叉中装有货物时,控制终端还可以根据货叉中所装货物的重量来确定货叉碰撞处理策略为第一碰撞处理策略还是第二碰撞处理策略。
具体的,可以在机器人的托板上设置传感器以获取货叉所装货物的重量数据,该传感器可以将测量的重量数据发送至控制终端。控制终端在得到货物的重量数据后,将该货物的重量数据与预设重量进行比较,若货物的重量数据超过预设重量,说明货物较重,即使货叉在外力的作用下发生旋转,该货物也不容易掉落,因此,控制终端可以确定碰撞处理策略为第二碰撞处理策略,即货叉可以处于自由旋转状态。
另外,若货物的重量数据未超过预设重量,说明货物较轻,当货叉在外力的作用下发生旋转时,货物容易发生掉落,因此,控制终端可以确定碰撞处理策略为第一碰撞处理策略,即控制货叉处于静止状态。
本实施例中,控制终端根据碰撞类型确定第一碰撞处理策略或第二碰撞处理策略,具体可以是根据货叉当前是否装有货物来确定采用何种碰撞处理策略,从而,既可以避免对货叉造成损坏,也可以防止货物掉落,从而保证货物安全,避免财产损失。
在一些实施例中,碰撞类型为伸缩臂伸出碰撞,根据碰撞类型确定货叉碰撞处理策略,包括:根据碰撞类型确定第三碰撞处理策略;或,根据碰撞类型确定第四碰撞处理策略;或,根据碰撞类型确定第五碰撞处理策略;或,根据碰撞类型确定第六碰撞处理策略。
其中,第三碰撞处理策略包括:控制伸缩臂的伸缩速度为零。
第四碰撞处理策略包括:控制伸缩臂的伸缩速度为零,以及控制用于驱动货叉旋转的第一驱动元件停止驱动货叉旋转,以使得货叉处于自由旋转状态。
第五碰撞处理策略包括:控制伸缩臂的伸缩速度为零,以及控制用于驱动伸缩臂伸缩的第二驱动元件停止驱动伸缩臂伸缩,以使得伸缩臂处于自由伸缩状态。
第六碰撞处理策略包括:控制伸缩臂的伸缩速度为零,控制用于驱动货叉旋转的第一驱动元件停止驱动货叉旋转,以使得货叉处于自由旋转状态,以及控制用于驱动伸缩臂伸缩的第二驱动元件停止驱动伸缩臂伸缩,以使得伸缩臂处于自由伸缩状态。
具体的,在控制终端检测到货叉发生碰撞时,若伸缩臂处于伸出状态,则确定碰撞类型为伸缩臂伸出碰撞。此时,控制终端可以确定货叉碰撞处理策略为第三碰撞处理策略、或者为第四碰撞处理策略、或者为第五碰撞处理策略、或者为第六碰撞处理策略。
具体的,第三碰撞处理策略包括:控制伸缩臂的伸缩速度为零。由于伸缩臂的作用是用于将托板所放置的货物推出托板或者将货物拉至托板,因此,在伸缩臂的伸缩速度为零的情况下,货叉在伸缩方向上不会发生移动,从而避免货叉继续与障碍物发生进一步的碰撞。
第四碰撞处理策略是在第三碰撞处理策略的基础上,进一步控制用于驱动货叉旋转的第一驱动元件停止驱动货叉旋转,以使得货叉处于自由旋转状态。其中,自由旋转状态是指若货叉继续受到外力,则货叉可以在外力的作用下,沿着固定的旋转轴进行旋转,以起到缓解外力的作用,从而,即使货叉继续受到外力,也可以通过进行自由旋转来对外力进行缓解,以避免对货叉造成损坏,最终使货叉以及机器人处于稳态。
第五碰撞处理策略是在第三碰撞处理策略的基础上,进一步控制用于驱动伸缩臂伸缩的第二驱动元件停止驱动伸缩臂伸缩,以使得伸缩臂处于自由伸缩状态。其中,自由伸缩状态是指若货叉继续受到外力,货叉内的伸缩臂可以在外力的作用下,沿着伸缩方向进行伸缩移动,以起到缓解外力的作用,从而,即使货叉继续受到外力,也可以通过在伸缩方向上进行移动来对外力进行缓解,以避免对货叉造成损坏,最终使货叉以及机器人处于稳态。
第六碰撞处理策略是在第三碰撞处理策略的基础上,进一步控制伸缩臂的伸缩速度为零,控制用于驱动货叉旋转的第一驱动元件停止驱动货叉旋转,以使得货叉处于自由旋转状态,以及控制用于驱动伸缩臂伸缩的第二驱动元件停止驱动伸缩臂伸缩,以使得伸缩臂处于自由伸缩状态。从而,即使货叉继续受到外力,也可以通过进行自由旋转,以及,通过在伸缩方向上进行移动来对外力进行缓解,以避免对货叉造成损坏,最终使货叉以及机器人处于稳态。
在一些实施例中,控制终端可以根据货叉中是否装有货物来确定货叉碰撞处理策略为第三碰撞处理策略、或者为第四碰撞处理策略、或者为第五碰撞处理策略、或者为第六碰撞处理策略。
具体的,在确定货叉当前装有货物时,控制终端确定货叉碰撞处理策略为第三碰撞处理策略,即控制终端伸缩臂的伸缩速度为零,一方面,可以避免货叉继续与障碍物发生进一步的碰撞,另外,若货叉继续受到外力,在伸缩臂的伸缩速度为零的情况下,货叉在伸缩方向上不会发生移动,从而可以避免出现由于外力使得货叉发生移动从而导致货物掉落的情况,进而保证货物安全。
例如,若货叉内装有玻璃制品等易碎品,通过控制伸缩臂的伸缩速度为零,可以避免出现由于外力使得货叉发生移动从而导致货物掉落的情况,以保证货物安全。
另外,在确定货叉当前未装有货物时,控制终端确定货叉碰撞处理策略为第四碰撞处理策略、或者为第五碰撞处理策略、或者为第六碰撞处理策略,即此时货叉处于自由旋转状态,或者,伸缩臂处于自由伸缩状态,或者,在货叉处于自由旋转状态的同时,伸缩臂处于自由伸缩状态。由于当前货叉未装有货物,即使货叉在外力作用下发生旋转和/或在伸缩臂的伸缩方向上发生移动,也不会出现货物掉落的情况,从而避免财产损失。
可选的,在确定货叉当前未装有货物时,控制终端可以根据发生碰撞时货叉所受的外力的方向来确定货叉碰撞处理策略。
具体的,可以在货叉的各个方向上布置多个压力传感器,在发生碰撞时,控制终端可以根据多个压力传感器的压力数据来确定货叉所受外力的方向,然后根据外力的方向来确定货叉碰撞处理策略。
其中,当仅存在一个方向的外力、且外力的方向与货叉的旋转方向相同时,控制终端可以确定货叉碰撞处理策略为第四碰撞处理策略,即此时货叉处于自由旋转状态,从而,货叉可以在外力的作用下自由旋转以起到缓解外力的作用。
此外,当仅存在一个方向的外力、且外力的方向与伸缩臂的伸缩移动方向相同时,控制终端可以确定货叉碰撞处理策略为第五碰撞处理策略,即此时伸缩臂处于自由伸缩状态,从而,伸缩臂可以在外力的作用下自由伸缩以起到缓解外力的作用。
另外,当同时存在与货叉的旋转方向相同的外力、以及与伸缩臂的伸缩移动方向相同的外力时,控制终端可以确定货叉碰撞处理策略为第六碰撞处理策略,即此时货叉处于自由旋转状态且伸缩臂处于自由伸缩状态,从而,货叉可以在外力的作用下自由旋转且伸缩臂可以在外力的作用下自由伸缩,以起到缓解外力的作用。
可以理解,外力的方向与货叉的旋转方向相同,具体可以是两方向完全相同,或者两方向的夹角低于预设角度。外力的方向与伸缩臂的伸缩移动方向相同同理。
本实施例中,控制终端根据碰撞类型确定第三碰撞处理策略或第四碰撞处理策略或第五碰撞处理策略或第六碰撞处理策略,具体可以是根据货叉当前是否装有货物来确定采用何种碰撞处理策略,从而,既可以避免对货叉造成损坏,也可以防止货物掉落,从而保证货物安全。
在一些实施例中,按照如下至少一种方式确定机器人的货叉发生碰撞:驱动元件的工作电流的增大幅度达到第一预设阈值,且达到第一预设阈值的持续时间达到第一预设时长;或,货叉的运动速度的减小幅度达到第二预设阈值;或,驱动元件的工作电流的增大幅度达到第三预设阈值,且达到第三预设阈值的持续时间达到第二预设时长,以及,货叉的运动速度的减小幅度达到第四预设阈值;或,设置于货叉的压力传感器检测到的压力的变化幅度达到第五预设阈值。
其中,驱动元件包括用于驱动货叉旋转的第一驱动元件、用于驱动伸缩臂伸缩的第二驱动元件以及用于驱动货叉升降的第三驱动元件中的至少一种。
具体的,货叉的运动类型可以包括旋转、伸缩臂伸缩移动以及升降,控制终端在控制货叉的运动状态时,可以通过控制第一驱动元件来控制货叉进行旋转,也可以通过控制第二驱动元件来控制货叉的伸缩臂进行伸缩移动,还可以通过控制第三驱动元件来控制货叉进行升降。
在控制终端控制货叉进行正常旋转、正常伸缩移动或者正常升降,各驱动元件的工作电流均为正常的工作值,而如果货叉与障碍物发生碰撞,会使得货叉在正常旋转、正常伸缩移动或者正常升降的过程中受到外力(来自障碍物)的作用,此时,驱动元件为了克服外力,需要更大的工作电流,即工作电流会存在一定的增大幅度,因此,在工作电流的增大幅度达到第一预设阈值,且达到第一预设阈值的持续时间达到第一预设时长时,可以确定货叉发生碰撞。从而,通过对驱动元件的工作电流的变化情况进行检测,可以确定机器人的货叉是否发生碰撞。另外,通过设置持续时间的条件,可以避免出现由于电流突变等意外事件而导致控制终端误认为发送货叉碰撞的情况,从而提高货叉碰撞检测结果的准确性。
此外,在货叉进行正常旋转、正常伸缩移动或者正常升降的过程中,货叉的运动速度为正常的速度值,而如果货叉与障碍物发生碰撞,会使得货叉在正常旋转、正常伸缩移动或者正常升降的过程中受到外力(来自障碍物)的作用,此时,货叉的运动速度会降低,因此,在货叉的运动速度的减小幅度达到第二预设阈值时,可以确定货叉发生碰撞。从而,通过对货叉的运动速度的变化情况进行检测,可以确定机器人的货叉是否发生碰撞。
另外,可以同时结合驱动元件的工作电流的变化情况以及货叉的运动速度的变化情况来检测货叉是否发生碰撞,具体的,当驱动元件的工作电流的增大幅度达到第三预设阈值,且达到第三预设阈值的持续时间达到第二预设时长,以及,货叉的运动速度的减小幅度达到第四预设阈值时,可以确定货叉发生碰撞。
其中,第三预设阈值可以和第一预设阈值相同,也可以不同;第二预设时长可以和第一预设时长相同,也可以不同;第四预设阈值可以和第二预设阈值相同,也可以不同。
另外,还可以在货叉上设置压力传感器,在货叉进行正常旋转、正常伸缩移动或者正常升降的过程中,如果货叉与障碍物发生碰撞,障碍物首先会与设置在货叉上的压力传感器接触,压力传感器在外力(来自障碍物)的作用下,其检测到的压力会发生变化,因此,在压力传感器检测到的压力的变化幅度达到第五预设阈值时,可以确定货叉发生碰撞。从而,通过对设置于货叉的压力传感器检测到的压力的变化情况进行检测,可以确定机器人的货叉是否发生碰撞。
本实施例中,控制终端可以通过驱动元件的工作电流的变化情况、货叉的运动速度的变化情况以及压力传感器检测到的压力的变化情况来进行碰撞检测,从而可以准确检测货叉是否发生碰撞,以便于进行货叉碰撞处理,以保护货叉。
在一些实施例中,还包括:在检测到机器人的货叉发生碰撞后,对碰撞的障碍物进行识别,并根据识别结果对障碍物进行处理。
具体的,控制终端在检测到机器人的货叉发生碰撞之后,除了按照货叉碰撞处理策略处理货叉碰撞事件以外,还可以对障碍物的类型等信息进行识别,并根据障碍物的识别结果对障碍物进行处理,从而,可以避免该障碍物与其他机器人发生碰撞,保证机器人或者障碍物的安全。
例如,控制终端可以调用设置在机器人的摄像头拍摄障碍物的图像,然后通过目标识别技术来对障碍物进行识别,从而得到障碍物的识别结果。可以理解,控制终端也可以通过其他方式进行障碍物识别,例如,通过射频识别技术(Radio FrequencyIdentification,RFID)进行货物的电子标签识别等,在此不做具体限定。
在一些实施例中,根据识别结果对障碍物进行处理,包括:在障碍物为货物时,根据识别结果确定障碍物的货物类型;根据障碍物的货物类型,将障碍物搬运至对应的货物存放位置。
具体的,控制终端通过对障碍物进行识别后,若确定障碍物为货物,则进一步根据识别结果确定障碍物的货物类型,并确定该货物所对应的货物存放位置,从而,控制终端控制机器人将该货物搬运至对应的货物存放位置,在对障碍物进行处理的同时,也可以保证货物存放的合理性。
在一些实施例中,还包括:在检测到货叉即将发生碰撞时,执行货叉碰撞避让策略。
具体的,控制终端也可以在机器人运行的过程中,对货叉是否会发生碰撞进行检测,并在检测到货叉即将发生碰撞时,执行货叉碰撞避让策略,从而避免出现货叉碰撞的情况,以起到提前保护货叉的作用。
在一些实施例中,按照如下方式确定机器人的货叉即将发生碰撞:基于货叉与障碍物之间的距离,以及货叉的当前运动状态,确定障碍物在货叉的运动路径上。
具体的,机器人安装有用于进行距离测量的传感器,例如光电传感器、测距传感器或者超声波雷达传感器等,控制终端可以通过进行距离测量的传感器来获取货叉与障碍物之间的距离。然后,结合货叉的当前运动状态,控制终端可以得到货叉的运动路径,最后,基于货叉与障碍物之间的距离以及货叉的运动路径确定障碍物是否在货叉的运动路径上。
若控制终端确定障碍物在货叉的运动路径上,说明货叉按照当前的运动路径进行运动时会与该障碍物发生碰撞,在这种情况下,控制终端可以执行货叉碰撞避让策略。
若控制终端确定障碍物不在货叉的运动路径上,说明货叉按照当前的运动路径进行运动时不会与该障碍物发生碰撞,在这种情况下,控制终端无需执行货叉碰撞避让策略。
其中,货叉的当前运动状态可以是旋转、伸缩移动或者升降等,相应的,货叉的路径可以是货叉的旋转路径、伸缩移动路径或者升降路径等。
例如,图4为本申请实施例中货叉与障碍物的位置关系的示例图,如图4所示,机器人10上设置有货叉11(为便于理解,其他结构未示出),货叉11可以在控制终端的控制下,在图中A-B高度范围内升降,在图中C-D长度范围内伸缩移动。另外,图中包含四个障碍物,分别为20a、20b、20c以及20d。
具体的,控制终端可以通过第三驱动元件控制货叉11沿B→A的方向,向上移动(即上升)至货叉11a所在的位置,货叉11a所在的位置为货叉11上升的最高位置。
在上升过程中,货叉11的运动路径为由货叉11当前所在的位置至货叉11a所在的位置,此时,对于障碍物20a,控制终端基于货叉11与障碍物20a之间的距离,以及货叉的当前运动状态,确定障碍物20a在货叉11的运动路径上,因此,控制终端可以确认货叉11即将与障碍物20a发生碰撞。
而对于障碍物20b,控制终端基于货叉11与障碍物20b之间的距离,以及货叉的当前运动状态,确定障碍物20b不在货叉11的运动路径上,因此,控制终端可以确认货叉11不会与障碍物20b发生碰撞。
此外,控制终端也可以通过第三驱动元件控制货叉11沿A→B的方向,向下移动(即下降)至货叉11b所在的位置,货叉11b所在的位置为货叉11下降的最低位置。
另外,控制终端可以通过第二驱动元件控制货叉11的伸缩臂沿C→D的方向进行伸缩移动,以使货叉11移动至货叉11d所在的位置,货叉11d所在的位置为货叉11伸缩移动的最远位置。此时,对于障碍物20c,控制终端基于货叉11与障碍物20c之间的距离,以及货叉的当前运动状态,确定障碍物20c在货叉11的运动路径上,因此,控制终端可以确认货叉11即将与障碍物20c发生碰撞。
而对于障碍物20d,控制终端基于货叉11与障碍物20d之间的距离,以及货叉的当前运动状态,确定障碍物20d不在货叉11的运动路径上,因此,控制终端可以确认货叉11不会与障碍物20d发生碰撞。
本实施例中,在控制终端基于货叉与障碍物之间的距离以及货叉的当前运动状态确定障碍物在货叉的运动路径上时,可以确定机器人的货叉即将发生碰撞,从而执行货叉碰撞避让策略,以避免货叉与障碍物发生碰撞,起到提前保护货叉的作用。
在一些实施例中,执行货叉碰撞避让策略,包括:根据障碍物的位置,调整货叉的位置,以使得货叉不与障碍物发生碰撞。
具体的,控制终端在确定障碍物位于货叉的运动路径上时,可以根据障碍物的位置来对货叉的位置进行调整,从而避免货叉在运动过程中与障碍物发生碰撞,以提前保护货叉。
在一些实施例中,根据障碍物的位置,调整货叉的位置,以使得货叉不与障碍物发生碰撞,包括:在障碍物位于货叉的运动路径上时,对货叉的运动路径进行调整,以使得障碍物不在货叉的运动路径上;或者,在障碍物位于货叉的运动路径上时,控制货叉沿运动路径运动至预设位置,并输出障碍物提示信息,其中,预设位置为运动路径上距离障碍物预设距离的位置。
控制终端在确定障碍物位于货叉的运动路径上时,可以通过对货叉的运动路径进行调整,以使得障碍物不在货叉的运动路径上,从而,货叉在运动过程不会与该障碍物发生碰撞,从而起到避开障碍物的目前,实现自动避障。
具体的,控制终端在进行货叉的运动路径调整时,可以是包括机器人的位置调整,即控制机器人的移动底盘进行移动。由于货叉是设置在机器人上,当机器人的位置发生变化时,货叉的运动路径也会发生变化,从而起到避障的作用。
例如,图5a为控制终端控制货叉避让障碍物的示意图,如图5a所示,机器人10在取货过程中,控制终端控制货叉11的运动路径为A-B-C,其中,A-B为控制货叉11进行升降(具体为上升)的运动路径,B-C为控制货叉11的伸缩臂进行伸缩(具体为伸出)的运动路径。然而,由于存在障碍物20,且障碍物20位于B-C运动路径上,控制终端确定该障碍物20将与货叉11发生碰撞。因此,控制终端可以控制机器人10进行位置移动,例如进行位置移动后的机器人为图中的机器人10',相应的,进行位置移动后的货叉为图中的货叉11',从而,货叉11'可以按照图中A'-B'-C'的运动路径进行运动,以执行取货处理,且可以顺利避开障碍物20。
另外,控制终端在确定障碍物位于货叉的运动路径上时,也可以控制货叉沿运动路径运动至距离障碍物预设距离的预设位置,并输出障碍物提示信息,以提醒相关人员对障碍物进行处理。在障碍物被处理后,控制终端可以控制货叉继续按照原来的运动路径进行运动。
例如,图5b为控制终端控制货叉避让障碍物的另一示意图,如图5b所示,机器人10在取货过程中,控制终端控制货叉11的运动路径为A-B-C,其中,A-B为控制货叉11进行升降(具体为上升)的运动路径,B-C为控制货叉11的伸缩臂进行伸缩(具体为伸出)的运动路径。然而,由于存在障碍物20,且障碍物20位于B-C运动路径上,控制终端确定该障碍物20将与货叉11发生碰撞。因此,控制终端可以控制货叉11首先运动至图中距离障碍物预设距离的D点位置,并输出障碍物提示信息。然后,在障碍物被处理后,再控制货叉11由D点移动至C点,也可以,货叉11运动至图中距离障碍物预设距离的D点位置后,机器人将障碍物20搬运至自身的存储单元中,再控制货叉11运动到C点,从而避免货叉与障碍物发生碰撞,以保护货叉。
应该理解的是,虽然上述实施例中的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,其可以以其他的顺序执行。而且,图中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,其执行顺序也不必然是依次进行,而是可以与其他步骤或者其他步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
在一些实施例中,提供一种货叉碰撞处理装置。
图6为本申请实施例提供的货叉碰撞处理装置的示意图,如图6所示,该装置包括:
类型确定模块100,用于当检测到机器人的货叉发生碰撞时,确定碰撞类型;
策略确定模块200,用于根据碰撞类型确定货叉碰撞处理策略;
碰撞处理模块300,用于根据货叉碰撞处理策略处理货叉碰撞。
关于货叉碰撞处理装置的具体限定可以参见上文中对于货叉碰撞处理方法的限定,在此不再赘述。上述货叉碰撞处理装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
本申请提供一种货叉碰撞处理装置,在检测到货叉发生碰撞时,首先确定货叉发生碰撞的碰撞类型,然后根据确定的碰撞类型来确定货叉碰撞处理策略,最后,根据确定的货叉碰撞处理策略来对货叉碰撞事件进行处理。相比于机器人继续控制货叉执行动作的做法,本申请在发生货叉碰撞时可以根据碰撞类型来处理货叉碰撞事件,从而可以有效保护货叉,防止货叉发生损坏,降低设备维护成本。
在一些实施例中,碰撞类型包括伸缩臂伸出碰撞和伸缩臂未伸出碰撞。
在一些实施例中,策略确定模块200具体用于:在碰撞类型为伸缩臂未伸出碰撞时,根据碰撞类型确定第一碰撞处理策略;或,根据碰撞类型确定第二碰撞处理策略;
其中,第一碰撞处理策略包括:控制货叉的运动速度为零;
第二碰撞处理策略包括:控制货叉的运动速度为零,以及控制用于驱动货叉旋转的第一驱动元件停止驱动货叉旋转,以使得货叉处于自由旋转状态。
在一些实施例中,策略确定模块200具体用于:在货叉装有货物时,根据碰撞类型确定第一碰撞处理策略;在货叉未装有货物时,根据碰撞类型确定第二碰撞处理策略。
在一些实施例中,策略确定模块200具体用于:在碰撞类型为伸缩臂伸出碰撞时,根据碰撞类型确定第三碰撞处理策略;或,根据碰撞类型确定第四碰撞处理策略;或,根据碰撞类型确定第五碰撞处理策略;或,根据碰撞类型确定第六碰撞处理策略;
其中,第三碰撞处理策略包括:控制伸缩臂的伸缩速度为零;
第四碰撞处理策略包括:控制伸缩臂的伸缩速度为零,以及控制用于驱动货叉旋转的第一驱动元件停止驱动货叉旋转,以使得货叉处于自由旋转状态;
第五碰撞处理策略包括:控制伸缩臂的伸缩速度为零,以及控制用于驱动伸缩臂伸缩的第二驱动元件停止驱动伸缩臂伸缩,以使得伸缩臂处于自由伸缩状态;
第六碰撞处理策略包括:控制伸缩臂的伸缩速度为零,控制用于驱动货叉旋转的第一驱动元件停止驱动货叉旋转,以使得货叉处于自由旋转状态,以及控制用于驱动伸缩臂伸缩的第二驱动元件停止驱动伸缩臂伸缩,以使得伸缩臂处于自由伸缩状态。
在一些实施例中,策略确定模块200具体用于:在货叉装有货物时,根据碰撞类型确定第三碰撞处理策略;在货叉未装有货物时,根据碰撞类型确定第四碰撞处理策略,或,确定第五碰撞处理策略,或,确定第六碰撞处理策略。
在一些实施例中,按照如下至少一种方式确定机器人的货叉发生碰撞:
驱动元件的工作电流的增大幅度达到第一预设阈值,且达到第一预设阈值的持续时间达到第一预设时长;或,
货叉的运动速度的减小幅度达到第二预设阈值;或,
驱动元件的工作电流的增大幅度达到第三预设阈值,且达到第三预设阈值的持续时间达到第二预设时长,以及,货叉的运动速度的减小幅度达到第四预设阈值;或,
设置于货叉的压力传感器检测到的压力的变化幅度达到第五预设阈值;
其中,驱动元件包括用于驱动货叉旋转的第一驱动元件、用于驱动伸缩臂伸缩的第二驱动元件以及用于驱动货叉升降的第三驱动元件中的至少一种。
在一些实施例中,货叉碰撞处理装置还包括:障碍物处理模块,用于在检测到机器人的货叉发生碰撞后,对碰撞的障碍物进行识别,并根据识别结果对障碍物进行处理。
在一些实施例中,障碍物处理模块具体用于:在障碍物为货物时,根据识别结果确定障碍物的货物类型;根据障碍物的货物类型,将障碍物搬运至对应的货物存放位置。
在一些实施例中,货叉碰撞处理装置还包括:碰撞避让模块,用于在检测到货叉即将发生碰撞时,执行货叉碰撞避让策略。
在一些实施例中,按照如下方式确定机器人的货叉即将发生碰撞:
基于货叉与障碍物之间的距离,以及货叉的当前运动状态,确定障碍物在货叉的运动路径上。
在一些实施例中,碰撞避让模块具体用于:根据障碍物的位置,调整货叉的位置,以使得货叉不与障碍物发生碰撞。
在一些实施例中,碰撞避让模块具体用于:在障碍物位于货叉的运动路径上时,对货叉的运动路径进行调整,以使得障碍物不在货叉的运动路径上;或者,在障碍物位于货叉的运动路径上时,控制货叉沿运动路径运动至预设位置,并输出障碍物提示信息,其中,预设位置为运动路径上距离障碍物预设距离的位置。
在一些实施例中,提供一种机器人,包括:货叉,以及上述的货叉碰撞处理装置。
在一些实施例中,提供一种计算机设备,图7为本申请实施例提供的计算机设备的示意图,如图7所示,该计算机设备包括:存储器71,处理器72及存储在存储器71上并可在处理器72上运行的计算机程序,处理器72执行程序时实现如上述的货叉碰撞处理方法。
其中,存储器和处理器之间直接或间接地电性连接,以实现数据的传输或交互。例如,这些元件相互之间可以通过一条或者多条通信总线或信号线实现电性连接,如可以通过总线连接。存储器中存储有实现数据访问控制方法的计算机执行指令,包括至少一个可以软件或固件的形式存储于存储器中的软件功能模块,处理器通过运行存储在存储器内的软件程序以及模块,从而执行各种功能应用以及数据处理。
存储器可以是,但不限于,随机存取存储器(Random Access Memory,RAM),只读存储器(Read Only Memory,ROM),可编程只读存储器(Programmable Read-Only Memory,PROM),可擦除只读存储器(Erasable Programmable Read-Only Memory,EPROM),电可擦除只读存储器(Electric Erasable Programmable Read-Only Memory,EEPROM)等。其中,存储器用于存储程序,处理器在接收到执行指令后,执行程序。进一步地,上述存储器内的软件程序以及模块还可包括操作系统,其可包括各种用于管理系统任务(例如内存管理、存储设备控制、电源管理等)的软件组件和/或驱动,并可与各种硬件或软件组件相互通信,从而提供其他软件组件的运行环境。
处理器可以是一种集成电路芯片,具有信号的处理能力。上述的处理器可以是通用处理器,包括中央处理器(Central Processing Unit,CPU)、网络处理器(NetworkProcessor,NP)等。可以实现或者执行本申请实施例中的公开的各方法、步骤及逻辑框图。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。
在一些实施例中,提供一种计算机可读存储介质,计算机可读存储介质中存储有计算机执行指令,计算机执行指令被处理器执行时用于实现如上述的货叉碰撞处理方法。
在一些实施例中,提供一种计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现如上述的货叉碰撞处理方法。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。
本领域技术人员在考虑说明书及实践这里公开的申请后,将容易想到本公开的其它实施方案。本申请旨在涵盖本公开的任何变型、用途或者适应性变化,这些变型、用途或者适应性变化遵循本公开的一般性原理并包括本公开未公开的本技术领域中的公知常识或惯用技术手段。说明书和实施例仅被视为示例性的,本公开的真正范围和精神由下面的权利要求书指出。
应当理解的是,本公开并不局限于上面已经描述并在附图中示出的精确结构,并且可以在不脱离其范围进行各种修改和改变。本公开的范围仅由所附的权利要求书来限制。
Claims (10)
1.一种货叉碰撞处理方法,其特征在于,包括:
当检测到机器人的货叉发生碰撞时,确定碰撞类型;
根据碰撞类型确定货叉碰撞处理策略;
根据所述货叉碰撞处理策略处理货叉碰撞。
2.根据权利要求1所述的方法,其特征在于,所述碰撞类型包括伸缩臂伸出碰撞和伸缩臂未伸出碰撞。
3.根据权利要求2所述的方法,其特征在于,所述碰撞类型为伸缩臂未伸出碰撞,所述根据碰撞类型确定货叉碰撞处理策略,包括:
根据所述碰撞类型确定第一碰撞处理策略;或,
根据所述碰撞类型确定第二碰撞处理策略;
其中,所述第一碰撞处理策略包括:控制货叉的运动速度为零;
所述第二碰撞处理策略包括:控制货叉的运动速度为零,以及控制用于驱动所述货叉旋转的第一驱动元件停止驱动所述货叉旋转,以使得所述货叉处于自由旋转状态。
4.根据权利要求3所述的方法,其特征在于,在所述货叉装有货物时,根据所述碰撞类型确定所述第一碰撞处理策略;
在所述货叉未装有货物时,根据所述碰撞类型确定所述第二碰撞处理策略。
5.根据权利要求2所述的方法,其特征在于,所述碰撞类型为伸缩臂伸出碰撞,所述根据碰撞类型确定货叉碰撞处理策略,包括:
根据所述碰撞类型确定第三碰撞处理策略;或,
根据所述碰撞类型确定第四碰撞处理策略;或,
根据所述碰撞类型确定第五碰撞处理策略;或,
根据所述碰撞类型确定第六碰撞处理策略;
其中,所述第三碰撞处理策略包括:控制伸缩臂的伸缩速度为零;
所述第四碰撞处理策略包括:控制伸缩臂的伸缩速度为零,以及控制用于驱动所述货叉旋转的第一驱动元件停止驱动所述货叉旋转,以使得所述货叉处于自由旋转状态;
所述第五碰撞处理策略包括:控制伸缩臂的伸缩速度为零,以及控制用于驱动所述伸缩臂伸缩的第二驱动元件停止驱动所述伸缩臂伸缩,以使得所述伸缩臂处于自由伸缩状态;
所述第六碰撞处理策略包括:控制伸缩臂的伸缩速度为零,控制用于驱动所述货叉旋转的第一驱动元件停止驱动所述货叉旋转,以使得所述货叉处于自由旋转状态,以及控制用于驱动所述伸缩臂伸缩的第二驱动元件停止驱动所述伸缩臂伸缩,以使得所述伸缩臂处于自由伸缩状态。
6.一种货叉碰撞处理装置,其特征在于,包括:
类型确定模块,用于当检测到机器人的货叉发生碰撞时,确定碰撞类型;
策略确定模块,用于根据碰撞类型确定货叉碰撞处理策略;
碰撞处理模块,用于根据所述货叉碰撞处理策略处理货叉碰撞。
7.一种机器人,其特征在于,包括:货叉,以及如权利要求6所述的货叉碰撞处理装置。
8.一种计算机设备,其特征在于,包括:存储器,处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述程序时实现如上述权利要求1-5任一项所述的货叉碰撞处理方法。
9.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质中存储有计算机执行指令,所述计算机执行指令被处理器执行时用于实现如权利要求1-5任一项所述的货叉碰撞处理方法。
10.一种计算机程序产品,包括计算机程序,其特征在于,该计算机程序被处理器执行时实现权利要求1-5任一项所述的货叉碰撞处理方法。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011637451.8A CN114690762A (zh) | 2020-12-31 | 2020-12-31 | 货叉碰撞处理方法、装置、机器人、设备、介质及产品 |
PCT/CN2021/137726 WO2022143140A1 (zh) | 2020-12-31 | 2021-12-14 | 货叉碰撞处理方法、装置、机器人、设备、介质及产品 |
EP21913881.5A EP4273658A4 (en) | 2020-12-31 | 2021-12-14 | METHOD AND DEVICE FOR PROCESSING PALLET FORK COLLISIONS AS WELL AS ROBOT, DEVICE, MEDIUM AND PRODUCT |
TW110147084A TWI820538B (zh) | 2020-12-31 | 2021-12-16 | 貨叉碰撞處理方法和裝置、機器人、計算機設備、計算機可讀儲存媒體及計算機程式產品 |
US18/343,992 US20230348249A1 (en) | 2020-12-31 | 2023-06-29 | Fork collision processing method and apparatus, robot, device, medium, and product |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011637451.8A CN114690762A (zh) | 2020-12-31 | 2020-12-31 | 货叉碰撞处理方法、装置、机器人、设备、介质及产品 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114690762A true CN114690762A (zh) | 2022-07-01 |
Family
ID=82133528
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011637451.8A Pending CN114690762A (zh) | 2020-12-31 | 2020-12-31 | 货叉碰撞处理方法、装置、机器人、设备、介质及产品 |
Country Status (5)
Country | Link |
---|---|
US (1) | US20230348249A1 (zh) |
EP (1) | EP4273658A4 (zh) |
CN (1) | CN114690762A (zh) |
TW (1) | TWI820538B (zh) |
WO (1) | WO2022143140A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116679696A (zh) * | 2022-11-28 | 2023-09-01 | 追觅创新科技(苏州)有限公司 | 避障方法、自移动机器人及其系统和计算机可读存储介质 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE4234375C2 (de) * | 1992-10-12 | 1995-10-12 | Noell Gmbh | Vorrichtung zur Personen- und Kollisionssicherung von fahrerlosen Gabelhubfahrzeugen |
US20140133944A1 (en) * | 2012-11-12 | 2014-05-15 | Lts Scale Company, Llc | Detection System Usable In Forklift Apparatus |
CN108237997B (zh) * | 2016-12-27 | 2020-08-07 | 比亚迪股份有限公司 | 自动导引搬运叉车及其保护系统和保护方法 |
CN108147325B (zh) * | 2018-02-06 | 2023-12-12 | 视航机器人(佛山)有限公司 | 叉车及其转角测量结构 |
TWI822729B (zh) * | 2018-02-06 | 2023-11-21 | 美商即時機器人股份有限公司 | 用於儲存一離散環境於一或多個處理器之一機器人之運動規劃及其改良操作之方法及設備 |
CN109160451A (zh) * | 2018-08-01 | 2019-01-08 | 顺丰科技有限公司 | 自主导航无人叉车、系统及控制方法 |
SE1850993A1 (en) * | 2018-08-20 | 2020-02-21 | Toyota Mat Handling Manufacturing Sweden Ab | Impact sensor device, a fork-lift truck comprsing such a device, and a method for arranging such a device to a fork-lift truck |
TWI683734B (zh) * | 2018-10-22 | 2020-02-01 | 新世代機器人暨人工智慧股份有限公司 | 機器人的防碰撞方法 |
CN209522152U (zh) * | 2019-01-16 | 2019-10-22 | 深圳市海柔创新科技有限公司 | 一种仓储机器人 |
CN209922808U (zh) * | 2019-05-23 | 2020-01-10 | 广州市技田信息技术有限公司 | 一种多传感器的agv叉车 |
CN110693396B (zh) * | 2019-10-21 | 2021-06-11 | 深圳市云鼠科技开发有限公司 | 一种基于free move技术的扫地机避障处理方式 |
CN211712539U (zh) * | 2019-12-05 | 2020-10-20 | 深圳易行机器人有限公司 | 一种新型agv叉车的货叉防撞装置 |
CN111645070B (zh) * | 2020-05-19 | 2022-06-14 | 华为技术有限公司 | 机器人的安全防护方法、装置与机器人 |
-
2020
- 2020-12-31 CN CN202011637451.8A patent/CN114690762A/zh active Pending
-
2021
- 2021-12-14 EP EP21913881.5A patent/EP4273658A4/en active Pending
- 2021-12-14 WO PCT/CN2021/137726 patent/WO2022143140A1/zh unknown
- 2021-12-16 TW TW110147084A patent/TWI820538B/zh active
-
2023
- 2023-06-29 US US18/343,992 patent/US20230348249A1/en active Pending
Also Published As
Publication number | Publication date |
---|---|
TWI820538B (zh) | 2023-11-01 |
EP4273658A4 (en) | 2024-04-17 |
WO2022143140A1 (zh) | 2022-07-07 |
EP4273658A1 (en) | 2023-11-08 |
TW202227346A (zh) | 2022-07-16 |
US20230348249A1 (en) | 2023-11-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2022105764A1 (zh) | 货物存放方法、装置、机器人、仓储系统和存储介质 | |
WO2020092447A1 (en) | A robotic system with automated package scan and registration mechanism and methods of operating the same | |
CN108046172A (zh) | 叉车机器人 | |
US20080044262A1 (en) | Article storage facility and operation method thereof | |
EP4005967A1 (en) | Apparatus and method for distribution article placement detection, robot, distribution device, and controller | |
US20180111757A1 (en) | Article Transport Facility | |
CN207699125U (zh) | 叉车机器人 | |
JP2022525441A (ja) | スマートフォークリフト及び容器位置姿勢ずれの検出方法 | |
CN211197464U (zh) | 一种搬运装置及具有此搬运装置的搬运机器人 | |
US20210061629A1 (en) | Automatic guided vehicle | |
US20230348249A1 (en) | Fork collision processing method and apparatus, robot, device, medium, and product | |
CN107352466B (zh) | 一种便于存取货的堆垛机以及自动化立体仓库 | |
CN112729104B (zh) | 传送机上的测量系统 | |
JP5880718B2 (ja) | 移載装置 | |
EP3656702A1 (en) | Mobile industrial robot with security system for pallet docketing | |
CN113561179B (zh) | 机器人控制方法、装置、机器人、存储介质及程序产品 | |
JP4941728B2 (ja) | 物品搬送装置 | |
CN114684516B (zh) | 货叉组件的控制方法、货叉组件及机器人 | |
JP7096429B2 (ja) | トランスポンダを備える空気入りタイヤを取り扱うためのフォークリフト | |
JP2009120273A (ja) | 移載装置 | |
JP5445399B2 (ja) | 移載装置および先入品判断方法 | |
JP2003073093A (ja) | 無人フォークリフト | |
KR20070110576A (ko) | 자동물류 반송장치 및 그 제어방법 | |
CN114701986B (zh) | 执行机构的控制方法和控制装置 | |
EP2955149B1 (en) | Method of operating a fork-lift truck, a fork-lift truck, a computer program product, and a method of modifying a fork-lift truck |
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 |