Nothing Special   »   [go: up one dir, main page]

JP5353500B2 - robot - Google Patents

robot Download PDF

Info

Publication number
JP5353500B2
JP5353500B2 JP2009161513A JP2009161513A JP5353500B2 JP 5353500 B2 JP5353500 B2 JP 5353500B2 JP 2009161513 A JP2009161513 A JP 2009161513A JP 2009161513 A JP2009161513 A JP 2009161513A JP 5353500 B2 JP5353500 B2 JP 5353500B2
Authority
JP
Japan
Prior art keywords
arm
sensor
cylindrical portion
actuator
structure material
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.)
Expired - Fee Related
Application number
JP2009161513A
Other languages
Japanese (ja)
Other versions
JP2011016183A (en
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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric 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 Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP2009161513A priority Critical patent/JP5353500B2/en
Priority to EP10167856A priority patent/EP2272636A2/en
Priority to CN2010102202014A priority patent/CN101947782B/en
Priority to US12/832,018 priority patent/US8396596B2/en
Publication of JP2011016183A publication Critical patent/JP2011016183A/en
Application granted granted Critical
Publication of JP5353500B2 publication Critical patent/JP5353500B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10T—TECHNICAL SUBJECTS COVERED BY FORMER US CLASSIFICATION
    • Y10T74/00—Machine element or mechanism
    • Y10T74/20—Control lever and linkage systems
    • Y10T74/20207—Multiple controlling elements for single controlled element
    • Y10T74/20305—Robotic arm
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10T—TECHNICAL SUBJECTS COVERED BY FORMER US CLASSIFICATION
    • Y10T74/00—Machine element or mechanism
    • Y10T74/20—Control lever and linkage systems
    • Y10T74/20207—Multiple controlling elements for single controlled element
    • Y10T74/20305—Robotic arm
    • Y10T74/20311—Robotic arm including power cable or connector
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10T—TECHNICAL SUBJECTS COVERED BY FORMER US CLASSIFICATION
    • Y10T74/00—Machine element or mechanism
    • Y10T74/20—Control lever and linkage systems
    • Y10T74/20207—Multiple controlling elements for single controlled element
    • Y10T74/20305—Robotic arm
    • Y10T74/20317—Robotic arm including electric motor

Landscapes

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

Abstract

A robot includes an arm includes a plurality of joints (15, 16, 17), a plurality of arm members (5, 6, 7) that form the arm, each arm member supporting a load, a plurality of actuators (15, 16, 17) that drive the joints and that are supported by the arm members, a load sensor (21, 22) embedded in at least one of the arm members to measure the load applied to the at least one of the arm members, a controller that controls movements of the actuators on the basis of a result of the measurement performed by the load sensor, and a wire hole through which a sensor line extend from a space inside the at least one of the arm members to a space inside the arm, the sensor line connecting the load sensor to the controller.

Description

本発明は、力制御機能を備えたロボットに関する。   The present invention relates to a robot having a force control function.

自動車や家電製品などの工業製品の組立作業は、従来人手に頼っており、作業の自動化が求められている。
従来人手で行なわれる作業は、複数の部材を嵌合させる嵌合作業や力倣い作業（具体的に）や部材を一定の力で別の部材に押し付ける作業等、比較的繊細な動作を必要とする作業が多く、かかる作業を人に代わってロボットで行う場合、ロボットが、取り扱う部材（ワーク）を取り扱う力（外力という）を高精度に制御する必要がある。
ロボットにより力を制御する手法として、特許文献１には、ロボットのアームの表面に感圧センサ等の接触センサ等を取り付けて、アームに作用する外力を測定し、測定結果に基づいてロボットの各関節の駆動部（アクチュエータ）を制御するものが開示されている。
また、特許文献２には、ロボットの手首部に６軸力覚センサを取り付け、ハンド部においてワークが受ける力及びモーメントを求め、これに基づいて各駆動部の駆動量を制御する技術が開示されている。 The assembly work of industrial products such as automobiles and home appliances has conventionally relied on manual labor, and automation of the work is required.
Conventionally, manual work requires relatively delicate operations such as fitting work to fit multiple members, force copying work (specifically), and pressing a member against another member with a constant force. When performing such work by a robot on behalf of a person, it is necessary to control the force (called external force) that the robot handles a member (work) to be handled with high accuracy.
As a method for controlling the force by the robot, Patent Document 1 discloses that a contact sensor such as a pressure sensor is attached to the surface of the robot arm, the external force acting on the arm is measured, and each of the robots is measured based on the measurement result. What controls the drive part (actuator) of a joint is disclosed.
Patent Document 2 discloses a technique for attaching a 6-axis force sensor to the wrist of a robot, obtaining the force and moment received by the work in the hand, and controlling the drive amount of each drive based on this. ing.

特許第３３８３６１４号Japanese Patent No. 3383614 特開２００８−３０７６３４JP2008-307634

ところで、特許文献１のごとく、アームの表面にセンサ等を取り付ける構成で、十分な精度で外力を測定してロボットを制御するためには、本来、センサはアクチュエータの近傍に配置されることが好ましい。アクチュエータの近傍において外力を測定することで、より正確にアクチュエータ部分にかかる外力を検出することができる。   By the way, in order to control a robot by measuring an external force with sufficient accuracy with a configuration in which a sensor or the like is attached to the surface of an arm as in Patent Document 1, it is originally preferable that the sensor is disposed in the vicinity of the actuator. . By measuring the external force in the vicinity of the actuator, it is possible to detect the external force applied to the actuator portion more accurately.

しかしながら、複数の方向の力の方向を検出するためには、アームの径方向に複数のセンサを設ける必要があり、各センサから制御装置へと接続される配線が数多く必要となる。即ち、かかる配線をアクチュエータの近傍のアームの内部に収めるためには配線の処理が複雑となってしまう。また、センサの配線がアクチュエータの近傍等の狭いスペースに配索されるので、アクチュエータの動作等によって配線が大きく変形することが考えられる。配線の変形等が大きくなると測定信号にノイズが多く含まれ、却って検出精度が低下してしまう。   However, in order to detect force directions in a plurality of directions, it is necessary to provide a plurality of sensors in the radial direction of the arm, and a large number of wirings connected from each sensor to the control device are required. That is, in order to store such wiring in the arm in the vicinity of the actuator, wiring processing becomes complicated. Further, since the sensor wiring is routed in a narrow space such as in the vicinity of the actuator, it is conceivable that the wiring is greatly deformed by the operation of the actuator or the like. When the deformation of the wiring or the like becomes large, the measurement signal contains a lot of noise, and the detection accuracy decreases.

また、特許文献２のごとく、ロボットの手首部に力覚センサを取付ける場合には、力覚センサのサイズ分だけロボットアームの手首部の寸法が長くなってしまう。手首部の寸法が長くなると、ロボットのハンド部がワークに接触する位置（即ち、作用点）とロボットアームの支持機構（即ち、支点）との距離が大きくなり、ロボットアームの支持機構にかかる負荷トルクが増大するため、力覚センサを取り付けない場合と比較してロボットの可搬能力が低下するという課題が生じる。   Further, as in Patent Document 2, when a force sensor is attached to the wrist of the robot, the size of the wrist of the robot arm becomes longer by the size of the force sensor. As the wrist dimension increases, the distance between the position at which the robot hand contacts the workpiece (ie, the point of action) and the robot arm support mechanism (ie, fulcrum) increases, and the load on the robot arm support mechanism increases. Since the torque increases, there arises a problem that the transportability of the robot is reduced as compared with the case where the force sensor is not attached.

本発明は、上記従来の課題に鑑み創案されたもので、ロボットの可搬能力を維持しながらも精度良く外力を制御することができるようにした、ロボットを提供することを目的とする。   The present invention has been developed in view of the above-described conventional problems, and an object of the present invention is to provide a robot that can control external force with high accuracy while maintaining the portable capability of the robot.

上記課題を解決するため、本発明は、次のように構成した。
本願発明（請求項１）は、管状に形成された円筒部を有する第１アーム構造材と、前記第１アーム構造材に対して回転可能に前記第１アーム構造材の先端側に接続された第２アーム構造材と、前記円筒部の内側に固定され、前記第１アーム構造材に対して前記第２アーム構造材を回転するアクチュエータと、前記円筒部の部材内部に埋設され、当該第１アーム構造材にかかる荷重を測定する荷重センサと、前記荷重センサの検出結果に基づいて、前記アクチュエータの動作を制御するコントローラと、前記円筒部の部材内部のうち前記アクチュエータと対向する領域に形成され、前記荷重センサが配置されるセンサ孔と、前記円筒部の部材内部に形成され、前記荷重センサから前記コントローラに接続されるセンサラインを、前記センサ孔から前記円筒部の延伸方向に沿った経路を経由して前記第１アーム構造材の基端側の内部空間に導入する配線孔と、を備えていることを特徴としている。
また、前記第１アーム構造材の基端側の前記内部空間に前記荷重センサの信号を増幅する増幅器が設置されていることが好ましい（請求項２）。
また、前記アクチュエータは、その回転軸中央に中空孔を有し、当該中空孔には配線が結束されたハーネスが挿通されており、前記増幅器からの配線が前記ハーネスに合流していることが好ましい（請求項３）。
また、前記荷重センサが前記円筒部の断面をなす円の周方向に等間隔で複数配置されていることが好ましい（請求項４）。
また、前記荷重センサが前記円筒部の断面をなす円の周方向に等間隔で３つ配置されていることが好ましい（請求項５）。
また、前記荷重センサは、前記第１アーム構造材の変形による歪みを検出する歪みセンサであることが好ましい（請求項６）。 In order to solve the above problems, the present invention is configured as follows.
The present invention (Claim 1) is connected to the first arm structure material having a cylindrical portion formed in a tubular shape, and to the distal end side of the first arm structure material so as to be rotatable with respect to the first arm structure material. a second arm member is fixed to the inside of the cylindrical portion, and an actuator for rotating said second arm member relative to said first arm member, is embedded in member inside the cylindrical portion, the first A load sensor that measures a load applied to the arm structure material, a controller that controls the operation of the actuator based on a detection result of the load sensor, and a region of the cylindrical portion facing the actuator. a sensor hole in which the load sensor is disposed, is formed on the member inside the cylindrical portion, a sensor line connected to the controller from the load sensor, or the sensor hole It is characterized in that it comprises a and a wiring hole for introducing into the inner space of the base end of the first arm member via a path along the extending direction of the cylindrical portion.
Moreover, it is preferable that an amplifier that amplifies the signal of the load sensor is installed in the internal space on the base end side of the first arm structural member .
Further, the actuator preferably has a hollow hole at the center of the rotation shaft, a harness in which wiring is bound is inserted into the hollow hole, and the wiring from the amplifier is preferably joined to the harness. (Claim 3).
Preferably, a plurality of the load sensors are arranged at equal intervals in a circumferential direction of a circle forming a cross section of the cylindrical portion.
Further, it is preferable that three load sensors are arranged at equal intervals in a circumferential direction of a circle forming a cross section of the cylindrical portion .
The load sensor is preferably a strain sensor that detects strain due to deformation of the first arm structure material.

本発明によれば、荷重センサがアーム構造材の部材内部に埋設されているので、アーム構造材の撓み等を荷重センサが精度良く検出することができる。また、荷重センサを手首部（即ち、アームの先端）設ける必要がないので、手首部にセンサを設けることにより、手首部の寸法が長くなってロボットの可搬能力が低下するという不都合が生じることもない。
さらに、センサラインが配線孔を通ってアームの内部空間に導入されるので、センサラインがアーム構造材により支持され、ロボットが稼動しても配線孔の内部にあってはセンサラインの変形が小さくてすみ、センサラインの変形によるノイズの発生や断線等の不都合を防止することができる。
したがって、簡単で信頼性の高い構成で、ロボットに加わる外力を制御するための最良の形態を提供することができる。 According to the present invention, since the load sensor is embedded in the member of the arm structure material, the load sensor can accurately detect the bending of the arm structure material. Further, since there is no need to provide a load sensor at the wrist (that is, the tip of the arm), providing the sensor at the wrist may cause a disadvantage that the size of the wrist becomes long and the portable capacity of the robot decreases. Nor.
Furthermore, since the sensor line is introduced into the internal space of the arm through the wiring hole, the sensor line is supported by the arm structure material, and even if the robot is operated, the deformation of the sensor line is small within the wiring hole. As a result, it is possible to prevent inconveniences such as generation of noise and disconnection due to deformation of the sensor line.
Therefore, it is possible to provide the best mode for controlling the external force applied to the robot with a simple and reliable configuration.

実施形態にかかるロボットの先端側をより詳細にしめした図The figure which showed the tip side of the robot concerning an embodiment in detail 実施形態にかかるロボットの模式的な正面図Schematic front view of the robot according to the embodiment 図１のＡ−Ａ断面を示す模式的な断面図Typical sectional drawing which shows the AA cross section of FIG.

以下、本発明の実施の形態について図を参照して説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings.

図２に示すように、本実施形態にかかるロボット（アーム）９は、基台１，アーム構造材２〜７，フランジ部８，アクチュエータ（関節部）１１〜１７及びコントローラ２０を有して構成されている。なお、これらの基台１，アーム構造材２〜７及びアクチュエータ（関節部）１１〜１７で多関節のアームが形成される。
基台１は、フロア（あるいは、天井等の固定面）に図示しないアンカーボルトで固定されている。
アーム構造材２〜７は、例えば、金属鋳物等で形成された構造支持部材であり、それぞれ基台１から順に直列に配置されている。 As shown in FIG. 2, the robot (arm) 9 according to this embodiment includes a base 1, arm structure materials 2 to 7, a flange portion 8, actuators (joint portions) 11 to 17, and a controller 20. Has been. The base 1, the arm structural members 2 to 7 and the actuators (joint portions) 11 to 17 form an articulated arm.
The base 1 is fixed to a floor (or a fixed surface such as a ceiling) with anchor bolts (not shown).
The arm structural members 2 to 7 are structural support members formed of, for example, a metal casting or the like, and are arranged in series from the base 1 in order.

基台１とアーム構造材２との間には、基台１とアーム構造材２とを矢印１１Ａ方向に回転可能なアクチュエータ（関節部）１１が介装されている。また、各アーム構造材２〜７の連結部にはそれぞれアクチュエータ１２〜１６が介装されている。さらに、アーム構造材７の先端側にはアクチュエータ１７が内蔵されている。
各アクチュエータ１１〜１７はそれぞれサーボモータ及び減速機並びにブレーキを有しており、制御装置２０からの信号に応じて動作を制御されるようになっている。 Between the base 1 and the arm structure material 2, an actuator (joint portion) 11 capable of rotating the base 1 and the arm structure material 2 in the direction of an arrow 11A is interposed. Actuators 12 to 16 are interposed in the connecting portions of the arm structural members 2 to 7, respectively. Furthermore, an actuator 17 is built in the distal end side of the arm structural member 7.
Each actuator 11-17 has a servomotor, a reduction gear, and a brake, respectively, and operation | movement is controlled according to the signal from the control apparatus 20. FIG.

即ち、アクチュエータ１１の駆動によりアーム構造材２とこれに支持されているアーム構造材３〜７が矢印１１Ａ方向に旋回し、アクチュエータ１２の駆動によりアーム構造材３とこれに支持されているアーム構造材４〜７が矢印１２Ａ方向に旋回し、アクチュエータ１３の駆動によりアーム構造材４とこれに支持されているアーム構造材５〜７が矢印１３Ａ方向に旋回し、アクチュエータ１４の駆動によりアーム構造材５とこれに支持されているアーム構造材６，７が矢印１４Ａ方向に旋回し、アクチュエータ１５の駆動によりアーム構造材６とこれに支持されているアーム構造材７が矢印１５Ａ方向に旋回し、アクチュエータ１６の駆動によりアーム構造材が矢印１６Ａ方向に旋回するようになっている。
また、アクチュエータ１７の駆動によりフランジ８が矢印１７Ａ方向に旋回するようになっている。なお、隣接するアクチュエータ１１〜１７の回転軸は互いに直交している。 That is, the arm structure material 2 and the arm structure materials 3 to 7 supported on the arm structure material 2 and the arm structure materials 3 to 7 supported by the actuator 11 are rotated in the direction of the arrow 11A, and the arm structure material 3 and the arm structure supported on the arm structure material 3 are driven. The members 4 to 7 are turned in the direction of the arrow 12A, and the arm structure member 4 and the arm structure members 5 to 7 supported by the actuator 13 are turned in the direction of the arrow 13A. 5 and the arm structure materials 6 and 7 supported by the arm structure material 6 and 7 rotate in the direction of the arrow 14A, and by driving the actuator 15, the arm structure material 6 and the arm structure material 7 supported by the arm structure material 7 rotate in the direction of the arrow 15A. The arm structure is turned in the direction of the arrow 16 </ b> A by driving the actuator 16.
Further, the drive of the actuator 17 turns the flange 8 in the direction of the arrow 17A. Note that the rotation axes of the adjacent actuators 11 to 17 are orthogonal to each other.

フランジ８には、図示省略の冶具が設けられており、フランジ８に冶具を介してエンドエフェクタを着脱できるようになっている。
ロボット９（制御装置２０）は、各アクチュエータ１１〜１７と、フランジ８に装着される図示しない種々のエンドエフェクタとの動作をそれぞれ制御して、嵌合作業、力倣い作業、押し付け作業等の種々の作業を行うようになっている。これらの力制御についての詳細な説明については省略する。 An unillustrated jig is provided on the flange 8 so that an end effector can be attached to and detached from the flange 8 via the jig.
The robot 9 (control device 20) controls the operations of the actuators 11 to 17 and various end effectors (not shown) attached to the flange 8 to perform various operations such as fitting work, force copying work, and pressing work. Work to do. A detailed description of these force controls will be omitted.

各アクチュエータ１１〜１７はそれぞれ回転軸１１Ａ〜１７Ａ中央に中空孔が設けられており、各中空孔には、それぞれアクチュエータ１１〜１７及びエンドエフェクタに接続される配線が結束されたハーネス１９が挿通されている。また、ハーネス１９は基台１からロボット９の外部へ導出され、制御装置２０及び図示しない電源装置に接続されている。   Each actuator 11-17 is provided with a hollow hole in the center of each of the rotation shafts 11A-17A, and a harness 19 in which wires connected to the actuators 11-17 and the end effector are respectively bundled is inserted into each hollow hole. ing. The harness 19 is led out from the base 1 to the outside of the robot 9 and connected to the control device 20 and a power supply device (not shown).

図１に示すように、ロボット９の最も先端側のアーム構造材７とアーム構造材７を支持するアーム構造材６の部材内部には、それぞれセンサ（荷重センサ）２１，２２が埋設されている。
各センサ２１,２２は、歪み量を測定可能な歪みセンサであり、それぞれアーム構造材６，７の変形量を測定できるようになっている。 As shown in FIG. 1, sensors (load sensors) 21 and 22 are embedded in the arm structure material 7 that supports the arm structure material 7 on the most distal side of the robot 9 and the arm structure material 6 that supports the arm structure material 7, respectively. .
Each of the sensors 21 and 22 is a strain sensor capable of measuring the amount of strain, and can measure the amount of deformation of the arm structural members 6 and 7, respectively.

より詳しく説明すると、図３にも示すように、センサ２１は、アクチュエータ１７を支持するように円筒状に形成されたアーム構造材７の円筒部７Ａの部材内部に設けられたセンサ設置用孔２１Ａの内部に配設されている。また、センサ２１は円筒部７Ａの断面をなす円の径方向（アクチュエータ１７の回転軸を中心とする円弧）に沿って３箇所等間隔に設置されている。
これら３個のセンサ２１により３箇所の変形量から制御装置２０により各方向Ｆｘ、Ｆｙ、Ｆｚ（Ｆｘ、Ｆｙ、Ｆｚは互いに直交する）の３方向成分の力を算出するようになっている。
なお、断面を図示していないが、センサ２２は、アクチュエータ１６を支持するアーム構造材６の円筒部６Ａの部材内部に設けられたセンサ設置用孔の内部に３箇所等間隔に設置されている。 More specifically, as shown in FIG. 3, the sensor 21 includes a sensor installation hole 21 </ b> A provided in the member of the cylindrical portion 7 </ b> A of the arm structure material 7 formed in a cylindrical shape so as to support the actuator 17. Is disposed inside. Further, the sensors 21 are installed at three equal intervals along the radial direction of the circle forming the cross section of the cylindrical portion 7A (an arc centered on the rotation axis of the actuator 17).
These three sensors 21 calculate the forces of the three direction components in the respective directions Fx, Fy, and Fz (Fx, Fy, and Fz are orthogonal to each other) from the deformation amount at three locations.
Although not shown in cross section, the sensors 22 are installed at equal intervals at three locations in the sensor installation holes provided in the member of the cylindrical portion 6A of the arm structural member 6 that supports the actuator 16. .

各センサ２１のセンサ設置用孔２１Ａからは、ロボット９の基端側には配線用の配線孔２１Ｂが設けられ、センサ２１からの配線（以下、センサラインという）２１Ｃをアクチュエータ１７よりも基端側のアーム構造材７内部空間側に導くようになっている。
また、アクチュエータ１７よりも基端側のアーム構造材７内部空間には、センサライン２１Ｃからの信号を増幅するアンプ１０が各センサライン２１Ｂに対応して設けられており、各アンプ１０からの配線はハーネス１９に合流するようになっている。 A wiring hole 21 </ b> B for wiring is provided on the base end side of the robot 9 from the sensor installation hole 21 </ b> A of each sensor 21, and the wiring (hereinafter referred to as sensor line) 21 </ b> C from the sensor 21 is connected to the base end of the actuator 17. The arm structure material 7 on the side is guided to the internal space side.
In addition, an amplifier 10 that amplifies a signal from the sensor line 21 </ b> C is provided corresponding to each sensor line 21 </ b> B in the internal space of the arm structure material 7 closer to the proximal end than the actuator 17. Are joined to the harness 19.

同様に各センサ２２のセンサ設置用孔からは、ロボット９の基端側には配線用の配線孔が設けられ、センサ２２からのセンサラインがアクチュエータ１６よりも基端側のアーム構造材６の内部空間側に導かれ当該内部空間には、センサラインからの信号を増幅するアンプ１０が設けられ、各アンプ１０からの配線はハーネス１９に合流するようになっている。   Similarly, from the sensor installation hole of each sensor 22, a wiring hole for wiring is provided on the proximal end side of the robot 9, and the sensor line from the sensor 22 is connected to the arm structure material 6 on the proximal end side of the actuator 16. An amplifier 10 that is guided to the internal space side and amplifies the signal from the sensor line is provided in the internal space, and the wiring from each amplifier 10 is joined to the harness 19.

本実施形態のロボットはこのように構成されているので、アクチュエータ１７の周囲に等間隔に配置された３個のセンサ２１により、アクチュエータを支持する円筒部７Ａにおいて、アーム構造材７に生じる撓み（歪み）からアーム構造材７により支持される力を精度良く検出することができる。
また、各センサ２１からのセンサライン２１Ｃがアーム構造材７の部材内部に設けられた配線孔２１Ｂを通ってアクチュエータ１７の基端側のスペースまで導かれるので、ロボット９が動作してもセンサライン２１Ｃがアーム構造材７により支持されるため、過度な変形が生じることなく、安定して外力を検出することができる。 Since the robot according to the present embodiment is configured as described above, the three sensors 21 arranged at equal intervals around the actuator 17 cause the bending of the arm structure material 7 in the cylindrical portion 7A that supports the actuator ( It is possible to accurately detect the force supported by the arm structural member 7 from the distortion.
Further, since the sensor line 21C from each sensor 21 is led to the space on the proximal end side of the actuator 17 through the wiring hole 21B provided in the member of the arm structural member 7, the sensor line is also detected even if the robot 9 operates. Since 21C is supported by the arm structural member 7, the external force can be detected stably without causing excessive deformation.

以上、本発明の実施の形態について説明したが、本発明にかかるロボットは上述の実施形態のものに限定されるものではなく、本発明の趣旨を逸脱しない範囲で適宜変形して適用可能である。
例えば、上述の実施形態では荷重センサをアクチュエータの回転軸を中心とする円弧に沿って３個等間隔に配置しているが、センサの数量や設置の場所について実施形態のものに限定されるものではない。
また、実施形態では、荷重センサをロボット先端側の２個のアーム構造材にのみ取付けた例について説明したが、荷重センサは一のアーム構造材にのみ取り付けてもよく、また、全てのアーム構造材（基台も含む）に取り付けてもよい。 Although the embodiment of the present invention has been described above, the robot according to the present invention is not limited to the above-described embodiment, and can be appropriately modified and applied without departing from the spirit of the present invention. .
For example, in the above-described embodiment, three load sensors are arranged at equal intervals along an arc centered on the rotation axis of the actuator, but the number of sensors and the place of installation are limited to those of the embodiment. is not.
Further, in the embodiment, the example in which the load sensor is attached only to the two arm structure members on the robot front end side has been described. However, the load sensor may be attached to only one arm structure material, and all the arm structures It may be attached to a material (including a base).

１ 基台
２〜７ アーム構造材
７Ａ 円筒部
８ フランジ
９ ロボット
１０ アンプ
１１〜１７ アクチュエータ
１９ ハーネス
２０ 制御装置
２１，２２ センサ（荷重センサ）
２１Ａ センサ（荷重センサ）
２１Ｂ 配線孔
２１Ｃ センサライン DESCRIPTION OF SYMBOLS 1 Base 2-7 Arm structure material 7A Cylindrical part 8 Flange 9 Robot 10 Amplifier 11-17 Actuator 19 Harness 20 Controller 21, 22 Sensor (Load sensor)
21A sensor (load sensor)
21B Wiring hole 21C Sensor line

Claims (6)

管状に形成された円筒部を有する第１アーム構造材と、
前記第１アーム構造材に対して回転可能に前記第１アーム構造材の先端側に接続された第２アーム構造材と、
前記円筒部の内側に固定され、前記第１アーム構造材に対して前記第２アーム構造材を回転するアクチュエータと、
前記円筒部の部材内部に埋設され、当該第１アーム構造材にかかる荷重を測定する荷重センサと、
前記荷重センサの検出結果に基づいて、前記アクチュエータの動作を制御するコントローラと、
前記円筒部の部材内部のうち前記アクチュエータと対向する領域に形成され、前記荷重センサが配置されるセンサ孔と、
前記円筒部の部材内部に形成され、前記荷重センサから前記コントローラに接続されるセンサラインを、前記センサ孔から前記円筒部の延伸方向に沿った経路を経由して前記第１アーム構造材の基端側の内部空間に導入する配線孔と、を備えている
ことを特徴とする、ロボット。 A first arm structural member having a cylindrical portion formed in a tubular shape;
A second arm structure material connected to a distal end side of the first arm structure material so as to be rotatable with respect to the first arm structure material;
An actuator that is fixed to the inside of the cylindrical portion and rotates the second arm structural member relative to the first arm structural member;
A load sensor embedded in a member of the cylindrical portion and measuring a load applied to the first arm structure material;
A controller for controlling the operation of the actuator based on the detection result of the load sensor;
A sensor hole formed in a region facing the actuator in a member of the cylindrical portion, and the load sensor is disposed;
Is formed on the member inside the cylindrical portion, wherein a sensor line connected to the controller from the load sensor via the path along the extending direction of the cylindrical portion from the sensor holes of the first arm member group And a wiring hole introduced into the internal space on the end side . 前記第１アーム構造材の基端側の前記内部空間に前記荷重センサの信号を増幅する増幅器が設置されている
ことを特徴とする、請求項１記載のロボット。 The robot according to claim 1, wherein an amplifier that amplifies a signal of the load sensor is installed in the internal space on the base end side of the first arm structural member . 前記アクチュエータは、その回転軸中央に中空孔を有し、当該中空孔には配線が結束されたハーネスが挿通されており、The actuator has a hollow hole in the center of the rotation shaft, and a harness in which wiring is bundled is inserted in the hollow hole,
前記増幅器からの配線が前記ハーネスに合流しているWiring from the amplifier joins the harness
ことを特徴とする請求項２記載のロボット。The robot according to claim 2. 前記荷重センサが前記円筒部の断面をなす円の周方向に等間隔で複数配置されている
ことを特徴とする、請求項１〜３のいずれか１項に記載のロボット。 4. The robot according to claim 1, wherein a plurality of the load sensors are arranged at equal intervals in a circumferential direction of a circle forming a cross section of the cylindrical portion. 前記荷重センサが前記円筒部の断面をなす円の周方向に等間隔で３つ配置されているThree load sensors are arranged at equal intervals in a circumferential direction of a circle forming a cross section of the cylindrical portion.
ことを特徴とする、請求項１〜３のいずれか１項に記載のロボット。The robot according to any one of claims 1 to 3, wherein the robot is characterized by that. 前記荷重センサは、前記第１アーム構造材の変形による歪みを検出する歪みセンサである
ことを特徴とする、請求項１〜５のいずれか１項に記載のロボット。 The robot according to claim 1, wherein the load sensor is a strain sensor that detects strain due to deformation of the first arm structure material.
JP2009161513A 2009-07-08 2009-07-08 robot Expired - Fee Related JP5353500B2 (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2009161513A JP5353500B2 (en) 2009-07-08 2009-07-08 robot
EP10167856A EP2272636A2 (en) 2009-07-08 2010-06-30 Robot
CN2010102202014A CN101947782B (en) 2009-07-08 2010-07-06 Robot
US12/832,018 US8396596B2 (en) 2009-07-08 2010-07-07 Robot with load sensor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2009161513A JP5353500B2 (en) 2009-07-08 2009-07-08 robot

Publications (2)

Publication Number Publication Date
JP2011016183A JP2011016183A (en) 2011-01-27
JP5353500B2 true JP5353500B2 (en) 2013-11-27

Family

ID=42988508

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2009161513A Expired - Fee Related JP5353500B2 (en) 2009-07-08 2009-07-08 robot

Country Status (4)

Country Link
US (1) US8396596B2 (en)
EP (1) EP2272636A2 (en)
JP (1) JP5353500B2 (en)
CN (1) CN101947782B (en)

Families Citing this family (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE112010003206A5 (en) * 2009-08-04 2012-05-24 Majatronic Gmbh parallel robot
JP5499647B2 (en) * 2009-11-10 2014-05-21 株式会社安川電機 Robot and robot system
EP2572837B1 (en) * 2010-08-31 2014-06-11 Kabushiki Kaisha Yaskawa Denki Robot, robot system, robot control device, and state determining method
CN102452079A (en) * 2010-10-27 2012-05-16 鸿富锦精密工业（深圳）有限公司 Robot arm part
IT1404527B1 (en) * 2011-02-24 2013-11-22 Comau Spa ARTICULATED ROBOT WRIST.
IT1404528B1 (en) * 2011-02-24 2013-11-22 Comau Spa ARTICULATED ROBOT WRIST.
JP5895628B2 (en) * 2012-03-15 2016-03-30 株式会社ジェイテクト ROBOT CONTROL METHOD, ROBOT CONTROL DEVICE, AND ROBOT CONTROL SYSTEM
JP5346105B2 (en) 2012-03-27 2013-11-20 ファナック株式会社 Striatum processing equipment
KR101438513B1 (en) * 2013-01-24 2014-09-12 한국원자력연구원 Actuator module of two-far-end supported for snake robots using inside wiring
US9884426B2 (en) 2013-06-27 2018-02-06 De-Sta-Co Europe Gmbh Boom utilized in a geometric end effector system
CN104339365B (en) * 2013-07-26 2017-04-12 株式会社安川电机 Robot and manufacturing method of same
JP5928416B2 (en) 2013-07-26 2016-06-01 株式会社安川電機 Robot and robot manufacturing method
CN104385265A (en) * 2014-07-02 2015-03-04 中国科学院合肥物质科学研究院 Robot with redundant degree of freedom
US20180111275A1 (en) * 2014-08-01 2018-04-26 Kugar Inc. Modular system for constructing robots
JP2016068203A (en) * 2014-09-30 2016-05-09 セイコーエプソン株式会社 robot
JP6498140B2 (en) 2016-03-15 2019-04-10 平田機工株式会社 Work unit and work device
EP3585573B1 (en) 2017-02-22 2023-04-12 ABB Schweiz AG Industrial robot system with supervision sensor
CN107097214A (en) * 2017-05-23 2017-08-29 上海智殷自动化科技有限公司 The Wiring structure of wire needed for a kind of seven freedom industrial robot
JP2019098407A (en) 2017-11-28 2019-06-24 ファナック株式会社 robot
JP2022139292A (en) * 2021-03-11 2022-09-26 川崎重工業株式会社 Robot system and assembly method of the same

Family Cites Families (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4621332A (en) * 1983-06-20 1986-11-04 Hitachi, Ltd. Method and apparatus for controlling a robot utilizing force, position, velocity, spring constant, mass coefficient, and viscosity coefficient
US4973215A (en) * 1986-02-18 1990-11-27 Robotics Research Corporation Industrial robot with servo
JPH074526Y2 (en) * 1988-03-22 1995-02-01 三菱重工業株式会社 Force detector
JPH03117582A (en) * 1989-09-28 1991-05-20 Toyota Central Res & Dev Lab Inc Torque detecting device and torque control device for manipulator
DE4336773C2 (en) * 1993-10-28 1997-09-11 Bosch Gmbh Robert Device for measuring pressures, forces and moments
JP3077514B2 (en) * 1994-06-28 2000-08-14 トヨタ自動車株式会社 robot
JPH08118284A (en) * 1994-10-26 1996-05-14 Toshiba Corp Industrial robot
JPH08150580A (en) * 1994-11-29 1996-06-11 Toshiba Corp Industrial robot
SE508817C2 (en) * 1996-06-12 1998-11-09 Asea Brown Boveri Device at a robotic arm
JP3383614B2 (en) 1999-08-04 2003-03-04 技術研究組合医療福祉機器研究所 Impedance control device for horizontal articulated robot arm
JP2002082001A (en) * 2000-09-07 2002-03-22 Akira Maekawa Cylindrical force gauge
CN1208565C (en) * 2003-02-28 2005-06-29 浙江大学 Piezoelectric intelligent torsional control lever
JP3727937B2 (en) * 2003-09-30 2005-12-21 株式会社東芝 Force detection device and manipulator
JP2005144610A (en) * 2003-11-17 2005-06-09 Fanuc Ltd Sensor cable wiring processing structure
CN1325229C (en) * 2004-07-02 2007-07-11 浙江大学 Dress-able type flexible exoskeleton manipulator
US7752920B2 (en) * 2005-12-30 2010-07-13 Intuitive Surgical Operations, Inc. Modular force sensor
EP1764192B1 (en) * 2005-09-16 2009-11-25 Abb Ab An industrial robot with sensor means in the region of a tool flange
KR101323918B1 (en) * 2005-09-27 2013-10-31 가부시키가이샤 야스카와덴키 Multi-joint manipulator
JP2007118176A (en) * 2005-09-27 2007-05-17 Yaskawa Electric Corp Mobile manipulator
JP5146641B2 (en) * 2007-06-06 2013-02-20 株式会社安川電機 Substrate transfer robot and control method of substrate transfer robot
JP4271249B2 (en) * 2007-06-14 2009-06-03 ファナック株式会社 Mating device

Also Published As

Publication number Publication date
US20110010011A1 (en) 2011-01-13
US8396596B2 (en) 2013-03-12
JP2011016183A (en) 2011-01-27
EP2272636A2 (en) 2011-01-12
CN101947782A (en) 2011-01-19
CN101947782B (en) 2012-08-08

Similar Documents

Publication Publication Date Title
JP5353500B2 (en) robot
CN108463315B (en) Drive mechanism, robot arm, robot system, and method of manufacturing product
JP4625110B2 (en) Grasp type hand
JP5400473B2 (en) Robot equipment
KR101382815B1 (en) Horizontal articulated robot
US7445260B2 (en) Gripping type hand
JP6598495B2 (en) ROBOT DEVICE, CONTROL PROGRAM, RECORDING MEDIUM, ROBOT DEVICE CONTROL METHOD, AND ARTICLE MANUFACTURING METHOD
JP2533027B2 (en) Autonomous mobile piping maintenance robot
US10603798B2 (en) Robot
KR20000060115A (en) Master device having force reflective function
JP7319105B2 (en) Rotary axis structure and robot
JP2018099743A (en) Bend correction method for robot and control device for robot
JP2019162700A (en) Cable clamp and robot
JP6535976B2 (en) robot
JP5312917B2 (en) Oscillating rotation test equipment
JP2020091022A (en) Link operating device
JP2019030923A (en) Robot arm, robot device, and robot system
JP2003181782A (en) Industrial robot
JP7469523B2 (en) Displacement detection sensor, control device, and control system
JP5381039B2 (en) Articulated manipulator tip position control method and articulated manipulator
JP2008173757A (en) Five joints link type haptic device
WO2024122047A1 (en) Force sensor
WO2022186050A1 (en) Coupling device and robot
JP2023061648A (en) Robot system, robot system control method, article manufacturing method using robot system, shielding plate, control program and recording medium
JP2023061647A (en) Robot system, robot system control method, article manufacturing method using robot system, low friction member, control program and recording medium

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20120229

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20120316

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20130315

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130319

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130501

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20130730

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130812

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees