WO2024004645A1 - 測距装置、測距システム、および測距方法 - Google Patents
測距装置、測距システム、および測距方法 Download PDFInfo
- Publication number
- WO2024004645A1 WO2024004645A1 PCT/JP2023/022012 JP2023022012W WO2024004645A1 WO 2024004645 A1 WO2024004645 A1 WO 2024004645A1 JP 2023022012 W JP2023022012 W JP 2023022012W WO 2024004645 A1 WO2024004645 A1 WO 2024004645A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- distance
- value
- phase
- distance measurement
- light
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 29
- 238000005259 measurement Methods 0.000 claims description 218
- 238000012545 processing Methods 0.000 claims description 58
- 238000001514 detection method Methods 0.000 claims description 53
- 229920006395 saturated elastomer Polymers 0.000 claims description 28
- 238000000691 measurement method Methods 0.000 claims description 19
- 238000012935 Averaging Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 25
- 238000006243 chemical reaction Methods 0.000 description 9
- 238000002372 labelling Methods 0.000 description 7
- 230000003287 optical effect Effects 0.000 description 7
- 238000012546 transfer Methods 0.000 description 7
- 238000007792 addition Methods 0.000 description 6
- 238000012986 modification Methods 0.000 description 6
- 230000004048 modification Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 230000007423 decrease Effects 0.000 description 3
- 230000003111 delayed effect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000010363 phase shift Effects 0.000 description 3
- 239000000758 substrate Substances 0.000 description 3
- 239000006185 dispersion Substances 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000000737 periodic effect Effects 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000012217 deletion Methods 0.000 description 1
- 230000037430 deletion Effects 0.000 description 1
- 238000009792 diffusion process Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C3/00—Measuring distances in line of sight; Optical rangefinders
- G01C3/02—Details
- G01C3/06—Use of electric means to obtain final indication
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/483—Details of pulse systems
- G01S7/486—Receivers
- G01S7/4861—Circuits for detection, sampling, integration or read-out
- G01S7/4863—Detector arrays, e.g. charge-transfer gates
Definitions
- the present disclosure relates to a ranging device, a ranging system, and a ranging method.
- an indirect time of flight (ToF) method is generally known.
- Indirect ToF method the time from when pattern light is irradiated toward an object until it is received as reflected light is generated as a phase difference, and a distance measurement value is generated based on this phase difference.
- the measured distance value may be limited within one period. For this reason, a technique is known in which the repetition period is determined using a distance value measured by an optical system different from the indirect ToF method. However, since the distance measuring device is equipped with different optical systems, it becomes large in size.
- the present disclosure provides a light receiving device, a control method, and a distance measuring system that can suppress the increase in size of a device that generates a distance value based on a phase difference.
- a distance measuring sensor that receives the reflected light that is returned from the patterned light emitted from the light source device and reflected by the object; a first distance generation unit that generates a first distance measurement value that is a distance to the object based on the position of the pattern light received by a distance measurement sensor; a phase generation unit that generates a time period from when the pattern light is irradiated to when it is received as the reflected light as a phase difference; a second distance generation unit that generates a second distance measurement value that is a distance to the object according to the phase difference and a repetition period of the phase difference based on the first distance measurement value;
- a distance measuring device is provided.
- the apparatus may further include an output processing unit that generates a third measured distance value based on the first measured distance value and the second measured distance value.
- the pattern light is irradiated onto the object at a predetermined period
- the range sensor may accumulate charges at the predetermined period and at a plurality of different phases.
- the first distance generation section may generate a first distance measurement value using the first image generated by the first image generation section.
- the first distance generation unit may detect the position of a bright part of the pattern light, and generate the first measured distance value based on the detected position of the bright part based on the principle of triangulation.
- the plurality of different phases are of four types: 0 degree phase, 90 degree phase, 180 degree phase, and 270 degree phase
- the first image generation unit generates the first image based on a combination of detection signals with a phase of 0 degrees and a phase of 180 degrees, or a combination of detection signals with a phase of 90 degrees and a phase of 270 degrees. May be generated.
- the first image generation unit may generate the first image based on any one of a phase of 0 degrees, a phase of 90 degrees, a phase of 180 degrees, and a phase of 270 degrees.
- the second distance generation unit may generate the second distance measurement value based on the repetition period.
- the output processing unit calculates the first distance value and the second distance value using a first weight value corresponding to the first distance value and a second weight value corresponding to the second distance value.
- the third distance measurement value may be generated by weighted averaging the distance measurement values.
- the output processing section may generate a third measured distance value according to the determination by the determination processing section.
- the first distance generation unit When the determination processing unit determines that the saturation state is present, the first distance generation unit generates a combination of detection signals of a phase of 0 degrees and a phase of 180 degrees, or a combination of detection signals of a phase of 90 degrees and a phase of 270 degrees.
- the first distance measurement value may be generated using the first image generated based on a combination of detection signals of degrees.
- the first distance generating section generates the first distance generated based on the detection signals of 0 degree phase, 90 degree phase, 180 degree phase, and 270 degree phase when the determination processing section determines that the state is not saturated.
- the first distance measurement value may be generated using the image.
- the apparatus may further include a second period determining section that determines a second geometric repetition period of the patterned light based on the second measured distance value.
- the first distance generation unit may generate the first distance measurement value based on the second repetition period.
- the first distance generation unit may generate the first distance measurement value based on the second repetition period when determining that the saturation state is present.
- a light source device that emits patterned light having two types of brightness, a bright part and a dark part; a distance measuring device that receives reflected light that is returned after the patterned light is reflected by an object; Equipped with The distance measuring device is a distance measuring sensor that receives the reflected light that is returned from the patterned light emitted from the light source device and reflected by the object; a first distance generation unit that generates a first distance measurement value that is a distance to the object based on the position of the pattern light received by a distance measurement sensor; a phase generation unit that generates a time period from when the pattern light is irradiated to when it is received as the reflected light as a phase difference; a second distance generation unit that generates a second distance measurement value that is a distance to the object according to the phase difference and a repetition period of the phase difference based on the first distance measurement value; It may have.
- the distance measuring device may further include an output processing unit that generates a third measured distance value based on the first measured distance value and the second measured distance value.
- the apparatus may further include a display device that displays a distance image based on the third measured distance value.
- a distance measurement method that uses reflected light that is returned from a pattern of light emitted from a light source device and reflected by an object, a first distance generation step of generating a first distance value, which is a distance to the object, based on the position of the pattern light included in the reflected light; a phase generation step of generating a time period from when the pattern light is irradiated to when it is received as the reflected light as a phase difference; a second distance generation step of generating a second distance value that is the distance to the object according to the phase difference and a repetition period of the phase difference based on the first distance value;
- a distance measuring method is provided.
- the method may further include an output processing step of generating a third measured distance value based on the first measured distance value and the second measured distance value.
- FIG. 1 is a diagram illustrating a schematic configuration example of a ranging system to which the present technology is applied.
- FIG. 2 is a block diagram showing a configuration example of a light source device and a distance measuring device. A diagram schematically showing the relationship between the distance to an object and the distance measurement method.
- FIG. 2 is a perspective view showing an example of a chip configuration of a distance measuring device.
- FIG. 2 is a block diagram showing a configuration example of a distance measurement sensor.
- FIG. 2 is a block diagram showing an example of a pixel configuration.
- FIG. 3 is a diagram showing a relationship between a light emission pattern of a light source and a detection signal at a pixel.
- FIG. 3 is a block diagram showing an example of the configuration of a signal processing section.
- FIG. 6 is a diagram illustrating an example of an algorithm for generating a first measured distance value by a first distance generating section.
- FIG. 3 is a diagram showing a phase difference generated by a phase generation section.
- 5 is a flowchart showing an example of control in the ranging system 1.
- FIG. 3 is a block diagram illustrating a configuration example of a signal processing unit according to a second embodiment.
- FIG. 3 is a diagram schematically showing a distance measurement range of pattern light in a first distance generation section.
- FIG. 1 is a diagram illustrating a schematic configuration example of a ranging system to which the present technology is applied.
- the distance measuring system 1 shown in FIG. 1 includes a light source device 11, a light emitting side optical system 12, a distance measuring device 21, a light receiving side optical system 22, and a display device 51.
- the light source device 11 generates and irradiates patterned light 15 having two types of brightness, for example, a bright portion and a dark portion.
- the pattern light 15 has, for example, a plurality of spots SP formed of dots (rounds) arranged at regular or irregular predetermined intervals as shown in FIG. 1 as bright parts, and other areas as dark parts. It is said to be a patterned light.
- the pattern light 15 emitted by the light source device 11 is not limited to a pattern in which bright portions are dot-shaped, but may be a lattice pattern or the like.
- the pattern light 15 irradiated from the light source device 11 is irradiated onto a predetermined object OBJ as the object to be measured via the light emitting side optical system 12 . Then, the pattern light 15 is reflected by a predetermined object OBJ, and enters the distance measuring device 21 via the light receiving side optical system 22.
- the distance measuring device 21 receives the pattern light 15 reflected by the object OBJ and incident thereon.
- the distance measuring device 21 generates a detection signal according to the amount of the received pattern light 15. Then, the distance measuring device 21 calculates and outputs a distance value, which is a measured value of the distance to the predetermined object OBJ, based on the detection signal.
- FIG. 2 is a block diagram showing a configuration example of the light source device 11 and the distance measuring device 21.
- the light source device 11 includes a light emitting source 31 and a light source driving section 32.
- the distance measurement device 21 includes a synchronization control section 41, a distance measurement sensor 42, a signal processing section 43, and a storage section 44.
- the light emitting source 31 is constituted by a light source array in which a plurality of light emitting elements such as VCSEL (Vertical Cavity Surface Emitting Laser) are arranged in a plane direction.
- the light source 31 emits light while modulating the timing according to the light emission timing signal supplied from the synchronization control section 41 of the distance measuring device 21 under the control of the light source driving section 32, and emits pattern light 15 as irradiation light. Irradiates a predetermined object OBJ.
- OBJ a predetermined object
- infrared light having a wavelength in the range of about 850 nm to 940 nm is used as the irradiation light.
- the light source driving section 32 is composed of, for example, a laser driver, and causes each light emitting element of the light source 31 to emit light in accordance with a light emission timing signal supplied from the synchronization control section 41.
- the synchronization control section 41 of the distance measuring device 21 generates a light emission timing signal that controls the timing at which each light emitting element of the light source 31 emits light, and supplies it to the light source driving section 32 .
- the synchronization control unit 41 also supplies a light emission timing signal to the distance measurement sensor 42 in order to drive the distance measurement sensor 42 in accordance with the timing of light emission from the light source 31.
- a rectangular wave signal (pulse signal) that turns on and off at a predetermined frequency (eg, 10 MHz, 20 MHz, 50 MHz, 120 MHz, etc.) can be used as the light emission timing signal.
- a predetermined frequency eg, 10 MHz, 20 MHz, 50 MHz, 120 MHz, etc.
- the light emission timing signal is not limited to a rectangular wave as long as it is a periodic signal, and may be a sine wave, for example.
- the distance measuring sensor 42 uses a pixel array section 63 (see FIG. 3) in which a plurality of pixels 71 (see FIG. 3) are two-dimensionally arranged in a matrix, so that the pattern light 15 irradiated from the light source device 11 is directed to a predetermined object OBJ. receives the reflected light. Then, the distance measurement sensor 42 supplies a detection signal corresponding to the amount of received reflected light to the signal processing section 43 for each pixel of the pixel array section 63.
- the signal processing unit 43 is configured to include, for example, a CPU (Central Processing Unit).
- the signal processing unit 43 performs signal processing according to a program stored in the storage unit 44. That is, the signal processing unit 43 generates a distance measurement value, which is the distance from the distance measurement sensor 42 to the predetermined object OBJ, based on the detection signal supplied from the distance measurement sensor 42.
- a CPU Central Processing Unit
- FIG. 3 is a diagram schematically showing the relationship between the distance to the object OBJ and the distance measurement method.
- the signal processing unit 43 according to the present embodiment mainly generates the distance measurement value using the first distance measurement method in the first distance range, and In the second distance range, the distance measurement value is mainly generated using the second distance measurement method.
- the first distance measurement method generates a first distance measurement value based on the position of the bright spot SP in the pattern light on the distance measurement sensor 42, for example.
- This first distance measuring method can use, for example, the so-called SL method, in which the position of the spot SP, which is the bright part of the patterned light 15, is detected, and the position of the detected spot light is used to calculate the distance according to the principle of triangulation. , generates a first distance measurement value.
- the signal processing unit 43 can selectively use images used in the first distance measurement method depending on the distance to the object OBJ.
- the second distance measurement method is, for example, a ToF (Time of Flight) method, in which the time from when the spot SP, which is the bright part of the patterned light 15, is irradiated until it is received as reflected light is detected as a phase difference, Calculate distance based on phase difference. More specifically, the second distance measurement method according to the present embodiment generates the second distance measurement value using the distance based on the phase difference and the repetition cycle number n based on the first distance measurement value.
- ToF Time of Flight
- the detection signal may be saturated, and the distance measurement accuracy by the second distance measurement method tends to decrease, but the distance measurement accuracy by the first distance measurement method is maintained.
- the distance measurement accuracy in the first distance measurement method tends to decrease, but the accuracy is sufficient to determine the repetition period number n.
- the storage unit 44 is realized by, for example, a RAM (Random Access Memory), a semiconductor memory element such as a flash memory, a hard disk, an optical disk, or the like. This storage unit 44 stores the detection signal, the first measured distance value, the second measured distance value, and the like.
- the display device 51 is, for example, a monitor. This display device 51 can display, for example, a two-dimensional distance image.
- FIG. 4 is a perspective view showing an example of the chip configuration of the distance measuring device 21.
- the distance measuring device 21 can be configured with one chip in which a first die (substrate) 91 and a second die (substrate) 92 are stacked.
- the first die 91 includes, for example, a synchronization control section 41 and a distance measurement sensor 42
- the second die 92 includes, for example, a signal processing section 43 and a storage section 44.
- the distance measuring device 21 may be configured with three layers in which another logic die is stacked in addition to the first die 91 and the second die 92, or may be configured with a stack of four or more layers of dies (substrates). You can also Further, the distance measuring device 21 includes a first chip 95 as the distance measuring sensor 42 and a second chip 96 as the signal processing section 43 on a relay board 97, as shown in FIG. 4B, for example. Can be formed and configured. The synchronization control section 41 is included in either the first chip 95 or the second chip 96.
- FIG. 5 is a block diagram showing a configuration example of the ranging sensor 42.
- the distance measurement sensor 42 includes a timing control section 61, a row scanning circuit 62, a pixel array section 63, a plurality of AD (Analog to Digital) conversion sections 64, a column scanning circuit 65, and a signal processing section 66.
- a pixel array section 63 a plurality of pixels 71 are two-dimensionally arranged in a matrix in the row and column directions.
- the row direction is the direction in which the pixels 71 are arranged in the horizontal direction
- the column direction is the direction in which the pixels 71 are arranged in the vertical direction.
- the row direction is the horizontal direction in the figure
- the column direction is the vertical direction in the figure.
- the timing control section 61 includes, for example, a timing generator that generates various timing signals, and generates various timing signals in synchronization with the light emission timing signal supplied from the synchronization control section 41 (FIG. 2).
- the signal is supplied to a row scanning circuit 62, an AD converter 64, and a column scanning circuit 65. That is, the timing control section 61 controls the drive timing of the row scanning circuit 62, the AD conversion section 64, and the column scanning circuit 65.
- the row scanning circuit 62 is composed of, for example, a shift register or an address decoder, and drives each pixel 71 of the pixel array section 63 simultaneously or in units of rows.
- the pixel 71 receives reflected light under the control of the row scanning circuit 62 and outputs a detection signal (pixel signal) at a level corresponding to the amount of received light. Details of the pixel 71 will be described later with reference to FIG.
- pixel drive lines 72 are wired along the horizontal direction for each pixel row, and vertical signal lines 73 are wired along the vertical direction for each pixel column.
- the pixel drive line 72 transmits a drive signal for driving when reading a detection signal from the pixel 71.
- the pixel 71 may be indicated by the symbol I, and its coordinates may be indicated by (x, y).
- x is the position of pixel I in the row direction
- y is the position in the column direction.
- the pixel drive line 72 is shown as one wiring in FIG. 5, it is actually composed of a plurality of wirings.
- the vertical signal line 73 is shown as one wiring, it is actually composed of a plurality of wirings.
- the AD converter 64 is provided for each column, and converts the detection signal supplied from each pixel 71 in the corresponding column via the vertical signal line 73 in synchronization with the clock signal CK supplied from the timing controller 61. AD convert.
- the AD converter 64 outputs the AD-converted detection signal (detection data) to the signal processor 66 under the control of the column scanning circuit 65 .
- the column scanning circuit 65 sequentially selects the AD conversion units 64 and outputs the detected data after AD conversion to the signal processing unit 66 .
- FIG. 6 is a block diagram showing an example of the configuration of the pixel 71.
- the pixel 71 includes a photoelectric conversion element 81, a transfer switch 82, charge storage sections 83 and 84, and selection switches 85 and 86.
- the photoelectric conversion element 81 is composed of, for example, a photodiode, and photoelectrically converts reflected light to generate charges.
- Transfer switch 82 transfers the charge generated by photoelectric conversion element 81 to either charge storage section 83 or 84 based on transfer signal SEL_FD.
- the transfer switch 82 is composed of, for example, a pair of MOS (Metal-Oxide-Semiconductor) transistors.
- MOS Metal-Oxide-Semiconductor
- the charge storage sections 83 and 84 are formed of, for example, floating diffusion layers, accumulate charges, and generate a voltage according to the accumulated charges.
- the charges accumulated in charge accumulation sections 83 and 84 can be reset based on a reset signal RST.
- the selection switch 85 selects the output of the charge storage section 83 according to the selection signal RD_FD1.
- the selection switch 86 selects the output of the charge storage section 84 according to the selection signal RD_FD2. That is, when the selection switch 85 or 86 is turned on by the selection signal RD_FD1 or RD_FD2, a voltage signal corresponding to the accumulated charge of the turned-on charge storage section 83 or 84 is sent as a detection signal via the vertical signal line 73. Then, it is output to the AD conversion section 64.
- Each of the selection switches 85 and 86 is composed of, for example, a MOS transistor.
- the wiring that transmits the transfer signal SEL_FD, the reset signal RST, and the selection signals RD_FD1 and RD_FD2 corresponds to the pixel drive line 72 in FIG. 4.
- the charge storage units 83 and 84 are called a first tap and a second tap, respectively, in the ToF method, the pixel 71 transfers the charge generated by the photoelectric conversion element 81 to the first tap and the second tap.
- detection signals at two light reception timings with opposite phases such as phase 0 degrees and phase 180 degrees, can be acquired in one frame.
- detection signals of two light reception timings one with a phase of 90 degrees and the other with a phase of 270 degrees, can be obtained.
- FIG. 7 is a diagram showing the relationship between the light emission pattern of the light source 31 and the detection signal at the pixel 71. From the top, the light emission pattern of the light emitting source 31, the light reception pattern which is the timing at which the light emission pattern is received by the pixel 71, and the detection signals of phase 0 degrees, phase 90 degrees, phase 180 degrees, and phase 270 degrees are shown.
- the vertical axis of each signal indicates high level and low level, and the horizontal axis indicates time.
- the high level of the light emission pattern indicates the time during which the pattern light 15 (see FIG. 1) is irradiated, and the high level of the light reception pattern indicates the time during which the pattern light 15 is reflected and returned.
- pulsed light that repeatedly turns on and off at high speed at a frequency f (modulation frequency) is used.
- One period T of the pulsed light is 1/f.
- the reflected light is detected with a phase shift depending on the time ⁇ t from the light emitting source 31 to the distance measurement sensor 42.
- a high level in the detection signal of phase 0 degrees indicates the light reception timing of the pixel 71. That is, this is the timing at which the phase of the pulsed light emitted by the light source 31 of the light source device 11 is the same as that of the light emission pattern.
- the high level of the detection signal with a phase of 90 degrees is the timing at which the phase is delayed by 90 degrees from the pulsed light (light emission pattern) emitted by the light emitting source 31 of the light source device 11.
- the high level of the detection signal with a phase of 180 degrees is the timing at which the phase is delayed by 180 degrees from the pulsed light (light emission pattern) emitted by the light emitting source 31 of the light source device 11.
- the high level of the detection signal with a phase of 270 degrees is the timing at which the phase is delayed by 270 degrees from the pulsed light (light emission pattern) emitted by the light emitting source 31 of the light source device 11.
- the measurement signals corresponding to the charges accumulated when the light reception timing is set to phase 0 degrees, phase 90 degrees, phase 180 degrees, and phase 270 degrees are respectively Q0, Q90, Q180, and Q270. Signals corresponding to these charges are AD converted, and measurement signals Q0 (x, y), Q90 (x, y), Q180 (x, y), and Q270 (x, y) are generated for each pixel I (x, y). y) is stored in the storage unit 44.
- FIG. 8 is a block diagram showing a configuration example of the signal processing section 43.
- the signal processing section 43 includes an image generation section 430, a pattern detection section 432, a determination section 434, a first distance generation section 436, a phase generation section 437, a period determination section 438, It includes a second distance generation section 440 and an output processing section 442.
- the image generation unit 430 generates a two-dimensional image using at least one of the measurement signals Q0 (x, y), Q90 (x, y), Q180 (x, y), and Q270 (x, y). do. More specifically, the image generation unit 430 adds the measurement signals Q0 (x, y), Q90 (x, y), Q180 (x, y), and Q270 (x, y) to obtain the first A pixel value Ga(x,y) of the image Ga is generated. Furthermore, the image generation unit 430 generates the second image G0 using each of the measurement signals Q0(x, y), Q90(x, y), Q180(x, y), and Q270(x, y).
- FIG. 9 is a diagram showing the relationship between the distance to the object OBJ, the first image Ga, and the sixth image Gc.
- White indicates a high-luminance area
- the top shows the first image Ga
- the bottom shows the sixth image Gc.
- the distance to the object OBJ is 10, 15, 25, and 50 centimeters.
- the pixel value Ga(x,y) of the first image Ga is determined by the measurement signals Q0(x,y), Q90(x,y), Q180(x,y), and Q270(x , y), an image with a better SN ratio is generated.
- the pixels may become saturated and it may become impossible to individually distinguish the areas of the bright spots SP.
- the areas of bright spots SP can be individually determined up to about 15 cm.
- the signal values of the measurement signals Q0 (x, y), Q90 (x, y), Q180 (x, y), and Q270 (x, y) are different in magnitude. Therefore, the contrast of the bright spot SP region in the pattern light is different. As a result, any one of the second image G0, the third image G90, the fourth image G180, and the fifth image G270 can further reduce the area of the bright spot SP even if the distance to the object OBJ is about 15 cm. It becomes clearly distinguishable.
- the pattern detection unit 432 detects, for example, a bright spot SP area in the pattern light from the two-dimensional image generated by the image generation unit 430.
- the pattern detection unit 432 performs, for example, binarization processing on the two-dimensional image, and then performs labeling processing. Then, the pattern detection unit 432 stores information on the regions subjected to the labeling process and each coordinate corresponding to the position of the center of gravity of each area subjected to the labeling process in the storage unit 44.
- the determining unit 434 determines whether there is a saturated area of the two-dimensional image based on the information on the area where the pattern detecting unit 432 has performed the labeling process on the first image Ga. For example, when it is determined that the size of each area subjected to labeling processing exceeds a predetermined range, it is determined that the area is saturated. As a result, the determination result for each pixel I(x, y) is stored in the storage unit 44. For example, the determination unit 434 associates 0 with a pixel I (x, y) in an unsaturated area, and stores 1 in association with a pixel I (x, y) in a saturated area.
- the first distance generation unit 436 generates the first distance measurement value D1(x,y) for each pixel I(x,y) using the first distance measurement method described above.
- the first distance generation section 436 can change the image used to generate the first distance value, depending on the determination result of the determination section 434.
- the first distance generation unit 436 uses the first image Ga to generate the first distance measurement value for the area that the determination unit 434 determines is not saturated.
- the object OBJ is located at a distance of 60 cm or more, and measurement accuracy is improved by using a signal with a higher SN.
- the first distance generation unit 436 generates the first distance measurement value using the fifth image Gb or the sixth image Gc for the area determined by the determination unit 434 to be saturated. .
- the fifth image Gb or the sixth image G whose saturation is suppressed more than the first image Ga it is possible to improve the measurement accuracy for the object OBJ at a closer distance.
- the first distance generation unit 436 selects one of the second image G0, third image G90), fourth image G180, and fifth image G270, and generates the first distance measurement value. It's okay. In this case, the first distance generation unit 436 selects the image in which each region subjected to the labeling process by the determination unit 434 has the smallest size. In this case, by using any one of the second image G0, third image G90, fourth image G180, and fifth image G270 whose saturation is further suppressed than the fifth image Gb or the sixth image Gc. , it becomes possible to further improve the measurement accuracy for the object OBJ at a short distance.
- FIG. 10 is a diagram illustrating an example algorithm for generating the first measured distance value by the first distance generating section 436. As shown in FIG. 10, this is an example in which the SL method is used for the first distance generating section 436.
- the SL method uses a light source device 11 that projects pattern light and a distance measurement sensor 42 that receives the pattern light to find a pair between a certain position within the projection pattern and the corresponding position of the light receiving sensor. , apply triangulation to measure distance.
- the light source device 11 irradiates the object OBJ with a plurality of spots SP arranged at predetermined intervals as shown in FIG. Assume that the spot SP is detected at a predetermined position P2 in the light receiving area of the distance measuring sensor 42.
- the pattern detection unit 432 stores each barycenter coordinate of this position P2 in the storage unit 44.
- the position P1 in the projection pattern of the light source device 11 that has emitted the attention spot SP is known in the light source device 11. Furthermore, the positional relationship between the light source device 11 and the distance measurement sensor 42, including the baseline distance BL between the light source principal point (projection center) of the light source device 11 and the sensor principal point (light reception center) of the distance measurement sensor 42, is also known. It is. Therefore, the first distance generation unit 436 uses the position P1, the position P2, and the baseline distance BL to perform first distance measurement corresponding to the distance from the distance measurement device 21 to the object OBJ based on the principle of triangulation. The value D1(x,y) can be calculated.
- the first distance generation unit 436 determines which of the plurality of spots SP emitted by the light source device 11 each of the received spots SP corresponds to when the distance measurement sensor 42 receives the plurality of spots SP of the pattern light 15. Once it is known whether the spot SP corresponds to the spot SP, the first distance measurement value D1 (x, y) from the distance measuring device 21 to the object OBJ is calculated for each pixel I (x, y) for each of the plurality of spots SP. becomes possible.
- the distance measurement sensor 42 receives a predetermined spot SP at a predetermined position in the light receiving area, the pattern light 15 emitted by the light source device 11 of the distance measurement system 1 is transmitted to the spot SP of the light emitting source 31 that emitted it.
- a plurality of spots SP are arranged in a pattern so that (the position of) the spot SP can be specified.
- the position of the spot SP that is received as reflected light by the distance measurement sensor 42 moves within the light receiving area according to the distance to the object OBJ, but the trajectory of each spot SP is different from that of other spots. If the trajectory of the spot SP does not overlap, the spot SP (the position of the light emitting source 31) that has emitted the light can be identified based on the position of the spot SP received by the distance measuring sensor 42.
- the pattern light 15 has a dot pattern in which a plurality of spots SP are arranged at sufficiently sparse intervals such that the position of the spot SP detected by the distance measurement sensor 42 does not overlap with other spots SP.
- phase generation section 437 period determination section 438
- second distance generation section 440 will be explained with reference to FIG. First, a distance measurement method using the ToF method will be explained.
- the second distance measurement value D2 (x, y) [mm] corresponding to the distance from the distance measurement device 21 to the object OBJ can be calculated using the following equation (1).
- ⁇ t (x, y) in equation (1) is the time it takes for the pattern light 15 emitted from the light emitting source 31 to be reflected by the object OBJ and to enter each pixel (x, y) of the distance measurement sensor 42.
- c represents the speed of light.
- (x, y) are the coordinates of the pixel 71.
- the patterned light 15 emitted from the light emitting source 31 employs pulsed light that repeatedly turns on and off at a predetermined frequency f (modulation frequency) as shown in FIG. 7 at high speed.
- One period T of the pulsed light is 1/f.
- the distance measurement sensor 42 detects the reflected light (light reception pattern) with a phase shift depending on the time ⁇ t (x, y) from the light emitting source 31 to the distance measurement sensor 42 . If the amount of phase shift (phase difference) between the light emitting pattern and the light receiving pattern is ⁇ (x, y), the time ⁇ t(x, y) can be calculated using the following equation (2).
- the distance measurement value D2a (x, y) from the distance measurement sensor 42 to the object OBJ can be calculated using the following equation (3) from equation (1) and equation (2).
- FIG. 11 is a diagram showing the phase difference ⁇ generated by the phase generator 437.
- the phase generation unit 437 converts the phase difference ⁇ (x, y) at the pixel I(x, y) into the measurement signals Q0(x, y), Q90(x, y), Q180(x , y) and Q270(x, y) using the following equation (4).
- the second distance measurement value D2a(x, y) from distance measurement system 1 to object OBJ can be obtained. It can be calculated.
- FIG. 12 is a diagram showing an example of second distance measurement values for each frequency.
- the vertical axis is the measured distance and corresponds to the second measured distance value.
- a second distance measurement value L10 when a pulse signal with a frequency of 10 MHz is used for light emission and a second distance measurement value L120 when a pulse signal with a frequency of 120 MHz is used for light emission are shown.
- the second distance measurement value becomes more accurate as the frequency becomes higher.
- so-called aliasing occurs at high frequencies.
- the second distance measurement value when a pulse signal with a frequency of 120 MHz is used for light emission is 0 to 1.25 meters. Therefore, the second distance measurement value L120 repeats the distance measurement value from 0 to 1.25 meters.
- the cycle determining unit 438 determines the repetition cycle n(x, y) using the first distance measurement value D1(x, y). That is, the cycle determining unit 438 divides the first distance measurement value D1 (x, y) by D3 (f) and converts it into an integer using the floor function floor. D3(f) is a distance determined by the period f of the pulse signal.
- the second distance generation unit 440 generates a second distance measurement value using a second distance measurement method. That is, as shown in equation (6), the second distance generation unit 440 generates the distance measurement value D2a (x, y) based on the phase difference ⁇ (x, y) and the first distance measurement value D1 (x, y). The second distance measurement value D2 (x, y) is generated using the repetition period number n (x, y) based on y).
- the output processing unit 442 converts the measured distance value Dall (x, y) corresponding to each pixel I (x, y) into the first measured distance value D1 (x, y) and the second measured distance value D2 (x, y). ). More specifically, the distance value Dall(x,y) is generated using the determination result by the determination unit 434 for each pixel I(x,y) stored in the storage unit 44. For example, when the determination result of pixel I (x, y) indicates saturation, the first distance measurement value D1 (x, y) is set as the distance value Dall (x, y), and when it does not indicate saturation, Let the second measured distance value D2 (x, y) be the measured distance value Dall (x, y). The output processing unit 442 may cause the storage unit 44 to store the measured distance value Dall (x, y) and display the generated two-dimensional distance image Dall on the display device 51. This allows the operator to visually confirm the two-dimensional distance image Dall.
- FIG. 13 is a diagram showing the distance measurement value Dall (x, y) of pulsed light with a period of 120 MHz and the second distance measurement value D2 (x, y) of pulsed light with a period of 10 MHz to be compared.
- the distance measurement value Dall (x, y) of pulsed light with a period of 120 MHz is shown by line L20
- the second distance measurement value D2 (x, y) of pulsed light with a period of 10 MHz is shown by line L30.
- the horizontal axis indicates the distance to the object OBJ
- the vertical axis indicates distance measurement noise. Ranging noise is the variance of measured distances.
- the measurement signal is saturated using only the second distance value D2 (x, y), it is difficult to measure less than 60 centimeters, which corresponds to the first distance range (see FIG. 3), for example. Become.
- the first distance measurement value D1 (x, y) uses a two-dimensional image, the position of the spot SP can be detected even when the measurement signal is saturated. Therefore, with the distance measurement value Dall (x, y) according to the present embodiment that also uses the first distance measurement value D1 (x, y), distance measurement is possible up to about 15 centimeters.
- the distance measurement value of pulsed light with a period of 120 MHz is 1.25 meters, but in the distance measurement value Dall (x, y) according to the present embodiment, the repetition period number n (x, y ), it becomes possible to measure distances up to about 9 meters. As described above, as the period of the pulsed light becomes higher, the second distance measurement value is measured with higher precision. Therefore, the distance measurement value Dall (x, y) according to the present embodiment has less distance measurement noise at 5 meters than the second distance measurement value D2 (x, y) with a period of 10 MHz of pulsed light, which is the subject of comparison. 91 percent reduction and 81 percent reduction at 7 meters.
- the first distance measurement value D1(x,y) can be used as the distance measurement value Dall(x,y) according to the present embodiment. Therefore, the distance measurement value corresponding to the first distance range (see FIG. 3) where the detection signal is saturated and it is difficult to obtain the second distance measurement value D2 (x, y) by the Tof method is normally used. It becomes possible to obtain Dall(x, y).
- the first distance value D1 (x, y) when measuring distance with a pulsed light cycle of 120 MHz, even if so-called aliasing occurs in a range of 1.25 meters or more corresponding to the second distance range (see FIG. 3), the first distance value D1 (x, y) to generate a period number n(x, y), and a second distance measurement value D2 (x, y) with higher measurement accuracy than the first distance measurement value D1 (x, y).
- the same distance measurement sensor 42 since the same distance measurement sensor 42 is used, it is possible to suppress the number of measurement systems from becoming plural, and it is possible to suppress the increase in size of the apparatus.
- FIG. 14 is a flowchart showing an example of control in the ranging system 1.
- the distance measurement sensor 42 of the distance measurement device 21 generates measurement signals Q0 (x, y), Q90 (x, y), Q180 (x, y), and Q270 (x, y) (step S10 ).
- the image generation unit 430 generates a first image Ga obtained by adding the measurement signals Q0 (x, y), Q90 (x, y), Q180 (x, y), and Q270 (x, y), and the signal A sixth image Gc is generated by adding SQ90(x, y) and Q270(x, y) (step S12).
- the determining unit 434 determines the saturated area and the unsaturated area of the first image Ga from the information of the area where the pattern detecting unit 432 has subjected the labeling process to the first image Ga (step S14). If there is a region that is determined to be not saturated (No in step S14), the first distance generation unit 436 uses the first image Ga to calculate pixel I(x, y) for the region that is not saturated. A first distance measurement value D1 (x, y) is generated for each time (step S16). The determining unit 434 associates, for example, 1 with each pixel I(x, y) in the area determined to be not saturated, and stores it in the storage unit 44 .
- the period determining unit 438 uses the first distance measurement value D1 (x, y) to determine the repetition period n(x, y) for the area determined to be not saturated (step S18 ). Then, the second distance generation unit 440 generates a measured distance value D2a(x,y) based on the phase difference ⁇ (x,y) generated by the phase generation unit 437 for the area determined to be not saturated. , the repetition period number n(x,y) based on the first distance measurement value D1(x,y), and a second distance measurement value D2(x,y) is generated (step S20).
- the first distance generation unit 436 determines that there is a saturated area in the first image Ga(x, y).
- the first distance measurement value D1 (x, y) for each pixel I (x, y) is generated using the sixth image Gc (step S22).
- the determining unit 434 associates, for example, 0 with each pixel I(x, y) in the area determined to be saturated and stores it in the storage unit 44 .
- the output processing unit 442 uses the determination result of the determination unit 434 for each pixel I (x, y) stored in the storage unit 44 to determine if the determination result of the pixel I (x, y) indicates saturation.
- the first measured distance value D1 (x, y) is set as the measured distance value Dall (x, y)
- the first measured distance value D2 (x, y) is set as the measured distance value Dall (x, y)
- a two-dimensional distance image Dall is generated as (x, y) (step S24).
- the output processing unit 442 causes the two-dimensional distance image Dall to be stored in the storage unit 44 and displayed on the display device 51 (step S26).
- the first distance generation unit 436 generates the first distance value D1 (which is the distance to the object OBJ) based on the position of the pattern light received by the distance measurement sensor 42. x, y), and the second distance generation unit 440 generates a distance measurement value D2a (x, y) based on the phase difference ⁇ (x, y) generated by the phase generation unit 437, and a first distance measurement value
- the second distance measurement value D2 (x, y) is generated using the repetition period number n (x, y) based on D1 (x, y).
- the second distance measurement value D2(x, y) can be generated with higher accuracy.
- the single distance measurement sensor 42 since the single distance measurement sensor 42 generates a signal used for measurement by the first distance generation section 436 and the second distance generation section 440, it is possible to further downsize the distance measurement device 21.
- the output processing unit 442 calculates a first distance value D1 (x, y) for the region determined by the period determining unit 438 as not being saturated.
- the distance measurement system 1 differs from the distance measurement system 1 according to the first embodiment in that the distance measurement value Dall (x, y) is generated by weighted addition of the second distance measurement value D2a (x, y).
- W _SL (x, y) is a weight value according to the distance of the first distance measurement value D1 (x, y), as shown in equation (9), and a dispersion value of the distance according to the distance.
- ⁇ 2 _SL is the reciprocal of (x, y).
- FIG. 15 shows the distance measurement error and distance between the weighted and added distance value Dall (x, y) and the distance value Dall (x, y) to which the first distance value D1 (x, y) is not added.
- FIG. Line L40 is the measured distance value Dall (x, y) without adding the first measured distance value D1 (x, y)
- line L50 is the weighted sum of the first measured distance value D1 (x, y).
- the measured distance value Dall(x, y) is In the distance measurement value Dall (x, y) obtained by weighted addition, the distance measurement error is improved in the range of, for example, 0.9 meters to 2 meters.
- the first distance measurement value D1 (x, y) and the second distance measurement value are the reciprocals of the distance variance values ⁇ 2 _ToF (x, y) and ⁇ 2 _SL (x, y) according to the distance.
- D2a (x, y) By adding the value D2a (x, y), it is possible to further improve measurement accuracy.
- the first distance generation unit 436 can use information about the repetition period of the patterned light 15 when generating the first distance measurement value D1 (x, y). This differs from the ranging system 1 according to the first modification of the first embodiment in this respect. Below, differences from the ranging system 1 according to the first modification of the first embodiment will be explained.
- FIG. 16 is a block diagram showing a configuration example of the signal processing section 43 according to the second embodiment. As shown in FIG. 16, a second period determination section 444 is further provided.
- FIG. 17 is a diagram schematically showing the distance measurement range of the patterned light 15 in the first distance generation section 436.
- the first distance generation unit 436 generates one distance measurement value D1 (x, y) according to the position of each spot light in the area A20 on the light receiving surface of the distance measurement sensor 42.
- the patterned light 15 may be formed into a uniform pattern.
- the second distance generation unit 440 is able to generate the second distance measurement value D2a (x, y), although the measurement accuracy is reduced.
- the second cycle determination unit 444 uses the second distance measurement value D2a (x, y) of the peripheral area of the distance measurement sensor 42 with respect to the area determined to be saturated. Therefore, the geometric period of the patterned light 15 was determined. Thereby, even when the pattern light 15 is configured with a geometrically uniform repeating periodic pattern, it is possible to suppress the measurement accuracy of the first distance measurement value D1 (x, y) from decreasing.
- a distance measuring sensor that receives the reflected light that is returned from the patterned light emitted from the light source device and reflected by the object; a first distance generation unit that generates a first distance measurement value that is a distance to the object based on the position of the pattern light received by a distance measurement sensor; a phase generation unit that generates a time period from when the pattern light is irradiated to when it is received as the reflected light as a phase difference; a second distance generation unit that generates a second distance measurement value that is a distance to the object according to the phase difference and a repetition period of the phase difference based on the first distance measurement value; A distance measuring device equipped with.
- (4) further comprising a first image generation unit that generates a two-dimensional first image based on at least one of the plurality of detection signals based on the charges accumulated in the plurality of different phases, The distance measuring device according to (3), wherein the first distance generation section generates a first distance measurement value using the first image generated by the first image generation section.
- the first distance generation unit detects the position of the bright part of the pattern light, and generates the first measured distance value based on the detected position of the bright part based on the principle of triangulation. distance measuring device.
- the plurality of different phases are of four types: 0 degree phase, 90 degree phase, 180 degree phase, and 270 degree phase
- the first image generation unit generates the first image based on a combination of detection signals with a phase of 0 degrees and a phase of 180 degrees, or a combination of detection signals with a phase of 90 degrees and a phase of 270 degrees.
- the distance measuring device according to (5) that generates.
- (8) further comprising a cycle determination unit that determines a repetition cycle of the phase based on the first distance measurement value, The distance measuring device according to (7), wherein the second distance generation unit generates the second distance measurement value based on the repetition period.
- the output processing unit calculates the first distance value and the second distance value using a first weight value corresponding to the first distance value and a second weight value corresponding to the second distance value.
- the distance measurement device according to (8) which generates the third distance measurement value by weighted averaging the distance measurement values.
- the first distance generation unit When the determination processing unit determines that the saturation state is present, the first distance generation unit generates a combination of detection signals of a phase of 0 degrees and a phase of 180 degrees, or a combination of detection signals of a phase of 90 degrees and a phase of 270 degrees.
- the first distance generating section generates the first distance generated based on the detection signals of 0 degree phase, 90 degree phase, 180 degree phase, and 270 degree phase when the determination processing section determines that the state is not saturated.
- the distance measuring device further comprising a second period determination unit that determines a second geometric repetition period of the patterned light based on the second distance measurement value.
- a light source device that emits patterned light having two types of brightness, a bright part and a dark part; a distance measuring device that receives reflected light that is returned after the patterned light is reflected by an object; Equipped with The distance measuring device is a distance measuring sensor that receives the reflected light that is returned from the patterned light emitted from the light source device and reflected by the object; a first distance generation unit that generates a first distance measurement value that is a distance to the object based on the position of the pattern light received by a distance measurement sensor; a phase generation unit that generates a time period from when the pattern light is irradiated to when it is received as the reflected light as a phase difference; a second distance generation unit that generates a second distance measurement value that is a distance to the object according to the phase difference and a repetition period of the phase difference based on the first distance measurement value; A ranging system with
- the ranging device further includes an output processing unit that generates a third ranging value based on the first ranging value and the second ranging value.
- a distance measurement method that uses reflected light that is returned from a pattern of light emitted from a light source device and reflected by an object, a first distance generation step of generating a first distance value, which is a distance to the object, based on the position of the pattern light included in the reflected light; a phase generation step of generating a time period from when the pattern light is irradiated to when it is received as the reflected light as a phase difference; a second distance generation step of generating a second distance value that is the distance to the object according to the phase difference and a repetition period of the phase difference based on the first distance value;
- a distance measurement method comprising:
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Measurement Of Optical Distance (AREA)
Abstract
[課題]本開示では、位相差に基づき測距値を生成する装置の大型化を抑制可能な受光装置、制御方法、および測距システムを提供する。 [解決手段]本開示によれば、光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、測距センサで受光されたパターン光の位置に基づき、物体までの距離である第1測距値を生成する第1距離生成部と、パターン光が照射されてから反射光として受光されるまでの時間を位相差として生成する、位相生成部と、位相差と、第1測距値に基づく位相差の繰り返し周期と、に応じて物体までの距離である第2測距値を生成する第2距離生成部と、を備える測距装置が提供される。
Description
本開示は、測距装置、測距システム、および測距方法に関する。
測距モジュールにおける測距方法としては、例えばIndirect ToF(Indirect Time of Flight)方式が一般に知られている。このIndirect ToF方式では、物体に向かってパターン光が照射されてから反射光として受光されるまでの時間を位相差として生成し、この位相差に基づき測距値を生成する。
位相差の繰り返し周期が生じるため、測距値は1周期内に制限される恐れがある。このため、Indirect ToF方式とは異なる光学系による測距値を用いて繰り返し周期を求める技術が知られている。ところが、異なる光学系を備えるため測距装置が大型化してしまう。
そこで、本開示では、位相差に基づき測距値を生成する装置の大型化を抑制可能な受光装置、制御方法、および測距システムを提供する。
上記の課題を解決するために、本開示によれば、
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を備える測距装置が提供される。
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を備える測距装置が提供される。
前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理部を、更に備えてもよい。
前記パターン光は、所定の周期で前記物体に照射されており、
前記測距センサは、前記所定の周期で、且つ複数の異なる位相で電荷の蓄積を行ってもよい。
前記測距センサは、前記所定の周期で、且つ複数の異なる位相で電荷の蓄積を行ってもよい。
前記複数の異なる位相で蓄積された電荷に基づく、複数の検出信号の少なくともいずれかに基づき2次元の第1画像を生成する第1画像生成部を更に備え、
前記第1距離生成部は、前記第1画像生成部の生成した第1画像を用いて、第1測距値を生成してもよい。
前記第1距離生成部は、前記第1画像生成部の生成した第1画像を用いて、第1測距値を生成してもよい。
前記第1距離生成部は、前記パターン光の明部の位置を検出し、検出した前記明部の位置に基づき、三角測量の原理により前記第1測距値を生成してもよい。
前記複数の異なる位相は、位相0度、位相90度、位相180度、および、位相270度の4種類であり、
前記第1画像生成部は、位相0度、および、位相180度の検出信号の組合わせ、又は、位相90度、および、位相270度の検出信号の組合わせ、に基づき、前記第1画像を生成してもよい。
前記第1画像生成部は、位相0度、および、位相180度の検出信号の組合わせ、又は、位相90度、および、位相270度の検出信号の組合わせ、に基づき、前記第1画像を生成してもよい。
前記第1画像生成部は、位相0度、位相90度、位相180度、および、位相270度のいずれかに基づき、前記第1画像を生成してもよい。
前記第1測距値に基づき、前記位相の繰り返し周期を判定する周期判定部を、更に備え、
前記第2距離生成部は、前記繰り返し周期に基づき、前記第2測距値を生成してもよい。
前記第2距離生成部は、前記繰り返し周期に基づき、前記第2測距値を生成してもよい。
前記出力処理部は、前記第1測距値に応じた第1重み値と、前記第2測距値に応じた第2重み値と、を用いて、前記第1測距値と前記第2測距値とを加重平均して第3測距値を生成してもよい。
前記位相差を検出する際の検出信号が飽和状態であるか否かを判定する判定処理部を更に備え、
前記出力処理部は、前記判定処理部の判定に応じて、第3測距値を生成してもよい。
前記出力処理部は、前記判定処理部の判定に応じて、第3測距値を生成してもよい。
前記第1距離生成部は、前記判定処理部が、飽和状態であると判定する場合に、位相0度、および、位相180度の検出信号の組合わせ、又は、位相90度、および、位相270度の検出信号の組合わせ、に基づき生成した前記第1画像を用いて第1測距値を生成してもよい。
前記第1距離生成部は、前記判定処理部が、飽和状態でないと判定する場合に、位相0度、位相90度、位相180度、および、位相270度の検出信号に基づき生成した前記第1画像を用いて第1測距値を生成してもよい。
前記第2測距値に基づき、前記パターン光の幾何学的な第2繰り返し周期を判定する第2周期判定部を、更に備えてもよい。
前記第1距離生成部は、前記第2繰り返し周期に基づき、前記第1測距値を生成してもよい。
前記第1距離生成部は、前記飽和状態であると判定する場合に、前記第2繰り返し周期に基づき、前記第1測距値を生成してもよい。
上記の課題を解決するために、本開示によれば、
明部と暗部の2種類の輝度を有するパターン光を照射する光源装置と、
前記パターン光が物体で反射されて返ってきた反射光を受光する測距装置と
を備え、
前記測距装置は、
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を有してもよい。
明部と暗部の2種類の輝度を有するパターン光を照射する光源装置と、
前記パターン光が物体で反射されて返ってきた反射光を受光する測距装置と
を備え、
前記測距装置は、
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を有してもよい。
前記測距装置は、前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理部を、更に備えてもよい。
前記第3測距値に基づき、距離画像を表示する表示装置を更に備えてもよい。
上記の課題を解決するために、本開示によれば、
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を用いる測距方法であって、
前記反射光に含まれるパターン光の位置に基づき、物体までの距離である第1測距値を生成する第1距離生成工程と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成工程と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成工程と、
を備える測距方法が提供される。
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を用いる測距方法であって、
前記反射光に含まれるパターン光の位置に基づき、物体までの距離である第1測距値を生成する第1距離生成工程と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成工程と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成工程と、
を備える測距方法が提供される。
前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理工程を、更に備えてもよい。
以下、図面を参照して、測距装置、測距システム、および測距方法の実施形態について説明する。以下では、測距装置、測距システム、および測距方法の主要な構成部分を中心に説明するが測距装置、測距システム、および測距方法には、図示又は説明されていない構成部分や機能が存在しうる。以下の説明は、図示又は説明されていない構成部分や機能を除外するものではない。
(第1実施形態)
図1は、本技術を適用した測距システムの概略構成例を示している図である。図1に示す測距システム1は、光源装置11、発光側光学系12、測距装置21、受光側光学系22、および、表示装置51を有する。光源装置11は、例えば明部と暗部の2種類の輝度を有するパターン光15を生成して照射する。パターン光15は、例えば、図1に示されるような、規則的または不規則な所定の間隔で配置されたドット(丸)形状からなる複数のスポットSPを明部とし、その他の領域を暗部とするパターン光とされる。なお、光源装置11が照射するパターン光15は、明部をドット形状としたパターンに限定されず、格子パターン等でもよい。光源装置11から照射されたパターン光15は、発光側光学系12を介して被測定物としての所定の物体OBJに照射される。そして、パターン光15は、所定の物体OBJで反射され、受光側光学系22を介して、測距装置21に入射される。
図1は、本技術を適用した測距システムの概略構成例を示している図である。図1に示す測距システム1は、光源装置11、発光側光学系12、測距装置21、受光側光学系22、および、表示装置51を有する。光源装置11は、例えば明部と暗部の2種類の輝度を有するパターン光15を生成して照射する。パターン光15は、例えば、図1に示されるような、規則的または不規則な所定の間隔で配置されたドット(丸)形状からなる複数のスポットSPを明部とし、その他の領域を暗部とするパターン光とされる。なお、光源装置11が照射するパターン光15は、明部をドット形状としたパターンに限定されず、格子パターン等でもよい。光源装置11から照射されたパターン光15は、発光側光学系12を介して被測定物としての所定の物体OBJに照射される。そして、パターン光15は、所定の物体OBJで反射され、受光側光学系22を介して、測距装置21に入射される。
測距装置21は、物体OBJで反射されて入射されてくるパターン光15を受光する。測距装置21は、受光したパターン光15の光量に応じた検出信号を生成する。そして、測距装置21は、検出信号に基づいて、所定の物体OBJまでの距離の測定値である測距値を算出し、出力する。
図2は、光源装置11と測距装置21の構成例を示すブロック図である。図2に示すように、光源装置11は、発光源31と、光源駆動部32とを有する。測距装置21は、同期制御部41、測距センサ42、信号処理部43、および、記憶部44を有する。
発光源31は、例えば、VCSEL(Vertical Cavity Surface Emitting Laser:垂直共振器面発光レーザ)等の発光素子を平面方向に複数配列した光源アレイで構成される。発光源31は、光源駆動部32の制御にしたがい、測距装置21の同期制御部41から供給される発光タイミング信号に応じたタイミングで変調しながら発光して、照射光としてのパターン光15を所定の物体OBJに照射する。照射光には、例えば、波長が約850nmから940nmの範囲の赤外光が用いられる。
光源駆動部32は、例えば、レーザドライバ等で構成され、同期制御部41から供給される発光タイミング信号に応じて、発光源31の各発光素子を発光させる。測距装置21の同期制御部41は、発光源31の各発光素子が発光するタイミングを制御する発光タイミング信号を生成し、光源駆動部32に供給する。また、同期制御部41は、発光源31の発光のタイミングに合わせて測距センサ42を駆動させるために、発光タイミング信号を測距センサ42にも供給する。発光タイミング信号には、例えば、所定の周波数(例えば、10MHz、20MHz、50MHz、120MHzなど)でオンオフする矩形波の信号(パルス信号)を用いることができる。なお、発光タイミング信号は、周期信号であれば、矩形波に限定されず、例えば、サイン波などでもよい。
測距センサ42は、複数の画素71(図3参照)が行列状に2次元配置された画素アレイ部63(図3参照)により、光源装置11から照射されたパターン光15が所定の物体OBJで反射された反射光を受光する。そして、測距センサ42は、受光した反射光の受光量に応じた検出信号を、画素アレイ部63の画素単位で信号処理部43に供給する。
信号処理部43は、例えばCPU(CentralProcessingUnit)を含んで構成される。信号処理部43は、記憶部44に記憶されるプログラムにしたがい、信号処理を行う。すなわち、この信号処理部43は、測距センサ42から供給される検出信号に基づいて、測距センサ42から所定の物体OBJまでの距離である測距値を生成する。
図3は、物体OBJまでの距離と測距方式の関係を模式的に示す図である。図3に示すように、本実施形態に係る信号処理部43は、例えば第1距離の範囲では、主として第1測距方式で測距値を生成し、第1距離の範囲よりも遠方である第2距離の範囲では、主として第2測距方式で測距値を生成する。
第1測距方式は、例えばパターン光における明部のスポットSPの測距センサ42上の位置に基き、第1測距値を生成する。この第1測距方式は、例えば所謂SL方式を用いることが可能であり、パターン光15の明部であるスポットSPの位置を検出し、検出したスポット光の位置を用いて三角測量の原理により、第1測距値を生成する。また、信号処理部43は、第1測距方式に用いる画像を物体OBJまでの距離に応じて使い分けることが可能である。
第2測距方式は、例えばToF(Time of Flight)方式であり、パターン光15の明部であるスポットSPが照射されてから、反射光として受光されるまでの時間を位相差として検出し、位相差に基づいて距離を算出する。より具体的には、本実施形態に係る第2測距方式は、位相差に基づく距離と、第1測距値に基づく繰り返し周期数nと、を用いて第2測距値を生成する。
例えば、第1距離の範囲では、検出信号が飽和する場合があり、第2測距方式による測距精度が低下する傾向を示すが、第1測距方式での測距精度は維持される。一方で、第2距離の範囲では、第1測距方式での測距精度は低下傾向を示すが、繰り返し周期数nを判別する程度の精度は有する。
記憶部44は、例えば、RAM(Random Access Memory)、フラッシュメモリ等の半導体メモリ素子、ハードディスク、光ディスク等により実現される。この記憶部44は、検出信号、第1測距値、及び第2測距値などを記憶する。表示装置51は、例えばモニタである。この表示装置51は、例えば、二次元の距離画像などを表示可能である。
図4は、測距装置21のチップ構成例を示す斜視図である。測距装置21は、図4のAに示されるように、第1ダイ(基板)91と、第2ダイ(基板)92とが積層された1つのチップで構成することができる。第1ダイ91には、例えば、同期制御部41と測距センサ42が構成され、第2ダイ92には、例えば、信号処理部43と記憶部44とが構成される。
なお、測距装置21は、第1ダイ91と第2ダイ92とに加えて、もう1つのロジックダイを積層した3層で構成したり、4層以上のダイ(基板)の積層で構成したりしてもよい。また、測距装置21は、例えば、図4のBに示されるように、測距センサ42としての第1チップ95と、信号処理部43としての第2チップ96とを、中継基板97上に形成して構成することができる。同期制御部41は、第1チップ95または第2チップ96のいずれかに含んで構成される。
図5は、測距センサ42の構成例を示すブロック図である。測距センサ42は、タイミング制御部61、行走査回路62、画素アレイ部63、複数のAD(Analog to Digital)変換部64、列走査回路65、および、信号処理部66を備える。画素アレイ部63には、複数の画素71が行方向および列方向の行列状に2次元配置されている。ここで、行方向とは、水平方向の画素71の配列方向であり、列方向とは、垂直方向の画素71の配列方向である。行方向は、図中、横方向であり、列方向は図中、縦方向である。
タイミング制御部61は、例えば、各種のタイミング信号を生成するタイミングジェネレータなどによって構成され、同期制御部41(図2)から供給される発光タイミング信号に同期して、各種のタイミング信号を生成し、行走査回路62、AD変換部64、および、列走査回路65に供給する。すなわち、タイミング制御部61は、行走査回路62、AD変換部64、および、列走査回路65の駆動タイミングを制御する。
行走査回路62は、例えば、シフトレジスタやアドレスデコーダなどによって構成され、画素アレイ部63の各画素71を全画素同時または行単位等で駆動する。画素71は、行走査回路62の制御に従って反射光を受光し、受光量に応じたレベルの検出信号(画素信号)を出力する。画素71の詳細については、図7で後述する。
画素アレイ部63の行列状の画素配列に対して、画素行ごとに画素駆動線72が水平方向に沿って配線され、画素列ごとに垂直信号線73が垂直方向に沿って配線されている。画素駆動線72は、画素71から検出信号を読み出す際の駆動を行うための駆動信号を伝送する。以後の説明では、画素71を記号Iで示し、その座標を(x、y)で示す場合がある。xは、画素Iの行方向の位置であり、yは列方向の位置である。図5では、画素駆動線72が1本の配線として示されているが、実際には複数の配線で構成される。同様に、垂直信号線73も1本の配線として示されているが、実際には複数の配線で構成される。
AD変換部64は、列単位に設けられ、タイミング制御部61から供給されるクロック信号CKに同期して、垂直信号線73を介して、対応する列の各画素71から供給される検出信号をAD変換する。AD変換部64は、列走査回路65の制御に従って、AD変換した検出信号(検出データ)を信号処理部66に出力する。列走査回路65は、AD変換部64を順に選択して、AD変換後の検出データを信号処理部66へ出力させる。
図6は、画素71の構成例を示すブロック図である。図6に示すように、画素71は、光電変換素子81、転送スイッチ82、電荷蓄積部83および84、並びに、選択スイッチ85および86を備える。光電変換素子81は、例えば、フォトダイオードで構成され、反射光を光電変換して電荷を生成する。転送スイッチ82は、光電変換素子81が生成した電荷を、転送信号SEL_FDに基づいて、電荷蓄積部83および84のいずれかに転送する。この転送スイッチ82は、例えば、一対のMOS(Metal-Oxide-Semiconductor)トランジスタなどで構成される。
電荷蓄積部83および84は、例えば、浮遊拡散層で構成され、電荷を蓄積して、その蓄積電荷に応じた電圧を生成する。電荷蓄積部83および84に蓄積された電荷は、リセット信号RSTに基づいてリセットすることができる。選択スイッチ85は、選択信号RD_FD1に従って、電荷蓄積部83の出力を選択する。選択スイッチ86は、選択信号RD_FD2に従って、電荷蓄積部84の出力を選択する。すなわち、選択信号RD_FD1またはRD_FD2により、選択スイッチ85または86がオンされると、オンされた電荷蓄積部83または84の蓄積電荷に応じた電圧の信号が、検出信号として、垂直信号線73を介して、AD変換部64へ出力される。選択スイッチ85および86それぞれは、例えば、MOSトランジスタなどで構成される。
転送信号SEL_FD、リセット信号RST、並びに、選択信号RD_FD1およびRD_FD2を伝送する配線が、図4の画素駆動線72に相当する。電荷蓄積部83および84を、それぞれ、第1タップおよび第2タップと呼ぶこととすると、ToF方式では、画素71は、光電変換素子81で生成された電荷を、第1タップおよび第2タップに交互に電荷を蓄積させることにより、例えば、位相0度と位相180度のように、位相が反転した2つの受光タイミングの検出信号を1フレームで取得することができる。次のフレームでは、位相90度と位相270度の2つの受光タイミングの検出信号が取得できる。
図7は、発光源31の発光パターンと画素71での検出信号との関係を示す図である。上から発光源31の発光パターン、画素71に発光パターンが受光されるタイミングである受光パターン、位相0度、位相90度、位相180度、位相270度、の検出信号を示す。各信号の縦軸はハイレベルとロウレベルを示し、横軸は時間を示す。発光パターンのハイレベルでは、パターン光15(図1参照)が照射される時間を示し、受光パターンのハイレベルは、パターン光15が反射して戻ってくる時間を示す。すなわち、本実施形態では、周波数f(変調周波数)で高速にオンオフを繰り返すパルス光が採用される。パルス光の1周期Tは1/fとなる。画素71では、発光源31から測距センサ42に到達するまでの時間Δtに応じて、反射光(受光パターン)の位相がずれて検出される。
位相0度の検出信号におけるハイレベルは、画素71の受光タイミングを示す。すなわち、光源装置11の発光源31が出射するパルス光の位相、すなわち発光パターンと同じ位相とするタイミングである。
同様に、位相90度の検出信号のハイレベルは、光源装置11の発光源31が出射するパルス光(発光パターン)から90度遅れた位相とするタイミングである。同様に、位相180度の検出信号のハイレベルは、光源装置11の発光源31が出射するパルス光(発光パターン)から180度遅れた位相とするタイミングである。同様に、位相270度の検出信号のハイレベルは、光源装置11の発光源31が出射するパルス光(発光パターン)から270度遅れた位相とするタイミングである。
受光タイミングを、位相0度、位相90度、位相180度、および、位相270度としたときに蓄積された電荷に対応する計測信号を、それぞれ、Q0、Q90、Q180、および、Q270とする。これらの電荷に対応する信号はAD変換され、画素I(x、y)毎に計測信号Q0(x、y)、Q90(x、y)、Q180(x、y)、および、Q270(x、y)として、記憶部44に記憶される。
ここで、図8を用いて、信号処理部43の詳細を説明する。図8は、信号処理部43の構成例を示すブロック図である。図8に示すように、信号処理部43は、画像生成部430と、パターン検出部432と、判定部434と、第1距離生成部436と、位相生成部437と、周期判定部438と、第2距離生成部440と、出力処理部442とを備える。
画像生成部430は、計測信号Q0(x、y)、Q90(x、y)、Q180(x、y)、および、Q270(x、y)の少なくともいずれかを用いて、2次元画像を生成する。より具体的には、画像生成部430は、計測信号Q0(x、y)、Q90(x、y)、Q180(x、y)、および、Q270(x、y)を加算して、第1画像Gaの画素値Ga(x、y)を生成する。また、画像生成部430は、計測信号Q0(x、y)、Q90(x、y)、Q180(x、y)、および、Q270(x、y)のそれぞれを用いて、第2画像G0の画素値G0(x、y)と、第3画像G90の画素値G90(x、y)と、第4画像G180の画素値G180(x、y)と、第5画像G270の画素値G270(x、y)と、を生成する。更に、画像生成部430は、計測信号Q0(x、y)とQ180(x、y)を加算した第5画像Gbの画素値Gb(x、y)を生成し、計測信号Q90(x、y)とQ270(x、y)を加算した第6画像Gcの画素値Gc(x、y)を生成する。
図9は、対象物OBJまでの距離と、第1画像Ga、及び第6画像Gcとの関係を示す図である。白色が、高輝度の領域を示す、上が第1画像Gaを示し、下が第6画像Gcを示す。例えば、対象物OBJまでの距離が、10、15、25、50センチメートルの例を示す。図9に示すように、第1画像Gaの画素値Ga(x、y)は、計測信号Q0(x、y)、Q90(x、y)、Q180(x、y)、および、Q270(x、y)を加算するので、SN比がより良い画像が生成される。一方で、例えば25センチ程度の近距離では、画素が飽和し、明部のスポットSPの領域を個別に判別できなくなる恐れがある。これに対し、図9に示すように、第6画像Gcでは、15センチぐらいまで、明部のスポットSPの領域を個別に判別可能である。
また、計測信号Q0(x、y)、Q90(x、y)、Q180(x、y)、および、Q270(x、y)の各信号値の大きさは異なる。このため、パターン光における明部のスポットSPの領域のコントラストは異なる。これにより、第2画像G0、第3画像G90、第4画像G180、第5画像G270のいずれかは、例えば、対象物OBJまでの距離が15センチ程度でもさらに、明部のスポットSPの領域を明瞭に判別可能となる。
パターン検出部432は、画像生成部430が生成した2次元画像から例えばパターン光における明部のスポットSPの領域を検出する。パターン検出部432は、例えば2次元画像に対して2値化処理を施し、その後でラベリング処理を行う。そして、パターン検出部432は、ラベリング処理した領域の情報と、ラベリング処理された各領域の重心位置に対応する各座標を記憶部44に記憶する。
判定部434は、パターン検出部432が第1画像Gaに対してラベリング処理した領域の情報から、二次元画像の飽和している領域があるか否かを判定する。例えば、ラベリング処理された各領域の大きさが、所定の範囲を超えていると判定する場合に、飽和と判定する。これにより画素I(x、y)毎の判定結果を記憶部44に記憶する。例えば、判定部434は、飽和していない領域の画素I(x、y)には、0を関連付け、飽和している領域の画素I(x、y)には、1を関連付けて記憶させる。
第1距離生成部436は、上述の第1測距方式により画素I(x、y)毎の第1測距値D1(x、y)を生成する。この第1距離生成部436は、判定部434の判定結果に応じて、第1測距値の生成に用いる画像を異ならせることが可能である。例えば、第1距離生成部436は、判定部434が、飽和していないと判定する領域に対しては、第1画像Gaを用いて、第1測距値を生成する。この場合は、例えば、60センチ以上の遠方に物体OBJがあり、より高SNの信号を用いることにより、測定精度が向上する。一方で、第1距離生成部436は、判定部434が、飽和していると判定する領域に対しては、第5画像Gb又は第6画像Gcを用いて、第1測距値を生成する。この場合には、第1画像Gaよりも飽和が抑制された第5画像Gb又は第6画像Gを用いることにより、より近距離の物体OBJへの測定精度を向上させることが可能となる。
また、第1距離生成部436は、第2画像G0、第3画像G90)、第4画像G180、第5画像G270のいずれかの中の画像を選択して、第1測距値を生成してもよい。この場合第1距離生成部436は、判定部434によりラベリング処理された各領域の大きさが最も小さな画像を選択する。この場合には、第5画像Gb又は第6画像Gcよりも飽和が更に抑制された、第2画像G0、第3画像G90、第4画像G180、第5画像G270)のいずれかを用いることにより、近距離の物体OBJへの測定精度を更に向上させることが可能となる。
図10は、第1距離生成部436の第1測距値生成のアルゴリズム例を説明する図である。図10に示すように、第1距離生成部436にSL方式を用いる場合の例である。SL方式は、パターン光を投影する光源装置11と、そのパターン光を受光する測距センサ42とを用いて、投影パターン内のある位置とそれに対応する受光センサの位置との対を探すことにより、三角測量を適用して測距する。
光源装置11は、図1に示したように所定の間隔で配置された複数のスポットSPを物体OBJへ照射するが、1つのスポットSP(以下、注目スポットSPと称する。)に注目し、注目スポットSPが、測距センサ42の受光領域の所定の位置P2で検出されたとする。パターン検出部432は、この位置P2の各重心座標を記憶部44に記憶している。
このとき、注目スポットSPを発した光源装置11の投影パターン内の位置P1は、光源装置11において既知である。また、光源装置11の光源主点(投影中心)と、測距センサ42のセンサ主点(受光中心)との間のベースライン距離BLを含む光源装置11と測距センサ42の位置関係も既知である。したがって、第1距離生成部436は、位置P1と、位置P2と、ベースライン距離BLとを用いて、三角測量の原理により、測距装置21から物体OBJまでの距離に相当する第1測距値D1(x、y)を算出することができる。
このように、第1距離生成部436は、測距センサ42が、パターン光15の複数のスポットSPを受光したとき、受光した各スポットSPが、光源装置11が発した複数のスポットSPのどのスポットSPと対応するかが分かれば、複数のスポットSPそれぞれについて、画素I(x,y)毎に測距装置21から物体OBJまでの第1測距値D1(x、y)を算出することが可能となる。
そこで、測距システム1の光源装置11が発光するパターン光15は、測距センサ42が、受光領域の所定の位置で所定のスポットSPを受光したとき、それを発した発光源31のスポットSP(の位置)を特定できるように、複数のスポットSPが配置されたパターンとされている。
具体的には、測距センサ42で反射光として受光されるスポットSPの位置は、物体OBJまでの距離に応じて受光領域内で所定の軌跡で移動するが、各スポットSPの軌跡が他のスポットSPの軌跡とオーバーラップしなければ、測距センサ42が受光したスポットSPの位置に基づいて、それを発した発光源31のスポットSP(の位置)を同定することができる。換言すると、パターン光15は、測距センサ42で検出されるスポットSPの位置が他のスポットSPとオーバーラップしない十分に疎な間隔で複数のスポットSPが配置されたドットパターンとされている。
ここで、図7を参照にしつつ、位相生成部437、周期判定部438、及び第2距離生成部440について説明する。最初に、ToF方式による測距の方法を説明する。
測距装置21から物体OBJまでの距離に相当する第2測距値D2(x,y)[mm]は、以下の式(1)で計算することができる。
式(1)のΔt(x、y)は、発光源31から出射されたパターン光15が物体OBJで反射されて測距センサ42の各画素(x、y)に入射するまでの時間であり、cは、光速を表す。(x、y)は、画素71の座標である。
発光源31から照射されるパターン光15には、図7に示されるような、所定の周波数f(変調周波数)で高速にオンオフを繰り返すパルス光が採用される。パルス光の1周期Tは1/fとなる。測距センサ42では、発光源31から測距センサ42に到達するまでの時間Δt(x、y)に応じて、反射光(受光パターン)の位相がずれて検出される。この発光パターンと受光パターンとの位相のずれ量(位相差)をφ(x、y)とすると、時間Δt(x、y)は、下記の式(2)で算出することができる。
したがって、測距センサ42から物体OBJまでの測距値D2a(x、y)は、式(1)と式(2)とから、下記の式(3)で算出することができる。
図11は、位相生成部437の生成する位相差φを示す図である。図11に示すように、位相生成部437は、画素I(x、y)における位相差φ(x、y)を、計測信号Q0(x、y)、Q90(x、y)、Q180(x、y)、および、Q270(x、y)を用いて、下記の式(4)で算出する。
式(4)で算出された位相差φ(x、y)を上記の式(3)に入力することにより、測距システム1から物体OBJまでの第2測距値D2a(x、y)を算出することができる。
図12は、周波数別の第2測距値の例を示す図である。縦軸は計測距離であり、第2測距値に対応する。周波数10MHzのパルス信号を発光に用いた場合の第2測距値L10と、周波数120MHzのパルス信号を発光に用いた場合の第2測距値L120と、を示す。
第2測距値は、高周波数になるにしたがい高精度となることが知られている。一方で、第2測距値L120に示すように、高周波になると所謂エイリアスが発生する。例えば、周波数120MHzのパルス信号を発光に用いた場合の第2測距値は、0から1.25メートである。このため、第2測距値L120は、0から1.25メートの測距値を繰り返す。この場合の第2測距値D2(x、y)は、例えば繰り返し周期n=0の時には、0から1.25メートであり、繰り返し周期n=1の時には、1.25から2.5メートであり、繰り返し周期n=7の時には、7.5から8.75メートとなる。
そこで、周期判定部438は、第1測距値D1(x、y)を用いて、繰り返し周期n(x、y)を判定する。すなわち、この周期判定部438は、第1測距値D1(x、y)をD3(f)で除算して床関数floorで整数化する。D3(f)は、パルス信号の周期fで定まる距離である。
第2距離生成部440は、第2測距方式により、第2測距値を生成する。すなわち、第2距離生成部440は、(6)式に示すように、位相差φ(x、y)に基づく距離測距値D2a(x、y)と、第1測距値D1(x、y)に基づく繰り返し周期数n(x、y)と、を用いて第2測距値D2(x、y)を生成する。
出力処理部442は、各画素I(x、y)に対応する測距値Dall(x、y)を、第1測距値D1(x、y)と第2測距値D2(x、y)とを用いて生成する。より具体的には、記憶部44に記憶される各画素I(x、y)の判定部434による判定結果を用いて、距値Dall(x、y)を生成する。例えば、画素I(x、y)の判定結果が飽和を示す場合には、第1測距値D1(x、y)を距値Dall(x、y)とし、飽和を示さない場合には、第2測距値D2(x、y)を測距値Dall(x、y)とする。出力処理部442は、測距値Dall(x、y)を記憶部44に記憶させるととともに、生成した2次元の距離画像Dallを表示装置51に表示させてもよい。これにより、操作者は、2次元の距離画像Dallを視覚的に確認することが可能である。
図13は、パルス光の周期120MHzの測距値Dall(x、y)と、比較対象のパルス光の周期10MHzの第2測距値D2(x、y)と、を示す図である。パルス光の周期120MHzの測距値Dall(x、y)をラインL20で示し、パルス光の周期10MHzの第2測距値D2(x、y)をラインL30で示す。横軸は物体OBJまでの距離を示し、縦軸は測距ノイズを示す。測距ノイズは、測定距離の分散である。
図13に示すように、第2測距値D2(x、y)だけでは、計測信号が飽和するため、例えば第1距離範囲(図3参照)に対応する60センチメートル未満の測定は困難となる。一方で、第1測距値D1(x、y)は2次元画像を用いるため、計測信号が飽和している場合にも、スポットSPの位置の検出が可能となる。このため、第1測距値D1(x、y)をも用いる本実施形態に係る測距値Dall(x、y)では、15センチメートルぐらいまで、測距が可能となる。
また、従来であれば、パルス光の周期120MHzの測距値は、1.25メートルであるが、本実施形態に係る測距値Dall(x、y)では、繰り返し周期数n(x、y)の情報を用いることにより、9メートルぐらいまで、測距が可能となる。上述のように、パルス光の周期がより高周になるにしたがい第2測距値がより高精度に測定される。このため、本実施形態に係る測距値Dall(x、y)は、比較対象であるパルス光の周期10MHzの第2測距値D2(x、y)よりも測距ノイズが、5メートルで91パーセント低減し、7メートルで81パーセント低減する。
このように、本実施系形態に係る測距値Dall(x、y)は、第1測距値D1(x、y)を用いることが可能となる。このため、通常であれば、検出信号が飽和して、Tof法により第2測距値D2(x、y)をえることが困難な第1距離範囲(図3参照)に対応する測距値Dall(x、y)を得ることが可能となる。
更に、パルス光の周期120MHzで測距する場合に、第2距離範囲(図3参照)に対応する1.25メートル以上の範囲において、所謂エイリアスが発生する場合にも、第1測距値D1(x、y)を用いて、周期数n(x、y)を生成し、第1測距値D1(x、y)よりも測定精度のより高い第2測距値D2(x、y)を生成することが可能となるまた、同一の測距センサ42を用いるので、測定系が複数になることを抑制でき、装置の大型化を抑制できる。
以上が本実施形態に係る測距システム1の構成の説明であるが、以下に制御例を説明する。図14は、測距システム1における制御例を示すフローチャートである。まず、測距装置21の測距センサ42は、計測信号Q0(x、y)、Q90(x、y)、Q180(x、y)、および、Q270(x、y)を生成する(ステップS10)。
次に、画像生成部430は、計測信号Q0(x、y)、Q90(x、y)、Q180(x、y)、および、Q270(x、y)を加算した第1画像Gaと、信号SQ90(x、y)とQ270(x、y)を加算した第6画像Gcとを生成する(ステップS12)。
次に、判定部434は、パターン検出部432が第1画像Gaに対してラベリング処理した領域の情報から、第1画像Gaの飽和している領域と飽和していない領域とを判定する(ステップS14)。飽和していないと判定する領域がある場合(ステップS14のNo)、第1距離生成部436は、飽和していない領域に対して、第1画像Gaを用いて、画素I(x、y)毎の第1測距値D1(x、y)を生成する(ステップS16)。判定部434は、飽和していないと判定する領域の画素I(x、y)毎に例えば1を関連付けて、記憶部44に記憶する。
次に、周期判定部438は、飽和していないと判定する領域に対して、第1測距値D1(x、y)を用いて、繰り返し周期n(x、y)を判定する(ステップS18)。そして、第2距離生成部440は、飽和していないと判定する領域に対して、位相生成部437の生成する位相差φ(x、y)に基づく距離測距値D2a(x、y)と、第1測距値D1(x、y)に基づく繰り返し周期数n(x、y)と、を用いて第2測距値D2(x、y)を生成する(ステップS20)。
一方で、判定部434が、第1画像Ga(x、y)に飽和している領域があると判定する場合(ステップS14のYes)、第1距離生成部436は、飽和している領域に対して、第6画像Gcを用いて、画素I(x、y)毎の第1測距値D1(x、y)を生成する(ステップS22)。判定部434は、飽和していると判定する領域の画素I(x、y)毎に例えば0を関連付けて、記憶部44に記憶する。
次に、出力処理部442は、記憶部44に記憶される各画素I(x、y)の判定部434による判定結果を用いて、画素I(x、y)の判定結果が飽和を示す場合には、第1測距値D1(x、y)を測距値Dall(x、y)とし、飽和を示さない場合には、第1測距値D2(x、y)を測距値Dall(x、y)として、2次元の距離画像Dallを生成する(ステップS24)。そして、出力処理部442は、2次元の距離画像Dallを記憶部44に記憶させるととともに、表示装置51に表示させる(ステップS26)。
以上説明したように、本実施形態によれば、第1距離生成部436が、測距センサ42で受光されたパターン光の位置に基づき、物体OBJまでの距離である第1測距値D1(x、y)を生成し、第2距離生成部440は、位相生成部437の生成する位相差φ(x、y)に基づく距離測距値D2a(x、y)と、第1測距値D1(x、y)に基づく繰り返し周期数n(x、y)と、を用いて第2測距値D2(x、y)を生成することとした。これにより、位相差φ(x、y)にエイリアスが生じる場合にも、第2測距値D2(x、y)をより高精度に生成可能となる。この場合、単一の測距センサ42で第1距離生成部436及び第2距離生成部440の計測に用いる信号を生成するので、測距装置21をより小型化することが可能である。
(第1実施形態の変形例1)
第1実施形態の変形例1に係る測距システム1は、出力処理部442が、周期判定部438が飽和していないと判定する領域に対して、第1測距値D1(x、y)と第2測距値D2a(x、y)とを重み付け加算して測距値Dall(x、y)を生成する点で第1実施形態に係る測距システム1と相違する。以下では、第1実施形態に係る測距システム1と相違する点を説明する。
第1実施形態の変形例1に係る測距システム1は、出力処理部442が、周期判定部438が飽和していないと判定する領域に対して、第1測距値D1(x、y)と第2測距値D2a(x、y)とを重み付け加算して測距値Dall(x、y)を生成する点で第1実施形態に係る測距システム1と相違する。以下では、第1実施形態に係る測距システム1と相違する点を説明する。
第1実施形態の変形例1に係る出力処理部(7)式に従い、第1測距値D1(x、y)と第2測距値D2a(x、y)とを重み付け加算して測距値Dall(x、y)を生成する。ここで、W_ToF(x、y)は、(8)式に示すように、第2測距値D2a(x、y)の距離に応じた重み値であり、距離に応じた距離の分散値σ2
_ToF (x、y)の逆数である。一方で、W_SL(x、y)は、(9)式に示すように、第1測距値D1(x、y)の距離に応じた重み値であり、距離に応じた距離の分散値σ2
_SL(x、y)の逆数である。
図15は、重み付け加算した測距値Dall(x、y)と、第1測距値D1(x、y)を加算していない測距値Dall(x、y)との測距誤差と距離との関係を示す図である。ラインL40は、第1測距値D1(x、y)を加算していない測距値Dall(x、y)であり、ラインL50は、第1測距値D1(x、y)を重み付け加算した測距値Dall(x、y)である。重み付け加算した測距値Dall(x、y)では、例えば0.9メートルから2メートルの範囲で、測距誤差が改善される。これは、例えば0.9メートルから2メートルの範囲では、第1測距値D1(x、y)の測距精度と、第2測距値D2a(x、y)の測定精度が同等であので、加算処理により測定精度が改善されると考えられている。一方で、例えば2メートルを超える範囲では、分散値σ2
_SL(x、y)が増加して、第1測距値D1(x、y)の重み値W_SL(x、y)が低下するので、第1測距値D1(x、y)の影響が低減される。このため、ラインL40とラインL50とは同等の値を示す。
以上説明したように、距離に応じた距離の分散値σ2
_ToF(x、y)、σ2
_SL(x、y)の逆数で第1測距値D1(x、y)と第2測距値D2a(x、y)とを加算することにより、測定精度をより向上させることが可能となる。
(第2実施形態)
第2実施形態に係る測距システム1は、第1距離生成部436が、第1測距値D1(x、y)を生成する際に、パターン光15の繰り返し周期の情報を用いることが可能である点で第1実施形態の変形例1に係る測距システム1と相違する。以下では、第1実施形態の変形例1に係る測距システム1と相違する点を説明する。
第2実施形態に係る測距システム1は、第1距離生成部436が、第1測距値D1(x、y)を生成する際に、パターン光15の繰り返し周期の情報を用いることが可能である点で第1実施形態の変形例1に係る測距システム1と相違する。以下では、第1実施形態の変形例1に係る測距システム1と相違する点を説明する。
図16は、第2実施形態に係る信号処理部43の構成例を示すブロック図である。図16に示すように第2周期判定部444を更に備える。
図17は、第1距離生成部436におけるパターン光15の測距範囲を模式的に示す図である。例えば、第1距離生成部436は、測距センサ42の受光面上の領域A20の各スポット光の位置に応じて1測距値D1(x、y)を生成する。この場合、パターン光15が均一なパターンで構成される場合がある。この場合、物体OBJが近かずくに従い、例えば領域A10のパターンが領域A20に入ってくる。一方で、測距センサ42の周辺部では、第2距離生成部440は、測定精度は低下するが、第2測距値D2a(x、y)を生成することが可能である。
また、パターン光15は既知であるので、物体OBJまでの距離に応じて、領域A10のパターンが、領域A20にあったパターンであるかが判定可能となる。そこで、第2周期判定部444は、判定部434は、飽和していると判定する領域に関しては、測距センサ42の周辺部の第2測距値D2a(x、y)を用いて、パターン光15の幾何学的な周期を判定する。例えば、第2測距値D2a(x、y)が、0.6メートルから0.4メートルの範囲では幾何学的な周期m=0とし、0.4メートルから0.15メートルの範囲では幾何学的な周期m=1とする。
第1距離生成部436は、幾何学的な周期m=0では、パターン検出部432が検出した位置を用いて、第1測距値D1(x、y)を生成する。一方で、第1距離生成部436は、幾何学的な周期m=1では、パターン検出部432が検出した位置に所定の距離D3を加算した位置を用いて、第1測距値D1(x、y)を生成する。
以上説明したように、第2周期判定部444が、判定部434は、飽和していると判定する領域に関して、測距センサ42における周辺部の第2測距値D2a(x、y)を用いて、パターン光15の幾何学的な周期を判定することとした。これにより、パターン光15が幾何学的に均一な繰り返し周期パターンで構成される場合にも、第1測距値D1(x、y)の測定精度が低下すのを抑制できる。
なお、本技術は以下のような構成を取ることができる。
(1)
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を備える測距装置。
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を備える測距装置。
(2)
前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理部を、更に備える、(1)に記載の測距装置。
前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理部を、更に備える、(1)に記載の測距装置。
(3)
前記パターン光は、所定の周期で前記物体に照射されており、
前記測距センサは、前記所定の周期で、且つ複数の異なる位相で電荷の蓄積を行っている、(2)に記載の測距装置。
前記パターン光は、所定の周期で前記物体に照射されており、
前記測距センサは、前記所定の周期で、且つ複数の異なる位相で電荷の蓄積を行っている、(2)に記載の測距装置。
(4)
前記複数の異なる位相で蓄積された電荷に基づく、複数の検出信号の少なくともいずれかに基づき2次元の第1画像を生成する第1画像生成部を更に備え、
前記第1距離生成部は、前記第1画像生成部の生成した第1画像を用いて、第1測距値を生成する、(3)に記載の測距装置。
前記複数の異なる位相で蓄積された電荷に基づく、複数の検出信号の少なくともいずれかに基づき2次元の第1画像を生成する第1画像生成部を更に備え、
前記第1距離生成部は、前記第1画像生成部の生成した第1画像を用いて、第1測距値を生成する、(3)に記載の測距装置。
(5)
前記第1距離生成部は、前記パターン光の明部の位置を検出し、検出した前記明部の位置に基づき、三角測量の原理により前記第1測距値を生成する、(4)に記載の測距装置。
前記第1距離生成部は、前記パターン光の明部の位置を検出し、検出した前記明部の位置に基づき、三角測量の原理により前記第1測距値を生成する、(4)に記載の測距装置。
(6)
前記複数の異なる位相は、位相0度、位相90度、位相180度、および、位相270度の4種類であり、
前記第1画像生成部は、位相0度、および、位相180度の検出信号の組合わせ、又は、位相90度、および、位相270度の検出信号の組合わせ、に基づき、前記第1画像を生成する、(5)に記載の測距装置。
前記複数の異なる位相は、位相0度、位相90度、位相180度、および、位相270度の4種類であり、
前記第1画像生成部は、位相0度、および、位相180度の検出信号の組合わせ、又は、位相90度、および、位相270度の検出信号の組合わせ、に基づき、前記第1画像を生成する、(5)に記載の測距装置。
(7)
前記第1画像生成部は、位相0度、位相90度、位相180度、および、位相270度のいずれかに基づき、前記第1画像を生成する、(6)に記載の測距装置。
前記第1画像生成部は、位相0度、位相90度、位相180度、および、位相270度のいずれかに基づき、前記第1画像を生成する、(6)に記載の測距装置。
(8)
前記第1測距値に基づき、前記位相の繰り返し周期を判定する周期判定部を、更に備え、
前記第2距離生成部は、前記繰り返し周期に基づき、前記第2測距値を生成する、(7)に記載の測距装置。
前記第1測距値に基づき、前記位相の繰り返し周期を判定する周期判定部を、更に備え、
前記第2距離生成部は、前記繰り返し周期に基づき、前記第2測距値を生成する、(7)に記載の測距装置。
(9)
前記出力処理部は、前記第1測距値に応じた第1重み値と、前記第2測距値に応じた第2重み値と、を用いて、前記第1測距値と前記第2測距値とを加重平均して第3測距値を生成する、(8)に記載の測距装置。
前記出力処理部は、前記第1測距値に応じた第1重み値と、前記第2測距値に応じた第2重み値と、を用いて、前記第1測距値と前記第2測距値とを加重平均して第3測距値を生成する、(8)に記載の測距装置。
(10)
前記位相差を検出する際の検出信号が飽和状態であるか否かを判定する判定処理部を更に備え、
前記出力処理部は、前記判定処理部の判定に応じて、第3測距値を生成する、(9)に記載の測距装置。
前記位相差を検出する際の検出信号が飽和状態であるか否かを判定する判定処理部を更に備え、
前記出力処理部は、前記判定処理部の判定に応じて、第3測距値を生成する、(9)に記載の測距装置。
(11)
前記第1距離生成部は、前記判定処理部が、飽和状態であると判定する場合に、位相0度、および、位相180度の検出信号の組合わせ、又は、位相90度、および、位相270度の検出信号の組合わせ、に基づき生成した前記第1画像を用いて第1測距値を生成する、(10)に記載の測距装置。
前記第1距離生成部は、前記判定処理部が、飽和状態であると判定する場合に、位相0度、および、位相180度の検出信号の組合わせ、又は、位相90度、および、位相270度の検出信号の組合わせ、に基づき生成した前記第1画像を用いて第1測距値を生成する、(10)に記載の測距装置。
(12)
前記第1距離生成部は、前記判定処理部が、飽和状態でないと判定する場合に、位相0度、位相90度、位相180度、および、位相270度の検出信号に基づき生成した前記第1画像を用いて第1測距値を生成する、(11)に記載の測距装置。
前記第1距離生成部は、前記判定処理部が、飽和状態でないと判定する場合に、位相0度、位相90度、位相180度、および、位相270度の検出信号に基づき生成した前記第1画像を用いて第1測距値を生成する、(11)に記載の測距装置。
(13)
前記第2測距値に基づき、前記パターン光の幾何学的な第2繰り返し周期を判定する第2周期判定部を、更に備える、(12)に記載の測距装置。
前記第2測距値に基づき、前記パターン光の幾何学的な第2繰り返し周期を判定する第2周期判定部を、更に備える、(12)に記載の測距装置。
(14)
前記第1距離生成部は、前記第2繰り返し周期に基づき、前記第1測距値を生成する、(13)に記載の測距装置。
前記第1距離生成部は、前記第2繰り返し周期に基づき、前記第1測距値を生成する、(13)に記載の測距装置。
(15)
前記第1距離生成部は、前記飽和状態であると判定する場合に、前記第2繰り返し周期に基づき、前記第1測距値を生成する、(14)に記載の測距装置。
前記第1距離生成部は、前記飽和状態であると判定する場合に、前記第2繰り返し周期に基づき、前記第1測距値を生成する、(14)に記載の測距装置。
(16)
明部と暗部の2種類の輝度を有するパターン光を照射する光源装置と、
前記パターン光が物体で反射されて返ってきた反射光を受光する測距装置と
を備え、
前記測距装置は、
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を有する、測距システム。
明部と暗部の2種類の輝度を有するパターン光を照射する光源装置と、
前記パターン光が物体で反射されて返ってきた反射光を受光する測距装置と
を備え、
前記測距装置は、
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を有する、測距システム。
(17)
前記測距装置は、前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理部を、更に備える、(16)に記載の測距システム。
前記測距装置は、前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理部を、更に備える、(16)に記載の測距システム。
(18)
前記第3測距値に基づき、距離画像を表示する表示装置を更に備える、(17)に記載の測距システム。
前記第3測距値に基づき、距離画像を表示する表示装置を更に備える、(17)に記載の測距システム。
(19)
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を用いる測距方法であって、
前記反射光に含まれるパターン光の位置に基づき、物体までの距離である第1測距値を生成する第1距離生成工程と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成工程と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成工程と、
を備える測距方法。
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を用いる測距方法であって、
前記反射光に含まれるパターン光の位置に基づき、物体までの距離である第1測距値を生成する第1距離生成工程と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成工程と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成工程と、
を備える測距方法。
(20)
前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理工程を、更に備える、(19)に記載の測距方法。
前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理工程を、更に備える、(19)に記載の測距方法。
本開示の態様は、上述した個々の実施形態に限定されるものではなく、当業者が想到しうる種々の変形も含むものであり、本開示の効果も上述した内容に限定されない。すなわち、特許請求の範囲に規定された内容およびその均等物から導き出される本開示の概念的な思想と趣旨を逸脱しない範囲で種々の追加、変更および部分的削除が可能である。
1:測距システム、11:光源装置、21:測距装置、15:パターン光、42:測距センサ、43:信号処理部、51:表示装置、16:赤外光パルスレーザ、20:制御部、24:表示装置、430:像生成部、432:パターン検出部、434:判定部、436:第1距離生成部、437:位相生成部、438:周期判定部、440:第2距離生成部、442:出力処理部、444:第2周期判定部。
Claims (20)
- 光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を備える測距装置。 - 前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理部を、更に備える、請求項1に記載の測距装置。
- 前記パターン光は、所定の周期で前記物体に照射されており、
前記測距センサは、前記所定の周期で、且つ複数の異なる位相で電荷の蓄積を行っている、請求項2に記載の測距装置。 - 前記複数の異なる位相で蓄積された電荷に基づく、複数の検出信号の少なくともいずれかに基づき2次元の第1画像を生成する第1画像生成部を更に備え、
前記第1距離生成部は、前記第1画像生成部の生成した第1画像を用いて、第1測距値を生成する、請求項3に記載の測距装置。 - 前記第1距離生成部は、前記パターン光の明部の位置を検出し、検出した前記明部の位置に基づき、三角測量の原理により前記第1測距値を生成する、請求項4に記載の測距装置。
- 前記複数の異なる位相は、位相0度、位相90度、位相180度、および、位相270度の4種類であり、
前記第1画像生成部は、位相0度、および、位相180度の検出信号の組合わせ、又は、位相90度、および、位相270度の検出信号の組合わせ、に基づき、前記第1画像を生成する、請求項5に記載の測距装置。 - 前記第1画像生成部は、位相0度、位相90度、位相180度、および、位相270度のいずれかに基づき、前記第1画像を生成する、請求項6に記載の測距装置。
- 前記第1測距値に基づき、前記位相の繰り返し周期を判定する周期判定部を、更に備え、
前記第2距離生成部は、前記繰り返し周期に基づき、前記第2測距値を生成する、請求項7に記載の測距装置。 - 前記出力処理部は、前記第1測距値に応じた第1重み値と、前記第2測距値に応じた第2重み値と、を用いて、前記第1測距値と前記第2測距値とを加重平均して前記第3測距値を生成する、請求項8に記載の測距装置。
- 前記位相差を検出する際の検出信号が飽和状態であるか否かを判定する判定処理部を更に備え、
前記出力処理部は、前記判定処理部の判定に応じて、前記第3測距値を生成する、請求項9に記載の測距装置。 - 前記第1距離生成部は、前記判定処理部が、飽和状態であると判定する場合に、位相0度、および、位相180度の検出信号の組合わせ、又は、位相90度、および、位相270度の検出信号の組合わせ、に基づき生成した前記第1画像を用いて第1測距値を生成する、請求項10に記載の測距装置。
- 前記第1距離生成部は、前記判定処理部が、飽和状態でないと判定する場合に、位相0度、位相90度、位相180度、および、位相270度の検出信号に基づき生成した前記第1画像を用いて第1測距値を生成する、請求項11に記載の測距装置。
- 前記第2測距値に基づき、前記パターン光の幾何学的な第2繰り返し周期を判定する第2周期判定部を、更に備える、請求項12に記載の測距装置。
- 前記第1距離生成部は、前記第2繰り返し周期に基づき、前記第1測距値を生成する、請求項13に記載の測距装置。
- 前記第1距離生成部は、前記飽和状態であると判定する場合に、前記第2繰り返し周期に基づき、前記第1測距値を生成する、請求項14に記載の測距装置。
- 明部と暗部の2種類の輝度を有するパターン光を照射する光源装置と、
前記パターン光が物体で反射されて返ってきた反射光を受光する測距装置と
を備え、
前記測距装置は、
光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を受光する測距センサと、
測距センサで受光された前記パターン光の位置に基づき、前記物体までの距離である第1測距値を生成する第1距離生成部と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成部と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成部と、
を有する、測距システム。 - 前記測距装置は、前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理部を、更に備える、請求項16に記載の測距システム。
- 前記第3測距値に基づき、距離画像を表示する表示装置を更に備える、請求項17に記載の測距システム。
- 光源装置から照射されたパターン光が物体で反射されて返ってきた反射光を用いる測距方法であって、
前記反射光に含まれるパターン光の位置に基づき、物体までの距離である第1測距値を生成する第1距離生成工程と、
前記パターン光が照射されてから前記反射光として受光されるまでの時間を位相差として生成する、位相生成工程と、
前記位相差と、前記第1測距値に基づく前記位相差の繰り返し周期と、に応じて前記物体までの距離である第2測距値を生成する第2距離生成工程と、
を備える測距方法。 - 前記第1測距値、および前記第2測距値に基づき、第3測距値を生成する出力処理工程を、更に備える、請求項19に記載の測距方法。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2022-105072 | 2022-06-29 | ||
JP2022105072A JP2024005071A (ja) | 2022-06-29 | 2022-06-29 | 測距装置、測距システム、および測距方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2024004645A1 true WO2024004645A1 (ja) | 2024-01-04 |
Family
ID=89382074
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2023/022012 WO2024004645A1 (ja) | 2022-06-29 | 2023-06-14 | 測距装置、測距システム、および測距方法 |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP2024005071A (ja) |
WO (1) | WO2024004645A1 (ja) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20170206660A1 (en) * | 2016-01-15 | 2017-07-20 | Oculus Vr, Llc | Depth mapping using structured light and time of flight |
JP2020016654A (ja) * | 2018-07-24 | 2020-01-30 | 三星電子株式会社Samsung Electronics Co.,Ltd. | グレイスケールイメージングのための時間分解イメージセンサ及びイメージングユニット並びにグレイスケールイメージ生成方法 |
WO2021085128A1 (ja) * | 2019-10-28 | 2021-05-06 | ソニーセミコンダクタソリューションズ株式会社 | 測距装置、測定方法、および、測距システム |
JP2022504010A (ja) * | 2018-09-14 | 2022-01-13 | フェイスブック・テクノロジーズ・リミテッド・ライアビリティ・カンパニー | 構造化光源および飛行時間カメラ付き深度測定アセンブリ |
-
2022
- 2022-06-29 JP JP2022105072A patent/JP2024005071A/ja active Pending
-
2023
- 2023-06-14 WO PCT/JP2023/022012 patent/WO2024004645A1/ja unknown
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20170206660A1 (en) * | 2016-01-15 | 2017-07-20 | Oculus Vr, Llc | Depth mapping using structured light and time of flight |
JP2020016654A (ja) * | 2018-07-24 | 2020-01-30 | 三星電子株式会社Samsung Electronics Co.,Ltd. | グレイスケールイメージングのための時間分解イメージセンサ及びイメージングユニット並びにグレイスケールイメージ生成方法 |
JP2022504010A (ja) * | 2018-09-14 | 2022-01-13 | フェイスブック・テクノロジーズ・リミテッド・ライアビリティ・カンパニー | 構造化光源および飛行時間カメラ付き深度測定アセンブリ |
WO2021085128A1 (ja) * | 2019-10-28 | 2021-05-06 | ソニーセミコンダクタソリューションズ株式会社 | 測距装置、測定方法、および、測距システム |
Also Published As
Publication number | Publication date |
---|---|
JP2024005071A (ja) | 2024-01-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110596721B (zh) | 双重共享tdc电路的飞行时间距离测量系统及测量方法 | |
CN111727381B (zh) | 用于多维感测对象的多脉冲激光雷达系统 | |
US20210116572A1 (en) | Light ranging apparatus | |
US11272156B2 (en) | Spatial correlation sampling in time-of-flight imaging | |
CN110596725B (zh) | 基于插值的飞行时间测量方法及测量系统 | |
EP2729826B1 (en) | Improvements in or relating to the processing of time-of-flight signals | |
JP5206297B2 (ja) | 光学式測距装置及び方法 | |
EP3896489A1 (en) | Hybrid sensor system and method for providing 3d imaging | |
CN110596722A (zh) | 直方图可调的飞行时间距离测量系统及测量方法 | |
US6741082B2 (en) | Distance information obtaining apparatus and distance information obtaining method | |
US20070109268A1 (en) | Speckle-based two-dimensional motion tracking | |
US9971023B2 (en) | Systems and methods for time of flight measurement using a single exposure | |
US20160316193A1 (en) | Parametric online calibration and compensation in tof imaging | |
WO2016143482A1 (ja) | 光学式検知装置 | |
US11531094B2 (en) | Method and system to determine distance using time of flight measurement comprising a control circuitry identifying which row of photosensitive image region has the captured image illumination stripe | |
JP2009192499A (ja) | 距離画像生成装置 | |
JP2020153799A (ja) | 測距装置および測距方法 | |
JP2020112443A (ja) | 距離測定装置及び距離測定方法 | |
WO2020031881A1 (ja) | 光測距装置 | |
US20240061090A1 (en) | Time-of-flight demodulation circuitry, time-of-flight demodulation method, time-of-flight imaging apparatus, time-of-flight imaging apparatus control method | |
US20220043116A1 (en) | Time-of-flight sensor and method of measuring distance using the same | |
WO2024004645A1 (ja) | 測距装置、測距システム、および測距方法 | |
JP2022109077A (ja) | 距離画像撮像装置、及び距離画像撮像方法 | |
JP2002195807A (ja) | 光学式変位測定装置及びその投光光量補正方法 | |
US12032065B2 (en) | System and method for histogram binning for depth detection |
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: 23831093 Country of ref document: EP Kind code of ref document: A1 |