一种用于建筑施工的SCARA智能化机械臂控制方法和系统转让专利

申请号 : CN202111173612.7

文献号 : CN113771014B

文献日 :

基本信息:

PDF:

法律信息:

相似专利:

发明人 : 刘伟杰

申请人 : 北京中海兴达建设有限公司

摘要 :

本发明提出了一种用于建筑施工的SCARA智能化机械臂控制方法和系统。所述方法包括输入机械臂需要执行的目标任务;根所述目标任务规划三组与所要执行任务对应的动作方案;对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;在符合要求的动作方案中,按照执行规则进行目标任务操作。所述系统包括与所述方案步骤对应的模块。

权利要求 :

1.一种用于建筑施工的SCARA智能化机械臂控制方法,其特征在于,所述方法包括:输入机械臂需要执行的目标任务;

根据所述目标任务规划三组与所要执行任务对应的动作方案;

对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;

在符合要求的动作方案中,按照执行规则进行目标任务操作;

所述执行规则包括:

如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个动作方案进行排序;按照所述多个动作方案的排序,执行第一个动作方案,当第一个动作方案所执行的任务量达到第一标准任务量时,切换下第二个动作方案进行任务执行,当第二个动作方案执行任务达到第二标准任务量时,控制机械臂休息

45min后,利用第一个动作方案执行任务直至完成剩余所有任务量;其中,所述第一标准任务量和第二标准任务量时如下:

C1=45%C总,C2=40%C总其中,C1表示第一标准任务量;C2表示第二标准任务量;C总表示总任务量;

如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个动作方案进行排序;按照所述多个动作方案的排序,执行第一个动作方案,当第一个动作方案所执行的任务量达到第三标准任务量时,切换下第二个动作方案进行任务执行,当第二个动作方案执行任务达到第四标准任务量时,控制机械臂休息

30min后,利用第三个动作方案执行任务直至完成剩余所有任务量;其中,所述第三标准任务量和第四标准任务量时如下:

C3=40%C总,C4=35%C总其中,C3表示第三标准任务量;C4表示第四标准任务量;

如果最终确定符合任务执行的运行要求的动作方案为一个时,执行动作方案,当所述动作方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当所述动作方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述动作方案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如下:C5=35%C总,C6=45%C总其中,C5表示第五标准任务量;C6表示第六标准任务量。

2.根据权利要求1所述方法,其特征在于,根据所述目标任务规划三组与所要执行任务对应的动作方案,包括:

提取所述机械臂需要执行的目标任务;

根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;

根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械臂执行动作;

将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;

将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。

3.根据权利要求1所述方法,其特征在于,对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求,包括:对每组与所要执行任务对应的动作方案进行10‑20次的试操作;

实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;

通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;

提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。

4.根据权利要求3所述方法,其特征在于,所述通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求,包括:利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;Hi表示第i次出现关节运行参数偏差量时对应的偏差量数值;Hmax表示关节运行参数偏差量最大值;m表示每组动作方案中所包含的阶段性分解动作的个数;T表示每组动作方案中,执行完成一个阶段性分解动作所用时间长度;T0表示预先设置的分解动作标准运行时间;

如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。

5.一种用于建筑施工的SCARA智能化机械臂控制系统,其特征在于,所述系统包括:输入模块,用于输入机械臂需要执行的目标任务;

规划模块,用于根据所述目标任务规划三组与所要执行任务对应的动作方案;

试操作模块,用于对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;

执行模块,用于在符合要求的动作方案中,按照执行规则进行目标任务操作;

所述执行规则包括:

如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个动作方案进行排序;按照所述多个动作方案的排序,执行第一个动作方案,当第一个动作方案所执行的任务量达到第一标准任务量时,切换下第二个动作方案进行任务执行,当第二个动作方案执行任务达到第二标准任务量时,控制机械臂休息

45min后,利用第一个动作方案执行任务直至完成剩余所有任务量;其中,所述第一标准任务量和第二标准任务量时如下:

C1=45%C总,C2=40%C总其中,C1表示第一标准任务量;C2表示第二标准任务量;C总表示总任务量;

如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个动作方案进行排序;按照所述多个动作方案的排序,执行第一个动作方案,当第一个动作方案所执行的任务量达到第三标准任务量时,切换下第二个动作方案进行任务执行,当第二个动作方案执行任务达到第四标准任务量时,控制机械臂休息

30min后,利用第三个动作方案执行任务直至完成剩余所有任务量;其中,所述第三标准任务量和第四标准任务量时如下:

C3=40%C总,C4=35%C总其中,C3表示第三标准任务量;C4表示第四标准任务量;

如果最终确定符合任务执行的运行要求的动作方案为一个时,执行动作方案,当所述动作方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当所述动作方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述动作方案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如下:C5=35%C总,C6=45%C总其中,C5表示第五标准任务量;C6表示第六标准任务量。

6.根据权利要求5所述系统,其特征在于,所述规划模块包括:提取模块,用于提取所述机械臂需要执行的目标任务;

路径规划模块,用于根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;

动作规划模块,用于根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械臂执行动作;

合并模块,用于将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;

匹配模块,用于将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。

7.根据权利要求5所述系统,其特征在于,所述试操作模块包括:操作模块,用于对每组与所要执行任务对应的动作方案进行10‑20次的试操作;

监控模块,用于实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;

指标获取模块,用于通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;

方案确定模块,用于提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。

8.根据权利要求7所述系统,其特征在于,所述指标获取模块包括:指标计算模块,用于利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:

其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;Hi表示第i次出现关节运行参数偏差量时对应的偏差量数值;Hmax表示关节运行参数偏差量最大值;m表示每组动作方案中所包含的阶段性分解动作的个数;T表示每组动作方案中,执行完成一个阶段性分解动作所用时间长度;T0表示预先设置的分解动作标准运行时间;

比较确定模块,用于如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。

说明书 :

一种用于建筑施工的SCARA智能化机械臂控制方法和系统

技术领域

[0001] 本发明提出了一种用于建筑施工的SCARA智能化机械臂控制方法和系统,属于机械臂控制技术领域。

背景技术

[0002] 机械臂是指高精度,多输入多输出、高度非线性、强耦合的复杂系统。因其独特的操作灵活性, 已在工业装配, 安全防爆等领域得到广泛应用。
[0003] 机械臂是一个复杂系统, 存在着参数摄动、外界干扰及未建模动态等不确定性。因而机械臂的建模模型也存在着不确定性,对于不同的任务, 需要规划机械臂关节空间的
运动轨迹,从而级联构成末端位姿。
[0004] 现有的SCARA机械臂在建筑工地中应用时,由于建筑工地环境比较恶劣,且负重较重,在机械臂控制中,由于只采用一种单一动作完成任务常导致机械臂单一动作重复出现
关节特定位置磨损严重的问题发生。

发明内容

[0005] 本发明提供了一种用于建筑施工的SCARA智能化机械臂控制方法,用以解决现有机械臂控制存在单一方案执行导致任务执行灵活度较低,以及单一动作执行导致机械臂磨
损严重的问题:
[0006] 本发明提出的一种用于建筑施工的SCARA智能化机械臂控制方法,所述方法包括:
[0007] 输入机械臂需要执行的目标任务;
[0008] 根据所述目标任务规划三组与所要执行任务对应的动作方案;
[0009] 对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
[0010] 在符合要求的动作方案中,按照执行规则进行目标任务操作。
[0011] 进一步地,根据所述目标任务规划三组与所要执行任务对应的动作方案,包括:
[0012] 提取所述机械臂需要执行的目标任务;
[0013] 根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
[0014] 根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械臂执行
动作;
[0015] 将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
[0016] 将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
[0017] 进一步地,对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求,包括:
[0018] 对每组与所要执行任务对应的动作方案进行10‑20次的试操作;
[0019] 实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
[0020] 通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
[0021] 提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
[0022] 进一步地,所述通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求,包括:
[0023] 利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
[0024]
[0025] 其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;Hi表示第i次出现关节运行参数偏差量时对应的偏差量数值;Hmax表示关节运行参数偏差量最
大值;m表示每组运动方案中所包含的阶段性分解动作的个数;T表示每组运动方案中,执行
完成一个阶段性分解动作所用时间长度;T0表示预先设置的分解动作标准运行时间;
[0026] 如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
[0027] 进一步地,所述执行规则包括:
[0028] 如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第
一个运行方案,当第一个运行方案所执行的任务量达到第一标准任务量时,切换下第二个
运动方案进行任务执行,当第二个运动方案执行任务达到第二标准任务量时,控制机械臂
休息45min后,利用第一个运行方案执行任务直至完成剩余所有任务量;其中,所述第一标
准任务量和第二标准任务量时如下:
[0029] C1=45%C总,C2=40%C总
[0030] 其中,C1表示第一标准任务量;C2表示第二标准任务量;C总表示总任务量;
[0031] 如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第
一个运行方案,当第一个运行方案所执行的任务量达到第三标准任务量时,切换下第二个
运动方案进行任务执行,当第二个运动方案执行任务达到第四标准任务量时,控制机械臂
休息30min后,利用第三个运行方案执行任务直至完成剩余所有任务量;其中,所述第三标
准任务量和第四标准任务量时如下:
[0032] C3=40%C总,C4=35%C总
[0033] 其中,C3表示第三标准任务量;C4表示第四标准任务量;
[0034] 如果最终确定符合任务执行的运行要求的动作方案为一个时,执行运行方案,当所述运动方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当
所述运动方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述运行方
案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如
下:
[0035] C5=35%C总,C6=45%C总
[0036] 其中,C5表示第五标准任务量;C6表示第六标准任务量。
[0037] 一种用于建筑施工的SCARA智能化机械臂控制系统,所述系统包括:
[0038] 输入模块,用于输入机械臂需要执行的目标任务;
[0039] 规划模块,用于根据所述目标任务规划三组与所要执行任务对应的动作方案;
[0040] 试操作模块,用于对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
[0041] 执行模块,用于在符合要求的动作方案中,按照执行规则进行目标任务操作。
[0042] 进一步地,所述规划模块包括:
[0043] 提取模块,用于提取所述机械臂需要执行的目标任务;
[0044] 路径规划模块,用于根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
[0045] 动作规划模块,用于根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作
阶段对应的机械臂执行动作;
[0046] 合并模块,用于将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
[0047] 匹配模块,用于将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
[0048] 进一步地,所述试操作模块包括:
[0049] 操作模块,用于对每组与所要执行任务对应的动作方案进行10‑20次的试操作;
[0050] 监控模块,用于实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
[0051] 指标获取模块,用于通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
[0052] 方案确定模块,用于提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
[0053] 进一步地,所述指标获取模块包括:
[0054] 指标计算模块,用于利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
[0055]
[0056] 其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;Hi表示第i次出现关节运行参数偏差量时对应的偏差量数值;Hmax表示关节运行参数偏差量最
大值;m表示每组运动方案中所包含的阶段性分解动作的个数;T表示每组运动方案中,执行
完成一个阶段性分解动作所用时间长度;T0表示预先设置的分解动作标准运行时间;
[0057] 比较确定模块,用于如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
[0058] 进一步地,所述执行规则包括:
[0059] 如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第
一个运行方案,当第一个运行方案所执行的任务量达到第一标准任务量时,切换下第二个
运动方案进行任务执行,当第二个运动方案执行任务达到第二标准任务量时,控制机械臂
休息45min后,利用第一个运行方案执行任务直至完成剩余所有任务量;其中,所述第一标
准任务量和第二标准任务量时如下:
[0060] C1=45%C总,C2=40%C总
[0061] 其中,C1表示第一标准任务量;C2表示第二标准任务量;C总表示总任务量;
[0062] 如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第
一个运行方案,当第一个运行方案所执行的任务量达到第三标准任务量时,切换下第二个
运动方案进行任务执行,当第二个运动方案执行任务达到第四标准任务量时,控制机械臂
休息30min后,利用第三个运行方案执行任务直至完成剩余所有任务量;其中,所述第三标
准任务量和第四标准任务量时如下:
[0063] C3=40%C总,C4=35%C总
[0064] 其中,C3表示第三标准任务量;C4表示第四标准任务量;
[0065] 如果最终确定符合任务执行的运行要求的动作方案为一个时,执行运行方案,当所述运动方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当
所述运动方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述运行方
案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如
下:
[0066] C5=35%C总,C6=45%C总
[0067] 其中,C5表示第五标准任务量;C6表示第六标准任务量。
[0068] 本发明有益效果:
[0069] 本发明提出的一种用于建筑施工的SCARA智能化机械臂控制方法和系统,通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同
时,能够保证机械臂通过执行不同动作在一项任务完成中不会对关节某一特定位置产生高
度磨损,有效降低机械臂关节的磨损率,提高机械臂的使用寿命。另一方面,通过指标筛选
能够严格且有效提高动作方案的筛选力度,使获取的动作方案能够符合目标任务要求,在
多个动作方案切换执行过程中,能够有效提高目标任务的执行效率,缩短任务执行时间,进
而减少对机械臂的磨损率。

附图说明

[0070] 图1为本发明所述方法的流程图;
[0071] 图2为本发明所述系统的系统框图。

具体实施方式

[0072] 以下结合附图对本发明的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本发明,并不用于限定本发明。
[0073] 本发明提出的一种用于建筑施工的SCARA智能化机械臂控制方法,如图1所示,所述方法包括:
[0074] S1、输入机械臂需要执行的目标任务;
[0075] S2、根据所述目标任务规划三组与所要执行任务对应的动作方案;
[0076] S3、对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
[0077] S4、在符合要求的动作方案中,按照执行规则进行目标任务操作。
[0078] 上述技术方案的效果为:通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同时,能够保证机械臂通过执行不同动作在一项任务
完成中不会对关节某一特定位置产生高度磨损,有效降低机械臂关节的磨损率,提高机械
臂的使用寿命。另一方面,通过指标筛选能够严格且有效提高动作方案的筛选力度,使获取
的动作方案能够符合目标任务要求,在多个动作方案切换执行过程中,能够有效提高目标
任务的执行效率,缩短任务执行时间,进而减少对机械臂的磨损率。
[0079] 本发明的一个实施例,根据所述目标任务规划三组与所要执行任务对应的动作方案,包括:
[0080] S201、提取所述机械臂需要执行的目标任务;
[0081] S202、根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
[0082] S203、根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械
臂执行动作;
[0083] S204、将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
[0084] S205、将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
[0085] 上述技术方案的效果为:通过上述方案能够有效提高动作方案的获取效率,并且,有效提高获得的动作方案与目标任务之间的匹配度。进而提高后续的目标任务执行效率。
[0086] 本发明的一个实施例对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求,包括:
[0087] S301、对每组与所要执行任务对应的动作方案进行10‑20次的试操作;
[0088] S302、实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
[0089] S303、通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
[0090] S304、提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
[0091] 其中,所述通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求,包括:
[0092] S3031、利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
[0093]
[0094] 其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;Hi表示第i次出现关节运行参数偏差量时对应的偏差量数值;Hmax表示关节运行参数偏差量最
大值;m表示每组运动方案中所包含的阶段性分解动作的个数;T表示每组运动方案中,执行
完成一个阶段性分解动作所用时间长度;T0表示预先设置的分解动作标准运行时间;
[0095] S3032、如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
[0096] 上述技术方案的效果为:通过上述方案能够有效提高对获取的机械臂动作方案的筛选准确性,保证后续每个被执行的动作方案均能够提高目标任务的完成效率,防止不符
合目标任务完成规划的动作方案在执行过程中降低目标任务完成效率和完成质量。同时,
通过上述公式获取的指标能够有效反应当前动作方案的性能,提高每个动作方案执行的评
价准确性,进而提高动作方案筛选的准确性。另一方面,通过上述运行方案的指标公式能够
减少动作方案筛选的复杂程度,避免大量复杂运算和监控带来的资源耗费。
[0097] 本发明的一个实施例,所述执行规则包括:
[0098] 如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第
一个运行方案,当第一个运行方案所执行的任务量达到第一标准任务量时,切换下第二个
运动方案进行任务执行,当第二个运动方案执行任务达到第二标准任务量时,控制机械臂
休息45min后,利用第一个运行方案执行任务直至完成剩余所有任务量;其中,所述第一标
准任务量和第二标准任务量时如下:
[0099] C1=45%C总,C2=40%C总
[0100] 其中,C1表示第一标准任务量;C2表示第二标准任务量;C总表示总任务量;
[0101] 如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第
一个运行方案,当第一个运行方案所执行的任务量达到第三标准任务量时,切换下第二个
运动方案进行任务执行,当第二个运动方案执行任务达到第四标准任务量时,控制机械臂
休息30min后,利用第三个运行方案执行任务直至完成剩余所有任务量;其中,所述第三标
准任务量和第四标准任务量时如下:
[0102] C3=40%C总,C4=35%C总
[0103] 其中,C3表示第三标准任务量;C4表示第四标准任务量;
[0104] 如果最终确定符合任务执行的运行要求的动作方案为一个时,执行运行方案,当所述运动方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当
所述运动方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述运行方
案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如
下:
[0105] C5=35%C总,C6=45%C总
[0106] 其中,C5表示第五标准任务量;C6表示第六标准任务量。
[0107] 上述技术方案的效果为:通过上述执行规则的指定,通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同时,能够保证机械臂通
过执行不同动作在一项任务完成中不会对关节某一特定位置产生高度磨损,有效降低机械
臂关节的磨损率,提高机械臂的使用寿命。
[0108] 本发明实施例提出了一种用于建筑施工的SCARA智能化机械臂控制系统,如图2所示,所述系统包括:
[0109] 输入模块,用于输入机械臂需要执行的目标任务;
[0110] 规划模块,用于根据所述目标任务规划三组与所要执行任务对应的动作方案;
[0111] 试操作模块,用于对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
[0112] 执行模块,用于在符合要求的动作方案中,按照执行规则进行目标任务操作。
[0113] 上述技术方案的效果为:通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同时,能够保证机械臂通过执行不同动作在一项任务
完成中不会对关节某一特定位置产生高度磨损,有效降低机械臂关节的磨损率,提高机械
臂的使用寿命。另一方面,通过指标筛选能够严格且有效提高动作方案的筛选力度,使获取
的动作方案能够符合目标任务要求,在多个动作方案切换执行过程中,能够有效提高目标
任务的执行效率,缩短任务执行时间,进而减少对机械臂的磨损率。
[0114] 本发明的一个实施例,所述规划模块包括:
[0115] 提取模块,用于提取所述机械臂需要执行的目标任务;
[0116] 路径规划模块,用于根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
[0117] 动作规划模块,用于根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作
阶段对应的机械臂执行动作;
[0118] 合并模块,用于将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
[0119] 匹配模块,用于将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
[0120] 上述技术方案的效果为:通过上述方案能够有效提高动作方案的获取效率,并且,有效提高获得的动作方案与目标任务之间的匹配度。进而提高后续的目标任务执行效率。
[0121] 本发明的一个实施例,所述试操作模块包括:
[0122] 操作模块,用于对每组与所要执行任务对应的动作方案进行10‑20次的试操作;
[0123] 监控模块,用于实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
[0124] 指标获取模块,用于通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
[0125] 方案确定模块,用于提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
[0126] 其中,所述指标获取模块包括:
[0127] 指标计算模块,用于利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
[0128]
[0129] 其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;Hi表示第i次出现关节运行参数偏差量时对应的偏差量数值;Hmax表示关节运行参数偏差量最
大值;m表示每组运动方案中所包含的阶段性分解动作的个数;T表示每组运动方案中,执行
完成一个阶段性分解动作所用时间长度;T0表示预先设置的分解动作标准运行时间;
[0130] 比较确定模块,用于如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
[0131] 上述技术方案的效果为:通过上述方案能够有效提高对获取的机械臂动作方案的筛选准确性,保证后续每个被执行的动作方案均能够提高目标任务的完成效率,防止不符
合目标任务完成规划的动作方案在执行过程中降低目标任务完成效率和完成质量。同时,
通过上述公式获取的指标能够有效反应当前动作方案的性能,提高每个动作方案执行的评
价准确性,进而提高动作方案筛选的准确性。另一方面,通过上述运行方案的指标公式能够
减少动作方案筛选的复杂程度,避免大量复杂运算和监控带来的资源耗费。
[0132] 本发明的一个实施例,所述执行规则包括:
[0133] 如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第
一个运行方案,当第一个运行方案所执行的任务量达到第一标准任务量时,切换下第二个
运动方案进行任务执行,当第二个运动方案执行任务达到第二标准任务量时,控制机械臂
休息45min后,利用第一个运行方案执行任务直至完成剩余所有任务量;其中,所述第一标
准任务量和第二标准任务量时如下:
[0134] C1=45%C总,C2=40%C总
[0135] 其中,C1表示第一标准任务量;C2表示第二标准任务量;C总表示总任务量;
[0136] 如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第
一个运行方案,当第一个运行方案所执行的任务量达到第三标准任务量时,切换下第二个
运动方案进行任务执行,当第二个运动方案执行任务达到第四标准任务量时,控制机械臂
休息30min后,利用第三个运行方案执行任务直至完成剩余所有任务量;其中,所述第三标
准任务量和第四标准任务量时如下:
[0137] C3=40%C总,C4=35%C总
[0138] 其中,C3表示第三标准任务量;C4表示第四标准任务量;
[0139] 如果最终确定符合任务执行的运行要求的动作方案为一个时,执行运行方案,当所述运动方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当
所述运动方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述运行方
案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如
下:
[0140] C5=35%C总,C6=45%C总
[0141] 其中,C5表示第五标准任务量;C6表示第六标准任务量。
[0142] 上述技术方案的效果为:通过上述执行规则的指定,通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同时,能够保证机械臂通
过执行不同动作在一项任务完成中不会对关节某一特定位置产生高度磨损,有效降低机械
臂关节的磨损率,提高机械臂的使用寿命。
[0143] 显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围
之内,则本发明也意图包含这些改动和变型在内。