Vehicle control device
Patent Information
- Application Number
- PCT/JP2023/018952
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-22
- Publication Date
- 2024-11-28
Smart Images

Figure JP2023018952_28112024_PF_FP_ABST
Abstract
Description
Vehicle control device
[0001] The present invention relates to a vehicle control device.
[0002] Collision damage mitigation systems are becoming widely used in automobile vehicle control systems. These systems use external recognition sensors, such as cameras and millimeter-wave radar, mounted on the vehicle to detect obstacles ahead, and automatically apply the brakes when there is a risk of collision, thereby avoiding collisions and mitigating the damage caused by the collision.
[0003] In recent years, the scope of application of collision damage mitigation systems has been expanding to include not only collision avoidance when driving straight, but also when the vehicle is turning, such as when turning at an intersection.
[0004] For a collision damage mitigation system to operate correctly, it is necessary to accurately grasp information such as the position and speed of targets around the vehicle. When grasping speed information of targets around the vehicle using an external recognition sensor mounted on the vehicle, the relative position change between the vehicle and the target due to the movement or rotation of the vehicle and the relative position change due to the movement of the target itself are detected in combination.
[0005] However, since the characteristics of the vehicle's motion and the target's motion are different, the error characteristics that occur in each are also different, so in order for the collision damage reduction system to operate correctly, it is desirable to handle each separately.
[0006] To separate the ground speed information of the target from the information obtained from the external recognition sensor, it is necessary to remove at least the peripheral velocity component associated with the rotational motion of the vehicle. A yaw rate sensor is generally used to obtain the rotational motion of the vehicle, but because the detection principle differs from that of the external recognition sensor, the detection phase is easily shifted, and errors in the ground speed of the target are likely to occur in environments where the rotational speed of the vehicle is prone to change, such as when turning around or reversing at an S-shaped intersection or intersection.
[0007] Therefore, when the vehicle is turning, the target speed accuracy is likely to decrease compared to when the vehicle is traveling straight, and this decrease in speed accuracy is likely to cause undesirable system operation, such as an unnecessary operation that mistakenly determines a collision with a pedestrian when in fact there will be no collision.
[0008] Therefore, a collision damage mitigation system for a vehicle turning needs to take measures to prevent unnecessary activation.
[0009] Patent Document 1 describes a method for highly accurately determining the target ground speed while the vehicle is turning by subtracting the target's relative speed from the sum of the relative speed obtained from a sensor and the vehicle's speed.
[0010] WO2022 / 113472
[0011] The technology described in Patent Document 1 calculates the target ground speed by removing a speed component generated by a deviation between the mounting position of an external environment recognition sensor and the position of the vehicle rotation center for an external environment recognition sensor mounted at an arbitrary location, and does not aim to reduce sensor errors including phase shifts of each sensor.
[0012] Therefore, it does not prevent unnecessary activation of the collision damage mitigation system due to sensor errors while the vehicle is turning.
[0013] An object of the present invention is to realize a vehicle control device that can suppress unnecessary operation of a collision damage mitigation system due to a decrease in detection accuracy of target information while the host vehicle is turning.
[0014] In order to achieve the above object, the present invention is configured as follows.
[0015] The vehicle control device includes a rotational speed acquisition unit that acquires the rotational speed of the vehicle, a vehicle speed acquisition unit that acquires the speed of the vehicle, a target position acquisition unit that acquires the position of a target recognized by an external environment recognition unit mounted on the vehicle, a target ground speed calculation unit that acquires the ground speed of the target recognized by the external environment recognition unit, a reference target ground speed error calculation unit that acquires the ground speed error of a reference target that is used as a reference outside the vehicle, a driving assistance function calculation unit that determines the execution content of a driving assistance function related to the safety of the vehicle with respect to a moving object recognized by the external environment recognition unit using the ground speed error of the reference target, and an output unit that outputs a control command to a driving assistance function execution unit of the vehicle based on the execution content determined by the driving assistance function calculation unit.
[0016] According to the present invention, it is possible to realize a vehicle control device that can suppress unnecessary operation of a collision damage mitigation system due to a decrease in detection accuracy of target information while the host vehicle is turning.
[0017] Problems, configurations, and effects of the present invention other than those described above will become apparent from the following description of the embodiments.
[0018] FIG. 1 is an explanatory diagram showing an example of the configuration of a vehicle control device according to a first embodiment of the present invention. FIG. 2 is an explanatory diagram of a vehicle coordinate system and an explanatory diagram of the contents of calculation performed in a target ground speed calculation unit according to the first embodiment of the present invention. FIG. 3 is a flowchart showing the processing flow of a reference object ground speed error calculation unit according to the first embodiment of the present invention. FIG. 4 is a flowchart showing the processing flow of a driving support function calculation unit according to the first embodiment of the present invention. FIG. 5 is a diagram showing an example of a correction map for an alarm gain according to the first embodiment of the present invention. FIG. 6 is a diagram showing an example of a correction map for a collision avoidance brake gain according to the first embodiment of the present invention. FIG. 7 is an overhead view showing an example of an assumed scene for explaining the first embodiment of the present invention. FIG. 8 is an explanatory diagram showing an example of the configuration of a vehicle control device according to a second embodiment of the present invention. FIG. 9 is an explanatory diagram of a GPS coordinate system according to the second embodiment of the present invention. FIG. 10 is a flowchart showing the processing flow of a reference object ground speed error calculation unit according to the second embodiment of the present invention. FIG. 11 is an overhead view showing an example of an assumed scene for explaining the second embodiment of the present invention. FIG. 12 is an explanatory diagram showing an example of the configuration of a vehicle control device according to a third embodiment of the present invention. FIG. 13 is a flowchart showing the processing flow of a reference object ground speed error calculation unit 3 according to the third embodiment of the present invention. FIG. 14 is an overhead view showing an example of an assumed scene for explaining the third embodiment of the present invention. FIG. 15 is an explanatory diagram showing an example of the configuration of a vehicle control device according to a fourth embodiment of the present invention. FIG. 10 is a flowchart showing a processing flow of a reference object ground speed error calculation unit 4 in a fourth embodiment of the present invention; FIG. 11 is an overhead view showing an example of an assumed scene for explaining a fourth embodiment of the present invention;
[0019] Hereinafter, an embodiment of the present invention will be described with reference to the drawings.
[0020] The vehicle control device of the present invention is a vehicle control device that detects targets around the vehicle and controls the vehicle, and when a camera, which is an external environment recognition sensor, detects an object that matches the shape that has been learned in advance as a stationary object, it makes use of the fact that the true value of the ground speed of the stationary object is zero, and if the ground speed of the stationary object calculated by the external environment recognition sensor is high, it determines that the accuracy of ground speed detection has decreased due to some factor such as a sensor error, and adjusts the timing of execution of collision avoidance control such as automatic brake control that automatically applies braking force to the vehicle and warnings.
[0021] In the present invention, if the external environment recognition sensor can simultaneously detect a target to be controlled, such as a pedestrian, and a stationary object, such as a road sign, the ground speed information of the stationary object is calculated, and the detection accuracy of the external environment recognition sensor is evaluated according to the magnitude of the ground speed of the stationary object.If the detection accuracy is low, corrections such as delaying the operation of the collision damage mitigation system are made, thereby suppressing unnecessary operation of the collision damage mitigation system.
[0022] A collision mitigation system refers to, for example, sounding an alarm, applying automatic brakes, turning on lights, and automatically steering.
[0023] First Embodiment First, a first embodiment of the present invention will be described with reference to FIGS.
[0024] 1 is a diagram illustrating an example of the configuration of a vehicle control device 100 according to a first embodiment of the present invention. The vehicle control device 100 is a device for executing a collision damage mitigation system that detects targets around the host vehicle and controls the host vehicle.
[0025] 1 , the vehicle control device 100 includes an image processing unit 110. The image processing unit 110 includes a target position acquisition unit 1101 that calculates position information of a target from image information obtained from a camera (external environment recognition unit) 101, which is an external environment recognition sensor, rotational speed information of the host vehicle obtained from a yaw rate sensor (rotational speed acquisition unit that acquires the rotational speed of the vehicle) 102, and host vehicle speed information obtained from a vehicle speed sensor (vehicle speed acquisition unit) 104, a target relative speed acquisition unit 1102 that calculates the target speed, and a target type acquisition unit 1103 that determines the type of the target, and includes a target ground speed calculation unit 1104 that calculates the ground speed of the target from the results of these.
[0026] The vehicle control device 100 includes a target movement prediction unit 111 that predicts a future target movement trajectory using the target position, ground speed, and type calculated by the image processing unit 110, a traveling path prediction unit 112 that predicts a future traveling trajectory of the host vehicle using steering angle information obtained from the steering angle sensor 103 and the host vehicle speed obtained from a vehicle speed sensor (a vehicle speed acquisition unit that acquires the vehicle speed) 104, and a collision prediction unit 113 that determines whether a collision will occur based on the target traveling path information from the target prediction unit 111 and the host vehicle traveling path information from the traveling path prediction unit 112, and if a collision will occur, calculates the time to collision (hereinafter abbreviated as TTC).
[0027] Furthermore, the vehicle control device 100 includes a reference object ground speed error calculation unit 114 that calculates errors in the forward / backward and left / right ground speeds of a reference object when the reference object for which the true value of the ground speed can be determined is being detected by the image processing unit 110. The reference object ground speed error calculation unit 114 acquires the ground speed error of a reference object 404 (shown in FIG. 6A ) that is used as a reference outside the vehicle 400 (shown in FIG. 2 ).
[0028] In the first embodiment, a stationary object such as a road sign is used as the reference object. The vehicle control device 100 includes a driving assistance function calculation unit 115 that determines whether to issue a collision damage mitigation control request using a ground speed error of the reference object, a time to collision (TTC), a collision determination, and the vehicle speed. The driving assistance function calculation unit 115 determines the execution content of a driving assistance function related to the safety of the vehicle 400 with respect to a moving object recognized by the camera 101, using the ground speed error of the reference object 404.
[0029] The vehicle control device 100 has a mechanism in which an output unit 116 receives a control request command calculated by the driving support function calculation unit 115 and transmits it to the alarm 105 and the brake system 106. The alarm 105 and the brake system 106 correspond to driving support function execution units.
[0030] The output unit 116 outputs a control command to the driving assistance function execution units 105 and 106 of the vehicle 400 to execute the driving assistance function based on the execution content determined by the driving assistance function calculation unit 115 .
[0031] The driving assistance calculation unit 115 includes an automatic brake control calculation unit 108 and a warning control calculation unit 109 .
[0032] The automatic brake control calculation unit 108 determines the execution content of automatic brake control, which is one of the driving assistance functions related to the safety of the vehicle 400, for a moving object recognized by the camera 101 and which automatically applies braking force to the vehicle 400, based on the ground speed error of the reference target 114.
[0033] Based on the result of the automatic brake control calculation unit 108, the output unit 116 outputs a control command for executing automatic brake control to a brake actuator in the brake system of the vehicle 400.
[0034] The warning control calculation unit 109 determines the execution content of warning control for warning the driver of the vehicle 400, among the driving assistance functions related to the safety of the vehicle 400, for a moving object recognized by the camera 101, based on the ground speed error of the reference target 114.
[0035] The output unit 116 outputs a control command to the alarm device 15 of the vehicle 400 to execute alarm control based on the result of the alarm control calculation unit 109 .
[0036] In the first embodiment of the present invention, the brake system 106 and the alarm 105 are described as examples of safety devices to which the output is to be sent, but the present invention is not limited to these. For example, the present invention also includes application to a driving assistance function that avoids collisions by assisting the driver in steering.
[0037] FIG. 2 is an explanatory diagram of the vehicle coordinate system and the calculation contents performed by the target ground speed calculation unit 1104 in the first embodiment.
[0038] 2, in this embodiment, the geometric relationship with each target obtained by the camera 101, which is an external environment recognition sensor mounted on the vehicle 400, is described in a coordinate system in which the vehicle center of gravity is the origin, the X axis is the longitudinal direction of the vehicle with the forward direction being positive, the Y axis is the lateral direction of the vehicle with the left direction being positive, and the angle is 0 degrees in the forward direction of the vehicle and counterclockwise is positive. This coordinate system will be hereinafter referred to as the vehicle coordinate system.
[0039] The camera 101, which is an external environment recognition sensor mounted on the vehicle 400, may be a monocular camera or a compound eye camera, and may be one or more cameras. The camera is not limited to a camera as long as it is a sensor that can detect features such as the shape of an object and match it with a reference target registered in advance in the vehicle control device 100.
[0040] When the target object 301 is confirmed by the camera 101, the position (x obj , y obj ) is acquired by the target position acquisition unit 1101.
[0041] The position of the target 301 (x obj , y obj The target relative velocity [m / sec] due to a change in (x) over an arbitrary time period Δt [sec] is acquired by the target relative velocity acquisition unit 1102 according to the following equation (1). obj_z , y obj_z ) is the position of the target 301 at an arbitrary time Δt [sec] before
[0042]
[0043] When the rotation speed of the vehicle 400 is ωt [rad / sec], the relative peripheral speed 500 of the pedestrian can be expressed by the following equation (2). Therefore, the moving speed of the vehicle 400 in the x-axis and y-axis directions can be expressed as (V sx , V sy ) [m / sec], the ground speed of the pedestrian 403 (V objx , V objy ) [m / sec] can be calculated using the following equation (3). This calculation is performed by the target ground speed calculation unit 1104. In this example, the subject vehicle 400 is in a low vehicle speed range, turning at an intersection, so the velocity V sx [m / sec] corresponds to the host vehicle speed obtained from the vehicle speed sensor 104, and the velocity V sy [m / sec] may be treated as approximately zero.
[0044] Furthermore, the following equation (3) is based on the assumption that the camera 101 is mounted at the center of rotation of the vehicle 400, and depending on the mounting position of the camera 101, the distance between the camera 101 and the center of rotation of the vehicle 400 is taken into consideration and the camera peripheral speed is added.
[0045]
[0046]
[0047] In the first embodiment, a stationary object that is known to be fixed on the road and not move, such as a road sign, a utility pole, or a mailbox, is defined as a reference target.
[0048] FIG. 3 shows the processing flow of a program executed by the reference target ground speed error calculation unit 114, with a stationary object as the reference target, and the image processing unit 110 determines whether the detected object is a stationary object based on characteristics such as the shape of the object.
[0049] In step S3_0, it is determined that at least one stationary object is being detected among the detected objects. If a stationary object is being detected (Yes), in step S3_1, the ground speed information of the stationary object output from the image processing unit 110 is calculated as a composite speed V obj [m / sec] is the ground speed of a stationary object (V objx , V objy ) [m / sec] is used to calculate the following equation (4).
[0050] Here, the combined velocity V obj Since the true value of [m / sec] is zero, the composite velocity V obj In step S3_2, if multiple stationary objects are being detected simultaneously, the combined speed V of each stationary object is calculated. obj The maximum value of the above is selected and output to the driving support function calculation unit 115 as the reference object ground speed error.
[0051] If no stationary object is detected in step S3_0, the reference object ground speed error is output as an invalid value in step S3_3.
[0052]
[0053] FIG. 4 shows the processing flow of the program executed by the driving support function calculation unit 115.
[0054] First, in step S4_0, it is determined whether the reference object ground speed error calculated by the reference object ground speed error calculation unit 114 is an invalid value, and if it is not an invalid value, steps S4_1 and S4_2 are executed.
[0055] In step S4_1, a warning correction gain k is calculated using a warning correction map based on the magnitude of the reference object ground speed error. buzz The larger the error in the ground speed of the reference object, the smaller the correction gain k buzz That is, among the driving assistance functions related to vehicle safety, the execution timing of warning control for warning the driver of vehicle 400 is delayed as the ground speed error of reference object 404 increases.
[0056] Similarly, in step S4_2, a collision avoidance brake correction gain k is calculated using a collision avoidance brake correction map based on the magnitude of the reference object target ground speed error. cmb In the first embodiment, the correction gain k buzz , k cmb is a normalized value between 0 and 1, and the smaller the correction gain, the more delayed the activation timing of the collision damage mitigation system is corrected.
[0057] That is, among the driving assistance functions related to the safety of the vehicle 400, the timing of executing automatic brake control that automatically applies braking force to the vehicle 400 is delayed as the ground speed error of the reference object 404 increases.
[0058] An example of the correction map for the warning gain is shown in FIG. 5A, and an example of the correction map for the collision avoidance brake gain is shown in FIG. 5B. As shown in FIG. 5A, the warning gain k buzz decreases as the reference object-to-ground combined velocity Vt increases. cmb decreases as the reference object to ground combined velocity Vt increases.
[0059] In step S4_0, if the reference object ground speed error is an invalid value, the correction gain k is set in step S4_3 and step S4_4. buzz , k cmbare set to 1. This is the case when no reference targets are detected, and indicates that the operation timing of the collision damage mitigation system is not corrected because the ground speed accuracy of the target to be controlled cannot be evaluated.
[0060] In process S4_5, the collision prediction unit 113 determines that there is a possibility of collision and determines whether the object is a pedestrian. If there is no pedestrian with a possibility of collision, processes S4_13 and S4_14 are performed and the collision damage reduction system is not activated. In this embodiment 1, a pedestrian is assumed, but the type of object to be controlled is not limited to a bicycle, a car, or the like.
[0061] If there is a pedestrian with a possibility of collision, in step S4_6, the alarm intervention reference threshold Th is the distance between the vehicle position and the predicted collision point, which indicates the timing to start sounding the alarm. buzz For [m], the warning correction gain k obtained in the process S4_1 or the process S4_3 is buzz Using the corrected warning intervention threshold Th nbuzz [m] is calculated according to the following formula (5): buzz [m] can be calculated by any method. For example, it may be calculated by adjusting the time to collision (TTC) [sec] until the predicted collision point, the vehicle speed, the lap rate at the time of collision prediction, etc.
[0062]
[0063] Next, in step S4_7, a collision avoidance brake intervention reference threshold Th is a distance between the vehicle position and the collision predicted point, which indicates the timing to start the collision avoidance brake. cmb [m], the collision avoidance brake correction gain k obtained in the process S4_2 or the process S4_4 cmb Corrected collision avoidance brake intervention threshold Th ncmb [m] is calculated according to the following formula (6).
[0064] Collision avoidance brake intervention standard threshold Th buzz [m] can be calculated by any method, for example, by adjusting it based on the TTC, the vehicle speed, the overlap rate at the time of collision prediction, etc.
[0065]
[0066] In step S4_8, the travel distance (hereinafter referred to as the travel distance [m]) of the host vehicle 400 from the current time until the collision with the pedestrian is calculated. The travel distance is calculated by multiplying the host vehicle speed by the TTC [sec], for example.
[0067] Next, in process S4_9, the travel distance [m] calculated in process S4_8 is compared with the corrected warning intervention threshold [m] calculated in process S4_6, and if the travel distance [m] is longer than the corrected warning intervention threshold, it is determined that there is still sufficient time before a collision occurs, and process S4_13 is carried out, and the collision damage mitigation system is not activated.
[0068] If the road distance [m] is shorter than the corrected alarm intervention threshold, it is determined that a collision with a pedestrian is imminent, and step S4_10 is performed to generate a request command to sound an alarm.
[0069] After creating the request command to sound the alarm, the alarm activation request is sent to the output unit 116, and the driver is warned of the risk of collision using sound, light, vibration, etc.
[0070] Next, in process S4_11, the travel distance [m] calculated in process S4_8 is compared with the corrected collision avoidance brake intervention threshold [m] calculated in process S4_7, and if the travel distance [m] is longer than the corrected collision avoidance brake intervention threshold [m], it is determined that the collision can be avoided by the driver taking evasive action in response to the warning, and process S4_14 is carried out, and the collision avoidance brake is not activated.
[0071] If the road distance [m] is shorter than the corrected collision avoidance brake intervention threshold [m], it is determined that a collision with a pedestrian is certain, and step S4_12 is performed to generate a request command to implement collision avoidance braking.
[0072] After creating a request command to implement collision avoidance braking, the command is sent to the output unit 116 to activate the automatic brakes, thereby avoiding a collision with a pedestrian or reducing damage.
[0073] In process S4_13, a command requesting sounding of an alarm is not sent to the output unit 116. Similarly, in process S4_14, a command requesting collision avoidance braking is not sent to the output unit 116.
[0074] 6A and 6B are diagrams showing example scenes for explaining the processing of the first embodiment in more detail. As an example, it is assumed that the host vehicle 400 enters a T-junction and turns left. The host vehicle 400 is equipped with a camera 101 that captures images ahead of the host vehicle 400, and FIG. 6A shows a situation in which a pedestrian 401 is visible within the detection range CAM of the camera 101. The ground speed 403 (V objx , V objy ) [m / sec] is calculated.
[0075] To facilitate understanding of the present invention, the actual ground speed of the pedestrian 401, which cannot be observed directly, is depicted as reference symbol 402. In Fig. 6A, the ground speed 403 detected by the camera 101 deviates from the true value of the ground speed 402, which may result in an erroneous determination that the host vehicle 400 and the pedestrian 401 will collide.
[0076] 6B shows a case where a stationary object 404 is also within the camera detection range CAM. In this case, if the stationary object 404 is used as a reference target and a ground speed 405 of the stationary object 404 is generated, the ground speed 405 can be regarded as an error in the ground speed calculation by the camera 101, and it is thought that a similar error has occurred in the ground speed 402 of the pedestrian 401.
[0077] Generally, collision mitigation systems are activated when the distance to the predicted collision point with the controlled object falls below a certain threshold distance. Therefore, a reasonable way to suppress the activation of collision mitigation systems is to set low thresholds for warnings and collision avoidance braking intervention.
[0078] The accuracy of the ground speed calculation by the camera 101 is evaluated based on the magnitude of the reference object ground speed error, and when the reference object ground speed error is large, that is, when the accuracy of the ground speed calculation by the camera 101 is low, unnecessary operation due to the error in the moving speed can be prevented by setting the intervention threshold for the warning and collision avoidance brake to a small value according to the method described in the processing flow of Figure 4.
[0079] According to the first embodiment of the present invention, it is possible to realize a vehicle control device that can suppress unnecessary operation of a collision damage mitigation system due to a decrease in detection accuracy of target information while the host vehicle 400 is turning.
[0080] The target position acquisition unit 1101 can acquire at least the position of the target recognized by the camera (external environment recognition unit) 101 mounted on the vehicle 400.
[0081] Furthermore, the target ground speed calculation unit 1104 acquires at least the ground speed of the target recognized by the camera 101 .
[0082] Second Embodiment A second embodiment of the present invention will be described with reference to FIGS.
[0083] In the first embodiment, a stationary object with a ground speed of zero is used as the reference target, but in the second embodiment, a moving object with an arbitrary ground speed, such as a pedestrian, is also included as the reference target.
[0084] 7 is a configuration explanatory diagram showing an example of the configuration of a vehicle control device 100 in Example 2. In Fig. 7, the position and ground speed of a moving object serving as a reference target are acquired from an external information device 1000. The external information device 1000 acquires the position and speed of the moving object via data communication, for example, from a GPS device carried by a pedestrian or a surveillance camera installed in an urban area.
[0085] Furthermore, the vehicle position and azimuth angle are acquired from the vehicle position acquisition device 1001, for example, a GPS device mounted on the vehicle, and the reference object ground speed error calculation unit 117 checks whether the moving body acquired from the external information device 1000 is the same object among the objects being detected by the image processing unit 110 using the vehicle position and vehicle azimuth angle acquired from the vehicle position acquisition device 1001, and for targets determined to be the same object, evaluates the deviation between the ground speed acquired from the external information device 1000 and the ground speed calculated by the image processing unit 110, thereby evaluating the accuracy of the ground speed of each target being detected by the image processing unit.
[0086] The coordinate axes defining the position and direction of the information obtained from the external information device 1000 and the vehicle position acquisition device 1001 may be arbitrary, but it is assumed that the information obtained can be mapped onto the same coordinate axes, such as latitude and longitude obtained by GPS.
[0087] Here, as shown in FIG. 8, the east direction relative to an arbitrary reference point is the GPS X axis, the north direction is the GPS Y axis, and the azimuth angle is set to 0 degrees in the GPS X axis direction and 90 degrees in the GPS Y axis direction, and the position of the vehicle 800 is expressed as (x GPSv , y GPSv ), and the vehicle azimuth angle is θ GPSv , , the position of the moving reference target 901 is (x GPSp , y GPSp ), the ground speed of the moving reference object is (Vx GPSp , Vy GPSp ) Hereafter, this coordinate system will be referred to as the GPS coordinate system.
[0088] 9 shows the processing flow of the reference object ground speed error calculation unit 117 in FIG. 7. If a target obtained from the external information device 1000 exists and is detected in step S9_0 of FIG. 9, it is determined in step S9_1 whether the external recognition sensor is detecting the same object. The determination method is, for example, to use the following equation (7) to obtain the position information (x GPSp , y GPSp ) into the vehicle coordinate system and (x' GPSp , y′ GPSp ) and (x' GPSp , y′ GPSp ) and the target position (xobj , y obj ) is determined to be sufficiently close.
[0089]
[0090] In process S9_1, if it is determined that the target obtained from the external information device 1000 and the target obtained by the external recognition sensor are the same, the target is treated as a reference target, and in process S9_2, the ground speed of the target obtained from the external information device 1000 is mapped onto the vehicle coordinate system using the following equation (8), and the reference target ground speed error 2V is calculated using the following equation (9). obj2 Calculate [m / sec].
[0091]
[0092]
[0093] In step S9_3, if multiple reference targets are being detected at the same time, the reference target ground speed error 2V obj2 The maximum value of [m / sec] is selected and output as the reference object ground speed error to the driving support function calculation unit 115. If no reference object is detected, the reference object ground speed error is output as an invalid value in step S9_4.
[0094] After the reference object ground speed error calculation unit 117 obtains the reference object ground speed error, the driving support function calculation unit 115 and subsequent units perform the same processing as in the first embodiment.
[0095] 10 is an overhead view of an example scene for explaining Example 2, and assumes a scene in which the host vehicle 800 is entering a T-junction to turn left, as in Example 1. When the host vehicle 800 obtains position and speed information of a reference object 901 via the GPS relay server 107, if the moving reference object 901 is detected by an external environment recognition sensor mounted on the host vehicle 800, the ground speed calculated by the external environment recognition sensor is indicated by a dashed arrow 903, whereas the ground speed received via the GPS relay server 107 is indicated by a solid arrow 902. If there is a deviation between the two, it is considered that the ground speed arrow 403 calculated by the external environment recognition sensor of the control target object 401 also contains an error, and by delaying the activation timing of the collision damage mitigation system for the control target object 401, it is possible to suppress unnecessary activation caused by the ground speed error.
[0096] According to the second embodiment of the present invention, in addition to obtaining the same effects as those of the first embodiment, it is possible to realize a vehicle control device that can also include moving objects having any ground speed as reference targets.
[0097] Third Embodiment A third embodiment of the present invention will be described with reference to FIGS.
[0098] Fig. 11 is a configuration explanatory diagram showing an example of the configuration of a vehicle control device 100 according to a third embodiment. In Fig. 11, the third embodiment will be described assuming that the reference object is a stationary object, as in the first embodiment, but may be combined with the invention for a moving object according to the second embodiment.
[0099] In addition to the configuration of the first embodiment shown in FIG. 1 , the third embodiment shown in FIG. 11 includes a target ground speed 2 calculation unit 1105 added to the image processing unit 110, which calculates ground speed information of a stationary object using the steering angle sensor 103 instead of the yaw rate sensor, and a reference object combined ground speed calculation unit 118 which is modified to calculate the reference object ground speed error based on the target ground speed and target ground speed information.
[0100] The target ground speed 2 calculation unit 1105 first calculates the steering angle converted yaw rate γ , which is yaw rate information estimated from the information output from the steering angle sensor 103. t [rad / sec]. Yaw rate converted into steering angle γ t[rad / sec] can be calculated by any method, but for example, it can be obtained by the following equation (10).
[0101]
[0102] In equation (10), γ t is the steering angle converted yaw rate [rad / s], V is the vehicle speed "m / s", ρ is the turning radius [m], m is the vehicle weight [kg], l is the wheel base, l f is the vehicle center of gravity and the front axle length [m], l r is the vehicle center of gravity and rear axle length [m], δ is the steering angle sensor value [rad], K f is the front wheel cornering power [N / rad], K r is the rear wheel cornering power [N / rad], and n is the steering gear ratio.
[0103] The target ground speed (V objx2 , V objy2 ) [m / sec] is calculated as the steering angle converted yaw rate γ t [rad / sec] is the ω t This can be obtained by replacing [rad / sec].
[0104]
[0105] The processing flow in the reference object ground velocity error calculation unit 118 is shown in FIG.
[0106] In FIG. 12, similarly to the processing flow of FIG. 2, in step S12_0, it is determined whether a stationary object, which is a reference target, is being detected. If no stationary object is detected, an invalid value is output in step S12_4. If a stationary object is being detected in step S12_0, a composite ground speed is calculated for each stationary object in step S12_1. The calculation method is the same as equation (1). Subsequently, in step S12_2, a composite ground speed is calculated for each stationary object. The calculation method may be, for example, in accordance with the following equation (12):
[0107]
[0108] Next, in step S12_3, the maximum value is selected from the stationary object composite ground speed and the stationary object composite ground speed 2 for each stationary object, and output as the reference object ground speed error. In other words, the value with the maximum ground speed error is selected and output.
[0109] In this third embodiment, the steering angle sensor value does not directly affect the accuracy of the target ground speed, but it does affect the accuracy of the path prediction. In other words, if an error occurs in the steering angle sensor 103, the accuracy of the path prediction will decrease, which may lead to unnecessary operation of the collision avoidance control, so it is necessary to also evaluate the accuracy of the steering angle sensor 103. Generally, accuracy compensation for the yaw rate sensor 102 and accuracy compensation for the steering angle sensor 103 are provided separately, but by using this third embodiment, it is possible to evaluate the error in the value of the yaw rate sensor 102 and the error in the steering angle sensor 103 in a unified manner, with the aim of preventing unnecessary operation of the collision damage mitigation system.
[0110] 13 is an overhead view of an example scene for explaining the third embodiment. Similar to the first embodiment, the scene is assumed in which the vehicle 400 is entering a T-junction to turn left. In the first embodiment, when a stationary object and a pedestrian simultaneously enter the detection range of the camera, the ground speed of the stationary object is calculated using the yaw rate sensor value. However, in the third embodiment, the target ground speed is also calculated using the steering angle converted yaw rate value calculated from the steering angle sensor 103. The ground speed 405 of the stationary object calculated using the detection value of the yaw rate sensor 102 and the ground speed 406 of the stationary object calculated using the detection value of the steering angle sensor 103, whichever is greater, is transmitted to the driving assistance function calculation unit 115 as the reference object ground speed error. The processing of the driving assistance function calculation unit 115 is the same as that shown in FIG. 3.
[0111] By redundantly evaluating the ground speed of a stationary object from different rotational speed sensors, it is possible to uniformly evaluate the error components contained in each sensor, the yaw rate sensor 102 and the steering angle sensor 103, while more firmly suppressing unnecessary operation of collision avoidance control.
[0112] According to the third embodiment of the present invention, the same effects as those of the first embodiment can be obtained. In addition, as described above, the third embodiment of the present invention has a plurality of means (1104, 1105) for calculating the target ground speed, and is configured to redundantly evaluate the target ground speed error, so that it is possible to realize a vehicle control device that can more firmly suppress unnecessary operation of collision avoidance control.
[0113] Fourth Embodiment A fourth embodiment of the present invention will be described with reference to FIGS.
[0114] 14 is a configuration explanatory diagram showing an example of the configuration of a vehicle control device 100 according to a fourth embodiment. In the fourth embodiment, the reference object is a stationary object as in the first embodiment, but the fourth embodiment may be combined with the second or third embodiment.
[0115] 14, the reference object ground speed error calculation unit 114 in the configuration diagram of the first embodiment shown in FIG. 1 is replaced with a reference object ground speed error calculation unit 119. After the reference object ground speed error calculation unit 119 detects a stationary object and calculates the resultant ground speed of the stationary object, if the resultant ground speed of the stationary object indicates a value that exceeds a predetermined value, the driving assistance function calculation unit 115 determines that the reference object has been selected incorrectly, such as a moving sign, and excludes the stationary object from the calculation of the reference object ground speed error, without adjusting the execution timing of automatic brake control. In addition, the driving assistance function calculation unit 115 does not adjust the execution timing of warning control either.
[0116] FIG. 15 is a flowchart showing the processing flow of the reference object ground speed error calculation unit 119 in the fourth embodiment.
[0117] In FIG. 15, it is determined in step S15_0 that at least one stationary object is being detected among the detected targets. If a stationary object is being detected, in step S15_1, the ground speed information of the stationary object output from the image processing unit 110 is calculated as a composite speed V obj [m / sec] is the ground speed of a stationary object (V objx , V objy ) [m / sec] and the above formula (4) is used for calculation.
[0118] Here, the combined velocity V obj [m / sec] is true when zero is the resultant velocity Vobj In step S15_2, it is determined whether the combined speed V [m / sec] is within a range that can be generated as a ground speed error. obj If there is at least one stationary object whose ground speed is within the range where the ground speed error can occur, in step S15_3, the stationary object whose ground speed is outside the range where the ground speed error can occur is ignored, and the composite speed V of each stationary object within the range where the ground speed error can occur is calculated. obj The maximum value is selected from [m / sec] and output as the reference object ground speed error.
[0119] If no stationary object is detected in step S15_0, an invalid value is output as the reference object ground speed error in step S15_4. Even if stationary objects are detected in step S15_2, if the ground speeds of all stationary objects exceed the range in which a ground speed error can occur, the stationary objects detected here are not suitable as reference objects. For this reason, an invalid value is output as, for example, a moving sign.
[0120] After the reference object ground speed error calculation unit 119 obtains the reference object ground speed error, the processing from the driving support function calculation unit 115 onwards is the same as that in the first embodiment.
[0121] 16 is an overhead view of an example scene for explaining Example 4, and assumes a scene in which the vehicle 400 is entering a T-junction to turn left, as in Example 1. In Example 4, a target object 1600 is determined to be a stationary object from the shape of the detected object within the CAM, which is the detection range of the camera 101, and at the same time, the ground speed of a moving object 1610 detected within the CAM is calculated as 1611, and it is determined that the vehicle will collide with the target object 1610 in the future.
[0122] At this time, if the calculated ground speed 1601 of the target 1600 is sufficiently large, the target 1600 is initially determined to be a stationary object based on its shape, but is treated as a moving object that is not suitable as a reference object, and no correction is made, such as delaying the activation timing of the collision damage mitigation system for the target 1610 based on the magnitude of the ground speed 1601.
[0123] Therefore, the operation of the collision damage mitigation system for the target 1610 can be activated at an appropriate timing without being erroneously and excessively suppressed.
[0124] According to the fourth embodiment of the present invention, in addition to being able to obtain the same effects as those of the first embodiment, as described above, after a stationary object is detected and the resultant ground velocity of the stationary object is calculated, if the resultant ground velocity of the stationary object exhibits a value that exceeds a predetermined value, the object is treated as a moving object and is excluded from the calculation of the reference object ground velocity error. This provides the effect of being able to operate at an appropriate timing without erroneously and excessively suppressing operation.
[0125] 100... Vehicle control device, 101... Camera (external environment recognition unit), 102... Yaw rate sensor (rotation angle acquisition unit), 103... Steering angle sensor, 104... Vehicle speed sensor (vehicle speed acquisition unit), 105... Alarm (driving assistance function execution unit), 106... Brake system (driving assistance function execution unit), 107... GPS relay server, 108... Automatic brake control calculation unit, 109... Warning control calculation unit, 110... Image processing unit, 111... Target movement prediction unit, 112... Travel path prediction unit, 113... Collision prediction unit, 114, 11 7, 118, 119...Reference object ground speed error calculation unit, 115...Driving assistance function calculation unit, 301...Target, 400, 800...Own vehicle, 401...Pedestrian, 404...Stationary object (reference object), 901...Moving reference object, 1000...External information device, 1001...Own vehicle position acquisition device, 1101...Target position acquisition unit, 1102...Target relative speed acquisition unit, 1103...Target type acquisition unit, 1104...Target ground speed calculation unit, 1105...Target ground speed 2 calculation unit, 1600...Target, 1610...Moving object
Claims
1. A vehicle control device comprising: a rotational speed acquisition unit that acquires the rotational speed of a vehicle; a vehicle speed acquisition unit that acquires the speed of the vehicle; a target position acquisition unit that acquires the position of a target recognized by an external environment recognition unit mounted on the vehicle; a target ground speed calculation unit that acquires the ground speed of the target recognized by the external environment recognition unit; a reference target ground speed error calculation unit that acquires a ground speed error of a reference target used as a reference outside the vehicle; a driving assistance function calculation unit that determines an execution content of a driving assistance function related to the safety of the vehicle with respect to a moving object recognized by the external environment recognition unit using the ground speed error of the reference target; and an output unit that outputs a control command for executing the driving assistance function to a driving assistance function execution unit of the vehicle based on the execution content determined by the driving assistance function calculation unit.
2. A vehicle control device according to claim 1, characterized in that the reference object is a stationary object.
3. A vehicle control device as described in claim 1, comprising: an external information device that acquires the ground speed of the reference object; and a vehicle position acquisition device that acquires the position of the vehicle, wherein the reference object ground speed error calculation unit acquires the ground speed error of the reference object based on the ground speed of the reference object and the position of the vehicle acquired by the external information device.
4. A vehicle control device as described in claim 2 or claim 3, wherein the driving assistance function calculation unit includes an automatic brake control calculation unit that determines the execution content of automatic brake control, which is one of the driving assistance functions related to the safety of the vehicle and automatically applies a braking force to the vehicle, for the target recognized by the external environment recognition unit based on the ground speed error of the reference target, and the output unit outputs a control command for executing the automatic brake control to the brake system of the vehicle based on the result of the automatic brake control calculation unit.
5. A vehicle control device as described in claim 4, characterized in that the timing of execution of the automatic brake control, which automatically applies a braking force to the vehicle, among the driving assistance functions related to the safety of the vehicle, is delayed the greater the ground speed error of the reference object.
6. A vehicle control device as described in claim 5, characterized in that, when the ground speed error of the reference object indicates a value large enough to exceed a predetermined value, the driving assistance function calculation unit determines that the reference object has been selected incorrectly and does not adjust the timing of execution of the automatic brake control.
7. A vehicle control device as described in claim 2 or claim 3, wherein the driving assistance function calculation unit includes an alarm control calculation unit that determines the execution content of alarm control, among the driving assistance functions related to the safety of the vehicle, for alerting the driver of the vehicle for the moving body recognized by the external environment recognition unit based on the ground speed error of the reference object, and the output unit outputs a control command for executing the alarm control to an alarm device of the vehicle based on the result of the alarm control calculation unit.
8. A vehicle control device according to claim 7, characterized in that the timing of executing warning control for warning the driver of the vehicle, among the driving assistance functions related to the safety of the vehicle, is delayed the greater the ground speed error of the reference object.
9. A vehicle control device as described in claim 8, characterized in that when the ground speed error of the reference object indicates a value large enough to exceed a predetermined value, the driving assistance function calculation unit determines that the reference object has been selected incorrectly and does not adjust the timing of execution of the warning control.
10. A vehicle control device according to claim 1, further comprising a plurality of said target ground speed calculation units, and characterized in that said ground speed error is evaluated redundantly.
11. A vehicle control device as claimed in claim 10, characterized in that, from the ground speeds calculated by the plurality of target ground speed calculation units, the one with the maximum ground speed error is selected as the ground speed error of the reference target.
Citation Information
Patent Citations
Obstacle detection device for vehicle
JP2015155878A
Method for estimating absolute velocity of obstacle, system, computer device and storage medium
JP2020042012A
Driver assistance system having a device for recognizing stationary objects
US20090278672A1
Movement trajectory prediction device, and movement trajectory prediction method
WO2014192137A1
