Vehicle control device

Abstract

To provide a vehicle control device that can appropriately cope with a rut on a road in an automatic operation.SOLUTION: The vehicle control device comprises: a track calculating part 32 that calculates a target track of an own vehicle in a road constituting a target route; a behavior detecting part 5 that detects information concerning the behavior of the own vehicle; a rut determining part 34 that determines presence or absence of a rut on the target track, on the basis of at least one of a detected result by a periphery monitoring device 4 and a detected result by the behavior detecting part 5; a travelling possibility determining part 35 that when the rut determining part 34 determines that there is a rut, determines whether the own vehicle can run over the rut or not, on the basis of the detected result by the periphery monitoring device 4, the target track, and the detected result by the behavior detecting part 5; and a correcting part 36 that corrects at least one of the target track and the target route, when the travelling possibility determining part 35 determines that the own vehicle cannot run over the rut.SELECTED DRAWING: Figure 1

Description

[Technical field]

[0001] The present invention relates to a vehicle control device. [Background technology]

[0002] As a vehicle control device, for example, Japanese Patent Application Laid-Open Publication No. 2019-209763 discloses a technology for changing the distribution of driving force to the wheels when a rut is present on the road surface ahead of the vehicle's traveling direction. In this vehicle control device, for example, when there is a rut ahead of the vehicle's traveling direction, the vehicle switches from a two-wheel drive state to a four-wheel drive state. This allows the vehicle to smoothly overcome the rut. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2019-209763 A Summary of the Invention [Problem to be solved by the invention]

[0004] For example, on a general road and a snowy road, when the vehicle is traveling along the ruts of a preceding vehicle having a similar width, it is possible to smoothly escape the ruts by changing the distribution of driving force. However, it is possible that high ruts cannot be overcome by changing the distribution of driving force alone. For example, ruts formed on an unpaved road by the passage of a large dump truck may correspond to something like a curb or a wall for a passenger car. An object of the present invention is to provide a vehicle control device that can appropriately deal with ruts on the road during automatic driving. [Means for solving the problem]

[0005] The vehicle control device of the present invention includes a steering device that steers wheels, a route calculation unit that calculates a target route indicating roads that the host vehicle will take to reach the destination based on map data, position information of the host vehicle, and information of the destination, a surroundings monitoring device that monitors the surroundings of the host vehicle, a trajectory calculation unit that calculates a target trajectory of the host vehicle within the roads that constitute the target route based on detection results of the surroundings monitoring device in an autonomous driving state, a steering angle calculation unit that calculates a target steering angle based on the target trajectory, a steering control unit that controls the steering device based on the target steering angle, and a rut determination unit which determines whether or not there is a rut on the target trajectory based on at least one of the detection results of the periphery monitoring device and the detection results of the behavior detection unit; a traveling feasibility determination unit which, when it is determined by the rut determination unit that there is a rut, determines whether or not the host vehicle can overcome the rut based on the detection results of the periphery monitoring device, the target trajectory, and the detection results of the behavior detection unit; and a correction unit which, when it is determined by the traveling feasibility determination unit that the host vehicle cannot overcome the rut, corrects at least one of the target trajectory and the target route. Effect of the Invention

[0006] According to the present invention, when it is determined that the vehicle cannot overcome the rut during automated driving, at least one of the target trajectory and the target route is corrected. By changing the target trajectory or the target route, for example, it is possible to make the approach angle of the vehicle to the rut closer to 90 degrees to make it easier to overcome the rut, or to select a route to reach the destination without overcoming the rut. In other words, according to the present invention, it is possible to appropriately deal with ruts on the road during automated driving. [Brief description of the drawings]

[0007] [Figure 1] 1 is a configuration diagram of a vehicle control device according to an embodiment of the present invention; [Diagram 2] 6 is a conceptual diagram showing an example of correction of a target trajectory according to the present embodiment. FIG. [Diagram 3] 6 is a conceptual diagram showing an example of correction of a target trajectory according to the present embodiment. FIG. [Figure 4] FIG. 4 is a conceptual diagram showing an example of correction of a target route in the present embodiment. [Diagram 5] 5 is a flowchart showing a flow of correction of a target trajectory or a target route in the present embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0008] A vehicle control device 1 according to an embodiment of the present invention will be described in detail below with reference to the drawings. In addition to the following examples, the present invention can be embodied in various forms with various modifications and improvements based on the knowledge of those skilled in the art.

[0009] The vehicle control device 1 of this embodiment includes a steering system 2, an automatic driving ECU 3, a surroundings monitoring device 4, and a behavior detection unit 5. The steering system 2 includes a steering device 2A and a steering ECU (corresponding to a "steering control unit") 2B. The steering device 2A steers the left and right front wheels 10A, which are steered wheels. The steering device 2A is an electric power steering, and includes a steering knuckle 21, a steering rod 22, a steering wheel 23, which is a steering operation member, a steering shaft 24, a motion conversion mechanism 25, a steering actuator 26, an operation angle sensor 27, and an operation force sensor 28.

[0010] A pair of steering knuckles 21 each rotatably holds front wheel 10A. Both ends of steering rod 22 are connected to steering knuckle 21 via tie rod 22a. Steering shaft 24 rotates integrally with steering wheel 23. Motion conversion mechanism 25 is a rack-and-pinion mechanism that converts the rotational motion of steering shaft 24 into linear movement motion of steering rod 22 in the left-right direction. Steering actuator 26 is configured to apply a force (hereinafter also referred to as "axial force") to steering rod 22 that moves steering rod 22 in the left-right direction. Steering actuator 26 includes a steering motor 261 that applies an axial force to steering rod 22.

[0011] The operation angle sensor 27 is a sensor for detecting a steering operation angle (hereinafter, simply referred to as "operation angle"), which is the amount of operation of the steering wheel 23. The operation force sensor 28 is a sensor for detecting the amount of twist of a torsion bar (not shown) provided on the steering shaft 24 caused by the driver's steering operation, that is, a sensor for detecting an operation torque as an operation force applied to the steering wheel 23 by the driver.

[0012] The steering ECU 2B is an electronic control unit equipped with a CPU, memory, etc., and controls the steering device 2A. The steering ECU 2B sets a control current value (hereinafter also referred to as an "assist current value") to be supplied to the steering motor 261 based on the operation torque and operation direction (and further, for example, vehicle speed information) detected by the operation force sensor 28, and supplies a control current corresponding to the assist current value to the steering motor 261. The actual steering angle, which is the actual steering angle (steered amount) of the front wheels 10A, is estimated based on the detection value of a rotation angle sensor 261a provided in the steering motor 261. The assist current value is detected by a current sensor 261b provided in the steering motor 261.

[0013] The autonomous driving ECU 3 is an electronic control unit equipped with a CPU, a memory, and the like. The CPU includes one or more processors and executes various calculations described below. The autonomous driving ECU 3 can calculate the positional relationship between the host vehicle and objects around the host vehicle based on the detection results of the surroundings monitoring device 4 and map data (e.g., three-dimensional map data). The autonomous driving ECU 3 will be described in detail later.

[0014] The periphery monitoring device 4 is a device that monitors the periphery of the vehicle. The periphery monitoring device 4 is configured to include, for example, a camera that captures images of the periphery of the vehicle, and a millimeter wave radar and a LiDAR (Light Detection and Ranging, or Laser Imaging Detection and Ranging) that measures the distance between the vehicle and objects around the vehicle. The periphery monitoring device 4 can also be said to be a device that measures the distance between the vehicle and objects around the vehicle in order to estimate the position of the vehicle. From the viewpoint of detection accuracy, the periphery monitoring device 4 is preferably configured to include a LiDAR.

[0015] During automatic driving, steering ECU 2B sets an assist current value based on the target steering angle received from automatic driving ECU 3, and supplies a control current corresponding to the assist current value to steering motor 261. Even if steering wheel 23 is not operated, steering device 2A is operated by steering motor 261 to which a control current is applied. During automatic driving, front wheels 10A are steered according to an assist current value based on a target trajectory and a target steering angle, without operation of steering wheel 23. At this time, automatic driving ECU 3 also calculates a target operation angle of steering wheel 23 corresponding to the target steering angle.

[0016] In this way, the steering ECU 2B controls the steering device 2A in accordance with the target steering angle received from the automatic driving ECU 3 during automatic driving, and in accordance with the driver's operation of the steering wheel 23 during manual driving. The automatic driving ECU 3 sets a target route and target trajectory for automatic driving in the map data, and transmits a target steering angle based on the target trajectory to the steering ECU 2B during automatic driving.

[0017] (Various sensors) The vehicle is equipped with various sensors, such as a longitudinal acceleration sensor 51 that detects acceleration in the longitudinal direction of the vehicle, a lateral acceleration sensor 52 that detects acceleration in the left-right direction of the vehicle, a surroundings monitoring device 4 that monitors the surroundings of the vehicle, a yaw rate sensor 54 that detects the yaw rate of the vehicle, a roll rate sensor 55 that detects the roll rate of the vehicle, a pitch rate sensor 56 that detects the pitch rate of the vehicle, a wheel speed sensor 57 that detects the wheel speed, a vertical acceleration sensor 58 that detects the acceleration in the vertical direction of the vehicle, a suspension stroke sensor 59 that detects the stroke of a shock absorber, etc. The vehicle speed can be calculated based on the detection result of the wheel speed sensor 57, for example.

[0018] The various sensors are communicatively connected to various ECUs (e.g., steering ECU 2B, autonomous driving ECU 3). Communication within the vehicle is performed by CAN (car area network or controllable area network). In determining the presence or absence of ruts, which will be described later, sensors corresponding to behavior detection unit 5 that detects information regarding the behavior of the vehicle include, for example, longitudinal acceleration sensor 51, lateral acceleration sensor 52, yaw rate sensor 54, wheel speed sensor 57, current sensor 261b, roll rate sensor 55, pitch rate sensor 56, vertical acceleration sensor 58, and suspension stroke sensor 59.

[0019] The autonomous driving ECU 3 includes, as functions, a route calculation unit 31, a trajectory calculation unit 32, a steering angle calculation unit 33, a rut determination unit 34, a travel feasibility determination unit 35, and a correction unit 36. The route calculation unit 31 calculates a target route indicating roads that the host vehicle will pass through until it reaches the destination based on map data, the position information of the host vehicle, and information of the destination. The map data is stored, for example, in a storage medium (which may be a device outside the vehicle) with which the autonomous driving ECU 3 can communicate. The position information of the host vehicle is, for example, position information of the host vehicle measured by a GPS (Global Positioning System: omnidirectional positioning system). The vehicle is equipped with a GPS receiver 9 (GPS function). The destination is set, for example, by a user. The route calculation unit 31 calculates the target route based on a predetermined condition (for example, selection of the shortest route, etc.). The route calculation unit 31 may be configured to calculate a plurality of target routes and have the user select one target route from the plurality of target routes. The route calculation unit 31 performs a function similar to that of a well-known navigation system, for example.

[0020] In autonomous driving, the trajectory calculation unit 32 calculates a target trajectory of the host vehicle within the roads constituting the target route based on the detection results of the periphery monitoring device 4. The target trajectory can be said to be information on the target passing points of the host vehicle within the roads (including paved roads and unpaved roads) constituting the target route. For example, the target trajectory is calculated according to the recognition of white lines, other vehicles, pedestrians, etc. on the road based on the detection results of the periphery monitoring device 4. It can also be said that the target route indicates the roads along which the host vehicle will travel, and the target trajectory indicates the trajectory of the target passing points of the host vehicle within the roads.

[0021] The steering angle calculation unit 33 calculates a target steering angle based on the target trajectory. The steering angle calculation unit 33 calculates a target steering angle corresponding to the position of the host vehicle so that the traveling trajectory of the host vehicle is along (follows) the target trajectory. The steering angle calculation unit 33 calculates a target steering angle (command value) to be transmitted to the steering ECU 2B, for example, based on a FF target angle calculated by feedforward control and a FB target angle calculated by feedback control. The FF target angle is, for example, an angle according to the curvature of the target trajectory. The FB target angle is, for example, an angle based on a lateral deviation that is a deviation of the left and right position of the host vehicle from the target trajectory, and a yaw angle deviation based on the target trajectory.

[0022] (Determining the presence or absence of track ruts) The rut determination unit 34 determines whether or not there is a rut on the target trajectory based on at least one of the detection results of the periphery monitoring device 4 and the detection results of the behavior detection unit 5. The rut determination unit 34 determines whether or not there is a rut on the target trajectory based on, for example, the detection results of the lidar (and camera) of the periphery monitoring device 4, i.e., recognition information of the positions and shapes of objects around the vehicle. The rut determination unit 34 determines whether or not there is a rut based on a preset definition or determination criterion for a rut. For example, the definition or determination criterion for a rut is "a convex portion on a road that protrudes from the road surface (bottom surface) by a predetermined value or more and extends along the road surface for a predetermined length or more."

[0023] The rut determination unit 34 can determine the presence or absence of a rut based on the detection result of the behavior detection unit 5. For example, the rut determination unit 34 determines the presence or absence of a rut based on the detection result (assist current value supplied to the steering motor 261) of the current sensor 261b as the behavior detection unit 5. The steering ECU 2B sets the assist current value so that the difference between the actual steering angle and the target steering angle becomes small. Therefore, when the difference between the actual steering angle and the target steering angle does not become small due to the rut, the steering ECU 2B increases the assist current value and increases the axial force (steering assist force, motor torque). When the vehicle crosses (goes over) a rut, the road resistance against steering becomes large compared to when the vehicle is turning on a flat paved road, and the assist current value against the actual steering angle becomes large. In other words, when the target trajectory and the target steering angle are achieved, differences occur in the assist current value and the axial force depending on the road surface condition.

[0024] The rut determination unit 34 calculates the difference between a current reference value set in advance for the target steering angle and the detection result of the current sensor 261b, that is, the deviation from the reference, and determines the presence or absence of a rut based on a comparison between the deviation from the reference and a predetermined threshold. The rut determination unit 34 determines that there is no rut when the deviation from the reference is equal to or less than the predetermined threshold, and determines that there is a rut when the deviation from the reference exceeds the predetermined threshold. Alternatively, the rut determination unit 34 determines that there is a rut when the state in which the deviation from the reference exceeds the predetermined threshold continues for a predetermined time or more. When the vehicle unintentionally runs along the rut without going over the rut, the deviation from the reference continues to increase for a certain period of time. This allows the rut determination unit 34 to determine the presence or absence of contact between the vehicle and the rut, that is, the presence or absence of a rut. Note that the detection target of the behavior detection unit 5 here may be the axial force instead of the assist current value. The higher the assist current value, the greater the axial force.

[0025] Furthermore, the rut determination unit 34 may determine the presence or absence of a rut based on the detection results of other behavior detection unit 5, such as the amount of change in yaw rate, the amount of change in vertical acceleration, the amount of change in lateral acceleration, the amount of change in roll rate, the amount of change in pitch rate, the amount of change in suspension stroke, and the amount of change in wheel speed, etc. These values ​​(detection results) also change depending on the presence or absence of a rut.

[0026] The rut determination unit 34 can determine the presence or absence of a rut based on the detection result of the periphery monitoring device 4, for example, before the wheels attempt to go over the rut (before contact), and can also determine the presence or absence of a rut based on the detection result of the behavior detection unit when the wheels attempt to go over the rut (after contact). That is, the rut determination unit 34 is configured to be able to execute a pre-contact determination (pre-determination) based on the detection result of the periphery monitoring device 4 and a post-contact determination (post-determination) based on the detection result of the behavior detection unit 5. Therefore, even if the presence of a rut is overlooked in the pre-contact determination, for example, the rut determination unit 34 can detect the presence of a rut in the post-contact determination. In this way, the rut determination unit 34 determines the presence or absence of a rut based on at least one of the detection result of the periphery monitoring device 4 and the detection result of the behavior detection unit 5.

[0027] (Decision on whether or not to drive) When the rut determination unit 34 determines that there is a rut, the traveling feasibility determination unit 35 determines whether the vehicle can overcome the rut based on the detection result of the periphery monitoring device 4, the target trajectory, and the detection result of the behavior detection unit 5. When the rut determination unit 34 determines that there is a rut, the traveling feasibility determination unit 35 calculates the height of the rut and the extension direction of the rut based on the detection result of the periphery monitoring device 4. The traveling feasibility determination unit 35 can calculate the height of the rut based on the road surface and the extension direction of the rut along the road surface based on the detection result of the lidar (and camera) of the periphery monitoring device 4. However, the calculation (estimation) accuracy of the height and extension direction of the rut may differ depending on the function level of the periphery monitoring device 4, etc.

[0028] The traveling feasibility determination unit 35 determines whether the vehicle can get over the rut (hereinafter also referred to as "travel feasibility") based on, for example, the height of the rut, the approach angle of the vehicle to the rut according to the current target trajectory, the vehicle speed, and the acceleration. If the target trajectory (the traveling direction of the vehicle) and the extension direction of the rut can be grasped, the approach angle of the vehicle to the rut, i.e., the intersection angle between the extension direction of the rut and the target trajectory, can be calculated.

[0029] For example, the closer the entry angle is to 90 degrees, the easier it is considered that the host vehicle will overcome the rut. Also, for example, the higher the vehicle speed immediately before contacting the rut, the easier it is considered that the host vehicle will overcome the rut. Also, for example, the greater the acceleration of the host vehicle forward immediately before contacting the rut, the easier it is considered that the host vehicle will overcome the rut. The higher the vehicle speed or the greater the acceleration, the greater the force to overcome the rut and the higher the possibility that the host vehicle will run while breaking down the rut. In this way, the running possibility determination unit 35 determines whether or not it is possible to run based on, for example, the height of the rut, the entry angle, and at least one of the vehicle speed and acceleration. Hereinafter, factors other than the height of the rut in determining whether or not it is possible to run (entrance angle, vehicle speed, acceleration) are referred to as possibility determination factors.

[0030] The traveling feasibility determination unit 35 may include, for example, a map showing the relationship between the height of the rut, the feasibility determination factor, and the feasibility of passing over. The traveling feasibility determination unit 35 may also use, for example, a map to calculate a threshold vehicle speed and / or a threshold acceleration for passing over based on the height of the rut and the approach angle. In this case, the traveling feasibility determination unit 35 determines that the host vehicle cannot pass over the rut when, for example, the expected maximum vehicle speed (e.g., the maximum achievable vehicle speed) when the host vehicle reaches the rut is less than the threshold vehicle speed. The traveling feasibility determination unit 35 determines that the host vehicle cannot pass over the rut when, for example, the expected maximum acceleration (e.g., the maximum achievable acceleration) when the host vehicle reaches the rut is less than the threshold acceleration. The feasibility determination factor may include the driving force of each wheel and the distribution of the driving force (e.g., two-wheel drive state, four-wheel drive state). In other words, the traveling feasibility determination unit 35 may determine whether or not the host vehicle can pass over the rut based on the driving force of each wheel and the distribution of the driving force.

[0031] In addition, the traveling feasibility determination unit 35 may determine whether traveling is possible by, for example, comparing a threshold value for the height of the rut with a score based on the feasibility determination element. As an example, the higher the rut, the higher the threshold value. In this case, the score is higher the closer the entry angle is to 90 degrees, the higher the expected maximum vehicle speed, and the higher the expected maximum acceleration. Then, for example, when the sum of the scores of each feasibility determination element is less than the threshold value, the traveling feasibility determination unit 35 determines that the host vehicle cannot overcome the rut, and when the sum is equal to or greater than the threshold value, the traveling feasibility determination unit 35 determines that the host vehicle can overcome the rut. In addition, for example, when the driving force and / or the distribution of the driving force are included in the feasibility determination element, the higher the driving force, the higher the score, and the four-wheel drive state has a higher score than the two-wheel drive state. The feasibility determination element to be added as a score can be set appropriately.

[0032] In addition, when the rut determination unit 34 determines that there is a rut based on the detection result of the behavior detection unit 5, the travel possibility determination unit 35 may determine whether or not the vehicle can travel based on the detection result of the behavior detection unit 5 when the vehicle tries to go over the rut. For example, the travel possibility determination unit 35 may determine whether or not the vehicle can travel based on the detection result (assist current value) of the current sensor 261b or the motor torque when the vehicle tries to go over the rut. For example, when the assist current value when the vehicle tries to go over the rut is the maximum value of the assist current value set in advance, the travel possibility determination unit 35 determines that the vehicle cannot go over the rut. In this case, the travel possibility determination unit 35 may not calculate the height and extension direction of the rut. The travel possibility determination unit 35 may also estimate the height of the rut from the assist current value. The travel possibility determination unit 35 may also estimate the extension direction of the rut to be along the road in consideration of the road conditions. Furthermore, the traveling possibility determination unit 35 may determine whether traveling is possible based on the detection results of other behavior detection unit 5. The above-mentioned multiple determination methods can be appropriately changed.

[0033] (Target trajectory, target route correction) The correction unit 36 ​​corrects at least one of the target trajectory and the target route when the traveling feasibility determination unit 35 determines that the vehicle cannot overcome the rut. The correction unit 36 ​​of this embodiment corrects the target trajectory so that the intersection angle between the target trajectory and the rut is closer to 90 degrees after the correction than before the correction on the roads that constitute the target route. The correction unit 36 ​​of this embodiment first attempts to correct the target trajectory. Note that the intersection angle (the entry angle of the vehicle into the rut) can be expressed as an acute angle or an obtuse angle as long as it is not 90 degrees, but an acute angle will be described in this embodiment.

[0034] As shown in Fig. 2 and Fig. 3, when the target trajectory is corrected by the correction unit 36, for example, if the intersection angle between the target trajectory and the rut before the correction is θ1, the intersection angle θ2 after the correction is larger than θ1 and is equal to or smaller than 90 degrees (θ1<θ2≦90 degrees). The example in Fig. 2 is an example in which the rut determination unit 34 determines that there is a rut based on the detection result of the periphery monitoring device 4 (pre-contact determination), the traveling feasibility determination unit 35 determines that it is impossible to pass over, and the correction unit 36 ​​corrects the target trajectory. The example in Fig. 3 is an example in which the rut determination unit 34 determines that there is a rut based on the detection result of the behavior detection unit 5 (post-contact determination), the traveling feasibility determination unit 35 determines that it is impossible to pass over, and the correction unit 36 ​​corrects the target trajectory.

[0035] The autonomous driving ECU 3 may accelerate or decelerate the host vehicle to realize the corrected target trajectory, for example, to decelerate the host vehicle so as to enable small turning radius. In order to realize the target trajectory, the autonomous driving ECU 3 issues a target steering angle and a target deceleration (target braking force) or a target acceleration to a corresponding control device (such as the steering ECU 2B). In this way, the correction unit 36 ​​calculates a target trajectory that can be realized by the steering control and acceleration / deceleration control of the host vehicle and that the intersection angle θ2 is close to or equal to 90 degrees.

[0036] The correction unit 36 ​​gives priority to executing the correction calculation of the target trajectory (calculation related to correction), and if there is no target trajectory that can overcome the rut among the target trajectories that can be realized from the situation of the vehicle (vehicle speed, road width, etc.) in the correction calculation, the correction unit 36 ​​corrects the target route. In other words, when the traveling feasibility determination unit 35 determines that the vehicle cannot overcome the rut, the correction unit 36 ​​gives priority to executing the correction calculation of the target trajectory, and corrects the target route if the calculation result shows that the rut cannot be overcome even with the corrected target trajectory. In the correction calculation, the correction unit 36 ​​of this embodiment also refers to physical restriction information, such as map data or road width information based on the detection result of the surroundings monitoring device 4, and information on the presence of other ruts on the road.

[0037] As described above, the correction unit 36 ​​recalculates the target route when there is no target trajectory that can overcome the ruts in the current target route in the correction calculation. For example, when the condition in the correction calculation is "to make the intersection angle θ2 90 degrees," and the correction calculation finds that the intersection angle θ2 cannot be made 90 degrees due to restrictions such as road width even if the vehicle is decelerated at the maximum deceleration and steered at the maximum steering angle, the correction unit 36 ​​calculates another target route. Also, for example, when the ruts are too high and the vehicle cannot overcome the ruts even if the intersection angle θ2 is 90 degrees, the correction unit 36 ​​calculates another target route.

[0038] For example, when the correction unit 36 ​​can grasp the state of ruts ahead in the traveling direction of the vehicle (hereinafter, abbreviated as "ahead") from the detection result of the periphery monitoring device 4, the correction unit 36 ​​may calculate a target route that can overcome the ruts or a target route that does not need to overcome the ruts. As shown in Fig. 4, when the correction unit 36 ​​can recognize that the ruts end ahead (for example, when only the roads R4 and R5 ahead are paved roads), the correction unit 36 ​​corrects the target route so that the vehicle turns left after the ruts end.

[0039] The target route before correction (roads R1, R2) and the target route after correction (roads R1, R3, R5) have different combinations of roads to travel and different intersections to turn at (intersection C1 → intersection C2). In Figure 4, one road is defined as the road surface from one intersection to another (including the road surfaces at each intersection).

[0040] Even if the state of the rut ahead cannot be recognized, the correction unit 36 ​​sets a target route different from the current one, and as a result, the same situation as in FIG. 4 may occur. In other words, even if the state of the rut ahead is unknown, the correction unit 36 ​​calculates a target route different from the current one and corrects the target route. If the host vehicle needs to overcome the rut again while traveling on the corrected target route, the correction unit 36 ​​executes the correction calculation of the target trajectory again. Note that, when the correction unit 36 ​​recognizes that the rut in FIG. 4 extends into the intersection C2 at the stage of changing the target route, that is, when the correction unit 36 ​​recognizes that the rut needs to be overcome at the intersection C2, it calculates a target trajectory that can overcome the rut at the intersection C2 in advance. This allows the autonomous driving ECU 3 to decelerate the host vehicle or greatly expand the target trajectory at an early stage.

[0041] An example of the flow of correction of the target trajectory or the target route will be described with reference to FIG. 5. During automatic driving, the automatic driving ECU 3 judges whether or not there is a rut on the target trajectory (S1). If the automatic driving ECU 3 judges that there is a rut on the target trajectory (S1: Yes), it judges whether or not the host vehicle can overcome the rut on the current target trajectory (S2). If the automatic driving ECU 3 judges that the host vehicle cannot overcome the rut (S2: No), it executes a correction calculation of the target trajectory (S3). More specifically, the automatic driving ECU 3 calculates the target trajectory so that the crossing angle θ2 after correction is close to 90 degrees or is 90 degrees. The automatic driving ECU 3 incorporates, for example, information on the achievable acceleration / deceleration limit of the host vehicle and information on the road width into the correction calculation.

[0042] If there is a surmountable target trajectory (S4: Yes), the autonomous driving ECU 3 recalculates the target trajectory and corrects the target trajectory (S5). The autonomous driving ECU 3 issues commands to the corresponding control device, such as a target steering angle based on the corrected target trajectory, target acceleration / deceleration, and switching to a four-wheel drive state. On the other hand, if there is no surmountable target trajectory (S4: No), the autonomous driving ECU 3 recalculates the target route and corrects the target route (S6). When the target route is corrected, a target trajectory corresponding to the target route is set.

[0043] If the autonomous driving ECU 3 determines that there are no ruts (S1: No), or if there are ruts but the vehicle can overcome them (S2: Yes), the autonomous driving ECU 3 maintains the current target trajectory and target route and continues autonomous driving. The autonomous driving ECU 3 repeats this process at predetermined intervals during autonomous driving.

[0044] (Effects of this embodiment) According to this embodiment, when it is determined that the vehicle cannot overcome the rut during autonomous driving, the target trajectory or the target route is corrected. By changing the target trajectory or the target route, for example, it is possible to make the approach angle of the vehicle to the rut closer to 90 degrees to make it easier to overcome the rut, or to select a route to reach the destination without overcoming the rut. In other words, according to this embodiment, it is possible to appropriately deal with the ruts on the road during autonomous driving.

[0045] In this embodiment, the target trajectory is corrected so that the intersection angle θ2 approaches 90 degrees or the intersection angle θ2 becomes 90 degrees. As a result, the host vehicle travels so that the traveling direction is perpendicular or nearly perpendicular to the extension direction of the rut, making it easier to overcome the rut. Also, in this embodiment, if the host vehicle cannot overcome the rut, the automatic driving ECU 3 preferentially executes a correction calculation of the target trajectory. As a result, the target route (for example, the shortest route, etc.) is more likely to be maintained, and time loss due to detours is more likely to be reduced. Also, according to this embodiment, if it is determined that the host vehicle cannot overcome the rut even after correcting the target trajectory, the target route itself is changed, improving the probability of the host vehicle reaching the destination.

[0046] In this embodiment, the rut determination unit 34 determines the presence or absence of a rut without contact between the host vehicle and the rut based on the detection result of the periphery monitoring device 4, and determines the presence or absence of contact between the host vehicle and the rut based on the detection result of the behavior detection unit 5. In this way, the rut determination unit 34 can determine the presence or absence of a rut on the target trajectory both before and after the fact.

[0047] In this embodiment, the steering device 2A includes a steering motor 261 that steers the front wheels 10A, and the behavior detection unit 5 includes a current sensor 261b that detects the current value (assist current value) of the control current supplied to the steering motor 261. The rut determination unit 34 calculates a deviation from the reference, which is the difference between a current reference value set in advance for the target steering angle and the detection result of the current sensor 261b, and determines the presence or absence of a rut based on a comparison between the deviation from the reference and a predetermined threshold value. With this configuration, even if the vehicle control device 1 cannot find a rut based on the detection result of the surroundings monitoring device 4, it can determine the presence or absence of a rut based on the deviation from the reference after the wheels of the host vehicle come into contact with the rut. In other words, the vehicle control device 1 can correct at least one of the target trajectory and the target route even after the fact.

[0048] (others) The present invention is not limited to the above embodiment. For example, the correction unit 36 ​​may preferentially execute the correction calculation of the target route. The correction unit 36 ​​may also execute the correction calculation of the target trajectory along with the correction calculation of the target route. The turning device may also be provided for the rear wheels 10B. The steering system 2 may be a steer-by-wire type system. The automatic driving ECU 3 may be composed of a plurality of ECUs. The road includes paved roads and unpaved roads, and the ruts include those formed by soil or snow. The present invention is more effective for automatic driving of passenger cars in mines and the like where there are many unpaved roads with ruts formed by large heavy machinery, for example. [Explanation of symbols]

[0049] 1...vehicle control device, 2A...steering device, 2B...steering ECU (steering control unit), 261...steering motor, 261b...current sensor, 31...route calculation unit, 32...trajectory calculation unit, 33...steering angle calculation unit, 34...rut determination unit, 35...traveling feasibility determination unit, 36...correction unit, 4...periphery monitoring device, 5...behavior detection unit.

Claims

1. A steering device for steering the wheels; a route calculation unit that calculates a target route indicating roads along which the host vehicle will travel until the host vehicle reaches the destination based on map data, vehicle position information, and destination information; A surroundings monitoring device that monitors the surroundings of the host vehicle; a trajectory calculation unit that calculates a target trajectory of the host vehicle on roads that constitute the target route based on a detection result of the surroundings monitoring device in an autonomous driving mode; a steering angle calculation unit that calculates a target steering angle based on the target trajectory; a steering control unit that controls the steering device based on the target steering angle; A behavior detection unit that detects information regarding a behavior of the host vehicle; a rut determination unit that determines whether or not there is a rut on the target trajectory based on at least one of a detection result of the surroundings monitoring device and a detection result of the behavior detection unit; a travel possibility determination unit that, when it is determined by the rut determination unit that there is a rut, determines whether or not the host vehicle can overcome the rut based on the detection result of the periphery monitoring device, the target trajectory, and the detection result of the behavior detection unit; and a correction unit that corrects at least one of the target trajectory and the target route when the travel feasibility determination unit determines that the host vehicle cannot overcome the wheel track; Equipped with the correction unit corrects the target trajectory such that an intersection angle between the target trajectory and the wheel track after the correction is closer to 90 degrees than an intersection angle before the correction on roads constituting the target route. Vehicle control device.

2. A steering device for steering the wheels; a route calculation unit that calculates a target route indicating roads along which the host vehicle will travel until the host vehicle reaches the destination based on map data, vehicle position information, and destination information; A surroundings monitoring device that monitors the surroundings of the host vehicle; a trajectory calculation unit that calculates a target trajectory of the host vehicle on roads that constitute the target route based on a detection result of the surroundings monitoring device in an autonomous driving mode; a steering angle calculation unit that calculates a target steering angle based on the target trajectory; a steering control unit that controls the steering device based on the target steering angle; A behavior detection unit that detects information regarding a behavior of the host vehicle; a rut determination unit that determines whether or not there is a rut on the target trajectory based on at least one of a detection result of the surroundings monitoring device and a detection result of the behavior detection unit; a travel possibility determination unit that, when it is determined by the rut determination unit that there is a rut, determines whether or not the host vehicle can overcome the rut based on the detection result of the periphery monitoring device, the target trajectory, and the detection result of the behavior detection unit; and a correction unit that corrects at least one of the target trajectory and the target route when the travel feasibility determination unit determines that the host vehicle cannot overcome the wheel track; Equipped with The correction unit corrects the target trajectory so that an intersection angle between the target trajectory and the wheel track becomes 90 degrees on a road constituting the target route. Vehicle control device.

3. The correction unit, when it is determined by the traveling feasibility determination unit that the vehicle cannot overcome the rut, preferentially executes a correction calculation of the target trajectory, and when a calculation result indicates that the vehicle cannot overcome the rut even after the correction of the target trajectory, corrects the target route.

3. A vehicle control device according to claim 1 or 2.

4. When the rut determination unit determines that the rut exists, the travel possibility determination unit calculates a height of the rut and an extension direction of the rut based on a detection result of the periphery monitoring device. The vehicle control device according to any one of claims 1 to 3.

5. The surroundings monitoring device is configured to include a lidar. The vehicle control device according to any one of claims 1 to 4.

6. the rut determination unit determines the presence or absence of the rut without the host vehicle coming into contact with the rut based on the detection result of the periphery monitoring device, and determines the presence or absence of contact between the host vehicle and the rut based on the detection result of the behavior detection unit. The vehicle control device according to any one of claims 1 to 5.

7. The steering device includes a steering motor that steers wheels, The behavior detection unit includes a current sensor that detects a current value of a control current supplied to the steering motor, the rut determination unit calculates a deviation from a reference value, which is a difference between a current reference value preset for the target steering angle and a detection result of the current sensor, and determines the presence or absence of the rut based on a comparison between the deviation from the reference value and a predetermined threshold value. The vehicle control device according to claim 6.

8. A steering device for steering the wheels; a route calculation unit that calculates a target route indicating roads along which the host vehicle will travel until the host vehicle reaches the destination based on map data, vehicle position information, and destination information; A surroundings monitoring device that monitors the surroundings of the host vehicle; a trajectory calculation unit that calculates a target trajectory of the host vehicle on roads that constitute the target route based on a detection result of the surroundings monitoring device in an autonomous driving mode; a steering angle calculation unit that calculates a target steering angle based on the target trajectory; a steering control unit that controls the steering device based on the target steering angle; A behavior detection unit that detects information regarding a behavior of the host vehicle; a rut determination unit that determines whether or not there is a rut on the target trajectory based on at least one of a detection result of the surroundings monitoring device and a detection result of the behavior detection unit; a travel possibility determination unit that, when it is determined by the rut determination unit that there is a rut, determines whether or not the host vehicle can overcome the rut based on the detection result of the periphery monitoring device, the target trajectory, and the detection result of the behavior detection unit; and a correction unit that corrects at least one of the target trajectory and the target route when the travel feasibility determination unit determines that the host vehicle cannot overcome the wheel track; Equipped with The rut determination unit determines the presence or absence of a rut without contact between the host vehicle and the rut based on a detection result of the periphery monitoring device, and determines the presence or absence of contact between the host vehicle and the rut based on a detection result of the behavior detection unit; The steering device includes a steering motor that steers wheels, The behavior detection unit includes a current sensor that detects a current value of a control current supplied to the steering motor, the rut determination unit calculates a deviation from a reference value, which is a difference between a current reference value preset for the target steering angle and a detection result of the current sensor, and determines the presence or absence of the rut based on a comparison between the deviation from the reference value and a predetermined threshold value. Vehicle control device.

Images