CN114357019A - 一种智能网联环境下路侧感知单元数据质量监测方法 - Google Patents
一种智能网联环境下路侧感知单元数据质量监测方法 Download PDFInfo
- Publication number
- CN114357019A CN114357019A CN202111465443.4A CN202111465443A CN114357019A CN 114357019 A CN114357019 A CN 114357019A CN 202111465443 A CN202111465443 A CN 202111465443A CN 114357019 A CN114357019 A CN 114357019A
- Authority
- CN
- China
- Prior art keywords
- data
- vehicle
- track
- intelligent
- roadside
- 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.)
- Pending
Links
Images
Landscapes
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种智能网联环境下路侧感知单元数据质量监测方法,包括:同步采集所监测的路侧感知单元数据与智能网联车辆数据,得到路侧感知轨迹数据集、经过相应路段的智能网联车辆定位及感知数据;计算路侧感知轨迹数据集中各条轨迹与经过相应路段的智能网联车辆轨迹的相似度,从路侧感知轨迹数据集中筛选出与智能网联车辆相匹配的轨迹数据,形成测评轨迹数据对;进一步对齐路侧感知单元与智能网联车辆的系统时间,并对智能网联车辆数据进行插值重采样实现时间同步;通过计算路侧感知单元数据的绝对定位误差与相对定位误差,完成对路侧感知单元数据质量的监测。与现有技术相比,本发明能够对路侧感知单元数据质量进行全面、实时、可靠的监测。
Description
技术领域
本发明涉及交通信息采集与分析技术领域,尤其是涉及一种智能网联环境下路侧感知单元数据质量监测方法。
背景技术
伴随着5G和车联网技术的不断发展,路侧感知单元已经成为构建智能网联交通系统的重要支撑。智慧公路的路侧感知单元(如高清摄像头、毫米波雷达、激光雷达等)能够及时获取道路交通各参与对象的定位、速度等运动轨迹信息,实现车辆与车辆、车辆与道路基础设施之间的智能协同与配合,达到优化利用系统资源、提高道路交通安全、缓解交通拥堵的目标。路侧感知单元轨迹数据的准确与否将对智能网联交通环境的运行安全性、管控有效性产生重要影响。然而,针对输出的轨迹数据能否支撑智能网联车辆服务和精细化交通管控应用,目前并没有统一的标准,现有不同传感器感知数据的精度与质量也参差不齐,如何对路侧感知轨迹数据的质量进行监测也成为智慧公路、车路协同快速发展下亟需破解的难题。
过往研究对于路侧感知单元数据质量的监测,主要是利用更高精度的感知单元在同一时空尺度下获取数据与路侧感知数据进行对比评测,并提出一系列精度指标对感知数据质量水平进行判别。然而,部分研究受到对比数据源测量精度、实验场地封闭或传感器布设等限制,数据质量评价过程费时费力且缺乏合理、可靠的质量评价指标,难以满足智能网联环境下常态化、高频实时的路侧感知轨迹数据质量监测需求,因而亟需研发一种面向智慧道路路侧感知单元服役过程的数据在线监测方法,以能够对路侧感知单元数据质量进行全面实时可靠的监测。
发明内容
本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种智能网联环境下的路侧感知单元数据质量监测方法。
本发明考虑到,当前基于车联网和自动驾驶技术的飞速发展,越来越多的智能网联车辆涌入道路交通,并与传统人工驾驶车辆形成新型混合交通流,为路侧感知数据质量监测提供了新的方向与思路。智能网联车辆GPS/IMU设备的组合定位精度及车载激光雷达测距精度可达厘米甚至毫米级别,可获取精确的车辆定位数据及周围车辆相对定位数据;规模化运行的智能网联车辆高精度定位与感知数据可作为真实道路场景中重要的对比数据源,以上使得对于动态交通环境中路侧感知轨迹的常态化监测及评价成为可能。
因而,本发明通过采集处理并对比、评价路侧感知单元数据与车端高精定位及感知数据,进而实现对路侧感知单元数据质量的全面、实时、可靠监测。
本发明的目的可以通过以下技术方案来实现:一种智能网联环境下路侧感知单元数据质量监测方法,包括以下步骤:
S1、同步采集所监测的路侧感知单元数据与智能网联车辆数据,得到路侧感知轨迹数据集、经过相应路段的智能网联车辆定位及感知数据;
S2、计算路侧感知轨迹数据集中各条轨迹与经过相应路段的智能网联车辆轨迹的相似度,从路侧感知轨迹数据集中筛选出与智能网联车辆相匹配的对应轨迹数据,形成测评轨迹数据对;
S3、基于测评轨迹数据对,进一步对齐路侧感知单元系统时间与智能网联车辆系统时间,并对智能网联车辆数据进行插值重采样实现时间同步;
S4、根据测评轨迹数据对以及时间同步后的智能网联车辆数据,通过计算路侧感知单元数据的绝对定位误差与相对定位误差,完成对路侧感知单元数据质量的监测。
进一步地,所述智能网联车辆安装有定位设备、感知传感器和通信模块,所述智能网联车辆数据包括但不限于采样时间、车辆自身定位、周围车辆的相对位置;
所述路侧感知单元数据包括但不限于采样时间、目标定位坐标、目标速度;
所述智能网联车辆的感知精度不低于路侧感知单元的精度,且路侧感知单元定位坐标系与智能网联车辆定位坐标系相同。
进一步地,所述步骤S1具体包括以下步骤:
S11、在所监测的路侧感知单元的感知范围内,智能网联车辆跟随车流正常行驶,并采集获取自身定位及感知数据;与此同时,路侧感知单元同步进行数据采集,获取感知范围内目标车辆ID及定位数据;
S12、提取路侧感知单元数据,检索出属于同一ID的车辆运动信息并按时间排序构成轨迹,整理形成路侧感知轨迹数据集R={R1,R2,…,Rj,…,RM},其中,为车辆j的轨迹,为a时刻车辆j的定位坐标,A为路侧感知单元的采集终点时刻;
S13、提取智能网联车辆定位数据并按时间排序,构成智能网联车辆轨迹数据C,C={c1,c2,…,cB},cb为b时刻智能网联车辆的定位坐标,B为智能网联车辆的采集终点时刻,提取智能网联车辆感知数据,检索出数据目标ID的信息并按时间及排序,构成智能网联车辆感知数据集P={P1,P2,…,PN},其中智能网联车辆周围车辆i相对位置信息为c时刻车辆i的相对定位坐标。
进一步地,所述步骤S2具体包括以下步骤:
S21、计算路侧感知轨迹数据集中各条轨迹与智能网联车辆轨迹整体LCSS相似度;
S22、提取路侧感知轨迹数据与智能网联车辆轨迹各采样点周围车辆相对位置序列,并计算对应相对位置序列LCSS相似度;
S23、利用RPS-LCSS相似度算法计算各轨迹对相似度;
S24、选择路侧感知轨迹数据集中RPS-LCSS相似度最大的轨迹,以作为智能网联车辆轨迹对应的匹配轨迹。
进一步地,所述步骤S21的具体过程为:
对采集得到的路侧感知轨迹数据集R={R1,R2,…,RM},计算其中各条轨迹Rj与智能网联车轨迹C的最长公共子序列及其LCSS相似度DL(Rj,C),计算公式如下:
其中,LCSS(Rj,C)为轨迹Rj,C的最长公共子序列长度,dist(·)为距离函数,度量两坐标之间的距离,为轨迹坐标序列Rj的子序列,M为轨迹中坐标点数量,Cb为轨迹坐标序列C的子序列,Cb={c1,c2,…,cb,b≤B},N为轨迹中坐标点数量,γt为成员相似阈值,L(·)为轨迹长度,DL(Rj,C)为两轨迹之间的LCSS相似度。
进一步地,所述步骤S22的具体过程为:对智能网联车辆轨迹C,若采样点i周围存在L个车辆,则按照车辆相对距离从小到大的顺序构成相对坐标序列ci={(xk,yk)|k=0,1…,L},其中,(xk,yk)为距离智能网联车辆采样点i第k个相近车辆的相对坐标;
对路侧感知轨迹数据集中车辆轨迹Rj,若采样点i周围存在Q个车辆,则按照车辆相对距离从小到大的顺序构成相对坐标序列rij={(xl,yl)|l=0,1…,Q},其中,(xl,yl)为距离车辆Rj采样点i第l个相近车辆的相对坐标,由此,计算智能网联车辆C和路侧感知轨迹数据集中轨迹Rj对应采样点i的相对位置序列ci,rij的LCSS相似度为:
其中,LCSS(ci,rij)为相对坐标序列ci,rij的最长公共子序列长度,dist(·)为距离函数,度量两相对坐标之间的距离,为智能网联车辆周围车辆相对坐标序列ci的子序列,L为相对位置序列坐标点数量,为路侧感知轨迹数据集中智能网联车辆周围车辆的相对坐标序列rij的子序列,Q为相对位置序列坐标点数量,γr为成员相似度阈值,L(·)为相对坐标序列长度,DL(ci,rij)为两相对位置序列之间的LCSS相似度。
进一步地,所述步骤S23的具体过程为:计算路侧感知轨迹数据中各条轨迹Rj与智能网联车辆轨迹C整体相似度DL(Rj,C)、以及各对应采样点周围车辆相对位置序列相似度平均值之和,以作为两轨迹的RPS-LCSS相似度D(Rj,C):
其中,DL(Rj,C)为轨迹Rj与C的整体LCSS相似度,DL(ci,rij)为轨迹公共子序列中点i周围车辆相对位置序列ci与rij的LCSS相似度,T为轨迹对中最长公共子序列长度;
所述步骤S24的具体过程为:选择路侧感知轨迹数据集R中RPS-LCSS相似度最大的路侧轨迹Rz,以作为智能网联车辆轨迹的匹配轨迹:
由此确定出匹配路侧感知数据中智能网联车辆对应的轨迹数据。
进一步地,所述步骤S3具体包括以下步骤:
S31、求解系统时间对齐调整量,平移调整智能网联车辆数据时间,对平移时间后的智能网联车辆轨迹数据与路侧感知轨迹数据,采用相同时长及时间间隔进行三次样条插值,计算对应时刻车辆数据坐标与路侧感知数据坐标点距离,求解使得各对应点坐标平均距离最小的最佳系统时间对齐调整量ta:
ta=argminL(t)
其中,(xr(i),yr(i))为i时刻路侧感知轨迹数据对应采样坐标点,(xc(i),yc(i))为i时刻智能网联车辆轨迹对应采样坐标点,t为车端数据时间平移量,ta为最佳系统时间对齐调整量,M为插值后数据点个数;
S32、调整智能网联车辆数据时间实现时间对齐:根据步骤S31中得到的最佳系统时间对齐调整量ta,调整智能网联车辆的数据时间,以与路侧感知单元的系统时间进行对齐;
S33、智能网联车辆定位及感知数据与路侧感知轨迹数据时间同步:根据路侧感知轨迹数据采样时刻,使用三次样条曲线模型对智能网联车辆定位及感知数据进行插值重采样,与路侧感知轨迹数据采样时间实现同步。
进一步地,所述步骤S4具体包括以下步骤:
S41、计算路侧感知轨迹数据的单车绝对定位中误差ma;
S42、计算路侧感知轨迹数据的多车相对定位中误差mr;
S43、根据实际交通应用场景特征及需求,设置允许绝对定位误差阈值α、相对定位误差阈值β,根据单车绝对定位中误差ma、多车相对定位中误差mr分别与对应阈值的相对大小关系,确定出定位误差是否满足精度要求,完成对路侧感知单元数据质量的监测。
进一步地,所述步骤S41的具体过程为:利用智能网联车辆定位数据,计算路侧感知轨迹数据的单车绝对定位中误差ma:
其中,(xr(i),yr(i))为i时刻路侧感知轨迹数据定位坐标,(xc(i),yc(i))为i时刻智能网联车辆轨迹对应采样点定位坐标,(Δxi,Δyi)为i时刻路侧感知单元与智能网联车辆定位的相对位置坐标,εai为i时刻绝对定位误差,n为采样点个数;
所述步骤S42的具体过程为:利用智能网联车辆感知数据,计算路侧感知轨迹数据的多车相对定位中误差mr:
Δd(i)=dc(i)-dr(i)
其中,(xr(i),yr(i))为i时刻路侧感知单元采集的经过感知范围的智能网联车辆的坐标点,(xrn(i),yrn(i))为i时刻路侧感知单元采集距离经过的智能网联车辆周围车辆的坐标点,(xcn(i),ycn(i))为所经过的智能网联车辆采集的i时刻其周围车辆的相对坐标,dr(i)为i时刻路侧感知单元采集的所经过的智能网联车辆与其周围车辆的相对距离,dc(i)为i时刻所经过的智能网联车辆感知其周围车辆的相对距离,Δd(i)为i时刻路侧感知单元与智能网联车辆感知其周围车辆相对距离的差值,为其周围车辆相对距离差值的平均值,εri为i时刻多车相对定位误差,n为采样点个数。
与现有技术相比,本发明利用感知精度更高的智能网联车辆数据,以对路侧感知单元数据进行评价监测,通过在路侧感知轨迹数据集中匹配出与智能网联车辆相对应的轨迹数据,并将路侧感知单元系统时间与智能网联车辆系统时间进行对齐处理、通过轨迹重采样实现时间同步,由此能够对路侧感知单元数据质量进行全面、实时、可靠地监测。
本发明利用智能网联车辆可获取的周围车辆相对位置数据,由此提出一种RPS-LCSS相似度匹配算法,该算法在传统LCSS算法的基础上提出利用周围车辆相对位置衡量轨迹相似度,从路侧感知轨迹数据集中匹配智能网联车辆对应轨迹数据,在保证计算效率的前提下,较传统LCSS相似度算法可显著提升轨迹匹配准确率,能够在数据质量监测流程中提升轨迹筛选匹配的速度和效率。
本发明面向实际交通需求场景,扩展并设计了感知轨迹数据精度评价方法,根据智能网联车辆感知数据及实际需求特征,在单车绝对定位精度的基础上提出对多车相对定位精度进行评价,并利用中误差作为精度评价指标,对传统精度评价指标进行有效扩展,可满足不同应用需求下的数据质量监测及评价。
附图说明
图1为本发明的方法流程示意图;
图2a为实施例中路侧感知轨迹的周围车辆相对序列示意图;
图2b为实施例中智能网联车辆相对序列示意图;
图3为本发明时间同步算法示意图;
图4为实施例的轨迹匹配结果;
图5a为实施例中车辆直行段的定位误差计算结果;
图5b为实施例中车辆换道段的定位误差计算结果。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。
实施例
如图1所示,一种智能网联环境下路侧感知单元数据质量监测方法,包括以下步骤:
S1、同步采集所测评的路侧感知单元数据与所经过的智能网联车辆数据,构成路侧感知轨迹数据集及智能网联车辆定位及感知数据,具体的:
S11、在所监测的路侧感知单元的感知范围内,智能网联车辆跟随车流正常行驶,车载传感器采集获取自身定位及感知数据;与此同时,路侧感知单元同步进行数据采集,获取感知范围内目标车辆ID及定位数据。
S13、提取所经过的智能网联车辆定位数据并按时间排序,构成智能网联车辆轨迹数据C,C={c1,c2,…,cB},cb为b时刻智能网联车辆的定位坐标。提取智能网联车辆感知数据,检索出数据目标ID的信息并按时间及排序,构成智能网联车辆感知数据集P={P1,P2,…,PN}。其中智能网联车辆周围车辆i相对位置信息为c时刻车辆i的相对定位坐标。
S2、计算路侧感知轨迹数据集中的各条轨迹与所经过的智能网联车辆轨迹的相似度,从路侧感知轨迹数据集中筛选匹配智能网联车辆对应的轨迹数据,形成评价轨迹数据对,具体的:
S21、对采集得到的路侧感知轨迹数据集R={R1,R2,…,RM},计算其中各条路侧轨迹Rj与智能网联车轨迹C的最长公共子序列及其LCSS相似度DL(Rj,C)。计算公式如下:
其中,LCSS(Rj,C)为轨迹Rj,C的最长公共子序列长度;dist(·)为距离函数,度量两坐标之间的距离;为轨迹坐标序列Rj的子序列,M为轨迹中坐标点数量;Cb表示轨迹坐标序列C的子序列,Cb={c1,c2,…,cb,b≤B},N为轨迹中坐标点数量;γt为成员相似阈值;L(·)表示轨迹长度;DL(Rj,C)表示两轨迹之间的LCSS相似度。
S22、对智能网联车辆轨迹C,若采样点i周围存在L个车辆,按照车辆相对距离从小到大构成相对坐标序列ci={(xk,yk)|k=0,1…,L},其中(xk,yk)为距离智能网联车辆采样点i第k近的车辆的相对坐标。对路侧感知轨迹数据集中车辆轨迹Rj,若采样点i周围存在Q个车辆,按照车辆相对距离从小到大构成相对坐标序列rij={(xl,yl)|l=0,1…,Q},其中(xl,yl)为距离车辆Rj采样点i第l近的车辆的相对坐标。由此,计算智能网联车辆C和路侧感知轨迹数据集中轨迹Rj对应采样点i的相对位置序列ci,rij的LCSS相似度。
其中,LCSS(ci,rij)为相对坐标序列ci,rij的最长公共子序列长度;dist(·)为距离函数,度量两相对坐标之间的距离;为智能网联车辆周围车辆相对坐标序列ci的子序列,L为相对位置序列坐标点数量;表示路侧感知轨迹数据集中智能网联车辆周围车辆的相对坐标序列rij的子序列,Q为相对位置序列坐标点数量;γr为成员相似度阈值;L(·)表示相对坐标序列长度;DL(ci,rij)表示两相对位置序列之间的LCSS相似度。
S23、利用RPS-LCSS相似度算法计算各轨迹对相似度,确定轨迹对应匹配关系。将路侧感知轨迹数据集中各条轨迹Rj与所经过的智能网联车辆轨迹C整体相似度DL(Rj,C)及各对应采样点周围车辆相对位置序列相似度平均值之和作为两轨迹的RPS-LCSS相似度D(Rj,C)。
其中,DL(Rj,C)为轨迹Rj与C的整体LCSS相似度,DL(ci,rij)为轨迹公共子序列中点i周围车辆相对位置序列ci与rij的LCSS相似度,T为轨迹对中最长公共子序列长度。
S24、选择路侧轨迹集R中RPS-LCSS相似度最大的路侧感知轨迹数据Rz作为智能网联车辆轨迹的匹配轨迹,筛选确定匹配路侧感知轨迹数据集中智能网联车辆对应的轨迹数据:
S3、对齐路侧感知单元系统时间与所经过的智能网联车辆系统时间,并对智能网联车辆数据进行插值重采样实现时间同步(如图3所示),具体的:
S31、求解系统时间对齐调整量。平移调整智能网联车辆数据时间,对平移时间后的智能网联车辆轨迹数据与路侧感知轨迹数据,采用相同时长及时间间隔进行三次样条插值,计算对应时刻车辆数据坐标与路侧感知轨迹数据坐标点距离,求解使得各对应点坐标平均距离最小的最佳系统时间对齐调整量ta。
ta=argminL(t)
式中,(xr(i),yr(i))为i时刻路侧感知单元对应采样坐标点,(xc(i),yc(i))为i时刻智能网联车辆对应采样坐标点,t为智能网联车辆数据采集时间的平移量,ta为最佳系统时间对齐调整量,M为插值后数据点个数。
S32、调整智能网联车辆数据采集时间实现时间对齐。根据S31中求得的最佳系统时间对齐调整量ta,调整智能网联车辆数据时间与路侧感知单元时间进行对齐。
S33、智能网联车辆定位及感知数据与路侧感知轨迹数据时间同步。根据路侧感知轨迹数据采样时刻使用三次样条曲线模型对智能网联车辆定位及感知数据进行插值重采样,与路侧感知轨迹数据采样时间实现同步。
S4、计算路侧感知单元数据的绝对定位误差与相对定位误差,评价路侧感知单元数据质量,具体的:
S41、利用智能网联车辆定位数据,计算路侧感知数据的单车绝对定位中误差ma。
其中,(xr(i),yr(i))为i时刻路侧感知轨迹数据的定位坐标,(xc(i),yc(i))为i时刻智能网联车辆轨迹对应采样点定位坐标,(Δxi,Δyi)为i时刻路侧感知轨迹数据与智能网联车辆轨迹的位置点的相对坐标,εai为i时刻绝对定位误差,n为采样点个数。
S42、利用智能网联车辆感知数据,计算路侧感知轨迹数据的多车相对定位中误差mr。
Δd(i)=dc(i)-dr(i)
其中,(xr(i),yr(i))为i时刻路侧感知单元采集的经过感知范围的智能网联车辆的坐标点,(xrn(i),yrn(i))为i时刻路侧感知单元采集距离经过的智能网联车辆周围车辆的坐标点,(xcn(i),ycn(i))为所经过的智能网联车辆采集的i时刻其周围车辆的相对坐标,dr(i)为i时刻路侧感知单元采集的所经过的智能网联车辆与其周围车辆的相对距离,dc(i)为i时刻所经过的智能网联车辆感知其周围车辆的相对距离,Δd(i)为i时刻路侧感知单元与智能网联车辆感知其周围车辆相对距离的差值,为其周围车辆相对距离差值的平均值,εri为i时刻多车相对定位误差,n为采样点个数。
S43、根据实际交通应用场景特征及需求,设置允许绝对定位误差阈值α,相对定位误差阈值β,根据误差与阈值的相对大小关系确定定位误差是否满足精度要求;;分析相关因素等因素对感知数据定位精度的影响,从而为不同场景路侧感知轨迹数据的应用与修正提供指导。
本实施例基于同济大学智能网联交通环境进行,同济大学智慧道路路侧感知单元有激光雷达传感器、雷视融合传感器、高清摄像头等,参考团体标准《基于车路协同的高等级自动驾驶数据交互内容》(T/CSAE 158-2020)要求,无信号交叉口通行场景要求定位精度不超过50cm。
为便于数据处理及结果校验,本实施例主要针对路侧雷视融合传感器的感知轨迹数据进行质量监测及评价。实验用路侧雷视融合传感器可输出目标的经纬度坐标,采样频率为20Hz。本实施例中,智能网联车辆装有GNSS/IMU组合高精度定位设备,车身安装有三个激光雷达传感器、六个毫米波雷达传感器,可实时输出智能网联车辆自身位姿信息及周围车辆相对定位信息,定位误差为厘米级,采样频率为100Hz。以其中一次数据采集与质量监测及评价为例,本实施例应用上述技术方案,其主要过程为:
步骤一、令智能网联车辆与路侧雷视融合传感器同步进行数据采集,构成路侧雷视融合感知轨迹数据集与智能网联车辆定位及感知数据,包括:
步骤1.1、在路侧雷视融合感知范围内,指挥智能网联车辆完成直行及换道行驶,利用车载GNSS/IMU设施采集车辆自身位姿数据,利用车辆激光雷达、毫米波采集周围车辆相对位置数据,并打开路侧雷视融合传感器同步进行数据采集,获取感知范围内所有车辆运动信息。
步骤1.2、提取路侧雷视融合传感器获取的结构化感知数据,检索出属于同一ID的车辆运动信息并按时间排序构成轨迹,整理形成路侧感知轨迹数据集R={R1,R2,…,R33},共有感知轨迹33条。其中Ri={ri 1,ri 2,…,ri A},ri a为a时刻车辆i的定位坐标。
步骤1.3、提取智能网联车辆GNSS/IMU设备获取的定位数据并按时间排序,构成智能网联车辆轨迹数据C,C={c1,c2,…,c216},共有定位坐标点216个,其中cb为b时刻智能网联车辆的定位坐标。提取车辆激光雷达、毫米波获取的感知数据,检索出数据目标ID的信息并按时间及排序,构成智能网联车辆感知数据集P={P1,P2,…,P5},周围共有车辆5辆。其中为c时刻智能网联车辆周围车辆i的相对定位坐标。
步骤二、计算路侧雷视融合感知轨迹数据集中各条轨迹与智能网联车辆轨迹C的RPS-LCSS相似度,选择其中与智能网联车辆轨迹RPS-LCSS相似度最大的路侧雷视融合感知轨迹作为智能网联车辆匹配轨迹。计算所得RPS-LCSS相似度为1.85,利用路侧高清视频数据检验匹配准确性。轨迹匹配结果如图4所示。
步骤三、将路侧雷视融合传感器系统时间与智能网联车辆系统时间进行对齐,并对采集数据进行重采样实现时间同步,包括:
步骤3.1、求解系统时间对齐调整量。从-5s至5s,以0.01s为时间间隔依次平移调整智能网联车辆数据时间。按照0.01s的时间间隔,对平移时间后的智能网联车辆轨迹数据与路侧雷视融合感知轨迹数据分别进行三次样条插值,依次计算各平移时刻下坐标平均距离。在时间平移量范围内遍历,求解可得各对应点坐标平均距离最小的最佳系统时间对齐调整量ta为3.63s。
ta=argminL(t)
式中,(xr(i),yr(i))为i时刻路侧感知轨迹数据对应采样坐标点,(xc(i),yc(i))为i时刻智能网联车辆对应采样坐标点,t为车端数据时间平移量,ta为最佳系统时间对齐调整量,M为插值后数据点个数。
步骤3.2、调整智能网联车辆时间实现时间对齐。将智能网联车辆数据采样时间统一减去3.63s,与路侧雷视融合感知单元系统时间进行对齐。
步骤3.3、智能网联车辆与路侧雷视融合设备数据时间同步。根据路侧雷视融合感知数据采样时刻,使用三次样条曲线模型对调整时间后的智能网联车辆数据进行插值重采样,与路侧感知轨迹数据采样时间实现同步。
步骤四、计算路侧感知轨迹数据单车绝对定位误差与多车相对定位误差,评价路侧感知数据质量,包括:
步骤4.1、利用智能网联车辆定位数据,计算可得路侧雷视融合感知数据的单车绝对定位中误差ma为25.24cm。
其中,(xr(i),yr(i))为i时刻路侧感知轨迹数据的定位坐标,(xc(i),yc(i))为i时刻智能网联车辆轨迹对应采样点定位坐标,(Δxi,Δyi)为i时刻路侧感知单元与智能网联车辆定位的相对位置坐标,εai为i时刻绝对定位误差,n为采样点个数。
步骤4.2、利用智能网联车辆感知数据,计算路侧雷视融合感知轨迹数据集中多车相对定位中误差mr为24.76cm。
Δd(i)=dc(i)-dr(i)
其中,(xr(i),yr(i))为i时刻路侧感知单元采集的经过感知范围的智能网联车辆的坐标点,(xrn(i),yrn(i))为i时刻路侧感知单元采集距离经过的智能网联车辆周围车辆的坐标点,(xcn(i),ycn(i))为所经过的智能网联车辆采集的i时刻其周围车辆的相对坐标,dr(i)为i时刻路侧感知单元采集的所经过的智能网联车辆与其周围车辆的相对距离,dc(i)为i时刻所经过的智能网联车辆感知其周围车辆的相对距离,Δd(i)为i时刻路侧感知单元与智能网联车辆感知其周围车辆相对距离的差值,为其周围车辆相对距离差值的平均值,εri为i时刻多车相对定位误差,n为采样点个数。
步骤4.3、根据实际交通应用场景特征及团体标准《基于车路协同的高等级自动驾驶数据交互内容》要求,设置允许定位误差阈值α=50cm、β=40cm,根据以上计算结果可知路侧雷视融合感知单元的定位精度满足场景精度要求。分析距离路侧感知单元的距离、车辆驾驶行为等因素对路侧感知数据定位误差的影响,结果如图5a、图5b所示。实验测评路侧雷视融合感知单元在车辆发生换道及距离设施较远时易产生较大误差,应加强对这部分数据的清洗。
综上所述,本发明面向智能网联交通环境下路侧感知单元数据质量的常态、实时监测及评价,提出一种智慧公路路侧感知单元数据质量监测及评价系统,包括:同步采集所测评的路侧感知单元数据与智能网联车辆数据,构成路侧感知轨迹数据集及智能网联车辆定位及感知数据;计算路侧感知轨迹数据集中的各条轨迹与智能网联车辆轨迹的相似度,从路侧感知轨迹数据集中筛选匹配智能网联车辆对应的轨迹数据,形成测评轨迹对;对齐路侧感知单元系统时间与智能网联车辆系统时间,并对智能网联车辆数据进行重采样实现时间同步;计算路侧感知单元数据的绝对定位误差与相对定位误差,评价路侧感知数据质量。本发明利用智能网联车辆数据特征提出了一种可快速实现轨迹匹配的方法及全面反映场景需求的评价指标,面向未来智能网联环境下数据质量的常态化评价及数据应用提供了新的视角,降低了数据测评的人工与经济成本;本发明还可为为路侧感知单元全生命周期下状态监测提供指导,确保路侧感知数据可有效支撑系统运行,保障路侧感知单元的使用性能和效果。
Claims (10)
1.一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,包括以下步骤:
S1、同步采集所监测的路侧感知单元数据与智能网联车辆数据,得到路侧感知轨迹数据集、经过相应路段的智能网联车辆定位及感知数据;
S2、计算路侧感知轨迹数据集中各条轨迹与经过相应路段的智能网联车辆轨迹的相似度,从路侧感知轨迹数据集中筛选出与智能网联车辆相匹配的对应轨迹数据,形成测评轨迹数据对;
S3、基于测评轨迹数据对,进一步对齐路侧感知单元系统时间与智能网联车辆系统时间,并对智能网联车辆数据进行插值重采样实现时间同步;
S4、根据测评轨迹数据对以及时间同步后的智能网联车辆数据,通过计算路侧感知单元数据的绝对定位误差与相对定位误差,完成对路侧感知单元数据质量的监测。
2.根据权利要求1所述的一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,所述智能网联车辆安装有定位设备、感知传感器和通信模块,所述智能网联车辆数据包括但不限于采样时间、车辆自身定位、周围车辆的相对位置;
所述路侧感知单元数据包括但不限于采样时间、目标定位坐标、目标速度;
所述智能网联车辆的感知精度不低于路侧感知单元的精度,且路侧感知单元定位坐标系与智能网联车辆定位坐标系相同。
3.根据权利要求2所述的一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,所述步骤S1具体包括以下步骤:
S11、在所监测的路侧感知单元的感知范围内,智能网联车辆跟随车流正常行驶,并采集获取自身定位及感知数据;与此同时,路侧感知单元同步进行数据采集,获取感知范围内目标车辆ID及定位数据;
S12、提取路侧感知单元数据,检索出属于同一ID的车辆运动信息并按时间排序构成轨迹,整理形成路侧感知轨迹数据集R={R1,R2,…,Rj,…,RM},其中,为车辆j的轨迹,为a时刻车辆j的定位坐标,A为路侧感知单元的采集终点时刻;
4.根据权利要求3所述的一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,所述步骤S2具体包括以下步骤:
S21、计算路侧感知轨迹数据集中各条轨迹与智能网联车辆轨迹整体LCSS相似度;
S22、提取路侧感知轨迹数据与智能网联车辆轨迹各采样点周围车辆相对位置序列,并计算对应相对位置序列LCSS相似度;
S23、利用RPS-LCSS相似度算法计算各轨迹对相似度;
S24、选择路侧感知轨迹数据集中RPS-LCSS相似度最大的轨迹,以作为智能网联车辆轨迹对应的匹配轨迹。
5.根据权利要求4所述的一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,所述步骤S21的具体过程为:
对采集得到的路侧感知轨迹数据集R={R1,R2,…,RM},计算其中各条轨迹Rj与智能网联车轨迹C的最长公共子序列及其LCSS相似度DL(Rj,C),计算公式如下:
6.根据权利要求5所述的一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,所述步骤S22的具体过程为:对智能网联车辆轨迹C,若采样点i周围存在L个车辆,则按照车辆相对距离从小到大的顺序构成相对坐标序列ci={(xk,yk)|k=0,1…,L},其中,(xk,yk)为距离智能网联车辆采样点i第k个相近车辆的相对坐标;
对路侧感知轨迹数据集中车辆轨迹Rj,若采样点i周围存在Q个车辆,则按照车辆相对距离从小到大的顺序构成相对坐标序列rij={(xl,yl)|l=0,1…,Q},其中,(xl,yl)为距离车辆Rj采样点i第l个相近车辆的相对坐标,由此,计算智能网联车辆C和路侧感知轨迹数据集中轨迹Rj对应采样点i的相对位置序列ci,rij的LCSS相似度为:
7.根据权利要求6所述的一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,所述步骤S23的具体过程为:计算路侧感知轨迹数据中各条轨迹Rj与智能网联车辆轨迹C整体相似度DL(Rj,C)、以及各对应采样点周围车辆相对位置序列相似度平均值之和,以作为两轨迹的RPS-LCSS相似度D(Rj,C):
其中,DL(Rj,C)为轨迹Rj与C的整体LCSS相似度,DL(ci,rij)为轨迹公共子序列中点i周围车辆相对位置序列ci与rij的LCSS相似度,T为轨迹对中最长公共子序列长度;
所述步骤S24的具体过程为:选择路侧感知轨迹数据集R中RPS-LCSS相似度最大的路侧轨迹Rz,以作为智能网联车辆轨迹的匹配轨迹:
由此确定出匹配路侧感知数据中智能网联车辆对应的轨迹数据。
8.根据权利要求4所述的一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,所述步骤S3具体包括以下步骤:
S31、求解系统时间对齐调整量,平移调整智能网联车辆数据时间,对平移时间后的智能网联车辆轨迹数据与路侧感知轨迹数据,采用相同时长及时间间隔进行三次样条插值,计算对应时刻车辆数据坐标与路侧感知数据坐标点距离,求解使得各对应点坐标平均距离最小的最佳系统时间对齐调整量ta:
ta=argminL(t)
其中,(xr(i),yr(i))为i时刻路侧感知轨迹数据对应采样坐标点,(xc(i),yc(i))为i时刻智能网联车辆轨迹对应采样坐标点,t为车端数据时间平移量,ta为最佳系统时间对齐调整量,M为插值后数据点个数;
S32、调整智能网联车辆数据时间实现时间对齐:根据步骤S31中得到的最佳系统时间对齐调整量ta,调整智能网联车辆的数据时间,以与路侧感知单元的系统时间进行对齐;
S33、智能网联车辆定位及感知数据与路侧感知轨迹数据时间同步:根据路侧感知轨迹数据采样时刻,使用三次样条曲线模型对智能网联车辆定位及感知数据进行插值重采样,与路侧感知轨迹数据采样时间实现同步。
9.根据权利要求8所述的一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,所述步骤S4具体包括以下步骤:
S41、计算路侧感知轨迹数据的单车绝对定位中误差ma;
S42、计算路侧感知轨迹数据的多车相对定位中误差mr;
S43、根据实际交通应用场景特征及需求,设置允许绝对定位误差阈值α、相对定位误差阈值β,根据单车绝对定位中误差ma、多车相对定位中误差mr分别与对应阈值的相对大小关系,确定出定位误差是否满足精度要求,完成对路侧感知单元数据质量的监测。
10.根据权利要求9所述的一种智能网联环境下路侧感知单元数据质量监测方法,其特征在于,所述步骤S41的具体过程为:利用智能网联车辆定位数据,计算路侧感知轨迹数据的单车绝对定位中误差ma:
其中,(xr(i),yr(i))为i时刻路侧感知轨迹数据定位坐标,(xc(i),yc(i))为i时刻智能网联车辆轨迹对应采样点定位坐标,(Δxi,Δyi)为i时刻路侧感知单元与智能网联车辆定位的相对位置坐标,εai为i时刻绝对定位误差,n为采样点个数;
所述步骤S42的具体过程为:利用智能网联车辆感知数据,计算路侧感知轨迹数据的多车相对定位中误差mr:
Δd(i)=dc(i)-dr(i)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111465443.4A CN114357019A (zh) | 2021-12-03 | 2021-12-03 | 一种智能网联环境下路侧感知单元数据质量监测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111465443.4A CN114357019A (zh) | 2021-12-03 | 2021-12-03 | 一种智能网联环境下路侧感知单元数据质量监测方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114357019A true CN114357019A (zh) | 2022-04-15 |
Family
ID=81097164
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111465443.4A Pending CN114357019A (zh) | 2021-12-03 | 2021-12-03 | 一种智能网联环境下路侧感知单元数据质量监测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114357019A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114913352A (zh) * | 2022-05-05 | 2022-08-16 | 山东高速建设管理集团有限公司 | 基于联合相似度匹配的多源信息时空配准方法及系统 |
CN115166721A (zh) * | 2022-09-05 | 2022-10-11 | 湖南众天云科技有限公司 | 路侧感知设备中雷达与gnss信息标定融合方法及装置 |
CN115188187A (zh) * | 2022-07-05 | 2022-10-14 | 浙江嘉兴数字城市实验室有限公司 | 一种基于车路协同的路侧感知数据质量监测系统及方法 |
CN115358530A (zh) * | 2022-07-26 | 2022-11-18 | 上海交通大学 | 一种车路协同感知路侧测试数据质量评价方法 |
CN115410369A (zh) * | 2022-08-30 | 2022-11-29 | 合肥工业大学 | 一种实时道路通行速度区间构建方法 |
CN115994934A (zh) * | 2023-03-16 | 2023-04-21 | 福思(杭州)智能科技有限公司 | 数据时间对齐方法、装置以及域控制器 |
CN116346862A (zh) * | 2023-05-26 | 2023-06-27 | 斯润天朗(无锡)科技有限公司 | 用于智能网联汽车的传感器共享方法及装置 |
-
2021
- 2021-12-03 CN CN202111465443.4A patent/CN114357019A/zh active Pending
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114913352A (zh) * | 2022-05-05 | 2022-08-16 | 山东高速建设管理集团有限公司 | 基于联合相似度匹配的多源信息时空配准方法及系统 |
CN114913352B (zh) * | 2022-05-05 | 2023-05-26 | 山东高速建设管理集团有限公司 | 基于联合相似度匹配的多源信息时空配准方法及系统 |
CN115188187A (zh) * | 2022-07-05 | 2022-10-14 | 浙江嘉兴数字城市实验室有限公司 | 一种基于车路协同的路侧感知数据质量监测系统及方法 |
CN115358530A (zh) * | 2022-07-26 | 2022-11-18 | 上海交通大学 | 一种车路协同感知路侧测试数据质量评价方法 |
CN115410369A (zh) * | 2022-08-30 | 2022-11-29 | 合肥工业大学 | 一种实时道路通行速度区间构建方法 |
CN115410369B (zh) * | 2022-08-30 | 2024-02-20 | 合肥工业大学 | 一种实时道路通行速度区间构建方法 |
CN115166721A (zh) * | 2022-09-05 | 2022-10-11 | 湖南众天云科技有限公司 | 路侧感知设备中雷达与gnss信息标定融合方法及装置 |
CN115994934A (zh) * | 2023-03-16 | 2023-04-21 | 福思(杭州)智能科技有限公司 | 数据时间对齐方法、装置以及域控制器 |
CN116346862A (zh) * | 2023-05-26 | 2023-06-27 | 斯润天朗(无锡)科技有限公司 | 用于智能网联汽车的传感器共享方法及装置 |
CN116346862B (zh) * | 2023-05-26 | 2023-10-24 | 斯润天朗(无锡)科技有限公司 | 用于智能网联汽车的传感器共享方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114357019A (zh) | 一种智能网联环境下路侧感知单元数据质量监测方法 | |
WO2022206978A1 (zh) | 一种基于车载定位装置的路侧毫米波雷达校准方法 | |
CN109544932A (zh) | 一种基于出租车gps数据与卡口数据融合的城市路网流量估计方法 | |
CN109272756B (zh) | 一种信控交叉口排队长度估计方法 | |
CN109084786B (zh) | 一种地图数据的处理方法 | |
Rogers et al. | Mining GPS data to augment road models | |
CN111210612B (zh) | 基于公交gps数据与站点信息提取公交线路轨迹的方法 | |
CN107885795B (zh) | 一种卡口数据的数据校验方法、系统和装置 | |
CN108960060A (zh) | 一种无人驾驶车辆路面纹理识别系统及方法 | |
CN111275960A (zh) | 一种交通路况分析方法、系统及摄像机 | |
CN103456172A (zh) | 一种基于视频的交通参数测量方法 | |
US20220410949A1 (en) | Method for in-situ and real-time collection and processing of geometric parameters of railway lines | |
CN103837087A (zh) | 基于主动形状模型的受电弓自动检测方法 | |
CN110599853A (zh) | 驾校智能教学系统及方法 | |
CN114648231A (zh) | 一种车路协同路侧数据质量评价方法 | |
CN111619589B (zh) | 一种复杂环境的自动驾驶控制方法 | |
CN101131796A (zh) | 一种道路交通参数检测装置及检测方法 | |
Liu et al. | A car-following data collecting method based on binocular stereo vision | |
CN111524394A (zh) | 提升机坪综合航迹监视数据精度的方法、装置及系统 | |
CN112598932A (zh) | 一种基于车路协同技术的汽车防碰撞预警模型 | |
CN110675631A (zh) | 一种交通流溯源分析方法及系统 | |
Shao et al. | PTZ camera-based image processing for automatic crack size measurement in expressways | |
CN117198057A (zh) | 一种面向路侧感知轨迹数据质量检评的实验方法及系统 | |
CN116448126A (zh) | 一种导航电子地图数据生成自动补偿校验系统 | |
CN116129631A (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 |