JP5636148B2 - Automatic welding machine position detection system - Google Patents

Description

  The present invention relates to a position detection system for an automatic welder.

  In the automatic welder position detection system, the workpiece displacement is detected by operating the manipulator while irradiating the workpiece with the laser from the laser displacement sensor attached to the welding torch of the manipulator. Reflects.

  Here, the laser displacement sensor control device for controlling the laser displacement sensor is configured as an independent separate unit including a CPU board, an AD board, a relay printed board, and the like. The robot control device that drives and controls the manipulator and the laser displacement sensor control device exchange control information through serial communication.

  The system has a one-way search function for detecting the displacement. In this one-way search function, the detection point P1 is detected by operating the laser displacement sensor LS in any one direction (search direction) as shown in FIG. 19, and the deviation (deviation amount) between the reference point P0 and the detection point P1 is detected. This is a function of calculating and saving the deviation amount in one direction of the workpiece W in the deviation amount correction file F. The reference point P0 is a point detected by the laser displacement sensor LS when the workpiece W is located at the original position. Then, the actual workpiece can be welded by reflecting the calculated deviation amount in the welding program. In FIG. 19, an approach point AP indicates a point where the laser beam from the laser displacement sensor LS starts to be projected.

The one-way search operation is performed according to the following procedure.
As shown in FIG. 20 (a), in the robot controller RC, the laser irradiation command is sent to the laser displacement sensor controller LU when the point just before the one-way search command is reached by the reproduction operation by the program that is already taught teaching data. Is output, and then a one-way search command is output. In response to this laser irradiation command, the laser displacement sensor control device LU turns on the laser displacement sensor LS, and the laser displacement sensor LS starts distance measurement upon execution of the one-way search command. At the same time, under the control of the robot controller RC, the laser displacement sensor LS starts operation toward the search target point together with the welding torch of the manipulator. The laser displacement sensor LS outputs distance measurement data obtained by projecting the laser beam to the laser displacement sensor control device LU. The laser displacement sensor control device LU performs height detection based on the distance measurement data, and continues measurement until this height reaches a predetermined reference height.

  As shown in FIG. 20B, when the laser displacement sensor LS detects the workpiece W, that is, when the result of the height detection reaches the reference height, the laser displacement sensor control device LU turns off the laser of the laser displacement sensor LS. To turn on the touch detection input of the robot controller. When the robot control device RC receives the touch detection input, the robot control device RC stops the manipulator, calculates the amount of deviation between the previously taught reference point and the point stopped during the search, and stores it in the deviation amount correction file.

As described above, the position displacement of the workpiece can be detected by simply inputting the touch detection input to the object to the robot control device using the laser displacement sensor.
Patent Documents 1 to 5 are known as conventional techniques using a laser displacement meter. Patent Document 1 is a patent related to optical axis adjustment of a laser displacement meter, and Patent Document 2 is a patent related to welding position correction by a laser displacement meter. Patent Documents 3 to 5 are techniques relating to groove position detection using a laser displacement meter.
JP 07-299702 A Japanese Patent Laid-Open No. 09-183087 JP-A-10-146675 JP-A-11-123678, paragraph 0009 JP 2001-334366 A

  By the way, in conventional one-way search position detection, if there is no step at the point to be a feature point, such as the middle point of a lap joint, the one-way search alone cannot detect misalignment, and the number of searches There are cases where the groove position is obtained by performing the rotation and calculating the detection position, but there are problems that the teaching becomes complicated and the detection time becomes long.

  In addition, in patent document 1 and patent document 2, there exists a problem in which an application range is limited to a V-shaped joint and a ladle joint groove. Patent Document 3 has a problem that a plurality of search operations are required for detection of one groove in addition to being limited to a V-shaped joint and a labyrinth joint groove. In Patent Document 4, distance data is sampled by a one-way search, a temporary point where the slope changes suddenly (called a discontinuous point) is obtained, a curve by least square approximation is obtained on the left and right, and The intersection is a true feature point. The method of Patent Document 4 limits the target of feature points to only discontinuous points, and has a problem that feature points that are continuous points cannot be acquired. In Patent Document 5, the distance data is sampled by a one-way search and the groove gap center is recognized. However, a specific method for calculating the groove gap center is not mentioned.

  It is an object of the present invention to provide an automatic welding machine that does not require a plurality of search operations, does not select a joint shape (that is, a groove shape), and can make a feature point target a continuous point instead of a discontinuous point. It is to provide a position detection system.

In order to solve the above problems, the invention according to claim 1 is directed to a laser displacement sensor that projects laser light onto a welded joint to acquire distance measurement data, and the laser displacement sensor is welded together with a welding torch. A shape analysis means for analyzing the shape of the weld joint based on distance measurement data from the laser displacement sensor and a detection pattern predetermined according to the shape of the weld joint, Based on the shape analysis, groove information acquisition means for acquiring groove information including feature points and physical quantities related to the groove shape of the weld joint; robot control means for calculating and controlling the control amount of the manipulator; , wherein the detection pattern is composed of a group of parameters for analyzing the shape of the welded joint, at least in the parameter group, Parameters for designating one target position from among a plurality of target position to be a candidate of the feature point in KiHiraki tip profile are included, the portable operating for selecting a parameter for specifying the target position A target position specified by the parameter selected by the portable operation unit as a feature point, and detecting a displacement of the weld joint based on the feature point, and the manipulator based on the physical quantity It is a position detection system of an automatic welding machine characterized by correcting the control amount.

The invention of claim 2, Oite to claim 1, said shape analysis means, and groove information obtaining unit, the robot control means is characterized in that it also serves a common computer.

According to a third aspect of the invention, in the second aspect of the invention, the computer includes a distance measurement data storage unit that stores the distance measurement data, and the computer further includes a display unit that outputs and displays the distance measurement data. Is provided.

The invention of claim 4 is characterized in that, in claim 3 , the display means displays the distance measurement data in real time.

  As described above in detail, according to the first aspect of the present invention, a plurality of search operations are not required, a welded joint shape (that is, a groove shape) is not selected, and an object of a feature point is not a discontinuous point. Can be a continuous point.

Further, according to the first aspect of the invention, it is possible by the selection of parameters for specifying one target position from among a plurality of target position, to select one of a plurality of target position as a characteristic point . As a result, the control amount of the manipulator can be corrected based on the positional deviation from the selected feature point.

According to the invention of claim 2 , the shape analysis means, the groove information acquisition means, and the robot control means are shared by a common computer so that the distance measurement data received from the laser displacement sensor LS is sampled and the data memory is stored. Storage and shape analysis processing are realized by a common computer. Therefore, the loss of communication time does not occur as the number of search points as described above increases.

According to the invention of claim 3 , the behavior of the distance measurement data until it is detected by the one-way search can be confirmed on the display means, and at the time of erroneous detection, the operator can easily confirm the location where the erroneous detection has occurred. Can be done.

According to the invention of claim 4 , since the distance measurement data is displayed in real time when the manipulator is operated, the operator can confirm the laser operation in real time when an erroneous detection occurs.

(First embodiment)
A first embodiment in which a position detection system for an automatic welding machine according to the present invention is applied to a control device for a welding robot will be described below with reference to FIGS.

  FIG. 1 is a block diagram illustrating a configuration of a control apparatus 10 for a welding robot. The control device 10 of the welding robot controls the workpiece (work object) W so as to automatically perform arc welding. The welding robot control device 10 controls a manipulator M that performs a welding operation, a robot control device RC that controls the manipulator M, a laser displacement sensor LS as a sensor that detects the shape of the workpiece W, and a laser displacement sensor LS. And a laser displacement sensor controller LU.

  In addition, a teach pendant TP as a portable operation unit is connected to the robot controller RC. The teach pendant TP is provided with a keyboard and a liquid crystal display (not shown). Various teaching data are input to the robot controller RC by the keyboard.

  The manipulator M includes a base member 12 fixed to a floor or the like, and a plurality of arms 13 connected via a plurality of shafts. A welding torch 14 as a work tool is provided at the distal end portion of the arm 13 located on the most distal side. The welding torch 14 includes a wire 15 as a filler material, generates an arc between the tip of the wire 15 fed by a feeding device (not shown) and the workpiece W, and welds the wire 15 with the heat. To weld the workpiece W. A plurality of motors (not shown) are disposed between the arms 13, and the welding torch 14 can be freely moved back and forth and left and right by driving the motors. Note that front and rear refers to the direction in which the welding torch 14 travels along the weld line as the front, and the opposite direction 180 degrees as the rear. Left and right are referred to as left and right with reference to the direction in which the person travels.

  The robot controller RC controls the motor to drive the welding torch 14 along the main track of preset teaching data. Further, the robot controller RC outputs welding conditions such as a welding current and a welding voltage to the welding power source WPS, and causes the welding operation to be performed by electric power supplied from the welding power source WPS through the power cable PK. The robot control device RC corresponds to robot control means.

  The laser displacement sensor LS is a scanning type laser displacement sensor that measures the distance to the workpiece W by light emission and light reception of a laser, and is mounted on the welding torch 14. The laser displacement sensor LS includes a light emitting unit that emits light toward the workpiece W, a light receiving unit that receives the laser reflected by the workpiece W, and the like (both not shown). The laser emitted from the light emitting unit is irregularly reflected by the workpiece W and received by the light receiving unit. The light receiving unit is constituted by a CCD line sensor, for example, and measures the distance from the center of gravity of the received light amount distribution to the workpiece W.

The laser displacement sensor control device LU drives and controls the laser displacement sensor LS, and detects the groove shape of the workpiece W from the measured distance information. The laser displacement sensor control device LU includes a central processing unit (CPU), a computer including a plurality of shape analysis programs prepared according to various groove shapes, a memory for storing various data, and the like. As shown in FIG. 1, a display Disp and an adjustment personal computer PC are connected to the laser displacement sensor control device LU, and the laser displacement sensor control device LU can adjust the laser displacement sensor LS and read various data. .

In this embodiment, the laser displacement sensor control device LU (computer) corresponds to shape analysis means, groove information acquisition means, and shape analysis program storage means.
Next, the one-way search procedure for the groove information acquisition function in the robot control apparatus 10 will be described with reference to FIGS. 9, 10A, and 10B.

  In order to realize the above function, as a precondition, the sensor head LSa is attached so that the laser irradiation direction of the laser displacement sensor LS is parallel to any axis of the tool coordinate system, and FIG. 1 shows a welding torch 14 as a tool, and the tool coordinate system is represented as shown in FIG. In this embodiment, as shown in FIG. 2B, the sensor head LSa of the laser displacement sensor LS is attached to the welding torch 14 so that the laser irradiation direction is the Z-direction.

  In addition, before the welding operation is performed, the robot controller RC receives and stores teaching data indicating the operation and welding conditions of the manipulator M when welding is performed through the teach pendant TP.

  (1) First, the robot controller RC regenerates the manipulator M according to the teaching data, performs a search operation for the laser displacement sensor LS in one direction as shown in FIG. 3, and sets the reference point to the robot controller RC in advance. Remember. The method for acquiring the reference point will be described later for convenience of explanation.

(2) Next, after returning the manipulator M, the robot controller RC performs a reproduction operation according to the teaching data, and when the laser displacement sensor LS reaches the point just before the groove information acquisition command, as shown in FIG. A laser irradiation command is output to the laser displacement sensor controller LU. At the same time, the robot controller RC laser detects the detection pattern number corresponding to the detection pattern number and the detection parameter and the data sampling period input in advance by the teach pendant TP for shape analysis input in advance by the teach pendant TP. Transmit to the displacement sensor control unit LU.

Here, the detection parameter is a set of numerical values used in shape analysis by the laser displacement sensor control device LU. There are a plurality of detection parameters corresponding to the detection pattern number, and the meaning of the detection parameter changes depending on the detection pattern number.

Examples of detection parameters will be described later.
Note that the robot controller RC stores the position of the manipulator M as a search start point coordinate when the laser irradiation command is output to the laser displacement sensor controller LU.

(3) Thereafter, the robot controller RC outputs a groove information acquisition command to the laser displacement sensor controller LU.
(4) The laser displacement sensor LS starts distance measurement (that is, acquisition of distance measurement data) under the control of the laser displacement sensor control device LU according to the laser irradiation command, and at the same time, the welding torch 14 of the manipulator M reaches the search end point. Start moving towards. Then, distance measurement data obtained by projecting the laser light is input from the laser displacement sensor LS to the laser displacement sensor control device LU.

  The laser displacement sensor control device LU stores distance measurement data (that is, distance data) received from the laser displacement sensor LS at a cycle determined by the data sampling cycle during laser irradiation.

  (5) When the manipulator M reaches the search end point, the robot controller RC transmits a laser extinguishing command to the laser displacement sensor controller LU. In response to the command, the laser displacement sensor control device LU turns off the laser displacement sensor LS. At this time, the robot controller RC stores the position of the manipulator M as a search end point when a laser extinguishing command is output to the laser displacement sensor controller LU. Simultaneously with the transmission of the laser turn-off command, the robot control device RC transmits the search start point and the search end point in the robot coordinate system to the laser displacement sensor control device LU.

(6) After the search operation is completed, the laser displacement sensor control device LU performs an analysis process described later on the distance measurement data obtained in time series. Hereinafter, data on which analysis processing described later is performed is referred to as analysis target data. Then, a feature point for the analysis target data on the memory is obtained. Further, the laser displacement sensor control device LU obtains physical quantities such as a gap amount and a groove angle according to the groove. A detailed description of how to obtain the feature points and physical quantities will be described later with examples.

(Feature points and physical quantities)
Here, the characteristic points and physical quantities will be described by taking V-shaped joints, lap joints, and arc positions as welding joints as examples.

(V-shaped joint)
In the case of a V-shaped joint, as shown in FIG. 4, in the groove of the left and right welding base materials (work W), the middle point P of the groove located on the extended plane E on the upper surfaces of both welding members is a characteristic point. In the case of the V-shaped joint, the gap amount, groove depth, groove angle θ1, and groove angle θ2 are physical quantities. As shown in FIG. 4, the gap amount G is the distance between the edge portions of the left and right weld base materials of the groove that are spaced apart from each other (the distance between the open tips of the left and right weld base materials). The groove depth H is the depth of the groove. The groove angle θ1 is an angle on the groove side of one welding base material, and the groove angle θ2 is an angle on the groove side of the other welding base material.

(Lap joint)
In the case of the lap joint, as shown in FIG. 5, the end point of the upper plate U (referred to as the upper plate angle) is a feature point. In addition, the distance between the upper plate U and the lower plate S is a gap amount which is a physical quantity. Note that the gap amount of the lap joint is obtained by calculating the difference between the distance measurement data from the laser displacement sensor LS to the lower plate S and the distance measurement data from the upper plate U, and based on the difference, the preset upper plate U It can be obtained by subtracting the plate thickness.

(Calculation of feature points and physical quantities)
Here, the laser displacement sensor control device LU is describing calculation of the feature point and the physical quantity by the analysis process intends row. Analysis of this is performed the shape analysis program corresponding to the detected pattern number shown in Table 1 is read by a laser displacement sensor controller LU computers in the following order: (1) to (10). In the following description, detection parameters referred to when the computer executes are those described in detection parameters 1 to 9 shown in Table 1. These detection parameters are detection conditions for calculating feature points and physical quantities.

The detection parameter 1 and the detection parameter 2 respectively define an upper limit value and a lower limit value of data. The detection parameter 3 and the detection parameter 4 define an offset amount and a straight line length in the groove, respectively. The detection parameter 5 defines a target position (marked as a target position in Table 1) as a feature point. “0” is the deepest part of the groove and “1” is the upper left edge of the groove. “2” designates the upper right edge of the groove, “3” designates the midpoint of the groove, and “4” designates the approximate straight line intersection. Which position is the target position is set in the shape analysis program when the operator inputs in advance from the teach pendant TP.

The detection parameter 6 defines a threshold value for endpoint detection. The detection parameter 7 defines the offset amount outside the groove. The detection parameter 8 defines a filter mode for filtering the analysis target data, “0” is no filter, “1” is a moving average, “2” is a median, “3” is both a moving average and a median. Means processing. Which filter processing is performed is set in the shape analysis program in advance by the operator through input from the teach pendant TP. The detection parameter 9 defines the filter window width.

（１）まず、レーザ変位センサ制御装置ＬＵは検出パラメータ８でフィルタモードを設定する。

(1) First, the laser displacement sensor control device LU sets the filter mode with the detection parameter 8.

(2) Next, the laser displacement sensor control device LU filters the analysis target data according to the set filter mode with the filter window width specified by the detection parameter 9.
(3) Subsequently, the laser displacement sensor control device LU excludes data outside the range of the detection parameter 1 (data upper limit value) to the detection parameter 2 (data lower limit value) from the distance measurement distance, and the data deepest portion is included in the data. Search (see FIG. 6). In FIG. 6, black points indicate sampling points at the time of distance measurement data acquisition.

  (4) Next, the laser displacement sensor control device LU draws approximate straight lines each having a straight line length specified by the detection parameter 4 at both ends of the groove centering on a position that is offset from the deepest portion specified by the detection parameter 3. (See FIG. 6).

  (5) Subsequently, the laser displacement sensor control device LU sets the left and right open tips as points that start to be separated from each straight line by the distance specified by the detection parameter 6 (that is, the threshold value for endpoint detection) among the measured sampling points. (See FIG. 6).

(6) Next, the laser displacement sensor control device LU designates a feature point with the detection parameter 5 (see FIG. 6). In the present embodiment, it is assumed that “3” is selected as the shape analysis program in advance by an operator's input. Note that an acute angle is selected as each crossing angle.

(7) Subsequently, the laser displacement sensor control device LU sets the distance G between the open ends of the left and right welding base materials as the gap amount G (see FIG. 6).
(8) Next, the laser displacement sensor control device LU draws an approximate straight line outside the left groove centering on the position moved to the left by the offset amount specified by the detection parameter 7 from the left end of the groove. Similarly, a straight line outside the right groove is drawn (see FIG. 6).

(9) Subsequently, the laser displacement sensor control device LU sets the distance between the approximate straight line outside the left groove and the deepest part as the groove depth (see FIG. 6).
(10) Then, the laser displacement sensor control device LU determines the intersection angle between the left groove portion approximate line and the left groove outside approximate line as the groove angle θ1, and the right groove portion approximate line and the right groove outside approximate line as the intersection angle. Is a groove angle θ2 (see FIG. 6).

In addition, although there exists a place where the inclination changes steeply in the lap joint or the V-shaped joint, the groove information acquisition function can be applied even when this is not the case. For example, the arc position can be searched. The shape analysis procedure at the arc position is as follows (1) to (7).

This shape analysis is executed by reading a shape analysis program corresponding to the detection pattern number shown in Table 2 by the computer of the laser displacement sensor control device LU. The selection of the shape analysis program is determined in advance by operator input. The detection parameters that are referred to when the computer executes are those described in detection parameters 1 to 6 shown in Table 2. In this case, these detection parameters are detection conditions for calculating feature points.

The detection parameter 1 here defines the section length at the time of vertex search. The detection parameter 2 defines the amount of decrease from the apex. The detection parameter 3 is a height difference threshold value when searching for points A and B. The detection parameter 4 defines the radius of the arc to be searched. The detection parameter 5 defines a filter mode for filtering the shape target data. “0” is no filter, “1” is a moving average, “2” is a median, “3” is both a moving average and a median. Means processing. Which filter processing is performed is set in the shape analysis program when the operator inputs in advance from the teach pendant TP. The detection parameter 6 defines the filter window width.

（１）レーザ変位センサ制御装置ＬＵは検出パラメータ５でフィルタモードを設定する。

(1) The laser displacement sensor control device LU sets the filter mode with the detection parameter 5.

(2) Next, the laser displacement sensor control device LU filters the data to be analyzed with the filter window width specified by the detection parameter 6 according to the set filter mode.
(3) Subsequently, the laser displacement sensor control device LU searches for the apexes roughly based on the sampling points (see FIG. 8). The black dots in FIG. 8 indicate sampling points at the time of distance measurement data acquisition.

(4) Then, the laser displacement sensor control device LU excludes data away from the apex by the detection parameter 4 or more.
(5) Next, the laser displacement sensor control device LU searches the position where the detection parameter 2 is lowered from the apex. The search is started from the left end of the data shaped in (4) (hereinafter referred to as shaped data),
((Ranging data)-(Vertex-Detection parameter 2)) <Detection parameter 3
Let the point A be point A. Similarly, the search is performed from the right end of the shaped data, and the point B is obtained.

(6) Subsequently, the laser displacement sensor control device LU calculates a midpoint C of the points A to B.
(7) The laser displacement sensor control device LU uses the position of the coordinate of C in the left-right direction and the coordinate of the height of the vertex in the vertical direction as a feature point.

(Calculation of feature point coordinates)
Now, returning to the original, the laser displacement sensor control device LU is configured to use the feature points on the analysis target data obtained by the shape analysis processing and the search start point and search end point robots transmitted from the robot control device RC. The feature point coordinates in the robot coordinates are obtained from the coordinates, and are returned to the robot controller RC together with the physical quantity.

  Here, the feature points are obtained separately for the search direction and the laser irradiation direction. Hereinafter, the position of the feature point in the search direction is referred to as “left / right position”, and the position of the feature point in the laser irradiation direction is referred to as “up / down position”. At this time, the horizontal position and vertical position are obtained as follows.

（基準点の位置）
そして、最初の一方向サーチ動作時にはこれらが基準点（基準位置）として記録される。その様子を図７に示す。なお、図７は説明の便宜上サーチ方向がロボット座標系のＸ軸と平行に図示しているが、実際のサーチは必ずしもＸ軸と平行である必要はない。

(Reference point position)
These are recorded as reference points (reference positions) during the initial one-way search operation. This is shown in FIG. Although FIG. 7 shows the search direction parallel to the X axis of the robot coordinate system for convenience of explanation, the actual search does not necessarily need to be parallel to the X axis.

After acquiring the reference point (reference position) in this way, the one-way search operation is similarly performed on the workpiece W to be constructed.
(Calculation of deviation)
As described above, the robot control device RC calculates the deviation amount from the coordinates of the feature points returned from the laser displacement sensor control device LU and the previously stored reference point coordinates by the following formula, and the robot control device RC The data is stored in a shift amount correction file of a storage device such as a memory included in the computer.

（制御量の補正）
又、ロボット制御装置ＲＣは、レーザ変位センサ制御装置ＬＵから返信された物理量、例えば、ギャップ量、開先深さ、開先角度θ１、開先角度θ２の大きさに応じて、制御量としての溶接電流や、溶接速度や、ウィービング振幅を変化させる。例えば、ギャップ量が基準としている量よりも長くなれば、ロボット制御装置ＲＣは溶接電流を増加させたり、溶接速度を遅くしたり、或いはウィービング振幅を広くする。又、逆にギャップ量が基準としている量よりも短くなれば、ロボット制御装置ＲＣは溶接電流を減少させたり、溶接速度を速くしたり、或いはウィービング振幅を狭くする。

(Control amount correction)
Further, the robot controller RC determines a physical quantity returned from the laser displacement sensor controller LU, for example, a control amount according to the magnitude of the gap amount, the groove depth, the groove angle θ1, and the groove angle θ2. The welding current, welding speed, and weaving amplitude are changed. For example, if the gap amount is longer than the reference amount, the robot controller RC increases the welding current, decreases the welding speed, or widens the weaving amplitude. Conversely, if the gap amount is shorter than the reference amount, the robot controller RC decreases the welding current, increases the welding speed, or narrows the weaving amplitude.

  In the present embodiment, a two-dimensional groove information acquisition (feature point and physical quantity) can be performed by the same operation as the one-way search by using a sensor capable of only one-dimensional detection such as a laser displacement sensor. Here, the term “two-dimensional” means that the groove information can be obtained on a plane including the X-axis and the Z-axis.

  Further, by applying a detection algorithm suitable for each groove, it is possible to obtain characteristic points and physical quantities for various grooves other than lap joints and V-shaped joints. Further, even in the same joint, for example, feature points can be selected by switching detection parameters as in detection parameter 5 in Table 1.

According to the welding robot control apparatus 10 of the first embodiment, the following effects can be obtained.
(1) control unit 10 of the welding robot of this embodiment includes a laser displacement sensor controller LU as shape analysis means for performing a shape analysis of V-shaped coupling such as, for example, based on the distance measurement data from the laser displacement sensor LS. Then, the laser displacement sensor control device LU is based on shape analysis as a groove information acquisition means, for example, a feature point or physical quantity (gap amount, groove depth, groove angle θ1, opening angle) regarding the groove shape of the V-shaped joint. The groove information including the point angle θ2) is acquired. The laser displacement sensor control device LU detects, for example, a positional deviation of a V-shaped joint or the like based on the feature points. As a result, according to the present embodiment, a plurality of search operations are not necessary for feature point detection and a groove shape is not selected. Further, the feature point can be a continuous point instead of a discontinuous point so that the midpoint P of the groove located on the extended plane E on the upper surfaces of both weld members is a feature point. This is because Patent Document 4 has sampled distance data by a one-way search and used a temporary point (discontinuous point) where the slope of the line connecting the sampling points suddenly changes as a feature point. This is a feature that arises from the fact that the configuration of the form is very different.

(2) Further, the laser displacement sensor control device LU of the present embodiment can further acquire a physical quantity related to a groove shape such as a V-shaped joint based on the shape analysis.
(3) Further, the robot control device RC of the robot control device 10 according to the present embodiment can correct the control amount of the manipulator M based on the physical amount.

(4) In this embodiment, the computer of the laser displacement sensor control device LU stores a shape analysis program corresponding to the groove shape, performs shape analysis according to the selected shape analysis program, and features related to the welded joint. The groove information including was acquired. As a result, since the laser displacement sensor control device LU is executed according to the shape analysis program corresponding to the weld joint shape, it is possible to acquire feature points according to various weld joint shapes and to determine the weld joints based on the feature points. Misalignment can be detected.

(Second Embodiment)
Next, a second embodiment will be described with reference to FIGS. In addition, about the same structure as 1st Embodiment, the same code | symbol is attached | subjected, the detailed description is abbreviate | omitted, and it demonstrates centering on a different structure.

  The robot control device 10 according to the present embodiment has a basic function of the laser displacement sensor control device LU according to the first embodiment in the robot control device RC, so that the laser displacement sensor control device LU, the adjustment personal computer PC, and the display. Disp is omitted, and other configurations are provided as in the first embodiment. FIG. 12 shows the relationship between the robot controller RC and the laser displacement sensor LS in the second embodiment. That is, the robot control device RC connected to be able to communicate with the teach pendant TP is directly connected to the laser displacement sensor LS.

Therefore, the robot controller RC (computer) of this embodiment corresponds to a shape analysis unit, a groove information acquisition unit, a shape analysis program storage unit, a distance measurement data storage unit, and a robot control unit.

  Although not explained in the first embodiment, the teach pendant TP is provided with a keyboard 41 and a liquid crystal display 42 as a display means. Various teaching data and the like are input to the robot controller RC by the keyboard 41.

Hereinafter, the operation of the present embodiment will be described.
Also in the second embodiment, in order to realize the groove information acquisition function as in the first embodiment, as a precondition, the laser irradiation direction of the laser displacement sensor LS is any axis of the tool coordinate system. The sensor head LSa is attached so as to be in parallel with each other. In addition, before the welding operation is performed, the robot controller RC receives and stores teaching data indicating the operation and welding conditions of the manipulator M when welding is performed through the teach pendant TP.

  (1) First, the robot controller RC regenerates the manipulator M according to the teaching data, performs a search operation for the laser displacement sensor LS in one direction as shown in FIG. 3, and sets the reference point to the robot controller RC in advance. Remember. The method for acquiring the reference point is the same as in the first embodiment.

  (2) Next, after returning the manipulator M, the robot controller RC performs a reproduction operation according to the teaching data, and when the laser displacement sensor LS reaches the point just before the groove information acquisition, the laser control device RC performs the laser operation as shown in FIG. A laser irradiation command is output to the displacement sensor LS.

At the same time, the robot controller RC (computer) detects a detection pattern number for shape analysis that has been input in advance by the teach pendant TP, detection parameters and data sampling corresponding to the detection pattern number and input in advance by the teach pendant TP. Considering the period, the shape analysis program stored in a memory (not shown) or the like is executed.

  (3) Thereafter, the robot control device RC executes groove information acquisition. That is, in response to the laser irradiation command, the laser displacement sensor LS starts distance measurement (that is, acquisition of distance measurement data), and at the same time, the welding torch 14 of the manipulator M starts operation toward the search end point. Then, the distance measurement data obtained by projecting the laser beam is input from the laser displacement sensor LS to the robot controller RC (see FIG. 14A).

  In the robot controller RC, during laser irradiation, distance measurement data (that is, distance data) received from the laser displacement sensor LS at a cycle determined by the data sampling cycle is stored in a memory.

  (4) When the manipulator M reaches the search end point, the robot controller RC transmits a laser extinguishing command to the laser displacement sensor LS (see FIG. 14B). In response to the command, the laser displacement sensor LS is turned off. At this time, the robot controller RC stores the position of the manipulator M in the memory as the search end point when the laser extinguishing command is output.

(5) After the search operation is completed, the robot controller RC performs a shape analysis process on the distance measurement data obtained in time series. Then, a feature point for the analysis target data on the memory is obtained. Also, the robot controller RC obtains physical quantities such as a gap amount and a groove angle according to the groove.

In the following, the shift amount is calculated as in the first embodiment, and the control amount of the manipulator M is corrected using the physical amount.
In the second embodiment, the robot controller RC displays a graph of the shape analysis result on the display area Da (see FIG. 15) of the display including the liquid crystal display device provided in the teach pendant TP. Various physical quantities are displayed on the display area Db (see FIG. 16). In the present embodiment, the display area Db also shows the number of groove (laser) data.

The features of the second embodiment will be described below.
(1) In the first embodiment, since the laser displacement sensor controller LU manages all the distance data and analysis target data of the laser displacement sensor LS, the robot controller RC and the laser displacement sensor control each time one search is performed. Serial communication is performed between the devices LU. At this time, it takes a total time of 10 ms to 20 ms (at 115,200 bps). For this reason, in the first embodiment, the loss of communication time increases as the number of search points increases.

On the other hand, the second embodiment does not have such a problem. The distance measurement data received from the laser displacement sensor LS performed by the laser displacement sensor control device LU is sampled, the data is stored in the memory, and the shape analysis process is performed. Is realized by the robot controller RC. Therefore, no communication time loss occurs even if the number of search points increases.

In the second embodiment, the laser displacement sensor control device LU is eliminated, and the equipment cost can be reduced.
Note that the data display method in the second embodiment of the present invention may be modified as follows.

  In the second embodiment, as shown in FIG. 17, the distance measurement data may be displayed later after the one-way search operation on the liquid crystal display 42 of the teach pendant TP.

This embodiment has the following features.
(1) In the first embodiment, all the distance data and analysis target data of the laser displacement sensor LS are managed by the laser displacement sensor control device LU. For this reason, in the first embodiment, when the shape analysis of the groove information acquisition function is not successful, a monitor or a personal computer is connected to the laser displacement sensor control device LU, and the operation content confirmation work is required. In the one-way search, the distance measurement data can be displayed on the teach pendant as shown in FIG. In FIG. 17, the horizontal axis represents time, and the vertical axis represents distance.

  Therefore, in this embodiment, the behavior of the distance measurement data until it is detected by the one-way search can be confirmed on the teach pendant TP connected to the robot control device RC. In addition, at the time of erroneous detection, it is possible to easily check the location where the erroneous detection has occurred. That is, in the present embodiment, it is not necessary to bother to connect a monitor or a personal computer, and it is possible to easily check a location where an erroneous detection has occurred using the teach pendant.

  Further, in the second embodiment, as shown in FIG. 18, the distance measurement data may be displayed on the liquid crystal display 42 of the teach pendant TP in real time as shown in FIG. In FIG. 18, the horizontal axis represents time, and the vertical axis represents distance.

By being configured as described above, laser irradiation can be performed and distance measurement data can be displayed on the teach pendant TP in real time.
And by operating the manipulator M manually, you can check the behavior of the distance measurement data at the location you want to measure without using an external tool such as a personal computer on the teach pendant TP. Can be done easily.

The block diagram of the control apparatus of the robot of 1st Embodiment which actualized this invention. (A) is explanatory drawing of a tool coordinate system, (b) is a perspective view of the laser displacement sensor LS which shows the attachment state of the laser displacement sensor LS. Explanatory drawing of one-way search operation | movement. Explanatory drawing of the feature point and physical quantity of a V-shaped joint. Explanatory drawing of the feature point and physical quantity of a lap joint. Explanatory drawing of the procedure of shape analysis of a V-shaped joint. Explanatory drawing which shows the mode of conversion to the robot coordinate of a feature point and a physical quantity. Explanatory drawing of shape analysis of a circular arc position. Explanatory drawing explaining operation | movement of the groove | channel information acquisition function of 1st Embodiment. (A), (b) is explanatory drawing explaining operation | movement of the groove | channel information acquisition function of 1st Embodiment. (A) is a block diagram of the control apparatus of the robot of 2nd Embodiment, (b) is the schematic of the teach pendant TP. Explanatory drawing which shows the relationship between the robot control apparatus RC and laser displacement sensor LS in 2nd Embodiment. Explanatory drawing explaining operation | movement of the groove | channel information acquisition function of 2nd Embodiment. (A), (b) is explanatory drawing explaining operation | movement of the groove | channel information acquisition function of 2nd Embodiment. The explanatory diagram which displayed the shape analysis result as a graph and displayed on the display of the teach pendant TP. Explanatory drawing which displayed various physical quantities on the display of teach pendant TP. Explanatory drawing which shows the example by which ranging data was displayed on the teach pendant by one-way search in other embodiment. Explanatory drawing which shows the example of a ranging data real-time display on a teach pendant in other embodiment. Explanatory drawing of a one-way search function. (A)-(c) is explanatory drawing of a one-way search.

Explanation of symbols

LU ... Laser displacement sensor control device ( shape analysis means, groove information acquisition means, shape analysis program storage means), RC ... Robot control device ( shape analysis means, groove information acquisition means, shape analysis program storage means), LS ... Laser displacement sensor, 42 ... Liquid crystal display (display means).

Claims (4)

A laser displacement sensor for projecting laser light to a welded joint to obtain distance measurement data;
A manipulator for moving the laser displacement sensor in a direction crossing the welding line together with the welding torch;
Shape analysis means for performing shape analysis of the weld joint based on distance measurement data from the laser displacement sensor and a detection pattern predetermined according to the shape of the weld joint;
Based on the shape analysis, groove information acquisition means for acquiring groove information including feature points and physical quantities related to the groove shape of the weld joint;
Robot control means for calculating and controlling the control amount of the manipulator,
The detection pattern includes a group of parameters for analyzing the shape of the weld joint, and the parameter group includes at least one of a plurality of target positions that are candidates for the feature points in the groove shape. Includes parameters for specifying the target position of
A portable operation unit for selecting a parameter for designating the target position ;
The target position specified by the parameter selected in the portable operation unit is used as a feature point, and the displacement of the weld joint is detected based on the feature point, and the control amount of the manipulator is set based on the physical quantity. A position detection system for an automatic welding machine characterized by correcting.   2. The position detection system for an automatic welding machine according to claim 1, wherein the shape analysis means, the groove information acquisition means, and the robot control means are shared by a common computer. The computer includes distance measurement data storage means for storing the distance measurement data,
The position detection system for an automatic welding machine according to claim 2, wherein the computer is further provided with display means for outputting and displaying the distance measurement data.   4. The automatic welding machine position detection system according to claim 3, wherein the display means displays the distance measurement data in real time.

Images