CN106780627A - A kind of position orientation relation scaling method of all-purpose robot and positioner - Google Patents
A kind of position orientation relation scaling method of all-purpose robot and positioner Download PDFInfo
- Publication number
- CN106780627A CN106780627A CN201611198507.8A CN201611198507A CN106780627A CN 106780627 A CN106780627 A CN 106780627A CN 201611198507 A CN201611198507 A CN 201611198507A CN 106780627 A CN106780627 A CN 106780627A
- Authority
- CN
- China
- Prior art keywords
- positioner
- robot
- outside axle
- outside
- axle
- 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.)
- Pending
Links
- 239000011159 matrix material Substances 0.000 claims abstract description 7
- 230000001131 transforming Effects 0.000 claims abstract description 7
- 235000010384 tocopherol Nutrition 0.000 claims description 7
- 235000019731 tricalcium phosphate Nutrition 0.000 claims description 7
- 230000000875 corresponding Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000003466 welding Methods 0.000 description 20
- 238000004519 manufacturing process Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000000034 method Methods 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004805 robotic Methods 0.000 description 1
Abstract
The invention discloses a kind of all-purpose robot and the position orientation relation scaling method of positioner, comprise the following steps:(1) each outside axle is demarcated respectively, obtains its axial vector zn, n=1 .., N, wherein n are outside axle sequence number, and N is the outside number of axle;(2) according to the axial vector z of each outside axlenObtain module and carriage transformation matrixThe method does not have special requirement for the position relationship between the axle of multiple outside, and versatility is stronger.
Description
Technical field
The invention belongs to all-purpose robot application field, and in particular between a kind of all-purpose robot and multiaxis positioner
Position orientation relation scaling method.
Background technology
Most widely used robot is welding robot in industry manufacture field, especially in auto manufacturing, weldering
The usage amount of welding robot accounts for 50% in industrial robot total amount.Welding robot is that a kind of supermatic welding sets
It is standby, be the development trend of welding manufacture industry instead of manual welding operation using robot, be improve welding quality, reduces cost,
Improve the important means of working environment.Welding robot system is made up of robot, positioner and controller, typically using machine
The outside s function of device people's controller controls the motion of positioner, realizes coordinating welding.
The effect of outside axle be with this mates of robotic, make workpiece conjugate or shift, reach robot most
Good job position.In the application of outside axle, it is exactly most widely that the cooperating of welding robot and outside axle coordinates fortune
Dynamic, the welding for being used to turn round work using outside axle is conjugated, to obtain preferable Working position and speed of welding.It is substantially outside
Axle is the expansion of the welding machine joint of robot free degree and the extension of working space.The separate unit welding robot that the application of outside axle is
Operating flexibility it is stronger, the size of welding workpiece is also no longer limited by the working space of robot itself in theory.Outside axle
The a variety of limitation occurred largely in the weld job of compensate for over.It can be said that outside axle has become bonding machine
Device people breaks through the new fulcrum of itself limitation.Certainly, the key of positioner successful Application is the coordination control with welding robot
System.And robot and the premise that the demarcation of the position orientation relation of outside axle is robot and the efficient coordinated movement of various economic factors of positioner.
System based on welding robot with outside axle composition, robot is machine with the demarcation of the position orientation relation of outside axle
People and the premise of the efficient coordinated movement of various economic factors of outside axle, are also the practical key of off-line programming technique.Harbin Institute of Technology Liu is holy
Auspicious Master's thesis " arc welding robot off-line programing practical research " proposes 5 standardizations of the positioner that inclines based on rotation, record
TCP points are demarcated in five pose data of different positions by calculate be capable of achieving.The method is simple and quick, but is vulnerable to
The influence of accidentalia, random error is larger, it is difficult to meet the requirement of precision welding.Shanghai Communications University, the paper of Zhang Ke
A kind of multi-point calibration method that " scaling method of position relationship between welding robot and position changer " is proposed, there is larger limitation,
Position to outside axle requires, and only corresponds to the demarcation of twin shaft positioner.
The content of the invention
Goal of the invention:For problems of the prior art, become the invention discloses a kind of all-purpose robot and multiaxis
Position orientation relation scaling method between the machine of position, the method does not have special requirement for the position relationship between the axle of multiple outside,
Versatility is stronger.
Technical scheme:A kind of all-purpose robot and the position orientation relation scaling method of positioner, comprise the following steps:
Step 1, each outside axle is demarcated respectively, obtain its axial vector zn, n=1 .., N, wherein n are outside axle sequence
Number, N is the outside number of axle;
Step 2, the axial vector z according to each outside axlenObtain module and carriage transformation matrix
Specifically, an outside axle J is demarcated in step 1nThe step of include:
(11) anchor point is installed on the outside axle chuck, it is uniform in the outside axle range of movement to choose M
It is individual, operational group is transformed under robot-teaching pattern, keep that other outside shaft positions are constant, operation robot makes machine
The TCP points of people are overlapped with anchor point, and positioner is gone to the M position of point of selection, record the pose data of corresponding TCP points
Pm(Xm,Ym,Zm), wherein m=1..M;
(12) according to M pose data Pm(Xm,Ym,Zm) fit optimal disc;Cross the center of circle O of the optimal discn
(An,Bn,Cn) do the normal vector of the disc, the axial vector z of as described outside axlen。
Specifically, step (2) includes:
(21) origin of coordinates O (A, B, C) of positioner basis coordinates system is calculated;
To outside axle J1M pose data sampling point Pm(Xm,Ym,Zm) fit optimal sphere:
(X-A)2+(Y-B)2+(Z-C)2=D2
Wherein sphere centre coordinate O (A, B, C) is the origin of coordinates of positioner basis coordinates system;
(22) according to the axial vector z of each outside axlenCalculate the unit vector of the X, Y, Z axis of positioner basis coordinates system:
The unit vector of Z-direction is:
The unit vector of X-direction is:
The unit vector of Y direction is:
(23) module and carriage transformation matrix of the positioner basis coordinates system relative to robot basis coordinates system is obtained
Wherein I (ix,iy,iz) it is X-axis unit vectorJ(jx,jy,jz) it is Y-axis unit vectorK(kx,ky,kz) it is Z
Axle unit vectorO (A, B, C) is the origin of coordinates of positioner basis coordinates system.
Preferably, the optimal disc of least square fitting is used in step (12).
Preferably, the optimal sphere of least square fitting is used in step (21).
Preferably, 5 points, i.e. M=5 are uniformly chosen in the outside axle range of movement in step (11).
Beneficial effect:Compared with prior art, all-purpose robot disclosed by the invention is demarcated with the position orientation relation of positioner
Method has advantages below:1st, method disclosed by the invention is applied to various positioners, and multiple outside axle can be demarcated;
2nd, there is no special requirement to the position relationship between outside axle, outside axle and the position relationship of robot, the mechanism of positioner,
Highly versatile;3rd, multiple points are chosen in the demarcation of each outside axle, and the precision of demarcation has very big carrying relative to conventional method
It is high.
Brief description of the drawings
Fig. 1 is the coordinate system schematic diagram of multiaxis positioner;
Fig. 2 is multiaxis positioner outside axle calibration process schematic diagram.
Specific embodiment
With reference to the accompanying drawings and detailed description, the present invention is furture elucidated.
The present embodiment further explains method disclosed by the invention by taking twin shaft positioner as an example.This positioner around rotary shaft and
Sloping shaft rotates respectively, can move to multiple positions, and each outside axle gathers 5 pose numbers of location point in the present embodiment
According to.
A kind of all-purpose robot and the position orientation relation scaling method of positioner, comprise the following steps:
Step 1, each outside axle is demarcated respectively, obtain its axial vector zn, n=1 .., N, wherein n are outside axle sequence
Number, N is the outside number of axle;
First, rotary shaft J is demarcated1The step of include:
(11) in J1One anchor point is installed, anchor point functions as a datum mark, in J on chuck1Range of movement
5 points of interior uniform selection, select to be respectively -60 °, -30 °, 0 °, 30 °, 60 ° five relative to the angle of anchor point in the present embodiment
Individual position;Operational group is transformed under robot-teaching pattern, holding inclination shaft position is constant, and operation robot makes robot
TCP points overlapped with anchor point, positioner is gone to 5 positions of point of selection respectively, record the pose number of corresponding TCP points
According to Pu(Xu,Yu,Zu), wherein u=1..5;
(12) according to 5 pose data P of collectionu(Xu,Yu,Zu), optimal disc is gone out using least square fitting;Cross
The center of circle O of the optimal disc1(A1,B1,C1) do the normal vector of the disc, as the axial vector z of rotary shaft1。
Similarly, to sloping shaft J2Demarcated, obtained J2Axial vector z2。
Step 2, according to axial vector z1And z2Obtain module and carriage transformation matrixSpecifically include following steps:
(21) origin of coordinates O (A, B, C) of positioner basis coordinates system is calculated;
To rotary shaft J15 pose data sampling point Pu(Xu,Yu,Zu) optimal sphere is gone out using least square fitting:
(X-A)2+(Y-B)2+(Z-C)2=D2
Wherein sphere centre coordinate O (A, B, C) is the origin of coordinates of positioner basis coordinates system;
(22) according to axial vector z1And z2Calculate the unit vector of the X, Y, Z axis of positioner basis coordinates system:
The unit vector of Z-direction is:
The unit vector of X-direction is:
The unit vector of Y direction is:
(23) module and carriage transformation matrix of the positioner basis coordinates system relative to robot basis coordinates system is obtained
Wherein I (ix,iy,iz) it is X-axis unit vectorJ(jx,jy,jz) it is Y-axis unit vectorK(kx,ky,kz) it is Z
Axle unit vectorO (A, B, C) is the origin of coordinates of positioner basis coordinates system.
Claims (6)
1. the position orientation relation scaling method of a kind of all-purpose robot and positioner, it is characterised in that comprise the following steps:
(1) each outside axle is demarcated respectively, obtains its axial vector zn, n=1 .., N, wherein n are outside axle sequence number, and N is outside
The number of axle;
(2) according to the axial vector z of each outside axlenObtain module and carriage transformation matrix
2. the position orientation relation scaling method of all-purpose robot according to claim 1 and positioner, it is characterised in that step
(1) an outside axle J is demarcated innSpecific steps include:
(11) anchor point is installed on the outside axle chuck, M point is uniformly chosen in the outside axle range of movement,
Operational group is transformed under robot-teaching pattern, keeps that other outside shaft positions are constant, operation robot makes robot
TCP points are overlapped with anchor point, and positioner is gone to the M position of point of selection, record the pose data P of corresponding TCP pointsm
(Xm,Ym,Zm), wherein m=1..M;
(12) according to M pose data Pm(Xm,Ym,Zm) fit optimal disc;Cross the center of circle O of the optimal discn(An,Bn,
Cn) do the normal vector of the disc, the axial vector z of as described outside axlen。
3. the position orientation relation scaling method of all-purpose robot according to claim 1 and positioner, it is characterised in that step
(2) specifically include:
(21) origin of coordinates O (A, B, C) of positioner basis coordinates system is calculated;
To outside axle J1M pose data sampling point Pm(Xm,Ym,Zm) fit optimal sphere:
(X-A)2+(Y-B)2+(Z-C)2=D2
Wherein sphere centre coordinate O (A, B, C) is the origin of coordinates of positioner basis coordinates system;
(22) according to the axial vector z of each outside axlenCalculate the unit vector of the X, Y, Z axis of positioner basis coordinates system:
The unit vector of Z-direction is:
The unit vector of X-direction is:
The unit vector of Y direction is:
(23) module and carriage transformation matrix of the positioner basis coordinates system relative to robot basis coordinates system is obtained
Wherein I (ix,iy,iz) it is X-axis unit vectorJ(jx,jy,jz) it is Y-axis unit vectorK(kx,ky,kz) it is Z axis unit
VectorO (A, B, C) is the origin of coordinates of positioner basis coordinates system.
4. the position orientation relation scaling method of all-purpose robot according to claim 2 and positioner, it is characterised in that step
(12) the optimal disc of least square fitting is used in.
5. the position orientation relation scaling method of all-purpose robot according to claim 3 and positioner, it is characterised in that step
(21) the optimal sphere of least square fitting is used in.
6. the position orientation relation scaling method of all-purpose robot according to claim 2 and positioner, it is characterised in that step
(11) 5 points, i.e. M=5 are uniformly chosen in the outside axle range of movement in.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611198507.8A CN106780627A (en) | 2016-12-22 | 2016-12-22 | A kind of position orientation relation scaling method of all-purpose robot and positioner |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611198507.8A CN106780627A (en) | 2016-12-22 | 2016-12-22 | A kind of position orientation relation scaling method of all-purpose robot and positioner |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106780627A true CN106780627A (en) | 2017-05-31 |
Family
ID=58897532
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611198507.8A Pending CN106780627A (en) | 2016-12-22 | 2016-12-22 | A kind of position orientation relation scaling method of all-purpose robot and positioner |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106780627A (en) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107598919A (en) * | 2017-08-18 | 2018-01-19 | 华南理工大学 | A kind of two axle positioner scaling methods based on 5 standardizations |
CN109015652A (en) * | 2018-08-29 | 2018-12-18 | 苏州艾利特机器人有限公司 | A kind of control method of robot and the positioner coordinated movement of various economic factors |
CN109048887A (en) * | 2018-06-13 | 2018-12-21 | 华南理工大学 | A kind of single-shaft position changing machine scaling method based on 3 standardizations |
CN109079850A (en) * | 2018-08-16 | 2018-12-25 | 居鹤华 | Based on axis invariant multi-axis robot D-H system and D-H parameter determination method |
CN109773774A (en) * | 2017-11-14 | 2019-05-21 | 合肥欣奕华智能机器有限公司 | A kind of scaling method of robot and positioner position orientation relation |
CN110227873A (en) * | 2019-05-21 | 2019-09-13 | 南京衍构科技有限公司 | A kind of electric arc increasing material manufacturing method of large scale metal works |
CN110394554A (en) * | 2019-06-14 | 2019-11-01 | 广东镭奔激光科技有限公司 | A kind of robot motion track off-line programing method that the impeller disk is laser impact intensified |
CN111801630A (en) * | 2018-07-13 | 2020-10-20 | 深圳配天智能技术研究院有限公司 | Positioner axis coordinate system calibration method, robot system and storage device |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102743184A (en) * | 2012-05-14 | 2012-10-24 | 清华大学 | Geometrical parameter calibration method of X-ray cone beam computed tomography system |
CN102944182A (en) * | 2012-08-30 | 2013-02-27 | 哈尔滨汽轮机厂有限责任公司 | Rotor-free through-flow measurement method for steam turbine |
CN103063213A (en) * | 2013-01-04 | 2013-04-24 | 上海交通大学 | Calibration method of position relationship between welding robot and position changer |
CN104165586A (en) * | 2013-05-17 | 2014-11-26 | 上海三菱电梯有限公司 | Non-contact high-precision calibration method and application of workpiece coordinate system of robot |
CN106017326A (en) * | 2016-08-02 | 2016-10-12 | 清华大学 | Point location accuracy evaluation method for gantry drilling machine tool |
-
2016
- 2016-12-22 CN CN201611198507.8A patent/CN106780627A/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102743184A (en) * | 2012-05-14 | 2012-10-24 | 清华大学 | Geometrical parameter calibration method of X-ray cone beam computed tomography system |
CN102944182A (en) * | 2012-08-30 | 2013-02-27 | 哈尔滨汽轮机厂有限责任公司 | Rotor-free through-flow measurement method for steam turbine |
CN103063213A (en) * | 2013-01-04 | 2013-04-24 | 上海交通大学 | Calibration method of position relationship between welding robot and position changer |
CN104165586A (en) * | 2013-05-17 | 2014-11-26 | 上海三菱电梯有限公司 | Non-contact high-precision calibration method and application of workpiece coordinate system of robot |
CN106017326A (en) * | 2016-08-02 | 2016-10-12 | 清华大学 | Point location accuracy evaluation method for gantry drilling machine tool |
Non-Patent Citations (1)
Title |
---|
赵欢等: "基于最小二乘法的变位机与焊接机器人的位置关系标定", 《电焊机》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107598919A (en) * | 2017-08-18 | 2018-01-19 | 华南理工大学 | A kind of two axle positioner scaling methods based on 5 standardizations |
CN109773774A (en) * | 2017-11-14 | 2019-05-21 | 合肥欣奕华智能机器有限公司 | A kind of scaling method of robot and positioner position orientation relation |
CN109048887A (en) * | 2018-06-13 | 2018-12-21 | 华南理工大学 | A kind of single-shaft position changing machine scaling method based on 3 standardizations |
CN111801630A (en) * | 2018-07-13 | 2020-10-20 | 深圳配天智能技术研究院有限公司 | Positioner axis coordinate system calibration method, robot system and storage device |
CN109079850B (en) * | 2018-08-16 | 2020-01-07 | 居鹤华 | D-H system and D-H parameter determination method of multi-axis robot based on axis invariance |
CN109079850A (en) * | 2018-08-16 | 2018-12-25 | 居鹤华 | Based on axis invariant multi-axis robot D-H system and D-H parameter determination method |
CN109015652A (en) * | 2018-08-29 | 2018-12-18 | 苏州艾利特机器人有限公司 | A kind of control method of robot and the positioner coordinated movement of various economic factors |
CN110227873A (en) * | 2019-05-21 | 2019-09-13 | 南京衍构科技有限公司 | A kind of electric arc increasing material manufacturing method of large scale metal works |
CN110227873B (en) * | 2019-05-21 | 2021-03-12 | 南京衍构科技有限公司 | Electric arc additive manufacturing method for large-size metal workpiece |
CN110394554A (en) * | 2019-06-14 | 2019-11-01 | 广东镭奔激光科技有限公司 | A kind of robot motion track off-line programing method that the impeller disk is laser impact intensified |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106780627A (en) | A kind of position orientation relation scaling method of all-purpose robot and positioner | |
EP2350750B1 (en) | A method and an apparatus for calibration of an industrial robot system | |
DK2285537T3 (en) | Device and method for computer-assisted generation of a manipulatorbane | |
CN105643369A (en) | Cooperation system having machine tool and robot | |
CN107598919B (en) | Two-axis positioner calibration method based on five-point calibration method | |
Ryuh et al. | An automatic tool changer and integrated software for a robotic die polishing station | |
JP2007523757A (en) | Tracking and mirroring of multiple robot arms | |
CN101980091A (en) | Method for compensating central point of double-turntable five-axis linked numerical control machining rotary tool | |
CN109849019B (en) | Multi-robot machining method for rotary structural member | |
CN107378324A (en) | A kind of welding system and method for the abnormal workpieces of view-based access control model extraction | |
CN110919638B (en) | 3+ 4-configuration double-arm cooperative robot machining system and method | |
CN109015652A (en) | A kind of control method of robot and the positioner coordinated movement of various economic factors | |
CN108311835A (en) | A kind of dynamic electroplating equipment wielding machine arm system that view-based access control model measures | |
CN105500328A (en) | Leather line-drawing device | |
CN110586960B (en) | Method for machining a workpiece, numerical control device and machine tool | |
CN108608099B (en) | Welding gun correction method of corrugated plate welding robot | |
CN109773774A (en) | A kind of scaling method of robot and positioner position orientation relation | |
CN202894632U (en) | Container connecting pipe intersecting wire-electrode cutting robot mechanism | |
CN101859124A (en) | Program control method of pentahedron of numerical control plano milling machine | |
CN110548644B (en) | Arc dispensing method and system based on virtual axis | |
CN109531205A (en) | The double rotary table bases of orthogonal formula can be rotated numerical control clamp system and its regulation method | |
CN104625314A (en) | Portable pipe cutting device based on crawling mechanism | |
CN207205613U (en) | A kind of welding system of the abnormal workpieces of view-based access control model extraction | |
EP3175958B1 (en) | 5-axis and 6-axis mixing control method for industrial robot and system thereof | |
JP2019055440A (en) | Robot system and work-piece manufacturing method |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170531 |