Force-position-speed collaborative planning method and system considering dynamic characteristics of flexible grinding and polishing system
Through the 'force-position-speed' collaborative planning method, combined with the kinetics of the robot and the dynamic characteristics of the force-controlled actuator, the grinding and polishing process parameters are optimized, and the problem of poor grinding and polishing force and speed control accuracy in grinding and polishing complex surface parts is solved. , improves processing efficiency and surface quality.
Patent Information
- Application Number
- CN202411058964.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-02
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-08-02
AI Technical Summary
The prior art fails to fully consider the dynamic characteristics of robots and force-controlled actuators during the grinding and polishing process of complex curved surface parts, resulting in poor precision of grinding and polishing force and speed control, uneven material removal and low efficiency.
Using the 'force-position-speed' collaborative planning method, the position spline and direction spline of the grinding path are established, the speed model is optimized, and the system response equation of the force-controlled actuator is analyzed to consider the kinematics and dynamics constraints of the robot. The control points are dynamically adjusted in segmented B-splines to realize the coordinated planning of grinding and polishing feed speed and polishing force.
It improves grinding and polishing accuracy and efficiency, reduces production costs, enhances system stability and reliability, and realizes refined control of the grinding and polishing process.
Smart Images

Figure CN118963247A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to but is not limited to the technical field of grinding and polishing process planning, and in particular relates to a 'force-position-speed' collaborative planning method and system considering the dynamic characteristics of a robot flexible grinding and polishing system. Background Art
[0002] At present, with the rapid development of science and technology, complex curved surface parts such as integral blisks and blades are increasingly widely used in aerospace, automobile, shipbuilding and other fields. Grinding and polishing of complex curved surface parts is the final process of part finishing, and its processing quality affects the final forming accuracy of grinding and polishing. With the gradual improvement of robot manufacturing accuracy, the grinding and polishing strategy of "robot + active force control actuator" has gradually become the main grinding and polishing method for complex curved surface parts. When grinding and polishing complex curved surface parts, the grinding and polishing force and grinding and polishing speed are usually coordinated based on the material removal model to ensure the material removal accuracy of the parts after grinding and polishing. Since both the robot and the end effector are servo drive elements, the dynamic characteristics of the robot and the end force control actuator will affect the feed speed and the accuracy of the grinding and polishing force during the grinding process. Most of the existing flexible grinding and polishing parameter planning methods use constant force grinding and polishing or constant speed variable force grinding and polishing, which fail to give full play to the advantages of robot force control grinding and polishing. Therefore, when planning the grinding and polishing process parameters, it is necessary to consider the dynamic characteristics of the robot and the end force control actuator to achieve the optimal planning of the grinding and polishing process parameters.
[0003] Through the above analysis, the problems and defects of the prior art are as follows:
[0004] (1) When grinding and polishing complex curved surface parts, the existing constant force polishing or constant speed polishing method does not plan the contact force and grinding and polishing speed, which easily leads to uneven material removal and low processing efficiency.
[0005] (2) The existing variable force and variable speed grinding and polishing methods do not consider the dynamic characteristics of the grinding and polishing system when planning process parameters, which easily leads to poor control accuracy of the planned grinding and polishing force and grinding and polishing speed in actual grinding and polishing. Summary of the invention
[0006] In view of the problems existing in the prior art, the present invention provides a 'force-position-speed' collaborative planning method considering the dynamic characteristics of a robot flexible grinding and polishing system.
[0007] The present invention is implemented as follows: a 'force-position-speed' collaborative planning method considering the dynamic characteristics of a robot flexible grinding and polishing system, the method comprising:
[0008] S1, establishing the position spline and direction spline of the grinding and polishing path according to the grinding and polishing path.
[0009] S2, according to the specific scenario of grinding and polishing, a speed optimization model with the goal of optimizing grinding and polishing efficiency is established, and the speed-arc length curve is represented by B-spline;
[0010] S3, establish the constraint equations of robot kinematics and dynamics on the robot side of the robot flexible grinding and polishing system;
[0011] S4, analyze the system response equation of the force-controlled actuator, and establish the constraint equations of the grinding and polishing force, the grinding and polishing force derivative, and the grinding and polishing speed according to the material removal model.
[0012] S5, according to the dynamic mixed constraint conditions, the method of dynamically adjusting the control points using segmented B-spline is used to realize the process parameter planning of grinding feed speed-grinding force.
[0013] Further, in step S1, the position spline and direction spline of the grinding and polishing path are established. Specifically, since the grinding and polishing path can be expressed as [P, Θ] by Euler angles in the workpiece coordinate system, the position spline P (ω) and direction spline Θ (η) of the grinding and polishing path can be established by B-splines respectively;
[0014] The material removal model equation used is:
[0015]
[0016] Where h is the material removal depth, k h is the material removal equation coefficient, v is the grinding feed speed, n is the spindle speed, F is the grinding force, c t With c w is the curvature of the tool and the workpiece.
[0017] Furthermore, in step S2, a speed optimization model is established with the goal of optimizing the grinding and polishing efficiency, and the specific form of the speed-arc length curve represented by B-spline is:
[0018]
[0019] Where t is the total grinding and polishing time, s is the total arc length of the grinding and polishing path, S Σ is the total arc length of the polishing path, is the feed rate;
[0020] Since B-spline has the advantages of local support and strong local adjustment ability, the cubic B-spline curve Ψ(u) = (s, v) is used to express the relationship between the velocity curve and the arc length:
[0021]
[0022] where u∈[0,1] is the spline parameter, B i,p (u) is the spline basis function, V i are the spline control points.
[0023] Furthermore, the step S3 of establishing the constraint equations of robot kinematics and dynamics on the robot side in the robot flexible polishing system specifically includes:
[0024] First, in the process of feed rate planning and optimization, the motion constraints on the robot side include path constraints and joint constraints; path constraints refer to the feed rate constraints and acceleration constraints in the Cartesian space during the robot grinding process, which are expressed by the following constraint equation:
[0025]
[0026] Where V max and A max are the robot’s terminal velocity and acceleration constraints;
[0027] Since the robot is directly driven by 6 joint axes, the robot joint constraints also need to be considered in the grinding feed rate planning; the robot joint constraints include joint motion constraints and dynamic constraints; the joint motion constraints come from the displacement, velocity and acceleration of the robot joints, and the constraint equations are as follows:
[0028]
[0029] in represents the robot joint value, joint velocity and acceleration; ik(s) represents the robot kinematic inverse solution function; represents the robot joint motion constraint value; q′=dq / ds, q″=d 2 q / ds 2 Represents the first and second order partial derivatives of the robot joints with respect to the arc length of the terminal motion;
[0030] The above are the kinematic constraints of the robot. The dynamic equation of the robot can be expressed as:
[0031]
[0032] where τ 6×1 represents the robot joint motion vector, M 6×6 is the robot inertia matrix, C 6×6 is the Coriolis force matrix, G 6×1 is the gravity component matrix, τ f6×1 represents the friction torque, τ load6×1 is the robot joint torque value caused by the external load;
[0033] Substituting equation (5) into equation (6), we can obtain the constraint condition considering the dynamic characteristics of the robot as follows:
[0034]
[0035] where τ max is the robot dynamic torque constraint value.
[0036] Furthermore, the system response equation of the force-controlled actuator is analyzed in step S4, and the constraint equations of the grinding and polishing force, the grinding and polishing force derivative and the grinding and polishing speed are established according to the material removal model, which specifically includes:
[0037] The force control actuator can be simplified as a dual-mass spring-damper system, F m (t) is the motor output torque, F o (t) is the actual grinding contact force of the force-controlled actuator, m1 is the load mass on the motor side, m2 is the mass on the load side, c is the damping coefficient on the motor side, x1(t) is the output displacement on the motor side, x2(t) is the displacement on the load side, k1 is the spring stiffness, k e is the environmental stiffness; the equilibrium equation of the force-controlled actuator is expressed as:
[0038]
[0039] The above expression can be used to obtain the force transfer function of the force-controlled actuator through Laplace transform:
[0040]
[0041] Where s represents the Laplace variable. When using the end effector to grind high-rigidity parts, the system can be simplified to a second-order system:
[0042]
[0043] By introducing the PI controller, the closed-loop transfer function of the force control actuator is:
[0044]
[0045] The force control error transfer function can be expressed by the following formula:
[0046]
[0047] In the grinding and polishing process, since the actual force control actuator is a discrete system, the force control actuator will produce response errors when tracking the required force; the force control signal in each control cycle is regarded as a ramp signal The control error equation is as follows:
[0048]
[0049] According to the above force control error equation, when the robot is grinding, the derivative of the grinding force will affect the force control accuracy of the force control actuator, and the derivative of the grinding force will also affect the grinding feed speed; therefore, the derivative of the grinding force needs to be considered when planning the grinding feed speed, and the force constraint equation in the grinding and polishing speed planning is established as:
[0050]
[0051] The relationship between the above formula and the grinding feed speed is established through the material removal model:
[0052]
[0053] in The above formula can be converted into:
[0054]
[0055] further, It can be calculated by the following formula:
[0056]
[0057] Therefore, the constraint equation of the dynamic characteristics of the force-controlled actuator is considered in the grinding and polishing speed planning:
[0058]
[0059] Furthermore, in step S5, according to the dynamic hybrid constraint condition, the method of dynamically adjusting the control point by segmented B-spline is adopted to realize the process parameter planning of grinding feed speed-grinding force. The specific steps are:
[0060] According to steps S1-S4, the optimization equation for optimizing the grinding and polishing efficiency and considering the dynamic characteristics of the robot flexible grinding and polishing system is established as follows:
[0061]
[0062] Another object of the present invention is to provide a 'force-position-speed' collaborative planning system considering the dynamic characteristics of a robot flexible grinding and polishing system, which implements the 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system, and the system comprises:
[0063] Position spline and direction spline establishment module, which establishes the position spline and direction spline of the grinding and polishing path according to the grinding and polishing path;
[0064] The model building module is connected with the position spline and direction spline building modules. According to the specific scenario of grinding and polishing, a speed optimization model with the goal of optimizing grinding and polishing efficiency is established, and the speed-arc length curve is represented by B-spline;
[0065] Constraint equation establishment module, establishes the constraint equations of robot kinematics and dynamics on the robot side in the robot flexible grinding and polishing system; analyzes the system response equations of the force-controlled actuator, and establishes the constraint equations of grinding and polishing force, grinding and polishing force derivative and grinding and polishing speed according to the material removal model;
[0066] The planning implementation module is connected with the constraint equation establishment module. According to the dynamic mixed constraint conditions, the segmented B-spline dynamic adjustment control point method is adopted to realize the process parameter planning of grinding feed speed-grinding force.
[0067] Another object of the present invention is to provide a computer device, comprising a memory and a processor, wherein the memory stores a computer program, and when the computer program is executed by the processor, the processor executes the steps of the 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system.
[0068] Another object of the present invention is to provide a computer-readable storage medium storing a computer program, which, when executed by a processor, enables the processor to execute the steps of the 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system.
[0069] Another object of the present invention is to provide an information data processing terminal, which is used to implement the 'force-position-speed' collaborative planning system that takes into account the dynamic characteristics of the robot flexible grinding and polishing system.
[0070] In combination with the above technical solutions and the technical problems solved, the advantages and positive effects of the technical solutions to be protected by the present invention are as follows:
[0071] First, the present invention is a typical robot grinding and polishing process parameter planning problem. By considering the dynamic characteristics of the robot in the robot flexible grinding and polishing system and the response characteristics of the force-controlled actuator, a "force-position-speed" collaborative planning system of the robot flexible grinding and polishing process is realized.
[0072] Second, as auxiliary evidence of the inventiveness of the claims of the present invention, it is also reflected in the following important aspects:
[0073] (1) The expected benefits and commercial value of the technical solution of the present invention after transformation are:
[0074] The present invention proposes a 'force-position-speed' collaborative planning method that considers the dynamic characteristics of a flexible grinding and polishing system in robot grinding and polishing. In actual commercial applications, it can be mainly used in the field of industrial automation to improve the accuracy of robot force-controlled grinding and polishing, improve the surface quality and contour accuracy of complex curved parts, reduce production costs, and improve production quality.
[0075] (2) The technical solution of the present invention fills the technical gap in the industry at home and abroad:
[0076] In the industry applications of existing robots used in automated grinding and polishing, when industrial robots are used for force-controlled grinding and polishing, the dynamic characteristics of the robot during the grinding and polishing process are not considered, which will affect the grinding and polishing accuracy. The method proposed in the present invention that considers the dynamic characteristics of the grinding and polishing system can fill the technical gap in the industry caused by improper speed planning of robot force-controlled grinding and polishing, which is characterized by low force control accuracy and poor position accuracy.
[0077] (3) The technical solution of the present invention overcomes technical prejudice:
[0078] The planning of grinding force and grinding speed in traditional robot grinding and polishing is usually a single-objective optimization. For example, optimizing the grinding force or the grinding speed alone makes it difficult to achieve a better combination of grinding and polishing process parameters by optimizing multiple objectives at the same time. The present invention overcomes the limitations of single-objective optimization through multi-objective optimization.
[0079] Third, the method provided by the embodiment of the present invention solves multiple problems of the prior art in industrial applications and brings about significant technological progress. The following is a detailed description of these progress and problem solving:
[0080] 1) Technical problem solving:
[0081] -Speed and force coordination planning: Speed and force coordination planning is crucial in the grinding and polishing process. Traditional methods fail to consider the dynamic characteristics of the robot grinding and polishing system when planning these two parameters, resulting in unstable processing quality. The present invention achieves speed and force coordination planning by considering the robot's kinematic and dynamic constraints and the dynamic characteristics of the force-controlled actuator.
[0082] - Consideration of system dynamics: Previous methods did not fully consider the dynamics of the robot and force-controlled actuators, which led to problems in actual operation. This invention incorporates these characteristics into the planning process through detailed dynamic modeling, improving the stability and performance of the system.
[0083] 2) Technological progress:
[0084] - Improve processing efficiency and quality: By optimizing the speed model, the present invention can improve grinding and polishing efficiency while ensuring processing quality. This is especially important in large-scale production environments, which can significantly reduce production time and costs.
[0085] - Improve system stability and reliability: By comprehensively considering the dynamic characteristics of the robot and the force-controlled actuator, the present invention can reduce system vibration and error, thereby improving the overall stability and reliability.
[0086] -Realize refined control: By establishing accurate force constraint equations and material removal models, the present invention can achieve refined control of the grinding and polishing process, further improving processing accuracy and surface quality.
[0087] In summary, the technical solution of the present invention not only solves the problems of the prior art, but also brings about significant technological progress, providing strong support for the industrial application of the robot flexible grinding and polishing system. BRIEF DESCRIPTION OF THE DRAWINGS
[0088] Figure 1 A flow chart of a method for planning a grinding and polishing speed-force process provided by an embodiment of the present invention;
[0089] Figure 2 A schematic diagram of a force-controlled actuator and a schematic diagram of force balance provided for the implementation of the present invention;
[0090] Figure 3 A schematic diagram of recommended equipment provided by an embodiment of the present invention;
[0091] Figure 4 A schematic diagram of speed planning and speed error provided by an embodiment of the present invention and a comparative method;
[0092] Figure 5 A schematic diagram of planning force and force error provided by an embodiment of the present invention and a comparative method;
[0093] Figure 6 A schematic diagram of actual polishing depth removal error between an embodiment of the present invention and a comparative method. DETAILED DESCRIPTION
[0094] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not used to limit the present invention.
[0095] The embodiment of the present invention provides a 'force-position-speed' collaborative planning method considering the dynamic characteristics of a robot flexible grinding and polishing system, which specifically includes the following steps:
[0096] S1: Establish the position spline and direction spline of the grinding and polishing path
[0097] According to the grinding and polishing path, the position and direction of the grinding and polishing path are expressed by Euler angles in the workpiece coordinate system, and the position spline and direction spline are established respectively using B-spline. The position spline and direction spline ensure the smoothness and accuracy of the path through the local support and adjustment capabilities of B-spline.
[0098] S2: Building a speed-optimized model
[0099] According to the specific scenario of grinding and polishing, a speed optimization model with the goal of optimizing grinding and polishing efficiency is established, and the speed-arc length curve is represented by B-spline. Specifically, by optimizing the total time and total arc length of the grinding and polishing path, the relationship between the speed curve and the arc length is represented by the cubic B-spline curve, thereby optimizing the grinding and polishing feed speed.
[0100] S3: Establish the kinematic and dynamic constraint equations on the robot side
[0101] In the process of feed speed planning, the kinematic and dynamic constraints of the robot are considered and the corresponding constraint equations are established. Kinematic constraints include path constraints and joint constraints, and dynamic constraints include the displacement, velocity, acceleration and dynamic equations of the robot joints. By comprehensively considering these constraints, the stability and accuracy of the robot during the grinding and polishing process are ensured.
[0102] S4: Analyzing the system response equations of force-controlled actuators
[0103] The force-controlled actuator is simplified into a dual-mass spring-damper system, its system response equation is analyzed, and the constraint equations of grinding and polishing force, grinding and polishing force derivative and grinding and polishing speed are established according to the material removal model. By introducing a PI controller, a force-controlled error transfer function is established, and the dynamic characteristics of the force-controlled actuator are considered to improve the accuracy of force control during the grinding and polishing process.
[0104] S5: Process parameter planning under kinetic mixing constraints
[0105] According to the dynamic mixed constraint conditions, the method of dynamically adjusting the control points with segmented B-spline is adopted to realize the process parameter planning of grinding feed speed and grinding force. Through the adjustment of segmented B-spline, the optimization of feed speed and grinding force in the grinding process is ensured, thereby improving the grinding efficiency and quality.
[0106] Industrial application example 1: high-precision mold polishing
[0107] In high-precision mold processing, the surface quality of the mold directly affects the precision and service life of the product. Through the "force-position-speed" collaborative planning method of the present invention, the grinding and polishing path, feed speed and grinding and polishing force can be accurately controlled during the grinding and polishing process, thereby achieving high-quality polishing of the mold surface. The specific implementation steps include:
[0108] 1) Establish the mold grinding and polishing path: According to the three-dimensional model of the mold, use B-spline to establish the position spline and direction spline of the grinding and polishing path.
[0109] 2) Optimize grinding and polishing speed: According to the material and grinding and polishing requirements of the mold, a speed optimization model is established, and the speed-arc length curve is represented by cubic B-spline to optimize the grinding and polishing feed speed.
[0110] 3) Consider kinematic and dynamic constraints: During the grinding and polishing process, the kinematic and dynamic constraints of the robot are considered to ensure the stability and accuracy of the grinding and polishing process.
[0111] 4) Optimize grinding and polishing force control: By analyzing the system response of the force control actuator, the constraint equation of the grinding and polishing force is established to ensure accurate control of the grinding and polishing force.
[0112] 5) Parameter planning: According to the dynamic mixed constraints, the control points are dynamically adjusted using segmented B-splines to optimize the grinding feed speed and grinding force.
[0113] Through this method, the polishing quality of the mold surface is significantly improved, achieving high-precision and high-quality processing effects.
[0114] Industrial application example 2: Aircraft engine blade repair
[0115] Aircraft engine blades will be worn and damaged during long-term use and need to be repaired. Through the "force-position-speed" collaborative planning method of the present invention, the grinding and polishing path, feed speed and grinding and polishing force can be accurately controlled during the blade repair process, thereby achieving high-quality repair of the blade surface. The specific implementation steps include:
[0116] 1) Establish blade grinding and polishing path: Based on the 3D scanning data of the blade, use B-spline to establish the position spline and direction spline of the grinding and polishing path.
[0117] 2) Optimize grinding and polishing speed: According to the material and grinding and polishing requirements of the blade, a speed optimization model is established, and the speed-arc length curve is represented by cubic B-spline to optimize the grinding and polishing feed speed.
[0118] 3) Consider kinematic and dynamic constraints: During the grinding and polishing process, the kinematic and dynamic constraints of the robot are considered to ensure the stability and accuracy of the grinding and polishing process.
[0119] 4) Optimize grinding and polishing force control: By analyzing the system response of the force control actuator, the constraint equation of the grinding and polishing force is established to ensure accurate control of the grinding and polishing force.
[0120] 5) Parameter planning: According to the dynamic mixed constraints, the control points are dynamically adjusted using segmented B-splines to optimize the grinding feed speed and grinding force.
[0121] Through this method, the repair quality of the blade surface is significantly improved, restoring its original performance and service life, ensuring the safe operation of the aircraft engine.
[0122] like Figure 1 As shown, an embodiment of the present invention provides a 'force-position-speed' collaborative planning method considering the dynamic characteristics of a robot flexible grinding and polishing system, the method comprising:
[0123] S1, establishing the position spline and direction spline of the grinding and polishing path according to the grinding and polishing path.
[0124] S2, according to the specific scenario of grinding and polishing, a speed optimization model with the goal of optimizing grinding and polishing efficiency is established, and the speed-arc length curve is represented by B-spline;
[0125] S3, establish the constraint equations of robot kinematics and dynamics on the robot side of the robot flexible grinding and polishing system;
[0126] S4, analyze the system response equation of the force-controlled actuator, and establish the constraint equations of the grinding and polishing force, the grinding and polishing force derivative, and the grinding and polishing speed according to the material removal model.
[0127] S5, according to the dynamic mixed constraint conditions, the method of dynamically adjusting the control points using segmented B-spline is used to realize the process parameter planning of grinding feed speed-grinding force.
[0128] In step S1, the position spline and the direction spline of the grinding and polishing path are established. Specifically, since the grinding and polishing path can be represented by the Euler angle as [P, Θ] in the workpiece coordinate system, the position spline P (ω) and the direction spline Θ (η) of the grinding and polishing path can be established by B-spline respectively;
[0129] The material removal model equation used is:
[0130]
[0131] Where h is the material removal depth, k h is the material removal equation coefficient, v is the grinding feed speed, n is the spindle speed, F is the grinding force, c t With c w is the curvature of the tool and the workpiece.
[0132] Furthermore, in step S2, a speed optimization model is established with the goal of optimizing the grinding and polishing efficiency, and the specific form of the speed-arc length curve represented by B-spline is:
[0133]
[0134] Where t is the total grinding and polishing time, s is the total arc length of the grinding and polishing path, S Σ is the total arc length of the polishing path, is the feed rate;
[0135] Since B-spline has the advantages of local support and strong local adjustment ability, the cubic B-spline curve Ψ(u) = (s, v) is used to express the relationship between the velocity curve and the arc length:
[0136]
[0137] where u∈[0,1] is the spline parameter, B i,p (u) is the spline basis function, V i are the spline control points.
[0138] Furthermore, the step S3 of establishing the constraint equations of robot kinematics and dynamics on the robot side in the robot flexible polishing system specifically includes:
[0139] First, in the process of feed rate planning and optimization, the motion constraints on the robot side include path constraints and joint constraints; path constraints refer to the feed rate constraints and acceleration constraints in the Cartesian space during the robot grinding process, which are expressed by the following constraint equation:
[0140]
[0141] Where V max and A max are the robot’s terminal velocity and acceleration constraints;
[0142] Since the robot is directly driven by 6 joint axes, the robot joint constraints also need to be considered in the grinding feed rate planning; the robot joint constraints include joint motion constraints and dynamic constraints; the joint motion constraints come from the displacement, velocity and acceleration of the robot joints, and the constraint equations are as follows:
[0143]
[0144] in represents the robot joint value, joint velocity and acceleration; ik(s) represents the robot kinematics inverse solution function; represents the robot joint motion constraint value; q′=dq / ds, q″=d 2 q / ds 2 Represents the first and second order partial derivatives of the robot joints with respect to the arc length of the terminal motion;
[0145] The above are the kinematic constraints of the robot. The dynamic equation of the robot can be expressed as:
[0146]
[0147] where τ 6×1 represents the robot joint motion vector, M 6×6 is the robot inertia matrix, C 6×6 is the Coriolis force matrix, G 6×1 is the gravity component matrix, τ f6×1 represents the friction torque, τ load6×1 is the robot joint torque value caused by the external load;
[0148] Substituting equation (5) into equation (6), we can obtain the constraint condition considering the dynamic characteristics of the robot as follows:
[0149]
[0150] where τ max is the robot dynamic torque constraint value.
[0151] like Figure 2 As shown, the system response equation of the force-controlled actuator analyzed in step S4 is used to establish the constraint equations of the grinding and polishing force, the grinding and polishing force derivative and the grinding and polishing speed according to the material removal model, which specifically includes:
[0152] The force control actuator can be simplified as a dual-mass spring-damper system, F m (t) is the motor output torque, F o (t) is the actual grinding contact force of the force-controlled actuator, m1 is the load mass on the motor side, m2 is the mass on the load side, c is the damping coefficient on the motor side, x1(t) is the output displacement on the motor side, x2(t) is the displacement on the load side, k1 is the spring stiffness, k e is the environmental stiffness; the equilibrium equation of the force-controlled actuator is expressed as:
[0153]
[0154] The above expression can be used to obtain the force transfer function of the force-controlled actuator through Laplace transform:
[0155]
[0156] Where s represents the Laplace variable. When using the end effector to grind high-rigidity parts, the system can be simplified to a second-order system:
[0157]
[0158] By introducing the PI controller, the closed-loop transfer function of the force control actuator is:
[0159]
[0160] The force control error transfer function can be expressed by the following equation:
[0161]
[0162] In the grinding and polishing process, since the actual force control actuator is a discrete system, the force control actuator will produce response errors when tracking the required force; the force control signal in each control cycle is regarded as a ramp signal The control error equation is as follows:
[0163]
[0164] According to the above force control error equation, when the robot is grinding, the derivative of the grinding force will affect the force control accuracy of the force control actuator, and the derivative of the grinding force will also affect the grinding feed speed; therefore, the derivative of the grinding force needs to be considered when planning the grinding feed speed, and the force constraint equation in the grinding and polishing speed planning is established as:
[0165]
[0166] The relationship between the above formula and the grinding feed speed is established through the material removal model:
[0167]
[0168] in The above formula can be converted into:
[0169]
[0170] further, It can be calculated by the following formula:
[0171]
[0172] Therefore, the constraint equation of the dynamic characteristics of the force-controlled actuator is considered in the grinding and polishing speed planning:
[0173]
[0174] Furthermore, in step S5, according to the dynamic hybrid constraint condition, the method of dynamically adjusting the control point by segmented B-spline is adopted to realize the process parameter planning of grinding feed speed-grinding force. The specific steps are:
[0175] According to steps S1-S4, the optimization equation for optimizing the grinding and polishing efficiency and considering the dynamic characteristics of the robot flexible grinding and polishing system is established as follows:
[0176]
[0177] like Figure 3 , which is a schematic diagram of recommended equipment used in an embodiment of the present invention;
[0178] like Figure 4 , Figure 5 As shown in the figure, compared with the planning method that does not consider the dynamic constraints of the robot, the speed error and force control error of the method proposed by the present invention are reduced, indicating that the planning algorithm proposed by the present invention can obtain higher force control accuracy and speed accuracy. Figure 6The figure shows the comparison of the grinding and polishing material removal depth errors. It can be concluded that the method proposed in the present invention benefits from the improvement of force control accuracy and speed accuracy, and can achieve higher grinding and polishing material removal accuracy when applied to actual grinding and polishing.
[0179] 1. Specific application fields or related products of the present invention.
[0180] The embodiment of the present invention provides a 'force-position-speed' collaborative planning system considering the dynamic characteristics of a robot flexible grinding and polishing system, which implements the 'force-position-speed' collaborative planning method considering the dynamic characteristics of a robot flexible grinding and polishing system, and the system includes:
[0181] Position spline and direction spline establishment module, which establishes the position spline and direction spline of the grinding and polishing path according to the grinding and polishing path;
[0182] The model building module is connected with the position spline and direction spline building modules. According to the specific scenario of grinding and polishing, a speed optimization model with the goal of optimizing grinding and polishing efficiency is established, and the speed-arc length curve is represented by B-spline;
[0183] Constraint equation establishment module, establishes the constraint equations of robot kinematics and dynamics on the robot side in the robot flexible grinding and polishing system; analyzes the system response equations of the force-controlled actuator, and establishes the constraint equations of grinding and polishing force, grinding and polishing force derivative and grinding and polishing speed according to the material removal model;
[0184] The planning implementation module is connected with the constraint equation establishment module. According to the dynamic mixed constraint conditions, the segmented B-spline dynamic adjustment control point method is adopted to realize the process parameter planning of grinding feed speed-grinding force.
[0185] An embodiment of the present invention provides a computer device, which includes a memory and a processor, wherein the memory stores a computer program, and when the computer program is executed by the processor, the processor executes the steps of the 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system.
[0186] An embodiment of the present invention provides a computer-readable storage medium storing a computer program. When the computer program is executed by a processor, the processor executes the steps of the 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system.
[0187] An embodiment of the present invention provides an information data processing terminal, which is used to implement the 'force-position-speed' collaborative planning system that takes into account the dynamic characteristics of the robot flexible grinding and polishing system.
[0188] 2. Relevant evidence of the technical effects obtained by the embodiments of the present invention.
[0189] The experimental verification was carried out on the actual robot blade grinding and polishing, and the dynamic characteristics of the robot flexible grinding and polishing system were not considered as a control test. The grinding and polishing material removal depth was set to 20μm, and the grinding was performed four times, that is, the single grinding and polishing depth was 5μm. The electric spindle speed was set to 18000rpm, and the model coefficient was k h =1.2299×10 -6 , the grinding tool has a particle size of 800 mesh and a radius of 4 mm. The constraint condition on the force side is set to F max =4N, The robot's Cartesian motion constraints are set to v max =5mm / s, a max =10mm / s 2 .
[0190] The actual speed during grinding and polishing is Figure 4 As shown in the figure, the results show that the proposed method reduces the maximum feed speed error in the grinding and polishing process from 0.5435 mm / s to 0.4327 mm / s, which is 20.39% lower than the comparison method. The actual grinding and polishing force results are shown in Figure 5 As shown in the figure, the maximum absolute force control error in the grinding and polishing process decreased from 0.6357N to 0.4740N, a decrease of 25.44%. The standard deviation of the grinding and polishing force control error decreased from 0.1072N to 0.0759N, a decrease of 29.20%. The results show that by considering the dynamic characteristics of the robot flexible grinding and polishing system in the process of grinding and polishing process parameter planning, the force control accuracy in the grinding and polishing process is improved, the force fluctuation is reduced, and the force control effect is more stable.
[0191] like Figure 6 As shown in the figure, the grinding and polishing profiles before and after grinding and polishing were measured by a three-dimensional coordinate measuring machine. The maximum material removal error of the proposed method was 8.89μm (2.22μm / time) by calculating the grinding and polishing material removal depth error, which was basically consistent with the maximum profile error of the comparative method of 9.15μm (2.29μm / time). However, the average profile error of the proposed method was 2.83μm (0.71μm / time), while that of the comparative method was 3.76μm (0.94μm / time), which was a 24.73% reduction in average error compared with the comparative method. These results show that the proposed method improves the dynamic stability of the grinding and polishing feed speed and force control by considering the mixed dynamic constraints of the grinding and polishing system, thereby improving the consistency of the grinding and polishing surface quality.
[0192] It should be noted that the embodiments of the present invention can be implemented by hardware, software, or a combination of software and hardware. The hardware part can be implemented using dedicated logic; the software part can be stored in a memory and executed by an appropriate instruction execution system, such as a microprocessor or dedicated design hardware. It can be understood by a person of ordinary skill in the art that the above-mentioned devices and methods can be implemented using computer executable instructions and / or contained in a processor control code, such as a carrier medium such as a disk, CD or DVD-ROM, a programmable memory such as a read-only memory (firmware), or a data carrier such as an optical or electronic signal carrier. Such code is provided on the carrier medium. The device and its modules of the present invention can be implemented by hardware circuits such as very large-scale integrated circuits or gate arrays, semiconductors such as logic chips, transistors, etc., or programmable hardware devices such as field programmable gate arrays, programmable logic devices, etc., can also be implemented by software executed by various types of processors, and can also be implemented by a combination of the above-mentioned hardware circuits and software, such as firmware.
[0193] The above description is only a specific implementation mode of the present invention, but the protection scope of the present invention is not limited thereto. Any modifications, equivalent substitutions and improvements made by any technician familiar with the technical field within the technical scope disclosed by the present invention and within the spirit and principle of the present invention should be covered by the protection scope of the present invention.
Claims
1. A 'force-position-speed' collaborative planning method considering the dynamic characteristics of a robot flexible grinding and polishing system, characterized in that: The method includes: S1, establishing the position spline and direction spline of the grinding and polishing path according to the grinding and polishing path; S2, according to the specific scenario of grinding and polishing, a speed optimization model with the goal of optimizing grinding and polishing efficiency is established, and the speed-arc length curve is represented by B-spline; S3, establish the constraint equations of robot kinematics and dynamics on the robot side of the robot flexible grinding and polishing system; S4, analyzing the system response equation of the force-controlled actuator, and establishing the constraint equations of the grinding and polishing force, the grinding and polishing force derivative, and the grinding and polishing speed according to the material removal model; S5, according to the dynamic mixed constraint conditions, the method of dynamically adjusting the control points using segmented B-spline is used to realize the process parameter planning of grinding feed speed-grinding force.
2. The 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system according to claim 1 is characterized in that: In step S1, the position spline and the direction spline of the grinding and polishing path are established. Specifically, since the grinding and polishing path can be represented by the Euler angle as [P, Θ] in the workpiece coordinate system, the position spline P (ω) and the direction spline Θ (η) of the grinding and polishing path can be established by B-spline respectively; The material removal model equation used is: Where h is the material removal depth, k h is the material removal equation coefficient, v is the grinding feed speed, n is the spindle speed, F is the grinding force, c is t With c w is the curvature of the tool and the workpiece.
3. The 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system according to claim 1 is characterized in that: The speed optimization model for optimizing the grinding and polishing efficiency is established in step S2, and the specific form of the speed-arc length curve represented by B-spline is: Where t is the total grinding and polishing time, s is the total arc length of the grinding and polishing path, S ∑ is the total arc length of the polishing path, is the feed rate; Since B-spline has the advantages of local support and strong local adjustment ability, the cubic B-spline curve Ψ(u) = (s, v) is used to express the relationship between the velocity curve and the arc length: where u∈[0,1] is the spline parameter, B i,p (u) is the spline basis function, V i are the spline control points.
4. The 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system according to claim 1 is characterized in that: The step S3 of establishing the constraint equations of robot kinematics and dynamics on the robot side of the robot flexible polishing system specifically includes: First, in the process of feed rate planning and optimization, the motion constraints on the robot side include path constraints and joint constraints; path constraints refer to the feed rate constraints and acceleration constraints in the Cartesian space during the robot grinding process, which are expressed by the following constraint equation: Where V max and A max are the robot’s terminal velocity and acceleration constraints; Since the robot is directly driven by 6 joint axes, the robot joint constraints also need to be considered in the grinding feed rate planning; the robot joint constraints include joint motion constraints and dynamic constraints; the joint motion constraints come from the displacement, velocity and acceleration of the robot joints, and the constraint equations are as follows: in represents the robot joint value, joint velocity and acceleration; ik(s) represents the robot kinematics inverse solution function; represents the robot joint motion constraint value; q′=dq / ds, q″=d 2 q / ds 2 Represents the first and second order partial derivatives of the robot joints with respect to the arc length of the terminal motion; The above are the kinematic constraints of the robot. The dynamic equation of the robot can be expressed as: where τ 6×1 represents the robot joint motion vector, M 6×6 is the robot inertia matrix, C 6×6 is the Coriolis force matrix, G 6×1 is the gravity component matrix, τ f6×1 represents the friction torque, τ load6×1 is the robot joint torque value caused by the external load; Substituting equation (5) into equation (6), we can obtain the constraint condition considering the dynamic characteristics of the robot as follows: where τ max is the robot dynamic torque constraint value.
5. The 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system according to claim 1 is characterized in that: The system response equation of the force-controlled actuator is analyzed in step S4, and the constraint equations of the grinding and polishing force, the grinding and polishing force derivative and the grinding and polishing speed are established according to the material removal model, which specifically includes: The force control actuator can be simplified as a dual-mass spring-damper system, F m (t) is the motor output torque, F o (t) is the actual grinding contact force of the force-controlled actuator, m1 is the load mass on the motor side, m2 is the mass on the load side, c is the damping coefficient on the motor side, x1(t) is the output displacement on the motor side, x2(t) is the displacement on the load side, k1 is the spring stiffness, k e is the environmental stiffness; the equilibrium equation of the force-controlled actuator is expressed as: The above expression can be used to obtain the force transfer function of the force-controlled actuator through Laplace transform: Where s represents the Laplace variable. When using the end effector to grind high-rigidity parts, the system can be simplified to a second-order system: By introducing the PI controller, the closed-loop transfer function of the force control actuator is: The force control error transfer function can be expressed by the following equation: In the grinding and polishing process, since the actual force control actuator is a discrete system, the force control actuator will produce response errors when tracking the required force; the force control signal in each control cycle is regarded as a ramp signal The control error equation is as follows: According to the above force control error equation, when the robot is grinding, the derivative of the grinding force will affect the force control accuracy of the force control actuator, and the derivative of the grinding force will also affect the grinding feed speed; therefore, the derivative of the grinding force needs to be considered when planning the grinding feed speed, and the force constraint equation in the grinding and polishing speed planning is established as: The relationship between the above formula and the grinding feed speed is established through the material removal model: in The above formula can be converted into: further, It can be calculated by the following formula: Therefore, the constraint equation of the dynamic characteristics of the force-controlled actuator is considered in the grinding and polishing speed planning:
6. The 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system according to claim 1 is characterized in that: The step S5 uses a segmented B-spline method to dynamically adjust the control points according to the dynamic hybrid constraint conditions to achieve the process parameter planning of the grinding feed speed-grinding force. The specific steps are: According to steps S1-S4, the optimization equation for optimizing the grinding and polishing efficiency and considering the dynamic characteristics of the robot flexible grinding and polishing system is established as follows:
7. A 'force-position-speed' collaborative planning system considering the dynamic characteristics of a robot flexible grinding and polishing system implementing the 'force-position-speed' collaborative planning method considering the dynamic characteristics of a robot flexible grinding and polishing system as described in any one of claims 1 to 6, characterized in that: The system includes: Position spline and direction spline establishment module, which establishes the position spline and direction spline of the grinding and polishing path according to the grinding and polishing path; The model building module is connected with the position spline and direction spline building modules. According to the specific scenario of grinding and polishing, a speed optimization model with the goal of optimizing grinding and polishing efficiency is established, and the speed-arc length curve is represented by B-spline; Constraint equation establishment module, establishes the constraint equations of robot kinematics and dynamics on the robot side in the robot flexible grinding and polishing system; analyzes the system response equations of the force-controlled actuator, and establishes the constraint equations of grinding and polishing force, grinding and polishing force derivative and grinding and polishing speed according to the material removal model; The planning implementation module is connected with the constraint equation establishment module. According to the dynamic mixed constraint conditions, the segmented B-spline dynamic adjustment control point method is adopted to realize the process parameter planning of grinding feed speed-grinding force.
8. A computer device, characterized in that: The computer device includes a memory and a processor, the memory stores a computer program, and when the computer program is executed by the processor, the processor executes the steps of the 'force-position-speed' collaborative planning method considering the dynamic characteristics of the robot flexible grinding and polishing system as described in any one of claims 1-6.
9. A computer-readable storage medium storing a computer program, which, when executed by a processor, causes the processor to execute the steps of the 'force-position-speed' collaborative planning method considering the dynamic characteristics of a robot flexible grinding and polishing system as described in any one of claims 1 to 6.
10. An information data processing terminal, characterized in that: The information data processing terminal is used to implement the 'force-position-speed' collaborative planning system considering the dynamic characteristics of the robot flexible grinding and polishing system as described in claim 7.
Citation Information
Patent Citations
Cooperative robot compliance force control method and system
CN111037560A
Grinding robot force / position hybrid control method and system considering error constraint
CN113110051A
Robot grinding and polishing force-position-speed collaborative process planning method, system and terminal
CN115213901A
Grinding and polishing robot fuzzy variable impedance control method based on fast terminal sliding mode
CN116512242A
Robot grinding and polishing force hybrid control method and system for large-variable-curvature complex structural part
CN118181144A
Cited By
Robot surface lining sorting system based on ISWO algorithm trajectory planning
CN119748825A
A robot face cover sorting system based on ISWO algorithm trajectory planning
CN119748825B
Grinding and polishing control method and control system based on sliding mode control
CN119927805A
Blade deterministic robot grinding and polishing method based on mixed B spline curve
CN121245648A
Track optimization method and system considering redundancy characteristics of robot macro-micro force control grinding and polishing system
CN121680286A
