Disclosure of Invention
The inventors of the present disclosure found that the following problems exist in the above-described related art: fixed rule based signal lamp control schemes are less flexible, resulting in inefficient control of the vehicle.
In view of this, the present disclosure provides a control technique for a vehicle, which can improve control efficiency.
According to some embodiments of the present disclosure, there is provided a control method of a vehicle, including: responding to the fact that a target vehicle enters a first target area, and calculating a first control quantity according to the lane where the target vehicle is located and the current motion state information; controlling the target vehicle to run at a constant speed in the first target area at a first target speed according to the first control quantity; in response to the target vehicle leaving the first target area, calculating a second control amount according to the extending direction of the target lane and the current motion state information of the target vehicle; and controlling the target vehicle to drive to the target lane at a second target speed at a constant speed according to the second control quantity.
In some embodiments, the second control amount is calculated in response to the target vehicle leaving the first target area and entering a second target area; and in response to the target vehicle leaving the second target area and entering a third target area, controlling the target vehicle to drive to the target lane through the third target area at a constant speed at a second target speed.
In some embodiments, the first control amount and the second control amount are calculated on the premise that the target vehicle is ensured not to collide with a road edge and other vehicles.
In some embodiments, the first optimization problem model is constructed according to a first constraint with a minimized control completion time as an objective function, the first constraint comprising: a vehicle kinematics equation; avoid other vehicles and avoid collision with the edge of the road; driving along the lane in the forward direction; at the control completion time, the speed of the target vehicle is a first target speed, the acceleration is 0, and the target vehicle does not enter the third target area; and solving the first optimization problem model by using an optimization method, and determining the first control quantity.
In some embodiments, the second optimization problem model is constructed according to a second constraint with the minimized control completion time as the objective function, the second constraint comprising: a vehicle kinematics equation; avoid other vehicles and avoid collision with the edge of the road; at the control starting moment, the target vehicle is located at the edge of the third target area, the speed is a first target speed, and the acceleration is 0; at the control completion time, the speed of the target vehicle is a second target speed, the acceleration is 0, and the driving direction of the target vehicle is consistent with the extending direction of the target lane; and solving the second optimization problem model by using an optimization method to determine the second control quantity.
In some embodiments, in response to the target vehicle entering the first target area, assigning an avoidance priority to the target vehicle; and increasing the avoiding priority of other vehicles in the first target area, the second target area and the third target area, so that the avoiding priority of other vehicles is higher than the avoiding priority of the target vehicle, and the target vehicle is ensured not to collide with other vehicles.
In some embodiments, the first target area, the second target area and the third target area are circular areas with a center of a road intersection as a dot, and the radius of the second target area is larger than the radius of the third target area and smaller than the radius of the first target area.
In some embodiments, the first control amount and the second control amount include a plurality of items of a position, a speed, an acceleration, a front wheel yaw angle speed, a posture angle of the target vehicle at each time within a control completion time.
According to still other embodiments of the present disclosure, there is provided a control apparatus of a vehicle, including: the calculating unit is used for responding to the target vehicle entering a first target area, calculating a first control quantity according to the lane where the target vehicle is located and the current motion state information, responding to the target vehicle leaving the first target area, and calculating a second control quantity according to the extending direction of the target lane and the current motion state information of the target vehicle; and the control unit is used for controlling the target vehicle to run at a constant speed in the first target area at a first target speed according to the first control quantity and controlling the target vehicle to run to the target lane at a constant speed at a second target speed according to the second control quantity.
According to still further embodiments of the present disclosure, there is provided a control apparatus of a vehicle, including: a memory; and a processor coupled to the memory, the processor configured to execute the control method of the vehicle in any of the above embodiments based on instructions stored in the memory device.
According to still further embodiments of the present disclosure, there is provided a computer-readable storage medium having stored thereon a computer program which, when executed by a processor, implements a control method of a vehicle in any of the above embodiments.
In the above embodiment, the vehicle is controlled to run at a constant speed according to the information such as the current motion state and position of the vehicle, and on the basis of this, the control amount is generated according to the direction of the target lane so as to control the vehicle to run to the target lane. In this way, it is possible to flexibly plan a control strategy for the traveling state and the traveling target of each vehicle without following a fixed traveling restriction, thereby improving the control efficiency of the vehicle.
Detailed Description
Various exemplary embodiments of the present disclosure will now be described in detail with reference to the accompanying drawings. It should be noted that: the relative arrangement of the components and steps, the numerical expressions, and numerical values set forth in these embodiments do not limit the scope of the present disclosure unless specifically stated otherwise.
Meanwhile, it should be understood that the sizes of the respective portions shown in the drawings are not drawn in an actual proportional relationship for the convenience of description.
The following description of at least one exemplary embodiment is merely illustrative in nature and is in no way intended to limit the disclosure, its application, or uses.
Techniques, methods, and apparatus known to those of ordinary skill in the relevant art may not be discussed in detail but are intended to be part of the specification where appropriate.
In all examples shown and discussed herein, any particular value should be construed as merely illustrative, and not limiting. Thus, other examples of the exemplary embodiments may have different values.
It should be noted that: like reference numbers and letters refer to like items in the following figures, and thus, once an item is defined in one figure, further discussion thereof is not required in subsequent figures.
Fig. 1 shows a flow chart of some embodiments of a control method of a vehicle of the present disclosure.
As shown in fig. 1, the method includes: step 110, calculating a first control quantity; step 120, controlling the vehicle to run at a constant speed; step 130, calculating a second control quantity; and step 140, controlling the vehicle to drive to the target lane at a constant speed.
In step 110, in response to the target vehicle entering the first target area, a first control amount is calculated according to the lane in which the target vehicle is located and the current motion state information.
In some embodiments, a control device of the vehicle, such as a central management system, may be provided for controlling the travel of the vehicle. For example, a control device may be provided at a crossing where a plurality of lanes intersect to take over an area (the take over area includes a first target area), and after the target vehicle enters the take over area, the control device takes over the driving behavior of the target vehicle and controls it.
In some embodiments, the motion state information of the target vehicle at time t may include the current position of the target vehicle (e.g., the target vehicle's rear axle midpoint coordinates x (t), y (t), velocity v (t), acceleration a (t), front wheel yaw angle
Front wheel yaw angular velocity ω (t), attitude angle θ (t), and the like.
In some embodiments, the first control amount is calculated on the premise that the target vehicle is ensured not to collide with the road edge and other vehicles. For example, it may be ensured by the embodiment in fig. 2 that the target vehicle does not collide with other vehicles in the take-over area.
Fig. 2 illustrates a flow diagram of some embodiments of the disclosed collision avoidance method.
As shown in fig. 2, the method includes: step 210, allocating avoidance priority to the target vehicle; and step 210, increasing the evasion priority of other vehicles.
In step 210, in response to the target vehicle entering the first target area, an evasive priority is assigned to the target vehicle. For example, after the target vehicle enters the first target area, a unique identifier is assigned to the target vehicle (if k-1 vehicles already exist in the entire takeover area, the identifier of the target vehicle may be set to k), and then the evasive priority of the target vehicle is set to 1 (the larger the value of the evasive priority may be set, the higher the priority is).
In step 220, the evasion priorities of other vehicles in the first target area, the second target area and the third target area are increased, so that the evasion priorities of the other vehicles are higher than the evasion priority of the target vehicle, and the target vehicle is guaranteed not to collide with the other vehicles. For example, the evasive priority of an already existing k-1 car may be increased by 1.
In some embodiments, the takeover region may be further divided into a first target region, a second target region, and a third target region. The first target area, the second target area and the third target area are all circular areas taking the center of the intersection as a circular point, and the radius of the second target area is larger than that of the third target area and smaller than that of the first target area. For example, the take-over area of an intersection may be divided according to the schematic in fig. 3.
Fig. 3 illustrates a schematic diagram of some embodiments of the takeover region partitioning of the present disclosure.
As shown in fig. 3, a take-over area is set at the intersection of a road 31 and a road 32, and is divided into a first target area, a second target area, and a third target area.
In some embodiments, the lane in which the target vehicle is currently located may be lane 311, and the target lane after the target vehicle passes through the intersection may be lane 321. In order to enable the control target vehicle to smoothly enter the lane 321 from the lane 311, the control target vehicle may be controlled to travel at a constant speed in the first target area, a control strategy for causing the target vehicle to enter the lane 321 is planned in the second target area, and the control target vehicle may be controlled to enter the lane 321 in the third target area. For example, the first control amount may be calculated by the steps in fig. 4 to control the target vehicle to travel at a constant speed.
FIG. 4 illustrates a flow diagram for some embodiments of step 110 in FIG. 1.
As shown in fig. 4, step 110 includes: step 1110, constructing a first optimization problem model; and step 1120, determining a first control quantity.
In step 1110, a first optimization problem model is constructed according to a first constraint condition with the minimized control completion time as an objective function. For example, the first constraint includes: a vehicle kinematics equation; avoid other vehicles and avoid collision with the edge of the road; driving along the lane in the forward direction; at the control completion time, the speed of the target vehicle is the first target speed, the acceleration is 0, and the target vehicle does not enter the third target area.
In some embodiments, the control start time is t0The control end time is tfThen the objective function is such that the control is completed for time tf-t0And minimum. For example, a bicycle model based vehicle kinematics equation can be employed:
Lwthe front and rear wheel base of the target vehicle.
For example, if the target vehicle has four vertices at time t, positions a (t), b (t), c (t), and d (t), and the road edges have positions a and b, the avoidance of collision with the road edge can be expressed as:
a<A(t)<b;
a<B(t)<b;
a<C(t)<b;
a<D(t)<b。
for example, if the position of the center line of the lane where the target vehicle is located is c, then the vehicle can travel forward along the lane where the target vehicle is located, which can be expressed by the formula y (t) c. The motion state information a (t) of the target vehicle at the controller time can be given
0)、ω(t
0)、v(t
0)、
x(t
0)、y(t
0) And θ (t)
0). The first target speed is v
1And according to the constraint condition, the motion state information of the target vehicle at the control completion moment is as follows:
by solving the first optimization problem model using an optimization method, [ t ] can be obtained
0,t
f]The motion states a (t), ω (t), v (t) of the target vehicle at respective times within the time period,
x (t), y (t), and θ (t). A plurality of motion states, v (t), may be selected,
Is the first control amount.
The first optimization problem model belongs to the shortest time optimal control problem and can be solved by a numerical optimization method. The driving task related to the first optimization problem model is simple, the first optimization problem model can be solved in a short time (millisecond level), and error problems caused by time consumption of solving can be ignored. For example, after the solution is completed, the motion trajectory of the target vehicle within the first target area may be recorded.
The control of the target vehicle may continue through steps 120-140 in fig. 1 after the first control amount is determined.
In step 120, the target vehicle is controlled to travel at a constant speed within the first target area at the first target speed according to the first control amount. The target vehicle is controlled to run at a constant speed, the time of the target vehicle entering the third target area can be estimated in advance, and the control strategy is accurately planned, so that the control accuracy is improved.
In step 130, in response to the target vehicle leaving the first target area, a second control amount is calculated based on the extending direction of the target lane and the current motion state information of the target vehicle. For example, the second control amount is calculated in response to the target vehicle leaving the first target area and entering the second target area.
In some embodiments, the second control amount may be calculated by the steps in fig. 5.
Fig. 5 illustrates a flow diagram for some embodiments of step 130 in fig. 1.
As shown in fig. 5, step 130 includes: step 1310, constructing a second optimization problem model; and step 1320, determining a second control quantity.
In step 1310, a second optimization problem model is constructed according to a second constraint with the minimized control completion time as an objective function. For example, the second constraint includes: a vehicle kinematics equation; avoid other vehicles and avoid collision with the edge of the road; at the control starting moment, the target vehicle is located at the edge of a third target area, the speed is the first target speed, and the acceleration is 0; at the control completion time, the speed of the target vehicle is the second target speed, the acceleration is 0, and the traveling direction of the target vehicle coincides with the extending direction of the target lane.
In some embodiments, the control start time is t'0Control end time is t'fThen the objective function is such that control is completed for time t'f-t′0And minimum. Given the control start time (when the target vehicle leaves the second target area and enters the third target area) the moving state information of the target vehicle:
at the control termination time, the motion state information of the target vehicle is:
v2is the second target speed, thetadThe lane-based traffic lane is set according to the extending direction of the target lane.
Solving the second optimization problem model by using an optimization method to obtain [ t'
0,t′
f]The motion states a (t), ω (t), v (t) of the target vehicle at respective times within the time period,
x (t), y (t), and θ (t). A plurality of motion states, v (t), may be selected,
Is the second control amount.
The second optimization problem model belongs to the shortest time optimal control problem and can be solved by adopting a numerical optimization method. The second optimization problem model involves a complex driving task and requires significant solution time (in seconds) to complete the solution. Therefore, the second target area is set as the buffer area and used for calculating the control quantity of the target vehicle in the third target area, so that the problem of control delay can be effectively solved, and the control efficiency and accuracy are improved.
In some embodiments, after the solution of the second optimization problem model is completed, the planned movement trajectory of the target vehicle may be recorded. Having determined the second control amount, the target vehicle may be controlled via step 140 of FIG. 1.
In step 140, the target vehicle is controlled to drive toward the target lane at a constant speed at the second target speed according to the second control amount. For example, in response to the target vehicle leaving the second target area and entering the third target area, the target vehicle is controlled to drive at the second target speed at a uniform speed through the third target area toward the target lane.
In some embodiments, after the target vehicle leaves the takeover area, the identification, the motion track and the avoidance priority of the target vehicle are logged out. To this end, the target vehicle is disengaged from the take over of the control device.
In the above embodiment, the vehicle is controlled to run at a constant speed according to the information such as the current motion state and position of the vehicle, and on the basis of this, the control amount is generated according to the direction of the target lane so as to control the vehicle to run to the target lane. In this way, it is possible to flexibly plan a control strategy for the traveling state and the traveling target of each vehicle without following a fixed traveling restriction, thereby improving the control efficiency of the vehicle.
Fig. 6 shows a block diagram of some embodiments of a control device of a vehicle of the present disclosure.
As shown in fig. 6, the control device 6 of the vehicle includes a calculation unit 61 and a control unit 62.
The calculation unit 61 calculates a first control amount based on the lane in which the target vehicle is located and the current motion state information in response to the target vehicle entering the first target region. The calculation unit 61 calculates the second control amount according to the extending direction of the target lane and the current motion state information of the target vehicle in response to the target vehicle leaving the first target region.
For example, the first control amount and the second control amount include a plurality of items of a position, a speed, an acceleration, a front wheel yaw angle speed, and an attitude angle of the target vehicle at each time within the control completion time.
The control unit 62 controls the target vehicle to travel at a constant speed at the first target speed within the first target area in accordance with the first control amount. The control unit 62 controls the target vehicle to travel to the target lane at a constant speed at the second target speed in accordance with the second control amount.
In some embodiments, the calculation unit 61 calculates the first control amount and the second control amount on the premise of ensuring that the target vehicle does not collide with the road edge and other vehicles.
For example, the calculation unit 61 assigns an avoidance priority to the target vehicle in response to the target vehicle entering the first target area. The calculation unit 61 increases the avoidance priority of other vehicles in the first target area, the second target area, and the third target area, so that the avoidance priority of other vehicles is higher than the avoidance priority of the target vehicle, thereby ensuring that the target vehicle does not collide with other vehicles.
In some embodiments, the calculation unit 61 constructs the first optimization problem model according to the first constraint condition with the minimized control completion time as the objective function. The first constraint includes: a vehicle kinematics equation; avoid other vehicles and avoid collision with the edge of the road; driving along the lane in the forward direction; at the control completion time, the speed of the target vehicle is the first target speed, the acceleration is 0, and the target vehicle does not enter the third target area. The calculation unit 61 solves the first optimization problem model, and determines the first control amount.
In some embodiments, the calculation unit 61 calculates the second control amount in response to the target vehicle leaving the first target area and entering the second target area. The control unit 62 controls the target vehicle to travel toward the target lane through the third target region at the second target speed at the uniform speed in response to the target vehicle leaving the second target region and entering the third target region.
For example, the calculation unit 61 constructs a second optimization problem model according to the second constraint condition with the minimized control completion time as the objective function. The second constraint includes: a vehicle kinematics equation; avoid other vehicles and avoid collision with the edge of the road; at the control starting moment, the target vehicle is located at the edge of a third target area, the speed is the first target speed, and the acceleration is 0; at the control completion time, the speed of the target vehicle is a second target speed, the acceleration is 0, and the running direction of the target vehicle is consistent with the extending direction of the target lane; and solving the second optimization problem model and determining a second control quantity.
In some embodiments, the first target area, the second target area, and the third target area are all circular areas with the intersection center as a dot. The radius of the second target area is greater than the radius of the third target area and less than the radius of the first target area.
In the above embodiment, the vehicle is controlled to run at a constant speed according to the information such as the current motion state and position of the vehicle, and on the basis of this, the control amount is generated according to the direction of the target lane so as to control the vehicle to run to the target lane. In this way, the control strategy can be planned for the running state and the running target of each vehicle without following fixed running restrictions, thereby improving the control efficiency of the vehicle.
Fig. 7 shows a block diagram of further embodiments of a control device of a vehicle of the present disclosure.
As shown in fig. 7, the control device 7 of the vehicle of the embodiment includes: a memory 71 and a processor 72 coupled to the memory 71, the processor 72 being configured to execute a control method of a vehicle in any one of the embodiments of the present disclosure based on instructions stored in the memory 71.
The memory 71 may include, for example, a system memory, a fixed nonvolatile storage medium, and the like. The system memory stores, for example, an operating system, an application program, a Boot Loader (Boot Loader), a database, and other programs.
Fig. 8 shows a block diagram of further embodiments of a control device of a vehicle of the present disclosure.
As shown in fig. 8, a control device 8 of a vehicle of this embodiment includes: a memory 810 and a processor 820 coupled to the memory 810, the processor 820 being configured to execute a control method of a vehicle in any of the foregoing embodiments based on instructions stored in the memory 810.
Memory 810 may include, for example, system memory, fixed non-volatile storage media, and the like. The system memory stores, for example, an operating system, an application program, a BootLoader (BootLoader), and other programs.
The control device 8 of the vehicle may further include an input-output interface 830, a network interface 840, a storage interface 850, and the like. These interfaces 830, 840, 850 and between the memory 810 and the processor 820 may be connected, for example, by a bus 860. The input/output interface 830 provides a connection interface for input/output devices such as a display, a mouse, a keyboard, and a touch screen. The network interface 640 provides a connection interface for various networking devices. The storage interface 850 provides a connection interface for external storage devices such as an SD card and a usb disk.
As will be appreciated by one skilled in the art, embodiments of the present disclosure may be provided as a method, system, or computer program product. Accordingly, the present disclosure may take the form of an entirely hardware embodiment, an entirely software embodiment or an embodiment combining software and hardware aspects. Furthermore, the present disclosure may take the form of a computer program product embodied on one or more computer-usable non-transitory storage media (including, but not limited to, disk storage, CD-ROM, optical storage, and the like) having computer-usable program code embodied therein.
Up to this point, the control method of the vehicle, the control apparatus of the vehicle, and the computer-readable storage medium according to the present disclosure have been described in detail. Some details that are well known in the art have not been described in order to avoid obscuring the concepts of the present disclosure. It will be fully apparent to those skilled in the art from the foregoing description how to practice the presently disclosed embodiments.
The method and system of the present disclosure may be implemented in a number of ways. For example, the methods and systems of the present disclosure may be implemented by software, hardware, firmware, or any combination of software, hardware, and firmware. The above-described order for the steps of the method is for illustration only, and the steps of the method of the present disclosure are not limited to the order specifically described above unless specifically stated otherwise. Further, in some embodiments, the present disclosure may also be embodied as programs recorded in a recording medium, the programs including machine-readable instructions for implementing the methods according to the present disclosure. Thus, the present disclosure also covers a recording medium storing a program for executing the method according to the present disclosure.
Although some specific embodiments of the present disclosure have been described in detail by way of example, it should be understood by those skilled in the art that the foregoing examples are for purposes of illustration only and are not intended to limit the scope of the present disclosure. It will be appreciated by those skilled in the art that modifications may be made to the above embodiments without departing from the scope and spirit of the present disclosure. The scope of the present disclosure is defined by the appended claims.