一种基于扩展卡尔曼滤波器的双边遥操作控制方法

摘要

本发明提供一种基于扩展卡尔曼滤波器的双边遥操作控制方法，包括如下步骤：考虑系统不确定性和噪声信息，基于拉格朗日方程，建立双边遥操作系统模型；针对双边遥操作模型中存在的不确定扰动，设计干扰观测器；将干扰观测器的输出作为双边遥操作系统状态变量的一部分，得到系统扩张状态方程；设计扩展卡尔曼滤波器去除过程噪声和测量噪声，得到系统状态和扰动的准确估计；设计自适应二阶滑模有限时间控制器，来抵消不确定性扰动对系统的影响以及消除系统抖震，使从端机器人能够快速准确跟踪主端机器人。

说明书

技术领域：

本发明属于双边遥操作控制领域，具体涉及一种基于扩展卡尔曼滤波器的双边遥操作控制方法。

背景技术：

随着网络技术的快速发展，在医疗机器人手术、外太空操作、水下探索等多种场景下，双边遥操作系统的研究逐渐受到关注。通过医疗机器人可以在很远的距离内进行安全、准确的微创手术。通过远程机器人系统实现了外太空作业的地面跟踪和钻孔定位任务。同时，将水下遥控操作系统应用于危险环境下的深水探测。双边遥操作系统擅长于在人类难以接近的复杂、危险的环境中工作，系统中存在动态扰动，未知摩擦时延等不确定性干扰因素。另外，在实际工程应用中，由于角度传感器或速度传感器的带宽有限，不可避免地会产生过程噪声和测量噪声等噪声信息。不确定性干扰因素以及噪声信息严重影响系统稳定性和透明性，给精确的位置控制带来了巨大的挑战。因此，设计一个控制算法处理这些不确定性干扰因素和噪声信息显得尤为重要。

干扰观测器可以对系统中的不确定扰动进行观测，具有很强的抗干扰能力，因此能够被很好的应用于双边遥操作系统的位置精度控制。本发明采用一种基于扩展卡尔曼滤波器的双边遥操作控制方法，设计基于干扰观测器的扩展卡尔曼滤波器不仅能够观测系统状态和扰动，而且可以减小噪声影响，设计自适应二阶有限时间控制器，保证系统的快速跟踪性能，同时采用二阶滑模控制算法消除了传统滑模方法中出现的抖振现象。

发明内容：

本发明的目的在于提供一种基于扩展卡尔曼滤波器的双边遥操作控制方法，来处理双边遥操作系统中存在的不确定性干扰因素和噪声扰动问题，提高系统的稳定性和透明性，弥补现有研究方法中对系统噪声影响处理较少的缺点。本发明通过干扰观测器观测扰动，并将其扩张为新的系统状态，利用扩展卡尔曼滤波器对扩张状态方程进行滤波，得到更加精确的系统状态和扰动的估计，再对系统扰动进行补偿，设计自适应有限时间控制器，实现主从机器人的快速无抖振位置跟踪。

本发明技术方案如下：

一种基于扩展卡尔曼滤波器的双边遥操作控制方法，包括如下步骤：

步骤一：考虑系统不确定性和噪声信息，基于拉格朗日方程，建立双边遥操作系统模型；

步骤二：在步骤一的基础上，针对双边遥操作模型中存在的不确定扰动，设计干扰观测器；

步骤三：在步骤二的基础上，将干扰观测器的输出作为双边遥操作系统状态变量的一部分，得到系统扩张状态方程；

步骤四：在步骤三的基础上，设计扩展卡尔曼滤波器去除过程噪声和测量噪声，得到系统状态和扰动的准确估计；

步骤五：在步骤四的基础上，设计自适应二阶滑模有限时间控制器，来抵消不确定性扰动对系统的影响以及消除系统抖震，使从端机器人能够快速准确跟踪主端机器人。

在步骤一中，考虑系统不确定性干扰因素和噪声信息，根据拉格朗日方程，建立双边遥操作系统模型为：

其中，下标m和s分别表示双边遥操作系统的主端机器人和从端机器人，让i＝m,s,q

考虑到双边遥操作系统模型中包含动态不确定性结构参数，存在

其中M

因此，双边遥操作系统模型重写为

系统测量方程为

y

y

其中y

在步骤二中，设计干扰观测器来估计未知系统总集扰动D

其中

进一步的，在步骤三中，定义

为简单起见，将以下变量引入为

为了消除噪声干扰，提出基于干扰观测的扩展卡尔曼滤波器，同时将干扰观测器的输出作为新的系统状态变量，因此，系统扩张状态方程为

其中变量F(t)和G(t)表示如下

进一步的，在步骤四中，利用Ito随机微分方程，将双边遥操作系统建模为

dX(t)＝f[X(t),x(t)]dt+G(t)dω

dy(t)＝h[X(t)]dt+D(t)dη

其中，非线性函数f(·)和h(·)是连续微分非线性函数，通过下面方程的一阶展开式得到

是由矩阵随机过程的线性部分α(t)，β(t)和非线性部分

系统的输出y

状态估计的微分方程

滤波器增益：

K(t}＝P(t)β

黎卡提微分方程：

dP(t)＝[α(t)P(t)+P(t)α

其中Q(t)和R(t)是时变对称正定矩阵，一般是选择系统模型中扰动噪声项的协方差

Q(t)＝G(t)G

R(t)＝D(t)D

进一步的，在步骤五中，主、从机器人位置误差函数为

e

e

其中T

根据系统状态方程，主、从机器人加速度误差函数为

选取线性滑模面

其中，K

其中λ是一个足够小的正常数,

其中

自适应律设计为

因此，设计自适应二阶滑模有限时间控制器τ,，主从端机器人控制器提供的输入力矩τ

其中，当

其中κ＝diag(κ

本发明与现有技术相比有如下优点：

1、双边遥操作系统是复杂的网络化非线性系统，并处于复杂的工作环境中，不确定感染因素较多，工程实践中噪声信息对系统稳定性和透明性的影响是不可避免的。现有双边遥操作系统处理噪声信息的研究较少，因此，本发明考虑了不确定性扰动和噪声信息，基于拉格朗日方程建立新的双边遥操作动力学模型；

2、本发明不用增加昂贵的加速度传感器，能对双边遥操作系统实现高精度位置跟踪控制；

3、本发明通过干扰观测器观测扰动，并将其扩张为新的系统状态，利用扩展卡尔曼滤波器对扩张状态方程进行滤波，得到更加精确的系统状态和扰动的估计，再对系统扰动进行补偿。与传统观测器相比，它同时具有观测状态、扰动和去除噪声的功能，增强了系统鲁棒性；

4、本发明采用自适应二阶滑模有限时间控制算法，它的控制器结构简单，参数整定方便，鲁棒性强，可以保证系统的快速跟踪性能，同时消除了传统滑模控制方法中常出现的抖振现象。

附图说明：

图1为双边遥操作系统结构框图；

图2为基于扩展卡尔曼滤波器的双边遥操作控制算法原理框图；

图3为扩展卡尔曼滤波器估计扰动误差曲线图；

图4为双边遥操作系统主从机械臂位置跟踪曲线图。

具体实施方式：

为使本发明的目的更加明确，技术方案更加清晰，以下结合附图和具体实施例对本发明进行详细说明。

图1所示为本发明所述的双边遥操作系统结构框图，其主要由操作者，主端机器人，网络传输通道，从端机器人和工作环境五部分组成。在双边遥操作实际应用系统中，由于需要传感器测量位置信息，需要网络通道进行主从端信息交互，因此系统中存在着噪声信息，同时由于工作环境的复杂性，系统中不可避免的存在不确定干扰因素，如摩擦力，外部扰动等。

图2为本发明的控制原理框图，表明了本发明所述的一种基于扩展卡尔曼滤波器的双边遥操作控制算法。

下面结合图2、图3和图4对本发明所述控制算法进行详细描述，具体内容包括以下步骤：

步骤一，考虑系统不确定性干扰因素和噪声信息，根据拉格朗日方程，建立双边遥操作系统模型为：

其中，下标m和s分别表示双边遥操作系统的主端机器人和从端机器人，让i＝m,s,q

考虑到双边遥操作系统模型中包含动态不确定性结构参数，存在

其中M

因此，双边遥操作系统模型可以改写为

系统测量方程为

y

y

其中y

步骤二，设计干扰观测器来估计未知系统总集扰动D

其中

步骤三，写出系统扩张状态方程，定义

为简单起见，将以下变量引入为

为了消除噪声干扰，提出基于干扰观测的扩展卡尔曼滤波器，同时将干扰的输出作为新的系统状态变量，因此，系统扩张状态方程为

其中变量F(t)和G(t)表示如下

步骤四，设计扩展卡尔曼滤波器，利用Ito随机微分方程，进一步的将双边遥操作系统建模为

dX(t)＝f[X(t),x(t)]dt+G(t)dω

dy(t)＝h[X(t)]dt+D(t)dη

其中，非线性函数f(·)和h(·)是连续微分非线性函数，通过下面方程的一阶展开式得到

是由矩阵随机过程的线性部分α(t)，β(t)和非线性部分

系统的输出y

状态估计的微分方程

滤波器增益：

K(t}＝P(t)β

黎卡提微分方程：

dP(t)＝[α(t)P(t)+P(t)α

其中Q(t)和R(t)是时变对称正定矩阵，一般是选择系统模型中扰动噪声项的协方差

Q(t)＝G(t)G

R(t)＝D(t)D

步骤五，设计自适应二阶有限时间滑模控制方案，主、从机器人位置误差函数为

e

e

其中T

根据系统状态方程，主、从机器人加速度误差函数为

选取线性滑模面

其中，K

其中λ是一个足够小的正常数,

其中

自适应律设计为

设计自适应二阶滑模有限时间控制器τ，τ由等效控制器u

其中，当

其中κ＝diag(κ

下面给出自适应二阶滑模有限时间控制器的稳定性证明。

根据本发明所述的双边遥操作系统选择如下李雅普诺夫方程：

其中定义自适应错误为

其中

实施例

为了验证上述理论的可行性，在MATLAB下进行仿真实验，仿真实验验证了基于扩展卡尔曼滤波器的双边遥操作控制方法的效果。按照图2所示原理图在MATLAB中搭建双边遥操作系统仿真框架，定义主从机器人为2自由度的主从机械臂，其参数矩阵为：

其中，具体参数选择为：

仿真中主从机械臂间的通信时延为0.45s，为保持系统器快速稳定的跟踪性能，控制器参数选则如下：

图3为扩展卡尔曼滤波器估计扰动误差曲线图，可以看出在噪声存在情况下，对扰动的估计误差很小，保持在10

本发明未尽事宜为公知技术。

上述实施例只为说明本发明的技术构思及特点，其目的在于让熟悉此项技术的人士能够了解本发明的内容并据以实施，并不能以此限制本发明的保护范围。凡根据本发明精神实质所作的等效变化或修饰，都应涵盖在本发明的保护范围之内。