一种基于终端滑模的遥操作系统干扰有限时间补偿方法技术方案

本发明专利技术公开了一种基于终端滑模的遥操作系统干扰有限时间补偿方法，包括分别选取主机器人和从机器人组成遥操作系统，并分别测量主机器人和从机器人的系统参数，在线测量主机器人和从机器人的关机位置信息，并利用鲁棒精确差分器得到主机器人和从机器人的关节速度信息，设计基于终端滑模的有限时间干扰观测器，并反馈至主机器人和从机器人的控制器设计中，利用李雅普诺夫方程给出干扰观测器参数取值范围。本发明专利技术解决了现有干扰观测器观测速度慢且能力有限的问题，克服了参数不确定性和未知干扰对遥操作系统的影响，提高了系统的抗干扰性能。简化了控制器设计,更利于在工程实际中应用。

A finite time compensation method for teleoperation system based on terminal sliding mode

The invention discloses a disturbance compensation method. The finite time operating system based on terminal sliding mode, including selection of the main operating system from the remote robot and robot, and measuring the main parameters of the robot and the robot from the system, on-line measurement of the master robot and the robot from the off position information, and the use of robust and accurate difference for the master robot and the joint velocity information from the robot, the design of finite time disturbance observer based on terminal sliding mode, and feedback to the main controller design from the robot and robot, using Lyapunov equation of disturbance observer parameters. The invention solves the problem that the observation speed of the existing disturbance observer is slow and the capacity is limited, and overcomes the influence of parameter uncertainty and unknown interference on the teleoperation system, and improves the anti-interference performance of the system. The design of the controller is simplified, and it is more suitable to be applied in engineering practice.

【技术实现步骤摘要】

本专利技术涉及遥操作系统控制领域，尤其涉及一种基于终端滑模的遥操作系统干扰有限时间补偿方法。
技术介绍
遥操作系统主要由操作者、主机器人、网络信息传输通道、从机器人和远端的外界工作环境组成。其工作模式大致可描述为：操作者操作本地主机器人，并将主机器人的位置、速度等信息通过网络等传输媒介传送给从机器人，从机器人按照接收到的主机器人的位置和速度信息，在特定环境下模拟主机器人的行为从而完成各种工作，同时从机器人的工作状态将反馈至主端操作者，便于操作者根据从机器人的运动状态做出正确的决策。目前，遥操作系统的控制面临很大的挑战，一方面由于机器人本身为复杂的非线性系统，另一方面遥操作系统大多应用于复杂的人类无法或不适合接触的环境如海底探测，外空探测和危险环境救援等场景。系统的强非线性以及外界复杂未知的工作环境带来了系统的不确定和外界干扰。在大多数情况下可以将系统不确定以及外界干扰统一看作系统存在的强干扰。强干扰的存在给遥操作系统的控制性能带来了致命的影响。因此迫切需要提出新的系统干扰补偿策略，从而保证遥操作系统在恶劣工作环境下的高精度稳定工作。针对系统的强干扰，基于滑模的干扰观测器设计提供了很好的补偿效果。而终端滑模的出现，不但保留了传统线性滑模的优点，另外其抗干扰性更强，系统收敛更快，精度更高，而且能提供有限时间收敛。但是典型的基于滑模的干扰观测器当初观测误差较大时，其观测速度将大大降低，因此增加了控制器设计负担。较差的干扰观测器性能会导致整个系统的不稳定，给遥操作系统的实际应用带来很大的障碍。
技术实现思路
本专利技术为了解决上述问题，提供了一种观测速度快、能力强、克服参数不确定性和未知干扰对遥操作系统影响的基于终端滑模的遥操作系统干扰有限时间补偿方法。为实现上述目的，采用了以下技术方案：本专利技术主要包括主机器人和从机器人，包括如下步骤：步骤1，分别选取主机器人和从机器人并通过网络相连组成遥操作系统，再分别测量主、从机器人的系统参数，并利用力传感器测量操作者施加的力和外界环境施加的力。步骤2，实时测量主机器人和从机器人的机械臂位置信息，利用鲁棒精确差分器有限时间内得到主机器人和从机器人的机械臂速度信息；步骤3，基于所测量的关节位置和所重构的关节速度信息，设计基于终端滑模的系统干扰观测器；步骤4，利用李雅普诺夫(Lyapunov)方程给出干扰观测器参数取值范围，进而根据实际应用对系统收敛时间的要求来确定干扰观测器参数，将干扰观测器的观测值反馈到控制器设计中，实现对遥操作系统干扰的有限时间在线补偿。进一步的，所述步骤1中主、从机器人的系统参数包括：机械臂的长度信息和质量信息，以及根据机械臂的长度和质量信息分别计算出的主机器人和从机器人的惯性矩阵、哥氏力、离心力矩阵和重力项。利用力传感器测量操作者施加到主机器人的力Fh和外界环境施加到从端机器人的力Fe。进一步的，所述步骤2中，基于主机器人和从机器人的系统机械臂关节位置信息，利用鲁棒精确差分器分别得到主、从机器人的机械臂速度信息；鲁棒精确差分器设计如下式中，下标i＝m表示主机器人，i＝s表示从机器人，qij表示主/从机器人第j个关节的位置，yij1为qij的估计值，yij2为主/从机器人第j个关节的速度估计值；其中，φ1(yij1-qij)和φ2(yij1-qij)设计为：φ1(yij1-qij)＝sig(yij1-qij)1/2+μsig(yij1-qij)3/2，k1,k2,μ均为大于零的正常数；sig(yij1-qij)γ＝|yij1-qij|γsign(yij1-qij)，sign(yij1-qij)为符号函数，其定义为：当yij1-qij＞0时sign(yij1-qij)＝1；当yij1-qij＜0时sign(yij1-qij)＝-1；当yij1-qij＝0时sign(yij1-qij)＝0。进一步的，步骤3中，设计系统有限时间干扰观测器如下其中，其中，qm,qs∈Rn为关节位移矩阵；为关节速度矩阵；Mmo(qm),Mso(qs)∈Rn×n为系统标称的正定惯性矩阵；为标称哥氏力和离心力的向量；Gmo(qm),Gso(qs)∈Rn为标称重力力矩；Fh∈Rn和Fe∈Rn分别为人类操作者施加的力和环境施加的力；τm∈Rn和τs∈Rn为控制器提供的控制力矩；λm1,λm2,θm,θs均为大于零的正常数；和分别代表系统干扰Dm和Ds的估计值。进一步的，步骤4中，选取Lyapunov函数如下其中，Qm,Qs为对称正定常数矩阵，且满足可得，且时，和分别为系统干扰Dm和Ds的一阶导数；为Lm和Ls为正常数；当干扰观测器的取值满足如下条件时，遥操作系统干扰Dm和Ds可以在有限时间内被精确估计；进而，将所观测的系统干扰和反馈到控制器设计中对系统不确定的提前补偿，可得简单的P+d控制器如下其中，Tm(t)为主端机器人到从端机器人的信息传输时变时延，Ts(t)为从端机器人到主端机器人的信息传输时变时延，kpm，kps，kdm，kds均选取为对角正定对称常数矩阵，主从机器人组成的遥操作系统可以实现在系统存在不确定以及外界干扰情况的稳定运行。与现有技术相比，本专利技术方法具有如下优点：适用于具有二阶性质的各类系统如飞行器，机械臂，轮式机器人等设备。在观测器方法设计中同时引入指数趋近项和幂次趋近项，当观测器初始误差较大时，指数趋近项能使观测误差在很短的时间内收敛到零点附近且收敛时间与初始状态无关。进而幂次趋近项发挥主要作用使得观测误差能在有限时间内精确地收敛至零点。在该干扰观测器下，系统控制器的设计负担被降低。由于提前将系统的不确定进行了有效的补偿，因此系统具有更强的抗干扰性，且系统收敛速度更快，精度更高。附图说明图1为遥操作系统的结构框图。图2为本专利技术方法的控制原理框图。具体实施方式下面结合附图对本专利技术做进一步说明：如图1-2所示，本专利技术方法的步骤如下：步骤1，分别选取主机器人和从机器人组成遥操作系统，并分别测量主机器人和从机器人的系统参数，并利用力传感器测量操作者施加的力和外界环境施加的力。系统参数包括：杆的长度和质量信息，以及根据杆的长度和质量信息分别计算出的主机器人和从机器人的惯性矩阵、哥氏力、离心力矩阵和重力项。步骤2，在线测量主机器人和从机器人的关节位置信息，并利用鲁棒精确差分器有限时间内得到主机器人和从机器人的速度信息；鲁棒精确差分器设计如下其中，下标i＝m表示主机器人，i＝s表示从机器人，qij表示主/从机器人第j个关节的位置，yij1为qij的估计值，yij2为相应的速度估计值。另外，φ1(yij1-qij)和φ2(yij1-qij)设计为φ1(yij1-qij)＝sig(yij1-qij)1/2+μsig(yij1-qij)3/2，k1,k2,μ均为大于零的正常数。sig(yij1-qij)γ＝|yij1-qij|γsign(yij1-qij)，sign(yij1-qij)为符号函数，其定义为当yij1-qij＞0时sign(yij1-qij)＝1；当yij1-qij＜0时sign(yij1-qij)＝-1；当yij1-qij＝0时sign(yij1-qij)＝0。步骤3，基于所测量的关节位置和所重构的关节速度信息，设计基于终端滑模的系统有限时间干扰观测本文档来自技高网...

【技术保护点】
一种基于终端滑模的遥操作系统干扰有限时间补偿方法，主要包括主机器人和从机器人，其特征在于，所述方法包括如下步骤：步骤1，分别选取主机器人和从机器人并通过网络相连组成遥操作系统，再分别测量主、从机器人的系统参数，并利用力传感器测量操作者施加的力和外界环境施加的力。步骤2，实时测量主机器人和从机器人的机械臂位置信息，利用鲁棒精确差分器有限时间内得到主机器人和从机器人的机械臂速度信息；步骤3，基于所测量的关节位置和所重构的关节速度信息，设计基于终端滑模的系统干扰观测器；步骤4，利用李雅普诺夫(Lyapunov)方程给出干扰观测器参数取值范围，进而根据实际应用对系统收敛时间的要求来确定干扰观测器参数，将干扰观测器的观测值反馈到控制器设计中，实现对遥操作系统干扰的有限时间在线补偿。

【技术特征摘要】
1.一种基于终端滑模的遥操作系统干扰有限时间补偿方法，主要包括主机器人和从机器人，其特征在于，所述方法包括如下步骤：步骤1，分别选取主机器人和从机器人并通过网络相连组成遥操作系统，再分别测量主、从机器人的系统参数，并利用力传感器测量操作者施加的力和外界环境施加的力。步骤2，实时测量主机器人和从机器人的机械臂位置信息，利用鲁棒精确差分器有限时间内得到主机器人和从机器人的机械臂速度信息；步骤3，基于所测量的关节位置和所重构的关节速度信息，设计基于终端滑模的系统干扰观测器；步骤4，利用李雅普诺夫(Lyapunov)方程给出干扰观测器参数取值范围，进而根据实际应用对系统收敛时间的要求来确定干扰观测器参数，将干扰观测器的观测值反馈到控制器设计中，实现对遥操作系统干扰的有限时间在线补偿。2.根据权利要求1所述的一种基于终端滑模的遥操作系统干扰有限时间补偿方法，其特征在于：所述步骤1中主、从机器人的系统参数包括：机械臂的长度信息和质量信息，以及根据机械臂的长度和质量信息分别计算出的主机器人和从机器人的惯性矩阵、哥氏力、离心力矩阵和重力项。进一步利用力传感器测量操作者施加到主机器人的力Fh和外界环境施加到从端机器人的力Fe。3.根据权利要求1所述的一种基于终端滑模的遥操作系统干扰有限时间补偿方法，其特征在于：所述步骤2中，基于主机器人和从机器人的系统机械臂关节位置信息，利用鲁棒精确差分器分别得到主、从机器人的机械臂速度信息；鲁棒精确差分器设计如下y·ij1=-k1φ1(yij1-qij)+yij2y·ij2=-k2φ2(yij1-qij)---(1)]]>式中，下标i＝m表示主机器人，i＝s表示从机器人，qij表示主/从机器人第j个关节的位置，yij1为qij的估计值，yij2为主/从机器人第j个关节的速度估计值；其中，φ1(yij1-qij)和φ2(yij1-qij)设计为：φ1(yij1-qij)＝sig(yij1-qij)1/2+μsig(yij1-qij)3/2φ2(yij1-qij)=12sign(yij1-qij)+2μ(yij1-qij)+32μ2sig(yij1-qij)2]]>k1,k2,μ均为大于零的正常数；sig(yij1-qij)γ＝|yij1-qij|γsign(yij1-qij)，sign(yij1-qij)为符号函数，其定义为：当yij1-qij＞0时sign(yij1-qij)＝1；当yij1-qij＜0时sign(yij1-qij)＝-1；当yij1-qij＝0时sign(yij1-qij)＝0。4.根据权利要求1所述的一种基于终端滑模的遥操作系统干扰有限时间补偿方法，其特征在于，步骤3中，设计系...

【专利技术属性】
技术研发人员：华长春，杨亚娜，李军朋，
申请(专利权)人：燕山大学，
类型：发明
国别省市：河北;13