CN106527471B - 姿态机动过程中抑制挠性振动的轨迹规划方法和系统 - Google Patents
姿态机动过程中抑制挠性振动的轨迹规划方法和系统 Download PDFInfo
- Publication number
- CN106527471B CN106527471B CN201710060495.0A CN201710060495A CN106527471B CN 106527471 B CN106527471 B CN 106527471B CN 201710060495 A CN201710060495 A CN 201710060495A CN 106527471 B CN106527471 B CN 106527471B
- Authority
- CN
- China
- Prior art keywords
- trigonometric function
- angular acceleration
- acceleration
- angular
- track
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000013439 planning Methods 0.000 title claims abstract description 17
- 230000001133 acceleration Effects 0.000 claims abstract description 107
- 230000010355 oscillation Effects 0.000 claims abstract description 9
- 230000002401 inhibitory effect Effects 0.000 claims description 11
- 238000013440 design planning Methods 0.000 abstract description 2
- 230000005764 inhibitory process Effects 0.000 abstract description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开一种用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法,该方法包含:计算卫星机动过程中最大角加速度和最大角速度;确定角加速度三角函数阶次与残余振动的关系;确定角加速度三角函数阶次与加速时间系数的关系;确定角加速度三角函数阶次;对角加速度进行积分得到角速度和角度轨迹。本发明通过已知的执行机构最大力矩和最大角动量,计算确定三角函数阶次与振动残余量和加速时间系数的关系,通过迭代进而确定星体机动过程中三角函数角加速度指令的阶次,再对角加速度指令进行积分得到角速度和角度指令,通过对角加速度轨迹进行以挠性附件振动残余量为约束的设计规划,可以有效的抑制挠性附件的振动。
Description
技术领域
本发明涉及卫星姿态控制技术,具体涉及一种用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法和系统。
背景技术
随着卫星功能增强,星上携带的挠性附件面积尺寸越来越大,带来的影响是附件的挠性基频变得更低,耦合作用变大。随着卫星对平台姿态机动能力需求提高,星上配置大力矩的执行结构,如控制力矩陀螺群。这种大力矩执行机构输出力矩大,在姿态机动过程中容易激起挠性附件的振动,也影响姿态机动快速性。
发明内容
本发明提供一种用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法和系统,通保证振动残余量在指标要求内,实现姿态机动过程中挠性抑制。
为实现上述目的,本发明提供一种用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法,其特点是,该方法包含:
计算卫星机动过程中最大角加速度和最大角速度;
确定角加速度三角函数阶次与残余振动的关系;
确定角加速度三角函数阶次与加速时间系数的关系;
确定角加速度三角函数阶次;
对角加速度进行积分得到角速度和角度轨迹。
上述计算卫星机动过程中最大角加速度amax和最大角速度ωmax包含:
根据式(1)得到最大角加速度amax:
式(1)中,Tmax为执行机构的最大输出力矩,I为卫星姿态机动轴方向的转动惯量;
根据式(2)得到最大角速度ωmax:
式(2)中,Hmax为最大输出角动量,I为卫星姿态机动轴方向的转动惯量。
上述确定角加速度三角函数阶次与残余振动的关系包含:
角加速度轨迹为m为三角函数阶次,amax为卫星机动过程中最大角加速度,ω表示加速度信号频率,t表示时间;
卫星挠性附件的基频记为ωc,姿态机动过程中挠性附件振动的残余量为υm;
记确定各阶加速度轨迹作用后的振动残余量υm与m和n的关系如式(3):
上述确定角加速度三角函数阶次与加速时间系数的关系包含:
m阶三角函数的加速时间系数记为km,其关系如式(4):
式(4)中,m为三角函数阶次,ω表示加速度信号频率,ωc为卫星挠性附件的基频。
上述确定角加速度三角函数阶次包含:
根据式(5)计算加速轨迹信号的频率与卫星基频的比例:
式(5)中,amax为卫星机动过程中最大角加速度,ωmax为最大角速度;
将不同阶次m带入式(4)计算得到对应的加速时间系数km,将km带入式(5)计算得到对应的n,再将n带入式(3)计算对应的振动残余量υm,直到找到满足残余量指标的阶次m,从而最终确定角加速度轨迹的阶次m。
上述对角加速度进行积分得到角速度和角度轨迹包含:
将角加速度轨迹进行一次积分后,得到角速度ωm的三角函数轨迹,进行二次积分得到角度的三角函数轨迹,如式(6):
其中,m为三角函数阶次,amax为卫星机动过程中最大角加速度,ω表示加速度信号频率,t表示时间。
一种上述用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法的规划系统,其特点是,该系统包含:
角加速度三角函数阶次获取模块,其计算卫星机动过程中最大角加速度和最大角速度;确定角加速度三角函数阶次与残余振动和加速时间系数的关系;进而确定角加速度三角函数阶次;
角速度和角度轨迹获取模块,其连接角加速度三角函数阶次获取模块的输出,结合确定的角加速度轨迹的阶次,对角加速度进行积分得到角速度和角度轨迹。
本发明一种用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法和现有技术相比,其优点在于,本发明以姿态机动过程中挠性附件振动残余量为设计指标之一,通过已知的执行机构最大力矩和最大角动量、卫星机动方向转动惯量和挠性附件基频等信息,计算确定三角函数阶次与振动残余量和加速时间系数的关系,通过迭代进而确定星体机动过程中三角函数角加速度指令的阶次,再对角加速度指令进行积分得到角速度和角度指令,通过对角加速度轨迹进行以挠性附件振动残余量为约束的设计规划,可以有效的抑制挠性附件的振动。
附图说明
图1为本发明用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法的流程图。
具体实施方式
以下结合附图,进一步说明本发明的具体实施例。
如图1所示,公开了一种用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法的实施例,该方法具体包含以下步骤:
S1、计算卫星机动过程中最大角加速度amax和最大角速度ωmax。
根据式(1)得到最大角加速度amax:
式(1)中,Tmax为执行机构的最大输出力矩,I为卫星姿态机动轴方向的转动惯量;
根据式(2)得到最大角速度ωmax:
式(2)中,Hmax为最大输出角动量,I为卫星姿态机动轴方向的转动惯量。
S2、确定角加速度三角函数阶次与残余振动的关系。
角加速度轨迹为m为三角函数阶次,amax为卫星机动过程中最大角加速度,ω表示加速度信号频率,t表示时间。
卫星挠性附件的基频记为ωc,姿态机动过程中挠性附件振动的残余量为υm;记确定各阶加速度轨迹作用后的振动残余量υm与m和n的关系如式(3):
S3、确定角加速度三角函数阶次与加速时间系数的关系。
m阶三角函数的加速时间系数记为km,其关系如式(4):
式(4)中,m为三角函数阶次,ω表示加速度信号频率,ωc为卫星挠性附件的基频。
S4、确定角加速度三角函数阶次。
根据式(5)计算加速轨迹信号的频率与卫星基频的比例:
式(5)中,amax为卫星机动过程中最大角加速度,ωmax为最大角速度;
将不同阶次m带入式(4)计算得到对应的加速时间系数km,将km带入式(5)计算得到对应的n,再将n带入式(3)计算对应的振动残余量υm,直到找到满足残余量指标的阶次m,从而最终确定角加速度轨迹的阶次m。
S5、对角加速度进行积分得到角速度和角度轨迹。
将角加速度轨迹进行一次积分后,得到角速度ωm的三角函数轨迹,进行二次积分得到角度的三角函数轨迹,如式(6):
其中,m为三角函数阶次,amax为卫星机动过程中最大角加速度,ω表示加速度信号频率,t表示时间。
本发明还公开了一种上述用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法的规划系统的实施例,该系统包含:角加速度三角函数阶次获取模块和角速度和角度轨迹获取模块。
角加速度三角函数阶次获取模块用于计算卫星机动过程中最大角加速度和最大角速度;确定角加速度三角函数阶次与残余振动和加速时间系数的关系;进而确定角加速度三角函数阶次;
角速度和角度轨迹获取模块连接角加速度三角函数阶次获取模块的输出,用于结合确定的角加速度轨迹的阶次,对角加速度进行积分得到角速度和角度轨迹。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (4)
1.一种用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法,其特征在于,该方法包含:
计算卫星机动过程中最大角加速度和最大角速度;
确定角加速度三角函数阶次与残余振动的关系;
确定角加速度三角函数阶次与加速时间系数的关系;
确定角加速度三角函数阶次;
对角加速度进行积分得到角速度和角度轨迹;
所述确定角加速度三角函数阶次与残余振动的关系包含:
角加速度轨迹为m为三角函数阶次,amax为卫星机动过程中最大角加速度,ω表示加速度信号频率,t表示时间;
卫星挠性附件的基频记为ωc,姿态机动过程中挠性附件振动的残余量为υm;
记确定各阶加速度轨迹作用后的振动残余量υm与m和n的关系如式(3):
所述确定角加速度三角函数阶次与加速时间系数的关系包含:
m阶三角函数的加速时间系数记为km,其关系如式(4):
式(4)中,m为三角函数阶次,ω表示加速度信号频率,ωc为卫星挠性附件的基频;
所述确定角加速度三角函数阶次包含:
根据式(5)计算加速轨迹信号的频率与卫星基频的比例:
式(5)中,amax为卫星机动过程中最大角加速度,ωmax为最大角速度;
将不同阶次m带入式(4)计算得到对应的加速时间系数km,将km带入式(5)计算得到对应的n,再将n带入式(3)计算对应的振动残余量υm,直到找到满足残余量指标的阶次m,从而最终确定角加速度轨迹的阶次m。
2.如权利要求1所述的用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法,其特征在于,所述计算卫星机动过程中最大角加速度amax和最大角速度ωmax包含:
根据式(1)得到最大角加速度amax:
式(1)中,Tmax为执行机构的最大输出力矩,I为卫星姿态机动轴方向的转动惯量;
根据式(2)得到最大角速度ωmax:
式(2)中,Hmax为最大输出角动量,I为卫星姿态机动轴方向的转动惯量。
3.如权利要求1所述的用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法,其特征在于,所述对角加速度进行积分得到角速度和角度轨迹包含:
将角加速度轨迹进行一次积分后,得到角速度ωm的三角函数轨迹,进行二次积分得到角度的三角函数轨迹,如式(6):
其中,m为三角函数阶次,amax为卫星机动过程中最大角加速度,ω表示加速度信号频率,t表示时间。
4.一种如权利要求1至3中任意一项权利要求所述用于姿态机动过程中抑制挠性振动的三角函数轨迹规划方法的规划系统,其特征在于,该系统包含:
角加速度三角函数阶次获取模块,其计算卫星机动过程中最大角加速度和最大角速度;确定角加速度三角函数阶次与残余振动和加速时间系数的关系;进而确定角加速度三角函数阶次;
角速度和角度轨迹获取模块,其连接角加速度三角函数阶次获取模块的输出,结合确定的角加速度轨迹的阶次,对角加速度进行积分得到角速度和角度轨迹。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710060495.0A CN106527471B (zh) | 2017-01-25 | 2017-01-25 | 姿态机动过程中抑制挠性振动的轨迹规划方法和系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710060495.0A CN106527471B (zh) | 2017-01-25 | 2017-01-25 | 姿态机动过程中抑制挠性振动的轨迹规划方法和系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106527471A CN106527471A (zh) | 2017-03-22 |
CN106527471B true CN106527471B (zh) | 2019-10-01 |
Family
ID=58335955
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710060495.0A Active CN106527471B (zh) | 2017-01-25 | 2017-01-25 | 姿态机动过程中抑制挠性振动的轨迹规划方法和系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106527471B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019047073A1 (zh) | 2017-09-06 | 2019-03-14 | 深圳市道通智能航空技术有限公司 | 飞行器降落方法、飞行器和计算机可读存储介质 |
CN107608213B (zh) * | 2017-10-12 | 2020-11-03 | 上海航天控制技术研究所 | 一种卫星姿态机动路径规划的参数设计方法 |
CN109471424B (zh) * | 2018-12-04 | 2020-04-21 | 上海航天控制技术研究所 | 一种大角动量转动部件地面仿真测试系统及方法 |
CN110162073B (zh) * | 2019-05-29 | 2021-12-07 | 北京控制工程研究所 | 一种适应边界约束的分段正弦姿态机动轨迹规划方法 |
CN111731512B (zh) * | 2020-04-30 | 2022-03-04 | 上海航天控制技术研究所 | 一种基于太阳翼驱动控制的火星环绕器在线角动量管理方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6447699A (en) * | 1987-08-18 | 1989-02-22 | Mitsubishi Electric Corp | Attitude controller for artificial satellite |
KR100793058B1 (ko) * | 2006-09-27 | 2008-01-10 | 한국전자통신연구원 | 지향 목표 궤적 근사화를 이용한 위성 자세 제어 방법 |
CN103808323A (zh) * | 2012-11-07 | 2014-05-21 | 上海航天控制工程研究所 | 一种卫星姿态跟踪机动的余弦过渡加速度路径方法 |
CN103941739A (zh) * | 2014-04-15 | 2014-07-23 | 北京控制工程研究所 | 一种基于多项式的卫星姿态机动方法 |
CN104199297A (zh) * | 2014-08-12 | 2014-12-10 | 清华大学深圳研究生院 | 一种引入挠性附件振动量的空间机器人关节轨迹规划方法 |
CN106184819A (zh) * | 2016-09-09 | 2016-12-07 | 上海航天控制技术研究所 | 一种姿态机动自适应轨迹规划方法 |
-
2017
- 2017-01-25 CN CN201710060495.0A patent/CN106527471B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6447699A (en) * | 1987-08-18 | 1989-02-22 | Mitsubishi Electric Corp | Attitude controller for artificial satellite |
KR100793058B1 (ko) * | 2006-09-27 | 2008-01-10 | 한국전자통신연구원 | 지향 목표 궤적 근사화를 이용한 위성 자세 제어 방법 |
CN103808323A (zh) * | 2012-11-07 | 2014-05-21 | 上海航天控制工程研究所 | 一种卫星姿态跟踪机动的余弦过渡加速度路径方法 |
CN103941739A (zh) * | 2014-04-15 | 2014-07-23 | 北京控制工程研究所 | 一种基于多项式的卫星姿态机动方法 |
CN104199297A (zh) * | 2014-08-12 | 2014-12-10 | 清华大学深圳研究生院 | 一种引入挠性附件振动量的空间机器人关节轨迹规划方法 |
CN106184819A (zh) * | 2016-09-09 | 2016-12-07 | 上海航天控制技术研究所 | 一种姿态机动自适应轨迹规划方法 |
Non-Patent Citations (2)
Title |
---|
基于路径规划和输人成型的挠性航天器;刘德庆,彭仁军,张子龙;《上海航天》;20141231;第31卷(第4期);第41-46页、第72页 * |
柔性卫星角加速度轨迹规划与振动抑制方法;耿云海,侯志立,黄思萌;《宇航学报》;20161231;第37卷(第12期);正文第2-4节 * |
Also Published As
Publication number | Publication date |
---|---|
CN106527471A (zh) | 2017-03-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106527471B (zh) | 姿态机动过程中抑制挠性振动的轨迹规划方法和系统 | |
CN106184819B (zh) | 一种姿态机动自适应轨迹规划方法 | |
CN105180937B (zh) | 一种mems‑imu初始对准方法 | |
US7512493B2 (en) | High speed gyrocompass alignment via multiple Kalman filter based hypothesis testing | |
CN106679657B (zh) | 一种运动载体导航定位方法及装置 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN104281150A (zh) | 一种姿态机动的轨迹规划方法 | |
JP6255924B2 (ja) | センサー用ic、センサーデバイス、電子機器及び移動体 | |
CN105180728B (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
JP2004239643A (ja) | ハイブリッド航法装置 | |
CN107063244B (zh) | 一种飞行器飞行过程模拟方法 | |
WO2010027127A1 (en) | Underwater vehicles controlled by using gyro momentum approach | |
US20210108923A1 (en) | Information processing apparatus, information processing method, and program | |
CN106248082B (zh) | 一种飞行器自主导航系统及导航方法 | |
CN109269526A (zh) | 基于阻尼网络的旋转式格网惯导水平阻尼方法 | |
CN103268067A (zh) | 一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法 | |
CN104121930B (zh) | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 | |
CN110044361A (zh) | 基于目标投影位置的光学载荷星上自主调度方法 | |
CN108583938A (zh) | 一种可应用于运行于太阳同步晨昏轨道的全向天线通信卫星姿态控制系统及其方法 | |
CN109774977A (zh) | 一种基于四元数的时间最优的卫星姿态快速机动方法 | |
CN102880049A (zh) | 一种基于帆板挠性形变测量的自适应振动控制方法 | |
CN104677356A (zh) | 一种基于角增量和比力输出的划桨速度计算方法 | |
CN104375512B (zh) | 一种基于频谱分析的航天器机动路径优化方法 | |
JP2015094631A (ja) | 位置算出装置及び位置算出方法 | |
CN106379558B (zh) | 一种基于角加速度前馈的滑模变结构复合控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |