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

摘要:

权利要求书:

1.一种基于积分滑模障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法,其特征在于,包括以下步骤:步骤1,建立四旋翼飞行器系统的动态模型,设定系统的初始值、采样时间以及相关控制参数,过程如下:

1.1确定从基于四旋翼飞行器系统的机体坐标系到基于地球的惯性坐标的转移矩阵T:其中φ,θ,ψ分别是四旋翼飞行器的翻滚角、俯仰角、偏航角,表示无人机依次绕惯性坐标系的各坐标轴旋转的角度;

1.2四旋翼飞行器平动过程中的动态模型如下:其中x,y,z分别表示四旋翼飞行器在惯性坐标系下的三个位置,Uf表示四旋翼飞行器的输入力矩,m为四旋翼飞行器的质量,g表示重力加速度,将式(1)代入式(2)得:

1.3四旋翼飞行器转动过程中的动态模型为:其中τx,τy,τz分别代表机体坐标系上各个轴的力矩分量,Ixx,Iyy,Izz分别表示机体坐标系下的各个轴的转动惯量的分量,×表示叉乘,ωp表示翻滚角速度,ωq表示俯仰角速度,ωr表示偏航角速度, 表示翻滚角加速度, 表示俯仰角加速度, 表示偏航角加速度;

考虑到无人机处于低速飞行或者悬停状态,姿态角变化较小,认为因此式(4)改写为:

联立式(3)和式(5),得到四旋翼飞行器的动力学模型为:其中ux=cosφsinθcosψ+sinφsinψ,uy=cosφsinθsinψ-sinφcosψ;

1.4根据式(6),定义φ,θ的期望值为:其中φd为φ的期望信号值,θd为θ期望信号值,arcsin为反正弦函数;

步骤2,在每一个采样时刻,计算位置跟踪误差及其一阶导数;计算姿态角跟踪误差及其一阶导数;设计位置和姿态角控制器,过程如下:

2.1定义z跟踪误差及其一阶导数:其中zd表示z的期望信号;

2.2定义滑模面s1:

其中ρ1为正常数;

2.3设计障碍李雅普诺夫函数 并求解其一阶导数:其中Kb1为s1的边界,满足Kb1>|s1|max,|s1|max为|s1|的最大值, α1为虚拟控制量,其表达式为:其中k11为正常数,

将式(11)代入式(10),得:

2.4设计李雅普诺夫函数V12:求解式(13)的一阶导数,得:其中

将式(15)和式(6)代入式(14),得:

2.5设计Uf:

其中k12为正常数;

2.6定义x,y跟踪误差分别为e2,e3,则有:其中xd,yd分别表示x,y的期望信号;

2.7定义滑模面s2,s3:其中ρ2,ρ3为正常数;

2.8设计障碍李雅普诺夫函数 分别求解其一阶导数,得:

其中Kb2为e2的边界,满足Kb2>|s2|max,|s2|max为|s2|的最大值;Kb3为s3的边界,满足Kb3>|s3|max,|s3|max为|s3|的最大值; α2,α3为虚拟控制量,其表达式为:

其中k21,k31为正常数;

将式(21)代入式(20),得:

2.9设计李雅普诺夫函数V22,V32:求解式(23)的一阶导数,得:其中

将式(25),(6)代入式(24),分别得:

2.10通过式(26),(27)分别设计ux,uy:其中k22,k32为正常数;

2.11定义姿态角跟踪误差及其一阶导数:其中j=4,5,6,x4=φ,x5=θ,x6=ψ,x4d表示φ的期望值,x5d表示θ的期望值,x6d表示ψ的期望值,e4表示φ的跟踪误差,e5表示θ的跟踪误差,e6表示ψ的跟踪误差;

2.12定义滑模面sj:

其中ρj为正常数;

2.13设计障碍李雅普诺夫函数 并求解其一阶导数:其中Kbj为sj的边界,满足Kbj>|sj|max,|sj|max为|sj|的最大值; αj为姿态角的虚拟控制量,其表达式为:其中kj1为正常数;

将式(32)代入式(31),得:

2.14设计障碍李雅普诺夫函数Vj2:求解式(31)的一阶导数,得:其中

将式(36)和式(6)代入式(35),分别得:

2.15通过式(37),(38),(39)分别设计τx,τy,τz:其中k42,k52,k62为正常数。

2.如权利要求1所述的一种基于积分滑模障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法,其特征在于,所述方法还包括以下步骤:步骤3,验证四旋翼飞行器系统的稳定性;

3.1将式(17)代入式(16),得:

3.2将式(28)代入式(26)、(27),得:

3.3把式(40)代入式(37)、(38)、(39),得

3.4通过(41),(42),(43)可知四旋翼飞行器系统是稳定的。