Industrial robot pose accuracy and pose repeatability detection device and detection method

文档序号:647710 发布日期:2021-05-14 浏览:8次 中文

阅读说明:本技术 工业机器人位姿准确度和位姿重复性检测装置及检测方法 (Industrial robot pose accuracy and pose repeatability detection device and detection method ) 是由 韩莉莉 于 2020-12-28 设计创作,主要内容包括:本发明公开了工业机器人位姿准确度和位姿重复性检测装置,包括测试用末端执行器、测量机架和四轴测量仪;测量机架包括安装底板、立柱和样标针;四轴测量仪包括X轴测微台、Y轴测微台、R轴测微转台和Z轴测微台;Z轴移动平台上固定连接有位置检测爪和姿态检测爪;该检测装置检测位姿准确度和重复性的方法包括以下步骤:1)安装测试用末端执行器;2)安装测量机架;3)对测试点进行标定;4)对四轴测量仪进行标定;5)位置准确度和位置重复性测量;6)姿态准确度和姿态重复性测量;本发明的检测装置结构简单、便携,生产成本低,安装方便;检测方法操作简单,能够对大部分工业机器人进行检测,有助于提高工业机器人的产品质量。(The invention discloses a device for detecting pose accuracy and pose repeatability of an industrial robot, which comprises an end effector for testing, a measuring rack and a four-axis measuring instrument, wherein the end effector for testing is arranged on the measuring rack; the measuring rack comprises a mounting bottom plate, an upright post and a sample marking needle; the four-axis measuring instrument comprises an X-axis micrometer table, a Y-axis micrometer table, an R-axis micrometer rotary table and a Z-axis micrometer table; a position detection claw and a posture detection claw are fixedly connected to the Z-axis moving platform; the method for detecting the pose accuracy and repeatability by the detection device comprises the following steps: 1) mounting a test end effector; 2) installing a measuring rack; 3) calibrating the test point; 4) calibrating the four-axis measuring instrument; 5) position accuracy and position repeatability measurements; 6) measuring the attitude accuracy and the attitude repeatability; the detection device has the advantages of simple structure, portability, low production cost and convenience in installation; the detection method is simple to operate, can detect most industrial robots, and is beneficial to improving the product quality of the industrial robots.)

1. The industrial robot pose accuracy and pose repeatability detection device is characterized by comprising a test end effector, a measurement rack and a four-axis measuring instrument; the end effector for testing comprises a probe interface plate, a probe and a plurality of balancing weights; one side of the probe interface board is fixedly connected to a mechanical interface flange plate at the tail end of the robot, the probe is fixedly connected to the other side of the probe interface board, a measuring pin is installed at the position, close to the tip, of the probe, and balancing weights are symmetrically and fixedly connected to the two sides of the probe; the measuring rack comprises a mounting bottom plate, an upright post and a sample marking needle, the upright post is divided into a first upright post, a second upright post, a third upright post, a fourth upright post and a fifth upright post which are all fixedly connected on the mounting bottom plate, and the second upright post and the third upright post have the same structure and are higher than the first upright post; the fourth upright post and the fifth upright post have the same structure and are lower than the first upright post in height; the second upright post, the third upright post, the fourth upright post and the fifth upright post sequentially enclose a rectangular structure, and the first upright post is arranged at the center of the rectangle; the sample marking needles are respectively arranged on the tops of the columns, when the sample marking needles are arranged on the tops of the first columns, the positions of the needle points are marked as P1, when the sample marking needles are arranged on the tops of the second columns, the positions of the needle points are marked as P2, when the sample marking needles are arranged on the tops of the third columns, the positions of the needle points are marked as P3, when the sample marking needles are arranged on the tops of the fourth columns, the positions of the needle points are marked as P4, when the sample marking needles are arranged on the tops of the fifth columns, the positions of the needle points are marked as P5, and the positions of the P1, the P2, the P3, the P4 and the P5 meet the requirements of GB/T12642; the four-axis measuring instrument comprises a measuring instrument fixing base, an X-axis micrometering table, a Y-axis micrometering table, an R-axis micrometering rotary table and a Z-axis micrometering table; the X-axis micro measurement platform comprises an X-axis micro measurement platform fixing base, an X-axis moving platform and an X-axis movement detection measuring tool, a movement kinematic pair is formed between the X-axis moving platform and the X-axis micro measurement platform fixing base, the X-axis movement detection measuring tool comprises a fixing part and a movement displacement detection part, and the fixing part and the movement displacement detection part of the X-axis movement detection measuring tool are respectively installed on the X-axis micro measurement platform fixing base and the X-axis moving platform; the Y-axis micro measurement platform comprises a Y-axis micro measurement platform fixing base, a Y-axis moving platform and a Y-axis movement detection measuring tool, a movement kinematic pair is formed between the Y-axis moving platform and the Y-axis micro measurement platform fixing base, the Y-axis movement detection measuring tool comprises a fixing part and a movement displacement detection part, and the fixing part and the movement displacement detection part of the Y-axis movement detection measuring tool are respectively installed on the Y-axis micro measurement platform fixing base and the Y-axis moving platform; the R-axis micrometric rotary table comprises an R-axis micrometric rotary table fixing base, an R-axis rotating platform and an R-axis rotation detection measuring tool, a rotating kinematic pair is formed between the R-axis rotating platform and the R-axis micrometric rotary table fixing base, the R-axis rotation detection measuring tool comprises a fixing part and a rotation displacement detection part, and the fixing part and the rotation displacement detection part of the R-axis rotation detection measuring tool are respectively arranged on the R-axis micrometric rotary table fixing base and the R-axis rotating platform; the Z-axis micro measurement platform comprises a Z-axis micro measurement platform upright post, a Z-axis moving platform and a Z-axis movement detection measuring tool, a moving kinematic pair is formed between the Z-axis moving platform and the Z-axis micro measurement platform upright post, the Z-axis movement detection measuring tool comprises a fixed part and a moving displacement detection part, and the fixed part and the moving displacement detection part of the Z-axis movement detection measuring tool are respectively arranged on the Z-axis micro measurement platform upright post and the Z-axis moving platform; the X-axis micrometric table fixing base is fixedly connected to the top of the measuring instrument fixing base, the Y-axis micrometric table fixing base is fixedly connected to the top of the X-axis moving platform, and the moving direction of the Y-axis moving platform is perpendicular to that of the X-axis moving platform; the R-axis micrometric turntable fixing base is fixedly connected to the top of the Y-axis moving platform, the Z-axis micrometric table upright post is fixedly connected to the top of the R-axis rotating platform, and the moving direction of the Z-axis moving platform is respectively vertical to the moving direction of the X-axis moving platform and the moving direction of the Y-axis moving platform; the X-axis micro-measuring table, the Y-axis micro-measuring table and the R-axis micro-measuring rotary table are all provided with through holes for the sample marking needles to pass through; a position detection claw and a posture detection claw are fixedly connected to the Z-axis moving platform, a measurement groove is formed in the position detection claw, and one vertex of the measurement groove is used as a measurement point; the gesture detects and is provided with the detection sword on the claw, detects the last plane level setting of sword, detects the side slope setting of sword, detects the side of sword and is the acute angle with the contained angle between the last plane, detects the junction formation straight line detection cutting edge of last plane and the side of sword.

2. The industrial robot pose accuracy and pose repeatability detection device according to claim 1, wherein a plurality of threaded holes are evenly formed in the circumferential direction of the balancing weight, and balance weight screws are connected to the threaded holes in a threaded manner.

3. The industrial robot pose accuracy and pose repeatability detection device according to claim 1, wherein the X-axis micrometer table further comprises an X-axis guide rail, the fixing portion of the X-axis movement detection measuring tool adopts an X-axis micrometer head, the X-axis guide rail is installed between the X-axis moving platform and the X-axis micrometer table fixing base, an X-axis clamping device is arranged between the X-axis moving platform and the X-axis micrometer table fixing base, and an X-axis return spring is arranged between the X-axis moving platform and the X-axis micrometer table fixing base; the Y-axis micro-measuring platform comprises a Y-axis guide rail, a Y-axis moving detection measuring tool fixing part adopts a Y-axis micro-measuring head, the Y-axis guide rail is installed between the Y-axis moving platform and the Y-axis micro-measuring platform fixing base, a Y-axis clamping device is arranged between the Y-axis moving platform and the Y-axis micro-measuring platform fixing base, and a Y-axis reset spring is arranged between the Y-axis moving platform and the Y-axis micro-measuring platform fixing base; an R-axis clamping device is arranged between the R-axis micrometric turntable fixing base and the R-axis rotating platform, an R-axis micrometric head is adopted as the fixing part of the R-axis rotation detection measuring tool, and an R-axis resetting device is arranged between the R-axis micrometric turntable fixing base and the R-axis rotating platform; the Z-axis micrometering platform comprises a Z-axis guide rail and a Z-axis movement detection measuring tool, a Z-axis micrometering head is adopted as a fixing part of the Z-axis movement detection measuring tool, the Z-axis guide rail is installed between a Z-axis moving platform and a Z-axis micrometering platform upright post, a Z-axis clamping device is arranged between the Z-axis moving platform and the Z-axis micrometering platform upright post, and a Z-axis reset spring is arranged between the Z-axis moving platform and the Z-axis micrometering platform upright.

4. The industrial robot pose accuracy and pose repeatability detection device according to claim 1, wherein the measuring rack further comprises three horizontally arranged triangular positioning plates, positioning holes matched with the stand columns are arranged at the vertexes of the positioning plates, the mounting base plates comprise a first mounting base plate and two second mounting base plates, the stand columns comprise bases and extension rods, zero, one or more extension rods are arranged, the bases and the extension rods are of hollow structures, and the bases and the extension rods are detachably and fixedly connected through stand column joints; the base of the second upright column and the base of the fifth upright column are fixedly connected to one second mounting plate, the base of the third upright column and the base of the fourth upright column are fixedly connected to the other second mounting plate, and the base of the first upright column is fixedly connected to the first mounting plate; the first positioning plate is fixedly arranged on the outer circles of the first stand column, the second stand column and the third stand column through positioning holes in the positioning plate; the second positioning plate is fixedly arranged on the outer circles of the first upright post, the fourth upright post and the fifth upright post through positioning holes in the positioning plate; and the third positioning plate is fixedly arranged on the excircle of the first stand column, the second stand column and the third stand column through positioning holes in the positioning plates, and the third positioning plate is positioned above the first positioning plate.

5. The industrial robot pose accuracy and pose repeatability detection device according to claim 4, wherein the top and bottom of the column joint are provided with positioning grooves with opening structures, the top of the base and two ends of the extension rod are provided with positioning holes matched with the positioning grooves, the matching position of the positioning grooves and the positioning holes is provided with positioning pins, and the base and the extension rod are provided with locking hand wheels for locking the column joint.

6. The industrial robot pose accuracy and pose repeatability detection device according to claim 1 or 5, wherein a quick-change positioning device is fixedly connected to the bottom of a measuring instrument fixing base of the four-axis measuring instrument, the quick-change positioning device comprises a positioning sleeve, a positioning groove with an opening structure is arranged on the positioning sleeve, a positioning hole matched with the positioning groove is arranged at the top end of the upright post, a positioning pin is arranged at the matching position of the positioning groove and the positioning hole, and a locking hand wheel for locking the positioning sleeve is arranged on the upright post.

7. Method for detection of the accuracy and repeatability of the pose of an industrial robot using the device according to any of claims 1 to 6, characterized in that it comprises the following test steps:

1) end effector for mounting test

Fixedly mounting a probe interface plate of an end effector for testing on a mechanical interface flange plate at the end of an industrial robot to be tested, mounting a probe on the probe interface plate, and symmetrically and fixedly connecting balancing weights to two sides of the probe; the threaded holes arranged on the periphery of the balancing weight can be used for additionally installing balancing weight screws or fixing the balancing weight by using the balancing weight screws after increasing the number of the balancing weight, and the additionally installed balancing weight screws or the balancing weight can be used for adjusting the balancing weight and the position of the mass center; the balancing weight can be selected and matched according to the requirements of GB/T12642 and 100 percent rated load, 50 percent rated load or 10 percent rated load of the industrial robot to be tested;

2) mounting and measuring rack

Mounting a mounting bottom plate of the measuring rack on the plane of the measuring workbench; fixedly connecting the first upright column to the fifth upright column on the mounting base plate, wherein the positions of the upright columns meet the requirement of GB/T12642, so that the embodied test cube is positioned at the part expected to be applied most in the working space of the robot; enabling the edge of the test cube to be parallel to a base coordinate system of the robot; the central line of the first upright post is positioned in a coordinate system x of the robot seat1o1z1On a plane;

3) calibrating a test point

Mounting a sample marking needle at the top end of a first upright post of a measuring rack, wherein the needle point of the sample marking needle represents a test point P1, moving a robot, and enabling the tip end of a probe on a test end effector to be in contact with the needle point of the sample marking needle to finish the calibration of a point P1;

taking a point P1 as a reference, calculating coordinates of other test points P2, P3, P4 and P5 in a robot base seat system according to a determination principle of a GB/T12642 related test cube and the test points, and taking the coordinates as instruction positions when testing action programming;

sequentially mounting the sample marking needle on the top ends of the second upright post to the fifth upright post of the measuring rack, enabling the needle point of the sample marking needle to respectively represent the test points P2 to P5, moving the robot in a teaching mode, enabling the tip of a probe on the test end effector to be in contact with the needle point of the sample marking needle, completing the calibration of the test points P2 to P5, comparing the calibrated test points with the calculated command position, and calculating a corresponding deviation value to be used as a first error compensation value during later data processing;

4) calibrating a four-axis measuring instrument

Installing the sample mark needle into a four-axis measuring instrument, aligning a measuring point of a measuring groove on a position detecting claw with a needle point of the sample mark needle, and respectively reading the readings of X-direction, Y-direction and Z-direction micrometer heads on the four-axis measuring instrument to be used as a second error compensation value in the later data processing;

5) position accuracy and position repeatability measurements

Under an automatic control mode, enabling the robot to test the end effector to move to a position to be measured at a fixed posture and a speed required by GB/T12642 and then pause; installing a four-axis measuring instrument on the top end of the upright post corresponding to the point to be measured, and ensuring that the X direction, the Y direction and the Z direction of the four-axis measuring instrument are parallel to a base coordinate system of the industrial robot to be measured; respectively adjusting the positions of X-direction, Y-direction and Z-direction micrometer heads of the four-axis measuring instrument, enabling the measuring points to be in contact with the tip of a probe on the end effector for the robot test, and respectively reading displacement values of the X-direction micrometer heads, the Y-direction micrometer heads and the Z-direction micrometer heads; respectively subtracting the first error compensation value and the second error compensation value from the displacement values of the X-direction micrometer head, the Y-direction micrometer head and the Z-direction micrometer head to obtain position deviation values delta X, delta Y and delta Z of the industrial robot to be tested at the test point; respectively measuring the test points according to the sequence and the cycle measurement times recommended by GB/T12642 to obtain the position deviation value delta x of each test pointj,Δyj,Δzj

a. Calculating the position accuracy of the test points:

wherein, i represents the ith test point,

wherein n is the cycle number;

should select AP1~AP5Taking the worst data as the position accuracy of the whole robot to be tested;

b. and (3) calculating the position repetition degree of the test points:

wherein, i represents the ith test point,

6) attitude accuracy and attitude repeatability measurements

Under automatic control, the robot measurement end effector is moved to a position to be measured at a fixed posture and the speed required by GB/T12642 and then is suspended; installing a four-axis measuring instrument on the top end of the upright post corresponding to the point to be measured, and ensuring that the X direction, the Y direction and the Z direction of the four-axis measuring instrument are parallel to a base coordinate system of the industrial robot to be measured;

adjusting the position of X-direction, Y-direction and Z-direction micrometer heads of four-axis measuring instrument to make the detecting blade on the attitude detecting claw contact with the cylindrical surface of the front end of the probe, recording the contact point as the first measuring point, respectively reading the displacement values of the X-direction micrometer head and the Z-direction micrometer head, and recording the displacement values as X1And z1(ii) a Rotating the R-axis micrometer rotary table by 90 degrees, keeping the position of the Z-direction micrometer head unchanged, adjusting the position of the Y-direction micrometer head to make the detection blade of the attitude detection claw contact with the cylindrical surface at the front end of the probe on the end effector for measurement, and reading the Y-direction micrometer headThe value of the displacement, and is denoted as y1(ii) a The Y-direction and Z-direction micrometer heads of the four-axis measuring instrument are adjusted again to make the detecting blade of the attitude detecting claw contact with another arbitrary point on the cylindrical surface at the front end of the probe, the contact point is marked as a second measuring point, the second measuring point is far away from the first measuring point, the displacement values of the Y-direction and Z-direction micrometer heads are respectively read and marked as Y2And z2(ii) a Rotating the R-axis micrometric turntable by 90 degrees, namely rotating the R-axis micrometric turntable back to the initial position, keeping the position of the Z-direction micrometric head unchanged, adjusting the position of the X-direction micrometric head to enable the detection blade of the attitude detection claw to be in contact with the cylindrical surface at the front end of the probe, reading the displacement value of the X-direction micrometric head and recording the displacement value as X2

Δxi=x2-x1,Δyi=y2-y1,Δzi=z2-z1

Wherein i represents the ith test point;

calculated as RPY angle:

pitch angleDeflection angleRoll angle α ═ θ6

Wherein, theta6The rotation angle of a mechanical interface flange plate of the wrist part of the robot is represented;

measurement and calculation of the roll angle α:

rotating the R-axis micrometer table by a deflection angle gammaiAdjusting the position of X-direction, Y-direction and Z-direction micrometer heads of the four-axis measuring instrument to make the detecting blade of the attitude detecting claw contact with the outer circle surface of one end of the measuring pin at the front end of the probe, recording the contact point as a third measuring point, reading the displacement values of the Y-direction micrometer heads and the Z-direction micrometer heads respectively, and recording the displacement values as Y3And z3(ii) a Adjusting the position of X-direction, Y-direction and Z-direction micrometer heads of the four-axis measuring instrument to make the detecting blade of the attitude detecting claw contact with the outer circle surface of the other end of the measuring pin at the front end of the probe, recording the contact point as a fourth measuring point, and respectively reading Y-direction micrometer head and Z-direction micrometer headThe value of the head displacement, and is denoted as y4And z4

Δy=y4-y3,Δz=z4-z3

a. And (3) posture accuracy calculation:

in the formula, betacccAttitude angles, AP, of the command poses of test points i, respectivelyi,β、APi,γAnd APi,αRespectively the accuracy of the attitude angle of the test point i,is the average value of attitude angles, beta, obtained by repeatedly responding n times at the same posejjjIs the attitude angle of the j-th actual pose;

b. and (3) calculating the repeatability of the posture:

and for the attitude accuracy and the attitude repeatability evaluation of the whole robot, selecting the worst value of the attitude accuracy and the attitude repeatability of each test point.

Technical Field

The invention relates to the field of robot performance detection, in particular to a device and a method for detecting pose accuracy and pose repeatability of an industrial robot.

Background

Industrial robots are multi-degree-of-freedom machine devices oriented in the industrial field, the position and attitude of the end effector of which is a composite result of multi-axis motions. The pose accuracy and the pose repeatability are important indexes for measuring the technical performance of the industrial robot, and have important significance for keeping the industrial robot in a stable working state.

GB/T12642 introduces a detection method for pose accuracy and pose repeatability and also introduces a plurality of detection devices, but the existing detection device for pose accuracy and pose repeatability is complex in equipment structure, high in price, complex in operation, high in technical requirement for operators, high in detection cost and not suitable for popularization and application.

Disclosure of Invention

The invention aims to provide a device and a method for detecting the pose accuracy and the pose repeatability of an industrial robot, wherein the device is simple in structure, portable, low in production cost and convenient to install; the detection method is simple to operate, has low technical requirements on operators, can detect most industrial robots, and is beneficial to improving the product quality of the industrial robots.

In order to achieve the purpose, the invention adopts the following technical scheme: the industrial robot pose accuracy and pose repeatability detection device comprises a test end effector, a measurement rack and a four-axis measurement instrument; the end effector for testing comprises a probe interface plate, a probe and a plurality of balancing weights; one side of the probe interface board is fixedly connected to a mechanical interface flange plate at the tail end of the robot, the probe is fixedly connected to the other side of the probe interface board, a measuring pin is installed at the position, close to the tip, of the probe, and balancing weights are symmetrically and fixedly connected to the two sides of the probe; the measuring rack comprises a mounting bottom plate, an upright post and a sample marking needle, the upright post is divided into a first upright post, a second upright post, a third upright post, a fourth upright post and a fifth upright post which are all fixedly connected on the mounting bottom plate, and the second upright post and the third upright post have the same structure and are higher than the first upright post; the fourth upright post and the fifth upright post have the same structure and are lower than the first upright post in height; the second upright post, the third upright post, the fourth upright post and the fifth upright post sequentially enclose a rectangular structure, and the first upright post is arranged at the center of the rectangle; the sample marking needles are respectively arranged on the tops of the columns, when the sample marking needles are arranged on the tops of the first columns, the positions of the needle points are marked as P1, when the sample marking needles are arranged on the tops of the second columns, the positions of the needle points are marked as P2, when the sample marking needles are arranged on the tops of the third columns, the positions of the needle points are marked as P3, when the sample marking needles are arranged on the tops of the fourth columns, the positions of the needle points are marked as P4, when the sample marking needles are arranged on the tops of the fifth columns, the positions of the needle points are marked as P5, and the positions of the P1, the P2, the P3, the P4 and the P5 meet the requirements of GB/T12642; the four-axis measuring instrument comprises a measuring instrument fixing base, an X-axis micrometering table, a Y-axis micrometering table, an R-axis micrometering rotary table and a Z-axis micrometering table; the X-axis micro measurement platform comprises an X-axis micro measurement platform fixing base, an X-axis moving platform and an X-axis movement detection measuring tool, a movement kinematic pair is formed between the X-axis moving platform and the X-axis micro measurement platform fixing base, the X-axis movement detection measuring tool comprises a fixing part and a movement displacement detection part, and the fixing part and the movement displacement detection part of the X-axis movement detection measuring tool are respectively installed on the X-axis micro measurement platform fixing base and the X-axis moving platform; the Y-axis micro measurement platform comprises a Y-axis micro measurement platform fixing base, a Y-axis moving platform and a Y-axis movement detection measuring tool, a movement kinematic pair is formed between the Y-axis moving platform and the Y-axis micro measurement platform fixing base, the Y-axis movement detection measuring tool comprises a fixing part and a movement displacement detection part, and the fixing part and the movement displacement detection part of the Y-axis movement detection measuring tool are respectively installed on the Y-axis micro measurement platform fixing base and the Y-axis moving platform; the R-axis micrometric rotary table comprises an R-axis micrometric rotary table fixing base, an R-axis rotating platform and an R-axis rotation detection measuring tool, a rotating kinematic pair is formed between the R-axis rotating platform and the R-axis micrometric rotary table fixing base, the R-axis rotation detection measuring tool comprises a fixing part and a rotation displacement detection part, and the fixing part and the rotation displacement detection part of the R-axis rotation detection measuring tool are respectively arranged on the R-axis micrometric rotary table fixing base and the R-axis rotating platform; the Z-axis micro measurement platform comprises a Z-axis micro measurement platform upright post, a Z-axis moving platform and a Z-axis movement detection measuring tool, a moving kinematic pair is formed between the Z-axis moving platform and the Z-axis micro measurement platform upright post, the Z-axis movement detection measuring tool comprises a fixed part and a moving displacement detection part, and the fixed part and the moving displacement detection part of the Z-axis movement detection measuring tool are respectively arranged on the Z-axis micro measurement platform upright post and the Z-axis moving platform; the X-axis micrometric table fixing base is fixedly connected to the top of the measuring instrument fixing base, the Y-axis micrometric table fixing base is fixedly connected to the top of the X-axis moving platform, and the moving direction of the Y-axis moving platform is perpendicular to that of the X-axis moving platform; the R-axis micrometric turntable fixing base is fixedly connected to the top of the Y-axis moving platform, the Z-axis micrometric table upright post is fixedly connected to the top of the R-axis rotating platform, and the moving direction of the Z-axis moving platform is respectively vertical to the moving direction of the X-axis moving platform and the moving direction of the Y-axis moving platform; the X-axis micro-measuring table, the Y-axis micro-measuring table and the R-axis micro-measuring rotary table are all provided with through holes for the sample marking needles to pass through; a position detection claw and a posture detection claw are fixedly connected to the Z-axis moving platform, a measurement groove is formed in the position detection claw, and one vertex of the measurement groove is used as a measurement point; the gesture detects and is provided with the detection sword on the claw, detects the last plane level setting of sword, detects the side slope setting of sword, detects the side of sword and is the acute angle with the contained angle between the last plane, detects the junction formation straight line detection cutting edge of last plane and the side of sword.

Optionally, a plurality of threaded holes are uniformly formed in the circumferential direction of the balancing weight, and balancing screws are connected in the threaded holes in an internal thread mode.

Optionally, the X-axis micro-measurement platform further comprises an X-axis guide rail, and the fixing part of the X-axis movement detection measuring tool adopts an X-axis micro-measurement head, the X-axis guide rail is installed between the X-axis moving platform and the X-axis micro-measurement platform fixing base, an X-axis clamping device is arranged between the X-axis moving platform and the X-axis micro-measurement platform fixing base, and an X-axis return spring is arranged between the X-axis moving platform and the X-axis micro-measurement platform fixing base; the Y-axis micro-measuring platform comprises a Y-axis guide rail, a Y-axis moving detection measuring tool fixing part adopts a Y-axis micro-measuring head, the Y-axis guide rail is installed between the Y-axis moving platform and the Y-axis micro-measuring platform fixing base, a Y-axis clamping device is arranged between the Y-axis moving platform and the Y-axis micro-measuring platform fixing base, and a Y-axis reset spring is arranged between the Y-axis moving platform and the Y-axis micro-measuring platform fixing base; an R-axis clamping device is arranged between the R-axis micrometric turntable fixing base and the R-axis rotating platform, an R-axis micrometric head is adopted as the fixing part of the R-axis rotation detection measuring tool, and an R-axis resetting device is arranged between the R-axis micrometric turntable fixing base and the R-axis rotating platform; the Z-axis micrometering platform comprises a Z-axis guide rail and a Z-axis movement detection measuring tool, a Z-axis micrometering head is adopted as a fixing part of the Z-axis movement detection measuring tool, the Z-axis guide rail is installed between a Z-axis moving platform and a Z-axis micrometering platform upright post, a Z-axis clamping device is arranged between the Z-axis moving platform and the Z-axis micrometering platform upright post, and a Z-axis reset spring is arranged between the Z-axis moving platform and the Z-axis micrometering platform upright.

Optionally, the measuring rack further comprises three horizontally arranged triangular positioning plates, positioning holes matched with the stand columns are arranged at the vertexes of the positioning plates, the mounting base plates comprise a first mounting base plate and two second mounting base plates, the stand columns comprise bases and extension rods, zero, one or more extension rods can be arranged, the bases and the extension rods are hollow structures, and the bases and the extension rods are detachably and fixedly connected through stand column joints; the base of the second upright column and the base of the fifth upright column are fixedly connected to one second mounting plate, the base of the third upright column and the base of the fourth upright column are fixedly connected to the other second mounting plate, and the base of the first upright column is fixedly connected to the first mounting plate; the first positioning plate is fixedly arranged on the outer circles of the first stand column, the second stand column and the third stand column through positioning holes in the positioning plate; the second positioning plate is fixedly arranged on the outer circles of the first upright post, the fourth upright post and the fifth upright post through positioning holes in the positioning plate; and the third positioning plate is fixedly arranged on the excircle of the first stand column, the second stand column and the third stand column through positioning holes in the positioning plates, and the third positioning plate is positioned above the first positioning plate.

Optionally, the top and the bottom that the stand connects all are provided with open structure's constant head tank, the base top, the both ends of extension bar all be provided with constant head tank assorted locating hole, the constant head tank is provided with the locating pin with the cooperation department of locating hole, be provided with the locking hand wheel that is used for locking stand to connect on base and the extension bar.

Optionally, four-axis measuring apparatu's measuring apparatu unable adjustment base bottom fixedly connected with quick change positioner, quick change positioner include the position sleeve, are provided with open structure's constant head tank on the position sleeve, the stand top be provided with constant head tank assorted locating hole, the cooperation department of constant head tank and locating hole is provided with the locating pin, is provided with the locking hand wheel that is used for locking the position sleeve on the stand.

The method for detecting the pose accuracy and the pose repeatability of the industrial robot comprises the following testing steps:

1) end effector for mounting test

Fixedly mounting a probe interface plate of an end effector for testing on a mechanical interface flange plate at the end of an industrial robot to be tested, mounting a probe on the probe interface plate, and symmetrically and fixedly connecting balancing weights to two sides of the probe; the threaded holes arranged on the periphery of the balancing weight can be used for additionally installing balancing weight screws or fixing the balancing weight by using the balancing weight screws after increasing the number of the balancing weight, and the additionally installed balancing weight screws or the balancing weight can be used for adjusting the balancing weight and the position of the mass center; the balancing weight can be selected and matched according to the requirements of GB/T12642 and 100 percent rated load, 50 percent rated load or 10 percent rated load of the industrial robot to be tested;

2) mounting and measuring rack

Mounting a mounting bottom plate of the measuring rack on the plane of the measuring workbench; fixedly connecting the first upright column to the fifth upright column on the mounting base plate, wherein the positions of the upright columns meet the requirement of GB/T12642, so that the embodied test cube is positioned at the part expected to be applied most in the working space of the robot; enabling the edge of the test cube to be parallel to a base coordinate system of the robot; the central line of the first upright post is positioned in a coordinate system x of the robot seat1o1z1On a plane;

3) calibrating a test point

Mounting a sample marking needle at the top end of a first upright post of a measuring rack, wherein the needle point of the sample marking needle represents a test point P1, moving a robot, and enabling the tip end of a probe on a test end effector to be in contact with the needle point of the sample marking needle to finish the calibration of a point P1;

taking a point P1 as a reference, calculating coordinates of other test points P2, P3, P4 and P5 in a robot base seat system according to a determination principle of a GB/T12642 related test cube and the test points, and taking the coordinates as instruction positions when testing action programming;

sequentially mounting the sample marking needle on the top ends of the second upright post to the fifth upright post of the measuring rack, enabling the needle point of the sample marking needle to respectively represent the test points P2 to P5, moving the robot in a teaching mode, enabling the tip of a probe on the test end effector to be in contact with the needle point of the sample marking needle, completing the calibration of the test points P2 to P5, comparing the calibrated test points with the calculated command position, and calculating a corresponding deviation value to be used as a first error compensation value during later data processing;

4) calibrating a four-axis measuring instrument

Installing the sample mark needle into a four-axis measuring instrument, aligning a measuring point of a measuring groove on a position detecting claw with a needle point of the sample mark needle, and respectively reading the readings of X-direction, Y-direction and Z-direction micrometer heads on the four-axis measuring instrument to be used as a second error compensation value in the later data processing;

5) position accuracy and position repeatability measurements

Under an automatic control mode, enabling the robot to test the end effector to move to a position to be measured at a fixed posture and a speed required by GB/T12642 and then pause; installing a four-axis measuring instrument on the top end of the upright post corresponding to the point to be measured, and ensuring that the X direction, the Y direction and the Z direction of the four-axis measuring instrument are parallel to a base coordinate system of the industrial robot to be measured; respectively adjusting the positions of X-direction, Y-direction and Z-direction micrometer heads of the four-axis measuring instrument, enabling the measuring points to be in contact with the tip of a probe on the end effector for the robot test, and respectively reading displacement values of the X-direction micrometer heads, the Y-direction micrometer heads and the Z-direction micrometer heads; respectively subtracting the first error compensation value and the second error compensation value from the displacement values of the X-direction micrometer head, the Y-direction micrometer head and the Z-direction micrometer head to obtain position deviation values delta X, delta Y and delta Z of the industrial robot to be tested at the test point; respectively measuring the test points according to the sequence and the cycle measurement times recommended by GB/T12642 to obtain the position deviation value delta x of each test pointj,Δyj,Δzj

a. Calculating the position accuracy of the test points:

wherein, i represents the ith test point,

wherein n is the cycle number;

should select AP1~AP5Taking the worst data as the position accuracy of the whole robot to be tested;

b. and (3) calculating the position repetition degree of the test points:

wherein, i represents the ith test point,

6) attitude accuracy and attitude repeatability measurements

Under automatic control, the robot measurement end effector is moved to a position to be measured at a fixed posture and the speed required by GB/T12642 and then is suspended; installing a four-axis measuring instrument on the top end of the upright post corresponding to the point to be measured, and ensuring that the X direction, the Y direction and the Z direction of the four-axis measuring instrument are parallel to a base coordinate system of the industrial robot to be measured;

adjusting the position of X-direction, Y-direction and Z-direction micrometer heads of four-axis measuring instrument to make the detecting blade on the attitude detecting claw contact with the cylindrical surface of the front end of the probe, recording the contact point as the first measuring point, respectively reading the displacement values of the X-direction micrometer head and the Z-direction micrometer head, and recording the displacement values as X1And z1(ii) a Rotating the R-axis micrometer rotary table by 90 degrees, keeping the position of the Z-direction micrometer head unchanged, adjusting the position of the Y-direction micrometer head to make the detection blade of the attitude detection claw contact with the cylindrical surface at the front end of the probe on the end effector for measurement, reading the displacement value of the Y-direction micrometer head, and recording the displacement value as Y1(ii) a The Y-direction and Z-direction micrometer heads of the four-axis measuring instrument are adjusted again to make the detecting blade of the attitude detecting claw contact with another arbitrary point on the cylindrical surface at the front end of the probe, the contact point is marked as a second measuring point, the second measuring point is far away from the first measuring point, the displacement values of the Y-direction and Z-direction micrometer heads are respectively read and marked as Y2And z2(ii) a The R-axis micrometric rotary table is rotated for 90 degrees, namely the R-axis micrometric rotary table is rotated back to the initial position, and the Z-direction micrometric rotary table is rotatedThe position of the head is kept unchanged, the position of the X-direction micrometer head is adjusted to enable the detection blade of the attitude detection claw to be in contact with the cylindrical surface at the front end of the probe, the displacement value of the X-direction micrometer head is read and recorded as X2

Δxi=x2-x1,Δyi=y2-y1,Δzi=z2-z1

Wherein i represents the ith test point;

calculated as RPY angle:

pitch angleDeflection angleRoll angle α ═ θ6

Wherein, theta6The rotation angle of a mechanical interface flange plate of the wrist part of the robot is represented;

measurement and calculation of the roll angle α:

rotating the R-axis micrometer table by a deflection angle gammaiAdjusting the position of X-direction, Y-direction and Z-direction micrometer heads of the four-axis measuring instrument to make the detecting blade of the attitude detecting claw contact with the outer circle surface of one end of the measuring pin at the front end of the probe, recording the contact point as a third measuring point, reading the displacement values of the Y-direction micrometer heads and the Z-direction micrometer heads respectively, and recording the displacement values as Y3And z3(ii) a Adjusting the position of X-direction, Y-direction and Z-direction micrometer heads of the four-axis measuring instrument to make the detecting blade of the attitude detecting claw contact with the outer circle surface of the other end of the measuring pin at the front end of the probe, recording the contact point as a fourth measuring point, respectively reading the displacement values of the Y-direction micrometer heads and the Z-direction micrometer heads and recording the displacement values as Y4And z4

Δy=y4-y3,Δz=z4-z3

a. And (3) posture accuracy calculation:

in the formula, betacccAttitude angles, AP, of the command poses of test points i, respectivelyi,β、APi,γAnd APi,αRespectively the accuracy of the attitude angle of the test point i,is the average value of attitude angles, beta, obtained by repeatedly responding n times at the same posejjjIs the attitude angle of the j-th actual pose;

b. and (3) calculating the repeatability of the posture:

and for the attitude accuracy and the attitude repeatability evaluation of the whole robot, selecting the worst value of the attitude accuracy and the attitude repeatability of each test point.

The device and the method for detecting the pose accuracy and the pose repeatability of the industrial robot have the following advantages:

(1) the detection device has simple structure, portability, high measurement precision and low cost; the installation between spare part is convenient, swift.

(2) The operation method of the four-axis measuring instrument is simple, and compared with detection devices such as a laser tracker and the like, the four-axis measuring instrument does not need operators and has higher technical level.

(3) The quick-change positioning device is convenient to mount and dismount, quick replacement of the four-axis measuring instrument is facilitated, and detection efficiency is improved.

Drawings

Fig. 1 is a schematic view of the overall structure of the present invention.

Fig. 2 is a schematic structural diagram of a four-axis measuring instrument.

Fig. 3 is a schematic structural view of the measuring rack.

Fig. 4 is a schematic structural view of the position detection claw.

Fig. 5 is a schematic structural view of the posture detecting pawl.

Fig. 6 is a schematic view of the quick-change positioning sleeve and the base.

Fig. 7 is a schematic cross-sectional structure view of the quick-change positioning sleeve matched with the base.

Reference numerals: 1-end effector for test, 101-probe interface board, 102-counterweight block, 103-counterweight screw, 104-measuring pin, 105-probe, 2-four-axis measuring instrument, 201-measuring instrument fixing base, 202-X axis moving platform, 203-X axis movement detecting measuring instrument, 204-X axis clamping device, 205-Y axis moving platform, 206-Y axis movement detecting measuring instrument, 207-R axis rotating platform, 208-R axis rotation detecting measuring instrument, 209-R axis clamping device, 210-Z axis micro-measuring platform upright post, 211-Z axis moving platform, 212-Z axis movement detecting measuring instrument, 213-Z axis clamping device, 3-sample pointer, 4-measuring rack, 401-first upright post, 402-second upright post, 403-third upright post, 404-a fourth upright post, 405-a fifth upright post, 406-a first mounting bottom plate, 407-a second mounting bottom plate, 408-a base, 409-an extension bar, 410-a positioning plate, 411-a locking hand wheel, 5-a position detection claw, 501-a measurement groove, 502-a measurement point, 6-a posture detection claw, 601-a detection knife, 602-a detection knife edge, 7-a quick-change positioning device, 701-a positioning sleeve and 8-a positioning pin.

Detailed Description

In the following description, the moving direction of the X-axis moving stage 202 is taken as the X-axis direction of the space coordinate system, the moving direction of the Y-axis moving stage 205 is taken as the Y-axis direction of the space coordinate system, and the moving direction of the Z-axis moving stage 211 is taken as the Z-axis direction of the space coordinate system.

As shown in fig. 1-7, the industrial robot pose accuracy and pose repeatability detection device comprises a test end effector 1, a measurement rack 4 and a four-axis measuring instrument 2; the end effector 1 for testing comprises a probe interface plate 101, a probe 105 and a plurality of balancing weights 102; one side of the probe interface board 101 is fixedly connected to a mechanical interface flange plate at the tail end of the robot, the probe 105 is fixedly connected to the other side of the probe interface board 101, and a measuring pin 104 is arranged at the position, close to the tip, of the probe 105; the balancing weight 102 is symmetrically and fixedly connected to two sides of the probe 105, and the balancing weight 102 can be selected and matched according to 100% rated load, 50% rated load or 10% rated load of the industrial robot to be tested according to the requirement of GB/T12642.

The measuring rack 4 comprises a mounting base plate, upright columns and a sample marking needle 3, the upright columns are divided into a first upright column 401, a second upright column 402, a third upright column 403, a fourth upright column 404 and a fifth upright column 405, the upright columns are fixedly connected to the mounting base plate, the second upright column 402 and the third upright column 403 have the same structure, and the height of the second upright column 402 is higher than that of the first upright column 401; the fourth upright column 404 and the fifth upright column 405 have the same structure and are lower than the first upright column 401 in height; a second upright post 402, a third upright post 403, a fourth upright post 404 and a fifth upright post 405 sequentially form a square structure, and the first upright post 401 is arranged at the center of the square; sample index needle 3 is detachably installed at each stand top respectively, and sample index needle 3 only uses when demarcating the check point and demarcating four-axis measuring apparatu 2, and detachable connected mode can make things convenient for sample index needle 3's dismouting, improves the efficiency of demarcation.

When the marking needle 3 is arranged on the top of the first upright column 401, the position of the needle point is marked as P1, when the marking needle 3 is arranged on the top of the second upright column 402, the position of the needle point is marked as P2, when the marking needle 3 is arranged on the top of the third upright column 403, the position of the needle point is marked as P3, when the marking needle 3 is arranged on the top of the fourth upright column 404, the position of the needle point is marked as P4, when the marking needle 3 is arranged on the top of the fifth upright column 405, the position of the needle point is marked as P5, and the positions of P1, P2, P3, P4 and P5 meet the requirements of GB/T12642; the quick-change positioning sleeve 701 is installed at the bottom of the sample marker needle 3.

The four-axis measuring instrument 2 comprises a measuring instrument fixing base 201, an X-axis micrometering table, a Y-axis micrometering table, an R-axis micrometering turntable and a Z-axis micrometering table; the X-axis micro measurement platform comprises an X-axis micro measurement platform fixing base 408, an X-axis moving platform 202 and an X-axis moving detection measuring tool 203, a moving kinematic pair is formed between the X-axis moving platform 202 and the X-axis micro measurement platform fixing base 408, the moving kinematic pair can be realized through a rolling track, a sliding track and other connecting structures, the X-axis moving detection measuring tool 203 can measure the displacement deviation of the industrial robot in the X-axis direction, the X-axis moving detection measuring tool 203 comprises a fixing part and a moving displacement detection part, the fixing part of the X-axis moving detection measuring tool 203 is installed on the X-axis micro measurement platform fixing base 408, and the moving displacement detection part of the X-axis moving detection measuring tool 203 is installed on the X-axis moving platform 202.

The Y-axis micro measurement platform comprises a Y-axis micro measurement platform fixing base 408, a Y-axis moving platform 205 and a Y-axis moving detection measuring tool 206, a moving kinematic pair is formed between the Y-axis moving platform 205 and the Y-axis micro measurement platform fixing base 408, the moving kinematic pair can be realized through a rolling track, a sliding track and other connecting structures, the Y-axis moving detection measuring tool 206 can measure the displacement deviation of the industrial robot in the Y-axis direction, the Y-axis moving detection measuring tool 206 comprises a fixing part and a moving displacement detection part, the fixing part of the Y-axis moving detection measuring tool 206 is installed on the Y-axis micro measurement platform fixing base 408, and the moving displacement detection part of the Y-axis moving detection measuring tool 206 is installed on the Y-axis moving platform 205.

The R-axis micrometric rotary table comprises an R-axis micrometric rotary table fixed base 408, an R-axis rotating platform 207 and an R-axis rotation detection measuring tool 208, and a rotating kinematic pair is formed between the R-axis rotating platform 207 and the R-axis micrometric rotary table fixed base 408 and can be realized through a bearing and other structures. In the detection process of position accuracy and repeatability, when the displacement deviation measurement of the X axis, the Y axis and the Z axis is interfered, the angle of the measuring point 502 can be adjusted through the R axis micrometric turntable, so that the situation that the displacement deviation of the X axis, the Y axis and the Z axis cannot be measured due to mutual interference of the structure of the end effector 1 for testing and the structure of the four-axis measuring instrument 2 is prevented; in the detection process of attitude accuracy and repeatability, the R-axis micrometric rotary table can be used for measuring the pose angle of the industrial robot. The R-axis rotation detection gauge 208 includes a fixed portion and a rotational displacement detection portion, the fixed portion of the R-axis rotation detection gauge 208 is mounted on the R-axis micrometer stage fixed base 408, and the moving displacement detection portion of the R-axis rotation detection gauge 208 is mounted on the R-axis rotating platform 207.

The Z-axis micro measurement platform comprises a Z-axis micro measurement platform upright post 210, a Z-axis moving platform 211 and a Z-axis movement detection measuring tool 212, a movement kinematic pair is formed between the Z-axis moving platform 211 and the Z-axis micro measurement platform upright post 210 and can be realized through a rolling track, a sliding track and other connecting structures, the Z-axis movement detection measuring tool 212 can measure the displacement deviation of the industrial robot in the Z-axis direction, the Z-axis movement detection measuring tool 212 comprises a fixing part and a movement displacement detection part, the fixing part of the Z-axis movement detection measuring tool 212 is installed on a Z-axis micro measurement platform fixing base 408, and the movement displacement detection part of the Z-axis movement detection measuring tool 212 is installed on the Z-axis moving platform 211.

The movement or rotation of the X-axis micrometric table, the Y-axis micrometric table, the R-axis micrometric rotary table and the Z-axis micrometric table can be driven by manual, electric or other servo drives; the detection measuring tools of the X-axis micrometer table, the Y-axis micrometer table, the R-axis micrometer rotary table and the Z-axis micrometer table can adopt mechanical measuring tools such as micrometer heads, dial indicators and the like, and can also adopt contact or non-contact displacement sensors.

The X-axis micrometer stage fixed base 408 is fixedly connected to the top of the measuring instrument fixed base 201; the Y-axis micrometer stage fixed base 408 is fixedly connected to the top of the X-axis moving platform 202, and the moving direction of the Y-axis moving platform 205 is vertical to that of the X-axis moving platform 202; the R-axis micrometric turntable fixing base 408 is fixedly connected to the top of the Y-axis moving platform 205; the Z-axis micrometer stage upright column 210 is fixedly connected to the top of the R-axis rotating platform 207, and the moving direction of the Z-axis moving platform 211 is respectively vertical to the moving direction of the X-axis moving platform 202 and the moving direction of the Y-axis moving platform 205. The X-axis micrometric turret mount 408 may be integral with the gauge mount 201; the Y-axis micrometric turret fixed base 408 may be integral with the X-axis mobile platform 202; the R-axis micrometric turret fixed base 408 may be integrated with the Y-axis mobile platform 205; the Z-axis micropositioner column 210 may be integrated with the R-axis rotary table 207 in a single structure, and the sequence and connection of the X-axis micropositioner, the Y-axis micropositioner, and the R-axis micropositioner may include, but are not limited to, the above structures.

X axle micrometering platform, Y axle micrometering platform and R axle micrometering revolving stage all are provided with the through-hole that supplies appearance guide pin 3 to pass, and when carrying out the calibration to four-axis measuring apparatu 2, appearance guide pin 3 is installed inside four-axis measuring apparatu 2, utilizes the needle point of appearance guide pin 3 to carry out calibration to measuring point 502.

A position detection claw 5 and a posture detection claw 6 are fixedly connected to the Z-axis moving platform 211, a measurement groove 501 is formed in the position detection claw 5, one vertex of the measurement groove 501 is used as a measurement point 502, and the measurement point 502 is used for measuring displacement deviations of the industrial robot on an X axis, a Y axis and a Z axis; the posture detection claw 6 is provided with a detection knife 601, the upper plane of the detection knife 601 is horizontally arranged, the side surface of the detection knife 601 is obliquely arranged, the included angle between the side surface of the detection knife 601 and the upper plane is an acute angle, a straight line detection blade 602 is formed at the joint of the upper plane and the side surface of the detection knife 601, and the detection blade 602 is used for measuring the posture angle of the industrial robot.

Further, a plurality of threaded holes are uniformly formed in the circumferential direction of the balancing weight 102, the threaded holes can be used for being additionally provided with balancing weight screws 103 or being fixed by the balancing weight screws 103 after the number of the balancing weight 102 is increased, and the additionally provided balancing weight screws 103 or the balancing weight 102 can be used for adjusting the balancing weight and the mass center position.

Further, the X-axis micro-measurement platform further comprises an X-axis guide rail, an X-axis micro-measurement head is adopted as a fixing portion of the X-axis movement detection gauge 203, the X-axis guide rail is installed between the X-axis moving platform 202 and the X-axis micro-measurement platform fixing base 408, an X-axis clamping device 204 is arranged between the X-axis moving platform 202 and the X-axis micro-measurement platform fixing base 408, when the X-axis clamping device 204 is locked, movement of the four-axis measurement gauge 2 in the X-axis direction can be limited, an X-axis return spring is arranged between the X-axis moving platform 202 and the X-axis micro-measurement platform fixing base 408, and the X-axis return spring can enable the X-axis moving platform 202 and the X-axis movement detection gauge 203 to keep consistent, that is, the movement amount of the X-axis movement detection gauge 203 is the.

The Y-axis micro-measuring table comprises a Y-axis guide rail, a Y-axis micro-measuring head is adopted as a fixing part of the Y-axis movement detection measuring tool 206, the Y-axis guide rail is installed between the Y-axis moving platform 205 and the Y-axis micro-measuring table fixing base 408, a Y-axis clamping device is arranged between the Y-axis moving platform 205 and the Y-axis micro-measuring table fixing base 408, when the Y-axis clamping device is locked, the movement of the four-axis measuring tool 2 in the Y-axis direction can be limited, a Y-axis return spring is arranged between the Y-axis moving platform 205 and the Y-axis micro-measuring table fixing base 408, and the Y-axis return spring can enable the X-axis moving platform 202 and the Y-axis movement detection measuring tool 206 to keep consistent, namely the movement amount of the Y-axis movement detection measuring.

An R-axis clamping device 209 is arranged between the R-axis micrometric turntable fixing base 408 and the R-axis rotating platform 207, an R-axis micrometric head is adopted as a fixing part of the R-axis rotation detection measuring tool 208, an R-axis resetting device is arranged between the R-axis micrometric turntable fixing base 408 and the R-axis rotating platform 207, and the R-axis resetting device can enable the R-axis rotating platform 207 and the R-axis rotation detection measuring tool 208 to keep consistency, namely the rotation quantity of the R-axis rotation detection measuring tool 208 is the same as that of the R-axis rotating platform 207.

The Z-axis micrometer table comprises a Z-axis guide rail, a Z-axis micrometer head is adopted as a fixing part of the Z-axis movement detection measuring tool 212, the Z-axis guide rail is installed between the Z-axis moving platform 211 and the Z-axis micrometer table upright post 210, a Z-axis clamping device 213 is arranged between the Z-axis moving platform 211 and the Z-axis micrometer table upright post 210, when the Z-axis clamping device 213 is locked, the movement of the four-axis measuring instrument 2 in the Z-axis direction can be limited, a Z-axis return spring is arranged between the Z-axis moving platform 211 and the Z-axis micrometer table upright post 210, and the Z-axis return spring can enable the Z-axis moving platform 211 and the Z-axis movement detection measuring tool 212 to keep consistency, namely the movement amount of the Z-axis movement detection measuring tool 212 is the same as the.

Further, the measuring rack 4 further comprises three triangular positioning plates 410 horizontally arranged, positioning holes matched with the columns are arranged at the top points of the positioning plates 410, the mounting base plates comprise a first mounting base plate 406 and two second mounting base plates 407, the columns comprise bases 408 and extension rods 409, the number of the extension rods 409 can be zero, one or more, the extension rods 409 are not mounted on the fourth column 404 and the fifth column 405, one extension rod 409 is mounted on the first column 401, and two extension rods 409 are mounted on the second column 402 and the third column 403.

The base 408 and the extension bar 409 are both hollow structures, and the base 408 and the extension bar 409, and the extension bar 409 are detachably and fixedly connected through upright post joints; the base 408 of the second upright 402 and the base 408 of the fifth upright 405 are fixedly connected to one second mounting plate, the base 408 of the third upright 403 and the base 408 of the fourth upright 404 are fixedly connected to the other second mounting plate, and the base 408 of the first upright 401 is fixedly connected to the first mounting plate; the first positioning plate 410 is fixedly arranged on the outer circles of the first upright column 401, the second upright column 402 and the third upright column 403 through positioning holes on the positioning plate 410; the second positioning plate 410 is fixedly arranged on the outer circles of the first upright column 401, the fourth upright column 404 and the fifth upright column 405 through positioning holes on the positioning plate 410; the third positioning plate 410 is fixedly mounted on the outer circles of the first upright column 401, the second upright column 402 and the third upright column 403 through positioning holes in the positioning plate 410, the third positioning plate 410 is located above the first positioning plate 410, the positioning plate 410 can determine the mounting positions of the upright columns, the stability between the upright columns can be enhanced, and the accuracy of the measurement result is ensured.

Further, the top and the bottom that the stand connects all are provided with open structure's constant head tank, base 408 top, the both ends of extension bar 409 all be provided with constant head tank assorted locating hole, the constant head tank is provided with locating pin 8 with the cooperation department of locating hole, be provided with the locking hand wheel 411 that is used for locking the stand to connect on base 408 and the extension bar 409.

When the stand connects and inserts in base 408 or extension bar 409, usable locating pin 8 inserts in the locating hole on the constant head tank that the stand connects and base 408 or extension bar 409, connect the rotation on the horizontal direction to the stand and restrict, reuse locking hand wheel 411 supports the lateral wall that the stand connects, connect the removal in vertical side to the stand and restrict, after the position that the stand connects is restricted, it is last, the part that connects down also receives the same restriction, base 408 promptly, the position of extension bar 409 can not change, the stability of measuring frame 4 has been improved, and then the accuracy of testing result is improved.

When dismantling the stand, only need will loosen locking hand wheel 411, just can extract the stand and connect, need not operate locating pin 8 during the dismantlement, made things convenient for the dismantlement of stand.

Further, the bottom of the measuring instrument fixing base 201 of the four-axis measuring instrument 2 is fixedly connected with a quick-change positioning device 7, the quick-change positioning device 7 comprises a positioning sleeve 701, the connection mode of the positioning sleeve 701 and the column is the same as the connection mode of the column joint and the base 408 or the extension bar 409, a positioning groove with an open structure is arranged on the positioning sleeve 701, a positioning hole matched with the positioning groove is arranged at the top end of the column, a positioning pin 8 is arranged at the matching position of the positioning groove and the positioning hole, and a locking hand wheel 411 used for locking the positioning sleeve 701 is arranged on the column.

When the locating sleeve 701 is inserted into the top of the upright column, the locating pin 8 can be inserted into the locating groove of the locating sleeve 701 and the locating hole of the upright column to limit the rotation of the locating sleeve 701 in the horizontal direction, the locking hand wheel 411 is abutted against the side wall of the locating sleeve 701 to limit the movement of the locating sleeve 701 in the vertical direction, and after the position of the locating sleeve 701 is limited, the four-axis measuring instrument 2 fixedly connected with the locating sleeve is also limited in the same way, namely, the four-axis measuring instrument 2 is stably installed at the top end of the upright column, so that the subsequent operations such as calibration and detection are facilitated.

The four-axis measuring instrument 2 needs to complete parameter detection of five test points P1-P5, when the stand column of the four-axis measuring instrument 2 is replaced, the four-axis measuring instrument 2 can be taken down only by loosening the locking hand wheel 411, the positioning pin 8 does not need to be operated when the four-axis measuring instrument is detached and replaced, the four-axis measuring instrument 2 is replaced simply and quickly, and the detection efficiency can be improved.

A method for detecting the pose accuracy and the pose repeatability of an industrial robot comprises the following testing steps:

1) end effector 1 for mounting test

Fixedly installing a probe interface plate 101 of the end effector 1 for testing on a mechanical interface flange plate at the tail end of the industrial robot to be tested, installing a probe 105 on the probe interface plate 101, and symmetrically and fixedly connecting balancing weights 102 to two sides of the probe 105; the threaded holes arranged on the periphery of the balancing weight 102 can be used for installing the balancing weight screws 103 or fixing the balancing weight 102 by using the balancing weight screws 103 after increasing the number of the balancing weight 102, and the additionally installed balancing weight screws 103 or the balancing weight 102 can be used for adjusting the balancing weight and the position of the mass center; the balancing weight 102 can be selected and matched according to the requirements of GB/T12642 and 100 percent rated load, 50 percent rated load or 10 percent rated load of the industrial robot to be tested;

2) mounting of the measuring frame 4

Mounting the mounting bottom plate of the measuring frame 4 on the plane of the measuring workbench; fixedly connecting the first upright column 401 to the fifth upright column 405 on an installation bottom plate, wherein the positions of the upright columns meet the requirement of GB/T12642, so that the embodied test cube is positioned at the part with the most expected application in the working space of the robot; enabling the edge of the test cube to be parallel to a base coordinate system of the robot; the centre line of the first upright 401 is located in the robot seat coordinate system x1o1z1On a plane;

3) calibrating a test point

Mounting the sample marking needle 3 on the top end of the first upright column 401 of the measuring rack 4, wherein the needle point of the sample marking needle 3 represents a test point P1, moving the robot to enable the tip end of the probe 105 on the test end effector 1 to be in contact with the needle point of the sample marking needle 3, and completing the calibration of a point P1;

taking a point P1 as a reference, calculating coordinates of other test points P2, P3, P4 and P5 in a robot base seat system according to a determination principle of a GB/T12642 related test cube and the test points, and taking the coordinates as instruction positions when testing action programming;

sequentially mounting the sample marking needle 3 on the top ends of a second upright post 402-a fifth upright post 405 of the measuring frame 4, enabling the needle point of the sample marking needle 3 to respectively represent the test points P2-P5, moving the robot in a teaching mode, enabling the tip of a probe 105 on the test end effector 1 to be in contact with the needle point of the sample marking needle 3, completing the calibration of the test points P2-P5, comparing the test points with the calculated command position, and calculating a corresponding deviation value to be used as a first error compensation value in the later data processing;

4) calibrating a four-axis measuring instrument 2

Installing the sample mark needle 3 into the four-axis measuring instrument 2, aligning the measuring point 502 of the measuring groove 501 on the position detection claw 5 with the needle point of the sample mark needle 3, and respectively reading the readings of the micrometer heads in the X direction, the Y direction and the Z direction on the four-axis measuring instrument 2 as a second error compensation value in the later data processing;

5) position accuracy and position repeatability measurements

Under an automatic control mode, enabling the end effector 1 for the robot test to move to a position to be measured at a fixed posture and a speed required by GB/T12642 and then pause; installing a four-axis measuring instrument 2 on the top end of the upright post corresponding to the point to be measured, and ensuring that the X direction, the Y direction and the Z direction of the four-axis measuring instrument 2 are parallel to a base coordinate system of the industrial robot to be measured; adjusting the positions of the X-direction micrometer head, the Y-direction micrometer head and the Z-direction micrometer head of the four-axis measuring instrument 2 respectively, enabling the measuring point 502 to be in contact with the top of the probe 105 on the end effector 1 for the robot test, and reading the displacement values of the X-direction micrometer head, the Y-direction micrometer head and the Z-direction micrometer head respectively; respectively subtracting the first error compensation value and the second error compensation value from the displacement values of the X-direction micrometer head, the Y-direction micrometer head and the Z-direction micrometer head to obtain position deviation values delta X, delta Y and delta Z of the industrial robot to be tested at the test point; respectively measuring the test points according to the sequence and the cycle measurement times recommended by GB/T12642 to obtain the position deviation value delta x of each test pointj,Δyj,Δzj

a. Calculating the position accuracy of the test points:

wherein, i represents the ith test point,

wherein n is the cycle number;

should select AP1~AP5Taking the worst data as the position accuracy of the whole robot to be tested;

b. and (3) calculating the position repetition degree of the test points:

wherein, i represents the ith test point,

6) attitude accuracy and attitude repeatability measurements

Under automatic control, the robot measurement end effector is moved to a position to be measured at a fixed posture and the speed required by GB/T12642 and then is suspended; installing a four-axis measuring instrument 2 on the top end of the upright post corresponding to the point to be measured, and ensuring that the X direction, the Y direction and the Z direction of the four-axis measuring instrument 2 are parallel to a base coordinate system of the industrial robot to be measured;

the position of the X-, Y-and Z-direction micrometer heads of the four-axis measuring instrument 2 is adjusted so that the detecting blade 602 of the attitude detecting claw 6 is brought into contact with the cylindrical surface of the tip of the probe 105, the contact point is designated as a first measuring point, and the displacement values of the X-and Z-direction micrometer heads are read and designated as X1And z1(ii) a Rotating the R-axis micrometer rotary table by 90 degrees, keeping the position of the Z-direction micrometer head unchanged, adjusting the position of the Y-direction micrometer head to make the detection blade 602 of the attitude detection claw 6 contact with the cylindrical surface at the front end of the probe 105 on the end effector for measurement, reading the displacement value of the Y-direction micrometer head, and recording the displacement value as Y1(ii) a The Y-direction and Z-direction micrometer heads of the four-axis measuring instrument 2 are adjusted again to make the detecting blade 602 of the attitude detecting claw 6 contact with another arbitrary point on the cylindrical surface at the front end of the probe 105, the contact point is marked as a second measuring point, the second measuring point is far away from the first measuring point, the displacement values of the Y-direction and Z-direction micrometer heads are respectively read and marked as Y2And z2(ii) a Rotating the R-axis micrometric turntable by 90 degrees, namely rotating the R-axis micrometric turntable back to the initial position, keeping the position of the Z-direction micrometric head unchanged, adjusting the position of the X-direction micrometric head to enable the detection blade 602 of the attitude detection claw 6 to be in contact with the cylindrical surface at the front end of the probe 105, reading the displacement value of the X-direction micrometric head and recording the displacement value as X2

Δxi=x2-x1,Δyi=y2-y1,Δzi=z2-z1

Wherein i represents the ith test point;

calculated as RPY angle:

pitch angleDeflection angleRoll angle α ═ θ6

Wherein, theta6The rotation angle of a mechanical interface flange plate of the wrist part of the robot is represented;

measurement and calculation of the roll angle α:

rotating the R-axis micrometer table by a deflection angle gammaiThe position of the X-, Y-and Z-direction micrometer heads of the four-axis measuring instrument 2 is adjusted so that the detecting blade 602 of the attitude detecting claw 6 is brought into contact with the outer circumferential surface of one end of the measuring pin 104 at the front end of the probe 105, and this contact point is designated as a third measuring point, and the displacement values of the Y-and Z-direction micrometer heads are read respectively and designated as Y3And z3(ii) a The position of the X-, Y-and Z-direction micrometer heads of the four-axis measuring instrument 2 is adjusted so that the detecting blade 602 of the attitude detecting claw 6 is brought into contact with the outer circumferential surface of the other end of the measuring pin 104 at the front end of the probe 105, and this contact point is designated as a fourth measuring point, and the displacement values of the Y-and Z-direction micrometer heads are read respectively and designated as Y4And z4

Δy=y4-y3,Δz=z4-z3

a. And (3) posture accuracy calculation:

in the formula, betacccAttitude angles, AP, of the command poses of test points i, respectivelyi,β、APi,γAnd APi,αRespectively the accuracy of the attitude angle of the test point i,is the average value of attitude angles, beta, obtained by repeatedly responding n times at the same posejjjIs the attitude angle of the j-th actual pose;

b. and (3) calculating the repeatability of the posture:

and for the attitude accuracy and the attitude repeatability evaluation of the whole robot, selecting the worst value of the attitude accuracy and the attitude repeatability of each test point.

The embodiments described above are only a part of the embodiments of the present invention, and not all of them. All other embodiments that can be obtained by a person skilled in the art based on the embodiments of the present invention without any creative effort belong to the protection scope of the present invention.

21页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:中间轴齿轮位置度检测方法

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!