CN113532427A - 一种基于位置规划的卫星转台路径规划方法 - Google Patents
一种基于位置规划的卫星转台路径规划方法 Download PDFInfo
- Publication number
- CN113532427A CN113532427A CN202110795164.8A CN202110795164A CN113532427A CN 113532427 A CN113532427 A CN 113532427A CN 202110795164 A CN202110795164 A CN 202110795164A CN 113532427 A CN113532427 A CN 113532427A
- Authority
- CN
- China
- Prior art keywords
- interval
- track
- speed
- section
- planned
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明涉及一种基于位置规划的卫星转台路径规划方法,通过对转台四个区间的位置轨迹分别规划,其中两个有效观测区间以系统要求的恒定速度运行,位置运行轨迹为固定斜率的直线;其余两个无效观测区间变速运行,位置运行轨迹分别为两段抛物线,共计六段位置轨迹规划。本发明通过规划两个变速区间的速度及加速度,从而可保证系统每个周期运行的时间能够严格保持一致,对地观测区间速度保持恒定。
Description
技术领域
本发明涉及一种基于位置规划的卫星转台路径规划方法,属于转台伺服控制技术领域。
背景技术
随着航空航天领域各方面技术的快速发展,人们对空间领域的探测需求不断增加,探测的难度也在逐渐加大。在探测任务中,常用的探测方式通常是通过卫星或者飞船搭载不同的载荷,如雷达、天线、微波辐射计、光学仪器等。
通过控制卫星上搭载的伺服扫描机构其运行的转速、角度来调节雷达、光学仪器的姿态,从而实现准确的定位及对地观测。此外,由于空间伺服扫描机构通常执行的是周期性的扫描任务,在执行过程中,要求严格控制每个周期的扫描时间、扫描转速等,因此,在实现高质量的探测任务时,需要保证高响应、高精度、高稳定的驱动控制性能。
卫星转台在执行任务过程中是以固定的频率周期性地执行相同的运动轨迹,在每个完整的运动轨迹内,必须确保其在对地观测内的两段轨迹内的速度保持匀速,因此,本申请主要针对空间机构变速扫描任务的需求,根据卫星转台的不同的扫描方式,研究了系统路径规划算法,提出了一种基于位置规划的卫星转台路径规划方法。
发明内容
为解决上述技术问题,本发明提供了一种基于位置规划的卫星转台路径规划方法。
本发明通过以下技术方案得以实现。
本发明提供的一种基于位置规划的卫星转台路径规划方法,卫星转台执行任务过程中,以固定周期T重复执行相同的扫描任务,每个完整的执行周期为0°到360°,分为四个不同的执行区间;
其中两个执行区间为有效观测区间,卫星转台匀速运行,位置运行轨迹为固定斜率的直线;另外两个执行区间为无效观测区间,卫星转台变速运行,初始速度和结束速度为匀速区间的运行速度,位置运行轨迹为抛物线。
卫星转台在运动过程中,四个不同的执行区间分别为:第一区间:0°~θ1,为有效区间,称为匀速区间Ⅰ,位置轨迹为固定斜率直线;第二区间:θ1~θ2,为无效区间,称为变速区间Ⅰ,位置轨迹为两段抛物线;第三区间:θ2~θ3,为有效区间,称为匀速区间Ⅱ,位置轨迹为固定斜率直线;第四区间:θ3~360°,为无效区间,称为变速区间Ⅱ,位置轨迹为两段抛物线。
每个周期T内位置路径规划算法分为六段。
所述位置路径规划算法包括以下步骤:
②第二区间为无效区间,规划为两段位置轨迹运行,分别为凹抛物线轨迹和凸抛物线轨迹;
第一段位置轨迹凹抛物线,起始速度为v1,加速度为a1,加速时间为t1,则第二区间第一段位置轨迹规划为:
第二区间第二段为凸抛物线轨迹,结束速度为v2,减速度为a2,减速时间为t2,则第二区间减速段的位置轨迹规划为:
③第三区间的位置为固定斜率直线轨迹,运行速度为v2,执行时间为t∈[(θ1/v1)+t1+t2,(θ1/v1)+t1+t2+((θ3-θ1-θ2)/v2))],则第三区间的位置轨迹规划为:
④第四区间为变速区间,轨迹同样规划为两段位置轨迹运行,凹抛物线轨迹和凸抛物线轨迹;
第一段位置轨迹为凹抛物线,起始速度为v2,加速度为a3,加速时间为t3,则第四区间的第一段位置轨迹规划为:
第四区间第二段为凸抛物线轨迹,结束速度为v1,减速度为a4,减速时间为t4,则第四区间第二段位置轨迹规划为:
本发明的有益效果在于:通过规划两个变速区间的速度及加速度,从而可保证系统每个周期运行的时间能够严格保持一致,对地观测区间速度保持恒定。
附图说明
图1是本发明一个扫描时间周期T内的位置规划曲线;
图2是本发明一个扫描角度周期内的速度曲线。
具体实施方式
下面进一步描述本发明的技术方案,但要求保护的范围并不局限于所述。
实施例1
如图1和图2所示,卫星转台执行任务过程中,以固定周期2.76ms重复执行相同的扫描任务;每个完整的执行周期为0°到360°,分为四个不同的执行区间;其中两个执行区间为有效观测区间,要求转台必须匀速运行;另外两个执行区间为无效观测区间,但初始速度和结束速度必须为匀速区间的执行速度;
其次,卫星转台在运动过程中四个不同的执行区间分别为:第一区间是0°到4°的范围,为有效区间,即匀速区间,速度为20°/s;第二区间是4°到108°的范围,为无效区间,即变速区间;第三区间是108°到240°的范围,为有效区间,即匀速区间,速度为66°/s;第四区间是240°到360°的范围,为无效区间,即变速区间。
最后,每个周期内位置路径规划算法分为六段,位置路径规划算法如下:
(1)第一区间的位置为固定斜率直线轨迹,运行速度为20°/s,执行时间为0.2s,则第一区间的位置轨迹规划为:
θ=20t,t∈[0,0.2s];
(2)第二区间为无效区间,规划为两段位置轨迹运行,凹抛物线轨迹和凸抛物线轨迹。第一段位置轨迹为凹抛物线,起始速度为20°/s,加速度为5426°/s2,加速时间为0.136s。则第二区间第一段位置轨迹规划为:
θ=20*(t-0.2)+2713*(t-0.2)2+4,t∈(0.2,0.336];
(3)第二区间第二段为凸抛物线轨迹,结束速度为66°/s,减速度为5661°/s2,减速时间为0.124s。则第二区间减速段的位置轨迹规划为:
θ=108-66*(0.46-t)-2831*(0.46-t)2,t∈(0.336,0.46];
(4)第三区间的位置为固定斜率直线轨迹,运行速度为66°/s,执行时间为t∈[0.46s,2.46s],则第三区间的位置轨迹规划为:
θ=66*(t-0.46)+108°,t∈(0.46s,2.46s];
(5)第四区间为变速区间,轨迹同样规划为两段位置轨迹运行,凹抛物线轨迹和凸抛物线轨迹。第一段位置轨迹为凹抛物线,起始速度为66°/s,加速度为4943°/s2,加速时间为0.14s,则第四区间的第一段位置轨迹规划为:
θ=240°+66*(t-2.46)+2472(t-2.46)2,t∈(2.46,2.6];
(6)第四区间第二段为凸抛物线轨迹,结束速度为20°/s,减速度为4613°/s2,减速时间为0.16s。则第四区间第二段位置轨迹规划为:
θ=360°-20*(2.76-t)-2307(2.76-t)2,t∈(2.6,2.76]。
Claims (4)
1.一种基于位置规划的卫星转台路径规划方法,其特征在于:卫星转台执行任务过程中,以固定周期T重复执行相同的扫描任务,每个完整的执行周期为0°到360°,分为四个不同的执行区间;
其中两个执行区间为有效观测区间,卫星转台匀速运行,位置运行轨迹为固定斜率的直线;另外两个执行区间为无效观测区间,卫星转台变速运行,初始速度和结束速度为匀速区间的运行速度,位置运行轨迹为抛物线。
2.如权利要求1所述的基于位置规划的卫星转台路径规划方法,其特征在于:卫星转台在运动过程中,四个不同的执行区间分别为:第一区间:0°~θ1,为有效区间,称为匀速区间I,位置轨迹为固定斜率直线;第二区间:θ1~θ2,为无效区间,称为变速区间I,位置轨迹为两段抛物线;第三区间:θ2~θ3,为有效区间,称为匀速区间II,位置轨迹为固定斜率直线;第四区间:θ3~360°,为无效区间,称为变速区间II,位置轨迹为两段抛物线。
3.如权利要求1所述的基于位置规划的卫星转台路径规划方法,其特征在于:每个周期T内位置路径规划算法分为六段。
4.如权利要求3所述的基于位置规划的卫星转台路径规划方法,其特征在于:所述位置路径规划算法包括以下步骤:
②第二区间为无效区间,规划为两段位置轨迹运行,分别为凹抛物线轨迹和凸抛物线轨迹;
第二区间的第一段位置为凹抛物线轨迹,起始速度为v1,加速度为a1,加速时间为t1,则第二区间加速段的第一段位置轨迹规划为:
第二区间的第二段位置为凸抛物线轨迹,结束速度为v2,减速度为a2,减速时间为t2,则第二区间减速段的第二段位置轨迹规划为:
③第三区间的位置为固定斜率直线轨迹,运行速度为v2,执行时间为t∈[(θ1/v1)+t1+t2,(θ1/v1)+t1+t2+((θ3-θ1-θ2)/v2))],则第三区间的位置轨迹规划为:
④第四区间为变速区间,轨迹同样规划为两段位置轨迹运行,凹抛物线轨迹和凸抛物线轨迹;
第四区间的第一段位置为凹抛物线轨迹,起始速度为v2,加速度为a3,加速时间为t3,则第四区间的第一段位置轨迹规划为:
第四区间的第二段位置为凸抛物线轨迹,结束速度为v1,减速度为a4,减速时间为t4,则第四区间的第二段位置轨迹规划为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110795164.8A CN113532427B (zh) | 2021-07-14 | 2021-07-14 | 一种基于位置规划的卫星转台路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110795164.8A CN113532427B (zh) | 2021-07-14 | 2021-07-14 | 一种基于位置规划的卫星转台路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113532427A true CN113532427A (zh) | 2021-10-22 |
CN113532427B CN113532427B (zh) | 2022-08-19 |
Family
ID=78099089
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110795164.8A Active CN113532427B (zh) | 2021-07-14 | 2021-07-14 | 一种基于位置规划的卫星转台路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113532427B (zh) |
Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3147477A (en) * | 1957-12-26 | 1964-09-01 | Gen Electric | Speed measuring system |
GB1336681A (en) * | 1971-04-02 | 1973-11-07 | Macmanus J | Turntable device |
US4618757A (en) * | 1983-09-06 | 1986-10-21 | Constructions Soudees Du Coteau | Method and apparatus for manufacturing large, metal cylindrical structures |
US20110304736A1 (en) * | 2010-06-15 | 2011-12-15 | Flir Systems, Inc. | Gimbal positioning with target velocity compensation |
CN103759592A (zh) * | 2013-12-20 | 2014-04-30 | 河北汉光重工有限责任公司 | 激光武器高精度转台跟踪技术 |
CN104129713A (zh) * | 2014-07-11 | 2014-11-05 | 浙江工业大学 | 一种离线的桥式吊车轨迹控制方法 |
CN107030697A (zh) * | 2017-04-28 | 2017-08-11 | 广州大学 | 一种机器人笛卡尔空间平滑轨迹的规划方法 |
US20170277192A1 (en) * | 2016-03-24 | 2017-09-28 | Honda Motor Co., Ltd. | System and method for trajectory planning for unexpected pedestrians |
CN108073185A (zh) * | 2017-11-30 | 2018-05-25 | 江西洪都航空工业集团有限责任公司 | 多无人机同时到达协同控制方法 |
CN109298682A (zh) * | 2018-11-16 | 2019-02-01 | 重庆邮电大学 | 一种基于抛物线插值算法的双机器人协同轨迹优化方法 |
CN110196590A (zh) * | 2019-04-23 | 2019-09-03 | 华南理工大学 | 一种用于机器人路径跟踪的时间最优轨迹规划系统及方法 |
CN110203422A (zh) * | 2019-05-31 | 2019-09-06 | 中国人民解放军63729部队 | 针对面目标区域探测的快速响应卫星轨道设计方法 |
DE102019134487A1 (de) * | 2019-01-28 | 2020-07-30 | GM Global Technology Operations LLC | System und verfahren einer algorithmischen lösung zum erzeugen einer glatten fahrzeuggeschwindigkeitstrajektorie für ein autonomes fahrzeug mit räumlichen geschwindigkeitsbegrenzungen |
CN111498150A (zh) * | 2020-03-27 | 2020-08-07 | 中国科学院西安光学精密机械研究所 | 一种星载大惯量旋转载荷角动量和力矩补偿方法及系统 |
US20210181740A1 (en) * | 2019-12-11 | 2021-06-17 | Baidu Usa Llc | Speed planning using a speed planning guideline for idle speed of autonomous driving vehicles |
CN113103240A (zh) * | 2021-04-29 | 2021-07-13 | 哈尔滨工业大学 | 用于实现c2连续的机器人轨迹规划方法、装置及系统 |
-
2021
- 2021-07-14 CN CN202110795164.8A patent/CN113532427B/zh active Active
Patent Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3147477A (en) * | 1957-12-26 | 1964-09-01 | Gen Electric | Speed measuring system |
GB1336681A (en) * | 1971-04-02 | 1973-11-07 | Macmanus J | Turntable device |
US4618757A (en) * | 1983-09-06 | 1986-10-21 | Constructions Soudees Du Coteau | Method and apparatus for manufacturing large, metal cylindrical structures |
US20110304736A1 (en) * | 2010-06-15 | 2011-12-15 | Flir Systems, Inc. | Gimbal positioning with target velocity compensation |
CN103759592A (zh) * | 2013-12-20 | 2014-04-30 | 河北汉光重工有限责任公司 | 激光武器高精度转台跟踪技术 |
CN104129713A (zh) * | 2014-07-11 | 2014-11-05 | 浙江工业大学 | 一种离线的桥式吊车轨迹控制方法 |
US20170277192A1 (en) * | 2016-03-24 | 2017-09-28 | Honda Motor Co., Ltd. | System and method for trajectory planning for unexpected pedestrians |
CN107030697A (zh) * | 2017-04-28 | 2017-08-11 | 广州大学 | 一种机器人笛卡尔空间平滑轨迹的规划方法 |
CN108073185A (zh) * | 2017-11-30 | 2018-05-25 | 江西洪都航空工业集团有限责任公司 | 多无人机同时到达协同控制方法 |
CN109298682A (zh) * | 2018-11-16 | 2019-02-01 | 重庆邮电大学 | 一种基于抛物线插值算法的双机器人协同轨迹优化方法 |
DE102019134487A1 (de) * | 2019-01-28 | 2020-07-30 | GM Global Technology Operations LLC | System und verfahren einer algorithmischen lösung zum erzeugen einer glatten fahrzeuggeschwindigkeitstrajektorie für ein autonomes fahrzeug mit räumlichen geschwindigkeitsbegrenzungen |
CN110196590A (zh) * | 2019-04-23 | 2019-09-03 | 华南理工大学 | 一种用于机器人路径跟踪的时间最优轨迹规划系统及方法 |
CN110203422A (zh) * | 2019-05-31 | 2019-09-06 | 中国人民解放军63729部队 | 针对面目标区域探测的快速响应卫星轨道设计方法 |
US20210181740A1 (en) * | 2019-12-11 | 2021-06-17 | Baidu Usa Llc | Speed planning using a speed planning guideline for idle speed of autonomous driving vehicles |
CN111498150A (zh) * | 2020-03-27 | 2020-08-07 | 中国科学院西安光学精密机械研究所 | 一种星载大惯量旋转载荷角动量和力矩补偿方法及系统 |
CN113103240A (zh) * | 2021-04-29 | 2021-07-13 | 哈尔滨工业大学 | 用于实现c2连续的机器人轨迹规划方法、装置及系统 |
Non-Patent Citations (6)
Title |
---|
CHENG HUAN等: ""An Improved JPDA-UKF Method Based on Motion Compensation"", 《TELECOMMUNICATION ENGINEERING》 * |
PARIS, J.F.等: ""Using Geostationary Operational Environmental Satellite (GOES) Visible-Infrared Spin-Scan Radiometer (VISSR) Data To Estimate The Spatial And Temporal Distribution Of Rainfall In Southern Mexico"", 《GEOSCIENCE AND REMOTE SENSING SYMPOSIUM, 1991. IGARSS 91. REMOTE SENSING: GLOBAL MONITORING FOR EARTH MANAGEMENT., INTERNATIONAL》 * |
吴兴校,等: ""基于MODBUS-RS485多路集成系统的快速通信"", 《现代机械》 * |
张亮等: ""星地量子通信光链路的建立与在轨验证"", 《中国科学:信息科学》 * |
朱其新等: ""伺服系统运动轨迹规划研究简要综述"", 《苏州科技大学学报(自然科学版)》 * |
李玉冰: ""摆动扫描式红外地球敏感器整机标定系统"", 《万方》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113532427B (zh) | 2022-08-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107263466B (zh) | 空间机器人基于二次规划问题的基座无扰控制方法 | |
CN111897357B (zh) | 一种卫星对地扫描的姿态跟踪控制方法 | |
CN111580520B (zh) | 基于二维码导航的四轮转向agv轨迹纠偏方法 | |
CN106956260B (zh) | 一种多关节机械臂平面蛇形轨迹运动的逆运动学求解方法 | |
CN111580453B (zh) | 基于plc的提高二维圆弧插补轨迹精度的实现方法 | |
CN111347422B (zh) | 一种提高机器人关节精度的控制方法 | |
CN113532427B (zh) | 一种基于位置规划的卫星转台路径规划方法 | |
CN114355962A (zh) | 时间约束下燃料最优的近距离顺光抵近与维持控制方法 | |
CN113479353B (zh) | 一种基于速度规划的卫星转台路径规划方法 | |
CN104932251A (zh) | 一种用于空间光学遥感器随动系统的同步控制方法 | |
CN113568442A (zh) | 一种对星控制系统及方法 | |
CN111251303B (zh) | 一种周期性姿态调整的机器人运动控制方法 | |
CN113867423B (zh) | 一种伺服转台方位角度跟踪控制方法及装置 | |
CN103422065B (zh) | 磁控溅射设备及磁控管控制方法 | |
CN115167429A (zh) | 一种移动机器人位置和姿态同时规划方法 | |
CN113031433B (zh) | 一种控制动中通伺服系统的方法和装置 | |
CN114089303A (zh) | 一种一维dbf雷达搜索模式与跟踪模式切换方案 | |
CN115343949A (zh) | 一种固定翼无人机跟踪制导律设计方法及验证平台 | |
CN109993768B (zh) | 一种提高伺服跟踪实时性和精准性的空中目标测谱方法 | |
CN113190028A (zh) | 一种敏捷卫星指向控制方法及系统 | |
KR20230056225A (ko) | 차동 구동형 이동로봇의 운동역학을 고려한 장애물 회피 및 경로 추종방법 | |
CN116909321A (zh) | 一种基于人工势场法的四轴惯性平台全姿态控制方法 | |
Zhang et al. | A Two-Dimensional Solar Tracking Stationary Guidance Method Based on Feature-Based Time Series | |
CN116812171B (zh) | 一种轨道飞行器姿轨耦合矢量控制系统和方法 | |
CN117445929A (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 |