一种面向通信时滞的机械臂系统多级优化协调控制方法技术方案

本发明专利技术提供了一种面向通信时滞的机械臂系统多级优化协调控制方法，属于机械臂系统控制技术领域，包括如下步骤：S1：将机械臂系统中的各个机械臂作为通信节点建立通信拓扑；S2：获取邻居节点的状态信息，并制定带有通信时滞的二阶机械臂系统控制模型；S3：针对机械臂在运动过程中的关节漂移及终止速度非零的问题，设计用于机械臂系统稳定运行的多级优化性能指标；S4：基于带有通信时滞的二阶机械臂系统控制模型及多级优化性能指标，设计机械臂系统的分布式控制协议；S5：在机械臂系统分布式控制协议的驱动下，完成对机械臂系统的多级优化协调控制。本发明专利技术能够完成机械臂系统的协调控制，并有效的保障机械臂系统的稳定运行和运行精度。

【技术实现步骤摘要】
一种面向通信时滞的机械臂系统多级优化协调控制方法
本专利技术涉及一种面向通信时滞的机械臂系统多级优化协调控制方法，属于机械臂系统控制
，尤其适用于面向通信时滞的机械臂系统多级优化协调控制方法。
技术介绍
随着分布式传感器、计算设备以及通信技术的快速发展，以多个机械臂组成的机械臂系统成为控制对象的工业系统在生产应用中展现出可观的效能，因而受到了产业界的广泛关注。相比于单机械臂控制系统而言，多机械臂控制系统在鲁棒性、灵活性以及经济性方面拥有诸多优势，但系统复杂性的增加提高了控制算法的设计难度。因此，研究高效且实用的多机械臂协调控制方法逐渐成为当前研究的主流。在过去的几十年里，针对机械臂系统已开展了大量的研究，但先前的工作大多在未考虑通信时滞的理想情况下展开，忽略了传感器或其它通信设备在信息传输中产生的通信延迟。然而，这些通信延迟常常会对系统的稳定性造成破坏，致使系统震荡甚至发散。此外，关节漂移及终止速度非零等问题也是机械臂系统应用中潜在的性能缺陷。值得指出，现有的控制算法大多只关注于机械臂协调运动约束的设计而忽略了机械臂本身的性能优化。未考虑性能优化的机械臂的关节角误差会随着任务的执行逐渐累积，最终导致机械臂系统的执行精度偏离预期值。因此，亟需一种面向通信时滞的机械臂系统多级优化协调控制方法来解决上述问题。
技术实现思路
针对现有机械臂控制技术中存在忽略通信延迟、关节漂移及终止速度非零等不足，本专利技术提供一种面向通信时滞的机械臂系统多级优化协调控制方法，旨在进一步提升机械臂系统控制的稳定性和准确性。为达到上述目的，本专利技术提供如下技术方案：一种面向通信时滞的机械臂系统多级优化协调控制方法，可以实现针对多个同构或者异构机械臂构成的机械臂系统的控制，包括如下步骤：S1：将机械臂系统中的各个机械臂作为通信节点建立通信拓扑；S2：针对每个机械臂，结合其在机械臂系统的通信拓扑中连通关系，获取邻居节点的状态信息，并制定带有通信时滞的二阶机械臂系统控制模型；S3：针对机械臂在运动过程中的关节漂移及终止速度非零的问题，设计用于机械臂系统稳定运行的多级优化性能指标；S4：基于带有通信时滞的二阶机械臂系统控制模型及多级优化性能指标，设计机械臂系统的分布式控制协议；S5：在机械臂系统分布式控制协议的驱动下，完成对机械臂系统的多级优化协调控制。进一步，所述的步骤S2具体为：S201：根据机械臂系统的通信协议设计需求确定通信拓扑图；S202：根据通信拓扑图确定邻接矩阵A，度矩阵D和拉普拉斯矩阵L，明确连通关系；S203：获取邻居节点的状态信息，并制定带有通信时滞的二阶机械臂系统控制模型。更进一步，步骤S201所述的通信拓扑图由节点信息V和边信息E构成，其中，各个机械臂节点集合V＝{vj|j＝1，...，p}，各个机械臂之间连通关系集合E＝{(vj，vk)|vj∈V，vk∈V}，p≥2为机械臂系统中机械臂的个数。更进一步，步骤S202所述的邻接矩阵其中，当(vj，vk)∈E时，ajk＝1，否则ajk＝0；所述的度矩阵其中，diag(·)为对角化操作；所述的拉普拉斯矩阵更进一步，步骤S203所述的制定带有通信时滞的二阶机械臂系统控制模型具体为：第j个机械臂在接收到与其连通的邻居节点机械臂的状态信息时，制定第j个机械臂带有通信时滞的二阶机械臂系统控制模型为其中：表示为3维空间中的第j个机械臂在t时刻的位移状态信息，同理，Xk为与第j个机械臂相邻的机械臂的位移状态信息；Nj为与第j个机械臂相邻的机械臂节点集合；τ为延迟时间；假设第j个机械臂含有m个关节，为第j个机械臂的雅克比矩阵，存储了第j个机械臂各个关节角速度状态信息和位移状态信息的线性关系；所有关节对应的角速度状态信息其中，为第1个关节的角位移对应的角速度；φj为第j个机械臂与中央控制器的连接权重，当第j个机械臂接收到中央控制器的指令时，φj＝1，否则，φj＝0；为中央控制器的位移控制指令在第j个机械臂上的投影，分别为第j个机械臂的末端执行器在x轴、y轴和z轴方向上的期望位移；为中央控制器的速度控制指令，为关于时间t的导数。进一步，步骤S3针对第j个机械臂所述的多级优化性能指标设计过程为：S301：设计针对关节漂移的性能指标为：其中，为设计参数，为机械臂j所有关节的角加速度，θj(0)为机械臂j所有关节的初始时刻的角度；S302：设计针对终止速度非零问题的性能指标为：其中，λ∈[0，1]为最小化角速度指标效果的权重；S303：综合针对关节漂移的性能指标和针对终止速度非零的性能指标，设计多级优化性能指标为：其中，为一个非线性映射函数，T为分配给执行中央控制器指令的时间。特别地，设计参数α、β越大越好，但是太大会增加计算量，一般选50左右较优；λ直接反映最小加速度和最小速度谁呈现主要作用，当λ＜0.5时，最小加速度占主要影响，当λ≥0.5时，最小速度占主要影响；较优地，可以通过采用深度学习等方式求得。进一步，所述的步骤S4具体为：S401：将单个机械臂的带有通信时滞的二阶机械臂系统控制模型作为约束条件、多级优化性能指标作为优化目标函数，建立单个机械臂的二次规划优化模型；S402：将所有机械臂的二次规划优化模型整合改写成机械臂系统的二次规划优化模型；S403：利用拉格朗日乘子法将机械臂系统的二次规划优化模型转化为一个非线性方程，进一步，基于该方程设计机械臂系统的分布式控制协议。更进一步，步骤S402所述的机械臂系统的二次规划优化模型为：目标函数：约束条件：其中，为机械臂系统所有关节的角位移，同理，为机械臂系统所有关节的角速度和角加速度；为机械臂系统的雅克比矩阵，为J关于时间t的导数，I3为3×3单位矩阵，为所有机械臂的位移状态信息，为中央控制器的位移控制指令，为机械臂接收指令矩阵，为元素全为1的向量，表示张量积，为xd(t)关于时间t的二次导数。更进一步，步骤S403所述的非线性方程为Θ(t)·u(t)＝η(t)；其中：为机械臂系统的系统矩阵；为状态变量向量；为机械臂系统的控制向量；其中，ξ(t)＝[ξ1，ξ2，...ξ3mp]为拉格朗日乘子向量；为性能指标向量；约束向量为所述的机械臂系统的分布式控制协议为：其中，()-1为对矩阵或向量的求逆操作。进一步，针对分布式协议计算出的状态变量控制量采用离散的差分的方式，可以实现机械臂系统全局状态信息变量的估计结果，驱动完成对机械臂系统的多级优化协调控制。本专利技术的有益效果在于：本专利技术提供了一种面向通信时滞的机械臂系统多级优化协调控制方法，通过引入时间延迟函数，综合考虑了并克服了关节漂移和终止速度非零问题，构建了多级优化性能指标，并设计了分布式控制协议，有效的实现了机械臂系统的协调控制，保证了系统控制的稳定性和准确性。附图说明为了使本本文档来自技高网...

【技术保护点】
1.一种面向通信时滞的机械臂系统多级优化协调控制方法，其特征在于，该方法包含以下步骤：/nS1：将机械臂系统中的各个机械臂作为通信节点建立通信拓扑；/nS2：针对每个机械臂，结合其在机械臂系统的通信拓扑中连通关系，获取邻居节点的状态信息，并制定带有通信时滞的二阶机械臂系统控制模型；/nS3：针对机械臂在运动过程中的关节漂移及终止速度非零的问题，设计用于机械臂系统稳定运行的多级优化性能指标；/nS4：基于带有通信时滞的二阶机械臂系统控制模型及多级优化性能指标，设计机械臂系统的分布式控制协议；/nS5：在机械臂系统分布式控制协议的驱动下，完成对机械臂系统的多级优化协调控制。/n

【技术特征摘要】
1.一种面向通信时滞的机械臂系统多级优化协调控制方法，其特征在于，该方法包含以下步骤：
S1：将机械臂系统中的各个机械臂作为通信节点建立通信拓扑；
S2：针对每个机械臂，结合其在机械臂系统的通信拓扑中连通关系，获取邻居节点的状态信息，并制定带有通信时滞的二阶机械臂系统控制模型；
S3：针对机械臂在运动过程中的关节漂移及终止速度非零的问题，设计用于机械臂系统稳定运行的多级优化性能指标；
S4：基于带有通信时滞的二阶机械臂系统控制模型及多级优化性能指标，设计机械臂系统的分布式控制协议；
S5：在机械臂系统分布式控制协议的驱动下，完成对机械臂系统的多级优化协调控制。


2.根据权利要求1所述的一种面向通信时滞的机械臂系统多级优化协调控制方法，其特征在于，所述的步骤S2具体为：
S201：根据机械臂系统的通信协议设计需求确定通信拓扑图；
S202：根据通信拓扑图确定邻接矩阵A，度矩阵D和拉普拉斯矩阵L，明确连通关系；
S203：获取邻居节点的状态信息，并制定带有通信时滞的二阶机械臂系统控制模型。


3.根据权利要求2所述的一种面向通信时滞的机械臂系统多级优化协调控制方法，其特征在于，步骤S201所述的通信拓扑图由节点信息V和边信息E构成，其中，各个机械臂节点集合V＝{vj|j＝1，…，p}，各个机械臂之间连通关系集合E＝{(vj，vk)|vj∈V，vk∈V}，p≥2为机械臂系统中机械臂的个数。


4.根据权利要求2所述的一种面向通信时滞的机械臂系统多级优化协调控制方法，其特征在于，步骤S202所述的邻接矩阵其中，当(vj，vk)∈E时，ajk＝1，否则ajk＝0；所述的度矩阵其中，diag(·)为对角化操作；所述的拉普拉斯矩阵


5.根据权利要求2所述的一种面向通信时滞的机械臂系统多级优化协调控制方法，其特征在于，步骤S203所述的制定带有通信时滞的二阶机械臂系统控制模型具体为：第j个机械臂在接收到与其连通的邻居节点机械臂的状态信息时，制定第j个机械臂带有通信时滞的二阶机械臂系统控制模型为其中：表示为3维空间中的第j个机械臂在t时刻的位移状态信息，同理，Xk为与第j个机械臂相邻的机械臂的位移状态信息；Nj为与第j个机械臂相邻的机械臂节点集合；τ为延迟时间；假设第j个机械臂含有m个关节，为第j个机械臂的雅克比矩阵，存储了第j个机械臂各个关节角速度状态信息和位移状态信息的线性关系；所有关节对应的角速度状态信息其中，为第1个关节的角位移对应的角速度；φj为第j个机械臂与中央控制器的连接权重，当第j个机械臂接收到中央控制器的指令时，φj＝1，否则...

【专利技术属性】
技术研发人员：尚明生，刘梅，彭波，张嘉政，
申请(专利权)人：中国科学院重庆绿色智能技术研究院，
类型：发明
国别省市：重庆;50