A five-degree-of-freedom parallel-serial hybrid robot, design method and application
By designing a five-degree of freedom parallel series hybrid robot, adopting a structure that is first parallel and then series, combined with kinematic analysis, the problem of insufficient research on the composition of parallel and parallel hybrid mechanisms in the existing technology is solved, and high-precision and large-size processing is achieved and convenient installation effect.
Patent Information
- Application Number
- CN202411090063.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-09
- Publication Date
- 2024-11-01
- Estimated Expiration
- 2044-08-09
AI Technical Summary
The existing series and parallel robots have their own limitations, and the lack of research on mixed mechanisms composed of parallel and parallel has led to shortcomings in work space, stiffness performance and machining accuracy.
A five-degree-of-freedom parallel series hybrid robot is designed, adopting a structure that is first parallel and then series, including a fixed platform, an RPR-RP parallel mechanism and a 3-RPS parallel mechanism. The power output end of the RPR-RP parallel mechanism is used and 3- The RPS parallel mechanism is connected to realize five degrees of freedom motion, and combines kinematic analysis and design methods to establish an overall kinematic model and a static stiffness model.
It achieves the advantages of small overall size, superior stiffness performance and wide work space, can process large-size parts with high precision, and is easy to install and transport, improving the application capabilities of robots in the manufacturing field.
Smart Images

Figure CN118636116B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robots, and in particular to a five-degree-of-freedom parallel-serial hybrid robot, a design method and an application thereof. Background Art
[0002] Currently, the robot structures used in ultra-precision machining are mainly divided into serial structures and parallel structures. The serial mechanism has the advantages of simple structure, flexible operation and simple control, so it is widely used in the manufacturing field. However, it also has defects such as low structural stiffness, low motion accuracy and poor load-bearing capacity.
[0003] The parallel mechanism has the advantages of solid structure, fast response speed, high positioning accuracy, strong load-bearing capacity, wide operating space and easy inverse kinematics solution. It can form a good complementary relationship with the currently widely used series mechanism, but it also has the disadvantage of a small working space.
[0004] It can be seen that the series mechanism and the parallel mechanism each have their limitations, so the series-parallel hybrid mechanism came into being. The structure of this mechanism is usually composed of series and parallel mechanisms. It combines the advantages of the two mechanisms and has greater advantages in working space, stiffness performance and processing accuracy.
[0005] At present, there are remarkable research results on hybrid mechanisms composed of series and parallel mechanisms at home and abroad, but there is a lack of research on hybrid mechanisms composed of parallel and parallel mechanisms. Summary of the invention
[0006] To solve the above problems, the present invention provides a five-degree-of-freedom parallel-serial hybrid robot, a design method and an application, which adopts a parallel-first-then-serial structure and has the advantages of small overall size, excellent stiffness performance and wide working space.
[0007] To achieve the above object, the present invention provides a five-degree-of-freedom parallel-serial hybrid robot, comprising a fixed platform and a RPR-RP parallel mechanism and a 3-RPS parallel mechanism connected in series, the RPR-RP parallel mechanism is arranged on the fixed platform, and a power output end of the RPR-RP parallel mechanism is connected to the 3-RPS parallel mechanism;
[0008] The 3-RPS parallel mechanism includes an intermediate platform, a moving platform, and a plurality of RPS branches that are evenly rotated in a circular array and arranged between the intermediate platform and the moving platform;
[0009] The RPR-RP parallel mechanism includes an RP branch and an RPR branch symmetrically arranged about a fixed platform. Both the RP branch and the RPR branch include a rotating pair vertically rotationally connected to the fixed platform and a moving pair connected to the power output end of the rotating pair and telescopic toward the 3-RPS parallel mechanism. The power output end of the moving pair of the RPR branch is vertically rotationally connected to the intermediate platform, and the power output end of the moving pair of the RP branch is fixedly connected to the intermediate platform.
[0010] The present invention has the following beneficial effects:
[0011] 1. The structure of first parallel connection and then series connection is adopted, which has the advantages of small overall size, excellent rigidity performance and wide working space;
[0012] 2. By using RPR-RP as the main mechanism and 3-RPS as the auxiliary mechanism, it can not only realize the processing and measurement of large-size parts, but also ensure the processing accuracy and facilitate the overall installation and transportation.
[0013] The technical solution of the present invention is further described in detail below through the accompanying drawings and embodiments. BRIEF DESCRIPTION OF THE DRAWINGS
[0014] Figure 1 It is a structural schematic diagram of a five-degree-of-freedom parallel-serial hybrid robot of the present invention;
[0015] Figure 2 It is a structural schematic diagram of the RP branch chain of a five-degree-of-freedom parallel-serial hybrid robot of the present invention;
[0016] Figure 3 It is a structural schematic diagram of an RPR branch chain of a five-degree-of-freedom parallel-serial hybrid robot of the present invention;
[0017] Figure 4 It is a structural schematic diagram of the RPS branch chain of a five-degree-of-freedom parallel-serial hybrid robot of the present invention;
[0018] Figure 5 A flow chart of a design method of a five-degree-of-freedom parallel-serial hybrid robot according to the present invention;
[0019] Figure 6 A schematic diagram of a parallel-serial hybrid robot coordinate system for a design method of a five-degree-of-freedom parallel-serial hybrid robot according to the present invention;
[0020] Figure 7 A displacement variation curve diagram of a driving rod of an RPR-RP parallel mechanism of a design method of a five-degree-of-freedom parallel-serial hybrid robot of the present invention;
[0021] Figure 8 It is a displacement variation curve diagram of the driving rod of the 3-RPS parallel mechanism of the present invention;
[0022] Figure 9 It is a driving force variation curve diagram of the RPR-RP parallel mechanism when there is no external force on the moving platform of the present invention;
[0023] Figure 10 It is a driving force variation curve diagram of the 3-RPS parallel mechanism when there is no external force on the moving platform of the present invention;
[0024] Figure 11 It is a curve diagram of driving power consumption variation of the RPR-RP parallel mechanism when there is no external force on the moving platform of the present invention;
[0025] Figure 12 It is a curve diagram of driving power consumption variation of the 3-RPS parallel mechanism when there is no external force on the moving platform of the present invention;
[0026] Figure 13 It is a curve diagram of the driving force variation of the RPR-RP parallel mechanism when the moving platform of the present invention is subjected to a vertical force;
[0027] Figure 14 It is a driving force variation curve diagram of the 3-RPS parallel mechanism when the moving platform of the present invention is subjected to a vertical force;
[0028] Figure 15 It is a curve diagram of driving power consumption variation of the RPR-RP parallel mechanism when the moving platform of the present invention is subjected to a vertical force;
[0029] Figure 16 It is a curve diagram of the driving power consumption variation of the 3-RPS parallel mechanism when the moving platform of the present invention is subjected to a vertical force.
[0030] Among them: 1. Fixed platform; 2. RPR branch chain; 3. RP branch chain; 4. Intermediate platform; 5. RPS branch chain; 6. Moving platform; 7. Rotating pair; 8. Moving pair; 9. Rotating seat; 10. Electric cylinder; 11. Rotating ball. DETAILED DESCRIPTION
[0031] In order to make the purpose, technical scheme and advantages disclosed in the embodiments of the present invention clearer, the embodiments of the present invention are further described in detail in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the embodiments of the present invention and are not intended to limit the embodiments of the present invention. Based on the embodiments in this application, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of this application. Examples of the embodiments are shown in the accompanying drawings, where the same or similar reference numerals throughout represent the same or similar elements or elements with the same or similar functions.
[0032] like Figure 1-Figure 4As shown, a five-degree-of-freedom parallel-serial hybrid robot includes a fixed platform 1 and a RPR-RP parallel mechanism and a 3-RPS parallel mechanism connected in series, the RPR-RP parallel mechanism is arranged on the fixed platform 1, and the power output end of the RPR-RP parallel mechanism is connected to the 3-RPS parallel mechanism; wherein the 3-RPS parallel mechanism includes an intermediate platform 4, a moving platform 6, and a plurality of RPS branches 5 that are arranged in a circular array and rotate uniformly between the intermediate platform 4 and the moving platform 6; the RPR-RP parallel mechanism includes an RP branch 3 and an RPR branch 2 that are symmetrically arranged about the fixed platform 1, the RP branch 3 and the RPR branch 2 both include a rotating pair 7 that is vertically rotationally connected to the fixed platform 1 and a moving pair 8 that is connected to the power output end of the rotating pair 7 and telescopes toward the 3-RPS parallel mechanism, the power output end of the moving pair 8 of the RPR branch 2 is vertically rotationally connected to the intermediate platform 4, and the power output end of the moving pair 8 of the RP branch 3 is fixedly connected to the intermediate platform 4.
[0033] The rotating pair 7 is a square bearing with one end vertically rotatably connected to the fixed platform 1, and the moving pair 8 is a telescopic motor vertically rotatably connected to the other end of the square bearing; the output shaft of the telescopic motor of the RP branch chain 3 is fixedly connected to the intermediate platform 4 via a flange connecting shaft, and the output shaft of the telescopic motor of the RPR branch chain 2 is vertically rotatably connected to the intermediate platform 4 via a rolling bearing, and the connection between the RP branch chain 3 and the intermediate platform 4 and the connection between the RPR branch chain 2 and the intermediate platform 4 are symmetrically arranged about the center of the intermediate platform 4 and the horizontal center of the fixed platform 1; the RPS branch chain 5 includes an electric cylinder 10, and the cylinder body of the electric cylinder 10 is rotatably connected to the bottom end of the intermediate platform 4 via a rotating seat 9, and the telescopic rod of the electric cylinder 10 is rotatably connected to the top of the moving platform 6 via a rotating ball 11.
[0034] In this embodiment, the 3-RPS parallel mechanism includes three evenly distributed RPS branches 5 .
[0035] Through the above structure, when the RP branch chain 3 and the RPR branch chain 2 of the RPR-RP parallel mechanism are extended and retracted synchronously, the intermediate platform 4 is driven to move horizontally, and then the moving platform 6 is driven to move horizontally, which is the first degree of freedom; when the RP branch chain 3 and the RPR branch chain 2 are not extended and retracted synchronously, the rotation connection point between the RPR branch chain 2 and the intermediate platform 4 rotates, which is the second degree of freedom; when the three RPS branch chains 5 are extended and retracted synchronously, the moving platform 6 is driven to move vertically, which is the third degree of freedom; when the three RPS branch chains 5 are not extended and retracted synchronously, the moving platform 6 is driven to rotate around the RPS branch chain 5, which are the remaining two degrees of freedom, thereby realizing five degrees of freedom.
[0036] like Figure 5 and Figure 6 As shown, the design method of a five-degree-of-freedom parallel-serial hybrid robot comprises the following steps:
[0037] S1. Perform kinematic analysis on the parallel-serial hybrid robot and establish a kinematic model;
[0038] Step S1 specifically includes the following steps:
[0039] S11. Construct a three-dimensional model of a parallel-series hybrid robot based on three-dimensional modeling software;
[0040] S12. Solve the degrees of freedom of the three-dimensional model of the parallel-series hybrid robot based on the screw theory, and complete the kinematic analysis using the closed-loop vector theory;
[0041] Step S12 specifically includes the following steps:
[0042] S121, initial state setting:
[0043] Initialize the RPR-RP parallel mechanism:
[0044] Set the straight line where the revolute pair 7 of the RPR branch chain 2 is located as , the straight line where the moving pair 8 of the RPR branch chain 2 is located is , the rotation connection point between the RPR branch chain 2 and the intermediate platform 4 is ; The straight line where the revolving pair 7 of the RP branch chain 3 is located is , the straight line where the moving pair 8 of the RP branch chain 3 is located is , the fixed connection point between the RP branch chain 3 and the intermediate platform 4 is ; The coordinate origin is fixed on platform 1 Center and The midpoint of the center connecting line, The axis is On the connecting line of Center of mass direction Centroid, The axis is perpendicular to the base plane and downward. The axis is determined by the right-hand rule;
[0045] Initialize the 3-RPS parallel mechanism:
[0046] The 3-RPS parallel mechanism is assumed to have three RPS branches 5, and the origin of the RPS branches 5 is the center of the rotating seat 9. The shaft extends along the axis of the rotating seat 9, The axis is determined by the right-hand rule, The axis is perpendicular to the base surface, and the straight lines where the electric cylinders 10 of the three RPS branches 5 are located are , , The positions of the rotating seats 9 of the three RPS branch chains 5 are respectively , , The positions of the turning balls 11 of the three RPS branches 5 are , , ;
[0047] S122. Calculate the degrees of freedom of the RPR-RP parallel mechanism and the 3-RPS parallel mechanism respectively:
[0048] S1221, determine the moving helical system and constrained anti-helix of RP branch 3, RPR branch 2 and RPS branch 5 respectively by helical theory;
[0049] Among them, the expressions of the motion helical system and constrained anti-helical system of RP branch chain 3 are as follows:
[0050] (1)
[0051] In the formula, and All represent RP branch chain 3 motion helical system, , , , Both represent the constrained antihelix of RP branch 3, express vector coordinates of the center of mass; and Respectively On axis and Direction cosines of direction;
[0052] The expressions of the moving helical system and the constrained antihelical system of RPR branch chain 2 are as follows:
[0053] (2)
[0054] In the formula, , , Both represent the RPR branch chain 2 motion helical system, , , Both represent the constrained antihelix of RPR, and Respectively On axis and Direction cosines of direction, and The vector coordinates representing the mass center of the terminal revolving pair 7;
[0055] The expressions of the moving helical system and the constrained antihelical system of RPS branch chain 5 are as follows:
[0056] (3)
[0057] In the formula, , , , , Both represent the RPS branch chain 5 motion helical system, represents the constrained anti-helix of RPS, They represent the direction cosines of the axis of the moving pair 8, The vector coordinates representing the center of mass of the revolute pair 7;
[0058] S12212. Calculate the degrees of freedom using the modified GK formula:
[0059] (4)
[0060] In the formula, represents the number of degrees of freedom of the RPR-RP parallel mechanism; Indicates the number of components of the RPR-RP parallel mechanism; Represents the number of kinematic pairs of the RPR-RP parallel mechanism; Refers to the first The number of degrees of freedom of each kinematic joint; represents the redundant constraints of the RPR-RP parallel mechanism; represents the local degrees of freedom of the RPR-RP parallel mechanism; represents the order of the RPR-RP parallel mechanism;
[0061] In the RPR-RP parallel mechanism , =5, =5, =1, =3, =3 is substituted into formula (4), and the degree of freedom of the RPR-RP parallel mechanism is obtained to be 2;
[0062] In the 3-RPS parallel mechanism , =8, =9, where the degrees of freedom of the three revolute joints and three prismatic joints are , degrees of freedom of the three ball joints Substituting into formula (4), we can get that the degree of freedom of the 3-RPS parallel mechanism is 3;
[0063] S13. Establish the overall kinematic model of the parallel-series hybrid robot based on kinematic analysis;
[0064] Step S13 specifically includes the following steps:
[0065] S131. Establish coordinate system:
[0066] On the fixed platform 1 and The midpoint of the connecting line establishes the coordinate system , the coordinate origin is ,in, Axis parallel to line , the positive direction is point to , Axis perpendicular to Axis down, The direction of the axis is determined by the right-hand rule;
[0067] On the platform The coordinate system is established at the center of the triangle , the coordinate origin is ,in, Axis parallel to axis, positive direction and The directions of the axes are consistent, and Axis and The axes are in the same plane, Axis perpendicular to Axis direction downward, The direction of the axis is determined by the right-hand rule;
[0068] On the moving platform 6 The coordinate system is established at the center of the triangle , the coordinate origin is ,That Axis parallel to axis, positive direction and The axis direction is consistent, Axis perpendicular to Axis direction downward, The direction of the axis is determined by the right-hand rule;
[0069] S132. Perform kinematic analysis on the parallel-serial hybrid robot to construct an overall kinematic model of the parallel-serial hybrid robot:
[0070] S1321. Kinematic analysis of the RPP-RP parallel mechanism:
[0071] remember for Relative to The rotation matrix of for The origin of the coordinates exist The position vector in the middle platform 4 is around the fixed platform 1. The rotation of the axis and a certain direction in the horizontal plane ( 0), so we choose pitch-roll-yaw Euler angles to represent the rotation, and then we get the position vector and rotation matrix expressions:
[0072] ;
[0073] In the formula, represents the horizontal coordinate of the displacement matrix, represents the ordinate of the displacement matrix, Representation System Around middle The angle of the axis rotation, and , , the rest are similar;
[0074] make exist The position vector is exist The position vector is set and The distance between them is l, the origin and The connection between Draw a circle with radius Located on the drawn circle, the radius of the circle is E, according to the geometric relationship, , The position coordinates are:
[0075] (5)
[0076] Will Coordinates Next, we get:
[0077] (6)
[0078] Therefore, the kinematic model of the RPP-RP parallel mechanism is obtained as follows:
[0079] (7)
[0080] In the formula, represents the length of RP branch 3, represents the length of RPR branch 2;
[0081] Construct a geometric constraint to establish the relationship between variables and set the vector and The angle between i , i As a fixed value, we get:
[0082] (8)
[0083] Thus obtained , , The constraint relationship between them;
[0084] S1322. Kinematic analysis of 3-RPS parallel mechanism:
[0085] The RPS branch chain 5 is regarded as the origin of the coordinate system B of the intermediate platform 4 and first passes through the center of the rotating seat 9 on the intermediate platform 4. , then through the center of electric cylinder 10 , and then passes through the center of the rotating ball 11 on the moving platform 6 , and finally reach the closed-loop motion chain of the coordinate system origin C of the moving platform 6, and record for relatively The rotation matrix of The origin C of the coordinate system is The position vector is ,use and Describe the position and attitude of the moving platform 6 relative to the intermediate platform 4, and select the pitch-roll-yaw Euler angle to represent the rotation, and obtain the position vector and rotation matrix expressions as follows:
[0086] (9)
[0087] In the formula, , , Respectively represent the abscissa, ordinate, and depth coordinate of the displacement matrix; Representation System Winding middle Angle of axis rotation; Representation System Winding middle the angle of rotation of the shaft; and , ;
[0088] remember exist The position vector is exist Middle position vector, set point The radius of the circumscribed circle is R, and the hinge point The radius of the circumscribed circle is r, and the coordinates of each point are obtained according to the geometric relationship as follows:
[0089] (10)
[0090] According to the closed-loop vector method, In the equation, the closed loop vector equations of each branch chain are:
[0091] (11)
[0092] remember The hinge points on the middle platform 4 are The unit vector under the condition of , according to the relationship between the vector from the origin B to each hinge point and the perpendicularity of the rotation axis vector, we get:
[0093] (12)
[0094] By analyzing the geometric constraints of the mechanism, it is found that the vectors of each rotation axis are always perpendicular to the vector of the movement axis, thus obtaining:
[0095] (13)
[0096] Substituting equations (9), (10), and (12) into equation (13), we obtain:
[0097] (14)
[0098] Let the intermediate variable , and substituting q into equation (9) we obtain:
[0099] (15)
[0100] The position of the moving platform 6 relative to the intermediate platform 4 can be obtained by ( , , ) Three independent parameter descriptions realize the kinematic decoupling of the parallel-serial hybrid robot;
[0101] At this time, the kinematic model of the 3-RPS parallel mechanism is obtained by combining equations (10), (11) and (15) as shown below:
[0102] (16)
[0103] S1323. Kinematic analysis of parallel-serial hybrid robots:
[0104] Based on the principle of homogeneous transformation, the overall homogeneous transformation matrix of the moving platform 6 relative to the intermediate platform 4 is obtained: :
[0105] (17)
[0106] Substituting the matrix elements into equation (17) yields the matrix A T C Each block element is used to solve the homogeneous transformation matrix of the moving platform 6 relative to the fixed platform 1 A T C ;
[0107] The position of the moving platform 6 relative to the fixed platform 1 is set to , the homogeneous transformation matrix A T C Establish the position and posture of the moving platform 6 and five independent parameters describing the motion of a parallel-serial hybrid robot ( , , α , β , c ) T The mapping relationship between them is obtained, and the coupling relationship between the RPR-RP parallel mechanism degrees of freedom and the 3-RPS parallel mechanism degrees of freedom is obtained, so the following formula is set:
[0108] (18)
[0109] The kinematic model of the parallel-serial hybrid robot is as follows:
[0110] (19)
[0111] use and c right X B Express it, get X is about ( , , , α , β , c ) is a function of the five independent parameters of the moving platform 6 ( , , α , β , c), solve and obtain the drive of the parallel-serial hybrid robot;
[0112] S14, solving the velocity Jacobian matrix of the RPR-RP parallel mechanism and the 3-RPS parallel mechanism of the kinematic model according to the velocity closed-loop vector equation, and obtaining the overall velocity Jacobian matrix of the parallel-serial hybrid robot;
[0113] Step S14 specifically includes the following steps:
[0114] S141. Define the Jacobian matrix:
[0115] (20)
[0116] In the formula, Indicates the movement of the dynamic platform 6, J represents the Jacobian matrix of the parallel-serial hybrid robot, Represents the driving motion of the parallel-serial hybrid robot;
[0117] S142. Construct the Jacobian matrix of the RPR-RP parallel mechanism:
[0118] According to the kinematic model of the RPR-RP parallel mechanism, the closed loop vectors of each branch of the RPR-RP parallel mechanism are obtained: The equation is:
[0119] (twenty one)
[0120] In the formula, express The unit vector in ;
[0121] Take the time derivative of both sides of equation (21) and multiply them get:
[0122] (twenty two)
[0123] In the formula, Indicates drive A i B i speed, A v B Indicates that the middle platform 4 is relative to Linear speed, A oh B Indicates that the middle platform 4 is relative to The angular velocity of S i express The unit vector in ;
[0124] Since the RPR-RP parallel mechanism has two branches, equation (22) is transformed into:
[0125] (twenty three)
[0126] In the formula, J vB1 For RPR-RP parallel mechanism The 2×6 velocity Jacobian matrix in;
[0127] Simplified 2×6 velocity Jacobian matrix of RPR-RP parallel mechanism:
[0128] The translation speed in the horizontal plane is represented by the speed on the horizontal axis and the speed on the vertical axis respectively. According to the relationship between the angular velocity and the rate of change of the Euler angle, the speed of the intermediate platform 4 in The speed is:
[0129] (twenty four)
[0130] Substituting equation (24) into equation (23) and synthesizing the speed, we have:
[0131] (25)
[0132] S143, Constructing the Jacobian matrix of the 3-RPS parallel mechanism
[0133] According to the kinematic model of the 3-RPS parallel mechanism, the closed loop vectors of each branch chain of the 3-RPS parallel mechanism are obtained: The equation is:
[0134] (26)
[0135] In the formula, n i Representation System The unit vector in ;
[0136] Take the time derivative of equation (26) and multiply it by get:
[0137] (27)
[0138] In the formula, Indicates drive B i C i The speed of B i C i Indicates that the moving platform 6 is relative to Linear speed, B oh C Indicates that the moving platform 6 is relative to Angular velocity;
[0139] Since there are three branches in the 3-RPS parallel mechanism, equation (27) is transformed into:
[0140] (28)
[0141] in:
[0142] (29)
[0143] In the formula, J vC1 In order to obtain the 3-RPS parallel mechanism The 3×6 velocity Jacobian matrix under ;
[0144] Simplify the 3×6 velocity Jacobian matrix of the 3-RPS parallel mechanism, according to the 6 velocity of the moving platform The definitions are:
[0145] (30)
[0146] Where: In the coordinate system The speed of They represent the dynamic platform 6 in the system Middle Winding Angular velocity of the axis, The angular velocity of the axis Linear speed of the axis; , , They represent the moving platform 6 at Next axis, axis Axis speed;
[0147] And among them,
[0148] ;
[0149] ;
[0150] ;
[0151] ;
[0152] And get the dynamic platform 6 in Lower angular velocity for:
[0153] (31)
[0154] In the formula, , , They represent the moving platform 6 at Down axis, axis Angular velocity of the axis;
[0155] set up Indicates the relative position of the moving platform 6 to the system Linear speed, Indicates the relative position of the moving platform 6 to the system The angular velocity of the moving platform 6 is By combining line speed With angular velocity This is described by the following function with three separate parameters:
[0156] (32)
[0157] Formula (32) can be transformed into the following formula:
[0158] (33)
[0159] The velocity and angular velocity of the moving platform 6 can be decomposed into different parts by transformation, where: represents the partial velocity and angular velocity components of the moving platform 6, Indicated in The velocity component in the direction, and Is the dynamic platform 6 in and The angular velocity component in the direction, represents the remaining velocity and angular velocity components of the moving platform 6, and Is the dynamic platform 6 in and The velocity component in the direction, Is the dynamic platform 6 in Angular velocity component in direction;
[0160] use B V C1 Linear Representation B V C2 ,get:
[0161] (34)
[0162] In the formula, Respectively and The transformation matrix of
[0163] So we have:
[0164] (35)
[0165] Substituting formula (35) into formula (29), we obtain:
[0166] (36)
[0167] In the formula, J vC1 J kC1 is the 3×3 velocity Jacobian matrix of the 3-RPS parallel mechanism obtained;
[0168] S144, solve the Jacobian matrices of the RPR-RP parallel mechanism and the 3-RPS parallel mechanism, and move the intermediate platform 4 relative to And dynamic platform 6 relative to The velocity is described by the following six-parameter function:
[0169] (37)
[0170] In the formula, A vector representing the derivative of the motion parameters of the moving platform 6; , They represent the moving platform 6 at Coordinate system , The velocity component in the direction, Indicates that the dynamic platform 6 is Coordinate system The velocity component in the direction; , , The moving platform 6 is , , Angular velocity component of the shaft's rotation.
[0171] Combining equations (23), (29) and (37) we get:
[0172] (38)
[0173] In the formula, Indicates that the moving platform 6 is in the reference system The velocity component in Indicates the RPR-RP parallel mechanism drive branch chain in the coordinate system The speed of Indicates the 3-RPS parallel mechanism drive branch chain in the coordinate system The speed of the next
[0174] Transformed into:
[0175] (39)
[0176] In the formula, v p Indicates the driving speed;
[0177] set up =( , ) T Indicates that the moving platform 6 is relative to The speed of , They represent the moving platform 6 relative to The linear velocity and angular velocity of Considered as function, because:
[0178] (40)
[0179] In the formula, is the Jacobian matrix The first ( i , j ) elements, , represents the relationship between the linear velocity component of the moving platform 6 and the generalized velocity parameter, r ij is the rotation matrix A R C The first ( i , j ) elements, , represents the relationship between the angular velocity component of the moving platform 6 and the generalized velocity parameter; Represents the rate of change of the rotation matrix elements;
[0180] Dynamic platform 6 The speed in is expressed as:
[0181] (41)
[0182] Combining equations (39) and (41) we get:
[0183] (42)
[0184] In the formula, J is the overall velocity Jacobian matrix expression of the parallel-serial hybrid robot;
[0185] In step S15, a rod length constraint and a rotation angle constraint are added;
[0186] The rod length constraints are as follows:
[0187] (43)
[0188] In the formula, The minimum displacement allowed for each branch drive, The maximum displacement allowed for each branch drive joint, Represents the driving displacement variable of each branch chain.
[0189] S15. Solve the workspace of the parallel-series hybrid robot based on the limit boundary search method;
[0190] S16. Use Adams virtual prototype software to perform kinematic simulation on the kinematic model and verify the kinematic model.
[0191] S2, based on the kinematic model established in step S1, a static stiffness model of the parallel-series hybrid robot is established by using a static force transfer matrix analysis method including constraint forces;
[0192] Step S2 specifically includes the following steps:
[0193] S21. Assuming that the fixed platform 1, the intermediate platform 4 and the moving platform 6 are rigid bodies, according to the definition of Hooke's law: establish the relationship between the drive, virtual displacement and stiffness of the RPS branch chain 5, the RP branch chain 3 and the RPR branch chain 2:
[0194] (44)
[0195] In the formula, represents the vector of the driving force of the RPR-RP parallel mechanism, and , They represent the driving forces on RP branch 3 and RPR branch 2, respectively; represents the vector of the driving force of the 3-RPS parallel mechanism, and F C =( F 3l F 4l F 5l F 3x F 4x F 5x ), F 3l , F 4l , F5l They represent the driving forces of the three RPS branches 5 respectively; F 3x , F 4x, F 5x They represent the constraints existing in the three RPS branches 5; ΔL B represents the total virtual displacement produced by RP branch 3 and RPR branch 2, and ΔL B =( Δl 1 Δl 2 ) T , Δl 1 , Δl 2 They represent the virtual displacements produced by RP branch 3 and RPR branch 2, respectively; ΔL C represents the virtual displacement of the three RPS branches 5, and ΔL C =( Δl 3 Δl 4 Δl 5 Δl 3x Δl 4x Δl 5x ) T , Δl 3, Δl 4 , Δl 5 They represent the three virtual displacements generated by the three RPS branches 5, Δl 3x , Δl 4x, Δl 5x They represent the deformation of three RPS branches 5 under the driving force; K B represents the rigidity matrix of RP branch 3 and RPR branch 2, and K B = diagnosis [ K h1 K h2 ], K h1, K h2They represent the axial stiffness of RP branch 3 and RPR branch 2, respectively; K C represents the rigidity matrix of the three RPS branches 5, and K C = diagnosis [ K h3 K h4 K h5 K h3x K h4x K h5x ], K h3 , K h4 , K h5 Respectively represent the axial stiffness of the three RPS branches 5, K h3x , K h4x , K h5x They represent the lateral stiffness of the three RPS branches 5 under the restraint force;
[0196] S22. Use the velocity constraint equation and the principle of virtual work to establish the full stiffness model of the parallel-series hybrid robot:
[0197] S221. Construct the stiffness matrix of the RPR-RP parallel mechanism :
[0198] (45)
[0199] In the formula, J vB1 J kB1 Represents the Jacobian matrix of the RPR-RP parallel mechanism; ( J vB1 J kB1 ) T represents the static force transfer matrix of the RPR-RP parallel mechanism;
[0200] S221. Construct the stiffness matrix of the 3-RPS parallel mechanism :
[0201] (46)
[0202] In the formula, J R1 The Jacobian matrix representing the conversion of angular velocity into generalized velocity; J vC1Indicates 3-RPS parallel mechanism velocity Jacobian matrix;
[0203] S222, construct the overall stiffness matrix of the parallel-series hybrid robot K :
[0204] (47)
[0205] In the formula, A F C Indicates the external force borne by the moving platform 6; K h represents the stiffness matrix of each branch of the parallel-series hybrid robot, and K h = diagnosis [ K h1 K h2 K h3 K h4 K h5 K h3x K h4x K h5x ]; D A x C Indicates that the moving platform 6 is relative to The virtual displacement generated is D A x C =( Dl C Δz C Dth Cx Dth Cy Dth Cz ) T , Dl C It represents the virtual displacement caused by the movement of the moving platform 6 in the horizontal plane, Δz C It represents the virtual displacement caused by the moving platform 6 moving along the Z direction, Dth Cx 、Dth Cy 、Dth Cz Respectively represent the moving platform 6 around , , The rotation angle of the axis;
[0206] S23. The variation law of the stiffness in each degree of freedom direction in the set working space is obtained through Matlab simulation:
[0207] Solving the overall stiffness matrix of the serial-hybrid robot K The axial and lateral stiffness of RPS branch 5, RP branch 3 and RPR branch 2 are obtained:
[0208] (48)
[0209] In the formula, represents the axial stiffness of RPS branch 5, RP branch 3, and RPR branch 2; represents the lateral stiffness of RPS branch 5, RP branch 3, and RPR branch 2; E i represents the elastic modulus of the material of RPS branch 5, RP branch 3 and RPR branch 2, S i represents the cross-sectional area of RPS branch 5, RP branch 3 and RPR branch 2, l i represents the length of RPS branch 5, RP branch 3 and RPR branch 2, I i represents the section moment of inertia of RPS branch 5, RP branch 3, and RPR branch 2;
[0210] In step S23, the driving rods of the RP chain 3 and the RPR chain 2 are set. d i =32mm (i=1,2), the length of RP branch 3 and RPR branch 2 is l i =800mm( i =1,2), driving rod of RPS branch chain 5 d i =14mm( i =3,4,5), the length of RPS branch 5 is l i =220mm( i =3,4,5), section moment of inertia I =Πd 4 / 64, and its elastic modulus is taken as the parameter E=200Gpa of aluminum alloy 7075; in order to solve the variation law of the directional stiffness of each degree of freedom of the parallel-serial hybrid robot in the set working space.
[0211] S24. Use finite element software to simulate and obtain the stress and deformation cloud diagrams of the moving platform 6 under radial, lateral and axial loads, and obtain the overall stiffness of the structure under the set conditions.
[0212] like Figure 7 and Figure 8 As shown in the figure, the simulation results of the displacement changes of each driving rod of the parallel-serial hybrid robot are basically consistent with the variation range and trend of the curve graph of the theoretical model solution result. Although there is a certain error in the displacement of the driver at the same time, this is because the application position of the simulation constraint and the theoretical position cannot be completely consistent. From the results, the error is small and has a certain accuracy, which verifies the rationality of the design and the correctness of the kinematic model establishment, and provides a theoretical basis for the subsequent evaluation of the static stiffness and dynamic performance of the hybrid robot.
[0213] S3. Construct the dynamic model of the parallel-series hybrid robot by Lagrange equation method;
[0214] Step S3 specifically includes the following steps:
[0215] S31. Use the vector method to analyze the linear velocity and angular velocity of each branch of the parallel-series hybrid robot;
[0216] Among them, the angular velocity expression of each branch of the series-hybrid robot is as follows:
[0217] (49)
[0218] In the formula, A oh i Indicates branch chain L i exist The angular velocity of A oh j Indicates branch chain L j exist Angular velocity under s i ( i =1,2) indicates that the axial unit vector of each branch of the RPR-RP parallel mechanism is The following expression; A oh B Indicates that the dynamic platform 6 is Angular velocity under
[0219] The linear speed of each branch chain is The following expression is:
[0220] (50)
[0221] In the formula, L i ( i=1,2) represents RP branch 3 and RPR branch 2 of the RPR-RP parallel mechanism; L j ( j =3,4,5) represents the three RPS branches 5 of the 3-RPS parallel mechanism; Representing the reference frame Relative to the reference frame The rotation matrix of represents the length of the three RPS branches 5 of the 3-RPS parallel mechanism; Indicates branch chain In the reference frame The position vector of the next
[0222] S32. Construct the dynamic model of the parallel-series hybrid robot based on the Lagrange equation:
[0223] (51)
[0224] in,
[0225] (52)
[0226] In the formula, Q It represents the generalized force borne by the parallel-series hybrid robot; t represents the driving force of the parallel-series hybrid robot, F r represents the external disturbance force, and F r =[f r n r ] T ; ψ represents the generalized coordinates of the parallel-serial hybrid robot; represents the mass matrix of each branch of the RPR-RP parallel mechanism; Represents the mass matrix of each branch of the 3-RPS parallel mechanism; represents the gravity term of the RPR-RP parallel mechanism; represents the gravity term of the 3-RPS parallel mechanism; represents the mass matrix of the RPR-RP parallel mechanism; represents the mass matrix of the 3-RPS parallel mechanism; C B represents the Coriolis force; C C represents the coefficient moment of the centrifugal force term; J T t display The center of mass of the moving platform 6; represents the overall mass matrix; represents the overall gravity matrix; represents the Coriolis force matrix; represents the generalized acceleration vector;
[0227] S33. Use Adams to perform dynamic simulation to obtain the driving force and power consumption variation rules of the parallel-series hybrid robot when the moving platform 6 is unloaded, subjected to vertical load, and subjected to horizontal load.
[0228] S4. Construct the error model of parallel-series hybrid robot based on differential method.
[0229] like Figure 9-Figure 12 As shown, the following curves of the driving force changes of each branch under the condition that the moving platform 6 is not subjected to external load are relatively regular: (1) In most cases during the movement process, the driving force of the RPR-RP parallel mechanism is smaller than that of the 3-RPS parallel mechanism, while the power consumption is opposite; (2) The driving force and power consumption changes of the RPR-RP parallel mechanism are larger than those of the 3-RPS parallel mechanism; (3) The changing rules of the two driving force curves of the RPR-RP parallel mechanism are similar, but not completely symmetrical and in opposite directions.
[0230] like Figure 13-Figure 16 As shown in the figure, the driving force and power consumption of each branch of the RPR-RP parallel mechanism when the moving platform 6 is subjected to a 50N vertical load and when there is no load are consistent and equal in magnitude, while the driving force and power consumption of each branch of the 3-RPS parallel mechanism are much greater than those when there is no load. The reason is that the RPR-RP parallel mechanism moves in a horizontal plane, while the moving platform 6 is subjected to a vertical upward force. Therefore, whether the moving platform 6 is subjected to force or not has little effect on the driving force and power consumption of the RPR-RP parallel mechanism. The 3-RPS parallel mechanism can move along the Z0 axis and be subjected to a force along the Z0 axis at the same time. Therefore, compared with the case of only gravity, its driving force and power consumption will change greatly, and the dynamic characteristics will change to a certain extent due to the force, which will cause the curve change trend to be inconsistent with the case of only gravity. In summary, the driving force and power consumption curves of the mechanism change smoothly under the given motion trajectory conditions, indicating that the mechanism moves stably. According to the simulation results, it is helpful to evaluate the force and power consumption required for each drive and the structural optimization design.
[0231] Step S4 specifically includes the following steps:
[0232] S41. Construct the error model of RPR-RP parallel mechanism based on differential method:
[0233] (53)
[0234] In the formula, δp represents the posture error vector of the intermediate platform 4, and δp =[ δxδyδγ ] T , δxδyδγ Respectively represent the middle platform 4 along , , Directional pose error component; δL represents the rod length error vector of the driving rod of the RPR-RP parallel mechanism, and δL =[ δL 1 δL 2 δL 3 ] T , represents the RPR branch chain 2-rod length error vector, represents the RP branch chain 3-bar length error vector, represents the virtual rod length error vector; δr represents the position error of the center and connection point of the RPR-RP parallel mechanism revolute pair 7, and δr =[ δb 1 da 1 δb 2 da 2 δb 1 da 2 ] T , represents the position error of the connection point on RPR branch 2, represents the position error of the connection point on RP branch 3, and It represents the centers of the two revolute pairs 7 in the branch chain of the RPR-RP parallel mechanism; Jh 1 represents the driving rod direction vector matrix of the RPR-RP parallel mechanism; Yes 1 represents the error transfer matrix;
[0235] S42. Construct the error model of 3-RPS parallel mechanism based on differential method:
[0236] (54)
[0237] in,
[0238] ;
[0239] ;
[0240] In the formula, represents the position and angle error of the intermediate platform 4, represents the position error, represents the angle error, represents the error vector of the branch chain, Indicates The error of the branch chain, represents the submatrix of the Jacobian matrix of the parallel mechanism, and is a unit vector, indicating the direction of the branch chain, is the rotation matrix, is the transformation matrix. represents a submatrix of the error transfer matrix, represents the drive rod error of the branch chain, Indicates the rotation pair 7 error of the branch chain, Indicates other errors of the branch chain;
[0241] S43. Based on the error model of the RPR-RP parallel mechanism and the error model of the 3-RPS parallel mechanism, the overall error model of the parallel-serial hybrid robot is obtained.
[0242] The application of the five-degree-of-freedom parallel-serial hybrid robot in free-form surface processing based on electrically assisted photocatalytic nanoparticle colloid jet polishing.
[0243] Therefore, the present invention adopts the above-mentioned five-degree-of-freedom parallel-serial hybrid robot, design method and application, and adopts a structure of first parallel connection and then series connection, which has the advantages of small overall size, excellent stiffness performance and wide working space.
[0244] Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, those skilled in the art should understand that they can still modify or replace the technical solution of the present invention with equivalents, and these modifications or equivalent replacements cannot cause the modified technical solution to deviate from the spirit and scope of the technical solution of the present invention.
Claims
1. A five-degree-of-freedom parallel-serial hybrid robot, characterized in that: It includes a fixed platform and a RPR-RP parallel mechanism and a 3-RPS parallel mechanism connected in series, the RPR-RP parallel mechanism is arranged on the fixed platform, and a power output end of the RPR-RP parallel mechanism is connected to the 3-RPS parallel mechanism; The 3-RPS parallel mechanism includes an intermediate platform, a moving platform, and a plurality of RPS branches that are evenly rotated in a circular array and arranged between the intermediate platform and the moving platform; The RPR-RP parallel mechanism includes an RP branch and an RPR branch symmetrically arranged about a fixed platform, and both the RP branch and the RPR branch include a rotating pair connected to the fixed platform for vertical rotation, and a moving pair connected to the power output end of the rotating pair and extending toward the 3-RPS parallel mechanism, the power output end of the moving pair of the RPR branch is connected to the intermediate platform for vertical rotation, and the power output end of the moving pair of the RP branch is fixedly connected to the intermediate platform; The rotating pair is a square bearing with one end connected to the fixed platform for vertical rotation, and the moving pair is a telescopic motor connected to the other end of the square bearing for vertical rotation; The output shaft of the telescopic motor of the RP branch chain is fixedly connected to the intermediate platform via a flange connection shaft, and the output shaft of the telescopic motor of the RPR branch chain is vertically rotatably connected to the intermediate platform via a rolling bearing. The connection between the RP branch chain and the intermediate platform and the connection between the RPR branch chain and the intermediate platform are symmetrically arranged about the connection between the center of the intermediate platform and the horizontal center of the fixed platform; The RPS branch chain includes an electric cylinder, the cylinder body of the electric cylinder is rotatably connected to the bottom end of the intermediate platform via a rotating seat, and the telescopic rod of the electric cylinder is rotatably connected to the top end of the moving platform via a rotating ball; The design method of a five-degree-of-freedom parallel-serial hybrid robot includes the following steps: S1. Perform kinematic analysis on the parallel-serial hybrid robot and establish a kinematic model; Step S1 specifically includes the following steps: S11. Construct a three-dimensional model of a parallel-series hybrid robot based on three-dimensional modeling software; S12. Solve the degrees of freedom of the three-dimensional model of the parallel-series hybrid robot based on the screw theory, and complete the kinematic analysis using the closed-loop vector theory; Step S12 specifically includes the following steps: S121, initial state setting: Initialize the RPR-RP parallel mechanism: Set the straight line where the revolving pair of the RPR branch chain is located as , the straight line where the moving pair of the RPR branch chain is located is , the rotation connection point between the RPR branch chain and the middle platform is ; The straight line where the revolving pair of the RP branch chain is located is , the straight line where the moving pair of the RP branch chain is located is , the fixed connection point between the RP branch chain and the middle platform is ; The origin of the coordinates is on the fixed platform Center and The midpoint of the center connecting line, The axis is On the connecting line of Center of mass direction Centroid, The axis is perpendicular to the base plane and downward. The axis is determined by the right-hand rule; Initialize the 3-RPS parallel mechanism: The 3-RPS parallel mechanism is assumed to have three RPS branches, and the origin of the RPS branches is the center of the rotating seat. The shaft extends along the axis of the rotating seat, The axis is determined by the right-hand rule, The axis is perpendicular to the base surface, and the lines where the electric cylinders of the three RPS branches are located are , , The positions of the rotating seats of the three RPS branches are , , The rotation positions of the three RPS branches are , , ; S122. Calculate the degrees of freedom of the RPR-RP parallel mechanism and the 3-RPS parallel mechanism respectively: S1221. Determine the motion helical system and constrained anti-helix of the RP branch, RPR branch and RPS branch respectively by means of helical theory; The expressions of the motion helical system and constrained anti-helical system of the RP branch chain are as follows: (1) In the formula, and Both represent the moving helical system of the RP branch chain. , , , Both represent the constrained antihelix of the RP side chain. express vector coordinates of the center of mass; and Respectively On axis and Direction cosines of direction; The expressions of the motion helical system and constrained anti-helical system of the RPR branch chain are as follows: (2) In the formula, , , Both represent the RPR branch chain motion helical system, , , Both represent the constrained antihelix of RPR, and Respectively On axis and Direction cosines of direction, and Represents the center of mass vector coordinates of the revolute pair formed by the magnetic rod of the RPR branch chain and the intermediate platform; The expressions of the motion helical system and constrained anti-helical system of the RPS branch chain are as follows: (3) In the formula, , , , , Both represent the RPS branch chain motion spiral system, represents the constrained anti-helix of RPS, They represent the direction cosines of the moving secondary axis, The vector coordinates representing the rotating secondary mass center; S12212. Calculate the degrees of freedom using the modified GK formula: (4) In the formula, represents the number of degrees of freedom of the RPR-RP parallel mechanism; Indicates the number of components of the RPR-RP parallel mechanism; Represents the number of kinematic pairs of the RPR-RP parallel mechanism; Refers to the first The number of degrees of freedom of each kinematic joint; represents the redundant constraints of the RPR-RP parallel mechanism; represents the local degrees of freedom of the RPR-RP parallel mechanism; represents the order of the RPR-RP parallel mechanism; In the RPR-RP parallel mechanism , =5, =5, =1, =3, =3 is substituted into formula (4), and the degree of freedom of the RPR-RP parallel mechanism is obtained to be 2; In the 3-RPS parallel mechanism , =8, =9, where the degrees of freedom of the three revolute joints and three prismatic joints are , degrees of freedom of the three ball joints , =0, =0 is substituted into formula (4), and the degree of freedom of the 3-RPS parallel mechanism is obtained to be 3; Step S13 specifically includes the following steps: S131. Establish coordinate system: On a specific platform and The midpoint of the connecting line establishes the coordinate system , the coordinate origin is ,in, Axis parallel to line , the positive direction is point to , Axis perpendicular to Axis down, The direction of the axis is determined by the right-hand rule; On the platform The coordinate system is established at the center of the triangle , the coordinate origin is ,in, Axis parallel to axis, positive direction and The directions of the axes are consistent, and Axis and The axes are in the same plane, Axis perpendicular to Axis direction downward, The direction of the axis is determined by the right-hand rule; On moving platform The coordinate system is established at the center of the triangle , the coordinate origin is ,That Axis parallel to axis, positive direction and The axis direction is consistent, Axis perpendicular to Axis direction downward, The direction of the axis is determined by the right-hand rule; S132. Perform kinematic analysis on the parallel-serial hybrid robot to construct an overall kinematic model of the parallel-serial hybrid robot: S1321. Kinematic analysis of the RPP-RP parallel mechanism: remember for Relative to The rotation matrix of for The origin of the coordinates exist The position vector inside the intermediate platform is The rotation of the axis and a certain direction in the horizontal plane ( 0), so we choose pitch-roll-yaw Euler angles to represent the rotation, and then we get the position vector and rotation matrix expressions: ; In the formula, represents the horizontal coordinate of the displacement matrix, represents the ordinate of the displacement matrix, Representation System Around middle The angle of the axis rotation, and , , the rest are similar; make Indicate point exist The position vector is For point exist The position vector is set and The distance between them is l, with the origin is the center of the circle, the origin Rotating connection point with RPR branch chain and intermediate platform The connection between Draw a circle with radius Located on the drawn circle, the radius of the circle is E, according to the geometric relationship, , The position coordinates are: (5) Will Coordinates Convert in system Next, we get: (6) Therefore, the kinematic model of the RPP-RP parallel mechanism is obtained as follows: (7) In the formula, Indicates the length of the RP branch, represents the length of the PRP branch chain; Construct a geometric constraint to establish the relationship between variables and set the vector and The angle between them is θ, θ is a fixed value, and we get: (8) Thus obtained , , The constraint relationship between them; S1322. Kinematic analysis of 3-RPS parallel mechanism: The RPS branch chain is regarded as the starting point of the coordinate system origin B of the middle platform, which first passes through the center of the rotating seat on the middle platform. , then through the center of the electric cylinder , and then passes through the center of the rotating ball on the moving platform , and finally reach the closed-loop motion chain of the coordinate system origin C of the moving platform, and record for relatively The rotation matrix of The origin C of the coordinate system is The position vector is ,use and Describe the position and attitude of the moving platform relative to the intermediate platform, and select the pitch-roll-yaw Euler angle to represent the rotation, and get the position vector and rotation matrix expressions as follows: (9) In the formula, , , Respectively represent the abscissa, ordinate, and depth coordinate of the displacement matrix; Representation System Winding middle Angle of axis rotation; Representation System Winding middle the angle of rotation of the shaft; and , ; remember For point exist The position vector is For point exist Middle position vector, set point The radius of the circumscribed circle is R, and the hinge point The radius of the circumscribed circle is r, and the coordinates of each point are obtained according to the geometric relationship as follows: (10) According to the closed-loop vector method, In the equation, the closed loop vector equations of each branch chain are: (11) remember The hinge points on the middle platform are The unit vector under the condition of , according to the relationship between the vector from the origin B to each hinge point and the perpendicularity of the rotation axis vector, we get: (12) By analyzing the geometric constraints of the mechanism, it is found that the vectors of each rotation axis are always perpendicular to the vector of the movement axis, thus obtaining: (13) Substituting equations (9), (10), and (12) into equation (13), we obtain: (14) Let the intermediate variable , and substituting q into equation (9) we obtain: (15) The position of the moving platform relative to the middle platform can be obtained by ( , , ) Three independent parameter descriptions realize the kinematic decoupling of the parallel-serial hybrid robot; At this time, the kinematic model of the 3-RPS parallel mechanism is obtained by combining equations (10), (11) and (15) as shown below: (16) S1323. Kinematic analysis of parallel-serial hybrid robots: Based on the principle of homogeneous transformation, the overall homogeneous transformation matrix of the moving platform relative to the intermediate platform is obtained : (17) Substitute the matrix elements into equation (17) to obtain the block elements of the matrix ATC, and solve the homogeneous transformation matrix ATC of the moving platform relative to the fixed platform; Set the position of the moving platform relative to the fixed platform as ( , ,α1,β1,γ1)T, the homogeneous transformation matrix ATC establishes the posture of the moving platform ( , ,α2,β2,γ2)T and five independent parameters describing the motion of parallel-series hybrid robots ( , ,α,β,γ)T, the coupling relationship between the RPR-RP parallel mechanism degrees of freedom and the 3-RPS parallel mechanism degrees of freedom is obtained, so the following formula is set: (18) The kinematic model of the parallel-serial hybrid robot is as follows: (19) use and γ to represent XB, we get X is about ( , , ,α,β,γ) function, using the five independent parameters of the dynamic platform ( , ,α,β,γ), and solve to obtain the drive of the parallel-serial hybrid robot; Step S14 specifically includes the following steps: S141. Define the Jacobian matrix: (20) In the formula, represents the motion of the moving platform, J represents the Jacobian matrix of the parallel-series hybrid robot, Represents the driving motion of the parallel-serial hybrid robot; S142. Construct the Jacobian matrix of the RPR-RP parallel mechanism: According to the kinematic model of the RPR-RP parallel mechanism, the closed loop vectors of each branch of the RPR-RP parallel mechanism are obtained: The equation is: (21) In the formula, express The unit vector in ; Take the time derivative of both sides of equation (21) and multiply them get: (22) In the formula, Indicates the speed of driving AiBi, AvB indicates the relative speed of the intermediate platform The linear velocity of the intermediate platform relative to 0 angular velocity, Si represents The unit vector in ; Since the RPR-RP parallel mechanism has two branches, equation (22) is transformed into: (23) Where, JvB1 is the RPR-RP parallel mechanism The 2×6 velocity Jacobian matrix in; Simplified 2×6 velocity Jacobian matrix of RPR-RP parallel mechanism: The translation speed in the horizontal plane is represented by the speed on the horizontal axis and the speed on the vertical axis respectively. According to the relationship between the angular velocity and the rate of change of the Euler angle, the speed of the intermediate platform can be obtained. The speed is: (24) Substituting equation (24) into equation (23) and synthesizing the speed, we have: (25) S143, Constructing the Jacobian matrix of the 3-RPS parallel mechanism According to the kinematic model of the 3-RPS parallel mechanism, the closed loop vectors of each branch chain of the 3-RPS parallel mechanism are obtained: The equation is: (26) In the formula, ni represents the coefficient The unit vector in ; Take the time derivative of equation (26) and multiply it by get: (27) In the formula, Indicates the speed of driving BiCi, BiCi indicates the relative speed of the moving platform The linear velocity of the moving platform relative to Angular velocity; Since there are three branches in the 3-RPS parallel mechanism, equation (27) is transformed into: (28) in: (29) In the formula, JvC1 is the obtained 3-RPS parallel mechanism The 3×6 velocity Jacobian matrix under ; Simplify the 3×6 velocity Jacobian matrix of the 3-RPS parallel mechanism, according to the moving platform velocity The definitions are: (30) Where: Indicates the coordinate system of the moving platform The speed of They represent the dynamic platform in the system Middle Winding Angular velocity of the axis, The angular velocity of the axis Linear speed of the axis; Respectively represent the dynamic platform Next axis, axis Axis speed; And among them, ; ; ; ; And get the dynamic platform in Lower angular velocity for: (31) In the formula, Respectively represent the dynamic platform Down axis, axis Angular velocity of the axis; set up Indicates the dynamic platform relative to the system Linear speed, Indicates the dynamic platform relative to the system The angular velocity of the moving platform By combining line speed With angular velocity This is described by the following function with three separate parameters: (32) Formula (32) can be transformed into the following formula: (33) The velocity and angular velocity of the moving platform can be decomposed into different parts through transformation, where: represents the partial velocity and angular velocity components of the moving platform, Indicated in The velocity component in the direction, and Is the dynamic platform in and The angular velocity component in the direction, represents the remaining velocity and angular velocity components of the moving platform, and Is the dynamic platform in and The velocity component in the direction, Is the dynamic platform in Angular velocity component in direction; Using BVC1 to linearly represent BVC2, we get: (34) In the formula, Respectively and The transformation matrix of So we have: (35) Substituting formula (35) into formula (29), we obtain: (36) Where JvC1JkC1 is the obtained 3×3 velocity Jacobian matrix of the 3-RPS parallel mechanism; S144, solve the Jacobian matrices of the RPR-RP parallel mechanism and the 3-RPS parallel mechanism, and move the intermediate platform relative to And the dynamic platform relative to The velocity is described by the following six-parameter function: (37) In the formula, The vector representing the derivatives of the motion parameters of the moving platform; , Respectively represent the dynamic platform Coordinate system , The velocity component in the direction, Indicates that the platform is Coordinate system The velocity component in the direction; , , The moving platform is , , Angular velocity component of shaft rotation; Combining equations (23), (29) and (37) we get: (38) In the formula, Indicates the moving platform in the reference system The velocity component in Indicates the RPR-RP parallel mechanism drive branch chain in the coordinate system The speed of Indicates the 3-RPS parallel mechanism drive branch chain in the coordinate system The speed of the next Transformed into: (39) Where, vp represents the driving speed; set up =( , )T represents the moving platform relative to The speed of , They represent the moving platform relative to The linear velocity and angular velocity of Considered as function, because: (40) In the formula, is the Jacobian matrix The (i,j)th element in , represents the relationship between the linear velocity component of the moving platform and the generalized velocity parameter, rij is the (i, j)th element in the rotation matrix ARC, , represents the relationship between the angular velocity component of the moving platform and the generalized velocity parameter; Represents the rate of change of the rotation matrix elements; Dynamic platform The speed in is expressed as: (41) Combining equations (39) and (41) we get: (42) Where, J is the overall velocity Jacobian matrix expression of the parallel-serial hybrid robot; In step S15, a rod length constraint and a rotation angle constraint are added; The rod length constraints are as follows: (43) In the formula, The minimum displacement allowed for each branch drive, The maximum displacement allowed for each branch drive joint, represents the driving displacement variable of each branch chain; S13. Establish the overall kinematic model of the parallel-series hybrid robot based on kinematic analysis; S14, solving the velocity Jacobian matrix of the RPR-RP parallel mechanism and the 3-RPS parallel mechanism of the kinematic model according to the velocity closed-loop vector equation, and obtaining the overall velocity Jacobian matrix of the parallel-serial hybrid robot; S15. Solve the workspace of the parallel-series hybrid robot based on the limit boundary search method; S16. Perform kinematic simulation on the kinematic model using Adams virtual prototype software to verify the kinematic model; S2, based on the kinematic model established in step S1, a static stiffness model of the parallel-series hybrid robot is established by using a static force transfer matrix analysis method including constraint forces; S3. Construct the dynamic model of the parallel-series hybrid robot by Lagrange equation method; S4. Construct the error model of parallel-series hybrid robot based on differential method.
2. A five-degree-of-freedom parallel-serial hybrid robot according to claim 1, characterized in that: Step S2 specifically includes the following steps: S21. Set the fixed platform, the intermediate platform and the moving platform as rigid bodies. According to the definition of Hooke's law, establish the relationship between the drive, virtual displacement and stiffness of the RPS branch chain, the RP branch chain and the RPR branch chain: (44) In the formula, represents the vector of the driving force of the RPR-RP parallel mechanism, and , They represent the driving forces on the RP branch and the RPR branch respectively; represents the vector composed of the driving force of the 3-RPS parallel mechanism, and FC=(F3l F4l F5l F3x F4x F5x)T,F3l ,F4l ,F5l represent the driving forces of the three RPS branches respectively; F3x ,F4x ,F5x represent the constraints of the three RPS branches respectively; ΔLB represents the total virtual displacement generated by the RP branch and the RPR branch, and ΔLB=(Δl1 Δl2)T,Δl1 ,Δl2 represent the virtual displacements generated by the RP branch and the RPR branch respectively; ΔLC represents the virtual displacement generated by the three RPS branches, and ΔLC=(Δl3 Δl4 Δl5 Δl3x Δl4x Δl5x)T,Δl3,Δl4 ,Δl5 represent the three virtual displacements generated by the three RPS branches respectively, Δl3x ,Δl4x, Δl5x represents the deformation of the three RPS branches under the driving force; KB represents the rigidity matrix of the RP branch and the RPR branch, and KB=diag[Kh1Kh2], Kh1, Kh2 represent the axial stiffness of the RP branch and the RPR branch, respectively; KC represents the rigidity matrix of the three RPS branches, and KC=diag[Kh3 Kh4 Kh5 Kh3x Kh4x Kh5x], Kh3, Kh4, Kh5 represent the axial stiffness of the three RPS branches, Kh3x, Kh4x, Kh5x represent the lateral stiffness of the three RPS branches under the constraint force, respectively; S22. Use the velocity constraint equation and the principle of virtual work to establish the full stiffness model of the parallel-series hybrid robot: S221. Construct the stiffness matrix of the RPR-RP parallel mechanism : (45) Where JvB1JkB1 represents the Jacobian matrix of the RPR-RP parallel mechanism; (JvB1JkB1)T represents the static force transfer matrix of the RPR-RP parallel mechanism S221. Construct the stiffness matrix of the 3-RPS parallel mechanism : (46) Where JR1 represents the Jacobian matrix of angular velocity converted into generalized velocity; JvC1 represents the 3-RPS parallel mechanism velocity Jacobian matrix; S222. Construct the overall stiffness matrix K of the parallel-serial hybrid robot: (47) Where AFC represents the external force on the moving platform; Kh represents the stiffness matrix of each branch of the parallel-series hybrid robot, and Kh=diag[Kh1 Kh2 Kh3 Kh4 Kh5 Kh3x Kh4x Kh5x]; ΔAxC represents the relative stiffness of the moving platform to The virtual displacement generated is: ΔAxC = (ΔλC ΔzC ΔθCx ΔθCy ΔθCz) T, ΔλC represents the virtual displacement generated by the moving platform moving in the horizontal plane, ΔzC represents the virtual displacement generated by the moving platform moving along the Z direction, ΔθCx, ΔθCy, and ΔθCz represent the virtual displacement generated by the moving platform moving around the horizontal plane, respectively. , , The rotation angle of the axis; S23. The variation law of the stiffness in each degree of freedom direction in the set working space is obtained through Matlab simulation: Solving the overall stiffness matrix K of the serial-hybrid robot, we can obtain the axial and lateral stiffness of the RPS branch, RP branch, and RPR branch: (48) In the formula, represents the axial stiffness of the RPS branch, RP branch, and RPR branch; represents the lateral stiffness of the RPS branch, RP branch and RPR branch; Ei represents the elastic modulus of the material of the RPS branch, RP branch and RPR branch, Si represents the cross-sectional area of the RPS branch, RP branch and RPR branch, li represents the length of the RPS branch, RP branch and RPR branch, and Ii represents the section inertia moment of the RPS branch, RP branch and RPR branch; S24. Use finite element software to simulate the stress and deformation cloud diagrams of the moving platform under radial, lateral and axial loads, and obtain the overall stiffness of the structure under the set conditions.
3. A five-degree-of-freedom parallel-serial hybrid robot according to claim 2, characterized in that: In step S23, the driving rod di=32mm (i=1,2) of the RP branch and the RPR branch is set, the length of the RP branch and the RPR branch is li=800mm (i=1,2), the driving rod di=14mm (i=3,4,5), the length of the RPS branch is li=220mm (i=3,4,5), the section inertia moment I=Πd4 / 64, and its elastic modulus is the parameter E=200Gpa of aluminum alloy 7075; in order to solve the change law of the directional stiffness of each degree of freedom of the parallel-serial hybrid robot in the set workspace.
4. A five-degree-of-freedom parallel-serial hybrid robot according to claim 3, characterized in that: Step S3 specifically The following steps are involved: S31. Use the vector method to analyze the linear velocity and angular velocity of each branch of the parallel-series hybrid robot; Among them, the angular velocity expression of each branch of the series-hybrid robot is as follows: (49) In the formula, Aωi represents the branched chain Li Aωj represents the angular velocity of the branch chain Lj under angular velocity under the condition of si (i=1,2) represents the axial unit vector of each branch of the RPR-RP parallel mechanism. AωB represents the moving platform under Angular velocity under The linear speed of each branch chain is The following expression is: (50) Where Li (i=1,2) represents the RP branch and RPR branch of the RPR-RP parallel mechanism; Lj (j=3,4,5) represents the three RPS branches of the 3-RPS parallel mechanism; Representing the reference frame Relative to the reference frame The rotation matrix of Represents the length of the three RPS branches of the 3-RPS parallel mechanism; Indicates branch chain In the reference frame The position vector of the next S32. Construct the dynamic model of the parallel-series hybrid robot based on the Lagrange equation: (51) in, (52) Where, Q represents the generalized force borne by the parallel-serial hybrid robot; τ represents the driving force of the parallel-serial hybrid robot, Fr represents the external interference force, and Fr=[fr nr]T; ψ represents the generalized coordinates of the parallel-serial hybrid robot; represents the mass matrix of each branch of the RPR-RP parallel mechanism; Represents the mass matrix of each branch of the 3-RPS parallel mechanism; represents the gravity term of the RPR-RP parallel mechanism; represents the gravity term of the 3-RPS parallel mechanism; represents the mass matrix of the RPR-RP parallel mechanism; represents the mass matrix of the 3-RPS parallel mechanism; CB represents the Coriolis force; CC represents the coefficient moment of the centrifugal force term; JTτ represents the center of mass of the moving platform; represents the overall mass matrix; represents the overall gravity matrix; represents the Coriolis force matrix; represents the generalized acceleration vector; S33. Use Adams to perform dynamic simulation and obtain the driving force and power consumption variation of the parallel-series hybrid robot when the moving platform is unloaded, subjected to vertical load, and subjected to horizontal load.
5. A five-degree-of-freedom parallel-serial hybrid robot according to claim 4, characterized in that: Step S4 specifically includes the following steps: S41. Construct the error model of RPR-RP parallel mechanism based on differential method: (53) Where δp represents the posture error vector of the intermediate platform, and δp=[δx δy δγ]T, δx δy δγ represent the position error vector of the intermediate platform along the , , Directional pose error component; represents the rod length error vector of the driving rod of the RPR-RP parallel mechanism, and , represents the RPR branch rod length error vector, represents the RP branch rod length error vector, represents the virtual rod length error vector; represents the position error of the rotation sub-center and connection point of the RPR-RP parallel mechanism, and , Represents the position error of the connection point on the RPR branch, Indicates the position error of the connection point on the RP branch, and represents the center of the two revolute pairs in the branch chain of the RPR-RP parallel mechanism; Jh1 represents the driving rod direction vector matrix of the RPR-RP parallel mechanism; Je1 represents the error transfer matrix; S42. Construct the error model of 3-RPS parallel mechanism based on differential method: (54) in, ; ; In the formula, Represents the posture error of the intermediate platform in position and angle, represents the position error, represents the angle error, represents the error vector of the branch chain, Indicates The error of the branch chain, represents the submatrix of the Jacobian matrix of the parallel mechanism, and is a unit vector, indicating the direction of the branch chain, is the rotation matrix, is the transformation matrix; represents a submatrix of the error transfer matrix, represents the drive rod error of the branch chain, represents the rotational pair error of the branch chain, Indicates other errors of the branch chain; S43. Based on the error model of the RPR-RP parallel mechanism and the error model of the 3-RPS parallel mechanism, the overall error model of the parallel-serial hybrid robot is obtained.
6. Application of a five-DOF parallel-serial hybrid robot as claimed in claim 1 in free-form surface processing based on electrically assisted photocatalytic nanoparticle colloid jet polishing.
