WO2024087522A1 - Autonomous driving decision planning and autonomous vehicle - Google Patents

Autonomous driving decision planning and autonomous vehicle Download PDF

Info

Publication number
WO2024087522A1
WO2024087522A1 PCT/CN2023/086587 CN2023086587W WO2024087522A1 WO 2024087522 A1 WO2024087522 A1 WO 2024087522A1 CN 2023086587 W CN2023086587 W CN 2023086587W WO 2024087522 A1 WO2024087522 A1 WO 2024087522A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
driving
trajectory
route
autonomous driving
Prior art date
Application number
PCT/CN2023/086587
Other languages
French (fr)
Chinese (zh)
Inventor
李潇
何毅晨
丁曙光
王乃峥
Original Assignee
北京三快在线科技有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 北京三快在线科技有限公司 filed Critical 北京三快在线科技有限公司
Publication of WO2024087522A1 publication Critical patent/WO2024087522A1/en

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles

Definitions

  • the embodiments of the present application relate to the field of autonomous driving technology, and in particular to autonomous driving decision planning and autonomous driving vehicles.
  • an autonomous driving vehicle can obtain a manually set driving route and move according to the manually set driving route.
  • the present application provides an autonomous driving decision-making plan and an autonomous driving vehicle, and the technical solution includes the following contents.
  • a method for autonomous driving decision planning comprising:
  • controlling the autonomous driving vehicle In response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located, controlling the autonomous driving vehicle to travel along a trial route, wherein the driving route of the obstacle vehicle conflicts with the driving route of the autonomous driving vehicle;
  • While the autonomous driving vehicle is driving along the trial route, obtaining relevant information of the obstacle vehicle;
  • the autonomous driving decision planning is performed on the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle.
  • an automatic driving decision-making planning device comprising:
  • control module configured to control the autonomous driving vehicle to travel along a trial route in response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located, wherein the route of the obstacle vehicle conflicts with the route of the autonomous driving vehicle;
  • An acquisition module used for acquiring relevant information of the obstacle vehicle during the process of the autonomous driving vehicle driving along the trial route
  • a determination module used to determine the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle
  • a planning module is used to perform autonomous driving decision planning for the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle.
  • an autonomous driving vehicle which includes a processor and a memory, wherein the memory stores at least one computer program, and the at least one computer program is loaded and executed by the processor so that the autonomous driving vehicle implements the above-mentioned autonomous driving decision planning method.
  • a non-temporary computer-readable storage medium in which at least one computer program is stored, and the at least one computer program is loaded and executed by a processor to enable the autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
  • a computer program in which at least one computer instruction is stored, and the at least one computer instruction is loaded and executed by a processor to enable an autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
  • a computer program product in which at least one computer program is stored, and the at least one computer program is loaded and executed by a processor to enable an autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
  • the autonomous driving vehicle when there is an obstacle vehicle in the environment where the autonomous driving vehicle is located, the autonomous driving vehicle is controlled to drive along the trial route, and the obstacle vehicle is guided to move by actively showing the driving intention of the autonomous driving vehicle, so that the obstacle vehicle can show the driving intention of the obstacle vehicle as soon as possible.
  • the relevant information of the obstacle vehicle is used to determine the driving intention of the obstacle vehicle, so that the autonomous driving vehicle can capture the driving intention of the obstacle vehicle in advance.
  • the autonomous driving vehicle makes autonomous driving decision-making plans based on the driving intention of the obstacle vehicle, it not only improves the intelligence level of the autonomous driving vehicle, but also helps to improve the driving safety of the autonomous driving vehicle.
  • FIG1 is a schematic diagram of an implementation environment of an autonomous driving decision-making planning method provided in an embodiment of the present application
  • FIG2 is a flow chart of an autonomous driving decision-making planning method provided by an embodiment of the present application.
  • FIG3 is a schematic diagram of a space-level vehicle meeting provided by an embodiment of the present application.
  • FIG4 is a schematic diagram of a time-level vehicle meeting provided by an embodiment of the present application.
  • FIG5 is a schematic diagram of a trajectory planning provided in an embodiment of the present application.
  • FIG6 is a schematic diagram of a vehicle motion provided by an embodiment of the present application.
  • FIG7 is a schematic diagram of a framework of an autonomous driving decision-making planning method provided in an embodiment of the present application.
  • FIG8 is a schematic diagram of an autonomous driving decision-making plan provided in an embodiment of the present application.
  • FIG9 is a schematic diagram of the structure of an automatic driving decision-making and planning device provided in an embodiment of the present application.
  • FIG10 is a schematic diagram of the structure of a terminal device provided in an embodiment of the present application.
  • FIG. 11 is a schematic diagram of the structure of a server provided in an embodiment of the present application.
  • FIG1 is a schematic diagram of an implementation environment of an autonomous driving decision-making planning method provided in an embodiment of the present application.
  • the implementation environment includes a terminal device 101 and a server 102.
  • the autonomous driving decision-making planning method provided in an embodiment of the present application can be executed by the terminal device 101, or by the server 102, or by the terminal device 101 and the server 102.
  • at least one of the terminal device 101 and the server 102 can be deployed in an autonomous driving vehicle
  • the autonomous driving decision-making planning method provided in an embodiment of the present application is executed by the autonomous driving vehicle.
  • the autonomous driving vehicle can be an automatic car, an automatic electric car, a drone, a robot, or other subject that can travel automatically.
  • the terminal device 101 can be a smart phone, a game console, a desktop computer, a tablet computer, a laptop computer, a smart TV, a smart car device, an intelligent voice interaction device, a smart home appliance, etc.
  • the server 102 can be a single server, or a server cluster consisting of multiple servers, or any one of a cloud computing platform and a virtualization center, which is not limited in the embodiments of the present application.
  • the server 102 can be connected to the terminal device 101 through a wired network or a wireless network.
  • the server 102 can have functions such as data processing, data storage, and data transmission and reception, which are not limited in the embodiments of the present application.
  • the number of terminal devices 101 and servers 102 is not limited and can be one or more.
  • autonomous driving vehicles can obtain manually set driving routes and control the autonomous driving vehicles to move along the manually set driving routes.
  • This autonomous driving decision-making and planning method is relatively simple and difficult to cope with complex actual traffic scenarios. It has a low degree of intelligence, resulting in poor driving safety of autonomous driving vehicles.
  • the embodiment of the present application provides an autonomous driving decision-making planning method, which can be applied to the above-mentioned implementation environment and can improve the driving safety of the autonomous driving vehicle.
  • the method can be executed by an autonomous driving vehicle.
  • it is executed by an autonomous driving vehicle deployed with at least one of a terminal device and a server.
  • the method includes the following steps.
  • Step 201 in response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located, controlling the autonomous driving vehicle to travel along a trial route, where the obstacle vehicle refers to a vehicle that conflicts with the driving route of the autonomous driving vehicle.
  • the autonomous driving vehicle is equipped with at least one sensor, including but not limited to a temperature sensor, an infrared sensor, an image sensor, etc.
  • Each sensor corresponds to a sensing range, and the environment in which the autonomous driving vehicle is located refers to the sensing range of various sensors configured on the autonomous driving vehicle.
  • the autonomous vehicle can sense all the vehicles in the environment where the autonomous vehicle is located.
  • the autonomous vehicle can plan a trial route and drive along the trial route.
  • the driving route of the obstacle vehicle conflicts with the driving route of the autonomous vehicle.
  • the driving direction of the obstacle vehicle can be the same as that of the autonomous driving vehicle, or it can be opposite to the driving direction of the autonomous driving vehicle. That is, the obstacle vehicle and the autonomous driving vehicle can travel in the same direction or in opposite directions.
  • the autonomous driving vehicle may determine the estimated collision time between the autonomous driving vehicle and any vehicle based on the driving route of the autonomous driving vehicle and the driving route of any vehicle in the environment where the autonomous driving vehicle is located. If the estimated collision time is less than the time threshold, then any vehicle is determined to be an obstacle vehicle. Since the estimated collision time between the obstacle vehicle and the autonomous driving vehicle is less than the time threshold, it means that the obstacle vehicle and the autonomous driving vehicle will collide within the time threshold, and therefore, there is a conflict between the driving route of the obstacle vehicle and the driving route of the autonomous driving vehicle.
  • step 205 to step 207 are included before step 201 .
  • Step 205 obtaining the historical actual driving trajectory of the autonomous driving vehicle, the historical actual driving trajectory of the obstacle vehicle, and the historical expected driving trajectory of the obstacle vehicle, wherein the historical expected driving trajectory of the obstacle vehicle is estimated based on the driving route of the obstacle vehicle.
  • the historical expected driving trajectory of the obstacle vehicle is estimated by the autonomous driving vehicle based on the driving route of the obstacle vehicle.
  • the historical expected driving trajectory of the obstacle vehicle is estimated by other devices other than the autonomous driving vehicle based on the driving route of the obstacle vehicle.
  • the autonomous driving vehicle is deployed with a terminal device, and other devices other than the autonomous driving vehicle include but are not limited to a server.
  • the terminal device or the obstacle vehicle reports the driving route of the obstacle vehicle to the server, so that the server estimates the historical expected driving trajectory of the obstacle vehicle based on the driving route of the obstacle vehicle.
  • the automatic driving decision planning for the automatic driving vehicle in the embodiment of the present application is a continuous process. Therefore, the automatic driving decision planning for the automatic driving vehicle can be carried out in a periodic manner to achieve periodic control of the automatic driving vehicle.
  • the automatic driving vehicle can determine the trial route corresponding to the previous time period or the previous several time periods of the current time period as the historical expected driving trajectory of the automatic driving vehicle. Since the automatic driving vehicle drives according to the trial route corresponding to the current time period in the current time period, the actual driving route of the automatic driving vehicle is the same as the trial route.
  • the automatic driving vehicle in the time period before the current time period (i.e., the previous time period or the previous several time periods of the current time period), the automatic driving vehicle also drives according to the trial route corresponding to the previous time period, so the historical actual driving trajectory of the automatic driving vehicle is the same as the trial route corresponding to the previous time period. Since the trial route corresponding to the previous time period can be determined as the historical expected driving trajectory of the automatic driving vehicle, and the historical actual driving trajectory of the automatic driving vehicle is the same as the trial route corresponding to the previous time period, it can be considered that the historical expected driving trajectory of the automatic driving vehicle is also the historical actual driving trajectory of the automatic driving vehicle.
  • the autonomous driving vehicle can sense the actual driving trajectory of the obstacle vehicle through the sensors.
  • the autonomous driving vehicle can use the actual driving trajectory of the obstacle vehicle corresponding to the previous time period or the previous several time periods of the current time period as the historical actual driving trajectory of the obstacle vehicle.
  • the historical actual driving trajectory of the obstacle vehicle is the actual driving trajectory of the obstacle vehicle sensed by the autonomous driving vehicle in the time period before the current time period.
  • the sensors of the autonomous driving vehicle can sense the actual position of the obstacle vehicle multiple times, and each time the actual position is sensed, the sensing time (i.e., the time when the actual position is sensed) can be recorded. Therefore, the historical actual driving trajectory of the obstacle vehicle includes the position information of multiple actual trajectory points and the time information of the obstacle vehicle arriving at each actual trajectory point. Among them, the position information of the actual trajectory point corresponds to the perceived actual position, and the time information of arriving at the actual trajectory point corresponds to the sensing time.
  • the autonomous driving vehicle will conduct joint planning to jointly plan the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle.
  • the expected driving trajectory of the autonomous driving vehicle is the trial route corresponding to the autonomous driving vehicle in the next time period. Therefore, the method for determining the expected driving trajectory of the obstacle vehicle can be found in the description of determining the trial route.
  • the expected driving trajectory of the obstacle vehicle is the trial route corresponding to the obstacle vehicle in the next time period, which will not be repeated here.
  • the expected driving trajectory of the autonomous driving vehicle includes the position information of multiple expected trajectory points and the time information when the autonomous driving vehicle reaches each expected trajectory point.
  • the expected driving trajectory of the obstacle vehicle includes the position information of multiple expected trajectory points and the time information when the obstacle vehicle reaches each expected trajectory point.
  • the autonomous driving vehicle may determine the expected driving trajectory of the obstacle vehicle corresponding to the previous time period or the previous several time periods before the current time period as the historical expected driving trajectory of the obstacle vehicle.
  • the historical expected driving trajectory of the obstacle vehicle is the expected driving trajectory of the obstacle vehicle corresponding to the time period before the current time period.
  • Step 206 determining historical deviation information based on the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle.
  • the autonomous driving vehicle plans the historical expected driving trajectory of the obstacle vehicle.
  • the autonomous driving vehicle expects the obstacle vehicle to move according to the historical expected driving trajectory of the obstacle vehicle, but in fact the obstacle vehicle moves according to its own driving intention. Therefore, there is a certain difference between the actual historical driving trajectory of the obstacle vehicle and the expected historical driving trajectory of the obstacle vehicle.
  • the autonomous driving vehicle may determine historical deviation information based on the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle, so as to quantify the difference between the historical actual driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the obstacle vehicle through the historical deviation information.
  • the value of the historical deviation information is proportional to the size of the difference, that is, the larger the value of the historical deviation information, the larger the difference between the historical actual driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the obstacle vehicle.
  • step 206 includes steps 2061 and 2062.
  • Step 2061 for any obstacle vehicle, determine the deviation information between the historical expected driving trajectory of any obstacle vehicle and the historical actual driving trajectory of any obstacle vehicle.
  • the autonomous driving vehicle can determine the deviation information between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle, and record the deviation information as the deviation information of the obstacle vehicle.
  • the difference between the historical actual driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the obstacle vehicle can be quantified through the deviation information of the obstacle vehicle.
  • the numerical value of the deviation information of the obstacle vehicle is proportional to the size of the difference, that is, the larger the numerical value of the deviation information of the obstacle vehicle, the greater the difference between the historical actual driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the obstacle vehicle.
  • step 2061 includes: determining the spatial deviation information corresponding to the obstacle vehicle based on the position information of multiple expected trajectory points and the position information of multiple actual trajectory points; determining the time deviation information corresponding to the obstacle vehicle based on the time information of the obstacle vehicle arriving at each expected trajectory point and the time information of the obstacle vehicle arriving at each actual trajectory point; determining the deviation information of the obstacle vehicle based on the spatial deviation information and time deviation information corresponding to the obstacle vehicle.
  • the spatial deviation information corresponding to the obstacle vehicle can be determined based on the position information of multiple expected trajectory points and the position information of multiple actual trajectory points.
  • the spatial deviation information corresponding to the obstacle vehicle can reflect the difference between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle at the spatial level.
  • implementation method A1 Two methods of determining the spatial deviation information corresponding to the obstacle vehicle, namely, implementation method A1 and implementation method A2, are provided below.
  • Implementation A1 For any expected trajectory point, based on the position information of the expected trajectory point and the position information of multiple actual trajectory points, the distance between the expected trajectory point and each actual trajectory point is calculated, and the minimum distance corresponding to the expected trajectory point is determined from the distances between the expected trajectory point and each actual trajectory point.
  • the spatial deviation information corresponding to the obstacle vehicle is calculated based on the minimum distances corresponding to the multiple expected trajectory points, for example, the minimum distances corresponding to the multiple expected trajectory points are weighted averaged to obtain the spatial deviation information corresponding to the obstacle vehicle.
  • implementation A1 calculates the spatial deviation information corresponding to the obstacle vehicle based on the minimum distance corresponding to multiple expected trajectory points.
  • the distance between any actual trajectory point and each expected trajectory point can be calculated first, and then the minimum distance corresponding to the actual trajectory point can be determined. After that, the spatial deviation information corresponding to the obstacle vehicle can be calculated based on the minimum distance corresponding to multiple actual trajectory points.
  • Implementation A2 based on the position information of multiple expected trajectory points, the spatial characteristics of the historical expected driving trajectory of the obstacle vehicle are determined. Based on the position information of multiple actual trajectory points, the spatial characteristics of the historical actual driving trajectory of the obstacle vehicle are determined. After that, the characteristic distance between the spatial characteristics of the historical expected driving trajectory of the obstacle vehicle and the spatial characteristics of the historical actual driving trajectory of the obstacle vehicle is calculated, and the spatial deviation information corresponding to the obstacle vehicle is obtained based on the characteristic distance, such as mapping the characteristic distance to obtain the spatial deviation information corresponding to the obstacle vehicle.
  • the spatial characteristics of the historical expected driving trajectory of the obstacle vehicle can be expressed as a feature vector, and the spatial characteristics of the historical driving trajectory of the obstacle vehicle can be expressed as another feature vector.
  • the feature distance between the two feature vectors is calculated.
  • the mapping relationship between the feature distance and the spatial deviation information is queried based on the feature distance to obtain the spatial deviation information mapped to the feature distance.
  • the queried spatial deviation information is the spatial deviation information corresponding to the obstacle vehicle.
  • implementation methods can determine the time deviation information corresponding to the barrier vehicle based on the time information of the barrier vehicle reaching each expected trajectory point and the time information of the barrier vehicle reaching each actual trajectory point.
  • the time deviation information corresponding to the barrier vehicle can reflect the difference between the historical expected driving trajectory of the barrier vehicle and the historical actual driving trajectory of the barrier vehicle at the time level. The following provides two methods for determining the time deviation information corresponding to the barrier vehicle, implementation method B1 and implementation method B2.
  • the time information of the obstacle vehicle reaching the expected trajectory point is related to the position information of the expected trajectory point
  • the time information of the obstacle vehicle reaching the actual trajectory point is related to the position information of the actual trajectory point.
  • Implementation method B1 for any expected trajectory point, based on the position information of the expected trajectory point and the position information of multiple actual trajectory points, calculate the distance between the expected trajectory point and each actual trajectory point, determine the minimum distance corresponding to the expected trajectory point from the distance between the expected trajectory point and each actual trajectory point, and thus determine the actual trajectory point corresponding to the minimum distance. Based on the time information of the obstacle vehicle arriving at the expected trajectory point and the time information of the actual trajectory point corresponding to the minimum distance corresponding to the expected trajectory point (for example, calculating the time difference between the two time information), the time deviation information corresponding to the expected trajectory point is obtained. In other words, when the obstacle vehicle arrives at the expected trajectory point, a time information is generated.
  • the minimum distance corresponding to the expected trajectory point is determined above, and the minimum distance corresponds to an actual trajectory point, a time information is also generated when the obstacle vehicle arrives at the actual trajectory point corresponding to the minimum distance, and two time information are generated in total.
  • the embodiment of the present application can obtain the time deviation information corresponding to the expected trajectory point based on the two time information. Afterwards, based on the time deviation information corresponding to multiple expected trajectory points, the time deviation information corresponding to the obstacle vehicle is determined, for example, the time deviation information corresponding to multiple expected trajectory points is weighted averaged to obtain the time deviation information corresponding to the obstacle vehicle.
  • implementation method B1 calculates the time deviation information corresponding to the obstacle vehicle based on the time deviation information corresponding to multiple expected trajectory points.
  • the distance between any actual trajectory point and each expected trajectory point can be calculated first, and then the minimum distance corresponding to the actual trajectory point can be determined, thereby determining the expected trajectory point corresponding to the minimum distance, so as to calculate the time deviation information corresponding to the actual trajectory point.
  • the time deviation information corresponding to the obstacle vehicle is calculated based on the time deviation information corresponding to multiple actual trajectory points.
  • Implementation method B2 based on the position information of multiple expected trajectory points and the time information of the obstacle vehicle arriving at each expected trajectory point, the time characteristics of the historical expected driving trajectory of the obstacle vehicle are determined. Based on the position information of multiple actual trajectory points and the time information of the obstacle vehicle arriving at each actual trajectory point, the time characteristics of the historical actual driving trajectory of the obstacle vehicle are determined. Afterwards, the characteristic distance between the time characteristics of the historical expected driving trajectory of the obstacle vehicle and the time characteristics of the historical actual driving trajectory of the obstacle vehicle is calculated, and the time deviation information corresponding to the obstacle vehicle is obtained based on the characteristic distance, such as mapping the characteristic distance to obtain the time deviation information corresponding to the obstacle vehicle.
  • the time characteristics of the historical expected driving trajectory of the obstacle vehicle and the time characteristics of the historical actual driving trajectory of the obstacle vehicle can be represented by two feature vectors.
  • the embodiment of the present application can calculate the feature distance between the two feature vectors, query the mapping relationship between the feature distance and the spatial deviation information based on the feature distance, and obtain the time deviation information mapped to the feature distance.
  • the time deviation information obtained by the query is the time deviation information corresponding to the obstacle vehicle.
  • the spatial deviation information corresponding to the obstacle vehicle and the time deviation information corresponding to the obstacle vehicle are weighted summed, weighted averaged, etc. to obtain the deviation information of the obstacle vehicle.
  • the deviation information of the obstacle vehicle can reflect the difference between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle at the spatiotemporal level. Since the deviation information of the obstacle vehicle is determined based on the spatial deviation information corresponding to the obstacle vehicle and the temporal deviation information corresponding to the obstacle vehicle, the embodiment of the present application decouples the deviation information of the obstacle vehicle into the difference at the spatial level and the difference at the temporal level.
  • Figure 3 is a schematic diagram of a spatial level meeting provided by an embodiment of the present application.
  • Figure 3 shows vehicle A and vehicle B on the road, and the movement direction of vehicle A is opposite to the movement direction of vehicle B.
  • vehicle A and vehicle B meet, one optional method is that vehicle A moves along trajectory A-m1 and vehicle B moves along trajectory B-m1, and another optional method is that vehicle A moves along trajectory A-m2 and vehicle B moves along trajectory B-m2. Therefore, for vehicle A, at the spatial level, vehicle A can move along trajectory A-m1 or along trajectory A-m2, and this movement difference is the difference at the spatial level.
  • FIG. 4 is a schematic diagram of a time-level meeting provided by an embodiment of the present application.
  • FIG. 4 shows vehicles A, B and C on the road, wherein the movement direction of vehicle A is opposite to that of vehicle B, while vehicle C is stationary, or the movement direction of vehicle C is the same as that of vehicle A.
  • Vehicle B moves along the trajectory B-m.
  • one optional method is that vehicle A moves along the trajectory A-m1. In this case, vehicle A meets vehicle B behind vehicle C.
  • Another optional method is that vehicle A moves along the trajectory A-m2. In this case, vehicle A meets vehicle B after passing vehicle C. Therefore, for vehicle A, at the time level, vehicle A can move along the trajectory A-m1 or along the trajectory A-m2. This movement difference is the difference at the time level.
  • the historical expected driving trajectory of the obstacle vehicle and the obstacle vehicle are calculated at the spatial level and the temporal level respectively.
  • the difference between the historical actual driving trajectories and the deviation information of the obstacle vehicle is calculated based on the differences in spatial and temporal levels, which is conducive to improving the accuracy of the deviation information of the obstacle vehicle, so that the autonomous driving vehicle can plan a more accurate expected trajectory and improve the driving safety of the autonomous driving vehicle.
  • the historical expected driving trajectory of any barrier vehicle includes expected trajectory points at multiple moments
  • the historical actual driving trajectory of any barrier vehicle includes actual trajectory points at multiple moments.
  • step 2061 includes: for any moment, based on the position information of the expected trajectory point at any moment and the position information of the actual trajectory point at any moment, determining the distance between the expected trajectory point and the actual trajectory point corresponding to any moment; based on the distance between the expected trajectory point and the actual trajectory point corresponding to each moment, determining the deviation information between the historical expected driving trajectory of any barrier vehicle and the historical actual driving trajectory of any barrier vehicle.
  • an expected trajectory point corresponds to a time (or moment), that is, an expected trajectory point can be understood as an expected trajectory point at a moment.
  • the historical actual driving trajectory of any obstacle vehicle includes the position information of multiple actual trajectory points and the time information of the obstacle vehicle arriving at each actual trajectory point, so an actual trajectory point can be understood as an actual trajectory point at a moment.
  • the distance between the expected trajectory point and the actual trajectory point corresponding to that moment is calculated according to the distance formula.
  • the distance between the expected trajectory point and the actual trajectory point corresponding to each moment is averaged, summed, etc. to obtain the calculation result, and the calculation result is used as the deviation information of the obstacle vehicle, or the calculation result is mapped to the deviation information of the obstacle vehicle.
  • the deviation information of the obstacle vehicle is proportional to the calculation result, that is, the larger the calculation result, the larger the deviation information of the obstacle vehicle, and the greater the difference between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle.
  • Step 2062 Determine historical deviation information based on deviation information between historical expected driving trajectories of each obstacle vehicle and historical actual driving trajectories of each obstacle vehicle.
  • the deviation information between the historical expected driving trajectory of any obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle can be recorded as the deviation information of the obstacle vehicle.
  • the deviation information of each obstacle vehicle can be calculated by weighted average, weighted sum, etc. to obtain the historical deviation information, which can also be called the deviation of Bayesian equilibrium.
  • Step 207 determine a trial route based on the historical actual driving trajectory and historical deviation information of the autonomous driving vehicle.
  • the historical actual driving trajectory of the autonomous driving vehicle is a trial route corresponding to a time period before the current time period.
  • the autonomous driving vehicle can perform joint planning based on the historical actual driving trajectory of the autonomous driving vehicle and the historical deviation information to plan a first joint route for the current time period, wherein the first joint route includes the trial route.
  • step 207 includes steps 2071 to 2074 .
  • Step 2071 in response to the historical deviation information being less than the first threshold, determining at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle.
  • the first threshold is a set value.
  • the first threshold is a set value.
  • the historical deviation information is less than the first threshold, it means that the difference between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle is small, which meets the expectations of the autonomous driving vehicle.
  • the autonomous driving vehicle can obtain the driving intention of the autonomous driving vehicle by analyzing the historical actual driving trajectory of the autonomous driving vehicle. By analyzing the historical actual driving trajectory of the obstacle vehicle, the driving intention of the obstacle vehicle can be obtained, thereby obtaining the driving intention of all subjects in the environment where the autonomous driving vehicle is located, where all subjects include autonomous driving vehicles and obstacle vehicles. Based on the driving intentions of all subjects in the environment where the autonomous driving vehicle is located, at least one first candidate route for the obstacle vehicle and at least one first candidate route for the autonomous driving vehicle can be planned.
  • FIG. 5 is a schematic diagram of trajectory planning provided by an embodiment of the present application.
  • the autonomous driving vehicle is vehicle A, and the historical actual driving trajectory of vehicle A is A-m'; the obstacle vehicles include vehicle B and vehicle C, wherein the historical actual driving trajectory of vehicle B is B-m', and the historical actual driving trajectory of vehicle C is stationary.
  • vehicle A obtains that the driving intention of vehicle A is to move forward, and by analyzing B-m', the driving intention of vehicle B is also to move forward, and by analyzing the historical actual driving trajectory of vehicle C, the driving intention of vehicle C is to be stationary.
  • vehicle A can plan that the first candidate route of vehicle A includes A-m1 and A-m2, the first candidate route of vehicle B is B-m, and the first candidate route of vehicle C is stationary.
  • step 2071 includes: determining the trajectory point distribution information of the obstacle vehicle and the trajectory point distribution information of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle; for the target subject, generating multiple trajectory points of the target subject based on the trajectory point distribution information of the target subject, where the target subject is the obstacle vehicle or the autonomous driving vehicle; sampling multiple target trajectory points of the target subject from the multiple trajectory points of the target subject; and sampling multiple target trajectory points of the target subject based on the multiple trajectory points of the target subject.
  • the target trajectory point generates at least one first candidate route of the target body.
  • a sampling process is performed for multiple trajectory points of the target subject, thereby obtaining multiple target trajectory points of the target subject, and a first candidate route of the target subject is generated based on the multiple target trajectory points of the target subject.
  • multiple sampling processes are performed for multiple trajectory points of the target subject, and a first candidate route can be obtained through each sampling process, thereby generating multiple first candidate routes of the target subject. In this way, at least one first candidate route of the target subject can be obtained. That is, at least one first candidate route of the autonomous driving vehicle is obtained, and at least one first candidate route of the obstacle vehicle is obtained.
  • the driving intentions of all subjects in the environment can be determined by analyzing the historical actual driving trajectories of the autonomous driving vehicle and the historical actual driving trajectories of the obstacle vehicle. Based on the driving intentions of all subjects in the environment and the historical actual driving trajectories of the obstacle vehicle, the trajectory point distribution information of the obstacle vehicle can be determined, wherein the trajectory point distribution information of the obstacle vehicle can reflect the distribution satisfied by the trajectory points of the obstacle vehicle, for example, the trajectory points of the obstacle vehicle satisfy the Gaussian distribution.
  • the trajectory point distribution information of the autonomous driving vehicle can be determined, wherein the trajectory point distribution information of the autonomous driving vehicle can reflect the distribution satisfied by the trajectory points of the autonomous driving vehicle.
  • the obstacle vehicle is taken as the target subject, or the autonomous driving vehicle is taken as the target subject.
  • the target subject since the trajectory point distribution information of the target subject can reflect the distribution satisfied by the trajectory points of the target subject, multiple trajectory points of the target subject can be generated based on the trajectory point distribution information of the target subject, and the position information of these multiple trajectory points satisfies the distribution.
  • the first target trajectory point is sampled from the multiple trajectory points of the target subject based on the historical actual driving trajectory of the target subject, and the distance between the first target trajectory point and the last actual trajectory point in the historical actual driving trajectory is less than the distance threshold.
  • the next target trajectory point is sampled from the multiple trajectory points of the target subject based on the historical actual driving trajectory of the target subject and the sampled target trajectory points, and the distance between the next target trajectory point and the last target trajectory point sampled is less than the distance threshold, until the loop termination condition is reached.
  • the distance threshold is a settable value, and it can also be a value determined based on information such as the acceleration and speed of the target subject.
  • the time information of the target subject arriving at each target trajectory point is determined based on the unit time.
  • the difference between the time information of the target subject arriving at two adjacent target trajectory points is the unit time, such as at least one unit time.
  • the time information of the target subject arriving at each target trajectory point is determined. In this case, the difference between the time information of the target subject arriving at two adjacent target trajectory points, the distance between the two adjacent target trajectory points, the acceleration and speed of the target subject and other information satisfy the kinematic formula.
  • a first candidate route of the target subject includes multiple target trajectory points of the target subject and the time information of the target subject reaching each target trajectory point. In the above manner, at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle can be obtained.
  • Step 2072 Combine at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle to obtain at least one first combined route, wherein any first combined route includes a first candidate route of the obstacle vehicle and a first candidate route of the autonomous driving vehicle.
  • a first candidate route for the obstacle vehicle is randomly sampled from at least one first candidate route for the obstacle vehicle; a first candidate route for the autonomous driving vehicle is randomly sampled from at least one first candidate route for the autonomous driving vehicle.
  • the sampled first candidate route for the obstacle vehicle and the sampled first candidate route for the autonomous driving vehicle are regarded as the first combined route. In this way, at least one first combined route can be determined.
  • Step 2073 determining the recommended index for each first combination route.
  • a recommendation index function can be set, and the recommendation index function can evaluate the quality of any first combination route to obtain the recommendation index of the first combination route, that is, the recommendation index function is used to determine the recommendation index of the first combination route.
  • the recommendation index function when evaluating the quality of the first combination route, not only the efficiency of the first candidate route of the autonomous driving vehicle should be considered, but also the safety of the first candidate route of the obstacle vehicle should be evaluated with reference to the first candidate route of the obstacle vehicle.
  • the larger the recommendation index of the first combination route the better the first combination route is, and the better the balance between driving efficiency and driving safety when the autonomous driving vehicle moves based on the first candidate route of the autonomous driving vehicle in the first combination route.
  • the embodiment of the present application selects the first combination route with a larger recommendation index, the first combination route is better, and the first candidate route of the autonomous driving vehicle included in the first combination route is also better. If the autonomous driving vehicle moves according to the first candidate route of the autonomous driving vehicle, it can better balance the driving efficiency and driving safety of the autonomous driving vehicle.
  • step 2073 includes: determining parameter distribution information of a recommended index function based on the historical actual driving trajectory of the obstacle vehicle, the recommended index function being used to determine the recommended index of the first combined route; generating multiple candidate parameters of the recommended index function based on the parameter distribution information of the recommended index function; sampling target parameters of the recommended index function from the multiple candidate parameters of the recommended index function; and determining the recommended index of each first combined route based on the target parameters of the recommended index function.
  • the autonomous driving vehicle may first analyze the historical expected driving trajectory and the historical actual driving trajectory of the obstacle vehicle to determine the historical deviation information, wherein the method for determining the historical deviation information has been described above and will not be repeated here.
  • the parameter distribution information of the recommended index function is determined based on the value of the historical deviation information.
  • the parameter distribution information of the recommended index function can reflect the distribution satisfied by the parameters of the recommended index function, for example, the parameters of the recommended index function satisfy the Gaussian distribution.
  • the parameter distribution information of the recommended index function can reflect the distribution satisfied by the parameters of the recommended index function
  • multiple candidate parameters of the recommended index function can be generated based on the parameter distribution information of the recommended index function, and the values of the multiple candidate parameters satisfy the distribution.
  • the target parameter of the recommended index function is sampled from the multiple candidate parameters of the recommended index function.
  • the target parameter can be used to balance the driving safety and driving efficiency of the autonomous driving vehicle.
  • the target parameter of the recommended index function corresponding to the previous time period can be obtained.
  • the difference between the target parameter corresponding to the previous time period and the candidate parameter is calculated to obtain the difference corresponding to the candidate parameter.
  • the difference corresponding to each candidate parameter can be determined, and the candidate parameter corresponding to the difference that satisfies the difference condition is used as the target parameter of the recommended index function corresponding to the current time period.
  • the embodiment of the present application does not limit the difference that satisfies the difference condition.
  • the difference that satisfies the difference condition is the minimum difference.
  • the recommendation index function corresponding to the current time period may be determined, thereby determining the recommendation index of each first combination route using the recommendation index function of the current time period.
  • determining the recommended index of each first combination route based on the target parameter of the recommended index function includes: for any first combination route, obtaining at least one reference information of any first combination route, any reference information is any one of comfort, safety, speed of the autonomous driving vehicle, uncertainty, politeness and circulation, comfort is used to describe acceleration, safety is used to describe collision information, uncertainty is used to describe the concentration of trajectory points, politeness is used to describe the impact of the autonomous driving vehicle on the movement of the obstacle vehicle, and circulation is used to describe the average speed of vehicles in the environment where the autonomous driving vehicle is located; determining the recommended index of any first combination route based on each reference information of any first combination route and the target parameter of the recommended index function corresponding to each reference information (also referred to as each reference information).
  • any first combined route corresponds to at least one of reference information such as comfort, safety, speed of the autonomous driving vehicle, uncertainty, politeness, and circulation.
  • comfort is used to describe the acceleration of the autonomous driving vehicle and/or the obstacle vehicle.
  • the comfort includes the acceleration of the autonomous driving vehicle and the acceleration of the obstacle vehicle, or the comfort includes the jerk of the autonomous driving vehicle and the jerk of the obstacle vehicle.
  • the jerk here can be expressed by the first-order derivative of acceleration, that is, the second-order derivative of velocity, which refers to the acceleration of acceleration.
  • Safety is used to describe the collision information between the autonomous driving vehicle and the obstacle vehicle. Since the first combined route includes a first candidate route for the obstacle vehicle and a first candidate route for the autonomous driving vehicle, the autonomous driving vehicle can estimate the collision information between the autonomous driving vehicle and the obstacle vehicle based on the first candidate route for the autonomous driving vehicle and the first candidate route for the obstacle vehicle.
  • the collision information includes the collision time and the collision distance.
  • Uncertainty is used to describe the concentration of the trajectory points of the target subject, which is an obstacle vehicle or an autonomous driving vehicle. That is, uncertainty is used to describe the concentration of the trajectory points of the obstacle vehicle and/or the autonomous driving vehicle. The more concentrated the trajectory points are, the smaller the uncertainty is.
  • the trajectory point distribution information of the obstacle vehicle satisfies the Gaussian distribution
  • the trajectory point distribution information of the autonomous driving vehicle also satisfies the Gaussian distribution.
  • the sum of the variances or the average value of the two Gaussian distributions can be used as uncertainty.
  • the politeness level is used to describe the impact of the autonomous driving vehicle on the movement of the obstacle vehicle.
  • the first combined route includes a first candidate route for the obstacle vehicle and a first candidate route for the autonomous driving vehicle.
  • the politeness level can be determined based on the first candidate route for the obstacle vehicle and the first candidate route for the autonomous driving vehicle.
  • the politeness level is a parameter that measures the amplitude of the obstacle vehicle's movement.
  • the obstacle vehicle movement here refers to the movement performed by the obstacle vehicle to avoid collision with the autonomous driving vehicle.
  • the obstacle vehicle movement can be deceleration.
  • the politeness level can measure the amplitude of deceleration. Among them, the larger the amplitude of the obstacle vehicle's movement, the greater the politeness level.
  • the circulation degree is used to describe the average speed of vehicles in the environment of the autonomous vehicle. Therefore, the circulation degree of the autonomous vehicle can be calculated.
  • the average speed of the autonomous driving vehicles and the average speed of the obstacle vehicles are taken as the circulation degree.
  • the weighted sum of each reference information of the first combined route and the target parameter of the recommendation index function corresponding to each reference information is calculated to obtain the recommendation index of the first combined route.
  • the recommendation index of the first combined route comfort * coefficient 1 + safety * coefficient 2 + speed of the autonomous driving vehicle * coefficient 3 + uncertainty * coefficient 4 + politeness * coefficient 5 + circulation * coefficient 6.
  • coefficient 1 is the target parameter of the recommendation index function corresponding to comfort.
  • Coefficient 2 is the target parameter of the recommendation index function corresponding to safety.
  • Coefficient 3 is the target parameter of the recommendation index function corresponding to the speed of the autonomous driving vehicle.
  • Coefficient 4 is the target parameter of the recommendation index function corresponding to uncertainty.
  • Coefficient 5 is the target parameter of the recommendation index function corresponding to politeness.
  • Coefficient 6 is the target parameter of the recommendation index function corresponding to circulation.
  • Step 2074 Select a first combined route with a highest recommendation index from at least one first combined route, and use the first candidate route of the autonomous driving vehicle included in the first combined route with the highest recommendation index as a trial route.
  • At least one first combination route can be sorted in descending order according to the recommended index to obtain the sorted first combination routes.
  • the first sorted first combination route is used as the first joint route.
  • at least one first combination route can also be sorted in descending order according to the recommended index to obtain the sorted first combination routes.
  • the last sorted first combination route is used as the first joint route.
  • the first joint route includes a first candidate route for the obstacle vehicle and a first candidate route for the autonomous driving vehicle, wherein the first candidate route for the obstacle vehicle is the expected driving trajectory corresponding to the obstacle vehicle in the current time period, and the first candidate route for the autonomous driving vehicle is the trial route corresponding to the autonomous driving vehicle in the current time period.
  • meeting traffic rules includes that the autonomous driving vehicle and the obstacle vehicle on the road cannot collide, so there is no intersection between the trial route of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle.
  • meeting traffic rules includes taking the driving direction of the obstacle vehicle as the positive direction and the obstacle vehicle driving close to the right side of the road, so both the trial route of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle meet the requirement of being close to the right side of the road.
  • step 207 includes steps 2075 to 2077 .
  • Step 2075 In response to the historical deviation information being not less than the first threshold, obtaining at least one mapping relationship, any one of which is used to describe the mapping relationship between the driving trajectory set and the reference route, and the driving trajectory set includes at least one driving trajectory.
  • the autonomous driving vehicle can directly determine the trial route of the autonomous driving vehicle in the current time period.
  • the autonomous driving vehicle may be configured with at least one mapping relationship.
  • the autonomous driving vehicle may call each mapping relationship. Any mapping relationship is used to describe the mapping relationship between a driving trajectory set and a reference route, and the driving trajectory set includes at least one driving trajectory.
  • the mapping relationship is used to describe the mapping relationship between which driving trajectory set and the reference route, or in other words, which driving trajectory set and reference route the mapping relationship includes, then which driving trajectory set is the driving trajectory set corresponding to the mapping relationship, and which reference route is the reference route corresponding to the mapping relationship.
  • Step 2076 Select a target mapping relationship from at least one mapping relationship, in which the driving trajectory set matches the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle.
  • the autonomous driving vehicle can match each mapping relationship with a historical actual trajectory set, where the historical actual trajectory set includes the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle.
  • the mapping relationship is determined as the target mapping relationship.
  • the embodiment of the present application does not limit the way in which the driving trajectory set is matched with the historical actual trajectory set. Exemplarily, if each driving trajectory in the driving trajectory set is the same as each historical actual driving trajectory in the historical actual trajectory set, the driving trajectory set matches the historical actual trajectory set.
  • Step 2077 determine the reference route corresponding to the target mapping relationship as the trial route.
  • the target mapping relationship describes the mapping relationship between the driving trajectory set and the reference route.
  • the reference route corresponding to the target mapping relationship can be determined as the trial route of the autonomous driving vehicle.
  • the method further includes: determining at least one second candidate route of the obstacle vehicle based on the trial route and the historical actual driving trajectory of the obstacle vehicle; combining any second candidate route of the obstacle vehicle with the trial route to obtain any second candidate route of the obstacle vehicle; a second combination route; determining the recommended index of each second combination route, and selecting the second combination route with the highest recommended index from each second combination route.
  • the autonomous vehicle can obtain the driving intention of the autonomous vehicle by analyzing the trial route of the autonomous vehicle, and can obtain the driving intention of the obstacle vehicle by analyzing the historical actual driving trajectory of the obstacle vehicle, thereby obtaining the driving intention of all subjects in the environment where the autonomous vehicle is located. Based on the driving intention of all subjects in the environment, at least one second candidate route of the obstacle vehicle can be planned. Among them, the generation principle of the second candidate route of the obstacle vehicle is similar to the generation principle of the first candidate route of the target subject, which can be referred to the description in step 2071 and will not be repeated here.
  • a second candidate route for the obstacle vehicle is randomly sampled from at least one second candidate route for the obstacle vehicle.
  • the trial route of the autonomous driving vehicle and the sampled second candidate route for the obstacle vehicle are regarded as a second combined route. In this way, at least one second combined route can be determined.
  • the recommended index function can be used to determine the recommended index of the second combined route.
  • the larger the recommended index of the second combined route the better the second combined route.
  • the safety of the autonomous driving vehicle and the obstacle vehicle is higher.
  • the method for determining the recommended index of the second combined route is similar to the method for determining the recommended index of the first combined route. See the description in step 2073 above, which will not be repeated here.
  • At least one second combined route may be sorted in descending order according to the recommended index to obtain the sorted second combined routes.
  • the first sorted second combined route is used as the first joint route.
  • at least one second combined route may also be sorted in descending order according to the recommended index to obtain the sorted second combined routes.
  • the last sorted second combined route is used as the first joint route.
  • the first joint route includes a trial route of the obstacle vehicle and a second candidate route of the autonomous driving vehicle, and the second candidate route of the obstacle vehicle is the expected driving trajectory corresponding to the obstacle vehicle in the current time period.
  • Step 202 while the autonomous driving vehicle is driving along the trial route, obtain relevant information of the obstacle vehicle.
  • the autonomous driving vehicle may obtain a first combined route, which includes the trial route of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle.
  • the obstacle vehicle may be tentatively guided to move according to the expected driving trajectory of the obstacle vehicle, so that the obstacle vehicle may show the driving intention of the obstacle vehicle as soon as possible.
  • the autonomous driving vehicle is vehicle A
  • the trial route of the autonomous driving vehicle is A-m
  • the obstacle vehicle is vehicle B.
  • the autonomous driving vehicle is controlled to move according to A-m, so as to tentatively guide the obstacle vehicle to move according to the expected driving trajectory B-m1 of the obstacle vehicle.
  • the obstacle vehicle can express its driving intention more quickly, so that the autonomous driving vehicle can make decisions earlier and improve the driving safety of the autonomous driving vehicle.
  • the actual driving trajectory of the obstacle vehicle B in the current time period is B-m2, that is, the obstacle vehicle B first approaches the right side of itself from the middle of the road, then approaches the left side of itself, and then keeps going straight.
  • the autonomous driving vehicle A also needs to approach the left side of itself.
  • the autonomous driving vehicle A is controlled to move continuously according to A-m in the current time period.
  • the autonomous driving vehicle Even if the obstacle vehicle B approaches the left side of itself, the autonomous driving vehicle will not change the direction of movement, thereby avoiding the phenomenon that the autonomous driving vehicle is blocked in place due to blindly compromising with the obstacle vehicle, and the autonomous driving vehicle produces violent shaking, etc., and improves the movement efficiency and anti-noise performance of the autonomous driving vehicle.
  • the sensors of the autonomous driving vehicle can sense the actual position of the obstacle vehicle multiple times in the current time period, and the time of sensing each time can be obtained. Therefore, the autonomous driving vehicle can obtain the actual driving trajectory of the obstacle vehicle in the current time period, and the actual driving trajectory of the obstacle vehicle includes the position information of multiple actual trajectory points and the time information of the obstacle vehicle arriving at each actual trajectory point.
  • the actual driving trajectory of the obstacle vehicle is the relevant information of the obstacle vehicle.
  • Step 203 determining the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle.
  • the autonomous driving vehicle can determine the driving intention of the obstacle vehicle by analyzing its actual driving trajectory.
  • the driving intention of the obstacle vehicle reflects the movement trend of the obstacle vehicle. For example, if the obstacle vehicle tends to slow down and turn left, the driving intention of the obstacle vehicle can reflect the information of slowing down and turning left.
  • step 203 includes: determining the intention of the obstacle vehicle in the time dimension according to the relevant information of the obstacle vehicle; determining the intention of the obstacle vehicle in the space dimension according to the relevant information of the obstacle vehicle; and determining the intention of the obstacle vehicle in the time dimension and the intention of the obstacle vehicle in the space dimension as the driving intention of the obstacle vehicle.
  • the autonomous driving vehicle can determine the location of the obstacle vehicle by analyzing the actual driving trajectory of the obstacle vehicle.
  • the intention of the obstacle car in the time dimension can reflect the trend of the obstacle car's movement speed. In more popular terms, the intention of the obstacle car in the time dimension can reflect whether the obstacle car will accelerate, maintain a constant speed, or slow down.
  • the autonomous vehicle can determine the intention of the obstacle vehicle in the spatial dimension, and the intention of the obstacle vehicle in the spatial dimension can reflect the trend of the obstacle vehicle's movement direction.
  • the intention of the obstacle vehicle in the spatial dimension can reflect whether the obstacle vehicle will drive on the left side of the road or on the right side of the road next.
  • the intention of the obstacle vehicle in the time dimension and the intention of the obstacle vehicle in the space dimension can be combined to obtain the driving intention of the obstacle vehicle. Therefore, the driving intention of the obstacle vehicle can reflect the trend of the movement direction and movement speed of the obstacle vehicle. For example, the driving intention of the obstacle vehicle can reflect that the obstacle vehicle will accelerate and approach the left side of the road next. In this case, the obstacle vehicle will quickly approach the left side of the road; or, the driving intention of the obstacle vehicle can reflect that the obstacle vehicle will decelerate and approach the left side of the road next. In this case, the obstacle vehicle will slowly approach the left side of the road.
  • Step 204 performing autonomous driving decision planning for the autonomous driving vehicle at least based on the driving intention of the obstacle vehicle.
  • the autonomous driving vehicle can make autonomous driving decision planning according to the driving intention of the obstacle vehicle to plan a second joint route, which includes the trial route of the autonomous driving vehicle in the next time period and the expected driving trajectory of the obstacle vehicle in the next time period.
  • the second joint route is determined in a similar manner to the first joint route, which will not be described in detail here.
  • step 204 includes: in response to a change in the driving intention of the obstacle vehicle, determining a target driving route of the obstacle vehicle at least according to the driving intention of the obstacle vehicle; and determining a target driving route of the autonomous driving vehicle based on the target driving route of the obstacle vehicle.
  • the autonomous driving vehicle can obtain the driving intention of the obstacle vehicle in the historical time period, wherein the driving intention of the obstacle vehicle in the historical time period is obtained by analyzing the historical actual driving trajectory of the obstacle vehicle, and the historical time period is the time period before the current time period. By comparing the driving intention of the obstacle vehicle in the current time period with the driving intention of the obstacle vehicle in the historical time period, it is determined whether the driving intention of the obstacle vehicle in the current time period has changed.
  • the autonomous driving vehicle can compromise with the obstacle vehicle, and plan the driving route of the autonomous driving vehicle while ensuring that the obstacle vehicle drives according to its driving intention, so that the obstacle vehicle and the autonomous driving vehicle can move in cooperation to ensure driving safety. Therefore, the embodiment of the present application will first determine the target driving route of the obstacle vehicle according to the driving intention of the obstacle vehicle, so that the obstacle vehicle moves according to its target driving route and ensures that the obstacle vehicle drives according to its driving intention.
  • the autonomous driving vehicle determines the target driving route of the autonomous driving vehicle based on the target driving route of the obstacle vehicle, and the target driving route of the autonomous driving vehicle and the target driving route of the obstacle vehicle need to meet traffic rules to ensure that the autonomous driving vehicle and the obstacle vehicle can drive safely.
  • step 204 includes: in response to the obstacle vehicle's driving intention not changing, obtaining the distance between the autonomous driving vehicle and the obstacle vehicle; if the distance between the autonomous driving vehicle and the obstacle vehicle is less than a distance threshold, controlling the autonomous driving vehicle to stop driving.
  • a second joint route can be planned according to the driving intention of the obstacle vehicle.
  • the second joint route includes the trial route of the autonomous driving vehicle in the next time period and the expected driving trajectory of the obstacle vehicle in the next time period, so that the autonomous driving vehicle can drive according to the trial route in the next time period.
  • step 204 includes: performing autonomous driving decision planning for the autonomous driving vehicle based at least on the driving intention of the obstacle vehicle and the second combined route with the highest recommended index.
  • the first combined route is the second combined route with the highest recommendation index.
  • the second combined route with the highest recommendation index includes the trial route of the autonomous driving vehicle and a second candidate route of the obstacle vehicle.
  • the autonomous driving vehicle drives along its trial route while obtaining relevant information of the obstacle vehicle.
  • the trial route of the autonomous driving vehicle is the expected driving trajectory of the autonomous driving vehicle and also the actual driving trajectory of the autonomous driving vehicle.
  • the second candidate route of the vehicle is the expected driving trajectory of the obstacle vehicle, and the relevant information of the obstacle vehicle is the actual driving trajectory of the obstacle vehicle.
  • the autonomous driving vehicle can make autonomous driving decision planning for the autonomous driving vehicle according to the driving intention of the obstacle vehicle and the second combined route with the highest recommended index to plan the second combined route, which can refer to the determination method of the first combined route and will not be repeated here.
  • the autonomous driving vehicle performs autonomous driving decision planning for the autonomous driving vehicle at least based on the driving intention of the obstacle vehicle and the first combined route with the highest recommended index.
  • the first combined route with the highest recommended index includes the first candidate route of the obstacle vehicle and the first candidate route of the autonomous driving vehicle, the first candidate route of the obstacle vehicle is the expected driving trajectory of the obstacle vehicle, and the first candidate route of the autonomous driving vehicle is the trial route of the autonomous driving vehicle, which is also the actual driving trajectory of the autonomous driving vehicle.
  • the autonomous driving vehicle determines the first joint route corresponding to the current time period in the previous time period of the current time period.
  • the autonomous driving vehicle is controlled to move according to the trial route in the first joint route, obtain the actual driving trajectory of the obstacle vehicle, and determine the second joint route corresponding to the next time period of the current time period based on the expected driving trajectory of the obstacle vehicle in the first joint route and the actual driving trajectory of the obstacle vehicle.
  • the contents executed based on the first joint route in the current time period are repeatedly executed based on the second joint route.
  • FIG. 7 is a schematic diagram of the framework of an autonomous driving decision-making planning method provided in an embodiment of the present application.
  • the framework includes forward imitation and online estimation, wherein forward imitation is used to generate a joint route.
  • the joint route includes the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle, which can be collectively referred to as the expected driving trajectory.
  • the expected driving trajectory corresponding to the current time period is the first joint route mentioned above
  • the expected driving trajectory corresponding to the next time period is the second joint route mentioned above.
  • the autonomous driving vehicle may generate a first joint route in the previous time period of the current time period so that the autonomous driving vehicle moves according to the expected driving trajectory (i.e., the trial route) of the autonomous driving vehicle in the first joint route in the current time period.
  • the expected driving trajectory i.e., the trial route
  • the autonomous driving vehicle can obtain the expected driving trajectory corresponding to the previous time period (i.e. the historical expected driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the autonomous driving vehicle mentioned above), and on the other hand, the autonomous driving vehicle can observe the actual driving trajectory corresponding to the previous time period (i.e. the historical actual driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the autonomous driving vehicle mentioned above). Based on the expected driving trajectory and the actual driving trajectory, online estimation is performed to obtain the perfect Bayesian equilibrium error (i.e. the historical deviation information mentioned above).
  • the autonomous driving vehicle moves according to the historical expected driving trajectory of the autonomous driving vehicle, the difference between the historical expected driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the autonomous driving vehicle is small and can be ignored.
  • the historical expected driving trajectory of the autonomous driving vehicle is the historical actual driving trajectory of the autonomous driving vehicle.
  • the trajectory point distribution information of the obstacle vehicle and the trajectory point distribution information of the autonomous driving vehicle are calculated by the trajectory point distribution estimator, and the parameter distribution information of the reward function (i.e., the recommended indicator function mentioned above) is estimated by the reward parameter estimator.
  • multiple trajectory points of the obstacle vehicle can be generated based on the trajectory point distribution information of the obstacle vehicle, and a candidate route for the obstacle vehicle can be obtained by sampling the target trajectory points of the multiple trajectory points.
  • a candidate route for the autonomous driving vehicle can be obtained.
  • the reward function estimator generates multiple candidate parameters of the reward function based on the parameter distribution information of the reward function, and obtains the target parameters of the reward function by sampling from the multiple candidate parameters.
  • the recommended indicators of each combined route are determined based on the target parameters of the reward function, and the combined route with the highest recommended indicator is selected as the joint route corresponding to the current time period.
  • the expected driving trajectory of the autonomous driving vehicle can be determined based on the perfect Bayesian equilibrium error, the trajectory point distribution information of the obstacle vehicle can be calculated by the trajectory point distribution estimator, and the parameter distribution information of the reward function (i.e. the recommended indicator function mentioned above) can be estimated by the reward parameter estimator.
  • multiple trajectory points of the obstacle vehicle can be generated based on the trajectory point distribution information of the obstacle vehicle, and a candidate route for the obstacle vehicle can be obtained by sampling the target trajectory points of the multiple trajectory points.
  • a combined route generation (corresponding to the second combined route mentioned above) can be achieved.
  • the reward function estimator generates multiple candidate parameters of the reward function based on the parameter distribution information of the reward function, and obtains the target parameters of the reward function by sampling from the multiple candidate parameters.
  • the recommended indicators of each combined route are determined based on the target parameters of the reward function, and the combined route with the highest recommended indicator is selected as the current time cycle.
  • the corresponding joint route for the period is
  • the embodiment of the present application realizes that in the previous time period, based on the expected driving trajectory corresponding to the previous time period and the actual driving trajectory corresponding to the previous time period, the expected driving trajectory corresponding to the current time period is determined. Then, the autonomous driving vehicle moves in the current time period according to the expected driving trajectory of the autonomous driving vehicle corresponding to the current time period, and at the same time, observes the actual driving trajectories of the autonomous driving vehicle and the obstacle vehicle corresponding to the current time period.
  • the expected driving trajectory corresponding to the current time period and the actual driving trajectory corresponding to the current time period can be obtained, and in the current time period, based on the expected driving trajectory corresponding to the current time period and the actual driving trajectory corresponding to the current time period, the expected driving trajectory corresponding to the next time period (i.e., the second joint route) is determined.
  • Figure 8 is a schematic diagram of an autonomous driving decision-making plan provided by an embodiment of the present application.
  • the road includes obstacle vehicles A to C and an autonomous driving vehicle D.
  • the embodiment of the present application can plan that the expected driving trajectory of the autonomous driving vehicle is to drive on the left side of the road close to itself (as shown by the dotted line).
  • the autonomous driving vehicle tentatively moves according to the expected driving trajectory of the autonomous driving vehicle within a time period, and tracks the actual driving trajectory of obstacle vehicles A to C in real time.
  • the expected driving trajectory of the autonomous driving vehicle D in the next time period is determined based on the actual driving trajectory of obstacle vehicles A to C.
  • the autonomous vehicle D tentatively turns left and observes the reactions of the bicycles (i.e., obstacle vehicles A to C). Based on the reactions of the bicycles, it determines whether it is safe to continue turning left. If it is safe, it continues to turn left, thereby achieving safe driving.
  • the bicycles i.e., obstacle vehicles A to C.
  • the automatic driving decision-making planning method provided in the embodiment of the present application can be applied to any traffic scene, for example, it can be applied to narrow road scenes, scenes where the automatic driving vehicle identifies that the driving intention of the obstacle vehicle is to drive in the middle of the road, etc.
  • the narrow road scene is that the drivable width of the road is less than the width threshold, for example, the road is a secondary road or there are many vehicles parked on both sides of the road.
  • the obstacle vehicle will choose to drive on the left or right side of its own road, and for the obstacle vehicle driving in the middle of the road, the automatic driving vehicle can identify that the driving intention of the obstacle vehicle is to drive in the middle of the road.
  • the automatic driving vehicle A and the obstacle vehicle B are both driving towards each other in the middle of the road, and the movement trajectory of the obstacle vehicle B is approximately straight.
  • the automatic driving vehicle A can recognize that the obstacle vehicle B is driving in the middle of the road and driving towards the automatic driving vehicle A, but the automatic driving vehicle A cannot determine whether the obstacle vehicle B wants to drive on the left side of its own road (i.e., B-m1) or on the right side of its own road (i.e., B-m2).
  • the autonomous driving vehicle When the autonomous driving vehicle identifies the obstacle vehicle's driving intention as driving in the middle of the road, the autonomous driving vehicle will jointly plan the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle, find the best cooperation strategy for all subjects, and the autonomous driving vehicle will continue to move according to the expected driving trajectory of the autonomous driving vehicle within a time period.
  • the autonomous driving vehicle A will jointly plan the expected trajectory of the autonomous driving vehicle A as A-m2 and the expected driving trajectory of the obstacle vehicle B as B-m2, and the autonomous driving vehicle will continue to move according to A-m2 within a time period to induce the obstacle vehicle B to move close to B-m2.
  • the autonomous driving vehicle After the time period ends, if the actual driving trajectory of the obstacle vehicle is consistent with the expected driving trajectory of the obstacle vehicle, the autonomous driving vehicle will cooperate to complete the meeting based on the captured driving intention of the obstacle vehicle. If the actual driving trajectory of the obstacle vehicle is inconsistent with the expected driving trajectory of the obstacle vehicle, the autonomous driving vehicle needs to jointly plan the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle again to ensure the driving safety of the autonomous driving vehicle. For example, in Figure 3, the obstacle vehicle B is still moving straight, and the distance between the autonomous driving vehicle and the obstacle vehicle B is relatively close. Then the autonomous driving vehicle can jointly plan that the expected driving trajectory of the autonomous driving vehicle is a stationary trajectory, while the expected trajectory of the obstacle vehicle is a trajectory that drives on its left side.
  • the autonomous driving vehicle will continuously move according to the expected driving trajectory of the autonomous driving vehicle within a time period. After the time period ends, the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle will be jointly planned again according to the actual driving trajectory of the obstacle vehicle.
  • This control method will improve the planning efficiency of the joint route.
  • the feasible trajectory of the obstacle vehicle is reduced by half from the perspective of the autonomous driving vehicle; when the obstacle vehicle shows the intention of meeting the vehicle at the time level and the intention of meeting the vehicle at the space level at the same time, the feasible trajectory of the obstacle vehicle is reduced by 3/4.
  • the autonomous driving vehicle continuously moves according to the expected driving trajectory of the autonomous driving vehicle within a time period to guide the obstacle vehicle to show the driving intention as soon as possible, so as to reduce the feasible trajectory of the obstacle vehicle and increase the feasible trajectory of the autonomous driving vehicle.
  • the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle are jointly planned again according to the actual driving trajectory of the obstacle vehicle. This can not only improve the efficiency of joint planning and ensure real-time performance, but also increase the probability of the autonomous driving vehicle executing an efficient trajectory and improve the driving efficiency of the autonomous driving vehicle.
  • Data including but not limited to data for analysis, stored data, displayed data, etc.
  • signals are all authorized by the user or fully authorized by all parties, and the collection, use and processing of relevant data must comply with relevant laws, regulations and standards of relevant countries and regions.
  • relevant laws, regulations and standards of relevant countries and regions For example, the actual driving trajectory and expected driving trajectory involved in this application are all obtained with full authorization.
  • the autonomous driving vehicle when there is an obstacle vehicle in the environment where the autonomous driving vehicle is located, the autonomous driving vehicle is controlled to travel along the trial route, and the obstacle vehicle is guided to move by actively displaying the driving intention of the autonomous driving vehicle, so that the obstacle vehicle can display the driving intention of the obstacle vehicle as soon as possible.
  • the relevant information of the obstacle vehicle is obtained, and the driving intention of the obstacle vehicle is determined through the relevant information of the obstacle vehicle, so that the autonomous driving vehicle can capture the driving intention of the obstacle vehicle in advance.
  • the autonomous driving decision-making planning is carried out for the autonomous driving vehicle according to the driving intention of the obstacle vehicle, it not only improves the intelligence level of the autonomous driving vehicle, but also helps to improve the driving safety of the autonomous driving vehicle.
  • FIG9 is a schematic diagram of the structure of an automatic driving decision-making and planning device provided in an embodiment of the present application. As shown in FIG9 , the device includes:
  • the control module 901 is used to control the autonomous driving vehicle to drive along a trial route in response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located.
  • the obstacle vehicle refers to a vehicle that conflicts with the driving route of the autonomous driving vehicle, that is, the driving route of the obstacle vehicle conflicts with the driving route of the autonomous driving vehicle.
  • An acquisition module 902 is used to acquire relevant information of an obstacle vehicle while the autonomous driving vehicle is driving along the trial route;
  • a determination module 903 is used to determine the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle;
  • the planning module 904 is used to make an autonomous driving decision plan for the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle.
  • the device further includes:
  • the acquisition module 902 is further used to acquire the historical actual driving trajectory of the autonomous driving vehicle, the historical actual driving trajectory of the obstacle vehicle, and the historical expected driving trajectory of the obstacle vehicle.
  • the historical expected driving trajectory of the obstacle vehicle is estimated based on the driving route of the obstacle vehicle. For example, the historical expected driving trajectory of the obstacle vehicle is estimated by the autonomous driving vehicle based on the driving route of the obstacle vehicle.
  • the determination module 903 is further used to determine the historical deviation information based on the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle;
  • the determination module 903 is also used to determine a trial route based on the historical actual driving trajectory and historical deviation information of the autonomous driving vehicle.
  • the determination module 903 is used to determine, in response to the historical deviation information being less than a first threshold, at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle; combine at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle to obtain at least one first combined route, any first combined route including a first candidate route of the obstacle vehicle and a first candidate route of the autonomous driving vehicle; determine the recommended index of each first combined route; select the first combined route with the highest recommended index from the at least one first combined route, and use the first candidate route of the autonomous driving vehicle included in the first combined route with the highest recommended index as a trial route.
  • the determination module 903 is used to determine the trajectory point distribution information of the obstacle vehicle and the trajectory point distribution information of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle; for a target subject, generate multiple trajectory points of the target subject based on the trajectory point distribution information of the target subject, where the target subject is the obstacle vehicle or the autonomous driving vehicle; sample multiple target trajectory points of the target subject from the multiple trajectory points of the target subject; and generate at least one first candidate route of the target subject based on the multiple target trajectory points of the target subject. For example, one or more first candidate routes of the target subject are generated.
  • the determination module 903 is used to determine the parameter distribution information of the recommended index function based on the historical actual driving trajectory of the obstacle vehicle, and the recommended index function is used to determine the recommended index of the first combined route; based on the parameter distribution information of the recommended index function, generate multiple candidate parameters of the recommended index function; sample the target parameters of the recommended index function from the multiple candidate parameters of the recommended index function; and determine the recommended index of each first combined route based on the target parameters of the recommended index function.
  • the determination module 903 is used to obtain at least one reference information of any first combined route for any first combined route, where any reference information is any one of comfort, safety, speed of the autonomous driving vehicle, uncertainty, politeness, and circulation, where comfort is used to describe acceleration, safety is used to describe collision information, uncertainty is used to describe the concentration of trajectory points (the trajectory points are trajectory points of the target subject, and the target subject is the obstacle vehicle or the autonomous driving vehicle), politeness is used to describe the impact of the autonomous driving vehicle on the movement of the obstacle vehicle, and circulation is used to describe the average speed of vehicles in the environment where the autonomous driving vehicle is located; based on each of the first combined routes, The reference information and the target parameter of the recommendation index function corresponding to each reference information (also referred to as each reference information) determine the recommendation index of any first combination route.
  • comfort is used to describe acceleration
  • safety is used to describe collision information
  • uncertainty is used to describe the concentration of trajectory points (the trajectory points are trajectory points of the target subject, and the target subject is the obstacle vehicle or the autonomous driving vehicle)
  • the determination module 903 is used to obtain at least one mapping relationship in response to the historical deviation information being not less than a first threshold value, any one of which is used to describe the mapping relationship between a driving trajectory set and a reference route, the driving trajectory set including at least one driving trajectory; select a target mapping relationship from at least one mapping relationship that matches the driving trajectory set with the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle (or, select a target mapping relationship from at least one mapping relationship, the driving trajectory set corresponding to the target mapping relationship includes at least one driving trajectory that matches the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle); and determine the reference route corresponding to the target mapping relationship as a trial route.
  • the determination module 903 is further configured to determine at least one second candidate route of the obstacle vehicle based on the trial route and the historical actual driving trajectory of the obstacle vehicle; combine any second candidate route of the obstacle vehicle with the trial route to obtain any second combined route; determine a recommended index for each second combined route, and select a second combined route with the highest recommended index from each second combined route;
  • the planning module 904 is used to perform autonomous driving decision planning for the autonomous driving vehicle based on at least the driving intention of the obstacle vehicle and the second combined route with the highest recommended index.
  • the determination module 903 is used to determine, for any obstacle vehicle, deviation information between a historical expected driving trajectory of any obstacle vehicle and a historical actual driving trajectory of any obstacle vehicle; and determine historical deviation information based on the deviation information between the historical expected driving trajectory of each obstacle vehicle and the historical actual driving trajectory of each obstacle vehicle.
  • the historical expected driving trajectory of any obstacle vehicle includes expected trajectory points at multiple moments, and the historical actual driving trajectory of any obstacle vehicle includes actual trajectory points at multiple moments;
  • the determination module 903 is used to determine, for any moment, the distance between the expected trajectory point and the actual trajectory point corresponding to any moment based on the position information of the expected trajectory point at any moment and the position information of the actual trajectory point at any moment; and determine the deviation information between the historical expected driving trajectory of any obstacle vehicle and the historical actual driving trajectory of any obstacle vehicle based on the distance between the expected trajectory point and the actual trajectory point corresponding to each moment.
  • the determination module 903 is used to determine the intention of the obstacle vehicle in the time dimension according to the relevant information of the obstacle vehicle; determine the intention of the obstacle vehicle in the space dimension according to the relevant information of the obstacle vehicle; and determine the intention of the obstacle vehicle in the time dimension and the intention of the obstacle vehicle in the space dimension as the driving intention of the obstacle vehicle.
  • the planning module 904 is used to determine a target driving route of the obstacle vehicle at least according to the driving intention of the obstacle vehicle in response to a change in the driving intention of the obstacle vehicle; and determine a target driving route of the autonomous driving vehicle based on the target driving route of the obstacle vehicle.
  • the planning module 904 is used to obtain the distance between the autonomous driving vehicle and the obstacle vehicle in response to the obstacle vehicle's driving intention not changing; if the distance between the autonomous driving vehicle and the obstacle vehicle is less than a distance threshold, control the autonomous driving vehicle to stop driving.
  • the autonomous driving vehicle when there is an obstacle vehicle in the environment where the autonomous driving vehicle is located, the autonomous driving vehicle is controlled to travel along the trial route, and the obstacle vehicle is guided to move by actively displaying the driving intention of the autonomous driving vehicle, so that the obstacle vehicle can display the driving intention of the obstacle vehicle as soon as possible.
  • the relevant information of the obstacle vehicle is obtained, and the driving intention of the obstacle vehicle is determined through the relevant information of the obstacle vehicle, so that the autonomous driving vehicle can capture the driving intention of the obstacle vehicle in advance.
  • the autonomous driving decision-making planning is carried out for the autonomous driving vehicle according to the driving intention of the obstacle vehicle, it not only improves the intelligence level of the autonomous driving vehicle, but also helps to improve the driving safety of the autonomous driving vehicle.
  • the device provided in FIG. 9 above only uses the division of the above functional modules as an example to illustrate when implementing its functions.
  • the above functions can be assigned to different functional modules as needed, that is, the internal structure of the device is divided into different functional modules to complete all or part of the functions described above.
  • the device and method embodiments provided in the above embodiments belong to the same concept, and their specific implementation process is detailed in the method embodiment, which will not be repeated here.
  • FIG10 shows a block diagram of a terminal device 1000 provided by an exemplary embodiment of the present application.
  • the terminal device 1000 includes: a processor 1001 and a memory 1002 .
  • Processor 1001 may include one or more processing cores, such as a 4-core processor, an 8-core processor, etc.
  • Processor 1001 may be implemented in at least one of the following hardware forms: DSP (Digital Signal Processing), FPGA (Field-Programmable Gate Array), and PLA (Programmable Logic Array).
  • Processor 1001 may also include a main processor and a coprocessor.
  • the main processor is a processor for processing data in an awake state, also known as a CPU (Central Processing Unit); the coprocessor is a low-power processor for processing data in a standby state.
  • the processor 1001 may be integrated with a GPU (Graphics Processing Unit), which is responsible for rendering and drawing the content to be displayed on the display screen.
  • the processor 1001 may also include an AI (Artificial Intelligence) processor, which is used to process computing operations related to machine learning.
  • AI Artificial Intelligence
  • the memory 1002 may include one or more computer-readable storage media, which may be non-transitory. Non-transitory computer-readable storage media may also be referred to as non-transitory computer-readable storage media.
  • the memory 1002 may also include a high-speed random access memory, and a non-volatile memory, such as one or more disk storage devices, flash memory storage devices.
  • the non-transitory computer-readable storage medium in the memory 1002 is used to store at least one computer program, which is used to be executed by the processor 1001 to implement the autonomous driving decision planning method provided in the method embodiment of the present application.
  • the terminal device 1000 may further optionally include: a peripheral device interface 1003 and at least one peripheral device.
  • the processor 1001, the memory 1002 and the peripheral device interface 1003 may be connected via a bus or a signal line.
  • Each peripheral device may be connected to the peripheral device interface 1003 via a bus, a signal line or a circuit board.
  • the peripheral device includes: at least one of a radio frequency circuit 1004, a display screen 1005, a camera assembly 1006, an audio circuit 1007 and a power supply 1008.
  • the peripheral device interface 1003 may be used to connect at least one peripheral device related to I/O (Input/Output) to the processor 1001 and the memory 1002.
  • the processor 1001, the memory 1002, and the peripheral device interface 1003 are integrated on the same chip or circuit board; in some other embodiments, any one or two of the processor 1001, the memory 1002, and the peripheral device interface 1003 may be implemented on a separate chip or circuit board, which is not limited in this embodiment.
  • the radio frequency circuit 1004 is used to receive and transmit RF (Radio Frequency) signals, also known as electromagnetic signals.
  • the radio frequency circuit 1004 communicates with the communication network and other communication devices through electromagnetic signals.
  • the radio frequency circuit 1004 converts electrical signals into electromagnetic signals for transmission, or converts received electromagnetic signals into electrical signals.
  • the radio frequency circuit 1004 includes: an antenna system, an RF transceiver, one or more amplifiers, a tuner, an oscillator, a digital signal processor, a codec chipset, a user identity module card, and the like.
  • the radio frequency circuit 1004 can communicate with other terminals through at least one wireless communication protocol.
  • the wireless communication protocol includes, but is not limited to: the World Wide Web, a metropolitan area network, an intranet, various generations of mobile communication networks (2G, 3G, 4G and 5G), a wireless local area network and/or a WiFi (Wireless Fidelity) network.
  • the radio frequency circuit 1004 may also include circuits related to NFC (Near Field Communication), which is not limited in this application.
  • the display screen 1005 is used to display a UI (User Interface).
  • the UI may include graphics, text, icons, videos, and any combination thereof.
  • the display screen 1005 also has the ability to collect touch signals on the surface or above the surface of the display screen 1005.
  • the touch signal can be input as a control signal to the processor 1001 for processing.
  • the display screen 1005 can also be used to provide virtual buttons and/or virtual keyboards, also known as soft buttons and/or soft keyboards.
  • the display screen 1005 can be one, which is set on the front panel of the terminal device 1000; in other embodiments, the display screen 1005 can be at least two, which are respectively set on different surfaces of the terminal device 1000 or are folded; in other embodiments, the display screen 1005 can be a flexible display screen, which is set on the curved surface or folded surface of the terminal device 1000. Even, the display screen 1005 can also be set to a non-rectangular irregular shape, that is, a special-shaped screen.
  • the display screen 1005 can be made of materials such as LCD (Liquid Crystal Display) and OLED (Organic Light-Emitting Diode).
  • the camera assembly 1006 is used to capture images or videos.
  • the camera assembly 1006 includes a front camera and a rear camera.
  • the front camera is set on the front panel of the terminal, and the rear camera is set on the back of the terminal.
  • there are at least two rear cameras which are any one of a main camera, a depth of field camera, a wide-angle camera, and a telephoto camera, so as to realize the fusion of the main camera and the depth of field camera to realize the background blur function, the fusion of the main camera and the wide-angle camera to realize panoramic shooting and VR (Virtual Reality) shooting function or other fusion shooting functions.
  • the camera assembly 1006 may also include a flash.
  • the audio circuit 1007 may include a microphone and a speaker.
  • the microphone is used to collect sound waves from the user and the environment, and convert the sound waves into electrical signals and input them into the processor 1001 for processing, or input them into the RF circuit 1004 to achieve voice communication.
  • the microphone may also be an array microphone or an omnidirectional acquisition microphone.
  • the speaker is used to convert the electrical signals from the processor 1001 or the RF circuit 1004 into sound waves.
  • the audio circuit 1007 may also include a headphone jack.
  • the power supply 1008 is used to supply power to various components in the terminal device 1000.
  • the power supply 1008 may be an alternating current, a direct current, a disposable battery, or a rechargeable battery.
  • the rechargeable battery may be a wired rechargeable battery or a wireless rechargeable battery.
  • the terminal device 1000 further includes one or more sensors 1009 .
  • the one or more sensors 1009 include, but are not limited to: an acceleration sensor 1011 , a gyroscope sensor 1012 , a pressure sensor 1013 , an optical sensor 1014 , and a proximity sensor 1015 .
  • the acceleration sensor 1011 can detect the magnitude of acceleration on the three coordinate axes of the coordinate system established by the terminal device 1000.
  • the acceleration sensor 1011 can be used to detect the components of gravity acceleration on the three coordinate axes.
  • the processor 1001 can control the display screen 1005 to display the user interface in a horizontal view or a vertical view according to the gravity acceleration signal collected by the acceleration sensor 1011.
  • the acceleration sensor 1011 can also be used for collecting game or user motion data.
  • the gyro sensor 1012 can detect the body direction and rotation angle of the terminal device 1000, and the gyro sensor 1012 can cooperate with the acceleration sensor 1011 to collect the user's 3D actions on the terminal device 1000.
  • the processor 1001 can implement the following functions based on the data collected by the gyro sensor 1012: motion sensing (such as changing the UI according to the user's tilt operation), image stabilization during shooting, game control, and inertial navigation.
  • the pressure sensor 1013 can be set on the side frame of the terminal device 1000 and/or the lower layer of the display screen 1005.
  • the processor 1001 performs left and right hand recognition or shortcut operations according to the holding signal collected by the pressure sensor 1013.
  • the processor 1001 controls the operability controls on the UI interface according to the user's pressure operation on the display screen 1005.
  • the operability controls include at least one of a button control, a scroll bar control, an icon control, and a menu control.
  • the optical sensor 1014 is used to collect the ambient light intensity.
  • the processor 1001 can control the display brightness of the display screen 1005 according to the ambient light intensity collected by the optical sensor 1014. Specifically, when the ambient light intensity is high, the display brightness of the display screen 1005 is increased; when the ambient light intensity is low, the display brightness of the display screen 1005 is reduced.
  • the processor 1001 can also dynamically adjust the shooting parameters of the camera assembly 1006 according to the ambient light intensity collected by the optical sensor 1014.
  • the proximity sensor 1015 also called a distance sensor, is usually arranged on the front panel of the terminal device 1000.
  • the proximity sensor 1015 is used to collect the distance between the user and the front of the terminal device 1000.
  • the processor 1001 controls the display screen 1005 to switch from the screen-on state to the screen-off state; when the proximity sensor 1015 detects that the distance between the user and the front of the terminal device 1000 is gradually increasing, the processor 1001 controls the display screen 1005 to switch from the screen-off state to the screen-on state.
  • FIG. 10 does not limit the terminal device 1000 and may include more or fewer components than shown in the figure, or combine certain components, or adopt a different component arrangement.
  • FIG11 is a schematic diagram of the structure of the server provided in the embodiment of the present application.
  • the server 1100 may have relatively large differences due to different configurations or performances, and may include one or more processors 1101 and one or more memories 1102, wherein the one or more memories 1102 store at least one computer program, and the at least one computer program is loaded and executed by the one or more processors 1101 to implement the automatic driving decision planning method provided by the above-mentioned various method embodiments.
  • the processor 1101 is a CPU.
  • the server 1100 may also have components such as a wired or wireless network interface, a keyboard, and an input and output interface for input and output.
  • the server 1100 may also include other components for implementing device functions, which will not be described in detail here.
  • a non-temporary computer-readable storage medium in which at least one computer program is stored.
  • the at least one computer program is loaded and executed by a processor to enable the autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
  • the above-mentioned non-temporary computer-readable storage medium can be a read-only memory (ROM), a random access memory (RAM), a compact disc (CD-ROM), a magnetic tape, a floppy disk, an optical data storage device, etc.
  • ROM read-only memory
  • RAM random access memory
  • CD-ROM compact disc
  • magnetic tape a magnetic tape
  • floppy disk a magnetic tape
  • optical data storage device etc.
  • a computer program in which at least one computer instruction is stored, and the at least one computer instruction is loaded and executed by a processor to enable an autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
  • a computer program or a computer program product is also provided, in which at least one computer program is stored, and the at least one computer program is loaded and executed by a processor to enable an autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Traffic Control Systems (AREA)

Abstract

An autonomous driving decision planning method: in response to the existence of an obstacle vehicle in the environment of an autonomous vehicle, controlling the autonomous vehicle to drive according to a heuristic route; in the process of the autonomous vehicle driving according to the heuristic route, obtaining related information of the obstacle vehicle; according to the related information of the obstacle vehicle, determining a driving intention of the obstacle vehicle; and at least according to the driving intention of the obstacle vehicle, performing autonomous driving decision planning on the autonomous vehicle.

Description

自动驾驶决策规划及自动驾驶车辆Autonomous driving decision planning and autonomous driving vehicles
本申请要求于2022年10月24日提交的申请号为202211303615.2、申请名称为“自动驾驶决策规划方法及自动驾驶车辆”的中国专利申请的优先权,其全部内容通过引用结合在本申请中。This application claims priority to the Chinese patent application with application number 202211303615.2, filed on October 24, 2022, and application name “Autonomous driving decision planning method and autonomous driving vehicle”, the entire contents of which are incorporated by reference into this application.
技术领域Technical Field
本申请实施例涉及自动驾驶技术领域,特别涉及自动驾驶决策规划及自动驾驶车辆。The embodiments of the present application relate to the field of autonomous driving technology, and in particular to autonomous driving decision planning and autonomous driving vehicles.
背景技术Background technique
随着计算机的不断发展,越来越多的车辆配置有传感器、控制器、执行器等器件,使得汽车可以感知周围、内部的环境信息。通过对环境信息进行分析,可以实现控制汽车在不同路况中进行自动驾驶,这类可以自动驾驶的汽车也称为自动驾驶车辆。With the continuous development of computers, more and more vehicles are equipped with sensors, controllers, actuators and other devices, which enable cars to perceive the surrounding and internal environmental information. By analyzing the environmental information, it is possible to control the car to drive automatically in different road conditions. Such cars that can drive automatically are also called autonomous vehicles.
相关技术中,自动驾驶车辆可以获取人工设定的行驶路线,并按照人工设定的行驶路线进行运动。In related technologies, an autonomous driving vehicle can obtain a manually set driving route and move according to the manually set driving route.
发明内容Summary of the invention
本申请提供了一种自动驾驶决策规划及自动驾驶车辆,所述技术方案包括如下内容。The present application provides an autonomous driving decision-making plan and an autonomous driving vehicle, and the technical solution includes the following contents.
一方面,提供了一种自动驾驶决策规划方法,所述方法包括:On the one hand, a method for autonomous driving decision planning is provided, the method comprising:
响应于自动驾驶车辆所处环境中存在障碍车,控制所述自动驾驶车辆按照试探路线进行行驶,所述障碍车的行驶路线与所述自动驾驶车辆的行驶路线存在冲突;In response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located, controlling the autonomous driving vehicle to travel along a trial route, wherein the driving route of the obstacle vehicle conflicts with the driving route of the autonomous driving vehicle;
在所述自动驾驶车辆按照所述试探路线进行行驶的过程中,获取所述障碍车的相关信息;While the autonomous driving vehicle is driving along the trial route, obtaining relevant information of the obstacle vehicle;
根据所述障碍车的相关信息确定所述障碍车的行驶意图;Determining the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle;
至少根据所述障碍车的行驶意图对所述自动驾驶车辆进行自动驾驶决策规划。The autonomous driving decision planning is performed on the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle.
另一方面,提供了一种自动驾驶决策规划装置,所述装置包括:In another aspect, an automatic driving decision-making planning device is provided, the device comprising:
控制模块,用于响应于自动驾驶车辆所处环境中存在障碍车,控制所述自动驾驶车辆按照试探路线进行行驶,所述障碍车的行驶路线与所述自动驾驶车辆的行驶路线存在冲突;a control module, configured to control the autonomous driving vehicle to travel along a trial route in response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located, wherein the route of the obstacle vehicle conflicts with the route of the autonomous driving vehicle;
获取模块,用于在所述自动驾驶车辆按照所述试探路线进行行驶的过程中,获取所述障碍车的相关信息;An acquisition module, used for acquiring relevant information of the obstacle vehicle during the process of the autonomous driving vehicle driving along the trial route;
确定模块,用于根据所述障碍车的相关信息确定所述障碍车的行驶意图;A determination module, used to determine the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle;
规划模块,用于至少根据所述障碍车的行驶意图对所述自动驾驶车辆进行自动驾驶决策规划。A planning module is used to perform autonomous driving decision planning for the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle.
另一方面,提供了一种自动驾驶车辆,所述自动驾驶车辆包括处理器和存储器,所述存储器中存储有至少一条计算机程序,所述至少一条计算机程序由所述处理器加载并执行,以使所述自动驾驶车辆实现上述所述的自动驾驶决策规划方法。On the other hand, an autonomous driving vehicle is provided, which includes a processor and a memory, wherein the memory stores at least one computer program, and the at least one computer program is loaded and executed by the processor so that the autonomous driving vehicle implements the above-mentioned autonomous driving decision planning method.
另一方面,还提供了一种非临时性计算机可读存储介质,所述非临时性计算机可读存储介质中存储有至少一条计算机程序,所述至少一条计算机程序由处理器加载并执行,以使自动驾驶车辆实现上述任一所述的自动驾驶决策规划方法。On the other hand, a non-temporary computer-readable storage medium is also provided, in which at least one computer program is stored, and the at least one computer program is loaded and executed by a processor to enable the autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
另一方面,还提供了一种计算机程序,所述计算机程序中存储有至少一条计算机指令,所述至少一条计算机指令由处理器加载并执行,以使自动驾驶车辆实现上述任一种自动驾驶决策规划方法。On the other hand, a computer program is also provided, in which at least one computer instruction is stored, and the at least one computer instruction is loaded and executed by a processor to enable an autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
另一方面,还提供了一种计算机程序产品,所述计算机程序产品中存储有至少一条计算机程序,所述至少一条计算机程序由处理器加载并执行,以使自动驾驶车辆实现上述任一种自动驾驶决策规划方法。On the other hand, a computer program product is also provided, in which at least one computer program is stored, and the at least one computer program is loaded and executed by a processor to enable an autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
本申请提供的技术方案至少带来如下有益效果:The technical solution provided by this application brings at least the following beneficial effects:
本申请提供的技术方案中,当自动驾驶车辆所处环境中存在障碍车时,控制自动驾驶车辆按照试探路线进行行驶,通过主动展示自动驾驶车辆的行驶意图来引导障碍车运动,以使障碍车尽快展示障碍车的行驶意图。在自动驾驶车辆按照试探路线进行行驶的过程中,获取 障碍车的相关信息,并通过障碍车的相关信息确定障碍车的行驶意图,使得自动驾驶车辆能够提早捕捉到障碍车的行驶意图。在根据障碍车的行驶意图对自动驾驶车辆进行自动驾驶决策规划时,不仅提高了自动驾驶车辆的智能化程度,还有利于提高自动驾驶车辆的行车安全性。In the technical solution provided by this application, when there is an obstacle vehicle in the environment where the autonomous driving vehicle is located, the autonomous driving vehicle is controlled to drive along the trial route, and the obstacle vehicle is guided to move by actively showing the driving intention of the autonomous driving vehicle, so that the obstacle vehicle can show the driving intention of the obstacle vehicle as soon as possible. The relevant information of the obstacle vehicle is used to determine the driving intention of the obstacle vehicle, so that the autonomous driving vehicle can capture the driving intention of the obstacle vehicle in advance. When the autonomous driving vehicle makes autonomous driving decision-making plans based on the driving intention of the obstacle vehicle, it not only improves the intelligence level of the autonomous driving vehicle, but also helps to improve the driving safety of the autonomous driving vehicle.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.
图1是本申请实施例提供的一种自动驾驶决策规划方法的实施环境示意图;FIG1 is a schematic diagram of an implementation environment of an autonomous driving decision-making planning method provided in an embodiment of the present application;
图2是本申请实施例提供的一种自动驾驶决策规划方法的流程图;FIG2 is a flow chart of an autonomous driving decision-making planning method provided by an embodiment of the present application;
图3是本申请实施例提供的一种空间层面的会车示意图;FIG3 is a schematic diagram of a space-level vehicle meeting provided by an embodiment of the present application;
图4是本申请实施例提供的一种时间层面的会车示意图;FIG4 is a schematic diagram of a time-level vehicle meeting provided by an embodiment of the present application;
图5是本申请实施例提供的一种轨迹规划的示意图;FIG5 is a schematic diagram of a trajectory planning provided in an embodiment of the present application;
图6是本申请实施例提供的一种车辆运动的示意图;FIG6 is a schematic diagram of a vehicle motion provided by an embodiment of the present application;
图7是本申请实施例提供的一种自动驾驶决策规划方法的框架示意图;FIG7 is a schematic diagram of a framework of an autonomous driving decision-making planning method provided in an embodiment of the present application;
图8是本申请实施例提供的一种自动驾驶决策规划示意图;FIG8 is a schematic diagram of an autonomous driving decision-making plan provided in an embodiment of the present application;
图9是本申请实施例提供的一种自动驾驶决策规划装置的结构示意图;FIG9 is a schematic diagram of the structure of an automatic driving decision-making and planning device provided in an embodiment of the present application;
图10是本申请实施例提供的一种终端设备的结构示意图;FIG10 is a schematic diagram of the structure of a terminal device provided in an embodiment of the present application;
图11是本申请实施例提供的一种服务器的结构示意图。FIG. 11 is a schematic diagram of the structure of a server provided in an embodiment of the present application.
具体实施方式Detailed ways
为使本申请的目的、技术方案和优点更加清楚,下面将结合附图对本申请实施方式作进一步地详细描述。In order to make the objectives, technical solutions and advantages of the present application more clear, the implementation methods of the present application will be further described in detail below with reference to the accompanying drawings.
图1是本申请实施例提供的一种自动驾驶决策规划方法的实施环境示意图,如图1所示,该实施环境包括终端设备101和服务器102。本申请实施例提供的自动驾驶决策规划方法可以由终端设备101执行,也可以由服务器102执行,或者由终端设备101和服务器102共同执行。其中,终端设备101和服务器102中的至少一项可以部署在自动驾驶车辆中,由自动驾驶车辆执行本申请实施例提供的自动驾驶决策规划方法。自动驾驶车辆可以是自动汽车、自动电动车、无人机、机器人等可以自动行驶的主体。FIG1 is a schematic diagram of an implementation environment of an autonomous driving decision-making planning method provided in an embodiment of the present application. As shown in FIG1 , the implementation environment includes a terminal device 101 and a server 102. The autonomous driving decision-making planning method provided in an embodiment of the present application can be executed by the terminal device 101, or by the server 102, or by the terminal device 101 and the server 102. Among them, at least one of the terminal device 101 and the server 102 can be deployed in an autonomous driving vehicle, and the autonomous driving decision-making planning method provided in an embodiment of the present application is executed by the autonomous driving vehicle. The autonomous driving vehicle can be an automatic car, an automatic electric car, a drone, a robot, or other subject that can travel automatically.
终端设备101可以是智能手机、游戏主机、台式计算机、平板电脑、膝上型便携计算机、智能电视、智能车载设备、智能语音交互设备、智能家电等。服务器102可以为一台服务器,或者为多台服务器组成的服务器集群,或者为云计算平台和虚拟化中心中的任意一种,本申请实施例对此不加以限定。服务器102可以与终端设备101通过有线网络或无线网络进行通信连接。服务器102可以具有数据处理、数据存储以及数据收发等功能,在本申请实施例中不加以限定。终端设备101和服务器102的数量不受限制,可以是一个或多个。The terminal device 101 can be a smart phone, a game console, a desktop computer, a tablet computer, a laptop computer, a smart TV, a smart car device, an intelligent voice interaction device, a smart home appliance, etc. The server 102 can be a single server, or a server cluster consisting of multiple servers, or any one of a cloud computing platform and a virtualization center, which is not limited in the embodiments of the present application. The server 102 can be connected to the terminal device 101 through a wired network or a wireless network. The server 102 can have functions such as data processing, data storage, and data transmission and reception, which are not limited in the embodiments of the present application. The number of terminal devices 101 and servers 102 is not limited and can be one or more.
在自动驾驶技术领域中,自动驾驶车辆可以获取人工设定的行驶路线,并控制自动驾驶车辆按照人工设定的行驶路线进行运动。该自动驾驶决策规划方式较为简单,难以应对复杂的实际交通场景,智能化程度低,导致自动驾驶车辆的行车安全性较差。In the field of autonomous driving technology, autonomous driving vehicles can obtain manually set driving routes and control the autonomous driving vehicles to move along the manually set driving routes. This autonomous driving decision-making and planning method is relatively simple and difficult to cope with complex actual traffic scenarios. It has a low degree of intelligence, resulting in poor driving safety of autonomous driving vehicles.
本申请实施例提供了一种自动驾驶决策规划方法,该方法可应用于上述实施环境中,能够提高自动驾驶车辆的行车安全性。以图2所示的本申请实施例提供的一种自动驾驶决策规划方法的流程图为例,该方法可由自动驾驶车辆来执行。比如,由部署有终端设备和服务器中的至少一项的自动驾驶车辆来执行。如图2所示,该方法包括如下步骤。The embodiment of the present application provides an autonomous driving decision-making planning method, which can be applied to the above-mentioned implementation environment and can improve the driving safety of the autonomous driving vehicle. Taking the flowchart of an autonomous driving decision-making planning method provided by the embodiment of the present application shown in Figure 2 as an example, the method can be executed by an autonomous driving vehicle. For example, it is executed by an autonomous driving vehicle deployed with at least one of a terminal device and a server. As shown in Figure 2, the method includes the following steps.
步骤201,响应于自动驾驶车辆所处环境中存在障碍车,控制自动驾驶车辆按照试探路线进行行驶,障碍车是指与自动驾驶车辆的行驶路线存在冲突的车辆。Step 201, in response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located, controlling the autonomous driving vehicle to travel along a trial route, where the obstacle vehicle refers to a vehicle that conflicts with the driving route of the autonomous driving vehicle.
在一些实施方式中,自动驾驶车辆上配置有至少一种传感器,传感器包括但不限于温度传感器、红外传感器、图像传感器等。每一种传感器对应一个感知范围,自动驾驶车辆所处的环境指的是自动驾驶车辆上配置的各种传感器的感知范围。In some embodiments, the autonomous driving vehicle is equipped with at least one sensor, including but not limited to a temperature sensor, an infrared sensor, an image sensor, etc. Each sensor corresponds to a sensing range, and the environment in which the autonomous driving vehicle is located refers to the sensing range of various sensors configured on the autonomous driving vehicle.
通过自动驾驶车辆上配置的各种传感器,自动驾驶车辆可以感知到自动驾驶车辆所处环境中所有的车辆。当这些车辆中存在障碍车时,自动驾驶车辆可以规划出试探路线,并按照试探路线进行行驶。其中,障碍车的行驶路线与自动驾驶车辆的行驶路线存在冲突。障碍车 的行驶方向可以和自动驾驶车辆的行驶方向相同,也可以和自动驾驶车辆的行驶方向相反,即障碍车和自动驾驶车辆可以同向行驶,也可以反向行驶。Through the various sensors configured on the autonomous vehicle, the autonomous vehicle can sense all the vehicles in the environment where the autonomous vehicle is located. When there is an obstacle vehicle among these vehicles, the autonomous vehicle can plan a trial route and drive along the trial route. Among them, the driving route of the obstacle vehicle conflicts with the driving route of the autonomous vehicle. The driving direction of the obstacle vehicle can be the same as that of the autonomous driving vehicle, or it can be opposite to the driving direction of the autonomous driving vehicle. That is, the obstacle vehicle and the autonomous driving vehicle can travel in the same direction or in opposite directions.
可选地,自动驾驶车辆可以基于自动驾驶车辆的行驶路线和自动驾驶车辆所处环境中任一车辆的行驶路线,确定自动驾驶车辆和任一车辆的预计碰撞时间。若预计碰撞时间小于时间阈值,则确定任一车辆为障碍车。由于障碍车和自动驾驶车辆的预计碰撞时间小于时间阈值,说明障碍车和自动驾驶车辆会在时间阈值内发生碰撞,因此,障碍车的行驶路线和自动驾驶车辆的行驶路线存在冲突。Optionally, the autonomous driving vehicle may determine the estimated collision time between the autonomous driving vehicle and any vehicle based on the driving route of the autonomous driving vehicle and the driving route of any vehicle in the environment where the autonomous driving vehicle is located. If the estimated collision time is less than the time threshold, then any vehicle is determined to be an obstacle vehicle. Since the estimated collision time between the obstacle vehicle and the autonomous driving vehicle is less than the time threshold, it means that the obstacle vehicle and the autonomous driving vehicle will collide within the time threshold, and therefore, there is a conflict between the driving route of the obstacle vehicle and the driving route of the autonomous driving vehicle.
在一种可能的实现方式中,步骤201之前还包括步骤205至步骤207。In a possible implementation, step 205 to step 207 are included before step 201 .
步骤205,获取自动驾驶车辆的历史实际行驶轨迹、障碍车的历史实际行驶轨迹和障碍车的历史期望行驶轨迹,障碍车的历史期望行驶轨迹根据障碍车的行驶路线预估得到。Step 205, obtaining the historical actual driving trajectory of the autonomous driving vehicle, the historical actual driving trajectory of the obstacle vehicle, and the historical expected driving trajectory of the obstacle vehicle, wherein the historical expected driving trajectory of the obstacle vehicle is estimated based on the driving route of the obstacle vehicle.
示例性地,障碍车的历史期望行驶轨迹是自动驾驶车辆根据障碍车的行驶路线预估得到的。或者,障碍车的历史期望行驶轨迹由自动驾驶车辆之外的其他设备根据障碍车的行驶路线预估得到。比如,自动驾驶车辆部署有终端设备,自动驾驶车辆之外的其他设备包括但不限于服务器,终端设备或者障碍车向服务器上报障碍车的行驶路线,从而由服务器根据障碍车的行驶路线预估得到障碍车的历史期望行驶轨迹。Exemplarily, the historical expected driving trajectory of the obstacle vehicle is estimated by the autonomous driving vehicle based on the driving route of the obstacle vehicle. Alternatively, the historical expected driving trajectory of the obstacle vehicle is estimated by other devices other than the autonomous driving vehicle based on the driving route of the obstacle vehicle. For example, the autonomous driving vehicle is deployed with a terminal device, and other devices other than the autonomous driving vehicle include but are not limited to a server. The terminal device or the obstacle vehicle reports the driving route of the obstacle vehicle to the server, so that the server estimates the historical expected driving trajectory of the obstacle vehicle based on the driving route of the obstacle vehicle.
可以理解的是,本申请实施例对自动驾驶车辆进行自动驾驶决策规划是一个持续性的过程,因此,可以采用周期性的方式,对自动驾驶车辆进行自动驾驶决策规划,以实现对自动驾驶车辆进行周期性的控制。本申请实施例中,自动驾驶车辆可以将当前时间周期的上一时间周期或者上几个时间周期对应的试探路线确定为自动驾驶车辆的历史期望行驶轨迹。由于当前时间周期内自动驾驶车辆按照当前时间周期对应的试探路线进行行驶,因此,自动驾驶车辆的实际行驶路线和试探路线相同,因此,可以认为在当前时间周期之前的时间周期(即当前时间周期的上一时间周期或者上几个时间周期)内,自动驾驶车辆也按照之前的时间周期对应的试探路线进行行驶,因而自动驾驶车辆的历史实际行驶轨迹和之前的时间周期对应的试探路线相同。由于可以将之前的时间周期对应的试探路线确定为自动驾驶车辆的历史期望行驶轨迹,且自动驾驶车辆的历史实际行驶轨迹和之前的时间周期对应的试探路线相同,因而可以认为自动驾驶车辆的历史期望行驶轨迹也是自动驾驶车辆的历史实际行驶轨迹。It can be understood that the automatic driving decision planning for the automatic driving vehicle in the embodiment of the present application is a continuous process. Therefore, the automatic driving decision planning for the automatic driving vehicle can be carried out in a periodic manner to achieve periodic control of the automatic driving vehicle. In the embodiment of the present application, the automatic driving vehicle can determine the trial route corresponding to the previous time period or the previous several time periods of the current time period as the historical expected driving trajectory of the automatic driving vehicle. Since the automatic driving vehicle drives according to the trial route corresponding to the current time period in the current time period, the actual driving route of the automatic driving vehicle is the same as the trial route. Therefore, it can be considered that in the time period before the current time period (i.e., the previous time period or the previous several time periods of the current time period), the automatic driving vehicle also drives according to the trial route corresponding to the previous time period, so the historical actual driving trajectory of the automatic driving vehicle is the same as the trial route corresponding to the previous time period. Since the trial route corresponding to the previous time period can be determined as the historical expected driving trajectory of the automatic driving vehicle, and the historical actual driving trajectory of the automatic driving vehicle is the same as the trial route corresponding to the previous time period, it can be considered that the historical expected driving trajectory of the automatic driving vehicle is also the historical actual driving trajectory of the automatic driving vehicle.
由于自动驾驶车辆配置有传感器,因此,自动驾驶车辆可以通过传感器感知得到障碍车的实际行驶轨迹。自动驾驶车辆可以将当前时间周期的上一个时间周期或者上几个时间周期对应的障碍车的实际行驶轨迹作为障碍车的历史实际行驶轨迹。也就是说,障碍车的历史实际行驶轨迹是自动驾驶车辆在当前时间周期之前的时间周期内感知得到的障碍车的实际行驶轨迹。Since the autonomous driving vehicle is equipped with sensors, the autonomous driving vehicle can sense the actual driving trajectory of the obstacle vehicle through the sensors. The autonomous driving vehicle can use the actual driving trajectory of the obstacle vehicle corresponding to the previous time period or the previous several time periods of the current time period as the historical actual driving trajectory of the obstacle vehicle. In other words, the historical actual driving trajectory of the obstacle vehicle is the actual driving trajectory of the obstacle vehicle sensed by the autonomous driving vehicle in the time period before the current time period.
需要说明的是,在当前时间周期内,自动驾驶车辆的传感器可以多次感知障碍车的实际位置,在每次感知到实际位置时,可以记录感知时间(即感知到实际位置时的时间)。因此,障碍车的历史实际行驶轨迹包括多个实际轨迹点的位置信息和障碍车到达各个实际轨迹点的时间信息。其中,实际轨迹点的位置信息对应于感知到的实际位置,到达实际轨迹点的时间信息对应于感知时间。It should be noted that within the current time period, the sensors of the autonomous driving vehicle can sense the actual position of the obstacle vehicle multiple times, and each time the actual position is sensed, the sensing time (i.e., the time when the actual position is sensed) can be recorded. Therefore, the historical actual driving trajectory of the obstacle vehicle includes the position information of multiple actual trajectory points and the time information of the obstacle vehicle arriving at each actual trajectory point. Among them, the position information of the actual trajectory point corresponds to the perceived actual position, and the time information of arriving at the actual trajectory point corresponds to the sensing time.
在当前时间周期内,对自动驾驶车辆进行自动驾驶决策规划时,自动驾驶车辆会进行联合规划,以联合规划出自动驾驶车辆的期望行驶轨迹和障碍车的期望行驶轨迹。其中,自动驾驶车辆的期望行驶轨迹即为自动驾驶车辆在下一时间周期对应的试探路线,因此,障碍车的期望行驶轨迹的确定方式可以见有关确定试探路线的描述,比如,障碍车的期望行驶轨迹即为障碍车在下一时间周期对应的试探路线,在此暂不赘述。During the current time period, when the autonomous driving vehicle makes autonomous driving decision planning, the autonomous driving vehicle will conduct joint planning to jointly plan the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle. Among them, the expected driving trajectory of the autonomous driving vehicle is the trial route corresponding to the autonomous driving vehicle in the next time period. Therefore, the method for determining the expected driving trajectory of the obstacle vehicle can be found in the description of determining the trial route. For example, the expected driving trajectory of the obstacle vehicle is the trial route corresponding to the obstacle vehicle in the next time period, which will not be repeated here.
其中,自动驾驶车辆的期望行驶轨迹包括多个期望轨迹点的位置信息和自动驾驶车辆到达各个期望轨迹点的时间信息。同样地,障碍车的期望行驶轨迹包括多个期望轨迹点的位置信息和障碍车到达各个期望轨迹点的时间信息。The expected driving trajectory of the autonomous driving vehicle includes the position information of multiple expected trajectory points and the time information when the autonomous driving vehicle reaches each expected trajectory point. Similarly, the expected driving trajectory of the obstacle vehicle includes the position information of multiple expected trajectory points and the time information when the obstacle vehicle reaches each expected trajectory point.
本申请实施例中,自动驾驶车辆可以将当前时间周期的上一时间周期或者上几个时间周期对应的障碍车的期望行驶轨迹确定为障碍车的历史期望行驶轨迹。也就是说,障碍车的历史期望行驶轨迹是当前时间周期之前的时间周期所对应的障碍车的期望行驶轨迹。In the embodiment of the present application, the autonomous driving vehicle may determine the expected driving trajectory of the obstacle vehicle corresponding to the previous time period or the previous several time periods before the current time period as the historical expected driving trajectory of the obstacle vehicle. In other words, the historical expected driving trajectory of the obstacle vehicle is the expected driving trajectory of the obstacle vehicle corresponding to the time period before the current time period.
步骤206,基于障碍车的历史期望行驶轨迹和障碍车的历史实际行驶轨迹确定历史偏差信息。Step 206 : determining historical deviation information based on the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle.
自动驾驶车辆为障碍车规划出障碍车的历史期望行驶轨迹。自动驾驶车辆期望障碍车按照障碍车的历史期望行驶轨迹进行运动,而实际上障碍车是按照自身行驶意图进行运动的, 因此,障碍车的历史实际行驶轨迹与障碍车的历史期望行驶轨迹之间存在一定的差异。The autonomous driving vehicle plans the historical expected driving trajectory of the obstacle vehicle. The autonomous driving vehicle expects the obstacle vehicle to move according to the historical expected driving trajectory of the obstacle vehicle, but in fact the obstacle vehicle moves according to its own driving intention. Therefore, there is a certain difference between the actual historical driving trajectory of the obstacle vehicle and the expected historical driving trajectory of the obstacle vehicle.
自动驾驶车辆可以基于障碍车的历史期望行驶轨迹和障碍车的历史实际行驶轨迹确定历史偏差信息,以通过历史偏差信息来量化障碍车的历史实际行驶轨迹与障碍车的历史期望行驶轨迹之间的差异。可选地,历史偏差信息的数值大小与差异的大小成正比,即历史偏差信息的数值越大,则障碍车的历史实际行驶轨迹与障碍车的历史期望行驶轨迹之间的差异越大。The autonomous driving vehicle may determine historical deviation information based on the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle, so as to quantify the difference between the historical actual driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the obstacle vehicle through the historical deviation information. Optionally, the value of the historical deviation information is proportional to the size of the difference, that is, the larger the value of the historical deviation information, the larger the difference between the historical actual driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the obstacle vehicle.
在一种可能的实现方式中,障碍车的数量为至少两个。这种情况下,步骤206包括步骤2061至步骤2062。In a possible implementation, the number of the obstacle vehicles is at least two. In this case, step 206 includes steps 2061 and 2062.
步骤2061,对于任一个障碍车,确定任一个障碍车的历史期望行驶轨迹和任一个障碍车的历史实际行驶轨迹之间的偏差信息。Step 2061: for any obstacle vehicle, determine the deviation information between the historical expected driving trajectory of any obstacle vehicle and the historical actual driving trajectory of any obstacle vehicle.
由于任一个障碍车的历史实际行驶轨迹与该障碍车的历史期望行驶轨迹之间存在一定的差异,因此,自动驾驶车辆可以确定出该障碍车的历史期望行驶轨迹和该障碍车的历史实际行驶轨迹之间的偏差信息,将该偏差信息记为该障碍车的偏差信息。通过障碍车的偏差信息可以量化障碍车的历史实际行驶轨迹与障碍车的历史期望行驶轨迹之间的差异。可选地,障碍车的偏差信息的数值大小与差异的大小成正比,即障碍车的偏差信息的数值越大,则障碍车的历史实际行驶轨迹与障碍车的历史期望行驶轨迹之间的差异越大。Since there is a certain difference between the historical actual driving trajectory of any obstacle vehicle and the historical expected driving trajectory of the obstacle vehicle, the autonomous driving vehicle can determine the deviation information between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle, and record the deviation information as the deviation information of the obstacle vehicle. The difference between the historical actual driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the obstacle vehicle can be quantified through the deviation information of the obstacle vehicle. Optionally, the numerical value of the deviation information of the obstacle vehicle is proportional to the size of the difference, that is, the larger the numerical value of the deviation information of the obstacle vehicle, the greater the difference between the historical actual driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the obstacle vehicle.
上文已提及,任一个障碍车的历史期望行驶轨迹包括多个期望轨迹点的位置信息和障碍车到达各个期望轨迹点的时间信息,任一个障碍车的历史实际行驶轨迹包括多个实际轨迹点的位置信息和障碍车到达各个实际轨迹点的时间信息。在这种情况下,可选地,步骤2061包括:基于多个期望轨迹点的位置信息和多个实际轨迹点的位置信息,确定障碍车对应的空间偏差信息;基于障碍车到达各个期望轨迹点的时间信息和障碍车到达各个实际轨迹点的时间信息,确定障碍车对应的时间偏差信息;基于障碍车对应的空间偏差信息和时间偏差信息,确定障碍车的偏差信息。As mentioned above, the historical expected driving trajectory of any obstacle vehicle includes the position information of multiple expected trajectory points and the time information of the obstacle vehicle arriving at each expected trajectory point, and the historical actual driving trajectory of any obstacle vehicle includes the position information of multiple actual trajectory points and the time information of the obstacle vehicle arriving at each actual trajectory point. In this case, optionally, step 2061 includes: determining the spatial deviation information corresponding to the obstacle vehicle based on the position information of multiple expected trajectory points and the position information of multiple actual trajectory points; determining the time deviation information corresponding to the obstacle vehicle based on the time information of the obstacle vehicle arriving at each expected trajectory point and the time information of the obstacle vehicle arriving at each actual trajectory point; determining the deviation information of the obstacle vehicle based on the spatial deviation information and time deviation information corresponding to the obstacle vehicle.
本申请实施例中,存在多种实现方式,可以基于多个期望轨迹点的位置信息和多个实际轨迹点的位置信息确定障碍车对应的空间偏差信息。其中,障碍车对应的空间偏差信息可以在空间层面反映出障碍车的历史期望行驶轨迹和障碍车的历史实际行驶轨迹之间的差异。In the embodiment of the present application, there are multiple implementation methods, and the spatial deviation information corresponding to the obstacle vehicle can be determined based on the position information of multiple expected trajectory points and the position information of multiple actual trajectory points. Among them, the spatial deviation information corresponding to the obstacle vehicle can reflect the difference between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle at the spatial level.
下面提供了实现方式A1和实现方式A2两种确定障碍车对应的空间偏差信息的方式。Two methods of determining the spatial deviation information corresponding to the obstacle vehicle, namely, implementation method A1 and implementation method A2, are provided below.
实现方式A1,对于任一个期望轨迹点,基于该期望轨迹点的位置信息与多个实际轨迹点的位置信息,计算该期望轨迹点与各个实际轨迹点之间的距离,从该期望轨迹点与各个实际轨迹点之间的距离中确定该期望轨迹点对应的最小距离。基于多个期望轨迹点对应的最小距离计算出障碍车对应的空间偏差信息,例如,将多个期望轨迹点对应的最小距离进行加权平均,得到障碍车对应的空间偏差信息。Implementation A1: For any expected trajectory point, based on the position information of the expected trajectory point and the position information of multiple actual trajectory points, the distance between the expected trajectory point and each actual trajectory point is calculated, and the minimum distance corresponding to the expected trajectory point is determined from the distances between the expected trajectory point and each actual trajectory point. The spatial deviation information corresponding to the obstacle vehicle is calculated based on the minimum distances corresponding to the multiple expected trajectory points, for example, the minimum distances corresponding to the multiple expected trajectory points are weighted averaged to obtain the spatial deviation information corresponding to the obstacle vehicle.
需要说明的是,实现方式A1是基于多个期望轨迹点对应的最小距离计算出障碍车对应的空间偏差信息。在应用时,可以基于实现方式A1的原理,先计算出任一个实际轨迹点与各个期望轨迹点之间的距离,再从中确定出实际轨迹点对应的最小距离。之后,基于多个实际轨迹点对应的最小距离计算出障碍车对应的空间偏差信息。It should be noted that implementation A1 calculates the spatial deviation information corresponding to the obstacle vehicle based on the minimum distance corresponding to multiple expected trajectory points. When applied, based on the principle of implementation A1, the distance between any actual trajectory point and each expected trajectory point can be calculated first, and then the minimum distance corresponding to the actual trajectory point can be determined. After that, the spatial deviation information corresponding to the obstacle vehicle can be calculated based on the minimum distance corresponding to multiple actual trajectory points.
实现方式A2,基于多个期望轨迹点的位置信息,确定出障碍车的历史期望行驶轨迹的空间特征。基于多个实际轨迹点的位置信息,确定出障碍车的历史实际行驶轨迹的空间特征。之后,计算障碍车的历史期望行驶轨迹的空间特征和障碍车的历史实际行驶轨迹的空间特征之间的特征距离,基于特征距离得到障碍车对应的空间偏差信息,如对特征距离进行映射处理,得到障碍车对应的空间偏差信息。Implementation A2, based on the position information of multiple expected trajectory points, the spatial characteristics of the historical expected driving trajectory of the obstacle vehicle are determined. Based on the position information of multiple actual trajectory points, the spatial characteristics of the historical actual driving trajectory of the obstacle vehicle are determined. After that, the characteristic distance between the spatial characteristics of the historical expected driving trajectory of the obstacle vehicle and the spatial characteristics of the historical actual driving trajectory of the obstacle vehicle is calculated, and the spatial deviation information corresponding to the obstacle vehicle is obtained based on the characteristic distance, such as mapping the characteristic distance to obtain the spatial deviation information corresponding to the obstacle vehicle.
比如,障碍车的历史期望行驶轨迹的空间特征可以表示为一个特征向量,障碍车的历史行驶轨迹的空间特征可以表示为另一个特征向量。计算这两个特征向量之间的特征距离。之后,根据特征距离查询特征距离与空间偏差信息之间的映射关系,得到与特征距离相映射的空间偏差信息,查询得到的该空间偏差信息即为障碍车对应的空间偏差信息。For example, the spatial characteristics of the historical expected driving trajectory of the obstacle vehicle can be expressed as a feature vector, and the spatial characteristics of the historical driving trajectory of the obstacle vehicle can be expressed as another feature vector. The feature distance between the two feature vectors is calculated. Afterwards, the mapping relationship between the feature distance and the spatial deviation information is queried based on the feature distance to obtain the spatial deviation information mapped to the feature distance. The queried spatial deviation information is the spatial deviation information corresponding to the obstacle vehicle.
本申请实施例中,存在多种实现方式,可以基于障碍车到达各个期望轨迹点的时间信息和障碍车到达各个实际轨迹点的时间信息,确定障碍车对应的时间偏差信息。障碍车对应的时间偏差信息可以在时间层面反映出障碍车的历史期望行驶轨迹和障碍车的历史实际行驶轨迹之间的差异。下面提供了实现方式B1和实现方式B2两种确定障碍车对应的时间偏差信息的方式。In the embodiment of the present application, there are multiple implementation methods, which can determine the time deviation information corresponding to the barrier vehicle based on the time information of the barrier vehicle reaching each expected trajectory point and the time information of the barrier vehicle reaching each actual trajectory point. The time deviation information corresponding to the barrier vehicle can reflect the difference between the historical expected driving trajectory of the barrier vehicle and the historical actual driving trajectory of the barrier vehicle at the time level. The following provides two methods for determining the time deviation information corresponding to the barrier vehicle, implementation method B1 and implementation method B2.
需要说明的是,障碍车到达期望轨迹点的时间信息与该期望轨迹点的位置信息相关,障碍车到达实际轨迹点的时间信息与该实际轨迹点的位置信息相关。因此,在计算障碍车对应 的时间偏差信息时,需要基于多个期望轨迹点的位置信息、障碍车到达各个期望轨迹点的时间信息、多个实际轨迹点的位置信息和障碍车到达各个实际轨迹点的时间信息来计算。It should be noted that the time information of the obstacle vehicle reaching the expected trajectory point is related to the position information of the expected trajectory point, and the time information of the obstacle vehicle reaching the actual trajectory point is related to the position information of the actual trajectory point. When obtaining the time deviation information, it is necessary to calculate based on the position information of multiple expected trajectory points, the time information when the obstacle vehicle arrives at each expected trajectory point, the position information of multiple actual trajectory points, and the time information when the obstacle vehicle arrives at each actual trajectory point.
实现方式B1,对于任一个期望轨迹点,基于该期望轨迹点的位置信息与多个实际轨迹点的位置信息,计算该期望轨迹点与各个实际轨迹点之间的距离,从该期望轨迹点与各个实际轨迹点之间的距离中确定该期望轨迹点对应的最小距离,从而确定出最小距离对应的实际轨迹点。基于障碍车到达该期望轨迹点的时间信息和障碍车到达该期望轨迹点所对应的最小距离对应的实际轨迹点的时间信息(例如,计算这两个时间信息之间的时间差值),得到该期望轨迹点对应的时间偏差信息。换言之,障碍车到达该期望轨迹点时产生一个时间信息,由于上文确定了该期望轨迹点对应的最小距离,且最小距离对应有一个实际轨迹点,因而障碍车到达最小距离对应的实际轨迹点时也产生一个时间信息,共产生两个时间信息。本申请实施例可以根据两个时间信息,得到该期望轨迹点对应的时间偏差信息。之后,基于多个期望轨迹点对应的时间偏差信息,确定障碍车对应的时间偏差信息,例如,将多个期望轨迹点对应的时间偏差信息进行加权平均,得到障碍车对应的时间偏差信息。Implementation method B1, for any expected trajectory point, based on the position information of the expected trajectory point and the position information of multiple actual trajectory points, calculate the distance between the expected trajectory point and each actual trajectory point, determine the minimum distance corresponding to the expected trajectory point from the distance between the expected trajectory point and each actual trajectory point, and thus determine the actual trajectory point corresponding to the minimum distance. Based on the time information of the obstacle vehicle arriving at the expected trajectory point and the time information of the actual trajectory point corresponding to the minimum distance corresponding to the expected trajectory point (for example, calculating the time difference between the two time information), the time deviation information corresponding to the expected trajectory point is obtained. In other words, when the obstacle vehicle arrives at the expected trajectory point, a time information is generated. Since the minimum distance corresponding to the expected trajectory point is determined above, and the minimum distance corresponds to an actual trajectory point, a time information is also generated when the obstacle vehicle arrives at the actual trajectory point corresponding to the minimum distance, and two time information are generated in total. The embodiment of the present application can obtain the time deviation information corresponding to the expected trajectory point based on the two time information. Afterwards, based on the time deviation information corresponding to multiple expected trajectory points, the time deviation information corresponding to the obstacle vehicle is determined, for example, the time deviation information corresponding to multiple expected trajectory points is weighted averaged to obtain the time deviation information corresponding to the obstacle vehicle.
需要说明的是,实现方式B1是基于多个期望轨迹点对应的时间偏差信息计算出障碍车对应的时间偏差信息。在应用时,可以基于实现方式B1的原理,先计算出任一个实际轨迹点与各个期望轨迹点之间的距离,再从中确定出实际轨迹点对应的最小距离,从而确定出最小距离对应的期望轨迹点,以计算出实际轨迹点对应的时间偏差信息。之后,基于多个实际轨迹点对应的时间偏差信息计算出障碍车对应的时间偏差信息。It should be noted that implementation method B1 calculates the time deviation information corresponding to the obstacle vehicle based on the time deviation information corresponding to multiple expected trajectory points. When applied, based on the principle of implementation method B1, the distance between any actual trajectory point and each expected trajectory point can be calculated first, and then the minimum distance corresponding to the actual trajectory point can be determined, thereby determining the expected trajectory point corresponding to the minimum distance, so as to calculate the time deviation information corresponding to the actual trajectory point. After that, the time deviation information corresponding to the obstacle vehicle is calculated based on the time deviation information corresponding to multiple actual trajectory points.
实现方式B2,基于多个期望轨迹点的位置信息和障碍车到达各个期望轨迹点的时间信息,确定出障碍车的历史期望行驶轨迹的时间特征。基于多个实际轨迹点的位置信息和障碍车到达各个实际轨迹点的时间信息,确定出障碍车的历史实际行驶轨迹的时间特征。之后,计算障碍车的历史期望行驶轨迹的时间特征和障碍车的历史实际行驶轨迹的时间特征之间的特征距离,基于特征距离得到障碍车对应的时间偏差信息,如对特征距离进行映射处理,得到障碍车对应的时间偏差信息。Implementation method B2, based on the position information of multiple expected trajectory points and the time information of the obstacle vehicle arriving at each expected trajectory point, the time characteristics of the historical expected driving trajectory of the obstacle vehicle are determined. Based on the position information of multiple actual trajectory points and the time information of the obstacle vehicle arriving at each actual trajectory point, the time characteristics of the historical actual driving trajectory of the obstacle vehicle are determined. Afterwards, the characteristic distance between the time characteristics of the historical expected driving trajectory of the obstacle vehicle and the time characteristics of the historical actual driving trajectory of the obstacle vehicle is calculated, and the time deviation information corresponding to the obstacle vehicle is obtained based on the characteristic distance, such as mapping the characteristic distance to obtain the time deviation information corresponding to the obstacle vehicle.
示例性地,障碍车的历史期望行驶轨迹的时间特征,以及障碍车的历史实际行驶轨迹的时间特征,可以通过两个特征向量进行表示。本申请实施例可以计算这两个特征向量之间的特征距离,根据特征距离查询特征距离与空间偏差信息之间的映射关系,得到与特征距离相映射的时间偏差信息,查询得到的该时间偏差信息即为障碍车对应的时间偏差信息。Exemplarily, the time characteristics of the historical expected driving trajectory of the obstacle vehicle and the time characteristics of the historical actual driving trajectory of the obstacle vehicle can be represented by two feature vectors. The embodiment of the present application can calculate the feature distance between the two feature vectors, query the mapping relationship between the feature distance and the spatial deviation information based on the feature distance, and obtain the time deviation information mapped to the feature distance. The time deviation information obtained by the query is the time deviation information corresponding to the obstacle vehicle.
在按照实现方式A1或者实现方式A2等方式确定出障碍车对应的空间偏差信息,并按照实现方式B1或者实现方式B2等方式确定出障碍车对应的时间偏差信息之后,将障碍车对应的空间偏差信息和障碍车对应的时间偏差信息进行加权求和、加权求平均等计算,得到障碍车的偏差信息。After determining the spatial deviation information corresponding to the obstacle vehicle according to implementation method A1 or implementation method A2, and determining the time deviation information corresponding to the obstacle vehicle according to implementation method B1 or implementation method B2, the spatial deviation information corresponding to the obstacle vehicle and the time deviation information corresponding to the obstacle vehicle are weighted summed, weighted averaged, etc. to obtain the deviation information of the obstacle vehicle.
其中,障碍车的偏差信息可以在时空层面反映出障碍车的历史期望行驶轨迹和障碍车的历史实际行驶轨迹之间差异。由于障碍车的偏差信息是基于障碍车对应的空间偏差信息和障碍车对应的时间偏差信息确定的,因此,本申请实施例将障碍车的偏差信息解耦成了空间层面的差异和时间层面的差异。Among them, the deviation information of the obstacle vehicle can reflect the difference between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle at the spatiotemporal level. Since the deviation information of the obstacle vehicle is determined based on the spatial deviation information corresponding to the obstacle vehicle and the temporal deviation information corresponding to the obstacle vehicle, the embodiment of the present application decouples the deviation information of the obstacle vehicle into the difference at the spatial level and the difference at the temporal level.
请参见图3,图3是本申请实施例提供的一种空间层面的会车示意图,图3示出了道路上的车辆A和车辆B,且车辆A的运动方向和车辆B的运动方向相反。车辆A和车辆B进行会车时,一种可选方式为车辆A按照轨迹A-m1进行运动且车辆B按照轨迹B-m1进行运动,另一种可选方式为车辆A按照轨迹A-m2进行运动且车辆B按照轨迹B-m2进行运动。因此,针对车辆A来说,在空间层面上,车辆A可以按照轨迹A-m1进行运动,也可以按照轨迹A-m2进行运动,这种运动差异即为空间层面的差异。Please refer to Figure 3, which is a schematic diagram of a spatial level meeting provided by an embodiment of the present application. Figure 3 shows vehicle A and vehicle B on the road, and the movement direction of vehicle A is opposite to the movement direction of vehicle B. When vehicle A and vehicle B meet, one optional method is that vehicle A moves along trajectory A-m1 and vehicle B moves along trajectory B-m1, and another optional method is that vehicle A moves along trajectory A-m2 and vehicle B moves along trajectory B-m2. Therefore, for vehicle A, at the spatial level, vehicle A can move along trajectory A-m1 or along trajectory A-m2, and this movement difference is the difference at the spatial level.
请参见图4,图4是本申请实施例提供的一种时间层面的会车示意图,图4示出了道路上的车辆A、车辆B和车辆C,其中,车辆A的运动方向和车辆B的运动方向相反,而车辆C静止,或者,车辆C的运动方向与车辆A的运动方向相同。车辆B按照轨迹B-m进行运动,在车辆A和车辆B进行会车时,一种可选方式为车辆A按照轨迹A-m1进行运动,这种情况下,车辆A是跟在车辆C后面完成与车辆B的会车,另一种可选方式为车辆A按照轨迹A-m2进行运动,这种情况下,车辆A是超过了车辆C之后完成与车辆B的会车。因此,针对车辆A来说,在时间层面上,车辆A可以按照轨迹A-m1进行运动,也可以按照轨迹A-m2进行运动,这种运动差异即为时间层面的差异。Please refer to FIG. 4, which is a schematic diagram of a time-level meeting provided by an embodiment of the present application. FIG. 4 shows vehicles A, B and C on the road, wherein the movement direction of vehicle A is opposite to that of vehicle B, while vehicle C is stationary, or the movement direction of vehicle C is the same as that of vehicle A. Vehicle B moves along the trajectory B-m. When vehicles A and B meet, one optional method is that vehicle A moves along the trajectory A-m1. In this case, vehicle A meets vehicle B behind vehicle C. Another optional method is that vehicle A moves along the trajectory A-m2. In this case, vehicle A meets vehicle B after passing vehicle C. Therefore, for vehicle A, at the time level, vehicle A can move along the trajectory A-m1 or along the trajectory A-m2. This movement difference is the difference at the time level.
本申请实施例中,在空间层面和时间层面分别计算障碍车的历史期望行驶轨迹和障碍车 的历史实际行驶轨迹之间的差异,并基于空间层面和时间层面的差异计算障碍车的偏差信息,有利于提高了障碍车的偏差信息的准确性,从而使自动驾驶车辆规划出更准确的期望轨迹,提高自动驾驶车辆的行车安全性。In the embodiment of the present application, the historical expected driving trajectory of the obstacle vehicle and the obstacle vehicle are calculated at the spatial level and the temporal level respectively. The difference between the historical actual driving trajectories and the deviation information of the obstacle vehicle is calculated based on the differences in spatial and temporal levels, which is conducive to improving the accuracy of the deviation information of the obstacle vehicle, so that the autonomous driving vehicle can plan a more accurate expected trajectory and improve the driving safety of the autonomous driving vehicle.
在另一种可能的实现方式中,任一个障碍车的历史期望行驶轨迹包括多个时刻的期望轨迹点,任一个障碍车的历史实际行驶轨迹包括多个时刻的实际轨迹点。这种情况下,步骤2061包括:对于任一个时刻,基于任一个时刻的期望轨迹点的位置信息和任一个时刻的实际轨迹点的位置信息,确定任一个时刻对应的期望轨迹点和实际轨迹点之间的距离;基于各个时刻对应的期望轨迹点和实际轨迹点之间的距离,确定任一个障碍车的历史期望行驶轨迹和任一个障碍车的历史实际行驶轨迹之间的偏差信息。In another possible implementation, the historical expected driving trajectory of any barrier vehicle includes expected trajectory points at multiple moments, and the historical actual driving trajectory of any barrier vehicle includes actual trajectory points at multiple moments. In this case, step 2061 includes: for any moment, based on the position information of the expected trajectory point at any moment and the position information of the actual trajectory point at any moment, determining the distance between the expected trajectory point and the actual trajectory point corresponding to any moment; based on the distance between the expected trajectory point and the actual trajectory point corresponding to each moment, determining the deviation information between the historical expected driving trajectory of any barrier vehicle and the historical actual driving trajectory of any barrier vehicle.
由于任一个障碍车的历史期望行驶轨迹包括多个期望轨迹点的位置信息和障碍车到达各个期望轨迹点的时间信息,因此,一个期望轨迹点对应一个时间(或者说时刻),即一个期望轨迹点可以理解为一个时刻的期望轨迹点。任一个障碍车的历史实际行驶轨迹包括多个实际轨迹点的位置信息和障碍车到达各个实际轨迹点的时间信息,因此,一个实际轨迹点可以理解为一个时刻的实际轨迹点。Since the historical expected driving trajectory of any obstacle vehicle includes the position information of multiple expected trajectory points and the time information of the obstacle vehicle arriving at each expected trajectory point, an expected trajectory point corresponds to a time (or moment), that is, an expected trajectory point can be understood as an expected trajectory point at a moment. The historical actual driving trajectory of any obstacle vehicle includes the position information of multiple actual trajectory points and the time information of the obstacle vehicle arriving at each actual trajectory point, so an actual trajectory point can be understood as an actual trajectory point at a moment.
对于任一个时刻,基于该时刻的期望轨迹点的位置信息和该时刻的实际轨迹点的位置信息,按照距离公式计算出该时刻对应的期望轨迹点和实际轨迹点之间的距离。对各个时刻对应的期望轨迹点和实际轨迹点之间的距离进行求平均、求和等运算,得到运算结果,将运算结果作为障碍车的偏差信息,或者,将运算结果映射为障碍车的偏差信息。其中,障碍车的偏差信息与运算结果成正比,即运算结果越大,障碍车的偏差信息越大,障碍车的历史期望行驶轨迹和障碍车的历史实际行驶轨迹之间的差异越大。For any moment, based on the position information of the expected trajectory point at that moment and the position information of the actual trajectory point at that moment, the distance between the expected trajectory point and the actual trajectory point corresponding to that moment is calculated according to the distance formula. The distance between the expected trajectory point and the actual trajectory point corresponding to each moment is averaged, summed, etc. to obtain the calculation result, and the calculation result is used as the deviation information of the obstacle vehicle, or the calculation result is mapped to the deviation information of the obstacle vehicle. Among them, the deviation information of the obstacle vehicle is proportional to the calculation result, that is, the larger the calculation result, the larger the deviation information of the obstacle vehicle, and the greater the difference between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle.
步骤2062,基于各个障碍车的历史期望行驶轨迹和各个障碍车的历史实际行驶轨迹之间的偏差信息,确定历史偏差信息。Step 2062: Determine historical deviation information based on deviation information between historical expected driving trajectories of each obstacle vehicle and historical actual driving trajectories of each obstacle vehicle.
本申请实施例中,可以将任一个障碍车的历史期望行驶轨迹和该障碍车的历史实际行驶轨迹之间的偏差信息记为该障碍车的偏差信息。可以对各个障碍车的偏差信息进行加权平均、加权求和等计算,得到历史偏差信息,该历史偏差信息也可称为贝叶斯均衡的偏差。In the embodiment of the present application, the deviation information between the historical expected driving trajectory of any obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle can be recorded as the deviation information of the obstacle vehicle. The deviation information of each obstacle vehicle can be calculated by weighted average, weighted sum, etc. to obtain the historical deviation information, which can also be called the deviation of Bayesian equilibrium.
步骤207,基于自动驾驶车辆的历史实际行驶轨迹和历史偏差信息确定试探路线。Step 207: determine a trial route based on the historical actual driving trajectory and historical deviation information of the autonomous driving vehicle.
自动驾驶车辆的历史实际行驶轨迹是当前时间周期之前的时间周期对应的试探路线。自动驾驶车辆可以基于自动驾驶车辆的历史实际行驶轨迹和历史偏差信息进行联合规划,以规划出当前时间周期的第一联合路线,第一联合路线包括试探路线。The historical actual driving trajectory of the autonomous driving vehicle is a trial route corresponding to a time period before the current time period. The autonomous driving vehicle can perform joint planning based on the historical actual driving trajectory of the autonomous driving vehicle and the historical deviation information to plan a first joint route for the current time period, wherein the first joint route includes the trial route.
在一种可能的实现方式中,步骤207包括步骤2071至步骤2074。In a possible implementation, step 207 includes steps 2071 to 2074 .
步骤2071,响应于历史偏差信息小于第一阈值,则基于自动驾驶车辆的历史实际行驶轨迹和障碍车的历史实际行驶轨迹,确定障碍车的至少一个第一候选路线和自动驾驶车辆的至少一个第一候选路线。Step 2071, in response to the historical deviation information being less than the first threshold, determining at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle.
本申请实施例中,第一阈值是设定的数值。当历史偏差信息小于第一阈值时,说明障碍车的历史期望行驶轨迹与障碍车的历史实际行驶轨迹之间的差异较小,符合自动驾驶车辆的期望。自动驾驶车辆通过分析自动驾驶车辆的历史实际行驶轨迹,可以得到自动驾驶车辆的行驶意图,通过分析障碍车的历史实际行驶轨迹,可以得到障碍车的行驶意图,从而得到自动驾驶车辆所处环境中所有主体的行驶意图,这里的所有主体包括自动驾驶车辆和障碍车。基于自动驾驶车辆所处环境中所有主体的行驶意图可以规划出障碍车的至少一个第一候选路线和自动驾驶车辆的至少一个第一候选路线。In the embodiment of the present application, the first threshold is a set value. When the historical deviation information is less than the first threshold, it means that the difference between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle is small, which meets the expectations of the autonomous driving vehicle. The autonomous driving vehicle can obtain the driving intention of the autonomous driving vehicle by analyzing the historical actual driving trajectory of the autonomous driving vehicle. By analyzing the historical actual driving trajectory of the obstacle vehicle, the driving intention of the obstacle vehicle can be obtained, thereby obtaining the driving intention of all subjects in the environment where the autonomous driving vehicle is located, where all subjects include autonomous driving vehicles and obstacle vehicles. Based on the driving intentions of all subjects in the environment where the autonomous driving vehicle is located, at least one first candidate route for the obstacle vehicle and at least one first candidate route for the autonomous driving vehicle can be planned.
例如,请参见图5,图5是本申请实施例提供的一种轨迹规划的示意图。自动驾驶车辆为车辆A,车辆A的历史实际行驶轨迹为A-m’;障碍车包括车辆B和车辆C,其中,车辆B的历史实际行驶轨迹为B-m’,车辆C的历史实际行驶轨迹为静止。则车辆A通过分析A-m’得到车辆A的行驶意图为前进,通过分析B-m’得到车辆B的行驶意图也为前进,通过分析车辆C的历史实际行驶轨迹得到车辆C的行驶意图为静止。在这种情况下,车辆A可以规划出车辆A的第一候选路线包括A-m1和A-m2,车辆B的第一候选路线为B-m,车辆C的第一候选路线为静止。For example, please refer to Figure 5, which is a schematic diagram of trajectory planning provided by an embodiment of the present application. The autonomous driving vehicle is vehicle A, and the historical actual driving trajectory of vehicle A is A-m'; the obstacle vehicles include vehicle B and vehicle C, wherein the historical actual driving trajectory of vehicle B is B-m', and the historical actual driving trajectory of vehicle C is stationary. Then, by analyzing A-m', vehicle A obtains that the driving intention of vehicle A is to move forward, and by analyzing B-m', the driving intention of vehicle B is also to move forward, and by analyzing the historical actual driving trajectory of vehicle C, the driving intention of vehicle C is to be stationary. In this case, vehicle A can plan that the first candidate route of vehicle A includes A-m1 and A-m2, the first candidate route of vehicle B is B-m, and the first candidate route of vehicle C is stationary.
可选地,步骤2071包括:基于自动驾驶车辆的历史实际行驶轨迹和障碍车的历史实际行驶轨迹确定障碍车的轨迹点分布信息和自动驾驶车辆的轨迹点分布信息;对于目标主体,基于目标主体的轨迹点分布信息生成目标主体的多个轨迹点,目标主体为障碍车或者自动驾驶车辆;从目标主体的多个轨迹点中采样出目标主体的多个目标轨迹点;基于目标主体的多个 目标轨迹点生成目标主体的至少一个第一候选路线。Optionally, step 2071 includes: determining the trajectory point distribution information of the obstacle vehicle and the trajectory point distribution information of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle; for the target subject, generating multiple trajectory points of the target subject based on the trajectory point distribution information of the target subject, where the target subject is the obstacle vehicle or the autonomous driving vehicle; sampling multiple target trajectory points of the target subject from the multiple trajectory points of the target subject; and sampling multiple target trajectory points of the target subject based on the multiple trajectory points of the target subject. The target trajectory point generates at least one first candidate route of the target body.
比如,针对目标主体的多个轨迹点执行一次采样过程,从而得到目标主体的多个目标轨迹点,基于目标主体的多个目标轨迹点生成目标主体的一个第一候选路线。又比如,针对目标主体的多个轨迹点执行多次采样过程,通过每次采样过程均能够得到一个第一候选路线,从而生成目标主体的多个第一候选路线。由此,便能够得到目标主体的至少一个第一候选路线。也即是,得到自动驾驶车辆的至少一个第一候选路线,得到障碍车的至少一个第一候选路线。For example, a sampling process is performed for multiple trajectory points of the target subject, thereby obtaining multiple target trajectory points of the target subject, and a first candidate route of the target subject is generated based on the multiple target trajectory points of the target subject. For another example, multiple sampling processes are performed for multiple trajectory points of the target subject, and a first candidate route can be obtained through each sampling process, thereby generating multiple first candidate routes of the target subject. In this way, at least one first candidate route of the target subject can be obtained. That is, at least one first candidate route of the autonomous driving vehicle is obtained, and at least one first candidate route of the obstacle vehicle is obtained.
本申请实施例中,通过分析自动驾驶车辆的历史实际行驶轨迹、障碍车的历史实际行驶轨迹,可以确定出环境中所有主体的行驶意图。基于环境中所有主体的行驶意图和障碍车的历史实际行驶轨迹,可以确定出该障碍车的轨迹点分布信息,其中,障碍车的轨迹点分布信息可以反映障碍车的轨迹点所满足的分布,例如,障碍车的轨迹点满足高斯分布。同样的原理,基于环境中所有主体的行驶意图和自动驾驶车辆的历史实际行驶轨迹,可以确定出自动驾驶车辆的轨迹点分布信息,其中,自动驾驶车辆的轨迹点分布信息可以反映自动驾驶车辆的轨迹点所满足的分布。In an embodiment of the present application, the driving intentions of all subjects in the environment can be determined by analyzing the historical actual driving trajectories of the autonomous driving vehicle and the historical actual driving trajectories of the obstacle vehicle. Based on the driving intentions of all subjects in the environment and the historical actual driving trajectories of the obstacle vehicle, the trajectory point distribution information of the obstacle vehicle can be determined, wherein the trajectory point distribution information of the obstacle vehicle can reflect the distribution satisfied by the trajectory points of the obstacle vehicle, for example, the trajectory points of the obstacle vehicle satisfy the Gaussian distribution. By the same principle, based on the driving intentions of all subjects in the environment and the historical actual driving trajectories of the autonomous driving vehicle, the trajectory point distribution information of the autonomous driving vehicle can be determined, wherein the trajectory point distribution information of the autonomous driving vehicle can reflect the distribution satisfied by the trajectory points of the autonomous driving vehicle.
将障碍车作为目标主体,或者将自动驾驶车辆作为目标主体。针对目标主体,由于目标主体的轨迹点分布信息可以反应出目标主体的轨迹点所满足的分布,因此,可以基于目标主体的轨迹点分布信息生成目标主体的多个轨迹点,且这多个轨迹点的位置信息满足分布。The obstacle vehicle is taken as the target subject, or the autonomous driving vehicle is taken as the target subject. For the target subject, since the trajectory point distribution information of the target subject can reflect the distribution satisfied by the trajectory points of the target subject, multiple trajectory points of the target subject can be generated based on the trajectory point distribution information of the target subject, and the position information of these multiple trajectory points satisfies the distribution.
接着,从目标主体的多个轨迹点中采样出目标主体的多个目标轨迹点。在一种可能的实现方式中,先根据目标主体的历史实际行驶轨迹,从目标主体的多个轨迹点中采样出第一个目标轨迹点,且第一个目标轨迹点与历史实际行驶轨迹中最后一个实际轨迹点之间的距离小于距离阈值。接着,循环执行根据目标主体的历史实际行驶轨迹和已采样出的目标轨迹点,从目标主体的多个轨迹点中采样出下一个目标轨迹点,且下一个目标轨迹点与已采样出的最后一个目标轨迹点之间的距离小于距离阈值,直至达到循环终止条件。其中,距离阈值是可以设定的数值,也可以是根据目标主体的加速度、速度等信息确定的数值。Next, multiple target trajectory points of the target subject are sampled from the multiple trajectory points of the target subject. In one possible implementation, the first target trajectory point is sampled from the multiple trajectory points of the target subject based on the historical actual driving trajectory of the target subject, and the distance between the first target trajectory point and the last actual trajectory point in the historical actual driving trajectory is less than the distance threshold. Next, the next target trajectory point is sampled from the multiple trajectory points of the target subject based on the historical actual driving trajectory of the target subject and the sampled target trajectory points, and the distance between the next target trajectory point and the last target trajectory point sampled is less than the distance threshold, until the loop termination condition is reached. Among them, the distance threshold is a settable value, and it can also be a value determined based on information such as the acceleration and speed of the target subject.
通过上述方式,可以采样出目标主体的多个目标轨迹点。接着,基于单位时间确定目标主体到达各个目标轨迹点的时间信息。这种情况下,目标主体到达两个相邻的目标轨迹点的时间信息之间的差值为单位时间,比如至少一个单位时间。或者,基于目标主体的加速度、速度等信息,确定目标主体到达各个目标轨迹点的时间信息。这种情况下,目标主体到达两个相邻的目标轨迹点的时间信息之间的差值、这两个相邻的目标轨迹点之间的距离、目标主体的加速度和速度等信息,满足运动学公式。In the above manner, multiple target trajectory points of the target subject can be sampled. Then, the time information of the target subject arriving at each target trajectory point is determined based on the unit time. In this case, the difference between the time information of the target subject arriving at two adjacent target trajectory points is the unit time, such as at least one unit time. Alternatively, based on the acceleration, speed and other information of the target subject, the time information of the target subject arriving at each target trajectory point is determined. In this case, the difference between the time information of the target subject arriving at two adjacent target trajectory points, the distance between the two adjacent target trajectory points, the acceleration and speed of the target subject and other information satisfy the kinematic formula.
本申请实施例中,目标主体的一个第一候选路线包括目标主体的多个目标轨迹点和目标主体到达各个目标轨迹点的时间信息。通过上述方式,可以得到障碍车的至少一个第一候选路线、自动驾驶车辆的至少一个第一候选路线。In the embodiment of the present application, a first candidate route of the target subject includes multiple target trajectory points of the target subject and the time information of the target subject reaching each target trajectory point. In the above manner, at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle can be obtained.
步骤2072,将障碍车的至少一个第一候选路线和自动驾驶车辆的至少一个第一候选路线进行组合,得到至少一个第一组合路线,任一个第一组合路线包括障碍车的一个第一候选路线和自动驾驶车辆的一个第一候选路线。Step 2072: Combine at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle to obtain at least one first combined route, wherein any first combined route includes a first candidate route of the obstacle vehicle and a first candidate route of the autonomous driving vehicle.
本申请实施例中,从障碍车的至少一个第一候选路线中随机采样出障碍车的一个第一候选路线;从自动驾驶车辆的至少一个第一候选路线随机采样出该自动驾驶车辆的一个第一候选路线。将采样出的障碍车的一个第一候选路线、自动驾驶车辆的一个第一候选路线视作第一组合路线。通过这种方式,可以确定出至少一个第一组合路线。In the embodiment of the present application, a first candidate route for the obstacle vehicle is randomly sampled from at least one first candidate route for the obstacle vehicle; a first candidate route for the autonomous driving vehicle is randomly sampled from at least one first candidate route for the autonomous driving vehicle. The sampled first candidate route for the obstacle vehicle and the sampled first candidate route for the autonomous driving vehicle are regarded as the first combined route. In this way, at least one first combined route can be determined.
步骤2073,确定各个第一组合路线的推荐指标。Step 2073, determining the recommended index for each first combination route.
本申请实施例中,可以设定一个推荐指标函数,该推荐指标函数可以对任一个第一组合路线进行优劣评价,得到该第一组合路线的推荐指标,也就是说,推荐指标函数用于确定第一组合路线的推荐指标。其中,在评价第一组合路线的优劣时,不仅要考虑自动驾驶车辆的第一候选路线的高效性,还要参考障碍车的第一候选路线来评价自动驾驶车辆的第一候选路线的安全性。第一组合路线的推荐指标越大,表明第一组合路线越好,自动驾驶车辆基于第一组合路线中自动驾驶车辆的第一候选路线进行运动时行车高效性和行车安全性之间的平衡越好。或者说,由于本申请实施例选择了推荐指标较大的第一组合路线,因而第一组合路线较好,第一组合路线包括的自动驾驶车辆的第一候选路线也较好,自动驾驶车辆如果按照该自动驾驶车辆的第一候选路线进行运动,则能够较好的平衡自动驾驶车辆的行车高效性和行车安全性。 In the embodiment of the present application, a recommendation index function can be set, and the recommendation index function can evaluate the quality of any first combination route to obtain the recommendation index of the first combination route, that is, the recommendation index function is used to determine the recommendation index of the first combination route. Among them, when evaluating the quality of the first combination route, not only the efficiency of the first candidate route of the autonomous driving vehicle should be considered, but also the safety of the first candidate route of the obstacle vehicle should be evaluated with reference to the first candidate route of the obstacle vehicle. The larger the recommendation index of the first combination route, the better the first combination route is, and the better the balance between driving efficiency and driving safety when the autonomous driving vehicle moves based on the first candidate route of the autonomous driving vehicle in the first combination route. In other words, since the embodiment of the present application selects the first combination route with a larger recommendation index, the first combination route is better, and the first candidate route of the autonomous driving vehicle included in the first combination route is also better. If the autonomous driving vehicle moves according to the first candidate route of the autonomous driving vehicle, it can better balance the driving efficiency and driving safety of the autonomous driving vehicle.
可选地,步骤2073包括:基于障碍车的历史实际行驶轨迹确定推荐指标函数的参数分布信息,推荐指标函数用于确定第一组合路线的推荐指标;基于推荐指标函数的参数分布信息,生成推荐指标函数的多个候选参数;从推荐指标函数的多个候选参数中采样推荐指标函数的目标参数;基于推荐指标函数的目标参数确定各个第一组合路线的推荐指标。Optionally, step 2073 includes: determining parameter distribution information of a recommended index function based on the historical actual driving trajectory of the obstacle vehicle, the recommended index function being used to determine the recommended index of the first combined route; generating multiple candidate parameters of the recommended index function based on the parameter distribution information of the recommended index function; sampling target parameters of the recommended index function from the multiple candidate parameters of the recommended index function; and determining the recommended index of each first combined route based on the target parameters of the recommended index function.
本申请实施例中,自动驾驶车辆可以先对障碍车的历史期望行驶轨迹和历史实际行驶轨迹进行分析,以确定出历史偏差信息,其中,历史偏差信息的确定方式在上文已有描述,在此不再赘述。接着,基于历史偏差信息的数值确定推荐指标函数的参数分布信息,推荐指标函数的参数分布信息可以反应出推荐指标函数的参数所满足的分布,例如,推荐指标函数的参数满足高斯分布。In the embodiment of the present application, the autonomous driving vehicle may first analyze the historical expected driving trajectory and the historical actual driving trajectory of the obstacle vehicle to determine the historical deviation information, wherein the method for determining the historical deviation information has been described above and will not be repeated here. Next, the parameter distribution information of the recommended index function is determined based on the value of the historical deviation information. The parameter distribution information of the recommended index function can reflect the distribution satisfied by the parameters of the recommended index function, for example, the parameters of the recommended index function satisfy the Gaussian distribution.
由于推荐指标函数的参数分布信息可以反应出推荐指标函数的参数所满足的分布,因此,可以基于推荐指标函数的参数分布信息生成推荐指标函数的多个候选参数,且这多个候选参数的数值满足分布。Since the parameter distribution information of the recommended index function can reflect the distribution satisfied by the parameters of the recommended index function, multiple candidate parameters of the recommended index function can be generated based on the parameter distribution information of the recommended index function, and the values of the multiple candidate parameters satisfy the distribution.
接着,从推荐指标函数的多个候选参数中采样推荐指标函数的目标参数,该目标参数可以用于平衡自动驾驶车辆的行车安全性和行车高效性。可选地,可以获取上一时间周期对应的推荐指标函数的目标参数,对于任一个候选参数,计算上一时间周期对应的目标参数与该候选参数之间的差值,得到该候选参数对应的差值。通过这种方式,可以确定出各个候选参数对应的差值,将满足差值条件的差值所对应的候选参数作为当前时间周期对应的推荐指标函数的目标参数。本申请实施例不对满足差值条件的差值做限定,示例性的,满足差值条件的差值为最小差值。Next, the target parameter of the recommended index function is sampled from the multiple candidate parameters of the recommended index function. The target parameter can be used to balance the driving safety and driving efficiency of the autonomous driving vehicle. Optionally, the target parameter of the recommended index function corresponding to the previous time period can be obtained. For any candidate parameter, the difference between the target parameter corresponding to the previous time period and the candidate parameter is calculated to obtain the difference corresponding to the candidate parameter. In this way, the difference corresponding to each candidate parameter can be determined, and the candidate parameter corresponding to the difference that satisfies the difference condition is used as the target parameter of the recommended index function corresponding to the current time period. The embodiment of the present application does not limit the difference that satisfies the difference condition. Exemplarily, the difference that satisfies the difference condition is the minimum difference.
之后,基于当前时间周期对应的推荐指标函数的目标参数,可以确定出当前时间周期对应的推荐指标函数,从而利用当前时间周期的推荐指标函数确定出各个第一组合路线的推荐指标。Afterwards, based on the target parameter of the recommendation index function corresponding to the current time period, the recommendation index function corresponding to the current time period may be determined, thereby determining the recommendation index of each first combination route using the recommendation index function of the current time period.
可选地,基于推荐指标函数的目标参数确定各个第一组合路线的推荐指标,包括:对于任一个第一组合路线,获取任一个第一组合路线的至少一个参照信息,任一个参照信息为舒适度、安全度、自动驾驶车辆的速度、不确定度、礼貌程度以及流通度中的任一项,舒适度用于描述加速度,安全度用于描述碰撞信息,不确定度用于描述轨迹点的集中程度,礼貌程度用于描述自动驾驶车辆对障碍车的运动所造成的影响,流通度用于描述自动驾驶车辆所处环境中车辆的平均速度;基于任一个第一组合路线的各个参照信息和各个参考信息(也称为各个参照信息)对应的推荐指标函数的目标参数,确定任一个第一组合路线的推荐指标。Optionally, determining the recommended index of each first combination route based on the target parameter of the recommended index function includes: for any first combination route, obtaining at least one reference information of any first combination route, any reference information is any one of comfort, safety, speed of the autonomous driving vehicle, uncertainty, politeness and circulation, comfort is used to describe acceleration, safety is used to describe collision information, uncertainty is used to describe the concentration of trajectory points, politeness is used to describe the impact of the autonomous driving vehicle on the movement of the obstacle vehicle, and circulation is used to describe the average speed of vehicles in the environment where the autonomous driving vehicle is located; determining the recommended index of any first combination route based on each reference information of any first combination route and the target parameter of the recommended index function corresponding to each reference information (also referred to as each reference information).
本申请实施例中,任一个第一组合路线对应舒适度、安全度、自动驾驶车辆的速度、不确定度、礼貌程度以及流通度等参照信息中的至少一个。In the embodiment of the present application, any first combined route corresponds to at least one of reference information such as comfort, safety, speed of the autonomous driving vehicle, uncertainty, politeness, and circulation.
其中,舒适度用于描述自动驾驶车辆和/或障碍车的加速度,例如,舒适度包括自动驾驶车辆的加速度和障碍车的加速度,或者,舒适度包括自动驾驶车辆的加加速度和障碍车的加加速度,这里的加加速度可以用加速度的一阶导数也就是速度的二阶导数来表示,指加速度的加速度。Among them, comfort is used to describe the acceleration of the autonomous driving vehicle and/or the obstacle vehicle. For example, the comfort includes the acceleration of the autonomous driving vehicle and the acceleration of the obstacle vehicle, or the comfort includes the jerk of the autonomous driving vehicle and the jerk of the obstacle vehicle. The jerk here can be expressed by the first-order derivative of acceleration, that is, the second-order derivative of velocity, which refers to the acceleration of acceleration.
安全度用于描述自动驾驶车辆和障碍车之间的碰撞信息。由于第一组合路线包括障碍车的一个第一候选路线和自动驾驶车辆的一个第一候选路线,因此,自动驾驶车辆可以根据自动驾驶车辆的一个第一候选路线和障碍车的一个第一候选路线,预估出自动驾驶车辆和障碍车之间的碰撞信息。其中,碰撞信息包括碰撞时间和碰撞距离。Safety is used to describe the collision information between the autonomous driving vehicle and the obstacle vehicle. Since the first combined route includes a first candidate route for the obstacle vehicle and a first candidate route for the autonomous driving vehicle, the autonomous driving vehicle can estimate the collision information between the autonomous driving vehicle and the obstacle vehicle based on the first candidate route for the autonomous driving vehicle and the first candidate route for the obstacle vehicle. The collision information includes the collision time and the collision distance.
不确定度用于描述目标主体的轨迹点的集中程度,目标主体为障碍车或者自动驾驶车辆。也即是,不确定度用于描述障碍车和/或自动驾驶车辆的轨迹点的集中程度,轨迹点越集中,不确定度越小。可选地,障碍车的轨迹点分布信息满足高斯分布,同样地,自动驾驶车辆的轨迹点分布信息也满足高斯分布。可以将这两个高斯分布的方差之和或者平均值等,作为不确定度。Uncertainty is used to describe the concentration of the trajectory points of the target subject, which is an obstacle vehicle or an autonomous driving vehicle. That is, uncertainty is used to describe the concentration of the trajectory points of the obstacle vehicle and/or the autonomous driving vehicle. The more concentrated the trajectory points are, the smaller the uncertainty is. Optionally, the trajectory point distribution information of the obstacle vehicle satisfies the Gaussian distribution, and similarly, the trajectory point distribution information of the autonomous driving vehicle also satisfies the Gaussian distribution. The sum of the variances or the average value of the two Gaussian distributions can be used as uncertainty.
礼貌程度用于描述自动驾驶车辆对障碍车的运动所造成的影响。可选地,第一组合路线包括障碍车的一个第一候选路线和自动驾驶车辆的一个第一候选路线,可以基于障碍车的第一候选路线和自动驾驶车辆的第一候选路线,确定出礼貌程度。礼貌程度是衡量障碍车动作幅度的参数,此处的障碍车动作指的是障碍车为避免和自动驾驶车辆碰撞而执行的动作,例如,障碍车动作可以为减速,这种情况下,礼貌程度可以衡量减速幅度。其中,障碍车动作幅度越大,礼貌程度越大。The politeness level is used to describe the impact of the autonomous driving vehicle on the movement of the obstacle vehicle. Optionally, the first combined route includes a first candidate route for the obstacle vehicle and a first candidate route for the autonomous driving vehicle. The politeness level can be determined based on the first candidate route for the obstacle vehicle and the first candidate route for the autonomous driving vehicle. The politeness level is a parameter that measures the amplitude of the obstacle vehicle's movement. The obstacle vehicle movement here refers to the movement performed by the obstacle vehicle to avoid collision with the autonomous driving vehicle. For example, the obstacle vehicle movement can be deceleration. In this case, the politeness level can measure the amplitude of deceleration. Among them, the larger the amplitude of the obstacle vehicle's movement, the greater the politeness level.
流通度用于描述自动驾驶车辆所处环境中车辆的平均速度,因此,可以计算自动驾驶车 辆的平均速度和障碍车的平均速度,将自动驾驶车辆的平均速度和障碍车的平均速度之间的平均值,作为流通度。The circulation degree is used to describe the average speed of vehicles in the environment of the autonomous vehicle. Therefore, the circulation degree of the autonomous vehicle can be calculated. The average speed of the autonomous driving vehicles and the average speed of the obstacle vehicles are taken as the circulation degree.
接下来,将第一组合路线的各个参照信息和各个参考信息(也称为各个参照信息)对应的推荐指标函数的目标参数进行加权求和计算,得到该第一组合路线的推荐指标。例如,第一组合路线的推荐指标=舒适度*系数1+安全度*系数2+自动驾驶车辆的速度*系数3+不确定度*系数4+礼貌程度*系数5+流通度*系数6。其中,系数1为舒适度对应的推荐指标函数的目标参数。系数2为安全度对应的推荐指标函数的目标参数。系数3为自动驾驶车辆的速度对应的推荐指标函数的目标参数。系数4为不确定度对应的推荐指标函数的目标参数。系数5为礼貌程度对应的推荐指标函数的目标参数。系数6为流通度对应的推荐指标函数的目标参数。Next, the weighted sum of each reference information of the first combined route and the target parameter of the recommendation index function corresponding to each reference information (also referred to as each reference information) is calculated to obtain the recommendation index of the first combined route. For example, the recommendation index of the first combined route = comfort * coefficient 1 + safety * coefficient 2 + speed of the autonomous driving vehicle * coefficient 3 + uncertainty * coefficient 4 + politeness * coefficient 5 + circulation * coefficient 6. Among them, coefficient 1 is the target parameter of the recommendation index function corresponding to comfort. Coefficient 2 is the target parameter of the recommendation index function corresponding to safety. Coefficient 3 is the target parameter of the recommendation index function corresponding to the speed of the autonomous driving vehicle. Coefficient 4 is the target parameter of the recommendation index function corresponding to uncertainty. Coefficient 5 is the target parameter of the recommendation index function corresponding to politeness. Coefficient 6 is the target parameter of the recommendation index function corresponding to circulation.
步骤2074,从至少一个第一组合路线中选择推荐指标最高的第一组合路线,将推荐指标最高的第一组合路线包括的自动驾驶车辆的第一候选路线作为试探路线。Step 2074: Select a first combined route with a highest recommendation index from at least one first combined route, and use the first candidate route of the autonomous driving vehicle included in the first combined route with the highest recommendation index as a trial route.
本申请实施例中,可以将至少一个第一组合路线按照推荐指标从高到低的顺序进行排序,得到排序后的各个第一组合路线。将排序后的第一个第一组合路线作为第一联合路线。当然,在应用时,也可以将至少一个第一组合路线按照推荐指标从低到高的顺序进行排序,得到排序后的各个第一组合路线。将排序后的最后一个第一组合路线作为第一联合路线。第一联合路线包括障碍车的一个第一候选路线和自动驾驶车辆的一个第一候选路线,其中,障碍车的第一候选路线为障碍车在当前时间周期对应的期望行驶轨迹,自动驾驶车辆的第一候选路线为自动驾驶车辆在当前时间周期对应的试探路线。In an embodiment of the present application, at least one first combination route can be sorted in descending order according to the recommended index to obtain the sorted first combination routes. The first sorted first combination route is used as the first joint route. Of course, when applied, at least one first combination route can also be sorted in descending order according to the recommended index to obtain the sorted first combination routes. The last sorted first combination route is used as the first joint route. The first joint route includes a first candidate route for the obstacle vehicle and a first candidate route for the autonomous driving vehicle, wherein the first candidate route for the obstacle vehicle is the expected driving trajectory corresponding to the obstacle vehicle in the current time period, and the first candidate route for the autonomous driving vehicle is the trial route corresponding to the autonomous driving vehicle in the current time period.
需要说明的是,第一联合路线需要满足交通规则。例如,满足交通规则包括在道路上行驶的自动驾驶车辆和障碍车不能相撞,则自动驾驶车辆的试探路线和障碍车的期望行驶轨迹不存在交点。又比如,满足交通规则包括以障碍车的行驶方向作为正方向,障碍车靠近道路右侧行驶,则自动驾驶车辆的试探路线和障碍车的期望行驶轨迹均满足靠近道路右侧。It should be noted that the first joint route needs to meet traffic rules. For example, meeting traffic rules includes that the autonomous driving vehicle and the obstacle vehicle on the road cannot collide, so there is no intersection between the trial route of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle. For another example, meeting traffic rules includes taking the driving direction of the obstacle vehicle as the positive direction and the obstacle vehicle driving close to the right side of the road, so both the trial route of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle meet the requirement of being close to the right side of the road.
在一种可能的实现方式中,步骤207包括步骤2075至步骤2077。In a possible implementation, step 207 includes steps 2075 to 2077 .
步骤2075,响应于历史偏差信息不小于第一阈值,则获取至少一个映射关系,任一个映射关系用于描述行驶轨迹集合和参考路线之间的映射关系,行驶轨迹集合包括至少一个行驶轨迹。Step 2075: In response to the historical deviation information being not less than the first threshold, obtaining at least one mapping relationship, any one of which is used to describe the mapping relationship between the driving trajectory set and the reference route, and the driving trajectory set includes at least one driving trajectory.
本申请实施例中,当历史偏差信息不小于第一阈值时,说明障碍车的历史期望行驶轨迹与障碍车的历史实际行驶轨迹之间的差异较大,不符合自动驾驶车辆的期望。自动驾驶车辆可以直接确定出自动驾驶车辆在当前时间周期的试探路线。In the embodiment of the present application, when the historical deviation information is not less than the first threshold, it indicates that the difference between the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle is large, which does not meet the expectations of the autonomous driving vehicle. The autonomous driving vehicle can directly determine the trial route of the autonomous driving vehicle in the current time period.
自动驾驶车辆可以配置有至少一个映射关系。在历史偏差信息不小于第一阈值时,自动驾驶车辆可以调用各个映射关系。任一个映射关系用于描述行驶轨迹集合和参考路线之间的映射关系,行驶轨迹集合包括至少一个行驶轨迹。对于一个映射关系而言,该映射关系用于描述哪个行驶轨迹集合和参考路线之间的映射关系,或者说,该映射关系包括哪个行驶轨迹集合和参考路线,则哪个行驶轨迹集合即为该映射关系对应的行驶轨迹集合,哪个参考路线即为该映射关系对应的参考路线。The autonomous driving vehicle may be configured with at least one mapping relationship. When the historical deviation information is not less than a first threshold, the autonomous driving vehicle may call each mapping relationship. Any mapping relationship is used to describe the mapping relationship between a driving trajectory set and a reference route, and the driving trajectory set includes at least one driving trajectory. For a mapping relationship, the mapping relationship is used to describe the mapping relationship between which driving trajectory set and the reference route, or in other words, which driving trajectory set and reference route the mapping relationship includes, then which driving trajectory set is the driving trajectory set corresponding to the mapping relationship, and which reference route is the reference route corresponding to the mapping relationship.
步骤2076,从至少一个映射关系中选择行驶轨迹集合与自动驾驶车辆的历史实际行驶轨迹和障碍车的历史实际行驶轨迹相匹配的目标映射关系。或者说,从至少一个映射关系中选择目标映射关系,目标映射关系对应的行驶轨迹集合包括的至少一个行驶轨迹,与自动驾驶车辆的历史实际行驶轨迹和障碍车的历史实际行驶轨迹相匹配。Step 2076: Select a target mapping relationship from at least one mapping relationship, in which the driving trajectory set matches the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle. In other words, select a target mapping relationship from at least one mapping relationship, in which the driving trajectory set corresponding to the target mapping relationship includes at least one driving trajectory that matches the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle.
自动驾驶车辆可以将各个映射关系与历史实际轨迹集合进行匹配,其中,历史实际轨迹集合包括自动驾驶车辆的历史实际行驶轨迹和障碍车的历史实际行驶轨迹。The autonomous driving vehicle can match each mapping relationship with a historical actual trajectory set, where the historical actual trajectory set includes the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle.
对于任一个映射关系,若该映射关系中的行驶轨迹集合与历史实际轨迹集合匹配,则将该映射关系确定为目标映射关系。本申请实施例不对行驶轨迹集合与历史实际轨迹集合进行匹配的方式做限定。示例性的,若行驶轨迹集合中各个行驶轨迹与历史实际轨迹集合中各个历史实际行驶轨迹相同,则行驶轨迹集合与历史实际轨迹集合相匹配。For any mapping relationship, if the driving trajectory set in the mapping relationship matches the historical actual trajectory set, the mapping relationship is determined as the target mapping relationship. The embodiment of the present application does not limit the way in which the driving trajectory set is matched with the historical actual trajectory set. Exemplarily, if each driving trajectory in the driving trajectory set is the same as each historical actual driving trajectory in the historical actual trajectory set, the driving trajectory set matches the historical actual trajectory set.
步骤2077,将目标映射关系对应的参考路线确定为试探路线。Step 2077: determine the reference route corresponding to the target mapping relationship as the trial route.
目标映射关系描述了行驶轨迹集合和参考路线之间的映射关系,可以将目标映射关系对应的参考路线确定为自动驾驶车辆的试探路线。The target mapping relationship describes the mapping relationship between the driving trajectory set and the reference route. The reference route corresponding to the target mapping relationship can be determined as the trial route of the autonomous driving vehicle.
可选地,步骤2077之后还包括:基于试探路线和障碍车的历史实际行驶轨迹,确定障碍车的至少一个第二候选路线;将障碍车的任一个第二候选路线和试探路线进行组合,得到任 一个第二组合路线;确定各个第二组合路线的推荐指标,从各个第二组合路线中选择推荐指标最高的第二组合路线。Optionally, after step 2077, the method further includes: determining at least one second candidate route of the obstacle vehicle based on the trial route and the historical actual driving trajectory of the obstacle vehicle; combining any second candidate route of the obstacle vehicle with the trial route to obtain any second candidate route of the obstacle vehicle; a second combination route; determining the recommended index of each second combination route, and selecting the second combination route with the highest recommended index from each second combination route.
自动驾驶车辆通过分析自动驾驶车辆的试探路线,可以得到自动驾驶车辆的行驶意图,通过分析障碍车的历史实际行驶轨迹,可以得到障碍车的行驶意图,从而得到自动驾驶车辆所处环境中所有主体的行驶意图。基于环境中所有主体的行驶意图可以规划出障碍车的至少一个第二候选路线。其中,障碍车的第二候选路线的生成原理与目标主体的第一候选路线的生成原理相类似,可以参见步骤2071中的说明,在此不再赘述。The autonomous vehicle can obtain the driving intention of the autonomous vehicle by analyzing the trial route of the autonomous vehicle, and can obtain the driving intention of the obstacle vehicle by analyzing the historical actual driving trajectory of the obstacle vehicle, thereby obtaining the driving intention of all subjects in the environment where the autonomous vehicle is located. Based on the driving intention of all subjects in the environment, at least one second candidate route of the obstacle vehicle can be planned. Among them, the generation principle of the second candidate route of the obstacle vehicle is similar to the generation principle of the first candidate route of the target subject, which can be referred to the description in step 2071 and will not be repeated here.
从障碍车的至少一个第二候选路线中随机采样出障碍车的一个第二候选路线。将自动驾驶车辆的试探路线和采样出的障碍车的一个第二候选路线视作第二组合路线。通过这种方式,可以确定出至少一个第二组合路线。A second candidate route for the obstacle vehicle is randomly sampled from at least one second candidate route for the obstacle vehicle. The trial route of the autonomous driving vehicle and the sampled second candidate route for the obstacle vehicle are regarded as a second combined route. In this way, at least one second combined route can be determined.
可以利用推荐指标函数确定第二组合路线的推荐指标,第二组合路线的推荐指标越大,表明第二组合路线越好,自动驾驶车辆基于第二组合路线中的试探路线进行运动且障碍车基于第二组合路线中障碍车的第二候选路线进行运动时,自动驾驶车辆和障碍车的安全性越高。其中,第二组合路线的推荐指标的确定方式与第一组合路线的推荐指标的确定方式相类似,参见上文步骤2073中的说明,在此不再赘述。The recommended index function can be used to determine the recommended index of the second combined route. The larger the recommended index of the second combined route, the better the second combined route. When the autonomous driving vehicle moves based on the trial route in the second combined route and the obstacle vehicle moves based on the second candidate route of the obstacle vehicle in the second combined route, the safety of the autonomous driving vehicle and the obstacle vehicle is higher. The method for determining the recommended index of the second combined route is similar to the method for determining the recommended index of the first combined route. See the description in step 2073 above, which will not be repeated here.
可以将至少一个第二组合路线按照推荐指标从高到低的顺序进行排序,得到排序后的各个第二组合路线。将排序后的第一个第二组合路线作为第一联合路线。当然,在应用时,也可以将至少一个第二组合路线按照推荐指标从低到高的顺序进行排序,得到排序后的各个第二组合路线。将排序后的最后一个第二组合路线作为第一联合路线。第一联合路线包括障碍车的试探路线和自动驾驶车辆的一个第二候选路线,障碍车的第二候选路线为障碍车在当前时间周期对应的期望行驶轨迹。At least one second combined route may be sorted in descending order according to the recommended index to obtain the sorted second combined routes. The first sorted second combined route is used as the first joint route. Of course, when applied, at least one second combined route may also be sorted in descending order according to the recommended index to obtain the sorted second combined routes. The last sorted second combined route is used as the first joint route. The first joint route includes a trial route of the obstacle vehicle and a second candidate route of the autonomous driving vehicle, and the second candidate route of the obstacle vehicle is the expected driving trajectory corresponding to the obstacle vehicle in the current time period.
步骤202,在自动驾驶车辆按照试探路线进行行驶的过程中,获取障碍车的相关信息。Step 202: while the autonomous driving vehicle is driving along the trial route, obtain relevant information of the obstacle vehicle.
自动驾驶车辆可以获取到第一联合路线,该第一联合路线包括自动驾驶车辆的试探路线和障碍车的期望行驶轨迹。在当前时间周期内,通过控制自动驾驶车辆按照试探路线进行运动,可以试探性地引导障碍车按照障碍车的期望行驶轨迹进行运动,以使障碍车尽快展示障碍车的行驶意图。The autonomous driving vehicle may obtain a first combined route, which includes the trial route of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle. In the current time period, by controlling the autonomous driving vehicle to move according to the trial route, the obstacle vehicle may be tentatively guided to move according to the expected driving trajectory of the obstacle vehicle, so that the obstacle vehicle may show the driving intention of the obstacle vehicle as soon as possible.
请参见图6,图6是本申请实施例提供的一种车辆运动的示意图。其中,自动驾驶车辆为车辆A,且自动驾驶车辆的试探路线为A-m,障碍车为车辆B。在当前时间周期内控制自动驾驶车辆按照A-m进行运动,以试探性地引导障碍车按照障碍车的期望行驶轨迹B-m1进行运动。通过自动驾驶车辆和障碍车的试探性博弈,可以让障碍车更快地表现出行驶意图,从而使自动驾驶车辆可提早进行决策,提高自动驾驶车辆的行车安全性。Please refer to Figure 6, which is a schematic diagram of vehicle movement provided by an embodiment of the present application. Among them, the autonomous driving vehicle is vehicle A, and the trial route of the autonomous driving vehicle is A-m, and the obstacle vehicle is vehicle B. In the current time period, the autonomous driving vehicle is controlled to move according to A-m, so as to tentatively guide the obstacle vehicle to move according to the expected driving trajectory B-m1 of the obstacle vehicle. Through the tentative game between the autonomous driving vehicle and the obstacle vehicle, the obstacle vehicle can express its driving intention more quickly, so that the autonomous driving vehicle can make decisions earlier and improve the driving safety of the autonomous driving vehicle.
此外,在当前时间周期内障碍车B的实际行驶轨迹为B-m2,也就是说,障碍车B先从道路中间往自身的右侧靠近,再往自身的左侧靠近,之后保持直行。一般情况下,障碍车B往自身的左侧靠近,则自动驾驶车辆A也需要往自身的左侧靠近,但本申请实施例由于在当前时间周期内控制自动驾驶车辆A会持续性的按照A-m进行运动,即使障碍车B往自身的左侧靠近,自动驾驶车辆也不会更改运动方向,从而避免了自动驾驶车辆因盲目的向障碍车妥协而导致被堵塞在原地、自动驾驶车辆产生剧烈的抖动等现象,提高了自动驾驶车辆的运动效率和抗噪声性能。In addition, the actual driving trajectory of the obstacle vehicle B in the current time period is B-m2, that is, the obstacle vehicle B first approaches the right side of itself from the middle of the road, then approaches the left side of itself, and then keeps going straight. In general, if the obstacle vehicle B approaches the left side of itself, the autonomous driving vehicle A also needs to approach the left side of itself. However, in the embodiment of the present application, the autonomous driving vehicle A is controlled to move continuously according to A-m in the current time period. Even if the obstacle vehicle B approaches the left side of itself, the autonomous driving vehicle will not change the direction of movement, thereby avoiding the phenomenon that the autonomous driving vehicle is blocked in place due to blindly compromising with the obstacle vehicle, and the autonomous driving vehicle produces violent shaking, etc., and improves the movement efficiency and anti-noise performance of the autonomous driving vehicle.
由于自动驾驶车辆配置有传感器,因此,在当前时间周期内,自动驾驶车辆的传感器可以多次感知障碍车的实际位置,在每次感知到实际位置时,可以得到感知时的时间。因此,自动驾驶车辆可以获取到障碍车在当前时间周期内的实际行驶轨迹,障碍车的实际行驶轨迹包括多个实际轨迹点的位置信息和该障碍车到达各个实际轨迹点的时间信息。障碍车的实际行驶轨迹即为障碍车的相关信息。Since the autonomous driving vehicle is equipped with sensors, the sensors of the autonomous driving vehicle can sense the actual position of the obstacle vehicle multiple times in the current time period, and the time of sensing each time can be obtained. Therefore, the autonomous driving vehicle can obtain the actual driving trajectory of the obstacle vehicle in the current time period, and the actual driving trajectory of the obstacle vehicle includes the position information of multiple actual trajectory points and the time information of the obstacle vehicle arriving at each actual trajectory point. The actual driving trajectory of the obstacle vehicle is the relevant information of the obstacle vehicle.
步骤203,根据障碍车的相关信息确定障碍车的行驶意图。Step 203: determining the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle.
自动驾驶车辆通过分析障碍车的实际行驶轨迹,可以确定出障碍车的行驶意图。障碍车的行驶意图反应了障碍车的运动趋势,例如,障碍车趋向于减速左转,则障碍车的行驶意图可以反应出减速左转的信息。The autonomous driving vehicle can determine the driving intention of the obstacle vehicle by analyzing its actual driving trajectory. The driving intention of the obstacle vehicle reflects the movement trend of the obstacle vehicle. For example, if the obstacle vehicle tends to slow down and turn left, the driving intention of the obstacle vehicle can reflect the information of slowing down and turning left.
在一种可能的实现方式中,步骤203包括:根据障碍车的相关信息确定障碍车在时间维度的意图;根据障碍车的相关信息确定障碍车在空间维度的意图;将障碍车在时间维度的意图和障碍车在空间维度的意图确定为障碍车的行驶意图。In a possible implementation, step 203 includes: determining the intention of the obstacle vehicle in the time dimension according to the relevant information of the obstacle vehicle; determining the intention of the obstacle vehicle in the space dimension according to the relevant information of the obstacle vehicle; and determining the intention of the obstacle vehicle in the time dimension and the intention of the obstacle vehicle in the space dimension as the driving intention of the obstacle vehicle.
本申请实施例中,自动驾驶车辆通过分析障碍车的实际行驶轨迹,可以确定出障碍车在 时间维度的意图,障碍车在时间维度的意图可以反应障碍车运动快慢的趋势。更通俗的讲,障碍车在时间维度的意图能反应障碍车接下来会加速行驶或者障碍车会保持匀速行驶或者障碍车会减速行驶。In the embodiment of the present application, the autonomous driving vehicle can determine the location of the obstacle vehicle by analyzing the actual driving trajectory of the obstacle vehicle. The intention of the obstacle car in the time dimension can reflect the trend of the obstacle car's movement speed. In more popular terms, the intention of the obstacle car in the time dimension can reflect whether the obstacle car will accelerate, maintain a constant speed, or slow down.
自动驾驶车辆通过分析障碍车的实际行驶轨迹,可以确定出障碍车在空间维度的意图,障碍车在空间维度的意图可以反应障碍车运动方向的趋势。也就是说,障碍车在空间维度的意图能反应障碍车接下来会靠道路左侧行驶还是靠道路右侧行驶。By analyzing the actual driving trajectory of the obstacle vehicle, the autonomous vehicle can determine the intention of the obstacle vehicle in the spatial dimension, and the intention of the obstacle vehicle in the spatial dimension can reflect the trend of the obstacle vehicle's movement direction. In other words, the intention of the obstacle vehicle in the spatial dimension can reflect whether the obstacle vehicle will drive on the left side of the road or on the right side of the road next.
可以将障碍车在时间维度的意图和障碍车在空间维度的意图进行结合,得到障碍车的行驶意图。因此,障碍车的行驶意图可以反应障碍车运动方向和运动速度的趋势。例如,障碍车的行驶意图可以反应障碍车接下来会加速行驶且向道路左侧靠近,这种情况下,障碍车会迅速地向道路左侧靠近;或者,障碍车的行驶意图可以反应障碍车接下来会减速行驶且向道路左侧靠近,这种情况下,障碍车会缓慢地向道路左侧靠近。The intention of the obstacle vehicle in the time dimension and the intention of the obstacle vehicle in the space dimension can be combined to obtain the driving intention of the obstacle vehicle. Therefore, the driving intention of the obstacle vehicle can reflect the trend of the movement direction and movement speed of the obstacle vehicle. For example, the driving intention of the obstacle vehicle can reflect that the obstacle vehicle will accelerate and approach the left side of the road next. In this case, the obstacle vehicle will quickly approach the left side of the road; or, the driving intention of the obstacle vehicle can reflect that the obstacle vehicle will decelerate and approach the left side of the road next. In this case, the obstacle vehicle will slowly approach the left side of the road.
步骤204,至少根据障碍车的行驶意图对自动驾驶车辆进行自动驾驶决策规划。Step 204, performing autonomous driving decision planning for the autonomous driving vehicle at least based on the driving intention of the obstacle vehicle.
自动驾驶车辆可以根据障碍车的行驶意图进行自动驾驶决策规划,以规划出第二联合路线,该第二联合路线包括自动驾驶车辆在下一时间周期的试探路线和障碍车在下一时间周期的期望行驶轨迹。其中,第二联合路线和第一联合路线的确定方式相类似,在此不再赘述。The autonomous driving vehicle can make autonomous driving decision planning according to the driving intention of the obstacle vehicle to plan a second joint route, which includes the trial route of the autonomous driving vehicle in the next time period and the expected driving trajectory of the obstacle vehicle in the next time period. The second joint route is determined in a similar manner to the first joint route, which will not be described in detail here.
在一种可能的实现方式中,步骤204包括:响应于障碍车的行驶意图发生改变,至少根据障碍车的行驶意图确定障碍车的目标行驶路线;基于障碍车的目标行驶路线确定自动驾驶车辆的目标行驶路线。In one possible implementation, step 204 includes: in response to a change in the driving intention of the obstacle vehicle, determining a target driving route of the obstacle vehicle at least according to the driving intention of the obstacle vehicle; and determining a target driving route of the autonomous driving vehicle based on the target driving route of the obstacle vehicle.
当确定出障碍车的行驶意图时,可以确定障碍车的行驶意图是否发生改变,其中,此处障碍车的行驶意图指的是障碍车在当前时间周期的行驶意图。可选地,自动驾驶车辆可以获取障碍车在历史时间周期的行驶意图,其中,障碍车在历史时间周期的行驶意图是通过分析障碍车的历史实际行驶轨迹得到的,历史时间周期是当前时间周期之前的时间周期。通过对比障碍车在当前时间周期的行驶意图和障碍车在历史时间周期的行驶意图,确定障碍车在当前时间周期的行驶意图是否改变。When the driving intention of the obstacle vehicle is determined, it can be determined whether the driving intention of the obstacle vehicle has changed, wherein the driving intention of the obstacle vehicle here refers to the driving intention of the obstacle vehicle in the current time period. Optionally, the autonomous driving vehicle can obtain the driving intention of the obstacle vehicle in the historical time period, wherein the driving intention of the obstacle vehicle in the historical time period is obtained by analyzing the historical actual driving trajectory of the obstacle vehicle, and the historical time period is the time period before the current time period. By comparing the driving intention of the obstacle vehicle in the current time period with the driving intention of the obstacle vehicle in the historical time period, it is determined whether the driving intention of the obstacle vehicle in the current time period has changed.
由于障碍车的历史实际行驶轨迹与自动驾驶车辆的历史实际行驶轨迹冲突,即障碍车与自动驾驶车辆的行驶路线存在冲突,因此,当障碍车的行驶意图发生改变时,说明障碍车表现出解决冲突的意图,此时自动驾驶车辆可以向障碍车妥协,在保证障碍车按照其行驶意图行驶的同时,规划出自动驾驶车辆的行驶路线,以使障碍车和自动驾驶车辆协作运动,保证行车安全性。因此,本申请实施例会先根据障碍车的行驶意图确定障碍车的目标行驶路线,以便于障碍车按照其目标行驶路线进行运动,保证障碍车按照其行驶意图行驶。接着,自动驾驶车辆基于障碍车的目标行驶路线确定自动驾驶车辆的目标行驶路线,且自动驾驶车辆的目标行驶路线和障碍车的目标行驶路线需要满足交通规则,以保证自动驾驶车辆和障碍车能够安全的行驶。Since the historical actual driving trajectory of the obstacle vehicle conflicts with the historical actual driving trajectory of the autonomous driving vehicle, that is, there is a conflict between the driving routes of the obstacle vehicle and the autonomous driving vehicle, therefore, when the driving intention of the obstacle vehicle changes, it means that the obstacle vehicle shows the intention to resolve the conflict. At this time, the autonomous driving vehicle can compromise with the obstacle vehicle, and plan the driving route of the autonomous driving vehicle while ensuring that the obstacle vehicle drives according to its driving intention, so that the obstacle vehicle and the autonomous driving vehicle can move in cooperation to ensure driving safety. Therefore, the embodiment of the present application will first determine the target driving route of the obstacle vehicle according to the driving intention of the obstacle vehicle, so that the obstacle vehicle moves according to its target driving route and ensures that the obstacle vehicle drives according to its driving intention. Next, the autonomous driving vehicle determines the target driving route of the autonomous driving vehicle based on the target driving route of the obstacle vehicle, and the target driving route of the autonomous driving vehicle and the target driving route of the obstacle vehicle need to meet traffic rules to ensure that the autonomous driving vehicle and the obstacle vehicle can drive safely.
在一种可能的实现方式中,步骤204包括:响应于障碍车的行驶意图未改变,获取自动驾驶车辆与障碍车之间的距离;若自动驾驶车辆与障碍车之间的距离小于距离阈值,则控制自动驾驶车辆停止行驶。In one possible implementation, step 204 includes: in response to the obstacle vehicle's driving intention not changing, obtaining the distance between the autonomous driving vehicle and the obstacle vehicle; if the distance between the autonomous driving vehicle and the obstacle vehicle is less than a distance threshold, controlling the autonomous driving vehicle to stop driving.
当障碍车的行驶意图未发生改变时,说明障碍车没有表现出解决冲突的意图,此时,需要获取自动驾驶车辆和位置和障碍车的位置,以基于自动驾驶车辆和位置和障碍车的位置,计算出自动驾驶车辆与障碍车之间的距离。When the driving intention of the obstacle vehicle has not changed, it means that the obstacle vehicle has no intention to resolve the conflict. At this time, it is necessary to obtain the position of the autonomous driving vehicle and the position of the obstacle vehicle to calculate the distance between the autonomous driving vehicle and the obstacle vehicle based on the position of the autonomous driving vehicle and the position of the obstacle vehicle.
当自动驾驶车辆与障碍车之间的距离小于距离阈值时,说明自动驾驶车辆即将与障碍车碰撞,此时可以控制自动驾驶车辆停止行驶,以主动避免碰撞。当自动驾驶车辆与障碍车之间的距离不小于距离阈值时,说明自动驾驶车辆在短时间内不会与障碍车碰撞,此时可以根据障碍车的行驶意图,规划出第二联合路线,第二联合路线包括自动驾驶车辆在下一时间周期的试探路线和障碍车在下一时间周期的期望行驶轨迹,以便于自动驾驶车辆在下一时间周期按照该试探路线进行行驶。When the distance between the autonomous driving vehicle and the obstacle vehicle is less than the distance threshold, it means that the autonomous driving vehicle is about to collide with the obstacle vehicle. At this time, the autonomous driving vehicle can be controlled to stop driving to actively avoid the collision. When the distance between the autonomous driving vehicle and the obstacle vehicle is not less than the distance threshold, it means that the autonomous driving vehicle will not collide with the obstacle vehicle in a short time. At this time, a second joint route can be planned according to the driving intention of the obstacle vehicle. The second joint route includes the trial route of the autonomous driving vehicle in the next time period and the expected driving trajectory of the obstacle vehicle in the next time period, so that the autonomous driving vehicle can drive according to the trial route in the next time period.
在一种可能的实现方式中,步骤204包括:至少根据障碍车的行驶意图和推荐指标最高的第二组合路线,对自动驾驶车辆进行自动驾驶决策规划。In one possible implementation, step 204 includes: performing autonomous driving decision planning for the autonomous driving vehicle based at least on the driving intention of the obstacle vehicle and the second combined route with the highest recommended index.
本申请实施例中,第一联合路线为推荐指标最高的第二组合路线。推荐指标最高的第二组合路线包括自动驾驶车辆的试探路线和障碍车的一个第二候选路线。其中,在当前时间周期内,自动驾驶车辆按照其试探路线进行行驶的同时,获取障碍车的相关信息,自动驾驶车辆的试探路线即为自动驾驶车辆的期望行驶轨迹,也为自动驾驶车辆的实际行驶轨迹,障碍 车的第二候选路线即为障碍车的期望行驶轨迹,障碍车的相关信息即为障碍车的实际行驶轨迹。自动驾驶车辆可以根据障碍车的行驶意图和推荐指标最高的第二组合路线,对自动驾驶车辆进行自动驾驶决策规划,以规划出第二联合路线,可以参照第一联合路线的确定方式,在此不再赘述。In the embodiment of the present application, the first combined route is the second combined route with the highest recommendation index. The second combined route with the highest recommendation index includes the trial route of the autonomous driving vehicle and a second candidate route of the obstacle vehicle. In the current time period, the autonomous driving vehicle drives along its trial route while obtaining relevant information of the obstacle vehicle. The trial route of the autonomous driving vehicle is the expected driving trajectory of the autonomous driving vehicle and also the actual driving trajectory of the autonomous driving vehicle. The second candidate route of the vehicle is the expected driving trajectory of the obstacle vehicle, and the relevant information of the obstacle vehicle is the actual driving trajectory of the obstacle vehicle. The autonomous driving vehicle can make autonomous driving decision planning for the autonomous driving vehicle according to the driving intention of the obstacle vehicle and the second combined route with the highest recommended index to plan the second combined route, which can refer to the determination method of the first combined route and will not be repeated here.
基于同样的原理,当第一联合路线为推荐指标最高的第一组合路线时,自动驾驶车辆至少根据障碍车的行驶意图和推荐指标最高的第一组合路线,对自动驾驶车辆进行自动驾驶决策规划。其中,推荐指标最高的第一组合路线包括障碍车的第一候选路线和自动驾驶车辆的第一候选路线,障碍车的第一候选路线为障碍车的期望行驶轨迹,自动驾驶车辆的第一候选路线为自动驾驶车辆的试探路线,也为自动驾驶车辆的实际行驶轨迹。Based on the same principle, when the first joint route is the first combined route with the highest recommended index, the autonomous driving vehicle performs autonomous driving decision planning for the autonomous driving vehicle at least based on the driving intention of the obstacle vehicle and the first combined route with the highest recommended index. Among them, the first combined route with the highest recommended index includes the first candidate route of the obstacle vehicle and the first candidate route of the autonomous driving vehicle, the first candidate route of the obstacle vehicle is the expected driving trajectory of the obstacle vehicle, and the first candidate route of the autonomous driving vehicle is the trial route of the autonomous driving vehicle, which is also the actual driving trajectory of the autonomous driving vehicle.
综合步骤201至步骤204的内容可知,自动驾驶车辆在当前时间周期的上一时间周期内确定出当前时间周期对应的第一联合路线。在当前时间周期内,控制自动驾驶车辆按照第一联合路线中的试探路线进行运动,获取障碍车的实际行驶轨迹,并基于第一联合路线中的障碍车的期望行驶轨迹和障碍车的实际行驶轨迹,确定出当前时间周期的下一时间周期对应的第二联合路线。在下一时间周期内基于第二联合路线重复执行在当前时间周期内基于第一联合路线执行的内容。Based on the contents of step 201 to step 204, it can be seen that the autonomous driving vehicle determines the first joint route corresponding to the current time period in the previous time period of the current time period. In the current time period, the autonomous driving vehicle is controlled to move according to the trial route in the first joint route, obtain the actual driving trajectory of the obstacle vehicle, and determine the second joint route corresponding to the next time period of the current time period based on the expected driving trajectory of the obstacle vehicle in the first joint route and the actual driving trajectory of the obstacle vehicle. In the next time period, the contents executed based on the first joint route in the current time period are repeatedly executed based on the second joint route.
下面结合图7来进行描述,图7是本申请实施例提供的一种自动驾驶决策规划方法的框架示意图。该框架包括前向模仿和在线估算,其中前向模仿用于生成联合路线。联合路线包括自动驾驶车辆的期望行驶轨迹和障碍车的期望行驶轨迹,可以统称为期望行驶轨迹。其中,当前时间周期对应的期望行驶轨迹即为上文提及的第一联合路线,下一时间周期对应的期望行驶轨迹即为上文提及的第二联合路线。The following description is made in conjunction with Figure 7, which is a schematic diagram of the framework of an autonomous driving decision-making planning method provided in an embodiment of the present application. The framework includes forward imitation and online estimation, wherein forward imitation is used to generate a joint route. The joint route includes the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle, which can be collectively referred to as the expected driving trajectory. Among them, the expected driving trajectory corresponding to the current time period is the first joint route mentioned above, and the expected driving trajectory corresponding to the next time period is the second joint route mentioned above.
自动驾驶车辆可以在当前时间周期的上一时间周期生成第一联合路线,以便于自动驾驶车辆在当前时间周期按照第一联合路线中自动驾驶车辆的期望行驶轨迹(即试探路线)进行运动。The autonomous driving vehicle may generate a first joint route in the previous time period of the current time period so that the autonomous driving vehicle moves according to the expected driving trajectory (i.e., the trial route) of the autonomous driving vehicle in the first joint route in the current time period.
在上一时间周期,一方面,自动驾驶车辆可以获取上一时间周期对应的期望行驶轨迹(即上文提及的障碍车的历史期望行驶轨迹和自动驾驶车辆的历史期望行驶轨迹),另一方面,自动驾驶车辆可以观测到上一时间周期对应的实际行驶轨迹(即上文提及的障碍车的历史实际行驶轨迹和自动驾驶车辆的历史实际行驶轨迹)。基于期望行驶轨迹和实际行驶轨迹进行在线估算,得到完美贝叶斯均衡误差(即上文提及的历史偏差信息)。In the previous time period, on the one hand, the autonomous driving vehicle can obtain the expected driving trajectory corresponding to the previous time period (i.e. the historical expected driving trajectory of the obstacle vehicle and the historical expected driving trajectory of the autonomous driving vehicle mentioned above), and on the other hand, the autonomous driving vehicle can observe the actual driving trajectory corresponding to the previous time period (i.e. the historical actual driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the autonomous driving vehicle mentioned above). Based on the expected driving trajectory and the actual driving trajectory, online estimation is performed to obtain the perfect Bayesian equilibrium error (i.e. the historical deviation information mentioned above).
需要说明的是,由于自动驾驶车辆是按照自动驾驶车辆的历史期望行驶轨迹进行运动的,因此,自动驾驶车辆的历史期望行驶轨迹与自动驾驶车辆的历史实际行驶轨迹之间的差异较小,可以忽略不计。也就是说,自动驾驶车辆的历史期望行驶轨迹即为自动驾驶车辆的历史实际行驶轨迹。It should be noted that since the autonomous driving vehicle moves according to the historical expected driving trajectory of the autonomous driving vehicle, the difference between the historical expected driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the autonomous driving vehicle is small and can be ignored. In other words, the historical expected driving trajectory of the autonomous driving vehicle is the historical actual driving trajectory of the autonomous driving vehicle.
若完美贝叶斯均衡误差小于第一阈值,则由轨迹点分布估算器计算出障碍车的轨迹点分布信息和自动驾驶车辆的轨迹点分布信息,由回报参数估算器估算出回报函数(即上文提及的推荐指标函数)的参数分布信息。If the perfect Bayesian equilibrium error is less than the first threshold, the trajectory point distribution information of the obstacle vehicle and the trajectory point distribution information of the autonomous driving vehicle are calculated by the trajectory point distribution estimator, and the parameter distribution information of the reward function (i.e., the recommended indicator function mentioned above) is estimated by the reward parameter estimator.
这种情况下,在前向模仿时,可以基于障碍车的轨迹点分布信息生成障碍车的多个轨迹点,通过对多个轨迹点进行目标轨迹点采样,得到障碍车的一个候选路线,采用同样的方式可以得到自动驾驶车辆的一个候选路线。将障碍车的各个候选路线和自动驾驶车辆的各个候选路线进行组合,可以实现组合路线生成(对应于上文提及的第一组合路线)。由回报函数估算器基于回报函数的参数分布信息生成回报函数的多个候选参数,通过从多个候选参数中采样,得到回报函数的目标参数。之后,基于回报函数的目标参数确定各个组合路线的推荐指标,从中选择推荐指标最高的组合路线,作为当前时间周期对应的联合路线。In this case, during forward imitation, multiple trajectory points of the obstacle vehicle can be generated based on the trajectory point distribution information of the obstacle vehicle, and a candidate route for the obstacle vehicle can be obtained by sampling the target trajectory points of the multiple trajectory points. In the same way, a candidate route for the autonomous driving vehicle can be obtained. By combining the candidate routes of the obstacle vehicle and the candidate routes of the autonomous driving vehicle, a combined route generation (corresponding to the first combined route mentioned above) can be achieved. The reward function estimator generates multiple candidate parameters of the reward function based on the parameter distribution information of the reward function, and obtains the target parameters of the reward function by sampling from the multiple candidate parameters. Afterwards, the recommended indicators of each combined route are determined based on the target parameters of the reward function, and the combined route with the highest recommended indicator is selected as the joint route corresponding to the current time period.
若完美贝叶斯均衡误差不小于第一阈值,则基于完美贝叶斯均衡误差可以确定出自动驾驶车辆的期望行驶轨迹,由轨迹点分布估算器计算出障碍车的轨迹点分布信息,由回报参数估算器估算出回报函数(即上文提及的推荐指标函数)的参数分布信息。If the perfect Bayesian equilibrium error is not less than the first threshold, the expected driving trajectory of the autonomous driving vehicle can be determined based on the perfect Bayesian equilibrium error, the trajectory point distribution information of the obstacle vehicle can be calculated by the trajectory point distribution estimator, and the parameter distribution information of the reward function (i.e. the recommended indicator function mentioned above) can be estimated by the reward parameter estimator.
这种情况下,在前向模仿时,可以基于障碍车的轨迹点分布信息生成障碍车的多个轨迹点,通过对多个轨迹点进行目标轨迹点采样,得到障碍车的一个候选路线。将障碍车的各个候选路线和自动驾驶车辆的期望行驶轨迹进行组合,可以实现组合路线生成(对应于上文提及的第二组合路线)。由回报函数估算器基于回报函数的参数分布信息生成回报函数的多个候选参数,通过从多个候选参数中采样,得到回报函数的目标参数。之后,基于回报函数的目标参数确定各个组合路线的推荐指标,从中选择推荐指标最高的组合路线,作为当前时间周 期对应的联合路线。In this case, during forward imitation, multiple trajectory points of the obstacle vehicle can be generated based on the trajectory point distribution information of the obstacle vehicle, and a candidate route for the obstacle vehicle can be obtained by sampling the target trajectory points of the multiple trajectory points. By combining the various candidate routes of the obstacle vehicle with the expected driving trajectory of the autonomous driving vehicle, a combined route generation (corresponding to the second combined route mentioned above) can be achieved. The reward function estimator generates multiple candidate parameters of the reward function based on the parameter distribution information of the reward function, and obtains the target parameters of the reward function by sampling from the multiple candidate parameters. Afterwards, the recommended indicators of each combined route are determined based on the target parameters of the reward function, and the combined route with the highest recommended indicator is selected as the current time cycle. The corresponding joint route for the period.
自此,本申请实施例实现了在上一时间周期,基于上一时间周期对应的期望行驶轨迹和上一时间周期对应的实际行驶轨迹,确定出当前时间周期对应的期望行驶轨迹。接着,自动驾驶车辆在当前时间周期按照当前时间周期对应的自动驾驶车辆的期望行驶轨迹进行运动,同时,观测当前时间周期对应的自动驾驶车辆、障碍车的实际行驶轨迹。通过这种方式,可以得到当前时间周期对应的期望行驶轨迹和当前时间周期对应的实际行驶轨迹,并在当前时间周期,基于当前时间周期对应的期望行驶轨迹和当前时间周期对应的实际行驶轨迹,确定下一时间周期对应的期望行驶轨迹(即第二联合路线)。From now on, the embodiment of the present application realizes that in the previous time period, based on the expected driving trajectory corresponding to the previous time period and the actual driving trajectory corresponding to the previous time period, the expected driving trajectory corresponding to the current time period is determined. Then, the autonomous driving vehicle moves in the current time period according to the expected driving trajectory of the autonomous driving vehicle corresponding to the current time period, and at the same time, observes the actual driving trajectories of the autonomous driving vehicle and the obstacle vehicle corresponding to the current time period. In this way, the expected driving trajectory corresponding to the current time period and the actual driving trajectory corresponding to the current time period can be obtained, and in the current time period, based on the expected driving trajectory corresponding to the current time period and the actual driving trajectory corresponding to the current time period, the expected driving trajectory corresponding to the next time period (i.e., the second joint route) is determined.
请参见图8,图8是本申请实施例提供的一种自动驾驶决策规划示意图。本申请实施例中,道路上包括障碍车A至C和自动驾驶车辆D。在障碍车A至C均是直行的情况下,本申请实施例可以规划出自动驾驶车辆的期望行驶轨迹是靠近自身的道路左侧行驶(如虚线所示)。此时,自动驾驶车辆在一个时间周期内试探性的按照自动驾驶车辆的期望行驶轨迹进行运动,并实时跟踪障碍车A至C的实际行驶轨迹。根据障碍车A至C的实际行驶轨迹来确定自动驾驶车辆D在下一个时间周期的期望行驶轨迹。Please refer to Figure 8, which is a schematic diagram of an autonomous driving decision-making plan provided by an embodiment of the present application. In the embodiment of the present application, the road includes obstacle vehicles A to C and an autonomous driving vehicle D. When obstacle vehicles A to C are all going straight, the embodiment of the present application can plan that the expected driving trajectory of the autonomous driving vehicle is to drive on the left side of the road close to itself (as shown by the dotted line). At this time, the autonomous driving vehicle tentatively moves according to the expected driving trajectory of the autonomous driving vehicle within a time period, and tracks the actual driving trajectory of obstacle vehicles A to C in real time. The expected driving trajectory of the autonomous driving vehicle D in the next time period is determined based on the actual driving trajectory of obstacle vehicles A to C.
简单来说,自动驾驶车辆D试探性的向左转,观测自行车(即障碍车A至C)的反应。基于自行车的反应判断是否继续向左转是否安全。若安全则继续左转,从而实现安全行车。In simple terms, the autonomous vehicle D tentatively turns left and observes the reactions of the bicycles (i.e., obstacle vehicles A to C). Based on the reactions of the bicycles, it determines whether it is safe to continue turning left. If it is safe, it continues to turn left, thereby achieving safe driving.
需要说明的是,本申请实施例提供的自动驾驶决策规划方法可以适用于任意的交通场景,例如,适用于窄路场景、自动驾驶车辆识别障碍车的行驶意图为道路中间行驶的场景等。其中,窄路场景是道路的可行驶宽度小于宽度阈值,例如,道路是辅路或者道路两旁停有较多的车辆。一般情况下,障碍车会选择靠自身的道路左侧或者右侧行驶,而对于在道路中间行驶的障碍车,自动驾驶车辆可以识别出该障碍车的行驶意图为道路中间行驶。比如,在图3中,自动驾驶车辆A和障碍车B均在道路中间相向而行,障碍车B的运动轨迹是近似于直行,自动驾驶车辆A可以识别到障碍车B是在道路中间行驶且与自动驾驶车辆A相向行驶,但自动驾驶车辆A无法确定障碍车B接下来是想要靠自身的道路左侧行驶(即B-m1),还是靠自身的道路右侧行驶(即B-m2)。It should be noted that the automatic driving decision-making planning method provided in the embodiment of the present application can be applied to any traffic scene, for example, it can be applied to narrow road scenes, scenes where the automatic driving vehicle identifies that the driving intention of the obstacle vehicle is to drive in the middle of the road, etc. Among them, the narrow road scene is that the drivable width of the road is less than the width threshold, for example, the road is a secondary road or there are many vehicles parked on both sides of the road. In general, the obstacle vehicle will choose to drive on the left or right side of its own road, and for the obstacle vehicle driving in the middle of the road, the automatic driving vehicle can identify that the driving intention of the obstacle vehicle is to drive in the middle of the road. For example, in Figure 3, the automatic driving vehicle A and the obstacle vehicle B are both driving towards each other in the middle of the road, and the movement trajectory of the obstacle vehicle B is approximately straight. The automatic driving vehicle A can recognize that the obstacle vehicle B is driving in the middle of the road and driving towards the automatic driving vehicle A, but the automatic driving vehicle A cannot determine whether the obstacle vehicle B wants to drive on the left side of its own road (i.e., B-m1) or on the right side of its own road (i.e., B-m2).
以自动驾驶车辆识别障碍车的行驶意图为道路中间行驶的场景为例,当自动驾驶车辆识别到障碍车在道路中间行驶时,自动驾驶车辆会联合规划出自动驾驶车辆的期望行驶轨迹和障碍车的期望行驶轨迹,寻找到所有主体的最佳协作策略,并且自动驾驶车辆在一个时间周期内持续性地按照自动驾驶车辆的期望行驶轨迹进行运动。例如,在图3中,自动驾驶车辆A会联合规划出自动驾驶车辆A的期望轨迹是A-m2、障碍车B的期望行驶轨迹是B-m2,并且自动驾驶车辆在一个时间周期内持续性地按照A-m2进行运动,以引动障碍车B靠近B-m2来进行运动。在时间周期结束后,若障碍车的实际行驶轨迹与障碍车的期望行驶轨迹一致,则自动驾驶车辆基于捕捉到的障碍车的行驶意图合作完成会车。若障碍车的实际行驶轨迹与障碍车的期望行驶轨迹不一致,则自动驾驶车辆需要再次联合规划出自动驾驶车辆的期望行驶轨迹和障碍车的期望行驶轨迹,以保证自动驾驶车辆的行车安全性。比如,在图3中障碍车B还是保持直行,且自动驾驶车辆与障碍车B的距离较近,则自动驾驶车辆可以联合规划出自动驾驶车辆的期望行驶轨迹是静止的轨迹,而障碍车的期望轨迹是靠自身左侧行驶的轨迹。Take the scenario where the autonomous driving vehicle identifies the obstacle vehicle's driving intention as driving in the middle of the road as an example. When the autonomous driving vehicle identifies the obstacle vehicle driving in the middle of the road, the autonomous driving vehicle will jointly plan the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle, find the best cooperation strategy for all subjects, and the autonomous driving vehicle will continue to move according to the expected driving trajectory of the autonomous driving vehicle within a time period. For example, in Figure 3, the autonomous driving vehicle A will jointly plan the expected trajectory of the autonomous driving vehicle A as A-m2 and the expected driving trajectory of the obstacle vehicle B as B-m2, and the autonomous driving vehicle will continue to move according to A-m2 within a time period to induce the obstacle vehicle B to move close to B-m2. After the time period ends, if the actual driving trajectory of the obstacle vehicle is consistent with the expected driving trajectory of the obstacle vehicle, the autonomous driving vehicle will cooperate to complete the meeting based on the captured driving intention of the obstacle vehicle. If the actual driving trajectory of the obstacle vehicle is inconsistent with the expected driving trajectory of the obstacle vehicle, the autonomous driving vehicle needs to jointly plan the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle again to ensure the driving safety of the autonomous driving vehicle. For example, in Figure 3, the obstacle vehicle B is still moving straight, and the distance between the autonomous driving vehicle and the obstacle vehicle B is relatively close. Then the autonomous driving vehicle can jointly plan that the expected driving trajectory of the autonomous driving vehicle is a stationary trajectory, while the expected trajectory of the obstacle vehicle is a trajectory that drives on its left side.
本申请实施例中,自动驾驶车辆会在一个时间周期内持续性地按照自动驾驶车辆的期望行驶轨迹进行运动,在时间周期结束后,根据障碍车的实际行驶轨迹再次联合规划出自动驾驶车辆的期望行驶轨迹和障碍车的期望行驶轨迹,这种控制方式会提高联合路线的规划效率。简单来说,当障碍车表现出时间层面的会车意图或空间层面的会车意图时,在自动驾驶车辆的视角中,障碍车的可行轨迹就减少了一半;当障碍车同时表现出时间层面的会车意图和空间层面的会车意图时,障碍车的可行轨迹就减少了3/4。障碍车的可行轨迹越少,自动驾驶车辆的可行轨迹就越多,自动驾驶车辆就越有可能执行更高效的运动轨迹。自动驾驶车辆通过在一个时间周期内持续性地按照自动驾驶车辆的期望行驶轨迹进行运动,以引导障碍车尽快的表现出行驶意图,以削减障碍车的可行轨迹,增加自动驾驶车辆的可行轨迹。使得在时间周期结束后,根据障碍车的实际行驶轨迹再次联合规划出自动驾驶车辆的期望行驶轨迹和障碍车的期望行驶轨迹时,不仅可以提高联合规划效率,保证实时性,还能提高自动驾驶车辆执行高效轨迹的概率,提高自动驾驶车辆的行车高效性。In the embodiment of the present application, the autonomous driving vehicle will continuously move according to the expected driving trajectory of the autonomous driving vehicle within a time period. After the time period ends, the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle will be jointly planned again according to the actual driving trajectory of the obstacle vehicle. This control method will improve the planning efficiency of the joint route. In simple terms, when the obstacle vehicle shows the intention of meeting the vehicle at the time level or the intention of meeting the vehicle at the space level, the feasible trajectory of the obstacle vehicle is reduced by half from the perspective of the autonomous driving vehicle; when the obstacle vehicle shows the intention of meeting the vehicle at the time level and the intention of meeting the vehicle at the space level at the same time, the feasible trajectory of the obstacle vehicle is reduced by 3/4. The fewer the feasible trajectories of the obstacle vehicle, the more feasible trajectories of the autonomous driving vehicle, and the more likely the autonomous driving vehicle is to execute a more efficient motion trajectory. The autonomous driving vehicle continuously moves according to the expected driving trajectory of the autonomous driving vehicle within a time period to guide the obstacle vehicle to show the driving intention as soon as possible, so as to reduce the feasible trajectory of the obstacle vehicle and increase the feasible trajectory of the autonomous driving vehicle. After the time period ends, the expected driving trajectory of the autonomous driving vehicle and the expected driving trajectory of the obstacle vehicle are jointly planned again according to the actual driving trajectory of the obstacle vehicle. This can not only improve the efficiency of joint planning and ensure real-time performance, but also increase the probability of the autonomous driving vehicle executing an efficient trajectory and improve the driving efficiency of the autonomous driving vehicle.
需要说明的是,本申请所涉及的信息(包括但不限于用户设备信息、用户个人信息等)、 数据(包括但不限于用于分析的数据、存储的数据、展示的数据等)以及信号,均为经用户授权或者经过各方充分授权的,且相关数据的收集、使用和处理需要遵守相关国家和地区的相关法律法规和标准。例如,本申请中涉及到的实际行驶轨迹、期望行驶轨迹等都是在充分授权的情况下获取的。It should be noted that the information involved in this application (including but not limited to user device information, user personal information, etc.) Data (including but not limited to data for analysis, stored data, displayed data, etc.) and signals are all authorized by the user or fully authorized by all parties, and the collection, use and processing of relevant data must comply with relevant laws, regulations and standards of relevant countries and regions. For example, the actual driving trajectory and expected driving trajectory involved in this application are all obtained with full authorization.
上述方法中,当自动驾驶车辆所处环境中存在障碍车时,控制自动驾驶车辆按照试探路线进行行驶,通过主动展示自动驾驶车辆的行驶意图来引导障碍车运动,以使障碍车尽快展示障碍车的行驶意图。在自动驾驶车辆按照试探路线进行行驶的过程中,获取障碍车的相关信息,并通过障碍车的相关信息确定障碍车的行驶意图,使得自动驾驶车辆能够提早捕捉到障碍车的行驶意图。在根据障碍车的行驶意图对自动驾驶车辆进行自动驾驶决策规划时,不仅提高了自动驾驶车辆的智能化程度,还有利于提高自动驾驶车辆的行车安全性。In the above method, when there is an obstacle vehicle in the environment where the autonomous driving vehicle is located, the autonomous driving vehicle is controlled to travel along the trial route, and the obstacle vehicle is guided to move by actively displaying the driving intention of the autonomous driving vehicle, so that the obstacle vehicle can display the driving intention of the obstacle vehicle as soon as possible. In the process of the autonomous driving vehicle driving along the trial route, the relevant information of the obstacle vehicle is obtained, and the driving intention of the obstacle vehicle is determined through the relevant information of the obstacle vehicle, so that the autonomous driving vehicle can capture the driving intention of the obstacle vehicle in advance. When the autonomous driving decision-making planning is carried out for the autonomous driving vehicle according to the driving intention of the obstacle vehicle, it not only improves the intelligence level of the autonomous driving vehicle, but also helps to improve the driving safety of the autonomous driving vehicle.
图9所示为本申请实施例提供的一种自动驾驶决策规划装置的结构示意图,如图9所示,该装置包括:FIG9 is a schematic diagram of the structure of an automatic driving decision-making and planning device provided in an embodiment of the present application. As shown in FIG9 , the device includes:
控制模块901,用于响应于自动驾驶车辆所处环境中存在障碍车,控制自动驾驶车辆按照试探路线进行行驶,障碍车是指与自动驾驶车辆的行驶路线存在冲突的车辆,即障碍车的行驶路线与自动驾驶车辆的行驶路线存在冲突;The control module 901 is used to control the autonomous driving vehicle to drive along a trial route in response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located. The obstacle vehicle refers to a vehicle that conflicts with the driving route of the autonomous driving vehicle, that is, the driving route of the obstacle vehicle conflicts with the driving route of the autonomous driving vehicle.
获取模块902,用于在自动驾驶车辆按照试探路线进行行驶的过程中,获取障碍车的相关信息;An acquisition module 902 is used to acquire relevant information of an obstacle vehicle while the autonomous driving vehicle is driving along the trial route;
确定模块903,用于根据障碍车的相关信息确定障碍车的行驶意图;A determination module 903 is used to determine the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle;
规划模块904,用于至少根据障碍车的行驶意图对自动驾驶车辆进行自动驾驶决策规划。The planning module 904 is used to make an autonomous driving decision plan for the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle.
在一种可能的实现方式中,该装置还包括:In a possible implementation, the device further includes:
获取模块902,还用于获取自动驾驶车辆的历史实际行驶轨迹、障碍车的历史实际行驶轨迹和障碍车的历史期望行驶轨迹,障碍车的历史期望行驶轨迹根据障碍车的行驶路线预估得到,比如,障碍车的历史期望行驶轨迹是自动驾驶车辆根据障碍车的行驶路线预估得到的;The acquisition module 902 is further used to acquire the historical actual driving trajectory of the autonomous driving vehicle, the historical actual driving trajectory of the obstacle vehicle, and the historical expected driving trajectory of the obstacle vehicle. The historical expected driving trajectory of the obstacle vehicle is estimated based on the driving route of the obstacle vehicle. For example, the historical expected driving trajectory of the obstacle vehicle is estimated by the autonomous driving vehicle based on the driving route of the obstacle vehicle.
确定模块903,还用于基于障碍车的历史期望行驶轨迹和障碍车的历史实际行驶轨迹确定历史偏差信息;The determination module 903 is further used to determine the historical deviation information based on the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle;
确定模块903,还用于基于自动驾驶车辆的历史实际行驶轨迹和历史偏差信息确定试探路线。The determination module 903 is also used to determine a trial route based on the historical actual driving trajectory and historical deviation information of the autonomous driving vehicle.
在一种可能的实现方式中,确定模块903,用于响应于历史偏差信息小于第一阈值,则基于自动驾驶车辆的历史实际行驶轨迹和障碍车的历史实际行驶轨迹,确定障碍车的至少一个第一候选路线和自动驾驶车辆的至少一个第一候选路线;将障碍车的至少一个第一候选路线和自动驾驶车辆的至少一个第一候选路线进行组合,得到至少一个第一组合路线,任一个第一组合路线包括障碍车的一个第一候选路线和自动驾驶车辆的一个第一候选路线;确定各个第一组合路线的推荐指标;从至少一个第一组合路线中选择推荐指标最高的第一组合路线,将推荐指标最高的第一组合路线包括的自动驾驶车辆的第一候选路线作为试探路线。In one possible implementation, the determination module 903 is used to determine, in response to the historical deviation information being less than a first threshold, at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle; combine at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle to obtain at least one first combined route, any first combined route including a first candidate route of the obstacle vehicle and a first candidate route of the autonomous driving vehicle; determine the recommended index of each first combined route; select the first combined route with the highest recommended index from the at least one first combined route, and use the first candidate route of the autonomous driving vehicle included in the first combined route with the highest recommended index as a trial route.
在一种可能的实现方式中,确定模块903,用于基于自动驾驶车辆的历史实际行驶轨迹和障碍车的历史实际行驶轨迹确定障碍车的轨迹点分布信息和自动驾驶车辆的轨迹点分布信息;对于目标主体,基于目标主体的轨迹点分布信息生成目标主体的多个轨迹点,目标主体为障碍车或者自动驾驶车辆;从目标主体的多个轨迹点中采样出目标主体的多个目标轨迹点;基于目标主体的多个目标轨迹点生成目标主体的至少一个第一候选路线。比如,生成目标主体的一个或多个第一候选路线。In a possible implementation, the determination module 903 is used to determine the trajectory point distribution information of the obstacle vehicle and the trajectory point distribution information of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle; for a target subject, generate multiple trajectory points of the target subject based on the trajectory point distribution information of the target subject, where the target subject is the obstacle vehicle or the autonomous driving vehicle; sample multiple target trajectory points of the target subject from the multiple trajectory points of the target subject; and generate at least one first candidate route of the target subject based on the multiple target trajectory points of the target subject. For example, one or more first candidate routes of the target subject are generated.
在一种可能的实现方式中,确定模块903,用于基于障碍车的历史实际行驶轨迹确定推荐指标函数的参数分布信息,推荐指标函数用于确定第一组合路线的推荐指标;基于推荐指标函数的参数分布信息,生成推荐指标函数的多个候选参数;从推荐指标函数的多个候选参数中采样推荐指标函数的目标参数;基于推荐指标函数的目标参数确定各个第一组合路线的推荐指标。In a possible implementation, the determination module 903 is used to determine the parameter distribution information of the recommended index function based on the historical actual driving trajectory of the obstacle vehicle, and the recommended index function is used to determine the recommended index of the first combined route; based on the parameter distribution information of the recommended index function, generate multiple candidate parameters of the recommended index function; sample the target parameters of the recommended index function from the multiple candidate parameters of the recommended index function; and determine the recommended index of each first combined route based on the target parameters of the recommended index function.
在一种可能的实现方式中,确定模块903,用于对于任一个第一组合路线,获取任一个第一组合路线的至少一个参照信息,任一个参照信息为舒适度、安全度、自动驾驶车辆的速度、不确定度、礼貌程度以及流通度中的任一项,舒适度用于描述加速度,安全度用于描述碰撞信息,不确定度用于描述轨迹点的集中程度(轨迹点为目标主体的轨迹点,目标主体为障碍车或者自动驾驶车辆),礼貌程度用于描述自动驾驶车辆对障碍车的运动所造成的影响,流通度用于描述自动驾驶车辆所处环境中车辆的平均速度;基于任一个第一组合路线的各个 参照信息和各个参考信息(也称为各个参照信息)对应的推荐指标函数的目标参数,确定任一个第一组合路线的推荐指标。In a possible implementation, the determination module 903 is used to obtain at least one reference information of any first combined route for any first combined route, where any reference information is any one of comfort, safety, speed of the autonomous driving vehicle, uncertainty, politeness, and circulation, where comfort is used to describe acceleration, safety is used to describe collision information, uncertainty is used to describe the concentration of trajectory points (the trajectory points are trajectory points of the target subject, and the target subject is the obstacle vehicle or the autonomous driving vehicle), politeness is used to describe the impact of the autonomous driving vehicle on the movement of the obstacle vehicle, and circulation is used to describe the average speed of vehicles in the environment where the autonomous driving vehicle is located; based on each of the first combined routes, The reference information and the target parameter of the recommendation index function corresponding to each reference information (also referred to as each reference information) determine the recommendation index of any first combination route.
在一种可能的实现方式中,确定模块903,用于响应于历史偏差信息不小于第一阈值,则获取至少一个映射关系,任一个映射关系用于描述行驶轨迹集合和参考路线之间的映射关系,行驶轨迹集合包括至少一个行驶轨迹;从至少一个映射关系中选择行驶轨迹集合与自动驾驶车辆的历史实际行驶轨迹和障碍车的历史实际行驶轨迹相匹配的目标映射关系(或者说,从至少一个映射关系中选择目标映射关系,目标映射关系对应的行驶轨迹集合包括的至少一个行驶轨迹,与自动驾驶车辆的历史实际行驶轨迹和障碍车的历史实际行驶轨迹相匹配);将目标映射关系对应的参考路线确定为试探路线。In one possible implementation, the determination module 903 is used to obtain at least one mapping relationship in response to the historical deviation information being not less than a first threshold value, any one of which is used to describe the mapping relationship between a driving trajectory set and a reference route, the driving trajectory set including at least one driving trajectory; select a target mapping relationship from at least one mapping relationship that matches the driving trajectory set with the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle (or, select a target mapping relationship from at least one mapping relationship, the driving trajectory set corresponding to the target mapping relationship includes at least one driving trajectory that matches the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle); and determine the reference route corresponding to the target mapping relationship as a trial route.
在一种可能的实现方式中,确定模块903,还用于基于试探路线和障碍车的历史实际行驶轨迹,确定障碍车的至少一个第二候选路线;将障碍车的任一个第二候选路线和试探路线进行组合,得到任一个第二组合路线;确定各个第二组合路线的推荐指标,从各个第二组合路线中选择推荐指标最高的第二组合路线;In a possible implementation, the determination module 903 is further configured to determine at least one second candidate route of the obstacle vehicle based on the trial route and the historical actual driving trajectory of the obstacle vehicle; combine any second candidate route of the obstacle vehicle with the trial route to obtain any second combined route; determine a recommended index for each second combined route, and select a second combined route with the highest recommended index from each second combined route;
规划模块904,用于至少根据障碍车的行驶意图和推荐指标最高的第二组合路线,对自动驾驶车辆进行自动驾驶决策规划。The planning module 904 is used to perform autonomous driving decision planning for the autonomous driving vehicle based on at least the driving intention of the obstacle vehicle and the second combined route with the highest recommended index.
在一种可能的实现方式中,确定模块903,用于对于任一个障碍车,确定任一个障碍车的历史期望行驶轨迹和任一个障碍车的历史实际行驶轨迹之间的偏差信息;基于各个障碍车的历史期望行驶轨迹和各个障碍车的历史实际行驶轨迹之间的偏差信息,确定历史偏差信息。In a possible implementation, the determination module 903 is used to determine, for any obstacle vehicle, deviation information between a historical expected driving trajectory of any obstacle vehicle and a historical actual driving trajectory of any obstacle vehicle; and determine historical deviation information based on the deviation information between the historical expected driving trajectory of each obstacle vehicle and the historical actual driving trajectory of each obstacle vehicle.
在一种可能的实现方式中,任一个障碍车的历史期望行驶轨迹包括多个时刻的期望轨迹点,任一个障碍车的历史实际行驶轨迹包括多个时刻的实际轨迹点;In a possible implementation, the historical expected driving trajectory of any obstacle vehicle includes expected trajectory points at multiple moments, and the historical actual driving trajectory of any obstacle vehicle includes actual trajectory points at multiple moments;
确定模块903,用于对于任一个时刻,基于任一个时刻的期望轨迹点的位置信息和任一个时刻的实际轨迹点的位置信息,确定任一个时刻对应的期望轨迹点和实际轨迹点之间的距离;基于各个时刻对应的期望轨迹点和实际轨迹点之间的距离,确定任一个障碍车的历史期望行驶轨迹和任一个障碍车的历史实际行驶轨迹之间的偏差信息。The determination module 903 is used to determine, for any moment, the distance between the expected trajectory point and the actual trajectory point corresponding to any moment based on the position information of the expected trajectory point at any moment and the position information of the actual trajectory point at any moment; and determine the deviation information between the historical expected driving trajectory of any obstacle vehicle and the historical actual driving trajectory of any obstacle vehicle based on the distance between the expected trajectory point and the actual trajectory point corresponding to each moment.
在一种可能的实现方式中,确定模块903,用于根据障碍车的相关信息确定障碍车在时间维度的意图;根据障碍车的相关信息确定障碍车在空间维度的意图;将障碍车在时间维度的意图和障碍车在空间维度的意图确定为障碍车的行驶意图。In a possible implementation, the determination module 903 is used to determine the intention of the obstacle vehicle in the time dimension according to the relevant information of the obstacle vehicle; determine the intention of the obstacle vehicle in the space dimension according to the relevant information of the obstacle vehicle; and determine the intention of the obstacle vehicle in the time dimension and the intention of the obstacle vehicle in the space dimension as the driving intention of the obstacle vehicle.
在一种可能的实现方式中,规划模块904,用于响应于障碍车的行驶意图发生改变,至少根据障碍车的行驶意图确定障碍车的目标行驶路线;基于障碍车的目标行驶路线确定自动驾驶车辆的目标行驶路线。In one possible implementation, the planning module 904 is used to determine a target driving route of the obstacle vehicle at least according to the driving intention of the obstacle vehicle in response to a change in the driving intention of the obstacle vehicle; and determine a target driving route of the autonomous driving vehicle based on the target driving route of the obstacle vehicle.
在一种可能的实现方式中,规划模块904,用于响应于障碍车的行驶意图未改变,获取自动驾驶车辆与障碍车之间的距离;若自动驾驶车辆与障碍车之间的距离小于距离阈值,则控制自动驾驶车辆停止行驶。In one possible implementation, the planning module 904 is used to obtain the distance between the autonomous driving vehicle and the obstacle vehicle in response to the obstacle vehicle's driving intention not changing; if the distance between the autonomous driving vehicle and the obstacle vehicle is less than a distance threshold, control the autonomous driving vehicle to stop driving.
上述装置中,当自动驾驶车辆所处环境中存在障碍车时,控制自动驾驶车辆按照试探路线进行行驶,通过主动展示自动驾驶车辆的行驶意图来引导障碍车运动,以使障碍车尽快展示障碍车的行驶意图。在自动驾驶车辆按照试探路线进行行驶的过程中,获取障碍车的相关信息,并通过障碍车的相关信息确定障碍车的行驶意图,使得自动驾驶车辆能够提早捕捉到障碍车的行驶意图。在根据障碍车的行驶意图对自动驾驶车辆进行自动驾驶决策规划时,不仅提高了自动驾驶车辆的智能化程度,还有利于提高自动驾驶车辆的行车安全性。In the above device, when there is an obstacle vehicle in the environment where the autonomous driving vehicle is located, the autonomous driving vehicle is controlled to travel along the trial route, and the obstacle vehicle is guided to move by actively displaying the driving intention of the autonomous driving vehicle, so that the obstacle vehicle can display the driving intention of the obstacle vehicle as soon as possible. In the process of the autonomous driving vehicle driving along the trial route, the relevant information of the obstacle vehicle is obtained, and the driving intention of the obstacle vehicle is determined through the relevant information of the obstacle vehicle, so that the autonomous driving vehicle can capture the driving intention of the obstacle vehicle in advance. When the autonomous driving decision-making planning is carried out for the autonomous driving vehicle according to the driving intention of the obstacle vehicle, it not only improves the intelligence level of the autonomous driving vehicle, but also helps to improve the driving safety of the autonomous driving vehicle.
应理解的是,上述图9提供的装置在实现其功能时,仅以上述各功能模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将设备的内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。另外,上述实施例提供的装置与方法实施例属于同一构思,其具体实现过程详见方法实施例,这里不再赘述。It should be understood that the device provided in FIG. 9 above only uses the division of the above functional modules as an example to illustrate when implementing its functions. In actual applications, the above functions can be assigned to different functional modules as needed, that is, the internal structure of the device is divided into different functional modules to complete all or part of the functions described above. In addition, the device and method embodiments provided in the above embodiments belong to the same concept, and their specific implementation process is detailed in the method embodiment, which will not be repeated here.
图10示出了本申请一个示例性实施例提供的终端设备1000的结构框图。该终端设备1000包括有:处理器1001和存储器1002。FIG10 shows a block diagram of a terminal device 1000 provided by an exemplary embodiment of the present application. The terminal device 1000 includes: a processor 1001 and a memory 1002 .
处理器1001可以包括一个或多个处理核心,比如4核心处理器、8核心处理器等。处理器1001可以采用DSP(Digital Signal Processing,数字信号处理)、FPGA(Field-Programmable Gate Array,现场可编程门阵列)、PLA(Programmable Logic Array,可编程逻辑阵列)中的至少一种硬件形式来实现。处理器1001也可以包括主处理器和协处理器,主处理器是用于对在唤醒状态下的数据进行处理的处理器,也称CPU(Central Processing Unit,中央处理器);协处理器是用于对在待机状态下的数据进行处理的低功耗处理器。在一些实施例中,处理器 1001可以集成有GPU(Graphics Processing Unit,图像处理器),GPU用于负责显示屏所需要显示的内容的渲染和绘制。一些实施例中,处理器1001还可以包括AI(Artificial Intelligence,人工智能)处理器,该AI处理器用于处理有关机器学习的计算操作。Processor 1001 may include one or more processing cores, such as a 4-core processor, an 8-core processor, etc. Processor 1001 may be implemented in at least one of the following hardware forms: DSP (Digital Signal Processing), FPGA (Field-Programmable Gate Array), and PLA (Programmable Logic Array). Processor 1001 may also include a main processor and a coprocessor. The main processor is a processor for processing data in an awake state, also known as a CPU (Central Processing Unit); the coprocessor is a low-power processor for processing data in a standby state. In some embodiments, the processor 1001 may be integrated with a GPU (Graphics Processing Unit), which is responsible for rendering and drawing the content to be displayed on the display screen. In some embodiments, the processor 1001 may also include an AI (Artificial Intelligence) processor, which is used to process computing operations related to machine learning.
存储器1002可以包括一个或多个计算机可读存储介质,该计算机可读存储介质可以是非暂态的。非暂态的计算机可读存储介质也可称为非临时性计算机可读存储介质。存储器1002还可包括高速随机存取存储器,以及非易失性存储器,比如一个或多个磁盘存储设备、闪存存储设备。在一些实施例中,存储器1002中的非暂态的计算机可读存储介质用于存储至少一个计算机程序,该至少一个计算机程序用于被处理器1001所执行以实现本申请中方法实施例提供的自动驾驶决策规划方法。The memory 1002 may include one or more computer-readable storage media, which may be non-transitory. Non-transitory computer-readable storage media may also be referred to as non-transitory computer-readable storage media. The memory 1002 may also include a high-speed random access memory, and a non-volatile memory, such as one or more disk storage devices, flash memory storage devices. In some embodiments, the non-transitory computer-readable storage medium in the memory 1002 is used to store at least one computer program, which is used to be executed by the processor 1001 to implement the autonomous driving decision planning method provided in the method embodiment of the present application.
在一些实施例中,终端设备1000还可选包括有:外围设备接口1003和至少一个外围设备。处理器1001、存储器1002和外围设备接口1003之间可以通过总线或信号线相连。各个外围设备可以通过总线、信号线或电路板与外围设备接口1003相连。具体地,外围设备包括:射频电路1004、显示屏1005、摄像头组件1006、音频电路1007和电源1008中的至少一种。In some embodiments, the terminal device 1000 may further optionally include: a peripheral device interface 1003 and at least one peripheral device. The processor 1001, the memory 1002 and the peripheral device interface 1003 may be connected via a bus or a signal line. Each peripheral device may be connected to the peripheral device interface 1003 via a bus, a signal line or a circuit board. Specifically, the peripheral device includes: at least one of a radio frequency circuit 1004, a display screen 1005, a camera assembly 1006, an audio circuit 1007 and a power supply 1008.
外围设备接口1003可被用于将I/O(Input/Output,输入/输出)相关的至少一个外围设备连接到处理器1001和存储器1002。在一些实施例中,处理器1001、存储器1002和外围设备接口1003被集成在同一芯片或电路板上;在一些其他实施例中,处理器1001、存储器1002和外围设备接口1003中的任意一个或两个可以在单独的芯片或电路板上实现,本实施例对此不加以限定。The peripheral device interface 1003 may be used to connect at least one peripheral device related to I/O (Input/Output) to the processor 1001 and the memory 1002. In some embodiments, the processor 1001, the memory 1002, and the peripheral device interface 1003 are integrated on the same chip or circuit board; in some other embodiments, any one or two of the processor 1001, the memory 1002, and the peripheral device interface 1003 may be implemented on a separate chip or circuit board, which is not limited in this embodiment.
射频电路1004用于接收和发射RF(Radio Frequency,射频)信号,也称电磁信号。射频电路1004通过电磁信号与通信网络以及其他通信设备进行通信。射频电路1004将电信号转换为电磁信号进行发送,或者,将接收到的电磁信号转换为电信号。可选地,射频电路1004包括:天线系统、RF收发器、一个或多个放大器、调谐器、振荡器、数字信号处理器、编解码芯片组、用户身份模块卡等等。射频电路1004可以通过至少一种无线通信协议来与其它终端进行通信。该无线通信协议包括但不限于:万维网、城域网、内联网、各代移动通信网络(2G、3G、4G及5G)、无线局域网和/或WiFi(Wireless Fidelity,无线保真)网络。在一些实施例中,射频电路1004还可以包括NFC(Near Field Communication,近距离无线通信)有关的电路,本申请对此不加以限定。The radio frequency circuit 1004 is used to receive and transmit RF (Radio Frequency) signals, also known as electromagnetic signals. The radio frequency circuit 1004 communicates with the communication network and other communication devices through electromagnetic signals. The radio frequency circuit 1004 converts electrical signals into electromagnetic signals for transmission, or converts received electromagnetic signals into electrical signals. Optionally, the radio frequency circuit 1004 includes: an antenna system, an RF transceiver, one or more amplifiers, a tuner, an oscillator, a digital signal processor, a codec chipset, a user identity module card, and the like. The radio frequency circuit 1004 can communicate with other terminals through at least one wireless communication protocol. The wireless communication protocol includes, but is not limited to: the World Wide Web, a metropolitan area network, an intranet, various generations of mobile communication networks (2G, 3G, 4G and 5G), a wireless local area network and/or a WiFi (Wireless Fidelity) network. In some embodiments, the radio frequency circuit 1004 may also include circuits related to NFC (Near Field Communication), which is not limited in this application.
显示屏1005用于显示UI(User Interface,用户界面)。该UI可以包括图形、文本、图标、视频及其它们的任意组合。当显示屏1005是触摸显示屏时,显示屏1005还具有采集在显示屏1005的表面或表面上方的触摸信号的能力。该触摸信号可以作为控制信号输入至处理器1001进行处理。此时,显示屏1005还可以用于提供虚拟按钮和/或虚拟键盘,也称软按钮和/或软键盘。在一些实施例中,显示屏1005可以为一个,设置在终端设备1000的前面板;在另一些实施例中,显示屏1005可以为至少两个,分别设置在终端设备1000的不同表面或呈折叠设计;在另一些实施例中,显示屏1005可以是柔性显示屏,设置在终端设备1000的弯曲表面上或折叠面上。甚至,显示屏1005还可以设置成非矩形的不规则图形,也即异形屏。显示屏1005可以采用LCD(Liquid Crystal Display,液晶显示屏)、OLED(Organic Light-Emitting Diode,有机发光二极管)等材质制备。The display screen 1005 is used to display a UI (User Interface). The UI may include graphics, text, icons, videos, and any combination thereof. When the display screen 1005 is a touch display screen, the display screen 1005 also has the ability to collect touch signals on the surface or above the surface of the display screen 1005. The touch signal can be input as a control signal to the processor 1001 for processing. At this time, the display screen 1005 can also be used to provide virtual buttons and/or virtual keyboards, also known as soft buttons and/or soft keyboards. In some embodiments, the display screen 1005 can be one, which is set on the front panel of the terminal device 1000; in other embodiments, the display screen 1005 can be at least two, which are respectively set on different surfaces of the terminal device 1000 or are folded; in other embodiments, the display screen 1005 can be a flexible display screen, which is set on the curved surface or folded surface of the terminal device 1000. Even, the display screen 1005 can also be set to a non-rectangular irregular shape, that is, a special-shaped screen. The display screen 1005 can be made of materials such as LCD (Liquid Crystal Display) and OLED (Organic Light-Emitting Diode).
摄像头组件1006用于采集图像或视频。可选地,摄像头组件1006包括前置摄像头和后置摄像头。通常,前置摄像头设置在终端的前面板,后置摄像头设置在终端的背面。在一些实施例中,后置摄像头为至少两个,分别为主摄像头、景深摄像头、广角摄像头、长焦摄像头中的任意一种,以实现主摄像头和景深摄像头融合实现背景虚化功能、主摄像头和广角摄像头融合实现全景拍摄以及VR(Virtual Reality,虚拟现实)拍摄功能或者其它融合拍摄功能。在一些实施例中,摄像头组件1006还可以包括闪光灯。The camera assembly 1006 is used to capture images or videos. Optionally, the camera assembly 1006 includes a front camera and a rear camera. Usually, the front camera is set on the front panel of the terminal, and the rear camera is set on the back of the terminal. In some embodiments, there are at least two rear cameras, which are any one of a main camera, a depth of field camera, a wide-angle camera, and a telephoto camera, so as to realize the fusion of the main camera and the depth of field camera to realize the background blur function, the fusion of the main camera and the wide-angle camera to realize panoramic shooting and VR (Virtual Reality) shooting function or other fusion shooting functions. In some embodiments, the camera assembly 1006 may also include a flash.
音频电路1007可以包括麦克风和扬声器。麦克风用于采集用户及环境的声波,并将声波转换为电信号输入至处理器1001进行处理,或者输入至射频电路1004以实现语音通信。出于立体声采集或降噪的目的,麦克风可以为多个,分别设置在终端设备1000的不同部位。麦克风还可以是阵列麦克风或全向采集型麦克风。扬声器则用于将来自处理器1001或射频电路1004的电信号转换为声波。在一些实施例中,音频电路1007还可以包括耳机插孔。The audio circuit 1007 may include a microphone and a speaker. The microphone is used to collect sound waves from the user and the environment, and convert the sound waves into electrical signals and input them into the processor 1001 for processing, or input them into the RF circuit 1004 to achieve voice communication. For the purpose of stereo acquisition or noise reduction, there may be multiple microphones, which are respectively arranged at different parts of the terminal device 1000. The microphone may also be an array microphone or an omnidirectional acquisition microphone. The speaker is used to convert the electrical signals from the processor 1001 or the RF circuit 1004 into sound waves. In some embodiments, the audio circuit 1007 may also include a headphone jack.
电源1008用于为终端设备1000中的各个组件进行供电。电源1008可以是交流电、直流电、一次性电池或可充电电池。当电源1008包括可充电电池时,该可充电电池可以是有线充电电池或无线充电电池。 The power supply 1008 is used to supply power to various components in the terminal device 1000. The power supply 1008 may be an alternating current, a direct current, a disposable battery, or a rechargeable battery. When the power supply 1008 includes a rechargeable battery, the rechargeable battery may be a wired rechargeable battery or a wireless rechargeable battery.
在一些实施例中,终端设备1000还包括有一个或多个传感器1009。该一个或多个传感器1009包括但不限于:加速度传感器1011、陀螺仪传感器1012、压力传感器1013、光学传感器1014以及接近传感器1015。In some embodiments, the terminal device 1000 further includes one or more sensors 1009 . The one or more sensors 1009 include, but are not limited to: an acceleration sensor 1011 , a gyroscope sensor 1012 , a pressure sensor 1013 , an optical sensor 1014 , and a proximity sensor 1015 .
加速度传感器1011可以检测以终端设备1000建立的坐标系的三个坐标轴上的加速度大小。比如,加速度传感器1011可以用于检测重力加速度在三个坐标轴上的分量。处理器1001可以根据加速度传感器1011采集的重力加速度信号,控制显示屏1005以横向视图或纵向视图进行用户界面的显示。加速度传感器1011还可以用于游戏或者用户的运动数据的采集。The acceleration sensor 1011 can detect the magnitude of acceleration on the three coordinate axes of the coordinate system established by the terminal device 1000. For example, the acceleration sensor 1011 can be used to detect the components of gravity acceleration on the three coordinate axes. The processor 1001 can control the display screen 1005 to display the user interface in a horizontal view or a vertical view according to the gravity acceleration signal collected by the acceleration sensor 1011. The acceleration sensor 1011 can also be used for collecting game or user motion data.
陀螺仪传感器1012可以检测终端设备1000的机体方向及转动角度,陀螺仪传感器1012可以与加速度传感器1011协同采集用户对终端设备1000的3D动作。处理器1001根据陀螺仪传感器1012采集的数据,可以实现如下功能:动作感应(比如根据用户的倾斜操作来改变UI)、拍摄时的图像稳定、游戏控制以及惯性导航。The gyro sensor 1012 can detect the body direction and rotation angle of the terminal device 1000, and the gyro sensor 1012 can cooperate with the acceleration sensor 1011 to collect the user's 3D actions on the terminal device 1000. The processor 1001 can implement the following functions based on the data collected by the gyro sensor 1012: motion sensing (such as changing the UI according to the user's tilt operation), image stabilization during shooting, game control, and inertial navigation.
压力传感器1013可以设置在终端设备1000的侧边框和/或显示屏1005的下层。当压力传感器1013设置在终端设备1000的侧边框时,可以检测用户对终端设备1000的握持信号,由处理器1001根据压力传感器1013采集的握持信号进行左右手识别或快捷操作。当压力传感器1013设置在显示屏1005的下层时,由处理器1001根据用户对显示屏1005的压力操作,实现对UI界面上的可操作性控件进行控制。可操作性控件包括按钮控件、滚动条控件、图标控件、菜单控件中的至少一种。The pressure sensor 1013 can be set on the side frame of the terminal device 1000 and/or the lower layer of the display screen 1005. When the pressure sensor 1013 is set on the side frame of the terminal device 1000, the user's holding signal of the terminal device 1000 can be detected, and the processor 1001 performs left and right hand recognition or shortcut operations according to the holding signal collected by the pressure sensor 1013. When the pressure sensor 1013 is set on the lower layer of the display screen 1005, the processor 1001 controls the operability controls on the UI interface according to the user's pressure operation on the display screen 1005. The operability controls include at least one of a button control, a scroll bar control, an icon control, and a menu control.
光学传感器1014用于采集环境光强度。在一个实施例中,处理器1001可以根据光学传感器1014采集的环境光强度,控制显示屏1005的显示亮度。具体地,当环境光强度较高时,调高显示屏1005的显示亮度;当环境光强度较低时,调低显示屏1005的显示亮度。在另一个实施例中,处理器1001还可以根据光学传感器1014采集的环境光强度,动态调整摄像头组件1006的拍摄参数。The optical sensor 1014 is used to collect the ambient light intensity. In one embodiment, the processor 1001 can control the display brightness of the display screen 1005 according to the ambient light intensity collected by the optical sensor 1014. Specifically, when the ambient light intensity is high, the display brightness of the display screen 1005 is increased; when the ambient light intensity is low, the display brightness of the display screen 1005 is reduced. In another embodiment, the processor 1001 can also dynamically adjust the shooting parameters of the camera assembly 1006 according to the ambient light intensity collected by the optical sensor 1014.
接近传感器1015,也称距离传感器,通常设置在终端设备1000的前面板。接近传感器1015用于采集用户与终端设备1000的正面之间的距离。在一个实施例中,当接近传感器1015检测到用户与终端设备1000的正面之间的距离逐渐变小时,由处理器1001控制显示屏1005从亮屏状态切换为息屏状态;当接近传感器1015检测到用户与终端设备1000的正面之间的距离逐渐变大时,由处理器1001控制显示屏1005从息屏状态切换为亮屏状态。The proximity sensor 1015, also called a distance sensor, is usually arranged on the front panel of the terminal device 1000. The proximity sensor 1015 is used to collect the distance between the user and the front of the terminal device 1000. In one embodiment, when the proximity sensor 1015 detects that the distance between the user and the front of the terminal device 1000 is gradually decreasing, the processor 1001 controls the display screen 1005 to switch from the screen-on state to the screen-off state; when the proximity sensor 1015 detects that the distance between the user and the front of the terminal device 1000 is gradually increasing, the processor 1001 controls the display screen 1005 to switch from the screen-off state to the screen-on state.
本领域技术人员可以理解,图10中示出的结构并不构成对终端设备1000的限定,可以包括比图示更多或更少的组件,或者组合某些组件,或者采用不同的组件布置。Those skilled in the art will appreciate that the structure shown in FIG. 10 does not limit the terminal device 1000 and may include more or fewer components than shown in the figure, or combine certain components, or adopt a different component arrangement.
图11为本申请实施例提供的服务器的结构示意图,该服务器1100可因配置或性能不同而产生比较大的差异,可以包括一个或多个处理器1101和一个或多个的存储器1102,其中,该一个或多个存储器1102中存储有至少一条计算机程序,该至少一条计算机程序由该一个或多个处理器1101加载并执行以实现上述各个方法实施例提供的自动驾驶决策规划方法,示例性的,处理器1101为CPU。当然,该服务器1100还可以具有有线或无线网络接口、键盘以及输入输出接口等部件,以便进行输入输出,该服务器1100还可以包括其他用于实现设备功能的部件,在此不做赘述。FIG11 is a schematic diagram of the structure of the server provided in the embodiment of the present application. The server 1100 may have relatively large differences due to different configurations or performances, and may include one or more processors 1101 and one or more memories 1102, wherein the one or more memories 1102 store at least one computer program, and the at least one computer program is loaded and executed by the one or more processors 1101 to implement the automatic driving decision planning method provided by the above-mentioned various method embodiments. Exemplarily, the processor 1101 is a CPU. Of course, the server 1100 may also have components such as a wired or wireless network interface, a keyboard, and an input and output interface for input and output. The server 1100 may also include other components for implementing device functions, which will not be described in detail here.
在示例性实施例中,还提供了一种非临时性计算机可读存储介质,该非临时性计算机可读存储介质中存储有至少一条计算机程序,该至少一条计算机程序由处理器加载并执行,以使自动驾驶车辆实现上述任一种自动驾驶决策规划方法。In an exemplary embodiment, a non-temporary computer-readable storage medium is also provided, in which at least one computer program is stored. The at least one computer program is loaded and executed by a processor to enable the autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
可选地,上述非临时性计算机可读存储介质可以是只读存储器(Read-Only Memory,ROM)、随机存取存储器(Random Access Memory,RAM)、只读光盘(Compact Disc Read-Only Memory,CD-ROM)、磁带、软盘和光数据存储设备等。Optionally, the above-mentioned non-temporary computer-readable storage medium can be a read-only memory (ROM), a random access memory (RAM), a compact disc (CD-ROM), a magnetic tape, a floppy disk, an optical data storage device, etc.
示例性地,还提供了一种计算机程序,计算机程序中存储有至少一条计算机指令,至少一条计算机指令由处理器加载并执行,以使自动驾驶车辆实现上述任一种自动驾驶决策规划方法。Exemplarily, a computer program is also provided, in which at least one computer instruction is stored, and the at least one computer instruction is loaded and executed by a processor to enable an autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
在示例性实施例中,还提供了一种计算机程序或计算机程序产品,该计算机程序或计算机程序产品中存储有至少一条计算机程序,该至少一条计算机程序由处理器加载并执行,以使自动驾驶车辆实现上述任一种自动驾驶决策规划方法。In an exemplary embodiment, a computer program or a computer program product is also provided, in which at least one computer program is stored, and the at least one computer program is loaded and executed by a processor to enable an autonomous driving vehicle to implement any of the above-mentioned autonomous driving decision planning methods.
应当理解的是,在本文中提及的“多个”是指两个或两个以上。“和/或”,描述关联对象的关联关系,表示可以存在三种关系,例如,A和/或B,可以表示:单独存在A,同时存在A和B,单独存在B这三种情况。字符“/”一般表示前后关联对象是一种“或”的关系。 It should be understood that the "plurality" mentioned in this article refers to two or more. "And/or" describes the association relationship of the associated objects, indicating that there can be three relationships. For example, A and/or B can mean: A exists alone, A and B exist at the same time, and B exists alone. The character "/" generally indicates that the associated objects before and after are in an "or" relationship.
上述本申请实施例序号仅仅为了描述,不代表实施例的优劣。The serial numbers of the embodiments of the present application are for description only and do not represent the advantages or disadvantages of the embodiments.
以上所述仅为本申请的示例性实施例,并不用以限制本申请,凡在本申请的原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。 The above description is only an exemplary embodiment of the present application and is not intended to limit the present application. Any modifications, equivalent substitutions, improvements, etc. made within the principles of the present application shall be included in the protection scope of the present application.

Claims (18)

  1. 一种自动驾驶决策规划方法,其中,所述方法包括:A method for autonomous driving decision planning, wherein the method comprises:
    响应于自动驾驶车辆所处环境中存在障碍车,控制所述自动驾驶车辆按照试探路线进行行驶,所述障碍车的行驶路线与所述自动驾驶车辆的行驶路线存在冲突;In response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located, controlling the autonomous driving vehicle to travel along a trial route, wherein the driving route of the obstacle vehicle conflicts with the driving route of the autonomous driving vehicle;
    在所述自动驾驶车辆按照所述试探路线进行行驶的过程中,获取所述障碍车的相关信息;While the autonomous driving vehicle is driving along the trial route, obtaining relevant information of the obstacle vehicle;
    根据所述障碍车的相关信息确定所述障碍车的行驶意图;Determining the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle;
    至少根据所述障碍车的行驶意图对所述自动驾驶车辆进行自动驾驶决策规划。The autonomous driving decision planning is performed on the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle.
  2. 根据权利要求1所述的方法,其中,所述控制所述自动驾驶车辆按照试探路线进行行驶之前,还包括:The method according to claim 1, wherein before controlling the autonomous driving vehicle to drive along the trial route, the method further comprises:
    获取所述自动驾驶车辆的历史实际行驶轨迹、所述障碍车的历史实际行驶轨迹和所述障碍车的历史期望行驶轨迹,所述障碍车的历史期望行驶轨迹根据所述障碍车的行驶路线预估得到;Acquire the historical actual driving trajectory of the autonomous driving vehicle, the historical actual driving trajectory of the obstacle vehicle, and the historical expected driving trajectory of the obstacle vehicle, wherein the historical expected driving trajectory of the obstacle vehicle is estimated based on the driving route of the obstacle vehicle;
    基于所述障碍车的历史期望行驶轨迹和所述障碍车的历史实际行驶轨迹确定历史偏差信息;Determining historical deviation information based on the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle;
    基于所述自动驾驶车辆的历史实际行驶轨迹和所述历史偏差信息确定所述试探路线。The trial route is determined based on the historical actual driving trajectory of the autonomous driving vehicle and the historical deviation information.
  3. 根据权利要求2所述的方法,其中,所述基于所述自动驾驶车辆的历史实际行驶轨迹和所述历史偏差信息确定所述试探路线,包括:The method according to claim 2, wherein the determining the trial route based on the historical actual driving trajectory of the autonomous driving vehicle and the historical deviation information comprises:
    响应于所述历史偏差信息小于第一阈值,则基于所述自动驾驶车辆的历史实际行驶轨迹和所述障碍车的历史实际行驶轨迹,确定所述障碍车的至少一个第一候选路线和所述自动驾驶车辆的至少一个第一候选路线;In response to the historical deviation information being less than a first threshold, determining at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle;
    将所述障碍车的至少一个第一候选路线和所述自动驾驶车辆的至少一个第一候选路线进行组合,得到至少一个第一组合路线,任一个第一组合路线包括所述障碍车的一个第一候选路线和所述自动驾驶车辆的一个第一候选路线;Combining at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle to obtain at least one first combined route, wherein any first combined route includes a first candidate route of the obstacle vehicle and a first candidate route of the autonomous driving vehicle;
    确定各个第一组合路线的推荐指标;Determining recommended indicators for each first combination route;
    从所述至少一个第一组合路线中选择推荐指标最高的第一组合路线,将所述推荐指标最高的第一组合路线包括的所述自动驾驶车辆的第一候选路线作为所述试探路线。A first combined route with a highest recommendation index is selected from the at least one first combined route, and a first candidate route of the autonomous driving vehicle included in the first combined route with the highest recommendation index is used as the trial route.
  4. 根据权利要求3所述的方法,其中,所述基于所述自动驾驶车辆的历史实际行驶轨迹和所述障碍车的历史实际行驶轨迹,确定所述障碍车的至少一个第一候选路线和所述自动驾驶车辆的至少一个第一候选路线,包括:The method according to claim 3, wherein the determining, based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle, at least one first candidate route of the obstacle vehicle and at least one first candidate route of the autonomous driving vehicle comprises:
    基于所述自动驾驶车辆的历史实际行驶轨迹和所述障碍车的历史实际行驶轨迹确定所述障碍车的轨迹点分布信息和所述自动驾驶车辆的轨迹点分布信息;Determining the trajectory point distribution information of the obstacle vehicle and the trajectory point distribution information of the autonomous driving vehicle based on the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle;
    对于目标主体,基于所述目标主体的轨迹点分布信息生成所述目标主体的多个轨迹点,所述目标主体为所述障碍车或者所述自动驾驶车辆;For a target subject, generating a plurality of trajectory points of the target subject based on the trajectory point distribution information of the target subject, wherein the target subject is the obstacle vehicle or the autonomous driving vehicle;
    从所述目标主体的多个轨迹点中采样出所述目标主体的多个目标轨迹点;Sampling a plurality of target trajectory points of the target subject from the plurality of trajectory points of the target subject;
    基于所述目标主体的多个目标轨迹点生成所述目标主体的至少一个第一候选路线。At least one first candidate route of the target body is generated based on a plurality of target trajectory points of the target body.
  5. 根据权利要求3所述的方法,其中,所述确定各个第一组合路线的推荐指标,包括:The method according to claim 3, wherein determining the recommendation index of each first combination route comprises:
    基于所述障碍车的历史实际行驶轨迹确定推荐指标函数的参数分布信息,所述推荐指标函数用于确定第一组合路线的推荐指标;Determining parameter distribution information of a recommended index function based on the historical actual driving trajectory of the obstacle vehicle, wherein the recommended index function is used to determine the recommended index of the first combined route;
    基于所述推荐指标函数的参数分布信息,生成所述推荐指标函数的多个候选参数;Based on the parameter distribution information of the recommendation index function, generating a plurality of candidate parameters of the recommendation index function;
    从所述推荐指标函数的多个候选参数中采样所述推荐指标函数的目标参数;Sampling a target parameter of the recommendation index function from a plurality of candidate parameters of the recommendation index function;
    基于所述推荐指标函数的目标参数确定各个第一组合路线的推荐指标。The recommendation index of each first combined route is determined based on the target parameter of the recommendation index function.
  6. 根据权利要求5所述的方法,其中,所述基于所述推荐指标函数的目标参数确定各个第一组合路线的推荐指标,包括:The method according to claim 5, wherein determining the recommendation index of each first combined route based on the target parameter of the recommendation index function comprises:
    对于任一个第一组合路线,获取所述任一个第一组合路线的至少一个参照信息,任一个 参照信息为舒适度、安全度、所述自动驾驶车辆的速度、不确定度、礼貌程度以及流通度中的任一项,所述舒适度用于描述加速度,所述安全度用于描述碰撞信息,所述不确定度用于描述目标主体的轨迹点的集中程度,所述目标主体为障碍车或者自动驾驶车辆,所述礼貌程度用于描述所述自动驾驶车辆对所述障碍车的运动所造成的影响,所述流通度用于描述所述自动驾驶车辆所处环境中车辆的平均速度;For any first combined route, at least one reference information of any first combined route is obtained, any The reference information is any one of comfort, safety, speed of the autonomous driving vehicle, uncertainty, politeness, and circulation, wherein the comfort is used to describe acceleration, the safety is used to describe collision information, the uncertainty is used to describe the concentration of trajectory points of a target subject, the target subject is an obstacle vehicle or an autonomous driving vehicle, the politeness is used to describe the influence of the autonomous driving vehicle on the movement of the obstacle vehicle, and the circulation is used to describe the average speed of vehicles in the environment where the autonomous driving vehicle is located;
    基于所述任一个第一组合路线的各个参照信息和所述各个参照信息对应的推荐指标函数的目标参数,确定所述任一个第一组合路线的推荐指标。The recommendation index of any one of the first combined routes is determined based on each reference information of the first combined routes and a target parameter of a recommendation index function corresponding to each reference information.
  7. 根据权利要求2所述的方法,其中,所述基于所述自动驾驶车辆的历史实际行驶轨迹和所述历史偏差信息确定所述试探路线,包括:The method according to claim 2, wherein the determining the trial route based on the historical actual driving trajectory of the autonomous driving vehicle and the historical deviation information comprises:
    响应于所述历史偏差信息不小于第一阈值,则获取至少一个映射关系,任一个映射关系用于描述行驶轨迹集合和参考路线之间的映射关系,所述行驶轨迹集合包括至少一个行驶轨迹;In response to the historical deviation information being not less than a first threshold, obtaining at least one mapping relationship, any one of which is used to describe a mapping relationship between a driving trajectory set and a reference route, the driving trajectory set including at least one driving trajectory;
    从所述至少一个映射关系中选择目标映射关系,所述目标映射关系对应的行驶轨迹集合包括的至少一个行驶轨迹,与所述自动驾驶车辆的历史实际行驶轨迹和所述障碍车的历史实际行驶轨迹相匹配;Selecting a target mapping relationship from the at least one mapping relationship, wherein the driving trajectory set corresponding to the target mapping relationship includes at least one driving trajectory that matches the historical actual driving trajectory of the autonomous driving vehicle and the historical actual driving trajectory of the obstacle vehicle;
    将所述目标映射关系对应的参考路线确定为所述试探路线。A reference route corresponding to the target mapping relationship is determined as the trial route.
  8. 根据权利要求7所述的方法,其中,所述方法还包括:The method according to claim 7, wherein the method further comprises:
    基于所述试探路线和所述障碍车的历史实际行驶轨迹,确定所述障碍车的至少一个第二候选路线;Determining at least one second candidate route for the obstacle vehicle based on the trial route and the historical actual driving trajectory of the obstacle vehicle;
    将所述障碍车的任一个第二候选路线和所述试探路线进行组合,得到任一个第二组合路线;Combining any second candidate route of the obstacle vehicle with the trial route to obtain any second combined route;
    确定各个第二组合路线的推荐指标,从各个第二组合路线中选择推荐指标最高的第二组合路线;Determine the recommended index of each second combination route, and select the second combination route with the highest recommended index from each second combination route;
    所述至少根据所述障碍车的行驶意图对所述自动驾驶车辆进行自动驾驶决策规划,包括:The step of performing autonomous driving decision planning for the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle includes:
    至少根据所述障碍车的行驶意图和所述推荐指标最高的第二组合路线,对所述自动驾驶车辆进行自动驾驶决策规划。The autonomous driving decision planning is performed on the autonomous driving vehicle at least based on the driving intention of the obstacle vehicle and the second combined route with the highest recommended index.
  9. 根据权利要求2所述的方法,其中,所述基于所述障碍车的历史期望行驶轨迹和所述障碍车的历史实际行驶轨迹确定历史偏差信息,包括:The method according to claim 2, wherein the determining of the historical deviation information based on the historical expected driving trajectory of the obstacle vehicle and the historical actual driving trajectory of the obstacle vehicle comprises:
    对于任一个障碍车,确定所述任一个障碍车的历史期望行驶轨迹和所述任一个障碍车的历史实际行驶轨迹之间的偏差信息;For any obstacle vehicle, determining deviation information between a historical expected driving trajectory of the obstacle vehicle and a historical actual driving trajectory of the obstacle vehicle;
    基于各个障碍车的历史期望行驶轨迹和所述各个障碍车的历史实际行驶轨迹之间的偏差信息,确定所述历史偏差信息。The historical deviation information is determined based on deviation information between the historical expected driving trajectory of each obstacle vehicle and the historical actual driving trajectory of each obstacle vehicle.
  10. 根据权利要求9所述的方法,其中,所述任一个障碍车的历史期望行驶轨迹包括多个时刻的期望轨迹点,所述任一个障碍车的历史实际行驶轨迹包括多个时刻的实际轨迹点;The method according to claim 9, wherein the historical expected driving trajectory of any barrier vehicle includes expected trajectory points at multiple moments, and the historical actual driving trajectory of any barrier vehicle includes actual trajectory points at multiple moments;
    所述确定所述任一个障碍车的历史期望行驶轨迹和所述任一个障碍车的历史实际行驶轨迹之间的偏差信息,包括:The determining of the deviation information between the historical expected driving trajectory of any obstacle vehicle and the historical actual driving trajectory of any obstacle vehicle includes:
    对于任一个时刻,基于所述任一个时刻的期望轨迹点的位置信息和所述任一个时刻的实际轨迹点的位置信息,确定所述任一个时刻对应的期望轨迹点和实际轨迹点之间的距离;For any moment, based on the position information of the expected trajectory point at the any moment and the position information of the actual trajectory point at the any moment, determine the distance between the expected trajectory point and the actual trajectory point corresponding to the any moment;
    基于各个时刻对应的期望轨迹点和实际轨迹点之间的距离,确定所述任一个障碍车的历史期望行驶轨迹和所述任一个障碍车的历史实际行驶轨迹之间的偏差信息。Based on the distance between the expected trajectory point and the actual trajectory point corresponding to each moment, the deviation information between the historical expected driving trajectory of any obstacle vehicle and the historical actual driving trajectory of any obstacle vehicle is determined.
  11. 根据权利要求1至10任一所述的方法,其中,所述根据所述障碍车的相关信息确定所述障碍车的行驶意图,包括:The method according to any one of claims 1 to 10, wherein determining the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle comprises:
    根据所述障碍车的相关信息确定所述障碍车在时间维度的意图;Determining the intention of the obstacle vehicle in the time dimension according to the relevant information of the obstacle vehicle;
    根据所述障碍车的相关信息确定所述障碍车在空间维度的意图;Determining the intention of the obstacle vehicle in the spatial dimension according to the relevant information of the obstacle vehicle;
    将所述障碍车在时间维度的意图和所述障碍车在空间维度的意图确定为所述障碍车的行驶意图。 The intention of the obstacle vehicle in the time dimension and the intention of the obstacle vehicle in the space dimension are determined as the driving intention of the obstacle vehicle.
  12. 根据权利要求1至7、9和10中任一所述的方法,其中,所述至少根据所述障碍车的行驶意图对所述自动驾驶车辆进行自动驾驶决策规划,包括:The method according to any one of claims 1 to 7, 9 and 10, wherein the step of performing autonomous driving decision planning for the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle comprises:
    响应于所述障碍车的行驶意图发生改变,至少根据所述障碍车的行驶意图确定所述障碍车的目标行驶路线;In response to a change in the driving intention of the barrier vehicle, determining a target driving route of the barrier vehicle at least according to the driving intention of the barrier vehicle;
    基于所述障碍车的目标行驶路线确定所述自动驾驶车辆的目标行驶路线。A target driving route of the autonomous driving vehicle is determined based on the target driving route of the obstacle vehicle.
  13. 根据权利要求1至7、9和10中任一所述的方法,其中,所述至少根据所述障碍车的行驶意图对所述自动驾驶车辆进行自动驾驶决策规划,包括:The method according to any one of claims 1 to 7, 9 and 10, wherein the step of performing autonomous driving decision planning for the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle comprises:
    响应于所述障碍车的行驶意图未改变,获取所述自动驾驶车辆与所述障碍车之间的距离;In response to the driving intention of the obstacle vehicle not changing, acquiring a distance between the autonomous driving vehicle and the obstacle vehicle;
    若所述自动驾驶车辆与所述障碍车之间的距离小于距离阈值,则控制所述自动驾驶车辆停止行驶。If the distance between the autonomous driving vehicle and the obstacle vehicle is less than a distance threshold, the autonomous driving vehicle is controlled to stop driving.
  14. 一种自动驾驶决策规划装置,其中,所述装置包括:An automatic driving decision-making planning device, wherein the device comprises:
    控制模块,用于响应于自动驾驶车辆所处环境中存在障碍车,控制所述自动驾驶车辆按照试探路线进行行驶,所述障碍车的行驶路线与所述自动驾驶车辆的行驶路线存在冲突;a control module, configured to control the autonomous driving vehicle to travel along a trial route in response to the presence of an obstacle vehicle in the environment where the autonomous driving vehicle is located, wherein the route of the obstacle vehicle conflicts with the route of the autonomous driving vehicle;
    获取模块,用于在所述自动驾驶车辆按照所述试探路线进行行驶的过程中,获取所述障碍车的相关信息;An acquisition module, used for acquiring relevant information of the obstacle vehicle during the process of the autonomous driving vehicle driving along the trial route;
    确定模块,用于根据所述障碍车的相关信息确定所述障碍车的行驶意图;A determination module, used to determine the driving intention of the obstacle vehicle according to the relevant information of the obstacle vehicle;
    规划模块,用于至少根据所述障碍车的行驶意图对所述自动驾驶车辆进行自动驾驶决策规划。A planning module is used to perform autonomous driving decision planning for the autonomous driving vehicle at least according to the driving intention of the obstacle vehicle.
  15. 一种自动驾驶车辆,其中,所述自动驾驶车辆包括处理器和存储器,所述存储器中存储有至少一条计算机程序,所述至少一条计算机程序由所述处理器加载并执行,以使所述自动驾驶车辆实现权利要求1至13任一所述的自动驾驶决策规划方法。An autonomous driving vehicle, wherein the autonomous driving vehicle comprises a processor and a memory, wherein the memory stores at least one computer program, and the at least one computer program is loaded and executed by the processor so that the autonomous driving vehicle implements the autonomous driving decision planning method described in any one of claims 1 to 13.
  16. 一种非临时性计算机可读存储介质,其中,所述非临时性计算机可读存储介质中存储有至少一条计算机程序,所述至少一条计算机程序由处理器加载并执行,以使自动驾驶车辆实现如权利要求1至13任一所述的自动驾驶决策规划方法。A non-temporary computer-readable storage medium, wherein at least one computer program is stored in the non-temporary computer-readable storage medium, and the at least one computer program is loaded and executed by a processor to enable an autonomous driving vehicle to implement the autonomous driving decision planning method as described in any one of claims 1 to 13.
  17. 一种计算机程序,其中,所述计算机程序中存储有至少一条计算机指令,所述至少一条计算机指令由处理器加载并执行,以使自动驾驶车辆实现如权利要求1至13任一所述的自动驾驶决策规划方法。A computer program, wherein at least one computer instruction is stored in the computer program, and the at least one computer instruction is loaded and executed by a processor to enable an autonomous driving vehicle to implement the autonomous driving decision planning method as described in any one of claims 1 to 13.
  18. 一种计算机程序产品,其中,所述计算机程序产品中存储有至少一条计算机指令,所述至少一条计算机指令由处理器加载并执行,以使自动驾驶车辆实现如权利要求1至13任一所述的自动驾驶决策规划方法。 A computer program product, wherein at least one computer instruction is stored in the computer program product, and the at least one computer instruction is loaded and executed by a processor to enable an autonomous driving vehicle to implement the autonomous driving decision planning method as described in any one of claims 1 to 13.
PCT/CN2023/086587 2022-10-24 2023-04-06 Autonomous driving decision planning and autonomous vehicle WO2024087522A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202211303615.2A CN117962917A (en) 2022-10-24 2022-10-24 Automatic driving decision planning method and automatic driving vehicle
CN202211303615.2 2022-10-24

Publications (1)

Publication Number Publication Date
WO2024087522A1 true WO2024087522A1 (en) 2024-05-02

Family

ID=90829839

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2023/086587 WO2024087522A1 (en) 2022-10-24 2023-04-06 Autonomous driving decision planning and autonomous vehicle

Country Status (2)

Country Link
CN (1) CN117962917A (en)
WO (1) WO2024087522A1 (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113635912A (en) * 2021-09-10 2021-11-12 阿波罗智能技术(北京)有限公司 Vehicle control method, device, equipment, storage medium and automatic driving vehicle
CN113715814A (en) * 2021-09-02 2021-11-30 北京百度网讯科技有限公司 Collision detection method, collision detection device, electronic apparatus, medium, and autonomous vehicle
CN113799797A (en) * 2021-07-27 2021-12-17 北京三快在线科技有限公司 Trajectory planning method and device, storage medium and electronic equipment
CN114852103A (en) * 2022-05-23 2022-08-05 北京小马睿行科技有限公司 Method and device for determining vehicle driving strategy and vehicle
CN115214722A (en) * 2022-08-15 2022-10-21 阿波罗智联(北京)科技有限公司 Automatic driving method, device, electronic equipment, storage medium and vehicle

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113799797A (en) * 2021-07-27 2021-12-17 北京三快在线科技有限公司 Trajectory planning method and device, storage medium and electronic equipment
CN113715814A (en) * 2021-09-02 2021-11-30 北京百度网讯科技有限公司 Collision detection method, collision detection device, electronic apparatus, medium, and autonomous vehicle
CN113635912A (en) * 2021-09-10 2021-11-12 阿波罗智能技术(北京)有限公司 Vehicle control method, device, equipment, storage medium and automatic driving vehicle
CN114852103A (en) * 2022-05-23 2022-08-05 北京小马睿行科技有限公司 Method and device for determining vehicle driving strategy and vehicle
CN115214722A (en) * 2022-08-15 2022-10-21 阿波罗智联(北京)科技有限公司 Automatic driving method, device, electronic equipment, storage medium and vehicle

Also Published As

Publication number Publication date
CN117962917A (en) 2024-05-03

Similar Documents

Publication Publication Date Title
CN112400202B (en) Eye tracking with prediction and post update to GPU for fast foveal rendering in HMD environment
EP3491493B1 (en) Gesture based control of autonomous vehicles
US11858148B2 (en) Robot and method for controlling the same
CN111566612A (en) Visual data acquisition system based on posture and sight line
US10620720B2 (en) Input controller stabilization techniques for virtual reality systems
CN112400150A (en) Dynamic graphics rendering based on predicted glance landing sites
CN112307642B (en) Data processing method, device, system, computer equipment and storage medium
CN103608741A (en) Tracking and following of moving objects by a mobile robot
KR20200057414A (en) Electronic device for providing driving guide information and method thereof
WO2022226736A1 (en) Multi-screen interaction method and apparatus, and terminal device and vehicle
WO2021052008A1 (en) Screen projection method and system
US20190354178A1 (en) Artificial intelligence device capable of being controlled according to user action and method of operating the same
CN108627176A (en) Screen luminance adjustment method and Related product
KR20210057358A (en) Gesture recognition method and gesture recognition device performing the same
KR20190098102A (en) Artificial intelligence device for controlling external device
JP2022089774A (en) Device and method for monitoring driver in vehicle
CN110614634B (en) Control method, portable terminal, and storage medium
KR102639904B1 (en) Robot for airport and method thereof
EP3115926A1 (en) Method for control using recognition of two-hand gestures
CN112915541B (en) Jumping point searching method, device, equipment and storage medium
CN113343457B (en) Automatic driving simulation test method, device, equipment and storage medium
CN111038497B (en) Automatic driving control method and device, vehicle-mounted terminal and readable storage medium
WO2024087522A1 (en) Autonomous driving decision planning and autonomous vehicle
CN113110487A (en) Vehicle simulation control method and device, electronic equipment and storage medium
US11170539B2 (en) Information processing device and information processing method