A kinematic modeling method for a five-degree-of-freedom hybrid robot
Through the kinematic modeling method of five-degree of freedom hybrid robots, the closed solution method and serial-parallel hybrid multi-joint structure are used to solve the problems of large motion inertia and large structural size of robots in the prior art, and high-precision and high-speed trajectory are achieved Planning and control, suitable for industrial and medical fields.
Patent Information
- Application Number
- CN202210624490.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-06-02
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2042-06-02
AI Technical Summary
In the prior art, the tandem robot has a large motion inertia, cumulative error, and the parallel robot has a large structure size and a small working space, which affects its application in the industrial field; while the hybrid robot lacks effective kinematic modeling methods, which is difficult to Achieve high-speed and high-precision trajectory planning and control.
A kinematic modeling method for mixed-connected robots with five degrees of freedom is proposed, and a closed solution is used to solve the position forward and inverse solution, and a series-parallel hybrid multi-articular structure is used, which is composed of fixed platform, end tools, two branches and connecting rods. Establish the robot's connecting rod coordinate system, use the homogeneous transformation matrix formula to obtain the positive and negative solutions of kinematics, and realize the position and posture adjustment of the end tool.
It realizes a five-degree of freedom hybrid robot with simple structure, high rigidity, simple kinematic positive and negative solutions, and high positioning accuracy. It is easy to trajectory planning and control, and is suitable for industrial, medical and other fields.
Smart Images

Figure CN115056220B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of hybrid robots, and in particular to a kinematic modeling method for a five-degree-of-freedom hybrid robot. Background Art
[0002] According to the mode of structural combination, robots are roughly divided into three types: parallel robots, serial robots and hybrid robots. The structure of hybrid robots consists of two parts: serial modules and parallel modules.
[0003] Serial robots have a large working space, flexible movement, and a wide range of applications. They have been widely used in various industrial fields. Drive devices need to be added to each joint of the serial robot, and the motion inertia is relatively large, which is not conducive to achieving high-speed working state, and there are cumulative errors.
[0004] Parallel robots have high rigidity, stable structure, no accumulated errors, and the drive device is generally installed on or near the frame, which reduces the dynamic load, improves dynamic performance, and facilitates high-speed working. However, parallel robots usually have some defects such as large structural size, small working space, and many transmission links, which affect their application in various aspects.
[0005] The hybrid robot combines many advantages of parallel robots and serial robots. This type of robot has high rigidity, strong load-bearing capacity, high precision, fast movement speed and a large working space. It has great theoretical research value and practical application value.
[0006] Robot kinematic analysis is used to describe the relationship between the input and output parameters of a robot. It is the basis of statics analysis, stiffness analysis, dynamics analysis and robot control. It includes position analysis, velocity analysis and acceleration analysis. The position analysis of the robot is the basis of kinematic analysis. The position analysis of the robot is divided into two types: forward position solution and inverse position solution.
[0007] In actual production, the five-degree-of-freedom hybrid robot can meet the needs of many production operations and is widely used in electronics, light industry, food, medical and other industries.
[0008] The present invention proposes a kinematic modeling method for a five-degree-of-freedom hybrid robot, and adopts a closed solution method to solve the forward and inverse solutions of the robot's position. The hybrid robot has a simple and novel structure, high rigidity, concise kinematic forward and inverse solutions, high positioning accuracy, and is easy to implement trajectory planning and control. Summary of the invention
[0009] The purpose of the present invention is to provide a five-degree-of-freedom hybrid robot with simple structure, concise forward and inverse solutions of motion, large working space and simple control method.
[0010] The robot adopts a serial-parallel hybrid multi-joint structure, which consists of a fixed platform, an end tool, two branch chains, a moving pair and a connecting rod.
[0011] The first branch chain is composed of a fixed platform, a first moving pair, a first connecting rod, a second moving pair, a second connecting rod, a first universal joint, a third connecting rod, a third moving pair, a fourth connecting rod and a second universal joint in sequence.
[0012] The second branch chain is composed of a fixed platform, a fourth moving pair, a fifth connecting rod, a fifth moving pair, a sixth connecting rod and a second universal joint in sequence.
[0013] One end of the seventh connecting rod is connected to the second universal joint, and the other end is connected to the end tool through the sixth moving joint.
[0014] The moving directions of the first moving pair and the fourth moving pair are parallel; the moving directions of the second moving pair and the fifth moving pair are parallel; the moving directions of the first moving pair and the second moving pair are perpendicular; the moving directions of the fourth moving pair and the fifth moving pair are perpendicular.
[0015] The first moving pair, the second moving pair, the fourth moving pair, the fifth moving pair and the sixth moving pair are driving pairs of the robot.
[0016] Establish the coordinate system of each link of the robot.
[0017] A coordinate system o1x1y1z1 is established on the first moving pair. The coordinate axis o1z1 coincides with the moving direction, and the coordinate axis o1x1 is perpendicular to the moving direction of the second moving pair. When the first moving pair is at zero position, the coordinate system o1x1y1z1 coincides with the coordinate system o0x0y0z0, and the moving distance of the coordinate system o1x1y1z1 on the coordinate axis o0z0 is d1.
[0018] A coordinate system o2x2y2z2 is established on the second moving pair. The coordinate axis o2z2 coincides with the moving direction and passes through the center of the first universal joint. The coordinate axis o2y2 is parallel to the coordinate axis o1x1 and in the opposite direction with a distance d2. The distance between the coordinate axis o2z2 and the coordinate axis o1z1 is l1.
[0019] A coordinate system o5x5y5z5 is established on the first universal joint. The coordinate axis o5y5 passes through the center of the second universal joint. The coordinate axis o5z5 is perpendicular to the plane determined by the coordinate axis o2x2 and the coordinate axis o5y5. The distance between o2o5 is l4.
[0020] A coordinate system o6x6y6z6 is established on the third moving pair. The directions of the three coordinate axes of the coordinate system o6x6y6z6 and the coordinate system o5x5y5z5 are consistent, and the distance between o5o6 is l6.
[0021] Establish coordinate system o7x7y7z7 on the second universal joint. The directions of the three coordinate axes of coordinate system o7x7y7z7 and coordinate system o6x6y6z6 are consistent, and the distance between o6o7 is l7.
[0022] A coordinate system o3x3y3z3 is established on the fourth mobile pair, the coordinate axis o3z3 coincides with the moving direction, the coordinate axis o3x3 is perpendicular to the moving direction of the fifth mobile pair, the distance between the coordinate axis o3x3 and the coordinate axis o0x0 is d3, and the distance between the coordinate axis o3z3 and the coordinate axis o0z0 is l2.
[0023] A coordinate system o4x4y4z4 is established on the fifth moving joint. The coordinate axis o4z4 coincides with the moving direction and passes through the center of the second universal joint. The distance from o4o7 is l5. The coordinate axis o4y4 is parallel to the coordinate axis o3x3 and in the opposite direction. The distance is d4. The distance between the coordinate axis o4z4 and the coordinate axis o3z3 is l3.
[0024] A coordinate system o8x8y8z8 is established on the end tool, with the coordinate origin o8 on the plane o7y7z7, the coordinate axis o8y8 is parallel to the coordinate axis o7z7 and the distance between them is d5, and the coordinate axis o8z8 is parallel to the coordinate axis o7y7 and the distance between them is l8.
[0025] The positive directions of the three axes in all the above-mentioned spatial rectangular coordinate systems conform to the right-hand rule.
[0026] Establish the robot's homogeneous transformation matrix formula:
[0027]
[0028]
[0029] The robot has two cross universal joints, each of which has two revolute joints, and the established coordinate systems are o5x5y5z5 and o7x7y7z7 respectively.
[0030] The center coordinates of the two cross universal joints are:
[0031]
[0032] vector for:
[0033]
[0034]
[0035] The unit vector is
[0036] The unit vector is:
[0037]
[0038]
[0039] The homogeneous transformation matrix can be obtained
[0040]
[0041] and The posture is consistent, and the homogeneous transformation matrix can be obtained for:
[0042]
[0043] and The posture is consistent, and the homogeneous transformation matrix can be obtained for:
[0044]
[0045] A homogeneous transformation matrix can be created
[0046]
[0047] Multiply to create a homogeneous transformation matrix Obtain the correct solution for the robot kinematics:
[0048]
[0049] According to the robot motion equation and the end tool pose matrix, we can get:
[0050]
[0051] Among them, [n x ,n y ,n z ]、[o x ,o y ,o z ]、[a x ,a y ,a z ] respectively represent the projection components of the three principal axis unit vectors n, o, a of the transformed coordinate system relative to the three principal axes of the original coordinate system, [p x ,p y ,p z ] represents the coordinate value of the origin of the transformed coordinate system relative to the origin vector p of the original coordinate system.
[0052] The end tool has a symmetrical structure, n and o have arbitrary postures, a and p are known values, and the joint variables d1, d2, d3, d4, and d5 are calculated.
[0053]
[0054]
[0055] From formula (4), we know that according to the geometric relationship l1+l2≠l3, a x ≠0, we get:
[0056]
[0057] From formula (5), we get:
[0058]
[0059] From equations (5), (6) and (7), we can get:
[0060]
[0061] for Calculate d1, d2, d3, d4, and d5 for the two cases respectively, and calculate d4+l5 and d2+l4, and compare the two to see whether they meet the assumptions.
[0062] Substituting equations (7), (8), and (9) into equation (1), we obtain:
[0063]
[0064] Substituting equations (7), (8), and (10) into equation (2), we obtain:
[0065]
[0066] Substituting equations (5) and (10) into equation (3), we obtain:
[0067]
[0068] Substituting equations (7) and (12) into equation (5), we obtain:
[0069]
[0070] Substituting formula (11) into formula (9), we get:
[0071]
[0072] In summary, we can obtain the values of all joint variables d1, d2, d3, d4, and d5, and the inverse solution of the robot kinematics is:
[0073]
[0074] The present invention provides a kinematic modeling method for a five-degree-of-freedom hybrid robot. The robot consists of a fixed platform, two branches, a terminal moving pair, and connected rods. The robot can achieve five-degree-of-freedom output including three-dimensional movement and two-dimensional rotation. Five driving mechanisms drive the four moving pairs of the two branches and the terminal moving pair to achieve the position and posture adjustment of the terminal tool. A robot connecting rod coordinate system is established to obtain the kinematic forward and inverse solutions. The hybrid robot has a simple and novel structure, high rigidity, concise kinematic forward and inverse solutions, high positioning accuracy, and is easy to implement trajectory planning and control. The present invention is a hybrid robot with broad potential application prospects in many fields such as industry and medicine. BRIEF DESCRIPTION OF THE DRAWINGS
[0075] Figure 1 This is a motion principle diagram of a five-degree-of-freedom hybrid robot of the present invention. DETAILED DESCRIPTION
[0076] The present invention is further described in detail below in conjunction with embodiments and drawings, but the implementation manner of the present invention is not limited thereto.
[0077] like Figure 1 As shown, this implementation example provides a kinematic modeling method for a five-degree-of-freedom hybrid robot.
[0078] Establish the coordinate systems of each link of the robot.
[0079] A coordinate system o1x1y1z1 is established on the first moving pair. The coordinate axis o1z1 coincides with the moving direction, and the coordinate axis o1x1 is perpendicular to the moving direction of the second moving pair. When the first moving pair is at zero position, the coordinate system o1x1y1z1 coincides with the coordinate system o0x0y0z0, and the moving distance of the coordinate system o1x1y1z1 on the o0z0 axis is d1.
[0080] A coordinate system o2x2y2z2 is established on the second moving pair. The coordinate axis o2z2 coincides with the moving direction and passes through the center of the first universal joint. The coordinate axis o2y2 is parallel to the coordinate axis o1x1 and in the opposite direction with a distance d2. The distance between the coordinate axis o2z2 and the coordinate axis o1z1 is l1.
[0081] A coordinate system o5x5y5z5 is established on the first universal joint. The coordinate axis o5y5 passes through the center of the second universal joint. The coordinate axis o5z5 is perpendicular to the plane determined by the coordinate axis o2x2 and the coordinate axis o5y5. The distance between o2o5 is l4.
[0082] A coordinate system o6x6y6z6 is established on the third moving pair. The directions of the three coordinate axes of the coordinate system o6x6y6z6 and the coordinate system o5x5y5z5 are consistent, and the distance between o5o6 is l6.
[0083] Establish coordinate system o7x7y7z7 on the second universal joint. The directions of the three coordinate axes of coordinate system o7x7y7z7 and coordinate system o6x6y6z6 are consistent, and the distance between o6o7 is l7.
[0084] A coordinate system o3x3y3z3 is established on the fourth mobile pair, the coordinate axis o3z3 coincides with the moving direction, the coordinate axis o3x3 is perpendicular to the moving direction of the fifth mobile pair, the distance between the coordinate axis o3x3 and the coordinate axis o0x0 is d3, and the distance between the coordinate axis o3z3 and the coordinate axis o0z0 is l2.
[0085] A coordinate system o4x4y4z4 is established on the fifth moving joint. The coordinate axis o4z4 coincides with the moving direction and passes through the center of the second universal joint. The distance from o4o7 is l5. The coordinate axis o4y4 is parallel to the coordinate axis o3x3 and in the opposite direction. The distance is d4. The distance between the coordinate axis o4z4 and the coordinate axis o3z3 is l3.
[0086] A coordinate system o8x8y8z8 is established on the end tool, with the coordinate origin o8 on the plane o7y7z7, the coordinate axis o8y8 is parallel to the coordinate axis o7z7 and the distance between them is d5, and the coordinate axis o8z8 is parallel to the coordinate axis o7y7 and the distance between them is l8.
[0087] The positive directions of the three axes in all the above-mentioned spatial rectangular coordinate systems conform to the right-hand rule.
[0088] The first moving pair, the second moving pair, the fourth moving pair, the fifth moving pair, and the sixth moving pair are the driving pairs of the robot, and the sliding motion is realized through the motor and the ball screw. When each driving pair moves different displacements under control, the remaining moving pairs and universal joints make corresponding movements under the pull of the connecting rod, thereby realizing the three translation and two rotation motion output of the end tool in the workspace.
[0089] Establish the robot's homogeneous transformation matrix formula:
[0090]
[0091]
[0092] The robot has two cross universal joints, each of which has two revolute joints, and the established coordinate systems are o5x5y5z5 and o7x7y7z7 respectively.
[0093] The center coordinates of the two cross universal joints are:
[0094]
[0095] vector for:
[0096]
[0097]
[0098] The unit vector is
[0099] The unit vector is:
[0100]
[0101]
[0102] The homogeneous transformation matrix can be obtained
[0103]
[0104] and The posture is consistent, and the homogeneous transformation matrix can be obtained for:
[0105]
[0106] and The posture is consistent, and the homogeneous transformation matrix can be obtained for:
[0107]
[0108] A homogeneous transformation matrix can be created
[0109]
[0110] Multiply to create a homogeneous transformation matrix
[0111]
[0112] According to the robot motion equation and the end tool pose matrix, we can get:
[0113]
[0114] The postures of n and o are arbitrary, a and p are known and fixed values, find the joint variables d1, d2, d3, d4, and d5.
[0115]
[0116]
[0117] From formula (4), we know that according to the geometric relationship l1+l2≠l3, ax ≠0, we get:
[0118]
[0119] From formula (5), we get:
[0120]
[0121] From equations (5), (6) and (7), we can get:
[0122]
[0123] for Calculate d1, d2, d3, d4, and d5 for the two cases respectively, and calculate d4+l5 and d2+l4, and compare the two to see if they meet the assumptions.
[0124] Substituting equations (7), (8), and (9) into equation (1), we obtain:
[0125]
[0126] Substituting equations (7), (8), and (10) into equation (2), we obtain:
[0127]
[0128] Substituting equations (5) and (10) into equation (3), we obtain:
[0129]
[0130] Substituting equations (7) and (12) into equation (5), we obtain:
[0131]
[0132] Substituting formula (11) into formula (9), we get:
[0133]
[0134] In summary, we can obtain the values of all joint variables d1, d2, d3, d4, and d5.
[0135]
[0136] The above embodiments are only used to further illustrate the present invention, but cannot be understood as limiting the scope of protection of the present invention. It should be pointed out that ordinary technicians in this field can modify, replace and modify the above embodiments according to the design concept of the present invention, which all belong to the protection scope of the present invention.
Claims
1. A kinematic modeling method for a five-degree-of-freedom hybrid robot, characterized in that: The robot adopts a serial-parallel hybrid multi-joint structure, which consists of a fixed platform, an end tool, two branch chains, a moving pair and a connecting rod; The first branch chain is composed of the fixed platform, the first moving pair, the first connecting rod, the second moving pair, the second connecting rod, the first universal joint, the third connecting rod, the third moving pair, the fourth connecting rod, and the second universal joint in sequence; The second branch chain is composed of the fixed platform, the fourth moving pair, the fifth connecting rod, the fifth moving pair, the sixth connecting rod, and the second universal joint in sequence; One end of the seventh connecting rod is connected to the second universal joint, and the other end is connected to the end tool through the sixth moving joint; The first moving pair is parallel to the moving direction of the fourth moving pair; the second moving pair is parallel to the moving direction of the fifth moving pair; the first moving pair is perpendicular to the moving direction of the second moving pair; the fourth moving pair is perpendicular to the moving direction of the fifth moving pair; The first moving pair, the second moving pair, the fourth moving pair, the fifth moving pair and the sixth moving pair are driving pairs of the robot; Establishing the coordinate systems of the connecting rods of the robot; A coordinate system o1x1y1z1 is established on the first moving pair, wherein the coordinate axis o1z1 coincides with the moving direction, and the coordinate axis o1x1 is perpendicular to the moving direction of the second moving pair. When the first moving pair is at zero position, the coordinate system o1x1y1z1 coincides with the coordinate system o0x0y0z0, and the moving distance of the coordinate system o1x1y1z1 on the coordinate axis o0z0 is d1; A coordinate system o2x2y2z2 is established on the second moving pair, wherein the coordinate axis o2z2 coincides with the moving direction and passes through the center of the first universal joint, the coordinate axis o2y2 is parallel to the coordinate axis o1x1 and in the opposite direction, and the distance between the coordinate axis o2z2 and the coordinate axis o1z1 is l1; A coordinate system o5x5y5z5 is established on the first universal joint, wherein the coordinate axis o5y5 passes through the center of the second universal joint, the coordinate axis o5z5 is perpendicular to the plane defined by the coordinate axis o2x2 and the coordinate axis o5y5, and the distance between o2o5 is l4; A coordinate system o6x6y6z6 is established on the third moving pair, wherein the directions of the three coordinate axes of the coordinate system o6x6y6z6 and the coordinate system o5x5y5z5 are consistent, and the distance between o5o6 is l6; A coordinate system o7x7y7z7 is established on the second universal joint, wherein the three coordinate axes of the coordinate system o7x7y7z7 and the coordinate system o6x6y6z6 are in the same direction, and the distance between o6o7 is l7; A coordinate system o3x3y3z3 is established on the fourth mobile pair, wherein the coordinate axis o3z3 coincides with the moving direction, the coordinate axis o3x3 is perpendicular to the moving direction of the fifth mobile pair, the distance between the coordinate axis o3x3 and the coordinate axis o0x0 is d3, and the distance between the coordinate axis o3z3 and the coordinate axis o0z0 is l2; A coordinate system o4x4y4z4 is established on the fifth moving joint, wherein the coordinate axis o4z4 coincides with the moving direction and passes through the center of the second universal joint, and the distance from o4o7 is l5, the coordinate axis o4y4 is parallel to the coordinate axis o3x3 in the opposite direction, and the distance from o4z4 to o3z3 is l3; A coordinate system o8x8y8z8 is established on the end tool, the coordinate origin o8 is on the plane o7y7z7, the coordinate axis o8y8 is parallel to the coordinate axis o7z7 and the distance is d5, and the coordinate axis o8z8 is parallel to the coordinate axis o7y7 and the distance is l8; The positive directions of the three axes in all the above spatial rectangular coordinate systems conform to the right-hand rule; The homogeneous transformation matrix formula of the robot is established: The robot has two cross universal joints, each of which has two revolute joints, and the established coordinate systems are respectively the coordinate systems o5x5y5z5 and o7x7y7z7; The center position coordinates of the two cross universal joints are: vector for: The unit vector is The unit vector is: The homogeneous transformation matrix can be obtained and The posture is consistent, and the homogeneous transformation matrix can be obtained for: and The posture is consistent, and the homogeneous transformation matrix can be obtained for: A homogeneous transformation matrix can be created Multiply to create a homogeneous transformation matrix The correct solution of the robot kinematics is obtained:
2. A kinematic modeling method for a five-degree-of-freedom hybrid robot according to claim 1, characterized in that: According to the robot motion equation and the end tool pose matrix, we can get: Among them, [n x ,n y ,n z ]、[o x ,o y ,o z ]、[a x ,a y ,a z ] respectively represent the projection components of the three principal axis unit vectors n, o, a of the transformed coordinate system relative to the three principal axes of the original coordinate system, [p x ,p y ,p z ] represents the coordinate value of the origin of the transformed coordinate system relative to the origin vector p of the original coordinate system; The end tool is a symmetrical structure, n and o are in any position, a and p are known values, and joint variables d1, d2, d3, d4, and d5 are calculated; From formula (4), we know that according to the geometric relationship l1+l2≠l3, a x ≠0, we get: From formula (5), we get: From equations (5), (6) and (7), we can get: for Calculate d1, d2, d3, d4, d5 for the two cases respectively, and calculate d4+l5 and d2+l4, and compare the two to see whether they meet the assumptions; Substituting equations (7), (8), and (9) into equation (1), we obtain: Substituting equations (7), (8), and (10) into equation (2), we obtain: Substituting equations (5) and (10) into equation (3), we obtain: Substituting equations (7) and (12) into equation (5), we obtain: Substituting formula (11) into formula (9), we get: In summary, the values of all the joint variables d1, d2, d3, d4, and d5 can be obtained, and the inverse kinematics solution of the robot is:
