无人机多区域内巡逻轨迹编号方法与流程

文档序号:24646973发布日期:2021-04-13 15:37阅读:160来源:国知局
无人机多区域内巡逻轨迹编号方法与流程

1.本发明涉及一种无人机飞行轨迹编号方法,尤其涉及一种无人机多区域内巡逻轨迹编号方法,可用于无人机多区域内侦查、巡逻及搜索的场合,例如航空航天、测绘等领域。


背景技术:

2.地球本身是一个巨大的此题,在地球表面会呈现缓慢梯度变化,同时,地球表面不同磁场特性的物质,如岩石、矿体、人造设备等也会导致地磁场的剧烈变化,通过对一个区域的磁异常变化检测和描述,可以有针对性的实现物质探测和目标寻找等目的。近年来,随着无人机技术的飞速发展和航磁设备的小型化,航磁探测技术与无人机结合逐渐成为可能。
3.应后期磁场数据处理的要求,需要获得无人机飞行的轨迹线编号及轨迹线间距等相关信息,目前采取的方法主要通过采用无人机地面站航迹规划的方式获取,通过目前方法获取的轨迹编号存在以下问题:
4.(1)真实飞行路线和结果与轨迹规划的路线和结果有偏差,导致编号存在错误;
5.(2)无人机飞行距离以及范围比需要进行扫描和探测的区域面积大,导致无人机轨迹中存在大量多余的数据,使得后期处理中工作量大,且导致处理结果不准确。


技术实现要素:

6.本发明的技术解决问题:克服现有技术的不足,提供一种无人机多区域内巡逻轨迹编号方法,实现对多区域无人机飞行数据的切割和编号,为无人机数据及其他设备数据组合提供了轨迹编号信息。
7.本发明的技术解决方案:一种无人机多区域内巡逻轨迹编号方法,其特征在于步骤如下:
8.(1)在wgs84坐标系下,无人机依次在以经纬度坐标(xn、yn)为区域中心点,范围为r*r的n个正方形区域内开展巡逻飞行,n=1~n;在无人机巡逻飞行过程中实时对外发送无人机飞行位置信息,按照时间顺序排列形成巡逻飞行轨迹数据,保存为无人机飞行位置信息数据文件;
9.uav_longitude_k为第k帧无人机飞行位置信息经度,uav_latitude_k表示第k帧无人机飞行位置信息纬度;k=1~k,k表示无人机飞行过程中所有的数据帧个数,保存为无人机飞行位置信息数据文件;n个正方形区域,具体要求为:区域上不重叠,每个正方形区域的两条相对的边平行于纬度线,另外两条相对的边平行于经度线;
10.(2)通过区域中心点经纬度坐标(xn、yn)(n=1~n)和范围大小r*r,计算在wgs84坐标系下各正方形区域的西北角经纬度坐标(left_top_n_x,left_top_n_y)(n=1~n),计算在wgs84坐标系下各正方形区域的东南角经纬度坐标(right_bottom_n_x,right_bottom_n_y)(n=1~n);
11.(3)对无人机飞行轨迹状态及进行初始化,即设置轨迹编号值track_num,并对轨
迹编号值清零(track_num=0);设置首次进入第n区域的标志flag_first_point_n(n=1~n),并将首次进入第n区域标志flag_first_point_n(n=1~n)置为0(表示无人机未进入过第n区域);设置已在第n区域内标志位track_flag,并对已在该n区域内标志位track_flag置0(表示无人机尚在该区域外);设置n个文件;
12.(4)从步骤(1)的无人机飞行位置信息数据文件中读取按照时间顺序排列形成的巡逻飞行轨迹数据,读取第k时间下的无人机飞行位置(uav_longitude_k,uav_latitude_k)(k=1~k),k从1开始;
13.(5)判断第k时间下的无人机飞行位置是否在第n个正方形区域内,如果判断为否,将步骤(4)中k的值加1后赋给k,返回步骤(4),如果判断为是,进入步骤(6);k大于等于1,小于等于无人机巡逻飞行总时间k;
14.(6)判断无人机是否首次进入第n个正方形区域,如果判断为否,进入步骤(7),如果判断为是,轨迹编号值track_num清零(track_num=0),首次进入该n区域标志flag_first_point_n置为1(表示无人机已进入过该区域),已在该n区域内标志位track_flag置0(表示无人机尚在该区域外),再进入步骤(7);
15.(7)判断无人机是否已在第n正方形区域内(其中,已在是指:无人机在1~(k

1)时刻已经进入过第n正方形区域内,即判断已在该区域内标志位track_flag是否为1),如果判断为是,直接保存无人机飞行位置(uav_longitude_k,uav_latitude_k)和轨迹编号值track_num至n个文件中的第n个文件中,如果判断为否,已在该区域内标志位track_flag置1(表示无人机已在该区域内),轨迹编号值track_num加1后赋给轨迹编号值track_num,以更新轨迹编号值(track_num++),保存无人机飞行位置和轨迹编号值track_num至n个文件中的第n个文件中。
16.优选的,所述步骤(2)的实现方法为:
17.dlng=2*arcsin(sin(r/(4*earth_radius))/cos(yn))
18.dlat=r/2/earth_radius
19.left_top_n_x=xn

dlng
20.left_top_n_y=yn+dlat
21.right_bottom_n_x=xn+dlng
22.right_bottom_n_y=yn

dlat
23.其中earth_radius表示地球赤道半径,earth_radius=6378137.0米;
24.r表示正方形区域边长;
25.xn为第n个区域中心点的经度坐标;
26.yn为第n个区域中心点的纬度坐标;
27.dlng为长度r/2在地球坐标系下的经度差值;
28.dlat为长度r/2在地球坐标系下的纬度差值;
29.left_top_n_x为第n个区域西北角经度坐标;
30.left_top_n_y为第n个区域西北角纬度坐标;
31.right_bottom_n_x为第n个区域东南角经度坐标;
32.right_bottom_n_y为第n个区域东南角纬度坐标;
33.优选的,所述步骤(3)的实现方法为:
34.(1)轨迹编号值track_num清零:track_num=0;
35.(2)首次进入该n区域标志flag_first_point_n置为0(表示无人机未进入过该n区域):flag_first_point_n=0(n=1~n);
36.(3)无人机是否已在该n区域内标志位track_flag置0(表示无人机尚在该区域外):track_flag=0。
37.其中track_num表示轨迹编号值;
38.flag_first_point_n表示首次进入该n区域标志;
39.track_flag表示无人机是否已在该n区域内标志位。
40.优选的,所述步骤(5)判断第k时间下的无人机飞行位置是否在第n个正方形区域内,实现方法为:
41.判断第k时间下的无人机飞行位置(uav_longitude_k,uav_latitude_k)(k=1~k)是否满足:left_top_n_x<uav_longitude_k<right_bottom_n_x,同时满足left_top_n_y<uav_latitude_k<right_bottom_n_y
42.其中:uav_longitude_k表示第k帧无人机飞行位置信息经度;
43.uav_latitude_k表示第k帧无人机飞行位置信息纬度。
44.优选的,所述步骤(6)的实现方法为:
45.(1)判断首次进入该n区域标志flag_first_point_n是否为0,0表示无人机未进入过该n区域,1表示无人机已进入过该区域。,
46.(2)如果判断为0,轨迹编号值track_num清零(track_num=0),首次进入该n区域标志flag_first_point_n置为1(表示无人机已进入过该区域),无人机是否已在该n区域内标志位track_flag置0(表示无人机尚在该区域外);
47.(3)如果判断为1,不作处理。
48.优选的,所述步骤(6)判断无人机是否首次进入第n个正方形区域,实现方法为:
49.(1)判断无人机是否已在该n区域内即判断无人机是否已在该n区域内标志位track_flag是否为0,0表示无人机尚在该区域外,1表示无人机已在该区域内;
50.(2)如果判断为0,无人机是否已在该区域内标志位track_flag置1(表示无人机已在该区域内),轨迹编号值加1(track_num++),保存无人机飞行位置和轨迹编号值track_num至第n个文件中;
51.(3)如果判断为0,保存无人机飞行位置和轨迹编号值track_num至第n个文件中。
52.本发明与现有技术相比的优点如下:
53.(1)现有的无人机轨迹编号方法主要根据无人机航迹规划,采用在线处理的方式进行,该方法需要修改无人机飞控软件,而且使得飞控软件逻辑复杂,可靠性差,影响无人机的安全性,本方法不需要修改无人机飞控软件,主要通过后期数据处理,方法简单,可靠性强。
54.(2)现有的无人机轨迹编号方法主要是应用在较为理想的飞行环境,在应对复杂飞行环境,比如强风、gps信息干扰、磁场干扰等问题时,无法有效隔离错误数据,在多区域飞行时,无法进行良好的轨迹编号,而本方法能够正确识别复杂环境下的数据,也能够处理多区域飞行的数据信息,能够保证数据的可靠性。
55.(3)现有的无人机轨迹编号方法发出的数据存在非区域内巡逻的轨迹数据,针对
后期处理时,这些数据为干扰数据,不利于后期数据融合,本方法处理的数据全部为区域内轨迹数据,数据的纯净度高。
附图说明
56.图1为本发明的实现原理图;
57.图2为多区域轨迹编号平面图;
58.图3为多区域轨迹编号3d图。
具体实施方式
59.下面结合附图和具体实施例对本发明做进一步详细描述。
60.本发明公开了一种无人机多区域内巡逻轨迹编号方法,本发明提出采用巡逻区域中心点及巡逻范围大小计算无人机巡逻区域,并根据无人机区域内巡逻飞行的机理进行无人机飞行轨迹线切割,通过区域切换,实现无人机多区域内巡逻轨迹编号,该方法属于事后无人机轨迹编号,可以用于复杂的无人机多区域巡逻环境,不依赖于无人机系统的轨迹规划,也不需要在线实时进行判断,与无人机轨迹规划方法相比,该方法真实性高,数据为无人机真实飞行数据,且不占用无人机本身计算资源,不需要额外更改无人机导航和控制系统软件,使用范围广,易用性强。
61.进一步优选方案为:航空磁力仪具有高效、快速、受地表地形影响小等优势,在地质普查、金属矿勘探、油气资源远景评价等领域发挥着重要作用。航空磁测量系统的核心部件就是航空磁力仪和磁补偿技术。本方案主要应用于航空磁力仪数据的磁补偿处理,通过本方法,可以获得无人机飞行的轨迹线及其编号,将其代入到磁补偿算法中,有效提高磁补偿的精度。图1是本发明的数据处理流程图,通过上述流程可以有效完成数据的切割和编号。图2表示无人机飞行轨迹和过程,其中两个正方形框表示需要探测的区域(10m*10m),图3表示图2正方形框中的轨迹线及其编号,也是本方法最终获得的效果。
62.优选的,无人机是一种可以携带相机、传感器、通信设备或其他有效载荷的遥控飞行器或自动驾驶飞机。无人机系统包括四大构成要素:(1)飞行器;(2)地面控制站;(3)有效载荷;(4)维护/保障系统。
63.无人机可以通过携带特定有效载荷来执行给定任务,包括各种传感器套装,包括电光和红外传感器、合成孔径雷达(sar)、信号情报传感器以及用于完成侦察/监视任务的多光谱和高光谱成像器。在军事应用中,可以在部署军队之前发射无人机来执行战场侦察任务。
64.优选的,无人机作为一种新型信息获取载体,具有灵活性高、操作性强、成本低以及对作业环境要求低等优点,在各行各业发挥越来越大的作用。在一些特殊应用场景,无人机在多个区域内巡逻飞行,通过搭载不同的载荷,比如激光扫描、磁探测、光学扫描等,实现区域巡逻和侦察。无人机与上述仪器设备数据进行组合时,需要使用无人机在区域内飞行轨迹编号。
65.优选的,本发明的实现优选方式是:根据区域中心点位置坐标和区域边界长度计算得到区域范围大小,通过连续判断无人机飞行位置坐标是否在区域内、无人机是否首次进入该区域、无人机是否已在该区域内,从而确定无人机是否进行了区域转移和巡逻轨迹
切换,最终实现了无人机多区域巡逻轨迹的编号。
66.优选的实现方法如图1所示,本发明优选的具体实现方法和步骤:
67.(1)无人机在以经纬度坐标(xn、yn)(n=1~n)为区域中心点,范围为r*r的n个正方形区域内开展巡逻飞行,在无人机巡逻飞行过程中实时对外发送无人机飞行位置信息(uav_longitude_k,uav_latitude_k)(k=1~k),k表示无人机飞行过程中所有的数据帧个数,保存为无人机飞行位置信息数据文件;
68.(2)通过区域中心点经纬度坐标(xn、yn)(n=1~n)和范围大小r*r,计算正方形区域的西北角经纬度坐标(left_top_n_x,left_top_n_y)(n=1~n),计算正方形区域的东南角经纬度坐标(right_bottom_n_x,right_bottom_n_y)(n=1~n);
69.(3)无人机飞行轨迹状态初始化,轨迹编号值track_num清零(track_num=0),首次进入该n区域标志flag_first_point_n(n=1~n)置为0(表示无人机未进入过该n区域),无人机是否已在该n区域内标志位track_flag置0(表示无人机尚在该区域外);
70.(4)从无人机飞行位置信息数据文件读取无人机飞行位置(uav_longitude_k,uav_latitude_k)(k=1~k),判断无人机飞行位置是否在第n个区域内,如果判断为否,再进入步骤(4),如果判断为是,进入步骤(5)。
71.(5)判断无人机是否首次进入该n区域,如果判断为否,进入步骤(6),如果判断为是,轨迹编号值track_num清零(track_num=0),首次进入该n区域标志flag_first_point_n置为1(表示无人机已进入过该区域),无人机是否已在该n区域内标志位track_flag置0(表示无人机尚在该区域外),再进入步骤(6);
72.(6)判断无人机是否已在该n区域内,如果判断为是,直接保存无人机飞行位置和轨迹编号值track_num,如果判断为否,无人机是否已在该区域内标志位track_flag置1(表示无人机已在该区域内),轨迹编号值加1(track_num++),保存无人机飞行位置和轨迹编号值track_num。
73.所述步骤(2)的实现方法为:
74.dlng=2*arcsin(sin(r/(4*earth_radius))/cos(yn))
75.dlat=r/2/earth_radius
76.left_top_n_x=xn

dlng
77.left_top_n_y=yn+dlat
78.right_bottom_n_x=xn+dlng
79.right_bottom_n_y=yn

dlat
80.其中earth_radius表示地球赤道半径,earth_radius=6378137.0米;
81.r表示正方形区域边长;
82.xn为第n个区域中心点的经度坐标;
83.yn为第n个区域中心点的纬度坐标;
84.dlng为长度r/2在地球坐标系下的经度差值;
85.dlat为长度r/2在地球坐标系下的纬度差值;
86.left_top_n_x为第n个区域西北角经度坐标;
87.left_top_n_y为第n个区域西北角纬度坐标;
88.right_bottom_n_x为第n个区域东南角经度坐标;
89.right_bottom_n_y为第n个区域东南角纬度坐标;
90.所述步骤(3)的实现方法为:
91.(1)轨迹编号值track_num清零:track_num=0;
92.(2)首次进入该n区域标志flag_first_point_n置为0(表示无人机未进入过该n区域):flag_first_point_n=0(n=1~n);
93.(3)无人机是否已在该n区域内标志位track_flag置0(表示无人机尚在该区域外):track_flag=0。
94.其中track_num表示轨迹编号值;
95.flag_first_point_n表示首次进入该n区域标志;
96.track_flag表示无人机是否已在该n区域内标志位。
97.所述步骤(4)的实现方法为:
98.判断无人机飞行位置(uav_longitude_k,uav_latitude_k)(k=1~k)是否满足:left_top_n_x<uav_longitude_k<right_bottom_n_x,同时满足left_top_n_y<uav_latitude_k<right_bottom_n_y
99.其中:uav_longitude_k表示无人机飞行位置信息经度;
100.uav_latitude_k表示无人机飞行位置信息纬度。
101.所述步骤(5)的实现方法为:
102.(1)判断首次进入该n区域标志flag_first_point_n是否为0,0表示无人机未进入过该n区域,1表示无人机已进入过该区域。,
103.(2)如果判断为0,轨迹编号值track_num清零(track_num=0),首次进入该n区域标志flag_first_point_n置为1(表示无人机已进入过该区域),无人机是否已在该n区域内标志位track_flag置0(表示无人机尚在该区域外);
104.(3)如果判断为1,不作处理。
105.所述步骤(6)的实现方法为:
106.(1)判断无人机是否已在该n区域内即判断无人机是否已在该n区域内标志位track_flag是否为0,0表示无人机尚在该区域外,1表示无人机已在该区域内;
107.(2)如果判断为0,无人机是否已在该区域内标志位track_flag置1(表示无人机已在该区域内),轨迹编号值加1(track_num++),保存无人机飞行位置和轨迹编号值track_num至第n个文件中;
108.(3)如果判断为0,保存无人机飞行位置和轨迹编号值track_num至第n个文件中。
109.进一步优选方案为:本方法作为磁补偿算法的预处理方法,可以获得无人机飞行的轨迹线及其编号,将其代入到磁补偿算法中,有效提高磁补偿的精度。
110.进一步优选方案为:无人机在中心点坐标为(114.7748452,41.2919194)、(114.77505,41.2921397)的2个边界为10米*10米的正方形区域内飞行,图2为无人机飞行轨迹线平面图,表示无人机飞行轨迹和过程,其中两个正方形框表示需要探测的区域(10m*10m),可以明显看出无人机部分轨迹在正方形框内,有部分轨迹在正方形框外。图3为无人机飞行轨迹线3d图,表示图2正方形框中的轨迹线及其编号,也是本方法最终获得的效果。完成本方法处理后,将上述轨迹线和编号输入到磁补偿算法中,可以有效提高磁探测结果。
111.通过上述方法即可完成无人机多区域内巡逻轨迹编号方法,从图2和图3中可以看
出本方法实现了无人机多区域轨迹数据的轨迹线切割和轨迹编号。
112.本发明未详细描述内容为本领域技术人员公知技术。
当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1