无人机导航定位方法及装置与流程

文档序号:24642720发布日期:2021-04-13 13:55阅读:865来源:国知局
无人机导航定位方法及装置与流程

1.本申请属于无人机技术领域,尤其涉及无人机导航定位方法及装置。


背景技术:

2.无人驾驶飞机简称“无人机”,是利用无线电遥控设备和自备的程序控制装置操纵的不载人飞机,或者由车载计算机自主操作的不载人飞机。虽然无人机的相关技术正在逐渐成熟,但是仍存在亟待解决的问题。例如,目前无人机在导航时所使用的无人机的位置信息的准确性较低,导致导航精确度较低。


技术实现要素:

3.本申请实施例提供了无人机导航定位方法及装置,可以解决以下问题:目前无人机在导航时所使用的无人机的位置信息的准确性较低,导致导航精确度较低。
4.第一方面,本申请实施例提供了一种无人机导航定位方法,无人机导航定位方法应用于无人机,无人机导航定位方法包括:
5.根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息;
6.获取无人机的姿态数据;
7.根据姿态数据修正无人机的第一位置信息,以及根据修正后的第一位置信息进行导航。
8.第二方面,本申请实施例提供了一种无人机导航定位装置,无人机导航定位装置应用于无人机,无人机导航定位装置包括:
9.第一单元,用于根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息;
10.第二单元,用于获取无人机的姿态数据;
11.第三单元,用于根据姿态数据修正无人机的第一位置信息,以及根据修正后的第一位置信息进行导航。
12.第三方面,本申请实施例提供了一种终端设备,包括:存储器、处理器以及存储在该存储器中并可在该处理器上运行的计算机程序,该处理器执行该计算机程序时实现如无人机导航定位方法的步骤。
13.第四方面,本申请实施例提供了一种计算机可读存储介质,包括:该计算机可读存储介质存储有计算机程序,该计算机程序被处理器执行时实现如无人机导航定位方法的步骤。
14.第五方面,本申请实施例提供了一种计算机程序产品,当计算机程序产品在终端设备上运行时,使得终端设备执行上述第一方面中任一项无人机导航定位方法的步骤。
15.可以理解的是,上述第二方面至第五方面的有益效果可以参见上述第一方面中的相关描述,在此不再赘述。
16.本申请实施例与现有技术相比存在的有益效果是:实时动态(real

time kinematic,rtk)载波相位差分技术是基于将无人机视为质点的前提下实现的,即在根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息的过程中,是不考虑无人机的姿态的。本申请实施例中,由于能够在根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息之后,还获取无人机的姿态数据,再根据姿态数据修正无人机的第一位置信息,修正后的第一位置信息的准确性较高,因此,根据修正后的第一位置信息进行导航,能够大大地提高导航精确度。
附图说明
17.为了更清楚地说明本申请实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
18.图1是本申请一实施例提供的第一种无人机导航定位方法的流程示意图;
19.图2是本申请实施例提供的一种导航坐标系的示意图;
20.图3是本申请实施例提供的一种机体坐标系的示意图;
21.图4是本申请另一实施例提供的第二种无人机导航定位方法的流程示意图;
22.图5是本申请实施例提供的一种无人机导航定位装置的结构示意图;
23.图6是本申请实施例提供的终端设备的结构示意图。
具体实施方式
24.以下描述中,为了说明而不是为了限定,提出了诸如特定系统结构、技术之类的具体细节,以便透彻理解本申请实施例。然而,本领域的技术人员应当清楚,在没有这些具体细节的其它实施例中也可以实现本申请。在其它情况中,省略对众所周知的系统、装置、电路以及方法的详细说明,以免不必要的细节妨碍本申请的描述。
25.应当理解,当在本申请说明书和所附权利要求书中使用时,术语“包括”指示所描述特征、整体、步骤、操作、元素和/或组件的存在,但并不排除一个或多个其它特征、整体、步骤、操作、元素、组件和/或其集合的存在或添加。
26.还应当理解,在本申请说明书和所附权利要求书中使用的术语“和/或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。
27.如在本申请说明书和所附权利要求书中所使用的那样,术语“如果”可以依据上下文被解释为“当...时”或“一旦”或“响应于确定”或“响应于检测到”。类似地,短语“如果确定”或“如果检测到[所描述条件或事件]”可以依据上下文被解释为意指“一旦确定”或“响应于确定”或“一旦检测到[所描述条件或事件]”或“响应于检测到[所描述条件或事件]”。
[0028]
另外,在本申请说明书和所附权利要求书的描述中,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
[0029]
在本申请说明书中描述的参考“一个实施例”或“一些实施例”等意味着在本申请的一个或多个实施例中包括结合该实施例描述的特定特征、结构或特点。由此,在本说明书中的不同之处出现的语句“在一个实施例中”、“在一些实施例中”、“在其他一些实施例中”、

在另外一些实施例中”等不是必然都参考相同的实施例,而是意味着“一个或多个但不是所有的实施例”,除非是以其他方式另外特别强调。术语“包括”、“包含”、“具有”及它们的变形都意味着“包括但不限于”,除非是以其他方式另外特别强调。
[0030]
实施例一:
[0031]
图1示出了本申请实施例提供的第一种无人机导航定位方法的流程示意图,第一种无人机导航定位方法应用于无人机,详述如下:
[0032]
该无人机内可包括星基授时装置,星基授时装置的精度可达20纳秒量级,该星基授时装置用于传播标准时间。
[0033]
步骤s101,根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息。
[0034]
其中,第一卫星导航系统信号与下文提到的第二卫星导航系统信号,是在不同的时间点从指定卫星导航系统接收到的信号,该指定卫星导航系统可为全球定位系统或者北斗卫星导航系统。无人机的第一位置信息可包括无人机在导航坐标系中的坐标(x1,y1,z1),将确定出无人机的第一位置信息的时间点记为t1,对应地,x1、y1、z1分别可以体现无人机在时间点t1所处位置的经度、纬度、高度。
[0035]
作为示例而非限定的是,该导航坐标系可如图2所示,该导航坐标系为三维坐标系,导航坐标系中的三个轴分别为第一轴、第二轴、第三轴,导航坐标系的原点q1位于地球质心处,第三轴通过格林尼治线和赤道线的交点q2,第三轴的正方向为原点q1指向交点q2的方向,第二轴通过原点q1,且第二轴的正方向为原点q1指向北极的方向,第一轴与第二轴以及第三轴构成右手坐标系。
[0036]
另外,rtk载波相位差分技术的原理主要是无人机接收地面端基准站所发送的信号,根据卫星导航系统信号和地面端基准站所发送的信号确定无人机的位置信息。
[0037]
步骤s102,获取无人机的姿态数据。
[0038]
其中,该无人机的姿态数据包括横滚角、俯仰角以及偏航角。
[0039]
为了便于描述,可在无人机上建立机体坐标系,该机体坐标系(三维坐标系)可如图3所示,将机体坐标系的三个坐标轴分别记为:x2轴、y2轴、z2轴,机体坐标系的原点q3位于飞机质心处,z2轴在无人机的对称平面内并平行于无人机的设计轴线,z2轴的正方向为原点q3指向无人机的机头的方向,y2轴垂直于无人机的对称平面,且y2轴的正方向为原点q3指向无人机的机身上方,x2轴在无人机的对称平面内,x2轴与y2轴以及z2轴构成右手坐标系。
[0040]
其中,横滚角为机体坐标系的x2轴与导航坐标系的第一轴之间的夹角;俯仰角为机体坐标系的y2轴与导航坐标系的第二轴之间的夹角;偏航角为机体坐标系的z2轴与导航坐标系的第三轴之间的夹角。
[0041]
作为示例而非限定的是,该步骤s102可具体包括:通过姿态传感器获取无人机的姿态数据。其中,姿态传感器是基于微机电系统技术的三维运动姿态测量系统,姿态传感器可包括三轴陀螺仪以及三轴电子罗盘等运动传感器,姿态传感器通过内嵌的arm处理器可得到经过温度补偿的姿态数据。
[0042]
步骤s103,根据姿态数据修正无人机的第一位置信息,以及根据修正后的第一位置信息进行导航。
[0043]
作为示例而非限定的是,根据修正后的第一位置信息进行导航具体包括:根据修正后的第一位置信息自动规划航线,根据规划出的航线进行导航。
[0044]
在一些实施例中,根据修正后的第一位置信息进行导航,包括:根据修正后的第一位置信息确定无人机与指定禁飞区域之间的距离;若无人机与指定禁飞区域之间的距离小于或者等于预设距离,则规划出避绕指定禁飞区域的目标航线;根据目标航线进行导航。由于能够规划出避绕指定禁飞区域的目标航线,以及根据目标航线进行导航,因此,能够减少因无人机的飞行而导致的风险,有效地维护了国家公共安全。
[0045]
其中,指定禁飞区域包括但不限于:军用机场区域、民用机场区域以及政府机构上空区域。
[0046]
在一些实施例中,根据修正后的第一位置信息进行导航,包括:根据修正后的第一位置信息确定无人机与指定禁飞区域之间的距离;若无人机与指定禁飞区域之间的距离大于预设距离,则根据修正后的第一位置信息修正原定航线,根据原定航线进行导航。
[0047]
作为示例而非限定的是,该原定航线为:在根据修正后的第一位置信息进行导航之前,无人机所规划出来的航线。
[0048]
若无人机与指定禁飞区域之间的距离大于预设距离,则可以忽略指定禁飞区域对无人机的影响,直接根据修正后的第一位置信息修正原定航线,再根据原定航线进行导航,进而能够大大地提高导航精确度。
[0049]
本申请实施例中,rtk载波相位差分技术是基于将无人机视为质点的前提下实现的,即在根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息的过程中,是不考虑无人机的姿态的。本申请实施例中,由于能够在根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息之后,还获取无人机的姿态数据,再根据姿态数据修正无人机的第一位置信息,修正后的第一位置信息的准确性较高,因此,根据修正后的第一位置信息进行导航,能够大大地提高导航精确度。
[0050]
实施例二:
[0051]
与上述实施例一对应,图4示出了本申请实施例提供的第二种无人机导航定位方法的示意图,第二种无人机导航定位方法应用于无人机,本实施例的步骤s401、步骤s403与实施例一的步骤s101、步骤s102相同,此处不再赘述:
[0052]
步骤s401,根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息。
[0053]
步骤s402,根据第二卫星导航系统信号和rtk载波相位差分技术确定无人机的第二位置信息。
[0054]
其中,无人机的第二位置信息可包括无人机在导航坐标系中的坐标(x3,y3,z3),将确定出无人机的第二位置信息的时间点记为时间点t2,对应地,x3、y3、z3可以分别体现无人机在时间点t2所处位置的经度、纬度、高度。
[0055]
为了便于描述,将在确定出无人机的第一位置信息之后,但未确定出无人机的第二位置信息所对应的时间段记为时间段h,即可将t1至t2之间的时间段记为时间段h,也可以将时间段h记为开区间(t1,t2),其中,时间段h不包括t1和t2这两个时间点,而是包括t1至t2之间的时间点。
[0056]
步骤s403,获取无人机的姿态数据。
[0057]
其中,该无人机的姿态数据包括:姿态传感器在时间点t1所计算出的姿态数据,该无人机的姿态数据还可包括:姿态传感器在时间段h内所计算出的姿态数据。
[0058]
步骤s404,根据姿态数据计算目标距离,目标距离为:在时间段h内,无人机对应的移动距离。
[0059]
作为示例而非限定的是,假设时间点t1为10点01分01秒,时间点t2为10点01分10秒,对应地,该目标距离为:在10点01分01秒至10点01分10秒之间的时间段内,无人机对应的移动距离,即该目标距离为无人机在时间段h(10点01分01秒至10点01分10秒之间的时间段)内移动的距离。
[0060]
步骤s405,根据目标距离修正无人机的第一位置信息,以及根据修正后的第一位置信息进行导航。
[0061]
可选地,无人机的第一位置信息包括:无人机在导航坐标系中的坐标,导航坐标系为三维坐标系,导航坐标系中的三个轴分别为第一轴、第二轴、第三轴,对应地,根据姿态数据计算目标距离,包括:
[0062]
根据姿态数据和无人机的加速度计算目标距离,目标距离包括:在确定出无人机的第一位置信息之后,但未确定出无人机的第二位置信息所对应的时间段内,无人机在第一轴的方向上的移动距离、无人机在第二轴的方向上的移动距离以及无人机在第三轴的方向上的移动距离;
[0063]
对应地,根据目标距离修正无人机的第一位置信息,包括:
[0064]
根据无人机在第一轴的方向上的移动距离、无人机在第二轴的方向上的移动距离以及无人机在第三轴的方向上的移动距离修正无人机的第一位置信息。
[0065]
其中,无人机的加速度为无人机中的加速度计所输出的加速度,由于加速度计和无人机的机体是固连在一起的,因此,该无人机的加速度可表现为机体坐标系中的三维矢量加速度。
[0066]
另外,根据姿态数据和无人机的加速度计算目标距离具体包括:根据姿态数据中的横滚角从该无人机的加速度中分解出第一加速度,根据姿态数据中的俯仰角从该无人机的加速度中分解出第二加速度,以及根据姿态数据中的偏航角从该无人机的加速度中分解出第三加速度,其中,第一加速度为该无人机的加速度在导航坐标系上的第一轴上的线加速度分量,第二加速度为该无人机的加速度在导航坐标系上的第二轴上的线加速度分量,第三加速度为该无人机的加速度在导航坐标系上的第三轴上的线加速度分量,根据第一加速度计算在时间段h内无人机在第一轴的方向上的移动距离,根据第二加速度计算在时间段h内无人机在第二轴的方向上的移动距离,以及根据第三加速度计算在时间段h内无人机在第三轴的方向上的移动距离。
[0067]
由于该无人机的姿态数据包括横滚角、俯仰角以及偏航角,且横滚角为机体坐标系的x2轴与导航坐标系的第一轴之间的夹角,俯仰角为机体坐标系的y2轴与导航坐标系的第二轴之间的夹角,偏航角为机体坐标系的z2轴与导航坐标系的第三轴之间的夹角,因此,根据横滚角、俯仰角、偏航角可实现无人机的加速度在机体坐标系与导航坐标系之间进行转换,在本实施例中,具体体现为将无人机的加速度(在机体坐标系中的三维矢量加速度)分解出(在导航坐标系的三个轴上的)第一加速度、第二加速度、第三加速度,进而能够较为精准地计算出在时间段h内无人机在导航坐标系的三个轴方向上的移动距离,以提高修正
后的第一位置信息的准确度。
[0068]
作为示例而非限定的是,假设无人机的第一位置信息为无人机在导航坐标系中的坐标(x1,y1,z1),对应地,修正后的第一位置信息为无人机在导航坐标系中的坐标(x11,y11,z11),无人机的姿态数据包括:在时间点t1姿态传感器所计算出的横滚角p10、在时间点t1获取到的俯仰角p20、在时间点t1获取到的偏航角p30,无人机的加速度包括:在时间点t1加速度计所输出的加速度a10,对应地,根据姿态数据中的横滚角从该无人机的加速度中分解出第一加速度,可具体包括:用a10乘以cos p10,将a10与cos p10的乘积确定为第一加速度,对应地,根据第一加速度计算在时间段h内无人机在第一轴的方向上的移动距离s1可具体包括:根据第一加速度计算在时间点t1时无人机在第一轴的方向上的瞬时速度v,根据瞬时速度v以及公式计算s1,其中,t表示时间。以此类推,计算出无人机在第二轴的方向上的移动距离s2以及无人机在第三轴的方向上的移动距离s3,对应地,根据无人机在第一轴的方向上的移动距离、无人机在第二轴的方向上的移动距离以及无人机在第三轴的方向上的移动距离修正无人机的第一位置信息,包括:用s1加上x1,将s1与x1之和确定为x11,用s2加上y1,将s2与y1之和确定为y11,以及用s3加上z1,将s1与z1之和确定为z11,即可得到修正后的第一位置信息(x11,y11,z11)。
[0069]
可选地,根据修正后的第一位置信息进行导航包括:根据修正后的第一位置信息和确定出无人机的第二位置信息的时间点进行导航。
[0070]
具体地,将修正后的第一位置信息和确定出无人机的第二位置信息的时间点进行融合,融合后的数据可表示为四维坐标,根据融合后的数据进行导航。
[0071]
由于目标距离为:在“确定出无人机的第一位置信息之后,但未确定出无人机的第二位置信息”所对应的时间段内,无人机对应的移动距离,因此,可将修正后的第一位置信息视为:无人机在确定出无人机的第二位置信息的时间点所处位置的信息,对应地,可将修正后的第一位置信息和确定出无人机的第二位置信息的时间点进行融合,再根据融合后的数据进行导航,由此,能够大大地提高导航的准确度。
[0072]
作为示例而非限定的是,将修正后的第一位置信息(x11,y11,z11)和确定出无人机的第二位置信息的时间点进行融合,融合后的数据可表示为四维坐标(x11,y11,z11,t2),根据(x11,y11,z11,t2)进行导航。
[0073]
一般地,当无人机处于工作状态时,无人机的位置总是在不断地变动,对应地,无人机需要不断地更新其位置信息,在本申请实施例中,可体现为“在根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息之后,需要根据第二卫星导航系统信号和rtk载波相位差分技术确定无人机的第二位置信息”。由于在“确定出无人机的第一位置信息之后,但未确定出无人机的第二位置信息”所对应的时间段内,无人机会移动一定的距离,因此,为了能够较为准确地修正第一位置信息,需要根据姿态数据计算目标距离,再根据目标距离修正无人机的第一位置信息,进而,根据修正后的第一位置信息进行导航,能够提高导航的精确度。
[0074]
实施例三:
[0075]
与上述实施例一对应,图5示出了本申请实施例提供的一种无人机导航定位装置的结构示意图,该无人机导航定位装置应用于无人机,该无人机导航定位装置包括:第一单
元501、第二单元502以及第三单元503。其中:
[0076]
该无人机内可包括星基授时装置,星基授时装置的精度可达20纳秒量级,该星基授时装置可用于向无人机导航定位装置传播标准时间。
[0077]
第一单元501,用于根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息。
[0078]
其中,第一卫星导航系统信号与下文提到的第二卫星导航系统信号,是在不同的时间点从指定卫星导航系统接收到的信号,该指定卫星导航系统可为全球定位系统或者北斗卫星导航系统。无人机的第一位置信息可包括无人机在导航坐标系中的坐标(x1,y1,z1),将确定出无人机的第一位置信息的时间点记为t1,对应地,x1、y1、z1分别可以体现无人机在时间点t1所处位置的经度、纬度、高度。
[0079]
作为示例而非限定的是,该导航坐标系可如图2所示,该导航坐标系为三维坐标系,导航坐标系中的三个轴分别为第一轴、第二轴、第三轴,导航坐标系的原点q1位于地球质心处,第三轴通过格林尼治线和赤道线的交点q2,第三轴的正方向为原点q1指向交点q2的方向,第二轴通过原点q1,且第二轴的正方向为原点q1指向北极的方向,第一轴与第二轴以及第三轴构成右手坐标系。
[0080]
另外,rtk载波相位差分技术的原理主要是无人机接收地面端基准站所发送的信号,根据卫星导航系统信号和地面端基准站所发送的信号确定无人机的位置信息。
[0081]
第二单元502,用于获取无人机的姿态数据。
[0082]
其中,该无人机的姿态数据包括横滚角、俯仰角以及偏航角。
[0083]
为了便于描述,可在无人机上建立机体坐标系,该机体坐标系(三维坐标系)可如图3所示,将机体坐标系的三个坐标轴分别记为:x2轴、y2轴、z2轴,机体坐标系的原点q3位于飞机质心处,z2轴在无人机的对称平面内并平行于无人机的设计轴线,z2轴的正方向为原点q3指向无人机的机头的方向,y2轴垂直于无人机的对称平面,且y2轴的正方向为原点q3指向无人机的机身上方,x2轴在无人机的对称平面内,x2轴与y2轴以及z2轴构成右手坐标系。
[0084]
其中,横滚角为机体坐标系的x2轴与导航坐标系的第一轴之间的夹角;俯仰角为机体坐标系的y2轴与导航坐标系的第二轴之间的夹角;偏航角为机体坐标系的z2轴与导航坐标系的第三轴之间的夹角。
[0085]
作为示例而非限定的是,第二单元502在获取无人机的姿态数据时,可具体用于:通过姿态传感器获取无人机的姿态数据。其中,姿态传感器是基于微机电系统技术的三维运动姿态测量系统,姿态传感器可包括三轴陀螺仪以及三轴电子罗盘等运动传感器,姿态传感器通过内嵌的arm处理器可得到经过温度补偿的姿态数据。
[0086]
第三单元503,用于根据姿态数据修正无人机的第一位置信息,以及根据修正后的第一位置信息进行导航。
[0087]
作为示例而非限定的是,第三单元503在根据修正后的第一位置信息进行导航时,具体用于:根据修正后的第一位置信息自动规划航线,根据规划出的航线进行导航。
[0088]
在一些实施例中,第三单元503在根据修正后的第一位置信息进行导航时,用于:根据修正后的第一位置信息确定无人机与指定禁飞区域之间的距离;若无人机与指定禁飞区域之间的距离小于或者等于预设距离,则规划出避绕指定禁飞区域的目标航线;根据目
标航线进行导航。由于能够规划出避绕指定禁飞区域的目标航线,以及根据目标航线进行导航,因此,能够减少因无人机的飞行而导致的风险,有效地维护了国家公共安全。
[0089]
其中,指定禁飞区域包括但不限于:军用机场区域、民用机场区域以及政府机构上空区域。
[0090]
在一些实施例中,第三单元503在根据修正后的第一位置信息进行导航时,用于:根据修正后的第一位置信息确定无人机与指定禁飞区域之间的距离;若无人机与指定禁飞区域之间的距离大于预设距离,则根据修正后的第一位置信息修正原定航线,根据原定航线进行导航。
[0091]
作为示例而非限定的是,该原定航线为:在根据修正后的第一位置信息进行导航之前,无人机所规划出来的航线。
[0092]
若无人机与指定禁飞区域之间的距离大于预设距离,则可以忽略指定禁飞区域对无人机的影响,直接根据修正后的第一位置信息修正原定航线,再根据原定航线进行导航,进而能够大大地提高导航精确度。
[0093]
可选地,第一单元501在根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息之后,根据第二卫星导航系统信号和rtk载波相位差分技术确定无人机的第二位置信息;对应地,第三单元503在根据姿态数据修正无人机的第一位置信息时,用于:根据姿态数据计算目标距离,目标距离为:在确定出无人机的第一位置信息之后,但未确定出无人机的第二位置信息所对应的时间段内,无人机对应的移动距离,根据目标距离修正无人机的第一位置信息。
[0094]
其中,无人机的第二位置信息可包括无人机在导航坐标系中的坐标(x3,y3,z3),将确定出无人机的第二位置信息的时间点记为时间点t2,对应地,x3、y3、z3可以分别体现无人机在时间点t2所处位置的经度、纬度、高度。
[0095]
为了便于描述,将在确定出无人机的第一位置信息之后,但未确定出无人机的第二位置信息所对应的时间段记为时间段h,即可将t1至t2之间的时间段记为时间段h,也可以将时间段h记为开区间(t1,t2),其中,时间段h不包括t1和t2这两个时间点,而是包括t1至t2之间的时间点。
[0096]
其中,该无人机的姿态数据包括:姿态传感器在时间点t1所计算出的姿态数据,该无人机的姿态数据还可包括:姿态传感器在时间段h内所计算出的姿态数据。
[0097]
作为示例而非限定的是,假设时间点t1为10点01分01秒,时间点t2为10点01分10秒,对应地,该目标距离为:在10点01分01秒至10点01分10秒之间的时间段内,无人机对应的移动距离,即该目标距离为无人机在时间段h(10点01分01秒至10点01分10秒之间的时间段)内移动的距离。
[0098]
一般地,当无人机处于工作状态时,无人机的位置总是在不断地变动,对应地,无人机需要不断地更新其位置信息,在本申请实施例中,可体现为“在根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息之后,需要根据第二卫星导航系统信号和rtk载波相位差分技术确定无人机的第二位置信息”。由于在“确定出无人机的第一位置信息之后,但未确定出无人机的第二位置信息”所对应的时间段内,无人机会移动一定的距离,因此,为了能够较为准确地修正第一位置信息,需要根据姿态数据计算目标距离,再根据目标距离修正无人机的第一位置信息,进而,根据修正后的第一位置信息进行导
航,能够提高导航的精确度。
[0099]
可选地,无人机的第一位置信息包括:无人机在导航坐标系中的坐标,导航坐标系为三维坐标系,导航坐标系中的三个轴分别为第一轴、第二轴、第三轴,对应地,第三单元503在根据姿态数据计算目标距离时,用于:根据姿态数据和无人机的加速度计算目标距离,目标距离包括:在确定出无人机的第一位置信息之后,但未确定出无人机的第二位置信息所对应的时间段内,无人机在第一轴的方向上的移动距离、无人机在第二轴的方向上的移动距离以及无人机在第三轴的方向上的移动距离;对应地,第三单元503在根据目标距离修正无人机的第一位置信息时,用于:根据无人机在第一轴的方向上的移动距离、无人机在第二轴的方向上的移动距离以及无人机在第三轴的方向上的移动距离修正无人机的第一位置信息。
[0100]
其中,无人机的加速度为无人机中的加速度计所输出的加速度,由于加速度计和无人机的机体是固连在一起的,因此,该无人机的加速度可表现为机体坐标系中的三维矢量加速度。
[0101]
另外,第三单元503在根据姿态数据和无人机的加速度计算目标距离时,具体用于:根据姿态数据中的横滚角从该无人机的加速度中分解出第一加速度,根据姿态数据中的俯仰角从该无人机的加速度中分解出第二加速度,以及根据姿态数据中的偏航角从该无人机的加速度中分解出第三加速度,其中,第一加速度为该无人机的加速度在导航坐标系上的第一轴上的线加速度分量,第二加速度为该无人机的加速度在导航坐标系上的第二轴上的线加速度分量,第三加速度为该无人机的加速度在导航坐标系上的第三轴上的线加速度分量,根据第一加速度计算在时间段h内无人机在第一轴的方向上的移动距离,根据第二加速度计算在时间段h内无人机在第二轴的方向上的移动距离,以及根据第三加速度计算在时间段h内无人机在第三轴的方向上的移动距离。
[0102]
由于该无人机的姿态数据包括横滚角、俯仰角以及偏航角,且横滚角为机体坐标系的x2轴与导航坐标系的第一轴之间的夹角,俯仰角为机体坐标系的y2轴与导航坐标系的第二轴之间的夹角,偏航角为机体坐标系的z2轴与导航坐标系的第三轴之间的夹角,因此,根据横滚角、俯仰角、偏航角可实现无人机的加速度在机体坐标系与导航坐标系之间进行转换,在本实施例中,具体体现为将无人机的加速度(在机体坐标系中的三维矢量加速度)分解出(在导航坐标系的三个轴上的)第一加速度、第二加速度、第三加速度,进而能够较为精准地计算出在时间段h内无人机在导航坐标系的三个轴方向上的移动距离,以提高修正后的第一位置信息的准确度。
[0103]
作为示例而非限定的是,假设无人机的第一位置信息为无人机在导航坐标系中的坐标(x1,y1,z1),对应地,修正后的第一位置信息为无人机在导航坐标系中的坐标(x11,y11,z11),无人机的姿态数据包括:在时间点t1姿态传感器所计算出的横滚角p10、在时间点t1获取到的俯仰角p20、在时间点t1获取到的偏航角p30,无人机的加速度包括:在时间点t1加速度计所输出的加速度a10,对应地,第三单元503在根据姿态数据中的横滚角从该无人机的加速度中分解出第一加速度时,可具体用于:用a10乘以cos p10,将a10与cos p10的乘积确定为第一加速度,对应地,第三单元503在根据第一加速度计算在时间段h内无人机在第一轴的方向上的移动距离s1时,可具体用于:根据第一加速度计算在时间点t1时无人
机在第一轴的方向上的瞬时速度v,根据瞬时速度v以及公式计算s1,其中,t表示时间。以此类推,第三单元503计算出无人机在第二轴的方向上的移动距离s2以及无人机在第三轴的方向上的移动距离s3,对应地,第三单元503在根据无人机在第一轴的方向上的移动距离、无人机在第二轴的方向上的移动距离以及无人机在第三轴的方向上的移动距离修正无人机的第一位置信息时,具体用于:用s1加上x1,将s1与x1之和确定为x11,用s2加上y1,将s2与y1之和确定为y11,以及用s3加上z1,将s1与z1之和确定为z11,即可得到修正后的第一位置信息(x11,y11,z11)。
[0104]
可选地,第三单元503在根据修正后的第一位置信息进行导航时,具体用于:根据修正后的第一位置信息和确定出无人机的第二位置信息的时间点进行导航。
[0105]
具体地,第三单元503将修正后的第一位置信息和确定出无人机的第二位置信息的时间点进行融合,融合后的数据可表示为四维坐标,根据融合后的数据进行导航。
[0106]
由于目标距离为:在“确定出无人机的第一位置信息之后,但未确定出无人机的第二位置信息”所对应的时间段内,无人机对应的移动距离,因此,可将修正后的第一位置信息视为:无人机在确定出无人机的第二位置信息的时间点所处位置的信息,对应地,第三单元503可将修正后的第一位置信息和确定出无人机的第二位置信息的时间点进行融合,再根据融合后的数据进行导航,由此,能够大大地提高导航的准确度。
[0107]
作为示例而非限定的是,将修正后的第一位置信息(x11,y11,z11)和确定出无人机的第二位置信息的时间点进行融合,融合后的数据可表示为四维坐标(x11,y11,z11,t2),根据(x11,y11,z11,t2)进行导航。
[0108]
本申请实施例中,rtk载波相位差分技术是基于将无人机视为质点的前提下实现的,即在根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息的过程中,是不考虑无人机的姿态的。本申请实施例中,由于能够在根据第一卫星导航系统信号和rtk载波相位差分技术确定无人机的第一位置信息之后,还获取无人机的姿态数据,再根据姿态数据修正无人机的第一位置信息,修正后的第一位置信息的准确性较高,因此,根据修正后的第一位置信息进行导航,能够大大地提高导航精确度。
[0109]
实施例四:
[0110]
图4为本申请一实施例提供的无人机导航定位终端设备的结构示意图。如图4所示,该实施例的无人机导航定位终端设备4包括:至少一个处理器40(图4中仅示出一个)处理器、存储器41以及存储在该存储器41中并可在该至少一个处理器40上运行的计算机程序42,该处理器40执行该计算机程序42时实现上述任意各个无人机导航定位方法实施例中的步骤。
[0111]
该无人机导航定位终端设备4可以是桌上型计算机、笔记本、掌上电脑及云端服务器等计算设备。该无人机导航定位终端设备可包括,但不仅限于,处理器40、存储器41。本领域技术人员可以理解,图4仅仅是无人机导航定位终端设备4的举例,并不构成对无人机导航定位终端设备4的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件,例如还可以包括输入输出设备、网络接入设备等。
[0112]
所称处理器40可以是中央处理单元(central processing unit,cpu),该处理器40还可以是其他通用处理器、数字信号处理器(digital signal processor,dsp)、专用集
成电路(application specific integrated circuit,asic)、现成可编程门阵列(field

programmable gate array,fpga)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。
[0113]
该存储器41在一些实施例中可以是该无人机导航定位终端设备4的内部存储单元,例如无人机导航定位终端设备4的硬盘或内存。该存储器41在另一些实施例中也可以是该无人机导航定位终端设备4的外部存储设备,例如该无人机导航定位终端设备4上配备的插接式硬盘,智能存储卡(smart media card,smc),安全数字(secure digital,sd)卡,闪存卡(flash card)等。进一步地,该存储器41还可以既包括该无人机导航定位终端设备4的内部存储单元也包括外部存储设备。该存储器41用于存储操作系统、应用程序、引导装载程序(bootloader)、数据以及其他程序等,例如该计算机程序的程序代码等。该存储器41还可以用于暂时地存储已经输出或者将要输出的数据。
[0114]
需要说明的是,上述单元之间的信息交互、执行过程等内容,由于与本申请方法实施例基于同一构思,其具体功能及带来的技术效果,具体可参见方法实施例部分,此处不再赘述。
[0115]
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将该装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。实施例中的各功能单元、模块可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中,上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。另外,各功能单元、模块的具体名称也只是为了便于相互区分,并不用于限制本申请的保护范围。上述系统中单元、模块的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
[0116]
本申请实施例还提供了一种计算机可读存储介质,该计算机可读存储介质存储有计算机程序,该计算机程序被处理器执行时实现可实现上述各个方法实施例中的步骤。
[0117]
本申请实施例提供了一种计算机程序产品,当计算机程序产品在移动终端上运行时,使得移动终端执行时实现可实现上述各个方法实施例中的步骤。
[0118]
该集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请实现上述实施例方法中的全部或部分流程,可以通过计算机程序来指令相关的硬件来完成,该的计算机程序可存储于一计算机可读存储介质中,该计算机程序在被处理器执行时,可实现上述各个方法实施例的步骤。其中,该计算机程序包括计算机程序代码,该计算机程序代码可以为源代码形式、对象代码形式、可执行文件或某些中间形式等。该计算机可读介质至少可以包括:能够将计算机程序代码携带到拍照终端设备的任何实体或装置、记录介质、计算机存储器、只读存储器(rom,read

only memory)、随机存取存储器(ram,random access memory)、电载波信号、电信信号以及软件分发介质。例如u盘、移动硬盘、磁碟或者光盘等。在某些司法管辖区,根据立法和专利实践,计算机可读介质不可以是电载波信号和电信信号。
[0119]
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述或记载的部分,可以参见其它实施例的相关描述。
[0120]
本领域普通技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请的范围。
[0121]
在本申请所提供的实施例中,应该理解到,所揭露的网络设备和方法,可以通过其它的方式实现。例如,以上所描述的网络设备实施例仅仅是示意性的,例如,该模块或单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通讯连接可以是通过一些接口,装置或单元的间接耦合或通讯连接,可以是电性,机械或其它的形式。
[0122]
该作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
[0123]
以上该实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围,均应包含在本申请的保护范围之内。
当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1