欢迎来到知嘟嘟! 联系电话:13095918853 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13095918853
知嘟嘟经纪人
收藏
专利号: 2018102943145
申请人: 厦门理工学院
专利类型:发明专利
专利状态:已下证
专利领域: 控制;调节
更新日期:2024-01-05
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种两关节机器人跟踪模糊控制设计方法,其特征在于,包括以下步骤:S1,搭建两关节机器人系统,所述两关节机器人系统包括两台永磁直流电机、第一关节和第二关节,所述第一关节和所述第二关节铰接,且两台所述永磁直流电机分别驱动所述第一关节和所述第二关节进行旋转;

S2,根据动力学原理,建立所述两关节机器人系统的数学模型,所述数学模型属于一个具有强耦合的非线性系统;中,所述两关节机器人系统的数学模型为:T T

其中,θ=[θ1 θ2],ω=[ω1 ω2],u1、u1分别为两个电动机的电枢电压;ω1、ω2分别为两个电机的角加速度,θ1、θ2分别为两个电机的角速度,Tm1、Tm2分别为两个电磁转矩;l1、l2分别为第一关节与第二个关节的臂长,lg1、为第一关节到该关节臂质心的距离,lg2为第二个关节到该关节臂质心的距离;m1、m2分别为第一关节臂的质量和第二关节臂的质量;I1、I2分别为第一关节臂的瞬时惯性和第二个关节臂的瞬时惯性;Bm1、Bm2分别为两个电动机的粘滞系数;

S3,基于所述数学模型以及模糊模型的表达方法,将所述非线性系统转化为模糊系统;

S4,基于所述两关节机器人系统的测量信号,设计追踪模糊输出反馈控制器;

S5,设计δ算子模糊滤波器,用于过滤测量噪声。

2.根据权利要求1所述的两关节机器人跟踪模糊控制设计方法,其特征在于,还包括:对两关节机器人的末端进行位置建模,得到:

3.根据权利要求2所述的两关节机器人跟踪模糊控制设计方法,其特征在于,步骤S3中,定义以下的测量变量作为所述模糊系统的前件变量:θ1,θ2,cosθ1,cosθ2,sinθ1,sinθ2,

4.根据权利要求3所述的两关节机器人跟踪模糊控制设计方法,其特征在于,所述非线性系统通过δ算子T‑S模糊模型表示为:T T

其中,x(t)=[θ1 θ2] ,z(t)=[X Y]代表两关节机器人的末端坐标,αi(t)为T‑S模糊系统的隶属度函数,{Ai,Bi,Ci,Di}为两关节系统矩阵,u(t)为输入的电枢电压,ω(t)为输出通道的扰动信号,z(t)为系统的调控输出信号。

5.根据权利要求4所述的两关节机器人跟踪模糊控制设计方法,其特征在于,步骤S4中,所述追踪模糊输出反馈控制器的构造如下:其中,Ki为系统的控制器增益, yd为两关节机器人的平面坐标参考状态,且假定yd=0。

6.根据权利要求5所述的两关节机器人跟踪模糊控制设计方法,其特征在于,将所述追踪模糊输出反馈控制器的公式(4)代入到模糊模型的公式(3),得到所述追踪模糊输出反馈控制器的闭环模糊控制系统:

其中,

7.根据权利要求6所述的两关节机器人跟踪模糊控制设计方法,其特征在于,所述追踪模糊输出反馈控制器的增益Ki由以下矩阵不等式进行求解设计:其中, *表示矩阵的对称,

Sym{*}表示矩阵*与*的转置之和,T为两关节系统的采样周期,G为任意的自由矩阵,P为正定对称矩阵。

8.根据权利要求7所述的两关节机器人跟踪模糊控制设计方法,其特征在于,步骤S5中,δ算子模糊滤波器构造如下:其中,xf(t)为滤波器的状态变量,{Afi,Bfi,Cfi}为所设计的滤波器增益。

9.根据权利要求8所述的两关节机器人跟踪模糊控制设计方法,其特征在于,所述滤波器的增益由以下的线性矩阵不等式进行求解设计:X‑Y>0 (9)

其中

其中Y,X是对称正定的矩阵

是任意的具有适当维数的矩阵,*表示矩阵的对称,Sym{*}表示矩阵*与*的转置之和;且所述滤波器的增益按以下公式计算:矩阵S和W是两个非奇异的矩阵,且满足:‑1

SW=I‑XY 。 (14)