TCP calibration method, device and storage medium for industrial robot abrasive belt tools
By using a combination device of fixed base, turntable and line scanning sensors in industrial robot belt tools, the problem of insufficient calibration accuracy is solved, and the precise calibration of belt tools is achieved, and the grinding effect and workpiece quality are improved.
Patent Information
- Application Number
- CN202411209050.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-30
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-08-30
AI Technical Summary
The prior art is difficult to accurately calibrate the TCP of industrial robot belt tools, resulting in inconsistent grinding effects and damage to the surface of the workpiece.
The TCP calibration device and method including a fixed base, a vertical rotary table, a horizontal rotary table, a guide rail, a line scanning sensor, a clamp and a clamp spacing sensor are used to calculate the center point of the sand belt tool by recording the clamp and sensor data multiple times. The axis of the working wheel is accurately calibrated from the offset of the center surface of the flange at the end of the industrial robot.
The precise calibration of the belt tool TCP is achieved, which improves the uniformity and consistency of grinding, reduces positioning errors, and ensures the quality and production efficiency of the workpiece surface.
Smart Images

Figure CN118700165B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot automation technology, and in particular to a TCP calibration method, a device and a storage medium suitable for an industrial robot abrasive belt tool. Background Art
[0002] Industrial robots equipped with belt sanders are increasingly used for grinding. In the manufacturing industry, this combination significantly improves grinding accuracy and efficiency and reduces labor costs. The flexibility of belt sanders combined with the precise control of industrial robots makes it possible to grind workpieces with complex shapes. At the same time, robot grinding also reduces safety risks caused by manual operation. In the future, with the advancement of technology, the collaborative application of industrial robots and belt sanders will be further expanded and optimized, promoting the intelligent upgrading of the manufacturing industry.
[0003] The calibration accuracy of TCP (Tool Center Point) has a significant impact on the effect of industrial robots using abrasive belts for grinding. The calibration accuracy of TCP is directly related to the positioning accuracy and stability of the motion trajectory of the industrial robot when performing grinding tasks. When the TCP calibration accuracy is high, it helps to improve the uniformity and consistency of grinding, reduce over-grinding or under-grinding caused by positioning errors, and thus improve product quality and production efficiency. Conversely, if the TCP calibration accuracy is insufficient, the industrial robot may have positioning deviations or unstable motion trajectories when performing grinding tasks. This may lead to uneven contact pressure between the abrasive belt and the workpiece, resulting in inconsistent grinding effects and even damage to the workpiece surface.
[0004] The existing TCP calibration methods are mainly divided into two categories. One method is through robot self-alignment, such as replacing the robot tool with an object with a clear tip, pointing the tip of the object to another object with a clear tip in space, and touching it from four directions, the robot's four-state posture, and using the four-point method to calculate the TCP. This method relies on the operator's experience and for some tools of special shapes or sizes, the four-point method may be difficult to accurately calibrate the TCP. The other method is through the visual-assisted calibration method, which uses visual feature points for auxiliary calibration. This is also an indirect calibration method and requires a high-resolution camera and image processing system.
[0005] Existing TCP calibration methods are all indirect calibration methods, that is, the known relationship between the calibrated object and the actual TCP of the robot is known, and the known object is calibrated by visual means or the four-point method to calculate the TCP position of the industrial robot. This calibration process will introduce substitution errors and cannot achieve TCP calibration of robots with complex shapes.
[0006] When an industrial robot uses a belt sander to grind a workpiece, the working wheel of the belt sander presses the belt and the workpiece tightly, that is, the contact line between the belt sander and the workpiece is a line segment on the circumference, and during the assembly process of the belt sander, there will be a certain angle deviation between the working wheel, supporting wheel, driving wheel and back plate. It is difficult to make an equivalent replacement for the center point of the working wheel axis. Even if an equivalent replacement is made, it will introduce a large error. Therefore, it is difficult to accurately calibrate the TCP of the belt sander tool. Summary of the invention
[0007] The present invention aims to solve the technical problem that it is difficult to accurately calibrate the TCP of a sanding belt tool in the prior art, and provides a TCP calibration method, device and storage medium suitable for an industrial robot sanding belt tool.
[0008] In order to solve the above technical problems, the technical solutions of the present invention are as follows:
[0009] A TCP calibration device suitable for an industrial robot abrasive belt tool comprises: a fixed base, a vertical turntable, a horizontal turntable fixing plate, a horizontal turntable and a guide rail connected in sequence; a line scanning sensor is arranged on the guide rail; a first clamping plate and a second clamping plate are respectively arranged on both sides of the line scanning sensor; and a clamping plate spacing sensor is respectively arranged in the first clamping plate and the second clamping plate;
[0010] in:
[0011] The fixed base is fixed on the fixed table, and the right side surface is perpendicular to the bottom surface;
[0012] The vertical turntable is fixed to the right side surface of the fixed base by screws, and the vertical turntable is built-in with a first angle feedback sensor for positioning and zero return movement;
[0013] The horizontal turntable fixing plate is fixed to the rotating surface of the vertical turntable;
[0014] The horizontal turntable is fixed on the horizontal turntable fixing plate, and the horizontal turntable has a built-in second angle feedback sensor for positioning and zero return movement;
[0015] A guide rail is fixed on the horizontal turntable, and a first clamping plate and a second clamping plate are provided on the guide rail; the first clamping plate and the second clamping plate are used for automatic clamping and bidirectional linear motion along the guide rail; the side surfaces of the first clamping plate and the second clamping plate are perpendicular to the motion direction of the guide rail;
[0016] The first clamping plate and the second clamping plate are respectively installed with clamping plate spacing sensors for measuring the distance between the first clamping plate and the second clamping plate;
[0017] A plurality of columns and rows of line scanning sensors are provided between the first clamping plate and the second clamping plate on the guide rail for measuring the distance between the object to be measured and the corresponding position in the pointing direction;
[0018] When the vertical turntable is at zero position, the axis is in the horizontal direction, the axis of the horizontal turntable is in the vertical direction, the axis of the vertical turntable and the axis of the horizontal turntable intersect, the guide rail is in the horizontal direction, and the movement direction of the guide rail is the same as the axis direction of the vertical turntable.
[0019] In the above technical solution, the line scanning sensors in multiple columns and rows are laser displacement sensors respectively, the number of rows is greater than or equal to 5, and the number of columns is greater than or equal to 2.
[0020] In the above technical solution, the zero point of the line scanning sensor is located on the upper surface of the horizontal turntable, and the measuring direction is perpendicular to the upper surface of the horizontal turntable.
[0021] In the above technical solution, the abrasive belt tool includes: a back plate, a supporting wheel and a working wheel; an abrasive belt is provided on one side of the back plate; the abrasive belt is respectively connected to two supporting wheels and one working wheel; one of the supporting wheels is also connected to a motor; the abrasive belt is driven by the motor and continuously transmits around the two supporting wheels and one working wheel.
[0022] In the above technical solution, the clamp plate spacing sensor is embedded in the first clamp plate and the second clamp plate.
[0023] In the above technical solution, the clamp plate spacing sensor is fixed above the first clamp plate and the second clamp plate.
[0024] In the above technical solution, the clamp plate spacing sensor is fixed below the first clamp plate and the second clamp plate.
[0025] In the above technical solution, the first clamping plate and the second clamping plate are automatically clamped by electric or pneumatic spring control.
[0026] A TCP calibration method applicable to the above-mentioned TCP calibration device applicable to an industrial robot abrasive belt tool comprises the following steps:
[0027] S001: Reset the vertical turntable and the horizontal turntable to zero point;
[0028] S002: The industrial robot controls the abrasive belt tool to move toward the TCP calibration mechanism, moves the working wheel of the abrasive belt tool between the first clamping plate and the second clamping plate, adjusts the posture of the industrial robot, and records the position of the first clamping plate. and the position of the second splint ,make When the distance between the first clamping plate and the second clamping plate is the smallest, it indicates that the axis of the working wheel is parallel to the guide rail. Record the angle of the turntable in the horizontal direction at this time. , record the vertical angle of the turntable at this time , record the position of the center point of the end flange of the industrial robot at this time and posture In the process of calibration using the horizontal turntable and the vertical turntable, the position and posture As the starting position, we have:
[0029] ;
[0030] ;
[0031] in, To calibrate the first point using the horizontal turntable, To calibrate the first point using the horizontal turntable, To calibrate the first point using the vertical turntable, The posture of the first point when calibrating using the vertical turntable;
[0032] The values of the two columns of line scan sensors are recorded at this time, and two columns of data are obtained as follows, where N is the number of rows of the line scan sensor:
[0033] ;
[0034] ;
[0035] S003: Control the industrial robot to lift the abrasive belt tool to disengage the TCP calibration mechanism and move the horizontal turntable to an angle , the vertical turntable remains ;
[0036] S004: The industrial robot controls the abrasive belt tool to move toward the TCP calibration mechanism, moves the working wheel 5 of the abrasive belt tool between the first clamping plate and the second clamping plate, adjusts the posture of the industrial robot, and records the position of the first clamping plate. and the position of the second splint ,make When the distance between the first clamping plate and the second clamping plate is the smallest, it indicates that the axis of the working wheel is parallel to the guide rail. Record the position of the center point of the end flange of the industrial robot at this time. and posture , also record the values of the two columns of line scan sensors and ;
[0037] S005: Repeat steps S003-S004 three times to get the angle of the turntable in the horizontal direction , , , get the position of the center point of the industrial robot end flange , , and posture , , , and the same value is obtained for the line scan sensor and , and , and ;
[0038] S006: Move the horizontal turntable to , control the industrial robot to lift the abrasive belt tool to separate from the TCP calibration mechanism, and rotate the vertical turntable to Location;
[0039] S007: The industrial robot controls the abrasive belt tool to move toward the TCP calibration mechanism, moves the working wheel of the abrasive belt tool between the first clamping plate and the second clamping plate, adjusts the posture of the industrial robot, and records the position of the first clamping plate. and the position of the second splint ,make When the distance between the first clamping plate and the second clamping plate is the smallest, it indicates that the axis of the working wheel is parallel to the guide rail. Record the position of the center point of the end flange of the industrial robot at this time. and posture , also record the values of the two columns of line scan sensors and ;
[0040] S008: Repeat steps S006-S007 three times to obtain the vertical angle , get the position of the center point of the industrial robot end flange , , and posture , , , and the same value is obtained for the line scan sensor and , and , and ;
[0041] S009: According to and , and , and , and , and and , Calculate the position of the midpoint of the axis of the working wheel 5 relative to the midpoint of the horizontal turntable , where i=1, 2, 3, 4, 5;
[0042] S010: According to , , , , calculate the offset of the center point of the abrasive belt tool relative to the center plane of the end flange of the industrial robot in the X and Y directions and ;
[0043] S011: According to and , and , and , and , and and , Calculate the distance between the midpoint of the axis of the working wheel and the midpoint of the horizontal turntable , where i=1, 2, 3, 4, 5;
[0044] S012: According to , , , calculate the offset of the center point of the abrasive belt tool relative to the center plane of the end flange of the industrial robot in the Z direction ;
[0045] S013: The TCP of the tested abrasive belt tool is obtained as follows: .
[0046] A computer-readable storage medium stores a computer program, wherein the computer program can be executed by a processor to implement the steps in the above-mentioned TCP calibration method applicable to an industrial robot abrasive belt tool.
[0047] The present invention has the following beneficial effects:
[0048] The TCP calibration method, device and storage medium of the abrasive belt tool of an industrial robot of the present invention ensure that the working wheel of the abrasive belt tool is strictly perpendicular to the horizontal turntable through a clamping plate spacing sensor, accurately identify the working line segment of the working wheel through a line scanning sensor, and then obtain the axis of the working wheel. Through the cooperation of the horizontal turntable, the vertical turntable and the industrial robot, the TCP of the abrasive belt tool can be accurately calibrated through a step-by-step calibration method. BRIEF DESCRIPTION OF THE DRAWINGS
[0049] The present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments.
[0050] Figure 1 It is a structural schematic diagram of the abrasive belt tool of the TCP calibration device suitable for the abrasive belt tool of an industrial robot according to the present invention.
[0051] Figure 2 The present invention is a schematic diagram of the structure of the motion mechanism and sensor of the TCP calibration device suitable for industrial robot abrasive belt tools.
[0052] Figure 3 It is a structural schematic diagram of a TCP calibration mechanism of a TCP calibration device suitable for an industrial robot abrasive belt tool of the present invention.
[0053] Figure 4 It is a schematic diagram of the overall structure of the TCP calibration device suitable for industrial robot abrasive belt tools of the present invention.
[0054] The reference numerals in the figures indicate:
[0055] 1-support wheel; 2-motor; 3-sand belt; 4-back plate; 5-working wheel; 6-grinding plate spacing sensor; 7-first clamping plate; 8-second clamping plate; 9-guide rail; 10-line scanning sensor; 11-fixed base; 12-vertical turntable; 13-horizontal turntable fixing plate; 14-horizontal turntable. DETAILED DESCRIPTION
[0056] The inventive concept of the present invention is:
[0057] The invention provides a TCP calibration method, a device and a storage medium applicable to an industrial robot abrasive belt tool, so as to realize accurate calibration of the TCP of the abrasive belt tool.
[0058] The present invention is described in detail below with reference to the accompanying drawings.
[0059] In a specific embodiment of the present invention, the abrasive belt tool is a belt sander. The belt sander is connected to an industrial robot, such as Figure 1 As shown, the sanding machine includes: a back plate 4, a supporting wheel 1 and a working wheel 5; a sanding belt 3 is provided on one side of the back plate 4; the sanding belt 3 is respectively connected to two supporting wheels 1 and one working wheel 5; one of the supporting wheels 1 is also connected to a motor 2; the sanding belt 3 can be driven by the motor 2 to continuously transmit around the two supporting wheels 1 and one working wheel 5.
[0060] The TCP calibration device of the present invention is suitable for industrial robot abrasive belt tools, such as Figure 2-4As shown, it includes: a fixed base 11, a vertical turntable 12, a horizontal turntable fixing plate 13, a horizontal turntable 14, and a guide rail 9 connected in sequence; a line scanning sensor 10 is provided on the guide rail 9; a first clamping plate 7 and a second clamping plate 8 are provided on both sides of the line scanning sensor 10; two clamping plate spacing sensors 6 are provided in the first clamping plate 7 and the second clamping plate 8, respectively.
[0061] in:
[0062] The fixed base 11 is responsible for carrying the entire calibration mechanism. The fixed base 11 can be fixed on the fixed table by screws. The right side and the bottom surface of the fixed base 11 should be strictly vertical.
[0063] The vertical turntable 12 is fixed to the right side surface of the fixed base 11 by screws. The vertical turntable 12 has a built-in first angle feedback sensor, which can perform positioning and zero return movement;
[0064] The horizontal turntable fixing plate 13 is fixed to the rotating surface of the vertical turntable 12 by screws;
[0065] The horizontal turntable fixing plate 13 is used to carry the horizontal turntable 14;
[0066] The horizontal turntable 14 is fixed to the horizontal turntable fixing plate 13 by screws. The horizontal turntable 14 has a built-in second angle feedback sensor and can perform positioning and zero return movements.
[0067] The horizontal turntable 14 is fixed with a guide rail 9 by screws, and a first clamping plate 7 and a second clamping plate 8 are provided on the guide rail 9; the first clamping plate 7 and the second clamping plate 8 can perform bidirectional linear motion along the guide rail 9.
[0068] The first clamping plate 7 and the second clamping plate 8 are respectively installed with a clamping plate spacing sensor 6, which is embedded in the first clamping plate 7 and the second clamping plate 8 and is used to measure the distance between the first clamping plate 7 and the second clamping plate 8. In other specific embodiments, the clamping plate spacing sensor 6 can also be fixed above or below the first clamping plate 7 and the second clamping plate 8.
[0069] On the guide rail 9, a line scanning sensor 10 is provided between the first clamping plate 7 and the second clamping plate 8. The installation position of the line scanning sensor 10 does not affect the movement of the first clamping plate 7 and the second clamping plate 8 along the guide rail 9. The line scanning sensor 10 in the present invention is a laser displacement sensor, which can measure the distance between the object being measured and the corresponding position in the direction in which it points. The number of rows of the line scanning sensor 10 is preferably more than 5 rows. The multiple rows of line scanning sensors 10 are arranged at equal intervals, and the spacing is , the spacing between the two columns of line scan sensors 10 is The distance between the first row and the last row of line scanning sensors 10 should be smaller than the ideal radius R of the working wheel 5 of the sanding machine; the zero point of the line scanning sensor 10 should be located on the upper surface of the horizontal turntable 14, and its measuring direction is perpendicular to the upper surface of the horizontal turntable 14. The position relationship of the first row of line scanning sensors 10 relative to the center point of the horizontal turntable 14 is , the first column line scans all rows of sensor 10 The values should be the same.
[0070] Before using the TCP calibration mechanism, the equipment needs to be adjusted to ensure that the axis of the vertical turntable 12 is in the horizontal direction when it is at the zero position, the axis of the horizontal turntable 14 is in the vertical direction, and the axis of the vertical turntable 12 and the axis of the horizontal turntable 14 should intersect, the guide rail 9 should be in the horizontal direction, and the position of the guide rail 9 passing the horizontal turntable 14 is the zero point of the guide rail 9, the left side is negative and the right side is positive, and the movement direction of the guide rail 9 is the same as the axis direction of the vertical turntable 12, and the side of the first clamping plate 7 and the second clamping plate 8 should be perpendicular to the movement direction of the guide rail 9. The first clamping plate 7 and the second clamping plate 8 can be controlled by electric or pneumatic springs to achieve automatic clamping function.
[0071] The distance between the center point of the vertical direction turntable 12 and the center point of the horizontal direction turntable 14 in the horizontal direction is L1, and the distance between the center point of the vertical direction turntable 12 and the center point of the horizontal direction turntable 14 in the vertical direction is L2.
[0072] When using the TCP calibration method for industrial robot abrasive belt tools of the present invention to perform abrasive belt TCP calibration, the following steps are included:
[0073] S001, reset the vertical turntable 12 and the horizontal turntable 14 to zero point;
[0074] S002, the industrial robot controls the belt sander to move toward the TCP calibration mechanism, moves the working wheel 5 of the belt sander to between the first clamping plate 7 and the second clamping plate 8, adjusts the posture of the industrial robot, and records the position of the first clamping plate 7 and the position of the second clamping plate 8 ,make When the distance between the first clamping plate 7 and the second clamping plate 8 is the smallest, it means that the axis of the working wheel 5 is parallel to the guide rail 9. Record the angle of the turntable 14 in the horizontal direction at this time. , record the angle of the turntable 12 in the vertical direction at this time , record the position of the center point of the end flange of the industrial robot at this time and posture In the calibration process using the horizontal turntable 14 and the vertical turntable 12, the position and posture As the starting position, we have:
[0075] ;
[0076] ;
[0077] in, To calibrate the position of the first point using the horizontal turntable 14, To calibrate the posture of the first point using the horizontal turntable 14, To calibrate the position of the first point using the vertical turntable 12, The posture of the first point when calibrating using the vertical turntable 12;
[0078] The values of the two columns of line scan sensors 10 are recorded at this time, and two columns of data are obtained as follows, where N is the number of rows of the line scan sensor 10:
[0079] ;
[0080] ;
[0081] S003, control the industrial robot to lift the belt sander to separate from the TCP calibration mechanism, and move the horizontal turntable 14 to an angle , the vertical turntable 12 still maintains ;
[0082] S004, the industrial robot controls the belt sander to move toward the TCP calibration mechanism, moves the working wheel 5 of the belt sander to between the first clamping plate 7 and the second clamping plate 8, adjusts the posture of the industrial robot, and records the position of the first clamping plate 7 and the position of the second clamping plate 8 ,make When the distance between the first clamping plate 7 and the second clamping plate 8 is the smallest, it means that the axis of the working wheel 5 is parallel to the guide rail 9. The position of the center point of the end flange of the industrial robot at this time is recorded. and posture , also record the values of the two columns of line scan sensors 10 and .
[0083] S005, repeat steps S003-S004 three times to obtain the angle of the turntable 14 in the horizontal direction , , , get the position of the center point of the industrial robot end flange , , and posture , , , and the value of line scan sensor 10 is also obtained and , and , and .
[0084] S006, move the horizontal turntable 14 to , control the industrial robot to lift the belt sander to separate from the TCP calibration mechanism, and rotate the vertical turntable 12 to Location;
[0085] S007, the industrial robot controls the belt sander to move toward the TCP calibration mechanism, moves the working wheel 5 of the belt sander to between the first clamping plate 7 and the second clamping plate 8, adjusts the posture of the industrial robot, and records the position of the first clamping plate 7 and the position of the second clamping plate 8 ,make When the distance between the first clamping plate 7 and the second clamping plate 8 is the smallest, it means that the axis of the working wheel 5 is parallel to the guide rail 9. The position of the center point of the end flange of the industrial robot at this time is recorded. and posture , also record the values of the two columns of line scan sensors 10 and .
[0086] S008, repeat steps S006-S007 three times to obtain the vertical angle , get the position of the center point of the industrial robot end flange , , and posture , , , and the value of line scan sensor 10 is also obtained and , and , and .
[0087] S009, according to and , and , and , and , and and , The position of the midpoint of the axis of the working wheel 5 relative to the midline point of the horizontal turntable 14 is calculated. , where i=1, 2, 3, 4, 5.
[0088] S010, according to , , , , calculate the offset of the center point of the abrasive belt tool relative to the center plane of the end flange of the industrial robot in the X and Y directions and .
[0089] S011, according to and , and , and , and , and and , Calculate the distance between the midpoint of the axis of the working wheel 5 and the midpoint of the horizontal turntable 14 , where i=1, 2, 3, 4, 5.
[0090] S012, according to , , , calculate the offset of the center point of the abrasive belt tool relative to the center plane of the end flange of the industrial robot in the Z direction .
[0091] S013, that is, the TCP of the measured sanding machine is .
[0092] In the above process, according to the coordinate transformation of the industrial robot, the matrix P is the position matrix of the center point of the end flange of the industrial robot. , T is the posture matrix of the center point of the end flange of the industrial robot.
[0093] ;
[0094] Then the rotation matrix of the industrial robot is:
[0095] ;
[0096] Take the first column of the first set of parameters as an example. , the row spacing of the laser displacement sensor is , the position of the first row line scanning sensor 10 relative to the center point of the horizontal turntable 14 is . Then there is, point , , ..., Located on the same circle, the least squares fitting is performed on it, and we have:
[0097] ;
[0098] In the formula, , , is an unknown number. The number of equations in the above equation group is greater than the number of unknown numbers. It can be calculated that the position of the center of the working wheel 5 relative to the center of the upper surface of the horizontal turntable 14 obtained by the first column of the first group of parameters is ,in .
[0099] Similarly, we can calculate , where i is the number of measurements, which is 5 in this embodiment, i.e., i=1, 2, 3, 4, 5, and j is the number of columns of the line scan sensor 10, which is 2 in this embodiment.
[0100] For the first and second columns of the first parameter, you can use and , calculate the spatial coordinates of the intersection of the center line of the working wheel 5 and the two side surfaces of the working wheel 5. Since the first clamping plate 7 and the second clamping plate 8 on both sides have clamped the working wheel 5, the above calculation process is equivalent to calculating the and The intersection point with the planes of the first clamping plate 7 and the second clamping plate 8.
[0101] The two intersection points can be calculated as and .
[0102] Similarly, the other group parameters in the horizontal direction can be calculated as follows: and , where N=2, 3, 4, 5. However, for the second, third, fourth, and fifth groups of parameters, the horizontal turntable 14 has a rotation angle. After calculation, it can be obtained that the spatial coordinates of the intersection of the center line of the working wheel 5 and the two side surfaces of the working wheel 5 at this position are: and , where N=1, 2, 3, 4, 5. When N=1, These five sets of data are re-recorded as and , where i=1, 2, 3, 4, 5.
[0103] Similarly, the spatial coordinates of the intersection of the center line of the working wheel 5 and the two side surfaces of the working wheel 5 when the vertical turntable 12 rotates can also be obtained for the 2nd to 5th groups of data:
[0104] and , N=2, 3, 4, 5. These 5 sets of data are re-recorded as and , where i=6, 7, 8, 9.
[0105] The above process obtains 10 sets of position data of the center point of the end flange of the industrial robot. , , , , ,in and The positions are the same, so the above data can be recorded in sequence as , i=1, 2, 3, ..., 9.
[0106] for , assuming the position of the TCP on this side of the sanding machine is , then we have the following system of equations:
[0107]
[0108] The number of positions in the above system of equations is less than the number of equations, so it can be solved .
[0109] Similarly, according to and , i=1, 2, 3, ..., 9, the position of the TCP on the other side of the belt sander can also be calculated .
[0110] Furthermore, it can be obtained that when the industrial robot controls the belt sander to perform grinding processing, the axis of the processing wheel of the belt sander is relative to the center point of the end flange of the industrial robot. arrive The actual interaction area between the machining wheel and the workpiece is a line on the cylindrical surface with a radius of R and the line segment as the axis.
[0111] In summary, the TCP calibration method and device applicable to the industrial robot abrasive belt tool of the present invention realizes the accurate calibration of the TCP of the abrasive belt machine.
[0112] In addition to the above-mentioned method and device, the present invention also includes: a computer-readable storage medium, which stores a computer program, and the computer program can be executed by a processor to implement the steps in the above-mentioned TCP calibration method of the TCP calibration device suitable for industrial robot abrasive belt tools.
[0113] In other specific embodiments, the TCP calibration method, device and storage medium applicable to industrial robot abrasive belt tools of the present invention are also applicable to the TCP calibration of abrasive belt machines of various different structures, and are also applicable to the TCP calibration of abrasive belt machines other than industrial robots. In addition to abrasive belt machines, the present invention is also used to calibrate wheel-shaped tools, and the method is the same as the method in the above-mentioned specific embodiments, which will not be repeated here.
[0114] The TCP calibration method, device and storage medium of the abrasive belt tool of an industrial robot of the present invention ensure that the working wheel of the abrasive belt tool is strictly perpendicular to the horizontal turntable through a clamping plate spacing sensor, accurately identify the working line segment of the working wheel through a line scanning sensor, and then obtain the axis of the working wheel. Through the cooperation of the horizontal turntable, the vertical turntable and the industrial robot, the TCP of the abrasive belt tool can be accurately calibrated through a step-by-step calibration method.
[0115] Obviously, the above embodiments are merely examples for the purpose of clear explanation, and are not intended to limit the implementation methods. For those skilled in the art, other different forms of changes or modifications can be made based on the above description. It is not necessary and impossible to list all the implementation methods here. The obvious changes or modifications derived therefrom are still within the scope of protection of the invention.
Claims
1. A TCP calibration device suitable for industrial robot abrasive belt tools, characterized in that: The invention comprises: a fixed base (11), a vertical turntable (12), a horizontal turntable fixing plate (13), a horizontal turntable (14) and a guide rail (9) which are connected in sequence; a line scanning sensor (10) is provided on the guide rail (9); a first clamping plate (7) and a second clamping plate (8) are provided on both sides of the line scanning sensor (10); and a clamping plate spacing sensor (6) is provided in the first clamping plate (7) and the second clamping plate (8); in: The fixed base (11) is fixed on the fixed table, and the right side surface is perpendicular to the bottom surface; The vertical direction turntable (12) is fixed to the right side surface of the fixed base (11) by means of screws, and the vertical direction turntable (12) is built with a first angle feedback sensor for positioning and zero return movement; The horizontal turntable fixing plate (13) is fixed to the rotating surface of the vertical turntable (12); The horizontal direction turntable (14) is fixed on the horizontal direction turntable fixing plate (13), and the horizontal direction turntable (14) has a built-in second angle feedback sensor for positioning and zero return movement; A guide rail (9) is fixed on the horizontal turntable (14), and a first clamping plate (7) and a second clamping plate (8) are provided on the guide rail (9); the first clamping plate (7) and the second clamping plate (8) are used for automatic clamping, and after clamping, the first clamping plate (7) and the second clamping plate (8) can move synchronously along two directions on the guide rail (9) to adjust the position of the clamped workpiece on the guide rail (9); the side surfaces of the first clamping plate (7) and the second clamping plate (8) are perpendicular to the movement direction of the guide rail (9); A splint spacing sensor (6) is installed in each of the first splint (7) and the second splint (8) for measuring the distance between the first splint (7) and the second splint (8); A plurality of columns and rows of line scanning sensors (10) for measuring the distance between a measured object and a corresponding position in a pointing direction are arranged between the first clamping plate (7) and the second clamping plate (8) on the guide rail (9); When the vertical turntable (12) is at the zero position, the axis of the vertical turntable (12) is in the horizontal direction, the axis of the horizontal turntable (14) is in the vertical direction, the axis of the vertical turntable (12) and the axis of the horizontal turntable (14) intersect, the guide rail (9) is in the horizontal direction, and the movement direction of the guide rail (9) is the same as the axis direction of the vertical turntable (12).
2. The TCP calibration device for industrial robot abrasive belt tools according to claim 1, characterized in that: The line scanning sensors (10) of multiple columns and rows are laser displacement sensors, respectively, the number of rows is greater than or equal to 5, and the number of columns is greater than or equal to 2.
3. The TCP calibration device for industrial robot abrasive belt tools according to claim 1, characterized in that: The zero point of the line scanning sensor (10) is located on the upper surface of the horizontal direction turntable (14), and the measuring direction is perpendicular to the upper surface of the horizontal direction turntable (14).
4. The TCP calibration device for industrial robot abrasive belt tools according to claim 1, characterized in that: The abrasive belt tool comprises: a back plate (4), a supporting wheel (1) and a working wheel (5); an abrasive belt (3) is arranged on one side of the back plate (4); the abrasive belt (3) is respectively connected to two supporting wheels (1) and one working wheel (5); one of the supporting wheels (1) is also connected to a motor (2); and the abrasive belt (3) is driven by the motor (2) to continuously rotate around the two supporting wheels (1) and the one working wheel (5).
5. The TCP calibration device for industrial robot abrasive belt tools according to claim 1, characterized in that: The clamping plate distance sensor (6) is embedded in the first clamping plate (7) and the second clamping plate (8).
6. The TCP calibration device for industrial robot abrasive belt tools according to claim 1, characterized in that: The clamp plate spacing sensor (6) is fixed above the first clamp plate (7) and the second clamp plate (8).
7. The TCP calibration device for industrial robot abrasive belt tools according to claim 1, characterized in that: The clamp plate spacing sensor (6) is fixed below the first clamp plate (7) and the second clamp plate (8).
8. The TCP calibration device for industrial robot abrasive belt tools according to claim 1, characterized in that: The first clamping plate (7) and the second clamping plate (8) are automatically clamped by electric or pneumatic spring control.
9. A TCP calibration method applicable to the TCP calibration device for industrial robot abrasive belt tools according to claim 4, characterized in that: The following steps are involved: S001: Reset the vertical turntable (12) and the horizontal turntable (14) to zero point; S002: The industrial robot controls the abrasive belt tool to move toward the TCP calibration mechanism, moves the working wheel (5) of the abrasive belt tool between the first clamping plate (7) and the second clamping plate (8), and adjusts the posture of the industrial robot, and records the position L of the first clamping plate (7). A and the position L of the second clamping plate (8) B , so that L A +L B = 0, when the distance between the first clamping plate (7) and the second clamping plate (8) is the smallest, it indicates that the axis of the working wheel (5) is parallel to the guide rail (9), and the angle α1 of the horizontal turntable (14) is recorded as 0, and the angle β1 of the vertical turntable (12) is recorded as 0. The position P1 and posture T1 of the center point of the end flange of the industrial robot are recorded at this time. In the calibration process using the horizontal turntable (14) and the vertical turntable (12), the position P1 and posture T1 are used as the starting posture, and then: P hor_1 =P1, T hor_1 =T1; P Ver_1 =P1, T ver_1 =T1; Among them, P hor_1 To determine the position of the first point when using the horizontal turntable (14), T hor_1 is the posture of the first point when calibrating using the horizontal turntable (14), P Ver_1 To determine the position of the first point when using the vertical turntable (12), T ver_1 The posture of the first point when calibrating using the vertical turntable (12); The values of the two columns of line scanning sensors (10) are recorded at this time, and two columns of data are obtained as follows, wherein N is the number of rows of the line scanning sensor (10): Laser 1_1 =[Data 1_1_1 ,Data 1_1_2 ...,Data 1_1_N ]; Laser 1_2 =[Data 1_2_1 ,Data 1_2_2 ...,Data 1_2_N ]; S003: Control the industrial robot to lift the abrasive belt tool to disengage the TCP calibration mechanism, move the horizontal turntable (14) to an angle α2, and keep the vertical turntable (12) at β1=0; S004: The industrial robot controls the abrasive belt tool to move toward the TCP calibration mechanism, moves the working wheel (5) of the abrasive belt tool between the first clamping plate (7) and the second clamping plate (8), and adjusts the posture of the industrial robot, and records the position L of the first clamping plate (7). A and the position L of the second clamping plate (8) B , so that L A +L B = 0, when the distance between the first clamping plate (7) and the second clamping plate (8) is the smallest, it indicates that the axis of the working wheel (5) is parallel to the guide rail (9), and the position P of the center point of the end flange of the industrial robot at this time is recorded. hor_2 and posture T hor_2 , also record the values of the two lines of scanning sensors (10) Laser hor2_1 and Laser hor2_2 ; S005: Repeat steps S003-S004 three times to obtain the angles α3, α4, and α5 of the horizontal turntable (14), and obtain the position P of the center point of the end flange of the industrial robot hor_3 , P hor_4 , P hor_5 and posture T hor_3 、T hor_4 、T hor_5 , and the value of the line scan sensor (10) is also obtained hor3_1 and Laser hor3_2 , Laser hor4_1 and Laser hor4_2 , Laser hor5_1 and Laser hor5_2 ; S006: Move the horizontal turntable (14) to α1=0, control the industrial robot to lift the abrasive belt tool to disengage the TCP calibration mechanism, and rotate the vertical turntable (12) to the β2 position; S007: The industrial robot controls the abrasive belt tool to move toward the TCP calibration mechanism, moves the working wheel (5) of the abrasive belt tool between the first clamping plate (7) and the second clamping plate (8), and adjusts the posture of the industrial robot, and records the position L of the first clamping plate (7). A and the position L of the second clamping plate (8) B , so that L A +L B = 0, when the distance between the first clamping plate (7) and the second clamping plate (8) is the smallest, it indicates that the axis of the working wheel (5) is parallel to the guide rail (9), and the position P of the center point of the end flange of the industrial robot at this time is recorded. ver_2 and posture T ver_2 , also record the values of the two lines of scanning sensors (10) Laser ver2_1 and Laser ver2_2 ; S008: Repeat steps S006-S007 three times to obtain the vertical angles β3, β4, β5, and the position P of the center point of the end flange of the industrial robot ver_3 , P ver_4 , P ver_5 and posture T ver_3 、T ver_4 、T ver_5 , and the value of the line scan sensor (10) is also obtained ver3_1 and Laser ver3_2 , Laser ver4_1 and Laser ver4_2 , Laser ver5_1 and Laser ver5_2 ; S009: According to Laser hor1_1 and Laser hor1_2 , Laser hor2_1 and Laser hor2_2 , Laser hor3_1 and Laser hor3_2 , Laser hor4_1 and Laser hor4_2 , Laser hor5_1 and Laser hor5_2 and L A , L B The position R of the midpoint of the axis of the working wheel (5) relative to the midpoint of the horizontal turntable (14) is calculated. hor_i , where i = 1, 2, 3, 4, 5; S010: According to R hor_1 , R hor_2 , R hor_3 , R hor_4 , R hor_5 , α1, α2, α3, α4, α5, P hor_1 , P hor_2 , P hor_3 , P hor_4 , P hor_5 , T hor_1 、T hor_2 、T hor_3 、T hor_4 、T hor_5 Calculate the offset X of the center point of the abrasive belt tool relative to the center plane of the end flange of the industrial robot in the X and Y directions tcp and Y tcp ; S011: According to Laser ver1_1 and Laser ver1_2 , Laser ver2_1 and Laser ver2_2 , Laser ver3_1 and Laser ver3_2 , Laser ver4_1 and Laser ver4_2 , Laser ver5_1 and Laser ver5_2 and L A , L B The distance R between the midpoint of the axis of the working wheel (5) and the midpoint of the horizontal turntable (14) is calculated. ver_i , where i = 1, 2, 3, 4, 5; S012: According to β1, β2, β3, β4, β5, P ver_1 , P ver_2 , P ver_3 , P ver_4 , P ver_5 , T ver_1 、T ver_2 、T ver_3 、T ver_4 、T ver_5 , calculate the offset Z of the center point of the abrasive belt tool relative to the center plane of the end flange of the industrial robot in the Z direction tcp ; S013: The TCP of the abrasive belt tool measured is (X tcp , Y tcp , Z tcp ).
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and the computer program can be executed by a processor to implement the steps in the TCP calibration method of a TCP calibration device suitable for an industrial robot abrasive belt tool as claimed in claim 9.
