CN114608590B - 一种恶劣环境下基于智能反射表面的多车辆追踪方法 - Google Patents
一种恶劣环境下基于智能反射表面的多车辆追踪方法 Download PDFInfo
- Publication number
- CN114608590B CN114608590B CN202210231729.4A CN202210231729A CN114608590B CN 114608590 B CN114608590 B CN 114608590B CN 202210231729 A CN202210231729 A CN 202210231729A CN 114608590 B CN114608590 B CN 114608590B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- reflecting surface
- vector
- intelligent reflecting
- intelligent
- 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 57
- 230000005540 biological transmission Effects 0.000 claims abstract description 18
- 239000013598 vector Substances 0.000 claims description 86
- 239000011159 matrix material Substances 0.000 claims description 51
- 230000008569 process Effects 0.000 claims description 12
- 230000008054 signal transmission Effects 0.000 claims description 10
- 238000005259 measurement Methods 0.000 claims description 9
- 230000010363 phase shift Effects 0.000 claims description 9
- 238000005070 sampling Methods 0.000 claims description 8
- 230000007704 transition Effects 0.000 claims description 6
- 238000005562 fading Methods 0.000 claims description 4
- 230000014509 gene expression Effects 0.000 claims description 4
- 239000000654 additive Substances 0.000 claims description 3
- 230000000996 additive effect Effects 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 3
- 238000012545 processing Methods 0.000 abstract description 2
- 238000002474 experimental method Methods 0.000 description 9
- 238000000342 Monte Carlo simulation Methods 0.000 description 4
- 230000007423 decrease Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/40—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
- H04W4/44—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P] for communication between vehicles and infrastructures, e.g. vehicle-to-cloud [V2C] or vehicle-to-home [V2H]
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/40—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
- H04W4/46—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P] for vehicle-to-vehicle communication [V2V]
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
Abstract
一种恶劣环境下基于智能反射表面的多车辆追踪方法,本发明涉及基于智能反射表面的多车辆追踪方法。本发明的目的是为了解决现有在恶劣环境下,车辆和基础设施之间可能不存在视线链路,从而导致定位精度下降;以及在多车辆追踪中,由于主车选取不当将进一步降低算法的鲁棒性的问题。一种恶劣环境下基于智能反射表面的多车辆追踪方法过程为:步骤一:建立多车辆追踪***模型;步骤二:基于步骤一建立的多车辆追踪***模型,根据主车选择策略选定主车;步骤三:基于步骤二选定主车,优化智能反射表面配置并获得传输时延;步骤四:基于步骤三获得的传输时延,利用无迹卡尔曼滤波器实现多车辆追踪。本发明用于信号处理技术领域。
Description
技术领域
本发明涉及多车辆追踪方法,具体涉及基于智能反射表面的多车辆追踪方法,属于信号处理技术领域。
背景技术
近年来,随着交通工业的快速发展,新一代智能交通***得到广泛的研究和应用。获取准确的车辆位置信息对于挖掘现有道路交通潜力,建立实时、高可靠、高效的交通管理***具有重要意义。可靠实时的车辆定位可以对车辆进行有效地指挥,从而提高运输效率,保证车辆安全。从某种意义上说,车辆定位和追踪技术是智能交通***的关键技术和核心内容。
全球导航卫星***(Global Navigation Satellite System,GNSS)由于具有覆盖范围广、使用方便、全天候等优点,在车辆追踪领域得到了最广泛的应用。尽管全球导航卫星***在开阔地区已经实现了高精度的定位性能,但由于城市环境中建筑物的遮挡,其定位性能将大幅下降。另一种流行的技术是基于测距的定位方法,它依赖于车辆到基础设施间的视线链路实现车辆定位。一般而言,用于定位的距离参数包括到达时间(Time ofArrival,TOA)、到达角(Angle of Arrival,AOA)、接收信号强度(Received SignalStrength,RSS)或者将以上几种参数组合使用。这些参数可通过路边基础设施,即路侧单位(Road Side Unit,RSU)进行测量。基于上述距离参数,车辆定位可通过三边定位算法实现。此外,由于惯性导航***(Inertial Navigation System,INS)受外部环境的影响较小,因此将基于距离的方法和惯性导航***相结合可以提高定位的可靠性。
尽管上述方法具有高精度的多车辆追踪性能,但是在恶劣环境下,车辆和基础设施之间可能不存在视线链路,从而导致定位精度下降。在多车辆追踪中,由于主车选取不当将进一步降低算法的鲁棒性。
发明内容
本发明的目的是为了解决现有在恶劣环境下,车辆和基础设施之间可能不存在视线链路,从而导致定位精度下降;以及在多车辆追踪中,由于主车选取不当将进一步降低算法的鲁棒性的问题,而提出一种恶劣环境下基于智能反射表面的多车辆追踪方法。
一种恶劣环境下基于智能反射表面的多车辆追踪方法具体过程为:
步骤一:建立多车辆追踪***模型;
步骤二:基于步骤一建立的多车辆追踪***模型,根据主车选择策略选定主车;
步骤三:基于步骤二选定主车,优化智能反射表面配置并获得传输时延;
步骤四:基于步骤三获得的传输时延,利用无迹卡尔曼滤波器实现多车辆追踪。
本发明的有益效果为:
本发明通过在无线环境中部署智能反射表面,建立车辆到路侧单元的虚拟视线链路,并给出了主车选择策略,通过合理选择主车和从车,在此基础上利用无迹卡尔曼滤波器完成车辆位置信息的融合,实现恶劣环境下多车辆的鲁棒追踪,提高定位精度和鲁棒性。
本发明针对恶劣环境下车辆和基础设施之间没有视线链路的问题,给出了一种基于智能反射表面的多车辆追踪方法,提高了智能交通***的安全性。
本发明对硬件要求低,仅需要车辆和路侧单元配备单天线收发设备,大大降低了应用成本,本发明所述技术可广泛应用于城市峡谷,山区,隧道等各场景,具有实际应用价值。
附图说明
图1为本发明所述的一种恶劣环境下基于智能反射表面的多车辆追踪方法的流程框图;
图2为本发明所述的一种恶劣环境下基于智能反射表面的多车辆追踪方法的***模型示意图,h表示从智能反射表面到主车链路信道系数,θ为智能反射表面到主车的波达方向;
图3是采用本发明所述的一种恶劣环境下基于智能反射表面的多车辆追踪方法预测的车辆运动轨迹图;
图4是采用本发明所述的一种恶劣环境下基于智能反射表面的多车辆追踪方法在各时间点预测的车辆位置均方根误差图。
具体实施方式
具体实施方式一:本实施方式一种恶劣环境下基于智能反射表面的多车辆追踪方法具体过程为:
步骤一:建立多车辆追踪***模型;
步骤二:基于步骤一建立的多车辆追踪***模型,根据主车选择策略选定主车;
步骤三:基于步骤二选定主车,优化智能反射表面配置并获得传输时延;
步骤四:基于步骤三获得的传输时延,利用无迹卡尔曼滤波器实现多车辆追踪。
本发明所述的恶劣环境主要就是指建筑物的遮挡使车辆与基础设施(如卫星,路侧单元)之间不存在视线链路。在该环境下传统方法性能下降。
具体实施方式二:本实施方式与具体实施方式一不同的是,所述步骤一中建立的多车辆追踪***模型,步骤如下:
步骤一一、多车辆追踪***由N辆发出定位请求的车辆和一组位置已知的路侧单元以及智能反射表面组成;
智能反射表面部署在道路一侧并具有M个无源反射单元,每个反射单元可以独立地改变入射信号的相位,配备单天线收发设备的路侧单元可以调整智能反射表面的配置,车辆不仅可以通过智能反射表面辅助与路侧单元进行通信,也可以实现车辆之间相互通信;
步骤一二、设每辆车在二维笛卡尔坐标系中运动,k时刻第n辆车的状态表示为
其中和/>表示k时刻第n辆车在坐标系中x轴和y轴的坐标位置,/>和表示k时刻第n辆车在坐标系中x轴方向和y轴方向上的速度,上角标T表示转置,N辆车在k时刻的状态空间向量表示为/>
步骤一三、假设每辆车在任意两个相邻时刻内(Δt表示采样间隔)近似为恒速模型,因此满足xk=Fxk-1+ωk;
其中xk-1表示N辆车在k-1时刻的状态空间向量,F=diag(Fa,...,Fa)是4N×4N的状态转移矩阵(N个Fa,与***内车辆数量一致。F是4N×4N的矩阵,而Fa是4×4维矩阵。),Δt表示采样间隔,diag(·)表示对角矩阵;ωk为均值为零的高斯分布过程噪声,具有4N×4N的协方差矩阵Q,Q=diag(Qa,...,Qa)(N个Qa),
其它步骤及参数与具体实施方式一相同。
具体实施方式三:本实施方式与具体实施方式一或二不同的是,所述步骤二中基于步骤一建立多车辆追踪***模型,根据主车选择策略选定主车,步骤如下:
步骤二一、假设所有信道都在准静态平坦衰落(平坦衰落说明在信号传输过程中可以忽略的不同采样间隔之间的干扰,即t时刻和t+Δt时刻的信号独立。准静态平坦衰落说明信号在一个采样间隔Δt内保持恒定。)下,且在一个采样间隔Δt内信道系数(信道系数是hn和g)保持不变,并且所有车辆和路侧单元都位于智能反射表面的远场区域;
hn表示从智能反射表面到第n辆车链路信道系数,g表示路侧单元到智能反射表面链路信道系数;
以智能反射表面的第一个单元作为参考单元,hn和g表达式分别为
其中j为虚数且j2=-1,λ为发射信号波长,dR为智能反射表面单元间隔,m为智能反射表面第m个单元,m=1,2,…,M,M为智能反射表面单元个数;θn为智能反射表面到第n辆车的波达方向,为路侧单元到智能反射表面的波达方向;
由于智能反射表面的反射信号在远场条件下可近似为平面波,所以同一信号对于智能反射表面的每个单元的波达方向都相同;
步骤二二、假设车辆和路侧单元之间的视线链路被阻塞,通过智能反射表面建立虚拟视线链路(车辆从路侧单元接收到的信号都是通过虚拟视线链路传输的。从图2可以看出,车辆与路侧单元的视线链路被阻塞,需要借助智能反射表面实现车辆与路侧单元的通信,因此路测单元到智能反射表面和智能反射表面到车辆这两段链路共同组成虚拟视线链路。);具体过程为:
用ρn表示第n辆车到智能反射表面之间的路径损失,本发明采用3GPP UrbanMicro(UMi)模型,其表达式为
其中dn表示第n辆车到智能反射表面之间的距离,r表示智能反射表面到路侧单元的距离;
在智能反射表面建立的虚拟视线链路辅助下,第n辆车接收到的信号表示为
其中s是具有零均值和单位标准差的传输信号,u是标准差为σs的加性高斯白噪声,pt是路侧单元的发射功率,H表示共轭转置,是对于第n辆车的智能反射表面的配置控制矩阵;
其中表示对于第n辆车的智能反射表面的第m个单元的相移参数,用于改变入射信号的相位,其中m=1,2,...,M;
步骤二三、基于步骤二一和步骤二二,通过智能反射表面的辅助,可以使第n辆车接收到的信号yn对应的接收功率pn最大,通过调节智能反射表面的配置,分别使多车辆追踪***中每台车接收到的信号对应的接收功率最大,并从中选择接收功率最大的车辆作为主车,其余车辆作为从车由主车引导追踪。
其它步骤及参数与具体实施方式一或二相同。
具体实施方式四:本实施方式与具体实施方式一至三之一不同的是,所述对于第n辆车的智能反射表面的配置控制矩阵Ψn的具体求解过程为:
由hn和g得到对于第n辆车的智能反射表面第m个单元的相移参数m=1,2,...,M,
其中arg(·)表示相位,[·]m表示向量的第m个元素,进而得到Ψn。
其它步骤及参数与具体实施方式一至三之一相同。
具体实施方式五:本实施方式与具体实施方式一至四之一不同的是,所述步骤三中基于步骤二选定主车,优化智能反射表面配置并获得传输时延,步骤如下:
步骤三一、在选定主车后,假设主车到智能反射表面参考单元的距离为dp,经过参考单元反射的信号传输时延为τp=dp/c,c为光速,由于智能反射表面的反射信号在远场条件下可近似为平面波,因此主车到智能反射表面第m个单元的距离为dm=dp+(m-1)dRcos(θp);
其中θp为智能反射表面到主车的波达方向,经过第m个单元反射的信号传输时延为主车到智能反射表面第m个单元和参考单元之间的相位差为/>所以τm与τp的差值为
步骤三二、调整对于主车的智能反射表面的配置控制矩阵Ψp,使
其中表示对于主车的智能反射表面的第m个单元的相移参数,此时主车到智能反射表面每个单元反射信号的相位都与参考单元相位相同,所以Δτm=0,因此主车到智能反射表面每个单元的传输时延都为τp;
步骤三三、多车辆追踪***中余下的N-1辆从车到主车的距离分别为因此从车到主车信号传输时延表示为/>i=1,2,...,N-1。
其它步骤及参数与具体实施方式一至四之一相同。
具体实施方式六:本实施方式与具体实施方式一至五之一不同的是,所述步骤四中基于步骤三获得的传输时延,利用无迹卡尔曼滤波器实现多车辆追踪,步骤如下:
步骤四一、在k时刻构造观测向量zk=hk(xk)+υk;
其中hk(xk)是测量向量,包括通过惯性导航***对车辆速度观测得到的线性部分和通过观测传输时延得到的非线性部分,因此观测向量可以写为
其中为hk(xk)的非线性部分,的线性部分,由惯性导航***对每辆车x轴方向和y轴方向的速度观测量组成,υk是协方差矩阵为Rk的零均值观测噪声;
其中σ1,...,σN为时延观测噪声标准差,σins1,...,σins2N为惯性导航***对速度观测量的噪声标准差;
步骤四二、在k=0时刻,N辆车的状态向量表示为x0,状态向量x0的预测值可以用均值代替,即状态向量x0的协方差矩阵/>其中E[·]表示数学期望;
对于k>0时刻的状态向量,可以通过状态转移矩阵进行状态预测,即其中/>表示k-1时刻状态向量的预测值,/>表示在k-1时刻对k时刻状态向量的预测值,k-1时刻对k时刻状态向量的协方差矩阵Pk|k-1=FPk-1FT+Q通过预测得到,其中Pk-1表示k-1时刻状态向量的协方差矩阵;
步骤四三、为了在k-1时刻计算观测向量zk的统计特性,需要选取2L+1个Sigma点,其中L=4N表示状态量维数,2L+1个Sigma点是具有和状态向量相同的维度的4N×1维列向量,并可以表示为
其中表示在k-1时刻的第i个Sigma点,[·]i表示矩阵的第i列,κ是用于确定Sigma点和状态向量预测值/>之间距离的参数;
将2L+1个Sigma点代入到测量向量hk(xk),从而得到在k-1时刻对k时刻观测向量的预测值此预测值是将所有的2L+1个Sigma点代入到测量向量后得到的加权均值,第i个Sigma点所对应的权值wi可以表示为
观测向量的协方差矩阵Pzz和状态向量与观测向量的协方差矩阵Pxz可以分别表示为
其中用于计算协方差的权值为
α和β为无迹卡尔曼滤波器的中间参数;
步骤四四、更新状态空间向量和协方差矩阵,得到多车辆状态空间向量的预测值
其中是在k时刻通过无迹卡尔曼滤波器得到的多车辆状态空间向量的预测值,Pk表示k时刻状态向量的协方差矩阵。
包括了***内所有车辆的位置和速度,代表了算法得到的最终结果。车辆的运动模型本身是包含噪声的,而每次预测也是包含噪声的,这给卡尔曼的预测带来了不确定性,而这种不确定性就是由状态向量的协方差矩阵Pk表示,所以在递推过程中,无论是在步骤四二中,在k-1时刻对k时刻进行预测,还是步骤四三种采样Sigma点,都需要协方差矩阵作为重要的中间量。
其它步骤及参数与具体实施方式一至五之一相同。
采用以下实施例验证本发明的有益效果:
实施例一:
参阅图1,本发明所述的一种恶劣环境下基于智能反射表面的多车辆追踪方法的MATLAB仿真实验步骤如下:
1.建立多车辆追踪***模型,步骤如下:
(1)多车辆追踪***由N辆发出定位请求的车辆和一组位置已知的路侧单元以及智能反射表面组成,智能反射表面部署在道路一侧并具有M个无源反射单元,每个反射单元可以独立地改变入射信号的相位,配备单天线收发设备的路侧单元可以调整智能反射表面的配置,车辆不仅可以通过智能反射表面辅助与路侧单元进行通信,也可以实现车辆之间相互通信,***模型如图2所示;
实验中以智能反射表面的第一个单元作为原点建立二维笛卡尔坐标系,即将智能反射表面的第一个单元部署在坐标为[0,0]的位置,路侧单元部署在坐标为[30,40]的位置,N=2,M=15;
(2)设每辆车在二维笛卡尔坐标系中运动,k时刻第n辆车的状态表示为其中/>和/>表示k时刻第n辆车在坐标系中x轴和y轴的坐标位置,/>和/>表示k时刻第n辆车在坐标系中x轴方向和y轴方向上的速度,上角标T表示转置,N辆车在k时刻的状态空间向量表示为/>
实验中***真实的初始状态向量为x0=[5m,10m/s,5m,10m/s,50m,5m/s,87m,10m/s]T;
(3)假设每辆车在任意两个相邻时刻内近似为恒速模型,因此满足xk=Fxk-1+ωk,其中xk-1表示N辆车在k-1时刻的状态空间向量,F=diag(Fa,…,Fa)是4N×4N的状态转移矩阵,Δt表示采样间隔,diag(·)表示对角矩阵;ωk为均值为零的高斯分布过程噪声,具有4N×4N的协方差矩阵Q,Q=diag(Qa,...,Qa),
实验中Δt=0.2s;
2.根据主车选择策略选定主车,步骤如下:
(1)假设所有信道都在准静态平坦衰落下,并且信道参数在一个采样间隔Δt内信道系数保持不变,并且所有车辆和路侧单元都位于智能反射表面的远场区域。hn和g分别表示从智能反射表面到第n辆车链路和路侧单元到智能反射表面链路信道参数,以智能反射表面的第一个单元作为参考单元,其表达式分别为
其中j为虚数且j2=-1,λ为发射信号波长,dR为智能反射表面单元间隔,θn为智能反射表面到第n辆车的波达方向,为路侧单元到智能反射表面的波达方向,由于智能反射表面的反射信号在远场条件下可近似为平面波,所以同一信号对于智能反射表面的每个单元的波达方向都相同;
实验中发射信号波长λ=0.1m,单元间隔dR=0.05m,θ1=45°,θ2=60°;
(2)假设车辆和路侧单元之间的视线链路被阻塞,并通过智能反射表面建立虚拟视线链路,用ρn表示第n辆车到智能反射表面之间的路径损失,本发明采用3GPP UrbanMicro(UMi)模型,其表达式为其中dn表示第n辆车到智能反射表面之间的距离,r表示智能反射表面到路侧单元的距离,在智能反射表面建立的虚拟视线链路辅助下,第n辆车接收到的信号表示为/>其中s是具有零均值和单位标准差的传输信号,u是标准差为σs的加性高斯白噪声,pt是路侧单元的发射功率,H表示共轭转置,/>是对于第n辆车的智能反射表面的配置控制矩阵,其中/>表示对于第n辆车的智能反射表面的第m个单元的相移参数,用于改变入射信号的相位,其中m=1,2,...,M;
实验中r=50m,d1=7m,d2=100m,发射功率pt=1W,高斯白噪声u标准差σs=1;
(3)由hn和g得到对于第n辆车的智能反射表面第m个单元的相移参数m=1,2,…,M,其中arg(·)表示相位,[·]m表示向量的第m个元素,进而得到Ψn,在此配置下,通过智能反射表面的辅助,可以使第n辆车接收功率最大,此时接收信号的功率为/>通过调节智能反射表面的配置,分别使***中每台车接收功率最大,并从中选择接收功率最大的车辆作为主车,其余车辆作为从车由主车引导追踪;
3.优化智能反射表面配置并获得传输时延,步骤如下:
(1)在选定主车后,假设主车到智能反射表面参考单元的距离为dp,经过参考单元反射的信号传输时延为τp=dp/c,c为光速,由于智能反射表面的反射信号在远场条件下可近似为平面波,因此主车到智能反射表面第m个单元的距离为dm=dp+(m-1)dRcos(θp),其中θp为智能反射表面到主车的波达方向,经过第m个单元反射的信号传输时延为主车到智能反射表面第m个单元和参考单元之间的相位差为所以τm与τp的差值为/>m=2,3,...,M;
(2)调整对于主车的智能反射表面的配置控制矩阵Ψp,使
m=2,3,...,M,其中/>表示对于主车的智能反射表面的第m个单元的相移参数,此时主车到智能反射表面每个单元反射信号的相位都与参考单元相位相同,所以Δτm=0,因此主车到智能反射表面每个单元的传输时延都为τp;
(3)***中余下的N-1辆从车到主车的距离分别为因此从车到主车信号传输时延表示为/>i=1,2,...,N-1;
4.利用无迹卡尔曼滤波器实现多车辆追踪,步骤如下:
(1)在k时刻构造观测向量zk=hk(xk)+υk,其中hk(xk)是测量向量,包括通过惯性导航***对车辆速度观测得到的线性部分和通过观测传输时延得到的非线性部分,因此观测向量可以写为其中/>为hk(xk)的非线性部分,/>为hk(xk)的线性部分,由惯性导航***对每辆车x轴方向和y轴方向的速度观测量组成,υk是协方差矩阵为Rk的零均值观测噪声,其中σ1,...,σN为时延观测噪声标准差,σins1,...,σins2N为惯性导航***对速度观测量的噪声标准差;
实验中τp和的标准差为σ1=σ2=1ns;假设惯性导航***对于不同车辆不同方向的速度观测量的噪声标准差相同,即σins1=σins2=σins3=σins4=σins=4m/s;
(2)在k=0时刻,N辆车的状态向量表示为x0,其预测值可以用均值代替,即协方差矩阵/>其中E[·]表示数学期望,对于k>0时刻的状态向量,可以通过状态转移矩阵进行状态预测,即/>其中/>表示k-1时刻状态向量的预测值,/>表示在k-1时刻对k时刻状态向量的预测值,k-1时刻对k时刻状态向量的协方差矩阵Pk|k-1=FPk-1FT+Q通过预测得到,其中Pk-1表示k-1时刻状态向量的协方差矩阵;
实验中x0=[5m,10m/s,5m,10m/s,50m,5m/s,87m,10m/s]T已知,且P0=Q;
(3)为了在k-1时刻计算观测向量zk的统计特性,需要选取2L+1个Sigma点,其中L=4N表示状态量维数,这些Sigma点是具有和状态向量相同的维度的4N×1维列向量,并可以表示为
其中表示在k-1时刻的第i个Sigma点,[·]i表示矩阵的第i列,κ是用于确定Sigma点和状态向量预测值/>之间距离的参数;将这些Sigma点代入到测量向量hk(xk),从而得到在k-1时刻对k时刻观测向量的预测值/>此预测值是将所有的Sigma点代入到测量向量后得到的加权均值,第i个Sigma点所对应的权值wi可以表示为
观测向量的协方差矩阵Pzz和状态向量与观测向量的协方差矩阵Pxz可以分别表示为
其中用于计算协方差的权值为
α和β为无迹卡尔曼滤波器的中间参数;
实验中L=8,κ=-5,α=0.01,β=2;
(4)更新状态空间向量和协方差矩阵,得到多车辆状态空间向量的预测值
其中是在k时刻通过无迹卡尔曼滤波器得到的多车辆状态空间向量的预测值,Pk表示k时刻状态向量的协方差矩阵。
实验中观测时长T=20s,预测得到的车辆运动轨迹如图3所示。从图3中可以看出,预测的车辆运动轨迹与车辆真实轨迹基本重合。选取Δt=0.2s,惯性导航***对速度观测量的噪声标准差σins分别选取1m/s、3m/s和5m/s,对各时间点分别进行1000次蒙特卡洛实验,得到的各时间点预测的车辆位置的均方根误差,如图4所示。均方根误差(Root Mean其中/>表示在第t次蒙特卡罗实验中的平均追踪误差,Ei(t)表示在第t次蒙特卡罗实验中第i辆车的平均追踪误差,表示为/>其中K=T/Δt表示单次追踪过程中的采样总数,在不能整除时向下取整。/>为k时刻第t次蒙特卡罗实验中第i辆车的实际位置,/>为对应的预测位置。从图4可以看出,均方根误差随σins的减小而减小,随着时间增加而迅速减小,说明本发明方法在追踪过程中能快速收敛并能保持较高的追踪性能。综上所述,本实施例证明了本发明所述的一种恶劣环境下基于智能反射表面的多车辆追踪方法的有效性和可靠性。/>
本发明还可有其它多种实施例,在不背离本发明精神及其实质的情况下,本领域技术人员当可根据本发明作出各种相应的改变和变形,但这些相应的改变和变形都应属于本发明所附的权利要求的保护范围。
Claims (3)
1.一种恶劣环境下基于智能反射表面的多车辆追踪方法,其特征在于:所述方法具体过程为:
步骤一:建立多车辆追踪***模型;
步骤二:基于步骤一建立的多车辆追踪***模型,根据主车选择策略选定主车;
步骤三:基于步骤二选定主车,优化智能反射表面配置并获得传输时延;
步骤四:基于步骤三获得的传输时延,利用无迹卡尔曼滤波器实现多车辆追踪;
所述步骤二中基于步骤一建立多车辆追踪***模型,根据主车选择策略选定主车,步骤如下:
步骤二一、假设所有信道都在准静态平坦衰落下,且在一个采样间隔Δt内信道系数保持不变,并且所有车辆和路侧单元都位于智能反射表面的远场区域;
hn表示从智能反射表面到第n辆车链路信道系数,g表示路侧单元到智能反射表面链路信道系数;
以智能反射表面的第一个单元作为参考单元,hn和g表达式分别为
其中j为虚数且j2=-1,λ为发射信号波长,dR为智能反射表面单元间隔,m为智能反射表面第m个单元,m=1,2,…,M,M为智能反射表面单元个数;θn为智能反射表面到第n辆车的波达方向,为路侧单元到智能反射表面的波达方向;
步骤二二、假设车辆和路侧单元之间的视线链路被阻塞,通过智能反射表面建立虚拟视线链路;具体过程为:
用ρn表示第n辆车到智能反射表面之间的路径损失,表达式为
其中dn表示第n辆车到智能反射表面之间的距离,r表示智能反射表面到路侧单元的距离;
第n辆车接收到的信号表示为
其中s是具有零均值和单位标准差的传输信号,u是标准差为σs的加性高斯白噪声,pt是路侧单元的发射功率,H表示共轭转置,是对于第n辆车的智能反射表面的配置控制矩阵;
其中表示对于第n辆车的智能反射表面的第m个单元的相移参数其中m=1,2,...,M;
步骤二三、基于步骤二一和步骤二二,使第n辆车接收到的信号yn对应的接收功率pn最大,分别使多车辆追踪***中每台车接收到的信号对应的接收功率最大,并从中选择接收功率最大的车辆作为主车,其余车辆作为从车由主车引导追踪;
所述步骤三中基于步骤二选定主车,优化智能反射表面配置并获得传输时延,步骤如下:
步骤三一、在选定主车后,假设主车到智能反射表面参考单元的距离为dp,经过参考单元反射的信号传输时延为τp=dp/c,c为光速,由于智能反射表面的反射信号在远场条件下可近似为平面波,因此主车到智能反射表面第m个单元的距离为dm=dp+(m-1)dRcos(θp);
其中θp为智能反射表面到主车的波达方向,经过第m个单元反射的信号传输时延为主车到智能反射表面第m个单元和参考单元之间的相位差为/>所以τm与τp的差值为
步骤三二、调整对于主车的智能反射表面的配置控制矩阵Ψp,使
其中表示对于主车的智能反射表面的第m个单元的相移参数,此时主车到智能反射表面每个单元反射信号的相位都与参考单元相位相同,所以Δτm=0,因此主车到智能反射表面每个单元的传输时延都为τp;
步骤三三、多车辆追踪***中余下的N-1辆从车到主车的距离分别为因此从车到主车信号传输时延表示为/>
所述步骤四中基于步骤三获得的传输时延,利用无迹卡尔曼滤波器实现多车辆追踪,步骤如下:
步骤四一、在k时刻构造观测向量zk=hk(xk)+υk;
其中hk(xk)是测量向量,包括通过惯性导航***对车辆速度观测得到的线性部分和通过观测传输时延得到的非线性部分,因此观测向量可以写为
其中为hk(xk)的非线性部分,为hk(xk)的线性部分,υk是协方差矩阵为Rk的零均值观测噪声;
其中σ1,...,σN为时延观测噪声标准差,σins1,...,σins2N为惯性导航***对速度观测量的噪声标准差;
步骤四二、在k=0时刻,N辆车的状态向量表示为x0,状态向量x0的预测值可以用均值代替,即状态向量x0的协方差矩阵/>其中E[·]表示数学期望;
对于k>0时刻的状态向量,可以通过状态转移矩阵进行状态预测,即其中表示k-1时刻状态向量的预测值,/>表示在k-1时刻对k时刻状态向量的预测值,k-1时刻对k时刻状态向量的协方差矩阵Pk|k-1=FPk-1FT+Q通过预测得到,其中Pk-1表示k-1时刻状态向量的协方差矩阵;
步骤四三、为了在k-1时刻计算观测向量zk的统计特性,选取2L+1个Sigma点,其中L=4N表示状态量维数,2L+1个Sigma点是具有和状态向量相同的维度的4N×1维列向量,并可以表示为
其中表示在k-1时刻的第i个Sigma点,[·]i表示矩阵的第i列,κ是用于确定Sigma点和状态向量预测值/>之间距离的参数;
将2L+1个Sigma点代入到测量向量hk(xk),从而得到在k-1时刻对k时刻观测向量的预测值此预测值是将所有的2L+1个Sigma点代入到测量向量后得到的加权均值,第i个Sigma点所对应的权值wi可以表示为
观测向量的协方差矩阵Pzz和状态向量与观测向量的协方差矩阵Pxz可以分别表示为
其中用于计算协方差的权值为
α和β为无迹卡尔曼滤波器的中间参数;
步骤四四、更新状态空间向量和协方差矩阵,得到多车辆状态空间向量的预测值
其中是在k时刻通过无迹卡尔曼滤波器得到的多车辆状态空间向量的预测值,Pk表示k时刻状态向量的协方差矩阵。
2.根据权利要求1所述一种恶劣环境下基于智能反射表面的多车辆追踪方法,其特征在于:所述步骤一中建立的多车辆追踪***模型,步骤如下:
步骤一一、多车辆追踪***由N辆发出定位请求的车辆和一组位置已知的路侧单元以及智能反射表面组成;
步骤一二、设每辆车在二维笛卡尔坐标系中运动,k时刻第n辆车的状态表示为
其中和/>表示k时刻第n辆车在坐标系中x轴和y轴的坐标位置,/>和/>表示k时刻第n辆车在坐标系中x轴方向和y轴方向上的速度,上角标T表示转置;
N辆车在k时刻的状态空间向量表示为
步骤一三、假设每辆车在任意两个相邻时刻内近似为恒速,因此满足xk=Fxk-1+ωk;
其中xk-1表示N辆车在k-1时刻的状态空间向量,F=diag(Fa,...,Fa)是4N×4N的状态转移矩阵,Δt表示采样间隔,diag(·)表示对角矩阵;ωk为均值为零的高斯分布过程噪声,具有4N×4N的协方差矩阵Q,Q=diag(Qa,…,Qa),
3.根据权利要求2所述一种恶劣环境下基于智能反射表面的多车辆追踪方法,其特征在于:所述对于第n辆车的智能反射表面的配置控制矩阵Ψn的具体求解过程为:
由hn和g得到对于第n辆车的智能反射表面第m个单元的相移参数
其中arg(·)表示相位,[·]m表示向量的第m个元素,进而得到Ψn。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210231729.4A CN114608590B (zh) | 2022-03-09 | 2022-03-09 | 一种恶劣环境下基于智能反射表面的多车辆追踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210231729.4A CN114608590B (zh) | 2022-03-09 | 2022-03-09 | 一种恶劣环境下基于智能反射表面的多车辆追踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114608590A CN114608590A (zh) | 2022-06-10 |
CN114608590B true CN114608590B (zh) | 2024-04-30 |
Family
ID=81860638
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210231729.4A Active CN114608590B (zh) | 2022-03-09 | 2022-03-09 | 一种恶劣环境下基于智能反射表面的多车辆追踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114608590B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105223575A (zh) * | 2015-10-22 | 2016-01-06 | 广州极飞电子科技有限公司 | 无人机、无人机的测距滤波方法及基于该方法的测距方法 |
CN106228805A (zh) * | 2016-06-30 | 2016-12-14 | 北京航空航天大学 | 一种交互式多车辆跟踪方法及装置 |
CN107274721A (zh) * | 2017-06-07 | 2017-10-20 | 北京科技大学 | 一种智能交通***中多车辆协作定位方法 |
CN108399753A (zh) * | 2018-03-01 | 2018-08-14 | 山东建筑大学 | 基于超声波录波信息的车辆轨迹跟踪方法与*** |
CN113155123A (zh) * | 2021-04-01 | 2021-07-23 | 北京大学 | 基于数据共享的多智能车辆协同定位追踪方法及装置 |
CN113382382A (zh) * | 2021-06-09 | 2021-09-10 | 天津理工大学 | 一种基于模糊逻辑优化策略的车辆自组网络路由方法 |
CN114034298A (zh) * | 2021-11-04 | 2022-02-11 | 吉林大学 | 一种基于可重构智能表面的车辆定位方法 |
-
2022
- 2022-03-09 CN CN202210231729.4A patent/CN114608590B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105223575A (zh) * | 2015-10-22 | 2016-01-06 | 广州极飞电子科技有限公司 | 无人机、无人机的测距滤波方法及基于该方法的测距方法 |
CN106228805A (zh) * | 2016-06-30 | 2016-12-14 | 北京航空航天大学 | 一种交互式多车辆跟踪方法及装置 |
CN107274721A (zh) * | 2017-06-07 | 2017-10-20 | 北京科技大学 | 一种智能交通***中多车辆协作定位方法 |
CN108399753A (zh) * | 2018-03-01 | 2018-08-14 | 山东建筑大学 | 基于超声波录波信息的车辆轨迹跟踪方法与*** |
CN113155123A (zh) * | 2021-04-01 | 2021-07-23 | 北京大学 | 基于数据共享的多智能车辆协同定位追踪方法及装置 |
CN113382382A (zh) * | 2021-06-09 | 2021-09-10 | 天津理工大学 | 一种基于模糊逻辑优化策略的车辆自组网络路由方法 |
CN114034298A (zh) * | 2021-11-04 | 2022-02-11 | 吉林大学 | 一种基于可重构智能表面的车辆定位方法 |
Non-Patent Citations (1)
Title |
---|
RoS: Passive Smart Surface for Roadside-to-Vehicle Communication;ohn Nolan;《ACM SIGCOMM 2021 Conference》;20210831;第165-178页 * |
Also Published As
Publication number | Publication date |
---|---|
CN114608590A (zh) | 2022-06-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7719461B1 (en) | Track fusion by optimal reduced state estimation in multi-sensor environment with limited-bandwidth communication path | |
US7821453B2 (en) | Distributed iterative multimodal sensor fusion method for improved collaborative localization and navigation | |
CN100373690C (zh) | 从移动平台精确跟踪和与卫星通信的方法 | |
CN102622520B (zh) | 一种机动目标跟踪的分布式多模型估计融合方法 | |
Parker et al. | Cooperative vehicle position estimation | |
US9354305B2 (en) | Method for producing at least information for track fusion and association for radar target tracking, and storage medium thereof | |
US20060240839A1 (en) | Methods and systems for location estimation | |
CN103746757A (zh) | 一种基于星载多波束天线的单星干扰源定位方法 | |
CN105549005A (zh) | 一种基于网格划分的动态目标波达方向跟踪方法 | |
CN111273298A (zh) | 基于波浪滑翔器组网技术的水下声学目标定位与跟踪方法 | |
CN103956074A (zh) | 基于位置服务的停车场自动指引***及实现方法 | |
CN113438596B (zh) | 一种面向北斗与5g融合的毫米波低时延波束赋形方法 | |
CN105044667A (zh) | 一种运动目标的双星跟踪方法、装置和*** | |
Wu et al. | UAV-based target tracking: Integrating sensing into communication signals | |
CN114608590B (zh) | 一种恶劣环境下基于智能反射表面的多车辆追踪方法 | |
Zhu et al. | On a novel high accuracy positioning with intelligent reflecting surface and unscented kalman filter for intelligent transportation systems in B5G | |
CN105445757A (zh) | 一种交通工具引导***及引导方法 | |
Zeng et al. | Radio frequency based direction sensing using massive MIMO | |
CN114034298B (zh) | 一种基于可重构智能表面的车辆定位方法 | |
CN109799477B (zh) | 一种面向毫米波车联网的序贯车辆指纹定位方法及装置 | |
Qasem et al. | Unscented and extended Kalman estimators for non linear indoor tracking using distance measurements | |
KR102596954B1 (ko) | 주행체에 장착되는 태그 및 이를 포함하는 주행체 좌표 측정 시스템 | |
Bian et al. | Reconfigurable Intelligent Surface Assisted Mobile Target Tracking With Agile Phase Control | |
Zhao et al. | Integrated sensing and communication‐promoted beam tracking and coverage for complex vehicular networks | |
CN114567400B (zh) | 一种基于几何随机的无人机空地mimo信道建模方法 |
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 |