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 PDF

Info

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
Application number
CN201611198507.8A
Other languages
Chinese (zh)
Inventor
黄嘉鑫
徐晗
王富林
何杏兴
Original Assignee
南京熊猫电子股份有限公司
南京熊猫电子装备有限公司
南京熊猫仪器仪表有限公司
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 南京熊猫电子股份有限公司, 南京熊猫电子装备有限公司, 南京熊猫仪器仪表有限公司 filed Critical 南京熊猫电子股份有限公司
Priority to CN201611198507.8A priority Critical patent/CN106780627A/en
Publication of CN106780627A publication Critical patent/CN106780627A/en

Links

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

A kind of position orientation relation scaling method of all-purpose robot and positioner
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
T P R = i x i y i z A j x j y j z B k x k y k z C 0 0 0 1 ;
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.
CN201611198507.8A 2016-12-22 2016-12-22 A kind of position orientation relation scaling method of all-purpose robot and positioner CN106780627A (en)

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 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)

* Cited by examiner, † Cited by third party
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
CN110227873B (en) * 2019-05-21 2021-03-12 南京衍构科技有限公司 Electric arc additive manufacturing method for large-size metal workpiece

Citations (5)

* Cited by examiner, † Cited by third party
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

Patent Citations (5)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
Title
赵欢等: "基于最小二乘法的变位机与焊接机器人的位置关系标定", 《电焊机》 *

Cited By (9)

* Cited by examiner, † Cited by third party
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
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
CN103240591B (en) Assembly equipment and assembly method
CN104384765B (en) Based on the automatic soldering method of threedimensional model and machine vision
JP5316124B2 (en) Laser welding equipment
US9782899B2 (en) Calibration method for coordinate system of robot manipulator
Liao et al. Modeling and control of automated polishing/deburring process using a dual-purpose compliant toolhead
CN101559597B (en) Multifunctional gantry type seven-shaft industrial robot
JP6279862B2 (en) How to control a redundant robot
CN104858748A (en) Automatic robot device for grinding air feeding and discharging edges of blade
KR20150051892A (en) Method for programming motion-sequences of a redundant industry robot and associated industry robot
US4275986A (en) Programmable automatic assembly system
CN107253084B (en) Efficient high-precision robot milling automatic system in aircraft digital assembly
US20100332032A1 (en) Displacement correcting method and displacement correcting program in automatic operation system
US9507337B2 (en) Numerical control device
JP5236596B2 (en) Processing robot system
JP4888619B1 (en) Numerical controller
US8457786B2 (en) Method and an apparatus for calibration of an industrial robot system
CN102099153B (en) Method for shifting the point of machining of a work piece and machine tool
US8231117B2 (en) Robot system
DK2285537T3 (en) Device and method for computer-assisted generation of a manipulatorbane
CN102203685A (en) Method for allowing a manipulator to cover a predetermined trajectory, and control device for carrying out said method
CN102802883B (en) Calibration of a base coordinate system for an industrial robot
US7774910B2 (en) Independent axis clamping apparatus and method
CN104615092B (en) Work mechanism control system and its method
CN106625665B (en) A kind of drilling milling machine device people's system of packaged type automatic addressing
CN101716709A (en) Machining method of workpiece welding groove-workpiece rotary type numerical control cutting machine

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