主权项 |
一种姿轨一体卫星的推力分配方法,其特征在于包括以下步骤:1)、在卫星上安装n个推力器,令C=[T;U],D=[A;B],建立推力分配模型:C=DF式中,C为控制律给出的控制指令,T为推力在卫星质心处产生的作用力矩T=AF,作用力为U=BF;A为所有推力器的单位矢量对卫星的力矩矩阵,A=[d<sub>1</sub>e<sub>1</sub> d<sub>2</sub>e<sub>2</sub> ... d<sub>n</sub>e<sub>n</sub>],[d<sub>1</sub> d<sub>2</sub> ... d<sub>n</sub>]为n个推力器卫星质心的位置矢量矩阵,[e<sub>1</sub> e<sub>2</sub> ... e<sub>n</sub>]为n个推力器产生的单位推力矩阵,D为推力配置矩阵;2)、初解步骤1)所述推力分配模型,得到F=D<sup>T</sup>(DD<sup>T</sup>)<sup>‑1</sup>C,D<sup>T</sup>(DD<sup>T</sup>)<sup>‑1</sup>为D的伪逆;3)、对步骤2)得到的初解按照推力正负进行分组:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>F</mi><mi>pc</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>F</mi><mrow><mi>pc</mi><mo>_</mo><mi>neg</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>F</mi><mrow><mi>pc</mi><mo>_</mo><mi>pos</mi></mrow></msub></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000724844900000011.GIF" wi="333" he="162" /></maths> F<sub>pc_neg</sub><0,F<sub>pc_pos</sub>>0其中,F<sub>pc</sub>为初解正负分组后的新矩阵,F<sub>pc_neg</sub>为所有负解的子矩阵,F<sub>pc_pos</sub>为所有正解的子矩阵;将效率矩阵对应分组:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>D</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>D</mi><mi>neg</mi></msub></mtd></mtr><mtr><mtd><msub><mi>D</mi><mi>pos</mi></msub></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000724844900000012.GIF" wi="244" he="164" /></maths>D<sub>neg</sub>为F<sub>pc_neg</sub>对应的效率矩阵子阵、D<sub>pos</sub>为对应F<sub>pc_pos</sub>的效率矩阵子阵;将负值组的推力全部置零,得到:F<sub>pc_neg</sub>=u<sub>1</sub>=[0 … 0]对分配后的期望量再次分配,得到修正后的分配值u<sub>2</sub>:M<sub>d</sub>=D<sub>pos</sub>u<sub>2</sub>M<sub>d</sub>为控制律给出的初始期望量C经分配后得到的期望量;4)、将步骤3)中D<sub>pos</sub>分解为行秩不变的k个子矩阵,同时对u<sub>2</sub>进行分解,重新求伪逆,构成以下方程组:<maths num="0003" id="cmaths0003"><math><![CDATA[<mfenced open='' close=''><mtable><mtr><mtd><msub><mi>M</mi><mi>d</mi></msub><mo>=</mo><msubsup><mi>D</mi><mi>pos</mi><mn>1</mn></msubsup><msubsup><mi>u</mi><mn>2</mn><mn>1</mn></msubsup></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msub><mi>M</mi><mi>d</mi></msub><mo>=</mo><msubsup><mi>D</mi><mi>pos</mi><mi>k</mi></msubsup><msubsup><mi>u</mi><mn>2</mn><mi>k</mi></msubsup></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000724844900000021.GIF" wi="288" he="272" /></maths>针对每一组方程,求解对应的<img file="FDA0000724844900000022.GIF" wi="511" he="144" />F<sub>j</sub>是待求解变量,F<sub>j</sub>=[u<sub>1</sub>,u<sub>2</sub>],j=1,..,n、c<sub>j,m</sub>为已知系数,代表第j台推力器消耗的推进剂量、CDOP为燃料消耗因子;5)、选取步骤4)中J最小的一组进行执行。 |