CN113238577B - 一种基于5g网关的无人机与无人车协作方法 - Google Patents
一种基于5g网关的无人机与无人车协作方法 Download PDFInfo
- Publication number
- CN113238577B CN113238577B CN202110524455.3A CN202110524455A CN113238577B CN 113238577 B CN113238577 B CN 113238577B CN 202110524455 A CN202110524455 A CN 202110524455A CN 113238577 B CN113238577 B CN 113238577B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- unmanned
- gateway
- vehicle
- 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 59
- 230000015572 biosynthetic process Effects 0.000 claims abstract description 41
- 230000004927 fusion Effects 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 24
- 238000005259 measurement Methods 0.000 claims description 14
- 238000004891 communication Methods 0.000 claims description 11
- 238000003491 array Methods 0.000 claims description 7
- 230000001131 transforming effect Effects 0.000 claims description 6
- 238000000354 decomposition reaction Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000012935 Averaging Methods 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000014759 maintenance of location Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation 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
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
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)
- Mobile Radio Communication Systems (AREA)
Abstract
本发明公开了一种基于5G网关的无人机与无人车协作方法,包括云平台、无人车和无人机,所述5G网关终端包括队形保持控制器和轨迹跟踪控制器;基于TDOA和DOA融合定位方式计算5G网关的网关终端坐标;所述云平台根据所述无人车和所述无人机的实际运行状态以及执行任务规划虚拟领航者的轨迹,将期望运行信息发送给所述5G网关终端;所述5G网关终端将编队控制的控制量下发给无人车和无人机两者的控制器,由控制器控制无人车和无人机的运行。该方法提供稳定的精度较高的定位信息,无人机能与地面无人车完成协作任务。
Description
技术领域
本发明涉及5G网络技术领域,尤其涉及一种基于5G网关的无人机与无人车协作方法。
背景技术
目前市面上的无人机多采用2.4G等短程通信方式,仅能在视距范围内进行控制,通信距离短,数据共享能力差,而4G通信在时延、带宽上无法满足部分无人机业务。无人机定位主要基于GPS定位,定位精度不高,GPS信号易受建筑物等遮挡导致定位失效。RTK定位可提供高精度的定位信息,若无人机采用RTK定位,需在无人机上携带两个以上的信号接收机,给无人机带来较大负荷。
而且,现有的大部分无人机不具备协同能力,感知和作业范围小,在有协同作业需求时改造升级成本高、难度大。例如无人机和消防机器人协同侦查灭火的情况。有鉴于此,需要对传统单机飞行的无人机进行定位功能和协同作业能力的快速扩展。
发明内容
本发明的目的在于提出一种基于5G网关的无人机与无人车协作方法,将5G网关作为无人机飞行控制的扩展模块,无需对原有无人机和飞行系统做大规模改动,即可为无人机进行低成本的快速升级,5G网关通过5G无线定位方式提供稳定的精度较高的定位信息,通过5G网关在边缘计算平台为无人机扩展协作功能,使无人机能与地面无人车完成协作任务,有效扩大无人机在侦察巡检范围。
为达此目的,本发明采用以下技术方案:
一种基于5G网关的无人机与无人车协作方法,包括云平台、无人车和无人机,所述无人车和无人机均安装有5G网关终端,所述无人车和无人机均通过5G无线网络与所述云平台通信连接;
所述5G网关包括队形保持控制器和轨迹跟踪控制器;
该方法包括以下步骤:
基于TDOA和DOA融合定位方式计算5G网关终端坐标;
基于5G网关终端坐标,获取所述无人车和所述无人机的实际运行状态,所述实际运行状态包括实际位置、实际速度和实际航向角度;
所述云平台构建有虚拟领航者的无人车和无人机的编队系统模型;
所述5G网关终端将所述无人车和无人机的实际运行状态发送至所述云平台;
所述云平台根据所述无人车和所述无人机的实际运行状态以及执行任务规划虚拟领航者的轨迹,将无人车和无人机的期望运行信息发送给所述5G网关终端,所述期望运行信息包括期望位置、速度和航向角度;
所述5G网关终端的队形保持控制器根据所述期望运行信息计算出无人机和无人车编队保持队形所需的控制量,所述5G网关终端的轨迹跟踪控制器计算出无人车和无人机跟踪虚拟领航者所需的控制量,将两部分控制量加权求和作为编队控制的控制量;
所述5G网关终端将编队控制的控制量分别下发给无人车和无人机两者的控制器,由控制器控制无人车和无人机的运行。
进一步的,基于TDOA和DOA融合定位方式计算5G网关终端坐标的方法为:
TDOA定位:通过5G网关终端到达两个不同基站的间的时间差估计5G网关终端到该两个基站的距离差,再由该距离差与5G网关终端坐标关系解算该5G网关终端的坐标;
DOA定位:通过天线阵列测量两个基站发出的信号到5G网关终端接收的入射角度,建立空间直线方程组,所述入射角度包括俯仰角和偏航角;通过所述的空间直线方程组联解出该5G网关终端的坐标;
将TDOA定位所得5G网关终端的坐标和DOA定位所得5G网关终端的坐标,加权平均得到最终坐标。
进一步的,所述TDOA定位的方法为:
(1)5G网关终端到达第i个基站的时间表示模型:
(2)作差估计出无人机到达两个基站的距离差Dij,记Di=|Pue-Pi|为无人机到达基站i的距离,Dij=|Di-Dj|为无人机到基站i,j的距离差;
(3)由上述距离差与无人机坐标关系解算无人机的坐标:
其中,(xi,yi,zi),(xj,yj,zj)表示基站i,j的坐标;
(4)联立多个步骤(1)-(3)的方程式,解出5G网关终端的坐标(x,y,z)。
进一步的,所述DOA定位的方法为:
天线整列为均匀线性阵列,阵元间距均为Δ,选取最左侧阵元作为基准阵元,第i个阵元的坐标为xi(i=1,2,…,M);
(1)对于第k个基站发来的第k个宽带信号(k=1,2,…,K),第i个阵元与基准阵元的到达时间差为:
相位差为:
(2)第k个信号的导向矢量:
βk(θk)=[exp(-jφ1,k)exp(-jφ2,k)…exp(-jφM,k)]T;
(3)将均匀线性阵列划分为两个子阵列X1,X2,子阵列X1包含线性阵列的前M-1个阵元,子阵列X2包含线性阵列的后M-1个阵元;两个子阵的结构完全相同,阵列流型间存在旋转不变关系Φ;建立子阵X1和子阵X2接收信号矩阵模型:
X1(t)=Bs(t)+n1(t),
X2(t)=BΦs(t)+n2(t);
其中,s(t)为入射信号矩阵,n1(t),n2(t)为输出噪声,X1、X2为子阵列1和子阵列2的接收信号矩阵,
X1(t)=[x1(t),x2(t),…,xM-1(t)]T,
X2(t)=[x2(t),x3(t),…,xM(t)]T,s(t)=[s1(t),s2(t),…,sK(t)]T为入射信号;
Φ=diag[exp(-jφ1),exp(-jφ2),…,exp(-jφK)];
(4)离散采样得到t=nT0时刻子阵X1和子阵X2接收信号矩阵模型:
X1(n)=Bs(n)+n1(n),
X2(n)=BΦs(n)+n2(n),
记s(n),n1(n),n2(n)经FFT运算及小批量窄带化后的值为s(w),n1(w),n2(w),信号输出为:
X1(w)=Bs(w)+n1(w),
X2(w)=BΦs(w)+n2(w);
将上述公式写成矩阵形式为:
(5)计算输出自协方差矩阵Ryy并做特征值分解:
信号空间和阵列流型空间的秩相等,有且仅有一个非奇异矩阵T使得:
E1,E2之间关系为E2=BΦT=E1T-1ΦT=E1Ψ,Ψ=T-1ΦT反映两个阵列接收信号子空间的旋转不变关系,Ψ的特征值矩阵为Φ;
(6)计算Ψ,再由阵列流型旋转不变关系Φ计算角估计值
对Ryy做特征值分解求得特征子空间E1,E2,进而求得Ψ,联立两个不同频点的窄带方程,解算第k个基站信号到达天线阵列的俯仰角θk和偏航角再将多个不同频窄带信号求得的θk,做最小均方误差估计,得到俯仰角θk、偏航角
(二)由波达角度计算5G网关终端坐标
进一步的,将TDOA定位所得5G网关终端的坐标和DOA定位所得5G网关终端的坐标,加权平均得到最终坐标的方法为:
定义TDOA定位和AOA定位下坐标估计值与基站坐标的残差分别为:
进一步的,以l-γ-θ方法来描述虚拟领航者与无人机的距离和夹角关系,l表示二者的总距离,γ表示二者垂直方向的夹角,θ表示二者水平方向的夹角;
将虚拟领航者和无人机的三维空间坐标投影至XY平面上,在XY平面内对异构无人机系统进行队形保持和轨迹跟踪控制;
在XY平面内,无人机Ua的坐标为(xa,ya)、航向角为θa,无人车Ug的坐标为(xg,yg)、航向角为θg;当形成稳定队形时,无人机和无人车之间距离达到期望值L(t)为t时刻无人机和无人车之间的距离,Lr为期望距离。
进一步的,计算无人机位姿偏差模型Uae=(xe,ye,θe)的方法如下:
(1)在XY平面内建立无人机、无人车运动模型:
其中va,vg分别对应无人机、无人车的速度;
(3)定义α=θga+θg-θa,求解L,θga微分表达式:
(4)定义无人机Ua=(xa,ya,θa)相对无人车Ug=(xg,yg,θg)的期望位姿为Uar=(xar,yar,θar),表达式如下:
其中θgar表示期望位置相对无人车的夹角;
(5)将世界坐标变换至无人机坐标,并建立无人机位姿偏差模型Uae:
进一步的,所述网关队形保持控制器包括速度控制器和航向角速度控制器,以Lyapunov方法设计速度控制器的控制量和航向角速度控制器的控制量,方法如下:
(1)选取系统Lyapunov函数:
(3)验证稳定性:
进一步的,所述5G网关终端的轨迹跟踪控制器的控制量的计算方法如下:
(一)计算无人机和无人车位姿偏差模型Ue=(xe,ye,θe):
定义无人和无人车当前位姿Uc=(xc,yc,θc),所述云平台规划的虚拟领航者位姿Ur=(xr,yr,θr),将无人机和无人车所在的世界坐标系变换为无人机和无人车坐标系,计算位姿偏差模型Ue=(xe,ye,θe)。
(二)以Lyapunov方法设计轨迹跟踪控制器的速度控制器的控制量和航向角速度控制器的控制量:
(1)选取系统Lyapunov函数:
(2)设计速度控制器的控制量vc和航向角速度控制器的控制量wc:
vc=vrcosθe+k1xe+xek2|ye|,
(3)验证稳定性:
本发明实施例的有益效果为:
5G网关终端可为无人机提供5G通信与定位服务,使地面控制中心(即云平台)能对其进行远程控制,同时5G网关终端能为无人机提供5G无线定位信息。该定位信息是利用5G高频毫米波和大规模天线阵列的技术带来的显著提高的测距精度和测角精度,融合TDOA和DOA定位方式,在DOA测角过程中通过将5G宽带信号分解窄带信号,提升测角精度。
该5G网关终端扩展了无人机与地面无人车的协作功能,在5G网关终端上分布式地部署队形保持控制器和轨迹跟踪控制器,该队形保持控制器和轨迹跟踪控制器放置在边缘计算平台,无需对原有无人机和飞行控制系统做大规模改动,可为无人机进行低成本的快速升级。
通过控制虚拟领航者与无人机的夹角γ实现对无人机高度的单独控制,将无人机与无人车的协同控制转化为水平面的协同控制,实现异构无人系统的协同控制。队形保持控制器和轨迹跟踪控制器计算队形保持和轨迹跟踪所需的速度及航向角速度,原无人机/车系统控制器根据速度及航向角速度完成底层控制。因此,该5G网关终端在边缘计算平台为无人机扩展协作功能,使无人机能与地面无人车完成协作任务,有效扩大无人机在侦察巡检范围。
附图说明
图1是本发明一个实施例的基于5G网关的无人机与无人车协作方法的系统结构图;
图2是5G网关的网关终端的定位信息计算流程图;
图3是5G网络的天线阵列示意图;
图4是无人机和无人车在水平坐标系下的相对位置关系图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。
在本发明的描述中,需要理解的是,术语“纵向”、“横向”“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
在本发明的描述中,除非另有说明,“多个”的含义是两个或两个以上。
下面结合图1至图4,描述本发明实施例的基于5G网关的无人机与无人车协作方法。
如图1所示,本发明实施例的一种基于5G网关的无人机与无人车协作方法,包括云平台、无人车和无人机,无人车和无人机均安装有5G网关终端,无人车和无人机均通过5G无线网络与所述云平台通信连接;
5G网关包括队形保持控制器和轨迹跟踪控制器;
该方法包括以下步骤:
基于TDOA和DOA融合定位方式计算5G网关终端坐标;
基于5G网关终端坐标,获取无人车和无人机的实际运行状态,实际运行状态包括实际位置、实际速度和实际航向角度;
云平台构建有虚拟领航者的无人车和无人机的编队系统模型;
5G网关终端将无人车和无人机的实际运行状态发送至云平台;
云平台根据无人车和无人机的实际运行状态以及执行任务规划虚拟领航者的轨迹,将无人车和无人机以的期望运行信息发送给5G网关终端,期望运行信息包括期望位置、速度和航向角度;
5G网关终端的队形保持控制器根据期望运行信息计算出无人机和无人车编队保持队形所需的控制量,5G网关终端的轨迹跟踪控制器计算出无人车和无人机跟踪虚拟领航者所需的控制量,将两部分控制量加权求和作为编队控制的控制量;
5G网关终端将编队控制的控制量分别下发给无人车和无人机两者的控制器,由控制器控制无人车和无人机的运行。
本发明实施例的方法中,该5G网关终端可为无人机提供5G通信与定位服务,使地面控制中心(云平台)能对其进行远程控制,同时5G网关终端为无人机提供5G无线定位信息,融合TDOA和DOA定位方式,计算5G网关的网关终端坐标,显著提高的测距精度和测角精度。
无人机可借助5G网关与地面控制中心的低时延通信,该5G网关终端扩展了无人机与地面无人车的协作功能,在5G网关终端上分布式地部署队形保持控制器和轨迹跟踪控制器,该队形保持控制器和轨迹跟踪控制器放置在边缘计算平台。通过控制无人机与虚拟领航者的夹角γ实现对无人机高度的单独控制,同时,将无人机与无人车的协同控制转化为水平面的协同控制,实现异构无人系统的协同控制。队形保持控制器和轨迹跟踪控制器用于计算队形保持和轨迹跟踪所需的速度及航向角速度,原有的无人机/车系统控制器根据速度及航向角速度完成底层控制。
具体的,5G网关终端搭载SIM8200 5G模组,为无人机/车提供大带宽、低时延通信。进一步的,如图2所示,基于TDOA和DOA融合定位方式计算5G网关终端坐标的方法为:
TDOA定位:通过5G网关终端到达两个不同基站的间的时间差估计5G网关终端到该两个基站的距离差,再由该距离差与5G网关终端坐标关系解算该5G网关终端的坐标;
DOA定位:通过天线阵列测量两个基站发出的信号到5G网关终端接收的入射角度,建立空间直线方程组,入射角度包括俯仰角和偏航角;通过的空间直线方程组联解出该5G网关终端的坐标;
将TDOA定位所得5G网关终端的坐标和DOA定位所得5G网关终端的坐标加权平均得到最终坐标。
本发明实施例利用FFT(一种DFT的高效算法)将5G大宽带的OFDM(OrthogonalFrequency Division Multiplexing即正交频分复用技术)信号分解为多个相互正交的子载波,以小批量方式将频率相近的子载波归入同一窄带信号,再利用ESPRIT算法对不同频点的窄带信号做波达角度的估计。新一代的5G通讯技术采用高频毫米波和大规模天线阵列,毫米波的高频率和大带宽特性能够显著提高TDOA的测距精度,毫米波的定向波束赋形可以精确获取波达方向,同时大规模天线阵列带来的更高分辨率的波束也能大幅提升DOA的测角精度。
具体的,TDOA定位的方法为:
(1)5G网关终端到达第i个基站的时间表示模型:
其中,δue为5G网关终端的时钟误差,δi为基站的时钟误差,c为光速,Pue为5G网关终端位置,Pi为基站位置,为测距误差。上述的时间差方程可以消除网关终端的钟差δue,同时依赖于5G毫米波的高频和大带宽特性,测距误差会得到削减。
(2)作差估计出无人机到达两个基站的距离差Dij,记Di=|Pue-Pi|为无人机到达基站i的距离,Dij=|Di-Dj|为无人机到基站i,j的距离差。
(3)由上述距离差与无人机坐标关系解算无人机的坐标:
其中,(xi,yi,zi),(xj,yj,zj)表示基站i,j的坐标。
(4)联立多个步骤(1)-(3)的方程式,解出5G网关终端的坐标(x,y,z)。
通过天线阵列测量两个基站发出的信号到网关接收终端的入射角度,包括俯仰角θ(信号到达天线阵列的方向与z轴的夹角)和偏航角(信号到达天线阵列的方向与x轴的夹角),建立空间直线方程组,联解出网关终端的坐标,5G毫米波的定向波束赋形和大规模的天线阵列带来的高分辨率波束能够提高测角精度,进而获得更精确的位置信息。具体的,DOA定位的方法为:
传统的ESPRIT测角算法可以用于窄带信号的测角,5G通信的大带宽需求使得OFDM调制信号的带宽也急剧增大,ESPRIT测角算法难以获得精准的角估计值。这里通过FFT将OFDM宽带信号分解为多个相互正交的子载波,再对子载波的频域信号做角估计,以此改进ESPRIT算法,使其在大带宽情况下仍能获得较为精准的角估计值。
天线整列为均匀线性阵列,阵元间距均为Δ,选取最左侧阵元作为基准阵元,第i个阵元的坐标为xi(i=1,2,…,M);
(1)对于第k个基站发来的第k个宽带信号(k=1,2,…,K),第i个阵元与基准阵元的到达时间差为:
相位差为:
(2)第k个信号的导向矢量:
βk(θk)=[exp(-jφ1,k)exp(-jφ2,k)…exp(-jφM,k)]T;
(3)将均匀线性阵列划分为两个子阵列X1,X2,子阵列X1包含线性阵列的前M-1个阵元,子阵列X2包含线性阵列的后M-1个阵元;两个子阵的结构完全相同,阵列流型间存在旋转不变关系Φ;建立子阵X1和子阵X2接收信号矩阵模型:
X1(t)=Bs(t)+n1(t),
X2(t)=BΦs(t)+n2(t);
其中,n1(t),n2(t)为输出噪声,s(t)为入射信号矩阵X1、X2为子阵列1和子阵列2的接收信号矩阵,
X1(t)=[x1(t),x2(t),…,xM-1(t)]T,X2(t)=[x2(t),x3(t),…,xM(t)]T,s(t)=[s1(t),s2(t),…,sK(t)]T
为入射信号;
Φ=diag[exp(-jφ1),exp(-jφ2),…,exp(-jφK)];
假设只有1个基站发来信号,即k=1时,
子阵X1(t)=β1(θ1)s1(t)+n1(t),也就是说子阵列X1接收的信号矩阵等于导向矢量乘以入射信号,再加上噪声。
(4)离散采样得到t=nT0时刻子阵X1和子阵X2接收信号矩阵模型:
X1(n)=Bs(n)+n1(n),
X2(n)=BΦs(n)+n2(n),
经FFT运算将当前时刻的子阵X1和子阵X2输出信号分解为不同频子载波下的输出信号。按小批量的方式,将频率接近的信号划分为一个批量,该批量组成的信号近似窄带信号下的输出信号,以该批量中的中心频率作为载波信号的频点。记s(n),n1(n),n2(n)经FFT运算及小批量窄带化后的值为s(w),n1(w),n2(w),信号输出为:
X1(w)=Bs(w)+n1(w),
X2(w)=BΦs(w)+n2(w);
将上述公式写成矩阵形式为:
(5)计算输出自协方差矩阵Ryy并做特征值分解:
信号空间和阵列流型空间的秩相等,有且仅有一个非奇异矩阵T使得:
E1,E2之间关系为E2=BΦT=E1T-1ΦT=E1Ψ,Ψ=T-1ΦT反映两个阵列接收信号子空间的旋转不变关系,Ψ的特征值矩阵为Φ;
(6)计算Ψ,再由阵列流型旋转不变关系Φ计算角估计值
对Ryy做特征值分解求得特征子空间E1,E2,进而求得Ψ,联立两个不同频点的窄带方程,解算第k个基站信号到达天线阵列的俯仰角θk和偏航角再将多个不同频窄带信号求得的θk,做最小均方误差估计,得到俯仰角θk、偏航角进一步提升测角精度;
(二)由波达角度计算5G网关终端坐标
具体的,将TDOA定位所得5G网关终端的坐标和DOA定位所得5G网关终端的坐标,加权平均得到最终坐标的方法为:
定义TDOA定位和AOA定位下坐标估计值与基站坐标的残差分别为:
进一步的,地面惯性系O-XYZ下,无人车仅在XY平面做二维运动,而无人机做三维运动,为实现异构无人系统的统一协同控制,以l-γ-θ方法来描述虚拟领航者与无人机的距离和夹角关系,l表示二者的总距离,γ表示二者垂直方向的夹角,θ表示二者水平方向的夹角;通过虚拟领航者的高度坐标和无人机与虚拟领航者的夹角γ实现对无人机高度的单独控制。
将虚拟领航者和无人机的三维空间坐标投影至XY平面上,在XY平面内对异构无人机系统进行队形保持和轨迹跟踪控制;
在XY平面内,无人机Ua的坐标为(xa,ya)、航向角为θa,无人车Ug的坐标为(xg,yg)、航向角为θg;当形成稳定队形时,无人机和无人车之间距离达到期望值L(t)为t时刻无人机和无人车之间的距离,Lr为期望距离。
进一步的,计算无人机位姿偏差模型Uae=(xe,ye,θe)的方法如下:
(1)在XY平面内建立无人机、无人车运动模型:
其中va,vg分别对应无人机、无人车的速度;
(3)定义α=θga+θg-θa,求解L,θga微分表达式:
(4)定义无人机Ua=(xa,ya,θa)相对无人车Ug=(xg,yg,θg)的期望位姿为Uar=(xar,yar,θar),表达式如下:
其中θgar表示期望位置相对无人车的夹角;
(5)将世界坐标变换至无人机坐标,并建立无人机位姿偏差模型Uae:
进一步的,网关队形保持控制器包括速度控制器和航向角速度控制器,以Lyapunov方法设计速度控制器的控制量和航向角速度控制器的控制量,方法如下:
(1)选取系统Lyapunov函数:
(3)验证稳定性:
进一步的,5G网关终端的轨迹跟踪控制器的控制量的计算方法如下:
(一)计算无人机和无人车位姿偏差模型Ue=(xe,ye,θe):
定义无人和无人车当前位姿Uc=(xc,yc,θc),云平台规划的虚拟领航者位姿Ur=(xr,yr,θr),将无人机和无人车所在的世界坐标系变换为无人机和无人车坐标系,计算位姿偏差模型Ue=(xe,ye,θe)。
(二)以Lyapunov方法设计轨迹跟踪控制器的速度控制器的控制量和航向角速度控制器的控制量:
(1)选取系统Lyapunov函数:
(2)设计速度控制器的控制量vc和航向角速度控制器的控制量wc:
vc=vrcosθe+k1xe+xek2|ye|,
(3)验证稳定性:
根据本发明实施例的一种基于5G网关的无人机与无人车协作方法的其他构成等以及操作对于本领域普通技术人员而言都是已知的,这里不再详细描述。
在本说明书的描述中,参考术语“实施例”、“示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管已经示出和描述了本发明的实施例,本领域的普通技术人员可以理解:在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由权利要求及其等同物限定。
Claims (9)
1.一种基于5G网关的无人机与无人车协作方法,其特征在于,包括云平台、无人车和无人机,所述无人车和无人机均安装有5G网关终端,所述无人车和无人机均通过5G无线网络与所述云平台通信连接;
所述5G网关包括队形保持控制器和轨迹跟踪控制器;
该方法包括以下步骤:
基于TDOA和DOA融合定位方式计算5G网关终端坐标;
基于5G网关终端坐标,获取所述无人车和所述无人机的实际运行状态,所述实际运行状态包括实际位置、实际速度和实际航向角度;
所述云平台构建有虚拟领航者的无人车和无人机的编队系统模型;
所述5G网关终端将所述无人车和无人机的实际运行状态发送至所述云平台;
所述云平台根据所述无人车和所述无人机的实际运行状态以及执行任务规划虚拟领航者的轨迹,将无人车和无人机的期望运行信息发送给所述5G网关终端,所述期望运行信息包括期望位置、速度和航向角度;
所述5G网关终端的队形保持控制器根据所述期望运行信息计算出无人机和无人车编队保持队形所需的控制量,所述5G网关终端的轨迹跟踪控制器计算出无人车和无人机跟踪虚拟领航者所需的控制量,将两部分控制量加权求和作为编队控制的控制量;
所述5G网关终端将编队控制的控制量分别下发给无人车和无人机两者的控制器,由控制器控制无人车和无人机的运行。
2.根据权利要求1所述的基于5G网关的无人机与无人车协作方法,其特征在于,基于TDOA和DOA融合定位方式计算5G网关终端坐标的方法为:
TDOA定位:通过5G网关终端到达两个不同基站的间的时间差估计5G网关终端到该两个基站的距离差,再由该距离差与5G网关终端坐标关系解算该5G网关终端的坐标;
DOA定位:通过天线阵列测量两个基站发出的信号到5G网关终端接收的入射角度,建立空间直线方程组,所述入射角度包括俯仰角和偏航角;通过所述的空间直线方程组联解出该5G网关终端的坐标;
将TDOA定位所得5G网关终端的坐标和DOA定位所得5G网关终端的坐标,加权平均得到最终坐标。
3.根据权利要求2所述的基于5G网关的无人机与无人车协作方法,其特征在于,所述TDOA定位的方法为:
(1)5G网关终端到达第i个基站的时间表示模型:
(2)作差估计出无人机到达两个基站的距离差Dij,记Di=|Pue-Pi|为无人机到达基站i的距离,Dij=|Di-Dj|为无人机到基站i,j的距离差;
(3)由上述距离差与无人机坐标关系解算无人机的坐标:
其中,(xi,yi,zi),(xj,yj,zj)表示基站i,j的坐标;
(4)联立多个步骤(1)-(3)的方程式,解出5G网关终端的坐标(x,y,z)。
4.根据权利要求3所述的基于5G网关的无人机与无人车协作方法,其特征在于,所述DOA定位的方法为:
天线整列为均匀线性阵列,阵元间距均为Δ,选取最左侧阵元作为基准阵元,第i个阵元的坐标为xi,i=1,2,…,M;
(1)对于第k个基站发来的第k个宽带信号k=1,2,…,K,第i个阵元与基准阵元的到达时间差为:
相位差为:
(2)第k个信号的导向矢量:
βk(θk)=[exp(-jφ1,k) exp(-jφ2,k) L exp(-jφM,k)]T;
(3)将均匀线性阵列划分为两个子阵列X1,X2,子阵列X1包含线性阵列的前M-1个阵元,子阵列X2包含线性阵列的后M-1个阵元;两个子阵的结构完全相同,阵列流型间存在旋转不变关系Φ;建立子阵X1和子阵X2接收信号矩阵模型:
X1(t)=Bs(t)+n1(t),
X2(t)=BΦs(t)+n2(t);
其中,s(t)为入射信号矩阵,n1(t),n2(t)为输出噪声,X1、X2为子阵列1和子阵列2的接收信号矩阵,
X1(t)=[x1(t),x2(t),L,xM-1(t)]T,X2(t)=[x2(t),x3(t),L,xM(t)]T,s(t)=[s1(t),s2(t),L,sK(t)]T
为入射信号;
Φ=diag[exp(-jφ1),exp(-jφ2),L,exp(-jφK)];
(4)离散采样得到t=nT0时刻子阵X1和子阵X2接收信号矩阵模型:
X1(n)=Bs(n)+n1(n),
X2(n)=BΦs(n)+n2(n),
记s(n),n1(n),n2(n)经FFT运算及小批量窄带化后的值为s(w),n1(w),n2(w),信号输出为:
X1(w)=Bs(w)+n1(w),
X2(w)=BΦs(w)+n2(w);
将上述公式写成矩阵形式为:
(5)计算输出自协方差矩阵Ryy并做特征值分解:
信号空间和阵列流型空间的秩相等,有且仅有一个非奇异矩阵T使得:
E1,E2之间关系为E2=BΦT=E1T-1ΦT=E1Ψ,Ψ=T-1ΦT反映两个阵列接收信号子空间的旋转不变关系,Ψ的特征值矩阵为Φ;
(6)计算Ψ,再由阵列流型旋转不变关系Φ计算角估计值:
对Ryy做特征值分解求得特征子空间E1,E2,进而求得Ψ,联立两个不同频点的窄带方程,解算第k个基站信号到达天线阵列的俯仰角θk和偏航角再将多个不同频窄带信号求得的θk,做最小均方误差估计,得到俯仰角θk、偏航角
(二)由波达角度计算5G网关终端坐标:
7.根据权利要求6所述的基于5G网关的无人机与无人车协作方法,其特征在于,计算无人机位姿偏差模型Uae=(xe,ye,θe)的方法如下:
(1)在XY平面内建立无人机、无人车运动模型:
其中va,vg分别对应无人机、无人车的速度;
(3)定义α=θga+θg-θa,求解L,θga微分表达式:
(4)定义无人机Ua=(xa,ya,θa)相对无人车Ug=(xg,yg,θg)的期望位姿为Uar=(xar,yar,θar),表达式如下:
其中θgar表示期望位置相对无人车的夹角;
(5)将世界坐标变换至无人机坐标,并建立无人机位姿偏差模型Uae:
9.根据权利要求7所述的基于5G网关的无人机与无人车协作方法,其特征在于,所述5G网关终端的轨迹跟踪控制器的控制量的计算方法如下:
(一)计算无人机或无人车位姿偏差模型Ue=(xe,ye,θe):
定义无人机或无人车当前位姿Uc=(xc,yc,θc),所述云平台规划的虚拟领航者位姿Ur=(xr,yr,θr),将无人机或无人车所在的世界坐标系变换为无人机或无人车坐标系,计算位姿偏差模型Ue=(xe,ye,θe):
(二)以Lyapunov方法设计轨迹跟踪控制器的速度控制器的控制量和航向角速度控制器的控制量:
(1)选取系统Lyapunov函数:
(2)设计速度控制器的控制量vc和航向角速度控制器的控制量wc:
vc=vrcosθe+k1xe+xek2|ye|,
(3)验证稳定性:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110524455.3A CN113238577B (zh) | 2021-05-13 | 2021-05-13 | 一种基于5g网关的无人机与无人车协作方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110524455.3A CN113238577B (zh) | 2021-05-13 | 2021-05-13 | 一种基于5g网关的无人机与无人车协作方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113238577A CN113238577A (zh) | 2021-08-10 |
CN113238577B true CN113238577B (zh) | 2022-01-25 |
Family
ID=77134222
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110524455.3A Active CN113238577B (zh) | 2021-05-13 | 2021-05-13 | 一种基于5g网关的无人机与无人车协作方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113238577B (zh) |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106054922B (zh) * | 2016-06-22 | 2018-10-23 | 长安大学 | 一种无人机-无人车联合编队协同控制方法 |
CN107943071B (zh) * | 2017-11-03 | 2020-02-07 | 中国科学院自动化研究所 | 无人车的编队保持控制方法及系统 |
CA3107374C (en) * | 2018-07-24 | 2022-09-27 | Tg-17, Llc | Systems and methods for autonomous machine tracking and localization of mobile objects |
CN109240331B (zh) * | 2018-09-30 | 2020-04-03 | 北京航空航天大学 | 一种无人机-无人车集群模型时变编队控制方法及系统 |
CN110413006B (zh) * | 2019-08-30 | 2022-04-01 | 杭州电子科技大学 | 一种基于5g通信的无人机编队组网系统及方法 |
CN110824419B (zh) * | 2019-10-25 | 2023-05-02 | 长江大学 | 一种物流车辆的定位方法及系统 |
CN111132007B (zh) * | 2019-12-16 | 2022-01-11 | 上海交通大学 | 一种基于5G/NB-IoT簇节点信息融合的NB终端高精度定位算法 |
CN112214034B (zh) * | 2020-09-29 | 2022-04-08 | 南京航空航天大学 | 一种基于ZigBee的四旋翼飞行器编队飞行控制方法 |
-
2021
- 2021-05-13 CN CN202110524455.3A patent/CN113238577B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113238577A (zh) | 2021-08-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10192540B2 (en) | Coordinated route distribution systems and methods | |
CN106712827B (zh) | 星载数字多波束接收天线的动态波束跟踪测试装置及方法 | |
CN107801195B (zh) | 一种车联网定位中的路边单元优化部署方法 | |
CN108520640B (zh) | 基于超宽带的无人机导航方法、导航设备、无人机 | |
US20160088498A1 (en) | Unmanned aerial vehicle for antenna radiation characterization | |
CN105870603B (zh) | 一种高铁宽带专网高动态转换系统的天线控制方法 | |
CN103746757A (zh) | 一种基于星载多波束天线的单星干扰源定位方法 | |
CN112197761A (zh) | 一种高精度多旋翼机协同定位方法及系统 | |
CN108628327A (zh) | 一种基于超宽带通信的无人机导航装置 | |
CN108896957A (zh) | 一种无人机操控信号源的定位系统及方法 | |
WO2021088133A1 (zh) | 一种多旋翼无人机飞行轨迹的构建方法及系统 | |
CN114018161A (zh) | 一种用于测控系统的高精度距离标校方法 | |
CN110741272B (zh) | 无线电信标系统 | |
CN113447924A (zh) | 一种基于毫米波雷达的无人机测绘方法和系统 | |
CN113238577B (zh) | 一种基于5g网关的无人机与无人车协作方法 | |
CN112098926A (zh) | 一种利用无人机平台的智能测角训练样本生成方法 | |
CN115560757B (zh) | 随机姿态误差条件下基于神经网络的无人机直接定位校正方法 | |
CN114422060B (zh) | 一种无人机通信信道模型的构建方法和系统 | |
Calvo-Fullana et al. | Communications and robotics simulation in UAVs: A case study on aerial synthetic aperture antennas | |
Vishnevsky et al. | Modelling of uav simulator for local navigation system of tethered high-altitude platforms | |
CN112485778A (zh) | 机载雷达杂波距离弯曲校正方法 | |
Li et al. | A relative navigation method based on wireless ranging for UAV in GPS denied environment | |
CN114526735B (zh) | 一种无人飞行器集群仅测距初始相对位姿确定方法 | |
KR20190073889A (ko) | 비행 모델의 모의자세 추정 장치 및 그 방법 | |
CN221148916U (zh) | 基于机载与地面融合的tdoa定位系统 |
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 |