具体实施方式
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
图1为本申请实施例提供的应用场景示意图,参见图1,可移动平台11上搭载有一个或多个雷达12。例如,安装于诸如车前的雷达12可以用于探测车辆前方的情况,实现跟车、预警等功能,安装于诸如车后的雷达12可以用于探测车辆后方的情况,实现倒车、泊车指示等功能。雷达12可以设置于可移动平台11的任意合适位置,用于获取雷达的周围环境信息。
其中,可移动平台11可为车辆、无人机、机器人等。雷达12可为毫米波雷达、微波雷达、激光雷达等,本实施例中并不限制。
首先采用具体的实施例对本申请的获取雷达位置的方法进行说明。
图2为本申请实施例提供的获取雷达位置的方法的流程图一。本实施例的执行主体可为获取雷达位置的装置,获取雷达位置的装置为雷达的全部或部分,或者,获取雷达位置的装置为可移动平台的全部或部分,参见图2,本实施例的方法包括:
步骤S201、通过雷达对周围环境进行采样,以得到雷达的采集数据。
在一种方式中,雷达可向周围环境发出探测信号,探测信号被周围环境中的物体反射后产生回波信号,其中,雷达的采集数据可为回波信号,还可为对回波信号进行采样后得到的数据,比如雷达的采集数据可为周围环境的点云数据。
步骤S202、根据雷达的采集数据,获取雷达的周围环境信息。
其中,雷达的周围环境信息可包括雷达所在的地面,此外,雷达的周围环境信息还可以其它的环境信息,例如树木、墙壁等遮挡物信息,本实施例中并不限制。
在雷达的周围环境信息包括雷达所在的地面的情况下,根据雷达的采集数据,获取雷达的周围环境信息,可包括:根据雷达的采集数据,获取雷达所在的地面的信息。本实施例中,雷达所在的地面可为雷达所在的可移动平台所运行的地面。
可选地,可根据雷达的采集数据,采用随机样本一致性(random sampleconsensus,简称RANSAC)算法获取雷达的周围环境信息,使得本实施例中的获取雷达位置的方法实现效率高,运算速度快,可实现高效快速的雷达位置的获取。
步骤S203、根据雷达的周围环境信息,确定雷达相对于周围环境的位置信息。
其中,若雷达的周围环境信息为雷达所在的地面的信息,则可根据雷达的所在的地面的信息,确定雷达相对于地面的位置信息。雷达相对于地面的一组位置信息可包括如下中的至少一项:雷达相对于地面的俯仰角、翻滚角、高度。
可以理解的是,可通过雷达实时的对周围环境进行采样,因此,可得到多组雷达的采集数据,相应地,可得到雷达相对于周围环境的多组位置信息。
可选地,在得到雷达相对于周围环境的多组位置信息之后,还包括:对雷达相对于周围环境的多组位置信息进行后处理,后处理用于滤除多组位置信息中的异常位置信息。其中,后处理可为滤波处理。滤波处理可为以下中的任一个:中值滤波处理或均值滤波处理或加权平均滤波处理。
本实施例中可通过雷达自身采集的周围环境数据获取雷达相对于周围环境的位置信息,无需通过双目相机或者其它装置相对有地面的位置信息转换成雷达相对于地面的位置信息,避免了通过双目相机或者其它装置相对于地面的位置信息转换成雷达相对于地面的位置信息时误差的引入,获取雷达相对于地面的位置信息的效率高且准确。
图3为本申请实施例提供的获取雷达位置的方法的流程图二。参见图3,本实施例的方法包括:
步骤S301、通过雷达对周围环境进行采样,以得到雷达的采集数据。
其中,该步骤的具体实现参见图2所示的实施例中的步骤S201的具体实现,此处不再赘述。
步骤S302、根据雷达的采集数据,获取雷达所在的地面的方程。
其中,雷达的采集数据的含义同图2所示的实施例中的阐述,在此不赘述;进一步地,雷达所在的地面的方程即为图2所示的实施例中的雷达所在的地面的信息。
可选地,根据雷达的采集数据,采用RANSAC算法获取雷达所在的地面的方程。
其中,采用RANSAC算法获取雷达所在的地面的方程,具体可为:
在雷达采集的数据为周围环境的点云数据时,周围环境的点云数据中的每个数据可为一个三维坐标,每个三维坐标对应一个点。
(1)在周围环境的点云数据组成的集合{P}中随机抽取N个数据,根据N个数据拟合平面1:A1x+B1y+C1z+D1=0。获取N个数据所对应的点距离平面1的距离,统计N个数据所对应的点中与平面1的距离小于预设阈值的点(也可称为内值点(inliers))的数目E1。
(2)按照步骤1的方法重复执行预设次数,获取对应的内值点最多的一次拟合平面过程所得到的拟合平面A0x+B0y+C0z+D0=0。
(3)获取集合{P}中对应的点与平面A0x+B0y+C0z+D0=0之间的距离小于预设阈值的所有预选数据,根据所有预选数据重新拟合平面:得到平面Ax+By+Cz+D=0,平面Ax+By+Cz+D=0即为雷达所在的地面的平面方程。
在雷达所在的地面方程为Ax+By+Cz+D=0时,A为与地面坐标系的X轴相关的系数,B为与地面坐标系的Y轴相关的系数,C为与地面坐标系的Z轴相关的系数,D为常数项。该平面方程指示地面与三坐标轴的交点分别为S(-D/A,0,0),T(0,-D/B,0),U(0,0,-D/C)。其中,若C≤0,则地面坐标系的Z轴的朝向向下;若C>0,则地面坐标系的Z轴的朝向向上。
步骤S303、根据雷达所在的地面的平面方程的系数,获取雷达相对于地面的位置信息。
在一种方案中,根据雷达所在的地面的平面方程的系数,获取雷达相对于该地面的信息可通过步骤a1~a2实现:
a1、对雷达所在的地面的平面方程的系数进行预处理,得到预处理后的系数。
可选地,对雷达所在的地面的平面方程的系数进行预处理,得到预处理后的系数,包括:对该平面方程的系数进行归一化处理,得到归一化系数,归一化系数为预处理后的系数。
其中,若地面坐标系的Z轴的朝向向下,对该平面方程的系数进行归一化处理,得到归一化系数包括:对平面方程的系数进行归一化处理,得到归一化处理后的系数,并获取归一化处理后的系数的相反数,归一化处理后的系数的相反数为归一化系数;或者,获取平面方程的系数的相反数,并对平面方程的系数的相反数进行归一化处理,得到归一化系数。可以理解的是,可以对该平面方程的所有系数或者部分系数进行归一化处理,得到预处理后的系数。
在一种方式中,可通过如下公式对该平面方程的与X轴相关的系数A进行归一化处理,得到第一系数A1:
若地面坐标系的Z轴的朝向向上:A1=A/sqrt(A2+B2+C2);
若地面坐标系的Z轴的朝向向下:A1=-A/sqrt(A2+B2+C2)。
其中,sqrt()表示平方根计算函数。
在一种方式中,可通过如下公式对该平面方程的与Y轴相关的系数B进行归一化处理,得到第二系数B1:
若地面坐标系的Z轴的朝向向上:B1=B/sqrt(A2+B2+C2);
若地面坐标系的Z轴的朝向向下:B1=-B/sqrt(A2+B2+C2)。
在一种方式中,可通过如下公式对该平面方程的与Z轴相关的系数C进行归一化处理,得到第三系数C1:
若地面坐标系的Z轴的朝向向上:C1=C/sqrt(A2+B2+C2);
若地面坐标系的Z轴的朝向向下:C1=-C/sqrt(A2+B2+C2)。
在一种方式中,可通过如下公式对该平面方程的常数项D进行归一化处理,得到第四系数D1:
若地面坐标系的Z轴的朝向向上:D1=D/sqrt(A2+B2+C2);
若地面坐标系的Z轴的朝向向下:D1=-D/sqrt(A2+B2+C2)。
a2、根据预处理后的系数,获取雷达相对于该地面的信息。
其中,预处理后的系数可包括:雷达所在的地面的平面方程中与地面坐标系的X轴相关的系数被预处理后的第一系数和/或该平面方程中与地面坐标系的Y轴相关的系数被预处理后的第二系数和/或与地面坐标系的Z轴相关的系数被预处理后的第三系数和/或该平面方程中常数项被预处理后的第四系数。
(1)若预处理后的系数包括:第一系数,则获取雷达相对于该地面的信息可包括:根据第一系数,获取雷达相对于地面的俯仰角。
在一种方式中,可通过如下公式获取雷达相对于地面的俯仰角P:
P=arccos(A1)*180°/π-90°;
其中,arccos()表示反余弦函数,A1为第一系数。
(2)若预处理后的系数包括第二系数和第三系数,则获取雷达相对于地面的位置信息可包括:根据第二系数和第三系数,获取雷达相对于地面的翻滚角。
在一种方式中,可通过如下公式计算雷达相对于地面的翻滚角R:
R=-arccos(B1/sqrt(B12+C12))×180°/π+90°;
其中,B1为第二系数,C1为第三系数。
(3)若预处理后的系数包括第四系数,则获取雷达相对于地面的位置信息,包括:根据第四系数,获取雷达相对于地面的高度。
在一种方式中,可通过如下公式获取雷达相对于地面的高度H:
H=|D1|。
其中,D1为第四系数。
相应地,在得到雷达相对于地面的多组位置信息之后,还包括:对雷达相对于地面的多组位置信息进行后处理,后处理用于滤除多组位置信息中的异常位置信息。其中,后处理的含义参照图2所示的实施例中的阐述,此处不再赘述。
其中,雷达相对于地面的位置信息可用于获取地面的信息,比如地面的坡度,车辆转弯时车辆两侧地面的高度差,还可用于获取在该地面上的其它物体的高度等等。
本实施例获取雷达位置的方法使得获取雷达相对于地面的位置信息的效率高且准确。
以上对本申请所涉及的获取雷达位置的方法进行了说明,下面对本申请实施例涉及的装置进行说明。
图4为本申请实施例提供的雷达的结构示意图,如图4所示,本实施例的雷达包括:数据采集装置41和处理器42。
数据采集装置41,用于对周围环境进行采样,得到所述雷达的采集数据;处理器,所述处理器42与所述数据采集装置41连接,用于执行如下操作:从所述数据采集装置获取所述雷达的采集数据;根据所述雷达的采集数据,获取所述雷达的周围环境信息;根据所述周围环境信息,确定所述雷达相对于所述周围环境的位置信息。
可选地,所述周围环境包括所述雷达所在的地面,所述处理器42在用于执行根据所述雷达的采集数据,获取所述雷达的周围环境信息时,具体用于:根据所述雷达的采集数据,获取所述雷达所在的地面的信息。
可选地,所述地面的信息包括所述地面的平面方程。
可选地,所述处理器42在用于执行根据所述周围环境信息,确定所述雷达相对于所述周围环境的位置信息的操作时,具体用于:根据所述地面的平面方程的系数,获取所述雷达相对于所述地面的位置信息。
可选地,所述处理器42在用于执行根据所述地面的平面方程的系数,获取所述雷达相对于所述地面的位置信息的操作时,具体用于:对所述地面的平面方程的系数进行预处理,得到预处理后的系数;根据所述预处理后的系数,获取所述雷达相对于所述地面的位置信息。
可选地,所述处理器42在用于执行对所述地面的平面方程的系数进行预处理,得到预处理后的系数的操作时,具体用于:对所述平面方程的系数进行归一化处理,得到归一化系数,所述归一化系数为所述预处理后的系数。
可选地,所述处理器42在用于执行对所述平面方程的系数进行归一化处理,得到归一化系数的操作时,具体用于:对所述平面方程的系数进行归一化处理,得到归一化处理后的系数,并获取归一化处理后的系数的相反数,归一化处理后的系数的相反数为所述归一化系数;或者,获取所述平面方程的系数的相反数,并对所述平面方程的系数的相反数进行归一化处理,得到所述归一化系数。
可选地,所述预处理后的系数包括:所述平面方程中与地面坐标系的X轴相关的系数被预处理后的第一系数;所述处理器42在用于执行获取所述雷达相对于所述地面的位置信息的操作时,具体用于:根据所述第一系数,获取所述雷达相对于所述地面的俯仰角。
可选地,所述预处理后的系数包括:所述平面方程中与地面坐标系的Y轴相关的系数被预处理后的第二系数和与所述地面坐标系的Z轴相关的系数被预处理后的第三系数;所述处理器42在用于执行获取所述雷达相对于所述地面的位置信息的操作时,具体用于:根据所述第二系数和所述第三系数,获取所述雷达相对于所述地面的翻滚角。
可选地,所述根据所述预处理后的系数包括:所述平面方程中常数项被预处理后的第四系数;所述处理器42在用于执行获取所述雷达相对于所述地面的位置信息的操作时,具体用于:根据所述第四系数,获取所述雷达相对于所述地面的高度。
可选地,所述平面方程为:Ax+By+Cz+D=0;其中,所述A为与地面坐标系的X轴相关的系数,所述B为与所述地面坐标系的Y轴相关的系数,所述C为所述地面坐标系的Z轴相关的系数,所述D为常数项。
可选地,若C≤0,则所述地面坐标系的Z轴的朝向向下;若C>0,则所述地面坐标系的Z轴的朝向向上。
可选地,所述处理器42在用于执行根据所述周围环境信息,确定所述雷达相对于所述周围环境的位置信息之后,还用于执行如下操作:
对所述雷达相对于所述周围环境的多组位置信息进行后处理,所述后处理用于滤除所述多组位置信息中的异常位置信息。
可选地,所述后处理为滤波处理。
可选地,所述滤波处理为以下中的任一个:中值滤波处理或均值滤波处理或加权平均滤波处理。
可选地,所述处理器42在用于执行根据所述雷达的采集数据,获取所述雷达的周围环境信息的操作时,具体用于:根据所述雷达的采集数据,采用随机样本一致性RANSAC算法获取所述雷达的周围环境信息。
可选地,所述雷达相对于所述地面的每个位置信息包括以下至少一项:所述雷达相对于所述地面的俯仰角、翻滚角、高度。
本实施例的雷达,可以用于执行上述各方法实施例中的技术方案,其实现原理和技术效果类似,此处不再赘述。
本申请实施例还提供一种可移动平台,可移动平台上搭载有图4所示的实施例中的雷达。
图5为本申请实施例提供的另一可移动平台的结构示意图,本实施例的可移动平台,包括:雷达51和处理器52。
所述雷达51用于对周围环境进行采样,得到所述雷达51的采集数据;所述处理器52与所述雷达51通信连接,用于执行如下操作:从所述雷达51获取所述雷达51的采集数据;根据所述雷达51的采集数据,获取所述雷达51的周围环境信息;根据所述周围环境信息,确定所述雷达51相对于所述周围环境的位置信息。
可选地,所述周围环境包括所述雷达51所在的地面,所述处理器52在用于执行根据所述雷达51的采集数据,获取所述雷达51的周围环境信息时,具体用于:根据所述雷达51的采集数据,获取所述雷达51所在的地面的信息。
可选地,所述地面的信息包括所述地面的平面方程。
可选地,所述处理器52在用于执行根据所述周围环境信息,确定所述雷达51相对于所述周围环境的位置信息的操作时,具体用于:根据所述地面的平面方程的系数,获取所述雷达51相对于所述地面的位置信息。
可选地,所述处理器52在用于执行根据所述地面的平面方程的系数,获取所述雷达51相对于所述地面的位置信息的操作时,具体用于:对所述地面的平面方程的系数进行预处理,得到预处理后的系数;根据所述预处理后的系数,获取所述雷达51相对于所述地面的位置信息。
可选地,所述处理器52在用于执行对所述地面的平面方程的系数进行预处理,得到预处理后的系数的操作时,具体用于:对所述平面方程的系数进行归一化处理,得到归一化系数,所述归一化系数为所述预处理后的系数。
可选地,所述处理器52在用于执行对所述平面方程的系数进行归一化处理,得到归一化系数的操作时,具体用于:对所述平面方程的系数进行归一化处理,得到归一化处理后的系数,并获取归一化处理后的系数的相反数,归一化处理后的系数的相反数为所述归一化系数;或者,获取所述平面方程的系数的相反数,并对所述平面方程的系数的相反数进行归一化处理,得到所述归一化系数。
可选地,所述预处理后的系数包括:所述平面方程中与地面坐标系的X轴相关的系数被预处理后的第一系数;所述处理器52在用于执行获取所述雷达51相对于所述地面的位置信息的操作时,具体用于:根据所述第一系数,获取所述雷达51相对于所述地面的俯仰角。
可选地,所述预处理后的系数包括:所述平面方程中与地面坐标系的Y轴相关的系数被预处理后的第二系数和与所述地面坐标系的Z轴相关的系数被预处理后的第三系数;所述处理器52在用于执行获取所述雷达51相对于所述地面的位置信息的操作时,具体用于:根据所述第二系数和所述第三系数,获取所述雷达51相对于所述地面的翻滚角。
可选地,所述根据所述预处理后的系数包括:所述平面方程中常数项被预处理后的第四系数;所述处理器52在用于执行获取所述雷达51相对于所述地面的位置信息的操作时,具体用于:根据所述第四系数,获取所述雷达51相对于所述地面的高度。
可选地,所述平面方程为:Ax+By+Cz+D=0;
其中,所述A为与地面坐标系的X轴相关的系数,所述B为与所述地面坐标系的Y轴相关的系数,所述C为所述地面坐标系的Z轴相关的系数,所述D为常数项。
可选地,若C≤0,则所述地面坐标系的Z轴的朝向向下;若C>0,则所述地面坐标系的Z轴的朝向向上。
可选地,所述处理器52在用于执行根据所述周围环境信息,确定所述雷达51相对于所述周围环境的位置信息之后,还用于执行如下操作:对所述雷达51相对于所述周围环境的多组位置信息进行后处理,所述后处理用于滤除所述多组位置信息中的异常位置信息。
可选地,所述后处理为滤波处理。
可选地,所述滤波处理为以下中的任一个:中值滤波处理或均值滤波处理或加权平均滤波处理。
可选地,所述处理器52在用于执行根据所述雷达51的采集数据,获取所述雷达51的周围环境信息的操作时,具体用于:根据所述雷达51的采集数据,采用随机样本一致性RANSAC算法获取所述雷达51的周围环境信息。
可选地,所述雷达51相对于所述地面的每个位置信息包括以下至少一项:所述雷达51相对于所述地面的俯仰角、翻滚角、高度。
本实施例的可移动平台,可以用于执行上述各方法实施例中的技术方案,其实现原理和技术效果类似,此处不再赘述。
本领域普通技术人员可以理解:实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。前述的程序可以存储于一计算机可读取存储介质中。该程序在执行时,执行包括上述各方法实施例的步骤;而前述的存储介质包括:ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。
最后应说明的是:以上各实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述各实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的范围。