CN113771014B - 一种用于建筑施工的scara智能化机械臂控制方法和系统 - Google Patents
一种用于建筑施工的scara智能化机械臂控制方法和系统 Download PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000009435 building construction Methods 0.000 title claims abstract description 12
- 230000009471 action Effects 0.000 claims abstract description 255
- 238000000354 decomposition reaction Methods 0.000 claims description 18
- 230000008569 process Effects 0.000 claims description 12
- 238000012163 sequencing technique Methods 0.000 claims description 12
- 238000012544 monitoring process Methods 0.000 claims description 11
- 230000010391 action planning Effects 0.000 claims description 9
- 238000000605 extraction Methods 0.000 claims description 3
- 238000012216 screening Methods 0.000 description 12
- 238000005299 abrasion Methods 0.000 description 11
- 230000000694 effects Effects 0.000 description 8
- 230000002035 prolonged effect Effects 0.000 description 5
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/04—Programme-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/041—Cylindrical coordinate type
- B25J9/042—Cylindrical coordinate type comprising an articulated arm
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme 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智能化机械臂控制方法，所述方法包括：
输入机械臂需要执行的目标任务；
根据所述目标任务规划三组与所要执行任务对应的动作方案；
对每组动作方案进行试操作，通过试操作确定每组动作方案的运行指标是否符合要求；
在符合要求的动作方案中，按照执行规则进行目标任务操作。
进一步地，根据所述目标任务规划三组与所要执行任务对应的动作方案，包括：
提取所述机械臂需要执行的目标任务；
根据所述目标任务涉及的执行路线，对机械臂的执行路径进行规划，获得三组执行路径；
根据所述目标任务涉及的被搬运物体的位置和三组执行路径，分别对与三组执行路径对应的机械臂的执行动作进行分阶段动作规划；获得每个动作阶段对应的机械臂执行动作；
将每个动作阶段对应的机械臂执行动作进行合并，获得三组机械臂执行动作；
将每组机械臂执行动作与每组执行路径进行对应匹配，获得三组与所要执行任务对应的动作方案。
进一步地，对每组动作方案进行试操作，通过试操作确定每组动作方案的运行指标是否符合要求，包括：
对每组与所要执行任务对应的动作方案进行10-20次的试操作；
实时监控记录每组动作方案在执行过程中，所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量；
通过偏差量计算获取所述机械臂运行操作指标，并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求；
提取符合运行要求的动作方案，确定利用所述符合运行要求的动作方案执行任务。
进一步地，所述通过偏差量计算获取所述机械臂运行操作指标，并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求，包括：
利用指标获取模型计算所述机械臂运行操作指标，所述指标获取模型如下：
其中，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次的试操作；
监控模块，用于实时监控记录每组动作方案在执行过程中，所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量；
指标获取模块，用于通过偏差量计算获取所述机械臂运行操作指标，并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求；
方案确定模块，用于提取符合运行要求的动作方案，确定利用所述符合运行要求的动作方案执行任务。
进一步地，所述指标获取模块包括：
指标计算模块，用于利用指标获取模型计算所述机械臂运行操作指标，所述指标获取模型如下：
其中，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、利用指标获取模型计算所述机械臂运行操作指标，所述指标获取模型如下：
其中，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次的试操作；
监控模块，用于实时监控记录每组动作方案在执行过程中，所述机械臂完成每个动作时的实际关节运行参数与设置关节运行参数之间的偏差量；
指标获取模块，用于通过偏差量计算获取所述机械臂运行操作指标，并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求；
方案确定模块，用于提取符合运行要求的动作方案，确定利用所述符合运行要求的动作方案执行任务。
其中，所述指标获取模块包括：
指标计算模块，用于利用指标获取模型计算所述机械臂运行操作指标，所述指标获取模型如下：
其中，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所述方法，其特征在于，所述通过偏差量计算获取所述机械臂运行操作指标，并根据所述机械臂运行操作指标判断每组动作方案是否符合运行要求，包括：
利用指标获取模型计算所述机械臂运行操作指标，所述指标获取模型如下：
其中，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所述系统，其特征在于，所述指标获取模块包括：
指标计算模块，用于利用指标获取模型计算所述机械臂运行操作指标，所述指标获取模型如下：
其中，W表示所述机械臂运行操作指标；n表示出现关节运行参数偏差量的次数；H i 表示第i次出现关节运行参数偏差量时对应的偏差量数值；H max 表示关节运行参数偏差量最大值；m表示每组动作方案中所包含的阶段性分解动作的个数；T表示每组动作方案中，执行完成一个阶段性分解动作所用时间长度；T 0表示预先设置的分解动作标准运行时间；
比较确定模块，用于如果所述机械臂运行操作指标超过预设的指标阈值时，确定该动作方案不符合任务执行的运行要求。
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)
| 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)
| 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 |
-
2021
- 2021-10-09 CN CN202111173612.7A patent/CN113771014B/zh active Active
Patent Citations (8)
| 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 |
|---|---|---|
| CN108121216B (zh) | 一种基于数字化工厂的自动化车间虚拟调试方法 | |
| CN107966907B (zh) | 一种应用于冗余度机械臂的障碍物躲避解决方法 | |
| CN109683615B (zh) | 机器人连续运动的路径的速度前瞻方法及机器人控制器 | |
| Zhang et al. | Optimization of identification structure parameters based on recursive maximum likelihood iteration | |
| AU2018374073B2 (en) | Correlation modeling method for coupling failure of critical components of deep well hoist under incomplete information condition | |
| CN106249717A (zh) | 一种基于执行器饱和多智能体系统建模的协调控制方法 | |
| CN110488781A (zh) | 一种基于迁移强化学习的生产系统调度方法 | |
| CN113031621A (zh) | 一种桥式起重机安全避障路径规划方法及系统 | |
| CN113771014B (zh) | 一种用于建筑施工的scara智能化机械臂控制方法和系统 | |
| CN116901086B (zh) | 一种基于智能算法的工业机器人轨迹优化的控制方法 | |
| CN116068900A (zh) | 面向多非完整约束移动机器人的强化学习行为控制方法 | |
| CN114418159B (zh) | 肢体运动轨迹及其预测误差的预测方法、系统和电子装置 | |
| CN115958596A (zh) | 双冗余机械臂运动规划方法及装置、设备、存储介质 | |
| Abd et al. | A fuzzy decision support system for selecting the optimal scheduling rule in robotic flexible assembly cells | |
| Monostori et al. | Multipurpose modelling and optimisation of production processes and process chains by combining machine learning and search techniques | |
| CN113510699A (zh) | 一种基于改进蚁群优化算法的机械臂运动轨迹规划方法 | |
| CN113183146A (zh) | 一种基于快速灵活全纯嵌入思想的机械臂运动规划方法 | |
| CN111965980A (zh) | 一种机器人自适应反馈学习控制方法、控制器及机器人 | |
| CN114610034B (zh) | 一种移动机器人路径规划方法 | |
| CN114347036B (zh) | 优化机械臂关节中心距离和关节运动范围的方法 | |
| CN118607852A (zh) | 一种批量流的柔性作业车间优化调度方法及系统 | |
| CN112051733B (zh) | 一种基于图像分类的刚性机械臂复合学习控制方法 | |
| Qin et al. | Research on Fuzzy Learning Algorithm Robot Cooperation Model | |
| Huang et al. | Vision-based robotic motion control for non-autonomous environment | |
| Filipović | Failure recovery in FMS using augmented Petri net approach based on weighted sum |
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 |