WO2023218636A1 - ロボット制御装置及び加工システム - Google Patents
ロボット制御装置及び加工システム Download PDFInfo
- Publication number
- WO2023218636A1 WO2023218636A1 PCT/JP2022/020211 JP2022020211W WO2023218636A1 WO 2023218636 A1 WO2023218636 A1 WO 2023218636A1 JP 2022020211 W JP2022020211 W JP 2022020211W WO 2023218636 A1 WO2023218636 A1 WO 2023218636A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- robot
- control device
- workpiece
- fixing mechanism
- unit
- Prior art date
Links
- 238000003754 machining Methods 0.000 title description 4
- 230000007246 mechanism Effects 0.000 claims abstract description 86
- 238000004891 communication Methods 0.000 claims abstract description 19
- 238000000034 method Methods 0.000 claims description 34
- 238000012937 correction Methods 0.000 claims description 19
- 238000004088 simulation Methods 0.000 claims description 18
- 238000012545 processing Methods 0.000 claims description 9
- 230000003993 interaction Effects 0.000 claims description 3
- 238000011017 operating method Methods 0.000 abstract description 3
- 239000000284 extract Substances 0.000 abstract 1
- 210000000078 claw Anatomy 0.000 description 24
- 238000010586 diagram Methods 0.000 description 13
- 230000008569 process Effects 0.000 description 5
- 238000010977 unit operation Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 3
- 238000012840 feeding operation Methods 0.000 description 3
- 238000003825 pressing Methods 0.000 description 3
- 238000003780 insertion Methods 0.000 description 2
- 230000037431 insertion Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
Definitions
- the present invention relates to a robot control device and a processing system.
- robots have been used to supply workpieces to industrial equipment such as machine tools.
- the robot grips the workpiece and supplies the gripped workpiece to a fixing mechanism for the main shaft of the machine tool.
- a fixing mechanism for fixing the workpiece for example, a chuck having about 2 to 4 jaws or a mechanism for sucking the workpiece using air is used (see, for example, Patent Document 1).
- Such a system requires teaching to set a work program that sequentially specifies the operation procedure of the robot and the fixing mechanism, that is, the posture and operating speed of the robot, the operation of the hand that grips the workpiece, the operation of the fixing mechanism, etc.
- a robot control device is a robot control device that controls a robot that supplies and takes out a workpiece to a fixing mechanism of a machine tool, and which sends a signal that instructs or confirms the operating state of the fixing mechanism.
- the communication device includes a communication unit that transmits and receives, a storage unit that stores specifications of the signals that the communication unit transmits and receives, and a teaching unit that sets the signals that the communication unit transmits and receives.
- FIG. 1 is a block diagram showing the configuration of a processing system according to an embodiment of the present disclosure.
- 3 is a diagram illustrating a setting screen for operating procedures in the processing system of FIG. 2.
- FIG. 3 is a diagram illustrating a setting screen for an operation procedure for supplying a workpiece in the processing system of FIG. 2.
- FIG. It is a figure which shows the operation
- FIG. 6 is a diagram showing an operation for correcting a posture error of a workpiece.
- FIG. 6 is a diagram showing an operation for correcting a posture error of a workpiece.
- FIG. 6 is a diagram showing an operation for correcting a posture error of a workpiece.
- FIG. 6 is a diagram showing an operation for correcting a posture error of a workpiece.
- FIG. 6 is a diagram showing an operation for correcting a positional error of a workpiece.
- FIG. 6 is a diagram showing an operation for correcting a positional error of a workpiece.
- FIG. 1 is a block diagram showing the configuration of a processing system 1 according to an embodiment of the present disclosure.
- the processing system 1 of this embodiment includes a machine tool 10, a numerical control device 20, a robot 30, and a robot control device 40.
- a robot 30 supplies and takes out a workpiece W to and from a machine tool 10.
- the machine tool 10 has a fixing mechanism 11 that holds the workpiece W.
- the fixing mechanism 11 of the present embodiment includes a base member 111 that rotates together with the main shaft, and is arranged at equal intervals in the circumferential direction on the end face of the base member 111, and grips the workpiece W by moving (opening and closing) in the radial direction.
- This chuck has three gripping claws 112.
- the fixing mechanism is not limited to the illustrated configuration, and may have a configuration having four or more gripping claws, for example, or may be configured to attract and hold the workpiece W by vacuum force or magnetic force.
- the numerical control device 20 is a well-known control device that controls the machine tool 10.
- the numerical control device 20 outputs a signal indicating the state of the fixing mechanism 11 to the robot controller 40, and operates the fixing mechanism 11 in response to a signal received from the robot controller 40 instructing the opening and closing of the fixing mechanism 11.
- the robot 30 is controlled by a robot control device 40 and supplies and takes out the work W.
- a vertical articulated robot can be used as the robot 30, but other types of robots may also be used.
- the robot 30 of this embodiment includes an arm 31 having a plurality of joints, a gripping mechanism 32 provided at the tip of the arm 31 to grip a workpiece W, and a force acting on the gripping mechanism 32 due to interaction with the workpiece W. It has a force sense value detector 33 that detects the reflected force sense value.
- the gripping mechanism 32 has a plurality of gripping fingers 321 that grip the workpiece W.
- the force value detector 33 can be a sensor that detects, for example, force, bending moment, distortion, etc. acting on the grip fingers 321 or the main body of the grip mechanism 32, and detects the current value and torque of the motor of the drive shaft of the arm 31. etc. may be configured to detect. That is, the force sense value detector 33 may be a part of the arm 31. Further, as the force value detector 33, a 3-axis or 6-axis force sensor such as a strain gauge type, capacitance type, magnetic type, or optical type may be used.
- the robot control device 40 itself is an embodiment of the robot control device according to the present disclosure.
- the robot control device 40 of this embodiment includes a communication section 41 , a storage section 42 , a teaching section 43 , an execution control section 44 , a force value acquisition section 45 , an error correction section 46 , and a simulation section 47 .
- the robot control device 40 can be realized by one or more computer devices having, for example, a memory, a processor, an input/output interface, etc., and executing an appropriate control program.
- Each component of the robot control device 40 is a classification of the functions of the robot control device 40, and does not have to be clearly distinguishable in terms of physical configuration and program configuration.
- a display device 51 such as a display panel and an input device 52 such as a keyboard and a mouse are connected to the robot control device 40 in order to realize a user interface.
- the display device 51 and the input device 52 may be provided integrally with the robot control device 40, or the display device 51 and the input device 52 may be provided integrally, such as a touch panel.
- the communication unit 41 transmits and receives signals that instruct or confirm the operating state of the fixing mechanism 11. Specifically, the communication unit 41 receives a signal from the numerical control device 20 that turns the gripping claws 112 of the fixing mechanism 11 ON in either the closed state or the opened state, and turns OFF in the other state. do. The communication unit 41 also transmits a signal requesting the numerical control device 20 to close or open the gripping claws 112 of the fixing mechanism 11 .
- the specifications of these signals that is, the format of the signals, the addresses of the input/output interfaces used for transmitting and receiving the signals, etc. may differ depending on the type of fixing mechanism 11. For example, depending on the type of fixing mechanism 11, some output an ON signal when the gripping claws 112 are closed, while others output an OFF signal. Further, the signals transmitted and received by the communication unit 41 are not limited to ON/OFF signals, but may be analog signals or signals that transmit information based on ON/OFF changes over time.
- the storage unit 42 stores specifications of signals to be transmitted and received for each type of fixing mechanism 11.
- the type of fixing mechanism 11 can be specified by its model, but can also be specified by a code used by the user to identify the fixing mechanism 11. or may be specified based on a group set based on signal specifications. That is, each of the plurality of fixing mechanisms 11 may be treated as a different type, or a group including a plurality of types of fixing mechanisms 11 may be treated as one type.
- the teaching unit 43 displays the operation procedures of each unit operation, such as the feeding operation of the workpiece W, the operation of taking out the workpiece W, etc., in a space (execution line) set on the display device 51.
- the icons represented in the order in which they should be executed it is possible to automatically set various parameters that specify the operation procedure of the robot 30 that realizes the unit operation represented by each icon, that is, the operation of the robot 30 can be easily taught.
- the teaching unit 43 changes the screen displayed on the display device 51 to the setting of the operation procedure of the unit operation, as necessary. It may be configured to switch to a settings screen that prompts the user to input the minimum necessary information.
- the teaching section 43 When setting the operation procedure for supplying or taking out the workpiece W, the teaching section 43 refers to the storage section 42 and sets signals to be transmitted and received by the communication section 41 according to the type of the fixing mechanism 11. The teaching unit 43 also accepts user input, and sets an operation procedure for supplying or taking out the workpiece W by the fixing mechanism 11 and the robot 30 based on the received input. For this purpose, the teaching unit 43 displays a setting screen that prompts the user to make the minimum necessary input when an icon representing supply or removal of the workpiece W is placed on the execution line.
- FIG. 3 illustrates a setting screen 1000 for setting the feeding operation of the workpiece W, which is displayed on the display device 51 by the teaching section 43.
- the teaching unit 43 is configured to be able to set the operation procedure for the supply operation of the workpiece W on a single setting screen 1000.
- the feeding operation of the workpiece W includes the step of causing the numerical control device 20 to open the gripping claw 112 of the fixing mechanism 11, and the step of moving the robot 30 to the feeding start position, which is set to place the workpiece on the rotation axis of the main shaft of the machine tool 10. a step of positioning the tip; a step of moving the workpiece W in the axial direction of the fixing mechanism 11 by a minimum insertion length or more by the robot 30 and inserting it into the fixing mechanism 11; and a step of closing the.
- the teaching unit 43 automatically sets the mode of the signal to be transmitted and received by the communication unit 41 and the address of the input/output interface according to the type of the fixing mechanism 11 in the process of opening the gripping claw 112 and the process of closing the gripping claw 112. do.
- the teaching unit 43 may be configured to acquire the type of the fixing mechanism 11 from the numerical control device 20, but in order to make it possible to also use the existing numerical control device 20, the teaching section 43 may be configured to acquire the type of the fixing mechanism 11 from the received user input. Preferably, it is configured to identify the type. For this reason, the setting screen 1000 in FIG. 3 displays a pull-down menu 1001 that allows the user to input the fixing mechanism.
- the teaching unit 43 sets the supply start position in advance on the setting screen 1000 in FIG.
- a pull-down menu 1002 is displayed that allows the user to select from among a plurality of preset values, specifically, a preset coordinate number.
- the setting screen 1000 displayed by the teaching unit 43 includes a button 1003 that pops up a window for modifying the preset value (coordinates) of the supply start position.
- a window that pops up when the button 1003 is operated has multiple text boxes each displaying editable numerical values (X, Y, Z, W, P, R) that specify the position and orientation of the tip reference point of the robot 30. may be included.
- the teaching unit 43 displays a text box 1004 on the setting screen 1000 that allows the user to input the minimum insertion length in the process of inserting the workpiece W into the fixing mechanism 11.
- the teaching unit 43 also includes a test execution button 1005 that starts a process in which the execution control unit 44 executes the operation procedure and the error correction unit 46 optimizes the operation procedure based on the force sense value, and a test execution button 1005 as shown in FIG.
- a button 1006 for pop-up displaying a window for adjusting parameters such as speed and determination threshold when optimizing the operation procedure based on the force sense value is displayed on the setting screen 1000.
- the execution control unit 44 causes the fixing mechanism 11 and the robot 30 to execute the operation procedure according to the procedure taught by the teaching unit 43. Further, it is preferable that the execution control unit 44 is configured to be able to operate the fixing mechanism 11 and the robot 30 by immediately reflecting the operation procedure corrected by the error correction unit 46.
- the force value acquisition unit 45 acquires a force value that reflects the force generated by the interaction between the workpiece W and the robot 30 from the force value detector 33 during execution of the operation procedure. That is, the force sense value acquisition unit 45 acquires the magnitude and direction of the force of the workpiece W pushing back the gripping mechanism 32 of the robot 30 when the workpiece W comes into contact with the fixing mechanism 11 .
- the error correction unit 46 corrects errors in the position and posture of the robot in the operation procedure based on the force sense value acquired by the force sense value acquisition unit, and optimizes the operation procedure. Details of error correction in the error correction section 46 will be explained below.
- FIGS. 4A and 4B are diagrams illustrating the operation of supplying and fixing the work W according to the present embodiment to the fixing mechanism 11.
- the robot 30 supplies the workpiece W to the fixing mechanism 11, it operates along the direction L in which the workpiece W is supplied to the fixing mechanism 11. Then, when the robot 30 supplies the cylindrical workpiece W near the center of the gripping claws 112 and the machine tool 10 closes the gripping claws 112, the workpiece W is fixed at the center of the base member 111.
- the machine tool 10 can obtain good machining accuracy.
- the error correction unit 46 executes a process (force value control) for correcting the error in the position and posture of the workpiece W and the fixing mechanism 11, as described below.
- FIGS. 5A, 5B, and 5C are diagrams showing the operation of correcting the posture error of the workpiece W.
- the robot control device 40 controls the robot 30 and positions the workpiece W on the base member 111.
- the workpiece W has an attitude error with respect to the base member 111.
- the error correction unit 46 of the robot control device 40 executes force sense value control that corrects the parameters of the operation procedure based on the force sense values.
- the error correction unit 46 controls the robot 30 to press the workpiece W against any one of the gripping claws 112 while the force value control is being executed. That is, the error correction unit 46 uses the robot 30 to press the workpiece W against the fixing mechanism 11 in a direction substantially perpendicular to the direction in which the workpiece W is supplied to the fixing mechanism 11 while performing force value control.
- FIG. 5B is a diagram showing an operation for correcting the posture of the workpiece W when the workpiece W is pressed against the gripping claws 112.
- a moment M1 is generated around the center (rotation center C) of the contact surface between the workpiece W and the gripping claws 112.
- the reaction force against the force that presses the workpiece W against the gripping claws 112 is force F
- the distance from the rotation center C of the workpiece W to the position where force F acts is distance r2
- the error correction unit 46 executes force value control so that the moment pressing the workpiece W against the fixing mechanism 11 becomes zero. That is, when the force value detector 33 detects the moment M1, the error correction unit 46 causes the robot 30 to rotate the workpiece W around the rotation center C, and corrects the posture of the workpiece W. As a result, as shown in FIG. 5C, the workpiece W rotates in a direction in which the moment M1 becomes smaller, and the error in the posture of the workpiece W is corrected.
- FIGS. 6A and 6B are diagrams showing the operation of correcting the position error of the workpiece W.
- the robot control device 40 controls the robot 30 and positions the workpiece W on the end surface of the base member 111.
- the workpiece W has a positional error relative to the base member 111.
- the error correction unit 46 executes force sense value control.
- the error correction unit 46 transmits a control signal to the numerical control device 20 using the communication unit 41 while the force value control is being executed, and controls the operation of closing the gripping claws 112 of the fixing mechanism 11 from the machine tool. 10 to execute. That is, the numerical control device 20 operates the fixing mechanism 11 in conjunction with the force sense value control by the robot 30 and the robot control device 40.
- the workpiece W is subjected to a force F1 by the gripping claws 112 in a direction substantially perpendicular to the direction in which the workpiece W is supplied to the fixing mechanism 11, as shown in FIG. 6B. Then, when the force sense value detector 33 detects the force F1, the error correction unit 46 moves the workpiece W in a direction in which the force F1 becomes smaller by the action of force sense value control, and corrects the position of the workpiece W. .
- the force sense value control described above includes, for example, impedance control, damping control, etc., but is not limited to these.
- the machine tool 10 may repeat the operation of the fixing mechanism 11 a preset number of times.
- the error correction unit 46 causes the fixing mechanism 11 to repeatedly open and close the gripping claws 112 a predetermined number of times while performing force value control. Thereby, errors in the position and posture of the workpiece W are corrected each time the gripping claws 112 are opened and closed.
- the fixing mechanism 11 is a suction mechanism
- the machine tool 10 repeats suction and release of the workpiece W a predetermined number of times while executing force value control. Thereby, errors in the position and posture of the workpiece W are corrected each time the workpiece is sucked and released.
- the robot 30 or the machine tool 10 is equipped with a movement amount detector that detects the movement amount of the workpiece W, and the error correction unit 46 detects that the movement amount of the workpiece W is a predetermined distance or Force value control may be repeated until the angle becomes less than or equal to a predetermined angle.
- the machine tool 10 releases the workpiece W by the fixing mechanism 11, and then operates the fixing mechanism 11 again.
- the workpiece W may be fixed by. That is, when the fixing mechanism 11 operates, the machine tool 10 interrupts the operation of the fixing mechanism 11 if the detected value of the force value detector 33 is equal to or higher than a predetermined value indicating excessive force or moment, After the work W is released by the fixing mechanism 11, the fixing mechanism 11 may be operated again to fix the work W by the fixing mechanism 11.
- the simulation unit 47 executes a simulation of the operation procedure and displays the simulation results. It is preferable that the simulation unit 47 displays the calculated force sense value together with the simulation result. For example, in addition to the force sense value, the simulation unit 47 is configured to be able to display parameters such as speed and contact threshold during the simulation together with the simulation result. Good too. It is preferable that the simulation results by the simulation unit 47 be displayed as part of the setting screen 1000. In other words, it is preferable to ensure a space that can be used for displaying simulation results by the teaching section 43.
- the simulation unit 47 may be configured to display, for example, by highlighting, in a way that allows identification of abnormal values among the displayed parameters when a problem occurs during the simulation. This allows the user to easily understand parameters that may cause problems.
- the robot control device may be configured to be able to similarly set the operation procedure related to taking out a workpiece.
- processing system 10 machine tool 11 fixing mechanism 111 base member 112 gripping claw 20 numerical control device 30 robot 31 arm 32 gripping mechanism 321 gripping finger 33 force value detector 40 robot control device 41 communication unit 42 storage unit 43 teaching unit 44 execution Control section 45 Force value acquisition section 46 Error correction section 47 Simulation section W Work
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
ロボットにより固定機構にワークを供給する動作手順の教示を容易に行うことができるロボット制御装置は、工作機械の固定機構へのワークの供給及び取り出しを行うロボットを制御するロボット制御装置であって、前記固定機構の動作状態を指示又は確認する信号を送受信する通信部と、前記通信部が送受信する前記信号の仕様を記憶する記憶部と、前記通信部が送受信する前記信号を設定する教示部と、を備える。
Description
本発明は、ロボット制御装置及び加工システムに関する。
従来、ワークを工作機械等の産業機器へ供給するために、ロボットが用いられている。この場合、ロボットは、ワークを把持し、把持したワークを工作機械の主軸の固定機構へ供給する。ワークを固定する固定機構は、例えば、2~4本程度の爪を有するチャック又は空気によってワークを吸着する機構等が用いられている(例えば、特許文献1参照)。係るシステムでは、ロボット及び固定機構の動作手順、つまりロボットの姿勢及び動作速度、ワークを把持するハンドの動作、固定機構の動作等を逐次的に特定する作業プログラムを設定する教示が必要になる。
工作機械で十分な加工精度を得るために、ワークの中心位置と各爪とがなす中心位置は一致し、かつワークの方向は爪の方向に対して平行になるようワークを供給する必要がある。このような動作をロボットによって実現するためには、ワークの中心位置及び姿勢を固定機構と合わせる教示作業が必要である。正確に教示するためには熟練者でも多くの時間と労力が必要となり、ロボットに慣れていない作業者には非常に困難な作業となる。
このため、ロボットにより固定機構にワークを供給する動作手順の教示を容易に行うことができる技術が望まれる。
本開示の一態様に係るロボット制御装置は、工作機械の固定機構へのワークの供給及び取り出しを行うロボットを制御するロボット制御装置であって、前記固定機構の動作状態を指示又は確認する信号を送受信する通信部と、前記通信部が送受信する前記信号の仕様を記憶する記憶部と、前記通信部が送受信する前記信号を設定する教示部と、を備える。
本発明によれば、ロボットにより固定機構にワークを供給する動作手順の教示を容易に行うことができる。
以下、本開示の実施形態について、図面を参照しながら説明する。図1は、本開示の一実施形態に係る加工システム1の構成を示すブロック図である。本実施形態の加工システム1は、工作機械10と、数値制御装置20と、ロボット30と、ロボット制御装置40と、を備える。加工システム1は、ロボット30により工作機械10に対するワークWの供給及び取り出しを行う。
工作機械10は、ワークWを保持する固定機構11を有する。本実施形態の固定機構11は、主軸と共に回転するベース部材111と、ベース部材111の端面に、周方向に等間隔に配設され、径方向に移動(開閉)することによりワークWを把持する3つの把持爪112を有するチャックである。なお、固定機構は図示する構成に限られず、例えば4つ以上の把持爪を有する構成とされてもよく、真空力又は磁力によりワークWを吸着保持するよう構成されてもよい。
数値制御装置20は、工作機械10を制御する周知の制御装置である。数値制御装置20は、固定機構11の状態を示す信号をロボット制御装置40に対して出力すると共に、ロボット制御装置40から受信する固定機構11の開閉を指示する信号に応じて固定機構11を動作させる。
ロボット30は、ロボット制御装置40によって制御され、ワークWの供給及び取り出しを行う。ロボット30としては、典型的には垂直多関節ロボットを用いることができるが、他の形式のロボットを用いてもよい。本実施形態のロボット30は、複数の関節を有するアーム31と、アーム31の先端に設けられ、ワークWを把持する把持機構32と、ワークWとの相互作用により把持機構32に作用する力を反映する力覚値を検出する力覚値検出器33と、を有する。
把持機構32は、ワークWを把持する複数の把持指321を有する。力覚値検出器33は、例えば把持指321又は把持機構32の本体に作用する力、曲げモーメント、歪み等を検出するセンサとすることができ、アーム31の駆動軸のモータの電流値、トルク等を検出するよう構成されてもよい。つまり、力覚値検出器33は、アーム31の一部であってもよい。さらに力覚値検出器33として、歪みゲージ式、静電容量式、磁気式、光学式などの3軸または6軸の力覚センサを使用してもよい。
ロボット制御装置40は、それ自体が本開示に係るロボット制御装置の一実施形態である。本実施形態のロボット制御装置40は、通信部41、記憶部42、教示部43、実行制御部44、力覚値取得部45、誤差修正部46及びシミュレーション部47を備える。ロボット制御装置40は、例えばメモリ、プロセッサ、入出力インターフェイス等を有し、適切な制御プログラムを実行する1又は複数のコンピュータ装置によって実現できる。ロボット制御装置40の各構成要素は、ロボット制御装置40の機能を類別したものであって、物理構成及びプログラム構成において明確に区分できるものでなくてもよい。また、ロボット制御装置40には、ユーザインターフェイスを実現するために、例えばディスプレイパネル等の表示装置51及び例えばキーボード、マウス等の入力装置52が接続される。表示装置51及び入力装置52は、ロボット制御装置40と一体に設けられてもよい、また、表示装置51及び入力装置52は、例えばタッチパネル等の一体に設けられるものであってもよい。
通信部41は、固定機構11の動作状態を指示又は確認する信号を送受信する。具体的には、通信部41は、数値制御装置20から、固定機構11の把持爪112を閉じた状態と把持爪112を開いた状態のいずれか一方でONとなり他方でOFFとなる信号を受信する。また、通信部41は、数値制御装置20に対して、固定機構11の把持爪112を閉じること又は開くことを要求する信号を送信する。これらの信号の仕様、つまり信号の態様及びその信号の送受信に用いられる入出力インターフェイスのアドレス等は、固定機構11の種類によって異なり得る。例として、固定機構11の種類によって、把持爪112が閉じられているときにONを出力するものと、OFFを出力するものとがある。また、通信部41が送受信する信号は、ON/OFF信号に限られず、アナログ信号やON/OFFの経時変化により情報を伝達する信号であってもよい。
記憶部42は、固定機構11の種類ごとに送受信する信号の仕様を記憶する、固定機構11の種類は、その型式によって特定され得るが、ユーザが固定機構11識別するために用いる符号等によって特定されてもよく、信号の仕様に基づいて設定されるグループに基づいて特定されてもよい。つまり、複数の固定機構11を個体ごとに別の種類として扱ってもよく、複数の型式の固定機構11を含むグループを1つの種類として取り扱ってもよい。
教示部43は、例として、図2に示すように、表示装置51に設定されるスペース(実行ライン)に、ワークWの供給動作、ワークWの取り出し動作等のそれぞれが単位動作の動作手順を表すアイコンを実行すべき順番に並べて配置することで、各アイコンが表す単位動作を実現するロボット30の動作手順を特定する各種のパラメータを自動的に設定できる、つまりロボット30の動作を簡単に教示できるユーザインターフェイスを提供するよう構成され得る。動作手順を特定するパラメータとしては、ロボット30の基準点の座標、各駆動軸の位置、速度(特に固定機構11に近付く速度)、把持指321の状態等が挙げられる。さらに、教示部43は、必要に応じて、単位動作を表すアイコン配置したとき又は単位動作を表すアイコンを選択したときに、表示装置51に表示する画面を、その単位動作の動作手順の設定に必要な最低限の情報をユーザに入力させる設定画面に切り替えるよう構成され得る。
教示部43は、ワークWの供給又は取り出しの動作手順を設定する際に、記憶部42を参照し、固定機構11の種類に応じて通信部41により送受信する信号を設定する。また、教示部43は、ユーザの入力を受付け、受付けた前記入力に基づいて固定機構11及びロボット30によるワークWの供給又は取り出しの動作手順を設定する。このために、教示部43は、ワークWの供給又は取り出しを表すアイコンを実行ライン上に配置された場合、ユーザに必要最小限の入力を促す設定画面を表示する。図3に、教示部43が表示装置51に表示するワークWの供給動作の設定を行うための設定画面1000を例示する。教示部43は、ワークWの供給動作の動作手順を単一の設定画面1000において設定可能に構成される。
ワークWの供給動作は、数値制御装置20に固定機構11の把持爪112を開かせる工程と、ワークを工作機械10の主軸の回転軸上に配置するよう設定される供給開始位置にロボット30の先端部を位置決めする工程と、ロボット30によりワークWを固定機構11の軸方向に最低挿入長さ以上移動させて固定機構11に挿入する工程と、数値制御装置20に固定機構11の把持爪112を閉じさせる工程と、を含む。
教示部43は、把持爪112を開かせる工程及び把持爪112を閉じさせる工程において、固定機構11の種類に応じて通信部41により送受信する信号の態様及び入出力インターフェイスのアドレスを自動的に設定する。教示部43は、固定機構11の種類を数値制御装置20から取得するよう構成されてもよいが、既存の数値制御装置20も利用可能とするために、受付けたユーザの入力により固定機構11の種類を特定するよう構成されることが好ましい。このため、図3の設定画面1000には、ユーザに固定機構を入力させるプルダウンメニュー1001が表示されている。
教示部43は、供給開始位置にロボット30を位置決めする工程の教示、つまり実行制御部44が必要とする動作パラメータの設定を行うために、図3の設定画面1000に、供給開始位置を予め設定される複数のプリセット値の中から選択、具体的には予め設定された座標の番号をユーザに選択させるプルダウンメニュー1002を表示する。また、教示部43が表示する設定画面1000は、供給開始位置のプリセット値(座標)を修正するためのウィンドウをポップアップ表示させるボタン1003を含む。ボタン1003の操作によりポップアップするウィンドウには、ロボット30の先端基準点の位置及び向きを特定する(X,Y,Z,W,P,R)の数値を編集可能にそれぞれ表示する複数のテキストボックスが含まれ得る。
教示部43は、設定画面1000に、ワークWを固定機構11に挿入する工程における最低挿入長さをユーザに入力させるテキストボックス1004を表示する。
また、教示部43は、実行制御部44により動作手順を実行し、誤差修正部46により力覚値に基づいて動作手順を最適化するプロセスを開始するテスト実行ボタン1005と、図3に示すように、力覚値に基づく動作手順の最適化を行う際の例えば速度、判定閾値等のパラメータを調整するためのウィンドウをポップアップ表示させるためのボタン1006と、を設定画面1000に表示する。
実行制御部44は、教示部43において教示された手順に従って、固定機構11及びロボット30に動作手順を実行させる。また、実行制御部44は、誤差修正部46が修正する動作手順を即座に反映させて固定機構11及びロボット30を動作させ得るよう構成されることが好ましい。
力覚値取得部45は、動作手順の実行の際に、力覚値検出器33から、ワークWとロボット30の相互作用により生じる力を反映する力覚値を取得する。つまり、力覚値取得部45は、ワークWが固定機構11に当接することで、ワークWがロボット30の把持機構32を押し返す力の大きさ及び向きを取得する。
誤差修正部46は、力覚値取得部が取得した力覚値に基づいて、動作手順におけるロボットの位置及び姿勢の誤差を修正し、動作手順を最適化する。以下に、誤差修正部46における誤差修正の詳細を説明する。
図4A及び図4Bは、本実施形態に係るワークWを固定機構11に供給して固定する際の動作を示す図である。ロボット30は、ワークWを固定機構11に供給する際に、ワークWを固定機構11に供給する方向Lに沿って動作する。そして、ロボット30により円柱形状のワークWを把持爪112の中心位置付近に供給し、工作機械10により把持爪112を閉じると、ワークWは、ベース部材111の中心位置に固定される。
固定機構11のベース部材111に対してワークWを正しい位置及び姿勢で供給できれば、把持爪112を閉じたときに、図4Aに示すようにベース部材111とワークWの中心軸とは一致する。この場合、工作機械10は、良好な加工精度を得ることができる。
しかし、ワークWを供給する際に、ベース部材111に対してワークWの位置及び姿勢の誤差が大きい場合、把持爪112を閉じたときに、図4Bに示すようにベース部材111とワークWの中心軸がずれた状態で固定される場合がある。この場合、工作機械10は、良好な加工精度を得ることはできない。
そこで、誤差修正部46は、以下に説明するようにワークWと固定機構11の位置及び姿勢の誤差を修正する処理(力覚値制御)を実行する。
図5A、図5B及び図5Cは、ワークWの姿勢誤差を修正する動作を示す図である。図5Aに示すように、ロボット制御装置40は、ロボット30を制御し、ワークWをベース部材111に位置決めする。ここで、図5Aに示す例では、ワークWは、ベース部材111に対して姿勢の誤差を生じている。その後、ロボット制御装置40の誤差修正部46は、力覚値に基づいて動作手順のパラメータを修正する力覚値制御を実行する。
具体的には、誤差修正部46は、力覚値制御を実行中において、ロボット30を制御して、ワークWを把持爪112のいずれか1つに押し付ける。すなわち、誤差修正部46は、力覚値制御を実行中において、ワークWを固定機構11に供給する方向とは略直交する方向に対して、ロボット30によってワークWを固定機構11に押し付ける。
図5Bは、ワークWを把持爪112に押し付けた場合におけるワークWの姿勢を修正する動作を示す図である。図5Bに示すように、ロボット30が、ワークWを把持爪112に押し付けると、ワークWと把持爪112との接触面の中央(回転中心C)の周りにモーメントM1が発生する。ここで、ワークWを把持爪112に押し付けた力に対する反力を力Fとし、ワークWの回転中心Cから、力Fが作用する位置までの距離を距離r2とすると、モーメントM1は、[M1=r2×F]と表される。
力覚値検出器33が、モーメントM1を検出すると、誤差修正部46は、ワークWを固定機構11に押し付けるモーメントが0となるように力覚値制御を実行する。すなわち、力覚値検出器33が、モーメントM1を検出すると、誤差修正部46は、ロボット30により、回転中心Cを中心としてワークWを回転させ、ワークWの姿勢を修正する。これにより、図5Cに示すように、ワークWは、モーメントM1が小さくなる方向へ回転し、ワークWの姿勢の誤差が修正される。
図6A及び図6Bは、ワークWの位置誤差を修正する動作を示す図である。図6Aに示すように、ロボット制御装置40は、ロボット30を制御し、ワークWをベース部材111の端面に位置決めする。ここで、図6Aに示す例では、ワークWは、ベース部材111に対して位置の誤差を生じている。その後、誤差修正部46は、力覚値制御を実行する。
具体的には、誤差修正部46は、力覚値制御を実行中において、通信部41を用いて数値制御装置20へ制御信号を送信し、固定機構11の把持爪112を閉じる動作を工作機械10に実行させる。すなわち、数値制御装置20は、ロボット30及びロボット制御装置40による力覚値制御に連動して、固定機構11を作動する。
把持爪112が閉じられると、図6Bに示すように、ワークWは、把持爪112によって、ワークWを固定機構11に供給する方向とは略直交する方向に力F1を受ける。そして、力覚値検出器33が、力F1を検出すると、誤差修正部46は、力覚値制御の作用により、力F1が小さくなる方向へワークWを移動させ、ワークWの位置を修正する。
このように力覚値制御中に、把持爪112を閉じると、ワークWに位置の誤差が生じている場合、ワークWは、力覚値制御の作用により、位置の誤差を無くす方向に移動する。なお、上述した力覚値制御は、例えば、インピーダンス制御、ダンピング制御等が用いられるが、これらに限定されない。
また、工作機械10は、固定機構11の作動を、予め設定した回数繰り返してもよい。誤差修正部46は、力覚値制御を実行中に、固定機構11に把持爪112の開閉を所定回数繰り返させる。これにより、把持爪112の開閉の度に、ワークWの位置及び姿勢の誤差が修正される。なお、固定機構11が吸着機構である場合、工作機械10は、力覚値制御を実行中に、ワークWの吸着及び解放を所定回数繰り返させる。これにより、吸着及び解放の度に、ワークWの位置及び姿勢の誤差が修正される。
また、ロボット30又は工作機械10は、ワークWの移動量を検出する移動量検出器を備え、誤差修正部46は、固定機構11が作動する際に、ワークWの移動量が所定の距離又は所定の角度以下となるまで力覚値制御を繰り返してもよい。
さらに、固定機構11を作動している間に過大な力又はモーメントが発生した場合、工作機械10は、固定機構11によりワークWを解放してから、再度固定機構11を作動し、固定機構11によりワークWを固定してもよい。すなわち、工作機械10は、固定機構11が作動する際に、力覚値検出器33の検出値が、過大な力又はモーメントを示す所定値以上である場合、固定機構11の作動を中断し、固定機構11によりワークWを解放してから、再度固定機構11を作動し、固定機構11によりワークWを固定してもよい。
また、固定機構11にワークWを押し付けた後に固定機構11を閉じる動作を行う方法を説明したが、固定機構11を閉じた後にワークWを押し付ける動作を行ってもよい。
シミュレーション部47は、動作手順のシミュレーションを実行し、シミュレーションの結果を表示する。シミュレーション部47は、計算上の力覚値をシミュレーションの結果と共に表示することが好ましく、例えば力覚値の他、シミュレーション中の速度、接触閾値等のパラメータもシミュレーションの結果と共に表示可能に構成されてもよい。シミュレーション部47によるシミュレーション結果の表示は、設定画面1000の一部として行うことが好ましい。つまり、教示部43によるシミュレーション結果の表示に用いることができるスペースを確保するよう構成されることが好ましい。シミュレーション部47は、シミュレーション中に問題が発生する場合に、表示されたパラメータの中で異常な値になったものを識別可能に、例えばハイライト等により表示するよう構成されてもよい。これにより、問題が発生する原因となり得るパラメータをユーザが容易に把握できる。
以上、本開示の実施形態について説明したが、本発明は前述した実施形態に限るものではない。また、前述した実施形態に記載された効果は、本発明から生じる好適な効果を列挙したに過ぎず、本発明による効果は、前述した実施形態に記載されたものに限定されるものではない。
例として、本発明に係るロボット制御装置は、ワークの取り出しに係る動作手順についても同様に設定可能に構成され得る。
1 加工システム
10 工作機械
11 固定機構
111 ベース部材
112 把持爪
20 数値制御装置
30 ロボット
31 アーム
32 把持機構
321 把持指
33 力覚値検出器
40 ロボット制御装置
41 通信部
42 記憶部
43 教示部
44 実行制御部
45 力覚値取得部
46 誤差修正部
47 シミュレーション部
W ワーク
10 工作機械
11 固定機構
111 ベース部材
112 把持爪
20 数値制御装置
30 ロボット
31 アーム
32 把持機構
321 把持指
33 力覚値検出器
40 ロボット制御装置
41 通信部
42 記憶部
43 教示部
44 実行制御部
45 力覚値取得部
46 誤差修正部
47 シミュレーション部
W ワーク
Claims (9)
- 工作機械の固定機構へのワークの供給及び取り出しを行うロボットを制御するロボット制御装置であって、
前記固定機構の動作状態を指示又は確認する信号を送受信する通信部と、
前記通信部が送受信する前記信号の仕様を記憶する記憶部と、
前記通信部が送受信する前記信号を設定する教示部と、
を備える、ロボット制御装置。 - 前記教示部は、ユーザの入力を受付け、受付けた前記入力に基づいて前記固定機構及び前記ロボットによる前記ワークの供給又は取り出しの動作手順を設定する、請求項1に記載のロボット制御装置。
- 前記固定機構及び前記ロボットに前記動作手順を実行させる実行制御部と、
前記動作手順の実行の際に、前記ワークと前記ロボットの相互作用により生じる力を反映する力覚値を取得する力覚値取得部と、
前記力覚値取得部が取得した前記力覚値に基づいて、前記動作手順における前記ロボットの位置及び姿勢の誤差を修正する誤差修正部と、
を備える、請求項2に記載のロボット制御装置。 - 前記教示部は、受付けた前記入力により前記固定機構の種類を特定する、請求項3に記載のロボット制御装置。
- 前記実行制御部は、前記固定機構の種類に基づいてパラメータを設定する、請求項4に記載のロボット制御装置。
- 前記動作手順のシミュレーションを実行し、前記シミュレーションの結果を表示するシミュレーション部をさらに備える、請求項2から5のいずれかに記載のロボット制御装置。
- 前記教示部は、前記動作手順を単一の設定画面において設定可能に構成される、請求項2から6のいずれかに記載のロボット制御装置。
- 前記教示部は、前記ロボットの動作パラメータを予め設定されるプリセット値に設定するよう構成され、前記設定画面は、前記プリセット値を修正するためのウィンドウをポップアップ表示させるボタンを含む、請求項7に記載のロボット制御装置。
- 請求項1から8のいずれかに記載のロボット制御装置と、前記固定機構を有する工作機械と、前記ロボット制御装置に制御され、前記固定機構へのワークの供給及び取り出しを行うロボットと、を備える、加工システム。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2022/020211 WO2023218636A1 (ja) | 2022-05-13 | 2022-05-13 | ロボット制御装置及び加工システム |
TW112115364A TW202344358A (zh) | 2022-05-13 | 2023-04-25 | 機器人控制裝置及加工系統 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2022/020211 WO2023218636A1 (ja) | 2022-05-13 | 2022-05-13 | ロボット制御装置及び加工システム |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2023218636A1 true WO2023218636A1 (ja) | 2023-11-16 |
Family
ID=88730180
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2022/020211 WO2023218636A1 (ja) | 2022-05-13 | 2022-05-13 | ロボット制御装置及び加工システム |
Country Status (2)
Country | Link |
---|---|
TW (1) | TW202344358A (ja) |
WO (1) | WO2023218636A1 (ja) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10207519A (ja) * | 1997-01-27 | 1998-08-07 | Fanuc Ltd | ロボットの制御方式 |
JP2010191602A (ja) * | 2009-02-17 | 2010-09-02 | Fanuc Ltd | 工作機械と組み合わせて使用するロボットの制御装置 |
JP2017116993A (ja) * | 2015-12-21 | 2017-06-29 | ファナック株式会社 | セルコントロールシステムにおける製造セルの状態変化管理システム |
-
2022
- 2022-05-13 WO PCT/JP2022/020211 patent/WO2023218636A1/ja unknown
-
2023
- 2023-04-25 TW TW112115364A patent/TW202344358A/zh unknown
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10207519A (ja) * | 1997-01-27 | 1998-08-07 | Fanuc Ltd | ロボットの制御方式 |
JP2010191602A (ja) * | 2009-02-17 | 2010-09-02 | Fanuc Ltd | 工作機械と組み合わせて使用するロボットの制御装置 |
JP2017116993A (ja) * | 2015-12-21 | 2017-06-29 | ファナック株式会社 | セルコントロールシステムにおける製造セルの状態変化管理システム |
Also Published As
Publication number | Publication date |
---|---|
TW202344358A (zh) | 2023-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11090814B2 (en) | Robot control method | |
JP5545534B2 (ja) | ロボットの教示再生装置、教示再生方法、及び教示データ作成方法 | |
CN106493711B (zh) | 控制装置、机器人以及机器人*** | |
US20180029232A1 (en) | Control apparatus and robot | |
WO2018147411A1 (ja) | ロボットシステム及びその制御方法 | |
TW201710043A (zh) | 遠端操作機器人系統及其運轉方法 | |
JP2010089257A (ja) | 産業用ロボットのティーチングのための方法及びそれに対応して装備された産業用ロボット | |
WO2013190648A1 (ja) | ロボットシステムおよび部品の製造方法 | |
JP2014176940A (ja) | ロボットシステム、ロボット制御方法及び被加工物の製造方法 | |
WO2018212239A1 (ja) | 遠隔操作ロボットシステム | |
US20220410385A1 (en) | Program Creation Apparatus, And Storage Medium | |
JP2017030059A (ja) | ロボット制御装置、ロボットおよびロボットシステム | |
CN114905487A (zh) | 示教装置、示教方法以及记录介质 | |
JP2012125852A (ja) | 組立ロボットとその制御方法 | |
WO2023218636A1 (ja) | ロボット制御装置及び加工システム | |
US11389954B2 (en) | Robot control device | |
WO2020032263A1 (ja) | ロボットシステム | |
EP4067012A1 (en) | Method for controlling robot, robot system, and program for controlling robot | |
JP5360155B2 (ja) | ロボットシステム | |
JP7173798B2 (ja) | 動作プログラムの変数を監視するロボットの制御装置 | |
US20230286142A1 (en) | Robot teaching control method, robot teaching apparatus, and robot system | |
CN114179076B (zh) | 作业时间提示方法、力控制参数设定方法、机器人***以及存储介质 | |
WO2022210186A1 (ja) | ロボットの位置および姿勢を制御するパラメータを算出する制御装置 | |
US11400584B2 (en) | Teaching method | |
US20220080587A1 (en) | Method Of Adjusting Force Control Parameter, Robot System, And Force Control Parameter Adjustment Program |
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: 22941713 Country of ref document: EP Kind code of ref document: A1 |