Processing math: 7%

上海交通大学学报, 2022, 56(7): 868-876 doi: 10.16183/j.cnki.jsjtu.2021.186

电子信息与电气工程

基于扰动块的柔性臂分布式滚动时域估计

徐晨辉, 俞芳慧, 何德峰,

浙江工业大学 信息工程学院, 杭州 310023

Disturbance-Blocking-Based Distributed Receding Horizon Estimation of Flexible Joint Robots

XU Chenhui, YU Fanghui, HE Defeng,

College of Information Engineering, Zhejiang University of Technology, Hangzhou 310023, China

通讯作者: 何德峰,男,教授,博士生导师,电话(Tel.):0571-88320367;E-mail:hdfzj@zjut.edu.cn.

责任编辑: 石易文

收稿日期: 2021-06-2  

基金资助: 国家自然科学基金(61773345)
浙江省高校基本科研业务费项目(RF-C2020003)

Received: 2021-06-2  

作者简介 About authors

徐晨辉(1996-),男,浙江省宁波市人,博士生,研究方向为鲁棒滚动时域估计.

摘要

针对柔性机械臂因在实际运动过程中易发生变形而需进行状态监测的问题,提出一种基于扰动块的分布式滚动时域估计算法.在分布式一致性滚动时域估计的基础上,通过设计扰动块并将其应用于估计窗口内的过程扰动序列,减少了与优化相关的变量,从而降低了算法的计算量,实现快速性.通过分析算法在最大分块长度下的可行性与收敛性,建立了保证算法的优化问题存在等价解的假设条件,并将结果推广到了过程扰动任意分块的情况.仿真结果表明:与不加扰动块的算法相比,所提算法能在不影响估计误差的前提下有效缩短计算时间.

关键词: 柔性机械臂; 状态估计; 滚动时域估计; 分布式估计; 扰动块

Abstract

Considering the state monitoring problem of flexible joint robots (FJRs) caused by the easy deformation in practice, a distributed receding horizon estimation algorithm based on disturbance blocks is proposed. Based on distributed consistent receding horizon estimation, the proposed algorithm reduces the computational amount and achieves rapidity by designing the disturbance block and applying it to the process disturbance sequence in the estimation window to reduce the variables related to optimization. By analyzing the feasibility and convergence of the proposed algorithm based on the maximum block length, the assumptions are made under which the existence of equivalent solution to the optimization problem of the algorithm is guaranteed, and the results are extended to the case that the process disturbance can be divided into arbitrary blocks. The simulation results show that the proposed algorithm can effectively shorten the computation time without affecting the estimation error compared with the algorithm without disturbance blocks.

Keywords: flexible joint robots (FJRs); state estimation; receding horizon estimation; distributed estimation; disturbance blocks

PDF (1332KB) 元数据 多维度评价 相关文章 导出 EndNote| Ris| Bibtex  收藏本文

本文引用格式

徐晨辉, 俞芳慧, 何德峰. 基于扰动块的柔性臂分布式滚动时域估计[J]. 上海交通大学学报, 2022, 56(7): 868-876 doi:10.16183/j.cnki.jsjtu.2021.186

XU Chenhui, YU Fanghui, HE Defeng. Disturbance-Blocking-Based Distributed Receding Horizon Estimation of Flexible Joint Robots[J]. Journal of Shanghai Jiaotong University, 2022, 56(7): 868-876 doi:10.16183/j.cnki.jsjtu.2021.186

近年来,柔性机械臂由于质量轻、可操作性强、安全性好等优点,引起了研究人员的高度关注[1-5],在航空[6]、医疗[7]、车载[8]等多个领域得到了广泛应用.由于其自身材质等原因,柔性机械臂在运动过程中易产生弯曲、剪切等变形情况,进而会影响精度.所以在实际应用(尤其是航空、医疗等安全性要求极高的应用)中有必要对柔性机械臂的状态进行监测,通常可利用传感器测量来获得柔性臂的各个状态.然而传感器往往带有测量噪声,进而降低测得信息的准确度.此外,运行过程中产生的振动、移位等因素都会对系统造成不确定扰动,进而影响真实状态的测量.

处理上述问题的一种常用方法是状态估计,目前大量研究针对柔性臂设计了多种不同的观测器[9-11].文献[9]提出了一种扰动观测器,用于估计柔性臂电机侧的不确定性.文献[10]针对柔性臂存在不确定性和控制器所需状态不可测的问题,研究了基于径向基函数神经网络的观测器来估计系统的控制变量.柔性臂由于硬件设计方面的原因通常带有物理约束,然而上述观测器均没有考虑此类约束问题.近年来,滚动时域估计(MHE)由于可充分利用约束条件中包含的系统扰动信息和状态信息,成为了处理约束下动态系统估计问题的一种有效方法[12].考虑具有多采样速率的移动机器人,文献[13]提出了一种基于滚动时域的机器人状态估计算法.文献[12] 和[14]针对系统不同类型的时延问题,提出了相应的滚动时域估计算法.

与集中式滚动时域估计[12-18]相比,分布式滚动时域估计凭借运算速度快、可伸缩性强、容错能力好等优点, 成为了估计领域的重点研究对象之一[19-24].在分布式框架下,相邻的局部估计器之间可通过信息交互来提升各自的估计性能.文献[19]通过对相邻节点的先验估计进行融合,提出了一种分布式滚动时域估计算法.在弱可观测条件下,该算法中所有节点的估计均可收敛于实际值.文献[20]在文献[19]的基础上通过对到达成本进行多步融合,保证了局部估计误差的一致性,提高了估计的瞬态性和稳定性.文献[22-23]研究了分布式滚动时域估计在传感器网络中的共识策略.文献[24]提出了处理网络时延和丢包问题的分布式滚动时域估计算法.

目前,绝大多数分布式滚动时域估计的研究都围绕整个系统模型展开,导致算法的计算量高度依赖于系统模型的复杂度.当系统规模扩大时,算法每个时刻的计算量也会随之增加.另一方面,基于滚动优化原理的模型预测控制也存在同样的问题.文献[25]发现通过引入“块”技术,可有效减少模型预测控制算法中优化变量的数量,进而降低算法的计算复杂度,减少在线计算占用的资源.文献[26]提出了输入分块(IB)、偏移量分块(OB)、增量输入分块(DIB)、增量偏移分块(DOB)等多种“块”策略.文献[27-28]设计了新的块结构与约束条件,从而保证了块策略下模型预测控制算法的可行性与稳定性.文献[29]成功将带有块策略的模型预测控制算法应用到实际生产过程中.

受上述研究启发,本文通过将块策略和分布式滚动时域估计结合,提出了一种基于扰动块的快速分布式滚动时域估计算法,并将其应用于柔性机械臂的状态监测过程.主要贡献有:① 将块策略应用于滚动估计窗口的过程扰动序列,减少了与优化问题相关的扰动变量,从而降低了计算量;② 基于系统状态方程,通过设计新的约束条件,建立了保证所提算法的优化问题具有等价解的假设条件,并将结果推广到了扰动任意分块的情况;③ 与未加入块结构的算法相比,所提算法可以有效缩短计算时间,同时不改变其在估计误差方面的性能.

1 问题描述

考虑如图1所示的单自由度柔性机械臂,其中:q1,q2分别为对应两个连接点的转角角度;m为连杆质量;L为连杆质心到关节的长度;JL为柔性臂转动惯量;K为关节刚度系数;JR为转子转动惯量.取 x=[q1·q1q2·q2]T为状态变量,u为已知控制输入,柔性机械臂线性状态方程可表示为[1]

·x=Ax+Bu
(1)

式中:A为系统状态矩阵;B为输入矩阵.

图1

图1   单自由度柔性机械臂

Fig.1   Single-freedom flexible joint robot


考虑运动过程中带有的不确定性扰动w∈R4,Raa维实数集,采用一阶前向差分法对式(1)进行离散化,可得如下带有过程噪声的离散线性状态方程:

xt+1=A'xt+B'ut+wt
(2)

式中:

A'= [1Ts00(-mgL-K)Ts/JL1KTs/JL0001TsKTs/JR0-KTs/JR1]
B'=[000Ts/JR]

Ts为系统离散化周期,g为重力加速度;t为时刻;utt时刻的控制输入;wt为逆协方差矩阵为Q的高斯白噪声.xtwt满足约束条件 xtX, wtW,XW为已知紧凸集.

考虑使用M个传感器测量柔性臂的状态,传感器之间通过网络相连.传感器网络的通信拓扑可由(E, ε) 表示,其中E={1, 2, …, M}为拓扑中传感器节点的集合, εE×E为拓扑中连接传感器节点的边的集合.对于传感器i,Ei为其邻居传感器集合.传感器节点iEt时刻的测量模型如下所示:

yit=Cixt+ vit
(3)

式中:yit∈R为t时刻第i个传感器的测量输出;Ci为已知测量矩阵;vit∈R为t时刻第i个传感器的测量噪声,同时假设其为逆协方差矩阵为γi的高斯白噪声.对于所有iE,测量噪声vit与过程扰动wt不相关,且满足约束条件vitV,V为已知紧凸集.

关于柔性臂的分布式状态估计问题可描述为在t时刻,每个传感器节点iE基于本地测量值yi0,yi1, …,yit,以及从所有邻居传感器节点jEi处接收到的信息,估计系统状态xt.

2 主要结果

以传感器节点i为例,基于分布式全信息估计(DFIE)的柔性臂系统状态估计问题可表示为以下二次规划问题:

min˜xi0,{˜wik}t-1k=0φit=+k=0tv~kiγi2+ jEik=0tv~kjγj2+k=0t-1w~kiQ2
(4)
s.t.x~k+1i=A'x~ki+B'uk+w~kiXv~kj= ykj-Cjx~ki∈V,jEi∪{i}, kI0:tw~kiW, kI0: t-1
(5)

式中:正定矩阵P0为先验状态x-0的逆协方差矩阵;Ia: b为整数集合{n|anb};x~0iw~ki分别为传感器节点i对系统状态x0和过程扰动wk的估计;v~kj为传感器节点j的测量噪声vkj的估计值;(x-0,P0)为传感器节点i对系统状态x0的先验信息.则(x~0i*, {w~ki*}k=0t-1)为式(4)在t时刻的最优解.基于最优解和式(2),可获得最优状态估计序列{x~ki*}k=0t.

全信息估计利用从初始时刻到当前时刻所有的测量数据生成状态估计,其计算量会随时间持续增大,因此这种估计方法被称为计算难解.为避免全信息估计带来的计算负担,通过使用滚动窗口中的信息替换过去的“完整信息”[12],滚动时域估计将计算范围限制在了离当前时刻最近的固定时域内.然而MHE的计算量仍然与系统模型维度成正相关,且随窗口长度增大而增大.

针对此问题,本文引入“块”策略,通过在估计窗口的过程扰动估计序列中设计扰动块结构,令块结构内的扰动值相等以减少优化变量个数,降低计算量.t时刻传感器节点i估计窗口内基于块结构的扰动示意图如图2所示.其中:估计窗口内第N个扰动w^t-1i单独为一块,而前N-1个扰动可任意分块;S为前N-1个扰动的分块总数,满足SI1:N-1;ln为估计窗口内第n个扰动块,nI1:S;dn为扰动块长度,满足dnI1:N-1.w^ti,n为同个扰动块内的优化变量值,其值相等;{w-ti,w^t-1i}为估计窗口内分块后的扰动序列,w-ti={1d1\otimesw^ti,1,1d2\otimesw^ti,2, …,1dS\otimesw^ti,S},1a为由a个1构成的行向量;\otimes为克罗内克积.由此,将估计窗口内每一时刻需要求解的扰动变量个数减少至原来的(S+1)/N,降低了计算量.特别地, S=N-1等价于未分块的情况.

图2

图2   基于块结构的扰动示意图

Fig.2   Diagram of blocking-based disturbance


通过将“块”结构引入分布式滚动时域估计,可得如下带有扰动块的分布式滚动时域估计:

minx^t-Ni,{w^ti,n}n=1S,w^t-1iΦti=Fti+k=t-Nt-1w^kiQ2+ k=t-Ntv^kiγi2+k=t-NtjEiv^kjγj2s.t.x^k+1i=A'x^ki+B'uk+w^ki, kIt-N: t-1x^t-1iX,x^tiX, iE
(6)
{ w^ki}k=t-Nt-1}={ w-ti, w^t-1i}, w^t-1i∈W v^kj=ykj-Cjx^kiV,kIt-1: t, jEi∪{i}
(7)

式中:x^ki,{w^ti,n}n=1Sw^t-1i分别为k时刻系统状态估计和时域[t-N, t-1]内扰动的估计(x~kix^ki都表示状态估计,区别是求解的算法不同);Fti为到达代价,定义如下[20]:

Fti= jEi{i}πi,jx^t-Ni-x-t-NjPt-Nj2
(8)

其中:x-t-NjPt-Nj总结了传感器节点jt-N时刻之前的历史信息,并将其概括为对t-N时刻系统状态的先验估计x-t-Nj及其逆协方差矩阵Pt-Nj;πi, j为共识权重,满足:

jEi{i}πi,j=1, π i,j≥0,∀iE, jEi∪{i}
(9)

用于融合传感器节点i及其所有邻居传感器节点的到达代价.参考文献[20]的共识策略,在每个估计时刻对到达代价进行多次加权融合,以扩展信息的交换.

本文将分析加入扰动块与新约束后分布式滚动时域估计算法的可行性和收敛性,并给出先验估计x-t-Ni和逆协方差矩阵Pt-Ni的迭代方程.

基于已有研究,未加入扰动块的分布式滚动时域估计算法的稳定性分析可参考文献[20].然而在估计窗口内引入块结构,并强制令块内的扰动值相等后,算法的可行性与收敛性便难以保证.本文所设扰动块结构中,对于估计窗口内前N-1个扰动可任意分块,通过加入新约束,设计与未加入块结构时等价的最优解来保证其估计性能,令估计窗口内最后一个过程扰动单独不分块,保证当前时刻状态的可行性.首先分析最大分块长度情况(S=1),即估计窗口内前N-1个扰动为1块,第N个扰动为1块,基于最大分块长度块结构的扰动示意图如图3所示.之后,将最大分块长度的分析结果推广至前 N-1个扰动可任意分块的情况.

图3

图3   基于最大分块长度块结构的扰动示意图

Fig.3   Diagram of disturbance based on maximum blocking


最大分块长度下的分布式滚动时域估计问题可描述为以下二次规划问题:

minx^t-Ni,w^ti,1,w^t-1iΦti=Fti+k=t-Nt-1w^kiQ2+ k=t-Ntv^kiγi2+k=t-NtjEiv^kjγj2s.t.x^k+1i=A'x^ki+B'uk+w^ki,kIt-N: t-1
(10)
x^t-1iX,x^tiX, iE} w^ki}k=t-Nt-1={ 1d1\otimes w^ti,1, w^t-1i}, w^t-1iWv^kj=ykj-Cjx^kiV,kIt-1: t, jEi∪{i}
(11)

在进一步讨论式(10)描述的优化问题之前,先给出下列定义和假设.

定义1 当t>N时,对满足约束的x~t-NX,{w~k}k=t-Nt-2W,若存在x^t-NX和{w^k}k=t-Nt-2,使等式x~t-1=AN-1x~t-N+k=t-Nt-2At-k-1w~k=AN-1x^t-N+k=t-Nt-2At-k-1w^k成立,则称(x^t-N, {w^k}k=t-Nt-2)为等价于(x~t-N, {w~k}k=t-Nt-2)的满足约束的系统等价解.

假设1 式(2)描述的柔性臂系统中,状态矩阵A' 满足:

rank (k=t-Nt-2(A')t-k-1|k=t-Nt-2(A')t-k-1wk)=rank(k=t-Nt-2(A')t-k-1)≤rank(A')

式中:扰动序列{wk}k=t-Nt-2W.

假设2 式(2)描述的系统满足全局能观要求,即(C,A')可观,其中C=col(Ci; iE).

假设3 传感器网络拓扑(E, ε)为强连接,即任意两个传感器节点i, jE之间均存在有向路径.

基于上述假设,定理1给出了最大分块长度下分布式滚动时域估计的可行性与收敛性分析.

定理1 若假设1~3成立,则式(10)描述的优化问题可行且收敛.

证明 当tN时,分布式全信息估计存在可行解x~0i,{w~ki}k=0N-1,可得状态估计序列{x~ki}k=0NX.t>N时,未分块的分布式滚动时域估计存在可行解x~t-NiX和{w~ki}k=t-Nt-1W,可得t时刻状态估计x~tiX.考虑式(10),估计窗口内前N-1个扰动分为一块,满足w^t-Ni=w^t-N+1i=…=w^t-2i,第N个扰动w^t-1i单独不分块,基于假设1,式(10)描述的优化问题可找到等价解:

x^t-Ni=x~t-NiX

k=t-Nt-2(A')t-k-1w^ki=k=t-Nt-2(A')t-k-1w~ki

{w^ki}k=t-Nt-2W

进而可得:

x^t-1i=(A')N-1x~t-Ni+k=t-Nt-2(A')t-k-1w~ki=

(A')N-1x^t-Ni+k=t-Nt-2(A')t-k-1w^kiX

根据定义1,可得式(10)的解等价于未分块时分布式滚动时域估计的优化问题的解.进一步,当 t>N,对任意iE,先验估计x-t-Ni和加权矩阵Pt-Ni的迭代方程可参考文献[20],即

x-t-Ni=A' x^t-N-1i*
(12)
Pt-Ni= α8[A'(Ωt-N-1i)-1(A')T-1]-1
(13)

其中:

\begin{aligned} \boldsymbol{\Omega}_{t-N}^{i}=& \pi_{j \in E}^{i, j} \boldsymbol{P}_{t-N}^{j}+\boldsymbol{\Lambda}^{i} \\ \boldsymbol{\Lambda}^{i}=&\left(\boldsymbol{L}^{i}\right)^{\mathrm{T}} \boldsymbol{\psi}^{i} \boldsymbol{L}^{i}-\\ &\left(\boldsymbol{L}^{i}\right)^{\mathrm{T}} \boldsymbol{\psi}^{i} \boldsymbol{H}^{i}\left[\left(\boldsymbol{H}^{i}\right)^{\mathrm{T}} \boldsymbol{\psi}^{i} \boldsymbol{H}^{i}+2 \tilde{\boldsymbol{\omega}}\right]^{-1}\left(\boldsymbol{H}^{i}\right)^{\mathrm{T}} \boldsymbol{\psi}^{i} \boldsymbol{L}^{i} \\ \boldsymbol{\psi}^{i}=& \operatorname{diag}(\underbrace{\left(\boldsymbol{\gamma}^{i}, \boldsymbol{\gamma}^{i}, \cdots, \boldsymbol{\gamma}^{i}\right)}_{N+1}\\ \tilde{\boldsymbol{\omega}}=& \operatorname{diag}(\underbrace{\boldsymbol{Q}, \boldsymbol{Q}, \boldsymbol{Q}}_{N}) \end{aligned}

Hi=000Ci00CiA'Ci0Ci(A')N-1Ci(A')N-2Ci

Li=[CiCiA'Ci(A')N]T

式中:x^t-N-1i*t-1时刻的状态最优解;α为区间(0, 1)的标量;矩阵ϑ为正定矩阵; 0为合适维度的零矩阵;初始矩阵P0i正定.取估计误差et-Ni=xt-N-x^t-Ni,由文献[20]可得,et-Ni一致有界,即存在一常数ζ >0,使得‖eti‖≤ζ, ∀iE, t≥0.特别地,若 wt=0,vti=0,则limteti‖=0, iE.综上可得,式(10)的优化问题可行且收敛.

在定理1的基础上,将分析结果推广到过程扰动任意分块的情况,如推论1所示.

推论1 基于假设1~3,若将估计窗口内前N-1个扰动分为S块,SI1:N-1,则式(6)的优化问题可行且收敛.

证明 当S=1时,由定理1可得式(6)的优化问题可行且收敛.由块结构的原理可得,当S=1时,式(6)的解可作为S=2, 3, …, N-1时的一组可行解,即当S=2, 3, …, N-1时,式(6)至少存在一组可行解.参考定理1的证明过程可得,当S=2, 3, …, N-1时,式(6)可行且收敛.

综上所述,算法1总结了基于扰动块的分布式滚动时域估计的步骤.

算法1

(1) 初始化.在t=0时所有传感器节点存储先验估计x-0和逆协方差矩阵P0,并设定估计窗口长度N、扰动块总数S及每块长度dn,其中SI1:N-1,nI1:S,n=1Sdn=N-1.

(2) 当1≤tN,窗口长度N=t,所有传感器节点运行分布式全信息估计算法,求解式(4);当t>N时,传感器节点运行基于块结构的分布式滚动时域估计算法,求解式(6).

(3) 基于最优解以及式(2),计算t时刻的最优状态估计.

(4) 当t>N,所有传感器节点根据式(12)和(13)计算下一时刻的逆协方差矩阵Pt-N+1i和先验估计x-t-N+1i.

3 仿真验证

结合式(2)的单自由度柔性机械臂系统模型,取m=1 kg,g=9.8 m/s2,K=100 N·m,L=1 m,JL=JR=1 kg·m2,Ts=0.3 s,可以得到如下所示的4阶系统:

xt+11xt+12xt+13xt+14= 0.16450.099920.59800.17126.23260.1645-7.20430.59800.59800.17120.22310.1159-7.20430.59805.52660.2231xt1xt2xt3xt4+0.01830.17120.02600.1159ut+wt1wt2wt3wt4

采用常规模型预测控制算法设计控制输入u,使得状态分量x1,x3的轨迹跟踪周期为240、幅值为20的余弦曲线.因运行过程中考虑扰动,扰动由协方差Q-1=diag[0.0012 0.038 0.0012 0.038]的高斯白噪声表示,且满足约束-2≤wc≤2,c=1, 2, 3, 4.系统初始状态x0=[20 0 20 0]T,状态满足约束-22≤x1≤22,-22≤x3≤22.到达代价的初始协方差P0-1=100I4(I4为4×4维的单位矩阵),先验初始状态x-0服从均值为x0、协方差为P0-1的正态分布.

采用如图4所示的传感器网络拓扑,其中:箭头方向表示传感器间信息可传递的路径;传感器1~4分别测量状态分量x1~x4.测量模型如下所示:

yt1=[1000]xt+vt1

yt2=[0100]xt+vt2

yt3=[0010]xt+vt3

yt4=[0001]xt+vt4

其中:测量噪声vi为协方差γi=1的高斯白噪声.1号传感器可接收4号传感器的测量数据,故1号传感器可获得关于状态分量x1x4的信息;同理,2号、3号、4号传感器可分别获得关于状态分量x1x2x2x3x3x4的信息.

图4

图4   传感器网络

Fig.4   Sensor network


取滚动时域窗口长度N=6,采用以下3种基于不同扰动块的分布式滚动时域估计算法.

算法 I 将估计窗口内每个扰动单独分块(S=N-1),其等价于不加入块结构的分布式滚动时域估计算法.

算法 II 将估计窗口内的扰动分为3块(S=2),每块长度分别取d1=3,d2=2,d3=1,分块方式满足本文所设条件.

算法 III 将估计窗口内的扰动分为2块(即最大分块长度情况S=1),最后一个扰动单独为1块,前N-1个扰动为1块.

首先以算法 III 为例,仿真验证了本文所提算法的有效性.其次,结合上述3种算法,仿真对比了不同分块形式对算法估计性能和计算时间的影响.所有仿真均由MATLAB R2016b完成,搭配MS Windows 10 操作系统、2.4 GHz Intel(R) Core(TM) i5-4210U CPU及4 GB内存.

图56分别为基于算法III的柔性臂状态轨迹估计和估计误差,其中: ec为状态分量xc的估计误差.表1所示为各个传感器节点对各个状态分量估计的均方根误差(RMSE).由图56可以看出,基于算法 III,每个传感器节点能有效估计柔性臂的各个状态分量,且估计误差保持在固定范围内.由表1可知,针对同个状态分量,所有传感器节点的估计误差趋向于一致,这得益于所提算法采用的共识策略,即式(5)和(6).通过在每个时刻对到达代价进行多次融合,本地传感器节点可间接获得非邻居传感器节点的估计信息,进而提高估计的一致性.

图5

图5   状态轨迹估计

Fig.5   Estimates of state trajectory


图6

图6   估计误差

Fig.6   Estimation errors


表1   基于算法Ⅲ状态分量估计的均方根误差

Tab.1  RMSEs of state component estimation based on algorithm III

状态
分量
传感器1
误差
传感器2
误差
传感器3
误差
传感器4
误差
x10.23320.22390.22660.2324
x21.56891.26591.25331.5555
x30.22770.24020.24410.2301
x41.22411.45181.46051.2418

新窗口打开| 下载CSV


对比算法 I、算法 II 和算法 III 各自所需计算时间及其估计性能,仿真结果如图78所示,其中:eaj为传感器对状态分量xj的平均估计误差;t'为每个传感器节点的平均计算时间.表2所示为不同算法下状态估计的均方根误差以及每个传感器节点的平均计算时间(ACT).

图7

图7   不同算法下状态分量平均估计误差对比

Fig.7   Comparison of average estimation errors of state component based on different algorithms


图8

图8   不同算法平均计算时间对比

Fig.8   Comparison of ACTs of different algorithms


表2   不同算法平均计算时间与均方根误差对比

Tab.2  Comparison of ACTs and RMSEs of different algorithms

算法传感器1
ACT/s
传感器2
ACT/s
传感器3
ACT/s
传感器4
ACT/s
RMSE
I1.01011.02721.02221.00620.8318
II0.43270.43820.43740.43730.8318
III0.30930.30720.30510.30410.8318

新窗口打开| 下载CSV


结合图7表2的RMSE值可以发现,基于不同分块形式的分布式滚动时域估计算法的平均估计误差基本相同,这是因为本文所提算法的优化问题的解与未分块的具有等价性.通过对比图8表2中算法所需的平均计算时间可知,分块形式对算法的计算时间有显著影响.在计算时间方面,算法 I>算法 II>算法 III,这是由于算法 I 将每个扰动单独分为1块,从而每一时刻需求解28个变量;算法 II 将扰动分为3块,从而每一时刻需求解16个变量;算法 III 将最后一个扰动单独分为1块,其余扰动为另一块,从而每一时刻只需求解12个变量.这使得在每一时刻的计算量方面,算法 I>算法 II>算法 III.由此, 说明了算法估计窗口中扰动分块的数量越少,每一时刻需求解的变量就越少,所需计算时间就越短.结合图78表2可以发现,与未分块的分布式滚动时域估计算法相比,本文所提算法可以在不增大估计误差的基础上有效缩短计算时间,从而提高计算效率.

4 结语

本文研究了基于扰动块的快速分布式滚动时域估计算法及其在约束柔性机械臂系统中的应用.基于分布式一致性滚动时域估计算法,通过对估计窗口内的过程扰动序列进行分块,且强制令同一块内的扰动变量值相等,减少了每一时刻需求解的扰动变量个数,降低了算法的计算量.进一步,通过分析建立了假设条件,使得基于块结构的优化问题的解等价于未分块的优化问题的解,以此保证所提算法的可行性与稳定性.仿真结果表明,与未加入扰动块的分布式估计算法相比,基于扰动块的分布式滚动时域估计算法能在不影响估计精度的前提下有效缩短计算时间,从而提高估计效率.

参考文献

SPONG M W.

Modeling and control of elastic joint robots

[J]. Journal of Dynamic Systems, Measurement, and Control, 1987, 109(4): 310-318.

DOI:10.1115/1.3143860      URL     [本文引用: 2]

KIM M J, BECK F, OTT C, et al.

Model-free friction observers for flexible joint robots with torque measurements

[J]. IEEE Transactions on Robotics, 2019, 35(6): 1508-1515.

DOI:10.1109/TRO.2019.2926496      URL     [本文引用: 1]

LING S, WANG H Q, LIU P X.

Adaptive fuzzy tracking control of flexible-joint robots based on command filtering

[J]. IEEE Transactions on Industrial Electronics, 2020, 67(5): 4046-4055.

DOI:10.1109/TIE.2019.2920599      URL     [本文引用: 1]

KIM J, CROFT E A.

Full-state tracking control for flexible joint robots with singular perturbation techniques

[J]. IEEE Transactions on Control Systems Technology, 2019, 27(1): 63-73.

DOI:10.1109/TCST.2017.2756962      URL     [本文引用: 1]

LIU X, ZHAO F, GE S S, et al.

End-effector force estimation for flexible-joint robots with global friction approximation using neural networks

[J]. IEEE Transactions on Industrial Informatics, 2019, 15(3): 1730-1741.

DOI:10.1109/TII.2018.2876724      URL     [本文引用: 1]

于仕泽, 王周义, 戴振东, .

一种面向航天需求的仿生柔性机械臂的设计

[J]. 机械制造与自动化, 2020, 49(1): 134-137.

[本文引用: 1]

YU Shize, WANG Zhouyi, DAI Zhendong, et al.

Design of bionic flexible arm in aerospace demand

[J]. Machine Building & Automation, 2020, 49(1): 134-137.

[本文引用: 1]

ZOU S Z, PAN B, FU Y L, et al.

Extended high-gain observer based adaptive control of flexible-joint surgical robot

[C]∥2016 IEEE International Conference on Robotics and Biomimetics. Qingdao, China: IEEE, 2016: 2128-2133.

[本文引用: 1]

陈晓云.

车载柔性机械臂系统轨迹跟踪补偿控制研究

[J]. 自动化与仪器仪表, 2016(6): 90-91.

[本文引用: 1]

CHEN Xiaoyun.

On-board flexible manipulator system trajectory tracking compensation control research

[J]. Automation & Instrumentation, 2016(6): 90-91.

[本文引用: 1]

KIM M J, CHUNG W K.

Disturbance-observer-based PD control of flexible joint robots for asymptotic convergence

[J]. IEEE Transactions on Robotics, 2015, 31(6): 1508-1516.

DOI:10.1109/TRO.2015.2477957      URL     [本文引用: 2]

LIU X, YANG C G, CHEN Z G, et al.

Neuro-adaptive observer based control of flexible joint robot

[J]. Neurocomputing, 2018, 275: 73-82.

DOI:10.1016/j.neucom.2017.05.011      URL     [本文引用: 2]

KIM M J, BECK F, OTT C, et al.

Model-free friction observers for flexible joint robots with torque measurements

[J]. IEEE Transactions on Robotics, 2019, 35(6): 1508-1515.

DOI:10.1109/TRO.2019.2926496      URL     [本文引用: 1]

ZOU L, WANG Z D, HAN Q L, et al.

Moving horizon estimation for networked time-delay systems under round-robin protocol

[J]. IEEE Transactions on Automatic Control, 2019, 64(12): 5191-5198.

DOI:10.1109/TAC.2019.2910167      URL     [本文引用: 4]

LIU A D, ZHANG W A, CHEN M Z Q, et al.

Moving horizon estimation for mobile robots with multirate sampling

[J]. IEEE Transactions on Industrial Electronics, 2017, 64(2): 1457-1467.

DOI:10.1109/TIE.2016.2611458      URL     [本文引用: 2]

HAN C Y, LI C C, HE F, et al.

Receding horizon estimation for linear discrete-time systems with multi-channel observation delays

[J]. IEEE/CAA Journal of Automatica Sinica, 2019, 6(2): 478-484.

DOI:10.1109/JAS.2018.7511261      URL     [本文引用: 2]

XU Y, ZHOU J Y, RAO H X, et al.

Reset moving horizon estimation for quantized discrete time systems

[J]. IEEE Transactions on Automatic Control, 2021, 66(9): 4199-4205.

DOI:10.1109/TAC.2020.3037140      URL     [本文引用: 1]

何德峰, 俞芳慧, 徐晨辉.

网联车辆协同巡航系统快速滚动时域状态估计

[J]. 控制理论与应用, 2021, 38(4): 457-466.

[本文引用: 1]

HE Defeng, YU Fanghui, XU Chenhui.

Fast receding horizon state estimation of cooperative cruise systems of connected vehicles

[J]. Control Theory & Applications, 2021, 38(4): 457-466.

[本文引用: 1]

刘帅, 赵国荣, 曾宾, .

带丢包和量化的参数不确定系统滚动时域估计

[J]. 系统工程与电子技术, 2020, 42(4): 912-918.

[本文引用: 1]

LIU Shuai, ZHAO Guorong, ZENG Bin, et al.

Moving horizon estimation for uncertain systems with packet dropouts and quantization

[J]. Systems Engineering and Electronics, 2020, 42(4): 912-918.

[本文引用: 1]

刘帅, 赵国荣, 曾宾, .

测量数据丢失的随机不确定系统滚动时域估计

[J]. 控制与决策, 2021, 36(2): 450-456.

[本文引用: 1]

LIU Shuai, ZHAO Guorong, ZENG Bin, et al.

Moving horizon estimation for stochastic uncertain system with missing measurements

[J]. Control and Decision, 2021, 36(2): 450-456.

[本文引用: 1]

FARINA M, FERRARI-TRECATE G, SCATTOLINI R.

Distributed moving horizon estimation for linear constrained systems

[J]. IEEE Transactions on Automatic Control, 2010, 55(11): 2462-2475.

DOI:10.1109/TAC.2010.2046058      URL     [本文引用: 3]

BATTISTELLI G.

Distributed moving-horizon estimation with arrival-cost consensus

[J]. IEEE Transactions on Automatic Control, 2019, 64(8): 3316-3323.

DOI:10.1109/TAC.2018.2879598      URL     [本文引用: 5]

YIN X Y, LIU J F.

Distributed moving horizon state estimation of two-time-scale nonlinear systems

[J]. Automatica, 2017, 79: 152-161.

DOI:10.1016/j.automatica.2017.01.023      URL     [本文引用: 1]

LI H P, SHI Y, YAN W S.

Distributed receding horizon estimation for sensor networks with improved consensus strategy

[C]∥Proceedings of the 33rd Chinese Control Conference. Nanjing, China: IEEE, 2014: 316-321.

[本文引用: 2]

VENTURINO A, BERTRAND S, MANIU C S, et al.

Distributed moving horizon estimation with pre-estimating observer

[C]∥2020 24th International Conference on System Theory, Control and Computing. Sinaia, Romania: IEEE, 2020: 174-179.

[本文引用: 2]

ZENG J, LIU J F.

Distributed moving horizon state estimation: Simultaneously handling communication delays and data losses

[J]. Systems & Control Letters, 2015, 75: 56-68.

DOI:10.1016/j.sysconle.2014.11.007      URL     [本文引用: 2]

LEE J H, CHIKKULA Y, YU Z H, et al.

Improving computational efficiency of model predictive control algorithm using wavelet transformation

[J]. International Journal of Control, 1995, 61(4): 859-883.

DOI:10.1080/00207179508921935      URL     [本文引用: 1]

CAGIENARD R, GRIEDER P, KERRIGAN E C, et al.

Move blocking strategies in receding horizon control

[J]. Journal of Process Control, 2007, 17(6): 563-570.

DOI:10.1016/j.jprocont.2007.01.001      URL     [本文引用: 1]

SHEKHAR R C, MANZIE C.

Optimal move blocking strategies for model predictive control

[J]. Automatica, 2015, 61: 27-34.

DOI:10.1016/j.automatica.2015.07.030      URL     [本文引用: 1]

SON S H, OH T H, KIM J W, et al.

Move blocked model predictive control with improved optimality using semi-explicit approach for applying time-varying blocking structure

[J]. Journal of Process Control, 2020, 92: 50-61.

DOI:10.1016/j.jprocont.2020.04.002      URL     [本文引用: 1]

JUNG T Y, JANG H, LEE J H.

Move blocking strategy applied to re-entrant manufacturing line scheduling

[J]. International Journal of Control, Automation and Systems, 2015, 13(2): 410-418.

DOI:10.1007/s12555-014-0243-9      URL     [本文引用: 1]

/