The present invention relates to a vehicle motion control device and a vehicle motion control method for generating a travel path as a target of a vehicle and controlling a motion of the vehicle based on the generated travel path.
There is known an autonomous driving technique of generating a travel path configured by information such as a travel route as a target of a vehicle and the speed of the vehicle, based on a road situation on a course of the vehicle or a state of the vehicle acquired using a map, communication, or a sensor, and controlling a power train, a brake, or a steering such that the vehicle follows the generated travel path.
As a method of generating a travel path in a case where there is unevenness that can be passed by on a course of a vehicle, PTL 1 discloses a method of reducing a vertical acceleration generated above a spring of a vehicle and improving ride comfort by performing a vehicle speed control of increasing or decreasing a vehicle speed to avoid resonance of vibration generated when passing through the unevenness with the portion above the spring of the vehicle.
However, in the method disclosed in PTL 1, the longitudinal acceleration caused by the increase or decrease of the vehicle speed is not considered. Thus, the longitudinal acceleration becomes significant depending on the increase or decrease of the vehicle speed and the magnitude of the unevenness, and thus the ride comfort may be deteriorated as compared with the case where the vehicle speed control is not performed. In addition, generation of a travel path for avoiding unevenness, and a possibility that a suspension is damaged by vibration generated below the spring of the vehicle when passing by the unevenness, and the like are not taken into consideration, and in some cases, a necessary and sufficient ride comfort and safety cannot be obtained with respect to the road situation on the course of the vehicle and the state of the vehicle.
Therefore, an object of the present invention is to provide a vehicle motion control device and a vehicle motion control method for generating a travel path capable of realizing comfortable ride comfort and high safety with a small physical quantity related to a vehicle behavior such as a longitudinal acceleration, a lateral acceleration, and a vertical acceleration generated when a vehicle passes or avoids with respect to a predetermined region such as unevenness on a course of a vehicle.
In order to solve the above problem, according to the present invention, a vehicle motion control device includes a vehicle behavior prediction portion that predicts a physical quantity related to a vehicle behavior that occurs when a vehicle maintains a reference route toward a predetermined region on a course and a physical quantity related to a vehicle behavior that occurs when the vehicle shifts to an avoidance route for avoiding the predetermined region, and a path generation portion that generates a travel path defined by the reference route or the avoidance route in which the physical quantity is smaller than a defined value.
In addition, according to the present invention, a vehicle motion control method includes a step of predicting a physical quantity related to a vehicle behavior that occurs when a vehicle maintains a reference route toward a predetermined region on a course, a step of predicting a physical quantity related to a vehicle behavior that occurs when the vehicle shifts to an avoidance route for avoiding the predetermined region, and
a step of generating a travel path defined by the reference route or the avoidance route in which the physical quantity is smaller than a defined value.
According to the vehicle motion control device or the vehicle motion control method of the present invention, it is possible to realize comfortable ride comfort and high safety with a small physical quantity related to a vehicle behavior such as a longitudinal acceleration, a lateral acceleration, and a vertical acceleration generated when a vehicle passes or avoids with respect to a predetermined region such as unevenness on a course of a vehicle.
Hereinafter, an in-vehicle system including a vehicle motion control device according to an embodiment of the present invention will be described in detail with reference to
<In-vehicle System 1>
The in-vehicle system 1 is mounted on a vehicle and performs vehicle motion control such as autonomous driving and driving support of the vehicle.
The extra-vehicular communication device 11 performs inter-vehicle communication and road-to-vehicle communication with another vehicle by wireless communication, and transmits and receives information on a vehicle, a surrounding environment, and the like.
The GNSS 12 receives radio waves transmitted from an artificial satellite such as a quasi-zenith satellite or a GPS satellite, and acquires information on the position of the vehicle and the like.
In addition to general road information used in a navigation system or the like, the map information storage unit 13 stores road information such as a width and a curvature of a road, and surrounding environment information such as a traveling state, a road surface condition, and a traffic condition of other vehicles. The surrounding environment information is sequentially updated by information acquired by vehicle-to-vehicle communication or road-to-vehicle communication using the extra-vehicular communication device 11.
The sensor 14 includes a sensor that detects an operation by a driver, a speed, an acceleration, an angular velocity, a steering angle, and the like of the vehicle, in addition to an external recognition sensor that detects information of a surrounding environment, such as an image sensor, a millimeter wave radar, and lidar. The surrounding environment information detected by the external recognition sensor detects various objects such as obstacles, other vehicles, pedestrians, signs, lane lines, and buildings existing around the vehicle. For example, the sensor 14 recognizes a lane boundary line, a lane outside line, and the like based on a difference in luminance between a white line and a road surface of image data captured by the image sensor.
The HMI unit 15 displays information necessary for the user from various types of information obtained by the extra-vehicular communication device 11, the sensor 14, and the like on a display and generates a voice guidance, an alarm, and the like with a speaker, in addition to receiving an input operation of the user such as selection of a travel mode and setting of a destination.
The vehicle motion control device 2 includes an operation management unit 21, a travel path generation unit 22, and a travel control unit 23. The operation management unit 21, the travel path generation unit 22, and the travel control unit 23 are computers that integrally control a vehicle and include hardware such as an arithmetic device such as a CPU, a main storage device such as a semiconductor memory, an auxiliary storage device, and a communication device. The arithmetic device executes a program loaded in the main storage device to implement various functions. Hereinafter, such well-known techniques will be appropriately omitted. In the present embodiment, a configuration in which the operation management unit 21, the travel path generation unit 22, and the travel control unit 23 are separated has been described for easy understanding of the present invention. However, when the present invention is adopted for an actual vehicle, the functions may be realized by a host controller.
The operation management unit 21 generates position information of the vehicle and information on the vehicle behavior and various objects existing around the vehicle based on the information acquired by the extra-vehicular communication device 11, the GNSS 12, the map information storage unit 13, and the sensor 14. In addition, the operation management unit 21 periodically transmits the position information, the surrounding environment information, and the information regarding the vehicle behavior via the extra-vehicular communication device 11, and sequentially updates the map information storage unit 13. Further, the operation management unit 21 sets the route from the current position of the vehicle to the destination based on the information such as the destination acquired by the HMI unit 15 in addition to the position information, the surrounding environment information, and the information related to the vehicle behavior. The information generated or set by the operation management unit 21 is referred to as travel status information below.
The travel control unit 23 sets a target driving force, a target braking force, a target steering angle, and the like so that the vehicle travels to follow the travel path output from the travel path generation unit 22, and controls the power train system 3, the brake system 4, and the steering system 5.
The power train system 3 controls a driving force generated by an internal combustion engine, an electric motor, or the like based on an operation of the driver or a target driving force output from the travel control unit 23.
The brake system 4 controls a braking force generated by a brake caliper or the like based on an operation of the driver or a target braking force output from the travel control unit 23.
The steering system 5 controls the steering angle of the wheel based on the operation of the driver and the target steering angle output from the travel control unit 23.
<Travel Path Generation Unit 22>
Next, an example of functional blocks of the travel path generation unit 22 will be schematically described with reference to
The travel path generation unit 22 generates a travel path defined by information such as a travel route as a target of the vehicle and the speed of the vehicle by using, as an input, the above-described travel status information. The travel path generation unit 22 includes an information acquisition portion 22a, a travel region information calculation portion 22b, a vehicle behavior prediction portion 22c, an action extraction portion 22d, an action determination portion 22e, and a travel path generation portion 22f.
The information acquisition portion 22a acquires the travel status information from the operation management unit 21.
The travel region information calculation portion 22b uses, as an input, the travel status information output from the information acquisition portion 22a to calculate a region in which the vehicle can travel without coming into contact with obstacles such as other vehicles, pedestrians, and buildings on the course, a lateral movement distance, a target speed, a road surface friction coefficient, and the like of the vehicle, which are required to avoid unevenness and the like. An example of travel region information output from the travel region information calculation portion 22b will be schematically described with reference to
In the situation illustrated in
The predetermined region 71 may be an obstacle that cannot pass, such as another vehicle at a lower speed than the vehicle 60, in addition to unevenness, a puddle, or a rough road such as a frozen road that can pass, and the type of the predetermined region 71 is not limited. When the predetermined region 71 is another vehicle at a low speed, the target speed at which the relative speed with respect to the predetermined region 71 becomes 0 is defined such that the vehicle 60 does not come into contact with the predetermined region 71 even though the vehicle maintains reference route 81. In addition, the travel region information calculation portion 22b may output, as the travelable region, a risk potential map calculated in consideration of a movement range of another vehicle and a reach range when a pedestrian runs out. In addition, the avoidance route 82 illustrated in
The vehicle behavior prediction portion 22c uses, as an input, the travel status information output from information acquisition portion 22a and the travel region information output from travel region information calculation portion 22b, to predict a physical quantity related to the vehicle behavior such as an acceleration when the reference route 81 is maintained and when the route is switched to the avoidance route 82. An example of the physical quantity related to the vehicle behavior, which is predicted by the vehicle behavior prediction portion 22c will be schematically described with reference to
In a coordinate system, the front-rear direction of the vehicle is represented by an x-axis, the left-right direction of the vehicle is represented by a y-axis, and the up-down direction of the vehicle is represented by a z-axis. The front-shaft side and the rear-shaft side of the mass below the spring are denoted by m1f and m1r, the mass above the spring is denoted by m2, and the up-down displacement of the center of gravity above the spring 61 is denoted by z2cg. The up-up displacements above the spring of the wheels are denoted by z2f and z2r. The up-down displacements below the spring are denoted by z1f and z1r, the road surface up-down displacement is denoted by z0f and z0r, and the pitch angle of the center of gravity above the spring 61 is denoted by θ. The suspension spring constants are denoted by ksf and ksr, the suspension damping coefficients are denoted by csf and csr, and the wheel base that is a distance between the front and rear wheel axles is denoted by l, the distances in the front-rear direction of the vehicle from the front and rear wheel axles to the center of gravity above the spring are denoted by lf and lr, and the height of the center of gravity above the spring 61 is denoted by h.
In the vehicle behavior prediction portion 22c, information regarding the height of the road surface which is a portion of the travel region information, is input to this model, and the center of gravity above the spring, vertical accelerations above and below the spring on each wheel, and the suspension stroke amount which is the relative displacement in the vertical direction above and below the spring are calculated. In addition, the physical quantity related to the vehicle behavior, which is predicted by the vehicle behavior prediction portion 22c, may be a speed, an acceleration, a jerk, an angle, an angular velocity, and an angular acceleration in each degree of freedom of the vehicle in addition to the longitudinal acceleration, the lateral acceleration, and the vertical acceleration generated at the center of gravity above the spring. The physical quantity related to the vehicle behavior, which is predicted by the vehicle behavior prediction portion 22c, is not limited. In addition, the physical quantity related to the vehicle behavior, which is predicted by the vehicle behavior prediction portion 22c, may be performed not only for each of the passing and avoiding actions but also for a plurality of speed candidates defined between the upper limit speed VU and the lower limit speed VL illustrated in
The action extraction portion 22d uses, as an input, the travel status information output from the information acquisition portion 22a and the physical quantity related to the vehicle behavior such as the acceleration output from the vehicle behavior prediction portion 22c, to extract and output an action in which the physical quantity related to the vehicle behavior is equal to or smaller than a vehicle limit among the candidates output from the vehicle behavior prediction portion 22c. Here, a specific example of the vehicle limit will be described. First, with respect to the planar motion of the vehicle, an acceleration that exceeds vehicle performance and a road surface friction coefficient of an engine, a tire, or the like cannot be generated. Thus, the acceleration based on the vehicle performance and the road surface friction coefficient becomes a vehicle limit. The planar synthetic acceleration, which is the acceleration related to the planar motion of the vehicle, can be calculated by the square root of the sum of squares of the longitudinal acceleration and the lateral acceleration. Next, with respect to the vertical motion of the vehicle, the upper limit values of the vertical accelerations above and below the spring on each wheel where the suspension of the vehicle is not damaged, and the suspension stroke amount are the vehicle limits. The upper limit value is, for example, about 1 G for the vertical acceleration above the spring on each wheel, about 20 G for the vertical acceleration below the spring on each wheel, and about 0.1 m for the suspension stroke amount although the suspension stroke amount varies depending on the shape of the suspension. In this manner, the action extraction portion 22d extracts and outputs only safe and feasible actions. In a case where there is no action in which the physical quantity related to the vehicle behavior is equal to or less than the vehicle limit, the passing action of decelerating at the longitudinal acceleration of the vehicle limit is extracted and output in consideration of safety.
The travel path generation portion 22f uses, as an input, the travel status information output from the information acquisition portion 22a and the information regarding the action output from the action determination portion 22e, to set a travel route and a speed on which the action determined by the action determination portion 22e is performed, and output the travel route and the speed as a travel path to the travel control unit 23.
<Processing of Action Determination Portion 22e>
Next, an outline of processing of the action determination portion 22e will be described with reference to
First, in Step S1, the action determination portion 22e acquires the travel status information output from the information acquisition portion 22a, the action in which the physical quantity related to the vehicle behavior output from the action extraction portion 22d becomes equal to or smaller than the vehicle limit, or the physical quantity related to the vehicle behavior that occurs in the passing action of decelerating at the longitudinal acceleration of the vehicle limit.
Then, in Step S11, the action determination portion 22e determines whether or not the physical quantity related to the vehicle behavior when the vehicle travels on the avoidance route 82 is greater than a defined value based on the information acquired in Step S1. When the physical quantity is greater than the defined value (YES in Step S11), the process proceeds to Step S12. When the physical quantity is equal to or smaller than the defined value (NO in Step S11), the process proceeds to Step S13. Here, the defined value may be a predetermined value determined in advance in consideration of ride comfort or the like, or a value of the vehicle limit based on the road surface friction coefficient acquired by the sensor 14 or the like, and the definition of the defined value is not limited.
In Step S12, the action determination portion 22e selects maintenance of the reference route 81 as the action of the vehicle 60. When there is no avoidance route 82 extracted by the action extraction portion 22d, the process proceeds to Step S12 to select the maintenance of the reference route 81.
On the other hand, in Step S13, the action determination portion 22e determines whether the physical quantity related to the vehicle behavior on the reference route is greater than the defined value based on the information acquired in Step S1 (Step S13). When the physical quantity is greater than the defined value (YES in Step S13), the process proceeds to Step S14. When the physical quantity is equal to or smaller than the defined value (NO in Step S13), the process proceeds to Step S15.
In Step S14, the action determination portion 22e selects the shift to the avoidance route 82 as the action of the vehicle 60. When there is no reference route 81 extracted by the action extraction portion 22d, the process proceeds to Step S14 to select the shift to the avoidance route 82.
On the other hand, in Step S15, the action determination portion 22e determines whether or not the physical quantity related to the vehicle behavior at the time of the reference route is equal to or smaller than the physical quantity related to the vehicle behavior at the time of the avoidance route based on the information acquired in Step S1. When the former is equal to or smaller than the latter (YES in Step S15), the process proceeds to Step S12. When the former is greater than the latter (NO in Step S15), the process proceeds to Step S14.
With the above processing, the action determination portion 22e selects either maintaining of the reference route 81 or shifting to the avoidance route 82 as the action of the vehicle 60.
<Processing Different from
Next, an outline of processing of the action determination portion 22e will be described with reference to
First, in Step S1, the action determination portion 22e acquires the information output from the information acquisition portion 22a and the action extraction portion 22d as in
Then, in Step S22, the action determination portion 22e determines whether or not the sum of physical quantities related to the vehicle behavior at the time of the reference route calculated in Step S21 is equal to or smaller than the sum of physical quantities related to the vehicle behavior at the time of the avoidance route (Step S22). When the former is equal to or smaller than the latter (YES in Step S22), the process proceeds to Step S23 to select the maintenance of the reference route 81. When the former is greater than the latter (NO in Step S22), the process proceeds to Step S24 to select the shift to the avoidance route 82.
<Processing Different from
Next, an outline of processing of the action determination portion 22e will be described with reference to
First, the action determination portion 22e acquires the information output from the information acquisition portion 22a and the action extraction portion 22d in Step S1, similarly to
Here, A, B, C, and D in (Expression 1) and (Expression 2) are weighting factors. Gxm, Gym, and Gzm are maximum accelerations (front and rear, side, up and down), and tm is a movement time caused by an action in which the vehicle 60 passes or avoids the predetermined region 71. Gxs, Gys, and Gzs are acceleration defined values (front and rear, side, up and down), and ts is a movement time caused by an action in which the vehicle 60 passes or avoids the predetermined region 71 at the current speed V0. The numerator of the evaluation function such as Gxm shown in (Expression 1) or (Expression 2) may be not only the acceleration but also the distance, the velocity, the jerk, the angular velocity, and the angular acceleration, or may be not only the maximum value but also the integral value. The physical quantity related to the vehicle behavior defined in the numerator of the evaluation function is not limited. In addition, the denominator of the evaluation function such as Gxs shown in (Expression 1) and (Expression 2) may be not only the acceleration but also the distance, the speed, the jerk, the angular velocity, and the angular acceleration, and may be not only a predetermined defined value but also a value based on the road surface friction coefficient, the ride comfort, the vehicle state, and the like output from the travel region information calculation portion 22b. The coefficient regarding the vehicle behavior defined in the denominator of the evaluation function is not limited.
Then, in Step 32, the action determination portion 22e determines whether or not the evaluation value at the time of the reference route calculated in Step S31 is equal to or smaller than the evaluation value at the time of the avoidance route (Step S32). When the former is equal to or smaller than the latter (YES in Step S32), the process proceeds to Step S33 to select the maintenance of the reference route 81. When the former is greater than the latter (NO in Step S32), the process proceeds to Step S34 to select the shift to the avoidance route 82.
Next, an example of an effect achieved by the vehicle 60 equipped with the in-vehicle system 1 including the vehicle motion control device 2 described above will be described with reference to
In each graph of
First, under the circumstances, there are two vehicle behaviors “black circles” and “black squares” in
Since the sum of the maximum accelerations of the two vehicle behaviors is smaller than the avoidance route in which the reference route of the “black circle” is the “black square” as illustrated in (a) of
<Example of Flowchart Different from
Next, an outline of processing of the action determination portion 22e will be described with reference to
First, in Step S1, the action determination portion 22e acquires information output from the information acquisition portion 22a and the action extraction portion 22d, as in
Next, in Step S41, the action determination portion 22e determines whether or not the travel mode set by the operation management unit 21 is the movement time priority mode. When the travel mode is the movement time priority mode (YES in Step S41), the process proceeds to Step S42 to select an action for the shortest time. When the travel mode is not the movement time priority mode, the process proceeds to Step S43 to perform action selection processing. In Step S43, the action selection processing of any one of the routine R1 illustrated in
The above description is an example of the method of generating the travel path as the target of the vehicle and the method of controlling a motion of the vehicle in the present invention. By using the in-vehicle system 1 including the vehicle motion control device 2 having such a configuration, it is possible to realize comfortable ride comfort and high safety with a small physical quantity related to a vehicle behavior such as the longitudinal acceleration, the lateral acceleration, and the vertical acceleration occurring when passing or avoiding the predetermined region on the course of the vehicle.
Number | Date | Country | Kind |
---|---|---|---|
2020-104290 | Jun 2020 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2021/015482 | 4/14/2021 | WO |