CN113183981A - 一种自动驾驶背景下的非机动车过街路权协商系统 - Google Patents

一种自动驾驶背景下的非机动车过街路权协商系统 Download PDF

Info

Publication number
CN113183981A
CN113183981A CN202110233675.0A CN202110233675A CN113183981A CN 113183981 A CN113183981 A CN 113183981A CN 202110233675 A CN202110233675 A CN 202110233675A CN 113183981 A CN113183981 A CN 113183981A
Authority
CN
China
Prior art keywords
module
automatic driving
motor vehicle
decision
vehicle
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.)
Granted
Application number
CN202110233675.0A
Other languages
English (en)
Other versions
CN113183981B (zh
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.)
Ningbo University
Original Assignee
Ningbo University
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 Ningbo University filed Critical Ningbo University
Priority to CN202110233675.0A priority Critical patent/CN113183981B/zh
Publication of CN113183981A publication Critical patent/CN113183981A/zh
Application granted granted Critical
Publication of CN113183981B publication Critical patent/CN113183981B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00—Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001—Planning or execution of driving tasks
    • B60W60/0015—Planning or execution of driving tasks specially adapted for safety
    • B60W60/0017—Planning or execution of driving tasks specially adapted for safety of other traffic participants
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00—Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001—Planning or execution of driving tasks
    • B60W60/0027—Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/01—Detecting movement of traffic to be counted or controlled
    • G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/09—Arrangements for giving variable traffic instructions
    • G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
    • G08G1/096708—Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control
    • G08G1/096725—Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control where the received information generates an automatic action on the vehicle control
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/06—Direction of travel
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/10—Longitudinal speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/10—Longitudinal speed
    • B60W2520/105—Longitudinal acceleration
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/40—Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404—Characteristics
    • B60W2554/4041—Position
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/40—Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404—Characteristics
    • B60W2554/4042—Longitudinal speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/40—Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404—Characteristics
    • B60W2554/4044—Direction of movement, e.g. backwards

Abstract

本发明公开了一种自动驾驶背景下的非机动车过街路权协商系统，包括环境感知模块、决策模块、输出模块和反馈模块，环境感知模块包括自动驾驶车载监控模块、非机动车载监控模块、路侧监控模块，输出模块包括自动驾驶车辆输出模块和非机动车输出模块，当自动驾驶车辆与非机动车在街口相遇时，自动驾驶车载监控模块获取自动驾驶车辆速度、加速度和行车方向信息并输出给决策模块，非机动车车载监控模块获取非机动车速度、加速度和行车方向信息并输出给决策模块，决策模块对其接收的信息进行处理并生成相应决策信号输出，自动驾驶车辆输出模块执行来自决策模块的决策信号；优点是能够兼顾非机动车过街安全与自动驾驶车辆通行效率。

Description

一种自动驾驶背景下的非机动车过街路权协商系统
技术领域
本发明涉及一种非机动车过街路权协商系统，尤其是涉及一种自动驾驶背景下的非机动车过街路权协商系统。
背景技术
据统计，我国机动车保有量超3.6亿辆，非机动车保有量超4亿辆，机动车与非机动车混合通行是我国城市交通的重要特征。2019年我国非机动车伤亡人数达1.3万人，其中在非机动车过街这一时段发生的伤亡占很大一部分。
目前，非机动车驾驶人在无信号灯情况下过街时与司机通过眼神或者手势等方式表达是否让行的意图，提高过街的安全性。而在自动驾驶背景下，自动驾驶车辆需要通过对非机动车的意图进行预测来实施相应的车辆控制。自动驾驶车辆对非机动车的有效意图预测的前提和基础是准确的环境感知，由于非机动车相比较机动车体积小，且数量众多，易相互遮挡，自动驾驶车辆搭载的环境感知传感器无法非常准确地获取非机动车的信息；另外，自动驾驶车辆无法准确识别非机动车驾驶人意图，非机动车驾驶人也难以掌握自动驾驶车辆的行驶意图，即双方无法通过进行有效的信息交换来确认路权。由此，自动驾驶车辆被编程为默认在非机动车过街时无条件让行来保障非机动车过街安全，这将致使大量自动驾驶车辆排队现象的出现，自动驾驶车辆通行效率显著降低。
发明内容
本发明所要解决的技术问题是提供一种能够兼顾非机动车过街安全与自动驾驶车辆通行效率的自动驾驶背景下的非机动车过街路权协商系统。
本发明解决上述技术问题所采用的技术方案为：一种自动驾驶背景下的非机动车过街路权协商系统，包括环境感知模块、决策模块、输出模块和反馈模块，所述的环境感知模块包括自动驾驶车载监控模块、非机动车载监控模块、路侧监控模块，所述的输出模块包括自动驾驶车辆输出模块和非机动车输出模块，所述的自动驾驶车载监控模块和所述的自动驾驶车辆输出模块搭载在自动驾驶车辆上，所述的非机动车车载监控模块、所述的非机动车输出模块和所述的反馈模块搭载在非机动车上，所述的路侧监控模块安装在非机动车过街路侧；所述的自动驾驶车载监控模块用于获取自动驾驶车辆速度、加速度和行车方向信息并输出给所述的决策模块，所述的非机动车车载监控模块用于获取非机动车速度、加速度和行车方向信息并输出给所述的决策模块，所述的路侧监控模块用于获取自动驾驶车辆位置信息和非机动车位置信息并输出给所述的决策模块，所述的决策模块能够对输入其内的信息进行处理生成对应的决策信号输出，所述的决策模块还能够通过所述的自动驾驶车辆输出模块输出对非机动车驾驶人的提示信息，所述的自动驾驶车辆输出模块用于执行来自决策模块的决策信号，所述的反馈模块用于将非机动车驾驶人输入其内的反馈信息输出给所述的决策模块；当自动驾驶车辆与非机动车在街口相遇时，所述的自动驾驶车载监控模块获取自动驾驶车辆速度、加速度和行车方向信息并输出给所述的决策模块，所述的非机动车车载监控模块获取非机动车速度、加速度和行车方向信息并输出给所述的决策模块，所述的决策模块对其接收的信息进行处理并生成相应决策信号输出，在生成相应决策信号过程中，如有需要，所述的决策模块能通过所述的自动驾驶车辆输出模块输出对非机动车驾驶人的提示信息，也能通过所述的反馈模块接收非机动车驾驶人输出的反馈信息，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号。
所述的决策模块生成相应决策信号的具体过程为：
S1、所述的决策模块通过所述的自动驾驶车载监控模块、所述的非机动车载监控模块和所述的路侧监控模块输出的检测信号中的自动驾驶车辆和非机动车的速度、加速度、行车方向和位置信息预测出自动驾驶车辆与非机动车的行驶轨迹；
S2、将以自动驾驶车辆与非机动车预测的行驶轨迹的交汇点为圆心，自动驾驶车辆长度的1.5倍为半径所形成的圆形区域定义为危险区域；
S3、将自动驾车辆到达危险区域起点边缘的时间记为tvs，终点边缘的时间记为tve，非机动车到达危险区域起点边缘的时间记为tns，终点边缘的时间记为tne，非机动车到达危险区域起始边缘前自动驾驶车辆穿越危险区域的速度记为vmax，采用公式(1)～(4)分别计算得到tns、tne、tvs和vmax：
Figure BDA0002959738430000021
Figure BDA0002959738430000031
Figure BDA0002959738430000032
Figure BDA0002959738430000033
其中，min为取最小值符号；dv为自动驾驶车辆当前位置离预测的该自动驾驶车辆将到达的危险区域起始边缘的距离，dv等于所述的决策模块获取的自动驾驶车辆当前位置和预测的该自动驾驶车辆将到达的危险区域起始边缘位置的直线距离；dn为非机动车当前位置离预测的该非机动车将到达的危险区域起始边缘的距离，dn等于所述的决策模块获取的非机动车当前位置和预测的该非机动车将到达的危险区域起始边缘位置的直线距离；vv为自动驾驶车辆当前的速度；vn为非机动车当前的速度；w为危险区域的直径；l为自动驾驶车辆的长度；vlm为自动驾驶车辆允许的最高速度；
S4、比较dv+w+l和
Figure BDA0002959738430000034
的大小，其中al为自动驾驶车辆性能内的最大加速度，根据比较结果确定tve的值，具体为：
如果
Figure BDA0002959738430000035
则令
Figure BDA0002959738430000036
如果
Figure BDA0002959738430000037
则令
Figure BDA0002959738430000038
S5、所述的决策模块分别比较tne和tvs的大小以及tns和tve的大小，基于比较结果生成对应的决策信号输出，具体为：
当tne<tvs或者tve<tns时，所述的决策模块判断自动驾驶车辆和非机动车不存在同时到达危险区域的可能，此时所述的决策模块输出正常通行的决策信号至所述的自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆正常通过街口；
当tne≥tvs且tve≥tns时，所述的决策模块判断自动驾驶车辆和非机动车存在同时到达危险区域的可能，此时所述的决策模块先通过所述的非机动车输出模块以交流信息的方式询问非机动车行驶人是否同意让行，之后，如果所述的决策模块在预设时间内从所述的反馈模块处获取到非机动车行驶人反馈的“是”的有效输入，此时所述的决策模块输出正常通行的决策信号至自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆正常通过街口；
如果所述的决策模块在预设时间内从所述的反馈模块处获取到非机动车行驶人反馈的“否”的有效输入，此时所述的决策模块比较自动驾驶车辆在非机动车到达危险区域前停车所需的最小加速度as和自动驾驶车辆性能内的最大加速度al，根据比较结果确定自动驾驶车辆能否在非机动车到达危险区域前停车,as按如下公式进行计算：
Figure BDA0002959738430000041
当as<al时，所述的决策模块判断自动驾驶车辆能在非机动车到达危险区域前停车，此时所述的决策模块输出禁止通行的决策信号至自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆开始减速并在危险区域前停车，同时所述的决策模块输出能够通行的提醒信号至所述的非机动车输出模块，提醒非机动车驾驶人正常过街；
当as≥al时，所述的决策模块判断自动驾驶车辆不能在非机动车到达危险区域前停车,此时所述的决策模块输出正常通行的决策信号至所述的自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆正常通过街口，同时所述的决策模块输出“前方危险”的提醒信号至所述的非机动车输出模块，提醒非机动车驾驶人让行；
如果所述的决策模块在预设时间内从所述的反馈模块处未获取到非机动车行驶人输入的有效输入信息，此时所述的决策模块利用非机动车监控模块检测到的非机动车加速度和速度信息判断非机动车的“走-停”状态，检测非机动车是否继续前进，当判断非机动车处于继续前进状态时，所述的决策模块按照之前的方法利用当前信息重新判断自动驾驶车辆能否在非机动车到达危险区域前停车，并进行相应操作；当判断非机动车处于停止前进状态时，所述的决策模块输出正常通行的决策信号至所述的自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆正常通过街口。该方法中实现了自动驾驶车辆与非机动车的有效交流，解决非机动车“走-停”困惑，进一步提高通行效率及通行安全性。
与现有技术相比，本发明的优点在于通过环境感知模块、决策模块、输出模块和反馈模块构建自动驾驶背景下的非机动车过街路权协商系统，环境感知模块包括自动驾驶车载监控模块、非机动车载监控模块、路侧监控模块，输出模块包括自动驾驶车辆输出模块和非机动车输出模块，自动驾驶车载监控模块和自动驾驶车辆输出模块搭载在自动驾驶车辆上，非机动车车载监控模块、非机动车输出模块和反馈模块搭载在非机动车上，路侧监控模块安装在非机动车过街路侧；自动驾驶车载监控模块用于获取自动驾驶车辆速度、加速度和行车方向信息并输出给决策模块，非机动车车载监控模块用于获取非机动车速度、加速度和行车方向信息并输出给决策模块，路侧监控模块用于获取自动驾驶车辆位置信息和非机动车位置信息并输出给决策模块，决策模块能够对输入其内的信息进行处理生成对应的决策信号输出，决策模块还能够通过自动驾驶车辆输出模块输出对非机动车驾驶人的提示信息，自动驾驶车辆输出模块用于执行来自决策模块的决策信号，反馈模块用于将非机动车驾驶人输入其内的反馈信息输出给决策模块；当自动驾驶车辆与非机动车在街口相遇时，自动驾驶车载监控模块获取自动驾驶车辆速度、加速度和行车方向信息并输出给决策模块，非机动车车载监控模块获取非机动车速度、加速度和行车方向信息并输出给决策模块，决策模块对其接收的信息进行处理并生成相应决策信号输出，在生成相应决策信号过程中，如有需要，决策模块能通过自动驾驶车辆输出模块输出对非机动车驾驶人的提示信息，也能通过反馈模块接收非机动车驾驶人输出的反馈信息，自动驾驶车辆输出模块执行来自决策模块的决策信号，由此本发明通过环境感知模块、决策模块、输出模块和反馈模块将自动驾驶车辆与非机动车之间进行紧密衔接，大幅提升自动驾驶车辆对非机动车的环境感知能力，实现了自动驾驶车辆与非机动车的自动路权协商，保障非机动车过街安全的同时提高自动驾驶车辆通行效率。
附图说明
图1为本发明的自动驾驶背景下的非机动车过街路权协商系统的结构图一；
图2为本发明的自动驾驶背景下的非机动车过街路权协商系统的结构图二；
图3为本发明的自动驾驶背景下的非机动车过街路权协商系统的工作流程图；
图4为本发明的自动驾驶背景下的非机动车过街路权协商系统的一种应用环境示意图。
具体实施方式
以下结合附图实施例对本发明作进一步详细描述。
实施例：如图1和图2所示，一种自动驾驶背景下的非机动车过街路权协商系统，包括环境感知模块、决策模块、输出模块和反馈模块，环境感知模块包括自动驾驶车载监控模块、非机动车载监控模块、路侧监控模块，输出模块包括自动驾驶车辆输出模块和非机动车输出模块，自动驾驶车载监控模块和自动驾驶车辆输出模块搭载在自动驾驶车辆上，非机动车车载监控模块、非机动车输出模块和反馈模块搭载在非机动车上，路侧监控模块安装在非机动车过街路侧；自动驾驶车载监控模块用于获取自动驾驶车辆速度、加速度和行车方向信息并输出给决策模块，非机动车车载监控模块用于获取非机动车速度、加速度和行车方向信息并输出给决策模块，路侧监控模块用于获取自动驾驶车辆位置信息和非机动车位置信息并输出给决策模块，决策模块能够对输入其内的信息进行处理生成对应的决策信号输出，决策模块还能够通过自动驾驶车辆输出模块输出对非机动车驾驶人的提示信息，自动驾驶车辆输出模块用于执行来自决策模块的决策信号，反馈模块用于将非机动车驾驶人输入其内的反馈信息输出给决策模块；当自动驾驶车辆与非机动车在街口相遇时，自动驾驶车载监控模块获取自动驾驶车辆速度、加速度和行车方向信息并输出给决策模块，非机动车车载监控模块获取非机动车速度、加速度和行车方向信息并输出给决策模块，决策模块对其接收的信息进行处理并生成相应决策信号输出，在生成相应决策信号过程中，如有需要，决策模块能通过自动驾驶车辆输出模块输出对非机动车驾驶人的提示信息，也能通过反馈模块接收非机动车驾驶人输出的反馈信息，自动驾驶车辆输出模块执行来自决策模块的决策信号。
本实施例中，如图3所示，决策模块生成相应决策信号的具体过程为：
S1、决策模块通过自动驾驶车载监控模块、非机动车载监控模块和路侧监控模块输出的检测信号中的自动驾驶车辆和非机动车的速度、加速度、行车方向和位置信息预测出自动驾驶车辆与非机动车的行驶轨迹；
S2、将以自动驾驶车辆与非机动车预测的行驶轨迹的交汇点为圆心，自动驾驶车辆长度的1.5倍为半径所形成的圆形区域定义为危险区域；
S3、将自动驾车辆到达危险区域起点边缘的时间记为tvs，终点边缘的时间记为tve，非机动车到达危险区域起点边缘的时间记为tns，终点边缘的时间记为tne，非机动车到达危险区域起始边缘前自动驾驶车辆穿越危险区域的速度记为vmax，采用公式(1)～(4)分别计算得到tns、tne、tvs和vmax：
Figure BDA0002959738430000061
Figure BDA0002959738430000062
Figure BDA0002959738430000071
Figure BDA0002959738430000072
其中，min为取最小值符号；dv为自动驾驶车辆当前位置离预测的该自动驾驶车辆将到达的危险区域起始边缘的距离，dv等于决策模块获取的自动驾驶车辆当前位置和预测的该自动驾驶车辆将到达的危险区域起始边缘位置的直线距离；dn为非机动车当前位置离预测的该非机动车将到达的危险区域起始边缘的距离，dn等于决策模块获取的非机动车当前位置和预测的该非机动车将到达的危险区域起始边缘位置的直线距离；vv为自动驾驶车辆当前的速度；vn为非机动车当前的速度；w为危险区域的直径；l为自动驾驶车辆的长度；vlm为自动驾驶车辆允许的最高速度；
S4、比较dv+w+l和
Figure BDA0002959738430000073
的大小，其中al为自动驾驶车辆性能内的最大加速度，根据比较结果确定tve的值，具体为：
如果
Figure BDA0002959738430000074
则令
Figure BDA0002959738430000075
如果
Figure BDA0002959738430000076
则令
Figure BDA0002959738430000077
S5、决策模块分别比较tne和tvs的大小以及tns和tve的大小，基于比较结果生成对应的决策信号输出，具体为：
当tne<tvs或者tve<tns时，决策模块判断自动驾驶车辆和非机动车不存在同时到达危险区域的可能，此时决策模块输出正常通行的决策信号至自动驾驶车辆输出模块，自动驾驶车辆输出模块执行来自决策模块的决策信号，控制自动驾驶车辆正常通过街口；
当tne≥tvs且tve≥tns时，决策模块判断自动驾驶车辆和非机动车存在同时到达危险区域的可能，此时决策模块先通过非机动车输出模块以交流信息的方式询问非机动车行驶人是否同意让行，之后，如果决策模块在预设时间内从反馈模块处获取到非机动车行驶人反馈的“是”的有效输入，此时决策模块输出正常通行的决策信号至自动驾驶车辆输出模块，自动驾驶车辆输出模块执行来自决策模块的决策信号，控制自动驾驶车辆正常通过街口；
如果决策模块在预设时间内从反馈模块处获取到非机动车行驶人反馈的“否”的有效输入，此时决策模块比较自动驾驶车辆在非机动车到达危险区域前停车所需的最小加速度as和自动驾驶车辆性能内的最大加速度al，根据比较结果确定自动驾驶车辆能否在非机动车到达危险区域前停车,s按如下公式进行计算：
Figure BDA0002959738430000081
当as<al时，决策模块判断自动驾驶车辆能在非机动车到达危险区域前停车，此时决策模块输出禁止通行的决策信号至自动驾驶车辆输出模块，自动驾驶车辆输出模块执行来自决策模块的决策信号，控制自动驾驶车辆开始减速并在危险区域前停车，同时决策模块输出能够通行的提醒信号至非机动车输出模块，提醒非机动车驾驶人正常过街；
当as≥al时，决策模块判断自动驾驶车辆不能在非机动车到达危险区域前停车,此时决策模块输出正常通行的决策信号至自动驾驶车辆输出模块，自动驾驶车辆输出模块执行来自决策模块的决策信号，控制自动驾驶车辆正常通过街口，同时决策模块输出“前方危险”的提醒信号至非机动车输出模块，提醒非机动车驾驶人让行；
如果决策模块在预设时间内从反馈模块处未获取到非机动车行驶人输入的有效输入信息，此时决策模块利用非机动车监控模块检测到的非机动车加速度和速度信息判断非机动车的“走-停”状态，检测非机动车是否继续前进，当判断非机动车处于继续前进状态时，决策模块按照之前的方法利用当前信息重新判断自动驾驶车辆能否在非机动车到达危险区域前停车，并进行相应操作；当判断非机动车处于停止前进状态时，决策模块输出正常通行的决策信号至自动驾驶车辆输出模块，自动驾驶车辆输出模块执行来自决策模块的决策信号，控制自动驾驶车辆正常通过街口。
本实施例中，反馈模块可以被设置为接收非机动车驾驶人的语音输入的麦克风，或供非机动车驾驶人选择的按钮等。决策模块可以选择专用的电控装置，也可以使用车辆的ECU(电控单元)。此外，决策模块可以为车载装置，搭载在自动驾驶车辆上，也可以设置为远程控制单元，并与其他模块以有线和/或无线的方式进行通讯。
图4展示了本发明的自动驾驶背景下的非机动车过街路权协商系统的一种应用环境。如图4所示，自动驾驶车辆在道路上行驶，自动驾驶车辆的前方有一人行横道，人行横道旁有非机动车和路侧监控设施，非机动车部分被障碍遮挡，自动驾驶车辆无法通过自身传感器准确获取全非机动车的信息。本发明可使自动驾驶车辆行至人行横道附近时，判断出非机动车是否需要过街，并与非机动车通过相互交流协商的形式确认路权。本发明也可以用于与图4不同的环境。比如，在无信号交叉口，非机动车可以横穿马路；又比如在没有设置路口的路段，无隔离栏进行隔离，非机动车同样可能横穿道路。

Claims (2)

1.一种自动驾驶背景下的非机动车过街路权协商系统，其特征在于包括环境感知模块、决策模块、输出模块和反馈模块，所述的环境感知模块包括自动驾驶车载监控模块、非机动车载监控模块、路侧监控模块，所述的输出模块包括自动驾驶车辆输出模块和非机动车输出模块，所述的自动驾驶车载监控模块和所述的自动驾驶车辆输出模块搭载在自动驾驶车辆上，所述的非机动车车载监控模块、所述的非机动车输出模块和所述的反馈模块搭载在非机动车上，所述的路侧监控模块安装在非机动车过街路侧；所述的自动驾驶车载监控模块用于获取自动驾驶车辆速度、加速度和行车方向信息并输出给所述的决策模块，所述的非机动车车载监控模块用于获取非机动车速度、加速度和行车方向信息并输出给所述的决策模块，所述的路侧监控模块用于获取自动驾驶车辆位置信息和非机动车位置信息并输出给所述的决策模块，所述的决策模块能够对输入其内的信息进行处理生成对应的决策信号输出，所述的决策模块还能够通过所述的自动驾驶车辆输出模块输出对非机动车驾驶人的提示信息，所述的自动驾驶车辆输出模块用于执行来自决策模块的决策信号，所述的反馈模块用于将非机动车驾驶人输入其内的反馈信息输出给所述的决策模块；当自动驾驶车辆与非机动车在街口相遇时，所述的自动驾驶车载监控模块获取自动驾驶车辆速度、加速度和行车方向信息并输出给所述的决策模块，所述的非机动车车载监控模块获取非机动车速度、加速度和行车方向信息并输出给所述的决策模块，所述的决策模块对其接收的信息进行处理并生成相应决策信号输出，在生成相应决策信号过程中，如有需要，所述的决策模块能通过所述的自动驾驶车辆输出模块输出对非机动车驾驶人的提示信息，也能通过所述的反馈模块接收非机动车驾驶人输出的反馈信息，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号。
2.根据权利要求1所述的一种自动驾驶背景下的非机动车过街路权协商系统，其特征在于所述的决策模块生成相应决策信号的具体过程为：
S1、所述的决策模块通过所述的自动驾驶车载监控模块、所述的非机动车载监控模块和所述的路侧监控模块输出的检测信号中的自动驾驶车辆和非机动车的速度、加速度、行车方向和位置信息预测出自动驾驶车辆与非机动车的行驶轨迹；
S2、将以自动驾驶车辆与非机动车预测的行驶轨迹的交汇点为圆心，自动驾驶车辆长度的1.5倍为半径所形成的圆形区域定义为危险区域；
S3、将自动驾车辆到达危险区域起点边缘的时间记为tvs，终点边缘的时间记为tve，非机动车到达危险区域起点边缘的时间记为tns，终点边缘的时间记为tne，非机动车到达危险区域起始边缘前自动驾驶车辆穿越危险区域的速度记为vmax，采用公式(1)～(4)分别计算得到tns、tne、tvs和vmax：
Figure FDA0002959738420000021
Figure FDA0002959738420000022
Figure FDA0002959738420000023
Figure FDA0002959738420000024
其中，min为取最小值符号；dv为自动驾驶车辆当前位置离预测的该自动驾驶车辆将到达的危险区域起始边缘的距离，dv等于所述的决策模块获取的自动驾驶车辆当前位置和预测的该自动驾驶车辆将到达的危险区域起始边缘位置的直线距离；dn为非机动车当前位置离预测的该非机动车将到达的危险区域起始边缘的距离，dn等于所述的决策模块获取的非机动车当前位置和预测的该非机动车将到达的危险区域起始边缘位置的直线距离；vv为自动驾驶车辆当前的速度；vn为非机动车当前的速度；w为危险区域的直径；l为自动驾驶车辆的长度；vlm为自动驾驶车辆允许的最高速度；
S4、比较dv+w+l和
Figure FDA0002959738420000025
的大小，其中al为自动驾驶车辆性能内的最大加速度，根据比较结果确定tve的值，具体为：
如果
Figure FDA0002959738420000026
则令
Figure FDA0002959738420000027
如果
Figure FDA0002959738420000028
则令
Figure FDA0002959738420000029
S5、所述的决策模块分别比较tne和tvs的大小以及tns和tve的大小，基于比较结果生成对应的决策信号输出，具体为：
当tne＜tvs或者tve＜tns时，所述的决策模块判断自动驾驶车辆和非机动车不存在同时到达危险区域的可能，此时所述的决策模块输出正常通行的决策信号至所述的自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆正常通过街口；
当tne≥tvs且tve≥tns时，所述的决策模块判断自动驾驶车辆和非机动车存在同时到达危险区域的可能，此时所述的决策模块先通过所述的非机动车输出模块以交流信息的方式询问非机动车行驶人是否同意让行，之后，如果所述的决策模块在预设时间内从所述的反馈模块处获取到非机动车行驶人反馈的“是”的有效输入，此时所述的决策模块输出正常通行的决策信号至自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆正常通过街口；
如果所述的决策模块在预设时间内从所述的反馈模块处获取到非机动车行驶人反馈的“否”的有效输入，此时所述的决策模块比较自动驾驶车辆在非机动车到达危险区域前停车所需的最小加速度as和自动驾驶车辆性能内的最大加速度al，根据比较结果确定自动驾驶车辆能否在非机动车到达危险区域前停车，as按如下公式进行计算：
Figure FDA0002959738420000031
当as＜al时，所述的决策模块判断自动驾驶车辆能在非机动车到达危险区域前停车，此时所述的决策模块输出禁止通行的决策信号至自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆开始减速并在危险区域前停车，同时所述的决策模块输出能够通行的提醒信号至所述的非机动车输出模块，提醒非机动车驾驶人正常过街；
当as≥al时，所述的决策模块判断自动驾驶车辆不能在非机动车到达危险区域前停车，此时所述的决策模块输出正常通行的决策信号至所述的自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆正常通过街口，同时所述的决策模块输出“前方危险”的提醒信号至所述的非机动车输出模块，提醒非机动车驾驶人让行；
如果所述的决策模块在预设时间内从所述的反馈模块处未获取到非机动车行驶人输入的有效输入信息，此时所述的决策模块利用非机动车监控模块检测到的非机动车加速度和速度信息判断非机动车的“走-停”状态，检测非机动车是否继续前进，当判断非机动车处于继续前进状态时，所述的决策模块按照之前的方法利用当前信息重新判断自动驾驶车辆能否在非机动车到达危险区域前停车，并进行相应操作；当判断非机动车处于停止前进状态时，所述的决策模块输出正常通行的决策信号至所述的自动驾驶车辆输出模块，所述的自动驾驶车辆输出模块执行来自所述的决策模块的决策信号，控制自动驾驶车辆正常通过街口。
CN202110233675.0A 2021-03-03 2021-03-03 一种自动驾驶背景下的非机动车过街路权协商系统 Active CN113183981B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110233675.0A CN113183981B (zh) 2021-03-03 2021-03-03 一种自动驾驶背景下的非机动车过街路权协商系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110233675.0A CN113183981B (zh) 2021-03-03 2021-03-03 一种自动驾驶背景下的非机动车过街路权协商系统

Publications (2)

Publication Number Publication Date
CN113183981A true CN113183981A (zh) 2021-07-30
CN113183981B CN113183981B (zh) 2022-05-13

Family

ID=76973032

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110233675.0A Active CN113183981B (zh) 2021-03-03 2021-03-03 一种自动驾驶背景下的非机动车过街路权协商系统

Country Status (1)

Country Link
CN (1) CN113183981B (zh)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104637315A (zh) * 2015-02-06 2015-05-20 北京交通大学 车路协同环境下的无信号交叉口优化控制方法和系统
CN110696827A (zh) * 2019-11-01 2020-01-17 戴姆勒股份公司 自动驾驶车辆的控制方法
CN111627205A (zh) * 2020-04-28 2020-09-04 南京理工大学 基于碰撞风险的自动驾驶车辆与非机动车辆通行权分配方法
CN111739296A (zh) * 2020-06-19 2020-10-02 长安大学 一种大型公交站点区域乘客与非机动车时空分离方法
CN112289056A (zh) * 2020-09-30 2021-01-29 深圳市金溢科技股份有限公司 路侧设备、路侧系统、车载设备及道路预测方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104637315A (zh) * 2015-02-06 2015-05-20 北京交通大学 车路协同环境下的无信号交叉口优化控制方法和系统
CN110696827A (zh) * 2019-11-01 2020-01-17 戴姆勒股份公司 自动驾驶车辆的控制方法
CN111627205A (zh) * 2020-04-28 2020-09-04 南京理工大学 基于碰撞风险的自动驾驶车辆与非机动车辆通行权分配方法
CN111739296A (zh) * 2020-06-19 2020-10-02 长安大学 一种大型公交站点区域乘客与非机动车时空分离方法
CN112289056A (zh) * 2020-09-30 2021-01-29 深圳市金溢科技股份有限公司 路侧设备、路侧系统、车载设备及道路预测方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
柴琳果: "智能车路协同交叉口间隙耦合运行控制方法", 《 CNKI博士学位论文全文库》 *

Also Published As

Publication number Publication date
CN113183981B (zh) 2022-05-13

Similar Documents

Publication Publication Date Title
US11067987B2 (en) Driving assistance method and driving assistance device
JP5493780B2 (ja) 運転支援装置、運転支援方法及びそのプログラム
US8027762B2 (en) Driving assist apparatus
WO2015156146A1 (ja) 走行制御装置、車載用表示装置、及び走行制御システム
US20180144636A1 (en) Distracted driver detection, classification, warning, avoidance system
KR102020340B1 (ko) 라이다를 이용한 교차로 운행 및 보행 안전 모니터링 시스템
US9336183B2 (en) Vehicle information processing system and driving assistance system
KR101417522B1 (ko) 고속도로 자율주행 시스템 및 방법
JP4760517B2 (ja) 車両減速判定システム、車載装置、路側装置、コンピュータプログラム及び車両減速判定方法
US8924141B2 (en) Information providing apparatus
CN104183149A (zh) 一种车用交通状况预知提示装置及方法
US20190054922A1 (en) Systems and methods for automatically passing vehicles
CN109427215A (zh) 用于对车辆进行错误行驶警告的方法和设备
CN110271554B (zh) 用于车辆的驾驶辅助系统和方法
JP3945305B2 (ja) 運転者将来状況予測装置
JP5640576B2 (ja) 走行支援装置、及び走行支援システム
KR102077315B1 (ko) 지능형 교통정보제공장치 및 정보제공방법
JP2014089588A (ja) 運転支援装置
CN113183981B (zh) 一种自动驾驶背景下的非机动车过街路权协商系统
CN111341150B (zh) 用于避免超高车辆驶入限高路段的提醒方法与装置
JP2015022124A (ja) 運転特徴判定システム
CN116324908A (zh) 用于识别旁路车道的装置和方法
JP4380458B2 (ja) 警告灯制御装置及び方法
JP2012256138A (ja) 携帯端末装置およびこれを備えた運転評価システム
CN114973697A (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
GR01 Patent grant
GR01 Patent grant