[go: up one dir, main page]

WO2025004213A1 - Robot system, control device therefor, control method, and control program - Google Patents

Robot system, control device therefor, control method, and control program Download PDF

Info

Publication number
WO2025004213A1
WO2025004213A1 PCT/JP2023/023940 JP2023023940W WO2025004213A1 WO 2025004213 A1 WO2025004213 A1 WO 2025004213A1 JP 2023023940 W JP2023023940 W JP 2023023940W WO 2025004213 A1 WO2025004213 A1 WO 2025004213A1
Authority
WO
WIPO (PCT)
Prior art keywords
tool
image
workpiece
robot
processing
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
PCT/JP2023/023940
Other languages
French (fr)
Japanese (ja)
Inventor
幹人 ▲羽▼根
忠則 鈴木
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fanuc Corp
Original Assignee
Fanuc Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fanuc Corp filed Critical Fanuc Corp
Priority to PCT/JP2023/023940 priority Critical patent/WO2025004213A1/en
Priority to TW113120916A priority patent/TW202500337A/en
Publication of WO2025004213A1 publication Critical patent/WO2025004213A1/en
Anticipated expiration legal-status Critical
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B24GRINDING; POLISHING
    • B24BMACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B27/00Other grinding machines or devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B24GRINDING; POLISHING
    • B24BMACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B49/00Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation
    • B24B49/10Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation involving electrical means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B24GRINDING; POLISHING
    • B24BMACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B49/00Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation
    • B24B49/12Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation involving optical means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B24GRINDING; POLISHING
    • B24BMACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B9/00Machines or devices designed for grinding edges or bevels on work or for removing burrs; Accessories therefor
    • B24B9/02Machines or devices designed for grinding edges or bevels on work or for removing burrs; Accessories therefor characterised by a special design with respect to properties of materials specific to articles to be ground
    • B24B9/04Machines or devices designed for grinding edges or bevels on work or for removing burrs; Accessories therefor characterised by a special design with respect to properties of materials specific to articles to be ground of metal, e.g. skate blades
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements

Definitions

  • This disclosure relates to a robot system, its control device, control method, and control program.
  • a robot system includes a grinding device that grinds an object and a robot that adjusts the attitude of the grinding device based on the rotation speed and current value of the drive unit of the grinding device (see, for example, Patent Document 1).
  • One aspect of the present disclosure is a robot system that includes a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, a camera that captures a first image of processing marks formed on the workpiece by the processing, and a control device, the control device including at least one memory and at least one processor, the memory stores a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative attitude of the workpiece and the tool, and associates the second images with the parameters, and the processor estimates the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.
  • FIG. 1 is a perspective view illustrating a robot system according to an embodiment of the present disclosure.
  • 2 is a partial enlarged view showing the posture of a tool during processing by the robot system of FIG. 1.
  • 2 is a schematic diagram showing a surface of a workpiece polished by the robot system of FIG. 1 .
  • FIG. 2 is a schematic diagram showing a first image acquired by a camera of the robot system of FIG. 1 .
  • FIG. 2 is a block diagram showing a configuration of a control device according to an embodiment of the present disclosure.
  • FIG. 6 is a schematic diagram showing a second image stored in the memory of the control device of FIG. 5 .
  • FIG. 6 is a schematic diagram showing a second image stored in the memory of the control device of FIG. 5 .
  • FIG. 6 is a schematic diagram showing a second image stored in the memory of the control device of FIG. 5 .
  • 6 is a flowchart showing a control method performed by the control device of FIG. 5 .
  • FIG. 13 is a schematic diagram showing a first image when the tool is tilted around the X-axis.
  • a robot system 1 includes a robot 20 that performs a predetermined task, a tool 30 attached to the tip of the robot 20, and a camera 40 disposed outside the robot 20.
  • the robot system 1 also includes a control device 10 according to this embodiment that controls the robot 20, the tool 30, and the camera 40.
  • a tool 30 is attached to the tip of the third wrist element 28 via a force sensor 29.
  • the force sensor 29 is, for example, a six-axis sensor that detects three force components acting on the tool 30 in three orthogonal axial directions and three torque components around each axis.
  • Motor 32a is mounted on the tip side of main body 32.
  • Motor 32a has shaft 32b with grinding wheel 31 attached to its tip, and shaft 32b extends in a direction perpendicular to the longitudinal axis of main body 32, that is, in a direction parallel to sixth axis F.
  • grinding wheel 31 is positioned such that central axis CL, which is the center of rotation, is parallel to sixth axis F.
  • the tool coordinate system has an origin O at the position on the outer periphery of the lower surface of the grinding wheel 31 that is farthest from the sixth axis F, and has an X-axis, a Y-axis, and a Z-axis that are mutually orthogonal at the origin O.
  • the tool coordinate system defines mutually orthogonal X-axis and Z-axis in a plane including the central axis CL of the grinding wheel 31.
  • the Z-axis is set to extend vertically when the central axis CL is tilted forward by a preset reference angle with respect to the vertical direction.
  • the grinding wheel 31 which is inclined at a reference angle (reference position), moves near the origin O along the surface of the workpiece W in the X-axis direction while in contact with the surface, as shown in FIG. 2, thereby grinding the weld mark S. Then, as shown in FIG. 3, a band-shaped grinding mark (machining mark) s1 is formed on the surface of the workpiece W, which is made up of continuous arc-shaped grinding marks in the X-axis direction.
  • Camera 40 is, for example, a two-dimensional camera that captures two-dimensional images. As shown in Figs. 1 and 2, camera 40 is installed facing downward above worktable T, and captures the surface of workpiece W within its angle of view. Camera 40 can capture a first image P1 that includes, for example, welding marks S on the surface of workpiece W and grinding marks s1 formed when part of the welding marks S is ground, as shown in Fig. 4.
  • the control device 10 includes at least one memory 2 such as a ROM or a RAM, at least one processor 3 such as a CPU, an input device 4, and a transmitter/receiver 5.
  • Operation program 2a also includes a command to rotate grinding wheel 31 around central axis CL while maintaining the reference posture, and move grinding wheel 31 along the direction in which welding mark S extends while bringing the vicinity of origin O of grinding wheel 31 into contact with the surface of the workpiece W.
  • the correction program 2b includes a group of control commands for correcting the posture of the tool 30. For example, when a slight tilt occurs between the lower surface of the grindstone 31 and the surface of the workpiece W when the two are brought into surface alignment, the correction program 2b corrects the posture of the tool 30 when the tool 30 is disposed at an angle relative to the reference posture in which the tool 30 should be disposed. More specifically, the processor 3 sends an image capturing command to the camera 40 based on the correction program 2b, and causes the camera 40 to acquire a first image P1. Furthermore, the processor 3 receives the first image P1 from the camera 40 based on the correction program 2b, and compares the first image P1 with a second image P2 (described later) stored in the memory 2. Then, based on the comparison result, the inclination (deviation) of the tool 30 with respect to the reference attitude is corrected.
  • a second image P2 described later
  • the second image P2 is, for example, an image captured by the camera 40 of polishing marks s2 formed by performing a preliminary polishing process with the tool 30 on a test workpiece on which a reference line S' corresponding to the welding mark S has been drawn.
  • Fig. 6 is a second image P2 of the polishing marks s2 formed when the tool 30 is correctly placed in the reference posture.
  • Fig. 7 is a second image P2 when the tool 30 is tilted by a predetermined angle only around the X-axis with respect to the reference posture
  • Fig. 8 is a second image P2 when the tool 30 is tilted by a predetermined angle only around the Y-axis with respect to the reference posture.
  • the memory 2 stores angular deviation amounts (parameters) 2c around the X, Y, and Z axes of the tool 30 corresponding to each second image P2 with respect to the reference posture, in association with each second image P2. That is, the second image P2 shown in Fig. 6 is associated with zero as the angular deviation amount 2c around the X-axis, Y-axis, and Z-axis. On the other hand, the second image P2 shown in Fig. 7 is associated with a non-zero value as the angular deviation amount 2c around the X-axis, and the second image P2 shown in Fig. 8 is associated with a non-zero value as the angular deviation amount 2c around the Y-axis.
  • the second image P2 is an image captured by the camera 40 each time the tool 30 is rotated at a predetermined small angle interval only around the X-axis, only around the Y-axis, and only around the Z-axis, and multiple images are stored in the memory 2.
  • the processor 3 determines the second image P2 that is closest to the first image P1 by matching, and reads out the deviation amount 2c associated with it, thereby making it possible to estimate the deviation amount of the tool 30 from the reference posture. In other words, it is possible to estimate the relative posture of the tool 30 with respect to the workpiece W.
  • the processor 3 can then determine the amount of correction for the attitude of the tool 30 based on the estimated amount of deviation of the tool 30 .
  • the input device 4 is, for example, a keyboard, a touch panel, an operation panel, etc., and is a device that accepts an instruction from an operator to execute the operation program 2a or the correction program 2b.
  • the transmission/reception unit 5 transmits and receives signals to and from the robot 20, the tool 30, the camera 40, etc., based on the operation program 2a and the correction program 2b.
  • a control method performed by the control device 10 of the robot system 1 according to this embodiment configured as above will be described with reference to the flowchart shown in FIG.
  • FIG. 3 an example will be described in which one of a plurality of welding marks S formed linearly on the surface of the workpiece W is polished from one end side to the other end side.
  • the control device 10 of the robot system 1 aligns the underside of the grindstone 31 with the surface of the workpiece W in accordance with the operation program 2a, and then places the tool 30 in a reference posture.
  • the control device 10 then rotates the grindstone 31 around the central axis CL, and brings the vicinity of the origin O of the grindstone 31 into contact with one end of the weld mark S so that the reaction force acting on the tool 30 detected by the force sensor 29 becomes a predetermined magnitude (see FIG. 2).
  • the grindstone 31 is moved from one end of the weld mark S to the other end along the surface of the workpiece W, thereby starting the polishing process of the weld mark S (step S1).
  • the correction program 2b when it is detected that the tool 30 has moved a predetermined distance in the direction along the X-axis after the start of the polishing process (step S2), the correction program 2b is executed by the processor 3.
  • the polishing process is interrupted (step S3).
  • the control device 10 causes the camera 40 to photograph the processing mark s1 formed between the start and interruption of the polishing process and a portion of the remaining welding mark S, and obtain a first image P1 (step S4).
  • the polishing mark s1 in the first image P1 will be formed shifted from the welding mark S, which is the target position, as shown in FIG. 10.
  • the first image P1 captured by the camera 40 is sent to the control device 10 via the transmitting/receiving unit 5, where it is subjected to image processing.
  • the control device 10 compares the processed first image P1 with a plurality of second images P2 previously stored in the memory 2 as shown in Fig. 6 to Fig. 8 (step S5).
  • the processor 3 compares the position and shape of the grinding marks s1 relative to the welding marks S in the first image P1 with the position and shape of the grinding marks s2 relative to each reference line S' in the plurality of second images P2.
  • the control device 10 selects the second image P2 that includes the grinding marks s2 whose position and shape are closest to the grinding marks s1 in the first image P1, and reads out from the memory 2 the deviation amount 2c stored in association with the selected second image P2.
  • the processor 3 determines that the attitude of the tool 30 is not deviated from the reference attitude (step S6). Then, when it is determined that the attitude of the tool 30 is not deviated from the reference attitude, the processor 3 resumes the interrupted polishing process according to the operation program 2a (step S9).
  • the processor 3 determines that the processing mark s1 is deviated from the target position (step S6). Then, the processor 3 corrects the attitude of the tool 30 by operating the robot 20 in a direction that cancels out the read-out deviation amount 2c (step S7). Then, with the attitude of the tool 30 corrected, the polishing process based on the operation program 2a is resumed (step S8), and the process returns to step S2.
  • steps S2 to S8 are repeated until the second image P2 that is closest to the acquired first image P1 becomes the image shown in FIG. 6.
  • polishing may be performed from the beginning, or polishing of the remaining weld marks S may be performed.
  • the robot system 1, control device 10, control method, and control program according to this embodiment can correct the posture of the tool 30 when it starts polishing if it is not in the reference posture in which it should be placed.
  • the precision of the polishing can be improved.
  • the correction of the posture of the tool 30 is performed when the weld mark S has been polished a specified distance, i.e., at the beginning of the polishing process, so it is possible to prevent the tool 30 from continuing to polish with the posture in a misaligned state. Therefore, it is possible to minimize the amount of polishing that is left behind due to the misalignment of the tool 30, and it is also possible to shorten the time required for the polishing process.
  • the object to be processed is the weld mark S formed on the surface of the flat workpiece W, but this is not limited to this.
  • the workpiece W may have a gently curved surface, and the object to be processed may be the weld mark or the like formed on the curved surface.
  • a grinder for polishing is exemplified as the tool 30.
  • the tool 30 is not limited to this.
  • the tool 30 may be any tool that performs scraping, cutting, laser processing, or the like on a workpiece.
  • the polishing process is performed by bringing the tool 30 attached to the tip of the robot 20 into contact with the workpiece W installed outside, but the positions of the workpiece W and the tool 30 may be interchanged.
  • the polishing process may be performed by bringing the workpiece W attached to the tip of the robot 20 into contact with the tool 30 fixed outside.
  • the camera 40 is positioned above the work table T, but it may be positioned at any position as long as it can capture an image of the surface of the workpiece W and the machining marks s1 formed thereon.
  • the camera 40 may be attached to the tip of the wrist of the robot 20 and positioned so that the vicinity of the origin O of the grinding wheel 31 is within the angle of view. In this case, there is an advantage that the polishing marks s1 formed by the polishing process can be captured at a closer position, making it possible to obtain a highly accurate first image P1.
  • the first image P1 acquired by executing the correction program 2b and the deviation amount of the attitude of the tool 30 estimated based on the first image P1 may be additionally stored in the memory 2. That is, the control device 10 may perform one or more corrections and associate all the correction amounts when there is finally no deviation amount with the first image P1 acquired first after the start of the correction program 2b as deviation amounts, and store them in the memory 2 for comparison. The control device 10 may then use a so-called machine learning function to estimate the deviation amounts around all axes X, Y, and Z at once from the acquired first image P1.
  • the attitude of the tool 30 is adjusted by operating the robot 20.
  • the drive mechanism of the tool 30 may be operated by an amount corresponding to the deviation in the attitude of the tool 30 estimated by the method similar to that described above. In this case, the attitude of the tool 30 can be corrected while maintaining the attitude of the robot 20.
  • the control device 10 changes the attitude of the tool 30 based on the estimated deviation amount of the attitude of the tool 30, but instead, the arrangement of the tool coordinate system set on the tool 30 may be changed. For example, if the posture of the tool 30 at the start of polishing is tilted around the X-axis with respect to the reference posture, the tool coordinate system set for the tool 30 is reset by tilting around the X-axis by the same amount as the tilt of the tool 30 and in the opposite direction. This allows the robot 20 to operate based on the tool coordinate system tilted in a direction that cancels the deviation in the posture of the tool 30. Therefore, in the operation program 2a executed after the tool coordinate system is reset, the posture of the tool 30 is corrected.
  • control device 10 may correct the posture deviation of the tool 30 and adjust the contact pressure of the tool 30 on the workpiece W based on the reaction force acting on the tool 30 detected by the force sensor 29. This makes it possible to prevent the contact pressure acting on the tool 30 from unintentionally increasing and exceeding the allowable value during polishing after the posture of the tool 30 is corrected.
  • the amount of correction of the attitude of the tool 30 may be adjusted depending on the type of the tool 30.
  • a plurality of second images P2 and the deviation amounts 2c of the tool 30 are stored in the memory 2 in association with each of a plurality of grindstones 31 having different grit sizes.
  • the amount of correction of the attitude of the tool 30 may be adjusted depending on the period of use of the tool 30 .
  • a plurality of second images P2 and the deviation amounts 2c of the tool 30 are associated with each other and stored in the memory 2. This makes it possible to prevent the accuracy of the correction of the attitude of the tool 30 from being deteriorated due to differences in the wear state of the grindstone 31.
  • control device 10 controls the robot 20 so that the posture of the tool 30 is corrected based on the deviation in the estimated posture of the tool 30.
  • the robot system 1 may be provided with a display device, and the control device 10 may display the direction and magnitude of the deviation in the estimated posture of the tool 30 on the display device, to allow the worker to correct the posture of the tool 30.
  • a robot system comprising: a tool that performs a predetermined processing on a workpiece; a robot that moves the tool and the workpiece relatively; a camera that acquires a first image of processing marks formed on the workpiece by the processing; and a control device, the control device having at least one memory and at least one processor, the memory stores a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative attitude of the workpiece and the tool, corresponding to the parameters, and the processor estimates the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.
  • Appendix 2 2.
  • Appendix 3 A robot system as described in Appendix 2, comprising a drive mechanism capable of changing the posture of the tool, wherein the processor adjusts the posture of the tool by operating the drive mechanism based on the estimated parameters.
  • Appendix 4 3. The robot system of claim 2, wherein the processor adjusts the posture of the tool by controlling the robot based on the estimated parameters.
  • (Appendix 5) 5.
  • a control device for a robot system comprising a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, and a camera that acquires a first image of processing marks formed on the workpiece by the processing, the control device comprising at least one memory and at least one processor, wherein the memory stores a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative attitude between the workpiece and the tool, in correspondence with the parameters, and the processor estimates the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.
  • a control method for a robot system including a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, and a camera that acquires a first image of processing marks formed on the workpiece by the processing, the control method storing a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative posture between the workpiece and the tool in correspondence with the parameters, and estimating the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.
  • a control program for a robot system including a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, and a camera that acquires a first image of processing marks formed on the workpiece by the processing, the control program causing a computer to execute the following steps: store a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative posture between the workpiece and the tool, correspond to the parameters, and estimate the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.
  • Robot system 1 Robot system 2 Memory 2c Displacement amount (parameter) 3 Processor 10 Control device 20 Robot 29 Force sensor (sensor) 30 Tool 40 Camera O Origin P1 First image P2 Second image s1 Grinding marks (processing marks) s2 Polishing marks (processing marks) Double Work

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Human Computer Interaction (AREA)
  • Manipulator (AREA)

Abstract

A robot system (1) comprises a tool (30) that performs prescribed machining on a workpiece (W), a robot (20) that relatively moves the tool (30) and the workpiece (W), a camera (40) that acquires a first image of a machining mark formed on the workpiece (W) by the machining, and a control device (10). The control device (10) is provided with at least one memory and at least one processor. The memory stores a plurality of second images of machining marks from when machining is performed by switching parameters relating to the relative orientation of the workpiece (W) and the tool (30), in association with the parameters. The processor compares the first image and the second images, thereby estimating a parameter corresponding to the machining mark in the first image.

Description

ロボットシステム、その制御装置、制御方法および制御プログラムROBOT SYSTEM, CONTROL DEVICE, CONTROL METHOD, AND CONTROL PROGRAM THEREOF

 本開示は、ロボットシステム、その制御装置、制御方法および制御プログラムに関するものである。 This disclosure relates to a robot system, its control device, control method, and control program.

 対象物を研削する研削装置と、研削装置の駆動部の回転数および電流値に基づいて、研削装置の姿勢を調節するロボットとを備えたロボットシステムが知られている(例えば、特許文献1参照。)。 A robot system is known that includes a grinding device that grinds an object and a robot that adjusts the attitude of the grinding device based on the rotation speed and current value of the drive unit of the grinding device (see, for example, Patent Document 1).

特開2022-065378号公報JP 2022-065378 A

 対象物の研削状態を、研削装置の回転数および電流値を指標にして間接的に検出する場合には、対象物に対する研削装置の僅かなずれを検出することが難しく、対象物を精度よく研削することが困難である。 When the grinding condition of the object is indirectly detected using the rotation speed and current value of the grinding device as indicators, it is difficult to detect slight deviations of the grinding device relative to the object, making it difficult to grind the object with precision.

 したがって、対象物に対して所定の加工を行うロボットシステムにおいて、対象物に対するツールの僅かなずれを補正して精度よく加工できることが望まれている。 Therefore, in a robot system that performs specified processing on an object, it is desirable to be able to correct slight misalignment of the tool relative to the object and perform processing with high precision.

 本開示の一態様は、ワークに対して所定の加工を行うツールと、該ツールと前記ワークとを相対的に移動させるロボットと、前記加工により前記ワークに形成された加工痕の第1画像を取得するカメラと、制御装置とを備え、該制御装置が、少なくとも1つのメモリと、少なくとも1つのプロセッサとを備え、前記メモリが、前記ワークと前記ツールとの相対姿勢に関するパラメータを切り替えて前記加工を行ったときの加工痕の複数の第2画像を前記パラメータに対応付けて記憶し、前記プロセッサが、前記第1画像と前記第2画像とを照合することにより、前記第1画像の加工痕に対応する前記パラメータを推定するロボットシステムである。 One aspect of the present disclosure is a robot system that includes a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, a camera that captures a first image of processing marks formed on the workpiece by the processing, and a control device, the control device including at least one memory and at least one processor, the memory stores a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative attitude of the workpiece and the tool, and associates the second images with the parameters, and the processor estimates the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.

本開示の一実施形態に係るロボットシステムを示す斜視図である。FIG. 1 is a perspective view illustrating a robot system according to an embodiment of the present disclosure. 図1のロボットシステムの加工時におけるツールの姿勢を示す部分的な拡大図である。2 is a partial enlarged view showing the posture of a tool during processing by the robot system of FIG. 1. 図1のロボットシステムにより研磨されたワークの表面を示す概略図である。2 is a schematic diagram showing a surface of a workpiece polished by the robot system of FIG. 1 . 図1のロボットシステムのカメラが取得する第1画像を示す概略図である。FIG. 2 is a schematic diagram showing a first image acquired by a camera of the robot system of FIG. 1 . 本開示の一実施形態に係る制御装置の構成を示すブロック図である。FIG. 2 is a block diagram showing a configuration of a control device according to an embodiment of the present disclosure. 図5の制御装置のメモリに記憶される第2画像を示す概略図である。FIG. 6 is a schematic diagram showing a second image stored in the memory of the control device of FIG. 5 . 図5の制御装置のメモリに記憶される第2画像を示す概略図である。FIG. 6 is a schematic diagram showing a second image stored in the memory of the control device of FIG. 5 . 図5の制御装置のメモリに記憶される第2画像を示す概略図である。FIG. 6 is a schematic diagram showing a second image stored in the memory of the control device of FIG. 5 . 図5の制御装置による制御方法を示すフローチャートである。6 is a flowchart showing a control method performed by the control device of FIG. 5 . ツールがX軸回りに傾いている場合の第1画像を示す概略図である。FIG. 13 is a schematic diagram showing a first image when the tool is tilted around the X-axis.

 本開示の一実施形態に係るロボットシステム1、制御装置10、制御方法および制御プログラムについて、図面を参照して以下に説明する。
 本実施形態に係るロボットシステム1は、図1に示すように、所定の作業を行うロボット20と、ロボット20の先端に取り付けられたツール30と、ロボット20の外部に配置されたカメラ40とを備える。また、ロボットシステム1は、ロボット20、ツール30およびカメラ40を制御する本実施形態に係る制御装置10を備える。
A robot system 1, a control device 10, a control method, and a control program according to an embodiment of the present disclosure will be described below with reference to the drawings.
1, a robot system 1 according to this embodiment includes a robot 20 that performs a predetermined task, a tool 30 attached to the tip of the robot 20, and a camera 40 disposed outside the robot 20. The robot system 1 also includes a control device 10 according to this embodiment that controls the robot 20, the tool 30, and the camera 40.

 ロボット20は、図1に示すように、例えば、6軸垂直多関節型ロボットである。
 ロボット20は、水平な床面等の被設置面に設置されるベース21と、鉛直な第1軸線A回りにベース21に対して回転可能な旋回胴22とを備える。また、ロボット20は、水平な第2軸線B回りに旋回胴22に対して回転可能な第1アーム23と、第2軸線Bに平行な第3軸線C回りに第1アーム23に対して回転可能な第2アーム24とを備える。さらに、ロボット20は、第2アーム24の先端に支持された3軸の手首ユニット25を備える。
As shown in FIG. 1, the robot 20 is, for example, a six-axis vertical articulated robot.
The robot 20 includes a base 21 placed on an installation surface such as a horizontal floor surface, and a rotating body 22 that is rotatable relative to the base 21 about a vertical first axis A. The robot 20 also includes a first arm 23 that is rotatable relative to the rotating body 22 about a horizontal second axis B, and a second arm 24 that is rotatable relative to the first arm 23 about a third axis C that is parallel to the second axis B. The robot 20 also includes a three-axis wrist unit 25 supported at the tip of the second arm 24.

 手首ユニット25は、第3軸線Cに直交する平面に沿って延びる第4軸線D回りに第2アーム24に対して回転可能な第1手首要素26を備える。また、手首ユニット25は、第4軸線Dに直交する第5軸線E回りに第1手首要素26に対して回転可能な第2手首要素27を備える。さらに、手首ユニット25は、第5軸線Eに直交し、第4軸線Dと第5軸線Eとの交点を通過する第6軸線F回りに第2手首要素27に対して回転可能な第3手首要素28を備える。 The wrist unit 25 includes a first wrist element 26 that is rotatable relative to the second arm 24 around a fourth axis D that extends along a plane perpendicular to the third axis C. The wrist unit 25 also includes a second wrist element 27 that is rotatable relative to the first wrist element 26 around a fifth axis E that is perpendicular to the fourth axis D. The wrist unit 25 also includes a third wrist element 28 that is rotatable relative to the second wrist element 27 around a sixth axis F that is perpendicular to the fifth axis E and passes through the intersection of the fourth axis D and the fifth axis E.

 第3手首要素28の先端には、図2に示すように、力センサ29を介在させてツール30が取り付けられている。力センサ29は、例えば、6軸センサであって、ツール30に作用する直交3軸方向の3つの力成分と、各軸回りの3つのトルク成分とを検出する。 As shown in FIG. 2, a tool 30 is attached to the tip of the third wrist element 28 via a force sensor 29. The force sensor 29 is, for example, a six-axis sensor that detects three force components acting on the tool 30 in three orthogonal axial directions and three torque components around each axis.

 本実施形態において、ツール30は、グラインダである。ツール30は、例えば、図1に示すように、作業台Tに設置された平板状のワークWの表面に凸状に形成された1以上の溶接痕Sを研磨加工する。この場合に、力センサ29は、研磨加工時にツール30がワークWの表面に接触した際の反力を検出する。 In this embodiment, the tool 30 is a grinder. For example, as shown in FIG. 1, the tool 30 grinds one or more welding marks S formed in a convex shape on the surface of a flat workpiece W placed on a workbench T. In this case, the force sensor 29 detects the reaction force when the tool 30 comes into contact with the surface of the workpiece W during grinding.

 図2に示す例において、ツール30は、円板状の砥石31と、砥石31を中心軸CL回りに回転可能に支持する本体部32とを備える。
 本体部32は、長手軸を有する形状を有し、基端側は、力センサ29の第3手首要素28とは反対側の側面に固定されたブラケット33によって、その長手軸を第6軸線Fに直交させた姿勢に支持されている。
In the example shown in FIG. 2, the tool 30 includes a disk-shaped grindstone 31 and a main body 32 that supports the grindstone 31 rotatably about a central axis CL.
The main body 32 has a shape with a longitudinal axis, and the base end side is supported in a position with its longitudinal axis perpendicular to the sixth axis F by a bracket 33 fixed to the side of the force sensor 29 opposite the third wrist element 28.

 また、本体部32の先端側には、モータ32aが搭載されている。モータ32aは、先端に砥石31が取り付けられたシャフト32bを備えており、シャフト32bは、本体部32の長手軸に直交する方向、つまり、第6軸線Fに平行な方向に延びている。すなわち、砥石31は、回転中心である中心軸CLが、第6軸線Fと平行になる姿勢に配置されている。 Motor 32a is mounted on the tip side of main body 32. Motor 32a has shaft 32b with grinding wheel 31 attached to its tip, and shaft 32b extends in a direction perpendicular to the longitudinal axis of main body 32, that is, in a direction parallel to sixth axis F. In other words, grinding wheel 31 is positioned such that central axis CL, which is the center of rotation, is parallel to sixth axis F.

 また、ツール30には、互いに直交する3軸のツール座標系が規定される。ツール座標系は、図2に示すように、砥石31の下面の外周縁のうち、第6軸線Fから最も離れた位置を原点Oとし、原点Oにおいて互いに直交するX軸,Y軸,Z軸を備える。 In addition, a tool coordinate system with three mutually orthogonal axes is defined for the tool 30. As shown in FIG. 2, the tool coordinate system has an origin O at the position on the outer periphery of the lower surface of the grinding wheel 31 that is farthest from the sixth axis F, and has an X-axis, a Y-axis, and a Z-axis that are mutually orthogonal at the origin O.

 図2に示す例において、ツール座標系は、砥石31の中心軸CLを含む平面内に、相互に直交するX軸およびZ軸が定義されている。また、Z軸は、中心軸CLが鉛直方向に対して、予め設定された基準角度だけ前のめりに傾けられている状態において、鉛直方向に延びる方向に設定されている。 In the example shown in FIG. 2, the tool coordinate system defines mutually orthogonal X-axis and Z-axis in a plane including the central axis CL of the grinding wheel 31. The Z-axis is set to extend vertically when the central axis CL is tilted forward by a preset reference angle with respect to the vertical direction.

 すなわち、基準角度だけ傾いた姿勢(基準姿勢)の砥石31の原点O近傍が、図2に示すように、ワークWの表面に接触しながら、表面に沿ってX軸方向に移動することにより、溶接痕Sが研磨される。そして、ワークWの表面には、図3に示すように、円弧状の研磨痕がX軸方向に連続してなる帯状の研磨痕(加工痕)s1が形成される。 In other words, the grinding wheel 31, which is inclined at a reference angle (reference position), moves near the origin O along the surface of the workpiece W in the X-axis direction while in contact with the surface, as shown in FIG. 2, thereby grinding the weld mark S. Then, as shown in FIG. 3, a band-shaped grinding mark (machining mark) s1 is formed on the surface of the workpiece W, which is made up of continuous arc-shaped grinding marks in the X-axis direction.

 カメラ40は、例えば、2次元画像を取得する2次元カメラである。カメラ40は、図1および図2に示すように、作業台Tの上方に下向きに設置され、ワークWの表面を画角内に収める。そして、カメラ40は、例えば、図4に示すような、ワークWの表面の溶接痕Sと、その溶接痕Sの一部を研磨した際に形成された研磨痕s1とを含む第1画像P1を取得できる。 Camera 40 is, for example, a two-dimensional camera that captures two-dimensional images. As shown in Figs. 1 and 2, camera 40 is installed facing downward above worktable T, and captures the surface of workpiece W within its angle of view. Camera 40 can capture a first image P1 that includes, for example, welding marks S on the surface of workpiece W and grinding marks s1 formed when part of the welding marks S is ground, as shown in Fig. 4.

 制御装置10は、図5に示すように、ROMおよびRAM等の少なくとも1つのメモリ2と、CPU等の少なくとも1つのプロセッサ3と、入力装置4と、送受信部5とを備える。 As shown in FIG. 5, the control device 10 includes at least one memory 2 such as a ROM or a RAM, at least one processor 3 such as a CPU, an input device 4, and a transmitter/receiver 5.

 メモリ2には、ワークWの表面の溶接痕Sを研磨する際のロボット20およびツール30の動作を制御する動作プログラム2aが記憶されている。また、メモリ2には、動作プログラム2aの実行により行われる研磨加工の際の、ツール30の姿勢を補正する補正プログラム(制御プログラム)2bが記憶されている。さらに、メモリ2には、後述する第2画像P2が記憶されている。 The memory 2 stores an operation program 2a that controls the operation of the robot 20 and the tool 30 when polishing the weld mark S on the surface of the workpiece W. The memory 2 also stores a correction program (control program) 2b that corrects the posture of the tool 30 when polishing is performed by executing the operation program 2a. The memory 2 also stores a second image P2, which will be described later.

 動作プログラム2aには、砥石31の下面全面をワークWの表面に接触させ、力センサ29により検出される反力に基づく力制御によって、砥石31の下面とワークWの表面とを一致させる面合わせ指令が含まれる。また、動作プログラム2aには、面合わせの実行後、砥石31をワークWの表面から上方に引き離し、ツール30をツール座標系のY軸回りに基準角度だけ前のめりに傾けた基準姿勢にする指令が含まれる(図2参照)。さらに、動作プログラム2aには、基準姿勢を維持したまま砥石31を中心軸CL回りに回転させ、砥石31の原点Oの近傍を、ワークWの表面に接触させつつ、溶接痕Sの延びる方向に沿って移動させる指令が含まれる。 Operation program 2a includes a surface alignment command to bring the entire lower surface of grinding wheel 31 into contact with the surface of the workpiece W and align the lower surface of grinding wheel 31 with the surface of the workpiece W by force control based on the reaction force detected by force sensor 29. Operation program 2a also includes a command to, after performing surface alignment, pull grinding wheel 31 upward from the surface of the workpiece W and set tool 30 to a reference posture in which tool 30 is tilted forward by a reference angle around the Y axis of the tool coordinate system (see FIG. 2). Operation program 2a also includes a command to rotate grinding wheel 31 around central axis CL while maintaining the reference posture, and move grinding wheel 31 along the direction in which welding mark S extends while bringing the vicinity of origin O of grinding wheel 31 into contact with the surface of the workpiece W.

 補正プログラム2bは、ツール30の姿勢を補正するための一群の制御指令を含む。補正プログラム2bは、例えば、砥石31の下面とワークWの表面との面合わせ時に、両者間に僅かな傾きが生じ、ツール30が本来配置されるべき基準姿勢に対して傾いて配置された場合に、その姿勢を補正する。
 より具体的には、プロセッサ3は、補正プログラム2bに基づいて、カメラ40に撮影指令を送り、カメラ40に第1画像P1を取得させる。さらに、プロセッサ3は、補正プログラム2bに基づいて、カメラ40から第1画像P1を受け取り、その第1画像P1とメモリ2に記憶されている第2画像P2(後述)とを照合する。そして、照合結果に基づいて、ツール30の基準姿勢に対する傾き(ずれ)を補正する。
The correction program 2b includes a group of control commands for correcting the posture of the tool 30. For example, when a slight tilt occurs between the lower surface of the grindstone 31 and the surface of the workpiece W when the two are brought into surface alignment, the correction program 2b corrects the posture of the tool 30 when the tool 30 is disposed at an angle relative to the reference posture in which the tool 30 should be disposed.
More specifically, the processor 3 sends an image capturing command to the camera 40 based on the correction program 2b, and causes the camera 40 to acquire a first image P1. Furthermore, the processor 3 receives the first image P1 from the camera 40 based on the correction program 2b, and compares the first image P1 with a second image P2 (described later) stored in the memory 2. Then, based on the comparison result, the inclination (deviation) of the tool 30 with respect to the reference attitude is corrected.

 メモリ2に記憶されている第2画像P2の例を、図6から図8に示す。第2画像P2は、例えば、溶接痕Sに対応する基準線S´が引かれたテストワークに対して、ツール30により予備的に研磨加工を行うことにより形成された研磨痕s2をカメラ40により撮影した画像である。
 図6は、ツール30を正しく基準姿勢に配置して形成された研磨痕s2の第2画像P2である。また、図7は、ツール30が基準姿勢に対してX軸回りのみに所定角度だけ傾いた場合の第2画像P2であり、図8は、ツール30が基準姿勢に対してY軸回りのみに所定角度だけ傾いた場合の第2画像P2である。
6 to 8 show examples of the second image P2 stored in the memory 2. The second image P2 is, for example, an image captured by the camera 40 of polishing marks s2 formed by performing a preliminary polishing process with the tool 30 on a test workpiece on which a reference line S' corresponding to the welding mark S has been drawn.
Fig. 6 is a second image P2 of the polishing marks s2 formed when the tool 30 is correctly placed in the reference posture. Fig. 7 is a second image P2 when the tool 30 is tilted by a predetermined angle only around the X-axis with respect to the reference posture, and Fig. 8 is a second image P2 when the tool 30 is tilted by a predetermined angle only around the Y-axis with respect to the reference posture.

 メモリ2には、各第2画像P2に対応するツール30の基準姿勢に対するX,Y,Z軸回りの角度のずれ量(パラメータ)2cが、それぞれの第2画像P2に対応付けて記憶されている。
 すなわち、図6に示す第2画像P2には、X,Y,Z軸回りの角度のずれ量2cとして、全てゼロが対応付けられている。一方、図7に示す第2画像P2には、X軸回り、図8に示す第2画像P2には、Y軸回りの角度のずれ量2cとして、ゼロではない値が対応付けられている。
The memory 2 stores angular deviation amounts (parameters) 2c around the X, Y, and Z axes of the tool 30 corresponding to each second image P2 with respect to the reference posture, in association with each second image P2.
That is, the second image P2 shown in Fig. 6 is associated with zero as the angular deviation amount 2c around the X-axis, Y-axis, and Z-axis. On the other hand, the second image P2 shown in Fig. 7 is associated with a non-zero value as the angular deviation amount 2c around the X-axis, and the second image P2 shown in Fig. 8 is associated with a non-zero value as the angular deviation amount 2c around the Y-axis.

 第2画像P2は、X軸回りのみ、Y軸回りのみ、Z軸回りのみにそれぞれ所定の微小角度間隔でツール30を回転させ、その都度カメラ40により取得させた画像であり、メモリ2に複数記憶されている。
 プロセッサ3は、照合により第1画像P1に最も近い第2画像P2を決定し、それに対応付けられているずれ量2cを読み出すことにより、ツール30の基準姿勢に対するずれ量を推定することができる。すなわち、ワークWに対するツール30の相対姿勢を推定することができる。
 そして、プロセッサ3は、推定したツール30のずれ量に基づいて、ツール30の姿勢の補正量を求めることができる。
The second image P2 is an image captured by the camera 40 each time the tool 30 is rotated at a predetermined small angle interval only around the X-axis, only around the Y-axis, and only around the Z-axis, and multiple images are stored in the memory 2.
The processor 3 determines the second image P2 that is closest to the first image P1 by matching, and reads out the deviation amount 2c associated with it, thereby making it possible to estimate the deviation amount of the tool 30 from the reference posture. In other words, it is possible to estimate the relative posture of the tool 30 with respect to the workpiece W.
The processor 3 can then determine the amount of correction for the attitude of the tool 30 based on the estimated amount of deviation of the tool 30 .

 入力装置4は、例えば、キーボード、タッチパネル、操作盤等であって、作業者による動作プログラム2aあるいは補正プログラム2bの実行命令を受け付ける装置である。また、送受信部5は、動作プログラム2aおよび補正プログラム2bに基づいて、ロボット20、ツール30、カメラ40等に対して、それぞれ信号の送受信を行うものである。 The input device 4 is, for example, a keyboard, a touch panel, an operation panel, etc., and is a device that accepts an instruction from an operator to execute the operation program 2a or the correction program 2b. The transmission/reception unit 5 transmits and receives signals to and from the robot 20, the tool 30, the camera 40, etc., based on the operation program 2a and the correction program 2b.

 このように構成された本実施形態に係るロボットシステム1の制御装置10による制御方法について、図9に示すフローチャートに沿って説明する。
 以下においては、図3に示すように、ワークWの表面に直線状に形成された複数の溶接痕Sの1つを、一端側から他端側に向かって研磨する場合を例に説明する。
A control method performed by the control device 10 of the robot system 1 according to this embodiment configured as above will be described with reference to the flowchart shown in FIG.
In the following, as shown in FIG. 3, an example will be described in which one of a plurality of welding marks S formed linearly on the surface of the workpiece W is polished from one end side to the other end side.

 まず、本実施形態に係るロボットシステム1の制御装置10は、動作プログラム2aに従って、砥石31の下面とワークWの表面との面合わせを行った後に、ツール30を基準姿勢に配置する。その後、制御装置10は、砥石31を中心軸CL回りに回転させ、力センサ29によって検出されるツール30に作用する反力が所定の大きさになるように、砥石31の原点O近傍を溶接痕Sの一端に接触させる(図2参照)。そして、この状態から、砥石31をワークWの表面に沿って、溶接痕Sの一端側から他端側に向かって移動させることにより、溶接痕Sの研磨加工を開始する(ステップS1)。 First, the control device 10 of the robot system 1 according to this embodiment aligns the underside of the grindstone 31 with the surface of the workpiece W in accordance with the operation program 2a, and then places the tool 30 in a reference posture. The control device 10 then rotates the grindstone 31 around the central axis CL, and brings the vicinity of the origin O of the grindstone 31 into contact with one end of the weld mark S so that the reaction force acting on the tool 30 detected by the force sensor 29 becomes a predetermined magnitude (see FIG. 2). Then, from this state, the grindstone 31 is moved from one end of the weld mark S to the other end along the surface of the workpiece W, thereby starting the polishing process of the weld mark S (step S1).

 本実施形態に係る制御方法においては、研磨加工の開始後から、ツール30がX軸に沿う方向に所定距離だけ移動したことを検知すると(ステップS2)、プロセッサ3によって補正プログラム2bが実行される。補正プログラム2bが実行されると、研磨加工が中断される(ステップS3)。
 そして、制御装置10は、補正プログラム2bに従って、カメラ40に研磨加工の開始後から中断までの間に形成された加工痕s1および、残りの溶接痕Sの一部を撮影させ、第1画像P1を取得させる(ステップS4)。
In the control method according to the present embodiment, when it is detected that the tool 30 has moved a predetermined distance in the direction along the X-axis after the start of the polishing process (step S2), the correction program 2b is executed by the processor 3. When the correction program 2b is executed, the polishing process is interrupted (step S3).
Then, in accordance with the correction program 2b, the control device 10 causes the camera 40 to photograph the processing mark s1 formed between the start and interruption of the polishing process and a portion of the remaining welding mark S, and obtain a first image P1 (step S4).

 この場合において、例えば、ツール30の姿勢が、基準姿勢に対してX軸回りに僅かにずれている場合には、第1画像P1の研磨痕s1は、図10に示すように、狙い位置である溶接痕Sに対してずれて形成される。 In this case, for example, if the posture of the tool 30 is slightly shifted around the X-axis from the reference posture, the polishing mark s1 in the first image P1 will be formed shifted from the welding mark S, which is the target position, as shown in FIG. 10.

 カメラ40によって取得された第1画像P1は、送受信部5を経由して、制御装置10へと送られ、画像処理される。
 そして、制御装置10は、処理した第1画像P1と、図6から図8に示すような、メモリ2に予め記憶された複数の第2画像P2とを照合する(ステップS5)。具体的には、プロセッサ3が、第1画像P1の溶接痕Sに対する研磨痕s1の位置および形状と、複数の第2画像P2の各基準線S´に対する研磨痕s2の位置および形状とを比較する。そして、第1画像P1の研磨痕s1に最も近い位置および形状の研磨痕s2を含む第2画像P2を選択し、選択した第2画像P2に対応付けて記憶されているずれ量2cをメモリ2から読み出す。
The first image P1 captured by the camera 40 is sent to the control device 10 via the transmitting/receiving unit 5, where it is subjected to image processing.
The control device 10 then compares the processed first image P1 with a plurality of second images P2 previously stored in the memory 2 as shown in Fig. 6 to Fig. 8 (step S5). Specifically, the processor 3 compares the position and shape of the grinding marks s1 relative to the welding marks S in the first image P1 with the position and shape of the grinding marks s2 relative to each reference line S' in the plurality of second images P2. The control device 10 then selects the second image P2 that includes the grinding marks s2 whose position and shape are closest to the grinding marks s1 in the first image P1, and reads out from the memory 2 the deviation amount 2c stored in association with the selected second image P2.

 プロセッサ3は、読み出されたずれ量2cがゼロである場合、すなわち、選択した第2画像P2が、図6に示す画像である場合には、ツール30の姿勢が基準姿勢に対してずれていないと判定する(ステップS6)。そして、ツール30の姿勢が基準姿勢に対してずれていないと判定したときは、プロセッサ3は中断していた動作プログラム2aによる研磨加工を再開する(ステップS9)。 If the read deviation amount 2c is zero, i.e., if the selected second image P2 is the image shown in FIG. 6, the processor 3 determines that the attitude of the tool 30 is not deviated from the reference attitude (step S6). Then, when it is determined that the attitude of the tool 30 is not deviated from the reference attitude, the processor 3 resumes the interrupted polishing process according to the operation program 2a (step S9).

 一方、プロセッサ3は、読み出されたずれ量2cがゼロ以外である場合、すなわち、選択した第2画像P2が、図6以外の画像である場合には、加工痕s1が狙い位置に対してずれていると判定する(ステップS6)。そして、プロセッサ3は、読み出されたずれ量2cを打ち消す方向にロボット20を動作させることにより、ツール30の姿勢を補正する(ステップS7)。
 そして、ツール30の姿勢が補正された状態において、動作プログラム2aに基づく研磨加工が再開され(ステップS8)、ステップS2に戻る。
On the other hand, if the read-out deviation amount 2c is other than zero, that is, if the selected second image P2 is an image other than that shown in Fig. 6, the processor 3 determines that the processing mark s1 is deviated from the target position (step S6). Then, the processor 3 corrects the attitude of the tool 30 by operating the robot 20 in a direction that cancels out the read-out deviation amount 2c (step S7).
Then, with the attitude of the tool 30 corrected, the polishing process based on the operation program 2a is resumed (step S8), and the process returns to step S2.

 その後、取得された第1画像P1に最も近い第2画像P2が、図6に示す画像となるまで、ステップS2~S8の工程が繰り返される。これにより、ツール30のX,Y,Z軸回り全てのずれが補正される。この場合においては、全てのずれが補正された状態で、研磨加工を最初から実施してもよいし、残りの溶接痕Sの研磨加工を実施してもよい。 Then, steps S2 to S8 are repeated until the second image P2 that is closest to the acquired first image P1 becomes the image shown in FIG. 6. This corrects all misalignments around the X, Y, and Z axes of the tool 30. In this case, with all misalignments corrected, polishing may be performed from the beginning, or polishing of the remaining weld marks S may be performed.

 このように、本実施形態に係るロボットシステム1、制御装置10、制御方法および制御プログラムによれば、研磨加工の開始時のツール30が、本来配置されるべき基準姿勢でない場合に、その姿勢を補正できる。すなわち、ツール30の砥石31が、比較的柔らかいバフ等であって、力制御による面合わせを精度よく行うことができない場合であっても、研磨加工の精度を向上することができる。 In this way, the robot system 1, control device 10, control method, and control program according to this embodiment can correct the posture of the tool 30 when it starts polishing if it is not in the reference posture in which it should be placed. In other words, even if the grindstone 31 of the tool 30 is a relatively soft buff or the like and surface alignment cannot be performed with precision by force control, the precision of the polishing can be improved.

 また、この場合におけるツール30の姿勢の補正は、溶接痕Sを所定距離だけ研磨した時点、すなわち、研磨加工の序盤において行われるため、ツール30の姿勢がずれた状態のまま研磨し続けることを防止できる。したがって、ツール30の姿勢のずれによる研磨残し等を最小限に抑えることができ、研磨加工に要する時間を短縮することもできる。 In addition, in this case, the correction of the posture of the tool 30 is performed when the weld mark S has been polished a specified distance, i.e., at the beginning of the polishing process, so it is possible to prevent the tool 30 from continuing to polish with the posture in a misaligned state. Therefore, it is possible to minimize the amount of polishing that is left behind due to the misalignment of the tool 30, and it is also possible to shorten the time required for the polishing process.

 なお、本実施形態においては、平板状のワークWの表面に形成された溶接痕Sを加工対象としたが、これに限らず、ワークWがなだらかな曲面を有し、その曲面上に形成された溶接痕等を加工対象としてもよい。
 また、本実施形態においては、ツール30として、研磨加工用のグラインダを例示したが、これに限定されない。例えば、ツール30は、加工対象物に対して、キサゲ加工、切断加工あるいはレーザ加工等を施す任意のツールであってもよい。
In this embodiment, the object to be processed is the weld mark S formed on the surface of the flat workpiece W, but this is not limited to this. The workpiece W may have a gently curved surface, and the object to be processed may be the weld mark or the like formed on the curved surface.
In the present embodiment, a grinder for polishing is exemplified as the tool 30. However, the tool 30 is not limited to this. For example, the tool 30 may be any tool that performs scraping, cutting, laser processing, or the like on a workpiece.

 また、本実施形態は、外部に設置されたワークWに対して、ロボット20の先端に取り付けられたツール30を接触させることにより、研磨加工を行う構成であったが、ワークWとツール30との配置を入れ替えてもよい。すなわち、外部に固定されたツール30に対して、ロボット20の先端に取り付けられたワークWを接触させることにより、研磨加工を行うように構成されていてもよい。 In addition, in this embodiment, the polishing process is performed by bringing the tool 30 attached to the tip of the robot 20 into contact with the workpiece W installed outside, but the positions of the workpiece W and the tool 30 may be interchanged. In other words, the polishing process may be performed by bringing the workpiece W attached to the tip of the robot 20 into contact with the tool 30 fixed outside.

 また、本実施形態においては、カメラ40は、作業台Tの上方に配置されていたが、ワークWの表面およびそこに形成される加工痕s1を撮影できる位置であれば、任意の位置に配置されてもよい。例えば、カメラ40を、ロボット20の手首先端に取り付け、砥石31の原点O近傍を画角内に収めるように配置してもよい。この場合には、研磨加工により形成される研磨痕s1をより近い位置で撮影することができ、精度の良い第1画像P1を取得することができるという利点がある。 In addition, in this embodiment, the camera 40 is positioned above the work table T, but it may be positioned at any position as long as it can capture an image of the surface of the workpiece W and the machining marks s1 formed thereon. For example, the camera 40 may be attached to the tip of the wrist of the robot 20 and positioned so that the vicinity of the origin O of the grinding wheel 31 is within the angle of view. In this case, there is an advantage that the polishing marks s1 formed by the polishing process can be captured at a closer position, making it possible to obtain a highly accurate first image P1.

 また、本実施形態においては、補正プログラム2bの実行により取得した第1画像P1と、その第1画像P1に基づいて推定したツール30の姿勢のずれ量を、メモリ2に追加して記憶させてもよい。すなわち、制御装置10は、補正プログラム2bの開始後最初に取得した第1画像P1に、1回以上の補正を実施して最終的にずれ量がなくなったときの全ての補正量をずれ量として対応付けてメモリ2に照合用として蓄積してもよい。そして、制御装置10は、いわゆる機械学習機能によって、取得した第1画像P1から、全ての軸X,Y,Z回りのずれ量を一度に推定できるようにしてもよい。 In addition, in this embodiment, the first image P1 acquired by executing the correction program 2b and the deviation amount of the attitude of the tool 30 estimated based on the first image P1 may be additionally stored in the memory 2. That is, the control device 10 may perform one or more corrections and associate all the correction amounts when there is finally no deviation amount with the first image P1 acquired first after the start of the correction program 2b as deviation amounts, and store them in the memory 2 for comparison. The control device 10 may then use a so-called machine learning function to estimate the deviation amounts around all axes X, Y, and Z at once from the acquired first image P1.

 また、本実施形態においては、ロボット20を動作させることにより、ツール30の姿勢を調節した。これに代えて、ツール30自身が姿勢を変更する駆動機構を有している場合には、上記と同様の方法によって推定したツール30の姿勢のずれ量の分だけ、ツール30の駆動機構を動作させてもよい。この場合には、ロボット20の姿勢を維持したまま、ツール30の姿勢を補正することができる。 In addition, in this embodiment, the attitude of the tool 30 is adjusted by operating the robot 20. Alternatively, if the tool 30 itself has a drive mechanism for changing its attitude, the drive mechanism of the tool 30 may be operated by an amount corresponding to the deviation in the attitude of the tool 30 estimated by the method similar to that described above. In this case, the attitude of the tool 30 can be corrected while maintaining the attitude of the robot 20.

 また、本実施形態においては、制御装置10が、推定したツール30の姿勢のずれ量に基づいて、ツール30の姿勢を変更することとしたが、これに代えて、ツール30に設定されたツール座標系の配置を変更してもよい。
 例えば、研磨加工開始時のツール30の姿勢が、基準姿勢に対してX軸回りに傾いている場合には、ツール30に設定されたツール座標系を、X軸回りにツール30の傾きと同じ大きさかつ反対方向に傾けて再設定する。これにより、ロボット20は、ツール30の姿勢のずれを打ち消す方向に傾けられたツール座標系を基準に動作させられる。したがって、ツール座標系の再設定後に実行される動作プログラム2aでは、ツール30の姿勢が補正される。
Further, in this embodiment, the control device 10 changes the attitude of the tool 30 based on the estimated deviation amount of the attitude of the tool 30, but instead, the arrangement of the tool coordinate system set on the tool 30 may be changed.
For example, if the posture of the tool 30 at the start of polishing is tilted around the X-axis with respect to the reference posture, the tool coordinate system set for the tool 30 is reset by tilting around the X-axis by the same amount as the tilt of the tool 30 and in the opposite direction. This allows the robot 20 to operate based on the tool coordinate system tilted in a direction that cancels the deviation in the posture of the tool 30. Therefore, in the operation program 2a executed after the tool coordinate system is reset, the posture of the tool 30 is corrected.

 また、本実施形態においては、制御装置10が、ツール30の姿勢のずれを補正するとともに、力センサ29により検出されるツール30に作用する反力に基づいて、ツール30のワークWへの接触圧を調節してもよい。
 これにより、ツール30の姿勢を補正後の研磨加工において、ツール30に作用する接触圧が意図せず増大し、許容値を超えてしまうことを防止することができる。
In addition, in this embodiment, the control device 10 may correct the posture deviation of the tool 30 and adjust the contact pressure of the tool 30 on the workpiece W based on the reaction force acting on the tool 30 detected by the force sensor 29.
This makes it possible to prevent the contact pressure acting on the tool 30 from unintentionally increasing and exceeding the allowable value during polishing after the posture of the tool 30 is corrected.

 また、本実施形態においては、ツール30の種類に応じて、ツール30の姿勢の補正量を調整するように構成してもよい。
 例えば、番手の異なる複数の砥石31ごとに、それぞれ複数の第2画像P2およびツール30のずれ量2cを対応付けてメモリ2に記憶させる。
 これにより、一連の研磨加工の途中で砥石31の番手を変更するような場合であっても、砥石31の変更後のツール30の姿勢を、精度よく補正することができる。
In addition, in this embodiment, the amount of correction of the attitude of the tool 30 may be adjusted depending on the type of the tool 30.
For example, a plurality of second images P2 and the deviation amounts 2c of the tool 30 are stored in the memory 2 in association with each of a plurality of grindstones 31 having different grit sizes.
As a result, even if the grit size of the grindstone 31 is changed during a series of polishing processes, the posture of the tool 30 after the grindstone 31 is changed can be corrected with high accuracy.

 同様に、本実施形態においては、ツール30の使用期間に応じて、ツール30の姿勢の補正量を調整するように構成してもよい。
 例えば、砥石の使用期間、すなわち摩耗状態ごとに、それぞれ複数の第2画像P2およびツール30のずれ量2cを対応付けてメモリ2に記憶させる。これにより、砥石31の摩耗状態の違いによって、ツール30の姿勢の補正の精度が悪化することを防止できる。
Similarly, in this embodiment, the amount of correction of the attitude of the tool 30 may be adjusted depending on the period of use of the tool 30 .
For example, for each period of use of the grindstone, i.e., for each wear state, a plurality of second images P2 and the deviation amounts 2c of the tool 30 are associated with each other and stored in the memory 2. This makes it possible to prevent the accuracy of the correction of the attitude of the tool 30 from being deteriorated due to differences in the wear state of the grindstone 31.

 また、本実施形態においては、ツール30のツール座標系の各軸回りのずれを補正する方法を例示したが、同様の方法により、ツール30の各軸方向の位置ずれを補正することもできる。 In addition, in this embodiment, a method for correcting the deviation around each axis of the tool coordinate system of the tool 30 is exemplified, but a similar method can also be used to correct the position deviation in each axial direction of the tool 30.

 また、本実施形態においては、制御装置10は、推定したツール30の姿勢のずれに基づいて、ツール30の姿勢が補正されるようにロボット20を制御した。これに代えて、ロボットシステム1が表示装置を備え、制御装置10が、推定したツール30の姿勢のずれの方向および大きさを表示装置に表示して、作業者にツール30の姿勢を修正させてもよい。 In addition, in this embodiment, the control device 10 controls the robot 20 so that the posture of the tool 30 is corrected based on the deviation in the estimated posture of the tool 30. Alternatively, the robot system 1 may be provided with a display device, and the control device 10 may display the direction and magnitude of the deviation in the estimated posture of the tool 30 on the display device, to allow the worker to correct the posture of the tool 30.

 以上、本開示の実施形態について詳述したが、本開示は上述した個々の実施形態に限定されるものではない。これらの実施形態は、発明の要旨を逸脱しない範囲で、または、特許請求の範囲に記載された内容とその均等物から導き出される本発明の思想および趣旨を逸脱しない範囲で、種々の追加、置き換え、変更、部分的削除等が可能である。例えば、上述した実施形態において、各動作の順序や各処理の順序は、一例として示したものであり、これらに限定されるものではない。 Although the embodiments of the present disclosure have been described in detail above, the present disclosure is not limited to the individual embodiments described above. Various additions, substitutions, modifications, partial deletions, etc. are possible to these embodiments without departing from the gist of the invention, or without departing from the idea and intent of the present invention derived from the contents described in the claims and their equivalents. For example, in the above-mentioned embodiments, the order of each operation and the order of each process are shown as examples, and are not limited to these.

 上記実施形態および変形例に関し、さらに以下の付記を開示する。
(付記1)
 ワークに対して所定の加工を行うツールと、該ツールと前記ワークとを相対的に移動させるロボットと、前記加工により前記ワークに形成された加工痕の第1画像を取得するカメラと、制御装置とを備え、該制御装置が、少なくとも1つのメモリと、少なくとも1つのプロセッサとを備え、前記メモリが、前記ワークと前記ツールとの相対姿勢に関するパラメータを切り替えて前記加工を行ったときの加工痕の複数の第2画像を前記パラメータに対応付けて記憶し、前記プロセッサが、前記第1画像と前記第2画像とを照合することにより、前記第1画像の加工痕に対応する前記パラメータを推定するロボットシステム。
(付記2)
 前記プロセッサが、推定された前記パラメータに基づいて、前記ワークと前記ツールとの相対姿勢を調節する付記1に記載のロボットシステム。
(付記3)
 前記ツールの姿勢を変更可能な駆動機構を備え、前記プロセッサが、推定された前記パラメータに基づいて、前記駆動機構を動作させることにより、前記ツールの姿勢を調節する付記2に記載のロボットシステム。
(付記4)
 前記プロセッサが、推定された前記パラメータに基づいて、前記ロボットを制御することにより、前記ツールの姿勢を調節する付記2に記載のロボットシステム。
(付記5)
 前記ツールが前記ロボットに取り付けられ、前記ツールに、該ツールの先端点を原点とするツール座標系が設定され、前記プロセッサが、推定された前記パラメータに基づいて、前記ロボットを制御することにより、前記ツールの前記ツール座標系の前記原点回りの角度を調節する付記4に記載のロボットシステム。
(付記6)
 前記ツールが前記ロボットに取り付けられ、前記ツールに、該ツールの先端点を原点とするツール座標系が設定され、前記プロセッサが、推定された前記パラメータに基づいて、前記ツール座標系の前記原点回りの前記ツール座標系の角度を調節する付記2に記載のロボットシステム。
(付記7)
 前記プロセッサが、前記第1画像と該第1画像に対して推定した前記パラメータとを対応付けて、前記メモリに追加して記憶する付記2から付記6のいずれかに記載のロボットシステム。
(付記8)
 前記メモリが、前記ツールの種類に対応付けて前記第2画像および前記パラメータを記憶する付記2から付記7のいずれかに記載のロボットシステム。
(付記9)
 前記メモリが、前記ツールの使用期間に対応付けて前記第2画像および前記パラメータを記憶する付記2から付記8のいずれかに記載のロボットシステム。
(付記10)
 前記ツールに作用する力を検出可能なセンサを備え、前記プロセッサが、前記センサにより検出された前記力に基づいて、前記加工における前記ワークと前記ツールとの接触圧を調節する付記2から付記9のいずれかに記載のロボットシステム。
(付記11)
 ワークに対して所定の加工を行うツールと、該ツールと前記ワークとを相対的に移動させるロボットと、前記加工により前記ワークに形成された加工痕の第1画像を取得するカメラとを備えるロボットシステムの制御装置であって、少なくとも1つのメモリと、少なくとも1つのプロセッサとを備え、前記メモリが、前記ワークと前記ツールとの相対姿勢に関するパラメータを切り替えて前記加工を行ったときの加工痕の複数の第2画像を前記パラメータに対応付けて記憶し、前記プロセッサが、前記第1画像と前記第2画像とを照合することにより、前記第1画像の加工痕に対応する前記パラメータを推定する制御装置。
(付記12)
 ワークに対して所定の加工を行うツールと、該ツールと前記ワークとを相対的に移動させるロボットと、前記加工により前記ワークに形成された加工痕の第1画像を取得するカメラとを備えるロボットシステムの制御方法であって、前記ワークと前記ツールとの相対姿勢に関するパラメータを切り替えて前記加工を行ったときの加工痕の複数の第2画像を前記パラメータに対応付けて記憶し、前記第1画像と前記第2画像とを照合することにより、前記第1画像の加工痕に対応する前記パラメータを推定する制御方法。
(付記13)
 ワークに対して所定の加工を行うツールと、該ツールと前記ワークとを相対的に移動させるロボットと、前記加工により前記ワークに形成された加工痕の第1画像を取得するカメラとを備えるロボットシステムの制御プログラムであって、前記ワークと前記ツールとの相対姿勢に関するパラメータを切り替えて前記加工を行ったときの加工痕の複数の第2画像を前記パラメータに対応付けて記憶し、前記第1画像と前記第2画像とを照合することにより、前記第1画像の加工痕に対応する前記パラメータを推定することをコンピュータに実行させる制御プログラム。
The following supplementary notes are further disclosed regarding the above-described embodiment and modified examples.
(Appendix 1)
A robot system comprising: a tool that performs a predetermined processing on a workpiece; a robot that moves the tool and the workpiece relatively; a camera that acquires a first image of processing marks formed on the workpiece by the processing; and a control device, the control device having at least one memory and at least one processor, the memory stores a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative attitude of the workpiece and the tool, corresponding to the parameters, and the processor estimates the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.
(Appendix 2)
2. The robot system of claim 1, wherein the processor adjusts the relative posture of the workpiece and the tool based on the estimated parameters.
(Appendix 3)
A robot system as described in Appendix 2, comprising a drive mechanism capable of changing the posture of the tool, wherein the processor adjusts the posture of the tool by operating the drive mechanism based on the estimated parameters.
(Appendix 4)
3. The robot system of claim 2, wherein the processor adjusts the posture of the tool by controlling the robot based on the estimated parameters.
(Appendix 5)
5. The robot system of claim 4, wherein the tool is attached to the robot, a tool coordinate system is set on the tool with the tip point of the tool as its origin, and the processor adjusts the angle of the tool about the origin of the tool coordinate system by controlling the robot based on the estimated parameters.
(Appendix 6)
3. The robot system of claim 2, wherein the tool is attached to the robot, a tool coordinate system is set on the tool with the tip point of the tool as its origin, and the processor adjusts the angle of the tool coordinate system around the origin of the tool coordinate system based on the estimated parameters.
(Appendix 7)
7. The robot system according to claim 2, wherein the processor associates the first image with the parameters estimated for the first image and stores the associated first image in the memory.
(Appendix 8)
8. The robot system according to claim 2, wherein the memory stores the second image and the parameters in association with a type of the tool.
(Appendix 9)
9. The robot system of claim 2, wherein the memory stores the second image and the parameters in association with a period of use of the tool.
(Appendix 10)
10. The robot system of claim 2, further comprising a sensor capable of detecting a force acting on the tool, wherein the processor adjusts a contact pressure between the workpiece and the tool during the machining based on the force detected by the sensor.
(Appendix 11)
A control device for a robot system comprising a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, and a camera that acquires a first image of processing marks formed on the workpiece by the processing, the control device comprising at least one memory and at least one processor, wherein the memory stores a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative attitude between the workpiece and the tool, in correspondence with the parameters, and the processor estimates the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.
(Appendix 12)
A control method for a robot system including a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, and a camera that acquires a first image of processing marks formed on the workpiece by the processing, the control method storing a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative posture between the workpiece and the tool in correspondence with the parameters, and estimating the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.
(Appendix 13)
A control program for a robot system including a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, and a camera that acquires a first image of processing marks formed on the workpiece by the processing, the control program causing a computer to execute the following steps: store a plurality of second images of the processing marks when the processing is performed by switching parameters related to the relative posture between the workpiece and the tool, correspond to the parameters, and estimate the parameters corresponding to the processing marks in the first images by comparing the first images with the second images.

 1 ロボットシステム
 2 メモリ
 2c ずれ量(パラメータ)
 3 プロセッサ
 10 制御装置
 20 ロボット
 29 力センサ(センサ)
 30 ツール
 40 カメラ
 O 原点
 P1 第1画像
 P2 第2画像
 s1 研磨痕(加工痕)
 s2 研磨痕(加工痕)
 W ワーク
1 Robot system 2 Memory 2c Displacement amount (parameter)
3 Processor 10 Control device 20 Robot 29 Force sensor (sensor)
30 Tool 40 Camera O Origin P1 First image P2 Second image s1 Grinding marks (processing marks)
s2 Polishing marks (processing marks)
Double Work

Claims (13)

 ワークに対して所定の加工を行うツールと、該ツールと前記ワークとを相対的に移動させるロボットと、前記加工により前記ワークに形成された加工痕の第1画像を取得するカメラと、制御装置とを備え、
 該制御装置が、少なくとも1つのメモリと、少なくとも1つのプロセッサとを備え、
 前記メモリが、前記ワークと前記ツールとの相対姿勢に関するパラメータを切り替えて前記加工を行ったときの加工痕の複数の第2画像を前記パラメータに対応付けて記憶し、
 前記プロセッサが、前記第1画像と前記第2画像とを照合することにより、前記第1画像の加工痕に対応する前記パラメータを推定するロボットシステム。
A tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, a camera that acquires a first image of a processing mark formed on the workpiece by the processing, and a control device,
the control device comprises at least one memory and at least one processor;
the memory stores a plurality of second images of machining marks when the machining is performed by switching a parameter related to a relative attitude between the workpiece and the tool, in association with the parameter;
A robot system in which the processor estimates the parameters corresponding to processing marks in the first image by comparing the first image with the second image.
 前記プロセッサが、推定された前記パラメータに基づいて、前記ワークと前記ツールとの相対姿勢を調節する請求項1に記載のロボットシステム。 The robot system of claim 1, wherein the processor adjusts the relative posture between the workpiece and the tool based on the estimated parameters.  前記ツールの姿勢を変更可能な駆動機構を備え、
 前記プロセッサが、推定された前記パラメータに基づいて、前記駆動機構を動作させることにより、前記ツールの姿勢を調節する請求項2に記載のロボットシステム。
A drive mechanism capable of changing the attitude of the tool is provided,
The robot system of claim 2 , wherein the processor adjusts the attitude of the tool by operating the drive mechanism based on the estimated parameters.
 前記プロセッサが、推定された前記パラメータに基づいて、前記ロボットを制御することにより、前記ツールの姿勢を調節する請求項2に記載のロボットシステム。 The robot system of claim 2, wherein the processor adjusts the attitude of the tool by controlling the robot based on the estimated parameters.  前記ツールが前記ロボットに取り付けられ、
 前記ツールに、該ツールの先端点を原点とするツール座標系が設定され、
 前記プロセッサが、推定された前記パラメータに基づいて、前記ロボットを制御することにより、前記ツールの前記ツール座標系の前記原点回りの角度を調節する請求項4に記載のロボットシステム。
The tool is attached to the robot;
A tool coordinate system having a tip point of the tool as its origin is set for the tool;
The robot system of claim 4 , wherein the processor adjusts an angle of the tool about the origin of the tool coordinate system by controlling the robot based on the estimated parameters.
 前記ツールが前記ロボットに取り付けられ、
 前記ツールに、該ツールの先端点を原点とするツール座標系が設定され、
 前記プロセッサが、推定された前記パラメータに基づいて、前記ツール座標系の前記原点回りの前記ツール座標系の角度を調節する請求項2に記載のロボットシステム。
The tool is attached to the robot;
A tool coordinate system having a tip point of the tool as its origin is set for the tool;
The robotic system of claim 2 , wherein the processor adjusts an angle of the tool coordinate system about the origin of the tool coordinate system based on the estimated parameters.
 前記プロセッサが、前記第1画像と該第1画像に対して推定した前記パラメータとを対応付けて、前記メモリに追加して記憶する請求項2から請求項6のいずれか1項に記載のロボットシステム。 The robot system according to any one of claims 2 to 6, wherein the processor associates the first image with the parameters estimated for the first image, and stores the associated first image in the memory.  前記メモリが、前記ツールの種類に対応付けて前記第2画像および前記パラメータを記憶する請求項2から請求項7のいずれか1項に記載のロボットシステム。 The robot system according to any one of claims 2 to 7, wherein the memory stores the second image and the parameters in association with the type of the tool.  前記メモリが、前記ツールの使用期間に対応付けて前記第2画像および前記パラメータを記憶する請求項2から請求項8のいずれか1項に記載のロボットシステム。 The robot system according to any one of claims 2 to 8, wherein the memory stores the second image and the parameters in association with the period of use of the tool.  前記ツールに作用する力を検出可能なセンサを備え、
 前記プロセッサが、前記センサにより検出された前記力に基づいて、前記加工における前記ワークと前記ツールとの接触圧を調節する請求項2から請求項9のいずれか1項に記載のロボットシステム。
A sensor capable of detecting a force acting on the tool;
The robot system according to claim 2 , wherein the processor adjusts a contact pressure between the workpiece and the tool during the machining based on the force detected by the sensor.
 ワークに対して所定の加工を行うツールと、該ツールと前記ワークとを相対的に移動させるロボットと、前記加工により前記ワークに形成された加工痕の第1画像を取得するカメラとを備えるロボットシステムの制御装置であって、
 少なくとも1つのメモリと、少なくとも1つのプロセッサとを備え、
 前記メモリが、前記ワークと前記ツールとの相対姿勢に関するパラメータを切り替えて前記加工を行ったときの加工痕の複数の第2画像を前記パラメータに対応付けて記憶し、
 前記プロセッサが、前記第1画像と前記第2画像とを照合することにより、前記第1画像の加工痕に対応する前記パラメータを推定する制御装置。
A control device for a robot system including a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, and a camera that acquires a first image of a processing mark formed on the workpiece by the processing,
At least one memory and at least one processor;
the memory stores a plurality of second images of machining marks when the machining is performed by switching a parameter related to a relative attitude between the workpiece and the tool, in association with the parameter;
A control device in which the processor estimates the parameter corresponding to the processing marks in the first image by comparing the first image with the second image.
 ワークに対して所定の加工を行うツールと、該ツールと前記ワークとを相対的に移動させるロボットと、前記加工により前記ワークに形成された加工痕の第1画像を取得するカメラとを備えるロボットシステムの制御方法であって、
 前記ワークと前記ツールとの相対姿勢に関するパラメータを切り替えて前記加工を行ったときの加工痕の複数の第2画像を前記パラメータに対応付けて記憶し、
 前記第1画像と前記第2画像とを照合することにより、前記第1画像の加工痕に対応する前記パラメータを推定する制御方法。
A control method for a robot system including a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, and a camera that acquires a first image of a processing mark formed on the workpiece by the processing,
storing a plurality of second images of machining marks when the machining is performed by switching a parameter related to a relative attitude between the workpiece and the tool, in association with the parameter;
A control method for estimating the parameter corresponding to the processing marks in the first image by comparing the first image with the second image.
 ワークに対して所定の加工を行うツールと、該ツールと前記ワークとを相対的に移動させるロボットと、前記加工により前記ワークに形成された加工痕の第1画像を取得するカメラとを備えるロボットシステムの制御プログラムであって、
 前記ワークと前記ツールとの相対姿勢に関するパラメータを切り替えて前記加工を行ったときの加工痕の複数の第2画像を前記パラメータに対応付けて記憶し、
 前記第1画像と前記第2画像とを照合することにより、前記第1画像の加工痕に対応する前記パラメータを推定することをコンピュータに実行させる制御プログラム。
 
A control program for a robot system including a tool that performs a predetermined processing on a workpiece, a robot that moves the tool and the workpiece relatively, and a camera that acquires a first image of a processing mark formed on the workpiece by the processing,
storing a plurality of second images of machining marks when the machining is performed by switching a parameter related to a relative attitude between the workpiece and the tool, in association with the parameter;
A control program that causes a computer to execute a process of estimating the parameter corresponding to the processing mark in the first image by comparing the first image with the second image.
PCT/JP2023/023940 2023-06-28 2023-06-28 Robot system, control device therefor, control method, and control program Pending WO2025004213A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/JP2023/023940 WO2025004213A1 (en) 2023-06-28 2023-06-28 Robot system, control device therefor, control method, and control program
TW113120916A TW202500337A (en) 2023-06-28 2024-06-05 Robot system and its control device, control method and control program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2023/023940 WO2025004213A1 (en) 2023-06-28 2023-06-28 Robot system, control device therefor, control method, and control program

Publications (1)

Publication Number Publication Date
WO2025004213A1 true WO2025004213A1 (en) 2025-01-02

Family

ID=93937819

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2023/023940 Pending WO2025004213A1 (en) 2023-06-28 2023-06-28 Robot system, control device therefor, control method, and control program

Country Status (2)

Country Link
TW (1) TW202500337A (en)
WO (1) WO2025004213A1 (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05318280A (en) * 1992-05-19 1993-12-03 Hitachi Constr Mach Co Ltd Grinding attitude producing device of grinding robot
JP2013126710A (en) * 2011-11-16 2013-06-27 Nissan Motor Co Ltd Method and device for manufacturing joined article
JP2020019071A (en) * 2018-07-30 2020-02-06 ファナック株式会社 Robot system and calibration method

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05318280A (en) * 1992-05-19 1993-12-03 Hitachi Constr Mach Co Ltd Grinding attitude producing device of grinding robot
JP2013126710A (en) * 2011-11-16 2013-06-27 Nissan Motor Co Ltd Method and device for manufacturing joined article
JP2020019071A (en) * 2018-07-30 2020-02-06 ファナック株式会社 Robot system and calibration method

Also Published As

Publication number Publication date
TW202500337A (en) 2025-01-01

Similar Documents

Publication Publication Date Title
KR102166641B1 (en) Self-diagnosis of machine and method for precision calibration of machine
CN100506480C (en) Grinding machine with concentricity correction
US20100228384A1 (en) Method and device for generating transformed control data for controlling a tool on a machine tool
US5126645A (en) Grinder robot
CN107303644B (en) Method and system for measuring position of object on machine tool
JP7718990B2 (en) Compensation of positioning errors in robot-assisted surface machining.
US10328582B2 (en) Process system including robot that transfers workpiece to process machine
JP2014040001A (en) Workpiece processing device and control method for the same
US10377011B2 (en) Eyeglass lens processing apparatus and eyeglass lens processing program
JP2003311585A (en) Method for processing-error compensation in numerically controlled machine tool and grinding machine using that method
JP2011161619A (en) Spectacle lens processing device
JP2019014005A (en) Machine tool and origin correction method
JP5265274B2 (en) Positioning control method and positioning control device for numerically controlled machine tool
JP2009072879A (en) End face grinding method and double-side grinding device
JP2014238782A (en) Control method of machine tool
JP6992188B2 (en) Operation device calibration method, operation device system and control device
WO2025004213A1 (en) Robot system, control device therefor, control method, and control program
JP7088808B2 (en) Tool changer and machine tools
WO2022075303A1 (en) Robot system
JP2017124485A (en) Machine tool and correction method of tool tip position
CN112415948B (en) Surface type machining method based on numerical control machine tool with coordinate detection function
JP5401858B2 (en) Grinding machine and grinding method
JP6404002B2 (en) Curved plate peripheral edge processing method
JPH0760641A (en) Grinding robot and welding bead end point grinding method
JP2019089144A (en) Profiling processor

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 23943611

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2025529076

Country of ref document: JP

Kind code of ref document: A