发明名称 二体星型空间绳系编队系统自旋展开与回收最优控制方法
摘要 本发明提出了一种二体星型空间绳系编队系统自旋展开与回收最优控制方法,首先确定约束条件,包括控制量约束、状态约束、终端约束和动力学约束,其次根据任务要求选取性能指标,然后通过hp‑自适应为伪谱法获得最优控制量M和最优理想状态,最后设计状态测量误差控制器和执行机构误差控制器分别对理想状态和最优控制与实际状态和实际控制的误差进行控制。本发明利用从自旋运动出发建立的自旋动力学模型,能够在一定的性能指标和约束条件下,控制二体星型空间绳系编队系统顺利地实现自旋展开与回收任务,并为一般的多体星型空间绳系编队系统的自旋展开与回收控制提供了一定的理论参考。
申请公布号 CN103901894B 申请公布日期 2016.08.17
申请号 CN201410147969.1 申请日期 2014.04.14
申请人 西北工业大学 发明人 黄攀峰;马骏;袁建平;刘彬彬;孟中杰
分类号 G05D1/10(2006.01)I;G05B13/04(2006.01)I 主分类号 G05D1/10(2006.01)I
代理机构 西北工业大学专利中心 61204 代理人 陈星
主权项 一种二体星型空间绳系编队系统自旋展开与回收最优控制方法,其特征在于:采用以下步骤:步骤1:根据实际任务要求,确定二体星型空间绳系编队系统自旋展开与回收任务的约束条件,包括控制量约束、状态约束、终端约束和动力学约束;所述动力学约束指满足二体星型空间绳系编队系统的非线性自旋动力学模型:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mfrac><mrow><mn>2</mn><msub><mi>mr</mi><mn>0</mn></msub><msub><mi>sinx</mi><mn>2</mn></msub><mo>&lsqb;</mo><msub><mi>r</mi><mn>0</mn></msub><msubsup><mi>x</mi><mn>1</mn><mn>2</mn></msubsup><msub><mi>cosx</mi><mn>2</mn></msub><mo>+</mo><mi>L</mi><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>+</mo><msub><mi>x</mi><mn>3</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>&rsqb;</mo><mo>+</mo><msub><mi>u</mi><mn>1</mn></msub></mrow><mrow><mi>I</mi><mo>+</mo><mn>2</mn><msubsup><mi>mr</mi><mn>0</mn><mn>2</mn></msubsup><msup><mi>sin</mi><mn>2</mn></msup><msub><mi>x</mi><mn>2</mn></msub></mrow></mfrac></mrow>]]></math><img file="FDA0000931299610000011.GIF" wi="912" he="165" /></maths>其中,状态变量<img file="FDA0000931299610000012.GIF" wi="495" he="63" />控制量u=[u<sub>1</sub>]<sup>T</sup>=[M]<sup>T</sup>,<img file="FDA0000931299610000013.GIF" wi="37" he="54" />为编队中旋臂的旋臂角,L为编队中旋臂的长度,m为编队中子航天器的质量,r<sub>0</sub>为编队中主航天器的自旋半径,I为编队中主航天器的转动惯量,M为编队中主航天器的自旋扭矩,ω为编队中主航天器的自旋转速;所述状态约束指状态变量<img file="FDA0000931299610000014.GIF" wi="233" he="62" />满足<img file="FDA0000931299610000015.GIF" wi="371" he="319" />其中,ω<sub>min</sub>和ω<sub>max</sub>分别为编队自旋转速所允许的最小值和最大值,<img file="FDA0000931299610000016.GIF" wi="75" he="62" />和<img file="FDA0000931299610000017.GIF" wi="78" he="61" />分别为旋臂角角速度所允许的最小值和最大值;所述终端约束指在编队自旋的初始时刻t<sub>0</sub>和最终时刻t<sub>f</sub>时,对应的状态变量满足<img file="FDA0000931299610000018.GIF" wi="253" he="474" />其中ω<sub>0</sub>和ω<sub>f</sub>分别为编队自旋转速的初始状态和最终状态,<img file="FDA0000931299610000019.GIF" wi="53" he="47" />和<img file="FDA00009312996100000110.GIF" wi="51" he="53" />分别为编队旋臂角的初始状态和最终状态,<img file="FDA00009312996100000111.GIF" wi="52" he="60" />和<img file="FDA00009312996100000112.GIF" wi="50" he="61" />分别为旋臂角角速度的初始状态和最终状态;所述控制量约束指控制量满足M<sub>min</sub>≤M≤M<sub>max</sub>,其中M<sub>min</sub>和M<sub>max</sub>分别为编队中主航天器自旋扭矩的最小幅值和最大幅值;步骤2:根据任务要求,确定二体星型空间绳系编队系统自旋展开与回收任务的性能指标,当任务要求燃料消耗最少时,取性能指标函数<img file="FDA0000931299610000021.GIF" wi="422" he="87" />当任务要求时间消耗最少时,取性能指标函数J=t<sub>f</sub>;步骤3:在确定约束条件和性能指标的前提下,通过hp‑自适应为伪谱法获得二体星型空间绳系编队系统自旋展开与回收过程的最优控制量M和最优理想状态<img file="FDA0000931299610000022.GIF" wi="199" he="62" />步骤4:针对状态测量误差和执行机构误差分别设计状态测量误差控制器和执行机构误差控制器;步骤5:通过状态测量误差控制器对理想状态和实际状态的误差进行控制,通过执行机构误差控制器对最优控制和实际控制的误差进行控制。
地址 710072 陕西省西安市友谊西路127号