CN112428247B - 一种针对多主-多从遥操作系统的增强透明性能控制方法 - Google Patents

一种针对多主-多从遥操作系统的增强透明性能控制方法 Download PDF

Info

Publication number
CN112428247B
CN112428247B CN202011039344.5A CN202011039344A CN112428247B CN 112428247 B CN112428247 B CN 112428247B CN 202011039344 A CN202011039344 A CN 202011039344A CN 112428247 B CN112428247 B CN 112428247B
Authority
CN
China
Prior art keywords
robot
slave
master
information
neural network
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202011039344.5A
Other languages
English (en)
Other versions
CN112428247A (zh
Inventor
杨亚娜
曾祥端
李军朋
华长春
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yanshan University
Original Assignee
Yanshan University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yanshan University filed Critical Yanshan University
Priority to CN202011039344.5A priority Critical patent/CN112428247B/zh
Publication of CN112428247A publication Critical patent/CN112428247A/zh
Application granted granted Critical
Publication of CN112428247B publication Critical patent/CN112428247B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J3/00Manipulators of master-slave type, i.e. both controlling unit and controlled unit perform corresponding spatial movements
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/161Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1633Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1651Programme controls characterised by the control loop acceleration, rate control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Feedback Control In General (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种针对多主‑多从遥操作系统的增强透明性能控制方法,属于网络化非线性遥操作系统控制技术领域,具体为:针对网络化多主‑多从遥操作系统分别测量各个主、从机器人在末端执行器的位置、速度及加速度信息,并测量操作者对主机器人施加的力信息和从机器人与外界环境的接触力信息;针对多个主机器人基于接收到的从机器人力信息和操作者输入的力信息分别设计导纳理想轨迹生成器;针对多个从机器人基于从机器人本身与环境作用的力信息及接收到的主机器人的位置信息分别设计导纳理想轨迹生成器;分别针对各个主机器人和从机器人定义同步误差变量,并设计神经网络控制器;选取李雅普诺夫函数给出多主‑多从遥操作系统渐渐稳定的充分条件。

Description

一种针对多主-多从遥操作系统的增强透明性能控制方法
技术领域
本发明属于网络化非线性遥操作系统控制技术领域,尤其是一种针对多主-多从遥操作系统的增强透明性能的控制方法。
背景技术
遥操作系统利用通信网络将主、从设备连接起来,当操作者操纵主端设备进行某一个动作时,相应的控制信号通过网络信息传输通道传输到远距离端,指挥从端设备完成相应的操作。遥操作系统可以将人手延伸到人很难到达或是对人有害的环境中去执行任务。在这些应用中,遥操作系统扮演着重要的角色,因此受到了广泛的关注。目前,遥操作技术在工业、服务、医疗、国防、救援和空间技术等多个领域有着广泛的应用前景。
在遥操作实际应用过程中,仍存在许多问题需要解决。如随着遥操作机器人执行的任务越来越复杂,如搬运尺寸较大、重量较重的物体等。对多机器人协作的需求越来越高。而在实际中如在手术、救援等任务中,对遥操作机器人力反馈和临场感有更高的要求,这使得当下控制方法无法满足这一需求。
本专利旨在针对多从-多从遥操作系统在网络通信时延下,基于导纳控制理论,提出一种新的力反馈控制方法,从而提高整个系统的透明性能,增强操作者的沉浸感。
发明内容
本发明目的在于针对多主-多从遥操作系统提供一种增强透明性能控制方法,以解决现有控制器在透明性能方面存在的不足。
为实现上述目的,采用了以下技术方案:本发明所述方法包括以下步骤:
步骤1,针对由K个操作者,K个主机器人和N个从机器人组成的网络化多主-多从遥操作系统,分别测量各个主、从机器人末端执行器的位置xmx,i,xsx,j、速度
Figure BDA0002706108750000011
和加速度
Figure BDA0002706108750000012
信息,并进一步测量操作者对主机器人施加的力信息Fh,i和从端机器人与外界环境的接触力信息Fe,j,其中i=1,2,...,K,j=1,2,...,N。
步骤2,针对多个主机器人基于接收到的从机器人力信息和操作者输入的力信息分别设计导纳理想轨迹生成器
Figure BDA0002706108750000021
其中,Md,i,Cd,i,Kd,i∈Rn×n分别选取为对角正定常数矩阵,xmr,i∈Rn代表主机器人i末端执行器的理想轨迹,
Figure BDA0002706108750000022
分别代表理想轨迹的速度和加速度信息,∑Fe,j(t-Tj(t))表示与第i个主机器人进行通信的所有从机器人反馈的力经网络信息传输通道之和,Tj(t)代表从机器人信息传输到主机器人i时的时延信息;
步骤3,针对多个从机器人基于从机器人本身与环境的作用的力信息及接收到的主机器人的位置信息分别设计导纳理想轨迹生成器
Figure BDA0002706108750000023
其中Me,j,Ce,j∈Rn×n和Ke,j∈Rn×n选定为对角正定常数矩阵,xsd,j=xmx,j(t-Tm,j(t))代表与从机器人j进行通信的主端机器人通过网络传输通道得到的末端执行器位置信息,Tm,j(t)为主机器人信号传输到第j个从机器人时的时延信息,
Figure BDA0002706108750000024
为xsd,j的一阶导数信息,
Figure BDA0002706108750000025
为xsd,j的二阶导数信息;
步骤4,分别针对各个主机器人和从机器人定义同步误差变量,并设计神经网络控制器
Figure BDA0002706108750000026
Figure BDA0002706108750000027
其中
Figure BDA0002706108750000028
为神经网络理想权值Wmx,i的估计值,Km,i1,Km,i2,Km,i3选取为对角正定常数矩阵,p1,p2,q1,q2均选取为正奇数,且0<p1/p2<1,1<q1/q2,sign(sm,i)表示符号函数,即当sm,i=0时,sign(sm,i)=0,当sm,i>0时,sign(sm,i)=1,当sm,i<0时,sign(sm,i)=-1;
Figure BDA0002706108750000029
为神经网络理想权值Wsx,j的估计值,Ks,j1,Ks,j2,Ks,j3选取为对角正定常数矩阵,sign(ss,j)表示符号函数,即当ss,j=0时,sign(ss,j)=0,当ss,j>0时,sign(ss,j)=1,当ss,j<0时,sign(ss,j)=-1;
步骤5,选取李雅普诺夫函数给出多主-多从遥操作系统渐近稳定的充分条件Km,i3≥εm,iN和Ks,j3≥εs,jN,εm,iN和εs,jN为正常数。
进一步的,步骤1中,考虑由K个操作者操作K个主机器人,并控制远端N个从机器人进行协同作业,主机器人i和从机器人j在笛卡尔空间下的系统模型为:
Figure BDA0002706108750000031
其中,下标m代表主机器人,下标s代表从机器人,且i=1,2,...,K,j=1,2,...,N,xmx,i,xsx,j∈Rn分别为主从机器人末端执行器位移向量,
Figure BDA0002706108750000032
为末端执行器的速度向量,
Figure BDA0002706108750000033
为末端执行器的加速度向量,Mmx,i(xm,i),Msx,j(xs,j)∈Rn×n为系统的正定惯性矩阵,
Figure BDA0002706108750000034
为哥氏力和离心力的向量,Gmx,i(xm,i),Gsx,j(xs,j)∈Rn为重力力矩,
Figure BDA0002706108750000035
为系统存在的未知摩擦力以及有界外界干扰,Fh,i∈Rn和Fe,j∈Rn分别为人类操作者i施加到主机器人i的力和远端环境施加到从机器人j的力矩,umx,i∈Rn和usx,j∈Rn为控制器提供的控制力矩。
针对以上多主-多从遥操作系统分别测量主机器人和从机器人末端执行器的位置xmx,i,xsx,j、速度
Figure BDA0002706108750000036
和加速度
Figure BDA0002706108750000037
信息,并测量所受到的外界力信息Fh,i和Fe,j
进一步的,步骤2中,针对多个主机器人基于接收到的从机器人力信息和操作者输入的力信息针对每个主机器人分别设计其导纳理想轨迹生成器。
以第i个主机器人为例,导纳理想轨迹生成器设计为
Figure BDA0002706108750000041
其中,Md,i,Cd,i,Kd,i∈Rn×n分别选取为对角正定常数矩阵,xmr,i∈Rn代表主机器人i末端执行器的理想轨迹,
Figure BDA0002706108750000042
分别代表理想轨迹的速度和加速度信息,考虑主机器人i可能同时操作多个从机器人,因此主机器人i可能会同时接收到多个从机器人传输的力信息,因此∑Fe,j(t-Tj(t))表示与第i个主机器人进行通信的所有从机器人反馈的力经网络信息传输通道之和,Tj(t)代表从机器人信息传输到主机器人i时的时延信息。
进一步的,所述步骤3中,针对多个从机器人基于从机器人本身与环境的作用的力信息及接收到的主机器人的末端执行器的位置信息分别针对各个从机器人设计其导纳理想轨迹生成器。
针对从机器人j设计如下导纳轨迹生成器
Figure BDA0002706108750000043
其中,Me,j,Ce,j∈Rn×n和Ke,j∈Rn×n选定为对角正定常数矩阵,考虑从机器人一方面需要追踪主机器人的轨迹,一方面需要实现对不同物体的柔顺操作,因此理想轨迹为主机器人轨迹的修正值,因此xsd,j=xmx,j(t-Tm,j(t))代表与从机器人j进行通信的主端机器人通过网络传输通道得到的末端执行器位置信息,Tm,j(t)为主机器人信号传输到第j个从机器人时的时延信息,
Figure BDA0002706108750000044
为xsd,j的一阶导数信息,
Figure BDA0002706108750000045
为xsd,j的二阶导数信息。
进一步,所述步骤4,分别针对各个主机器人和从机器人定义位置同步误差变量,并设计基于滑模的神经网络控制器。针对主机器人i和从机器人j定义位置误差为
Figure BDA0002706108750000051
进一步可得速度误差为
Figure BDA0002706108750000052
基于定义的主、从机器人的位置误差变量,设计如下滑模面
Figure BDA0002706108750000053
其中,λm,is,j选取为正常数。
进而对(6)求导得
Figure BDA0002706108750000054
以主机器人i为例,将(5)-(7)式代入
Figure BDA0002706108750000055
Figure BDA0002706108750000056
经过变换可得
Figure BDA0002706108750000057
其中,
Figure BDA0002706108750000058
依据神经网络逼近原理该非线性函数Fmx,i可利用神经网络进行逼近即,
Figure BDA0002706108750000059
其中Wmx,i为神经网络理想权值,
Figure BDA00027061087500000510
选取为高斯径向基方程即
Figure BDA00027061087500000511
,cα,bα分别代表第α个神经元的中心和宽度,
Figure BDA00027061087500000512
ε(Xm,i)为神经网络估计误差。
进而控制器umx,i设计为
Figure BDA0002706108750000061
其中,
Figure BDA0002706108750000062
为神经网络理想权值Wmx,i的估计值,Km,i1,Km,i2,Km,i3选取为对角正定常数矩阵,p1,p2,q1,q2均选取为正奇数,且0<p1/p2<1,1<q1/q2,sign(sm,i)表示符号函数,即当sm,i=0时,sign(sm,i)=0,当sm,i>0时,sign(sm,i)=1,当sm,i<0时,sign(sm,i)=-1。
针对从机器人j,将(5)-(7)式代入
Figure BDA0002706108750000063
Figure BDA0002706108750000064
经过变换可得
Figure BDA0002706108750000065
其中,
Figure BDA0002706108750000066
依据神经网络逼近原理该非线性函数Fsx,j同样可利用神经网络进行逼近即,
Figure BDA0002706108750000067
其中Wsx,j为神经网络理想权值,
Figure BDA0002706108750000068
选取为高斯径向基方程即
Figure BDA0002706108750000069
,cβ,bβ分别代表第β个神经元的中心和宽度,
Figure BDA00027061087500000610
ε(Xs,j)为神经网络估计误差;
进而针对第j个从机器人控制器usx,j设计为
Figure BDA00027061087500000611
其中,
Figure BDA00027061087500000612
为神经网络理想权值Wsx,j的估计值,Ks,j1,Ks,j2,Ks,j3选取为对角正定常数矩阵,sign(ss,j)表示符号函数,即当ss,j=0时,sign(ss,j)=0,当ss,j>0时,sign(ss,j)=1,当ss,j<0时,sign(ss,j)=-1。
进一步,所述步骤5,选取李雅普诺夫函数如下:
选取李雅普诺夫函数如下:
Figure BDA0002706108750000071
其中,
Figure BDA0002706108750000072
γm,is,j选取为正常数。
其导数为
Figure BDA0002706108750000073
进一步通过设计神经网络权值调节律
Figure BDA0002706108750000074
可得
Figure BDA0002706108750000081
通过选取适当的神经元个数,神经网络估计误差ε(Xm,i),ε(Xs,j)有界,即满足不等式||ε(Xm,i)||≤εm,iN,||ε(Xs,j)||≤εs,jN成立,其中εm,iN和εs,jN选取为正常数。
因此最后可得
Figure BDA0002706108750000082
当不等式Km,i3≥εm,iN和Ks,j3≥εs,jN成立时,可得
Figure BDA0002706108750000083
因此可得滑模面sm,i,ss,j将会快速收敛至零点,且根据sm,i,ss,j的定义速度和位置误差
Figure BDA0002706108750000084
将渐近收敛至零点。标明主、从机器人末端执行器的实际轨迹会快速跟踪理想轨迹,因此主端可获得良好的透明性能,从端机器人可实现对不同物体的柔顺操作。
与现有技术相比,本发明方法具有如下优点:
1、针对各个主机器人设计基于导纳理论的理想轨迹生成器,该轨迹生成器充分考虑了从端机器人对主机器人的反馈力,因此可以大大提高系统透明性能。
2、针对各个从机器人,基于实时测得的外界环境作用力以及主机器人的轨迹信息设计了基于导纳理论的理想轨迹生成器。该轨迹生成器可增强从机器人系统对不同操作物体的柔顺性。
3、针对多个主机器人和多个从机器人分别设计基于滑模的神经网络控制器,且控制器中包括滑模面的高阶项和低阶项,因此可大大加快滑模面的收敛速度。
附图说明
图1为本发明多主-多从遥操作系统的结构框图;
图2为本发明主、从机器人末端执行器的实际轨迹和理想轨迹的轨迹跟踪曲线图;
图3为本发明的控制原理框图。
具体实施方式
下面结合附图对本发明做进一步说明:
如图1所示,针对由K个操作者、K个主机器人和远端N个从机器人,本发明所述方法包括以下步骤:
步骤1,针对网络化多主-多从遥操作系统,分别测量各个主、从机器人末端执行器的位置、速度及加速度信息,并进一步测量操作者对主机器人施加的力信息和从端机器人与外界环境的接触力信息;
考虑由K个操作者操作K个主机器人,并控制远端N个从机器人进行协同作业,主机器人i和从机器人j在笛卡尔空间下的系统模型为:
Figure BDA0002706108750000091
其中,下标m代表主机器人,下标s代表从机器人,且i=1,2,...,K,j=1,2,...,N,xmx,i,xsx,j∈Rn分别为主从机器人末端执行器位移向量,
Figure BDA0002706108750000092
为末端执行器的速度向量,
Figure BDA0002706108750000093
为末端执行器的加速度向量,Mmx,i(xm,i),Msx,j(xs,j)∈Rn×n为系统的正定惯性矩阵,
Figure BDA0002706108750000094
为哥氏力和离心力的向量,Gmx,i(xm,i),Gsx,j(xs,j)∈Rn为重力力矩,
Figure BDA0002706108750000101
为系统存在的未知摩擦力以及有界外界干扰,Fh,i∈Rn和Fe,j∈Rn分别为人类操作者i施加到主机器人i的力和远端环境施加到从机器人j的力矩,umx,i∈Rn和usx,j∈Rn为控制器提供的控制力矩。
针对以上多主-多从遥操作系统分别测量主机器人和从机器人末端执行器的位置xmx,i,xsx,j、速度
Figure BDA0002706108750000102
和加速度
Figure BDA0002706108750000103
信息,并测量所受到的外界力信息Fh,i和Fe,j
步骤2,针对多个主机器人基于接收到的从机器人力信息和操作者输入的力信息分别设计导纳理想轨迹生成器;
针对多个主机器人基于接收到的从机器人力信息和操作者输入的力信息针对每个主机器人分别设计其导纳理想轨迹生成器。
以第i个主机器人为例,导纳理想轨迹生成器设计为
Figure BDA0002706108750000104
其中,Md,i,Cd,i,Kd,i∈Rn×n分别选取为对角正定常数矩阵,xmr,i∈Rn代表主机器人i末端执行器的理想轨迹,
Figure BDA0002706108750000105
分别代表理想轨迹的速度和加速度信息,∑Fe,j(t-Tj(t))表示与第i个主机器人进行通信的所有从机器人反馈的力经网络信息传输通道之和,Tj(t)代表从机器人信息传输到主机器人i时的时延信息。
步骤3,针对多个从机器人基于从机器人本身与环境的作用的力信息及接收到的主机器人的位置信息分别设计导纳理想轨迹生成器;
针对多个从机器人基于从机器人本身与环境的作用的力信息及接收到的主机器人的末端执行器的位置信息分别针对各个从机器人设计其导纳理想轨迹生成器。
针对从机器人j设计如下导纳轨迹生成器
Figure BDA0002706108750000111
其中,Me,j,Ce,j∈Rn×n和Ke,j∈Rn×n选定为对角正定常数矩阵,xsd,j=xmx,j(t-Tm,j(t))代表与从机器人j进行通信的主端机器人通过网络传输通道得到的末端执行器位置信息,Tm,j(t)为主机器人信号传输到第j个从机器人时的时延信息,
Figure BDA0002706108750000112
为xsd,j的一阶导数信息,
Figure BDA0002706108750000113
为xsd,j的二阶导数信息。
步骤4,分别针对各个主机器人和从机器人定义同步误差变量,并设计神经网络控制器;
分别针对各个主机器人和从机器人定义位置同步误差变量,并设计简易神经网络控制器。针对主机器人i和从机器人j定义位置误差为
Figure BDA0002706108750000114
进一步可得速度误差为
Figure BDA0002706108750000115
基于定义的主、从机器人的位置误差变量,设计如下滑模面
Figure BDA0002706108750000116
其中,λm,is,j选取为正常数。
进而对(6)求导得
Figure BDA0002706108750000117
针对主机器人i,将(6)-(8)式代入
Figure BDA0002706108750000118
Figure BDA0002706108750000119
经过变换可得
Figure BDA0002706108750000121
其中,
Figure BDA0002706108750000122
依据神经网络逼近原理该非线性函数Fmx,i可利用神经网络进行逼近即,
Figure BDA0002706108750000123
其中Wmx,i为神经网络理想权值,
Figure BDA0002706108750000124
选取为高斯径向基方程即
Figure BDA0002706108750000125
,cα,bα分别代表第α个神经元的中心和宽度,
Figure BDA0002706108750000127
ε(Xm,i)为神经网络估计误差。
进而控制器umx,i设计为
Figure BDA0002706108750000128
其中,
Figure BDA0002706108750000129
为神经网络理想权值Wmx,i的估计值,Km,i1,Km,i2,Km,i3选取为对角正定常数矩阵,p1,p2,q1,q2均选取为正奇数,且0<p1/p2<1,1<q1/q2,sign(sm,i)表示符号函数,即当sm,i=0时,sign(sm,i)=0,当sm,i>0时,sign(sm,i)=1,当sm,i<0时,sign(sm,i)=-1。
针对从机器人j,将(5)-(6)式代入
Figure BDA00027061087500001210
Figure BDA00027061087500001211
经过变换可得
Figure BDA00027061087500001212
其中,
Figure BDA00027061087500001213
依据神经网络逼近原理该非线性函数Fsx,j同样可利用神经网络进行逼近即,
Figure BDA00027061087500001214
其中Wsx,j为神经网络理想权值,
Figure BDA00027061087500001215
选取为高斯径向基方程即
Figure BDA0002706108750000131
,cβ,bβ分别代表第β个神经元的中心和宽度,
Figure BDA0002706108750000132
ε(Xs,j)为神经网络估计误差。
进而针对第j个从机器人控制器usx,j设计为
Figure BDA0002706108750000133
其中,
Figure BDA0002706108750000134
为神经网络理想权值Wsx,j的估计值,Ks,j1,Ks,j2,Ks,j3选取为对角正定常数矩阵,sign(ss,j)表示符号函数,即当ss,j=0时,sign(ss,j)=0,当ss,j>0时,sign(ss,j)=1,当ss,j<0时,sign(ss,j)=-1。
步骤5,选取李雅普诺夫函数给出多主-多从遥操作系统渐近稳定的充分条件;
选取李雅普诺夫函数如下:
Figure BDA0002706108750000135
其中,
Figure BDA0002706108750000136
γm,is,j选取为正常数。
其导数为
Figure BDA0002706108750000141
进一步通过设计神经网络权值调节律
Figure BDA0002706108750000142
可得
Figure BDA0002706108750000143
通过选取适当的神经元个数,神经网络估计误差ε(Xm,i),ε(Xs,j)有界,即满足不等式||ε(Xm,i)||≤εm,iN,||ε(Xs,j)||≤εs,jN成立,其中εm,iN和εs,jN选取为正常数。
因此最后可得
Figure BDA0002706108750000144
当Km,i3和Ks,j3分别选取为大于εm,iN和εs,jN的正常数时,可得
Figure BDA0002706108750000145
因此可得滑模面sm,i,ss,j将会快速收敛至零点,且根据sm,i,ss,j的定义速度和位置误差
Figure BDA0002706108750000146
将渐近收敛至零点。由图2可知,主、从机器人末端执行器的实际轨迹会快速跟踪理想轨迹,因此主端可获得良好的透明性能,从端机器人可实现对不同物体的柔顺操作。图3为本发明的控制原理框图。
以上所述的实施例仅仅是对本发明的优选实施方式进行描述,并非对本发明的范围进行限定,在不脱离本发明设计精神的前提下,本领域普通技术人员对本发明的技术方案做出的各种变形和改进,均应落入本发明权利要求书确定的保护范围内。

Claims (4)

1.一种针对多主-多从遥操作系统的增强透明性能控制方法,其特征在于:所述方法包括以下步骤:
步骤1,针对由K个操作者,K个主机器人和N个从机器人组成的网络化多主-多从遥操作系统,分别测量各个主、从机器人末端执行器的位置xmx,i,xsx,j、速度
Figure FDA0003345285830000011
和加速度
Figure FDA0003345285830000012
信息,并进一步测量操作者对主机器人施加的力信息Fh,i和从端机器人与外界环境的接触力信息Fe,j,其中i=1,2,...,K,j=1,2,...,N,下标m代表主机器人,下标s代表从机器人;
步骤2,针对多个主机器人基于接收到的从机器人力信息和操作者输入的力信息分别设计导纳理想轨迹生成器
Figure FDA0003345285830000013
其中,Md,i,Cd,i,Kd,i∈Rn×n分别选取为对角正定常数矩阵,xmr,i∈Rn代表主机器人i末端执行器的理想轨迹,
Figure FDA0003345285830000014
分别代表理想轨迹的速度和加速度信息,∑Fe,j(t-Tj(t))表示与第i个主机器人进行通信的所有从机器人反馈的力经网络信息传输通道之和,Tj(t)代表从机器人信息传输到主机器人i时的时延信息;
步骤3,针对多个从机器人基于从机器人本身与环境的作用的力信息及接收到的主机器人的位置信息分别设计导纳理想轨迹生成器
Figure FDA0003345285830000015
其中Me,j,Ce,j∈Rn×n和Ke,j∈Rn×n选定为对角正定常数矩阵,xsd,j=xmx,j(t-Tm,j(t))代表与从机器人j进行通信的主端机器人通过网络传输通道得到的末端执行器位置信息,Tm,j(t)为主机器人信号传输到第j个从机器人时的时延信息,
Figure FDA0003345285830000021
为xsd,j的一阶导数信息,
Figure FDA0003345285830000022
为xsd,j的二阶导数信息;
步骤4,分别针对各个主机器人和从机器人定义同步误差变量,并设计神经网络控制器
Figure FDA0003345285830000023
Figure FDA0003345285830000024
其中
Figure FDA0003345285830000025
为神经网络理想权值Wmx,i的估计值,Km,i1,Km,i2,Km,i3选取为对角正定常数矩阵,p1,p2,q1,q2均选取为正奇数,且0<p1/p2<1,1<q1/q2,sign(sm,i)表示符号函数,即当sm,i=0时,sign(sm,i)=0,当sm,i>0时,sign(sm,i)=1,当sm,i<0时,sign(sm,i)=-1;
Figure FDA0003345285830000026
为神经网络理想权值Wsx,j的估计值,Ks,j1,Ks,j2,Ks,j3选取为对角正定常数矩阵,sign(ss,j)表示符号函数,即当ss,j=0时,sign(ss,j)=0,当ss,j>0时,sign(ss,j)=1,当ss,j<0时,sign(ss,j)=-1;
步骤5,选取李雅普诺夫函数给出多主-多从遥操作系统渐近稳定的充分条件Km,i3≥εm,iN和Ks,j3≥εs,jN,εm,iN和εs,jN为正常数。
2.根据权利要求1所述的一种针对多主-多从遥操作系统的增强透明性能控制方法,其特征在于:步骤1中,针对网络化多主-多从遥操作系统,分别测量各个主、从机器人在末端执行器的位置、速度及加速度信息,并进一步测量操作者对主机器人施加的力信息和从端机器人与外界环境的接触力信息;考虑由K个操作者操作K个主机器人,并控制远端N个从机器人进行协同作业,主机器人i和从机器人j在笛卡尔空间下的系统模型为:
Figure FDA0003345285830000031
其中,xmx,i,xsx,j∈Rn分别为主从机器人末端执行器位移向量,
Figure FDA0003345285830000032
为末端执行器的速度向量,
Figure FDA0003345285830000033
为末端执行器的加速度向量,Mmx,i(xm,i),Msx,j(xs,j)∈Rn×n为系统的正定惯性矩阵,
Figure FDA0003345285830000034
为哥氏力和离心力的向量,Gmx,i(xm,i),Gsx,j(xs,j)∈Rn为重力力矩,
Figure FDA0003345285830000035
为系统存在的未知摩擦力以及有界外界干扰,Fh,i∈Rn和Fe,j∈Rn分别为人类操作者i施加到主机器人i的力和远端环境施加到从机器人j的力矩,umx,i∈Rn和usx,j∈Rn为控制器提供的控制力矩。
3.根据权利要求1所述的一种针对多主-多从遥操作系统的增强透明性能控制方法,其特征在于:所述步骤4中,分别针对各个主机器人和从机器人定义同步误差变量,并设计神经网络控制器;
分别针对主机器人i和从机器人j定义位置同步误差变量,并设计基于滑模的神经网络控制器;针对主机器人i和从机器人j定义位置误差为
Figure FDA0003345285830000036
进一步可得速度误差为
Figure FDA0003345285830000037
基于定义的主、从机器人的位置误差变量,设计如下滑模面
Figure FDA0003345285830000041
其中,λm,is,j选取为正常数;
进而对(6)求导得
Figure FDA0003345285830000042
针对主机器人i,将(5)-(7)式代入
Figure FDA0003345285830000043
Figure FDA0003345285830000044
经过变换可得
Figure FDA0003345285830000045
其中,
Figure FDA0003345285830000046
依据神经网络逼近原理该非线性函数Fmx,i可利用神经网络进行逼近即,
Figure FDA0003345285830000047
其中Wmx,i为神经网络理想权值,
Figure FDA0003345285830000048
选取为高斯径向基方程即
Figure FDA0003345285830000049
Figure FDA00033452858300000410
cα,bα分别代表第α个神经元的中心和宽度,
Figure FDA00033452858300000411
ε(Xm,i)为神经网络估计误差;
进而控制器umx,i设计为
Figure FDA00033452858300000412
其中,
Figure FDA00033452858300000413
为神经网络理想权值Wmx,i的估计值,Km,i1,Km,i2,Km,i3选取为对角正定常数矩阵,p1,p2,q1,q2均选取为正奇数,且0<p1/p2<1,1<q1/q2,sign(sm,i)表示符号函数,即当sm,i=0时,sign(sm,i)=0,当sm,i>0时,sign(sm,i)=1,当sm,i<0时,sign(sm,i)=-1;
针对从机器人j,将(5)-(7)式代入
Figure FDA0003345285830000051
Figure FDA0003345285830000052
经过变换可得
Figure FDA0003345285830000053
其中,
Figure FDA0003345285830000054
依据神经网络逼近原理该非线性函数Fsx,j同样可利用神经网络进行逼近即,
Figure FDA0003345285830000055
其中Wsx,j为神经网络理想权值,
Figure FDA0003345285830000056
选取为高斯径向基方程即
Figure FDA0003345285830000057
Figure FDA0003345285830000058
cβ,bβ分别代表第β个神经元的中心和宽度,
Figure FDA0003345285830000059
ε(Xs,j)为神经网络估计误差;
进而针对第j个从机器人控制器usx,j设计为
Figure FDA00033452858300000510
其中,
Figure FDA00033452858300000511
为神经网络理想权值Wsx,j的估计值,Ks,j1,Ks,j2,Ks,j3选取为对角正定常数矩阵,sign(ss,j)表示符号函数,即当ss,j=0时,sign(ss,j)=0,当ss,j>0时,sign(ss,j)=1,当ss,j<0时,sign(ss,j)=-1。
4.根据权利要求1所述的一种针对多主-多从遥操作系统的增强透明性能控制方法,其特征在于:所述步骤5中,选取李雅普诺夫函数给出多主-多从遥操作系统渐近稳定的充分条件;
选取李雅普诺夫函数如下:
Figure FDA0003345285830000061
其中,
Figure FDA0003345285830000062
γm,is,j选取为正常数,
其导数为
Figure FDA0003345285830000063
进一步通过设计神经网络权值调节律
Figure FDA0003345285830000064
可得
Figure FDA0003345285830000065
通过选取适当的神经元个数,神经网络估计误差ε(Xm,i),ε(Xs,j)有界,即满足不等式||ε(Xm,i)||≤εm,iN,||ε(Xs,j)||≤εs,jN成立,其中εm,iN和εs,jN选取为正常数,因此最后可得
Figure FDA0003345285830000071
当不等式Km,i3≥εm,iN和Ks,j3≥εs,jN成立时,可得
Figure FDA0003345285830000072
因此可得滑模面sm,i,ss,j将会快速收敛至零点,且根据sm,i,ss,j的定义速度和位置误差
Figure FDA0003345285830000073
将渐近收敛至零点;标明主、从机器人末端执行器的实际轨迹会快速跟踪理想轨迹,因此主端可获得良好的透明性能,从端机器人可实现对不同物体的柔顺操作。
CN202011039344.5A 2020-09-28 2020-09-28 一种针对多主-多从遥操作系统的增强透明性能控制方法 Active CN112428247B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011039344.5A CN112428247B (zh) 2020-09-28 2020-09-28 一种针对多主-多从遥操作系统的增强透明性能控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011039344.5A CN112428247B (zh) 2020-09-28 2020-09-28 一种针对多主-多从遥操作系统的增强透明性能控制方法

Publications (2)

Publication Number Publication Date
CN112428247A CN112428247A (zh) 2021-03-02
CN112428247B true CN112428247B (zh) 2021-12-21

Family

ID=74690072

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011039344.5A Active CN112428247B (zh) 2020-09-28 2020-09-28 一种针对多主-多从遥操作系统的增强透明性能控制方法

Country Status (1)

Country Link
CN (1) CN112428247B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114311031B (zh) * 2021-12-29 2024-05-28 上海微创医疗机器人(集团)股份有限公司 手术机器人主从端延时测试方法、系统、存储介质和设备

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6252029B2 (ja) * 2013-08-13 2017-12-27 東京電力ホールディングス株式会社 遠隔操作ロボットシステム
US10959795B2 (en) * 2015-08-25 2021-03-30 Kawasaki Jukogyo Kabushiki Kaisha Remote-control manipulator system and method of operating the same
TWI617908B (zh) * 2016-06-02 2018-03-11 巨擘科技股份有限公司 機械手臂控制裝置,包含該控制裝置的機械手臂系統及機械手臂控制方法
CN109048897B (zh) * 2018-08-14 2021-01-15 清华大学深圳研究生院 一种主从机器人遥操作的方法
CN111136633B (zh) * 2020-01-13 2021-04-09 燕山大学 针对时变时延下柔性主-从机器人系统的全状态控制方法

Also Published As

Publication number Publication date
CN112428247A (zh) 2021-03-02

Similar Documents

Publication Publication Date Title
CN112180729B (zh) 一种机械臂自适应轨迹跟踪控制方法
Kim et al. Robust control of an equipment-added multirotor using disturbance observer
Asl et al. Adaptive neural network control of cable-driven parallel robots with input saturation
Wang et al. Hybrid force/position control in workspace of robotic manipulator in uncertain environments based on adaptive fuzzy control
Liang et al. Fuzzy-sliding mode control for humanoid arm robots actuated by pneumatic artificial muscles with unidirectional inputs, saturations, and dead zones
Yan et al. Decentralized ability-aware adaptive control for multi-robot collaborative manipulation
CN108646569B (zh) 离散时间状态下的遥操作系统的控制方法
Zhao et al. Adaptive quantized fault-tolerant control of a 2-DOF helicopter system with actuator fault and unknown dead zone
CN115625711B (zh) 一种考虑末端力的双臂机器人协同控制方法
Zhai et al. Adaptive robust synchronized control for cooperative robotic manipulators with uncertain base coordinate system
Yang et al. Multi‐manipulators coordination for bilateral teleoperation system using fixed‐time control approach
Lu et al. Deep reinforcement learning control of fully-constrained cable-driven parallel robots
CN112428247B (zh) 一种针对多主-多从遥操作系统的增强透明性能控制方法
Xu et al. A wireless reconfigurable modular manipulator and its control system
Muscolo et al. A Comparison between Two Force‐Position Controllers with Gravity Compensation Simulated on a Humanoid Arm
CN111427264B (zh) 一种复杂遥操作技术的神经自适应固定时间控制方法
Deylami et al. Observer‐based adaptive control of cooperative multiple manipulators using the Mastroianni operators as uncertainty approximator
CN108693776A (zh) 一种三自由度Delta并联机器人的鲁棒控制方法
CN109048995B (zh) 一种三自由度Delta并联机器人的非线性关节摩擦力补偿方法
Li et al. Impedance control for human-robot interaction with an adaptive fuzzy approach
CN108227493B (zh) 一种机器人轨迹跟踪方法
Wang et al. Backstepping Sliding Mode Robust Control for a Wire‐Driven Parallel Robot Based on a Nonlinear Disturbance Observer
CN115890650A (zh) 一种可重构机械臂事件触发分散最优容错控制方法及系统
Le et al. Adaptive neural network controller-based chattering-free sliding mode for 6-DOF industrial manipulators
Li et al. Adaptive robust control of the cable driven system for position tracking

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant