The present disclosure relates to moving object detection apparatuses that detect moving objects existing around a vehicle.
There is disclosed, for example in Japanese Patent Application Publication No. JP 2011-017634 A, a moving object detection apparatus that detects moving objects existing around an own vehicle by emitting radar waves as transmitted waves over a predetermined angle around the vehicle and receiving reflected waves.
According to the present disclosure, there is provided a moving object detection apparatus which includes an information acquisition unit, a trajectory estimation unit, a maximum electric power storage unit, an electric-power drop determination unit, a recognition determination unit and a suppression unit.
The information acquisition unit is configured to repeatedly acquire, from a radar apparatus that is mounted to a vehicle to transmit and receive radar waves, observed-point information indicating, at least, observed-point positions that are positions of observed points where the radar waves are reflected and received electric powers that are electric powers of the received radar waves.
The trajectory estimation unit is configured to estimate, based on the observed-point positions indicated by a plurality of pieces of the observed-point information acquired by the information acquisition unit respectively at different time instants, a tracking trajectory tracking movement of a moving object corresponding to a plurality of the observed points.
The maximum electric power storage unit is configured to store, based on the received electric powers indicated by the plurality of pieces of the observed-point information acquired by the information acquisition unit respectively at different time instants, a maximum received-electric-power that is a maximum value of the received electric powers.
The electric-power drop determination unit is configured to determine, for each of the plurality of pieces of the observed-point information acquired by the information acquisition unit, whether a received-electric-power difference, which is a difference value obtained by subtracting the received electric power indicated by the piece of the observed-point information from the maximum received-electric-power stored in the maximum electric power storage unit, is greater than a preset drop determination value.
The recognition determination unit is configured to determine, for each of the plurality of pieces of the observed-point information acquired by the information acquisition unit, whether the received electric power indicated by the piece of the observed-point information is lower than or equal to a preset recognition determination value.
The suppression unit is configured to suppress, when the received-electric-power difference is determined by the electric-power drop determination unit to be greater than the drop determination value and the received electric power is determined by the recognition determination unit to be lower than or equal to the recognition determination value, the degree of tracking the observed points in the tracking trajectory estimated by the trajectory estimation unit.
In a radar apparatus, when a radar wave reflected by a detection target is received by the radar apparatus, the received electric power may be lowered under the influence of multipath propagation via a road surface, roadside objects and the like, thereby lowering the S/N ratio. The inventor of the present application has found, through detailed investigation, that when the S/N ratio is lowered, the results of detecting the azimuth of the detection target may vary, causing the accuracy of detecting the position of the detection target to be lowered.
In contrast, the above-described moving object detection apparatus according to the present disclosure determines, when the received-electric-power difference is determined to be greater than the drop determination value and the received electric power is determined to be lower than or equal to the recognition determination value, that the S/N ratio is lowered. Moreover, when the S/N ratio is determined to be lowered, the moving object detection apparatus suppresses the degree of tracking the observed points in the tracking trajectory estimated by the trajectory estimation unit. The accuracy of detecting the positions of the observed points when the S/N ratio is lowered is low; therefore, it is possible for the moving object detection apparatus to estimate the tracking trajectory of the moving object suppressing the influence of the observed points where the position detection accuracy is low. Consequently, the accuracy of detecting the position of the moving object can be improved.
An embodiment of the present disclosure will be described hereinafter with reference to the drawings.
A moving object detection system 1 according to the present embodiment is mounted to a vehicle. As shown in
As shown in
The radar apparatus 2 is installed such that a central axis CA of a detection range of a receiving antenna is oriented in a direction inclined by an installation angle φ backward with respect to a width direction DW of the vehicle VH. The detection range is set to include, for example, a range of ±80° with the central axis CA being its center.
The radar apparatus 2 uses a well-known FMCW method. The radar apparatus 2 transmits radar waves of upward modulation intervals and radar waves of downward modulation intervals alternately at a preset modulation period, and receives the reflected radar waves. In addition, FMCW is an abbreviation of Frequency Modulated Continuous Wave. The radar apparatus 2 detects, for each modulation cycle, the distances to points where the radar waves are reflected (hereinafter, to be referred to as observed points), the relative speeds between it and the observed points, the azimuths of the observed points and the electric powers of the received radar waves. In addition, the azimuths are horizontal angles with respect to the central axis CA.
Moreover, the radar apparatus 2 outputs observed-point information, which indicates the detected distances, relative speeds and azimuths of the observed points and the received electric powers, to the moving object detection apparatus 4.
The warning device 3 is an audio output device installed in the vehicle compartment. The warning device 3 is configured to output a warning sound to occupants of the vehicle.
As shown in
The steering angle sensor 5 detects the rotation angle of a steering wheel of the vehicle VH and outputs a steering angle signal, which is indicative of the detection results, to the moving object detection apparatus 4.
Next, steps of a rear-approach warning process performed by the CPU 11 of the moving object detection apparatus 4 will be described. During operation of the moving object detection apparatus 4, the rear-approach warning process is repeated each time one modulation period elapses.
As shown in
If there is no predicted point, the CPU 11 advances the rear-approach warning process to step S180. On the other hand, if there is a predicted point, then in step S30, the CPU 11 sets a tracking region. Specifically, as shown in
Upon completion of step S30, in step S40 as shown in
Referring back to
If the received-electric-power difference is determined to be greater than the drop determination value, the CPU 11 further determines, in step S90, whether the acquired received-electric-power is lower than or equal to a preset recognition determination value. In addition, the recognition determination value is preset by referring to a recognition determination value map. The recognition determination value map is set to have a negative correlation between the distance indicated by the observed-point information acquired in step S10 and the recognition determination value. It should be noted that the expression of “having a negative correlation between the distance and the recognition determination value” encompasses both the case of the recognition determination value decreasing in steps with increase in the distance and the case of the recognition determination value decreasing continuously with increase in the distance.
If the acquired received-electric-power is determined to be lower than or equal to the recognition determination value, the CPU 11 sets, in step S100, tracking filter coefficients α and β to be described later. Specifically, the CPU 11 sets the tracking filter coefficient α by referring to a first map for use when the received-electric-power drops. Moreover, the CPU 11 sets the tracking filter coefficient β by referring to a second map for use when the received-electric-power drops. Thereafter, the CPU 11 advances the rear-approach warning process to step S180.
The first and second maps for use when the received-electric-power drops are set to have a positive correlation between the distance indicated by the observed-point information acquired in step S10 and the tracking filter coefficients α and β. It should be noted that the expression of “having a positive correlation between the distance and the tracking filter coefficients” encompasses both the case of the tracking filter coefficients increasing in steps with increase in the distance and the case of the tracking filter coefficients increasing continuously with increase in the distance.
On the other hand, if the acquired received-electric-power is determined in step S90 to be higher than the recognition determination value, the CPU 11 advances the rear-approach warning process to step S110. Moreover, if the received-electric-power difference is determined in step S80 to be less than or equal to the drop determination value, the CPU 11 also advances the rear-approach warning process to step S110.
In step S110, the CPU 11 sets the tracking filter coefficients α and R to be described later. Specifically, the CPU 11 sets the tracking filter coefficient α by referring to a first map for use when the received-electric-power is normal. Moreover, the CPU 11 sets the tracking filter coefficient β by referring to a second map for use when the received-electric-power is normal. Thereafter, the CPU 11 advances the rear-approach warning process to step S180.
The first and second maps for use when the received-electric-power is normal are set to have a positive correlation between the distance indicated by the observed-point information acquired in step S10 and the tracking filter coefficients α and β. Moreover, when compared at the same distance, the tracking filter coefficient α set by the first map for use when the received-electric-power is normal is greater than the tracking filter coefficient α set by the first map for use when the received-electric-power drops. Similarly, when compared at the same distance, the tracking filter coefficient β set by the second map for use when the received-electric-power is normal is greater than the tracking filter coefficient β set by the second map for use when the received-electric-power drops.
As shown in
Moreover, as shown in
The first and second maps for use when the vehicle VH is traveling through a curve are set to have a positive correlation between the distance indicated by the observed-point information acquired in step S10 and the tracking filter coefficients α and β. Moreover, when compared at the same distance, the tracking filter coefficient α set by the first map for use when the vehicle VH is traveling through a curve is greater than the tracking filter coefficient α set by the first map for use when the received-electric-power is normal. Similarly, when compared at the same distance, the tracking filter coefficient β set by the second map for use when the vehicle VH is traveling through a curve is greater than the tracking filter coefficient β set by the second map for use when the received-electric-power is normal.
As shown in
Xs(k)=Xp(k)+α{Xm(k)−Xp(k)} (1)
Vs(k)=Vs(k−1)+(β/T){Xm(k)−Xp(k)} (2)
T in Equation (2) is the modulation period. Both a in Equation (1) and β in Equation (2) are the tracking filter coefficients. Xm(k) in both Equations (1) and (2) is the position of the kth observed point. Xm(k) is calculated based on the distance and azimuth indicated by the observed-point information acquired in step S10.
Xp(k) in both Equations (1) and (2) is the position of the kth predicted point. Xp(k) is calculated by the following Equation (3) in later-described step S190 in the rear-approach warning process performed before one modulation period.
Next, in step S190, the CPU 11 calculates the predicted-point position Xp(K+1) by the following Equation (3).
Xp(K+1)=Xs(k)+T×Vs(k) (3)
Further, in step S200, the CPU 11 resets (i.e., sets to 0) an extrapolation counter stored in the RAM 13. Thereafter, the CPU 11 advances the rear-approach warning process to step S210.
Moreover, if the current observed-point position is determined in step S40 to be outside the tracking region, then in step S130, the CPU 11 determines whether the value of the extrapolation counter (hereinafter, to be referred to as the number of extrapolations) is greater than or equal to a preset extrapolation stop determination value (e.g., 5 in the present embodiment). If the number of extrapolations is determined to be greater than or equal to the extrapolation stop determination value, then in step S170, the CPU 11 initializes (e.g., sets to 0 [dB]) the maximum received-electric-power Pmax. Thereafter, the CPU 11 terminates the rear-approach warning process.
On the other hand, if the number of extrapolations is determined to be less than the extrapolation stop determination value, then in step S140, the CPU 11 performs an extrapolation process. Specifically, the CPU 11 updates the latest smoothed position to a position that is obtained by moving the latest smoothed position at the latest smoothed velocity for one modulation period.
Further, in step S150, the CPU 11 sets the latest predicted-point position to a position that is obtained by moving the latest smoothed position, which has been updated in step S140, at the latest smoothed velocity for one modulation period. Then, the CPU 11 increments the extrapolation counter in step S160. Thereafter, the CPU 11 advances the rear-approach warning process to step S210.
In step S210, the CPU 11 determines whether a preset warning condition is satisfied. In the present embodiment, the warning condition is preset such that all of the following first, second and third conditions are satisfied. The first condition is that the smoothed position is on the rear side of the vehicle VH. The second condition is that the smoothed position is within a lane adjacent to and rightward of the lane on which the vehicle VH is traveling. The third condition is that a predicted time to collision TTC, which is calculated based on both the distance between the vehicle VH and the smoothed position and the smoothed velocity, is shorter than or equal to a preset warning determination time (e.g., 2 s in the present embodiment). In addition, TTC is an abbreviation of Time To Collision.
If the warning condition is not satisfied, then in step S220, the CPU 11 terminates the output of the warning sound from the warning device 3. Consequently, when the warning device 3 is outputting the warning sound, the output of the warning sound is interrupted; otherwise, when the warning device 3 is not outputting the warning sound, the state of the warning device 3 not outputting the warning sound is maintained. Thereafter, the CPU 11 terminates the rear-approach warning process.
On the other hand, if the warning condition is satisfied, then in step S230, the CPU 11 causes the warning device 3 to output the warning sound. Consequently, when the warning device 3 is outputting the warning sound, the state of the warning device 3 outputting the warning sound is maintained; otherwise, when the warning device 3 is not outputting the warning sound, the output of the warning sound is started. Thereafter, the CPU 11 terminates the rear-approach warning process.
The moving object detection apparatus 4 configured as described above repeatedly acquires, from the radar apparatus 2 that is mounted to the vehicle VH to transmit and receive radar waves, the observed-point information indicating, at least, the observed-point positions that are the positions of the observed points where the radar waves are reflected and the received electric powers that are the electric powers of the received radar waves.
The moving object detection apparatus 4 estimates, based on the observed-point positions indicated by a plurality of pieces of the observed-point information acquired respectively at different time instants, a tracking trajectory tracking the movement of a moving object corresponding to a plurality of the observed points.
The moving object detection apparatus 4 determines and stores, based on the received electric powers indicated by the plurality of pieces of the observed-point information acquired respectively at different time instants, the maximum received-electric-power Pmax that is a maximum value of the received electric powers.
The moving object detection apparatus 4 determines, for each of the plurality of pieces of the acquired observed-point information, whether the received-electric-power difference, which is the difference value obtained by subtracting the received electric power indicated by the piece of the acquired observed-point information from the stored maximum received-electric-power Pmax, is greater than the preset drop determination value.
The moving object detection apparatus 4 also determines, for each of the plurality of pieces of the acquired observed-point information, whether the received electric power indicated by the piece of the acquired observed-point information is lower than or equal to the preset recognition determination value.
When the received-electric-power difference is determined to be greater than the drop determination value and the received electric power is determined to be lower than or equal to the recognition determination value, the moving object detection apparatus 4 suppresses the degree of tracking the observed points in the estimated tracking trajectory.
As above, when the received-electric-power difference is determined to be greater than the drop determination value and the received electric power is determined to be lower than or equal to the recognition determination value, the moving object detection apparatus 4 determines that the S/N ratio is lowered. Moreover, when the S/N ratio is determined to be lowered, the moving object detection apparatus 4 suppresses the degree of tracking the observed points in the estimated tracking trajectory. The accuracy of detecting the positions of the observed points when the S/N ratio is lowered is low; therefore, it is possible for the moving object detection apparatus 4 to estimate the tracking trajectory of the moving object suppressing the influence of the observed points where the position detection accuracy is low. Consequently, the accuracy of detecting the position of the moving object can be improved.
In addition, the moving object detection apparatus 4 estimates the tracking trajectory on the basis of the observed-point positions indicated respectively by the plurality of pieces of the observed-point information and the tracking filter coefficients α and β indicating the degree of tracking the observed-point positions. Moreover, the moving object detection apparatus 4 suppresses the degree of tracking in the tracking trajectory by setting the tracking filter coefficients α and β so as to lower the degree of tracking. Consequently, it becomes possible for the moving object detection apparatus 4 to suppress the degree of tracking in the tracking trajectory by the simple method of setting the tracking filter coefficients α and β.
As shown in
In contrast,
As shown in
The moving object detection apparatus 4 sets the recognition determination value so as to have a negative correlation between the distance from the moving object to the vehicle VH and the recognition determination value. Moreover, the moving object detection apparatus 4 sets the drop determination value so as to have a negative correlation between the distance from the moving object to the vehicle VH and the drop determination value. Consequently, it becomes possible for the moving object detection apparatus 4 to set the recognition determination value and the drop determination value to suitable values according to the drop in the received electric powers due to increase in the distance from the moving object to the vehicle VH.
The moving object detection apparatus 4 determines whether a preset suppression execution condition, which indicates that the vehicle is traveling straight or through a gentle curve, is satisfied. In the present embodiment, the suppression execution condition is that the steering angle is within a preset traveling-straight determination range. Moreover, when it is determined that the suppression execution condition is not satisfied, the moving object detection apparatus 4 inhibits suppression of the degree of tracking in the tracking trajectory. Consequently, when a rapid position change is caused, by traveling of the vehicle through a tight curve, to occur in the width direction Dw of the vehicle VH in the results of detecting the position of the moving object by the radar apparatus 2, the moving object detection apparatus 4 can suppress deterioration of the responsiveness to the actual positions of the moving object in the tracking trajectory of the moving object.
Moreover, when it is determined that the suppression execution condition is not satisfied, the moving object detection apparatus 4 sets the tracking filter coefficients α and β so as to make the degree of tracking become higher than when it is determined that the suppression execution condition is satisfied, thereby enhancing the degree of tracking the observed points in the estimated tracking trajectory. Consequently, when a rapid position change is caused, by traveling of the vehicle through a tight curve, to occur in the width direction Dw of the vehicle VH in the results of detecting the position of the moving object by the radar apparatus 2, the moving object detection apparatus 4 can improve the responsiveness to the actual positions of the moving object in the tracking trajectory of the moving object.
In the above-described embodiment, step S10 corresponds to a process performed by an information acquisition unit; step S180 corresponds to a process performed by a trajectory estimation unit; and steps S50 and S60 correspond to a process performed by a maximum electric power storage unit.
Moreover, step S80 corresponds to a process performed by an electric-power drop determination unit; step S90 corresponds to a process performed by a recognition determination unit; and step S100 corresponds to a process performed by a suppression unit.
Furthermore, step S70 corresponds to processes performed by a suppression determination unit and an inhibition unit; and step S120 corresponds to a process performed by an enhancing unit.
As above, one embodiment of the present disclosure has been described. However, the present disclosure is not limited to the above-described embodiment and can be carried out through various modifications.
For example, in the above-described embodiment, the radar apparatus 2 uses the FMCW method. However, the radar method of the radar apparatus 2 is not limited to the FMCW method. For example, the radar apparatus 2 may alternatively use a two-frequency CW method or an FCM method. In addition, FCM is an abbreviation of Fast-Chirp Modulation.
In the above-described embodiment, the radar apparatus 2 is configured to transmit radar waves to the right-rear side of the vehicle VH. However, the transmission direction of radar waves is not limited to the direction toward the right-rear side of the vehicle VH. For example, the radar apparatus 2 may alternatively be configured to transmit radar waves to at least one of a front side, a right-front side, a left-front side, a rear side, the right-rear side, a left-rear side, a right side and a left side of the vehicle VH.
In the above-described embodiment, when the steering angle is within the preset traveling-straight determination range, the moving object detection apparatus 4 determines that the vehicle VH is traveling straight or through a gentle curve. However, the determination as to whether or not the vehicle VH is traveling straight or through a gentle curve is not limited to the above method. For example, the determination may alternatively be made based on the yaw rate of the vehicle VH and the traveling speed of the vehicle VH.
Moreover, a function realized by a single component in the above-described embodiment may alternatively be realized by a plurality of components together. In contrast, functions realized by a plurality of components in the above-described embodiment may alternatively be realized by a single component. Furthermore, part of the configuration of the above-described embodiment may be omitted. In addition, the configuration of the above-described embodiment may be partially added to or partially replaced with the configuration of any other embodiment.
In addition to the above-described moving object detection apparatus 4, the present disclosure may also be embodied in various modes such as a system that includes the moving object detection apparatus 4 as a component thereof, a program for enabling a computer to function as the moving object detection apparatus 4, a storage medium having the program stored therein, and a method of detecting a moving object.
Number | Date | Country | Kind |
---|---|---|---|
2018-136959 | Jul 2018 | JP | national |
The present application is a continuation application of International Application No. PCT/JP2019/028112 filed on Jul. 17, 2019, which is based on and claims priority from Japanese Patent Application No. 2018-136958 filed on Jul. 20, 2018. The contents of these applications are hereby incorporated by reference in their entirety into the present application.
Number | Name | Date | Kind |
---|---|---|---|
20160124076 | Nakatani | May 2016 | A1 |
20180239015 | Nishida | Aug 2018 | A1 |
20190219681 | Atsushi | Jul 2019 | A1 |
20200124713 | Shimizu | Apr 2020 | A1 |
Number | Date | Country |
---|---|---|
H06-150196 | May 1994 | JP |
2011-232818 | Nov 2011 | JP |
Entry |
---|
U.S. Appl. No. 17/151,487 and its entire file history, filed Jan. 18, 2021, Shimizu. |
Number | Date | Country | |
---|---|---|---|
20210223384 A1 | Jul 2021 | US |
Number | Date | Country | |
---|---|---|---|
Parent | PCT/JP2019/028276 | Jul 2019 | WO |
Child | 17151490 | US |