发明名称 一种基于安全区的特征质量获取方法
摘要 一种基于安全区的特征质量获取方法,通过将绳系弹性、绳系质量、环境干扰等建模时忽略的因素等效为特征质量的一部分,并加以安全区条件约束,通过计算特征质量估计值与真实特征质量的比值,对估计值不断进行修正,以逼近真实特征质量。本发明方法不仅将安全放在第一位,并且减少了对激励信号的需求。另外,特征质量的引入减少了由于忽略外部干扰或弹性等因素引入的控制误差,特别适用于质量特性不确知空间碎片清理等空间任务。
申请公布号 CN102520725A 申请公布日期 2012.06.27
申请号 CN201110412439.1 申请日期 2011.12.08
申请人 北京控制工程研究所 发明人 谈树萍;何英姿;魏春岭
分类号 G05D1/08(2006.01)I;G05D1/10(2006.01)I 主分类号 G05D1/08(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 1.一种基于安全区的特征质量获取方法,其特征在于步骤如下:(1)将外部干扰因素δ纳入绳系卫星的质量特性,由此建立绳系卫星的动力学模型为<maths num="0001"><![CDATA[<math><mrow><mover><mi>X</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msup><mfenced open='(' close=')'><mtable><mtr><mtd><mover><mi>x</mi><mo>&CenterDot;</mo></mover></mtd><mtd><mover><mi>y</mi><mo>&CenterDot;</mo></mover></mtd><mtd><mover><mi>z</mi><mo>&CenterDot;</mo></mover></mtd><mtd><mn>2</mn><mi>&Omega;</mi><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mo>-</mo><mfrac><mi>x</mi><mrow><mover><mi>m</mi><mo>~</mo></mover><mo>|</mo><mo>|</mo><msub><mi>r</mi><mi>rat</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow></mfrac><mi>u</mi></mtd><mtd><mo>-</mo><msup><mi>&Omega;</mi><mn>2</mn></msup><mi>y</mi><mo>-</mo><mfrac><mi>y</mi><mrow><mover><mi>m</mi><mo>~</mo></mover><mo>|</mo><mo>|</mo><msub><mi>r</mi><mi>rat</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow></mfrac><mi>u</mi></mtd><mtd><mn>3</mn><msup><mi>&Omega;</mi><mn>2</mn></msup><mi>z</mi><mo>-</mo><mn>2</mn><mi>&Omega;</mi><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mo>-</mo><mfrac><mi>z</mi><mrow><mover><mi>m</mi><mo>~</mo></mover><mo>|</mo><mo>|</mo><msub><mi>r</mi><mi>rat</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow></mfrac><mi>u</mi></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow></math>]]></maths>其中x、y、z、<img file="FSA00000634337400012.GIF" wi="54" he="36" /><img file="FSA00000634337400013.GIF" wi="57" he="45" /><img file="FSA00000634337400014.GIF" wi="23" he="35" />分别为绳系卫星中子星相对于母星的三轴位移及相应的速度,||r<sub>sat</sub>||为绳系卫星中母星与子星之间的相对位置,Ω为绳系卫星中母星的轨道角速度,u为控制器,<img file="FSA00000634337400015.GIF" wi="35" he="38" />为特征质量;所述的特征质量为考虑外部干扰因素δ后绳系卫星中子星相对于控制器u的等效质量;(2)选取控制器<img file="FSA00000634337400016.GIF" wi="337" he="67" />其中<img file="FSA00000634337400017.GIF" wi="26" he="38" />为根据绳系卫星中子星和母星之间的距离安全边界u<sub>f</sub>确定的常数,<img file="FSA00000634337400018.GIF" wi="152" he="59" />m为控制器设计时采用的子星质量;(3)利用步骤(2)确定的控制器,根据kh时刻的特征质量估计值<img file="FSA00000634337400019.GIF" wi="106" he="73" />获得(k+1)h时刻的控制量<img file="FSA000006343374000110.GIF" wi="570" he="69" />其中k为正整数;(4)将控制量u<sub>(k+1)h</sub>带入到步骤(1)中建立的绳系卫星动力学模型中,得到闭环控制系统的动力学方程<img file="FSA000006343374000111.GIF" wi="239" he="60" />其中<img file="FSA000006343374000112.GIF" wi="1182" he="350" /><maths num="0002"><![CDATA[<math><mrow><mi>c</mi><mo>=</mo><mfrac><msubsup><mi>m</mi><mi>kh</mi><mo>*</mo></msubsup><mover><mi>m</mi><mo>~</mo></mover></mfrac><mo>;</mo></mrow></math>]]></maths>(5)获取(k+1)h时刻绳系卫星中子星相对于母星的三轴位移及相应的速度观测量分别为x<sub>(k+1)h</sub>、y<sub>(k+1)h</sub>、z<sub>(k+1)h</sub>、<img file="FSA000006343374000114.GIF" wi="160" he="56" /><img file="FSA000006343374000115.GIF" wi="166" he="56" /><img file="FSA000006343374000116.GIF" wi="158" he="55" />并记为<maths num="0003"><![CDATA[<math><mrow><msubsup><mi>X</mi><mrow><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mi>h</mi></mrow><mo>*</mo></msubsup><mo>=</mo><msup><mfenced open='(' close=')'><mtable><mtr><mtd><msub><mi>x</mi><mrow><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mi>h</mi></mrow></msub></mtd><mtd><msub><mi>y</mi><mrow><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mi>h</mi></mrow></msub></mtd><mtd><msub><mi>z</mi><mrow><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mi>h</mi></mrow></msub></mtd><mtd><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mrow><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mi>h</mi></mrow></msub></mtd><mtd><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mrow><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mi>h</mi></mrow></msub></mtd><mtd><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mrow><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mi>h</mi></mrow></msub></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>;</mo></mrow></math>]]></maths>根据步骤(4)中确定的闭环控制系统的动力学方程<img file="FSA000006343374000118.GIF" wi="214" he="58" />解得观测量<img file="FSA000006343374000119.GIF" wi="137" he="70" />满足<img file="FSA000006343374000120.GIF" wi="371" he="74" /><img file="FSA000006343374000121.GIF" wi="72" he="63" />为kh时刻绳系卫星中子星相对于母星的三轴位移及相应的速度观测量;(6)设定采样步长h<<1,求解矩阵方程组<img file="FSA00000634337400021.GIF" wi="718" he="92" />得到矩阵A<sup>*</sup>中的常数c,其中X<sub>(t+1)h</sub>为动力学方程<img file="FSA00000634337400022.GIF" wi="192" he="55" />在(k+1)h时刻的解,其中<img file="FSA00000634337400023.GIF" wi="1109" he="350" />为定常矩阵,X在kh时刻的取值为<img file="FSA00000634337400024.GIF" wi="89" he="73" />(7)判断c是否等于1,如果c=1,则<img file="FSA00000634337400025.GIF" wi="204" he="71" />否则继续计算,直至(k+r)h时刻满足c=1,此时<img file="FSA00000634337400026.GIF" wi="322" he="81" />其中r为大于零的正整数。
地址 100080 北京市2729信箱