CN110712768B - 一种控制力矩陀螺群初始框架位置确定方法 - Google Patents
一种控制力矩陀螺群初始框架位置确定方法 Download PDFInfo
- Publication number
- CN110712768B CN110712768B CN201911074488.1A CN201911074488A CN110712768B CN 110712768 B CN110712768 B CN 110712768B CN 201911074488 A CN201911074488 A CN 201911074488A CN 110712768 B CN110712768 B CN 110712768B
- Authority
- CN
- China
- Prior art keywords
- initial frame
- control moment
- angle combination
- delta
- frame angle
- 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 20
- 238000005259 measurement Methods 0.000 claims abstract description 15
- 238000005457 optimization Methods 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
Images
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/28—Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect
- B64G1/286—Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect using control momentum gyroscopes (CMGs)
-
- 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
- B64G1/245—Attitude control algorithms for spacecraft attitude control
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种控制力矩陀螺群初始框架位置确定方法,该方法包含以下步骤:S1、构建控制力矩陀螺群总角动量的约束方程;S2、构建奇异测度的指标函数;S3、结合步骤S1和S2的数据进行非线性叠代搜索,并将所述非线性迭代搜索的结果转化到0‑2π,作为初始框架角组合δ0;S4、将步骤S3所得的初始框架角组合δ0作为初始值继续代入到步骤S3中,计算出新的初始框架角组合δ0,并不断进行步骤S3和步骤S4的循环,直至前后两次所得的初始框架角组合δ0之间差值小于或等于0.001°时,输出当前的初始框架角组合δ0。其优点是:根据控制力矩陀螺群角动量约束方程和奇异测度指标函数,通过多次叠代搜索出控制力矩陀螺群初始框架的位置,具有简单可靠,运算量小,工程易于实现的优点。
Description
技术领域
本发明涉及控制力矩陀螺群领域,具体涉及一种控制力矩陀螺群初始框架位置确定方法。
背景技术
随着卫星的功能不断丰富,卫星的质量也在不断增加。卫星在进行大角度快速机动的时候,不仅仅需要执行机构提供足够大且足够连续的控制力矩,同时也需要有足够大的角动量空间,使得卫星能够以较大的角速度实现快速机动。控制力矩陀螺群的力矩能够满足卫星进行大角度快速机动的要求,控制力矩陀螺群初始框架角位置决定着卫星在指定方向的机动角速度,同时控制陀螺群的奇异测度关系着控制力矩陀螺群是否能够输出指定的力矩。
发明内容
本发明的目的在于提供一种控制力矩陀螺群初始框架位置确定方法,根据控制力矩陀螺群角动量约束方程和奇异测度指标函数,通过多次叠代搜索出控制力矩陀螺群初始框架的位置,该方法能够确定满足控制力矩陀螺群角动量为零,且奇异测度最大的控制力矩陀螺群初始框架位置,使得卫星在各个方向机动都有最大的角动量空间,且避免出现奇异的状况,输出的控制力矩稳定,具有简单可靠,运算量小,工程易于实现的优点。
为了达到上述目的,本发明通过以下技术方案实现:
一种控制力矩陀螺群初始框架位置确定方法,该方法包含以下步骤:
S1、构建控制力矩陀螺群总角动量的约束方程;
S2、构建奇异测度的指标函数;
S3、结合步骤S1和S2的数据进行非线性叠代搜索,并将所述非线性迭代搜索的结果转化到0-2π,作为初始框架角组合δ0;
S4、将步骤S3所得的初始框架角组合δ0作为初始值继续代入到步骤S3中,计算出新的初始框架角组合δ0,并不断进行步骤S3和步骤S4的循环,直至前后两次所得的初始框架角组合δ0之间的差值小于或等于0.001°时,输出当前的初始框架角组合δ0。
优选地,所述步骤S1中,所述控制力矩陀螺群总角动量的约束方程为:
其中,n为控制力矩陀螺个数,hi为第i个控制力矩陀螺角动量。
优选地,所述步骤S2具体为:
S2.1、计算奇异测度D:
其中,n为控制力矩陀螺个数,ti、tj为第i个或第j个控制力矩陀螺控制力矩方向的单位矢量;
S2.2、构建奇异测度D的指标函数J:
J=min(-D) (3)。
优选地,所述步骤S3具体为:
S3.1、结合步骤S2和步骤S3的数据进行非线性叠代搜索,得到框架角组合δ;
S3.2、将所述框架角组合转化到0-2π,作为初始框架角组合δ0。
优选地,所述步骤S3.1具体为:
利用fmincon函数进行非线性叠代搜索,得到框架角组合δ,
其中,第一次非线性叠代搜索时的初始框架角组合δ0可任意选取,幅值在0-2π之间。
优选地,所述步骤S3.2具体为:
用框架角组合δ除以2π,取其余数作为下一次非线性叠代搜索的初始框架角组合δ0,表示为:
δ0=mod(δ,2π) (5)。
本发明与现有技术相比具有以下优点:
(1)本发明的一种控制力矩陀螺群初始框架位置确定方法,根据控制力矩陀螺群角动量约束方程和奇异测度指标函数,通过多次叠代搜索出控制力矩陀螺群初始框架的位置,具有简单可靠,运算量小,工程易于实现的优点;
(2)本发明的一种控制力矩陀螺群初始框架位置确定方法,设计了一种角动量约束条件与奇异测度指标函数相结合的最优化模型,使得控制力矩陀螺群在初始时刻的总角动量为零,同时奇异度量最大,保证系统能够在任意方向上姿态控制与姿态稳定的能力。
附图说明
图1为本发明的一种控制力矩陀螺群初始框架位置确定方法。
具体实施方式
以下结合附图,通过详细说明一个较佳的具体实施例,对本发明做进一步阐述。
如图1所示,为本发明的一种控制力矩陀螺群初始框架位置确定方法示意图,该方法包含以下步骤:
S1、构建控制力矩陀螺群总角动量的约束方程。
所述控制力矩陀螺群总角动量的约束方程为:
其中,n为控制力矩陀螺个数,hi为第i个控制力矩陀螺角动量。
S2、构建奇异测度的指标函数。
所述步骤S2具体为:
S2.1、计算奇异测度D:
其中,n为控制力矩陀螺个数,ti、tj为第i个或第j个控制力矩陀螺控制力矩方向的单位矢量。
S2.2、构建奇异测度D的指标函数J:
J=min(-D) (3)。
S3、结合步骤S1和S2的数据进行非线性叠代搜索,并将所述非线性迭代搜索的结果转化到0-2π,作为初始框架角组合δ0。
所述步骤S3具体为:
S3.1、结合步骤S2和步骤S3的数据进行非线性叠代搜索,得到框架角组合δ。
所述步骤S3.1具体为:利用fmincon函数进行非线性叠代搜索,得到框架角组合δ,
其中,第一次非线性叠代搜索时的初始框架角组合δ0可任意选取,幅值在0-2π之间。
S3.2、将所述框架角组合δ转化到0-2π,作为下一次非线性叠代搜索的初始框架角组合δ0。
所述步骤S3.2具体为:
用框架角组合δ除以2π,取其余数作为下一次非线性叠代搜索的初始框架角组合δ0,表示为:
δ0=mod(δ,2π) (5)。
S4、将步骤S3所得的初始框架角组合δ0作为初始值继续代入到步骤S3中,计算出新的初始框架角组合δ0,并不断进行步骤S3和步骤S4的循环,直至前后两次所得的初始框架角组合δ0之间的差值小于或等于0.001°时,输出当前的初始框架角组合δ0。
综上所述,本发明的控制力矩陀螺群初始框架位置确定方法,根据控制力矩陀螺群角动量约束方程和奇异测度指标函数,设计了一种角动量约束条件与奇异测度指标函数相结合的最优化模型,通过多次叠代搜索出控制力矩陀螺群初始框架的位置,使得控制力矩陀螺群在初始时刻的总角动量为零,同时奇异度量最大,保证系统能够在任意方向上姿态控制与姿态稳定的能力,具有简单可靠,运算量小,工程易于实现的优点。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (6)
1.一种控制力矩陀螺群初始框架位置确定方法,其特征在于,该方法包含以下步骤:
S1、构建控制力矩陀螺群总角动量的约束方程;
S2、构建奇异测度的指标函数;
S3、结合步骤S1和S2的数据进行非线性叠代搜索,用框架角组合δ除以2π,取其余数作为初始框架角组合δ0;
S4、将步骤S3所得的初始框架角组合δ0作为初始值继续代入到步骤S3中,计算出新的初始框架角组合δ0,并不断进行步骤S3和步骤S4的循环,直至前后两次所得的初始框架角组合δ0之间的差值小于或等于0.001°时,输出当前的初始框架角组合δ0。
4.如权利要求3所述的控制力矩陀螺群初始框架位置确定方法,其特征在于,所述步骤S3具体为:
S3.1、结合步骤S2和步骤S3的数据进行非线性叠代搜索,得到框架角组合δ;
S3.2、将所述框架角组合转化到0-2π,作为初始框架角组合δ0。
6.如权利要求4或5所述的控制力矩陀螺群初始框架位置确定方法,其特征在于,所述步骤S3.2具体为:
用框架角组合δ除以2π,取其余数作为下一次非线性叠代搜索的初始框架角组合δ0,表示为:
δ0=mod(δ,2π) (5)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911074488.1A CN110712768B (zh) | 2019-10-31 | 2019-10-31 | 一种控制力矩陀螺群初始框架位置确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911074488.1A CN110712768B (zh) | 2019-10-31 | 2019-10-31 | 一种控制力矩陀螺群初始框架位置确定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110712768A CN110712768A (zh) | 2020-01-21 |
CN110712768B true CN110712768B (zh) | 2021-03-16 |
Family
ID=69214719
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911074488.1A Active CN110712768B (zh) | 2019-10-31 | 2019-10-31 | 一种控制力矩陀螺群初始框架位置确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110712768B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112650311B (zh) * | 2020-11-24 | 2022-09-13 | 上海航天控制技术研究所 | 基于线性霍尔的控制力矩陀螺外框转速和位置控制方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7246776B2 (en) * | 2004-07-23 | 2007-07-24 | Honeywell International, Inc. | Method and system for CMG array singularity avoidance |
US7370833B2 (en) * | 2005-10-20 | 2008-05-13 | Honeywell International Inc. | Method and system for determining a singularity free momentum path |
CN100565405C (zh) * | 2008-09-12 | 2009-12-02 | 航天东方红卫星有限公司 | 一种操纵律奇异回避的航天器姿态控制系统 |
CN101763038B (zh) * | 2009-12-22 | 2012-06-06 | 北京航空航天大学 | 一种双框架磁悬浮控制力矩陀螺结构模态振动控制方法 |
CN101891018B (zh) * | 2010-07-09 | 2013-04-17 | 中国科学院长春光学精密机械与物理研究所 | 基于力矩输出能力最优的单框架控制力矩陀螺操纵方法 |
CN103019247B (zh) * | 2011-09-27 | 2016-12-07 | 上海航天控制工程研究所 | 一种火星探测器无陀螺自主空间姿态机动控制方法 |
CN103235515B (zh) * | 2013-04-25 | 2016-01-20 | 哈尔滨工业大学 | 一种利用零运动避免单框架控制力矩陀螺群框架轴转速死区的方法 |
CN105223961B (zh) * | 2015-10-16 | 2018-04-13 | 北京机械设备研究所 | 一种用于控制力矩陀螺奇异规避的航天器姿态控制方法 |
CN108958273B (zh) * | 2018-06-19 | 2021-07-06 | 上海卫星工程研究所 | 一种基于不同型谱单框架控制力矩陀螺的陀螺群构型设计方法 |
-
2019
- 2019-10-31 CN CN201911074488.1A patent/CN110712768B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110712768A (zh) | 2020-01-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Lu et al. | Adaptive attitude tracking control for rigid spacecraft with finite-time convergence | |
CN107690567B (zh) | 利用扩展卡尔曼滤波器用于对移动载体设备的航行进行追踪的方法 | |
US8543266B2 (en) | Modified Kalman filter for generation of attitude error corrections | |
US10274318B1 (en) | Nine-axis quaternion sensor fusion using modified kalman filter | |
CN107618678B (zh) | 卫星姿态角度偏差下的姿控信息联合估计方法 | |
Hermant | Optimal control of the atmospheric reentry of a space shuttle by an homotopy method | |
CN103708044B (zh) | 一种用于卫星快速姿态机动的饱和滑模变结构控制方法 | |
US20140231589A1 (en) | Gyroless Three-Axis Sun Acquisition Using Sun Sensor and Unscented Kalman Filter | |
JP6255924B2 (ja) | センサー用ic、センサーデバイス、電子機器及び移動体 | |
CN107339987B (zh) | 一种基于函数迭代积分的刚体姿态解算方法 | |
CN107664498A (zh) | 一种姿态融合解算方法及系统 | |
CN110044385B (zh) | 一种大失准角情况下的快速传递对准方法 | |
WO2021110055A1 (zh) | 一种用于最优估计精对准的严格逆向导航方法 | |
CN115617051B (zh) | 车辆控制方法、装置、设备和计算机可读介质 | |
CN108313330B (zh) | 一种基于增广Kalman滤波的卫星干扰力矩估计方法 | |
CN110712768B (zh) | 一种控制力矩陀螺群初始框架位置确定方法 | |
Chiang et al. | Constrained filtering method for attitude determination using GPS and gyro | |
CN112729332A (zh) | 一种基于旋转调制的对准方法 | |
JP2002323322A (ja) | 慣性計測装置を用いた姿勢推定装置及び方法並びにプログラム | |
US9567112B1 (en) | Method and apparatus for singularity avoidance for control moment gyroscope (CMG) systems without using null motion | |
CN102880049B (zh) | 一种基于帆板挠性形变测量的自适应振动控制方法 | |
CN115033844A (zh) | 一种无人机状态估计方法、系统、设备及可读存储介质 | |
CN103323031A (zh) | 一种基于星敏的地平仪系统误差在线补偿的方法 | |
CN105136150B (zh) | 一种基于多次星敏感器测量信息融合的姿态确定方法 | |
CN114323007A (zh) | 一种载体运动状态估计方法及装置 |
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 |