WO2020045445A1 - Dispositif de mesure de distance, groupe de dispositifs de mesure de distance et système de dispositif de mesure de distance - Google Patents

Dispositif de mesure de distance, groupe de dispositifs de mesure de distance et système de dispositif de mesure de distance Download PDF

Info

Publication number
WO2020045445A1
WO2020045445A1 PCT/JP2019/033542 JP2019033542W WO2020045445A1 WO 2020045445 A1 WO2020045445 A1 WO 2020045445A1 JP 2019033542 W JP2019033542 W JP 2019033542W WO 2020045445 A1 WO2020045445 A1 WO 2020045445A1
Authority
WO
WIPO (PCT)
Prior art keywords
light
distance measuring
measuring device
distance
unit
Prior art date
Application number
PCT/JP2019/033542
Other languages
English (en)
Japanese (ja)
Inventor
岡本　修治
佐伯　哲夫
石丸　裕
和穂 江川
智浩 江川
裕多 堀
Original Assignee
日本電産株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 日本電産株式会社 filed Critical 日本電産株式会社
Publication of WO2020045445A1 publication Critical patent/WO2020045445A1/fr

Links

Images

Classifications

    • 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/02—Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06—Systems determining position data of a target
    • G01S17/08—Systems determining position data of a target for measuring distance only
    • G01S17/10—Systems determining position data of a target for measuring distance only using transmission of interrupted, pulse-modulated waves
    • 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/497—Means for monitoring or calibrating
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions

Definitions

  • the present invention relates to a distance measuring device, a distance measuring device group, and a distance measuring device system.
  • Patent Literature 1 discloses an autonomous mobile device including a laser range finder.
  • a laser range finder scans a laser in a horizontal direction around an autonomous mobile device in a fan shape within a predetermined range. That is, the laser range finder emits the laser at every predetermined angle. Then, the laser range finder detects the laser reflected from the object and returns, and determines the angle between the laser and the object based on the emission angle of the laser and the time from when the laser is emitted to when the laser reflects and returns from the object. And distance.
  • the autonomous mobile device has a local map creating unit and a self-position estimating unit.
  • the local map creator creates a local map around the own device with the laser range finder as the origin, based on information detected by the laser range finder.
  • the self-position estimating unit compares the local map, which has been transformed into the coordinate system (absolute coordinate system) of the environment map, with the environment map, and estimates the self-position based on the result of the comparison.
  • the autonomous mobile device has a sign detection unit.
  • the sign detection unit detects a sign based on the output pattern of the detection information and the non-detection information output from the laser range finder. More specifically, the sign detection unit is configured such that a plurality of detection information groups and a plurality of non-detection information groups alternately appear a predetermined number of times, and the number of non-detection information included in each of the plurality of non-detection information groups Is within the first predetermined range and the number of pieces of detection information included in each of the plurality of detection information groups is within the second predetermined range, it is determined that the detection target is a marker.
  • the self-position estimating unit corrects the estimated self-position based on the sign detected by the sign detecting unit.
  • Patent Document 1 According to the autonomous mobile device of Patent Document 1 described above, it is possible to reliably determine and detect a sign, regardless of the environment in which the sign is placed, and to perform accurate autonomous movement. ing. Patent Document 1 also discloses that the sign detection unit determines that the detected object is a sign when the same detected object is determined to be a sign a plurality of times. It is stated that this makes it possible to more reliably prevent erroneous detection of a sign.
  • Patent Document 1 does not solve this problem.
  • an object of the present invention is to provide a distance measuring device capable of suppressing erroneous distance measurement due to interference from another distance measuring device.
  • An exemplary distance measuring device includes a light emitting unit that includes a light emitting unit and performs rotational scanning of emitted light, a light receiving unit that outputs a light receiving signal based on light reception, an emission of the emitted light, and the light receiving unit. And a distance measuring unit that measures a distance to a measurement target based on light reception by the light emitting unit. It is determined that the light receiving signal is based on the light reflected by the object to be measured, based on the shift of the light receiving timing of the light receiving signal obtained when the light is emitted.
  • the exemplary distance measuring device of the present invention it is possible to suppress erroneous distance measurement due to interference from another distance measuring device.
  • FIG. 1 is a schematic overall perspective view of an automatic guided vehicle according to one embodiment of the present invention.
  • FIG. 2 is a schematic side view of the automatic guided vehicle according to one embodiment of the present invention.
  • FIG. 3 is a plan view of the automatic guided vehicle according to one embodiment of the present invention as viewed from above.
  • FIG. 4 is a schematic side sectional view of the distance measuring device according to one embodiment of the present invention.
  • FIG. 5 is a block diagram showing an electrical configuration of the distance measuring device according to one embodiment of the present invention.
  • FIG. 6 is a block diagram showing an electrical configuration of the automatic guided vehicle according to one embodiment of the present invention.
  • FIG. 7 is a block diagram illustrating a first configuration example of the distance measurement unit.
  • FIG. 8 is a diagram for explaining pulse width correction.
  • FIG. 9 is a diagram illustrating a situation where a plurality of automatic guided vehicles equipped with a distance measuring device operate in a warehouse or the like.
  • FIG. 10 is a diagram illustrating an example of a waveform of a light reception signal obtained when the emission light is emitted at the first scanning position.
  • FIG. 11 is a diagram illustrating an example of a waveform of a received light signal obtained when the emitted light is emitted at the second scanning position.
  • FIG. 12 is a diagram in which the waveforms shown in FIGS. 10 and 11 are overlapped.
  • FIG. 13 is a diagram illustrating a situation where a plurality of automatic guided vehicles operate in a warehouse or the like and a situation where a worker works.
  • FIG. 10 is a diagram illustrating an example of a waveform of a light reception signal obtained when the emission light is emitted at the first scanning position.
  • FIG. 11 is a diagram illustrating an example of a waveform of a received light signal obtained when the emitted
  • FIG. 14 is a block diagram illustrating a second configuration example of the distance measurement unit.
  • FIG. 15 is a flowchart of a process performed by the distance measurement unit of the second configuration example.
  • FIG. 16 is a waveform diagram showing an example of the light receiving signal.
  • FIG. 17 is a schematic diagram illustrating a configuration example of a distance measurement device system.
  • FIG. 18 is a waveform diagram showing an example of each light receiving signal obtained at the first scanning position and the second scanning position in an overlapping manner.
  • the distance measuring device is configured as a laser range finder
  • an automatic guided vehicle that is used to carry a load
  • the automatic guided vehicle is also generally called an AGV (Automatic Guided Vehicle).
  • FIG. 1 is a schematic overall perspective view of an automatic guided vehicle 15 according to an embodiment of the present invention.
  • FIG. 2 is a schematic side view of the automatic guided vehicle 15 according to one embodiment of the present invention.
  • FIG. 3 is a plan view seen from above of the automatic guided vehicle 15 according to one embodiment of the present invention.
  • the automatic guided vehicle 15 travels autonomously by two-wheel drive and transports luggage.
  • the automatic guided vehicle 15 includes the vehicle body 1, the carrier 2, the support portions 3L and 3R, the drive motors 4L and 4R, the drive wheels 5L and 5R, the driven wheels 6F and 6R, and the distance measuring device 7. .
  • the vehicle body 1 includes a base 1A and a base 1B.
  • the plate-like base 1B is fixed to the rear upper surface of the base 1A.
  • the base 1B has a triangular portion Tr protruding forward.
  • the plate-shaped carrier 2 is fixed to the upper surface of the platform 1B. Luggage can be placed on the upper surface of the bed 2.
  • the carrier 2 extends further forward than the platform 1B. Thereby, a gap S is formed between the front of the base 1A and the front of the carrier 2.
  • the distance measuring device 7 is disposed in the gap S at a position in front of the vertex of the triangular portion Tr of the base 1B.
  • the distance measuring device 7 is configured as a laser range finder, and measures a distance to a measurement target while scanning a laser beam.
  • the distance measurement device 7 is used for obstacle detection, map information creation, and self-position identification described later. The detailed configuration of the distance measuring device 7 itself will be described later.
  • the support 3L is fixed to the left side of the base 1A, and supports the drive motor 4L.
  • the drive motor 4L is configured by, for example, an AC servomotor.
  • the drive motor 4L incorporates a speed reducer (not shown).
  • the drive wheel 5L is fixed to a rotating shaft of the drive motor 4L.
  • the support 3R is fixed to the right side of the base 1A and supports the drive motor 4R.
  • the drive motor 4R is configured by, for example, an AC servomotor.
  • the drive motor 4R incorporates a speed reducer (not shown).
  • the drive wheel 5R is fixed to a rotating shaft of the drive motor 4R.
  • the driven wheel 6F is fixed to the front side of the base 1A.
  • the driven wheel 6R is fixed to the rear side of the base 1A.
  • the driven wheels 6F, 6R rotate passively according to the rotation of the drive wheels 5L, 5R.
  • the automatic guided vehicle 15 By driving the drive wheels 5L, 5R by the drive motors 4L, 4R, the automatic guided vehicle 15 can be moved forward and backward. In addition, by controlling the rotational speeds of the drive wheels 5L and 5R to provide a difference, the automatic guided vehicle 15 can be turned clockwise or counterclockwise to change the direction.
  • the base 1A houses therein a control unit U, a battery B, and a communication unit T.
  • the control unit U is connected to the distance measuring device 7, the drive motors 4L and 4R, the communication unit T, and the like.
  • the control unit U communicates various signals with the distance measuring device 7 as described later.
  • the control unit U also controls the drive of the drive motors 4L and 4R.
  • the communication unit T communicates with an external tablet terminal (not shown) and conforms to, for example, Bluetooth (registered trademark). Thereby, the automatic guided vehicle 15 can be remotely controlled by the tablet terminal.
  • the battery B is composed of, for example, a lithium ion battery, and supplies power to each unit such as the distance measuring device 7, the control unit U, and the communication unit T.
  • FIG. 4 is a schematic side sectional view of the distance measuring device 7.
  • the distance measuring device 7 configured as a laser range finder includes a laser light source 71, a collimating lens 72, a light projecting mirror 73, a light receiving lens 74, a light receiving mirror 75, a wavelength filter 76, a light receiving element 77, A housing 78, a motor 79, a housing 80, a substrate 81, and a wiring 82 are provided.
  • the housing 80 has a substantially columnar shape extending in the vertical direction when viewed from the outside, and accommodates various components including the laser light source 71 in the internal space.
  • the laser light source 71 is mounted on the lower surface of a substrate 81 fixed to the lower surface of the upper end of the housing 80.
  • the laser light source 71 emits, for example, laser light in the infrared region downward.
  • the collimating lens 72 is disposed below the laser light source 71.
  • the collimating lens 72 emits the laser light emitted from the laser light source 71 downward as parallel light.
  • a light projecting mirror 73 is arranged below the collimating lens 72.
  • the light projecting mirror 73 is fixed to the rotating housing 78.
  • the rotating housing 78 is fixed to a shaft 79 ⁇ / b> A of the motor 79, and is driven to rotate around the rotation axis J by the motor 79. With the rotation of the rotating housing 78, the light projecting mirror 73 is also driven to rotate about the rotation axis J.
  • the light projecting mirror 73 reflects the laser light emitted from the collimating lens 72, and emits the reflected laser light as emission light L1. Since the light projecting mirror 73 is driven to rotate as described above, the emission light L1 is emitted while changing the emission direction within a range of 360 degrees around the rotation axis J.
  • the housing 80 has a transmission part 801 in the middle in the vertical direction.
  • the transmissive portion 801 is made of a translucent resin or the like.
  • the predetermined rotation scanning angle range ⁇ is set to 270 degrees around the rotation axis J as an example, as shown in FIG. More specifically, the range of 270 degrees includes 180 degrees in the front and 45 degrees in the left and right directions.
  • the emitted light L1 is transmitted through the transmission part 801 at least within a range of 270 degrees around the rotation axis J. In a range where the rear transmission part 801 is not disposed, the emitted light L1 is blocked by the inner wall of the housing 80, the wiring 82, or the like.
  • the light receiving mirror 75 is fixed to the rotating housing 78 at a position below the light projecting mirror 73.
  • the light receiving lens 74 is fixed to a circumferential side surface of the rotating housing 78.
  • the wavelength filter 76 is located below the light receiving mirror 75 and is fixed to the rotating housing 78.
  • the light receiving element 77 is located below the wavelength filter 76 and is fixed to the rotating housing 78.
  • the outgoing light L1 emitted from the distance measuring device 7 is reflected by the object to be measured and becomes diffused light. Part of the diffused light is transmitted through the gap S and the transmission portion 801 as incident light L2 and is incident on the light receiving lens 74.
  • the incident light L2 transmitted through the light receiving lens 74 is incident on the light receiving mirror 75, and is reflected downward by the light receiving mirror 75.
  • the reflected incident light L2 passes through the wavelength filter 76 and is received by the light receiving element 77.
  • the wavelength filter 76 transmits light in the infrared region.
  • the light receiving element 77 converts the received light into an electric signal by photoelectric conversion.
  • the rotating housing 78 When the rotating housing 78 is driven to rotate by the motor 79, the light receiving lens 74, the light receiving mirror 75, the wavelength filter 76, and the light receiving element 77 are driven to rotate together with the light projecting mirror 73.
  • the outgoing light L1 is emitted in the rotational scanning angle range ⁇ and the outgoing light L1 is reflected by the measurement object located within the measurement range Rs, the reflected light is transmitted through the transmission unit 801 as incident light L2 and is received by the light receiving lens 74. Is incident on.
  • the motor 79 is connected to the substrate 81 by a wiring 82 and is driven to rotate by being energized from the substrate 81.
  • the motor 79 rotates the rotating housing 78 at a predetermined rotation speed.
  • the rotating housing 78 is driven to rotate at about 3000 rpm.
  • the wiring 82 is routed vertically along the rear inner wall of the housing 80.
  • FIG. 5 is a block diagram illustrating an electrical configuration of the distance measuring device 7.
  • the distance measuring device 7 includes a laser light emitting unit 701, a laser light receiving unit 702, a distance measuring unit 703, a data communication interface 704, a second arithmetic processing unit 705, a driving unit 706, And a motor 79.
  • the laser light emitting unit 701 includes a laser light source 71 (FIG. 4), an LD driver (not shown) for driving the laser light source 71, and the like.
  • the LD driver is mounted on the substrate 81.
  • the laser emitting unit 701, the light projecting mirror 73, the rotating housing 78, and the motor 79 constitute a light emitting unit 83 (FIG. 4). That is, the distance measuring device 7 includes the light projecting unit 83 that includes the light emitting unit (laser light emitting unit 701) and performs rotational scanning of the emitted light L1.
  • Laser light receiving section 702 includes light receiving element 77 (FIG. 4) and the like, and outputs a light receiving signal based on the received light. That is, the distance measuring device 7 includes a light receiving unit (laser light receiving unit 702) that outputs a light receiving signal based on light reception. The more specific configuration of the laser light receiving unit 702 will be described later.
  • the distance measuring unit 703 receives a light receiving signal output from the laser light receiving unit 702.
  • the distance measuring unit 703 has a first arithmetic processing unit 703A.
  • the laser emission unit 701 emits a pulsed laser beam using the laser emission pulse LP output from the first arithmetic processing unit 703A as a trigger. At this time, the outgoing light L1 is emitted.
  • the incident light L2 is received by the laser light receiving unit 702.
  • Laser light receiving section 702 outputs a light receiving signal to distance measuring section 703 based on the reception of incident light L2.
  • the first arithmetic processing unit 703A outputs a reference pulse (not shown in FIG. 5) output together with the laser emission pulse LP.
  • the distance measurement unit 703 can acquire the distance to the measurement target OJ by measuring the elapsed time from the rising timing of the reference pulse to the rising timing of the light receiving signal. That is, the distance measuring unit 703 measures the distance by a so-called TOF (Time @ Of @ Flight) method.
  • the distance measuring device 7 includes the distance measuring unit 703 that measures the distance to the measurement target OJ based on the emission of the emitted light and the light reception by the light receiving unit 702. The more specific configuration of the distance measuring device 7 will be described later.
  • the drive unit 706 controls the rotation of the motor 79.
  • the motor 79 is driven to rotate at a predetermined rotation speed by the drive unit 706.
  • the first arithmetic processing unit 703A outputs a laser emission pulse LP each time the motor 79 rotates by a predetermined unit angle.
  • the laser light emitting unit 701 emits light, and the emitted light L1 is emitted.
  • FIG. 3 shows that the emitted light L1 is emitted at every predetermined rotation angle ⁇ .
  • the first arithmetic processing unit 703A uses the distance measurement device 7 as a reference based on the rotation angle position of the motor 79 at the timing when the laser emission pulse LP is output and the distance measurement data obtained corresponding to the laser emission pulse LP. To generate position information on the orthogonal coordinate system. That is, the position of the measurement object OJ is acquired based on the rotation angle position of the light projecting mirror 73 and the measured distance. The acquired position information is output from the first arithmetic processing unit 703A as measured distance data DT. In this manner, a distance image of the measurement object OJ can be obtained by rotational scanning of the emitted light L1 in the rotational scanning angle range ⁇ .
  • the measured distance data DT output from the first arithmetic processing unit 703A is transmitted via the data communication interface 704 to the automatic guided vehicle 15 shown in FIG.
  • the second arithmetic processing unit 705 determines whether or not the measurement target is located within a predetermined area based on the measurement distance data DT. Specifically, if the position of a certain measurement target indicated by the measurement distance data DT is located within the predetermined area, it is determined that the measurement target is located within the predetermined area. When determining that the measurement target is located within the predetermined area, the second arithmetic processing unit 705 outputs the detection signal Ds, which is a flag, as a High level. On the other hand, when the measurement object is not located within the predetermined area, the detection signal Ds having a low level is output. The detection signal Ds is transmitted to the automatic guided vehicle 15 shown in FIG.
  • FIG. 6 is a block diagram illustrating an electrical configuration of the automatic guided vehicle 15.
  • the automatic guided vehicle 15 includes a distance measuring device 7, a control unit 8, a driving unit 9, and a communication unit T.
  • the control unit 8 is provided in the control unit U (FIG. 1).
  • the control unit 8 is configured by a processor such as a CPU (Central Processing Unit).
  • the drive unit 9 includes a motor driver (not shown) and drive motors 4L and 4R.
  • the motor driver is provided in the control unit U.
  • the control unit 8 issues a command to the drive unit 9 and controls the drive unit 9.
  • the driving unit 9 controls the driving speed and the rotating direction of the driving wheels 5L and 5R.
  • the control unit 8 communicates with a tablet terminal (not shown) via the communication unit T.
  • the control unit 8 can receive, via the communication unit T, an operation signal corresponding to the content operated on the tablet terminal.
  • the measured distance data DT output from the distance measuring device 7 is input to the control unit 8.
  • the control unit 8 can create map information based on the measured distance data DT.
  • the map information is information generated for performing self-position identification for specifying the position of the automatic guided vehicle 15 and is generated as position information of a stationary object at a place where the automatic guided vehicle 15 runs. For example, when the location where the automatic guided vehicle 15 travels is a warehouse, the stationary object is a wall of the warehouse, shelves arranged in the warehouse, or the like.
  • the map information is generated, for example, when a manual operation of the automatic guided vehicle 15 is performed by the tablet terminal.
  • an operation signal corresponding to the operation of, for example, the joystick of the tablet terminal is transmitted to the control unit 8 via the communication unit T, and the control unit 8 instructs the driving unit 9 in accordance with the operation signal, The traveling control of the transport vehicle 15 is performed.
  • the control unit 8 specifies the position of the measurement target at the place where the automatic guided vehicle 15 travels as map information. I do.
  • the position of the automatic guided vehicle 15 is specified based on the drive information of the drive unit 9.
  • the map information generated as described above is stored in the storage unit 85 of the control unit 8.
  • the control unit 8 compares the measured distance data DT input from the distance measuring device 7 with the map information stored in advance in the storage unit 85, thereby identifying the position of the automatic guided vehicle 15 itself. I do. That is, the control unit 8 functions as a position identification unit. By performing the self-position identification, the control unit 8 can perform autonomous traveling control of the automatic guided vehicle 15 along a predetermined route.
  • the control unit 8 can also control the driving unit 9 based on the detection signal Ds output from the distance measuring device 7.
  • FIG. 7 is a block diagram illustrating a first configuration example of the distance measurement unit 703.
  • FIG. 7 also shows a specific configuration example of the laser light receiving unit 702.
  • the laser light receiving section 702 has an APD (avalanche photodiode) 702A and an amplifier circuit (transimpedance amplifier) 702B.
  • the APD 702A corresponds to the light receiving element 77, and converts the received laser light into a current signal.
  • the amplifier circuit 702B converts the current signal output from the APD 702A into a light receiving signal Ps by current / voltage conversion and outputs the light receiving signal Ps.
  • the distance measuring unit 703 includes a first TDC (time to digital converter) 703B and a second TDC 703C in addition to the above-described first arithmetic processing unit 703A.
  • the first TDC 703B measures an elapsed time T1 from the rising timing of the reference pulse SP output from the first arithmetic processing unit 703A to the rising timing of the light receiving signal Ps output from the amplifier circuit 702B.
  • the second TDC 703C measures an elapsed time T2 from the rising timing of the reference pulse SP output from the first arithmetic processing unit 703A to the falling timing of the light receiving signal Ps output from the amplifier circuit 702B.
  • the first arithmetic processing unit 703A performs the following distance measurement by pulse width correction based on the measurement results by the first TDC 703B and the second TDC 703C.
  • the light receiving signal Ps is not actually a pulse waveform but a waveform having a gradient with respect to time, as shown in FIG. Accordingly, even if the elapsed time T1 from the rising timing t0 of the reference pulse SP to the timing of crossing the first light receiving threshold Th1 when the light receiving signal Ps rises is measured by the first TDC 703B, it is necessary to measure the elapsed time for accurate distance measurement. It is necessary to perform the correction by subtracting the correction amount ⁇ t from the time T1.
  • the correction amount ⁇ t is a time from when the light receiving signal Ps rises to the first light receiving threshold Th1 from the zero level.
  • the pulse width correction the elapsed time T2 from the rising timing t0 of the reference pulse SP to the timing of crossing the second light receiving threshold Th2 when the light receiving signal Ps falls is also measured by the second TDC 703C, and the elapsed times T2 and T1 are measured. Is calculated as the pulse width W. As the peak level of the light receiving signal Ps increases, the rising and falling of the light receiving signal become steeper, the pulse width W increases, and the correction amount ⁇ t decreases. Therefore, the correction amount ⁇ t is determined based on the actually calculated pulse width W and the relationship between the preset pulse width W and the correction amount ⁇ t. Then, distance measurement is performed by subtracting the determined correction amount ⁇ t from the measured elapsed time T1.
  • the distance measuring device 7 measures the distance based on the reception of the direct light DL or the reflected light RL, there is a possibility that the distance measuring device 7 erroneously measures a distance different from the distance to the measurement target to be measured. In addition to the situation shown in FIG. 9, for example, when another fixed type distance measuring device (for preventing intrusion, etc.) is present, the effect of the laser beam emitted from the distance measuring device is the same. .
  • the distance measuring device 7 of the present embodiment has a function of suppressing the influence of such interference from other distance measuring devices.
  • a function of suppressing the influence of such interference from other distance measuring devices will be described with reference to FIGS. 10 to 12 as an example.
  • FIG. 10 shows an example of the waveform of the light receiving signal Ps1 obtained when the emission light L1 is emitted at a certain first scanning position in the measurement range Rs (FIG. 3) for scanning the emission light L1.
  • the scanning position is an angular position around the rotation axis J with reference to a predetermined radial direction about the rotation axis J with reference to FIG.
  • the light receiving signal Ps1 shown in FIG. 10 is shown as a waveform with respect to the timing at which the emission light L1 is emitted, that is, the elapsed time from the rising timing of the reference pulse SP. This is the same in FIGS. 11 and 12. As shown in FIG.
  • the received light signal Ps1 includes a received light signal Ps11 based on the reception of the reflected light of the outgoing light L1 reflected by the measurement target, and a received light signal Ps1 based on the reception of the direct light emitted from another distance measuring device. Ps12.
  • FIG. 11 shows an example of the waveform of the light receiving signal Ps2 obtained when the emitted light L1 is emitted at the second scanning position shifted from the first scanning position by the predetermined rotation angle ⁇ (FIG. 3) in the same revolution.
  • the received light signal Ps2 is composed of a received light signal Ps21 based on the reception of the reflected light reflected from the object to be emitted and the received light signal Ps2 based on the reception of the direct light emitted from another distance measuring device. Ps22.
  • the distance measuring unit 703 uses the first TDC 703B to start from the rising timing of the reference pulse PS to the timing of crossing the first light receiving threshold Th1 at the rising of each of the light receiving signals Ps11 and Ps12. The elapsed times T10 and T11 are measured. Further, when the emission light L1 is emitted at the first scanning position, the distance measurement unit 703 uses the second TDC 703C to determine the second light reception threshold Th2 at the fall of each of the light reception signals Ps11 and Ps12 from the rise timing of the reference pulse PS. The elapsed times T20 and T21 until the crossing timing are measured.
  • the distance measurement unit 703 uses the first TDC 703B to cross the first light reception threshold Th1 at the rise of each of the light reception signals Ps21 and PS22 from the rise timing of the reference pulse PS. The elapsed times T12 and T13 until the timing are measured. Further, when the emission light L1 is emitted at the second scanning position, the distance measurement unit 703 uses the second TDC 703C to determine the second light reception threshold value Th2 at the fall of each of the light reception signals Ps21 and PS22 from the rise timing of the reference pulse PS. The elapsed times T22 and T23 until the crossing timing are measured.
  • the first arithmetic processing unit 703A included in the distance measuring unit 703 calculates the difference between the elapsed times until the light reception signals obtained at the first and second scanning positions cross the first light reception threshold Th1 by a predetermined time difference. It is determined whether it is within. That is, in the example of FIGS. 10 and 11, the first arithmetic processing unit 703A compares the difference between the elapsed times T10 and T12 and the difference between the elapsed times T11 and T13 with the predetermined time differences.
  • FIG. 12 is a diagram in which the waveforms shown in FIGS. 10 and 11 are overlapped.
  • the light receiving signals Ps11 and PS21 are light receiving signals based on the reception of the reflected light of the outgoing light L1 by the measurement object, there is almost no difference between the elapsed times T10 and T12, and the difference is within a predetermined time difference. Becomes
  • the difference ⁇ T between the elapsed times T11 and T13 increases, and the difference ⁇ T is within a predetermined time difference. No longer.
  • Other distance measuring devices often have different rotational speeds for the rotation scanning of the emitted light from their own distance measuring device 7, in which case the deviation of the light receiving timing of the direct light in the distance measuring device 7 becomes large, and the difference ⁇ T Becomes larger. Even if the rotation speed is the same in setting, the rotation speed is often shifted due to an error in many cases. In this case, the shift of the light receiving timing of the direct light also becomes large. The same applies to the case where the light emitted from another distance measuring device receives the reflected light (reflected light RL in FIG. 9) reflected by the object.
  • the first arithmetic processing unit 703A determines that the received light signal is based on the light reflected by the measurement object when the difference between the elapsed times is within the predetermined time difference, and otherwise, the received light signal is another signal. It is determined that it is based on the light emitted from the distance measuring device.
  • the first arithmetic processing unit 703A determines whether the elapsed time until the light reception signal crosses the first light reception threshold Th1 and the time until the second light reception threshold Th2 crosses. Based on the elapsed time, distance measurement is performed using the pulse width correction described above. For example, in the case of FIGS. 10 and 11, the pulse width correction is performed based on the elapsed times T10 and T20 or the elapsed times T12 and T22.
  • the first arithmetic processing unit 703A does not perform the distance measurement. That is, in the examples of FIGS. 10 and 11, distance measurement is not performed on the light receiving signals Ps12 and Ps22. Thereby, it is possible to suppress the distance from being erroneously measured due to interference by the light emitted from another distance measuring device.
  • the distance measuring unit 703 determines the light receiving signal based on the shift of the light receiving timing of the light receiving signal obtained when the light projecting unit 83 emits the emitted light L1 at a plurality of scanning positions shifted by the predetermined rotation angle ⁇ in the same revolution. It is determined that it is based on the light reflected by the measurement object. Thereby, whether the received light signal is based on the light reflected from the object to be measured or the light emitted from another distance measuring device is determined, so that the light receiving signal is determined based on the light emitted from the other distance measuring device. Erroneous measurement of the distance can be suppressed.
  • the distance measurement unit 703 determines that the light reception signal is based on the light reflected by the measurement target when the evaluation value based on the shift in the light reception timing is within a predetermined time difference.
  • the first arithmetic processing unit 703A determines whether the difference between the elapsed times until the light reception signals obtained at the first and second scanning positions cross the second light reception threshold Th2 is within a predetermined time difference. You may.
  • the second scanning position is not limited to a position shifted from the first scanning position by a predetermined rotation angle ⁇ which is an interval for emitting the emission light L1, but is shifted from the first scanning position by twice the predetermined rotation angle ⁇ , for example. Or the like.
  • the predetermined time difference to be compared with the above-described shift of the light receiving timing can be set based on, for example, the following calculation formula.
  • the predetermined time difference is defined based on the following equation (1).
  • ⁇ Tth (((V1 + V2 ) ⁇ ⁇ t ⁇ + L err ⁇ 2) ⁇ 2) / c (1)
  • V1 the distance the moving speed of the moving body measuring device is mounted
  • V2 a predetermined value
  • ⁇ t ⁇ Measurement time interval corresponding to a predetermined rotation angle
  • L err maximum error of distance measurement
  • c speed of light
  • V1 is the moving speed of the moving object (automated guided vehicle 15) on which the distance measuring device 7 is mounted.
  • V2 is, for example, the moving speed of another automatic guided vehicle 150 shown in FIG.
  • the distance measuring device 7 receives the reflected light RL150 (FIG. 13) reflected by the automatic guided vehicle 150 from the output light L1 emitted from the distance measuring device 7, the distance measuring device 150 recognizes the automatic guided vehicle 150 as the measurement target. can do.
  • the distance measuring device 7 reflects the emitted light L1 emitted from the distance measuring device 7 by the worker 200.
  • the worker 200 can be recognized as a measurement target.
  • the shift of the light receiving timing is within 0.4006 ns, it is determined that the light receiving signal is based on the reflected light reflected by the measurement object, the emitted light L1 emitted from the distance measuring device 7.
  • the predetermined time difference can be appropriately defined in consideration of the distance measurement maximum error and the distance measurement maximum error.
  • FIG. 14 is a block diagram showing a second configuration example of the distance measurement unit 703.
  • the distance measuring unit 703 of this configuration example further includes a first comparator 703D and a second comparator 703E as a configuration difference from the first configuration example (FIG. 7).
  • the first comparator 703D compares the light receiving signal Ps input to the non-inverting input terminal (+) with the first threshold value Vth1 input to the inverting input terminal (-), and compares the comparison result with the first operation processing unit. 703A.
  • the second comparator 703E compares the light receiving signal Ps input to the inverting input terminal ( ⁇ ) with the second threshold value Vth2 input to the non-inverting input terminal (+), and compares the comparison result with the first arithmetic processing unit. 703A.
  • the second threshold value Vth2 is smaller than the first threshold value Vth1.
  • the distance measuring unit 703 of the second configuration example performs the processing shown in the flowchart of FIG. First, in step S1, the first arithmetic processing unit 703A determines whether the intensity of the light receiving signal Ps is equal to or greater than the first threshold value Vth1 based on the output level of the first comparator 703D. That is, if the output level of the first comparator 703D is High, the intensity of the light receiving signal Ps is equal to or higher than the first threshold Vth1, and if the output level is Low, the intensity of the light receiving signal Ps is lower than the first threshold Vth1.
  • the light receiving signal may be based on direct light emitted from another distance measuring device, and the process proceeds to step S2.
  • the first arithmetic processing unit 703A determines whether or not the above-described shift in light receiving timing (difference in elapsed time) is within a predetermined time difference. If the difference is within the predetermined time difference (Y in step S2), it is determined that the received light signal is based on the reflected light reflected by the measurement object, and the outgoing light L1 emitted from the distance measuring device 7 is not determined (step S2). N), it is determined that the light receiving signal is based on the direct light emitted from another distance measuring device.
  • step S1 if the intensity of the light receiving signal Ps is lower than the first threshold value Vth1 (N in step S1), the process proceeds to step S3, where the first arithmetic processing unit 703A performs the processing based on the output level of the second comparator 703E. It is determined whether the intensity of the light receiving signal Ps is equal to or greater than the second threshold value Vth1. That is, if the output level of the second comparator 703E is low, the intensity of the light receiving signal Ps is equal to or higher than the second threshold Vth2, and if the output level is high, the intensity of the light receiving signal Ps is lower than the second threshold Vth2.
  • the intensity of the light receiving signal Ps is equal to or greater than the second threshold value Vth2 (Y in step S3), it is determined that the light receiving signal is based on the reflected light reflected by the measurement target object, the emitted light L1 emitted from the distance measuring device 7. . Therefore, in this case, the first arithmetic processing unit 703A performs distance measurement based on the pulse width correction. Otherwise (N in step S3), it is determined that the received light signal is based on the reflected light reflected by the object, the emitted light emitted from another distance measuring device. Therefore, distance measurement is not performed in this case.
  • FIG. 16 is a waveform diagram illustrating an example of the light receiving signal Ps.
  • FIG. 16 shows a waveform with respect to an elapsed time from the timing at which the emission light L1 is emitted.
  • the light receiving signal Ps includes the light receiving signals Psx, Psy, and Psz.
  • the intensity of the light receiving signal Psx is equal to or more than the first threshold value Vth1.
  • the intensity of the light receiving signal Psy is lower than the first threshold value Vth1, but equal to or higher than the second threshold value Vth2.
  • the intensity of the light receiving signal Psz becomes lower than the second threshold value Vth2.
  • the process proceeds to a process of comparing a difference in light reception timing with a predetermined time difference, and if not, the light reception signal is reflected light by light emitted from another distance measuring device. May be determined.
  • the distance measurement unit 703 determines whether the received light signal is based on the light reflected by the measurement target. Accordingly, when the intensity of the received light signal is equal to or greater than the first threshold, the above determination is made because the received light signal may be based on light emitted from another distance measuring device. Otherwise, the above determination is not performed, so that the processing load can be reduced.
  • the distance measurement unit 703 makes a determination based on a comparison between a second threshold value smaller than the first threshold value and the intensity of the received light signal. If the intensity of the received light signal is smaller than the first threshold and equal to or greater than the second threshold, it is determined that the received light signal is based on the light reflected by the measurement target, and if the intensity of the received light signal is smaller than the second threshold, It is determined that the light receiving signal is based on the reflected light by the light emitted from another distance measuring device. Thereby, it is possible to appropriately determine the reflected light from the measurement target object and the reflected light due to the light emitted from another distance measuring device.
  • FIG. 17 is a schematic diagram showing an example of a configuration of a distance measuring device system configured by using a plurality of distance measuring devices according to the present embodiment.
  • the distance measurement device system 300 illustrated in FIG. 17 includes a distance measurement device group GR and a management device 250.
  • the distance measuring device group GR includes a first distance measuring device 7A and a second distance measuring device 7B.
  • the first distance measuring device 7A is mounted on the first automatic guided vehicle 15A.
  • the second distance measuring device 7B is mounted on the second automatic guided vehicle 15B.
  • the first distance measuring device 7A and the first automatic guided vehicle 15A are configured similarly to the distance measuring device 7 and the automatic guided vehicle 15 described above.
  • the second distance measuring device 7B and the second automatic guided vehicle 15B are configured similarly to the distance measuring device 7 and the automatic guided vehicle 15 described above.
  • the first distance measurement device 7A receives the rotation speed command CM1 from the management device 250, and sets the first rotation speed of the rotation scanning.
  • the second distance measurement device 7B receives the rotation speed command CM2 from the management device 250, and sets the second rotation speed of the rotation scanning.
  • the first rotation speed and the second rotation speed are set to different values.
  • the rotation speed command is received by the distance measurement devices 7A and 7B via, for example, the communication unit T (FIG. 6) of the automatic guided vehicles 15A and 15B.
  • the first rotation speed is set to 2400 rpm and the second rotation speed is set to 2401 rpm
  • the predetermined rotation angle ⁇ of the rotation scanning in the distance measuring devices 7A and 7B is set to 0. 125 °.
  • the time interval corresponding to the predetermined rotation angle ⁇ is 8.6806 ⁇ S in the first distance measuring device 7A, and 8.6679 ⁇ S in the second distance measuring device 7B.
  • FIG. 18 shows the light receiving signal Ps1 when the emitted light L1 is emitted at the first scanning position in the first distance measuring device 7A, and the second received light signal Ps1 shifted from the first scanning position by the predetermined rotation angle ⁇ in the same revolution.
  • FIG. 7 is a waveform diagram in which a light receiving signal Ps2 when emitting outgoing light L1 at a scanning position is superimposed. That is, FIG. 18 is a diagram corresponding to FIG. 12 described above.
  • the light receiving signal Ps1 includes the light receiving signal Ps12 by the direct light DL2 from the second distance measuring device 7B.
  • the first arithmetic processing unit 703A in the first distance measuring device 7A determines that ⁇ T is not within the predetermined time difference, and determines that the received light signal is not based on the reflected light from the measurement target. That is, in the distance measuring device group GR, by setting the rotation speed of the rotational scanning to be intentionally different, direct light due to light emitted from the second distance measuring device 7B is continuously emitted in the first distance measuring device 7A. In this way, erroneous distance measurement based on the direct light DL2 from the second distance measuring device 7B can be avoided by preventing light from being received at the same timing.
  • the first arithmetic processing unit 703A in the second distance measurement device 7B determines that ⁇ T is not within the predetermined time difference, and it is possible to avoid an erroneous distance measurement based on the direct light DL1 from the first distance measurement device 7A.
  • the method of setting the rotation speed for each distance measuring device in the distance measuring device group may be set independently for each distance measuring device without using the management device 250.
  • the distance measuring device group GR is a distance measuring device group including the first distance measuring device 7A and the second distance measuring device 7B.
  • the first distance measuring device 7A and the second distance measuring device 7B include a light emitting unit 83 that includes a light emitting unit 701 and performs rotation scanning of the emitted light L1, a light receiving unit 702 that outputs a light receiving signal based on light reception, and a light emitting unit 702.
  • a distance measuring unit 703 that measures a distance to a measurement target based on emission of the emitted light L1 and light reception by the light receiving unit 702.
  • the first distance measurement device 7A is a distance measurement device having the above-described configuration, and includes a first rotation speed of the rotation scan by the first distance measurement device 7A, a second rotation speed of the rotation scan by the second distance measurement device 7B, Is different.
  • the first distance measuring device 7A prevents direct light from light emitted from the second distance measuring device 7B from being continuously received at the same timing, and is based on the direct light from the second distance measuring device 7B. Incorrect distance measurement can be avoided.
  • the distance measuring unit 703 of the second distance measuring device 7B is configured to detect the shift of the light receiving timing of the light receiving signal obtained when the light projecting unit 83 emits the emitted light L1 at a plurality of scanning positions shifted by a predetermined rotation angle in the same rotation. , It is determined that the light receiving signal is based on the light reflected by the measurement object. This can prevent the second distance measuring device 7B from erroneously measuring the distance based on the direct light from the first distance measuring device 7A.
  • the distance measurement device system 300 includes a distance measurement device group GR and a management device 250, and the first rotation speed and the second rotation speed are based on a command from the management device 250. This makes it easy to set the rotation speed for a plurality of distance measuring devices.
  • the determination may be made based on the light receiving signal obtained when emitting L1. More specifically, the average value of the light receiving timing deviation between the first scanning position and the second scanning position and the light receiving timing deviation between the second scanning position and the third scanning position is calculated as an evaluation value. It is determined whether the evaluated value is within a predetermined time difference.
  • an unmanned carrier is described as an example of a moving object equipped with a distance measuring device.
  • the present invention is not limited to this, and the moving object is applicable to a device other than a transportation purpose, such as a cleaning robot or a monitoring robot. May be.
  • This invention can be utilized for the automatic guided vehicle which conveys a load, for example.

Landscapes

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

Abstract

L'objectif de la présente invention est de proposer un dispositif de mesure de distance grâce auquel il est possible de supprimer des mesures erronées de distance qui résultent de l'interférence d'autres dispositifs de mesure de distance. Ce dispositif de mesure de distance est pourvu d'une unité de projection de lumière (83) qui comprend une unité luminescente (701) et qui effectue un balayage en révolution de lumière émise, une unité de réception de lumière (702) qui produit en sortie un signal de réception de lumière sur la base de la réception de lumière, et une unité de mesure de distance (703) qui mesure la distance jusqu'à un objet en train d'être mesuré (OJ) sur la base de l'émission de la lumière émise et de la réception de lumière par l'unité de réception de lumière (702). Dans ladite invention, sur la base d'un décalage entre les instants de réception de lumière des signaux de réception de lumière obtenus lorsque l'unité de projection de lumière (83) émet la lumière émise dans une pluralité de positions de balayage décalées par un angle prescrit de rotation dans la même révolution, l'unité de mesure de distance (703) détermine que les signaux de réception de lumière sont fondés sur de la lumière réfléchie par l'objet en train d'être mesuré (OJ).
PCT/JP2019/033542 2018-08-29 2019-08-27 Dispositif de mesure de distance, groupe de dispositifs de mesure de distance et système de dispositif de mesure de distance WO2020045445A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018160011 2018-08-29
JP2018-160011 2018-08-29

Publications (1)

Publication Number Publication Date
WO2020045445A1 true WO2020045445A1 (fr) 2020-03-05

Family

ID=69644354

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/033542 WO2020045445A1 (fr) 2018-08-29 2019-08-27 Dispositif de mesure de distance, groupe de dispositifs de mesure de distance et système de dispositif de mesure de distance

Country Status (1)

Country Link
WO (1) WO2020045445A1 (fr)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20210270600A1 (en) * 2020-02-27 2021-09-02 Kabushiki Kaisha Toshiba System and method

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007225342A (ja) * 2006-02-21 2007-09-06 Toyota Motor Corp ３次元測定装置及び３次元測定装置を搭載した自律移動装置
JP2008070270A (ja) * 2006-09-14 2008-03-27 Hokuyo Automatic Co 測距装置
JP2014181993A (ja) * 2013-03-19 2014-09-29 Denso Wave Inc セキュリティ装置
JP2015055488A (ja) * 2013-09-10 2015-03-23 株式会社デンソーウェーブ セキュリティ装置
US9810775B1 (en) * 2017-03-16 2017-11-07 Luminar Technologies, Inc. Q-switched laser for LIDAR system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007225342A (ja) * 2006-02-21 2007-09-06 Toyota Motor Corp ３次元測定装置及び３次元測定装置を搭載した自律移動装置
JP2008070270A (ja) * 2006-09-14 2008-03-27 Hokuyo Automatic Co 測距装置
JP2014181993A (ja) * 2013-03-19 2014-09-29 Denso Wave Inc セキュリティ装置
JP2015055488A (ja) * 2013-09-10 2015-03-23 株式会社デンソーウェーブ セキュリティ装置
US9810775B1 (en) * 2017-03-16 2017-11-07 Luminar Technologies, Inc. Q-switched laser for LIDAR system

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20210270600A1 (en) * 2020-02-27 2021-09-02 Kabushiki Kaisha Toshiba System and method

Similar Documents

Publication Publication Date Title
US5717484A (en) Position detecting system
US20160170412A1 (en) Autonomous mobile device and method for controlling same
TWI684084B (zh) 移動裝置
JPWO2019064750A1 (ja) 距離測定装置、および移動体
JP6464410B2 (ja) 障害物判定装置および障害物判定方法
WO2020071465A1 (fr) Dispositif de mesure de distance
JP5765694B2 (ja) 測距方法及び車載測距装置
JP2006338580A (ja) 移動ロボットの位置制御システムと位置制御方法
WO2018173595A1 (fr) Dispositif de déplacement
WO2020045445A1 (fr) Dispositif de mesure de distance, groupe de dispositifs de mesure de distance et système de dispositif de mesure de distance
JP2017026535A (ja) 障害物判定装置及び障害物判定方法
KR102595870B1 (ko) 초소형 라이다 센서
WO2020195333A1 (fr) Circuit de mesure de distance, dispositif de télémétrie et corps mobile
KR20180023608A (ko) 무인 운반차의 운행 시스템
JP2017204062A (ja) 自律搬送システム
JP2017032329A (ja) 障害物判定装置、移動体、及び障害物判定方法
WO2018173594A1 (fr) Dispositif de mesure de distance et véhicule de transport
US20230135740A1 (en) Distance measurement device, and mounting orientation sensing method and mounting orientation sensing program for same
WO2020045474A1 (fr) Unité à capteur et corps mobile
US20230139369A1 (en) Micro-lidar sensor
WO2019058678A1 (fr) Dispositif de mesure de distance et corps mobile équipé de celui-ci
US20230225580A1 (en) Robot cleaner and robot cleaner control method
WO2019181691A1 (fr) Dispositif de mesure de distance et corps mouvant
WO2019181692A1 (fr) Dispositif de mesure de distance et corps mobile
WO2019146440A1 (fr) Dispositif de mesure de distance et corps mobile

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

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19855621

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: JP