METHOD OF LANE CHANGE DECISION-MAKING AND PATH PLANNING
20190202462 ยท 2019-07-04
Assignee
Inventors
Cpc classification
B60W30/18163
PERFORMING OPERATIONS; TRANSPORTING
B60W2554/804
PERFORMING OPERATIONS; TRANSPORTING
B60W2420/403
PERFORMING OPERATIONS; TRANSPORTING
B60W2754/10
PERFORMING OPERATIONS; TRANSPORTING
B60W2552/00
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A method of lane change and path planning that receives sensed signals from multiple sensors through a car computer on a vehicle to generate multiple traveling speed time-sorted information and multiple surrounding circumstance time-sorted information, and to further generate a 33 grid corresponding to the surroundings of the vehicle; when receiving a signal to switch on the turn signals, the car computer selects data within a time interval from those traveling speed time-sorted information and surrounding circumstance time-sorted information, respectively; and then the selected data is to be processed together with the 33 grid to generate a lane change space, and through a decision strategy to determine whether the lane change space complies with a safety movement strategy, and then the car computer generates a planned path of movement, such that a safest space for assisting lane change is provided for improving convenience and safety.
Claims
1. A method of lane change decision-making and path planning, applied to a host vehicle having multiple sensors to sense data, the data sensed by the sensors being received by a car computer on the host vehicle, and the car computer executing the following steps: receiving multiple traveling speed sensed data and multiple surrounding circumstance sensed data, and respectively generating traveling speed time-sorted information and surrounding circumstance time-sorted information; according to the traveling speed time-sorted information and the surrounding circumstance time-sorted information, generating a 33 grid which corresponds to a surrounding area of the host vehicle; according to a switch-on signal of turn signals, selecting multiple data within a time interval from the traveling speed time-sorted information and the surrounding circumstance time-sorted information respectively, and generating at least one lane change space based on the selected data and the 33 grid; through a decision-making model, determining whether the at least one lane change space complies with a safety movement strategy, and then generating a planned path of movement for the host vehicle.
2. The method as claimed in claim 1, wherein the 33 grid comprises three front blocks on a front side of the host vehicle, two side blocks on both lateral sides of the host vehicle and three back blocks on a back side of the host vehicle, and each block having a coverage area defined by a longitudinal length and a transverse length of the block; wherein the longitudinal length of each front block's coverage area is calculated as follows:
D.sub.front=max{D.sub.break,D.sub.min.sub.
D.sub.ego=max{D.sub.break,D.sub.min.sub.
D.sub.back=D.sub.min+max{V.sub.breakV.sub.ego,0}Time.sub.LC; D.sub.back: a longitudinal length of the back block's coverage area; D.sub.min: the minimum safe distance between the host vehicle and a vehicle behind.
3. The method as claimed in claim 2, wherein the lane change time for the host vehicle is calculated according to the following:
Time.sub.LC=2t.sub.1+2t.sub.2; t.sub.1: a first acceleration time of lane change; t.sub.2: a second acceleration time of lane change.
4. The method as claimed in claim 3, wherein, the first acceleration time of the lane change t.sub.1, is calculated according to the following:
t.sub.1=a/J; a: lateral acceleration; J: jerk; wherein the second acceleration time of the lane change t.sub.2 is calculated according to the following:
5. The method as claimed in claim 4, wherein the braking distance between the host vehicle and the vehicle D.sub.break is calculated according to the following:
D.sub.break=V.sub.ego(TB+TTR)+L.sub.ego; TB: collision time with the front vehicle; TTR: response time; wherein the collision time with the front vehicle D.sub.break is calculated by the following:
a.sub.r=0.4g,g=9.8; wherein the minimum safe distance between the host vehicle and the front vehicle D.sub.min.sub.
D.sub.min.sub.
D.sub.min=V.sub.back/2; V.sub.back: longitudinal speed of the vehicle behind.
6. The method as claimed in claim 5, wherein the switch-on signal of the turn signals is a continuously outputting pulse signal, each time the car computer receives the switch-on signal, the car computer reselects multiple data within the time interval from the traveling speed time-sorted information and the surrounding circumstance time-sorted information respectively, and generates the at least one lane change space based on the selected data and the 33 grid, until the switch-on signal of the turn signals is no longer received by the car computer.
7. The method as claimed in claim 6, wherein when the car computer receives a steering wheel signal and determines whether a rotation value of the steering wheel signal exceeds a default rotation value, then the car computer deletes the traveling speed time-sorted information and the surrounding circumstance time-sorted information for the time interval between a first time point when the car computer determines that the rotation value of the steering wheel signal exceeds the default rotation value and a second time point when the car computer receives a switch-off signal of the turn signals.
8. The method as claimed in claim 7, wherein, the car computer sorts the traveling speed sensed data and the surrounding circumstance sensed data in time sequence according to the time point when the data is sensed, so as to generate the traveling speed time-sorted information and the surrounding circumstance time-sorted information; and the car computer determines an information length of the traveling speed time-sorted information and the surrounding circumstance time-sorted information for the current lane change, checks whether the information length for the current lane change is shorter than a default information length, and if affirmative, pads in blank data to the traveling speed time-sorted information and the surrounding circumstance time-sorted information for the current lane change so as to keep the information length of the current lane change same as the default information length.
9. The method as claimed in claim 8, wherein, the car computer generates a longitudinal movement distance of lane change according to the lane change time for the host vehicle and the longitudinal speed of the host vehicle, and the car computer also generates the planned path of movement through a trapezoidal acceleration trajectory model based on the first acceleration time of the lane change, the second acceleration time of the lane change, the longitudinal movement distance of lane change and a lane width.
10. The method as claimed in claim 9, wherein, the traveling speed sensed data includes relative longitudinal speed, relative lateral acceleration, and relative acceleration between the host vehicle and its surrounding vehicles, as well as longitudinal speed of the vehicle, and longitudinal speeds and lateral speeds of the surrounding vehicles; the surrounding circumstance sensed data includes the lane width and locations of the surrounding vehicles.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0012]
[0013]
[0014]
[0015]
[0016]
[0017]
[0018]
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0019] The following, with the drawings and the preferred embodiment of the present invention, further illustrates the technical means that the present invention adopts to achieve the intended purpose.
[0020] Referring to
[0021] The road 20 is partitioned by a plurality of lane markings 201 into a central lane 21, an outer lane 22 and an inner lane 23, wherein the road as illustrated by the drawings is only an example and it is not limited thereto. Taking the direction of
[0022] In the following, the traveling of the host vehicle 10 on the central lane 21 is taken as an example, multiple traveling speed sensed data and multiple surrounding circumstance sensed data is sensed through sensors on the host vehicle 10, wherein the multiple traveling speed sensed data include information about the relative longitudinal speed, the relative lateral acceleration and the relative acceleration between the host vehicle 10 and other surrounding vehicles, the longitudinal speed and the lateral speed of the host vehicle 10 as well as the longitudinal speeds and the lateral speeds of the surrounding vehicles; and the surrounding circumstance sensed data include information such as the lane width of the middle lane 21, the lane width of the outer lane 22, the lane width of the inner lane 23, and the sensing of the presence of vehicles and their locations within the surrounding area of the host vehicle 10.
[0023] Since the sensors of the host vehicle 10 sense and then transmit sensed data to the car computer at every sensing time point, the car computer respectively sorts the multiple traveling speed sensed data and the multiple surrounding circumstance sensed data in time sequence according to the sensing time of each data, and then the data is respectively processed to get a traveling speed time-sorted information and a surrounding circumstance time-sorted information, then the information can be retrieved directly and conveniently by the car computer to get the data within a certain time interval when the car computer determines to change lane. Further examples to briefly describe how to process to obtain the time-sorted information are shown in the table below:
TABLE-US-00001 sensing time information T1 T2 T3 the longitudinal V.sub.longitudinal.sub.
[0024] Because within each lane change time, the retrieved time sequenced data is of a different length for the car computer, and in order to allow the car computer to process the data sensed at time point T1, T2, T3, namely, V.sub.longitudinal.sub._.sub.11, V.sub.longitudinal.sub._.sub.12, V.sub.longitudinal.sub._.sub.13 as one processing data, the longitudinal speed data of the first lane change is sequenced by time as the time-sorted information such as [V.sub.longitudinal.sub._.sub.11, V.sub.longitudinal.sub._.sub.12, V.sub.longitudinal.sub._.sub.13], and the longitudinal speed data of the second lane change is sequenced by time as the time-sorted information such as [V.sub.longitudinal.sub._.sub.21, V.sub.longitudinal.sub._.sub.22].
[0025] However, since each lane change time could be different from another, the amounts of data retrieved could also differ. For example, the longitudinal speed data of the first lane change is retrieved within T1 to T3 time intervals, but the longitudinal speed data of the second lane change is retrieved within T1 to T2 time interval, so the information lengths of the time-sorted information of the longitudinal speed data of the first and the second lane changes are not the same, resulting in ineffective handling by the car computer. In order for the car computer to process time-sorted information effectively, by way of time-sorted information unification, namely, to firstly compare the information lengths of the time-sorted information of the longitudinal speed data of the first and the second lane changes with a default information length, for example, the default information length is three pieces of data but not limited thereto, so the information length of the time-sorted information of the longitudinal speed data of the first lane change is the same as the default information length. However, the information length of the time-sorted information of the longitudinal speed data of the second lane change is only two pieces. Hence, the information length of the time-sorted information of the longitudinal speed data of the second lane change is less than the default information length. Then, the time-sorted information of the longitudinal speed of the second lane change will be padded with None data at the T3 sensing time point, where None represents a null value data, so as to set the longitudinal speed of the second lane change at T3 sensing time point with blank data to indicate that no data is sensed. Therefore, the time-sorted information of the longitudinal speed data of the second lane change is [V.sub.longitudinal.sub._.sub.21, V.sub.longitudinal.sub._.sub.22, None]. In other words, the sensing time point without sensed data in the time-sorted information of the longitudinal speed data of the second lane change is padded with blank data so that the length of the time-sorted information for lane change will always be the same as the default information length so as to facilitate the car computer to process the current as well as follow-up time-sorted information for lane change.
[0026] The car computer processes the multiple traveling speed sensed data and the multiple surrounding circumstance sensed data into the multiple traveling speed time-sorted information and the multiple surrounding circumstance time-sorted information through time sequencing and information unification. According to the traveling speed time-sorted information and the surrounding circumstance time-sorted information, the car computer generates a 33 grid 30 which corresponds to the vehicle's surroundings and to relate to the central lane 21, the outer lane 22 and the inner lane 23. The 33 grid 30 comprises a first block 31, a second block 32, a third block 33, a fourth block 34, a fifth block 35, a sixth block 36, a seventh block 37, an eighth block 38, and a ninth block 39 which is surrounded by the first to the eighth blocks 3138. The ninth block 39 corresponds to the location of the host vehicle 10. The first block 31, the fourth block 34 and the sixth block 36 (they are also called front blocks hereinafter) are located in the first direction 202 of the host vehicle 10, with the first block 31 corresponding to the outer lane 22, the fourth block 34 corresponding to the central lane 21 and the sixth block 36 corresponding to the inner lane 23. The second block 32 is located in the third direction 204 of the host vehicle 10 and corresponds to the outer lane 22, and the seventh block 37 is located at the fourth direction 205 of the host vehicle 10 and corresponds to the inner lane 23 (The second block 32 and the seventh block 37 are also called side blocks hereinafter). The third block 33, the fifth block 35 and the eighth block 38 (they are also called back blocks hereinafter) are located in the second direction 203 of the host vehicle 10, with the third blocks 33 corresponding to the outer lane 22, the fifth block 35 corresponding to the central lane 21 and the eighth block 38 corresponding to the inner lane 23.
[0027] It should be particularly noted that the 33 grid 30 is generated based on continuously sensed multiple traveling speed sensed data and multiple surrounding circumstance sensed data.
[0028] The coverage area of each block of the 33 grid 30 changes as the speed of the host vehicle 10 changes.
[0029] In this embodiment, the coverage areas of the first block 31, the fourth block 34 and the sixth block 36 in the 33 grid 30 each have a longitudinal length as well as a lateral length, and the lateral length is the width of the lane, and the longitudinal lengths of the first block 31, the fourth block 34 and the sixth block 36 are each calculated according to the following formula:
D.sub.front=max{D.sub.break,D.sub.min.sub.
D.sub.break=V.sub.ego(TB+TTR)+L.sub.ego; [0037] TB: collision time with the front vehicle (Time to Breaking, TB); [0038] TTR: response time (Time To React); based on the driver's reaction time developed by the European New Car Assessment Program (Euro NACP); [0039] wherein, TB is calculated by the following formula:
a.sub.r=0.4g,g=9.8; [0043] wherein, D.sub.min.sub.
D.sub.min.sub.
Time.sub.LC=2t.sub.1+2t.sub.2; [0045] t.sub.1: the first acceleration time of the lane change; [0046] t.sub.2: the second acceleration time of the lane change; [0047] wherein, t.sub.1 is calculated by the following formula:
t.sub.1=a/J; [0048] a: lateral acceleration; in this embodiment, a is a preset value which may be set according to the actual situation, wherein a preferred value of a may be 1.5 but not limited thereto; [0049] J: jitter; wherein, J is a preset value which may be set according to the actual situation, wherein a preferred value of J may be 3, but not limited thereto; [0050] wherein, t.sub.2 is calculated by the following formula:
[0051] y.sub.eva: lane width.
[0052] In this embodiment, the coverage areas of the second block 32 and the seventh block 37 in the 33 grid 30 each have the longitudinal length and the lateral length, and the lateral length is the width of the lane. The longitudinal lengths of the coverage areas of the second block 32 and the seventh block 37 are each calculated according to the following formula:
D.sub.ego=max {D.sub.break,D.sub.min.sub.
[0054] In this embodiment, the coverage areas of the third block 33, the fifth block 35 and the eighth block 38 in the 33 grid 30 each have a longitudinal length and a lateral length, and the lateral length is the width of the lane, and the longitudinal lengths of the third block 33, the fifth block 35 and the eighth block 38 are each calculated according to the following formula:
D.sub.back=D.sub.min+max{V.sub.breakV.sub.ego,0}Time.sub.LC; [0055] D.sub.back: the longitudinal length of a back block's coverage area; [0056] D.sub.min: the minimum safe distance between the host vehicle and a vehicle behind;
D.sub.min=V.sub.back/2; [0057] V.sub.back: longitudinal speed of the vehicle behind.
[0058] After the car computer of the host vehicle 10 generates the 33 grid 30, as shown in
[0059] Specifically, for example, when it is sensed that a front vehicle 40 is in the fourth block 34 and the driver intends to change lane from the central lane 21 to the inner lane 23, then, when the car computer receives the switch-on signal of the turn signals, the car computer will calculate the lane change space according to the selected data and the 33 grid 30 and determines whether the lane change space complies with the safety movement strategy through the decision-making model. The lane change space refers to the safest braking distance for the host vehicle 10 and the front vehicle 40 within the fourth block 34, and when the lane change space between the host vehicle 10 and the front vehicle 40 complies with the safety movement strategy, then the car computer will mark a safe distance indicator 301 for the fourth block 34 to be used by the car computer and generates the planned path of movement 302.
[0060] In this embodiment, the manner of retrieving the data within the time interval from the traveling speed time-sorted information and the surrounding circumstance time-sorted information refers to the situation that at the time point when the car computer receives the switch-on signal of the turn signals, the car computer will start to search and to retrieve from the traveling speed time-sorted information and the surrounding circumstance time-sorted information for the data corresponding to the time point and the time interval further backward. The time interval may be set as, for example, 0.4 second, but not limited thereto.
[0061] In this embodiment, since the switch-on signal of the turn signals is a continuously output pulse signal, each time the car computer receives the switch-on signal, it will reselect multiple data within the time interval respectively from the traveling speed time-sorted information and the surrounding circumstance time-sorted information, and generates at least one lane change space based on the selected data and the 33 grid, until the switch-on signal of the turn signals is no longer received by the car computer.
[0062] In this embodiment, the decision-making model is a neural decision-making model, which is based on the traveling speed sensed data and the surrounding circumstance sensed data during the time of testing, and it generates the corresponding 33 grid for testing as well as the lane change space, and then, it will determine whether the lane change space complies with a safe space distance, and if affirmative, the lane change space will be stored as a safety movement strategy. In this way, one or more safety movement strategies are trained according to different circumstances. Therefore, the neural nodes of such neural decision-making model are implemented based on the parameter values of the traveling speed sensed data, the surrounding circumstance sensed data, the 33 grid, the lane width, and the switch-on signal of the turn signals. [0063] The planning of the planned path of movement 302 is as shown in
[0064] The planned path of movement includes a longitudinal movement distance and a lateral movement distance, and the formula for calculating the longitudinal movement distance required for the lane change of the host vehicle 10 is as follows:
R.sub.LPS=V.sub.egoTime.sub.LC; [0065] R.sub.LPS: a longitudinal movement distance of lane change; moreover, the lateral movement distance is the width of the lane y.sub.eva.
[0066] In the present embodiment, it is assumed a=1.5 m/s.sup.2 (meter: m; second: s), J=3 m/s.sup.3, y.sub.eva=3.5 m, t.sub.1=0.5 s, t.sub.2=1.31 s, R.sub.LPS=60.3 m, but not limited thereto.
[0067] Through the trapezoidal acceleration trajectory model as shown in
[0068] In this embodiment, the steering wheel is rotated to generate a steering wheel signal when the host vehicle changes lanes according to the planned path of movement. The car computer determines whether the rotation value of the steering wheel signal exceeds a default rotation value, and if affirmative, it is deemed that the host vehicle 10 has started to change lane, and when a switch-off signal of the turn signals is received, the vehicle computer deletes the traveling speed time-sorted information and the surrounding circumstance time-sorted information data within the time interval which is between the time point when the car computer determines that the rotation value of the steering wheel signal exceeds a default rotation value, and the time point when the car computer receives the switch-off signal of the turn signals.
[0069] In this embodiment, reference is made to
[0070] As seen from the above, before the host vehicle 10 starts to change lanes, it will be determined, based on the sensed data for surrounding circumstances and the vehicle's status, whether the lane to change to and the currently traveling lane have enough safe space in between to allow the host vehicle 10 to change lanes. By the determined safe space which is sufficient for lane change, the car computer of the host vehicle 10 can provide change lane assistance with the safest lane change space under any arbitrary speed, so as to achieve the objectives of improving lane change convenience and safety.
[0071] According to the aforesaid contents, a further summarized flow chart of the method for lane change decision-making and path planning according to the present invention is shown in
[0072] receiving multiple traveling speed sensed data and multiple surrounding circumstance sensed data, and generating corresponding traveling speed time-sorted information and surrounding circumstance time-sorted information (S61);
[0073] according to the traveling speed time-sorted information and the surrounding circumstance time-sorted information, generating a 33 grid 30 which corresponds to the surrounding area of the vehicle (S62);
[0074] receiving the switch-on signal of turn signals, selecting multiple data within a time interval respectively from the traveling speed time-sorted information and the surrounding circumstance time-sorted information, and generating at least one lane change space based on the selected data and the 33 grid 30 (S63);
[0075] through the decision-making model, determining whether the lane change space complies with a safety movement strategy, then generating a planned path of movement (S64).
[0076] Even though numerous characteristics and advantages of the present invention have been set forth in the foregoing description, together with details of the structure and function of the invention, the disclosure is illustrative only. Changes may be made in detail, especially in matters of shape, size, and arrangement of parts within the principles of the invention to the full extent indicated by the broad general meaning of the terms in which the appended claims are expressed.