基于毫米波通感一体化无人设备的自主导航系统及方法

1.本发明属于无人系统控制和移动通信的技术领域，主要涉及了一种基于毫米波通感一体化无人设备的自主导航系统及方法。


背景技术：

2.随着无人机、无人车、智能机器人等智能无人系统应用场景的拓展，人们对于无人系统的智能化需求不断提升。传统无人系统需要人为遥控，并且操作者需要实时观察无人系统的位置，来调整无人系统的移动轨迹。惯导系统的出现，使无人系统有了自主导航的能力。高精度的惯导系统可以实时记录无人系统的运行状态，从而绘制无人系统的运行路线进而实现对无人系统的实时定位。但是惯导系统存在累积误差，随着无人系统的移动，该误差值会不断增加。现有的研究中，人们会在无人系统中安装全球定位系统（gps）来修正惯导系统的误差，但是在单个无人系统里安装gps，增加了无人系统的成本。此外，gps的定位精度较低，无法满足无人系统实时高精度定位的需求。
3.在现有的毫米波移动通信系统中，由于大规模多发多收系统（massivemimo）的应用，以及毫米波波束具有一定的指向性，通信感知一体化成为了研究热点。随着物联网技术的发展，被放置各个场景中的小型传感器也被纳入了毫米波移动通信系统中，而这些技术都为无人系统的自动化控制和导航提供了客观条件。


技术实现要素：

4.本发明正是针对现有技术中无人系统实时高精度定位尚有缺陷的问题，提供一种基于毫米波通感一体化无人设备的自主导航系统及方法，包括至少一个智能无人系统和至少一个移动通信基站，所述移动通信基站面向所有用户发送信号，信号包括但不限于毫米波信号；所述智能无人系统设于无人设备中，至少包括惯导定位系统；智能无人系统实时接收来自移动通信基站的毫米波信号，解码信号帧头中基站身份信息和位置信息的同时，根据信号的出射角、到达角和到达时延，估计出智能无人系统与基站间的相对位置，依据此位置，对自身惯导定位系统的累积误差进行校正，并且根据惯导定位和毫米波定位，确定自身位置，实现自主导航。本发明使无人系统可以利用自由空间中的毫米波信号，在不影响移动通信系统的前提下，实现高精度定位和自主导航。
5.为了实现上述目的，本发明采取的技术方案是：基于毫米波通感一体化无人设备的自主导航系统，包括至少一个智能无人系统和至少一个移动通信基站，所述移动通信基站面向所有用户发送信号，所述信号包括但不限于毫米波信号；所述智能无人系统设于无人设备中，至少包括惯导定位系统；智能无人系统实时接收来自移动通信基站的毫米波信号，解码信号帧头中基站身份信息和位置信息的同时，根据信号的出射角、到达角和到达时延，估计出智能无人系统与基站间的相对位置，依据此位置，对自身惯导定位系统的累积误差进行校正，并且根据惯导定位和毫米波定位，确定自身位置，实现自主导航。
6.作为本发明的一种改进，所述智能无人系统包括无人设备、动力系统、毫米波感知系统和惯导系统，所述动力系统用于为智能无人系统提供动力支持，包括电机、电池、功放模块及移动控制模块，所述无人设备与电机相连接，电池分别与电机和功放模块相连接，功放模块与移动控制模块相连接；所述毫米波感知系统用于接收和处理移动通信基站的毫米波信号，并反馈导航校正，包括毫米波信号接收模块、毫米波信号处理模块及导航校正模块，所述毫米波信号处理模块分别与毫米波信号接收模块和导航校正模块相连接；所述惯导定位系统包括惯导导航模块、惯导信息处理模块及惯导定位模块，所述惯导信息处理模块分别与惯导导航模块和惯导定位模块相连接，惯导导航模块还分别与移动控制模块和导航校正模块相连接。
7.作为本发明的一种改进，所述无人设备包括但不限于无人机、无人车或智能机器人。
8.作为本发明的一种改进，所述移动通信基站由射频通信发射天线、通信信号处理系统及射频通信接收天线组成，所述通信信号处理系统分别与射频通信发射天线和射频通信接收天线相连接，通信信号处理系统还连接到网关。
9.作为本发明的又一种改进，还包括传感器，所述智能无人系统接收传感器广播中的信息，根据传感器的身份信息、位置信息、射频信号的方向和时延，估测自身位置信息。
10.作为本发明的又一种改进，对惯导定位系统中的累积误差设定阙值，当到达阙值时，智能无人系统停止运行，所述累积误差与时间呈正相关。
11.为了实现上述目的，本发明还采取的技术方案是：基于毫米波通感一体化无人设备的自主导航方法，包括如下步骤：s1：智能无人系统从初始点出发，获取初始点坐标，惯导定位系统通过监测和计算智能无人系统在移动中的行进方向、速率和姿态信息，与初始点位置相比对，指导智能无人系统的定位和导航；s2：智能无人系统行进过程中，收集移动通信基站在自由空间中发出的毫米波信号，并对信号进行解码，获取毫米波信号帧头中的基站身份信息和位置信息；s3：智能无人系统对毫米波信号进行联合处理，提取出信道状态信息，利用射频定位算法，从信道状态信息中至少提取出毫米波信号的出射角、到达角和时延信息，从而估计出移动通信基站相对于智能无人系统的相对位置信息；s4：综合分析惯导定位系统和毫米波感知系统获取到的定位信息，估计出当前智能无人系统的准确位置，然后由毫米波感知系统中的导航校正模块，对智能无人系统的惯导导航模块进行误差校正。
12.作为本发明的一种改进，所述步骤s3中，利用music射频定位算法，从信道状态信息中提取出毫米波信号的出射角、到达角和时延信息，所述利用music算法计算到达角的步骤具体包括：s31：计算不同时域的多个接收信号向量的协方差矩阵；s32：对协方差矩阵进行特征值分解；s33：按特征值的大小顺序，把与信号个数相等的最大特征值对应的特征向量看成
信号子空间，把剩下的特征值对应的特征向量看成噪声子空间；s34：计算谱函数，通过寻求峰值来得到到达角的估计值，对信号到达角进行遍历搜索时，当搜索到的角度与某个信号的到达角相同时，空间谱函数就会得到一个极值点，依据极值点，获取信号的到达角。
13.作为本发明的又一种改进，所述智能无人系统能接收环境中传感器广播的信息，根据传感器的身份信息、所在位置，射频信号的方向和时延，估测自身所在位置。
14.与现有技术相比较，本案的有益效果为：（1）与传统的智能无人机系统相比，本发明可以实现智能无人系统的自主导航，而不需要人为的遥控和路线修正，惯导定位模块和毫米波感知系统的联合工作，可以使智能无人系统精准高速地到达目的地。
15.（2）与现有的智能无人系统导航技术相比，本发明基于现有的移动通信系统，不需要搭建额外的通信链路且不影响现有通信系统，成本低、可实现性和可靠性高，具体为：a. 本发明基于现有的射频移动通信系统，信号传输速率高且误码率低，智能无人系统只解码对自由空间中的毫米波信号进行部分解码，而无需额外搭建新的通信链路，大大降低成本，提高了可靠性。
16.b. 本发明中，智能无人系统从毫米波信号中提取到达角和信号时延，从而进行高精度定位和惯导系统的修正，相比现有的gps定位等技术，具有更高的准确度.c. 该发明中系统可以在通信链路正常工作的基础上，通过给智能无人系统添加新的模块以实现更多的功能，具有良好的延展性；d. 整个系统的复杂度较低，智能无人系统和移动通信基站在现有技术下都比较容易实现。
附图说明
17.图1是本发明基于毫米波通感一体化无人设备的自主导航方法的场景示意图；图2是本发明自主导航系统中智能无人系统的结构框图；图3是本发明自主导航系统中移动通信基站的结构框图。
具体实施方式
18.下面结合附图和具体实施方式，进一步阐明本发明，应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
19.实施例1基于毫米波通感一体化无人设备的自主导航系统，包括一个或多个智能无人系统和一个或多个移动通信基站，其中，移动通信基站由射频通信发射天线、通信信号处理系统和射频通信接收天线组成，具体如图3所示。射频通信发射天线连接到通信信号处理系统，通信信号处理系统连接到射频通信接收天线，通信信号处理系统还连接到网关。移动通信基站面向所有用户发送信号，而非仅面向智能无人系统服务的，信号包括但不限于毫米波信号，因而智能无人系统只是利用了环境中的毫米波信号，进行定位和自主导航。
20.所述智能无人系统包括无人设备、动力系统、毫米波感知系统和惯导定位系统，如图2所示，智能无人系统可以是无人机、无人车、智能机器人等一系列无人系统，动力系统用
于为智能无人系统提供动力支持，包括电机、电池、功放模块及移动控制模块，无人设备与电机相连接，电池分别与电机和功放模块相连接，功放模块与移动控制模块相连接。毫米波感知系统用于接收和处理移动通信基站的毫米波信号，并反馈导航校正，包括毫米波信号接收模块、毫米波信号处理模块及导航校正模块，所述毫米波信号处理模块分别与毫米波信号接收模块和导航校正模块相连接。惯导定位系统包括惯导导航模块、惯导信息处理模块及惯导定位模块，所述惯导信息处理模块分别与惯导导航模块和惯导定位模块相连接，惯导导航模块还分别与移动控制模块和导航校正模块相连接。
21.智能无人系统实时接收来自移动通信基站的毫米波信号，解码信号帧头中基站身份信息和位置信息的同时，根据信号的出射角、到达角和到达时延，估计出智能无人系统与基站间的相对位置，依据此位置，对自身惯导定位系统的累积误差进行校正，并且根据惯导定位和毫米波定位，确定自身位置，实现自主导航。
22.惯导定位系统存在累积误差e(t)，因而可以为累积误差e(t)设定阙值，当e(t)达到阈值后，智能无人系统会偏离原有路线，到达错误的地点，因而此时可设定智能无人系统停止运行，以防止更加偏离路线，所述e(t)与时间呈正相关。
23.本实施例的自主导航系统可以实现智能无人系统的自主导航，而不需要人为的遥控和路线修正，同时，基于现有的移动通信系统，不需要搭建额外的通信链路且不影响现有通信系统，成本低、可实现性和可靠性高，使智能无人系统精准高速地到达目的地，解决了现有技术中无人系统实时高精度定位尚有缺陷的问题，实用性强，是未来新兴的自主导航产品。
24.实施例2基于毫米波通感一体化无人设备的自主导航方法，如图1所示，包括如下步骤：步骤s1：智能无人系统从初始点出发，初始点坐标已知。智能无人系统依靠的自身惯导定位系统，通过监测和计算智能无人系统在移动中的行进方向、速率和姿态等信息，与初始点位置相比对，从而实现智能无人系统初步的定位和导航。
25.该惯导定位系统存在累积误差e(t)，对累积误差e(t)设定阙值，e(t)与时间呈正相关，当e(t)达到一定阈值后，智能无人系统会偏离原有路线，从而到达错误的地点。
26.步骤s2：智能无人系统收集自由空间中的毫米波信号，并对信号进行解码，获取信号帧头中的基站身份信息和位置信息，同时对来自不同基站的信号解码信息进行分类和存储，以进行下一步的处理。
27.步骤s3：对一段时间内来自同一基站的信号信息进行处理，提取出信道状态信息（csi），然后利用射频定位算法，从csi中提取出毫米波信号的出射角、到达角和时延等信息，从而估计出基站相对于智能无人系统的方位等。
28.在实际系统中，我们可以根据状况的不同，选择不同的射频定位算法。本实施例中，通过music射频定位算法，从csi中提取出到达角（aoa）等信息的算法步骤示例如下：1、计算不同时域的多个接收信号向量的协方差矩阵；2、对协方差矩阵进行特征值分解；3、按特征值的大小顺序，把与信号个数相等的最大特征值对应的特征向量看成信号子空间，把剩下的特征值对应的特征向量看成噪声子空间；4、计算谱函数，通过寻求峰值来得到到达角的估计值。对信号aoa进行遍历搜索
时，当搜索到的角度与某个信号的aoa相同时，空间谱函数就会得到一个极值点，依据极值点，我们可以获取信号的aoa。
29.假设接收端有m根天线，接收信号为x，则接收信号的相关矩阵可以被表示为，它的表达式为其中是信号的协方差矩阵。a为方向矩阵，是范徳蒙德矩阵。我们对做奇异值分解，可得到特征值和特征向量。
30.由于协方差矩阵是厄尔米特矩阵, 所以矩阵的特征值均为实数, 并且由于协方差矩阵的特征值均大于 0 , 即矩阵是正定的,所以可推出是半正定的。根据的秩为n可知, 信号空间对应的特征值和特征向量的个数为n, 分别为和，而噪声空间对应的特征值和特征向量的个数则为m-n，分别为和。由于噪声能量相对于信号能量要小很多, 因此,是协方差矩阵所有特征值中一组最小的特征值, 且趋近于零，即由于信号空间与噪声空间是正交的, 因此信号空间方向矩阵a的列向量与噪声空间的特征向量也是正交的，而 a的列向量与信号的到达方向一一对 应, 根据此性质, 便可以利用噪声空间的特征向量来求解信号的到达方向。构建噪声矩阵,然后定义空间谱函数,然后定义空间谱函数其中是接收天线阵列的相位差矩阵。由空间谱函数的定义可以看出, 当和正交时，会出现一个谱峰, 谱峰对应的值便是信号到达方向的估计值。
31.步骤s4：综合分析惯导定位系统和毫米波感知系统获取到的定位信息，估计出当前智能无人系统的准确位置，然后由毫米波感知系统中的导航校正模块，对智能无人系统的惯导导航模块进行误差校正。综合分析惯导定位系统和毫米波感知系统获取到的定位信息，估计出当前智能无人系统的准确位置，其原因在于毫米波定位也存在一定的误差，根据信道状况的不同，其误差也不同。智能无人系统需要根据实际情况，推算出惯导定位系统的定位置信区间和毫米波感知系统的定位置信区间，并联合分析得到一个更加精确的定位结果，作为惯导导航模块的修正依据。
32.除了移动通信基站外，智能无人系统也可以接收环境中的传感器广播的信息，根据传感器的身份信息、所在位置，射频信号的方向和时延，估测自身所在位置。
33.步骤s5：根据惯导定位和毫米波定位，确定自身位置，实现自主导航。
34.假设无人系统初始位置为时刻位置为,惯导系统刷新间隔为，t时刻无人系统位移为,则有关系式
其中 为惯导系统的累计误差，t时刻惯导系统误差为 。
35.在毫米波定位系统中，根据步骤s3中的算法，我们可以得到基站信号的到达角。假设有n个基站，则对应有n个信号的到达角。由于基站位置固定，结合基站所在位置，基站信号方向连线的交点位置，即为无人系统所在位置 。该位置误差设为 ,该误差通常不随时间发生改变。
36.根据惯导系统和基站所得出的无人系统位置 和 ，结合当前时刻惯导系统和基站定位的误差 和 ，我们可以得到两个以估测位置为中心，定位误差为半径的圆形区域范围。取这两个范围的交集，我们可以得到无人系统的估测位置。依据该位置，我们可以更新无人系统的所在方位，从而实现精确的自主导航。
37.需要说明的是，以上内容仅仅说明了本发明的技术思想，不能以此限定本发明的保护范围，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰均落入本发明权利要求书的保护范围之内。