System.ArgumentOutOfRangeException: 索引和长度必须引用该字符串内的位置。 参数名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind()
【技术实现步骤摘要】
本专利技术涉及智能交通和电子不停车收费,并且更具体地,涉及一种rsu安装参数单点标定方法、系统及存储介质。
技术介绍
1、具备doa定位功能的rsu在安装时需要对安装参数和坐标关系进行标定,标定方法有很多种。最简单的方法是测量出rsu的安装角和安装高度,由软件自动生成一组安装参数,不需要建立车道坐标系,不需要在地面画点测量标定点位置,不需要用obu进行现场标定。但该方法要求rsu安装在车道正中心,且阵列天线的正前方必须正对来车方向,否则就会有误差。在工程应用中,rsu安装角好测量,但rsu相对竖直方向的旋转角很难控制,也非常难测量,导致定位结果会有较大误差。
2、现有技术一:申请号为201410759415.7(rsu安装参数标定方法)给出了一种rsu安装参数标定方法,在车道平面选定至少三个不在同一直线的标定点,得到九个方程,解出九个方程便能确定rsu的安装参数。
3、现有技术二:申请号为201710543680.5(一种路侧单元天线的标定方法及装置)给出了一种路侧单元天线的标定方法,该方法选取一个基准坐标系,通过rsu坐标系与基准坐标系的第一转换矩阵和车道坐标系与基准坐标系的第二转换矩阵,结合测量所得的安装高度得到第三转换矩阵,确定坐标系的关系。
4、现有技术三:申请号为202111600270.2(一种rsu标定方法、装置、电子设备和系统)给出了一种rsu的标定方法,该系统由具备获取经纬度功能的待标定rsu、辅助rsu和标定obu组成,标定obu发射标定信号,待标定rsu和辅助rsu接收标
5、现有技术一需要至少三个不在同一直线上的标定点,且要解九个方程,求解过程非常复杂。现有技术二需要选取一个基准坐标系,还需要人工测量rsu的安装高度,测量高度需要先找投影点再测高度,测量结果有一定误差。现有技术三需要几个设备都具备精确的北斗或gps定位功能,在有顶棚的收费站不方便实施。
技术实现思路
1、为了解决现有技术的问题,本专利技术提供一种rsu安装参数单点标定方法、系统及存储介质。
2、根据本专利技术的一个方面,提供了一种rsu安装参数单点标定方法,包括:
3、通过加速度传感器获取阵列天线所在路侧单元坐标系的三个坐标轴与车道平面的夹角;
4、通过夹角和待定高度,建立车道平面在路侧单元坐标系下的平面方程;
5、在车道平面选取一个除投影点以外的标定点,将车载单元放在标定点发射微波信号;
6、路侧单元接收到微波信号后,通过doa算法计算出标定点的方向角;
7、通过方向角和标定点的坐标,再结合建立的平面方程,求解出路侧单元的安装高度,并确定车道平面在路侧单元坐标系下的平面方程;
8、基于夹角,建立路侧单元坐标系与车道坐标系的旋转矩阵;其中,旋转矩阵的三个转动角中有两个跟加速度传感器获取的夹角有关,只有绕竖直z轴的旋转角为待求量;
9、将标定点分别在路侧单元坐标系和车道坐标系下的坐标代入到坐标系变换关系式中,求解出旋转矩阵中绕竖直z轴的旋转角。
10、可选地,所述通过加速度传感器获取阵列天线所在路侧单元坐标系的三个坐标轴与车道平面的夹角之前,还包括:
11、定义距离地面预设高度的平面为车道平面,以路侧单元在车道平面的竖直向下投影点为原点建立车道坐标系x1y1z;
12、以路侧单元中的阵列天线建立路侧单元坐标系x"y"z";在x"y"z"坐标系原点r处建立坐标系xyz,使x、y轴分别与x1y1z坐标系的x1、y1轴平行;由此可得,x"y"z"坐标系与xyz坐标系只存在旋转关系,旋转关系用三个坐标轴的转动角α、β、γ来表示;xyz坐标系与x1y1z坐标系只在z轴上存在平移关系,平移关系用路侧单元到车道平面的高度h表示。
13、可选地,所述通过加速度传感器获取阵列天线所在路侧单元坐标系的三个坐标轴与车道平面的夹角,包括:
14、通过加速度传感器读取路侧单元中的阵列天线三个方向的重力加速度分量accx、accy、accz;
15、基于三个方向的重力加速度分量accx、accy、accz,通过以下公式计算路侧单元坐标系x"y"z"的三个坐标轴与车道平面的夹角:
16、
17、
18、
19、式中,θx、θy、θz分别为路侧单元坐标系x"y"y"的三个坐标轴与车道平面的夹角,定义水平面上方的夹角为正向。
20、可选地,所述通过夹角和待定高度,建立车道平面在路侧单元坐标系下的平面方程,包括:
21、设x1oy1平面在路侧单元坐标系x"y"z"下的截距式平面方程为:
22、
23、其中,x1oy1平面为由车道坐标系x1y1z中的x1坐标轴和y1坐标轴与路侧单元在车道平面的竖直向下投影点o构成的平面;a、b、c分别为车道平面与路侧单元坐标系x"y"z"的交点;x、y、z分别为p点在路侧单元坐标系x"y"z"下的三个坐标;p点为标定车载单元所在位置,即标定点;
24、由于路侧单元坐标系原点距x1oy1平面的高度为h,且θx、θy、θz为路侧单元坐标系的x"y"z"坐标轴与xry平面的夹角,由此可得:
25、
26、从而,得到车道平面在路侧单元坐标系下的平面方程为:
27、sin(θx)x+sin(θy)y+sin(θz)z=-h
28、其中,xry平面为坐标系xyz中的x坐标轴和y坐标轴与x"y"z"坐标系的原点r构成的平面;x、y、z分别为p点在路侧单元坐标系x"y"z"下的三个坐标,p点为标定车载单元所在位置。
29、可选地,所述通过方向角和标定点的坐标,再结合建立的平面方程,求解出路侧单元的安装高度,并确定车道平面在路侧单元坐标系下的平面方程,包括:
30、通过方向角和标定点的坐标,确定标定点在路侧单元坐标系下的坐标为:
31、
32、式中,θ1、θ2为通过doa算法计算得到的标定点p的方向角,rp为标定点p到x"y"z"坐标系原点r的距离;
33、将标定点在路侧单元坐标系下的坐标代入建立的平面方程,得到:
34、
35、其中,
36、令
37、
38、代入平面方程,化简后得到路侧单元的安装高度h的计算式:
39、
40、式中,h为路侧单元的安装高度;标定点p在坐标系xyz下的坐标为(xp,yp,-h);
41、将通过doa算法计算出的标定点p的方向角和标定点p在坐标系xyz下的坐标代入路侧单元的安装高度h的计算式,得到路侧单元的安装高度h,之后将安装高度h代入车道平面在路侧单元坐标系下的平面方程。
42、可选地,所述基于夹角,建立路侧单元坐标系与车道坐标系的旋转矩本文档来自技高网...
【技术保护点】
1.一种RSU安装参数单点标定方法,其特征在于,包括:
2.根据权利要求1所述的方法,其特征在于,所述通过加速度传感器获取阵列天线所在路侧单元坐标系的三个坐标轴与车道平面的夹角之前,还包括:
3.根据权利要求2所述的方法,其特征在于,所述通过加速度传感器获取阵列天线所在路侧单元坐标系的三个坐标轴与车道平面的夹角,包括:
4.根据权利要求3所述的方法,其特征在于,所述通过夹角和待定高度,建立车道平面在路侧单元坐标系下的平面方程,包括:
5.根据权利要求4所述的方法,其特征在于,所述通过方向角和标定点的坐标,再结合建立的平面方程,求解出路侧单元的安装高度,并确定车道平面在路侧单元坐标系下的平面方程,包括:
6.根据权利要求5所述的方法,其特征在于,所述基于夹角,建立路侧单元坐标系与车道坐标系的旋转矩阵,包括:
7.根据权利要求6所述的方法,其特征在于,所述将标定点分别在路侧单元坐标系和车道坐标系下的坐标代入到坐标系变换关系式中,求解出旋转矩阵中绕竖直Z轴的旋转角,包括:
8.一种RSU安装参数单点标定
9.一种计算机可读存储介质,其特征在于,所述存储介质存储有计算机程序,所述计算机程序用于执行上述权利要求1-7任一所述的方法。
10.一种电子设备,其特征在于,所述电子设备包括:
...【技术特征摘要】
1.一种rsu安装参数单点标定方法,其特征在于,包括:
2.根据权利要求1所述的方法,其特征在于,所述通过加速度传感器获取阵列天线所在路侧单元坐标系的三个坐标轴与车道平面的夹角之前,还包括:
3.根据权利要求2所述的方法,其特征在于,所述通过加速度传感器获取阵列天线所在路侧单元坐标系的三个坐标轴与车道平面的夹角,包括:
4.根据权利要求3所述的方法,其特征在于,所述通过夹角和待定高度,建立车道平面在路侧单元坐标系下的平面方程,包括:
5.根据权利要求4所述的方法,其特征在于,所述通过方向角和标定点的坐标,再结合建立的平面方程,求解出路侧单元的安装高度,并确定车道平面在路侧单元坐标系下的平面方程,包括:
6.根...
【专利技术属性】
技术研发人员:杨胜尧,刘金福,王开然,崔进龙,高志国,吴俊辉,
申请(专利权)人:北京云星宇交通科技股份有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。