迭代制導(dǎo)真空單級定點著陸原理【2】

前言
這是一個介紹迭代制導(dǎo)真空單級定點著陸的系列文章
第0篇以最簡的形式只介紹了計算公式與流程,不需要懂任何原理就可以復(fù)現(xiàn)

第1篇介紹了使用最優(yōu)控制求解大量簡化的定點著陸問題,得到了含未知常數(shù)的姿態(tài)角解

我不是自動化或者航天相關(guān)專業(yè)的,全靠聽過幾節(jié)現(xiàn)代控制論的網(wǎng)課讀懂論文加以復(fù)現(xiàn),不保證正確,如有錯誤還請指正

?引力常量(引力常數(shù)G與星球質(zhì)量M的乘積)
?最大推力
?噴氣速度(單位m/s,1s比沖等于9.81m/s噴氣速度)
?燃料質(zhì)量消耗速率(
)
?與時間無關(guān)的積分常數(shù)(*取x,vx,y,vy,z,vz)
【2】
?以當前時間為0的時間
?剩余飛行時間
?設(shè)定的終端位置
?設(shè)定的終端速度
?當前位置(t=0)
?當前速度(t=0)
?當前質(zhì)量(t=0)
位置、速度、質(zhì)量關(guān)于時間的函數(shù)
? 推力產(chǎn)生的總速度增量、位移增量
?引力產(chǎn)生的總速度增量、位移增量
?滑行位移增量
?推力的速度、位移增量關(guān)于時間的函數(shù)
?引力的速度、位移增量關(guān)于時間的函數(shù)
【3】
?只滿足終點速度約束的姿態(tài)角
推力的方向矢量向xy平面做投影
是從
到
的夾角,以向z軸正方向為負
是從x軸到
的夾角,以向y軸正方向為正


和速度(或者已知軌道的六根數(shù)),通過調(diào)整推力的大小和方向,使飛船在推力和重力的共同作用下,達到設(shè)定的最終位置
和速度
????·?坐標原點O在星球中心
????·?OY指向終端位置
????·?OX在軌道平面內(nèi),與OY垂直,與火箭飛行速度同向

有了坐標系的規(guī)定和以上幾個條件的限定,我們可以把上篇最后得到的姿態(tài)角公式
近似簡化為
是僅滿足速度約束的最優(yōu)化問題的姿態(tài)角,四個k是修正小量,不出意外的話要比

得考慮引力了
上篇文章我們一直是在沒有引力的自由空間內(nèi)做的分析,但到了定點著陸不可能不考慮引力的問題了
根據(jù)微積分的線性特性,我們可以把火箭變化的位置和速度分成三個分量:滑行、推力、引力,也就是
(1)
這里下標t表示推力項(thrust),下標g表示引力項(gravity),下標c表示滑行項(coast)
也許你看到這里會立刻意識到,只要我算出引力項,然后移到等號左邊,重新構(gòu)建起“等效的”終端位置和速度,不就可以直接套用無引力的條件了嗎
但是你緊接著就會發(fā)現(xiàn),積分號內(nèi)位置函數(shù)是未知的,如果要求出它,就得求出其中的引力項
,而求出這一項,又得求速度的引力項
,一個邏輯上的套娃就出來了
怎么解決這個問題呢,我們做一個野蠻近似,假設(shè)從當前到制導(dǎo)結(jié)束的引力作用效果等效于一個常矢量
這只是對當前與終端重力加速度做了一個非常野蠻的平均,肯定會引入誤差,但是你會發(fā)現(xiàn),當逐漸靠近著陸點時,誤差會逐步減少
上面的積分項和滑行項就變成了
(2)
解決了引力的問題我們繼續(xù)解決下一個問題


不要忘了上篇計算出的姿態(tài)角公式里還保留著一堆未知常數(shù),計算它們的過程不可避免地要反復(fù)做積分,但積分上限現(xiàn)在是未知的,這是不行的,我們得算一下
這里要引入一下齊奧爾科夫斯基公式
那么dv是不是呢?嚴格來說不是的。齊奧爾科夫斯基公式在推導(dǎo)的過程中要求推力是朝一個固定方向,所以只有姿態(tài)角保持
時,才有
。不過前面提到,簡化姿態(tài)角公式里的k是小量,這里可以野蠻近似認為
我們把公式(1)的第一行修改一下,和剛剛得到的函數(shù)放在一起

,
以上三個公式對另外一個姿態(tài)角的k也適用
這樣積分就是人能算的了,為了寫起來簡潔我們先設(shè)定四個推力積分


是已知的,引力項與滑行項由公式(2)給出,推力項

雖然這篇文章雖然求解出了姿態(tài)角隨時間變化的函數(shù),但依然存在很多問題
????終端只限定了速度和2個位置分量,第三個位置分量應(yīng)當怎么處理
????星球在自轉(zhuǎn),落點的位置在不斷的變化,如果建立的是非旋轉(zhuǎn)系,落點會不準,如果建立的是旋轉(zhuǎn)系,重力計算會不準
????計算里引入了大量的近似,每一次近似都會引入微小的誤差,任何一點微小的誤差都有可能導(dǎo)致最終偏離著陸點很遠的距離
????總飛行時間大多有上百秒,的大小會逐漸變大,太大了會導(dǎo)致前面作為小量的近似誤差很大

參考資料
[1] 丁文浩. 月球探測器動力下降段制導(dǎo)控制方法研究[D].哈爾濱工業(yè)大學,2022.
[2] 李偉. 基于精確控制解的運載火箭迭代制導(dǎo)自適應(yīng)性分析研究[D]. 哈爾濱工業(yè)大學, 2012.
[3] oPengLuo. 迭代制導(dǎo)總結(jié). https://blog.csdn.net/qq_25777815/article/details/91858142