CN104525421A - Method for generating overall spraying path - Google Patents
Method for generating overall spraying path Download PDFInfo
- Publication number
- CN104525421A CN104525421A CN201510000796.5A CN201510000796A CN104525421A CN 104525421 A CN104525421 A CN 104525421A CN 201510000796 A CN201510000796 A CN 201510000796A CN 104525421 A CN104525421 A CN 104525421A
- Authority
- CN
- China
- Prior art keywords
- spraying
- path
- workpiece
- spray
- node
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B05—SPRAYING OR ATOMISING IN GENERAL; APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
- B05B—SPRAYING APPARATUS; ATOMISING APPARATUS; NOZZLES
- B05B13/00—Machines or plants for applying liquids or other fluent materials to surfaces of objects or other work by spraying, not covered by groups B05B1/00 - B05B11/00
- B05B13/02—Means for supporting work; Arrangement or mounting of spray heads; Adaptation or arrangement of means for feeding work
- B05B13/04—Means for supporting work; Arrangement or mounting of spray heads; Adaptation or arrangement of means for feeding work the spray heads being moved during spraying operation
- B05B13/0431—Means for supporting work; Arrangement or mounting of spray heads; Adaptation or arrangement of means for feeding work the spray heads being moved during spraying operation with spray heads moved by robots or articulated arms, e.g. for applying liquid or other fluent material to 3D-surfaces
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Spray Control Apparatus (AREA)
Abstract
The invention discloses a method for generating an overall spraying path. The method comprises the steps of reading a three-dimensional projection view of a workpiece to be sprayed, reading the spraying parameters of a spraying robot, calculating the spraying path of each single face of the workpiece to be sprayed according to the three-dimensional projection view and the spraying parameters, judging the spraying mode of each face of the workpiece to be measured, when the spraying modes of each face of the workpiece to be tested comprise single-face spraying and multi-face spraying, for the face, needing single-face spraying, to be measured, selecting the single-face spraying path of the face to be measured, and for the face, needing multi-face spraying, to be tested, carrying out combination and interpolation on the spraying path of each face to be measured so that a multi-face spraying path can be generated as the overall spraying path.
Description
Technical field
The present invention relates to spraying field, be specifically related to a kind of method producing integral spray path.
Background technology
Use spray robot can avoid manually being in poisonous and hazardous production environment for a long time in spraying industry.At present artificial lead-through teaching and off-line programing method are mainly comprised to the programming mode of spray robot.Artificial lead-through teaching is the position of progressively being moved spray gun by veteran operative's robot controlling handle, to complete the setting in whole spraying path.By recording and preserve Parameters variation and the position in robot end joint, make robot can repeat original movement locus, to realize automatic coating.This kind of method has relatively high cost of labor.
Off-line programing method needs to utilize computer graphics techniques to generate spraying part model in advance.When spraying workpiece, calculating spraying path according to existing spraying part model and spraying coating process, and spraying according to this spraying path command robot.But, the robot off-line programming software operation relative complex adopted in practical application, and need accurate workpiece cad model or threedimensional model, generation could be simulated and spray path comparatively accurately.But at Furniture panel etc. in the less demanding production environment of spraying path precision, these sheet material workpiece often do not have CAD or threedimensional model, then off-line programming software cannot be utilized to go simulation to generate spraying path.
Summary of the invention
The technical problem to be solved in the present invention is to provide a kind of method producing integral spray path, to reduce artificial participation, improves spraying coordinates measurement precision, reduces the complexity of spraying, improve operability.
For solving the problems of the technologies described above, the present invention adopts following technical scheme:
The invention provides a kind of method producing integral spray path, it is characterized in that, the method in described generation integral spray path comprises the following steps:
Read tripleplane's view of spraying workpiece;
Read the spray parameters of described spray robot;
Calculate the spraying path of each one side of described spraying workpiece according to described tripleplane view and described spray parameters, wherein, the spraying path of described each one side is represented by the three-dimensional coordinate of the spraying node on described each one side and normal vector;
Judge the spraying method of described workpiece for measurement each;
When the spraying method of each of described workpiece for measurement is one side spraying, then described overall path is the spraying path of described each tested surface;
When the spraying method of each of described workpiece for measurement is multiaspect spraying, then the spraying path of described each tested surface is combined and interpolation, to produce multiaspect spraying path as described integral spray path;
When the spraying method of each of described workpiece for measurement comprises one side spraying and multiaspect spraying, then the tested surface needing one side to spray is chosen to the one side spraying path of described tested surface, and the spraying path of the tested surface sprayed for needing multiaspect to described each tested surface is combined and interpolation, spray path as a whole to produce multiaspect spraying path;
When the spraying method of each of described workpiece for measurement comprises one side spraying and multiaspect spraying, combine described one side spraying path and described multiaspect spraying path, to form integral spray path; And
Spraying instruction is produced, to control to spray workpiece described in described coating robot coats according to described integral spray path.
In one embodiment, described spraying instruction comprises described multiple data set, described multiple data set comprises the data of spraying line number data, spraying path attribute data, spray gun attribute data and multiple attitude point, wherein, connected mode described in spraying path attribute data representation between multiple attitude point, described connected mode comprises: straight line connects and is connected with matched curve, and described multiple attitude point data comprises three-dimensional point coordinate and the unit normal vector of corresponding spraying node.
Compared with prior art, adopt Study of Intelligent Robot Control system and method for the present invention can measuring workpieces three-view diagram automatically, and automatically generate the spraying profile of spray gun according to three-view diagram.Do not need in this process manually to try spray, thus improve deposition accuracies, alleviate artificial burden.Meanwhile, owing to can not be subject to the restriction of workpiece CAD figure, Study of Intelligent Robot Control system and method operation of the present invention is easier, and applicable surface is wider.
Accompanying drawing explanation
Figure 1 shows that intelligent robot paint finishing according to an embodiment of the invention.
Figure 2 shows that optical measuring apparatus according to an embodiment of the invention.
Figure 3 shows that the schematic diagram of transfer station according to an embodiment of the invention.
Figure 4 shows that the schematic diagram of light curtain bracing or strutting arrangement according to an embodiment of the invention.
Figure 5 shows that the structure chart of motor control module according to an embodiment of the invention.
Figure 6 shows that the spraying method flow chart controlling spray robot according to an embodiment of the invention.
Figure 7 shows that the method flow diagram according to an embodiment of the invention spraying workpiece being carried out to optical measurement.
Figure 8 shows that method flow diagram spraying workpiece being carried out to optical measurement according to another embodiment of the present invention.
Figure 9 shows that the method flow diagram of central controller according to an embodiment of the invention.
Figure 10 shows that the other method flow chart of central controller according to an embodiment of the invention.
Figure 11 shows that the method flow diagram in the spraying path calculating one side according to an embodiment of the invention.
Figure 12 shows that one side spraying node schematic diagram according to an embodiment of the invention.
Figure 13 shows that the method flow diagram calculating three-dimensional coordinate corresponding to one side spraying node according to an embodiment of the invention.
Figure 14 shows that the method flow diagram calculating three-dimensional coordinate corresponding to front view spraying node according to an embodiment of the invention.
Figure 15 shows that the method flow diagram calculating three-dimensional coordinate corresponding to top view spraying node according to an embodiment of the invention.
Figure 16 shows that the method flow diagram calculating three-dimensional coordinate corresponding to left view spraying node according to an embodiment of the invention.
Figure 17 shows that the method flow diagram calculating each spraying nodal method vector according to an embodiment of the invention.
Figure 18 shows that the schematic diagram of target spraying node and adjacent node according to an embodiment of the invention.
Figure 19 shows that the method flow diagram according to an embodiment of the invention described spraying profile being carried out to spatial fit.
Figure 20 shows that the method flow diagram producing integral spray path according to an embodiment of the invention.
Detailed description of the invention
Below will provide detailed description to embodiments of the invention.Although the present invention will carry out setting forth and illustrating in conjunction with some detailed description of the invention, it should be noted that the present invention is not merely confined to these embodiments.On the contrary, the amendment carry out the present invention or equivalent replacement, all should be encompassed in the middle of right of the present invention.
In addition, in order to better the present invention is described, in detailed description of the invention hereafter, give numerous details.It will be understood by those skilled in the art that do not have these details, the present invention can implement equally.In other example, known method, flow process, element and circuit are not described in detail, so that highlight purport of the present invention.
Figure 1 shows that intelligent robot paint finishing 100 according to an embodiment of the invention.In one embodiment, intelligent robot paint finishing 100 comprises optical measuring apparatus 106, main control device 102 and spraying equipment 104.In one embodiment, spraying equipment 104 comprises spray robot 112 and is assemblied in the spray gun 110 of spray robot 112.Optical measuring apparatus 106 carries out optical measurement to spraying workpiece, with the dimension information of the tripleplane's view and described spraying workpiece that obtain described spraying workpiece, and produces the workpiece signal representing described tripleplane view and described dimension information.Main control device 102 is connected with optical measuring apparatus 106, for receiving described workpiece signal, read the spray parameters relevant to spray robot 112, calculate the spraying path of described spray robot 112 according to described workpiece signal and described spray parameters, and produce the spraying instruction comprising described spraying routing information.Spraying equipment 104 is connected with described main control device.Spraying equipment 104 carries out spraying operation according to described spraying instruction according to described spraying path.
Advantage is, intelligent robot paint finishing 100 utilizes optical measuring apparatus 106 to measure tripleplane's view of spraying workpiece in real time, and automatically generates the spraying profile of spray gun according to described tripleplane view.Owing to not needing manual hand manipulation, intelligent robot paint finishing 100 improves deposition accuracies.Owing to not needing the CAD picture of standard workpiece, intelligent robot paint finishing 100 has saved cost.
In the embodiment illustrated in fig. 1, main control device 102 comprises central controller 126, device drives memory 120, display 122, model interface 124 and control button 128.Device drives memory 120, display 122, model interface 124 are connected with central controller 126 with control button 128.Central controller 126 is communicated with optical measuring apparatus 106 by model interface 124, for receiving tripleplane's view that optical measuring apparatus 106 sends.Central controller 126 reads and drives parameter from device drives memory 120, and gives optical measuring apparatus 106 and spraying equipment 104 configuration driven operational factor.Central controller 126 generates spraying path according to tripleplane's view of workpiece for measurement and spray parameters, and shows on display 122.Staff checks the spraying path automatically generated by display 122.If the spraying path automatically generated needs amendment, staff revises spray parameters by control button 128.Thus, central controller 126 generates spraying path again, and produces spraying instruction, completes spraying operation to control spray robot 112.
In one embodiment, optical measuring apparatus 106 comprises data-interface 130, picking sensor 132, depth camera 134, transfer station 136 and motor control module 138.Data-interface 130 is connected with main control device 102, drives parameter, and transmit tripleplane's view to main control device 102 for receiving from main control device 102.Composition graphs 2 to Fig. 5 is described by concrete structure and the operation of optical measuring apparatus 106.
Figure 2 shows that optical measuring apparatus 106 according to an embodiment of the invention.As shown in Figure 2, transfer station 136 comprises conveyer belt 224.Conveyer belt 224 covers belt, for spraying workpiece is sent to the other end from one end of transfer station.Fig. 2 shows a spraying workpiece is sent to other end schematic diagram from one end of transfer station.For convenience, Fig. 2 shows this spraying workpiece respectively in the state in transfer station two ends and centre position.
In one embodiment, picking sensor 132 is installed in transfer station 136.More particularly, transfer station 136 comprises two table tops, and picking sensor 132 is arranged on the junction of two table tops.In the embodiment of fig. 2, picking sensor 132 comprises two groups of light curtain transmitters and receiver, such as: first group of transmitter 210 and receiver 211, second group of transmitter 212 and 213.When transfer station 136 transmits described spraying workpiece, the first surface of described spraying workpiece and the projection view of second are measured and recorded to described two groups of light curtain transmitters and receiver respectively.Such as: the top view of described spraying workpiece is measured and recorded to transmitter 210 and receiver 211; The front view of described spraying workpiece is measured and recorded to transmitter 212 and receiver 213.More particularly, the transmitter of each picking sensor sends equidistant light, and corresponding receiver receives corresponding light, and when receiver receives light, output is first signal of telecommunication; When light is blocked by the body, receiver does not receive light, then export second signal of telecommunication; Described picking sensor calculates obverse shape and the size of described workpiece for measurement according to described first signal of telecommunication and described second point signal.
Depth camera 134 is installed on one end of transfer station 136.Depth camera 134 is according to the range difference measurement between described spraying workpiece and described transfer station background and the projection view of the 3rd recording described spraying workpiece.More particularly, depth camera 134 is arranged on the direction of transfer face of described spraying workpiece, and thus, depth camera 134 arranges and have recorded the left view of described spraying workpiece.
Advantage is, adopt two groups of picking sensors of Fig. 2 and the structure of depth camera, optical measuring apparatus 106, without the need to three groups of picking sensors, not only facilitates building of transfer station 136, also a saving the cost of transfer station 136.
In another embodiment, picking sensor comprises three groups of light curtain transmitters and receiver, for measuring and record the projection view (this embodiment not shown) in three faces (i.e. front view, top view and left view) of described spraying workpiece respectively.
Figure 3 shows that the schematic diagram of transfer station 136 according to an embodiment of the invention.Composition graphs 2 is described by Fig. 3.Fig. 3 shows a part of view of transfer station 136.Transfer station 136 comprises two table tops 302 and 304.Table top 302 and 304 is provided with conveyer belt 224 respectively.Support glass 306 is provided with between two table tops 302 and 304.Advantage is, support glass 306 can printing opacity, and therefore, light curtain transmitter 210 and receiver 211 can be separately positioned on support glass 306 and under support glass 306.In addition, light curtain transmitter 212 and receiver 213 are separately positioned on the both sides of support glass 306.In addition, as shown in Figures 2 and 3, light curtain transmitter and receiver are all fixed in transfer station 136 by light curtain bracing or strutting arrangement 222 and (will be described at Fig. 4).
Figure 4 shows that the schematic diagram of light curtain bracing or strutting arrangement 222 according to an embodiment of the invention.Composition graphs 2 and Fig. 3 are described by Fig. 4.Each light curtain transmitter of picking sensor and receiver all adopt light curtain bracing or strutting arrangement 222 as shown in Figure 4 to fix.Light curtain bracing or strutting arrangement 222 comprises two screw arms 402 and 406 and light curtain support arm 404.Two screw arms 402 and 406 lay respectively at the both sides of light curtain support arm 404, and screw arm 402 is connected by crossbeam 408 with light curtain support arm 404 with 406, and screw arm 402 and 406 has screw hole 412 and 414 respectively.Aforesaid light curtain transmitter or receiver are arranged on light curtain bracing or strutting arrangement 222 by light curtain support arm 404, and light curtain bracing or strutting arrangement 222 is individually fixed on two table tops 224 and 226 by the screw of screw hole 412 and 414.
Figure 5 shows that the structure chart of motor control module 138 according to an embodiment of the invention.In one embodiment, motor control module 138 is arranged under the table top of transfer station 136.Motor control module 138 comprises controller 502, motor 504 and encoder 506.Encoder 506 produces the feedback signal representing described conveyer belt speed, and controller 502 controls motor 504, to control the speed of conveyer belt 504 according to described feedback signal.Advantage is, by controlling the speed of conveyer belt 504, to reach the optimization effect on picking sensor and depth camera shooting perspective plane.
Figure 6 shows that the spraying method flow chart 600 controlling spray robot according to an embodiment of the invention.Composition graphs 1 to 5 is described by Fig. 6.
In step 602, optical measurement is carried out, with the dimension information of the tripleplane's view and described spraying workpiece that obtain described spraying workpiece to spraying workpiece.In step 604, the workpiece signal representing described tripleplane view and described dimension information is produced.In step 606, the spray parameters relevant to described spray robot is read.In step 608, calculate the spraying path of described spray robot according to described workpiece signal and described spray parameters, and produce the spraying instruction comprising described spraying routing information.In step 610, control described spray robot according to described spraying instruction and carry out spraying operation according to described spraying path.In step 612, the feedback signal of the conveyer belt speed representing transfer station 136 is produced.In step 614, control the motor 504 of transfer station 136 according to described feedback signal, to control described conveyer belt speed.
Figure 7 shows that the method flow diagram 602 according to an embodiment of the invention spraying workpiece being carried out to optical measurement.Fig. 7 is further describing the step 602 in Fig. 6.
In a step 702, described spraying workpiece is sent to the other end from one end of transfer station.In step 704, in the transport process of described spraying workpiece, three groups of transmitters and receiver is adopted to measure and record the projection view in three faces of described spraying workpiece respectively.
Figure 8 shows that the method flow diagram 602 ' spraying workpiece being carried out to optical measurement according to another embodiment of the present invention.Fig. 8 is further describing the step 602 in Fig. 6.Fig. 7 and Fig. 8 is two kinds of different embodiments of step 602.
In step 802, described spraying workpiece is sent to the other end from one end of transfer station.In step 804, in the transport process of described spraying workpiece, two groups of light curtain transmitters and receiver is adopted to measure and record the first surface of described spraying workpiece and the projection view of second respectively.In step 806, adopt depth camera according to the range difference measurement between described spraying workpiece and described transfer station background and the projection view of the 3rd recording described spraying workpiece.In the embodiment of Fig. 7 or Fig. 8, transfer station, support glass, depth camera, motor control module and picking sensor adopt the structure of Fig. 2 to Fig. 5, just repeat no more at this.
Advantage is, adopts the control method of Fig. 6 to Fig. 8 to use optical measuring apparatus to measure 3-D view and the dimension information of workpiece for measurement, avoids and scheme in default of workpiece CAD and automatically cannot generate the problem in spraying path.Meanwhile, automatically generate spraying path according to the 3-D view of workpiece for measurement and dimension information, avoid the error produced because of artificial check and correction path, improve deposition accuracies, and which thereby enhance coating quality.
Be described further to the method generating spraying path according to 3-D view below.
Figure 9 shows that the method flow diagram 900 of central controller 126 according to an embodiment of the invention.Method flow diagram 900 describes a kind of spray robot control method based on threedimensional model identification.
In step 902, for main control device 102, optical measuring apparatus 106 and spraying equipment 104 arrange hardware driving parameter.Wherein, main control device 102 data-interface 130 that comprises display 122, be connected with described optical measuring apparatus 106 with described spraying equipment 104.Spraying equipment 104 comprises spray gun 110 and spray robot 112.
In step 904, tripleplane's view of workpiece to be sprayed is read from optical measuring apparatus 106.
In step 906, produce spraying instruction according to described tripleplane view and dimension information, spray described spraying workpiece to control spray robot 112.
Figure 10 shows that the other method flow chart 904 of central controller 126 according to an embodiment of the invention.Method flow diagram 904 describes a kind of method controlling spray robot path.Figure 10 is the further illustrating of step 904 in Fig. 9.
In step 1002, tripleplane's view of spraying workpiece is read.In step 1004, read the spray parameters of described spray robot.In step 1006, the spraying path of each one side of described spraying workpiece is calculated according to described tripleplane view and described spray parameters.In step 1008, the spraying path of described each one side is presented on display 122.In step 1010, user judges that whether this spraying path, face is feasible.If spraying path is infeasible, then enter step 1012, user resets spray parameters by control button 128.Thus, central controller 126 regenerates the spraying path of each one side of spraying workpiece according to changing later parameter, and enters step 1008.
If spraying path is feasible, then enter step 1014, the spraying path according to described each one side produces integral spray path.
In step 1016, produce spraying instruction, to control to spray workpiece described in described coating robot coats.
Advantage is, by the step of display display and user's amendment, spraying path is optimized more.Meanwhile, with user's manual operation spray gun measure spray path method compared with, change parameter and the method automatically generating spraying path simplifies manual operation, and improve the computational accuracy in spraying path.
In another embodiment, central controller 126 eliminates step 1008 to step 1010.
Figure 11 shows that the method flow diagram 1006 in the spraying path calculating one side according to an embodiment of the invention.Figure 11 is further illustrating step 1006 in Figure 10.
In step 1102, determine described workpiece according to described tripleplane view multiple to be sprayed.In step 1104, the spraying node span of the spray gun of spray robot and coating cloud diameter according to described spray parameters and described tripleplane view computation, and determine the spraying node in each face of described multiple to be sprayed according to described spraying node span and described coating cloud diameter, and obtain the two-dimensional points coordinate of described spraying node.The two-dimensional coordinate computational methods of the two dimension spraying node in step 1102 to step 1104 will be described in conjunction with Figure 12.
Figure 12 shows that one side spraying node schematic diagram 1200 according to an embodiment of the invention.In one embodiment, spray parameters comprises technological parameter and path parameter.Wherein, technological parameter comprises spray gun distance, spraying coverage, spraying number of times and angle of gun.Path parameter comprise to whole workpiece spraying mode and surface information to be sprayed.The mode of this integral spray comprises one side and multiaspect sprays, bound edge is preferential or one side is preferential.According to technological parameter, horizontal and vertical division is carried out to spray-coating surface, ensure that spraying node drops within range of views simultaneously.As shown in figure 12, when needs calculate spraying node, the scope of central controller 126 according to spray gun distance, spraying coverage and angle of gun determination spray gun spraying coating cloud and the node span of movement at every turn.Thus, the position of each spraying node is set according to the scope and node span that spray coating cloud.
Get back to Figure 11, in a step 1106, the three-dimensional coordinate that the described spraying node calculating each face according to each view two-dimensional points coordinate corresponding relation of described tripleplane view is corresponding.Step 1106 will further describe in Figure 13 to Figure 16.
In step 1108, three-dimensional coordinate according to the three-dimensional coordinate of each node of described spraying node and the adjacent node of each node described calculates the normal vector that each sprays node, wherein, described normal vector represents the spatiality of described spray gun at correspondence spraying node.Step 1106 will further describe in fig. 17.
In step 1110, the spraying profile of described band spray-coating surface is generated according to the three-dimensional coordinate of described spraying node.Step 1108 will further describe in Figure 17 to Figure 18.
In step 1112, spatial fit is carried out to described spraying profile, to obtain spraying profile after matching.Step 1112 will further describe in Figure 19.
In step 1114, calculate the running orbit of described spray gun according to the spraying profile after described matching.Step 1114 will further describe in fig. 20.
Figure 13 shows that the method flow diagram 1106 calculating three-dimensional coordinate corresponding to one side spraying node according to an embodiment of the invention.Figure 13 is further illustrating step 1106 in Figure 11.In one embodiment, tripleplane's view comprises front view, top view and left view.
In step 1302, the two-dimensional coordinate of the spraying node in front view is converted to three-dimensional coordinate.In step 1304, the two-dimensional coordinate of the spraying node in top view is converted to three-dimensional coordinate.In step 1306, the two-dimensional coordinate of the spraying node in left view is converted to three-dimensional coordinate.What deserves to be explained is, step 1302 can exchange execution sequence arbitrarily to 1306.
Figure 14 shows that the method flow diagram 1302 calculating three-dimensional coordinate corresponding to front view spraying node according to an embodiment of the invention.Figure 14 is further describing step 1302.Figure 14 is described for the target spraying node in front view.
In one embodiment, utilize three-view diagram method for reconstructing can calculate the three-dimensional coordinate of spraying node, be equivalent to spraying node motion to arrive on the surface of model reality.The principle of Figure 14 is: in three-view diagram, for (an x (v) in front view, z (v)), demand fulfillment is a bit (y (w), z (w)) in left view, z (w)=z (v), and there is a bit (x (h) in a top view, y (h)) make x (h)=x (v), y (h)=y (w), the three-dimensional coordinate that just can obtain this point corresponding in front view is (x (v), y (h), z (w)), otherwise the three-dimensional coordinate of this point cannot be obtained.In one embodiment, if the point (x (h) of the point of left view (y (w), z (w)) or top view, y (h)) be positioned at beyond model real surface, then cannot obtain three-dimensional coordinate.In one embodiment, if the z (w) in front view is not equal to the z (v) in left view, then need to choose immediate value z (v).Below will describe in detail.
In step 1402, read the described target spraying node in described front view.The two-dimensional coordinate of described target spraying node in described front view is (X, Z), supposes that described target spraying node is (X, Y, Z) at three-dimensional coordinate.In step 1404, traversal detects the capable spraying node row coordinate belonging to described workpiece for measurement of X in described top view.In step 1406, more described row coordinate, to obtain maximum Y_Max1 and the minimum of a value Y_Min1 of described row coordinate.What deserves to be explained is, for the point (x, y) in top view, the point that x coordinate is corresponding in a top view is not likely confirmed as spraying node, in this case, needs the value range first determining Y.
In step 1408, in the described left view of traversal detection, Z dependent of dead military hero is in the spraying rows of nodes coordinate of described workpiece for measurement.In step 1410, more described row-coordinate, to obtain maximum Y_Max2 and the minimum of a value Y_Min2 of described row-coordinate.What deserves to be explained is, for the point (y, z) in left view, the point that Z coordinate is corresponding in left view is not likely confirmed as spraying node, in this case, needs the value range first determining Y.
In step 1412, calculate the first difference between described maximum Y_Max1 and described maximum Y_Max2.In step 1414, calculate the second difference between described minimum of a value Y_Min1 and described minimum of a value Y_Min2.When described first difference is greater than the first predetermined threshold value (step 1416) or described second difference is greater than second predetermined threshold value (step 1418), then enter step 1426, stop the three-dimensional coordinate calculating described target spraying node, otherwise, enter step 1420.Due to difference be greater than threshold value time, specification error is too large, then cannot find rational corresponding points, therefore, stops calculating three-dimensional coordinate.
In step 1420, determine maximum Y_Max and the minimum of a value Y_Min of coordinate Y.Specifically, when described first difference is less than described first predetermined threshold value and described second difference is less than described second predetermined threshold value, then more described maximum Y_Max1 and described maximum Y_Max2, and more described minimum of a value Y_Min1 and described minimum of a value Y_Min2.When described maximum Y_Max1 equals described maximum Y_Max2, then the maximum Y_Max of the Y-coordinate in the three-dimensional coordinate of described target spraying node equals Y_Max1 or Y_Max2, otherwise the maximum Y_Max of Y-coordinate is the smaller value in Y_Max1 and Y_Max2.When described minimum of a value Y_Min1 equals described minimum of a value Y_Min2, the minimum of a value Y_ Min of the Y-coordinate in the three-dimensional coordinate of then described target spraying node equals Y_Min1 or Y_Min2, otherwise the minimum of a value Y_ Min of Y-coordinate is the smaller value in Y_Min1 and Y_Min2.
In step 1422, according to spray-coating surface label determination coordinate Y.In one embodiment, the spray-coating surface numbering of described workpiece to be sprayed is read.When described be numbered odd number time, then the coordinate Y of described target spraying node equals minimum of a value Y_Min.When described be numbered even number time, then the coordinate Y of described target spraying node equals maximum Y_Max.In step 1424, draw three-dimensional coordinate (X, Y, Z).
Figure 15 shows that the method flow diagram 1304 calculating three-dimensional coordinate corresponding to top view spraying node according to an embodiment of the invention.Figure 15 is further describing step 1304.Figure 15 is described for the target spraying node in top view.
In step 1502, read the target spraying node in described top view, the two-dimensional coordinate of described target spraying node in described front view be (X ', Y '), and suppose that described target spraying node is (X ', Y ', Z ') at three-dimensional coordinate.In step 1504, traversal detects X ' row in described front view and belongs to the spraying node row coordinate of described workpiece for measurement.In step 1506, the row coordinate of more described front view, to obtain maximum Z ' _ Max1 and minimum of a value the Z ' _ Min1 of described row coordinate.In step 1508, traversal detects the capable spraying node row coordinate belonging to described workpiece for measurement of Y in described left view.In step 1510, the row coordinate in more described left view, to obtain maximum Z ' _ Max2 and minimum of a value the Z ' _ Min2 of described row coordinate.In step 1512, calculate the first difference between described maximum Z ' _ Max1 and described maximum Z ' _ Max2.In step 1514, calculate the second difference between described minimum of a value Z ' _ Min1 and described minimum of a value Z ' _ Min2.
When described first difference is less than the first predetermined threshold value (step 1516) and described second difference is less than the second predetermined threshold value (step 1518), then enter step 1520, otherwise, enter step 1526, stop coordinates computed Z.
In step 1520, determine maximum Z ' _ Max and minimum of a value the Z ' _ Min of coordinate Z '.More particularly, more described maximum Z ' _ Max1 and described maximum Z ' _ Max2, and more described minimum of a value Z ' _ Min1 and described minimum of a value Z ' _ Min2.When described maximum Z ' _ Max1 equals described maximum Z ' _ Max2, maximum the Z ' _ Max of the Z ' coordinate in the three-dimensional coordinate of then described target spraying node equals Z ' _ Max1 or Z ' _ Max2, otherwise maximum the Z ' _ Max of Z ' coordinate is the smaller value in Z ' _ Max1 and Z ' _ Max2; When described minimum of a value Z ' _ Min1 equals described minimum of a value Z ' _ Min2, minimum of a value the Z ' _ Min of the Z ' coordinate in the three-dimensional coordinate of then described target spraying node equals Z ' _ Min1 or Z ' _ Min2, otherwise minimum of a value the Z ' _ Min of Z ' coordinate is the smaller value in Z ' _ Min1 and Z ' _ Min2.
In step 1522, from Z ' _ Min and Z ' _ Max, one is selected to be worth as coordinate Z ' according to the spray-coating surface information of described workpiece to be sprayed, to determine that described target spraying node is in three-dimensional coordinate (X ', Y ', Z ') (step 1524).
Figure 16 shows that the method flow diagram 1306 calculating three-dimensional coordinate corresponding to left view spraying node according to an embodiment of the invention.Figure 16 is further describing step 1306.Figure 16 is described for the target spraying node in left view.
In step 1602, read the target spraying node in described left view, the two-dimensional coordinate of described target spraying node in described left view be (Y ' ', Z ' '), and suppose that described target spraying node is (X ' ', Y ' ', Z ' ') at three-dimensional coordinate.
In step 1604, in the described front view of traversal detection, Z ' ' dependent of dead military hero is in the spraying rows of nodes coordinate of described workpiece for measurement.In step 1606, the row-coordinate in more described front view, to obtain maximum X ' ' _ Max1 and the minimum of a value X ' ' _ Min1 of described row-coordinate.In step 1608, in the described top view of traversal detection, Y ' ' dependent of dead military hero is in the spraying rows of nodes coordinate of described workpiece for measurement.
In step 1610, the row-coordinate in more described top view, to obtain maximum X ' ' _ Max2 and the minimum of a value X ' ' _ Min2 of described row coordinate.In step 1612, calculate the first difference between described maximum X ' ' _ Max1 and described maximum X ' ' _ Max2.In step 1614, the second difference between described minimum of a value X ' ' _ Min1 and described minimum of a value X ' ' _ Min2 is calculated.
When described first difference is less than the first predetermined threshold value (step 1616) and described second difference is less than the second predetermined threshold value (step 1618), then enter step 1620, otherwise, stop coordinates computed X ' '.
In step 1620, determine maximum X ' ' _ Max and the X ' ' _ Min of X ' '.In one embodiment, more described maximum X ' ' _ Max1 and described maximum X ' ' _ Max2, and more described minimum of a value X ' ' _ Min1 and described minimum of a value X ' ' _ Min2.When described maximum X ' ' _ Max1 equals described maximum X ' ' _ Max2, the maximum X ' ' _ Max of the X ' ' coordinate in the three-dimensional coordinate of then described target spraying node equals X ' ' _ Max1 or X ' ' _ Max2, otherwise the maximum X ' ' _ Max of X ' ' coordinate is the smaller value in X ' ' _ Max1 and X ' ' _ Max2.When described minimum of a value X ' ' _ Min1 equals described minimum of a value X ' ' _ Min2, the minimum of a value X ' ' _ Min of the X ' ' coordinate in the three-dimensional coordinate of then described target spraying node equals X ' ' _ Min1 or X ' ' _ Min2, otherwise the minimum of a value X ' ' _ Min of X ' ' coordinate is the smaller value in X ' ' _ Min1 and X ' ' _ Min2;
In step 1622, from X ' ' _ Min and X ' ' _ Max, one is selected to be worth as coordinate X ' ' according to the spray-coating surface information of described workpiece to be sprayed, to determine that described target spraying node is in three-dimensional coordinate (X ' ', Y ' ', Z ' ') (step 1624).
Figure 17 shows that the method flow diagram 1108 calculating each spraying nodal method vector according to an embodiment of the invention.Figure 17 is further describing the step 1108 in Figure 11.Figure 17 chooses wherein to illustrate to a target spraying node J.As previously mentioned, spray nodal method vector γ and represent the spatial attitude of spray gun at spraying node.
Figure 18 shows that the schematic diagram of target spraying node J and adjacent node J1, J2, J3 and J4 according to an embodiment of the invention.Be described below with reference to Figure 17 and Figure 18.
In step 1702, read the three dimensional space coordinate of target spraying node J.In step 1704, detect adjacent node J1, J2, J3 and the J4 on four adjacent directions of described target spraying node.In step 1706, read the three dimensional space coordinate of described four adjacent nodes J1, J2, J3 and J4.In step 1708, spraying node J is connected respectively with straight line, J1, J2, triangle (the J that J3 and J4 is formed, J1, J2), (J, J2, J3), (J, J3, and (J J4), J4, J1), wherein, (J, J1, J2) expression straight line is by node J, the triangle that J1 and J2 is connected to form, (J, J2, J3) expression straight line is by node J, the triangle that J2 and J3 is connected to form, (J, J3, J4) expression straight line is by node J, the triangle that J3 and J4 is connected to form, (J, J4, J1) expression straight line is by node J, the triangle that J4 and J1 is connected to form.In step 1708, calculate 4 normal vectors of triangle (J, J1, J2), (J, J2, J3), (J, J3, J4) and (J, J4, J1) respectively.Leg-of-mutton normal vector refers to the direction vector vertical with the face that triangle is formed.In step 1710, calculate the mean value of described 4 normal vectors, to obtain the normal vector of described target spraying node J.
Advantage is, the method for the computing method vector in Figure 17 considers the situation of the four direction of destination node, and thus, this normal vector can show spray gun more accurately in the due angle of destination node and attitude, improves the accuracy of spraying.
Figure 19 shows that the method flow diagram 1112 according to an embodiment of the invention described spraying profile being carried out to spatial fit.Figure 19 is further describing the step 1112 in Figure 11.
For the spraying node that space generates, each row (column) is a space curve at space representation.Represent with straight line if will spray between two between node, be then unfavorable for the spraying operation of robot, therefore needing the spraying profile to generating to carry out matching, representing with straight line and curve.
In step 1902, select the scan mode of each spraying node described.In step 1904, according to described scan mode read described multiple to be sprayed ought data above.In step 1906, according to the three-dimensional coordinate of N-th row node described N-th row node projected to described ought above, to obtain the three-dimensional coordinate at the described multiple projection nodes that ought go up above.In step 1908, calculate the slope of the connecting line of each node of described multiple projection node node corresponding with described N-th row node.In step 1910, the size between the slope that more each node is corresponding and slope corresponding to adjacent node.In step 1912, when described comparative result shows the slope of present node equal with adjacent slope (illustrating that present node and adjacent node are in a plane), then the first numbering is added to described first node, otherwise (illustrating that present node and adjacent node are in Different Plane), adds the second numbering to described first node.
In step 1914, determine index value according to described numbering.Traversal detects the numbering of described multiple projection node.When described present node be numbered the first numbering time, then the interval between described present node and the adjacent node of described present node adds the first index value (such as: logical zero).When described first node be numbered the second numbering time, then the interval between described first node and the adjacent node of described first node adds the second index value (such as: logical one).
In step 1916, according to spraying profile described in the index value matching that each node described is corresponding.Specifically, when the index value in described interval is the first index value (representing that present node and adjacent node are at grade), then the spraying profile in described interval is connect the straight line being contained in described interval node.When the index value in described interval is the second index value (representing that present node and adjacent node are in Different Plane), then to the multiple point of described Interval Sampling, and three difference matchings are carried out to described multiple point, to obtain the curve in described interval, namely the spraying profile in described interval is described curve.
After obtaining spraying node matching track and normal vector, just can according to the spraying profile of spray gun described in following formulae discovery and normal vector:
Wherein, H represents the distance of described spray gun apart from described surface of the work to be sprayed; P ' (X, Y, Z) represents the node in the running orbit of spray gun; P (X, Y, Z) represents the spraying node on to be sprayed; V ' (X, Y, Z) represents the normal vector of spraying node; V (X, Y, Z) represents the normal vector of spray gun.
Figure 20 shows that the method flow diagram 1014 producing integral spray path according to an embodiment of the invention.Figure 20 is the further description of the step 1014 in Figure 10.
In step 2002, if the spraying method of each of described workpiece for measurement is one side spraying, then enter step 2003, described overall path is the spraying path of described each tested surface, otherwise, enter step 2004.In step 2004, if the spraying method of each of described workpiece for measurement is multiaspect spraying, then enter step 2005, the spraying path of described each tested surface is combined and interpolation, to produce multiaspect spraying path as described integral spray path, otherwise, enter step 2006.
In step 2006, the spraying method of each of described workpiece for measurement comprises one side spraying and multiaspect spraying, now, enter step 2007, the tested surface sprayed for needing one side chooses the one side spraying path of described tested surface, and the spraying path of the tested surface sprayed for needing multiaspect to described each tested surface is combined and interpolation, to produce multiaspect spraying path.Combine described one side spraying path and described multiaspect spraying path, to form integral spray path.
In sum, adopt Study of Intelligent Robot Control system and method for the present invention can measuring workpieces three-view diagram automatically, and automatically generate the spraying profile of spray gun according to three-view diagram.Do not need in this process manually to try spray, thus improve deposition accuracies, alleviate artificial burden.Meanwhile, owing to can not be subject to the restriction of workpiece CAD figure, Study of Intelligent Robot Control system and method operation of the present invention is easier, and applicable surface is wider.
Detailed description of the invention and accompanying drawing are only the conventional embodiment of the present invention above.Obviously, various supplement, amendment and replacement can be had under the prerequisite not departing from the present invention's spirit that claims define and invention scope.It should be appreciated by those skilled in the art that the present invention can change in form, structure, layout, ratio, material, element, assembly and other side under the prerequisite not deviating from invention criterion according to concrete environment and job requirement in actual applications to some extent.Therefore, be only illustrative rather than definitive thereof in the embodiment of this disclosure, the scope of the present invention is defined by appended claim and legal equivalents thereof, and is not limited thereto front description.
Claims (2)
1. produce the method in integral spray path, it is characterized in that, the method in described generation integral spray path comprises the following steps:
Read tripleplane's view of spraying workpiece;
Read the spray parameters of described spray robot;
Calculate the spraying path of each one side of described spraying workpiece according to described tripleplane view and described spray parameters, wherein, the spraying path of described each one side is represented by the three-dimensional coordinate of the spraying node on described each one side and normal vector;
Judge the spraying method of described workpiece for measurement each;
When the spraying method of each of described workpiece for measurement is one side spraying, then described overall path is the spraying path of described each tested surface;
When the spraying method of each of described workpiece for measurement is multiaspect spraying, then the spraying path of described each tested surface is combined and interpolation, to produce multiaspect spraying path as described integral spray path;
When the spraying method of each of described workpiece for measurement comprises one side spraying and multiaspect spraying, then the tested surface needing one side to spray is chosen to the one side spraying path of described tested surface, and the spraying path of the tested surface sprayed for needing multiaspect to described each tested surface is combined and interpolation, spray path as a whole to produce multiaspect spraying path;
When the spraying method of each of described workpiece for measurement comprises one side spraying and multiaspect spraying, combine described one side spraying path and described multiaspect spraying path, to form integral spray path; And
Spraying instruction is produced, to control to spray workpiece described in described coating robot coats according to described integral spray path.
2. the method in generation integral spray path according to claim 1, it is characterized in that, described spraying instruction comprises described multiple data set, described multiple data set comprises the data of spraying line number data, spraying path attribute data, spray gun attribute data and multiple attitude point, wherein, connected mode described in spraying path attribute data representation between multiple attitude point, described connected mode comprises: straight line connects and is connected with matched curve, and described multiple attitude point data comprises three-dimensional point coordinate and the unit normal vector of corresponding spraying node.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510000796.5A CN104525421A (en) | 2015-01-04 | 2015-01-04 | Method for generating overall spraying path |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510000796.5A CN104525421A (en) | 2015-01-04 | 2015-01-04 | Method for generating overall spraying path |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN104525421A true CN104525421A (en) | 2015-04-22 |
Family
ID=52841153
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201510000796.5A Pending CN104525421A (en) | 2015-01-04 | 2015-01-04 | Method for generating overall spraying path |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104525421A (en) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106327561A (en) * | 2016-08-31 | 2017-01-11 | 武汉湾流科技股份有限公司 | Intelligent spraying method and system based on machine vision technology |
| CN107214024A (en) * | 2017-06-16 | 2017-09-29 | 深圳市鹏创达自动化有限公司 | Ink ejecting method, device and the computer-readable recording medium of substrate |
| WO2018177211A1 (en) * | 2017-03-27 | 2018-10-04 | 陕西华拓科技有限责任公司 | Robot for performing droplet jetting, and droplet jetting control method for robot |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS58131163A (en) * | 1982-01-29 | 1983-08-04 | Asahi Okuma Ind Co Ltd | Coating method and apparatus therefor |
| CN201380635Y (en) * | 2009-03-18 | 2010-01-13 | 广州亚陆控制系统有限公司 | Printing system |
| CN102806178A (en) * | 2012-07-25 | 2012-12-05 | 杭州先临三维科技股份有限公司 | Spraying system capable of automatically acquiring spraying positioning size and spraying method of spraying system |
| CN202735526U (en) * | 2012-08-29 | 2013-02-13 | 叶茂军 | Mounting structure of infrared light screen sensor |
| CN103990571A (en) * | 2014-05-22 | 2014-08-20 | 北京铭隆世纪科技有限公司 | Automatic paint-spraying method and device |
| CN203825668U (en) * | 2014-05-14 | 2014-09-10 | 贵州中南交通科技有限公司 | Light screen sensor fixing device for vehicle identification |
-
2015
- 2015-01-04 CN CN201510000796.5A patent/CN104525421A/en active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS58131163A (en) * | 1982-01-29 | 1983-08-04 | Asahi Okuma Ind Co Ltd | Coating method and apparatus therefor |
| CN201380635Y (en) * | 2009-03-18 | 2010-01-13 | 广州亚陆控制系统有限公司 | Printing system |
| CN102806178A (en) * | 2012-07-25 | 2012-12-05 | 杭州先临三维科技股份有限公司 | Spraying system capable of automatically acquiring spraying positioning size and spraying method of spraying system |
| CN202735526U (en) * | 2012-08-29 | 2013-02-13 | 叶茂军 | Mounting structure of infrared light screen sensor |
| CN203825668U (en) * | 2014-05-14 | 2014-09-10 | 贵州中南交通科技有限公司 | Light screen sensor fixing device for vehicle identification |
| CN103990571A (en) * | 2014-05-22 | 2014-08-20 | 北京铭隆世纪科技有限公司 | Automatic paint-spraying method and device |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106327561A (en) * | 2016-08-31 | 2017-01-11 | 武汉湾流科技股份有限公司 | Intelligent spraying method and system based on machine vision technology |
| WO2018177211A1 (en) * | 2017-03-27 | 2018-10-04 | 陕西华拓科技有限责任公司 | Robot for performing droplet jetting, and droplet jetting control method for robot |
| CN107214024A (en) * | 2017-06-16 | 2017-09-29 | 深圳市鹏创达自动化有限公司 | Ink ejecting method, device and the computer-readable recording medium of substrate |
| CN107214024B (en) * | 2017-06-16 | 2020-01-21 | 深圳市鹏创达自动化有限公司 | Ink jetting method and device for substrate and computer readable storage medium |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104525420A (en) | Spraying robot control method based on three-dimensional model recognition | |
| CN104525422A (en) | Method for controlling paths of spray robot | |
| CN104549850A (en) | Method for controlling spraying gun of spraying robot | |
| CN104525423A (en) | Spray method for controlling spray robot | |
| CN104525424A (en) | Optical measurement device for setting spraying path of spraying robot | |
| US11441899B2 (en) | Real time position and orientation tracker | |
| CN109967292A (en) | A kind of automatic spraying system and its method based on the reconstruct of workpiece profile information three-dimensional | |
| CN110238831A (en) | Robot teaching system and method based on RGB-D image and teaching device | |
| CN204448383U (en) | A kind of intelligent robot paint finishing | |
| CN204469968U (en) | A kind of optical measuring apparatus for coating robot coats's path setting | |
| CN109765901A (en) | Dynamic cost digital map navigation method based on line laser and binocular vision | |
| CN106949845A (en) | Two-dimensional laser galvanometer scanning system and scaling method based on binocular stereo vision | |
| CN108286949A (en) | A kind of packaged type three dimensional detection robot system | |
| CN104588243B (en) | A kind of intelligent robot paint finishing | |
| CN102135776A (en) | Industrial robot control system based on visual positioning and control method thereof | |
| CN103294886A (en) | System for reproducing virtual objects | |
| CN106737859A (en) | The method for calibrating external parameters of sensor and robot based on invariable plane | |
| CN104525421A (en) | Method for generating overall spraying path | |
| CN107941167B (en) | Space scanning system based on unmanned aerial vehicle carrier and structured light scanning technology and working method thereof | |
| CN114459345B (en) | Aircraft fuselage position and posture detection system and method based on visual space positioning | |
| CN104549851B (en) | Method for fitting spraying joint of workpeice to be sprayed | |
| Xu et al. | Projector-guided non-holonomic mobile 3D printing | |
| CN104707749B (en) | A kind of method of the 3-D spraying nodal method vector that workpiece to be sprayed is set | |
| CN106182088B (en) | Localization method, device between industrial robot and grid | |
| CN115675784B (en) | Ship block docking system and docking method based on digital measuring field |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20150422 |
|
| RJ01 | Rejection of invention patent application after publication |