CN110688731B - 一种并联式指向平台的扰动建模与抑制方法 - Google Patents
一种并联式指向平台的扰动建模与抑制方法 Download PDFInfo
- Publication number
- CN110688731B CN110688731B CN201910791692.9A CN201910791692A CN110688731B CN 110688731 B CN110688731 B CN 110688731B CN 201910791692 A CN201910791692 A CN 201910791692A CN 110688731 B CN110688731 B CN 110688731B
- Authority
- CN
- China
- Prior art keywords
- platform
- angular momentum
- steps
- following
- hinge point
- 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
- 230000000452 restraining effect Effects 0.000 title description 5
- 230000033001 locomotion Effects 0.000 claims abstract description 34
- 230000001629 suppression Effects 0.000 claims abstract description 13
- 238000004364 calculation method Methods 0.000 claims description 23
- 230000026058 directional locomotion Effects 0.000 claims description 6
- 239000002245 particle Substances 0.000 claims description 5
- 230000000694 effects Effects 0.000 abstract description 3
- 230000002411 adverse Effects 0.000 abstract description 2
- 238000004458 analytical method Methods 0.000 description 3
- 230000002401 inhibitory effect Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000003384 imaging method Methods 0.000 description 2
- 241000733322 Platea Species 0.000 description 1
- 230000010485 coping Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
技术领域
本发明涉及一种星载运动附件扰动建模与抑制技术领域,特别是一种并联式指向平台的扰动建模与抑制方法。
背景技术
当前,多载荷卫星通过将有效载荷安装在指向平台上,通过平台的敏捷指向实现对目标的扫描、凝视、跟踪等成像任务,从而提高载荷的工作效能。然而,载荷的指向运动势必会对整星姿态以及不同载荷的目标指向产生强烈干扰。如何有效消除载荷运动产生的姿态扰动,使各载荷能够互不干扰地执行各自的成像任务,从而使卫星系统达到一种扰动解耦的高动态协同控制状态,是多载荷卫星姿控系统必须解决的关键问题。然而,传统卫星姿态控制系统一般采用闭环反馈控制的方式实现卫星的姿态稳定,并不考虑载荷运动对卫星姿态的影响,这种处理方式在运动载荷单一,且相对较小时是合理的,但在运动载荷较大或者具有多个运动载荷时,反馈系统由于其固有的滞后特性,已难以抑制载荷指向运动对卫星平台的扰动影响。
发明内容
本发明的目的在于克服现有技术的上述不足,提供一种并联式指向平台的扰动建模与抑制方法,有效抑制了平台指向运动的不利影响,保证卫星姿态具有高稳定度水平。
本发明的上述目的是通过如下技术方案予以实现的:
一种并联式指向平台的扰动建模与抑制方法,包括如下步骤:
步骤一、下平台与星本体固连,上平台为载荷安装面,建立下平台坐标系OBXBYBZB;建立上平台坐标系OPXPYPZP;
步骤二、下平台3个铰链点分别用Bi表示;上平台3个铰链点分别用Pi表示;下平台铰链点Bi与对应上平台铰链点Pi之间通过支杆连接;i为正整数,1≤i≤3;建立下平台各铰点Bi的下平台铰链点坐标系BiXBiYBiZBi;建立下平台各铰点Bi的下平台铰链点坐标系PiXPiYPiZPi;
在上述的一种并联式指向平台的扰动建模与抑制方法,所述的步骤一中,下平台坐标系OBXBYBZB的建立方法为:
原点OB位于下平台的圆心,ZB轴垂直于下平台指向上平台,YB轴位于下平台所在平面,XB轴方向由右手法则确定;
上平台坐标系OPXPYPZP的建立方法为:
原点OP位于上平台铰点外接圆的圆心,ZP轴竖直向上,YP轴位于上平台所在平面,初始状态下与YB平行,XP轴方向由右手法则确定。
在上述的一种并联式指向平台的扰动建模与抑制方法,所述的步骤二中,下平台铰链点坐标系BiXBiYBiZBi的建立方法为:
原点Bi位于下平台铰点Bi处,ZBi方向沿支杆方向向上,YBi方向为支杆的转动轴轴向,XBi方向由右手法则确定;
上平台铰链点坐标系PiXPiYPiZPi的建立方法为:
坐标原点Pi位于上平台铰点Pi处,ZPi方向沿支杆方向向上,YPi方向为支杆的转动轴,XPi方向由右手法则确定。
将公式(3)代入公式(2),得:
式中,mP为上平台的质量;
本发明与现有技术相比具有如下优点:
(1)本发明基于系统角动量的变化量进行扰动分析和补偿力矩设计,相比直接采用显式表达的力和力矩方程具有更广泛的物理意义,且不涉及难以测量的线加速度和角加速度,因而具有更好的工程适用性;
(2)本发明采用前馈力矩补偿的方式设计补偿量,不需要经过参数估计的收敛过程,保证了扰动补偿的实时性,这对于提高系统的动态性能,应对快速变化的平台扰动力矩有重要意义;
(3)本发明建立了一类具有环状铰接关系的运动机构精确扰动力矩模型,由于这类机构刚性好,能够利用结构分析软件获得较高精度的惯量/结构参数,从而确保了扰动分析结果的准确性,可进一步应用于具有类似结构形式运动系统的卫星姿态扰动估计。
附图说明
图1为本发明扰动建模与抑制流程示意图;
图2为本发明并联指向平台示意图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步详细的描述:
如图1所示为扰动建模与抑制流程示意图,由图可知,一种并联式指向平台的扰动建模与抑制方法,包括如下步骤:
步骤一、如图2所示为并联指向平台示意图,由图可知,下平台与星本体固连,上平台为载荷安装面,建立下平台坐标系OBXBYBZB;建立上平台坐标系OPXPYPZP;
下平台坐标系OBXBYBZB的建立方法为:
原点OB位于下平台的圆心,ZB轴垂直于下平台指向上平台,YB轴位于下平台所在平面,XB轴方向由右手法则确定;
上平台坐标系OPXPYPZP的建立方法为:
原点OP位于上平台铰点外接圆的圆心,ZP轴竖直向上,YP轴位于上平台所在平面,初始状态下与YB平行,XP轴方向由右手法则确定。
步骤二、下平台3个铰链点分别用Bi表示;上平台3个铰链点分别用Pi表示;下平台铰链点Bi与对应上平台铰链点Pi之间通过支杆连接;i为正整数,1≤i≤3;建立下平台各铰点Bi的下平台铰链点坐标系BiXBiYBiZBi;建立下平台各铰点Bi的下平台铰链点坐标系PiXPiYPiZPi。
下平台铰链点坐标系BiXBiYBiZBi的建立方法为:
原点Bi位于下平台铰点Bi处,ZBi方向沿支杆方向向上,YBi方向为支杆的转动轴轴向,XBi方向由右手法则确定;
上平台铰链点坐标系PiXPiYPiZPi的建立方法为:
坐标原点Pi位于上平台铰点Pi处,ZPi方向沿支杆方向向上,YPi方向为支杆的转动轴,XPi方向由右手法则确定。
将公式(3)代入公式(2),得:
式中,mP为上平台的质量;
由此支杆必须进行伸缩运动才能适应上平台产生的牵连运动,此时支杆的质心、惯量等参数都将发生变化。为了避免将问题复杂化,可将支杆分解成两部分进行分析,一部分与上平台的Pi点铰接,一部分与下平台的Bi点铰接,两部分质心、惯量等参数不变,则支杆的角动量是两部分的角动量之和:
步骤五、将步骤四计算得到的补偿力矩对卫星的控制量进行补偿,抑制指向平台对卫星的扰动的影响,在进行补偿时应满足如下公式
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (6)
1.一种并联式指向平台的扰动建模与抑制方法,其特征在于:包括如下步骤:
步骤一、下平台与星本体固连,上平台为载荷安装面,建立下平台坐标系OBXBYBZB;建立上平台坐标系OPXPYPZP;下平台坐标系OBXBYBZB的建立方法为:
原点OB位于下平台的圆心,ZB轴垂直于下平台指向上平台,YB轴位于下平台所在平面,XB轴方向由右手法则确定;
上平台坐标系OPXPYPZP的建立方法为:
原点OP位于上平台铰点外接圆的圆心,ZP轴竖直向上,YP轴位于上平台所在平面,初始状态下与YB平行,XP轴方向由右手法则确定;
步骤二、下平台3个铰链点分别用Bi表示;上平台3个铰链点分别用Pi表示;下平台铰链点Bi与对应上平台铰链点Pi之间通过支杆连接;i为正整数,1≤i≤3;建立下平台各铰点Bi的下平台铰链点坐标系BiXBiYBiZBi;建立上平台各铰点Pi的下平台铰链点坐标系PiXPiYPiZPi;下平台铰链点坐标系BiXBiYBiZBi的建立方法为:
原点Bi位于下平台铰点Bi处,ZBi方向沿支杆方向向上,YBi方向为支杆的转动轴轴向,XBi方向由右手法则确定;
上平台铰链点坐标系PiXPiYPiZPi的建立方法为:
坐标原点Pi位于上平台铰点Pi处,ZPi方向沿支杆方向向上,YPi方向为支杆的转动轴,XPi方向由右手法则确定;
联立上述公式,得:
式中,mP为上平台的质量;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910791692.9A CN110688731B (zh) | 2019-08-26 | 2019-08-26 | 一种并联式指向平台的扰动建模与抑制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910791692.9A CN110688731B (zh) | 2019-08-26 | 2019-08-26 | 一种并联式指向平台的扰动建模与抑制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110688731A CN110688731A (zh) | 2020-01-14 |
CN110688731B true CN110688731B (zh) | 2020-11-20 |
Family
ID=69108607
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910791692.9A Active CN110688731B (zh) | 2019-08-26 | 2019-08-26 | 一种并联式指向平台的扰动建模与抑制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110688731B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7185855B2 (en) * | 2004-04-30 | 2007-03-06 | Honeywell International, Inc. | Method and system for steering a momentum control system |
CN101038208A (zh) * | 2007-02-06 | 2007-09-19 | 重庆大学 | 一种六轴微激振器系统 |
WO2017003932A1 (en) * | 2015-06-28 | 2017-01-05 | Vamvas Vassilios | Eccentrically rotating mass turbine |
CN106326576A (zh) * | 2016-08-26 | 2017-01-11 | 北京控制工程研究所 | 一种任意基准系下的整星偏置角动量的偏航估计方法 |
CN107783420A (zh) * | 2017-09-15 | 2018-03-09 | 北京控制工程研究所 | 一种星载运动天线扰动抑制方法 |
CN108762073A (zh) * | 2018-05-23 | 2018-11-06 | 北京控制工程研究所 | 一种主动指向超静平台操纵律设计方法 |
CN108897239A (zh) * | 2018-06-29 | 2018-11-27 | 北京控制工程研究所 | 一种航天器两级姿态控制模拟系统 |
-
2019
- 2019-08-26 CN CN201910791692.9A patent/CN110688731B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7185855B2 (en) * | 2004-04-30 | 2007-03-06 | Honeywell International, Inc. | Method and system for steering a momentum control system |
CN101038208A (zh) * | 2007-02-06 | 2007-09-19 | 重庆大学 | 一种六轴微激振器系统 |
WO2017003932A1 (en) * | 2015-06-28 | 2017-01-05 | Vamvas Vassilios | Eccentrically rotating mass turbine |
CN106326576A (zh) * | 2016-08-26 | 2017-01-11 | 北京控制工程研究所 | 一种任意基准系下的整星偏置角动量的偏航估计方法 |
CN107783420A (zh) * | 2017-09-15 | 2018-03-09 | 北京控制工程研究所 | 一种星载运动天线扰动抑制方法 |
CN108762073A (zh) * | 2018-05-23 | 2018-11-06 | 北京控制工程研究所 | 一种主动指向超静平台操纵律设计方法 |
CN108897239A (zh) * | 2018-06-29 | 2018-11-27 | 北京控制工程研究所 | 一种航天器两级姿态控制模拟系统 |
Non-Patent Citations (3)
Title |
---|
4-UPS/UPR并联机构动力学分析;耿明超 等;《农业机械学报》;20140831;第45卷(第8期);第299-306页 * |
Singular formalism and admissible control of spacecraft with rotating flexible solar array;Lu Dongning 等;《Chinese Journal of Aeronautics》;20131219;第136-144页 * |
基于观测器的超静卫星平台关节-任务空间鲁棒控制方法;郝仁剑 等;《空间控制技术与应用》;20190630;第45卷(第3期);第8-16页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110688731A (zh) | 2020-01-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105468007B (zh) | 一种基于干扰观测器的挠性卫星轨迹线性化姿态控制方法 | |
CN110125936B (zh) | 一种空间机器人的地面实验验证系统 | |
De Luca et al. | Regulation of flexible arms under gravity | |
US6969965B2 (en) | Controller of legged mobile robot | |
JP5506823B2 (ja) | ロボットの制御装置 | |
CN105382843B (zh) | 一种抓捕末阶段机械臂与操作平台协调控制方法 | |
FI129740B (en) | DYNAMIC BEND COMPENSATION, COORDINATED LIFTING CONTROL, AND SWIVEL PREVENTION IN CARGO HANDLING EQUIPMENT | |
CN106625610B (zh) | 侧立式交叉杆型并联机构六自由度航天器运动仿真平台 | |
Malekzadeh et al. | A robust nonlinear control approach for tip position tracking of flexible spacecraft | |
CN110342400B (zh) | 一种基于负载能量耦合的桥式起重机定位消摆控制方法 | |
CN106708078B (zh) | 一种适用于空间机器人执行器故障下的快速姿态稳定方法 | |
JP2008129813A (ja) | 柔軟アームを有する移動ロボット | |
Lei et al. | Finite-time tracking control and vibration suppression based on the concept of virtual control force for flexible two-link space robot | |
CN112859593B (zh) | 一种轮腿式机器人机身姿态及足端受力协同控制方法 | |
CN107015567A (zh) | 一种超大尺度柔性航天器分散协同控制方法 | |
CN113619814A (zh) | 一种交会对接最后逼近段相对姿轨耦合控制方法 | |
CN107783420B (zh) | 一种星载运动天线扰动抑制方法 | |
CN110688731B (zh) | 一种并联式指向平台的扰动建模与抑制方法 | |
CN114954724A (zh) | 一种四足单臂作业机器人的运动控制方法及系统 | |
Malekzadeh et al. | Robust attitude and vibration control of a nonlinear flexible spacecraft | |
Jung et al. | Operational space control framework for torque controlled humanoid robots with joint elasticity | |
CN112405528B (zh) | 一种考虑引力影响的空间机械臂系统显式动力学控制方法 | |
CN106054912B (zh) | 一种挠性航天器的高精度姿态镇定方法 | |
Schlott et al. | A crane-based five-axis manipulator for antenna tests | |
CN105717791B (zh) | 一种自适应h无穷控制的悬臂梁振动控制方法 |
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 |