Summary of the invention
For overcoming the above problems, the present invention proposes the multiplexing caliberating device of a kind of robot polishing grinding system program and method.This caliberating device structure is simple, be easy to industrially promote, its scaling method coordinates the basic function of industrial robot, establish corresponding transfer algorithm, for completing between multiple similar polishing system, (equipment is identical, but assembly precision and relative position are different) conversion of program and multiplexing, the equipment installation site requirement between such method greatly reduces multiple system, the flexibility of the procedure sharing between increase system.
For reaching this object, the present invention by the following technical solutions:
The caliberating device that robot polishing grinding system program is multiplexing, comprise take turns installation sleeve, on take turns installing plate, scaling board, adjusting rod, lower whorl installation sleeve, lower whorl installing plate and regulate locking member; Take turns on described installation sleeve be installed on described on take turns the centre of installing plate; Described scaling board takes turns installation sleeve on described; Take turns installing plate two ends on described and be provided with described adjustment locking member; One end of described adjusting rod is provided with elongated hole, and described adjustment locking member is through described elongated hole, then the axle that described scaling board can be made to take turns installation sleeve on described rotates, and locks described adjustment locking member and then can fix described scaling board; The other end of described adjusting rod is installed on described lower whorl installing plate; Described lower whorl installation sleeve is installed on the centre of described lower whorl installing plate.
More excellent, take turns on described installation sleeve with described on take turns installing plate installation connected mode be riveted joint, bolt is connected, key pin connects, Elastic buckle connects, weld in wherein one.
More excellent, described lower whorl installation sleeve and the installation connected mode of described lower whorl installing plate are riveted joints, bolt is connected, key pin connects, Elastic buckle connects, weld in wherein one.
More excellent, described adjusting rod is no less than 2.
More excellent, described adjustment locking member 7 is bolt fastening structures.
The multiplexing scaling method of the robot polishing grinding system program of caliberating device is used to comprise the steps:
1) demarcation head is arranged in the robot of source polishing system; Caliberating device is installed on the belt sander of source polishing system, locking caliberating device; Described demarcation head is arranged on the flange of robot, above has a conical tip, and at timing signal, operator manipulation robot, makes the tip of described demarcation head aim at each feature point for calibration; Described source polishing system refers to that robot has been mounted with the robot polishing system of available polishing program;
2) { the feature point for calibration coordinate of R} is also recorded as the first feature point for calibration: P to measure source polishing system belt sander basis coordinates system
r1(x
r1, y
r1, z
r1), the second feature point for calibration: P
r2(x
r2, y
r2, z
r2), the 3rd feature point for calibration: P
r3(x
r3, y
r3, z
r3), wherein, P
r1for initial point, with feature point for calibration P
r1and P
r2line is X-axis, and direction is the first feature point for calibration P
r1point to the second feature point for calibration P
r2, the 3rd feature point for calibration P
r3for the point on coordinate system first quartile, x
ri, y
ri, z
ri(i=1,2,3) represent X, Y, Z value of 3 feature point for calibration in the polishing system of source respectively;
3) adjust the abrasive belt wheel installation site of new polishing system belt sander, make it to agree with the caliberating device of locked structure; Described new polishing system refers to the robot not yet installing polishing program, by the error calculation of described source polishing system and described new polishing system assembly building, copies the robot polishing system after available polishing system program;
4) { the feature point for calibration coordinate of U} is also recorded as the 4th feature point for calibration: P ' to measure belt sander reference frame in new polishing system
r1(x '
r1, y '
r1, z '
r1), the 5th feature point for calibration: P '
r2(x '
r2, y '
r2, z '
r2), the 6th feature point for calibration: P '
r3(x '
r3, y '
r3, z '
r3), P '
r1for initial point, with feature point for calibration P '
r1with P '
r2line is X-axis, and direction is the 4th feature point for calibration P '
r1point to the 5th feature point for calibration P '
r2, the 6th feature point for calibration P '
r3for the point on coordinate system first quartile, x '
ri, y '
ri, z '
ri(i=1,2,3) represent X, Y, Z value of 3 feature point for calibration in new polishing system respectively;
5) according to source polishing system belt sander basis coordinates system, { in R} to new polishing system, belt sander reference frame { remember by the homogeneous transition matrix of U}
rt
u,
Calculating makes new advances, and { the homogeneous coordinates value of U} is P to belt sander reference frame in polishing system
u1=[x
u1, y
u1, z
u1, 1]
t=[0,0,0,1]
t, P
u2=[x
u2, y
u2, z
u2, 1]
t=[x
u2, 0,0,1]
t, P
u3=[x
u3, y
u3, z
u3, 1]
t=[x
u3, y
u3, 0,1]
t, x
u3>0, y
u3>0; Wherein, from coordinate system, { to coordinate system, { the rotation transformation of U}, around position fixing system, { the XYZ axle of R} have rotated R} respectively
angle, and p
x, p
y, p
zrepresent that { R} is to coordinate system { the initial point deviant of U} from coordinate system respectively;
6) according to equation
the transformation matrix of calculating source polishing system
rt
u;
7) according to 6) method, calculate the transformation matrix of new polishing system
rt
u';
8) the XYZ offset value x of basis coordinates system is recorded
ti, y
ti, z
tiwith the XYZ axle anglec of rotation α of difference moving coordinate system
ti, β
ti, γ
ti, wherein i=1,2,3 ... represent i-th tracing point, the pose of each tracing point of these Parametric Representations, express with homogeneous coordinates, namely
Remember that new polishing system tracing point homogeneous coordinates value is P
ti', by formula
rt
up
ti=
rt '
up
ti' tracing point of the polishing system that makes new advances can be calculated, express with homogeneous coordinates, namely
Solve the XYZ offset value x of the polishing system that makes new advances '
ti, y '
ti, z '
tiwith the XYZ axle anglec of rotation α ' of difference moving coordinate system
ti, β '
ti, γ '
titotally 6 parameters, thus calculate the program of the polishing system that makes new advances.
More excellent, the installation method of described caliberating device comprises:
The adjustment locking member of described caliberating device is in loosening state, by on take turns installation sleeve and be enclosed within the upper abrasive belt wheel wheel shaft of belt sander, lower whorl installation sleeve is enclosed within the lower abrasive belt wheel wheel shaft of belt sander, the angle of adjustment scaling board, make it parallel to the ground, again by take turns installation sleeve and lower whorl installation sleeve is tightened with upper abrasive belt wheel wheel shaft and lower abrasive belt wheel wheel shaft respectively, finally adjustment locking member is tightened; Described upper abrasive belt wheel wheel shaft is mainly used in installing abrasive belt wheel, when carrying out proving operation, by take turns installation sleeve and connect upper wheel installing plate and upper abrasive belt wheel wheel shaft, be fixed on the upper abrasive belt wheel wheel shaft of belt sander by caliberating device; Described lower abrasive belt wheel wheel shaft, is mainly used in installing lower abrasive belt wheel, when carrying out proving operation, lower whorl installation sleeve being connected lower whorl installing plate and lower abrasive belt wheel wheel shaft, is fixed on the lower abrasive belt wheel wheel shaft of belt sander by caliberating device.
Beneficial effect of the present invention is:
1, can not limit by the alignment error of the equipment installation site difference between many cover polishing systems and equipment, the program that realizes is transplanted and is reused between different machines robot system, greatly improves programming efficiency.
2, calibration algorithm is simple effectively, precision is high, can be used between multiple similar polishing system that (equipment is identical, but assembly precision and relative position are different) conversion of program and multiplexing, equipment installation site requirement between such method greatly reduces multiple system, the flexibility of the procedure sharing between increase system.
3, to the basic no requirement (NR) of installation site precision of equipment, operating position is in robot working space.
4, do not need to use accurate measuring instrument in addition, use the encoder to count function of robot can realize corresponding demarcation.
Detailed description of the invention
As Fig. 1, the caliberating device that a kind of robot polishing grinding system program is multiplexing, comprise take turns installation sleeve 1, on take turns installing plate 2, scaling board 3, adjusting rod 4, lower whorl installation sleeve 5, lower whorl installing plate 6 and regulate locking member 7; Take turns on described installation sleeve 1 be installed on described on take turns the centre of installing plate 2; Described scaling board 3 takes turns installation sleeve 1 on described; Take turns installing plate 2 two ends on described and be provided with described adjustment locking member 7; One end of described adjusting rod 4 is provided with elongated hole 8, and described adjustment locking member 7 is through described elongated hole 8, then the axle that described scaling board 3 can be made to take turns installation sleeve 5 on described rotates, lock described adjustment locking member 7 and can fix described scaling board 3; The other end of described adjusting rod 4 is installed on described lower whorl installing plate 6; Described lower whorl installation sleeve 5 is installed on the centre of described lower whorl installing plate 6.
This caliberating device structure is simple, adjust structure size can be carried out according to the assembling situation of belt sander in the polishing system of source, particularly to adjustable and the scaling board 3 of lockable position locked, then adjust the assembling situation of belt sander in new polishing system according to the physical dimension of caliberating device; Handled easily person finds calibration position accurately, improves stated accuracy; The relative position coherence request installed equipment in many cover polishing systems is low, even if the robot of different cover polishing system is different from the relative position of belt sander, robot program in the polishing system of source is changed, can directly apply in new polishing system robot.
More excellent, take turns on described installation sleeve 1 with described on take turns installing plate 2 installation connected mode be riveted joint, bolt is connected, key pin connects, Elastic buckle connects, weld in wherein one.
More excellent, described lower whorl installation sleeve 5 and the installation connected mode of described lower whorl installing plate 6 are riveted joints, bolt is connected, key pin connects, Elastic buckle connects, weld in wherein one.
More excellent, described adjusting rod 4 is no less than 2.
More excellent, described adjustment locking member 7 is bolt fastening structures.
Carry out the demarcation of source program polishing system on this basis, scaling method is as follows: be arranged on the robot flange of source polishing system by demarcation 9, manipulation robot carries out the demarcation at TCP (tool coordinates system center), and feature point for calibration is on the front end cusp demarcating 9.After completing TCP demarcation, manipulation robot, its TCP is made to go successively to touch 3 feature point for calibration (Fig. 5 on scaling board 3, attitude does not limit): the first feature point for calibration A, the second feature point for calibration B and the 3rd feature point for calibration C, the teaching system carried by robot (teach box) is read 3 points and (is designated as the first feature point for calibration A:P relative to the XYZ coordinate value of basis coordinates system of robot
r1(x
r1, y
r1, z
r1), the second feature point for calibration B:P
r2(x
r2, y
r2, z
r2), the 3rd feature point for calibration C:P
r3(x
r3, y
r3, z
r3), wherein, x
ri, y
ri, z
ri(i=1,2,3) represent the XYZ value of 3 feature point for calibration respectively).
Demarcate new polishing system belt sander: unclamp and take turns installation sleeve 1 and lower whorl installation sleeve 5, the belt sander (Fig. 2) of caliberating device (Fig. 1) from source polishing system is pulled down, keep caliberating device (Fig. 1) structure constant, attach it on the belt sander (Fig. 2) of new polishing system.Be arranged on the robot flange of new polishing system by demarcation 9, manipulation robot carries out the demarcation at TCP (tool coordinates system center), and feature point for calibration is on the front end cusp demarcating head (10).Manipulation robot again, robot TCP is made to go successively to touch 3 feature point for calibration (Fig. 5 on scaling board (3), attitude does not limit): the first feature point for calibration A, the second feature point for calibration B and the 3rd feature point for calibration C, the teaching system carried by robot (teach box) read 3 points relative to basis coordinates system of robot XYZ coordinate value (be designated as the 4th feature point for calibration A ': P '
r1(x '
r1, y
' r1, z '
r1), the 5th feature point for calibration B ': P '
r2(x '
r2, y '
r2, z '
r2), the 6th feature point for calibration C ': P
' r3(x '
r3, y '
r3, z '
r3), wherein, x '
ri, y '
ri, z '
ri(i=1,2,3) represent the XYZ value of 3 feature point for calibration respectively).
Finally do numerical computations and Program transformation according to nominal data.
Use the scaling method that the robot polishing grinding system program of caliberating device is multiplexing, its basic step comprises:
After demarcating, the feature point for calibration obtaining source polishing system and new polishing system respectively, relative to the coordinate value under robot basis coordinates system in respective polishing system, comprises the first feature point for calibration A:P of source polishing system
r1(x
r1, y
r1, z
r1), the second feature point for calibration B:P
r2(x
r2, y
r2, z
r2), the 3rd feature point for calibration C:P
r3(x
r3, y
r3, z
r3), the 4th feature point for calibration A ': P of new polishing system '
r1(x '
r1, y '
r1, z '
r1), the 5th feature point for calibration B ': P '
r2(x '
r2, y '
r2, z '
r2), the 6th feature point for calibration C ': P '
r3(x '
r3, y '
r3, z '
r3), wherein, x
ri, y
ri, z
ri(i=1,2,3) represent the XYZ value of 3 feature point for calibration in the polishing system of source respectively, x '
ri, y '
ri, z '
ri(i=1,2,3) represent the XYZ value of 3 feature point for calibration in new polishing system respectively.
By the tracing point coordinate value corresponding to the robotic motion routine in the polishing system of source, and above-mentioned 6 feature point for calibration coordinate values, be input in Program transformation algorithm software, software calculates tracing point coordinate value corresponding to the robotic motion routine of the polishing system that makes new advances automatically, and generate corresponding robot program's document, the robot that can directly be loaded in new polishing system uses, and reaches the grinding workpieces effect consistent with source polishing system robot.
Concrete steps are as follows:
1) demarcation 9 is arranged in the robot of source polishing system; Caliberating device is installed on the belt sander of source polishing system, locking caliberating device; Described demarcation 9 is arranged on the flange of robot, above has a conical tip, and at timing signal, operator manipulation robot, makes the tip of described demarcation 9 aim at each feature point for calibration; Described source polishing system refers to that robot has been mounted with the robot polishing system of available polishing program;
2) { the feature point for calibration coordinate of R} is also recorded as the first feature point for calibration A:P to measure source polishing system belt sander basis coordinates system
r1(x
r1, y
r1, z
r1), the second feature point for calibration B:P
r2(x
r2, y
r2, z
r2), the 3rd feature point for calibration C:P
r3(x
r3, y
r3, z
r3), wherein, P
r1for initial point, with feature point for calibration P
r1and P
r2line is X-axis, and direction is the first feature point for calibration P
r1point to the second feature point for calibration P
r2, the 3rd feature point for calibration P
r3for the point on coordinate system first quartile, x
ri, y
ri, z
ri(i=1,2,3) represent X, Y, Z value of 3 feature point for calibration in the polishing system of source respectively;
3) adjust the abrasive belt wheel installation site of new polishing system belt sander, make it to agree with the caliberating device of locked structure; Described new polishing system refers to the robot not yet installing polishing program, by the error calculation of described source polishing system and described new polishing system assembly building, copies the robot polishing system after available polishing system program;
4) measure belt sander reference frame in new polishing system the feature point for calibration coordinate of U} and be recorded as the 4th feature point for calibration A ': P '
r1(x '
r1, y '
r1, z '
r1), the 5th feature point for calibration B ': P '
r2(x '
r2, y '
r2, z '
r2), the 6th feature point for calibration C ': P '
r3(x '
r3, y '
r3, z '
r3), P '
r1for initial point, with feature point for calibration P '
r1with P '
r2line is X-axis, and direction is the 4th feature point for calibration P '
r1point to the 5th feature point for calibration P '
r2, the 6th feature point for calibration P '
r3for the point on coordinate system first quartile, x '
ri, y '
ri, z '
ri(i=1,2,3) represent X, Y, Z value of 3 feature point for calibration in new polishing system respectively;
5) according to source polishing system belt sander basis coordinates system, { in R} to new polishing system, belt sander reference frame { remember by the homogeneous transition matrix of U}
rt
u,
calculating makes new advances, and { the homogeneous coordinates value of U} is P to belt sander reference frame in polishing system
u1=[x
u1, y
u1, z
u1, 1]
t=[0,0,0,1]
t, P
u2=[x
u2, y
u2, z
u2, 1]
t=[x
u2, 0,0,1]
t, P
u3=[x
u3, y
u3, z
u3, 1]
t=[x
u3, y
u3, 0,1]
t, x
u3>0, y
u3>0; Wherein, from coordinate system, { to coordinate system, { the rotation transformation of U}, around position fixing system, { the XYZ axle of R} have rotated R} respectively
angle, and p
x, p
y, p
zrepresent that { R} is to coordinate system { the initial point deviant of U} from coordinate system respectively;
6) according to equation
the transformation matrix of calculating source polishing system
rt
u;
7) according to 6) method, calculate the transformation matrix of new polishing system
rt
u';
8) the XYZ offset value x of basis coordinates system is recorded
ti, y
ti, z
tiwith the XYZ axle anglec of rotation α of difference moving coordinate system
ti, β
ti, γ
ti, wherein i=1,2,3 ... represent i-th tracing point, the pose of each tracing point of these Parametric Representations, express with homogeneous coordinates, namely
Remember that new polishing system tracing point homogeneous coordinates value is P
ti', by formula
rt
up
ti=
rt '
up
ti' tracing point of the polishing system that makes new advances can be calculated, express with homogeneous coordinates, namely
Solve the XYZ offset value x of the polishing system that makes new advances '
ti, y '
ti, z '
tiwith the XYZ axle anglec of rotation α ' of difference moving coordinate system
ti, β '
ti, γ '
titotally 6 parameters, thus calculate the program of the polishing system that makes new advances.
The Program transformation algorithm principle of this method is described as follows:
For source polishing system, based on 3 feature point for calibration P
r1, P
r2and P
r3{ R} (as shown in Figure 5), { R} is with feature point for calibration P for coordinate system can to set up the device coordinate system of belt sander
r1for initial point, with feature point for calibration P
r1and P
r2line is X-axis, and direction is the first feature point for calibration P
r1point to the second feature point for calibration P
r2, the 3rd feature point for calibration P
r3for the point on coordinate system first quartile.
3 feature point for calibration coordinates are expressed with homogeneous coordinates form, are the first feature point for calibration A:P
r1=[x
r1, y
r1, z
r1, 1]
t, the first feature point for calibration B:P
r2=[x
r2, y
r2, z
r2, 1]
t, the first feature point for calibration C:P
r3=[x
r3, y
r3, z
r3, 1]
t, and robot basis coordinates system in the polishing system of source (be designated as R}) to coordinate system, { the homogeneous transition matrix of U} is designated as
rt
u, have
Wherein, from coordinate system R} to coordinate system { around position fixing system { the XYZ axle component of rotation of R} the rotation transformation of U}
angle, and p
x, p
y, p
zrepresent that { R} is to coordinate system { the initial point deviant of U} from coordinate system respectively.
3 feature point for calibration are P based on the homogeneous coordinates value of coordinate system U
u1=[x
u1, y
u1, z
u1, 1]
t=[0,0,0,1]
t, P
u2=[x
u2, y
u2, z
u2, 1]
t=[x
u2, 0,0,1]
t, P
u3=[x
u3, y
u3, z
u3, 1]
t=[x
u3, y
u3, 0,1]
t, x
u3>0, y
u3>0.
By coordinate system, { { relation of R} has equation P for U} and coordinate system
ri=
rt
up
ui(i=1,2,3) set up, and substitute into and calculate, namely
Solve this equation group, draw transformation matrix
rt
u.
Use the same method and demarcate belt sander on new polishing system, calculate the transformation matrix of new polishing system
rt
u'.
Demarcate and calculate the transformation matrix of source polishing system and new polishing system completing
rt
u,
rt
u' after, can calculate the tracing point coordinate of source polishing system robot program.The tracing point numerical value of robot program's general record is that the XYZ deviant of robot TCP coordinate system relative to basis coordinates system of robot is (respectively along the XYZ axle translation distance x of basis coordinates system of robot
ti, y
ti, z
ti) and 1-2-3 Eulerian angles (the XYZ axle anglec of rotation α of moving coordinate system respectively
ti, β
ti, γ
ti) totally 6 parameters, wherein i=1,2,3 ... represent i-th tracing point, these parameters are expressed with homogeneous coordinates, namely by these Parametric Representations pose of each tracing point
Remember that new polishing system robot program tracing point homogeneous coordinates value is P
ti', by formula
RT
UP
ti=
RT′
UP
ti′
The tracing point (homogeneous coordinates form) of the polishing system that makes new advances can be calculated, then foundation
Solve and make new advances in polishing system, robot TCP coordinate system relative to the XYZ deviant of basis coordinates system of robot (respectively along the XYZ axle translation distance x ' of basis coordinates system of robot
ti, y '
ti, z '
ti) and 1-2-3 Eulerian angles (the XYZ axle anglec of rotation α ' of moving coordinate system respectively
ti, β '
ti, γ '
ti) totally 6 parameters, and generate corresponding program, be loaded in robot system.
More excellent, the installation method of described caliberating device comprises: the adjustment locking member 7 of described caliberating device is in loosening state, by on take turns installation sleeve 1 and be enclosed within the upper abrasive belt wheel wheel shaft 10 of belt sander, lower whorl installation sleeve 5 is enclosed within the lower abrasive belt wheel wheel shaft 11 of belt sander, the angle of adjustment scaling board 3, make it parallel to the ground, then by take turns installation sleeve 1 and tighten with upper abrasive belt wheel wheel shaft 10 and lower abrasive belt wheel wheel shaft 11 respectively with lower whorl installation sleeve 5, finally adjustment locking member 7 is tightened; Described upper abrasive belt wheel wheel shaft 10 is mainly used in installing abrasive belt wheel, when carrying out proving operation, by take turns installation sleeve 1 and connect and take turns installing plate 2 and upper abrasive belt wheel wheel shaft 10, be fixed on the upper abrasive belt wheel wheel shaft 10 of belt sander by caliberating device; Described lower abrasive belt wheel wheel shaft 11, is mainly used in installing lower abrasive belt wheel, when carrying out proving operation, lower whorl installation sleeve 5 being connected lower whorl installing plate 6 and lower abrasive belt wheel wheel shaft 11, being fixed on the lower abrasive belt wheel wheel shaft 11 of belt sander by caliberating device.