CN1831468A - Method for deciding relative position of laser scanner and robot - Google Patents

Method for deciding relative position of laser scanner and robot Download PDF

Info

Publication number
CN1831468A
CN1831468A CN 200510053460 CN200510053460A CN1831468A CN 1831468 A CN1831468 A CN 1831468A CN 200510053460 CN200510053460 CN 200510053460 CN 200510053460 A CN200510053460 A CN 200510053460A CN 1831468 A CN1831468 A CN 1831468A
Authority
CN
China
Prior art keywords
scanner
robot
coordinate
translation
spheroid
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
Application number
CN 200510053460
Other languages
Chinese (zh)
Other versions
CN100338433C (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.)
Tianjin Zhitong Information System Integration Co ltd
Original Assignee
XINAO BOWEI TECHNOLOGY 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 XINAO BOWEI TECHNOLOGY Co Ltd filed Critical XINAO BOWEI TECHNOLOGY Co Ltd
Priority to CNB2005100534601A priority Critical patent/CN100338433C/en
Publication of CN1831468A publication Critical patent/CN1831468A/en
Application granted granted Critical
Publication of CN100338433C publication Critical patent/CN100338433C/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

A method for calibrating relative position of laser scanner to robot includes moving sphere to scanning scope of scanner by mechanical arm of robot, calculating out coordinate of sphere center to scanner and recording coordinate of mechanical tail end to robot base, controlling said tail end to make translation, varying attitude of said arm, calculating out rotary relation of scanner coordinate to robot base coordinate, making sphere translation by said arm and scanning sphere by scanner to record related coordinates, varying attitude of said arm and calculating out translation - relation of scanner coordinate to robot base coordinate.

Description

The scaling method of the relative position of laser scanner and robot
Technical field
The present invention relates to the scaling method of the relative position of laser scanner and robot.
Background technology
Laser scanner can be used for the reconstruction of three dimensions point, if but the mutual alignment of scanner and scanned object fix, its can reconstruct scope just be subjected to considerable restraint.With the line laser is example, the point that just sweep trace shone of its energy reconstruct.For the sweep limit of expanded sweep device, normally used method has two kinds.The one, scanner is placed on the mechanical hook-up, by the motion of mechanical hook-up, make the sweep trace of scanner can reach the more space point.Another kind method is, scanned object is placed on the mechanical hook-up, and by the motion of mechanical hook-up, the scanner scans that makes each spatial point on the scanned object to be fixed arrives.
Therefore, no matter adopt which kind of mode, the demarcation of the TCP of scanner determines that promptly the relation between scanner coordinate system and mechanical hook-up coordinate system is the problem that at first will solve.But present scaling method all is that the rotation relationship of scanner and mechanical hook-up and translation relation are coupled together, and the robustness and the accuracy of its demarcation are low.
Content of the present invention
The objective of the invention is to utilize the known spheroid of radius as instrument, realized the demarcation of relative position relation between laser scanner and the robot coordinate system, realized the decoupling zero of rotation relationship and translation relation, and process is simple, precision height and good stability.
For achieving the above object, the invention provides the scaling method of the relative position of a kind of laser scanner and robot, may further comprise the steps:
Step 1, scanner are relative with robot base static, spheroid of the terminal clamping of the mechanical arm of robot, and manipulator motion makes spheroid in the sweep limit of scanner;
Step 2, scanner are gathered the sweep trace on the described spheroid, calculate the coordinate of the centre of sphere of described spheroid with respect to scanner, and record mechanical arm end this moment is with respect to the coordinate of robot base;
Step 3, the terminal translation of control mechanical arm make spheroid still in the sweep limit of scanner;
Step 4, repeating step 2;
The attitude of step 5, change robot arm makes terminal translation of mechanical arm and rotation, repeating step 2-4;
Step 6, repeating step 5;
Step 7, calculate the rotation relation of scanner coordinate and robot base coordinate, promptly calculate the rotation matrix of scanner coordinate system and robot base coordinate sys-tem;
Step 8, control mechanical arm make the spheroid translation, and scanner scans spheroid in the process of spheroid translation, note spherome surface and are scanned a little with respect to the coordinate of scanner and the corresponding moment mechanical arm end coordinate with respect to robot base;
The attitude of step 9, change robot arm makes terminal translation of mechanical arm and rotation, repeating step 8;
Step 10 is calculated the translation relation of scanner coordinate and robot base coordinate, promptly calculates the translation matrix of scanner coordinate system and robot base coordinate sys-tem.
Described step 9 can be carried out repeatedly.Described step 6 can also for repeating step 5 once the scanner in the above method be line laser scanner.
The present invention also provides the scaling method of the relative position of a kind of laser scanner and robot, may further comprise the steps:
Step 1, spheroid are relative with robot base static, scanner of the terminal clamping of the mechanical arm of robot, and manipulator motion makes spheroid in the sweep limit of scanner;
Step 2, scanner are gathered the sweep trace on the described spheroid, calculate the coordinate of the centre of sphere of described spheroid with respect to scanner, and record mechanical arm end this moment is with respect to the coordinate of robot base;
Step 3, the terminal translation of control mechanical arm make spheroid still in the sweep limit of scanner;
Step 4, repeating step 2;
The attitude of step 5, change robot makes terminal translation of mechanical arm and rotation, repeating step 2-4;
Step 6, repeating step 5;
Step 7, calculate the rotation relation of scanner coordinate and the terminal coordinate of robot arm, promptly calculate the rotation matrix of scanner coordinate system and robot arm end coordinate system;
Step 8, control mechanical arm make the scanner translation, and scanner scans spheroid in the process of scanner translation, note spherome surface and are scanned a little with respect to the coordinate of scanner and the corresponding moment mechanical arm end coordinate with respect to robot base;
The attitude of step 9, change robot arm makes terminal translation of mechanical arm and rotation, repeating step 8;
Step 10, calculate the translation relation of scanner coordinate and the terminal coordinate of robot arm, promptly calculate the translation matrix of scanner coordinate system and robot arm end coordinate system.
Described step 9 can be carried out repeatedly.Described step 6 can also for repeating step 5 once more than.Scanner in the described method is a line laser scanner.
Therefore, the present invention has the following advantages:
1, utilize spheroid as instrument, realize demarcating, its process is simple;
2, utilize at the fixed method of the partial sweep make-game standard laid down by the ministries or commissions of the Central Government, can improve scanning and recover precision;
3, the decoupling zero of translation relation and rotation relationship be can realize, the stability and the precision of demarcating improved.
Below in conjunction with drawings and Examples, technical scheme of the present invention is described in further detail.
Description of drawings
Fig. 1 is the position view of the scaling method embodiment 1 of relative position of the present invention.
Fig. 2 is the method flow diagram of the scaling method embodiment 1 of relative position of the present invention.
Fig. 3 is the position view of the scaling method embodiment 2 of relative position of the present invention.
Fig. 4 is the method flow diagram of the scaling method embodiment 2 of relative position of the present invention.
Embodiment
Invention thought of the present invention is to utilize line laser scanner and a spheroid and realize when robot clamping scanner, demarcates the relation between scanner coordinate system and the robot end's coordinate system; When robot clamping spheroid, demarcate the relation between scanner coordinate system and the robot base coordinate sys-tem.Therefore this method is demarcated the mutual alignment relation of robot and line laser scanner, and line laser scanner is not only calibration tool, is still demarcated object.
Embodiment 1
As shown in Figure 1, be the synoptic diagram of the embodiment of the invention 1.Robot 1 have one can the clamping object mechanical arm 11, spheroid 3 of top 12 clampings of mechanical arm 11, robot 1 and line laser scanner 2 all are fixed in the world coordinate system, and spheroid 3 is within the sweep limit of scanner 2.Present embodiment is the position relation of demarcating between scanner 2 and the robot base 10, i.e. rotation matrix R between the coordinate system of the coordinate system of definite scanner 2 and base 10 sWith the translation matrix T sThe coordinate system on mechanical arm top 12 is made as Tool 0Coordinate system.
As shown in Figure 2, be the method flow diagram of the embodiment of the invention 1.
Step 101, scanner are relative with robot base static, spheroid of the terminal clamping of the mechanical arm of robot, and manipulator motion makes spheroid in the sweep limit of scanner;
Step 102, scanner are gathered the sweep trace on the described spheroid, calculate the coordinate of the centre of sphere of described spheroid with respect to scanner, and record mechanical arm end this moment is with respect to the coordinate of robot base;
Step 103, the terminal translation of control mechanical arm make spheroid still in the sweep limit of scanner;
Step 104, repeating step 102;
The attitude of step 105, change robot arm makes terminal translation of mechanical arm and rotation, repeating step 102-104;
Step 106, repeating step 105; Can repeat one or many;
Step 107, calculate the rotation relation of scanner coordinate and robot base coordinate, promptly calculate the rotation matrix of scanner coordinate system and robot base coordinate sys-tem;
Step 108, control mechanical arm make the spheroid translation, and scanner scans spheroid in the process of spheroid translation, note spherome surface and are scanned a little with respect to the coordinate of scanner and the corresponding moment mechanical arm end coordinate with respect to robot base;
The attitude of step 109, change robot arm makes terminal translation of mechanical arm and rotation, repeating step 8; In order to improve measuring accuracy, this step can be carried out repeatedly.
Step 110, calculate the translation relation of scanner coordinate and robot base coordinate, promptly calculate the translation matrix of scanner coordinate system and robot base coordinate sys-tem.
1, calculates the rotation relation of line laser scanner coordinate and robot base coordinate, promptly calculate the rotation matrix R of scanner coordinate and robot base coordinate s
For one and Tool 0The point of coordinate system stationkeeping (as the centre of sphere of spheroid), it is at Tool 0Under coordinate (x t, y t, z t) and its coordinate (x with respect to scanner coordinate system l, y l, z l) between relation satisfy:
X t 1 = R 0 T 0 0 1 - 1 · R s T s 0 1 · X l 1 . . . ( 1 )
Wherein, x tFor this point of fixity at Tool 0Coordinate under the coordinate system
Figure A20051005346000082
X lThe coordinate that recovers in scanner for this point of fixity (is its coordinate with respect to scanner
Figure A20051005346000083
R 0Be Tool 0With respect to the rotation matrix of robot base, T 0Be Tool 0With respect to the translation matrix of robot base, R sWith T sBe the scanner that to demarcate rotation and translation matrix with respect to base coordinate system.
After the expansion of (1) formula, can obtain:
R 0·X t+T 0=R s·X l+T s(2)
Control robot makes to obtain the same point of fixity of twice recovery of scanner:
R 01·X t+T 01=R s·X l1+T s(3)
R 02·X t+T 02=R s·X l2+T s(4)
The attitude of robot remains unchanged in the control procedure if make, i.e. R 01=R 02(4)-(3) can be obtained: T 02-T 01=R s(X L2-X L1) (5)
For line laser scanner, it is difficult finding the coordinate of a certain spatial point under scanner, can solve this problem by allowing scanner recover Virtual Space point (referring to the spheroid centre of sphere herein).When scanner was swept to spheroid, its laser rays simulated a space circle, measures radius of sphericity, gets the centre of sphere by the geometric relationship ball.But the centre of sphere will have two to separate, removing puppet by experiment in the process separates: the experimenter can be by the position judgment centre of sphere direction of sweep trace in spheroid, again by select upper, middle and lower portion 3 points in the sweep trace with about graded, with this advisory computing machine, computing machine then obtains two vectors according to these 3, obtain the roughly direction at centre of sphere place again by the result of these two vectorial multiplication crosses, separate thereby remove puppet.
By ball of step 101 robot clamping, move in the visual range of scanner, beat sweep trace on spheroid by the collection of step 102 scanner, obtain the coordinate of centre of sphere point under scanner, promptly draw X by top computing method L1, write down Tool at this moment 0Promptly from robot controller, read T 01By step 103, the control robot translation still makes ball in the visual range of scanner afterwards, beats sweep trace on spheroid by the collection of step 104 scanner again, recovers the coordinate of the centre of sphere under scanner, obtains X L2, and write down Tool at this moment 0Promptly from robot controller, read T 02So far, can obtain the data of one group of solving equation (5).Change robot pose by step 105 and step 106, once or once, gather a group or more experimental data substitution equation (5) as mentioned above again, can obtain Rx, Ry, Rz.
2, calculate the translation relation of scanner coordinate and robot base coordinate, promptly find the solution the translation matrix of scanner coordinate system and robot base coordinate sys-tem by the method for scanning sphere, calibrating parameters X, Y, Z:
By (2) Shi Kede, for Tool 0The spatial point of stationkeeping has:
X t=R 0 -1·(R s·X l+T s-T 0)=R 0 -1·(R s·X l-T 0)+R 0 -1T s(6)
In the three-dimensional reconfiguration system of above-mentioned scanner and robot combination, (spatial point is with respect to Tool for the restoration result of scanner 0The position of coordinate system) X tWith its coordinate X under scanner coordinate system lRelation shown in (6) formula.For different spaces point X T1With X T2, can obtain its relative position relation:
X t2-X t1=R 02 -1·(R s·X l2+T s-T 02)-R 01 -1·(R s·X l1+T s-T 01)(7)
When robot only carries out translation in scanning process is R 01=R 02The time, but the following formula abbreviation is:
X t2-X t1=R 0 -1·(R s·(X l2-X l1)-T 02+T 01(8)
Can obtain from (8) formula, when robot scans a sphere with translation (attitude is constant), T no matter sGet what value, its restoration result all is a sphere.Relative position relation between the result who recovers (body form that promptly recovers) only with rotation matrix R sRelevant.So in the three-dimensional reconfiguration system of above-mentioned scanner and robot combination, when robot only carries out translation in scanning process, the rotation matrix R during the mould shapes that scanner recovers is only demarcated with scanner sRelevant, and with translation relation T sIrrelevant.
Get T s=0, (be X with its scanning restoration result t) do spherical match, the sphere center position X that obtains BActual position X with the centre of sphere bBetween will satisfy (6) formula, that is:
X b=X B+R 0 -1T s(9)
By step 108, control robot is carried out translation scanning.In scanning process, be scanned the some coordinate under scanner and the Tool in the corresponding moment with noting 0According to (6) formula, get T s=0, can carry out the 3-d recovery of the sphere that scanned, utilize the result who recovers to carry out the sphere match, can obtain the X in (7) formula B, write down Tool this moment simultaneously 0Change the robot posture once or once by step 109, as stated above, obtain a group or more X again BAnd Tool 0Value utilizes equation (7) can solve T s, draw X, Y, Z.
This method utilizes spheroid as instrument, realizes demarcating, and its process is simple; In calibration process, (Rx, Ry is Rz) with translation relation (X, Y, Z) decoupling zero, raising result's stability and precision to make its rotation relationship.
Embodiment 2
As shown in Figure 3, be the synoptic diagram of the embodiment of the invention 2.Robot 1 have one can the clamping object mechanical arm 11, scanner 2 of top 12 clampings of mechanical arm 11, robot 1 and spheroid 3 all are fixed in the world coordinate system, and spheroid 3 is within the sweep limit of line laser scanner 2.Present embodiment is the position relation of demarcating between scanner 2 and the mechanical arm top 12, i.e. rotation matrix R between the coordinate system on the coordinate system of definite scanner 2 and mechanical arm top 12 sWith the translation matrix T sThe coordinate system on mechanical arm top 12 is made as Tool 0Coordinate system.
As shown in Figure 4, be the method flow diagram of the embodiment of the invention 2.
Step 201, spheroid are relative with robot base static, scanner of the terminal clamping of the mechanical arm of robot, and manipulator motion makes spheroid in the sweep limit of scanner;
Step 202, scanner are gathered the sweep trace on the spheroid, calculate the coordinate of the centre of sphere of spheroid with respect to scanner, and record mechanical arm end this moment is with respect to the coordinate of robot base;
Step 203, the terminal translation of control mechanical arm make spheroid still in the sweep limit of scanner;
Step 204, repeating step 202;
The attitude of step 205, change robot makes terminal translation of mechanical arm and rotation, repeating step 202-204;
Step 206, repeating step 205; More than can repeating once also to repeat once.
Step 207, calculate the rotation relation of scanner coordinate and the terminal coordinate of robot arm, promptly calculate the rotation matrix of scanner coordinate system and robot arm end coordinate system;
Step 208, control mechanical arm make the scanner translation, and scanner scans spheroid in the process of scanner translation, note spherome surface and are scanned a little with respect to the coordinate of scanner and the corresponding moment mechanical arm end coordinate with respect to robot base; Utilize the method for partial sweep, can improve scanning and recover precision;
The attitude of step 209, change robot arm makes terminal translation of mechanical arm and rotation, repeating step 208; In order to improve precision, this step can be carried out repeatedly.
Step 210, calculate the translation relation of scanner coordinate and the terminal coordinate of robot arm, promptly calculate the translation matrix of scanner coordinate system and robot arm end coordinate system.
1, calculates the rotation relation of scanner coordinate system and robot arm top coordinate system, promptly calculate the rotation matrix R of scanner coordinate system and robot arm top coordinate system s
For a point (as the spheroid centre of sphere) with the robot base coordinate sys-tem stationkeeping, its coordinate (x under base coordinate system w, y w, z w) and its coordinate (x with respect to scanner coordinate system l, y l, z l) between relation satisfy:
X w 1 = R 0 T 0 0 1 · R t T t 0 1 · X l 1 . . . ( 10 )
Wherein, X wBe the coordinate of this point of fixity under base coordinate system
Figure A20051005346000122
X lThe coordinate that recovers in scanner for this point of fixity (is its coordinate with respect to scanner
Figure A20051005346000123
R 0Be Tool 0With respect to the rotation matrix of base coordinate system, T 0Be Tool 0With respect to the translation matrix of base coordinate system, R tWith T tBe that the scanner that will demarcate is with respect to Tool 0Rotation and translation matrix.
After the expansion of (10) formula, can obtain:
X w=R 0·R t·X l+R 0·T t+T 0(11)
Control robot makes the same point of fixity of twice recovery of scanner, can obtain:
X w1=R 01·R t·X l1+R 01·T t+T 01(12)
X w2=R 02·R t·X l2+R 02·T t+T 02(13)
The attitude of robot remains unchanged in the control procedure if make, i.e. X W1=X W2, R 01=R 02, (13)-(12) can be obtained:
R 0·R t·(X l1-X l2)=T 02-T 01(14)
For line laser scanner, it is difficult finding the coordinate of a certain spatial point under scanner, can solve this problem by allowing scanner recover Virtual Space point (referring to the spheroid centre of sphere herein).When scanner was swept to spheroid, its laser rays simulated a space circle, measures radius of sphericity, gets the centre of sphere by the geometric relationship ball.But the centre of sphere will have two to separate, removing puppet by experiment in the process separates: the experimenter can be by the position judgment centre of sphere direction of sweep trace in spheroid, again by select upper, middle and lower portion 3 points in the sweep trace with about graded, with this advisory computing machine, computing machine then obtains two vectors according to these 3, obtain the roughly direction at centre of sphere place again by the result of these two vectorial multiplication crosses, separate thereby remove puppet.
By step 201 robot clamping scanner, move to a spheroid being fixed in the world coordinates around, make this spheroid in the visual range of scanner, by step 202, the sweep trace on spheroid is beaten in the scanner collection, obtains the coordinate of centre of sphere point under scanner, writes down the Tool of this moment 0Promptly from robot controller, read T 01And R 0By step 203, the control robot translation still makes ball in the visual range of scanner afterwards, beats sweep trace on spheroid by the collection of step 204 scanner again, recovers the coordinate of the centre of sphere under scanner, and writes down the Tool of this moment 0Promptly from robot controller, read T 02And R 0So far, can obtain the experimental data of one group of solving equation (14).Change robot pose once or once by step 205 and step 206, gather a group or more experimental data as mentioned above again, substitution equation (14) can be obtained Rx, Ry, Rz.
2, calculate the translation relation of scanner coordinate and mechanical arm top coordinate, promptly find the solution the translation matrix of scanner coordinate system and mechanical arm top coordinate system by the method for scanning sphere, calibrating parameters X, Y, Z:
By (11) Shi Kede, for basis coordinates be that the spatial point of stationkeeping has:
X w=R 0·R t·X l+R 0·T t+T 0(15)
In the three-dimensional reconfiguration system of above-mentioned scanner and robot combination, the restoration result of scanner (spatial point is with respect to the position of base coordinate system) X wWith its coordinate X under scanner coordinate system lRelation shown in (15) formula.For different spaces point X W1With X W2, can obtain its relative position relation:
X w2-X w1=R 02·R t·X l2+R 02·T t+T 02-(R 01·R t·X l1+R 01·T t+T 01)(16)
When robot only carries out translation in scanning process is R 01=R 02The time, but the following formula abbreviation is:
X w2-X w1=R 0·R t·(X l2-X l1)+T 02-T 01(17)
Can obtain from (17) formula, when robot scans a sphere with translation (attitude is constant), T no matter tGet what value, its restoration result all is a sphere.Relative position relation between the result who recovers (body form that promptly recovers) only with rotation matrix R tRelevant.In the three-dimensional reconfiguration system of above-mentioned scanner and robot combination, when robot only carries out translation in scanning process, the rotation matrix R during the mould shapes that scanner recovers is only demarcated with scanner tRelevant, and with translation relation T tIrrelevant.Get T t=0, (be X with its scanning restoration result w) do spherical match, the sphere center position X that obtains BActual position X with the centre of sphere bBetween will satisfy (15) formula, that is:
X b=X B+R 0·T t(18)
Carry out translation scanning by step 208 control robot, in scanning process, note and be scanned the some coordinate under scanner and the Tool in the corresponding moment 0According to (15) formula, get T t=0, can carry out the 3-d recovery of the sphere that scanned, utilize the result who recovers to carry out the sphere match, can obtain the X in (18) formula B, write down Tool this moment simultaneously 0Change robot pose once or once by step 209 again, as stated above, obtain a group or more X again BAnd Tool 0Value utilizes equation (18) can solve T s, promptly draw X, Y, Z.
This method utilizes spheroid as instrument, realizes demarcating, and its process is simple; In calibration process, (Rx, Ry is Rz) with translation relation (X, Y, decoupling zero Z), raising result's stability and precision to have realized rotation relationship.
It should be noted last that, above embodiment is only unrestricted in order to technical scheme of the present invention to be described, although the present invention is had been described in detail with reference to preferred embodiment, those of ordinary skill in the art is to be understood that, can make amendment or be equal to replacement technical scheme of the present invention, and not breaking away from the spirit and scope of technical solution of the present invention, it all should be encompassed in the middle of the claim scope of the present invention.

Claims (8)

1, the scaling method of the relative position of a kind of laser scanner and robot is characterized in that may further comprise the steps:
Step 1, scanner are relative with robot base static, spheroid of the terminal clamping of the mechanical arm of robot, and manipulator motion makes spheroid in the sweep limit of scanner;
Step 2, scanner are gathered the sweep trace on the described spheroid, calculate the coordinate of the centre of sphere of described spheroid with respect to scanner, and record mechanical arm end this moment is with respect to the coordinate of robot base;
Step 3, the terminal translation of control mechanical arm make spheroid still in the sweep limit of scanner;
Step 4, repeating step 2;
The attitude of step 5, change robot arm makes terminal translation of mechanical arm and rotation, repeating step 2-4;
Step 6, repeating step 5;
Step 7, calculate the rotation relation of scanner coordinate and robot base coordinate, promptly calculate the rotation matrix of scanner coordinate system and robot base coordinate sys-tem;
Step 8, control mechanical arm make the spheroid translation, and scanner scans spheroid in the process of spheroid translation, note spherome surface and are scanned a little with respect to the coordinate of scanner and the corresponding moment mechanical arm end coordinate with respect to robot base;
The attitude of step 9, change robot arm makes terminal translation of mechanical arm and rotation, repeating step 8;
Step 10, calculate the translation relation of scanner coordinate and robot base coordinate, promptly calculate the translation matrix of scanner coordinate system and robot base coordinate sys-tem.
2, the scaling method of the relative position of laser scanner according to claim 1 and robot is characterized in that: described step 9 is carried out repeatedly.
3, the scaling method of the relative position of laser scanner according to claim 1 and robot is characterized in that: described step 6 can also for repeating step 5 once more than.
4, the scaling method of the relative position of laser scanner according to claim 1 and robot is characterized in that: the scanner in the described method is a line laser scanner.
5, the scaling method of the relative position of a kind of laser scanner and robot is characterized in that may further comprise the steps:
Step 1, spheroid are relative with robot base static, scanner of the terminal clamping of the mechanical arm of robot, and manipulator motion makes spheroid in the sweep limit of scanner;
Step 2, scanner are gathered the sweep trace on the described spheroid, calculate the coordinate of the centre of sphere of described spheroid with respect to scanner, and record mechanical arm end this moment is with respect to the coordinate of robot base;
Step 3, the terminal translation of control mechanical arm make spheroid still in the sweep limit of scanner;
Step 4, repeating step 2;
The attitude of step 5, change robot makes terminal translation of mechanical arm and rotation, repeating step 2-4;
Step 6, repeating step 5;
Step 7, calculate the rotation relation of scanner coordinate and the terminal coordinate of robot arm, promptly calculate the rotation matrix of scanner coordinate system and robot arm end coordinate system;
Step 8, control mechanical arm make the scanner translation, and scanner scans spheroid in the process of scanner translation, note spherome surface and are scanned a little with respect to the coordinate of scanner and the corresponding moment mechanical arm end coordinate with respect to robot base;
The attitude of step 9, change robot arm makes terminal translation of mechanical arm and rotation, repeating step 8;
Step 10, calculate the translation relation of scanner coordinate and the terminal coordinate of robot arm, promptly calculate the translation matrix of scanner coordinate system and robot arm end coordinate system.
6, the scaling method of the relative position of laser scanner according to claim 5 and robot is characterized in that: described step 9 is carried out repeatedly.
7, the scaling method of the relative position of laser scanner according to claim 5 and robot is characterized in that: described step 6 can also for repeating step 5 once more than.
8, the scaling method of the relative position of laser scanner according to claim 5 and robot is characterized in that: the scanner in the described method is a line laser scanner.
CNB2005100534601A 2005-03-10 2005-03-10 Method for deciding relative position of laser scanner and robot Expired - Fee Related CN100338433C (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CNB2005100534601A CN100338433C (en) 2005-03-10 2005-03-10 Method for deciding relative position of laser scanner and robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CNB2005100534601A CN100338433C (en) 2005-03-10 2005-03-10 Method for deciding relative position of laser scanner and robot

Publications (2)

Publication Number Publication Date
CN1831468A true CN1831468A (en) 2006-09-13
CN100338433C CN100338433C (en) 2007-09-19

Family

ID=36993894

Family Applications (1)

Application Number Title Priority Date Filing Date
CNB2005100534601A Expired - Fee Related CN100338433C (en) 2005-03-10 2005-03-10 Method for deciding relative position of laser scanner and robot

Country Status (1)

Country Link
CN (1) CN100338433C (en)

Cited By (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101239552B (en) * 2007-02-08 2012-07-04 星云电脑股份有限公司 Method for correcting laser carving machine mechanism relative position
CN103033183A (en) * 2012-12-14 2013-04-10 中国航空工业集团公司北京长城航空测控技术研究所 Indoor precise positioning system and method for industrial robot
CN104132616A (en) * 2014-08-19 2014-11-05 苏州北硕检测技术有限公司 Hand-eye calibration method and system for measuring robot through laser
CN104165584A (en) * 2013-05-17 2014-11-26 上海三菱电梯有限公司 Non-contact high-precision calibration method and application of base reference coordinate system of robot
CN105157567A (en) * 2015-05-15 2015-12-16 天津智通机器人有限公司 Tool coordinate system calibration method and system for measurement robot
CN105424024A (en) * 2015-11-03 2016-03-23 葛洲坝易普力股份有限公司 Spatial target position and orientation calibration method based on total station
CN105444672A (en) * 2015-12-17 2016-03-30 华科精准(北京)医疗科技有限公司 Orthogonal plane calibrating method and orthogonal plane calibrating system of relation between laser distance measuring device and end of mechanical arm
CN104132616B (en) * 2014-08-19 2017-01-04 苏州北硕检测技术有限公司 The hand and eye calibrating method of laser measurement machine people and system
CN107140540A (en) * 2017-07-05 2017-09-08 三汽车起重机械有限公司 Crane large arm single-point or 2 angle calibration methods and crane
CN107270833A (en) * 2017-08-09 2017-10-20 武汉智诺维科技有限公司 A kind of complex curved surface parts three-dimension measuring system and method
CN108286946A (en) * 2018-01-30 2018-07-17 周蕊 The method and system of sensing station mark fixed sum data splicing
CN108290287A (en) * 2015-11-04 2018-07-17 富兰卡爱米卡股份有限公司 Robot with the control that the discretization to position and/or posture is manually entered
CN108582076A (en) * 2018-05-10 2018-09-28 武汉库柏特科技有限公司 A kind of Robotic Hand-Eye Calibration method and device based on standard ball
CN108692688A (en) * 2018-04-28 2018-10-23 武汉理工大学 A kind of robot measurement-system of processing scanner coordinate system automatic calibration method
CN109176517A (en) * 2018-09-10 2019-01-11 武汉久同智能科技有限公司 Series connection industrial robot link parameters scaling method based on the constraint of end name point
CN110116411A (en) * 2019-06-06 2019-08-13 浙江汉振智能技术有限公司 A kind of robot 3D vision hand and eye calibrating method based on ball target
CN110539330A (en) * 2019-09-05 2019-12-06 亿嘉和科技股份有限公司 robot navigation system position calibration device and calibration method thereof
CN110986782A (en) * 2019-12-26 2020-04-10 苏州伟信奥图智能科技有限公司 Calibration method suitable for manipulator
CN111152216A (en) * 2019-12-30 2020-05-15 福州国化智能技术有限公司 Method for automatically correcting tool center point of industrial robot
CN111633651A (en) * 2020-05-28 2020-09-08 杜思傲 TCP calibration method for hollow tubular tool
CN111791223A (en) * 2019-04-01 2020-10-20 发那科株式会社 Calibration device
CN112361958A (en) * 2020-11-04 2021-02-12 同济大学 Line laser and mechanical arm calibration method
CN114347027A (en) * 2022-01-08 2022-04-15 天晟智享(常州)机器人科技有限公司 Pose calibration method of 3D camera relative to mechanical arm
CN115112022A (en) * 2022-08-30 2022-09-27 枣庄市胜达精密铸造有限公司 Blank casting laser measurement system

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08272414A (en) * 1995-03-29 1996-10-18 Fanuc Ltd Calibrating method for robot and visual sensor using hand camera
CN1115545C (en) * 1999-08-23 2003-07-23 胡修泰 Angular coordinate measuring method for point and novel wheel positioning device
JP2002118730A (en) * 2000-10-06 2002-04-19 Citizen Electronics Co Ltd Handy scanner
JP2002307346A (en) * 2001-04-18 2002-10-23 Mitsubishi Electric Corp Method and device for calibrating visual coordinates of robot

Cited By (34)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101239552B (en) * 2007-02-08 2012-07-04 星云电脑股份有限公司 Method for correcting laser carving machine mechanism relative position
CN103033183B (en) * 2012-12-14 2015-07-01 中国航空工业集团公司北京长城航空测控技术研究所 Indoor precise positioning system and method for industrial robot
CN103033183A (en) * 2012-12-14 2013-04-10 中国航空工业集团公司北京长城航空测控技术研究所 Indoor precise positioning system and method for industrial robot
CN104165584A (en) * 2013-05-17 2014-11-26 上海三菱电梯有限公司 Non-contact high-precision calibration method and application of base reference coordinate system of robot
CN104132616B (en) * 2014-08-19 2017-01-04 苏州北硕检测技术有限公司 The hand and eye calibrating method of laser measurement machine people and system
CN104132616A (en) * 2014-08-19 2014-11-05 苏州北硕检测技术有限公司 Hand-eye calibration method and system for measuring robot through laser
CN105157567B (en) * 2015-05-15 2017-10-10 天津智通机器人有限公司 The tool coordinates system scaling method and system of a kind of robot measurement
CN105157567A (en) * 2015-05-15 2015-12-16 天津智通机器人有限公司 Tool coordinate system calibration method and system for measurement robot
CN105424024B (en) * 2015-11-03 2018-05-29 葛洲坝易普力股份有限公司 A kind of position and orientation scaling method of the extraterrestrial target based on total powerstation
CN105424024A (en) * 2015-11-03 2016-03-23 葛洲坝易普力股份有限公司 Spatial target position and orientation calibration method based on total station
US10994415B2 (en) 2015-11-04 2021-05-04 Franka Emika Gmbh Robot with control system for discrete manual input of positions and/or poses
CN108290287A (en) * 2015-11-04 2018-07-17 富兰卡爱米卡股份有限公司 Robot with the control that the discretization to position and/or posture is manually entered
CN105444672B (en) * 2015-12-17 2017-10-17 华科精准(北京)医疗科技有限公司 Orthogonal plane calibration method and system for relation between laser range finder and tail end of mechanical arm
CN105444672A (en) * 2015-12-17 2016-03-30 华科精准(北京)医疗科技有限公司 Orthogonal plane calibrating method and orthogonal plane calibrating system of relation between laser distance measuring device and end of mechanical arm
CN107140540A (en) * 2017-07-05 2017-09-08 三汽车起重机械有限公司 Crane large arm single-point or 2 angle calibration methods and crane
CN107270833A (en) * 2017-08-09 2017-10-20 武汉智诺维科技有限公司 A kind of complex curved surface parts three-dimension measuring system and method
CN108286946A (en) * 2018-01-30 2018-07-17 周蕊 The method and system of sensing station mark fixed sum data splicing
CN108692688A (en) * 2018-04-28 2018-10-23 武汉理工大学 A kind of robot measurement-system of processing scanner coordinate system automatic calibration method
CN108582076A (en) * 2018-05-10 2018-09-28 武汉库柏特科技有限公司 A kind of Robotic Hand-Eye Calibration method and device based on standard ball
CN109176517B (en) * 2018-09-10 2021-04-30 武汉久同智能科技有限公司 Series industrial robot connecting rod parameter calibration method based on terminal nominal point constraint
CN109176517A (en) * 2018-09-10 2019-01-11 武汉久同智能科技有限公司 Series connection industrial robot link parameters scaling method based on the constraint of end name point
CN111791223A (en) * 2019-04-01 2020-10-20 发那科株式会社 Calibration device
CN110116411A (en) * 2019-06-06 2019-08-13 浙江汉振智能技术有限公司 A kind of robot 3D vision hand and eye calibrating method based on ball target
CN110539330A (en) * 2019-09-05 2019-12-06 亿嘉和科技股份有限公司 robot navigation system position calibration device and calibration method thereof
CN110986782A (en) * 2019-12-26 2020-04-10 苏州伟信奥图智能科技有限公司 Calibration method suitable for manipulator
CN111152216A (en) * 2019-12-30 2020-05-15 福州国化智能技术有限公司 Method for automatically correcting tool center point of industrial robot
CN111152216B (en) * 2019-12-30 2022-04-26 福州国化智能技术有限公司 Method for automatically correcting tool center point of industrial robot
CN111633651B (en) * 2020-05-28 2021-01-29 杭州键嘉机器人有限公司 TCP calibration method for hollow tubular tool
CN111633651A (en) * 2020-05-28 2020-09-08 杜思傲 TCP calibration method for hollow tubular tool
WO2021238104A1 (en) * 2020-05-28 2021-12-02 杭州键嘉机器人有限公司 Tcp calibration method for hollow tubular tool
CN112361958A (en) * 2020-11-04 2021-02-12 同济大学 Line laser and mechanical arm calibration method
CN112361958B (en) * 2020-11-04 2022-06-21 同济大学 Line laser and mechanical arm calibration method
CN114347027A (en) * 2022-01-08 2022-04-15 天晟智享(常州)机器人科技有限公司 Pose calibration method of 3D camera relative to mechanical arm
CN115112022A (en) * 2022-08-30 2022-09-27 枣庄市胜达精密铸造有限公司 Blank casting laser measurement system

Also Published As

Publication number Publication date
CN100338433C (en) 2007-09-19

Similar Documents

Publication Publication Date Title
CN100338433C (en) Method for deciding relative position of laser scanner and robot
CN1305443C (en) Ultrasound wave imaging equipment
CN100346356C (en) Information processing apparatus and method, program, and navigation apparatus
CN1959740A (en) Image processing method and device, program for processing image, and storage medium thereof
CN1091270C (en) Parts testing method
CN1109488C (en) Electronic part mounting apparatus
JP2017100240A (en) Control device, robot and robot system
CN101067872A (en) Method for checking two-dimensional draft data from tri-dimensional reverse modeling source model data
CN1816729A (en) Three-dimensional shape measuring method and measuring apparatus thereof
CN1747816A (en) A method and a system for programming an industrial robot to move relative to defined positions on an object, including generation of a surface scanning program
CN101063881A (en) Numerical controller
CN1792678A (en) Detection system, occupant protection device, vehicle, and detection method
CN1788282A (en) Statistical dynamic modelling method and apparatus
CN101046506A (en) Method of correcting gradient deformation of magnetic resonant image based on spherical harmonic function
CN101029902A (en) Non-oriented multi-position and high-precision calibrating method for inertial measuring unit
CN101067628A (en) Vector correcting method for non-gyro accelerometer array mounting error
JP2021079468A (en) Control device, control system, robot system and controlling method
CN1851752A (en) Dual video camera calibrating method for three-dimensional reconfiguration system
CN1943512A (en) Device and method for determining interesting zone
CN1801889A (en) Back-up rearview device
CN1225502A (en) Method of separating chips from semiconductor wafer
CN1612167A (en) Movement of a virtual articulated object in a virtual environment by preventing internal collisions between the articulated elements of the articulated object
CN1294539C (en) Triangle polygon plotting device and triangle polygon plotting method
CN1285449C (en) Polygonal-target multi-finger grab planning method and apparatus
CN1270870C (en) Cam machining process

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
ASS Succession or assignment of patent right

Owner name: ZHITONG ROBOT SYSTEM CO., LTD., LANGFANG CITY

Free format text: FORMER OWNER: XINAO BOWEI TECHNOLOGY CO., LTD.

Effective date: 20150608

C41 Transfer of patent application or patent right or utility model
TR01 Transfer of patent right

Effective date of registration: 20150608

Address after: Hongrun road 065001 Langfang City Development Zone in Hebei Province

Patentee after: INTERSMART ROBOTIC SYSTEMS Co.,Ltd.

Address before: 065001 Langfang City, Hebei Province Economic and Technological Development Zone Langfang Huaxiang

Patentee before: XINAO MDT TECHNOLOGY Co.,Ltd.

TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20180824

Address after: 300000 Tianjin Dongli District Tianjin free trade pilot area (Airport Economic Zone) Aviation Road 278 office building, block C.

Patentee after: TIANJIN ZHITONG INFORMATION SYSTEM INTEGRATION Co.,Ltd.

Address before: 065001 Hebei province Langfang City Development Zone Hongrun Road

Patentee before: INTERSMART ROBOTIC SYSTEMS Co.,Ltd.

CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20070919

CF01 Termination of patent right due to non-payment of annual fee