CN112810604B - Intelligent vehicle behavior decision method and system based on parking lot scene - Google Patents
Intelligent vehicle behavior decision method and system based on parking lot scene Download PDFInfo
- Publication number
- CN112810604B CN112810604B CN202110051997.3A CN202110051997A CN112810604B CN 112810604 B CN112810604 B CN 112810604B CN 202110051997 A CN202110051997 A CN 202110051997A CN 112810604 B CN112810604 B CN 112810604B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- driving
- driving environment
- bicycle
- indicating
- 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.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- 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/06—Automatic manoeuvring for parking
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
技术领域technical field
本发明涉及智能车辆行为决策技术领域,特别是关于一种基于停车场场景下智能车辆行为决策方法及系统。The invention relates to the technical field of intelligent vehicle behavior decision-making, in particular to a method and system for intelligent vehicle behavior decision-making based on a parking lot scene.
背景技术Background technique
随着物联网、人工智能等相关技术的不断发展,汽车正在向无人化和网联化方向发展。智能车辆作为未来人工智能领域的重要分支,不仅能提高道路交通的通行效率,而且能提高车辆的安全性,极大的改变了人们的出行方式。智能车辆是一个集成了环境感知、行为决策、路径规划以及车辆控制等复杂功能的系统,其关键在于车辆驾驶行为决策是否合理。智能车辆的行为决策模块作为无人车辆的“大脑”,通过环境感知系统综合周围环境及车辆自身信息以指导车辆输出安全、可靠及合理的驾驶动作。目前,对于智能车辆的行为决策应用场景的研究主要包括高速公路和城市道路,但是对于智能车辆在停车场场景下的行为决策研究较少,在停车场场景下,车辆的行驶速度相对较低,并且其他车辆的驾驶行为相对复杂。With the continuous development of related technologies such as the Internet of Things and artificial intelligence, automobiles are developing in the direction of unmanned and networked. As an important branch of artificial intelligence in the future, intelligent vehicles can not only improve the efficiency of road traffic, but also improve the safety of vehicles, greatly changing the way people travel. An intelligent vehicle is a system that integrates complex functions such as environmental perception, behavioral decision-making, path planning, and vehicle control. As the "brain" of the unmanned vehicle, the behavior decision module of the intelligent vehicle integrates the surrounding environment and the vehicle's own information through the environment perception system to guide the vehicle to output safe, reliable and reasonable driving actions. At present, the research on the application scenarios of behavioral decision-making of intelligent vehicles mainly includes highways and urban roads, but there is less research on behavioral decision-making of intelligent vehicles in the parking lot scene. In the parking lot scene, the speed of the vehicle is relatively low, And the driving behavior of other vehicles is relatively complex.
发明内容SUMMARY OF THE INVENTION
本发明的目的在于提供一种基于停车场场景下智能车辆行为决策方法及系统来克服或至少减轻现有技术的上述缺陷中的至少一个。The purpose of the present invention is to provide a method and system for intelligent vehicle behavior decision-making based on a parking lot scene to overcome or at least alleviate at least one of the above-mentioned defects of the prior art.
为实现上述目的,本发明提供一种基于停车场场景下智能车辆决策方法,该方法包括:In order to achieve the above object, the present invention provides a method for intelligent vehicle decision-making based on a parking lot scene, the method comprising:
步骤1,进入泊车决策系统,感知自车所处的驾驶场景,并判断是否处于停车场场景S,如果是,则进入步骤2;如果不是,则进入步骤4;Step 1, enter the parking decision system, perceive the driving scene where the vehicle is located, and determine whether it is in the parking lot scene S, if so, go to
S={si|i=1,2,3}S={s i |i=1,2,3}
其中,s1表示直行车道,s2表示交叉路口,s3表示停车位;Among them, s 1 represents a straight lane, s 2 represents an intersection, and s 3 represents a parking space;
步骤2,判断自车是否处于驾驶过程中,如果是,则进入步骤3;如果不是,则进入步骤4;
步骤3,根据他车与自车的位置关系P、他车与自车的距离关系D、他车与自车的行驶方向关系C、他车与自车的速度关系V、以及他车的泊车驾驶行为O中的一种或多种,对自车的泊车驾驶行为E进行决策;Step 3: According to the positional relationship P between his car and his own car, the distance relationship D between his car and his own car, the driving direction relationship C between his car and his own car, the speed relationship V between his car and his own car, and the parking distance of his car. One or more of the vehicle driving behaviors O, making decisions on the parking driving behavior E of the own vehicle;
P={pi|i=1,2,…9}P={pi | i =1,2,…9}
其中,p1表示他车位于自车相同车道的前方,p2表示他车位于自车相邻车道的前方,p3表示他车位于自车相同车道的后方,p4表示他车位于自车相邻车道的后方,p5表示他车位于自车侧方,p6表示他车位于自车行驶车道侧前方的停车位内,p7表示他车位于自车行驶车道侧后方的停车位内,p8表示他车位于自车所在停车位的相邻停车位内,p9表示他车位于自车所在停车位前方的车道上;Among them, p 1 means that the other car is located in front of the same lane of the own vehicle, p 2 means that the other car is located in front of the adjacent lane of the own vehicle, p 3 means that the other car is located in the back of the same lane of the own vehicle, p 4 means that the other car is located in the own vehicle The rear of the adjacent lane, p 5 means that the other car is located on the side of the own vehicle, p 6 means that the other car is located in the parking space in front of the driving lane of the own vehicle, p 7 means that the other car is located in the parking space behind the driving lane of the own vehicle , p 8 indicates that his car is located in the adjacent parking space of the own car's parking space, p 9 indicates that his car is located in the lane in front of the own parking space;
D={di|i=1,2}D={d i |i=1,2}
其中,d1表示他车与自车的距离大于等于安全距离,d2表示他车与自车的距离大于等于安全距离;Among them, d 1 indicates that the distance between the other vehicle and the own vehicle is greater than or equal to the safety distance, and d 2 indicates that the distance between the other vehicle and the own vehicle is greater than or equal to the safety distance;
C={ci|i=1,2,3}C={ci | i =1,2,3}
其中,c1表示同向,c2表示反向,c3表示垂向;Among them, c 1 represents the same direction, c 2 represents the reverse direction, and c 3 represents the vertical direction;
V={vi|i=1,2,3}V={v i |i=1,2,3}
其中,v1表示他车的速度大于自车,v2表示他车的速度小于自车,v3表示他车的速度与自车相同;Among them, v 1 means that the speed of his car is greater than that of the own car, v 2 means that the speed of his car is lower than that of the own car, and v 3 means that the speed of his car is the same as that of the own car;
O={oi|i=1,2,…,6}O={o i |i=1,2,…,6}
其中,o1表示直行,o2表示换道,o3表示转弯,o4表示停车,o5表示驶入停车位,o6表示驶出停车位;Among them, o 1 means going straight, o 2 means changing lanes, o 3 means turning, o 4 means parking, o 5 means driving into the parking space, o 6 means driving out of the parking space;
自车的泊车驾驶行为包括以下五种:Self-vehicle parking and driving behaviors include the following five types:
E={ei|i=1,2,…5}E={e i |i=1,2,…5}
其中,e1表示自主巡航,e2表示车辆跟随,e3表示停车等待,e4表示驶入停车位,e5表示驶出停车位;Among them, e 1 represents autonomous cruise, e 2 represents vehicle following, e 3 represents parking waiting, e 4 represents driving into the parking space, and e 5 represents driving out of the parking space;
步骤4,退出泊车决策系统。Step 4, exit the parking decision system.
进一步地,自车的驾驶行为决策为e1的驾驶环境包括:Further, the driving environment in which the driving behavior decision of the self - vehicle is e1 includes:
1.自车处于s1、p1、和d1同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 1 , p 1 , and d 1 coexist;
2.自车处于s1、p1、d2、c1、和v1同时存在的驾驶环境;2. The self-vehicle is in a driving environment where s 1 , p 1 , d 2 , c 1 , and v 1 coexist;
3.自车处于p2、p3、p4、p5、和p7中的一种与s1同时存在的驾驶环境;3. The self-vehicle is in a driving environment in which one of p 2 , p 3 , p 4 , p 5 , and p 7 coexists with s 1 ;
4.自车处于s1、p6、和d1同时存在的驾驶环境;4. The self-vehicle is in a driving environment where s 1 , p 6 , and d 1 coexist;
5.自车处于s2、p2、c2、和o1同时存在的驾驶环境;5. The self-vehicle is in a driving environment where s 2 , p 2 , c 2 , and o 1 coexist;
6.自车处于p3、p4和p7中的一种与s2同时存在的驾驶环境。6. The self-vehicle is in a driving environment in which one of p 3 , p 4 and p 7 coexists with s 2 .
进一步地,自车的驾驶行为决策为e2的驾驶环境包括:Further, the driving environment in which the driving behavior decision of the self-vehicle is e 2 includes:
1.自车处于s1、p1、d2、c1、v2或v3、以及o1或o2同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 1 , p 1 , d 2 , c 1 , v 2 or v 3 , and o 1 or o 2 exist simultaneously;
2.自车处于s2、p1、和c1同时存在的驾驶环境。2. The self-vehicle is in a driving environment where s 2 , p 1 , and c 1 coexist.
进一步地,自车的驾驶行为决策为e3的驾驶环境包括:Further, the driving environment where the driving behavior decision of the self-vehicle is e3 includes:
1.自车处于s1、p1、d2、c1、v2或v3、以及o5或o6同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 1 , p 1 , d 2 , c 1 , v 2 or v 3 , and o 5 or o 6 exist simultaneously;
2.自车处于s1、p1、d2、和c2同时存在的驾驶环境;2. The self-vehicle is in a driving environment where s 1 , p 1 , d 2 , and c 2 coexist;
3.自车处于s1、p6、和d2同时存在的驾驶环境;3. The self-vehicle is in a driving environment where s 1 , p 6 , and d 2 coexist;
4.自车处于s2、p1、和c3同时存在的驾驶环境;4. The self-vehicle is in a driving environment where s 2 , p 1 , and c 3 coexist;
5.自车处于s2、p2、c2、和o3同时存在的驾驶环境;5. The self-vehicle is in a driving environment where s 2 , p 2 , c 2 , and o 3 coexist;
6.自车处于s2、p2、和c3同时存在的驾驶环境;6. The self-vehicle is in a driving environment where s 2 , p 2 , and c 3 coexist;
7.自车处于s3、p8、c2、和o6同时存在的驾驶环境;7. The self-vehicle is in a driving environment where s 3 , p 8 , c 2 , and o 6 coexist;
8.自车处于s3、p9、和d2时存在的驾驶环境。8. The driving environment that exists when the ego vehicle is at s 3 , p 9 , and d 2 .
进一步地,自车的驾驶行为决策为e4的驾驶环境包括:Further, the driving environment in which the driving behavior decision of the self - vehicle is e4 includes:
1.自车处于s3、p8、c1、和o5同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 3 , p 8 , c 1 , and o 5 exist at the same time;
2.自车处于s3、p8、c1、和o6同时存在的驾驶环境;2. The self-vehicle is in a driving environment where s 3 , p 8 , c 1 , and o 6 coexist;
3.自车处于s3、p9、和d1同时存在的驾驶环境。3. The self-vehicle is in a driving environment where s 3 , p 9 , and d 1 coexist.
进一步地,自车的驾驶行为决策为e5的驾驶环境包括:Further, the driving environment in which the driving behavior decision of the self - vehicle is e5 includes:
1.自车处于s3、p8、c1、和o6同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 3 , p 8 , c 1 , and o 6 coexist;
2.自车处于s3、p8、c2、和o5同时存在的驾驶环境;2. The self-vehicle is in a driving environment where s 3 , p 8 , c 2 , and o 5 coexist;
3.自车处于s3、p9、和d1同时存在的驾驶环境。3. The self-vehicle is in a driving environment where s 3 , p 9 , and d 1 coexist.
本发明还提供一种基于停车场场景下智能车辆决策系统,该系统包括:The present invention also provides an intelligent vehicle decision-making system based on a parking lot scene, the system comprising:
驾驶场景判断单元,其用于在进入泊车决策系统后,感知自车所处的驾驶场景,并判断是否处于停车场场景S;如果不是,则进入步骤4;A driving scene judgment unit, which is used to perceive the driving scene in which the vehicle is located after entering the parking decision system, and determine whether it is in the parking lot scene S; if not, go to step 4;
S={si|i=1,2,3}S={s i |i=1,2,3}
其中,s1表示直行车道,s2表示交叉路口,s3表示停车位;Among them, s 1 represents a straight lane, s 2 represents an intersection, and s 3 represents a parking space;
驾驶状态判断单元,其用于在所述驾驶场景判断单元判定自车处于停车场场景S的情形下,判断自车是否处于驾驶过程中,如果是,则进入步骤3;如果不是,则进入步骤4;A driving state judging unit, which is used for judging whether the self-vehicle is in the driving process when the driving scene judging unit determines that the self-vehicle is in the parking lot scene S, and if so, enter
泊车决策单元,其用于在所述驾驶状态判断单元判定自车处于驾驶过程中的情形下,根据他车与自车的位置关系P、他车与自车的距离关系D、他车与自车的行驶方向关系C、他车与自车的速度关系V、以及他车的泊车驾驶行为O中的一种或多种,对自车的泊车驾驶行为E进行决策,以及用于在所述驾驶场景判断单元判定自车未处于停车场场景S的情形下或所述驾驶状态判断单元判定自车未处于驾驶过程中的情形下退出;The parking decision-making unit is used for, when the driving state judging unit determines that the own vehicle is in the driving process, according to the positional relationship P between the other vehicle and the own vehicle, the distance relationship D between the other vehicle and the own vehicle, and the distance between the other vehicle and the own vehicle. One or more of the driving direction relationship C of the own vehicle, the speed relationship V between the other vehicle and the own vehicle, and the parking driving behavior O of the other vehicle, to make a decision on the parking driving behavior E of the own vehicle, and use it for Exit when the driving scene determination unit determines that the vehicle is not in the parking lot scene S or the driving state determination unit determines that the vehicle is not in the driving process;
P={pi|i=1,2,…9}P={pi | i =1,2,…9}
其中,p1表示他车位于自车相同车道的前方,p2表示他车位于自车相邻车道的前方,p3表示他车位于自车相同车道的后方,p4表示他车位于自车相邻车道的后方,p5表示他车位于自车侧方,p6表示他车位于自车行驶车道侧前方的停车位内,p7表示他车位于自车行驶车道侧后方的停车位内,p8表示他车位于自车所在停车位的相邻停车位内,p9表示他车位于自车所在停车位前方的车道上;Among them, p 1 means that the other car is located in front of the same lane of the own vehicle, p 2 means that the other car is located in front of the adjacent lane of the own vehicle, p 3 means that the other car is located in the back of the same lane of the own vehicle, p 4 means that the other car is located in the own vehicle The rear of the adjacent lane, p 5 means that the other car is located on the side of the own vehicle, p 6 means that the other car is located in the parking space in front of the driving lane of the own vehicle, p 7 means that the other car is located in the parking space behind the driving lane of the own vehicle , p 8 indicates that his car is located in the adjacent parking space of the own car's parking space, p 9 indicates that his car is located in the lane in front of the own parking space;
D={di|i=1,2}D={d i |i=1,2}
其中,d1表示他车与自车的距离大于等于安全距离,d2表示他车与自车的距离大于等于安全距离;Among them, d 1 indicates that the distance between the other vehicle and the own vehicle is greater than or equal to the safety distance, and d 2 indicates that the distance between the other vehicle and the own vehicle is greater than or equal to the safety distance;
C={ci|i=1,2,3}C={ci | i =1,2,3}
其中,c1表示同向,c2表示反向,c3表示垂向;Among them, c 1 represents the same direction, c 2 represents the reverse direction, and c 3 represents the vertical direction;
V={vi|i=1,2,3}V={v i |i=1,2,3}
其中,v1表示他车的速度大于自车,v2表示他车的速度小于自车,v3表示他车的速度与自车相同;Among them, v 1 means that the speed of his car is greater than that of the own car, v 2 means that the speed of his car is lower than that of the own car, and v 3 means that the speed of his car is the same as that of the own car;
O={oi|i=1,2,…,6}O={o i |i=1,2,…,6}
其中,o1表示直行,o2表示换道,o3表示转弯,o4表示停车,o5表示驶入停车位,o6表示驶出停车位;Among them, o 1 means going straight, o 2 means changing lanes, o 3 means turning, o 4 means parking, o 5 means driving into the parking space, o 6 means driving out of the parking space;
自车的泊车驾驶行为包括以下五种:Self-vehicle parking and driving behaviors include the following five types:
E={ei|i=1,2,…5}E={e i |i=1,2,…5}
其中,e1表示自主巡航,e2表示车辆跟随,e3表示停车等待,e4表示驶入停车位,e5表示驶出停车位。Among them, e 1 represents autonomous cruise, e 2 represents vehicle following, e 3 represents parking waiting, e 4 represents driving into the parking space, and e 5 represents driving out of the parking space.
进一步地,自车的驾驶行为决策为e1的驾驶环境包括:Further, the driving environment in which the driving behavior decision of the self - vehicle is e1 includes:
1.自车处于s1、p1、和d1同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 1 , p 1 , and d 1 coexist;
2.自车处于s1、p1、d2、c1、和v1同时存在的驾驶环境;2. The self-vehicle is in a driving environment where s 1 , p 1 , d 2 , c 1 , and v 1 coexist;
3.自车处于p2、p3、p4、p5、和p7中的一种与s1同时存在的驾驶环境;3. The self-vehicle is in a driving environment in which one of p 2 , p 3 , p 4 , p 5 , and p 7 coexists with s 1 ;
4.自车处于s1、p6、和d1同时存在的驾驶环境;4. The self-vehicle is in a driving environment where s 1 , p 6 , and d 1 coexist;
5.自车处于s2、p2、c2、和o1同时存在的驾驶环境;5. The self-vehicle is in a driving environment where s 2 , p 2 , c 2 , and o 1 coexist;
6.自车处于p3、p4和p7中的一种与s2同时存在的驾驶环境。6. The self-vehicle is in a driving environment in which one of p 3 , p 4 and p 7 coexists with s 2 .
进一步地,自车的驾驶行为决策为e2的驾驶环境包括:Further, the driving environment in which the driving behavior decision of the self-vehicle is e 2 includes:
1.自车处于s1、p1、d2、c1、v2或v3、以及o1或o2同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 1 , p 1 , d 2 , c 1 , v 2 or v 3 , and o 1 or o 2 exist simultaneously;
2.自车处于s2、p1、和c1同时存在的驾驶环境。2. The self-vehicle is in a driving environment where s 2 , p 1 , and c 1 coexist.
进一步地,自车的驾驶行为决策为e3的驾驶环境包括:Further, the driving environment where the driving behavior decision of the self-vehicle is e3 includes:
1.自车处于s1、p1、d2、c1、v2或v3、以及o5或o6同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 1 , p 1 , d 2 , c 1 , v 2 or v 3 , and o 5 or o 6 exist simultaneously;
2.自车处于s1、p1、d2、和c2同时存在的驾驶环境;2. The self-vehicle is in a driving environment where s 1 , p 1 , d 2 , and c 2 coexist;
3.自车处于s1、p6、和d2同时存在的驾驶环境;3. The self-vehicle is in a driving environment where s 1 , p 6 , and d 2 coexist;
4.自车处于s2、p1、和c3同时存在的驾驶环境;4. The self-vehicle is in a driving environment where s 2 , p 1 , and c 3 coexist;
5.自车处于s2、p2、c2、和o3同时存在的驾驶环境;5. The self-vehicle is in a driving environment where s 2 , p 2 , c 2 , and o 3 coexist;
6.自车处于s2、p2、和c3同时存在的驾驶环境;6. The self-vehicle is in a driving environment where s 2 , p 2 , and c 3 coexist;
7.自车处于s3、p8、c2、和o6同时存在的驾驶环境;7. The self-vehicle is in a driving environment where s 3 , p 8 , c 2 , and o 6 coexist;
8.自车处于s3、p9、和d2时存在的驾驶环境。8. The driving environment that exists when the ego vehicle is at s 3 , p 9 , and d 2 .
进一步地,自车的驾驶行为决策为e4的驾驶环境包括:Further, the driving environment in which the driving behavior decision of the self - vehicle is e4 includes:
1.自车处于s3、p8、c1、和o5同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 3 , p 8 , c 1 , and o 5 exist at the same time;
2.自车处于s3、p8、c1、和o6同时存在的驾驶环境;2. The self-vehicle is in a driving environment where s 3 , p 8 , c 1 , and o 6 coexist;
3.自车处于s3、p9、和d1同时存在的驾驶环境。3. The self-vehicle is in a driving environment where s 3 , p 9 , and d 1 coexist.
进一步地,自车的驾驶行为决策为e5的驾驶环境包括:Further, the driving environment in which the driving behavior decision of the self - vehicle is e5 includes:
1.自车处于s3、p8、c1、和o6同时存在的驾驶环境;1. The self-vehicle is in a driving environment where s 3 , p 8 , c 1 , and o 6 coexist;
2.自车处于s3、p8、c2、和o5同时存在的驾驶环境;2. The self-vehicle is in a driving environment where s 3 , p 8 , c 2 , and o 5 coexist;
3.自车处于s3、p9、和d1同时存在的驾驶环境。3. The self-vehicle is in a driving environment where s 3 , p 9 , and d 1 coexist.
本发明由于采取以上技术方案,其具有以下优点:The present invention has the following advantages due to taking the above technical solutions:
1.将驾驶场景进行分类,能够使智能车辆的行为决策更加容易。1. Categorizing driving scenarios can make the behavioral decisions of intelligent vehicles easier.
2.智能车辆根据不同场景下其他车辆的驾驶行为,使自车的行为决策更加贴合实际,能够提高停车场的停车效率和车辆行驶过程的安全性。2. According to the driving behavior of other vehicles in different scenarios, the intelligent vehicle makes the behavior decision of the vehicle more realistic, which can improve the parking efficiency of the parking lot and the safety of the vehicle driving process.
附图说明Description of drawings
图1是本发明实施例提供的基于停车场场景下智能车辆行为决策方法的流程图。FIG. 1 is a flowchart of a method for intelligent vehicle behavior decision-making based on a parking lot scene provided by an embodiment of the present invention.
图2是本发明实施例提供的基于停车场场景下影响智能车辆行为决策的分类图。FIG. 2 is a classification diagram for influencing intelligent vehicle behavior decision based on a parking lot scenario provided by an embodiment of the present invention.
图3是本发明实施例提供的智能车辆在直行车道场景下的行为决策图。FIG. 3 is a behavior decision diagram of an intelligent vehicle in a straight lane scenario provided by an embodiment of the present invention.
图4是本发明实施例提供的智能车辆在交叉口或T型口场景下的行为决策图。FIG. 4 is a behavior decision diagram of an intelligent vehicle in an intersection or T-junction scenario provided by an embodiment of the present invention.
图5是本发明实施例提供的智能车辆驶入或驶出停车位场景下的行为决策图。FIG. 5 is a behavior decision diagram in a scenario where an intelligent vehicle enters or leaves a parking space provided by an embodiment of the present invention.
具体实施方式Detailed ways
下面结合附图和实施例对本发明进行详细的描述。The present invention will be described in detail below with reference to the accompanying drawings and embodiments.
如图1所示,本发明实施例提供的基于停车场场景下智能车辆决策方法,包括:As shown in FIG. 1, the intelligent vehicle decision-making method based on the parking lot scene provided by the embodiment of the present invention includes:
步骤1,进入泊车决策系统,感知自车所处的驾驶场景,并判断是否处于停车场场景S,如果是,则进入步骤2;如果不是,则进入步骤4;Step 1, enter the parking decision system, perceive the driving scene where the vehicle is located, and determine whether it is in the parking lot scene S, if so, go to
S={si|i=1,2,3}S={s i |i=1,2,3}
其中,s1表示直行车道,s2表示交叉路口,s3表示停车位。Among them, s 1 represents a straight lane, s 2 represents an intersection, and s 3 represents a parking space.
步骤2,判断自车是否处于驾驶过程中,如果是,则进入步骤3;如果不是,则进入步骤4。
步骤3,根据他车与自车的泊车交互行为和他车的泊车驾驶行为O,对自车的泊车驾驶行为E进行决策。本实施例对他车与自车的泊车交互行为、他车的泊车驾驶行为和自车的泊车驾驶行为E进行分类。
其中,他车与自车的泊车交互行包括他车与自车的位置关系P、他车与自车的距离关系D、他车与自车的行驶方向关系C、和他车与自车的速度关系V。Among them, the parking interaction between the other car and the own car includes the position relationship P between the other car and the own car, the distance relationship D between the other car and the own car, the driving direction relationship C between the other car and the own car, and the relationship between the other car and the own car. The velocity relationship V.
在停车场场景下,他车与自车的位置关系P包括以下九种:In the parking lot scenario, the positional relationship P between his car and his own car includes the following nine types:
P={pi|i=1,2,…9}P={pi | i =1,2,…9}
其中,p1表示他车位于自车相同车道的前方,p2表示他车位于自车相邻车道的前方,p3表示他车位于自车相同车道的后方,p4表示他车位于自车相邻车道的后方,p5表示他车位于自车侧方(两车道及以上),p6表示他车位于自车行驶车道侧前方的停车位内,p7表示他车位于自车行驶车道侧后方的停车位内,p8表示他车位于自车所在停车位的相邻停车位内,p9表示他车位于自车所在停车位前方的车道上。Among them, p 1 means that the other car is located in front of the same lane of the own vehicle, p 2 means that the other car is located in front of the adjacent lane of the own vehicle, p 3 means that the other car is located in the back of the same lane of the own vehicle, p 4 means that the other car is located in the own vehicle The rear of the adjacent lane, p 5 means that the other car is located on the side of the own vehicle (two lanes or more), p 6 means that the other car is located in the parking space in front of the driving lane of the own vehicle, p 7 means that the other car is located in the driving lane of the own vehicle In the parking space behind the side, p 8 indicates that his car is located in the adjacent parking space of the parking space where the vehicle is located, and p 9 indicates that his car is located in the lane in front of the parking space where the vehicle is located.
在停车场场景下,他车与自车的距离关系D包括以下两种:In the parking lot scenario, the distance relationship D between his car and his own car includes the following two:
D={di|i=1,2}D={d i |i=1,2}
其中,d1表示他车与自车的距离大于等于安全距离d,d2表示他车与自车的距离大于等于安全距离d,d的具体数值可根据车辆尺寸参数认为设置。Among them, d 1 indicates that the distance between the other vehicle and the own vehicle is greater than or equal to the safety distance d, and d 2 indicates that the distance between the other vehicle and the own vehicle is greater than or equal to the safety distance d. The specific value of d can be considered to be set according to the vehicle size parameters.
在停车场场景下,他车与自车的行驶方向关系C包括以下三种:In the parking lot scenario, the relationship C between the driving direction of the other car and the own car includes the following three types:
C={ci|i=1,2,3}C={ci | i =1,2,3}
其中,c1表示同向,c2表示反向,c3表示垂向。Among them, c 1 represents the same direction, c 2 represents the reverse direction, and c 3 represents the vertical direction.
在停车场场景下,他车与自车的速度关系V包括以下三种:In the parking lot scenario, the speed relationship V between the other car and the own car includes the following three types:
V={vi|i=1,2,3}V={v i |i=1,2,3}
其中,v1表示他车的速度大于自车,v2表示他车的速度小于自车,v3表示他车的速度与自车相同。Among them, v 1 means that the speed of his car is greater than that of the own car, v 2 means that the speed of his car is lower than that of the own car, and v 3 means that the speed of his car is the same as that of the own car.
在停车场场景下,他车的泊车驾驶行为O包括以下六种:In the parking lot scenario, his car's parking driving behavior O includes the following six types:
O={oi|i=1,2,…,6}O={o i |i=1,2,…,6}
其中,o1表示直行,o2表示换道,o3表示转弯,o4表示停车,o5表示驶入停车位,o6表示驶出停车位。Among them, o 1 means going straight, o 2 means changing lanes, o 3 means turning, o 4 means parking, o 5 means driving into the parking space, o 6 means driving out of the parking space.
在停车场场景下,自车的泊车驾驶行为E包括以下五种:In the parking lot scenario, the parking driving behavior E of the self-vehicle includes the following five types:
E={ei|i=1,2,…5}E={e i |i=1,2,…5}
其中,e1表示自主巡航,e2表示车辆跟随,e3表示停车等待,e4表示驶入停车位,e5表示驶出停车位。Among them, e 1 represents autonomous cruise, e 2 represents vehicle following, e 3 represents parking waiting, e 4 represents driving into the parking space, and e 5 represents driving out of the parking space.
本步骤根据他车与自车的位置关系P、他车与自车的距离关系D、他车与自车的行驶方向关系C、他车与自车的速度关系V、以及他车的泊车驾驶行为O中的一种或多种,对自车的泊车驾驶行为E进行决策。This step is based on the positional relationship P between the other vehicle and the own vehicle, the distance relationship D between the other vehicle and the own vehicle, the driving direction relationship C between the other vehicle and the own vehicle, the speed relationship V between the other vehicle and the own vehicle, and the parking of the other vehicle. One or more of the driving behaviors O to make decisions on the parking driving behavior E of the self-vehicle.
步骤4,退出泊车决策系统:当自车不处于停车场场景下的驾驶过程中,即自车已驶入停车位或已驶出停车场,此决策行为结束。Step 4: Exit the parking decision system: When the self-vehicle is not in the driving process in the parking lot scene, that is, the self-vehicle has entered the parking space or has exited the parking lot, this decision-making behavior ends.
本发明实施例不仅将停车场场景进行分类,能够使智能车辆的行为决策更加容易,而且智能车辆根据不同场景下其他车辆的驾驶行为,使自车行为决策更加贴合实际,能够提高停车场的停车效率和车辆行驶过程的安全性。The embodiment of the present invention not only classifies the parking lot scenes, which can make the behavior decision of the intelligent vehicle easier, but also makes the self-vehicle behavior decision more realistic according to the driving behavior of other vehicles in different scenarios, which can improve the behavior of the parking lot. Parking efficiency and safety during vehicle travel.
在一个实施例中,如图3-5所示,步骤3中自车在不同驾驶环境下的行为决策具体描述为:In one embodiment, as shown in Figures 3-5, the behavioral decisions of the self-vehicle in different driving environments in
(一)自车的驾驶行为决策为e1的驾驶环境包括:( 1 ) The driving environment in which the driving behavior decision of the self-vehicle is e1 includes:
1.自车处于s1、p1、和d1同时存在的驾驶环境的情形下,由于两车处于安全距离之外,他车的驾驶行为不会对自车造成影响,则此时自车的驾驶行为决策为e1。1. When the self-vehicle is in a driving environment in which s 1 , p 1 , and d 1 coexist, since the two vehicles are at a safe distance, the driving behavior of the other vehicle will not affect the self-vehicle, then the self-vehicle at this time The driving behavior decision is e 1 .
2.自车处于s1、p1、d2、c1、和v1同时存在的驾驶环境的情形下,虽然两车处于安全距离之内,但他车的速度大于自车,两车之间的距离在变大,则此时自车的驾驶行为决策为e1。2. In the driving environment where s 1 , p 1 , d 2 , c 1 , and v 1 coexist, although the two cars are within a safe distance, the speed of the other car is greater than the one The distance between them is getting larger, then the driving behavior decision of the self-vehicle at this time is e 1 .
3.自车处于p2、p3、p4、p5、和p7中的一种与s1同时存在的驾驶环境的情形下,由于在这几种交互关系中,他车的驾驶行为不会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e1。3. When the own car is in a driving environment in which one of p 2 , p 3 , p 4 , p 5 , and p 7 coexists with s 1 , because in these interactive relationships, the driving behavior of the other car If the driving behavior of the self-vehicle is not affected, the driving behavior decision of the self-vehicle at this time is e 1 .
4.自车处于s1、p6、和d1同时存在的驾驶环境的情形下,由于两车处于安全距离之外,他车的驾驶行为不会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e1。4. Under the circumstance that the own car is in a driving environment where s 1 , p 6 , and d 1 exist at the same time, since the two cars are at a safe distance, the driving behavior of the other car will not affect the driving behavior of the own car, then this The driving behavior decision of the ego vehicle is e 1 .
5.自车处于s2、p2、c2、和o1同时存在的驾驶环境的情形下,由于两车的轨迹不会相交,则此时自车的驾驶行为决策为e1。5. When the self-vehicle is in a driving environment where s 2 , p 2 , c 2 , and o 1 coexist, since the trajectories of the two vehicles do not intersect, the self-vehicle's driving behavior decision at this time is e 1 .
6.自车处于p3、p4和p7中的一种与s2同时存在的驾驶环境的情形下,由于在这几种交互关系中,他车的驾驶行为不会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e1。6. In a situation where the ego car is in a driving environment in which one of p 3 , p 4 and p 7 coexists with s 2 , because in these interaction relationships, the driving behavior of the ego car will not affect the ego car's driving. If the behavior affects, then the driving behavior decision of the ego vehicle at this time is e 1 .
(二)自车的驾驶行为决策为e2的驾驶环境包括:( 2 ) The driving environment in which the driving behavior decision of the self-vehicle is e2 includes:
1.自车处于s1、p1、d2、c1、v2或v3、以及o1或o2同时存在的驾驶环境的情形下,由于两车处于安全距离之内,并且此时距离在不断减小或者不变,他车的驾驶行为会对自车的速度造成影响,则此时自车的驾驶行为决策为e2。其中的“v2或v3”可以理解为择一选择,“o1或o2”可以理解为择一选择。1. When the self-vehicle is in a driving environment where s 1 , p 1 , d 2 , c 1 , v 2 or v 3 , and o 1 or o 2 exist at the same time, since the two vehicles are within a safe distance, and at this time The distance is decreasing or unchanged, and the driving behavior of the other car will affect the speed of the own car, then the driving behavior decision of the own car at this time is e 2 . Among them, "v 2 or v 3 " can be understood as an alternative choice, and "o 1 or o 2 " can be understood as an alternative choice.
2.自车处于s2、p1、和c1同时存在的驾驶环境的情形下,由于他车位于自车的前方,他车的驾驶行为会对自车的速度造成影响,则此时自车的驾驶行为决策为e2。2. When the ego car is in a driving environment where s 2 , p 1 , and c 1 exist at the same time, since the other car is located in front of the ego car, the driving behavior of the ego car will affect the speed of the ego car, then the ego car is The driving behavior decision of the car is e 2 .
(三)自车的驾驶行为决策为e3的驾驶环境包括:( 3 ) The driving environment where the driving behavior decision of the self-vehicle is e3 includes:
1.自车处于s1、p1、d2、c1、v2或v3、以及o5或o6同时存在的驾驶环境的情形下,由于两车处于安全距离之内,他车正进行驶入/驶出停车位的驾驶行为,会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e3。其中,“或”表示择一选择。1. When the self-vehicle is in a driving environment in which s 1 , p 1 , d 2 , c 1 , v 2 or v 3 , and o 5 or o 6 exist at the same time, since the two vehicles are within a safe distance, the other vehicle is driving. The driving behavior of entering/exiting the parking space will affect the driving behavior of the self-vehicle, and the driving behavior decision of the self-vehicle at this time is e 3 . Among them, "or" means to choose one.
2.自车处于s1、p1、d2、和c2同时存在的驾驶环境的情形下,由于两车处于安全距离之内,并且在同一车道反向行驶,他车的驾驶行为会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e3。2. When the own vehicle is in a driving environment where s 1 , p 1 , d 2 , and c 2 exist at the same time, since the two vehicles are within a safe distance and drive in the opposite direction in the same lane, the driving behavior of the other vehicle will affect the driving behavior of the other vehicle. If the driving behavior of the ego car affects, then the driving behavior decision of the ego car at this time is e 3 .
3.自车处于s1、p6、和d2同时存在的驾驶环境的情形下,由于两车处于安全距离之内,他车在自车侧前方的停车位内,他车的驾驶行为会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e3。3. When the own vehicle is in a driving environment where s 1 , p 6 , and d 2 exist at the same time, since the two vehicles are within a safe distance and the other vehicle is in the parking space in front of the own vehicle, the driving behavior of the other vehicle will be affected. If the driving behavior of the own vehicle is affected, the driving behavior decision of the own vehicle at this time is e 3 .
4.自车处于s2、p1、和c3同时存在的驾驶环境的情形下,由于他车位于自车前方,且行驶方向为垂向,自车需等待他车先行驶过,则此时自车的驾驶行为决策为e3。4. When the own vehicle is in a driving environment where s 2 , p 1 , and c 3 coexist, since the other vehicle is in front of the own vehicle and the driving direction is vertical, the own vehicle needs to wait for the other vehicle to pass first, then this The driving behavior decision of the ego vehicle is e 3 .
5.自车处于s2、p2、c2、和o3同时存在的驾驶环境的情形下,由于两车的轨迹会相交,自车需等待他车先行驶过,则此时自车的驾驶行为决策为e3。5. When the self-vehicle is in a driving environment where s 2 , p 2 , c 2 , and o 3 exist at the same time, since the trajectories of the two vehicles will intersect, the self-vehicle needs to wait for the other vehicle to pass first. The driving behavior decision is e 3 .
6.自车处于s2、p2、和c3同时存在的驾驶环境的情形下,由于两车的轨迹会相交,自车需等待他车先行驶过,此时自车的驾驶行为决策为e3。6. When the self-vehicle is in the driving environment where s 2 , p 2 , and c 3 exist at the same time, since the trajectories of the two vehicles will intersect, the self-vehicle needs to wait for the other vehicle to pass by first. At this time, the self-vehicle's driving behavior decision is: e 3 .
7.自车处于s3、p8、c2、和o6同时存在的驾驶环境的情形下,由于他车的驾驶行为会对本车的驾驶行为产生影响,则此时自车的驾驶行为决策为e3。7. When the own car is in a driving environment where s 3 , p 8 , c 2 , and o 6 exist at the same time, since the driving behavior of other cars will have an impact on the driving behavior of the own car, the driving behavior of the own car is decided at this time is e 3 .
8.自车处于s3、p9、和d2时存在的驾驶环境的情形下,由于两个车辆处于安全距离之内,有碰撞的可能,则此时自车的驾驶行为决策为e3。8. When the self-vehicle is in the driving environment that exists when s 3 , p 9 , and d 2 , since the two vehicles are within a safe distance and there is a possibility of collision, the driving behavior decision of the self-vehicle at this time is e 3 .
(四)自车的驾驶行为决策为e4的驾驶环境包括:( 4 ) The driving environment in which the driving behavior decision of the self-vehicle is e4 includes:
1.自车处于s3、p8、c1、和o5同时存在的驾驶环境的情形下,由于他车的行为不会影响自车驶入停车位,则此时自车的驾驶行为决策为e4。1. When the own car is in a driving environment where s 3 , p 8 , c 1 , and o 5 exist at the same time, since the behavior of other cars will not affect the own car's driving into the parking space, the driving behavior of the own car is decided at this time is e 4 .
2.自车处于s3、p8、c1、和o6同时存在的驾驶环境的情形下,由于他车的驾驶行为对本车的驾驶行为没有影响,则此时自车的驾驶行为决策为e4。2. When the own car is in the driving environment where s 3 , p 8 , c 1 , and o 6 exist at the same time, since the driving behavior of other cars has no influence on the driving behavior of the own car, the driving behavior decision of the own car at this time is: e 4 .
3.自车处于s3、p9、和d1同时存在的驾驶环境的情形下,由于他车的驾驶行为不会对本车的驾驶行为产生影响,则此时自车的驾驶行为决策为e4。3. When the own car is in the driving environment where s 3 , p 9 , and d 1 exist at the same time, since the driving behavior of other cars will not affect the driving behavior of the own car, the driving behavior decision of the own car at this time is e 4 .
在一个实施例中,自车的驾驶行为决策为e5的驾驶环境包括:In one embodiment, the driving environment where the driving behavior decision of the self - vehicle is e5 includes:
1.自车处于s3、p8、c1、和o6同时存在的驾驶环境的情形下,由于他车的驾驶行为对本车的驾驶行为没有影响,则此时自车的驾驶行为决策为e5。1. When the own car is in the driving environment where s 3 , p 8 , c 1 , and o 6 exist at the same time, since the driving behavior of other cars has no influence on the driving behavior of the own car, the driving behavior decision of the own car at this time is: e 5 .
2.自车处于s3、p8、c2、和o5同时存在的驾驶环境,由于他车的驾驶行为不会影响自车驶出停车位,则此时自车的驾驶行为决策为e5。2. The self-vehicle is in a driving environment where s 3 , p 8 , c 2 , and o 5 exist at the same time. Since the driving behavior of other vehicles will not affect the self-vehicle's driving out of the parking space, the driving behavior decision of the self-vehicle at this time is e 5 .
3.自车处于s3、p9、和d1同时存在的驾驶环境的情形下,由于他车的驾驶行为不会对本车的驾驶行为产生影响,则此时自车的驾驶行为决策为e5。3. When the own car is in the driving environment where s 3 , p 9 , and d 1 exist at the same time, since the driving behavior of other cars will not affect the driving behavior of the own car, the driving behavior decision of the own car at this time is e 5 .
本发明实施例还提供一种基于停车场场景下智能车辆决策系统,其包括驾驶场景判断单元、驾驶状态判断单元和泊车决策单元。The embodiment of the present invention also provides an intelligent vehicle decision system based on a parking lot scene, which includes a driving scene judgment unit, a driving state judgment unit, and a parking decision unit.
驾驶场景判断单元用于在进入泊车决策系统后,感知自车所处的驾驶场景,并判断是否处于停车场场景S:The driving scene judgment unit is used to perceive the driving scene where the vehicle is located after entering the parking decision system, and determine whether it is in the parking lot scene S:
S={si|i=1,2,3}S={s i |i=1,2,3}
其中,s1表示直行车道,s2表示交叉路口,s3表示停车位。Among them, s 1 represents a straight lane, s 2 represents an intersection, and s 3 represents a parking space.
驾驶状态判断单元用于在所述驾驶场景判断单元判定自车处于停车场场景S的情形下,判断自车是否处于驾驶过程中。The driving state judging unit is configured to judge whether the self-vehicle is in the driving process when the driving scene judging unit determines that the self-vehicle is in the parking lot scene S.
泊车决策单元用于在所述驾驶状态判断单元判定自车处于驾驶过程中的情形下,根据他车与自车的位置关系P、他车与自车的距离关系D、他车与自车的行驶方向关系C、他车与自车的速度关系V、以及他车的泊车驾驶行为O中的一种或多种,对自车的泊车驾驶行为E进行决策,以及用于在所述驾驶场景判断单元判定自车未处于停车场场景S的情形下或所述驾驶状态判断单元判定自车未处于驾驶过程中的情形下退出。The parking decision unit is used to determine the position relationship P between the other car and the own vehicle, the distance relationship D between the other vehicle and the own vehicle, and the One or more of the driving direction relationship C, the speed relationship V between the other car and the own car, and the parking driving behavior O of the other car, make decisions on the parking driving behavior E of the own car, and use it in all The driving scene determination unit determines that the vehicle is not in the parking lot scene S or the driving state determination unit determines that the vehicle is not in the driving process to exit.
在停车场场景下,他车与自车的位置关系P包括以下九种:In the parking lot scenario, the positional relationship P between his car and his own car includes the following nine types:
P={pi|i=1,2,…9}P={pi | i =1,2,…9}
其中,p1表示他车位于自车相同车道的前方,p2表示他车位于自车相邻车道的前方,p3表示他车位于自车相同车道的后方,p4表示他车位于自车相邻车道的后方,p5表示他车位于自车侧方,p6表示他车位于自车行驶车道侧前方的停车位内,p7表示他车位于自车行驶车道侧后方的停车位内,p8表示他车位于自车所在停车位的相邻停车位内,p9表示他车位于自车所在停车位前方的车道上。Among them, p 1 means that the other car is located in front of the same lane of the own vehicle, p 2 means that the other car is located in front of the adjacent lane of the own vehicle, p 3 means that the other car is located in the back of the same lane of the own vehicle, p 4 means that the other car is located in the own vehicle The rear of the adjacent lane, p 5 means that the other car is located on the side of the own vehicle, p 6 means that the other car is located in the parking space in front of the driving lane of the own vehicle, p 7 means that the other car is located in the parking space behind the driving lane of the own vehicle , p 8 means that his car is located in the adjacent parking space of the own car's parking space, p 9 means that his car is in the lane in front of the own car's parking space.
在停车场场景下,他车与自车的距离关系D包括以下两种:In the parking lot scenario, the distance relationship D between his car and his own car includes the following two:
D={di|i=1,2}D={d i |i=1,2}
其中,d1表示他车与自车的距离大于等于安全距离d,d2表示他车与自车的距离大于等于安全距离d,d的具体数值可根据车辆尺寸参数认为设置。Among them, d 1 indicates that the distance between the other vehicle and the own vehicle is greater than or equal to the safety distance d, and d 2 indicates that the distance between the other vehicle and the own vehicle is greater than or equal to the safety distance d. The specific value of d can be considered to be set according to the vehicle size parameters.
在停车场场景下,他车与自车的行驶方向关系C包括以下三种:In the parking lot scenario, the relationship C between the driving direction of the other car and the own car includes the following three types:
C={ci|i=1,2,3}C={ci | i =1,2,3}
其中,c1表示同向,c2表示反向,c3表示垂向。Among them, c 1 represents the same direction, c 2 represents the reverse direction, and c 3 represents the vertical direction.
在停车场场景下,他车与自车的速度关系V包括以下三种:In the parking lot scenario, the speed relationship V between the other car and the own car includes the following three types:
V={vi|i=1,2,3}V={v i |i=1,2,3}
其中,v1表示他车的速度大于自车,v2表示他车的速度小于自车,v3表示他车的速度与自车相同。Among them, v 1 means that the speed of his car is greater than that of the own car, v 2 means that the speed of his car is lower than that of the own car, and v 3 means that the speed of his car is the same as that of the own car.
在停车场场景下,他车的泊车驾驶行为O包括以下六种:In the parking lot scenario, his car's parking driving behavior O includes the following six types:
O={oi|i=1,2,…,6}O={o i |i=1,2,…,6}
其中,o1表示直行,o2表示换道,o3表示转弯,o4表示停车,o5表示驶入停车位,o6表示驶出停车位。Among them, o 1 means going straight, o 2 means changing lanes, o 3 means turning, o 4 means parking, o 5 means driving into the parking space, o 6 means driving out of the parking space.
在停车场场景下,自车的泊车驾驶行为E包括以下五种:In the parking lot scenario, the parking driving behavior E of the self-vehicle includes the following five types:
E={ei|i=1,2,…5}E={e i |i=1,2,…5}
其中,e1表示自主巡航,e2表示车辆跟随,e3表示停车等待,e4表示驶入停车位,e5表示驶出停车位。Among them, e 1 represents autonomous cruise, e 2 represents vehicle following, e 3 represents parking waiting, e 4 represents driving into the parking space, and e 5 represents driving out of the parking space.
本发明实施例不仅将停车场场景进行分类,能够使智能车辆的行为决策更加容易,而且智能车辆根据不同场景下其他车辆的驾驶行为,使自车行为决策更加贴合实际,能够提高停车场的停车效率和车辆行驶过程的安全性。The embodiment of the present invention not only classifies the parking lot scenes, which can make the behavior decision of the intelligent vehicle easier, but also makes the self-vehicle behavior decision more realistic according to the driving behavior of other vehicles in different scenarios, which can improve the behavior of the parking lot. Parking efficiency and safety during vehicle travel.
在一个实施例中,自车的驾驶行为决策为e1的驾驶环境包括:In one embodiment, the driving environment where the driving behavior decision of the self-vehicle is e1 includes:
1.自车处于s1、p1、和d1同时存在的驾驶环境的情形下,由于两车处于安全距离之外,他车的驾驶行为不会对自车造成影响,则此时自车的驾驶行为决策为e1。1. When the self-vehicle is in a driving environment in which s 1 , p 1 , and d 1 coexist, since the two vehicles are at a safe distance, the driving behavior of the other vehicle will not affect the self-vehicle, then the self-vehicle at this time The driving behavior decision is e 1 .
2.自车处于s1、p1、d2、c1、和v1同时存在的驾驶环境的情形下,虽然两车处于安全距离之内,但他车的速度大于自车,两车之间的距离在变大,则此时自车的驾驶行为决策为e1。2. When the own vehicle is in the driving environment where s 1 , p 1 , d 2 , c 1 , and v 1 exist at the same time, although the two vehicles are within a safe distance, the speed of the other vehicle is greater than that of the own vehicle, and the speed of the other vehicle is greater than that of the own vehicle. The distance between them is getting larger, then the driving behavior decision of the self-vehicle at this time is e 1 .
3.自车处于p2、p3、p4、p5、和p7中的一种与s1同时存在的驾驶环境的情形下,由于在这几种交互关系中,他车的驾驶行为不会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e1。3. When the own car is in a driving environment in which one of p 2 , p 3 , p 4 , p 5 , and p 7 coexists with s 1 , because in these interactive relationships, the driving behavior of the other car If the driving behavior of the self-vehicle is not affected, the driving behavior decision of the self-vehicle at this time is e 1 .
4.自车处于s1、p6、和d1同时存在的驾驶环境的情形下,由于两车处于安全距离之外,他车的驾驶行为不会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e1。4. Under the circumstance that the own car is in a driving environment where s 1 , p 6 , and d 1 exist at the same time, since the two cars are at a safe distance, the driving behavior of the other car will not affect the driving behavior of the own car, then this The driving behavior decision of the ego vehicle is e 1 .
5.自车处于s2、p2、c2、和o1同时存在的驾驶环境的情形下,由于两车的轨迹不会相交,则此时自车的驾驶行为决策为e1。5. When the self-vehicle is in a driving environment where s 2 , p 2 , c 2 , and o 1 coexist, since the trajectories of the two vehicles do not intersect, the self-vehicle's driving behavior decision at this time is e 1 .
6.自车处于p3、p4和p7中的一种与s2同时存在的驾驶环境的情形下,由于在这几种交互关系中,他车的驾驶行为不会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e1。6. In a situation where the ego car is in a driving environment in which one of p 3 , p 4 and p 7 coexists with s 2 , because in these interaction relationships, the driving behavior of the ego car will not affect the ego car's driving. If the behavior affects, then the driving behavior decision of the ego vehicle at this time is e 1 .
在一个实施例中,自车的驾驶行为决策为e2的驾驶环境包括:In one embodiment, the driving environment where the driving behavior decision of the self-vehicle is e 2 includes:
1.自车处于s1、p1、d2、c1、v2或v3、以及o1或o2同时存在的驾驶环境的情形下,由于两车处于安全距离之内,并且此时距离在不断减小或者不变,他车的驾驶行为会对自车的速度造成影响,则此时自车的驾驶行为决策为e2。其中的“v2或v3”可以理解为择一选择,“o1或o2”可以理解为择一选择。1. When the self-vehicle is in a driving environment where s 1 , p 1 , d 2 , c 1 , v 2 or v 3 , and o 1 or o 2 exist at the same time, since the two vehicles are within a safe distance, and at this time The distance is decreasing or unchanged, and the driving behavior of the other car will affect the speed of the own car, then the driving behavior decision of the own car at this time is e 2 . Among them, "v 2 or v 3 " can be understood as an alternative choice, and "o 1 or o 2 " can be understood as an alternative choice.
2.自车处于s2、p1、和c1同时存在的驾驶环境的情形下,由于他车位于自车的前方,他车的驾驶行为会对自车的速度造成影响,则此时自车的驾驶行为决策为e2。2. When the ego car is in a driving environment where s 2 , p 1 , and c 1 exist at the same time, since the other car is located in front of the ego car, the driving behavior of the ego car will affect the speed of the ego car, then the ego car is The driving behavior decision of the car is e 2 .
在一个实施例中,自车的驾驶行为决策为e3的驾驶环境包括:In one embodiment, the driving environment where the driving behavior decision of the self-vehicle is e3 includes:
1.自车处于s1、p1、d2、c1、v2或v3、以及o5或o6同时存在的驾驶环境的情形下,由于两车处于安全距离之内,他车正进行驶入/驶出停车位的驾驶行为,会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e3。其中,“或”表示择一选择。1. When the self-vehicle is in a driving environment where s 1 , p 1 , d 2 , c 1 , v 2 or v 3 , and o 5 or o 6 exist at the same time, since the two vehicles are within a safe distance, the other vehicle is driving. The driving behavior of entering/exiting the parking space will affect the driving behavior of the self-vehicle, and the driving behavior decision of the self-vehicle at this time is e 3 . Among them, "or" means to choose one.
2.自车处于s1、p1、d2、和c2同时存在的驾驶环境的情形下,由于两车处于安全距离之内,并且在同一车道反向行驶,他车的驾驶行为会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e3。2. When the own vehicle is in a driving environment where s 1 , p 1 , d 2 , and c 2 exist at the same time, since the two vehicles are within a safe distance and drive in the opposite direction in the same lane, the driving behavior of the other vehicle will affect the driving behavior of the other vehicle. If the driving behavior of the ego car affects, then the driving behavior decision of the ego car at this time is e 3 .
3.自车处于s1、p6、和d2同时存在的驾驶环境的情形下,由于两车处于安全距离之内,他车在自车侧前方的停车位内,他车的驾驶行为会对自车的驾驶行为造成影响,则此时自车的驾驶行为决策为e3。3. When the own vehicle is in a driving environment where s 1 , p 6 , and d 2 exist at the same time, since the two vehicles are within a safe distance and the other vehicle is in the parking space in front of the own vehicle, the driving behavior of the other vehicle will be affected. If the driving behavior of the own vehicle is affected, the driving behavior decision of the own vehicle at this time is e 3 .
4.自车处于s2、p1、和c3同时存在的驾驶环境的情形下,由于他车位于自车前方,且行驶方向为垂向,自车需等待他车先行驶过,则此时自车的驾驶行为决策为e3。4. When the own vehicle is in a driving environment where s 2 , p 1 , and c 3 coexist, since the other vehicle is in front of the own vehicle and the driving direction is vertical, the own vehicle needs to wait for the other vehicle to pass first, then this The driving behavior decision of the ego vehicle is e 3 .
5.自车处于s2、p2、c2、和o3同时存在的驾驶环境的情形下,由于两车的轨迹会相交,自车需等待他车先行驶过,则此时自车的驾驶行为决策为e3。5. When the self-vehicle is in a driving environment where s 2 , p 2 , c 2 , and o 3 exist at the same time, since the trajectories of the two vehicles will intersect, the self-vehicle needs to wait for the other vehicle to pass first. The driving behavior decision is e 3 .
6.自车处于s2、p2、和c3同时存在的驾驶环境的情形下,由于两车的轨迹会相交,自车需等待他车先行驶过,此时自车的驾驶行为决策为e3。6. When the self-vehicle is in the driving environment where s 2 , p 2 , and c 3 exist at the same time, since the trajectories of the two vehicles will intersect, the self-vehicle needs to wait for the other vehicle to pass by first. At this time, the self-vehicle's driving behavior decision is: e 3 .
7.自车处于s3、p8、c2、和o6同时存在的驾驶环境的情形下,由于他车的驾驶行为会对本车的驾驶行为产生影响,则此时自车的驾驶行为决策为e3。7. When the own car is in a driving environment where s 3 , p 8 , c 2 , and o 6 exist at the same time, since the driving behavior of other cars will have an impact on the driving behavior of the own car, the driving behavior of the own car is decided at this time is e 3 .
8.自车处于s3、p9、和d2时存在的驾驶环境的情形下,由于两个车辆处于安全距离之内,有碰撞的可能,则此时自车的驾驶行为决策为e3。8. When the self-vehicle is in the driving environment that exists when s 3 , p 9 , and d 2 , since the two vehicles are within a safe distance and there is a possibility of collision, the driving behavior decision of the self-vehicle at this time is e 3 .
在一个实施例中,自车的驾驶行为决策为e4的驾驶环境包括:In one embodiment, the driving environment where the driving behavior decision of the self - vehicle is e4 includes:
1.自车处于s3、p8、c1、和o5同时存在的驾驶环境的情形下,由于他车的行为不会影响自车驶入停车位,则此时自车的驾驶行为决策为e4。1. When the own car is in a driving environment where s 3 , p 8 , c 1 , and o 5 exist at the same time, since the behavior of other cars will not affect the own car's driving into the parking space, the driving behavior of the own car is decided at this time is e 4 .
2.自车处于s3、p8、c1、和o6同时存在的驾驶环境的情形下,由于他车的驾驶行为对本车的驾驶行为没有影响,则此时自车的驾驶行为决策为e4。2. When the own car is in the driving environment where s 3 , p 8 , c 1 , and o 6 exist at the same time, since the driving behavior of other cars has no influence on the driving behavior of the own car, the driving behavior decision of the own car at this time is: e 4 .
3.自车处于s3、p9、和d1同时存在的驾驶环境的情形下,由于他车的驾驶行为不会对本车的驾驶行为产生影响,则此时自车的驾驶行为决策为e4。3. When the own car is in the driving environment where s 3 , p 9 , and d 1 exist at the same time, since the driving behavior of other cars will not affect the driving behavior of the own car, the driving behavior decision of the own car at this time is e 4 .
在一个实施例中,自车的驾驶行为决策为e5的驾驶环境包括:In one embodiment, the driving environment where the driving behavior decision of the self - vehicle is e5 includes:
1.自车处于s3、p8、c1、和o6同时存在的驾驶环境的情形下,由于他车的驾驶行为对本车的驾驶行为没有影响,则此时自车的驾驶行为决策为e5。1. When the own car is in the driving environment where s 3 , p 8 , c 1 , and o 6 exist at the same time, since the driving behavior of other cars has no influence on the driving behavior of the own car, the driving behavior decision of the own car at this time is: e 5 .
2.自车处于s3、p8、c2、和o5同时存在的驾驶环境,由于他车的驾驶行为不会影响自车驶出停车位,则此时自车的驾驶行为决策为e5。2. The self-vehicle is in a driving environment where s 3 , p 8 , c 2 , and o 5 exist at the same time. Since the driving behavior of other vehicles will not affect the self-vehicle's driving out of the parking space, the driving behavior decision of the self-vehicle at this time is e 5 .
3.自车处于s3、p9、和d1同时存在的驾驶环境的情形下,由于他车的驾驶行为不会对本车的驾驶行为产生影响,则此时自车的驾驶行为决策为e5。3. When the own car is in the driving environment where s 3 , p 9 , and d 1 exist at the same time, since the driving behavior of other cars will not affect the driving behavior of the own car, the driving behavior decision of the own car at this time is e 5 .
最后需要指出的是:以上实施例仅用以说明本发明的技术方案,而非对其限制。本领域的普通技术人员应当理解:可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。Finally, it should be pointed out that the above embodiments are only used to illustrate the technical solutions of the present invention, but not to limit them. It should be understood by those of ordinary skill in the art that the technical solutions described in the foregoing embodiments can be modified, or some of the technical features thereof can be equivalently replaced; these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the various aspects of the present invention. The spirit and scope of the technical solutions of the embodiments.
Claims (12)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110051997.3A CN112810604B (en) | 2021-01-15 | 2021-01-15 | Intelligent vehicle behavior decision method and system based on parking lot scene |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110051997.3A CN112810604B (en) | 2021-01-15 | 2021-01-15 | Intelligent vehicle behavior decision method and system based on parking lot scene |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112810604A CN112810604A (en) | 2021-05-18 |
CN112810604B true CN112810604B (en) | 2022-04-05 |
Family
ID=75869466
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110051997.3A Active CN112810604B (en) | 2021-01-15 | 2021-01-15 | Intelligent vehicle behavior decision method and system based on parking lot scene |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112810604B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115082900B (en) * | 2022-07-19 | 2023-06-16 | 湖南大学无锡智能控制研究院 | Intelligent vehicle driving decision system and method in parking lot scene |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102014224601A1 (en) * | 2014-12-02 | 2016-06-02 | Robert Bosch Gmbh | Device and method for operating a parking space |
CN105857306B (en) * | 2016-04-14 | 2018-07-10 | 中国科学院合肥物质科学研究院 | A kind of vehicle autonomous parking paths planning method for a variety of scenes of parking |
JP6819500B2 (en) * | 2017-07-26 | 2021-01-27 | 株式会社デンソー | Parking support system and parking support method |
CN110962843B (en) * | 2018-09-30 | 2021-07-27 | 上海汽车集团股份有限公司 | Automatic parking control decision method and system |
JP7157390B2 (en) * | 2019-01-30 | 2022-10-20 | トヨタ自動車株式会社 | Driving support device |
DE102019204203A1 (en) * | 2019-03-27 | 2020-10-01 | Volkswagen Aktiengesellschaft | Method for parking a motor vehicle in a parking zone with an autonomous parking process based on a temporary parking position, parking assistance system and motor vehicle |
US11485353B2 (en) * | 2019-04-30 | 2022-11-01 | Baidu Usa Llc | Segmenting a parking trajectory to control an autonomous driving vehicle to park |
-
2021
- 2021-01-15 CN CN202110051997.3A patent/CN112810604B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN112810604A (en) | 2021-05-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113165652B (en) | Examining Predicted Trajectories Using a Grid-Based Approach | |
WO2022105579A1 (en) | Control method and apparatus based on autonomous driving, and vehicle and related device | |
US20190143992A1 (en) | Self-driving learning apparatus and method using driving experience information | |
US20250004470A1 (en) | Generating trajectories for autonomous vehicles | |
CN111462497A (en) | Traffic data issuing method, system, terminal and storage medium | |
CN110488802A (en) | A kind of automatic driving vehicle dynamic behaviour decision-making technique netted under connection environment | |
CN111583693B (en) | An urban road intelligent traffic cooperative operation system and intelligent vehicle control method | |
CN112258841B (en) | Intelligent vehicle risk assessment method based on vehicle track prediction | |
CN110751847A (en) | Decision-making method and system for automatically driving vehicle behaviors | |
CN111696373A (en) | Motorcade cooperative sensing method, motorcade cooperative control method and motorcade cooperative control system | |
CN110989568B (en) | Automatic driving vehicle safe passing method and system based on fuzzy controller | |
CN112002144A (en) | Method and system for assessing driving risk situation at unsignaled intersections | |
CN113160547A (en) | Automatic driving method and related equipment | |
WO2023155041A1 (en) | Intelligent driving method, device, and vehicle comprising said device | |
CN113320545A (en) | Intersection behavior prediction decision method based on line-control intelligent vehicle | |
JP2022550058A (en) | Safety analysis framework | |
CN115257819A (en) | Decision-making method for safe driving of large-scale commercial vehicle in urban low-speed environment | |
JP2022179383A (en) | System and method for completing joint risk localization and reasoning in driving scenario | |
CN115107767A (en) | A control method for automatic driving braking and anti-collision based on artificial intelligence | |
CN117022324A (en) | Automatic driving automobile compliance safety decision planning system and method | |
Xie et al. | Study on the controlled field test scenarios of automated vehicles | |
CN112810604B (en) | Intelligent vehicle behavior decision method and system based on parking lot scene | |
CN116985790A (en) | Intelligent networking automobile decision-making method and system for intersection without signal lamp | |
CN111476491A (en) | Vehicle motion simulation analysis method in urban traffic scene | |
CN115440023A (en) | Method and device for judging traffic violation behaviors |
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 |