CN114061381A - 一种探空火箭载荷平台的快速调姿方法及装置 - Google Patents
一种探空火箭载荷平台的快速调姿方法及装置 Download PDFInfo
- Publication number
- CN114061381A CN114061381A CN202111527207.0A CN202111527207A CN114061381A CN 114061381 A CN114061381 A CN 114061381A CN 202111527207 A CN202111527207 A CN 202111527207A CN 114061381 A CN114061381 A CN 114061381A
- Authority
- CN
- China
- Prior art keywords
- attitude
- angular velocity
- momentum
- angular
- difference
- 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 28
- 239000013598 vector Substances 0.000 claims abstract description 12
- 230000002194 synthesizing effect Effects 0.000 claims abstract description 6
- 230000017105 transposition Effects 0.000 claims description 2
- 230000000087 stabilizing effect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 238000001514 detection method Methods 0.000 description 3
- 230000006641 stabilisation Effects 0.000 description 2
- 238000011105 stabilization Methods 0.000 description 2
- 235000015842 Hesperis Nutrition 0.000 description 1
- 235000012633 Iberis amara Nutrition 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 239000002994 raw material Substances 0.000 description 1
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42B—EXPLOSIVE CHARGES, e.g. FOR BLASTING, FIREWORKS, AMMUNITION
- F42B15/00—Self-propelled projectiles or missiles, e.g. rockets; Guided missiles
- F42B15/01—Arrangements thereon for guidance or control
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Combustion & Propulsion (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种探空火箭载荷平台的快速调姿方法及装置,方法包括步骤:计算当前姿态与目标姿态之差,获得差角值;利用差角值规划梯形角速度曲线,以获得角速度矢量;利用差角方向与角速度值合成各轴角速度指令;根据所述指令控制执行机构进行姿态调整和稳定操作,所述执行机构采用动量轮、飞轮等动量器件。用于低成本探空火箭载荷平台的快速调姿与稳定,采用角速度与角速度指令的误差项作为控制变量,实现对三轴大角度机动的跟踪控制,响应快、反应灵敏、控制器阶数低,容易实现。
Description
技术领域
本发明涉及探空火箭控制技术领域,尤其涉及一种探空火箭载荷平台的快速调姿方法及装置。
背景技术
探空火箭比探空气球飞得高,比低轨卫星轨道低,是30km~200km高度范围内的有效探测工具,可用于天气预报、地球和天文物理研究,还可以用于某些特殊问题的研究和试验。探空火箭结构简单、成本低廉、发射方便,适用于临时观察(相对)短时间出现的自然现象和特殊变化,以及持续观察某些随时间、地点变化的现象。
由于探空火箭对飞行姿态和弹道的要求不如导弹或运载火箭那么严格,因此为了降低成本,探空火箭一般为无控火箭,只有最基本的飞行稳定性和弹道要求:保证飞行稳定性、达到预定探测高度和减少弹道顶点和落点散布。在此前提下,为了保证探空火箭的任务效果,越来越多的有效载荷选择存放于仪器舱等平台,通过利用辅助姿态控制机构进行姿态调整与稳定,进一步利用降落伞等气动减速装置进行回收。
探空火箭的主要探测范围在稀薄大气层与邻近空间之间,重力低,气动效应微弱。探空火箭的载荷重量取决于任务要求,一般为几公斤到几百公斤。空气舵需要利用气动效应才能提供控制力矩,不适用该工作环境。喷气推进器作为控制机构,响应快、指向精度较高;但通常的推力矢量控制采用固定发动机或开关进行控制,无法实现连续控制,若要实现连续控制需额外增加气阀,将大大提升成本和额外负载;同时,由于采用消耗性原料,与探空火箭的低成本目标相悖。因此,惯常采用的利用空气舵或喷气推进器进行姿态控制的方式不适用于载荷平台的姿态调节与稳定。
综上所述,低成本有效进行探空火箭的载荷平台的快速稳定与调姿是当前难点。
发明内容
针对上述现有技术不足,本发明提供一种探空火箭载荷平台的快速调姿方法及装置,用于低成本探空火箭载荷平台的快速调姿与稳定,采用角速度与角速度指令的误差项作为控制变量,实现对三轴大角度机动的跟踪控制,响应快、反应灵敏、控制器阶数低,容易实现。
为了实现本发明的目的,拟采用以下方案:
一种探空火箭载荷平台的快速调姿方法,包括步骤:
计算当前姿态与目标姿态之差,获得差角值;
利用差角值规划梯形角速度曲线,以获得角速度矢量;
利用差角方向与角速度值合成各轴角速度指令;
根据所述指令控制执行机构进行姿态调整和稳定操作,所述执行机构采用动量轮、飞轮等动量器件。
一种探空火箭载荷平台的快速调姿装置,包括:
指令模块,用于计算当前姿态与目标姿态之差,获得差角值;并利用差角值规划梯形角速度曲线,以获得角速度矢量;并利用差角方向与角速度值合成各轴角速度指令;以及
执行机构,用于根据所述指令进行姿态调整和稳定操作;所述执行机构采用动量轮、飞轮等动量器件。
动量轮的安装方式可以根据实际指标要求,采用三轴正交安装的反作用轮,三轴正交安装和第四个等倾角斜装的四个偏置动量轮构成的零动量系统,固定安装或V型斜装的偏置动量轮系统,以及双框架动量轮等方式。
本发明的有益效果在于:
1、本发明所述的控制方法基于欧拉轴-角方式,对沿特征主轴的机动角速度进行三段式规划,设计出机动过程的四元数最优轨迹,可以实现对三轴大角度机动的跟踪控制。
2、本发明所述的控制方法,控制指令采用角速度与角速度指令的误差项作为控制变量,控制器响应快、反应灵敏。
3、采用本发明所述装置和方法设计得到的控制器阶数低,容易实现。
4、采用本发明所述装置和方法建立的控制系统,成本低、可重复使用。
附图说明
本文描述的附图只是为了说明所选实施例,而不是所有可能的实施方案,更不是意图限制本发明的范围。
图1为本申请实施例的内外回路结构示意图。
图2为本申请实施例的梯形状态轨迹示意图。
图3为本申请实施例的快速调姿方法流程图。
图4为本申请实施例的状态轨迹规划原理示意图。
图5为本申请实施例的内回路控制器结构说明示意图。
具体实施方式
为了使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明做进一步的详细描述。
本申请实施例的提供一种探空火箭载荷平台的快速调姿装置及方法,根据执行机构的调姿能力,采用状态轨迹控制方式,规划梯形角速度曲线,直接设计角速度调整和维持曲线。
本申请实施例中,作为姿态调整和稳定的执行机构采用动量轮、飞轮等动量器件。可选地,动量轮的安装方式可以根据实际指标要求,采用三轴正交安装的反作用轮,三轴正交安装和第四个等倾角斜装的四个偏置动量轮构成的零动量系统,固定安装或V型斜装的偏置动量轮系统以及双框架动量轮等方式。
具体的,本申请实施例提供的快速调姿装置包括指令模块和执行机构。指令模块用于计算当前姿态与目标姿态之差,获得差角值;并利用差角值规划梯形角速度曲线,以获得角速度矢量;并利用差角方向与角速度值合成各轴角速度指令;执行机构,用于根据所述指令进行姿态调整和稳定操作;所述执行机构采用动量器件。
如图1所示,本申请实施例的控制分为内外回路:外回路根据姿控要求和阶段划分设计姿态调整指令,内回路形成实现姿态控制的控制指令。
其中,ΩC表示装订的目标姿态角(欧拉角),Ω表示当前欧拉角,ωr表示r轴的角速度,Ur表示r轴控制电压,M表示控制力矩,下标r可以为x1、y1、z1,表示弹体坐标系下的某一坐标轴,也可以表示合成的张量。
外回路采用状态轨迹规划方法,根据执行机构的调姿能力,规划梯形角速度曲线,如附图2所示,直接设计角速度调整和维持曲线从而生成各轴角速度指令,确保姿态调整过程中的姿态角张量一直在目标姿态调整张量平面内。
具体的,如图3所示,包括如下详细步骤:
步骤101,计算当前姿态与目标姿态之差,获得差角值。
如附图4所示,初始/当前偏航角为ψ0、俯仰角为目标偏航角为ψC、俯仰角为用q0表示初始/当前姿态的四元数,qC表示目标姿态的四元数,那么最优姿态调整为沿q的轨迹,该轨迹为绕轴n旋转θ(四元数意义下为两个)。这里,q为特征主轴矢量,转动主轴记为n,特征转角记为θ,于是有:
步骤102,利用差角值规划梯形角速度曲线,以获得角速度矢量。
采用按欧拉轴-角方式,沿最小路径机动的轨迹规划梯形角速度曲线。如图2所示的角速度曲线是示意图,目标是利用合适的角速度积分够角度差即可,即是需要用角速度满足差角。根据逆推,对差角求导就能最快(相当于接近长方形的梯形)满足差角要求。
对q求导,那么,特征转角的角速度矢量为:
式中,ωC表示角速度张量的控制指令,T表示转置。
内回路控制目标是使真实发生的角速度ω跟随该指令。通过适当的内回路控制器设计,就能满足采用状态轨迹控制方式,直接使角速度张量ω落入轨迹q所在平面内。
待规划出轨迹后,采用适当的控制方法,实现快速姿态机动和稳定控制。具体地,为便于执行机构实现控制效果,内回路采用三通道PI控制或PID控制方式,如附图5所示,满足:
Ur=k22r(k4r+k3r/s)(ωrC-ωr)
对于不同通道,系数k22r、k3r和k4r可以取不同值。s是古典控制领域拉氏变换的算子符号,表示微分项,1/s表示积分项。
以上仅为本发明的优选实施例,并不表示是唯一的或是限制本发明。本领域技术人员应理解,在不脱离本发明的范围情况下,对本发明进行的各种改变或同等替换,均属于本发明保护的范围。
Claims (10)
1.一种探空火箭载荷平台的快速调姿方法,其特征在于,包括步骤:
计算当前姿态与目标姿态之差,获得差角值;
利用差角值规划梯形角速度曲线,以获得角速度矢量;
利用差角方向与角速度值合成各轴角速度指令。
2.根据权利要求1所述的探空火箭载荷平台的快速调姿方法,其特征在于,还包括步骤:根据所述指令控制执行机构进行姿态调整和稳定操作,所述执行机构为动量器件。
6.根据权利要求5所述的探空火箭载荷平台的快速调姿方法,其特征在于,根据所述控制指令,采用三通道PI控制或PID控制执行机构进行姿态调整和稳定操作,满足:
Ur=k22r(k4r+k3r/s)(ωrC-ωr);
对于不同通道,系数k22r、k3r和k4r可以取不同值,Ur表示r轴控制电压,ωr表示r轴的角速度,下标r可以为x1、y1、z1,表示弹体坐标系下的某一坐标轴,也可以表示合成的张量,s是古典控制领域拉氏变换的算子符号。
7.根据权利要求2所述的探空火箭载荷平台的快速调姿方法,其特征在于,动量器件包括动量轮,动量轮的安装方式包括以下方式之一:
采用三轴正交安装的反作用轮;
三轴正交安装和第四个等倾角斜装的四个偏置动量轮构成的零动量系统;
固定安装或V型斜装的偏置动量轮系统;以及
双框架动量轮。
8.根据权利要求1所述的探空火箭载荷平台的快速调姿方法,其特征在于,利用差角值规划梯形角速度曲线中,采用按欧拉轴-角方式、沿最小路径机动的轨迹进行规划。
9.一种探空火箭载荷平台的快速调姿装置,其特征在于,包括:
指令模块,用于计算当前姿态与目标姿态之差,获得差角值;并利用差角值规划梯形角速度曲线,以获得角速度矢量;并利用差角方向与角速度值合成各轴角速度指令;以及
执行机构,用于根据所述指令进行姿态调整和稳定操作;所述执行机构采用动量器件。
10.根据权利要求9所述的探空火箭载荷平台的快速调姿装置,其特征在于,动量器件包括动量轮,动量轮的安装方式包括以下方式之一:
采用三轴正交安装的反作用轮;
三轴正交安装和第四个等倾角斜装的四个偏置动量轮构成的零动量系统;
固定安装或V型斜装的偏置动量轮系统;以及
双框架动量轮。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111527207.0A CN114061381B (zh) | 2021-12-14 | 2021-12-14 | 一种探空火箭载荷平台的快速调姿方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111527207.0A CN114061381B (zh) | 2021-12-14 | 2021-12-14 | 一种探空火箭载荷平台的快速调姿方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114061381A true CN114061381A (zh) | 2022-02-18 |
CN114061381B CN114061381B (zh) | 2023-07-14 |
Family
ID=80229481
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111527207.0A Active CN114061381B (zh) | 2021-12-14 | 2021-12-14 | 一种探空火箭载荷平台的快速调姿方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114061381B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104281150A (zh) * | 2014-09-29 | 2015-01-14 | 北京控制工程研究所 | 一种姿态机动的轨迹规划方法 |
CN105955283A (zh) * | 2016-05-30 | 2016-09-21 | 上海航天控制技术研究所 | 多轴快速姿态机动喷气控制方法 |
CN106275508A (zh) * | 2016-08-15 | 2017-01-04 | 上海航天控制技术研究所 | 一种卫星绕空间轴的最短路径姿态机动控制方法 |
CN108508905A (zh) * | 2018-04-08 | 2018-09-07 | 上海微小卫星工程中心 | 一种基于最短空间轴的姿态机动控制和导引律规划方法 |
CN109144089A (zh) * | 2018-10-08 | 2019-01-04 | 五邑大学 | 一种具有姿态调整功能的探空火箭飞控系统 |
CN109592083A (zh) * | 2018-10-16 | 2019-04-09 | 天津中精微仪器设备有限公司 | 一种带自动配重的空间飞行器模拟器 |
CN109774977A (zh) * | 2019-03-28 | 2019-05-21 | 上海微小卫星工程中心 | 一种基于四元数的时间最优的卫星姿态快速机动方法 |
CN113212803A (zh) * | 2021-04-30 | 2021-08-06 | 北京控制工程研究所 | 一种兼顾动态跟踪与定点成像任务的联合姿态机动方法 |
-
2021
- 2021-12-14 CN CN202111527207.0A patent/CN114061381B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104281150A (zh) * | 2014-09-29 | 2015-01-14 | 北京控制工程研究所 | 一种姿态机动的轨迹规划方法 |
CN105955283A (zh) * | 2016-05-30 | 2016-09-21 | 上海航天控制技术研究所 | 多轴快速姿态机动喷气控制方法 |
CN106275508A (zh) * | 2016-08-15 | 2017-01-04 | 上海航天控制技术研究所 | 一种卫星绕空间轴的最短路径姿态机动控制方法 |
CN108508905A (zh) * | 2018-04-08 | 2018-09-07 | 上海微小卫星工程中心 | 一种基于最短空间轴的姿态机动控制和导引律规划方法 |
CN109144089A (zh) * | 2018-10-08 | 2019-01-04 | 五邑大学 | 一种具有姿态调整功能的探空火箭飞控系统 |
CN109592083A (zh) * | 2018-10-16 | 2019-04-09 | 天津中精微仪器设备有限公司 | 一种带自动配重的空间飞行器模拟器 |
CN109774977A (zh) * | 2019-03-28 | 2019-05-21 | 上海微小卫星工程中心 | 一种基于四元数的时间最优的卫星姿态快速机动方法 |
CN113212803A (zh) * | 2021-04-30 | 2021-08-06 | 北京控制工程研究所 | 一种兼顾动态跟踪与定点成像任务的联合姿态机动方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114061381B (zh) | 2023-07-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Li et al. | A survey on moving mass control technology | |
US20190243385A1 (en) | Thrust vectored multicopters | |
CN102574575B (zh) | 一种航空飞行器 | |
Liesk et al. | Design and experimental validation of a nonlinear low-level controller for an unmanned fin-less airship | |
CN104199303B (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
US8561944B2 (en) | System and method for desaturation of a control moment gyroscope | |
Chen et al. | Adaptive path following control of a stratospheric airship with full-state constraint and actuator saturation | |
Yamasaki et al. | Robust trajectory-tracking method for UAV guidance using proportional navigation | |
US20170349301A1 (en) | Severe weather agility thrusters, and associated systems and methods | |
Acosta et al. | Adaptive nonlinear dynamic inversion control of an autonomous airship for the exploration of Titan | |
JPH0933197A (ja) | 混合ミサイル自動操縦器 | |
Miao et al. | Yaw controller design of stratospheric airship based on phase plane method | |
Burnashev et al. | Robust controller for supersonic unmanned aerial vehicle | |
Kamel et al. | Simulation and modelling of flight missile dynamics and autopilot analysis | |
CN114061381A (zh) | 一种探空火箭载荷平台的快速调姿方法及装置 | |
Kowalik et al. | A mathematical model for controlling a quadrotor UAV | |
CN114610057B (zh) | 一种高马赫飞行器机动突防策略设计方法 | |
US5875993A (en) | Flight control of an airborne vehicle at low velocity | |
Bulka et al. | A universal controller for unmanned aerial vehicles | |
CN114265420B (zh) | 适于高动态、控制慢响应的制导控制一体化设计方法 | |
Hodžić et al. | Simulation of short range missile guidance using proportional navigation | |
Lorenz et al. | Robustness analysis related to the control design of the SHEFEX-II hypersonic canard control experiment | |
Sato et al. | Trajectory guidance and control for a small uav | |
CN112937832A (zh) | 一种空投式无人机及其抛射方法 | |
Stappert et al. | Re-entry and Flight Dynamics of a Winged Reusable First Stage |
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 |