Parallel type curved surface compliant three-degree-of-freedom grinding and polishing flange and grinding and polishing system

Through the three-degree-of-free grinding and grinding flange and grinding system that conforms to the parallel curved surface, combined with the parallel mechanism and force control strategy, the force-position coupling problem of robot grinding and grinding in the processing of large and complex curved surface parts is solved, and the surface accuracy and efficiency are improved , suitable for a variety of manufacturing processes.

CN118875889AActive Publication Date: 2024-11-01HUAZHONG UNIV OF SCI & TECH
View PDF 15 Cites 0 Cited by

Patent Information

Application Number
CN202310472170.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-04-27
Publication Date
2024-11-01
Estimated Expiration
2043-04-27

AI Technical Summary

Technical Problem

Robot grinding and polishing has force level coupling problems when dealing with large and complex curved parts, making it difficult to accurately obtain surface structural parameters, resulting in low processing quality, low efficiency, and difficult to handle efficient and precise machining in weak rigid areas in and at the tail of parts.

Method used

A three-degree-of-freedom grinding and polishing flange with parallel curved surfaces is designed, and a parallel mechanism, force control strategy and impedance control strategy are adopted. Through the telescopic adjustment of the connecting rod assembly and polishing module, the attitude adaptive adjustment of the end flange is achieved. , ensure constant force grinding and polishing, and optimize the processing process through six-degree of freedom robot and specific process characteristics.

Benefits of technology

It improves the surface accuracy of large and complex curved surface parts, improves work efficiency, solves the problems of high labor intensity and low efficiency of workers, and is suitable for a variety of manufacturing and processing processes, improving the overall industrial level.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118875889A_ABST
    Figure CN118875889A_ABST
Patent Text Reader

Abstract

The invention belongs to the technical field of robot grinding and polishing, and particularly discloses a parallel type curved surface compliance three-degree-of-freedom grinding and polishing flange and a grinding and polishing system. Comprising a platform and connecting module and a branch chain module, and the platform and connecting module comprises a movable platform and a fixed platform which are arranged at an interval; the branch chain module comprises three groups of telescopic adjusting connecting rod assemblies which are arranged between the movable platform and the fixed platform and are symmetrically arranged about the center of the movable platform, one end of each telescopic adjusting connecting rod assembly is connected with the movable platform through a ball pair, and the other end of each telescopic adjusting connecting rod assembly is connected with the fixed platform through a rotating pair; in this way, by adjusting the lengths of the three sets of telescopic adjusting connecting rod assemblies, three-degree-of-freedom movement of translation along the z-axis or rotation along the x-axis and the y-axis of the movable platform is achieved. The parallel mechanism is adopted, rigidity is large, inertia is good, the structure is compact, the bandwidth is effectively increased, and meanwhile it is guaranteed that the grinding and polishing process is consistent with the normal direction of a curved surface in the grinding and polishing process.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of robot grinding and polishing, and more specifically, relates to a parallel curved surface compliant three-degree-of-freedom grinding and polishing flange and a grinding and polishing system. Background Art

[0002] Large and complex curved surface parts are key components in various fields. They have very high requirements for shape and position accuracy and surface roughness, and are closely related to the life and efficiency of the equipment. Typical representatives are aircraft engine blades, wind turbine blades, turbine blades, high-speed rail bodies, etc. Before being put into use, parts processed by machine tools must undergo one or more overall one-time finishing processes, which is the traditional grinding and polishing process.

[0003] At present, the main grinding and polishing methods used in my country are manual grinding and polishing and gantry machine grinding and polishing. Manual grinding and polishing has very high requirements on the workers' experience level. The quality of parts processed by different workers is uneven, and the positioning methods are also different. It not only consumes a lot of manpower, but also has very low work efficiency. Some parts will generate dust and noise during the grinding and polishing process, which is very harmful to the workers' body and mind. Although gantry machine grinding and polishing frees the workers' hands, it is difficult to move and lacks flexibility. Workers need a long time to learn and master the use. The main disadvantage is that it is difficult to handle the problem of efficient and precise processing of the weak rigidity areas in the middle and tail of the parts. The robot grinding and polishing method is adopted, and the mobile robot is used as the execution equipment for the grinding and polishing of parts, which avoids the disadvantages of manual grinding and polishing and gantry machine grinding and polishing. It is very flexible and frees workers from boring work. At the same time, it avoids the harm of dust to workers and has high social benefits.

[0004] However, robot grinding and polishing is not omnipotent, and its disadvantages are obvious, with the focus on the following aspects:

[0005] 1. There is a contradiction between the strong rigidity and low bandwidth motion characteristics of the robot and the high rigidity and high precision of large complex curved surface parts. The force-position coupling problem is serious, and the kinematic characteristics are unknown.

[0006] 2. For the robot end effector to successfully perform grinding and polishing, its interactive control with the environment is crucial. In fact, due to the manufacturing errors generated during the processing of large and complex curved surface parts, the complexity of the grinding and polishing environment, and the deformation of the blades caused by clamping during the grinding and polishing process, it is impossible to accurately obtain its surface structure parameters. At the same time, due to the large radial size changes, free-form surface, large size, weak rigidity and other characteristics of large and complex curved surface parts themselves, it is difficult to predetermine the contact force and processing trajectory of the robot in the grinding and polishing process, which is prone to local under-grinding or over-grinding, affecting surface accuracy, reducing efficiency, and affecting the service life of the equipment. Summary of the invention

[0007] In view of the above defects or improvement needs of the prior art, the present invention provides a parallel surface-compliant three-degree-of-freedom grinding and polishing flange and a grinding and polishing system, wherein a parallel surface-compliant three-degree-of-freedom grinding and polishing flange is designed accordingly in combination with the characteristics of the six-degree-of-freedom robot itself and the characteristics of the blade grinding process, and its key components such as the platform and connection module and the branch module structure and their specific settings are studied and designed. A parallel mechanism is adopted accordingly, which has high rigidity, good inertia and compact structure, and effectively improves the bandwidth. At the same time, the surface compliance achieved through the force control strategy and the impedance control strategy ensures the adaptive adjustment of the posture of the end flange, ensures that the normal direction of the surface is consistent during the grinding and polishing process, and can ensure constant force grinding and polishing, which greatly changes the processing quality, improves the surface accuracy of large and complex curved surface parts, and improves work efficiency.

[0008] To achieve the above object, according to one aspect of the present invention, a parallel curved surface compliant three-degree-of-freedom grinding and polishing flange is proposed, comprising a platform, a connection module and a branch chain module, wherein:

[0009] The platform and connection module include a moving platform and a fixed platform arranged at intervals;

[0010] The branch chain module includes three groups of telescopic adjustable link assemblies disposed between the moving platform and the fixed platform and arranged symmetrically about the center of the moving platform, one end of the telescopic adjustable link assembly is connected to the moving platform through a ball pair, and the other end is connected to the fixed platform through a rotating pair;

[0011] In this way, by adjusting the lengths of the three sets of telescopic adjustable link assemblies, the three degrees of freedom of the moving platform can be achieved, namely, translation along the z-axis or rotation along the x-axis and the y-axis respectively.

[0012] As further preferred, the telescopic adjustable link assembly includes a hinge component, a first drive component, a guide rail component, a skateboard, a rotating sub-component and a position sensing component, one end of the hinge component is connected to the moving platform, and the other end is fixedly connected to the first drive component, a power output shaft of the first drive component is connected to the skateboard, the skateboard moves along the guide rail component under the drive of the first drive component, and the bottom of the skateboard is connected to the fixed platform through the rotating sub-component, in this way, the skateboard is driven by the first drive component to move along the guide rail component to adjust the distance and posture between the moving platform and the fixed platform, and the position sensing component is used to identify the movement distance of the skateboard.

[0013] As further preferred, the first driving component includes a telescopic driving motor, a synchronous pulley and a screw component, the power output shaft of the telescopic driving motor is connected to the synchronous pulley, the synchronous pulley includes a driving wheel, a driven wheel and a belt wound around the driving wheel and the driven wheel, the driven wheel is connected to the screw component, and the screw component is fixedly connected to the slide plate.

[0014] As a further preferred embodiment, the position sensing component includes a sensor fixing bar, a sensing sheet and a sensing sensor arranged along the movement direction of the skateboard, the sensor fixing bar is fixedly connected to the guide rail component, one end of the sensing sheet is slidably connected to the sensor fixing bar, and the other end moves synchronously with the skateboard, the sensing sensor includes two sensors, which are respectively arranged on both sides of the sensing sheet along the movement direction of the skateboard, and the distance between the two sensing sensors at least covers the maximum movement distance of the sensing sheet.

[0015] As a further preferred embodiment, a grinding and polishing module is also provided on the top surface of the moving platform, and the grinding and polishing module includes a grinding and polishing motor, a one-dimensional force sensor, a sensor connecting plate, a coupling, a bearing and a grinding disc. One end of the grinding and polishing motor is fixedly connected to the moving platform, and the other end is connected to the sensor connecting plate. A plurality of the one-dimensional force sensors are arranged in a uniform array along the circumference of the grinding and polishing motor, and the one-dimensional force sensor is arranged between the moving platform and the sensor connecting plate. The power output shaft of the grinding and polishing motor is connected to the coupling, one end of the coupling is connected to the sensor connecting plate, and the other end is connected to the grinding disc through the bearing.

[0016] As a further preferred embodiment, the screw system of the telescopic adjustable connecting rod assembly is:

[0017]

[0018] As a further preferred embodiment, the actual processing space area of ​​the grinding and polishing flange is:

[0019] l min ≤l i ≤l max

[0020] φ min ≤φ i ≤φ max

[0021] Among them, use l min The minimum length of the telescopic adjustable connecting rod assembly is expressed as l max is the maximum length of the telescopic adjustable link assembly, l i is the actual length of the telescopically adjustable connecting rod assembly, φ min is the minimum rotation angle of the ball pair, φ max is the maximum rotation angle of the ball pair, φ iis the actual rotation angle of the ball pair;

[0022] The rotation angle expression of the ball pair of the upper platform is:

[0023]

[0024] Among them, n i is the reference vector for mounting the ball joint.

[0025] According to another aspect of the present invention, a grinding and polishing control method is also provided, which is implemented using the three-degree-of-freedom grinding and polishing flange as described above, and includes the following steps:

[0026] S1 builds the impedance control model of three-degree-of-freedom grinding and polishing flange;

[0027] S2 calculates the expected grinding and polishing force of the grinding and polishing module, and obtains the actual grinding and polishing force and actual posture of the grinding and polishing module;

[0028] S3 adjusts the lengths of the three sets of telescopic adjustable connecting rod assemblies according to the difference between the actual polishing force and the expected polishing force and the actual posture of the polishing module, so that the three-degree-of-freedom polishing flange drives the polishing module to the expected posture and the polishing force of the polishing module is the expected polishing force.

[0029] As further preferred, in step S1, the impedance control model is:

[0030]

[0031] Δx=x d -x(t)

[0032] Δf=f d -f(t)

[0033] Where M d is the mass matrix, D d is the damping matrix, K d is the stiffness matrix, Δx is the displacement deformation, Δf is the force deviation, x d is the desired pose, x(t) is the current pose, and f d is the desired force, and f(t) is the current contact force.

[0034] According to another aspect of the present invention, there is also provided a grinding and polishing system, comprising the above-mentioned three-degree-of-freedom grinding and polishing flange, a grinding and polishing module integrated on a moving platform of the three-degree-of-freedom grinding and polishing flange, and a control module in communication with the three-degree-of-freedom grinding and polishing flange and the grinding and polishing module, wherein:

[0035] The control module adjusts the position of the three-degree-of-freedom polishing flange according to the difference between the actual polishing force and the expected polishing force and the actual posture of the polishing module, and drives the polishing module to the expected posture and the polishing force of the polishing module to the expected polishing force by controlling the moving platform to translate along the z-axis or rotate along the x-axis and y-axis respectively.

[0036] In general, the above technical solution conceived by the present invention has the following technical advantages compared with the prior art:

[0037] 1. The present invention adopts a parallel mechanism with high rigidity, good inertia and compact structure, which effectively improves the bandwidth. At the same time, the surface compliance achieved through force control strategy and impedance control strategy ensures the adaptive adjustment of the posture of the end flange, ensures that the normal direction of the surface is consistent during the grinding and polishing process, and can ensure constant force grinding and polishing, which greatly changes the processing quality, improves the surface accuracy of large and complex curved surface parts, and improves work efficiency. At the same time, this invention can be applied to a variety of manufacturing and processing processes, solves the problem of insufficient labor, and helps to improve my country's overall industrial level. BRIEF DESCRIPTION OF THE DRAWINGS

[0038] Figure 1 It is a schematic diagram of the parallel curved surface compliant three-degree-of-freedom grinding and polishing flange structure involved in the present invention;

[0039] Figure 2 It is an exploded view of the flange grinding and polishing module assembly involved in the present invention;

[0040] Figure 3 is an exploded view of the flange branch chain module assembly of the present invention;

[0041] Figure 4 It is an exploded view of the flange platform and the connecting part components involved in the present invention;

[0042] Figure 5 It is a schematic diagram of a parallel curved surface compliant three-degree-of-freedom grinding and polishing flange mechanism involved in the present invention;

[0043] Figure 6 This is a schematic diagram of the 3-RPS mechanism involved in the present invention;

[0044] Figure 7 It is the spiral analysis diagram of branch motion in 3-RPS mechanism;

[0045] Figure 8 It is the 3-PRS spiral motion analysis diagram;

[0046] Fig. 9 It is a typical cross-sectional schematic diagram of a ball joint involved in the present invention;

[0047] Fig.10 is a schematic diagram of the position of the ball hinge relative to the mobile platform;

[0048] Fig.11 This is a flange working space design flow chart involved in the present invention;

[0049] Fig.12 It is the boundary diagram of the grinding and polishing flange working space;

[0050] Fig.13 It is a schematic diagram of the physical model of impedance control;

[0051] Fig.14 This is the impedance controller schematic.

[0052] In all the drawings, the same reference numerals represent the same technical features, specifically: A-grinding and polishing module, B-branch chain module, C-platform and connection module, 1-grinding disc, 2-bearing, 3-coupling, 4-sensor connecting plate, 5-one-dimensional force sensor, 6-grinding and polishing motor, 7-screw component, 8-screw, 9-cross roller linear guide, 10-screw nut, 11-slide plate, 12-sensor protection plate, 13-new sensor plate, 14-sensor fixing strip, 15-sensor, 16-telescopic drive motor, 17-synchronous pulley, 18-moving platform, 19-transition plate, 20-fixed platform, 21-hinge, 22-copper column, 23-universal ball joint. DETAILED DESCRIPTION

[0053] In order to make the purpose, technical solutions and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not intended to limit the present invention. In addition, the technical features involved in the various embodiments of the present invention described below can be combined with each other as long as they do not conflict with each other.

[0054] like Figure 1As shown, a parallel curved surface-compliant three-degree-of-freedom grinding and polishing flange provided by an embodiment of the present invention includes a platform and a connection module and a branch chain module, wherein the platform and the connection module include a movable platform 18 and a fixed platform 20 arranged at intervals; the branch chain module includes three groups of telescopic adjustable link assemblies arranged between the movable platform 18 and the fixed platform 20 and symmetrically arranged about the center of the movable platform 18, one end of the telescopic adjustable link assembly is connected to the movable platform 18 through a ball pair, and the other end is connected to the fixed platform 20 through a rotating pair; in this way, by adjusting the length of the three groups of telescopic adjustable link assemblies, the three-degree-of-freedom movement of the movable platform 18 along the z-axis or the rotation along the x-axis and y-axis respectively can be realized. More specifically, the telescopic adjustable link assembly includes a hinge component, a first drive component, a guide rail component, a skateboard 11, a rotating sub-component and a position sensing component. One end of the hinge component is connected to the moving platform 18, and the other end is fixedly connected to the first drive component. The power output shaft of the first drive component is connected to the skateboard 11. The skateboard 11 moves along the guide rail component under the drive of the first drive component, and the bottom of the skateboard 11 is connected to the fixed platform 20 through the rotating sub-component. In this way, the skateboard 11 is driven by the first drive component to move along the guide rail component to adjust the distance and posture between the moving platform 18 and the fixed platform 20. The position sensing component is used to identify the movement distance of the skateboard 11. The first driving component includes a telescopic driving motor 16, a synchronous pulley 17 and a screw component. The power output shaft of the telescopic driving motor 16 is connected to the synchronous pulley 17. The synchronous pulley 17 includes a driving wheel, a driven wheel and a belt wound around the driving wheel and the driven wheel. The driven wheel is connected to the screw component, and the screw component is fixedly connected to the skateboard 11. The position sensing component includes a sensor fixing bar 14, a sensing sheet 13 and a sensing sensor 15 arranged along the movement direction of the skateboard 11. The sensor fixing bar 14 is fixedly connected to the guide rail component. One end of the sensing sheet 13 is slidably connected to the sensor fixing bar 14, and the other end moves synchronously with the skateboard 11. The sensing sensor 15 includes two, which are respectively arranged on both sides of the sensing sheet 13 along the movement direction of the skateboard 11, and the distance between the two sensing sensors 15 at least covers the maximum movement distance of the sensing sheet 13.A polishing module is also provided on the top surface of the moving platform 18, and the polishing module includes a polishing motor 6, a one-dimensional force sensor 5, a sensor connecting plate 4, a coupling 3, a bearing 2 and a grinding disc 1. One end of the polishing motor 6 is fixedly connected to the moving platform 18, and the other end is connected to the sensor connecting plate 4. A plurality of one-dimensional force sensors 5 are arranged in a uniform array along the circumference of the polishing motor 6, and the one-dimensional force sensor 5 is provided between the moving platform 18 and the sensor connecting plate 4. The power output shaft of the polishing motor 6 is connected to the coupling 3, one end of the coupling 3 is connected to the sensor connecting plate 4, and the other end passes through the bearing 2 and is connected to the grinding disc 1.

[0055] like Figure 2 As shown, in a preferred embodiment of the present invention, the flange as a whole comprises an upper (moving) platform that can clamp the driving mechanism, three retractable connecting rods (moving pairs) and a base (fixed platform). The upper platform is connected to the connecting rod through three ball hinges (ball pairs), and the three ball hinges are evenly distributed on a circle with the center of the upper platform as the center and r as the radius. The lines connecting the three and the center of the circle are 120° to each other, that is, B1, B2, and B3 are equilateral triangles, with the center of the upper platform as the center and the circle with r as the radius as its circumscribed circle; the other end of the connecting rod is connected to the base through an equidistant pin joint (rotating pair). Similarly, P1, P2, and P3 are also equilateral triangles, with the center of the base as the center and R as the radius as its circumscribed circle. By changing the length of the connecting rod, the movement of the upper platform can be manipulated relative to the base. The three connecting rods are constrained by the pin pair and can only rotate around points P1, P2, and P3 respectively in three planes that are perpendicular to the base and pass through B1P1, B2P2, and B3P3. It can be seen that when the lengths of the three connecting rods are determined, the position of the upper platform can be uniquely determined. Through the above analysis, it can be known that the grinding and polishing flange mechanism designed by the present invention can move in three degrees of freedom: translation along the z-axis or rotation along the x- and y-axes. The flange can be divided into three parts from a structural perspective, including A grinding and polishing module, B branch chain module, C platform and connection module from top to bottom, with a total height of 270mm. In the process of structural design and selection of key parts, compact structure and easy processing and assembly are adopted as principles, and standard parts are selected as much as possible. The parameters of non-standard parts are designed based on the parameters of standard parts, which greatly reduces the processing and assembly time, and is convenient for later parts replacement and optimization and upgrading. Figure 3As shown, the grinding and polishing module includes a grinding disc 1, a RU42 cross-roller bearing, a coupling 3, a sensor connecting plate 4, a one-dimensional force sensor 5 and a Yaskawa servo motor. The diameter of the grinding disc 1 is 120 mm and the thickness is 5 mm. The diameter of the grinding disc 1 is half of the diameter of the moving platform, which is both beautiful and practical. The overall size is consistent with the sensor connecting plate 4 to form a symmetrical structure. At the same time, threaded holes are opened on the grinding disc 1 and the sensor connecting plate 4. The threaded holes of the grinding disc 1 cooperate with the inner ring of the RU42 cross-roller bearing to fix the grinding disc 1 and the bearing 2 together; the threaded holes on the sensor connecting plate 4 are used to fix the one-dimensional force sensor 5 together with the moving platform. The grinding and polishing motor selects a Yaskawa servo motor 6. The motor output shaft is connected to the coupling 3. The coupling 3 is fixed to the inner ring of the RU42 cross-roller bearing 2 through the mounting hole, so that the rotation of the motor 6 drives the grinding disc 1 to rotate, thereby ensuring the quality of grinding and polishing. As shown Figure 4 As shown, the branch chain as a whole consists of four parts: the motor part, the transmission part, the position sensing part, and the guide rail part. The motor 16 of the motor part is selected in the same way as the motor 6 of the A grinding and polishing part. The output shaft of the motor 16 is connected to the synchronous pulley 17 to drive the synchronous pulley 17 to rotate. The transmission part selects synchronous pulley transmission, and the motor can control the movement of the screw 8 through the belt. The position sensing part consists of a sensor protective sheet 12, two LU-L24 sensors 15, a new sensor sheet 13, and a sensor fixing bar 14. Among them, the sensor protective sheet 12 is used to isolate the sensor from the external environment to prevent dust and other damage to components; the new sensor sheet 13 is fixed on the sensor fixing bar 14 and can slide with the guide rail; the two LU-L24 sensors 15 are evenly distributed on the sensor fixing bar 14, which can detect the position of the new sensor sheet 13, that is, the guide rail at any time. The position information is transmitted to the PC end to monitor the position of the guide rail online to obtain the real-time posture of the moving platform. The principle of the guide rail part is to drive the screw 8 to rotate through the synchronous pulley 17, and the screw 8 rotates, the screw nut 10 moves, and the slide plate 11 moves through the movement of the screw nut 10, so as to achieve the effect of variable connecting rod length, that is, the moving pair. From the internal structure diagram of the guide rail part, it can be seen that the slide plate 11 is fixed on four cross roller linear guides 9 to achieve free sliding. At the same time, there are two 635 bearings 7, screw locking nuts, bearing caps and other fixed parts on the upper end of the screw 8 to increase the bearing capacity of the screw 8 and achieve higher precision.

[0056] like Figure 5As shown, there are two platforms for the entire grinding and polishing flange, namely, a fixed platform 20 and a moving platform 18. The fixed platform 20 is connected to the manipulator, and the moving platform 18 is connected to the grinding and polishing part for grinding and polishing. The moving platform 18 and the fixed platform 20 have the same diameter, both of which are 240mm and 8mm thick. According to the position distribution relationship of the flange at the end of the manipulator and the threaded holes of the one-dimensional force sensor, the two platforms are opened with corresponding threaded holes for connection and fixation. The parts of the connection part are mainly standard parts, namely, the universal ball head damping hinge joint 23 (ball pair), hinge 21 (rotation pair), copper column 22 and transition plate 19. The installation connection between the standard parts uses a carbon fiber plate of appropriate thickness to obtain strong rigidity and strength while reducing weight as much as possible. Some key connecting parts use aluminum alloy processed parts to simplify the structure and ensure the strength of the structure. The universal ball head damping hinge joint 23 can realize swing in any direction and has adjustable torque, long service life and convenient disassembly; the hinge 21 is selected with high precision, which can effectively reduce the flange space and save raw materials; the copper column 22 and the transition plate 19 can be used to connect the moving pair with the moving platform 18 and the fixed platform 20 respectively.

[0057] like Figure 6 As shown, in the embodiment of the present invention, in the three-degree-of-freedom polishing flange (3-RPS) mechanism, R is a revolute pair, P is a translation pair, and S is a ball pair. Through the screw theory, the screw system of the branch motion is:

[0058]

[0059] like Figure 7 As shown, the constrained spiral system is:

[0060] $ r =(1 0 0;0f-e)

[0061] It can be obtained that the other two branches are parallel to the first revolute pair and pass through the center of their respective branch ball pairs. At the same time, the three constraints are linearly independent, limiting the three degrees of freedom of the platform. The restricted movements include the movement of the moving platform in the X and Y directions and the rotation in the Z direction.

[0062] Calculated according to the modified GK formula:

[0063]

[0064] Where: M represents the number of degrees of freedom of the polished flange; n represents the number of components of the polished flange; g represents the number of kinematic pairs in the polished flange; f i It represents the number of degrees of freedom of the i-th kinematic pair of the polishing flange; v represents the parallel redundant constraint.

[0065] It can be concluded that the 3-RPS mechanism can achieve two rotations and one translation with full freedom.

[0066] The working space of the 3-RPS parallel mechanism of the present invention refers to the actual processing space area that can be reached by the center point C of the upper platform, which can reflect the working performance of the parallel mechanism to a large extent.

[0067] In fact, there are many factors that can affect the working space of the parallel mechanism, the main factors are some physical constraints such as the constraint of the driving rod length, the constraint of the ball joint, the constraint of the interference between the connecting rods, etc. Since the invented 3-RPS parallel mechanism has three independent degrees of freedom, in order to calculate the working space, it is necessary to calculate the three degrees of freedom of movement, namely X C , Y C , Z C This requires solving equations with one moving and two rotating coordinates as independent variables to obtain the values ​​of the three moving variables. Since these three equations are highly nonlinear, it is bound to bring great difficulties to the solution. The present invention solves the equations according to the above three constraints to obtain the actual workspace, which makes the solution method of the workspace relatively simple and reliable, and is also convenient for practical application.

[0068] Discussion on driving rod length constraint:

[0069] The invented 3-RPS parallel grinding and polishing flange has three driving rods, which are distributed along the circumference at 120°. The length of the three rods can be obtained by the coordinates of the upper and lower points. Since the moving pair has a travel limit, the length of the driving rod is limited. min Indicates the minimum length of the rod, using l max represents the maximum length of the rod, then the length of the rod can be constrained by the following formula:

[0070] l min ≤l i ≤l max

[0071] Discussion on ball joint constraints:

[0072] Assume the spherical joint angle is φ i , its range is determined by the angle between the z-axis of the fixed coordinate system and the spherical hinge vector Z, as Fig. 9 The Z-axis reference vector of the ith ball joint on the upper platform is n i The spherical joint rotation angle of the upper platform is expressed as Where i = 1, 2, 3. The rotation angle constraint is

[0073] φ min ≤φ i ≤φ max

[0074] Where n i is the reference vector for installing the ball joint, φmin is the minimum rotation angle of the ball joint, φ max is the maximum rotation angle of the ball joint.

[0075] The following derivation aims to express φ i :

[0076] Let the normal vector N of the plane c-xyz be:

[0077] N=a 1 I+b 1 J+c 1 K

[0078] a 1 , b 1 、c 1 is the constant term coefficient, I is the x-axis unit vector, J is the y-axis unit vector, and K is the z-axis unit vector;

[0079] The corresponding plane equation is:

[0080] Ax+By+Cz=d

[0081] A, B, C are constant term coefficients, d is a constant term, and x, y, z are the coordinate axes of the corresponding plane;

[0082] Depend on Figure 6 It can be seen that:

[0083]

[0084] Among them, B 1 B 2 and B 2 B 3 Ball hinge B 1 To B 2 With B 2 To B 3 The line vector pointing to can determine the components of the normal vector N:

[0085]

[0086]

[0087]

[0088] Since the ball hinge is firmly fixed to the upper platform, Fig.10 As shown, the symmetry axis of each ball hinge intersects the normal line of the upper platform at m, along the normal line and through the point (x c ,y c ,z c ) is:

[0089]

[0090] By defining the unit vector components we get:

[0091]

[0092]

[0093]

[0094] Therefore, the Cartesian coordinates of point m can be obtained as:

[0095] x m =x c +AD m

[0096] y m =y c +BD m

[0097] z m =z c +CD m

[0098] Similarly, the straight line equation of the connecting rod is:

[0099]

[0100] The angle φ can be obtained i The expression is as follows:

[0101]

[0102] Where i = 1, 2, 3 and 0 < φ i <φ max / 2.

[0103] Due to the characteristics of the mechanism itself, there can be no interference between the rods. So far, all constraints have been discussed.

[0104] Through the above derivation, the expression of the virtual rod length and the expression of the rotation angle of the ball hinge are currently known. Due to the particularity of the polished flange structure, there will be no interference between the rods, so only the two constraints of rod length and rotation angle range need to be considered. The principle of the boundary numerical limit search method is to search for points in space. If the rod length and rotation angle of the point are within the specified limit range, the point is within the working space of the mechanism. If any of the specified conditions are not met, the point is outside the working space of the mechanism. Finally, all points that meet the constraints are found and drawn into a surface, and the complete working space of the mechanism can be obtained. Use parallel planes to divide the working space into infinitesimal elements with a thickness of ΔZ, find the boundaries of the working space in each plane, and connect them together to form a surface to obtain the three-dimensional working space of the mechanism.

[0105] More specifically, Fig.11 As shown, first initialize the parameters of the flange mechanism: min is the minimum length of the rod, l max is the maximum length of the rod, R is the fixed platform diameter, r is the moving platform diameter, Z min is the lowest height that the center point of the moving platform can reach, Z max The highest height that the center point of the moving platform can reach, α and β are the Euler angles;

[0106] Set the initial value according to the designed grinding and polishing flange size: For example, l min =170mm, l max =240mm, R=120mm, r=120mm, Z 0 =160mm;

[0107] Calculate the length of each telescopic rod of the flange and the corresponding rotation angle value of the flange;

[0108] Determine whether the rotation angle value corresponding to the flange meets the constraint requirements. If so, record the corresponding parameters and draw the working space boundary of the flange. If not, adjust the parameters ΔZ, α, β, and recalculate the length of each telescopic rod of the flange and the rotation angle value corresponding to the flange until the rotation angle value corresponding to the flange meets the constraint requirements and the working space boundary of the flange is drawn.

[0109] After using the boundary numerical limit search method and writing a program in MATLAB software to simulate the workspace of the mechanism, the boundary graph of the workspace is obtained as follows Fig.12 shown.

[0110] Since there is a contradiction between the strong rigidity and low bandwidth motion characteristics of the robot and the high rigidity and high precision of large complex curved surface parts, and the force-position coupling problem is serious and the kinematic characteristics are unknown, the robot is required to have a certain degree of compliance during the processing process to reduce the processing error. In order to achieve the compliance of the contact force and posture of the end of the flexible flange, it is necessary to use a corresponding force control algorithm to control the contact force in real time. The present invention uses an impedance control algorithm, performs gravity compensation on the six-dimensional force sensor, and sets a corresponding impedance controller to achieve the surface compliance of the polishing flange.

[0111] More specifically, the present invention also relates to a grinding and polishing control method, comprising the following steps:

[0112] S1 builds the impedance control model of three-degree-of-freedom grinding and polishing flange;

[0113] S2 calculates the expected grinding and polishing force of the grinding and polishing module, and obtains the actual grinding and polishing force and actual posture of the grinding and polishing module;

[0114] S3 adjusts the lengths of the three sets of telescopic adjustable connecting rod assemblies according to the difference between the actual polishing force and the expected polishing force and the actual posture of the polishing module, so that the three-degree-of-freedom polishing flange drives the polishing module to the expected posture and the polishing force of the polishing module is the expected polishing force.

[0115] Among them, impedance control is the most common and widely used basic motion control method in robot motion control, and has been widely used in the compliance control of industrial robots. The purpose of impedance control is to adjust the mechanical impedance of the flange by adjusting the reference position trajectory, environmental position and environmental stiffness of the grinding and polishing flange, so as to ensure that the grinding and polishing flange and the external environment always maintain the ideal dynamic relationship we set, that is, the magnitude of the grinding and polishing force. By adjusting the dynamic relationship between the position of the grinding and polishing flange and the actual contact force, the surface compliance can be well achieved. Its advantages are that it can be monitored online in real time, and it has good robustness to the interference and uncertainty of the external environment. When the system needs to switch from unconstrained to constrained motion, it can keep the system stable. Its disadvantage is that in practice, due to the uncertainty of the environment and the different processing quality of the parts, it is difficult to accurately obtain the theoretical reference trajectory of the grinding and polishing flange and the position and stiffness of the actual processing environment, so it is impossible to accurately guarantee the control of force and position. Simply put, when the force signal fed back by the force sensor is simultaneously converted into the adjustment amount of the robot's end position, velocity or acceleration, it is impedance control. Therefore, the physical meaning of impedance control is to simplify the robot into a second-order system of mass-damper-spring and control it. F is the impedance force. Its physical model is as follows: Fig.13 shown.

[0116] Mechanical impedance is generated by the mechanical system itself and is characterized by the mass matrix M, the damping matrix D and the stiffness matrix K. Impedance control establishes a dynamic relationship between force and position, and the ideal impedance control model for polishing flanges is:

[0117]

[0118] Δx=x d -x(t)

[0119] Δf=f d -f(t)

[0120] where x d With f d are the expected position and force of the polished flange, x(t) and f(t) are the current position and contact force of the polished flange detected by the sensor in real time, Δx and its first-order and second-order derivatives represent the deviation between the expected and current position, velocity and acceleration of the polished flange. The impedance control of the polished flange is achieved by adjusting the parameter M d , D d With K d To achieve the control of flange end force and position.

[0121] In the present invention, the force sensor is a six-dimensional force sensor, which can measure the information of three forces and torques that change in real time in space. The sensor itself has gravity. Although the possible influence of the sensor's own gravity on the detected force and torque information has been considered in the design process and corresponding compensation has been made, in the actual grinding process, the influence of the gravity of the grinding and polishing module on the sensor changes instantly with the change of the end effector posture. If no compensation is performed, the sensor accuracy will be greatly affected and the impedance control cannot be well implemented. The gravity compensation problem belongs to the statics problem in robotics. The algorithm principles of gravity compensation and torque compensation will be introduced in detail below.

[0122] The present invention uses ZYZ Euler angles to describe the posture of the grinding and polishing flange, and α, β, and γ are the rotation coefficients of the third coordinate transformation. Assuming the gravity of the grinding and polishing module is G, the vector representation of the gravity of the grinding and polishing module in the coordinate system O-XYZ is In the coordinate system c-xyz, the gravity of the grinding and polishing module is not only related to the size of G, but also to α, β, and γ. To reflect it in the coordinate system c-xyz, you need to multiply the inverse matrix of the rotation matrix [T] on the left:

[0123]

[0124] The vector of gravity in the basic coordinate system O-XYZ is expressed as Then the cosine of the angle between gravity and the x-axis in the workpiece coordinate system c-xyz is:

[0125]

[0126] The component of the gravity of the grinding and polishing module on the x-axis in the workpiece coordinate system c-xyz is:

[0127] G x =G×cosψ=r 31 G

[0128] Similarly, the components of the gravity of the grinding and polishing module on the three coordinate axes in the workpiece coordinate system c-xyz are:

[0129] {G x ,G y ,G z}={r 31 G,r 32 G,r 33 G}

[0130] The torque signal measured on each coordinate axis of the sensor is not only related to the components of the gravity of the grinding and polishing module in the other two coordinate systems, but also to the position of the center of mass of the grinding and polishing module in the workpiece coordinate system. Assume that the torque components of the gravity of the grinding and polishing module on the three coordinate axes in the workpiece coordinate system are {M x ,M y ,M z}, the coordinates of the center of gravity of the grinding and polishing module in the workpiece coordinate system are {L x ,L y ,L z}, the components of the gravity of the grinding and polishing module on the three coordinate axes in the workpiece coordinate system c-xyz have been obtained as {G x ,G y ,G z}, according to the relationship between force and torque, the following expression can be obtained:

[0131] M x =G z ×L y -G y ×L z

[0132] M y =G x ×L z -G z ×L x

[0133] M z =G y ×L x -G x ×L y

[0134] When the center of mass of the polishing module falls on the Z axis of the sensor, L x =L y =0, the above formula can be simplified to:

[0135] M x =-G y ×L z

[0136] M y =G x ×L z

[0137] M z =0

[0138] In the actual measurement process, in addition to the influence of the gravity of the polishing module on the measurement results mentioned above, the initial value setting of the sensor itself will also have a great influence on the measurement results. Therefore, before the actual measurement, we must obtain the initial value and compensate it.

[0139] Assume that the initial value of the force sensor is set to {F x0 ,F y0 ,F z0 ,T x0 ,T y0 ,T z0}, the actual value measured by the sensor is {F ex ,F ey ,F ez ,T ex ,T ey ,T ez},but:

[0140]

[0141] Then, according to the six groups of specific postures, the joint solution can be solved to obtain {F x0 ,F y0 ,F z0 ,T x0 ,T y0 ,T z0} and the center of gravity size and position of the grinding and polishing module.

[0142] The impedance controller designed by the present invention works as follows: Fig.14 As shown:

[0143] By setting the corresponding control parameter M d , D d With K d, and the environmental impedance parameters obtained by estimation or online learning, so that the input is the target position of the polished flange, and the output is the contact force at the end of the polished flange. After adjusting the parameters, the controller can have better performance.

[0144] In addition, the present invention also provides a grinding and polishing system, comprising the above-mentioned three-degree-of-freedom grinding and polishing flange, a grinding and polishing module integrated on a moving platform of the three-degree-of-freedom grinding and polishing flange, and a control module in communication with the three-degree-of-freedom grinding and polishing flange and the grinding and polishing module, wherein:

[0145] The control module adjusts the position of the three-degree-of-freedom polishing flange according to the difference between the actual polishing force and the expected polishing force and the actual posture of the polishing module, and drives the polishing module to the expected posture and the polishing force of the polishing module to the expected polishing force by controlling the moving platform to translate along the z-axis or rotate along the x-axis and y-axis respectively.

[0146] It will be easily understood by those skilled in the art that the above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions and improvements made within the spirit and principles of the present invention should be included in the protection scope of the present invention.

Claims

1. A parallel curved surface compliant three-degree-of-freedom polished flange, characterized in that: It includes platform, connection module and branch chain module, among which: The platform and connection module include a movable platform (18) and a fixed platform (20) arranged at intervals; The branch chain module comprises three groups of telescopic adjustable link assemblies which are arranged between the moving platform (18) and the fixed platform (20) and are symmetrically arranged about the center of the moving platform (18); one end of the telescopic adjustable link assembly is connected to the moving platform (18) through a ball pair, and the other end is connected to the fixed platform (20) through a revolute pair; In this way, by adjusting the lengths of the three sets of telescopic adjustable link assemblies, the three degrees of freedom of the moving platform (18) can be achieved, namely, translation along the z-axis or rotation along the x-axis and the y-axis.

2. The parallel curved surface compliant three-degree-of-freedom polished flange according to claim 1, characterized in that: The telescopic adjustable link assembly comprises an articulated component, a first driving component, a guide rail component, a slide plate (11), a rotating sub-component and a position sensing component. One end of the articulated component is connected to the moving platform (18), and the other end is fixedly connected to the first driving component. The power output shaft of the first driving component is connected to the slide plate (11). The slide plate (11) moves along the guide rail component under the drive of the first driving component, and the bottom of the slide plate (11) is connected to the fixed platform (20) through the rotating sub-component. In this way, the slide plate (11) is driven by the first driving component to move along the guide rail component to adjust the distance and posture between the moving platform (18) and the fixed platform (20). The position sensing component is used to identify the movement distance of the slide plate (11).

3. The parallel curved surface compliant three-degree-of-freedom polished flange according to claim 2, characterized in that: The first driving component comprises a telescopic driving motor (16), a synchronous pulley (17) and a screw component, the power output shaft of the telescopic driving motor (16) is connected to the synchronous pulley (17), the synchronous pulley (17) comprises a driving wheel, a driven wheel and a belt wound around the driving wheel and the driven wheel, the driven wheel is connected to the screw component, and the screw component is fixedly connected to the slide plate (11).

4. The parallel curved surface compliant three-degree-of-freedom polished flange according to claim 2, characterized in that: The position sensing component comprises a sensor fixing bar (14), a sensing sheet (13) and a sensing sensor (15) arranged along the movement direction of the slide plate (11); the sensor fixing bar (14) is fixedly connected to the guide rail component; one end of the sensing sheet (13) is slidably connected to the sensor fixing bar (14), and the other end moves synchronously with the slide plate (11); the sensing sensor (15) comprises two, which are arranged on both sides of the sensing sheet (13) along the movement direction of the slide plate (11), and the distance between the two sensing sensors (15) at least covers the maximum movement distance of the sensing sheet (13).

5. The parallel curved surface compliant three-degree-of-freedom polished flange according to claim 2, characterized in that: The top surface of the moving platform (18) is also provided with a grinding and polishing module, which includes a grinding and polishing motor (6), a one-dimensional force sensor (5), a sensor connecting plate (4), a coupling (3), a bearing (2) and a grinding disc (1). One end of the grinding and polishing motor (6) is fixedly connected to the moving platform (18), and the other end is connected to the sensor connecting plate (4). A plurality of the one-dimensional force sensors (5) are arranged in a uniform array along the circumference of the grinding and polishing motor (6), and the one-dimensional force sensor (5) is arranged between the moving platform (18) and the sensor connecting plate (4). The power output shaft of the grinding and polishing motor (6) is connected to the coupling (3), one end of the coupling (3) is connected to the sensor connecting plate (4), and the other end passes through the bearing (2) and is connected to the grinding disc (1).

6. The parallel curved surface compliant three-degree-of-freedom polished flange according to claim 1, characterized in that: The actual processing space area of ​​the grinding and polishing flange is: l min ≤l i ≤l max f min ≤φ i ≤φ max Among them, use l min The minimum length of the telescopic adjustable connecting rod assembly is expressed as l max is the maximum length of the telescopic adjustable link assembly, l i is the actual length of the telescopically adjustable connecting rod assembly, φ min is the minimum rotation angle of the ball pair, φ max is the maximum rotation angle of the ball pair, φ i is the actual rotation angle of the ball pair.

7. The parallel curved surface compliant three-degree-of-freedom polished flange according to claim 1, characterized in that: The rotation angle expression of the ball pair of the upper platform is: Among them, n i is the reference vector for mounting the ball joint.

8. A grinding and polishing control method, characterized in that: The method is implemented by using the three-degree-of-freedom polishing flange as described in any one of claims 1 to 7, comprising the following steps: S1 builds the impedance control model of three-degree-of-freedom grinding and polishing flange; S2 calculates the expected grinding and polishing force of the grinding and polishing module, and obtains the actual grinding and polishing force and actual posture of the grinding and polishing module; S3 adjusts the lengths of the three sets of telescopic adjustable connecting rod assemblies according to the difference between the actual polishing force and the expected polishing force and the actual posture of the polishing module, so that the three-degree-of-freedom polishing flange drives the polishing module to the expected posture and the polishing force of the polishing module is the expected polishing force.

9. A grinding and polishing control method according to claim 8, characterized in that: In step S1, the impedance control model is: Δx=x d -x(t) Δf=f d -f(t) Where M d is the mass matrix, D d is the damping matrix, K d is the stiffness matrix, Δx is the displacement deformation, Δf is the force deviation, x d is the desired pose, x(t) is the current pose, and f d is the desired force, and f(t) is the current contact force.

10. A grinding and polishing system, characterized in that: It comprises the three-degree-of-freedom grinding and polishing flange according to any one of claims 1 to 7, a grinding and polishing module integrated on a moving platform (18) of the three-degree-of-freedom grinding and polishing flange, and a control module in communication with the three-degree-of-freedom grinding and polishing flange and the grinding and polishing module, wherein: The control module adjusts the position of the three-degree-of-freedom polishing flange according to the difference between the actual polishing force and the expected polishing force and the actual posture of the polishing module, and drives the polishing module to the expected posture and the polishing force of the polishing module to the expected polishing force by controlling the moving platform (18) to translate along the z-axis or rotate along the x-axis and y-axis respectively.

Citation Information

Patent Citations

  • Blade polishing integral processing machine tool with curve surface adaptive

    CN101148021A

  • Spherical hinge mechanism, branched chain employing spherical hinge mechanism, and parallel robot thereof

    CN102996617A

  • Two-rotating one-moving three-freedom-degree parallel mechanism

    CN103056870A

  • Hybrid robot for stirring friction welding in redundant drive space

    CN103909518A

  • Combined-type three-axis force sensor and calculating method

    CN105092134A