[go: up one dir, main page]

JP2013169628A - Torque limit mechanism, driving device and robot device - Google Patents

Torque limit mechanism, driving device and robot device Download PDF

Info

Publication number
JP2013169628A
JP2013169628A JP2012036238A JP2012036238A JP2013169628A JP 2013169628 A JP2013169628 A JP 2013169628A JP 2012036238 A JP2012036238 A JP 2012036238A JP 2012036238 A JP2012036238 A JP 2012036238A JP 2013169628 A JP2013169628 A JP 2013169628A
Authority
JP
Japan
Prior art keywords
rotational force
limiting mechanism
torque limiting
driven shaft
unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP2012036238A
Other languages
Japanese (ja)
Inventor
Masahiko Yomoto
雅彦 與本
Yasushi Ono
康 大野
Susumu Makinouchi
進 牧野内
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.)
Nikon Corp
Original Assignee
Nikon 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 Nikon Corp filed Critical Nikon Corp
Priority to JP2012036238A priority Critical patent/JP2013169628A/en
Publication of JP2013169628A publication Critical patent/JP2013169628A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

【課題】衝突時や挟み込み発生時等における人や物などの周囲の作業環境への損傷などを低減すること。
【解決手段】回転駆動軸の回転力を被駆動軸に伝達する伝達部と、回転駆動軸と被駆動軸とに対して相対的な変位を生じさせる許容値に基づき、伝達部による回転力の伝達状態を調整可能な調整部と、所定の較正動作によって得られる較正情報に応じて、許容値を変更可能な制御部とを備える。
【選択図】図1
[PROBLEMS] To reduce damage to a surrounding work environment such as a person or an object at the time of a collision or occurrence of pinching.
A transmission unit that transmits a rotational force of a rotary drive shaft to a driven shaft, and an allowable value that causes a relative displacement between the rotary drive shaft and the driven shaft. An adjustment unit capable of adjusting a transmission state and a control unit capable of changing an allowable value according to calibration information obtained by a predetermined calibration operation.
[Selection] Figure 1

Description

本発明は、トルク制限機構、駆動装置及びロボット装置に関する。   The present invention relates to a torque limiting mechanism, a drive device, and a robot device.

近年、例えば工業分野に限られず、医療や福祉などの広い産業分野において、作業者の負担軽減等を目的として、ロボット装置が用いられている。このようなロボット装置は、例えば、関節部を介して複数の腕部が接続される構成になっている(例えば、特許文献1参照)。このようなロボット装置において、ロボット装置周囲の人や物が腕部に挟み込まれた場合に駆動トルクを低減して、挟み込まれた人や物及びロボット装置の損傷を低減する構成が知られている。   In recent years, for example, robot devices are used not only in the industrial field but also in a wide range of industrial fields such as medical care and welfare in order to reduce the burden on workers. Such a robot apparatus is configured, for example, such that a plurality of arm portions are connected via joint portions (see, for example, Patent Document 1). In such a robot apparatus, a configuration is known in which when a person or object around the robot apparatus is sandwiched between arms, the driving torque is reduced to reduce damage to the sandwiched person or object and the robot apparatus. .

特開2004−188535号公報JP 2004-188535 A

しかしながら、上述のようなロボット装置は、例えば、人や物への衝突を検出した後或いは人や物の挟み込みを検出した後などに駆動トルクを低減するための動作を行う場合、衝突発生や挟み込み発生から駆動トルクの低減までに時間がかかり、衝突時や挟み込み発生時等における人や物などの周囲の作業環境への損傷を低減することが難しいという問題があった。   However, when the robot apparatus as described above performs an operation for reducing the driving torque after detecting a collision with a person or an object or after detecting an object or object being caught, There is a problem that it takes time from generation to reduction of driving torque, and it is difficult to reduce damage to surrounding work environments such as people and objects at the time of collision or occurrence of pinching.

本発明は、上記問題を解決すべくなされたもので、その目的は、例えば衝突時や挟み込み発生時の損傷を低減することができるトルク制限装置、駆動装置及びロボット装置を提供することにある。   The present invention has been made to solve the above problems, and an object of the present invention is to provide a torque limiting device, a driving device, and a robot device that can reduce, for example, damage at the time of collision or occurrence of pinching.

本発明の第一の態様に従えば、回転駆動軸の回転力を被駆動軸に伝達する伝達部と、回転駆動軸と被駆動軸とに対して相対的な変位を生じさせる許容値に基づき、伝達部による回転力の伝達状態を調整可能な調整部と、所定の較正動作によって得られる較正情報に応じて、許容値を変更可能な制御部とを備えるトルク制限機構が提供される。   According to the first aspect of the present invention, based on a transmission unit that transmits the rotational force of the rotary drive shaft to the driven shaft, and an allowable value that causes a relative displacement between the rotary drive shaft and the driven shaft. A torque limiting mechanism is provided that includes an adjustment unit that can adjust the transmission state of the rotational force by the transmission unit, and a control unit that can change an allowable value according to calibration information obtained by a predetermined calibration operation.

本発明の第二の態様に従えば、本発明の第一の態様に従うトルク制限機構と、回転駆動軸を回転させる駆動部と、を備える駆動装置が提供される。   According to the second aspect of the present invention, there is provided a drive device including the torque limiting mechanism according to the first aspect of the present invention and a drive unit that rotates the rotary drive shaft.

本発明の第三の態様に従えば、本発明の第一の態様に従うトルク制限機構を備えるロボット装置が提供される。   According to a third aspect of the present invention, there is provided a robot apparatus provided with a torque limiting mechanism according to the first aspect of the present invention.

本発明によれば、衝突時や挟み込み発生時等における人や物などの周囲の作業環境への損傷などを低減することができる。   ADVANTAGE OF THE INVENTION According to this invention, the damage to the surrounding work environment, such as a person and an object at the time of a collision, the occurrence of pinching, etc. can be reduced.

本発明の第一実施形態に係る駆動装置の構成の一例を示す構成図。The block diagram which shows an example of a structure of the drive device which concerns on 1st embodiment of this invention. 本実施形態におけるトルク制限機構の構成の一例を示す断面図Sectional drawing which shows an example of a structure of the torque limitation mechanism in this embodiment. 本実施形態における回転力の伝達経路の一例を示す断面図。Sectional drawing which shows an example of the transmission path | route of the rotational force in this embodiment. 本実施形態におけるトルク制限機構の特性の一例を示すグラフ。The graph which shows an example of the characteristic of the torque limiting mechanism in this embodiment. 本実施形態における制御部が駆動装置を制御する構成の一例を示す構成図。The block diagram which shows an example of the structure which the control part in this embodiment controls a drive device. 本実施形態における相対的なすべりの上限値の変化の一例を示すグラフ。The graph which shows an example of the change of the upper limit of the relative slip in this embodiment. 本実施形態における較正動作の一例を示す図。The figure which shows an example of the calibration operation | movement in this embodiment. 本実施形態における較正動作の一例を示す図。The figure which shows an example of the calibration operation | movement in this embodiment. 本発明の第二実施形態に係るロボット装置の構成の一例を示す構成図。The block diagram which shows an example of a structure of the robot apparatus which concerns on 2nd embodiment of this invention.

[第一実施形態]
以下、図面を参照して、本発明の第一の実施形態を説明する。
図1は、本発明の第一の実施形態に係るトルク制限機構120及び駆動装置100を備えるロボット装置200の構成の一例を示す構成図である。
[First embodiment]
Hereinafter, a first embodiment of the present invention will be described with reference to the drawings.
FIG. 1 is a configuration diagram illustrating an example of a configuration of a robot apparatus 200 including a torque limiting mechanism 120 and a driving apparatus 100 according to the first embodiment of the present invention.

本実施形態のロボット装置200は、固定部10と、可動部20(被駆動部)と、駆動装置100と、上位装置80とを備えている。
固定部10は、駆動装置100及び可動部20を支持する支持部材であり、例えば、床に固定されている。
The robot apparatus 200 of this embodiment includes a fixed unit 10, a movable unit 20 (driven unit), a driving device 100, and a host device 80.
The fixed unit 10 is a support member that supports the driving device 100 and the movable unit 20, and is fixed to the floor, for example.

可動部20(被駆動部)は、例えば、ロボット装置200の腕(アーム)部分であり、例えば、固定部10に対して移動(例えば、回転移動)される。固定部10と可動部20とは、連結部30において、移動可能(例えば、回転可能)に連結されている。
連結部30は、固定部10と可動部20とを連結しており、この駆動装置100を備えている。
駆動装置100は、駆動部150と、トルク制限機構120とを備えており、固定部10に固定され、可動部20(被駆動部)を移動(例えば、回転移動)させる。
The movable part 20 (driven part) is, for example, an arm part of the robot apparatus 200, and is moved (for example, rotated) with respect to the fixed part 10, for example. The fixed portion 10 and the movable portion 20 are connected to be movable (for example, rotatable) at the connecting portion 30.
The connecting portion 30 connects the fixed portion 10 and the movable portion 20 and includes the driving device 100.
The drive device 100 includes a drive unit 150 and a torque limiting mechanism 120, is fixed to the fixed unit 10, and moves (for example, rotates) the movable unit 20 (driven unit).

本実施形態において上位装置80は、例えば、ロボット装置200の制御用コンピュータである。この上位装置80は、駆動ドライバを備えており、駆動装置100の駆動部150に対して、可動部20(被駆動部)を移動(例えば、回転移動)させる回転力の指令値に応じた、駆動部150を駆動する駆動電流(例えば、駆動電流IT)を出力する。   In the present embodiment, the host device 80 is, for example, a computer for controlling the robot apparatus 200. The host device 80 includes a drive driver, and corresponds to a command value of a rotational force that moves (for example, rotationally moves) the movable unit 20 (driven portion) relative to the drive unit 150 of the drive device 100. A drive current (for example, drive current IT) for driving the drive unit 150 is output.

駆動部150は、上位装置80が出力する駆動電流ITに応じた回転力によって回転駆動軸11を回転させる。本実施形態の駆動部150は、例えば、固定部10の第3軸受部12cに取り付けられ、上位装置80から供給される駆動電流ITに応じた回転力によって回転駆動軸11を回転させる。   The drive unit 150 rotates the rotary drive shaft 11 with a rotational force corresponding to the drive current IT output from the host device 80. The drive unit 150 of the present embodiment is attached to, for example, the third bearing unit 12 c of the fixed unit 10, and rotates the rotary drive shaft 11 with a rotational force according to the drive current IT supplied from the host device 80.

回転駆動軸11は、例えば、駆動部150によって発生された回転力を出力する駆動部150の回転出力軸である。また、回転駆動軸11は、拡径部11aを備えており、固定部10の第一軸受部12a及び第二軸受部12bと、可動部20の第4軸受部22a及び第5軸受部22bと、被駆動軸21とを貫通している。   The rotation drive shaft 11 is, for example, a rotation output shaft of the drive unit 150 that outputs a rotational force generated by the drive unit 150. The rotary drive shaft 11 includes an enlarged diameter portion 11a, and includes a first bearing portion 12a and a second bearing portion 12b of the fixed portion 10, and a fourth bearing portion 22a and a fifth bearing portion 22b of the movable portion 20. It penetrates through the driven shaft 21.

トルク制限機構120は、調整部121と、検出部122とを備えており、回転駆動軸11の回転力を被駆動軸21に伝達可能である。
検出部122は、例えば、トルクセンサを備えており、回転駆動軸11と被駆動軸21との間に伝達される回転力を検出する。
The torque limiting mechanism 120 includes an adjustment unit 121 and a detection unit 122, and can transmit the rotational force of the rotary drive shaft 11 to the driven shaft 21.
The detection unit 122 includes, for example, a torque sensor, and detects a rotational force transmitted between the rotational drive shaft 11 and the driven shaft 21.

被駆動軸21は、回転駆動軸11から伝達された回転力によって回転する回転軸である。本実施形態の被駆動軸21は、例えば、可動部20の第5軸受部22bに接続されており、第5軸受部22bとともに回転する。つまり、可動部20は、被駆動軸21が回転することによって、被駆動軸21を中心にして回転する。   The driven shaft 21 is a rotation shaft that rotates by the rotational force transmitted from the rotation drive shaft 11. The driven shaft 21 of the present embodiment is connected to, for example, the fifth bearing portion 22b of the movable portion 20, and rotates together with the fifth bearing portion 22b. That is, the movable unit 20 rotates about the driven shaft 21 as the driven shaft 21 rotates.

調整部121は、駆動素子131と、伝達部130とを備えており、回転駆動軸11と被駆動軸21との間に伝達される回転力の上限値(許容値)を調整する。
駆動素子131は、一端が可動部20に接続され、他端が伝達部130の一端に接続されており、制御部123から出力される制御信号に基づき変形することによって伝達部130の張力を変化させて、回転駆動軸11及び被駆動軸21に対する伝達部130のグリップ力を変化させる。
The adjustment unit 121 includes a drive element 131 and a transmission unit 130, and adjusts the upper limit value (allowable value) of the rotational force transmitted between the rotary drive shaft 11 and the driven shaft 21.
One end of the drive element 131 is connected to the movable unit 20 and the other end is connected to one end of the transmission unit 130, and the tension of the transmission unit 130 is changed by deformation based on a control signal output from the control unit 123. Thus, the gripping force of the transmission unit 130 with respect to the rotary drive shaft 11 and the driven shaft 21 is changed.

伝達部130は、回転駆動軸11の拡径部11aと被駆動軸21とに対して接触可能にされて(例えば、巻きかけられて)おり、例えば張力(すなわち、伝達部130のグリップ力)に対応する許容値によって回転駆動軸11の回転力を被駆動軸21に伝達する。つまり、回転駆動軸11の拡径部11aから被駆動軸21に伝達されるトルクの許容値は、トルク制限機構120が備える伝達部130のグリップ力によって設定される。   The transmission part 130 is made contactable (for example, wound) with respect to the enlarged diameter part 11a of the rotational drive shaft 11 and the driven shaft 21, for example, tension (that is, grip force of the transmission part 130). The rotational force of the rotary drive shaft 11 is transmitted to the driven shaft 21 by an allowable value corresponding to. That is, the allowable value of torque transmitted from the enlarged diameter portion 11 a of the rotary drive shaft 11 to the driven shaft 21 is set by the grip force of the transmission portion 130 provided in the torque limiting mechanism 120.

制御部123は、後述する上位装置80から供給される回転力指令値を駆動部150に出力する。また、制御部123は、調整部121が調整する上限値を可動部20の負荷及び加速度に応じて設定するとともに、検出部122が検出する回転力と設定されている上限値とに基づいて、上限値の設定を変更する。制御部123は、上記の上限値に基づく制御信号を調整部121に出力する。   The control unit 123 outputs a rotational force command value supplied from the host device 80 described later to the driving unit 150. Further, the control unit 123 sets the upper limit value adjusted by the adjustment unit 121 according to the load and acceleration of the movable unit 20, and based on the rotational force detected by the detection unit 122 and the set upper limit value, Change the upper limit setting. The control unit 123 outputs a control signal based on the above upper limit value to the adjustment unit 121.

次に、図2を参照して、トルク制限機構120が備える調整部121としての駆動素子131と伝達部130との詳細な構成について説明する。
図2は、トルク制限機構120の構成を示す断面図である。
伝達部130は、その端部(第一端部130a、第二端部130b)が、拡径部11a及び被駆動軸21の周方向の基準位置Pを挟むように所定の隙間を空けて対向して配置されている。また、伝達部130の形状は、例えば、帯状又は線状などである。
Next, with reference to FIG. 2, a detailed configuration of the drive element 131 and the transmission unit 130 as the adjustment unit 121 included in the torque limiting mechanism 120 will be described.
FIG. 2 is a cross-sectional view showing the configuration of the torque limiting mechanism 120.
The transmission part 130 is opposed with a predetermined gap so that its end parts (first end part 130a, second end part 130b) sandwich the reference position P in the circumferential direction of the enlarged diameter part 11a and the driven shaft 21. Are arranged. Moreover, the shape of the transmission part 130 is a strip | belt shape or a linear form, for example.

拡径部11aと被駆動軸21とは、例えば、同一の径を有しているため、拡径部11aの外周面と被駆動軸21の外周面との間では段差が発生することが無い。このため、伝達部130と拡径部11aとの間、及び、伝達部130と被駆動軸21との間には、ほぼ同一のグリップ力が発生することになる。   For example, since the enlarged diameter portion 11a and the driven shaft 21 have the same diameter, no step is generated between the outer peripheral surface of the enlarged diameter portion 11a and the outer peripheral surface of the driven shaft 21. . For this reason, substantially the same gripping force is generated between the transmission unit 130 and the enlarged diameter portion 11 a and between the transmission unit 130 and the driven shaft 21.

駆動素子131(本実施形態においては、第一駆動素子131−1及び第二駆動素子131−2)は、伝達部130と拡径部11a及び被駆動軸21との間の接触状態を調整する。第一駆動素子131−1及び第二駆動素子131−2としては、例えば電歪素子(例、ピエゾ素子)や磁歪素子などの電気機械変換素子が用いられている。例えば、第一駆動素子131−1及び第二駆動素子131−2は、駆動電圧が供給されることにより、一方向に伸縮する構成である。   The drive element 131 (in the present embodiment, the first drive element 131-1 and the second drive element 131-2) adjust the contact state between the transmission unit 130, the enlarged diameter portion 11a, and the driven shaft 21. . As the first drive element 131-1 and the second drive element 131-2, for example, an electromechanical conversion element such as an electrostrictive element (eg, a piezo element) or a magnetostrictive element is used. For example, the first drive element 131-1 and the second drive element 131-2 are configured to expand and contract in one direction when a drive voltage is supplied.

第一駆動素子131−1は、伸縮方向の一方の端部が伝達部130の第一端部130aに接続されている。また、第一駆動素子131−1の他方の端部は、可動部20の端面から突出した支持部134に固定されている。したがって、第一駆動素子131−1は、第一端部130aと支持部134とで挟まれた構成となっている。第一駆動素子131−1のうち第一端部130aとの接続部分には、フレクシャ機構132−1が形成されている。   As for the 1st drive element 131-1, one edge part of the expansion-contraction direction is connected to the 1st end part 130a of the transmission part 130. FIG. The other end portion of the first drive element 131-1 is fixed to a support portion 134 protruding from the end surface of the movable portion 20. Therefore, the first drive element 131-1 is configured to be sandwiched between the first end portion 130 a and the support portion 134. A flexure mechanism 132-1 is formed at a connection portion of the first driving element 131-1 with the first end portion 130a.

第二駆動素子131−2は、伸縮方向の一方の端部が伝達部130の第二端部130bに接続されている。また、第二駆動素子131−2の他方の端部は、可動部20の端面から突出した支持部134に固定されている。したがって、第二駆動素子131−2は、第二端部130bと支持部134とで挟まれた構成となっている。第二駆動素子131−2のうち第二端部130bとの接続部分には、フレクシャ機構132−2が形成されている。   The second drive element 131-2 has one end in the expansion / contraction direction connected to the second end 130b of the transmission unit 130. The other end of the second drive element 131-2 is fixed to a support part 134 protruding from the end surface of the movable part 20. Therefore, the second drive element 131-2 is sandwiched between the second end portion 130b and the support portion 134. A flexure mechanism 132-2 is formed at a connection portion of the second drive element 131-2 with the second end portion 130b.

上述したように、制御部123は第一駆動素子131−1及び第二駆動素子131−2に接続されており、当該第一駆動素子131−1及び第二駆動素子131−2に対して駆動電圧を供給可能になっている。制御部123は、第一駆動素子131−1及び第二駆動素子131−2に印加する駆動電圧の電圧値を変化させることにより、第一駆動素子131−1及び第二駆動素子131−2の伸縮量を調整する。   As described above, the control unit 123 is connected to the first drive element 131-1 and the second drive element 131-2, and is driven with respect to the first drive element 131-1 and the second drive element 131-2. The voltage can be supplied. The control unit 123 changes the voltage value of the drive voltage applied to the first drive element 131-1 and the second drive element 131-2 to thereby change the first drive element 131-1 and the second drive element 131-2. Adjust the amount of expansion / contraction.

例えば、第一駆動素子131−1が伸びると、伝達部130の第一端部130aが第二端部130bに近づく方向に移動する。また、第二駆動素子131−2が伸びると、伝達部130の第二端部130bが第一端部130aに近づく方向に移動する。このため、伝達部130が拡径部11aの周面(例、外周面や内周面)及び被駆動軸21の周面(例、外周面や内周面)に巻きつき、当該伝達部130に張力が加わる。第一駆動素子131−1が縮むと、第一端部130aが第二端部130bから離れる方向に移動する。また、第二駆動素子131−2が縮むと、第二端部130bが第一端部130aから離れる方向に移動する。このため、伝達部130が拡径部11a及び被駆動軸21から離れて、伝達部130が弛緩する。このように、例えば、伝達部130は、駆動素子131の駆動(例、伸縮)によって回転駆動軸11の径方向及び被駆動軸21の径方向に力(例、伝達部130のグリップ力や張力、押圧力)が加えられる。これによって、伝達部130と拡径部11aとの間、及び伝達部130と被駆動軸21との間で、それぞれ摩擦力が生じる。なお、本実施形態は、例えば、駆動素子131を縮ませることによって、伝達部130が拡径部11a及び被駆動軸21に巻きついて、当該伝達部130にグリップ力が加わる構成にしてもよい。そして、本実施形態は、駆動素子131が伸びることによって、伝達部130が拡径部11a及び被駆動軸21から離れて弛緩する構成にしてもよい。   For example, when the first drive element 131-1 extends, the first end portion 130 a of the transmission unit 130 moves in a direction approaching the second end portion 130 b. Further, when the second driving element 131-2 extends, the second end portion 130b of the transmission unit 130 moves in a direction approaching the first end portion 130a. For this reason, the transmission unit 130 wraps around the peripheral surface (eg, outer peripheral surface or inner peripheral surface) of the enlarged diameter portion 11 a and the peripheral surface (eg, outer peripheral surface or inner peripheral surface) of the driven shaft 21, and the transmission unit 130. Tension. When the first driving element 131-1 contracts, the first end portion 130a moves in a direction away from the second end portion 130b. When the second driving element 131-2 contracts, the second end portion 130b moves in a direction away from the first end portion 130a. For this reason, the transmission part 130 leaves | separates from the enlarged diameter part 11a and the driven shaft 21, and the transmission part 130 relaxes. In this way, for example, the transmission unit 130 is driven by the drive element 131 (e.g., expansion / contraction) in the radial direction of the rotational drive shaft 11 and the radial direction of the driven shaft 21 (e.g., grip force or tension of the transmission unit 130). , Pressing force) is applied. As a result, frictional forces are generated between the transmission part 130 and the enlarged diameter part 11a and between the transmission part 130 and the driven shaft 21, respectively. In the present embodiment, for example, the driving element 131 may be contracted so that the transmission unit 130 is wound around the enlarged diameter portion 11a and the driven shaft 21, and a gripping force is applied to the transmission unit 130. In the present embodiment, the transmission unit 130 may be separated from the diameter-enlarged portion 11a and the driven shaft 21 to be relaxed when the drive element 131 is extended.

次に、図3を参照して、駆動部150によって発生される回転力が被駆動軸21に伝達される回転力の伝達経路の一例を説明する。
図3は、本実施形態における回転力の伝達経路の一例を示す断面図である。
まず、駆動部150は、所定の回転力を発生させて、発生させた回転力によって回転駆動軸11を回転させる。この回転駆動軸11の回転力は、拡径部11aと、トルク制限機構120の伝達部130との間に生じる摩擦力によって、伝達部130に伝達される(図3のTq1)。次に、伝達部130の回転力は、伝達部130と、被駆動軸21との間に生じる摩擦力によって、被駆動軸21に伝達される(図3のTq2)。このようにして、駆動部150によって発生された回転力は、被駆動軸21に伝達される。上述したように、駆動部150は、固定部10の第3軸受部12cに固定されており、被駆動軸21は、可動部20の第5軸受部22bに固定されている。この回転力によって、可動部20は、固定部10を基準にして回転される。
Next, with reference to FIG. 3, an example of a transmission path of the rotational force through which the rotational force generated by the drive unit 150 is transmitted to the driven shaft 21 will be described.
FIG. 3 is a cross-sectional view showing an example of a rotational force transmission path in the present embodiment.
First, the drive unit 150 generates a predetermined rotational force, and rotates the rotational drive shaft 11 by the generated rotational force. The rotational force of the rotary drive shaft 11 is transmitted to the transmission unit 130 by a frictional force generated between the enlarged diameter portion 11a and the transmission unit 130 of the torque limiting mechanism 120 (Tq1 in FIG. 3). Next, the rotational force of the transmission unit 130 is transmitted to the driven shaft 21 by the frictional force generated between the transmission unit 130 and the driven shaft 21 (Tq2 in FIG. 3). In this way, the rotational force generated by the drive unit 150 is transmitted to the driven shaft 21. As described above, the drive unit 150 is fixed to the third bearing portion 12 c of the fixed portion 10, and the driven shaft 21 is fixed to the fifth bearing portion 22 b of the movable portion 20. Due to this rotational force, the movable part 20 is rotated with reference to the fixed part 10.

次に、本実施形態に係るトルク制限機構120において、回転駆動軸11(拡径部11a)から被駆動軸21へ回転力を伝達し、当該被駆動軸21に回転力を作用させる原理の一例を説明する。被駆動軸21を駆動させる際には、拡径部11a及び被駆動軸21に巻き付いた伝達部130に張力を生じさせて、当該張力によって生じるグリップ力によって拡径部11aと被駆動軸21とを連結する。拡径部11aと被駆動軸21とが伝達部130によって連結されることで、回転駆動軸11から被駆動軸21へと回転力が伝達可能となる。   Next, in the torque limiting mechanism 120 according to the present embodiment, an example of the principle of transmitting the rotational force from the rotational drive shaft 11 (the enlarged diameter portion 11a) to the driven shaft 21 and applying the rotational force to the driven shaft 21. Will be explained. When the driven shaft 21 is driven, tension is generated in the enlarged diameter portion 11a and the transmission portion 130 wound around the driven shaft 21, and the enlarged diameter portion 11a and the driven shaft 21 are caused by the grip force generated by the tension. Are connected. The enlarged diameter portion 11 a and the driven shaft 21 are connected by the transmission portion 130, so that the rotational force can be transmitted from the rotational drive shaft 11 to the driven shaft 21.

オイラーの摩擦ベルト理論により、回転駆動軸11(拡径部11a)及び被駆動軸21に巻き付いた伝達部130の第一端部130a側の張力(T1)及び第二端部130b側の張力(T2)が下記(式1)を満たすとき、伝達部130と拡径部11aとの間、伝達部130と被駆動軸21との間で、それぞれ摩擦力が生じ、伝達部130が拡径部11aの外周面及び被駆動軸21の外周面に対して滑りを生じることの無い状態(接触状態)となる。なお、本実施形態では、伝達部130が短手方向に等しい寸法ずつ拡径部11a及び被駆動軸21に掛けられているため、生じる摩擦力の大きさは、伝達部130と拡径部11aとの間、及び、伝達部130と被駆動軸21との間で、ほぼ等しくなる。   According to Euler's friction belt theory, the tension (T1) on the first end portion 130a side and the tension (T1) on the second end portion 130b side of the transmission portion 130 wound around the rotary drive shaft 11 (expanded diameter portion 11a) and the driven shaft 21 ( When T2) satisfies the following (formula 1), a frictional force is generated between the transmission portion 130 and the enlarged diameter portion 11a, and between the transmission portion 130 and the driven shaft 21, and the transmission portion 130 becomes the enlarged diameter portion. It will be in the state (contact state) which does not produce slip with respect to the outer peripheral surface of 11a, and the outer peripheral surface of the driven shaft 21. FIG. In this embodiment, since the transmission portion 130 is hung on the enlarged diameter portion 11a and the driven shaft 21 by the same dimension in the short direction, the magnitude of the frictional force generated is the transmission portion 130 and the enlarged diameter portion 11a. And between the transmission unit 130 and the driven shaft 21 are substantially equal.

伝達部130は、拡径部11a及び被駆動軸21に対して接触状態となったときに、摩擦力によって回転駆動軸11及び被駆動軸21と共に移動する。この移動により、回転駆動軸11から被駆動軸21に回転力が伝達される。ただし、(式1)において、μは伝達部130と拡径部11a及び被駆動軸21との間の摩擦係数であり、θは伝達部130の有効巻き付き角(接触角度)である。有効巻き付け角θについては、拡径部11aの外周面及び被駆動軸21の外周面のうち伝達部130に対して接触状態となりうる部分の範囲である。   The transmission unit 130 moves together with the rotary drive shaft 11 and the driven shaft 21 by frictional force when being brought into contact with the enlarged diameter portion 11 a and the driven shaft 21. By this movement, a rotational force is transmitted from the rotary drive shaft 11 to the driven shaft 21. However, in (Equation 1), μ is a coefficient of friction between the transmission unit 130, the enlarged diameter portion 11 a and the driven shaft 21, and θ is an effective winding angle (contact angle) of the transmission unit 130. The effective winding angle θ is a range of a portion that can be in contact with the transmission unit 130 on the outer peripheral surface of the enlarged diameter portion 11 a and the outer peripheral surface of the driven shaft 21.

Figure 2013169628
Figure 2013169628

このとき、回転力の伝達に寄与する張力は、(T1−T2)によって表される。上記(式1)に基づいて張力(T1−T2)を求めると、(式2)のようになる。   At this time, the tension that contributes to the transmission of the rotational force is represented by (T1-T2). When the tension (T1-T2) is obtained based on the above (Expression 1), it is expressed as (Expression 2).

Figure 2013169628
Figure 2013169628

上記(式2)より、回転駆動軸11から被駆動軸21に伝達される回転力は、例えば第一駆動素子131−1の伸縮によって伝達部130に生じる張力T1によって一意に決定されることがわかる。(式2)の右辺の張力T1の係数部分は、伝達部130と拡径部11a及び被駆動軸21との間における摩擦係数μ、及び、伝達部130の有効巻き付き角θにそれぞれ依存する。   From the above (Equation 2), the rotational force transmitted from the rotary drive shaft 11 to the driven shaft 21 is uniquely determined by, for example, the tension T1 generated in the transmission unit 130 due to the expansion and contraction of the first drive element 131-1. Recognize. The coefficient portion of the tension T1 on the right side of (Equation 2) depends on the friction coefficient μ between the transmission portion 130, the enlarged diameter portion 11a, and the driven shaft 21, and the effective winding angle θ of the transmission portion 130, respectively.

図4は、オイラーの原理に基づく摩擦係数μを変化させたときの有効巻き付き角θと係数部分の値との関係を示すグラフである。グラフの横軸は有効巻き付き角θを示しており、グラフの縦軸は係数部分の値を示している。図4に示すように、例えば摩擦係数μが0.3の場合には、有効巻き付き角θが300°以上のときに係数部分の値が0.8以上となっている。   FIG. 4 is a graph showing the relationship between the effective winding angle θ and the value of the coefficient portion when the friction coefficient μ based on Euler's principle is changed. The horizontal axis of the graph indicates the effective winding angle θ, and the vertical axis of the graph indicates the value of the coefficient portion. As shown in FIG. 4, for example, when the friction coefficient μ is 0.3, the value of the coefficient portion is 0.8 or more when the effective winding angle θ is 300 ° or more.

このことから、摩擦係数μが0.3の場合には、有効巻き付き角θを300°以上とすることにより、第一駆動素子131−1による張力T1の80%以上の力が被駆動軸21の回転力に寄与することがわかる。この巻き付き角の他(例、180°、270°、360°、360°以上)、図4のグラフから、例えば伝達部130と、拡径部11a及び被駆動軸21との間の摩擦係数を大きくするほど、係数部分の値が大きくなることが推定される。このように、回転駆動軸11から被駆動軸21に伝達される回転力の上限値(許容値)の大きさは第一駆動素子131−1による張力T1によって一意に決定されることになる。したがって、本実施形態におけるトルク制限機構又は制御部は、回転駆動軸11(拡径部11a)及び被駆動軸21に対する伝達部130のグリップ力を緩めること及び締め付けることによって上記回転力の上限値を変更可能である。   From this, when the friction coefficient μ is 0.3, by setting the effective winding angle θ to 300 ° or more, the force of 80% or more of the tension T1 by the first drive element 131-1 is driven shaft 21. It can be seen that this contributes to the rotational force. In addition to the winding angle (eg, 180 °, 270 °, 360 °, 360 ° or more), from the graph of FIG. 4, for example, the friction coefficient between the transmission unit 130, the enlarged diameter portion 11a and the driven shaft 21 is calculated. It is estimated that the larger the value is, the larger the value of the coefficient portion is. Thus, the magnitude of the upper limit value (allowable value) of the rotational force transmitted from the rotary drive shaft 11 to the driven shaft 21 is uniquely determined by the tension T1 by the first drive element 131-1. Therefore, the torque limiting mechanism or the control unit in this embodiment sets the upper limit value of the rotational force by loosening and tightening the gripping force of the transmission unit 130 with respect to the rotational drive shaft 11 (the enlarged diameter portion 11a) and the driven shaft 21. It can be changed.

次に、本実施形態の制御部123が駆動装置100を制御する構成について説明する。   Next, a configuration in which the control unit 123 of the present embodiment controls the driving device 100 will be described.

図5は、本実施形態の制御部123が駆動装置100を制御する構成の一例を示す構成図である。   FIG. 5 is a configuration diagram illustrating an example of a configuration in which the control unit 123 according to the present embodiment controls the driving device 100.

本実施形態において上位装置80は、例えば、ロボット装置200の制御用コンピュータであり、制御部123に対して、回転駆動軸11を回転させる駆動部150の回転力の指令値である回転力指令値(例えば、回転力指令値CT)を出力する。なお、この指令値は、回転駆動軸11の回転位置の指令値や、回転駆動軸11の回転速度の指令値であってもよい。   In the present embodiment, the host device 80 is, for example, a computer for controlling the robot device 200, and a rotational force command value that is a rotational force command value of the drive unit 150 that rotates the rotational drive shaft 11 with respect to the control unit 123. (For example, a rotational force command value CT) is output. The command value may be a command value for the rotational position of the rotary drive shaft 11 or a command value for the rotational speed of the rotary drive shaft 11.

制御部123は、上位装置80に接続されており、上位装置80が出力する、回転力指令値CTを取得する。また、制御部123は、上位装置80から取得した駆動部150の回転力指令値CTに応じた、駆動部150を駆動する駆動電流(例えば、駆動電流IT)を駆動部150に出力する。また、制御部123は、回転駆動軸11の回転力を被駆動軸21に伝達可能なトルク制限機構120が有する調整部121が調整する回転力の上限値を設定する。また、制御部123は、検出部122が検出する被駆動軸21の回転力(例えば、回転駆動軸11から被駆動軸21に伝達された回転力)と設定されている上限値とに基づいて、上限値の設定を変更する。   The control unit 123 is connected to the host device 80 and acquires a rotational force command value CT output from the host device 80. In addition, the control unit 123 outputs a drive current (for example, drive current IT) for driving the drive unit 150 according to the rotational force command value CT of the drive unit 150 acquired from the host device 80 to the drive unit 150. Further, the control unit 123 sets an upper limit value of the rotational force adjusted by the adjustment unit 121 included in the torque limiting mechanism 120 that can transmit the rotational force of the rotational drive shaft 11 to the driven shaft 21. Further, the control unit 123 is based on the rotational force of the driven shaft 21 detected by the detection unit 122 (for example, the rotational force transmitted from the rotational drive shaft 11 to the driven shaft 21) and the set upper limit value. Change the upper limit setting.

本実施形態の制御部123は、例えば、モータドライバ123aと、クラッチ制御部123bと、回転力検出部123cとを備えている。この、モータドライバ123aは、上位装置80から取得した駆動部150の回転力指令値CTに応じて、駆動部150を駆動する駆動電流ITを生成し、生成した駆動電流ITを駆動部150に出力する。また、クラッチ制御部123bは、トルク制限機構120が有する調整部121に接続されており、回転力の上限値を、第一駆動素子131−1及び第二駆動素子131−2に印加して設定する設定電圧(例えば、設定電圧VS)を調整部121に出力する。また、回転力検出部123cは、検出部122に接続されており、検出部122が検出する被駆動軸21の回転力を示す回転力情報(例えば、回転力情報DT)を取得する。   The control unit 123 of this embodiment includes, for example, a motor driver 123a, a clutch control unit 123b, and a rotational force detection unit 123c. The motor driver 123 a generates a drive current IT for driving the drive unit 150 in accordance with the rotational force command value CT of the drive unit 150 acquired from the host device 80, and outputs the generated drive current IT to the drive unit 150. To do. The clutch control unit 123b is connected to the adjustment unit 121 included in the torque limiting mechanism 120, and sets the upper limit value of the rotational force by applying it to the first drive element 131-1 and the second drive element 131-2. The set voltage (for example, set voltage VS) to be output is output to the adjustment unit 121. Moreover, the rotational force detection part 123c is connected to the detection part 122, and acquires the rotational force information (for example, rotational force information DT) which shows the rotational force of the driven shaft 21 which the detection part 122 detects.

制御部123は、通常動作において、回転力の上限値を設定して、設定した上限値に応じた設定電圧VSを、クラッチ制御部123bを介して調整部121に出力する。   In normal operation, the control unit 123 sets an upper limit value of the rotational force and outputs a set voltage VS corresponding to the set upper limit value to the adjustment unit 121 via the clutch control unit 123b.

例えば、トルク制限機構120は、通常動作において、伝達する回転力の大きさが、設定されている上限値を超えている場合には、伝達する回転力の大きさが上限値を超えないように滑りを発生させる。ここで、トルク制限機構120の滑りとは、例えば、回転駆動軸11の回転数(又は回転速度)と被駆動軸21の回転数(又は回転速度)とが一致していない状態である。このトルク制限機構120の滑りは、例えば、トルク制限機構120に設定されている上限値を超える回転力を回転駆動軸11及び被駆動軸21間において伝達しようとした場合に発生する。   For example, in the normal operation, the torque limiting mechanism 120 prevents the magnitude of the transmitted rotational force from exceeding the upper limit value when the magnitude of the transmitted rotational force exceeds the set upper limit value. Causes slipping. Here, the slip of the torque limiting mechanism 120 is a state in which, for example, the rotational speed (or rotational speed) of the rotary drive shaft 11 does not match the rotational speed (or rotational speed) of the driven shaft 21. The slip of the torque limiting mechanism 120 occurs when, for example, a rotational force exceeding the upper limit set in the torque limiting mechanism 120 is transmitted between the rotary drive shaft 11 and the driven shaft 21.

図6は、本実施形態における相対的な滑りの上限値の変化の一例を示すグラフである。通常動作において、回転駆動軸11と被駆動軸21との間に伝達される回転力の上限値は、例えば、図6に示す波形WSのように設定されている。例えば、上限値は被駆動軸21が駆動される状態(例えば、被駆動軸21に加わる負荷トルクの変化)に応じて設定されている。一例として、上限値は、図6の時刻t0からt1において波形WS1に示すに設定されている。図6の時刻t1からt8においても同様に、上限値は波形WS2からWS8に示すように、それぞれ設定されている。   FIG. 6 is a graph showing an example of a change in the upper limit value of relative slip in the present embodiment. In the normal operation, the upper limit value of the rotational force transmitted between the rotational drive shaft 11 and the driven shaft 21 is set, for example, as a waveform WS shown in FIG. For example, the upper limit value is set according to a state in which the driven shaft 21 is driven (for example, a change in load torque applied to the driven shaft 21). As an example, the upper limit value is set as shown in the waveform WS1 from time t0 to time t1 in FIG. Similarly, from time t1 to time t8 in FIG. 6, the upper limit values are set as shown by the waveforms WS2 to WS8, respectively.

これに対して、トルク制限機構120は、伝達部130、拡径部11a及び被駆動軸21などの表面状態の変化、表面への油の付着、湿気の影響などの原因により、上述した摩擦力が変化することがある。トルク制限機構120は、例えば、これらの原因によって伝達部130と、拡径部11a又は被駆動軸21とが固着する場合がある。このような場合に、トルク制限機構120が伝達する回転力は、設定した上限値を超えることがある。   In contrast, the torque limiting mechanism 120 causes the above-described frictional force due to changes in the surface state of the transmission unit 130, the enlarged diameter portion 11a, the driven shaft 21, and the like, oil adhesion to the surface, and the influence of moisture. May change. In the torque limiting mechanism 120, for example, the transmission part 130 and the enlarged diameter part 11a or the driven shaft 21 may be fixed due to these causes. In such a case, the rotational force transmitted by the torque limiting mechanism 120 may exceed the set upper limit value.

例えば、トルク制限機構120が伝達する回転力の上限値が、設定した上限値よりも増加することがある。ここで、設定されている上限値(例えば、波形WSによって示される上限値)に対して摩擦力が増加した場合、例えば、図6に示す波形WSは、波形WUに変化する。この場合、伝達する回転力の大きさが設定された上限値を超えても、滑りが発生しないことがある。   For example, the upper limit value of the rotational force transmitted by the torque limiting mechanism 120 may increase from the set upper limit value. Here, when the frictional force increases with respect to the set upper limit value (for example, the upper limit value indicated by the waveform WS), for example, the waveform WS shown in FIG. 6 changes to the waveform WU. In this case, slipping may not occur even if the magnitude of the rotational force transmitted exceeds the set upper limit value.

また、例えば、トルク制限機構120が伝達する回転力は、設定した上限値に達しないことがある。つまり、トルク制限機構120が伝達する回転力の上限値が、設定した上限値よりも減少することがある。ここで、設定されている上限値(WS)に対して摩擦力が減少した場合、例えば、図6に示す波形WSは、波形WLに変化する。この場合、被駆動軸21の負荷(例えば、可動部20及び可動部20が移動させる負荷)を移動させるために必要な回転力を回転駆動軸11から被駆動軸21に伝達することができないことがある。   Further, for example, the rotational force transmitted by the torque limiting mechanism 120 may not reach the set upper limit value. That is, the upper limit value of the rotational force transmitted by the torque limiting mechanism 120 may be smaller than the set upper limit value. Here, when the frictional force decreases with respect to the set upper limit value (WS), for example, the waveform WS shown in FIG. 6 changes to the waveform WL. In this case, the rotational force necessary to move the load of the driven shaft 21 (for example, the movable portion 20 and the load moved by the movable portion 20) cannot be transmitted from the rotary drive shaft 11 to the driven shaft 21. There is.

つまり、トルク制限機構120において、上記のように摩擦力が変化すると、滑りが発生すべき状況において滑りが発生しなかったり、滑りが発生すべきでない状況において滑りが発生したりする、といった誤作動が発生する場合がある。   In other words, in the torque limiting mechanism 120, when the frictional force changes as described above, a malfunction occurs such that no slip occurs in a situation where the slip should occur or a slip occurs in a situation where the slip should not occur. May occur.

そこで、本実施形態では、滑りが発生すべき状況において滑りが発生するように、トルク制限機構120に設定されている上限値を変更する。例えば、制御部123は、当該上限値を変更するため、通常動作とは別に、回転力に関するトルク制限機構120の較正動作を行わせる。当該較正動作において、制御部123は、回転駆動軸11と被駆動軸21との間に相対的な滑りが発生する場合の回転力(滑り発生回転力)を較正情報として求める。制御部123は、通常動作において、トルク制限機構120の上限値を、較正情報として求めた滑り発生回転力に変更する。   Therefore, in the present embodiment, the upper limit value set in the torque limiting mechanism 120 is changed so that the slip occurs in a situation where the slip should occur. For example, in order to change the upper limit value, the control unit 123 causes the torque limiting mechanism 120 related to the rotational force to be calibrated separately from the normal operation. In the calibration operation, the control unit 123 obtains, as calibration information, a rotational force (slip generated rotational force) when a relative slip occurs between the rotary drive shaft 11 and the driven shaft 21. In normal operation, the control unit 123 changes the upper limit value of the torque limiting mechanism 120 to the slip generation rotational force obtained as the calibration information.

つまり、図6に即して説明すると、まず較正動作において波形WUの値や波形WLの値を較正情報として求める。その後、通常動作において、予め設定されている上限値の波形WSを、求めた波形WUや波形WLに変更する。以降の通常動作は、変更後の上限値(波形WU又は波形WL)に基づいて行われる。このため、トルク制限機構120の状態に応じて上限値を柔軟に適応させることができる。   In other words, referring to FIG. 6, first, in the calibration operation, the value of the waveform WU and the value of the waveform WL are obtained as calibration information. Thereafter, in the normal operation, the preset upper limit waveform WS is changed to the obtained waveform WU or waveform WL. Subsequent normal operations are performed based on the changed upper limit value (waveform WU or waveform WL). For this reason, the upper limit value can be flexibly adapted according to the state of the torque limiting mechanism 120.

この場合、制御部123は、ロボット装置200に対して異なる複数種類の較正動作を行わせ、これらの複数種類の較正動作について、それぞれ較正情報として滑り発生回転力を求める。複数種類の較正動作として、制御部123は、例えば通常動作と同一の動作を行わせることができる。あるいは、制御部123は、トルク制限機構120に滑りが発生する可能性のある動作を、通常動作に相当する動作として行わせても構わない。なお、制御部123は、上記の複数種類の較正動作に限らず、1種類の較正動作をロボット装置200に対して行わせてもよい。   In this case, the control unit 123 causes the robot apparatus 200 to perform a plurality of different types of calibration operations, and obtains the slip generation rotational force as calibration information for each of the plurality of types of calibration operations. As a plurality of types of calibration operations, the control unit 123 can perform, for example, the same operations as the normal operations. Alternatively, the control unit 123 may cause the torque limiting mechanism 120 to perform an operation that may cause a slip as an operation corresponding to a normal operation. Note that the control unit 123 is not limited to the plurality of types of calibration operations described above, and may cause the robot device 200 to perform one type of calibration operation.

このような通常動作に相当する較正動作として、例えば静止している可動部20に対して一方向に力を作用させる動作が挙げられる。この較正動作の一例として、図7に示すように、可動部20の先端に較正用の錘Gを取り付ける。検出部122は、錘Gによって滑りが発生したときの回転力(滑り発生回転力)を検出する。なお、較正用の錘Gは、トルク制限機構120に滑りが生じる程度の重さであり、予め決められた所定の重さである。制御部123は、検出された滑り発生回転力を、第一較正情報として例えば制御部123に設けられる不図示のメモリ等に記憶させる。また、制御部123は、一方向として、例えば重力方向に沿った方向の他、重力方向に逆らう方向や重力方向に交差する方向など、複数の異なる方向についての滑り発生回転力を求め、較正情報としてメモリ等に記憶させても良い。上記の較正動作においては、例えば錘Gを取り付ける代わりに、例えば可動部20の先端を重力方向に引っ張る機構を用いることで、錘Gを取り付ける場合と同等な結果を得ることができる。なお、上記の較正動作の一例として、可動部20の先端に取り付ける較正用の錘Gは、重さを容易に調整できるような形態であってもよい。   As a calibration operation corresponding to such a normal operation, for example, there is an operation in which a force is applied in one direction to the stationary movable unit 20. As an example of the calibration operation, a calibration weight G is attached to the tip of the movable portion 20 as shown in FIG. The detection unit 122 detects a rotational force (slip generation rotational force) when slippage is generated by the weight G. The calibration weight G has such a weight that the torque limiting mechanism 120 slips, and has a predetermined weight. The control unit 123 stores the detected slip generation rotational force as first calibration information in, for example, a memory (not shown) provided in the control unit 123. Further, the control unit 123 obtains a slip generation rotational force in a plurality of different directions such as a direction along the gravity direction, a direction against the gravity direction, and a direction crossing the gravity direction as one direction, and calibration information. May be stored in a memory or the like. In the above calibration operation, for example, instead of attaching the weight G, for example, by using a mechanism that pulls the tip of the movable portion 20 in the direction of gravity, a result equivalent to the case of attaching the weight G can be obtained. As an example of the above-described calibration operation, the calibration weight G attached to the tip of the movable portion 20 may be configured so that the weight can be easily adjusted.

また、通常動作に相当する較正動作として、一方向に可動部20を等速移動させて対象物Pに衝突させる動作が挙げられる。この較正動作の一例として、制御部123は、図8に示すように、一方向に可動部20を移動させ、トルク制限機構120に滑りが発生するように可動部20を対象物Pに接触させる又は押し付ける。検出部122は、滑りが発生したときの滑り発生回転力を検出する。制御部123は、検出された滑り発生回転力を、第二較正情報として例えば制御部123に設けられる不図示のメモリ等に記憶させる。また、制御部123は、一方向として、例えば重力方向に交差する方向の他、重力方向に沿った方向や重力方向に逆らう方向など、複数の異なる方向についての滑り発生回転力を求め、較正情報としてメモリ等に記憶させても良い。   Further, as a calibration operation corresponding to the normal operation, there is an operation in which the movable unit 20 is moved at a constant speed in one direction to collide with the object P. As an example of the calibration operation, the control unit 123 moves the movable unit 20 in one direction as shown in FIG. 8 and brings the movable unit 20 into contact with the object P so that the torque limiting mechanism 120 slips. Or press. The detection unit 122 detects the slip generation rotational force when the slip occurs. The control unit 123 stores the detected slip generation rotational force as second calibration information in, for example, a memory (not shown) provided in the control unit 123. Further, the control unit 123 obtains a slip generation rotational force in a plurality of different directions such as a direction along the gravity direction or a direction against the gravity direction in addition to a direction intersecting the gravity direction as one direction, and calibration information. May be stored in a memory or the like.

また、通常動作に相当する較正動作として、可動部20を一方向に加速移動させる動作が挙げられる。この較正動作において、まず制御部123は、例えば固定部10を静止させた状態から、トルク制限機構120に滑りが発生するように固定部10を一方向に加速して移動させる。検出部122は、滑りが発生したときの滑り発生回転力を検出する。制御部123は、検出された滑り発生回転力を、第三較正情報として例えば制御部123に設けられる不図示のメモリ等に記憶させる。このとき、制御部123は、一方向として、例えば重力方向に交差する方向や重力方向に沿った方向、重力方向に逆らう方向など、複数の異なる方向について較正動作を行わせたり、異なる加速度で較正動作を行わせたりして、複数の較正情報を得るようにしても良い。   Further, as a calibration operation corresponding to the normal operation, there is an operation of accelerating and moving the movable part 20 in one direction. In this calibration operation, first, the control unit 123 accelerates and moves the fixing unit 10 in one direction so that the torque limiting mechanism 120 slips, for example, from a state where the fixing unit 10 is stationary. The detection unit 122 detects the slip generation rotational force when the slip occurs. The control unit 123 stores the detected slip generation rotational force as third calibration information in, for example, a memory (not shown) provided in the control unit 123. At this time, the control unit 123 causes the calibration operation to be performed in a plurality of different directions such as a direction crossing the gravity direction, a direction along the gravity direction, a direction against the gravity direction, or the calibration with different accelerations. A plurality of calibration information may be obtained by performing an operation.

また、通常動作に相当する較正動作として、一方向に移動している可動部20を減速させる動作が挙げられる。この較正動作において、まず制御部123は、一方向に固定部10を所定速度で移動させた状態から、トルク制限機構120に滑りが発生するように固定部10を減速させる。検出部122は、滑りが発生したときの滑り発生回転力を検出する。制御部123は、検出された滑り発生回転力を、第四較正情報として例えば制御部123に設けられる不図示のメモリ等に記憶させる。このとき、制御部123は、一方向として、例えば重力方向に交差する方向や重力方向に沿った方向、重力方向に逆らう方向など、複数の異なる方向について較正動作を行わせたり、異なる減速度(減速方向の加速度)で較正動作を行わせたりして、複数の較正情報を得るようにしても良い。   Moreover, the operation | movement which decelerates the movable part 20 which is moving to one direction is mentioned as calibration operation corresponded to normal operation | movement. In this calibration operation, first, the control unit 123 decelerates the fixing unit 10 so that the torque limiting mechanism 120 slips from the state where the fixing unit 10 is moved at a predetermined speed in one direction. The detection unit 122 detects the slip generation rotational force when the slip occurs. The control unit 123 stores the detected slip generation rotational force as fourth calibration information in, for example, a memory (not shown) provided in the control unit 123. At this time, the control unit 123 causes the calibration operation to be performed in a plurality of different directions such as a direction crossing the gravitational direction, a direction along the gravitational direction, a direction against the gravitational direction as one direction, or a different deceleration ( A plurality of calibration information may be obtained by performing a calibration operation with acceleration in the deceleration direction).

上記の較正動作を行うタイミングとしては、通常動作が行われない期間などが挙げられる。例えば、制御部123は、ロボット装置200の電源を入れた後、通常動作が行われるまでの期間に較正動作を行わせても良い。また、制御部123は、一日ごとに所定の時間が到来したときに較正動作を行わせても良い。通常動作を行っているときに所定の時間が到来した場合、制御部123は通常動作を停止させ、当該通常動作が停止している期間に較正動作を行わせる。   Examples of the timing for performing the calibration operation include a period during which the normal operation is not performed. For example, the control unit 123 may cause the calibration operation to be performed during a period until the normal operation is performed after the robot apparatus 200 is turned on. Further, the control unit 123 may cause the calibration operation to be performed when a predetermined time has arrived every day. When a predetermined time comes during the normal operation, the control unit 123 stops the normal operation and performs the calibration operation during the period in which the normal operation is stopped.

以上のように較正動作を行った後、制御部123はロボット装置200に通常動作を行わせる。通常動作において、制御部123は、動作の種類ごとに、トルク制限機構120の上限値を、上記較正情報として求めた較正情報(滑り発生回転力)に等しくなるように変更する。   After performing the calibration operation as described above, the control unit 123 causes the robot apparatus 200 to perform a normal operation. In normal operation, the control unit 123 changes the upper limit value of the torque limiting mechanism 120 so as to be equal to the calibration information (slip generation torque) obtained as the calibration information for each type of operation.

例えば、制御部123は、静止している可動部20に対して一方向に力が作用する場合には第一較正情報に基づいて上限値を変更させる。また、制御部123は、一方向に可動部20を等速移動させる場合には第二較正情報に基づいて上限値を変更させる。また、制御部123は、可動部20を一方向に加速移動させる場合には第三較正情報に基づいて上限値を変更させる。また、制御部123は、一方向に移動している可動部20を減速させる場合には第四較正情報に基づいて上限値を変更させる。   For example, the control unit 123 changes the upper limit value based on the first calibration information when a force acts in one direction on the movable unit 20 that is stationary. Moreover, the control part 123 changes an upper limit based on 2nd calibration information, when moving the movable part 20 to constant speed in one direction. In addition, the control unit 123 changes the upper limit value based on the third calibration information when the movable unit 20 is accelerated and moved in one direction. Moreover, the control part 123 changes an upper limit based on 4th calibration information, when decelerating the movable part 20 which is moving to one direction.

トルク制限機構120の上限値を変更する場合、同一種類の動作に対して複数の較正情報が求められている場合(例、異なる方向についての較正情報、異なる加速度についての較正情報、異なる動作期間についての較正情報など)、制御部123は、複数の較正情報のうち一の較正情報を上限値として選択する。このとき、制御部123は、例えば重力方向に沿った方向についての較正情報を優先的に選択しても良いし、加速度が最も大きい場合についての較正情報を優先的に選択しても良い。   When changing the upper limit value of the torque limiting mechanism 120, when multiple pieces of calibration information are required for the same type of operation (eg, calibration information for different directions, calibration information for different accelerations, and different operation periods) The calibration unit 123 selects one calibration information among the plurality of calibration information as the upper limit value. At this time, the control unit 123 may preferentially select calibration information for a direction along the direction of gravity, for example, or may preferentially select calibration information for a case where acceleration is the highest.

以上のように、本実施形態に係るトルク制限機構120は、回転駆動軸11の回転力を被駆動軸21に伝達する伝達部130と、回転駆動軸11と被駆動軸21とに対して相対的な変位を生じさせる上限値に基づき、伝達部130による回転力の伝達状態を調整可能な調整部121と、回転力についての所定の較正動作によって得られる較正情報に応じて、上限値を変更可能な制御部123とを備えるので、例えば、経年変化による伝達部130の表面状態の変化や、周囲環境の油や埃、湿気などによりトルク制限機構120の摩擦力が変化した場合であっても、摩擦力の変化に応じた上限値が設定される。これにより、例えば、可動部20が人や物を挟み込んだ場合に、トルク制限機構120に設定されている上限値を超えて回転力が伝達されることを低減することができる。これにより、トルク制限機構120は、挟み込み発生から短時間で駆動トルクを低減することができるので、衝突時や挟み込み発生時等における人や物などの周囲の作業環境への損傷などを低減することができる。また、本実施形態に係るトルク制限機構120は、例えば上記のように摩擦力の変化に応じた上限値が設定されることによって、滑りを生じさせない場合に誤って滑りが生じることを低減できるため、予期しない衝突を引き起こすことを防止できる。   As described above, the torque limiting mechanism 120 according to this embodiment is relative to the transmission unit 130 that transmits the rotational force of the rotational drive shaft 11 to the driven shaft 21, and the rotational drive shaft 11 and the driven shaft 21. The upper limit value is changed according to the adjustment unit 121 that can adjust the transmission state of the rotational force by the transmission unit 130 and the calibration information obtained by a predetermined calibration operation for the rotational force, based on the upper limit value that causes a general displacement. For example, even when the frictional force of the torque limiting mechanism 120 is changed due to changes in the surface state of the transmission unit 130 due to secular change, oil, dust, moisture, or the like in the surrounding environment. The upper limit value is set according to the change of the frictional force. Thereby, for example, when the movable unit 20 sandwiches a person or an object, it is possible to reduce the transmission of the rotational force exceeding the upper limit set in the torque limiting mechanism 120. As a result, the torque limiting mechanism 120 can reduce the driving torque in a short time from the occurrence of pinching, and therefore, it is possible to reduce damage to surrounding work environments such as people and objects at the time of collision or occurrence of pinching. Can do. Further, the torque limiting mechanism 120 according to the present embodiment can reduce the occurrence of slipping accidentally when slipping is not caused by setting an upper limit value according to a change in frictional force as described above, for example. , Can prevent unexpected collisions.

[第二実施形態]
以下、図面を参照して、本発明の第二実施形態を説明する。なお、上述した第一実施形態と同様である構成及び動作については、説明を省略する。
図9は、本実施形態におけるロボット装置の構成の一例を示す構成図である。
図9に示すように、本実施形態のロボット装置200は、台座部50と、固定部10と、手先部40と、複数の可動部20(例えば、可動部20a及び可動部20b)と、複数の駆動装置100(例えば、駆動装置100a及び駆動装置100b)を備えている。
[Second Embodiment]
Hereinafter, a second embodiment of the present invention will be described with reference to the drawings. In addition, description is abbreviate | omitted about the structure and operation | movement similar to 1st embodiment mentioned above.
FIG. 9 is a configuration diagram illustrating an example of the configuration of the robot apparatus according to the present embodiment.
As shown in FIG. 9, the robot apparatus 200 according to the present embodiment includes a pedestal part 50, a fixed part 10, a hand part 40, a plurality of movable parts 20 (for example, a movable part 20 a and a movable part 20 b), and a plurality of parts. Drive device 100 (for example, drive device 100a and drive device 100b).

台座部50は、ロボット装置200が設置されている床に固定されている。
固定部10は、第1端部が台座部に固定されており、第2端部が連結部30aを介して可動部20aの第1端部と連結されている。
The pedestal 50 is fixed to the floor where the robot apparatus 200 is installed.
As for the fixed part 10, the 1st end part is being fixed to the base part, and the 2nd end part is connected with the 1st end part of the movable part 20a via the connection part 30a.

可動部20aは、第1端部が連結部30aを介して固定部10の第2端部と連結されており、第2端部が連結部30bを介して可動部20bの第1端部と連結されている。例えば、可動部20aは、ロボット装置200が備えるロボットアームのうちの上腕部である。   The movable part 20a has a first end connected to the second end of the fixed part 10 via the connecting part 30a, and a second end connected to the first end of the movable part 20b via the connecting part 30b. It is connected. For example, the movable part 20a is an upper arm part of a robot arm included in the robot apparatus 200.

可動部20bは、第1端部が連結部30bを介して可動部20aの第2端部と連結されており、第2端部に手先部40が接続されている。例えば、可動部20bは、ロボット装置200が備えるロボットアームのうちの下腕部である。
手先部40は、可動部20bの第2端部に接続されており、被移動物体WKを保持する(例えば、把持する)。
As for the movable part 20b, the 1st end part is connected with the 2nd end part of the movable part 20a via the connection part 30b, and the hand part 40 is connected to the 2nd end part. For example, the movable portion 20b is a lower arm portion of a robot arm included in the robot apparatus 200.
The hand part 40 is connected to the second end of the movable part 20b and holds (for example, holds) the moving object WK.

駆動装置100aは、連結部30aに備えられており、上位装置80の指令値に基づいて固定部10に対して可動部20aが回転移動するように可動部20aを駆動する。同様に、駆動装置100bは、連結部30bに備えられており、上位装置80の指令値に基づいて可動部20aに対して可動部20bが回転移動するように可動部20bを駆動する。また、これらの駆動装置100は、上述した実施形態において説明したトルク制限機構120をそれぞれ備えている。例えば、駆動装置100aは、トルク制限機構120としてのトルク制限機構120aを備えており、駆動装置100bは、トルク制限機構120としてのトルク制限機構120bを備えている。   The driving device 100a is provided in the connecting portion 30a, and drives the movable portion 20a so that the movable portion 20a rotates with respect to the fixed portion 10 based on a command value of the host device 80. Similarly, the driving device 100b is provided in the connecting portion 30b, and drives the movable portion 20b so that the movable portion 20b rotates relative to the movable portion 20a based on a command value of the host device 80. Moreover, these drive devices 100 are each provided with the torque limiting mechanism 120 demonstrated in embodiment mentioned above. For example, the driving device 100 a includes a torque limiting mechanism 120 a as the torque limiting mechanism 120, and the driving device 100 b includes a torque limiting mechanism 120 b as the torque limiting mechanism 120.

以上説明したように、本実施形態の駆動装置100(駆動装置100a、駆動装置100b)は、上述した実施形態において説明したトルク制限機構120を備えている。これにより、本実施形態の駆動装置100は、例えば衝突時や挟み込み発生時の損傷を低減することができる。   As described above, the driving device 100 (the driving device 100a and the driving device 100b) of the present embodiment includes the torque limiting mechanism 120 described in the above-described embodiments. Thereby, the drive device 100 of this embodiment can reduce the damage at the time of a collision or the occurrence of pinching, for example.

また、本実施形態のロボット装置200は、上述した実施形態において説明したトルク制限機構120(本実施形態においては、トルク制限機構120a及びトルク制限機構120b)を備えている。これにより、本実施形態のロボット装置200は、例えば衝突時や挟み込み発生時の損傷を低減することができる。   Further, the robot apparatus 200 of the present embodiment includes the torque limiting mechanism 120 (in the present embodiment, the torque limiting mechanism 120a and the torque limiting mechanism 120b) described in the above-described embodiments. Thereby, the robot apparatus 200 of this embodiment can reduce the damage at the time of a collision or occurrence of pinching, for example.

以上、本発明の実施形態を図面を参照して詳述してきたが、具体的な構成はこの実施形態に限られるものではなく、本発明の趣旨を逸脱しない範囲で適宜変更を加えることができる。   As mentioned above, although embodiment of this invention has been explained in full detail with reference to drawings, a concrete structure is not restricted to this embodiment and can be suitably changed in the range which does not deviate from the meaning of this invention. .

なお、上記の実施形態における制御部123又はこの制御部123が備える各部は、専用のハードウェアにより実現されるものであってもよく、また、メモリおよびマイクロプロセッサにより実現させるものであってもよい。   Note that the control unit 123 or each unit included in the control unit 123 in the above embodiment may be realized by dedicated hardware, or may be realized by a memory and a microprocessor. .

なお、この制御部123が備える各部はメモリおよびCPU(中央演算装置)により構成され、制御部123が備える各部の機能を実現するためのプログラムをメモリにロードして実行することによりその機能を実現させるものであってもよい。   Each unit included in the control unit 123 includes a memory and a CPU (Central Processing Unit), and the function is realized by loading a program for realizing the function of each unit included in the control unit 123 into the memory and executing the program. It may be allowed.

また、制御部123が備える各部の機能を実現するためのプログラムをコンピュータ読み取り可能な記録媒体に記録して、この記録媒体に記録されたプログラムをコンピュータシステムに読み込ませ、実行することにより、制御部123が備える各部による処理を行ってもよい。なお、ここでいう「コンピュータシステム」とは、OSや周辺機器等のハードウェアを含むものとする。
また、「コンピュータシステム」は、WWWシステムを利用している場合であれば、ホームページ提供環境(あるいは表示環境)も含むものとする。
In addition, by recording a program for realizing the function of each unit included in the control unit 123 on a computer-readable recording medium, causing the computer system to read and execute the program recorded on the recording medium, the control unit You may perform the process by each part with which 123 is provided. Here, the “computer system” includes an OS and hardware such as peripheral devices.
Further, the “computer system” includes a homepage providing environment (or display environment) if a WWW system is used.

また、「コンピュータ読み取り可能な記録媒体」とは、フレキシブルディスク、光磁気ディスク、ROM、CD−ROM等の可搬媒体、コンピュータシステムに内蔵されるハードディスク等の記憶装置のことをいう。さらに「コンピュータ読み取り可能な記録媒体」とは、インターネット等のネットワークや電話回線等の通信回線を介してプログラムを送信する場合の通信線のように、短時間の間、動的にプログラムを保持するもの、その場合のサーバやクライアントとなるコンピュータシステム内部の揮発性メモリのように、一定時間プログラムを保持しているものも含むものとする。また上記プログラムは、前述した機能の一部を実現するためのものであってもよく、さらに前述した機能をコンピュータシステムにすでに記録されているプログラムとの組み合わせで実現できるものであってもよい。   The “computer-readable recording medium” refers to a storage device such as a flexible medium, a magneto-optical disk, a portable medium such as a ROM and a CD-ROM, and a hard disk incorporated in a computer system. Furthermore, the “computer-readable recording medium” dynamically holds a program for a short time like a communication line when transmitting a program via a network such as the Internet or a communication line such as a telephone line. In this case, a volatile memory in a computer system serving as a server or a client in that case, and a program that holds a program for a certain period of time are also included. The program may be a program for realizing a part of the functions described above, and may be a program capable of realizing the functions described above in combination with a program already recorded in a computer system.

11…回転駆動軸、21…被駆動軸、100…駆動装置、120…トルク制限機構、121…調整部、122…検出部、123…制御部、124…すべり検出部、125…回転力検出部(検出部)、150…駆動部、200…ロボット装置   DESCRIPTION OF SYMBOLS 11 ... Rotary drive shaft, 21 ... Driven shaft, 100 ... Drive apparatus, 120 ... Torque limiting mechanism, 121 ... Adjustment part, 122 ... Detection part, 123 ... Control part, 124 ... Slip detection part, 125 ... Rotation force detection part (Detection unit), 150 ... drive unit, 200 ... robot apparatus

Claims (12)

回転駆動軸の回転力を被駆動軸に伝達する伝達部と、
前記回転駆動軸と前記被駆動軸とに対して相対的な変位を生じさせる許容値に基づき、前記伝達部による前記回転力の伝達状態を調整可能な調整部と、
所定の較正動作によって得られる較正情報に応じて、前記許容値を変更可能な制御部と
を備えるトルク制限機構。
A transmission unit for transmitting the rotational force of the rotary drive shaft to the driven shaft;
An adjustment unit capable of adjusting a transmission state of the rotational force by the transmission unit, based on an allowable value that causes a relative displacement with respect to the rotation drive shaft and the driven shaft;
A torque limiting mechanism comprising: a control unit capable of changing the allowable value according to calibration information obtained by a predetermined calibration operation.
前記較正動作は、前記回転駆動軸と前記被駆動軸との間に相対的な滑りが発生するときの滑り発生回転力を求めることを含む
請求項1に記載のトルク制限機構。
The torque limiting mechanism according to claim 1, wherein the calibration operation includes obtaining a slip generation rotational force when a relative slip occurs between the rotation drive shaft and the driven shaft.
前記制御部は、前記滑り発生回転力が前記許容値に等しくなるように前記調整部に前記伝達状態を調整させる
請求項2に記載のトルク制限機構。
The torque limiting mechanism according to claim 2, wherein the control unit causes the adjustment unit to adjust the transmission state so that the slip generation rotational force becomes equal to the allowable value.
前記較正動作は、前記回転駆動軸及び前記被駆動軸の異なる回転方向についての前記滑り発生回転力をそれぞれ求めることを含む
請求項2又は請求項3に記載のトルク制限機構。
4. The torque limiting mechanism according to claim 2, wherein the calibration operation includes determining the slip generation rotational force in different rotational directions of the rotational drive shaft and the driven shaft. 5.
前記制御部は、前記異なる回転方向についての前記滑り発生回転力が異なる場合には、前記異なる回転方向のうちいずれか一方の前記回転方向についての前記滑り発生回転力を用いて前記調整部に前記伝達状態を調整させる
請求項4に記載のトルク制限機構。
When the slip generation rotational force with respect to the different rotational directions is different, the control unit uses the slip generation rotational force with respect to any one of the different rotational directions to the adjustment unit. The torque limiting mechanism according to claim 4, wherein a transmission state is adjusted.
前記制御部は、前記異なる回転方向のうち前記回転駆動軸及び前記被駆動軸に作用する加速度が大きい方向についての前記滑り発生回転力を用いて前記調整部に前記伝達状態を調整させる
請求項4又は請求項5に記載のトルク制限機構。
The said control part makes the said adjustment part adjust the said transmission state using the said slip generation | occurrence | production rotational force about the direction where the acceleration which acts on the said rotational drive shaft and the said driven shaft among the said different rotation directions is large. Alternatively, the torque limiting mechanism according to claim 5.
前記被駆動軸は、アーム部に連結されており、
前記制御部は、前記異なる回転方向のうち前記アーム部の重力によって前記被駆動軸が回転する方向についての前記滑り発生回転力を用いて前記調整部に前記伝達状態を調整させる
請求項4から請求項6に記載のトルク制限機構。
The driven shaft is connected to an arm portion,
The said control part makes the said adjustment part adjust the said transmission state using the said slip generation | occurrence | production rotational force about the direction which the said driven shaft rotates by the gravity of the said arm part among the said different rotation directions. Item 7. The torque limiting mechanism according to Item 6.
前記制御部は、複数の前記較正動作によって得られる複数の前記較正情報に対してそれぞれ前記許容値を変更する
請求項1から請求項7のうちいずれか一項に記載のトルク制限機構。
The torque limiting mechanism according to any one of claims 1 to 7, wherein the control unit changes the allowable value for each of a plurality of pieces of calibration information obtained by a plurality of the calibration operations.
前記伝達部は、前記回転駆動軸と前記被駆動軸とのうち少なくとも一方の回転軸の周面の少なくとも一部に対して接触可能に設けられ、前記回転軸の軸方向とは異なる方向に力が加えられた状態で前記回転軸に接触することによって前記回転駆動軸の回転力を前記被駆動軸に伝達するように形成されており、
前記調整部は、前記許容値が可変となるように、前記回転軸に対する前記伝達部の接触状態を前記伝達状態として調整可能に形成されている
請求項1から請求項8のうちいずれか一項に記載のトルク制限機構。
The transmission portion is provided so as to be able to contact at least a part of a circumferential surface of at least one of the rotation drive shaft and the driven shaft, and a force in a direction different from the axial direction of the rotation shaft. Is formed so as to transmit the rotational force of the rotational drive shaft to the driven shaft by contacting the rotational shaft with
The adjustment unit is formed so that the contact state of the transmission unit with respect to the rotation shaft can be adjusted as the transmission state so that the allowable value is variable. The torque limiting mechanism described in 1.
前記較正動作は、所定の期間ごとに行われる
請求項1から請求項9のうちいずれか一項に記載のトルク制限機構。
The torque limiting mechanism according to any one of claims 1 to 9, wherein the calibration operation is performed every predetermined period.
請求項1から請求項10のいずれか一項に記載のトルク制限機構と
前記回転駆動軸を回転させる駆動部と、
を備える駆動装置。
The torque limiting mechanism according to any one of claims 1 to 10, a drive unit that rotates the rotary drive shaft,
A drive device comprising:
請求項1から請求項10のいずれか一項に記載のトルク制限機構を備える
ロボット装置。
A robot apparatus comprising the torque limiting mechanism according to any one of claims 1 to 10.
JP2012036238A 2012-02-22 2012-02-22 Torque limit mechanism, driving device and robot device Pending JP2013169628A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2012036238A JP2013169628A (en) 2012-02-22 2012-02-22 Torque limit mechanism, driving device and robot device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012036238A JP2013169628A (en) 2012-02-22 2012-02-22 Torque limit mechanism, driving device and robot device

Publications (1)

Publication Number Publication Date
JP2013169628A true JP2013169628A (en) 2013-09-02

Family

ID=49263931

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012036238A Pending JP2013169628A (en) 2012-02-22 2012-02-22 Torque limit mechanism, driving device and robot device

Country Status (1)

Country Link
JP (1) JP2013169628A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017006636A1 (en) * 2015-07-04 2017-01-12 学校法人早稲田大学 Robot arm control system
CN109154495A (en) * 2016-05-24 2019-01-04 伊利诺斯工具制品有限公司 three-dimensional calibration tool and method
CN109238199A (en) * 2018-09-03 2019-01-18 清华大学 A kind of robot rotary shaft kinematic calibration method

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017006636A1 (en) * 2015-07-04 2017-01-12 学校法人早稲田大学 Robot arm control system
JP2017013207A (en) * 2015-07-04 2017-01-19 学校法人早稲田大学 Robot arm control system
EP3318373A4 (en) * 2015-07-04 2018-09-26 Waseda University Robot arm control system
US10730184B2 (en) 2015-07-04 2020-08-04 Waseda University Robot arm control system
CN109154495A (en) * 2016-05-24 2019-01-04 伊利诺斯工具制品有限公司 three-dimensional calibration tool and method
US10928193B2 (en) 2016-05-24 2021-02-23 Illinois Tool Works Inc. Three-dimensional calibration tools and methods
CN109238199A (en) * 2018-09-03 2019-01-18 清华大学 A kind of robot rotary shaft kinematic calibration method
CN109238199B (en) * 2018-09-03 2020-04-03 清华大学 A Kinematic Parameter Calibration Method of Robot Rotation Axis

Similar Documents

Publication Publication Date Title
JP7206638B2 (en) ROBOT, CONTROL DEVICE, AND ROBOT CONTROL METHOD
JP6699843B2 (en) Robot arm control system
JP7225563B2 (en) ROBOT, CONTROL DEVICE, AND ROBOT CONTROL METHOD
JP2013169628A (en) Torque limit mechanism, driving device and robot device
JP5966294B2 (en) Abnormality determination device, drive device, and robot device
JP2013163223A (en) Torque limiting mechanism, drive device, and robot device
WO2013039204A1 (en) Torque limiting mechanism, drive device and robotic device
JP2013163224A (en) Torque limiting mechanism, drive device, and robot device
EP4003663B1 (en) A tendon tension sensing apparatus and a clutch mechanism for a mechanical effector device
JP5641041B2 (en) MOTOR DEVICE, MOTOR DEVICE MANUFACTURING METHOD, AND ROBOT DEVICE
JP2014037028A (en) Torque limiting mechanism, driving device and robot device
US8534429B2 (en) Piezo-actuated braking system and method for a stepper motor
CN110621456B (en) Power transmission system for mechanical device
JP2014050926A (en) Torque limiting mechanism, drive unit, and robot system
JP5835212B2 (en) MOTOR DEVICE, MOTOR DEVICE MANUFACTURING METHOD, AND ROBOT DEVICE
JP2013076432A (en) Torque limiting mechanism, driving device, and robot device
JP2012110971A (en) Robot
JP5966320B2 (en) DRIVE DEVICE, ROBOT DEVICE, AND DRIVE METHOD
JP5621350B2 (en) MOTOR DEVICE, ROTOR DRIVING METHOD, AND ROBOT DEVICE
JP2011217490A (en) Motor device, method of driving rotor, and robot device
JP7467829B2 (en) DRIVE DEVICE, HAND, AND METHOD FOR CONTROLLING DRIVE DEVICE
JP2013070529A (en) Motor device and robot device
JP2011217500A (en) Motor device, method of driving rotor, and robot device
JP2010259182A (en) Motor device, rotor driving method, and shaft member driving method
WO2011125719A1 (en) Motor device, method for driving rotor, and robot device