CN111806435A - 一种低速电动车自动循迹控制*** - Google Patents
一种低速电动车自动循迹控制*** Download PDFInfo
- Publication number
- CN111806435A CN111806435A CN202010592981.9A CN202010592981A CN111806435A CN 111806435 A CN111806435 A CN 111806435A CN 202010592981 A CN202010592981 A CN 202010592981A CN 111806435 A CN111806435 A CN 111806435A
- Authority
- CN
- China
- Prior art keywords
- electric vehicle
- module
- coordination control
- lane
- differential gps
- 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
Links
- 230000000007 visual effect Effects 0.000 claims abstract description 22
- 238000012545 processing Methods 0.000 claims description 14
- 230000036544 posture Effects 0.000 claims description 3
- 239000004575 stone Substances 0.000 claims description 3
- 230000008878 coupling Effects 0.000 abstract description 3
- 238000010168 coupling process Methods 0.000 abstract description 3
- 238000005859 coupling reaction Methods 0.000 abstract description 3
- 238000011217 control strategy Methods 0.000 abstract 1
- 238000000034 method Methods 0.000 description 6
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000002023 wood Substances 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000008021 deposition Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 229910052742 iron Inorganic materials 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000012800 visualization Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- 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
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/14—Receivers specially adapted for specific applications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/485—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an optical system or imaging system
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/53—Determining attitude
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/16—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V10/00—Arrangements for image or video recognition or understanding
- G06V10/70—Arrangements for image or video recognition or understanding using pattern recognition or machine learning
- G06V10/77—Processing image or video features in feature spaces; using data integration or data reduction, e.g. principal component analysis [PCA] or independent component analysis [ICA] or self-organising maps [SOM]; Blind source separation
- G06V10/80—Fusion, i.e. combining data from various sources at the sensor level, preprocessing level, feature extraction level or classification level
- G06V10/809—Fusion, i.e. combining data from various sources at the sensor level, preprocessing level, feature extraction level or classification level of classification results, e.g. where the classifiers operate on the same input data
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
-
- 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/53—Road markings, e.g. lane marker or crosswalk
-
- 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/20—Static objects
-
- 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/402—Type
- B60W2554/4029—Pedestrians
-
- 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/60—Traversable objects, e.g. speed bumps or curbs
-
- 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/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- 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
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Theoretical Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Human Computer Interaction (AREA)
- Electromagnetism (AREA)
- Artificial Intelligence (AREA)
- Health & Medical Sciences (AREA)
- Software Systems (AREA)
- Databases & Information Systems (AREA)
- Evolutionary Computation (AREA)
- Computing Systems (AREA)
- Medical Informatics (AREA)
- General Health & Medical Sciences (AREA)
- Mathematical Physics (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种低速电动车自动循迹控制***,该***包括包括视觉识别模块,差分GPS模块,协调控制模块,自动驾驶控制模块,该***通过结合视觉模块与差分GPS模块共同进行自动循迹,保证了车辆循迹的准确性与稳定性;考虑到两模块在控制中出现的耦合影响,设计了协调控制策略,消除两模块间的互相干扰,发挥了视觉与差分GPS循迹的优点。
Description
技术领域
本发明涉及自动驾驶领域,特别涉及一种低速电动车自动循迹控制***。
背景技术
在科技进步,技术日新月异的今天,自动化与智能化成为现代生活与工业生产的主流,在车辆驾驶领域,如何解放驾驶员的双手,提高车辆的安全性与稳定性一直是人们要解决的问题,因此智能驾驶应运而生,智能驾驶将应用于各个领域,在工业中车辆可脱离驾驶员独立工作,而在交通运输中,通过车联网技术,实现交通网络数据化、可视化,大大提高生产效率和交通效率。
目前智能驾驶发展迅速,其实现方式主要有以下几种:
第一种,基于导轨,其主要方式有铺设引导轨,使车体与轮组在导轨上完成固定路线的行驶。或者在规划路线上铺设感应体(如铁线,磁条等),在车辆上安装传感器,车辆识别出行驶路径,沿着铺设感应体的路径行驶。这种方式车辆行驶可靠性及稳定性很高,路线不容易出现偏差,但因其要提前铺设导轨或感应体,成本高,且灵活性差,若要改变其行驶路径,只能重新铺设新路径。
第二种,基于视觉识别,其主要依靠设置在车辆前部的摄像头拍摄图像,利用图像处理模块识别车道线及障碍物,连接自动驾驶控制模块,实现自动循迹行驶及躲避障碍物。这种方式车辆行驶路径更加灵活,可用于更大范围的自动驾驶,但其在多路径(如分岔路口)无法判断正确路径。且过度依赖路面条件,时间长后,由于摩擦或灰尘沉积,使车道线模糊,不容易辨识,不利于自动循迹。
第三种:基于红外探测,也是一种常见的手段,通过红外线传感器,实现循迹和避障。但是缺点也难以避免,这种方式受外界环境影响大,易受其他热源和光源的干扰。
第四种:基于雷达探测器,有激光雷达,超声波雷达等,这种方式具有非常精确的测距及定位能力,隐蔽性好、抗有源干扰能力强,但其价格成本让人望而却步。
发明内容
为解决现有技术中存在的问题,本发明目的是提出一种低速电动车自动循迹控制***,通过结合视觉识别模块和GPS模块,经协调控制,增强自动驾驶稳定性,实现良好的自动循迹效果。
为实现上述目的,本发明提出一种低速电动车自动循迹控制***,包括视觉识别模块,差分GPS模块,协调控制模块,自动驾驶控制模块。
视觉识别模块,用以识别电动车行驶车道内的车道线及前方预设范围的障碍物;
差分GPS模块,用以获取电动车位置坐标,生成规划路径;
协调控制模块,用以协调视觉识别模块和差分GPS模块;
自动驾驶控制模块,与所述协调控制模块连接,接收协调控制信号,用于循迹行驶和遇到障碍物时制动。
优选的,所述视觉识别模块包括:
摄像头,设置在电动车前部,用于拍摄电动车所处车道内两车道线图像及前方预设范围的障碍物图像;
图像处理单元,与所述摄像头连接,用于处理所拍摄车道线及障碍物图像,获取电动车所在车道内相对位置,以及障碍物信息。
进一步优选的,所述障碍物包括高度大于底盘最小高度或宽度大于通行安全宽度的行人、木块、石块,所述障碍物信息包括所述障碍物的位置和几何形状。
优选的,所述差分GPS模块包括:
两个差分GPS接收器,设置在电动车顶部纵向排列且相距不少于一米,用以获取电动车行驶中实时位置坐标和车身姿态;
计算中心,与差分GPS接收器连接,接收电动车行驶信息,用以在程序中生成规划路径信息;
所述规划路径信息包括规划路径坐标,以及在多条路径(如分岔路口)设置解耦点。
优选的,所述协调控制模块与图像处理单元和计算中心连接,用以接收所述图像处理单元输出的电动车相对车道位置信息和障碍物信息以及计算中心生成的规划路径信息,运用协调控制算法,协调视觉识别模块和差分GPS模块,输出协调控制信号。
进一步优选的,所述协调控制算法包含三条判断依据,分别为是否检测到障碍物,是否检测到解耦点,规划路径与车道中心线距离是否≤d。经协调控制算法输出以下三种协调控制信号:制动;依据差分GPS循迹;依据差分GPS循迹且视觉模块辅助。
优选的,所述自动驾驶控制模块包括:
驱动器41:控制电动车10启动和驱动;
转向器42:控制电动车10转向;
制动器43:控制电动车10前方预设范围出现所述障碍物时制动;
所述自动驾驶控制模块与所述协调控制模块连接,接收协调控制信号,控制电动车制动和依据规划路径信息行驶,同时在规定差值范围内选择依据车道位置信息,进一步修正电动车在车道中心行驶。本发明的有益效果是:通过将视觉识别模块和差分GPS模块结合,以差分GPS模块为主,视觉识别模块为辅,运用协调控制算法实现两模块间的耦合与解耦。运用差分GPS模块实现自动循迹的完整性,结合视觉识别模块修正自动循迹的细节,大大发挥了各自的优势,提高了自动循迹的精确性和稳定性。
附图说明
图1是本发明提供的自动循迹控制***的结构框图;
图2是本发明提供的协调控制模块的算法流程图;
图3是本发明提供的电动车工况一行驶状态示意图;
图4是本发明提供的电动车工况二行驶状态示意图。
其中:
1是视觉识别模块,11摄像头,12图像处理单元;
2是差分GPS模块,21是差分GPS接收器,22是计算中心;
3是协调控制模块;
4是自动驾驶控制模块,41是驱动器,42是转向器,43是制动器;
10电动车,
13车道线。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1所示,本发明实提供了一种低速电动车自动循迹控制***,所述***包括包括视觉识别模块1,差分GPS模块2,协调控制模块3,自动驾驶控制模块4。
所述视觉识别模块包括摄像头11,设置在电动车10前部,用于拍摄电动车10所处车道内两车道线13图像及前方预设范围的障碍物图像;
图像处理单元12,与所述摄像头11连接,用于处理所拍摄车道线13及障碍物图像,获取电动车所在车道内相对位置,以及障碍物信息;
所述障碍物包括高度大于底盘最小高度或宽度大于通行安全宽度的行人、木块、石块,所述障碍物信息包括所述障碍物的位置和几何形状。
所述差分GPS模块2包括两个差分GPS接收器21,设置在电动车10顶部纵向排列且为保证定位精确性,两接收器相距不少于一米,用以获取电动车10行驶中实时位置坐标和车身姿态;
计算中心22,与差分GPS接收器21连接,接收电动车行驶信息,用以在程序中生成规划路径信息;
所述规划路径信息包括规划路径坐标,以及在多条路径(如分岔路口)设置解耦点。
所述协调控制模块3与图像处理单元12和计算中心22连接,用以接收所述图像处理单元12输出的电动车相对车道位置信息和障碍物信息以及计算中心22生成的规划路径信息,运用协调控制算法,协调视觉识别模块1和差分GPS模块2,输出协调控制信号。
所述自动驾驶控制模块4包括:
驱动器41:控制电动车10启动和驱动。
转向器42:控制电动车10转向。
制动器43:控制电动车10前方预设范围出现所述障碍物时制动。
当电动车10自动循迹行驶前,由人工提前驾驶电动车10行驶在规划路径,利用差分GPS模块2采集规划路径坐标,且生成规划路径信息。所述规划路径信息包括规划路径坐标,以及在多条路径(如分岔路口)前设置解耦点。
由于视觉识别模块和差分GPS模块都可引导自动循迹,为协调两模块,提出一种协调控制算法。
如图2所示,在本发明实施例中,所述协调控制算法包含三条判断依据,分别为是否检测到障碍物,是否检测到解耦点,规划路径距车道中心线距离是否≤Δd。经协调控制算法输出以下三种协调控制信号:制动,依据差分GPS循迹,依据差分GPS循迹且视觉模块辅助。
协调控制模块3首先检测是否出现障碍物,接着检测解耦点,进一步检测规划路径距车道中心线距离是否≤Δd。
下面依据两种工况具体描述协调控制算法:
工况一:如图3所示,自动驾驶控制模块4控制电动车10行驶于单条路径,协调控制模块3实时检测以下信息。为保证自动循迹安全,协调控制模块3实时检测是否遇到障碍物,若检测到障碍物信息,则发出制动信号,自动驾驶控制模块4控制制动器43制动;若未检测到障碍物信息,则进一步检测是否有解耦点,由于此时在单条路径,未设置解耦点。进一步检测规划路径距车道中心线距离是否≤Δd,若规划路径距车道中心线距离≤Δd,表示规划路径与车道中心线无较大偏差,则自动循迹方式为依据差分GPS循迹且视觉模块辅助。如图3所示,此时电动车10按规划路径行驶,规划路径与车道中心线距离为d,若d≤Δd,则依据差分GPS循迹且视觉模块辅助,自动驾驶模块4控制驱动器41和转向器42将电动车10修正至车道中心,若d>Δd,电动车依据差分GPS循迹。
工况二:如图4,此时电动车前方出现多条路径(如分岔路口),路径分为直行与转弯,若此时继续使用视觉识别模块辅助自动驾驶,则可能出现下列情况:
①规划路径为直行,此时电动车使用视觉识别模块辅助,行驶在车道中心,若视觉识别模块识别出转弯车道线,控制电动车转向,而协调控制模块3检测出规划路径距车道中心线距离d>Δd,电动车偏离规划路径较大,自动循迹方式变为依据差分GPS循迹,控制电动车回到规划路径。
②规划路径为转弯,若视觉识别模块识别出直行车道线,控制电动车继续直行,而协调控制模块3检测出规划路径距车道中心线距离d>Δd,电动车偏离规划路径较大,自动循迹方式变为依据差分GPS循迹,控制电动车回到规划路径。
①②两种情况都会造成较大行驶偏差,导致电动车无法回到规划路径,造成交通堵塞甚至交通事故。
因此,为避免上述情况,在多条路径(如分岔路口)路段设置解耦点,此时若电动车依据差分GPS循迹且视觉模块辅助,进入分岔路口路段时,协调控制模块3检测到解耦点,解除差分GPS模块与视觉识别模块的耦合,自动循迹方式变为依据差分GPS循迹,电动车驶出分岔路口路段,协调控制模块3检测不到解耦点,自动循迹方式与工况一相同。
补充地,当电动车遇到障碍物制动,清除障碍物后,协调控制模块3未检测到障碍物,自动驾驶控制模块控制驱动器41重新驱动电动车,自动循迹方式按所述协调控制算法得到。
最后应说明的几点是:首先,在本申请的描述中,需要说明的是,除非另有规定和限定,术语“安装”、“相连”、“连接”应做广义理解,可以是机械连接或电连接,也可以是两个元件内部的连通,可以是直接相连,“上”、“下”、“左”、“右”等仅用于表示相对位置关系,当被描述对象的绝对位置改变,则相对位置关系可能发生改变;
其次:本发明公开实施例附图中,只涉及到与本公开实施例涉及到的结构,其他结构可参考通常设计,在不冲突情况下,本发明同一实施例及不同实施例可以相互组合;
最后:以上所述仅为本发明的优选实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (7)
1.一种低速电动车自动循迹控制***,其特征在于,所述低速电动车自动循迹控制***包括视觉识别模块,差分GPS模块,协调控制模块,自动驾驶控制模块。视觉识别模块,用以识别电动车行驶车道内的车道线及前方预设范围的障碍物。差分GPS模块,用以获取电动车位置坐标,生成规划路径。协调控制模块,用以协调视觉识别模块和差分GPS模块。自动驾驶控制模块,与所述协调控制模块连接,接收协调控制信号,用于循迹行驶和遇到障碍物时制动。
2.根据权利要求1所述的***,其特征在于,所述视觉识别模块包括:
摄像头,设置在电动车前部,用于拍摄电动车所处车道内两车道线图像及前方预设范围的障碍物图像;
图像处理单元,与所述摄像头连接,用于处理所拍摄车道线及障碍物图像,获取电动车所在车道内相对位置,以及障碍物信息。
3.根据权利要求2所述的***,其特征在于,所述障碍物包括高度大于底盘最小高度或宽度大于通行安全宽度的行人、木块、石块,所述障碍物信息包括所述障碍物的位置和几何形状。
4.根据权利要求1所述的***,其特征在于,所述差分GPS模块包括:
两个差分GPS接收器,设置在电动车顶部纵向排列且相距不少于一米,用以获取电动车行驶中实时位置坐标和车身姿态;
计算中心,与差分GPS接收器连接,接收电动车行驶信息,用以在程序中生成规划路径信息;
所述规划路径信息包括规划路径坐标,以及在多条路径(如分岔路口)路段设置解耦点。
5.根据权利要求1所述的***,其特征在于,所述协调控制模块与图像处理单元和计算中心连接,用以接收所述图像处理单元输出的电动车相对车道位置信息和障碍物信息以及计算中心生成的规划路径信息,运用协调控制算法,协调视觉识别模块和差分GPS模块,输出协调控制信号。
6.根据权利要求5所述的***,其特征在于,所述协调控制算法包含三条判断依据,分别为是否检测到障碍物,是否检测到解耦点,规划路径与车道中心线距离是否≤d。经协调控制算法输出以下三种协调控制信号:制动;依据差分GPS循迹;依据差分GPS循迹且视觉模块辅助。
7.根据权利要求1所述的***,其特征在于,所述自动驾驶控制模块包括:
驱动器:控制电动车转向。
转向器:控制电动车启动和驱动。
制动器:控制电动车前方预设范围出现所述障碍物时制动;
所述自动驾驶控制模块与所述协调控制模块连接,接收协调控制信号,控制电动车制动和依据规划路径信息行驶,同时在规定差值范围内选择依据车道位置信息,进一步修正电动车在车道中心行驶。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010592981.9A CN111806435B (zh) | 2020-06-25 | 2020-06-25 | 一种低速电动车自动循迹控制*** |
NL2028206A NL2028206B1 (en) | 2020-06-25 | 2021-05-12 | Automatic tracking control system for low-speed electric vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010592981.9A CN111806435B (zh) | 2020-06-25 | 2020-06-25 | 一种低速电动车自动循迹控制*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111806435A true CN111806435A (zh) | 2020-10-23 |
CN111806435B CN111806435B (zh) | 2021-12-07 |
Family
ID=72856509
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010592981.9A Active CN111806435B (zh) | 2020-06-25 | 2020-06-25 | 一种低速电动车自动循迹控制*** |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN111806435B (zh) |
NL (1) | NL2028206B1 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112802356A (zh) * | 2020-12-30 | 2021-05-14 | 深圳市微网力合信息技术有限公司 | 一种基于物联网的车辆自动驾驶方法及终端 |
CN114128461A (zh) * | 2021-10-27 | 2022-03-04 | 江汉大学 | 穴盘育苗移栽机器人的控制方法及穴盘育苗移栽机器人 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103921788A (zh) * | 2014-04-02 | 2014-07-16 | 奇瑞汽车股份有限公司 | 一种汽车行驶控制***及方法 |
CN104267721A (zh) * | 2014-08-29 | 2015-01-07 | 陈业军 | 一种智能汽车的无人驾驶*** |
CN107139917A (zh) * | 2017-04-27 | 2017-09-08 | 江苏大学 | 一种基于混杂理论的无人驾驶汽车横向控制***和方法 |
CN208363002U (zh) * | 2018-06-05 | 2019-01-11 | 广东纵行科技有限公司 | 一种低速自动驾驶*** |
CN109649390A (zh) * | 2018-12-19 | 2019-04-19 | 清华大学苏州汽车研究院(吴江) | 一种自动驾驶汽车自主跟车***及方法 |
CN110456788A (zh) * | 2019-07-22 | 2019-11-15 | 中兴智能汽车有限公司 | 一种自动驾驶客车控制***及自动驾驶客车 |
CN110568848A (zh) * | 2019-09-10 | 2019-12-13 | 东风商用车有限公司 | 清扫车的示教自动驾驶作业*** |
CN110568841A (zh) * | 2019-08-05 | 2019-12-13 | 西藏宁算科技集团有限公司 | 一种自动驾驶决策方法及*** |
CN209803634U (zh) * | 2019-06-14 | 2019-12-17 | 湖南汽车工程职业学院 | 一种车载自动驾驶定位及控制*** |
CN209852177U (zh) * | 2019-02-23 | 2019-12-27 | 同济大学 | 一种用于自动驾驶清扫车的环境感知*** |
CN111260913A (zh) * | 2020-01-16 | 2020-06-09 | 江苏徐工工程机械研究院有限公司 | 一种露天矿山无人化运输***的矿用卡车卸载方法及*** |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7295925B2 (en) * | 1997-10-22 | 2007-11-13 | Intelligent Technologies International, Inc. | Accident avoidance systems and methods |
KR102064223B1 (ko) * | 2017-07-12 | 2020-02-11 | 엘지전자 주식회사 | 차량용 주행 시스템 및 차량 |
KR20200029050A (ko) * | 2017-08-30 | 2020-03-17 | 닛산 지도우샤 가부시키가이샤 | 운전 지원 차량의 주행 제어 방법 및 주행 제어 장치 |
-
2020
- 2020-06-25 CN CN202010592981.9A patent/CN111806435B/zh active Active
-
2021
- 2021-05-12 NL NL2028206A patent/NL2028206B1/en active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103921788A (zh) * | 2014-04-02 | 2014-07-16 | 奇瑞汽车股份有限公司 | 一种汽车行驶控制***及方法 |
CN104267721A (zh) * | 2014-08-29 | 2015-01-07 | 陈业军 | 一种智能汽车的无人驾驶*** |
CN107139917A (zh) * | 2017-04-27 | 2017-09-08 | 江苏大学 | 一种基于混杂理论的无人驾驶汽车横向控制***和方法 |
CN208363002U (zh) * | 2018-06-05 | 2019-01-11 | 广东纵行科技有限公司 | 一种低速自动驾驶*** |
CN109649390A (zh) * | 2018-12-19 | 2019-04-19 | 清华大学苏州汽车研究院(吴江) | 一种自动驾驶汽车自主跟车***及方法 |
CN209852177U (zh) * | 2019-02-23 | 2019-12-27 | 同济大学 | 一种用于自动驾驶清扫车的环境感知*** |
CN209803634U (zh) * | 2019-06-14 | 2019-12-17 | 湖南汽车工程职业学院 | 一种车载自动驾驶定位及控制*** |
CN110456788A (zh) * | 2019-07-22 | 2019-11-15 | 中兴智能汽车有限公司 | 一种自动驾驶客车控制***及自动驾驶客车 |
CN110568841A (zh) * | 2019-08-05 | 2019-12-13 | 西藏宁算科技集团有限公司 | 一种自动驾驶决策方法及*** |
CN110568848A (zh) * | 2019-09-10 | 2019-12-13 | 东风商用车有限公司 | 清扫车的示教自动驾驶作业*** |
CN111260913A (zh) * | 2020-01-16 | 2020-06-09 | 江苏徐工工程机械研究院有限公司 | 一种露天矿山无人化运输***的矿用卡车卸载方法及*** |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112802356A (zh) * | 2020-12-30 | 2021-05-14 | 深圳市微网力合信息技术有限公司 | 一种基于物联网的车辆自动驾驶方法及终端 |
CN112802356B (zh) * | 2020-12-30 | 2022-01-04 | 深圳市微网力合信息技术有限公司 | 一种基于物联网的车辆自动驾驶方法及终端 |
CN114128461A (zh) * | 2021-10-27 | 2022-03-04 | 江汉大学 | 穴盘育苗移栽机器人的控制方法及穴盘育苗移栽机器人 |
Also Published As
Publication number | Publication date |
---|---|
NL2028206A (en) | 2022-02-17 |
NL2028206B1 (en) | 2022-06-03 |
CN111806435B (zh) | 2021-12-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107145147B (zh) | 一种车辆低速自动驾驶避碰方法及*** | |
CN108928343A (zh) | 一种全景融合自动泊车***及方法 | |
US6151539A (en) | Autonomous vehicle arrangement and method for controlling an autonomous vehicle | |
JP7038118B2 (ja) | 駐車支援方法及び駐車制御装置 | |
US5913376A (en) | Automatic steering control apparatus | |
US8285476B2 (en) | Vehicle position calculating device and vehicle position calculating method | |
KR101398223B1 (ko) | 차량의 차선 변경 제어 장치 및 그 제어 방법 | |
WO2020135772A1 (zh) | 车辆自动驾驶时动态目标线的生成方法、生成***及车辆 | |
CN111806435B (zh) | 一种低速电动车自动循迹控制*** | |
CN106470886A (zh) | 用于建立运输工具的周围环境模型的方法 | |
CN108352117B (zh) | 车道维持控制装置 | |
JP6623311B2 (ja) | 制御装置及び制御方法 | |
CN109542097A (zh) | 红外置顶循迹的井下无人无轨胶轮车及其行驶控制方法 | |
JP2004110390A (ja) | 車外監視装置、及び、この車外監視装置を備えた走行制御装置 | |
JPH0962346A (ja) | 自動操舵システム | |
JP6991119B2 (ja) | 自動運転における進路制御方法 | |
CN108459600A (zh) | 一种agv小车的视觉导航*** | |
CN112537295A (zh) | 驾驶辅助装置 | |
JP6710647B2 (ja) | 駐車支援装置 | |
JP3245363B2 (ja) | 車両の衝突防止装置 | |
JP2004322916A (ja) | 運転支援装置 | |
CN112837554A (zh) | 基于双目相机的agv定位导航方法及*** | |
JPH1139598A (ja) | 車両の衝突防止装置 | |
JP7006889B2 (ja) | 移動車両の走行システム | |
EP3679441B1 (en) | Mobile robot having collision avoidance system for crossing a road from a pedestrian pathway |
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 |