WO2023162084A1 - ロボット制御装置およびロボットシステム - Google Patents
ロボット制御装置およびロボットシステム Download PDFInfo
- Publication number
- WO2023162084A1 WO2023162084A1 PCT/JP2022/007585 JP2022007585W WO2023162084A1 WO 2023162084 A1 WO2023162084 A1 WO 2023162084A1 JP 2022007585 W JP2022007585 W JP 2022007585W WO 2023162084 A1 WO2023162084 A1 WO 2023162084A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- robot
- sensor
- state
- welding
- force
- Prior art date
Links
- 210000000707 wrist Anatomy 0.000 claims abstract description 10
- 238000003466 welding Methods 0.000 description 105
- 238000003860 storage Methods 0.000 description 9
- 230000007935 neutral effect Effects 0.000 description 8
- 238000001514 detection method Methods 0.000 description 5
- 210000003813 thumb Anatomy 0.000 description 4
- 230000005484 gravity Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 239000002184 metal Substances 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 238000003825 pressing Methods 0.000 description 2
- 238000007789 sealing Methods 0.000 description 2
- 210000003811 finger Anatomy 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 230000000149 penetrating effect Effects 0.000 description 1
- 230000001012 protector 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
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
Definitions
- the present disclosure relates to a robot control device and a robot system.
- Patent Document 1 there has been known a technique in which a detection device for detecting a weld line is detachable from a tool such as a welding torch to expand the detection range of the detection device and eliminate interference with other members
- a robot capable of operating by so-called lead-through control, which incorporates a sensor that detects force applied by a worker and changes the position and posture of the robot according to the magnitude and direction of the force detected by the sensor. (See Patent Document 2, for example).
- the detection device for detecting the welding line is mounted so as to protrude greatly from the wrist of the robot or a tool such as a welding torch. It is removed when teaching an unnecessary area or before starting execution after completion of teaching.
- the teaching of the robot is performed by operating it by lead-through control, the load acting on the robot fluctuates depending on the presence or absence of the detection device. Therefore, even if the load acting on the robot varies due to attachment and detachment of the device, it is desired that the robot can be properly operated by the lead-through control.
- a robot control device capable of controlling the robot by lead-through control that changes the attitude of the robot according to the magnitude and direction of force detected by a force sensor provided in the robot, a first state in which an additional device is attached and a second state in which the additional device is not attached; It is a robot control device that switches load settings.
- FIG. 1 is an overall configuration diagram showing a robot system according to an embodiment of the present disclosure
- FIG. FIG. 2 is a front view showing a robot provided in the robot system of FIG. 1
- 2 is a partial perspective view showing the welding torch, torch bracket, handle and tool bracket attached to the wrist tip of the robot of the robotic system of FIG. 1
- FIG. 2 is a block diagram showing the robot system of FIG. 1;
- a robot control device 3 and a robot system 1 will be described below with reference to the drawings.
- a robot system 1 according to this embodiment includes a robot 2 having a force sensor 10 and a robot controller 3 for controlling the robot 2, as shown in FIG.
- a flange 5 rotatable around the rotation axis X at the tip, and a tool bracket 6 is fixed to the flange 5 .
- a torch bracket 7 for supporting a long tool such as a welding torch 100 is fixed to the tool bracket 6, and the torch bracket 7 is provided with two handles 8 and 9 to be gripped by an operator.
- the torch bracket 7 includes a bracket body 11 fixed to the tool bracket 6, and a fixed block 12 to which the welding torch 100 is fixed to the bracket body 11 and handles 8 and 9 are fixed.
- the welding torch 100 includes a tubular torch body 110 curved in one direction, a substantially cylindrical neck holder 120 connected to the base end of the torch body 110, and a guide tube 130 connected to the base end of the neck holder 120. It has
- the guide tube 130, the neck holder 120 and the torch body 110 have inner holes (not shown) through which the welding wire 140 extends in the longitudinal direction.
- Welding torch 100 welds a workpiece by projecting welding wire 140 penetrating through the inner hole from the tip of torch body 110 and generating an arc between it and the workpiece.
- the welding torch 100 Since the welding torch 100 has an elongated shape as described above, the welding torch 100 cannot pass through the inside of the wrist 4, and is supported by the torch bracket 7 at a position eccentric to the rotation axis X of the flange 5. be. Then, the torch body 110 is curved along a plane (hereinafter referred to as a tool plane) P including the rotation axis X of the flange 5 from the position fixed to the torch bracket 7 , and the welding wire 140 is bent along the rotation axis X of the flange 5 . It is arranged in a form that protrudes to a position where it intersects with. The intersection of the rotational axis X of the flange 5 and the welding wire 140 is generally set as the tool tip point.
- a tool plane a plane
- the intersection of the rotational axis X of the flange 5 and the welding wire 140 is generally set as the tool tip point.
- the handles 8, 9 are arranged in a position proximate to the longitudinal axis Y of the first handle 8 and the welding torch 100 arranged along the tool plane P and the second handle 9 arranged extending in a direction perpendicular to the tool plane P.
- the first handle 8 is a straight rod-shaped member that can be gripped by the operator's right hand.
- the first handle 8 is arranged parallel to the longitudinal axis Y of the welding torch 100 with a gap between it and the welding torch 100 that allows four fingers other than the thumb of the right hand to be inserted. Thereby, the first handle 8 is arranged on the tool plane P so as to extend in the direction along the longitudinal axis Y of the welding torch 100 .
- a lead-through switch 13 is provided at the tip of the first handle 8 that can be operated with the thumb of the right hand holding the first handle 8 .
- the lead-through switch 13 functions to enable lead-through control when pressure is applied by the thumb, and to disable lead-through control when pressure is released.
- the second handle 9 is a straight rod-shaped member arranged at a position where a worker who holds the first handle 8 with his right hand can hold it with his left hand.
- the fixed block 12 is provided with two push button switches 14 and 15 at positions that can be operated by the thumb of the left hand when the second handle 9 is gripped with the right hand.
- One of the push button switches 14 is a teaching button that stores the angle of each axis of the robot 2 at the time of being pushed.
- the other push button switch 15 is a mode switching button that switches the operation mode of the robot 2 between the orthogonal operation and each axis operation each time it is pressed.
- the tool bracket 6 is a cuboid block-shaped member sandwiched between the flange 5 and the torch bracket 7 .
- a bracket body 11 of a torch bracket 7 is fixed to the end surface of the tool bracket 6 parallel to the flange 5 .
- three side surfaces parallel to the rotation axis X of the flange 5 of the tool bracket 6 are provided with sensor mounting surfaces (mounting surfaces) for detachably mounting welding sensors (additional devices) 30. 6a is provided. Only one sensor mounting surface 6a is shown in FIG.
- the welding sensor 30 can accurately detect the welding line by, for example, scanning the workpiece with a laser beam in a direction intersecting the welding line on the workpiece and detecting the reflected light.
- the sensor mounting surfaces 6a are provided on three side surfaces of the tool bracket 6, for example, left and right side surfaces and a rear surface side surface when the tool bracket 6 is viewed from the torch bracket 7 side.
- the operator can select the sensor mounting surface 6a and mount the welding sensor 30 according to the scanning direction of the laser beam, the position of the processing work line with respect to the welding torch 100, and the like.
- Two pin holes 16 and four screw holes 17 are provided on the sensor mounting surface 6a, and the welding sensor 30 can be mounted in a state of being accurately positioned with respect to the robot 2 by bolts and positioning pins.
- each sensor mounting surface 6a is provided with a switch (detachable sensor) 18 that is pressed when the welding sensor 30 is mounted. Which sensor mounting surface 6a the welding sensor 30 is mounted on can be detected by the state of the switch 18 provided on the sensor mounting surface 6a to which the welding sensor 30 is mounted.
- the welding sensor 30 is fixed to the sensor mounting surface 6a on the right side as viewed from the torch bracket 7 side.
- the welding sensor 30 has a relatively large outer shape and is arranged to protrude relatively greatly from the sensor mounting surface 6a.
- the robot control device 3 includes a storage section 19 and a control section 20, as shown in FIG.
- the control unit 20 includes at least one processor and memory.
- the control unit 20 outputs a command signal to control the robot 2 by so-called lead-through control, in which the attitude of the robot 2 is changed according to the magnitude and direction of the force detected by the force sensor 10 provided in the robot 2. do.
- a welding power source 40 is connected to the robot control device 3 as shown in FIG.
- a welding sensor connection unit 50 is connected to the robot control device 3 , and a sensor control cable 60 connected to the welding sensor 30 is connected to the welding sensor connection unit 50 .
- the robot control device 3 detects the force sensor 10 in a state (second state) in which the welding sensor 30 is not attached to any of the sensor mounting surfaces 6a and the welding torch 100 is mounted by the torch bracket 7.
- the storage unit 19 stores the load information.
- the load information for example, values detected by the force sensor 10 when the angle of each axis of the robot 2 is arranged at the origin position are stored.
- the control unit 20 controls the force sensor 10 as long as the estimated value is detected regardless of the angle of each axis. , can be treated as a neutral load state (load setting) in which no external force is acting.
- the robot control device 3 stores in the storage unit 19 basic information of the welding sensor 30, namely the mass and the position of the center of gravity from the sensor mounting surface 6a.
- the control unit 20 changes the neutral load state.
- the position stored in the storage unit 19 is the center of gravity position stored in the storage unit 19 away from the sensor attachment surface 6a where the attachment is detected.
- the mass of the weld sensor 30 is added. Therefore, when the first state is detected, the controller 20 controls the force sensor 10 based on the mass and the center of gravity stored in the storage unit 19 and the information on each axis of the robot 2 . estimated load information and set it as a new neutral load condition.
- the control unit 20 corrects the taught point based on the characteristics of the detected welding work line. That is, when the position coordinates of the tip of the welding wire 140 projecting from the tip of the welding torch 100 are set as the teaching point, if the teaching point deviates from the welding work line detected by the welding sensor 30, Correct the coordinates of the teaching point so that it is placed on the welding work line.
- the operator In order to teach a welding operation using the robot system 1 according to the present embodiment, the operator must first move the torch bracket 7 to the first position of the torch bracket 7 in the second state in which the welding sensor 30 is not attached to the sensor mounting surface 6a. The handle 8 and the second handle 9 are grasped.
- the lead-through control is enabled.
- the robot controller 3 operates the robot 2 by lead-through control based on the forces applied to the first handle 8 and the second handle 9 .
- the switch 18 provided on the sensor mounting surface 6a is in the OFF state, so the robot control device 3 detects the force sensor 10 in the neutral load state stored in the storage unit 19. Based on value.
- the robot control device 3 detects the force sensor 10 in the neutral load state stored in the storage unit 19. Based on value.
- the operator applies force to the first handle 8 and the second handle 9, the magnitude and direction of the force detected by the force sensor 10 change. 3 operates the robot 2 by lead-through control.
- the operator presses one of the push button switches 14, which are teaching buttons provided near the second handle 9, so that each of the robot 2 at the time of pressing is changed. Axis angles are stored. By repeating this operation, the operation program of the robot 2 can be taught.
- the operator attaches the welding sensor 30 to one of the sensor mounting surfaces 6a in order to teach a teaching point that needs to be taught precisely, such as a welding work line.
- the switch 18 on the sensor mounting surface 6a to which the welding sensor 30 is attached is turned on.
- the control unit 20 uses the mass and center-of-gravity position of the welding sensor 30 stored in the storage unit 19 to change the neutral load state.
- the robot controller 3 moves the robot 2 to a desired position by lead-through control, Multiple teach points along the weld line can be taught.
- the operator activates the welding sensor 30 and reproduces the teaching points taught along the welding work line, thereby operating the robot 2, A laser beam is scanned by the welding sensor 30 to detect the characteristics of the welding work line.
- the control unit 20 accurately aligns the tool tip point of the tip of the welding torch 100 with the welding work line based on the input characteristics. Correct the coordinates of each teaching point as follows.
- the operator After completing the teaching of the teaching points along the welding work line, the operator removes the welding sensor 30 from the sensor mounting surface 6a and teaches the remaining teaching points while operating the robot 2 by lead-through control. In this case also, when the welding sensor 30 is removed from the sensor mounting surface 6a, the switch 18 is turned off and the second state is detected. The load state stored in the storage unit 19 is restored. As a result, the force sensor 10 can accurately detect the magnitude and direction of force applied to the first handle 8 and the second handle 9 by the operator, and the robot 2 can be moved in a desired posture.
- the first state in which the welding sensor 30 is attached to the sensor mounting surface 6a and the second state in which the welding sensor 30 is not attached are distinguished, Switch the load setting when lead-through control is executed.
- the lead-through control can be performed correctly and the robot 2 can be operated in a desired posture.
- the advantage is that the teaching operation can be performed without worrying about interference with peripheral devices by performing teaching in the second state with the welding sensor 30 removed. There is Moreover, even when teaching is performed in the first state with the welding sensor 30 attached, the robot 2 can be correctly lead-through controlled regardless of the force acting on the force sensor 10 by the welding sensor 30 . Further, there is an advantage that the characteristics of the welding work line can be detected by the welding sensor 30 and the teaching points along the welding work line can be accurately corrected.
- the mounting position of the welding sensor 30 can be changed according to the application. Then, regardless of which sensor mounting surface 6a the welding sensor 30 is mounted on, the mounting position of the welding sensor 30 can be detected by the switch 18 provided on each sensor mounting surface 6a, and the neutral load state can be correctly changed. has the advantage of being able to
- the attachment of the welding sensor 30 to the sensor attachment surface 6a is detected by the switch 18 physically pressed by the welding sensor 30.
- a proximity sensor such as a Hall element may be employed.
- the first state and the second state are determined based on force information detected by the force sensor 10 in the first state and force information detected by the force sensor 10 in the second state. can be identified.
- the first A state and a second state may be identified.
- the mounting position of the welding sensor 30 may be detected based on the magnitude and direction of the force detected by the force sensor 10, and the neutral load state may be changed based on the detected mounting position.
- the sensor control cable 60 is connected to the welding sensor 30 so that the signal output from the welding sensor 30 is taken into the robot control device 3 . Therefore, instead of detecting attachment/detachment of the welding sensor 30 by the switch 18 which is an attachment/detachment sensor, it is determined whether the sensor control cable 60 is connected or whether the output from the welding sensor 30 is input to the robot control device 3 . Attachment/detachment of the welding sensor 30 may be detected depending on whether or not. Then, when the attachment of welding sensor 30 is detected, based on the force information detected by force sensor 10, sensor mounting surface 6a on which welding sensor 30 is attached may be specified.
- the robot 2 to which the welding torch 100 for arc welding is attached is exemplified, but it may be applied to the robot 2 to which other tools such as laser welding or sealing are attached.
- the welding sensor 30 for detecting the welding work line has been exemplified. may For example, it may be a sensor that detects a machining work line, which is a trajectory for sealing.
- a guard member surrounding the welding sensor 30 may be attached as indicated by the chain double-dashed lines in FIGS. 1 and 2.
- the guard member for example, a metal box-shaped cover that is fixed to the tool bracket 6 and surrounds the outer peripheral surface of the welding sensor 30 other than the laser emission surface, or a protector made of a metal pipe material may be adopted. .
- the sensor mounting surface 6a for mounting the welding sensor 30 is provided at three locations on the tool bracket 6, but any number of one or more may be provided. In the case of one location, it is only necessary to detect the presence or absence of attachment/detachment.
- the form, shape and arrangement of the tool bracket 6, torch bracket 7, handles 8 and 9, lead-through switch 13, push button switches 14 and 15, etc. may be arbitrary.
- the number of handles may or may not be one. If there is no handle, the operator may directly grasp the torch bracket 7, the tool bracket 6 or the wrist 4 of the robot 2 and push and pull.
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
ロボット（２）に備えられた力センサにより検出された力の大きさおよび方向に応じてロボット（２）の姿勢を変更するリードスルー制御によりロボット（２）を制御可能なロボット制御装置（３）であって、ロボット（２）の手首（４）先端に、付加装置（３０）が装着された第１状態と、付加装置（３０）が装着されていない第２状態とを識別し、第１状態および第２状態においてリードスルー制御が実行される際のロボット（２）の負荷設定を切り替えるロボット制御装置（３）である。
Description
本開示は、ロボット制御装置およびロボットシステムに関するものである。
従来、溶接線を検出する検出装置を溶接トーチ等のツールから着脱可能にして、検出装置による検出範囲を拡大させ、他の部材との干渉をなくす技術が知られている（例えば、特許文献１参照。）。また、作業者により加えられる力を検出するセンサを内蔵し、センサにより検出された力の大きさおよび方向に応じてロボットの位置および姿勢を変更する、いわゆるリードスルー制御により動作可能なロボットが知られている（例えば、特許文献２参照。）。
溶接線を検出する検出装置は、ロボットの手首あるいは溶接トーチ等のツールから大きく突出して装着されるので、溶接線を検出する必要のある領域の教示の際にのみ装着され、溶接線を検出する必要のない領域の教示の際や教示完了後の実行開始前には取り外される。ロボットの教示をリードスルー制御により動作させて行う場合には、検出装置の有無により、ロボットに作用する負荷が変動する。したがって、装置の脱着によりロボットに作用する負荷が変動してもリードスルー制御によるロボットの操作が適正に行われることが望まれている。
ロボットに備えられた力センサにより検出された力の大きさおよび方向に応じて前記ロボットの姿勢を変更するリードスルー制御により前記ロボットを制御可能なロボット制御装置であって、前記ロボットの手首先端に、付加装置が装着された第１状態と、前記付加装置が装着されていない第２状態とを識別し、前記第１状態および前記第２状態においてリードスルー制御が実行される際の前記ロボットの負荷設定を切り替えるロボット制御装置である。
本開示の一実施形態に係るロボット制御装置３およびロボットシステム１について、図面を参照して以下に説明する。
本実施形態に係るロボットシステム１は、図１に示されるように、力センサ１０を備えたロボット２と、ロボット２を制御するロボット制御装置３とを備えている。
本実施形態に係るロボットシステム１は、図１に示されるように、力センサ１０を備えたロボット２と、ロボット２を制御するロボット制御装置３とを備えている。
ロボット２の手首４先端には、最先端の回転軸線Ｘ回りに回転可能なフランジ５が備えられ、フランジ５には、ツールブラケット６が固定されている。また、ツールブラケット６には、溶接トーチ１００のような長尺のツールを支持するトーチブラケット７が固定され、トーチブラケット７には、作業者によって把持される２つのハンドル８，９が備えられている。
トーチブラケット７は、ツールブラケット６に固定されるブラケット本体１１と、ブラケット本体１１に溶接トーチ１００を固定するとともにハンドル８，９が固定された固定ブロック１２とを備えている。
溶接トーチ１００は、一方向に湾曲した管状のトーチ本体１１０と、トーチ本体１１０の基端に接続された略円柱状のネックホルダ１２０と、ネックホルダ１２０の基端に接続されたガイドチューブ１３０とを備えている。
溶接トーチ１００は、一方向に湾曲した管状のトーチ本体１１０と、トーチ本体１１０の基端に接続された略円柱状のネックホルダ１２０と、ネックホルダ１２０の基端に接続されたガイドチューブ１３０とを備えている。
ガイドチューブ１３０、ネックホルダ１２０およびトーチ本体１１０は、溶接ワイヤ１４０を長手方向に貫通させる内孔（図示略）を備えている。溶接トーチ１００は、内孔内を貫通してきた溶接ワイヤ１４０をトーチ本体１１０の先端から突出させて、ワークとの間にアークを発生させることによりワークを溶接する。
溶接トーチ１００は、上述したように長尺の形態を有しているので、手首４内部を貫通させることができず、フランジ５の回転軸線Ｘに対して偏心した位置にトーチブラケット７によって支持される。そして、トーチ本体１１０は、トーチブラケット７に固定された位置からフランジ５の回転軸線Ｘを含む平面（以下、ツール平面という。）Ｐに沿って湾曲し、溶接ワイヤ１４０をフランジ５の回転軸線Ｘに交差させる位置に突出させる形態に配置される。フランジ５の回転軸線Ｘと溶接ワイヤ１４０との交差点が、一般にツール先端点として設定される。
ハンドル８，９は、ツール平面Ｐに沿って配置された第１ハンドル８および溶接トーチ１００の長手軸Ｙに近接する位置において、ツール平面Ｐに対して直交する方向に延びて配置された第２ハンドル９である。
第１ハンドル８は、作業者が右手で握ることができる直棒状の部材である。第１ハンドル８は、溶接トーチ１００との間に右手の親指以外の４本の指が入る程度の隙間をあけて、溶接トーチ１００の長手軸Ｙに平行に配置されている。これにより、第１ハンドル８は、ツール平面Ｐ上に溶接トーチ１００の長手軸Ｙに沿う方向に延びる形態で配置されている。
第１ハンドル８は、作業者が右手で握ることができる直棒状の部材である。第１ハンドル８は、溶接トーチ１００との間に右手の親指以外の４本の指が入る程度の隙間をあけて、溶接トーチ１００の長手軸Ｙに平行に配置されている。これにより、第１ハンドル８は、ツール平面Ｐ上に溶接トーチ１００の長手軸Ｙに沿う方向に延びる形態で配置されている。
第１ハンドル８の先端には、第１ハンドル８を把持した状態の右手の親指によって操作可能なリードスルースイッチ１３が設けられている。リードスルースイッチ１３は、親指による押圧力が付与された状態でリードスルー制御を有効にし、押圧力が解除された状態でリードスルー制御を無効にするよう機能する。
第２ハンドル９は、第１ハンドル８を右手で握った作業者が左手で握ることができる位置に配置された直棒状の部材である。固定ブロック１２には、第２ハンドル９を順手で握った状態の左手の親指によって操作可能な位置に２つの押しボタンスイッチ１４，１５が設けられている。
一方の押しボタンスイッチ１４は、押されることにより、押された時点におけるロボット２の各軸の角度を記憶する教示ボタンである。また、他方の押しボタンスイッチ１５は、押される都度にロボット２の動作モードを直交動作と各軸動作とで切り替えるモード切替ボタンである。
ツールブラケット６は、フランジ５とトーチブラケット７との間に挟まれた直方体ブロック状の部材である。ツールブラケット６のフランジ５と平行な先端面にはトーチブラケット７のブラケット本体１１が固定されている。また、図３に示されるように、ツールブラケット６のフランジ５の回転軸線Ｘと平行な３つの側面には、溶接センサ（付加装置）３０を着脱可能に取り付けるためのセンサ取付面（取付面）６ａが設けられている。図３には、１つのセンサ取付面６ａのみが表示されている。
溶接センサ３０は、例えば、ワークに対して、ワーク上の溶接作業線に交差する方向にレーザ光を走査して反射光を検出することにより、溶接作業線を精度よく検出することができる。
センサ取付面６ａは、ツールブラケット６の３つの側面、例えば、ツールブラケット６をトーチブラケット７側から見たときの左右の両側面および背面側の側面の３箇所に設けられている。
センサ取付面６ａは、ツールブラケット６の３つの側面、例えば、ツールブラケット６をトーチブラケット７側から見たときの左右の両側面および背面側の側面の３箇所に設けられている。
作業者は、レーザ光の走査方向および溶接トーチ１００に対する加工作業線の位置などに応じて、センサ取付面６ａを選択し、溶接センサ３０を取り付けることができる。センサ取付面６ａには、２つのピン孔１６と４つのネジ孔１７とが設けられ、ボルトおよび位置決めピンによって、溶接センサ３０をロボット２に対して精度よく位置決めした状態に取り付けることができる。
また、各センサ取付面６ａには、溶接センサ３０が取り付けられることにより押されるスイッチ（着脱センサ）１８が設けられている。溶接センサ３０がどのセンサ取付面６ａに取り付けられたのかについては、取付先のセンサ取付面６ａに設けられているスイッチ１８の状態によって検出することができる。
図１および図２に示す例では、溶接センサ３０は、トーチブラケット７側から見て右側の側面のセンサ取付面６ａに固定されている。溶接センサ３０は、比較的大きな外形を有し、センサ取付面６ａから比較的大きく張り出して配置される。
ロボット制御装置３は、図４に示されるように、記憶部１９と制御部２０とを備えている。
制御部２０は、少なくとも１つのプロセッサとメモリとを備えている。
制御部２０は、ロボット２に備えられた力センサ１０により検出された力の大きさおよび方向に応じてロボット２の姿勢を変更する、いわゆるリードスルー制御によりロボット２を制御するよう指令信号を出力する。
制御部２０は、少なくとも１つのプロセッサとメモリとを備えている。
制御部２０は、ロボット２に備えられた力センサ１０により検出された力の大きさおよび方向に応じてロボット２の姿勢を変更する、いわゆるリードスルー制御によりロボット２を制御するよう指令信号を出力する。
ロボット制御装置３には、図１に示されるように、溶接電源４０が接続され、溶接電源４０と溶接トーチ１００とはガイドチューブ１３０によって接続されている。また、ロボット制御装置３には溶接センサ接続ユニット５０が接続され、溶接センサ接続ユニット５０には、溶接センサ３０に接続されるセンサ制御ケーブル６０が接続されている。
ロボット制御装置３は、いずれのセンサ取付面６ａにも溶接センサ３０が取り付けられておらず、トーチブラケット７によって溶接トーチ１００が取り付けられている状態（第２状態）において、力センサ１０により検出される負荷情報を記憶部１９に記憶している。負荷情報としては、例えば、ロボット２の各軸の角度を原点位置に配置したときの力センサ１０により検出される値を記憶している。
ロボット２の各軸の角度（各軸情報）が変化すると、力センサ１０により検出される値は変化するが、制御部２０は、ロボット２の各軸情報と、記憶部１９に記憶されている負荷情報とから、力センサ１０により検出される力の大きさおよび方向を推定することができる。したがって、制御部２０は、全てのスイッチ１８が溶接センサ３０の取付を検出していない第２状態においては、各軸の角度にかかわらず、推定される値を力センサ１０が検出している限り、外力が作用していない中立の負荷状態（負荷設定）として取り扱うことができる。
また、ロボット制御装置３は、溶接センサ３０の基本情報である質量およびセンサ取付面６ａからの重心位置の情報を記憶部１９に記憶している。
そして、スイッチ１８により、いずれかのセンサ取付面６ａに溶接センサ３０が取り付けられたことが検出された場合には、制御部２０は、中立の負荷状態を変更する。
そして、スイッチ１８により、いずれかのセンサ取付面６ａに溶接センサ３０が取り付けられたことが検出された場合には、制御部２０は、中立の負荷状態を変更する。
すなわち、溶接センサ３０が取り付けられた状態（第１状態）においては、取付を検出したセンサ取付面６ａから記憶部１９に記憶されている重心位置だけ離れた位置に、記憶部１９に記憶されている溶接センサ３０の質量が追加される。したがって、制御部２０は、第１状態であることが検出された場合には、記憶部１９に記憶されている質量および重心位置と、ロボット２の各軸情報とから、力センサ１０により検出される負荷情報を推定し、新たな中立の負荷状態として設定する。
また、制御部２０は、溶接センサ３０により溶接作業線が検出されたときには、検出された溶接作業線の特徴に基づいて、教示済の教示点を補正する。すなわち、教示点として、溶接トーチ１００先端に突出する溶接ワイヤ１４０の先端の位置座標が設定されている場合に、溶接センサ３０により検出された溶接作業線上から教示点がずれている場合には、溶接作業線上に配置されるように教示点の座標を補正する。
このように構成された本実施形態に係るロボット制御装置３およびロボットシステム１の作用について、以下に説明する。
本実施形態に係るロボットシステム１を用いて溶接作業の教示を実施するには、作業者は、まず、センサ取付面６ａに溶接センサ３０を取り付けていない第２状態において、トーチブラケット７の第１ハンドル８および第２ハンドル９を握る。
本実施形態に係るロボットシステム１を用いて溶接作業の教示を実施するには、作業者は、まず、センサ取付面６ａに溶接センサ３０を取り付けていない第２状態において、トーチブラケット７の第１ハンドル８および第２ハンドル９を握る。
そして、第１ハンドル８に設けられたリードスルースイッチ１３を押下することにより、リードスルー制御を有効にする。これにより、第１ハンドル８および第２ハンドル９に加えた力に基づいて、ロボット制御装置３が、リードスルー制御によってロボット２を動作させる。
この第２状態においては、センサ取付面６ａに設けられたスイッチ１８はオフ状態となっているので、ロボット制御装置３は、記憶部１９に記憶されている中立の負荷状態における力センサ１０の検出値を基準とする。そして、作業者が、第１ハンドル８および第２ハンドル９に力を加えることにより、力センサ１０により検出される力の大きさおよび方向が変化するので、その変化量に基づいて、ロボット制御装置３が、リードスルー制御によりロボット２を動作させる。
ロボット２が所望の姿勢に配置された状態において、作業者が第２ハンドル９近傍に設けられた教示ボタンである一方の押しボタンスイッチ１４を押下することにより、押下された時点におけるロボット２の各軸の角度が記憶される。この動作を繰り返すことによりロボット２の動作プログラムを教示することができる。
溶接センサ３０が取り付けられていない第２状態における教示操作においては、動作プログラムの開始点、中継点等の比較的大まかに設定することが可能な教示点について教示することができる。また、比較的大きな溶接センサ３０がツールブラケット６に固定されていないので、溶接センサ３０と周辺部材との干渉を気にすることなく、比較的狭隘な環境においても教示操作を容易に行うことができる。
次いで、溶接作業線のように、精密に教示する必要がある教示点を教示するには、作業者は、いずれかのセンサ取付面６ａに溶接センサ３０を取り付ける。溶接センサ３０を取り付けると、溶接センサ３０が取り付けられたセンサ取付面６ａのスイッチ１８がオン状態に切り替えられる。スイッチ１８がオン状態に切り替わると、制御部２０は、記憶部１９に記憶されている溶接センサ３０の質量および重心位置を用いて中立の負荷状態を変更する。
すなわち、センサ取付面６ａに溶接センサ３０を取り付けると、取り付ける前後において力センサ１０により検出される力の大きさおよび方向が変化するが、ロボット制御装置３は、溶接センサ３０を取り付けた第１状態が中立の負荷状態であると判断することができる。したがって、この第１状態において、作業者が、第１ハンドル８および第２ハンドル９を把持して力を加えると、ロボット制御装置３が、ロボット２をリードスルー制御によって所望の位置に動作させ、溶接作業線に沿う複数の教示点を教示することができる。
溶接作業線に沿う複数の教示点が教示された後に、作業者は、溶接センサ３０を作動させ、溶接作業線に沿って教示された教示点を再生することにより、ロボット２を動作させながら、溶接センサ３０によってレーザ光を走査させ、溶接作業線の特徴を検出させる。制御部２０は、溶接センサ３０により検出された溶接作業線の特徴が入力されると、入力された特徴に基づいて、溶接トーチ１００先端のツール先端点が精度よく溶接作業線に位置合わせされるように、各教示点の座標を補正する。
溶接作業線に沿う教示点の教示が終了した後には、作業者は、溶接センサ３０をセンサ取付面６ａから取り外し、残りの教示点の教示をリードスルー制御によってロボット２を動作させながら実施する。この場合においても、溶接センサ３０がセンサ取付面６ａから取り外されることにより、スイッチ１８がオフ状態となって第２状態であることが検出されるので、制御部２０は、中立の負荷状態を、記憶部１９に記憶されている負荷状態に戻す。これにより、作業者が第１ハンドル８および第２ハンドル９に加えた力の大きさおよび方向を力センサ１０により精度よく検出して、ロボット２を所望の姿勢に動作させることができる。
このように、本実施形態に係るロボット制御装置３およびロボットシステム１によれば、センサ取付面６ａに溶接センサ３０が取り付けられた第１状態と取り付けられていない第２状態とを識別して、リードスルー制御が実行される際の負荷設定を切り替える。これにより、比較的大重量かつ大きな外形の溶接センサ３０の取付の有無にかかわらず、リードスルー制御を正しく行って、ロボット２を所望の姿勢に動作させることができる。
すなわち、溶接センサ３０を必要としない教示点においては、溶接センサ３０を取り外した第２状態において教示を実施することにより、周辺装置との干渉を気にせずに教示作業を行うことができるという利点がある。また、溶接センサ３０を取り付けた第１状態において教示を行う場合においても、溶接センサ３０により力センサ１０に作用する力にかかわらず、ロボット２を正しくリードスルー制御することができる。そして、溶接作業線の特徴を溶接センサ３０によって検出し、溶接作業線に沿う教示点を精度よく補正することができるという利点がある。
また、本実施形態においては、ツールブラケット６に複数のセンサ取付面６ａを設けたので、用途に合わせて溶接センサ３０の取付位置を変更することができる。そして、どのセンサ取付面６ａに溶接センサ３０を取り付けた場合においても、各センサ取付面６ａに設けられたスイッチ１８によって、溶接センサ３０の取付位置を検出でき、中立の負荷状態を正しく変更することができるという利点がある。
なお、本実施形態においては、センサ取付面６ａへの溶接センサ３０の取付を、溶接センサ３０により物理的に押されるスイッチ１８によって検出したが、これに代えて、他の形式の着脱センサ、例えば、ホール素子等の近接センサを採用してもよい。
また、着脱センサに代えて、第１状態において力センサ１０により検出される力の情報と、第２状態において力センサ１０により検出される力の情報とに基づいて、第１状態と第２状態とを識別してもよい。
また、着脱センサに代えて、第１状態において力センサ１０により検出される力の情報と、第２状態において力センサ１０により検出される力の情報とに基づいて、第１状態と第２状態とを識別してもよい。
例えば、第１状態および第２状態において、ロボット２を原点位置に配置し、他の外力が加わっていないときの力センサ１０により検出される力の大きさおよび方向を比較することにより、第１状態と第２状態とを識別してもよい。また、力センサ１０により検出される力の大きさおよび方向に基づいて、溶接センサ３０の取付位置を検出し、検出された取付位置に基づいて、中立の負荷状態を変更することにしてもよい。
また、溶接センサ３０を取り付ける際には、センサ制御ケーブル６０を溶接センサ３０に接続することにより、溶接センサ３０から出力される信号をロボット制御装置３に取り込むことが行われる。したがって、着脱センサであるスイッチ１８によって溶接センサ３０の着脱を検出することに代えて、センサ制御ケーブル６０が接続されたか否か、あるいは、溶接センサ３０からの出力がロボット制御装置３に入力されたか否かによって、溶接センサ３０の着脱を検出してもよい。そして、溶接センサ３０の装着が検出された場合に、力センサ１０によって検出される力の情報に基づいて、溶接センサ３０が装着されたセンサ取付面６ａを特定すればよい。
また、本実施形態においては、アーク溶接用の溶接トーチ１００が取り付けられたロボット２を例示したが、レーザ溶接あるいはシーリング等の他のツールが取り付けられたロボット２に適用してもよい。また、ロボット２の手首４先端に着脱可能に取り付けられる付加装置として、溶接作業線を検出する溶接センサ３０を例示したが、これに代えて、他の任意の付加装置を装着する場合に適用してもよい。例えば、シーリングを行う軌跡である加工作業線を検出するセンサであってもよい。
また、溶接センサ３０に作業者が誤って接触してしまうことを防止するために、図１および図２に２点鎖線によって示されるように、溶接センサ３０を取り囲むガード部材を装着してもよい。ガード部材としては、例えば、ツールブラケット６に固定され、溶接センサ３０のレーザ射出面以外の外周面を取り囲む金属製の箱状のカバーあるいは、金属製のパイプ材からなるプロテクタを採用してもよい。
また、本実施形態においては、溶接センサ３０を取り付けるセンサ取付面６ａをツールブラケット６に３箇所設けた場合を例示したが、１以上の任意の数だけ設けられていてもよい。１箇所の場合には、着脱の有無を検出するだけでよい。また、ツールブラケット６、トーチブラケット７、ハンドル８，９、リードスルースイッチ１３、押しボタンスイッチ１４，１５等の形式、形状および配置は任意でよい。
また、第１ハンドル８および第２ハンドル９を有する場合を示したが、ハンドルは１つであってもなくてもよい。ハンドルがない場合には、作業者は、トーチブラケット７、ツールブラケット６あるいはロボット２の手首４を直接手で掴んで押し引きすることにしてもよい。
１ ロボットシステム
２ ロボット
３ ロボット制御装置
４ 手首
６ａ センサ取付面（取付面）
１０ 力センサ
１８ スイッチ（着脱センサ）
４０ 溶接センサ（付加装置）
２ ロボット
３ ロボット制御装置
４ 手首
６ａ センサ取付面（取付面）
１０ 力センサ
１８ スイッチ（着脱センサ）
４０ 溶接センサ（付加装置）
Claims (6)
- ロボットに備えられた力センサにより検出された力の大きさおよび方向に応じて前記ロボットの姿勢を変更するリードスルー制御により前記ロボットを制御可能なロボット制御装置であって、
前記ロボットの手首先端に、付加装置が装着された第１状態と、前記付加装置が装着されていない第２状態とを識別し、
前記第１状態および前記第２状態においてリードスルー制御が実行される際の前記ロボットの負荷設定を切り替えるロボット制御装置。 - 前記手首先端における前記付加装置の取付面に設けられた着脱センサの出力に基づいて、前記第１状態と前記第２状態とを識別する請求項１に記載のロボット制御装置。
- 複数の前記取付面にそれぞれ設けられた前記着脱センサの出力に基づいて、前記第１状態における前記付加装置の取付位置を識別し、
前記第１状態においてリードスルー制御が実行される際の前記ロボットの負荷設定を前記取付位置に応じて切り替える請求項２に記載のロボット制御装置。 - 前記第１状態において前記力センサにより検出される力の情報と、前記第２状態において前記力センサにより検出される力の情報とに基づいて、前記第１状態と前記第２状態とを識別する請求項１に記載のロボット制御装置。
- 前記第１状態において前記力センサにより検出される力の情報と、前記第２状態において前記力センサにより検出される力の情報とに基づいて、前記第１状態における前記付加装置の取付位置を識別し、
前記第１状態においてリードスルー制御が実行される際の前記ロボットの負荷設定を前記取付位置に応じて切り替える請求項４に記載のロボット制御装置。 - 請求項１から請求項５のいずれかに記載のロボット制御装置と、
前記力センサを有する前記ロボットとを備えるロボットシステム。
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/JP2022/007585 WO2023162084A1 (ja) | 2022-02-24 | 2022-02-24 | ロボット制御装置およびロボットシステム |
| JP2022533499A JP7157275B1 (ja) | 2022-02-24 | 2022-02-24 | ロボット制御装置およびロボットシステム |
| TW112104869A TWI823773B (zh) | 2022-02-24 | 2023-02-10 | 機器人控制裝置及機器人系統 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/JP2022/007585 WO2023162084A1 (ja) | 2022-02-24 | 2022-02-24 | ロボット制御装置およびロボットシステム |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2023162084A1 true WO2023162084A1 (ja) | 2023-08-31 |
Family
ID=83688409
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP2022/007585 WO2023162084A1 (ja) | 2022-02-24 | 2022-02-24 | ロボット制御装置およびロボットシステム |
Country Status (3)
| Country | Link |
|---|---|
| JP (1) | JP7157275B1 (ja) |
| TW (1) | TWI823773B (ja) |
| WO (1) | WO2023162084A1 (ja) |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS63318277A (ja) * | 1987-06-19 | 1988-12-27 | ファナック株式会社 | 水平ア−ム型多関節ロボットの上下軸直接教示方法と装置 |
| JPH09150383A (ja) * | 1995-11-29 | 1997-06-10 | Meidensha Corp | ロボット制御装置 |
| WO2021261426A1 (ja) * | 2020-06-25 | 2021-12-30 | ファナック株式会社 | ロボット制御装置 |
-
2022
- 2022-02-24 WO PCT/JP2022/007585 patent/WO2023162084A1/ja active Application Filing
- 2022-02-24 JP JP2022533499A patent/JP7157275B1/ja active Active
-
2023
- 2023-02-10 TW TW112104869A patent/TWI823773B/zh active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS63318277A (ja) * | 1987-06-19 | 1988-12-27 | ファナック株式会社 | 水平ア−ム型多関節ロボットの上下軸直接教示方法と装置 |
| JPH09150383A (ja) * | 1995-11-29 | 1997-06-10 | Meidensha Corp | ロボット制御装置 |
| WO2021261426A1 (ja) * | 2020-06-25 | 2021-12-30 | ファナック株式会社 | ロボット制御装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| TW202335809A (zh) | 2023-09-16 |
| JP7157275B1 (ja) | 2022-10-19 |
| JPWO2023162084A1 (ja) | 2023-08-31 |
| TWI823773B (zh) | 2023-11-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6597971B2 (en) | Device for avoiding interference | |
| KR100449429B1 (ko) | 로봇의교시장치 | |
| CN106493711B (zh) | 控制装置、机器人以及机器人系统 | |
| US20100312391A1 (en) | Calibration Of A Lead-Through Teaching Device For An Industrial Robot | |
| JP6730247B2 (ja) | ロボット操作装置 | |
| KR101800946B1 (ko) | 로봇 펜던트 | |
| JP6219881B2 (ja) | 対象物を保護する保護部材を有する把持装置及びそれを具備するロボット装置 | |
| EP2090408B1 (en) | System and a method for visualization of process errors | |
| CN109465806B (zh) | 具备中空的手腕要素的机器人 | |
| JP6592053B2 (ja) | 作業ツールの移動方向を監視する制御装置 | |
| JP5572994B2 (ja) | ロボット制御装置 | |
| JPH08216074A (ja) | ロボットの直接教示装置 | |
| WO2023162084A1 (ja) | ロボット制御装置およびロボットシステム | |
| JP3632268B2 (ja) | ロボットの直接教示装置 | |
| US7462803B2 (en) | Disconnection box for a robot system | |
| JP6668665B2 (ja) | ロボット装置 | |
| WO2022138596A1 (ja) | ロボット用操作装置およびロボット | |
| US11745339B2 (en) | Horizontal articulated robot | |
| JP5446573B2 (ja) | ロボット制御装置及びロボット操作用デバイス | |
| US20240131722A1 (en) | Robot manipulation device and robot | |
| JPH08336785A (ja) | 産業用ロボットの教示装置 | |
| JPH02190285A (ja) | ロボット用ハンド | |
| WO2024009382A1 (ja) | ロボット装置 | |
| JP2018114590A (ja) | ロボット教示装置およびロボットの教示方法 | |
| CN116472147A (zh) | 机器人用操作装置以及机器人 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| WWE | Wipo information: entry into national phase |
Ref document number: 2022533499 Country of ref document: JP |
|
| 121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 22928612 Country of ref document: EP Kind code of ref document: A1 |