WO2021065998A1 - 測距装置、及び、測距装置の窓の汚れを検出する方法 - Google Patents

測距装置、及び、測距装置の窓の汚れを検出する方法 Download PDF

Info

Publication number
WO2021065998A1
WO2021065998A1 PCT/JP2020/037118 JP2020037118W WO2021065998A1 WO 2021065998 A1 WO2021065998 A1 WO 2021065998A1 JP 2020037118 W JP2020037118 W JP 2020037118W WO 2021065998 A1 WO2021065998 A1 WO 2021065998A1
Authority
WO
WIPO (PCT)
Prior art keywords
measuring device
window
distance measuring
light receiving
unit
Prior art date
Application number
PCT/JP2020/037118
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
Priority claimed from JP2020159470A external-priority patent/JP7447752B2/ja
Application filed by 株式会社デンソー filed Critical 株式会社デンソー
Priority to CN202080069439.3A priority Critical patent/CN114502984A/zh
Publication of WO2021065998A1 publication Critical patent/WO2021065998A1/ja
Priority to US17/657,667 priority patent/US20220221565A1/en

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
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • G01S17/08Systems determining position data of a target for measuring distance only
    • G01S17/10Systems determining position data of a target for measuring distance only using transmission of interrupted, pulse-modulated waves
    • 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/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/497Means for monitoring or calibrating
    • 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
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar 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/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/4808Evaluating distance, position or velocity data
    • 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/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/481Constructional features, e.g. arrangements of optical elements
    • G01S7/4817Constructional features, e.g. arrangements of optical elements relating to scanning
    • 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/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/497Means for monitoring or calibrating
    • G01S2007/4975Means for monitoring or calibrating of sensor obstruction by, e.g. dirt- or ice-coating, e.g. by reflection measurement on front-screen
    • G01S2007/4977Means for monitoring or calibrating of sensor obstruction by, e.g. dirt- or ice-coating, e.g. by reflection measurement on front-screen including means to prevent or remove the obstruction

Definitions

  • the present disclosure relates to a technique for detecting dirt on a window of a distance measuring device.
  • JP2016-176750A discloses a ranging device that irradiates pulsed light, receives reflected light reflected by an external object, and measures the distance from the flight time of the light to the external object.
  • the window of the distance measuring device becomes dirty, the S / N ratio decreases and the distance to an external object cannot be measured accurately.
  • the actual situation has been that the technique for detecting whether or not the window of the distance measuring device is dirty has not been sufficiently studied.
  • a ranging device uses a light emitting unit that emits pulsed light, a light receiving unit that receives reflected light of the pulsed light reflected by an external object, and a flight time of the reflected light received by the light receiving unit.
  • a light emitting unit that emits pulsed light
  • a light receiving unit that receives reflected light of the pulsed light reflected by an external object
  • a flight time of the reflected light received by the light receiving unit is provided.
  • a case in which the calculation unit for calculating the distance to the external object, the light emitting unit and the light receiving unit are accommodated, and a case having a window for passing the pulsed light and the reflected light is predetermined.
  • the window is provided with a determination unit for determining that the window is dirty, and the stain determination condition is "in at least one pixel within the viewing range of the distance measuring device, the said The first condition is included that the light receiving intensity at a specific flight time corresponding to the distance of the light path from the light emitting unit to the window is equal to or greater than the intensity threshold.
  • this distance measuring device when the dirt detection condition is satisfied for the light receiving intensity at a specific flight time, it is determined that the window is dirty, so it is detected from the light receiving intensity whether or not the window is dirty. It is possible.
  • FIG. 1 is a schematic configuration diagram of a distance measuring device.
  • FIG. 2 is a schematic configuration diagram showing an optical system.
  • FIG. 3 is an explanatory diagram schematically showing the configuration of the light receiving array.
  • FIG. 4 is an explanatory diagram schematically showing the configuration of the light receiving element included in the pixel.
  • FIG. 5 is a schematic configuration diagram of the calculation determination unit.
  • FIG. 6 is a histogram of the initial state with no stains on the windows.
  • FIG. 7 is a histogram of the window dirt detection process.
  • FIG. 8 is an explanatory diagram schematically showing the configuration of a light receiving array including pixels for detecting stains.
  • FIG. 9 is an explanatory diagram showing a state in which distance measurement and dirt detection are performed for each pixel block.
  • FIG. 10 is a flowchart showing the procedure of the window dirt detection process.
  • FIG. 11 is an explanatory diagram showing a case where the window is dirty at a plurality of pixel positions within the visual field range
  • the distance measuring device 20 is housed in a case 90 having a window 92 on the front surface.
  • a cleanup unit 400 that executes a removing operation for removing dirt on the window of the window 92 is provided.
  • the cleanup unit 400 of the present embodiment includes the washer units 410 and 411 and the heater unit 420.
  • the washer portions 410 and 411 are used to remove dirt on the surface of the window 92 by injecting water onto the surface of the window 92.
  • a first washer portion 410 for removing dirt on the left side of the window 92 and a second washer portion 411 for removing dirt on the right side of the window 92 are provided, but three or more washer portions are provided. May be good.
  • a plurality of washer portions each of which is in charge of removing dirt from a plurality of different regions of the window 92, may be provided.
  • one washer portion may be used to remove dirt on the entire window 92.
  • air may be injected instead of water, or the washer portion may be configured so that both water and air can be injected.
  • the heater unit 420 is used to heat the window 92 with a heater wire provided along the window 92 to melt snow or ice adhering to the surface of the window 92.
  • the cleanup unit 400 a configuration other than these may be adopted.
  • a wiper unit that wipes the window 92 may be used as the cleanup unit 400.
  • the distance measuring device 20 includes an optical system 30 that emits pulsed light for distance measurement and receives reflected light from an external object, and an arithmetic determination unit 100 that processes a signal obtained from the optical system 30.
  • the external object is also called an "object” or “target”.
  • the optical system 30 includes a light emitting unit 40 that emits laser light as pulsed light, a scanning unit 50 that scans the laser light within a predetermined viewing range 80, and incident light including reflected light and ambient light from an external object.
  • a light receiving unit 60 for receiving light is provided.
  • the range finder 20 is, for example, an in-vehicle LiDAR (Laser Imaging Detection and Ringing) mounted on a vehicle such as an automobile.
  • the horizontal direction of the visual field range 80 coincides with the horizontal direction X
  • the vertical direction coincides with the vertical direction Y.
  • Information such as the distance measured by the distance measuring device 20 is received and used by the distance receiving unit 500 which is an external device.
  • the distance receiving unit 500 has a notification unit 510 that notifies the user of various types of information.
  • the notification unit 510 is, for example, a display unit, a speaker, or the like provided in the guest room.
  • the distance receiving unit 500 is, for example, a control device including an ECU (Electronic Control Unit) of the vehicle.
  • the light emitting unit 40 includes a semiconductor laser element (hereinafter, also simply referred to as a laser element) 41 that emits a laser beam for distance measurement, a circuit board 43 incorporating a drive circuit of the laser element 41, and a circuit board 43.
  • a collimating lens 45 for converting a laser beam emitted from a laser element 41 into parallel light is provided.
  • the laser element 41 is a laser diode capable of oscillating a so-called short pulse laser.
  • the laser element 41 constitutes a rectangular laser emitting region by arranging a plurality of laser diodes along the vertical direction.
  • the laser element 41 is also referred to as a "light source”.
  • the scanning unit 50 is composed of a so-called one-dimensional scanner.
  • the scanning unit 50 includes a mirror 54, a rotary solenoid 58, and a rotating unit 56.
  • the mirror 54 reflects the laser beam that is collimated by the collimated lens 45.
  • the rotary solenoid 58 receives a control signal from the calculation determination unit 100 and repeats forward rotation and reverse rotation within a predetermined angle range.
  • the rotating portion 56 is driven by the rotary solenoid 58, repeats forward rotation and reverse rotation on a rotating axis with the vertical direction as the axial direction, and scans the mirror 54 in one direction along the horizontal direction.
  • the laser beam incident from the laser element 41 via the collimating lens 45 is reflected by the mirror 54 and scanned along the horizontal direction by the rotation of the mirror 54.
  • the visual field range 80 shown in FIG. 1 corresponds to the scanning range of the irradiation light. Since the light receiving intensity is obtained at each pixel position in the visual field range 80, the distribution of the light receiving intensity within the visual field range 80 constitutes a kind of image. Therefore, the field of view 80 can also be referred to as an "image area".
  • the scanning unit 50 may be omitted, and the light emitting unit 40 may emit pulsed light over the entire visual field range 80, and the light receiving unit 60 may receive the reflected light over the entire visual field range 80.
  • a set of data showing the distribution of light receiving intensity within the field of view 80 is also called a "frame". Distance measurement is performed frame by frame.
  • the laser beam output from the distance measuring device 20 is diffusely reflected on the surface of an external object such as a person or a car, and a part of the laser light is returned to the mirror 54 of the scanning unit 50 as reflected light.
  • This reflected light is reflected by the mirror 54, is incident on the light receiving lens 61 of the light receiving unit 60 as incident light together with the ambient light, is collected by the light receiving lens 61, and is incident on the light receiving array 65.
  • the light receiving array 65 is composed of a plurality of pixels 66 arranged two-dimensionally.
  • one pixel 66 is composed of a plurality of light receiving elements 68 arranged so as to have H elements in the horizontal direction and V elements in the vertical direction.
  • H and V are integers of 1 or more, respectively.
  • each of the five light receiving elements 68 is configured in the horizontal direction and the vertical direction.
  • the number (H ⁇ V) of the light receiving elements 68 constituting one pixel 66 is also referred to as “pixel size”.
  • SPAD Single Photon Avalanche Diode
  • the light receiving result of one pixel 66 is the light receiving intensity at one pixel position within the visual field range 80.
  • the "pixel 66" that constitutes the light receiving array 65 means hardware, and is used in a different meaning from the "pixel” that constitutes the visual field range 80.
  • the light receiving result of the pixel 66 is used as the light receiving intensity of one pixel within the visual field range 80, there is a correspondence relationship between the two.
  • Each light receiving element 68 connects a quenching resistor Rq and an avalanche diode Da in series between the power supply Vcc and the ground line, inputs the voltage at the connection point to the inverting element INV, and converts the voltage level into an inverted digital signal. I'm converting.
  • the output of the inverting element INV is input to one input terminal of the AND circuit SW.
  • the selection signal Sc is input to the other input terminal of the AND circuit SW.
  • the selection signal Sc is used to specify from which light receiving element 68 of the light receiving array 65 to read the signal.
  • the selection signal Sc for selecting a certain light receiving element 68 is switched from the low level to the high level, the output signal Sout reflecting the state of the avalanche diode Da is output from the light receiving element 68.
  • the timing of switching the selection signal Sc to the high level corresponds to the flight time of the reflected light. Therefore, after the light emission of one pulsed light, the selection signal Sc is switched from the low level to the high level at a plurality of timings corresponding to a plurality of flight times.
  • the output signal Sout is a pulse signal generated by receiving incident light including reflected light and ambient light in which the irradiation light is reflected by an external object existing in the scanning range and returned.
  • the output signals Sout of the light receiving element 68 at a plurality of flight times are sequentially input to the calculation determination unit 100.
  • the calculation determination unit 100 includes a calculation unit 200, a determination unit 300, and a storage unit 310.
  • the calculation unit 200 calculates the distance D to the external object OBJ by using the flight time Tf of the reflected light received by the light receiving unit 60.
  • the calculation unit 200 includes a control unit 210 that controls the entire calculation determination unit 100, an addition unit 220, a histogram generation unit 230, a peak detection unit 240, and a distance calculation unit 250.
  • the adder 220 is a circuit that adds the outputs of the light receiving elements 68 included in the pixels 66 constituting the light receiving array 65. When the incident light pulse is incident on one pixel 66, each light receiving element 68 included in the pixel 66 operates.
  • SPAD is used as the light receiving element 68
  • the pixel 66 is composed of a plurality of SPADs.
  • the SPAD can detect only one photon incident, but the detection of the SPAD by the limited light from the external object OBJ must be probabilistic.
  • the addition unit 220 adds the output signal Sout from the SPAD, which can detect the incident light only stochastically.
  • the histogram generation unit 230 generates a histogram of the light receiving intensity by adding the addition results of the addition unit 220 a plurality of times, and outputs the histogram to the peak detection unit 240.
  • This histogram is a graph showing the light receiving intensity at each of a plurality of flight times.
  • the light receiving intensity is the total number of received SPADs in one pixel 66. Multiple flight times are set at regular intervals.
  • the peak detection unit 240 analyzes the light receiving intensity of the histogram input from the histogram generation unit 230, detects the peak of the light receiving intensity, and determines the flight time of the detected peak.
  • the flight time of the detected peak corresponds to the flight time Tf of the light reflected by the external object OBJ.
  • the distance calculation unit 250 calculates the distance D to the external object OBJ by using the flight time Tf of light.
  • the determination unit 300 executes the dirt detection process of the window 92 by using the light receiving intensity of the light receiving unit 60.
  • the determination unit 300 uses the histogram generated by the histogram generation unit 230 as information representing the light reception intensity in the light receiving unit 60. The details of the dirt detection process of the window 92 will be described later.
  • the cleanup unit 400 executes a removing operation for removing the dirt on the window 92 in response to an instruction from the determination unit 300.
  • a temperature sensor 320 for measuring the outside air temperature is connected to the determination unit 300. However, the temperature sensor 320 can be omitted.
  • the storage unit 310 stores the distribution of the threshold value set values within the visual field range 80 of the distance measuring device 20.
  • the “threshold value set value” is a value used for determining the intensity threshold value used in the window stain detection process, and is set in advance and stored in the storage unit 310. The intensity threshold value and the threshold value set value will be described later.
  • the histogram generated by the histogram generation unit 230 is a graph showing the light receiving intensity I at each of the plurality of flight times Tf.
  • FIG. 6 shows an example of a histogram in an initial state in which the window 92 is clean
  • FIG. 7 shows an example of a histogram in the window dirt detection process.
  • the meanings of the symbols used in FIGS. 6 and 7 are as follows. A symbol having a trailing end of "0" indicates an initial state, and a symbol having a trailing end of "1" indicates a window stain detection process.
  • the meaning of the reference numerals during the window stain detection process shown in FIG. 7 will be mainly described.
  • CL0, CL1 Clutter peak
  • the clutter peak CL1 is a peak of the light receiving intensity that appears at a specific flight time Tc corresponding to the distance of the optical path from the light emitting unit 40 to the window 92.
  • the light reflected by the window 92 is called "clutter light”.
  • Tc Flight time of clutter peak
  • the flight time Tc of clutter peak is a specific flight time corresponding to the distance of the optical path from the light emitting unit 40 to the window 92.
  • TP0, TP1 Target peak
  • the target peak TP1 is a peak of the light receiving intensity corresponding to the reflected light from an external object.
  • Tt Flight time of the target peak
  • Tt of the target peak is the flight time corresponding to the distance from the light emitting unit 40 to the external object.
  • Imax Maximum value that the light receiving intensity I can take
  • the maximum value Imax that the light receiving intensity I can take is the total number of light receiving elements 68 per pixel used when creating a histogram. As described with reference to FIG. 4, one pixel 66 is composed of H ⁇ V light receiving elements 68.
  • N is an integer of 2 or more and the light receiving results obtained by N times of light emission are summed to create a histogram, the maximum value Imax that the light receiving intensity I can take is equal to N ⁇ H ⁇ V.
  • H0, H1 Clutter peak level
  • the clutter peak level H1 is an absolute value of the height of the clutter peak CL1.
  • the clutter peak level H1 is also simply referred to as “peak level H1” or “light receiving intensity H1”.
  • It0, It1 Intensity threshold value of clutter peak
  • the intensity threshold value It1 of the clutter peak CL1 is set to “at least one pixel in the field of view 80 of the distance measuring device 20 at a specific flight time Tc” among the stain detection conditions. It is used when determining whether or not the first condition of "the light receiving intensity is equal to or higher than the intensity threshold value It1" is satisfied.
  • the intensity threshold value It1 is usually set to a value smaller than the maximum value Imax that the light receiving intensity I can take, but it may be set to a value equal to the maximum value Imax.
  • the method for determining the intensity threshold value It1 during the window stain detection process will be described later.
  • BL0, BL1 Histogram baseline level
  • the histogram baseline level BL1 is the average value of signal values other than peaks in the histogram.
  • Threshold value setting value This threshold value setting value ⁇ is a value obtained by subtracting the baseline level BL1 from the intensity threshold value It1. In other words, the intensity threshold It1 can be determined by adding the threshold setting value ⁇ to the base line level BL1.
  • the effective signal range width (Imax-BL1) is a value obtained by subtracting the baseline level BL1 from the maximum value Imax that the light receiving intensity I can take. ..
  • the target peak TP0 corresponding to the reflected light from the external object appears.
  • the distance to the external object is determined from the flight time Tt of the target peak TP0.
  • the histogram of FIG. 6 also includes a clutter peak CL0 as a peak for the reflected light at the window 92.
  • the clutter peak CL0 is the light receiving intensity at a specific flight time Tc corresponding to the distance of the optical path from the light emitting unit 40 to the window 92.
  • the clutter peak CL0 has a state in which the window 92 is clean, for example, a peak level H0 at the time of shipment from the factory (hereinafter, referred to as “initial clutter peak level H0”).
  • the specific flight time Tc at which the clutter peak CL0 appears is different for each pixel position within the visual field range 80.
  • the reason for this is that in FIG. 1, the optical path length of the optical path from the light emitting unit 40 to the window 92 is different for each pixel position in the visual field range 80. Further, the initial clutter peak level H0 at each pixel position is also usually different for each pixel position.
  • the position where the window 92 exists is not the target of distance measurement, so it is not necessary to acquire the measured value of the light receiving intensity I at the specific flight time Tc where the clutter peak CL1 appears.
  • one feature is that the measured value of the light receiving intensity I is acquired at a specific flight time Tc.
  • the levels of the target peak TP1 and the clutter peak CL1 in the histogram during the window stain detection process are usually different from the levels of the target peak TP0 and the clutter peak CL0 in the initial state.
  • the window 92 when the window 92 is dirty, its clutter peak level H1 is higher than the initial clutter peak level H0. Further, when the window 92 is dirty, the level of the target peak TP1 for the same external object is often low.
  • the baseline level BL1 during the window dirt detection process is affected by the external environment such as the presence or absence of an external light source such as the sun. For example, in the presence of strong sunlight, the baseline level BL1 shows extremely high values. At this time, the clutter peak level H1 is similarly increased. Therefore, it is preferable to adaptively determine the intensity threshold value It1 at the time of the window stain detection process in consideration of such an influence of the external environment. This point will be described later.
  • the following methods A to C can be considered.
  • Method for determining intensity threshold A> The intensity threshold value It1 at the time of window dirt detection processing is set to a constant value.
  • the intensity threshold value It1 may be set to one value common to all the pixels in the visual field range 80, or the intensity threshold value It1 may be set for each pixel in the visual field range 80. It may be stored as a threshold setting value in the storage unit 310. In the former case, the storage unit 310 can be omitted.
  • the intensity threshold value It1 is set for each pixel in the visual field range 80, the intensity threshold value It1 higher than the initial clutter peak level H0 for each pixel can be set, so that the window stain detection process can be performed more accurately. It has the advantage of being able to be executed.
  • the threshold value setting value ⁇ is a value set in advance so that the calculation result (BL0 + ⁇ ) when the above equation (1) is applied to the initial state is sufficiently larger than the initial clutter peak level H0.
  • the threshold value setting value ⁇ may be set to one value common to all pixels in the visual field range 80, or a fixed intensity value ⁇ may be set for each pixel in the visual field range 80 and stored in the storage unit 310. It may be stored in.
  • the threshold value setting value ⁇ may be determined according to the pixel size (H ⁇ V) and the number of times of light emission N when generating the histogram.
  • ⁇ 0 is a predetermined constant value.
  • the pixel size (H ⁇ V) is the number of SPADs included in one pixel 66, as described in FIG.
  • the effective signal range width (Imax-BL1) is multiplied by the threshold setting value ⁇ which is a coefficient less than 1, and the value obtained by adding the baseline level BL1 to the multiplication result is defined as the intensity threshold It1 at the time of window stain detection processing. ..
  • the threshold setting value ⁇ is set in advance so that the calculation result ⁇ (Imax-BL0) ⁇ ⁇ + BL0 ⁇ when the above equation (2) is applied to the initial state is sufficiently larger than the initial clutter peak level H0. Value.
  • the threshold value setting value ⁇ may be set to one value common to all pixels in the visual field range 80, or may be set for each pixel in the visual field range 80 and stored in the storage unit 310.
  • this method C similarly to the above-mentioned method B, there is an advantage that the intensity threshold value It1 at the time of window stain detection processing can be adaptively determined in consideration of the influence of the external environment. Further, in this method C, even when the light from the outside is extremely strong and the baseline level BL1 becomes high, the intensity threshold value It1 at the time of the window stain detection process is set to a value smaller than the maximum value Imax of the light receiving intensity. Since it can be maintained, there is an advantage that the window dirt detection process can be executed more accurately.
  • the threshold value set value used for determining the intensity threshold value It1 is different for each pixel in the visual field range 80, it is preferable to store the distribution of the threshold value set value in the visual field range 80 in the storage unit 310. It is preferable that the threshold value is stored at all the pixel positions in the field of view 80, but by storing the threshold value only at the thinned pixel positions, the distribution of the threshold value in the field of view 80 can be stored. You may try to remember it. In the latter case, when calculating the intensity threshold value It1 at each pixel position, the threshold value set value at each pixel position can be determined by interpolation.
  • a light receiving array 65a including a pixel 67 for detecting stains may be used in addition to the pixel 66 for distance measurement. That is, the light receiving unit 60 may include a pixel 67 for detecting stains on the window 92 in addition to the pixel 66 for measuring the distance.
  • the dirt detection pixel 67 is arranged in the vicinity of the distance measurement pixel 66. Specifically, when the window 92 is clean, the clutter light is not applied to the pixel 67 for dirt detection, and when the window 92 is dirty, the clutter light is applied to the pixel 67 for dirt detection. It is preferable that the pixel 67 for detecting stains is arranged as described above.
  • the clutter peak increases in the distance measurement pixel 66 and the clutter light to the periphery thereof increases. If the pixel 67 for dirt detection is arranged at this position, the presence or absence of dirt can be determined by the presence or absence of light input to the pixel 67, and there is an advantage that dirt detection can be realized by a simpler calculation.
  • a plurality of pixels 66 included in the light receiving array 65 may be divided into a plurality of pixel blocks and time-division processing may be performed, and distance measurement and dirt detection may be performed at the same timing.
  • a plurality of pixels 66 are divided into two pixel blocks, a pixel block A and a pixel block B, and when distance measurement is performed by one pixel block, the other pixel block is parallel to this. Detects dirt.
  • the plurality of pixels 66 included in the light receiving array 65 may be divided into three or more pixel blocks. In this case, dirt detection can be performed on at least one pixel block, and distance measurement can be performed on the other pixel block.
  • the window dirt detection process shown in FIG. 10 is executed under the control of the control unit 210.
  • step S100 it is determined whether or not the processing timing of the window dirt detection process has been reached.
  • the processing timing of the window dirt detection process may be, for example, every predetermined period during the normal distance measuring operation of the distance measuring device 20. Alternatively, the processing timing of the window dirt detection process may be set within a predetermined self-diagnosis period of the distance measuring device 20.
  • step S200 the determination unit 300 acquires the peak level H1 of the clutter peak CL1 from the histogram of the light receiving intensity.
  • step S300 the determination unit 300 determines whether or not the predetermined stain determination condition is satisfied. If the stain determination condition is not satisfied, the process returns to step S100 and waits until the next processing timing. On the other hand, if the dirt determination condition is satisfied, the process proceeds to step S400, which will be described later.
  • any one of the various stain determination conditions described below can be used.
  • ⁇ Dirt judgment condition 1> When only the first condition C1 below is satisfied, it is determined that the window 92 is dirty.
  • First condition C1 "In at least one pixel in the field of view 80 of the distance measuring device 20, the light receiving intensity H1 at a specific flight time Tc corresponding to the distance of the optical path from the light emitting unit 40 to the window 92 is the intensity. Must be above the threshold It1 ” Since the stain determination condition 1 is a condition looser than other stain determination conditions described later, there is an advantage that the possibility of overlooking the stain on the window 92 is low.
  • the success or failure of the first condition C1 is preferably determined regardless of whether or not the histogram contains the target peak TP1. This has the advantage that dirt on the window 92 can be detected even when the histogram contains the target peak TP1.
  • Second condition C2a "The number of pixels in which the light receiving intensity H1 at a specific flight time Tc is equal to or greater than the intensity threshold It1 within the visual field range 80 is equal to or greater than the number threshold which is an integer of 2 or more.”
  • this stain determination condition 2 in FIG. 7 when there are a plurality of pixels in the visual field range 80 in which the peak level H1 of the clutter peak CL1 is equal to or higher than the intensity threshold value It1, it is determined that the window 92 is dirty. There is an advantage that the dirt of 92 can be determined more reliably.
  • Second condition C2b "In the field of view 80, there is a pixel aggregate in which a plurality of pixels having a light receiving intensity H1 at a specific flight time Tc equal to or higher than an intensity threshold It1 are continuous with each other, and a pixel set. The number of pixels in the body must be greater than or equal to a predetermined number threshold. " In the stain determination condition 3, as shown in FIG.
  • a plurality of pixels having a light receiving intensity H1 at a specific flight time Tc of which the intensity threshold value It1 or more are formed on each other within the visual field range 80 due to the contamination of the window 92.
  • the pixel aggregate PA is continuously formed.
  • the phrase "two pixels are continuous with each other” means that one of the pixels is present at any of the four adjacent positions on the top, bottom, left, and right of the other pixel.
  • the window 92 is dirty, the dirt is often attached to a cohesive area in the window 92. Therefore, as shown in FIG. 11, the light receiving intensity H1 at a specific flight time Tc is the intensity threshold value It1.
  • the plurality of pixels as described above usually form a pixel aggregate PA within the visual field range 80. Therefore, the stain determination condition 3 has an advantage that the stain of the window 92 can be determined more reliably than the stain determination condition 2 described above.
  • the determination as to whether or not the stain determination condition is satisfied may be performed over a plurality of frames. For example, when N is a predetermined integer of 2 or more, it may be determined that the window 92 is dirty when the stain determination condition is continuously satisfied over N consecutive frames. .. Further, when N is an integer of 3 or more and M is an integer of 2 or more and N or less, the window 92 becomes dirty when the dirt determination condition is satisfied in M frames out of N consecutive frames. It may be determined that there is. Alternatively, when N is a predetermined integer of 2 or more, whether or not the stain determination condition is satisfied by using the total value or the average value of the light receiving intensity H1 and the intensity threshold value It1 over N consecutive frames. May be determined. If these methods are adopted, there is an advantage that the presence or absence of dirt can be stably determined and false detection can be prevented.
  • step S400 the window dirt removal operation is executed.
  • the window dirt removing operation is executed by the cleanup unit 400 in response to an instruction from the determination unit 300.
  • the washer portions 410 and 411 remove dirt on the surface of the window 92 by injecting at least one of water and air onto the surface of the window 92.
  • the heater unit 420 is provided with a heater wire along the window 92. The window 92 may be heated to melt the snow or ice adhering to the surface of the window 92.
  • one of a plurality of cleanup methods may be selected and executed according to the position of dirt on the window 92.
  • a plurality of washer portions 410 and 411 that are in charge of removing stains in a plurality of different regions of the window 92, only the washer portion that is in charge of removing stains in the region is selected according to the region where the stain is present. You may start it.
  • both of the two washer portions 410 and 411 are arranged on one of the two side sides of the window 92, and the first washer portion 410 has a slow fluid discharge rate and a low dirt removing ability. 2
  • the washer portion 411 may have a high fluid discharge rate and a high dirt removing ability.
  • the first washer portion 410 having a low dirt removing ability is used to remove the dirt, and the other side is used.
  • dirt removal may be performed using the second washer portion 411 because the dirt removing ability is high.
  • the cleanup method may be selected and executed according to the degree of dirt.
  • the stain index value indicating the degree of stain for example, any of the following can be used.
  • (1) Dirt index value D1 The stain index value D1 is the difference between the light receiving intensity H1 and the intensity threshold value It1.
  • (2) Dirt index value D2 The dirt index value D2 is the number of pixels in which dirt is present.
  • (3) Dirt index value D3 The stain index value D3 is an added value obtained by adding the difference between the light receiving intensity H1 and the intensity threshold value It1 over a plurality of pixels in the visual field range 80. All of these stain index values D1 to D3 indicate that the larger the value, the higher the degree of stain.
  • the determination unit 300 may calculate any of these stain index values D1 to D3 and notify the cleanup unit 400.
  • the cleanup unit 400 can select and execute one of a plurality of cleanup methods having different stain removing abilities according to the degree of stain indicated by the stain index value.
  • the degree of stain may be divided into a plurality of stain stages in advance, and one of the following three types of cleanup methods may be adopted at each stain stage.
  • Cleanup method C1 Perform cleanup with a washer that uses only air.
  • Cleanup method C2 Perform cleanup with a washer section that uses both air and water.
  • Cleanup method C3 Perform cleanup using both the washer section and the warper section.
  • step S400 may be omitted.
  • the determination unit 300 notifies the occupant of the vehicle equipped with the distance measuring device 20 that the window 92 of the distance measuring device 20 is dirty.
  • Such notification can be performed, for example, by using a notification unit 510 such as a display unit or a speaker provided in the guest room.
  • the calculation unit 200 may not output the distance data of the area where the dirt exists in the window 92 to the outside, but may output only the distance data of the area where the dirt does not exist to the outside.
  • the number of pixels in which the light receiving intensity H1 at a specific flight time Tc is equal to or greater than the intensity threshold value It1 is equal to or greater than the first number threshold value.
  • the cleanup unit 400 may be made to execute the removal operation. Thereby, it is possible to determine whether or not the dirt has a size that cannot be removed by the cleanup unit 400.
  • the determination unit 300 may update the threshold value setting value by calculating a new threshold value setting value according to the light receiving intensity H1 and storing it in the storage unit 310.
  • the cleanup unit 400 may be driven to perform the removal operation, and the light receiving intensity H1 obtained after the removal operation may be used to calculate a new threshold setting value.
  • the new threshold value is calculated using, for example, the original light receiving intensity H0 and the light receiving intensity H1. According to this method, it is possible to cope with aged deterioration of light emission, distortion of the window 92, and the like, and it is possible to prevent oversight of dirt.
  • a new threshold value set value corresponding to the light receiving intensity H1 obtained during that time is calculated and stored in the storage unit 310.
  • the threshold setting value may be updated depending on the above. According to this method, it is possible to cope with aged deterioration of light emission, distortion of the window 92, and the like, and it is possible to prevent oversight of dirt.
  • the predetermined stain detection condition for the light receiving intensity H1 at the specific flight time Tc is satisfied, it is determined that the window 92 is dirty. Therefore, the light receiving intensity is determined. It is possible to detect whether the window is dirty or not.
  • the controls and methods thereof described in the present disclosure are realized by a dedicated computer provided by configuring a processor and memory programmed to perform one or more functions embodied by a computer program. May be done.
  • the controls and methods thereof described in the present disclosure may be implemented by a dedicated computer provided by configuring the processor with one or more dedicated hardware logic circuits.
  • the control unit and method thereof described in the present disclosure may be a combination of a processor and memory programmed to perform one or more functions and a processor composed of one or more hardware logic circuits. It may be realized by one or more dedicated computers configured.
  • the computer program may be stored in a computer-readable non-transitional tangible recording medium as an instruction executed by the computer.

Landscapes

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

Abstract

測距装置(20)は、発光部(40)と、受光部(60)と、演算部(200)と、窓(92)を有するケース(90)と、予め定められた汚れ判定条件が成立する場合に、窓に汚れが存在するものと判定する判定部(300)と、を備える。汚れ判定条件は、『測距装置の視野範囲内の少なくとも1つの画素において、発光部から窓までの光路の距離に相当する特定の飛行時間における受光強度が強度閾値以上であること』という第1の条件を含む。

Description

測距装置、及び、測距装置の窓の汚れを検出する方法 関連出願の相互参照
 本願は、2019年10月4日に出願された出願番号2019-183438の日本特許出願、及び、2020年9月24日に出願された出願番号2020-159470の日本特許出願に基づく優先権を主張し、それらの開示の全てが参照によって本願に組み込まれる。
 本開示は、測距装置の窓の汚れを検出する技術に関する。
 JP2016-176750Aには、パルス光を照射して外部物体で反射された反射光を受光し、光の飛行時間から外部物体までの距離を測定する測距装置が開示されている。
 上述の測距装置では、測距装置の窓に汚れが付着すると、S/N比が低下して外部物体までの距離を正確に測定できない。しかし、従来は、測距装置の窓に汚れが付着しているか否かを検出する技術について、十分に検討されていないのが実情であった。
 本開示の一形態によれば、測距装置が提供される。この測距装置は、パルス光を発光する発光部と、外部物体で反射された前記パルス光の反射光を受光する受光部と、前記受光部で受光された前記反射光の飛行時間を用いて、前記外部物体までの距離を演算する演算部と、前記発光部と前記受光部とを収容するケースであって、前記パルス光及び前記反射光を通過させる窓を有するケースと、予め定められた汚れ判定条件が成立する場合に、前記窓に汚れが存在するものと判定する判定部と、を備え、前記汚れ判定条件は、『前記測距装置の視野範囲内の少なくとも1つの画素において、前記発光部から前記窓までの光路の距離に相当する特定の飛行時間における受光強度が強度閾値以上であること』という第1の条件を含む。
 この測距装置によれば、特定の飛行時間における受光強度について汚れ検出条件が成立する場合に窓に汚れが存在するものと判定するので、受光強度から窓に汚れがあるか否かを検出することが可能である。
図1は、測距装置の概略構成図であり、 図2は、光学系を表す概略構成図であり、 図3は、受光アレイの構成を模式的に示す説明図であり、 図4は、画素に含まれる受光素子の構成を模式的に示す説明図であり、 図5は、演算判定部の概略構成図であり、 図6は、窓に汚れの無い初期状態のヒストグラムであり、 図7は、窓汚れ検出処理時のヒストグラムであり、 図8は、汚れ検出用の画素を含む受光アレイの構成を模式的に示す説明図であり、 図9は、画素ブロック毎に距離測定と汚れ検出とを行う様子を示す説明図であり、 図10は、窓汚れ検出処理の手順を示すフローチャートであり、 図11は、視野範囲内の複数の画素位置において窓に汚れがある場合を示す説明図である。
 図1に示すように、測距装置20は、前面に窓92を有するケース90に収容されている。窓92の近傍には、窓92の窓の汚れを除去するための除去動作を実行するクリーンアップ部400が設けられている。本実施形態のクリーンアップ部400は、ウォッシャ部410,411とヒータ部420とを含んでいる。ウォッシャ部410,411は、窓92の表面に水を噴射することによって、窓92の表面の汚れを除去するために使用される。この例では、窓92の左側の汚れを除去する第1ウォッシャ部410と、窓92の右側の汚れを除去する第2ウォッシャ部411とを設けているが、3つ以上のウォッシャ部を設けてもよい。換言すれば、窓92の複数の異なる領域の汚れ除去をそれぞれ担当する複数のウォッシャ部を設けてもよい。或いは、1つのウォッシャ部で窓92の全体の汚れを除去するようにしてもよい。更に、水の代わりに空気を噴射してもよく、水と空気の両方を噴射できるようにウォッシャ部を構成してもよい。ヒータ部420は、窓92に沿って設けられたヒータ線で窓92を加熱して、窓92の表面に付着した雪や氷を融解させるために使用される。クリーンアップ部400としては、これら以外の構成を採用してもよく、例えば、窓92をワイプするワイパー部をクリーンアップ部400として用いてもよい。
 測距装置20は、測距のためのパルス光を射出して外部物体からの反射光を受ける光学系30と、光学系30から得られた信号を処理する演算判定部100とを備える。外部物体を、「対象物」又は「ターゲット」とも呼ぶ。光学系30は、パルス光としてのレーザ光を射出する発光部40と、レーザ光を予め定められた視野範囲80内で走査させる走査部50と、外部物体からの反射光や外乱光を含む入射光を受光するための受光部60とを備える。
 測距装置20は、例えば、自動車などの車両に搭載される車載用のLiDAR(Laser Imaging Detection and Ranging)である。車両が水平な路面を走行している場合に、視野範囲80の横方向は水平方向Xと一致し、縦方向は鉛直方向Yと一致する。測距装置20で測定された距離などの情報は、外部装置である距離受信部500によって受信されて利用される。距離受信部500は、各種の情報をユーザーに通知する通知部510を有している。通知部510は、例えば、客室内に設けられた表示部やスピーカ等である。距離受信部500は、例えば、車両のECU(Electronic Control Unit)を含む制御装置である。
 図2に示すように、発光部40は、測距用のレーザ光を射出する半導体レーザ素子(以下、単にレーザ素子とも呼ぶ)41と、レーザ素子41の駆動回路を組み込んだ回路基板43と、レーザ素子41から射出されたレーザ光を平行光にするコリメートレンズ45とを備える。レーザ素子41は、いわゆる短パルスレーザを発振可能なレーザダイオードである。本実施形態において、レーザ素子41は、複数のレーザダイオードを鉛直方向に沿って配列させることにより矩形状のレーザ発光領域を構成する。レーザ素子41を「光源」とも呼ぶ。
 走査部50は、いわゆる一次元スキャナによって構成される。走査部50は、ミラー54と、ロータリソレノイド58と、回転部56とによって構成される。ミラー54は、コリメートレンズ45により平行光とされたレーザ光を反射する。ロータリソレノイド58は、演算判定部100からの制御信号を受けて、予め定められた角度範囲内で正転および逆転を繰り返す。回転部56は、ロータリソレノイド58によって駆動し、鉛直方向を軸方向とする回転軸で正転および逆転を繰り返し、ミラー54を水平方向に沿った一方向に走査させる。コリメートレンズ45を介してレーザ素子41から入射したレーザ光は、ミラー54によって反射され、ミラー54の回転により水平方向に沿って走査される。図1に示す視野範囲80は、この照射光の走査範囲に相当する。視野範囲80内の各画素位置で受光強度が得られるので、視野範囲80内の受光強度の分布は一種の画像を構成する。従って、視野範囲80を「画像領域」と呼ぶことも可能である。なお、走査部50を省略して、発光部40から視野範囲80内の全体にわたってパルス光を射出するとともに、受光部60で視野範囲80内の全体にわたる反射光を受光するようにしてもよい。視野範囲80内の受光強度の分布を示すデータの集合を、「フレーム」とも呼ぶ。距離測定は、1フレーム毎に実行される。
 測距装置20から出力されるレーザ光は、人や車などの外部物体があると、その表面で乱反射し、その一部は反射光として走査部50のミラー54に戻ってくる。この反射光は、ミラー54で反射されて、外乱光とともに入射光として受光部60の受光レンズ61に入射し、受光レンズ61で集光されて受光アレイ65に入射する。
 図3に示すように、受光アレイ65は、二次元配列された複数の画素66で構成される。図4に示すように、1つの画素66は、水平方向にH個、鉛直方向にV個となるように配列された複数の受光素子68で構成されている。H及びVはそれぞれ1以上の整数である。本実施形態ではH=V=5であり、水平方向および鉛直方向においてそれぞれ5個の受光素子68で構成される。但し、任意の数の受光素子68で画素66を構成することが可能であり、一つの受光素子68で画素66を構成してもよい。本実施形態では、1画素66を構成する受光素子68の数(H×V)を、「画素サイズ」とも呼ぶ。本実施形態では、受光素子68としてSPAD(Single Photon Avalanche Diode)を用いているが、PINフォトダイオード等の他の種類の受光素子を用いてもよい。1つの画素66の受光結果は、視野範囲80内の1つの画素位置における受光強度となる。この説明から理解できるように、受光アレイ65を構成する「画素66」はハードウエアを意味しており、視野範囲80を構成する「画素」とは異なる意味で使用されている。但し、画素66の受光結果が視野範囲80内の1画素の受光強度として使用されるので、両者の間には対応関係が存在する。
 各受光素子68は、電源Vccと接地ラインとの間に直列にクエンチ抵抗器RqとアバランシェダイオードDaを接続し、その接続点の電圧を反転素子INVに入力し、電圧レベルの反転したデジタル信号に変換している。反転素子INVの出力は、アンド回路SWの一方の入力端子に入力される。アンド回路SWの他方の入力端子には、選択信号Scが入力される。選択信号Scは、受光アレイ65のどの受光素子68からの信号を読み出すかを指定するのに用いられる。すなわち、ある受光素子68を選択する選択信号Scをローレベルからハイレベルに切り替えると、アバランシェダイオードDaの状態を反映した出力信号Soutがその受光素子68から出力される。選択信号Scをハイレベルに切り替えるタイミングは、反射光の飛行時間に相当する。従って、1回のパルス光の発光の後に、複数の飛行時間に相当する複数のタイミングで選択信号Scがローレベルからハイレベルにそれぞれ切り替えられる。
 出力信号Soutは、照射光が走査範囲に存在する外部物体に反射して戻ってくる反射光や外乱光を含む入射光の受光により生じるパルス信号である。複数の飛行時間における受光素子68の出力信号Soutは、演算判定部100に順次入力される。
 図5に示すように、演算判定部100は、演算部200と、判定部300と、記憶部310とを含んでいる。演算部200は、受光部60で受光された反射光の飛行時間Tfを用いて、外部物体OBJまでの距離Dを演算する。演算部200は、演算判定部100全体の制御を行なう制御部210と、加算部220と、ヒストグラム生成部230と、ピーク検出部240と、距離演算部250とを備える。
 加算部220は、受光アレイ65を構成する画素66に含まれる受光素子68の出力を加算する回路である。入射光パルスが一つの画素66に入射すると、画素66に含まれる各受光素子68が動作する。前述したように、本実施形態では、受光素子68としてSPADを使用しており、画素66を複数個のSPADから構成している。SPADは、一つのフォトンが入射しただけでこれを検出することが可能であるが、外部物体OBJからの限られた光によるSPADの検出は確率的なものにならざるを得ない。加算部220は、確率的にしか入射光を検出し得ないSPADからの出力信号Soutを加算する。
 ヒストグラム生成部230は、加算部220の加算結果を複数回足し合せることによって、受光強度のヒストグラムを生成し、ピーク検出部240に出力する。このヒストグラムは、複数の飛行時間のそれぞれにおける受光強度を表すグラフである。受光強度は、1画素66内の受光したSPAD数の合計である。複数の飛行時間は、一定の間隔で設定されている。ピーク検出部240は、ヒストグラム生成部230から入力されたヒストグラムの受光強度を解析して、受光強度のピークを検出し、検出されたピークの飛行時間を決定する。検出されたピークの飛行時間は、外部物体OBJで反射された光の飛行時間Tfに相当する。距離演算部250は、光の飛行時間Tfを用いて、外部物体OBJまでの距離Dを演算する。
 判定部300は、受光部60における受光強度を用いて、窓92の汚れ検出処理を実行する。本実施形態では、判定部300は、受光部60における受光強度を表す情報として、ヒストグラム生成部230で生成されたヒストグラムを用いる。窓92の汚れ検出処理の詳細については後述する。窓92に汚れがあるものと判定された場合には、判定部300からの指示に応じて、クリーンアップ部400が窓92の汚れを除去するための除去動作を実行する。判定部300には、外気温度を測定するための温度センサ320が接続されている。但し、温度センサ320は省略可能である。
 記憶部310は、測距装置20の視野範囲80内における閾値設定値の分布を記憶する。「閾値設定値」とは、窓汚れ検出処理で使用される強度閾値を決定するために用いられる値であり、予め設定されて記憶部310に格納される。強度閾値や閾値設定値については更に後述する。
 図6及び図7に示すように、ヒストグラム生成部230で生成されたヒストグラムは、複数の飛行時間Tfのそれぞれにおける受光強度Iを示すグラフである。図6は、窓92に汚れの無い初期状態のヒストグラムの例を示しており、図7は、窓汚れ検出処理時のヒストグラムの例を示している。図6及び図7で使用した符号の意味は以下の通りである。なお、末尾が「0」である符号は初期状態を示し、末尾が「1」の符号は窓汚れ検出処理時を示す。以下では主として図7に示した窓汚れ検出処理時の符号の意味を説明する。
(1)CL0,CL1:クラッタピーク
 クラッタピークCL1は、発光部40から窓92までの光路の距離に相当する特定の飛行時間Tcに現れる受光強度のピークである。窓92による反射光を「クラッタ光」と呼ぶ。
(2)Tc:クラッタピークの飛行時間
 クラッタピークの飛行時間Tcは、発光部40から窓92までの光路の距離に相当する特定の飛行時間である。
(3)TP0,TP1:ターゲットピーク
 ターゲットピークTP1は、外部物体からの反射光に対応する受光強度のピークである。
(4)Tt:ターゲットピークの飛行時間
 ターゲットピークの飛行時間Ttは、発光部40から外部物体までの距離に対応する飛行時間である。
(5)Imax:受光強度Iが取り得る最大値
 受光強度Iが取り得る最大値Imaxは、ヒストグラムを作成する際に使用される1画素当りの受光素子68の延べ数である。図4で説明したように、1つの画素66はH×V個の受光素子68で構成されている。Nを2以上の整数とするとき、N回の発光による受光結果を合計してヒストグラムを作成する場合には、受光強度Iが取り得る最大値Imaxは、N×H×Vに等しい。
(6)H0,H1:クラッタピークレベル
 クラッタピークレベルH1は、クラッタピークCL1の高さの絶対値である。以下では、クラッタピークレベルH1を、単に「ピークレベルH1」又は「受光強度H1」とも呼ぶ。
(7)It0,It1:クラッタピークの強度閾値
 クラッタピークCL1の強度閾値It1は、汚れ検出条件のうち、『測距装置20の視野範囲80内の少なくとも1つの画素において、特定の飛行時間Tcにおける受光強度が強度閾値It1以上であること』という第1の条件が成立するか否かを判断する際に使用される。強度閾値It1は、通常は受光強度Iが取り得る最大値Imaxよりも小さな値に設定されるが、最大値Imaxと等しい値に設定してもよい。窓汚れ検出処理時の強度閾値It1の決定方法については後述する。
(8)BL0,BL1:ヒストグラムのベースラインレベル
 ヒストグラムのベースラインレベルBL1は、ヒストグラムにおけるピーク以外の信号値の平均値である。
(9)α:閾値設定値
 この閾値設定値αは、強度閾値It1からベースラインレベルBL1を減算した値である。換言すれば、強度閾値It1は、べースラインレベルBL1にこの閾値設定値αを加算することによって決定できる。但し、後述するように、他の方法で強度閾値It1を決定することも可能である。
(10)(Imax0-BL0),(Imax-BL1):実効信号レンジ幅
 実効信号レンジ幅(Imax-BL1)は、受光強度Iが取り得る最大値ImaxからベースラインレベルBL1を減算した値である。
 図6に示すように、窓92に汚れが無い初期状態における典型的なヒストグラムには、外部物体からの反射光に対応するターゲットピークTP0が現れる。外部物体までの距離は、このターゲットピークTP0の飛行時間Ttから決定される。図6のヒストグラムは、更に、窓92での反射光に対するピークとしてのクラッタピークCL0も含んでいる。クラッタピークCL0は、発光部40から窓92までの光路の距離に相当する特定の飛行時間Tcにおける受光強度である。このクラッタピークCL0は、窓92に汚れが無い状態、例えば、工場出荷時におけるピークレベルH0(以下、「初期クラッタピークレベルH0」と呼ぶ)を有する。なお、クラッタピークCL0が現れる特定の飛行時間Tcは、視野範囲80内の画素位置毎に異なっている。この理由は、図1において、発光部40から窓92までの光路の光路長が、視野範囲80内の画素位置毎に異なるからである。また、各画素位置における初期クラッタピークレベルH0も画素位置毎に異なっているのが普通である。
 なお、通常の測距装置では、窓92が存在する位置は測距対象とならないので、クラッタピークCL1が現れる特定の飛行時間Tcにおいて受光強度Iの測定値を取得する必要はない。本実施形態では、クラッタピークCL1を利用して窓92の汚れ検出を行うために、特定の飛行時間Tcにおいて受光強度Iの測定値を取得する点に1つの特徴がある。
 図7の例に示すように、窓汚れ検出処理時のヒストグラムにおけるターゲットピークTP1及びクラッタピークCL1のレベルは、初期状態におけるターゲットピークTP0及びクラッタピークCL0のレベルとは異なるのが普通である。例えば、窓92に汚れが存在する場合には、そのクラッタピークレベルH1は、初期クラッタピークレベルH0よりも高くなる。また、窓92に汚れが存在する場合には、同じ外部物体に対するターゲットピークTP1のレベルも低くなる場合が多い。
 窓汚れ検出処理時のベースラインレベルBL1は、太陽などの外部光源の有無等の外部環境に影響される。例えば、強い太陽光が存在する場合には、ベースラインレベルBL1は極めて高い値を示す。このとき、クラッタピークレベルH1も同様に高くなる。従って、このような外部環境の影響を考慮して、窓汚れ検出処理時の強度閾値It1を適応的に決定することが好ましい。この点は更に後述する。
 窓汚れ検出処理時の強度閾値It1の決定方法としては、例えば以下のような方法A~Cが考えられる。
<強度閾値の決定方法A>
 窓汚れ検出処理時の強度閾値It1を、一定値に設定する。
 この場合には、強度閾値It1を、視野範囲80内の全画素に共通する1つの値に設定してもよく、或いは、視野範囲80内の各画素毎に強度閾値It1をそれぞれ設定して、記憶部310内に閾値設定値として格納してもよい。前者の場合には、記憶部310は省略可能である。但し、強度閾値It1を視野範囲80内の各画素毎に設定するようにすれば、各画素毎の初期クラッタピークレベルH0よりも高い強度閾値It1を設定できるので、窓汚れ検出処理をより正確に実行できるという利点がある。
<強度閾値の決定方法B>
 ヒストグラムのベースラインレベルBL1に、固定値である閾値設定値αを加算した値を、窓汚れ検出処理時の強度閾値It1とする。
 It1=BL1+α   …(1)
 ここで、閾値設定値αは、初期状態に上記(1)式を適用したときの演算結果(BL0+α)が初期クラッタピークレベルH0よりも十分に大きくなるように予め設定された値である。閾値設定値αは、視野範囲80内の全画素に共通する1つの値に設定してもよく、或いは、視野範囲80内の各画素毎に強度固定値αをそれぞれ設定して記憶部310内に格納してもよい。この方法Bによれば、外部光源の有無等の外部環境の影響を考慮して、窓汚れ検出処理時の強度閾値It1を適応的に決定できるという利点がある。なお、閾値設定値αは、画素サイズ(H×V)や、ヒストグラムを生成する際の発光回数Nに応じて決定しても良い。例えば、以下のいずれかの式を用いて閾値設定値αを決定するようにしてもよい。
 α=α0×(H×V)
 α=α0×N
 α=α0×(H×V)×N
ここで、α0は予め定めた一定値である。画素サイズ(H×V)は、図4で説明したように、1つの画素66に含まれるSPADの数である。
<強度閾値の決定方法C>
 実効信号レンジ幅(Imax-BL1)に、1未満の係数である閾値設定値βを乗算し、その乗算結果にベースラインレベルBL1を加算した値を、窓汚れ検出処理時の強度閾値It1とする。
 この場合に、窓汚れ検出処理時の強度閾値It1は、次式で算出できる。
 It1=(Imax-BL1)×β+BL1   …(2)
 ここで、閾値設定値βは、初期状態に上記(2)式を適用したときの演算結果{(Imax-BL0)×β+BL0}が初期クラッタピークレベルH0よりも十分に大きくなるように予め設定された値である。閾値設定値βは視野範囲80内の全画素に共通する1つの値に設定してもよく、或いは、視野範囲80内の各画素毎に設定して記憶部310内に格納してもよい。この方法Cによれば、上述した方法Bと同様に、外部環境の影響を考慮して、窓汚れ検出処理時の強度閾値It1を適応的に決定できるという利点がある。また、この方法Cは、更に、外部からの光が極めて強くてベースラインレベルBL1が高くなった場合にも、窓汚れ検出処理時の強度閾値It1を受光強度の最大値Imaxよりも小さな値に維持できるので、窓汚れ検出処理をより正確に実行できるという利点がある。
 なお、強度閾値It1を決定するために用いられる閾値設定値が視野範囲80の各画素毎に異なる場合には、視野範囲80内における閾値設定値の分布を記憶部310に記憶することが好ましい。閾値設定値は、視野範囲80内のすべての画素位置で記憶しておくことが好ましいが、間引きした画素位置のみで閾値設定値を記憶することによって、視野範囲80内における閾値設定値の分布を記憶するようにしてもよい。後者の場合には、各画素位置における強度閾値It1を算出する際に、各画素位置での閾値設定値を補間により決定できる。
 図8の例に示すように、距離測定用の画素66に加えて、汚れ検出用の画素67を含む受光アレイ65aを用いてもよい。すなわち、受光部60は、距離測定用の画素66とは別に、窓92の汚れ検出用の画素67を含んでいても良い。汚れ検出用の画素67は、距離測定用の画素66の近傍に配置される。具体的には、窓92に汚れが無い場合には汚れ検出用の画素67にクラッタ光が印加されず、窓92に汚れがある場合には汚れ検出用の画素67にクラッタ光が印加されるように汚れ検出用の画素67が配置されていることが好ましい。窓92に汚れがある場合には、距離測定用の画素66においてクラッタピークが増大するとともに、その周辺へのクラッタ光が増加する。この位置に汚れ検出用の画素67を配置すれば、この画素67への光入力の有無で汚れの有無を判定でき、よりシンプルな演算で汚れ検出を実現できるという利点がある。
 また、図9に示すように、受光アレイ65に含まれる複数の画素66を、複数の画素ブロックに分割して時分割処理し、距離測定と汚れ検出とを同一タイミングで実施してもよい。図9の例では、複数の画素66が画素ブロックAと画素ブロックBの2つの画素ブロックに分割されており、一方の画素ブロックにより距離測定を行うときに、これと並行して他方の画素ブロックにより汚れ検出を行う。受光アレイ65に含まれる複数の画素66は、3個以上の画素ブロックに分割してもよい。この場合には、少なくとも1つの画素ブロックで汚れ検出を行い、他の画素ブロックで距離測定を行うことができる。
 図10に示す窓汚れ検出処理は、制御部210の制御の下で実行される。ステップS100では、窓汚れ検出処理の処理タイミングに至ったか否かが判断される。窓汚れ検出処理の処理タイミングは、例えば、測距装置20の通常の測距動作中の所定の期間毎としてもよい。或いは、予め定められた測距装置20の自己診断期間内において窓汚れ検出処理の処理タイミングを設定するようにしてもよい。
 窓汚れ検出処理の予め定められた処理タイミングに至った場合には、ステップS200に進み、判定部300が、受光強度のヒストグラムから、クラッタピークCL1のピークレベルH1を取得する。
 ステップS300では、判定部300が、予め定められた汚れ判定条件が成立するか否かを判断する。汚れ判定条件が成立しない場合には、ステップS100に戻り、次の処理タイミングまで待機する。一方、汚れ判定条件が成立した場合には、後述するステップS400に進む。
 汚れ判定条件としては、例えば、以下に説明する種々の汚れ判定条件のうちのいずれか1つを使用することが可能である。
<汚れ判定条件1>
 以下の第1の条件C1のみが成立した場合に、窓92に汚れが存在するものと判定する。
・第1の条件C1:『測距装置20の視野範囲80内の少なくとも1つの画素において、発光部40から窓92までの光路の距離に相当する特定の飛行時間Tcにおける受光強度H1が、強度閾値It1以上であること』
 この汚れ判定条件1は、後述する他の汚れ判定条件よりも緩い条件なので、窓92の汚れを見逃す可能性が低いという利点がある。なお、第1の条件C1の成否は、ヒストグラムがターゲットピークTP1を含むか否かに拘わらずに判定されることが好ましい。こうすれば、ヒストグラムがターゲットピークTP1を含む場合にも窓92の汚れを検出できるという利点がある。
<汚れ判定条件2>
 上記第1の条件C1と下記の第2の条件C2aが両方とも成立した場合に、窓92に汚れが存在するものと判定する。
・第2の条件C2a:『視野範囲80内において、特定の飛行時間Tcにおける受光強度H1が強度閾値It1以上となる画素の画素数が、2以上の整数である個数閾値以上であること』
 この汚れ判定条件2では、図7において、クラッタピークCL1のピークレベルH1が強度閾値It1以上となる画素が視野範囲80内に複数個存在する場合に窓92に汚れが存在すると判定するので、窓92の汚れをより確実に判定できるという利点がある。
<汚れ判定条件3>
 上記第1の条件C1と下記の第2の条件C2bが両方とも成立した場合に、窓92に汚れが存在するものと判定する。
・第2の条件C2b:『視野範囲80内において、特定の飛行時間Tcにおける受光強度H1が強度閾値It1以上となる複数の画素が互いに連続する画素集合体が存在しており、かつ、画素集合体の画素数が予め定められた個数閾値以上であること』
 この汚れ判定条件3は、図11に示すように、窓92の汚れに起因して、特定の飛行時間Tcにおける受光強度H1が強度閾値It1以上となる複数の画素が、視野範囲80内において互いに連続して画素集合体PAを構成している場合を想定している。なお、「2つの画素が互いに連続する」という語句は、そのうちの一方の画素が他方の画素の上下左右の4隣接位置のいずれかに存在することを意味する。窓92に汚れが存在する場合には、窓92内のまとまった領域に汚れが付着している場合が多いので、図11に示すように、特定の飛行時間Tcにおける受光強度H1が強度閾値It1以上となる複数の画素が、視野範囲80内において画素集合体PAを構成するのが普通である。従って、汚れ判定条件3では、上述した汚れ判定条件2よりも更に確実に窓92の汚れを判定できるという利点がある。
 汚れ判定条件が成立したか否かの判定は、複数のフレームにわたって実施してもよい。例えば、Nを予め定められた2以上の整数とするとき、連続するN個のフレームにわたって汚れ判定条件が連続して成立した場合に、窓92に汚れがあるものと判定するようにしてもよい。また、Nを3以上の整数とし、Mを2以上N以下の整数とするとき、連続するN個のフレームのうちのM個のフレームにおいて汚れ判定条件が成立した場合に、窓92に汚れがあるものと判定するようにしてもよい。或いは、Nを予め定められた2以上の整数とするとき、連続するN個のフレームにわたる受光強度H1及び強度閾値It1のそれぞれの合計値又は平均値を用いて、汚れ判定条件が成立するか否かを判定してもよい。これらの方法を採用すれば、安定的に汚れの有無を判定でき、誤検知を防止できるという利点がある。
 汚れ判定条件が成立した場合には、ステップS400に進み、窓汚れの除去動作が実行される。窓汚れの除去動作は、判定部300からの指示に応じて、クリーンアップ部400によって実行される。具体的には、例えば、ウォッシャ部410,411が、窓92の表面に水と空気の少なくとも一方を噴射することによって、窓92の表面の汚れを除去する。また、温度センサ320で測定された外気温度が、窓92に雪又は氷が付着する可能性がある温度を示している場合には、ヒータ部420が、窓92に沿って設けられたヒータ線で窓92を加熱して、窓92の表面に付着した雪や氷を融解させるようにしてもよい。
 なお、窓92の汚れの位置に応じて複数のクリーンアップ方法の1つを選択して実行するようにしてもよい。例えば、窓92の複数の異なる領域の汚れ除去をそれぞれ担当する複数のウォッシャ部410,411を用いて、汚れが存在する領域に応じて、その領域の汚れ除去を担当するウォッシャ部のみを選択して起動するようにしてもよい。或いは、窓92の2つの側辺のうちの一方の側辺に2つのウォッシャ部410,411の両方を配置し、第1ウォッシャ部410を流体吐出速度が遅く汚れ除去能力が低いものとし、第2ウォッシャ部411を流体吐出速度が速く汚れ除去能力が高いものとしてもよい。この場合に、2つのウォッシャ部が配置されている窓92の側辺により近い領域に汚れが存在する場合は汚れ除去能力が低い第1ウォッシャ部410を用いて汚れ除去を実行し、他方の側辺により近い領域に汚れが存在する場合は汚れ除去能力が高いで第2ウォッシャ部411を用いて汚れ除去を実行してもよい。
 また、クリーンアップ方法を、汚れの程度に応じて選択して実行するようにしてもよい。汚れの程度を示す汚れ指標値としては、例えば以下のいずれかを使用することができる。
(1)汚れ指標値D1
 汚れ指標値D1は、受光強度H1と強度閾値It1との差分である。
(2)汚れ指標値D2
 汚れ指標値D2は、汚れが存在する画素数である。
(3)汚れ指標値D3
 汚れ指標値D3は、受光強度H1と強度閾値It1との差分を、視野範囲80内の複数の画素にわたって加算した加算値である。
 これらの汚れ指標値D1~D3は、いずれもその値が大きいほど、汚れの程度が高いことを示す。判定部300は、これらの汚れ指標値D1~D3のうちのいずれかを算出して、クリーンアップ部400に通知するようにしてもよい。
 クリーンアップ部400は、汚れ指標値によって示される汚れの程度に応じて、汚れ除去能力が異なる複数のクリーンアップ方法のうちの1つを選択して実行することが可能である。例えば、汚れの程度を予め複数の汚れ段階に区分し、各汚れ段階において、以下の3種類のクリーンアップ方法のうちの1つを採用してもよい。
(1)クリーンアップ方法C1
 空気のみを用いるウォッシャ部によるクリーンアップを実行する。
(2)クリーンアップ方法C2
 空気と水の両方を用いるウォッシャ部によるクリーンアップを実行する。
(3)クリーンアップ方法C3
 ウォッシャ部とワーパー部の両方を用いるクリーンアップを実行する。
 これらの3種類のクリーンアップ方法C1~C3は、この順に汚れ除去能力が次第に高くなるものであり、汚れの程度が低い順に選択されて適用される。
 なお、ステップS400は省略してもよい。また、窓92に汚れがある場合には、測距装置20を搭載する車両の乗員に対して、判定部300が、測距装置20の窓92に汚れがあることを通知することが好ましい。このような通知は、例えば、客室内に設けられた表示部やスピーカ等の通知部510を用いて行うことができる。汚れを通知する際には、窓92のうちの汚れが存在する位置を外部に通知することが好ましい。また、演算部200は、窓92のうちで汚れが存在する領域の距離データを外部に出力せず、汚れが存在しない領域の距離データのみを外部に出力するようにしてもよい。
 なお、上述した<汚れ判定条件2>又は<汚れ判定条件3>を使用する場合に、特定の飛行時間Tcにおける受光強度H1が強度閾値It1以上となる画素の画素数が第1の個数閾値以上の場合に、(a)その画素数が第1の個数閾値よりも大きな第2の個数閾値以上の場合にはクリーンアップ部400に除去動作を実行させること無く通知のみを行い、(b)その画素数が第2の個数閾値未満の場合にはクリーンアップ部400に除去動作を実行させる、ようにしてもよい。これにより、クリーンアップ部400により除去不可能な大きさの汚れか否かを判定できる。
 また、判定部300は、窓92が汚れていない場合において、受光強度H1に応じた新たな閾値設定値を算出して記憶部310に保存することによって、閾値設定値を更新しても良い。この場合に、クリーンアップ部400を駆動して除去動作を実行し、除去動作後に得られる受光強度H1を使用して新たな閾値設定値を算出してもよい。新たな閾値設定値は、例えば、元の受光強度H0と、受光強度H1とを用いて算出される。この方法によれば、発光の経年劣化や窓92のひずみなどに対応でき、汚れを見落とすことが防止できる。
 また、通常の車両走行において、一度も汚れと判定されることなく走行を終了した場合、その間に得られた受光強度H1に応じた新たな閾値設定値を算出して記憶部310に保存することによって、閾値設定値を更新しても良い。この方法によれば、発光の経年劣化や窓92のひずみなどに対応でき、汚れを見落とすことが防止できる。
 以上のように、本実施形態によれば、特定の飛行時間Tcにおける受光強度H1について予め定められた汚れ検出条件が成立する場合に、窓92に汚れが存在するものと判定するので、受光強度から窓に汚れがあるか否かを検出することが可能である。
 本開示に記載の制御部及びその手法は、コンピュータプログラムにより具体化された一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリーを構成することによって提供された専用コンピュータにより、実現されてもよい。あるいは、本開示に記載の制御部及びその手法は、一つ以上の専用ハードウエア論理回路によってプロセッサを構成することによって提供された専用コンピュータにより、実現されてもよい。もしくは、本開示に記載の制御部及びその手法は、一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリーと一つ以上のハードウエア論理回路によって構成されたプロセッサとの組み合わせにより構成された一つ以上の専用コンピュータにより、実現されてもよい。また、コンピュータプログラムは、コンピュータにより実行されるインストラクションとして、コンピュータ読み取り可能な非遷移有形記録媒体に記憶されていてもよい。
 本開示は上述した実施形態やその変形例に限られるものではなく、その要旨を逸脱しない範囲において種々の態様において実施することが可能である。また、上述した種々の特徴的な構成は、互いに矛盾しない限り、任意に組み合わせて採用することが可能である。

Claims (20)

  1.  測距装置(20)であって、
     パルス光を発光する発光部(40)と、
     外部物体で反射された前記パルス光の反射光を受光する受光部(60)と、
     前記受光部で受光された前記反射光の飛行時間を用いて、前記外部物体までの距離を演算する演算部(200)と、
     前記発光部と前記受光部とを収容するケースであって、前記パルス光及び前記反射光を通過させる窓(92)を有するケース(90)と、
     予め定められた汚れ判定条件が成立する場合に、前記窓に汚れが存在するものと判定する判定部(300)と、
    を備え、
     前記汚れ判定条件は、『前記測距装置の視野範囲内の少なくとも1つの画素において、前記発光部から前記窓までの光路の距離に相当する特定の飛行時間における受光強度が強度閾値以上であること』という第1の条件を含む、測距装置。
  2.  請求項1に記載の測距装置であって、
     前記演算部は、複数の飛行時間のそれぞれにおける受光強度を表すヒストグラムを作成して前記判定部に提供するように構成されており、
     前記判定部は、前記ヒストグラムのベースラインレベルに、固定値である閾値設定値を加算することによって、前記強度閾値を算出するように構成されている、測距装置。
  3.  請求項1に記載の測距装置であって、
     前記演算部は、複数の飛行時間のそれぞれにおける受光強度を表すヒストグラムを作成して前記判定部に提供するように構成されており、
     前記ヒストグラムにおいて、受光強度が取り得る最大値から前記ヒストグラムのベースラインレベルを減算した値を実効信号レンジ幅と呼ぶとき、
     前記判定部は、前記実効信号レンジ幅に1未満の係数である閾値設定値を乗算し、その乗算結果に前記ベースラインレベルを加算することによって、前記強度閾値を算出するように構成されている、測距装置。
  4.  請求項2又は3に記載の測距装置であって、更に、
     前記視野範囲内における前記閾値設定値の分布を記憶する記憶部(310)を備え、
     前記判定部は、前記記憶部に記憶されている前記閾値設定値を用いて、前記視野範囲内の各画素毎に前記強度閾値を算出する、測距装置。
  5.  請求項1~4のいずれか一項に記載の測距装置であって、
     前記汚れ判定条件は、更に、
     『前記視野範囲内において、前記特定の飛行時間における受光強度が前記強度閾値以上となる画素の画素数が、予め定められた第1の個数閾値以上であること』
     又は、
    『前記視野範囲内において、前記特定の飛行時間における受光強度が前記強度閾値以上となる複数の画素が互いに連続する画素集合体が存在しており、かつ、前記画素集合体の画素数が予め定められた第1の個数閾値以上であること』
    という第2の条件を含む、測距装置。
  6.  請求項1~5のいずれか一項に記載の測距装置であって、
     前記受光部は、距離測定用の画素とは別に、窓の汚れ検出用の画素を含む、測距装置。
  7.  請求項1~6のいずれか一項に記載の測距装置であって、
     前記視野範囲内における受光強度の分布を示すデータの集合をフレームと呼び、Nを2以上の整数とするとき、
     前記判定部は、連続するN個のフレームにおける前記受光強度と前記強度閾値とを用いて、前記窓に汚れが存在するか否かの判定を実行する、測距装置。
  8.  請求項7に記載の測距装置であって、
     前記判定部は、前記連続するN個のフレームにわたって前記汚れ判定条件が連続して成立した場合に、前記窓に汚れがあるものと判定する、測距装置。
  9.  請求項7に記載の測距装置であって、
     前記判定部は、前記Nを3以上の整数とし、Mを2以上N以下の整数とするとき、前記連続するN個のフレームのうちのM個のフレームにおいて前記汚れ判定条件が成立した場合に、前記窓に汚れがあるものと判定する、測距装置。
  10.  請求項7に記載の測距装置であって、
     前記判定部は、前記連続するN個のフレームにわたる前記受光強度及び前記強度閾値のそれぞれの合計値又は平均値を用いて、前記汚れ判定条件が成立するか否かを判定する、測距装置。
  11.  請求項1~10のいずれか一項に記載の測距装置であって、更に、
     前記窓に汚れが存在するものと判定された場合に、前記窓の汚れを除去するための除去動作を実行するクリーンアップ部を備える測距装置。
  12.  請求項11に記載の測距装置であって、
     前記クリーンアップ部は、前記窓の汚れが存在する位置に応じて複数のクリーンアップ方法のうちの1つを選択して実行する、測距装置。
  13.  請求項12に記載の測距装置であって、
     前記クリーンアップ部は、前記窓の複数の異なる領域の汚れ除去をそれぞれ担当する複数のウォッシャ部を有し、前記複数の異なる領域のうちの前記汚れが存在する領域に応じて、汚れ除去を担当するウォッシャ部を選択してクリーンアップを実行する、測距装置。
  14.  請求項11に記載の測距装置であって、
     前記クリーンアップ部は、前記窓の汚れの程度に応じて、汚れ除去能力が異なる複数のクリーンアップ方法のうちの1つを選択して実行する、測距装置。
  15.  請求項14に記載の測距装置であって、
     前記判定部は、前記窓の汚れの程度を示す汚れ指標値として、
     前記受光強度と前記強度閾値との差分を示す第1の汚れ指標値と、
     前記汚れが存在する画素数を示す第2の汚れ指標値と、
     前記受光強度と前記強度閾値との差分を、前記視野範囲内の複数の画素にわたって加算した加算値を示す第3の汚れ指標値と、
    のうちのいずれか一つを算出し、
     前記汚れ指標値を前記クリーンアップ部に通知する、測距装置。
  16.  請求項5に従属する請求項11に記載の測距装置であって、
     前記特定の飛行時間における受光強度が前記強度閾値以上となる画素の画素数が前記第1の個数閾値以上である場合に、前記判定部は、
    (a)前記画素数が前記第1の個数閾値よりも大きな第2の個数閾値以上の場合には、前記クリーンアップ部による除去動作を実行させることなく前記窓に汚れが存在する旨の通知を実行し、
    (b)前記画素数が前記第2の個数閾値未満の場合には、前記クリーンアップ部に前記除去動作を実行させる、測距装置。
  17.  請求項4に従属する請求項11に記載の測距装置であって、
     前記判定部は、前記窓に汚れが存在する旨の判定がなされていない状態で、前記受光強度に応じて新たな閾値設定値を算出して前記記憶部に保存することによって、前記閾値設定値を更新する、測距装置。
  18.  請求項1~17のいずれか一項に記載の測距装置であって、
     前記判定部は、前記窓の中で前記汚れが存在する位置を外部に通知する、測距装置。
  19.  請求項1~18のいずれか一項に記載の測距装置であって、
     前記演算部は、前記窓の中で前記汚れが存在する領域において得られた前記距離を外部に通知せず、前記汚れが存在しない領域において得られた前記距離を外部に出力する、測距装置。
  20.  測距装置(20)の窓の汚れを検出する方法であって、
     前記測距装置は、
      パルス光を発光する発光部(40)と、
      外部物体で反射された前記パルス光の反射光を受光する受光部(60)と、
      前記受光部で受光された前記反射光の飛行時間を用いて、前記外部物体までの距離を演算する演算部(200)と、
      前記発光部と前記受光部とを収容するケースであって、前記パルス光及び前記反射光を通過させる窓(92)を有するケース(90)と、
    を備え、
     前記方法は、
    (a)前記受光部の出力を用いて、前記発光部から前記窓までの光路の距離に相当する特定の飛行時間における受光強度を取得する工程と、
    (b)『前記測距装置の視野範囲内の少なくとも1つの画素において、前記特定の飛行時間における受光強度が強度閾値以上であること』という第1の条件を含む汚れ判定条件が成立する場合に、前記窓に汚れが存在するものと判定する工程と、
    を備える方法。
PCT/JP2020/037118 2019-10-04 2020-09-30 測距装置、及び、測距装置の窓の汚れを検出する方法 WO2021065998A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202080069439.3A CN114502984A (zh) 2019-10-04 2020-09-30 测距装置、以及检测测距装置的窗口的污垢的方法
US17/657,667 US20220221565A1 (en) 2019-10-04 2022-04-01 Distance measuring apparatus and method of determining dirt on window

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
JP2019-183438 2019-10-04
JP2019183438 2019-10-04
JP2020-159470 2020-09-24
JP2020159470A JP7447752B2 (ja) 2019-10-04 2020-09-24 測距装置、及び、測距装置の窓の汚れを検出する方法

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US17/657,667 Continuation US20220221565A1 (en) 2019-10-04 2022-04-01 Distance measuring apparatus and method of determining dirt on window

Publications (1)

Publication Number Publication Date
WO2021065998A1 true WO2021065998A1 (ja) 2021-04-08

Family

ID=75337005

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/037118 WO2021065998A1 (ja) 2019-10-04 2020-09-30 測距装置、及び、測距装置の窓の汚れを検出する方法

Country Status (3)

Country Link
US (1) US20220221565A1 (ja)
CN (1) CN114502984A (ja)
WO (1) WO2021065998A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022209698A1 (ja) * 2021-03-29 2022-10-06 パイオニア株式会社 測定装置、制御装置、制御方法、およびプログラム
WO2023273421A1 (zh) * 2021-06-30 2023-01-05 上海禾赛科技有限公司 用于激光雷达的光罩脏污检测方法及光罩脏污检测系统
EP4386431A1 (en) 2022-12-15 2024-06-19 Mettler-Toledo GmbH Method for diagnosing erroneous distance measurement of a laser rangefinder unit, laser rangefinder unit and computer program

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115792870B (zh) * 2023-02-09 2023-06-20 图达通智能科技(苏州)有限公司 用于激光雷达的窗口遮挡的检测方法及装置
CN116125437B (zh) * 2023-04-19 2023-07-14 山东鼎瞰智能科技发展有限公司 一种安全激光扫描仪及其光窗检测方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07280940A (ja) * 1994-04-12 1995-10-27 Mitsubishi Electric Corp 車両用レーダ装置
JP2009192526A (ja) * 2008-01-16 2009-08-27 Ihi Corp レーザ距離測定装置及びその遮蔽物検出方法
JP2011013135A (ja) * 2009-07-03 2011-01-20 Nippon Signal Co Ltd:The 光測距装置
JP2017049097A (ja) * 2015-09-01 2017-03-09 株式会社デンソーウェーブ レーザレーダ装置
US20180284268A1 (en) * 2017-03-29 2018-10-04 Luminar Technologies, Inc. Ultrasonic vibrations on a window in a lidar system

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3196732B2 (ja) * 1998-07-16 2001-08-06 日本電気株式会社 車間距離検出装置
JP3669320B2 (ja) * 2001-10-04 2005-07-06 日産自動車株式会社 車間距離計測装置
JP6256252B2 (ja) * 2014-08-21 2018-01-10 株式会社デンソーウェーブ 固定型非同軸系レーザレーダ走査装置
JP6936070B2 (ja) * 2017-08-01 2021-09-15 トヨタ自動車株式会社 周辺監視装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07280940A (ja) * 1994-04-12 1995-10-27 Mitsubishi Electric Corp 車両用レーダ装置
JP2009192526A (ja) * 2008-01-16 2009-08-27 Ihi Corp レーザ距離測定装置及びその遮蔽物検出方法
JP2011013135A (ja) * 2009-07-03 2011-01-20 Nippon Signal Co Ltd:The 光測距装置
JP2017049097A (ja) * 2015-09-01 2017-03-09 株式会社デンソーウェーブ レーザレーダ装置
US20180284268A1 (en) * 2017-03-29 2018-10-04 Luminar Technologies, Inc. Ultrasonic vibrations on a window in a lidar system

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022209698A1 (ja) * 2021-03-29 2022-10-06 パイオニア株式会社 測定装置、制御装置、制御方法、およびプログラム
WO2023273421A1 (zh) * 2021-06-30 2023-01-05 上海禾赛科技有限公司 用于激光雷达的光罩脏污检测方法及光罩脏污检测系统
EP4386431A1 (en) 2022-12-15 2024-06-19 Mettler-Toledo GmbH Method for diagnosing erroneous distance measurement of a laser rangefinder unit, laser rangefinder unit and computer program
WO2024126067A1 (en) 2022-12-15 2024-06-20 Mettler-Toledo Gmbh Method for diagnosing erroneous distance measurement of a laser rangefinder unit, laser rangefinder unit and computer program

Also Published As

Publication number Publication date
US20220221565A1 (en) 2022-07-14
CN114502984A (zh) 2022-05-13

Similar Documents

Publication Publication Date Title
WO2021065998A1 (ja) 測距装置、及び、測距装置の窓の汚れを検出する方法
JP7447752B2 (ja) 測距装置、及び、測距装置の窓の汚れを検出する方法
JP7013926B2 (ja) 光学的測距装置およびその方法
JP4375064B2 (ja) レーダ装置
JP6863342B2 (ja) 光測距装置
JP2020076589A (ja) 対象物検出装置
JP5710108B2 (ja) 光測距装置
CN112219131B (zh) 光学测距装置及其方法
CN111538020A (zh) 含对应于适应性柱条宽度的子区的基于直方图的信号检测
CN113646660B (zh) 测距装置
JP3966301B2 (ja) 車両用レーダ装置
JP2019144184A (ja) 光学的測距装置およびその方法
CN113330329A (zh) 具有lidar传感器的阻挡检测和天气检测系统
WO2020145035A1 (ja) 距離測定装置及び距離測定方法
JP7180398B2 (ja) 光測距装置およびその制御方法
WO2021210415A1 (ja) 光測距装置
JP2021196342A (ja) 測距装置
US11936845B2 (en) Localized window contaminant detection
JP2009085920A (ja) 車両用レーザレーダ装置および車両用レーザレーダ装置の汚れ判定方法
JP2019135468A (ja) 擾乱光判別装置、擾乱光分離装置、擾乱光判別方法及び擾乱光分離方法
JP2020187042A (ja) 光測距装置
CN112887627B (zh) 增加LiDAR设备动态范围的方法、光检测测距LiDAR设备及机器可读介质
CN112887628B (zh) 光探测和测距设备及增加其动态范围的方法
JP2019138666A (ja) 測距装置
US20230266450A1 (en) System and Method for Solid-State LiDAR with Adaptive Blooming Correction

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: 20871965

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20871965

Country of ref document: EP

Kind code of ref document: A1