CN114967723A - 一种超空泡外形航行体高精度姿态控制方法 - Google Patents
一种超空泡外形航行体高精度姿态控制方法 Download PDFInfo
- Publication number
- CN114967723A CN114967723A CN202210672793.6A CN202210672793A CN114967723A CN 114967723 A CN114967723 A CN 114967723A CN 202210672793 A CN202210672793 A CN 202210672793A CN 114967723 A CN114967723 A CN 114967723A
- Authority
- CN
- China
- Prior art keywords
- attitude
- navigation body
- control method
- channel
- control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 40
- 238000005096 rolling process Methods 0.000 claims abstract description 13
- 238000004088 simulation Methods 0.000 claims abstract description 5
- 230000003044 adaptive effect Effects 0.000 claims description 8
- 230000008878 coupling Effects 0.000 claims description 8
- 238000010168 coupling process Methods 0.000 claims description 8
- 238000005859 coupling reaction Methods 0.000 claims description 8
- 238000009795 derivation Methods 0.000 claims description 4
- 239000012530 fluid Substances 0.000 claims description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0833—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using limited authority control
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Computer Security & Cryptography (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明属于航行体控制领域,公开了一种超空泡外形航行体高精度姿态控制方法。步骤1:建立超空泡外形航行体的姿态动力学模型;步骤2:基于步骤1的姿态动力学模型,设计高精度姿态控制律;步骤3:基于步骤2设计的高精度姿态控制律,进行数学仿真分析。本发明用以解决当航行体同时作俯仰、偏航和滚转三个方向或两个通道组合机动时控制精度不够,或导致航行体姿态失控的问题,实现对航行体姿态的高精度控制。
Description
技术领域
本发明属于航行体控制领域,具体涉及一种超空泡外形航行体高精度姿态控制方法。
背景技术
超空泡外形的航行体在水下航行尤其是机动航行时,由于俯仰、偏航和滚转三个通道间存在较大的耦合关系,为控制器设计增加了难度,常规航行体姿态控制系统设计都是采用各通道独立设计PID参数的控制策略,这种控制策略在航行器定深直航或弱机动时能保证控制精度满足要求,但当航行体同时作俯仰、偏航和滚转三个方向或两个通道组合机动时,由于通道间的耦合效应,会造成控制精度不够,甚至导致航行体姿态失控。
发明内容
本发明提供一种超空泡外形航行体高精度姿态控制方法,用以解决当航行体同时作俯仰、偏航和滚转三个方向或两个通道组合机动时控制精度不够,或导致航行体姿态失控的问题,实现对航行体姿态的高精度控制。
本发明通过以下技术方案实现:
一种超空泡外形航行体高精度姿态控制方法,所述控制方法包括以下步骤:
步骤1:建立超空泡外形航行体的姿态动力学模型;
步骤2:基于步骤1的姿态动力学模型,设计高精度姿态控制律;
步骤3:基于步骤2设计的高精度姿态控制律,进行数学仿真分析。
一种超空泡外形航行体高精度姿态控制方法,所述步骤1具体包括以下步骤:
步骤1.1:建立航行体姿态动力学方程;
步骤1.2:建立航行体姿态运动学方程;
步骤1.3:基于步骤1.1的方程和步骤1.2的方程对俯仰子系统状态方程进行推导;
步骤1.4:得到俯仰通道的状态方程;
步骤1.5:得到偏航通道的状态方程;
步骤1.6:基于步骤1.4和步骤1.5得到滚转通道的状态方程。
一种超空泡外形航行体高精度姿态控制方法,所述步骤1.1的建立航行体姿态动力学方程具体为,
一种超空泡外形航行体高精度姿态控制方法,所述步骤1.2的建立航行体姿态运动学方程具体为,
一种超空泡外形航行体高精度姿态控制方法,是步骤1.3对俯仰子系统状态方程进行推导具体为,
又由角速度表达式有:
一种超空泡外形航行体高精度姿态控制方法,所述步骤1.4得到俯仰通道的状态方程具体为,
其中,fz代表耦合项。
一种超空泡外形航行体高精度姿态控制方法,所述所述步骤1.5得到偏航通道的状态方程具体为,
式中,fy代表耦合项。
一种超空泡外形航行体高精度姿态控制方法,所述步骤2的设计高精度姿态控制律具体为:
对于俯仰子系统,进行精确线性化,得偏航通道的控制律;
基于自适应律对干扰进行自适应补偿,得到滚转通道控制律。
一种超空泡外形航行体高精度姿态控制方法,对于俯仰子系统,进行精确线性化,得偏航通道的控制律具体为,
取滑模面为:
对其求导可得:
设计指数型滑模趋近律为:
式中,ε>0,k>0为控制系数;
联立和得:
同理可得偏航通道的控制律为:
一种超空泡外形航行体高精度姿态控制方法,所述基于自适应律对干扰进行自适应补偿,得到滚转通道控制律具体为,考虑外界干扰d(t)影响:
设计自适应律对干扰进行自适应补偿:
式中,λ为正常数,代表收敛速率,|·|代表向量的模;
故最终滚转通道控制律为:
本发明的有益效果是:
本发明在分别设计三通道回路的同时,考虑三通道间的耦合关系,将其进行协调设计,实现对航行体姿态的高精度控制。
本发明能在设计航行体姿态控制器时,对外界干扰进行自适应高精度估计,从而在姿态控制系统中进行补偿,实现对各通道控制指令的精确跟踪,具备优秀的鲁棒性。
本发明在滑模控制器中采用了指数型滑模趋近律,能够实现对期望指令平滑跟踪,且收敛速度快,收敛时间短。
本发明通过精确线性化的方式设计了俯仰、偏航、滚转三通道的控制器,提高了控制精度,保证了系统稳定性,并且进行三通道的解耦,能够使得三通道分别进行参数整定,从而呈现出更优的控制性能。
附图说明
图1是本发明的结构示意图。
图2是本发明的航行体深度曲线图。
图3是本发明的航行体姿态角曲线图。
图4是本发明的滚转舵偏角示意图。
图5是本发明的俯仰舵偏角示意图。
图6是本发明的偏航舵偏角示意图。
图7是本发明的三维曲线图。
具体实施方式
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
一种超空泡外形航行体高精度姿态控制方法,所述控制方法包括以下步骤:
步骤1:建立超空泡外形航行体的姿态动力学模型;
步骤2:基于步骤1的姿态动力学模型,设计高精度姿态控制律;
步骤3:基于步骤2设计的高精度姿态控制律,进行数学仿真分析。
一种超空泡外形航行体高精度姿态控制方法,所述步骤1具体包括以下步骤:
步骤1.1:建立航行体姿态动力学方程;
步骤1.2:建立航行体姿态运动学方程;
步骤1.3:基于步骤1.1的方程和步骤1.2的方程对俯仰子系统状态方程进行推导;
步骤1.4:得到俯仰通道的状态方程;
步骤1.5:得到偏航通道的状态方程;
步骤1.6:基于步骤1.4和步骤1.5得到滚转通道的状态方程。
一种超空泡外形航行体高精度姿态控制方法,所述步骤1.1的建立航行体姿态动力学方程具体为,
一种超空泡外形航行体高精度姿态控制方法,所述步骤1.2的建立航行体姿态运动学方程具体为,
一种超空泡外形航行体高精度姿态控制方法,是步骤1.3对俯仰子系统状态方程进行推导具体为,
又由角速度表达式有:
一种超空泡外形航行体高精度姿态控制方法,所述步骤1.4得到俯仰通道的状态方程具体为,
其中,fz代表耦合项。
一种超空泡外形航行体高精度姿态控制方法,所述所述步骤1.5得到偏航通道的状态方程具体为,
式中,fy代表耦合项。
一种超空泡外形航行体高精度姿态控制方法,所述步骤2的设计高精度姿态控制律具体为:
对于俯仰子系统,进行精确线性化,得偏航通道的控制律;
基于自适应律对干扰进行自适应补偿,得到滚转通道控制律。
一种超空泡外形航行体高精度姿态控制方法,对于俯仰子系统,进行精确线性化,得偏航通道的控制律具体为,
取滑模面为:
对其求导可得:
设计指数型滑模趋近律为:
式中,ε>0,k>0为控制系数;
联立和得:
同理可得偏航通道的控制律为:
一种超空泡外形航行体高精度姿态控制方法,所述基于自适应律对干扰进行自适应补偿,得到滚转通道控制律具体为,考虑外界干扰d(t)影响:
设计自适应律对干扰进行自适应补偿:
式中,λ为正常数,代表收敛速率,|·|代表向量的模;
故最终滚转通道控制律为:
数学仿真分析,设定工况如下:
变量 | 数值 |
深度 | 5米 |
目标航速 | 8kn |
目标机动 | 是 |
目标机动形式 | 正弦机动 |
根据上述工况设定,如图2、3、4、5、6和7所示,该控制算法精度较高,深度,姿态角等均能满足控制精度要求,在目标机动频率较高的情况下,依然能够保证对控制信号的准确追踪,证实了控制系统的有效性。
Claims (10)
1.一种超空泡外形航行体高精度姿态控制方法,其特征在于,所述控制方法包括以下步骤:
步骤1:建立超空泡外形航行体的姿态动力学模型;
步骤2:基于步骤1的姿态动力学模型,设计高精度姿态控制律;
步骤3:基于步骤2设计的高精度姿态控制律,进行数学仿真分析。
2.根据权利要求1所述一种控制方法,其特征在于,所述步骤1具体包括以下步骤:
步骤1.1:建立航行体姿态动力学方程;
步骤1.2:建立航行体姿态运动学方程;
步骤1.3:基于步骤1.1的方程和步骤1.2的方程对俯仰子系统状态方程进行推导;
步骤1.4:得到俯仰通道的状态方程;
步骤1.5:得到偏航通道的状态方程;
步骤1.6:基于步骤1.4和步骤1.5得到滚转通道的状态方程。
8.根据权利要求1所述一种控制方法,其特征在于,所述步骤2的设计高精度姿态控制律具体为:
对于俯仰子系统,进行精确线性化,得偏航通道的控制律;
基于自适应律对干扰进行自适应补偿,得到滚转通道控制律。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210672793.6A CN114967723B (zh) | 2022-06-15 | 2022-06-15 | 一种超空泡外形航行体高精度姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210672793.6A CN114967723B (zh) | 2022-06-15 | 2022-06-15 | 一种超空泡外形航行体高精度姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114967723A true CN114967723A (zh) | 2022-08-30 |
CN114967723B CN114967723B (zh) | 2023-09-15 |
Family
ID=82963033
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210672793.6A Active CN114967723B (zh) | 2022-06-15 | 2022-06-15 | 一种超空泡外形航行体高精度姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114967723B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116176870A (zh) * | 2023-03-20 | 2023-05-30 | 北京星途探索科技有限公司 | 一种用于飞行器的固体姿轨控动力系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2724364A1 (fr) * | 1994-09-12 | 1996-03-15 | Matra Marconi Space France | Procede et systeme de stabilisation selon trois axes d'un satellite d'orbite non-equatoriale |
CN110231831A (zh) * | 2019-07-23 | 2019-09-13 | 兰州理工大学 | 一种基于角度测量的航天器姿态解耦最优控制方法 |
CN111045440A (zh) * | 2019-12-16 | 2020-04-21 | 北京航空航天大学 | 一种高超声速飞行器俯冲段快速滚转控制方法 |
CN111176312A (zh) * | 2020-01-03 | 2020-05-19 | 莆田学院 | 一种四旋翼无人机姿态自抗扰动态面控制方法及存储介质 |
CN112578805A (zh) * | 2020-12-30 | 2021-03-30 | 湖北航天飞行器研究所 | 一种旋翼飞行器的姿态控制方法 |
CN113342025A (zh) * | 2021-06-25 | 2021-09-03 | 南京航空航天大学 | 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法 |
US20220137643A1 (en) * | 2019-07-12 | 2022-05-05 | Autel Robotics Co., Ltd. | Aircraft control method and aircraft |
-
2022
- 2022-06-15 CN CN202210672793.6A patent/CN114967723B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2724364A1 (fr) * | 1994-09-12 | 1996-03-15 | Matra Marconi Space France | Procede et systeme de stabilisation selon trois axes d'un satellite d'orbite non-equatoriale |
US20220137643A1 (en) * | 2019-07-12 | 2022-05-05 | Autel Robotics Co., Ltd. | Aircraft control method and aircraft |
CN110231831A (zh) * | 2019-07-23 | 2019-09-13 | 兰州理工大学 | 一种基于角度测量的航天器姿态解耦最优控制方法 |
CN111045440A (zh) * | 2019-12-16 | 2020-04-21 | 北京航空航天大学 | 一种高超声速飞行器俯冲段快速滚转控制方法 |
CN111176312A (zh) * | 2020-01-03 | 2020-05-19 | 莆田学院 | 一种四旋翼无人机姿态自抗扰动态面控制方法及存储介质 |
CN112578805A (zh) * | 2020-12-30 | 2021-03-30 | 湖北航天飞行器研究所 | 一种旋翼飞行器的姿态控制方法 |
CN113342025A (zh) * | 2021-06-25 | 2021-09-03 | 南京航空航天大学 | 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116176870A (zh) * | 2023-03-20 | 2023-05-30 | 北京星途探索科技有限公司 | 一种用于飞行器的固体姿轨控动力系统 |
CN116176870B (zh) * | 2023-03-20 | 2023-09-19 | 北京星途探索科技有限公司 | 一种用于飞行器的固体姿轨控动力系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114967723B (zh) | 2023-09-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109189071B (zh) | 基于模糊观测器的鲁棒自适应无人船路径跟踪控制方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
CN113093804B (zh) | 基于反演滑模控制的无人艇编队控制方法和控制系统 | |
CN112947462B (zh) | 考虑时变漂角与姿态调节的无人艇群编队协同控制方法 | |
CN106444822B (zh) | 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法 | |
CN106444806B (zh) | 基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 | |
CN108594846A (zh) | 一种障碍环境下多auv编队队形优化控制方法 | |
CN111487966B (zh) | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 | |
CN102880060A (zh) | 再入飞行器自适应指数时变滑模姿态控制方法 | |
CN111045432B (zh) | 一种欠驱动水面船非线性路径跟踪控制系统及方法 | |
CN106292293B (zh) | 一种固定翼无人舰载机的自适应自动着舰引导控制系统 | |
CN105807789B (zh) | 基于t-s模糊观测器补偿的uuv控制方法 | |
CN106292294B (zh) | 基于模型参考自适应控制的舰载无人机自动着舰控制装置 | |
CN107272719B (zh) | 基于协调因子的高超声速飞行器姿态运动协调控制方法 | |
CN105843224A (zh) | 基于神经动态模型反步法的auv水平面路径跟踪控制方法 | |
CN111857165B (zh) | 一种水下航行器的轨迹跟踪控制方法 | |
CN111290278B (zh) | 一种基于预测滑模的高超声速飞行器鲁棒姿态控制方法 | |
CN116047909B (zh) | 面向海事平行搜寻的无人机-船协同鲁棒自适应控制方法 | |
CN112527018A (zh) | 一种欠驱动自主水下航行器的三维镇定控制方法 | |
CN113741433B (zh) | 一种水面无人船的分布式编队方法 | |
CN114967723A (zh) | 一种超空泡外形航行体高精度姿态控制方法 | |
CN116382332B (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN117389312A (zh) | 一种基于模型的水下航行器抗衡滚三维跟踪控制方法 | |
CN112198885A (zh) | 一种满足机动平台自主降落需求的无人机控制方法 | |
CN112578814B (zh) | 一种用于多自主水下航行器编队直线航迹跟踪控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |