CN110549333B - Gravity compensation method for TriMule horizontal series-parallel robot - Google Patents
Gravity compensation method for TriMule horizontal series-parallel robot Download PDFInfo
- Publication number
- CN110549333B CN110549333B CN201910722956.5A CN201910722956A CN110549333B CN 110549333 B CN110549333 B CN 110549333B CN 201910722956 A CN201910722956 A CN 201910722956A CN 110549333 B CN110549333 B CN 110549333B
- Authority
- CN
- China
- Prior art keywords
- robot
- point
- track
- compensation
- tail end
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
The invention discloses a gravity compensation method for a TriMule horizontal series-parallel robot, which comprises the following steps: establishing a three-dimensional virtual prototype of the TriMule horizontal series-parallel robot, and importing finite element analysis software to obtain a plurality of point positions with obvious deformation of the central point of the tail end of the robot under the influence of gravity; measuring offsets generated in the X, Y, Z direction under a robot coordinate system after a plurality of point positions with obvious deformation are influenced by gravity and taking the offsets as compensation values; and programming a program in the robot control system, adding a compensation value to the continuous track of the tail end of the robot passing through the points, driving the robot to move along the track, tracking and measuring the track of the tail end of the robot by using a laser tracker, comparing the compensated track with a theoretical track, finding out a point position with poor compensation, and modifying the compensation value again until an ideal effect is achieved. The invention can make the compensation more accurate.
Description
Technical Field
The invention belongs to a gravity compensation method of a robot, and particularly relates to a gravity compensation method of a TriMule horizontal type series-parallel robot.
Background
Since the new century, the rapid development of industries such as aviation, aerospace, wind power, high speed railway and the like has prompted an increasing demand for large-scale structures/functional parts. The parts have the characteristics of large overall dimension, complex geometric shape, high precision requirement and the like, and the manufacturing, the maintenance and the repair of the parts face various challenges. The traditional manufacturing mode (such as large/super-large horizontal or vertical machine tools and the like) is difficult to be sufficient for processing the parts due to the defects of strict requirements on installation environment, high energy consumption, low efficiency and the like.
With the continuous development and innovation of the robot technology, the single-machine manufacturing unit and the multi-machine manufacturing system which take the series-parallel configuration equipment as the core functional component play more and more roles in the occasions of high-efficiency, high-precision and short-flow processing facing to large-scale complex parts. The series-parallel configuration equipment has the advantages of large working space/occupied area ratio, large static rigidity and flexible collocation, is easy to manufacture into a plug-and-play module, and further builds various manufacturing systems with wide application according to the processing requirements, and makes up the defects of the traditional series configuration equipment.
As shown in fig. 1, the structure of the trimole horizontal type hybrid robot as a latest improved configuration of a classical hybrid robot-Tricept series robot is as follows: the parallel connection part consists of three driving motors 1, three driving branched chains 4, a rotating bracket 1(3), a rotating bracket 2(6), a driven branched chain 2 and a base 7; the rotating support 1(3) and the rotating support 2(6) are fixed on the base 7, one end of each of the two driving branched chains 4 and the driven branched chain 2 is fixed on the rotating support 2(6) and can swing left and right in the horizontal direction, the other end of each of the two driving branched chains 4 is fixed on two sides of the tail end of the driven branched chain 2, and the whole rotating support 2(6) can rotate up and down around a fixed shaft of the whole rotating support 2 (6); one end of the remaining driving branched chain 4 is fixed on the rotating bracket 1(3) and can swing left and right in the horizontal direction, the other end is fixed at the tail end of the driven branched chain 2, and the rotating bracket 1(3) can rotate up and down around the fixed shaft of the rotating bracket; three driving motors 1 are used for fixing the tails of the three driving branched chains 4 and driving the driving branched chains 4 to drive the driven branched chains 2 to extend and retract together; the serial part consists of a two-degree-of-freedom serial swing head 5, and the two-degree-of-freedom serial swing head is fixed at the tail end of the driven branched chain 2, can rotate around the driven branched chain 2 shaft and can swing up and down.
The TriMule horizontal hybrid robot inherits the advantages of the Tricept series robot, is lower in manufacturing cost and better in manufacturing manufacturability, is universal with part of parts of the Tricept series robot, and is more reliable and durable.
There are some problems in the use of the trimole horizontal hybrid robot, such as: the horizontal robot can generate certain deformation under the action of the end load and the gravity of the mechanical arm in the moving process, the deformation enables the position of the end of the robot to deviate, and the precision of the robot and the overall performance of the robot are seriously influenced by the deformation.
Disclosure of Invention
The invention aims to overcome the defects of the prior art and provide a gravity compensation method for a TriMule horizontal hybrid robot, so as to solve the problem that the tail end position of the TriMule horizontal hybrid robot is deviated due to the deformation caused by the gravity of a mechanical arm of the TriMule horizontal hybrid robot in the prior art.
The technical scheme for solving the problems is as follows:
the invention discloses a gravity compensation method for a TriMule horizontal series-parallel robot, which comprises the following steps of:
step one, mounting a laser target ball at the tail end of a two-freedom-degree series head of a robot, and arranging a laser tracker right in front of a TriMule horizontal series-parallel robot to obtain a running track of the tail end of the two-freedom-degree series head of the robot;
step two, building a three-dimensional virtual prototype of the TriMule horizontal series-parallel robot by adopting solidworks software in a computer, then introducing the three-dimensional virtual prototype into finite element analysis software ANSYS, and making a deformation cloud chart of the robot at any pose in a working space under the action of gravity by utilizing the ANSYS to obtain a plurality of point positions S with obvious deformation caused by the influence of gravity on the central point of the tail end of the two-degree-of-freedom series head of the robot1、S2…SnThen, respectively measuring the difference value in the direction of X, Y, Z under the robot coordinate system between the theoretical position corresponding to each point in a plurality of points with obvious deformation and the position after deformation under the influence of gravity in ANSYS softwareAs position compensation values of several points with obvious deformation and recording the difference value Wherein i is 1,2.. n;
step three, measuring in solidworks software to obtain S1、S2…SnCoordinates of each point under a robot coordinate system;
fourthly, writing a gravity compensation PLC program in a TURBO PMAC system of the robot controller, and carrying out two-freedom-degree operation on the robotThe central point of the end of the pendulum head is positioned at the slave S1Point movement to SnCompensating each point position of the continuous track of the points to form a correction value of each point position, wherein the process is as follows:
manually setting an inclusion S1、S2…SnThe continuous motion track of each point ensures that the tail end center of the two-freedom-degree series head of the robot follows the motion track from S1Point movement to SnPoint; when the central point of the tail end of the two-freedom-degree series head of the robot is positioned at S1To SnAt any point position SaWhen a belongs to 1 and 2aAdding the compensation value of the corresponding position obtained by the calculation in the second step to the theoretical position of the point location; when the central point of the tail end of the two-freedom-degree series head of the robot is positioned at the slave S1Point movement to SnAt an arbitrary point position S in the continuous motion trajectory ofb,When using SbTheoretical position of point location plus all SaX, Y, Z of the direction compensation value of (a) is calculatedaThe average value of X, Y, Z directional compensation values is formulated as:
step five, the TURBO PMAC system outputs a compensated motion trail control signal to the robot motor to enable the central point of the tail end of the two-freedom-degree series head of the robot to be from S1Point movement to SnSimultaneously, a laser tracker is utilized to track and measure the central point of the tail end of the two-freedom-degree series swinging head of the robot from S1Point movement to SnThe continuous motion track of the point is input into the operation software of the laser tracker1、S2…SnThe coordinates of each point under the robot coordinate system can generate a theoretical track;
and step six, comparing the compensated track with the theoretical track, finding out point positions with poor compensation, taking the deviation of the track acquired by the laser tracker and the theoretical track in the direction of X, Y, Z as a re-compensation numerical value of corresponding track points in the operation software of the laser tracker, then correcting the position values of the corresponding track points by adopting the re-compensation numerical value on the basis of the position correction value of each point position in the program of step four, and repeating the step five and the step six until the compensated track meets the requirements.
The beneficial effects of the invention are as follows:
1. from the perspective of a control system, gravity compensation is carried out without adding an auxiliary mechanism, and modification of the robot configuration and influence on the motion space of the robot are avoided.
2. By using the finite element simulation analysis method, the stress of the robot in any posture can be simulated and analyzed, the motion of the robot is not influenced by adding a sensor, and the data acquisition is more flexible.
3. Different compensation values can be applied to different positions by utilizing the built-in PLC to correct the kinematics in real time, so that the compensation is more accurate.
4. The precision of the laser tracker is 0.01mm, the precision of position correction can be greatly improved by using the laser tracker, and the tail end position error caused by gravity can be reduced to the greatest extent through multiple times of measurement, comparison and correction.
Drawings
Fig. 1 is a schematic structural diagram of a prior trimole horizontal hybrid robot;
fig. 2 is a flowchart of a gravity compensation method for a trimole horizontal hybrid robot according to the present invention;
FIG. 3 shows the robot at the end of the maximum working space by S1To SnExemplified by n ═ 10) and S)bA schematic diagram of (a);
fig. 4 is a schematic diagram of the laser tracker tracking the trajectory of the end of the robot according to the present invention.
Detailed Description
The invention is explained in detail below with reference to the drawings and the embodiments.
Because the parallel mechanism in the horizontal layout is greatly influenced by self gravity, the lead screw reflected in the parallel part is bent and deformed under the action of self gravity and tail end gravity in the process of extension and shortening under the driving of the motor, and the serial swinging head 5 can be regarded as a whole due to relative concentration of mass, so the tail end position deviation caused by deformation can be compensated by controlling the driving motor 1 of the parallel part.
The invention discloses a gravity compensation method for a TriMule horizontal hybrid robot based on the principle, which is shown in the attached drawings, and comprises the following steps:
firstly, mounting a laser target ball 9 at the tail end 5 of a two-degree-of-freedom serial swinging head of a robot, and arranging a laser tracker 8 right in front of a TriMule horizontal series-parallel robot to obtain the running track of the tail end 5 of the two-degree-of-freedom serial swinging head of the robot, wherein the laser tracker is usually arranged right 2 meters away from the right in front of the TriMule horizontal series-parallel robot and is right opposite to the robot;
step two, according to the flow chart of the gravity compensation method of the figure 2, a three-dimensional virtual prototype of the TriMule horizontal hybrid robot is established in a computer by adopting solidworks software, then the three-dimensional virtual prototype is led into finite element analysis software ANSYS, the ANSYS is used for making a deformation cloud chart of the robot at any pose in a working space under the action of gravity, and a plurality of point locations S with obvious deformation caused by the influence of gravity on the central point of the tail end of the two-degree-of-freedom serial swinging head of the robot are obtained1、S2…SnThen, respectively measuring the difference value in the direction of X, Y, Z under the robot coordinate system between the theoretical position corresponding to each point in a plurality of points with obvious deformation and the position after deformation under the influence of gravity in ANSYS softwareAnd the position compensation values of a plurality of point positions with obvious deformation are recorded.
Step three, measuring in solidworks software to obtain S1、S2…SnCoordinates of each point under a robot coordinate system;
fourthly, writing a gravity compensation PLC program in a TURBO PMAC system of the robot controller, and carrying out two-freedom-degree operation on the robotThe central point of the end of the pendulum head is positioned at the slave S1Point movement to SnCompensating each point position of the continuous track of the points to form a correction value of each point position, wherein the process is as follows:
manually setting an inclusion S1、S2…SnThe continuous motion track of each point ensures that the tail end center of the two-freedom-degree series head of the robot follows the motion track from S1Point movement to SnAnd (4) point. When the central point of the tail end of the two-freedom-degree series head of the robot is positioned at S1To SnAt any point position Sa(a is equal to 1,2.. n), adding SaAdding the compensation value of the corresponding position obtained by the calculation in the second step to the theoretical position of the point location; when the central point of the tail end of the two-freedom-degree series head of the robot is positioned at the slave S1Point movement to SnAt an arbitrary point position S in the continuous motion trajectory ofb When using SbTheoretical position of point location plus all SaX, Y, Z of the direction compensation value of (a) is calculatedaThe average value of X, Y, Z directional compensation values is formulated as:
step five, the TURBO PMAC system outputs a compensated motion trail control signal to the robot motor to enable the central point of the tail end of the two-freedom-degree series head of the robot to be from S1Point movement to SnSimultaneously, a laser tracker is utilized to track and measure the central point of the tail end of the two-freedom-degree series swinging head of the robot from S1Point movement to SnThe continuous motion track of the point is input into the operation software of the laser tracker1、S2…SnThe coordinates of each point under the robot coordinate system can generate a theoretical track;
and step six, comparing the compensated track with the theoretical track, finding out point positions with poor compensation, taking the deviation of the track acquired by the laser tracker and the theoretical track in the direction of X, Y, Z as a re-compensation numerical value of corresponding track points in the operation software of the laser tracker, then correcting the position values of the corresponding track points by adopting the re-compensation numerical value on the basis of the position correction value of each point position in the program of step four, and repeating the step five and the step six until the compensated track meets the requirements.
If occurrence includes Sa,SbLocation S where any compensation is not perfectk(k epsilon N), and correcting or newly building compensation of the point in the PLC program in the previous step according to the deviation value of the track acquired by the laser tracker and the theoretical track in the direction of X, Y, Z And tracking and measuring again until the compensation effect of the point meets the requirement.
Although the preferred embodiments of the present invention have been described above with reference to the accompanying drawings, the present invention is not limited to the above-described embodiments, which are merely illustrative and not restrictive, and those skilled in the art can make many modifications without departing from the spirit and scope of the present invention as defined in the appended claims.
Claims (1)
1. A gravity compensation method for a TriMule horizontal hybrid robot is characterized by comprising the following steps:
step one, mounting a laser target ball at the tail end of a two-freedom-degree series head of a robot, and arranging a laser tracker right in front of a TriMule horizontal series-parallel robot to obtain a running track of the tail end of the two-freedom-degree series head of the robot;
step two, adopting solidworks software to establish a three-dimensional virtual prototype of the TriMule horizontal hybrid robot in a computer, and then using the three-dimensional virtual prototypeFinite element analysis software ANSYS is introduced into the machine, a deformation cloud chart of the robot at any pose in a working space under the action of gravity is made by using the ANSYS, and a plurality of point positions S with obvious deformation caused by the influence of gravity on the central point of the tail end of the two-degree-of-freedom serial swinging head of the robot are obtained1、S2…SnThen, respectively measuring the difference value in the direction of X, Y, Z under the robot coordinate system between the theoretical position corresponding to each point in a plurality of points with obvious deformation and the position after deformation under the influence of gravity in ANSYS softwareAs position compensation values of several points with obvious deformation and recording the difference valueWherein i is 1,2.. n;
step three, measuring in solidworks software to obtain S1、S2…SnCoordinates of each point under a robot coordinate system;
fourthly, writing a gravity compensation PLC program in a TURBO PMAC system of the robot controller, and locating the central point of the tail end of the two-freedom-degree series head of the robot at the slave S1Point movement to SnCompensating each point position of the continuous track of the points to form a correction value of each point position, wherein the process is as follows:
manually setting an inclusion S1、S2…SnThe continuous motion track of each point ensures that the tail end center of the two-freedom-degree series head of the robot follows the motion track from S1Point movement to SnPoint; when the central point of the tail end of the two-freedom-degree series head of the robot is positioned at S1To SnAt any point position SaWhen a belongs to 1 and 2aAdding the compensation value of the corresponding position obtained by the calculation in the second step to the theoretical position of the point location; when the central point of the tail end of the two-freedom-degree series head of the robot is positioned at the slave S1Point movement to SnAt any point in the continuous motion trackWhen using SbTheoretical position of point location plus all SaX, Y, Z of the direction compensation value of (a) is calculatedaThe average value of X, Y, Z directional compensation values is formulated as:
step five, the TURBO PMAC system outputs a compensated motion trail control signal to the robot motor to enable the central point of the tail end of the two-freedom-degree series head of the robot to be from S1Point movement to SnSimultaneously, a laser tracker is utilized to track and measure the central point of the tail end of the two-freedom-degree series swinging head of the robot from S1Point movement to SnThe continuous motion track of the point is input into the operation software of the laser tracker1、S2…SnThe coordinates of each point under the robot coordinate system can generate a theoretical track;
and step six, comparing the compensated track with the theoretical track, finding out point positions with poor compensation, taking the deviation of the track acquired by the laser tracker and the theoretical track in the direction of X, Y, Z as a re-compensation numerical value of corresponding track points in the operation software of the laser tracker, then correcting the position values of the corresponding track points by adopting the re-compensation numerical value on the basis of the position correction value of each point position in the program of step four, and repeating the step five and the step six until the compensated track meets the requirements.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910722956.5A CN110549333B (en) | 2019-08-06 | 2019-08-06 | Gravity compensation method for TriMule horizontal series-parallel robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910722956.5A CN110549333B (en) | 2019-08-06 | 2019-08-06 | Gravity compensation method for TriMule horizontal series-parallel robot |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110549333A CN110549333A (en) | 2019-12-10 |
CN110549333B true CN110549333B (en) | 2022-03-29 |
Family
ID=68736980
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910722956.5A Active CN110549333B (en) | 2019-08-06 | 2019-08-06 | Gravity compensation method for TriMule horizontal series-parallel robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110549333B (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111618857B (en) * | 2020-05-28 | 2021-04-20 | 杭州键嘉机器人有限公司 | Multi-load self-adaptive gravity compensation method for mechanical arm |
CN112643669B (en) * | 2020-12-04 | 2022-01-18 | 广州机械科学研究院有限公司 | Robot position deviation compensation method, system, device and storage medium |
CN112893955B (en) * | 2021-01-15 | 2022-07-12 | 天津大学 | Hybrid robot milling error compensation method based on static stiffness model |
CN117444943B (en) * | 2023-12-26 | 2024-03-22 | 济南二机床集团有限公司 | Series-parallel manipulator and manipulator track planning method |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101060988B1 (en) * | 2009-01-23 | 2011-09-01 | 성균관대학교산학협력단 | Apparatus and method for tracking moving objects using intelligent signal strength of Zigbee |
CN102320040B (en) * | 2011-08-11 | 2014-02-26 | 南昌大学 | Force feedback interactive device for automatically regulating balance of dead weight |
CN105835036B (en) * | 2016-05-05 | 2018-10-30 | 西安交通大学 | A kind of parallel connected bionic eye device and its control method |
CN106625573B (en) * | 2016-10-25 | 2018-11-13 | 天津大学 | A kind of series parallel robot in five degrees of freedom direct error compensation technique |
CN108161936B (en) * | 2017-12-26 | 2020-06-30 | 中科新松有限公司 | Optimized robot calibration method and device |
-
2019
- 2019-08-06 CN CN201910722956.5A patent/CN110549333B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN110549333A (en) | 2019-12-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110549333B (en) | Gravity compensation method for TriMule horizontal series-parallel robot | |
CN108297101B (en) | Multi-joint-arm series robot end pose error detection and dynamic compensation method | |
CN107421442B (en) | Robot positioning error online compensation method assisted by external measurement | |
CN106625573B (en) | A kind of series parallel robot in five degrees of freedom direct error compensation technique | |
EP1274546B1 (en) | Pathcorrection for an industrial robot | |
CN102092478B (en) | Positioning device for butting wing body | |
CN108655827B (en) | Method for identifying space error of five-axis numerical control machine tool | |
CN104596418B (en) | A kind of Multi-arm robots coordinate system is demarcated and precision compensation method | |
CN103143984B (en) | Based on the machine tool error dynamic compensation method of laser tracker | |
CN109159151A (en) | A kind of mechanical arm space tracking tracking dynamic compensation method and system | |
CN112558547B (en) | Quick optimization method for geometric error compensation data of translational shaft of five-axis numerical control machine tool | |
CN104890013A (en) | Pull-cord encoder based calibration method of industrial robot | |
CN111037542B (en) | Track error compensation method for linear machining of inverse dynamics control robot | |
CN110561438A (en) | Industrial robot manpower/position compliance control method based on kinetic parameter identification | |
CN109657282B (en) | H-shaped motion platform modeling method based on Lagrangian dynamics | |
CN110370271B (en) | Joint transmission ratio error calibration method of industrial series robot | |
CN108204879B (en) | A kind of measuring method and system of rotary inertia | |
CN103496449A (en) | Pose adjustment track planning method for plane side wall component assembling | |
CN108507572B (en) | Attitude positioning error correction method based on MEMS inertial measurement unit | |
CN111687845B (en) | Mechanical arm kinematics parameter calibration method based on inertia measurement unit | |
CN114611362B (en) | Installation and debugging method for working face of large instrument, electronic device and medium | |
CN113636348A (en) | Glass transfer system for building installation | |
CN113910247B (en) | Industrial robot tail end track control method and system considering joint clearance evolution | |
CN112373042A (en) | Method and system for monitoring pose of five-axis 3D printer | |
CN111390914A (en) | Robot zero position and tool coordinate calibration method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |