Device, control device, and method for generating signals for oscillating motion.
By generating and monitoring the amplitude and frequency characteristics of the oscillation signal, the oscillation signal frequency of the robot tool is corrected in real time, which solves the problem of reduced welding accuracy caused by resonance in the oscillation motion and achieves higher welding operation stability and quality.
Patent Information
- Application Number
- CN202180100950.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-08-03
- Publication Date
- 2026-11-10
- Estimated Expiration
- 2041-08-03
AI Technical Summary
When a robot performs a swinging motion, the resonance of the tool reduces the quality of the work, especially during the welding process, affecting welding accuracy and quality.
By generating oscillation signals and monitoring the amplitude and frequency characteristics of the tool in real time, the processor is used to determine and correct resonance, and the frequency of the oscillation signals is adjusted to suppress resonance. This process includes generating oscillation signals, acquiring time series data, analyzing frequency characteristics, and performing correction processing.
It effectively suppresses the resonance of the tool during the swinging motion, improves the stability and precision of the welding operation, and enhances the welding quality.
Smart Images

Figure CN117716306B_ABST
Abstract
Description
Technical Field
[0001] This disclosure relates to an apparatus and a control device for generating signals for oscillating motion. Background Technology
[0002] Devices that enable robots to perform weaving motions are known (e.g., Patent Document 1).
[0003] Existing technical documents
[0004] Patent documents
[0005] Patent Document 1: Japanese Patent Application Publication No. 10-235582 Summary of the Invention
[0006] The problem that the invention aims to solve
[0007] In the past, when a robot shakes a tool during a swinging motion, the robot sometimes resonates, which can reduce the quality of the work.
[0008] Methods for solving problems
[0009] One aspect of this disclosure provides an apparatus that generates a oscillating motion signal, the oscillating motion being performed by a robot moving a tool along a predetermined work path and oscillating the tool in a direction intersecting the work path. The apparatus comprises: an oscillating signal generation unit that generates an oscillating signal for the robot to oscillate the tool; a time-series data acquisition unit that acquires time-series data of the amplitude value of the tool in the intersecting direction when the robot performs the oscillating motion according to the oscillating signal generated by the oscillating signal generation unit; a frequency characteristic acquisition unit that acquires a first frequency characteristic of the time-series data acquired by the time-series data acquisition unit; a resonance determination unit that determines whether the robot resonates at the frequency of the oscillating signal generated by the oscillating signal generation unit based on the first frequency characteristic acquired by the frequency characteristic acquisition unit; and a correction unit that corrects the oscillating signal to change the frequency when the resonance determination unit determines that the robot resonates.
[0010] In other aspects of this disclosure, a method is provided for generating a swinging signal, wherein the swinging action is performed by a robot moving a tool along a predetermined work path and swinging the tool in a direction intersecting the work path, wherein a processor generates a swinging signal for the robot to swing the tool, the processor acquires time-series data of the amplitude value of the tool in the intersecting direction when the robot performs the swinging action according to the generated swinging signal, the processor acquires a first frequency characteristic of the acquired time-series data, the processor determines whether the robot resonates at the frequency of the generated swinging signal based on the acquired first frequency characteristic, and when the processor determines that the robot resonates, the processor corrects the swinging signal to change the frequency.
[0011] Invention Effects
[0012] It can suppress resonance caused by tool shaking during oscillation, thus enabling more stable oscillation. As a result, it can improve the precision of welding operations, thereby improving weld quality. Attached Figure Description
[0013] Figure 1 This is a diagram of a robot system according to one implementation method.
[0014] Figure 2 yes Figure 1 The diagram shows a block diagram of the robot system.
[0015] Figure 3 express Figure 1 The trajectory shown is for the swinging motion performed by the robot.
[0016] Figure 4 Is Figure 1 The diagram shows the functional block diagram of the control device that generates swing motion commands.
[0017] Figure 5 This represents the waveform of the first swing signal in one embodiment.
[0018] Figure 6 Indicates through the Figure 5 The waveform of the second swing signal is generated by filtering the first swing signal shown.
[0019] Figure 7 express Figure 6 The frequency characteristics (spectrum) of the second swing signal are shown.
[0020] Figure 8 This represents the time-varying characteristics of the tool amplitude value at the robot's resonance at the fundamental frequency.
[0021] Figure 9 express Figure 8 The frequency characteristics of the time-varying properties are shown.
[0022] Figure 10 This represents the time-varying characteristics of the tool amplitude value when the robot resonates at harmonic frequencies.
[0023] Figure 11 express Figure 8 The frequency characteristics of the time-varying properties are shown.
[0024] Figure 12 It means Figure 1 The flowchart shown is an example of the control process for a welding operation performed by a robot system.
[0025] Figure 13 This is a diagram of a robot system with other implementation methods.
[0026] Figure 14 yes Figure 13 The diagram shows a block diagram of the robot system.
[0027] Figure 15 Is Figure 13 The diagram shows the functional block diagram of the teaching device that generates swing motion commands.
[0028] Figure 16 Other examples of tracks that represent oscillating motion.
[0029] Figure 17 Indicates the use of robots to Figure 16 The waveform of the swing signal when the track performs a swinging motion is shown. Detailed Implementation
[0030] Hereinafter, embodiments of the present disclosure will be described in detail with reference to the accompanying drawings. Furthermore, in the various embodiments described below, the same elements are labeled with the same symbols, and repeated descriptions are omitted. First, refer to... Figure 1 as well as Figure 2 The robot system 10 according to one embodiment will be described. The robot system 10 includes a robot 12 and a control device 14.
[0031] In this embodiment, robot 12 performs welding operations on workpiece W. Specifically, robot 12 is a vertical articulated robot, comprising: a robot base 16, a rotating body 18, a lower arm 20, an upper arm 22, a wrist 24, and a tool 26. The robot base 16 is fixed to the floor of the work unit or to an automated guided vehicle (AGV). The rotating body 18 is mounted on the robot base 16 in a manner that allows it to rotate about a vertical axis.
[0032] The lower arm portion 20 is rotatably mounted on the rotating body 18. The upper arm portion 22 is rotatably mounted on the front end of the lower arm portion 20. The wrist portion 24 includes: a wrist base 24a, which is rotatably mounted on the front end of the upper arm portion 22 about two mutually orthogonal axes; and a wrist flange 24b, which is rotatably mounted on the wrist base 24a.
[0033] Tool 26 is detachably mounted on wrist flange 24b. In this embodiment, tool 26 is a welding torch that generates a discharge between itself and workpiece W according to instructions from control device 14, melting welding wire fed from wire material feed device (not shown) to weld workpiece W. Alternatively, tool 26 may also be a laser processing head that emits a laser beam and melts welding wire using the laser beam to weld workpiece W.
[0034] Multiple servo motors 28 are respectively installed on the robot base 16, rotating body 18, lower arm 20, upper arm 22 and wrist 24. Figure 2 These servo motors 28 rotate the movable elements of the robot 12 (i.e., the rotating body 18, the lower arm 20, the upper arm 22, the wrist 24, and the wrist flange 24b) according to instructions from the control device 14, thereby moving the tool 26.
[0035] Control device 14 controls the movements of robot 12. For example... Figure 2 As shown, the control device 14 is a computer having a processor 30, a memory 32, and an I / O interface 34. The processor 30 has a CPU or GPU, etc., and is communicatively connected to the memory 32 and the I / O interface 34 via a bus 36. While communicating with these components, it performs calculations for executing the swinging motion described later.
[0036] The memory 32, including RAM or ROM, temporarily or permanently stores various data used in the computational processing performed by the processor 30, as well as various data generated during the computational processing. The I / O interface 34, for example, has an Ethernet port, USB port, fiber optic connector, or HDMI terminal, and communicates with external devices via wired or wireless means under instructions from the processor 30. In this embodiment, the servo motor 28 of the robot 12 is communicatively connected to the I / O interface 34.
[0037] The control device 14 includes an input device 38 and a display device 40. The input device 38 includes a keyboard, mouse, or touch panel, etc., for receiving data input from the operator. The display device 40 includes a liquid crystal display or an organic EL display, etc., for displaying various data.
[0038] The input device 38 and the display device 40 can be connected to the I / O interface 34 in a wired or wireless manner. Alternatively, the input device 38 and the display device 40 can be separately mounted from the housing of the control device 14, or they can be integrally assembled into the housing of the control device 14.
[0039] like Figure 1 As shown, a robot coordinate system C1 and a tool coordinate system C2 are established for the robot 12. The robot coordinate system C1 is the coordinate system used for automatically controlling the various movable elements of the robot 12. In this embodiment, the robot coordinate system C1 is established such that its origin is located at the center of the robot base 16 and its z-axis coincides with the rotation axis of the rotary body 18. Furthermore, in the following description, for convenience, the positive x-axis direction of the robot coordinate system C1 is referred to as the right, the positive y-axis direction as the front, and the positive z-axis direction as the top.
[0040] The tool coordinate system C2 is a coordinate system that defines the position of tool 26 within the robot coordinate system C1, and is used to set up tool 26. Furthermore, in this specification, "position" sometimes refers to both location and orientation. In this embodiment, the tool coordinate system C2 is set up such that its origin (so-called TCP) is located at the working point of tool 26 (e.g., the point where tool 26 melts the welding wire) and its z-axis direction is aligned with the working direction of tool 26 (e.g., the direction of the central axis of the welding torch tip or the emission direction of the laser beam).
[0041] When the tool 26 is moved, the processor 30 sets a tool coordinate system C2 in the robot coordinate system C1 and sends commands to each servo motor 28 of the robot 12 to move each movable element of the robot 12 so as to position the tool 26 at the position represented by the set tool coordinate system C2. In this way, the processor 30 can position the tool 26 at any position in the robot coordinate system C1 through the movement of the robot 12.
[0042] Next, refer to Figure 3 To illustrate the oscillating motion performed by the processor 30 on the robot 12 during welding operations on workpiece W. The oscillating motion is performed to widen the weld bead formed on workpiece W during welding. Specifically, during the oscillating motion, the processor 30 moves the tool 26 along a predetermined work path WP via the robot 12, and oscillates the tool 26 in a direction intersecting the work path WP.
[0043] exist Figure 3In the example shown, the work path WP is set on the workpiece W in a straight line extending in the x-axis direction of the robot coordinate system C1. In this case, during the oscillating motion, the processor 30 moves the tool 26 to the right along the work path WP via the robot 12 and oscillates the tool 26 in the back-and-forth direction. As a result, the tool 26 moves relative to the workpiece W along a wavy track TR while welding the workpiece W.
[0044] Next, the method for generating the signal for the swinging motion will be described. First, as a preparatory process, the operator operates the input device 38 to input the parameter PR of the swing signal WS used to swing the tool 26 during the swinging motion. The parameter PR includes the amplitude value A of the swing signal WS and the frequency f0 of the fundamental frequency FM of the swing signal WS, etc. The processor 30 receives the input of the parameter PR through the input device 38. Thus, in this embodiment, the processor 30 serves as the first input receiving unit 44 for receiving the input of the fundamental frequency f0 of the FM. Figure 2 To fulfill its function.
[0045] Processor 30 generates a swing signal WS according to parameter PR. Figure 4 The diagram shows a functional block diagram illustrating the generation of the swing signal WS in the control device 14. The processor 30 functions as the original signal generation unit 46, generating the swing signal WS1 according to the received parameter PR.
[0046] Figure 5 This represents an example of the swing signal WS1. Figure 5 The vertical axis represents the amplitude A of the movement of tool 26 in the back-and-forth direction (in other words, the distance A from the work path WP), and the horizontal axis represents time t. Figure 5 In the example shown, the oscillating signal WS1 is a triangular wave with an amplitude value A received from the operator and a frequency f0 (i.e., a period T0 = 1 / f0).
[0047] Next, the processor 30 functions as a filter unit 48, performing a filtering process FR1 on the oscillating signal WS1 generated by the original signal generation unit 46 to remove high-frequency components. In this embodiment, the filter unit 48 is composed of a digital filter (FIR filter or IIR filter). For example, the filter unit 48 performs a moving average process on the oscillating signal WS1, which is a digital signal, at filtering times τ, thereby performing the filtering process FR1 as a low-pass filter.
[0048] Alternatively, the filter unit 48 may be configured to perform the filtering process FR1 as a bandpass filter or a notch filter. The filter unit 48 generates the oscillating signal WS2 by performing the filtering process FR1 on the oscillating signal WS1.
[0049] Figure 6This represents an example of the oscillating signal WS2. Furthermore, in Figure 6 In the image, for comparison, the dashed line represents the oscillation signal WS1. For example... Figure 6 As shown, the result of filtering FR1 is that the triangular wave oscillation signal WS1 is transformed into an oscillation signal WS2 that is similar to the waveform of the trigonometric function (i.e., the frequency characteristic FC is changed by removing high-frequency components).
[0050] Thus, in this embodiment, the processor 30 functions as both the original signal generation unit 46 and the filter unit 48, generating swing signals WS1 and WS2. Therefore, the original signal generation unit 46 and the filter unit 48 constitute the swing signal generation unit 56 that generates the swing signals WS1 and WS2. Furthermore, in Figure 6 In the previous embodiment, the swing signals WS1 and WS2 were represented as analog signals, but in this embodiment, the swing signals WS1 and WS2 generated by the swing signal generation unit 56 are digital signals.
[0051] Figure 7 The frequency characteristics FC of the swing signal WS2 generated by the swing signal generation unit 56 are schematically shown. WS (Spectrum). For example... Figure 7 As shown, the oscillating signal WS2 has a fundamental frequency FM at frequency f0, and harmonics HM1 at frequency f1, HM2 at frequency f2, ... at frequency f n Harmonics HM n The frequency components.
[0052] Harmonic HM n frequency f n For example, it can be an integer multiple (specifically, an odd multiple) of the fundamental FM frequency f0. Figure 7 In the example shown, the fundamental frequency FM has an amplitude A0, the harmonic HM1 has an amplitude A1, and the harmonic HM2 has an amplitude A2. Thus, the oscillating signal WS2 has a frequency f. n The frequency components (n = 0, 1, 2, 3...) (i.e., fundamental FM and harmonic HM) n ).
[0053] Refer again Figure 2 as well as Figure 4 The processor 30 functions as the main motion command generation unit 50, generating a main motion command CM1 for moving the robot 12 toward the work path WP during the aforementioned swinging motion. Furthermore, the processor 30 functions as a filter unit 52, filtering the main motion command CM1 generated by the main motion command generation unit 50 into a filter FR2.
[0054] The filter unit 52 is composed of the same digital filter as the filter unit 48 described above, and performs a filtering process FR2 to remove high-frequency components on the main action command CM1. The filtering process FR2 may be the same as or different from the filtering process FR1 described above. The filter unit 52 generates the main action command CM2 by performing the filtering process FR2 on the main action command CM1.
[0055] Next, the processor 30 functions as a swing motion command generation unit 54, applying the swing signal WS2 to the main motion command CM2, thereby generating a swing motion command CM3 for the robot 12 to perform a swing motion. Specifically, the swing motion command generation unit 54 is an adder that generates the swing motion command CM3 (=CM2+WS2) by adding the swing signal WS2 to the main motion command CM2.
[0056] Through I / O interface 34 and servo amplifier (not shown), a swing motion command CM3 generated by swing motion command generation unit 54 is output to servo motor 28 of robot 12. According to this swing motion command CM3, robot 12 performs a swing motion, causing tool 26 to move along... Figure 3 The track TR shown is moving.
[0057] The original signal generation unit 46, the main action command generation unit 50, the filter units 48 and 52, and the swing motion command generation unit 54 can be functional modules implemented by the operating program PG executed by the processor 30. In addition, at least one of the main action command generation unit 50, the filter units 48 and 52, and the swing motion command generation unit 54 (e.g., filter units 48 and 50) can also be installed as analog circuits in the control device 14.
[0058] When robot 12 performs a swinging motion according to the swinging motion command CM3 generated as described above, the inherent frequency of robot 12, which causes tool 26 to swing in the back-and-forth direction, is related to the frequency of the swinging motion. Figure 7 The fundamental frequency f0 or harmonic HM of the swing signal WS2 described in the text is the fundamental frequency FM. n frequency f n If they are consistent, then robot 12 may resonate.
[0059] Figure 8 This schematically illustrates the time-varying characteristic of the amplitude value A of tool 26 in the forward-backward direction (i.e., the y-axis direction of robot coordinate system C1) at the resonance of robot 12 at the fundamental frequency f0 of FM. R1 Furthermore, in Figure 8 In the diagram, for comparison purposes, the dashed line represents the time variation characteristics of the swing signal WS2 generated by the swing signal generation unit 56.
[0060] in addition, Figure 9 schematic representation of time-varying characteristics AR1 Frequency characteristics FC R1 .like Figure 9 As shown, the frequency response FC R1 It includes the fundamental frequency FM and harmonic frequency HM contained in the original oscillating signal WS2. n The frequency components, but when robot 12 resonates at frequency f0, the amplitude value A0' of the fundamental wave FM is greater than the amplitude value A0 of the original oscillating signal WS2.
[0061] on the other hand, Figure 10 This schematically illustrates the time-varying characteristic of the amplitude A of tool 26 in the forward and backward direction when robot 12 resonates at the frequency f2 of harmonic HM2. R2 .in addition, Figure 11 schematic representation of time-varying characteristics A R2 Frequency characteristics FC R2 .like Figure 11 As shown, when robot 12 resonates at frequency f2, the amplitude value A2' of harmonic HM2 is greater than the amplitude value A2 of the original oscillation signal WS2.
[0062] produce Figures 8-11 When resonance occurs as shown, the trajectory TR of tool 26 changes from... Figure 3 As shown, the trajectory TR corresponding to the original oscillation signal WS2 deviates, resulting in reduced accuracy of the welding operation. Therefore, in this embodiment, when the processor 30 detects such resonance, it corrects the oscillation signal WS to suppress the resonance.
[0063] The following describes the method for correcting the oscillation signal WS. Figure 4 As shown, in this embodiment, a rotation detector 58 (encoder or Hall element, etc.) for detecting the rotation (rotation angle or rotation position) of the servo motor 28 is provided on each servo motor 28.
[0064] During the period when robot 12 performs a swinging motion according to swinging motion command CM3, each rotation detector 58 continuously (e.g., periodically) detects the rotation of servo motor 28 and supplies it sequentially to control device 14 as position feedback FB. As an example, the rotation detector 58 operates at a control cycle T. c (For example, 100 [msec]) The rotation of the servo motor 28 is periodically detected and supplied to the control device 14 as position feedback FB.
[0065] The processor 30 continuously acquires position feedback FB from the rotation detector 58 via the I / O interface 34. Furthermore, the processor 30 functions as a time-series data acquisition unit 60, acquiring time-series data TD of the amplitude value A of the tool 26 in the forward and backward directions based on the acquired position feedback FB.
[0066] Specifically, whenever the processor 30 obtains position feedback FB from the rotation detector 58, it uses the position feedback FB to calculate the coordinates of the tool 26 (specifically, the origin of the tool coordinate system C2: TCP) in the robot coordinate system C1, and calculates the amplitude value A based on the coordinates.
[0067] Whenever the processor 30 obtains position feedback FB from the rotation detector 58 (i.e., in control period T), c The amplitude value A is obtained and stored in memory 32 as time series data TD. The time series data TD obtained in this way is, for example, compared with... Figure 8 Time-varying characteristics A R1 or Figure 10 Time-varying characteristics A R2 The corresponding digital signal.
[0068] Next, the processor 30 functions as the frequency characteristic acquisition unit 62, acquiring the frequency characteristic FC of the time series data TD acquired by the time series data acquisition unit 60. TD (First frequency characteristic). Specifically, processor 30 uses a predetermined period T... f The acquired time series data TD is transformed into frequency domain data by performing a Fourier transform (e.g., FFT), thereby obtaining the frequency response FC. TD .
[0069] This is how the frequency response FC is obtained. TD For example with Figure 9 The frequency response FC shown R1 or Figure 11 The frequency response FC shown R2 Correspondingly. Furthermore, the period T of the Fourier transform... f For example, the control cycle T can be arbitrarily set by the operator. c The period is an integer multiple of the specified period. The operator can also specify the period T. f The input is the parameter PR mentioned above.
[0070] Next, the processor 30 functions as the resonance determination unit 64, and obtains the frequency characteristic FC from the frequency characteristic acquisition unit 62. TD The frequency f of the swing signal WS2 generated in the swing signal generation unit 56 is determined. n Does robot 12 resonate? The following is a specific example illustrating the method for determining resonance.
[0071] As a specific example of resonance determination, the resonance determination unit 64 obtains the frequency characteristic FC of the time series data TD acquired by the time series data acquisition unit 60. TD The frequency characteristic FC of the swing signal WS2 generated by the swing signal generation unit 56 WSBy comparing the (second frequency characteristics), it can be determined whether robot 12 resonates.
[0072] Specifically, the processor 30 functions as the frequency characteristic acquisition unit 62, and is related to the aforementioned frequency characteristic FC. TD Together, obtain the frequency characteristic FC of the swing signal WS2. WS For example, the frequency characteristic acquisition unit 62 acquires the oscillating signal WS2 generated by the filter unit 48, and then processes the oscillating signal WS2 with a predetermined period T. f Perform a Fourier transform (e.g., FFT) to transform the data into frequency domain data, thereby obtaining the frequency response (FC). WS Thus, the frequency response acquisition unit 62 acquires... Figure 7 The frequency response FC shown WS .
[0073] As an example, the resonance determination unit 64 determines the frequency characteristics FC of the acquired oscillation signal WS2 based on... WS , with this frequency characteristic FC WS The included frequency f n The amplitude value A below n (The second amplitude value) correspondingly sets the threshold α n Specifically, the resonance determination unit 64 determines the resonance based on the obtained frequency characteristics FC. WS The amplitude value A0 at the frequency f0 of the fundamental FM included. Figure 7 The threshold α0 is set as α0 = β × A0 (β is a coefficient greater than or equal to 1).
[0074] On the other hand, the resonance determination unit 64 determines the frequency characteristics FC of the acquired time series data TD. TD To obtain the frequency characteristic FC TD The amplitude value A0' (first amplitude value) at the frequency f0 of the fundamental wave FM is included. Then, the resonance determination unit 64 compares the amplitude value A0' with the threshold α0 and determines whether the amplitude value A0' exceeds the threshold α0 (i.e., A0' > α0). When A0' > α0, it is determined that the robot 12 resonates at the frequency f0 of the fundamental wave FM of the swing signal WS2.
[0075] Alternatively, the resonance determination unit 64 can also determine the resonance based on the frequency characteristic FC. WS The included harmonics HM n frequency f n The amplitude value A below n (For example, Figure 7 The amplitude values A1, A2… shown are used to set the threshold α. n Determined as α n =β×A n Furthermore, the resonance determination unit 64 determines the frequency characteristics FC of the acquired time series data TD.TD The included harmonics HM n frequency f n The amplitude value A below n '(First amplitude value. For example, Figure 11 Does the amplitude value A2' shown exceed the threshold α? n (A n '>α n ), in A n '>α n At that time, it was determined that robot 12 was in the harmonic HM of the swing signal WS2. n frequency f n Resonance.
[0076] Furthermore, the resonance determination unit 64 can also determine the frequency response FC. WS Includes fundamental frequency (FM) and harmonic frequencies (HM) n frequency f n Their respective amplitude values A n Set threshold α n , and frequency response FC TD Includes fundamental frequency (FM) and harmonic frequencies (HM) n frequency f n Their respective amplitude values A n 'Compare. For which frequency f?' n Amplitude value A n Set threshold α n This can be predetermined by the operator.
[0077] As another example, the resonance determination unit 64 calculates the frequency response FC. WS The specified frequency bands included [f i f j (For example, the frequency band [f0, f2] = f0 ≤ f ≤ f2) where the amplitude value A n The integral value INT(=∫A) n For the calculated integral value INT, the threshold γ is set to γ = β × INT.
[0078] On the other hand, the resonance determination unit 64 calculates the frequency response FC. TD The included frequency band [f i f j Amplitude value A n The integral value of 'INT' (=∫A) n Furthermore, the resonance determination unit 64 determines whether the obtained integral value INT' exceeds the threshold γ (INT'>γ). If INT'>γ, it determines that the robot 12 resonates at a certain frequency component of the swing signal WS2.
[0079] As another example, the resonance determination unit 64 calculates the frequency response FC.WS Amplitude value A n The spectral density D (power spectral density, energy spectral density, etc.) is used to determine the threshold δ, which is set to δ = β × D. Meanwhile, the resonance determination unit 64 calculates the obtained frequency response FC. TD Amplitude value A n The spectral density D' is then determined. Furthermore, the resonance determination unit 64 determines whether the calculated spectral density D' exceeds the threshold δ (D' > δ). If D' > δ, the robot 12 is determined to resonate.
[0080] Furthermore, the resonance determination unit 64 can also determine the frequency response FC. WS The obtained calculated value (e.g., amplitude value A) n The integral value INT or spectral density D) and the frequency response FC TD The obtained calculated value (e.g., amplitude value A) n The difference Δ between the integral value INT' or the spectral density D'.
[0081] Furthermore, the resonance determination unit 64 can determine whether the difference Δ exceeds a predetermined threshold Δ. th (Δ>Δ th ), in Δ>Δ th At that time, it is determined that robot 12 is in resonance. As described above, the resonance determination unit 64 compares the frequency characteristics FC with each other. TD and FC WS Determine whether robot 12 resonates.
[0082] Furthermore, the resonance determination unit 64 can also handle the setting of the aforementioned threshold α. n , γ, δ or Δ th The threshold setting data THD is input. For example, the operator operates the input device 38 to pre-input the aforementioned coefficient β or threshold Δ. th The threshold setting data THD is received by the processor 30 and functions as the resonance determination unit 64, setting the threshold α according to the threshold setting data THD. n , γ, δ or Δ th That is, in this case, the processor 30 serves as the second input receiving unit 66, which is the input to the acceptance threshold setting data THD. Figure 2 To fulfill its function.
[0083] As another specific example of resonance determination, the resonance determination unit 64 can also determine the frequency characteristics FC of the oscillation signal WS2 without obtaining them. WS In this case, it determines whether robot 12 is in resonance. Specifically, processor 30 functions as resonance determination unit 64, determining the frequency characteristics FC of the time series data TD acquired by frequency characteristic acquisition unit 62. TD The included fundamental frequency (FM) or harmonic frequency (HM)n frequency f n The amplitude value A below n 'Whether it exceeds a predetermined threshold α' n '.
[0084] Furthermore, the resonance determination unit 64 is in A n '>α n At that time, it was determined that robot 12 was in resonance. This threshold α n According to the frequency f of the oscillating signal WS2 n The frequency characteristics FC of the oscillation signal WS2 are predetermined by the operator and stored in memory 32. For example, the operator verifies the frequency characteristics FC of the oscillation signal WS2 in advance using experimental methods. WS A threshold α can be set. n In this case, the processor 30 can also function as a second input receiving unit 66, pre-accepting the threshold α via the input device 38. n ' is the input.
[0085] Using the above method, the resonance determination unit 64 determines whether the robot 12 is in resonance. When the resonance determination unit 64 determines that the robot 12 is in resonance, the processor 30 functions as a correction unit 68, correcting the oscillation signal WS to change the frequency f of the oscillation signal WS. n .
[0086] As an example, the correction unit 68 changes the frequency f0 of the fundamental frequency FM, which is input as parameter PR. Specifically, the correction unit 68 increases or decreases the frequency f0 set in parameter PR by a predetermined amount. And change to frequency f0'( or After the frequency f0' is changed, the original signal generation unit 46 generates an oscillating signal WS1 with the changed frequency f0'.
[0087] As a result, the frequency f0 of the fundamental frequency FM of the swing signal WS2 generated by the filter unit 48 also changes to the frequency f0'. Thus, the correction unit 68 corrects the swing signals WS1 and WS2 generated by the swing signal generation unit 56 by changing the frequency f0 of the fundamental frequency FM. In this case, not only the frequency f0 of the fundamental frequency FM of the swing signal WS2 generated by the swing signal generation unit 56 can be changed, but the harmonic frequency HM can also be changed. n frequency f n .
[0088] As another example, the resonance determination unit 64 determines that the robot 12 is in the harmonic HM of the swing signal WS2. n frequency f n During resonance, the correction unit 68 can also change the harmonic HM n frequency f nTo correct the oscillation signal WS2. For example, the frequency characteristic acquisition unit 62 acquires the frequency characteristic FC. WS and FC TD The resonance determination unit 64 pairs frequency characteristics FC WS and FC TD The result of the comparison is as follows: Figure 11 As shown, the amplitude value A2' at the frequency f2 of the harmonic HM2 exceeds the threshold α2.
[0089] In this case, the correction unit 68 uses digital signal processing to obtain the frequency characteristic FC of the oscillation signal WS2 acquired by the frequency characteristic acquisition unit 62. WS The frequency f2 of the included harmonic HM2 increases or decreases by a specified amount. The frequency is changed to f2'. Furthermore, the correction unit 68 calculates the frequency characteristics FC of the harmonic HM2 with the changed frequency f2', the fundamental frequency FM of the original oscillating signal WS2, and the harmonics HM1, HM3, HM4… WS '.
[0090] The swing signal generation unit 56 obtains the frequency characteristic FC from the correction unit 68. WS The inverse Fourier transform (e.g., IFFT) is performed to generate a corrected swing signal WS2, which is then output to the swing motion command generation unit 54. In this way, the correction unit 68 can change the harmonic HM... n frequency f n To correct the oscillation signal WS2.
[0091] Furthermore, even when the resonance determination unit 64 determines the harmonic HM n frequency f n Amplitude value A n 'Whether it exceeds a predetermined threshold α' n When determining the resonance of robot 12, the correction unit 68 can also change the harmonic HM. n frequency f n To correct the oscillation signal WS2.
[0092] Specifically, for example Figure 11 As shown, the resonance determination unit 64 determines that the amplitude value A2' at the frequency f2 of the harmonic HM2 exceeds the predetermined threshold α2'. At this time, the frequency characteristic acquisition unit 62 acquires the frequency characteristic FC of the oscillation signal WS2. WS The correction unit 68 corrects the obtained frequency characteristic FC WS The change in frequency f2 of the included harmonic HM2 by increasing or decreasing Instead, it is changed to frequency f2'.
[0093] Furthermore, as described above, the correction unit 68 calculates the frequency characteristics FC of the harmonic HM2 with the changed frequency f2', the fundamental frequency FM of the original oscillating signal WS2, and the harmonics HM1, HM3, HM4... WS The corrected oscillation signal WS2 is generated by performing an inverse Fourier transform (e.g., IFFT). Thus, the correction unit 68 can change the harmonic HM... n frequency f n To correct the oscillation signal WS2.
[0094] In addition, the processor 30 can also function as a first input receiving unit 44, receiving the aforementioned changes together with the fundamental FM frequency f0. The input. For example, the operator operates the input device 38 to pre-input the change amount. The swing signal generation unit 56 generates a swing signal WS2 according to the received amplitude value A and frequency f0. When the resonance determination unit 64 determines that the robot 12 is in resonance, the correction unit 68 adjusts the signal according to the received change amount. To change the frequency f of the oscillating signal WS n As described above, the correction unit 68 corrects the oscillation signal WS to change the frequency f. n .
[0095] Next, refer to Figure 12 The control flow for the welding operation executed by the processor 30 is described. When the processor 30 receives a start command from the operator, the host controller, or the job program PG, it begins... Figure 12 The process is shown below. In step S1, the processor 30 begins its swinging motion.
[0096] Specifically, as described above, the processor 30 functions as a swing signal generation unit 56 (original signal generation unit 46, filter unit 48), a main motion command generation unit 50, a filter unit 52, and a swing motion command generation unit 54, generating a swing motion command CM3, and causing the robot 12 to move according to the swing motion command CM3. As a result, the robot 12 begins to swing.
[0097] In step S2, the processor 30 activates the tool 26, causing it to perform welding operations. Thus, the processor 30 performs the oscillating motion initiated in step S1 while simultaneously welding the workpiece W using the tool 26. In this way, the processor 30 acts as a tool control unit 70 that activates the tool 26 to perform welding operations. Figure 2 In step S3, the processor 30 functions as a time series data acquisition unit 60, and as described above, begins the operation of acquiring time series data TD.
[0098] In step S4, the processor 30 functions as the frequency characteristic acquisition unit 62, and as described above, begins to acquire the frequency characteristic FC of the time series data TD. TD The operation. For example, the frequency characteristic acquisition unit 62 continuously (e.g., to control the period T) c (The frequency characteristic FC of the swing signal WS2 generated by the swing signal generation unit 56 is obtained.) WS The frequency characteristic FC of the time series data TD acquired by the time series data acquisition unit 60 when the robot 12 moves according to the swing signal WS2. TD .
[0099] In step S5, the processor 30 functions as the resonance determination unit 64, as described above, based on the frequency characteristic FC obtained in step S4. TD The processor 30 determines whether robot 12 is resonating. For example, it compares the frequency characteristics FC obtained in the most recent step S4. WS and FC TD The processor 30 determines whether robot 12 resonates. If the processor determines that robot 12 resonates (i.e., yes), it proceeds to step S6; otherwise, it proceeds to step S7.
[0100] In step S6, the processor 30 functions as a correction unit 68, correcting the oscillation signal WS as described above to change the frequency f of the oscillation signal WS. n For example, processor 30 controls the frequency f0 of the fundamental frequency FM of the oscillating signal WS1 (or the harmonic HM of the oscillating signal WS2) to... n frequency f n Increase or decrease the amount of change The frequency is changed to f0'. Then, the processor 30 functions as the swing signal generation unit 56, generating swing signals WS1 and WS2 according to the changed frequency f0'.
[0101] After step S6, the processor 30 returns to step S5, repeatedly executing the loop of steps S5 and S6 until the determination in step S5 is negative. Here, the processor 30 may also adjust the frequency f of the oscillation signal WS each time step S6 is executed. n Within a predetermined permissible range [f] th1 f th2 The amount of change each time within ]
[0102] For example, when the fundamental FM frequency f0 is f0 = 4 [Hz], the allowable range [f th1 f th2 ](=f th1 ≤f n '≤f th2The range [3.5, 4.5] (i.e., 4 [Hz] ± 0.5 [Hz]) can be arbitrarily determined by the operator. In this case, the processor 30 can function as a first input receiving unit 44, in conjunction with the change in quantity. Together, we will define the permitted scope [f] th1 f th2 The threshold f th1 and f th2 Input.
[0103] Alternatively, step S6 can be performed to adjust the frequency f after the change. n 'For the permissible range [f] th1 f th2 [Outer time (i.e., f)] n '<f th1 Or f th2 <f n The processor 30 generates a warning signal representing this meaning as image data (or sound data) and displays it on the display device 40 (or outputs it through a speaker). Additionally, the processor 30 adjusts the frequency f after the change. n 'For the permissible range [f] th1 f th2 When the warning signal is issued, the welding operation can continue while the warning signal is being issued, or the welding operation can be stopped while the warning signal is being issued.
[0104] In step S7, the processor 30 determines whether the welding operation has ended based on the work program PG and the feedback FB from the rotary detector 58. When the processor 30 determines that the welding operation has ended (i.e., yes), it functions as the tool control unit 70 to stop the movement of the tool 26, thus ending the operation. Figure 12 The process is shown. On the other hand, if the processor 30 determines that the result is negative, it returns to step S5.
[0105] In addition, Figure 12 In the illustrated process, processor 30 can also begin step S1 after starting step S2. Alternatively, the operator can choose not to pre-input the change amount. Instead, processor 30 randomly determines to change the frequency f each time step S6 is executed. n Change
[0106] As described above, in this embodiment, the processor 30 functions as a first input receiving unit 44, a swing signal generating unit 56, a time series data acquiring unit 60, a frequency characteristic acquiring unit 62, a resonance determination unit 64, a second input receiving unit 66, a correction unit 68, and a tool control unit 70, generating a signal for swinging motion.
[0107] Therefore, the first input receiving unit 44, the oscillation signal generation unit 56, the time series data acquisition unit 60, the frequency characteristic acquisition unit 62, the resonance determination unit 64, the second input receiving unit 66, the correction unit 68, and the tool control unit 70 constitute a device 80 for generating a signal for oscillation motion. Figure 2 That is, in this embodiment, the device 80 is installed in the control device 14 as a functional module implemented by the processor 30 executing the work program PG.
[0108] As described above, the device 80 includes: a swing signal generation unit 56 that generates swing signals WS1 and WS2; a time series data acquisition unit 60 that acquires time series data TD when the robot 12 performs a swinging action according to the swing signal WS2; and a frequency characteristic acquisition unit 62 that acquires the frequency characteristic FC of the time series data TD. TD (First frequency characteristic).
[0109] Additionally, the device 80 includes a resonance determination unit 64, which determines the resonance based on the frequency characteristics FC. TD The correction unit 68 determines whether robot 12 is resonating; when robot 12 is determined to be resonating, it corrects the swing signal WS1 or WS2 to change the frequency f of the swing signal WS1 or WS2. n .
[0110] This structure can suppress resonance generated when the tool 26 swings back and forth during the oscillating motion, thus enabling more stable oscillating motion. As a result, the precision of the welding operation can be improved, thereby enhancing the welding quality.
[0111] Furthermore, in device 80, as an example, the correction unit 68 corrects the oscillation signals WS1 and WS2 by changing the frequency f0 of the fundamental frequency FM of the oscillation signals WS1 and WS2. According to this configuration, as described above, not only the frequency f0 of the fundamental frequency FM of the oscillation signal WS2 can be changed, but also the harmonic frequency HM can be altered. n frequency f n Therefore, even if robot 12 is in the fundamental frequency FM or harmonic frequency HM of the swing signal WS2. n a certain frequency f n Resonance can also be easily and reliably suppressed.
[0112] In addition, in the device 80, the first input receiving unit 44 receives the input of the fundamental frequency f0 of the FM wave, the swing signal generating unit 56 generates swing signals WS1 and WS2 with the received frequency f0, and the correction unit 68 corrects the swing signals WS1 and WS2 generated by the swing signal generating unit 56 by changing the received frequency f0.
[0113] According to this structure, the operator can arbitrarily set the frequency f0, thus enabling the design of more diverse swinging movements. Furthermore, by changing the operator-set frequency f0, the resonance of the robot 12 caused by that frequency f0 can be reliably suppressed.
[0114] In addition, in device 80, the first input receiving unit 44 also receives inputs for fundamental frequency (FM) or harmonic frequency (HM). n frequency f n The amount of change to be made The correction unit 68 processes the input according to the amount of change received. To change the frequency f n Based on this structure, the operator can arbitrarily determine the amount of change. In order to enable frequency f n The changes minimize the impact on welding quality and reliably suppress resonance.
[0115] Furthermore, in device 80, as an example, the frequency characteristic acquisition unit 62 also acquires the frequency characteristic FC of the swing signal WS2 generated by the swing signal generation unit 56. WS (Second frequency characteristic), the resonance determination unit 64 obtains the frequency characteristic FC from the frequency characteristic acquisition unit 62. TD and FC WS A comparison is made to determine whether robot 12 resonates. Based on this structure, it is possible to detect whether robot 12 resonates with higher precision.
[0116] In addition, regarding the frequency response FC TD and FC WS During the comparison, the resonance determination unit 64 determines the frequency response FC. TD The specified frequency f included n Amplitude value A n '(First amplitude value) exceeds the frequency characteristic FC' WS The specified frequency f included n Amplitude value A n The threshold α is determined by (the second amplitude value). n When this occurs, it is determined that robot 12 is resonating. Based on this structure, a relatively simple algorithm can be used to detect whether robot 12 is resonating with high precision.
[0117] In addition, the second input receiving unit 66 receives inputs used to set the threshold α. n The threshold setting data THD (coefficient β) is input, and the resonance determination unit 64 determines the amplitude value A according to the threshold setting data THD. n Set threshold α n Based on this structure, the operator can arbitrarily set the threshold α used for resonance determination. n .
[0118] On the other hand, as another example, the resonance determination unit 64 obtains the frequency characteristic FC of the time series data TD acquired by the frequency characteristic acquisition unit 62. TD The specified frequency f included n Amplitude value A n 'Exceeding the frequency f according to the swing signal WS2' n Predetermined threshold α n At that time, it was determined that the robot 12 was in resonance.
[0119] Based on this structure, it is possible to detect whether robot 12 resonates using a simpler algorithm. In this case, the second input receiving unit 66 receives the threshold α. n The input is '. Based on this structure, the operator can arbitrarily set the threshold α used for resonance determination. n '.
[0120] Additionally, according to device 80, in Figure 12 In the process shown, when the tool control unit 70 performs welding operations (step S2), the oscillation signal generation unit 56 generates oscillation signals WS1 and WS2, and the time series data acquisition unit 60 acquires the time series data TD when the oscillation action is performed according to the oscillation signals WS1 and WS2 generated during the welding operation (step S3).
[0121] Furthermore, the resonance determination unit 64 determines the frequency characteristic FC obtained by the frequency characteristic acquisition unit 62 during the welding operation. TD (Step S4) Determine whether the robot 12 resonates (Step S5). When the correction unit 68 determines that the robot 12 resonates during the welding operation, it corrects the oscillation signals WS1 and WS2 (Step S6). According to this configuration, during the actual welding operation, it is possible to monitor whether the robot 12 resonates in real time, and when the resonance occurs, it is possible to correct the oscillation signal WS in real time.
[0122] Furthermore, before actually performing welding operations (e.g., when teaching robot 12 to swing motion), the resonance generation and correction of the swing signal WS by robot 12 can also be verified. See below for reference. Figure 13 as well as Figure 14 The robot system 100 that performs such functions will be described.
[0123] The robot system 100 differs from the robot system 10 described above in that it also includes a teaching pendant 102. The teaching pendant 102 teaches the robot 12 oscillating movements. Specifically, the teaching pendant 102 is, for example, a portable computer such as a teach pendant or a tablet terminal, and includes a processor 104, a memory 106, and an I / O interface 108. Furthermore, the teaching pendant 102 is equipped with an input device 110 and a display device 112.
[0124] Furthermore, the structure and function of the processor 104, memory 106, I / O interface 108, input device 110, and display device 112 are the same as those of the processor 30, memory 32, I / O interface 34, input device 38, and display device 40 described above; therefore, repeated descriptions are omitted. The processor 104 is communicatively connected to the memory 106 and I / O interface 108 via bus 114, and performs computational processing for executing the teaching functions described later while communicating with these components.
[0125] In this embodiment, the functions of the device 80 (first input receiving unit 44, swing signal generating unit 56, time series data acquisition unit 60, frequency characteristic acquisition unit 62, resonance determination unit 64, second input receiving unit 66, correction unit 68, and tool control unit 70) are installed in the teaching pendant 102, and the processor 104 of the teaching pendant 102 functions as the device 80.
[0126] The processor 104 is configured to send instructions to each servo motor 28 of the robot 12 via the control device 14 based on input data to the input device 110, causing the robot 12 to perform jog movements according to the instructions. The operator teaches the robot 12 to jog movements by operating the input device 110.
[0127] Specifically, the operator operates the input device 110 to teach the robot 12 multiple teaching points TP for moving the tool 26 (TCP) in the direction of the work path WP. On the other hand, the operator operates the input device 110 to input parameters PR (amplitude value A, frequency f0, etc.) of the oscillation signal WS.
[0128] The processor 104 acquires the coordinates of the teaching point TP in the robot coordinate system C1 and functions as the first input receiving unit 44, accepting the input of parameter PR. Furthermore, the processor 104 generates a work program PG1 based on the acquired teaching point TP and parameter PR. In this work program PG1, the coordinates of the teaching point TP and parameter PR are defined as command codes. Thus, the teaching pendant 102 teaches the robot 12 oscillating motions, generating the work program PG1 for welding operations.
[0129] The operator followed the established work procedure PG1 to test the swinging motion of robot 12 and verify whether robot 12 resonated. Figure 15 A block diagram is shown illustrating the function of generating the swing signal WS in the teaching pendant 102. The operator operates the input device 110 to give the processor 104 a work start command.
[0130] According to the operation start instruction, the processor 104 functions as the swing signal generation unit 56, as in the above embodiment, to generate the swing signal WS. Specifically, the processor 104 functions as the original signal generation unit 46, generating the swing signal WS1 according to the parameters PR specified in the operation program PG1, and functions as the filter unit 48, filtering the swing signal WS1 generated by the original signal generation unit 46 by FR1, thereby generating the swing signal WS2.
[0131] In addition, as in the above embodiment, the processor 104 functions as the main action instruction generation unit 50, generating the main action instruction CM1 according to the teaching point TP specified in the job program PG1, and functions as the filter unit 52, filtering the main action instruction CM1 generated by the main action instruction generation unit 50 for FR2, thereby generating the main action instruction CM2.
[0132] Furthermore, the processor 104 functions as a swing motion command generation unit 54, generating a swing motion command CM3 by applying a swing signal WS2 to the main motion command CM2, and sending it to the servo motor 28 of the robot 12 via the I / O interface 108 and the control device 14. In this way, the processor 104 controls the robot 12 to perform swing motions according to the swing motion command CM3 via the control device 14.
[0133] In this embodiment, during the period when the robot 12 performs the oscillating motion, the processor 104 functions as the tool control unit 70, stopping the movement of the tool 26. Therefore, while the robot 12 is in a state where the tool 26 is stopped (i.e., no welding operation is performed), it moves the tool 26 along... Figure 3 The track TR moves in a swinging motion as shown.
[0134] During the swinging motion of the robot 12, the rotation detector 58 continuously detects the rotation of the servo motor 28, as in the above embodiment, and supplies it to the teaching device 102 as position feedback FB via the control device 14. Furthermore, the processor 104, as in the above embodiment, functions as a time-series data acquisition unit 60, a frequency characteristic acquisition unit 62, and a resonance determination unit 64, determining whether the robot 12 is resonating.
[0135] In this way, when the operator performs the swinging motion of robot 12 according to the work procedure PG1, they can verify whether robot 12 resonates. Furthermore, when resonance is detected, the operator can determine the resonant frequency f of robot 12. n .
[0136] When resonance is detected in robot 12, the operator operates input device 110 to input the aforementioned change amount. Processor 104 functions as the first input receiving unit 44, receiving changes in quantity. The input, as the correction unit 68, functions according to the change amount. To change the frequency f n (For example, the frequency f0 of the fundamental FM), thereby correcting the oscillation signals WS1 and WS2.
[0137] Furthermore, the oscillation signal generation unit 56 generates a corrected oscillation signal WS2. When the resonance determination unit 64 causes the robot 12 to perform an oscillation action according to the corrected oscillation signal WS2, it again determines whether resonance of the robot 12 has occurred. By repeatedly performing the above trial operation, the operator can obtain the optimal amount of change that can suppress the resonance of the robot 12.
[0138] Then, the processor 104 generates a job program PG2 that specifies command statements based on input data from the operator. These command statements are used to specify the frequency f, which is defined as parameter PR in job program PG1. n Change amount For example, processor 104 generates job program PG2 as follows: it changes the frequency f0 of the fundamental FM specified in job program PG1 by a certain amount. Define the changed frequency f0' as a command statement.
[0139] The processor 104 supplies the generated job program PG2 to the control device 14. The processor 30 of the control device 14, according to the job program PG2, causes the robot 12 to move and perform the actual welding operation on the workpiece W. Here, according to the job program PG2, the frequency f that causes resonance... n Changed to frequency f n Therefore, even if robot 12 performs a swinging motion according to the work procedure PG2, robot 12 will not resonate. Thus, the quality of the work can be improved.
[0140] As described above, in this embodiment, the swing signal generation unit 56 generates swing signals WS1 and WS2 when the tool control unit 70 stops the tool 26, and the time series data acquisition unit 60 acquires time series data TD when the swing action is performed according to the swing signal WS2 generated when the tool 26 stops.
[0141] Furthermore, the resonance determination unit 64 determines the frequency characteristic FC obtained when the tool 26 stops. TD This allows for the determination of whether robot 12 resonates. In this way, the resonance of robot 12 can be verified during the teaching of the swing motion of robot 12 without moving tool 26. As a result, the resonance that occurs during actual welding operations can be reliably suppressed, thereby improving the quality of the work.
[0142] Furthermore, the resonance determination unit 64 can obtain the frequency characteristic FC obtained by the frequency characteristic acquisition unit 62. TD The learning model LM, constructed through machine learning, is applied to determine whether robot 12 resonates. This learning model LM represents the frequency response FC. TD Correlation with the resonance generated in robot 12.
[0143] The learning model LM can be constructed, for example, by taking the oscillation signal WS according to various parameters PR and obtaining the frequency characteristic FC when the robot 12 performs an oscillation motion. TD The learning dataset, representing the decision data for whether or not resonance exists, is repeatedly fed to the machine learning device (e.g., supervised learning). The learning model LM is pre-stored in memory 32 or 106.
[0144] The resonance determination unit 64 will determine the frequency characteristic FC obtained by the frequency characteristic acquisition unit 62 during the oscillation motion. TD The inputs are sequentially fed into the learning model LM. The learning model LM then calculates the frequency response characteristics (FC) of the inputs. TD To determine whether resonance exists. Thus, the resonance determination unit 64 can use the frequency response FC. TD And the learning model LM can accurately determine whether robot 12 resonates.
[0145] Furthermore, the learning model LM can also be used when the frequency response FC is input. TD When resonance is detected, the system determines whether resonance exists and outputs the optimal change amount if resonance is detected. Such a learning model LM represents the frequency response FC TD The resonance and changes generated in robot 12 The correlation can be constructed by combining various frequency characteristics FC. TD This indicates the data used to determine whether resonance exists, and the change in the data related to the data used to determine whether resonance occurs. The learning dataset is repeatedly fed into the machine learning device.
[0146] In this case, the learning model LM obtains the frequency characteristic FC during the oscillating motion from the input of the resonance determination unit 64. TD When resonance is detected, the frequency response FC of the output is compared with that of the input. TD Changes with high correlation Furthermore, the correction unit 68 adjusts the correction according to the change output by the learning model LM. To change the frequency f n This corrects the oscillation signal WS. Based on this configuration, when the robot 12 resonates, it can achieve the optimal change amount obtained through machine learning. To correct the oscillation signal WS.
[0147] Furthermore, the processor 30 or 104 can also, during the oscillating motion, synchronously cause the tool 26 to oscillate up and down in sync with the forward and backward oscillation of the tool 26. (See reference...) Figure 3 as well as Figure 16 This swinging motion will be explained. Figure 16 In the example shown, the processor 30 causes the tool 26 to rock back and forth and to rock up and down in a manner that displaces it upward by a distance δ at the position of the movement path WP.
[0148] Figure 17 This indicates that in order for robot 12 to perform... Figure 16 The swing signal WS1 generated by the swing signal generation unit 56 is a swinging motion in the up and down direction as shown. z and WS2 z .also, Figure 17 The vertical axis represents the amplitude A that causes tool 26 to swing up and down, and the horizontal axis represents time t. Figure 17 The swing signal WS1 shown z It has amplitude A and frequency f 0_z (=1 / T 0_z ) is used as the parameter PR.
[0149] Similar to the embodiment described above, the original signal generation unit 46 generates an oscillation signal WS1. z The filter section 48 processes the swing signal WS1 z Perform filtering FR1 to generate the oscillating signal WS2. z According to the swing signal WS2 z When robot 12 shakes tool 26 in the up-down direction, robot 12 may respond to the swing signal WS2. z frequency f n_z Resonance.
[0150] The processor 30 or 104 functions as a time series data acquisition unit 60, a frequency characteristic acquisition unit 62, and a resonance determination unit 64. Using the same method as in the above embodiment, it determines whether the robot 12 has resonance. When resonance is determined to have occurred, the oscillation signal WS1 can be corrected. z or WS2 z To change the frequency f n_z .
[0151] Furthermore, in the above embodiments, the case where the processor 30 or 104 determines whether the robot 12 resonates and corrects the swing signal WS when the actual robot 12 performs a swinging motion is described (so-called online). However, it is not limited to this; the processor 30 or 104 may also function as a device 80 to simulate the swinging motion of the robot 12 in a virtual space, in which the simulation of whether the robot 12 resonates and the correction of the swing signal WS are performed (so-called offline).
[0152] Furthermore, in the above embodiment, the function of device 80 was described as being implemented in either the control device 14 or the teaching device 102. However, it is not limited to this; the function of device 80 may also be implemented in both the control device 14 and the teaching device 102. That is, in this case, device 80A (first input receiving unit 44, oscillation signal generation unit 56, time series data acquisition unit 60, frequency characteristic acquisition unit 62, resonance determination unit 64, second input receiving unit 66, correction unit 68, and tool control unit 70) is installed in the control device 14, and device 80B (first input receiving unit 44, oscillation signal generation unit 56, time series data acquisition unit 60, frequency characteristic acquisition unit 62, resonance determination unit 64, second input receiving unit 66, correction unit 68, and tool control unit 70) is installed in the teaching device 102.
[0153] Alternatively, a portion of the functions of device 80 (e.g., correction unit 68 and tool control unit 70) may be installed on control device 14, while other portions of the functions of device 80 (e.g., first input receiving unit 44, swing signal generation unit 56, time series data acquisition unit 60, frequency characteristic acquisition unit 62, resonance determination unit 64 and second input receiving unit 66) may be installed on teaching device 102.
[0154] Alternatively, the function of device 80 can also be installed on any other computer (desktop PC, etc.) that can be communicatively connected to control device 14 or teaching device 102. In this case, the processor of the other computer can also function as device 80, controlling robot 12 via control device 14 to perform swinging motions.
[0155] Furthermore, in the above embodiment, the case where the tool 26 is a welding torch and welding operation is performed on the workpiece W has been described. However, it is not limited to this; for example, the tool 26 may also be configured to melt the brazing filler metal fed from the brazing filler metal feed device (not shown) to perform brazing operation on the workpiece W, or it may be configured to perform any operation on the workpiece W.
[0156] Furthermore, robot 12 is not limited to a vertical jointed robot; for example, it can be any type of robot capable of moving tool 26, such as a horizontal jointed robot or a parallel linkage robot. The present disclosure has been described above through embodiments, but the above embodiments do not limit the invention as defined in the claims.
[0157] Symbol Explanation
[0158] 10, 100 robot systems
[0159] 12 robots
[0160] 14 Control device
[0161] 26 tools
[0162] 30, 104 processors
[0163] Input Acceptance Department 44, 66
[0164] 56. Oscillation Signal Generation Unit
[0165] 60 Time Series Data Acquisition Department
[0166] 62 Frequency Response Acquisition Section
[0167] 64 Resonance Determination Unit
[0168] 68 Correction Department
[0169] 70 Tool Control Department
[0170] 80 devices
[0171] 102 Teaching device.
Claims
1. A device that generates a signal for a oscillating motion, the oscillating motion being achieved by a robot moving a tool along a predetermined work path and oscillating the tool in a direction intersecting the work path, characterized in that, The device has: A swing signal generating unit generates a swing signal for causing the robot to swing the tool; The time series data acquisition unit acquires the following time series data: time series data of the amplitude value of the tool in the cross direction when the robot performs the swinging action according to the swinging signal generated by the swinging signal generation unit; The frequency characteristic acquisition unit acquires the first frequency characteristic of the time series data acquired by the time series data acquisition unit; The resonance determination unit determines whether the robot resonates based on the first frequency characteristic obtained by the frequency characteristic acquisition unit. as well as The correction unit corrects the oscillation signal to change the frequency when the resonance determination unit determines that the robot is in resonance.
2. The apparatus according to claim 1, characterized in that, The correction unit corrects the oscillation signal by changing the frequency of the fundamental wave of the oscillation signal.
3. The apparatus according to claim 2, characterized in that, The device further comprises: a first input receiving unit that receives the input of the frequency of the fundamental wave. The swing signal generation unit generates a swing signal having the frequency received by the first input receiving unit. The correction unit corrects the oscillation signal generated by the oscillation signal generation unit by changing the frequency received by the first input receiving unit.
4. The apparatus according to claim 3, characterized in that, The first input receiving unit also accepts inputs that change the amount of the frequency change. The correction unit changes the frequency according to the change amount received by the first input receiving unit.
5. The apparatus according to any one of claims 1 to 4, characterized in that, The frequency characteristic acquisition unit also acquires: a second frequency characteristic of the oscillating signal generated by the oscillating signal generation unit. The resonance determination unit determines whether the robot resonates by comparing the first frequency characteristic and the second frequency characteristic obtained by the frequency characteristic acquisition unit.
6. The apparatus according to claim 5, characterized in that, When the first amplitude value of a predetermined frequency contained in the first frequency characteristic exceeds a threshold determined based on the second amplitude value of the predetermined frequency contained in the second frequency characteristic, the resonance determination unit determines that the robot is resonating.
7. The apparatus according to claim 6, characterized in that, The device further includes a second input receiving unit that accepts input of threshold setting data for setting the threshold. The resonance determination unit sets the threshold for the second amplitude value according to the threshold setting data received by the second input receiving unit.
8. The apparatus according to any one of claims 1 to 4, characterized in that, When the first amplitude value of a predetermined frequency included in the first frequency characteristic obtained by the frequency characteristic acquisition unit exceeds a threshold predetermined based on the frequency of the oscillation signal, the resonance determination unit determines that the robot is resonating.
9. The apparatus according to claim 8, characterized in that, The device further includes a second input receiving unit that receives the input of the threshold.
10. The apparatus according to any one of claims 1 to 4, characterized in that, The device further includes a tool control unit that operates the tool to perform a specified task. When the tool control unit stops the tool, the oscillation signal generation unit generates the oscillation signal. The time series data acquisition unit acquires: the time series data of the time when the oscillation action is performed according to the oscillation signal generated by the oscillation signal generation unit when the tool stops. The resonance determination unit determines whether the robot resonates based on the first frequency characteristic obtained by the frequency characteristic acquisition unit when the tool stops.
11. The apparatus according to any one of claims 1 to 4, characterized in that, The device further includes a tool control unit that operates the tool to perform a specified task. When the tool control unit performs the specified operation, the oscillation signal generation unit generates the oscillation signal. The time series data acquisition unit acquires: the time series data of the swinging action performed according to the swinging signal generated by the swinging signal generation unit during the execution of the specified operation. The resonance determination unit determines whether the robot resonates based on the first frequency characteristic obtained by the frequency characteristic acquisition unit during the execution of the specified operation. When performing the specified task, if the resonance determination unit determines that the robot is in resonance, the correction unit corrects the oscillation signal.
12. A control device, characterized in that, The control device has the device according to any one of claims 1 to 11. The control device controls the robot to perform the swinging motion.
13. A method for generating a signal for a oscillating motion, the oscillating motion being achieved by a robot moving a tool along a predetermined work path and oscillating the tool in a direction intersecting the work path, characterized in that, The processor generates a swing signal to cause the robot to shake the tool. The processor acquires the following time-series data: time-series data of the amplitude value of the tool in the intersection direction when the robot performs the swinging motion according to the generated swing signal. The processor acquires the first frequency characteristic of the acquired time series data. Based on the acquired first frequency characteristic, the processor determines whether the robot resonates at the frequency of the generated oscillation signal. When the processor determines that the robot is resonating, it corrects the oscillation signal to change the frequency.
Citation Information
Patent Citations
Weaving control device for robot
JP1998235582A
Robot control method, robot device, program and record medium
JP2015199149A
