CN113370218A - 基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法 - Google Patents
基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法 Download PDFInfo
- Publication number
- CN113370218A CN113370218A CN202110764320.4A CN202110764320A CN113370218A CN 113370218 A CN113370218 A CN 113370218A CN 202110764320 A CN202110764320 A CN 202110764320A CN 113370218 A CN113370218 A CN 113370218A
- Authority
- CN
- China
- Prior art keywords
- flexible mechanical
- physical system
- ipmc
- mechanical arm
- model
- 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.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Endoscopes (AREA)
- Manipulator (AREA)
- Instruments For Viewing The Inside Of Hollow Bodies (AREA)
- Surgical Instruments (AREA)
Abstract
本发明涉及一种基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法,包括步骤:建立由离子聚合物金属复合材料驱动的内窥柔性机械臂模型;根据柔性机械梁模块和IPMC驱动模块的状态方程得到复合物理系统的能量方程;通过建立端口哈密顿模型,证明内窥柔性机械臂模型是无源的;整个开环系统保持互联稳定;进一步通过级联与阻尼配置无源控制方法对柔性机械臂设计控制器,预设前馈无源控制参数,将内窥柔性机械臂模型无源化。本发明的有益效果是:提出一种对柔性机械臂的无源控制方法,使柔性机械臂达到动态平衡的同时达到对弹性振动的抑制,实现在人体环境内实时对内窥镜机械臂的运动控制。
Description
技术领域
本发明属于机械臂的控制领域,尤其涉及一种基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法,具体涉及柔性机械臂的基于端口哈密顿建模的多种物理尺度模型的无源控制方法。
背景技术
人体结构的环境复杂且脆弱,刚性的手术设备自由度比较低,对手术会造成的很大的局限性。在医疗器械领域,柔性机械臂自由度高,对人体创伤小。离子聚合物金属复合材料IPMC(electroactive polymer,EAP)是一种新型智能高分子材料,当有外加电场时,电活性聚合物内部结构发生改变,在薄膜表面的导电层之间的静电引力促使薄膜发生压缩与形变。新型多自由度的由仿生材料制作的柔性机械臂使用(电活性聚合物)作为执行器。这种机械臂可以通过微创手术进入人体作为微型内窥镜的执行器,或者进行定点给药。
对于柔性机械臂,弹性振动问题是至关重要且不能避免的。弹性振动是梁的机械机构的一种内在扰动,一般很难快速衰减,特别是当多自由度机械臂运动时,柔性振动通过各关节间的耦合在机械臂末端放大,对系统造成振荡甚至不稳定。
近几年,人们在这个问题上做了很多研究。比如运用模糊神经控制算法或者自适应模糊滑模控制来消去弹性振动。但是这些研究方法都对模型都进行了简化,并且很少考虑整个柔性机械臂的物理系统的能量问题。
如果设计的物理量,从能量的角度能够使系统能量函数按照我们希望的能量函数进行分布,那就可以从能量的角度达到控制目的。
发明内容
本发明的目的是克服现有技术中的不足,提供一种基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法。
这种基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法,包括以下步骤:
步骤1、建立由离子聚合物金属复合材料(IPMC)驱动的内窥柔性机械臂模型,内窥柔性机械臂模型是柔性机械梁模块和IPMC驱动模块组成的复合物理系统(整个系统里有多种物理现象);根据柔性机械梁模块和IPMC驱动模块的状态方程得到复合物理系统的能量方程;
步骤2、通过建立端口哈密顿模型,证明内窥柔性机械臂模型是无源的;整个开环系统(open loop system,为未受过调节的复合物理系统)保持互联稳定;
步骤3、进一步通过级联与阻尼配置无源控制方法(IDA-PBC)对柔性机械臂设计控制器,预设前馈无源控制参数,将由离子聚合物金属复合材料(IPMC)驱动的内窥柔性机械臂模型无源化;
上述偏微分方程为匹配条件,其中J为能量传递矩阵,R为能量损耗矩阵;其中g为复合物理系统的输入矩阵,g⊥是g的满秩零化子,并且哈密顿函数Hd(x)满足条件:
x*=argminHd(x)
x*为待稳定的目标点,满足复合物理系统的端口哈密顿模型完全渐进稳定的级联与阻尼配置无源控制方法(IDA-PBC)的表达式如下:
其中Jd、Rd分别是逆转矩阵和对称矩阵;
对分布参数系统进行离散后,步骤2中柔性机械梁模块与IPMC执行器的互连模型内的T、S皆为M离散过后m×m的数值矩阵, C′、L′分别是闭环控制系统(closed-loopsystem,又称反馈系统,控制理论中指被控制过的有回路的系统)中的电容参数和电感参数;rc为阻尼参数;
步骤3.3、证明由离子聚合物金属复合材料(IPMC)驱动的内窥柔性机械臂模型具有无源性;
首先定义一个复合物理系统g的满秩零化子g⊥:
In是对角线为1的对角矩阵,矩阵维度为n×n;
通过设置Rd=R+Rc,对复合物理系统进行阻尼注入,Rc=diag(0 0 rc 0),rc为阻尼参数;
通过设置Hd(x)=H(x)+Hc(x),将步骤3.1中匹配条件写成以下匹配方程式:
从上述匹配条件,复合物理系统所需能量的交叉项在x3、φ和Q之间,假设:
选择以下参数的值满足匹配条件:
将上述参数代入步骤3.1的无源控制方法(IDA-PBC)的表达式中,得到步骤3.2中设计的控制器表达式;
步骤4、计算无源控制参数C′和阻尼参数rc,最后控制参数K;
通过控制阻尼参数rc控制对复合物理系统阻尼注入的量,通过增大阻尼参数rc的值来抑制柔性机械臂的抖振;阻尼参数rc取值过大不影响系统稳定性和到达平衡点的速度,但会造成能量的耗散;
步骤5、设定完成的控制算法下载到数字信号处理器中,将IPMC驱动模块两端的电压作为复合物理系统的控制变量,复合物理系统通过IPMC驱动模块两端的电压驱动使IPMC驱动模块发生形变,在薄膜表面的导电层之间的静电引力促使薄膜发生压缩与形变,从而驱动内窥柔性机械臂模型的柔性机械梁模块,进而控制位于柔性机械梁模块内机械臂末端的内窥镜的位置。
作为优选,步骤1具体包括以下步骤:
步骤1.1、柔性机械梁模块的状态方程使用铁木辛哥梁模型的状态方程,表达如下:
上式中,z为空间变量,t为时间变量;w(z,t)是横向位移;是梁的旋转角度;系数ρ是单位质量长度;系数Iρ是横截面的转动惯量;系数E是杨氏弹性模量;系数I是惯性矩横截面;系数K是剪切模量;τ(z,t)是施加于柔性梁的力矩;
步骤1.2、IPMC驱动模块的状态方程由双电层电极模型、电应力扩散模型、机械横梁三种偏微分方程表示;
其中双电层电极的偏微分方程为:
上式中,t为时间变量,C2(t)是双电层电容,R1是电极的电阻,R2是聚合电阻,v是电势,i是电流,ε是电极的电阻相对电极表面的虚拟坐标;
电应力扩散模型的偏微分方程为:
上式中,z为空间变量,t为时间变量;fs(z,t)为电荷溶胀率,je(z,t)是电流密度,js(z,t)是水流密度,σe是电导率,K是Darcy渗透度,Kz是碰撞模量常数,λ是Onsager耦合常数,G是剪切弹性模量常数。
作为优选,假定步骤1中IPMC驱动模块和柔性机械梁模块完美切合,建模时假设IPMC驱动模块的机械梁结构为柔性机械梁模块结构的一部分,此时步骤1.2中机械横梁的偏微分方程与柔性机械梁模块的状态方程一致,均使用铁木辛哥梁模型的状态方程:
作为优选,步骤2具体包括以下步骤:
步骤2.1、复合物理系统的柔性机械梁模块被视为季莫申科梁模型,复合物理系统中柔性机械梁模块的端口哈密顿模型表达式如下:
上式中,x(t)为状态变量,并且:
柔性机械梁模块具有状态(能量)变量:剪切应变横向动量分布角应变和角动量分布其中z∈(a,b),a、b分别为空间中柔性机械梁模块内柔性机械臂的两端;t为时间变量,t≥0;w是横向位移;状态空间X=L2([a,b];R4),其中,L2空间是线性空间,状态空间定义在L2空间内,R4表示有四个实数状态变量;逆转算子是一个作用于状态空间X的阶偏对称微分算子;矩阵是耗散矩阵,Rt和Rr分别为平移和角度粘滞分数常数;
柔性机械梁模块的能量表示为:
上式中,a、b分别为空间中柔性机械梁模块内柔性机械臂的两端;柔性机械梁模块的分布式位移由IPMC执行器在梁上的产生的分布力矩控制;分布力矩作为分布输入变量:
上式中,为分布式输入映射,b(z)=[b1(z),…,bm(z)],ud=[ud1(z),…,udm(z)]T,m是IPMC驱动器的个数,IPMC驱动器包括固定端驱动器和中端驱动器;分布输出变量是分布输入变量的幂共轭变量:
柔性机械梁模块的能量方程为:
步骤2.2、复合物理系统的IPMC驱动模块中,IPMC执行器通过改变其电力系统(等效的双电层模型电极)的电压,可以以较小的电压造成离子聚合物层的反应从而使柔性材料进行形变;IPMC执行器等效为一个双电层RC电路模型,双电层RC电路模型两端的电压作为系统控制变量,复合物理系统中IPMC驱动模块的端口哈密顿模型表达式如下:
IPMC驱动模块的总能量定义为磁能和电能状态向量为xa=[φ,Q]T,其中φ为磁通量,C为电容,Q为电容器的电荷,r1和r2是等效电路电阻,u(t)是在IPMC执行器上施加的电压,ua是由复合物理系统的机械运动产生在IPMC等效电容器的电流,y是电感,ya是IPMC等效电容器两端的电压;
当内窥柔性机械臂模型由m个IPMC驱动器驱动时,所有IPMC驱动器的端口哈密顿模型表达式如下:
Im、R1、R1分别是对角线为1、r1、r2的对角矩阵,矩阵维度皆为m×m;φ为磁通量,Q为电容器的电荷;
步骤2.3、复合物理系统的端口哈密顿模型建模:
IPMC执行器弯曲作用在柔性机械梁模块上,IPMC执行器和柔性机械梁模块的互连关系定义为:
k=diag[k1,…,km],ya为联结作用在柔性机械梁模块的力矩,k是联结作用在柔性机械梁模块的力矩ya的常数系数,柔性机械梁模块与IPMC执行器的互连模型为:
则复合物理系统的端口哈密顿模型为:
上式中,g(x)是输入矩阵;其中J为能量传递矩阵,R为能量损耗矩阵;u是在IPMC执行器上施加的电压;
复合物理系统的总能量为:
步骤2.4、通过端口哈密顿模型证明复合物理系统的无源性步骤为:
端口哈密顿模型的几何结构是保证复合物理系统中的总能量是保守的,将哈密顿函数作为复合物理系统的能量存储函数:
建立复合物理系统的动态方程:
上式中,H(t)为复合物理系统的能量存储函数,为复合物理系统的时变状态变量;逆转矩阵J=-JT表示复合物理系统的能量传递;R表示复合物理系统的内部能量耗散矩阵,R=RT≥0;B(t)是输入矩阵;u(t)是对耦输入变量,y是对耦输出变量,u(t)和y表示系统和外部环境的能量交互;
将复合物理系统的功率平衡方程表示如下:
由于复合物理系统的功率始终小于或者等于复合物理系统无损耗时输入输出的功率,则端口哈密顿模型是无源的,则内窥柔性机械臂模型也是无源的,复合物理系统的功率平衡方程的含义是哈密顿系统是无源的(即能量无源的定义)。
作为优选,柔性机械梁模块为柔性梁结构。
作为优选,内窥柔性机械臂模型由一片或两片离子聚合物金属复合材料(IPMC)驱动。
本发明的有益效果是:
本发明提出一种对柔性机械臂的无源控制方法,使柔性机械臂达到动态平衡的同时达到对弹性振动的抑制,实现在人体环境内实时对内窥镜机械臂的运动控制。通过建立基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的端口哈密顿模型,证明系统的无源性,闭环中接入的IDA-PBC控制器也是无源的,从而使整个闭环系统达到无源性,通过调节IDA-PBC无源控制器的参数,从而提高整个系统的速度以及消除弹性振动,从而使系统达到稳定。
本发明适用于内窥柔性机械臂的运动控制和满足机械臂实时变化的机械结构。本发明采用端口哈密尔顿建模方式和无源理论分析由IPMC驱动的柔性机械臂的复合系统的稳定性和能量无源特性,之后通过在控制闭环接入的IDA-PBC控制器也是无源的,提高整个柔性机械臂的运动速度,使机械臂精确到达控制位置,并消除弹性振动。采用的无源控制思路为将整个复合物理系统视为一个整体,将控制器和被控制的由IPMC驱动的柔性机械臂复合系统视为能量转换的设备,对柔性机械梁模块和IPMC驱动模块组成的复合物理系统进行能量整型,从而使复合物理系统能量函数按照预想的能量函数进行分布,从而从能量的角度达到控制目的。
附图说明
图1为离子聚合物金属复合材料(IPMC)驱动的内窥柔性机械臂示意图;
图2为IPMC等效电路模型示意图;
图3为IDA-PBC无源控制方法的系统结构图;
图4为实施例二单IPMC驱动的柔性梁示意图;
图5为实验信号装置的结构示意图;
图6为无阻尼注入情况下的控制结果曲线图;
图7为IDA-PBC的控制结果(固定控制参数C对比)示意图;
图8为实施例三双IPMC驱动的柔性梁示意图;
图9为柔性梁形状目标示意图;
图10为双IPMC驱动的柔性梁使用IDA-PBC控制方法得到的实验结果示意图。
附图标记说明:阳离子1、水分子2、等效系统3、dSPACE处理器4、柔性机械臂和驱动片5、激光位移传感器6、机械臂7、固定端驱动器8、中端驱动器9、中端激光传感器10、末端激光传感器11、IPMC执行器12、柔性结构内管13、末端执行器14。
具体实施方式
下面结合实施例对本发明做进一步描述。下述实施例的说明只是用于帮助理解本发明。应当指出,对于本技术领域的普通人员来说,在不脱离本发明原理的前提下,还可以对本发明进行若干修饰,这些改进和修饰也落入本发明权利要求的保护范围内。
为验证本发明,建立了一个由IPMC驱动(IPMC驱动器等效电路模型如图2所示)的柔性机械臂的实验平台,对柔性机械臂所采用的无源控制方法(IDA-PBC)的控制系统结构如图3所示,而采用的完整的实验装置示意图如图5所示,本发明采用的各柔性机械臂配置的参数如下表1所示;
表1 各柔性机械臂配置的参数表
机械臂类型 | 单个IPMC驱动 | 双IPMC驱动 |
机械臂长度 | 0.16米 | 0.16米 |
IPMC驱动器位置 | 0.07米到0.09米 | 0到0.02米,0.07到0.09米 |
单个IPMC驱动器长度 | 0.02米 | 0.02米 |
实施例一
本申请实施例一提供了一种由单片如图1所示IPMC驱动的基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法。
步骤1、建立由离子聚合物金属复合材料(IPMC)驱动的内窥柔性机械臂模型,内窥柔性机械臂模型是柔性机械梁模块和IPMC驱动模块组成的复合物理系统(整个系统里有多种物理现象);根据柔性机械梁模块和IPMC驱动模块的状态方程得到复合物理系统的能量方程;
步骤1.1、柔性机械梁模块的状态方程使用铁木辛哥梁模型的状态方程,表达如下:
上式中,z为空间变量,t为时间变量;w(z,t)是横向位移;是梁的旋转角度;系数ρ是单位质量长度;系数Iρ是横截面的转动惯量;系数E是杨氏弹性模量;系数I是惯性矩横截面;系数K是剪切模量;τ(z,t)是施加于柔性梁的力矩;
步骤1.2、IPMC驱动模块的状态方程由双电层电极模型、电应力扩散模型、机械横梁三种偏微分方程表示;
其中双电层电极的偏微分方程为:
上式中,t为时间变量,C2(t)是双电层电容,R1是电极的电阻,R2是聚合电阻,v是电势,i是电流,ε是电极的电阻相对电极表面的虚拟坐标;
电应力扩散模型的偏微分方程为:
上式中,z为空间变量,t为时间变量;fs(z,t)为电荷溶胀率,je(z,t)是电流密度,js(z,t)是水流密度,σe是电导率,K是Darcy渗透度,Kz是碰撞模量常数,λ是Onsager耦合常数,G是剪切弹性模量常数;
假定步骤1中IPMC驱动模块和柔性机械梁模块完美切合,建模时假设IPMC驱动模块的机械梁结构为柔性机械梁模块结构的一部分,此时步骤1.2中机械横梁的偏微分方程与柔性机械梁模块的状态方程一致,均使用铁木辛哥梁模型的状态方程:
步骤2、通过建立端口哈密顿模型,证明内窥柔性机械臂模型是无源的;整个开环系统(open loop system,为未受过调节的复合物理系统)保持互联稳定;
步骤2.1、复合物理系统的柔性机械梁模块被视为季莫申科梁模型,复合物理系统中柔性机械梁模块的端口哈密顿模型表达式如下:
上式中,x(t)为状态变量,并且:
柔性机械梁模块具有状态(能量)变量:剪切应变横向动量分布角应变和角动量分布其中z∈(a,b),a、b分别为空间中柔性机械梁模块内柔性机械臂的两端;t为时间变量,t≥0;w是横向位移;状态空间X=L2([a,b];R4),其中,L2空间是线性空间,状态空间定义在L2空间内,R4表示有四个实数状态变量;逆转算子是一个作用于状态空间X的阶偏对称微分算子;矩阵是耗散矩阵,Rt和Rr分别为平移和角度粘滞分数常数;
柔性机械梁模块的能量表示为:
上式中,a、b分别为空间中柔性机械梁模块内柔性机械臂的两端;柔性机械梁模块的分布式位移由IPMC执行器在梁上的产生的分布力矩控制;分布力矩作为分布输入变量:
上式中,为分布式输入映射,b(z)=[b1(z),…,bm(z)],ud=[ud1(z),…,udm(z)]T,m是IPMC驱动器的个数,IPMC驱动器包括固定端驱动器和中端驱动器;分布输出变量是分布输入变量的幂共轭变量:
柔性机械梁模块的能量方程为:
步骤2.2、复合物理系统的IPMC驱动模块中,IPMC执行器通过改变其电力系统(等效的双电层模型电极)的电压,可以以较小的电压造成离子聚合物层的反应从而使柔性材料进行形变;IPMC执行器等效为一个双电层RC电路模型,双电层RC电路模型两端的电压作为系统控制变量,复合物理系统中IPMC驱动模块的端口哈密顿模型表达式如下:
IPMC驱动模块的总能量定义为磁能和电能状态向量为xa=[φ,Q]T,其中φ为磁通量,C为电容,Q为电容器的电荷,r1和r2是等效电路电阻,u(t)是在IPMC执行器上施加的电压,ua是由复合物理系统的机械运动产生在IPMC等效电容器的电流,y是电感,ya是IPMC等效电容器两端的电压;
当内窥柔性机械臂模型由m个IPMC驱动器驱动时,所有IPMC驱动器的端口哈密顿模型表达式如下:
Im、R1、R1分别是对角线为1、r1、r2的对角矩阵,矩阵维度皆为m×m;φ为磁通量,Q为电容器的电荷;
步骤2.3、复合物理系统的端口哈密顿模型建模:
IPMC执行器弯曲作用在柔性机械梁模块上,IPMC执行器和柔性机械梁模块的互连关系定义为:
k=diag[k1,…,km],ya为联结作用在柔性机械梁模块的力矩,k是联结作用在柔性机械梁模块的力矩ya的常数系数,柔性机械梁模块与IPMC执行器的互连模型为:
则复合物理系统的端口哈密顿模型为:
上式中,g(x)是输入矩阵;其中J为能量传递矩阵,R为能量损耗矩阵;u是在IPMC执行器上施加的电压;
复合物理系统的总能量为:
步骤2.4、通过端口哈密顿模型证明复合物理系统的无源性步骤为:
端口哈密顿模型的几何结构是保证复合物理系统中的总能量是保守的,将哈密顿函数作为复合物理系统的能量存储函数:
建立复合物理系统的动态方程:
上式中,H(t)为复合物理系统的能量存储函数,为复合物理系统的时变状态变量;逆转矩阵J=-JT表示复合物理系统的能量传递;R表示复合物理系统的内部能量耗散矩阵,R=RT≥0;B(t)是输入矩阵;u(t)是对耦输入变量,y是对耦输出变量,u(t)和y表示系统和外部环境的能量交互;
将复合物理系统的功率平衡方程表示如下:
由于复合物理系统的功率始终小于或者等于复合物理系统无损耗时输入输出的功率,则端口哈密顿模型是无源的,则内窥柔性机械臂模型也是无源的,复合物理系统的功率平衡方程的含义是哈密顿系统是无源的(即能量无源的定义)。
步骤3、进一步通过级联与阻尼配置无源控制方法(IDA-PBC)对柔性机械臂设计控制器,预设前馈无源控制参数,将由离子聚合物金属复合材料(IPMC)驱动的内窥柔性机械臂模型无源化;
上述偏微分方程为匹配条件,其中J为能量传递矩阵,R为能量损耗矩阵;其中g为复合物理系统的输入矩阵,g⊥是g的满秩零化子,并且哈密顿函数Hd(x)满足条件:
x*=argminHd(x)
x*为待稳定的目标点,满足复合物理系统的端口哈密顿模型完全渐进稳定的级联与阻尼配置无源控制方法(IDA-PBC)的表达式如下:
其中Jd、Rd分别是逆转矩阵和对称矩阵;
对分布参数系统进行离散后,步骤2.3中柔性机械梁模块与IPMC执行器的互连模型内的T、S皆为M离散过后m×m的数值矩阵, C′、L′分别是闭环控制系统(closed-loopsystem,又称反馈系统,控制理论中指被控制过的有回路的系统)中的电容参数和电感参数;rc为阻尼参数;
步骤3.3、证明由离子聚合物金属复合材料(IPMC)驱动的内窥柔性机械臂模型具有无源性;
首先定义一个复合物理系统g的满秩零化子g⊥:
In是对角线为1的对角矩阵,矩阵维度为n×n;
通过设置Rd=R+Rc,对复合物理系统进行阻尼注入,Rc=diag(0 0 rc 0),rc为阻尼参数;
通过设置Hd(x)=H(x)+Hc(x),将步骤3.1中匹配条件写成以下匹配方程式:
从上述匹配条件,复合物理系统所需能量的交叉项在x3、φ和Q之间,假设:
选择以下参数的值满足匹配条件:
将上述参数代入步骤3.1的无源控制方法(IDA-PBC)的表达式中,得到步骤3.2中设计的控制器表达式;
步骤4、计算无源控制参数C′和阻尼参数rc,最后控制参数K;
通过控制阻尼参数rc控制对复合物理系统阻尼注入的量,通过增大阻尼参数rc的值来抑制柔性机械臂的抖振;阻尼参数rc取值过大不影响系统稳定性和到达平衡点的速度,但会造成能量的耗散;
步骤5、设定完成的控制算法下载到数字信号处理器中,将IPMC驱动模块两端的电压作为复合物理系统的控制变量,复合物理系统通过IPMC驱动模块两端的电压驱动使IPMC驱动模块发生形变,在薄膜表面的导电层之间的静电引力促使薄膜发生压缩与形变,从而驱动内窥柔性机械臂模型的柔性机械梁模块,进而控制位于柔性机械梁模块内机械臂末端的内窥镜的位置。
实施例二
在实施例一的基础上,本申请实施例二提供了一种如图4所示由单片IPMC驱动的基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法。
使用dSPACE软硬件工作平台和计算机(带有Matlab Simulink),在IPMC驱动模块上生成控制信号U∈[0,7V],测量值是柔性机械臂的位移和施加到IPMC执行器12上的电压。位移通过KEYENCE公司的激光位移传感器(LK-G152)检测。本实施例采用对应机械臂类型Ⅰ,由一片IPMC驱动,用于验证控制方法并验证控制参数对的控制结果的影响。
具体包括如下步骤:
步骤1,建立由IPMC驱动的内窥柔性机械臂的端口哈密顿模型,复合模型包括柔性机械梁结构模块、1片IPMC驱动块(如图4所示);
步骤2,根据设定的柔性机械臂目标位置,计算对应系统平衡点向量,通过级联与阻尼配置无源控制方法(IDA-PBC)对柔性机械臂设计控制器;
步骤3,根据设定的柔性机械臂目标位置,计算对应系统平衡点向量,计算无源控制参数C′和阻尼参数rc;
步骤4,运用matlab对完成的控制算法进行仿真,最后的控制结果如图6、图7所示.当不使用阻尼注入,即rc=0时,无源控制参数C′越大,则柔性机械臂达到预期位置越快,但抖振越大。当固定无源控制参数C′时,rc越大,即阻尼注入越大,柔性机械臂的抖振越小。
实施例三
在实施例二的基础上,本申请实施例三提供了一种如图8所示由两片IPMC驱动的基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法。
使用dSPACE软硬件工作平台和计算机(带有Matlab Simulink),在IPMC驱动模块上生成控制信号U∈[0,7V],测量值是柔性机械臂的位移和施加到IPMC执行器12上的电压。位移通过KEYENCE公司的激光位移传感器(LK-G152)检测。实施例二对应机械臂类型Ⅱ,由两片IPMC驱动,用于验证控制方法对多个IPMC驱动的机械臂的有效性。
步骤1,建立由IPMC驱动的内窥柔性机械臂的端口哈密顿模型,复合模型包括柔性机械梁结构模块、两片IPMC驱动块(如图8所示);
步骤2,根据设定的柔性机械臂目标位置,计算对应系统平衡点向量,通过级联与阻尼配置无源控制方法(IDA-PBC)对柔性机械臂设计控制器;
步骤3,根据设定的柔性机械臂目标位置,计算对应系统平衡点向量,计算无源控制参数C′和阻尼参数rc;
步骤4,将设计完成的控制算法从matlab下载到dSPACE软硬件工作平台中,通过该控制环节,对系统进行运动控制。最后的控制结果如图10所示,固定端的驱动器从3秒开始启动,在3秒到15秒之间时,中间端已经达到图7所示目标位置且保持稳定,在15秒时,激活第二个IPMC驱动器,末端最终达到图7所示目标位置,中间端的位移保持不变,其位移只取决于固定端的驱动器。
Claims (7)
1.基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法,其特征在于,包括以下步骤:
步骤1、建立由离子聚合物金属复合材料驱动的内窥柔性机械臂模型,内窥柔性机械臂模型是柔性机械梁模块和IPMC驱动模块组成的复合物理系统;根据柔性机械梁模块和IPMC驱动模块的状态方程得到复合物理系统的能量方程;
步骤2、通过建立端口哈密顿模型,证明内窥柔性机械臂模型是无源的;整个开环系统保持互联稳定;
步骤3、进一步通过级联与阻尼配置无源控制方法对柔性机械臂设计控制器,预设前馈无源控制参数,将由离子聚合物金属复合材料驱动的内窥柔性机械臂模型无源化;
上述偏微分方程为匹配条件,其中J为能量传递矩阵,R为能量损耗矩阵;其中g为复合物理系统的输入矩阵,g⊥是g的满秩零化子,并且哈密顿函数Hd(x)满足条件:
x*=argminHd(x)
x*为待稳定的目标点,满足复合物理系统的端口哈密顿模型完全渐进稳定的级联与阻尼配置无源控制方法的表达式如下:
其中Jd、Rd分别是逆转矩阵和对称矩阵;
步骤3.3、证明由离子聚合物金属复合材料驱动的内窥柔性机械臂模型具有无源性;
首先定义一个复合物理系统g的满秩零化子g⊥:
In是对角线为1的对角矩阵,矩阵维度为n×n;
通过设置Rd=R+Rc,对复合物理系统进行阻尼注入,Rc=diag(0 0 rc 0),rc为阻尼参数;
通过设置Hd(x)=H(x)+Hc(x),将步骤3.1中匹配条件写成以下匹配方程式:
从上述匹配条件,复合物理系统所需能量的交叉项在x3、φ和Q之间,假设:
选择以下参数的值满足匹配条件:
将上述参数代入步骤3.1的无源控制方法的表达式中,得到步骤3.2中设计的控制器表达式;
步骤4、计算无源控制参数C′和阻尼参数rc,最后控制参数K;
通过控制阻尼参数rc控制对复合物理系统阻尼注入的量,通过增大阻尼参数rc的值来抑制柔性机械臂的抖振;
步骤5、设定完成的控制算法下载到数字信号处理器中,复合物理系统通过IPMC驱动模块两端的电压驱动使IPMC驱动模块发生形变,从而驱动内窥柔性机械臂模型的柔性机械梁模块,进而控制位于柔性机械梁模块内机械臂末端的内窥镜的位置。
2.根据权利要求1所述柔性机械臂的无源控制方法,其特征在于,步骤1具体包括以下步骤:
步骤1.1、柔性机械梁模块的状态方程使用铁木辛哥梁模型的状态方程,表达如下:
上式中,z为空间变量,t为时间变量;w(z,t)是横向位移;是梁的旋转角度;系数ρ是单位质量长度;系数Iρ是横截面的转动惯量;系数E是杨氏弹性模量;系数I是惯性矩横截面;系数K是剪切模量;τ(z,t)是施加于柔性梁的力矩;
步骤1.2、IPMC驱动模块的状态方程由双电层电极模型、电应力扩散模型、机械横梁三种偏微分方程表示;
其中双电层电极的偏微分方程为:
上式中,t为时间变量,C2(t)是双电层电容,R1是电极的电阻,R2是聚合电阻,v是电势,i是电流,ε是电极的电阻相对电极表面的虚拟坐标;
电应力扩散模型的偏微分方程为:
上式中,z为空间变量,t为时间变量;fs(z,t)为电荷溶胀率,je(z,t)是电流密度,js(z,t)是水流密度,σe是电导率,K是Darcy渗透度,Kz是碰撞模量常数,λ是Onsager耦合常数,G是剪切弹性模量常数。
4.根据权利要求2所述基于端口哈密顿建模的离子聚合物金属复合材料柔性机械臂的无源控制方法,其特征在于,步骤2具体包括以下步骤:
步骤2.1、复合物理系统的柔性机械梁模块被视为季莫申科梁模型,复合物理系统中柔性机械梁模块的端口哈密顿模型表达式如下:
上式中,x(t)为状态变量,并且:
柔性机械梁模块具有状态变量:剪切应变横向动量分布角应变和角动量分布其中z∈(a,b),a、b分别为空间中柔性机械梁模块内柔性机械臂的两端;t为时间变量,t≥0;w是横向位移;状态空间X=L2([a,b];R4),其中,L2空间是线性空间,状态空间定义在L2空间内,R4表示有四个实数状态变量;逆转算子是一个作用于状态空间X的阶偏对称微分算子;矩阵是耗散矩阵,Rt和Rr分别为平移和角度粘滞分数常数;
柔性机械梁模块的能量表示为:
上式中,a、b分别为空间中柔性机械梁模块内柔性机械臂的两端;柔性机械梁模块的分布式位移由IPMC执行器在梁上的产生的分布力矩控制;分布力矩作为分布输入变量:
上式中,为分布式输入映射,b(z)=[b1(z),…,bm(z)],ud=[ud1(z),…,udm(z)]T,m是IPMC驱动器的个数,IPMC驱动器包括固定端驱动器和中端驱动器;分布输出变量是分布输入变量的幂共轭变量:
柔性机械梁模块的能量方程为:
步骤2.2、复合物理系统的IPMC驱动模块中,IPMC执行器通过改变其电力系统的电压使柔性材料进行形变;IPMC执行器等效为双电层RC电路模型,双电层RC电路模型两端的电压作为控制变量,复合物理系统中IPMC驱动模块的端口哈密顿模型表达式如下:
IPMC驱动模块的总能量定义为磁能和电能状态向量为xa=[φ,Q]T,其中φ为磁通量,C为电容,Q为电容器的电荷,r1和r2是等效电路电阻,u(t)是在IPMC执行器上施加的电压,ua是由复合物理系统的机械运动产生在IPMC等效电容器的电流,y是电感,ya是IPMC等效电容器两端的电压;
当内窥柔性机械臂模型由m个IPMC驱动器驱动时,所有IPMC驱动器的端口哈密顿模型表达式如下:
Im、R1、R1分别是对角线为1、r1、r2的对角矩阵,矩阵维度皆为m×m;φ为磁通量,Q为电容器的电荷;
步骤2.3、复合物理系统的端口哈密顿模型建模:
IPMC执行器弯曲作用在柔性机械梁模块上,IPMC执行器和柔性机械梁模块的互连关系定义为:
k=diag[k1,…,km],ya为联结作用在柔性机械梁模块的力矩,k是联结作用在柔性机械梁模块的力矩ya的常数系数,柔性机械梁模块与IPMC执行器的互连模型为:
则复合物理系统的端口哈密顿模型为:
上式中,g(x)是输入矩阵;其中J为能量传递矩阵,R为能量损耗矩阵;u是在IPMC执行器上施加的电压;
复合物理系统的总能量为:
步骤2.4、通过端口哈密顿模型证明复合物理系统的无源性步骤为:
将哈密顿函数作为复合物理系统的能量存储函数:
建立复合物理系统的动态方程:
上式中,H(t)为复合物理系统的能量存储函数,为复合物理系统的时变状态变量;逆转矩阵J=-JT表示复合物理系统的能量传递;R表示复合物理系统的内部能量耗散矩阵,R=RT≥0;B(t)是输入矩阵;u(t)是对耦输入变量,y是对耦输出变量,u(t)和y表示系统和外部环境的能量交互;
将复合物理系统的功率平衡方程表示如下:
由于复合物理系统的功率始终小于或者等于复合物理系统无损耗时输入输出的功率,则端口哈密顿模型是无源的,则内窥柔性机械臂模型也是无源的。
5.根据权利要求1所述柔性机械臂的无源控制方法,其特征在于:步骤1中柔性机械梁模块为柔性梁结构。
7.根据权利要求1所述柔性机械臂的无源控制方法,其特征在于:步骤1中内窥柔性机械臂模型由一片或两片离子聚合物金属复合材料驱动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110764320.4A CN113370218B (zh) | 2021-07-06 | 2021-07-06 | 基于离子聚合物金属复合材料柔性机械臂的无源控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110764320.4A CN113370218B (zh) | 2021-07-06 | 2021-07-06 | 基于离子聚合物金属复合材料柔性机械臂的无源控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113370218A true CN113370218A (zh) | 2021-09-10 |
CN113370218B CN113370218B (zh) | 2021-11-26 |
Family
ID=77581162
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110764320.4A Active CN113370218B (zh) | 2021-07-06 | 2021-07-06 | 基于离子聚合物金属复合材料柔性机械臂的无源控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113370218B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4928047A (en) * | 1988-03-31 | 1990-05-22 | Agency Of Industrial Science & Technology, Ministry Of International Trade | Manipulator and control method |
CN104723340A (zh) * | 2015-03-07 | 2015-06-24 | 哈尔滨工业大学 | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 |
CN107589671A (zh) * | 2017-09-22 | 2018-01-16 | 哈尔滨工业大学 | 一种基于事件驱动的卫星姿态控制方法 |
CN108555913A (zh) * | 2018-06-15 | 2018-09-21 | 天津大学 | 基于无源性的移动机械臂位置/力的自抗扰控制方法 |
CN110794678A (zh) * | 2019-11-05 | 2020-02-14 | 燕山大学 | 一种磁滞非线性受限下的四通道遥操作力反馈控制方法 |
-
2021
- 2021-07-06 CN CN202110764320.4A patent/CN113370218B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4928047A (en) * | 1988-03-31 | 1990-05-22 | Agency Of Industrial Science & Technology, Ministry Of International Trade | Manipulator and control method |
CN104723340A (zh) * | 2015-03-07 | 2015-06-24 | 哈尔滨工业大学 | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 |
CN107589671A (zh) * | 2017-09-22 | 2018-01-16 | 哈尔滨工业大学 | 一种基于事件驱动的卫星姿态控制方法 |
CN108555913A (zh) * | 2018-06-15 | 2018-09-21 | 天津大学 | 基于无源性的移动机械臂位置/力的自抗扰控制方法 |
CN110794678A (zh) * | 2019-11-05 | 2020-02-14 | 燕山大学 | 一种磁滞非线性受限下的四通道遥操作力反馈控制方法 |
Non-Patent Citations (2)
Title |
---|
朱杨晔: "基于无源化方法单臂柔性机械臂的控制研究", 《第五届全国流体传动与控制学术会议暨2008 年中国航空学会液压与气动学术会议》 * |
邱志成: "柔性机械臂的振动测量和控制研究进展综述", 《信息与控制》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113370218B (zh) | 2021-11-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Lee et al. | Nonparametric online learning control for soft continuum robot: An enabling technique for effective endoscopic navigation | |
Paez et al. | Design and analysis of a soft pneumatic actuator with origami shell reinforcement | |
Lipson | Challenges and opportunities for design, simulation, and fabrication of soft robots | |
Hao et al. | Modeling and adaptive inverse control of hysteresis and creep in ionic polymer–metal composite actuators | |
Bar-Cohen | Electroactive polymers: current capabilities and challenges | |
US7865268B2 (en) | Mechanical fish robot exploiting vibration modes for locomotion | |
CN107914269B (zh) | 一种基于蜂巢气动网络的软体机器人 | |
Liaw et al. | Sliding-mode enhanced adaptive motion tracking control of piezoelectric actuation systems for micro/nano manipulation | |
Duriez et al. | Framework for online simulation of soft robots with optimization-based inverse model | |
Yim et al. | An artificial muscle actuator for biomimetic underwater propulsors | |
CN110597072B (zh) | 机器人导纳柔顺控制方法及系统 | |
Liaw et al. | Robust neural network motion tracking control of piezoelectric actuation systems for micro/nanomanipulation | |
Mutlu et al. | An effective methodology to solve inverse kinematics of electroactive polymer actuators modelled as active and soft robotic structures | |
Mattioni et al. | Modelling and control of an IPMC actuated flexible structure: A lumped port Hamiltonian approach | |
Xiao et al. | Design, characterization and optimization of multi-directional bending pneumatic artificial muscles | |
JP3369351B2 (ja) | 多関節マニピュレータの弾性設定方法および制御装置 | |
CN113370218B (zh) | 基于离子聚合物金属复合材料柔性机械臂的无源控制方法 | |
CN114700951A (zh) | 一种用于医护机器人的柔顺控制方法 | |
Moghadam et al. | Analytical dynamic modeling of fast trilayer polypyrrole bending actuators | |
CN112589798B (zh) | 基于介电弹性体执行器的软体机器人状态反馈控制方法 | |
Lin et al. | Control of ionic polymer-metal composites for active catheter systems via linear parameter-varying approach | |
CN113858204A (zh) | 一种冗余机械臂的追踪控制方法、装置及介质 | |
Wu et al. | Modeling and control of an IPMC actuated flexible beam under the port-Hamiltonian framework | |
Zhang et al. | A two-stage optimization procedure for the design of an EAP-actuated soft gripper | |
Macchelli et al. | Port-Hamiltonian Control Design for an IPMC Actuated Highly Flexible Endoscope |
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 |