[发明专利]多移动机器人的分布式单时滞控制器设计方法

摘要

多移动机器人的分布式单时滞控制器设计方法，步骤如下：1)根据拉格朗日方法获取单个移动机器人均为单积分的模型；2)根据模型参数建立多移动机器人系统的单时滞控制器；3)基于Lambert W函数方法，极点配置选取合适的时滞参数，然后求取使移动机器人稳定的单时滞控制器比例参数的值；4)将移动机器人的模型参数输入时延控制参数的计算单元，将控制参数输入监控模块执行预调控制程序；5)经过预调系统镇定的单时滞控制器施加于每个移动机器人，以便于对稳定的移动机器人进行协同控制。通过单时滞控制器程序调节各移动机器人之间的速度差来使整个系统达到一致，完成协同控制。

主权项

1.多移动机器人的分布式单时滞控制器设计方法，包括如下步骤：步骤1，先基于刚体运动学原理，考虑多移动机器人的输入输出等时滞的影响；根据以下步骤确定多移动机器人的模型：(11)考虑多移动机器人系统的个体皆具有单积分器模型：其中x_i(t)为多移动机器人的状态信息，u_i(t)为控制输入；(12)控制输入u_i采用下列的控制器协议：其中N_i是节点i的邻居节点,a_ij是节点i和节点j之间的权重；(13)引入单时滞控制器，相应的闭环系统表示为:其中，k_i是比例控制系数，t为时滞控制系数；步骤2，建立具有单时滞控制器矩阵带有时滞控制模型集合反馈环节是多移动机器人系统拓扑结构对应的Laplacian矩阵，系统输入为r，系统输出为y的多移动机器人反馈控制系统；其中步骤3，根据以下步骤确定能使移动机器人稳定的单时滞控制器的参数范围；(31)根据系统的Laplacian矩阵的定义，式(3)可以表示为状态空间模型的形式：其中，X(t)＝[x₁ x₂ ... x_n]^T∈Rⁿ是系统的状态信息矩阵，Γ＝KL是指被比例控制系数修改过的Laplacian矩阵；其中，K＝diag(k₁,k₂,...,k_n)是比例控制参数矩阵，L为系统的拓扑结构对应的Laplacian矩阵；由于矩阵Γ是受控制参数影响的，是由Laplacian矩阵经过几次初等行变换而来，则可以假设Γ是可对角化的，即存在非奇异矩阵T_Γ，使得T_Γ^‑1ΓT_Γ＝Λ_Γ  (5)其中，Λ_Γ是一个对角矩阵，其元素都是矩阵Γ的特征值；已知，单积分多智能体系统能达成一致的充分必要条件，是其Laplacian矩阵存在一个0特征值；对应的，矩阵Γ也应存在一个0特征值，由此可得，矩阵Λ_Γ应该具有如下的形式Λ_Γ＝diag(0,λ₂,λ₃,....λ_n)  (6)其中，0,λ₂,λ₃,....λ_n为待求的Γ的特征值；(32)针对状态空间模型(4)采用系统分解方法，假设X＝T_Γξ其中，ξ＝[ξ₁,ξ₂,...,ξ_n]^T；那么原闭环系统就可表示为由此原系统可以分解为两部分：显然，(7)的极点对系统的一致性性能有着主要的影响，其对应的特征方程为：s‑λ_je^‑st＝0,j＝2,3,....,n  (8)其中λ_j与t都对特征方程(8)的极点在复平面的位置有影响；(33)方程(8)的解可以表示为：其中W_k(s)是Lambert W方程的第k个分支；在所有的解s_k中，与主支(k＝0)相关联的解s₀的实部拥有最大值；即max[Re{W_k(H)}]＝Re{W₀(H)}其中，每一个W_k(H)都有确定的取值范围，其中主支W₀(H)的取值范围为Re{W₀(H)}≥‑1由此可以确定待求的最右极点的取值范围：在此范围内，可以任意选择合适的最右极点的取值；假设期望的(8)的最右极点为则有：根据式(11)，由于与t都已选定，则可以求出对应的λ_j的值；在确定每一个λ_j的值以后，则矩阵Λ_Γ也可以确定；由于对角矩阵Λ_Γ的元素皆为矩阵Γ的特征值，故有根据(12)，可以得到n‑1个关于(k₁,k₂,...,k_n)的方程，根据这个方程组，可确定(k₁,k₂,...,k_n)的取值；这些(k₁,k₂,...,k_n)的取值，可以将每一个子系统的最右特征根配置在期望的位置的控制器参数；步骤4，将移动机器人的模型参数输入时延控制参数的计算单元，将控制参数输入监控模块执行预调控制程序：经模拟量输入信号，经A/D装换模块将模拟信号转化为数字信号输入，将输入值与设定值进行比较可得到不同的跟踪误差按照离散域比例时延控制算式计算输出控制信号u(n)的值；其中，n为当前时刻的采样步数；u(n)计算公式如下：u(n)＝ke(n‑t)+u₀其中，u₀为控制器调节之前的输入控制信号，k是比例控制参数，e(n‑t)为采样步数为n时的时滞跟踪误差；通过对比例时滞控制器的调节减少误差以确保移动机器人的稳定运行；步骤5，将步骤4中经过预调系统镇定的单时滞控制器施加于每个移动机器人，以便于对稳定的移动机器人进行协同控制；通过单时滞控制器程序调节各移动机器人之间的速度差来使整个系统达到一致，完成协同控制。