CN107966149B - 一种多约束自主飞行器的程序角优化设计方法 - Google Patents

一种多约束自主飞行器的程序角优化设计方法 Download PDF

Info

Publication number
CN107966149B
CN107966149B CN201711157130.6A CN201711157130A CN107966149B CN 107966149 B CN107966149 B CN 107966149B CN 201711157130 A CN201711157130 A CN 201711157130A CN 107966149 B CN107966149 B CN 107966149B
Authority
CN
China
Prior art keywords
aircraft
space
program angle
time
antenna
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201711157130.6A
Other languages
English (en)
Other versions
CN107966149A (zh
Inventor
张烽
刘丙利
童科伟
胡冬生
李扬
陈蓉
焉宁
申麟
高朝辉
唐庆博
唐琼
张柳
张雪梅
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Academy of Launch Vehicle Technology CALT
Original Assignee
China Academy of Launch Vehicle Technology CALT
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by China Academy of Launch Vehicle Technology CALT filed Critical China Academy of Launch Vehicle Technology CALT
Priority to CN201711157130.6A priority Critical patent/CN107966149B/zh
Publication of CN107966149A publication Critical patent/CN107966149A/zh
Application granted granted Critical
Publication of CN107966149B publication Critical patent/CN107966149B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0205—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
    • G05B13/024—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Software Systems (AREA)
  • Medical Informatics (AREA)
  • Evolutionary Computation (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Variable-Direction Aerials And Aerial Arrays (AREA)

Abstract

一种多约束自主飞行器的程序角优化设计方法，包括如下步骤：步骤一、设定对地定向时段起始时刻为T0，设定对地定向时段终止时刻和天基数传时段起始时刻均为T1，设定天基数传时段终止时刻为T2；步骤二、根据飞行器的轨道参数和发射点参数，基于本体坐标系相对于发射惯性坐标系的姿态转换矩阵，计算飞行器对地定向时段的程序角；步骤三、根据天基数传时段飞行器的天线对天基卫星的可见性，确定飞行器的天线和天基卫星，计算飞行器天基数传时段的程序角；步骤四、根据步骤二中飞行器对地定向时段的程序角和步骤三中飞行器天基数传时段的程序角进行平滑。

Description

一种多约束自主飞行器的程序角优化设计方法
技术领域
本发明涉及一种多约束自主飞行器的程序角优化设计方法，属于飞行器制导、导航与控制领域。
背景技术
飞行器在轨运行时，往往通过所配置的地球敏感器、太阳敏感器及星敏感器等空间定向寻的装置实施姿态确定与控制，确保飞行器姿态按任务需求变化。然而，针对纯惯组导航方案下的飞行器，其任务要求的姿态变化仅能通过程序控制方案得以实现，而程序控制方案中，程序角的设计是一个关键环节。程序角表征了飞行器在执行任务期间的期望姿态序列，需要满足飞行任务指定的姿态动作，现有的程序角设计方法往往集中于运载火箭的上升段，设计需求较少、姿态约束较为简单，相比之下，在轨飞行器为实现在轨操作、姿态机动、数据通信等需求，需要完成多种姿态(如对地三轴稳定、多次天基对星定向等)，同时还需满足控制、热控、遥测控等专业的专业约束。因而，对于含有天地基测控复合需求的飞行任务，其飞行器程序角的设计存在着诸多挑战，以往的程序角设计方法很难直接适用。
发明内容
本发明要解决的技术问题是：克服现有技术的不足，提供了一种多约束自主飞行器的程序角优化设计方法，采用三次多项式对程序角突变时刻进行了平滑，平滑后的效果好；同时能够确保姿态变化幅度最小，燃料消耗最省；采用轨道系数据作为输入条件，降低程序角计算对飞行器发射时刻的依赖性。
本发明目的通过以下技术方案予以实现：
一种多约束自主飞行器的程序角优化设计方法，包括如下步骤：
步骤一、设定对地定向时段起始时刻为T0，设定对地定向时段终止时刻和天基数传时段起始时刻均为T1，设定天基数传时段终止时刻为T2；
步骤二、根据飞行器的轨道参数和发射点参数，基于本体坐标系相对于发射惯性坐标系的姿态转换矩阵，计算飞行器对地定向时段的程序角；
步骤三、根据天基数传时段飞行器的天线对天基卫星的可见性，确定飞行器的天线和天基卫星，计算飞行器天基数传时段的程序角；
步骤四、根据步骤二中飞行器对地定向时段的程序角和步骤三中飞行器天基数传时段的程序角进行平滑。
上述多约束自主飞行器的程序角优化设计方法，所述步骤二中飞行器的轨道参数包括：真近点角f，近地点幅角ω，轨道倾角io，升交点赤经Ω；所述发射点参数包括：射向A0，发射点经度λ0，发射点纬度B0。
上述多约束自主飞行器的程序角优化设计方法，所述步骤二中本体坐标系相对于发射惯性坐标系的姿态转换矩阵
Figure BDA0001474593300000021
为：
Figure BDA0001474593300000022
式中
Figure BDA0001474593300000023
其中，rij(i＝1,2,3,j＝1,2,3)为姿态转换矩阵
Figure BDA0001474593300000024
的元素，i为姿态转换矩阵
Figure BDA0001474593300000025
的行序号，j为姿态转换矩阵
Figure BDA0001474593300000026
的列序号，
Figure BDA0001474593300000027
表示发射坐标系与发射惯性系的坐标转换矩阵，t为当前飞行时刻；
Figure BDA0001474593300000028
表示地心直角坐标系与发射坐标系的坐标转换矩阵，
Figure BDA0001474593300000029
表示地心第二轨道坐标系与地心直角坐标系的坐标转换矩阵，
Figure BDA00014745933000000210
表示地心第二轨道坐标系与轨道坐标系的坐标转换矩阵，
Figure BDA00014745933000000211
表示本体坐标系与轨道坐标系的坐标转换矩阵。
上述多约束自主飞行器的程序角优化设计方法，所述步骤二中飞行器对地定向时段的程序角为：
ψc＝-arcsinr31
Figure BDA0001474593300000031
Figure BDA0001474593300000032
式中
Figure BDA0001474593300000033
其中，rij(i＝1,2,3,j＝1,2,3)为姿态转换矩阵
Figure BDA0001474593300000034
的元素，i为姿态转换矩阵
Figure BDA0001474593300000035
的行序号，j为姿态转换矩阵
Figure BDA0001474593300000036
的列序号，
Figure BDA0001474593300000037
ψc、γc分别表征飞行器的俯仰程序角、偏航程序角和滚动程序角，t为当前飞行时刻。
上述多约束自主飞行器的程序角优化设计方法，对飞行器的天线和天基卫星分别设置序号，根据天基数传时段飞行器的天线对天基卫星的可见性，确定飞行器的天线和天基卫星的方法为：
(1)当上一周期所选定的飞行器的天线和上一周期所选定的天基卫星通信可见时，则选取上一周期所选定的飞行器的天线和上一周期所选定的天基卫星保持不变；否则转入步骤(2)；
(2)当上一周期所选定的飞行器的天线可见一颗以上的天基卫星时，则选取上一周期所选定的飞行器的天线和可见的天基卫星中序号最小的天基卫星通信；否则转入步骤(3)；
(3)当飞行器的天线可见上一周期所选定的天基卫星时，则选取可见天基卫星中序号最小的飞行器的天线和上一周期所选定的天基卫星通信；否则转入步骤(4)；
(4)在飞行器的天线和可见的天基卫星中，分别选定序号最小的飞行器的天线和序号最小的天基卫星通信。
上述多约束自主飞行器的程序角优化设计方法，所述步骤三中计算飞行器天基数传时段的程序角的方法为：
Figure BDA0001474593300000041
式中
α＝-arcsinrm,y
β＝-arctan(rm,x/rm,z)
其中，
Figure BDA0001474593300000042
ψc、γc分别表征飞行器的俯仰程序角、偏航程序角和滚动程序角，α、β分别为第一系数和第二系数，θ为天线夹角，rm,x、rm,y、rm,z为飞行器与天基卫星相对位置矢量的元素，m为飞行器的天线序号，π为圆周率。
上述多约束自主飞行器的程序角优化设计方法，利用线性规划方法迭代计算飞行器天基数传时段的俯仰程序角
Figure BDA0001474593300000043
的方法为：
以俯仰角为变量，建立优化函数J：
Figure BDA0001474593300000044
上述优化函数满足以下约束：
Figure BDA0001474593300000045
式中
α＝-arcsinrm,y
β＝-arctan(rm,x/rm,z)
其中，γc(t)、γc(t-1)分别表征t时刻飞行器的滚动程序角、t-1时刻飞行器的滚动程序角；ψc(t)、ψc(t-1)分别表征t时刻飞行器的偏航程序角、t-1时刻飞行器的偏航程序角；
Figure BDA0001474593300000046
分别表征t时刻飞行器的俯仰程序角、t-1时刻飞行器的俯仰程序角；不等式函数
Figure BDA0001474593300000047
表征热控约束，φ为预置值，θ为天线夹角，α、β分别为第一系数和第二系数，rm,x、rm,y、rm,z为飞行器与天基卫星相对位置矢量的元素，m为飞行器的天线序号，π为圆周率。
上述多约束自主飞行器的程序角优化设计方法，所述步骤四中对步骤二中飞行器对地定向时段的程序角和步骤三中飞行器天基数传时段的程序角进行平滑的方法为：
(1)确定对地定向时段终止时刻和天基数传时段起始时刻、天基数传时段的飞行器天线切换时刻为程序角突变时刻记为t0，设置平滑结束时刻记为tf；
(2)根据步骤(1)利用差分方法可到t0和tf时刻飞行器的程序角变化率
Figure BDA0001474593300000051
(3)根据步骤(2)利用三次多项式计算平滑时段的程序角。
上述多约束自主飞行器的程序角优化设计方法，所述步骤(8c)中的三次多项式为：
Figure BDA0001474593300000052
式中
Figure BDA0001474593300000053
其中，θ为飞行器的程序角，a1θ、a2θ、a3θ、a4θ均为多项式系数，
Figure BDA0001474593300000054
ψc、γc分别表征飞行器的俯仰程序角、偏航程序角和滚动程序角，θ0、θt分别为t0和tf时刻飞行器的程序角。
本发明相比于现有技术具有如下有益效果：
(1)本发明提出的程序角设计方案能够解决含有复合测控需求及多专业约束的程序角设计问题，适用于纯惯组导航配置下的长时间在轨飞行器程序控制方案；
(2)本发明提出的优化设计方法能够有效实现程序角的平滑变化，综合考虑控制、遥测控及热控多专业约束，同时能够确保姿态变化幅度最小，燃料消耗最省；
(3)本发明方法采用轨道系数据作为计算输入，降低程序角计算对飞行器发射时刻的依赖性，飞行时刻推迟与延后均不影响程序角计算结果，具备良好的适用性及鲁棒性；
(4)本发明方法采用三次多项式对理论设计结果中突变时刻对应的程序角进行平滑，平滑后的效果好，最大化地减小飞行器的姿态变化。
附图说明
图1为本发明的步骤流程图；
图2为本发明的对地定向段标准姿态示意图；
图3为本发明的天基数传段标准姿态示意图；
图4为本发明的本体坐标系至发射惯性坐标系转换过程流程图；
图5为本发明的过渡坐标系示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明的实施方式作进一步详细描述。
根据飞行时序、飞行器的轨道信息、天基卫星轨道信息及可见性信息，针对含有天地基测控复合需求的飞行任务下的两个飞行段(对地定向段和天基数传段)，综合考虑控制、遥测控、热控等系统的多专业约束，设计了发射惯性系下的飞行程序角，并进一步基于三次多项式方法完成了程序角的平滑，所设计的全程程序角不仅能够实现任务所需的复杂姿态序列，而且能够确保程序角变化幅度较小，利于姿态的快速可达及燃料最省。
图1为本发明的步骤流程图。步骤101、设定对地定向时段起始时刻为T0，设定对地定向时段终止时刻和天基数传时段起始时刻均为T1，设定天基数传时段终止时刻为T2。首先，引入标准下述坐标系：
(101a)本体坐标系O1-X1Y1Z1：坐标原点O1位于飞行器质心，O1X1轴与飞行器结构纵轴平行，O1Y1轴指向第III象限线，O1Z1指向第IV象限线，并与O1X1轴、O1Y1轴符合右手定则。
(101b)发射坐标系OA-XAYAZA：坐标原点OA与发射点固连，OAXA轴在发射点水平面内，指向发射架瞄准方向，OAYA轴垂直于发射点水平面、指向上方。OAZA轴与OAXA轴和OAYA轴成右手直角坐标系。OAXA轴与发射点所在子午线正北方的夹角为发射方位角A0，也称为射向。OAYA轴与赤道平面的夹角为天文纬度B0，而OAYA轴所在的天文子午面与起始天文子午面之间的二面角称为发射点天文经度λ0。
(101c)发射惯性坐标系O-XYZ：在发射瞬间原点O与发射点OA重合，各坐标轴与发射坐标系的相应各轴重合。飞行器起飞后，此坐标系在惯性空间保持不动。
(101d)轨道坐标系O1-xyz：假设飞行器轨道为圆轨道，轨道坐标系原点O1与飞行器质心固连并随其沿轨道运动，O1z轴与其地心矢量重合，并指向地心方向为正，O1x轴在飞行器轨道面内垂直于O1z轴并指向运动方向为正，O1y轴由右手规则确定。
(101e)地心第二轨道坐标系Oe-X2Y2Z2：该坐标系原点在地心Oe。OeX2轴在飞行器轨道平面内，指向近地点方向。OeZ2轴指向卫星轨道平面正法向方向。OeZ2轴的方向是使得该坐标系成为右手直角坐标系的方向。该坐标系为静参考系。
随后，根据飞行器飞行时序，明确飞行器在其与运载器分离后，以分离时间为零时刻计算，在0～T1时间内，飞行器需要实现对地测控通信；在T1～T2时间内，飞行器需要实现天基数传，对地定向时段终止时刻和天基数传时段起始时刻均为T1，T1属于飞行器程序角平滑时段。根据上述天地基测控复合需求，飞行器在轨飞行全程需要实现下述标准姿态：
(1)飞行器分离后0～T1时间段内，记为对地定向段，飞行器采取对地三轴稳定姿态，如图2所示，飞行器O1X1轴正向与速度方向重合，O1Y1轴位于O1X1轴与地心径构成的平面内，与O1X1轴垂直，并指向天顶方向，O1Z1轴与O1X1轴和O1Y1轴构成直角坐标系。
(2)飞行器分离后T1～T2时间段内，记为天基数传段，飞行器采取指向天基卫星稳定姿态，即，飞行器在天基数传段飞行时，始终有一部天基数传天线对准一颗天基卫星，如图3所示。需要说明的是，本实施例飞行器配置有两部天基数传天线，天线夹角为θ，第一天线指向向量br1和第二天线指向向量br2在飞行器本体坐标系下分别为：
Figure BDA0001474593300000081
可使用的天基卫星设置为两颗：天基卫星1和天基卫星2，运行于GEO轨道，定位经度分别为δ1(经度)和δ2(经度)。
步骤102、根据飞行器的轨道参数和程序角，基于本体坐标系相对于发射惯性坐标系的姿态转换矩阵，计算飞行器对地定向时段的程序角。
对地定向段程序角设计，如图4，根据飞行器轨道参数与发射点参数，确定0～T1时间段内本体坐标系相对于发射惯性系的姿态转换矩阵序列：
(102a)根据对地定向段的标准姿态，可以得到0～T1时间段内飞行器相对于轨道坐标系下的标准飞行姿态序列，并得到本体坐标系与轨道坐标系的坐标转换矩阵
Figure BDA0001474593300000082
Figure BDA0001474593300000083
(102b)根据轨道坐标系与地心第二轨道坐标系的定义，确定地心第二轨道坐标系与轨道坐标系的坐标转换矩阵
Figure BDA0001474593300000084
Figure BDA0001474593300000085
式中，f为飞行器真近点角。
(102c)根据地心第二轨道坐标系与地心直角坐标系的定义，确定地心第二轨道坐标系与地心直角坐标系的坐标转换矩阵
Figure BDA0001474593300000086
Figure BDA0001474593300000091
式中，ω近地点幅角，io为轨道倾角，Ω升交点赤经。
(102d)根据地心直角坐标系与发射坐标系的定义，利用射向A0，发射点经度λ0，发射点纬度B0，确定地心直角坐标系与发射坐标系的坐标转换矩阵
Figure BDA0001474593300000092
Figure BDA0001474593300000093
(102e)根据发射坐标系与发射惯性坐标系的定义，利用地球自转角速度ωe，射向A0，发射点纬度B0，t为当前飞行时刻，确定发射坐标系与发射惯性系的坐标转换矩阵
Figure BDA0001474593300000094
Figure BDA0001474593300000095
式中
Figure BDA0001474593300000096
aij(i＝1,2,3,j＝1,2,3)为发射坐标系与发射惯性系的坐标转换矩阵
Figure BDA0001474593300000097
的元素。
(102f)基于上述推导，联立式(1)-(6)，能够得到本体坐标系至发射惯性坐标系的姿态转换矩阵
Figure BDA0001474593300000098
为：
Figure BDA0001474593300000101
随后，基于飞行器三通道程序角
Figure BDA0001474593300000102
ψc、γc分别表征飞行器的俯仰程序角、偏航程序角和滚动程序角，本体坐标系相对于发射惯性坐标系的姿态转换矩阵
Figure BDA0001474593300000103
列写如下：
Figure BDA0001474593300000104
最后，联立式(7)和(8)，能够得到对地定向段程序角为：
Figure BDA0001474593300000105
rij(i＝1,2,3,j＝1,2,3)为姿态转换矩阵
Figure BDA0001474593300000106
的元素，i为姿态转换矩阵
Figure BDA0001474593300000107
的行序号，j为姿态转换矩阵
Figure BDA0001474593300000108
的列序号，
Figure BDA0001474593300000109
表示发射坐标系与发射惯性系的坐标转换矩阵；
Figure BDA00014745933000001010
表示地心直角坐标系与发射坐标系的坐标转换矩阵，
Figure BDA00014745933000001011
表示地心第二轨道坐标系与地心直角坐标系的坐标转换矩阵，
Figure BDA00014745933000001012
表示地心第二轨道坐标系与轨道坐标系的坐标转换矩阵，
Figure BDA00014745933000001013
表示本体坐标系与轨道坐标系的坐标转换矩阵。
步骤103、根据天基数传时段飞行器的天线对天基卫星的可见性，确定飞行器的天线和天基卫星，计算飞行器天基数传时段的程序角；当飞行器的天线进行切换时，切换时刻属于飞行器程序角平滑时段。
对飞行器的天线和天基卫星分别设置序号，根据天基数传时段飞行器的天线对天基卫星的可见性，确定飞行器的天线和天基卫星的方法为：
(103a)当上一周期所选定的飞行器的天线和上一周期所选定的天基卫星通信可见时，则选取上一周期所选定的飞行器的天线和上一周期所选定的天基卫星保持不变；否则转入步骤(103b)；
(103b)当上一周期所选定的飞行器的天线可见一颗以上的天基卫星时，则选取上一周期所选定的飞行器的天线和可见的天基卫星中序号最小的天基卫星通信；否则转入步骤(103c)；
(103c)当飞行器的天线可见上一周期所选定的天基卫星时，则选取可见天基卫星中序号最小的飞行器的天线和上一周期所选定的天基卫星通信；否则转入步骤(103d)；
(103d)在飞行器的天线和可见的天基卫星中，分别选定序号最小的飞行器的天线和序号最小的天基卫星通信。
本实施例为确定飞行器对两颗天基卫星的可见性情况，不失一般性，考虑一种复杂情况如下：
(1)飞行器分离后T1～T11时间段内，仅天基卫星1对飞行器可见；
(2)飞行器分离后T11～T12时间段内，天基卫星1和天基卫星2对飞行器均可见；
(3)飞行器分离后T12～T13时间段内，仅天基卫星2对飞行器均可见；
(4)飞行器分离后T13～T14时间段内，天基卫星1和天基卫星2对飞行器均可见；
(5)飞行器分离后T14～T2时间段内，仅天基卫星1对飞行器均可见。
基于上述可见性情况，确定下述原则便于后续天线指向策略制定：
(1)当天基卫星1和天基卫星2均对飞行器可见时，为避免大幅姿态机动，不做天线切换，仍沿用前一时刻的所选天线以及天线指向的天基卫星；
(2)仅天基卫星1对飞行器可见时，选用天基卫星1进行程序角计算；
(3)仅天基卫星2对飞行器可见时，选用天基卫星2进行程序角计算。
基于上述原则，考虑到遥测控系统对天基数传天线的链路连续性要求，确定天基数传段切换时刻如下：
Figure BDA0001474593300000111
同时，确定天基数传段天基卫星使用策略如下：
(1)飞行器分离后T1～Ta时间段内，使用天基卫星1；
(2)飞行器分离后Ta～Tb时间段内，使用天基卫星2；
(3)飞行器分离后Tb～T2时间段内，使用天基卫星1；
根据天基数传段标准姿态要求，在T1～T2时间段内，获取两个天基卫星在轨道坐标系下的位置矢量序列orZJ1、orZJ2以及飞行器在轨道坐标系下的位置矢量序列or，利用式(3)-(6)，建立发射惯性坐标下的期望相对位置rm如下：
Figure BDA0001474593300000121
式中，brm表示第m部天线在本体坐标系下的指向矢量。上式将作为求解天基数传段程序角的理论基础。
为求解程序角
Figure BDA0001474593300000122
设置过渡坐标系，如图5所示，可通过两次坐标系转换将矢量brm转换至期望的相对位置矢量，第一次绕X轴顺时针旋转角度α，第二次绕Y轴旋转角度β，α、β可通过下式求取：
Figure BDA0001474593300000123
rm,x、rm,y、rm,z为飞行器与天基卫星相对位置矢量的元素。
程序角可通过下式确定：
Figure BDA0001474593300000124
为确定俯仰角
Figure BDA0001474593300000125
以
Figure BDA0001474593300000126
为变量，以姿态变化最小为优化指标，建立优化问题：以俯仰角为变量，建立优化函数J：
Figure BDA0001474593300000127
上述优化函数满足以下约束
Figure BDA0001474593300000131
式中，γc(t)、γc(t-1)分别表征t时刻飞行器的滚动程序角、t-1时刻飞行器的滚动程序角；ψc(t)、ψc(t-1)分别表征t时刻飞行器的偏航程序角、t-1时刻飞行器的偏航程序角；
Figure BDA0001474593300000132
分别表征t时刻飞行器的俯仰程序角、t-1时刻飞行器的俯仰程序角；不等式函数
Figure BDA0001474593300000133
表征热控约束，φ为预置值，θ为天线夹角，α、β分别为第一系数和第二系数，rm,x、rm,y、rm,z为飞行器与天基卫星相对位置矢量的元素，m为飞行器的天线序号，π为圆周率。利用线性规划方法迭代求解上述优化问题，解算得到天基数传段程序角及天线使用策略。
步骤104、根据步骤102中飞行器对地定向时段的程序角和步骤103中飞行器天基数传时段的程序角进行平滑。
所述飞行器程序角平滑时段包括对地定向时段和飞行器天基数传时段的切换时刻T1，当飞行器的天线进行切的切换时刻。上述时刻因存在飞行器姿态变化会引起飞行器的程序角变化，因此需要对上述时刻及后续的一段时间的程序角进行平滑。即飞行器程序角平滑时段为T1时刻及T1时刻之后的一段时间、上述切换时刻及切换时刻之后的一段时间。T1时刻和切换时刻都是突变时刻。
对飞行器程序角平滑时段的程序角进行平滑的方法为：
(1)确定对地定向时段终止时刻和天基数传时段起始时刻、天基数传时段的飞行器天线切换时刻为程序角突变时刻记为t0，设置平滑结束时刻记为tf；
(2)根据步骤(1)利用差分方法可到t0和tf时刻飞行器的程序角变化率
Figure BDA0001474593300000134
(3)根据步骤(2)利用三次多项式计算平滑时段的程序角。
为得到全程飞行程序角，采用三次多项式插值方法对时间点T1,Ta,Tb处程序角序列发生突变的情况进行平滑处理，过程如下：
(1)设定程序角取值突变时刻为t0∈{T1,Ta,Tb}，相对应的平滑终止时刻为tf∈{Tf1,Tfa,Tfb}，因此，平滑时间为T＝tf-t0。根据解算得到程序角序列可知，在t0和t时刻程序角θ(t0)、θ(tf)为：
Figure BDA0001474593300000141
(2)利用差分可以得到在t0和tf时刻程序角变化率
Figure BDA0001474593300000142
随后，构造下述三次多项式形成平滑段的程序角：
Figure BDA0001474593300000143
其中，多项式系数
Figure BDA0001474593300000144
可由下式确定：
Figure BDA0001474593300000145
θ为飞行器的程序角，a1θ、a2θ、a3θ、a4θ均为多项式系数，
Figure BDA0001474593300000146
ψc、γc分别表征飞行器的俯仰程序角、偏航程序角和滚动程序角，θ0、θt分别为t0和tf时刻飞行器的程序角。
(3)根据式(17)，求解多项式系数
Figure BDA0001474593300000147
并根据式(16)，确定平滑段的程序角。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

Claims (8)

1.一种多约束自主飞行器的程序角优化设计方法，其特征在于：包括如下步骤：
步骤一、设定对地定向时段起始时刻为T0，设定对地定向时段终止时刻和天基数传时段起始时刻均为T1，设定天基数传时段终止时刻为T2；
步骤二、根据飞行器的轨道参数和发射点参数，基于本体坐标系相对于发射惯性坐标系的姿态转换矩阵，计算飞行器对地定向时段的程序角；
步骤三、根据天基数传时段飞行器的天线对天基卫星的可见性，确定飞行器的天线和天基卫星，计算飞行器天基数传时段的程序角；
步骤四、对步骤二中飞行器对地定向时段的程序角和步骤三中飞行器天基数传时段的程序角进行平滑；
所述步骤二中飞行器的轨道参数包括：真近点角f，近地点幅角ω，轨道倾角io，升交点赤经Ω；所述发射点参数包括：射向A0，发射点经度λ0，发射点纬度B0。
2.根据权利要求1所述的一种多约束自主飞行器的程序角优化设计方法，其特征在于：所述步骤二中本体坐标系相对于发射惯性坐标系的姿态转换矩阵
Figure FDA0002268466440000011
为：
Figure FDA0002268466440000012
式中
Figure FDA0002268466440000013
其中，rij(i＝1,2,3,j＝1,2,3)为姿态转换矩阵
Figure FDA0002268466440000014
的元素，i为姿态转换矩阵
Figure FDA0002268466440000015
的行序号，j为姿态转换矩阵
Figure FDA0002268466440000016
的列序号，
Figure FDA0002268466440000017
表示发射坐标系与发射惯性系的坐标转换矩阵，t为当前飞行时刻；
Figure FDA0002268466440000021
表示地心直角坐标系与发射坐标系的坐标转换矩阵，
Figure FDA0002268466440000022
表示地心第二轨道坐标系与地心直角坐标系的坐标转换矩阵，
Figure FDA0002268466440000023
表示地心第二轨道坐标系与轨道坐标系的坐标转换矩阵，
Figure FDA0002268466440000024
表示本体坐标系与轨道坐标系的坐标转换矩阵。
3.根据权利要求1所述的一种多约束自主飞行器的程序角优化设计方法，其特征在于：所述步骤二中飞行器对地定向时段的程序角为：
ψc＝-arcsinr31
Figure FDA0002268466440000025
Figure FDA0002268466440000026
式中
Figure FDA0002268466440000027
其中，rij(i＝1,2,3,j＝1,2,3)为姿态转换矩阵
Figure FDA0002268466440000028
的元素，i为姿态转换矩阵
Figure FDA0002268466440000029
的行序号，j为姿态转换矩阵
Figure FDA00022684664400000210
的列序号，
Figure FDA00022684664400000211
ψc、γc分别表征飞行器的俯仰程序角、偏航程序角和滚动程序角，t为当前飞行时刻。
4.根据权利要求1所述的一种多约束自主飞行器的程序角优化设计方法，其特征在于：对飞行器的天线和天基卫星分别设置序号，根据天基数传时段飞行器的天线对天基卫星的可见性，确定飞行器的天线和天基卫星的方法为：
(5a)当上一周期所选定的飞行器的天线和上一周期所选定的天基卫星通信可见时，则选取上一周期所选定的飞行器的天线和上一周期所选定的天基卫星保持不变；否则转入步骤(5b)；
(5b)当上一周期所选定的飞行器的天线可见一颗以上的天基卫星时，则选取上一周期所选定的飞行器的天线和可见的天基卫星中序号最小的天基卫星通信；否则转入步骤(5c)；
(5c)当飞行器的天线可见上一周期所选定的天基卫星时，则选取可见天基卫星中序号最小的飞行器的天线和上一周期所选定的天基卫星通信；否则转入步骤(5d)；
(5d)在飞行器的天线和可见的天基卫星中，分别选定序号最小的飞行器的天线和序号最小的天基卫星通信。
5.根据权利要求1所述的一种多约束自主飞行器的程序角优化设计方法，其特征在于：所述步骤三中计算飞行器天基数传时段的程序角的方法为：
Figure FDA0002268466440000031
式中
α＝-arcsin rm,y
β＝-arctan(rm,x/rm,z)
其中，
Figure FDA0002268466440000032
ψc、γc分别表征飞行器的俯仰程序角、偏航程序角和滚动程序角，α、β分别为第一系数和第二系数，θ为天线夹角，rm,x、rm,y、rm,z为飞行器与天基卫星相对位置矢量的元素，m为飞行器的天线序号，π为圆周率。
6.根据权利要求5所述的一种多约束自主飞行器的程序角优化设计方法，其特征在于：利用线性规划方法迭代计算飞行器天基数传时段的俯仰程序角
Figure FDA0002268466440000033
的方法为：
以俯仰角为变量，建立优化函数J：
Figure FDA0002268466440000034
上述优化函数满足以下约束：
Figure FDA0002268466440000035
式中
α＝-arcsin rm,y
β＝-arctan(rm,x/rm,z)
其中，γc(t)、γc(t-1)分别表征t时刻飞行器的滚动程序角、t-1时刻飞行器的滚动程序角；ψc(t)、ψc(t-1)分别表征t时刻飞行器的偏航程序角、t-1时刻飞行器的偏航程序角；
Figure FDA0002268466440000041
分别表征t时刻飞行器的俯仰程序角、t-1时刻飞行器的俯仰程序角；不等式函数
Figure FDA0002268466440000042
表征热控约束，φ为预置值，θ为天线夹角，α、β分别为第一系数和第二系数，rm,x、rm,y、rm,z为飞行器与天基卫星相对位置矢量的元素，m为飞行器的天线序号，π为圆周率。
7.根据权利要求1～6之一所述的一种多约束自主飞行器的程序角优化设计方法，其特征在于：所述步骤四中对步骤二中飞行器对地定向时段的程序角和步骤三中飞行器天基数传时段的程序角进行平滑的方法为：
(8a)确定对地定向时段终止时刻和天基数传时段起始时刻、天基数传时段的飞行器天线切换时刻为程序角突变时刻记为t0，设置平滑结束时刻记为tf；
(8b)根据步骤(8a)利用差分方法得到t0和tf时刻飞行器的程序角变化率
Figure FDA0002268466440000043
(8c)根据步骤(8b)利用三次多项式计算平滑时段的程序角。
8.根据权利要求7所述的一种多约束自主飞行器的程序角优化设计方法，其特征在于：所述步骤(8c)中的三次多项式为：
θ＝a1θ(tf-t0)3+a2θ(tf-t0)2+a3θ(tf-t0)+a4θ,
Figure FDA0002268466440000044
式中
Figure FDA0002268466440000045
其中，θ为飞行器的程序角，a1θ、a2θ、a3θ、a4θ均为多项式系数，
Figure FDA0002268466440000046
ψc、γc分别表征飞行器的俯仰程序角、偏航程序角和滚动程序角，θ0、θf分别为t0和tf时刻飞行器的程序角。
CN201711157130.6A 2017-11-20 2017-11-20 一种多约束自主飞行器的程序角优化设计方法 Active CN107966149B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711157130.6A CN107966149B (zh) 2017-11-20 2017-11-20 一种多约束自主飞行器的程序角优化设计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711157130.6A CN107966149B (zh) 2017-11-20 2017-11-20 一种多约束自主飞行器的程序角优化设计方法

Publications (2)

Publication Number Publication Date
CN107966149A CN107966149A (zh) 2018-04-27
CN107966149B true CN107966149B (zh) 2020-04-10

Family

ID=62001280

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711157130.6A Active CN107966149B (zh) 2017-11-20 2017-11-20 一种多约束自主飞行器的程序角优化设计方法

Country Status (1)

Country Link
CN (1) CN107966149B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109617574A (zh) * 2018-11-19 2019-04-12 上海无线电设备研究所 一种高动态载体下的多天线通信方法
CN110989337B (zh) * 2019-12-10 2020-12-01 北京理工大学 考虑舵机失效及气动扰动的飞行器旋转控制系统及方法
CN112173173B (zh) * 2020-09-14 2022-03-04 北京空间飞行器总体设计部 一种面向成像卫星的目标可见弧段确定方法
CN114036780B (zh) * 2021-12-06 2024-09-10 航天科工火箭技术有限公司 一种受天基测控约束的火箭姿态角设计方法
CN115294754B (zh) * 2022-10-09 2023-03-03 北京星河动力装备科技有限公司 火箭遥测方法、装置、运载火箭、电子设备和存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103925917A (zh) * 2014-05-05 2014-07-16 上海新跃仪表厂 一种运载火箭姿态角速率信号的测量系统及方法
CN106444430A (zh) * 2016-11-09 2017-02-22 上海宇航系统工程研究所 运载火箭一子级再入控制系统及方法、仿真系统及方法
CN106774268A (zh) * 2016-12-29 2017-05-31 中国运载火箭技术研究院 一种空间飞行器故障处理方法
CN106908085A (zh) * 2017-04-10 2017-06-30 北京航天自动控制研究所 一种基于地球自转补偿的星光测量指向控制方法
CN107063244A (zh) * 2017-04-14 2017-08-18 北京航天自动控制研究所 一种飞行器飞行过程模拟方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103925917A (zh) * 2014-05-05 2014-07-16 上海新跃仪表厂 一种运载火箭姿态角速率信号的测量系统及方法
CN106444430A (zh) * 2016-11-09 2017-02-22 上海宇航系统工程研究所 运载火箭一子级再入控制系统及方法、仿真系统及方法
CN106774268A (zh) * 2016-12-29 2017-05-31 中国运载火箭技术研究院 一种空间飞行器故障处理方法
CN106908085A (zh) * 2017-04-10 2017-06-30 北京航天自动控制研究所 一种基于地球自转补偿的星光测量指向控制方法
CN107063244A (zh) * 2017-04-14 2017-08-18 北京航天自动控制研究所 一种飞行器飞行过程模拟方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
一种超音速火箭靶弹程序角优化方法研究;沈冠军 等;《兵工学报》;20150430;第36卷(第4期);第644-652页 *
基于组合粒子群算法的运载火箭弹道优化设计;张柳 等;《导弹与航天运载技术》;20161231(第6期);第1-5页 *

Also Published As

Publication number Publication date
CN107966149A (zh) 2018-04-27

Similar Documents

Publication Publication Date Title
CN107966149B (zh) 一种多约束自主飞行器的程序角优化设计方法
Wang et al. Integrated relative position and attitude control for spacecraft rendezvous with ISS and finite-time convergence
WO2017113567A1 (zh) 火星探测器自主导航方法
CN111897357B (zh) 一种卫星对地扫描的姿态跟踪控制方法
CN109948852B (zh) 一种敏捷卫星的同轨多点目标成像任务规划方法
CN107450582B (zh) 一种基于星上实时规划的相控阵数传引导控制方法
CN109911249B (zh) 低推重比飞行器的星际转移有限推力入轨迭代制导方法
CN111307139A (zh) 一种基于偏振/天文信息融合的航向与姿态确定方法
US10464694B1 (en) Asymmetric thruster gimbal configuration
JP4097086B2 (ja) 複数の宇宙機を異なる軌道に投入する方法
Ran et al. Attitude control system design and on-orbit performance analysis of nano-satellite—“Tian Tuo 1”
CN112629543A (zh) 一种大椭圆轨道及小倾角圆轨道的轨道规划方法
CN112061424B (zh) 一种基于融合目标姿态的机动过程能源角动态跟踪方法
CN112783183A (zh) 一种太阳同步圆回归轨道的轨道规划方法
Somov et al. Guidance and precise motion control of free-flying robots and land-survey mini-satellites
CN114993305A (zh) 一种基于发射坐标系的制导炮弹组合导航方法
Fujita et al. Attitude maneuvering sequence design of high-precision ground target tracking control for multispectral Earth observations
Watanabe et al. Initial In-Orbit Operation Result of Microsatellite HIBARI: Attitude Control by Driving Solar Array Paddles
CN113968362B (zh) 一种卫星在轨自主三轴快速机动控制方法
JP2004210032A (ja) 編隊飛行衛星
Somov et al. Attitude & orbit digital and pulse-width control of large-scale communication spacecraft
Wie et al. Attitude and orbit control systems
CN109460051B (zh) 轨道返回再入式飞行器对星通信姿态控制方法
Somov et al. Guidance and control of a space robot at additional launching and approaching a communication geostationary satellite
Mohammed et al. Magnetorquer control for orbital manoeuvre of low earth orbit microsatellite

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant