Dynamic velocity planning method for autonomous vehicle and system thereof
11604473 · 2023-03-14
Assignee
Inventors
- Zhi-Hao Zhang (Changhua County, TW)
- Tsung-Ming Hsu (Changhua County, TW)
- Bo-Han Lin (Changhua County, TW)
Cpc classification
B60W2554/00
PERFORMING OPERATIONS; TRANSPORTING
B60W2050/0028
PERFORMING OPERATIONS; TRANSPORTING
B60W60/0013
PERFORMING OPERATIONS; TRANSPORTING
B60W50/0098
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A dynamic velocity planning method for an autonomous vehicle is performed to plan a best velocity curve of the autonomous vehicle. An information storing step is performed to store an obstacle information, a road information and a vehicle information. An acceleration limit calculating step is performed to calculate the vehicle information according to a calculating procedure to generate an acceleration limit value range. An acceleration combination generating step is performed to generate a plurality of acceleration combinations according to the obstacle information, the road information, and the acceleration limit value range. An acceleration filtering step is performed to filter the acceleration combinations according to a jerk threshold and a jerk switching frequency threshold to obtain a selected acceleration combination. An acceleration smoothing step is performed to execute a driving behavior procedure to adjust the selected acceleration combination to generate the best velocity curve.
Claims
1. A dynamic velocity planning method for an autonomous vehicle, which is performed to plan a best velocity curve of the autonomous vehicle, and the dynamic velocity planning method for the autonomous vehicle comprising: performing an information storing step to drive a memory to store an obstacle information of an obstacle, a road information and a vehicle information of the autonomous vehicle, wherein the vehicle information comprises a jerk threshold and a jerk switching frequency threshold; performing an acceleration limit calculating step to drive a processing unit to receive the vehicle information from the memory and calculate the vehicle information according to a calculating procedure to generate an acceleration limit value range of the autonomous vehicle; performing an acceleration combination generating step to drive the processing unit to receive the obstacle information and the road information from the memory and plan an acceleration interval of the autonomous vehicle according to the obstacle information, the road information and the acceleration limit value range, and then generate a plurality of acceleration combinations of the autonomous vehicle according to the acceleration interval; performing an acceleration filtering step to drive the processing unit to filter the acceleration combinations according to the jerk threshold and the jerk switching frequency threshold to obtain a selected acceleration combination; and performing an acceleration smoothing step to drive the processing unit to execute a driving behavior procedure to adjust the selected acceleration combination to generate the best velocity curve; wherein the vehicle information further comprises a front wheel cornering stiffness, a rear wheel cornering stiffness, a front wheelbase, a rear wheelbase, a vehicle inertia and a vehicle mass.
2. The dynamic velocity planning method for the autonomous vehicle of claim 1, wherein the acceleration limit calculating step comprises: performing a lateral acceleration calculating step to drive the processing unit to calculate the vehicle information according to a dynamics calculating model to generate a lateral acceleration of the autonomous vehicle; performing a longitudinal acceleration calculating step to drive the processing unit to calculate the lateral acceleration according to a friction circle calculating model to generate a longitudinal acceleration of the autonomous vehicle; and performing a longitudinal-velocity and lateral-velocity calculating step to drive the processing unit to calculate the lateral acceleration and the longitudinal acceleration according to a kinematics calculating model to generate a lateral velocity and a longitudinal velocity of the autonomous vehicle, respectively.
3. The dynamic velocity planning method for the autonomous vehicle of claim 1, wherein the acceleration combination generating step comprises: performing an acceleration interval generating step, wherein the acceleration interval generating step is implemented by the processing unit and comprises: performing an obstacle limiting step to limit the acceleration limit value range of the autonomous vehicle according to the obstacle information to generate an initial acceleration interval; and performing a road limiting step to limit the initial acceleration interval according to the road information to generate the acceleration interval.
4. The dynamic velocity planning method for the autonomous vehicle of claim 3, wherein the acceleration combination generating step further comprises: performing an acceleration dispersing step, wherein the acceleration dispersing step is implemented by the processing unit and comprises: performing a dispersing step to generate a plurality of acceleration groups according to a predetermined time interval and the acceleration interval and disperse each of the acceleration groups according to a predetermined acceleration interval to generate at least one acceleration target point; and performing a target point combining step to sequentially combine the at least one acceleration target point of each of the acceleration groups to generate the acceleration combinations.
5. The dynamic velocity planning method for the autonomous vehicle of claim 1, wherein each of the acceleration combinations comprises a maximum jerk and a jerk switching frequency, the jerk threshold is represented as J.sub.threshold, the maximum jerk of each of the acceleration combinations is represented as J.sub.max, the jerk switching frequency of each of the acceleration combinations is represented as Jfrequency, and the jerk switching frequency threshold is represented as f.sub.threshold and conforms to the following equation:
J.sub.max≤J.sub.threshold; and
EJfrequency≤f.sub.threshold.
6. The dynamic velocity planning method for the autonomous vehicle of claim 1, wherein the acceleration smoothing step comprises: performing an adjusting step to adjust the selected acceleration combination according to one of a progressive model, a normal model and a conservative model to generate an artificial acceleration combination, wherein the artificial acceleration combination has a plurality of optimal accelerations; and performing a fitting step to integrate and smooth the optimal accelerations of the artificial acceleration combination to fit the best velocity curve.
7. A dynamic velocity planning system for an autonomous vehicle, which is performed to plan a best velocity curve of the autonomous vehicle, and the dynamic velocity planning system for the autonomous vehicle comprising: a memory configured to access an obstacle information of an obstacle, a road information, a vehicle information of the autonomous vehicle, a calculating procedure and a driving behavior procedure, wherein the vehicle information comprises a jerk threshold and a jerk switching frequency threshold; and a processing unit electrically connected to the memory, wherein the processing unit is configured to implement a dynamic velocity planning method for the autonomous vehicle comprising: performing an acceleration limit calculating step to calculate the vehicle information according to the calculating procedure to generate an acceleration limit value range of the autonomous vehicle; performing an acceleration combination generating step to plan an acceleration interval of the autonomous vehicle according to the obstacle information, the road information and the acceleration limit value range, and then generate a plurality of acceleration combinations of the autonomous vehicle according to the acceleration interval; performing an acceleration filtering step to filter the acceleration combinations according to the jerk threshold and the jerk switching frequency threshold to obtain a selected acceleration combination; and performing an acceleration smoothing step to execute the driving behavior procedure to adjust the selected acceleration combination to generate the best velocity curve; wherein the vehicle information further comprises a front wheel cornering stiffness, a rear wheel cornering stiffness, a front wheelbase, a rear wheelbase, a vehicle inertia and a vehicle mass.
8. The dynamic velocity planning system for the autonomous vehicle of claim 7, wherein the memory comprises a dynamics calculating model, a friction circle calculating model and a kinematics calculating model, and the acceleration limit calculating step comprises: performing a lateral acceleration calculating step to calculate the vehicle information according to the dynamics calculating model to generate a lateral acceleration of the autonomous vehicle; performing a longitudinal acceleration calculating step to calculate the lateral acceleration according to the friction circle calculating model to generate a longitudinal acceleration of the autonomous vehicle; and performing a longitudinal-velocity and lateral-velocity calculating step to calculate the lateral acceleration and the longitudinal acceleration according to the kinematics calculating model to generate a lateral velocity and a longitudinal velocity of the autonomous vehicle, respectively.
9. The dynamic velocity planning system for the autonomous vehicle of claim 7, wherein the processing unit is configured to implement an acceleration interval generating step, and the acceleration interval generating step comprises: performing an obstacle limiting step to limit the acceleration limit value range of the autonomous vehicle according to the obstacle information to generate an initial acceleration interval; and performing a road limiting step to limit the initial acceleration interval according to the road information to generate the acceleration interval.
10. The dynamic velocity planning system for the autonomous vehicle of claim 9, wherein the processing unit is configured to implement an acceleration dispersing step, and the acceleration dispersing step comprises: performing a dispersing step to generate a plurality of acceleration groups according to a predetermined time interval and the acceleration interval and disperse each of the acceleration groups according to a predetermined acceleration interval to generate at least one acceleration target point; and performing a target point combining step to sequentially combine the at least one acceleration target point of each of the acceleration groups to generate the acceleration combinations.
11. The dynamic velocity planning system for the autonomous vehicle of claim 7, wherein each of the acceleration combinations comprises a maximum jerk and a jerk switching frequency, the jerk threshold is represented as J.sub.threshold, the maximum jerk of each of the acceleration combinations is represented as J.sub.max, the jerk switching frequency of each of the acceleration combinations is represented as Jfrequency, and the jerk switching frequency threshold is represented as f.sub.threshold and conforms to the following equation:
J.sub.max≤J.sub.threshold; and
EJfrequency≤f.sub.threshold.
12. The dynamic velocity planning system for the autonomous vehicle of claim 7, wherein the processing unit is configured to implement the acceleration smoothing step, and the acceleration smoothing step comprises: performing an adjusting step to adjust the selected acceleration combination according to one of a progressive model, a normal model and a conservative model to generate an artificial acceleration combination, wherein the artificial acceleration combination has a plurality of optimal accelerations; and performing a fitting step to integrate and smooth the optimal accelerations of the artificial acceleration combination to fit the best velocity curve.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) The present disclosure can be more fully understood by reading the following detailed description of the embodiment, with reference made to the accompanying drawings as follows:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
DETAILED DESCRIPTION
(14) The embodiment will be described with the drawings. For clarity, some practical details will be described below. However, it should be noted that the present disclosure should not be limited by the practical details, that is, in some embodiment, the practical details is unnecessary. In addition, for simplifying the drawings, some conventional structures and elements will be simply illustrated, and repeated elements may be represented by the same labels.
(15) It will be understood that when an element (or device) is referred to as be “connected to” another element, it can be directly connected to the other element, or it can be indirectly connected to the other element, that is, intervening elements may be present. In contrast, when an element is referred to as be “directly connected to” another element, there are no intervening elements present. In addition, the terms first, second, third, etc. are used herein to describe various elements or components, these elements or components should not be limited by these terms. Consequently, a first element or component discussed below could be termed a second element or component.
(16) Please refer to
(17) The information storing step S02 is performed to drive a memory to store an obstacle information of an obstacle, a road information and a vehicle information 102 of the autonomous vehicle. The vehicle information 102 includes a jerk threshold and a jerk switching frequency threshold. The acceleration limit calculating step S04 is performed to drive a processing unit to receive the vehicle information 102 from the memory and calculate the vehicle information 102 according to a calculating procedure to generate an acceleration limit value range 104 of the autonomous vehicle. In addition, the acceleration combination generating step S06 is performed to drive the processing unit to receive the obstacle information and the road information from the memory and plan an acceleration interval of the autonomous vehicle according to the obstacle information, the road information and the acceleration limit value range 104, and then generate a plurality of acceleration combinations 106 of the autonomous vehicle according to the acceleration interval. The acceleration filtering step S08 is performed to drive the processing unit to filter the acceleration combinations 106 according to the jerk threshold and the jerk switching frequency threshold to obtain a selected acceleration combination 108. The acceleration smoothing step S10 is performed to drive the processing unit to execute a driving behavior procedure to adjust the selected acceleration combination 108 to generate the best velocity curve 110. Therefore, the dynamic velocity planning method 100 for the autonomous vehicle of the present disclosure obtains the acceleration limit value range 104 through the vehicle information 102 and the calculating procedure, and then plans the acceleration combinations 106 by integrating the acceleration limit value range 104 with the obstacle information and the road information, and uses the acceleration as a standard and considers vehicle operating limits, vehicle dynamics and human driving behaviors at the same time so as to adapt to changes in the environmental, so that the future behavior of the autonomous vehicle is predictable. The details of the abovementioned steps will be described below through more detailed embodiments.
(18) Please refer to
(19) The information storing step S12 is performed to drive a memory to store an obstacle information of an obstacle Obj, a road information and a vehicle information 102 of the autonomous vehicle HV. In detail, the autonomous vehicle HV includes a sensing module which is configured to sense the obstacle information, the road information and the vehicle information 102 and stores the obstacle information, the road information and the vehicle information 102 to the memory. The obstacle information includes an obstacle velocity V.sub.obj, an obstacle acceleration a.sub.Obj and an obstacle acceleration range 103 of the obstacle Obj. The road information includes a maximum speed limit V.sub.max and a minimum speed limit V.sub.min. The vehicle information 102 includes a jerk threshold, a jerk switching frequency threshold, a front wheel cornering stiffness, a rear wheel cornering stiffness, a front wheelbase, a rear wheelbase, a vehicle inertia and a vehicle mass.
(20) The acceleration limit calculating step S14 is performed to drive a processing unit to receive the vehicle information 102 from the memory and calculate the vehicle information 102 according to a calculating procedure to generate an acceleration limit value range 104 of the autonomous vehicle HV. In detail, the acceleration limit calculating step S14 includes performing a lateral acceleration calculating step S142, a longitudinal acceleration calculating step S144 and a longitudinal-velocity and lateral-velocity calculating step S146. The lateral acceleration calculating step S142 is performed to drive the processing unit to calculate the vehicle information 102 according to a dynamics calculating model to generate a lateral acceleration a.sub.y of the autonomous vehicle HV. The longitudinal acceleration calculating step S144 is performed to drive the processing unit to calculate the lateral acceleration a.sub.y according to a friction circle calculating model to generate a longitudinal acceleration a.sub.x of the autonomous vehicle HV. The longitudinal-velocity and lateral-velocity calculating step S146 is performed to drive the processing unit to calculate the lateral acceleration a.sub.y and the longitudinal acceleration a.sub.x according to a kinematics calculating model to generate a lateral velocity v and a longitudinal velocity u of the autonomous vehicle HV, respectively.
(21) More detail, the calculating procedure includes the dynamics calculating model, the friction circle calculating model and the kinematics calculating model. First, the dynamics calculating model includes a lateral force F.sub.y, the vehicle mass m, an acceleration {dot over (v)}, the longitudinal velocity u, a yaw rate r, a yaw angular acceleration {dot over (r)}, a front wheel lateral force F.sub.yf, a rear wheel lateral force F.sub.yr and the vehicle inertia I.sub.z and conforms to the following equation (1):
(22)
(23) The processing unit substitutes the front wheel cornering stiffness C.sub.af, the rear wheel cornering stiffness C.sub.ar the front wheelbase a, the rear wheelbase b, the vehicle inertia I.sub.z and the vehicle mass m of the vehicle information 102 into the equation (1) and derives the following equation (2) according to the dynamics calculating model:
(24)
(25) v is the lateral velocity, δ.sub.f is a front wheel angle, and t is a time. The processing unit performs a matrix multiplication and an expansion on the equation (2), and the lateral acceleration a.sub.y which conforms to the following equation (3) can be obtained after arranging:
(26)
(27) Next, the friction circle calculating model includes a maximum available longitudinal force F.sub.x,max, a longitudinal force F.sub.x, a maximum available lateral force F.sub.y,max, the lateral force F.sub.y, a maximum longitudinal acceleration a.sub.x,max, a maximum lateral acceleration a.sub.y,max, the longitudinal acceleration a.sub.x and the lateral acceleration a.sub.y, and conforms to the following equation (4). The processing unit shifts and eliminates the equation (4) to generate the longitudinal acceleration a.sub.x which conforms to the following equation (5):
(28)
(29) Finally, the kinematics calculating model includes a velocity V, an initial velocity V.sub.0, the acceleration {dot over (V)} and the time t, and conforms to the following equation (6). The processing unit generates the longitudinal velocity u and the lateral velocity v which conform to the following equation (7) according to the kinematics calculating model:
(30)
(31) S is a distance, u.sub.0 is an initial longitudinal velocity and v.sub.0 is an initial lateral velocity. Therefore, the dynamic velocity planning method 100a for the autonomous vehicle HV of the present disclosure generates the lateral acceleration a.sub.y through the vehicle information 102 and the dynamics calculating model, and then generates the longitudinal acceleration a.sub.x through the friction circle calculating model, and finally generates the longitudinal velocity u and the lateral velocity v through the kinematics calculating model. It is worth noting that two accelerations a.sub.HV of the vehicle information 102 in a longitudinal direction X and a lateral direction Y during a future path are the abovementioned longitudinal acceleration a.sub.x and the lateral acceleration a.sub.y, respectively. Two velocities V.sub.HV of the vehicle information 102 in the longitudinal direction X and the lateral direction Y are the abovementioned longitudinal velocity u and the lateral velocity v, respectively. The range of the accelerations a.sub.HV of the vehicle information 102 is the acceleration limit value range 104 of the autonomous vehicle HV.
(32) The acceleration combination generating step S16 includes performing an acceleration interval generating step S162 and an acceleration dispersing step S164. The acceleration interval generating step S162 includes performing an obstacle limiting step S1622 and a road limiting step S1624. The obstacle limiting step S1622 is performed to limit the acceleration limit value range 104 of the autonomous vehicle HV according to the obstacle information to generate an initial acceleration interval 104a. The road limiting step S1624 is performed to limit the initial acceleration interval 104a according to the road information to generate an acceleration interval 105. In detail, the processing unit limits the acceleration limit value range 104 based on the obstacle acceleration range 103 (i.e., the range of the obstacle acceleration a.sub.Obj) of the obstacle information to generate the initial acceleration interval 104a. Then, the processing unit extracts the acceleration limit value range 104 based on the maximum speed limit V.sub.max and the minimum speed limit V.sub.min to generate the acceleration interval 105. Therefore, the dynamic velocity planning method 100a for the autonomous vehicle HV of the present disclosure uses the road information and the obstacle information in a general vehicle lane to further limit the acceleration limit value range 104 of the autonomous vehicle HV to calculate the applicable acceleration range of the autonomous vehicle HV (i.e., the acceleration interval 105).
(33) Further, the acceleration dispersing step S164 includes performing a dispersing step S1642 and a target point combining step S1644. The dispersing step S1642 is performed to generate a plurality of acceleration groups G1, G2, G3, G4 according to a predetermined time interval and the acceleration interval 105, and disperse each of the acceleration groups G1, G2, G3, G4 according to a predetermined acceleration interval to generate at least one acceleration target point a.sub.T. The target point combining step S1644 is performed to sequentially combine the at least one acceleration target point a.sub.T of each of the acceleration groups G1, G2, G3, G4 to generate a plurality of acceleration combinations 106. For example, when the predetermined acceleration interval is 1 m/s.sup.2 and the predetermined time interval is 0.1 second as a standard, the acceleration interval 105 of a first trajectory point of the autonomous vehicle HV is [1,1] m/s.sup.2 and only has an acceleration value (i.e., the acceleration target point a.sub.T). Then, the next trajectory point of an acceleration value is calculated according to the first trajectory point, and the next acceleration interval 105 is [−3,5] m/s.sup.2, which can divide into 9 kinds of acceleration values −3, −2, −1, 0, 1, 2, 3, 4 and 5 m/s.sup.2. Similarly, the another trajectory point of an acceleration value is calculated according to the current trajectory point, and the another acceleration interval 105 is [−4,8] m/s.sup.2, and so on (as shown in
(34) The acceleration filtering step S18 is performed to drive the processing unit to filter the acceleration combinations 106 according to the jerk threshold and the jerk switching frequency threshold to obtain a selected acceleration combination 108. Specifically, each of the abovementioned acceleration combinations 106 includes a maximum jerk. The maximum jerk of each of the acceleration combinations 106 is less than or equal to the jerk threshold. The maximum jerk of each of the acceleration combinations 106 is represented as J.sub.max. The jerk threshold is represented as J.sub.threshold and conforms to the following equation (8):
J.sub.max≤J.sub.threshold (8).
(35) In detail, the acceleration combinations 106 include an acceleration combination 1061 and an acceleration combination 1062. The jerk threshold J.sub.threshold can be 20 m/s.sup.3. In the acceleration combination 1061, the first jerk about 10 m/s.sup.3 is generated from 1 m/s.sup.2 to 2 m/s.sup.2, and the final jerk (that is, the maximum jerk J.sub.max of the acceleration combination 1061) about 20 m/s.sup.3 is generated from 3 m/s.sup.2 to 1 m/s.sup.2. In the acceleration combination 1062, the first jerk (that is, the maximum jerk J.sub.max of the acceleration combination 1062) about 40 m/s.sup.3 is generated from 1 m/s.sup.2 to −3 m/s.sup.2, and the final jerk about 20 m/s.sup.3 is generated from 1 m/s.sup.2 to −1 m/s.sup.2. Therefore, the processing unit eliminates the abovementioned acceleration combination 1062 according to the jerk threshold J.sub.threshold.
(36) Moreover, the vehicle information 102 further includes the jerk switching frequency threshold which stores in the memory. Each of the abovementioned acceleration combinations 106 further includes a jerk switching frequency. Especially, the jerk switching frequency of each of the abovementioned acceleration combinations 106 is less than or equal to the jerk switching frequency threshold and represented as Jfrequency, and the jerk switching frequency threshold is represented as f.sub.threshold and conforms to the following equation (9):
ΣJfrequency≤f.sub.threshold (9).
(37) In detail, the jerk switching frequency threshold f.sub.threshold can be 2. When the jerk is switched between positive and negative values, the jerk switching frequency Jfrequency is accumulated once time. In the acceleration combination 1061, the acceleration target point a.sub.T changes from the beginning 1 m/s.sup.2 to 2 m/s.sup.2. Next, the acceleration target point a.sub.T changes from 2 m/s.sup.2 to 3 m/s.sup.2, and then changes from 3 m/s.sup.2 to 1 m/s.sup.2. The jerk switching frequency Jfrequency of the acceleration combination 1061 is 0. In the acceleration combination 1062, the acceleration target point a.sub.T changes from the beginning 1 m/s.sup.2 to −3 m/s.sup.2. Next, the acceleration target point a.sub.T changes from −3 m/s.sup.2 to 1 m/s.sup.2, and then changes from 1 m/s.sup.2 to −1 m/s.sup.2. The jerk switching frequency Jfrequency of the acceleration combination 1062 is 3. Hence, the processing unit eliminates the abovementioned acceleration combination 1062 according to the jerk switching frequency threshold f.sub.threshold. Therefore, the dynamic velocity planning method 100a for the autonomous vehicle HV of the present disclosure filters the acceleration combinations 106 of the vehicle dynamics through the jerk threshold J.sub.threshold and the jerk switching frequency threshold f.sub.threshold so as to generate the selected acceleration combination 108 (i.e., the acceleration combination 1061).
(38) The acceleration smoothing step S20 is performed to drive the processing unit to execute the driving behavior procedure to adjust the selected acceleration combination 108 to generate the best velocity curve 110. The driving behavior procedure is classified into the progressive model M1, the normal model M2 and the conservative model M3 according to an acceleration a, a velocity V and a steering wheel angle θ In addition, the acceleration smoothing step S20 includes an adjusting step S202 and a fitting step S204. The adjusting step S202 is performed to adjust the selected acceleration combination 108 according to one of the abovementioned progressive model M1, the normal model M2 and the conservative model M3 to generate an artificial acceleration combination 108a. The artificial acceleration combination 108a has a plurality of optimal accelerations a.sub.f1, a.sub.f2, a.sub.f3, a.sub.f4. The fitting step S204 is performed to integrate and smooth each of the optimal accelerations a.sub.f1, a.sub.f2, a.sub.f3, a.sub.f4 of the artificial acceleration combination 108a to fit the best velocity curve 110.
(39) In detail, each of the progressive model M1, the normal model M2 and the conservative model M3 includes a trend curve C. The processing unit adjusts the acceleration target points a.sub.T1, a.sub.T2, a.sub.T3, a.sub.T4 in the selected acceleration combination 108 to the optimal accelerations a.sub.f1, a.sub.f2, a.sub.f3, a.sub.f4 according to the trend curve C of one of the progressive model M1, the normal model M2 and the conservative model M3 which is similar to the selected acceleration combination 108, respectively. For example, the acceleration target point a.sub.T2 (−3 m/s.sup.2) is adjusted to the best acceleration a.sub.f2 (−2 m/s.sup.2). Finally, the artificial acceleration combination 108a is converted to a velocity combination 108b through an integration method. The velocity combination 108b is curve-fitted so as to smooth the velocity combination 108b and generate the best velocity curve 110. The controlling step S22 is performed to control the autonomous vehicle HV by an automatic driving parameter based on the best velocity curve 110. The detail of the controlling step S22 is the conventional technology, and will not be described again herein.
(40) Therefore, the dynamic velocity planning method 100a for the autonomous vehicle HV of the present disclosure changes an acceleration changing rate through the driving behavior procedure so as to obtain the artificial acceleration combination 108a, and then fits the velocity combination 108b into a smooth curve to solve the controlling shock caused by the problems of a discontinuous velocity. The collision time between the autonomous vehicle HV and the obstacle Obj can be further estimated according to the best velocity curve 110, so that the interaction relationship between the autonomous vehicle HV and the obstacle Obj can be predicted.
(41) Please refer to
(42) The sensing module 300 is configured to sense the obstacle information, the road information and the vehicle information 102 and store the obstacle information, the road information and the vehicle information 102 into the memory 400. The obstacle information includes the obstacle velocity V.sub.Obj, the obstacle acceleration a.sub.Obj. The road information includes the maximum speed limit V.sub.max and the minimum speed limit V.sub.min. The vehicle information 102 includes the jerk threshold, the jerk switching frequency threshold, the front wheel cornering stiffness, the rear wheel cornering stiffness, the front wheelbase, the rear wheelbase, the vehicle inertia and the vehicle mass of the autonomous vehicle HV. The abovementioned sensing module 300 may include a GPS, a gyroscope, an odometer, a speed meter, an Inertial Measurement Unit (IMU), a LiDAR, a radar and a camera. The sensing module 300 is the conventional technology, and will not be described again herein.
(43) The memory 400 is configured to access the obstacle information of the obstacle Obj, the vehicle information 102 of the autonomous vehicle HV, the calculating procedure and the driving behavior procedure. The driving behavior procedure is classified into the progressive model M1, the normal model M2 and the conservative model M3 according to the acceleration a, the velocity V and the steering wheel angle θ. The vehicle information 102 includes the jerk threshold J.sub.threshold and the jerk switching frequency threshold f.sub.threshold of the autonomous vehicle HV.
(44) The processing unit 500 is electrically connected to the memory 400 and the sensing module 300. The processing unit 500 is configured to implement the dynamic velocity planning methods 100, 100a for the autonomous vehicle HV. The processing unit 500 may be a microprocessor, an electronic control unit (ECU), a computer, a mobile device or other computing processors.
(45) Therefore, the dynamic velocity planning system 200 for the autonomous vehicle HV of the present disclosure uses the obstacle information, the road information and the vehicle information 102 to plan the acceleration combinations 106 feasible for the autonomous vehicle HV, and filter the acceleration combinations 106 to the artificial acceleration combination 108a suitable for driving behavior through the jerk limits so as to adapt to environmental changes in the future and improve the comfort of passengers.
(46) In summary, the present disclosure has the following advantages: First, the acceleration limit value range is obtained through the vehicle information and the calculating procedure, and the acceleration combination is planned by integrating the obstacle information with the road information. The acceleration is used as a standard, and the present disclosure considers the vehicle operating limits, the vehicle dynamics and the human driving behavior at the same time so as to adapt to changes in the environmental. Second, the feasible acceleration combinations are filtered through the jerk threshold and the jerk switching frequency threshold so as to reduce the acceleration changing rate and improve the comfort of passengers. Third, the velocity planning that can cope with changes in the environment can handle situations that cannot be handled by ordinary commercially vehicle systems, such as obstacle intrusion, a lane change pace, etc. The present disclosure makes an autonomous vehicle planning system more robust and safer to environmental changes.
(47) Although the present disclosure has been described in considerable detail with reference to certain embodiments thereof, other embodiments are possible. Therefore, the spirit and scope of the appended claims should not be limited to the description of the embodiments contained herein.
(48) It will be apparent to those skilled in the art that various modifications and variations can be made to the structure of the present disclosure without departing from the scope or spirit of the disclosure. In view of the foregoing, it is intended that the present disclosure cover modifications and variations of this disclosure provided they fall within the scope of the following claims.