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

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

Info

Publication number
CN113479353B
CN113479353B CN202110796770.1A CN202110796770A CN113479353B CN 113479353 B CN113479353 B CN 113479353B CN 202110796770 A CN202110796770 A CN 202110796770A CN 113479353 B CN113479353 B CN 113479353B
Authority
CN
China
Prior art keywords
speed
interval
acceleration
deceleration
constant
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
Application number
CN202110796770.1A
Other languages
English (en)
Other versions
CN113479353A (zh
Inventor
蔡华祥
吴兴校
李彬
陈星宇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guizhou Aerospace Linquan Motor Co Ltd
Original Assignee
Guizhou Aerospace Linquan Motor Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Guizhou Aerospace Linquan Motor Co Ltd filed Critical Guizhou Aerospace Linquan Motor Co Ltd
Priority to CN202110796770.1A priority Critical patent/CN113479353B/zh
Publication of CN113479353A publication Critical patent/CN113479353A/zh
Application granted granted Critical
Publication of CN113479353B publication Critical patent/CN113479353B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/66—Arrangements or adaptations of apparatus or instruments, not otherwise provided for

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Navigation (AREA)

Abstract

本发明涉及一种基于速度规划的卫星转台路径规划方法，通过对转台四个区间的速度轨迹分别规划，其中两个有效观测区间以***要求的恒定速度运行，其余两个无效观测区间变速运行，变速区间的起点速度和终点速度分别为匀速区间的速度。本发明通过规划两个变速区间的速度及加速度，从而可保证***每个周期运行的时间能够严格保持一致，对地观测区间速度保持恒定。

Description

一种基于速度规划的卫星转台路径规划方法
技术领域
本发明涉及一种基于速度规划的卫星转台路径规划方法，属于转台伺服控制技术领域。
背景技术
随着航空航天领域各方面技术的快速发展，人们对空间领域的探测需求不断增加，探测的难度也在逐渐加大。在探测任务中，常用的探测方式通常是通过卫星或者飞船搭载不同的载荷，如雷达、天线、微波辐射计、光学仪器等。
通过控制卫星上搭载的伺服扫描机构其运行的转速、角度来调节雷达、光学仪器的姿态，从而实现准确的定位及对地观测。此外，由于空间伺服扫描机构通常执行的是周期性的扫描任务，在执行过程中，要求严格控制每个周期的扫描时间、扫描转速等，因此，在实现高质量的探测任务时，需要保证高响应、高精度、高稳定的驱动控制性能。
卫星转台在执行任务过程中是以固定的频率周期性地执行相同的运动轨迹，在每个完整的运动轨迹内，必须确保其在对地观测内的两段轨迹内的速度保持匀速，因此，本申请主要针对空间机构变速扫描任务的需求，根据卫星转台的不同的扫描方式，研究了***路径规划算法，提出了一种基于速度规划的卫星转台路径规划方法。
发明内容
为解决上述技术问题，本发明提供了一种基于速度规划的卫星转台路径规划方法。
本发明通过以下技术方案得以实现。
本发明提供的一种基于速度规划的卫星转台路径规划方法，卫星转台执行任务过程中，以固定周期T重复执行相同的扫描任务，每个完整的执行周期为0°到360°，分为四个不同的执行区间；
其中两个执行区间为有效观测区间，卫星转台匀速运行；另外两个执行区间为无效观测区间，卫星转台变速运行，初始速度和结束速度为匀速区间的运行速度。
卫星转台在运动过程中，四个不同的执行区间分别为：第一区间：0°～θ1，为有效区间，称为匀速区间，速度为v1；第二区间：θ1～θ2，为无效区间，称为变速区间；第三区间：θ2～θ3，为有效区间，称为匀速区间，速度为v2；第四区间：θ3～360°，为无效区间，称为变速区间。
每个周期内速度路径规划算法分为六段。
所述的速度路径规划算法包括以下步骤：
①第一区间为匀速区间，运行速度为v1，执行时间t为
Figure BDA0003163067740000021
则第一区间的速度规划为：
Figure BDA0003163067740000022
②第二区间为变速区间，规划为两段速度运行，匀加速和匀减速；
第二区间加速段的起始速度为v1，加速度为a1，加速时间为t1，则第二区间加速段的速度规划为：
Figure BDA0003163067740000031
第二区间减速段的结束速度为v2，减速度为a2，减速时间为t2。则第二区间减速段的速度规划为：
Figure BDA0003163067740000032
③第三区间为匀速区间，运行速度为v2，执行时间为t∈[(θ1/v1)+t1+t2,(θ1/v1)+t1+t2+((θ3-θ2)/v2))]，则第三区间的速度规划为：
Figure BDA0003163067740000033
④第四区间为变速区间，轨迹同样规划为两段速度运行，匀加速和匀减速；
第四区间加速段的起始速度为v2，加速度为a3，加速时间为t3，则第四区间加速段的速度规划为：
Figure BDA0003163067740000034
第四区间减速段的结束速度为v1，减速度为a4，，减速时间为t4，则第四区间减速段的速度规划为：
Figure BDA0003163067740000041
本发明的有益效果在于：通过规划两个变速区间的速度及加速度，从而可保证***每个周期运行的时间能够严格保持一致，对地观测区间速度保持恒定。
附图说明
图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°/s2，加速时间为0.136s。则第二区间加速段的速度规划为：
v＝20+5426*(t-0.2),t∈(0.2s,0.336s]；
(3)第二区间减速段的结束速度为66°/s，减速度为5661°/s2，减速时间为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°/s2，加速时间为0.14s，则第四区间加速段的速度规划为：
v＝66+4943(t-2.46),t∈[2.46s,2.6s]；
(6)第四区间减速段的结束速度为20°/s，减速度为4613°/s2，减速时间为0.16s。则第四区间减速段的速度规划为：
v＝758.5-4613*(t-2.6),t∈(2.6s,2.76s]。

Claims (2)

1.一种基于速度规划的卫星转台路径规划方法，其特征在于：卫星转台执行任务过程中，以固定周期T重复执行相同的扫描任务，每个完整的执行周期为0°到360°，分为四个不同的执行区间；
其中两个执行区间为有效观测区间，卫星转台匀速运行；另外两个执行区间为无效观测区间，卫星转台变速运行，初始速度和结束速度为匀速区间的运行速度；
每个周期内速度路径规划算法分为六段；
所述的速度路径规划算法包括以下步骤：
①第一区间为匀速区间，运行速度为v1，执行时间t为
Figure FDA0003748018190000011
θ1为第一区间匀速运行的运行角度，则第一区间的速度规划为：
V＝v1，
Figure FDA0003748018190000012
②第二区间为变速区间，规划为两段速度运行，匀加速和匀减速；
第二区间加速段的起始速度为v1，加速度为a1，加速时间为t1，则第二区间加速段的速度规划为：
Figure FDA0003748018190000013
第二区间减速段的结束速度为v2，减速度为a2，减速时间为t2，则第二区间减速段的速度规划为：
Figure FDA0003748018190000021
③第三区间为匀速区间，运行速度为v2，执行时间为t∈[(θ1/v1)+t1+t2，(θ1/v1)+t1+t2+(θ3-θ2)/v2]，θ2为第二区间减速运行的运行角度，θ3为第三区间匀速运行的运行角度，则第三区间的速度规划为：
Figure FDA0003748018190000022
④第四区间为变速区间，轨迹同样规划为两段速度运行，匀加速和匀减速；
第四区间加速段的起始速度为V2，加速度为a3，加速时间为t3，则第四区间加速段的速度规划为：
Figure FDA0003748018190000023
第四区间减速段的结束速度为v1，减速度为a4，减速时间为t4，则第四区间减速段的速度规划为：
Figure FDA0003748018190000031
。
2.如权利要求1所述的基于速度规划的卫星转台路径规划方法，其特征在于：卫星转台在运动过程中，四个不同的执行区间分别为：第一区间：0°～θ1，为有效区间，称为匀速区间，速度为v1；第二区间：θ1～θ2，为无效区间，称为变速区间；第三区间：θ2～θ3，为有效区间，称为匀速区间，速度为v2；第四区间：θ3～360°，为无效区间，称为变速区间。
CN202110796770.1A 2021-07-14 2021-07-14 一种基于速度规划的卫星转台路径规划方法 Active CN113479353B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110796770.1A CN113479353B (zh) 2021-07-14 2021-07-14 一种基于速度规划的卫星转台路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110796770.1A CN113479353B (zh) 2021-07-14 2021-07-14 一种基于速度规划的卫星转台路径规划方法

Publications (2)

Publication Number Publication Date
CN113479353A CN113479353A (zh) 2021-10-08
CN113479353B true CN113479353B (zh) 2022-09-06

Family

ID=77939451

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110796770.1A Active CN113479353B (zh) 2021-07-14 2021-07-14 一种基于速度规划的卫星转台路径规划方法

Country Status (1)

Country Link
CN (1) CN113479353B (zh)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3730014A (en) * 1971-12-17 1973-05-01 J Brems Rotary indexing mechanism
EP1037114A2 (en) * 1999-03-09 2000-09-20 Canon Kabushiki Kaisha Stage control method, exposure method, exposure apparatus and device manufacturing method
JP2004153941A (ja) * 2002-10-31 2004-05-27 Mitsubishi Electric Corp 交流励磁形発電電動機の制御装置
CN105373143A (zh) * 2015-10-21 2016-03-02 中国科学院光电技术研究所 一种抑制风载荷扰动的大型天文望远镜高精度控制***及方法
CN111666661A (zh) * 2020-05-21 2020-09-15 武汉大学 敏捷卫星单轨动中成像多条带拼接任务规划方法及***
CN111811541A (zh) * 2020-07-31 2020-10-23 上海芯物科技有限公司 一种双轴转台***
CN111940850A (zh) * 2020-07-23 2020-11-17 天津职业技术师范大学(中国职业培训指导教师进修中心) 一种基于电子螺旋导轨的斜齿轮插齿加工方法
CN112666986A (zh) * 2020-11-25 2021-04-16 北京无线电测量研究所 一种天线伺服轨迹规划方法和***
CN113103240A (zh) * 2021-04-29 2021-07-13 哈尔滨工业大学 用于实现c2连续的机器人轨迹规划方法、装置及***

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19714221A1 (de) * 1997-04-07 1998-10-08 Zeiss Carl Fa Konfokales Mikroskop mit einem motorischen Scanningtisch
US6866557B2 (en) * 2002-07-02 2005-03-15 Mitch Randall Apparatus and method for producing ambulatory motion
JP4367467B2 (ja) * 2006-07-25 2009-11-18 セイコーエプソン株式会社 プリンタおよびプリンタの制御方法
US8050800B2 (en) * 2007-10-21 2011-11-01 Ge Intelligent Platforms, Inc. Method and system for meeting end conditions in a motion control system
CN201918952U (zh) * 2010-11-16 2011-08-03 凯迈(洛阳)电子有限公司 一种基于直线电机的摆动装置
CN103071826B (zh) * 2013-01-07 2015-07-15 深圳大学 一种高速高精多轴pcb数控钻床及其控制方法
WO2017113219A1 (zh) * 2015-12-30 2017-07-06 深圳配天智能技术研究院有限公司 折弯跟随轨迹规划方法、装置及***
CN109269504B (zh) * 2018-10-24 2021-04-13 北京控制工程研究所 一种具有末端约束的姿态机动路径规划方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3730014A (en) * 1971-12-17 1973-05-01 J Brems Rotary indexing mechanism
EP1037114A2 (en) * 1999-03-09 2000-09-20 Canon Kabushiki Kaisha Stage control method, exposure method, exposure apparatus and device manufacturing method
JP2004153941A (ja) * 2002-10-31 2004-05-27 Mitsubishi Electric Corp 交流励磁形発電電動機の制御装置
CN105373143A (zh) * 2015-10-21 2016-03-02 中国科学院光电技术研究所 一种抑制风载荷扰动的大型天文望远镜高精度控制***及方法
CN111666661A (zh) * 2020-05-21 2020-09-15 武汉大学 敏捷卫星单轨动中成像多条带拼接任务规划方法及***
CN111940850A (zh) * 2020-07-23 2020-11-17 天津职业技术师范大学(中国职业培训指导教师进修中心) 一种基于电子螺旋导轨的斜齿轮插齿加工方法
CN111811541A (zh) * 2020-07-31 2020-10-23 上海芯物科技有限公司 一种双轴转台***
CN112666986A (zh) * 2020-11-25 2021-04-16 北京无线电测量研究所 一种天线伺服轨迹规划方法和***
CN113103240A (zh) * 2021-04-29 2021-07-13 哈尔滨工业大学 用于实现c2连续的机器人轨迹规划方法、装置及***

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
伺服***运动轨迹规划研究简要综述;朱其新等;《苏州科技大学学报(自然科学版)》;20180915(第03期);全文 *
卫星导航***转台天线对北斗卫星全弧段连续跟踪技术研究;张之学等;《第五届中国卫星导航学术年会》;20140521;全文 *
望远镜中跟踪架的扰动补偿及精密控制技术研究;蔡华祥;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20160815;全文 *
永磁同步电机带霍尔及增量式编码器的伺服控制;蔡华祥等;《现代机械》;20180828(第04期);全文 *

Also Published As

Publication number Publication date
CN113479353A (zh) 2021-10-08

Similar Documents

Publication Publication Date Title
CN102999048A (zh) 一种车载动基座光电搜索跟踪转台的伺服控制方法
CN105008252A (zh) 改变闭环轨道上的列车车厢速度的方法和设备
CN105007012A (zh) 一种车载转台控制***及方法
CN111580453B (zh) 基于plc的提高二维圆弧插补轨迹精度的实现方法
CN111580520A (zh) 基于二维码导航的四轮转向agv轨迹纠偏方法
CN113479353B (zh) 一种基于速度规划的卫星转台路径规划方法
CN104714485A (zh) 一种新型高精度微量进给伺服***及控制方法
Yang et al. Smooth trajectory planning along Bezier curve for mobile robots with velocity constraints
CN111347422B (zh) 一种提高机器人关节精度的控制方法
EP0135772B1 (en) Operation control apparatus for robots
CN113532427B (zh) 一种基于位置规划的卫星转台路径规划方法
CN104932251A (zh) 一种用于空间光学遥感器随动***的同步控制方法
CN113568442A (zh) 一种对星控制***及方法
CN111590570B (zh) 一种同步交叉耦合机器人轮廓控制方法
CN111251303B (zh) 一种周期性姿态调整的机器人运动控制方法
CN115343949B (zh) 一种固定翼无人机跟踪制导律设计方法及验证平台
CN109116845B (zh) 自动导引运输车定位方法、定位***及自动导引运输***
CN113867423A (zh) 一种伺服转台方位角度跟踪控制方法及装置
KR20230056225A (ko) 차동 구동형 이동로봇의 운동역학을 고려한 장애물 회피 및 경로 추종방법
CN106919185A (zh) 基于Dubins曲线的稳定平台位置伺服控制方法
CN116048146B (zh) 面向旋转光纤陀螺惯导的角速度平滑控制方法
CN115946121B (zh) 一种用于机械臂基于动态规划的传送带跟踪方法
CN118034387A (zh) 一种摆扫平台***及其控制方法
CN116812171B (zh) 一种轨道飞行器姿轨耦合矢量控制***和方法
CN113601008A (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