阅读说明：本技术 一种基于速度规划的卫星转台路径规划方法 (Satellite turntable path planning method based on speed planning ) 是由 蔡华祥 吴兴校 李彬 陈星宇 于 2021-07-14 设计创作，主要内容包括：本发明涉及一种基于速度规划的卫星转台路径规划方法,通过对转台四个区间的速度轨迹分别规划,其中两个有效观测区间以系统要求的恒定速度运行,其余两个无效观测区间变速运行,变速区间的起点速度和终点速度分别为匀速区间的速度。本发明通过规划两个变速区间的速度及加速度,从而可保证系统每个周期运行的时间能够严格保持一致,对地观测区间速度保持恒定。(The invention relates to a satellite turntable path planning method based on speed planning, which is characterized in that speed tracks of four intervals of a turntable are respectively planned, wherein two effective observation intervals run at a constant speed required by a system, the other two ineffective observation intervals run at variable speeds, and the starting point speed and the end point speed of each variable speed interval are respectively the speeds of the constant speed intervals. The invention can ensure that the running time of each period of the system can be strictly kept consistent by planning the speed and the acceleration of the two speed change intervals, and the speed of the earth observation interval is kept constant.)

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

技术领域

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

技术领域

。

背景技术

随着航空航天领域各方面技术的快速发展，人们对空间领域的探测需求不断增加，探测的难度也在逐渐加大。在探测任务中，常用的探测方式通常是通过卫星或者飞船搭载不同的载荷，如雷达、天线、微波辐射计、光学仪器等。

通过控制卫星上搭载的伺服扫描机构其运行的转速、角度来调节雷达、光学仪器的姿态，从而实现准确的定位及对地观测。此外，由于空间伺服扫描机构通常执行的是周期性的扫描任务，在执行过程中，要求严格控制每个周期的扫描时间、扫描转速等，因此，在实现高质量的探测任务时，需要保证高响应、高精度、高稳定的驱动控制性能。

卫星转台在执行任务过程中是以固定的频率周期性地执行相同的运动轨迹，在每个完整的运动轨迹内，必须确保其在对地观测内的两段轨迹内的速度保持匀速，因此，本申请主要针对空间机构变速扫描任务的需求，根据卫星转台的不同的扫描方式，研究了系统路径规划算法，提出了一种基于速度规划的卫星转台路径规划方法。

发明内容

为解决上述技术问题，本发明提供了一种基于速度规划的卫星转台路径规划方法。

本发明通过以下技术方案得以实现。

本发明提供的一种基于速度规划的卫星转台路径规划方法，卫星转台执行任务过程中，以固定周期T重复执行相同的扫描任务，每个完整的执行周期为0°到360°，分为四个不同的执行区间；

其中两个执行区间为有效观测区间，卫星转台匀速运行；另外两个执行区间为无效观测区间，卫星转台变速运行，初始速度和结束速度为匀速区间的运行速度。

卫星转台在运动过程中，四个不同的执行区间分别为：第一区间：0°～θ₁，为有效区间，称为匀速区间，速度为v₁；第二区间：θ₁～θ₂，为无效区间，称为变速区间；第三区间：θ₂～θ₃，为有效区间，称为匀速区间，速度为v₂；第四区间：θ₃～360°，为无效区间，称为变速区间。

每个周期内速度路径规划算法分为六段。

所述的速度路径规划算法包括以下步骤：

①第一区间为匀速区间，运行速度为v₁，执行时间t为则第一区间的速度规划为：

②第二区间为变速区间，规划为两段速度运行，匀加速和匀减速；

第二区间加速段的起始速度为v₁，加速度为a₁，加速时间为t₁，则第二区间加速段的速度规划为：

第二区间减速段的结束速度为v₂，减速度为a₂，减速时间为t₂。则第二区间减速段的速度规划为：

③第三区间为匀速区间，运行速度为v₂，执行时间为t∈[(θ₁/v₁)+t₁+t₂,(θ₁/v₁)+t₁+t₂+((θ₃-θ₂)/v₂))]，则第三区间的速度规划为：

④第四区间为变速区间，轨迹同样规划为两段速度运行，匀加速和匀减速；

第四区间加速段的起始速度为v₂，加速度为a₃，加速时间为t₃，则第四区间加速段的速度规划为：

第四区间减速段的结束速度为v₁，减速度为a₄，，减速时间为t₄，则第四区间减速段的速度规划为：

本发明的有益效果在于：通过规划两个变速区间的速度及加速度，从而可保证系统每个周期运行的时间能够严格保持一致，对地观测区间速度保持恒定。

附图说明

图1是本发明一个扫描时间周期T内的速度规划曲线；

图2是本发明一个扫描角度周期内的速度曲线。

具体实施方式

下面进一步描述本发明的技术方案，但要求保护的范围并不局限于所述。

如图1和图2所示，卫星转台执行任务过程中，以2.76ms的固定周期重复执行相同的扫描任务；每个完整的执行周期为0°到360°，分为四个不同的执行区间；其中两个执行区间为有效观测区间，要求转台必须匀速运行；另外两个执行区间为无效观测区间，但初始速度和结束速度必须为匀速区间的执行速度。

其次，卫星转台在运动过程中四个不同的执行区间分别为：第一区间是358°到2°的范围，为有效区间，即匀速区间，速度为20°/s；第二区间是2°到106°的范围，为无效区间，即变速区间；第三区间是106°到238°的范围，为有效区间，即匀速区间，速度为66°/s；第四区间是238°到358°的范围，为无效区间，即变速区间。

最后，每个周期内速度路径规划算法分为六段。速度路径规划算法如下：

(1)第一区间为匀速区间，运行速度为20°/s，执行时间为0.2s，则第一区间的速度规划为：

v＝20°/s,t∈[0,0.2s]；

(2)第二区间为变速区间，规划为两段速度运行，匀加速和匀减速运行。加速段的起始速度为20°/s，加速度为5426°/s²，加速时间为0.136s。则第二区间加速段的速度规划为：

v＝20+5426*(t-0.2),t∈(0.2s,0.336s]；

(3)第二区间减速段的结束速度为66°/s，减速度为5661°/s²，减速时间为0.124s。则第二区间减速段的速度规划为：

v＝757.9-5661*(t-0.336),t∈(0.336s,0.46s]；

(4)第三区间为匀速区间，运行速度为66°/s，执行时间为t∈[0.46s,2.46s]，则第三区间的速度规划为：

v＝66°/s,t∈(0.46s,2.46s]；

(5)第四区间的速度为为变速区间，同样规划为两段速度运行，匀加速和匀减速运行。加速段的起始速度为66°/s，加速度为4943°/s²，加速时间为0.14s，则第四区间加速段的速度规划为：

v＝66+4943(t-2.46),t∈[2.46s,2.6s]；

(6)第四区间减速段的结束速度为20°/s，减速度为4613°/s²，减速时间为0.16s。则第四区间减速段的速度规划为：

v＝758.5-4613*(t-2.6),t∈(2.6s,2.76s]。