[发明专利]一种自动驾驶决策与控制联合仿真模型的构建方法

说明书

本发明公开了一种自动驾驶决策与控制联合仿真模型的构建方法，通过搭建仿真道路环境代替真实道路，通过模拟车辆模型代替实际车辆，通过清晰直观的simulink建模代替繁琐的编写和调试软件。使得决策和控制算法在开发早期进行可行性验证成为可能，并能够更加快速的定位系统漏洞，提高了自动驾驶软件开发的效率，同时减小了实车验证算法时的交通安全问题和经济成本。

技术领域

本发明涉及自动驾驶领域的软件建模仿真领域，更具体地说，涉及一种自动驾驶决策与控制联合仿真模型的构建方法。

背景技术

自动驾驶核心功能主要包括感知、决策、控制部分。通过软件建模仿真的方式搭建道路模型、车辆模型和算法模型，可以在开发早期对比验证各种算法的优劣性。决策和控制联合仿真的目的是解决自动驾驶算法开发中的效率问题，通过车辆模型替换实车，可以更加安全和高效的验证决策和控制系统的稳定性。并且，通过模型直接生成代码和报告，将代码下载到各种快速原型设备上去测试验证，能够减少软件工程师编写代码的时间。

传统开发嵌入式软件的方式是直接通过ECU来控制各种外设，验证软件是否满足功能需求。该方式对于自动驾驶决策和控制系统的开发来说则是直接将软件烧录到自动驾驶控制器中，通过控制器直接控制车辆在实际道路环境中行驶，通过观察车辆运动的轨迹和车辆控制的舒适性等是否满足需求来评估软件的优劣性。使用这种开发方式，存在以下问题：

1、在软件算法开发的早期，可能存在各种无法预测的问题，使用该软件直接控制车辆在实际道路上行驶，可能会由于软件问题造成严重的交通事故，存在很大的危险性。

2、需要花费大量时间和精力在各种不同的道路环境下测试和调试才能验证决策和控制软件系统的性能，开发效率较低。

3、在实车环境上调试，由于不是理想环境，可能造成相同的算法由于环境的变化或传感器噪声的影响，出现不同的结果，不便于分析问题原因。

发明内容

本发明要解决的技术问题在于，针对现有技术中自动驾驶决策和控制系统测试和验证困难的缺陷，提供自动驾驶决策与控制联合仿真模型的构建方法。

本发明解决其技术问题所采用的技术方案是：构造一种自动驾驶决策与控制联合仿真模型的构建方法，包含如下步骤：

在prescan仿真软件中搭建各种不同的驾驶道路场景；

在carsim仿真软件中根据实际被控车辆的参数来搭建相同性能的仿真车辆，并为仿真车辆配置驱动系统来控制仿真车辆的运行，驱动系统所需的输入参数为：方向盘角度以及油门或刹车踏板位置，输出参数为：车辆位置、车辆速度、车辆航向角及车辆横摆角速度；

在simulink软件中搭建综合处理仿真模型，加载prescan仿真软件中搭建的驾驶道路场景，同时加载carsim仿真软件的搭建的仿真车辆；所述综合处理仿真模型包括决策系统和控制系统；

决策系统根据carsim仿真软件提供的当前的车辆位置、prescan仿真软件提供的仿真车辆所处的驾驶道路场景进行路径规划，计算出下一时刻的期望位置以及期望航向角；决策系统中预设有目标速度；

控制系统根据决策系统计算出的下一时刻的期望位置以及期望航向角、预设的目标速度，以及carsim仿真软件提供的车辆位置与车辆速度，计算出油门或刹车位置，以及方向盘角度，然后将计算结果发给carsim仿真软件中的驱动系统来控制仿真车辆运行；

仿真车辆输出的车辆位置、车辆速度、车辆航向角及车辆横摆角速度又作为下一时刻决策系统和控制系统的输入，从而形成一个闭环，控制车辆沿着目标路径行使。

进一步地，在本发明的自动驾驶决策与控制联合仿真模型的构建方法，还包括在simulink中添加自定义的GUI界面和示波器模块，实时显示仿真车辆的位置和速度。