一种基于约束力鲁棒伺服控制的欠驱动柔性机械臂系统技术方案

技术编号:19700116 阅读:71 留言:0更新日期:2018-12-08 13:28
本发明专利技术公开一种基于约束力鲁棒伺服控制的欠驱动柔性机械臂系统。所述欠驱动柔性机械臂系统采用约束力鲁棒伺服控制方法控制所述欠驱动柔性机械臂系统的机械臂。所述约束力鲁棒伺服控制方法在Udwadia和Kalaba的基本框架下,得到了可以应用在控制器设计中的约束力闭环形式,这对于伺服约束是可行的。另外,通过嵌入一个虚拟控制,将整个系统分成了两个子系统,再通过类Udwadia‑Kalaba控制部分控制方法和鲁棒控制部分控制方法,使得连杆角度近似的跟随给定的约束,同时保证了系统的一致边界性和整个系统的一致最终边界性能。

【技术实现步骤摘要】
一种基于约束力鲁棒伺服控制的欠驱动柔性机械臂系统
本专利技术涉及伺服控制方法领域,尤其涉及一种欠驱动柔性机械臂系统,特别是一种基于约束力鲁棒伺服控制的欠驱动柔性机械臂系统。
技术介绍
柔性关节机械臂被广泛的应用于工业领域中,作为一个有力的助手,机械臂可以为我们快速而精确地承担一系列的工作,例如定位和轨迹跟踪等。在实际情况中,机械臂结构被要求遵循确定的约束。所谓的约束主要分为两类:被动约束和伺服约束。对于被动约束,周围环境可以产生所需要的约束力来限制运动。一般认为,我们所未知的不确定性因素仍然是系统的一部分,而且整个系统包含所有不确定性的信息。因此,不确定性可以通过系统本身完全的解决。基于这些前提条件,许多学者为了确保系统服从这些约束规律已经做出了出色的研究。然而伺服约束问题却没有得到充分的研究,部分原因是由于难以获得约束力。我们知道,约束具有不同的形式并且有些形式是不完整的,这使得约束方程不可积分。此外柔性关节机械臂系统拥有比它的自由度数目更少的输入,换句话说,这是欠驱动的。因此,很难进行约束力的精确描述。
技术实现思路
本专利技术提供了一种基于约束力鲁棒伺服控制的欠驱动柔性机械臂系统,本文档来自技高网...

【技术保护点】
1.一种基于约束力鲁棒伺服控制的欠驱动柔性机械臂系统,其特征在于,其采用约束力鲁棒伺服控制方法控制所述欠驱动柔性机械臂系统的机械臂,所述约束力鲁棒伺服控制方法包括以下步骤:步骤(1),提供带有约束的欠驱动柔性机械臂系统的动力学方程:

【技术特征摘要】
1.一种基于约束力鲁棒伺服控制的欠驱动柔性机械臂系统,其特征在于,其采用约束力鲁棒伺服控制方法控制所述欠驱动柔性机械臂系统的机械臂,所述约束力鲁棒伺服控制方法包括以下步骤:步骤(1),提供带有约束的欠驱动柔性机械臂系统的动力学方程:其中,M代表欠驱动柔性机械臂系统的机械臂的惯量矩阵,C代表着所述机械臂的离心力,G代表所述机械臂的重力,K代表所述机械臂的弹性系数,q1代表所述机械臂的连杆角度矢量;q2代表所述机械臂的关节角度矢量,为q1的一阶求导,为q1的二阶求导,J代表所述机械臂的执行器惯量的对角矩阵;u代表所述机械臂的电机的输入力,为q2的二阶求导;步骤(2),引入虚拟控制变量u1,设x2=q2-u1,将所述动力学方程转换成:其中,步骤(3),令系统的虚拟控制u1,满足如下公式:u1=p11+p12+p13式(4.9)其中,p11,p12,p13分别代表虚拟控制u1的分量,p11代表理想约束控制部分,p12代表稳定性收敛控制部分,p13代表鲁棒控制部分;p11,p12,p13的获取过程包括以下步骤:(3.1)令系统的虚拟控制u1的分量p11,满足如下公式:其中,A代表欠驱动柔性机械臂系统的约束条件矩阵,代表M的名义部分,代表C的名义部分,代表G的名义部分,b1代表系统二阶约束目标值,这里上标+代表Moore-Penrose广义逆矩阵;(3.2)令系统的虚拟控制u1的分量p12,满足如下公式:其中,γ1为对应控制器分量p12的正增益参数,AT代表矩阵A的转置,P为任意n×n的正定矩阵,P-1为矩阵P的逆矩阵,c1代表系统一阶约束目标值;(3.3)令系统的虚拟控制u1的分量p13,满足如下公式:其中μ1代表调整式(3.4)的控制饱和区域大小的参数,Ф1代表正增益参数,ρ1代表式(3.4)中含有的不确定性和外界干扰的最大边界估计值;步骤(4),令系统的控制u,满足如下公式:其中,Kp代表带有对应维数的对角正定增益矩阵,S代表带有对应维数的对角正定增益矩阵,Kd代表带有对应维数的对角正定增益矩阵,代表K的名义部分,代表J的名义部分;这里μ2=(x3+Sx2)ρ2,p2代表一个标量函数,ρ2:R2n×Rn×Rn→R+,R代表实数,ε2>0。2.如权利要求1所述的基于约束力鲁棒伺服控制的欠驱动柔性机械臂系统,其特征在于,所述控制方法存在不确定边界的幅值影响,所述幅值影响采用平均控制力描述:分别...

【专利技术属性】
技术研发人员:董方方赵晓敏
申请(专利权)人:合肥工业大学
类型:发明
国别省市:安徽,34

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1