发明名称 姿轨一体卫星的推力分配方法
摘要 本发明公开了一种姿轨一体卫星的推力分配方法,属于卫星控制技术领域。在推力器安装布局确定后,建立推力分配的数学模型以传统的伪逆法为基础得到推力分配的初解,即初始的推力分配方案;然后,在初解的基础上进行分组,得到基于链式分配的修正伪逆法的推力分配方案;最后,设计推力分配优化指标,结合推力器各指标进行总体的算法优化,使推力分配得到优化。本发明能够在推力器配置的负载范围内有效地完成卫星一体化控制任务,同时有效地节省燃料,减小推力构型带来的推力分配误差,提高推力的控制精度。
申请公布号 CN104932261A 申请公布日期 2015.09.23
申请号 CN201510274674.5 申请日期 2015.05.26
申请人 南京航空航天大学 发明人 华冰;邵珠君;关欣;康国华;吴云华
分类号 G05B13/04(2006.01)I;G05D1/08(2006.01)I;G05D1/10(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 江苏圣典律师事务所 32237 代理人 贺翔;吴庭祥
主权项 一种姿轨一体卫星的推力分配方法,其特征在于包括以下步骤: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最小的一组进行执行。
地址 210016 江苏省南京市秦淮区御道街29号