CN115202405B - 一种基于无人机的飞行路径规划方法 - Google Patents
一种基于无人机的飞行路径规划方法 Download PDFInfo
- Publication number
- CN115202405B CN115202405B CN202211119748.4A CN202211119748A CN115202405B CN 115202405 B CN115202405 B CN 115202405B CN 202211119748 A CN202211119748 A CN 202211119748A CN 115202405 B CN115202405 B CN 115202405B
- Authority
- CN
- China
- Prior art keywords
- starting point
- point
- path
- steps
- following
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 150000001875 compounds Chemical class 0.000 claims description 6
- 239000000126 substance Substances 0.000 claims description 3
- 238000004422 calculation algorithm Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000010006 flight Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于无人机的飞行路径规划方法,包括S1、确定路径规划参数,包括作业范围、起终点之间的距离及平面角度;S2、根据路径规划参数,确定路径点;其中,路径点为起终点之间的若干圆形路径上的移动点以及圆形路径上的起始点;S3、对路径点进行修正,获得路径规划结果。基于本发明方法,在同等区域下,路线尽量短、飞行时间尽可能减少;可以在各种区域形状下进行飞行;采集到的数据可以作为三维精细化建模的素材;可以延生算法适用更多场景。
Description
技术领域
本发明属于路径规划技术领域,具体涉及一种基于无人机的飞行路径规划方法。
背景技术
现有的如无人机等需要进行路径规划的移动机器人采用的路径规划方法多为基于凸多边形地块的往复式运行航线规划方法,其根据凸多边形边界点计算出外框经纬度范围,在范围内根据航线间的间隔和方向,计算出一组平行线与多边形外框的交点,转为经纬度坐标,然后按顺序添加到航线里,生成往复式航线。
上述路径规划方法的缺点为:
1、路径规划的路线较长,导致飞行时间过长,不适合电量小的无人机;
2、该方法主要用于面积较大的凸多边形区域内采集数据,对多边形形状有要求,如凹多边形不适合;
3、该方法实现过程中需要确定区域边界点。
发明内容
针对现有技术中的上述不足,本发明提供的基于无人机的飞行路径规划方法解决了上述背景技术中的问题。
为了达到上述发明目的,本发明采用的技术方案为:一种基于无人机的飞行路径规划方法,包括以下步骤:
S1、确定路径规划参数,包括作业范围、起终点之间的距离及平面角度;
S2、根据路径规划参数,确定路径点;
其中,路径点为起终点之间的若干圆形路径上的移动点以及圆形路径上的起始点;
S3、对路径点进行修正,获得路径规划结果。
进一步地,所述步骤S2具体为:
S21、确定圆形路径的圈数;
S22、计算每个圆形路径的圆心位置;
S23、根据圆心位置确定每个圆形路径上的起始点;
S24、计算每个圆形路径上的移动点。
进一步地,所述步骤S21中圆形路径的圈数Q为:
进一步地,所述步骤S22中,根据起点A和终点B的经度一致性,在UTM平面坐标系中确定每个圆形路径的圆心位置,其中,第一个圆形路径的圆心位置为起点坐标;
进一步地,所述步骤S23中,根据起点A和终点B的经度一致性,在UTM平面坐标系中确定每个圆形路径的起始点;
进一步地,所述步骤S24具体为:
S24-1、基于圆形路径的等分数,确定圆形路径上移动点的数量;
S24-2、根据起始点角度,从起始点开始按顺时针方向,依次确定每个移动点的移动角度,进而确定每个移动点的位置;
进一步地,所述步骤S3中,对路径点的修正包括高度差影响修正和重叠修正。
进一步地,所述高度差影响修正是指对路径点的高度进行修正,修正的方法具体为:
计算每个圆形路径的圆心与起点的相对高度差,进而确定每个圆形路径的海拔高度,得到每个路径点修正后的高度h为:
进一步地,所述重叠修正是指对连续圆形路径之间的重叠距离进行修正,修正方法具体为:
基于圆形路径间的目标重叠率,对移动机器人的飞行速度进行调整,进而修正圆形路径之间的重叠距离;
本发明的有益效果为:
(1)本发明方法应用到无人机上时,可以缩短飞行时间,同样电量下,无人机可以做更多航拍飞行,提升采集数据的效率。
(2)航线规划不再需要依赖凸多边形区域规划,只需要两个点即可一键生成。
(3)参数配置自由,适配各种需要,圆形半径、航点速度、高度、重叠率等都可以自己配置。
(4)圆形路径的等分数人为设置,随时可以精确定位到飞机当前哪个点,如果一次航线飞不完,可以暂停任务,下次飞行直接从对应记录的点出发继续执行。
(5)可以根据实际情况调整并延生对应算法,在两点间路径规划的基础上,如果有需要,可以延生出3个点,4个点,甚至多点间的路径规划。
附图说明
图1为本发明提供的基于无人机的飞行路径规划方法流程图。
图2为本发明中的起终点坐标示意图。
图3为本发明中的起终点间的平面角度示意图。
图4为本发明中的确定圆形路径圈数示意图。
图5为本发明中的起终点经度一致且起点在下终点在上时的圆心确定示意图。
图6为本发明中的起终点经度不一致且纬度一致时的圆心确定示意图。
图7为本发明中的起终点经纬度均不一致时的圆心确定示意图。
图8为本发明中的起终点经纬度均不一致时的起始点确定示意图。
图9为本发明中的确定移动点位置坐标示意图。
图10为本发明中的路径规划轨迹图。
图11为本发明中的高度差修正示意图。
具体实施方式
下面对本发明的具体实施方式进行描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
本发明实施例提供了一种基于无人机的飞行路径规划方法,如图1所示,包括以下步骤:
S1、确定路径规划参数,包括作业范围、起终点之间的距离及平面角度;
S2、根据路径规划参数,确定路径点;
其中,路径点为起终点之间的若干圆形路径上的移动点以及圆形路径上的起始点;
S3、对路径点进行修正,获得路径规划结果。
本发明实施例的步骤S1中,如图2所示,路径规划时的起点和终点分别为A、B,作业范围,即圆形路径的半径为r,移动机器人基于GPS坐标系确定的起点A的坐标为A(lngA, latA,h A ),终点B的坐标为B(lngB,latB,h B )。
(1)使用Location.distanceBetween函数求解;
(2)将GPS坐标系转换到UTM(Universal Transverse Mercator Grid System,通用横墨卡托格网系统)平面坐标系,在UTM平面坐标系中计算两点之间的距离;
(3)使用Haversine公式计算。
本实施例中的UTM坐标系作为一种平面坐标系是一种平面直角坐标,这种坐标格网系统及其所依据的投影已经广泛用于地形图,作为卫星影像和自然资源数据库的参考格网以及要求精确定位的其他应用;在该坐标系中,两点距离即为实际距离。
根据起终点在GPS坐标系中的经纬度,确定其在UTM坐标下的分带,根据不同分带对应的计算算法,确定起终点在UTM坐标系中的平面坐标,得到起点A的平面坐标为,终点B的平面坐标为,如图3所示,得到平面角度a满足:,进而根据反三角函数计算出平面角度。
本发明实施例的步骤S2具体为:
S21、确定圆形路径的圈数;
S22、计算每个圆形路径的圆心位置;
S23、根据圆心位置确定每个圆形路径上的起始点;
S24、计算每个圆形路径上的移动点。
本实施例的步骤S21中,如图4所示,圆形路径的圈数Q为:
本实施例的步骤S22中,根据起点A和终点B的经度一致性,在UTM平面坐标系中确定每个圆形路径的圆心位置,其中,第一个圆形路径的圆心位置为起点坐标;
其中,r为作业范围的半径,a为起终点间的平面角度,为起点A在UTM坐标系中的平面坐标,i为圆形路径的序号,且i=0,1,2,3,…,Q-1,Q为圆形路径的圈数,i=0对应第一个圆形路径,即点A即是起点也是第一个圆形路径的圆心位置。
本实施例的步骤S23中,根据起点A和终点B的经度一致性,在UTM平面坐标系中确定每个圆形路径的起始点;
本实施例的步骤S24具体为:
S24-1、基于圆形路径的等分数,确定圆形路径上移动点的数量;
S24-2、根据起始点角度,从起始点开始按顺时针方向,依次确定每个移动点的移动角度,进而确定每个移动点的位置;
具体地,如图9所示,基于计算出的移动角度根据三角函数计算出每个移动点的平面坐标。
本实施例中,默认将圆形路径等分为18份,也可根据需要设置成其他数字,数字越大确定移动点数越多,以18为例,一个圆形路径被分为18份,除了18个移动点外,终点和起点的位置一致,即一个圆形路径上的移动点数为19,如果有Q个圆形路径,则就是19*Q个移动点,当无人机需要断点续飞时,可以直接从第几个点开始任务。
基于上述过程得到的路径点如图10所示,其中起点为A,终点为B,实际飞行轨迹为从起点出发,飞到第一个圆的起飞点,然后顺时针飞向下一个航点;一圈飞完后刚好在起飞点,然后直线飞向下一个圆的起飞点,继续顺时针飞行。
本实施例的步骤S3中,对路径点的修正包括高度差影响修正和重叠修正。
其中,高度差影响修正是指对路径点的高度进行修正,修正的方法具体为:
如图11所示,计算每个圆形路径的圆心与起点的相对高度差,进而确定每个圆形路径的海拔高度,得到每个路径点修正后的高度h为:
式中,为起点A的高度,为两个圆形路径圆心之间高度偏差,i为圆形路径的序号,且i=0,1,2,3,…,Q-1,为圆形路径的圈数;其中,确定每个圆形路径的海拔高度以便本方法适用于起点和终点高度差较大的情况。
其中,重叠修正是指对连续圆形路径之间的重叠距离进行修正,修正方法具体为:
基于圆形路径间的目标重叠率,对移动机器人的飞行速度进行调整,进而修正圆形路径之间的重叠距离;
具体地,当移动机器人的拍照时间固定时,基于想要实现的重叠距离,可以计算出移动机器人的移动速度,即基于实际移动距离等于拍摄真实距离与重叠距离的差值,进而对移动机器人其进行移动控制。
需要说明的是,本发明实施例提供了的路径规划方法,除了可以应用到无人机等飞行器上,也可以用于陆地运行的移动机器人,以最终解决基于路径规划结果实现可见光下的高精度三维重建。
在本发明的描述中,需要理解的是,术语“中心”、“厚度”、“上”、“下”、“水平”、“顶”、“底”、“内”、“外”、“径向”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的设备或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
Claims (7)
2.根据权利要求1所述的基于无人机的飞行路径规划方法,其特征在于,所述步骤S22中,根据起点A和终点B的经度一致性,在UTM平面坐标系中确定每个圆形路径的圆心位置,其中,第一个圆形路径的圆心位置为起点坐标;
5.根据权利要求1所述的基于无人机的飞行路径规划方法,其特征在于,所述步骤S3中,对路径点的修正包括高度差影响修正和重叠修正。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211119748.4A CN115202405B (zh) | 2022-09-15 | 2022-09-15 | 一种基于无人机的飞行路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211119748.4A CN115202405B (zh) | 2022-09-15 | 2022-09-15 | 一种基于无人机的飞行路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115202405A CN115202405A (zh) | 2022-10-18 |
CN115202405B true CN115202405B (zh) | 2022-12-02 |
Family
ID=83573451
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211119748.4A Active CN115202405B (zh) | 2022-09-15 | 2022-09-15 | 一种基于无人机的飞行路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115202405B (zh) |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10509124B2 (en) * | 2015-04-09 | 2019-12-17 | Siemens Energy, Inc. | Method for estimating time of flight for acoustic pyrometry |
CN106774395B (zh) * | 2016-12-14 | 2019-11-22 | 东北农业大学 | 农用植保无人机避障喷施路径规划方法及无人机 |
CN111123903B (zh) * | 2018-10-30 | 2021-05-25 | 武汉理工大学 | 一种基于圆形轨迹单元的无人艇避障方法 |
CN109857143B (zh) * | 2019-04-09 | 2022-02-22 | 大连大学 | 一种吞吐量最大化的无人机轨迹规划方法 |
CN110119159B (zh) * | 2019-05-28 | 2022-03-08 | 中国人民解放军海军航空大学 | 无人飞行器双圆弧路径的单参数确定方法和路径规划方法 |
CN111221349B (zh) * | 2019-11-26 | 2022-12-23 | 西北工业大学 | 多无人机目标定位的航路规划方法 |
CN110908405B (zh) * | 2019-12-18 | 2023-10-10 | 中国人民解放军总参谋部第六十研究所 | 一种固定翼无人机进行同心圆飞行时的控制方法 |
CN112327917B (zh) * | 2020-11-12 | 2022-12-27 | 哈尔滨工业大学(深圳) | 基于群体智能的无人机集群协同覆盖方法 |
CN112684810B (zh) * | 2020-12-18 | 2022-12-13 | 彩虹无人机科技有限公司 | 一种固定翼无人机环绕飞行的导航方法 |
CN113093783B (zh) * | 2021-02-23 | 2023-09-12 | 广东工贸职业技术学院 | 一种无人机的拍摄控制方法及装置 |
CN113885565A (zh) * | 2021-10-21 | 2022-01-04 | 国网天津市电力公司电力科学研究院 | 一种多旋翼无人机圆弧转弯的控制方法 |
-
2022
- 2022-09-15 CN CN202211119748.4A patent/CN115202405B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN115202405A (zh) | 2022-10-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104850134B (zh) | 一种无人机高精度自主避障飞行方法 | |
CN106020237B (zh) | 植保无人机的多机作业航线规划及其喷洒作业方法和系统 | |
EP2817689B1 (en) | Safe emergency landing of a uav | |
Hernandez-Lopez et al. | An automatic approach to UAV flight planning and control for photogrammetric applications | |
CN110727288A (zh) | 一种基于点云的电力巡检精准三维航线规划方法 | |
CN106054929A (zh) | 一种基于光流的无人机自动降落引导方法 | |
CN112789672B (zh) | 控制和导航系统、姿态优化、映射和定位技术 | |
CN107084725A (zh) | 一种多旋翼无人机电力巡检三维航线规划方法 | |
JP7501878B2 (ja) | ドローン作業支援システム及びドローン作業支援方法 | |
CN105867404A (zh) | 一种无人机测量土石方的设备及方法 | |
CN111650958A (zh) | 一种固定翼无人机起飞段切入航路点的在线路径规划方法 | |
CN105513434A (zh) | 无人机飞行管制系统及其管制方法 | |
CN109945868B (zh) | 一种无人机目标照射航线自动规划方法 | |
CN111650962B (zh) | 一种适用于带状测区的多旋翼无人机航线规划与航摄方法 | |
CN113282108A (zh) | 基于无人机技术快速精准采集低空遥感影像的方法 | |
CN114721436A (zh) | 一种面向无人机载高光谱成像系统的航线自动规划方法 | |
CN105243364A (zh) | 光电吊舱搜索方法、装置以及系统 | |
CN115014361A (zh) | 航线规划方法、装置及计算机存储介质 | |
CN112597664A (zh) | 一种基于无人机的铁路既有线精细实景三维建模航带设计方法 | |
CN113342027B (zh) | 一种飞行航线轨迹模拟方法 | |
CN115202405B (zh) | 一种基于无人机的飞行路径规划方法 | |
CN113093801A (zh) | 一种多无人机协同编队的航路文件制作方法 | |
Ismael et al. | Accuracy assessment of UAV photogrammetry for large scale topographic mapping | |
CN107393349B (zh) | 一种无人机飞行空域超界自动告警方法 | |
CN114018244B (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 |