CN105974917B - A kind of vehicle obstacle-avoidance path planning research method based on novel artificial potential field method - Google Patents
A kind of vehicle obstacle-avoidance path planning research method based on novel artificial potential field method Download PDFInfo
- Publication number
- CN105974917B CN105974917B CN201610309717.3A CN201610309717A CN105974917B CN 105974917 B CN105974917 B CN 105974917B CN 201610309717 A CN201610309717 A CN 201610309717A CN 105974917 B CN105974917 B CN 105974917B
- Authority
- CN
- China
- Prior art keywords
- obstacle
- main vehicle
- vehicle
- potential field
- road
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 102
- 230000008569 process Effects 0.000 claims abstract description 32
- 239000013598 vector Substances 0.000 claims description 9
- 230000007423 decrease Effects 0.000 claims description 7
- 239000002131 composite material Substances 0.000 claims description 5
- 238000001514 detection method Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 abstract description 5
- 230000009471 action Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 13
- 230000001133 acceleration Effects 0.000 description 11
- 206010039203 Road traffic accident Diseases 0.000 description 6
- 230000008859 change Effects 0.000 description 5
- 238000013178 mathematical model Methods 0.000 description 4
- 238000004088 simulation Methods 0.000 description 4
- 230000006872 improvement Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000009977 dual effect Effects 0.000 description 2
- 238000005381 potential energy Methods 0.000 description 2
- 230000003321 amplification Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000008676 import Effects 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000004886 process control Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting 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)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种基于新型人工势场法的车辆避障路径规划研究方法,包括步骤:利用CCD摄像机、毫米波雷达、车载传感器分别实时采集车辆避障路径规划所需的信息,根据车辆避障路径规划所需的信息后,建立基于人工势场法的道路边界斥力势场和障碍物斥力势场模型,由主车在道路边界斥力势场和障碍物斥力势场组成的复合场中受到的力的作用建立平衡方程,求解得到主车在避障过程中要经过的位置点,从而得到避障路径,同时对避障过程中的主车车速进行控制以提高安全性和舒适性。本发明所用方法计算量小、便于实现实时控制,规划出的避障路径比传统方法更加安全、可靠。
The invention discloses a research method for vehicle obstacle avoidance path planning based on a novel artificial potential field method. After obtaining the information required for obstacle path planning, the road boundary repulsion potential field and obstacle repulsion potential field models based on the artificial potential field method are established, and the main vehicle is subjected to The balance equation is established based on the action of the force, and the location points that the main vehicle will pass through during the obstacle avoidance process are obtained by solving the solution, so as to obtain the obstacle avoidance path. At the same time, the speed of the main vehicle during the obstacle avoidance process is controlled to improve safety and comfort. The method used in the invention has a small calculation amount and is convenient for realizing real-time control, and the planned obstacle avoidance path is safer and more reliable than the traditional method.
Description
技术领域technical field
本发明属于机动车辆驾驶安全领域,特别是涉及一种基于新型人工势场法的车辆避障路径规划研究方法。The invention belongs to the field of motor vehicle driving safety, and in particular relates to a research method for vehicle obstacle avoidance path planning based on a novel artificial potential field method.
背景技术Background technique
道路交通事故多由车辆与障碍物的碰撞以及碰撞后的次生事故引起。根据公安部交通管理科学研究所发布的我国2010年的交通事故统计数据,分析可知,因驾驶员过失(比如:判断失误,决策失误等)造成的交通事故起数约占90%。如果能够在紧急交通情况下帮助驾驶员采取相应的安全措施,那么交通事故的发生几率将会大幅减小,而车辆的局部避障路径规划正是实现这一目标的重要手段。该方法在碰撞发生前为车辆规划处一条安全路径,使车辆无碰撞的绕过障碍物,这对减少道路交通事故的发生具有十分重要的意义。Road traffic accidents are mostly caused by collisions between vehicles and obstacles and secondary accidents after collisions. According to the statistical data of traffic accidents in my country in 2010 released by the Traffic Management Science Research Institute of the Ministry of Public Security, the analysis shows that the number of traffic accidents caused by driver errors (such as: misjudgment, wrong decision, etc.) accounts for about 90%. If the driver can be helped to take corresponding safety measures in an emergency traffic situation, the probability of traffic accidents will be greatly reduced, and the vehicle's local obstacle avoidance path planning is an important means to achieve this goal. This method plans a safe path for the vehicle before the collision, so that the vehicle can bypass the obstacle without collision, which is of great significance to reduce the occurrence of road traffic accidents.
车辆局部路经规划是一个比较复杂的过程,驾驶员在行车过程中仅依靠感觉和经验进行避障的判断,很容易发生事故,尤其在高速行驶时。局部路径规划主要分为已知环境信息和未知环境信息两种类型,由于前者所适应的范围非常局限,所以本发明主要针对未知环境信息情形下的车辆局部路径规划。车辆通过车载设备(毫米波雷达、CCD摄像机、各种传感器等)获取道路信息,如路宽、车道数、障碍物的位置,大小等,并将这些信息进行一定的分析处理,然后根据探测到的这些信息规划出一条由起始点到目标点的无碰撞最优路径。Vehicle local path planning is a relatively complicated process. Drivers only rely on their senses and experience to make obstacle avoidance judgments during driving, which is prone to accidents, especially when driving at high speeds. Local path planning is mainly divided into two types: known environment information and unknown environment information. Since the scope of the former is very limited, the present invention is mainly aimed at vehicle local path planning in the case of unknown environment information. Vehicles obtain road information through on-board equipment (millimeter wave radar, CCD camera, various sensors, etc.), such as road width, number of lanes, position and size of obstacles, etc. Based on this information, a collision-free optimal path from the starting point to the goal point is planned.
中国专利CN 102520718 A公开了一种基于物理建模的机器人避障路径规划方法,该方法通过设立机器人工作区域的引力场栅格和距离信息栅格,建立机器人双重栅格信息图,基于上述双重栅格信息图,采用有向遍历法搜索所有可行路径进行规划。该方法是针对已经环境信息条件下为机器人进行避障路径规划,且当栅格取得很小时,存在计算量大等问题。中国专利CN104317291A公开了一种基于人工势场法的机器人避碰路径规划研究方法,提供了一种复杂形状移动机器人在未知环境下的的避碰路径规划方法。该方法只适用于静态障碍物的场合,且不能克服传统人工势场法的局部极小值问题。Chinese patent CN 102520718 A discloses a robot obstacle avoidance path planning method based on physical modeling. The method establishes a robot dual grid information map by setting up a gravitational field grid and a distance information grid in the robot working area. Based on the above dual The raster information map uses the directed traversal method to search for all feasible paths for planning. This method is aimed at planning obstacle-avoiding paths for robots under the condition of existing environmental information, and when the grid is obtained very small, there are problems such as large amount of calculation. Chinese patent CN104317291A discloses a research method for robot collision avoidance path planning based on artificial potential field method, and provides a collision avoidance path planning method for mobile robots with complex shapes in an unknown environment. This method is only suitable for static obstacles, and cannot overcome the local minimum problem of the traditional artificial potential field method.
发明内容Contents of the invention
针对现有技术的不足,本发明提供了一种基于新型人工势场法的车辆避障路径规划研究方法,解决计算量大、传统人工势场法的局部极小值问题。Aiming at the deficiencies of the prior art, the present invention provides a vehicle obstacle avoidance path planning research method based on a novel artificial potential field method, which solves the problem of large calculation and local minimum value of the traditional artificial potential field method.
本发明是采用如下技术方案,实现上述技术目的。The present invention adopts the following technical solutions to achieve the above-mentioned technical purpose.
一种基于新型人工势场法的车辆避障路径规划研究方法,包括以下步骤:A research method for vehicle obstacle avoidance path planning based on a novel artificial potential field method, comprising the following steps:
S1.利用CCD摄像机、毫米波雷达、车载设备分别实时采集车辆避障路径规划所需的道路信息、障碍物信息、主车信息;S1. Use CCD cameras, millimeter wave radars, and on-board equipment to collect road information, obstacle information, and main vehicle information required for vehicle obstacle avoidance path planning in real time;
S2.获取车辆避障路径规划所需的信息后,在毫米波雷达的探测范围建立道路坐标系,用向量表示道路边界点、障碍物、主车的位置,根据道路信息、障碍物信息、主车信息建立基于人工势场法的道路边界斥力势场和障碍物斥力势场模型;具体如下:S2. After obtaining the information required for vehicle obstacle avoidance path planning, establish a road coordinate system within the detection range of the millimeter-wave radar, and use vectors to represent the position of road boundary points, obstacles, and the main vehicle. The car information establishes the road boundary repulsion potential field and obstacle repulsion potential field model based on the artificial potential field method; the details are as follows:
S2.1道路坐标系的建立S2.1 Establishment of road coordinate system
在平直或近似平直、宽为B的多车道道路上,根据毫米波雷达性能,在毫米波雷达的可探测距离L内,将道路边界分为n等份,每个等份间的距离为L0=L/n;以主车所在车道的中心线为x轴,主车质心在路面上的投影点为原点建立道路坐标系,假设在未来每一时刻汽车的质心位于道路边界对应等分点的连线上,则道路左、右边界上每个等分点、障碍物、主车的位置可以用向量表示出来;On a straight or nearly straight multi-lane road with a width of B, according to the performance of the millimeter-wave radar, within the detectable distance L of the millimeter-wave radar, divide the road boundary into n equal parts, and the distance between each equal part L 0 = L/n; take the centerline of the lane where the main vehicle is located as the x-axis, and the projection point of the main vehicle's center of mass on the road surface as the origin to establish a road coordinate system, assuming that the vehicle's center of mass is located at the road boundary at each moment in the future, corresponding to On the connecting line of the dividing points, the position of each dividing point, obstacle, and main vehicle on the left and right boundaries of the road can be represented by vectors;
S2.2道路边界斥力势场的建立S2.2 Establishment of road boundary repulsion potential field
通过CCD摄像机识别前方的道路边界线并提取出道路边界线数据,通过边界线数据进行分析处理提取出道路信息,再以此建立道路边界斥力势场;Identify the front road boundary line through the CCD camera and extract the road boundary line data, analyze and process the boundary line data to extract road information, and then establish the road boundary repulsion potential field;
S2.3障碍物斥力势场的建立S2.3 Establishment of obstacle repulsion potential field
通过毫米波雷达检测主车前方的障碍物信息、车载传感器获取主车的速度信息,再以此建立障碍物斥力势场;The millimeter-wave radar detects the obstacle information in front of the main vehicle, and the on-board sensor obtains the speed information of the main vehicle, and then establishes the obstacle repulsion potential field;
S3.根据主车在道路边界斥力势场和障碍物斥力势场组成的复合场中受到的力的作用建立平衡方程,并利用数学软件matlab对其进行求解得到主车在避障过程中要经过的位置点,从而得到避障路径;S3. Establish a balance equation based on the force that the main vehicle receives in the composite field composed of the road boundary repulsion potential field and the obstacle repulsion potential field, and use the mathematical software matlab to solve it to obtain the main vehicle's obstacles during obstacle avoidance. The location point of , so as to obtain the obstacle avoidance path;
S4.对避障过程中的主车车速进行控制以提高安全性,使主车在避障时将车速降低到一个合适的值,并在绕开障碍物后恢复正常车速行驶。S4. Control the speed of the main vehicle during the obstacle avoidance process to improve safety, so that the main vehicle reduces the vehicle speed to an appropriate value during obstacle avoidance, and returns to normal speed after avoiding the obstacle.
进一步,所述S1中,道路信息包括路宽及车道数量;障碍物信息,包括障碍物的数目、大小、位置及速度;主车信息包括主车的速度、主车与障碍物的距离、主车与道路边界的距离以及主车相对于障碍物的角度。Further, in the S1, the road information includes road width and the number of lanes; obstacle information includes the number, size, position and speed of obstacles; the host vehicle information includes the speed of the host vehicle, the distance between the host vehicle and the obstacle, the The distance between the car and the road boundary and the angle of the host car relative to the obstacle.
进一步,所述S2.3障碍物斥力势场的建立过程中,将主车等效为一个质点,并用一个直径为D的安全圆包裹住障碍物,同时,为了使主车能够提前开始避障,赋予障碍物一个影响范围ρ0,当车辆进入障碍物影响范围ρ0时,将只受到沿道路坐标系y方向分布的障碍物斥力势场的作用,同时,对于主车前方运动的障碍物,若障碍物的速度在主车速度方向上有速度分量,则主车还会受到障碍物速度势场的斥力作用。Further, in the establishment process of the S2.3 obstacle repulsion potential field, the main vehicle is equivalent to a mass point, and a safety circle with a diameter D is used to wrap the obstacle. At the same time, in order to enable the main vehicle to start obstacle avoidance in advance , giving the obstacle an influence range ρ 0 , when the vehicle enters the obstacle influence range ρ 0 , it will only be affected by the obstacle repulsion potential field distributed along the y-direction of the road coordinate system. At the same time, for the obstacle moving in front of the main vehicle , if the velocity of the obstacle has a velocity component in the velocity direction of the host vehicle, the host vehicle will also be affected by the repulsive force of the velocity potential field of the obstacle.
进一步,所述S3中,借助matlab对建立的平衡方程求解,实际得到的是主车未来某时刻将要驶向的点的纵坐标,从而得到主车在避障过程所要经过的各点,再将这些点进行曲线拟合,从而得到一条能使主车安全绕过障碍物的避障路径;同时,由于障碍物有可能是运动的,所以每隔一段时间Δt,根据新采集的信息再次进行路径规划,以保证实时性。Further, in the above S3, with the help of matlab to solve the established balance equation, what is actually obtained is the ordinate of the point where the main vehicle will drive to at a certain time in the future, so as to obtain the points that the main vehicle will pass through during the obstacle avoidance process, and then Curve fitting is performed on these points to obtain an obstacle avoidance path that enables the main vehicle to bypass obstacles safely; at the same time, since the obstacle may be moving, the path is performed again according to the newly collected information at intervals Δt planning to ensure real-time performance.
进一步,所述S4在主车避障过程中,主车进入障碍物影响范围后,对主车车速进行控制,使主车车速能随主车与障碍物距离的减小而减小,当车辆绕过障碍物后,主车车速能随主车与障碍物距离的增大而增大,当主车驶出障碍物的影响范围时,主车车速将不再受该模型的控制。Further, in the S4, during the obstacle avoidance process of the main vehicle, after the main vehicle enters the influence range of the obstacle, the speed of the main vehicle is controlled so that the speed of the main vehicle can decrease with the decrease of the distance between the main vehicle and the obstacle. After bypassing the obstacle, the speed of the main vehicle can increase with the increase of the distance between the main vehicle and the obstacle. When the main vehicle drives out of the influence range of the obstacle, the speed of the main vehicle will no longer be controlled by the model.
有益效果:利用改进的人工势场法为车辆自主避障规划出一条安全路径,并在避障过程中对主车车速进行控制以提高避障过程的安全性和舒适性。对于运动的障碍物和静止的障碍物,本方法都能在碰撞发生前为车辆规划出安全无碰撞的路径绕开障碍物,可极大的减少因避障失误所导致的交通事故,并且所用方法计算量小、便于实现实时控制。Beneficial effects: the improved artificial potential field method is used to plan a safe path for the vehicle's autonomous obstacle avoidance, and the speed of the main vehicle is controlled during the obstacle avoidance process to improve the safety and comfort of the obstacle avoidance process. For moving obstacles and stationary obstacles, this method can plan a safe and collision-free path for the vehicle to avoid obstacles before the collision occurs, which can greatly reduce traffic accidents caused by obstacle avoidance errors, and the used The calculation amount of the method is small, and it is convenient to realize real-time control.
附图说明Description of drawings
图1为本发明一种基于新型人工势场法的车辆避障路径规划研究方法的流程图;Fig. 1 is a kind of flow chart of the vehicle obstacle avoidance path planning research method based on novel artificial potential field method of the present invention;
图2为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的道路坐标系图;Fig. 2 is a road coordinate system diagram described in a vehicle obstacle avoidance path planning research method based on the novel artificial potential field method of the present invention;
图3为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的道路边界斥力示意图;Fig. 3 is a schematic diagram of road boundary repulsion described in a method of vehicle obstacle avoidance path planning research method based on the novel artificial potential field method of the present invention;
图4为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的道路边界斥力势场分布图;Fig. 4 is a distribution diagram of the road boundary repulsion potential field described in the vehicle obstacle avoidance path planning research method based on the novel artificial potential field method of the present invention;
图5为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的速度方向示意图;Fig. 5 is a schematic diagram of the speed direction described in a vehicle obstacle avoidance path planning research method based on the novel artificial potential field method of the present invention;
图6为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的主车所受合力图;Fig. 6 is a diagram of the resultant force suffered by the main vehicle described in the research method for vehicle obstacle avoidance path planning based on the novel artificial potential field method of the present invention;
图7为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的避障路径图;Fig. 7 is the obstacle avoidance path diagram described in a kind of vehicle obstacle avoidance path planning research method based on the novel artificial potential field method of the present invention;
图8为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的未引入速度避障路径图;Fig. 8 is the non-introduced speed obstacle avoidance path diagram described in the vehicle obstacle avoidance path planning research method based on the novel artificial potential field method of the present invention;
图9为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的路径跟随图;Fig. 9 is a path following diagram described in a research method for vehicle obstacle avoidance path planning based on the novel artificial potential field method of the present invention;
图10为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的横摆角速度图;Fig. 10 is a yaw rate diagram described in a research method for vehicle obstacle avoidance path planning based on the novel artificial potential field method of the present invention;
图11为本发明一种基于新型人工势场法的车辆避障路径规划研究方法中所述的侧向加速度图。FIG. 11 is a diagram of lateral acceleration described in a research method for vehicle obstacle avoidance path planning based on a novel artificial potential field method according to the present invention.
具体实施方式Detailed ways
下面将结合附图以及具体实施例对本发明作进一步的说明,但本发明的保护范围并不限于此。The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments, but the protection scope of the present invention is not limited thereto.
如图1所示,一种基于改进型人工势场法和速度控制的车辆避障路径规划研究方法流程图,包括步骤:As shown in Figure 1, a flow chart of a research method for vehicle obstacle avoidance path planning based on the improved artificial potential field method and speed control, including steps:
S1.利用CCD摄像机、毫米波雷达、车载设备(车载传感器、全球定位系统GPS)分别实时采集车辆避障路径规划所需的道路信息、障碍物信息、主车信息;CCD摄像机安装在主车前挡风玻璃上,需保证摄像头能够“直视”前方;毫米波雷达安装在车头前部、车辆的纵向轴线上,与地面的距离最少为35cm,最大为65cm;车速传感器安装在变速器壳内,主车内置有GPS。S1. Use CCD camera, millimeter-wave radar, and vehicle-mounted equipment (vehicle sensor, global positioning system GPS) to collect in real time the road information, obstacle information, and main vehicle information required for vehicle obstacle avoidance path planning; the CCD camera is installed in front of the main vehicle On the windshield, it is necessary to ensure that the camera can "look straight ahead"; the millimeter-wave radar is installed on the front of the car and on the longitudinal axis of the vehicle, and the distance from the ground is at least 35cm and the maximum is 65cm; the vehicle speed sensor is installed in the transmission case. The main vehicle has built-in GPS.
其中道路信息包括路宽及车道数量;障碍物信息,包括障碍物的数目、大小、位置及速度;主车信息包括主车的速度、主车与障碍物的距离、主车与道路边界的距离以及主车相对于障碍物的角度。The road information includes the road width and the number of lanes; the obstacle information includes the number, size, position and speed of obstacles; the main vehicle information includes the speed of the main vehicle, the distance between the main vehicle and obstacles, and the distance between the main vehicle and the road boundary And the angle of the main vehicle relative to the obstacle.
S2.获取车辆避障路径规划所需的信息后,在毫米波雷达的探测范围建立道路坐标系,用向量表示道路边界点、障碍物、主车的位置,根据道路信息、障碍物信息、主车信息建立基于人工势场法的道路边界斥力势场和障碍物斥力势场模型;具体如下:S2. After obtaining the information required for vehicle obstacle avoidance path planning, establish a road coordinate system within the detection range of the millimeter-wave radar, and use vectors to represent the position of road boundary points, obstacles, and the main vehicle. The car information establishes the road boundary repulsion potential field and obstacle repulsion potential field model based on the artificial potential field method; the details are as follows:
S2.1道路坐标系的建立S2.1 Establishment of road coordinate system
在平直或近似平直、宽为B的多车道道路上,根据毫米波雷达性能,在毫米波雷达的可探测距离L内,将道路边界分为n等份,每个等份间的距离为L0=L/n,如图2所示;以主车所在车道的中心线为x轴,主车质心在路面上的投影点为原点建立道路坐标系,假设在未来每一时刻汽车的质心位于道路边界对应等分点的连线上,则道路左、右边界上每个等分点、障碍物、主车的位置可以用向量表示出来。On a straight or nearly straight multi-lane road with a width of B, according to the performance of the millimeter-wave radar, within the detectable distance L of the millimeter-wave radar, divide the road boundary into n equal parts, and the distance between each equal part L 0 =L/n, as shown in Figure 2; take the center line of the lane where the main vehicle is located as the x-axis, and the projection point of the main vehicle’s center of mass on the road surface as the origin to establish a road coordinate system, assuming that the vehicle’s The center of mass is located on the connection line corresponding to the bisection points of the road boundary, then the position of each bisection point, obstacle, and main vehicle on the left and right boundaries of the road can be represented by a vector.
S2.2道路边界斥力势场的建立S2.2 Establishment of road boundary repulsion potential field
通过CCD摄像机识别前方的道路边界线并提取出道路边界线数据,通过边界线数据进行分析处理提取出道路信息,再以此建立道路边界斥力势场;道路边界斥力势场对处在其中的车辆产生斥力作用,如图3所示,以此来限制车辆的行驶区域。Identify the front road boundary line through the CCD camera and extract the road boundary line data, analyze and process the boundary line data to extract road information, and then establish the road boundary repulsion potential field; Generate a repulsive force, as shown in Figure 3, to limit the driving area of the vehicle.
根据人工势场模型在机器人领域运用的经验,建立如下式所示的道路边界斥力势场的数学模型:According to the experience of using the artificial potential field model in the field of robots, the mathematical model of the repulsion potential field at the road boundary is established as shown in the following formula:
式中的Uroad,L、Uroad,R分别为道路左右边界斥力势场,kroadL、kroadR分别为道路左、右边界危险斥力场施加斥力的比例常数,分别为汽车质心、道路左、右边界上对应点的坐标向量,W车为车宽。In the formula, U road,L , U road,R are the repulsive force potential fields on the left and right boundaries of the road, respectively, k roadL , k roadR are the proportional constants of the repulsive force applied by the dangerous repulsive force field on the left and right boundaries of the road, respectively, are the coordinate vectors of the center of mass of the car and the corresponding points on the left and right boundaries of the road, and Wcar is the width of the car .
由数学模型(1)、(2)及图4可知,汽车与道路边界的距离越小,它的势能值越大,汽车受到的斥力也就越大,当车辆与道路边界的距离趋于零时,道路边界斥力将趋于无穷大,以此来限制车辆的行驶区域,斥力可由对势场模型进行梯度运算得到。From the mathematical models (1), (2) and Figure 4, it can be seen that the smaller the distance between the vehicle and the road boundary, the greater its potential energy value, and the greater the repulsion force on the vehicle. When the distance between the vehicle and the road boundary tends to zero When , the road boundary repulsion will tend to infinity, so as to limit the driving area of the vehicle. The repulsion can be obtained by gradient calculation of the potential field model.
为了使车辆在道路中没有障碍物或无需采取避障措施时,能够沿着车道行驶,即实现车道保持功能,我们通过调整势场的比例常数kroad,L、kroad,R来使车辆在道路边界斥力势场的作用下,其受力平衡点始终保持在车道中间,但是,考虑到交通规则和驾驶员的驾驶习惯,我们将尽量使主车在无需避障的情况下能够沿着右车道的中心线行驶,本发明取主车行驶车道为双车道,由势场数学模型可知:In order to enable the vehicle to drive along the lane when there are no obstacles in the road or without taking obstacle avoidance measures, that is, to realize the lane keeping function, we adjust the proportional constants k road,L and k road,R of the potential field to make the vehicle in Under the action of the repulsive potential field at the road boundary, its force balance point is always kept in the middle of the lane. However, considering the traffic rules and the driver's driving habits, we will try our best to make the main vehicle be able to drive along the right side without avoiding obstacles. The centerline of the lane travels, and the present invention takes the driving lane of the main vehicle as a two-lane lane, as can be known from the potential field mathematical model:
Uroad,L=Uroad,R (3)U road, L = U road, R (3)
在没有障碍物时,主车距离车道右边界距离为主车距离车道左边界距离为 When there is no obstacle, the distance between the main vehicle and the right boundary of the lane is The distance between the main vehicle and the left boundary of the lane is
即which is
从而得到如下关系:Thus the following relationship is obtained:
S2.3障碍物斥力势场的建立S2.3 Establishment of obstacle repulsion potential field
通过毫米波雷达检测主车前方的障碍物信息、车载传感器获取主车的速度信息,再以此建立障碍物斥力势场。The millimeter-wave radar detects the obstacle information in front of the main vehicle, and the on-board sensor obtains the speed information of the main vehicle, and then establishes the obstacle repulsion potential field.
障碍物斥力势场对行驶中的车辆产生斥力作用,使车辆远离障碍物。汽车在行驶过程中,前方的道路交通情况随时都可能发生变化,可能没有障碍物,可能突然出现障碍物,障碍物可能是静止的,也可能运动的;因此,车载雷达必须以一定的频率不断探测前方的道路情况,包括障碍物的数目、大小、位置以及速度。影响障碍物斥力大小的因素主要有:障碍物相对于本车的位置和速度,障碍物的大小(按标准车)。The obstacle repulsion potential field produces a repulsion effect on the moving vehicle, keeping the vehicle away from the obstacle. During the driving process of the car, the road traffic conditions ahead may change at any time, there may be no obstacles, obstacles may appear suddenly, obstacles may be stationary or moving; therefore, the vehicle radar must constantly Detect the road conditions ahead, including the number, size, position and speed of obstacles. The factors affecting the size of the obstacle repulsion mainly include: the position and speed of the obstacle relative to the vehicle, and the size of the obstacle (according to the standard vehicle).
在路径规划过程中,将主车等效为一个质点,这与实际情况不符,为此用一个直径为D的安全圆包裹住障碍物,这个安全圆的尺寸必须将主车和障碍物的尺寸都考虑进去,为此本发明暂定直径D为两倍车宽。同时,为了是主车能够提前开始避障,我们赋予障碍物一个影响范围ρ0,ρ0取值为车辆的制动安全距离,当车辆进入障碍物影响范围ρ0时,将受到障碍物斥力势场的作用,且该斥力势场只沿y方向分布。同时,对于主车前方运动的障碍物,规定障碍物速度方向为β,主车速度的方向为θ,如图5所示,则主车速度方向与障碍物速度方向之间的夹角α=θ-β;若即障碍物的速度在主车速度上有一个分量v0cosα,则主车还会受到障碍物速度势场的斥力作用;若即障碍物的速度在主车速度方向上没有速度分量,则主车不受速度斥力势场的作用。避障过程只考虑主车前方的障碍物,故α∈(0,π)。In the process of path planning, the main vehicle is equivalent to a particle, which is inconsistent with the actual situation. Therefore, a safety circle with a diameter of D is used to wrap the obstacle. The size of this safety circle must be the size of the main vehicle and the obstacle. All take into account, the tentative diameter D of the present invention is twice the vehicle width for this reason. At the same time, in order for the main vehicle to start avoiding obstacles in advance, we give the obstacle an influence range ρ 0 , and the value of ρ 0 is the braking safety distance of the vehicle. When the vehicle enters the obstacle influence range ρ 0 , it will be repulsed by the obstacle The effect of the potential field, and the repulsive potential field is only distributed along the y direction. At the same time, for the obstacle moving in front of the main vehicle, the speed direction of the obstacle is defined as β, and the speed direction of the main vehicle is θ. As shown in Figure 5, the angle between the speed direction of the main vehicle and the obstacle speed direction α = θ-β; if That is, the speed of the obstacle has a component v 0 cosα in the speed of the main vehicle, and the main vehicle will also be affected by the repulsive force of the velocity potential field of the obstacle; if That is to say, the speed of the obstacle has no velocity component in the direction of the speed of the main vehicle, so the main vehicle is not affected by the potential field of velocity repulsion. The obstacle avoidance process only considers the obstacles in front of the main vehicle, so α∈(0,π).
情况一,当时,障碍物的斥力势场为:Case 1, when When , the repulsion potential field of the obstacle is:
情况二,当时,障碍物的斥力势场为:Case 2, when When , the repulsion potential field of the obstacle is:
情况三,当时,此时,主车不受障碍物斥力势场的作用,即Case three, when At this time, the main vehicle is not affected by the repulsive potential field of obstacles, that is,
Ureq=0 (8)U req = 0 (8)
综上所述,障碍物斥力势场为In summary, the obstacle repulsion potential field is
式中kob为障碍物斥力势场的比例系数,为汽车质心对应点的坐标向量,W车为车宽,为障碍物的位置向量,D为安全圆的直径,ρ0为障碍物的影响范围,v为主车的当前运动速度,v0为动态障碍物的当前运动速度,θ为移动车体的当前运动方向;φ为动态障碍物的当前运动方向。where k ob is the proportional coefficient of the obstacle repulsion potential field, is the coordinate vector of the point corresponding to the center of mass of the car , Wcar is the width of the car, is the position vector of the obstacle, D is the diameter of the safety circle, ρ 0 is the influence range of the obstacle, v is the current velocity of the main vehicle, v 0 is the current velocity of the dynamic obstacle, θ is the current velocity of the moving vehicle Movement direction; φ is the current movement direction of the dynamic obstacle.
从数学模型(9)及图4的势能值分布图可知,主车在进入障碍物的影响范围之后,随着主车与障碍物距离减小,主车受到的斥力增大,当主车与障碍物的距离趋近于零时,障碍物的斥力将区域无穷大,以此来使主车不予障碍物相撞。同时,对于运动的障碍物,障碍物的速度在本车速度方向上的分量越大,本车受到的斥力也就越大。From the mathematical model (9) and the potential energy value distribution diagram in Figure 4, it can be seen that after the main vehicle enters the influence range of the obstacle, as the distance between the main vehicle and the obstacle decreases, the repulsion force received by the main vehicle increases. When the distance of the object approaches zero, the repulsive force of the obstacle will expand to an infinite area, so as to prevent the main vehicle from colliding with the obstacle. At the same time, for a moving obstacle, the greater the component of the obstacle's speed in the direction of the vehicle's speed, the greater the repulsion force received by the vehicle.
S3.根据主车在道路边界斥力势场和障碍物斥力势场组成的复合场中受到的力的作用建立平衡方程,并利用matlab对其进行求解得到主车在避障过程中要经过的位置点,从而得到避障路径;S3. Establish a balance equation based on the force that the main vehicle receives in the composite field composed of the road boundary repulsion potential field and the obstacle repulsion potential field, and use matlab to solve it to obtain the position that the main vehicle will pass through during the obstacle avoidance process point, so as to obtain the obstacle avoidance path;
在道路边界斥力势场和障碍物斥力势场组成的复合场中,主车受到复合场力的作用,并最终达到平衡状态,如图6所示,即:In the composite field composed of the road boundary repulsion potential field and the obstacle repulsion potential field, the main vehicle is affected by the composite field force and finally reaches a balanced state, as shown in Figure 6, namely:
借助数学软件matlab对其求解,由于假设主车为未来任意时刻的横坐标都对应道路边界某一等分点,即主车的横坐标已知(xi=(i-1)L0),对平衡方程进行求解,实际得到的是主车未来某时刻将要驶向的点的纵坐标,从而得到主车在避障过程所要经过的各点,然后用一条平滑的曲线将这些点连接起来,就得到一条能使主车安全绕过障碍物的避障路径。同时,由于障碍物有可能是运动的,所以每隔一段时间Δt,根据新采集的信息再次进行路径规划,以保证实时性。Solve it with the help of the mathematical software matlab, since it is assumed that the abscissa of the main vehicle at any time in the future corresponds to a certain bisection point of the road boundary, that is, the abscissa of the main vehicle is known ( xi = (i-1)L 0 ), Solving the balance equation, what is actually obtained is the ordinate of the point that the main vehicle will drive to at a certain time in the future, so as to obtain the points that the main vehicle will pass through during the obstacle avoidance process, and then connect these points with a smooth curve, An obstacle avoidance path that enables the main vehicle to bypass obstacles safely is obtained. At the same time, because the obstacle may be moving, the path planning is carried out again according to the newly collected information at intervals Δt to ensure real-time performance.
主程序如下:The main program is as follows:
通过matlab的运算,可以得到避障路径的坐标,根据l的取值,共有120组数据,由于篇幅的限制,这里只列出20组,如表1所示:Through the operation of matlab, the coordinates of the obstacle avoidance path can be obtained. According to the value of l, there are 120 sets of data in total. Due to space limitations, only 20 sets are listed here, as shown in Table 1:
表1避障过程的20组坐标Table 1 20 sets of coordinates in the obstacle avoidance process
从表1数据和图7可以看出,改进后的方法规划出来的路径在避障过程中主车与障碍物的距离大于改进前的距离至少20cm,这可以有效的提高避障时的安全性,避免与障碍物发生“擦肩而过”的现象。从图8中可以看出,对于运动的障碍物,改进前的方法规划出的路径和障碍物有重叠,这说明主车按此路径行驶会与障碍物相撞,而改进后的方法却能很好的规避运动的障碍物。From the data in Table 1 and Figure 7, it can be seen that the distance between the main vehicle and the obstacle in the path planned by the improved method is greater than the distance before the improvement by at least 20cm, which can effectively improve the safety of obstacle avoidance , to avoid the phenomenon of "passing by" with obstacles. It can be seen from Figure 8 that for moving obstacles, the path planned by the method before the improvement overlaps with the obstacle, which means that the main vehicle will collide with the obstacle when driving on this path, but the improved method can Good for avoiding moving obstacles.
S4.对避障过程中的主车车速进行控制以提高安全性,使主车在避障时将车速降低到一个合适的值,并在绕开障碍物后恢复正常车速行驶。S4. Control the speed of the main vehicle during the obstacle avoidance process to improve safety, so that the main vehicle reduces the vehicle speed to an appropriate value during obstacle avoidance, and returns to normal speed after avoiding the obstacle.
车辆在避障过程中为了保证安全,必须与障碍物保持一定的距离,且在避障转向时,如果仍以之前的速度行驶(通常>40km/h),则会严重影响避障的安全性和乘坐舒适性,尤其是高速行驶时,为此本文提出了对避障过程车辆速度的控制方法,使车辆在避障时将车速降低到一个合适的值,并在绕开障碍物后恢复正常车速行驶。速度的控制模型为:In order to ensure safety during the obstacle avoidance process, the vehicle must keep a certain distance from the obstacle, and if it is still driving at the previous speed (usually >40km/h) during the obstacle avoidance steering, the safety of obstacle avoidance will be seriously affected and riding comfort, especially when driving at high speed, this paper proposes a control method for the vehicle speed in the obstacle avoidance process, so that the vehicle can reduce the vehicle speed to a suitable value when avoiding obstacles, and return to normal after avoiding obstacles Drive at speed. The speed control model is:
式中dco代表主车与障碍物间的距离,d0为预留的安全距离,vc是主车避障前的速度,amax为最大减速度,λ为放大系数,取λ=0.6~0.7,ρ0代表障碍物的影响距离,td为车辆从开始制动到其停止的时间。In the formula, d co represents the distance between the main vehicle and the obstacle, d 0 is the reserved safety distance, v c is the speed of the main vehicle before avoiding obstacles, a max is the maximum deceleration, λ is the amplification factor, and λ=0.6 ~0.7, ρ 0 represents the influence distance of obstacles, and t d is the time from the start of braking to the stop of the vehicle.
从速度控制模型可以看出,主车在进入障碍物影响范围内后,速度能够随与障碍物距离的减小而减小,当车辆绕过障碍物时,速度随车辆与障碍物距离的增大而增大,当主车驶出障碍物的影响范围时,车速将不再受从模型的控制。From the speed control model, it can be seen that after the main vehicle enters the range affected by the obstacle, the speed can decrease with the decrease of the distance from the obstacle. Larger and larger, when the master vehicle drives out of the influence range of the obstacle, the vehicle speed will no longer be controlled by the slave model.
将matlab计算出的避障路径导入车辆动力学仿真软件carsim中,可以得到如图9和图10所示的仿真曲线;其中图9是路径跟随曲线,图中带圈曲线是仿真软件中主车的真实行驶路径,不带圈曲线是目标路径,为求解得到的路径;从图中可以看出,两条曲线基本吻合,说明在carsim仿真软件中,主车是沿计算得到的避障路径行驶,同时这也可以说明仿真过程的主车各种动力学信息与现实中主车避障过程的状态信息相符。仿真过程中各模型参数见表2。Import the obstacle avoidance path calculated by matlab into the vehicle dynamics simulation software carsim, and the simulation curves shown in Figure 9 and Figure 10 can be obtained; Figure 9 is the path following curve, and the circled curve in the figure is the main vehicle in the simulation software The real driving path of , the curve without circles is the target path, which is the path obtained from the solution; it can be seen from the figure that the two curves are basically consistent, indicating that in the carsim simulation software, the main vehicle is driving along the calculated obstacle avoidance path , at the same time, it can also show that the various dynamic information of the main vehicle in the simulation process is consistent with the state information of the main vehicle in the obstacle avoidance process in reality. The model parameters in the simulation process are shown in Table 2.
表2仿真模型参数Table 2 Simulation model parameters
图10和图11是主车避障过程中的横摆角速度和侧向加速度图。可以看出,两图的变化趋势大致相同,这说明主车的横摆角速度和侧向加速度随主车避障过程的变化而变化,只是在避障开始阶段,侧向加速度的变化速度大于横摆角速度。Figure 10 and Figure 11 are diagrams of the yaw rate and lateral acceleration of the main vehicle during obstacle avoidance. It can be seen that the change trends of the two figures are roughly the same, which means that the yaw rate and lateral acceleration of the main vehicle change with the obstacle avoidance process of the main vehicle. pendulum speed.
两个图的变化趋势反映了主车的整个避障过程,开始时,主车在极短的时间加速到预设车速,横摆角速度和侧向加速度都出现了较大的值,随着车速提高到预设值,横摆角速度和侧向加速度只在很小的范围内变化,直到第6秒左右,主车接近前方障碍物,开始缓慢转向,在8.4秒左右,主车横摆角速度和侧向加速度都达到了最大值,说明主车已到达障碍物正侧方,即将就要绕过障碍物,之后,横摆角速度和侧向加速度的值变小,主车逐渐绕过障碍物并回到原车道。The change trend of the two graphs reflects the entire obstacle avoidance process of the main vehicle. At the beginning, the main vehicle accelerates to the preset speed in a very short time, and both the yaw rate and the lateral acceleration have large values. Increase to the preset value, the yaw rate and lateral acceleration only change in a small range, until about 6 seconds, the main car approaches the obstacle in front and starts to turn slowly, at about 8.4 seconds, the main car yaw rate and The lateral acceleration has reached the maximum value, indicating that the main vehicle has reached the front side of the obstacle and is about to bypass the obstacle. After that, the values of yaw rate and lateral acceleration become smaller, and the main vehicle gradually bypasses the obstacle and Return to original lane.
在图10和图11中,虚线为避障过程对速度进行控制后得到的主车横摆角速度和侧向加速度图,实线为未对车速进行控制得到的主车横摆角速度和侧向加速度图。主车在未进入障碍物的影响范围内时,图中两条曲线基本吻合,在进入障碍物的影响范围内后,可以明显看出,避障过程对车速进行控制后,其横摆角速度和侧向加速度的值都小于未对车速进行控制的值,且侧向加速度的值小于0.4g,这说明在避障过程对车速进行控制可以有效提高舒适性。In Figure 10 and Figure 11, the dotted line is the yaw rate and lateral acceleration diagram of the main vehicle obtained after the speed is controlled during the obstacle avoidance process, and the solid line is the yaw rate and lateral acceleration of the main vehicle obtained without speed control picture. When the main vehicle does not enter the influence range of the obstacle, the two curves in the figure basically coincide. After entering the influence range of the obstacle, it can be clearly seen that after the obstacle avoidance process controls the vehicle speed, its yaw rate and The values of the lateral acceleration are all smaller than the value without controlling the vehicle speed, and the value of the lateral acceleration is less than 0.4g, which shows that controlling the vehicle speed during the obstacle avoidance process can effectively improve the comfort.
以上所述,仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围,应当理解,本发明并不限于这里所描述的实现方案,这些实现方案描述的目的在于帮助本领域中的技术人员实践本发明。任何本领域中的技术人员很容易在不脱离本发明精神和范围的情况下进行进一步的改进和完善,因此本发明只受到本发明权利要求的内容和范围的限制,其意图涵盖所有包括在由所附权利要求所限定的本发明精神和范围内的备选方案和等同方案。The above descriptions are only preferred embodiments of the present invention, and are not intended to limit the protection scope of the present invention. It should be understood that the present invention is not limited to the implementation solutions described here. The purpose of these implementation solutions descriptions is to help those skilled in the art Those skilled in the art practice the present invention. Any person skilled in the art can easily carry out further improvement and perfection without departing from the spirit and scope of the present invention, so the present invention is only limited by the content and scope of the claims of the present invention, and it is intended to cover all Alternatives and equivalents within the spirit and scope of the invention as defined by the appended claims.
Claims (5)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610309717.3A CN105974917B (en) | 2016-05-11 | 2016-05-11 | A kind of vehicle obstacle-avoidance path planning research method based on novel artificial potential field method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610309717.3A CN105974917B (en) | 2016-05-11 | 2016-05-11 | A kind of vehicle obstacle-avoidance path planning research method based on novel artificial potential field method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105974917A CN105974917A (en) | 2016-09-28 |
CN105974917B true CN105974917B (en) | 2018-12-14 |
Family
ID=56992096
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610309717.3A Expired - Fee Related CN105974917B (en) | 2016-05-11 | 2016-05-11 | A kind of vehicle obstacle-avoidance path planning research method based on novel artificial potential field method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105974917B (en) |
Families Citing this family (46)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106375174A (en) * | 2016-11-17 | 2017-02-01 | 吉林大学 | A vehicle safety evaluation device applied to insurance damage assessment |
CN106873600A (en) * | 2017-03-31 | 2017-06-20 | 深圳市靖洲科技有限公司 | It is a kind of towards the local obstacle-avoiding route planning method without person bicycle |
US10710592B2 (en) * | 2017-04-07 | 2020-07-14 | Tusimple, Inc. | System and method for path planning of autonomous vehicles based on gradient |
CN108873875B (en) * | 2017-05-08 | 2023-11-14 | 中国华电集团有限公司青海分公司 | Robot steering motion control method and device, robot and storage medium |
DE102017113392B4 (en) * | 2017-06-19 | 2021-06-10 | Sick Ag | Device for the safety control of a machine |
CN107608346A (en) * | 2017-08-30 | 2018-01-19 | 武汉理工大学 | Ship intelligent barrier avoiding method and system based on Artificial Potential Field |
US10928832B2 (en) | 2017-09-29 | 2021-02-23 | Huawei Technologies Co., Ltd. | Impedance-based motion control for autonomous vehicles |
US10948912B2 (en) * | 2017-10-31 | 2021-03-16 | Passion Mobility Ltd. | Automatic following system and method |
CN109933092B (en) * | 2017-12-18 | 2022-07-05 | 北京京东乾石科技有限公司 | Aircraft obstacle avoidance method and device, readable storage medium and aircraft |
CN110346814B (en) * | 2018-04-08 | 2023-04-28 | 浙江国自机器人技术有限公司 | Obstacle detection and obstacle avoidance control method and system based on 3D laser |
CN109032129B (en) * | 2018-06-21 | 2021-07-27 | 昆山华恒工程技术中心有限公司 | Path deviation rectifying method and device, path guiding method and readable medium |
CN108897216A (en) * | 2018-07-03 | 2018-11-27 | 吉林大学 | A kind of intelligent automobile model prediction decision-making technique based on the virtual field of force in region |
CN109515437A (en) * | 2018-09-10 | 2019-03-26 | 江苏大学 | A kind of ACC control method for vehicle considering fore-aft vehicle |
US11054831B2 (en) * | 2018-09-27 | 2021-07-06 | Caterpillar Paving Products Inc. | Automatic site planning for autonomous construction vehicles |
CN110379155B (en) * | 2018-09-30 | 2021-01-26 | 长城汽车股份有限公司 | Method and system for determining coordinates of road target |
WO2020063816A1 (en) | 2018-09-30 | 2020-04-02 | 长城汽车股份有限公司 | Method for constructing driving coordinate system, and application thereof |
CN109376642B (en) * | 2018-10-16 | 2022-03-04 | 长安大学 | Method for predicting state of moving vehicle based on driver behavior |
US11370426B2 (en) * | 2019-01-22 | 2022-06-28 | Nissan Motor Co., Ltd. | Vehicle travel control method and travel control device |
TWI691729B (en) * | 2019-01-31 | 2020-04-21 | 宏碁股份有限公司 | Navigation system and method for operating a navigation system |
CN111796587B (en) * | 2019-03-21 | 2024-09-24 | 北京京东乾石科技有限公司 | Automatic driving method, storage medium and electronic device |
CN110244713B (en) * | 2019-05-22 | 2023-05-12 | 江苏大学 | Intelligent vehicle lane change track planning system and method based on artificial potential field method |
CN110363986B (en) * | 2019-06-28 | 2021-09-10 | 江苏大学 | Centralized confluence area vehicle speed optimization method |
CN110356405B (en) * | 2019-07-23 | 2021-02-02 | 桂林电子科技大学 | Vehicle assisted driving method, device, computer equipment and readable storage medium |
CN110488866B (en) * | 2019-08-20 | 2022-08-05 | 西南石油大学 | Unmanned aerial vehicle formation obstacle avoidance method based on gradient function |
CN110567478B (en) * | 2019-09-30 | 2023-06-30 | 广西科技大学 | A Path Planning Method for Unmanned Vehicles Based on Artificial Potential Field Method |
CN110764411B (en) * | 2019-11-06 | 2020-08-21 | 大连理工大学 | Two-wheeled self-balancing vehicle autonomous obstacle avoidance method for multi-obstacle environment |
CN110908373B (en) * | 2019-11-11 | 2021-05-07 | 南京航空航天大学 | An Intelligent Vehicle Trajectory Planning Method Based on Improved Artificial Potential Field |
CN111176272B (en) * | 2019-11-28 | 2023-05-12 | 的卢技术有限公司 | Artificial potential field track planning method and system based on motion constraint |
CN111489023A (en) * | 2020-04-03 | 2020-08-04 | 武汉理工大学 | Multifunctional intelligent robot system for processing dynamic crew service demand information |
CN113525375B (en) * | 2020-04-21 | 2023-07-21 | 宇通客车股份有限公司 | Vehicle lane changing method and device based on artificial potential field method |
CN113960996A (en) * | 2020-07-20 | 2022-01-21 | 华为技术有限公司 | Method and device for planning obstacle avoidance path of traveling device |
CN112068548B (en) * | 2020-08-07 | 2022-06-07 | 北京航空航天大学 | Special scene-oriented unmanned vehicle path planning method in 5G environment |
CN111873992A (en) * | 2020-08-11 | 2020-11-03 | 北京理工大学重庆创新中心 | Artificial potential field method for automatic driving vehicle decision layer path planning |
CN113002537A (en) * | 2021-03-16 | 2021-06-22 | 镇江康飞汽车制造股份有限公司 | Vehicle active collision avoidance method based on artificial potential field method |
CN113654569A (en) * | 2021-08-16 | 2021-11-16 | 江铃汽车股份有限公司 | A path planning method, system and storage medium |
CN113741478B (en) * | 2021-09-14 | 2024-02-27 | 北京超星未来科技有限公司 | Speed planning method and system |
CN113916246B (en) * | 2021-09-26 | 2023-09-01 | 江苏徐工工程机械研究院有限公司 | Unmanned obstacle avoidance path planning method and system |
CN114647245A (en) * | 2022-03-23 | 2022-06-21 | 河南科技大学 | Unmanned vehicle curve obstacle avoidance path planning method based on artificial potential field |
CN115123293A (en) * | 2022-06-09 | 2022-09-30 | 燕山大学 | Track planning method based on potential field guidance |
CN114834449B (en) * | 2022-06-10 | 2024-09-13 | 湖南大学 | Intelligent driving automobile safety obstacle avoidance method based on multi-potential field fusion |
CN115145275B (en) * | 2022-06-24 | 2024-04-30 | 中国安全生产科学研究院 | Multi-robot formation obstacle avoidance control method based on improved artificial potential field method |
CN115158353A (en) * | 2022-07-08 | 2022-10-11 | 东风柳州汽车有限公司 | Automatic driving control method, device, equipment and storage medium |
CN115092183B (en) * | 2022-07-15 | 2024-04-09 | 东风柳州汽车有限公司 | Active obstacle avoidance control method and system for vehicle based on potential field force |
CN115158361B (en) * | 2022-08-11 | 2024-10-18 | 东南大学 | A method for autonomous control of vehicles in free flow state based on artificial potential field |
CN115489548B (en) * | 2022-09-20 | 2024-06-04 | 重庆大学 | Intelligent car park road path planning method |
CN117270575B (en) * | 2023-11-22 | 2024-01-30 | 中节能(新泰)太阳能科技有限公司 | Unmanned aerial vehicle inspection obstacle avoidance method for high-voltage line overhead area based on coordinate transformation |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102591332A (en) * | 2011-01-13 | 2012-07-18 | 同济大学 | Device and method for local path planning of pilotless automobile |
CN103092204A (en) * | 2013-01-18 | 2013-05-08 | 浙江大学 | Mixed robot dynamic path planning method |
CN103576686A (en) * | 2013-11-21 | 2014-02-12 | 中国科学技术大学 | Automatic guide and obstacle avoidance method for robot |
WO2014075598A1 (en) * | 2012-11-13 | 2014-05-22 | Zhu Shaoming | Mobile robot separating visual positioning and navigation method and positioning and navigation system thereof |
CN104317291A (en) * | 2014-09-16 | 2015-01-28 | 哈尔滨恒誉名翔科技有限公司 | Artificial-potential-field-based robot collision preventation path planning method |
CN104317292A (en) * | 2014-09-16 | 2015-01-28 | 哈尔滨恒誉名翔科技有限公司 | Method for planning collision avoidance path of robot with complicated shape |
CN104977933A (en) * | 2015-07-01 | 2015-10-14 | 吉林大学 | Regional path tracking control method for autonomous land vehicle |
-
2016
- 2016-05-11 CN CN201610309717.3A patent/CN105974917B/en not_active Expired - Fee Related
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102591332A (en) * | 2011-01-13 | 2012-07-18 | 同济大学 | Device and method for local path planning of pilotless automobile |
WO2014075598A1 (en) * | 2012-11-13 | 2014-05-22 | Zhu Shaoming | Mobile robot separating visual positioning and navigation method and positioning and navigation system thereof |
CN103092204A (en) * | 2013-01-18 | 2013-05-08 | 浙江大学 | Mixed robot dynamic path planning method |
CN103576686A (en) * | 2013-11-21 | 2014-02-12 | 中国科学技术大学 | Automatic guide and obstacle avoidance method for robot |
CN104317291A (en) * | 2014-09-16 | 2015-01-28 | 哈尔滨恒誉名翔科技有限公司 | Artificial-potential-field-based robot collision preventation path planning method |
CN104317292A (en) * | 2014-09-16 | 2015-01-28 | 哈尔滨恒誉名翔科技有限公司 | Method for planning collision avoidance path of robot with complicated shape |
CN104977933A (en) * | 2015-07-01 | 2015-10-14 | 吉林大学 | Regional path tracking control method for autonomous land vehicle |
Non-Patent Citations (2)
Title |
---|
基于改进人工势场法的智能无人车路径规划仿真研究;刘洲洲;《计算技术与自动化》;20130630;第32卷(第2期);第133-136页 * |
智能车辆车道保持系统中避障路径规划;汪明磊;《合肥工业大学学报》;20140228;第37卷(第2期);第129-133页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105974917A (en) | 2016-09-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105974917B (en) | A kind of vehicle obstacle-avoidance path planning research method based on novel artificial potential field method | |
CN109501799B (en) | Dynamic path planning method under condition of Internet of vehicles | |
US10611368B2 (en) | Method and system for collision avoidance | |
CN110723141B (en) | A kind of vehicle active collision avoidance system and collision avoidance mode switching method | |
JP6601696B2 (en) | Prediction device, prediction method, and program | |
CN111016893B (en) | An adaptive cruise control system and control method for intelligent vehicle extension game lane keeping in congested environment | |
CN112512887B (en) | Driving decision selection method and device | |
CN108032859B (en) | Automatic lane change control method and device and automobile | |
CN110614998A (en) | Aggressive driving-assisted curve obstacle avoidance and road changing path planning system and method | |
CN111942378A (en) | Vehicle control device, vehicle control method, and storage medium | |
CN103640622B (en) | A kind of automobile steering intelligent control method based on pilot model and control system | |
CN108011947A (en) | A kind of vehicle cooperative formula formation driving system | |
CN108091176B (en) | A vehicle active anti-collision virtual zebra crossing control system | |
CN114779229A (en) | Target detection method and device | |
JP2018151287A (en) | Vehicle running control device | |
JP2019108103A (en) | Vehicle control device, vehicle control method, and program | |
WO2018131298A1 (en) | Vehicle control system, vehicle control method, and vehicle control program | |
CN103802829A (en) | Control method for collision avoidance of vehicle and apparatus for collision avoidance of vehicle implementing the same | |
CN109318893A (en) | Method and system for safe driving assistance based on pixel height change of license plate | |
DE112017007906T5 (en) | VEHICLE CONTROL DEVICE, VEHICLE CONTROL METHOD AND PROGRAM | |
CN104554105A (en) | Vehicle collision-proof network early-warning method and device and confirmatory experiment platform | |
JP2019137189A (en) | Vehicle control system, vehicle control method, and program | |
CN108528445A (en) | A kind of intelligent automobile sensor blind area active collision avoidance method | |
JP2019131077A (en) | Vehicle control device, vehicle control method, and program | |
JP2019053646A (en) | Vehicle control device, vehicle control method, and program |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20181214 Termination date: 20190511 |
|
CF01 | Termination of patent right due to non-payment of annual fee |