CN109911250B - 一种磁测磁控速率阻尼的方法 - Google Patents
一种磁测磁控速率阻尼的方法 Download PDFInfo
- Publication number
- CN109911250B CN109911250B CN201910278233.0A CN201910278233A CN109911250B CN 109911250 B CN109911250 B CN 109911250B CN 201910278233 A CN201910278233 A CN 201910278233A CN 109911250 B CN109911250 B CN 109911250B
- Authority
- CN
- China
- Prior art keywords
- vector
- geomagnetic field
- magnetic
- damping
- field vector
- 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
Images
Landscapes
- Force Measurement Appropriate To Specific Purposes (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
技术领域
本发明总体而言涉及航空航天技术领域,具体而言涉及一种磁测磁控速率阻尼的方法。
背景技术
在星箭分离后,卫星的初始分离角速度需进行阻尼控制;另外,卫星平台自身所引发的内源性大角速率更需要进行及时施加阻尼。高轨卫星可采用陀螺仪测量角速度,并采用推力器或动量轮施加阻尼;对于低轨道、低成本微纳卫星,磁强计和磁力矩器是重要且可靠的姿控单机,故可采用磁测磁控方案施加阻尼。
在卫星姿态翻转过程中,考虑到星体系下地磁场矢量呈球状分布,无法依据磁测数据准确判定姿态的翻转方向。默认星体角速率较小,B-dot算法可以顺利确定可有效阻尼的控制指令;但在星体角速率大于180/ΔT(°/s)的情况下(为ΔT姿态控制系统控制周期),B-dot算法无法识别星体翻转方向,进而趋于采信较小的角速率数值,而相应的方向与星体实际翻转方向相反;采用错误的角速率数值解算所得的控制指令将无法实现速率阻尼。
事实上,现有的B-dot阻尼算法及其变种能够实现有效阻尼的最大角速率上限远小于180/ΔT(°/s),无法应对星体角速率因初始分离、推力器故障等而过大的场景;基于磁强计多拍测量信息进行星体角速率估算,进而采用角速率反馈方式完成阻尼控制的方法可以实现较大角速率的阻尼控制,但由于估算的星体角速度矢量与真实值有较大偏差,故控制效率较低。
发明内容
本发明的任务是提供一种一种磁测磁控速率阻尼的方法,通过该方法,可以在星体角速率小于180/ΔT(°/s)的情况下,准确地确定磁力矩器的期望输出磁矩,从而施加精确的阻尼。
根据本发明,该任务通过一种控制速率阻尼的方法来解决,该方法包括下列步骤:
计算相平面中心O到C的矢径Bb ++;
根据相平面中心O到C的矢径Bb ++和当前拍地磁场矢量的测量值Bb确定磁力矩器的期望输出磁矩;以及
根据期望输出磁矩驱动磁力矩器。
在本发明的一个优选方案中规定,该方法还包括下列步骤:
根据当前拍与上一拍地磁场矢量的测量值Bb和Bb —和相平面中心O到C的矢径Bb ++确定地磁场变化率矢量rΔB;
根据地磁场变化率矢量rΔB和当前拍地磁场矢量的测量值Bb确定磁力矩器工作结束时对应的地磁场矢量Bb E;以及
用当前拍地磁场矢量的测量值Bb和所述地磁场矢量Bb E分别替代当前拍与上一拍地磁场矢量的测量值Bb和Bb —以便用于下一拍的计算。
在本发明的又一优选方案中规定,该方法还包括下列步骤:
m=m0·sgn(Bb-Bb -),
其中m0为磁力矩器的额定输出磁矩。
在本发明的另一优选方案中规定,计算相平面中心O到C的矢径Bb ++包括下列步骤:
按照下列公式根据当前拍与上一拍地磁场矢量的测量值Bb和Bb —确定表征矢量变化率的矢量Ω:
Ω=Bb -×Bb;
根据下列公式确定与矢量Ω和当前拍磁场矢量的测量值Bb相垂直的单位矢量L:
根据下列公式确定相平面中心O到A的距离:
根据下列公式计算相平面中心O到C的矢径Bb ++:
本发明至少具有如下有益效果:本发明基于B-dot阻尼控制算法的原理,针对前一拍和当前拍测量得到的地磁场矢量,估算其变化率矢量,明确阻尼磁控开始时刻的地磁场矢量,并预测阻尼磁控结束时刻的地磁场矢量,之后求取地磁场矢量变化率,从而准确地确定磁力矩器的期望输出磁矩,进而根据期望输出磁矩更精准地驱动磁力矩器产生所期望的阻尼控制。
附图说明
下面结合附图参考具体实施例来进一步阐述本发明。
图1示出了修正的磁控对日自旋定向控制流程图。
图2示出了星体系下地磁场矢量示意图。
图3示出了速率阻尼过程中星体角速率变化曲线。以及
图4示出了速率阻尼过程中星体角速度模值变化曲线。
具体实施方式
应当指出,各附图中的各组件可能为了图解说明而被夸大地示出,而不一定是比例正确的。在各附图中,给相同或功能相同的组件配备了相同的附图标记。
在本发明中,除非特别指出,“布置在…上”、“布置在…上方”以及“布置在…之上”并未排除二者之间存在中间物的情况。此外,“布置在…上或上方”仅仅表示两个部件之间的相对位置关系,而在一定情况下、如在颠倒产品方向后,也可以转换为“布置在…下或下方”,反之亦然。
在本发明中,各实施例仅仅旨在说明本发明的方案,而不应被理解为限制性的。
在本发明中,除非特别指出,量词“一个”、“一”并未排除多个元素的场景。
在此还应当指出,在本发明的实施例中,为清楚、简单起见,可能示出了仅仅一部分部件或组件,但是本领域的普通技术人员能够理解,在本发明的教导下,可根据具体场景需要添加所需的部件或组件。
在此还应当指出,在本发明的范围内,“相同”、“相等”、“等于”等措辞并不意味着二者数值绝对相等,而是允许一定的合理误差,也就是说,所述措辞也涵盖了“基本上相同”、“基本上相等”、“基本上等于”。
另外,本发明的各方法的步骤的编号并未限定所述方法步骤的执行顺序。除非特别指出,各方法步骤可以以不同顺序执行。
本发明所要解决的技术问题是对既有的、仅采用磁强计进行测量和仅采用磁力矩器进行卫星速率阻尼控制的B-dot磁控阻尼方法进行适应性修改,实现大角速率场景下的阻尼控制。本发明提出一种有效的B-dot算法修正方法,该方法根据磁强计前后两拍测得的地磁场矢量,估算磁力矩器工作结束时对应的地磁场矢量,进而由磁力矩器开始工作及工作结束时刻对应的地磁场矢量确定地磁场矢量变化量矢量,进而确定磁力矩器的工作指令。
无论是外源或内源造成了星体角速率过大,若星体角速率小于180/ΔT(°/s),在仅用磁强计进行测量且仅用磁力矩器进行控制的情况下,应用本发明均可在有效时间完成阻尼。
下面根据具体实施例进一步阐述本发明。
图1示出了修正的磁控对日自旋定向控制流程图。应当指出,在本实施例中采用了一些可选步骤,而在其它实施例中,这些步骤不是必需的。
如图1所示为B-dot阻尼控制流程图,如图2所示为星体系下地磁场矢量示意图。由图1可知,适用于大角速率场景的B-dot阻尼控制可通过如下步骤实现:
步骤1、根据当前拍与上一拍地磁场矢量的测量值,估算星体角速率大小:
若满足:
则执行步骤2,否则跳转步骤11。
步骤2、根据前后两拍地磁矢量确定表征矢量变化率的矢量Ω:
Ω=Bb -×Bb
其中,当前拍测得的地磁矢量为Bb,前一拍测得的地磁矢量为Bb —。
步骤3、计算与Ω和Bb相垂直的单位矢量L:
步骤4、计算直角三角形相似原理相关知识,可以求得相平面中心O到A的距离:
其中当前拍测得的地磁矢量为Bb,前一拍测得的地磁矢量为Bb —。
步骤5、计算相平面中心O到C的矢径:
其中,当前拍测得的地磁矢量为Bb,前一拍测得的地磁矢量为Bb —。
之后,跳转至步骤10。
步骤6、根据姿控系统的测量值在求解控制指令时是否延迟一拍,确定是否增加以下步骤7至步骤9的环节。若存在时间延迟,则执行步骤7。
步骤7、根据前后两拍地磁场矢量及步骤4所确定的相平面中心O到C的矢径,确定地磁场变化率矢量:
其中rΔB为在磁力矩器工作过程中的地磁场变化率矢量。
步骤8、根据rΔB和当前拍地磁场矢量确定磁力矩器工作结束时对应的地磁场矢量:
Bb E=Bb+rΔB
其中Bb E为在磁力矩器工作结束时刻对应的地磁场矢量。
步骤9、采用Bb和Bb E分别替代Bb —和Bb,并跳转步骤1,为下一拍计算作准备。
步骤10、确定磁力矩器的输出磁矩:
m=m0·sgn(Bb ++-Bb)
其中m为期望输出磁矩,m0为磁力矩器额定输出磁矩。
步骤11、小角速率情况下确定磁力矩器输出磁矩:
m=m0·sgn(Bb-Bb -)
其中m为期望输出磁矩,m0为磁力矩器额定输出磁矩。
步骤12、根据期望输出磁矩,驱动磁力矩器工作,完成本拍的阻尼控制。
以下通过数值仿真进行验证:
(1)设航天器初始角速度为:
偏航角速度:97.5°/s
俯仰角速度:97.5°/s
滚转角速度:97.5°/s
角速度模值:168.87°/s
(2)航天器初始姿态为:
偏航角:-40°
俯仰角:83.75°
滚转角:90°
(3)航天器惯量参数为:
转动惯量Ixx:0.5kg·m2
转动惯量Ixx:0.5kg·m2
转动惯量Ixx:0.5kg·m2
惯量积Ixy:0.01kg·m2
惯量积Ixz:0.01kg·m2
惯量积Iyz:-0.01kg·m2
(4)航天器轨道参数为:
高度为500km的晨昏轨道。
(5)航天器磁控参数为:
X向磁力矩器最大输出磁矩:3A·m2
Y向磁力矩器最大输出磁矩:3A·m2
Z向磁力矩器最大输出磁矩:3A·m2
X向磁力矩器最小输出磁矩:0.015A·m2
Y向磁力矩器最小输出磁矩:0.015A·m2
Z向磁力矩器最小输出磁矩:0.015A·m2
阻尼控制周期:1s
阻尼控制占空比:0.5
图3和图4为B-dot阻尼方法对应的大初始角速率情况下的速率阻尼仿真结果。仿真结果表明:在初始角速率模值小于180/ΔT(°/s)的条件下,虽然星体角速度很大,但采用B-dot阻尼方法仍可以在有限时间内完成速率阻尼;在星体角速度模值大于100°/s时,阻尼进程较慢,而在其小于100°/s时,阻尼进程明显变快;在星体角速度模值约小于20°/s时,用传统的B-dot阻尼控制方法可保证星体角速率平稳阻尼至零附近。
需要说明的是,本用例选取的是一条太阳同步轨道,磁力矩线绝大多数情况下与轨道面近似平行,故俯仰方向上的磁阻尼性能较弱;在三轴角速率均较大情况下,三轴间的相互耦合可以弥补俯仰轴控制能力的不足,但在仅俯仰角速度较大情况下,俯仰方向控制能力的不足将会降低磁阻尼可控的角速率门限。在本算例对应的条件下,磁阻尼可控的俯仰角速率门限上限为142°/s,而该值仍远高于传统的B-dot阻尼算法的可控上限及正常情况下可致的星体角速率上限。
可见,采用本发明所述方法可成功解决大角速率情况下的纯磁测磁纯阻尼问题,可在有限时间内完成星体角速率的阻尼。
本发明至少具有如下有益效果:本发明基于B-dot阻尼控制算法的原理,针对前一拍和当前拍测量得到的地磁场矢量,估算其变化率矢量,明确阻尼磁控开始时刻的地磁场矢量,并预测阻尼磁控结束时刻的地磁场矢量,之后求取地磁场矢量变化率,从而准确地确定磁力矩器的期望输出磁矩,进而根据期望输出磁矩更精准地驱动磁力矩器产生所期望的阻尼。
虽然本发明的一些实施方式已经在本申请文件中予以了描述,但是本领域技术人员能够理解,这些实施方式仅仅是作为示例示出的。本领域技术人员在本发明的教导下可以想到众多的变型方案、替代方案和改进方案而不超出本发明的范围。所附权利要求书旨在限定本发明的范围,并藉此涵盖这些权利要求本身及其等同变换的范围内的方法和结构。
Claims (1)
1.一种控制速率阻尼的方法,包括下列步骤:
计算相平面中心O到C的矢径Bb ++,包括:
按照下列公式根据当前拍与上一拍地磁场矢量的测量值Bb和Bb -确定表征矢量变化率的矢量Ω:
Ω=Bb -×Bb;
根据下列公式确定与矢量Ω和当前拍地磁场矢量的测量值Bb相垂直的单位矢量L:
其中C为单位矢量L方向的一点,且OA=OC,B为矢量Bb的端点,OA垂直于OB且A点为B点和Bb矢量的端点所在直线与OA的交点,OD垂直于AB且D点为与AB之间的交点,rOD为OD构成的矢量,并且rBD为BD构成的矢量;
根据下列公式确定相平面中心O到A的距离:
根据下列公式计算相平面中心O到C的矢径Bb ++:
根据相平面中心O到C的矢径Bb ++和当前拍地磁场矢量的测量值Bb确定磁力矩器的期望输出磁矩,包括:
确定磁力矩器的期望输出磁矩:
m=m0·sgn(Bb ++-Bb)
其中m为期望输出磁矩,m0为磁力矩器额定输出磁矩;以及
根据期望输出磁矩驱动磁力矩器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910278233.0A CN109911250B (zh) | 2019-04-09 | 2019-04-09 | 一种磁测磁控速率阻尼的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910278233.0A CN109911250B (zh) | 2019-04-09 | 2019-04-09 | 一种磁测磁控速率阻尼的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109911250A CN109911250A (zh) | 2019-06-21 |
CN109911250B true CN109911250B (zh) | 2020-11-03 |
Family
ID=66968970
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910278233.0A Active CN109911250B (zh) | 2019-04-09 | 2019-04-09 | 一种磁测磁控速率阻尼的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109911250B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112607064B (zh) * | 2020-12-25 | 2021-08-06 | 上海交通大学 | 避免进入自旋状态的微纳卫星磁阻尼控制方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4776540A (en) * | 1986-10-03 | 1988-10-11 | Communications Satellite Corporation | Method of orienting a synchronous satellite |
CN102582850B (zh) * | 2012-03-16 | 2014-06-18 | 上海微小卫星工程中心 | 提高卫星磁控精度的方法 |
US9846023B1 (en) * | 2014-07-01 | 2017-12-19 | The United States Of America As Represented By The Administrator Of Nasa | Electromagnetic monitoring and control of a plurality of nanosatellites |
CN107444675B (zh) * | 2017-08-18 | 2019-10-01 | 上海微小卫星工程中心 | 一种航天器速率阻尼控制方法 |
CN109533396B (zh) * | 2019-01-16 | 2020-07-17 | 上海微小卫星工程中心 | 一种基于磁测磁控的卫星自旋定向方法 |
-
2019
- 2019-04-09 CN CN201910278233.0A patent/CN109911250B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109911250A (zh) | 2019-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109823571A (zh) | 一种遥感微纳卫星的多阶段姿态控制方法 | |
CN109048890A (zh) | 基于机器人的协调轨迹控制方法、系统、设备及存储介质 | |
WO2015188409A1 (zh) | 基于mems惯导的双四元数动中通天线控制方法及系统 | |
CN109533396B (zh) | 一种基于磁测磁控的卫星自旋定向方法 | |
CN104085539B (zh) | 成像定标的姿态控制方法 | |
JP2008508602A (ja) | Cmgアレイにおけるトルクを最適化するための方法及びシステム | |
CN109539903A (zh) | 一种固体运载火箭椭圆转移轨道迭代制导控制方法 | |
CN110132269A (zh) | 一种导弹高精度垂直发射初始姿态获取方法 | |
CN103708044A (zh) | 一种用于卫星快速姿态机动的饱和滑模变结构控制方法 | |
CN109911250B (zh) | 一种磁测磁控速率阻尼的方法 | |
CN100559190C (zh) | 一种对加速度计零位偏差进行在轨标定的方法 | |
CN111098299B (zh) | 一种空间机器人扰动补偿的方法 | |
CN113955152B (zh) | 一种星体对日定向控制方法 | |
CN110816897A (zh) | 一种基于cmg系统的多模式转换控制方法 | |
CN108759589A (zh) | 一种旋转导弹制导控制解耦合的方法及装置 | |
CN103808323A (zh) | 一种卫星姿态跟踪机动的余弦过渡加速度路径方法 | |
CN103486905A (zh) | 一种再入飞行器末制导交班条件确定方法 | |
CN109677638B (zh) | 一种基于地磁场测量参数的改进的纯磁控自旋对日定向方法 | |
CN110282121A (zh) | 坐标系转换方法、其装置、飞行器航向控制方法及飞行器 | |
CN114229038A (zh) | 一种基于j2摄动主动利用的编队构形重构控制方法 | |
CN114043479A (zh) | 一种误差矫正的地坪磨抛机器人轨迹纠偏方法及装置 | |
CN110803304A (zh) | 一种卫星姿态控制系统 | |
CN111323049A (zh) | 一种粒子群算法的粗对准方法 | |
CN102880049B (zh) | 一种基于帆板挠性形变测量的自适应振动控制方法 | |
CN109774977A (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 |