一种多冗余度机械臂系统的一致性规划方法及电子设备技术方案

本申请公开了一种多冗余度机械臂系统的一致性规划方法及电子设备，本申请首先获取领导者机械臂的结构参数并据此获得领导者机械臂的期望轨迹，进而根据实际工作目标确定二次规划问题模型，再以有向拓扑图来描述各个机械臂之间的交互关系，并利用预先构建的迭代学习网络求解算法求解得到的各个跟随者机械臂的关节角速度控制量，最后将各个关节角速度控制量传输至对应的跟随者机械臂的下位机控制器，以供下位机控制器驱动对应的跟随者机械臂进行运动，使所有机械臂的末端执行器跟随所述领导者机械臂的期望轨迹；本申请可以实现多机械臂系统的一致性规划，可广泛应用于机械臂控制领域。领域。领域。

【技术实现步骤摘要】
一种多冗余度机械臂系统的一致性规划方法及电子设备


[0001]本申请涉及机械臂控制领域，尤其是一种多冗余度机械臂系统的一致性规划方法及电子设备。

技术介绍

[0002]随着人工智能和计算机技术的不断发展，机器人系统的应用领域和范围正在不断扩大，机械臂系统渗入到我们的工作和生活中。机械臂系统在居家生活、工业制造、电力行业以及国防等领域中都扮演着重要角色。尤其在工业制造流水线中，机械臂得到了大量的应用，例如汽车流水生产线中的焊接机械臂、搬运机械臂、喷漆机械臂等。随着工业流水线的扩大和智能化，机械臂被大规模的应用。机械臂系统也由原来的单机械臂系统扩展为多机械臂系统，同时，工业流水线上的工作任务具有可重复性。多机械臂系统可广泛应用于多种产品大规模制造的任务，极大地提高生产效率，降低生产成本，增强可靠性。因此，针对在可重复性环境下的多机械臂系统的研究成为了今年来的研究热点。
[0003]多冗余度机械臂系统包含一个领导者机械臂，其余为跟随者机械臂，在这些实际的工作任务中，需要多机械臂系统的各个机械臂进行信息交互。然而，由于节约成本和实际工作环境约束，并不是所有的跟随者机械臂都可以获得领导者机械臂的信息，只有部分在领导者机械臂附近的跟随者机械臂可以获得领导者机械臂的控制命令，而剩余其他跟随者机械臂仅能通过其邻近的跟随者机械臂获得信息，以实现跟踪领导者机械臂的运动轨迹。同时，为保证多机械臂在执行任务的可重复性，也即重复运动要求机械臂的各个关节在完成一次末端轨迹闭合的周期运动之后都能回复到其初始状态，在这种情况下能保证机械臂每次周期运动的初始状态都是一致的。对于领导者机械臂需要采用逆运动学方程和重复运动指标获得实现跟踪期望轨迹的最优关节角度，跟随者机械臂通过通信网络学习得到领导者机械臂的最优关节角度。
[0004]传统的冗余度机械臂的运动学求解方法是基于伪逆的方法。然而，由于伪逆方法需要计算矩阵的逆，并且冗余度机械臂在实际应用中面临的任务越来越多样化，所以在实际应用中难以实时处理较为复杂的任务。相较于伪逆方法，基于二次规划的优化方案的机械臂的运动规的方法应用更为广泛。相关技术提出了一种递归神经网络求解器，称作零化神经网络，该求解器被用来求解时变的二次规划问题，并用于求解冗余度机械臂运动规划问题。由于利用了参数的导数信息，零化神经网络能够成功求得时变二次规划问题的最优解。然而，这种传统的零化神经网络只能在无限时间内逼近理论最优解，且该方法无法实现在有限工作时间内的多机械臂系统的一致性控制。为实现可重复性的多机械臂系统的一致性规划，迭代学习控制，作为一种常用于重复运动机器人系统的控制方案，应用到多机械臂系统的一致性二次规划问题的求解中。并且，在基于迭代学习的多冗余度机械臂系统的一致性规划还没有相关的文献进行研究。迭代学习网络的输入考虑了各个跟随者机械臂的一致性误差，在不断重复同一期望轨迹的跟踪任务中，不仅可以实现领导者机械臂跟踪期望轨迹的任务，还可以实现跟随者机械臂在有限时间内跟踪上领导者机械臂的轨迹。

技术实现思路

[0005]有鉴于此，本申请提供一种多冗余度机械臂系统的一致性规划方法及电子设备，以实现领导者机械臂跟踪期望轨迹的任务，且实现跟随者机械臂在有限时间内跟踪上领导者机械臂的轨迹。
[0006]本申请的一方面提供了一种多冗余度机械臂系统的一致性规划方法，包括：
[0007]S1：从多冗余度机械臂系统中获取领导者机械臂的结构参数，并根据所述结构参数建立所述领导者机械臂的逆运动学方程，以获得所述领导者机械臂的期望轨迹；
[0008]S2：根据冗余度机械臂系统的实际工作目标，确定以重复运动指标作为性能指标的时变二次规划问题模型；
[0009]S3：根据冗余度机械臂系统中各个机械臂的通信网络结构，以有向拓扑图来描述冗余度机械臂系统中所述领导者机械臂与各个跟随者机械臂的交互关系，以及各个跟随者机械臂之间的交互关系；
[0010]S4：获取预先构建的迭代学习网络求解算法，并根据所述迭代学习网络求解算法求解得到的各个跟随者机械臂的关节角速度控制量，所述迭代学习网络求解算法为根据冗余度机械臂系统的可重复特性构建得到；
[0011]S5：将各个所述关节角速度控制量传输至对应的跟随者机械臂的下位机控制器，以供下位机控制器驱动对应的跟随者机械臂进行运动，使所有机械臂的末端执行器跟随所述领导者机械臂的期望轨迹。
[0012]可选地，步骤S1包括：
[0013]从多冗余度机械臂系统中获取领导者机械臂的雅克比矩阵和关节角速度变量，作为结构参数；
[0014]根据所述雅克比矩阵和关节角速度变量建立所述领导者机械臂的逆运动学方程如下：
[0015][0016]其中，J
L
(t)∈R
m
×
n
表示所述领导者机械臂的雅克比矩阵，x0(t)∈R
n
表示所述领导者机械臂的关节角速度变量，表示所述领导者机械臂期望轨迹的时间导数。
[0017]可选地，步骤S2包括：
[0018]确定以重复运动指标作为性能指标的时变二次规划问题模型，所述时变二次规划问题模型如下：
[0019][0020][0021]其中，N表示机械臂的总个数，x
j
(t)∈R
n
表示第j个机械臂的关节角速度向量，b
j
(t)∈R
n
×1表示系数向量，H
j
(t)∈R
n
×
n
表示一个正定对称的系数矩阵。
[0022]可选地，所述方法还包括：
[0023]利用惩罚函数法将所述时变二次规划问题模型等价变换为无约束优化问题，所述无约束优化问题如下：
[0024][0025]其中，σ＞＞0表示惩罚因子，J
L,v
(t)∈R1×
n
表示矩阵J
L
(t)的第v行,y
d,v
(t)∈R1表示向量y
d
(t)的第v行。
[0026]可选地，步骤S3包括：
[0027]利用第一有向拓扑图表示包含所述领导者机械臂的冗余度机械臂系统的交互关系；其中，所述第一有向拓扑图表示为节点“0”表示所述领导者机械臂，节点“1”～节点“N”表示各个所述跟随者机械臂；
[0028]利用第二有向拓扑图表示只有所述跟随者机械臂的冗余度机械臂系统的交互关系；其中，所述第二有向拓扑图表示为G＝(V,E)，V＝{1,2,L,N}表示所述跟随者机械臂对应的节点集合，表示无领导者机械臂的拓扑图中的边集合；
[0029]利用矩阵描述所述跟随者机械臂是否获得所述领导者机械臂的信息关系；其中，所述矩阵表示为S＝diag(s1,s2,L,s
N
)，s
j
＝1表示所述跟随者机械臂可以获得所述领导者机械臂的信息，s
j
＝0表示所述跟随者机械臂无法获得所述领导者机械臂的信息。<本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种多冗余度机械臂系统的一致性规划方法，其特征在于，包括：S1：从多冗余度机械臂系统中获取领导者机械臂的结构参数，并根据所述结构参数建立所述领导者机械臂的逆运动学方程，以获得所述领导者机械臂的期望轨迹；S2：根据冗余度机械臂系统的实际工作目标，确定以重复运动指标作为性能指标的时变二次规划问题模型；S3：根据冗余度机械臂系统中各个机械臂的通信网络结构，以有向拓扑图来描述冗余度机械臂系统中所述领导者机械臂与各个跟随者机械臂的交互关系，以及各个跟随者机械臂之间的交互关系；S4：获取预先构建的迭代学习网络求解算法，并根据所述迭代学习网络求解算法求解得到的各个跟随者机械臂的关节角速度控制量，所述迭代学习网络求解算法为根据冗余度机械臂系统的可重复特性构建得到；S5：将各个所述关节角速度控制量传输至对应的跟随者机械臂的下位机控制器，以供下位机控制器驱动对应的跟随者机械臂进行运动，使所有机械臂的末端执行器跟随所述领导者机械臂的期望轨迹。2.根据权利要求1所述的一种多冗余度机械臂系统的一致性规划方法，其特征在于，步骤S1包括：从多冗余度机械臂系统中获取领导者机械臂的雅克比矩阵和关节角速度变量，作为结构参数；根据所述雅克比矩阵和关节角速度变量建立所述领导者机械臂的逆运动学方程如下：其中，J
L
(t)∈R
m
×
n
表示所述领导者机械臂的雅克比矩阵，x0(t)∈R
n
表示所述领导者机械臂的关节角速度变量，表示所述领导者机械臂期望轨迹的时间导数。3.根据权利要求1所述的一种多冗余度机械臂系统的一致性规划方法，其特征在于，步骤S2包括：确定以重复运动指标作为性能指标的时变二次规划问题模型，所述时变二次规划问题模型如下：模型如下：其中，N表示机械臂的总个数，x
j
(t)∈R
n
表示第j个机械臂的关节角速度向量，b
j
(t)∈R
n
×1表示系数向量，H
j
(t)∈R
n
×
n
表示一个正定对称的系数矩阵。4.根据权利要求3所述的一种多冗余度机械臂系统的一致性规划方法，其特征在于，所述方法还包括：利用惩罚函数法将所述时变二次规划问题模型等价变换为无约束优化问题，所述无约束优化问题如下：
其中，σ＞＞0表示惩罚因子，J
L,v
(t)∈R1×
n
表示矩阵J
L
(t)的第v行,y
d,v
(t)∈R1表示向量y
d
(t)的第v行。5.根据权利要求4所述的一种多冗余度机械臂系统的一致性规划方法，其特征在于，步骤S3包括：利用第一有向拓扑图表示包含所述领导者机械臂的冗余度机械臂系统的交互关系；其中，所述第一有向拓扑图表示为节点“0”表示所述领导者机械臂，节点“1”～节点“N”表示各个所述跟随者机械臂；利用第二有向拓扑图表示只有所述跟随者机械臂的冗余度机械臂系统的交互关系；其中，所述第二有向拓扑图表示为G＝(V,E)，V＝{1,2,L,N}表示所述跟随者机械臂对应的节点集合，表示无领导者机械臂的拓扑图中的边集合；利用矩阵描述所述跟随者机械臂是否获得所述领导者机械臂的信息关系；其中，所述矩阵表示为S＝diag(s1,s2,L,s
N
)，s
j
＝1表示所述跟随者机械臂可以获得所述领导者机械臂的信息，s
j
＝0表示所述跟随者机械臂无法获得所述领导者机械臂的信息。6.根据权利要求5所述的一种多冗余度机械臂系统的一致性规划方法，其特征在于，步骤S4包括：S4.1：先利用变量i∈Z
+
来描述冗余度机械臂系统的任务重复次数，再利用变量t∈[0,T]来描述任务时间；将所有机械臂的关节角速度向量组合为：x(t,i)＝(x0(t,i)
T
,x1(t,i)
T
,L,x
N
(t,i)
T
)
T
∈R
n(N+1)
S4.2：对所述领导...

【专利技术属性】
技术研发人员：肖腾飞，杨松，韩瑜，钱军，
申请(专利权)人：中山大学，
类型：发明
国别省市：