一种齿轮巡检非线性分数阶滑模线性扩展状态控制方法技术

本发明专利技术公开了一种齿轮巡检非线性分数阶滑模线性扩展状态控制方法，包括，基于齿轮巡检机器人系统N关节机械臂数学模型，构建无模型控制框架并定义齿轮巡检机器人系统N关节机械臂跟踪误差方程；利用线性扩展状态观测器，实现对齿轮巡检机器人系统不确定性参数和未知外扰进行实时观测补偿；以齿轮巡检机器人系统N关节机械臂跟踪误差方程为基础，结合非线性函数和分数阶微分，构建非线性分数阶滑模面；采用齿轮巡检机器人系统N关节机械臂数学模型相关的一般等速趋近律，设计齿轮巡检机器人系统N关节机械臂非线性分数阶滑模线性扩展状态观测无模型控制器；验证了齿轮巡检机器人N关节机械臂为目标的轨迹跟踪试验。器人N关节机械臂为目标的轨迹跟踪试验。器人N关节机械臂为目标的轨迹跟踪试验。

【技术实现步骤摘要】
一种齿轮巡检非线性分数阶滑模线性扩展状态控制方法


[0001]本专利技术涉及工业机器人控制系统
，尤其涉及一种齿轮巡检非线性分数阶滑模线性扩展状态控制方法。

技术介绍

[0002]低人工成本等优点。常见的工业机器人有：码垛机器人、焊接机器人、装配机器人、检测机器人。其中，巡检机器人作为一种检测机器人，兼具自主移动和视觉检测的功能，常常被用在工业瑕疵的探测、救难救灾现场、生命探测等。齿轮巡检机器人作为一种常规的检测机器人，可用于齿轮工艺检测，需对其末端机械臂轨迹进行有效地跟踪控制。
[0003]齿轮巡检机器人是由N关节机械臂和高倍相机组成，通过控制N关节机械臂末端轨迹，从而实现高倍相机多角度，多景深拍摄齿轮工艺图像。但齿轮巡检机器人作为一种非线性系统，其末端轨迹控制精度一直是需要解决的问题。常规的控制方法一般都是基于模型，存在模型不确定性和参数不准确等问题。

技术实现思路

[0004]鉴于上述现有存在的问题，提出了一种齿轮巡检非线性分数阶滑模线性扩展状态控制方法，本专利技术解决的技术问题是：如何针对齿轮巡检机器人系统N关节机械臂轨迹跟踪存在基于模型不确定性和参数不准确等问题。
[0005]为解决上述技术问题，本专利技术提供如下技术方案：基于齿轮巡检机器人系统N关节机械臂数学模型，构建无模型控制框架并定义齿轮巡检机器人系统N关节机械臂跟踪误差方程；利用线性扩展状态观测器，实现对齿轮巡检机器人系统不确定性参数和未知外扰进行实时观测补偿；以齿轮巡检机器人系统N关节机械臂跟踪误差方程为基础，结合非线性函数和分数阶微分，构建非线性分数阶滑模面；采用齿轮巡检机器人系统N关节机械臂数学模型相关的一般等速趋近律，设计齿轮巡检机器人系统N关节机械臂非线性分数阶滑模线性扩展状态观测无模型控制器τ(t)。
[0006]作为本专利技术所述的齿轮巡检非线性分数阶滑模线性扩展状态控制方法的一种优选方案，其中：
[0007]所述的齿轮巡检机器人系统包含：图像运算中心、高倍相机、N关节机械臂。
[0008]作为本专利技术所述的齿轮巡检非线性分数阶滑模线性扩展状态控制方法的一种优选方案，其中：
[0009]所述的齿轮巡检机器人系统N关节机械臂数学模型：
[0010][0011]其中，等式左边分别为：齿轮巡检机器人系统N关节机械臂惯性力项齿轮巡检机器人系统N关节机械臂离心力和哥氏力项齿轮巡检机器人系统N关节机械臂重力项G(q(t))∈R
n
×1、齿轮巡检机器人系统N关节机械臂
摩擦力项外扰项τ
d
(t)∈R
n
×1；M(q(t))∈R
n
×
n
为齿轮巡检机器人系统N关节机械臂惯性矩阵，为齿轮巡检机器人系统N关节机械臂离心力和哥氏力矩阵；等式右边为齿轮巡检机器人系统N关节机械臂控制力项τ(t)∈R
n
×1；
[0012]基于所述的齿轮巡检机器人系统N关节机械臂数学模型，构建无模型控制框架：
[0013][0014]其中，m(q(t))∈R
n
×
n
为齿轮巡检机器人系统N关节机械臂无模型框架控制器无物理意义调参增益矩阵，d(t)∈R
n
×1为齿轮巡检机器人系统不确定性参数和未知外扰，定义如下：
[0015][0016]定义所述的齿轮巡检机器人系统N关节机械臂的跟踪误差为：
[0017]e(t)＝q
*
(t)
‑
q(t)
[0018]其中，q
*
(t)是所述的齿轮巡检机器人系统N关节机械臂的目标轨迹，q(t)是所述的齿轮巡检机器人系统N关节机械臂的实际轨迹，e(t)是所述的齿轮巡检机器人系统N关节机械臂的跟踪误差；
[0019]将所述的齿轮巡检机器人系统N关节机械臂的跟踪误差取二阶微分得：
[0020][0021]其中，是e(t)的二阶微分；是q
*
(t)的二阶微分；是q(t)的二阶微分；
[0022]定义齿轮巡检机器人系统N关节机械臂跟踪误差方程：
[0023][0024]作为本专利技术所述的齿轮巡检非线性分数阶滑模线性扩展状态控制方法的一种优选方案，其中：
[0025]定义线性扩展状态观测器：
[0026][0027][0028]其中，e1＝g1(t)
‑
q(t)是线性扩展状态观测器的观测误差，g1(t)是齿轮巡检机器人系统N关节机械臂实际轨迹的估计值；g2(t)是齿轮巡检机器人系统N关节机械臂不确定性参数和未知外扰的估计值。
[0029]作为本专利技术所述的齿轮巡检非线性分数阶滑模线性扩展状态控制方法的一种优选方案，其中：
[0030]定义非线性分数阶滑模面：
[0031][0032]s(t)＝[s1(t) s2(t)
ꢀ…ꢀ
s
n
(t)]T
[0033]k
np
＝diag[k
1np k
2np
ꢀ…ꢀ
k
nnp
]T
[0034]k
nd
＝diag[k
1nd k
2nd
ꢀ…ꢀ
k
nnd
]T
[0035][0036]e(t)＝[e1(t) e2(t)
ꢀ…ꢀ
e
n
(t)]T
[0037][0038][0039]其中，s1(t)，s2(t)，
…
，s
n
(t)是非线性分数阶滑模面s(t)的子滑模面，k
np
是非线性分数阶滑模面非线性比例项的调参增益，k
nd
是非线性分数阶滑模面非线性微分项的调参增益，fal[e(t),γ,η]是非线性函数，γ和η是调参增益，满足：0<γ<1，η>0，sign[e(t)]是符号函数，满足：是分数阶微分，j是分数阶微分阶数；
[0040]将所述的非线性分数阶滑模面取一阶微分的：
[0041][0042]其中，是非线性分数阶滑模面s(t)子滑模面的一阶微分。
[0043]作为本专利技术所述的齿轮巡检非线性分数阶滑模线性扩展状态控制方法的一种优
选方案，其中：
[0044]定义齿轮巡检机器人系统N关节机械臂数学模型相关的一般等速趋近律：
[0045][0046]α＝[α
1 α2ꢀ…ꢀ
α
n
][0047]d
max
(t)＝[d
1max
(t) d
2max
(t)
ꢀ…ꢀ
d
nmax
(t)][0048][0049]其中，α是调参增益，满足：α
n
>0，d
max
(t)是齿轮巡检机本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种齿轮巡检非线性分数阶滑模线性扩展状态控制方法，其特征在于：包括如下步骤：S1，基于齿轮巡检机器人系统N关节机械臂数学模型，构建无模型控制框架并定义齿轮巡检机器人系统N关节机械臂跟踪误差方程；S2，利用线性扩展状态观测器，实现对齿轮巡检机器人系统不确定性参数和未知外扰进行实时观测补偿；S3，以齿轮巡检机器人系统N关节机械臂跟踪误差方程为基础，结合非线性函数和分数阶微分，构建非线性分数阶滑模面；S4,，采用齿轮巡检机器人系统N关节机械臂数学模型相关的一般等速趋近律，设计齿轮巡检机器人系统N关节机械臂非线性分数阶滑模线性扩展状态观测无模型控制器τ(t)。2.根据权利要求1所述的一种齿轮巡检非线性分数阶滑模线性扩展状态控制方法，其特征在于：步骤S1中，所述的齿轮巡检机器人系统包含：图像运算中心、高倍相机、N关节机械臂。3.根据权利要求1～2任一所述的一种齿轮巡检非线性分数阶滑模线性扩展状态控制方法，其特征在于：步骤S1中，所述的齿轮巡检机器人系统N关节机械臂数学模型：其中，等式左边分别为：齿轮巡检机器人系统N关节机械臂惯性力项齿轮巡检机器人系统N关节机械臂离心力和哥氏力项齿轮巡检机器人系统N关节机械臂重力项G(q(t))∈R
n
×1、齿轮巡检机器人系统N关节机械臂摩擦力项外扰项τ
d
(t)∈R
n
×1；M(q(t))∈R
n
×
n
为齿轮巡检机器人系统N关节机械臂惯性矩阵，为齿轮巡检机器人系统N关节机械臂离心力和哥氏力矩阵；等式右边为齿轮巡检机器人系统N关节机械臂控制力项τ(t)∈R
n
×1；基于所述的齿轮巡检机器人系统N关节机械臂数学模型，构建无模型控制框架：其中，m(q(t)∈R
n
×
n
为齿轮巡检机器人系统N关节机械臂无模型框架控制器无物理意义调参增益矩阵，d(t)∈R
n
×1为齿轮巡检机器人系统不确定性参数和未知外扰，定义如下：定义所述的齿轮巡检机器人系统N关节机械臂的跟踪误差为：e(t)＝q
*
(t)
‑
q(t)其中，q
*
(t)是所述的齿轮巡检机器人系统N关节机械臂的目标轨迹，q(t)是所述的齿轮巡检机器人系统N关节机械臂的实际轨迹，e(t)是所述的齿轮巡检机器人系统N关节机械臂的跟踪误差；将所述的齿轮巡检机器人系统N关节机械臂的跟踪误差取二阶微分得：
其中，是e(t)的二阶微分；是q
*
(t)的二阶微分；是q(t)的二阶微分；定义齿轮巡检机器人系统N关节机械臂跟踪误差方程：4.根据权利要求1～3任一所述的一种齿轮巡检非线性分数阶滑模线性扩展状态控制方法，其特征在于：步骤S2中，定义线性扩展状态观测器，下式中α、δ和β均为线性扩展状态观测器的调参增益：观测器的调参增益：其中，e1＝g1(t)
‑...

【专利技术属性】
技术研发人员：朱明祥，鲍甜恬，
申请(专利权)人：南京师范大学泰州学院，
类型：发明
国别省市：