工艺约束驱动的机器人多执行机构协同控制方法、装置、设备及介质与流程

摘要: 本发明涉及机器人协同控制,尤其涉及一种工艺约束驱动的机器人多执行机构协同控制方法、装置、设备及介质。背景技术:1、现有对高维多执行机构的协同控制技术主要采用三类...
工艺约束驱动的机器人多执行机构协同控制方法、装置、设备及介质与流程

本发明涉及机器人协同控制,尤其涉及一种工艺约束驱动的机器人多执行机构协同控制方法、装置、设备及介质。

背景技术:

1、现有对高维多执行机构的协同控制技术主要采用三类控制方式:其一为固定映射控制,即将人工输入的每一个维度在硬件或底层程序上永久绑定固定的执行机构,例如左摇杆固定控制底盘、右摇杆固定控制机械臂;其二为模式切换控制,即基于有限状态机,通过按键指令切换当前响应人工输入的控制对象,实现同一输入设备对不同子系统的分时复用,例如巡视状态下摇杆控制底盘,切换后控制机械臂,再切换后控制喷头流量;其三为全自主规划控制,即机器人依赖同步定位与建图及预设轨迹算法完全自主完成作业,仅在出错时交由人工干预。

2、然而,上述三类方式均无法有效应对复杂工艺约束下的多机构强耦合协同需求:固定映射控制属于解耦控制思维,随着系统自由度增加必须成倍增加操作按键,操作人员面临极高的认知与操作负荷,且无法依靠人工实现多变量的实时同步协同(如边走边调整姿态保持贴合力);模式切换控制在同一时刻通常只有一个子系统响应输入,其余机构被锁定,其只能表达“控制谁”,无法表达“多个机构应当怎样按照工艺约束协同配合”;全自主规划控制在光照极差、存在强电磁干扰、壁面环境非结构化且动态变化大的受限空间内可靠性极低,无法替代操作人员的实时经验判断。

3、因此,如何根据当前作业工艺的约束条件动态确定并重构机器人多个执行机构之间的控制关系,在受限空间多工艺作业场景下实现多执行机构按照工艺约束的自动协同控制,成为亟待解决的问题。

技术实现思路

1、本申请的主要目的在于提供一种工艺约束驱动的机器人多执行机构协同控制方法、装置、设备及介质,旨在解决如何在受限空间多工艺作业场景下实现多执行机构按照工艺约束的协同控制的技术问题。

2、为实现上述目的,本申请提出一种工艺约束驱动的机器人多执行机构协同控制方法,包括:

3、采集人工输入设备的操作信号,对所述操作信号进行归一化处理,得到操作输入向量;

4、获取当前作业工艺对应的工艺约束集合,并采集机器人的实时状态信息;

5、根据所述工艺约束集合和所述实时状态信息,从机器人的多个执行机构中确定参与响应的目标执行机构,并确定所述目标执行机构的控制变量对应关系;

6、根据所述工艺约束集合和所述实时状态信息,建立各所述目标执行机构的控制变量之间的协同关系,并设置各所述控制变量的约束条件,生成控制关系集合;

7、根据所述控制关系集合对所述操作输入向量进行解析,得到维度高于操作输入向量维度的目标执行机构的控制变量;

8、将各所述控制变量下发至对应的所述目标执行机构,以使各所述目标执行机构按照各所述控制变量执行动作。

9、此外,为实现上述目的,本申请还提出一种工艺约束驱动的机器人多执行机构协同控制装置,所述工艺约束驱动的机器人多执行机构协同控制装置包括:

10、输入采集模块,用于采集人工输入设备的操作信号,对所述操作信号进行归一化处理,得到操作输入向量;

11、状态获取模块,用于获取当前作业工艺对应的工艺约束集合,并采集机器人的实时状态信息;

12、机构确定模块,用于根据所述工艺约束集合和所述实时状态信息,从机器人的多个执行机构中确定参与响应的目标执行机构,并确定所述目标执行机构的控制变量对应关系;

13、关系生成模块,用于根据所述工艺约束集合和所述实时状态信息,建立各所述目标执行机构的控制变量之间的协同关系,并设置各所述控制变量的约束条件,生成控制关系集合;

14、解析模块,用于根据所述控制关系集合对所述操作输入向量进行解析,得到维度高于操作输入向量维度的目标执行机构的控制变量;

15、发送模块,用于将各所述控制变量下发至对应的所述目标执行机构,以使各所述目标执行机构按照各所述控制变量执行动作。

16、此外,为实现上述目的,本申请还提出一种存储介质,所述存储介质为计算机可读介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如上文所述的工艺约束驱动的机器人多执行机构协同控制方法的步骤。

17、此外,为实现上述目的,本申请还提供一种计算机程序产品,所述计算机程序产品包括计算机程序,所述计算机程序被处理器执行时实现如上文所述的工艺约束驱动的机器人多执行机构协同控制方法的步骤。

18、本申请通过采集人工操作信号得到操作输入向量,获取工艺约束集合与机器人实时状态信息,据此确定目标执行机构及其控制变量对应关系,建立机构间协同关系与约束条件生成控制关系集合,再据此将低维操作输入向量解析为高维控制变量并下发执行,实现控制关系随工艺的动态重构。本申请无需增加人工输入维度即可实现多执行机构的工艺自适应协同控制,降低操作负荷,且新增工艺仅需扩展约束库,系统可扩展性强。

1.一种工艺约束驱动的机器人多执行机构协同控制方法,其特征在于,所述方法包括:

2.如权利要求1所述的方法,其特征在于,所述获取当前作业工艺对应的工艺约束集合,并采集机器人的实时状态信息的步骤,包括:

3.如权利要求1所述的方法,其特征在于,所述根据所述工艺约束集合和所述实时状态信息,从机器人的多个执行机构中确定参与响应的目标执行机构,并确定所述目标执行机构的控制变量对应关系的步骤,包括:

4.如权利要求1所述的方法,其特征在于,所述根据所述工艺约束集合和所述实时状态信息,建立各所述目标执行机构的控制变量之间的协同关系,并设置各所述控制变量的约束条件,生成控制关系集合的步骤,包括:

5.如权利要求1所述的方法,其特征在于,所述根据所述控制关系集合对所述操作输入向量进行解析,得到维度高于操作输入向量维度的目标执行机构的控制变量的步骤,包括:

6.如权利要求1所述的方法,其特征在于,所述将各所述控制变量下发至对应的所述目标执行机构,以使各所述目标执行机构按照各所述控制变量执行动作的步骤,包括:

7.如权利要求1所述的方法,其特征在于,所述采集人工输入设备的操作信号,对所述操作信号进行归一化处理,得到操作输入向量的步骤,包括:

8.一种工艺约束驱动的机器人多执行机构协同控制装置,其特征在于,所述装置应用于如权利要求1至7中任一项所述的工艺约束驱动的机器人多执行机构协同控制方法,所述装置包括:

9.一种工艺约束驱动的机器人多执行机构协同控制设备,其特征在于,所述设备包括:存储器、处理器及存储在所述存储器上并在所述处理器上运行的工艺约束驱动的机器人多执行机构协同控制程序,所述工艺约束驱动的机器人多执行机构协同控制程序配置为实现如权利要求1-7中任一项所述的工艺约束驱动的机器人多执行机构协同控制方法的步骤。

10.一种存储介质,其特征在于,所述存储介质上存储有工艺约束驱动的机器人多执行机构协同控制程序,所述工艺约束驱动的机器人多执行机构协同控制程序被处理器执行时实现如权利要求1-7中任一项所述的工艺约束驱动的机器人多执行机构协同控制方法的步骤。