抓取点确定方法、装置、存储介质、控制器和程序产品与流程

摘要: 本发明涉及控制领域,尤其涉及一种抓取点确定方法、装置、存储介质、控制器和程序产品,属于机械手的程序控制。背景技术:1、工业机器人在各大生产领域应用广泛,是可以自...
抓取点确定方法、装置、存储介质、控制器和程序产品与流程

本发明涉及控制领域,尤其涉及一种抓取点确定方法、装置、存储介质、控制器和程序产品,属于机械手的程序控制。

背景技术:

1、工业机器人在各大生产领域应用广泛,是可以自动执行工作的机器装置,相关技术中对于流水线(传送带)上的物体,例如分拣、装配等工作场景,还在以人工操作为主流,若机器人可根据不同的场景完成分拣、装配工作,即可降低对人工劳动力的需求。因此,如何准确计算出机器人与传送带上运行物体的相遇抓取点成为关键点。

技术实现思路

1、本发明要解决的技术问题在于如何准确计算出机器人与传送带上运行物体的相遇抓取点,从而提供一种抓取点确定方法、装置、存储介质、控制器和程序产品,属于机械手的程序控制。

2、本发明一方面提供了一种抓取点确定方法,用于确定机器人抓取传送带上的目标物体的抓取点,包括:获取所述传送带的运行速度,并获取所述机器人的运行倍率;根据所述机器人的运行参数计算所述机器人从待机点运行至当前抓取点的运行时间;根据计算的所述机器人从待机点运行至当前抓取点的运行时间,判断是否满足抓取条件;若判断不满足抓取条件,则根据获取的所述传送带的运行速度、所述机器人的运行倍率和计算的所述运行时间计算叠加距离;根据计算的所述叠加距离更新当前抓取点,并计算所述机器人从待机点运行至更新的当前抓取点的运行时间,从而判断是否满足抓取条件;若判断不满足所述抓取条件,则根据获取的所述传送带的运行速度、所述机器人的运行倍率和更新当前抓取点后计算的所述机器人从待机点运行至更新的当前抓取点的运行时间,重新计算叠加距离,依此类推,直到满足所述抓取条件;若判断满足抓取条件,则将当前的抓取点确定为机器人抓取传送带上的目标物体的最终的抓取点。

3、可选地,根据确定的所述传送带的运行速度、获取的所述机器人的运行倍率和计算的所述运行时间,计算叠加距离d,包括:根据确定的所述传送带的运行速度、获取的所述机器人的运行倍率和计算的所述运行时间,按照如下公式计算叠加距离d:

4、d=a(v_c*t_r)/k;

5、其中,d为叠加距离,a为预设的抓取效率系数,v_c为传送带的运行速度,t_r为机器人运行至抓取迭代点位的时间,k为机器人的运行倍率。

6、可选地,所述抓取条件,包括:所述机器人从待机点运行至当前抓取点的运行时间与所述目标物体从当前位置运行至当前抓取点的运行时间相同。

7、可选地,还包括:若判断不满足所述抓取条件,则在根据获取的所述传送带的运行速度、所述机器人倍率和计算的所述运行时间计算叠加距离之前,根据当前计算叠加距离的次数,更新所述抓取效率系数;和/或,若判断不满足所述抓取条件,则在根据获取的所述传送带的运行速度、所述机器人倍率和计算的所述运行时间计算叠加距离之前,根据当前所述传送带的运行速度、所述机器人的机器人倍率以及预设的抓取区域大小,更新所述抓取效率系数。

8、可选地,根据当前计算叠加距离d的次数,更新所述抓取效率系数,包括:若当前计算叠加距离d的次数大于第一预设次数,则将所述抓取效率系数提高第一预设值;若当前计算叠加距离d的次数大于第二预设次数且小于等于第一预设次数,则将所述抓取效率系数提高第二预设值;若当前计算叠加距离d的次数小于等于第二预设次数,则保持当前的抓取效率系数;其中,所述第一预设次数大于所述第二预设次数;所述第一预设值大于所述第二预设值。

9、可选地,根据当前所述传送带的运行速度、所述机器人的机器人倍率以及预设的抓取区域大小,更新所述抓取效率系数,包括:获取预设的不同传送带的运行速度、机器人倍率以及抓取区域与抓取效率系数的对应关系;根据所述对应关系确定当前所述传送带的运行速度、所述机器人的机器人倍率以及预设的抓取区域大小对应的抓取效率系数。

10、本发明另一方面提供了一种抓取点确定装置,用于确定机器人抓取传送带上的目标物体的抓取点,包括:获取单元,用于获取所述传送带的运行速度,并获取所述机器人的运行倍率;第一计算单元,用于根据所述机器人的运行参数计算所述机器人从待机点运行至当前抓取点的运行时间;第一判断单元,用于根据所述第一计算单元计算的所述机器人从待机点运行至当前抓取点的运行时间,判断是否满足抓取条件;第二计算单元,用于若所述第一判断单元判断不满足抓取条件,则根据所述获取单元获取的所述传送带的运行速度、所述机器人的运行倍率和所述第一计算单元计算的所述运行时间计算叠加距离;第一更新单元,用于根据所述第二计算单元计算的所述叠加距离更新当前抓取点;所述第一计算单元,还用于:计算所述机器人从待机点运行至更新的当前抓取点的运行时间,从而所述第一判断单元判断是否满足抓取条件;所述第二计算单元,还用于:若判断不满足所述抓取条件,则根据所述获取单元获取的所述传送带的运行速度、所述机器人的运行倍率和所述第一更新单元更新当前抓取点后所述第一计算单元计算的所述机器人从待机点运行至更新的当前抓取点的运行时间,重新计算叠加距离,依此类推,直到所述第一判断单元判断满足所述抓取条件;确定单元,用于若所述第一判断单元判断满足抓取条件,则将当前的抓取点确定为机器人抓取传送带上的目标物体的最终的抓取点。

11、可选地,所述第二计算单元,根据所述获取单元获取的所述传送带的运行速度、所述机器人的运行倍率和所述第一计算单元计算的所述运行时间,计算叠加距离d,包括:根据获取的所述传送带的运行速度、所述机器人的运行倍率和计算的所述运行时间,按照如下公式计算叠加距离d:

12、d=a(v_c*t_r)/k;

13、其中,d为叠加距离,a为预设的抓取效率系数,v_c为传送带的运行速度,t_r为机器人运行至抓取迭代点位的时间,k为机器人的运行倍率。

14、可选地,所述抓取条件,包括:所述机器人从待机点运行至当前抓取点的运行时间与所述目标物体从当前位置运行至当前抓取点的运行时间相同。

15、可选地,还包括:第二更新单元,用于在所述第二计算单元根据所述获取单元获取的所述传送带的运行速度、所述机器人的运行倍率和所述第一计算单元计算的所述运行时间计算叠加距离之前,根据当前计算叠加距离d的次数,更新所述抓取效率系数;和/或,在所述第二计算单元根据所述获取单元获取的所述传送带的运行速度、所述机器人的运行倍率和所述第一计算单元计算的所述运行时间计算叠加距离之前,根据当前所述传送带的运行速度、所述机器人的机器人倍率以及预设的抓取区域大小,更新所述抓取效率系数。

16、可选地,所述第二更新单元,根据当前计算叠加距离d的次数,更新所述抓取效率系数,包括:若当前计算叠加距离d的次数大于第一预设次数,则将所述抓取效率系数提高第一预设值;若当前计算叠加距离d的次数大于第二预设次数且小于等于第一预设次数,则将所述抓取效率系数提高第二预设值;若当前计算叠加距离d的次数小于等于第二预设次数,则保持当前的抓取效率系数;其中,所述第一预设次数大于所述第二预设次数;所述第一预设值大于所述第二预设值。

17、可选地,所述第二更新单元,根据当前所述传送带的运行速度、所述机器人的机器人倍率以及预设的抓取区域大小,更新所述抓取效率系数,包括:获取预设的不同传送带的运行速度、机器人倍率以及抓取区域与抓取效率系数的对应关系;根据所述对应关系确定当前所述传送带的运行速度、所述机器人的机器人倍率以及预设的抓取区域大小对应的抓取效率系数。

18、本发明又一方面提供了一种存储介质,其上存储有计算机程序,所述程序被处理器执行时实现前述任一所述方法的步骤。

19、本发明再一方面提供了一种机器人控制器,包括处理器、存储器以及存储在存储器上可在处理器上运行的计算机程序,所述处理器执行所述程序时实现前述任一所述方法的步骤。

20、本发明再一方面提供了一种机器人控制器,包括前述任一所述的抓取点确定装置。

21、本发明再一方面提供了一种计算机程序产品,包括计算机程序,所述计算机程序被处理器执行时实现前述任一所述方法的步骤。

22、根据本发明的技术方案,根据机器人的抓取区域、传送带的运行速度、机器人倍率以及机器人的运动参数,实现高效、准确的抓取点确定。在已知机器人运动参数条件下,可以准确计算出机器人与目标物体相遇抓取点位置,属于机械手的程序控制。

23、根据本发明的技术方案,根据传送带运行速度、机器人倍率以及机器人运行参数,实时计算叠加距离,确定机器人对目标物体的抓取点,能够实现抓取预判点的精准定位。通过计算在设置的机器人抓取区域内,机器人从当前所处的抓取待机点到迭代计算出的抓取点(相遇点)的运行时间,与传送带上物体同时运行到相遇点的时间一致,从而完成高效、准确的抓取动作。

24、根据本发明的技术方案,引入抓取效率系数动态调节策略,该抓取效率系数与迭代次数正相关,随迭代次数增加自动提升系数值以增大步长,加速收敛。当对同一个目标物体完成抓取或所述机器人运行倍率变更,则重置所述抓取效率系数,兼顾了高速工况下的响应效率与低速下的定位精度。通过自适应调整搜索步长与安全校验的双重保障,显著提升了复杂工况下机器人的抓取成功率与整体作业效率。