WO2020013050A1 - 車両制御装置、車両制御方法及び車両制御システム - Google Patents
車両制御装置、車両制御方法及び車両制御システム Download PDFInfo
- Publication number
- WO2020013050A1 WO2020013050A1 PCT/JP2019/026464 JP2019026464W WO2020013050A1 WO 2020013050 A1 WO2020013050 A1 WO 2020013050A1 JP 2019026464 W JP2019026464 W JP 2019026464W WO 2020013050 A1 WO2020013050 A1 WO 2020013050A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- vehicle
- control device
- control
- trajectory
- steering
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 180
- 230000001133 acceleration Effects 0.000 claims description 24
- 238000006073 displacement reaction Methods 0.000 claims description 17
- 230000007423 decrease Effects 0.000 claims description 5
- 238000011156 evaluation Methods 0.000 description 65
- 238000012887 quadratic function Methods 0.000 description 15
- 238000004364 calculation method Methods 0.000 description 14
- 230000008859 change Effects 0.000 description 14
- 230000004044 response Effects 0.000 description 13
- 238000012937 correction Methods 0.000 description 12
- 238000001514 detection method Methods 0.000 description 9
- 230000004043 responsiveness Effects 0.000 description 6
- 238000013519 translation Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 5
- 238000012886 linear function Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 230000006399 behavior Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
- B60W30/165—Automatically following the path of a preceding lead vehicle, e.g. "electronic tow-bar"
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/04—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/12—Lateral speed
- B60W2520/125—Lateral acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/30—Road curve radius
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/802—Longitudinal distance
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/805—Azimuth angle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
Definitions
- the present invention relates to a vehicle control device, a vehicle control method, and a vehicle control system.
- Patent Document 1 discloses that a relative position of a follow-up target ahead of a host vehicle with respect to the host vehicle is calculated as a target position, the calculated target position is acquired a plurality of times on a time axis, stored in a buffer memory, and stored in a buffer memory.
- the steering assist control device that calculates a control target value for steering based on the movement trajectory of the tracking target estimated based on the plurality of target positions, the calculation is performed on the tracking target located behind the current vehicle position. It is disclosed that an acquisition period of a target position is adjusted based on a separation distance between the host vehicle and a target to be followed and the host vehicle speed so as to estimate a movement trajectory in a state where the target position is stored in a buffer memory.
- An object of the present invention is to provide a vehicle control device, a vehicle control method, and a vehicle control system that can suppress a change in a command related to steering in follow-up steering control.
- a primary following control that causes the vehicle to follow the preceding vehicle using a primary trajectory
- a secondary following control that causes the vehicle to follow the preceding vehicle using a secondary trajectory.
- a distribution is obtained, and a command relating to the steering of the vehicle for achieving the determined primary following control and the secondary following control is output to a steering actuator unit relating to the steering of the vehicle.
- FIG. 4 is a diagram for explaining a rotational translation change amount of a host vehicle. It is a figure showing an evaluation pattern of a track following system and a yaw angle following system. It is a flowchart which shows the procedure of following steering control.
- FIG. 7 is a diagram illustrating a correlation between a correction value of an evaluation point of a yaw angle tracking method and a centrifugal acceleration.
- FIG. 4 is a diagram illustrating a correlation between a correction value of an evaluation point of a yaw angle tracking method and a vehicle speed.
- FIG. 1 is a configuration block diagram showing one mode of a vehicle control system according to an embodiment of the present invention.
- the vehicle control system 10 of FIG. 1 is a driving support system having a function of following steering control for causing a vehicle (own vehicle) 1 to follow a preceding vehicle ahead.
- the vehicle control system 10 includes a driving support control device 20, a traveling control device 30, a steering control device 40, and an external recognition device 50.
- the driving support control device 20, the traveling control device 30, and the steering control device 40 are electronic control devices including a microcomputer having a MPU (Microprocessor Unit), a ROM (Read Only Memory), a RAM (Random Access Memory), and the like. And a controller of the vehicle control system 10.
- MPU Microprocessor Unit
- ROM Read Only Memory
- RAM Random Access Memory
- the external world recognition device 50 is an external world recognition unit that recognizes the external environment of the vehicle 1 using an external world detection device such as a camera, a millimeter wave radar, and a laser radar.
- the external world recognition device 50 calculates, for example, a pixel shift amount of a corresponding position between a pair of left and right images, that is, a parallax, by performing image matching processing on a pair of left and right images of an object captured by a stereo camera, Each point generates a distance image indicating the distribution of distance information based on luminance or the like according to parallax.
- the external world recognition device 50 then coordinates each point on the distance image in a three-dimensional real space with the vehicle length direction, that is, the distance direction being the X axis, the vehicle width direction, ie, the left and right direction being the Y axis, and the vehicle height direction being the Z axis. Convert to As a result, the outside world recognition device 50 can capture the image of the vehicle 1 such as a lane marking (road center line, road outside line, or the like), an obstacle, or a preceding vehicle traveling in front of the vehicle 1. Recognize the relative positional relationship with.
- a lane marking road center line, road outside line, or the like
- the external world recognition device 50 converts a specific point on the back of the preceding vehicle in the distance image into XY coordinates with the vehicle 1 as the origin.
- the converted XY coordinate values are used as relative position information of the preceding vehicle with respect to the vehicle 1.
- the external world recognition device 50 sets a specific point on the back of the preceding vehicle as, for example, the center position in the vehicle width direction on the back of the preceding vehicle.
- the external world recognition device 50 sets the origin of the XY coordinates to, for example, the center point of the vehicle 1, that is, the point where the center line in the vehicle width direction of the vehicle 1 and the center line in the vehicle length direction of the vehicle 1 overlap. Then, the external world recognition device 50 outputs information on the relative positional relationship between the preceding vehicle and the vehicle 1 to the driving support control device 20.
- the vehicle 1 has a vehicle speed sensor 60 for detecting a vehicle speed (running speed) V (m / s) of the vehicle 1, a yaw rate sensor 70 for detecting a yaw rate ⁇ (rad / s) of the vehicle 1, and an autonomous steering.
- a steering angle sensor 80 that detects a steering angle ⁇ s (deg) of an electric power steering device 90 that is a steering device is provided.
- the driving support control device 20 includes the information on the relative position relationship acquired by the external recognition device 50, the information on the vehicle speed V detected by the vehicle speed sensor 60, the information on the yaw rate ⁇ detected by the yaw rate sensor 70, and the steering angle sensor. 80 inputs information on the detected steering angle ⁇ s.
- the driving support control device 20 includes, as software, functions such as a relative position detection unit 21, a movement trajectory calculation unit 22, a curvature calculation unit 23, a yaw angle calculation unit 24, and a lateral position calculation unit 25. Then, the driving support control device 20 calculates a control parameter related to the setting of the target steering angle, and outputs an instruction signal corresponding to the control parameter, that is, a command regarding steering to the traveling control device 30.
- the driving control device 30 can communicate with the driving support control device 20 and receives an instruction signal corresponding to a control parameter from the driving support control device 20. Then, the travel control device 30 obtains a target steering angle based on an instruction signal corresponding to the control parameter, and outputs a command related to the target steering angle to the steering control device 40 as a command related to steering.
- the steering control device 40 controls the electric power steering device 90, that is, the electric motor as a steering actuator, based on the input command regarding the target steering angle.
- the driving support control device 20 has a function of performing follow-up steering control for causing the vehicle 1 to follow a preceding vehicle in front by two different control methods. Then, the driving support control device 20 switches or distributes the two control methods, obtains control parameters related to the setting of the target steering angle, and outputs information on the obtained control parameters to the travel control device 30.
- One of the two different control methods approximates the trajectory of the preceding vehicle by a quadratic function, and calculates the curvature component, the yaw angle component, and the lateral position, which are coefficients of the approximate expression, as control parameters (first control parameters).
- first control parameters control parameters
- the other of the two different control methods approximates the movement trajectory from the vehicle 1 to the preceding vehicle by a linear function, and uses a yaw angle component, which is a coefficient of the approximate expression, as a control parameter (second control parameter).
- This is a yaw angle follow-up system (shortest follow-up control system) that performs a primary follow-up control for causing the vehicle 1 to follow the preceding vehicle using a primary trajectory.
- the second-order coefficient in the quadratic function is the curvature component of the trajectory
- the first-order coefficient is the yaw angle component of the trajectory (the inclination component of the trajectory with respect to the own vehicle).
- the 0th order coefficient represents the lateral position component of the moving trajectory with respect to the vehicle 1.
- a target steering angle is determined so that the vehicle 1 travels along a target trajectory represented by a linear function having the yaw angle as a primary coefficient. This is a system in which the vehicle 1 is made to follow using a primary trajectory.
- the flowchart in FIG. 2 illustrates one mode of the following steering control (switching control between the trajectory following method and the yaw angle following method) by the driving support control device 20. It should be noted that the routine shown in the flowchart of FIG. 2 is executed in an interrupt process every fixed time (for example, 50 ms).
- step S101 the driving support control device 20 calculates a behavior change of the vehicle 1 per calculation cycle Ts (s). Specifically, the driving support control device 20 reads the vehicle speed V detected by the vehicle speed sensor 60 and the yaw rate ⁇ detected by the yaw rate sensor 70, and calculates the rotational translation change amount of the vehicle 1. Note that the driving support control device 20 uses the detected value of the steering angle ⁇ , the detected value of the vehicle speed V, and the wheel base and the stability factor of the vehicle 1 instead of acquiring the information on the yaw rate ⁇ from the yaw rate sensor 70. Can be calculated.
- FIG. 3 shows the amount of change in rotational translation of the vehicle 1 per calculation cycle Ts (s), that is, from one calculation cycle before to the present.
- the rotation change amount of the vehicle 1 is ⁇ (rad)
- the translation change amount of the vehicle 1 in the vehicle length direction is ⁇ X (m)
- the translation change amount of the vehicle 1 in the vehicle width direction is ⁇ Y (m).
- ⁇ , ⁇ X, and ⁇ Y can be expressed by the following Equation 1.
- step S ⁇ b> 102 the driving support control device 20 detects the current relative position of the preceding vehicle with respect to the vehicle 1 based on the information on the relative positional relationship from the external recognition device 50.
- the relative position of the preceding vehicle with respect to the current vehicle 1 is represented by XY coordinates with the current position of the vehicle 1 as the origin and the current position of the vehicle 1 defined as Xnow and the lateral position as Xnow.
- the driving support control device 20 sequentially stores the relative position of the preceding vehicle with respect to the vehicle 1 detected in step S102 in a built-in memory such as a RAM. Thereby, the detection result of the relative position becomes the registered relative position.
- step S103 the driving support control device 20 calculates in step S101 all the registered relative positions of the relative position history, which is the time-series relative position data stored in the memory, in order to estimate the trajectory of the preceding vehicle. According to the amount of rotation translation change, it is converted and rewritten into XY coordinates with the current position of the vehicle 1 as the origin. Assuming that the front-back position and the lateral position of the registered relative position in the relative position history are X and Y, respectively, the registered relative position X ', Y' after the coordinate conversion is represented by the following equation (2).
- X [n] and Y [n] represent the front-rear position and the left-right position of the preceding vehicle stored n times in the past.
- the newest registered relative positions X [0] and Y [0] in the relative position history are represented by XY coordinates whose origin is the position of the vehicle 1 before the calculation cycle Ts from the present.
- the newest registered relative positions X [0] and Y [0] in the relative position history are converted into the positions on the XY coordinates with the current position of the vehicle 1 as the origin according to Expression 2.
- step S104 the driving support control device 20 compares the relative position (Xnow, Ynow) detected in step S102 with the newest registered relative position (X [X [ 0], Y [0]), it is determined whether or not the distance D (> 0) satisfies the following Expression 3 with respect to the threshold value Dth (> 0).
- the comparison between the distance D and the threshold Dth in step S104 is a process for effectively using the memory capacity. That is, when the relative position of the preceding vehicle with respect to the vehicle 1 has hardly changed, even if the newly detected relative position (Xnow, Ynow) is added to the relative position history, the moving locus of the preceding vehicle is approximated. The following function hardly changes.
- the driving support control device 20 switches between storing the data of the relative position (Xnow, Ynow) newly detected this time in the memory or discarding the data based on the comparison result of the distance D and the threshold value Dth.
- the threshold value Dth corresponding to the interval for storing the position of the preceding vehicle is a value corresponding to the capacity of the memory for storing the registered relative position, the processing capability of the processor, and the like.
- the driving support control device 20 proceeds from step S104 to step S105, and adds the data of the relative position (Xnow, Ynow) newly detected this time to the relative position history. And store the data.
- the driving support control device 20 bypasses step S105 from step S104 and proceeds to step S106, and the relative position (Xnow, Ynow) newly detected this time. Is not added to the relative position history. That is, when the distance D is equal to or less than the threshold value Dth, the driving support control device 20 discards the data of the relative position (Xnow, Ynow) newly detected this time without saving.
- step S105 the driving support control device 20 stores the data of the relative position (Xnow, Ynow) detected in step S102 in a memory such as a RAM, and adds the data to the relative position history as a new registered relative position. Specifically, the driving support control device 20 rewrites the newest registered relative position (X [0], Y [0]) in the relative position history according to the following Expression 4, and newly detects the new registered relative position in step S102 this time. Let the relative position (Xnow, Ynow) be the newest registered relative position (X [0], Y [0]).
- the driving support control device 20 rewrites the remaining registered relative positions (X [I], Y [I]: I> 0) of the relative position history according to the following Expression 5 so that the registered relative position up to that point is obtained. (X [I], Y [I]) are updated and stored only once each as past data. Note that the left side of Equation 5 indicates the registered relative position after rewriting, and the right side of Equation 5 indicates the registered relative position before rewriting.
- the memory of the driving support control device 20 has a capacity for storing a number of registered relative positions until I of the registered relative positions (X [I], Y [I]) reaches a maximum value Imax (a positive integer). You have it. Therefore, when the oldest registered relative position (Xold, Yold) in the relative position history before rewriting is (X [Imax], Y [Imax]), the data of the registered relative position (Xold, Yold) before rewriting is Discarded. Note that the driving support control device 20 may use the registered relative memory stored in the memory when the condition that the following recognition control cannot be performed, such as when the external recognition device 50 cannot recognize the preceding vehicle to be followed in front of the vehicle 1. Erase all data at the location.
- step S106 the driving support control device 20 calculates the trajectory of the preceding vehicle by the least square method using the data of the plurality of registered relative positions (X [I], Y [I]).
- R is calculated as a control parameter (second order coefficient) of the curvature component (curvature calculation unit 23).
- the driving support control device 20 A primary coefficient B is specified as a control parameter of the yaw angle component and stored in the memory.
- the range from the latest value is set to the shortest range.
- the range is set to the longest from the latest value.
- the zero-order coefficient C is obtained, the following range can be set. This makes it easy to reflect the information on the lateral position, the yaw angle, and the curvature in the actual trajectory of the preceding vehicle in the approximate curve of the approximate expression calculated for each range, and to improve the accuracy and responsiveness in estimating the trajectory. Compatibility can be improved.
- step S107 the driving support control device 20 obtains a coefficient (primary coefficient) corresponding to the yaw angle based on the front-rear position Xnow and the lateral position Ynow of the preceding vehicle.
- the first-order coefficient corresponding to the yaw angle obtained in step S107 is a control parameter used in the yaw angle tracking method.
- the curvature component and the lateral position component are not used. Then, the curvature component and the lateral position component are each set to zero.
- the driving assistance control device 20 obtains the curvature component, the yaw angle component, and the lateral position component which are the three control parameters in the trajectory tracking method, and further calculates the yaw angle which is one control parameter in the yaw angle tracking method. Find the corner component. Next, the driving support control device 20 switches between the trajectory tracking method and the yaw angle tracking method.
- step S108 the driving support control device 20 evaluates the appropriateness of each of the trajectory tracking method and the yaw angle tracking method based on conditions such as the traveling road and the state of the preceding vehicle.
- the trajectory tracking method if the distance between the vehicles is long, the error of the yaw rate sensor is accumulated and the command steering angle fluctuates. If the distance between the vehicles is short, the lateral position of the preceding vehicle is erroneously detected and the command steering angle fluctuates.
- the driving support control device 20 selects a control method that is more appropriate under the conditions at that time so as to compensate for the disadvantages of each control method, and sets the steering angle according to the control parameter obtained by the selected control method. Control.
- FIG. 4 shows one aspect of the evaluation pattern of each control method.
- the evaluation conditions the curvature of the road, the distance to the preceding vehicle (inter-vehicle distance), and the amount of lateral displacement of the preceding vehicle with respect to the vehicle 1 are used, and the appropriateness of each control method is set to “high” or “medium” for each evaluation condition. "" And “Low”.
- the control methods are switched by comparing the appropriateness of each control method, and the three-level evaluation of the appropriateness of “high”, “medium”, and “low” corresponds to the weighting of each control method, and The higher the degree, the greater the weight.
- the driving support control device 20 roughly classifies the traveling road into a straight line (small curvature) and a curve (large curvature).
- a straight line small curvature
- a curve large curvature
- the driving support control device 20 evaluates the appropriateness of the yaw angle tracking method as “low” on the curve based on the possibility of the shortcut.
- the control response on a straight road is delayed, so that the appropriateness of the trajectory tracking method on a straight road is evaluated as “medium”.
- the driving support control device 20 evaluates the appropriateness of the trajectory tracking method on a curve as “high” because the shortcut can be suppressed, and determines the appropriateness of the yaw angle tracking method on a straight road based on high responsiveness. Evaluate as “high”.
- the driving support control device 20 roughly classifies the condition of the inter-vehicle distance into near, middle, and distant.
- the trajectory tracking method if the inter-vehicle distance is short, the entire preceding vehicle cannot be photographed by the camera, thereby causing a lateral position detection error of the preceding vehicle. It is easy to occur. Also, in the case of the trajectory tracking method, if the inter-vehicle distance is far, errors in the yaw rate detection value used for calculating the movement trajectory accumulate, which becomes a factor of the command steering angle fluctuation.
- the driving support control device 20 evaluates the appropriateness of the trajectory following method when the inter-vehicle distance is near and far, as “low”, and evaluates the appropriateness of the trajectory following method when the inter-vehicle distance is intermediate. Is evaluated as “high”.
- the driving support control device 20 evaluates the appropriateness of the yaw angle tracking method when the inter-vehicle distance is near and far, as “medium”, and evaluates the yaw angle tracking method when the inter-vehicle distance is intermediate. The appropriate degree is evaluated as “high”.
- the driving support control device 20 roughly divides the conditions of the lateral deviation amount of the preceding vehicle with respect to the vehicle 1 into small lateral deviation amounts and large lateral deviation amounts.
- the yaw angle tracking method has a quick response to a lateral displacement of a preceding vehicle, but if the lateral displacement amount is large, there is a possibility that a short cut in a traveling line may occur.
- the shortcut can be suppressed even when the lateral displacement amount is large, but there is a characteristic that the response to the lateral displacement of the preceding vehicle is slow.
- the driving support control device 20 evaluates the appropriateness of the yaw angle tracking method as “medium” when the amount of lateral displacement is large, and evaluates “high” when the amount of lateral displacement is small. In addition, the driving support control device 20 evaluates the appropriateness of the trajectory following method as “high” when the lateral deviation amount is large, and evaluates “medium” when the lateral deviation amount is small.
- step S109 the driving support control device 20 sets “high” in each of the road curvature, the distance to the preceding vehicle (inter-vehicle distance), and the lateral displacement amount of the preceding vehicle, of the trajectory following method and the yaw angle following method. It is determined which control method has obtained more evaluations. In addition, the driving support control device 20 sets the evaluation score of “high” to 5 points, the evaluation score of “medium” to 3 points, and the evaluation score of “low” to 1 point, for example. The control method with the higher total value can be determined in step S109.
- step S110 the driving support control device 20 selects the trajectory following method as the following steering control method, and calculates a curvature component (second order coefficient), a yaw angle component (first order coefficient), and a lateral component obtained by the trajectory following method.
- the position component (0-order coefficient) is used as a control parameter to be output to the subsequent traveling control device 30.
- step S111 the driving support control device 20 selects the yaw following method as the following steering control method, and outputs the yaw angle component (first order coefficient) obtained by the yaw following method to the subsequent traveling control device 30.
- the curvature component (second order coefficient) and the horizontal position component (zero order coefficient) are set to zero.
- the driving support control device 20 determines in advance as a standard control method of the trajectory tracking method and the yaw angle tracking method. Control method (for example, a trajectory following method) can be selected. The selection of the control method in steps S110 and S111 is a tentative selection, and the driving support control device 20 finally determines the control method based on the conditions of the centrifugal acceleration and the vehicle speed in step S112 and thereafter.
- the driving support control device 20 determines whether or not a predetermined or more following delay occurs when the following steering control is performed by the trajectory following method.
- the driving support control device 20 calculates the centrifugal acceleration when the vehicle follows the preceding vehicle from the curvature radius r and the vehicle speed V, and when the calculated centrifugal acceleration is equal to or greater than the threshold ACth (ACth> 0), the predetermined value is equal to or greater than a predetermined value. Is determined to occur. That is, the driving support control device 20 determines that a response delay equal to or more than a predetermined value occurs in the following steering control in the trajectory following method when the following equation 11 is satisfied.
- abs ( ⁇ ) is a function that returns the absolute value of the variable ⁇
- the threshold ACth is a value of, for example, about 1.5 m / s2.
- the driving support control device 20 proceeds to step S113, and sets the yaw angle component (first order coefficient) obtained by the yaw angle tracking method as a control parameter to be output to the subsequent traveling control device 30. ).
- the driving support control device 20 predicts that a response delay greater than or equal to a predetermined value will occur in the trajectory tracking method, and the yaw angle tracking that has a faster response than the trajectory tracking method. Switch to the method.
- the driving support control device 20 bypasses step S113 and proceeds to step S114. That is, when the centrifugal acceleration is less than the threshold value ACth, it is a condition that the following steering control can be performed with a sufficient response speed even in the case of the trajectory following method. Keep selection.
- step S114 the driving support control device 20 determines whether the vehicle speed V is equal to or higher than the threshold value Vth.
- the state where the vehicle speed V is equal to or higher than the threshold value Vth is a state where high responsiveness is required for the following steering control.
- the driving assistance control device 20 proceeds to step S115, and as a control parameter to be output to the subsequent traveling control device 30, the yaw angle component (primary Coefficient). That is, when the trajectory following method is selected in step S110, the driving support control device 20 suppresses a decrease in the response of the following steering control if the vehicle speed V is equal to or more than the threshold Vth even if the centrifugal acceleration is less than the threshold ACth. To the yaw angle tracking system.
- the following steering control can be performed with sufficient responsiveness even in the case of the trajectory following method, so that the driving support control device 20 bypasses step S115, Holds the control method selection. Therefore, when the trajectory following method is selected in step S110, the driving support control device 20 finally performs the trajectory following method when the centrifugal acceleration is less than the threshold value ACth and the vehicle speed V is less than the threshold value Vth. If the yaw angle tracking method is selected in step S111 and the yaw angle tracking method is selected in step S111, the yaw angle tracking method is finally selected as the control method of the tracking steering control regardless of the conditions of the centrifugal acceleration and the vehicle speed V. become.
- the driving support control device 20 first determines whether or not to select the yaw angle tracking method based on the conditions of the centrifugal acceleration and the vehicle speed V. When both the centrifugal acceleration and the vehicle speed V are smaller than the threshold values, Either of the trajectory tracking method and the yaw angle tracking method can be selected based on the evaluation pattern. In addition, the driving support control device 20 sets the appropriateness (giving the evaluation points) also for the conditions of the centrifugal acceleration and the vehicle speed V, and performs the trajectory following method by comprehensive evaluation with the appropriateness based on the curvature, the inter-vehicle distance, and the lateral displacement. And the yaw angle tracking method.
- the trajectory tracking method when the inter-vehicle distance is short, a lateral position detection error of the preceding vehicle occurs, and the command steering angle fluctuates.
- the yaw rate detection used for calculating the movement trajectory is performed.
- the yaw angle tracking system has a characteristic that the error of the value accumulates and becomes a cause of the fluctuation of the command steering angle, and the yaw angle tracking system has a characteristic that although the responsiveness is higher than the trajectory tracking system, a short-cut of the traveling line occurs.
- the driving support control device 20 determines whether the trajectory tracking method and the yaw angle tracking method are used under the current running conditions based on the conditions of the curvature (straight line / curve), the inter-vehicle distance, the lateral displacement of the preceding vehicle, the centrifugal acceleration, and the vehicle speed. It is determined which suitability is higher, and the control method with the higher suitability is selected and applied to the following steering control. This makes it possible to cause the vehicle 1 (own vehicle) to follow the preceding vehicle with a sufficient response while suppressing the fluctuation of the command steering angle and the shortcut of the traveling line, and to improve the performance of the following steering control.
- the driving support control device 20 performs weighting to change the weight of the trajectory tracking method and the weight of the yaw angle tracking method in accordance with the traveling conditions, and distributes both the trajectory tracking method and the yaw angle tracking method by such weighting. They can be used in combination.
- the flowchart of FIG. 5 shows one mode of tracking steering control using both the trajectory tracking method and the yaw angle tracking method in combination by weighting.
- step S208 the driving support control device 20 performs an appropriate evaluation of each control method with reference to the evaluation pattern of FIG. 4, as in step S108 described above.
- the driving support control device 20 gives an evaluation point for each control method in each evaluation in the three-level evaluation of “high”, “medium”, and “low” of the appropriate degree. For example, the evaluation point when the appropriate degree is “high” is 5 points, the evaluation point when the appropriate degree is “medium” is 3 points, and the evaluation point when the appropriate degree is “low” is 1 point. . Then, the driving support control device 20 totals the evaluation points under the respective conditions of the curvature, the inter-vehicle distance, and the lateral displacement of the preceding vehicle for each control method, substitutes the total result of the trajectory tracking method into C1, and calculates the yaw angle tracking method. Is assigned to C2.
- the total value C1 is obtained by calculating the evaluation points for the trajectory tracking method under the condition of the curvature, the evaluation points for the trajectory tracking method under the inter-vehicle distance condition, and the evaluation points for the trajectory tracking method under the condition of the lateral displacement of the preceding vehicle.
- the total value C2 is calculated for the evaluation point for the yaw angle tracking method under the condition of the curvature, the evaluation point for the yaw angle tracking method under the condition of the following distance, and the evaluation point for the yaw angle tracking method under the condition of the lateral displacement of the preceding vehicle. This is the sum with the evaluation points, and the larger the evaluation point total values C1 and C2, the higher the appropriateness.
- step S209 the driving support control device 20 obtains a correction value ⁇ C2ac ( ⁇ C2ac ⁇ 0) of the evaluation point total value C2 for the yaw angle tracking method according to the centrifugal acceleration, and obtains the evaluation point total value obtained in step S208.
- the evaluation point total value C2 is updated to the result of adding the correction value ⁇ C2ac to C2.
- FIG. 6 shows the correlation between the centrifugal acceleration and the correction value ⁇ C2ac.
- the maximum value of the correction value ⁇ C2ac is the same 5 points as the evaluation point when the appropriate degree in step S208 is “high”, and from the minimum value 0 point to the maximum value 5 points as the centrifugal acceleration increases. (0 ⁇ ⁇ C2ac ⁇ 5). This is because the response of the trajectory tracking method decreases as the centrifugal acceleration increases, and the appropriateness of the yaw angle tracking method relatively increases. Therefore, when the centrifugal acceleration is large, the driving support control device 20 calculates the evaluation point total value C2. By making a larger correction, the weight of the yaw angle tracking method is increased to suppress the occurrence of a response delay.
- step S210 the driving support control device 20 calculates a correction value ⁇ C2vs ( ⁇ C2vs ⁇ 0) of the evaluation point total value C2 for the yaw angle tracking method according to the vehicle speed V, and corrects the correction value ⁇ C2ac in step S209.
- the evaluation point total value C2 is updated to the result of adding the correction value ⁇ C2 vs to the subsequent evaluation point total value C2.
- FIG. 7 shows a correlation between the vehicle speed and the correction value ⁇ C2vs.
- the maximum value of the correction value ⁇ C2vs is the same 5 points as the evaluation point when the appropriate degree in step S208 is “high”, and from the minimum value 0 point to the maximum value 5 points as the vehicle speed V increases. (0 ⁇ ⁇ C2vs ⁇ 5). This is because the response of the trajectory tracking method decreases as the vehicle speed V increases, and the appropriateness of the yaw angle tracking method relatively increases. In addition, when the vehicle speed is high, the evaluation point total value C2 is further corrected to increase the weight of the yaw angle tracking method, thereby suppressing the occurrence of a response delay.
- step S211 the driving support control device 20 determines each coefficient (curvature component, yaw angle component, and lateral position component) obtained by the trajectory tracking method and each coefficient (curvature component, yaw angle component, and lateral position component) obtained by the yaw angle tracking method.
- the position components are weighted by the evaluation point total values C1 and C2, and the respective coefficients to be output to the subsequent traveling control device 30 are determined.
- the curvature component (second order coefficient) and the horizontal position component (zero order coefficient) are zero.
- the driving support control device 20 calculates each coefficient (curvature component, yaw angle component, lateral position component) to be output as a control parameter to the traveling control device 30 according to the following Expression 12.
- the curvature component obtained by the trajectory tracking method is represented by [1 / R] tr
- the yaw angle component is represented by [ ⁇ ] tr
- the curvature component is represented by [1 / R] ya
- the yaw angle component is represented by [ ⁇ ] ya
- the driving support control device 20 calculates each coefficient output as a control parameter to the travel control device 30 as follows. This is calculated according to Expression 13. In other words, each coefficient output as a control parameter to the travel control device 30 becomes closer to the coefficient in the yaw angle tracking method as the evaluation point total value C1 becomes smaller than the evaluation point total value C2, and the evaluation point total value C1 becomes the evaluation point. As the value becomes larger than the total value C2, the coefficient approaches the trajectory tracking method.
- the driving support control device 20 determines the appropriateness of the trajectory following method and the appropriateness of the yaw angle following method under the conditions of the curvature, the inter-vehicle distance, the lateral displacement of the preceding vehicle, the centrifugal acceleration, and the vehicle speed. The degree is obtained, each coefficient obtained by each control method is weighted according to the appropriate degree of each control method, and a coefficient (control parameter) finally output to the travel control device 30 is determined. That is, by using the trajectory tracking method and the yaw angle tracking method in combination, the driving support control device 20 can perform the following steering control while compensating for each other's disadvantages. While taking advantage of the high responsiveness of the angle following method, fluctuations in the command steering angle and shortcuts on the traveling line can be suppressed, and the performance of following steering control can be improved.
- the process of allocating the trajectory tracking method and the yaw angle tracking method includes switching to one of the trajectory tracking method and the yaw angle tracking method and performing the tracking steering control. For example, if the weight of the trajectory tracking method is 100% and the weight of the yaw angle tracking method is 0%, the driving support control device 20 performs the tracking steering control by the trajectory tracking method.
- the driving support control device 20 determines the suitability of the trajectory tracking method and the yaw angle tracking method based on the curvature, the headway, the lateral displacement of the preceding vehicle, the centrifugal acceleration, and the vehicle speed. Appropriate determination can be made based on at least one. Further, the driving support control device 20 can switch from the trajectory tracking method to the yaw tracking method or change the weighting to the yaw angle tracking method more largely based on the increase in the fluctuation of the command steering angle. In addition, the driving support control device 20 can switch between the trajectory tracking method and the yaw tracking method or change the weight of both control methods according to the magnitude of the road surface friction coefficient.
- the evaluation point total value C1 (C1> 0) of the trajectory tracking method and the evaluation point total value C2 (C2> 0) of the yaw tracking method are fixed values, and the weighting of both control methods is fixed, and the control of the following steering control is performed.
- the parameters can be determined.
- the driving support control device 20 can evaluate the appropriateness of the trajectory tracking method and the appropriateness of the yaw angle tracking method for each coefficient, and perform different weighting for each coefficient to obtain a final coefficient.
- the driving support control device 20 can weight each evaluation item such as the curvature and the inter-vehicle distance. Weighting for each evaluation item can be realized, for example, by making the maximum value of the evaluation points different for each evaluation item. Further, when the absolute value ⁇ C of the deviation between the evaluation point total value C1 and the evaluation point total value C2 is equal to or larger than the threshold value ⁇ Cth, the driving support control device 20 selects one of the trajectory following method and the yaw angle following method. When the deviation ⁇ C is smaller than the threshold value ⁇ Cth, the trajectory tracking method and the yaw angle tracking method can be weighted according to the evaluation point total values C1 and C2.
- the steering assist device Information about the external environment of the own vehicle acquired by the external recognition unit, and input information about the behavior of the own vehicle acquired by the sensor device, Based on the information on the external environment and the information on the behavior of the own vehicle, the relative position of the preceding vehicle ahead of the own vehicle with respect to the own vehicle is determined and the time series data of the relative position is updated and stored, A moving path of the preceding vehicle is approximated by a quadratic function based on the time series data of the relative position, and a component of a target path of the own vehicle is obtained as a first control parameter, A movement trajectory from the host vehicle to the preceding vehicle is approximated by a linear function, and a component of a target trajectory of the host vehicle is obtained as a second control parameter, A command related to steering based on a third control parameter to which the first control parameter and the second control parameter are distributed is output to a steering actuator of the host vehicle.
- the third control parameter is obtained by performing weighting to make the first control parameter larger than the second control parameter in accordance with an increase in curvature of a road. I do.
- the inter-vehicle distance between the preceding vehicle and the host vehicle increases the weight of the second control parameter greater than the first control parameter in accordance with an increase from a predetermined intermediate value
- the third control parameter is obtained by performing weighting to make the weight for the second control parameter larger than the first control parameter in accordance with the decrease of the inter-vehicle distance from the predetermined intermediate value.
- the third control parameter is obtained by performing weighting to make the first control parameter larger than the second control parameter in accordance with an increase in the lateral displacement of the preceding vehicle. It is characterized by the following. In a preferred aspect of the steering assist device, the third control parameter is obtained by increasing the weight of the second control parameter as the centrifugal acceleration increases.
- the third control parameter is obtained by increasing the weight of the second control parameter as the vehicle speed increases.
- the first control parameter is a curvature component, a yaw angle component, and a lateral position component
- the second control parameter is a yaw angle component.
- the present invention is not limited to the above-described embodiment, and includes various modifications.
- the above-described embodiments have been described in detail for easy understanding of the present invention, and are not necessarily limited to those having all the configurations described above.
- a part of the configuration of one embodiment can be replaced with the configuration of another embodiment, and the configuration of one embodiment can be added to the configuration of another embodiment.
- SYMBOLS 1 ... Vehicle (own vehicle), 10 ... Vehicle control system, 20 ... Driving support control device (vehicle control device), 30 ... Driving control device, 40 ... Steering control device, 50 ... External recognition device (External recognition unit), 60 ... vehicle speed sensor, 70 ... yaw rate sensor, 80 ... steering angle sensor, 90 ... electric power steering device (steering actuator)
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本発明の車両制御装置は、車両の前方を走行する先行車両が走行した道路曲率に関する情報と、前記車両と前記先行車両との相対位置に関する情報と、に基づいて、前記先行車両に対して前記車両を1次の軌跡を用いて追従させる1次追従制御と、前記先行車両に対して前記車両を2次の軌跡を用いて追従させる2次追従制御と、の配分を求め、求められた前記1次追従制御および前記2次追従制御を達成するための前記車両の操舵に関する指令を、前記車両の操舵に関する操舵アクチュエータ部に出力する。
Description
本発明は、車両制御装置、車両制御方法及び車両制御システムに関する。
特許文献1には、自車両前方の追従対象の自車両に対する相対位置を対象位置として算出し、算出した対象位置を時間軸上で複数回取得してバッファメモリに記憶するとともに、バッファメモリに記憶した複数の対象位置に基づき推定した追従対象の移動軌跡に基づいて操舵についての制御目標値を算出する操舵支援制御装置において、現在の自車両位置よりも後方に位置していた追従対象について算出した対象位置がバッファメモリに記憶されている状態で移動軌跡を推定するように、自車両と追従対象との離間距離と自車速とに基づいて対象位置の取得周期を調整することが開示されている。
ところで、先行車両に自車両を追従させるように操舵に関する目標値を算出する追従操舵制御において、自車両に搭載したカメラで前方の先行車両を撮影する場合、自車両と先行車両との車間距離が短いと、先行車両の全体をカメラで撮影することができなくなることで、先行車両の横位置の検出値に誤差が生じ、係る誤差によって指令舵角の変動が発生し易くなる。
一方、自車両と先行車両との車間距離が長い場合は、移動軌跡の算出に用いるヨーレート検出値の誤差が累積して移動軌跡の算出が不正確になり、指令舵角の変動要因になる場合があった。
一方、自車両と先行車両との車間距離が長い場合は、移動軌跡の算出に用いるヨーレート検出値の誤差が累積して移動軌跡の算出が不正確になり、指令舵角の変動要因になる場合があった。
本発明の目的は、追従操舵制御における操舵に関する指令の変動を抑制できる、車両制御装置、車両制御方法及び車両制御システムを提供することにある。
本発明の一実施形態によれば、その1つの態様において、車両の前方を走行する先行車両が走行した道路曲率に関する情報と、前記車両と前記先行車両との相対位置に関する情報と、に基づいて、前記先行車両に対して前記車両を1次の軌跡を用いて追従させる1次追従制御と、前記先行車両に対して前記車両を2次の軌跡を用いて追従させる2次追従制御と、の配分を求め、求められた前記1次追従制御および前記2次追従制御を達成するための前記車両の操舵に関する指令を、前記車両の操舵に関する操舵アクチュエータ部に出力する。
本発明の一実施形態によれば、追従操舵制御における操舵に関する指令の変動を抑制して、追従操舵制御の性能を向上させることができる。
以下、本発明に係る車両制御装置、車両制御方法及び車両制御システムの実施形態を、図面に基づいて説明する。
図1は、本発明の実施形態に係る車両制御システムの一態様を示す構成ブロック図である。
図1の車両制御システム10は、車両(自車両)1を前方の先行車両に追従させる追従操舵制御の機能を有した運転支援システムである。
図1は、本発明の実施形態に係る車両制御システムの一態様を示す構成ブロック図である。
図1の車両制御システム10は、車両(自車両)1を前方の先行車両に追従させる追従操舵制御の機能を有した運転支援システムである。
車両制御システム10は、運転支援制御装置20、走行制御装置30、操舵制御装置40、外界認識装置50を備える。
運転支援制御装置20、走行制御装置30、及び操舵制御装置40は、MPU(Microprocessor Unit)、ROM(Read Only Memory)、RAM(Random Access Memory)などを有するマイクロコンピュータを備えた電子制御装置であり、車両制御システム10のコントローラを構成する。
運転支援制御装置20、走行制御装置30、及び操舵制御装置40は、MPU(Microprocessor Unit)、ROM(Read Only Memory)、RAM(Random Access Memory)などを有するマイクロコンピュータを備えた電子制御装置であり、車両制御システム10のコントローラを構成する。
外界認識装置50は、カメラ、ミリ波レーダ、レーザレーダなどの外界検出デバイスを用いて車両1の外部環境を認識する外界認識部である。
外界認識装置50は、例えば、ステレオカメラで撮像した対象物の左右一対の画像に対して画像マッチング処理を行うことで、左右一対の画像間における対応位置の画素ずれ量、つまり視差を算出し、各点が視差に応じた輝度等によって距離情報の分布を示す距離画像を生成する。
外界認識装置50は、例えば、ステレオカメラで撮像した対象物の左右一対の画像に対して画像マッチング処理を行うことで、左右一対の画像間における対応位置の画素ずれ量、つまり視差を算出し、各点が視差に応じた輝度等によって距離情報の分布を示す距離画像を生成する。
そして、外界認識装置50は、距離画像上の各点を、車長方向すなわち距離方向をX軸、車幅方向すなわち左右方向をY軸、車高方向をZ軸とする3次元実空間の座標に変換する。
これにより、外界認識装置50は、車両1が走行する道路の区画線(車道中央線や車道外側線等)、障害物、車両1の前方を走行する先行車両などの撮像対象物と、車両1との相対位置関係を認識する。
これにより、外界認識装置50は、車両1が走行する道路の区画線(車道中央線や車道外側線等)、障害物、車両1の前方を走行する先行車両などの撮像対象物と、車両1との相対位置関係を認識する。
ここで、外界認識装置50は、先行車両と車両1との相対位置関係の認識処理において、距離画像のうちの先行車両の背面における特定の点を、車両1を原点としたXY座標に変換し、変換したXY座標値を車両1に対する先行車両の相対位置情報とする。
なお、外界認識装置50は、先行車両の背面における特定の点を、例えば、先行車両の背面における車幅方向の中心位置とする。また、外界認識装置50は、XY座標の原点を、例えば、車両1の中心点、すなわち、車両1の車幅方向における中心線と車両1の車長方向における中心線とが重なる点とする。
そして、外界認識装置50は、先行車両などと車両1との相対位置関係に関する情報を運転支援制御装置20に出力する。
なお、外界認識装置50は、先行車両の背面における特定の点を、例えば、先行車両の背面における車幅方向の中心位置とする。また、外界認識装置50は、XY座標の原点を、例えば、車両1の中心点、すなわち、車両1の車幅方向における中心線と車両1の車長方向における中心線とが重なる点とする。
そして、外界認識装置50は、先行車両などと車両1との相対位置関係に関する情報を運転支援制御装置20に出力する。
また、車両1は、車両1の車速(走行速度)V(m/s)を検出する車速センサ60、車両1のヨーレートγ(rad/s)を検出するヨーレートセンサ70、自律的に操舵可能なステアリング装置である電動パワーステアリング装置90の舵角θs(deg)を検出する舵角センサ80を備える。
そして、運転支援制御装置20は、外界認識装置50が取得した相対位置関係に関する情報とともに、車速センサ60が検出した車速Vに関する情報、ヨーレートセンサ70が検出したヨーレートγに関する情報、更に、舵角センサ80が検出した舵角θsに関する情報を入力する。
そして、運転支援制御装置20は、外界認識装置50が取得した相対位置関係に関する情報とともに、車速センサ60が検出した車速Vに関する情報、ヨーレートセンサ70が検出したヨーレートγに関する情報、更に、舵角センサ80が検出した舵角θsに関する情報を入力する。
運転支援制御装置20は、相対位置検出部21、移動軌跡算出部22、曲率算出部23、ヨー角算出部24、横位置算出部25などの機能をソフトウェアとして備える。そして、運転支援制御装置20は、目標操舵角の設定に関連した制御パラメータを算出し、係る制御パラメータに対応する指示信号、つまり、操舵に関する指令を走行制御装置30に出力する。
走行制御装置30は、運転支援制御装置20と相互通信可能であり、運転支援制御装置20からの制御パラメータに対応する指示信号を受信する。そして、走行制御装置30は、制御パラメータに対応する指示信号に基づき目標操舵角を求め、目標操舵角に関する指令を操舵に関する指令として操舵制御装置40に出力する。
走行制御装置30は、運転支援制御装置20と相互通信可能であり、運転支援制御装置20からの制御パラメータに対応する指示信号を受信する。そして、走行制御装置30は、制御パラメータに対応する指示信号に基づき目標操舵角を求め、目標操舵角に関する指令を操舵に関する指令として操舵制御装置40に出力する。
操舵制御装置40は、入力した目標操舵角に関する指令に基づいて電動パワーステアリング装置90、つまり、操舵アクチュエータとしての電動モータを制御する。
ここで、運転支援制御装置20は、2つの異なる制御方式によって車両1を前方の先行車両に追従させる追従操舵制御を実施する機能を有する。そして、運転支援制御装置20は、2つの制御方式を切り換えるか又は配分して、目標操舵角の設定に関連した制御パラメータを求め、求めた制御パラメータに関する情報を走行制御装置30に出力する。
ここで、運転支援制御装置20は、2つの異なる制御方式によって車両1を前方の先行車両に追従させる追従操舵制御を実施する機能を有する。そして、運転支援制御装置20は、2つの制御方式を切り換えるか又は配分して、目標操舵角の設定に関連した制御パラメータを求め、求めた制御パラメータに関する情報を走行制御装置30に出力する。
上記2つの異なる制御方式のうちの一方は、先行車両の移動軌跡を2次関数で近似し、近似式の係数である曲率成分、ヨー角成分、及び横位置を制御パラメータ(第1制御パラメータ)として求める方式、つまり、先行車両に対して車両1を2次の軌跡を用いて追従させる2次追従制御を行う軌跡追従方式である。
また、上記2つの異なる制御方式のうちの他方は、車両1から先行車両までの移動軌跡を1次関数で近似し、近似式の係数であるヨー角成分を制御パラメータ(第2制御パラメータ)として求める方式、つまり、先行車両に対して車両1を1次の軌跡を用いて追従させる1次追従制御を行うヨー角追従方式(最短追従制御方式)である。
また、上記2つの異なる制御方式のうちの他方は、車両1から先行車両までの移動軌跡を1次関数で近似し、近似式の係数であるヨー角成分を制御パラメータ(第2制御パラメータ)として求める方式、つまり、先行車両に対して車両1を1次の軌跡を用いて追従させる1次追従制御を行うヨー角追従方式(最短追従制御方式)である。
先行車両の移動軌跡を2次関数で近似する場合、2次関数における2次の係数は移動軌跡の曲率成分を、1次の係数は移動軌跡のヨー角成分(自車両に対する移動軌跡の傾き成分)を、0次の係数は車両1に対する移動軌跡の横位置成分を表す。
そして、軌跡追従方式では、これら0次から2次の各係数を走行制御装置30に出力し、走行制御装置30は、2次関数で表される目標軌跡に沿って車両1を走行させるように目標操舵角を求める。つまり、軌跡追従方式は、先行車両に対して車両1を2次の軌跡を用いて追従させる方式である。
一方、ヨー角追従方式では、ヨー角を1次の係数とする1次関数で表される目標軌跡に沿って車両1を走行させるように目標操舵角を求める方式であって、先行車両に対して車両1を1次の軌跡を用いて追従させる方式である。
そして、軌跡追従方式では、これら0次から2次の各係数を走行制御装置30に出力し、走行制御装置30は、2次関数で表される目標軌跡に沿って車両1を走行させるように目標操舵角を求める。つまり、軌跡追従方式は、先行車両に対して車両1を2次の軌跡を用いて追従させる方式である。
一方、ヨー角追従方式では、ヨー角を1次の係数とする1次関数で表される目標軌跡に沿って車両1を走行させるように目標操舵角を求める方式であって、先行車両に対して車両1を1次の軌跡を用いて追従させる方式である。
図2のフローチャートは、運転支援制御装置20による追従操舵制御(軌跡追従方式、ヨー角追従方式の切り換え制御)の一態様を示す。
なお、図2のフローチャートに示すルーチンは、一定時間(例えば50ms)毎の割り込み処理で実行される。
なお、図2のフローチャートに示すルーチンは、一定時間(例えば50ms)毎の割り込み処理で実行される。
運転支援制御装置20は、ステップS101(図中において「S101」と略記する。以下同様である。)で、演算周期Ts(s)当たりの車両1の挙動変化を算出する。
具体的には、運転支援制御装置20は、車速センサ60が検出した車速Vと、ヨーレートセンサ70が検出したヨーレートγと、を読み込んで、車両1の回転並進変化量を算出する。
なお、運転支援制御装置20は、ヨーレートγに関する情報をヨーレートセンサ70から取得する代わりに、舵角θの検出値、車速Vの検出値、更に、車両1のホイールベースやスタビリティファクターを用いて算出することができる。
具体的には、運転支援制御装置20は、車速センサ60が検出した車速Vと、ヨーレートセンサ70が検出したヨーレートγと、を読み込んで、車両1の回転並進変化量を算出する。
なお、運転支援制御装置20は、ヨーレートγに関する情報をヨーレートセンサ70から取得する代わりに、舵角θの検出値、車速Vの検出値、更に、車両1のホイールベースやスタビリティファクターを用いて算出することができる。
図3は、演算周期Ts(s)当たり、つまり、1演算周期前から現在までの車両1の回転並進変化量を示している。
図3に示すように、車両1の回転変化量をΔθ(rad)、車両1の車長方向の並進変化量をΔX(m)、車両1の車幅方向の並進変化量をΔY(m)とすると、Δθ、ΔX及びΔYは、以下の数式1で表すことができる。
図3に示すように、車両1の回転変化量をΔθ(rad)、車両1の車長方向の並進変化量をΔX(m)、車両1の車幅方向の並進変化量をΔY(m)とすると、Δθ、ΔX及びΔYは、以下の数式1で表すことができる。
ステップS102(相対位置検出部21)で、運転支援制御装置20は、外界認識装置50からの相対位置関係の情報に基づいて、現在の車両1に対する先行車両の相対位置を検出する。
なお、現在の車両1に対する先行車両の相対位置は、図3に示すように、前後位置をXnow、横位置をYnowとして、現在の車両1の位置を原点とするXY座標で表すものとする。
運転支援制御装置20は、ステップS102で検出した車両1に対する先行車両の相対位置を、RAM等の内蔵メモリに順次記憶する。これにより、相対位置の検出結果は登録相対位置となる。
なお、現在の車両1に対する先行車両の相対位置は、図3に示すように、前後位置をXnow、横位置をYnowとして、現在の車両1の位置を原点とするXY座標で表すものとする。
運転支援制御装置20は、ステップS102で検出した車両1に対する先行車両の相対位置を、RAM等の内蔵メモリに順次記憶する。これにより、相対位置の検出結果は登録相対位置となる。
ステップS103で、運転支援制御装置20は、先行車両の移動軌跡を推定するために、メモリに記憶した時系列の相対位置データである相対位置履歴の全ての登録相対位置を、ステップS101で算出した回転並進変化量に応じて、現在の車両1の位置を原点とするXY座標に変換して書き換える。
相対位置履歴中の登録相対位置における前後位置及び横位置をそれぞれX,Yとすると、座標変換後の登録相対位置X′,Y′は以下の数式2で示される。
相対位置履歴中の登録相対位置における前後位置及び横位置をそれぞれX,Yとすると、座標変換後の登録相対位置X′,Y′は以下の数式2で示される。
ここで、X[n]及びY[n]は、n回だけ過去に記憶された先行車両の前後位置及び左右位置を表す。
例えば、図3において、相対位置履歴のうち最も新しい登録相対位置X[0],Y[0]は、現在から演算周期Ts前の車両1の位置を原点とするXY座標で表されている。このため、相対位置履歴のうち最も新しい登録相対位置X[0],Y[0]は、数式2にしたがって、現在の車両1の位置を原点とするXY座標上の位置に変換される。
例えば、図3において、相対位置履歴のうち最も新しい登録相対位置X[0],Y[0]は、現在から演算周期Ts前の車両1の位置を原点とするXY座標で表されている。このため、相対位置履歴のうち最も新しい登録相対位置X[0],Y[0]は、数式2にしたがって、現在の車両1の位置を原点とするXY座標上の位置に変換される。
ステップS104で、運転支援制御装置20は、ステップS102で検出した相対位置(Xnow,Ynow)と、ステップS103で登録相対位置を座標変換した後の相対位置履歴中で最も新しい登録相対位置(X[0],Y[0])との距離D(>0)が閾値Dth(>0)に対して以下の数式3を満たしているか否かを判定する。
ステップS104における距離Dと閾値Dthとの比較は、メモリ容量を有効利用するための処理である。
すなわち、車両1に対する先行車両の相対位置が殆ど変化していない場合に、今回新たに検出した相対位置(Xnow,Ynow)を相対位置履歴に追加しても、先行車両の移動軌跡を近似する2次関数は殆ど変化しない。
すなわち、車両1に対する先行車両の相対位置が殆ど変化していない場合に、今回新たに検出した相対位置(Xnow,Ynow)を相対位置履歴に追加しても、先行車両の移動軌跡を近似する2次関数は殆ど変化しない。
このため、距離Dが閾値Dth以下である場合、今回新たに検出した相対位置(Xnow,Ynow)をメモリに記憶させることは、メモリ容量を無駄に消費することになる。
そこで、運転支援制御装置20は、距離Dと閾値Dthとの比較結果に基づいて、今回新たに検出した相対位置(Xnow,Ynow)のデータをメモリに記憶するか破棄するかを切り換える。ここで、先行車両の位置を記憶する間隔に相当する閾値Dthは、登録相対位置を記憶させるメモリの容量やプロセッサの処理能力などに応じた値である。
そこで、運転支援制御装置20は、距離Dと閾値Dthとの比較結果に基づいて、今回新たに検出した相対位置(Xnow,Ynow)のデータをメモリに記憶するか破棄するかを切り換える。ここで、先行車両の位置を記憶する間隔に相当する閾値Dthは、登録相対位置を記憶させるメモリの容量やプロセッサの処理能力などに応じた値である。
距離Dが閾値Dthより大きい場合(D>Dth)、運転支援制御装置20は、ステップS104からステップS105に進んで、今回新たに検出した相対位置(Xnow,Ynow)のデータを相対位置履歴に追加して記憶する処理を実施する。
一方、距離Dが閾値Dth以下である場合(D≦Dth)、運転支援制御装置20は、ステップS104からステップS105を迂回してステップS106に進み、今回新たに検出した相対位置(Xnow,Ynow)のデータを相対位置履歴に追加する処理を実施しない。つまり、距離Dが閾値Dth以下である場合、運転支援制御装置20は、今回新たに検出した相対位置(Xnow,Ynow)のデータを保存せずに破棄する。
一方、距離Dが閾値Dth以下である場合(D≦Dth)、運転支援制御装置20は、ステップS104からステップS105を迂回してステップS106に進み、今回新たに検出した相対位置(Xnow,Ynow)のデータを相対位置履歴に追加する処理を実施しない。つまり、距離Dが閾値Dth以下である場合、運転支援制御装置20は、今回新たに検出した相対位置(Xnow,Ynow)のデータを保存せずに破棄する。
運転支援制御装置20は、ステップS105において、ステップS102で検出した相対位置(Xnow,Ynow)のデータをRAM等のメモリに記憶して、相対位置履歴に新たな登録相対位置として追加する。
具体的には、運転支援制御装置20は、相対位置履歴のうち最も新しい登録相対位置(X[0],Y[0])を以下の数式4にしたがって書き換え、今回ステップS102で新たに検出した相対位置(Xnow,Ynow)を最も新しい登録相対位置(X[0],Y[0])とする。
具体的には、運転支援制御装置20は、相対位置履歴のうち最も新しい登録相対位置(X[0],Y[0])を以下の数式4にしたがって書き換え、今回ステップS102で新たに検出した相対位置(Xnow,Ynow)を最も新しい登録相対位置(X[0],Y[0])とする。
そして、運転支援制御装置20は、相対位置履歴の残りの登録相対位置(X[I],Y[I]:I>0)を以下の数式5にしたがって書き換えることで、それまでの登録相対位置(X[I],Y[I])をそれぞれ1回だけより過去のデータとして更新記憶させる。
なお、数式5の左辺は書き換え後の登録相対位置を示し、数式5の右辺は書き換え前の登録相対位置を示す。
なお、数式5の左辺は書き換え後の登録相対位置を示し、数式5の右辺は書き換え前の登録相対位置を示す。
ここで、運転支援制御装置20のメモリは、登録相対位置(X[I],Y[I])のIが最大値Imax(正の整数)となるまで数の登録相対位置を記憶する容量を有しているものとする。
したがって、書き換え前の相対位置履歴のうち最も古い登録相対位置(Xold,Yold)が(X[Imax],Y[Imax])であるとき、書き換え前の登録相対位置(Xold,Yold)のデータは破棄される。
なお、運転支援制御装置20は、例えば車両1の前方における追従対象となる先行車両を外界認識装置50が認識できない場合など、追従操舵制御を実施できない条件になった場合、メモリに記憶した登録相対位置のデータを全て消去する。
したがって、書き換え前の相対位置履歴のうち最も古い登録相対位置(Xold,Yold)が(X[Imax],Y[Imax])であるとき、書き換え前の登録相対位置(Xold,Yold)のデータは破棄される。
なお、運転支援制御装置20は、例えば車両1の前方における追従対象となる先行車両を外界認識装置50が認識できない場合など、追従操舵制御を実施できない条件になった場合、メモリに記憶した登録相対位置のデータを全て消去する。
運転支援制御装置20は、ステップS106(移動軌跡算出部22)において、複数の登録相対位置(X[I],Y[I])のデータを用いた最小二乗法によって、先行車両の移動軌跡を近似する2次関数Y=f(X)を算出する。
ここで、2次関数Y=f(X)は、2次の係数A、1次の係数B、0次の係数Cによって以下の数式6で表される。
ここで、2次関数Y=f(X)は、2次の係数A、1次の係数B、0次の係数Cによって以下の数式6で表される。
そして、運転支援制御装置20は、先行車両の移動軌跡を近似する2次関数Y=f(X)から、現在の車両1の前後位置すなわちX=0における先行車両の移動軌跡の曲率(1/R)を曲率成分の制御パラメータ(2次の係数)として算出する(曲率算出部23)。
X=0における移動軌跡の曲率(1/R)は、以下の数式7のように、2次関数Y=f(X)をXに関して2階微分及び1階微分した導関数を用いて得られる。
X=0における移動軌跡の曲率(1/R)は、以下の数式7のように、2次関数Y=f(X)をXに関して2階微分及び1階微分した導関数を用いて得られる。
数式7において、1次の係数Bは0に近い値であるため、曲率(1/R)は、1/R=2×Aなる式から算出することができ、運転支援制御装置20は、曲率成分の制御パラメータとして、2次の係数Aを特定してメモリに記憶する。
また、運転支援制御装置20は、先行車両の移動軌跡を近似する2次関数Y=f(X)から、現在の車両1の前後位置すなわちX=0における移動軌跡のヨー角φをヨー角成分の制御パラメータ(1次の係数)として算出する(ヨー角算出部24)。
X=0における移動軌跡のヨー角φは、以下の数式8のように、2次関数Y=f(X)をXに関して1階微分した導関数から得られるので、運転支援制御装置20は、ヨー角成分の制御パラメータとして1次の係数Bを特定してメモリに記憶する。
また、運転支援制御装置20は、先行車両の移動軌跡を近似する2次関数Y=f(X)から、現在の車両1の前後位置すなわちX=0における移動軌跡のヨー角φをヨー角成分の制御パラメータ(1次の係数)として算出する(ヨー角算出部24)。
X=0における移動軌跡のヨー角φは、以下の数式8のように、2次関数Y=f(X)をXに関して1階微分した導関数から得られるので、運転支援制御装置20は、ヨー角成分の制御パラメータとして1次の係数Bを特定してメモリに記憶する。
更に、運転支援制御装置20は、先行車両の移動軌跡を近似する2次関数Y=f(X)から、現在の車両1の前後位置すなわちX=0における移動軌跡の横位置YX=0を横位置成分の制御パラメータ(0次の係数)として算出する(横位置算出部25)。
X=0における移動軌跡の横位置YX=0は、以下の数式9のように、0次の係数Cとなるので、運転支援制御装置20は、横位置成分の制御パラメータとして0次の係数Cを特定してメモリに記憶する。
X=0における移動軌跡の横位置YX=0は、以下の数式9のように、0次の係数Cとなるので、運転支援制御装置20は、横位置成分の制御パラメータとして0次の係数Cを特定してメモリに記憶する。
先行車両の移動軌跡を近似する2次関数Y=f(X)から上記のようにして求めた、曲率成分、ヨー角成分及び横位置成分の3つの制御パラメータに基づいて、電動パワーステアリング装置90の目標操舵角を設定するのが、軌跡追従方式である。
つまり、運転支援制御装置20は、軌跡追従方式で追従操舵制御を行う場合、先行車両の移動軌跡を2次関数Y=f(X)で近似して、これを車両1の目標軌跡とし、この目標軌跡に沿って車両1が移動するように操舵角を制御する。
つまり、運転支援制御装置20は、軌跡追従方式で追従操舵制御を行う場合、先行車両の移動軌跡を2次関数Y=f(X)で近似して、これを車両1の目標軌跡とし、この目標軌跡に沿って車両1が移動するように操舵角を制御する。
なお、運転支援制御装置20は、先行車両の移動軌跡を近似する2次関数Y=f(X)を算出するときに用いる登録相対位置(X[I],Y[I])の範囲を、2次の係数Aを求めるときには最新値から最も短い範囲とし、0次の係数Cを求めるときには最新値から最も長い範囲とし、1次の係数Bを求めるときには2次の係数Aを求めるとき以上でかつ0次の係数Cを求めるとき以下の範囲とすることができる。
これにより、範囲毎に算出した近似式の近似曲線には、先行車両の実際の移動軌跡における、横位置、ヨー角、曲率の情報を反映させやすくなり、移動軌跡の推定における精度及び応答性の両立性を向上させることができる。
これにより、範囲毎に算出した近似式の近似曲線には、先行車両の実際の移動軌跡における、横位置、ヨー角、曲率の情報を反映させやすくなり、移動軌跡の推定における精度及び応答性の両立性を向上させることができる。
運転支援制御装置20は、ステップS107において、先行車両の前後位置Xnow及び横位置Ynowに基づいてヨー角に相当する係数(1次の係数)を求める。
ステップS107で求めるヨー角に相当する1次の係数は、ヨー角追従方式で用いる制御パラメータであり、ヨー角追従方式では、曲率成分及び横位置成分を使用しないので、以下の数式10に示すように、曲率成分及び横位置成分をそれぞれ零とする。
ステップS107で求めるヨー角に相当する1次の係数は、ヨー角追従方式で用いる制御パラメータであり、ヨー角追従方式では、曲率成分及び横位置成分を使用しないので、以下の数式10に示すように、曲率成分及び横位置成分をそれぞれ零とする。
現在の車両1に対する先行車両の相対位置である前後位置Xnow及び横位置Ynowに基づいて求めたヨー角成分のみを制御パラメータとし、電動パワーステアリング装置90の目標操舵角を設定するのが、ヨー角追従方式である。
つまり、ヨー角追従方式では、1次の係数をヨー角φとする1次関数(Y=φX)で目標軌跡を特性し、この目標軌跡に沿って車両1が移動するように操舵角を制御する。
つまり、ヨー角追従方式では、1次の係数をヨー角φとする1次関数(Y=φX)で目標軌跡を特性し、この目標軌跡に沿って車両1が移動するように操舵角を制御する。
上記のようにして、運転支援制御装置20は、軌跡追従方式における3つの制御パラメータである曲率成分、ヨー角成分、横位置成分を求め、更に、ヨー角追従方式における1つの制御パラメータであるヨー角成分を求める。
次いで、運転支援制御装置20は、軌跡追従方式、ヨー角追従方式の切り換えを実施する。
次いで、運転支援制御装置20は、軌跡追従方式、ヨー角追従方式の切り換えを実施する。
運転支援制御装置20は、ステップS108で、走路や先行車両の状況などの条件に基づいて、軌跡追従方式、ヨー角追従方式それぞれについて適正度合を評価する。
軌跡追従方式の場合、車間が遠いとヨーレートセンサの誤差が累積して指令舵角が変動し、車間が短いと先行車両の横位置を誤検出して指令舵角が変動する。一方、ヨー角追従方式の場合、先行車両に最短距離で追従するように制御するため、カーブでは車両1の走行ラインがショートカットする可能性がある。
そこで、運転支援制御装置20は、各制御方式の短所を補うことができるように、そのときの条件でより適正である制御方式を選択し、選択した制御方式で求めた制御パラメータにしたがって舵角を制御する。
軌跡追従方式の場合、車間が遠いとヨーレートセンサの誤差が累積して指令舵角が変動し、車間が短いと先行車両の横位置を誤検出して指令舵角が変動する。一方、ヨー角追従方式の場合、先行車両に最短距離で追従するように制御するため、カーブでは車両1の走行ラインがショートカットする可能性がある。
そこで、運転支援制御装置20は、各制御方式の短所を補うことができるように、そのときの条件でより適正である制御方式を選択し、選択した制御方式で求めた制御パラメータにしたがって舵角を制御する。
図4は、各制御方式の評価パターンの一態様を示す。
図4では、評価条件として、道路曲率、先行車両との距離(車間距離)、及び、車両1に対する先行車両の横ずれ量を用い、評価条件毎に各制御方式の適正度合を「高」「中」「低」の3段階に評価する。
なお、後述するように各制御方式の適正度合を比較して制御方式を切り換えるので、適正度合の「高」「中」「低」の3段階評価は、各制御方式の重み付けに相当し、適正度合が高いほど重み付けを大きくすることになる。
図4では、評価条件として、道路曲率、先行車両との距離(車間距離)、及び、車両1に対する先行車両の横ずれ量を用い、評価条件毎に各制御方式の適正度合を「高」「中」「低」の3段階に評価する。
なお、後述するように各制御方式の適正度合を比較して制御方式を切り換えるので、適正度合の「高」「中」「低」の3段階評価は、各制御方式の重み付けに相当し、適正度合が高いほど重み付けを大きくすることになる。
道路曲率の条件について、運転支援制御装置20は、走行路を直線(曲率小)とカーブ(曲率大)とに大別する。
前述のように、ヨー角追従方式はカーブの曲率が大きいほど(急カーブであるときほど)、走行ラインがショートカット(内回り)する可能性が高くなり、カーブでヨー角追従方式を採用することは好ましくない。
前述のように、ヨー角追従方式はカーブの曲率が大きいほど(急カーブであるときほど)、走行ラインがショートカット(内回り)する可能性が高くなり、カーブでヨー角追従方式を採用することは好ましくない。
そのため、運転支援制御装置20は、カーブではヨー角追従方式の適正度合を、ショートカットの可能性に基づき「低」と評価する。
また、軌跡追従方式は直線路での制御応答が遅れることになるから、直線路では軌跡追従方式の適正度合が「中」と評価する。
更に、運転支援制御装置20は、カーブでの軌跡追従方式の適正度合を、ショートカットを抑止できることから「高」と評価し、直線路でのヨー角追従方式の適正度合を、高い応答性に基づき「高」と評価する。
また、軌跡追従方式は直線路での制御応答が遅れることになるから、直線路では軌跡追従方式の適正度合が「中」と評価する。
更に、運転支援制御装置20は、カーブでの軌跡追従方式の適正度合を、ショートカットを抑止できることから「高」と評価し、直線路でのヨー角追従方式の適正度合を、高い応答性に基づき「高」と評価する。
また、運転支援制御装置20は、車間距離の条件を、近傍、中間、遠方に大別する。
軌跡追従方式の場合、車間距離が近傍であると、先行車両の全体をカメラで撮影することができなくなることで、先行車両の横位置の検出誤差が生じ、係る誤差によって指令舵角の変動が発生し易くなる。また、軌跡追従方式の場合、車間距離が遠方であると、移動軌跡の算出に用いるヨーレート検出値の誤差が累積して、指令舵角の変動要因になる。
そこで、運転支援制御装置20は、車間距離が近傍であるとき及び遠方であるときの軌跡追従方式の適正度合を「低」と評価し、車間距離が中間であるときの軌跡追従方式の適正度合を「高」と評価する。
軌跡追従方式の場合、車間距離が近傍であると、先行車両の全体をカメラで撮影することができなくなることで、先行車両の横位置の検出誤差が生じ、係る誤差によって指令舵角の変動が発生し易くなる。また、軌跡追従方式の場合、車間距離が遠方であると、移動軌跡の算出に用いるヨーレート検出値の誤差が累積して、指令舵角の変動要因になる。
そこで、運転支援制御装置20は、車間距離が近傍であるとき及び遠方であるときの軌跡追従方式の適正度合を「低」と評価し、車間距離が中間であるときの軌跡追従方式の適正度合を「高」と評価する。
一方、ヨー角追従方式については、車間距離が近傍であって先行車両の横位置の検出誤差が生じても影響が比較的小さく、また、車間距離が遠方であるときのセンサ誤差の累積がない。
そこで、運転支援制御装置20は、車間距離が近傍であるとき及び遠方であるときのヨー角追従方式の適正度合が「中」と評価し、車間距離が中間であるときのヨー角追従方式の適正度合を「高」と評価する。
そこで、運転支援制御装置20は、車間距離が近傍であるとき及び遠方であるときのヨー角追従方式の適正度合が「中」と評価し、車間距離が中間であるときのヨー角追従方式の適正度合を「高」と評価する。
更に、運転支援制御装置20は、車両1に対する先行車両の横ずれ量の条件を、横ずれ量小と横ずれ量大とに大別する。
ヨー角追従方式は、先行車両の横ずれに対して応答が速いが、横ずれ量が大きいと走行ラインのショートカットが生じる可能性がある。これに対し、軌跡追従方式では、横ずれ量が大きい場合でもショートカットを抑止できるが、先行車両の横ずれに対して応答が遅いという特性がある。
ヨー角追従方式は、先行車両の横ずれに対して応答が速いが、横ずれ量が大きいと走行ラインのショートカットが生じる可能性がある。これに対し、軌跡追従方式では、横ずれ量が大きい場合でもショートカットを抑止できるが、先行車両の横ずれに対して応答が遅いという特性がある。
そこで、運転支援制御装置20は、ヨー角追従方式の適正度合を、横ずれ量が大きいときは「中」と評価し、横ずれ量が小さいときは「高」と評価する。
また、運転支援制御装置20は、軌跡追従方式の適正度合を、横ずれ量が大きいときは「高」と評価し、横ずれ量が小さいときは「中」と評価する。
また、運転支援制御装置20は、軌跡追従方式の適正度合を、横ずれ量が大きいときは「高」と評価し、横ずれ量が小さいときは「中」と評価する。
運転支援制御装置20は、ステップS109で、軌跡追従方式とヨー角追従方式とのうち、道路曲率、先行車両との距離(車間距離)、及び、先行車両の横ずれ量の各項目で「高」の評価をより多く得た制御方式がどちらであったかを判断する。
なお、運転支援制御装置20は、例えば、「高」の評価点を5点、「中」の評価点を3点、「低」の評価点を1点とし、各項目で得た評価点の合計値が高かった方の制御方式を、ステップS109で判断することができる。
なお、運転支援制御装置20は、例えば、「高」の評価点を5点、「中」の評価点を3点、「低」の評価点を1点とし、各項目で得た評価点の合計値が高かった方の制御方式を、ステップS109で判断することができる。
そして、軌跡追従方式の「高」評価の数がヨー角追従方式の「高」評価の数よりも多かった場合(軌跡追従方式の評価点の合計がヨー角追従方式の評価点の合計よりも大きかった場合)、運転支援制御装置20は、ステップS110に進む。
ステップS110で、運転支援制御装置20は、追従操舵制御の方式として軌跡追従方式を選択し、軌跡追従方式で求めた曲率成分(2次の係数)、ヨー角成分(1次の係数)、横位置成分(0次の係数)を、後段の走行制御装置30に出力する制御パラメータとする。
ステップS110で、運転支援制御装置20は、追従操舵制御の方式として軌跡追従方式を選択し、軌跡追従方式で求めた曲率成分(2次の係数)、ヨー角成分(1次の係数)、横位置成分(0次の係数)を、後段の走行制御装置30に出力する制御パラメータとする。
一方、ヨー角追従方式の「高」評価の数が軌跡追従方式の「高」評価の数よりも多かった場合(ヨー角追従方式の評価点の合計が軌跡追従方式の評価点の合計よりも大きかった場合)、運転支援制御装置20は、ステップS111に進む。
ステップS111で、運転支援制御装置20は、追従操舵制御の方式としてヨー追従方式を選択し、ヨー追従方式で求めたヨー角成分(1次の係数)を後段の走行制御装置30に出力する制御パラメータとし、曲率成分(2次の係数)及び横位置成分(0次の係数)については零とする。
ステップS111で、運転支援制御装置20は、追従操舵制御の方式としてヨー追従方式を選択し、ヨー追従方式で求めたヨー角成分(1次の係数)を後段の走行制御装置30に出力する制御パラメータとし、曲率成分(2次の係数)及び横位置成分(0次の係数)については零とする。
なお、「高」評価の数が同数である場合(或いは評価点の合計が同点である場合)、運転支援制御装置20は、軌跡追従方式とヨー角追従方式とのうち標準制御方式として予め定めた制御方式(例えば軌跡追従方式)を選択することができる。
上記ステップS110、ステップS111での制御方式の選択は仮の選択であり、運転支援制御装置20は、ステップS112以降で、遠心加速度及び車速の条件に基づき制御方式を最終的に決定する。
上記ステップS110、ステップS111での制御方式の選択は仮の選択であり、運転支援制御装置20は、ステップS112以降で、遠心加速度及び車速の条件に基づき制御方式を最終的に決定する。
運転支援制御装置20は、ステップS112で、軌跡追従方式によって追従操舵制御を行った場合に、所定以上の追従遅れが発生するか否かを判断する。
ここで、運転支援制御装置20は、曲率半径r及び車速Vから先行車両に追従させるときの遠心加速度を演算し、演算した遠心加速度が閾値ACth(ACth>0)以上であるときに、所定以上の追従遅れが発生すると判断する。
つまり、運転支援制御装置20は、以下の数式11の条件を満たすときに、軌跡追従方式での追従操舵制御において所定以上の応答遅れが発生すると判断する。
なお、数式11において、abs(α)は変数αの絶対値を返す関数であり、閾値ACthは例えば1.5m/s2程度の値である。
ここで、運転支援制御装置20は、曲率半径r及び車速Vから先行車両に追従させるときの遠心加速度を演算し、演算した遠心加速度が閾値ACth(ACth>0)以上であるときに、所定以上の追従遅れが発生すると判断する。
つまり、運転支援制御装置20は、以下の数式11の条件を満たすときに、軌跡追従方式での追従操舵制御において所定以上の応答遅れが発生すると判断する。
なお、数式11において、abs(α)は変数αの絶対値を返す関数であり、閾値ACthは例えば1.5m/s2程度の値である。
遠心加速度が閾値ACth以上であるとき、運転支援制御装置20は、ステップS113に進み、後段の走行制御装置30に出力する制御パラメータとして、ヨー角追従方式で得たヨー角成分(1次の係数)を選択する。
つまり、運転支援制御装置20は、ステップS110において軌跡追従方式を選択した場合であっても、軌跡追従方式で所定以上の応答遅れが発生すると予測すると、軌跡追従方式よりも応答が速いヨー角追従方式に切り替える。
つまり、運転支援制御装置20は、ステップS110において軌跡追従方式を選択した場合であっても、軌跡追従方式で所定以上の応答遅れが発生すると予測すると、軌跡追従方式よりも応答が速いヨー角追従方式に切り替える。
一方、遠心加速度が閾値ACth未満であるとき、運転支援制御装置20は、ステップS113を迂回してステップS114に進む。
つまり、遠心加速度が閾値ACth未満である場合、軌跡追従方式であっても十分な応答速度で追従操舵制御を行える条件であるので、運転支援制御装置20は、ステップS110又はステップS111における制御方式の選択を保持する。
つまり、遠心加速度が閾値ACth未満である場合、軌跡追従方式であっても十分な応答速度で追従操舵制御を行える条件であるので、運転支援制御装置20は、ステップS110又はステップS111における制御方式の選択を保持する。
運転支援制御装置20は、ステップS114で、車速Vが閾値Vth以上であるか否かを判断する。
ここで、車速Vが閾値Vth以上である状態とは、追従操舵制御に高い応答性が要求される状態である。
ここで、車速Vが閾値Vth以上である状態とは、追従操舵制御に高い応答性が要求される状態である。
そのため、運転支援制御装置20は、車速Vが閾値Vth以上である場合、ステップS115に進み、後段の走行制御装置30に出力する制御パラメータとして、ヨー角追従方式で得たヨー角成分(1次の係数)を選択する。
つまり、運転支援制御装置20は、ステップS110において軌跡追従方式を選択した場合、遠心加速度が閾値ACth未満であっても車速Vが閾値Vth以上であれば、追従操舵制御の応答性の低下を抑止するためにヨー角追従方式に切り換える。
つまり、運転支援制御装置20は、ステップS110において軌跡追従方式を選択した場合、遠心加速度が閾値ACth未満であっても車速Vが閾値Vth以上であれば、追従操舵制御の応答性の低下を抑止するためにヨー角追従方式に切り換える。
一方、車速Vが閾値Vth未満であるときは、軌跡追従方式であっても十分な応答性で追従操舵制御を行えるので、運転支援制御装置20は、ステップS115を迂回することで、それまでの制御方式の選択を保持する。
したがって、運転支援制御装置20は、ステップS110で軌跡追従方式を選択した場合は、遠心加速度が閾値ACth未満でかつ車速Vが閾値Vth未満であるときに、軌跡追従方式を最終的に追従操舵制御の制御方式として選択し、ステップS111でヨー角追従方式を選択した場合は、遠心加速度及び車速Vの条件に関わらずに、ヨー角追従方式を最終的に追従操舵制御の制御方式として選択することになる。
したがって、運転支援制御装置20は、ステップS110で軌跡追従方式を選択した場合は、遠心加速度が閾値ACth未満でかつ車速Vが閾値Vth未満であるときに、軌跡追従方式を最終的に追従操舵制御の制御方式として選択し、ステップS111でヨー角追従方式を選択した場合は、遠心加速度及び車速Vの条件に関わらずに、ヨー角追従方式を最終的に追従操舵制御の制御方式として選択することになる。
なお、運転支援制御装置20は、まず、遠心加速度、車速Vの条件に基づきヨー角追従方式を選択すべきか否かを判断し、遠心加速度及び車速Vがともに閾値よりも小さいときに、図4の評価パターンに基づいて軌跡追従方式とヨー角追従方式とのいずれか一方を選択することができる。
また、運転支援制御装置20は、遠心加速度及び車速Vの条件についても適正度合の設定(評価点の付与)を行い、曲率、車間距離、横ずれに基づく適正度合との総合評価で、軌跡追従方式とヨー角追従方式とのいずれか一方を選択することができる。
また、運転支援制御装置20は、遠心加速度及び車速Vの条件についても適正度合の設定(評価点の付与)を行い、曲率、車間距離、横ずれに基づく適正度合との総合評価で、軌跡追従方式とヨー角追従方式とのいずれか一方を選択することができる。
前述したように、軌跡追従方式は、車間距離が短いと先行車両の横位置の検出誤差が生じて指令舵角の変動が発生し、また、車間距離が長いと移動軌跡の算出に用いるヨーレート検出値の誤差が累積して指令舵角の変動要因になるという特性を有する、また、ヨー角追従方式は、応答性は軌跡追従方式より高いものの、走行ラインのショートカットが発生するという特性を有する。
そこで、運転支援制御装置20は、曲率(直線/カーブ)、車間距離、先行車両の横ずれ、遠心加速度、車速の各条件に基づき、現状での走行条件において軌跡追従方式とヨー角追従方式とのいずれの適正がより高いかを判断し、より適正が高い方の制御方式を選択して追従操舵制御に適用する。
これにより、指令舵角の変動や走行ラインのショートカットを抑制しつつ、車両1(自車両)を先行車両に十分な応答で追従させることができ、追従操舵制御の性能を向上させることができる。
そこで、運転支援制御装置20は、曲率(直線/カーブ)、車間距離、先行車両の横ずれ、遠心加速度、車速の各条件に基づき、現状での走行条件において軌跡追従方式とヨー角追従方式とのいずれの適正がより高いかを判断し、より適正が高い方の制御方式を選択して追従操舵制御に適用する。
これにより、指令舵角の変動や走行ラインのショートカットを抑制しつつ、車両1(自車両)を先行車両に十分な応答で追従させることができ、追従操舵制御の性能を向上させることができる。
ところで、運転支援制御装置20は、走行条件に応じて軌跡追従方式の重み及びヨー角追従方式の重みを変更する重み付けを行い、係る重み付けによる配分で軌跡追従方式とヨー角追従方式との双方を組み合わせて用いることができる。
図5のフローチャートは、重み付けによる配分で軌跡追従方式とヨー角追従方式との双方を組み合わせて用いる追従操舵制御の一態様を示す。
図5のフローチャートは、重み付けによる配分で軌跡追従方式とヨー角追従方式との双方を組み合わせて用いる追従操舵制御の一態様を示す。
なお、図5のフローチャートにおけるステップS201-ステップS207での処理内容は、図2のフローチャートのステップS101-ステップS107と同様であるので、ステップS201-ステップS207についての詳細な説明は省略する。
運転支援制御装置20は、ステップS208で、前述のステップS108と同様に、図4の評価パターンを参照して各制御方式の適正評価を行う。
運転支援制御装置20は、ステップS208で、前述のステップS108と同様に、図4の評価パターンを参照して各制御方式の適正評価を行う。
ここで、運転支援制御装置20は、適正度合の「高」「中」「低」の3段階評価において、各評価で制御方式毎に評価点を与える。
例えば、適正度合が「高」のときの評価点を5点とし、適正度合が「中」のときの評価点を3点とし、適正度合が「低」のときの評価点を1点とする。
そして、運転支援制御装置20は、曲率、車間距離、先行車両の横ずれの各条件での評価点を制御方式別に集計し、軌跡追従方式についての集計結果をC1に代入し、ヨー角追従方式についての集計結果をC2に代入する。
例えば、適正度合が「高」のときの評価点を5点とし、適正度合が「中」のときの評価点を3点とし、適正度合が「低」のときの評価点を1点とする。
そして、運転支援制御装置20は、曲率、車間距離、先行車両の横ずれの各条件での評価点を制御方式別に集計し、軌跡追従方式についての集計結果をC1に代入し、ヨー角追従方式についての集計結果をC2に代入する。
つまり、集計値C1は、曲率の条件での軌跡追従方式に対する評価点と、車間距離の条件での軌跡追従方式に対する評価点と、先行車両の横ずれの条件での軌跡追従方式に対する評価点との合計で、集計値C2は、曲率の条件でのヨー角追従方式に対する評価点と、車間距離の条件でのヨー角追従方式に対する評価点と、先行車両の横ずれの条件でのヨー角追従方式に対する評価点との合計であり、評価点集計値C1、C2は、大きいほど適正度合がより高いことを示す。
次いで、運転支援制御装置20は、ステップS209で、遠心加速度に応じてヨー角追従方式についての評価点集計値C2の補正値ΔC2ac(ΔC2ac≧0)を求め、ステップS208で求めた評価点集計値C2に補正値ΔC2acを加算した結果に、評価点集計値C2を更新する。
次いで、運転支援制御装置20は、ステップS209で、遠心加速度に応じてヨー角追従方式についての評価点集計値C2の補正値ΔC2ac(ΔC2ac≧0)を求め、ステップS208で求めた評価点集計値C2に補正値ΔC2acを加算した結果に、評価点集計値C2を更新する。
図6は、遠心加速度と補正値ΔC2acとの相関を示す。
補正値ΔC2acの最大値は、ステップS208での適正度合が「高」のときの評価点と同じ5点であり、遠心加速度が高くなるにしたがって最小値である0点から最大値である5点にまで徐々に増加する(0≦ΔC2ac≦5)。
これは、遠心加速度が大きくなるほど軌跡追従方式の応答が低下し、ヨー角追従方式の適正が相対的に増すためで、運転支援制御装置20は、遠心加速度が大きいときに評価点集計値C2をより大きく補正することで、ヨー角追従方式の重みを大きくして応答遅れの発生を抑制する。
補正値ΔC2acの最大値は、ステップS208での適正度合が「高」のときの評価点と同じ5点であり、遠心加速度が高くなるにしたがって最小値である0点から最大値である5点にまで徐々に増加する(0≦ΔC2ac≦5)。
これは、遠心加速度が大きくなるほど軌跡追従方式の応答が低下し、ヨー角追従方式の適正が相対的に増すためで、運転支援制御装置20は、遠心加速度が大きいときに評価点集計値C2をより大きく補正することで、ヨー角追従方式の重みを大きくして応答遅れの発生を抑制する。
次いで、運転支援制御装置20は、ステップS210で、車速Vに応じてヨー角追従方式についての評価点集計値C2の補正値ΔC2vs(ΔC2vs≧0)を求め、ステップS209での補正値ΔC2acによる補正後の評価点集計値C2に補正値ΔC2vsを加算した結果に、評価点集計値C2を更新する。
図7は、車速と補正値ΔC2vsとの相関を示す。
図7は、車速と補正値ΔC2vsとの相関を示す。
補正値ΔC2vsの最大値は、ステップS208での適正度合が「高」のときの評価点と同じ5点であり、車速Vが高くなるにしたがって最小値である0点から最大値である5点にまで徐々に増加する(0≦ΔC2vs≦5) これは、車速Vが高くなるほど軌跡追従方式の応答が低下し、ヨー角追従方式の適正が相対的に増すためで、運転支援制御装置20は、車速が高いときに評価点集計値C2をより大きく補正することで、ヨー角追従方式の重みを大きくして応答遅れの発生を抑制する。
運転支援制御装置20は、ステップS211で、軌跡追従方式で求めた各係数(曲率成分、ヨー角成分、横位置成分)及びヨー角追従方式で求めた各係数(曲率成分、ヨー角成分、横位置成分)に対し、評価点集計値C1,C2による重み付けを行って、後段の走行制御装置30に出力する各係数を決定する。
なお、ヨー角追従方式の場合、曲率成分(2次の係数)及び横位置成分(0次の係数)は零である。
なお、ヨー角追従方式の場合、曲率成分(2次の係数)及び横位置成分(0次の係数)は零である。
運転支援制御装置20は、以下の数式12にしたがって、走行制御装置30に制御パラメータとして出力する各係数(曲率成分、ヨー角成分、横位置成分)を算出する。
なお、数式12では、軌跡追従方式で求めた曲率成分を[1/R]tr、ヨー角成分を[φ]tr、横位置成分を[Yx=0]trと表し、ヨー角追従方式で求めた曲率成分を[1/R]ya、ヨー角成分を[φ]ya、横位置成分を[Yx=0]yaと表す。
なお、数式12では、軌跡追従方式で求めた曲率成分を[1/R]tr、ヨー角成分を[φ]tr、横位置成分を[Yx=0]trと表し、ヨー角追従方式で求めた曲率成分を[1/R]ya、ヨー角成分を[φ]ya、横位置成分を[Yx=0]yaと表す。
ここで、ヨー角追従方式での[1/R]ya及び[Yx=0]yaは零であるから、運転支援制御装置20は、走行制御装置30に制御パラメータとして出力する各係数を、以下の数13にしたがって算出することになる。
つまり、走行制御装置30に制御パラメータとして出力される各係数は、評価点集計値C1が評価点集計値C2よりも小さくなるほどヨー角追従方式での係数に近づき、評価点集計値C1が評価点集計値C2よりも大きくなるほど軌跡追従方式での係数に近づくことになる。
図5のフローチャートに示す追従操舵制御によると、運転支援制御装置20は、曲率、車間距離、先行車両の横ずれ、遠心加速度、車速の各条件における軌跡追従方式の適正度合及びヨー角追従方式の適正度合を求め、各制御方式で求めた各係数に対して各制御方式の適正度合に応じた重み付けを行って最終的に走行制御装置30に出力する係数(制御パラメータ)を決定する。
つまり、運転支援制御装置20は、軌跡追従方式とヨー角追従方式とを組み合わせて用いることで、相互に短所を補って追従操舵制御が行えるようになり、軌跡追従方式における滑らかな応答性やヨー角追従方式の高い応答性を活かしつつ、指令舵角の変動や走行ラインのショートカットを抑制でき、追従操舵制御の性能を向上させることができる。
つまり、運転支援制御装置20は、軌跡追従方式とヨー角追従方式とを組み合わせて用いることで、相互に短所を補って追従操舵制御が行えるようになり、軌跡追従方式における滑らかな応答性やヨー角追従方式の高い応答性を活かしつつ、指令舵角の変動や走行ラインのショートカットを抑制でき、追従操舵制御の性能を向上させることができる。
なお、軌跡追従方式とヨー角追従方式とを配分する処理には、軌跡追従方式とヨー角追従方式とのいずれか一方に切り換えて追従操舵制御を行うことが含まれる。例えば、軌跡追従方式の重みが100%で、ヨー角追従方式の重みが0%であれば、運転支援制御装置20は、軌跡追従方式で追従操舵制御を実施することになる。
上記実施形態で説明した各技術的思想は、矛盾が生じない限りにおいて、適宜組み合わせて使用することができる。
また、好ましい実施形態を参照して本発明の内容を具体的に説明したが、本発明の基本的技術思想及び教示に基づいて、当業者であれば、種々の変形態様を採り得ることは自明である。
また、好ましい実施形態を参照して本発明の内容を具体的に説明したが、本発明の基本的技術思想及び教示に基づいて、当業者であれば、種々の変形態様を採り得ることは自明である。
上記の実施形態では、運転支援制御装置20は、曲率、車間、先行車両の横ずれ、遠心加速度、車速に基づき、軌跡追従方式及びヨー角追従方式の適正を判断するが、これら走行条件のうちの少なくとも1つに基づき適正判断することができる。
また、運転支援制御装置20は、指令舵角の変動の増大に基づき、軌跡追従方式からヨー追従方式に切り換えたり、ヨー角追従方式への重み付けをより大きく変化させたりすることができる。
また、運転支援制御装置20は、路面の摩擦係数の大きさに応じて軌跡追従方式とヨー追従方式とを切り換えたり、両制御方式の重みを変更したりすることができる。
また、運転支援制御装置20は、指令舵角の変動の増大に基づき、軌跡追従方式からヨー追従方式に切り換えたり、ヨー角追従方式への重み付けをより大きく変化させたりすることができる。
また、運転支援制御装置20は、路面の摩擦係数の大きさに応じて軌跡追従方式とヨー追従方式とを切り換えたり、両制御方式の重みを変更したりすることができる。
また、軌跡追従方式の評価点集計値C1(C1>0)及びヨー追従方式の評価点集計値C2(C2>0)をそれぞれ固定値とし、両制御方式の重み付けを固定として追従操舵制御の制御パラメータを決定することができる。
また、運転支援制御装置20は、係数毎に軌跡追従方式の適正度合及びヨー角追従方式の適正度合を評価し、係数毎に異なる重み付けを行って最終的な係数を求めることができる。
また、運転支援制御装置20は、係数毎に軌跡追従方式の適正度合及びヨー角追従方式の適正度合を評価し、係数毎に異なる重み付けを行って最終的な係数を求めることができる。
また、運転支援制御装置20は、曲率や車間距離などの評価項目毎に重み付けすることができる。評価項目毎の重み付けは、例えば、評価点の最大値を評価項目毎に異ならせることで実現できる。
また、運転支援制御装置20は、評価点集計値C1と評価点集計値C2との偏差の絶対値ΔCが閾値ΔCth以上であるときに、軌跡追従方式とヨー角追従方式のいずれか一方を選択し、前記偏差ΔCが閾値ΔCth未満であるときに軌跡追従方式とヨー角追従方式とに評価点集計値C1,C2に応じた重み付けを行うことができる。
また、運転支援制御装置20は、評価点集計値C1と評価点集計値C2との偏差の絶対値ΔCが閾値ΔCth以上であるときに、軌跡追従方式とヨー角追従方式のいずれか一方を選択し、前記偏差ΔCが閾値ΔCth未満であるときに軌跡追従方式とヨー角追従方式とに評価点集計値C1,C2に応じた重み付けを行うことができる。
ここで、上述した実施形態から把握し得る技術的思想について、以下に記載する。
操舵支援装置は、その一態様として、
外部認識部が取得した自車両の外部環境に関する情報、及び、センサ装置が取得した前記自車両の挙動に関する情報を入力し、
前記外部環境に関する情報及び前記自車両の挙動に関する情報に基づいて、前記自車両の前方の先行車両の前記自車両に対する相対位置を求めるとともに前記相対位置の時系列データを更新記憶し、
前記相対位置の時系列データに基づき前記先行車両の移動軌跡を2次関数で近似して、前記自車両の目標軌跡の成分を第1制御パラメータとして求め、
前記自車両から前記先行車両までの移動軌跡を1次関数で近似して、前記自車両の目標軌跡の成分を第2制御パラメータとして求め、
前記第1制御パラメータ及び前記第2制御パラメータを配分した第3制御パラメータに基づく操舵に関する指令を、前記自車両の操舵アクチュエータ部に出力することを特徴とする。
操舵支援装置は、その一態様として、
外部認識部が取得した自車両の外部環境に関する情報、及び、センサ装置が取得した前記自車両の挙動に関する情報を入力し、
前記外部環境に関する情報及び前記自車両の挙動に関する情報に基づいて、前記自車両の前方の先行車両の前記自車両に対する相対位置を求めるとともに前記相対位置の時系列データを更新記憶し、
前記相対位置の時系列データに基づき前記先行車両の移動軌跡を2次関数で近似して、前記自車両の目標軌跡の成分を第1制御パラメータとして求め、
前記自車両から前記先行車両までの移動軌跡を1次関数で近似して、前記自車両の目標軌跡の成分を第2制御パラメータとして求め、
前記第1制御パラメータ及び前記第2制御パラメータを配分した第3制御パラメータに基づく操舵に関する指令を、前記自車両の操舵アクチュエータ部に出力することを特徴とする。
上記操舵支援装置の好ましい態様では、道路の曲率の増大に応じて前記第1制御パラメータに対する重みを前記第2制御パラメータよりも大きくする重み付けを実施して前記第3制御パラメータを求めることを特徴とする。
また、上記操舵支援装置の好ましい態様では、前記先行車両と前記自車両との車間距離が所定中間値からの増大に応じて前記第2制御パラメータの重みを前記第1制御パラメータよりも大きくし、前記車間距離の前記所定中間値からの減少に応じて前記第2制御パラメータに対する重みを前記第1制御パラメータよりも大きくする重み付けを実施して前記第3制御パラメータを求めることを特徴とする。
また、上記操舵支援装置の好ましい態様では、前記先行車両と前記自車両との車間距離が所定中間値からの増大に応じて前記第2制御パラメータの重みを前記第1制御パラメータよりも大きくし、前記車間距離の前記所定中間値からの減少に応じて前記第2制御パラメータに対する重みを前記第1制御パラメータよりも大きくする重み付けを実施して前記第3制御パラメータを求めることを特徴とする。
また、上記操舵支援装置の好ましい態様では、前記先行車両の横ずれの増大に応じて前記第1制御パラメータに対する重みを前記第2制御パラメータよりも大きくする重み付けを実施して前記第3制御パラメータを求めることを特徴とする。
また、上記操舵支援装置の好ましい態様では、遠心加速度が大きくなるほど前記第2制御パラメータに対する重みを大きくして前記第3制御パラメータを求めることを特徴とする。
また、上記操舵支援装置の好ましい態様では、遠心加速度が大きくなるほど前記第2制御パラメータに対する重みを大きくして前記第3制御パラメータを求めることを特徴とする。
また、上記操舵支援装置の好ましい態様では、車速が高くなるほど前記第2制御パラメータに対する重みを大きくして前記第3制御パラメータを求めることを特徴とする。
更に、上記操舵支援装置の好ましい態様では、前記第1制御パラメータは曲率成分、ヨー角成分、及び横位置成分、前記第2制御パラメータはヨー角成分であることを特徴とする。
更に、上記操舵支援装置の好ましい態様では、前記第1制御パラメータは曲率成分、ヨー角成分、及び横位置成分、前記第2制御パラメータはヨー角成分であることを特徴とする。
なお、本発明は上記した実施形態に限定されるものではなく、様々な変形例が含まれる。例えば、上記した実施形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。また、各実施形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。
本願は、2018年7月10日付出願の日本国特許出願第2018-131045号に基づく優先権を主張する。2018年7月10日付出願の日本国特許出願第2018-131045号の明細書、特許請求の範囲、図面、および要約書を含む全開示内容は、参照により本願に全体として組み込まれる。
1…車両(自車両)、10…車両制御システム、20…運転支援制御装置(車両制御装置)、30…走行制御装置、40…操舵制御装置、50…外界認識装置(外界認識部)、60…車速センサ、70…ヨーレートセンサ、80…舵角センサ、90…電動パワーステアリング装置(操舵アクチュエータ)
Claims (12)
- 車両制御装置であって、前記車両制御装置は、
外界認識部によって取得された、車両の前方を走行する先行車両が走行した道路曲率に関する情報が入力され、
前記外界認識部によって取得された、前記車両と前記先行車両との相対位置に関する情報が入力され、
入力された前記道路曲率に関する情報と、入力された前記車両と前記先行車両との相対位置に関する情報と、に基づいて、前記先行車両に対して前記車両を1次の軌跡を用いて追従させる1次追従制御と、前記先行車両に対して前記車両を2次の軌跡を用いて追従させる2次追従制御と、の配分を求め、
求められた前記1次追従制御および前記2次追従制御を達成するための前記車両の操舵に関する指令を、前記車両の操舵に関する操舵アクチュエータ部に出力する、
車両制御装置。 - 請求項1に記載の車両制御装置において、
入力された前記道路曲率に関する情報と、入力された前記車両と前記先行車両との相対位置に関する情報と、に基づいて、前記1次追従制御と前記2次追従制御とを選択的に切り替える、
車両制御装置。 - 請求項2に記載の車両制御装置において、
遠心加速度が閾値以上であるときに前記1次追従制御を選択する、
車両制御装置。 - 請求項2に記載の車両制御装置において、
車速が閾値以上であるときに前記1次追従制御を選択する、
車両制御装置。 - 請求項1に記載の車両制御装置において、
入力された前記道路曲率に関する情報と、入力された前記車両と前記先行車両との相対位置に関する情報と、に基づいて、前記1次追従制御と前記2次追従制御とに重み付けを行って配分する、
車両制御装置。 - 請求項5に記載の車両制御装置において、
遠心加速度が大きくなるほど前記1次追従制御に対する重みを大きくする、
車両制御装置。 - 請求項5に記載の車両制御装置において、
車速が高くなるほど前記1次追従制御に対する重みを大きくする、
車両制御装置。 - 請求項1に記載の車両制御装置において、
道路曲率の増大に応じて、前記2次追従制御に対する重みを前記1次追従制御に対する重みよりも大きくする、
車両制御装置。 - 請求項1に記載の車両制御装置において、
前記車両と前記先行車両との車間距離の所定中間値からの増大に応じて、前記1次追従制御に対する重みを前記2次追従制御に対する重みよりも大きくし、前記車間距離の前記所定中間値からの減少に応じて、前記1次追従制御に対する重みを前記2次追従制御に対する重みよりも大きくする、
車両制御装置。 - 請求項1に記載の車両制御装置において、
前記先行車両の横ずれの増大に応じて、前記2次追従制御に対する重みを前記1次追従制御に対する重みよりも大きくする、
車両制御装置。 - 車両制御方法であって、前記車両制御方法は、
外界認識部によって取得された、車両の前方を走行する先行車両が走行した道路曲率に関する情報が入力され、
前記外界認識部によって取得された、前記車両と前記先行車両との相対位置に関する情報が入力され、
入力された前記道路曲率に関する情報と、入力された前記車両と前記先行車両との相対位置に関する情報と、に基づいて、前記先行車両に対して前記車両を1次の軌跡を用いて追従させる1次追従制御と、前記先行車両に対して前記車両を2次の軌跡を用いて追従させる2次追従制御と、の配分を求め、
求められた前記1次追従制御および前記2次追従制御を達成するための前記車両の操舵に関する指令を、前記車両の操舵に関する操舵アクチュエータ部に出力する、
車両制御方法。 - 車両制御システムであって、前記車両制御システムは、
車両の前方を走行する先行車両が走行した道路曲率に関する情報を取得する外界認識部と、
前記外界認識部によって取得された前記道路曲率に関する情報が入力され、
前記外界認識部によって取得された、前記車両と前記先行車両との相対位置に関する情報が入力され、
入力された前記道路曲率に関する情報と、入力された前記車両と前記先行車両との相対位置に関する情報と、に基づいて、前記先行車両に対して前記車両を1次の軌跡を用いて追従させる1次追従制御と、前記先行車両に対して前記車両を2次の軌跡を用いて追従させる2次追従制御と、の配分を求め、
求められた前記1次追従制御および前記2次追従制御を達成するための前記車両の操舵に関する指令を出力する、
コントローラと、
前記コントローラから出力された前記指令が入力される、前記車両の操舵に関する操舵アクチュエータ部と、
を備える車両制御システム。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US17/255,326 US11884273B2 (en) | 2018-07-10 | 2019-07-03 | Vehicle control device, vehicle control method, and vehicle control system |
EP19834137.2A EP3822138B1 (en) | 2018-07-10 | 2019-07-03 | Vehicle control device and vehicle control method |
CN201980039351.4A CN112272633A (zh) | 2018-07-10 | 2019-07-03 | 车辆控制装置、车辆控制方法以及车辆控制*** |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018-131045 | 2018-07-10 | ||
JP2018131045A JP7149121B2 (ja) | 2018-07-10 | 2018-07-10 | 車両制御装置、車両制御方法及び車両制御システム |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2020013050A1 true WO2020013050A1 (ja) | 2020-01-16 |
Family
ID=69142817
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2019/026464 WO2020013050A1 (ja) | 2018-07-10 | 2019-07-03 | 車両制御装置、車両制御方法及び車両制御システム |
Country Status (5)
Country | Link |
---|---|
US (1) | US11884273B2 (ja) |
EP (1) | EP3822138B1 (ja) |
JP (1) | JP7149121B2 (ja) |
CN (1) | CN112272633A (ja) |
WO (1) | WO2020013050A1 (ja) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6910973B2 (ja) * | 2018-02-02 | 2021-07-28 | 日立Astemo株式会社 | 車両制御装置及びその制御方法並びに車両制御システム |
KR102637599B1 (ko) * | 2018-10-08 | 2024-02-19 | 주식회사 에이치엘클레무브 | 차량간 통신 정보를 이용한 차선변경 제어장치 및 방법과, 그를 위한 성향 정보 산출 장치 |
KR20220064445A (ko) * | 2020-11-11 | 2022-05-19 | 현대모비스 주식회사 | 전동식 조향시스템의 제어 장치 및 방법 |
US11628827B2 (en) * | 2021-01-19 | 2023-04-18 | Denso Ten Limited | Vehicle control device and control method |
CN115352443B (zh) * | 2022-09-21 | 2024-02-09 | 山东科技大学 | 一种基于旁车切入识别的自适应巡航控制方法及设备 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008143269A (ja) * | 2006-12-07 | 2008-06-26 | Toyota Motor Corp | 車両用制御装置 |
DE102012214206A1 (de) * | 2012-08-09 | 2014-02-13 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Krümmungserkennung eines Fahrspurverlaufs während einer vollautomatischen Fahrzeugführung |
JP2017065473A (ja) | 2015-09-30 | 2017-04-06 | 富士重工業株式会社 | 操舵支援制御装置 |
JP2018024344A (ja) * | 2016-08-10 | 2018-02-15 | 株式会社Subaru | 車両の走行制御装置 |
JP2018024338A (ja) * | 2016-08-10 | 2018-02-15 | 日産自動車株式会社 | 走行軌跡推定方法、及び走行軌跡推定装置 |
JP2018131045A (ja) | 2017-02-15 | 2018-08-23 | 株式会社デンソー | 車両用空調装置 |
Family Cites Families (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3897740B2 (ja) * | 2003-07-23 | 2007-03-28 | トヨタ自動車株式会社 | 車両の自動誘導装置及び車両位置推定装置 |
JP5429234B2 (ja) * | 2011-03-23 | 2014-02-26 | トヨタ自動車株式会社 | 車両用情報処理装置 |
KR101833874B1 (ko) * | 2011-07-14 | 2018-03-05 | 현대모비스 주식회사 | 가변 곡률을 적용한 지능형 순항제어 시스템 및 그 방법 |
JP5578331B2 (ja) * | 2011-12-26 | 2014-08-27 | トヨタ自動車株式会社 | 車両の走行軌跡制御装置 |
JP5505453B2 (ja) * | 2012-04-26 | 2014-05-28 | 株式会社デンソー | 車両用挙動制御装置 |
KR102623680B1 (ko) * | 2015-02-10 | 2024-01-12 | 모빌아이 비젼 테크놀로지스 엘티디. | 자율 주행을 위한 약도 |
JP6341137B2 (ja) * | 2015-04-08 | 2018-06-13 | トヨタ自動車株式会社 | 車両の運転支援制御装置 |
JP2016206976A (ja) * | 2015-04-23 | 2016-12-08 | トヨタ自動車株式会社 | 車両の運転支援制御のための先行車軌跡算出装置 |
JP6027659B1 (ja) * | 2015-08-27 | 2016-11-16 | 富士重工業株式会社 | 車両の走行制御装置 |
CN105667509A (zh) * | 2015-12-30 | 2016-06-15 | 苏州安智汽车零部件有限公司 | 一种用于汽车自适应巡航控制***的弯道控制***及方法 |
JP6327719B2 (ja) * | 2016-02-04 | 2018-05-23 | 株式会社Subaru | 車両の走行制御装置 |
JP6294924B2 (ja) * | 2016-09-05 | 2018-03-14 | 株式会社Subaru | 車両の走行制御装置 |
JP6898629B2 (ja) * | 2016-09-05 | 2021-07-07 | 株式会社Subaru | 車両の走行制御装置 |
US10875529B2 (en) * | 2016-10-25 | 2020-12-29 | Honda Motor Co., Ltd. | Vehicle control device |
JP6837196B2 (ja) * | 2017-02-15 | 2021-03-03 | 日立Astemo株式会社 | 車両運動制御装置、車両運動制御方法および車両運動制御システム |
JP6795792B2 (ja) * | 2017-09-28 | 2020-12-02 | トヨタ自動車株式会社 | 運転支援装置 |
JP6848794B2 (ja) * | 2017-09-29 | 2021-03-24 | トヨタ自動車株式会社 | 衝突回避支援装置 |
-
2018
- 2018-07-10 JP JP2018131045A patent/JP7149121B2/ja active Active
-
2019
- 2019-07-03 US US17/255,326 patent/US11884273B2/en active Active
- 2019-07-03 WO PCT/JP2019/026464 patent/WO2020013050A1/ja unknown
- 2019-07-03 EP EP19834137.2A patent/EP3822138B1/en active Active
- 2019-07-03 CN CN201980039351.4A patent/CN112272633A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008143269A (ja) * | 2006-12-07 | 2008-06-26 | Toyota Motor Corp | 車両用制御装置 |
DE102012214206A1 (de) * | 2012-08-09 | 2014-02-13 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zur Krümmungserkennung eines Fahrspurverlaufs während einer vollautomatischen Fahrzeugführung |
JP2017065473A (ja) | 2015-09-30 | 2017-04-06 | 富士重工業株式会社 | 操舵支援制御装置 |
JP2018024344A (ja) * | 2016-08-10 | 2018-02-15 | 株式会社Subaru | 車両の走行制御装置 |
JP2018024338A (ja) * | 2016-08-10 | 2018-02-15 | 日産自動車株式会社 | 走行軌跡推定方法、及び走行軌跡推定装置 |
JP2018131045A (ja) | 2017-02-15 | 2018-08-23 | 株式会社デンソー | 車両用空調装置 |
Non-Patent Citations (1)
Title |
---|
See also references of EP3822138A4 |
Also Published As
Publication number | Publication date |
---|---|
JP7149121B2 (ja) | 2022-10-06 |
EP3822138A1 (en) | 2021-05-19 |
CN112272633A (zh) | 2021-01-26 |
EP3822138B1 (en) | 2024-06-26 |
EP3822138A4 (en) | 2021-10-06 |
US11884273B2 (en) | 2024-01-30 |
JP2020006866A (ja) | 2020-01-16 |
US20210269030A1 (en) | 2021-09-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2020013050A1 (ja) | 車両制御装置、車両制御方法及び車両制御システム | |
CN109421709B (zh) | 车辆的驾驶辅助装置 | |
JP4229051B2 (ja) | 運転意図推定装置、車両用運転操作補助装置および車両用運転操作補助装置を備えた車両 | |
JP6507839B2 (ja) | 車両の走行制御装置 | |
WO2019150884A1 (ja) | 車両制御装置及びその制御方法並びに車両制御システム | |
US9403555B2 (en) | Driving route generation device | |
US10392015B2 (en) | Vehicle control device and vehicle control method | |
JP4037722B2 (ja) | 車外監視装置、及び、この車外監視装置を備えた走行制御装置 | |
JP4062310B2 (ja) | 運転意図推定装置、車両用運転操作補助装置および車両用運転操作補助装置を備えた車両 | |
JP6561704B2 (ja) | 運転支援装置、及び運転支援方法 | |
US10845813B2 (en) | Route setting method and route setting device | |
EP3514031B1 (en) | Parking assist method and device | |
CN110167813B (zh) | 行驶路径识别装置及行驶路径识别方法 | |
JP6443292B2 (ja) | 運転支援装置、及び運転支援方法 | |
JP6838285B2 (ja) | レーンマーカ認識装置、自車両位置推定装置 | |
US11151395B2 (en) | Roadside object detection device, roadside object detection method, and roadside object detection system | |
CN111428759A (zh) | 数据融合方法、电子设备及存储介质 | |
CN110632916A (zh) | 行动预测装置以及自动驾驶装置 | |
JP7059528B2 (ja) | 駐車支援方法及び駐車制御装置 | |
JP4852851B2 (ja) | 運転意図推定装置、車両用運転操作補助装置および車両用運転操作補助装置を備えた車両 | |
JP6451565B2 (ja) | 運転支援装置、及び運転支援方法 | |
CN111483459A (zh) | 车辆控制装置 | |
US11619495B2 (en) | Position estimating apparatus and position estimating method | |
US20230221432A1 (en) | Sensor recognition integration device | |
US20230347861A1 (en) | Vehicle Control Device, Vehicle Control Method, and Vehicle Control System |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 19834137 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |