The present application relates to a vehicle control device and a vehicle control method.
There is an existing vehicle control device that maintains travel of a host vehicle inside a traffic lane, with a center of the traffic lane as a target travel path. The existing vehicle control device is such that there are cases in which a driver wishes to cause the host vehicle to travel in a position (an offset position) on either the left or the right of the traffic lane center in accordance with a travel status of the host vehicle. However, when the driver carries out a steering intervention during driver assistance, there is a problem in that steering torque is generated in a direction opposite to that intended by the driver, causing a steering burden on the driver to increase instead.
Because of this, a vehicle control device disclosed in, for example, Patent Literature 1 is such that when a condition relating to a state of a host vehicle or a state of a driver is satisfied after a steering intervention by the driver, an amount of offset from a traffic lane center in the same traffic lane is stored, and the host vehicle is caused to travel along a path shifted in a lateral direction with respect to the host vehicle, thereby forming countermeasure to the heretofore described problem.
Patent Literature 1: WO 2017/022474
The existing vehicle control device is such that the amount of lateral offset with respect to the center of the traffic lane is a lateral position deviation from the center of the traffic lane to a central position of the host vehicle. This means that when there is an angle error between an original path and the host vehicle, an operation of the host vehicle becomes unstable. In order to avoid this operational instability of the host vehicle, a condition for causing the offset amount to be reflected is set, but there is a problem in that a driving operation such that causes the condition to be fulfilled is needed, and functional convenience is lost.
Also, there is a need for the condition to be fulfilled for a certain time from the driver implementing a steering intervention to the offset amount being reflected in a driver assistance device, because of which there is a problem in that there remains a section wherein torque for driver assistance is generated in a direction opposite to that of the steering torque.
The present application discloses technology for resolving the heretofore described kinds of problem, and has an object of providing a vehicle control device and a vehicle control method such that comfort when riding in a vehicle is increased.
A vehicle control device disclosed in the present application is characterized by including a road information input unit that detects relative positions of a host vehicle and a road, a target travel path calculating unit that calculates a target travel path for causing the host vehicle to travel along the road, a driver intervention detecting unit that detects a driver steering intervention in a steering of the host vehicle, a corrected target travel path calculating unit that, when the driver steering intervention is detected in the steering of the host vehicle as a result of a detection by the driver intervention detecting unit, calculates an offset amount with respect to the target travel path based on a state of the host vehicle, and calculates a corrected target travel path in which the offset amount is reflected, and a target steering angle calculating unit that calculates a target steering angle in order to cause the host vehicle to travel in accordance with the corrected target travel path, wherein the corrected target travel path calculating unit calculates the offset amount based on a lateral position deviation from the target travel path at a forward point-of-gaze of the host vehicle at a time of a driver steering state.
The vehicle control device disclosed in the present application is such that, according to the configuration, a lateral position deviation with respect to a target travel path at a forward point-of-gaze of a host vehicle is used as an offset amount, because of which the offset amount can be calculated even in a state wherein an angle deviation remains, and a smoother state transition can be carried out.
Hereafter, preferred embodiments of a vehicle control device and a vehicle control method according to the present application will be described, using the drawings.
In
The vehicle position and direction detecting unit 10 detects a coordinate position and a direction of a host vehicle by utilizing position fixing information from a man-made satellite. At least a target point sequence of a traffic lane center is included in the road map data 20. Also, a steering torque sensor, a vehicle speed sensor, and a yaw rate sensor are included in the vehicle sensor 30. The target travel path calculating unit 40 calculates a target travel path Path_map(t) of the host vehicle based on information from the vehicle position and direction detecting unit 10 and the road map data 20. The target travel path calculating unit 40, for example, calculates an approximated curve based on a target point sequence on a map in a host vehicle reference coordinate system, and outputs a coefficient of each of a lateral position deviation with respect to the approximated curve, an angle deviation, a road curvature, and a curvature change amount as a calculation result.
The driver intervention detecting unit 50 determines whether a preference of a driver is requesting an automatic driving state or requesting a driver steering state. For example, when using a value of a steering torque sensor installed in a vehicle, the driver intervention detecting unit 50 can detect a torque applied to a steering wheel by the driver guiding the steering wheel, because of which the driver intervention detecting unit 50 can detect whether or not the driver wishes to continue an automatic driving state. Also, when using a lateral position deviation yld(t) from the target travel path Path_map(t) at a host vehicle forward point-of-gaze calculated by the offset amount calculating unit 60, to be described hereafter, the driver intervention detecting unit 50 can identify an action by the driver of moving outside the traffic lane using the lateral position deviation yld(t).
The offset amount calculating unit 60 calculates an offset amount with respect to the target travel path Path_map(t) at a time of driver steering intervention based on information from the target travel path calculating unit 40, the driver intervention detecting unit 50, and the vehicle sensor 30, and outputs information relating to a corrected target travel path Path_collect(t) that takes the calculated offset amount into consideration. Also, the offset amount calculating unit 60 outputs the lateral position deviation yld(t) from the target travel path Path_map(t) at the host vehicle forward point-of-gaze to the driver intervention detecting unit 50.
The target steering angle calculating unit 70 calculates a target steering angle Target_steer_angle(t) for the host vehicle to follow a travel path based on information from the offset amount calculating unit 60 and the vehicle sensor 30. Also, the steering unit 80 carries out a steering control based on information from the target steering angle calculating unit 70 and the driver intervention detecting unit 50.
The vehicle control device 110 according to the first embodiment is configured as heretofore described, and when a driver steering intervention is detected by the driver intervention detecting unit 50, steering assistance control that assists driver steering is executed, a driver steering amount decreases, there is a shift to an automatic driving state when a state of non-intervention is identified by the driver intervention detecting unit 50, and a steering angle tracking control such that an actual steering angle tracks the target steering angle Target_steer_angle(t) output by the target steering angle calculating unit 70 is implemented.
Next, an overall operation of the vehicle control device 110 will be described, using a flowchart of
Firstly, the kind of target travel path Path_map(t) that passes through a target point sequence (basically disposed in the center of each traffic lane) of the traffic lane in which the host vehicle is currently traveling is calculated by the target travel path calculating unit 40 as an approximate expression in the host vehicle reference coordinate system (step S10).
Next, the corrected target travel path Path_collect (t), which includes information relating to a time of driver steering intervention, is calculated by the offset amount calculating unit 60 (step S20).
Next, the target steering angle Target_steer_angle(t) such that the host vehicle follows the corrected target travel path Path_collect(t) is calculated by the target steering angle calculating unit 70 (step S30).
Subsequently, steering is controlled by the steering unit 80 (step S40).
Next, an operation of the offset amount calculating unit 60 that accords with a presence or absence of a driver steering intervention will be described, using a flowchart of
Firstly, it is determined by the driver intervention detecting unit 50 whether or not there is a driver steering intervention (step S21).
When a driver steering intervention is detected in step S21, the host vehicle forward point-of-gaze and the lateral position deviation yld(t) with respect to the original target travel path Path_map(t) that passes through the map point sequence are calculated (step S22).
Subsequently, an offset amount yl0_offset(t) for calculating the corrected target travel path Path_collect (t) is adopted as the lateral position deviation yld(t) from the target travel path Path_map(t) at the host vehicle forward point-of-gaze, whereby the offset amount yl0_offset(t) is updated (step S23).
Also, when no driver steering intervention is detected in step S21 (a state wherein automatic driving by the system is continuing), or when a state of steering intervention by the driver is interrupted, that is, shift from a manual driving state to an automatic driving state by the driver's will is detected, a value of the offset amount to date is maintained (step S24).
Further, the corrected target travel path Path_collect (t) is calculated based on the offset amount calculated in step S23 or step S24 and a path passing through a map point sequence calculated by the target travel path calculating unit 40 (step S25), and the target steering angle Target_steer_angle(t) is calculated using the target steering angle calculating unit 70 (step S30 of
Next, an operation of the steering unit 80 that accords with the presence or absence of a driver steering intervention will be described, using a flowchart of
Firstly, it is determined by the driver intervention detecting unit 50 whether or not there is a driver steering intervention (step S41). When a driver steering intervention is detected in step S41, steering assistance control that adds assistance torque to steering torque of the driver is implemented, as in the case of an operation of existing electric power steering (EPS) (step S42). Also, when no driver steering invention is detected in step S41, the target steering angle Target_steer_angle(t) for following the target travel path Path_map(t) is input from the target steering angle calculating unit 70, and a steering angle tracking control that causes an actual steering angle to track the target steering angle Target_steer_angle(t) is implemented (step S43).
In
Next, when time t=t1, a driver steering intervention is detected by the driver intervention detecting unit 50. Subsequently, while t1<time t≤t2, the driver steering intervention is continued. At this time, the lateral position deviation yld(t) from the target travel path Path_map(t) at a host vehicle forward point-of-gaze Ld(t) is calculated using the following Expression 1 in step S22 of
In this embodiment, the lateral position deviation yld(t) from the original target travel path Path_map(t) at the host vehicle forward point-of-gaze Ld(t) is calculated, as shown in the following Expression 1, reflected in the offset amount yl0_offset(t), and adopted as an offset amount with respect to the original target travel path Path_map (t). In Expression 1, yl0(t) indicates a lateral position deviation between a host vehicle position and the target travel path Path_map(t), and el0(t) indicates an angle deviation from the target travel path Path_map(t) at a host vehicle forward point-of-gaze.
yl0_offset(t)=yl0(t)+el0(t)×Ld(t) (1)
Next, when t>t2, the manual driving state has been switched to the automatic driving state again by the driver intervention detecting unit 50. Herein, an offset amount yl0_offset(t2) when L=t2 is maintained using step S24 of
In
Also, in order to avoid the situation of
Path_map(t)=dC(t)×X3+1/{2×W_curv_map(t)}×X2+el0(t)×X+yl0(t) (2)
Path_collect(t)=dC(t)×X3+1/[2×{W_curv_map(t)+yl0_offset(t)}]×X2+el0(t)×X+{yl0(t)−yl0_offset(t)} (3)
As shown in Expression 3, the offset amount yl0_offset(t) is not only an intercept of Expression 2 (a zero-order term), but is also taken into consideration as an offset amount in a second-order term.
When the steering torque value str_trq is equal to or less than the threshold trq_sat in step S51, the driver intervention detecting unit 50 determines whether or not a magnitude of the lateral position deviation yld(t) from the original target travel path Path_map(t) at the host vehicle forward point-of-gaze Ld(t) is greater than a threshold yld_sat (step S52).
When a result of the determination in step 552 is that the lateral position deviation yld(t) is equal co or less than the threshold yld_sat, it is determined that there is no driver steering intervention. Also, when the threshold is exceeded in step S51 or step S52, it is determined that there is a state wherein a driver steering intervention is being detected.
In this way, the vehicle control device 110 according to the first embodiment continuously calculates an offset amount and the corrected target travel path Path_collect (t) from a driver steering intervention being detected and a switch being made from automatic driving to manual driving until a switch is made back to automatic driving, and when switching to automatic driving, the vehicle control device 110 applies a final value during manual driving of the continuously calculated offset value to the subsequent automatic driving, and uses the lateral position deviation yld(t) from the target travel path Path_map(t) at a host vehicle forward point-of-gaze as the offset amount, because of which the vehicle control device 110 can calculate the offset amount even in a state wherein the angle deviation el0(t) remains. This means that not only can a smoother state transition be carried out, but also a utilization range or a utilization condition of the relevant function is relaxed, because of which the convenience of the automatic driving function can be increased.
Also, the vehicle control device 110 according to the first embodiment, is such that when causing driver assistance to be ended using driver steering intervention, the offset amount is reflected even when the driver causes an operation amount to decrease before a condition is fulfilled, and a generation of a control torque such that the vehicle travels in a traffic lane center can be prevented.
Next, a vehicle control device according to a second embodiment will be described. A configuration of the vehicle control device according to the second embodiment is the same as that of the first embodiment shown in
In a flowchart of
When a driver steering intervention is detected in step S21a, the lateral position deviation yld(t) from the original target travel path Path_map(t) that passes through the map point sequence at the host vehicle forward point-of-gaze is calculated (step S22a).
Subsequently, the offset amount yl0_offset(t) for calculating the corrected target travel path Path_collect (t) based on the lateral position deviation yld(t) is calculated and updated (step S23a).
Also, when no driver steering intervention is detected in step S21a (a state wherein automatic driving by the system is continuing), or when a state of steering intervention by the driver is interrupted, that is, a shift from a manual driving state to an automatic driving state by the driver's will is detected, a value of the offset amount to date is maintained (step S24a).
Further, the corrected target travel path Path_collect (t) is calculated based on the offset amount calculated in step S23a or step S24a and a path passing through a map point sequence calculated by the target travel path calculating unit 40 (step S25a), and the target steering angle Target_steer_angle(t) is calculated using the target steering angle calculating unit 70 (step S30 of
In
Next, when time t=t1, a driver steering intervention is detected by the driver intervention detecting unit 50. Subsequently, while t1<time t≤t2, the driver steering intervention is continued. At this time, the lateral position deviation yld(t) from the target travel path Path_map(t) at the host vehicle forward point-of-gaze Ld(t) is calculated using the following Expression 4 in step S22a of
In this embodiment, the offset amount yl0_offset(t) is calculated based on the lateral position deviation yld(t) from the target travel path Path_map(t) at the host vehicle forward point-of-gaze Ld(t) as shown in the following Expression 4, and adopted as an offset amount with respect to the original target travel path Path_map(t).
yl0_offset(t)=yl0(t)+el0(t)×Ld(t) (4)
Next, when time t>t2, the manual driving has been switched to the automatic driving state again by the driver intervention detecting unit 50. Herein, the offset amount yl0_offset (t2) that is a final value of an average value of the lateral position deviation yld(t) during the driver steering intervention is maintained using step S24a of
When comparing with an operation in a case of applying Patent Literature 1 of
In the second embodiment too, in the same way as in the first embodiment, the target steering angle Target_steer_angle(t) is calculated by the target steering angle calculating unit 70. In the target travel path calculating unit 40, the target travel path Path_map(t), which is a path for traveling over a map point sequence, is expressed in the following Expression 5 based on information relating to the vehicle position and direction detecting unit 10 and the road map data 20. Also, the offset amount yl0_offset(t) calculated when moving in a traffic lane owing to a driver steering intervention is output by the offset amount calculating unit 60. Herein, a corrected target travel path wherein the offset amount yl0_offset(t) is reflected in the lateral position deviation yl0(t) from the host vehicle position and the path curvature radius W_curv_map(t) becomes the Path_collect(t) with respect to the target travel path Path_map(t), and is expressed in the following Expression 6. Note that dc(t) is a path curvature change, and X is a travel direction distance.
Path_map(t)=dC(t)×X3+1/{2×W_curv_map(t)}×X2+el0(t)×X+yl0(t) (5)
Path_collect(t)=dC(t)×X3+1/[2×{W_curv_map(t)+yl0_offset(t)}]×X 2+el0(t)×X+(yl0(t)−yl0_offset (t)) (6)
In this way, the vehicle control device 110 according to the second embodiment uses the lateral position deviation yld(t) from the target travel path Path_map(t) at a host vehicle forward point-of-gaze as the offset amount, because of which the vehicle control device 110 can calculate the offset amount even in a state wherein the angle deviation el0(t) remains, whereby a smoother state transition can be carried out.
Also, in the second embodiment, the offset amount yl0_offset(t) is calculated as an average value of the lateral position deviation yld(t) from a target travel path at a forward point-of-gaze during a steering intervention, but not being limited to this method, an offset amount more in line with a preference of the driver can be calculated by adopting a method that uses a final value when switching, or a method that calculates an average value within a range to which a condition is attached.
Next, a vehicle control device according to a third embodiment will be described. A configuration of the vehicle control device according to the third embodiment is the same as that of the first embodiment shown in
In a flowchart of
When a driver steering intervention is detected in step S21b, an offset amount yl0_offset(t) is calculated based on the lateral position deviation yl0(t) between the host vehicle position and the original target travel path Path_map(t) that passes through the map point sequence, or the angle deviation el0(t) (step S22b).
Subsequently, the offset amount yl0_offset(t) is updated by adopting the offset amount yl0_offset(t) calculated in step S22b as the offset amount yl0_offset(t) for calculating a corrected target travel path (step S23b).
Also, when no driver steering intervention is detected in step S21b (a state wherein automatic driving by the system is continuing), or when a state of steering intervention by the driver is interrupted, that is, a shift from a manual driving state to an automatic driving state by the driver's will is detected, a value of the offset amount to date is maintained (step S24b).
Further, the corrected target travel path Path_collect (t) is calculated based on the offset amount calculated in step S23b or step S24b and a path passing through a map point sequence calculated by the target travel path calculating unit 40 (step S25b), and the target steering angle Target_steer_angle(t) is calculated using the target steering angle calculating unit 70 (step S30 of
In
Next, when time t=t1, a driver steering intervention is detected by the driver intervention detecting unit 50. Subsequently, while t1<time t≤t2, the driver steering intervention is continued. At this time, the offset amount y_offset(t) is calculated based on the lateral position deviation yl0(t) between the original target travel path Path_map(t) passing through the map point sequence and the host vehicle position, or the angle deviation el0(t), in step S22b of
Next, when time t>t2, the manual driving state has been switched to the automatic driving state again by the driver intervention detecting unit 50. Herein, the offset amount yl0_offset (t2) when time t=t2 is maintained using step S24b of
The existing method is such that as a period during which it is determined whether or not an offset amount is to be reflected is provided when t2<time 2≤t3, control torque such that the host vehicle 120 follows the original target travel path Path_map(t) is generated from a control device during the period, because of which a driver needs cc cause torque to be generated in a direction opposing the control torque, and a feeling of discomfort occurs. Also, when the driver stops a steering intervention before the offset reflection determination period, the host vehicle 120 starts moving in such a way as to return to the original target travel path Path_map(t) (interference with the driver).
Meanwhile, the vehicle control device according to the third embodiment is such that no time restriction for causing an offset amount to be reflected is provided, and an offset amount at a point at which steering intervention is stopped is reflected, because of which the existing interference can be restricted.
In this way, in the third embodiment too, in the same way as in the first embodiment, the target steering angle Target_steer_angle(t) is calculated by the target steering angle calculating unit 70. In the target travel path calculating unit 40, the target travel path Path_map(t), which is a path for traveling over a map point sequence, is expressed in the following Expression 7 based on information relating to the vehicle position and direction detecting unit 10 and the road map data 20. Also, the offset amount yl0_offset(t) calculated when moving in a traffic lane owing to a driver steering intervention is output by the offset amount calculating unit 60. Herein, a corrected target travel path wherein the offset amount yl0_offset(t) is reflected in the lateral position deviation yl0(t) from the host vehicle position and the path curvature radius W_curv_map(t) becomes the Path_collect(t) with respect to the target travel path Path_map(t), and is expressed in the following Expression 8. Note that dc(t) is a path curvature change, and X is a travel direction distance.
Math. 5
Path_map(t)=dC(t)×X3+1/{2×W_curv_map(t)}×X2+el0(t)×X+yl0(t) (7)
Path_collect(t)=dC(t)×X3+1/[2×{W_curv_map(t)+yl0_offset(t)}]×X 2+el0(t)×X+{yl0(t)−yl0_offset(t)} (8)
In this way, the vehicle control device according to the third embodiment continuously calculates an offset amount and a corrected target travel path from a driver steering intervention being detected and a switch being made from automatic driving to manual driving until a switch is made back to automatic driving, and when switching to automatic driving, the vehicle control device applies a final value during manual driving of the continuously calculated offset value to the subsequent automatic driving, whereby a utilization range or a utilization condition of the relevant function is relaxed, because of which the convenience of the automatic driving function can be increased.
Also, in the third embodiment, the lateral position deviation yl0(t) between the original target travel path Path_map(t) and the host vehicle 120 is calculated as the offset amount yl0_offset(t) when calculating the offset amount yl0_offset(t), but not being limited to this method, an offset amount more in line with a preference of the driver can be calculated by calculating taking the angle deviation. el0(t) of the host vehicle 120 into consideration too.
Heretofore, a vehicle control device and a vehicle control method according to first to third embodiments of the present application have been described, but the target travel path calculating unit 40, the driver intervention detecting unit 50, the offset amount calculating unit 60, the target steering angle calculating unit 70, and the steering unit 80 configuring the computation control unit 100 included in the vehicle control device 110 described in each embodiment are configured of a processor 130 and a storage device 131, as shown by a hardware example of
Although the present application is described above in terms of various exemplifying embodiments and implementations, it should be understood that the various features, aspects, and functions described in one or more of the individual embodiments are not limited in their applicability to the particular embodiment with which they are described, but instead can be applied, alone or in various combinations, to one or more other embodiments.
It is therefore understood that numerous modifications that have not been exemplified can be devised without departing from the scope of the present application. For example, at least one constituent component may be modified, added, or eliminated. Furthermore, at least one of the constituent components mentioned in at least one of the preferred embodiments may be selected and combined with the constituent components mentioned in another preferred embodiment.
10 vehicle position and direction detecting unit, 20 road map data, 30 vehicle sensor, 40 target travel path calculating unit, 50 driver intervention detecting unit, 60 offset amount calculating unit, 70 target steering angle calculating unit, 80 steering unit, 90 road information input unit, 100 computation control unit, 110 vehicle control device, 120 host vehicle, 130 processor, 131 storage device.
Number | Date | Country | Kind |
---|---|---|---|
2019-019315 | Feb 2019 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2019/012340 | 3/25/2019 | WO | 00 |