This application claims the benefits of Taiwan application Serial No. 107115269, filed May 4, 2018 and Taiwan application Serial No. 107125382, filed Jul. 23, 2018, the disclosures of which are incorporated by reference herein in its entirety.
The disclosure relates to a laser positioning system and a position measuring method using this system, and more particularly to a laser positioning system for enhancing laser positioning accuracy and a position measuring method using this system.
With evolving eras, a new industrial manufacturing mode has transformed from mass production to flexible manufacturing in small amounts and diversity, hence requiring frequent changes in production lines and automated carrier systems with flexibilities. An automated Guided Vehicle (AGV) is an essential carrier in automated material transportation, and features advantages of occupying minimal space and production lines that can be flexibility adjusted. From the aspect of techniques, the object of positioning is accomplished by means of laser, magnetic columns and two-dimensional barcode tags. Among various techniques, laser map comparison and guiding method has an immense advantage. The positioning calculation of the laser map comparison and guiding method can be divided into two parts: calculation of global positioning in an entire environment, and calculation of fine positioning by using landmark features. Currently, only the contour of the landmark is used for positioning calculation. However, because the signal of a laser scanner includes noise and the noise is also generated when laser reaches edges of the landmark, achieving positioning having position accuracy under a millimeter scale can be quite challenging.
The disclosure is directed to a laser positioning system and a position measuring method using the same, in which positioning tags serving as positioning auxiliary labels are attached on a laser positioning board, and relative positions and distances of a laser scanner and a positioning board are calculated.
According to an aspect of the disclosure, a laser positioning system for positioning a mobile carrier is provided. The laser positioning system includes a positioning board, a laser scanner, a first positioning tag, a second positioning tag and a processing unit. The laser scanner is disposed on the mobile carrier, and is for emitting a light beam to the positioning board and receiving a plurality of reflected light spot signals generated by the light beam reflected from the positioning board when the laser scanner scans from a first region of the positioning board to a second region of the positioning board. The first positioning tag is disposed in the first region of the positioning board, and is for reflecting the light beam to generate a first positioning signal to the laser scanner. The second positioning tag is disposed in the second region of the positioning board, and is for reflecting the light beam to generate a second positioning signal to the laser scanner. The processing unit is for finding information of a position of the light beam projected on the first positioning tag and information of a position of the light beam projected on the second positioning tag, and filtering the light spot signals to define a reference coordinate, for the processing unit to calculate relative positions of the laser scanner and the positioning board according to the reference coordinate.
According to an aspect of the disclosure, a position measuring method for positioning a mobile carrier is provided. The mobile carrier is provided with a laser scanner. The position measuring method includes the following steps. The laser scanner projects a light beam on a first positioning tag, a positioning board and a second positioning tag to correspondingly generate a first positioning signal, a plurality of reflected light spot signals and a second positioning signal. The first positioning tag and the second positioning tag are disposed on two opposite regions of the positioning board. A processing unit finds information of positions of the light beam projected on the first positioning tag and the second positioning tag, and filters these reflected light spot signals to define a reference coordinate for the processing unit to calculate relative position of the laser scanner and the positioning board according to the reference coordinate.
To better understand the above and other aspects of the disclosure, embodiments are given in detail with the accompanying drawings below.
Detailed descriptions of the invention are disclosed below with a number of embodiments. However, the disclosed embodiments are for explanatory and exemplary purposes only, not for limiting the scope of protection of the invention. Similar/identical designations are used to indicate similar/identical elements.
A laser positioning system for positioning a mobile carrier is provided according to an embodiment. The mobile carrier is, for example, an unmanned transportation vehicle, an unmanned aircraft, a self-propelled robot or an unmanned transportation device. With the laser positioning system of the embodiment, the distance or coordinates of a mobile carrier relative to a target can be accurately measured when the mobile carrier moves on the ground or within a factory, or is airborne in a three-dimensional space, so as to ensure that the mobile carrier can automatically move to a work station or stop on a location point.
Referring to
As described above, in a specific region of the positioning board 110, for example, in edges near the first region S1 and the second region S2 of the positioning board 110, light-reflecting tag or stickers that are capable of reflecting light beam or enhance the intensity of a reflected light signal are attached to serve as the first positioning tag 122 and the second positioning tag 124 in the laser positioning system 100 of the embodiment. Alternatively, light-absorbing tags or stickers capable of absorbing light beam or weakening the intensity of a reflected light signal are attached to specific regions of the positioning board 110 to serve as the first positioning tag 122 and the second positioning tag 124. Thus, the laser positioning system 100 can determine whether the light beam L is projected on the first positioning tag 122 and the second positioning tag 124 according to the intensity of reflected light signal.
In one embodiment, by measuring the intensity of the reflected light signal, the light intensities of the first positioning signal B1 and the second positioning signals B2 are greater than the light intensity of the reflected light spot signals B3 (e.g., greater than twice of the light intensity of the reflected light spot signals B3), or smaller than the light intensity of the reflected light spot signals B3 (e.g., smaller than one-half of the light intensity of the reflected light spot signals B3), such that the laser positioning system 100 can be clearly find the positions of the light beam L projected on the first positioning tag 122 and the second positioning tag 124 and positions of reflected light spots of the light beam L projected on the positioning board 110.
Referring to
The reflected light spot signals B3 represent the position of the light beam L projected on the positioning board 110. By calculating the flight time and the angle of light beam L, the distances and angles of the laser scanner 120 relative to reflected light spots on the positioning board 110 can be roughly estimated. If the first positioning tag 122 and the second positioning tag 124 are not disposed on the positioning board 110, and the distances and the angles of the laser scanner 120 relative to the reflected light spots on the positioning board 110 are estimated only according to the reflected light spot signals B3, because noise signals are likely generated at the edges of the positioning board when the reflected light spots are generated near the first region S1 and the second region S2, accurate positioning cannot be achieved. In the laser positioning system 100 of the embodiment, the first positioning tag 122 and the second positioning tag 124 are disposed on the positioning board 110 to serve as auxiliary positioning labels, such that noise signals that generates at edge regions can be filtered out and the reflected light spot signals B3 within the specific regions R can be identified, thereby enhancing laser positioning accuracy.
Referring to
That is to say, the processing unit 130 is capable of removing noise signals on the outer regions of the first positioning tag 122 and the second positioning tag 124, and capturing only the reflected light spot signals B3 between the first positioning tag 122 and the second positioning tag 124 to define a regression line L1. In one embodiment, the calculating element 136 defines the regression line L according to a least square function of the reflected light spot signals B3 within the interval R. In the embodiment, a linear regression of least square method is adopted to find an equation of the regression line L1 most appropriately representing the reflected light spot signals B3, with the definitions as below:
Standard deviation of variable X:
where
Standard deviation of variable Y:
where
Correlation coefficient of variables X and Y:
and
Equation of the regression line L1:
Referring to
The laser scanner 120 is not limited to being a two-dimensional scanner that generates one single scanning beam H. In another embodiment, the laser scanner 120 may also be a three-dimensional scanner that generates multiple scanning beams H or a three-dimensional scanner consisting of at least two two-dimensional scanners. Referring to
Referring to
The plane equation is multiplied by the transpose matrix on the left to serve as a linear least square:
After organizing the above, an equation below is obtained:
Thus, the three coefficients a, b and c can be obtained.
Once having solved the plane equation, the processing unit 130 determines, according to the position information of the positioning tags, the angles of the laser beam L projected on the two opposite regions of the plane, generates two rays (i.e., the first line L2 and the second line L3) regarding the laser emitting center as an origin, and obtains two intersections at which the two rays intersect with the positions of the positioning tags on the previously solved plane equation. By retrieving three or more of the above intersections, a reference coordinate can be defined, for the processing unit 130 to calculate the relative positions of the laser scanner 120 and the positioning board 110.
A position measuring method for enhancing laser positioning accuracy is provided according to the embodiment in
In step S11, a light beam L is projected on the first positioning tag 122, the positioning board 120 and the second positioning tag 124 to correspondingly generate a first positioning signal B1, multiple reflected light spot signals B3 and a second positioning signal B2.
In step S12, position information of the light beam L projected on the first positioning tag 122 and position information of the light beam L projected on the second positioning tag 124 are found according to light intensities of light reflection signals.
In step S13, the reflected light spot signals B3 are filtered according to the position information of the light beam L projected on the first positioning tag 122 and the position information of the light beam L projected on the second positioning tag 124, so as to capture the reflected light spot signals B3 within an interval R between the first positioning tag 122 and the second positioning tag 124.
In step S14, a regression line L1 is defined according to a least square function of the reflected light spot signals B3 within the interval R.
In step S15, a first line L2 connecting the first positioning tag 122 and the emitting center position 121 of the laser scanner 120 is determined according to the position information of the first positioning tag 122, and a first intersection C1 is obtained by intersecting the first line L2 with the regression line L1.
In step S16, a second line L3 connecting the second positioning tag 124 and the emitting center position 121 of the laser scanner 120 is determined according to the position information of the second positioning tag 124, and a second intersection C2 is obtained by intersecting the second line L3 with the regression line L1.
In step S17, an intermediate point O of the first intersection C1 and the second intersection C2 is used as an origin of a coordinate axis, and relative positions of the laser scanner 120 and the positioning board 110 are calculated.
Another position measuring method for enhancing laser positioning accuracy is provided according to the embodiment in
The positioning board 110 is not limited to being a flat plate. In another embodiment, the positioning board 110 may have a specific shape, such as a V-shape, a W-shape (a zigzag shape), a trapezoid, a semicircle, an arc or a corrugated shape. In one embodiment, the processing unit 130 adopts a point cloud matching algorithm to identify a set of point cloud matching the surface shape of the positioning board 110, and thus the positioning board 110 may be any desired shape.
Referring to
A position measuring method 102 for enhancing laser positioning accuracy is provided according to the embodiment in
In step S21, a light beam L is projected on the first positioning tag 122, the positioning board 110′ and the second positioning tag 124 to correspondingly generate a first positioning signal B1, multiple reflected light spot signals B3 and a second positioning signal B2.
In step S22, position information of the light beam L projected on the first positioning tag 122 and position information of the light beam L projected on the second positioning tag 124 are found according to light intensities of light reflection signals.
In step S23, the reflected light dot signals B3 are filtered according to the position information of the first positioning tag 122 and the second positioning tag 124 to capture the reflected light spot signals B3 within an interval R between the first positioning tag 122 and the second positioning tag 124.
In step S24, a set of matching point cloud is determined according to the reflected light spot signals B3 within the interval R to define a reference coordinate of the positioning board 110, so as to calculate the relative positions of the laser scanner 120 and the positioning board 110.
Referring to
In the laser positioning system and the position measuring method using the same disclosed by the above embodiments, positioning tags serving as positioning auxiliary labels are attached on a laser positioning board, and relative positions or relative distances of a laser scanner and a positioning board are calculated through an algorithm, thereby enhancing laser positioning accuracy.
It will be apparent to those skilled in the art that various modifications and variations can be made to the disclosed embodiments. It is intended that the specification and examples be considered as exemplary only, with a true scope of the disclosure being indicated by the following claims and their equivalents.
Number | Date | Country | Kind |
---|---|---|---|
107115269 A | May 2018 | TW | national |
107125382 A | Jul 2018 | TW | national |
Number | Name | Date | Kind |
---|---|---|---|
4846297 | Field et al. | Jul 1989 | A |
5039217 | Maekawa | Aug 1991 | A |
5118191 | Hopkins | Jun 1992 | A |
5204731 | Tanaka | Apr 1993 | A |
5313262 | Leonard | May 1994 | A |
6675122 | Markendorf | Jan 2004 | B1 |
6697147 | Ko et al. | Feb 2004 | B2 |
7436522 | Steinbichler | Oct 2008 | B2 |
7460250 | Keightley | Dec 2008 | B2 |
7728963 | Kirschner | Jun 2010 | B2 |
7913405 | Berg | Mar 2011 | B2 |
8567076 | Ortleb | Oct 2013 | B2 |
8681317 | Moser | Mar 2014 | B2 |
9322654 | Bockem | Apr 2016 | B2 |
9395296 | Milton et al. | Jul 2016 | B1 |
9400175 | Luthi | Jul 2016 | B2 |
9443311 | Hallett | Sep 2016 | B2 |
9561019 | Mihailescu | Feb 2017 | B2 |
9612331 | Kwiatkowski | Apr 2017 | B2 |
9686532 | Tohme | Jun 2017 | B2 |
9739616 | Wang et al. | Aug 2017 | B2 |
10048379 | Markendorf | Aug 2018 | B2 |
10162058 | Shaffer | Dec 2018 | B2 |
10261183 | Smits | Apr 2019 | B2 |
10408604 | Ebrahimi Afrouzi | Sep 2019 | B1 |
20100157280 | Kusevic | Jun 2010 | A1 |
20100164807 | Tseng | Jul 2010 | A1 |
20110142138 | Tian et al. | Jun 2011 | A1 |
20140373369 | Böckem | Dec 2014 | A1 |
20160252619 | Markendorf | Sep 2016 | A1 |
20190265721 | Troy | Aug 2019 | A1 |
Number | Date | Country |
---|---|---|
102818568 | Dec 2012 | CN |
103645733 | Mar 2014 | CN |
104950892 | Sep 2015 | CN |
104102222 | Mar 2017 | CN |
104750115 | Mar 2017 | CN |
370186 | Sep 1999 | TW |
200742600 | Nov 2007 | TW |
201044322 | Dec 2010 | TW |
201738986 | Nov 2017 | TW |
Entry |
---|
Taiwanese Office Action and Search Report dated Dec. 11, 2018 for Application No. 107125382. |
Govindarajan et al., “Target Design and Recognition for 2-D Localization of Indoor Mobile Robots Using a Laser Sensor”, 6th IFAC Symposium on Mechatronic Systems, The International Federation of Automatic Control, Apr. 10-12, 2013, Hangzhou, China, pp. 67-74. |
Nguyen et al., “A Comparison of Line Extraction Algorithms using 2D Laser Rangefinder for Indoor Mobile Robotics”, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems, Date of Conference: Aug. 2-6, 2005, total 6 pages. |
Zhang, “Iterative Point Matching for Registration of Free-Form Curves and Surfaces”, International Journal of Computer Vision, 1994, vol. 13, No. 2, pp. 119-152. |
Number | Date | Country | |
---|---|---|---|
20190339363 A1 | Nov 2019 | US |