The present application claims priority from Japanese application JP2021-073696, filed on Apr. 23, 2021, the contents of which is hereby incorporated by reference into this application.
The present invention relates to a distance measurement system using a plurality of distance measurement image pickup apparatuses that measures a distance to a target by a time of flight of light.
A time of flight (TOF) method of measuring a distance by a time of flight until irradiation light is reflected by a target and returns has been known as a method of measuring a distance to a target. Specifically, exposure is performed by a plurality of exposure gates in which exposure timings are shifted with respect to a light emission timing of intensity-modulated irradiation light, and a delay time of reflected light with respect to the irradiation light is calculated from the exposure amount accumulated in each exposure gate, thereby obtaining a distance.
In the TOF method, distance measurement accuracy (repeated measurement error) and a distance measurement range (measurable distance range) depend on a pulse width (modulation frequency) of irradiation light, and the shorter the pulse width (the higher the modulation frequency), the higher the distance measurement accuracy and the narrower the distance measurement range. For this reason, a method has been proposed to achieve both high distance measurement accuracy and a wide distance measurement range by measuring distances using two types of irradiation light having a short pulse width and a long pulse width and comparing measurement results.
When a plurality of distance measurement image pickup apparatuses is operated in the same area, there is a problem that an error occurs in a distance measurement value since irradiation light (or reflected light) of an apparatus other than the own apparatus becomes interference light and is exposed by the own apparatus. As a countermeasure, JP 2020-56698 A discloses a technology. In this technology, one frame, which is a unit of measurement operation, includes a first distance measurement period of a width TH of pulsed light and a second distance measurement period of a width TL of pulsed light (however, TH<TL), the first distance measurement period is divided into a plurality of exposure periods obtained by shifting exposure timing with respect to emitted pulsed light, an exposure gate is opened n times (n is plural) at predetermined intervals to perform repeated exposure between one pulsed light ray and a subsequent pulsed light ray in each divided exposure period, a first non-exposure period, in which exposure is not performed from when the exposure gate is finally closed until when a subsequent pulsed light ray is emitted, is provided, the second distance measurement period is divided into a plurality of exposure periods obtained by shifting exposure timing with respect to emitted pulsed light, the exposure gate is opened only once to perform exposure between one pulsed light ray and a subsequent pulsed light ray in each divided exposure period, and a second non-exposure period, in which exposure is not performed from when the exposure gate is closed until when a subsequent pulsed light ray is emitted, is provided.
However, even when the technology of JP 2020-56698 A is used, it is considered that interference cannot be sufficiently suppressed depending on the distance between the apparatuses, which causes a distance measurement error so that distance measurement accuracy becomes insufficient.
Therefore, the invention provides a distance measurement system that achieves both high distance measurement accuracy and a wide measurement range and can reduce a distance measurement error by suppressing the effect of interference between apparatuses even when an interval between apparatuses becomes short.
According to of the invention, the following distance measurement system is provided. The distance measurement system is a system for measuring a distance to a target by a time of flight of light using a plurality of distance measurement image pickup apparatuses. Each of the distance measurement image pickup apparatuses includes a light emitting unit, a light receiving unit, a distance computation unit, and a controller. The light emitting unit irradiates the target with pulsed light emitted by a light source. The light receiving unit exposes pulsed light reflected by the target using an image sensor and converts the pulsed light into an electric signal. The distance computation unit computes a distance to the target from an output signal of the light receiving unit. The controller controls a light emission timing for emitting pulsed light from the light emitting unit and an exposure timing for exposing pulsed light by the light receiving unit. The plurality of distance measurement image pickup apparatuses may emit pulsed light rays at a plurality of different pulse widths. Further, intervals of pulsed light rays from the plurality of distance measurement image pickup apparatuses are set to be proportional to pulse widths in the respective distance measurement image pickup apparatuses. Further, the respective distance measurement image pickup apparatuses emit pulsed light rays at intervals of the pulsed light rays corresponding to pulse widths and the intervals of the pulsed light rays different from each other.
The invention provides a distance measurement system that achieves both high distance measurement accuracy and a wide measurement range and can reduce a distance measurement error by suppressing the effect of interference between apparatuses even when an interval between apparatuses becomes short.
Hereinafter, an embodiment of the invention will be described with reference to the drawings.
However, in this example, without directly measuring the delay time dT, a light receiving period is divided into a plurality of exposure gates to indirectly obtain the delay time dT from the exposure amount of each gate period, and the distance D is measured (also referred to as an indirect method).
In this instance, the first and second charge amounts Q1 and Q2, the delay time dT, and the distance D to the target 2 are as follows.
dT=T0·Q2/(Q1+Q2)
D=T
0
·Q
2/(Q1+Q3)·c/2
That is, the distance D can be calculated by measuring the first charge amount Q1 and the second charge amount Q2. The above description corresponds to a principle of distance measurement by the TOF method. In this example, distance measurement is performed by combining two distance measurement schemes of different pulse widths T0 and exposure gates S1 and S2.
First, the first distance measurement period will be described. In the light emission/exposure period, a light emission/exposure operation of a short pulse width (high modulation frequency) is performed. The light emission/exposure period includes n sets. In one set, periods A, B, and C are included by shifting an exposure timing, and exposure is divided and performed. In each divided period, as indicated by reference symbols A1, B1 and C1, between one light emission pulse and a subsequent light emission pulse, the exposure gate is opened a plurality of times (here, three times) at predetermined intervals to perform exposure, and charges are accumulated. In one set, the light emission/exposure operation is repeated m times, and this operation is repeatedly performed for n sets.
In a data output period, the charge amount for m×n times accumulated in each of the periods A, B, and C is read to calculate the distance, and first distance data in the first distance measurement period is output. As described above, in the first distance measurement period, reflected light for one light emission pulse is exposed a plurality of times at predetermined intervals, and such a light emission/exposure scheme is referred to as an “extended pulse scheme”.
Next, the second distance measurement period will be described. In the light emission/exposure period, light emission/exposure is performed with a long pulse width (low modulation frequency). As in the first distance measurement period, one set has periods A, B, and C having shifted exposure timings, and exposure is divided and performed. However, in each divided period, as indicated by reference symbols A2, B2 and C2, between one light emission pulse and a subsequent light emission pulse, the exposure gate is opened only once to perform exposure and charges are accumulated. The light emission/exposure operation is repeated m times within one set, and this operation is repeatedly performed for n sets.
In a data output period, the charge amount for m×n times accumulated in each of the periods A, B, and C is read to calculate the distance, and second distance data in the second distance measurement period is output. Hereinafter, the light emission/exposure scheme in the second distance measurement period is referred to as a “pulse scheme”.
As described above, widths of the pulsed light and the exposure gate, and the number of exposure repetitions are different between the first distance measurement period and the second distance measurement period. By measuring with a short pulse width (high frequency) in the first distance measurement period, a measurement result having high distance measurement accuracy is obtained. Meanwhile, by measuring with a long pulse width (low frequency) in the second distance measurement period, a measurement result having a wide distance measurement range is obtained. By combining both the measurement results and determining the distance (de-aliasing), it is possible to perform measurement with high distance measurement accuracy and a wide distance measurement range. Any of the first distance measurement period and the second distance measurement period may precede the other one.
Further, the present embodiment is characterized in that in the first distance measurement period and the second distance measurement period, instead of continuously performing one light emission/exposure operation and a subsequent light emission/exposure operation, after closing a last exposure gate until subsequent pulsed light is emitted, the first/second non-exposure periods are inserted, respectively. That is, the “extended pulse scheme” in the first distance measurement period is different from the “continuous scheme” in which the light emission/exposure operation is continuously performed. In this way, by providing the non-exposure period in any of the first distance measurement period and the second distance measurement period, as will be described below, it is possible to reduce a distance measurement error due to interference between apparatuses when a plurality of distance measurement image pickup apparatuses is operated.
The present embodiment describes that the exposure operation for one set is divided into three periods (periods A, B, and C) in which the exposure timing is shifted. However, the number of divided periods is not limited thereto, and an arbitrary number corresponding to a plural number may be adopted.
First, when the first distance measurement is started (S100), a counter i is set to 1 (S101), and light emission/exposure for n sets is started (S102). In a light emission/exposure operation, first, in period A light emission/exposure (S103), light emission/exposure indicated by timing A1 of
When the specified number of times n has not been reached (No in S110), the process returns to S103 and repeats from the period A light emission/exposure. In this manner, the charge A, the charge B, and the charge C for m1×n times are accumulated in the light receiving unit 12. When the counter i has reached the specified number of times n (Yes in S110), accumulated data of the charge amount is read from the light receiving unit 12 (S111). The distance computation unit 13 computes a distance (first distance data) to the target 2 using the read amount of the charge A and the charge C (S112).
Subsequently, the second distance measurement is started (S200). Since the second distance measurement has the same procedure as that of the first distance measurement (S100), a repeated description will be omitted. However, in the period A light emission/exposure (S203), light emission/exposure indicated by timing A2 of
The distance computation unit 13 determines the distance using the first distance data obtained in S112 and the second distance data obtained in S212 (S220). Details of computation will be described below. In the first distance measurement, distance data repeatedly displayed in units of narrow distance measurement ranges is obtained. On the other hand, in the second distance measurement, distance data of a wide distance measurement range is obtained. Using this data, repetition of the first distance data is solved to determine the distance (de-aliasing).
The number m1 and m2 of repetitions of light emission/exposure in one set and the number n of sets in the first distance measurement and the second distance measurement are appropriately set according to the length of one frame period. Next, specific examples of the distance measurement will be described in Example 1 and Example 2.
Here, even though the pulsed light interval 40 in the first distance measurement period and the pulsed light interval 40′ in the second distance measurement period are made equal to each other, lengths of the non-exposure period 36 and the second non-exposure period 39 may be set so that a ratio thereof has an integer multiple relationship.
Reflected light for one light emission pulse is exposed by any two consecutive gates of periods A, B and C. In this example, exposure is performed in the period A and the period B, which is indicated by reference symbols 41 and 42. When the amounts of charges generated by exposure in the periods A, B, and C are set to A, B, and C, respectively, the equation of
If MIN(A,B,C)=C,
dT={(B−C)/(A+B−2C)}·T+3nT
If MIN(A,B,C)=A,
dT={(C−A)/(B+C−2A)}·T+T+3nT
If MIN(A,B,C)=B,
dT={(A−B)/(C+A−2B)}·T+2T+3nT
Here, MIN is a function for obtaining a minimum value. “n” is a parameter representing an nth period in which exposure is performed in three times of repetitive exposure, and is referred to as the number of repetitions. Here, n=0, 1, and 2 represent the first, second and third times, respectively.
In measurement in the first distance measurement period, it is impossible to specify the number n of repetitions since it is not known at what exposure the signal is obtained.
Therefore, in the first distance measurement period, the first distance data D1T is computed from dT when n=0 as follows.
D
1T
=c·dT(n=0)/2
Here, a range of a measurable distance (distance measurement range) will be described. The distance measurement range DR is obtained from a reflected light delay time dTR.
dTR=(pulse width)×(number of times of repetitive exposure×3−1)
D
R
=c·dTR/2
In the first distance measurement period, since the pulse width=1T and the number of times of repetitive exposure=3,
dTR=1T·(3×3−1)=8T.
On the other hand, in the conventional one-time exposure,
dTR=1T·(1×3−1)=2T.
Thus, the distance measurement range DR is expanded by four times.
If A≥C,dT={(B−C)/(A+B−2C)}·4T
If A<C,dT={(C−A)/(B+C−2A)}·4T+4T
From dT, the second distance data D4T is calculated as follows.
D
4T
=c·dT/2
When the reflected light delay time is set to dTR,
dTR=4T·(1×3−1)=8T.
Thus, the distance measurement range DR in this case matches the distance measurement range DR in the first distance measurement period.
However, in the second distance measurement period, the pulse width of the reflected light is quadrupled and the shot noise is doubled when compared to the first distance measurement period. Therefore, even though the distance measurement range is wide, the measurement accuracy is worse than that in the first distance measurement period.
Thereafter, the number of repetitions n of the first distance measurement period is specified using the second distance data D4T of the second distance measurement period, and an accurate distance D is determined from the first distance data D1T.
First, in the result indicated by reference symbol 50 obtained from the short distance, the first distance data D1T (indicated by a solid line) in the first distance measurement period (pulse width=1T) is a straight line having a repetition. A distance to a repetition point (repetition distance) R1T is a maximum measurement distance at n=0, and R1T=3cT/2=4.5 m. In addition, a linear portion having a slope is a measurable distance measurement range DR, and 8cT/2=12 m.
The second distance data D4T (indicated by a broken line) in the second distance measurement period (pulse width=4T) is a straight line having no repetition. The distance measurement range DR (gradient part) is 8cT/2=12 m, which is equal to the distance measurement range DR of the first distance data D1T.
Next, the result indicated by reference symbol 51 obtained from a long distance will be described. When the target is at a long distance, the reflected light does not return in an exposure gate period for the pulsed light, and returns in an exposure gate period for subsequent pulsed light. That is, the result indicated by reference symbol 51 is a result measured by pulsed light irradiated one before. In this example, the pulsed light interval is set to 19T (190 nsec), and the measurement result 51 from a position farther than a distance 28.5 m as a starting point is repeatedly obtained in the same pattern as that of the measurement result 50 at the short distance. However, since a flight distance of the pulsed light increases, the intensity of a signal to be exposed attenuates.
However, the measurement result 51 obtained from a long distance is not originally intended and becomes a noise component for the measurement result 50 at a short distance when the measurement result 51 is left. Thus, the measurement result 51 needs to be invalidated. As a countermeasure, the non-exposure period is extended to widen the pulsed light interval, and the reflected light is weak and can be neglected by being moved away to an unexposed distance. However, when the pulsed light interval is excessively widened, the number of times of repetitive exposure within the exposure period decreases and the distance measurement accuracy decreases. Therefore, it is desirable that the pulsed light interval is twice or more the distance measurement range in both the first and second distance measurement periods. When the flight distance of light is doubled, the exposure amount is reduced to ¼, and thus a threshold value can be set for the exposure amount to invalidate the reflected light from a distance of twice or more. Under the condition of Example 1, the pulsed light interval (19T=28.5 m) is about 2.4 times the distance measurement range (8T=12 m).
First, a ratio n′ of a difference between the first and second distance data to the repetition distance Rn (=3cT/2) of the first distance measurement period is obtained. The ratio n′ is a value corresponding to the number n of repetitions to be obtained.
n′=(D4T−D1T)/R1T
n′ is indicated by a dotted line. Since measurement errors are included in the first distance data D1T and the second distance data D4T, n′ is not an original integer value and is involved with a fraction after a decimal point. Therefore, n′ is converted into an integer by a round function (rounding off to the nearest integer).
n=ROUND(n′)
Thus, a real value (integer value) n of the number of repetitions is obtained.
D=D
1T
+n·R
1T
=D
1T
+n·3cT/2
In this calculation, the repetition distance R1T is added n times to the first distance data D1T. Here, since the first distance data D1T has high distance measurement accuracy, and the repetition distance R1T to be added is a constant (3cT/2) determined from a unit time T and the speed of light c, the accurate distance D can be determined. In this way, it is possible to perform measurement achieving both the high distance measurement accuracy and the wide distance measurement range.
Since the distance is beyond the measurement range after 13.5 m, the distance calculation is not performed as invalid data. In this case, a relationship of the charge amount is (A+B−2C)=0, which may be used as a determination condition.
Next, measures against interference light between a plurality of distance measurement image pickup apparatuses will be described.
In this state, an influence of interference light between devices will be described. First, a state in which pulsed light 51 (irradiated light or reflected light) of device No. 2 is used as interference light and exposure is performed at an exposure gate (period A) 52 of device No. 1 is shown. However, subsequent pulsed light 53 (interference light) of device No. 2 is shifted by 2T from the exposure gate (period A) of device No. 1, and thus is not exposed. That is, thereafter, a period in which interference light from device No. 2 is exposed at the exposure gate (period A) of device No. 1 is expanded to a period (17×19T) of the least common multiple of the pulsed light intervals of both devices. However, including the fact that the exposure gate of device No. 1 is repeatedly opened three times in the period A, the amount of interference light to be exposed is reduced to 3/19 when compared to a case in which the pulsed light intervals of both devices are the same (both are 17T). Even though the timing of the exposure gate is different in the other periods (periods B and C), the amount of interference light to be exposed is reduced to 3/19, which is the same as that in the period A.
In the example of
As described above, a period in which an influence of interference light is received between a plurality of devices expands to the least common multiple of the pulsed light intervals of the respective devices. Therefore, to increase the least common multiple, it is a great idea to set the values of the pulsed light intervals of the respective devices to be relatively prime. In addition, a unit for changing the pulsed light interval is not limited to 1T, and may correspond to an arbitrary numerical value less than 1T such as 0.5T or 0.25T. By setting the value to less than 1T, it is possible to select an interference-avoidable pulsed light interval in a lot of combinations without widening the range of the pulsed light interval.
In general, a start timing of one frame is difference among a plurality of devices. Thus, a shift by dF occurs in the light emission/exposure periods (including set 1 to set 10) of device No. 1 and device No. 2. In an example of
However, in the first one set, interference light from device No. 2 is exposed only for an exposure gate 61 of the period C, and thus a distance error occurs in this portion. For example, when the pulsed light intervals of device No. 1 and device No. 2 correspond to a combination of
A description will be given of a case in which the shift dF of the start timing of one frame changes and the overlapping period changes. For example, in a case in which interference light is exposed only at the exposure gates of the periods B and C in one set, the interference light is canceled in the periods B and C. Therefore, it suffices that imbalance due to the interference light not being exposed in the period A is considered as the influence, and the imbalance amount is 3/19 as described above. Therefore, in this case, the distance error is reduced to 3/190 in the accumulation within the light emission/exposure period.
In addition, when the start deviation dF exceeds one set period, the number of sets not receiving the interference light from device No. 2 increases, and thus the distance error becomes smaller as a whole.
The cancellation effect of the interference light described here depends on the combination of the pulsed light intervals of device No. 1 and device No. 2, and the pulsed light intervals are set so that the cancellation effect increases. In addition, a combination of pulsed light intervals is determined and applied such that the amount of interference light is reduced in any combination of the first distance measurement period and the second distance measurement period.
As described above, this example is characterized in that the non-exposure period is provided so that the pulsed light intervals of the respective apparatuses are different from each other to avoid interference when operating a plurality of the apparatuses. In this instance, a description has been given of the fact that distance measurement accuracy can be ensured by adopting the “extended pulse scheme” of repeating exposure a plurality of times for a light emission pulse having a short pulse width in the first distance measurement period and providing the non-exposure period thereto. However, the distance measurement accuracy may not be ensured in a method of inserting the non-exposure period in the conventional “continuous scheme”. A reason will be described below.
When the reflected light from the target is exposed at a timing illustrated in
In Example 2, a description will be given of an example in which the pulse width and the number of times of repetitive exposure are different from those in Example 1.
Next, the distance calculation method of Example 2 will be described (a figure corresponding to
If MIN(A,B,C)=C,
dT={(B−C)/(A+B−2C)}·T+3nT
If MIN(A,B,C)=A,
dT={(C−A)/(B+C−2A)}·T+T+3nT
If MIN(A,B,C)=B,
dT={(A−B)/(C+A−2B)}·T+2T+3nT
Here, n is the number of repetitions representing an nth period in which exposure is performed in two times of repetitive exposure, and n=0, 1 indicate the first time and the second time, respectively.
In measurement in the first distance measurement period, it is impossible to specify the number n of repetitions. Therefore, in the first distance measurement period, the first distance data D1T is computed from dT when n=0 as follows.
D
1T
=c·dT(n=0)/2
Next, distance calculation in the second distance measurement period of
If A≥C,dT={(B−C)/(A+B−2C)}·2T
If A<C,dT={(C−A)/(B+C−2A)}·2T+2T
From dT, the second distance data D2T is calculated.
D
2T
=c·dT/2
Thereafter, the number n of repetitions of the first distance measurement period is specified using the measurement result D2T of the second distance measurement period, and the accurate distance D is determined from the first distance data D1T.
In Example 2, the distance measurement ranges in the first distance data and the second distance data are different from each other. That is, a reflected light delay time dTR1 and a distance measurement range DR1 in the first distance measurement period are
dTR1=1T·(2×3−1)=5T,DR1=7.5 m.
A reflected light delay time dTR2 and a distance measurement range DR2 in the second distance measurement period are
dTR2=2T·(1×3−1)=4T,DR2=6 m.
In de-aliasing, using the second distance data D2T, the number n of repetitions in the first distance data D1T is obtained in the following procedure. First, a ratio n′ of a difference amount between the first and second distance data to the repetition distance R1T (=3cT/2) of the first distance measurement period is obtained.
n′=(D2T−D1T)/R1T
n′ is indicated by a dotted line. Since measurement errors are included in the first distance data D1T and the second distance data D2T, n′ is not an original integer value and is involved with a fraction after a decimal point. Therefore, n′ is converted into an integer.
n=ROUND(n′)
Thus, a real value (integer value) n of the number of repetitions is obtained.
In this example, the distance measurement ranges DR1 and DR2 of D1T and D2T do not match each other. Thus, in a distance range 6 to 7.5 m, n′ varies from 1 to 0.66. However, by setting n=1 using a round function, it is possible to correctly perform de-aliasing. In addition, conversion from n′ into an integer n is not limited to the round function (rounding off), and a threshold value may be freely set according to a variation of a value of n′. In this example, it is possible to set n=0 when n′ 0.4, and n=1 when 0.4<n′.
D=D
1T
+n·R
1T
=D
1T
+n·3cT/2
In this computation, since the first distance data D1T has high distance measurement accuracy and the repetition distance R1T to be added is a constant (3cT/2) determined from the unit time T and the speed of light c, the accurate distance D can be determined. In this way, measurement can be performed by achieving both high distance measurement accuracy and a wide distance measurement range.
In the case of Example 2, an exposure time is shortened in both the first distance measurement period and the second distance measurement period, and thus Example 2 is advantageous when compared to Example 1 in an environment in which there is a concern about a reduction in distance measurement accuracy due to external light such as sunlight. In addition, in Example 2, since the first non-exposure period 86 and the second non-exposure period 89 are provided, it is possible to reduce distance measurement errors due to interference between a plurality of apparatuses while ensuring high distance measurement accuracy as in Example 1.
<Relationship Between Pulse Width and Number of Times of Repetitive Exposure>
Here, a description will be given of an optimum relationship between the pulse width of the first distance measurement period (high frequency) and the number of times of repetitive exposure, and the pulse width of the second distance measurement period (low frequency).
In Example 1, the distance measurement ranges of the first and second distance measurement periods are made equal to each other. However, for example, a case in which the pulse width of the second distance measurement period is further widened and the distance measurement range of the second distance measurement period is made wider than the distance measurement range of the first distance measurement period is considered.
In this case, since the distance measurement ranges DR1 and DR5 of the first and second distance data D1T and D5T are not equal to each other, n′ changes from 2 to 2.3 in a range of 12 to 13.5 m. However, de-aliasing can be performed by setting n=2 using a round function. However, when the pulse width of the second distance measurement period is widened to 5T, shot noise increases, the error of the second distance data D5T increases, and the variation in the value of n increases. Thus, an error is more likely to occur during de-aliasing when compared to a case in which the pulse width is 4T. Therefore, it is desirable that the distance measurement range of the first distance measurement period and the distance measurement range of the second distance measurement period are made equal to each other.
When the pulse width of the first distance measurement period is set to TH, the pulse width of the second distance measurement period is set to TL, and the distance measurement ranges corresponding thereto are set to DRH and DRL, a condition under which the distance measurement ranges of the first and second distance measurement periods are equal to each other is as follows.
D
RH=(cTH/2)·(3−1)
D
RL=(cTL/2)·(3n−1)
Here, c is the speed of light, and n is the number of times of repetitive exposure. A condition for DRH=DRL is as follows.
T
L
/T
H=(3n−1)/2
In Example 1 (
However, TL can be only set to an integer multiple of TH in some cases. In this case, it is sufficient to use an integer value rounded off after the decimal point. That is, it is possible to use TL obtained with respect to TH using the following equation.
T
L
/T
H=ROUNDDOWN[(3n−1)/2]
The ROUNDDOW function performs processing to omit figures below the decimal point here.
Example 2 corresponds to this case, and the condition for DRH=DRL is approximately satisfied by setting the pulse width ratio to TL/TH=2 and the number of times of repetitive exposure on the pulse width TH side to n=2.
According to the condition described above, since the distance measurement range of the first distance measurement period and the distance measurement range of the second distance measurement period are equal or close to each other, the distance measurement accuracy and the performance in the distance measurement range are balanced, and thus it is possible to perform most efficient measurement.
Meanwhile, for example, in an application that analyzes flow lines of people in a store, it is conceivable to use a plurality of distance measurement image pickup apparatuses, the number of which exceeds ten. Further, as an example of measures against occlusion, it is necessary to reduce the installation interval of the distance measurement image pickup apparatuses from the conventional interval of 3 m to 50 cm or less. However, as the installation interval is narrowed, the interference intensity of pulsed light emitted between the apparatuses increases. Even with the measures against interference light described above, there is a problem that a distance measurement error exceeds 5 cm. In addition, for example, when detecting stretching of a hand for a shelf in a store, from a viewpoint of improving measurement accuracy at a short distance, it is considered necessary to install a long distance-range distance measurement image pickup apparatus (in other words, a distance measurement image pickup apparatus that emits pulsed light having a large pulse width) and a short distance-range distance measurement image pickup apparatus (in other words, a distance measurement image pickup apparatus that emits pulsed light having a small pulse width) in a coexisting manner. Therefore, next, a description will be given of a distance measurement system capable of performing accurate measurement even when a distance between the apparatuses is narrowed and distance measurement image pickup apparatuses of different ranges coexist as described above.
First, with reference to
Further,
A ratio will be considered for specific description. As illustrated in
Next, an example of a system for realizing the above-mentioned interference suppression effect will be described.
As illustrated in
Further, each apparatus (TOF #1to n) includes a register setting block 121 and an interference setting computation block 122. The register setting block 121 has a function of setting a register. The interference setting computation block 122 has a function of setting a pulse period, and detailed processing will be described in detail later.
Further, each distance measurement image pickup apparatus (TOF #1 to n) includes a light emission/exposure gate generation circuit 131, a pulse generation unit 132, and a light emitting pulse circuit 133. The light emission/exposure gate generation circuit 131 is a circuit for generating a gate used for light emission and an exposure gate based on the reference clock. The pulse generation unit 132 is used to generate a pulse width and a pulse interval based on the reference clock. The light emitting pulse circuit 133 is a circuit used to generate pulsed light using the generated gate by an appropriately generated pulse width (in this example, PW=1×T=10 nsec) and a pulse interval based on the pulse period (in this example, the pulse period is 19 and PT=19×nsec). Note that each distance measurement image pickup apparatus (TOF #1 to n) may be configured so that the pulse width may be switched, and the pulse width used for the measurement may be appropriately selected by the user.
Further, each distance measurement image pickup apparatus (TOF #1 to n) includes an irradiation optical system drive circuit 141 and an exposure shutter pulse circuit 142. The irradiation optical system drive circuit 141 is a circuit used to drive an irradiation optical system to irradiate pulsed light based on input from the light emitting pulse circuit 133 from the light source. The exposure shutter pulse circuit 142 is a circuit used to control the timing of exposure using the exposure gate when performing measurement based on an appropriately set pulse width and pulse period. The light receiving unit 12 performs exposure based on input from the exposure shutter pulse circuit 142.
Further, each distance measurement image pickup apparatus (TOF #1 to n) includes an accumulated charge transfer unit 151 and the distance computation unit 13. The accumulated charge transfer unit 151 is used to transfer charges accumulated in the exposure gate during the measurement period and use the charges for distance calculation. The distance computation unit 13 is used to calculate the distance based on the accumulated charges by the above-mentioned calculation method.
Further, each distance measurement image pickup apparatus (TOF #1 to n) includes a communication I/F block 152. The communication I/F block 152 is included in an interface for communication, and is used, for example, to output data (calculated distance data, etc.) to the outside. Note that data output from each distance measurement image pickup apparatus (TOF #1 to n) may be received and acquired by a host PC 161. Then, the host PC 161 may aggregate the data from each distance measurement image pickup apparatus (TOF #1 to n) and output the resulting data. Further, data such as the pulse period and the pulse width of the pulsed light emitted by each distance measurement image pickup apparatus (TOF #1 to n) may be output to the host PC 161.
Furthermore, for example, the host PC 161 may be used to control each distance measurement image pickup apparatus (TOF #1 to n) so that measurement using the common reference clock is performed, or monitor whether measurement is performed using the common reference clock. Further, a command for setting a register, a pulse width, a pulse period, etc. may be output from the host PC 161 to each distance measurement image pickup apparatus (TOF #1 to n).
Next, details of processing of the interference setting computation block 122 will be described. Note that the subject of the processing of the interference setting computation block 122 is a processor (CPU in this example). By the processing of the interference setting computation block 122, the pulse period is set, and an interference setting table (data in the format illustrated in
A sampling clock is set in the interference setting computation block 122. The sampling clock may be the same as the reference clock generated by the crystal oscillator 111 and the PLL block 112.
In addition, in the interference setting computation block 122, a minimum pulse period, which is a least pulse period, is set. The minimum pulse period may be set to 13 as an example.
Further, in the processing of the interference setting computation block 122, information about the number of interference suppression settings is used. The number of interference suppression settings includes information related to information about a type of pulse width and information about the number of integers used to set the pulse period. The number of interference suppression settings may be appropriately set in the format of data in which the type of pulse width used for measurement is set to m (m=1, 2, 3 . . . ) and the number of integers used for setting the pulse period is set to n (n=1, 2, 3, . . . ), and stored in the distance measurement image pickup apparatuses (TOF #1 to n). In this case, mT×nT pulse periods (that is, m×n pulse periods) are set.
The integers used to set the pulse periods are arranged, for example, in an integer table, and the integer table is stored in an appropriate storage device (for example, a memory). The integers used to set the pulse periods may be natural numbers of 2 or more.
Further, in the processing of the interference setting computation block 122, different integers used to set the pulse periods are appropriately acquired from the integers stored in the integer table. Here, integers larger than or equal to the minimum pulse period are acquired, and as an example, integers larger than or equal to 13 are acquired. From the integers arranged in the integer table, n integers larger than or equal to the minimum pulse period may be acquired from a small value.
Further, in the processing of the interference setting computation block 122, after each different integer to be used is acquired, a value obtained by multiplying each different integer by an integer, which is a natural number, is obtained, and m×n pulse periods are obtained. Then, an interference setting table for storing m×n pulse periods in proportion to the size of the pulse width is generated.
Here, the interference setting table includes a pulse period as data related to an interval of pulsed light, and as an example, as illustrated in
When measurement is performed using the distance measurement system 100, a pulse period of pulsed light emitted by each distance measurement image pickup apparatus (TOF #1 to n) is appropriately selected from the interference setting table stored in each apparatus. Then, measurement is performed at an interval of pulsed light rays based on the reference clock common to each distance measurement image pickup apparatus (TOF #1 to n).
Here, for example, when measurement is performed by setting the pulse width of each distance measurement image pickup apparatus (TOF #1 to n) to 1T in common, a pulse period corresponding to the pulse width 1T of the interference setting table is appropriately selected in each distance measurement image pickup apparatus (TOF #1 to n), and measurement is performed based on the selected pulse period.
The distance measurement system 100 may perform measurement using different pulse widths between the distance measurement image pickup apparatuses (TOF #1 to n). For example, when measurement is performed by setting a pulse width of a certain apparatus to 2T, a pulse period corresponding to a pulse width 2T of an interference setting table of the apparatus is selected for the apparatus. Irradiation of pulsed light having a large pulse width has a greater effect of interference on other apparatuses than irradiation of pulsed light having a small pulse width. However, by using a pulse period that is an integer multiple (double or more) for a distance measurement image pickup apparatus having a large pulse width in this way, an interference residual between apparatuses (that is, an interference ratio between apparatuses) may be made uniform to easily obtain an appropriate interference suppression effect.
Note that the pulse period is selected so as to be different between the respective distance measurement image pickup apparatuses (TOF #1 to n) in measurement of the distance measurement system 100. Therefore, in measurement of the distance measurement system 100, pulse widths between the respective distance measurement image pickup apparatuses (TOF #1 to n) are all different.
The distance measurement system 100 can perform suitable measurement even when the apparatus interval is shortened by using the interference suppression measures described above. Further, the number of distance measurement image pickup apparatuses (TOF #1 to n) included in the distance measurement system 100 may be set to 10 or more (n≥10) as an example, and ten or distance measurement image pickup apparatuses may be used to perform measurement.
The invention is not limited to the above contents, and includes various modifications. For example, the above-mentioned examples, etc. have been described in detail for a better understanding of the invention, and are not necessarily limited to those including all the configurations of the description.
In the above description, the crystal oscillator 111 and the PLL block 112 are included in an emission source of the reference clock. However, for example, the emission source may include only the crystal oscillator 111. Alternatively, the emission source may include a reference clock generator built in the PLL.
Various types of data (tables or programs) can be stored in an appropriate storage device (for example, a memory included in the distance measurement image pickup apparatus). The processing of the distance measurement system 100 is performed by a processor executing an appropriate program for performing predetermined processing. For example, the processing of the distance measurement image pickup apparatus (TOF #1 to n) is performed by, as an example, a processor (the controller 14 which is a CPU included in the distance measurement image pickup apparatus) included in the distance measurement image pickup apparatus (TOF #1 to n). A CPU or GPU can be considered as an example of the processor. However, other semiconductor devices may be used as long as the semiconductor devices are main constituents that execute predetermined processing.
Number | Date | Country | Kind |
---|---|---|---|
2021-073696 | Apr 2021 | JP | national |