CN111258318A - 一种环卫车自动驾驶***及其控制方法 - Google Patents
一种环卫车自动驾驶***及其控制方法 Download PDFInfo
- Publication number
- CN111258318A CN111258318A CN202010074713.8A CN202010074713A CN111258318A CN 111258318 A CN111258318 A CN 111258318A CN 202010074713 A CN202010074713 A CN 202010074713A CN 111258318 A CN111258318 A CN 111258318A
- Authority
- CN
- China
- Prior art keywords
- subsystem
- vehicle
- positioning
- information
- obstacle
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000004140 cleaning Methods 0.000 claims abstract description 54
- 230000008447 perception Effects 0.000 claims abstract description 11
- 230000003993 interaction Effects 0.000 claims abstract description 6
- 230000002159 abnormal effect Effects 0.000 claims description 13
- 238000001514 detection method Methods 0.000 claims description 11
- 230000003068 static effect Effects 0.000 claims description 10
- 230000004888 barrier function Effects 0.000 claims description 9
- 230000004927 fusion Effects 0.000 claims description 9
- 238000012544 monitoring process Methods 0.000 claims description 8
- 238000003860 storage Methods 0.000 claims description 8
- 230000003542 behavioural effect Effects 0.000 claims description 5
- 230000008569 process Effects 0.000 claims description 3
- 230000001953 sensory effect Effects 0.000 claims 1
- 230000001133 acceleration Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 5
- 238000000605 extraction Methods 0.000 description 4
- 230000007547 defect Effects 0.000 description 3
- 238000009826 distribution Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000010415 tidying Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种环卫车自动驾驶***及其控制方法,涉及自动驾驶领域,该自动驾驶***包括定位子***,其用于实时更新车辆的位姿信息,选择预先录制的清扫路线;其还用于实时根据信号强度的大小,自动切换定位方式;感知子***,其用于根据清扫路线生成信息态势图;决策子***,其用于生成驾驶态势图,进而生成横向控制命令和纵向控制命令;驾驶态势图包括行进路线的路径规划;控制子***,还用于接收并执行横向控制命令和纵向控制命令,以及同步执行预定的清扫任务;HMI子***,其用于人机交互。本发明的自动驾驶***,无需采集高精度地图,可满足不同场景环境下环卫车自动驾驶的定位精度需求,完成环卫车的自动驾驶及清扫作业。
Description
技术领域
本发明涉及自动驾驶领域,具体涉及一种环卫车自动驾驶***及其控制方法。
背景技术
汽车自动驾驶技术一直是汽车领域的研究热点,力争能使车辆的驾驶更为简单及人性化。为了提高驾驶的安全性,很多车辆都配置了自动驾驶***。但是现有的自动驾驶***依赖于高精度地图,需要在高精度地图覆盖的区域才能实现路径规划。
环卫车是用于城市市容整理、清洁的专用车辆,其运行场景复杂,受道路环境等因素约束较大,现有的自动驾驶***无法满足环卫车自动驾驶工况。一方面,现有的高精度地图覆盖范围小且采集及维护成本较高,另一方面,在高架桥下、隧道或其它GPS信号较弱的场景下,环卫处的定位精度无法满足自动驾驶需求,存在一定的安全隐患,无法保证自动驾驶的安全性和可靠性。
发明内容
针对现有技术中存在的缺陷,本发明的目的在于提供一种环卫车自动驾驶***及其控制方法,可选择预先录制的清扫路线,无需高精度地图;还可根据信号强度的大小,选择定位方式。
本发明第一方面提供一种环卫车自动驾驶***,其包括:
定位子***,其用于实时更新车辆的位姿信息,以及根据初始位姿信息选择预先录制的清扫路线;其还用于实时根据信号强度的大小,自动切换定位方式;
感知子***,其用于采集道环卫车所在道路环境信息、以及环卫车周围障碍物目标的距离和速度信息,并根据上述清扫路线生成信息态势图;
决策子***,其用于根据上述信息态势图生成驾驶态势图,进而生成横向控制命令和纵向控制命令;上述驾驶态势图包括行进路线的路径规划;
控制子***,还用于接收并执行上述横向控制命令和纵向控制命令,以及同步执行预定的清扫任务;
HMI子***,其用于人机交互,确定采用自动驾驶模式或手动驾驶模式;其还用于显示自动驾驶过程中的车辆位姿信息、道路环境信息和路径规划。
基于第一方面,在可能的实施例中,定位子***包括:
高精度定位模块,其用于根据高精度定位信号生成车辆位姿信息;
激光定位模块,其用于根据激光定位信号生成车辆位姿信息;
切换模块,其用于当上述高精度定位信号强度小于信号阈值时,采用激光定位模块进行定位,否则采用高精度定位模块进行定位。
基于第一方面,在可能的实施例中,感知子***包括:
一个单目相机,其安装于上述驾驶室内,上述单目相机用于检测行驶前方和行驶前方两侧的障碍物目标;
一个视觉传感器,其安装于上述驾驶室内,上述视觉传感器用于识别行驶前方的障碍物目标类型,上述障碍物目标类型包括行人、车辆和车道线;
两个激光雷达,其分别设置于驾驶室的左右两侧下方,上述激光雷达用于检测行驶前方和行驶前方两侧的障碍物目标的类别,以及探测行驶前方两侧的道路边沿;上述障碍物目标的类别包括静态障碍物和动态障碍物;
一个毫米波雷达,其安装于上述驾驶室下方中部,上述毫米波雷达用于对障碍物目标的类别进行补充检测,以及探测行驶前方的远距离障碍物目标,还用于计算远距离障碍物目标与环卫车之间的距离,以及上述远距离障碍物目标的速度;
六个超声波雷达,其安装于上述驾驶室下方,并对称分布于上述毫米波雷达两侧,上述超声波雷达用于检测上述环卫车两侧的近距离障碍物目标,还用于计算近距离障碍物目标与环卫车之间的距离,以及上述近距离障碍物目标的速度;
高精度惯导,其用于探测上述环卫车自身的位置和姿态;
信息融合模块,其分别与上述单目相机、激光雷达、毫米波雷达、超声波雷达以及高精度惯导连接。
基于第一方面,在可能的实施例中,决策子***还用于根据上述路径规划进行行为规划;上述行为规划包括绕行超车、停车等待、减速跟车和保持车道内匀速行驶;
上述横向控制命令和纵向控制命令基于上述行为规划生成。
基于第一方面,在可能的实施例中,还包括存储子***,上述定位子***还用于预先录制清扫路线,并存储于上述存储子***。
基于第一方面,在可能的实施例中,还包括监控子***,上述监控子***用于监控上述感知子***的工作状态,并在上述感知子***发生异常时将异常信息发送至上述HMI子***和控制子***;
上述HMI子***还用于根据上述异常信息控制发出警报;
上述控制子***还用于根据上述异常信息控制减速停车。
本发明第二方面提供一种应用于上述自动驾驶***的控制方法,其包括步骤:
当确定采用自动驾驶模式后,采集车辆位姿信息,并根据上述位姿信息选择预先录制的清扫路线;实时根据信号强度的大小,选择定位方式;
采集道环卫车所在道路环境信息、以及环卫车周围障碍物目标的距离和速度信息,并根据上述清扫路线生成信息态势图;
根据上述信息态势图生成驾驶态势图,进而生成横向控制命令和纵向控制命令,上述驾驶态势图包括行进路线的路径规划,
执行上述横向控制命令和纵向控制命令,并同步执行预定的清扫任务。
基于第二方面,在可能的实施例中,上述实时根据信号强度的大小,选择定位方式,具体包括:
当高精度信号强度小于信号阈值时,采用激光定位模块进行定位;
当上述高精度信号强度大于或等于信号阈值时,采用高精度定位模块进行定位。
基于第二方面,在可能的实施例中,根据上述信息态势图生成驾驶态势图之后,还包括:
根据上述驾驶态势图进行行为规划,上述行为规划包括绕行超车、停车等待、减速跟车和保持车道内匀速行驶;
上述横向控制命令和纵向控制命令基于上述行为规划生成。
基于第二方面,在可能的实施例中,根据上述驾驶态势图进行行为规划,具体包括:
当行驶前方的障碍物目标为静态障碍物时,若上述静态障碍物的尺寸小于可绕行范围,确定上述行为规划为绕行超车,否则,停车等待;
当行驶前方的障碍物目标为动态障碍物时,若上述动态障碍物的速度小于上述环卫车的速度,确定上述行为规划为减速跟车,上述跟车目标为上述动态障碍物,否则保持车道内匀速行驶。
与现有技术相比,本发明的优点在于:
(1)本发明的环卫车自动驾驶***,可根据环卫车的位姿信息选择预先录制的清扫路线,无需采集高精度地图,同时,还可实时根据信号强度的大小,自动切换定位方式,可满足不同场景环境下环卫车自动驾驶的定位精度需求;利用定位子***、感知子***、决策子***和控制子***的配合,完成环卫车的自动驾驶及清扫作业。
(2)本发明的环卫车自动驾驶***,通过设置激光定位模块和切换模块,可弥补高精度定位信号强度较差时造成的定位误差大的缺陷,确保了定位的准确性及自动驾驶的安全性。
(3)本发明的环卫车自动驾驶***,通过单目相机、激光雷达、毫米波雷达、超声波雷达以及高精度惯导之间存在的感知冗余,可精准识别多种障碍物目标,减少感知盲区,有效检测环卫车实际运行工况中复杂的道路环境,以及包括机动车、行人在内的道路参与者,保证了自动驾驶安全性。
(4)本发明的环卫车自动驾驶***,利用环卫车清扫路线虽复杂但较为固定的特点,由人工驾驶,使用定位子***预先录制多条清扫路线并存储至存储子***,以便于每次自动驾驶时均可根据车辆位姿信息自行选择。
附图说明
图1为本发明实施例中环卫车自动驾驶***的结构示意图;
图2为本发明实施例中感知子***的分布示意图;
图3为本发明实施例中感知子***的原理图。
具体实施方式
以下结合附图及实施例对本发明作进一步详细说明。
参见图1所示,本发明提供一种环卫车自动驾驶***的实施例,该自动驾驶***包括定位子***、感知子***、决策子***、控制子***和HMI(Human Machine Interface,人机界面)子***。
当确定采用自动驾驶模式后,定位子***用于实时更新车辆的位姿信息,以及根据初始位姿信息选择预先录制的清扫路线;定位子***还用于实时根据信号强度的大小,自动切换定位方式。
其中,环卫车的当前位姿信息为环卫车在当前时刻的位置信息与姿态信息,如环卫车当前的位姿信息可以包括位置坐标和航向角等。
感知子***用于采集道环卫车所在道路环境信息、以及环卫车周围障碍物目标的距离和速度信息,并根据上述清扫路线生成信息态势图。
决策子***用于根据上述信息态势图实时生成驾驶态势图,进而生成横向控制命令和纵向控制命令。上述驾驶态势图包括行进路线的路径规划。
控制子***用于接收并执行上述横向控制命令和纵向控制命令,并同步执行预定的清扫任务。
HMI子***用于人机交互,根据驾驶者的意图确定采用自动驾驶模式或手动驾驶模式。HMI子***还用于显示自动驾驶过程中的车辆位姿信息、道路环境信息和路径规划。
本实施例的自动驾驶***,可根据环卫车的位姿信息选择预先录制的清扫路线,无需采集高精度地图,同时,还可实时根据信号强度的大小,自动切换定位方式,可满足不同场景环境下环卫车自动驾驶的定位精度需求;利用定位子***、感知子***、决策子***和控制子***的配合,完成环卫车的自动驾驶及清扫作业。
在上述实施例的基础上,本实施例中,上述定位子***包括高精度定位模块、激光定位模块和切换模块。
高精度定位模块用于根据高精度定位信号生成车辆位姿信息。上述高精度定位模块通过组合/惯性器件得到位姿数据,结合通过车身网络获取的车辆状态数据和接收的厘米级RTK(Real-time kinematic,实时动态)差分定位信息,实现厘米级高精度定位。
激光定位模块用于根据激光定位信号生成车辆位姿信息。激光定位模块连接一个16线激光雷达,该16线激光雷设置于驾驶室的上方。激光雷达作为一种三维空间的高精度测距设备,非常适合用作高精度定位,由于激光雷达输出的点云数量庞大,且实时进行处理容易受到环境影响而产生扰动,因此,需要先将激光点云进行特征提取,然后根据相邻两帧的特征点云进行ICP(Iterative Closest Point,迭代最近点)配准,计算相邻两帧的位置和姿态变化,最后推算出当前自车的位置和姿态。
切换模块用于当上述高精度定位信号强度小于信号阈值时,采用激光定位模块进行定位,否则采用高精度定位模块进行定位。
因此,一般情况下,均为默认高精度定位模块进行定位。在高架下或隧道等定位信号较差且组合惯导定位精度不高(大于20cm定位精度)的工况下,环卫车工作时,高精度定位模块会发出定位误差偏大的信号提醒,由切换模块切换到激光定位模块,激光定位模块根据激光SLAM(simultaneous localization and mapping,即时定位与地图构建)进行定位,保证全程都能提供稳定的高精度定位。
本实施例中,通过设置激光定位模块和切换模块,可弥补高精度定位信号强度较差时造成的定位误差大的缺陷,确保了定位的准确性及自动驾驶的安全性。
本实施例的定位子***还可提供大量历史先验数据,为感知子***提供冗余和增强感知效果,进而为决策子***提供更可靠的输入。
参见图2和图3所示,在上述实施例的基础上,本实施例中,上述感知子***包括单目相机、视觉传感器、激光雷达、毫米波雷达、超声波雷达、高精度惯导和信息融合模块。信息融合模块分别与上述单目相机、视觉传感器、激光雷达、毫米波雷达、超声波雷达以及高精度惯导连接。定位子***向感知子***提供车辆的实际世界坐标下的位姿信息。
上述单目相机设有一个,且安装于上述驾驶室内,上述单目相机用于检测行驶前方和行驶前方两侧的障碍物目标。单目相机障碍物目标检测距离为80m以内。
上述视觉传感器设有一个,且安装于上述驾驶室内,视觉传感器用于识别行驶前方的障碍物目标类型,进行障碍物目标分类。上述障碍物目标类型包括行人、车辆和车道线。可选地,视觉传感器为Mobileye相机。Mobileye相机障碍物目标检测距离为60m以内。
上述激光雷达设有两个,且分别设置于驾驶室的左右两侧下方。上述激光雷达用于检测行驶前方和行驶前方两侧的障碍物目标的类别,以及探测行驶前方两侧的道路边沿;上述障碍物目标的类别包括静态障碍物和动态障碍物。考虑到环卫车在白天和晚上均需要进行作业,因此,本实施例中,激光雷达为16线激光雷达,激光雷达的障碍物目标检测距离为100m以内。
上述毫米波雷达设有一个,且安装于上述驾驶室下方中部,根据毫米波雷达的特性,毫米波雷达用于对障碍物目标的类别进行补充检测,以及探测行驶前方的远距离障碍物目标。本实施例中,毫米波雷达采用前向毫米波雷达ESR,前向毫米波雷达障碍物目标检测的远距离阈值区间为100-175m。
上述毫米波雷达还用于计算远距离障碍物目标与环卫车之间的距离,以及上述远距离障碍物目标的速度。
上述超声波雷达设有六个,且安装于上述驾驶室下方,六个超声波雷达对称分布于上述毫米波雷达两侧,即三个超声波雷达设置于毫米波雷达一侧,另外三个超声波雷达设置于毫米波雷达的另一侧。
根据超声波雷达的特性,超声波雷达用于检测上述环卫车两侧的近距离障碍物目标,还用于计算近距离障碍物目标与环卫车之间的距离,以及上述近距离障碍物目标的速度。通过超声波雷达弥补激光雷达的安装高度限制,对近距离盲区补充。本实施例中,超声波雷达障碍物目标检测的近距离阈值为2.5m,即超声波雷达的障碍物目标检测距离为2.5m以内。
上述高精度惯导用于探测上述环卫车自身的位置和姿态,可达到厘米级定位精度。
其中,毫米波雷达、超声波雷达和Mobileye相机分别通过CAN(Controller AreaNetwork,控制器局域网络)线与信息融合模块进行通信,激光雷达和单目相机通过以太网与信息融合模块进行通信,高精度惯导与信息融合模块通过串口通信。通过Mobileye相机进行障碍物目标分类,通过毫米波雷达、超声波雷达、激光雷达、单目相机和高精度惯导进行障碍物目标检测及追踪。
在检测到障碍物目标的基础上,通过上述各器件之间的目标融合,可计算出目标当前的位置、角度、速度、加速度等基本信息。为了提高动态目标检测的精度与稳定性,采用冗余传感器设计,即同时利用单目相机、激光雷达、毫米波雷达、超声波雷达以及Mobileye相机之间存在的感知冗余,计算检测到的目标的状态信息。在此基础上,设计卡尔曼滤波器对检测结果进行感知融合,通过不同传感器的检测结果作为卡尔曼滤波器的观测值,可精准识别多种障碍物目标,减少感知盲区,提高动态障碍物检测的精度与稳定性,进而有效检测环卫车实际运行工况中复杂的道路环境,以及包括机动车、行人在内的道路参与者,保证了自动驾驶安全性。
本实施例中,信息态势图包括障碍物目标列表、道路信息和清扫路线等信息。
本实施例中,驾驶态势图还包括期望轨迹、期望速度、加速度,以及其它辅助规划信息等。
进一步地,决策子***还用于根据上述驾驶态势图进行行为规划,进而基于行为规划进行相应的运动规划。上述行为规划包括绕行超车、停车等待、减速跟车和保持环卫车在车道内匀速行驶。其中,运动规划即为横向控制命令和纵向控制命令。
决策子***对期望轨迹、期望速度和加速度,进行控制算法运算后,将得到的期望的方向盘转角、油门及刹车量通过CAN线发送到控制子***,控制子***控制电机、自动转向机、EBS(Electric Braking System,汽车电控制动***)、BCM(Body Control Module,车身控制模块)、EPS(Electric Power Steering,电动助力转向***)等执行机构响应,实现环卫车的转向、加减速以及其它辅助功能(转向灯、制动灯等)的自动控制,使车辆保持期望的行驶轨迹、期望速度及加速度。
因此,当清扫路径前方出现障碍物目标或其它道路参与者时,决策子***会根据实际情况实时进行二次路径规划,决定减速跟车、停车避撞或绕行超车等操作,并将相应的横向控制命令和纵向控制命令发送至控制子***。
在上述实施例的基础上,本实施例的自动驾驶***还包括存储子***,上述定位子***还用于预先录制清扫路线,并将清扫路线存储在上述存储子***中。
本实施例中,利用环卫车清扫路线虽复杂但较为固定的特点,由人工驾驶,使用定位子***预先录制多条清扫路线并存储至存储子***,以便于每次自动驾驶时均可根据车辆位姿信息自行选择,或通过HMI子***进行人为选择。不仅摆脱了高精度地图的局限性,扩大场景工况范围,且减少了制作高精度地图的费用。
HMI子***运行在平板电脑上,通过LAN((Local Area Network,局域网)接收并显示自动驾驶的信息,除了车辆位姿信息、道路环境信息和路径规划之外,还可显示车速状态、传感器状态、故障灯显示等;还可设置一键启动/退出自动驾驶模式操作,以提高人机交互的便利性。
本实施例中,当确定采用自动驾驶模式时,上述HMI子***还可通过平板电脑的人机交互界面对自动驾驶进行基本参数设置。上述基本参数包括目标车速和清扫路线选择。
进一步地,本实施例的自动驾驶***还包括监控Monitor子***,上述监控子***用于实时监控上述感知子***的工作状态,并在上述感知子***发生异常时将异常信息发送至上述HMI子***和控制子***。
上述HMI子***还用于根据上述异常信息控制发出警报;上述控制子***还用于根据上述异常信息控制减速停车。
本实施例中,监控子***还用于实时监控EBS和EPS等执行机构的状态,当EBS或EPS出现故障失效时,同样将该异常信息发送至HMI子***和控制子***,以进一步增加行驶安全性。
本实施例中,以选择的清扫路线为一次规划路径进行循迹驾驶,通过感知子***精准检测车辆周围障碍物目标情况及道路环境,当清扫路线上出现障碍物目标时,通过决策子***根据感知子***提供的信息态势图,进行预瞄点采样、生成备选路径、查找最优路径等,实时生成驾驶态势图,作为二次规划路径,并确定行为规划,进而生成横向控制命令和纵向控制命令发送给控制子***,由控制子***控制实现环卫车的转向、加减速以及其它辅助功能(转向灯、制动灯等)的自动控制,使车辆保持期望的行驶轨迹以及期望的速度和加速度。
本实施的控制***,不受道路环境等因素约束,有效保证了自动驾驶可靠性和安全性,同时可实现全部场景工况下的环卫车的自动驾驶控制。
本发明还提供一种应用于上述自动驾驶***的控制方法的实施例,其包括步骤:
S1.当确定采用自动驾驶模式后,采集车辆位姿信息,并根据上述位姿信息选择预先录制的清扫路线;实时根据信号强度的大小,选择定位方式;
S2.采集道环卫车所在道路环境信息、以及环卫车周围障碍物目标的距离和速度信息,并根据上述清扫路线生成信息态势图;
S3.根据上述信息态势图生成驾驶态势图,进而生成横向控制命令和纵向控制命令,上述驾驶态势图包括行进路线的路径规划。
其中,生成驾驶态势图包括更新数据和提取决策要素两个主要部分,以便于后续生成横向控制命令和纵向控制命令。
S4.执行上述横向控制命令和纵向控制命令,并同步执行预定的清扫任务。
进一步地,上述步骤S1中,实时根据信号强度的大小,选择定位方式,具体包括:
当高精度信号强度小于信号阈值时,采用激光定位模块进行定位。
当上述高精度信号强度大于或等于信号阈值时,采用高精度定位模块进行定位。
在上述实施例的基础上,本实施例中,上述步骤S2的生成信息态势图,具体包括:
首先,读取由单目相机、激光雷达、毫米波雷达、超声波雷达以及高精度惯导获取的数据,结合上述数据和清扫路线进行时间和空间同步。
然后,对上述数据和清扫路线进行特征提取和道路信息提取,并通过感知融合算法结合上述车辆位姿信息,生成上述信息态势图。
在上述实施例的基础上,本实施例中,上述步骤S3根据所述信息态势图生成驾驶态势图之后,还包括:根据上述驾驶态势图进行行为规划。其中,行为规划包括绕行超车、停车等待、减速跟车和保持车道内匀速行驶。
上述横向控制命令和纵向控制命令基于上述行为规划生成。
在上述实施例的基础上,本实施例中,根据上述驾驶态势图进行行为规划,具体包括:
当行驶前方的障碍物目标为静态障碍物时,若上述静态障碍物的尺寸小于可绕行范围,确定上述行为规划为绕行超车;若上述静态障碍物的尺寸大于可绕行范围,确定上述行为规划为停车等待,以避免发生碰撞。
当行驶前方的障碍物目标为动态障碍物时,若上述动态障碍物的速度小于上述环卫车的速度,确定上述行为规划为减速跟车,上述跟车目标为上述动态障碍物;若上述动态障碍物的速度大于或等于上述环卫车的速度,确定上述行为规划为保持车辆在车道内匀速行驶。
本实施例的控制方法,适用于上述各自动驾驶***,可预先录制清扫路线,然后根据环卫车的位姿信息进行选择;同时,实时规划运行轨迹,满足环卫车自动驾驶所有的场景需求,有效保证自动驾驶的安全性和可靠性。
本发明不局限于上述实施方式,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也视为本发明的保护范围之内。本说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (10)
1.一种环卫车自动驾驶***,其特征在于,其包括:
定位子***,其用于实时更新车辆的位姿信息,以及根据初始位姿信息选择预先录制的清扫路线;其还用于实时根据信号强度的大小,自动切换定位方式;
感知子***,其用于采集道环卫车所在道路环境信息、以及环卫车周围障碍物目标的距离和速度信息,并根据所述清扫路线生成信息态势图;
决策子***,其用于根据所述信息态势图生成驾驶态势图,进而生成横向控制命令和纵向控制命令;所述驾驶态势图包括行进路线的路径规划;
控制子***,还用于接收并执行所述横向控制命令和纵向控制命令,以及同步执行预定的清扫任务;
HMI子***,其用于人机交互,确定采用自动驾驶模式或手动驾驶模式;其还用于显示自动驾驶过程中的车辆位姿信息、道路环境信息和路径规划。
2.如权利要求1所述的环卫车自动驾驶***,其特征在于,所述定位子***包括:
高精度定位模块,其用于根据高精度定位信号生成车辆位姿信息;
激光定位模块,其用于根据激光定位信号生成车辆位姿信息;
切换模块,其用于当所述高精度定位信号强度小于信号阈值时,采用激光定位模块进行定位,否则采用高精度定位模块进行定位。
3.如权利要求1所述的环卫车自动驾驶***,其特征在于,所述感知子***包括:
一个单目相机,其安装于所述驾驶室内,所述单目相机用于检测行驶前方和行驶前方两侧的障碍物目标;
一个视觉传感器,其安装于所述驾驶室内,所述视觉传感器用于识别行驶前方的障碍物目标类型,所述障碍物目标类型包括行人、车辆和车道线;
两个激光雷达,其分别设置于驾驶室的左右两侧下方,所述激光雷达用于检测行驶前方和行驶前方两侧的障碍物目标的类别,以及探测行驶前方两侧的道路边沿;所述障碍物目标的类别包括静态障碍物和动态障碍物;
一个毫米波雷达,其安装于所述驾驶室下方中部,所述毫米波雷达用于对障碍物目标的类别进行补充检测,以及探测行驶前方的远距离障碍物目标,还用于计算远距离障碍物目标与环卫车之间的距离,以及所述远距离障碍物目标的速度;
六个超声波雷达,其安装于所述驾驶室下方,并对称分布于所述毫米波雷达两侧,所述超声波雷达用于检测所述环卫车两侧的近距离障碍物目标,还用于计算近距离障碍物目标与环卫车之间的距离,以及所述近距离障碍物目标的速度;
高精度惯导,其用于探测所述环卫车自身的位置和姿态;
信息融合模块,其分别与所述单目相机、激光雷达、毫米波雷达、超声波雷达以及高精度惯导连接。
4.如权利要求1所述的环卫车自动驾驶***,其特征在于:所述决策子***还用于根据所述路径规划进行行为规划;所述行为规划包括绕行超车、停车等待、减速跟车和保持车道内匀速行驶;
所述横向控制命令和纵向控制命令基于所述行为规划生成。
5.如权利要求1所述的环卫车自动驾驶***,其特征在于:还包括存储子***,所述定位子***还用于预先录制清扫路线,并存储于所述存储子***。
6.如权利要求1所述的环卫车自动驾驶***,其特征在于:还包括监控子***,所述监控子***用于监控所述感知子***的工作状态,并在所述感知子***发生异常时将异常信息发送至所述HMI子***和控制子***;
所述HMI子***还用于根据所述异常信息控制发出警报;
所述控制子***还用于根据所述异常信息控制减速停车。
7.一种应用于权利要求1所述自动驾驶***的控制方法,其特征在于,其包括步骤:
当确定采用自动驾驶模式后,采集车辆位姿信息,并根据所述位姿信息选择预先录制的清扫路线;实时根据信号强度的大小,选择定位方式;
采集道环卫车所在道路环境信息、以及环卫车周围障碍物目标的距离和速度信息,并根据所述清扫路线生成信息态势图;
根据所述信息态势图生成驾驶态势图,进而生成横向控制命令和纵向控制命令,所述驾驶态势图包括行进路线的路径规划,
执行所述横向控制命令和纵向控制命令,并同步执行预定的清扫任务。
8.如权利要求7所述的控制方法,其特征在于,所述实时根据信号强度的大小,选择定位方式,具体包括:
当高精度信号强度小于信号阈值时,采用激光定位模块进行定位;
当所述高精度信号强度大于或等于信号阈值时,采用高精度定位模块进行定位。
9.如权利要求7所述的控制方法,其特征在于,根据所述信息态势图生成驾驶态势图之后,还包括:
根据所述驾驶态势图进行行为规划,所述行为规划包括绕行超车、停车等待、减速跟车和保持车道内匀速行驶;
所述横向控制命令和纵向控制命令基于所述行为规划生成。
10.如权利要求9所述的控制方法,其特征在于,根据所述驾驶态势图进行行为规划,具体包括:
当行驶前方的障碍物目标为静态障碍物时,若所述静态障碍物的尺寸小于可绕行范围,确定所述行为规划为绕行超车,否则,停车等待;
当行驶前方的障碍物目标为动态障碍物时,若所述动态障碍物的速度小于所述环卫车的速度,确定所述行为规划为减速跟车,所述跟车目标为所述动态障碍物,否则保持车道内匀速行驶。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010074713.8A CN111258318A (zh) | 2020-01-22 | 2020-01-22 | 一种环卫车自动驾驶***及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010074713.8A CN111258318A (zh) | 2020-01-22 | 2020-01-22 | 一种环卫车自动驾驶***及其控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111258318A true CN111258318A (zh) | 2020-06-09 |
Family
ID=70949187
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010074713.8A Pending CN111258318A (zh) | 2020-01-22 | 2020-01-22 | 一种环卫车自动驾驶***及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111258318A (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111781937A (zh) * | 2020-08-07 | 2020-10-16 | 江苏普达迪泰科技有限公司 | 异物检测清扫***的无人化编队控制***及其控制方法 |
CN111962436A (zh) * | 2020-08-26 | 2020-11-20 | 吉林大学 | 一种非机动车道无人驾驶自动规划环保清扫车及清扫方法 |
CN112526997A (zh) * | 2020-12-07 | 2021-03-19 | 中国第一汽车股份有限公司 | 一种自动驾驶感知***、方法和车辆 |
CN112622890A (zh) * | 2020-11-26 | 2021-04-09 | 深兰人工智能(深圳)有限公司 | 清扫车 |
CN112833899A (zh) * | 2020-12-31 | 2021-05-25 | 吉林大学 | 一种用于无人环卫车的全覆盖路径规划方法 |
CN112987029A (zh) * | 2021-02-09 | 2021-06-18 | 上海振华重工(集团)股份有限公司 | 一种适用于驾驶设备的定位方法、***、设备及介质 |
CN114056351A (zh) * | 2021-11-26 | 2022-02-18 | 文远苏行(江苏)科技有限公司 | 自动驾驶方法及装置 |
CN114252086A (zh) * | 2021-12-22 | 2022-03-29 | 北京百度网讯科技有限公司 | 提示信息的输出方法、装置、设备、介质和车辆 |
CN114435400A (zh) * | 2022-01-29 | 2022-05-06 | 苏州挚途科技有限公司 | 无人驾驶环卫车的启动方法、无人驾驶环卫车及电子设备 |
CN114440928A (zh) * | 2022-01-27 | 2022-05-06 | 杭州申昊科技股份有限公司 | 激光雷达与里程计的联合标定方法、机器人、设备和介质 |
CN115246417A (zh) * | 2021-07-29 | 2022-10-28 | 上海仙途智能科技有限公司 | 作业执行方法、装置、设备及计算机可读存储介质 |
WO2023232046A1 (zh) * | 2022-05-31 | 2023-12-07 | 武汉路特斯汽车有限公司 | 基于车联网的车辆控制方法及控制*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2177965A2 (en) * | 2008-10-15 | 2010-04-21 | Deere & Company | High integrity coordination for multiple off-road machines |
CN103995537A (zh) * | 2014-05-09 | 2014-08-20 | 上海大学 | 飞行器室内外混合自主巡航***与方法 |
CN108445885A (zh) * | 2018-04-20 | 2018-08-24 | 鹤山东风新能源科技有限公司 | 一种基于纯电动物流车的自动驾驶***及其控制方法 |
CN108490941A (zh) * | 2018-03-29 | 2018-09-04 | 奇瑞汽车股份有限公司 | 应用于道路清扫车的自动驾驶***及其控制方法、装置 |
CN109827574A (zh) * | 2018-12-28 | 2019-05-31 | 中国兵器工业计算机应用技术研究所 | 一种无人机室内外切换导航*** |
-
2020
- 2020-01-22 CN CN202010074713.8A patent/CN111258318A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2177965A2 (en) * | 2008-10-15 | 2010-04-21 | Deere & Company | High integrity coordination for multiple off-road machines |
CN103995537A (zh) * | 2014-05-09 | 2014-08-20 | 上海大学 | 飞行器室内外混合自主巡航***与方法 |
CN108490941A (zh) * | 2018-03-29 | 2018-09-04 | 奇瑞汽车股份有限公司 | 应用于道路清扫车的自动驾驶***及其控制方法、装置 |
CN108445885A (zh) * | 2018-04-20 | 2018-08-24 | 鹤山东风新能源科技有限公司 | 一种基于纯电动物流车的自动驾驶***及其控制方法 |
CN109827574A (zh) * | 2018-12-28 | 2019-05-31 | 中国兵器工业计算机应用技术研究所 | 一种无人机室内外切换导航*** |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111781937A (zh) * | 2020-08-07 | 2020-10-16 | 江苏普达迪泰科技有限公司 | 异物检测清扫***的无人化编队控制***及其控制方法 |
CN111962436A (zh) * | 2020-08-26 | 2020-11-20 | 吉林大学 | 一种非机动车道无人驾驶自动规划环保清扫车及清扫方法 |
CN111962436B (zh) * | 2020-08-26 | 2021-05-07 | 吉林大学 | 一种非机动车道无人驾驶自动规划环保清扫车及清扫方法 |
CN112622890A (zh) * | 2020-11-26 | 2021-04-09 | 深兰人工智能(深圳)有限公司 | 清扫车 |
CN112526997A (zh) * | 2020-12-07 | 2021-03-19 | 中国第一汽车股份有限公司 | 一种自动驾驶感知***、方法和车辆 |
CN112833899A (zh) * | 2020-12-31 | 2021-05-25 | 吉林大学 | 一种用于无人环卫车的全覆盖路径规划方法 |
CN112833899B (zh) * | 2020-12-31 | 2022-02-15 | 吉林大学 | 一种用于无人环卫车的全覆盖路径规划方法 |
CN112987029A (zh) * | 2021-02-09 | 2021-06-18 | 上海振华重工(集团)股份有限公司 | 一种适用于驾驶设备的定位方法、***、设备及介质 |
CN115246417A (zh) * | 2021-07-29 | 2022-10-28 | 上海仙途智能科技有限公司 | 作业执行方法、装置、设备及计算机可读存储介质 |
CN115246417B (zh) * | 2021-07-29 | 2023-08-25 | 上海仙途智能科技有限公司 | 作业执行方法、装置、设备及计算机可读存储介质 |
CN114056351A (zh) * | 2021-11-26 | 2022-02-18 | 文远苏行(江苏)科技有限公司 | 自动驾驶方法及装置 |
CN114056351B (zh) * | 2021-11-26 | 2024-02-02 | 文远苏行(江苏)科技有限公司 | 自动驾驶方法及装置 |
CN114252086A (zh) * | 2021-12-22 | 2022-03-29 | 北京百度网讯科技有限公司 | 提示信息的输出方法、装置、设备、介质和车辆 |
CN114252086B (zh) * | 2021-12-22 | 2023-03-03 | 北京百度网讯科技有限公司 | 提示信息的输出方法、装置、设备、介质和车辆 |
CN114440928A (zh) * | 2022-01-27 | 2022-05-06 | 杭州申昊科技股份有限公司 | 激光雷达与里程计的联合标定方法、机器人、设备和介质 |
CN114435400A (zh) * | 2022-01-29 | 2022-05-06 | 苏州挚途科技有限公司 | 无人驾驶环卫车的启动方法、无人驾驶环卫车及电子设备 |
WO2023232046A1 (zh) * | 2022-05-31 | 2023-12-07 | 武汉路特斯汽车有限公司 | 基于车联网的车辆控制方法及控制*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111258318A (zh) | 一种环卫车自动驾驶***及其控制方法 | |
US11835959B1 (en) | Determining the stationary state of detected vehicles | |
EP3795457B1 (en) | Preparing autonomous vehicles for turns | |
US9862364B2 (en) | Collision mitigated braking for autonomous vehicles | |
US11004000B1 (en) | Predicting trajectory intersection by another road user | |
CN111169479A (zh) | 一种巡航控制方法、装置、***、车辆及存储介质 | |
EP3175311A1 (en) | Traffic signal response for autonomous vehicles | |
CN117485240A (zh) | 报告装置 | |
US11702087B2 (en) | Autonomous driving monitoring system | |
US20220366175A1 (en) | Long-range object detection, localization, tracking and classification for autonomous vehicles | |
CN112824175A (zh) | 车辆泊车*** | |
US20200250980A1 (en) | Reuse of Surroundings Models of Automated Vehicles | |
WO2023010042A1 (en) | Complementary control system for an autonomous vehicle | |
CN117836184A (zh) | 用于自主车辆的互补控制*** | |
US20220055659A1 (en) | Mode selection according to system conditions | |
JP2019043431A (ja) | 走行制御装置、走行制御方法およびプログラム | |
JP2021160399A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP7291015B2 (ja) | 周囲物体認識方法及び周囲物体認識装置 | |
US11325529B2 (en) | Early brake light warning system for autonomous driving vehicle | |
CN114274978A (zh) | 一种无人驾驶物流车的避障方法 | |
CN113022552A (zh) | 基于激光雷达和v2i技术的自动泊车***及控制方法 | |
CN113728324A (zh) | 基于点云的低高度障碍物检测*** | |
CN212172193U (zh) | 一种适用于微巴的智能网联自动驾驶*** | |
US20230249680A1 (en) | Systems and methods for navigating a trailer with a vehicle when a physical connection disconnects | |
US20230406293A1 (en) | Secondary fallback software stack for autonomous vehicle |
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: 20200609 |
|
RJ01 | Rejection of invention patent application after publication |