End effector polishing control method based on chicken flock optimization algorithm
Through the grinding control method based on the flock optimization algorithm, the problems of low control accuracy and large response delay in the surface processing of complex workpieces are solved, adaptive control of complex surfaces and real-time PID parameter optimization are realized, and grinding efficiency and surface quality are improved.
Patent Information
- Application Number
- CN202411417040.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-11
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2044-10-11
AI Technical Summary
The existing grinding control technology has problems such as low control accuracy, large response delay and disconnection between path and force control in the surface processing of complex workpieces. It is difficult to achieve adaptive control of complex curved surfaces and real-time PID parameter optimization, resulting in low machining efficiency and accuracy.
Using the end effector grinding control method based on the chicken flock optimization algorithm, three-dimensional digital and analog data are obtained through the visual camera, combined with the iterative nearest point algorithm to calculate the grinding amount and force, and using the chicken flock optimization algorithm to synchronize the grinding trajectory and PID parameters to achieve Dynamic adjustment and adaptive control of forces and paths.
It significantly improves the accuracy and consistency of complex surface machining, reduces the situation of excessive or insufficient grinding, improves the system response speed and control accuracy, realizes the deep integration optimization of path and force control, and improves machining efficiency and surface quality.
Smart Images

Figure CN119057699A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of intelligent control and optimization algorithms for grinding and polishing equipment, and in particular to a grinding control method for an end effector based on a flock optimization algorithm. Background Art
[0002] Grinding control technology is widely used in the surface treatment and finishing of various workpieces such as metals and ceramics. Its purpose is to control the grinding force and grinding path to make the workpiece surface achieve the predetermined smoothness and shape accuracy.
[0003] Existing grinding control systems usually use fixed force control or a preset force correction formula for grinding to process the workpiece surface in a constant force manner. However: 1. The surface of complex workpieces often has features such as variable curves, unevenness, and edge mutations, which makes it difficult to achieve precise grinding with fixed force control in these scenarios, and it is easy to cause problems of over-grinding or under-grinding, seriously affecting the surface quality of the workpiece.
[0004] 2. In order to improve the accuracy of grinding control, the existing technology usually uses a six-dimensional force sensor to monitor the grinding force in real time and fine-tune it by controlling the end effector. The common adjustment method is to manually set the parameters of the PID controller, namely the proportional gain (Kp), integral gain (Ki) and differential gain (Kd). However, the manual adjustment of PID parameters is not only time-consuming, but also difficult to respond quickly according to real-time changes in the processing environment. It is often impossible to find the global optimal control solution under different working conditions, resulting in a decrease in system control accuracy and efficiency.
[0005] 3. In order to further improve the intelligent level of grinding path planning, existing technologies gradually introduce algorithms such as model predictive control (MPC) to optimize the grinding trajectory. However, the MPC algorithm has a large amount of calculation and slow response speed. Especially when dealing with complex surfaces or high-dynamic environments, the system has obvious delays and cannot meet the real-time requirements of the grinding process, resulting in low trajectory control accuracy and low processing efficiency.
[0006] In addition, most current grinding control technologies treat force control and path planning as independent processes. The disconnect between path and force can easily cause the grinding head to stay in certain areas for too long or force control to be inaccurate, resulting in defects on the grinding surface. To compensate for this defect, the industry has tried to integrate multiple control strategies, but the simultaneous optimization of path and force control is still difficult to achieve, and the overall processing efficiency and precision have been limited.
[0007] Therefore, how to achieve adaptive control of complex surfaces, real-time PID parameter optimization, and synchronous optimization of path and force to improve grinding accuracy and processing efficiency has become a technical problem to be solved by the present invention. Summary of the invention
[0008] The technical problem solved by the present invention is to provide an end effector grinding control method based on a swarm optimization algorithm in response to the defects existing in the above-mentioned prior art, so as to solve the problems of low control accuracy, large response delay and disconnection between path and force control in the existing grinding control method proposed in the above-mentioned background technology in the surface processing of complex workpieces.
[0009] In order to solve the above technical problems, the technical solution adopted by the present invention is as follows: A method for controlling the grinding of an end effector based on a flock optimization algorithm comprises the following steps: Step 1: Obtain the 3D digital model data of the workpiece to be polished, scan the surface shape of the workpiece to be polished with a visual camera, obtain its 3D model, and align it with the 3D model of a known standard sample, calculate the grinding amount and grinding force at each point of the workpiece, so as to achieve adaptive control of complex curved surfaces and edge mutation areas; Step 2: Use the swarm optimization algorithm to plan the grinding trajectory, transform the trajectory planning problem into a constraint solving problem, set the robot arm kinematic constraints, spatial obstacle avoidance constraints and the objective function of minimizing the total energy consumption, total time or trajectory smoothness during the grinding process, optimize the control points of the grinding trajectory or the path points of the robot arm joints, and realize the dynamic synchronous optimization of force control and trajectory planning; Step 3: During the grinding process, the swarm optimization algorithm is used to perform real-time self-tuning on the PID parameters of the motor or cylinder, automatically optimize the proportional gain, integral gain and differential gain, monitor the changes in grinding force and grinding amount through the six-dimensional force sensor, and dynamically optimize the control parameters in the initial adjustment and fine adjustment stages to ensure the accuracy and stability of force and position control in high dynamic scenarios.
[0010] As a further solution of the present invention, the acquisition of the three-dimensional digital model data includes acquiring the three-dimensional data of the workpiece to be polished by scanning with a visual camera, generating a grinding deviation value for each area, and constructing a color mapping diagram to display the area to be polished to adaptively adjust the grinding force.
[0011] As a further solution of the present invention, when the swarm optimization algorithm is used for trajectory planning, the trajectory planning and grinding force control are optimized simultaneously, and the planned optimal path can adapt to workpieces with irregular surfaces, complex curved surfaces and variable shapes to avoid the inaccuracy and inefficiency caused by the separation of path and force control.
[0012] As a further solution of the present invention, the objective function of the real-time self-tuning of the PID parameters includes the integrated square error, the integrated time-weighted square error or other control indicators related to system performance, and the PID parameter combination is optimized to achieve precise force control.
[0013] As a further solution of the present invention, the integrated optimization of trajectory planning and force control is iterated multiple times through a flock optimization algorithm to optimize the combination of polishing trajectory control points and PID parameters and realize a shared optimization strategy for path and force control.
[0014] As a further solution of the present invention, the alignment of the three-dimensional digital model data includes using an iterative closest point ICP algorithm to make the three-dimensional scanning data of the workpiece to be ground coincide with the three-dimensional digital model reference points of the standard sample to accurately calculate the grinding deviation value of each point.
[0015] As a further solution of the present invention, the grinding force is determined by comprehensively considering the hardness of the material, grinding depth, grinding tool characteristics and grinding speed, and the grinding force at each point is comprehensively determined by theoretical formulas and empirical parameters.
[0016] As a further solution of the present invention, the grinding trajectory planning includes setting the joint angle, speed and acceleration limits of the robot arm to avoid collision with the workpiece or other equipment during the grinding process.
[0017] As a further solution of the present invention, when the flock optimization algorithm is used to optimize the grinding trajectory, the individuals are divided into three categories: roosters, hens and chicks according to the fitness values, and the grinding trajectory control points are optimized through multiple iterations until the termination conditions are met.
[0018] As a further solution of the present invention, the PID control process uses feedback data from a six-dimensional force sensor to perform error calculations and outputs control signals to the motor or cylinder to adjust the output force and position during the grinding process in real time; the PID parameter self-tuning performs fitness evaluation after each adjustment, and gradually optimizes the control system performance by minimizing the fitness, so that the system maintains the best state in a complex and dynamic grinding environment.
[0019] Compared with the prior art, the present invention has the following beneficial effects: 1. Adaptive gain control of complex surfaces: The present invention obtains the three-dimensional model of the workpiece through a visual camera, and combines it with the iterative closest point (ICP) algorithm for precise alignment, calculates the grinding force and grinding amount of each point, and realizes adaptive control of complex surfaces and edge mutation areas. Compared with the traditional constant force grinding method, the present invention can dynamically adjust the grinding force, thereby effectively avoiding excessive or insufficient modification, significantly improving the processing quality and consistency of the surface of complex workpieces, and overcoming the problem of control failure of the existing technology when dealing with complex working conditions.
[0020] 2. Efficient application of real-time customized PID parameter self-tuning: The present invention uses a flock optimization algorithm to perform real-time self-tuning on the PID parameters of the motor or cylinder, automatically optimizes the control parameters, and enables the system to achieve dynamic optimization in the initial adjustment and fine adjustment stages. This method overcomes the hysteresis and inaccuracy of traditional manual adjustment of PID parameters, especially in the processing of highly reflective or unevenly hard workpieces, can significantly improve the response speed and control accuracy of the system, avoid vibration, scratches and other problems caused by parameter mismatch, and enable the control system to always maintain optimal performance in a complex dynamic environment.
[0021] 3. Deep integration optimization of path and force control: The present invention deeply integrates grinding trajectory planning with force control, and performs multiple iterations of optimization through the flock optimization algorithm, so that the path and force control can be adjusted synchronously in a dynamic environment, breaking through the bottleneck of reduced accuracy and low efficiency caused by the separate control of path and force in the prior art. This shared optimization strategy effectively reduces unnecessary pauses and repeated actions, improves grinding efficiency and surface quality, and is particularly suitable for the processing of workpieces with irregular shapes, complex curved surfaces and variable components.
[0022] 4. Efficient and accurate real-time optimization capability: The use of swarm optimization algorithm for simultaneous optimization of trajectory and parameters not only reduces the computational complexity, but also significantly saves processing time. Compared with traditional model predictive control (MPC), it greatly reduces the amount of calculation and delay of trajectory planning, and improves real-time performance and overall efficiency. The system can monitor and adjust the grinding force and grinding amount of each point in real time during the grinding process, ensuring the efficiency and accuracy of the grinding process, and greatly improving the surface quality of the workpiece.
[0023] 5. Enhanced system stability and adaptability: The present invention ensures the stability of the system under complex working conditions by adjusting the force and trajectory planning in real time. Combined with the swarm optimization algorithm to coordinate the optimization of PID parameters and grinding trajectories, the control system has stronger adaptability and can cope with diverse workpiece requirements, thereby greatly expanding the application scope and flexibility of the system and improving the market competitiveness of the product.
[0024] Additional aspects and advantages of the present invention will be given in part in the following description and in part will be obvious from the following description, or will be learned through practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS
[0025] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.
[0026] Figure 1 4 is a flow chart of a control method in an embodiment of the present invention.
[0027] Figure 2 It is a technical roadmap for CSO planning and polishing trajectory in an embodiment of the present invention.
[0028] Figure 3 It is a technical roadmap for CSO tuning PID parameters in an embodiment of the present invention. DETAILED DESCRIPTION
[0029] The technical solutions in the embodiments of the present invention are described clearly and completely below. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of them. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0030] See also Figure 1 —3. In an embodiment of the present invention, a grinding control method for an end effector based on a flock optimization algorithm comprises the following steps: Step 1: Obtain the 3D digital model data of the workpiece to be polished, scan the surface shape of the workpiece to be polished with a visual camera, obtain its 3D model, and align it with the 3D model of a known standard sample, calculate the grinding amount and grinding force at each point of the workpiece, so as to achieve adaptive control of complex curved surfaces and edge mutation areas; Step 2: Use the swarm optimization algorithm to plan the grinding trajectory, transform the trajectory planning problem into a constraint solving problem, set the robot arm kinematic constraints, spatial obstacle avoidance constraints and the objective function of minimizing the total energy consumption, total time or trajectory smoothness during the grinding process, optimize the control points of the grinding trajectory or the path points of the robot arm joints, and realize the dynamic synchronous optimization of force control and trajectory planning; Step 3: During the grinding process, the swarm optimization algorithm is used to perform real-time self-tuning on the PID parameters of the motor or cylinder, automatically optimize the proportional gain, integral gain and differential gain, monitor the changes in grinding force and grinding amount through the six-dimensional force sensor, and dynamically optimize the control parameters in the initial adjustment and fine adjustment stages to ensure the accuracy and stability of force and position control in high dynamic scenarios.
[0031] As a further solution of the present invention, the acquisition of the three-dimensional digital model data includes acquiring the three-dimensional data of the workpiece to be polished by scanning with a visual camera, generating a grinding deviation value for each area, and constructing a color mapping diagram to display the area to be polished to adaptively adjust the grinding force.
[0032] As a further solution of the present invention, when the swarm optimization algorithm is used for trajectory planning, the trajectory planning and grinding force control are optimized simultaneously, and the planned optimal path can adapt to workpieces with irregular surfaces, complex curved surfaces and variable shapes to avoid the inaccuracy and inefficiency caused by the separation of path and force control.
[0033] As a further solution of the present invention, the objective function of the real-time self-tuning of the PID parameters includes the integrated square error, the integrated time-weighted square error or other control indicators related to system performance, and the PID parameter combination is optimized to achieve precise force control.
[0034] As a further solution of the present invention, the integrated optimization of trajectory planning and force control is iterated multiple times through a flock optimization algorithm to optimize the combination of polishing trajectory control points and PID parameters and realize a shared optimization strategy for path and force control.
[0035] As a further solution of the present invention, the alignment of the three-dimensional digital model data includes using an iterative closest point ICP algorithm to make the three-dimensional scanning data of the workpiece to be ground coincide with the three-dimensional digital model reference points of the standard sample to accurately calculate the grinding deviation value of each point.
[0036] As a further solution of the present invention, the grinding force is determined by comprehensively considering the hardness of the material, grinding depth, grinding tool characteristics and grinding speed, and the grinding force at each point is comprehensively determined by theoretical formulas and empirical parameters.
[0037] As a further solution of the present invention, the grinding trajectory planning includes setting the joint angle, speed and acceleration limits of the robot arm to avoid collision with the workpiece or other equipment during the grinding process.
[0038] As a further solution of the present invention, when the flock optimization algorithm is used to optimize the grinding trajectory, the individuals are divided into three categories: roosters, hens and chicks according to the fitness values, and the grinding trajectory control points are optimized through multiple iterations until the termination conditions are met.
[0039] As a further solution of the present invention, the PID control process uses feedback data from a six-dimensional force sensor to perform error calculations and outputs control signals to the motor or cylinder to adjust the output force and position during the grinding process in real time; the PID parameter self-tuning performs fitness evaluation after each adjustment, and gradually optimizes the control system performance by minimizing the fitness, so that the system maintains the best state in a complex and dynamic grinding environment.
[0040] Embodiment 1: This embodiment provides an end effector grinding control method based on a swarm optimization algorithm, which is applied to the high-precision grinding process of complex curved workpieces, and is particularly suitable for surface finishing of metal or ceramic workpieces with irregular surfaces, sudden edge changes, and uneven hardness.
[0041] In practical applications, the three-dimensional data of the workpiece to be polished is first obtained through a visual camera. Taking an aircraft engine blade as an example, the surface of the blade has a complex curved surface structure and a variable edge shape, and the traditional constant force polishing control cannot meet its high-precision surface quality requirements. The blade is scanned by a visual camera to obtain its three-dimensional model data, and aligned with the three-dimensional digital model of a known standard sample, and the iterative closest point (ICP) algorithm is used to accurately match the reference points of the two. By comparing the surface deviation of the workpiece to be polished and the standard sample, a color map showing the grinding requirements of each area is generated, so that the grinding amount and corresponding grinding force of each point are calculated to form the basic data for polishing.
[0042] After obtaining the basic data of grinding force and grinding amount, the swarm optimization algorithm is used to plan the grinding trajectory of the end effector. Specifically, the trajectory planning problem is transformed into a constraint solving problem, and the kinematic constraints of the robot arm (such as joint angle, speed, acceleration limit) and spatial obstacle avoidance constraints (avoid collision with workpieces or equipment) are set. By setting the objective function, such as minimizing the total energy consumption, grinding time or trajectory smoothness during the grinding process, the swarm optimization algorithm optimizes the grinding path into a set of control points and path points. During the optimization process, the swarm algorithm divides the group into three types of individuals: roosters, hens and chicks, and iteratively optimizes the control points according to the fitness value of each individual to achieve dynamic adjustment of the trajectory and planning of the optimal operation path. The core of this step is to optimize path planning and force control simultaneously to avoid the disadvantages of inaccuracy and inefficiency caused by the separation of path and force control.
[0043] During the grinding process, the system uses a swarm optimization algorithm to adjust the PID control parameters of the motor or cylinder in real time, including the proportional gain (Kp), integral gain (Ki), and differential gain (Kd), to achieve precise control of the grinding force and grinding amount. The self-tuning of PID parameters sets the performance indicators of the control system as the objective function, such as the integral square error or the integral time-weighted square error, and automatically searches for the optimal parameter combination through the swarm optimization algorithm. During the complex processing of the blade surface, the system can continuously adjust the grinding force and trajectory based on the real-time feedback data of the six-dimensional force sensor, so that the end effector can maintain the best force and position control under different working conditions; specifically, in Figure 3In the figure, Kp is the Proportional Gain, which is proportional to the current error. Increasing the proportional gain can speed up the system response, but too large a gain can cause oscillation. Ki is the Integral Gain, which is proportional to the accumulated value of the error. The integral gain can eliminate the steady-state error of the system, but too large a gain may cause the system to overshoot or oscillate. Kd is the Derivative Gain, which is proportional to the rate of change of the error. The derivative gain responds to rapid changes in the system response and can improve the stability of the system, but too large a gain may also introduce noise sensitivity.
[0044] For example, in the grinding of the sudden change area of the blade edge, the traditional control method is prone to over- or under-grinding due to inaccurate force control, resulting in defects such as irregular blade edges, vibrations, or surface scratches. This embodiment adjusts the PID parameters in real time and adaptively so that the grinding force remains stable in the edge area, avoiding the adverse consequences of traditional methods. Through real-time force control and trajectory planning synchronization optimization, the accuracy and uniformity of the grinding process are ensured, the processing quality of the workpiece is significantly improved, and the inefficiency caused by the disconnection between path planning and force control is avoided.
[0045] In summary, this embodiment achieves efficient grinding under complex surfaces and variable working conditions through the collaborative work of technical means such as visual cameras, flock optimization algorithms, and real-time PID control. This method significantly improves the accuracy, efficiency, and stability of the grinding process, especially when dealing with complex surfaces and high-dynamic environments, showing technical advantages that are difficult to achieve with traditional control methods. Through the above steps, the present invention solves the problems of low control accuracy, large response delay, and separation of path and force control in existing grinding control technologies, and provides an innovative solution for high-precision workpiece surface processing.
[0046] Embodiment 2: This embodiment demonstrates the application of an end-effector grinding control method based on a swarm optimization algorithm in the grinding of automobile engine cylinders. The grinding of automobile engine cylinders requires high precision and high efficiency, especially the complex surfaces of the cylinder inner wall and the raised structure. The traditional constant force grinding method is difficult to achieve precise processing of various parts, resulting in uneven grinding, surface defects or damage and other problems. This embodiment achieves efficient grinding of complex surfaces of the cylinder through innovative adaptive control and optimization algorithms.
[0047] In actual operation, the 3D model of the engine cylinder block is first scanned with a visual camera. The 3D digital model data of its inner wall and complex surface is obtained and aligned with the ideal model of the standard sample. The deviation value of the area to be polished is accurately calculated using the iterative closest point (ICP) algorithm. A color map is generated based on the deviation value to show the grinding requirements of each part, including the inner wall of the cylinder, the raised part and the groove area. This process can accurately identify the grinding amount of each point and calculate the corresponding grinding force to meet the grinding requirements of different parts of the cylinder block.
[0048] Next, the swarm optimization algorithm is used to plan the optimal operating trajectory of the robot arm and the end effector. By setting multiple constraints such as kinematics and spatial obstacle avoidance, and combining the goals that need to be minimized during the grinding process (such as total energy consumption, grinding time and trajectory smoothness), the swarm optimization algorithm automatically optimizes the trajectory control points. During the optimization process, the flock is divided into three types of individuals: roosters, hens and chicks. Each type of individual adjusts the trajectory according to the fitness value to ensure the simultaneous optimization of trajectory planning and grinding force control. This deeply integrated trajectory and force control avoids the inefficiency and uneven grinding problems caused by the separation of path and force control in traditional grinding methods.
[0049] During the actual grinding process, the system uses the swarm optimization algorithm to perform real-time self-tuning on the PID parameters of the motor and cylinder. Taking the grinding of the inner wall of the cylinder as an example, the traditional control method is difficult to maintain a constant grinding force due to uneven hardness or complex inner wall shape, and is prone to over- or under-grinding. By real-time monitoring of the feedback data of the six-dimensional force sensor, the swarm optimization algorithm automatically adjusts the proportional gain (Kp), integral gain (Ki) and differential gain (Kd) to ensure precise control of the grinding force and the end effector position. The adaptive PID parameter adjustment can continuously optimize the control performance in the initial stage of grinding, the transition stage and the fine grinding process, so that the system always maintains the best state in different grinding environments.
[0050] For example, in the grinding of the raised parts of the cylinder body, due to the small size and irregular shape of the raised parts, the conventional constant force control is prone to excessive grinding or damage of the raised parts due to force imbalance. This embodiment uses real-time self-tuning PID parameters to enable the grinding force to be quickly adjusted according to real-time feedback, thus avoiding defects caused by control misalignment during the grinding process. At the same time, the synchronous optimization of trajectory and force ensures the uniform movement and stable output of the grinding tool on complex surfaces, achieving high efficiency and accuracy in the grinding process.
[0051] This embodiment greatly improves the quality and efficiency of grinding through adaptive control of the complex surface of the cylinder and dynamic optimization of the flock optimization algorithm, avoiding the problems of low control accuracy, slow response and disconnection between path and force in traditional grinding methods. This method is particularly suitable for complex surfaces and variable processing scenarios, and provides an innovative and efficient solution for precision manufacturing and surface treatment of high-demand workpieces.
[0052] Embodiment 3: This embodiment demonstrates the application of an end-effector grinding control method based on a chicken swarm optimization algorithm (CSO) in the high-precision grinding of complex curved surface molds, which is particularly suitable for grinding mold surfaces with fine features, edge mutations, and drastic curvature changes. This method solves the problems of insufficient precision and low efficiency of traditional methods in complex surface processing through visual scanning, chicken swarm optimization algorithm, and real-time adaptive control. The specific implementation steps are as follows: Step 1: Acquisition of 3D digital model data and calculation of grinding amount: First, use a high-precision visual camera to scan the mold to be polished and obtain its 3D model data. For the small features, edge mutation areas and complex curvatures on the mold surface, the iterative closest point (ICP) algorithm is used to align the scan data with the 3D digital model of the standard sample. By comparing the surface deviation of the mold to be polished and the standard sample, the system generates the grinding amount and grinding force requirements for each point to form the basic data for polishing. At the same time, a color map is generated to display the grinding deviation of each area to intuitively present the size and position of the grinding force that needs to be adjusted.
[0053] Step 2: Grinding trajectory planning and optimization: After obtaining the basic grinding data, the swarm optimization algorithm is used to optimize the grinding trajectory of the end effector. Specifically, the trajectory planning problem is transformed into a constraint solving problem, and the settings include robot arm kinematic constraints (such as joint angles, speeds, and acceleration limits), spatial obstacle avoidance constraints, and objective functions (such as minimizing the total energy consumption, total time, or trajectory smoothness during the grinding process). The swarm optimization algorithm optimizes the trajectory control points through multiple iterations, divides the group into three categories: roosters, hens, and chicks, and dynamically adjusts the control points based on the fitness value to ensure synchronous optimization of the path and force control.
[0054] The optimized trajectory can accurately adapt to the irregular surface and complex curvature of the mold, avoiding the inaccuracy and inefficiency caused by the separation of path and force control. For example, in the grinding of edge mutation areas, the system can automatically adjust the path to reduce the problem of insufficient or excessive grinding caused by path deviation, significantly improving the grinding quality.
[0055] Step 3: Real-time self-tuning of PID parameters and optimization of force control: During the grinding process, the flock optimization algorithm is used to perform real-time self-tuning of the PID parameters of the motor or cylinder. Taking the complex changes on the mold surface as an example, traditional control methods often experience control inaccuracies in areas with sudden changes in curvature and uneven hardness, resulting in problems such as uneven grinding and surface scratches. The present invention monitors the real-time changes in grinding force and grinding amount through a six-dimensional force sensor, and automatically optimizes the PID control parameters (proportional gain Kp, integral gain Ki, differential gain Kd) to ensure precise control at each grinding stage (such as preliminary adjustment and fine adjustment).
[0056] The self-tuning of PID parameters uses system performance indicators such as integrated square error and integrated time-weighted square error as objective functions, and the swarm optimization algorithm searches for the optimal parameter combination through multiple iterations. Specifically, when the system detects force and position control deviations during the grinding process, the swarm algorithm quickly adjusts the control parameters based on real-time feedback, so that the end effector can automatically optimize the grinding force according to the characteristics of different areas. For example, when grinding the concave or convex parts of the mold, the system can quickly adjust the output force to avoid excessive or insufficient grinding caused by inaccurate force control in traditional methods.
[0057] It will be apparent to those skilled in the art that the present invention is not limited to the details of the exemplary embodiments described above and that the present invention can be implemented in other specific forms without departing from the spirit or essential features of the present invention. Therefore, the embodiments should be considered exemplary and non-restrictive in all respects, and the scope of the present invention is defined by the appended claims rather than the above description, and it is intended that all changes falling within the meaning and scope of the equivalent elements of the claims be included in the present invention.
Claims
1. A grinding control method for an end effector based on a swarm optimization algorithm, characterized in that: The following steps are involved: Step 1: Obtain the 3D digital model data of the workpiece to be polished, scan the surface shape of the workpiece to be polished with a visual camera, obtain its 3D model, and align it with the 3D model of a known standard sample, calculate the grinding amount and grinding force at each point of the workpiece, so as to achieve adaptive control of complex curved surfaces and edge mutation areas; Step 2: Use the swarm optimization algorithm to plan the grinding trajectory, transform the trajectory planning problem into a constraint solving problem, set the robot arm kinematic constraints, spatial obstacle avoidance constraints and the objective function of minimizing the total energy consumption, total time or trajectory smoothness during the grinding process, optimize the control points of the grinding trajectory or the path points of the robot arm joints, and realize the dynamic synchronous optimization of force control and trajectory planning; Step 3: During the grinding process, the swarm optimization algorithm is used to perform real-time self-tuning on the PID parameters of the motor or cylinder, automatically optimize the proportional gain, integral gain and differential gain, monitor the changes in grinding force and grinding amount through the six-dimensional force sensor, and dynamically optimize the control parameters in the initial adjustment and fine adjustment stages to ensure the accuracy and stability of force and position control in high dynamic scenarios.
2. The end effector grinding control method based on chicken swarm optimization algorithm according to claim 1 is characterized in that: The acquisition of the three-dimensional digital model data includes acquiring the three-dimensional data of the workpiece to be polished by scanning with a visual camera, generating a grinding deviation value for each area, and constructing a color mapping diagram to display the area to be polished to adaptively adjust the grinding force.
3. The end effector grinding control method based on chicken swarm optimization algorithm according to claim 1 is characterized in that: When the swarm optimization algorithm is used for trajectory planning, trajectory planning and grinding force control are optimized simultaneously, and the planned optimal path can adapt to workpieces with irregular surfaces, complex curved surfaces and variable shapes to avoid the inaccuracy and inefficiency caused by the separation of path and force control.
4. The end effector grinding control method based on chicken swarm optimization algorithm according to claim 1 is characterized in that: The objective function of the real-time self-tuning of the PID parameters includes an integrated square error, an integrated time-weighted square error or other control indicators related to system performance, and the PID parameter combination is optimized to achieve precise force control.
5. The end effector grinding control method based on chicken swarm optimization algorithm according to claim 1 is characterized in that: The integrated optimization of trajectory planning and force control is performed through multiple iterations of a flock optimization algorithm to optimize the combination of polishing trajectory control points and PID parameters and to achieve a shared optimization strategy for path and force control.
6. The end effector grinding control method based on chicken swarm optimization algorithm according to claim 1 is characterized in that: The alignment of the three-dimensional digital model data includes using an iterative closest point ICP algorithm to make the three-dimensional scanning data of the workpiece to be ground coincide with the three-dimensional digital model reference points of the standard sample to accurately calculate the grinding deviation value of each point.
7. The end effector grinding control method based on chicken swarm optimization algorithm according to claim 1 is characterized in that: The determination of the grinding force comprehensively considers the hardness of the material, the grinding depth, the characteristics of the grinding tool and the grinding speed, and the grinding force at each point is comprehensively determined by theoretical formulas and empirical parameters.
8. The end effector grinding control method based on chicken swarm optimization algorithm according to claim 1 is characterized in that: The grinding trajectory planning includes setting the joint angle, speed and acceleration limits of the robot arm to avoid collision with the workpiece or other equipment during the grinding process.
9. The end effector grinding control method based on chicken swarm optimization algorithm according to claim 1 is characterized in that: When the chicken flock optimization algorithm is used to optimize the grinding trajectory, the individuals are divided into three categories: roosters, hens and chicks according to the fitness values, and the grinding trajectory control points are optimized through multiple iterations until the termination conditions are met.
10. The end effector grinding control method based on chicken swarm optimization algorithm according to claim 1 is characterized in that: The PID control process uses the feedback data of the six-dimensional force sensor to calculate the error and output the control signal to the motor or cylinder to adjust the output force and position in real time during the grinding process; the PID parameter self-tuning performs fitness evaluation after each adjustment, and gradually optimizes the control system performance by minimizing the fitness, so that the system maintains the best state in a complex and dynamic grinding environment.
Citation Information
Patent Citations
Method of acquiring workpiece-processing optimal scheduling based on improved chicken flock algorithm
CN104880949A
Robot polishing control system and method
CN108115705A
ROS-based polishing mechanical arm control system
CN112091991A
Programming-free robot online constant-force grinding control system and method
CN112318319A
Equipment mechanical parameter optimization method based on improved teaching and chicken flock algorithm
CN114169104A
Cited By
Grinding and polishing control method and control system based on sliding mode control
CN119927805A
Lens polishing control method and system for sighting telescope
CN120056001A
Automatic side edge grinding system for thin-wall special-shaped part based on robot
CN120134125A
Wafer thinning device and thinning method
CN121018325A
Wafer thinning apparatus and thinning method
CN121018325B
