CN102564416A - System and method for reconstructing and positioning three-dimensional environment for mirror cleaning robot - Google Patents
System and method for reconstructing and positioning three-dimensional environment for mirror cleaning robot Download PDFInfo
- Publication number
- CN102564416A CN102564416A CN2011104554686A CN201110455468A CN102564416A CN 102564416 A CN102564416 A CN 102564416A CN 2011104554686 A CN2011104554686 A CN 2011104554686A CN 201110455468 A CN201110455468 A CN 201110455468A CN 102564416 A CN102564416 A CN 102564416A
- Authority
- CN
- China
- Prior art keywords
- laser
- cleaning robot
- attitude
- angle
- mirror surface
- 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.)
- Granted
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
A system for reconstructing and positioning a three-dimensional environment for a mirror cleaning robot comprises a laser distance measuring sensor, a motor, an eccentric wheel, a swing bracket of a bracket, an absolute value encoder, an MEMS (Micro-electromechanical System) inertial sensor, a host computer and a mileage recorder, wherein the bracket is arranged on the mirror cleaning robot; the motor is arranged at the front end of the bracket; the eccentric wheel is connected with the motor, and is in transmission with the bracket so as to convert the rotation movement of the motor into the swing movement of the bracket; the laser distance measuring sensor is linked with the bracket and used for obtaining the laser scanning data between obstacles in a real-time manner; the absolute value encoder is arranged on the swing shaft of the laser distance measuring sensor and used for directly measuring the swing angle of the laser distance measuring sensor relative to a vehicle body; the MEMS inertial sensor is mounted on the swing bracket and used for measuring the horizontally rolling angle and the pitching angle of the vehicle body relative to the geographic horizontal plane when the vehicle body moves on uneven ground; and the host computer is connected with the laser distance measuring sensor, the absolute value encoder, the MEMS inertial sensor and the mileage recorder, and is used for receiving the data sent by the laser distance measuring sensor and the like, building a 3D outline drawing, extracting the coplanar data points from three-dimensional data points, and defining the position of a truss.
Description
Invention field
The present invention relates generally to the solar energy thermal-power-generating field, be specifically related to the system and method for reconstruct of a kind of mirror surface cleaning robot three-dimensional and location.
Background technology
Solar energy thermal-power-generating is also named focus type solar energy generating (Concentrating Solar Power is called for short CSP); The sun power direct light is gathered together with the mode that focuses on through a large amount of catoptrons; Heating working medium, the steam of generation HTHP, steam driven steam turbine power generation.
The solar energy mirror field mainly is made up of with the superincumbent plane mirror of installation a large amount of framves that spreads out, and is the solar thermal utilization rate that improves land area of one unit, and the adjacent frame that spreads out is arranged compact.The annual temperature difference in the highlands at Jing Chang place is bigger, and whole mirror field ground flat degree may change.Mirror surface cleaning robot (or claiming the minute surface car) is used for the mirror surface cleaning of high altitude localities solar light-heat power-generation Jing Chang.
The minute surface car need be walked in adjacent gap of spreading out between the frame, and utilizes vehicle-mounted wiper mechanism cleaning plane mirror.For guaranteeing the safety of mirror field facility, need a kind of more accurate targeting scheme to confirm car body and the relative position relation of frame that spreads out, and then make reliable and stable the executing the task of minute surface car.
Traditional indoor and outdoor locator meams mainly contains: rely on the relative positioning of laser range sensor, rely on odometer dead reckoning location, through receiving the absolute fix of gps signal, the integrated navigation scheme of several kinds of modes more than the employing is arranged also.With upper type unique advantage is separately arranged all, laser range sensor is applied to indoor positioning can obtain stable environment profile, and odometer is a kind of simple and effective locator meams, the extremely strong solution of a kind of especially versatility of GPS.
Yet in the application of this project, new challenge has been proposed above locator meams.GPS civil signal bearing accuracy still can not satisfy the requirement that should use, and the bigger saltus step of GPS positioning signal existence, and is still unable to do what one wishes for frequency applications, the risk that exists gps signal to lose in addition.Odometer only provides the displacement variable of carrier working direction, can have than mistake the failure risk that when using separately, has idle running and slide for the road surface of poor flatness.The 2D laser range sensor is the range finding range that is subject to sensor itself in outdoor application one, the 2nd, and the outdoor environment contour feature is not remarkable, and especially the environment of this project is the baroque frame that spreads out, and has increased uncertainty greatly.
In a word, because complex environment structure in should using, and the pavement conditions of poor flatness, locator meams commonly used all can not meet the demands, and needs a kind of special targeting scheme.
Summary of the invention
The system that first purpose of the present invention is to provide a kind of mirror surface cleaning robot to carry out three-dimensionalreconstruction and location is to solve in the prior art technical matters that can not satisfy accuracy requirement in the pavement conditions location of poor flatness.
The method that second purpose of the present invention is to provide a kind of mirror surface cleaning robot to carry out three-dimensionalreconstruction and location is to solve in the prior art technical matters that can not satisfy accuracy requirement in the pavement conditions location of poor flatness.
A kind of mirror surface cleaning robot carries out the system of three-dimensionalreconstruction and location; Be used to be installed in the headstock part of said mirror surface cleaning robot; It further comprises laser range sensor, motor, eccentric wheel, wave support, absolute value encoder, MEMS inertial sensor, host computer and odometer; Wherein
Eccentric wheel is fixed on the motor, and transmission waves on the support said, is used for rotatablely moving of motor is converted into the oscillating motion of support;
Said laser range sensor is fixedly connected and waves support, is used for the oscillating motion campaign of waving support, and obtains laser scanning data;
Said absolute value encoder is arranged on waving on the axle of laser range sensor, is used for directly measuring the angle of waving with respect to car body;
The MEMS inertial sensor is used to measure car body roll angle and angle of pitch with respect to geographical surface level when the out-of-flatness ground motion;
Odometer: be installed in the mirror surface cleaning robot;
Host computer: connect laser range sensor, absolute value encoder, MEMS inertial sensor and odometer respectively; Be used to receive the transmission data that comprise the laser range sensor transmission; Make up a 3D profile diagram, extract the coplane data point in the three-dimensional data points, determine the chord position that spreads out and put.
Said MEMS inertial sensor comprises gyroscope and accelerometer, and said host computer further comprises:
Car body attitude measurement computing unit is used for the output according to gyroscope and accelerometer, calculates the attitude of this carrier of mirror surface cleaning robot;
The car body attitude merges computing unit; Be used for attitude with this carrier of mirror surface cleaning robot; Consider that again absolute value encoder obtains the angle of pitch α that waves The Cloud Terrace, finally calculate roll angle γ and the pitching angle theta of laser scanner with respect to the actual attitude of the geographical surface level in locality;
The laser data attitude is thrown projection corrected Calculation unit, is used to calculate the projection coordinate information of laser data point at geographical surface level;
Laser data translation corrected Calculation unit is used in the universal measurement time interval increment of mileage gauge and revises, and revised data are painted into one or three paint in the coordinate system, forms the one scan point cloud chart;
The location Calculation unit is used on this analyzing spot cloud atlas, locating the point that presets.
A kind of mirror surface cleaning robot carries out the method for three-dimensionalreconstruction and location, comprising:
Receive the output of gyroscope and accelerometer, calculate the attitude of this carrier of mirror surface cleaning robot;
With the attitude of this carrier of mirror surface cleaning robot, consider that again absolute value encoder obtains the angle of pitch α that waves The Cloud Terrace, finally calculate roll angle γ and the pitching angle theta of laser scanner with respect to the actual attitude of the geographical surface level in locality;
Calculate the projection coordinate information of laser data point at geographical surface level;
The increment of mileage gauge is revised in the universal measurement time interval, and revised data are painted into one or three paint in the coordinate system, forms the one scan point cloud chart;
On this analyzing spot cloud atlas, locate the point that presets.
Compared with prior art, the system that the present invention provides a kind of mirror surface cleaning robot to carry out three-dimensionalreconstruction and location, system provided by the invention can accomplish reconstruct location work under the pavement conditions of complex environment structure and poor flatness.
Also have, the present invention can provide and utilize the two-dimensional laser radar to carry out three-dimensionalreconstruction and positioning action, and cost is very low, and realizes conveniently.
Description of drawings
Fig. 1 carries out the part system architecture front elevational schematic of three-dimensionalreconstruction and location for a kind of mirror surface cleaning robot;
Fig. 2 carries out the part system architecture schematic rear view of three-dimensionalreconstruction and location for a kind of mirror surface cleaning robot;
Fig. 3 carries out the part system architecture side view of three-dimensionalreconstruction and location for a kind of mirror surface cleaning robot;
Fig. 4 carries out the process flow diagram of three-dimensionalreconstruction and location for a kind of mirror surface cleaning robot;
Fig. 5 is an existing coordinate definition figure.
Embodiment
Below in conjunction with accompanying drawing, specify the present invention.
See also Fig. 1, Fig. 2, Fig. 3, a kind of mirror surface cleaning robot carries out the system of three-dimensionalreconstruction and location.Be used to be installed in the headstock part of said mirror surface cleaning robot, it further comprises laser range sensor 15, motor 11, eccentric wheel 13, waves support, absolute value encoder, MEMS inertial sensor, host computer and odometer, wherein,
Said absolute value encoder is arranged on waving on the axle of laser range sensor 15, is used for directly waving angle with respect to car body;
The MEMS inertial sensor is used to measure car body roll angle and angle of pitch with respect to geographical surface level when the out-of-flatness ground motion;
Odometer: be installed in the mirror surface cleaning robot;
Host computer: connect laser range sensor 15, absolute value encoder, MEMS inertial sensor and odometer respectively; Be used to receive the transmission data that comprise the laser range sensor transmission; Make up a 3D profile diagram, extract the coplane data point in the three-dimensional data points, determine the chord position that spreads out and put.
Laser range sensor waves along waving fulcrum 17, waves fulcrum 17 and can be fixed in the mirror surface cleaning robot.Wave support and comprise upper bracket 141 and lower carriage 142 at least; The oblong-shaped of upper bracket 141 and lower carriage 142 formations one hollow, eccentric wheel 13 is arranged in the rectangle of said hollow, and eccentric wheel 13 drops on the said lower carriage 142; The perpendicular lattice framing in the left side of lower carriage can be fixedly connected with laser range sensor 15 through fulcrum 18; The following horizontal lattice framing of lower carriage 142 is connected with perpendicular lattice framing, and eccentric wheel 13 moves in the semi-surrounding circle of lower carriage, drives the oscillating motion of lower carriage 142.Also comprise a support bar in this instance, an end of support bar connects the lower end of the perpendicular lattice framing in the right side of upper bracket, and the other end flexibly connects on the laser range sensor.Like this, when eccentric wheel 13 moves in the semi-surrounding circle of lower carriage, at least can supported hold.Motor rotating band movable eccentric wheel makes support produce reciprocal oscillating motion, and the relative angle of this oscillating motion records through absolute value encoder.Laser sensor is fixed on support; (amplitude that support waves is approximately 20 ° to the two-dimensional scan frame of timing sampling some in a rolling period; This amplitude is adjustable through eccentric wheel setting-up eccentricity amount; Every at a distance from 2 ° of collections of carrying out a laser scanning data in a rolling period, promptly one wave carry out 20 frame laser scannings back and forth).
Said in this example eccentric diameter equals the height of the perpendicular lattice framing in a left side of said lower carriage.Said laser range sensor is arranged on and waves on the support or an end of motor.
Laser range sensor can adopt the two-dimensional laser distance measuring sensor, to reduce cost, also can directly adopt the three-dimensional laser distance measuring sensor.
In this example, said MEMS inertial sensor comprises gyroscope and accelerometer, and said host computer further comprises:
Car body attitude measurement computing unit is used for the output according to gyroscope and accelerometer, calculates the attitude of this carrier of mirror surface cleaning robot;
The car body attitude merges computing unit; Be used for attitude with this carrier of mirror surface cleaning robot; Consider that again absolute value encoder obtains the angle of pitch α that waves The Cloud Terrace, finally calculate roll angle γ and the pitching angle theta of laser scanner with respect to the actual attitude of the geographical surface level in locality;
The laser data attitude is thrown projection corrected Calculation unit, is used to calculate the projection coordinate information of laser data point at geographical surface level;
Laser data translation corrected Calculation unit is used in the universal measurement time interval increment of mileage gauge and revises, and revised data are painted into one or three paint in the coordinate system, forms the one scan point cloud chart;
The location Calculation unit is used on this analyzing spot cloud atlas, locating the point that presets.
To above-mentioned system, a kind of mirror surface cleaning robot carries out the method (seeing also Fig. 4) of three-dimensionalreconstruction and location, comprising:
At first carry out S110: receive the output of gyroscope and accelerometer, calculate the attitude of this carrier of mirror surface cleaning robot. (car body attitude measurement)
Explain: carrying out this algorithm of attitude of carrier measurement through inertial sensor is the algorithm of a maturation, and here we just repeat to realize and be applied in the project.
Gyro data is carried out the Kalman filtering time and is upgraded; Judge according to the measured value of accelerometer whether the motion state of car, result's decision of judgement are utilized the measuring value of accelerometer to carry out Kalman filtering and measured and upgrade; Resolve attitude according to the filter status estimated result after more than accomplishing.
(purpose: input angle speed (gyroscope survey) and acceleration (accelerometer measures), export the attitude of carrier: the angle of pitch, roll angle with respect to the geographical surface level in locality.
For clarity, divide three parts to say below: 1. coordinate system and angle metric definition 2. are judged motion state 3. system equations 4. attitude algorithms by the acceleration measuring value)
1. definition (seeing also Fig. 5)
Carrier coordinate system b: initial point o is positioned at carrier movement center, ox
bAxle is right-hand towards carrier, oy
bAxle is towards carrier dead ahead, oz
bWith ox
b, oy
bAxle is according to right-hand rule form right angle coordinate system o-x
by
bz
b
Local geographic coordinate system n: initial point O is that initial point overlaps with b, and the OX axle is towards geographical east orientation, the OY axle towards geographic north to, OZ and OY, OY axle are according to right-hand rule form right angle coordinate system O-XYZ
Carrier can be represented by pitching angle theta and roll angle γ with respect to the Space Angle position of geographic coordinate system, defines as follows:
Pitching angle theta, the carrier longitudinal axis is with respect to the angle of local ground level.
Roll angle γ, vertical plane of symmetry of carrier is with respect to the angle of being rotated through carrier longitudinal axis vertical guide.
2. motion state is judged
The motion state of carrier is divided into two kinds:
1) no mover is moving.Can confirm the attitude of the geographical relatively surface level of carrier under this state through the acceleration measuring value, the information that therefore can be used as a kind of redundancy is proofreaied and correct attitude of carrier;
2) there is active motor-driven.With top opposite, accelerometer measures can not be used for confirming attitude of carrier.
Judge principle: when carrier did not have linear acceleration, carrier was moving for no mover.This moment the acceleration measuring value
Its mould value should be 1 local gravitational acceleration (9.8m/s
2).
α wherein
aBe judgment threshold, generally get and be no more than 5%.
3. system equation
Input quantity: angular speed measures
Acceleration measures
Consideration and θ, the relevant state vector c of γ
3
And equivalent gyroscopic drift
Its kinetics equation does
[list of references]
Wherein
Be the system noise sequence, approximate satisfied
(expectation),
(covariance/variance), Q
kBe gyroscope noise sequence variance battle array.
Above equation is put in order order
Then formula [1] can be write as
When the motion state of carrier is moved for no mover, acceleration measuring value f
bSatisfy relational expression
Wherein g is a local gravitational acceleration, general desirable 9.8m/s
2 Be to measure noise sequence, approximate satisfied
(expectation),
(covariance/variance), R
kBe accelerometer noise sequence variance battle array.
Put following formula in order, order
Then formula [3] can be write as
Z=HX+v
b.......................................................[4]
To the system that forms by [2] and [4], adopt the Kalman filtering filtering algorithm to carry out iterative computation.The Kalman filtering filtering algorithm comprises that the time upgrades and measurement upgraded for two steps, is used to carry out the time renewal at each iteration cycle gyroscope measuring value; The result that motion state is judged is used for decision and whether measures renewal with the accelerometer measuring value, for there not being initiatively motion state, then measures renewal as if carrier normally, otherwise, the result after the result who directly utilizes the time to upgrade upgrades as measurement.
4. attitude algorithm
The real-time estimated state amount of Kalman filtering filtering algorithm
Value, through c
3Resolve attitude angle
θ=arcsin(c
32)
Top can list of references [1] Henrik Rehbinder; Xiaoming Hu.Drift-free attitude estimation for accelerated rigid bodies.Automatic, Volume 40, and Issue 4; April 2004, Pages 653-659
Then carry out S120: with the attitude of this carrier of mirror surface cleaning robot; Consider that again absolute value encoder obtains the angle of pitch α that waves The Cloud Terrace, finally calculate roll angle γ and the pitching angle theta (attitude fusion) of laser scanner with respect to the actual attitude of the geographical surface level in locality.
Attitude during each frame data that laser range sensor is measured is made up of two parts: the attitude of car body and the tilter attitude that is fixed on car body; Algorithm through the front has obtained this two-part attitude parameter respectively; Be respectively the attitude parameter of carrier: pitching angle theta and roll angle γ with respect to the geographical surface level in locality; With obtain the angle of pitch α that waves The Cloud Terrace by absolute value encoder, this moment, laser scanner with respect to the computing formula of the actual attitude of the geographical surface level in locality did
Roll angle γ, consistent with the carrier roll angle, only oscillating motion is arranged because wave The Cloud Terrace in pitch orientation, do not influence roll angle
Angle of pitch β: sin β=sin α cos γ+θ, β=arcsin (sin α cos γ+θ) (letter definition is seen Fig. 5 and above-mentioned explanation)
Carry out S130 again: calculate the projection coordinate information (be laser data attitude projection correction) of laser data point at geographical surface level.
Being the local n of Department of Geography from navigation system realizes through the rotation around three axles to the conversion of carrier coordinate system b
The result who rotates for three times representes that with direction cosine matrix the note navigation is that the direction cosine matrix
that is has to carrier
For each the angle-distance in the laser data to (a
iDist
i), at first be transformed into the rectangular coordinate system coordinate with following formula
Increase the contrary projection coordinate of laser data point that promptly obtain of multiply by direction cosine matrix after z component 0 value at geographical surface level
Carry out S140 subsequently: the increment of mileage gauge is revised in the universal measurement time interval, and revised data are painted into one or three paint in the coordinate system, forms one scan point cloud chart (laser data translation correction)
In a measuring period, car body might also be subjected to displacement when record pursued the frame laser data, and this laser data that just causes record need be carried out the translation correction through the increment of mileage gauge in the measuring intervals of TIME not in same position.
If the corresponding measurement attitude of two frame laser data is respectively (β
1γ
1) and (β
2γ
2), between two frames increment of odometer be (δ x δ y δ is a).
Do one and simplify to handle, the mileage increment is projected to geographical surface level according to the laser attitude of former frame:
To back one frame laser data then according to parameter (δ x
nδ y
nδ a) carries out translation and rotation, calculates by following formula
Suppose to obtain altogether in the measuring period N frame laser data, agreement is according to the processing of above-mentioned two steps, and each frame laser data is snapped to: initial point is positioned at the initial point of the 1st frame laser data, and projects to local level.
Processing through above algorithm steps; Each frame laser data in a measuring period is aimed on room and time; These revised data are painted in the same three-dimensional system of coordinate, and such width of cloth analyzing spot cloud atlas is the 3D profile of describe environment fully just.
Carry out S150 at last: on this analyzing spot cloud atlas, locate the point that presets.
On the basis that obtains environment 3D profile; Though consider the frame complex structure that spreads out; The profile of laser scanning has very big uncertainty; But the shelf structure that spreads out still has the characteristic on a lot of planes on 3d space, on 3D profile cloud atlas, show as the data point of some coplanes, adopts Hough transformation to extract the coplane data point in the three-dimensional data points; The result is carried out determine the chord position that spreads out after the operations such as cluster and put, through this notable feature can confirm to spread out relative position relation of frame and laser range sensor.
This part comprises: 1. on 3D profile cloud atlas, extract characteristic plane 2. and confirm the relative both sides of carrier the spread out position of frame and the angle of the carrier forward direction and the frame direction of spreading out.
1. extraction characteristic plane
The space plane equation:
z=a
xx+a
yy+d
For the 3D profile cloud atlas that builds, to each data point [x wherein
iy
iz
i]
TCarry out Hough transformation, a space plane in the corresponding parameter space of each data point.N point arranged in the 3D cloud atlas; N plane just arranged in parameter space; These Plane intersects and a point (can just in time not intersect at a point, but concentrate on a less zone relatively), the plane that the Hough inverse transformation of this point is formed with regard to coplane data point in the corresponding 3D cloud atlas.
But top algorithm list of references:
[1]http://en.wikipedia.org/wiki/Hough_transform
[2]
http://homepages.inf.ed.ac.uk/rbf/HIPR2/hough.htm
[3]Vosselman,G.,Dijkman,S.3D?Building?Model?Reconstruction?from?Point?Clouds?and?Ground?Plans.?International?Archives?of?the?Photogrammetry,Remote?Sensing?and?Spatial?Information?Sciences,vol34,part?3/W4,October?22?24,2001,Annapolis,MA,USA,pp.37-44.
2. relative position is located
If obtain representing the spread out equation on frame plane of a side from last step:
z=a
xx+a
yy+d
Laser center calculates according to following formula to plan range:
Carrier forward direction and the angle that spreads out between the frame plane calculate by following formula:
More than the disclosed several specific embodiments that are merely the application, but the application is not limited thereto, any those skilled in the art can think variation, all should drop in the application's the protection domain.
Claims (10)
1. a mirror surface cleaning robot carries out the system of three-dimensionalreconstruction and location; It is characterized in that; Be used to be installed in the headstock part of said mirror surface cleaning robot; It further comprises laser range sensor, motor, eccentric wheel, wave support, absolute value encoder, MEMS inertial sensor, host computer and odometer, wherein
Eccentric wheel is fixed on the motor, and transmission waves on the support said, is used for rotatablely moving of motor is converted into the oscillating motion of support;
Said laser range sensor is fixedly connected and waves support, is used for the oscillating motion campaign of waving support, and obtains laser scanning data;
Said absolute value encoder is arranged on waving on the axle of laser range sensor, is used for directly measuring the angle of waving with respect to car body;
The MEMS inertial sensor is used to measure car body roll angle and angle of pitch with respect to geographical surface level when the out-of-flatness ground motion;
Odometer: be installed in the mirror surface cleaning robot;
Host computer: connect laser range sensor, absolute value encoder, MEMS inertial sensor and odometer respectively; Be used to receive the transmission data that comprise the laser range sensor transmission; Make up a 3D profile diagram, extract the coplane data point in the three-dimensional data points, determine the chord position that spreads out and put.
2. the system of claim 1 is characterized in that, said laser range sensor waves along waving fulcrum, and the said fulcrum that waves is fixed in the said mirror surface cleaning robot.
3. according to claim 1 or claim 2 system; It is characterized in that the said support that waves comprises upper bracket and lower carriage at least, said upper bracket and lower carriage constitute the oblong-shaped of a hollow; Said eccentric wheel is arranged in the rectangle of said hollow; Said eccentric wheel drops on the said lower carriage, and the perpendicular lattice framing in the left side of lower carriage is fixedly connected with said laser range sensor, and the following horizontal lattice framing of said lower carriage is connected with the perpendicular lattice framing in a said left side; Said eccentric wheel moves in the semi-surrounding circle of lower carriage, drives the oscillating motion of lower carriage.
4. system as claimed in claim 3 is characterized in that, said eccentric diameter equals the height of the perpendicular lattice framing in a left side of said lower carriage.
5. system as claimed in claim 3 is characterized in that, also comprises a support bar, and an end of said support bar connects the lower end of the perpendicular lattice framing in the right side of said upper bracket, and the other end flexibly connects on the laser range sensor.
6. the system of claim 1 is characterized in that, said laser range sensor is arranged on and waves on the support or an end of motor.
7. system as claimed in claim 2 is characterized in that, said laser range sensor adopts the two-dimensional laser distance measuring sensor.
8. the system of claim 1 is characterized in that,
Said MEMS inertial sensor comprises gyroscope and accelerometer, and said host computer further comprises:
Car body attitude measurement computing unit is used for the output according to gyroscope and accelerometer, calculates the attitude of this carrier of mirror surface cleaning robot;
The car body attitude merges computing unit; Be used for attitude with this carrier of mirror surface cleaning robot; Consider that again absolute value encoder obtains the angle of pitch α that waves The Cloud Terrace, finally calculate roll angle γ and the pitching angle theta of laser scanner with respect to the actual attitude of the geographical surface level in locality;
The laser data attitude is thrown projection corrected Calculation unit, is used to calculate the projection coordinate information of laser data point at geographical surface level;
Laser data translation corrected Calculation unit is used in the universal measurement time interval increment of mileage gauge and revises, and revised data are painted into one or three paint in the coordinate system, forms the one scan point cloud chart;
The location Calculation unit is used on this analyzing spot cloud atlas, locating the point that presets.
9. a mirror surface cleaning robot carries out the method for three-dimensionalreconstruction and location, it is characterized in that, comprising:
Receive the output of gyroscope and accelerometer, calculate the attitude of this carrier of mirror surface cleaning robot;
With the attitude of this carrier of mirror surface cleaning robot, consider that again absolute value encoder obtains the angle of pitch α that waves The Cloud Terrace, finally calculate roll angle γ and the pitching angle theta of laser scanner with respect to the actual attitude of the geographical surface level in locality;
Calculate the projection coordinate information of laser data point at geographical surface level;
The increment of mileage gauge is revised in the universal measurement time interval, and revised data are painted into one or three paint in the coordinate system, forms the one scan point cloud chart;
On this analyzing spot cloud atlas, locate the point that presets.
10. method as claimed in claim 9 is characterized in that, on this analyzing spot cloud atlas, locatees the point that presets and further comprises:
On 3D profile cloud atlas, extract characteristic plane;
Confirm the relative both sides of carrier spread out position and the carrier forward direction of frame and the angle of the frame direction of spreading out.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110455468.6A CN102564416B (en) | 2011-12-30 | 2011-12-30 | System and method for reconstructing and positioning three-dimensional environment for mirror cleaning robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110455468.6A CN102564416B (en) | 2011-12-30 | 2011-12-30 | System and method for reconstructing and positioning three-dimensional environment for mirror cleaning robot |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102564416A true CN102564416A (en) | 2012-07-11 |
CN102564416B CN102564416B (en) | 2014-08-20 |
Family
ID=46410477
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110455468.6A Active CN102564416B (en) | 2011-12-30 | 2011-12-30 | System and method for reconstructing and positioning three-dimensional environment for mirror cleaning robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102564416B (en) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103090863A (en) * | 2013-01-31 | 2013-05-08 | 中国人民解放军国防科学技术大学 | Method for measuring posture and height of dynamic platform |
CN105717500A (en) * | 2016-02-24 | 2016-06-29 | 深圳乐行天下科技有限公司 | Laser radar and data correcting method thereof |
CN105743004A (en) * | 2016-03-31 | 2016-07-06 | 广东电网有限责任公司中山供电局 | Cluster management and control system for substation inspection robot |
CN106168802A (en) * | 2016-04-18 | 2016-11-30 | 深圳众为兴技术股份有限公司 | A kind of location aware device for moving robot |
CN106406338A (en) * | 2016-04-14 | 2017-02-15 | 中山大学 | Omnidirectional mobile robot autonomous navigation apparatus and method based on laser range finder |
CN107016870A (en) * | 2017-05-03 | 2017-08-04 | 李良杰 | Rough road condition drives guiding system |
CN108447572A (en) * | 2018-01-16 | 2018-08-24 | 深圳市智能机器人研究院 | Nuclear reactor safety shell steel lining hollowing automatic checkout system and method |
CN108513610A (en) * | 2017-04-21 | 2018-09-07 | 深圳市大疆灵眸科技有限公司 | A kind of holder Attitude estimation method, apparatus and corresponding holder |
CN109262616A (en) * | 2018-11-09 | 2019-01-25 | 浙江国自机器人技术有限公司 | Robot collision checking method, system, control centre and readable storage medium storing program for executing |
CN110954129A (en) * | 2019-12-19 | 2020-04-03 | 北京猎户星空科技有限公司 | Method, device, equipment and medium for determining mileage count data |
CN114608499A (en) * | 2022-03-24 | 2022-06-10 | 洛阳开远智能精机有限公司 | Wide-range parallel leaf spring measuring device |
CN114608499B (en) * | 2022-03-24 | 2024-07-26 | 洛阳开远智能精机有限公司 | Wide-range parallel leaf spring measuring device |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101008571A (en) * | 2007-01-29 | 2007-08-01 | 中南大学 | Three-dimensional environment perception method for mobile robot |
CN101033972A (en) * | 2007-02-06 | 2007-09-12 | 华中科技大学 | Method for obtaining three-dimensional information of space non-cooperative object |
CN101089556A (en) * | 2006-06-16 | 2007-12-19 | 三星电子株式会社 | Moving apparatus, method, and medium for compensating position of the moving apparatus |
US20090057238A1 (en) * | 2007-09-04 | 2009-03-05 | Efraim Garti | Pool cleaning robot |
ITMI20090411A1 (en) * | 2008-03-19 | 2009-09-20 | Vorwerk Co Interholding | AUTOMATIC COLLECTOR PIPE FOR FLOORS AND OBJECT WITH A SENSOR GROUP. |
CN101916110A (en) * | 2010-08-11 | 2010-12-15 | 方正 | Sweeping robot and walking control method for same |
-
2011
- 2011-12-30 CN CN201110455468.6A patent/CN102564416B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101089556A (en) * | 2006-06-16 | 2007-12-19 | 三星电子株式会社 | Moving apparatus, method, and medium for compensating position of the moving apparatus |
CN101008571A (en) * | 2007-01-29 | 2007-08-01 | 中南大学 | Three-dimensional environment perception method for mobile robot |
CN101033972A (en) * | 2007-02-06 | 2007-09-12 | 华中科技大学 | Method for obtaining three-dimensional information of space non-cooperative object |
US20090057238A1 (en) * | 2007-09-04 | 2009-03-05 | Efraim Garti | Pool cleaning robot |
ITMI20090411A1 (en) * | 2008-03-19 | 2009-09-20 | Vorwerk Co Interholding | AUTOMATIC COLLECTOR PIPE FOR FLOORS AND OBJECT WITH A SENSOR GROUP. |
CN101916110A (en) * | 2010-08-11 | 2010-12-15 | 方正 | Sweeping robot and walking control method for same |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103090863B (en) * | 2013-01-31 | 2015-04-08 | 中国人民解放军国防科学技术大学 | Method for measuring posture and height of dynamic platform |
CN103090863A (en) * | 2013-01-31 | 2013-05-08 | 中国人民解放军国防科学技术大学 | Method for measuring posture and height of dynamic platform |
CN105717500A (en) * | 2016-02-24 | 2016-06-29 | 深圳乐行天下科技有限公司 | Laser radar and data correcting method thereof |
CN105743004A (en) * | 2016-03-31 | 2016-07-06 | 广东电网有限责任公司中山供电局 | Cluster management and control system for substation inspection robot |
CN106406338A (en) * | 2016-04-14 | 2017-02-15 | 中山大学 | Omnidirectional mobile robot autonomous navigation apparatus and method based on laser range finder |
CN106406338B (en) * | 2016-04-14 | 2023-08-18 | 中山大学 | Autonomous navigation device and method of omnidirectional mobile robot based on laser range finder |
CN106168802A (en) * | 2016-04-18 | 2016-11-30 | 深圳众为兴技术股份有限公司 | A kind of location aware device for moving robot |
CN108513610A (en) * | 2017-04-21 | 2018-09-07 | 深圳市大疆灵眸科技有限公司 | A kind of holder Attitude estimation method, apparatus and corresponding holder |
CN107016870A (en) * | 2017-05-03 | 2017-08-04 | 李良杰 | Rough road condition drives guiding system |
CN108447572B (en) * | 2018-01-16 | 2020-10-27 | 深圳市智能机器人研究院 | Automatic detection system and method for hollowing of steel lining of containment vessel of nuclear reactor |
CN108447572A (en) * | 2018-01-16 | 2018-08-24 | 深圳市智能机器人研究院 | Nuclear reactor safety shell steel lining hollowing automatic checkout system and method |
CN109262616A (en) * | 2018-11-09 | 2019-01-25 | 浙江国自机器人技术有限公司 | Robot collision checking method, system, control centre and readable storage medium storing program for executing |
CN110954129A (en) * | 2019-12-19 | 2020-04-03 | 北京猎户星空科技有限公司 | Method, device, equipment and medium for determining mileage count data |
CN114608499A (en) * | 2022-03-24 | 2022-06-10 | 洛阳开远智能精机有限公司 | Wide-range parallel leaf spring measuring device |
CN114608499B (en) * | 2022-03-24 | 2024-07-26 | 洛阳开远智能精机有限公司 | Wide-range parallel leaf spring measuring device |
Also Published As
Publication number | Publication date |
---|---|
CN102564416B (en) | 2014-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102564416B (en) | System and method for reconstructing and positioning three-dimensional environment for mirror cleaning robot | |
Yi et al. | Recent research and applications of GPS‐based monitoring technology for high‐rise structures | |
Li et al. | Initial results of rover localization and topographic mapping for the 2003 Mars Exploration Rover mission | |
CN104880191B (en) | A kind of polarization auxiliary navigation method based on solar vector | |
CN104061899B (en) | A kind of vehicle side inclination angle based on Kalman filtering and angle of pitch method of estimation | |
CN103412565B (en) | A kind of robot localization method with the quick estimated capacity of global position | |
CN100476452C (en) | Airborne double-antenna double-measuring device interference SAR base linc motion measuring method | |
CN103557876B (en) | A kind of inertial navigation Initial Alignment Method for antenna tracking stable platform | |
CN106507913B (en) | Combined positioning method for pipeline mapping | |
CN101672913B (en) | Laser three-point dynamic positioning method and system thereof | |
CN103557871B (en) | A kind of lighter-than-air flight aerial Initial Alignment Method of device inertial navigation | |
CN105824039A (en) | Odometer-based GNSS/INS (Global Navigation Satellite System/Inertial Navigation System) vehicle-mounted combined positioning and orientation algorithm for overcoming satellite locking loss | |
CN103633417B (en) | Airborne antenna based on strapdown attitude tenacious tracking high accuracy points to tracking | |
CN104535061A (en) | Navigation system based on multi-sensor data fusion | |
CN103743414A (en) | Initial alignment method of speedometer-assisted strapdown inertial navigation system during running | |
CN104180793A (en) | Device and method for obtaining mobile spatial information for digital city construction | |
CN105698822A (en) | Autonomous inertial navigation action initial alignment method based on reverse attitude tracking | |
CN103400416B (en) | A kind of urban environment robot navigation method based on probability multilayer landform | |
CN110106755B (en) | Method for detecting irregularity of high-speed rail by reconstructing rail geometric form through attitude | |
CN106410410A (en) | Satellite capturing and tracking method for VSAT (Very Small Aperture Terminal) antenna system with physical level platform | |
CN105333869A (en) | Unmanned reconnaissance aerial vehicle synchronous positioning and picture compositing method based on self-adaption EKF | |
CN115597535B (en) | High-speed magnetic levitation track irregularity detection system and method based on inertial navigation | |
CN112578394B (en) | LiDAR/INS fusion positioning and drawing method with geometric constraint | |
CN103712621A (en) | Method for determining attitude of polarized light and infrared sensor auxiliary inertial navigation system | |
CN110133695A (en) | A kind of double antenna GNSS location delay time dynamic estimation system and method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |