CN114179085B - 机器人控制、轨迹衔接与平滑处理的方法及系统 - Google Patents
机器人控制、轨迹衔接与平滑处理的方法及系统 Download PDFInfo
- Publication number
- CN114179085B CN114179085B CN202111545817.3A CN202111545817A CN114179085B CN 114179085 B CN114179085 B CN 114179085B CN 202111545817 A CN202111545817 A CN 202111545817A CN 114179085 B CN114179085 B CN 114179085B
- Authority
- CN
- China
- Prior art keywords
- real
- track
- time
- robot
- time process
- 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 200
- 238000009499 grossing Methods 0.000 title claims abstract description 74
- 230000008569 process Effects 0.000 claims abstract description 171
- 238000012545 processing Methods 0.000 claims abstract description 32
- 238000005070 sampling Methods 0.000 claims abstract description 22
- 230000002452 interceptive effect Effects 0.000 claims abstract description 16
- 238000001514 detection method Methods 0.000 claims description 19
- 238000004891 communication Methods 0.000 claims description 14
- 230000003993 interaction Effects 0.000 claims description 7
- 230000035772 mutation Effects 0.000 claims description 7
- 238000011897 real-time detection Methods 0.000 claims description 7
- 230000001360 synchronised effect Effects 0.000 claims description 7
- 230000003068 static effect Effects 0.000 claims description 6
- 101100369993 Mus musculus Tnfsf10 gene Proteins 0.000 description 18
- 238000010586 diagram Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission 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
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
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/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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明提供了一种机器人控制、轨迹衔接与平滑处理的方法及系统,包括:通过交互界面下发任务指令;接收到任务指令,结合机器人当前状态对机器人进行运动规划;如果规划失败,不产生规划路径;如果规划成功,将规划路径发送至轨迹衔接与平滑处理模块,自动生成满足实时进程采样周期的平滑轨迹并下发至伺服系统;执行平滑轨迹,控制机器人各关节按照平滑轨迹运动。实时轨迹平滑处理模块,将实时进程与非实时进程中关于运动轨迹进行同步;非实时轨迹平滑处理模块,先将非实时轨迹转化为实时轨迹,再将实时进程与非实时进程中关于运动轨迹进行同步。本发明提升了机器人的适应性与智能性,降低了机器人对环境的强依赖。
Description
技术领域
本发明涉及机器人技术领域,具体地,涉及一种机器人控制、轨迹衔接与平滑处理的方法及系统。
背景技术
机器人是一种高精度,多输入多输出,高度非线性,强耦合的复杂系统,因其具备的自动化属性,使得机器人在工业制造、医学治疗、半导体制造以及太空探索等领域都发挥举足轻重的功能。传统机器人的控制器采用实时控制系统,控制周期非常短,因此能够实现高精度的同时也具备稳定的功能性能,同时其工作任务简单,传统机器人控制架构能够很好的满足单一重复的应用场景需求,如工厂的上下料,机器人仅需要不断重复固定路径即可。但是随着机器人应用的普及,其面对的应用场景也变得越来越复杂,单一的实时控制系统框架已经不能满足复杂场景的使用需求,因此机器人的控制系统架构升级势在必行。
面对复杂的应用场景,机器人智能规划技术越来越多的被开发并被机器人控制系统使用,但是机器人规划是一个实时性要求很低的操作,不需要按照既定频率在指定时间内完成运动规划,而是需要在尽可能短的时间内针对不同任务完成机器人运动规划并返回规划结果。因此,机器人控制系统框架需要包含实时进程与非实时进程,其中实时进程主要用于机器人控制,非实时进程主要用于机器人运动规划,而连接非实时进程与实时进程的桥梁就显得尤为重要了。
本专利发明了一种包含实时进程与非实时进程的控制系统框架,与传统机器人控制系统相比,实时进程既保证了机器人控制的稳定性与精确性,而非实时进程又能提高机器人的智能性与适应性,满足复杂应用场景使用的需求。同时,本专利在上述控制系统框架内,针对运动轨迹在非实时进程与实时进程之间的传递,发明了一种轨迹拼接与平滑处理方法,保证了最终实时进程中运动轨迹的平滑性。
专利文献CN106863306B(申请号:CN201710209885.X)公开了一种机器人关节空间平滑轨迹规划方法,包括步骤:首先,由机器人运动学逆解算法,实现机器人笛卡尔空间运动轨迹向关节空间运动轨迹的映射,获得关节空间关键插补点;然后,依据机器人各个关节的最大速度约束,调整笛卡尔插补周期;接着,借助三次多项式曲线进行关节空间关键插补点的角速度和角加速度估计,为下一步的五次样条曲线拟合提供条件;最后,从第一个关节空间关键插补点开始,依次使用相邻两个关节空间关键插补点构造五次样条曲线,作为关节空间的运动轨迹,再进行关节空间插补。但该发明没有避免机器人出现“急停急起”危险工况。
发明内容
针对现有技术中的缺陷,本发明的目的是提供一种机器人控制、轨迹衔接与平滑处理的方法及系统。
根据本发明提供的一种机器人控制方法,包括:
步骤S1:根据显示的状态以及工作需求,通过交互界面下发任务指令;
步骤S2:运动规划模块接收到任务指令,结合机器人当前状态对机器人进行运动规划,并通过交互界面反馈规划结果;
如果规划失败,不产生规划路径,机器人保持静止状态,终止运行;
如果规划成功,将规划路径发送至轨迹衔接与平滑处理模块,运行步骤S3;
步骤S3:轨迹规划与平滑处理模块接收到规划路径,自动生成满足实时进程采样周期的平滑轨迹并下发至伺服系统;
步骤S4:伺服系统执行平滑轨迹,控制机器人各关节按照平滑轨迹运动。
优选地,由实时进程与非实时进程构成,其中:
实时进程负责机器人运动轨迹拼接与平滑处理,并将平滑轨迹发送至机器人伺服系统,控制机器人各关节运动;
非实时进程负责针对工作任务的机器人运动规划,以及人机交互信息的处理,保证整个机器人控制系统的稳定性。
优选地,在非实时进程与实时进程中间添加心跳实时检测,避免出现因通信不稳定导致的机器人运动轨迹突变;心跳检测持续进行,每隔一个实时进程采样周期,非实时进程中的心跳发生模块都会产生一个新的心跳数字并下发至实时进程中的心跳检测模块,当心跳检测模块发现连续两个采样周期该心跳数字均未发生变化,则表明实时进程与非实时进程通信故障,机器人停止运动。
根据本发明提供的一种机器人控制系统,包括:
模块M1:根据显示的状态以及工作需求,通过交互界面下发任务指令;
模块M2:运动规划模块接收到任务指令,结合机器人当前状态对机器人进行运动规划,并通过交互界面反馈规划结果;
如果规划失败,不产生规划路径,机器人保持静止状态,终止运行;
如果规划成功,将规划路径发送至轨迹衔接与平滑处理模块,运行模块M3;
模块M3:轨迹规划与平滑处理模块接收到规划路径,自动生成满足实时进程采样周期的平滑轨迹并下发至伺服系统;
模块M4:伺服系统执行平滑轨迹,控制机器人各关节按照平滑轨迹运动。
优选地,由实时进程与非实时进程构成,其中:
实时进程负责机器人运动轨迹拼接与平滑处理,并将平滑轨迹发送至机器人伺服系统,控制机器人各关节运动;
非实时进程负责针对工作任务的机器人运动规划,以及人机交互信息的处理,保证整个机器人控制系统的稳定性。
优选地,在非实时进程与实时进程中间添加心跳实时检测,避免出现因通信不稳定导致的机器人运动轨迹突变;心跳检测持续进行,每隔一个实时进程采样周期,非实时进程中的心跳发生模块都会产生一个新的心跳数字并下发至实时进程中的心跳检测模块,当心跳检测模块发现连续两个采样周期该心跳数字均未发生变化,则表明实时进程与非实时进程通信故障,机器人停止运动。
根据本发明提供的一种基于机器人控制系统下的轨迹衔接与平滑处理的系统,包括:
实时轨迹平滑处理模块:将实时进程与非实时进程中关于运动轨迹进行同步;
非实时轨迹平滑处理模块:先将非实时轨迹转化为实时轨迹,再将实时进程与非实时进程中关于运动轨迹进行同步,产生可供伺服系统使用的平滑轨迹。
优选地,所述实时轨迹平滑处理模块:
由于实时进程与非实时进程的运行速率不一致,在同步两进程之间的轨迹时添加一段缓冲队列,根据机器人硬件性能以及任务需求设置该缓冲队列大小,运动规划共产生了N个轨迹点,设置该缓冲队列存储m个机器人运动轨迹点,非实时进程向该队列尾部添加轨迹点,当该缓冲队列填满后,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个轨迹点向前移动,直至完成运动规划产生的所有轨迹点;
所述非实时轨迹平滑处理模块:
运动规划共产生了M个非实时轨迹点,根据机器人硬件性能以及任务需求,从非实时轨迹点中选取k个轨迹点用于生成实时轨迹,采用三次多项式插值算法用于生成实时轨迹,将生成的实时轨迹放置于上述缓冲队列中,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个实时轨迹点向前移动,当缓冲队列为空时,再次将k个非实时轨迹点生成实时轨迹点,重复上述步骤,直至完成运动规划所产生的所有轨迹点。
根据本发明提供的一种基于机器人控制方法下的轨迹衔接与平滑处理的方法,包括:
步骤A1:如果是非实时轨迹平滑处理,将非实时轨迹转化为实时轨迹;如果是实时轨迹平滑处理,直接进入步骤A2:
步骤A2:将实时进程与非实时进程中关于运动轨迹进行同步,产生可供伺服系统使用的平滑轨迹。
优选地,所述实时轨迹平滑处理:
由于实时进程与非实时进程的运行速率不一致,在同步两进程之间的轨迹时添加一段缓冲队列,根据机器人硬件性能以及任务需求设置该缓冲队列大小,运动规划共产生了N个轨迹点,设置该缓冲队列存储m个机器人运动轨迹点,非实时进程向该队列尾部添加轨迹点,当该缓冲队列填满后,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个轨迹点向前移动,直至完成运动规划产生的所有轨迹点;
所述非实时轨迹平滑处理:
运动规划共产生了M个非实时轨迹点,根据机器人硬件性能以及任务需求,从非实时轨迹点中选取k个轨迹点用于生成实时轨迹,采用三次多项式插值算法用于生成实时轨迹,将生成的实时轨迹放置于上述缓冲队列中,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个实时轨迹点向前移动,当缓冲队列为空时,再次将k个非实时轨迹点生成实时轨迹点,重复上述步骤,直至完成运动规划所产生的所有轨迹点。
与现有技术相比,本发明具有如下的有益效果:
1、本发明提升了机器人的适应性与智能性,降低了机器人对环境的强依赖,在面对复杂的周边环境时,也能保证机器人正常工作;
2、本发明提升机器人智能性的同时也保证了其稳定性,通过对规划路径的平滑处理,保证机器人工作时的流畅性;
3、本发明避免了机器人出现“急停急起”危险工况,提高机器人使用寿命。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1为机器人控制系统架构图;
图2为机器人控制系统工作流程图;
图3为实时轨迹处理流程图。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变化和改进。这些都属于本发明的保护范围。
实施例1:
根据本发明提供的一种机器人控制方法,如图1-图3所示,包括:
步骤S1:根据显示的状态以及工作需求,通过交互界面下发任务指令;
步骤S2:运动规划模块接收到任务指令,结合机器人当前状态对机器人进行运动规划,并通过交互界面反馈规划结果;
如果规划失败,不产生规划路径,机器人保持静止状态,终止运行;
如果规划成功,将规划路径发送至轨迹衔接与平滑处理模块,运行步骤S3;
步骤S3:轨迹规划与平滑处理模块接收到规划路径,自动生成满足实时进程采样周期的平滑轨迹并下发至伺服系统;
步骤S4:伺服系统执行平滑轨迹,控制机器人各关节按照平滑轨迹运动。
具体地,由实时进程与非实时进程构成,其中:
实时进程负责机器人运动轨迹拼接与平滑处理,并将平滑轨迹发送至机器人伺服系统,控制机器人各关节运动;
非实时进程负责针对工作任务的机器人运动规划,以及人机交互信息的处理,保证整个机器人控制系统的稳定性。
具体地,在非实时进程与实时进程中间添加心跳实时检测,避免出现因通信不稳定导致的机器人运动轨迹突变;心跳检测持续进行,每隔一个实时进程采样周期,非实时进程中的心跳发生模块都会产生一个新的心跳数字并下发至实时进程中的心跳检测模块,当心跳检测模块发现连续两个采样周期该心跳数字均未发生变化,则表明实时进程与非实时进程通信故障,机器人停止运动。
实施例2:
实施例2为实施例1的优选例,以更为具体地对本发明进行说明。
本领域技术人员可以将本发明提供的一种机器人控制方法,理解为机器人控制系统的具体实施方式,即所述机器人控制系统可以通过执行所述机器人控制方法的步骤流程予以实现。
根据本发明提供的一种机器人控制系统,包括:
模块M1:根据显示的状态以及工作需求,通过交互界面下发任务指令;
模块M2:运动规划模块接收到任务指令,结合机器人当前状态对机器人进行运动规划,并通过交互界面反馈规划结果;
如果规划失败,不产生规划路径,机器人保持静止状态,终止运行;
如果规划成功,将规划路径发送至轨迹衔接与平滑处理模块,运行模块M3;
模块M3:轨迹规划与平滑处理模块接收到规划路径,自动生成满足实时进程采样周期的平滑轨迹并下发至伺服系统;
模块M4:伺服系统执行平滑轨迹,控制机器人各关节按照平滑轨迹运动。
具体地,由实时进程与非实时进程构成,其中:
实时进程负责机器人运动轨迹拼接与平滑处理,并将平滑轨迹发送至机器人伺服系统,控制机器人各关节运动;
非实时进程负责针对工作任务的机器人运动规划,以及人机交互信息的处理,保证整个机器人控制系统的稳定性。
具体地,在非实时进程与实时进程中间添加心跳实时检测,避免出现因通信不稳定导致的机器人运动轨迹突变;心跳检测持续进行,每隔一个实时进程采样周期,非实时进程中的心跳发生模块都会产生一个新的心跳数字并下发至实时进程中的心跳检测模块,当心跳检测模块发现连续两个采样周期该心跳数字均未发生变化,则表明实时进程与非实时进程通信故障,机器人停止运动。
实施例3:
实施例3为实施例1的优选例,以更为具体地对本发明进行说明。
根据本发明提供的一种基于机器人控制系统下的轨迹衔接与平滑处理的系统,包括:
实时轨迹平滑处理模块:将实时进程与非实时进程中关于运动轨迹进行同步;
非实时轨迹平滑处理模块:先将非实时轨迹转化为实时轨迹,再将实时进程与非实时进程中关于运动轨迹进行同步,产生可供伺服系统使用的平滑轨迹。
具体地,所述实时轨迹平滑处理模块:
由于实时进程与非实时进程的运行速率不一致,在同步两进程之间的轨迹时添加一段缓冲队列,根据机器人硬件性能以及任务需求设置该缓冲队列大小,运动规划共产生了N个轨迹点,设置该缓冲队列存储m个机器人运动轨迹点,非实时进程向该队列尾部添加轨迹点,当该缓冲队列填满后,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个轨迹点向前移动,直至完成运动规划产生的所有轨迹点;
所述非实时轨迹平滑处理模块:
运动规划共产生了M个非实时轨迹点,根据机器人硬件性能以及任务需求,从非实时轨迹点中选取k个轨迹点用于生成实时轨迹,采用三次多项式插值算法用于生成实时轨迹,将生成的实时轨迹放置于上述缓冲队列中,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个实时轨迹点向前移动,当缓冲队列为空时,再次将k个非实时轨迹点生成实时轨迹点,重复上述步骤,直至完成运动规划所产生的所有轨迹点。
实施例4:
实施例4为实施例1的优选例,以更为具体地对本发明进行说明。
本领域技术人员可以将本发明提供的一种轨迹衔接与平滑处理方法,理解为轨迹衔接与平滑处理系统的具体实施方式,即所述轨迹衔接与平滑处理系统可以通过执行所述轨迹衔接与平滑处理方法的步骤流程予以实现。
根据本发明提供的一种基于机器人控制方法下的轨迹衔接与平滑处理的方法,包括:
步骤A1:如果是非实时轨迹平滑处理,将非实时轨迹转化为实时轨迹;如果是实时轨迹平滑处理,直接进入步骤A2:
步骤A2:将实时进程与非实时进程中关于运动轨迹进行同步,产生可供伺服系统使用的平滑轨迹。
具体地,所述实时轨迹平滑处理:
由于实时进程与非实时进程的运行速率不一致,在同步两进程之间的轨迹时添加一段缓冲队列,根据机器人硬件性能以及任务需求设置该缓冲队列大小,运动规划共产生了N个轨迹点,设置该缓冲队列存储m个机器人运动轨迹点,非实时进程向该队列尾部添加轨迹点,当该缓冲队列填满后,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个轨迹点向前移动,直至完成运动规划产生的所有轨迹点;
所述非实时轨迹平滑处理:
运动规划共产生了M个非实时轨迹点,根据机器人硬件性能以及任务需求,从非实时轨迹点中选取k个轨迹点用于生成实时轨迹,采用三次多项式插值算法用于生成实时轨迹,将生成的实时轨迹放置于上述缓冲队列中,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个实时轨迹点向前移动,当缓冲队列为空时,再次将k个非实时轨迹点生成实时轨迹点,重复上述步骤,直至完成运动规划所产生的所有轨迹点。
实施例5:
实施例5为实施例1的优选例,以更为具体地对本发明进行说明。
本专利中的机器人控制系统由实时进程与非实时进程两个模块构成,其中:
实时进程主要负责机器人运动轨迹拼接与平滑处理,并将平滑轨迹发送至机器人伺服系统,控制机器人各关节运动;
非实时进程主要负责针对工作任务的机器人运动规划,以及人机交互信息的处理。为保证整个机器人控制系统的稳定性。
在非实时进程与实时进程中间添加心跳实时检测,避免出现因通信不稳定导致的机器人运动轨迹“突变”,机器人控制系统框架如图1所示。
从机器人控制系统框架图中的数据流可以看出完整的工作流程如下所示:
1)工作人员根据交互界面显示的状态以及工作需求,通过交互界面下发任务指令;
2)运动规划模块在接收到工作任务需求后,再结合机器人当前状态对机器人进行运动规划,并通过交互界面反馈规划结果。如果规划失败,那么不产生规划路径,即机器人保持静止状态;如果规划成功,那么将规划路径发送至轨迹衔接与平滑处理模块;
3)轨迹规划与平滑处理模块接收规划路径后,自动生成满足实时进程采样周期的平滑轨迹并下发至伺服系统;
4)伺服系统执行平滑轨迹,控制机器人各关机按照平滑轨迹运动。
需要指出的是,在机器人控制系统工作流程中,一直持续进行心跳检测:每隔一个实时进程采样周期,非实时进程中的心跳发生模块都会产生一个新的心跳数字并下发至实时进程中的心跳检测模块,当心跳检测模块发现连续两个采样周期该心跳数字均未发生变化,则表明实时进程与非实时进程通信故障,机器人停止运动。机器人控制系统详细的工作流程如图2所示。
本专利中涉及到的运动规划生成的轨迹包含两种:实时轨迹与非实时轨迹。一般而言,轨迹包含了路径点位置、速度、加速度以及相应时间信息,实时运动轨迹是指该轨迹中所有路径点位置对应的时间其时间间隔一致且很小,通常是在毫秒级别,而非实时轨迹是指所有路径点位置对应的时间其时间间隔不一致。因此本专利中的轨迹平滑处理包含了两种情况。
1)实时轨迹平滑处理
因为运动规划产生的实时轨迹已经保证了其平滑性,所以实时轨迹平滑处理只需要考虑实时进程与非实时进程中关于运动轨迹的同步问题,由于实时进程与非实时进程的运行速率不一致,通常而言实时进程速度更加快,在同步两进程之间的轨迹时需要添加一段缓冲队列。根据机器人硬件性能以及任务需求设置该缓冲队列大小,假设运动规划共产生了N个轨迹点,可设置该缓冲队列能存储m个机器人运动轨迹点,非实时进程向该队列尾部添加轨迹点,当该缓冲队列填满后,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个轨迹点向前移动,直至完成运动规划产生的所有轨迹点,其工作流程如图3所示。
2)非实时轨迹平滑处理
对于非实时轨迹,可考虑先将非实时轨迹转化为实时轨迹,再用上述实时轨迹处理方法来产生可供伺服系统使用的平滑轨迹。
假设运动规划共产生了M个非实时轨迹点,根据机器人硬件性能以及任务需求,从非实时轨迹点中选取k个轨迹点用于生成实时轨迹,本专利采用三次多项式插值算法用于生成实时轨迹。将生成的实时轨迹放置于上述缓冲队列中,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个实时轨迹点向前移动,当缓冲队列为空时,再次将k个非实时轨迹点生成实时轨迹点,重复上述步骤,直至完成运动规划所产生的所有轨迹点。
本领域技术人员知道,除了以纯计算机可读程序代码方式实现本发明提供的系统、装置及其各个模块以外,完全可以通过将方法步骤进行逻辑编程来使得本发明提供的系统、装置及其各个模块以逻辑门、开关、专用集成电路、可编程逻辑控制器以及嵌入式微控制器等的形式来实现相同程序。所以,本发明提供的系统、装置及其各个模块可以被认为是一种硬件部件,而对其内包括的用于实现各种程序的模块也可以视为硬件部件内的结构;也可以将用于实现各种功能的模块视为既可以是实现方法的软件程序又可以是硬件部件内的结构。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变化或修改,这并不影响本发明的实质内容。在不冲突的情况下,本申请的实施例和实施例中的特征可以任意相互组合。
Claims (8)
1.一种基于机器人控制方法下的轨迹衔接与平滑处理的方法,其特征在于,包括:
步骤A1:如果是非实时轨迹平滑处理,将非实时轨迹转化为实时轨迹;如果是实时轨迹平滑处理,直接进入步骤A2:
步骤A2:将实时进程与非实时进程中关于运动轨迹进行同步,产生可供伺服系统使用的平滑轨迹;
所述实时轨迹平滑处理:
由于实时进程与非实时进程的运行速率不一致,在同步两进程之间的轨迹时添加一段缓冲队列,根据机器人硬件性能以及任务需求设置该缓冲队列大小,运动规划共产生了N个轨迹点,设置该缓冲队列存储m个机器人运动轨迹点,非实时进程向该队列尾部添加轨迹点,当该缓冲队列填满后,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个轨迹点向前移动,直至完成运动规划产生的所有轨迹点;
所述非实时轨迹平滑处理:
运动规划共产生了M个非实时轨迹点,根据机器人硬件性能以及任务需求,从非实时轨迹点中选取k个轨迹点用于生成实时轨迹,采用三次多项式插值算法用于生成实时轨迹,将生成的实时轨迹放置于上述缓冲队列中,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个实时轨迹点向前移动,当缓冲队列为空时,再次将k个非实时轨迹点生成实时轨迹点,重复上述步骤,直至完成运动规划所产生的所有轨迹点。
2.根据权利要求1所述的基于机器人控制方法下的轨迹衔接与平滑处理的方法,其特征在于,包括:
所述机器人控制方法包括:
步骤S1:根据显示的状态以及工作需求,通过交互界面下发任务指令;
步骤S2:运动规划模块接收到任务指令,结合机器人当前状态对机器人进行运动规划,并通过交互界面反馈规划结果;
如果规划失败,不产生规划路径,机器人保持静止状态,终止运行;
如果规划成功,将规划路径发送至轨迹衔接与平滑处理模块,运行步骤S3;
步骤S3:轨迹规划与平滑处理模块接收到规划路径,自动生成满足实时进程采样周期的平滑轨迹并下发至伺服系统;
步骤S4:伺服系统执行平滑轨迹,控制机器人各关节按照平滑轨迹运动。
3.根据权利要求2所述的基于机器人控制方法下的轨迹衔接与平滑处理的方法,其特征在于:
由实时进程与非实时进程构成,其中:
实时进程负责机器人运动轨迹拼接与平滑处理,并将平滑轨迹发送至机器人伺服系统,控制机器人各关节运动;
非实时进程负责针对工作任务的机器人运动规划,以及人机交互信息的处理,保证整个机器人控制系统的稳定性。
4.根据权利要求3所述的基于机器人控制方法下的轨迹衔接与平滑处理的方法,其特征在于:
在非实时进程与实时进程中间添加心跳实时检测,避免出现因通信不稳定导致的机器人运动轨迹突变;心跳检测持续进行,每隔一个实时进程采样周期,非实时进程中的心跳发生模块都会产生一个新的心跳数字并下发至实时进程中的心跳检测模块,当心跳检测模块发现连续两个采样周期该心跳数字均未发生变化,则表明实时进程与非实时进程通信故障,机器人停止运动。
5.一种基于机器人控制系统下的轨迹衔接与平滑处理的系统,其特征在于,包括:
实时轨迹平滑处理模块:将实时进程与非实时进程中关于运动轨迹进行同步;
非实时轨迹平滑处理模块:先将非实时轨迹转化为实时轨迹,再将实时进程与非实时进程中关于运动轨迹进行同步,产生可供伺服系统使用的平滑轨迹;
所述实时轨迹平滑处理模块:
由于实时进程与非实时进程的运行速率不一致,在同步两进程之间的轨迹时添加一段缓冲队列,根据机器人硬件性能以及任务需求设置该缓冲队列大小,运动规划共产生了N个轨迹点,设置该缓冲队列存储m个机器人运动轨迹点,非实时进程向该队列尾部添加轨迹点,当该缓冲队列填满后,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个轨迹点向前移动,直至完成运动规划产生的所有轨迹点;
所述非实时轨迹平滑处理模块:
运动规划共产生了M个非实时轨迹点,根据机器人硬件性能以及任务需求,从非实时轨迹点中选取k个轨迹点用于生成实时轨迹,采用三次多项式插值算法用于生成实时轨迹,将生成的实时轨迹放置于上述缓冲队列中,实时进程从该队列首部取走轨迹点并下发至伺服系统,进一步的整个实时轨迹点向前移动,当缓冲队列为空时,再次将k个非实时轨迹点生成实时轨迹点,重复上述步骤,直至完成运动规划所产生的所有轨迹点。
6.根据权利要求5所述的一种基于机器人控制系统下的轨迹衔接与平滑处理的系统,其特征在于,包括:
所述机器人控制系统包括:
模块M1:根据显示的状态以及工作需求,通过交互界面下发任务指令;
模块M2:运动规划模块接收到任务指令,结合机器人当前状态对机器人进行运动规划,并通过交互界面反馈规划结果;
如果规划失败,不产生规划路径,机器人保持静止状态,终止运行;
如果规划成功,将规划路径发送至轨迹衔接与平滑处理模块,运行模块M3;
模块M3:轨迹规划与平滑处理模块接收到规划路径,自动生成满足实时进程采样周期的平滑轨迹并下发至伺服系统;
模块M4:伺服系统执行平滑轨迹,控制机器人各关节按照平滑轨迹运动。
7.根据权利要求6所述的一种基于机器人控制系统下的轨迹衔接与平滑处理的系统,其特征在于:
由实时进程与非实时进程构成,其中:
实时进程负责机器人运动轨迹拼接与平滑处理,并将平滑轨迹发送至机器人伺服系统,控制机器人各关节运动;
非实时进程负责针对工作任务的机器人运动规划,以及人机交互信息的处理,保证整个机器人控制系统的稳定性。
8.根据权利要求7所述的一种基于机器人控制系统下的轨迹衔接与平滑处理的系统,其特征在于:
在非实时进程与实时进程中间添加心跳实时检测,避免出现因通信不稳定导致的机器人运动轨迹突变;心跳检测持续进行,每隔一个实时进程采样周期,非实时进程中的心跳发生模块都会产生一个新的心跳数字并下发至实时进程中的心跳检测模块,当心跳检测模块发现连续两个采样周期该心跳数字均未发生变化,则表明实时进程与非实时进程通信故障,机器人停止运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111545817.3A CN114179085B (zh) | 2021-12-16 | 2021-12-16 | 机器人控制、轨迹衔接与平滑处理的方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111545817.3A CN114179085B (zh) | 2021-12-16 | 2021-12-16 | 机器人控制、轨迹衔接与平滑处理的方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114179085A CN114179085A (zh) | 2022-03-15 |
CN114179085B true CN114179085B (zh) | 2024-02-06 |
Family
ID=80605407
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111545817.3A Active CN114179085B (zh) | 2021-12-16 | 2021-12-16 | 机器人控制、轨迹衔接与平滑处理的方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114179085B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103197968A (zh) * | 2013-03-18 | 2013-07-10 | 焦点科技股份有限公司 | 一种融合同步异步特点的线程池处理方法及系统 |
WO2014145471A1 (en) * | 2013-03-15 | 2014-09-18 | Carnegie Mellon University | A supervised autonomous robotic system for complex surface inspection and processing |
CN106863306A (zh) * | 2017-03-31 | 2017-06-20 | 华南理工大学 | 一种机器人关节空间平滑轨迹规划方法 |
CN109409255A (zh) * | 2018-10-10 | 2019-03-01 | 长沙千博信息技术有限公司 | 一种手语场景生成方法及装置 |
CN109933008A (zh) * | 2019-03-28 | 2019-06-25 | 佛山智能装备技术研究院 | 一种非实时系统和机器人控制器的双插补方法及装置 |
CN110328668A (zh) * | 2019-07-27 | 2019-10-15 | 南京理工大学 | 基于速度平滑确定性策略梯度的机械臂路径规划方法 |
CN111736514A (zh) * | 2020-06-10 | 2020-10-02 | 杭州凯尔达机器人科技股份有限公司 | 基于通用计算机的机器人控制系统 |
CN112720462A (zh) * | 2020-12-09 | 2021-04-30 | 深圳先进技术研究院 | 一种机器人的轨迹规划系统和方法 |
CN113119110A (zh) * | 2021-03-18 | 2021-07-16 | 上海握珠智能科技有限公司 | 一种机器人的智能动作和目标的动态位姿实时融合的方法 |
CN113495565A (zh) * | 2021-08-19 | 2021-10-12 | 上海景吾智能科技有限公司 | 一种机器人及其轨迹规划和平滑过渡方法、系统及介质 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7222803B2 (ja) * | 2019-04-25 | 2023-02-15 | 株式会社日立製作所 | 軌道計画装置、軌道計画方法及びプログラム |
-
2021
- 2021-12-16 CN CN202111545817.3A patent/CN114179085B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2014145471A1 (en) * | 2013-03-15 | 2014-09-18 | Carnegie Mellon University | A supervised autonomous robotic system for complex surface inspection and processing |
CN103197968A (zh) * | 2013-03-18 | 2013-07-10 | 焦点科技股份有限公司 | 一种融合同步异步特点的线程池处理方法及系统 |
CN106863306A (zh) * | 2017-03-31 | 2017-06-20 | 华南理工大学 | 一种机器人关节空间平滑轨迹规划方法 |
CN109409255A (zh) * | 2018-10-10 | 2019-03-01 | 长沙千博信息技术有限公司 | 一种手语场景生成方法及装置 |
CN109933008A (zh) * | 2019-03-28 | 2019-06-25 | 佛山智能装备技术研究院 | 一种非实时系统和机器人控制器的双插补方法及装置 |
CN110328668A (zh) * | 2019-07-27 | 2019-10-15 | 南京理工大学 | 基于速度平滑确定性策略梯度的机械臂路径规划方法 |
CN111736514A (zh) * | 2020-06-10 | 2020-10-02 | 杭州凯尔达机器人科技股份有限公司 | 基于通用计算机的机器人控制系统 |
CN112720462A (zh) * | 2020-12-09 | 2021-04-30 | 深圳先进技术研究院 | 一种机器人的轨迹规划系统和方法 |
CN113119110A (zh) * | 2021-03-18 | 2021-07-16 | 上海握珠智能科技有限公司 | 一种机器人的智能动作和目标的动态位姿实时融合的方法 |
CN113495565A (zh) * | 2021-08-19 | 2021-10-12 | 上海景吾智能科技有限公司 | 一种机器人及其轨迹规划和平滑过渡方法、系统及介质 |
Also Published As
Publication number | Publication date |
---|---|
CN114179085A (zh) | 2022-03-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5430793B2 (ja) | 電動機制御システムおよび通信方法 | |
JP2019036014A (ja) | 情報処理装置、情報処理方法およびプログラム | |
CN113021330B (zh) | 一种分布式网络下的多机器人同步随动控制方法 | |
US20190094831A1 (en) | Control apparatus, control method, and support apparatus | |
JP2019061523A (ja) | 情報処理装置、情報処理方法およびプログラム | |
US20210370504A1 (en) | Robot control parameter interpolation | |
CN109454641B (zh) | 一种运动控制器多任务分工及数据交互方法 | |
CN114179085B (zh) | 机器人控制、轨迹衔接与平滑处理的方法及系统 | |
CN111650886A (zh) | 一种运动控制系统 | |
CN116009404B (zh) | 伺服设备的调试方法、装置、设备和可读存储介质 | |
CN117031980A (zh) | 基于智能规划的空间操控高精度大动态仿真装置、控制方法和系统 | |
CN113858213B (zh) | 一种用于目标同步的机器人动态轨迹规划方法 | |
CN114505853B (zh) | 一种工业机器人的远程分层管控方法及系统 | |
Simon et al. | Control laws, tasks and procedures with ORCCAD: Application to the control of an underwater arm | |
Yu et al. | Design of controller system for industrial robot based on RTOS Xenomai | |
JP3346847B2 (ja) | 子局同時起動方法 | |
CN111723473A (zh) | 一种三维可视化协同仿真系统 | |
US20230259100A1 (en) | Method for Controlling a Plurality of Execution Mechanisms, Electronic Device, and Storage Medium | |
JPH06337711A (ja) | ロボットの教示装置 | |
Greenyer et al. | Towards synthesizing energy-efficient controllers for modern production systems from scenario-based specifications | |
CN114603551A (zh) | 一种控制方法及电子设备 | |
Kang et al. | A task allocation and scheduling framework to facilitate efficient human-robot collaboration in high-mix assembly applications | |
Jacak et al. | CAST tools for intelligent control in manufacturing automation | |
CN115107023B (zh) | 一种真空双臂机器人的双臂独立控制方法 | |
CN112589793B (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 |