发明名称 基于发动机前后配置的姿轨控制方法
摘要 基于发动机前后配置的姿轨控制方法,在航天器的前端和后端分别配置平移发动机,对发动机开机进行组合,分别在航天器横向运动方向、俯仰和偏航方向对航天器进行位置控制和姿态控制。根据航天器质心位置,由平移控制力需求计算前后平移发动机位置开机系数ki1,计算原则是航天器前、后同方向的发动机产生的推力大小和方向与控制力需求相同,且前、后发动机产生的力矩大小相等;由姿态控制力矩需求计算前后发动机姿态开机系数ki2,计算原则是航天器前、后反方向的发动机产生的力矩大小和方向与控制力矩需求相同,且前、后反方向发动机产生的推力大小相等;最后计算平移发动机总开机系数ki=ki1+ki2并进行归1化处理后开发动机完成姿轨控制。
申请公布号 CN101758933B 申请公布日期 2012.08.22
申请号 CN200910243278.0 申请日期 2009.12.30
申请人 北京控制工程研究所 发明人 张昊;解永春;王敏
分类号 B64G1/24(2006.01)I;G06F17/50(2006.01)I 主分类号 B64G1/24(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 1.基于发动机前后配置的姿轨控制方法,其特征在于步骤如下:(1)在航天器的前端和后端分别配置平移发动机,其中M个平移发动机分别布置在航天器前端4个象限线上,推力指向外,推力大小分别为f<sub>1</sub>~f<sub>M</sub>,另外N个平移发动机分别布置在航天器后端4个象限线上,推力指向外,推力大小分别为f<sub>M+1</sub>~f<sub>M+N</sub>;所述平移发动机配置的最小数量为前端和后端各4个;(2)建立航天器本体系oxyz,其原点o为航天器的质心,x轴为航天器纵轴,指向航天器头部,y轴沿航天器的横向,垂直于纵轴,与航天器横向的一个主惯量轴一致,z轴与x、y轴构成右手系;(3)对平移发动机进行组合,分别在y轴的正负方向和z轴的正负方向对航天器进行位置控制和姿态控制,组合结果如下:位置控制时:+y轴,k<sub>11</sub>*F<sub>1</sub>+k<sub>51</sub>*F<sub>5</sub>-y轴,k<sub>21</sub>*F<sub>2</sub>+k<sub>61</sub>*F<sub>6</sub>+z轴,k<sub>31</sub>*F<sub>3</sub>+k<sub>71</sub>*F<sub>7</sub>-z轴,k<sub>41</sub>*F<sub>4</sub>+k<sub>81</sub>*F<sub>8</sub>姿态控制时:+y轴,k<sub>42</sub>*F<sub>4</sub>+k<sub>72</sub>*F<sub>7</sub>-y轴,k<sub>32</sub>*F<sub>3</sub>+k<sub>82</sub>*F<sub>8</sub>+z轴,k<sub>12</sub>*F<sub>1</sub>+k<sub>62</sub>*F<sub>6</sub>-z轴,k<sub>22</sub>*F<sub>2</sub>+k<sub>52</sub>*F<sub>5</sub>其中,F<sub>1</sub>~F<sub>4</sub>分别为航天器前端+y轴、-y轴、+z轴、-z轴四个方向平移发动机f<sub>1</sub>~f<sub>M</sub>的总推力,F<sub>5</sub>~F<sub>8</sub>分别为航天器后端+y轴、-y轴、+z轴、-z轴四个方向平移发动机f<sub>M+1</sub>~f<sub>M+N</sub>的总推力,k<sub>11</sub>、k<sub>21</sub>、k<sub>31</sub>、k<sub>41</sub>、k<sub>51</sub>、k<sub>61</sub>、k<sub>71</sub>、k<sub>81</sub>、k<sub>12</sub>、k<sub>22</sub>、k<sub>32</sub>、k<sub>42</sub>、k<sub>52</sub>、k<sub>62</sub>、k<sub>72</sub>、k<sub>82</sub>为平移发动机的开机系数,代表平移发动机的实际推力输出控制量;(4)获取航天器的质心位置; (5)根据航天器的质心位置和平移控制力需求计算前后平移发动机位置控制开机系数k<sub>i1</sub>,i=1,2,3......8,计算原则是航天器前端和后端同方向的平移发动机产生的推力大小和方向与平移控制力需求相同,且航天器前端和后端同方向的平移发动机产生的力矩大小相等,方向相反;(6)根据航天器的质心位置和姿态控制力矩需求计算前后平移发动机姿态开机系数k<sub>i2</sub>,计算原则是航天器前端和后端反方向的平移发动机共同产生力矩的大小和方向与姿态控制力矩需求相同,且航天器前端和后端反方向的平移发动机产生的推力大小相等,方向相反;(7)确定最终的平移发动机总开机系数k<sub>i</sub>=k<sub>i1</sub>+k<sub>i2</sub>;如果计算得到的平移发动机总开机系数小于1,则该方向上的平移发动机按照燃料节约的原则组合并按照该系数开机;如果计算得到的平移发动机总开机系数大于1,则需要对其进行归1化处理,归1化处理的原则是优先姿态控制;对于k<sub>i</sub>,当k<sub>i</sub>>1时,归1化处理原则如下:(a)如果k<sub>i2</sub>≥1,则Fi方向平移发动机的总开机系数为k<sub>i</sub>=1,航天器另一端与F<sub>i</sub>反方向平移发动机的姿态开机系数变为<img file="FSB00000785050100021.GIF" wi="230" he="128" />j≠i,且j∈(1,2,3,4,5,6,7,8);(b)如果k<sub>i2</sub><1,设Δk<sub>i</sub>=1-k<sub>i2</sub>,则F<sub>i</sub>方向平移发动机的总开机系数为k<sub>i</sub>=1,航天器另一端与F<sub>i</sub>同方向平移发动机的位置控制开机系数变为<img file="FSB00000785050100022.GIF" wi="277" he="129" />p≠i,且p∈(1,2,3,4,5,6,7,8);在得到归1化处理后的平移发动机总开机系数k<sub>i</sub>后,该方向的所有平移发动机按照燃料节约的原则组合,使得该方向按照归1化处理后的平移发动机总开机系数k<sub>i</sub>开机。 
地址 100080 北京市海淀区北京2729信箱