基于扰动块的柔性臂分布式滚动时域估计
Disturbance-Blocking-Based Distributed Receding Horizon Estimation of Flexible Joint Robots
通讯作者: 何德峰,男,教授,博士生导师,电话(Tel.):0571-88320367;E-mail:hdfzj@zjut.edu.cn.
责任编辑: 石易文
收稿日期: 2021-06-2
基金资助: |
|
Received: 2021-06-2
作者简介 About authors
徐晨辉(1996-),男,浙江省宁波市人,博士生,研究方向为鲁棒滚动时域估计.
针对柔性机械臂因在实际运动过程中易发生变形而需进行状态监测的问题,提出一种基于扰动块的分布式滚动时域估计算法.在分布式一致性滚动时域估计的基础上,通过设计扰动块并将其应用于估计窗口内的过程扰动序列,减少了与优化相关的变量,从而降低了算法的计算量,实现快速性.通过分析算法在最大分块长度下的可行性与收敛性,建立了保证算法的优化问题存在等价解的假设条件,并将结果推广到了过程扰动任意分块的情况.仿真结果表明:与不加扰动块的算法相比,所提算法能在不影响估计误差的前提下有效缩短计算时间.
关键词:
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:
本文引用格式
徐晨辉, 俞芳慧, 何德峰.
XU Chenhui, YU Fanghui, HE Defeng.
处理上述问题的一种常用方法是状态估计,目前大量研究针对柔性臂设计了多种不同的观测器[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 问题描述
式中:A为系统状态矩阵;B为输入矩阵.
图1
考虑运动过程中带有的不确定性扰动w∈R4,Ra为a维实数集,采用一阶前向差分法对式(1)进行离散化,可得如下带有过程噪声的离散线性状态方程:
式中:
Ts为系统离散化周期,g为重力加速度;t为时刻;ut为t时刻的控制输入;wt为逆协方差矩阵为Q的高斯白噪声.xt和wt满足约束条件 xt∈X, wt∈W,X和W为已知紧凸集.
考虑使用M个传感器测量柔性臂的状态,传感器之间通过网络相连.传感器网络的通信拓扑可由(E, ε) 表示,其中E={1, 2, …, M}为拓扑中传感器节点的集合, ε⊆E×E为拓扑中连接传感器节点的边的集合.对于传感器i,Ei为其邻居传感器集合.传感器节点i∈E在t时刻的测量模型如下所示:
式中:
关于柔性臂的分布式状态估计问题可描述为在t时刻,每个传感器节点i∈E基于本地测量值
2 主要结果
以传感器节点i为例,基于分布式全信息估计(DFIE)的柔性臂系统状态估计问题可表示为以下二次规划问题:
式中:正定矩阵P0为先验状态
全信息估计利用从初始时刻到当前时刻所有的测量数据生成状态估计,其计算量会随时间持续增大,因此这种估计方法被称为计算难解.为避免全信息估计带来的计算负担,通过使用滚动窗口中的信息替换过去的“完整信息”[12],滚动时域估计将计算范围限制在了离当前时刻最近的固定时域内.然而MHE的计算量仍然与系统模型维度成正相关,且随窗口长度增大而增大.
针对此问题,本文引入“块”策略,通过在估计窗口的过程扰动估计序列中设计扰动块结构,令块结构内的扰动值相等以减少优化变量个数,降低计算量.t时刻传感器节点i估计窗口内基于块结构的扰动示意图如图2所示.其中:估计窗口内第N个扰动
图2
通过将“块”结构引入分布式滚动时域估计,可得如下带有扰动块的分布式滚动时域估计:
式中:
其中:
用于融合传感器节点i及其所有邻居传感器节点的到达代价.参考文献[20]的共识策略,在每个估计时刻对到达代价进行多次加权融合,以扩展信息的交换.
本文将分析加入扰动块与新约束后分布式滚动时域估计算法的可行性和收敛性,并给出先验估计
图3
最大分块长度下的分布式滚动时域估计问题可描述为以下二次规划问题:
在进一步讨论式(10)描述的优化问题之前,先给出下列定义和假设.
定义1 当t>N时,对满足约束的
假设1 式(2)描述的柔性臂系统中,状态矩阵A' 满足:
rank (
式中:扰动序列{wk
假设2 式(2)描述的系统满足全局能观要求,即(C,A')可观,其中C=col(Ci; i∈E).
假设3 传感器网络拓扑(E, ε)为强连接,即任意两个传感器节点i, j∈E之间均存在有向路径.
基于上述假设,定理1给出了最大分块长度下分布式滚动时域估计的可行性与收敛性分析.
定理1 若假设1~3成立,则式(10)描述的优化问题可行且收敛.
证明 当t≤N时,分布式全信息估计存在可行解
{
进而可得:
(A')N-1
根据定义1,可得式(10)的解等价于未分块时分布式滚动时域估计的优化问题的解.进一步,当 t>N,对任意i∈E,先验估计
其中:
Hi=
Li=[
式中:
在定理1的基础上,将分析结果推广到过程扰动任意分块的情况,如推论1所示.
推论1 基于假设1~3,若将估计窗口内前N-1个扰动分为S块,S∈I1: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时所有传感器节点存储先验估计
(2) 当1≤t≤N,窗口长度N=t,所有传感器节点运行分布式全信息估计算法,求解式(4);当t>N时,传感器节点运行基于块结构的分布式滚动时域估计算法,求解式(6).
(3) 基于最优解以及式(2),计算t时刻的最优状态估计.
(4) 当t>N,所有传感器节点根据式(12)和(13)计算下一时刻的逆协方差矩阵
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阶系统:
采用常规模型预测控制算法设计控制输入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.到达代价的初始协方差
采用如图4所示的传感器网络拓扑,其中:箭头方向表示传感器间信息可传递的路径;传感器1~4分别测量状态分量x1~x4.测量模型如下所示:
其中:测量噪声vi为协方差γi=1的高斯白噪声.1号传感器可接收4号传感器的测量数据,故1号传感器可获得关于状态分量x1和x4的信息;同理,2号、3号、4号传感器可分别获得关于状态分量x1和x2、x2和x3、x3和x4的信息.
图4
取滚动时域窗口长度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内存.
图5
图6
表1 基于算法Ⅲ状态分量估计的均方根误差
Tab.1
状态 分量 | 传感器1 误差 | 传感器2 误差 | 传感器3 误差 | 传感器4 误差 |
---|---|---|---|---|
x1 | 0.2332 | 0.2239 | 0.2266 | 0.2324 |
x2 | 1.5689 | 1.2659 | 1.2533 | 1.5555 |
x3 | 0.2277 | 0.2402 | 0.2441 | 0.2301 |
x4 | 1.2241 | 1.4518 | 1.4605 | 1.2418 |
图7
图7
不同算法下状态分量平均估计误差对比
Fig.7
Comparison of average estimation errors of state component based on different algorithms
图8
表2 不同算法平均计算时间与均方根误差对比
Tab.2
算法 | 传感器1 ACT/s | 传感器2 ACT/s | 传感器3 ACT/s | 传感器4 ACT/s | RMSE |
---|---|---|---|---|---|
I | 1.0101 | 1.0272 | 1.0222 | 1.0062 | 0.8318 |
II | 0.4327 | 0.4382 | 0.4374 | 0.4373 | 0.8318 |
III | 0.3093 | 0.3072 | 0.3051 | 0.3041 | 0.8318 |
结合图7和表2的RMSE值可以发现,基于不同分块形式的分布式滚动时域估计算法的平均估计误差基本相同,这是因为本文所提算法的优化问题的解与未分块的具有等价性.通过对比图8和表2中算法所需的平均计算时间可知,分块形式对算法的计算时间有显著影响.在计算时间方面,算法 I>算法 II>算法 III,这是由于算法 I 将每个扰动单独分为1块,从而每一时刻需求解28个变量;算法 II 将扰动分为3块,从而每一时刻需求解16个变量;算法 III 将最后一个扰动单独分为1块,其余扰动为另一块,从而每一时刻只需求解12个变量.这使得在每一时刻的计算量方面,算法 I>算法 II>算法 III.由此, 说明了算法估计窗口中扰动分块的数量越少,每一时刻需求解的变量就越少,所需计算时间就越短.结合图7、8和表2可以发现,与未分块的分布式滚动时域估计算法相比,本文所提算法可以在不增大估计误差的基础上有效缩短计算时间,从而提高计算效率.
4 结语
本文研究了基于扰动块的快速分布式滚动时域估计算法及其在约束柔性机械臂系统中的应用.基于分布式一致性滚动时域估计算法,通过对估计窗口内的过程扰动序列进行分块,且强制令同一块内的扰动变量值相等,减少了每一时刻需求解的扰动变量个数,降低了算法的计算量.进一步,通过分析建立了假设条件,使得基于块结构的优化问题的解等价于未分块的优化问题的解,以此保证所提算法的可行性与稳定性.仿真结果表明,与未加入扰动块的分布式估计算法相比,基于扰动块的分布式滚动时域估计算法能在不影响估计精度的前提下有效缩短计算时间,从而提高估计效率.
参考文献
Modeling and control of elastic joint robots
[J].DOI:10.1115/1.3143860 URL [本文引用: 2]
Model-free friction observers for flexible joint robots with torque measurements
[J].DOI:10.1109/TRO.2019.2926496 URL [本文引用: 1]
Adaptive fuzzy tracking control of flexible-joint robots based on command filtering
[J].DOI:10.1109/TIE.2019.2920599 URL [本文引用: 1]
Full-state tracking control for flexible joint robots with singular perturbation techniques
[J].DOI:10.1109/TCST.2017.2756962 URL [本文引用: 1]
End-effector force estimation for flexible-joint robots with global friction approximation using neural networks
[J].DOI:10.1109/TII.2018.2876724 URL [本文引用: 1]
一种面向航天需求的仿生柔性机械臂的设计
[J].
Design of bionic flexible arm in aerospace demand
[J].
Extended high-gain observer based adaptive control of flexible-joint surgical robot
[C]
车载柔性机械臂系统轨迹跟踪补偿控制研究
[J].
On-board flexible manipulator system trajectory tracking compensation control research
[J].
Disturbance-observer-based PD control of flexible joint robots for asymptotic convergence
[J].DOI:10.1109/TRO.2015.2477957 URL [本文引用: 2]
Neuro-adaptive observer based control of flexible joint robot
[J].DOI:10.1016/j.neucom.2017.05.011 URL [本文引用: 2]
Model-free friction observers for flexible joint robots with torque measurements
[J].DOI:10.1109/TRO.2019.2926496 URL [本文引用: 1]
Moving horizon estimation for networked time-delay systems under round-robin protocol
[J].DOI:10.1109/TAC.2019.2910167 URL [本文引用: 4]
Moving horizon estimation for mobile robots with multirate sampling
[J].DOI:10.1109/TIE.2016.2611458 URL [本文引用: 2]
Receding horizon estimation for linear discrete-time systems with multi-channel observation delays
[J].DOI:10.1109/JAS.2018.7511261 URL [本文引用: 2]
Reset moving horizon estimation for quantized discrete time systems
[J].DOI:10.1109/TAC.2020.3037140 URL [本文引用: 1]
网联车辆协同巡航系统快速滚动时域状态估计
[J].
Fast receding horizon state estimation of cooperative cruise systems of connected vehicles
[J].
带丢包和量化的参数不确定系统滚动时域估计
[J].
Moving horizon estimation for uncertain systems with packet dropouts and quantization
[J].
测量数据丢失的随机不确定系统滚动时域估计
[J].
Moving horizon estimation for stochastic uncertain system with missing measurements
[J].
Distributed moving horizon estimation for linear constrained systems
[J].DOI:10.1109/TAC.2010.2046058 URL [本文引用: 3]
Distributed moving-horizon estimation with arrival-cost consensus
[J].DOI:10.1109/TAC.2018.2879598 URL [本文引用: 5]
Distributed moving horizon state estimation of two-time-scale nonlinear systems
[J].DOI:10.1016/j.automatica.2017.01.023 URL [本文引用: 1]
Distributed receding horizon estimation for sensor networks with improved consensus strategy
[C]
Distributed moving horizon estimation with pre-estimating observer
[C]
Distributed moving horizon state estimation: Simultaneously handling communication delays and data losses
[J].DOI:10.1016/j.sysconle.2014.11.007 URL [本文引用: 2]
Improving computational efficiency of model predictive control algorithm using wavelet transformation
[J].DOI:10.1080/00207179508921935 URL [本文引用: 1]
Move blocking strategies in receding horizon control
[J].DOI:10.1016/j.jprocont.2007.01.001 URL [本文引用: 1]
Optimal move blocking strategies for model predictive control
[J].DOI:10.1016/j.automatica.2015.07.030 URL [本文引用: 1]
Move blocked model predictive control with improved optimality using semi-explicit approach for applying time-varying blocking structure
[J].DOI:10.1016/j.jprocont.2020.04.002 URL [本文引用: 1]
Move blocking strategy applied to re-entrant manufacturing line scheduling
[J].DOI:10.1007/s12555-014-0243-9 URL [本文引用: 1]
/
〈 |
|
〉 |
