CN112815944B - Laser reflector positioning method based on corner joint characteristic structure - Google Patents

Laser reflector positioning method based on corner joint characteristic structure Download PDF

Info

Publication number
CN112815944B
CN112815944B CN202011625754.8A CN202011625754A CN112815944B CN 112815944 B CN112815944 B CN 112815944B CN 202011625754 A CN202011625754 A CN 202011625754A CN 112815944 B CN112815944 B CN 112815944B
Authority
CN
China
Prior art keywords
reflector
matching
laser
data
characteristic
Prior art date
Legal status (The legal status 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 status listed.)
Active
Application number
CN202011625754.8A
Other languages
Chinese (zh)
Other versions
CN112815944A (en
Inventor
徐冬云
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen Ego Robotics Co ltd
Original Assignee
Shenzhen Ego Robotics Co ltd
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 Shenzhen Ego Robotics Co ltd filed Critical Shenzhen Ego Robotics Co ltd
Priority to CN202011625754.8A priority Critical patent/CN112815944B/en
Publication of CN112815944A publication Critical patent/CN112815944A/en
Application granted granted Critical
Publication of CN112815944B publication Critical patent/CN112815944B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
    • G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser

Abstract

The application discloses a laser reflector positioning method based on corner joint feature structures, which comprises the steps of processing laser reflector data, extracting and generating a corner feature structure set of each reflector, matching the reflectors in laser with the reflectors on a map one by one through a corner feature matching method, judging whether matching is successful according to a set matching threshold value, and sequencing matched point sets from top to bottom according to matching results. And then, carrying out pairing uniqueness detection on the sequencing result of the obtained reflector plate pairing point set, removing the pairing of the reflector plates which participate repeatedly, and taking the optimal front three groups of reflector plate pairing points as data for carrying out geometric matching next. And finally, accurately transforming and positioning the initial estimated pose of the laser sensor into an accurate pose on the map by using the three groups of acquired one-to-one corresponding laser reflectors and the map reference landmark two-dimensional coordinates through plane coordinate transformation, and finishing the accurate positioning of the reflectors.

Description

Laser reflector positioning method based on corner joint characteristic structure
Technical Field
The application relates to a positioning method, in particular to a laser reflector positioning method based on a corner joint characteristic structural body.
Background
With the continuous application of Automatic Guided Vehicles (AGVs) in the industries of automatic production, transportation, storage and logistics and the like of the whole factory, the navigation technology of the AGVs is more and more important. The navigation technology applied in the current AGV mainly comprises magnetic navigation, laser navigation, visual navigation and the like, wherein the laser navigation is taken as a navigation technical scheme which is rapidly popularized in recent years, and the AGV navigation mode gradually becomes the current mainstream popularization AGV navigation mode due to the advantages of low high-precision characteristics, low requirement on the transformation degree of the environment, convenience in construction compared with the magnetic navigation, stability and precision reliability compared with the current visual navigation and the like.
The laser navigation technology mainly applied at present includes pure natural contour navigation (slam), laser reflector navigation and hybrid navigation (the pure natural slam and the reflector are used in a hybrid way). The vehicle position is positioned by constructing an environment map through pure natural navigation and using laser contour matching, the environment does not need to be transformed, the vehicle position is convenient, but the environment is easy to change or the position with a plurality of moving objects is easy to cause the unstable problem of positioning error increase or failure, and the laser reflector navigation mode adds an artificial fixed landmark through the mode of installing an artificial laser reflector in the working environment, so that the navigation stability and the positioning precision are improved when the environment is changed, and the vehicle position is widely adopted in the industrial manufacturing high-precision occasions at present.
Most of the current laser reflector navigation is based on field continuous search or based on side length characteristics between reflectors to realize data association between reflector data in laser scanning of a laser sensor and reflector data in a map, and then pose solving is carried out. However, reflector data association realized based on a continuous domain search mode needs to ensure accurate estimation of the initial pose of the AGV, and reflector data association based on reflector side length characteristics has high requirements on unequal constraint of side lengths arranged between reflectors, and in some occasions, incorrect matching is easily caused due to excessively uniform reflector arrangement, so that positioning navigation fails. Therefore, a laser reflector positioning method based on the corner joint feature structure is provided to solve the above problems.
Disclosure of Invention
A laser reflector positioning method based on corner joint characteristic structure bodies comprises the following steps;
step 1 Reflector data set Q on a known reference mapm{(xm0，ym0)，(xm1，ym1)，...，(xmn，ymn) And the corresponding pre-generated feature set F of the bafflemReflector data set Q extracted by real-time scanning laserr{(xr0，yr0)，(xr1，yr1)，...，(xrk，yrk) And for each reflector data, generating a reflector characteristic structure FeatureMark by combining the distance and mutual angle relationship among reflectors in the data set, and further obtaining a reflector characteristic structure set F corresponding to the laser scanning reflector data setrSample laser data contains the approximate estimated position (x) of the laser sensorini，yini，thetaini) And reflecting plate point set Qr{(xr0，yr0)，(xr1，yr1)，(xr2，yr2)，(xr3，yr3) For each of the reflecting plates, reflecting plate r0By using r0Distance versus angle relationships to other reflectors in the same laser data can generate a plurality of corner edge feature cells, where edge1 is denoted by r0To r1Edge2 (containing the edge length and the connection point ID), denoted by r0To r2The angle represents the angle between two edges, and for a single reflector with n neighboring reflectors, n x (n-1)/2 edge-corner feature cells, such as r, can be generated0Finally, the characteristic structure r of the reflector plate can be generated0Including 3 corner edge feature units, for other reflectors (r) in the laser data1，r2，r3) By performing the same operation, a reflector characteristic structure set F corresponding to the laser reflector data can be obtainedr{fr0，fr1，fr2，fr3}, baffle data QmThe characteristic structural body set F of the reflecting plate is obtained by the pretreatment of the processm{fm0，fm1，fm2，fm3，fm4}；
Step 2, processing the data of the laser reflector in the step 1 to obtain a characteristic structural body set F of the laser real-time scanning reflectorr{fr0，fr1，fr2，fr3Reflector feature structure set F obtained by preprocessing with reference mapm{fm0，fm1，fm2，fm3，fm4Performing matching operation of a feature structure FeatureMark, pushing the matching result into a reflecting plate feature structure matching pair set M to be processedmpThe matching between the reflecting plate characteristic structural bodies is to compare the edge and corner characteristic units in the reflecting plate characteristic structural bodies one by one, calculate the difference value, and count the number of qualified matched edge and corner characteristic units and the average matching error thereof. The matching calculation process of the edge and corner feature units is as follows:
firstly, calculating the angle difference of two corner edge characteristic units, and if the difference is at a set threshold value daWithin the range, carrying out next step of matching side length difference values, and if the side length difference values existAnd (3) under the condition that the side length difference values of the two sides are within the range of the set threshold value eT (if the two sides are matched and combined, the difference values are small), the characteristic units of the two sides and the corners are considered to be correspondingly equal, and the matching error is recorded. When two reflector feature structures are matched, edge and corner feature units contained in the two reflector feature structures are matched one by one according to the method, the successfully matched units are paired, and sequencing is carried out from small to large according to the average error. Because when matching, a situation that a single edge feature unit has a plurality of objects successfully matched occurs, at this time, we perform unique screening on an object group including a repeated matching unit according to the previous sequence from small arrival, retain an optimal result, and then calculate the number suc _ eAe _ sum of successfully matched edge feature units and the average error average _ error of matching of a plurality of edge feature units to count a reflector feature structure matching pair structure (the reflector feature structure matching pair structure is shown in fig. 4);
step 3, for the reflector plate characteristic structural body matching pair set M finally obtained in the step 2mpSorting MatchPair scores from top to bottom according to each matching pair, wherein the scoring mode is that the number of edge characteristic units successfully matched in a matching pair is large with high score suc _ eAe _ sum, the number of suc _ eAe _ sum is the same, the value of an average matching error average _ error is compared, the smaller the average _ error value is, the higher the score is, the situation that a plurality of other objects matched with the same reflector characteristic structure body possibly exist in a matching pair set, at this time, an optimal unique matching pair is sorted and reserved according to the score sorting, the sorting result of the matching pairs of sample laser scanning reflector data and reference map landmark data is obtained, two pairs of repeated pairs exist, and a set M comprising four pairs of matching pairs is reserved after screening and deletionmp{(fr1，fm2)，(fr2，fm4)，(fr0，fm1)，(fr3，fm0)}；
Step 4, through the acquired set M of matching pairsmpReflector match point pairs with one-to-one correspondence of laser data to map landmarks, e.g., from Mmp{(fr1，fm2)，(fr2，fm4)，(fr0，fm1)，(fr3，fm0) Get the matching point pair of the sample in }
Figure BDA0002879219100000041
After the one-to-one corresponding accurate matching point pairs are obtained, considering that the position between the actually arranged map landmarks and the reflecting plate in the laser scanning data can be regarded as a connected and fixed rigid body structure, the angle difference of the attitude angle of the connecting vector formed between every two laser reflecting plate data in a laser coordinate system and the vector attitude angle formed by connecting the corresponding landmarks in the map coordinate system is the rotation angle of the two point sets, and the difference of the centroid coordinates of the point sets after rotation is the translation amount of the two point sets, so that the coordinate transformation relation between the two point sets can be obtained. There will be a set Q of (n +1) pairs of matching pointsmpIs shown as
Figure BDA0002879219100000042
The rotation angle theta of the point set transformation can be obtained by formula (1), and then the translation amount is obtained
Figure BDA0002879219100000043
Can be obtained from formula (2) and formula (3);
Figure BDA0002879219100000044
Figure BDA0002879219100000045
Figure BDA0002879219100000046
step 5, the initial pose (x) of the laser sensor is determinedini，yini，thetaini) Through the obtained rotation translation amount between the laser scanning reflector data and the map landmark
Figure BDA0002879219100000051
Coordinate transformation is carried out according to the formula (4), and accurate map positioning pose (x) can be obtainedc，yc，thetac) The effect of the rotational translation is shown in fig. 6.
The beneficial effect of this application is: the invention provides a laser reflector positioning method based on a corner joint characteristic structural body, which realizes one-to-one correspondence between a real-time laser scanning reflector and a map reference reflector through matching of corner characteristic structural bodies, and further performs geometric matching to obtain an accurate current real-time pose of a robot. Compared with the original reflector matching method based on pure contour matching or only edge features, the method increases the angle features, has stronger stability and accuracy due to the multi-dimensional features, improves the reliability of reflector registration, can realize global positioning in a larger map range, and simultaneously strengthens the anti-interference performance on noise.
Drawings
In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings needed to be used in the description of the embodiments or the prior art will be briefly introduced below, and it is obvious that the drawings in the following description are only some embodiments of the present application, and it is obvious for those skilled in the art that other drawings can be obtained according to the drawings without inventive exercise.
FIG. 1 is a schematic diagram of a reflector feature structure extracted from laser scanning data according to the present application;
FIG. 2 is a schematic diagram of map data referenced in the present application;
FIG. 3 is a schematic diagram illustrating edge feature unit matching according to the present application;
FIG. 4 is a schematic diagram of a matching pair of characteristic structures of the reflecting plate of this application;
FIG. 5 is a schematic diagram illustrating sorting and screening of matching pairs of laser scanning reflector data and reference map landmark data according to the present application;
fig. 6 is a schematic diagram illustrating the matching effect of the laser reflector data and the map after the present rotational translation.
Detailed Description
In order to make the technical solutions better understood by those skilled in the art, the technical solutions in the embodiments of the present application will be clearly and completely described below with reference to the drawings in the embodiments of the present application, and it is obvious that the described embodiments are only partial embodiments of the present application, but not all embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present application.
It should be noted that the terms "first," "second," and the like in the description and claims of this application and in the drawings described above are used for distinguishing between similar elements and not necessarily for describing a particular sequential or chronological order. It should be understood that the data so used may be interchanged under appropriate circumstances such that embodiments of the application described herein may be used. Furthermore, the terms "comprises," "comprising," and "having," and any variations thereof, are intended to cover a non-exclusive inclusion, such that a process, method, system, article, or apparatus that comprises a list of steps or elements is not necessarily limited to those steps or elements expressly listed, but may include other steps or elements not expressly listed or inherent to such process, method, article, or apparatus.
In this application, the terms "upper", "lower", "left", "right", "front", "rear", "top", "bottom", "inner", "outer", "middle", "vertical", "horizontal", "lateral", "longitudinal", and the like indicate orientations or positional relationships based on the orientations or positional relationships shown in the drawings. These terms are used primarily to better describe the present application and its embodiments, and are not used to limit the indicated devices, elements or components to a particular orientation or to be constructed and operated in a particular orientation.
Moreover, some of the above terms may be used to indicate other meanings besides the orientation or positional relationship, for example, the term "on" may also be used to indicate some kind of attachment or connection relationship in some cases. The specific meaning of these terms in this application will be understood by those of ordinary skill in the art as appropriate.
Furthermore, the terms "mounted," "disposed," "provided," "connected," and "sleeved" are to be construed broadly. For example, it may be a fixed connection, a removable connection, or a unitary construction; can be a mechanical connection, or an electrical connection; may be directly connected, or indirectly connected through intervening media, or may be in internal communication between two devices, elements or components. The specific meaning of the above terms in the present application can be understood by those of ordinary skill in the art as the case may be.
It should be noted that the embodiments and features of the embodiments in the present application may be combined with each other without conflict. The present application will be described in detail below with reference to the accompanying drawings in conjunction with embodiments.
Referring to fig. 1-6, a method for positioning a laser reflector based on a corner combining feature structure includes the following steps:
step 1 Reflector data set Q on a known reference mapm{(xm0，ym0)，(xm1，ym1)，...，(xmn，ymn) And a corresponding pre-generated feature structure set F of the reflectormReflector data set Q extracted by real-time scanning laserr{(xr0，yr0)，(xr1，yr1)，...，(xrk，yrk) And for each reflector data, generating a reflector characteristic structure FeatureMark by combining the distance and mutual angle relationship among reflectors in the data set, and further obtaining a reflector characteristic structure set F corresponding to the laser scanning reflector data setrAs shown in FIG. 1.a, the sample laser data contains the approximate estimated position (x) of the laser sensorini，yini，thetaini) And reflecting plate point set Qr{(xr0，yr0)，(xr1，yr1)，(xr2，yr2)，(xr3，yr3) For each reflection thereinPlates, e.g. reflecting plates r, shown in FIG. 1.b0By using r0The distance and angular relationship to other reflectors in the same laser data can generate a plurality of corner-edge feature cells as shown in FIG. 1.c, where edge1 is denoted by r0To r1Edge characteristics (including edge length and connection point ID) of (c), edge2 is denoted by r0To r2The angle represents the angle between two edges, and for a single reflector with n neighboring reflectors, n x (n-1)/2 edge-corner feature cells, such as r, can be generated0The final reflector feature f shown in FIG. 1.d can be produced0Including 3 corner edge feature units for other reflectors (r) in the laser data1，r2，r3) By performing the same operation, a reflector characteristic structure set F corresponding to the laser reflector data shown in the figure can be obtainedr{fr0，fr1，fr2，fr3} sample Reflector data Q of the reference map (shown in FIG. 2)mThe characteristic structural body set F of the reflecting plate is obtained by the pretreatment of the processm{fm0，fm1，fm2，fm3，fm4}；
Step 2, processing the data of the laser reflector in the step 1 to obtain a characteristic structural body set F of the laser real-time scanning reflectorr{fr0，fr1，fr2，fr3Reflector feature structure set F obtained by preprocessing with reference mapm{fm0，fm1，fm2，fm3，fm4Performing matching operation of a feature structure FeatureMark, pushing the matching result into a reflecting plate feature structure matching pair set M to be processedmpThe matching between the reflector characteristic structural bodies is to compare the edge and corner characteristic units in the reflector characteristic structural bodies one by one, calculate the difference value, and count the number of qualified matched edge and corner characteristic units and the matching average error thereof. The matching calculation flow of the edge and corner feature unit is shown in fig. 3:
firstly, calculating the angle difference of two corner edge characteristic units, and if the difference is at a set threshold value daWithin the range, then goAnd performing next step of matching side length difference values, and if the side length difference values of the two sides are within the range of the set threshold value eT (if the matching combination of the two sides is in accordance, taking a smaller group of difference values), considering that the characteristic units of the two sides and the corner are correspondingly equal, and recording a matching error. When two reflector feature structures are matched, edge and corner feature units contained in the two reflector feature structures are matched one by one according to the method, the successfully matched units are paired, and sequencing is carried out from small to large according to the average error. Because a single edge feature unit has a plurality of successfully matched objects during matching, at this time, we uniquely screen an object group including a repeated matching unit according to the previous sequence from the smallest arrival, and keep the optimal result, and then calculate the number of successfully matched edge feature units suc _ eAe _ sum and the average error of matching of a plurality of edge feature units, and count the structure of a matched pair of reflector feature structures (the structure of a matched pair of reflector feature structures is shown in fig. 4);
step 3, for the reflector plate characteristic structural body matching pair set M finally obtained in the step 2mpSorting MatchPair scores from top to bottom according to each matching pair, wherein the scoring mode is that the number of edge characteristic units successfully matched in a matching pair is large with high score suc _ eAe _ sum, the number of suc _ eAe _ sum is the same, the value of an average matching error average _ error is compared, the smaller the average _ error value is, the higher the score is, the situation that a plurality of other objects matched with the same reflector characteristic structure body possibly exist in a matching pair set, and at this time, an optimal unique matching pair is sorted and reserved according to the scoring sorting, for example, the sorting result of the matching pairs of the laser scanning reflector data and the reference map landmark data in the example shown in FIG. 5 is obtained, wherein two pairs of repeated pairs exist, and a set M containing four pairs of matching pairs is reserved after screening and deletionmp{(fr1，fm2)，(fr2，fm4)，(fr0，fm1)，(fr3，fm0)}；
Step 4, through the acquired set M of matching pairsmpReflector match point pairs with one-to-one correspondence of laser data to map landmarks, e.g., from Mmp{(fr1，fm2)，(fr2，fm4)，(fr0，fm1)，(fr3，fm0) Get the matching point pairs of the sample in the (b) } step
Figure BDA0002879219100000091
After the one-to-one corresponding accurate matching point pairs are obtained, considering that the position between the actually arranged map landmarks and the reflecting plate in the laser scanning data can be regarded as a connected and fixed rigid body structure, the angle difference of the attitude angle of the connecting vector formed between every two laser reflecting plate data in a laser coordinate system and the vector attitude angle formed by connecting the corresponding landmarks in the map coordinate system is the rotation angle of the two point sets, and the difference of the centroid coordinates of the point sets after rotation is the translation amount of the two point sets, so that the coordinate transformation relation between the two point sets can be obtained. There will be a set Q of (n +1) pairs of matching pointsmpIs shown as
Figure BDA0002879219100000092
The rotation angle theta of the point set transformation can be obtained by formula (1), and then the translation amount is obtained
Figure BDA0002879219100000093
Can be obtained from formula (2) and formula (3);
Figure BDA0002879219100000094
Figure BDA0002879219100000095
Figure BDA0002879219100000101
step 5, the initial pose (x) of the laser sensor is determinedini，yini，thetaini) Through the obtained rotation translation amount between the laser scanning reflector data and the map landmark
Figure BDA0002879219100000102
Coordinate transformation is carried out according to the formula (4), and accurate map positioning pose (x) can be obtainedc，yc，thetac) The effect of the rotational translation is shown in fig. 6.
The application has the advantages that:
according to the method, the corner structure body is generated for each reflecting plate by extracting the corner features between the reflecting plates in the laser measurement data, feature matching is carried out on the corner structure body and map reflecting plate data, corresponding data association is achieved, and then the real-time pose of the laser sensor is obtained through geometric relation matching.
The above description is only a preferred embodiment of the present application and is not intended to limit the present application, and various modifications and changes may be made to the present application by those skilled in the art. Any modification, equivalent replacement, improvement and the like made within the spirit and principle of the present application shall be included in the protection scope of the present application.

Claims (1)

1.A laser reflector positioning method based on corner joint feature structure body is characterized by comprising the following steps: the positioning method comprises the following steps:
step 1 Reflector data set Q on a known reference mapm{(xm0，ym0)，(xm1，ym1)，...，(xmn，ymn) And a corresponding pre-generated feature structure set F of the reflectormReflector data set Q extracted by real-time scanning laserr{(xr0，yr0)，(xr1，yr1)，...，(xrk，yrk) And for each reflector data, generating a reflector characteristic structure FeatureMark by combining the distance and mutual angle relationship among reflectors in the data set, and further obtaining a reflector characteristic structure set F corresponding to the laser scanning reflector data setrThe sample laser data includes an estimated position (x) sensed by the laser sensorini，yini，thetaini) And reflecting plate point set Qr{(xr0，yr0)，(xr1，yr1)，(xr2，yr2)，(xr3，yr3) For each of the reflecting plates, reflecting plate r0By using r0The distance and angle relationships to other reflectors in the same laser data generate a plurality of corner edge feature cells, edge1 denoted by r0To r1Edge feature of (1), edge2 denoted by r0To r2For a single reflector with n neighboring reflectors, a total of n x (n-1)/2 corner-edge feature cells, e.g., r, are generated0Finally, the characteristic structure f like a reflecting plate is generated0Including 3 corner edge feature units for other reflectors (r) in the laser data1，r2，r3) The same operation is carried out to obtain a reflector characteristic structure body set F corresponding to the laser reflector datar{fr0，fr1，fr2，fr3}, baffle data QmThe characteristic structural body set F of the reflecting plate is obtained by the pretreatment of the processm{fm0，fm1，fm2，fm3，fm4}；
Step 2, processing the data of the laser reflector in the step 1 to obtain a characteristic structural body set F of the laser real-time scanning reflectorr{fr0，fr1，fr2，fr3Reflector feature structure set F obtained by preprocessing with reference mapm{fm0，fm1，fm2，fm3，fm4Performing matching operation of a feature structure FeatureMark, pushing a matching result into a matching pair set M of the feature structure of the reflector to be processedmpThe matching among the reflector characteristic structural bodies is to compare edge and corner characteristic units in the reflector characteristic structural bodies one by one, calculate the difference value of the edge and corner characteristic units and count the number of matched edge and corner characteristic units and the matching average error of the matched edge and corner characteristic units; the matching calculation process of the edge and corner feature units is as follows:
firstly, calculating the angle difference of two corner edge characteristic units, and if the difference is at a set threshold value daIf the side length difference values of the two sides are within the range of the set threshold value eT, the characteristic units of the two corner sides are considered to be correspondingly equal, and a matching error is recorded; when two reflector plate feature structures are matched, the corner edge feature units contained in the two reflector plate feature structures are matched one by one according to the method, the successfully matched units are matched, and the units are sorted from small to large according to the average error; when matching is carried out, the condition that a single edge characteristic unit has a plurality of objects successfully matched occurs, at the moment, according to the previous sequence from small to large, object groups containing repeated matching units are subjected to unique screening, the optimal result is kept, and then the successfully matched edge characteristic unit number suc _ eAe _ sum and the average error of matching of the plurality of edge characteristic units are calculated to calculate the matched pair structure of the reflector plate characteristic structure;
step 3, matching pair set M of the characteristic structural body of the reflecting plate finally obtained in the step 2mpSorting the scores of MatchPair from top to bottom according to the scores of each matching pair, wherein the scoring mode is that the number of edge characteristic units successfully matched in the matching pairs is large in suc _ eAe _ sum, the score is high, the suc _ eAe _ sum is the same, the value of an average matching error average _ error is compared, the smaller the value of the average _ error is, the higher the score is, the condition that a plurality of other objects matched with the same reflector characteristic structure exist in the matching pair set, the optimal unique matching pair is sorted and reserved according to the score sorting at this time, the matching pair sorting result of the sample laser scanning reflector data and the reference map landmark data is obtained, two pairs of repeated pairs are provided, and a set M comprising four pairs of matching pairs is reserved after screening and deletionmp{(fr1，fm2)，(fr2，fm4)，(fr0，fm1)，(fr3，fm0)}；
Step 4, through the acquired set M of matching pairsmpObtaining reflector matching point pairs corresponding to the laser data and the map landmarks one by one, such as from Mmp{(fr1，fm2)，(fr2，fm4)，(fr0，fm1)，(fr3，fm0) Get the matching point pair of the sample in }
Figure FDA0003668101440000031
After one-to-one corresponding accurate matching point pairs are obtained, considering that the position between a map landmark and a reflector in laser scanning data which are actually arranged is a connected and fixed rigid body structure, the angle difference of the attitude angle of a connecting vector formed between every two laser reflectors in a laser coordinate system and the vector attitude angle formed by connecting the corresponding landmarks in the map coordinate system is the rotation angle of the two point sets, and the difference of the centroid coordinates of the point sets after rotation is the translation amount of the two point sets, so that the coordinate transformation relation between the two point sets is obtained; there will be a set Q of (n +1) pairs of matching pointsmpIs shown as
Figure FDA0003668101440000032
The rotation angle theta of the point set transformation is obtained through the formula (1), and then the translation amount is obtained
Figure FDA0003668101440000033
Obtained by formula (2) and formula (3);
Figure FDA0003668101440000034
Figure FDA0003668101440000035
Figure FDA0003668101440000036
step 5, the initial pose (x) of the laser sensor is determinedini，yini，thetaini) Through the obtained rotation translation amount between the laser scanning reflector data and the map landmark
Figure FDA0003668101440000037
Coordinate transformation is carried out according to the formula (4), and the accurate map positioning pose (x) is obtainedc，yc，thetac)。
CN202011625754.8A 2020-12-31 2020-12-31 Laser reflector positioning method based on corner joint characteristic structure Active CN112815944B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011625754.8A CN112815944B (en) 2020-12-31 2020-12-31 Laser reflector positioning method based on corner joint characteristic structure

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011625754.8A CN112815944B (en) 2020-12-31 2020-12-31 Laser reflector positioning method based on corner joint characteristic structure

Publications (2)

Publication Number Publication Date
CN112815944A CN112815944A (en) 2021-05-18
CN112815944B true CN112815944B (en) 2022-07-12

Family

ID=75854851

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011625754.8A Active CN112815944B (en) 2020-12-31 2020-12-31 Laser reflector positioning method based on corner joint characteristic structure

Country Status (1)

Country Link
CN (1) CN112815944B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115220012A (en) * 2022-09-20 2022-10-21 成都睿芯行科技有限公司 Positioning method based on reflecting plate

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108195377A (en) * 2017-12-22 2018-06-22 广东嘉腾机器人自动化有限公司 One kind is based on the matched reflector matching algorithm of triangle perimeter
CN110160528A (en) * 2019-05-30 2019-08-23 华中科技大学 A kind of mobile device pose localization method based on angle character identification
CN111060092A (en) * 2019-12-31 2020-04-24 芜湖哈特机器人产业技术研究院有限公司 Rapid matching method of reflective columns
CN111273304A (en) * 2019-12-31 2020-06-12 芜湖哈特机器人产业技术研究院有限公司 Natural positioning method and system for fusion reflecting column

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA3032812A1 (en) * 2016-08-04 2018-02-08 Reification Inc. Methods for simultaneous localization and mapping (slam) and related apparatus and systems

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108195377A (en) * 2017-12-22 2018-06-22 广东嘉腾机器人自动化有限公司 One kind is based on the matched reflector matching algorithm of triangle perimeter
CN110160528A (en) * 2019-05-30 2019-08-23 华中科技大学 A kind of mobile device pose localization method based on angle character identification
CN111060092A (en) * 2019-12-31 2020-04-24 芜湖哈特机器人产业技术研究院有限公司 Rapid matching method of reflective columns
CN111273304A (en) * 2019-12-31 2020-06-12 芜湖哈特机器人产业技术研究院有限公司 Natural positioning method and system for fusion reflecting column

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
"基于反射标记物的激光导引AGV全局定位方法研究";徐京邦等;《制造业自动化》;20200228;第42卷(第2期);第113-115、127页 *

Also Published As

Publication number Publication date
CN112815944A (en) 2021-05-18

Similar Documents

Publication Publication Date Title
CN107063228B (en) Target attitude calculation method based on binocular vision
Schultz et al. Continuous localization using evidence grids
Minguez et al. Metric-based iterative closest point scan matching for sensor displacement estimation
CN107292234B (en) Indoor scene layout estimation method based on information edge and multi-modal features
Huang Review on LiDAR-based SLAM techniques
CN110599506B (en) Point cloud segmentation method for three-dimensional measurement of complex special-shaped curved surface robot
CN107818598B (en) Three-dimensional point cloud map fusion method based on visual correction
CN110458174B (en) Precise extraction method for key feature points of unordered point cloud
CN109579825B (en) Robot positioning system and method based on binocular vision and convolutional neural network
CN113781582A (en) Synchronous positioning and map creating method based on laser radar and inertial navigation combined calibration
CN114526739B (en) Mobile robot indoor repositioning method, computer device and product
CN111986219B (en) Matching method of three-dimensional point cloud and free-form surface model
CN113610917A (en) Circular array target center image point positioning method based on blanking points
CN111998846A (en) Unmanned system rapid relocation method based on environment geometry and topological characteristics
CN112815944B (en) Laser reflector positioning method based on corner joint characteristic structure
CN112945196B (en) Strip mine step line extraction and slope monitoring method based on point cloud data
CN107665496B (en) Three-dimensional attitude registration method
Wang et al. Multidimensional particle swarm optimization-based unsupervised planar segmentation algorithm of unorganized point clouds
Thomas et al. Delio: Decoupled lidar odometry
CN117029870A (en) Laser odometer based on road surface point cloud
CN114219022A (en) Multi-sensor multi-target tracking method combining cluster analysis and particle swarm optimization algorithm
Jelinek Vector maps in mobile robotics
CN114723795B (en) Bucket wheel machine unmanned operation positioning and mapping method based on improved nearest point registration
CN110455274A (en) Based on chamfering apart from the matched AGV initial alignment method of shape and positioning system
Hsu et al. Map building of unknown environment using PSO-tuned enhanced Iterative Closest Point algorithm

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant