发明名称 一种考虑J2摄动的近地卫星有限推力最优变轨方法
摘要 本发明公开的一种考虑J2摄动的近地卫星有限推力最优变轨方法,涉及近地卫星最优变轨方法,属于航空航天领域。本发明建立考虑J2摄动的航天器动力学方程;根据始末航天器状态,求解燃耗最优性能指标所对应的哈密顿函数H;根据庞特里亚金极大值原理求解最优控制率以及相应协态方程;根据变分法最优控制条件构造满足燃耗最优的两点边值问题打靶方程组;根据航天器始末状态和飞行时间,对两点边值问题打靶方程组进行求解,得到由最优推力控制方向和发动机开关函数构成的最优控制率;利用所述的控制率对卫星变轨进行控制,实现提高近地卫星转移过程的实时性和变轨精度,降低变轨转移所需的燃料消耗。本发明适用于发动机为有限推力模型下近地卫星变轨过程。
申请公布号 CN106379555A 申请公布日期 2017.02.08
申请号 CN201610803835.X 申请日期 2016.09.05
申请人 北京理工大学 发明人 乔栋;孙超;李翔宇
分类号 B64G1/10(2006.01)I;B64G1/24(2006.01)I;G06F17/50(2006.01)I 主分类号 B64G1/10(2006.01)I
代理机构 代理人
主权项 一种考虑J2摄动的近地卫星有限推力最优变轨方法,其特征在于:包括如下步骤:步骤一:在地心赤道惯性坐标系中建立考虑J2摄动的航天器动力学方程;所述的J2摄动为非球形引力摄动;首先考虑引入发动机的开关控制量u,在无摄动条件下笛卡尔坐标系中的有限推力航天器动力学方程公式(1)所示,此时笛卡尔坐标系选为地心赤道惯性坐标系,x轴指向春分点方向,z轴与地球自转轴一致,且指向北,y轴与x轴、z轴满足右手定则;<maths num="0001"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><mover><mi>r</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mi>v</mi></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>v</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mo>-</mo><mfrac><mi>&mu;</mi><msup><mi>r</mi><mn>3</mn></msup></mfrac><mi>r</mi><mo>+</mo><mfrac><mrow><msub><mi>T</mi><mi>max</mi></msub><mi>u</mi></mrow><mi>m</mi></mfrac><mi>&alpha;</mi></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>m</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mo>-</mo><mfrac><mrow><msub><mi>T</mi><mi>max</mi></msub><mi>u</mi></mrow><mrow><msub><mi>g</mi><mn>0</mn></msub><msub><mi>I</mi><mrow><mi>s</mi><mi>p</mi></mrow></msub></mrow></mfrac></mrow></mtd></mtr></mtable><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000011.GIF" wi="1150" he="343" /></maths>其中r=[x,y,z]为航天器的位置矢量,v=[v<sub>x</sub>,v<sub>y</sub>,v<sub>z</sub>]为航天器的速度矢量,m为航天器质量,α=[α<sub>x</sub>,α<sub>y</sub>,α<sub>z</sub>]为发动机推力方向单位矢量,u∈[0,1]为发动机的开关控制量,T<sub>max</sub>为发动机最大推力,μ为地球引力常数,g<sub>0</sub>为地球水平面重力加速度,I<sub>sp</sub>为发动机比冲;考虑非球形J2摄动对近地卫星运动的影响,由于引力项在三个方向不具有统一性,此时动力学方程表示为公式(2):<maths num="0002"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msub><mi>v</mi><mi>x</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msub><mi>v</mi><mi>y</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msub><mi>v</mi><mi>z</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>v</mi><mo>&CenterDot;</mo></mover><mi>x</mi></msub><mo>=</mo><mo>-</mo><mfrac><mi>&mu;</mi><msup><mi>r</mi><mn>3</mn></msup></mfrac><mi>x</mi><mo>+</mo><mfrac><mrow><msub><mi>T</mi><mi>max</mi></msub><mi>u</mi></mrow><mi>m</mi></mfrac><msub><mi>&alpha;</mi><mi>x</mi></msub><mo>+</mo><msub><mi>&mu;xJ</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>(</mo><mrow><mo>-</mo><mfrac><mn>3</mn><mn>2</mn></mfrac><mo>+</mo><mfrac><mn>15</mn><mn>2</mn></mfrac><mfrac><msup><mi>z</mi><mn>2</mn></msup><msup><mi>r</mi><mn>2</mn></msup></mfrac></mrow><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>v</mi><mo>&CenterDot;</mo></mover><mi>y</mi></msub><mo>=</mo><mo>-</mo><mfrac><mi>&mu;</mi><msup><mi>r</mi><mn>3</mn></msup></mfrac><mi>y</mi><mo>+</mo><mfrac><mrow><msub><mi>T</mi><mi>max</mi></msub><mi>u</mi></mrow><mi>m</mi></mfrac><msub><mi>&alpha;</mi><mi>y</mi></msub><mo>+</mo><msub><mi>&mu;yJ</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>(</mo><mrow><mo>-</mo><mfrac><mn>3</mn><mn>2</mn></mfrac><mo>+</mo><mfrac><mn>15</mn><mn>2</mn></mfrac><mfrac><msup><mi>z</mi><mn>2</mn></msup><msup><mi>r</mi><mn>2</mn></msup></mfrac></mrow><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>v</mi><mo>&CenterDot;</mo></mover><mi>z</mi></msub><mo>=</mo><mo>-</mo><mfrac><mi>&mu;</mi><msup><mi>r</mi><mn>3</mn></msup></mfrac><mi>z</mi><mo>+</mo><mfrac><mrow><msub><mi>T</mi><mi>max</mi></msub><mi>u</mi></mrow><mi>m</mi></mfrac><msub><mi>&alpha;</mi><mi>z</mi></msub><mo>+</mo><msub><mi>&mu;zJ</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>(</mo><mrow><mo>-</mo><mfrac><mn>9</mn><mn>2</mn></mfrac><mo>+</mo><mfrac><mn>15</mn><mn>2</mn></mfrac><mfrac><msup><mi>z</mi><mn>2</mn></msup><msup><mi>r</mi><mn>2</mn></msup></mfrac></mrow><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>m</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mo>-</mo><mfrac><mrow><msub><mi>T</mi><mi>max</mi></msub><mi>u</mi></mrow><mrow><msub><mi>g</mi><mn>0</mn></msub><msub><mi>I</mi><mrow><mi>s</mi><mi>p</mi></mrow></msub></mrow></mfrac></mrow></mtd></mtr></mtable><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000012.GIF" wi="1374" he="847" /></maths>其中R<sub>E</sub>=6378.137km为地球半径,J<sub>2</sub>=1.082626×10<sup>‑3</sup>为摄动系数;步骤二:根据始末航天器状态,求解燃耗最优性能指标所对应的哈密顿函数H;给定起始时刻t<sub>0</sub>航天器的位置矢量[r<sub>0</sub>;v<sub>0</sub>],到达时刻t<sub>f</sub>的位置矢量为[r<sub>f</sub>;v<sub>f</sub>];以燃耗最优作为性能指标J,表达式为公式(3):<maths num="0003"><math><![CDATA[<mrow><mi>J</mi><mo>=</mo><mfrac><msub><mi>T</mi><mrow><mi>m</mi><mi>a</mi><mi>x</mi></mrow></msub><mrow><msub><mi>g</mi><mn>0</mn></msub><msub><mi>I</mi><mrow><mi>s</mi><mi>p</mi></mrow></msub></mrow></mfrac><msubsup><mo>&Integral;</mo><msub><mi>t</mi><mn>0</mn></msub><msub><mi>t</mi><mi>f</mi></msub></msubsup><mi>u</mi><mi>d</mi><mi>t</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000021.GIF" wi="1150" he="135" /></maths>如果性能指标J中控制变量u为一次的,最优控制率应为Bang‑Bang控制;控制变量u应取1或0,控制变量u是不连续的;为使控制变量u连续,通过定义过渡系数ε来使控制变量u连续,则构造性能指标J:<maths num="0004"><math><![CDATA[<mrow><mi>J</mi><mo>=</mo><mfrac><msub><mi>T</mi><mrow><mi>m</mi><mi>a</mi><mi>x</mi></mrow></msub><mrow><msub><mi>g</mi><mn>0</mn></msub><msub><mi>I</mi><mrow><mi>s</mi><mi>p</mi></mrow></msub></mrow></mfrac><msubsup><mo>&Integral;</mo><msub><mi>t</mi><mn>0</mn></msub><msub><mi>t</mi><mi>f</mi></msub></msubsup><mo>{</mo><mi>u</mi><mo>-</mo><mi>&epsiv;</mi><mi>l</mi><mi>n</mi><mo>&lsqb;</mo><mi>u</mi><mrow><mo>(</mo><mn>1</mn><mo>-</mo><mi>u</mi><mo>)</mo></mrow><mo>&rsqb;</mo><mo>}</mo><mi>d</mi><mi>t</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000022.GIF" wi="1314" he="135" /></maths>对构造公式(4)的性能指标J乘以一个正的参数λ<sub>0</sub>,性能指标J函数形式为公式(5):<maths num="0005"><math><![CDATA[<mrow><mi>J</mi><mo>=</mo><msub><mi>&lambda;</mi><mn>0</mn></msub><mfrac><msub><mi>T</mi><mi>max</mi></msub><mrow><msub><mi>g</mi><mn>0</mn></msub><msub><mi>I</mi><mrow><mi>s</mi><mi>p</mi></mrow></msub></mrow></mfrac><msubsup><mo>&Integral;</mo><msub><mi>t</mi><mn>0</mn></msub><msub><mi>t</mi><mi>f</mi></msub></msubsup><mo>{</mo><mi>u</mi><mo>-</mo><mi>&epsiv;</mi><mi>l</mi><mi>n</mi><mo>&lsqb;</mo><mi>u</mi><mrow><mo>(</mo><mn>1</mn><mo>-</mo><mi>u</mi><mo>)</mo></mrow><mo>&rsqb;</mo><mo>}</mo><mi>d</mi><mi>t</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000023.GIF" wi="1342" he="134" /></maths>对于构造公式(5)的性能指标J,哈密顿函数H为:<maths num="0006"><math><![CDATA[<mrow><mi>H</mi><mo>=</mo><msub><mi>&lambda;</mi><mi>r</mi></msub><mo>&CenterDot;</mo><mover><mi>r</mi><mo>&CenterDot;</mo></mover><mo>+</mo><msub><mi>&lambda;</mi><mi>v</mi></msub><mo>&CenterDot;</mo><mover><mi>v</mi><mo>&CenterDot;</mo></mover><mo>-</mo><msub><mi>&lambda;</mi><mi>m</mi></msub><mover><mi>m</mi><mo>&CenterDot;</mo></mover><mo>+</mo><msub><mi>&lambda;</mi><mn>0</mn></msub><mfrac><msub><mi>T</mi><mrow><mi>m</mi><mi>a</mi><mi>x</mi></mrow></msub><mrow><msub><mi>g</mi><mn>0</mn></msub><msub><mi>I</mi><mrow><mi>s</mi><mi>p</mi></mrow></msub></mrow></mfrac><mo>{</mo><mi>u</mi><mo>-</mo><mi>&epsiv;</mi><mi>l</mi><mi>n</mi><mo>&lsqb;</mo><mi>u</mi><mrow><mo>(</mo><mn>1</mn><mo>-</mo><mi>u</mi><mo>)</mo></mrow><mo>&rsqb;</mo><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000024.GIF" wi="1469" he="134" /></maths>步骤三:根据庞特里亚金极大值原理,求解最优控制率以及相应的协态方程;由庞特里亚金极大值原理可知,为求解最优控制率,需令哈密顿函数最小化,即<img file="FDA0001109447520000025.GIF" wi="265" he="47" />得最优推力矢量的方向和幅值分别如公式(7)和公式(8)所示:<maths num="0007"><math><![CDATA[<mrow><mi>&alpha;</mi><mo>=</mo><mo>-</mo><mfrac><msub><mi>&lambda;</mi><mi>v</mi></msub><mrow><mo>|</mo><mo>|</mo><msub><mi>&lambda;</mi><mi>v</mi></msub><mo>|</mo><mo>|</mo></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000026.GIF" wi="1078" he="135" /></maths><maths num="0008"><math><![CDATA[<mrow><mi>u</mi><mo>=</mo><mfrac><mrow><mn>2</mn><mi>&epsiv;</mi></mrow><mrow><mi>&rho;</mi><mo>+</mo><mn>2</mn><mi>&epsiv;</mi><mo>+</mo><msqrt><mrow><msup><mi>&rho;</mi><mn>2</mn></msup><mo>+</mo><mn>4</mn><msup><mi>&epsiv;</mi><mn>2</mn></msup></mrow></msqrt></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000027.GIF" wi="1206" he="142" /></maths>开关函数ρ为:<maths num="0009"><math><![CDATA[<mrow><mi>&rho;</mi><mo>=</mo><mn>1</mn><mo>-</mo><mfrac><mrow><msub><mi>g</mi><mn>0</mn></msub><msub><mi>I</mi><mrow><mi>s</mi><mi>p</mi></mrow></msub><mo>|</mo><mo>|</mo><msub><mi>&lambda;</mi><mi>v</mi></msub><mo>|</mo><mo>|</mo></mrow><mrow><msub><mi>&lambda;</mi><mn>0</mn></msub><mi>m</mi></mrow></mfrac><mo>-</mo><mfrac><msub><mi>&lambda;</mi><mi>m</mi></msub><msub><mi>&lambda;</mi><mn>0</mn></msub></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000028.GIF" wi="1173" he="142" /></maths>对应的协态方程如公式(10):<maths num="0010"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mover><mi>&lambda;</mi><mo>&CenterDot;</mo></mover><mi>x</mi></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mo>&part;</mo><mi>H</mi></mrow><mrow><mo>&part;</mo><mi>x</mi></mrow></mfrac><mo>=</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>x</mi></mrow></msub><mfrac><mi>&mu;</mi><msup><mi>r</mi><mn>3</mn></msup></mfrac><mo>-</mo><mfrac><mrow><mn>3</mn><mi>&mu;</mi><mi>x</mi></mrow><msup><mi>r</mi><mn>5</mn></msup></mfrac><mi>r</mi><mo>&CenterDot;</mo><msub><mi>&lambda;</mi><mi>v</mi></msub><mo>+</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>x</mi></mrow></msub><msub><mi>&mu;J</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>&lsqb;</mo><mrow><mfrac><mn>3</mn><mn>2</mn></mfrac><mo>-</mo><mfrac><mn>15</mn><mn>2</mn></mfrac><mfrac><msup><mi>x</mi><mn>2</mn></msup><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>-</mo><mfrac><mn>15</mn><mn>2</mn></mfrac><mfrac><msup><mi>z</mi><mn>2</mn></msup><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>+</mo><mfrac><mn>105</mn><mn>2</mn></mfrac><mfrac><mrow><msup><mi>x</mi><mn>2</mn></msup><msup><mi>z</mi><mn>2</mn></msup></mrow><msup><mi>r</mi><mn>4</mn></msup></mfrac></mrow><mo>&rsqb;</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mo>+</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>y</mi></mrow></msub><msub><mi>&mu;J</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>&lsqb;</mo><mrow><mo>-</mo><mfrac><mn>15</mn><mn>2</mn></mfrac><mfrac><mrow><mi>x</mi><mi>y</mi></mrow><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>+</mo><mfrac><mn>105</mn><mn>2</mn></mfrac><mfrac><mrow><msup><mi>xyz</mi><mn>2</mn></msup></mrow><msup><mi>r</mi><mn>4</mn></msup></mfrac></mrow><mo>&rsqb;</mo></mrow><mo>+</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>z</mi></mrow></msub><msub><mi>&mu;J</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>&lsqb;</mo><mrow><mo>-</mo><mfrac><mn>45</mn><mn>2</mn></mfrac><mfrac><mrow><mi>x</mi><mi>z</mi></mrow><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>+</mo><mfrac><mn>105</mn><mn>2</mn></mfrac><mfrac><mrow><msup><mi>xz</mi><mn>3</mn></msup></mrow><msup><mi>r</mi><mn>4</mn></msup></mfrac></mrow><mo>&rsqb;</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>&lambda;</mi><mo>&CenterDot;</mo></mover><mi>y</mi></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mo>&part;</mo><mi>H</mi></mrow><mrow><mo>&part;</mo><mi>y</mi></mrow></mfrac><mo>=</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>y</mi></mrow></msub><mfrac><mi>&mu;</mi><msup><mi>r</mi><mn>3</mn></msup></mfrac><mo>-</mo><mfrac><mrow><mn>3</mn><mi>&mu;</mi><mi>y</mi></mrow><msup><mi>r</mi><mn>5</mn></msup></mfrac><mi>r</mi><mo>&CenterDot;</mo><msub><mi>&lambda;</mi><mi>v</mi></msub><mo>+</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>x</mi></mrow></msub><msub><mi>&mu;J</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>&lsqb;</mo><mrow><mo>-</mo><mfrac><mn>15</mn><mn>2</mn></mfrac><mfrac><mrow><mi>x</mi><mi>y</mi></mrow><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>+</mo><mfrac><mn>105</mn><mn>2</mn></mfrac><mfrac><mrow><msup><mi>xyz</mi><mn>2</mn></msup></mrow><msup><mi>r</mi><mn>4</mn></msup></mfrac></mrow><mo>&rsqb;</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mo>+</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>y</mi></mrow></msub><msub><mi>&mu;J</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>&lsqb;</mo><mrow><mfrac><mn>3</mn><mn>2</mn></mfrac><mo>-</mo><mfrac><mn>15</mn><mn>2</mn></mfrac><mfrac><msup><mi>y</mi><mn>2</mn></msup><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>-</mo><mfrac><mn>15</mn><mn>2</mn></mfrac><mfrac><msup><mi>z</mi><mn>2</mn></msup><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>+</mo><mfrac><mn>105</mn><mn>2</mn></mfrac><mfrac><mrow><msup><mi>y</mi><mn>2</mn></msup><msup><mi>z</mi><mn>2</mn></msup></mrow><msup><mi>r</mi><mn>4</mn></msup></mfrac></mrow><mo>&rsqb;</mo></mrow><mo>+</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>z</mi></mrow></msub><msub><mi>&mu;J</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>&lsqb;</mo><mrow><mo>-</mo><mfrac><mn>45</mn><mn>2</mn></mfrac><mfrac><mrow><mi>y</mi><mi>z</mi></mrow><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>+</mo><mfrac><mn>105</mn><mn>2</mn></mfrac><mfrac><mrow><msup><mi>yz</mi><mn>3</mn></msup></mrow><msup><mi>r</mi><mn>4</mn></msup></mfrac></mrow><mo>&rsqb;</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>&lambda;</mi><mo>&CenterDot;</mo></mover><mi>z</mi></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mo>&part;</mo><mi>H</mi></mrow><mrow><mo>&part;</mo><mi>z</mi></mrow></mfrac><mo>=</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>z</mi></mrow></msub><mfrac><mi>&mu;</mi><msup><mi>r</mi><mn>3</mn></msup></mfrac><mo>-</mo><mfrac><mrow><mn>3</mn><mi>&mu;</mi><mi>z</mi></mrow><msup><mi>r</mi><mn>5</mn></msup></mfrac><mi>r</mi><mo>&CenterDot;</mo><msub><mi>&lambda;</mi><mi>v</mi></msub><mo>+</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>x</mi></mrow></msub><msub><mi>&mu;J</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>&lsqb;</mo><mrow><mo>-</mo><mfrac><mn>45</mn><mn>2</mn></mfrac><mfrac><mrow><mi>x</mi><mi>z</mi></mrow><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>+</mo><mfrac><mn>105</mn><mn>2</mn></mfrac><mfrac><mrow><msup><mi>xz</mi><mn>3</mn></msup></mrow><msup><mi>r</mi><mn>4</mn></msup></mfrac></mrow><mo>&rsqb;</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mo>+</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>y</mi></mrow></msub><msub><mi>&mu;J</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>&lsqb;</mo><mrow><mo>-</mo><mfrac><mn>45</mn><mn>2</mn></mfrac><mfrac><mrow><mi>y</mi><mi>z</mi></mrow><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>+</mo><mfrac><mn>105</mn><mn>2</mn></mfrac><mfrac><mrow><msup><mi>yz</mi><mn>3</mn></msup></mrow><msup><mi>r</mi><mn>4</mn></msup></mfrac></mrow><mo>&rsqb;</mo></mrow><mo>+</mo><msub><mi>&lambda;</mi><mrow><mi>v</mi><mi>z</mi></mrow></msub><msub><mi>&mu;J</mi><mn>2</mn></msub><mfrac><msubsup><mi>R</mi><mi>E</mi><mn>2</mn></msubsup><msup><mi>r</mi><mn>5</mn></msup></mfrac><mrow><mo>&lsqb;</mo><mrow><mfrac><mn>9</mn><mn>2</mn></mfrac><mo>-</mo><mn>45</mn><mfrac><msup><mi>z</mi><mn>2</mn></msup><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>+</mo><mfrac><mn>105</mn><mn>2</mn></mfrac><mfrac><msup><mi>z</mi><mn>4</mn></msup><msup><mi>r</mi><mn>4</mn></msup></mfrac></mrow><mo>&rsqb;</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>&lambda;</mi><mo>&CenterDot;</mo></mover><mrow><mi>v</mi><mi>x</mi></mrow></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mo>&part;</mo><mi>H</mi></mrow><mrow><mo>&part;</mo><msub><mi>v</mi><mi>x</mi></msub></mrow></mfrac><mo>=</mo><mo>-</mo><msub><mi>&lambda;</mi><mi>x</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>&lambda;</mi><mo>&CenterDot;</mo></mover><mrow><mi>v</mi><mi>y</mi></mrow></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mo>&part;</mo><mi>H</mi></mrow><mrow><mo>&part;</mo><msub><mi>v</mi><mi>y</mi></msub></mrow></mfrac><mo>=</mo><mo>-</mo><msub><mi>&lambda;</mi><mi>y</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>&lambda;</mi><mo>&CenterDot;</mo></mover><mrow><mi>v</mi><mi>z</mi></mrow></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mo>&part;</mo><mi>H</mi></mrow><mrow><mo>&part;</mo><msub><mi>v</mi><mi>z</mi></msub></mrow></mfrac><mo>=</mo><mo>-</mo><msub><mi>&lambda;</mi><mi>z</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>&lambda;</mi><mo>&CenterDot;</mo></mover><mi>m</mi></msub><mo>=</mo><mo>-</mo><mfrac><mrow><mo>&part;</mo><mi>H</mi></mrow><mrow><mo>&part;</mo><mi>m</mi></mrow></mfrac><mo>=</mo><mo>-</mo><mo>|</mo><mo>|</mo><msub><mi>&lambda;</mi><mi>v</mi></msub><mo>|</mo><mo>|</mo><mfrac><mrow><msub><mi>T</mi><mi>max</mi></msub><mi>u</mi></mrow><msup><mi>m</mi><mn>2</mn></msup></mfrac></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001109447520000031.GIF" wi="1965" he="1534" /></maths>步骤四:根据变分法最优控制条件,构造两点边值问题方程组;所述的变分法最优控制条件指<img file="FDA0001109447520000032.GIF" wi="259" he="63" />根据Bang‑Bang控制的横截条件,当状态变量[r;v;m]边值是固定的,则相应的协态变量[λ<sub>r</sub>;λ<sub>v</sub>;λ<sub>m</sub>]是自由的,当状态变量[r;v;m]为自由的,则协态变量[λ<sub>r</sub>;λ<sub>v</sub>;λ<sub>m</sub>]为零;因此终端时刻的自由状态变量质量对应的协态变量λ<sub>m</sub>(t<sub>f</sub>)=0;因此,燃耗最优控制问题求解变为包含多个方程的两点边值问题的求解;Φ(z)=[r(t<sub>f</sub>)‑r<sub>f</sub>,v(t<sub>f</sub>)‑v<sub>f</sub>,λ<sub>m</sub>(t<sub>f</sub>)]<sup>T</sup>=0    (11)公式(11)称为打靶方程组;把协态变量[λ<sub>r</sub>;λ<sub>v</sub>;λ<sub>m</sub>]与数乘因子λ<sub>0</sub>共同称为拉格朗日乘子;则此时最优控制问题等价于对拉格朗日乘子的优化问题;对拉格朗日乘子乘以一个正数不影响燃耗最优控制问题的求解,因此为归一化参数,把拉格朗日乘子向量除以其初值的模的大小;定义新的协态变量为:<maths num="0011"><math><![CDATA[<mrow><mi>&lambda;</mi><mo>=</mo><mfrac><mi>&lambda;</mi><mrow><mo>|</mo><mo>|</mo><mi>&lambda;</mi><mrow><mo>(</mo><msub><mi>t</mi><mn>0</mn></msub><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow></mfrac></mrow>]]></math><img file="FDA0001109447520000033.GIF" wi="219" he="135" /></maths>重新定义后的拉格朗日乘子具有归一化的特点,即||λ(t<sub>0</sub>)||=1;;因此,把归一化条件||λ(t<sub>0</sub>)||=1加进公式(11)的打靶方程组,新的打靶方程组包含8个方程,如公式(12):Φ(z)=[r(t<sub>f</sub>)‑r<sub>f</sub>,v(t<sub>f</sub>)‑v<sub>f</sub>,λ<sub>m</sub>(t<sub>f</sub>),||λ(t<sub>0</sub>)||‑1]<sup>T</sup>=0    (12)在优化时,给定状态变量[r;v;m]与协态变量[λ<sub>r</sub>;λ<sub>v</sub>;λ<sub>m</sub>]的初始猜测值,对公式(2)的动力学方程和公式(10)的协态方程进行积分,得到满足最优控制条件<img file="FDA0001109447520000041.GIF" wi="235" he="47" />的终端状态参数[r(t<sub>f</sub>),v(t<sub>f</sub>),λ<sub>m</sub>(t<sub>f</sub>)],代入公式(12)即完成两点边值问题方程组构造;步骤五:根据航天器始末状态[r<sub>0</sub>,v<sub>0</sub>,r<sub>f</sub>,v<sub>f</sub>,m]和飞行时间t,求解两点边值问题打靶方程组;在求解公式(12)的两点边值问题打靶方程组时,初值采用航天器初始状态和随机生成的协态变量初值,通过非线性规划求解公式(12)的两点边值问题方程组;同时采用不同初值打靶计算,在样本充足的条件下统计可行解中燃耗最少的结果;对燃耗最少的结果采用逐渐减小过渡系数ε的方式迭代计算,直到求解公式(12)的两点边值问题打靶方程组满足预设的精度要求;步骤六:通过步骤五中的求解方法对步骤四中构造的两点边值问题打靶方程组进行求解,得到步骤三中公式(7)所示的最优推力矢量方向α和公式(9)所示的发动机开关函数ρ,以所述的推力矢量方向α和发动机开关函数ρ构成的控制率对卫星变轨进行控制,实现提高近地卫星转移过程的实时性和变轨精度,降低变轨转移所需的燃料消耗。
地址 100081 北京市海淀区中关村南大街5号