Driving assistance device, driving assistance method, and program

Abstract

To properly increase responsiveness in a necessary situation.SOLUTION: A driving support device acquires a steering state of a movable body, determines whether or not an amount of change in an avoidance track error representing a deviation quantity between a steering state and an avoidance track from the past to a reference point of time is more than a first threshold value which is a positive value, or less than a second threshold value which is a negative value, calculates an index value, if the amount of change in the avoidance track error is more than the first threshold value, or less than the second threshold value, by increasing the weight of the avoidance track error at the reference point of time, compares with the case where the amount of change in the avoidance track error is not more than the first threshold value, or equal to or more than the second threshold value, and guides a driver of the movable body or the movable body so as to change the steering state of the movable body in accordance with the index value.SELECTED DRAWING: Figure 1

Description

[Technical field]

[0001] The present invention relates to a driving assistance device, a driving assistance method, and a program. [Background technology]

[0002] 2. Description of the Related Art Conventionally, an invention for a device has been disclosed that detects an obstacle present in front of a vehicle and automatically steers the steering wheels to avoid a collision with the obstacle (Patent Document 1). [Prior art documents] [Patent documents]

[0003] [Patent Document 1] Patent Publication No. 2021-95021 Summary of the Invention [Problem to be solved by the invention]

[0004] Conventional techniques may not be able to improve responsiveness appropriately when needed.

[0005] The present invention has been made in consideration of the above circumstances, and one of its objects is to provide a driving assistance device, a driving assistance method, and a program that are capable of appropriately increasing responsiveness in necessary situations. [Means for solving the problem]

[0006] A driving assistance device, a driving assistance method, and a program according to the present invention employ the following configuration. (1): A driving assistance device according to one aspect of the present invention is a driving assistance device that assists driving of a moving body, the driving assistance device including a recognition unit that recognizes an object that is present at least in a traveling direction of the moving body and that the moving body should avoid contacting, an avoidance trajectory generation unit that generates a future avoidance trajectory along which the moving body can move while avoiding contact with the object, and a steering state of the moving body, the steering state of the moving body being acquired, and a determination is made as to whether or not an amount of change in an avoidance trajectory error, which represents an amount of deviation between the steering state and the avoidance trajectory, between a reference time point and a time point earlier than the reference time point, exceeds a first threshold value which is a positive value or is less than a second threshold value which is a negative value, and a determination is made as to whether or not the amount of change in the avoidance trajectory error does not exceed the first threshold value. or the second threshold value or more, calculates an index value by making a weight of the avoidance trajectory error at a time point earlier than the reference time point greater than a weight of the avoidance trajectory error at the reference time point, and calculates the index value by making a weight of the avoidance trajectory error at the reference time point greater than a weight of the avoidance trajectory error at a time point earlier than the reference time point, when an amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, and guides the driver of the moving body or the moving body so that a steering state of the moving body is changed in accordance with the index value.

[0007] (2): In the above aspect (1), the guidance control unit determines whether or not the amount of change exceeds a first threshold value, which is a positive value, or is less than a second threshold value, which is a negative value, for each of a plurality of periods between a plurality of past time points and a reference time point, obtains a statistical value of the avoidance trajectory error at the plurality of time points, and calculates the index value, and at that time, for a time point corresponding to a period in which the amount of change exceeds the first threshold value or is less than the second threshold value, replaces the avoidance trajectory error at that time point with the avoidance trajectory error at the reference time point to calculate the index value.

[0008] (3): In the above aspect (1), the guidance control unit calculates an amount of change in the avoidance trajectory error based on the avoidance trajectory error at the reference time point and a past value of the index value, and calculates the index value based on the past value of the index value and the amount of change in the avoidance trajectory error at the reference time point, and at this time, when the amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, the guidance control unit calculates the index value by increasing the weight of the avoidance trajectory error at the reference time point relative to the past value of the index value.

[0009] (4): In any of the above aspects (1) to (3), the avoidance trajectory error is a difference between a steering angle of the moving body and a target steering angle for moving along the avoidance trajectory.

[0010] (5): In any of the above aspects (1) to (3), the avoidance trajectory error is a value indicating the degree of lateral deviation between the avoidance trajectory and a trajectory that is predicted to be taken by the moving body, assuming that the steering state of the moving body continues.

[0011] (6): In the above aspect (5), the value indicating the degree of deviation is a value obtained by aggregating the amount of deviation between a plurality of lateral positions (positions in the width direction of the moving path) through which the moving body is predicted to pass, which correspond to a plurality of vertical positions in the longitudinal direction of the moving path, assuming that the steering state of the moving body continues, and a plurality of lateral positions on the avoidance trajectory corresponding to the plurality of vertical positions.

[0012] (7): In any of the above aspects (1) to (6), the guidance control unit guides the driver of the moving body to change the steering state of the moving body by outputting a voice from a speaker prompting the driver to change the steering state and / or displaying an image on a display device prompting the driver to change the steering state.

[0013] (8): In any of the above aspects (1) to (7), the guidance control unit guides the driver of the moving body or the moving body so as to change the steering state of the moving body by outputting a reaction force to an actuator attached to a steering operator that receives steering operation by the driver, the reaction force preventing operation in the same direction as the current steering state.

[0014] (9): In any of the above aspects (1) to (8), the guidance control unit guides the driver of the moving body or the moving body so as to change the steering state of the moving body by increasing the steering force of the steering device in a direction opposite to the current steering state.

[0015] (10): In a driving assistance method according to another aspect of the present invention, a driving assistance device that assists driving of a moving body acquires a steering state of the moving body, recognizes an object that is present at least in a traveling direction of the moving body and with which the moving body should avoid contact, acquires the steering state of the moving body, and determines whether or not a change in an avoidance trajectory error, which represents a deviation between the steering state and the avoidance trajectory between a reference time point and a time point earlier than the reference time point, exceeds a first threshold value that is a positive value or is less than a second threshold value that is a negative value, and determines whether or not a change in the avoidance trajectory error does not exceed the first threshold value or is equal to or greater than the second threshold value. In one case, an index value is calculated by making the weight of the avoidance trajectory error at a time point earlier than the reference time point larger than the weight of the avoidance trajectory error at the reference time point, and when an amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, the index value is calculated by making the weight of the avoidance trajectory error at the reference time point larger than the weight of the avoidance trajectory error at a time point earlier than the reference time point, and the driver of the moving body or the moving body is guided so that the steering state of the moving body is changed in accordance with the index value.

[0016] (11): A program according to another aspect of the present invention causes a processor of a driving assistance device that assists driving of a moving body to acquire a steering state of the moving body, recognize an object that is present at least in the traveling direction of the moving body and with which the moving body should avoid contact, acquire the steering state of the moving body, and determine whether or not a change in an avoidance trajectory error, which represents a deviation between the steering state and the avoidance trajectory, between a reference time point and a time point earlier than the reference time point exceeds a first threshold value that is a positive value or is less than a second threshold value that is a negative value, and determines whether or not the change in the avoidance trajectory error does not exceed the first threshold value or is less than the second threshold value. If it is equal to or greater than the reference time point, an index value is calculated by making the weight of the avoidance trajectory error at a time point earlier than the reference time point greater than the weight of the avoidance trajectory error at the reference time point, and if the amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, the index value is calculated by making the weight of the avoidance trajectory error at the reference time point greater than the weight of the avoidance trajectory error at a time point earlier than the reference time point, and the driver of the moving body or the moving body is guided so that the steering state of the moving body is changed in accordance with the index value. Effect of the Invention

[0017] According to aspects (1) to (11), responsiveness can be appropriately improved when necessary. [Brief description of the drawings]

[0018] [Figure 1] 1 is a configuration diagram mainly showing a driving assistance device 100 according to a first embodiment. [Diagram 2] FIG. 13 is a diagram showing an overview of the risks set by the transportation participant behavior prediction unit 120. [Diagram 3] 11 is a diagram for explaining the processing of the guidance control unit 160. FIG. [Figure 4] 11 is a graph showing an example of a change over time in an avoidance trajectory error Eθ and a guidance parameter Plead. [Diagram 5] 4 is a flowchart showing an example of a flow of processing executed by the driving assistance device 100. [Figure 6] FIG. 11 is a diagram for explaining an avoidance trajectory error Eθ(k) in the second embodiment. [Figure 7] 13 is a graph showing an example of a change over time in an avoidance trajectory error Eθ and a guidance parameter Plead# according to the third embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0019] Hereinafter, with reference to the drawings, an embodiment of the driving assistance device, the driving assistance method, and the program of the present invention will be described. The driving assistance device is a device that assists driving of a moving body. The "moving body" refers to a structure that can move by a driving mechanism provided therein, such as a vehicle, a micromobile, an autonomous mobile robot, a ship, or a drone. In the following description, it is assumed that the moving body is a vehicle that moves on the ground, and the configuration and function for moving the vehicle on the ground will be described. "Assisting driving" means, for example, mainly manual driving, giving advice on driving operation by voice, display, etc., and performing interference control to a certain extent. In addition, assisting driving may include moving the moving body autonomously at least temporarily.

[0020] First Embodiment FIG. 1 is a configuration diagram mainly showing a driving support device 100 according to the first embodiment. The driving support device 100 is mounted on a vehicle. In addition to the driving support device 100, this vehicle (hereinafter referred to as the subject vehicle M) is equipped with components such as a camera 10, a radar device 12, a LIDAR (Light Detection and Ranging) 14, an object recognition device 16, an HMI (Human Machine Interface) 30, a vehicle sensor 40, a driving operator 80, a driving force output device 200, a brake device 210, and a steering device 220. Note that the configuration shown in FIG. 1 is merely an example, and some of the components may be omitted, or other components may be added.

[0021] The camera 10 is, for example, a digital camera using a solid-state imaging element such as a CCD (Charge Coupled Device) or a CMOS (Complementary Metal Oxide Semiconductor). The camera 10 is attached to an arbitrary location of a vehicle (hereinafter, the vehicle M) in which the vehicle system 1 is mounted. When capturing an image of the front, the camera 10 is attached to the top of the front windshield, the back of the rearview mirror, or the like. The camera 10, for example, periodically and repeatedly captures images of the surroundings of the vehicle M. The camera 10 may be a stereo camera.

[0022] The radar device 12 emits radio waves such as millimeter waves around the vehicle M and detects radio waves reflected by an object (reflected waves) to detect at least the position (distance and direction) of the object. The radar device 12 is attached to an arbitrary location of the vehicle M. The radar device 12 may detect the position and speed of an object by an FM-CW (Frequency Modulated Continuous Wave) method.

[0023] The LIDAR 14 irradiates light (or electromagnetic waves with a wavelength close to that of light) around the vehicle M and measures the scattered light. The LIDAR 14 detects the distance to the target based on the time between light emission and light reception. The irradiated light is, for example, a pulsed laser light. The LIDAR 14 is attached to an arbitrary location of the vehicle M.

[0024] The object recognition device 16 performs sensor fusion processing on some or all of the detection results from the camera 10, the radar device 12, and the LIDAR 14 to recognize the position, type, speed, etc. of the object. The object recognition device 16 outputs the recognition result to the driving assistance device 100. The object recognition device 16 may output the detection results from the camera 10, the radar device 12, and the LIDAR 14 directly to the driving assistance device 100. The object recognition device 16 may be omitted from the vehicle system 1.

[0025] The HMI 30 presents various information to an occupant of the vehicle M and accepts input operations by the occupant. The HMI 30 includes various display devices, a speaker, a buzzer, a touch panel, switches, keys, and the like.

[0026] The vehicle sensor 40 includes a vehicle speed sensor that detects the speed of the host vehicle M, an acceleration sensor that detects acceleration, a yaw rate sensor that detects the angular velocity around a vertical axis, a direction sensor that detects the direction of the host vehicle M, and the like.

[0027] The driving operators 80 include, for example, an accelerator pedal, a brake pedal, a shift lever, a steering wheel, a special steering wheel, a joystick, and other operators. The driving operators 80 are fitted with sensors that detect the amount of operation or the presence or absence of operation, and the detection results are output to the driving support device 100, or some or all of the driving force output device 200, the brake device 210, and the steering device 220.

[0028] Prior to describing the driving support device 100, a driving force output device 200, a braking device 210, and a steering device 220 will be described.

[0029] The driving force output device 200 outputs a driving force (torque) for the vehicle to travel to the driving wheels. The driving force output device 200 includes, for example, a combination of an internal combustion engine, an electric motor, a transmission, and an ECU (Electronic Control Unit) that controls these. The ECU controls the above components according to information input from the driving operation device 80.

[0030] The brake device 210 includes, for example, a brake caliper, a cylinder that transmits hydraulic pressure to the brake caliper, an electric motor that generates hydraulic pressure in the cylinder, and a brake ECU. The brake ECU controls the electric motor according to information input from the driving support device 100 or information input from the driving operation element 80, so that a brake torque corresponding to a braking operation is output to each wheel. The brake device 210 may include, as a backup, a mechanism that transmits hydraulic pressure generated by operation of a brake pedal included in the driving operation element 80 to the cylinder via a master cylinder. Note that the brake device 210 is not limited to the configuration described above, and may be an electronically controlled hydraulic brake device that transmits hydraulic pressure of a master cylinder to the cylinder.

[0031] The steering device 220 includes, for example, a steering ECU, an electric motor, a steering angle sensor 222, and a reaction force motor 224. The electric motor changes the direction of the steered wheels by applying a force to, for example, a rack and pinion mechanism. The steering ECU drives the electric motor to change the direction of the steered wheels according to information input from the driving operator 80. The steering angle sensor 222 detects the state (e.g., the operation angle) of a steering operator such as a steering wheel, and outputs the state to the steering ECU and the driving support device 100. The reaction force motor 224 outputs a force (reaction force) to the steering wheel in a direction that hinders the operation by the occupant, according to an instruction input from the driving support device 100 or the like.

[0032] The driving assistance device 100 includes, for example, a recognition unit 110, a traffic participant behavior prediction unit 120, a trajectory prediction unit 130, an emergency stop control unit 140, an avoidance trajectory generation unit 150, and a guidance control unit 160. These components are realized by, for example, a hardware processor such as a CPU (Central Processing Unit) executing a program (software). In addition, some or all of these components may be realized by hardware (including circuitry) such as an LSI (Large Scale Integration), an ASIC (Application Specific Integrated Circuit), an FPGA (Field-Programmable Gate Array), or a GPU (Graphics Processing Unit), or may be realized by cooperation between software and hardware. The program may be stored in advance in a storage device (a storage device having a non-transient storage medium) such as the HDD or flash memory of the driving assistance device 100, or may be stored in a removable storage medium such as a DVD or CD-ROM, and installed in the HDD or flash memory of the driving assistance device 100 by inserting the storage medium (non-transient storage medium) into a drive device.

[0033] The recognition unit 110 recognizes the type, position, speed, acceleration, etc. of an object in the vicinity of the vehicle M based on information input from the camera 10, the radar device 12, and the LIDAR 14 via the object recognition device 16. The position of the object is recognized as a position on an absolute coordinate system with a representative point of the vehicle M (such as the center of gravity or the center of the drive shaft) as the origin, and is used for control. The position of the object may be represented by a representative point such as the center of gravity or a corner of the object, or may be represented by a represented area. The "state" of the object may include the acceleration or jerk of the object, or the "action state" (for example, whether or not the vehicle is changing lanes or is about to change lanes). In this way, the recognition unit 110 recognizes an object that is present at least in the traveling direction of the vehicle M and that the vehicle M should avoid contacting.

[0034] Furthermore, the recognition unit 110 recognizes, for example, the lane in which the host vehicle M is traveling (the driving lane). For example, the recognition unit 110 recognizes the position and attitude of the host vehicle M with respect to the driving lane. For example, the recognition unit 110 may recognize the deviation of the reference point of the host vehicle M from the center of the lane and the angle with respect to a line connecting the centers of the lanes in the traveling direction of the host vehicle M as the relative position and attitude of the host vehicle M with respect to the driving lane. Alternatively, the recognition unit 110 may recognize the position of the reference point of the host vehicle M with respect to either side end of the driving lane (a road dividing line or a road boundary) as the relative position of the host vehicle M with respect to the driving lane.

[0035] The traffic participant behavior prediction unit 120 predicts the future behavior of a subject (traffic participant) that exists on a driving lane or an adjacent lane adjacent to the driving lane and moves by itself among the objects recognized by the recognition unit 110. The traffic participants include other vehicles, pedestrians, bicycles, etc. For example, the traffic participant behavior prediction unit 120 may predict the future behavior of the traffic participant under the assumption of constant speed and constant acceleration based on the past movement history of the traffic participant, or may predict the future behavior of the traffic participant by a method such as a Kalman filter. In addition, the future behavior of the traffic participant may be predicted taking into account the direction of the traffic participant (the direction of the vehicle axis in the case of a vehicle, or the direction of the face in the case of a pedestrian). The future behavior means, for example, the position of the traffic participant at multiple points in time in the future.

[0036] Furthermore, the traffic participant behavior prediction unit 120 may set a risk, which is a reference value indicating the degree to which the vehicle M should not enter or approach, on an assumed plane S that represents the space around the vehicle M as a two-dimensional plane viewed from above, based on the predicted future behavior of traffic participants, etc. In other words, the risk indicates the probability of the presence of targets (including not only traffic participants but also areas where driving is not possible, such as road shoulders, guardrails, and areas outside white lines) (it does not have to be a "probability" in the strict sense). The higher the risk value, the more likely the vehicle M should not enter or approach, and the closer the value is to zero, the more favorable it is for the vehicle M to travel. However, this relationship may be reversed.

[0037] The traffic participant behavior prediction unit 120 also sets risks on the assumed plane S for each future point in time specified at regular time intervals, such as the current time t, Δt later (time t+Δt), 2Δt later (time t+2Δt), and so on.

[0038] FIG. 2 is a diagram showing an overview of the risk set by the traffic participant behavior prediction unit 120. The traffic participant behavior prediction unit 120 sets a risk for a traffic participant on an assumed plane S with an ellipse or circle based on the traveling direction and speed as contour lines, and sets a constant value of risk for a non-traveling area. In the figure, R(M1) is the risk of a stopped vehicle M1, and R(P) is the risk of a pedestrian P. Since the pedestrian P is moving in a direction crossing the road, a risk is set at a position different from the current time for each future time point. The same applies to moving vehicles, bicycles, etc. R(BD) is the risk of a non-traveling area BD. In the figure, the density of the hatching indicates the value of the risk, and the darker the hatching, the higher the risk. The traffic participant behavior prediction unit 120 may set the risk so that the value increases the further away from the center of the lane. Note that the traffic participant behavior prediction unit 120 may not set such a risk, but may simply predict the position of the traffic participant at multiple future times.

[0039] The trajectory prediction unit 130 inputs the speed VM of the host vehicle M detected by the vehicle speed sensor included in the vehicle sensor 40 and the steering angle θM of the host vehicle M detected by the steering angle sensor 222 of the steering device 220 into a vehicle body model (an arc model, a two-wheel model, etc.) and predicts the trajectory of the host vehicle M for a certain period of time in the future. Since various methods are known for the vehicle body model, detailed explanations are omitted. Note that the trajectory prediction unit 130 may be omitted in the first embodiment.

[0040] When the emergency stop control unit 140 determines that the position of the object recognized by the recognition unit 110 is on the trajectory of the host vehicle M predicted by the trajectory prediction unit 130 (when the trajectory prediction unit 130 is omitted, for example, this is interpreted as "within an area extending the vehicle width of the host vehicle M in the traveling direction") and that it is difficult to avoid contact by steering, the emergency stop control unit 140 instructs the brake device 210 to stop the host vehicle M. For example, when the position of the object recognized by the recognition unit 110 is on the trajectory of the host vehicle M predicted by the trajectory prediction unit 130 and the TTC (Time To Collision) with the object is equal to or less than a threshold, the emergency stop control unit 140 stops the host vehicle M. Note that when the emergency stop control unit 140 performs the above operation to stop the host vehicle M, the avoidance trajectory generation unit 150 and the guidance control unit 160 stop operating.

[0041] The avoidance trajectory generation unit 150 generates a future avoidance trajectory along which the host vehicle M can move while avoiding contact with the object recognized by the recognition unit 110. For example, the avoidance trajectory generation unit 150 generates an avoidance trajectory that passes through points with as low a risk as possible and minimizes the amount of turning at multiple points (trajectory points) on the avoidance trajectory.

[0042] 3 is a diagram for explaining the processing of the guidance control unit 160. In the figure, K is a trajectory predicted by the trajectory prediction unit 130, and K* is an avoidance trajectory generated by the avoidance trajectory generation unit 150. As shown in the figure, in order to go around the stopped vehicle M1 while avoiding a pedestrian P crossing from the right, it is preferable to move along the avoidance trajectory K*, but if the current steering angle θM is maintained, the vehicle will move along the trajectory K.

[0043] In such a situation, when the deviation between the avoidance trajectory K* and the steering state is large, the guidance control unit 160 guides the driver of the vehicle M or the steering state of the vehicle M so as to change the steering state. In the first embodiment, the steering state is the steering angle θM. More specifically, the guidance control unit 160 acquires the steering angle θM of the host vehicle M, and determines whether or not the change in the avoidance trajectory error, which represents the deviation between the steering angle θM and the avoidance trajectory K* between a reference time point and a time point earlier than the reference time point, exceeds a first threshold value which is a positive value or is less than a second threshold value which is a negative value. If the change in the avoidance trajectory error does not exceed the first threshold value or is equal to or greater than the second threshold value, the guidance control unit 160 calculates an index value by making the weight of the avoidance trajectory error at a time point earlier than the reference time point greater than the weight of the avoidance trajectory error at the reference time point, and if the change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, the guidance control unit 160 calculates an index value by making the weight of the avoidance trajectory error at the reference time point greater than the weight of the avoidance trajectory error at a time point earlier than the reference time point, and guides the driver to change the steering state of the host vehicle M according to the index value.

[0044] The absolute values ​​of the first threshold and the second threshold may be the same or different. In the following description, it is assumed that the first threshold=the absolute value of the second threshold=ε.

[0045] More specifically, the guidance control unit 160 according to the first and second embodiments determines whether or not the amount of change exceeds a first threshold value, which is a positive value, or is less than a second threshold value, which is a negative value, for each of a plurality of periods between a plurality of past time points and a reference time point, obtains statistics of the avoidance trajectory error at the plurality of time points, and calculates an index value. At this time, for a time point corresponding to a period in which the amount of change exceeds the first threshold value or is less than the second threshold value, the avoidance trajectory error at that time point is replaced with the avoidance trajectory error at the reference time point to calculate an index value.

[0046] Hereinafter, the avoidance trajectory error, which indicates the deviation between the steering angle θM and the avoidance trajectory K*, is represented as Eθ(k). Hereinafter, the symbols in parentheses indicate the control time. Also, the "index value" explained above is represented as the guidance parameter Plead(k).

[0047] The avoidance trajectory error Eθ(k) is, for example, the difference between the steering angle θM of the host vehicle M and the target steering angle θM* for moving along the avoidance trajectory K*. The target steering angle θM* is determined, for example, based on the angle between the current direction of the host vehicle M and the direction from the host vehicle M to a point a predetermined distance away on the avoidance trajectory K*, and the speed VM of the host vehicle M. The avoidance trajectory error Eθ(k) is the avoidance trajectory error at control time k, and the avoidance trajectory error Eθ(kj) is the avoidance trajectory error at control time kj.

[0048] The guidance control unit 160 calculates the guidance parameter Plead(k) based on, for example, equations (1) to (3). The guidance control unit 160 calculates Dθ(kj) and Mθ(kj) for each of j=1 to m.

[0049]

number

[0050]

number

[0051]

number

[0052] Dθ(kj) in formula (1) is the amount of change in the avoidance trajectory error Eθ from a past time point (kj) to a reference time point (k). Mθ(kj) (j=1 to m) in formula (2) is a calculation element whose total value (statistical value) is calculated in Plead(k) in formula (3). m is the number of filter taps. When Dθ(kj) is equal to or greater than -ε and equal to or less than ε, each of Mθ(kj) is replaced with Eθ(kj), that is, the avoidance trajectory error at a past time point, and when Dθ(kj) is less than -ε or exceeds ε, it is replaced with Eθ(k), that is, the avoidance trajectory error at a reference time point (k). Then, Mθ(kj) is summed up for j=1 to m, and further divided by (m+1) to calculate the induction parameter Plead(k).

[0053] As a result of this calculation, the guidance parameter Plead(k) is calculated by weighting the avoidance trajectory error at a time point prior to the reference time point greater than the weighting of the avoidance trajectory error at the reference time point when the amount of change in the avoidance trajectory error, which indicates the amount of deviation between the steering angle θM and the avoidance trajectory K* between the reference time point and a time point prior to the reference time point, does not exceed the first threshold value or is equal to or greater than the second threshold value, and is calculated by weighting the avoidance trajectory error at the reference time point greater than the weighting of the avoidance trajectory error at a time point prior to the reference time point when the amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value. As a result, when the absolute value of the avoidance trajectory error Eθ suddenly increases at a certain time point due to a sudden change in the surrounding situation of the vehicle M due to another traffic participant jumping out or an unexpected behavior, the guidance parameter Plead, which has been smoothed by calculating the moving average, quickly follows the avoidance trajectory error Eθ.

[0054] FIG. 4 is a graph showing an example of the change over time of the avoidance trajectory error Eθ and the guidance parameter Plead. In the figure, since the avoidance trajectory error Eθ is within the range of plus or minus ε with zero as the center until time t1, the guidance parameter Plead is determined based on the moving average value of the avoidance trajectory errors Eθ(k-1) to Eθ(km). When the avoidance trajectory error Eθ(k) suddenly changes from Eθ(k-1) at time t1, and Mθ(kj) based on each of the avoidance trajectory errors Eθ(k-1) to Eθ(km) deviates from the range of plus or minus ε with zero as the center, the guidance parameter Plead is calculated mainly based on the avoidance trajectory error Eθ(k). Note that since there is a high possibility that no particular traffic incident has occurred before the avoidance trajectory error Eθ(k) suddenly changes, the variation in the value of Eθ(k-1) to Eθ(km) is sufficiently small compared to the amount of change when Eθ(k) suddenly changes due to a traffic incident. Therefore, when the avoidance trajectory error Eθ(k) suddenly changes from Eθ(k-1), not only Dθ(k-1) but also Dθ(k-2) to Dθ(km) are highly likely to deviate from the range of plus or minus ε with zero as the center (in other words, ε is determined in this way). As a result, when the surrounding situation of the vehicle M suddenly changes due to other traffic participants jumping out or unexpected behavior, guidance corresponding to the change in the surrounding situation can be performed quickly. In addition, when Eθ(k) does not suddenly change from Eθ(k), the guidance parameter Plead is calculated based on the moving average of the avoidance trajectory errors Eθ(k-1) to Eθ(km), so that inconveniences such as malfunction, hunting, and excessive control can be suppressed.

[0055] The guidance control unit 160 uses the HMI 30 to output guidance information regarding the steering direction to the driver of the vehicle M according to the guidance parameter Plead, thereby guiding the driver's steering operation. For example, assuming that a positive guidance parameter Plead indicates that the steering angle θM deviates to the right from the avoidance trajectory K*, and a negative guidance parameter Plead indicates that the steering angle θM deviates to the left from the avoidance trajectory K*, the guidance control unit 160 causes the HMI 30 to output guidance information such as "Turn the steering wheel to the left" when the guidance parameter Plead is large, and "Turn the steering wheel to the right" when the guidance parameter Plead is small. The guidance control unit 160 may increase the degree of output of the guidance information as the absolute value of the guidance parameter Plead increases. "Increasing the degree of output" means, for example, increasing the volume, making the tone stronger, increasing the contrast of the display color, enlarging the display area, and the like. The guidance control unit 160 may cause the HMI 30 to output the guidance information only when the absolute value of the guidance parameter Plead is equal to or greater than a threshold value.

[0056] Instead of (or in addition to) having the HMI 30 output guidance information as described above, the guidance control unit 160 may instruct the steering device 220, for example, to make the reaction force against a steering operation to the right stronger than the reaction force against a steering operation to the left when the guidance parameter Plead is large, and to make the reaction force against a steering operation to the left stronger than the reaction force against a steering operation to the right when the guidance parameter Plead is small.

[0057] 5 is a flowchart showing an example of a flow of processing executed by the driving assistance device 100. First, the recognition unit 110 recognizes objects in the vicinity of the vehicle M (step S100), and the traffic participant behavior prediction unit 120 predicts future behavior of traffic participants (step S102).

[0058] Next, the emergency stop control unit 140 determines whether or not it is difficult to avoid contact with the object recognized in step S100 (step S104). If it is determined that it is difficult to avoid contact, the emergency stop control unit 140 instructs the brake device 210 to output a specified braking force and stop the host vehicle M (step S106).

[0059] If it is not determined in step S120 that contact avoidance is difficult, the avoidance trajectory generating unit 150 generates an avoidance trajectory K* (step S108).

[0060] Next, the guidance control unit 160 judges whether the change amount Dθ(kj) of the avoidance trajectory error Eθ falls within the range of plus or minus ε for each of the parameters j=1 to m (step S110), and if the change amount Dθ(k) falls within the range of plus or minus ε, Mθ(kj)=Eθ(kj) (step S112), and if the change amount Dθ(k) does not fall within the range of plus or minus ε, Mθ(kj)=Eθ(k) (step S114). Then, the guidance control unit 160 calculates a guidance parameter Plead(k) based on Mθ(kj) (step S116), and guides the driver of the host vehicle M or the steering state of the host vehicle M according to the guidance parameter Plead(k) (step S118).

[0061] According to the first embodiment described above, it is possible to appropriately improve responsiveness when necessary.

[0062] <Second embodiment> The second embodiment will be described below. In the first embodiment, the steering state is the steering angle θM, and the avoidance trajectory error Eθ(k) is the difference between the steering angle θM of the vehicle M and the target steering angle θM* for moving along the avoidance trajectory K*. In the second embodiment, the steering state is expressed as a plurality of lateral positions on the trajectory K predicted by the trajectory prediction unit 130, which correspond to a plurality of longitudinal positions in the longitudinal direction of the road (one example of a moving path) and are predicted to be passed by the vehicle M. The lateral position is, for example, a position in the width direction of the road, and is defined based on the center point or either the left or right end point of the lane. The avoidance trajectory error Eθ(k) in the second embodiment is a value indicating the degree of deviation between the trajectory K and the avoidance trajectory K* in terms of the lateral positions, and more specifically, is a value obtained by aggregating the amount of deviation when comparing a plurality of lateral positions on the trajectory K and a plurality of lateral positions on the avoidance trajectory K* that have the same longitudinal positions. Hereinafter, the difference will be mainly described.

[0063] FIG. 6 is a diagram for explaining the avoidance trajectory error Eθ(k) in the second embodiment. The guidance control unit 160 assumes a plurality of imaginary points eKq (q=1 to n) on the trajectory K at equal intervals (for each ΔX) with respect to the longitudinal direction X of the road, and assumes a plurality of imaginary points eK*q (q=1 to n) on the trajectory K* at equal intervals (for each ΔX) with respect to the longitudinal direction X of the road. Then, the distance Δe1 between the imaginary points eK1 and eK*1 to the distance Δen between the imaginary points eKn and eK*n are calculated, and the avoidance trajectory error Eθ(k) is calculated by dividing by n+1. The calculation method of the avoidance trajectory error Eθ(k) in the second embodiment is expressed by Equation (4). The avoidance trajectory error Eθ(k) in the second embodiment represents the deviation between the avoidance trajectory K* that has been suitably generated and the trajectory K when traveling as is, similar to the avoidance trajectory error Eθ(k) in the first embodiment, and therefore the same effect as in the first embodiment is expected.

[0064]

number

[0065] According to the second embodiment described above, similarly to the first embodiment, it is possible to appropriately improve responsiveness when necessary.

[0066] <Third embodiment> The third embodiment will be described below. In the third embodiment, the calculation method of the avoidance trajectory error Eθ(k) may be either the first embodiment or the second embodiment. The driving support device of the third embodiment calculates the induction parameter by a method different from the first or second embodiment. This will be described below. In the following, the amount of change in the third embodiment will be represented as Dθ#(k) and the induction parameter as Plead#(k), and values ​​with properties different from those in the first or second embodiment will be represented with "#".

[0067] The guidance control unit 160 according to the third embodiment calculates the change amount (intermediate variable) Dθ#(k) based on the avoidance trajectory error Eθ(k) at the reference time point (k) and the past value of the guidance parameter Plead# (for example, the previous value, guidance parameter Plead#(k-1)). Also, the guidance control unit 160 according to the third embodiment calculates the guidance parameter Plead#(k) based on the past value of the guidance parameter Plead# (for example, the previous value, guidance parameter Plead#(k-1)) and the change amount of the avoidance trajectory error Eθ(k) at the reference time point (k), and when the change amount Dθ#(k) of the avoidance trajectory error exceeds the first threshold value εp or is less than the second threshold value εn, which is a negative value, the guidance control unit 160 calculates the guidance parameter Plead#(k) by increasing the weight of the avoidance trajectory error Eθ(k) at the reference time point (k) relative to the past value of the guidance parameter Plead#.

[0068] The guidance control unit 160 calculates the guidance parameter Plead#(k) based on, for example, equations (5) to (7), where Kf(k) is a variable gain multiplied by the avoidance trajectory error Eθ(k), and Kf-ε is a setting value between 0 and 1 (filtering gain when the amount of change is small).

[0069]

number

[0070]

number

[0071]

number

[0072] By calculating the guidance parameter Plead#(k) in this manner, as in the first or second embodiment, when the surrounding conditions of the vehicle M suddenly change, the guidance parameter Plead#(k) quickly follows the avoidance trajectory error Eθ(k), making it possible to provide guidance that quickly responds to the change in the surrounding conditions.

[0073] Fig. 7 is a graph showing an example of the change over time of the avoidance trajectory error Eθ and the guidance parameter Plead#. The upper graph in Fig. 7 shows the change over time of the guidance parameter Plead# calculated by the method of the third embodiment, and the lower graph in Fig. 7 shows the change over time of the guidance parameter Plead# when Kf(k) is fixed at Kf-ε. As shown in the figure, immediately after time t2 when the avoidance trajectory error Eθ changes suddenly, the guidance parameter Plead# in the upper graph quickly follows the avoidance trajectory error Eθ, whereas the guidance parameter Plead# in the lower graph gently follows the avoidance trajectory error Eθ due to the action of a first-order lag.

[0074] According to the third embodiment described above, similarly to the first or second embodiment, it is possible to appropriately improve responsiveness in necessary situations.

[0075] <When applied to autonomous driving> In the above embodiments, the driving assistance based on manual driving has been described. The present invention can be similarly applied to automatic driving in which the driver does not basically perform driving operations. In that case, the "steering state" is the steering angle for traveling along the target trajectory generated by the main route generation unit of the automatic driving, or the lateral positions of multiple virtual points on the target trajectory. For these, the avoidance trajectory error Eθ(k) can be calculated by the method described in the first or second embodiment, and the subsequent processing can be performed. The guidance control unit 160 determines the correction steering amount based on the guidance parameter Plead(k), for example, and corrects the steering state of the host vehicle M based on the correction steering amount.

[0076] The above-described embodiment can be expressed as follows. A driving assistance device that assists driving of a moving object, A storage device storing a program; a hardware processor coupled to the storage device; The hardware processor executes the program stored in the storage device, Recognizing an object that the moving body should avoid contacting, which is present at least in a traveling direction of the moving body; generating a future avoidance trajectory along which the moving body can move while avoiding contact with the object; acquiring a steering state of the moving body, and determining whether or not an amount of change in an avoidance trajectory error, which represents an amount of deviation between the steering state and the avoidance trajectory, between a reference time point and a time point earlier than the reference time point exceeds a first threshold value which is a positive value or is less than a second threshold value which is a negative value; when the amount of change in the avoidance trajectory error does not exceed the first threshold value or is equal to or greater than the second threshold value, a weight of the avoidance trajectory error at a time point in the past than the reference time point is made larger to calculate an index value, and when the amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, a weight of the avoidance trajectory error at the reference time point is made larger to calculate the index value, guiding a driver of the moving body or the moving body so that a steering state of the moving body is changed in accordance with the index value; Driving assistance device.

[0077] The above describes the form for carrying out the present invention using an embodiment, but the present invention is not limited to such an embodiment, and various modifications and substitutions can be made within the scope that does not deviate from the gist of the present invention. [Explanation of symbols]

[0078] 100 Driving support device 110 Recognition part 120 Traffic Participant Behavior Prediction Department 130 Trajectory Prediction Section 140 Emergency stop control section 150 Avoidance trajectory generation section 160 Guidance control unit

Claims

1. A driving assistance device that assists driving of a moving object, a recognition unit that recognizes an object that the moving body should avoid contacting, the object being present at least in a traveling direction of the moving body; an avoidance trajectory generation unit that generates a future avoidance trajectory along which the moving body can move while avoiding contact with the object; acquiring a steering state of the moving body, and determining whether or not an amount of change in an avoidance trajectory error, which represents an amount of deviation between the steering state and the avoidance trajectory, between a reference time point and a time point earlier than the reference time point exceeds a first threshold value which is a positive value or is less than a second threshold value which is a negative value; when the amount of change in the avoidance trajectory error does not exceed the first threshold value or is equal to or greater than the second threshold value, a weight of the avoidance trajectory error at a time point earlier than the reference time point is made greater than a weight of the avoidance trajectory error at the reference time point to calculate an index value, and when the amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, a weight of the avoidance trajectory error at the reference time point is made greater than a weight of the avoidance trajectory error at a time point earlier than the reference time point to calculate the index value; a guidance control unit that guides a driver of the moving body or the moving body so that a steering state of the moving body is changed in accordance with the index value; A driving assistance device comprising:

2. The guidance control unit determines whether the amount of change exceeds a first threshold value, which is a positive value, or is less than a second threshold value, which is a negative value, for each of a plurality of periods from a plurality of past time points to a reference time point; obtaining a statistical value of the avoidance trajectory error at the plurality of time points to calculate the index value, and at that time, for a time point corresponding to a period in which the amount of change exceeds the first threshold value or is less than the second threshold value, the avoidance trajectory error at that time point is replaced with the avoidance trajectory error at the reference time point to calculate the index value; The driving assistance device according to claim 1.

3. the guidance control unit calculates an amount of change in the avoidance trajectory error based on the avoidance trajectory error at the reference time point and a past value of the index value, and calculates the index value based on the past value of the index value and the amount of change in the avoidance trajectory error at the reference time point, and when the amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, calculates the index value by increasing a weight of the avoidance trajectory error at the reference time point relative to the past value of the index value. The driving assistance device according to claim 1.

4. The avoidance trajectory error is a difference between a steering angle of the moving body and a target steering angle for moving along the avoidance trajectory. A driving assistance device according to any one of claims 1 to 3.

5. 4. The driving assistance device according to claim 1, wherein the avoidance trajectory error is a value indicating a degree of lateral deviation between a trajectory that the moving body is predicted to take, assuming that the steering state of the moving body continues, and the avoidance trajectory.

6. The value indicating the degree of deviation is a value obtained by aggregating the amount of deviation between a plurality of lateral positions (positions in the width direction of the moving path) which correspond to a plurality of vertical positions in the longitudinal direction of the moving path and through which the moving body is predicted to pass, and a plurality of lateral positions on the avoidance trajectory which correspond to the plurality of vertical positions, assuming that the steering state of the moving body continues. The driving assistance device according to claim 5.

7. The guidance control unit guides the driver of the moving body to change the steering state of the moving body by outputting a voice prompting the driver to change the steering state from a speaker and / or displaying an image prompting the driver to change the steering state on a display device. A driving assistance device according to any one of claims 1 to 6.

8. The guidance control unit outputs a reaction force to an actuator attached to a steering operator that receives a steering operation by a driver, the reaction force preventing an operation in the same direction as the current steering state, thereby guiding the driver of the moving body or the moving body so that the steering state of the moving body is changed. A driving assistance device according to any one of claims 1 to 7.

9. The guidance control unit guides the driver of the moving body or the moving body so as to change the steering state of the moving body by increasing a steering force in a direction opposite to a current steering state of the steering device. A driving assistance device according to any one of claims 1 to 8.

10. A driving assistance device that assists in driving a moving object, Acquire a steering state of the moving body, Recognizing an object that the moving body should avoid contacting, which is present at least in a traveling direction of the moving body; acquiring a steering state of the moving body, and determining whether or not an amount of change in an avoidance trajectory error, which represents an amount of deviation between the steering state and an avoidance trajectory that generates a future avoidance trajectory along which the moving body can move while avoiding contact with the object, between a reference time point and a time point earlier than the reference time point, exceeds a first threshold value which is a positive value or is less than a second threshold value which is a negative value; when the amount of change in the avoidance trajectory error does not exceed the first threshold value or is equal to or greater than the second threshold value, a weight of the avoidance trajectory error at a time point earlier than the reference time point is made greater than a weight of the avoidance trajectory error at the reference time point to calculate an index value, and when the amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, a weight of the avoidance trajectory error at the reference time point is made greater than a weight of the avoidance trajectory error at a time point earlier than the reference time point to calculate the index value; guiding a driver of the moving body or the moving body so that a steering state of the moving body is changed in accordance with the index value; Driving assistance methods.

11. A processor of a driving assistance device for assisting driving of a moving object, acquiring a steering state of the moving body; The moving object is detected as an object that the moving object should avoid contacting and that is present at least in a traveling direction of the moving object; acquiring a steering state of the moving body, and determining whether or not an amount of change in an avoidance trajectory error, which represents an amount of deviation between the steering state and an avoidance trajectory that generates a future avoidance trajectory along which the moving body can move while avoiding contact with the object, between a reference time point and a time point earlier than the reference time point exceeds a first threshold value which is a positive value or is less than a second threshold value which is a negative value; when the amount of change in the avoidance trajectory error does not exceed the first threshold value or is equal to or greater than the second threshold value, a weight of the avoidance trajectory error at a time point earlier than the reference time point is made greater than a weight of the avoidance trajectory error at the reference time point to calculate an index value, and when the amount of change in the avoidance trajectory error exceeds the first threshold value or is less than the second threshold value, a weight of the avoidance trajectory error at the reference time point is made greater than a weight of the avoidance trajectory error at a time point earlier than the reference time point to calculate the index value; guiding a driver of the moving body or the moving body so that a steering state of the moving body is changed in accordance with the index value; program.

Images