A robotic system for automated industrial painting
By projecting the scanning curve on the workpiece and optimizing the spray trajectory, the problems of automation system settings and coating thickness control are solved, production efficiency and product consistency are improved, material waste and equipment adjustment are reduced, uniform coating and high-quality coating are achieved Pack.
Patent Information
- Application Number
- CN202410909966.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-09
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2044-07-09
AI Technical Summary
When painting products that require frequent changes in the coating process, the setting and adjustment of the automation system is time-consuming and laborious, and the automated coating fails to effectively control the coating thickness, resulting in waste of material and product appearance quality problems.
By projecting the scan curve on the workpiece, judging and optimizing the scan curve, an initial trajectory that fits the surface of the workpiece is generated, and the coating thickness is controlled in the spray path control module to ensure uniform coverage and specification compliance.
Improves production efficiency and flexibility, reduces material costs, ensures product appearance quality and consistency, avoids equipment adjustments, and achieves uniform coating and the same batch quality.
Smart Images

Figure CN118577419B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of industrial automation, and in particular to a robot system for automated industrial painting. Background Art
[0002] Industrial automation has brought enterprises higher production efficiency, lower costs, better working environment and higher product quality, which are important factors for enterprises to gain advantages in the fiercely competitive market. However, when coating products produced in small batches or requiring frequent changes in the coating process, the setting and adjustment of the automation system may be time-consuming and costly; at the same time, automated coating needs to consider the cost of coatings. Failure to control the thickness of the coating may lead to uneconomical use of the coating and cause waste. Too thick a coating not only wastes materials, but may also increase the drying and curing time, affecting the appearance quality of the final product. Summary of the invention
[0003] In view of the above situation, in order to overcome the defects of the prior art, the present invention provides a robot system for automated industrial painting. In view of the technical problem that the setting and adjustment of the automated system may be time-consuming and costly when painting products that are produced in small batches or require frequent changes in the painting process, the present invention covers a rectangular area with a specified scanning width, projects the scanning curve onto the workpiece, judges the feasibility of the projection point, and modifies the scanning curve with additional path points and extended scanning to obtain an initial trajectory that fits the surface of the workpiece. When the workpiece is replaced, the adjustment and replacement of the equipment is avoided, the production efficiency and production speed are significantly improved, and greater production flexibility is provided; in view of the technical problem that the cost of coating must be considered in automated painting, and the failure to control the thickness of the coating may result in uneconomical use of the coating and waste. An overly thick coating not only wastes materials, but may also increase the drying and curing time, affecting the appearance quality of the final product, the present invention controls the coating thickness when planning the spraying trajectory, reduces material costs, ensures that each workpiece is coated evenly and in accordance with specifications, improves the appearance quality and functionality of the product, ensures that each batch of products has the same coating thickness and quality, and enhances the consistency and brand image of the product.
[0004] The technical solution adopted by the present invention is as follows: The present invention provides a robot system for automated industrial painting, the robot system for automated industrial painting comprising a spray gun, a workpiece conveyor belt, a paint delivery system, a spray path control module and a spray robot arm control module;
[0005] The spray gun is held by the end effector of the robot arm and is responsible for spraying the paint evenly onto the surface of the workpiece;
[0006] The workpiece conveyor conveys the workpiece to be painted into the spraying range of the spray gun, and conveys the painted workpiece to the next workstation;
[0007] The paint delivery system is responsible for providing paint to the spray gun and ensuring that the paint is delivered at an appropriate pressure and flow rate. The paint delivery system includes a paint tank, a delivery pump, a filter, a pressure regulator and a delivery pipeline;
[0008] The spray path control module plans the spray trajectory of the spray gun and controls the coating thickness to ensure that the coating evenly covers the surface of the workpiece;
[0009] The spraying robot arm control module is responsible for controlling the movement of the spraying robot arm, including joint angle, speed and acceleration, to ensure that the robot arm performs the painting task accurately and stably.
[0010] Furthermore, the spraying path control module generates a spraying trajectory using a curve generation algorithm, and the curve generation algorithm specifically includes the following steps:
[0011] Step S1: define a path point and a normal direction, specify a plane P using the path point and the normal direction, orthogonally project all the surface mesh vertices of the workpiece onto the plane P, record the orthogonal projections of the surface mesh vertices on the plane P as projection points, create a rectangle R on the plane P containing all the projection points, generate a regular grid-based curve C on the rectangle R, preset a spraying distance, and the curve C is a straight line connecting the projection points along one direction of the rectangle R and with the spraying distance as an interval;
[0012] Step S2: Scan the curve C, project the scan of the curve C onto the workpiece to obtain a pseudo projection, and determine whether the pseudo projection of the projection point on the workpiece is feasible;
[0013] Step S3: Optimize the projection points on the curve C to obtain the initial trajectory;
[0014] Step S4: Calculate the spraying trajectory;
[0015] Further, step S2, scanning the curve C, projecting the scan of the curve C onto the workpiece, and judging whether the pseudo-projection of the projection point on the workpiece is feasible, specifically includes the following steps:
[0016] Step S21: Each scan starts from one edge of the curve C and ends at the other edge, and rotates at the edge and then moves parallel to the spraying interval to perform a new scan. The new scan is parallel to the previous scan, but in the opposite direction;
[0017] Step S22: using a ray tracing projection algorithm to calculate the point on the workpiece that is closest to the plane P along a straight line from the arbitrary point and direction for any point and direction on the plane P, and calculating a surface normal at the projection point;
[0018] Step S23: For each point projected onto the workpiece surface, the direction of the point is described by a right-handed orthogonal coordinate system (t, b, n), where t is the tangent point, along the direction of the curve C, n is the normal point, pointing to the surface C, and b is uniquely determined by n and t, b=n×t;
[0019] Step S24: for a point on the curve C, n is the normal direction of the plane P, and t is the scanning direction;
[0020] Step S25: define the edge distance. For any point o and a normal direction l, the edge distance is calculated by a simple linear search along the normal direction l based on the normal direction of the plane P, and the projection points on the workpiece and outside the workpiece are found. The maximum edge distance is preset. For the projection point outside the workpiece, if the projection point is in a direction between l=±t and l=±b, and the edge distance is less than the maximum edge distance, it is recorded as a feasible point, otherwise the projection point is infeasible.
[0021] Step S26: record the set of path points as p set, evenly select 8 points on the tangent plane composed of p set, t set and b set, evenly sample at a position one spraying distance away from p set, discard the projection points whose distance to the edge is shorter than the distance from the path point to the edge of the workpiece, cluster the remaining normals, and obtain updated normals;
[0022] Step S27: Update the tangent normal and projection point. The formula used is as follows:
[0023] ;
[0024] ;
[0025] In the formula, is the updated tangent, is the updated projection point, is the tangent before updating, is the projection point before updating, is the updated normal, is the distance between the p-set and the projection of the p-set on the workpiece;
[0026] Furthermore, step S3, optimizing the projection points on the curve C, specifically includes the following steps:
[0027] Step S31: The pseudo projections of the scanned projection points of the curve C on the workpiece are recorded as path points, and the infeasible path points are removed at both ends of the scan. At the same time, the feasible points are projected onto the workpiece surface and the extended surface of the workpiece using pseudo projections, and the scans with less than two feasible points are discarded. For the holes on the workpiece surface, a new position is calculated from the adjacent feasible points by linear interpolation as the path point;
[0028] Step S32: Extending the scanned endpoints to the maximum extent along the tangent direction while maintaining feasibility;
[0029] Step S33: The maximum segment length allowed between preset path points is dmax, and two adjacent path points whose distance is less than dmax / 2 are recursively merged, and the average value of the two adjacent projection points is calculated to obtain a new point. If the new point is feasible, it is replaced with the pseudo projection of the new point, otherwise it remains unchanged. If one of the path points is the endpoint of the scan, the endpoint is used as the path point, and the other path point is discarded;
[0030] Step S34: recursively split two adjacent connected path points whose distance is greater than dmax by inserting a new point between the two path points. If the new point is feasible, the pseudo projection of the new point is used as the path point, otherwise it remains unchanged.
[0031] Further, step S4, calculating the spraying trajectory, specifically includes the following steps:
[0032] Step S41: spraying from one edge to the other edge of the workpiece is regarded as a continuous segment, and the spraying time of all continuous segments of the spraying trajectory, all path points, the direction of the spray gun and the spraying time between two consecutive path points are represented by a quaternion;
[0033] Step S42: Calculate the coating thickness at any node on the workpiece surface using the following formula:
[0034] ;
[0035] In the formula, is the coating thickness at any node on the workpiece surface, It is segmented time. It's on point The coating thickness at It is the center of the spray gun;
[0036] Step S43: Calculate the discreteness of the brush function on the continuous path as the auxiliary thickness. The formula used is as follows:
[0037] ;
[0038] In the formula, is a discrete function of the brush function on a continuous path, is the distance from the spray gun projection source to the point on the workpiece in the z direction, and the surface normal is the v normal. is the scaling vector from the position of the spray gun projection source to the point on the workpiece, is the distance from the spray gun projection source to the initial trajectory;
[0039] Step S44: define the coating thickness cost function and the coating path cost function, and the formula used is as follows:
[0040] ;
[0041] ;
[0042] In the formula, is the coating thickness cost function, is the surface area represented by the nodes on the workpiece surface, is the paint path cost function, and are the weights of position and direction changes along the trajectory, respectively;
[0043] Step S45: The sum of the coating thickness cost and the coating path cost is used as the cost function, and the calculation of the spraying trajectory is solved as a continuous nonlinear optimization problem to obtain the spraying trajectory, which is represented by the following symbols:
[0044] ;
[0045] In the formula, is the cost function, and They are inequality constraints and equality constraints respectively.
[0046] The beneficial effects achieved by the present invention using the above scheme are as follows:
[0047] (1) In view of the technical problem that the setting and adjustment of the automated system may be time-consuming and costly when coating products produced in small batches or requiring frequent changes in the coating process, the present invention covers a rectangular area with a specified scanning width, projects a scanning curve onto the workpiece, determines the feasibility of the projection point, modifies the scanning curve with additional path points and extended scanning, and obtains an initial trajectory that fits the workpiece surface. This avoids the need to adjust and replace equipment when the workpiece is replaced, significantly improves production efficiency and speed, and provides greater production flexibility;
[0048] (2) For automated coating, the coating cost must be considered. Failure to control the coating thickness may result in uneconomical use of the coating and waste. Too thick a coating not only wastes materials, but may also increase the drying and curing time, affecting the appearance quality of the final product. The present invention controls the coating thickness when planning the spraying trajectory, reduces material costs, ensures that each workpiece is coated evenly and in accordance with specifications, improves the appearance quality and functionality of the product, ensures that each batch of products has the same coating thickness and quality, and enhances product consistency and brand image. BRIEF DESCRIPTION OF THE DRAWINGS
[0049] Figure 1 A module connection diagram of a robot system for automated industrial painting provided by the present invention.
[0050] The accompanying drawings are used to provide further understanding of the present invention and constitute a part of the specification. They are used to explain the present invention together with the embodiments of the present invention and do not constitute a limitation of the present invention. DETAILED DESCRIPTION
[0051] The technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all the embodiments; based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.
[0052] Example 1: See Figure 1 , this embodiment provides a robot system for automated industrial painting, the robot system for automated industrial painting comprising a spray gun, a workpiece conveyor belt, a paint delivery system, a spray path control module and a spray robot arm control module;
[0053] The spray gun is held by the end effector of the robot arm and is responsible for spraying the paint evenly onto the surface of the workpiece;
[0054] The workpiece conveyor conveys the workpiece to be painted into the spraying range of the spray gun, and conveys the painted workpiece to the next workstation;
[0055] The paint delivery system is responsible for providing paint to the spray gun and ensuring that the paint is delivered at an appropriate pressure and flow rate. The paint delivery system includes a paint tank, a delivery pump, a filter, a pressure regulator and a delivery pipeline;
[0056] The spray path control module plans the spray trajectory of the spray gun and controls the coating thickness to ensure that the coating evenly covers the surface of the workpiece;
[0057] The spraying robot arm control module is responsible for controlling the movement of the spraying robot arm, including joint angle, speed and acceleration, to ensure that the robot arm performs the painting task accurately and stably.
[0058] Example 2: See Figure 1 This embodiment is based on the above embodiment, and the spraying path control module uses a curve generation algorithm to generate a spraying trajectory. The curve generation algorithm specifically includes the following steps:
[0059] Step S1: define a path point and a normal direction, specify a plane P using the path point and the normal direction, orthogonally project all the surface mesh vertices of the workpiece onto the plane P, record the orthogonal projections of the surface mesh vertices on the plane P as projection points, create a rectangle R on the plane P containing all the projection points, generate a regular grid-based curve C on the rectangle R, preset a spraying distance, and the curve C is a straight line connecting the projection points along one direction of the rectangle R and with the spraying distance as an interval;
[0060] Step S2: Scan the curve C, project the scan of the curve C onto the workpiece to obtain a pseudo projection, and determine whether the pseudo projection of the projection point on the workpiece is feasible;
[0061] Step S3: Optimize the projection points on the curve C to obtain the initial trajectory;
[0062] Step S4: Calculate the spraying trajectory.
[0063] Example 3: See Figure 1 This embodiment is based on the above embodiment. In step S2, the curve C is scanned and the scan of the curve C is projected onto the workpiece to determine whether the pseudo-projection of the projection point on the workpiece is feasible. Specifically, the following steps are included:
[0064] Step S21: Each scan starts from one edge of the curve C and ends at the other edge, and rotates at the edge and then moves parallel to the spraying interval to perform a new scan. The new scan is parallel to the previous scan, but in the opposite direction;
[0065] Step S22: using a ray tracing projection algorithm to calculate the point on the workpiece that is closest to the plane P along a straight line from the arbitrary point and direction for any point and direction on the plane P, and calculating a surface normal at the projection point;
[0066] Step S23: For each point projected onto the workpiece surface, the direction of the point is described by a right-handed orthogonal coordinate system (t, b, n), where t is the tangent point, along the direction of the curve C, n is the normal point, pointing to the surface C, and b is uniquely determined by n and t, b=n×t;
[0067] Step S24: for a point on the curve C, n is the normal direction of the plane P, and t is the scanning direction;
[0068] Step S25: define the edge distance. For any point o and a normal direction l, the edge distance is calculated by a simple linear search along the normal direction l based on the normal direction of the plane P, and the projection points on the workpiece and outside the workpiece are found. The maximum edge distance is preset. For the projection point outside the workpiece, if the projection point is in a direction between l=±t and l=±b, and the edge distance is less than the maximum edge distance, it is recorded as a feasible point, otherwise the projection point is infeasible.
[0069] Step S26: record the set of path points as p set, evenly select 8 points on the tangent plane composed of p set, t set and b set, evenly sample at a position one spraying distance away from p set, discard the projection points whose distance to the edge is shorter than the distance from the path point to the edge of the workpiece, cluster the remaining normals, and obtain updated normals;
[0070] Step S27: Update the tangent normal and projection point. The formula used is as follows:
[0071] ;
[0072] ;
[0073] In the formula, is the updated tangent, is the updated projection point, is the tangent before updating, is the projection point before updating, is the updated normal, is the distance between the p-set and the projection of the p-set on the workpiece.
[0074] Example 4: See Figure 1 This embodiment is based on the above embodiment. Step S3 optimizes the projection points on the curve C, and specifically includes the following steps:
[0075] Step S31: The pseudo projections of the scanned projection points of the curve C on the workpiece are recorded as path points, and the infeasible path points are removed at both ends of the scan. At the same time, the feasible points are projected onto the workpiece surface and the extended surface of the workpiece using pseudo projections, and the scans with less than two feasible points are discarded. For the holes on the workpiece surface, a new position is calculated from the adjacent feasible points by linear interpolation as the path point;
[0076] Step S32: Extending the scanned endpoints to the maximum extent along the tangent direction while maintaining feasibility;
[0077] Step S33: The maximum segment length allowed between preset path points is dmax, and two adjacent path points whose distance is less than dmax / 2 are recursively merged, and the average value of the two adjacent projection points is calculated to obtain a new point. If the new point is feasible, it is replaced with the pseudo projection of the new point, otherwise it remains unchanged. If one of the path points is the endpoint of the scan, the endpoint is used as the path point, and the other path point is discarded;
[0078] Step S34: recursively split two adjacent connected path points whose distance is greater than dmax by inserting a new point between the two path points. If the new point is feasible, the pseudo-projection of the new point is used as the path point, otherwise it remains unchanged.
[0079] Through the above embodiments, in order to address the technical problem that the setup and adjustment of the automation system may be time-consuming and costly when painting products that are produced in small batches or require frequent changes in the painting process, the present invention uses a specified scanning width to cover a rectangular area, projects the scanning curve onto the workpiece, determines the feasibility of the projection point, and modifies the scanning curve with additional path points and extended scanning to obtain an initial trajectory that fits the surface of the workpiece. This avoids the need to adjust and replace equipment when the workpiece is replaced, significantly improves production efficiency and speed, and provides greater production flexibility.
[0080] Example 5: See Figure 1 This embodiment is based on the above embodiment, step S4, calculating the spraying trajectory, specifically includes the following steps:
[0081] Step S41: spraying from one edge to the other edge of the workpiece is regarded as a continuous segment, and the spraying time of all continuous segments of the spraying trajectory, all path points, the direction of the spray gun and the spraying time between two consecutive path points are represented by a quaternion;
[0082] Step S42: Calculate the coating thickness at any node on the workpiece surface using the following formula:
[0083] ;
[0084] In the formula, is the coating thickness at any node on the workpiece surface, It is segmented time. It's on point The coating thickness at It is the center of the spray gun;
[0085] Step S43: Calculate the discreteness of the brush function on the continuous path as the auxiliary thickness. The formula used is as follows:
[0086] ;
[0087] In the formula, is a discrete function of the brush function on a continuous path, is the distance from the spray gun projection source to the point on the workpiece in the z direction, and the surface normal is the v normal. is the scaling vector from the position of the spray gun projection source to the point on the workpiece, is the distance from the spray gun projection source to the initial trajectory;
[0088] Step S44: define the coating thickness cost function and the coating path cost function, and the formula used is as follows:
[0089] ;
[0090] ;
[0091] In the formula, is the coating thickness cost function, is the surface area represented by the nodes on the workpiece surface, is the paint path cost function, and are the weights of position and direction changes along the trajectory, respectively;
[0092] Step S45: The sum of the coating thickness cost and the coating path cost is used as the cost function, and the calculation of the spraying trajectory is solved as a continuous nonlinear optimization problem to obtain the spraying trajectory, which is represented by the following symbols:
[0093] ;
[0094] In the formula, is the cost function, and They are inequality constraints and equality constraints respectively.
[0095] Through the above embodiments, it is necessary to consider the coating cost for automated coating. Failure to control the coating thickness may lead to uneconomical use of the coating and cause waste. Too thick a coating not only wastes materials, but may also increase the drying and curing time, affecting the appearance quality of the final product. The present invention controls the coating thickness when planning the spraying trajectory, reduces material costs, ensures that each workpiece receives a uniform and compliant coating, improves the appearance quality and functionality of the product, ensures that each batch of products has the same coating thickness and quality, and enhances product consistency and brand image.
[0096] Embodiment 6. This embodiment is based on the above embodiment. When the system is put into use, the workpiece conveyor belt identifies the position of the spray gun through a visual recognition algorithm and transfers the workpiece to the spray range of the spray gun. After identifying the workpiece, the spray robot arm control module uses a center of mass detection algorithm to find the center coordinates of the workpiece and uses an inverse kinematics algorithm to determine the joint position of the spray robot arm.
[0097] Embodiment 7, based on the above embodiment, this embodiment models the spray gun, models the spray gun as a projection source behind the spray gun nozzle, uses a plane with the spray gun nozzle as the origin, and calculates the angle from the projection source to the spray gun nozzle by using two points on the cone. The formula used is as follows:
[0098]
[0099] In the formula, is the angle from the projection source to the nozzle, and is the displacement of two points on the cone, and is the displacement of the spray gun nozzle.
[0100] It should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device.
[0101] Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the appended claims and their equivalents.
[0102] The present invention and its embodiments are described above, and such description is not restrictive. The drawings show only one embodiment of the present invention, and the actual structure is not limited thereto. In short, if ordinary technicians in the field are inspired by it, without departing from the purpose of the invention, they can design a structure and embodiment similar to the technical solution without creativity, which should belong to the protection scope of the present invention.
Claims
1. A robot system for automated industrial painting, characterized in that: The robot system for automated industrial painting comprises a spray gun, a workpiece conveyor belt, a paint delivery system, a spray path control module and a spray robot arm control module; The spray gun is held by the end effector of the robot arm and is responsible for spraying the paint evenly onto the surface of the workpiece; The workpiece conveyor conveys the workpiece to be painted into the spraying range of the spray gun, and conveys the painted workpiece to the next workstation; The paint delivery system is responsible for providing paint to the spray gun and ensuring that the paint is delivered at an appropriate pressure and flow rate. The paint delivery system includes a paint tank, a delivery pump, a filter, a pressure regulator and a delivery pipeline; The spray path control module plans the spray trajectory of the spray gun and controls the coating thickness to ensure that the coating evenly covers the surface of the workpiece; The spraying robot arm control module is responsible for controlling the movement of the spraying robot arm, including joint angle, speed and acceleration, to ensure that the robot arm performs the painting task accurately and stably; The spraying path control module uses a curve generation algorithm to generate a spraying trajectory, and the curve generation algorithm specifically includes the following steps: Step S1: define a path point and a normal direction, specify a plane P using the path point and the normal direction, orthogonally project all the surface mesh vertices of the workpiece onto the plane P, record the orthogonal projections of the surface mesh vertices on the plane P as projection points, create a rectangle R on the plane P containing all the projection points, generate a regular grid-based curve C on the rectangle R, preset a spraying distance, and the curve C is a straight line connecting the projection points along one direction of the rectangle R and with the spraying distance as an interval; Step S2: Scan the curve C, project the scan of the curve C onto the workpiece to obtain a pseudo projection, and determine whether the pseudo projection of the projection point on the workpiece is feasible; Step S3: Optimize the projection points on the curve C to obtain the initial trajectory; Step S4: Calculate the spraying trajectory.
2. A robot system for automated industrial painting according to claim 1, characterized in that: Step S2, scanning the curve C, projecting the scan of the curve C onto the workpiece, and judging whether the pseudo-projection of the projection point on the workpiece is feasible, specifically includes the following steps: Step S21: Each scan starts from one edge of the curve C and ends at the other edge, and rotates at the edge and then moves parallel to the spraying interval to perform a new scan. The new scan is parallel to the previous scan, but in the opposite direction; Step S22: using a ray tracing projection algorithm to calculate the point on the workpiece that is closest to the plane P along a straight line from the arbitrary point and direction for any point and direction on the plane P, and calculating a surface normal at the projection point; Step S23: For each point projected onto the workpiece surface, the direction of the point is described by a right-handed orthogonal coordinate system (t, b, n), where t is the tangent point, along the direction of the curve C, n is the normal point, pointing to the surface C, and b is uniquely determined by n and t, b=n×t; Step S24: for a point on the curve C, n is the normal direction of the plane P, and t is the scanning direction; Step S25: define the edge distance. For any point o and a normal direction l, the edge distance is calculated by a simple linear search along the normal direction l based on the normal direction of the plane P, and the projection points on the workpiece and outside the workpiece are found. The maximum edge distance is preset. For the projection point outside the workpiece, if the projection point is in a direction between l=±t and l=±b, and the edge distance is less than the maximum edge distance, it is recorded as a feasible point, otherwise the projection point is infeasible. Step S26: record the set of path points as p set, evenly select 8 points on the tangent plane composed of p set, t set and b set, evenly sample at a position one spraying distance away from p set, discard the projection points whose distance to the edge is shorter than the distance from the path point to the edge of the workpiece, cluster the remaining normals, and obtain updated normals; Step S27: Update the tangent normal and projection point.
3. A robot system for automated industrial painting according to claim 2, characterized in that: Step S3, optimizing the projection points on the curve C, specifically includes the following steps: Step S31: The pseudo projections of the scanned projection points of the curve C on the workpiece are recorded as path points, and the infeasible path points are removed at both ends of the scan. At the same time, the feasible points are projected onto the workpiece surface and the extended surface of the workpiece using pseudo projections, and the scans with less than two feasible points are discarded. For the holes on the workpiece surface, a new position is calculated from the adjacent feasible points by linear interpolation as the path point; Step S32: Extending the scanned endpoints to the maximum extent along the tangent direction while maintaining feasibility; Step S33: The maximum segment length allowed between preset path points is dmax, and two adjacent path points whose distance is less than dmax / 2 are recursively merged, and the average value of the two adjacent projection points is calculated to obtain a new point. If the new point is feasible, it is replaced with the pseudo projection of the new point, otherwise it remains unchanged. If one of the path points is the endpoint of the scan, the endpoint is used as the path point, and the other path point is discarded; Step S34: recursively split two adjacent connected path points whose distance is greater than dmax by inserting a new point between the two path points. If the new point is feasible, the pseudo-projection of the new point is used as the path point, otherwise it remains unchanged.
4. A robot system for automated industrial painting according to claim 3, characterized in that: Step S4, calculating the spraying trajectory, specifically includes the following steps: Step S41: spraying from one edge to the other edge of the workpiece is regarded as a continuous segment, and the spraying time of all continuous segments of the spraying trajectory, all path points, the direction of the spray gun and the spraying time between two consecutive path points are represented by a quaternion; Step S42: Calculate the coating thickness at any node on the workpiece surface; Step S43: Calculate the discretization of the brush function on the continuous path as the auxiliary thickness; Step S44: defining a coating thickness cost function and a coating path cost function; Step S45: taking the sum of the coating thickness cost and the coating path cost as the cost function, and solving the calculation of the spraying trajectory as a continuous nonlinear optimization problem to obtain the spraying trajectory.
Citation Information
Patent Citations
Spraying robot trajectory planning method based on improved point cloud slicing algorithm
CN112632718A
Spraying robot trajectory planning method based on grid projection algorithm
CN113019763A
