CN109931937B - 高精导航信息模拟方法及*** - Google Patents
高精导航信息模拟方法及*** Download PDFInfo
- Publication number
- CN109931937B CN109931937B CN201910244062.XA CN201910244062A CN109931937B CN 109931937 B CN109931937 B CN 109931937B CN 201910244062 A CN201910244062 A CN 201910244062A CN 109931937 B CN109931937 B CN 109931937B
- Authority
- CN
- China
- Prior art keywords
- lane
- simulation
- simulation data
- data
- node
- 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
- 238000004088 simulation Methods 0.000 title claims abstract description 215
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000013507 mapping Methods 0.000 claims description 7
- 238000005259 measurement Methods 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 8
- 238000004364 calculation method Methods 0.000 description 7
- 238000012360 testing method Methods 0.000 description 6
- 230000006870 function Effects 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 230000007613 environmental effect Effects 0.000 description 3
- 230000003993 interaction Effects 0.000 description 3
- 238000004806 packaging method and process Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 230000002238 attenuated effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000010998 test method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Landscapes
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明提供高精导航信息模拟方法及***,以对高精导航信息进行模拟。所述***至少包括:仿真数据生成单元和高精导航仿真单元;所述方法包括:所述仿真数据生成单元向所述高精导航仿真单元输出目标位置,并实时输出虚拟测试场景中车辆的当前位置仿真数据;所述高精导航仿真单元使用接收的当前位置仿真数据、目标位置以及OpenDRIVE地图文件生成高精导航仿真信息。在本发明实施例中,采用仿真数据生成单元和高精导航仿真单元生成高精导航仿真信息,其中,高精导航仿真单元模拟了地图盒子的功能,而仿真数据生成单元对高精导航仿真单元所需的输入数据进行了仿真。
Description
技术领域
本发明涉及仿真领域,特别涉及高精导航信息模拟方法及***。
背景技术
对于汽车智能驾驶***,高精地图是必备的关键部分,其能提供精确的地理信息,从而车辆可以根据图进行高精定位,并且高精地图能帮助车辆记性环境感知,例如道路的几何信息,超视距感知等。
车载地图盒子会根据其他设备提供的数据以及高精地图输出高精导航信息。而智能驾驶车辆控制器则根据高精导航信息发生控制信号。
仿真测试验证是智能驾驶***开发流程中必不可少的一个环节,然而,现有的仿真测试方案中,一般仅对毫米波雷达、激光雷达等物理传感器的信息进行模拟,并未对地图盒子输出的高精导航信息进行模拟。
发明内容
有鉴于此,本发明实施例提供高精导航信息模拟方法及***,以对高精导航信息进行模拟。
为实现上述目的,本发明实施例提供如下技术方案:
一种高精导航信息模拟方法,基于高精导航信息模拟***,所述***至少包括:仿真数据生成单元和高精导航仿真单元;
所述方法包括:
所述仿真数据生成单元向所述高精导航仿真单元输出目标位置,并实时输出虚拟测试场景中车辆的当前位置仿真数据;
所述高精导航仿真单元使用接收的当前位置仿真数据、目标位置以及OpenDRIVE地图文件生成高精导航仿真信息。
可选的,所述OpenDRIVE地图文件包括多个road节点及其子节点;每一road节点及其子节点用于描述一段道路的详细信息;所述子节点包括lane子节点;所述生成高精导航仿真信息包括:根据所述OpenDRIVE地图文件创建道路拓扑图;所述道路拓扑图中的车道节点与lane子节点一一对应;每一车道节点以相应lane子节点的标识id命名;所述车道节点的内容包括长度、车道中心线上的点的绝对位置、车道左右边界线类型、后续相连车道节点的id、左右相邻车道的类型和标识id;根据所述当前位置仿真数据确定当前绝对位置;将所述当前绝对位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出所述当前绝对位置对应的车道节点作为起始车道节点;将目标位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出目标位置对应的车道节点作为目标车道节点;根据所述起始车道节点和目标车道节点规划行车路径;根据所述行车路径,生成所述高精导航仿真信息。
可选的,所述根据所述行车路径,生成所述高精导航仿真信息包括:根据所述当前绝对位置,查找车辆在道路上的S坐标;所述S坐标包括所述当前绝对位置距车道起点的长度;根据所述S坐标,从规划的行车路径中计算车辆前方预设距离内的道路信息作为所述高精导航仿真信息。
可选的,所述虚拟测试场景中车辆为车辆动力学模型;所述仿真数据生成单元包括所述车辆动力学模型;所述当前位置仿真数据包括:卫星导航仿真数据和姿态仿真数据;所述实时输出虚拟测试场景中车辆的当前位置仿真数据包括:在虚拟测试场景的虚拟道路上运行所述车辆动力学模型;所述车辆动力学模型实时计算出在所述虚拟测试场景中自身的三维位置真值及惯性测量单元IMU数据;所述原始数据包括所述三维位置真值和IMU数据;将所述三维位置真值映射为经纬度真值;对所述经纬度真值和IMU数据添加噪声;按照所述地图盒子接收数据的通讯协议和数据格式,将加噪后的经纬度真值封装为导航仿真数据;按照所述地图盒子接收数据的通讯协议和数据格式,将加噪后的IMU数据封装为姿态仿真数据;向所述地图盒子发送所述卫星导航仿真数据和所述姿态仿真数据。
可选的,所述仿真数据生成单元还包括卫星导航信号模拟器、三维转台和IMU传感器;所述三维转台与所述IMU传感器相连接;所述实时输出虚拟测试场景中车辆的当前位置仿真数据包括:在虚拟测试场景的虚拟道路上运行所述车辆动力学模型;所述车辆动力学模型实时计算出在所述虚拟测试场景中自身的三维位置真值及第一IMU数据;所述原始数据包括所述三维位置真值和第一IMU数据;将所述三维位置真值映射为经纬度真值;将所述经纬度真值输出到所述卫星导航信号模拟器中,由所述卫星导航信号模拟器发送出携带经纬度真值信息的射频信号作为卫星导航仿真数据;将所述第一IMU数据输出到所述三维转台,由所述三维转台根据所述第一IMU数据变动姿态位置;所述IMU传感器根据所述三维转台的姿态位置生成的第二IMU数据为所述姿态仿真数据。
可选的,所述仿真数据生成单元包括道路编辑器;所述道路编辑器用于搭建虚拟道路,根据搭建的虚拟道路生成所述OpenDRIVE地图文件。
一种高精导航信息模拟***,包括:
仿真数据生成单元,用于输出目标位置,并实时输出虚拟测试场景中车辆的当前位置仿真数据;
高精导航仿真单元,用于接收目标位置、当前位置仿真数据及OpenDRIVE地图文件,使用接收的当前位置仿真数据、目标位置以及OpenDRIVE地图文件生成高精导航仿真信息。
可选的,所述OpenDRIVE地图文件包括多个road节点及其子节点;每一road节点及其子节点用于描述一段道路的详细信息;所述子节点包括lane子节点;在所述生成高精导航仿真信息的方面,所述高精导航仿真单元具体用于:根据所述OpenDRIVE地图文件创建道路拓扑图;所述道路拓扑图中的车道节点与lane子节点一一对应;每一车道节点以相应lane子节点的标识id命名;所述车道节点的内容包括长度、车道中心线上的点的绝对位置、车道左右边界线类型、后续相连车道节点的id、左右相邻车道的类型和标识id;根据所述当前位置仿真数据确定当前绝对位置;将所述当前绝对位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出所述当前绝对位置对应的车道节点作为起始车道节点;将目标位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出目标位置对应的车道节点作为目标车道节点;根据所述起始车道节点和目标车道节点规划行车路径;根据所述行车路径,生成所述高精导航仿真信息。
在本发明实施例中,采用仿真数据生成单元和高精导航仿真单元生成高精导航仿真信息,其中,高精导航仿真单元模拟了地图盒子的功能,而仿真数据生成单元对高精导航仿真单元所需的输入数据进行了仿真。
附图说明
图1a为本发明实施例提供的高精导航信息模拟***的一种示例性结构;
图1b为本发明实施例提供的高精导航信息模拟***示例性硬件架构;
图1c为本发明实施例提供的高精导航信息模拟***的另一种示例性结构;
图2为本发明实施例提供的测试方法的示例性流程图;
图3为本发明实施例提供的测试方法的另一示例性流程图;
图4为本发明实施例提供的拓扑图示意图;
图5a为本发明实施例提供的仿真数据生成流程图;
图5b为本发明实施例提供的仿真数据生成另一流程图;
图6a为本发明实施例提供的s坐标示意图;
图6b为本发明实施例提供的圆弧段上的点的相关变量示意图;
图6c为本发明实施例提供的螺旋线上的点的相关变量示意图;
图6d为本发明实施例提供的车辆与参考线上的点的关系示意图;
图6e为本发明实施例提供的曲线上的点距起点距离的计算示意图。
具体实施方式
本发明提供高精导航信息模拟方法及***,以对高精导航信息进行模拟。
本发明的核心思路是:采用仿真数据生成单元和高精导航仿真单元生成高精导航仿真信息,其中,高精导航仿真单元模拟了地图盒子的功能,而仿真数据生成单元对高精导航仿真单元所需的输入数据进行了仿真。
请参见图1a,上述高精导航信息模拟***的一种示例性结构包括:仿真数据生成单元1和高精导航仿真单元2。
其中,仿真数据生成单元1用于输出目标位置,并实时输出虚拟测试场景中车辆的当前位置仿真数据;
高精导航仿真单元2,用于接收目标位置、当前位置仿真数据及OpenDRIVE地图文件,使用接收的当前位置仿真数据、目标位置以及OpenDRIVE地图文件生成高精导航仿真信息。
高精导航信息模拟***的一种示例性硬件架构可参见图1b,包括:上位机、HIL(hardware-in-the-loop,硬件在环)下位机和智能驾驶车辆控制器。
高精导航仿真单元2可部署在下位机中。
在一个示例中,高精导航仿真单元2所需的数据可仅通过仿真软件生成,则仿真数据生成单元1可包括仿真软件。
在另一个示例中,可在上位机中部署仿真软件,此外,下位机侧也可进行相应的硬件部署以生成,则仿真数据生成单元1除可包括仿真软件,还可包括下位机侧用于仿真的硬件。
下面将基于上述共性介绍,对本发明实施例做进一步详细说明。
图2示出了基于上述高精导航信息模拟***的测试方法的一种示例性流程,其可包括:
S1:仿真数据生成单元向所述高精导航仿真单元输出目标位置,并实时输出虚拟测试场景中车辆的当前位置仿真数据;
虚拟测试场景中可包括车辆动力学模型、虚拟道路乃至静止或运动的障碍物(例如其他的车辆)。
车辆动力学模型是真实车辆的虚拟仿真模型。请参见图1c,车辆动力学模型11属于仿真数据生成单元1的一部分,车辆动力学模型11运行在虚拟测试场景中,当前位置仿真数据的原始数据由车辆动力学模型生成。
此外,仿真数据生成单元1还包括人机交互单元12,测试人员可通过人机交互单元12输入目标位置,还可通过人机交互单元12对车辆动力学模型11进行控制。
当前位置仿真数据可包括卫星导航仿真数据(例如GPS仿真数据、北斗仿真数据)和姿态仿真数据。
姿态仿真数据可包括惯性测量单元(IMU)仿真数据,例如车辆的横摆角、侧倾角、俯仰角,以及角速度等。
本文后续将介绍如何生成卫星导航仿真数据(例如GPS仿真数据)和姿态仿真数据。
至于OpenDRIVE地图文件,OpenDRIVE提供了一种基于车道轨迹描述路网的格式,其数据使用扩展标记语言(Extensible Markup Language,XML)语法表示,文件后缀名为“.xodr”。OpenDRIVE文件可以通过在仿真软件中手动搭建道路场景或者根据采集的真实道路数据自动生成。
请参见图1c,仿真数据生成单元1可包括道路编辑器13,道路编辑器13可用于人工搭建虚拟道路(在界面上手动画直线、弧线等来搭建虚拟道路),根据搭建的虚拟道路生成OpenDRIVE地图文件。
OpenDRIVE地图文件包括多个road节点及其子节点,每一road节点及其子节点用于描述一段道路的详细信息。
其中,详细信息包括道路的前后连接关系、道路类型、参考线平面几何形状、纵向高度变化、道路横截面形状、车道信息、沿路的建筑和交通标志信号;
OpenDRIVE地图文件中的junction节点及其子节点用于描述复杂情况下的道路连接关系,如各种交叉路口、高速匝道等,这样道路中的所有车道的具体信息以及车道和车道之间的逻辑关系都能够清楚的表示。
S2:高精导航仿真单元使用接收的当前位置仿真数据、目标位置以及OpenDRIVE地图文件生成高精导航仿真信息。
高精导航仿真单元用于模拟地图盒子。在真实场景下,地图盒子接收其他设备或部件传输的卫星导航信息、姿态信息,可计算得到车辆当前的绝对位置(具体的,绝对位置可包括经纬度)。
与之相类似,在本实施例中,高精导航仿真单元是根据卫星导航仿真数据和姿态仿真数据计算得到车辆动力学模型的绝对位置。
高精导航仿真信息可通过CAN总线或者以太网发送。
在本发明实施例中,采用仿真数据生成单元和高精导航仿真单元生成高精导航仿真信息,其中,高精导航仿真单元模拟了地图盒子的功能,而仿真数据生成单元对高精导航仿真单元所需的输入数据进行了仿真。
并且,可对OpenDRIVE数据进行手动更改,输出错误的车道线位置信息或者左右车道类型,模拟地图盒子输出错误数据,对控制器的容错能力进行验证的方法。
下面具体介绍如何生成高精导航仿真信息,请参见图3,其示例性得可包括如下步骤:
S21:根据OpenDRIVE地图文件创建道路拓扑图;
具体的,可先对OpenDRIVE文件进行解析,使用网上提供的TinyXML库文件,调用函数读取OpenDRIVE文件中的节点及其属性;再根据OpenDRIVE文件中的节点及其属性创建道路拓扑图。
前述提及了OpenDRIVE文件中的road节点的子节点包括lane子节点,道路拓扑图中的车道节点与lane子节点一一对应;每一车道节点以相应lane子节点的标识id命名。
而车道节点的内容包括lane长度、车道中心线上的点的绝对位置、车道左右边界线类型、后续相连车道节点的id、左右相邻车道的类型和标识id等。
假定一road节点中包括6个lane子节点,id分别是01-06,该road节点对应的车道节点如图4所示,车道节点之间是有向连接的,其标示了能否从一车道进入另一车道,例如,从02车道节点对应的车道可进入03车道节点对应的车道,但从02车道节点对应的车道不能直接进入04车道节点对应的车道;再例如,从05车道节点对应的车道不能进入05车道节点对应的车道。
S22:根据当前位置仿真数据确定当前绝对位置。
当前位置仿真数据主要包括卫星导航仿真数据和姿态仿真数据。如何根据卫星导航仿真数据和姿态仿真数据可参考现有方式,在此不作赘述。
S23:将当前绝对位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出当前绝对位置对应的车道节点作为起始车道节点。
可参考现有方式,在此不作赘述。
S24:将输入的目标位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出目标位置对应的车道节点作为目标车道节点。
可参考现有方式,在此不作赘述。
S25:根据起始车道节点和目标车道节点规划行车路径。
具体的,可根据起始节点和目标节点,在拓扑图中查找一条能够从起始节点到目标节点的最优路径。可参考现有规划方式,在此不作赘述。
S26:根据行车路径生成高精导航仿真信息。
具体的,可根据车辆的当前绝对位置,查找车辆在道路上的S坐标(S坐标包括当前绝对位置距车道起点的长度);再根据S坐标,从规划的行车路径中计算车辆前方预设距离(例如200米)内的道路信息作为所述高精导航仿真信息。
道路信息包括但不限于:车道中心线上的点,左右相邻车道的类型和中心线上的点等信息。
下面具体介绍如何生成当前位置仿真数据。
当前位置仿真数据主要包括卫星导航仿真数据和姿态仿真数据。
图5a示出了以软件方式生成卫星导航仿真数据和姿态仿真数据的示例性流程,包括:
S51:在虚拟测试场景的虚拟道路上运行车辆动力学模型;
本步骤模拟的是真实的车辆在道路上行驶。
虚拟道路的道路信息保存在OpenDRIVE文件中,相关介绍请参见本文前述记载,在此不作赘述。
S52:车辆动力学模型实时计算出自身在虚拟测试场景中的三维位置真值及IMU数据。
具体的,车辆动力学模型可实时计算出自身在虚拟测试场景中的XYZ位置真值以及IMU数据。
所述原始数据包括所述三维位置真值和IMU数据;
S53:将三维位置真值映射为经纬度真值。
可将XYZ坐标投影地理坐标***中,得到经纬度真值。
步骤S53可由车辆动力学模型执行,也可由专门的映射单元执行。该映射单元属于仿真数据生成单元。
S54:对经纬度真值和IMU数据添加噪声;
S55:按照高精导航仿真单元接收数据的通讯协议和数据格式,将加噪后的经纬度真值和IMU分别封装为导航仿真数据和姿态仿真数据。
加噪后的经纬度真值可封装为导航仿真数据,加噪后的IMU数据可封装为姿态仿真数据。
S56:向高精导航仿真单元发送卫星导航仿真数据和所述姿态仿真数据。
具体的,可按照高精导航仿真单元接收数据的通讯协议和数据格式发送加噪后的经纬度真值和IMU,可实现S55和S56。
步骤S54-46可由车辆动力学模型执行,也可由专门的发送单元执行。该发送单元属于仿真数据生成单元。
除了软件方式,也可结合硬件生成卫星导航仿真数据和姿态仿真数据,图5b即示出了生成的卫星导航仿真数据和姿态仿真数据的另一种示例性流程,包括:
S51-S53不作赘述。
S57:将经纬度真值输出到卫星导航信号模拟器中,由卫星导航信号模拟器发送出携带经纬度真值信息的射频信号作为卫星导航仿真数据。
以GPS为例,卫星导航信号模拟器具体可为GPS模拟器,卫星导航信号模拟器属于仿真数据生成单元。
将经纬度真值输入GPS模拟器后,GPS模拟器会发送出射频信号,高精导航仿真单元可以使用天线接收射频信号从而得到车辆的卫星导航仿真数据(卫星定位信息)。
S58:将IMU数据输出到三维转台,由IMU传感器输出IMU数据至高精导航仿真单元。
在此步骤中,进行了IMU硬件在环仿真,三维转台会根据输入的IMU数据(可称为第一IMU数据)变动姿态位置,而与之连接的IMU传感器则会根据三维转台的姿态位置生成IMU数据(可称为第二IMU数据)输出至高精导航仿真单元。
其中,三维转台和IMU传感器属于仿真数据生成单元,三维转台、IMU传感器和GPS模拟器位于下位机侧。
需要说明的是,在现有测试方式中,高精导航仿真单元采用的卫星导航信号是实车接收到的,以GPS射频信号为例,其容易受雨雪天气等环境因素影响而衰减,而在本实施例中,卫星导航信号是模拟生成的,也不必在户外进行测试,因此不会受环境因素影响。
下面介绍如何计算lane长度,以及,车道中心线上的点的绝对位置。
lane的长度等于其所属的laneSection的长度,道路的s坐标定义如图6a,其根据起始slaneSection坐标和road的length信息计算,一个road的节点可能包含一个或多个laneSection,如果只包含一个,则laneSection的长度等于road的长度,如果包含多个laneSection,某一laneSection的长度等于相邻两个laneSection的起始slaneSection坐标之差,最后一段laneSection的长度等于road的length(长度)减去本laneSection的slaneSection坐标。
车道中心线上的点的绝对坐标根据参考线和车道宽度计算得到。在计算车道中心线的点时,会每隔一定的间隔取一个点的绝对坐标进行保存,间隔示例性地可为1m、3m等。车道中心线上的点是高精导航输出的比较核心的信息,简单的理解就是控制车辆沿着车道中心线走,用于车辆控制信号的计算。
以距离lane的起点(起点的S坐标为slaneSection)slane处的点为例,该点在road中的s坐标为slane+slaneSection,可先求出在slane+slaneSection处的参考线上的点PRL的绝对坐标,参考线上点的坐标计算根据参考线的geometry信息计算。
OpenDRIVE中提供了五种几何曲线用于表示参考线的形状,分别是直线,圆弧,螺旋线,三次多项式和参数三次多项式。每一段曲线用一个geometry节点来描述,geometry中会包含曲线起点在road上的s坐标,起点的x,y坐标,起点处的切线方向(hdg)和曲线的长度(length),geometry的子节点中会包含line、spiral等具体的曲线类型和相关参数。
曲线上的点距起点的距离ds:
ds=slane+slaneSection-s
请参见图6e,其中s_lane或Slane是点PRL距离laneSection2的起点的长度,s_laneSection或SlaneSection是laneSection2的起点在road上的s坐标,S是arc曲线的起点在road上的s坐标。
对于arc曲线上的灰色点而言,ds=3,Slane=5,SlaneSection=8,S=10。
以曲线类型为直线为例,直线上的点PRL的坐标(PRLX,PRLY)可以直接根据直线的起点、方向和点在直线上距起点的距离ds计算:
上述x,y为直线参考线起点的绝对坐标。
以曲线类型为圆弧为例,圆弧上的点PRL可以先在以圆弧起点切线方向为u方向的uv坐标系中,如图6b所示,根据圆弧曲率(curvature)和ds计算点PRL相对于UV坐标原点(也即圆弧段的起点)的偏移du和dv:
然后根据du、dv和起点的hdg进行坐标系转换得到点PRL在xy坐标系下相对于圆弧起点的偏移dx、dy:
进而求出点PRL的坐标:
上述x,y为圆弧起点的绝对坐标。
以曲线类型为螺旋线为例,螺旋线上点PRL的计算可根据OpenDrive官网(http://www.opendrive.org/download.html)上提供的用于计算spiral的样例代码进行计算,代码中提供了odrSpiral函数,计算曲率从零开始变化的spiral曲线,在曲率为0的点作为原点,曲率为0的点切线方向为u的uv坐标系下的点的坐标和切线方向角度。如图6c所示,根据p0和p1处曲率curvStart和curvEnd,以及曲线的长度(length),可以算出曲率的变化率dc:
dc=(curvStart-curvEnd)/length
uv坐标系原点到p0以及点PRL的弧长s0和s1分别为:
使用odrSpiral函数计算起点p0的坐标(u0,v0),p0切线方向与u轴的夹角ɑ以及点PRL的坐标(uR,vR),从而可以算出du和dv分别为:
根据坐标系的旋转和偏移可以计算出在xy坐标系下点PRL相对于p0的偏移量dx和dy:
从而求出点PRL的xy坐标:
下面是三次多项式和参数三次多项式曲线上点坐标计算:
在uv坐标系中将曲线分成若干段,使用求若干直线长度和的方式求从起始点到某个点的弧长,依次由近及远如果弧长第一次大于ds,则认为该点是距起点长度为ds的点,得到uv坐标系下点的坐标,经过坐标转化可以求出点在xy坐标系中的坐标值。
求出参考线上相同s坐标点的xy坐标后,如图6d所示,使用laneOffset、本车道和参考线之间所有车道的宽度之和、本车道宽度的一半作为本车道中心线上的点和参考线之间的横向偏移tOffset,参考线上点的切线方向可以根据曲线的几何公式计算得到,偏移方向和切线方向垂直,从而可以得到偏移的方向,由PRL点的坐标,偏移的tOffset和方向可以求出PCL的坐标。
左右边界线类型可以根据OpenDRIVE文件中roadMark节点下的type获取。
左右相邻车道的类型和id,可根据OpenDRIVE中相同laneSection下的lane节点的id来查找,id编号连续,id为-2的车道,左侧车道id为-1,右侧为-3。车道的类型直接在lane节点的type中查找。
后续相连节点的id根据lane>link>successor节点的id以及后续的laneSection进行共同确定。如果当前lane的父节点laneSection后面还有laneSection节点,后续的laneSection直接为后面的laneSection。laneSection的后面没有laneSection节点,则后连的laneSection要根据所属road节点的successor节点中的信息进行搜索,road>succesoor节点中包含了下一个连接road的id、类型以及连接的是contactPoint是起点还是终点。根据这几个信息可以找到后连laneSection所属的road以及在road的起始还是末尾位置。如果road>succesoor节点中的elementType是junction,后续的road可能会有多个,需要找到每一个road中连接的laneSection。
上述中拓扑图中节点信息的计算过程以参考线右侧车道为例,参考线左侧的车道上车辆的行驶方向和参考线s坐标增加的方向相反,计算过程也会有一定差异。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置而言,由于其与实施例公开的方法相对应,所以描述的比较简单,之处参见方法部分说明即可。
专业人员还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及模型步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
结合本文中所公开的实施例描述的方法或模型的步骤可以直接用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机存储器(RAM)、内存、只读存储器(ROM)、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、可移动磁盘、WD-ROM、或技术领域内所公知的任意其它形式的存储介质中。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (6)
1.一种高精导航信息模拟方法,其特征在于,基于高精导航信息模拟***,所述***至少包括:仿真数据生成单元和高精导航仿真单元;
所述方法包括:
所述仿真数据生成单元向所述高精导航仿真单元输出目标位置,并实时输出虚拟测试场景中车辆的当前位置仿真数据,其中,所述当前位置仿真数据包括:卫星导航仿真数据和姿态仿真数据,所述姿态仿真数据包括:惯性测量单元仿真数据,所述惯性测量单元仿真数据至少包含车辆的横摆角、侧倾角、俯仰角,以及角速度;
所述高精导航仿真单元使用接收的当前位置仿真数据、目标位置以及OpenDRIVE地图文件生成高精导航仿真信息;
其中,所述虚拟测试场景中车辆为车辆动力学模型;所述仿真数据生成单元包括所述车辆动力学模型、卫星导航信号模拟器、三维转台和IMU传感器;所述三维转台与所述IMU传感器相连接;
所述当前位置仿真数据包括:卫星导航仿真数据和姿态仿真数据;
所述实时输出虚拟测试场景中车辆的当前位置仿真数据包括:
在虚拟测试场景的虚拟道路上运行所述车辆动力学模型;
所述车辆动力学模型实时计算出在所述虚拟测试场景中自身的三维位置真值及第一IMU数据;原始数据包括所述三维位置真值和第一IMU数据;
将所述三维位置真值映射为经纬度真值;
对所述经纬度真值和第一IMU数据添加噪声;
将加噪后的经纬度真值输出到所述卫星导航信号模拟器中,由所述卫星导航信号模拟器发送出携带经纬度真值信息的射频信号作为卫星导航仿真数据;
将加噪后的第一IMU数据输出到所述三维转台,由所述三维转台根据加噪后的第一IMU数据变动姿态位置;所述IMU传感器根据所述三维转台的姿态位置生成的第二IMU数据为所述姿态仿真数据。
2.如权利要求1所述的方法,其特征在于,所述OpenDRIVE地图文件包括多个road节点及其子节点;每一road节点及其子节点用于描述一段道路的详细信息;所述子节点包括lane子节点;
所述生成高精导航仿真信息包括:
根据所述OpenDRIVE地图文件创建道路拓扑图;所述道路拓扑图中的车道节点与lane子节点一一对应;每一车道节点以相应lane子节点的标识id命名;所述车道节点的内容包括长度、车道中心线上的点的绝对位置、车道左右边界线类型、后续相连车道节点的id、左右相邻车道的类型和标识id;
根据所述当前位置仿真数据确定当前绝对位置;
将所述当前绝对位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出所述当前绝对位置对应的车道节点作为起始车道节点;
将目标位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出目标位置对应的车道节点作为目标车道节点;
根据所述起始车道节点和目标车道节点规划行车路径;
根据所述行车路径,生成所述高精导航仿真信息。
3.权利要求2所述的方法,其特征在于,所述根据所述行车路径,生成所述高精导航仿真信息包括:
根据所述当前绝对位置,查找车辆在道路上的S坐标;所述S坐标包括所述当前绝对位置距车道起点的长度;
根据所述S坐标,从规划的行车路径中计算车辆前方预设距离内的道路信息作为所述高精导航仿真信息。
4.如权利要求1所述的方法,其特征在于,所述仿真数据生成单元包括道路编辑器;所述道路编辑器用于搭建虚拟道路,根据搭建的虚拟道路生成所述OpenDRIVE地图文件。
5.一种高精导航信息模拟***,其特征在于,包括:
仿真数据生成单元,用于输出目标位置,并实时输出虚拟测试场景中车辆的当前位置仿真数据,其中,所述当前位置仿真数据包括:卫星导航仿真数据和姿态仿真数据,所述姿态仿真数据包括:惯性测量单元仿真数据,所述惯性测量单元仿真数据至少包含车辆的横摆角、侧倾角、俯仰角,以及角速度;
高精导航仿真单元,用于接收目标位置、当前位置仿真数据及OpenDRIVE地图文件,使用接收的当前位置仿真数据、目标位置以及OpenDRIVE地图文件生成高精导航仿真信息;
其中,所述虚拟测试场景中车辆为车辆动力学模型;所述仿真数据生成单元包括所述车辆动力学模型、卫星导航信号模拟器、三维转台和IMU传感器;所述三维转台与所述IMU传感器相连接;
所述当前位置仿真数据包括:卫星导航仿真数据和姿态仿真数据;
所述仿真数据生成单元具体用于:
在虚拟测试场景的虚拟道路上运行所述车辆动力学模型;
所述车辆动力学模型实时计算出在所述虚拟测试场景中自身的三维位置真值及第一IMU数据;原始数据包括所述三维位置真值和第一IMU数据;
将所述三维位置真值映射为经纬度真值;
对所述经纬度真值和第一IMU数据添加噪声;
将加噪后的经纬度真值输出到所述卫星导航信号模拟器中,由所述卫星导航信号模拟器发送出携带经纬度真值信息的射频信号作为卫星导航仿真数据;
将加噪后的第一IMU数据输出到所述三维转台,由所述三维转台根据加噪后的第一IMU数据变动姿态位置;所述IMU传感器根据所述三维转台的姿态位置生成的第二IMU数据为所述姿态仿真数据。
6.如权利要求5所述的***,其特征在于,所述OpenDRIVE地图文件包括多个road节点及其子节点;每一road节点及其子节点用于描述一段道路的详细信息;所述子节点包括lane子节点;
在所述生成高精导航仿真信息的方面,所述高精导航仿真单元具体用于:
根据所述OpenDRIVE地图文件创建道路拓扑图;所述道路拓扑图中的车道节点与lane子节点一一对应;每一车道节点以相应lane子节点的标识id命名;所述车道节点的内容包括长度、车道中心线上的点的绝对位置、车道左右边界线类型、后续相连车道节点的id、左右相邻车道的类型和标识id;
根据所述当前位置仿真数据确定当前绝对位置;
将所述当前绝对位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出所述当前绝对位置对应的车道节点作为起始车道节点;
将目标位置与拓扑图中各车道节点车道中心线上点的绝对位置进行遍历运算比较,搜索出目标位置对应的车道节点作为目标车道节点;
根据所述起始车道节点和目标车道节点规划行车路径;
根据所述行车路径,生成所述高精导航仿真信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910244062.XA CN109931937B (zh) | 2019-03-28 | 2019-03-28 | 高精导航信息模拟方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910244062.XA CN109931937B (zh) | 2019-03-28 | 2019-03-28 | 高精导航信息模拟方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109931937A CN109931937A (zh) | 2019-06-25 |
CN109931937B true CN109931937B (zh) | 2021-10-15 |
Family
ID=66988484
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910244062.XA Active CN109931937B (zh) | 2019-03-28 | 2019-03-28 | 高精导航信息模拟方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109931937B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110297261B (zh) * | 2019-07-08 | 2022-08-30 | 卡斯柯信号有限公司 | 一种模拟列车运行轨迹的卫星导航仿真***及方法 |
CN111123740B (zh) * | 2019-12-19 | 2024-04-16 | 北京经纬恒润科技股份有限公司 | 硬件在环测试方法以及装置 |
CN113137973A (zh) * | 2020-01-20 | 2021-07-20 | 北京初速度科技有限公司 | 一种图像语义特征点真值确定方法及装置 |
CN111399512A (zh) * | 2020-03-27 | 2020-07-10 | 广州小鹏汽车科技有限公司 | 行车控制方法、行车控制装置和车辆 |
CN111707277B (zh) * | 2020-05-22 | 2022-01-04 | 上海商汤临港智能科技有限公司 | 获取道路语义信息的方法、装置及介质 |
CN112082567B (zh) * | 2020-09-05 | 2023-06-02 | 上海智驾汽车科技有限公司 | 基于改进Astar和灰狼算法结合的地图路径规划方法 |
CN112254737A (zh) * | 2020-10-27 | 2021-01-22 | 北京晶众智慧交通科技股份有限公司 | 地图数据转换方法 |
CN112394371B (zh) * | 2020-11-03 | 2024-04-12 | 武汉光庭信息技术股份有限公司 | 一种gps模拟信号生成方法、装置、电子设备及存储介质 |
CN112783142B (zh) * | 2021-01-05 | 2023-02-03 | 广州小鹏自动驾驶科技有限公司 | 车道居中控制的仿真测试***、方法、设备和存储介质 |
CN113177993B (zh) * | 2021-03-22 | 2024-03-01 | 中国人民解放军32801部队 | 一种仿真环境中高精地图的生成方法及*** |
CN113848749A (zh) * | 2021-08-31 | 2021-12-28 | 际络科技(上海)有限公司 | 自动驾驶仿真测试***、方法、电子设备及存储介质 |
CN113820965A (zh) * | 2021-09-26 | 2021-12-21 | 上汽通用五菱汽车股份有限公司 | Imu信号仿真方法、***、设备和计算机可读存储介质 |
CN114970085A (zh) * | 2022-04-06 | 2022-08-30 | 北京宾理信息科技有限公司 | 一种高精地图仿真测试方法及*** |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107389081A (zh) * | 2017-07-15 | 2017-11-24 | 东莞市华睿电子科技有限公司 | 一种无人驾驶车辆的智能导航方法及*** |
CN107452242A (zh) * | 2017-07-05 | 2017-12-08 | 广东工业大学 | 一种基于北斗导航的汽车模型半实物仿真*** |
CN107764266A (zh) * | 2017-09-18 | 2018-03-06 | 千寻位置网络有限公司 | 室内组合导航仿真方法及***、导航装置、终端、存储器 |
CN107807542A (zh) * | 2017-11-16 | 2018-03-16 | 北京北汽德奔汽车技术中心有限公司 | 自动驾驶仿真*** |
CN107991898A (zh) * | 2016-10-26 | 2018-05-04 | 法乐第(北京)网络科技有限公司 | 一种无人驾驶车辆模拟测试装置及电子设备 |
CN108027242A (zh) * | 2015-11-30 | 2018-05-11 | 华为技术有限公司 | 自动驾驶导航方法、装置、***、车载终端及服务器 |
CN108534790A (zh) * | 2018-02-27 | 2018-09-14 | 吉林省行氏动漫科技有限公司 | 无人驾驶车辆导航方法、装置及无人驾驶车辆 |
CN108803607A (zh) * | 2018-06-08 | 2018-11-13 | 北京领骏科技有限公司 | 一种用于自动驾驶的多功能仿真*** |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2864655Y (zh) * | 2006-01-13 | 2007-01-31 | 浙江大学 | 一种微型无人直升机飞行姿态三维仿真转台 |
CN108241762A (zh) * | 2016-12-26 | 2018-07-03 | 乐视汽车(北京)有限公司 | 用于自动驾驶仿真***的测试***和测试方法 |
CN107944091B (zh) * | 2017-10-30 | 2021-05-11 | 同济大学 | 一种虚实结合的车联网应用场景测试***及方法 |
-
2019
- 2019-03-28 CN CN201910244062.XA patent/CN109931937B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108027242A (zh) * | 2015-11-30 | 2018-05-11 | 华为技术有限公司 | 自动驾驶导航方法、装置、***、车载终端及服务器 |
CN107991898A (zh) * | 2016-10-26 | 2018-05-04 | 法乐第(北京)网络科技有限公司 | 一种无人驾驶车辆模拟测试装置及电子设备 |
CN107452242A (zh) * | 2017-07-05 | 2017-12-08 | 广东工业大学 | 一种基于北斗导航的汽车模型半实物仿真*** |
CN107389081A (zh) * | 2017-07-15 | 2017-11-24 | 东莞市华睿电子科技有限公司 | 一种无人驾驶车辆的智能导航方法及*** |
CN107764266A (zh) * | 2017-09-18 | 2018-03-06 | 千寻位置网络有限公司 | 室内组合导航仿真方法及***、导航装置、终端、存储器 |
CN107807542A (zh) * | 2017-11-16 | 2018-03-16 | 北京北汽德奔汽车技术中心有限公司 | 自动驾驶仿真*** |
CN108534790A (zh) * | 2018-02-27 | 2018-09-14 | 吉林省行氏动漫科技有限公司 | 无人驾驶车辆导航方法、装置及无人驾驶车辆 |
CN108803607A (zh) * | 2018-06-08 | 2018-11-13 | 北京领骏科技有限公司 | 一种用于自动驾驶的多功能仿真*** |
Non-Patent Citations (1)
Title |
---|
OpenDRIVE.OpenDRIVE® V 1.4 Format Specification, Revision H / OpenDRIVE® V 1.4 schema file.《http://www.opendrive.org/docs/OpenDRIVEFormatSpecRev1.4H.pdf》.2015,1-100. * |
Also Published As
Publication number | Publication date |
---|---|
CN109931937A (zh) | 2019-06-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109931937B (zh) | 高精导航信息模拟方法及*** | |
CN111897305B (zh) | 一种基于自动驾驶的数据处理方法、装置、设备及介质 | |
CN102713521B (zh) | 用gps踪迹产生、细化及扩充增量地图 | |
JP6197393B2 (ja) | レーン地図生成装置及びプログラム | |
JP5216665B2 (ja) | 地図データ更新システム及び地図データ更新プログラム、並びにこれを利用したナビゲーション装置及び車両制御装置 | |
CN103438897B (zh) | 基于栅格地图的路径轨迹校正方法 | |
CN108180921B (zh) | 利用gps数据的ar-hud导航***及其导航方法 | |
CN109916422B (zh) | 一种全局路径规划方法及装置 | |
CN105973244A (zh) | 获取地图信息的方法、导航方法及设备 | |
JP2009503638A (ja) | 道路網グラフをモデル化する方法、装置及びシステム | |
Tu et al. | Forwards: A map-free intersection collision-warning system for all road patterns | |
CN110276952B (zh) | 一种交通信息模拟采集方法及装置 | |
CN111007834B (zh) | 一种adas路径规划功能实验室测试***及方法 | |
CN105371859A (zh) | 基于安全驾驶地图的车道级别的导航引导***和方法 | |
CN114509065B (zh) | 地图构建方法、***、车辆终端、服务器端及存储介质 | |
CN116518960B (zh) | 路网更新方法、装置、电子设备和存储介质 | |
CN111737840B (zh) | 一种用于自动路径规划的交通沙盘地图构建与应用方法 | |
CN113191342A (zh) | 车道定位方法及电子设备 | |
CN114299712A (zh) | 一种数据处理方法、装置、设备以及可读存储介质 | |
CN113848749A (zh) | 自动驾驶仿真测试***、方法、电子设备及存储介质 | |
Boubakri et al. | High definition map update for autonomous and connected vehicles: A survey | |
KR102589296B1 (ko) | 항공사진을 이용하여 3차원 지도를 생성하는 장치 및 방법 | |
CN116225029B (zh) | 一种机器人路径规划方法 | |
Gomes et al. | Driver-centric VANET simulation | |
CN117152958A (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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: 4 / F, building 1, No.14 Jiuxianqiao Road, Chaoyang District, Beijing 100020 Applicant after: Beijing Jingwei Hirain Technologies Co.,Inc. Address before: 8 / F, block B, No. 11, Anxiang Beili, Chaoyang District, Beijing 100101 Applicant before: Beijing Jingwei HiRain Technologies Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |