一种基于经纬度信息的主车信息坐标系转换方法及系统技术方案

本发明专利技术公开了一种基于经纬度信息的主车信息坐标系转换方法及系统，属于自动驾驶技术领域。该方法包括：采集主车的经纬度信息以及主车视角下的相对运动环境信息；将所述经纬度信息转换为大地坐标系下的轨迹坐标信息，得到主车的绝对轨迹；根据所述主车的绝对轨迹，确定主车的横摆角；基于所述横摆角，将所述主车视角下的相对运动环境信息转换为鸟瞰视角下的绝对运动环境信息。本发明专利技术将主车视角下的相对运动环境信息转换到鸟瞰视角下的绝对运动环境信息，从而能够帮助自动驾驶车辆对视觉采集信息的研究，也方便其与路端设备进行信息融合，加强自动驾驶车辆对于驾驶场景的全局理解。解。解。

【技术实现步骤摘要】
一种基于经纬度信息的主车信息坐标系转换方法及系统


[0001]本专利技术涉及自动驾驶
，特别涉及一种基于经纬度信息的主车信息坐标系转换方法及系统。

技术介绍

[0002]随着汽车保有量的不断提升和自动驾驶技术的不断进步，智能驾驶系统逐渐进入公众视野，其中车端传感器采集的环境信息成为自动驾驶车辆的视觉识别信息的重要来源。目前对于车端环境信息的处理方法还存在一定的缺陷。
[0003]在典型自动驾驶车辆中，车辆视觉传感器往往是与车体固连的，所以车端设备采集到的环境信息往往是在主车视角下，坐标系跟随车辆的运动而不断移动，其主要缺点：一方面难以直接研究交通参与对象的绝对轨迹，另一方面也对驾驶场景的全局理解具有局限性。

技术实现思路

[0004]本专利技术的目的是提供一种基于经纬度信息的主车信息坐标系转换方法及系统，将环境信息从主车视角坐标系下的相对信息转换到鸟瞰视角坐标系下的绝对坐标。
[0005]为实现上述目的，本专利技术提供了如下方案：
[0006]一种基于经纬度信息的主车信息坐标系转换方法，包括：
[0007]采集主车的经纬度信息以及主车视角下的相对运动环境信息；所述主车视角下的相对运动环境信息包括：周边交通参与者在主车视角坐标系下的位置相对坐标和速度相对坐标；
[0008]将所述经纬度信息转换为大地坐标系下的轨迹坐标信息，得到主车的绝对轨迹；所述大地坐标系以正东方向为x轴正方向，以正北方向为y轴正方向，以主车运动轨迹的起始点为原点；
[0009]根据所述主车的绝对轨迹，确定主车的横摆角；
[0010]基于所述横摆角，将所述主车视角下的相对运动环境信息转换为鸟瞰视角下的绝对运动环境信息；所述鸟瞰视角下的绝对运动环境信息包括：周围交通参与者在鸟瞰视角坐标系中的位置绝对坐标和速度绝对坐标。
[0011]可选地，在将所述经纬度信息转换为大地坐标系下的轨迹坐标信息，得到主车的绝对轨迹之后，还包括：
[0012]利用加权线性回归的方法对所述绝对轨迹进行平滑处理。
[0013]可选地，根据所述主车的绝对轨迹，确定主车的横摆角，具体包括：
[0014]根据所述主车的绝对轨迹，确定主车不同方向上的绝对速度；
[0015]基于不同方向上的绝对速度确定主车的横摆角。
[0016]可选地，所述主车不同方向上的绝对速度的计算公式如下：
[0017]；
[0018]其中，为时刻x方向的主车绝对速度，为时刻y方向的主车绝对速度，为第k个数据采集的时间点，，为数据采集长度，为固定的时间间隔，为时刻对应的主车绝对轨迹坐标。
[0019]可选地，基于所述横摆角，通过公式，将所述主车视角下的相对运动环境信息转换为鸟瞰视角下的绝对运动环境信息；
[0020]其中，为横摆角；(,)为周围交通参与者在鸟瞰视角坐标系中的位置绝对坐标；(,)为周围交通参与者在鸟瞰视角坐标系中x轴方向和y轴方向上的速度绝对坐标；(,)为周围交通参与者在主车视角坐标系中的位置相对坐标；(,)为周围交通参与者在主车视角坐标系中的x轴方向和y轴方向上的速度相对坐标；(,)为主车在大地坐标系中的位置绝对坐标；(,)为主车在大地坐标系中x轴方向和y轴方向上的速度绝对坐标。
[0021]可选地，在基于所述横摆角，将所述主车视角下的相对运动环境信息转换为鸟瞰视角下的绝对运动环境信息之后，还包括：
[0022]利用加权线性回归方法对鸟瞰视角下的绝对运动环境信息进行平滑处理。
[0023]本专利技术还提供了一种基于经纬度信息的主车信息坐标系转换系统，包括：
[0024]采集模块，用于采集主车的经纬度信息以及主车视角下的相对运动环境信息；所述主车视角下的相对运动环境信息包括：周边交通参与者在主车视角坐标系下的位置相对坐标和速度相对坐标；
[0025]第一转换模块，用于将所述经纬度信息转换为大地坐标系下的轨迹坐标信息，得到主车的绝对轨迹；所述大地坐标系以正东方向为x轴正方向，以正北方向为y轴正方向，以主车运动轨迹的起始点为原点；
[0026]横摆角确定模块，用于根据所述主车的绝对轨迹，确定主车的横摆角；
[0027]第二转换模块，用于基于所述横摆角，将所述主车视角下的相对运动环境信息转换为鸟瞰视角下的绝对运动环境信息；所述鸟瞰视角下的绝对运动环境信息包括：周围交通参与者在鸟瞰视角坐标系中的位置绝对坐标和速度绝对坐标。
[0028]可选地，所述横摆角确定模块，具体包括：
[0029]绝对速度确定单元，用于根据所述主车的绝对轨迹，确定主车不同方向上的绝对
速度；
[0030]横摆角确定单元，用于基于不同方向上的绝对速度确定主车的横摆角。
[0031]可选地，还包括：
[0032]平滑处理模块，用于利用加权线性回归的方法对所述绝对轨迹以及鸟瞰视角下的绝对运动环境信息进行平滑处理。
[0033]根据本专利技术提供的具体实施例，本专利技术公开了以下技术效果：
[0034]本专利技术通过GPS采集主车的经纬度信息，并根据经纬度信息得到主车轨迹信息，从而得到相关的坐标系转换参数，即主车横摆角，然后基于坐标系转换参数将主车视角下的相对运动环境信息转换到鸟瞰视角下的绝对运动环境信息，从而能够帮助自动驾驶车辆对视觉采集信息的研究，也方便其与路端设备进行信息融合，加强自动驾驶车辆对于驾驶场景的全局理解。
附图说明
[0035]为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
[0036]图1为本专利技术实施例一提供的基于经纬度信息的主车信息坐标系转换方法的流程图；
[0037]图2为本专利技术实施例一提供的局部大地坐标系示意图；
[0038]图3为本专利技术实施例一提供的相对坐标转换为绝对坐标的示意图。
具体实施方式
[0039]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0040]本专利技术的目的是提供一种基于经纬度信息的主车信息坐标系转换方法及系统，将环境信息从主车视角坐标系下的相对信息转换到鸟瞰视角坐标系下的绝对坐标。
[0041]为使本专利技术的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本专利技术作进一步详细的说明。
[0042]实施例一
[0043]定义假设：仅考虑车辆横摆方向转动和车辆在平面内运动，即只考虑车辆在xOy平面的运动，因为车辆的鸟瞰视角本身忽略了运动中车辆绕y轴的俯仰方向的转动运动、绕x轴侧倾方本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于经纬度信息的主车信息坐标系转换方法，其特征在于，包括：采集主车的经纬度信息以及主车视角下的相对运动环境信息；所述主车视角下的相对运动环境信息包括：周边交通参与者在主车视角坐标系下的位置相对坐标和速度相对坐标；将所述经纬度信息转换为大地坐标系下的轨迹坐标信息，得到主车的绝对轨迹；所述大地坐标系以正东方向为x轴正方向，以正北方向为y轴正方向，以主车运动轨迹的起始点为原点；根据所述主车的绝对轨迹，确定主车的横摆角；基于所述横摆角，将所述主车视角下的相对运动环境信息转换为鸟瞰视角下的绝对运动环境信息；所述鸟瞰视角下的绝对运动环境信息包括：周围交通参与者在鸟瞰视角坐标系中的位置绝对坐标和速度绝对坐标。2.根据权利要求1所述的基于经纬度信息的主车信息坐标系转换方法，其特征在于，在将所述经纬度信息转换为大地坐标系下的轨迹坐标信息，得到主车的绝对轨迹之后，还包括：利用加权线性回归的方法对所述绝对轨迹进行平滑处理。3.根据权利要求1所述的基于经纬度信息的主车信息坐标系转换方法，其特征在于，根据所述主车的绝对轨迹，确定主车的横摆角，具体包括：根据所述主车的绝对轨迹，确定主车不同方向上的绝对速度；基于不同方向上的绝对速度确定主车的横摆角。4.根据权利要求3所述的基于经纬度信息的主车信息坐标系转换方法，其特征在于，所述主车不同方向上的绝对速度的计算公式如下：；其中，为时刻x方向的主车绝对速度，为时刻y方向的主车绝对速度，为第k个数据采集的时间点，，为数据采集长度，为固定的时间间隔，为时刻对应的主车绝对轨迹坐标。5.根据权利要求1所述的基于经纬度信息的主车信息坐标系转换方法，其特征在于，基于所述横摆角，通过公式，将所述主车视角下的相对运动环境信息转换为鸟瞰视角下的绝对运动环境信息；
其中，为横摆角；(,)为周围交通参与者在鸟瞰视角坐标系中的位置绝对坐标；(,)为周围交通参与者在鸟瞰视角坐标系中x轴方向...

【专利技术属性】
技术研发人员：吕超，刘昱沛，崔格格，孟相浩，臧政，龚建伟，齐建永，
申请(专利权)人：北理慧动北京教育科技有限公司，
类型：发明
国别省市：