CN104525422A - Method for controlling paths of spray robot - Google Patents
Method for controlling paths of spray robot Download PDFInfo
- Publication number
- CN104525422A CN104525422A CN201510000829.6A CN201510000829A CN104525422A CN 104525422 A CN104525422 A CN 104525422A CN 201510000829 A CN201510000829 A CN 201510000829A CN 104525422 A CN104525422 A CN 104525422A
- Authority
- CN
- China
- Prior art keywords
- spraying
- node
- spray
- path
- coordinate
- 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.)
- Granted
Links
- 239000007921 spray Substances 0.000 title claims abstract description 145
- 238000000034 method Methods 0.000 title claims abstract description 71
- 238000005507 spraying Methods 0.000 claims description 342
- 239000013598 vector Substances 0.000 claims description 36
- 238000005259 measurement Methods 0.000 claims description 32
- 238000000576 coating method Methods 0.000 claims description 13
- 239000011248 coating agent Substances 0.000 claims description 12
- 230000001419 dependent effect Effects 0.000 claims description 5
- 238000001514 detection method Methods 0.000 claims description 5
- 230000000052 comparative effect Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000015572 biosynthetic process Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 39
- 230000003287 optical effect Effects 0.000 description 23
- 101100129500 Caenorhabditis elegans max-2 gene Proteins 0.000 description 12
- 239000011521 glass Substances 0.000 description 6
- 239000003973 paint Substances 0.000 description 6
- 230000008021 deposition Effects 0.000 description 4
- 239000000203 mixture Substances 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000000205 computational method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 231100001261 hazardous Toxicity 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 231100000614 poison Toxicity 0.000 description 1
- 230000007096 poisonous effect Effects 0.000 description 1
- 238000007639 printing Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000013589 supplement Substances 0.000 description 1
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)
- Application Of Or Painting With Fluid Materials (AREA)
- Manipulator (AREA)
Abstract
The invention discloses a method for controlling paths of a spray robot. The method includes the following steps that three-dimensional projection views of a sprayed workpiece are read; spray parameters of the spray robot are read; according to the three-dimensional projection views and the spray parameters, the spray path on each single face of the sprayed workpiece is calculated; the spray path on each single face is displayed on a displayer; user commands are read; according to the user commands, the spray parameters are modified; according to the modified spray parameters, the spray path on each single face of the sprayed workpiece is calculated; according to the spray path on each single face, a whole spray path is generated; spray commands are generated, so that the spray robot is controlled to spray the sprayed workpiece.
Description
Technical field
The present invention relates to spraying field, be specifically related to a kind of method controlling spray robot 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 controlling spray robot 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 controlling spray robot path, it is characterized in that, the method in described control spray robot path comprises the following steps:
Read tripleplane's view of spraying workpiece;
Read the spray parameters of described spray robot;
The spraying path of each one side of described spraying workpiece is calculated according to described tripleplane view and described spray parameters;
By the display of the spraying path of described each one side over the display;
Read user instruction;
Described spray parameters is revised according to described user instruction;
The spraying path of each one side of described spraying workpiece is calculated according to amended spray parameters;
Spraying path according to described each one side produces integral spray path; And
Produce spraying instruction, to control to spray workpiece described in described coating robot coats.
In one embodiment, the described step calculating the spraying path of each one side of described spraying workpiece according to described tripleplane view and described spray parameters also comprises:
Determine described workpiece according to described tripleplane view multiple to be sprayed;
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;
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 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;
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, and described normal vector represents the spatiality of described spray gun at correspondence spraying node;
The spraying profile of described band spray-coating surface is generated according to the three-dimensional coordinate of described spraying node;
Spatial fit is carried out to described spraying profile, to obtain spraying profile after matching;
The running orbit of described spray gun is calculated according to the spraying profile after described matching.
In one embodiment, described tripleplane view comprises front view, top view and left view, and the step of the three-dimensional coordinate that the described spraying node in described each face of calculating is corresponding also comprises:
Read the target spraying node in described front view, the two-dimensional coordinate of described target spraying node in described front view is (X, Z), and described target spraying node is (X, Y, Z) at three-dimensional coordinate;
Traversal detects the capable spraying node row coordinate belonging to described workpiece for measurement of X in described top view;
More described row coordinate, to obtain maximum Y_Max1 and the minimum of a value Y_Min1 of described row coordinate;
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;
More described row-coordinate, to obtain maximum Y_Max2 and the minimum of a value Y_Min2 of described row-coordinate;
Calculate the first difference between described maximum Y_Max1 and described maximum Y_Max2;
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 or described second difference is greater than the second predetermined threshold value, then stop the three-dimensional coordinate calculating described target spraying node, otherwise, continue to perform following step;
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;
Read the spray-coating surface numbering of described workpiece to be sprayed;
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 one embodiment, described tripleplane view comprises front view, top view and left view, and the step of each spraying nodal method vector of described calculating also comprises:
Read the three dimensional space coordinate of target spraying node J;
Detect the adjacent node on four adjacent directions of described target spraying node;
Read the three dimensional space coordinate of described four adjacent nodes J1, J2, J3 and J4;
Triangle (J, J1, J2), (J of spraying node J, J1, J2, J3 and J4 formation is connected respectively with straight line, J2, J3), (J, J3, and (J J4), J4, J1), wherein, (J, J1, J2) expression straight line triangle that node J, J1 and J2 are connected to form, (J, J2, J3) expression straight line triangle that node J, J2 and J3 are connected to form, (J, J3, J4) expression straight line triangle that node J, J3 and J4 are connected to form, the triangle that node J, J4 and J1 are connected to form by (J, J4, J1) expression straight line;
Calculate 4 normal vectors of triangle (J, J1, J2), (J, J2, J3), (J, J3, J4) and (J, J4, J1) respectively;
Calculate the mean value of described 4 normal vectors, to obtain the normal vector of described target spraying node J.
In one embodiment, described the step that described spraying profile carries out spatial fit also to be comprised:
Select the scan mode of each spraying node described;
Read described multiple to be sprayed ought data above;
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;
Calculate the slope of the connecting line of each node of described multiple projection node node corresponding with described N-th row node;
Size between the slope that more each node is corresponding and slope corresponding to adjacent node, wherein, described projection node comprises first node;
When described comparative result shows that the slope of described first node is equal with adjacent slope, then the first numbering is added to described first node, otherwise, the second numbering is added to described first node;
Traversal detects the numbering of described multiple projection node;
When described first node be numbered the first numbering time, then the interval between described first node and the adjacent node of described first node adds the first index value;
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;
According to spraying profile described in the index value matching that each node described is corresponding.
In one embodiment, described in the index value matching that each node described in described basis is corresponding, the step of spraying profile also comprises:
When the index value in described interval is the first index value, then the spraying profile in described interval is connect the straight line being contained in described interval node; And
When the index value in described interval is the second index value, then to the multiple point of described Interval Sampling, and carry out three difference matchings to described multiple point, to obtain the curve in described interval, namely the spraying profile in described interval is described curve.
In one embodiment, the step calculating the running orbit of described spray gun according to the spraying profile after described matching also comprises:
According to the matching track of described spraying node and described normal vector 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.
In one embodiment, described generation integral spray path step also comprises:
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.
In one embodiment, described generation integral spray path step also comprises:
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.
In one embodiment, described generation integral spray path step also comprises:
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, to produce multiaspect spraying path; And
Combine described one side spraying path and described multiaspect spraying path, to form integral spray path.
Compared with prior art, adopt optical gauge of the present invention to make whole Study of Intelligent Robot Control system 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 (10)
1. control the method in spray robot path, it is characterized in that, the method in described control spray robot path comprises the following steps:
Read tripleplane's view of spraying workpiece;
Read the spray parameters of described spray robot;
The spraying path of each one side of described spraying workpiece is calculated according to described tripleplane view and described spray parameters;
By the display of the spraying path of described each one side over the display;
Read user instruction;
Described spray parameters is revised according to described user instruction;
The spraying path of each one side of described spraying workpiece is calculated according to amended spray parameters;
Spraying path according to described each one side produces integral spray path; And
Produce spraying instruction, to control to spray workpiece described in described coating robot coats.
2. the method in control spray robot path according to claim 1, is characterized in that, the described step calculating the spraying path of each one side of described spraying workpiece according to described tripleplane view and described spray parameters also comprises:
Determine described workpiece according to described tripleplane view multiple to be sprayed;
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;
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 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;
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, and described normal vector represents the spatiality of described spray gun at correspondence spraying node;
The spraying profile of described band spray-coating surface is generated according to the three-dimensional coordinate of described spraying node;
Spatial fit is carried out to described spraying profile, to obtain spraying profile after matching;
The running orbit of described spray gun is calculated according to the spraying profile after described matching.
3. the method in control spray robot path according to claim 2, is characterized in that, described tripleplane view comprises front view, top view and left view, and the step of the three-dimensional coordinate that the described spraying node in described each face of calculating is corresponding also comprises:
Read the target spraying node in described front view, the two-dimensional coordinate of described target spraying node in described front view is (X, Z), and described target spraying node is (X, Y, Z) at three-dimensional coordinate;
Traversal detects the capable spraying node row coordinate belonging to described workpiece for measurement of X in described top view;
More described row coordinate, to obtain maximum Y_Max1 and the minimum of a value Y_Min1 of described row coordinate;
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;
More described row-coordinate, to obtain maximum Y_Max2 and the minimum of a value Y_Min2 of described row-coordinate;
Calculate the first difference between described maximum Y_Max1 and described maximum Y_Max2;
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 or described second difference is greater than the second predetermined threshold value, then stop the three-dimensional coordinate calculating described target spraying node, otherwise, continue to perform following step;
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;
Read the spray-coating surface numbering of described workpiece to be sprayed;
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.
4. the method in the control spray robot path according to Claims 2 or 3, is characterized in that, described tripleplane view comprises front view, top view and left view, and the step of each spraying nodal method vector of described calculating also comprises:
Read the three dimensional space coordinate of target spraying node J;
Detect the adjacent node on four adjacent directions of described target spraying node;
Read the three dimensional space coordinate of described four adjacent nodes J1, J2, J3 and J4;
Triangle (J, J1, J2), (J of spraying node J, J1, J2, J3 and J4 formation is connected respectively with straight line, J2, J3), (J, J3, and (J J4), J4, J1), wherein, (J, J1, J2) expression straight line triangle that node J, J1 and J2 are connected to form, (J, J2, J3) expression straight line triangle that node J, J2 and J3 are connected to form, (J, J3, J4) expression straight line triangle that node J, J3 and J4 are connected to form, the triangle that node J, J4 and J1 are connected to form by (J, J4, J1) expression straight line;
Calculate 4 normal vectors of triangle (J, J1, J2), (J, J2, J3), (J, J3, J4) and (J, J4, J1) respectively;
Calculate the mean value of described 4 normal vectors, to obtain the normal vector of described target spraying node J.
5.
the method in control spray robot path according to claim 4, is characterized in that, describedly also comprises the step that described spraying profile carries out spatial fit:
Select the scan mode of each spraying node described;
Read described multiple to be sprayed ought data above;
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;
Calculate the slope of the connecting line of each node of described multiple projection node node corresponding with described N-th row node;
Size between the slope that more each node is corresponding and slope corresponding to adjacent node, wherein, described projection node comprises first node;
When described comparative result shows that the slope of described first node is equal with adjacent slope, then the first numbering is added to described first node, otherwise, the second numbering is added to described first node;
Traversal detects the numbering of described multiple projection node;
When described first node be numbered the first numbering time, then the interval between described first node and the adjacent node of described first node adds the first index value;
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;
According to spraying profile described in the index value matching that each node described is corresponding.
6. the method in control spray robot path according to claim 5, is characterized in that, described in the index value matching that each node described in described basis is corresponding, the step of spraying profile also comprises:
When the index value in described interval is the first index value, then the spraying profile in described interval is connect the straight line being contained in described interval node; And
When the index value in described interval is the second index value, then to the multiple point of described Interval Sampling, and carry out three difference matchings to described multiple point, to obtain the curve in described interval, namely the spraying profile in described interval is described curve.
7.
the method in control spray robot path according to claim 6, it is characterized in that, the step calculating the running orbit of described spray gun according to the spraying profile after described matching also comprises:
According to the matching track of described spraying node and described normal vector 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.
8. the method in control spray robot path according to claim 7, is characterized in that, described generation integral spray path step also comprises:
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.
9. the method in control spray robot path according to claim 7, is characterized in that, described generation integral spray path step also comprises:
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.
10. the method in control spray robot path according to claim 7, is characterized in that, described generation integral spray path step also comprises:
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, to produce multiaspect spraying path; And
Combine described one side spraying path and described multiaspect spraying path, to form integral spray path.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510000829.6A CN104525422B (en) | 2015-01-04 | 2015-01-04 | Method for controlling paths of spray robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510000829.6A CN104525422B (en) | 2015-01-04 | 2015-01-04 | Method for controlling paths of spray robot |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104525422A true CN104525422A (en) | 2015-04-22 |
| CN104525422B CN104525422B (en) | 2017-01-18 |
Family
ID=52841154
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201510000829.6A Expired - Fee Related CN104525422B (en) | 2015-01-04 | 2015-01-04 | Method for controlling paths of spray robot |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104525422B (en) |
Cited By (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104841593A (en) * | 2015-05-29 | 2015-08-19 | 芜湖希美埃机器人技术有限公司 | Control method of robot automatic spraying system |
| CN106327561A (en) * | 2016-08-31 | 2017-01-11 | 武汉湾流科技股份有限公司 | Intelligent spraying method and system based on machine vision technology |
| CN106423657A (en) * | 2016-08-23 | 2017-02-22 | 武汉理工大学 | Thermal spraying robot path planning method and system based on index curve |
| CN107899814A (en) * | 2017-12-20 | 2018-04-13 | 芜湖哈特机器人产业技术研究院有限公司 | A kind of robot spraying system and its control method |
| CN109000560A (en) * | 2018-06-11 | 2018-12-14 | 广东工业大学 | Method, apparatus and equipment based on three-dimensional camera detection package dimensions |
| CN109317383A (en) * | 2018-10-25 | 2019-02-12 | 佛山市顺德区东亚汽车部件有限公司 | A kind of high-effect spraying production technology and its system for the processing of moulding surface |
| CN109703228A (en) * | 2019-02-01 | 2019-05-03 | 佛山市彩正自动化设备有限公司 | A kind of spray equipment and method using high definition visual pathway |
| CN109948247A (en) * | 2019-03-18 | 2019-06-28 | 福州大学 | A kind of handicraft surface in Automatic Optimal spraying direction sprays emulation mode |
| CN110314907A (en) * | 2018-03-29 | 2019-10-11 | 涩谷机器株式会社 | Cleaning device and its movement setting method |
| CN111530671A (en) * | 2020-05-07 | 2020-08-14 | 佛山科学技术学院 | Intelligent robot spraying method based on spraying system |
| CN112439753A (en) * | 2019-09-02 | 2021-03-05 | 涩谷机器株式会社 | Cleaning device and operation setting method thereof |
| CN115608537A (en) * | 2022-11-22 | 2023-01-17 | 广州泽亨实业有限公司 | Automatic spraying control method and control system |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1927404B1 (en) * | 2006-11-28 | 2011-01-26 | Abb Ag | Method for determining spray parameters for controlling a paint gun using a spray agent |
| CN102500498A (en) * | 2011-11-11 | 2012-06-20 | 江苏科技大学 | Optimization method for spray gun track of spraying robot on irregular polyhedron |
| CN102909148A (en) * | 2012-08-13 | 2013-02-06 | 东南大学 | Spraying path automatic generating method for adaptive modeling of multiple spray guns |
| CN103611646A (en) * | 2013-12-09 | 2014-03-05 | 江苏科技大学 | Method for spraying robot spatial path planning |
| CN103990571A (en) * | 2014-05-22 | 2014-08-20 | 北京铭隆世纪科技有限公司 | Automatic paint-spraying method and device |
-
2015
- 2015-01-04 CN CN201510000829.6A patent/CN104525422B/en not_active Expired - Fee Related
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1927404B1 (en) * | 2006-11-28 | 2011-01-26 | Abb Ag | Method for determining spray parameters for controlling a paint gun using a spray agent |
| CN102500498A (en) * | 2011-11-11 | 2012-06-20 | 江苏科技大学 | Optimization method for spray gun track of spraying robot on irregular polyhedron |
| CN102909148A (en) * | 2012-08-13 | 2013-02-06 | 东南大学 | Spraying path automatic generating method for adaptive modeling of multiple spray guns |
| CN103611646A (en) * | 2013-12-09 | 2014-03-05 | 江苏科技大学 | Method for spraying robot spatial path planning |
| CN103990571A (en) * | 2014-05-22 | 2014-08-20 | 北京铭隆世纪科技有限公司 | Automatic paint-spraying method and device |
Non-Patent Citations (2)
| Title |
|---|
| 曾勇 等: "面向复杂曲面的喷涂机器人喷枪路径的规划", 《机械科学与技术》 * |
| 樊帅权 等: "三维可视化的喷涂机器人离线轨迹规划系统", 《计算机技术与发展》 * |
Cited By (18)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104841593A (en) * | 2015-05-29 | 2015-08-19 | 芜湖希美埃机器人技术有限公司 | Control method of robot automatic spraying system |
| CN106423657A (en) * | 2016-08-23 | 2017-02-22 | 武汉理工大学 | Thermal spraying robot path planning method and system based on index curve |
| CN106423657B (en) * | 2016-08-23 | 2018-11-30 | 武汉理工大学 | A kind of thermal spraying robot path planning method and system based on index curve |
| CN106327561A (en) * | 2016-08-31 | 2017-01-11 | 武汉湾流科技股份有限公司 | Intelligent spraying method and system based on machine vision technology |
| CN107899814A (en) * | 2017-12-20 | 2018-04-13 | 芜湖哈特机器人产业技术研究院有限公司 | A kind of robot spraying system and its control method |
| CN110314907A (en) * | 2018-03-29 | 2019-10-11 | 涩谷机器株式会社 | Cleaning device and its movement setting method |
| CN109000560B (en) * | 2018-06-11 | 2021-07-06 | 广东工业大学 | Method, device and equipment for detecting package size based on three-dimensional camera |
| CN109000560A (en) * | 2018-06-11 | 2018-12-14 | 广东工业大学 | Method, apparatus and equipment based on three-dimensional camera detection package dimensions |
| CN109317383A (en) * | 2018-10-25 | 2019-02-12 | 佛山市顺德区东亚汽车部件有限公司 | A kind of high-effect spraying production technology and its system for the processing of moulding surface |
| CN109317383B (en) * | 2018-10-25 | 2021-07-16 | 佛山市顺德区东亚汽车部件有限公司 | High-efficiency spraying production process and system for surface machining of injection molding part |
| CN109703228A (en) * | 2019-02-01 | 2019-05-03 | 佛山市彩正自动化设备有限公司 | A kind of spray equipment and method using high definition visual pathway |
| CN109948247A (en) * | 2019-03-18 | 2019-06-28 | 福州大学 | A kind of handicraft surface in Automatic Optimal spraying direction sprays emulation mode |
| CN109948247B (en) * | 2019-03-18 | 2023-04-07 | 福州大学 | Handicraft surface spraying simulation method capable of automatically optimizing spraying direction |
| CN112439753A (en) * | 2019-09-02 | 2021-03-05 | 涩谷机器株式会社 | Cleaning device and operation setting method thereof |
| CN112439753B (en) * | 2019-09-02 | 2024-05-28 | 涩谷机器株式会社 | Cleaning device and operation setting method thereof |
| CN111530671A (en) * | 2020-05-07 | 2020-08-14 | 佛山科学技术学院 | Intelligent robot spraying method based on spraying system |
| CN115608537A (en) * | 2022-11-22 | 2023-01-17 | 广州泽亨实业有限公司 | Automatic spraying control method and control system |
| CN115608537B (en) * | 2022-11-22 | 2023-03-14 | 广州泽亨实业有限公司 | Automatic spraying control method and control system |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104525422B (en) | 2017-01-18 |
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 | |
| CN106873550B (en) | Simulation device and simulation method | |
| US20190036337A1 (en) | System for robotic 3d printing | |
| CN110238831A (en) | Robot teaching system and method based on RGB-D image and teaching device | |
| CN109967292A (en) | A kind of automatic spraying system and its method based on the reconstruct of workpiece profile information three-dimensional | |
| CN204448383U (en) | A kind of intelligent robot paint finishing | |
| CN204469968U (en) | A kind of optical measuring apparatus for coating robot coats's path setting | |
| CN108286949A (en) | A kind of packaged type three dimensional detection robot system | |
| CN107175660B (en) | A kind of six-freedom degree robot kinematics scaling method based on monocular vision | |
| CN102135776A (en) | Industrial robot control system based on visual positioning and control method thereof | |
| CN106949845A (en) | Two-dimensional laser galvanometer scanning system and scaling method based on binocular stereo vision | |
| CN104588243B (en) | A kind of intelligent robot paint finishing | |
| KR20160044432A (en) | Systems and methods for tracking location of movable target object | |
| CN103793936A (en) | Automated frame of reference calibration for augmented reality | |
| CN111347431A (en) | Robot teaching spraying method and device for teaching handheld tool | |
| CN104525421A (en) | Method for generating overall spraying path | |
| CN104549851B (en) | Method for fitting spraying joint of workpeice to be sprayed | |
| CN114459345A (en) | System and method for detecting position and attitude of airplane body based on visual space positioning | |
| CN104707749B (en) | A kind of method of the 3-D spraying nodal method vector that workpiece to be sprayed is set | |
| 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 | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170118 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |