CN110716222B - 一种基于无人机的无人车导航方法及系统 - Google Patents

一种基于无人机的无人车导航方法及系统 Download PDF

Info

Publication number
CN110716222B
CN110716222B CN201911093747.5A CN201911093747A CN110716222B CN 110716222 B CN110716222 B CN 110716222B CN 201911093747 A CN201911093747 A CN 201911093747A CN 110716222 B CN110716222 B CN 110716222B
Authority
CN
China
Prior art keywords
unmanned aerial
aerial vehicle
unmanned
vehicle
current
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
CN201911093747.5A
Other languages
English (en)
Other versions
CN110716222A (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.)
Beihang University
Original Assignee
Beihang University
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 Beihang University filed Critical Beihang University
Priority to CN201911093747.5A priority Critical patent/CN110716222B/zh
Publication of CN110716222A publication Critical patent/CN110716222A/zh
Application granted granted Critical
Publication of CN110716222B publication Critical patent/CN110716222B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/46—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being of a radio-wave signal type
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/10—Position of receiver fixed by co-ordinating a plurality of position lines defined by path-difference measurements, e.g. omega or decca systems

Abstract

本发明公开一种基于无人机的无人车导航方法及系统。该方法包括：获取当前时刻无人机的广播信息以及接收到的可见星信息；利用广播信息和可见星信息对无人车当前时刻的位置进行计算得到当前时刻估计位置；判断当前时刻距离上次无人机位置调整时刻的时长是否达到预设时长；若否，则以当前时刻估计位置作为无人车的当前位置；若是，则利用无人机的广播信息、可见星信息以及当前时刻估计位置进行基于几何精度因子的无人机最优位置计算得到无人机最优位置；将无人机最优位置发送给无人机，使无人机调整到无人机最优位置；调整后，返回步骤“获取当前时刻无人机的广播信息以及接收到的可见星信息”。本发明能够在卫星信号缺失的情况下实现自主导航。

Description

一种基于无人机的无人车导航方法及系统
技术领域
本发明涉及导航定位领域，特别是涉及一种基于无人机的无人车导航方法及系统。
背景技术
对于无人车而言，实现自身准确的导航定位是执行一切任务的必备前提，正是受限于精准导航的需求，早期无人车的使用主要集中在工厂这样的非常局限的地方，通常需要在地面铺设专用的线条，安装专用的传感器件，并且只能完成非常简单的工作。而随着计算机处理能力的飞速发展，定位技术不断进步，当前的定位算法己经达到满足各种实时定位的要求，为在更多环境下使用的无人车提供了可能。就目前而言，在综合考虑硬件成本、系统可靠性、导航精度、计算实时性等因素的基础上，利用全球卫星导航系统(GNSS，GlobalNavigation Satellite System)(例如GPS(Global Positioning System，全球定位系统)、BDS(BeiDou Navigation Satellite System，北斗卫星导航系统)等)实现无人车的导航是首选。然而，GNSS卫星信号受环境影响较大，在复杂建筑群(例如城市环境下)、峡谷、森林等地会因信号衰减而无法准确导航定位。因此，对于这些特定场合，需要寻求其它的导航技术提供定位信息。此外，在有些需要高精度定位的场合，受限于GNSS可见星的数量与GNSS可见星的星座位置，仅依赖于GNSS信息可能无法达到预期的定位精度。
发明内容
本发明的目的是提供一种基于无人机的无人车导航方法及系统，在GNSS卫星信号不足以实现定位的情况下实现自主导航。
为实现上述目的，本发明提供了如下方案：
一种基于无人机的无人车导航方法，应用于一种无人车导航定位装置；该导航定位装置包括无人车和至少一架具有自主导航能力的无人机；所述无人车与所述无人机无线通讯连接；
该无人车导航方法包括：
获取当前时刻无人机的广播信息以及接收到的可见星信息；
利用所述无人机的广播信息和所述可见星信息对所述无人车当前时刻的位置进行计算，得到当前时刻估计位置；
判断当前时刻距离上次无人机位置调整时刻的时长是否达到预设时长，得到判断结果；
若所述判断结果表示否，则以所述当前时刻估计位置作为无人车的当前位置；
若所述判断结果表示是，则利用所述无人机的广播信息、所述可见星信息以及所述当前时刻估计位置进行基于几何精度因子的无人机最优位置计算，得到无人机最优位置；
将所述无人机最优位置发送给所述无人机，使所述无人机调整到所述无人机最优位置；
在所述无人机调整到所述无人机最优位置后，返回步骤“获取当前时刻无人机的广播信息以及接收到的可见星信息”。
可选的，所述利用所述无人机的广播信息和所述可见星信息对所述无人车当前时刻的位置进行计算，得到当前时刻估计位置，具体包括：
构建无人车、无人机和可见星的相对几何关系方程；
将所述广播信息以及所述可见星信息代入所述相对几何关系方程，利用牛顿迭代法进行求解，得到无人车的当前时刻估计位置。
可选的，所述利用所述无人机的广播信息、所述可见星信息以及所述当前时刻估计位置进行基于几何精度因子的无人机最优位置计算，得到无人机最优位置，具体包括：
构建无人车至各无人机位置的矢量以及无人车至各可见星位置的矢量，得到矢量矩阵；
依据所述矢量矩阵计算几何精度因子的表达式；
利用拉格朗日法对所述几何精度因子的表达式进行求解，得到使所述几何精度因子达到最小值时的约束条件；
根据所述约束条件确定各无人机的可选最优位置。
可选的，在所述根据所述约束条件确定各无人机的最优位置之后，还包括：
从各无人机的可选最优位置中选取使所有无人机的总移动距离最小的最优位置方案，得到各无人机的最优位置。
可选的，所述预设时长为无人机发送100次广播信息所需时长。
一种基于无人机的无人车导航系统，应用于一种无人车导航定位装置；该导航定位装置包括无人车和至少一架具有自主导航能力的无人机；所述无人车与所述无人机无线通讯连接；
该无人车导航系统包括：
信息获取模块，用于获取当前时刻无人机的广播信息以及接收到的可见星信息；
位置估计模块，用于利用所述无人机的广播信息和所述可见星信息对所述无人车当前时刻的位置进行计算，得到当前时刻估计位置；
判断模块，用于判断当前时刻距离上次无人机位置调整时刻的时长是否达到预设时长，得到判断结果；
位置确定模块，用于若所述判断结果表示否，则以所述当前时刻估计位置作为无人车的当前位置；
无人机最优位置计算模块，用于若所述判断结果表示是，则利用所述无人机的广播信息、所述可见星信息以及所述当前时刻估计位置进行基于几何精度因子的无人机最优位置计算，得到无人机最优位置；
无人机位置调整模块，用于将所述无人机最优位置发送给所述无人机，使所述无人机调整到所述无人机最优位置；
返回模块，用于在所述无人机调整到所述无人机最优位置后，返回所述信息获取模块。
可选的，所述位置估计模块包括：
方程构建单元，用于构建无人车、无人机和可见星的相对几何关系方程；
方程求解单元，用于将所述广播信息以及所述可见星信息代入所述相对几何关系方程，利用牛顿迭代法进行求解，得到无人车的当前时刻估计位置。
可选的，所述无人机最优位置计算模块包括：
矢量矩阵构建单元，用于构建无人车至各无人机位置的矢量以及无人车至各可见星位置的矢量，得到矢量矩阵；
几何精度因子表达式确定单元，用于依据所述矢量矩阵计算几何精度因子的表达式；
约束条件确定单元，用于利用拉格朗日法对所述几何精度因子的表达式进行求解，得到使所述几何精度因子达到最小值时的约束条件；
可选最优位置确定单元，用于根据所述约束条件确定各无人机的可选最优位置。
可选的，所述无人机最优位置计算模块包括：
最优方案选取单元，用于从各无人机的可选最优位置中选取使所有无人机的总移动距离最小的最优位置方案，得到各无人机的最优位置。
可选的，所述预设时长为无人机发送100次广播信息所需时长。
根据本发明提供的具体实施例，本发明公开了以下技术效果：本发明提供的基于无人机的无人车导航方法及系统，利用无人机的定位信息实现无人车的自主导航定位。并且通过不断对无人机的位置进行调整，使得无人机跟随无人车的同时保证较高的定位精度，提高了无人车的定位精度。因此本发明能够在GNSS卫星信号不足以实现定位的情况下实现自主导航。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例1的基于无人机的无人车导航方法的方法流程图；
图2为执行无人机最优位置配置与未执行无人机最优位置配置的无人车X轴定位误差仿真结果对比图；
图3为本发明实施例2的基于无人机的无人车导航系统的系统结构图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本发明作进一步详细的说明。
本发明提供的基于无人机的无人车导航方法及系统，均应用于一种无人车导航定位装置。该导航定位装置满足以下条件：
1、具备至少一架多旋翼无人机，该无人机具有自主导航能力，具有足够的导航精度，且可以根据要求进行自主移动；2、无人机与无人车之间存在一套具备收发能力的无线通信系统，且利用该无线通信系统，可实现无人车与无人机之间的相对距离的估计；3、无人车依据实际需要选择性地配备GNSS导航设备。
无人机的数量选择需要考虑如下因素：无人车的运行范围，通信系统信号的覆盖范围，无人车的导航精度要求，是否配备有GNSS导航设备，系统的硬件成本等。此外，如果无人车不配备有GNSS设备，则该导航定位装置必须要具备3架以上的无人机才可满足无人车导航要求。
实施例1：
图1为本发明实施例1的基于无人机的无人车导航方法的方法流程图。
该无人车导航方法包括：
步骤101：获取当前时刻无人机的广播信息以及接收到的可见星信息。
全部无人车和无人机开始运行后，无人机利用自身导航设备进行导航，同时全部无人机对外广播当前自身位置坐标，无人车接收所有能接收到的无人机的广播信息并进行相对距离测算(利用无人机的广播信息可以实现相对距离测算)，同时若无人车配备GNSS设备，则无人车利用自身的GNSS设备搜索并接收当前时刻所有GNSS可见星的信息并进行导航解算(导航解算结果为当前无人车至各卫星的伪距测量结果，其中，伪距是卫星定位过程中，地面接收机到卫星之间的估计距离。
假定系统中存在m架无人机(分别命名为无人机-1，无人机-2，…，无人机-m)，一辆无人车，无人车具备GNSS设备且可以搜索到一定数量的卫星。假定以下所有的坐标均已统一至同一坐标系(例如WGS-84坐标系)。
假设无人机-1在k时刻的真实位置坐标为
Figure BDA0002267657580000061
无人机-2在k时刻的真实位置坐标为
Figure BDA0002267657580000062
其余无人机真实位置坐标依此类推。无人机-1在k时刻由自身导航系统提供的位置坐标为
Figure BDA0002267657580000063
无人机-2在k时刻由自身导航系统提供的位置坐标为
Figure BDA0002267657580000064
其余无人机依此类推。无人车利用通信系统解算得到的距离无人机-1的相对距离为：d1，解算得到的距离无人机-2的相对距离为：d2，其余无人机依此类推。同时假定此时GNSS的可见星为n颗，分别定义为卫星-1，卫星-2，…，卫星-n。其中，通过查阅GNSS星历，可得k时刻卫星-1的准确位置为
Figure BDA0002267657580000065
其对应的解算得到的伪距观测量为
Figure BDA0002267657580000066
卫星-2的准确位置为
Figure BDA0002267657580000067
其对应的解算得到的伪距观测量为
Figure BDA0002267657580000068
其余卫星依此类推。
步骤102：利用所述无人机的广播信息和所述可见星信息对所述无人车当前时刻的位置进行计算，得到当前时刻估计位置。
该步骤102具体包括：
构建无人车、无人机和可见星的相对几何关系方程。将所述广播信息以及所述可见星信息代入所述相对几何关系方程，利用牛顿迭代法进行求解，得到无人车的当前时刻估计位置。
对该步骤102进行举例说明如下：
无人车利用接收到的无人机广播信息与接收到的GNSS可见星信息进行自身位置的在线计算。定义无人车k时刻的真实位置为：
Figure BDA0002267657580000069
则无人车、无人机、GNSS卫星的相对几何关系方程为：
Figure BDA0002267657580000071
Figure BDA0002267657580000072
其中，Δt代表GNSS的时钟误差，c代表光速，vG1,…vGn,v1,…,vm均为量测噪声，vG1,…vGn是由于电离层误差，对流层误差等导致，v1,…,vm由于无人机自身导航误差，通信系统误差等导致。
在此相对几何关系方程的基础上，将无人机导航系统提供无人机的位置：
Figure BDA0002267657580000073
(分别替代无人车/无人机/GNSS卫星的相对几何关系方程中的
Figure BDA0002267657580000074
)、GNSS星历获得的GNSS卫星位置
Figure BDA0002267657580000075
无人车/无人机通讯系统所提供得到的相对距离信息d1，…,dm、GNSS卫星获得的伪距观测量
Figure BDA0002267657580000076
代入相对几何关系方程，使用牛顿迭代法求解相对几何关系方程，得到
Figure BDA0002267657580000077
的估算结果
Figure BDA0002267657580000078
本发明中，使用牛顿迭代法计算的过程中，以
Figure BDA0002267657580000079
的结果作为计算初值。
其中
Figure BDA00022676575800000710
代表k-1时刻计算得到的无人车位置信息，
Figure BDA00022676575800000711
代表k时刻计算得到的无人车位置信息。
步骤103：判断当前时刻距离上次无人机位置调整时刻的时长是否达到预设时长，得到判断结果。该步骤用于判断是否需要执行步骤105，即无人机的最优位置配置过程。为了减少无人机的不必要机动，最优位置配置计算并不是每个时刻都进行的，可以设定为当k满足一定条件下执行或者取决于无人车的机动程度(当机动程度较大时执行)，本发明设定为当k满足一定条件时执行，例如当k为100的整数倍时执行一次最优配置计算，即将预设时长设置为无人机发送100次广播信息所需时长。
步骤104：若所述判断结果表示否，则以所述当前时刻估计位置作为无人车的当前位置。
步骤105：若所述判断结果表示是，则利用所述无人机的广播信息、所述可见星信息以及所述当前时刻估计位置进行基于几何精度因子的无人机最优位置计算，得到无人机最优位置。
步骤105具体包括：
A、构建无人车至各无人机位置的矢量以及无人车至各可见星位置的矢量，得到矢量矩阵。
B、依据所述矢量矩阵计算几何精度因子的表达式。
C、利用拉格朗日法对所述几何精度因子的表达式进行求解，得到使所述几何精度因子达到最小值时的约束条件。
D、根据所述约束条件确定各无人机的可选最优位置。
E、从各无人机的可选最优位置中选取使所有无人机的总移动距离最小的最优位置方案，得到各无人机的最优位置。
对该步骤A～E进行详细说明如下：
基于现有信息，将无人机的最优位置配置问题进行如下描述：
待优化参数：无人机位置
Figure BDA0002267657580000081
限制条件：无人车现有可接收到的全部GNSS可见星位置
Figure BDA0002267657580000082
无人车当前时刻位置
Figure BDA0002267657580000083
均不可改变；
性能指标：观测星座的GDOP(Geometric Dilution Precision，几何精度因子)。
由于GDOP反比于导航精度，即性能指标需要在满足限制条件的基础上尽可能的达到最小值。
其中，GDOP的计算方法如下：
首先计算当前无人车至各无人机与GNSS可见星的矢量：
Figure BDA0002267657580000091
Figure BDA0002267657580000092
Figure BDA0002267657580000093
分别为无人车至各无人机的位置矢量；
Figure BDA0002267657580000094
分别为无人车至各可见星的矢量。
进而可以构建矢量矩阵：
Figure BDA0002267657580000095
③进而计算得到：
DOP＝(MTM)-1
Figure BDA0002267657580000101
其中，( )T代表求取矩阵的转置，( )-1代表求取矩阵的逆，trace( )代表矩阵的迹，迹为矩阵对角线元素的和。
而通过利用拉格朗日法对上述最优问题进行求解，可以得到使得GDOP达到极小值的约束条件为：
knM＝01×3
其中，01×3代表1行3列的零矩阵，kn＝[1 1 1 1]。即，上述条件等价于：
Figure BDA0002267657580000102
M(i,1)、M(i,2)和M(i,3)分别为矢量矩阵第i行第1列元素、第i行第2列元素，第i行第3列元素。
如果仅以上述方程作为求解要求，可能会得到多组满足要求的无人机位置配置结果，而为了尽可能的减少无人机的飞行机动距离从而节约能量，因此本发明进一步采用如下的计算方法寻求最优：
定义寻求的最优无人机位置变量为：无人机-1位置：
Figure BDA0002267657580000103
无人机-m位置：
Figure BDA0002267657580000104
)，即该步骤的目的为寻找最优的
Figure BDA0002267657580000105
构建如下的矩阵：
Figure BDA0002267657580000106
Figure BDA0002267657580000111
Figure BDA0002267657580000112
Figure BDA0002267657580000113
分别为无人车至各无人机的最优位置的矢量。
进而可以构建矢量矩阵：
Figure BDA0002267657580000114
基于上述定义可以构建出如下的最优问题：
Figure BDA0002267657580000115
在满足
Figure BDA0002267657580000116
的基础上，寻求使得性能指标：
Figure BDA0002267657580000117
取得最小值，其中：
Figure BDA0002267657580000121
Mopt(j,1)、Mopt(j,2)和Mopt(j,3)分别为矢量矩阵第j行第1列、第j行第2列，第j行第3列的元素。dopt为m架无人机的移动距离总和，
Figure BDA0002267657580000122
为第p架无人机的移动距离。
上述最优化问题可以利用二次规划求解算法进行求解，得到无人机的最优位置配置结果：
Figure BDA0002267657580000123
另外，在充分考虑无人车计算能力与系统实时性要求的基础上，可以放松对解的最优性的要求，获得次优解也可以满足实际的使用要求。
步骤106：将所述无人机最优位置发送给所述无人机，使所述无人机调整到所述无人机最优位置。在所述无人机调整到所述无人机最优位置后，返回步骤101。
图2为执行无人机最优位置配置与未执行无人机最优位置配置的无人车X轴定位误差仿真结果对比图。
参见图2，仿真次数0-100次(虚线框区域)为尚未执行最优配置状态下的无人车导航定位结果，仿真次数100-150次(点划线区域)为无人机正在执行最优配置状态(无人机正处于位置调整状态)下的无人车导航定位结果，仿真次数150-250次(实线区域)为无人机已经运行至最优配置状态(结束位置调整状态)下的无人车导航定位结果，从图2中可以看出，实线区域的定位误差明显小于虚线框区域，即通过执行最优配置后，无人车的导航定位误差显著降低，导航定位精度得到提高。
实施例2：
图3为本发明实施例2的基于无人机的无人车导航系统的系统结构图。
参见图3该无人车导航系统包括：
信息获取模块201，用于获取当前时刻无人机的广播信息以及接收到的可见星信息；
位置估计模块202，用于利用所述无人机的广播信息和所述可见星信息对所述无人车当前时刻的位置进行计算，得到当前时刻估计位置；
判断模块203，用于判断当前时刻距离上次无人机位置调整时刻的时长是否达到预设时长，得到判断结果；
位置确定模块204，用于若所述判断结果表示否，则以所述当前时刻估计位置作为无人车的当前位置；
无人机最优位置计算模块205，用于若所述判断结果表示是，则利用所述无人机的广播信息、所述可见星信息以及所述当前时刻估计位置进行基于几何精度因子的无人机最优位置计算，得到无人机最优位置；
无人机位置调整模块206，用于将所述无人机最优位置发送给所述无人机，使所述无人机调整到所述无人机最优位置；
返回模块207，用于在所述无人机调整到所述无人机最优位置后，返回所述信息获取模块。
可选的，所述位置估计模块202包括：
方程构建单元，用于构建无人车、无人机和可见星的相对几何关系方程；
方程求解单元，用于将所述广播信息以及所述可见星信息代入所述相对几何关系方程，利用牛顿迭代法进行求解，得到无人车的当前时刻估计位置。
可选的，所述无人机最优位置计算模块包括：
矢量矩阵构建单元，用于构建无人车至各无人机位置的矢量以及无人车至各可见星位置的矢量，得到矢量矩阵；
几何精度因子表达式确定单元，用于依据所述矢量矩阵计算几何精度因子的表达式；
约束条件确定单元，用于利用拉格朗日法对所述几何精度因子的表达式进行求解，得到使所述几何精度因子达到最小值时的约束条件；
可选最优位置确定单元，用于根据所述约束条件确定各无人机的可选最优位置。
可选的，所述无人机最优位置计算模块205包括：
最优方案选取单元，用于从各无人机的可选最优位置中选取使所有无人机的总移动距离最小的最优位置方案，得到各无人机的最优位置。
可选的，所述预设时长为无人机发送100次广播信息所需时长。
根据本发明提供的具体实施例，本发明公开了以下技术效果：本发明提供的基于无人机的无人车导航方法及系统，有效的解决了传统的依赖于GNSS信息的无人车导航算法无法在GNSS信息缺失/失效情况下准确导航定位的问题，通过无人车与无人机之间进行协同定位导航的方式，有效扩展了无人车的应用范围。该算法将当前接收到的GNSS卫星信息、无人车当前导航定位结果作为限制条件，将无人机的位置作为可变参量，将观测星座的GDOP值作为性能指标，利用相关寻优算法可以计算得到：在满足限制条件的基础上，使得性能指标达到最优的可变参量值，即实现无人机位置的最优配置，进而提升无人车的导航定位精度。
本说明书中各个实施例采用递进的方式描述，每个实施例重点说明的都是与其他实施例的不同之处，各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言，由于其与实施例公开的方法相对应，所以描述的比较简单，相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处。综上所述，本说明书内容不应理解为对本发明的限制。

Claims (8)

1.一种基于无人机的无人车导航方法，其特征在于，应用于一种无人车导航定位装置；该导航定位装置包括无人车和至少一架具有自主导航能力的无人机；所述无人车与所述无人机无线通讯连接；
该无人车导航方法包括：
获取当前时刻无人机的广播信息以及接收到的可见星信息；
利用所述无人机的广播信息和所述可见星信息对所述无人车当前时刻的位置进行计算，得到当前时刻估计位置；
判断当前时刻距离上次无人机位置调整时刻的时长是否达到预设时长，得到判断结果；
若所述判断结果表示否，则以所述当前时刻估计位置作为无人车的当前位置；
若所述判断结果表示是，则利用所述无人机的广播信息、所述可见星信息以及所述当前时刻估计位置进行基于几何精度因子的无人机最优位置计算，得到无人机最优位置，具体包括：构建无人车至各无人机位置的矢量以及无人车至各可见星位置的矢量，得到矢量矩阵；依据所述矢量矩阵计算几何精度因子的表达式；利用拉格朗日法对所述几何精度因子的表达式进行求解，得到使所述几何精度因子达到最小值时的约束条件根据所述约束条件确定各无人机的可选最优位置；
将所述无人机最优位置发送给所述无人机，使所述无人机调整到所述无人机最优位置；
在所述无人机调整到所述无人机最优位置后，返回步骤“获取当前时刻无人机的广播信息以及接收到的可见星信息”。
2.根据权利要求1所述的基于无人机的无人车导航方法，其特征在于，所述利用所述无人机的广播信息和所述可见星信息对所述无人车当前时刻的位置进行计算，得到当前时刻估计位置，具体包括：
构建无人车、无人机和可见星的相对几何关系方程；
将所述广播信息以及所述可见星信息代入所述相对几何关系方程，利用牛顿迭代法进行求解，得到无人车的当前时刻估计位置。
3.根据权利要求1所述的基于无人机的无人车导航方法，其特征在于，在所述根据所述约束条件确定各无人机的最优位置之后，还包括：
从各无人机的可选最优位置中选取使所有无人机的总移动距离最小的最优位置方案，得到各无人机的最优位置。
4.根据权利要求1所述的基于无人机的无人车导航方法，其特征在于，所述预设时长为无人机发送100次广播信息所需时长。
5.一种基于无人机的无人车导航系统，其特征在于，应用于一种无人车导航定位装置；该导航定位装置包括无人车和至少一架具有自主导航能力的无人机；所述无人车与所述无人机无线通讯连接；
该无人车导航系统包括：
信息获取模块，用于获取当前时刻无人机的广播信息以及接收到的可见星信息；
位置估计模块，用于利用所述无人机的广播信息和所述可见星信息对所述无人车当前时刻的位置进行计算，得到当前时刻估计位置；
判断模块，用于判断当前时刻距离上次无人机位置调整时刻的时长是否达到预设时长，得到判断结果；
位置确定模块，用于若所述判断结果表示否，则以所述当前时刻估计位置作为无人车的当前位置；
无人机最优位置计算模块，用于若所述判断结果表示是，则利用所述无人机的广播信息、所述可见星信息以及所述当前时刻估计位置进行基于几何精度因子的无人机最优位置计算，得到无人机最优位置；
所述无人机最优位置计算模块包括：
矢量矩阵构建单元，用于构建无人车至各无人机位置的矢量以及无人车至各可见星位置的矢量，得到矢量矩阵；
几何精度因子表达式确定单元，用于依据所述矢量矩阵计算几何精度因子的表达式；
约束条件确定单元，用于利用拉格朗日法对所述几何精度因子的表达式进行求解，得到使所述几何精度因子达到最小值时的约束条件；
可选最优位置确定单元，用于根据所述约束条件确定各无人机的可选最优位置；
无人机位置调整模块，用于将所述无人机最优位置发送给所述无人机，使所述无人机调整到所述无人机最优位置；
返回模块，用于在所述无人机调整到所述无人机最优位置后，返回所述信息获取模块。
6.根据权利要求5所述的基于无人机的无人车导航系统，其特征在于，所述位置估计模块包括：
方程构建单元，用于构建无人车、无人机和可见星的相对几何关系方程；
方程求解单元，用于将所述广播信息以及所述可见星信息代入所述相对几何关系方程，利用牛顿迭代法进行求解，得到无人车的当前时刻估计位置。
7.根据权利要求5所述的基于无人机的无人车导航系统，其特征在于，所述无人机最优位置计算模块包括：
最优方案选取单元，用于从各无人机的可选最优位置中选取使所有无人机的总移动距离最小的最优位置方案，得到各无人机的最优位置。
8.根据权利要求5所述的基于无人机的无人车导航系统，其特征在于，所述预设时长为无人机发送100次广播信息所需时长。
CN201911093747.5A 2019-11-11 2019-11-11 一种基于无人机的无人车导航方法及系统 Active CN110716222B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911093747.5A CN110716222B (zh) 2019-11-11 2019-11-11 一种基于无人机的无人车导航方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911093747.5A CN110716222B (zh) 2019-11-11 2019-11-11 一种基于无人机的无人车导航方法及系统

Publications (2)

Publication Number Publication Date
CN110716222A CN110716222A (zh) 2020-01-21
CN110716222B true CN110716222B (zh) 2021-08-03

Family

ID=69215793

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911093747.5A Active CN110716222B (zh) 2019-11-11 2019-11-11 一种基于无人机的无人车导航方法及系统

Country Status (1)

Country Link
CN (1) CN110716222B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111208544B (zh) * 2020-03-04 2022-06-17 南京航空航天大学 一种用于无人机蜂群协同导航的完好性保护水平优化方法
CN112505626A (zh) * 2020-07-24 2021-03-16 北京航空航天大学 一种基于无人机的三维立体交通车辆定位方法
CN112146650B (zh) * 2020-09-18 2022-04-01 南京航空航天大学 一种用于无人蜂群协同导航的构型优化方法
CN113766416A (zh) * 2020-12-02 2021-12-07 北京京东乾石科技有限公司 一种无人机定位方法、装置及存储介质
CN116929350B (zh) * 2023-08-23 2023-11-21 南京理工大学 一种基于数据链测距的快速临机重构协同导航系统及方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102879792A (zh) * 2012-09-17 2013-01-16 南京航空航天大学 一种基于飞行器群动态组网的伪卫星系统
CN206523781U (zh) * 2017-01-22 2017-09-26 江苏中科院智能科学技术应用研究院 一种无人机与无人车协作巡逻系统
CN107957726A (zh) * 2017-12-29 2018-04-24 南京工程学院 无人车导航系统
CN208224845U (zh) * 2018-06-05 2018-12-11 南京工程学院 一种全方位视角的无人车导航系统
CN109813306A (zh) * 2019-01-17 2019-05-28 李子月 一种无人车规划轨迹卫星定位数据可信度计算方法
CN109813322A (zh) * 2019-03-18 2019-05-28 东莞理工学院 无人机与无人车协作导航系统
CN110285822A (zh) * 2019-07-01 2019-09-27 东莞理工学院 无人机建图算法与无人车导航算法的融合应用系统及方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102879792A (zh) * 2012-09-17 2013-01-16 南京航空航天大学 一种基于飞行器群动态组网的伪卫星系统
CN206523781U (zh) * 2017-01-22 2017-09-26 江苏中科院智能科学技术应用研究院 一种无人机与无人车协作巡逻系统
CN107957726A (zh) * 2017-12-29 2018-04-24 南京工程学院 无人车导航系统
CN208224845U (zh) * 2018-06-05 2018-12-11 南京工程学院 一种全方位视角的无人车导航系统
CN109813306A (zh) * 2019-01-17 2019-05-28 李子月 一种无人车规划轨迹卫星定位数据可信度计算方法
CN109813322A (zh) * 2019-03-18 2019-05-28 东莞理工学院 无人机与无人车协作导航系统
CN110285822A (zh) * 2019-07-01 2019-09-27 东莞理工学院 无人机建图算法与无人车导航算法的融合应用系统及方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
GPS 卫星坐标计算及几何精度因子;廖春招;《矿山测量》;20110831(第4期);29-31 *
无人机载伪卫星导航系统研究与应用;樊闯等;《科技论坛》;20161231;99-100 *
面向空地协同作战的无人机－无人车异构;周思全等;《航空兵器》;20190831;第26卷(第4期);54-59 *

Also Published As

Publication number Publication date
CN110716222A (zh) 2020-01-21

Similar Documents

Publication Publication Date Title
CN110716222B (zh) 一种基于无人机的无人车导航方法及系统
CN111886519B (zh) 定位系统、方法和介质
CN106255065B (zh) 智能手机室内外无缝定位系统及其方法
RU2446416C2 (ru) Способ повышения надежности информации о местоположении при переходе от региональной, широкомасштабной или глобальной дифференциальной навигации по фазе несущей (wadgps) к локальной кинематической в реальном времени (rtk) навигационной системе
US9116228B2 (en) Low latency centralized RTK system
US11808863B2 (en) Methods and systems for location determination
US20100090889A1 (en) Precise orbit determination system and method using gps data and galileo data
CN110208823B (zh) 确定用于基于卫星确定车辆位置的数据简档的方法
KR20150051747A (ko) 차량의 위치 결정 방법
CN109819670B (zh) 用于提供用于位置确定的校正数据的方法
Mu et al. A GNSS/INS-integrated system for an arbitrarily mounted land vehicle navigation device
Li et al. Performance analysis of indoor pseudolite positioning based on the unscented Kalman filter
Li et al. Review of PPP–RTK: Achievements, challenges, and opportunities
CN113063425A (zh) 车辆定位方法、装置、电子设备及存储介质
Xin et al. 3D-mapping-aided PPP-RTK aiming at deep urban canyons
Bauer et al. Evaluation of shadow maps for non-line-of-sight detection in urban GNSS vehicle localization with VANETs-The GAIN approach
CN116974291A (zh) 主从协同导航农业机械的控制误差确定方法及装置
KR20110114039A (ko) Ｄｒ／ｇｐｓ 데이터 융합 방법
CN112033441A (zh) 用于bds/mems组合导航下的联动编队完好性监测方法
CN114174870A (zh) 用于确定描述至少一个特定于环境的gnss曲线的模型的方法
CN109856656A (zh) 一种导航定位方法、装置、电子设备及存储介质
CN104864888A (zh) 一种导航设备位置修正的方法和装置
KR102270339B1 (ko) 고안전성 rtk-gnss의 초기 준비시간 단축 방법 및 시스템
CN111288990A (zh) 一种架空检修机器人组合姿态测量方法
CN114966790B (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