发明名称 一种基于几何分析的空间飞行器单轴指向纯磁控算法
摘要 本发明提出了一种基于几何分析的空间飞行器单轴指向纯磁控算法,通过纯磁控算法(即仅通过磁力矩器输出磁矩与地磁场相互作用产生控制力矩)来实现空间飞行器单轴指向控制。该算法采用空间几何方法获取最优控制磁矩方向,进而设计了PD控制器,克服了传统磁控方法效率低,甚至不可控的问题。该方法且简单易行,可应用于空间飞行器姿态控制领域,实现诸如太阳帆板对日指向,天线对地指向等指向控制。
申请公布号 CN105974820A 申请公布日期 2016.09.28
申请号 CN201610323291.7 申请日期 2016.05.13
申请人 深圳航天东方红海特卫星有限公司 发明人 寇义民;郭碧波;薛力军;魏世龙;季艳波;袁勤;张迎春
分类号 G05B17/02(2006.01)I 主分类号 G05B17/02(2006.01)I
代理机构 深圳市科吉华烽知识产权事务所(普通合伙) 44248 代理人 王雨时;严涓逢
主权项 一种基于几何分析的空间飞行器单轴指向纯磁控算法,其特征在于,所述算法包括如下步骤:①获取以下数据:目标方位向量<img file="FDA0000989900080000011.GIF" wi="99" he="62" />本体轴向量<img file="FDA0000989900080000012.GIF" wi="75" he="59" />和地磁场矢量<img file="FDA0000989900080000013.GIF" wi="42" he="63" />在本体系下的坐标,以及飞行器惯量矩阵I;②获取地磁场法平面内的一对非平行向量X和Y;③通过所述飞行器惯量矩阵I仿射变换计算角加速度平面的单位法向量Z’:X'=I<sup>‑1</sup>XY'=I<sup>‑1</sup>Y<maths num="0001"><math><![CDATA[<mrow><msup><mi>Z</mi><mo>&prime;</mo></msup><mo>=</mo><mfrac><mrow><msup><mi>X</mi><mo>&prime;</mo></msup><mo>&times;</mo><msup><mi>Y</mi><mo>&prime;</mo></msup></mrow><mrow><mo>|</mo><mo>|</mo><msup><mi>X</mi><mo>&prime;</mo></msup><mo>&times;</mo><msup><mi>Y</mi><mo>&prime;</mo></msup><mo>|</mo><mo>|</mo></mrow></mfrac></mrow>]]></math><img file="FDA0000989900080000014.GIF" wi="277" he="135" /></maths>其中,X’与Y’为X和Y仿射变换后的向量,近似位于磁力矩所产生的角加速度所在平面内;④由下式获得最优控制转轴<img file="FDA0000989900080000015.GIF" wi="103" he="71" /><img file="FDA0000989900080000016.GIF" wi="869" he="102" />其中NORM为向量归一化算子;⑤调整控制系数并计算磁控力矩T,此时T必定位于磁场法平面内,计算计算磁控力矩T具体为:计算转动角加速度大小和方向,<img file="FDA0000989900080000017.GIF" wi="1006" he="101" />其中,K<sub>p</sub>为控制系数;β为本体轴<img file="FDA0000989900080000018.GIF" wi="75" he="62" />与目标轴<img file="FDA0000989900080000019.GIF" wi="70" he="60" />的夹角;sign为获取正负号算子,即向量<img file="FDA00009899000800000110.GIF" wi="74" he="62" />与<img file="FDA00009899000800000111.GIF" wi="78" he="59" />点乘为正取正1,反之取负1,两者垂直时可取0,最优转轴<img file="FDA00009899000800000112.GIF" wi="82" he="63" />垂直于<img file="FDA00009899000800000113.GIF" wi="72" he="62" />和<img file="FDA00009899000800000114.GIF" wi="106" he="63" />K<sub>m</sub>为控制系数,其作用是对<img file="FDA00009899000800000115.GIF" wi="75" he="63" />方向的角速度进行控制;求取阻尼角加速度:<maths num="0002"><math><![CDATA[<mrow><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>d</mi></msub><mo>=</mo><msub><mi>K</mi><mi>d</mi></msub><mo>&lsqb;</mo><mi>&omega;</mi><mo>-</mo><mrow><mo>(</mo><mi>&omega;</mi><mo>&CenterDot;</mo><msup><mi>Z</mi><mo>&prime;</mo></msup><mo>)</mo></mrow><msup><mi>Z</mi><mo>&prime;</mo></msup><mo>&rsqb;</mo></mrow>]]></math><img file="FDA00009899000800000116.GIF" wi="491" he="77" /></maths>其中,K<sub>d</sub>为控制系数,ω为星体瞬时角速度,(ω·Z')Z'为ω中垂直于角加速度平面的分量,故ω‑(ω·Z')Z'为ω中位于角加速度平面内的分量;再计算要产生前述转动角加速度与阻尼角加速度所需的力矩:<maths num="0003"><math><![CDATA[<mrow><mi>T</mi><mo>=</mo><mi>I</mi><mrow><mo>(</mo><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>r</mi></msub><mo>+</mo><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>d</mi></msub><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0000989900080000021.GIF" wi="332" he="70" /></maths>⑥计算获得所需的控制磁矩M:<maths num="0004"><math><![CDATA[<mrow><mover><mi>M</mi><mo>&RightArrow;</mo></mover><mo>=</mo><mfrac><mrow><mover><mi>B</mi><mo>&RightArrow;</mo></mover><mo>&times;</mo><mover><mi>T</mi><mo>&RightArrow;</mo></mover></mrow><mrow><mo>|</mo><mo>|</mo><mover><mi>B</mi><mo>&RightArrow;</mo></mover><mo>|</mo><msup><mo>|</mo><mn>2</mn></msup></mrow></mfrac><mo>.</mo></mrow>]]></math><img file="FDA0000989900080000022.GIF" wi="253" he="182" /></maths>
地址 518000 广东省深圳市南山区科技园科技南十路深圳航天科技创新研究院D座910室