一种基于速度规划的卫星转台路径规划方法与流程

1.本发明涉及一种基于速度规划的卫星转台路径规划方法，属于转台伺服控制技术领域。


背景技术：

2.随着航空航天领域各方面技术的快速发展，人们对空间领域的探测需求不断增加，探测的难度也在逐渐加大。在探测任务中，常用的探测方式通常是通过卫星或者飞船搭载不同的载荷，如雷达、天线、微波辐射计、光学仪器等。
3.通过控制卫星上搭载的伺服扫描机构其运行的转速、角度来调节雷达、光学仪器的姿态，从而实现准确的定位及对地观测。此外，由于空间伺服扫描机构通常执行的是周期性的扫描任务，在执行过程中，要求严格控制每个周期的扫描时间、扫描转速等，因此，在实现高质量的探测任务时，需要保证高响应、高精度、高稳定的驱动控制性能。
4.卫星转台在执行任务过程中是以固定的频率周期性地执行相同的运动轨迹，在每个完整的运动轨迹内，必须确保其在对地观测内的两段轨迹内的速度保持匀速，因此，本技术主要针对空间机构变速扫描任务的需求，根据卫星转台的不同的扫描方式，研究了系统路径规划算法，提出了一种基于速度规划的卫星转台路径规划方法。


技术实现要素：

5.为解决上述技术问题，本发明提供了一种基于速度规划的卫星转台路径规划方法。
6.本发明通过以下技术方案得以实现。
7.本发明提供的一种基于速度规划的卫星转台路径规划方法，卫星转台执行任务过程中，以固定周期t重复执行相同的扫描任务，每个完整的执行周期为0
°
到360
°
，分为四个不同的执行区间；
8.其中两个执行区间为有效观测区间，卫星转台匀速运行；另外两个执行区间为无效观测区间，卫星转台变速运行，初始速度和结束速度为匀速区间的运行速度。
9.卫星转台在运动过程中，四个不同的执行区间分别为：第一区间：0
°
～θ1，为有效区间，称为匀速区间，速度为v1；第二区间：θ1～θ2，为无效区间，称为变速区间；第三区间：θ2～θ3，为有效区间，称为匀速区间，速度为v2；第四区间：θ3～360
°
，为无效区间，称为变速区间。
10.每个周期内速度路径规划算法分为六段。
11.所述的速度路径规划算法包括以下步骤：
12.①
第一区间为匀速区间，运行速度为v1，执行时间t为则第一区间的速度规划为：
[0013][0014]
②
第二区间为变速区间，规划为两段速度运行，匀加速和匀减速；
[0015]
第二区间加速段的起始速度为v1，加速度为a1，加速时间为t1，则第二区间加速段的速度规划为：
[0016][0017]
第二区间减速段的结束速度为v2，减速度为a2，减速时间为t2。则第二区间减速段的速度规划为：
[0018][0019]
③
第三区间为匀速区间，运行速度为v2，执行时间为t∈[(θ1/v1) t1 t2,(θ1/v1) t1 t2 ((θ3‑
θ2)/v2))]，则第三区间的速度规划为：
[0020][0021]
④
第四区间为变速区间，轨迹同样规划为两段速度运行，匀加速和匀减速；
[0022]
第四区间加速段的起始速度为v2，加速度为a3，加速时间为t3，则第四区间加速段的速度规划为：
[0023][0024]
第四区间减速段的结束速度为v1，减速度为a4，，减速时间为t4，则第四区间减速段的速度规划为：
[0025][0026]
本发明的有益效果在于：通过规划两个变速区间的速度及加速度，从而可保证系统每个周期运行的时间能够严格保持一致，对地观测区间速度保持恒定。
附图说明
[0027]
图1是本发明一个扫描时间周期t内的速度规划曲线；
[0028]
图2是本发明一个扫描角度周期内的速度曲线。
具体实施方式
[0029]
下面进一步描述本发明的技术方案，但要求保护的范围并不局限于所述。
[0030]
如图1和图2所示，卫星转台执行任务过程中，以2.76ms的固定周期重复执行相同的扫描任务；每个完整的执行周期为0
°
到360
°
，分为四个不同的执行区间；其中两个执行区间为有效观测区间，要求转台必须匀速运行；另外两个执行区间为无效观测区间，但初始速
度和结束速度必须为匀速区间的执行速度。
[0031]
其次，卫星转台在运动过程中四个不同的执行区间分别为：第一区间是358
°
到2
°
的范围，为有效区间，即匀速区间，速度为20
°
/s；第二区间是2
°
到106
°
的范围，为无效区间，即变速区间；第三区间是106
°
到238
°
的范围，为有效区间，即匀速区间，速度为66
°
/s；第四区间是238
°
到358
°
的范围，为无效区间，即变速区间。
[0032]
最后，每个周期内速度路径规划算法分为六段。速度路径规划算法如下：
[0033]
(1)第一区间为匀速区间，运行速度为20
°
/s，执行时间为0.2s，则第一区间的速度规划为：
[0034]
v＝20
°
/s,t∈[0,0.2s]；
[0035]
(2)第二区间为变速区间，规划为两段速度运行，匀加速和匀减速运行。加速段的起始速度为20
°
/s，加速度为5426
°
/s2，加速时间为0.136s。则第二区间加速段的速度规划为：
[0036]
v＝20 5426*(t
‑
0.2),t∈(0.2s,0.336s]；
[0037]
(3)第二区间减速段的结束速度为66
°
/s，减速度为5661
°
/s2，减速时间为0.124s。则第二区间减速段的速度规划为：
[0038]
v＝757.9
‑
5661*(t
‑
0.336),t∈(0.336s,0.46s]；
[0039]
(4)第三区间为匀速区间，运行速度为66
°
/s，执行时间为t∈[0.46s,2.46s]，则第三区间的速度规划为：
[0040]
v＝66
°
/s,t∈(0.46s,2.46s]；
[0041]
(5)第四区间的速度为为变速区间，同样规划为两段速度运行，匀加速和匀减速运行。加速段的起始速度为66
°
/s，加速度为4943
°
/s2，加速时间为0.14s，则第四区间加速段的速度规划为：
[0042]
v＝66 4943(t
‑
2.46),t∈[2.46s,2.6s]；
[0043]
(6)第四区间减速段的结束速度为20
°
/s，减速度为4613
°
/s2，减速时间为0.16s。则第四区间减速段的速度规划为：
[0044]
v＝758.5
‑
4613*(t
‑
2.6),t∈(2.6s,2.76s]。