CN112462776A - 一种基于非结构化道路的无人驾驶决策方法 - Google Patents

一种基于非结构化道路的无人驾驶决策方法 Download PDF

Info

Publication number
CN112462776A
CN112462776A CN202011372788.0A CN202011372788A CN112462776A CN 112462776 A CN112462776 A CN 112462776A CN 202011372788 A CN202011372788 A CN 202011372788A CN 112462776 A CN112462776 A CN 112462776A
Authority
CN
China
Prior art keywords
decision
information
vehicle
unmanned
precision map
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.)
Pending
Application number
CN202011372788.0A
Other languages
English (en)
Inventor
路晓冬
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Dilu Technology Co Ltd
Original Assignee
Dilu Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Dilu Technology Co Ltd filed Critical Dilu Technology Co Ltd
Priority to CN202011372788.0A priority Critical patent/CN112462776A/zh
Publication of CN112462776A publication Critical patent/CN112462776A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS

Abstract

本发明公开了一种基于非结构化道路的无人驾驶决策方法,首先读取多源信息,包括感知信息,定位信息,高精地图信息,道路规划信息;构建决策框架,包括宏观决策,微观决策和安全决策;实时结合多源信息,输出决策指令,下发给规划控制模块,最终实现无人车在非结构化道路上的行驶。

Description

一种基于非结构化道路的无人驾驶决策方法
技术领域
本发明涉及一种基于非结构化道路的无人驾驶决策方法,属于决策算法领域。
背景技术
无人驾驶汽车是智能汽车的一种,也称为轮式移动机器人,主要依靠车内的以计算机系统为主的智能驾驶仪来实现无人驾驶的目的。无人驾驶汽车是通过车载传感系统感知道路环境,自动规划行车路线并控制车辆到达预定目标的智能汽车。它是利用车载传感器来感知车辆周围环境,并根据感知所获得的道路、车辆位置和障碍物信息,控制车辆的转向和速度,从而使车辆能够安全、可靠地在道路上行驶。
现有无人驾驶决策算法全部是针对于结构化道路来进行开发,包括感知模块、定位模块、决策模块、运动规划模块和车辆控制模块;决策模块根据感知模块,定位模块以及运动规划模块采集的数据输出决策动作;运动规划模块根据决策动作,输出最优轨迹至轨迹追踪模块。
发明内容
本发明为解决现有算法中仅仅适用于结构化场景,过于依赖规则,决策算法死板固化,无法做到全场景覆盖,会导致的安全问题,提供了一种基于非结构化道路的无人驾驶决策方法。
本发明为解决上述技术问题采用以下技术方案:
一种基于非结构化道路的无人驾驶决策方法,具体步骤如下:
步骤1、实时获取无人驾驶汽车的多源信息,多源信息包括感知信息以及高精地图信息;
步骤2、根据步骤1获取的信息,实时监管突发情况,根据实时车速调整紧急刹车阈值,以决策是否紧急刹车;
步骤3、根据步骤1获取的信息,进行宏观决策,宏观决策包括车辆前进、变道超车、通过路口、路边停车和紧急情况五类;
步骤4、在步骤2中的宏观决策的基础上,进行微观决策,微观决策包括路径长度和左右限制边界、路径上的速度限制边界以及时间上的位置限制边界。
进一步,步骤1中感知信息是通过单目相机/双目相机、激光雷达/毫米波雷达并结合深度学习获取的本车周围环境信息。
进一步,步骤1中高精地图信息是基于高精地图得到的从起点到终点的路径规划信息以及实时获取的本车在高精地图中的定位信息。
进一步,将单目相机/双目相机、激光雷达/毫米波雷达感知到的障碍物信息,转换到高精地图坐标系下,并添加至高精地图。
进一步,在高精地图上设置起点和终点,使用全局规划算法,进行全局路径规划。
进一步,利用GPS和激光SLAM算法,实时获取本车在高精地图上的定位。
进一步,步骤3具体为:
步骤3.1:根据本车的实时车速,获得刹车距离X;
步骤3.2:利用实时获取的感知信息,检测本车周围的障碍物,并预测障碍物的运动轨迹;
步骤3.3:确定障碍物的运动轨迹和本车的路径规划的交点,并计算本车实时位置到交点的距离;
步骤3.4,若步骤3.3中得到的距离小于或等于刹车距离X,则需要紧急刹车,否则进行行驶。
本发明采用以上技术方案与现有技术相比,具有以下技术效果:
本决策方法不依赖结构化场景限制,模拟老司机开车决策思路,脱离场景概念,实现全路况覆盖,融合多源数据,直接进行行为决策,落地可能性和安全性大大提高。
附图说明
图1是本发明的流程图。
具体实施方式
本发明一种基于非结构化道路的无人驾驶决策方法,如图1所示,首先读取多源信息,包括感知信息,定位信息,高精地图信息,道路规划信息;构建决策框架,包括宏观决策,微观决策和安全决策;实时结合多源信息,输出决策指令,下发给规划控制模块,最终实现无人车在非结构化道路上的行驶。
步骤1:通过单目相机/双目相机、激光雷达/毫米波雷达,结合深度学习去获取本车周围环境信息,如行人、车辆、石头等障碍物信息;
步骤2:基于高精地图信息,得到从起点到终点的路径规划信息,并实时获取本车在高精地图中的定位信息;
步骤3:实时去监管突发情况,根据本车实时车速去调整紧急刹车阈值,来决策是否紧急刹车.
步骤4:读取步骤1和步骤2的输入信息,进行决策,主要是指对车身当前处于环境进行判断,在宏观决策中,将环境分为车辆前进、变道超车、通过路口、路边停车以及紧急情况五类;
步骤5:基于宏观决策输出,再结合高精地图信息,来输出路径长度和左右限制边界、路径上的速度限制边界以及时间上的位置限制边界,实现微观决策。
步骤1具体包括:
步骤1.1:使用单目相机/双目相机、激光雷达/毫米波雷达去得到车身周围的稠密感知;
步骤1.2:统计所有障碍物信息,并将其距离信息转换为在高精地图坐标系下的信息,并添加至高精地图。
步骤2具体包括:
步骤2.1:在高精地图上设置起点和终点,使用全局规划算法,进行全局路径规划;
步骤2.2:利用GPS和激光SLAM算法,实时获取本车在高精地图上的定位位置。
步骤3具体包括:
步骤3.1:根据本车的实时车速,获得刹车距离X;
步骤3.2:利用实时获取的感知信息,检测本车周围的障碍物,并预测障碍物的运动轨迹;
步骤3.3:确定障碍物的运动轨迹和本车的路径规划的交点,并计算本车实时位置到交点的距离;
步骤3.4,若步骤3.3中得到的距离小于或等于刹车距离X,则需要紧急刹车,否则进行行驶。
步骤4具体包括:
步骤4.1:读取本车定位信息和车身周围环境信息.若本车静止且未到达终点,下达命令至规划,进入车辆前进规划;
步骤4.2:若本车前进轨迹上出现静态障碍物,则下发变道超车的命令,进行路径规划;
步骤4.3:若本车通过定位信息和高精地图信息获得本车已距离路口距离小于某个值,经验设置为50米,则下发通过路口命令;
步骤4.4:若本车通过定位信息和高精地图信息获得本车距离终点小于某个值,经验设置为50米,则下发路边停车场景。
步骤5具体包括:
步骤5.1:针对步骤4输出的不同场景,来设置不同的输出结果;
步骤5.2:若当前场景是车辆前进,则将路径长度和左右限制边界设置为当前道路边界或车道边界,路径长度为50米,速度为当前车道允许车速的80%;当进行变道超车时,左右边界变为相邻右车道和本车道,速度应适当减速,保证安全性;当进行通过路口时,左右边界为虚拟车道边界,速度应根据交规进行控制,这部分工作由规划模块进行,本文不做具体分析。
应当指出,以上实施例的说明只是用于帮助理解本申请的方法及其核心思想,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以对本申请进行若干改进和修饰,这些改进和修饰也在本申请权利要求的保护范围内。

Claims (7)

1.一种基于非结构化道路的无人驾驶决策方法,其特征在于,具体步骤如下:
步骤1、实时获取无人驾驶汽车的多源信息,多源信息包括感知信息以及高精地图信息;
步骤2、根据步骤1获取的信息,实时监管突发情况,根据实时车速调整紧急刹车阈值,以决策是否紧急刹车;
步骤3、根据步骤1获取的信息,进行宏观决策,宏观决策包括车辆前进、变道超车、通过路口、路边停车和紧急情况五类;
步骤4、在步骤2中的宏观决策的基础上,进行微观决策,微观决策包括路径长度和左右限制边界、路径上的速度限制边界以及时间上的位置限制边界。
2.如权利要求1所述的一种基于非结构化道路的无人驾驶决策方法,其特征在于,步骤1中感知信息是通过单目相机/双目相机、激光雷达/毫米波雷达并结合深度学习获取的本车周围环境信息。
3.如权利要求1所述的一种基于非结构化道路的无人驾驶决策方法,其特征在于,步骤1中高精地图信息是基于高精地图得到的从起点到终点的路径规划信息以及实时获取的本车在高精地图中的定位信息。
4.如权利要求2所述的一种基于非结构化道路的无人驾驶决策方法,其特征在于,将单目相机/双目相机、激光雷达/毫米波雷达感知到的障碍物信息,转换到高精地图坐标系下,并添加至高精地图。
5.如权利要求3所述的一种基于非结构化道路的无人驾驶决策方法,其特征在于,在高精地图上设置起点和终点,使用全局规划算法,进行全局路径规划。
6.如权利要求3所述的一种基于非结构化道路的无人驾驶决策方法,其特征在于,利用GPS和激光SLAM算法,实时获取本车在高精地图上的定位。
7.如权利要求1所述的一种基于非结构化道路的无人驾驶决策方法,其特征在于,步骤3具体为:
步骤3.1:根据本车的实时车速,获得刹车距离X;
步骤3.2:利用实时获取的感知信息,检测本车周围的障碍物,并预测障碍物的运动轨迹;
步骤3.3:确定障碍物的运动轨迹和本车的路径规划的交点,并计算本车实时位置到交点的距离;
步骤3.4,若步骤3.3中得到的距离小于或等于刹车距离X,则需要紧急刹车,否则进行行驶。
CN202011372788.0A 2020-11-30 2020-11-30 一种基于非结构化道路的无人驾驶决策方法 Pending CN112462776A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011372788.0A CN112462776A (zh) 2020-11-30 2020-11-30 一种基于非结构化道路的无人驾驶决策方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011372788.0A CN112462776A (zh) 2020-11-30 2020-11-30 一种基于非结构化道路的无人驾驶决策方法

Publications (1)

Publication Number Publication Date
CN112462776A true CN112462776A (zh) 2021-03-09

Family

ID=74806473

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011372788.0A Pending CN112462776A (zh) 2020-11-30 2020-11-30 一种基于非结构化道路的无人驾驶决策方法

Country Status (1)

Country Link
CN (1) CN112462776A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114003026A (zh) * 2021-06-22 2022-02-01 的卢技术有限公司 一种基于Apollo框架改进的变道机制

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170364083A1 (en) * 2016-06-21 2017-12-21 Baidu Online Network Technology (Beijing) Co., Ltd. Local trajectory planning method and apparatus for smart vehicles
CN110568841A (zh) * 2019-08-05 2019-12-13 西藏宁算科技集团有限公司 一种自动驾驶决策方法及系统
CN111289978A (zh) * 2020-02-13 2020-06-16 北京享云智汇科技有限公司 一种车辆无人驾驶行为决策的方法和系统
CN111473794A (zh) * 2020-04-01 2020-07-31 北京理工大学 一种基于强化学习的结构化道路无人驾驶决策规划方法
CN111489578A (zh) * 2020-04-01 2020-08-04 北京理工大学 一种基于车道时空间隙的高速道路无人驾驶决策规划方法
CN111873995A (zh) * 2020-08-04 2020-11-03 禾多科技(北京)有限公司 高速公路自动驾驶上下匝道的系统及方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170364083A1 (en) * 2016-06-21 2017-12-21 Baidu Online Network Technology (Beijing) Co., Ltd. Local trajectory planning method and apparatus for smart vehicles
CN110568841A (zh) * 2019-08-05 2019-12-13 西藏宁算科技集团有限公司 一种自动驾驶决策方法及系统
CN111289978A (zh) * 2020-02-13 2020-06-16 北京享云智汇科技有限公司 一种车辆无人驾驶行为决策的方法和系统
CN111473794A (zh) * 2020-04-01 2020-07-31 北京理工大学 一种基于强化学习的结构化道路无人驾驶决策规划方法
CN111489578A (zh) * 2020-04-01 2020-08-04 北京理工大学 一种基于车道时空间隙的高速道路无人驾驶决策规划方法
CN111873995A (zh) * 2020-08-04 2020-11-03 禾多科技(北京)有限公司 高速公路自动驾驶上下匝道的系统及方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114003026A (zh) * 2021-06-22 2022-02-01 的卢技术有限公司 一种基于Apollo框架改进的变道机制

Similar Documents

Publication Publication Date Title
US11532167B2 (en) State machine for obstacle avoidance
CN109583151B (zh) 车辆的行驶轨迹预测方法及装置
US10703362B2 (en) Autonomous driving autonomous system, automated driving assistance method, and computer program
US11427191B2 (en) Obstacle avoidance action
CN112193244B (zh) 基于线性约束的自动驾驶车辆运动规划方法
US20220234615A1 (en) In-vehicle device and driving assist method
EP4018427A1 (en) Method of handling occlusions at intersections in operation of autonomous vehicle
CN113254806A (zh) 预测行人的移动的系统和方法
KR102613822B1 (ko) 다중 차선 방향전환 전체에 걸친 차량들의 제어
Kim et al. Automated complex urban driving based on enhanced environment representation with GPS/map, radar, lidar and vision
JP2019159428A (ja) 車両制御装置、車両制御方法及びプログラム
JP2019160031A (ja) 車両制御装置、車両制御方法、およびプログラム
WO2021086781A1 (en) Obstacle avoidance action
JP2019156271A (ja) 車両制御装置、車両制御方法、およびプログラム
US20220262133A1 (en) Detecting potentially occluded objects for autonomous vehicles
EP3842315B1 (en) Autonomous driving vehicle three-point turn
JP7341806B2 (ja) 運転制御方法及び運転制御装置
JP7379033B2 (ja) 運転支援方法及び運転支援装置
Yoneda et al. Trajectory optimization and state selection for urban automated driving
CN111103882A (zh) 一种无人驾驶电动汽车的自主跟车控制方法
CN112462776A (zh) 一种基于非结构化道路的无人驾驶决策方法
WO2016170683A1 (ja) 走行制御装置およびデータ構造
CN114572250A (zh) 一种自动驾驶通过交叉路口的方法及存储介质
CN112970052B (zh) 车辆控制系统
CN117916682A (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
RJ01 Rejection of invention patent application after publication

Application publication date: 20210309

RJ01 Rejection of invention patent application after publication