利索能及
我要发布
收藏
专利号: 2024104382973
申请人: 南京信息工程大学
专利类型:发明专利
专利状态:已下证
更新日期:2026-01-08
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种四旋翼无人机分数阶抗饱和滑模控制方法,其特征在于,包括:根据飞行位置目标构建四旋翼无人机动力学模型中位置子系统的分数阶滑模函数,根据姿态角目标构建四旋翼无人机动力学模型中姿态子系统的分数阶滑模函数;

通过滑模变结构控制方法对所述位置子系统的分数阶滑模函数进行处理以获得第一等效控制律,并通过自适应增益调整法获得所述位置子系统的第一切换控制律,根据所述飞行位置目标、第一等效控制律、第一切换控制律和为削弱输入饱和对位置子系统影响而引进的第一抗饱和变量获得所述位置子系统的控制输入;

根据偏航角和所述位置子系统的控制输入反解出期望俯仰角和期望翻滚角;

通过滑模变结构控制方法对所述姿态子系统的分数阶滑模函数进行处理以获得第二等效控制律,并通过自适应增益调整法获得所述姿态子系统的第二切换控制律,根据所述姿态角目标、期望俯仰角、期望翻滚角、第二等效控制律、第二切换控制律和为削弱输入饱和对姿态子系统影响而引进的第二抗饱和变量获得所述姿态子系统的控制输入;

将所述位置子系统的控制输入和姿态子系统的控制输入共同输入四旋翼无人机动力学模型,实现四旋翼无人机轨迹跟踪飞行位置目标和姿态角目标;

所述飞行位置目标用于使无人机位置误差收敛于0且保持稳定;

所述姿态角目标用于使无人机翻滚角、俯仰角和偏航角误差收敛于0且保持稳定;

所述四旋翼无人机动力学模型为:

其中位置子系统为:

姿态子系统为:

虚拟控制输入为:

其中, 分别为在 轴的值,为翻滚角, 为俯仰角,为偏航角, 为机体质量,为重力加速度,为螺旋桨中心到重心的距离, , , 分别为三个坐标方向上的空气阻力系数, , , 分别为三个转动方向上的空气阻力系数,, ,分别为机体绕 ,,轴的转动惯量; 为位置子系统的控制输入,, ,为姿态子系统的控制输入, 控制无人机的垂直起降, 控制无人机的翻滚通道,控制无人机的俯仰通道,控制无人机的偏航通道; , 表示位置通道上的模型不确定部分, , 表示姿态通道上的模型不确定部分;, 表示在运动位置上所受的外界扰动,, 表示在转动角度上所受的外界扰动, 、、为所述四旋翼无人机在X方向,Y方向和Z方向上的虚拟控制输入;

所述通过滑模变结构控制方法对所述位置子系统的分数阶滑模函数进行处理以获得第一等效控制律,并通过自适应增益调整法获得所述位置子系统的第一切换控制律,包括:所述位置子系统的分数阶滑模函数包括:

其中, 、 、 分别表示在X方向,Y方向和Z方向上的分数阶滑模函数, 为正的常数增益, 为分数阶的阶次, 为常数阶次; 表示分数阶函数,所述四旋翼无人机的实际位置坐标为 ,期望的位置坐标为 ,  均为位置跟踪误差;

在不考虑干扰的情况下,令分数阶滑模函数等于0可求得位置子系统的第一等效控制律,所述第一等效控制律包括:;

其中, 、 、 分别表示在X方向,Y方向和Z方向上的第一等效控制律;

通过自适应增益调整法估计所述位置子系统中模型不确定和扰动的未知上界,将所述未知上界的估计值代替所述位置子系统中实际的模型不确定和扰动的未知上界获得第一切换控制律:;

其中, 、 、 分别表示在X方向,Y方向和Z方向上的切换控制律, 、 为正常数增益, 为趋近律的指数, 为分数阶的阶次, 为各通道不确定和扰动的未知上界的估计值,其遵循:;

、 、为别为X方向,Y方向和Z方向上的自适应律增益;

根据所述飞行位置目标、所述第一等效控制律、所述第一切换控制律和为削弱输入饱和对位置子系统影响而引进的第一抗饱和变量获得所述位置子系统的控制输入包括:所述第一抗饱和变量包括:

其中,为正常数增益, , ;

所述位置子系统的控制输入:

所述根据偏航角和所述位置子系统的控制输入反解出期望俯仰角和期望翻滚角包括:;

所述通过滑模变结构控制方法对所述姿态子系统的分数阶滑模函数进行处理以获得第二等效控制律,并通过自适应增益调整法获得所述姿态子系统的第二切换控制律,包括:所述姿态子系统的分数阶滑模函数包括:

其中, 、 、 分别表示在 方向, 方向和 方向上的分数阶滑模函数, 为正的常数增益, 为分数阶的阶次, 为常数阶次; 表示分数阶函数,所述四旋翼无人机实际姿态角为 ,期望的姿态角为 , 均为姿态跟踪误差;

在不考虑干扰的情况下,令分数阶滑模函数等于0可求得姿态子系统的第二等效控制律,所述第二等效控制律包括:;

其中, 、 、 分别表示在X方向,Y方向和Z方向上的第二等效控制律;

通过自适应增益调整法估计所述姿态子系统中模型不确定和扰动的未知上界,将所述未知上界的估计值代替所述姿态子系统中实际的模型不确定和扰动的未知上界获得第二切换控制律:;

其中, 、 、 分别表示在 方向, 方向和 方向上的切换控制律, 为趋近律的指数, 为正常数增益, 为分数阶的阶次, 为各通道模型不确定和扰动的未知上界的估计值,其遵循:;

、 、 为 方向,方向和 方向上的自适应律增益;

根据所述姿态角目标、期望俯仰角、期望翻滚角、第二等效控制律、第二切换控制律和为削弱输入饱和对姿态子系统影响而引进的第二抗饱和变量获得所述姿态子系统的控制输入包括:所述第二抗饱和变量包括:

其中,  为正常数增益, , ;

所述姿态子系统的控制输入:

2. 根据权利要求1中任一项所述的四旋翼无人机分数阶抗饱和滑模控制方法,其特征在于,根据所述姿态子系统和位置子系统的控制输入构成的控制输入向量 受输入饱和的限制,即

其中 , 是控制器的最大

控制输入, 是控制器的最小控制输入。

3.一种四旋翼无人机分数阶抗饱和滑模控制装置,其特征在于,包括:获取模块:用于根据飞行位置目标构建四旋翼无人机动力学模型中位置子系统的分数阶滑模函数,根据姿态角目标构建四旋翼无人机动力学模型中姿态子系统的分数阶滑模函数;

位置子系统处理模块:用于通过滑模变结构控制方法对所述位置子系统的分数阶滑模函数进行处理以获得第一等效控制律,并通过自适应增益调整法获得所述位置子系统的第一切换控制律,根据所述飞行位置目标、所述第一等效控制律、所述第一切换控制律和为削弱输入饱和对位置子系统影响而引进的第一抗饱和变量获得所述位置子系统的控制输入;

反解模块:用于根据偏航角和所述位置子系统的控制输入反解出期望俯仰角和期望翻滚角;

姿态子系统处理模块:用于通过滑模变结构控制方法对所述姿态子系统的分数阶滑模函数进行处理以获得第二等效控制律,并通过自适应增益调整法获得所述姿态子系统的第二切换控制律,根据所述姿态角目标、期望俯仰角、期望翻滚角、第二等效控制律、第二切换控制律和为削弱输入饱和对姿态子系统影响而引进的第二抗饱和变量获得所述姿态子系统的控制输入;

跟踪模块:用于将所述位置子系统的控制输入和姿态子系统的控制输入共同输入四旋翼无人机动力学模型,实现四旋翼无人机轨迹跟踪飞行位置目标和姿态角目标;

所述飞行位置目标用于使无人机位置误差收敛于0且保持稳定;

所述姿态角目标用于使无人机翻滚角、俯仰角和偏航角误差收敛于0且保持稳定;

所述四旋翼无人机动力学模型为:

其中位置子系统为:

姿态子系统为:

虚拟控制输入为:

其中, 分别为在 轴的值,为翻滚角, 为俯仰角,为偏航角, 为机体质量,为重力加速度,为螺旋桨中心到重心的距离, , , 分别为三个坐标方向上的空气阻力系数, , , 分别为三个转动方向上的空气阻力系数,, ,分别为机体绕 ,,轴的转动惯量; 为位置子系统的控制输入,, ,为姿态子系统的控制输入, 控制无人机的垂直起降, 控制无人机的翻滚通道,控制无人机的俯仰通道,控制无人机的偏航通道; , 表示位置通道上的模型不确定部分, , 表示姿态通道上的模型不确定部分;, 表示在运动位置上所受的外界扰动,, 表示在转动角度上所受的外界扰动, 、、为所述四旋翼无人机在X方向,Y方向和Z方向上的虚拟控制输入;

所述通过滑模变结构控制方法对所述位置子系统的分数阶滑模函数进行处理以获得第一等效控制律,并通过自适应增益调整法获得所述位置子系统的第一切换控制律,包括:所述位置子系统的分数阶滑模函数包括:

其中, 、 、 分别表示在X方向,Y方向和Z方向上的分数阶滑模函数, 为正的常数增益, 为分数阶的阶次, 为常数阶次; 表示分数阶函数,所述四旋翼无人机的实际位置坐标为 ,期望的位置坐标为 ,  均为位置跟踪误差;

在不考虑干扰的情况下,令分数阶滑模函数等于0可求得位置子系统的第一等效控制律,所述第一等效控制律包括:;

其中, 、 、 分别表示在X方向,Y方向和Z方向上的第一等效控制律;

通过自适应增益调整法估计所述位置子系统中模型不确定和扰动的未知上界,将所述未知上界的估计值代替所述位置子系统中实际的模型不确定和扰动的未知上界获得第一切换控制律:;

其中, 、 、 分别表示在X方向,Y方向和Z方向上的切换控制律, 、 为正常数增益, 为趋近律的指数, 为分数阶的阶次, 为各通道不确定和扰动的未知上界的估计值,其遵循:;

、 、为别为X方向,Y方向和Z方向上的自适应律增益;

根据所述飞行位置目标、所述第一等效控制律、所述第一切换控制律和为削弱输入饱和对位置子系统影响而引进的第一抗饱和变量获得所述位置子系统的控制输入包括:所述第一抗饱和变量包括:

其中,为正常数增益, , ;

所述位置子系统的控制输入:

所述根据偏航角和所述位置子系统的控制输入反解出期望俯仰角和期望翻滚角包括:;

所述通过滑模变结构控制方法对所述姿态子系统的分数阶滑模函数进行处理以获得第二等效控制律,并通过自适应增益调整法获得所述姿态子系统的第二切换控制律,包括:所述姿态子系统的分数阶滑模函数包括:

其中, 、 、 分别表示在 方向, 方向和 方向上的分数阶滑模函数, 为正的常数增益, 为分数阶的阶次, 为常数阶次; 表示分数阶函数,所述四旋翼无人机实际姿态角为 ,期望的姿态角为 , 均为姿态跟踪误差;

在不考虑干扰的情况下,令分数阶滑模函数等于0可求得姿态子系统的第二等效控制律,所述第二等效控制律包括:;

其中, 、 、 分别表示在X方向,Y方向和Z方向上的第二等效控制律;

通过自适应增益调整法估计所述姿态子系统中模型不确定和扰动的未知上界,将所述未知上界的估计值代替所述姿态子系统中实际的模型不确定和扰动的未知上界获得第二切换控制律:;

其中, 、 、 分别表示在 方向, 方向和 方向上的切换控制律, 为趋近律的指数, 为正常数增益, 为分数阶的阶次, 为各通道模型不确定和扰动的未知上界的估计值,其遵循:;

、 、 为 方向,方向和 方向上的自适应律增益;

根据所述姿态角目标、期望俯仰角、期望翻滚角、第二等效控制律、第二切换控制律和为削弱输入饱和对姿态子系统影响而引进的第二抗饱和变量获得所述姿态子系统的控制输入包括:所述第二抗饱和变量包括:

其中,  为正常数增益, , ;

所述姿态子系统的控制输入: