WO2016031918A1 - 軸ずれ診断装置 - Google Patents

軸ずれ診断装置 Download PDF

Info

Publication number
WO2016031918A1
WO2016031918A1 PCT/JP2015/074249 JP2015074249W WO2016031918A1 WO 2016031918 A1 WO2016031918 A1 WO 2016031918A1 JP 2015074249 W JP2015074249 W JP 2015074249W WO 2016031918 A1 WO2016031918 A1 WO 2016031918A1
Authority
WO
WIPO (PCT)
Prior art keywords
target
recognition
axis deviation
vehicle
counter
Prior art date
Application number
PCT/JP2015/074249
Other languages
English (en)
French (fr)
Inventor
高木 亮
Original Assignee
株式会社デンソー
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社デンソー filed Critical 株式会社デンソー
Priority to DE112015003914.7T priority Critical patent/DE112015003914T5/de
Priority to CN201580046129.9A priority patent/CN106605153B/zh
Priority to US15/506,396 priority patent/US10539659B2/en
Publication of WO2016031918A1 publication Critical patent/WO2016031918A1/ja

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/40Means for monitoring or calibrating
    • G01S7/4004Means for monitoring or calibrating of parts of a radar system
    • G01S7/4026Antenna boresight
    • G01S7/403Antenna boresight in azimuth, i.e. in the horizontal plane
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/40Means for monitoring or calibrating
    • G01S7/4004Means for monitoring or calibrating of parts of a radar system
    • G01S7/4026Antenna boresight
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/86Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
    • G01S13/867Combination of radar systems with cameras
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/40Means for monitoring or calibrating
    • G01S7/4004Means for monitoring or calibrating of parts of a radar system
    • G01S7/4026Antenna boresight
    • G01S7/4034Antenna boresight in elevation, i.e. in the vertical plane
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9327Sensor installation details
    • G01S2013/93271Sensor installation details in the front of the vehicles

Definitions

  • the present invention relates to a technique for detecting an axial deviation of a beam sensor mounted on a vehicle.
  • the axis deviation of the beam sensor means that a reference axis (hereinafter referred to as a beam axis) along the traveling direction of the beam output from the beam sensor is deviated from a previously designed axis position. .
  • a beam sensor has been used to perform various controls for improving the driving safety of a vehicle.
  • This beam sensor detects a target existing around the vehicle by transmitting a probe beam such as a laser beam, an ultrasonic wave, and a millimeter wave and detecting a reflected beam.
  • the beam sensor is attached to a predetermined mounting position of the vehicle so that the exploration beam is irradiated to a predetermined irradiation range, and its beam axis coincides with a pre-designed axis position. For this reason, if the mounting position of the beam sensor is deviated from a predetermined mounting position due to some factor, the beam axis may be shifted from a pre-designed axial position. There is a risk that the waves will not be irradiated. Thereby, the detection accuracy of the target in a beam sensor falls, and there exists a possibility that the problem that the precision of various controls which improve the driving
  • the deviation of the beam axis from the predesigned axis position is also simply referred to as an axis deviation.
  • the axial deviation in the vertical plane including the beam axis is referred to as the vertical axial deviation
  • the axial deviation in the horizontal plane including the beam axis is also referred to as the horizontal axial deviation.
  • Patent Document 1 detects a vanishing point based on an image captured while a vehicle equipped with a laser beam sensor is running.
  • This technology detects an error between the laser beam delivery direction and the vehicle straight direction based on the detected vanishing point and the laser beam delivery direction when adjusting the laser beam axis, that is, when the vehicle is stopped. To do.
  • This technique corrects the laser beam transmission direction based on the detected error.
  • Patent Document 1 can correct the laser beam transmission direction based on vanishing points detected from an image captured while a vehicle equipped with a laser beam sensor is traveling.
  • this technique corrects the laser beam transmission direction when the laser beam axis is adjusted, that is, when the vehicle is stopped. Therefore, with this technology, it has been difficult to detect the axial deviation of the laser beam sensor when the vehicle is traveling.
  • a first object of this disclosure is to provide a technique for detecting an axial deviation of a beam axis in a beam sensor mounted on a vehicle when the vehicle is traveling.
  • a second object of the present disclosure is to improve detection accuracy of a beam axis misalignment in a beam sensor mounted on a vehicle.
  • a diagnostic device for a beam sensor that is mounted on a vehicle, transmits a probe beam, and receives a reflected beam based on the probe beam.
  • the diagnostic apparatus includes an acquisition unit that acquires horizontal axis deviation information indicating whether or not a horizontal axis deviation, which is an axis deviation with respect to a design beam axis position in a horizontal direction corresponding to a vehicle width direction, of the search beam has occurred.
  • This diagnostic apparatus is configured not to execute an axial deviation diagnosis in the vertical direction of the exploration beam when an axial deviation in the horizontal direction occurs with respect to the exploration beam. For this reason, it is possible to suppress erroneous detection of a situation in which an axial deviation occurs in the horizontal direction as a situation in which an axial deviation occurs in the vertical direction. That is, it is possible to suppress erroneous detection of the axial deviation in the vertical direction of the beam axis in the beam sensor, and it is possible to suppress erroneous detection of the axial deviation in the vertical direction of the beam axis in the beam sensor.
  • FIG. 1 is a block diagram showing an example of the configuration of a driving support system and a target recognition apparatus according to the first embodiment of the present invention.
  • FIG. 2 is a diagram for explaining a mounting position of the radar sensor shown in FIG. 1 with respect to the vehicle.
  • FIG. 3 is a diagram for explaining an axial deviation in the horizontal direction and an axial deviation in the vertical direction of the radar sensor shown in FIG.
  • FIG. 4 is a diagram for explaining detection ranges of the radar sensor and the image sensor shown in FIG.
  • FIG. 5 is a flowchart schematically showing a radar axis misalignment diagnosis process according to the first embodiment of the present invention.
  • FIG. 6 is a diagram illustrating an example of a method of detecting an axis deviation in the horizontal direction.
  • FIG. 7 is a flowchart schematically showing vertical axis deviation diagnosis processing in the radar axis deviation diagnosis processing shown in FIG. 5.
  • FIG. 8A is a flowchart showing detection count processing in the vertical axis deviation diagnosis processing.
  • FIG. 8B is a diagram showing a distance determination table used in the detection count process.
  • FIG. 9A is an explanatory diagram illustrating equations used for the abnormal recognition rate calculation processing and the abnormal recognition rate calculation processing in the vertical axis misalignment diagnosis processing.
  • FIG. 9B is a diagram showing a specific method for obtaining the first ratio calculation process.
  • FIG. 9C is a diagram illustrating a specific method for obtaining the second ratio calculation process.
  • FIG. 9A is an explanatory diagram illustrating equations used for the abnormal recognition rate calculation processing and the abnormal recognition rate calculation processing in the vertical axis misalignment diagnosis processing.
  • FIG. 9B is a diagram showing a specific method for obtaining the first ratio calculation process.
  • FIG. 9C is a diagram
  • FIG. 10A is a graph showing the relationship between the distance from the host vehicle to the preceding vehicle and the target double recognition ratio when weighting is not performed on the first counter, the second counter, and the third counter. It is.
  • FIG. 10B shows the distance between the host vehicle and the preceding vehicle and the target double recognition ratio when weighting is performed on at least one of the first counter, the second counter, and the third counter. It is a graph which shows a relationship.
  • FIG. 11A is a diagram showing a first map used for a vertical axis deviation amount calculation process in the vertical axis deviation diagnosis process.
  • FIG. 11B is a diagram showing a second map used for the vertical axis deviation amount calculation process in the vertical axis deviation diagnosis process.
  • FIG. 11A is a diagram showing a first map used for a vertical axis deviation amount calculation process in the vertical axis deviation diagnosis process.
  • FIG. 11B is a diagram showing a second map used for the vertical axis deviation amount calculation process in the vertical axis deviation diagnosis
  • FIG. 12 is a diagram for explaining the effect of the vertical axis misalignment diagnosis process according to the first embodiment and the detection count process according to the third embodiment.
  • FIG. 13 is a flowchart of the axis misalignment diagnosis process according to the second embodiment of the present invention.
  • FIG. 14A is a flowchart of detection count processing according to the third embodiment of the present invention.
  • FIG. 14B is a diagram illustrating an example of a distance determination table according to the third embodiment of this invention.
  • FIG. 15A is an explanatory diagram illustrating expressions used for the abnormal recognition rate calculation processing and the abnormal recognition rate calculation processing in the vertical axis misalignment diagnosis processing according to the third embodiment.
  • FIG. 15B is a diagram illustrating a specific method for obtaining the first ratio calculation process according to the third embodiment.
  • FIG. 15C is a diagram illustrating a specific method for obtaining the second ratio calculation process according to the third embodiment.
  • FIG. 16A is a diagram for explaining the lateral position of the sign when the horizontal axis is not displaced.
  • FIG. 16B is a diagram for explaining the lateral position of the sign when the horizontal axis is misaligned.
  • the driving support system 10 of the first embodiment includes a radar sensor 11, an image sensor 12, a target recognition device 13, and a driving support execution device 14.
  • the driving support system 10 is mounted on the vehicle 1.
  • the target recognition device 13 is connected to each of the radar sensor 11, the image sensor 12, and the driving support execution device 14 so as to be able to communicate with each other.
  • the radar sensor 11 is attached to a predetermined position at the front end of the host vehicle 1.
  • the center axis (radar axis) of the detection range is the front-rear direction of the host vehicle 1 (the longitudinal direction of the host vehicle 1 and the x-axis direction shown in FIG. 2) and the vertical direction.
  • the vehicle height direction perpendicular to the y-axis direction shown in FIG. 2 which is the x-axis direction and the vehicle width direction and the z-axis direction shown in FIG. 2 is attached at a predetermined angle. .
  • the radar sensor 11 has a predetermined direction (here, as an example) in the vehicle width direction (y-axis direction) in the xy plane (horizontal plane) of the host vehicle 1. (the direction of the x-axis) is attached so that the center axis M of the detection range is a predetermined angle ⁇ Y0 .
  • the radar sensor 11 has a predetermined direction in the vehicle height direction (z-axis direction) (here, the z-axis direction as an example) in the xz plane (vertical plane). Is attached at a predetermined angle ⁇ Z0 .
  • an angle (for example, ⁇ Ym ) between the center axis M of the detection range and a predetermined direction (x-axis) in the vehicle width direction is a predetermined angle in the horizontal plane.
  • the state changed from ⁇ Y0 (the shifted state) is referred to as a state in which a horizontal axis deviation has occurred.
  • an angle (for example, ⁇ Zm ) formed by the center axis M of the detection range and a predetermined direction (z-axis) in the vehicle height direction in the vertical plane is a predetermined angle.
  • the state changed from ⁇ Z0 (the shifted state) is referred to as a state in which an axial shift occurs in the vertical direction.
  • the radar sensor 11 irradiates a radar wave (radar beam) toward the first exploration area set in front of the host vehicle 1, and receives the reflected wave (reflected beam).
  • a radar wave radar beam
  • the radar sensor 11 and the target recognition device 13 constitute a well-known FMCW (Frequency Modulated Continuous Wave) radar that uses millimeter waves to detect a target existing in the first exploration area.
  • FMCW Frequency Modulated Continuous Wave
  • the radar sensor 11 is disposed, for example, in the central portion of the front end of the vehicle 1, and the frequency linearly increases (uplink modulation) and decreases (downlink modulation) with respect to time.
  • Transmit the transmitted wave (transmission beam) toward the first exploration area receive the radio wave (reflected beam) reflected by the target ahead, transmit the transmission wave (transmission beam) and the received wave (reception beam)
  • the radar sensor 11 extracts a beat signal having a beat frequency corresponding to the distance and relative speed between the radar sensor 11 and the target as received data.
  • the radar sensor 11 at least one of a transmission antenna and a reception antenna is configured by an array antenna. Note that a combination of a transmission antenna and a reception antenna is called a channel.
  • the radar sensor 11 extracts a beat signal for each channel.
  • the radar sensor 11 performs AD conversion on the extracted beat signal using an AD converter and outputs the result.
  • the output beat signal is input to the target recognition device 13.
  • the image sensor 12 includes, for example, a CCD camera disposed above the radar sensor 11 at the front end portion of the host vehicle 1, for example.
  • the second exploration area set in front of the vehicle 1 is imaged.
  • the CCD camera uses an angular range wider than the detection range of the radar sensor 11 as a detection range (see FIG. 4).
  • the first exploration region (first detection range) by the radar sensor 11 is a predetermined along the horizontal direction (the vehicle width direction of the vehicle 1) around the beam axis of the radar beam. For example, it is a region that expands in a fan shape so as to have an angle of view.
  • the second exploration region (second detection range) by the image sensor 12 is a region that spreads in a fan shape, for example, so as to have a predetermined angle of view along the horizontal direction (vehicle width direction) with the optical axis at the center. is there.
  • the beam axis of the radar sensor 11 and the optical axis of the image sensor 12 coincide with each other when viewed from above the vehicle 1.
  • the first exploration area (first detection range) by the radar sensor 11 has a predetermined angle of view along the vertical direction (the height direction of the vehicle 1) around the beam axis of the radar sensor 11.
  • it is fan-shaped.
  • the second exploration region (second detection range) by the image sensor 12 extends, for example, in a fan shape so as to have a predetermined angle of view along the vertical direction (height direction) around the optical axis. (See FIG. 12A).
  • the first search area and the second search area overlap each other.
  • the image sensor 12 detects a predetermined target (vehicle, pedestrian, etc.) existing within the imaging range by performing known image processing such as template matching on the imaging data captured by the CCD camera.
  • the image sensor 12 transmits information on the target (hereinafter referred to as an image target) detected by this processing to the target recognition device 13 as image target information.
  • the image target information includes at least information about the type, size, and position (distance, azimuth) of the detected image target.
  • the target recognition device 13 includes, for example, a microcomputer including a CPU 31, a ROM 32, and a RAM 33, and a digital signal processor (DSP) 34 for executing signal processing such as fast Fourier transform (FFT).
  • DSP digital signal processor
  • the CPU 31 of the target recognition device 13 recognizes various targets existing in the first exploration area according to the beat signal acquired from the radar sensor 11 and generates target information to be provided to the driving support execution device 40. Functions as a beam recognition unit 13a. Further, the CPU 31 of the target recognition device 13 recognizes various targets existing in the second exploration area in accordance with the image target information acquired from the image sensor 12 and provides the target to the driving support execution device 40. It functions as an image recognition unit 13b that generates mark information.
  • the recognition method of various targets in the target recognition process is a well-known technique, detailed description is abbreviate
  • the CPU 13 of the target recognition device 13 functions as a diagnostic processing unit that executes a radar axis misalignment diagnosis process that determines whether or not an axis misalignment has occurred in the radar sensor 11.
  • the driving assistance execution device 14 controls various on-vehicle devices according to the processing result (target information) in the target recognition device 13 and executes predetermined driving assistance.
  • the driving support execution device 14 includes at least a monitor that displays various images and a speaker that outputs an alarm sound and guidance sound as in-vehicle devices to be controlled.
  • the driving support execution device 14 may further include various control devices that control the internal combustion engine, the power train mechanism, the brake mechanism, and the like mounted on the host vehicle 1 as in-vehicle devices to be controlled.
  • the target recognizing device 13 acquires horizontal axis deviation information indicating whether or not an axis deviation in the horizontal direction of the radar sensor 11 has occurred (step S10).
  • the processing of step S10 by the CPU 31 or the hardware configuration that realizes the processing of step S10 corresponds to, for example, the acquisition unit 13c.
  • the target recognizing device 13 performs horizontal axis deviation diagnosis processing for detecting whether or not the horizontal deviation of the radar sensor 11 has occurred in the radar axis deviation diagnostic processing. It is executed as a separate process.
  • step S10 the target recognition device 13 acquires the detection result of the horizontal axis deviation diagnosis process as horizontal axis deviation information.
  • the target recognizing device 13 detects, as an example, as shown in FIG. 6 whether or not the horizontal deviation of the radar sensor 11 has occurred.
  • the target recognition device 13 detects a predetermined target included in the image based on the image captured by the image sensor 12.
  • the target recognition device 13 detects the distance from the host vehicle 1 to the preceding vehicle 9 and the vehicle width W of the preceding vehicle 9 with the preceding vehicle 9 as a predetermined target.
  • the target recognizing device 13 determines a horizontal plane (from the x-axis direction and the y-axis direction in FIGS. 2 and 3) including a predetermined reference point (here, the mounting position P0 of the radar sensor 11). ),
  • the azimuth range ⁇ g corresponding to the vehicle width W of the preceding vehicle 9 recognized in the image is calculated.
  • the target recognizing device 13 has a predetermined angle of the azimuth range ⁇ s including the azimuth range ⁇ g corresponding to the vehicle width W of the preceding vehicle 9, that is, the detection range of the radar sensor 11 in a state where there is no horizontal axis deviation. It is determined whether or not all the targets detected by the radar sensor 11 are included in the azimuth range ⁇ s corresponding to (step S20).
  • the target recognition device 13 causes an axis shift in the horizontal direction of the radar sensor 11. Judge that it is not.
  • the target recognition device 13 does not include at least one target Pr detected by the radar sensor 11 in the azimuth range ⁇ s (see FIG. 6), the horizontal deviation of the radar sensor 11 is detected. It determines with having generate
  • the target recognizing device 13 determines that an axial deviation has occurred in the horizontal direction (YES as a result of the determination in step S20)
  • the target recognizing device 13 does not execute a vertical axis deviation diagnosis process described later (prohibits execution).
  • the radar axis misalignment diagnosis process is terminated.
  • step S30 If the target recognition apparatus 13 determines that no horizontal axis deviation has occurred (NO in step S20), the target axis recognition device 13 executes vertical axis deviation diagnosis processing in step S30 (step S30).
  • the hardware configuration that realizes the determination process of step S20 or the determination process of step S20 by the CPU 31 corresponds to, for example, the determination unit 13d.
  • the hardware configuration that realizes the diagnosis process of step S30 by the CPU 31 or the diagnosis process of step S30 corresponds to the diagnosis unit 13e, for example.
  • the target recognition device 13 After executing the vertical axis deviation diagnosis process in step S30, the target recognition device 13 ends the radar axis deviation diagnosis process.
  • the target recognition apparatus 13 executes a detection count process that is a subroutine (S100). The detection count process will be described later. Thereafter, the vertical axis deviation diagnosis process proceeds to step S200.
  • step S200 the target recognizing device 13 executes a target bi-recognition ratio calculation process that is a subroutine.
  • the target bi-recognition ratio calculation process will be described later.
  • the vertical axis deviation diagnosis process proceeds to step 300.
  • step S300 the target recognition device 13 executes an abnormal recognition ratio calculation process.
  • the abnormal recognition ratio calculation process will be described later.
  • the vertical axis deviation diagnosis process proceeds to step S400.
  • step S400 vertical axis deviation amount calculation processing is executed.
  • the vertical axis deviation amount calculation process will be described later. Thereafter, the target recognition device 13 ends the vertical axis misalignment diagnosis process.
  • the target recognition device 13 determines whether or not the image target and the millimeter wave target match (S1110).
  • the image target refers to the preceding vehicle 9 that has been image-recognized by the image sensor 12
  • the millimeter wave target refers to the preceding vehicle 9 that has been radar-recognized by the radar sensor 11.
  • the coincidence between the image target and the millimeter wave target means that the recognized preceding vehicle 9 is recognized by both the radar recognition by the radar sensor 11 and the image recognition by the image sensor 12.
  • the target recognizing device 13 recognizes the preceding vehicle recognized when the radar-recognized preceding vehicle 9 exists within a predetermined range including the image-recognized preceding vehicle 9. It is determined that the vehicle 9 has been recognized by both radar recognition by the radar sensor 11 and image recognition by the image sensor 12.
  • the target recognition device 13 includes identification information (for example, appearance information of the millimeter wave target) included in the millimeter wave target obtained based on the radar recognition result by the radar sensor 11 and an image by the image sensor 12. It is determined whether or not the identification information (for example, appearance information of the image target) included in the image target obtained based on the recognition result matches.
  • identification information included in the millimeter wave target matches the identification information included in the image target as a result of this determination, the target recognition device 13 is the same by both the radar sensor 11 and the image sensor 12. It is determined that the target, i.e., the same preceding vehicle is recognized.
  • step S1110 If the determination in step S1110 is affirmative (S1110: YES), the detection count process proceeds to step S1120. On the other hand, when it is negative determination (S1110: NO), a detection count process transfers to step S1130.
  • step S1120 the target recognition device 13 performs target distance determination. Specifically, the target recognition device 13 determines the distance between the host vehicle 1 and the preceding vehicle 9 that has undergone radar recognition and image recognition. For the target distance determination, either the radar recognition result or the image recognition result may be used. Thereafter, the detection count process proceeds to step S1140.
  • step S1130 the target recognition device 13 performs target distance determination. Specifically, the target recognition device 13 determines the distance between the host vehicle 1 and the preceding vehicle 9 that has been image-recognized. Note that the result of image recognition is used for this target distance determination. Thereafter, the detection count process proceeds to step S1170.
  • step S1140 the target recognition apparatus 13 determines whether or not the radar recognition result is abnormal recognition. Specifically, the target recognition device 13 determines whether or not the radar recognition by the radar sensor 11 is an abnormal recognition result. If the determination result is affirmative, that is, if the radar recognition result is an abnormal recognition result (step S1140: YES), the detection count process proceeds to step S1160. On the other hand, when a negative determination is made, that is, when the radar recognition result is a normal recognition result (step S1140: NO), the detection count process proceeds to step S1150.
  • the abnormal recognition result means, for example, a result different from the normal recognition result in the first embodiment.
  • the resolution of the radar recognition result is inferior to the resolution of the radar recognition result in the normal case, or when the same target is detected continuously (periodically), in a certain cycle, due to disturbance, The case where the target cannot be detected is included in the abnormal recognition result.
  • the target recognizing device 13 increments the first counter C1 of hardware or software prepared in the own device 13.
  • the target recognizing device 13 is exemplified in FIG. 8B and refers to the distance determination table prepared in the own device 13 between the own vehicle 1 and the preceding vehicle 9 determined in step S1120.
  • the first counter C1 corresponding to the distance is incremented.
  • the first counter C1 is a counter indicating the number of times the preceding vehicle 9 has been normally recognized by the radar (that is, the preceding vehicle 9 is recognized by both the radar recognition by the radar sensor 11 and the image recognition by the image sensor 12). Counter) indicating the number of times the image has been recorded, and is prepared for each distance area set in the distance determination table.
  • a distance area is set in increments of 10 m from 0 m to 100 m, and one distance area is set for 100 m or more.
  • a distance index “ “1” to “11” are assigned respectively.
  • the target recognizing device 13 increments a second counter C2 of hardware or software prepared in the own device 13.
  • the target recognition device 13 refers to the distance determination table illustrated in FIG. 8B, and the second counter C2 to which the distance between the host vehicle 1 and the preceding vehicle 9 determined in step S1120 is applicable. Is incremented.
  • the second counter C2 is a counter indicating the number of times the preceding vehicle 9 has been recognized abnormally by the radar, that is, the number of times the preceding vehicle 9 has been recognized abnormally by both the radar recognition and the image recognition. It is prepared for each distance area set in the distance determination table. Thereafter, the target recognizing device 13 ends the detection count process.
  • the target recognizing device 13 increments a third counter C3 of hardware or software prepared in the own device 13.
  • the target recognition device 13 refers to the distance determination table illustrated in FIG. 8B, and the third counter C3 corresponding to the distance between the host vehicle 1 and the preceding vehicle 9 determined in step S1130. Is incremented.
  • the third counter C3 is a counter indicating the number of times that the preceding vehicle 9 has been subjected only to image recognition without laser recognition, and is provided for each distance region set in the distance determination table. Thereafter, the target recognizing device 13 ends the detection count process.
  • Target bi-recognition ratio calculation process Next, the target bi-recognition ratio calculation process which is a subroutine executed in S200 of the vertical axis deviation diagnosis process will be described with reference to FIG.
  • the target recognizing device 13 executes a target bi-recognition ratio calculation process when the vertical axis deviation diagnosis process proceeds to step S20.
  • the target recognition device 13 multiplies each value of the first counter C1 by a corresponding first coefficient, and multiplies each value of the second counter C2 by a corresponding second coefficient, Each value of the third counter C3 is multiplied by the corresponding third coefficient (see FIG. 9A).
  • the weight in the region where the distance from the own vehicle 1 to the preceding vehicle 9 is small is relatively smaller than the weight in the region where the distance from the own vehicle 1 to the preceding vehicle 9 is large.
  • Set the coefficient to be is set such that the weight in the region where the distance from the host vehicle 1 to the preceding vehicle 9 is large is relatively larger than the weight in the region where the distance from the host vehicle 1 to the preceding vehicle 9 is small.
  • the target recognition device 13 calculates a target / both recognition ratio. Specifically, the target recognizing device 13 sets the weighted first counter C1 value, the weighted first counter C1 value, and the weighted first counter C1 value for each distance area set in the distance determination table.
  • the target double recognition ratio is calculated by dividing the value of the second counter C2 and the weighted third counter C3 by the added value (expressed as a percentage (%), see FIG. 9B).
  • This target bi-recognition ratio is defined as the number of times the preceding vehicle 9 is recognized by both the radar recognition processing and the image recognition processing, and the number of times the preceding vehicle 9 is recognized by at least one of the image recognition processing or the radar recognition processing.
  • An example of the relationship ie, the ratio
  • the target bi-recognition ratio increases, and if the number of times of recognition in the image recognition process increases, the target bi-recognition ratio The value of decreases.
  • the target recognizing device 13 ends the target bi-recognition ratio calculation process.
  • the target recognizing device 13 executes an abnormal recognition rate calculation process when the vertical axis deviation diagnosis process proceeds to step S300. First, the target recognizing device 13 multiplies each value of the first counter C1 by a corresponding first coefficient, and multiplies each value of the second counter C2 by a corresponding second coefficient ( (See FIG. 9A).
  • the target recognition device 13 calculates an abnormal recognition rate. Specifically, the target recognizing device 13 sets the weighted second counter C2 value, the weighted first counter C1 value, and the weighted value for each distance area set in the distance determination table. The value of the second counter C2 is divided by the added value and expressed as a percentage (%) (see FIG. 9C).
  • the target recognition device 13 ends the abnormal recognition ratio calculation process.
  • the target recognizing device 13 executes the vertical axis deviation amount calculation process when the vertical axis deviation diagnosis process proceeds to step S400.
  • the target recognizing device 13 performs the vertical axis deviation generated in the radar sensor 11 in accordance with the target bi-recognition ratio calculated in S200 of the vertical axis deviation diagnosis process and the abnormal recognition ratio calculated in step S300.
  • the amount (vertical axis deviation amount) is estimated (vertical axis deviation estimation amount).
  • the target recognition apparatus 13 is exemplified in FIG. 11A, and refers to a map M prepared in the own apparatus 13, and a map M to which the calculated target bi-recognition ratio and abnormal recognition ratio correspond. Identify the top area. Then, the target recognizing device 13 determines that the vertical axis deviation amount of the value assigned to the specified area has occurred (see FIG. 11B).
  • each region on the map M and the value of the vertical axis deviation amount assigned to each region are set in advance by experiments or the like.
  • the target bi-recognition ratio the larger the target bi-recognition ratio value, the smaller the vertical axis deviation (absolute value), and the smaller the target bi-recognition ratio value, the smaller the vertical axis deviation (absolute value).
  • the vertical axis deviation amount tends to be positive when the abnormal recognition ratio value is large, and the vertical axis deviation amount tends to be negative when the abnormal recognition ratio value is small.
  • the target recognition device 13 sets each area on the map M and the value of the vertical axis deviation amount assigned to each area. In the example shown in FIG. 11B, when the target bi-recognition ratio is X% and the abnormal recognition ratio is Y%, the target recognizing device 13 shifts “ ⁇ degrees (deg)” to the vertical axis deviation. Estimate as a quantity.
  • the target recognition device 13 ends the vertical axis deviation amount calculation processing.
  • the target recognition apparatus 13 in the driving support system 10 detects the horizontal deviation of the radar sensor 11 before detecting the vertical deviation of the radar sensor 11? Judging whether or not.
  • the target recognition device 13 does not execute the axial deviation diagnosis in the vertical direction.
  • the first embodiment as a first effect, it is detected that the situation in which the axis deviation in the horizontal direction occurs is erroneously detected as the situation in which the axis deviation in the vertical direction occurs.
  • the effect of suppressing can be acquired. That is, the first embodiment can obtain the effect of suppressing erroneous detection of the axial deviation of the beam sensor such as the radar sensor 11 in the vertical direction.
  • the target recognizing device 13 executes a vertical deviation measurement process, and the vertical direction of the beam sensor such as the radar sensor 11 or the like. Whether or not an axial misalignment has occurred is diagnosed, and when an axial misalignment in the vertical direction of the beam sensor occurs, the amount of misalignment is detected. That is, the target recognizing device 13 diagnoses whether or not a vertical axis deviation has occurred in a situation in which no horizontal axis deviation has occurred, and the vertical axis deviation has occurred. In such a case, the amount of misalignment can be detected. Therefore, in the first embodiment, as a second effect, various controls for improving the traveling safety of the vehicle 1 can be executed with high accuracy based on the detected amount of axial deviation in the vertical direction. Can be obtained.
  • the target recognizing device 13 performs radar recognition of the preceding vehicle 9 traveling in front of the host vehicle 1 in the vertical axis misalignment diagnosis process, and detects the front of the host vehicle 1 based on the captured image obtained by capturing the front of the host vehicle 1. Image recognition of the traveling preceding vehicle 9 is performed. The target recognizing device 30 then determines that the number of times the preceding vehicle 9 has been recognized by both the radar recognition and the image recognition based on the radar recognition result and the image recognition result of the preceding vehicle 9 is at least the image recognition or the radar recognition. On the other hand, the ratio to the recognized number of times is calculated. An example of this ratio is the target double recognition ratio.
  • the target recognizing device 13 detects a vertical axis deviation generated in a beam sensor such as the radar sensor 11 in accordance with the calculated ratio value (see FIGS. 12A and 12B). Thereby, 1st Embodiment can acquire the 3rd effect that the axial shift in the vertical direction of the radar sensor 11 mounted in the own vehicle 1 can be detected with high accuracy when the own vehicle 1 is traveling. .
  • the target recognizing device 13 calculates the target bi-recognition ratio according to the distance from the own vehicle 1 to the preceding vehicle 9 in the vertical axis deviation diagnosis process. Then, the target recognizing device 13 has a vertical axis deviation generated in the radar sensor 11 in accordance with the value obtained by adding the weighted target bi-recognition ratio values by distance. Diagnose whether or not. Accordingly, the first embodiment obtains the fourth effect that it is possible to more accurately diagnose whether or not the vertical axis deviation of the radar sensor 11 mounted on the host vehicle 1 has occurred. Can do.
  • the target recognizing device 13 determines the ratio of the preceding vehicle 9 that is normally recognized, that is, the normal recognition ratio, and the ratio of the preceding vehicle 9 that is abnormally recognized, that is, the abnormal recognition ratio, in the vertical axis deviation diagnosis process. Calculate each.
  • the target recognizing device 13 diagnoses whether or not a vertical axis deviation has occurred in a beam sensor such as the radar sensor 11 according to the calculated normal recognition ratio and non-normal recognition ratio. If the target recognition device 13 is diagnosed as having an axial misalignment in the vertical direction, the target recognizing device 13 determines whether the upper axis misalignment or the lower axis misalignment and determines the amount of the axis misalignment. .
  • the first embodiment has the fifth effect that the amount of axial misalignment in the vertical direction of the beam sensor such as the radar sensor 11 mounted on the host vehicle 1 can be detected more accurately when the host vehicle 1 travels. Obtainable.
  • the target recognition device 13 corresponds to an example of a detection device, an acquisition unit, a determination unit, a diagnosis unit, a radar recognition unit, and an image recognition unit.
  • S10 corresponds to an example of processing as an acquisition unit
  • S20 corresponds to an example of processing as a determination unit
  • S30 corresponds to an example of processing as a detection unit.
  • a radar axis misalignment diagnosis process will be described with reference to the flowchart of FIG.
  • the target recognition device 13 performs the same processing as in the first embodiment for steps S10 and S20.
  • the target recognizing device 13 determines in step S20 that no axis deviation has occurred in the horizontal direction (step S20: NO)
  • the vertical axis deviation diagnosis in step S30 is performed as in the first embodiment. Execute the process. Then, after the execution is completed, the target recognition device 13 ends the radar axis misalignment diagnosis process.
  • step S40 executes the processing of step S40 and resets all the counters C1 to C3. Execute.
  • the processing in step S40 in the CPU 13 or the hardware configuration corresponding to this processing corresponds to, for example, reset means. Specifically, the target recognition device 13 resets various counters used for the detection count process, that is, the first counter C1, the second counter C2, and the third counter C3. Then, the target recognition device 13 ends the radar axis misalignment diagnosis process.
  • the target recognition device 13 uses various counters used in the vertical axis deviation diagnosis process (detection count process), that is, the first counter C1, when the horizontal axis deviation is detected in the radar axis deviation diagnosis process. All of the second counter C2 and the third counter C3 are reset.
  • the radar sensor 11 has a horizontal axis misalignment. Then, it is assumed that it takes time until the horizontal axis deviation information indicating that the horizontal axis deviation has occurred is acquired after the horizontal axis deviation has actually occurred in the radar sensor 11. Even in such a situation, the target recognition apparatus 13 according to the second embodiment receives the first to third information when the horizontal axis deviation information indicating that the axis deviation in the horizontal direction has occurred is acquired. Counters C1 to C3 are reset.
  • the count values accumulated in the first to third counters C1 to C3 from when the horizontal axis deviation actually occurs until the horizontal axis deviation information is acquired that is, the incorrect count value is It can be prevented from being used for the vertical axis deviation diagnosis processing.
  • the second embodiment as a sixth effect, it is determined whether or not an axial deviation has occurred in the vertical direction with high accuracy in the vertical axis deviation diagnosis process, and when the axial deviation has occurred, The effect that the axial deviation can be detected with high accuracy can be obtained.
  • the target recognition device 13 corresponds to an example of a first count unit, a second count unit, and a reset unit.
  • S1170 corresponds to an example of processing as the first counting unit
  • S1150 and S1160 correspond to an example of processing as the second counting unit
  • S40 corresponds to an example of processing as the resetting unit.
  • the target recognizing device 13 detects an axial deviation generated in the radar sensor 11 based on radar recognition and image recognition of the preceding vehicle 9.
  • the target recognizing device 13 is different from the first embodiment in that the vehicle height of the preceding vehicle 9 is taken into account when detecting the axis deviation.
  • the target recognition apparatus 13 executes a detection count process illustrated in FIG. 14 in step S100 instead of the detection count process illustrated in FIG.
  • the target recognizing device 13 executes the target bi-recognition ratio calculation process illustrated in FIG. 15 instead of the target bi-recognition ratio calculation process illustrated in FIG.
  • the target recognizing device 13 executes an abnormal recognition rate calculation process illustrated in FIG. 15 instead of the abnormal recognition ratio calculation process illustrated in FIG.
  • the target recognizing device 13 executes vertical axis deviation amount calculation processing similar to that of the first embodiment.
  • step S1205 the target recognizing device 13 determines whether or not the image target and the millimeter wave target are the same as in step S1110. That is, the target recognition device 13 determines whether or not the same preceding vehicle 9 has been recognized by both radar recognition by the radar sensor 11 and image recognition by the image sensor 12. If an affirmative determination is made by the target recognizing device 13 (step S1205: YES), the detection count process proceeds to step S1210. On the other hand, when a negative determination is made by the target recognition device 13 (step S1205: NO), the detection count process proceeds to step S1215.
  • step S1210 the target recognition device 13 performs target distance determination. Specifically, the target recognition device 13 determines the distance between the host vehicle 1 and the preceding vehicle 9 that has undergone radar recognition and image recognition. For the target distance determination, either the radar recognition result or the image recognition result may be used. Thereafter, the detection count process proceeds to step S1220.
  • step S1215 as in step S1130, the target recognition device 13 performs target distance determination. Specifically, the target recognition device 13 determines the distance between the host vehicle 1 and the preceding vehicle 9 that has been image-recognized. Note that the result of image recognition is used for this target distance determination. Thereafter, the detection count process proceeds to step S1235.
  • step S1220 the target recognizing device 13 determines whether or not the radar recognition by the radar sensor 11 is a millimeter wave abnormal recognition, similarly to step S1140. Specifically, the target recognition device 13 determines whether or not the radar recognition by the radar sensor 11 is normal recognition. Here, if the target recognition device 13 makes an affirmative determination, that is, if the radar recognition result is an abnormal recognition result (step S1220: YES), the detection count process proceeds to step S1230. On the other hand, when a negative determination is made, that is, when the radar recognition result is a normal recognition result (step S1220: NO), the detection count process proceeds to step S1225.
  • step S1225 the target recognition device 13 determines whether the vehicle height of the preceding vehicle 9 is higher than the vehicle height of a standard vehicle. Specifically, the target recognition device 13 determines whether or not the vehicle height of the preceding vehicle 9 is greater than a predetermined threshold using the result of image recognition.
  • the predetermined threshold is a value set for the purpose of excluding the preceding vehicle 9 having a vehicle height higher than that of a standard vehicle, such as a truck, in order to increase the accuracy of vertical axis deviation detection. It is set in advance by an experiment or the like (see FIGS. 12C and 12D). If the result of determination in step S1225 is affirmative (step S1225: YES), the detection count process proceeds to step S1245. On the other hand, if the determination is negative (step S1225: NO), the detection count process proceeds to step S1240.
  • step S1230 similar to the processing in step S1225, the target recognition device 13 determines whether the vehicle height of the preceding vehicle 9 is higher than the vehicle height of a standard vehicle. Specifically, the target recognition device 13 determines whether or not the vehicle height of the preceding vehicle 9 is larger than the predetermined threshold using the result of image recognition. If the result of determination in step S1230 is affirmative (S1230: YES), the detection count process proceeds to step S1255. On the other hand, if the determination is negative (S1230: NO), the detection count process proceeds to step S1250.
  • step S1235 the target recognition device 13 determines whether the vehicle height of the preceding vehicle 9 is higher than the vehicle height of a standard vehicle, as in the process of step S1225. Specifically, the target recognition device 13 determines whether or not the vehicle height of the preceding vehicle 9 is larger than the predetermined threshold using the result of image recognition. If the result of determination in step S1235 is affirmative (S1235: YES), the detection count process proceeds to step S1265. On the other hand, if the determination is negative (S1235: NO), the detection process proceeds to step S1260.
  • the target recognizing device 13 increments a fourth counter C4 of hardware or software prepared in the own device 13.
  • the target recognizing device 13 is exemplified in FIG. 14B and refers to the distance determination table prepared in the own device 13 between the own vehicle 1 and the preceding vehicle 9 determined in step S1210.
  • the fourth counter C4 corresponding to the distance is incremented.
  • This distance determination table is similar to the distance determination table illustrated in FIG. 8B, but may have different setting contents.
  • the fourth counter C4 is a counter indicating the number of times the preceding vehicle 9 whose vehicle height is less than the predetermined threshold has been normally recognized by the radar, and is set for each distance region set in the distance determination table. . Thereafter, the target recognition device 13 ends the detection count process.
  • step S1245 the target recognition device 13 increments the fifth counter C5 of hardware or software prepared in the device 13 itself.
  • the target recognizing device 13 is exemplified in FIG. 14B and refers to the distance determination table prepared in the own device 13 between the own vehicle 1 and the preceding vehicle 9 determined in step S1210.
  • the fifth counter C5 corresponding to the distance is incremented.
  • the fifth counter C5 is a counter indicating the number of times the preceding vehicle having a vehicle height equal to or higher than the predetermined threshold is normally recognized by the radar, and is set for each distance region set in the distance determination table. . Thereafter, the target recognition device 13 ends the detection count process.
  • step S1250 the target recognizing device 13 increments the sixth counter C6 of hardware or software prepared in the own device 30.
  • the target recognition device 13 is exemplified in FIG. 14B and refers to the distance determination table prepared in the own device 13, and the distance between the own vehicle V and the preceding vehicle determined in step S1210.
  • the corresponding sixth counter C6 is incremented.
  • the sixth counter C6 is a counter indicating the number of times the preceding vehicle whose vehicle height is less than the predetermined threshold has been abnormally recognized by the radar, and is set for each distance region set in the distance determination table. Yes. Thereafter, the target recognition device 13 ends the detection count process.
  • step S1255 the target recognition device 13 increments the seventh counter C7 of hardware or software prepared in the own device 13.
  • the target recognizing device 13 is exemplified in FIG. 14B and refers to the distance determination table prepared in the own device 13 between the own vehicle 1 and the preceding vehicle 9 determined in step S1210.
  • the seventh counter C7 corresponding to the distance is incremented.
  • the seventh counter C7 is a counter indicating the number of times the preceding vehicle having a vehicle height equal to or higher than a predetermined threshold has been abnormally recognized by the radar, and is set for each distance region set in the distance determination table. . Thereafter, the target recognition device 13 ends the detection count process.
  • step S1260 the target recognizing device 13 increments an eighth counter C8 of hardware or software prepared in the own device 13.
  • the target recognizing device 13 is exemplified in FIG. 14B and refers to the distance determination table prepared in the own device 13 between the own vehicle 1 and the preceding vehicle 9 determined in step S1215.
  • the eighth counter C8 corresponding to the distance is incremented.
  • the eighth counter C8 is a counter that indicates the number of times that a preceding vehicle having a vehicle height less than a predetermined threshold has been subjected to only image recognition without being laser-recognized, and for each distance region set in the distance determination table. Is set. Thereafter, the target recognition device 13 ends the detection count process.
  • the target recognizing device 13 increments a ninth counter C9 of hardware or software prepared in the own device 13.
  • the target recognizing device 13 is exemplified in FIG. 14B and refers to the distance determination table prepared in the own device 13 between the own vehicle 1 and the preceding vehicle 9 determined in step S1215.
  • the ninth counter C9 corresponding to the distance is incremented.
  • the ninth counter C9 is a counter that indicates the number of times that a preceding vehicle having a vehicle height equal to or higher than a predetermined threshold is not recognized by the laser but is only recognized by the image, and for each distance region set in the distance determination table. Is set. Thereafter, the target recognition device 13 ends the detection count process.
  • the target recognizing device 13 multiplies each value of the fourth counter C4 by a corresponding predetermined fourth coefficient to correspond to each value of the fifth counter C5. Multiply by a predetermined fifth coefficient.
  • the target recognizing device 13 adds the value of the fourth counter C4 obtained by multiplication and the value of the corresponding fifth counter C5 obtained by multiplication. As a result, a first count addition value is obtained for each distance region set in the distance determination table.
  • the target recognition device 13 multiplies each value of the sixth counter C6 by a corresponding predetermined sixth coefficient, and each corresponding value of the seventh counter C7 Multiply by the seventh coefficient. Then, the target recognition apparatus 13 adds the value of the sixth counter C6 obtained by multiplication and the value of the corresponding seventh counter C7 obtained by multiplication. As a result, a second count addition value is obtained for each distance region set in the distance determination table.
  • the target recognizing device 13 multiplies each value of the eighth counter C8 by a corresponding predetermined eighth coefficient to correspond to each value of the ninth counter C9. Multiply by a predetermined ninth coefficient. Then, the target recognition device 30 adds the value of the eighth counter C8 obtained by multiplication and the value of the corresponding ninth counter C9 obtained by multiplication. As a result, a third count addition value is obtained for each distance region set in the distance determination table. Note that the fourth to ninth coefficients are set in advance by experiments or the like in order to weight each corresponding counter.
  • the target recognition device 13 calculates a target / both recognition ratio. Specifically, the target recognizing device 13 sets the first count addition value, the second count addition value, and the third count for each distance region set in the distance determination table.
  • the target double recognition ratio is calculated by dividing the added value by the added value (expressed as a percentage (%), see FIG. 15B).
  • the target recognizing device 13 ends the target bi-recognition ratio calculation process.
  • the target recognizing device 13 multiplies each value of the fourth counter C4 by a corresponding predetermined fourth coefficient to correspond to each value of the fifth counter C5. Multiply by a predetermined fifth coefficient.
  • the target recognizing device 13 adds the value of the fourth counter C4 obtained by multiplication and the value of the corresponding fifth counter C5 obtained by multiplication. As a result, a first count addition value is obtained for each distance region set in the distance determination table.
  • the target recognition device 13 multiplies each value of the sixth counter C6 by a corresponding predetermined sixth coefficient to correspond to each value of the seventh counter C7. Multiply by a predetermined seventh coefficient. Then, the target recognition apparatus 13 adds the value of the sixth counter C6 obtained by multiplication and the value of the corresponding seventh counter C7 obtained by multiplication. As a result, a second count addition value is obtained for each distance region set in the distance determination table.
  • the target recognition device 13 calculates an abnormal recognition rate. Specifically, the target recognizing device 13 adds a first count addition value and a first count addition value and a second count addition value for each distance area set in the distance determination table.
  • the abnormal recognition rate is calculated by dividing by (represented as a percentage (%), see FIG. 15C).
  • the target recognition device 13 ends the abnormal recognition ratio calculation process.
  • the target recognition apparatus 13 of the third embodiment calculates the target double recognition ratio and the non-normal recognition ratio for each vehicle height of the preceding vehicle 9 in the vertical axis misalignment diagnosis process (detection count process). An axis deviation in the vertical plane generated in the radar sensor 11 is detected according to the target double recognition ratio and the abnormal recognition ratio for each vehicle height. Thereby, it is possible to detect the axis deviation with higher accuracy.
  • the target recognition device 13 determines whether or not the recognized vehicle height of the preceding vehicle 9 is greater than a predetermined threshold in the vertical axis deviation diagnosis process (detection counting process), and the vehicle height is greater than the predetermined threshold.
  • the preceding vehicle 9 is excluded and the target double recognition ratio and the abnormal recognition ratio are calculated. Thereby, it is possible to detect the axis deviation with higher accuracy.
  • the target recognition device 13 detects the amount of axial deviation of the radar sensor 11 in the vertical axis deviation diagnosis processing.
  • the present invention is not limited to this, and the vertical direction of the radar sensor 11 is not limited thereto. It may be possible to detect only whether or not an axis misalignment has occurred.
  • the axis in the horizontal direction is based on the angle between the center axis M of the detection range of the radar sensor 11 and the horizontal direction (x-axis direction) and the angle between the vertical direction (y-axis).
  • the axis of the radar sensor 11 for defining the axis deviation may be an axis different from the central axis M.
  • an axis extending from the radar sensor 11 toward the target search range is defined, and the axis is horizontal.
  • An axial deviation in the direction and an axial deviation in the vertical direction may be defined.
  • the vertical axis deviation diagnosis process described in the third embodiment is applied to the vertical axis deviation diagnosis process (S30) of the radar axis deviation diagnosis process (see FIG. 13) executed by the target recognition apparatus 13 in the second embodiment. May be.
  • the counter reset process executed in S40 all the various counters shown in the flowchart of FIG. 14, that is, the fourth to ninth counters are reset.
  • the target recognition device 13 detects the axial deviation of the radar sensor 11 in the horizontal direction using the radar sensor 11 and the image sensor 12.
  • the present invention is not limited to this, and various methods are possible. It may be detected with.
  • the target recognition device 13 detects a sign or the like provided on the traveling path of the host vehicle 1 using the image sensor 12, and based on a change in the position (lateral position) of the sign or the like, the radar sensor 11 An axial deviation in the horizontal direction may be detected. That is, as an example, as shown in FIG. 16A, when the axis deviation in the horizontal direction of the radar sensor 11 has not occurred (here, the center axis M of the detection range of the radar sensor 11 is the traveling direction of the host vehicle 1 ( in the horizontal direction of the radar sensor 11), the lateral position of the sign Q detected on the travel path of the host vehicle 1 (to the central axis M).
  • the position (E) in the direction perpendicular to the vehicle is detected as a constant value regardless of the distance between the vehicle 1 and the sign Q.
  • the target recognition device 13 may detect an axial deviation in the horizontal direction of the central axis M1 of the detection range of the radar sensor 11 and an amount of the axial deviation.
  • each of the above embodiments may be distributed as a plurality of constituent elements, or the functions of a plurality of constituent elements may be integrated into one constituent element. Further, at least a part of the configuration of each of the above embodiments may be replaced with a known configuration having a similar function. Moreover, you may abbreviate
  • at least a part of the configuration of each of the above embodiments may be added to or replaced with the configuration of the other above embodiments.
  • all the aspects included in the technical idea specified from the wording described in the claims are embodiments of the present invention.
  • the present invention is realized in various forms such as the driving support system 10 and the target recognizing device 13 described above, a program for causing the target recognizing device 13 to function, a medium on which the program is recorded, an axis misalignment diagnosis method, and the like. can do.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Traffic Control Systems (AREA)

Abstract

 探査ビームに水平軸ずれが発生しているか否かを表す水平軸ずれ情報を取得する取得部と、前記探査ビームに対し、車高方向に対応する垂直方向における設計ビーム軸位置に対する軸ずれである垂直軸ずれが発生しているか否かを診断する診断部と、前記水平軸ずれ情報に基づいて、前記診断部による前記垂直軸ずれの診断を実行するか否かを判断し、前記水平軸ずれ情報が前記水平方向における軸ずれが発生していないことを表している場合は、前記診断部による診断を実行し、前記水平軸ずれ情報が前記水平方向における軸ずれが発生していることを表している場合は、前記診断部による診断を禁止する判断部と、を備えた診断装置である。

Description

軸ずれ診断装置
 本発明は、車両に搭載されるビームセンサの軸ずれを検出する技術に関する。なお、ビームセンサの軸ずれとは、ビームセンサから出力されたビームの進行方向に沿った基準となる軸(以下、ビーム軸とする)が予め設計された軸位置に対してずれることを意味する。
 従来、車両の走行安全性を向上させる各種制御を行うために、ビームセンサが用いられている。このビームセンサは、レーザ光、超音波、ミリ波等の探査ビームを送信し、反射ビームを検出することによって、車両周辺に存在する物標を検知する。
 ビームセンサは、予め定められた照射範囲に探査ビームが照射されるように、車両の予め定められた取付位置に取り付けられ、そのビーム軸が予め設計された軸位置に一致する。このため、何らかの要因によってビームセンサの取付位置が予め定められた取付位置に対してずれると、ビーム軸が予め設計された軸位置に対してずれる恐れがあり、この結果、所定の照射範囲にレーダ波が照射されなくなる恐れがある。これにより、ビームセンサにおける物標の検出精度が低下し、車両の走行安全性を向上させる各種制御の精度が低下するという問題が生じる恐れがある。なお、上記ビーム軸の予め設計された軸位置に対するずれを単に軸ずれとも記載する。また、この軸ずれとして、ビーム軸を含む垂直面内における軸ずれを垂直方向の軸ずれとし、ビーム軸を含む水平面内における軸ずれを水平方向の軸ずれとも記載する。
 そこで、ビームセンサの軸ずれを検出するための技術が提案されている。
 例えば、特許文献1に記載された技術は、レーザビームセンサが搭載された車両の走行中に撮像した画像に基づいて消失点を検出する。この技術は、レーザビーム軸の調整時、すなわち、車両停止時において、検出された消失点とレーザビームの送出方向とに基づいて、レーザビームの送出方向と車両直進方向との間の誤差を検出する。そして、この技術は、検出された誤差に基づいて、レーザビームの送出方向の補正を行う。
特開2004-205398号公報
 上記特許文献1に記載の技術は、レーザビームセンサが搭載された車両の走行中に撮像された画像により検出された消失点に基づいて、レーザビームの送出方向の補正を行うことはできる。しかしながら、この技術は、レーザビーム軸の調整時、すなわち、車両停止時において、レーザビームの送出方向の補正を行うものである。したがって、この技術では、車両の走行時において、レーザビームセンサの軸ずれを検出することは困難であった。
 本開示は、このような課題に鑑みなされたものである。例えば、この開示は、車両に搭載されるビームセンサにおけるビーム軸の軸ずれを車両走行時に検出する技術を提供することを第1の目的とする。
 また、本開示は、車両に搭載されるビームセンサにおけるビーム軸の軸ずれの検出精度を向上させることを第2の目的とする。
 車両に搭載されて探査ビームを送信し、該探査ビームに基づく反射ビームを受信するビームセンサの診断装置である。この診断装置は、前記探査ビームの、車幅方向に対応する水平方向における設計ビーム軸位置に対する軸ずれである水平軸ずれが発生しているか否かを表す水平軸ずれ情報を取得する取得部と、前記探査ビームに対し、車高方向に対応する垂直方向における設計ビーム軸位置に対する軸ずれである垂直軸ずれが発生しているか否かを診断する診断部と、前記水平軸ずれ情報に基づいて、前記診断手段による前記垂直軸ずれの診断を実行するか否かを判断し、前記水平軸ずれ情報が前記水平方向における軸ずれが発生していないことを表している場合は、前記診断手段による診断を実行し、前記水平軸ずれ情報が前記水平方向における軸ずれが発生していることを表している場合は、前記診断手段による診断を禁止する判断部と、を備えている。
 この診断装置では、探査ビームに対し水平方向における軸ずれが発生している場合には、該探査ビームの垂直方向における軸ずれの診断を実行しないように構成されている。このため、水平方向における軸ずれが発生している状況を垂直方向における軸ずれが発生している状況として誤って検出することを抑制することができる。すなわち、ビームセンサにおけるビーム軸の垂直方向における軸ずれについての誤検出を抑制することができ、ビームセンサにおけるビーム軸の垂直方向における軸ずれの誤検出を抑制することができる。
 なお、特許請求の範囲に記載した括弧内の符号は、一つの態様として後述する実施形態に記載の具体的手段との対応関係を示すものであって、本発明の技術的範囲を限定するものではない。
図1は、本発明の第1の実施形態に関わる運転支援システム及び物標認識装置の構成の一例を示すブロック図である。 図2は、図1に示すレーダセンサの車両に対する取付位置を説明する図である。 図3は、図1に示すレーダセンサの水平方向における軸ずれ、及び垂直方向における軸ずれを説明する図である。 図4は、図1に示すレーダセンサ及び画像センサの検知範囲をそれぞれ説明する図である。 図5は、本発明の第1の実施形態に関わるレーダ軸ずれ診断処理を概略的に表すフローチャート。 図6は、水平方向における軸ずれ検出方法の一例を説明する図である。 図7は、図5に示すレーダ軸ずれ診断処理における垂直軸ずれ診断処理を概略的に示すフローチャート。 図8Aは、前記垂直軸ずれ診断処理における検知カウント処理を表すフローチャートである。 図8Bは、前記検知カウント処理において用いられる距離判定表を示す図である。 図9Aは、前記垂直軸ずれ診断処理における非正常認識割合演算処理および非正常認識割合演算処理に用いられる式を表す説明図である。 図9Bは、前記第1の割合演算処理の具体的な求め方を示す図である。 図9Cは、前記第2の割合演算処理の具体的な求め方を示す図である。 図10Aは、第1のカウンタ、第2のカウンタ、および第3のカウンタに対して重み付けが行われていない場合の自車両から先行車両までの距離と物標双認識割合との関係を示すグラフである。 図10Bは、第1のカウンタ、第2のカウンタ、および第3のカウンタにおける少なくとも1つに対して重み付けが行われていた場合の自車両から先行車両までの距離と物標双認識割合との関係を示すグラフである。 図11Aは、前記垂直軸ずれ診断処理における垂直軸ずれ量演算処理に用いられる第1のマップを示す図である。 図11Bは、前記垂直軸ずれ診断処理における垂直軸ずれ量演算処理に用いられる第2のマップを示す図である。 図12は、第1の実施形態に係る前記垂直軸ずれ診断処理の効果を説明するとともに、前記第3の実施形態に係る検知カウント処理を説明する図である。 図13は、本発明の第2の実施形態に関わる軸ずれ診断処理のフローチャートである。 図14Aは、本発明の第3実施形態に関わる検知カウント処理のフローチャートである。 図14Bは、本発明の第3実施形態の距離判定表の一例を示す図である。 図15Aは、第3実施形態に関わる、前記垂直軸ずれ診断処理における非正常認識割合演算処理および非正常認識割合演算処理に用いられる式を表す説明図である。 図15Bは、第3実施形態に関わる、前記第1の割合演算処理の具体的な求め方を示す図である。 図15Cは、第3実施形態に関わる、前記第2の割合演算処理の具体的な求め方を示す図である。 図16(a)は、水平方向における軸ずれが発生していないときの標識の横位置を説明する図である。図16(b)は、水平方向における軸ずれが発生しているときの標識の横位置を説明する図である。
 以下、本発明が適用された実施形態について、図面を用いて説明する。
 [1.第1実施形態]
 [1-1.構成]
 図1に示すように、第1の実施形態の運転支援システム10は、レーダセンサ11と、画像センサ12と、物標認識装置13と、運転支援実行装置14と、を備えている。この運転支援システム10は、車両1に搭載されている。物標認識装置13は、レーダセンサ11、画像センサ12および運転支援実行装置14のそれぞれと通信可能に接続されている。
 図2に示すように、レーダセンサ11は、自車両1の前端部における所定位置に取り付けられている。具体的には、レーダセンサ11は、その検知範囲の中心軸(レーダ軸)が、自車両1の前後方向(自車両1の長手方向であって、図2に示すx軸方向)及び上下方向(x軸方向及び車幅方向である図2に示すy軸方向と直交する車高方向であって、図2に示すz軸方向)に対して、それぞれ所定角度となるように取り付けられている。
 すなわち、一例として図3における(a)に示すように、レーダセンサ11は、自車両1のxy平面(水平面)内において、車幅方向(y軸方向)における所定の方向(ここでは、一例としてx軸の方向)に対して、検知範囲の中心軸Mが所定角度θY0となるように取り付けられている。また、図3における(c)に示すように、レーダセンサ11は、xz平面(垂直面)内において、車高方向(z軸方向)における所定の方向(ここでは、一例としてz軸の方向)に対して所定角度θZ0となるように取り付けられている。
 以下では、一例として図3における(b)に示すように、水平面内において検知範囲の中心軸Mと車幅方向における所定の方向(x軸)とのなす角度(例えば、θYm)が所定角度θY0から変化した状態(ずれた状態)を、水平方向における軸ずれが発生している状態という。また、一例として図3における(d)に示すように、垂直面内において検知範囲の中心軸Mと車高方向における所定の方向(z軸)とのなす角度(例えば、θZm)が所定角度θZ0から変化した状態(ずれた状態)を、垂直方向における軸ずれが発生している状態という。
 レーダセンサ11は、自車両1の前方に設定された第1の探査領域に向けてレーダ波(レーダビーム)を照射し、その反射波(反射ビーム)を受信する。例えば、レーダセンサ11は、物標認識装置13とともに、ミリ波を利用して第1の探査領域内に存在する物標を検知する周知のFMCW(Frequency Modulated Continuous Wave)レーダを構成する。
 具体的には、レーダセンサ11は、図2に示すように、例えば、車両1の前端部の中央部分に配置され、時間に対して周波数を直線的に上昇(上り変調)および下降(下り変調)させた送信波(送信ビーム)を第1の探査領域に向けて送信し、前方の物標で反射された電波(反射ビーム)を受信し、送信波(送信ビーム)と受信波(受信ビーム)とをミキシングする。そして、レーダセンサ11は、該レーダセンサ11と物標との距離及び相対速度に対応したビート周波数をもつビート信号を受信データとして抽出する。
 例えば、レーダセンサ11は、送信アンテナ及び受信アンテナのうち少なくとも一方がアレイアンテナによって構成されている。なお、送信アンテナと受信アンテナの組み合わせをチャンネルと呼ぶものとする。レーダセンサ11は、チャンネル毎にビート信号を抽出している。レーダセンサ11は、抽出したビート信号を、ADコンバータによってAD変換して出力する。出力されたビート信号は、物標認識装置13に入力される。
 画像センサ12は、図2に示すように、例えば自車両1の前端部におけるレーダセンサ11の上方に配置された例えばCCDカメラを備え、このCCDカメラにより自車両1の周囲、本実施形態では自車両1の前方に設定された第2の探査領域を撮像する。
 CCDカメラは、レーダセンサ11の検知範囲より広い角度範囲を検知範囲とする(図4参照)。
 すなわち、図4に示すように、レーダセンサ11による第1の探査領域(第1の検知範囲)は、レーダビームのビーム軸を中心として水平方向(車両1の車幅方向)に沿って所定の画角を有するように例えば扇形に広がる領域である。また、画像センサ12による第2の探査領域(第2の検知範囲)は、その光軸を中心として水平方向(車幅方向)に沿って所定の画角を有するように例えば扇形に広がる領域である。なお、図4に示すように、車両1の上方から見て、レーダセンサ11のビーム軸と画像センサ12の光軸とは一致している。
 また、レーダセンサ11による第1の探査領域(第1の検知範囲)は、レーダセンサ11のビーム軸を中心として垂直方向(車両1の高さ方向)に沿っても所定の画角を有するように例えば扇形に広がっている。同様に、画像センサ12による第2の探査領域(第2の検知範囲)は、その光軸を中心として垂直方向(高さ方向)に沿っても所定の画角を有するように例えば扇形に広がっている(図12(a)参照)。
 この結果、第1の探査領域と第2の探査領域とは、少なくとも一部が重複するようになっている。
 画像センサ12は、CCDカメラで撮像した撮像データに対して、テンプレートマッチング等の周知の画像処理を行うことにより、撮像範囲内に存在する所定の物標(車両、歩行者等)を検出する。
 そして、画像センサ12は、この処理により検出された物標(以下、画像物標という)の情報を画像物標情報として物標認識装置13へ送信する。なお、画像物標情報には、検出した画像物標の種類、大きさ、位置(距離、方位)についての情報が少なくとも含まれている。
 物標認識装置13は、例えば、CPU31、ROM32、RAM33からなるマイクロコンピュータと、高速フーリエ変換(FFT)等の信号処理を実行するためのデジタルシグナルプロセッサ(DSP)34とを備える。
 物標認識装置13のCPU31は、レーダセンサ11から取得したビート信号に従って、第1の探査領域内に存在する各種物標を認識し、運転支援実行装置40に提供するための物標情報を生成するビーム認識部13aとして機能する。また、物標認識装置13のCPU31は、画像センサ12から取得した画像物標情報に従って、第2の探査領域内に存在する各種物標を認識し、運転支援実行装置40に提供するための物標情報を生成する画像認識部13bとして機能する。なお、物標認識処理における各種物標の認識方法については周知の技術であるので、詳しい説明は省略する。
 また、物標認識装置13のCPU13は、レーダセンサ11に軸ずれが生じているか否かを判定する、レーダ軸ずれ診断処理を実行する診断処理部として機能する。
 運転支援実行装置14は、物標認識装置13における処理結果(物標情報)に従い、各種車載機器を制御して所定の運転支援を実行する。運転支援実行装置14は、制御対象となる車載機器として、各種画像を表示するモニタや、警報音や案内音声を出力するスピーカを少なくとも備える。また、運転支援実行装置14は、制御対象となる車載機器として、さらに、自車両1に搭載された内燃機関、パワートレイン機構、ブレーキ機構等を制御する各種制御装置を含んでいてもよい。
 [1-2.処理]
 [1-2-1.レーダ軸ずれ診断処理]
 物標認識装置13(すなわち、CPU13)が実行するレーダ軸ずれ診断処理について、図5のフローチャートを用いて説明する。本処理は、例えば、ACCスイッチ(auto cruise control switch)がオンされており、物標認識装置13による処理結果(物標情報)に基づいて、運転支援実行装置14により、例えば、自車両1の速度を、先行車両との距離に応じて自動制御するクルーズコントロールが実行されている間、繰り返し実行される。
 はじめに、物標認識装置13は、レーダセンサ11の水平方向における軸ずれが発生しているか否かを表す水平軸ずれ情報を取得する(ステップS10)。CPU31によるステップS10の処理、あるいはステップS10の処理を実現するハードウェア構成が、例えば、取得手段13cに対応する。
 第1の実施形態では一例として、物標認識装置13は、レーダセンサ11の水平方向における軸ずれが発生しているか否かを検出する水平軸ずれ診断処理を、本レーダ軸ずれ診断処理とは別処理として実行している。
 物標認識装置13は、ステップS10にて、この水平軸ずれ診断処理の検出結果を水平軸ずれ情報として取得する。物標認識装置13は、レーダセンサ11の水平方向における軸ずれが発生しているか否かを、一例として図6に示すように検出する。
 すなわち、物標認識装置13は、画像センサ12によって撮像された画像に基づいて、該画像内に含まれる所定の物標を検出する。ここでは一例として、物標認識装置13は、先行車両9を所定の物標として、自車両1から先行車両9までの距離と先行車両9の車幅Wとを検出する。物標認識装置13は、この検出結果に基づいて、所定の基準点(ここでは、レーダセンサ11の取付位置P0とする)を含む水平面(図2、図3のx軸方向及びy軸方向からなる面)において、画像認識された先行車両9の車幅Wに対応する方位範囲θgを算出する。
 ここで、物標認識装置13は、先行車両9の車幅Wに対応する方位範囲θgを含む所定の角度の方位範囲θs、すなわち、水平方向の軸ずれが無い状態におけるレーダセンサ11の検知範囲に対応する方位範囲θsに、レーダセンサ11によって検出された全ての物標が含まれるか否かを判断する(ステップS20)。
 方位範囲θsに、レーダセンサ11によって検出された全ての物標が含まれている場合(ステップS20の判断の結果NO)、物標認識装置13は、レーダセンサ11の水平方向における軸ずれが発生していないと判定する。
 一方、物標認識装置13は、方位範囲θs内に、レーダセンサ11によって検出された少なくとも1つの物標Prが含まれていない場合(図6参照)、レーダセンサ11の水平方向における軸ずれが発生していると判定する(ステップS20の判断の結果YES)。
 物標認識装置13は、水平方向における軸ずれが発生していると判定した場合(ステップS20の判断の結果YES)、後述する垂直軸ずれ診断処理を実行せず(実行を禁止して)、本レーダ軸ずれ診断処理を終了する。
 また、物標認識装置13は、水平方向における軸ずれが発生していないと判定した場合(ステップS20の判断の結果NO)、ステップS30にて垂直軸ずれ診断処理を実行する(ステップS30)。
 なお、CPU31によるステップS20の判断処理、あるいはステップS20の判断処理を実現するハードウェア構成が、例えば、判断手段13dに対応する。
 また、CPU31によるステップS30の診断処理、あるいはステップS30の診断処理を実現するハードウェア構成が、例えば、診断手段13eに対応する。
 ステップS30による垂直軸ずれ診断処理を実行した後、物標認識装置13は、本レーダ軸ずれ診断処理を終了する。
 [1-2-2.垂直軸ずれ診断処理]
 次に、レーダ軸ずれ診断処理のS30にて実行される垂直軸ずれ診断処理の一例を、図7のフローチャートを参照して説明する。なお、以下で説明する垂直軸ずれ診断処理において、単に軸ずれという場合には、垂直方向の軸ずれをいうものとする。
 最初に、物標認識装置13は、サブルーチンである検知カウント処理を実行する(S100)。なお、検知カウント処理については後述する。その後、垂直軸ずれ診断処理は、ステップS200に移行する。
 ステップS200では、物標認識装置13は、サブルーチンである物標双認識割合演算処理を実行する。なお、物標双認識割合演算処理については後述する。その後、垂直軸ずれ診断処理は、ステップ300に移行する。
 ステップS300では、物標認識装置13は、非正常認識割合演算処理を実行する。なお、非正常認識割合演算処理については後述する。その後、垂直軸ずれ診断処理は、ステップS400に移行する。
 ステップS400では、垂直軸ずれ量演算処理を実行する。なお、垂直軸ずれ量演算処理については後述する。その後、物標認識装置13は、本垂直軸ずれ診断処理を終了する。
 [1-2-2-1.距離別カウント処理]
 次に、垂直軸ずれ診断処理のS100にて実行されるサブルーチンである検知カウント処理について図8Aのフローチャートを参照して説明する。
 まず、物標認識装置13は、画像物標とミリ波物標とが一致しているか否かを判定する(S1110)。なお、このステップS1110において、画像物標とは、画像センサ12によって画像認識された先行車両9を指し、ミリ波物標とは、レーダセンサ11によってレーダ認識された先行車両9を指す。また、画像物標とミリ波物標との一致とは、認識された先行車両9が、レーダセンサ11によるレーダ認識と画像センサ12による画像認識の双方で認識されたことを言う。
 一例として、物標認識装置13は、画像認識された先行車両9を含む予め定められた範囲内にレーダ認識された先行車両9が存在していることが検出された場合に、認識された先行車両9が、レーダセンサ11によるレーダ認識と画像センサ12による画像認識の双方で認識されたと判定する。
 例えば、物標認識装置13は、レーダセンサ11によるレーダ認識結果に基づいて得られたミリ波物標に含まれる識別情報(例えば、そのミリ波物標の外観情報)と、画像センサ12による画像認識結果に基づいて得られた画像物標に含まれる識別情報(例えば、その画像物標の外観情報)とが一致しているか否かを判断する。この判断の結果、ミリ波物標に含まれる識別情報と画像物標に含まれる識別情報とが一致している場合、物標認識装置13は、レーダセンサ11および画像センサ12の双方により、同一の物標、すなわち、同一の先行車両が認識されたと判断する。
 このステップS1110において肯定判断である場合(S1110:YES)、検知カウント処理はステップS1120に移行する。一方、否定判断である場合(S1110:NO)、検知カウント処理はステップS1130に移行する。
 ステップS1120では、物標認識装置13は、物標距離判定を行う。具体的には、物標認識装置13は、自車両1とレーダ認識および画像認識された先行車両9との間の距離を判定する。なお、この物標距離判定には、レーダ認識の結果または画像認識の結果の何れを用いてもよい。この後、検知カウント処理は、ステップS1140に移行する。
 ステップS1130では、物標認識装置13は、物標距離判定を行う。具体的には、物標認識装置13は、自車両1と画像認識された先行車両9との間の距離を判定する。なお、この物標距離判定には、画像認識の結果を用いる。この後、検知カウント処理は、ステップS1170に移行する。
 ステップS1140では、物標認識装置13は、レーダ認識結果が非正常認識であるか否かを判断する。具体的には、物標認識装置13は、レーダセンサ11によるレーダ認識が非正常な認識結果であったか否かを判定する。ここで、肯定判断、すなわち、レーダ認識結果が非正常な認識結果であった場合(ステップS1140:YES)、検知カウント処理は、ステップS1160に移行する。一方、否定判断、すなわち、レーダ認識結果が正常な認識結果であった場合(ステップS1140:NO)、検知カウント処理は、ステップS1150に移行する。
 なお、非正常認識結果とは、第1の実施形態では、例えば、正常な認識結果とは異なる結果を意味する。例えば、レーダ認識結果の解像度が、正常な場合のレーダ認識結果の解像度よりも劣る場合や、同一の物標を連続的(周期的)に検知している状態において、あるサイクルにおいて、外乱により、上記物標が検知できなかった場合等が、上記非正常認識結果に含まれる。
 ステップS1150では、物標認識装置13は、自装置13内に用意されたハードウェアあるいはソフトウェアの第1のカウンタC1をインクリメントする。
 具体的には、物標認識装置13は、図8Bに例示され、自装置13内に用意された距離判定表を参照して、ステップS1120で判定した自車両1と先行車両9との間の距離が該当する第1のカウンタC1をインクリメントする。なお、第1のカウンタC1とは、先行車両9が正常にレーダ認識された回数を示すカウンタ(すなわち、先行車両9が、レーダセンサ11によるレーダ認識と画像センサ12による画像認識の双方で認識された回数を示すカウンタ)であり、距離判定表に設定された距離領域ごとに用意されている。また、距離判定表には、図8Bに例示するように、0mから100mまでは10m刻みで距離領域が設定され、100m以上は一つの距離領域が設定されており、各距離領域に距離インデックス「1」~「11」がそれぞれ付されている。なお、距離判定表の設定内容については、10m以外の刻みや距離領域数であってもよい。物標認識装置13は、この後、検知カウント処理を終了する。
 ステップS1160では、物標認識装置13は、自装置13内に用意されたハードウェアあるいはソフトウェアの第2のカウンタC2をインクリメントする。
 具体的には、物標認識装置13は、図8Bに例示する距離判定表を参照して、ステップS1120で判定した自車両1と先行車両9との間の距離が該当する第2のカウンタC2をインクリメントする。なお、第2のカウンタC2とは、先行車両9が非正常にレーダ認識された回数を示すカウンタ、すなわち、先行車両9がレーダ認識および画像認識の双方により非正常に認識された回数を示しており、距離判定表に設定された距離領域ごとに用意されている。物標認識装置13は、この後、検知カウント処理を終了する。
 ステップS1170では、物標認識装置13は、自装置13内に用意されたハードウェアあるいはソフトウェアの第3のカウンタC3をインクリメントする。
 具体的には、物標認識装置13は、図8Bに例示する距離判定表を参照して、ステップS1130で判定した自車両1と先行車両9との間の距離が該当する第3のカウンタC3をインクリメントする。なお、第3のカウンタC3とは、先行車両9がレーザ認識はされずに画像認識のみされた回数を示すカウンタであり、距離判定表に設定された距離領域ごとに用意されている。物標認識装置13は、この後、検知カウント処理を終了する。
 [1-2-2-2.物標双認識割合演算処理]
 次に、垂直軸ずれ診断処理のS200にて実行されるサブルーチンである物標双認識割合演算処理について図9を参照して説明する。
 物標認識装置13は、垂直軸ずれ診断処理がステップS20に移行した際に、本物標双認識割合演算処理を実行する。
 まず、物標認識装置13は、第1のカウンタC1の値それぞれに、対応する第1の係数を乗算するとともに、第2のカウンタC2の値それぞれに、対応する第2の係数を乗算し、第3のカウンタC3の値それぞれに、対応する第3の係数を乗算する(図9A参照)。
 なお、第1の係数、第2の係数、および第3の係数については、第1のカウンタC1、第2のカウンタC2および第3のカウンタC3の値それぞれに対して重み付けを行うために、実験等により予め設定されている。
 上記設定の一例について、図10Aに例示される自車両Vから先行車両までの距離と、後述する物標双認識割合との関係を示すグラフを用いて説明する。
 このグラフからも明らかなように、自車両1から先行車両までの距離が小さい領域では、レーダセンサ11に軸ずれが生じていない場合の物標双認識割合(詳細は後述する)の値と、レーダセンサ11に軸ずれが生じている場合の物標双認識割合の値との差異が小さい。一方、自車両1から先行車両までの距離が大きい領域では、レーダセンサ11に軸ずれが生じていない場合の物標双認識割合の値と、レーダセンサ11に軸ずれが生じている場合の物標双認識割合の値との差異が大きくなる傾向がある。
 このため、図10Bに示すように、例えば、自車両1から先行車両9までの距離が小さい領域における重みが、自車両1から先行車両9までの距離が大きい領域における重みよりも相対的に小さくなるような係数を設定する。言い換えれば、自車両1から先行車両9までの距離が大きい領域における重みが、自車両1から先行車両9までの距離が小さい領域における重みよりも相対的に大きくなるような係数を設定する。
 図10Aおよび図10Bに例示されたケースでは、車両1と先行車両9との距離がαm未満のカウンタに対して数値「0」の係数θを掛け合わせる。これにより、差が出にくい距離領域の情報を削除して、全体の精度を向上させる(図10B参照)。
 続いて、物標認識装置13は、物標双認識割合を算出する。具体的には、物標認識装置13は、距離判定表に設定された距離領域ごとに、重み付け後の第1のカウンタC1の値を、重み付け後の第1のカウンタC1の値と重み付け後の第2のカウンタC2の値と重み付け後の第3のカウンタC3の値とを加算した値で除算することにより、物標双認識割合を算出する(百分率(%)で表す、図9B参照)。
 この物標双認識割合は、先行車両9を、レーダ認識処理および画像認識処理の双方で認識した回数と、先行車両9を少なくとも画像認識処理またはレーダ認識処理の内の一方で認識した回数との関係(すなわち、割合)の一例を表している。例えば、レーダ認識処理および画像認識処理の双方で認識した回数が増加すれば、物標双認識割合の値は増大し、画像認識処理の単独で認識した回数が増加すれば、物標双認識割合の値は減少する。
 この後、物標認識装置13は、物標双認識割合演算処理を終了する。
 [1-2-2-3.非正常認識割合演算処理]
 次に、垂直軸ずれ診断処理のS300にて実行されるサブルーチンである非正常認識割合演算処理について図9を用いて説明する。
 物標認識装置13は、垂直軸ずれ診断処理がステップS300に移行した際に、非正常認識割合演算処理を実行する。
 まず、物標認識装置13は、第1のカウンタC1の値それぞれに、対応する第1の係数を乗算するとともに、第2のカウンタC2の値それぞれに、対応する第2の係数を乗算する(図9A参照)。
 続いて、物標認識装置13は、非正常認識割合を算出する。具体的には、物標認識装置13は、距離判定表に設定された距離領域ごとに、重み付け後の第2のカウンタC2の値を、重み付け後の第1のカウンタC1の値と重み付け後の第2のカウンタC2の値とを加算した値で除算し、百分率(%)で表す(図9C参照)。
 この後、物標認識装置13は、非正常認識割合演算処理を終了する。
 [1-2-2-4.垂直軸ずれ量演算処理]
 次に、垂直軸ずれ診断処理のS400にて実行されるサブルーチンである垂直軸ずれ量演算処理について図11を用いて説明する。
 物標認識装置13は、垂直軸ずれ診断処理がステップS400に移行した際に、本垂直軸ずれ量演算処理を実行する。
 ここでは、物標認識装置13は、垂直軸ずれ診断処理のS200で算出した物標双認識割合およびステップS300で算出した非正常認識割合に応じて、レーダセンサ11に生じた垂直方向における軸ずれ量(垂直軸ずれ量)を推定する(垂直軸ずれ推定量)。
 具体的には、物標認識装置13は、図11Aに例示され、自装置13内に用意されたマップMを参照して、算出した物標双認識割合および非正常認識割合が該当するマップM上の領域を特定する。そして、物標認識装置13は、その特定した領域に割り当てられた値の垂直軸ずれ量が発生していると判定する(図11B参照)。
 なお、上記マップM上の各領域および各領域に割り当てられた垂直軸ずれ量の値については、実験等により予め設定される。
 例えば、物標双認識割合については、物標双認識割合の値が大きいと垂直軸ずれ量(絶対値)が小さく、物標双認識割合の値が小さいと垂直軸ずれ量(絶対値)が大きい傾向がある。
 また、非正常認識割合については、非正常認識割合の値が大きいと垂直軸ずれ量がプラスであり、非正常認識割合の値が小さいと垂直軸ずれ量がマイナスである傾向がある。なお、レーダビーム軸を含む垂直面内において、該レーダビーム軸が設計ビーム軸位置に対して上側にずれた場合をプラスのずれ量とし、下側にずれた場合をマイナスのずれ量とする。物標認識装置13は、これらに従って、上記マップM上の各領域および各領域に割り当てられた垂直軸ずれ量の値を設定する。図11Bに示す例では、物標双認識割合がX%であり、非正常認識割合がY%である場合には、物標認識装置13は、「-α度(deg)」を垂直軸ずれ量として推定する。
 その後、物標認識装置13は、本垂直軸ずれ量演算処理を終了する。
 [1-3.効果]
 以上詳述した第1実施形態によれば、以下の効果が得られる。
 第1の実施形態に関わる運転支援システム10における物標認識装置13は、レーダセンサ11の垂直方向における軸ずれの検出を実行する前に、レーダセンサ11の水平方向における軸ずれが発生しているか否かを判断している。この結果、レーダセンサ11の水平方向における軸ずれが発生していると判断した場合には、物標認識装置13は、垂直方向における軸ずれの診断を実行しない。このため、第1の実施形態は、第1の効果として、水平方向における軸ずれが発生している状況を垂直方向における軸ずれが発生している状況であるという様に誤って検出することを抑制するという効果を得ることができる。すなわち、第1の実施形態は、レーダセンサ11等のビームセンサの垂直方向における軸ずれについての誤検出を抑制するという効果を得ることができる。
 一方、レーダセンサ11の水平方向における軸ずれが発生していないと判断した場合には、物標認識装置13は、垂直軸ずれ診断処理を実行して、レーダセンサ11等のビームセンサの垂直方向における軸ずれが発生しているか否かを診断し、ビームセンサの垂直方向における軸ずれが発生している場合に、その軸ずれ量を検出する。すなわち、物標認識装置13は、水平方向における軸ずれが発生していないことが確実な状況で、垂直方向における軸ずれが発生しているか否かを診断し、該垂直方向における軸ずれが発生していた場合に、その軸ずれ量を検出することができる。このため、第1の実施形態は、第2の効果として、検出した垂直方向における軸ずれ量に基づいて、車両1の走行安全性を向上させる各種制御を、精度よく実行することができるという効果を得ることができる。
 物標認識装置13は、垂直軸ずれ診断処理において、自車両1の前方を走行する先行車両9のレーダ認識を行うとともに、自車両1の前方を撮像した撮像画像に基づき自車両1の前方を走行する先行車両9の画像認識を行う。そして、物標認識装置30は、先行車両9のレーダ認識結果および画像認識結果に基づき、先行車両9をレーダ認識および画像認識の双方で認識した回数が先行車両9を少なくとも画像認識またはレーダ認識の一方で認識した回数に占める割合を算出する。なお、この割合の一例が、上記物標双認識割合である。物標認識装置13は、その算出した割合の値に応じて、レーダセンサ11等のビームセンサに生じた垂直方向における軸ずれを検出する(図12(a)および(b)参照)。これにより、第1の実施形態は、自車両1に搭載されるレーダセンサ11の垂直方向における軸ずれを自車両1の走行時に精度良く検出することができるという第3の効果を得ることができる。
 物標認識装置13は、垂直軸ずれ診断処理において、自車両1から先行車両9までの距離別に上記物標双認識割合を算出する。そして、物標認識装置13は、その算出した距離別の物標双認識割合の値に重み付けを行った後に合算した値に応じてレーダセンサ11に生じた垂直方向における軸ずれが発生しているか否かを診断する。第1の実施形態は、これにより、自車両1に搭載されるレーダセンサ11の垂直方向における軸ずれが発生しているか否かをより精度良く診断することができるという第4の効果を得ることができる。
 物標認識装置13は、垂直軸ずれ診断処理において、正常に認識された先行車両9の割合、すなわち正常認識割合と、非正常に認識された先行車両9の割合、すなわち非正常認識割合とをそれぞれ算出する。そして、物標認識装置13は、その算出した正常認識割合および非正常認識割合に応じてレーダセンサ11等のビームセンサに生じた垂直方向における軸ずれが発生しているか否かを診断する。そして、物標認識装置13は、垂直方向における軸ずれが発生していると診断された場合には、上方向の軸ずれか下方向の軸ずれかを判定するとともにその軸ずれ量を判定する。これにより、第1実施形態は、自車両1に搭載されるレーダセンサ11等のビームセンサの垂直方向における軸ずれ量を自車両1走行時により精度良く検出することができるという第5の効果を得ることができる。
 なお、第1実施形態では、物標認識装置13が、検出装置、取得手段、判断手段、診断手段、レーダ認識手段、画像認識手段、の一例に相当する。また、S10が取得手段としての処理の一例に相当し、S20が判断手段としての処理の一例に相当し、S30が検出手段としての処理の一例に相当する。
 [2.第2実施形態]
 [2-1.第1実施形態との相違点]
 第2実施形態は、基本的な構成は第1実施形態と同様である。このため、共通する構成については説明を省略し、相違点を中心に説明する。
 第2実施形態では、図13に示すように、物標認識装置13が、レーダ軸ずれ診断処理において、水平方向に軸ずれが生じていると判断した場合に、全てのカウンタC1~C3のリセットを行う点で、第1実施形態と相違する。
 [2-2.処理]
 第2実施形態のレーダ軸ずれ診断処理について、図13のフローチャートを用いて説明する。
 物標認識装置13は、ステップS10およびS20については、第1の実施形態と同様の処理を実行する。
 ここで、物標認識装置13は、ステップS20にて水平方向に軸ずれが生じていないと判断した場合(ステップS20:NO)、第1の実施形態と同様に、ステップS30の垂直軸ずれ診断処理を実行する。そして、実行終了後、物標認識装置13は、本レーダ軸ずれ診断処理を終了する。
 一方、物標認識装置13は、ステップS20にて水平方向に軸ずれが生じていると判断した場合(ステップS20:YES)、ステップS40の処理を実行し、全てのカウンタC1~C3のリセットを実行する。なお、CPU13におけるこのステップS40の処理、あるいはこの処理に対応するハードウェア構成が、例えばリセット手段に対応する。
 具体的には、物標認識装置13は、検知カウント処理に用いる各種カウンタ、すなわち、第1のカウンタC1、第2のカウンタC2、及び第3のカウンタC3を、リセットする。そして、物標認識装置13は、本レーダ軸ずれ診断処理を終了する。
 [2-3.効果]
 以上詳述した第2実施形態によれば、前述した第1実施形態の第1~第5の効果に加えて、以下の効果が得られる。
 物標認識装置13は、レーダ軸ずれ診断処理において、水平方向への軸ずれが検出された場合に、垂直軸ずれ診断処理(検知カウント処理)に用いる各種カウンタ、すなわち、第1のカウンタC1、第2のカウンタC2、および第3のカウンタC3を全てリセットする。
 ここで、レーダセンサ11において水平方向における軸ずれが発生していると仮定する。そして、レーダセンサ11において水平方向における軸ずれが実際に発生してから該水平方向における軸ずれが発生していることを表す水平軸ずれ情報が取得される迄に時間を要するものと仮定する。このように仮定した状況においても、第2実施形態の物標認識装置13は、水平方向における軸ずれが発生していることを表す水平軸ずれ情報が取得されると、第1~第3のカウンタC1~C3をリセットする。このため、水平方向における軸ずれが実際に発生してから水平軸ずれ情報が取得されるまでの間に第1~第3のカウンタC1~C3に蓄積されたカウント値、すなわち誤ったカウント値が垂直軸ずれ診断処理に用いられることを防止することができる。この結果、第2の実施形態は、第6の効果として、垂直軸ずれ診断処理において精度良く垂直方向における軸ずれが生じているか否かを判断し、かつ該軸ずれが発生していた場合、その軸ずれを精度よく検出することができるという効果を得ることができる。
 なお、第2実施形態では、物標認識装置13が、第1のカウント手段、第2のカウント手段、及びリセット手段、の一例に相当する。また、S1170が第1のカウント手段としての処理の一例に相当し、S1150、S1160が第2のカウント手段としての処理の一例に相当し、S40がリセット手段としての処理の一例に相当する。
 [3.第3実施形態]
 [3-1.第1実施形態との相違点]
 第3実施形態は、基本的な構成は第1実施形態と同様であるため、共通する構成については説明を省略し、相違点を中心に説明する。
 前述した第1実施形態では、物標認識装置13は、先行車両9のレーダ認識および画像認識に基づき、レーダセンサ11に生じた垂直方向における軸ずれを検出した。これに対し、第3実施形態では、物標認識装置13は、軸ずれの検出の際に、先行車両9の車高を考慮する点で、第1実施形態と相違する。
 [3-2.処理]
 具体的には、物標認識装置13は、垂直軸ずれ診断処理において、ステップS100では、図8に例示する検知カウント処理に代えて図14に例示する検知カウント処理を実行する。また、物標認識装置13は、ステップS200では、図9に例示する物標双認識割合演算処理に代えて図15に例示する物標双認識割合演算処理を実行する。また、物標認識装置13は、ステップS300では、図9に例示する非正常認識割合演算処理に代えて図15に例示する非正常認識割合演算処理を実行する。なお、物標認識装置13は、ステップS400では、第1の実施形態と同様の垂直軸ずれ量演算処理を実行する。
 以下に、第3の実施形態に関わる検知カウント処理、物標双認識割合演算処理および非正常認識割合演算処理について順に説明する。
 [3-2-1.検知カウント処理]
 垂直軸ずれ診断処理のS100にて実行される距離別カウント処理について、図14を用いて説明する。
 ステップS1205において、物標認識装置13は、ステップS1110と同様に、画像物標とミリ波物標とが一致しているか否かを判断する。すなわち、物標認識装置13は、同一の先行車両9が、レーダセンサ11によるレーダ認識と画像センサ12による画像認識の双方で認識されたか否かを判定する。ここで、物標認識装置13により肯定判断が行われた場合(ステップS1205:YES)、検知カウント処理は、ステップS1210に移行する。一方、物標認識装置13により否定判断が行われた場合(ステップS1205:NO)、検知カウント処理は、ステップS1215に移行する。
 ステップS1210では、物標認識装置13は、物標距離判定を行う。具体的には、物標認識装置13は、自車両1とレーダ認識および画像認識された先行車両9との間の距離を判定する。なお、この物標距離判定には、レーダ認識の結果または画像認識の結果の何れを用いてもよい。この後、検知カウント処理は、ステップS1220に移行する。
 ステップS1215では、ステップS1130と同様に、物標認識装置13は、物標距離判定を行う。具体的には、物標認識装置13は、自車両1と画像認識された先行車両9との間の距離を判定する。なお、この物標距離判定には、画像認識の結果を用いる。この後、検知カウント処理は、ステップS1235に移行する。
 ステップS1220では、物標認識装置13は、ステップS1140と同様に、レーダセンサ11によるレーダ認識がミリ波非正常認識であるか否かを判定する。具体的には、物標認識装置13は、レーダセンサ11によるレーダ認識が正常な認識ではなかったか否かを判定する。ここで、物標認識装置13は、肯定判断、すなわち、レーダ認識結果が非正常な認識結果であった場合(ステップS1220:YES)、検知カウント処理はステップS1230に移行する。一方、否定判断、すなわち、レーダ認識結果が正常な認識結果であった場合(ステップS1220:NO)、検知カウント処理は、ステップS1225に移行する。
 ステップS1225では、物標認識装置13は、先行車両9の車高が標準的な車両の車高より高いか否かを判定する。具体的には、物標認識装置13は、画像認識の結果を用いて、先行車両9の車高が所定の閾値よりも大きいか否かを判定する。なお、所定の閾値とは、垂直軸ずれ検出の精度を高めるために、トラック等の、標準的な車両の車高より車高が高い先行車両9を除外する目的で設定される値であり、実験等により予め設定される(図12(c)および(d)参照)。ステップS1225の判断の結果、肯定判断である場合には(ステップS1225:YES)、検知カウント処理は、ステップS1245に移行する。一方、否定判断である場合には(ステップS1225:NO)、検知カウント処理は、ステップS1240に移行する。
 ステップS1230では、ステップS1225の処理と同様に、物標認識装置13は、先行車両9の車高が標準的な車両の車高より高いか否かを判定する。 具体的には、物標認識装置13は、画像認識の結果を用いて、先行車両9の車高が上記所定の閾値よりも大きいか否かを判定する。ステップS1230の判断の結果、肯定判断である場合には(S1230:YES)、検知カウント処理は、ステップS1255に移行する。一方、否定判断である場合には(S1230:NO)、検知カウント処理は、ステップS1250に移行する。
 ステップS1235では、ステップS1225の処理と同様に、物標認識装置13は、先行車両9の車高が標準的な車両の車高より高いか否かを判定する。 具体的には、物標認識装置13は、画像認識の結果を用いて、先行車両9の車高が上記所定の閾値よりも大きいか否かを判定する。ステップS1235の判断の結果、肯定判断である場合には(S1235:YES)、検知カウント処理は、ステップS1265に移行する。一方、否定判断である場合には(S1235:NO)、検知処理は、ステップS1260に移行する。
 ステップS1240では、物標認識装置13は、自装置13内に用意されたハードウェアあるいはソフトウェアの第4のカウンタC4をインクリメントする。
 具体的には、物標認識装置13は、図14Bに例示され、自装置13内に用意された距離判定表を参照して、ステップS1210で判定した自車両1と先行車両9との間の距離が該当する第4のカウンタC4をインクリメントする。なお、この距離判定表は、図8Bに例示する距離判定表と同様であるが、異なる設定内容としてもよい。なお、第4のカウンタC4とは、車高が所定閾値未満である先行車両9が正常にレーダ認識された回数を示すカウンタであり、距離判定表に設定された距離領域ごとに設定されている。この後、物標認識装置13は、検知カウント処理を終了する。
 ステップS1245では、物標認識装置13は、自装置13内に用意されたハードウェアあるいはソフトウェアの第5のカウンタC5をインクリメントする。具体的には、物標認識装置13は、図14Bに例示され、自装置13内に用意された距離判定表を参照して、ステップS1210で判定した自車両1と先行車両9との間の距離が該当する第5のカウンタC5をインクリメントする。なお、第5のカウンタC5とは、車高が上記所定閾値以上である先行車両が正常にレーダ認識された回数を示すカウンタであり、距離判定表に設定された距離領域ごとに設定されている。その後、物標認識装置13は、検知カウント処理を終了する。
 ステップS1250では、物標認識装置13は、自装置30内に用意されたハードウェアあるいはソフトウェアの第6のカウンタC6をインクリメントする。
 具体的には、物標認識装置13は、図14Bに例示され、自装置13内に用意された距離判定表を参照して、ステップS1210で判定した自車両Vと先行車両との間の距離が該当する第6のカウンタC6をインクリメントする。なお、第6のカウンタC6とは、車高が上記所定閾値未満である先行車両が非正常にレーダ認識された回数を示すカウンタであり、距離判定表に設定された距離領域ごとに設定されている。その後、物標認識装置13は、検知カウント処理を終了する。
 ステップS1255では、物標認識装置13は、自装置13内に用意されたハードウェアあるいはソフトウェアの第7のカウンタC7をインクリメントする。
 具体的には、物標認識装置13は、図14Bに例示され、自装置13内に用意された距離判定表を参照して、ステップS1210で判定した自車両1と先行車両9との間の距離が該当する第7のカウンタC7をインクリメントする。なお、第7のカウンタC7とは、車高が所定閾値以上である先行車両が非正常にレーダ認識された回数を示すカウンタであり、距離判定表に設定された距離領域ごとに設定されている。その後、物標認識装置13は、検知カウント処理を終了する。
 ステップS1260では、物標認識装置13は、自装置13内に用意されたハードウェアあるいはソフトウェアの第8のカウンタC8をインクリメントする。
 具体的には、物標認識装置13は、図14Bに例示され、自装置13内に用意された距離判定表を参照して、ステップS1215で判定した自車両1と先行車両9との間の距離が該当する第8のカウンタC8をインクリメントする。なお、第8のカウンタC8とは、車高が所定閾値未満である先行車両がレーザ認識はされずに画像認識のみされた回数を示すカウンタであり、距離判定表に設定された距離領域ごとに設定されている。その後、物標認識装置13は、検知カウント処理を終了する。
 ステップS1265では、物標認識装置13は、自装置13内に用意されたハードウェアあるいはソフトウェアの第9のカウンタC9をインクリメントする。
 具体的には、物標認識装置13は、図14Bに例示され、自装置13内に用意された距離判定表を参照して、ステップS1215で判定した自車両1と先行車両9との間の距離が該当する第9のカウンタC9をインクリメントする。なお、第9のカウンタC9とは、車高が所定閾値以上である先行車両がレーザ認識はされずに画像認識のみされた回数を示すカウンタであり、距離判定表に設定された距離領域ごとに設定されている。その後、物標認識装置13は、検知カウント処理を終了する。
 [3-2-2.物標双認識割合演算処理]
 次に、垂直軸ずれ診断処理のS200にて実行する物標双認識割合演算処理について図15A~図15Cを用いて説明する。
 まず、物標認識装置13は、図15Aに示すように、第4のカウンタC4の値それぞれに、対応する所定の第4の係数を乗算し、第5のカウンタC5の値それぞれに、対応する所定の第5の係数を乗算する。そして、物標認識装置13は、乗算により得られた第4のカウンタC4の値と乗算により得られた対応する第5のカウンタC5の値とを加算する。この結果、距離判定表に設定された距離領域ごとに、第1のカウント加算値が得られる。
 物標認識装置13は、図15Aに示すように、第6のカウンタC6の値それぞれに、対応する所定の第6の係数を乗算し、第7のカウンタC7の値それぞれに、対応する所定の第7の係数を乗算する。そして、物標認識装置13は、乗算により得られた第6のカウンタC6の値と乗算により得られた対応する第7のカウンタC7の値とを加算する。この結果、距離判定表に設定された距離領域ごとに、第2のカウント加算値が得られる。
 さらに、物標認識装置13は、図15Aに示すように、第8のカウンタC8の値それぞれに、対応する所定の第8の係数を乗算し、第9のカウンタC9の値それぞれに、対応する所定の第9の係数を乗算する。そして、物標認識装置30は、乗算により得られた第8のカウンタC8の値と乗算により得られた対応する第9のカウンタC9の値とを加算する。この結果、距離判定表に設定された距離領域ごとに、第3のカウント加算値が得られる。
 なお、第4~第9の係数については、対応するそれぞれのカウンタに対して重み付けを行うために、実験等により予め設定される。
 続いて、物標認識装置13は、物標双認識割合を算出する。具体的には、物標認識装置13は、距離判定表に設定された距離領域ごとに、第1のカウント加算値を、第1のカウント加算値、第2のカウント加算値および第3のカウント加算値とを加算した値で除算することにより、物標双認識割合を算出する(百分率(%)で表す、図15B参照)。
 この後、物標認識装置13は、物標双認識割合演算処理を終了する。
 [3-2-2.非正常認識割合演算処理]
 次に、垂直軸ずれ診断処理のS300にて実行される非正常認識割合演算処理について図15A~図15Cを用いて説明する。
 まず、物標認識装置13は、図15Aに示すように、第4のカウンタC4の値それぞれに、対応する所定の第4の係数を乗算し、第5のカウンタC5の値それぞれに、対応する所定の第5の係数を乗算する。そして、物標認識装置13は、乗算により得られた第4のカウンタC4の値と乗算により得られた対応する第5のカウンタC5の値とを加算する。この結果、距離判定表に設定された距離領域ごとに、第1のカウント加算値が得られる。
 続いて、物標認識装置13は、図15Aに示すように、第6のカウンタC6の値それぞれに、対応する所定の第6の係数を乗算し、第7のカウンタC7の値それぞれに、対応する所定の第7の係数を乗算する。そして、物標認識装置13は、乗算により得られた第6のカウンタC6の値と乗算により得られた対応する第7のカウンタC7の値とを加算する。この結果、距離判定表に設定された距離領域ごとに、第2のカウント加算値が得られる。
 続いて、物標認識装置13は、非正常認識割合を算出する。具体的には、物標認識装置13は、距離判定表に設定された距離領域ごとに、第1のカウント加算値を、第1のカウント加算値および第2のカウント加算値とを加算した値で除算することにより、非正常認識割合を算出する(百分率(%)で表す、図15C参照)。
 この後、物標認識装置13は、非正常認識割合演算処理を終了する。
 [3-3.効果]
 以上詳述した第3実施形態によれば、前述した第1実施形態の効果に加え、以下の効果が得られる。
 第3の実施形態の物標認識装置13は、垂直軸ずれ診断処理(検知カウント処理)において、先行車両9の車高別に前記物標双認識割合および非正常認識割合を算出し、その算出した車高別の前記物標双認識割合および非正常認識割合に応じてレーダセンサ11に生じた垂直面内での軸ずれを検出する。これにより、より精度よく軸ずれを検出することができる。
 また、物標認識装置13は、垂直軸ずれ診断処理(検知カウント処理)において、認識した先行車両9の車高が所定閾値よりも大きいか否かを判定し、車高が所定閾値よりも大きい先行車両9については除外して前記物標双認識割合および非正常認識割合を算出する。これにより、より精度よく軸ずれを検出することができる。
 [4.他の実施形態]
 以上、本発明の第1~第3の実施形態について説明したが、本発明は、上記第1~第3の実施形態に限定されることなく、種々の形態を採り得ることは言うまでもない。
 上記各実施形態では、物標認識装置13は、垂直軸ずれ診断処理において、レーダセンサ11の垂直方向への軸ずれ量を検出していたが、これに限らず、レーダセンサ11の垂直方向への軸ずれが発生しているか否かだけを検出するようにしてもよい。
 上記各実施形態では、レーダセンサ11の検知範囲の中心軸Mと水平方向(x軸方向)とのなす角度、およびう垂直方向(y軸)とのなす角度に基づいて、それぞれ水平方向における軸ずれ、および垂直方向における軸ずれを定義していたが、これに限るものではない。軸ずれを定義するためのレーダセンサ11の軸は中心軸Mとは異なる軸であってもよく、例えばレーダセンサ11を起点として物標の探索範囲に向かって延びる軸を定め、この軸について水平方向における軸ずれ、および垂直方向における軸ずれを定義してもよい。
 上記第2実施形態において物標認識装置13が実行するレーダ軸ずれ診断処理(図13参照)の垂直軸ずれ診断処理(S30)に、上記第3実施形態に記載の垂直軸ずれ診断処理を適用してもよい。この場合、S40で実行するカウンタリセット処理では、図14のフローチャートに示す各種カウンタ、すなわち、第4~第9のカウンタを全てリセットする。
 上記各実施形態では、物標認識装置13は、レーダセンサ11の水平方向における軸ずれを、レーダセンサ11および画像センサ12を用いて検出していたが、これに限るものではなく、種々の方法で検出してよい。
 例えば、物標認識装置13は、画像センサ12を用いて自車両1の走行路に備えられている標識等を検出し、該標識等の位置(横位置)の変化に基づいて、レーダセンサ11の水平方向における軸ずれを検出してもよい。すなわち、一例として図16(a)に示すように、レーダセンサ11の水平方向における軸ずれが生じていない場合(ここでは、レーダセンサ11の検知範囲の中心軸Mが自車両1の進行方向(x軸)に一致している場合を、レーダセンサ11の水平方向における軸ずれが生じていないものとする)、自車両1の走行路にて検出された標識Qの横位置(中心軸Mに対して垂直な方向における位置)Eは、自車両1と標識Qとの距離に関係なく、一定値として検出される。これに対して、レーダセンサ11の水平方向の軸ずれが発生している場合は、一例として図16(b)に示すように、自車両1の走行路にて検出された標識Qの横位置E1は、自車両1と標識Qとの距離に応じて変化する。そこで、このような変化に応じて、物標認識装置13は、レーダセンサ11の検知範囲の中心軸M1の水平方向における軸ずれ、及びその軸ずれ量を検出するようにしてもよい。
 上記各実施形態における1つの構成要素が有する機能を複数の構成要素として分散させたり、複数の構成要素が有する機能を1つの構成要素に統合したりしてもよい。また、上記各実施形態の構成の少なくとも一部を、同様の機能を有する公知の構成に置き換えてもよい。また、上記各実施形態の構成の一部を、課題を解決できる限りにおいて省略してもよい。また、上記各実施形態の構成の少なくとも一部を、他の上記実施形態の構成に対して付加、置換等してもよい。なお、特許請求の範囲に記載の文言から特定される技術思想に含まれるあらゆる態様が本発明の実施形態である。
 本発明は、前述した運転支援システム10及び物標認識装置13の他、当該物標認識装置13を機能させるためのプログラム、このプログラムを記録した媒体、軸ずれ診断方法など、種々の形態で実現することができる。
 1…自車両 10…運転支援システム 11…レーダセンサ 12…画像センサ 13…物標認識装置 14…運転支援実行装置 31…CPU。

Claims (6)

  1.  車両に搭載されて探査ビームを送信し、該探査ビームに基づく反射ビームを受信するビームセンサ(11)の診断装置であって、
     前記探査ビームの、車幅方向に対応する水平方向における設計ビーム軸位置に対する軸ずれである水平軸ずれが発生しているか否かを表す水平軸ずれ情報を取得する取得手段(13c、S10)と、
     前記探査ビームに対し、車高方向に対応する垂直方向における設計ビーム軸位置に対する軸ずれである垂直軸ずれが発生しているか否かを診断する診断手段(13e、S30)と、
     前記水平軸ずれ情報に基づいて、前記診断手段による前記垂直軸ずれの診断を実行するか否かを判断し、前記水平軸ずれ情報が前記水平方向における軸ずれが発生していないことを表している場合は、前記診断手段による診断を実行し、前記水平軸ずれ情報が前記水平方向における軸ずれが発生していることを表している場合は、前記診断手段による診断を禁止する判断手段(13d、S20)と、
    を備えたことを特徴とする診断装置。
  2.  請求項1に記載の診断装置であって、
     前記診断手段は、前記垂直軸ずれが発生していると判断した場合、その垂直軸ずれにおける前記探査ビームの前記設計ビーム軸位置に対するずれ量を垂直軸ずれ量として検出することを特徴とする診断装置。
  3.  請求項2に記載の診断装置であって、
     前記ビームセンサによる前記反射ビームを受信した結果から、自車両の前方に対する第1の物標認識処理を繰り返し行うビーム認識手段(13a)と、
     画像センサ(20)により撮像された自車両の前方の撮像画像に基づき、自車両の前方に対する第2の物標認識処理を繰り返し行う画像認識手段(13b)と、を備え、
     前記診断手段は、
     前記ビーム認識手段(13a)による前記第1の物標認識処理の結果、および前記画像認識手段(13b)による前記第2の物標認識処理の結果に基づいて、前記自車両前方を走行する少なくとも1つの先行車両を第1の物標認識処理および第2の物標認識処理の双方で認識した回数と、当該少なくとも1つの先行車両を、第1物標認識処理または第2の物標認識処理の少なくとも一方で認識した回数との関係を求め、求めた関係に応じて、前記ビームセンサ(11)の探査ビーム軸を含む垂直面内における該探査ビーム軸の設計ビーム軸位置に対する軸ずれ量を前記垂直軸ずれ量として検出する軸ずれ検出手段(ステップS100~S400)と、
    を備えたことを特徴とする診断装置。
  4.  請求項3に記載の診断装置であって、
     前記ビーム認識手段は、前記少なくとも1つの先行車両を前記第1の物標認識処理により認識した回数をカウントするビーム認識用カウンタ(C1)を備え、
     前記画像認識手段は、前記少なくとも1つの先行車両を前記第2の物標認識処理により認識した回数をカウントする画像認識用カウンタ(C3)を備え、
     前記診断装置は、前記判断手段により前記水平軸ずれ情報が前記水平方向における軸ずれが発生していることを表している場合は、前記ビーム認識用カウンタおよび画像認識用カウンタによりそれぞれカウントされたカウント値をリセットするリセット手段(13f、ステップS40)を備えたことを特徴とする診断装置。
  5.  請求項3に記載の診断装置であって、
     前記少なくとも1つの先行車両は、前記第1の物標認識処理により正常に認識された先行車両と非正常に認識された先行車両とを含んでおり、
     前記軸ずれ検出手段は、前記自車両前方を走行する少なくとも1つの先行車両を第1の物標認識処理および第2の物標認識処理の双方で認識した回数、当該第1の物標認識処理および第2の物標認識処理の双方で非正常に認識した回数、および前記第2の物標認識処理単独で認識した回数の総和に対する、当該少なくとも1つの先行車両を、前記第1の物標認識処理および第2の物標認識処理の双方で認識した回数の割合を算出し、その算出した割合の値に応じて、前記ビームセンサ(11)の探査ビーム軸を含む垂直面内における該探査ビーム軸の設計ビーム軸位置に対する軸ずれ量を前記垂直軸ずれ量として検出することを特徴とする診断装置。
  6.  請求項5に記載の診断装置であって、
     前記ビーム認識手段は、前記少なくとも1つの先行車両を前記第1および第2の物標認識処理の双方で正常に認識した回数をカウントする第1のカウンタ(C1)と、前記少なくとも1つの先行車両を前記第1および第2の物標認識処理の双方で非正常に認識した回数をカウントする第2のカウンタ(C2)と、を備え、
     前記画像認識手段は、前記少なくとも1つの先行車両を前記第2の物標認識処理単独で認識した回数をカウントする第3のカウンタ(C3)を備え、
     前記診断装置は、前記判断手段により前記水平軸ずれ情報が前記水平方向における軸ずれが発生していることを表している場合は、前記第1~第3のカウンタによりそれぞれカウントされたカウント値をリセットするリセット手段(13、ステップS40)を備えたことを特徴とする診断装置。
PCT/JP2015/074249 2014-08-27 2015-08-27 軸ずれ診断装置 WO2016031918A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
DE112015003914.7T DE112015003914T5 (de) 2014-08-27 2015-08-27 Vorrichtung zum Erfassen einer axialen Fehlausrichtung
CN201580046129.9A CN106605153B (zh) 2014-08-27 2015-08-27 轴偏移诊断装置
US15/506,396 US10539659B2 (en) 2014-08-27 2015-08-27 Apparatus for detecting axial misalignment

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2014173074A JP6323256B2 (ja) 2014-08-27 2014-08-27 検出装置
JP2014-173074 2014-08-27

Publications (1)

Publication Number Publication Date
WO2016031918A1 true WO2016031918A1 (ja) 2016-03-03

Family

ID=55399802

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2015/074249 WO2016031918A1 (ja) 2014-08-27 2015-08-27 軸ずれ診断装置

Country Status (5)

Country Link
US (1) US10539659B2 (ja)
JP (1) JP6323256B2 (ja)
CN (1) CN106605153B (ja)
DE (1) DE112015003914T5 (ja)
WO (1) WO2016031918A1 (ja)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6475543B2 (ja) * 2015-03-31 2019-02-27 株式会社デンソー 車両制御装置、及び車両制御方法
US10852418B2 (en) * 2016-08-24 2020-12-01 Magna Electronics Inc. Vehicle sensor with integrated radar and image sensors
CN109425852B (zh) * 2017-08-21 2021-05-14 比亚迪股份有限公司 汽车及车载雷达的标定方法、装置
JP6904208B2 (ja) * 2017-10-10 2021-07-14 トヨタ自動車株式会社 軸ずれ判定装置
JP6970065B2 (ja) * 2018-09-06 2021-11-24 株式会社Soken 物体検出装置

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002174684A (ja) * 2000-12-08 2002-06-21 Omron Corp 測距装置の軸調整方法
US6809806B1 (en) * 2003-05-27 2004-10-26 International Truck Intellectual Property Company, Llc Apparatus and method for verifying the beam axis of front-looking land vehicle transceiver antenna
JP2008203179A (ja) * 2007-02-22 2008-09-04 Mitsubishi Electric Corp 電波軸調整装置および電波軸調整方法
JP2008215912A (ja) * 2007-03-01 2008-09-18 Mazda Motor Corp 車両用障害物検知装置

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0655142B1 (en) 1992-08-14 1999-06-23 Vorad Safety Systems, Inc. Smart blind spot sensor
US5517196A (en) 1992-08-14 1996-05-14 Pakett; Allan G. Smart blind spot sensor with object ranging
JP4698087B2 (ja) * 2001-08-15 2011-06-08 富士通テン株式会社 レーダの水平方向軸ずれ発生検出装置、軸ずれ量決定装置、および軸ずれ補正装置
JP2004085258A (ja) 2002-08-23 2004-03-18 Hitachi Ltd レーダ装置
JP4019933B2 (ja) 2002-12-26 2007-12-12 日産自動車株式会社 車両用レーダ装置およびレーダの光軸調整方法
JP3936713B2 (ja) 2004-09-24 2007-06-27 三菱電機株式会社 車両用後側方警報装置
KR20120106143A (ko) 2011-03-17 2012-09-26 현대모비스 주식회사 차량 레이더의 수평 또는 수직 방향으로의 얼라인먼트 방법
JP2012194169A (ja) * 2011-03-17 2012-10-11 Hyundai Mobis Co Ltd 車両レーダーのアライメント方法及びシステム
JP6428270B2 (ja) 2014-02-10 2018-11-28 株式会社デンソー 軸ずれ検出装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002174684A (ja) * 2000-12-08 2002-06-21 Omron Corp 測距装置の軸調整方法
US6809806B1 (en) * 2003-05-27 2004-10-26 International Truck Intellectual Property Company, Llc Apparatus and method for verifying the beam axis of front-looking land vehicle transceiver antenna
JP2008203179A (ja) * 2007-02-22 2008-09-04 Mitsubishi Electric Corp 電波軸調整装置および電波軸調整方法
JP2008215912A (ja) * 2007-03-01 2008-09-18 Mazda Motor Corp 車両用障害物検知装置

Also Published As

Publication number Publication date
CN106605153A (zh) 2017-04-26
US20170254881A1 (en) 2017-09-07
JP2016048194A (ja) 2016-04-07
CN106605153B (zh) 2020-06-19
DE112015003914T5 (de) 2017-05-11
JP6323256B2 (ja) 2018-05-16
US10539659B2 (en) 2020-01-21

Similar Documents

Publication Publication Date Title
JP6212880B2 (ja) 物標認識装置
CN105980880B (zh) 射束传感器的轴偏移检测装置
WO2016031918A1 (ja) 軸ずれ診断装置
JP6622167B2 (ja) 軸ずれ推定装置
US20180005056A1 (en) Object recognition device
US11346922B2 (en) Object recognition apparatus and object recognition method
JP2015155878A (ja) 車両用障害物検出装置
WO2017104503A1 (ja) 移動体制御装置及び移動体制御方法
JP6477453B2 (ja) 物体検知装置、物体検知方法
JP2017182696A (ja) 物体認識装置及び物体認識方法
JP2014153874A (ja) 物標認識装置
US20200249347A1 (en) Object detection device
US20180149740A1 (en) Object detection apparatus and object detection method
WO2016031919A1 (ja) 軸ずれ診断装置
JP5846472B2 (ja) 車両の物体検出装置
WO2015119298A1 (ja) ビームセンサの軸ずれ検出装置
JP2012088285A (ja) 障害物認識装置及び障害物認識方法
JP7028722B2 (ja) 軸ずれ角検出装置
JP6818902B6 (ja) 車両検知システム
CN115144857A (zh) 一种探测目标个数估计方法、装置、电子设备及存储介质

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 15835737

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 15506396

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 112015003914

Country of ref document: DE

122 Ep: pct application non-entry in european phase

Ref document number: 15835737

Country of ref document: EP

Kind code of ref document: A1