CN104960674B - 一种运动目标的指向跟踪控制方法 - Google Patents
一种运动目标的指向跟踪控制方法 Download PDFInfo
- Publication number
- CN104960674B CN104960674B CN201510293998.3A CN201510293998A CN104960674B CN 104960674 B CN104960674 B CN 104960674B CN 201510293998 A CN201510293998 A CN 201510293998A CN 104960674 B CN104960674 B CN 104960674B
- Authority
- CN
- China
- Prior art keywords
- satellite
- attitude
- moving target
- sequence
- axle
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种运动目标的指向跟踪控制方法，根据运动目标的方向，结合卫星对运动目标的指向轴，以姿态的两次旋转获取卫星的目标姿态，由此得到在跟踪任务时间内卫星的目标姿态序列；再将相邻时刻卫星的目标姿态以最短路径做机动规划，获得卫星的目标角速度序列；同时控制卫星的姿态和角速度，在控制过程中利用卫星目标角速度计算出前馈力矩，增强控制器响应速度，提高控制精度。利用本发明可以控制卫星的指向轴完成对运动目标进行跟踪。
Description
技术领域
本发明涉及一种运动目标的指向跟踪控制方法，属于卫星控制领域。
背景技术
卫星利用姿态机动控制卫星指向的技术是个新领域，利用姿态机动使得卫星指向对运动目标进行跟踪的技术还未见报道。
发明内容
本发明解决的技术问题为：克服现有技术不足，提供一种运动目标的指向跟踪控制方法，同时控制卫星的姿态和角速度，在控制过程中利用卫星目标角速度计算出前馈力矩，增强控制器响应速度，提高控制精度。利用本发明可以控制卫星的指向轴完成对运动目标进行跟踪。
本发明解决的技术方案为：一种运动目标的指向跟踪控制方法，包括确定目标姿态四元数序列阶段、确定目标姿态角速度序列阶段和利用比例、微分、前馈进行控制阶段；
所述的确定目标姿态四元数序列阶段步骤如下：
(1)运动目标在卫星轨道坐标系O-XoYoZo中的运动，形成了一个时域上的视线方向序列，包括了各个时刻运动目标的视线方向；跟踪运动目标的载荷安装在卫星本体坐标系的Xb轴或Yb轴或Zb轴上，将安装有跟踪运动目标的载荷的卫星本体轴作为卫星向运动目标的指向轴；
(2)选择卫星目标姿态的转序，该转序为第一次和第二次将安装有跟踪运动目标的载荷的卫星本体轴以外的两个卫星本体轴先转动，第三次转动卫星向运动目标的指向轴，使卫星向运动目标的指向轴指向运动目标；建立一个目标姿态坐标系O-XTYTZT，目标姿态坐标系原点O为卫星质心，将卫星向运动目标的指向轴作为ZT，根据ZT和卫星目标姿态的转序，确定目标姿态坐标系的XT轴和YT轴；
(3)计算步骤(2)的卫星目标姿态坐标系相对于卫星轨道坐标系的姿态角，即卫星第一次转动和第二次转动的姿态角根据步骤(1)运动目标的视线方向和步骤(2)卫星目标姿态的转序计算，第三次转动的姿态角置为0；根据这三个姿态角得到卫星的目标姿态，再根据卫星的目标姿态计算出该时刻相应的目标姿态四元数；
(4)根据步骤(3)计算得到的目标姿态四元数，按照时间顺序排列，得到目标姿态四元数序列[qmO(t0),…qmO(tk),…,qmO(tend)]，t0为卫星对运动目标的指向跟踪过程的初始时刻，tk为卫星对运动目标的指向跟踪过程中的某时刻，tend为卫星对运动目标的指向跟踪过程的结束时刻，qmO(t)为t时刻的目标姿态四元数；
所述的确定目标姿态角速度序列阶段步骤如下：
(5)对步骤(4)的目标姿态四元数序列中相邻时刻的目标姿态四元数进行差分计算，得到每个时刻卫星的目标角速度；
(6)将步骤(5)的每个时刻卫星的目标角速度按照时间顺序排列，得到目标姿态角速度序列[ωmO(t0),…ωmO(tk),…,ωmO(tend)]，ωmO(t)为t时刻的目标姿态角速度；
所述的利用比例、微分、前馈进行控制阶段步骤如下：
(7)根据步骤(4)的目标姿态四元数序列和步骤(6)的目标姿态角速度序列，结合卫星当前的姿态四元数和姿态角速度，按照比例+微分+前馈控制算法设计控制器。
本发明与现有技术的优点在于
(1)本发明同时控制卫星的姿态和角速度，在控制过程中利用卫星目标角速度计算出前馈力矩，增强控制器响应速度，提高控制精度。利用本发明可以控制卫星的指向轴完成对运动目标进行跟踪。
(2)本发明的步骤(7)可以提供较大带宽的控制器，且用前馈可以进一步提高控制器的动态响应速度。
附图说明
图1为本发明的卫星目标姿态的示意图；
图2为本发明利用卫星目标姿态四元数求解卫星目标姿态角速度的示意图；
图3为本发明的流程图；
图4为本发明的效果说明，在跟踪运动目标的过程中利用本发明控制的卫星的姿态角曲线；
图5为本发明的效果说明，在跟踪运动目标的过程中利用本发明控制的卫星的姿态角速度曲线；
图6为本发明的效果说明，在跟踪运动目标的过程中利用本发明控制的卫星的指向轴指向目标方向的误差曲线。
具体实施方式
本发明的基本思路为：提供一种运动目标的指向跟踪控制方法，该方法首先根据运动目标的运动轨迹，规划出卫星目标姿态四元数的时间序列，相邻时刻的四元数之间的机动按绕特征主轴最短路径进行机动规划，控制过程中同时考虑姿态误差和角速度误差，控制器设计引入前馈力矩增加响应速度，从而实现卫星对运动目标的指向跟踪的精确控制。
下面结合附图对本发明做进一步详细描述。
一种运动目标的指向跟踪控制方法，包括确定目标姿态四元数序列阶段、确定目标姿态角速度序列阶段和利用比例+微分+前馈进行控制阶段，
所述的确定目标姿态四元数序列阶段步骤如下：
(1)运动目标在卫星轨道坐标系O-XoYoZo中的运动，形成了一个时域上的视线方向序列，包括了各个时刻运动目标的视线方向；跟踪运动目标的载荷安装在卫星本体坐标系的Xb轴或Yb轴或Zb轴上，将安装有跟踪运动目标的载荷的卫星本体轴作为卫星向运动目标的指向轴；
(2)选择卫星目标姿态的转序，该转序为第一次和第二次将安装有跟踪运动目标的载荷的卫星本体轴以外的两个卫星本体轴先转动，第三次转动卫星向运动目标的指向轴，使卫星向运动目标的指向轴指向运动目标；如图1所示，建立一个目标姿态坐标系O-XTYTZT，卫星质心为目标姿态坐标系原点O，ZT为卫星向运动目标的指向轴，XT轴和YT轴则根据ZT和卫星目标姿态的转序进行确定；
(3)计算步骤(2)的卫星目标姿态坐标系相对于卫星轨道坐标系的姿态角，即卫星第一次转动和第二次转动的姿态角根据步骤(1)运动目标的视线方向和步骤(2)卫星目标姿态的转序计算，第三次转动的姿态角置为0；根据这三个姿态角得到卫星的目标姿态，再根据卫星的目标姿态计算出该时刻相应的目标姿态四元数；下面给出一个算例表明目标姿态的计算过程：
定义Om为卫星向运动目标的指向，在卫星轨道坐标系的表示为其中Omx、Omy、Omz为Om在卫星轨道坐标系X轴、Y轴、Z轴的分量。
按照绕卫星本体坐标系的X轴、Y轴、Z轴顺序先后转动的方式为卫星目标姿态的转序，则根据卫星姿态动力学，可知卫星在该转序下目标姿态的姿态角为：
θm＝arcsin(Omx)、ψm＝0；
式中θm、ψm分别为卫星的目标姿态的滚动角、俯仰角、偏航角。根据卫星的目标姿态的滚动角、俯仰角、偏航角，可以得到卫星的目标姿态四元数qmO。
(4)根据步骤(3)计算得到的目标姿态四元数，按照时间顺序排列，得到目标姿态四元数序列[qmO(t0),…qmO(tk),…,qmO(tend)]，t0为卫星对运动目标的指向跟踪过程的初始时刻，tk为卫星对运动目标的指向跟踪过程中的某时刻，tend为卫星对运动目标的指向跟踪过程的结束时刻，qmO(t)为t时刻的目标姿态四元数；
所述的确定目标姿态角速度序列阶段步骤如下：
(5)对步骤(4)的目标姿态四元数序列中相邻时刻的目标姿态四元数进行差分计算，得到每个时刻卫星的目标角速度；计算方法如下：
不妨假设相邻时刻tk-1和tk对应的目标姿态四元数分别为qmO(tk-1)和qmO(tk)，则tk时刻卫星的目标姿态角速度应为以qmO(tk-1)为初始姿态、以qmO(tk)为结束姿态、绕特征主轴方向沿最短路径一次机动到位所需的目标角速度，如图2所示。则tk时刻卫星的目标角速度ωmO(tk)计算方法为：
式中Δt＝tk-tk-1，qmOi表示四元数qmO的第i个分量，其中第4个分量为标量。
(6)将步骤(5)的每个时刻卫星的目标角速度按照时间顺序排列，得到目标姿态角速度序列[ωmO(t0),…ωmO(tk),…,ωmO(tend)]，ωmO(t)为t时刻的目标姿态角速度；
所述的利用比例+微分+前馈进行控制阶段步骤如下：
(7)根据步骤(4)的目标姿态四元数序列和步骤(6)的目标姿态角速度序列，结合卫星当前的姿态四元数和姿态角速度，用如下(8)～(10)计算控制力矩：
(8)计算比例控制项如下：
首先计算误差姿态四元数qBT(tk)：式中qBT(tk)是tk时刻的误差姿态四元数，qbO(tk-1)是tk-1时刻卫星的姿态四元数；
其次取误差姿态四元数的矢量部分，记为qΔ(t)，则比例控制项的输出力矩Tp(tk)为：Tp(tk)＝Kp·qΔ(tk)，式中Kp为比例控制参数，例如，Kp可以取正数。
(9)计算微分控制项如下：
首先计算误差姿态角速度：ωΔ(tk)＝ωmO(tk)-ωbO(tk)，式中ωΔ(tk)是tk时刻的误差姿态角速度，ωbO(tk)是tk时刻的姿态角速度；则微分控制项的输出力矩Td(tk)为：Td(tk)＝Kd·ωΔ(tk)，式中Kd为微分控制参数，例如，Kd可以取正数。
(10)计算前馈控制项如下：
式中TL(tk)为前馈力矩，J为卫星转动惯量矩阵。
(11)卫星所需的控制力矩Tc(tk)为上述三项的合成，即
Tc(tk)＝Tp(tk)+Td(tk)+TL(tk)
本发明的效果：
以一个轨道高度为750km的太阳同步轨道卫星为例，轨道倾角为98°；运动目标在轨道坐标系的视线方向变化角速度为0.5°/s，卫星跟踪指向控制60秒，从数学仿真结果来看，指向控制控制精度优于0.1°。
按照前述指向跟踪控制算法，星体三轴姿态角、姿态角速度、卫星Z轴与目标的夹角曲线、卫星的指向轴指向目标方向的误差曲线如图4、图5、图6。由图4和图5可以看出，卫星的俯仰角及俯仰角速度变化较大，说明目标主要在卫星的俯仰方向上运动，卫星需要不断调整俯仰角以完成对目标的指向跟踪；由图6可以看出，在指向跟踪控制过程中，卫星指向轴与运动目标方向之间的夹角，即目标指向误差小于0.1°。
本发明未详细阐述部分属于本领域公知技术。
Claims (1)
1.一种运动目标的指向跟踪控制方法，其特征在于：包括确定目标姿态四元数序列阶段、确定目标姿态角速度序列阶段和利用比例、微分、前馈进行控制阶段，
所述的确定目标姿态四元数序列阶段步骤如下：
(1)运动目标在卫星轨道坐标系O-XoYoZo中的运动，形成了一个时域上的视线方向序列，包括了各个时刻运动目标的视线方向；跟踪运动目标的载荷安装在卫星本体坐标系的Xb轴或Yb轴或Zb轴上，将安装有跟踪运动目标的载荷的卫星本体轴作为卫星向运动目标的指向轴；
(2)选择卫星目标姿态的转序，该转序为第一次和第二次将安装有跟踪运动目标的载荷的卫星本体轴以外的两个卫星本体轴先转动，第三次转动卫星向运动目标的指向轴，使卫星向运动目标的指向轴指向运动目标；建立一个目标姿态坐标系O-XTYTZT，目标姿态坐标系原点O为卫星质心，将卫星向运动目标的指向轴作为ZT，根据ZT和卫星目标姿态的转序，确定目标姿态坐标系的XT轴和YT轴；
(3)计算步骤(2)的卫星目标姿态坐标系相对于卫星轨道坐标系的姿态角，即卫星第一次转动和第二次转动的姿态角根据步骤(1)运动目标的视线方向和步骤(2)卫星目标姿态的转序计算，第三次转动的姿态角置为0；根据这三个姿态角得到卫星的目标姿态，再根据卫星的目标姿态计算出该时刻相应的目标姿态四元数；
(4)根据步骤(3)计算得到的目标姿态四元数，按照时间顺序排列，得到目标姿态四元数序列[qmO(t0),…qmO(tk),…,qmO(tend)]，t0为卫星对运动目标的指向跟踪过程的初始时刻，tk为卫星对运动目标的指向跟踪过程中的某时刻，tend为卫星对运动目标的指向跟踪过程的结束时刻，qmO(t)为t时刻的目标姿态四元数；
所述的确定目标姿态角速度序列阶段步骤如下：
(5)对步骤(4)的目标姿态四元数序列中相邻时刻的目标姿态四元数进行差分计算，得到每个时刻卫星的目标角速度；
(6)将步骤(5)的每个时刻卫星的目标角速度按照时间顺序排列，得到目标姿态角速度序列[ωmO(t0),…ωmO(tk),…,ωmO(tend)]，ωmO(t)为t时刻的目标姿态角速度；
所述的利用比例、微分、前馈进行控制阶段步骤如下：
(7)根据步骤(4)的目标姿态四元数序列和步骤(6)的目标姿态角速度序列，结合卫星当前的姿态四元数和姿态角速度，按照比例+微分+前馈控制算法设计控制器。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510293998.3A CN104960674B (zh) | 2015-06-01 | 2015-06-01 | 一种运动目标的指向跟踪控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510293998.3A CN104960674B (zh) | 2015-06-01 | 2015-06-01 | 一种运动目标的指向跟踪控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104960674A CN104960674A (zh) | 2015-10-07 |
| CN104960674B true CN104960674B (zh) | 2017-03-08 |
Family
ID=54214821
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201510293998.3A Active CN104960674B (zh) | 2015-06-01 | 2015-06-01 | 一种运动目标的指向跟踪控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104960674B (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108820255A (zh) * | 2018-06-20 | 2018-11-16 | 北京控制工程研究所 | 一种动目标跟瞄的三超控制全物理验证***及方法 |
Families Citing this family (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105867435A (zh) * | 2016-05-11 | 2016-08-17 | 西北工业大学 | 一种卫星光学载荷的平稳指向机动控制方法 |
| CN107436599A (zh) * | 2016-05-26 | 2017-12-05 | 北京空间技术研制试验中心 | 近距离在轨操作航天器的敏捷运动规划方法 |
| CN109911248B (zh) * | 2019-03-19 | 2020-11-27 | 湖南航升卫星科技有限公司 | 天基空间运动目标跟踪指向卫星姿态控制方法及*** |
| CN110450982B (zh) * | 2019-08-14 | 2021-04-06 | 上海卫星工程研究所 | 空间扫描机构的角动量前馈补偿方法及补偿*** |
| CN111605737B (zh) * | 2020-05-11 | 2021-10-01 | 北京控制工程研究所 | 一种航天器三超控制多级协同规划与敏捷机动方法 |
| CN112124632B (zh) * | 2020-09-22 | 2022-06-24 | 上海航天控制技术研究所 | 激光载荷调整角度饱和的卫星平台卸载方法 |
| CN112498743B (zh) * | 2020-10-23 | 2022-12-02 | 中国人民解放军战略支援部队航天工程大学 | 一种基于前馈与反馈的卫星姿态跟踪控制器 |
| CN113190028B (zh) * | 2021-03-31 | 2023-05-09 | 北京控制工程研究所 | 一种敏捷卫星指向控制方法及*** |
| CN113405554A (zh) * | 2021-06-29 | 2021-09-17 | 东风汽车集团股份有限公司 | 基于卫星定位***的车辆姿态计算方法 |
| CN113525720B (zh) * | 2021-07-27 | 2022-01-28 | 北京微纳星空科技有限公司 | 一种航天器目标姿态的确定方法、装置、设备及存储介质 |
| CN113830330B (zh) * | 2021-09-30 | 2023-08-29 | 北京控制工程研究所 | 一种基于中继星测控的卫星姿态指向方法和*** |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3623747B2 (ja) * | 2001-03-19 | 2005-02-23 | 日本電気航空宇宙システム株式会社 | 三軸衛星の姿勢変更制御方式 |
| CN100363851C (zh) * | 2004-11-26 | 2008-01-23 | 清华大学 | 航天器大角度机动控制的单框架力矩陀螺群的最优控制法 |
| CN103268067B (zh) * | 2013-05-03 | 2016-02-10 | 哈尔滨工业大学 | 一种基于拟四元数与拟四元数运动学方程的卫星指向跟踪控制方法 |
| CN104249816B (zh) * | 2013-06-27 | 2017-12-19 | 上海新跃仪表厂 | 非合作目标绕飞悬停的姿轨协同控制方法 |
| CN104527994B (zh) * | 2015-01-21 | 2016-08-24 | 哈尔滨工业大学 | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 |
-
2015
- 2015-06-01 CN CN201510293998.3A patent/CN104960674B/zh active Active
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108820255A (zh) * | 2018-06-20 | 2018-11-16 | 北京控制工程研究所 | 一种动目标跟瞄的三超控制全物理验证***及方法 |
| CN108820255B (zh) * | 2018-06-20 | 2020-04-10 | 北京控制工程研究所 | 一种动目标跟瞄的三超控制全物理验证***及方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104960674A (zh) | 2015-10-07 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104960674B (zh) | 一种运动目标的指向跟踪控制方法 | |
| CN106292287B (zh) | 一种基于自适应滑模控制的uuv路径跟踪方法 | |
| CN102163057B (zh) | 一种自治飞艇平面路径跟踪控制方法 | |
| CN107807657B (zh) | 一种基于路径规划的挠性航天器姿态自适应控制方法 | |
| CN106275508B (zh) | 一种卫星绕空间轴的最短路径姿态机动控制方法 | |
| CN106444822B (zh) | 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法 | |
| JP6989252B2 (ja) | エネルギー効率に優れた衛星の操縦 | |
| CN110347170B (zh) | 可重复使用运载器再入段鲁棒容错制导控制***及工作方法 | |
| CN103955223B (zh) | 一种深空探测软着陆过程的姿轨耦合控制方法 | |
| CN105045284B (zh) | 一种抗干扰无人飞行器路径跟踪控制方法 | |
| CN104199303B (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
| CN106970530B (zh) | 空间非合作目标自主视线交会的无模型预设性能控制方法 | |
| CN105425812B (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
| CN104281150A (zh) | 一种姿态机动的轨迹规划方法 | |
| CN106354147B (zh) | 一种基于发动机预摆的大质心横移下的姿轨控耦合控制***与方法 | |
| CN105116914B (zh) | 一种平流层飞艇解析模型预测路径跟踪控制方法 | |
| CN112572835B (zh) | 一种具有姿态切换的卫星在轨角动量管理及控制方法 | |
| CN108227728A (zh) | 一种考虑混合执行机构切换的航天器姿态动态控制分配方法 | |
| CN112061424B (zh) | 一种基于融合目标姿态的机动过程能源角动态跟踪方法 | |
| CN108427429B (zh) | 一种考虑动态指向约束的航天器视轴机动控制方法 | |
| CN105094144A (zh) | 一种无人飞艇自适应抗风路径跟踪控制方法 | |
| CN110597274B (zh) | 一种适应姿态重定向的sgcmg动态框架角速度确定方法 | |
| CN103818564B (zh) | 一种采用小推力的航天器轨道维持与对地定向姿态保持一体化控制方法 | |
| CN104850128B (zh) | 一种用于具有大惯量积航天器的动量轮布局配置方法 | |
| Juan et al. | Path following backstepping control of underactuated unmanned underwater vehicle |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant |