CN106354147B - 一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法 - Google Patents
一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法 Download PDFInfo
- Publication number
- CN106354147B CN106354147B CN201610970965.2A CN201610970965A CN106354147B CN 106354147 B CN106354147 B CN 106354147B CN 201610970965 A CN201610970965 A CN 201610970965A CN 106354147 B CN106354147 B CN 106354147B
- Authority
- CN
- China
- Prior art keywords
- angle
- control
- module
- program
- instruction
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 47
- 230000008878 coupling Effects 0.000 title claims abstract description 18
- 238000010168 coupling process Methods 0.000 title claims abstract description 18
- 238000005859 coupling reaction Methods 0.000 title claims abstract description 18
- 230000008569 process Effects 0.000 claims description 14
- 238000001914 filtration Methods 0.000 claims description 8
- 238000009434 installation Methods 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000010183 spectrum analysis Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 4
- 238000013461 design Methods 0.000 claims description 4
- 238000012545 processing Methods 0.000 claims description 4
- 230000008450 motivation Effects 0.000 claims description 3
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 claims description 2
- 230000005540 biological transmission Effects 0.000 claims description 2
- 238000013178 mathematical model Methods 0.000 claims description 2
- 238000012546 transfer Methods 0.000 claims description 2
- 238000005096 rolling process Methods 0.000 claims 1
- 230000000694 effects Effects 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 239000011159 matrix material Substances 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000006641 stabilisation Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000007480 spreading Effects 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
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/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Algebra (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法,包括:质心估计模块、预摆角计算模块、程序角去噪与补偿模块、控制反馈偏差计算模块、增量式PID控制模块、等效伺服摆角指令与限幅模块。本发明解决了在轨飞行器大质心横移姿轨耦合的高精度控制问题,达到了很好的工程应用效果。
Description
技术领域
本发明涉及一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法,属于在轨飞行器控制技术领域。
背景技术
轨道运输飞行器,在轨道部署卫星分离的过程中,存在大质量偏移的情况,如某任务存在质心横移45mm,则干扰力矩达200N·m以上,若只利用姿控发动机控制,控制力矩为68N·m,目前姿控发动机控制能力不能满足控制要求,需要轨控发动机具备摇摆的能力。飞行过程中需要进行多次大范围轨道转移,飞行器主发动机为轨道控制和姿态控制合用,姿态控制和轨道控制相互影响,造成控制系统性能恶化,在发动机等大干扰下需要保持精确的姿态控制。因此需要研究姿态耦合控制技术实现控制系统的姿态快速跟踪及稳定。
发明内容
本发明要解决的技术问题是:克服现有技术的不足,提供一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法,充分考虑在轨飞行器质心横移对控制系统影响,解决质心横移对起控特性影响,高频噪声对控制的影响,高精度跟踪控制等问题,确保飞行器高精度控制。
本发明技术解决方案:
一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统,包括:质心估计模块、预摆角计算模块、程序角去噪与补偿模块、控制反馈偏差计算模块、增量式PID控制模块、等效伺服摆角指令及限幅模块;
质心估计模块,根据控制计算机发送姿控发动控制指令,采集敏感器信息,通过估计方法,实时估计飞行器质心参数,然后传递给预摆角计算模块;
预摆角计算模块,根据质心估计模块实时估计飞行器质心参数计算出发动机预摆角及程序角补偿值,将程序角补偿值传递给程序角去噪与补偿模块对程序角进行补偿,将发动机预摆角发送给等效伺服摆角指令及限幅模块,对伺服摆角进行预摆处理;
程序角去噪与补偿模块,对制导计算模块输出的程序角指令进行滤波处理,然后根据预摆角计算模块输出程序角补偿值,将制导输出程序角由本体系旋转到质心系,将补偿后程序角输出给控制反馈偏差计算模块;
控制反馈偏差计算模块,输入为导航模块计算飞行器当前相对于轨道系姿态信息和由程序角去噪与补偿模块输出的程序角,然后进行四元数及姿态角速度偏差求解,并将偏差值输出给增量式PID控制模块;
增量式PID控制模块,根据控制反馈偏差计算模块输出的四元数偏差和姿态角速度偏差,采用增量式PID控制律计算出俯仰、偏航通道摆角控制指令,将摆角控制指令传递给等效伺服摆角指令及限幅模块;
等效伺服摆角指令计算及限幅模块,接收增量式PID控制模块输出的俯仰、偏航通道摆角控制指令以及预摆角计算模块输出的发动机预摆角指令,将两个指令信号进行叠加,根据伺服安装位置,将摆角指令分配为伺服电机I、II控制指令,并根据发动机摇摆范围,对伺服电机控制指令进行限幅,并将限幅后的伺服电机控制指令发送给综合控制器。
优选的,质心估计模块实现过程如下:
控制计算机分别对飞行器三通道正负方向发送定时姿控发动机开关指令,假定姿控发动机推力及力臂已知,即控制力矩系数已知,给定转动动量初值,由敏感器测量姿态角速度及姿态角加速度信息,从这些数据建立仿射系统本体属性的数学模型,采用带遗忘因子递推最小二乘方法,估计出飞行器质心参数,再由已估计出质心值,采用带遗忘因子递推最小二乘方法估计飞行器转动惯量,循环迭代,估计出较精确质心参数,然后传递给预摆角计算模块。
优选的,所述程序角去噪与补偿模块实现过程如下:
制导计算模块周期性向姿轨耦合控制系统发出飞行器需要跟踪姿态角信息,该信号为本体系到目标系姿态角,对制导计算模块输出的程序角信号进行离线频谱分析,获取程序角信号的有效带宽,程序角去噪与补偿模块首先对制导计算模块输出的程序角和预摆角计算程序补偿角进行叠加处理,即将轨道系到本体系程序角转换为质心系到目标系程序角,然后将欧拉角转换为四元数,将信号发送给离散化的低通滤波差分方程计算,差分输出即为程序角去噪与补偿后程序四元数,并将输出值发送给控制反馈偏差计算模块。
优选的,所述增量式PID控制模块实现过程如下:
由于控制反馈偏差计算模块计算出误差四元数和误差姿态角速度,增量式PID模块采用增量式PID控制律为Δu(k)=u(k)-u(k-1)=kp(e(k)-e(k-1))+kie(k)+kdωe,u(k)=u(k-1)+Δu(k),式中e为四元数误差,ωe为姿态角速度偏差,kp、ki、kd分别为比例、积分、微分系数,控制输出为飞行器俯仰、偏航通道发动机摇摆角大小,将计算结果输出给等效伺服指令及限幅模块。
一种基于发动机预摆的大质心横移下的姿轨控耦合控制方法,包括质心估计步骤、预摆角计算步骤、程序角去噪与补偿步骤、控制反馈偏差计算步骤、增量式PID控制步骤和等效伺服摆角指令及限幅步骤,具体如下:
(1)质心估计步骤,建立飞行器动力学模型,并分别以质心、转动惯量为状态变量建立质心、惯量、控制力矩、姿态信息之间的状态方程,控制计算机同时发送飞行器俯仰、偏航、滚动三通道姿控发动机开关指令,则控制力矩可根据理论发动机推力及安装位置计算出,假定转动惯量已知,通过敏感器采集飞行器角速度、角加速度信息,建立质心估计模型,通过带遗忘因子递推最小二乘方法,估计出质心参数,再由已估计出质心参数,建立转动惯量估计模型,采用同样方法可以估计出转动惯量值,循环迭代,控制计算机发送三通道姿控发动机正开、负开交替指令,以便准确估计出飞行器质心参数;
(2)预摆角计算步骤,根据质心估计步骤输出质心参数,采用坐标系旋转的方式,获取本体系与质心系的旋转角度,以此计算出发动机对准质心俯仰、偏航通道发动机摆角值及程序角补偿值,并分别发送给程序角去噪与补偿步骤和等效伺服摆角指令及限幅步骤;
(3)程序角去噪与补偿步骤,通过对制导计算程序角进行FFT频谱分析,确定程序角信号带宽,设计二阶低通滤波器,并根据控制计算机计算周期转换为差分方程,将制导计算步骤输出的程序角和预摆角计算步骤输出的程序角补偿量,通过坐标旋转获取补偿后程序角,经过差分方程计算,获取滤波后程序角,然后通过姿态角及四院数转换方程,转换为四元数,传递给控制反馈偏差计算步骤;
(4)控制反馈偏差计算步骤,由导航模块输出导航四元数和程序角去噪与补偿步骤输出的程序四元数,采用四元数叉乘方程,获取四元数偏差值,由导航模块输出导航姿态角速度,获取姿态角速度偏差值,将计算出四元数偏差及姿态角速度偏差值发送给增量式PID控制步骤;
(5)增量式PID控制步骤,根据控制反馈偏差计算步骤输出的四元数偏差和姿态角速度偏差,采用增量式PID控制律计算出俯仰、偏航通道摆角控制指令,将摆角指令传递给等效伺服摆角指令及限幅步骤;
(6)等效伺服摆角指令及限幅步骤,接收增量式PID控制步骤输出的俯仰、偏航通道摆角控制指令以及预摆角计算步骤输出的发动机预摆角指令,将两个指令信号进行叠加,根据伺服安装位置,将摆角指令分配为伺服电机I、II控制指令,并根据发动机摇摆范围,对伺服电机控制指令进行限幅,并将限幅后的伺服电机控制指令发送给综合控制器。
本发明与现有技术相比的优点在于:
(1)本发明通过在线质心估计、发动机预摆、误差四元数反馈控制、增量式PID算法、系统有效带宽分析和去噪技术,解决了在轨飞行器大质心横移姿轨耦合的高精度控制,达到了很好的工程应用效果。
(2)本发明提出基于质心估计的发动机预摆和制导程序角补偿方案,在发动机点火之前,采用伺服系统预摆发动机对准质心,则点火时质心横移引起的干扰力矩便会降低或消除,并采用在线质心估计的方法获取较为精确的质心横移值,达到精确预摆的目的。同时由于质心横移的存在,使得飞行器制导程序角基准发生改变,采用在线对制导程序角进行补偿,提高制导精度。
(3)本发明采用基于误差四元数反馈的增量式PID控制方案,有效解决欧拉角奇异问题,解决飞行器大角度机动过程姿态非单值问题,较传统运载控制方法,加入增量式积分环节,有效降低系统稳态误差,降低比例、微分环节参数幅值,达到在满足稳定控制精度的基础上有效增大系统抗干扰能力的目的。
(4)本发明采用有效系统带宽频谱分析和去噪技术,避免高频干扰信号引入姿控系统,此方法较传统姿控系统控制中加校正网络降低系统带宽的方案,优点为姿态控制相位、幅值裕度均较好,可更好的跟踪制导信号。
附图说明
图1为本发明的系统组成框图;
图2为本发明中预摆计算示意图;
图3为本发明中程序角补偿计算示意图;
图4为本发明中增量式PID控制方法;
图5为本发明中基于动力学质心估计示意图;
具体实施方式
以下将结合附图和实施例对本发明作进一步详细描述:
如图1所示,本发明基于发动机预摆的大质心横移下的姿轨控耦合控制系统包括:质心估计模块、预摆角计算模块、程序角去噪与补偿模块、控制反馈偏差计算模块、增量式PID控制模块、等效伺服摆角指令及限幅模块。其工作流程为质心估计模块计估计出飞行器质心值,发送给预摆角计算模块,预摆角计算模块计算出发动机预摆角及程序角补偿值,发动给等效摆角计算及限幅模块和程序角去噪与补偿模块。程序角去噪与补偿模块计算出滤波后程序角四元数发送给控制反馈偏差计算模块,控制反馈计算模块计算出误差四元数和误差姿态角速度发送给增量式PID控制模块,增量式PID控制模块计算出俯仰、偏航通道发动机摇摆指令,发送给等效伺服摆角指令及限幅模块,等效伺服摆角指令及限幅模块计算出伺服机构I、II控制指令,发送给综合控制器。
如图5所示,质心估计模块,分别建立飞行器运动学模型和姿态动力学模型,将动力学方程中的外力/外力矩和状态信息通过测量等手段作为已知量,将质心、惯量等特性参数作为未知量,然后整理成最小二乘法的标准形式进行未知参数的估计,采用带遗忘因子递推二乘法进行估计。首先建立刚性飞行器的姿态动力学方程为
式中:
I为飞行器的转动惯量,ω为飞行器相对于惯性空间的角速度,Tc为提供的控制力矩,Td为外部环境干扰力矩,qT=[q1,q2,q3,q4],并满足极线约束qTq=1。
选择转动惯量参数作为状态变量,即X=[Ixx Iyy Izz Ixy Ixz Iyz]T。令b=Tc+Td作为输出变量,则姿态动力学方程写成矩阵的形式为b=AX。
式中:
对于转动惯量辨识观测方程,均选择b作为观测量,选择X作为状态变量,则转动惯量辨识观测方程可以统一描述为Z=H(X)。根据转动惯量辨识观测方程,采用扩展卡尔曼滤波方法设计辨识算法。为了采用带遗忘因子递推最小二乘方法,将观测方程转换成离散状态方程为
Xk+1=Xk
Zk=HkXk
转动惯量估计,具体的算法流程为
第一步,设定初始值:X0和P0
第二步,建立递推方程
式中Pk|k-1,Pk,Kk为误差矩阵,H为状态矩阵,γ为遗忘因子。则方程构成了飞行器的转动惯量辨识方程。在转动惯量估计基础上对新的质心位置进行估计,依靠推力器和陀螺进行质心位置辨识。
(1)飞行器的x轴推力器工作,由于飞行器质心不过形心,因此会产生y轴和z轴的姿态干扰力矩。推力器的大小认为是已知,则干扰力矩的大小直接与推力器距离质心的距离相关。在利用陀螺测量得到箭体的姿态角速度,根据姿态动力学方程,将推力器与质心之间的距离作为未知量,整理成最小二乘法的标准形式,最终可得到上面级质心在飞行器本体系上的y轴和z轴坐标,而x轴上的坐标无法确定,因此联合体质心是在平行于x轴的直线上。
(2)同理,使用y轴和z轴上的推力器分别工作,可分别估计得到上面级质心位置所在的直线。
(3)理论上三条直线应该相交于同一点,该点即为飞行器的质心。但受到动力学模型误差、测量误差、推力误差等因素的影响,最终三条直线可能不会相交于同一点,则依靠质心在同一方向上的不同估计值进行融合处理,得到最终的飞行器质心三轴位置坐标。
如图2所示,预摆角计算模块,飞行器分离卫星之后,质心存在横向偏移量。为了克服质心横移下轨控对姿态控制的影响,提出发动机预摆方案,让发动机点火之前推力方向对准质心。发动机预摆角大小为
式中(xc,yc,zc)为飞行器质心在布局坐标系下坐标,为质心估计模块输出值,d为摇摆点在布局坐标系x轴坐标。
如图3所示,预摆角计算模块,姿态补偿角在数值上等于摆角补偿角δ0,符号相反,旋转顺序相反。采用发动机预摆方案后,发动机摆角补偿角依靠理论计算得出
如图2所示,程序角去噪与补偿模块,针对上面级的任务特点,上面级制导方案采用显式制导方法。根据终端目标参数和飞行器现在的运动参数对控制量的显式表达式实时计算控制姿态角,一般制导周期大于姿态控制周期,加入最优程序角后会使发动机摆角产生高频的振荡,对于制导程序角频谱分析,可知程序角带宽范围,因此,稳定系统对最优程序角进行滤波,通过滤波网络目的是平滑程序角输入信号,减小对稳定系统的影响。
滤波网络设计函数为
式中ξ1,ξ2为阻尼,ω1,ω2为频率。离散化处理如下
F1 α(nTfilter)=αcx
式中:为α通道滤波方程系数,表示俯仰、偏航通道;αcx,为各通道最终程序角处理后的当前程序角;为当前拍程序角滤波输出值。滤波后程序角转化为四元数为
式中:为滤波后俯仰、偏航程序角,qcx0为程序四元数,程序角补偿后四元数为
式中:qyb为程序角补偿四元数,qcx为补偿后程序角四元数。
如图1所示,控制量偏差计算模块,计算公式如下
qe=qe/|qe|·sign(qe(0))
式中:
Qgb为姿态四元数,由导航模块计算得到;
qcx为当前程序四元数,由程序角去噪与补偿模块计算得到;
qe为四元数控制偏差;
ωe为角速度控制偏差;
ωcx为程序角速度,由程序角去噪与补偿模块计算得到;
为当前平均角速度值,由导航模块计算得到;
如图4所示,增量式PID控制模块,计算公式如下
δψ=uψ(k)
式中:
qe为四元数控制偏差;
ωe为角速度控制偏差;
kpψ、kdψ:PID控制参数
如图1所示,等效伺服摆角指令及限幅模块将增量式输出指令与预摆指令进行叠加,如下公式
δψ=δψ+δψ_yb
式中δψ_yb为预摆角,由预摆角计算模块计算得到。
根据发动机摆动范围限制级伺服安装位置进行伺服指令及限幅计算,如下式所示
式中:
δψout:输出的伺服摆角;
δmax:伺服摆角限幅值,常值装订;
ΔTzk:姿控周期,常值装订;
δψ_yb:预摆角。
将经过分配限幅的伺服控制指令发送给综合控制器,控制伺服机构摇摆。
Claims (5)
1.一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统,其特征在于,包括:质心估计模块、预摆角计算模块、程序角去噪与补偿模块、控制反馈偏差计算模块、增量式PID控制模块、等效伺服摆角指令及限幅模块;
质心估计模块,根据控制计算机发送姿控发动控制指令,采集敏感器信息,通过估计方法,实时估计飞行器质心参数,然后传递给预摆角计算模块;
预摆角计算模块,根据质心估计模块实时估计飞行器质心参数计算出发动机预摆角及程序角补偿值,将程序角补偿值传递给程序角去噪与补偿模块对程序角进行补偿,将发动机预摆角发送给等效伺服摆角指令及限幅模块,对伺服摆角进行预摆处理;
程序角去噪与补偿模块,对制导计算模块输出的程序角指令进行滤波处理,然后根据预摆角计算模块输出程序角补偿值,将制导输出程序角由本体系旋转到质心系,将补偿后程序角输出给控制反馈偏差计算模块;
控制反馈偏差计算模块,输入为导航模块计算飞行器当前相对于轨道系姿态信息和由程序角去噪与补偿模块输出的程序角,然后进行四元数及姿态角速度偏差求解,并将偏差值输出给增量式PID控制模块;
增量式PID控制模块,根据控制反馈偏差计算模块输出的四元数偏差和姿态角速度偏差,采用增量式PID控制律计算出俯仰、偏航通道摆角控制指令,将摆角控制指令传递给等效伺服摆角指令及限幅模块;
等效伺服摆角指令计算及限幅模块,接收增量式PID控制模块输出的俯仰、偏航通道摆角控制指令以及预摆角计算模块输出的发动机预摆角指令,将两个指令信号进行叠加,根据伺服安装位置,将摆角指令分配为伺服电机I、II控制指令,并根据发动机摇摆范围,对伺服电机控制指令进行限幅,并将限幅后的伺服电机控制指令发送给综合控制器。
2.根据权利要求1所述基于发动机预摆的大质心横移下的姿轨控耦合控制系统,其特征在于:质心估计模块实现过程如下:
控制计算机分别对飞行器三通道正负方向发送定时姿控发动机开关指令,假定姿控发动机推力及力臂已知,即控制力矩系数已知,给定转动动量初值,由敏感器测量姿态角速度及姿态角加速度信息,从这些数据建立仿射系统本体属性的数学模型,采用带遗忘因子递推最小二乘方法,估计出飞行器质心参数,再由已估计出质心值,采用带遗忘因子递推最小二乘方法估计飞行器转动惯量,循环迭代,估计出较精确质心参数,然后传递给预摆角计算模块。
3.根据权利要求1所述基于发动机预摆的大质心横移下的姿轨控耦合控制系统,其特征在于:所述程序角去噪与补偿模块实现过程如下:
制导计算模块周期性向姿轨耦合控制系统发出飞行器需要跟踪姿态角信息,该信号为本体系到目标系姿态角,对制导计算模块输出的程序角信号进行离线频谱分析,获取程序角信号的有效带宽,程序角去噪与补偿模块首先对制导计算模块输出的程序角和预摆角计算程序补偿角进行叠加处理,即将轨道系到本体系程序角转换为质心系到目标系程序角,然后将欧拉角转换为四元数,将信号发送给离散化的低通滤波差分方程计算,差分输出即为程序角去噪与补偿后程序四元数,并将输出值发送给控制反馈偏差计算模块。
4.根据权利要求1所述基于发动机预摆的大质心横移下的姿轨控耦合控制系统,其特征在于:所述增量式PID控制模块实现过程如下:
由于控制反馈偏差计算模块计算出误差四元数和误差姿态角速度,增量式PID模块采用增量式PID控制律为Δu(k)=u(k)-u(k-1)=kp(e(k)-e(k-1))+kie(k)+kdωe,u(k)=u(k-1)+Δu(k),式中e为四元数误差,ωe为姿态角速度偏差,kp、ki、kd分别为比例、积分、微分系数,控制输出为飞行器俯仰、偏航通道发动机摇摆角大小,将计算结果输出给等效伺服指令及限幅模块。
5.一种基于发动机预摆的大质心横移下的姿轨控耦合控制方法,其特征在于包括质心估计步骤、预摆角计算步骤、程序角去噪与补偿步骤、控制反馈偏差计算步骤、增量式PID控制步骤和等效伺服摆角指令及限幅步骤,具体如下:
(1)质心估计步骤,建立飞行器动力学模型,并分别以质心、转动惯量为状态变量建立质心、惯量、控制力矩、姿态信息之间的状态方程,控制计算机同时发送飞行器俯仰、偏航、滚动三通道姿控发动机开关指令,则控制力矩可根据理论发动机推力及安装位置计算出,假定转动惯量已知,通过敏感器采集飞行器角速度、角加速度信息,建立质心估计模型,通过带遗忘因子递推最小二乘方法,估计出质心参数,再由已估计出质心参数,建立转动惯量估计模型,采用同样方法可以估计出转动惯量值,循环迭代,控制计算机发送三通道姿控发动机正开、负开交替指令,以便准确估计出飞行器质心参数;
(2)预摆角计算步骤,根据质心估计步骤输出质心参数,采用坐标系旋转的方式,获取本体系与质心系的旋转角度,以此计算出发动机对准质心俯仰、偏航通道发动机摆角值及程序角补偿值,并分别发送给程序角去噪与补偿步骤和等效伺服摆角指令及限幅步骤;
(3)程序角去噪与补偿步骤,通过对制导计算程序角进行FFT频谱分析,确定程序角信号带宽,设计二阶低通滤波器,并根据控制计算机计算周期转换为差分方程,将制导计算步骤输出的程序角和预摆角计算步骤输出的程序角补偿量,通过坐标旋转获取补偿后程序角,经过差分方程计算,获取滤波后程序角,然后通过姿态角及四院数转换方程,转换为四元数,传递给控制反馈偏差计算步骤;
(4)控制反馈偏差计算步骤,由导航模块输出导航四元数和程序角去噪与补偿步骤输出的程序四元数,采用四元数叉乘方程,获取四元数偏差值,由导航模块输出导航姿态角速度,获取姿态角速度偏差值,将计算出四元数偏差及姿态角速度偏差值发送给增量式PID控制步骤;
(5)增量式PID控制步骤,根据控制反馈偏差计算步骤输出的四元数偏差和姿态角速度偏差,采用增量式PID控制律计算出俯仰、偏航通道摆角控制指令,将摆角指令传递给等效伺服摆角指令及限幅步骤;
(6)等效伺服摆角指令及限幅步骤,接收增量式PID控制步骤输出的俯仰、偏航通道摆角控制指令以及预摆角计算步骤输出的发动机预摆角指令,将两个指令信号进行叠加,根据伺服安装位置,将摆角指令分配为伺服电机I、II控制指令,并根据发动机摇摆范围,对伺服电机控制指令进行限幅,并将限幅后的伺服电机控制指令发送给综合控制器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610970965.2A CN106354147B (zh) | 2016-10-31 | 2016-10-31 | 一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610970965.2A CN106354147B (zh) | 2016-10-31 | 2016-10-31 | 一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106354147A CN106354147A (zh) | 2017-01-25 |
CN106354147B true CN106354147B (zh) | 2019-08-09 |
Family
ID=57864902
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610970965.2A Active CN106354147B (zh) | 2016-10-31 | 2016-10-31 | 一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106354147B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109308074B (zh) * | 2017-07-28 | 2021-10-08 | 深圳禾苗通信科技有限公司 | 一种无人机重心偏移的补偿方法及系统 |
CN107885949B (zh) * | 2017-11-24 | 2020-11-24 | 上海机电工程研究所 | 开关式姿轨控直接力发动机推力建模方法 |
CN109030862A (zh) * | 2018-06-20 | 2018-12-18 | 南京信息工程大学 | 一种用于超声波风速风向仪的陀螺仪平衡装置及其角度自适应平衡调节方法 |
CN111319795B (zh) * | 2020-02-26 | 2023-08-01 | 上海航天控制技术研究所 | 自主实时反馈补偿姿控喷气影响的高精度轨控方法及系统 |
CN112550768B (zh) * | 2020-12-14 | 2022-07-12 | 北京航天自动控制研究所 | 一种短时大边界干扰下的高精度角速度控制方法 |
CN116382124B (zh) * | 2023-05-29 | 2023-08-18 | 东方空间技术(山东)有限公司 | 一种运载火箭的姿态控制仿真方法和系统 |
CN116540785B (zh) * | 2023-07-05 | 2023-09-15 | 北京未来宇航空间科技研究院有限公司 | 一种飞行器质心的偏移控制方法及飞行器 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103121514A (zh) * | 2011-11-18 | 2013-05-29 | 上海宇航系统工程研究所 | 一种适用于质心横移空间飞行器的姿态控制方法 |
-
2016
- 2016-10-31 CN CN201610970965.2A patent/CN106354147B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103121514A (zh) * | 2011-11-18 | 2013-05-29 | 上海宇航系统工程研究所 | 一种适用于质心横移空间飞行器的姿态控制方法 |
Non-Patent Citations (4)
Title |
---|
Stability of small-scale UAV helicopters and quadrotors with added payload mass under PID control;Paul E.I. Pounds,et al.;《Autonomous Robots》;20120224;第33卷;全文 * |
变质量飞行器变轨中摇摆发动机指向跟踪问题研究;韦文书等;《宇航学报》;20110831;第32卷(第8期);全文 * |
多星发射上面级的姿态解耦控制;张军等;《电机与控制学报》;20091130;第13卷;全文 * |
多星发射上面级的姿态解耦控制方法研究;杨阳等;《导弹与航天运载技术》;20071231(第5期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN106354147A (zh) | 2017-01-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106354147B (zh) | 一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法 | |
CN110119089B (zh) | 一种基于积分滑模的浸入不变流型自适应四旋翼控制方法 | |
CN111399531B (zh) | 高超声速飞行器滑翔段制导与姿态控制一体化设计方法 | |
CN111026160B (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
CN103256928B (zh) | 一种分布式惯性导航系统及其姿态传递对准方法 | |
CN104142686A (zh) | 一种卫星自主编队飞行控制方法 | |
CN112578805B (zh) | 一种旋翼飞行器的姿态控制方法 | |
CN106970530B (zh) | 空间非合作目标自主视线交会的无模型预设性能控制方法 | |
CN109269504B (zh) | 一种具有末端约束的姿态机动路径规划方法 | |
CN111459188B (zh) | 一种基于四元数的多旋翼非线性飞行控制方法 | |
CN104570742A (zh) | 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法 | |
CN110456816B (zh) | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 | |
CN115649491B (zh) | 适用于多源干扰下的低轨光学遥感卫星凝视成像控制方法 | |
CN112572835B (zh) | 一种具有姿态切换的卫星在轨角动量管理及控制方法 | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂系统 | |
CN109582039A (zh) | 一种采用相对导航信息的j2摄动下最优队形重构方法 | |
CN110673623A (zh) | 一种基于双环pd控制算法控制的四旋翼无人机着陆方法 | |
Li et al. | Multi-UUV formation coordination control based on combination of virtual structure and leader | |
CN111506095A (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
CN113778129A (zh) | 一种干扰补偿的高超声速变后掠翼飞行器跟踪控制方法 | |
CN112198885A (zh) | 一种满足机动平台自主降落需求的无人机控制方法 | |
CN114815888B (zh) | 一种仿射形式的制导控制一体化控制方法 | |
CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
CN114237270B (zh) | 一种考虑输入饱和的无人直升机跟踪控制方法 | |
CN113110593B (zh) | 基于虚拟结构和估计信息传输的飞行编队协同自适应控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |