Method for measuring relative precision of built-in system for zero calibration of full-automatic robot

文档序号：168158 发布日期：2021-10-29 浏览：40次中文

阅读说明：本技术 全自动机器人零点标定的系统内置测量相对精度方法 (Method for measuring relative precision of built-in system for zero calibration of full-automatic robot ) 是由黄加园陈田田邵望臻弗兰克纳塔朋赵刚于 2021-07-16 设计创作，主要内容包括：本发明是一种系统内置测量相对精度方法,特别涉及一种全自动机器人零点标定的系统内置测量相对精度方法。利用计算机来测量和校准所有相对的轴和位置的方法,全自动刀具测量传感器通过使用测头传感器,通过使用CNC控制的测量跳转功能,通过使用CNC控制器的计算能力,通过使用CNC系统内定义的参数,通过使用CNC系统内的系统宏程序。通过系统宏程序(G代码,M代码程序)实现全自动化,并且只要参数在CNC系统中设置良好,该系统宏程序可以用于所有类似的机器人系统。(The invention relates to a method for measuring relative precision of a system built-in, in particular to a method for measuring relative precision of a system built-in of a full-automatic robot zero point calibration. Method for measuring and calibrating all relative axes and positions with a computer, fully automatic tool measuring sensors by using feeler sensors, by using the measurement jump function of CNC control, by using the computing power of CNC controllers, by using parameters defined in the CNC system, by using system macros in the CNC system. Full automation is achieved by a system macro program (G code, M code program) and this can be used for all similar robotic systems as long as the parameters are well set in the CNC system.)

1. A method for measuring relative precision in a system built-in for zero point calibration of a full-automatic robot is characterized by comprising the following steps:

(I) hardware structure configuration:

the robot comprises more than six robots, a clamp containing an electric spindle, a rotating platform and a cutter length measuring sensor, wherein the robots are arranged on the rotating platform and rotate along the rotating platform;

(II) software control configuration:

firstly, a seven-axis servo controller: a robot body axis (5b), a rotating table (5c), an electric spindle controller (5a)) to control the position, velocity and acceleration of all axes; (5d) the CNC reads the on/off signal of the sensor through a sensor signal receiver;

a CNC main controller consisting of human-computer interaction interface software and interpolation software (6c) controls the synchronism of all the axes, and PLC software controls the logic control of the system; (6a) a program of numerical control program code standard (EIA-ISO) consists of G code and M code, which can be used to write a machining sculpture, also in this patent we used to execute a full automation measuring system macro program; (6b) the CNC uses the jump command G31 in combination with a measuring sensor to measure the exact measuring position; (6d) a CNC main controller which can calculate the calculation capability of the robot in a world coordinate system and a joint coordinate system and can switch the two coordinate systems; (6e) a CNC master controller with computing power to compute all possible poses of the robot;

thirdly, an operation panel allowing an operator to establish, modify and execute a calibration system macro program; (III) decoupling the symmetrical positions:

measuring the diameter of the tool through two symmetrical positions by using a tool measuring device, measuring the Z-direction height of the tool or the horizontal position of a measuring head by using a skip instruction G31, and finding out two symmetrical positions at the horizontal position, which are different from the vertical mode used for measuring the length of the tool, through which the error in the height can be measured, and then deriving the drift of the global zero point of the single axis of the robot;

global zero drift meaning: single axis drift + angular offset due to imperfections in the electric spindle support; recommending a more appropriate offset value to that axis by the computational power of the CNC controller;

we define six axes of the robot as C1 to C6;

ZR represents the Z axis of the tail end of the robot;

ZS is a Z axis representing an electric spindle;

the coordinates of the tool setting gauge are defined by the parameters of the CNC, and the coordinates are the same as all measurement coordinates used later;

the coordinates of the tool setting gauge do not need a very accurate numerical value, the robot is manually moved to the position and then set, and whether the center of the tool setting gauge is reached or not can be observed through eyes;

the zero point drift of each axis i is represented by the label δ Ci;

a change in Z direction and end deltaz,

since the axis i δ Ci is very sensitive to small changes, and the label is defined as Si ═ δ z/δ Ci;

several sets of symmetric positions will be defined from which to calculate the effect of zero drift for each axis on the measured height of the feeler;

first pair of symmetric position analyses:

position A, the six axes are controlled from C1 to C6 as follows:

c4 is zero;

c6 is 90 degrees;

the Z axis ZR of the robot is vertical to the ground;

c1, C2, C3 and C5 are calculated to reach the position of the tool setting gauge in an XYZ coordinate system under the condition that the conditions are met;

position B:

c2, C3, C4(═ 0) and C5 are in the same position at position-a;

c4 is likewise zero;

c6 is now-90 degrees;

c1 is recalculated so that the tip reaches the right side of the tool setting position;

③ sensitivity of height Z: using the position of the feeler to measure the height Z, while taking into account the sensitivity of the robot in each axis C1 to C6, we can find:

c1 has no effect on the height, and rotation of C1 does not mean any change in robot height Z;

c2 will have a large effect, but this effect is the same at position a and position B;

c3 has a large effect, but this effect is also the same at position A and position B;

c4 also has a large effect, and in addition, the effect is opposite at position a and position B;

c5 does not cause an effect because we control the Z axis of the robot to be perpendicular to the ground, a slight change in C5 causes a circumferential effect on the height Z, the bottom of the circumference being just above the tool setting coordinates;

the C6 has no influence because the Z axis of the robot is controlled to be vertical to the ground, which means that the C6 rotates like the C1 axis;

verifying and calculating the zero drift of the C4 axis based on the difference in position a and position B by simple height Z detection at these two positions;

since it only relates to one axis, a trial and error method is used to calibrate, change the zero offset a little for C4 and then re-measure it again;

the specific steps of calculating the exact value of the offset, using the CNC controller, are preferably:

assume that the sensitivity of the ith axis at height Z is:

Si＝δz/δCi；

the difference in sensitivity at position a and symmetric position B is then:

2.Si＝2.δz/δCi；

suppose we measure the height Z

of Za at position A;

and Zb in position B;

the offset δ Ci for the ith axis can then be calculated as:

2.δz/δCi＝(Za-Zb)；

δCi＝2.δz/(Za-Zb)；

second pair of symmetric position analysis:

position A, the six axes are controlled from C1 to C6 as follows:

c4 is 90 degrees, C5 is-90 degrees, and the Z axis of the robot is parallel to the ground in the state;

c1, C2, C3 and C6 are calculated to reach the position of the tool setting gauge in an XYZ coordinate system under the condition that the above conditions are met, and the Z axis of the tool is parallel to the ground;

position B:

c1, C2 and C3 are all identical;

c4, C5 and C6 are in complementary mirror positions;

c4 ═ 90 degrees, C5 ═ 90 degrees, C6b ═ C6 a-180;

by simple height Z detection at these two positions we can verify and calculate that the C5 axis is based on being at position A and position B;

third pair of symmetric position analysis:

position A:

the six axes are controlled from C1 to C6 as follows:

c4 is zero;

c6 is 90 degrees;

the Z axis ZR of the robot is parallel to the ground;

c1, C2, C3 and C5 are calculated to reach the position of the tool setting gauge in the XYZ coordinate system under the condition that the above conditions are satisfied;

position B:

c2, C3, C4(═ 0) and C5 are the same as position a;

c4 is also zero;

c6 is now-90 degrees;

c1 is recalculated so that the tip reaches the right side of the tool setting position;

this is quite similar to the first pair of symmetrical positions, except that the ZR is now not perpendicular to the ground but parallel to it;

by simple height Z detection at these two positions we can verify and calculate the zero drift of the C6 axis based on the difference in position a and position B;

(IV) coupled position analysis:

in the step (III), the three pairs of symmetrical position analysis are almost decoupled, and zero point drift of the axes C4, C5 and C6 is directly deduced from the three pairs of symmetrical position analysis;

solving a 5x5 matrix using five coupled position pairs to find the zero shift for each axis;

the zero point of C1 is not required to be set, and the zero point is aligned when the Z axis of the integrated robot is aligned with the Z axis of the rotary table;

suppose we have two positions a and B and are represented by sensitivities S2a … S6a and S2B … S6B;

and the sensitivity difference is represented as S2ba … S6ba, in order:

C2：S2ba＝S2b-S2a；

C3：S3ba＝S3b-S3a；

C4：S4ba＝S4b-S4a；

C5：S5ba＝S5b-S5a；

C6：S6ba＝S6b-S6a；

suppose we measure the height of Z with Za at position A and Zb at position B;

the difference in height Z is then dependent on all axes and is expressed as:

S2ba.δC2+S3ba.δC3+S4ba.δC4+S5ba.δC5+S6ba.δC6＝(Zb-Za)＝Zba

in total, five arbitrary position pairs A, B, C, D and E are defined and measured to obtain heights Za, Zb, ZC, ZD and Ze,

there are five equations and five variables:

S2ba.δC2+S3ba.δC3+S4ba.δC4+S5ba.δC5+S6ba.δC6＝Zba；

S2cb.δC2+S3cb.δC3+S4cb.δC4+S5cb.δC5+S6cb.δC6＝Zcb；

S2dc.δC2+S3dc.δC3+S4dc.δC4+S5dc.δC5+S6dc.δC6＝Zdc；

S2ed.δC2+S3ed.δC3+S4ed.δC4+S5ed.δC5+S6ed.δC6＝Zed；

S2ae.δC2+S3ae.δC3+S4ae.δC4+S5ae.δC5+S6ae.δC6＝Zae；

matrix form:

all positions are "independent" or "uncoupled", the inverse of the sensitivity matrix is present, and the zero point drift about each axis can be given by:

this approach effectively provides for finding independent locations;

the robot can be measured in the opposite posture, C2 shows that the robot can be negative, C1 can be rotated by 180 degrees to enable the tail end of the robot to reach the position of the tool setting gauge;

(V) alignment mode of the rotating table:

the center of the rotating table and the rotating table shaft need to be measured; mounting a probe on the robot;

selecting a point at one side of the rotary table, and measuring the XY coordinates of the point in a world coordinate system of the robot; this turret may be circular or square or even any shape;

selecting a point, rotating the robot along with the rotary table, and simultaneously measuring XY coordinates of the same point on different angles of 8 rotary tables; from the 8 points, the center of the best fitting circle of the turntable can be calculated;

3 points are satisfied from the mathematical theory, and better precision can be obtained along with the increase of the number of the points;

selecting a point on the surface of the turntable to measure its Z coordinate in the robot coordinate system; the surface of the turntable does not necessarily have to be planar;

a point is selected and the robot is then rotated with the turntable, and then the Z coordinates of the same point at different 8 angles are measured, and the normal vector of the best-fit plane is calculated from these 8 points.

Technical Field

The invention relates to a method for measuring relative precision of a system built-in, in particular to a method for measuring relative precision of a system built-in of a full-automatic robot zero point calibration.

Background

The existing operation mode has relatively low precision, so that the precision of the carved product is low and the added value is very low.

Disclosure of Invention

The present invention is primarily directed to solving the deficiencies of the prior art and providing a method for measuring and calibrating all relative axes and positions using a computer, a fully automatic tool measurement sensor, by using a stylus sensor, by using a measurement jump function of a CNC control, by using the computational power of a CNC controller, by using parameters defined in a CNC system, by using a system macro program in a CNC system, a method of in-system measurement relative accuracy calibration of a fully automatic robot zero calibration.

The technical problem of the invention is mainly solved by the following technical scheme:

a method for measuring relative precision in a system built-in calibration of a zero point of a full-automatic robot is carried out according to the following steps:

(I) hardware structure configuration:

(II) software control configuration:

thirdly, an operation panel allowing an operator to establish, modify and execute a calibration system macro program;

the robot system is provided with a tool length measuring device which is mainly used for measuring the length of the tool in the machining process so as to ensure the precision of the machining process. Usually the tool is mounted on an automatic tool changer or manually on the tool holder, the CNC will control the tool in the Z and vertical directions by using a system macro to touch the sensor and pass it to the CNC when the sensor switches the signal from off to on (or on), which can then calculate the actual tool length with an accuracy of 1 or a few microns.

(III) decoupling the symmetrical positions: