CN113771014B - 一种用于建筑施工的scara智能化机械臂控制方法和系统 - Google Patents

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

Info

Publication number
CN113771014B
CN113771014B CN202111173612.7A CN202111173612A CN113771014B CN 113771014 B CN113771014 B CN 113771014B CN 202111173612 A CN202111173612 A CN 202111173612A CN 113771014 B CN113771014 B CN 113771014B
Authority
CN
China
Prior art keywords
action
task
mechanical arm
execution
schemes
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.)
Active
Application number
CN202111173612.7A
Other languages
English (en)
Other versions
CN113771014A (zh
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.)
Beijing Zhonghai Xingda Construction Co ltd
Original Assignee
Beijing Zhonghai Xingda Construction 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 Beijing Zhonghai Xingda Construction Co ltd filed Critical Beijing Zhonghai Xingda Construction Co ltd
Priority to CN202111173612.7A priority Critical patent/CN113771014B/zh
Publication of CN113771014A publication Critical patent/CN113771014A/zh
Application granted granted Critical
Publication of CN113771014B publication Critical patent/CN113771014B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/02Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • B25J9/041Cylindrical coordinate type
    • B25J9/042Cylindrical coordinate type comprising an articulated arm
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

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

Description

一种用于建筑施工的SCARA智能化机械臂控制方法和系统
技术领域
本发明提出了一种用于建筑施工的SCARA智能化机械臂控制方法和系统,属于机械臂控制技术领域。
背景技术
机械臂是指高精度,多输入多输出、高度非线性、强耦合的复杂系统。因其独特的操作灵活性, 已在工业装配, 安全防爆等领域得到广泛应用。
机械臂是一个复杂系统, 存在着参数摄动、外界干扰及未建模动态等不确定性。因而机械臂的建模模型也存在着不确定性,对于不同的任务, 需要规划机械臂关节空间的运动轨迹,从而级联构成末端位姿。
现有的SCARA机械臂在建筑工地中应用时,由于建筑工地环境比较恶劣,且负重较重,在机械臂控制中,由于只采用一种单一动作完成任务常导致机械臂单一动作重复出现关节特定位置磨损严重的问题发生。
发明内容
本发明提供了一种用于建筑施工的SCARA智能化机械臂控制方法,用以解决现有机械臂控制存在单一方案执行导致任务执行灵活度较低,以及单一动作执行导致机械臂磨损严重的问题:
本发明提出的一种用于建筑施工的SCARA智能化机械臂控制方法,所述方法包括:
输入机械臂需要执行的目标任务;
根据所述目标任务规划三组与所要执行任务对应的动作方案;
对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
在符合要求的动作方案中,按照执行规则进行目标任务操作。
进一步地,根据所述目标任务规划三组与所要执行任务对应的动作方案,包括:
提取所述机械臂需要执行的目标任务;
根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械臂执行动作;
将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
进一步地,对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求,包括:
对每组与所要执行任务对应的动作方案进行10-20次的试操作;
实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
进一步地,所述通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求,包括:
利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
Figure 883931DEST_PATH_IMAGE001
其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;H i 表示第i次出现关节运行参数偏差量时对应的偏差量数值;H max 表示关节运行参数偏差量最大值;m表示每组运动方案中所包含的阶段性分解动作的个数;T表示每组运动方案中,执行完成一个阶段性分解动作所用时间长度;T 0表示预先设置的分解动作标准运行时间;
如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
进一步地,所述执行规则包括:
如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第一个运行方案,当第一个运行方案所执行的任务量达到第一标准任务量时,切换下第二个运动方案进行任务执行,当第二个运动方案执行任务达到第二标准任务量时,控制机械臂休息45min后,利用第一个运行方案执行任务直至完成剩余所有任务量;其中,所述第一标准任务量和第二标准任务量时如下:
C 1=45%C C 2=40%C
其中,C 1表示第一标准任务量;C 2表示第二标准任务量;C 表示总任务量;
如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第一个运行方案,当第一个运行方案所执行的任务量达到第三标准任务量时,切换下第二个运动方案进行任务执行,当第二个运动方案执行任务达到第四标准任务量时,控制机械臂休息30min后,利用第三个运行方案执行任务直至完成剩余所有任务量;其中,所述第三标准任务量和第四标准任务量时如下:
C 3=40%C C 4=35%C
其中,C 3表示第三标准任务量;C 4表示第四标准任务量;
如果最终确定符合任务执行的运行要求的动作方案为一个时,执行运行方案,当所述运动方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当所述运动方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述运行方案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如下:
C 5=35%C C 6=45%C
其中,C 5表示第五标准任务量;C 6表示第六标准任务量。
一种用于建筑施工的SCARA智能化机械臂控制系统,所述系统包括:
输入模块,用于输入机械臂需要执行的目标任务;
规划模块,用于根据所述目标任务规划三组与所要执行任务对应的动作方案;
试操作模块,用于对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
执行模块,用于在符合要求的动作方案中,按照执行规则进行目标任务操作。
进一步地,所述规划模块包括:
提取模块,用于提取所述机械臂需要执行的目标任务;
路径规划模块,用于根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
动作规划模块,用于根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械臂执行动作;
合并模块,用于将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
匹配模块,用于将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
进一步地,所述试操作模块包括:
操作模块,用于对每组与所要执行任务对应的动作方案进行10-20次的试操作;
监控模块,用于实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
指标获取模块,用于通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
方案确定模块,用于提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
进一步地,所述指标获取模块包括:
指标计算模块,用于利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
Figure 747982DEST_PATH_IMAGE001
其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;H i 表示第i次出现关节运行参数偏差量时对应的偏差量数值;H max 表示关节运行参数偏差量最大值;m表示每组运动方案中所包含的阶段性分解动作的个数;T表示每组运动方案中,执行完成一个阶段性分解动作所用时间长度;T 0表示预先设置的分解动作标准运行时间;
比较确定模块,用于如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
进一步地,所述执行规则包括:
如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第一个运行方案,当第一个运行方案所执行的任务量达到第一标准任务量时,切换下第二个运动方案进行任务执行,当第二个运动方案执行任务达到第二标准任务量时,控制机械臂休息45min后,利用第一个运行方案执行任务直至完成剩余所有任务量;其中,所述第一标准任务量和第二标准任务量时如下:
C 1=45%C C 2=40%C
其中,C 1表示第一标准任务量;C 2表示第二标准任务量;C 表示总任务量;
如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第一个运行方案,当第一个运行方案所执行的任务量达到第三标准任务量时,切换下第二个运动方案进行任务执行,当第二个运动方案执行任务达到第四标准任务量时,控制机械臂休息30min后,利用第三个运行方案执行任务直至完成剩余所有任务量;其中,所述第三标准任务量和第四标准任务量时如下:
C 3=40%C C 4=35%C
其中,C 3表示第三标准任务量;C 4表示第四标准任务量;
如果最终确定符合任务执行的运行要求的动作方案为一个时,执行运行方案,当所述运动方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当所述运动方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述运行方案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如下:
C 5=35%C C 6=45%C
其中,C 5表示第五标准任务量;C 6表示第六标准任务量。
本发明有益效果:
本发明提出的一种用于建筑施工的SCARA智能化机械臂控制方法和系统,通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同时,能够保证机械臂通过执行不同动作在一项任务完成中不会对关节某一特定位置产生高度磨损,有效降低机械臂关节的磨损率,提高机械臂的使用寿命。另一方面,通过指标筛选能够严格且有效提高动作方案的筛选力度,使获取的动作方案能够符合目标任务要求,在多个动作方案切换执行过程中,能够有效提高目标任务的执行效率,缩短任务执行时间,进而减少对机械臂的磨损率。
附图说明
图1为本发明所述方法的流程图;
图2为本发明所述系统的系统框图。
具体实施方式
以下结合附图对本发明的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本发明,并不用于限定本发明。
本发明提出的一种用于建筑施工的SCARA智能化机械臂控制方法,如图1所示,所述方法包括:
S1、输入机械臂需要执行的目标任务;
S2、根据所述目标任务规划三组与所要执行任务对应的动作方案;
S3、对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
S4、在符合要求的动作方案中,按照执行规则进行目标任务操作。
上述技术方案的效果为:通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同时,能够保证机械臂通过执行不同动作在一项任务完成中不会对关节某一特定位置产生高度磨损,有效降低机械臂关节的磨损率,提高机械臂的使用寿命。另一方面,通过指标筛选能够严格且有效提高动作方案的筛选力度,使获取的动作方案能够符合目标任务要求,在多个动作方案切换执行过程中,能够有效提高目标任务的执行效率,缩短任务执行时间,进而减少对机械臂的磨损率。
本发明的一个实施例,根据所述目标任务规划三组与所要执行任务对应的动作方案,包括:
S201、提取所述机械臂需要执行的目标任务;
S202、根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
S203、根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械臂执行动作;
S204、将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
S205、将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
上述技术方案的效果为:通过上述方案能够有效提高动作方案的获取效率,并且,有效提高获得的动作方案与目标任务之间的匹配度。进而提高后续的目标任务执行效率。
本发明的一个实施例对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求,包括:
S301、对每组与所要执行任务对应的动作方案进行10-20次的试操作;
S302、实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
S303、通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
S304、提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
其中,所述通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求,包括:
S3031、利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
Figure 31196DEST_PATH_IMAGE002
其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;H i 表示第i次出现关节运行参数偏差量时对应的偏差量数值;H max 表示关节运行参数偏差量最大值;m表示每组运动方案中所包含的阶段性分解动作的个数;T表示每组运动方案中,执行完成一个阶段性分解动作所用时间长度;T 0表示预先设置的分解动作标准运行时间;
S3032、如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
上述技术方案的效果为:通过上述方案能够有效提高对获取的机械臂动作方案的筛选准确性,保证后续每个被执行的动作方案均能够提高目标任务的完成效率,防止不符合目标任务完成规划的动作方案在执行过程中降低目标任务完成效率和完成质量。同时,通过上述公式获取的指标能够有效反应当前动作方案的性能,提高每个动作方案执行的评价准确性,进而提高动作方案筛选的准确性。另一方面,通过上述运行方案的指标公式能够减少动作方案筛选的复杂程度,避免大量复杂运算和监控带来的资源耗费。
本发明的一个实施例,所述执行规则包括:
如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第一个运行方案,当第一个运行方案所执行的任务量达到第一标准任务量时,切换下第二个运动方案进行任务执行,当第二个运动方案执行任务达到第二标准任务量时,控制机械臂休息45min后,利用第一个运行方案执行任务直至完成剩余所有任务量;其中,所述第一标准任务量和第二标准任务量时如下:
C 1=45%C C 2=40%C
其中,C 1表示第一标准任务量;C 2表示第二标准任务量;C 表示总任务量;
如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第一个运行方案,当第一个运行方案所执行的任务量达到第三标准任务量时,切换下第二个运动方案进行任务执行,当第二个运动方案执行任务达到第四标准任务量时,控制机械臂休息30min后,利用第三个运行方案执行任务直至完成剩余所有任务量;其中,所述第三标准任务量和第四标准任务量时如下:
C 3=40%C C 4=35%C
其中,C 3表示第三标准任务量;C 4表示第四标准任务量;
如果最终确定符合任务执行的运行要求的动作方案为一个时,执行运行方案,当所述运动方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当所述运动方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述运行方案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如下:
C 5=35%C C 6=45%C
其中,C 5表示第五标准任务量;C 6表示第六标准任务量。
上述技术方案的效果为:通过上述执行规则的指定,通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同时,能够保证机械臂通过执行不同动作在一项任务完成中不会对关节某一特定位置产生高度磨损,有效降低机械臂关节的磨损率,提高机械臂的使用寿命。
本发明实施例提出了一种用于建筑施工的SCARA智能化机械臂控制系统,如图2所示,所述系统包括:
输入模块,用于输入机械臂需要执行的目标任务;
规划模块,用于根据所述目标任务规划三组与所要执行任务对应的动作方案;
试操作模块,用于对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
执行模块,用于在符合要求的动作方案中,按照执行规则进行目标任务操作。
上述技术方案的效果为:通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同时,能够保证机械臂通过执行不同动作在一项任务完成中不会对关节某一特定位置产生高度磨损,有效降低机械臂关节的磨损率,提高机械臂的使用寿命。另一方面,通过指标筛选能够严格且有效提高动作方案的筛选力度,使获取的动作方案能够符合目标任务要求,在多个动作方案切换执行过程中,能够有效提高目标任务的执行效率,缩短任务执行时间,进而减少对机械臂的磨损率。
本发明的一个实施例,所述规划模块包括:
提取模块,用于提取所述机械臂需要执行的目标任务;
路径规划模块,用于根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
动作规划模块,用于根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械臂执行动作;
合并模块,用于将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
匹配模块,用于将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
上述技术方案的效果为:通过上述方案能够有效提高动作方案的获取效率,并且,有效提高获得的动作方案与目标任务之间的匹配度。进而提高后续的目标任务执行效率。
本发明的一个实施例,所述试操作模块包括:
操作模块,用于对每组与所要执行任务对应的动作方案进行10-20次的试操作;
监控模块,用于实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
指标获取模块,用于通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
方案确定模块,用于提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
其中,所述指标获取模块包括:
指标计算模块,用于利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
Figure 821035DEST_PATH_IMAGE003
其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;H i 表示第i次出现关节运行参数偏差量时对应的偏差量数值;H max 表示关节运行参数偏差量最大值;m表示每组运动方案中所包含的阶段性分解动作的个数;T表示每组运动方案中,执行完成一个阶段性分解动作所用时间长度;T 0表示预先设置的分解动作标准运行时间;
比较确定模块,用于如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
上述技术方案的效果为:通过上述方案能够有效提高对获取的机械臂动作方案的筛选准确性,保证后续每个被执行的动作方案均能够提高目标任务的完成效率,防止不符合目标任务完成规划的动作方案在执行过程中降低目标任务完成效率和完成质量。同时,通过上述公式获取的指标能够有效反应当前动作方案的性能,提高每个动作方案执行的评价准确性,进而提高动作方案筛选的准确性。另一方面,通过上述运行方案的指标公式能够减少动作方案筛选的复杂程度,避免大量复杂运算和监控带来的资源耗费。
本发明的一个实施例,所述执行规则包括:
如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第一个运行方案,当第一个运行方案所执行的任务量达到第一标准任务量时,切换下第二个运动方案进行任务执行,当第二个运动方案执行任务达到第二标准任务量时,控制机械臂休息45min后,利用第一个运行方案执行任务直至完成剩余所有任务量;其中,所述第一标准任务量和第二标准任务量时如下:
C 1=45%C C 2=40%C
其中,C 1表示第一标准任务量;C 2表示第二标准任务量;C 表示总任务量;
如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个运动方案进行排序;按照所述多个运行方案的排序,执行第一个运行方案,当第一个运行方案所执行的任务量达到第三标准任务量时,切换下第二个运动方案进行任务执行,当第二个运动方案执行任务达到第四标准任务量时,控制机械臂休息30min后,利用第三个运行方案执行任务直至完成剩余所有任务量;其中,所述第三标准任务量和第四标准任务量时如下:
C 3=40%C C 4=35%C
其中,C 3表示第三标准任务量;C 4表示第四标准任务量;
如果最终确定符合任务执行的运行要求的动作方案为一个时,执行运行方案,当所述运动方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当所述运动方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述运行方案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如下:
C 5=35%C C 6=45%C
其中,C 5表示第五标准任务量;C 6表示第六标准任务量。
上述技术方案的效果为:通过上述执行规则的指定,通过多个动作方案执行完成同一任务能够有效提高机械臂完成一项任务的实施方案灵活性,同时,能够保证机械臂通过执行不同动作在一项任务完成中不会对关节某一特定位置产生高度磨损,有效降低机械臂关节的磨损率,提高机械臂的使用寿命。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。

Claims (8)

1.一种用于建筑施工的SCARA智能化机械臂控制方法,其特征在于,所述方法包括:
输入机械臂需要执行的目标任务;
根据所述目标任务规划三组与所要执行任务对应的动作方案;
对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
在符合要求的动作方案中,按照执行规则进行目标任务操作;
所述执行规则包括:
如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个动作方案进行排序;按照所述多个动作方案的排序,执行第一个动作方案,当第一个动作方案所执行的任务量达到第一标准任务量时,切换下第二个动作方案进行任务执行,当第二个动作方案执行任务达到第二标准任务量时,控制机械臂休息45min后,利用第一个动作方案执行任务直至完成剩余所有任务量;其中,所述第一标准任务量和第二标准任务量时如下:
C 1=45%C C 2=40%C
其中,C 1表示第一标准任务量;C 2表示第二标准任务量;C 表示总任务量;
如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个动作方案进行排序;按照所述多个动作方案的排序,执行第一个动作方案,当第一个动作方案所执行的任务量达到第三标准任务量时,切换下第二个动作方案进行任务执行,当第二个动作方案执行任务达到第四标准任务量时,控制机械臂休息30min后,利用第三个动作方案执行任务直至完成剩余所有任务量;其中,所述第三标准任务量和第四标准任务量时如下:
C 3=40%C C 4=35%C
其中,C 3表示第三标准任务量;C 4表示第四标准任务量;
如果最终确定符合任务执行的运行要求的动作方案为一个时,执行动作方案,当所述动作方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当所述动作方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述动作方案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如下:
C 5=35%C C 6=45%C
其中,C 5表示第五标准任务量;C 6表示第六标准任务量。
2.根据权利要求1所述方法,其特征在于,根据所述目标任务规划三组与所要执行任务对应的动作方案,包括:
提取所述机械臂需要执行的目标任务;
根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械臂执行动作;
将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
3.根据权利要求1所述方法,其特征在于,对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求,包括:
对每组与所要执行任务对应的动作方案进行10-20次的试操作;
实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
4.根据权利要求3所述方法,其特征在于,所述通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求,包括:
利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
Figure 529431DEST_PATH_IMAGE001
其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;H i 表示第i次出现关节运行参数偏差量时对应的偏差量数值;H max 表示关节运行参数偏差量最大值;m表示每组动作方案中所包含的阶段性分解动作的个数;T表示每组动作方案中,执行完成一个阶段性分解动作所用时间长度;T 0表示预先设置的分解动作标准运行时间;
如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
5.一种用于建筑施工的SCARA智能化机械臂控制系统,其特征在于,所述系统包括:
输入模块,用于输入机械臂需要执行的目标任务;
规划模块,用于根据所述目标任务规划三组与所要执行任务对应的动作方案;
试操作模块,用于对每组动作方案进行试操作,通过试操作确定每组动作方案的运行指标是否符合要求;
执行模块,用于在符合要求的动作方案中,按照执行规则进行目标任务操作;
所述执行规则包括:
如果最终确定符合任务执行的运行要求的动作方案为两个时,按照机械臂运行操作指标由低到高的原则对多个动作方案进行排序;按照所述多个动作方案的排序,执行第一个动作方案,当第一个动作方案所执行的任务量达到第一标准任务量时,切换下第二个动作方案进行任务执行,当第二个动作方案执行任务达到第二标准任务量时,控制机械臂休息45min后,利用第一个动作方案执行任务直至完成剩余所有任务量;其中,所述第一标准任务量和第二标准任务量时如下:
C 1=45%C C 2=40%C
其中,C 1表示第一标准任务量;C 2表示第二标准任务量;C 表示总任务量;
如果最终确定符合任务执行的运行要求的动作方案为三个时,按照机械臂运行操作指标由低到高的原则对多个动作方案进行排序;按照所述多个动作方案的排序,执行第一个动作方案,当第一个动作方案所执行的任务量达到第三标准任务量时,切换下第二个动作方案进行任务执行,当第二个动作方案执行任务达到第四标准任务量时,控制机械臂休息30min后,利用第三个动作方案执行任务直至完成剩余所有任务量;其中,所述第三标准任务量和第四标准任务量时如下:
C 3=40%C C 4=35%C
其中,C 3表示第三标准任务量;C 4表示第四标准任务量;
如果最终确定符合任务执行的运行要求的动作方案为一个时,执行动作方案,当所述动作方案所执行的任务量达到第五标准任务量时,控制机械臂休息30min后再运行,当所述动作方案执行任务达到第六标准任务量时,控制机械臂休息40min后,利用所述动作方案执行任务直至完成剩余所有任务量;其中,所述第五标准任务量和第六标准任务量时如下:
C 5=35%C C 6=45%C
其中,C 5表示第五标准任务量;C 6表示第六标准任务量。
6.根据权利要求5所述系统,其特征在于,所述规划模块包括:
提取模块,用于提取所述机械臂需要执行的目标任务;
路径规划模块,用于根据所述目标任务涉及的执行路线,对机械臂的执行路径进行规划,获得三组执行路径;
动作规划模块,用于根据所述目标任务涉及的被搬运物体的位置和三组执行路径,分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划;获得每个动作阶段对应的机械臂执行动作;
合并模块,用于将每个动作阶段对应的机械臂执行动作进行合并,获得三组机械臂执行动作;
匹配模块,用于将每组机械臂执行动作与每组执行路径进行对应匹配,获得三组与所要执行任务对应的动作方案。
7.根据权利要求5所述系统,其特征在于,所述试操作模块包括:
操作模块,用于对每组与所要执行任务对应的动作方案进行10-20次的试操作;
监控模块,用于实时监控记录每组动作方案在执行过程中,所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量;
指标获取模块,用于通过偏差量计算获取所述机械臂运行操作指标,并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求;
方案确定模块,用于提取符合运行要求的动作方案,确定利用所述符合运行要求的动作方案执行任务。
8.根据权利要求7所述系统,其特征在于,所述指标获取模块包括:
指标计算模块,用于利用指标获取模型计算所述机械臂运行操作指标,所述指标获取模型如下:
Figure 180992DEST_PATH_IMAGE001
其中,W表示所述机械臂运行操作指标;n表示出现关节运行参数偏差量的次数;H i 表示第i次出现关节运行参数偏差量时对应的偏差量数值;H max 表示关节运行参数偏差量最大值;m表示每组动作方案中所包含的阶段性分解动作的个数;T表示每组动作方案中,执行完成一个阶段性分解动作所用时间长度;T 0表示预先设置的分解动作标准运行时间;
比较确定模块,用于如果所述机械臂运行操作指标超过预设的指标阈值时,确定该动作方案不符合任务执行的运行要求。
CN202111173612.7A 2021-10-09 2021-10-09 一种用于建筑施工的scara智能化机械臂控制方法和系统 Active CN113771014B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111173612.7A CN113771014B (zh) 2021-10-09 2021-10-09 一种用于建筑施工的scara智能化机械臂控制方法和系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111173612.7A CN113771014B (zh) 2021-10-09 2021-10-09 一种用于建筑施工的scara智能化机械臂控制方法和系统

Publications (2)

Publication Number Publication Date
CN113771014A CN113771014A (zh) 2021-12-10
CN113771014B true CN113771014B (zh) 2022-03-18

Family

ID=78855103

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111173612.7A Active CN113771014B (zh) 2021-10-09 2021-10-09 一种用于建筑施工的scara智能化机械臂控制方法和系统

Country Status (1)

Country Link
CN (1) CN113771014B (zh)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102609089A (zh) * 2011-01-13 2012-07-25 微软公司 用于机器人和用户交互的多状态模型
CN103240739A (zh) * 2013-05-07 2013-08-14 武汉科技大学 一种移动机械臂分散集中自主切换控制方法
DE102014101735A1 (de) * 2013-06-13 2014-12-18 GM Global Technology Operations LLC (n. d. Ges. d. Staates Delaware) Verfahren und vorrichtung zum steuern einer robotervorrichtung über am körper tragbare sensoren
CN108000501A (zh) * 2017-11-22 2018-05-08 湖北工业大学 一种用于串联机器人的新型轨迹规划方法
CN108638065A (zh) * 2018-05-15 2018-10-12 河南科技学院 一种排爆机器人双臂协同控制系统
CN109580404A (zh) * 2018-10-30 2019-04-05 杭州电子科技大学 工业机器人内置型线束磨损及加速磨损测试方法与装置
CN109623826A (zh) * 2019-01-04 2019-04-16 广西科技大学 一种无速度跳变的容错型冗余度机械臂运动规划方法
CN111421539A (zh) * 2020-04-01 2020-07-17 电子科技大学 一种基于计算机视觉的工业零件智能识别与分拣系统

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8805581B2 (en) * 2012-02-21 2014-08-12 GM Global Technology Operations LLC Procedural memory learning and robot control
US9713871B2 (en) * 2015-04-27 2017-07-25 Microsoft Technology Licensing, Llc Enhanced configuration and control of robots

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102609089A (zh) * 2011-01-13 2012-07-25 微软公司 用于机器人和用户交互的多状态模型
CN103240739A (zh) * 2013-05-07 2013-08-14 武汉科技大学 一种移动机械臂分散集中自主切换控制方法
DE102014101735A1 (de) * 2013-06-13 2014-12-18 GM Global Technology Operations LLC (n. d. Ges. d. Staates Delaware) Verfahren und vorrichtung zum steuern einer robotervorrichtung über am körper tragbare sensoren
CN108000501A (zh) * 2017-11-22 2018-05-08 湖北工业大学 一种用于串联机器人的新型轨迹规划方法
CN108638065A (zh) * 2018-05-15 2018-10-12 河南科技学院 一种排爆机器人双臂协同控制系统
CN109580404A (zh) * 2018-10-30 2019-04-05 杭州电子科技大学 工业机器人内置型线束磨损及加速磨损测试方法与装置
CN109623826A (zh) * 2019-01-04 2019-04-16 广西科技大学 一种无速度跳变的容错型冗余度机械臂运动规划方法
CN111421539A (zh) * 2020-04-01 2020-07-17 电子科技大学 一种基于计算机视觉的工业零件智能识别与分拣系统

Also Published As

Publication number Publication date
CN113771014A (zh) 2021-12-10

Similar Documents

Publication Publication Date Title
CN107167154B (zh) 一种基于时间代价函数的时间窗路径规划冲突解决方法
CN108121216B (zh) 一种基于数字化工厂的自动化车间虚拟调试方法
CN110488781B (zh) 一种基于迁移强化学习的生产系统调度方法
CN106119458B (zh) 基于bp神经网络的转炉炼钢工艺成本控制方法及系统
CN106249717A (zh) 一种基于执行器饱和多智能体系统建模的协调控制方法
AU2018374073B2 (en) Correlation modeling method for coupling failure of critical components of deep well hoist under incomplete information condition
CN103480534B (zh) 机器人喷涂工件曲面造型方法
CN113031621A (zh) 一种桥式起重机安全避障路径规划方法及系统
CN112286149A (zh) 一种考虑起重机运输过程的柔性车间调度优化方法及系统
CN109683615A (zh) 机器人连续运动的路径的速度前瞻方法及机器人控制器
CN111897224A (zh) 基于演员-评论家强化学习和模糊逻辑的多智能体编队控制方法
CN112348314A (zh) 一种带起重机的分布式柔性车间调度方法及系统
CN113771014B (zh) 一种用于建筑施工的scara智能化机械臂控制方法和系统
CN110209167B (zh) 一种实时的完全分布式的多机器人系统编队的方法
Rastogi et al. Sample-efficient reinforcement learning via difference models
CN109034540B (zh) 一种基于在制品工序流的机床序列编排动态预测方法
CN110609571B (zh) 一种基于多无人机的多运动目标分布式协同视觉定位方法
Yuan et al. A multi-agent double Deep-Q-network based on state machine and event stream for flexible job shop scheduling problem
CN115958596A (zh) 双冗余机械臂运动规划方法及装置、设备、存储介质
Monostori et al. Multipurpose modelling and optimisation of production processes and process chains by combining machine learning and search techniques
CN113510699A (zh) 一种基于改进蚁群优化算法的机械臂运动轨迹规划方法
CN111965980A (zh) 一种机器人自适应反馈学习控制方法、控制器及机器人
CN110825051A (zh) 一种基于gap metric的不确定系统的多模型控制方法
Daoui et al. Control design for untimed Petri nets using Markov decision processes
CN116901086B (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
GR01 Patent grant
GR01 Patent grant