JP2020006509A - Link operation device - Google Patents

Link operation device Download PDF

Info

Publication number
JP2020006509A
JP2020006509A JP2019185071A JP2019185071A JP2020006509A JP 2020006509 A JP2020006509 A JP 2020006509A JP 2019185071 A JP2019185071 A JP 2019185071A JP 2019185071 A JP2019185071 A JP 2019185071A JP 2020006509 A JP2020006509 A JP 2020006509A
Authority
JP
Japan
Prior art keywords
link
hub
link hub
attitude control
proximal
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.)
Granted
Application number
JP2019185071A
Other languages
Japanese (ja)
Other versions
JP6792687B2 (en
Inventor
浩 磯部
Hiroshi Isobe
浩 磯部
山田 裕之
Hiroyuki Yamada
裕之 山田
清悟 坂田
Seigo Sakata
清悟 坂田
直哉 小長井
Naoya Konagai
直哉 小長井
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.)
NTN Corp
Original Assignee
NTN Corp
NTN Toyo Bearing Co Ltd
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 NTN Corp, NTN Toyo Bearing Co Ltd filed Critical NTN Corp
Priority to JP2019185071A priority Critical patent/JP6792687B2/en
Publication of JP2020006509A publication Critical patent/JP2020006509A/en
Application granted granted Critical
Publication of JP6792687B2 publication Critical patent/JP6792687B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)
  • Transmission Devices (AREA)

Abstract

To provide a link operation device which can exactly detect external forces from various directions acting on a device tip by a simple and inexpensive constitution, can improve the safety of the device as a whole, and can be used to cooperative work with a person.SOLUTION: A link operation device 1 is constituted of a parallel link mechanism 9 for connecting a base-end side link hub 12 and a tip-side link hub by a plurality of link mechanisms 14. A controller 3 for controlling posture control actuators 10 is arranged. Posture control means 4 for outputting commands to the posture control actuators 10, and load estimation means 5 for estimating a load acting on the tip-side link hub are arranged at the controller 3. The load estimation means 5 has a collision detection function for detecting a collision acting on the tip-side link hub by torque change amounts acting on the posture control actuators 10. Also, there is arranged collision-coping control means for turning off operations of the posture control actuators 10, and making the operations free by the collision detection of the load estimation means 5.SELECTED DRAWING: Figure 2

Description

この発明は、医療機器や産業機器等の高速、高精度、および、広範な作動範囲を必要とする機器や人との協調作業に用いられるリンク作動装置に関する。   The present invention relates to a link actuating device used for cooperative work with a device such as a medical device or an industrial device, which requires a high speed, high accuracy, and a wide operating range, or with a person.

各種作業装置に用いられるパラレルリンク機構が、特許文献1、2に提案されている。特許文献1のパラレルリンク機構は、構成が比較的簡単であるが、各リンクの作動角が小さいため、トラベリングプレートの作動範囲を大きく設定すると、リンク長が長くなり、機構全体の寸法が大きくなるという問題がある。特許文献2のパラレルリンク機構は、基端側のリンクハブに対し先端側のリンクハブを、4節連鎖の3組以上のリンク機構を介して姿勢を変更可能に連結した構成としたことにより、コンパクトでありながら、精密で広範な作動範囲の動作が可能である。   Patent Literatures 1 and 2 propose parallel link mechanisms used for various working devices. The configuration of the parallel link mechanism of Patent Document 1 is relatively simple, but since the operating angle of each link is small, if the operating range of the traveling plate is set to be large, the link length increases, and the overall size of the mechanism increases. There is a problem. The parallel link mechanism of Patent Literature 2 has a configuration in which the link hub on the distal end side is connected to the link hub on the proximal end side so that the posture can be changed via three or more sets of link mechanisms in a four-node chain. While being compact, it can operate in a precise and wide operating range.

特開2000−94245号公報JP-A-2000-94245 米国特許第5,893,296号明細書U.S. Pat. No. 5,893,296

特許文献2のパラレルリンク機構など、従来のリンク作動装置は、いずれもパラレルリンク機構の先端に作用する力を検出するには高価なセンサを取り付ける必要があった。
医療機器等のように、人との協調作業に用いられるリンク作動装置では、誤って人の手や腕等が干渉した場合に、即座に自由に逃げられるようにすることが安全上で求められ、そのためには、リンク作動装置の先端に作用する力を検出して対処する必要がある。また医療機器や産業機器では、作業を精度良く行うために、リンク作動装置の先端に作用する力を検出可能とすることが求められる。
Conventional link operating devices such as the parallel link mechanism of Patent Document 2 require an expensive sensor to detect a force acting on the tip of the parallel link mechanism.
Link actuation devices used for cooperative work with humans, such as medical equipment, are required for safety to be able to escape immediately and freely when human hands or arms interfere by mistake. For this purpose, it is necessary to detect and cope with the force acting on the tip of the link operating device. Further, in medical equipment and industrial equipment, it is required to be able to detect a force acting on the tip of the link operating device in order to perform the operation with high accuracy.

この発明の目的は、上記課題を解消し、装置先端に作用する様々な方向からの外力を、簡易で安価な構成で検出でき、装置全体の安全性の向上が図れ、人との協調作業に用いることができるリンク作動装置を提供することである。   SUMMARY OF THE INVENTION An object of the present invention is to solve the above-mentioned problems, to detect external forces acting on the tip of the device from various directions with a simple and inexpensive configuration, to improve the safety of the entire device, and to cooperate with humans. It is to provide a link actuating device that can be used.

この発明のリンク作動装置は、基端側のリンクハブに対し先端側のリンクハブを、3組以上のリンク機構を介して姿勢を変更可能に連結し、前記各リンク機構は、それぞれ前記基端側のリンクハブおよび先端側のリンクハブに一端が回転可能に連結された基端側および先端側の端部リンク部材と、これら基端側および先端側の端部リンク部材の他端に両端がそれぞれ回転可能に連結された中央リンク部材とでなり、前記各リンク機構は、このリンク機構を直線で表現した幾何学モデルが、前記中央リンク部材の中央部に対する基端側部分と先端側部分とが対称を成す形状であり、前記3組以上のリンク機構のうち2組以上のリンク機構に、前記基端側のリンクハブに対する前記先端側のリンクハブの姿勢を任意に変更させる姿勢制御用アクチュエータを設けたリンク作動装置において、
前記各姿勢制御用アクチュエータを制御するコントローラが設けられ、このコントローラに、前記各姿勢制御用アクチュエータに指令を出力する姿勢制御手段、および前記先端側のリンクハブに作用する荷重を推定する荷重推定手段が設けられると共に、前記荷重推定手段は、前記各姿勢制御用アクチュエータに作用するトルク変化量より、前記先端側のリンクハブに作用する衝突を検知する衝突検知機能を有し、
前記荷重推定手段の衝突検知により前記各姿勢制御用アクチュエータの動作をオフにして自由とする衝突対応制御手段を備えた。
The link actuating device of the present invention is configured such that the distal end link hub is connected to the proximal end link hub via three or more sets of link mechanisms so that the attitude can be changed. The proximal and distal end link members, one ends of which are rotatably connected to the side link hub and the distal link hub, and the other ends of the proximal and distal end link members have opposite ends. Each link mechanism is a central link member rotatably connected, and each of the link mechanisms has a geometric model that expresses this link mechanism in a straight line, and includes a base portion and a distal portion with respect to a center portion of the center link member. Is a symmetrical shape, and two or more link mechanisms among the three or more link mechanisms allow the two or more link mechanisms to arbitrarily change the attitude of the distal link hub with respect to the proximal link hub. In link actuator provided with eta,
A controller for controlling each of the attitude control actuators is provided. The controller has a controller for outputting a command to each of the attitude control actuators, and a load estimating means for estimating a load acting on the link hub on the distal end side. Is provided, the load estimating means has a collision detection function of detecting a collision acting on the link hub on the distal end side from a torque change amount acting on each of the attitude control actuators,
A collision handling control means is provided which turns off the operation of each of the attitude control actuators and makes it free when the load estimation means detects a collision.

この構成によれば、基端側のリンクハブと、先端側のリンクハブと、3組以上のリンク機構とで、基端側のリンクハブに対し先端側のリンクハブが直交2軸周りに回転自在な2自由度機構が構成される。この2自由度機構は、コンパクトでありながら、先端側のリンクハブの可動範囲を広くとれる。各姿勢制御用アクチュエータの動作を制御することで、基端側のリンクハブに対して先端側のリンクハブの姿勢を任意に変更させることができる。   According to this configuration, the proximal link hub, the distal link hub, and the three or more link mechanisms rotate the distal link hub about two orthogonal axes with respect to the proximal link hub. A flexible two-degree-of-freedom mechanism is configured. This two-degree-of-freedom mechanism can widen the movable range of the link hub on the distal end side while being compact. By controlling the operation of each posture control actuator, the posture of the distal link hub with respect to the proximal link hub can be arbitrarily changed.

このような構成のリンク作動装置において、前記姿勢制御用アクチュエータのそれぞれがトルク検出手段を有し、これらのトルク検出手段の検出信号から、前記荷重推定手段による荷重の推定を行ってもよい。各姿勢制御用アクチュエータにトルク検出手段を設け、このトルク検出手段の検出信号から先端側のリンクハブに作用する荷重を推定する荷重推定手段を設けたため、別のセンサを先端側のリンクハブ等の可動部分に設けることなく荷重を推定することができる。先端側のリンクハブの荷重は、前記各リンク機構を介して前記各姿勢制御用アクチュエータに伝わるため、各姿勢制御用アクチュエータのトルクから先端側のリンクハブの荷重を計算できる。前記姿勢制御用アクチュエータのトルクを検出するトルク検出手段は、この姿勢制御用アクチュエータに印加する電流を検出するセンサ等の簡単な検出手段で構成できる。
このように、姿勢制御用アクチュエータにトルク検出手段を設け、別のセンサを先端側のリンクハブ等の可動部分に設けることなく、先端側のリンクハブに作用する荷重を推定するようにしたため、装置全体のコンパクト化やコスト低減に繋がる。
また、上記構成のリンク作動装置は、その可動範囲内において特異点がなく全方向にスムーズに動ける構成であるため、先端側のリンクハブに様々な方向から荷重が作用した場合でも姿勢制御用アクチュエータに確実にトルクが伝達され、正確に荷重を推定することができる。
In the link operating device having such a configuration, each of the attitude control actuators may include a torque detecting unit, and the load estimating unit may estimate a load from a detection signal of the torque detecting unit. Each attitude control actuator is provided with a torque detecting means, and a load estimating means for estimating a load acting on the distal link hub from a detection signal of the torque detecting means is provided. The load can be estimated without providing the movable portion. Since the load on the distal link hub is transmitted to each of the attitude control actuators via each of the link mechanisms, the load on the distal link hub can be calculated from the torque of each of the attitude control actuators. The torque detecting means for detecting the torque of the attitude control actuator can be constituted by a simple detecting means such as a sensor for detecting a current applied to the attitude control actuator.
As described above, since the posture control actuator is provided with the torque detecting means and another sensor is not provided on a movable portion such as the distal link hub, the load acting on the distal link hub is estimated. This leads to overall compactness and cost reduction.
In addition, since the link actuating device having the above-described structure has no singularity within its movable range and can move smoothly in all directions, even when loads are applied to the link hub on the distal end from various directions, the posture controlling actuator is used. Torque can be reliably transmitted, and the load can be accurately estimated.

この発明において、前記3組以上のリンク機構は、これらリンク機構が並ぶ周方向に等間隔に配置し、前記リンク機構の全てに対して前記姿勢制御用アクチュエータを設けても良い。
このように3組以上のリンク機構を等間隔に配置し、リンク機構全てに姿勢制御用アクチュエータを設けることで、各姿勢制御用アクチュエータに対してバランス良くトルクが伝達される。そのため、前記姿勢制御用アクチュエータに設けられたトルク検出手段の検出信号を用いてより正確に荷重を推定できるようになる。
In the present invention, the three or more sets of link mechanisms may be arranged at equal intervals in a circumferential direction in which the link mechanisms are arranged, and the attitude control actuator may be provided for all of the link mechanisms.
By arranging three or more link mechanisms at equal intervals and providing attitude control actuators for all the link mechanisms, torque is transmitted to each attitude control actuator in a well-balanced manner. Therefore, it is possible to more accurately estimate the load using the detection signal of the torque detection means provided in the attitude control actuator.

この発明のリンク作動装置は、前記基本構成において、前記3組以上のリンク機構に対して前記姿勢制御用アクチュエータを設けている。
リンク機構を3組とすると、リンク機構同士の干渉も少なくなり、作動範囲が大きくなるだけでなく、部品点数も少ないため、コスト低減に繋がる。また、リンク機構が3組であり、これら3組のリンク機構に対して前記姿勢制御用アクチュエータが設けられていると、バランス良くトルク伝達が行える。そのため、装置先端に作用する荷重を各姿勢制御用アクチュエータのトルク検出手段から求めるにつき、計算が行い易く、より正確に荷重を推定できるようになる。
In the link operating device of the present invention, in the basic configuration, the attitude control actuator is provided for the three or more sets of link mechanisms.
When three sets of link mechanisms are used, interference between the link mechanisms is reduced, and not only the operating range is increased, but also the number of parts is reduced, which leads to cost reduction. Further, when three sets of link mechanisms are provided and the attitude control actuator is provided for these three sets of link mechanisms, torque transmission can be performed in a well-balanced manner. Therefore, when the load acting on the tip of the apparatus is obtained from the torque detecting means of each attitude control actuator, the calculation is easy and the load can be estimated more accurately.

この発明において、前記荷重推定手段は、前記トルク検出手段により検出されるトルク変化量より、前記先端側のリンクハブに作用する衝突を検知する機能を有するようにしても良い。
先端側のリンクハブまたはこれに搭載しているものが何かに衝突すると、姿勢制御用アクチュエータに作用するトルクが急激に変化する。そのため、このトルク変動量により様々な方向に対する衝突を検知することができる。このように前記荷重推定手段に衝突検知機能を設けた構成により、リンク作動装置が人や物に接触した場合でも、それを検知して装置を停止させるなどの措置を採れるようになり、安全性が向上する。
In this invention, the load estimating means may have a function of detecting a collision acting on the link hub on the distal end side from a torque change amount detected by the torque detecting means.
When the link hub on the distal end side or the one mounted on it collides with something, the torque acting on the attitude control actuator changes abruptly. Therefore, collisions in various directions can be detected based on the amount of the torque fluctuation. With the configuration in which the load estimating means is provided with the collision detection function as described above, even when the link operating device comes into contact with a person or an object, it is possible to take measures such as detecting the contact and stopping the device. Is improved.

この発明のリンク作動装置は、前記荷重推定手段が、前記トルク検出手段のそれぞれのトルク値から、前記先端側のリンクハブに作用する荷重値と荷重が作用する方向を検知する機能を有する。
事前に先端に作用する荷重に対する各姿勢制御用アクチュエータに作用するトルクを測定し、各姿勢制御用アクチュエータに作用するトルクと先端に作用する荷重との関係を定めたテーブル等を作成しておいたり、機構解析により各姿勢制御用アクチュエータに作用するトルクから先端に作用する荷重を算出する計算式を立てておけば、トルク検出手段が検出するトルク値から先端側の荷重を推定できるようになる。先端に作用する荷重が精度良く検出されると、先端側のリンクハブに取付けられたエンドエフェクタ等による作業が精度良く行える。
The link operating device according to the present invention has a function in which the load estimating means detects a load value acting on the link hub on the distal end side and a direction in which the load acts from each torque value of the torque detecting means.
Measure the torque acting on each attitude control actuator for the load acting on the tip in advance, and create a table etc. that defines the relationship between the torque acting on each attitude control actuator and the load acting on the tip If a calculation formula for calculating the load acting on the tip from the torque acting on each attitude control actuator is established by a mechanism analysis, the load on the tip side can be estimated from the torque value detected by the torque detecting means. When the load acting on the distal end is detected with high accuracy, the operation by the end effector or the like attached to the link hub on the distal end side can be performed with high accuracy.

この発明のリンク作動装置は、基端側のリンクハブに対し先端側のリンクハブを、3組以上のリンク機構を介して姿勢を変更可能に連結し、前記各リンク機構は、それぞれ前記基端側のリンクハブおよび先端側のリンクハブに一端が回転可能に連結された基端側および先端側の端部リンク部材と、これら基端側および先端側の端部リンク部材の他端に両端がそれぞれ回転可能に連結された中央リンク部材とでなり、前記各リンク機構は、このリンク機構を直線で表現した幾何学モデルが、前記中央リンク部材の中央部に対する基端側部分と先端側部分とが対称を成す形状であり、前記3組以上のリンク機構のうち2組以上のリンク機構に、前記基端側のリンクハブに対する前記先端側のリンクハブの姿勢を任意に変更させる姿勢制御用アクチュエータを設けたリンク作動装置において、前記各姿勢制御用アクチュエータを制御するコントローラが設けられ、このコントローラに、前記各姿勢制御用アクチュエータに指令を出力する姿勢制御手段、および前記先端側のリンクハブに作用する荷重を推定する荷重推定手段が設けられると共に、前記荷重推定手段は、前記各姿勢制御用アクチュエータに作用するトルク変化量より、前記先端側のリンクハブに作用する衝突を検知する衝突検知機能を有し、前記荷重推定手段の衝突検知により前記各姿勢制御用アクチュエータの動作をオフにして自由とする衝突対応制御手段を備えたため、装置先端に作用する様々な方向からの外力を、簡易で安価な構成で検出でき、装置全体の安全性の向上を図ることができる。   The link actuating device of the present invention is configured such that the distal end link hub is connected to the proximal end link hub via three or more sets of link mechanisms so that the attitude can be changed. The proximal and distal end link members, one ends of which are rotatably connected to the side link hub and the distal link hub, and the other ends of the proximal and distal end link members have opposite ends. Each link mechanism is formed of a central link member rotatably connected, and each of the link mechanisms has a geometric model that expresses the link mechanism in a straight line, and includes a proximal portion and a distal portion with respect to a central portion of the central link member. Is a symmetrical shape, and two or more link mechanisms among the three or more link mechanisms allow the two or more link mechanisms to arbitrarily change the attitude of the distal link hub with respect to the proximal link hub. In a link actuating device provided with an eta, a controller for controlling each of the attitude control actuators is provided, and in this controller, attitude control means for outputting a command to each of the attitude control actuators, and a link hub on the distal end side. A load estimating means for estimating a load acting on the link hub is provided, and the load estimating means detects a collision acting on the link hub on the distal end side based on a torque change amount acting on each of the attitude control actuators. With the collision response control means that turns off the operation of each of the attitude control actuators by the load estimation means and detects the collision, the external force acting on the tip of the apparatus from various directions can be easily obtained. Detection can be performed with an inexpensive configuration, and safety of the entire apparatus can be improved.

この発明の第1の実施形態にかかるリンク作動装置の一部を省略した正面図である。It is the front view which omitted a part of link operation device concerning a 1st embodiment of this invention. 同リンク作動装置の基端側のリンクハブ等の横断面図と制御系の概念構成のブロック図とを組み合わせた説明図である。It is explanatory drawing which combined the cross-sectional view of the link hub etc. of the base end side of the link actuator with the block diagram of the conceptual structure of a control system. 同リンク作動装置の一つのリンク機構を直線で表現した模式図である。It is the schematic diagram which represented one link mechanism of the link operation device with a straight line. 同リンク作動装置の作動装置本体の斜視図である。It is a perspective view of the operation device main body of the same link operation device. 同リンク作動装置の図4とは異なる動作状態を示す斜視図である。It is a perspective view which shows the operation state different from FIG. 4 of the same link operating device. 同リンク作動装置の荷重推定手段で用いるトルクと衝突発生との関係を示すグラフである。It is a graph which shows the relationship between the torque used by the load estimating means of the link operating device, and the occurrence of a collision. 同リンク作動装置の荷重推定手段におけるトルクと作用力,作用方向の関係を示すテーブルの説明図である。It is explanatory drawing of the table which shows the relationship of the torque, the acting force, and the acting direction in the load estimation means of the link actuating device. この発明の他の実施形態にかかるリンク作動装置の一部を省略した正面図である。It is the front view which omitted some link operation devices concerning other embodiments of the present invention. 同リンク作動装置の基端側のリンクハブ等の横断面図と制御系の概念構成のブロック図とを組み合わせた説明図である。It is explanatory drawing which combined the cross-sectional view of the link hub etc. of the base end side of the link actuator with the block diagram of the conceptual structure of a control system. この発明のさらに他の実施形態にかかるリンク作動装置の一部を省略した正面図と制御系の概念構成のブロック図とを組み合わせた説明図である。It is an explanatory view combining a front view in which a part of a link operating device according to still another embodiment of the present invention is omitted and a block diagram of a conceptual configuration of a control system. 同リンク作動装置の基端側のリンクハブ等の横断面図である。It is a cross-sectional view of the link hub etc. of the base end side of the link operating device.

この発明の第1の実施形態を図1〜図7と共に説明する。このリンク作動装置1は、パラレルリンク機構9と、このパラレルリンク機構9を作動させる姿勢制御用アクチュエータ10と、この姿勢制御用アクチュエータを制御してパラレルリンク機構9の姿勢を変更させるコントローラ3(図2)とで構成される。   A first embodiment of the present invention will be described with reference to FIGS. The link operating device 1 includes a parallel link mechanism 9, an attitude control actuator 10 that operates the parallel link mechanism 9, and a controller 3 that controls the attitude control actuator to change the attitude of the parallel link mechanism 9 (see FIG. 2).

図1はリンク作動装置の正面図、図4、図5はリンク作動装置の互いに異なる状態を示す斜視図である。パラレルリンク機構9は、基端側のリンクハブ12に対し先端側のリンクハブ13を3組の個別のリンク機構14を介して姿勢変更可能に連結したものである。なお、図1では、1組のリンク機構14のみが示されている。前記3組のリンク機構14は、この実施形態では、これらリンク機構14が並ぶ周方向に等間隔に配置され、前記リンク機構14の全てに対して前記姿勢制御用アクチュエータ10が設けられている。前記3組のリンク機構14の並びの内部空間が、パラレルリンク機構9の内部空間Sとなる。なお、リンク機構14の数は、4組以上であっても良い。   FIG. 1 is a front view of the link operating device, and FIGS. 4 and 5 are perspective views showing different states of the link operating device. The parallel link mechanism 9 is configured by connecting a link hub 13 on the distal end side to a link hub 12 on the proximal end side via three sets of individual link mechanisms 14 so as to be able to change the posture. In FIG. 1, only one set of link mechanisms 14 is shown. In this embodiment, the three sets of link mechanisms 14 are arranged at equal intervals in the circumferential direction in which the link mechanisms 14 are arranged, and the attitude control actuator 10 is provided for all of the link mechanisms 14. The internal space in which the three sets of link mechanisms 14 are arranged is the internal space S of the parallel link mechanism 9. The number of the link mechanisms 14 may be four or more.

各個別のリンク機構14は、基端側の端部リンク部材15、先端側の端部リンク部材16、および中央リンク部材17で構成され、4つの回転対偶からなる4節連鎖のリンク機構をなす。基端側および先端側の端部リンク部材15,16はL字状をなし、一端がそれぞれ基端側のリンクハブ12および先端側のリンクハブ13に回転自在に連結されている。中央リンク部材17は、両端に基端側および先端側の端部リンク部材15,16の他端がそれぞれ回転自在に連結されている。   Each individual link mechanism 14 is composed of a proximal end link member 15, a distal end link member 16, and a center link member 17, and constitutes a four-bar chain link mechanism composed of four rotating pairs. . The proximal and distal end link members 15 and 16 are L-shaped, and have one end rotatably connected to the proximal link hub 12 and the distal link hub 13, respectively. The center link member 17 has the other ends of the end link members 15 and 16 on the base end side and the distal end side rotatably connected to both ends, respectively.

パラレルリンク機構9は、2つの球面リンク機構を組み合わせた構造であって、リンクハブ12,13と端部リンク部材15,16の各回転対偶、および端部リンク部材15,16と中央リンク部材17の各回転対偶の中心軸が、基端側と先端側においてそれぞれの球面リンク中心PA,PB(図3)で交差している。また、基端側と先端側において、リンクハブ12,13と端部リンク部材15,16の各回転対偶とそれぞれの球面リンク中心PA,PBからの距離も同じであり、端部リンク部材15,16と中央リンク部材17の各回転対偶とそれぞれの球面リンク中心PA,PBからの距離も同じである。端部リンク部材15,16と中央リンク部材17との各回転対偶の中心軸は、ある交差角γ(図1)を持っていてもよいし、平行であってもよい。   The parallel link mechanism 9 has a structure in which two spherical link mechanisms are combined, and includes a rotating pair of the link hubs 12 and 13 and the end link members 15 and 16, and the end link members 15 and 16 and the center link member 17. The center axis of each rotation pair intersects the respective spherical link centers PA and PB (FIG. 3) on the base end side and the distal end side. In addition, the distance from each rotational pair of the link hubs 12 and 13 and the end link members 15 and 16 to the respective spherical link centers PA and PB is also the same on the base end side and the distal end side. The distance from each rotational pair of the center link member 16 and the center link member 17 to the respective spherical link centers PA and PB is also the same. The central axes of the rotation pairs of the end link members 15, 16 and the center link member 17 may have a certain intersection angle γ (FIG. 1) or may be parallel.

図2は基端側のリンクハブ12、基端側の端部リンク部材15等の断面図にコントローラ3の概念構成のブロックを加えた図である。同図に、基端側のリンクハブ12と基端側の端部リンク部材15の各回転対偶の中心軸O1と、球面リンク中心PAとの関係が示されている。先端側のリンクハブ13および先端側の端部リンク部材16の形状ならびに位置関係も図2と同様である(図示せず)。図の例では、リンクハブ12,13と端部リンク部材15,16との各回転対偶の中心軸O1と、端部リンク部材15,16と中央リンク部材17との各回転対偶の中心軸O2とが成す角度αが90°とされているが、前記角度αは90°以外であっても良い。   FIG. 2 is a cross-sectional view of the link hub 12 on the base end side, the end link member 15 on the base end side, and the like, in which blocks of the conceptual configuration of the controller 3 are added. The figure shows the relationship between the center axis O1 of each rotating pair of the base link hub 12 and the base end link member 15, and the spherical link center PA. The shape and positional relationship of the link hub 13 on the distal end side and the end link member 16 on the distal end side are the same as those in FIG. 2 (not shown). In the example shown in the figure, the center axis O1 of each rotating pair of the link hubs 12, 13 and the end link members 15, 16 and the center axis O2 of each rotating pair of the end link members 15, 16 and the center link member 17 are shown. Is 90 °, the angle α may be other than 90 °.

3組のリンク機構14は、幾何学的に同一形状をなす。幾何学的に同一形状とは、図3に示すように、各リンク部材15,16,17を直線で表現した幾何学モデル、すなわち各回転対偶と、これら回転対偶間を結ぶ直線とで表現したモデルが、中央リンク部材17の中央部に対する基端側部分と先端側部分が対称を成す形状であることを言う。図3は、一組のリンク機構14を直線で表現した図である。この実施形態のパラレルリンク機構9は回転対称タイプで、基端側のリンクハブ12および基端側の端部リンク部材15と、先端側のリンクハブ13および先端側の端部リンク部材16との位置関係が、中央リンク部材17の中心線Cに対して回転対称となる位置構成になっている。各中央リンク部材17の中央部は、共通の軌道円D上に位置している。   The three sets of link mechanisms 14 are geometrically identical. As shown in FIG. 3, the geometrically identical shape is represented by a geometric model in which each link member 15, 16, 17 is represented by a straight line, that is, each rotational pair and a line connecting these rotational pairs. This means that the model has a shape in which the proximal end portion and the distal end portion with respect to the central portion of the central link member 17 are symmetrical. FIG. 3 is a diagram in which one set of link mechanisms 14 is represented by a straight line. The parallel link mechanism 9 of this embodiment is of a rotationally symmetric type, and includes a base link hub 12 and a base end link member 15, and a front link hub 13 and a front end link member 16. The positional relationship is such that the positional relationship is rotationally symmetric with respect to the center line C of the center link member 17. The central portion of each central link member 17 is located on a common track circle D.

基端側のリンクハブ12と先端側のリンクハブ13と3組のリンク機構14とで、基端側のリンクハブ12に対し先端側のリンクハブ13が直交2軸周りに回転自在な2自由度機構が構成される。言い換えると、基端側のリンクハブ12に対して先端側のリンクハブ13を、回転が2自由度で姿勢変更自在とした機構である。この2自由度機構は、コンパクトでありながら、基端側のリンクハブ12に対する先端側のリンクハブ13の可動範囲を広くとれる。   The proximal link hub 12, the distal link hub 13, and three sets of link mechanisms 14 allow the distal link hub 13 to freely rotate about two orthogonal axes with respect to the proximal link hub 12. A degree mechanism is configured. In other words, this is a mechanism that allows the attitude of the link hub 13 on the distal end side to be freely changed with two degrees of freedom with respect to the link hub 12 on the proximal end side. This two-degree-of-freedom mechanism can make the movable range of the link hub 13 on the distal end relative to the link hub 12 on the proximal end wide while being compact.

例えば、球面リンク中心PA,PBを通り、リンクハブ12,13と端部リンク部材15,16の各回転対偶の中心軸O1(図2)と直角に交わる直線をリンクハブ12,13の中心軸QA,QBとした場合、基端側のリンクハブ12の中心軸QAと先端側のリンクハブ13の中心軸QBとの折れ角θ(図3)の最大値を約±90°とすることができる。また、基端側のリンクハブ12に対する先端側のリンクハブ13の旋回角φ(図3)を0°〜360°の範囲に設定できる。折れ角θは、基端側のリンクハブ12の中心軸QAに対して先端側のリンクハブ13の中心軸QBが傾斜した垂直角度のことであり、旋回角φは、基端側のリンクハブ12の中心軸QAに対して先端側のリンクハブ13の中心軸QBが傾斜した水平角度のことである。   For example, a straight line that passes through the spherical link centers PA and PB and that intersects at right angles with the center axis O1 (FIG. 2) of each rotation pair of the link hubs 12 and 13 and the end link members 15 and 16 is formed as a center axis of the link hubs 12 and 13. In the case of QA and QB, the maximum value of the bending angle θ (FIG. 3) between the central axis QA of the proximal link hub 12 and the central axis QB of the distal link hub 13 may be about ± 90 °. it can. Further, the turning angle φ (FIG. 3) of the distal link hub 13 with respect to the proximal link hub 12 can be set in the range of 0 ° to 360 °. Is the vertical angle at which the central axis QB of the distal link hub 13 is inclined with respect to the central axis QA of the proximal link hub 12, and the turning angle φ is the vertical link hub. 12 is a horizontal angle at which the center axis QB of the link hub 13 on the distal end side is inclined with respect to the center axis QA of the twelve.

基端側のリンクハブ12に対する先端側のリンクハブ13の姿勢変更は、基端側のリンクハブ12の中心軸QAと先端側のリンクハブ13の中心軸QBとの交点Oを回転中心として行われる。図4は、基端側のリンクハブ12の中心軸QAと先端側のリンクハブ13の中心軸QBが同一線上にある状態を示し、図5は、基端側のリンクハブ12の中心軸QAに対して先端側のリンクハブ13の中心軸QBが或る作動角をとった状態を示す。姿勢が変化しても、基端側と先端側の球面リンク中心PA,PB間の距離L(図3)は変化しない。   The posture of the distal link hub 13 with respect to the proximal link hub 12 is changed with the center of rotation O at the intersection O between the central axis QA of the proximal link hub 12 and the central axis QB of the distal link hub 13. Will be FIG. 4 shows a state in which the central axis QA of the proximal link hub 12 and the central axis QB of the distal link hub 13 are on the same line, and FIG. 5 shows the central axis QA of the proximal link hub 12. 5 shows a state where the central axis QB of the link hub 13 on the distal end side has a certain operating angle. Even if the posture changes, the distance L (FIG. 3) between the spherical link centers PA and PB on the proximal and distal ends does not change.

このパラレルリンク機構9において、各リンク機構14におけるリンクハブ12,13と端部リンク部材15,16の回転対偶の中心軸O1(図2)の角度および球面リンク中心PA,PBからの長さが互いに等しく、かつ各リンク機構14のリンクハブ12,13と端部リンク部材15,16の回転対偶の中心軸O1、および、端部リンク部材15,16と中央リンク17の回転対偶の中心軸O2が、基端側および先端側において球面リンク中心PA,PBと交差し、かつ基端側の端部リンク部材15と先端側の端部リンク部材16の幾何学的形状が等しく、かつ中央リンク部材17についても基端側の先端側とで形状が等しいとき、中央リンク部材17の対称面に対して、中央リンク部材17と端部リンク部材15,16との角度位置関係を基端側と先端側とで同じにすれば、幾何学的対称性から基端側のリンクハブ12および基端側の端部リンク部材15と、先端側のリンクハブ13および先端側の端部リンク部材16とは同じに動く。   In this parallel link mechanism 9, the angle of the rotation center of the link hubs 12 and 13 and the end link members 15 and 16 of each link mechanism 14 and the center axis O1 (FIG. 2) and the length from the spherical link centers PA and PB are set. The center axes O1 of the rotation pairs of the link hubs 12, 13 and the end link members 15, 16 of each link mechanism 14, which are equal to each other, and the center axis O2 of the rotation pairs of the end link members 15, 16 and the center link 17 Intersect the spherical link centers PA and PB on the proximal side and the distal side, and the geometric shapes of the proximal end link member 15 and the distal end link member 16 are equal, and the central link member When the shape of the center link member 17 is the same as the shape of the base end portion on the distal end side, the angular position relationship between the center link member 17 and the end link members 15 and 16 with respect to the symmetry plane of the center link member 17 is obtained. Are the same on the proximal side and the distal side, the geometrical symmetry makes the proximal link hub 12 and the proximal end link member 15, the distal link hub 13 and the distal end The part link member 16 moves in the same manner.

図1に示すように、基端側のリンクハブ12は、前記ベース部材6と、このベース部材6と一体に設けられた3個の回転軸連結部材21とで構成される。ベース部材6は中央部に円形の貫通孔6a(図2)を有し、この貫通孔6aの周囲に3個の回転軸連結部材21が円周方向に等間隔で配置されている。貫通孔6aの中心は、基端側のリンクハブ中心軸QA上に位置する。各回転軸連結部材21には、軸心がリンクハブ中心軸QAと交差する回転軸22が軸受23により回転自在に連結されている。軸受23は、スペーサ24と共に前記回転軸連結部材21に設置されている。前記回転軸22に、基端側の端部リンク部材15の一端が、ナット22cで止め付けて連結される。   As shown in FIG. 1, the link hub 12 on the proximal end side includes the base member 6 and three rotation shaft connecting members 21 provided integrally with the base member 6. The base member 6 has a circular through hole 6a (FIG. 2) in the center, and three rotation shaft connecting members 21 are arranged around the through hole 6a at equal intervals in the circumferential direction. The center of the through hole 6a is located on the link hub center axis QA on the base end side. A rotating shaft 22 whose axis intersects the link hub center axis QA is rotatably connected to each rotating shaft connecting member 21 by a bearing 23. The bearing 23 is installed on the rotating shaft connecting member 21 together with the spacer 24. One end of the end link member 15 on the proximal end side is connected to the rotating shaft 22 by being fixed with a nut 22c.

回転軸22は、減速機構52の出力軸に同軸上に配置される。また、減速機構52の出力軸には、この減速機構52の出力軸と一体に回転するように、スペーサ28を介して基端側の端部リンク部材15の一端がボルト29で連結される。ボルト29は、基端側の端部リンク部材15の一端に形成された切欠き部25内から止め付けられている。
基端側の端部リンク部材15の他端には切欠き部26が設けられ、この切欠き部26内に配置された中央リンク部材17の一端に、回転自在に連結する回転軸35が連結される。
The rotation shaft 22 is arranged coaxially with the output shaft of the speed reduction mechanism 52. One end of the proximal end link member 15 is connected to the output shaft of the speed reduction mechanism 52 via a spacer 28 with a bolt 29 so as to rotate integrally with the output shaft of the speed reduction mechanism 52. The bolt 29 is fixed from a notch 25 formed at one end of the end link member 15 on the base end side.
A notch 26 is provided at the other end of the end link member 15 on the base end side, and a rotation shaft 35 rotatably connected to one end of the center link member 17 disposed in the notch 26 is connected. Is done.

図1,図4,図5に示すように、先端側のリンクハブ13は、平板状の先端部材40と、この先端部材40の底面に円周方向等配で設けられた3個の回転軸連結部材41とで構成される。先端部材40には、このリンク作動装置1の用途に応じて作業機となるエンドエフェクタ(図示せず)が取付けられる。各回転軸連結部材41が配置される円周の中心は、先端側のリンクハブ中心軸QB上に位置する。各回転軸連結部材41は、軸心がリンクハブ中心軸QBと交差する回転軸42(図4)が回転自在に連結されている。この先端側のリンクハブ13の回転軸42に、先端側の端部リンク部材16の一端が連結される。先端側の端部リンク部材16の他端には、中央リンク部材17の他端に回転自在に連結された回転軸45が連結される。先端側のリンクハブ13の回転軸42および中央リンク部材17の回転軸45も、前記回転軸35と同じ形状であり、かつ2個の軸受(図示せず)を介して回転軸連結部材41および中央リンク部材17の他端にそれぞれ回転自在に連結されている。   As shown in FIGS. 1, 4, and 5, the link hub 13 on the tip side includes a plate-shaped tip member 40 and three rotating shafts provided on the bottom surface of the tip member 40 at equal circumferential intervals. And a connecting member 41. An end effector (not shown) serving as a working machine is attached to the distal end member 40 according to the use of the link operating device 1. The center of the circumference where each rotation shaft connecting member 41 is arranged is located on the link hub center axis QB on the distal end side. Each rotating shaft connecting member 41 is rotatably connected to a rotating shaft 42 (FIG. 4) whose axis intersects the link hub center axis QB. One end of the end link member 16 on the front end is connected to the rotation shaft 42 of the link hub 13 on the front end. A rotating shaft 45 rotatably connected to the other end of the center link member 17 is connected to the other end of the end link member 16 on the distal end side. The rotation shaft 42 of the link hub 13 on the distal end side and the rotation shaft 45 of the center link member 17 have the same shape as the rotation shaft 35, and are connected to the rotation shaft connecting member 41 and the rotation shaft via two bearings (not shown). The center link member 17 is rotatably connected to the other end.

リンク作動装置1の姿勢制御用アクチュエータ10は、減速機構52を備えたロータリアクチュエータであり、具体的には減速機構付きのサーボモータであり、基端側のリンクハブ12のベース部材6の上面に、前記回転軸22と同軸上に設置されている。姿勢制御用アクチュエータ10と減速機構52は一体に設けられ、モータ固定部材53により減速機構52がベース部材6に固定されている。この例では、3組のリンク機構14の全てに姿勢制御用アクチュエータ10が設けられている。なお、3組のリンク機構14のうち少なくとも2組に姿勢制御用アクチュエータ10を設ければ、基端側のリンクハブ12に対する先端側のリンクハブ13の姿勢を確定することができる。   The attitude control actuator 10 of the link actuating device 1 is a rotary actuator having a speed reduction mechanism 52, specifically, a servomotor with a speed reduction mechanism, and is provided on the upper surface of the base member 6 of the link hub 12 on the base end side. , Are installed coaxially with the rotation shaft 22. The attitude control actuator 10 and the speed reduction mechanism 52 are provided integrally, and the speed reduction mechanism 52 is fixed to the base member 6 by a motor fixing member 53. In this example, the attitude control actuator 10 is provided in all three sets of link mechanisms 14. If the attitude control actuators 10 are provided in at least two of the three link mechanisms 14, the attitude of the distal link hub 13 with respect to the proximal link hub 12 can be determined.

図2において、コントローラ3は、リンク作動装置1のパラレルリンク機構9を制御する装置であり、上位の制御手段(図示せず)または手入力の操作手段(図示せず)から与えられた姿勢変更先の指令に従って、各姿勢制御用アクチュエータ10に回転角度の指令を出力する姿勢制御手段4が設けられている。コントローラ3への変更先の姿勢指令は、例えば前記旋回角φ(図3)と折れ角θで与えられるが、姿勢制御手段4は、与えられた旋回角φと折れ角θの指令を、所定の演算式に従って各姿勢制御用アクチュエータ10の回転角度の指令に変換し、各姿勢制御用アクチュエータ10に出力する。また、姿勢制御手段4は、各姿勢制御用アクチュエータ10に設けられた回転角度検出器(図示せず)の検出信号を用いてサーボ機構(図示せず)によりフィードバック制御を行う。パラレルリンク機構9に前記エンドエフェクタ(図示せず)を設ける場合は、このエンドエフェクタの制御についても、コントローラ3により行う。   In FIG. 2, a controller 3 is a device for controlling the parallel link mechanism 9 of the link actuating device 1, and changes the attitude given by a higher-level control means (not shown) or a manual input operation means (not shown). Attitude control means 4 for outputting a rotation angle instruction to each attitude control actuator 10 in accordance with the previous instruction is provided. The posture command of the change destination to the controller 3 is given, for example, by the turning angle φ (FIG. 3) and the bending angle θ, and the posture control means 4 sends the given command of the turning angle φ and the bending angle θ to a predetermined value. Is converted into a command of the rotation angle of each attitude control actuator 10 in accordance with the following equation, and is output to each attitude control actuator 10. The attitude control means 4 performs feedback control by a servo mechanism (not shown) using a detection signal of a rotation angle detector (not shown) provided in each attitude control actuator 10. When the end effector (not shown) is provided in the parallel link mechanism 9, the controller 3 also controls the end effector.

このコントローラ3に、前記先端側のリンクハブ13(図1)に作用する荷重を推定する荷重推定手段5が設けられている。前記姿勢制御用アクチュエータ10は、それぞれがトルク検出手段8を有し、これらのトルク検出手段8の検出信号から、前記荷重推定手段5による前記先端側のリンクハブ13の作用荷重の推定を行う。トルク検出手段8は、例えば、各姿勢制御用アクチュエータ10に流れる電流を検出する電流センサ等からなる。   The controller 3 is provided with a load estimating means 5 for estimating a load acting on the link hub 13 (FIG. 1) on the distal end side. Each of the attitude control actuators 10 has torque detecting means 8, and estimates the applied load of the link hub 13 on the distal end side by the load estimating means 5 from the detection signals of the torque detecting means 8. The torque detecting means 8 includes, for example, a current sensor for detecting a current flowing through each of the attitude control actuators 10.

荷重推定手段5による先端側のリンクハブ13の作用荷重の推定は、必ずしも数値として推定しなくても良く、例えば衝突が生じたか否かの判定を行える程度の段階的な推定であっても良い。図6は、衝突検知の例を示し、縦軸に各トルク検出手段8が検出したトルクの値を、横軸に時間の経過をそれぞれ示す。同図の例では、姿勢制御用アクチュエータ10の加速時のトルク値を示しており、各姿勢制御用アクチュエータ10のトルク値は次第に上昇しているが、時刻t1の時点で急激に上昇している。荷重推定手段5は、このような各トルク検出手段8により検出されるトルクの単位時間当たりの変化量であるトルク変化量(同図ではトルク変化曲線の勾配で表れる)から、先端側のリンクハブ13が衝突をしたことを検知するようにしても良い。この衝突検知では、トルク変化量は、例えば閾値を超えたか否かが分かれば良い。この衝突検知において、荷重推定手段5は、各トルク検出手段8の検出値のうち、いずれか一つのトルク検出手段8の検出値が閾値を超えていると衝突と判定するようにしても良く、また各トルク検出手段8の検出値から、定められた規則に従って総合的に判断して衝突と判定するようにしても良い。   The estimation of the acting load of the link hub 13 on the distal end side by the load estimating means 5 does not necessarily need to be estimated as a numerical value, and may be, for example, a stepwise estimation that can determine whether or not a collision has occurred. . FIG. 6 shows an example of collision detection, in which the vertical axis shows the value of the torque detected by each torque detecting means 8, and the horizontal axis shows the passage of time. In the example shown in the figure, the torque value of the attitude control actuator 10 during acceleration is shown, and the torque value of each attitude control actuator 10 gradually increases, but sharply increases at time t1. . The load estimating means 5 calculates the torque change amount (indicated by the gradient of the torque change curve in FIG. 5) which is the change amount per unit time of the torque detected by each of the torque detecting means 8 based on the torque change amount. 13 may detect that it has collided. In this collision detection, it is only necessary to know whether or not the torque change amount has exceeded a threshold value, for example. In this collision detection, the load estimating means 5 may determine that a collision has occurred if any one of the detected values of the torque detecting means 8 exceeds the threshold value. Alternatively, a collision may be determined based on the detection values of the respective torque detecting means 8 according to a predetermined rule.

前記荷重推定手段5が上記のように衝突検知機能を有するものである場合、前記コントーラ3またはその前記前記姿勢制御手段4に、前記荷重推定手段5による衝突検知によって、各姿勢制御用アクチュエータ10の動作をサーボオフ等によって自由とする衝突対応制御手段(図示せず)を設けても良い。このようにサーボオフ等によって自由にパラレルリンク機構9が自由に移動できるようにすることで、安全性が向上する。   When the load estimating means 5 has a collision detection function as described above, the controller 3 or the attitude control means 4 thereof is provided with the collision detection by the load estimating means 5 so that each of the attitude control actuators 10 A collision handling control means (not shown) that makes the operation free by servo-off or the like may be provided. As described above, the safety is improved by allowing the parallel link mechanism 9 to freely move by servo-off or the like.

この実施形態では、荷重推定手段5は、上記衝突検知の機能の他に、前記トルク検出手段8のそれぞれのトルク値から、前記先端側のリンクハブ13に作用する荷重値と荷重が作用する方向の検知を可能としている。
この例では、具体的には、事前に先端側のリンクハブ13に作用する荷重に対する各姿勢制御用アクチュエータ10に作用するトルクを測定し、その測定結果を用いて、各姿勢制御用アクチュエータ10に作用するトルクT1,T2,T3と先端側のリンクハブ13に作用する荷重との関係を定めたテーブル7(図7)を作成しておき、前記各トルクT1,T2,T3の検出値を前記テーブル7と照合して作用力と方向を求めるようにしている。テーブル7における方向は、例えば、図3に示す先端側のリンクハブ13の旋回角φである。
In this embodiment, in addition to the collision detection function, the load estimating means 5 calculates the load value acting on the link hub 13 on the distal end side and the direction in which the load acts based on the respective torque values of the torque detecting means 8. Detection is possible.
In this example, specifically, the torque acting on each posture control actuator 10 with respect to the load acting on the link hub 13 on the distal end side is measured in advance, and the measurement result is used to apply the posture control actuator 10 to each posture control actuator 10. A table 7 (FIG. 7) defining the relationship between the acting torques T1, T2, T3 and the load acting on the link hub 13 on the distal end side is prepared, and the detected values of the torques T1, T2, T3 are determined by The acting force and the direction are obtained by collating with the table 7. The direction in the table 7 is, for example, the turning angle φ of the link hub 13 on the distal end side shown in FIG.

荷重推定手段5は、図7のテーブル7を用いる代わりに、機構解析により各姿勢制御用アクチュエータ10に作用するトルクから先端側のリンクハブ13に作用する荷重を算出する計算式を備えておき、トルク検出手段8が検出するトルク値T1,T2,T3から先端側のリンクハブ13に作用する荷重を推定するようにしても良い。   The load estimating means 5 has a calculation formula for calculating the load acting on the link hub 13 on the distal end side from the torque acting on each posture control actuator 10 by a mechanism analysis, instead of using the table 7 in FIG. The load acting on the link hub 13 on the distal end side may be estimated from the torque values T1, T2, T3 detected by the torque detecting means 8.

この構成のリンク作動装置1によると、上記のように、基端側のリンクハブ12と、先端側のリンクハブ13と、3組以上のリンク機構14とで、基端側のリンクハブ12に対し先端側のリンクハブ13が直交2軸周りに回転自在な2自由度機構が構成される。この2自由度機構は、コンパクトでありながら、先端側のリンクハブ13の可動範囲を広くとれる。各姿勢制御用アクチュエータ10の動作を制御することで、基端側のリンクハブ12に対して先端側のリンクハブ13の姿勢を任意に変更させることができる。   According to the link operating device 1 having this configuration, as described above, the proximal link hub 12, the distal link hub 13, and the three or more sets of link mechanisms 14 form the proximal link hub 12. On the other hand, a two-degree-of-freedom mechanism in which the link hub 13 on the distal end side is rotatable about two orthogonal axes is configured. This two-degree-of-freedom mechanism allows a wide movable range of the link hub 13 on the distal end side while being compact. By controlling the operation of each posture control actuator 10, the posture of the distal link hub 13 with respect to the proximal link hub 12 can be arbitrarily changed.

このような構成のリンク作動装置1において、姿勢制御用アクチュエータ10にトルク検出手段8を設け、このトルク検出手段8の検出信号から先端側のリンクハブ13に作用する荷重を推定する荷重推定手段5を設けたため、別のセンサを先端側のリンクハブ13等の可動部分に設けることなく荷重を推定することができる。先端側のリンクハブ13の荷重は、前記各リンク機構14を介して前記各姿勢制御用アクチュエータ10に伝わるため、各姿勢制御用アクチュエータ10のトルクから先端側のリンクハブ13の荷重を計算できる。前記トルク検出手段8は、姿勢制御用アクチュエータ10に印加する電流を検出するセンサ等の簡単な検出手段で構成できる。   In the link actuating device 1 having such a configuration, the attitude control actuator 10 is provided with the torque detecting means 8 and the load estimating means 5 for estimating the load acting on the link hub 13 on the distal end side from the detection signal of the torque detecting means 8. Is provided, the load can be estimated without providing another sensor on a movable portion such as the link hub 13 on the distal end side. Since the load of the link hub 13 on the distal end side is transmitted to each of the attitude control actuators 10 via each of the link mechanisms 14, the load on the link hub 13 on the distal end side can be calculated from the torque of each of the attitude control actuators 10. The torque detecting means 8 can be constituted by a simple detecting means such as a sensor for detecting a current applied to the attitude control actuator 10.

このように、姿勢制御用アクチュエータ10にトルク検出手段8を設け、別のセンサを先端側のリンクハブ13等の可動部分に設けることなく、先端側のリンクハブ13に作用する荷重を推定するようにしたため、装置全体のコンパクト化やコスト低減に繋がる。
また、上記構成のリンク作動装置1は、その可動範囲内において特異点がなく全方向にスムーズに動ける構成であるため、先端側のリンクハブ13に様々な方向から荷重が作用した場合でも姿勢制御用アクチュエータ10に確実にトルクが伝達され、正確に荷重を推定することができる。
In this manner, the torque acting on the distal link hub 13 is estimated without providing the torque detecting means 8 on the attitude control actuator 10 and providing another sensor on a movable portion such as the distal link hub 13. This leads to downsizing of the entire apparatus and cost reduction.
In addition, since the link operating device 1 having the above-described configuration has no singularity within its movable range and can move smoothly in all directions, the posture control is performed even when loads are applied to the distal end link hub 13 from various directions. Torque is reliably transmitted to the actuator 10 for use, and the load can be accurately estimated.

この実施形態では、前記3組以上のリンク機構14を等間隔に配置し、これらリンク機構14の全てに姿勢制御用アクチュエータ10を設けたため、各姿勢制御用アクチュエータ10に対してバランス良くトルクが伝達される。そのため、前記姿勢制御用アクチュエータ10に設けられたトルク検出手段8の検出信号を用いて正確に荷重を推定できるようになる。また、リンク機構14は3組としたため、リンク機構14の相互の干渉も少なくなり、作動範囲が大きくなるだけでなく、部品点数も少なくなって、コスト低減に繋がる。   In this embodiment, the three or more sets of the link mechanisms 14 are arranged at equal intervals, and the attitude control actuators 10 are provided in all of the link mechanisms 14, so that the torque is transmitted to each attitude control actuator 10 in a well-balanced manner. Is done. Therefore, the load can be accurately estimated using the detection signal of the torque detection means 8 provided in the attitude control actuator 10. Further, since three sets of the link mechanisms 14 are used, mutual interference of the link mechanisms 14 is reduced, and not only the operating range is increased, but also the number of parts is reduced, leading to cost reduction.

また、前記荷重推定手段5は、前記トルク検出手段8により検出されるトルク変化量より、前記先端側のリンクハブ13に作用する衝突を検知する機能を有する。
先端側のリンクハブ13に搭載しているもの、例えばエンドエフェクタ(図示せず)が何かに衝突すると、姿勢制御用アクチュエータ10に作用するトルクが急激に変化する(図 参照)。そのため、このトルク変動量により様々な方向に対する衝突を検知することができる。このように前記荷重推定手段5に衝突検知機能を設けた構成により、リンク作動装置1が人や物に接触した場合でも、それを検知して装置を停止させるなどの措置をと採れるようになり、安全性が向上する。
Further, the load estimating means 5 has a function of detecting a collision acting on the link hub 13 on the distal end side from a torque change amount detected by the torque detecting means 8.
When a component mounted on the link hub 13 on the distal end side, for example, an end effector (not shown) collides with something, the torque acting on the attitude control actuator 10 changes abruptly (see the figure). Therefore, collisions in various directions can be detected based on the amount of the torque fluctuation. With the configuration in which the load estimating means 5 is provided with a collision detection function, even when the link operating device 1 comes into contact with a person or an object, measures can be taken such as detecting the contact and stopping the device. , Safety is improved.

前記荷重推定手段5は、さらに、前記トルク検出手段8のそれぞれのトルク値から、前記先端側のリンクハブ13に作用する荷重値と荷重が作用する方向の検知する機能を有する。前述のようにテーブル7等を作成しておいたり、計算式を立てておけば、トルク検出手段8が検出するトルク値から先端側の荷重を推定できるようになる。先端に作用する荷重が精度良く検出されると、先端側のリンクハブ13に取付けられたエンドエフェクタ等による作業が精度良く行える。   The load estimating means 5 further has a function of detecting, from the respective torque values of the torque detecting means 8, a load value acting on the link hub 13 on the distal end side and a direction in which the load acts. As described above, if the table 7 and the like are prepared or a calculation formula is prepared, the load on the distal end side can be estimated from the torque value detected by the torque detecting means 8. When the load acting on the distal end is accurately detected, the operation by the end effector or the like attached to the link hub 13 on the distal end side can be performed with high accuracy.

図8,図9は、他の実施形態を示す。特に説明する事項の他は、図1〜図7に示す第1の実施形態と同様であるので、重複する説明を省略する。この実施形態では、図8、図9に示すように先端側のリンクハブ13が多角形状に形成され、基端側のリンクハブ12は、ベース部材6上にスペーサ65を介して多角形状の基端側のリンクハブ12を設置した構成とされている。先端側のリンクハブ13にエンドエフェクタ(図示せず)が設置されている。また、姿勢制御用アクチュエータ10が図9のように接続されている。   8 and 9 show another embodiment. Except for matters to be particularly described, they are the same as those of the first embodiment shown in FIGS. 1 to 7, and thus redundant description will be omitted. In this embodiment, as shown in FIGS. 8 and 9, the link hub 13 on the distal end side is formed in a polygonal shape, and the link hub 12 on the proximal end side is formed on the base member 6 through a spacer 65 with a polygonal base. The link hub 12 on the end side is provided. An end effector (not shown) is installed on the link hub 13 on the distal end side. Further, an attitude control actuator 10 is connected as shown in FIG.

パラレルリンク機構9の3組のリンク機構14の全てに、基端側の端部リンク部材15を回動させて基端側のリンクハブ12に対する先端側のリンクハブ13の姿勢を任意に変更させる姿勢制御用アクチュエータ10と、この姿勢制御用アクチュエータ10の動作量を基端側の端部リンク部材15に減速して伝達する減速機構71とが設けられている。姿勢制御用アクチュエータ10はロータリアクチュエータ、より詳しくは減速機52付きのサーボモータであって、モータ固定部材53によりベース部材6に固定されている。減速機構71は、姿勢制御用アクチュエータ10の減速機52と、歯車式の減速部73とでなる。以下では、減速機構71に平歯車を使用しているが、その他の機構(例えば、かさ歯車やウォーム機構)でも良い。   All three sets of link mechanisms 14 of the parallel link mechanism 9 rotate the proximal end link member 15 to arbitrarily change the attitude of the distal link hub 13 with respect to the proximal link hub 12. An attitude control actuator 10 and a speed reduction mechanism 71 that reduces and transmits the operation amount of the attitude control actuator 10 to the end link member 15 on the base end side are provided. The attitude control actuator 10 is a rotary actuator, more specifically, a servomotor with a speed reducer 52, and is fixed to the base member 6 by a motor fixing member 53. The speed reduction mechanism 71 includes the speed reducer 52 of the attitude control actuator 10 and a gear type speed reduction unit 73. In the following, a spur gear is used for the reduction mechanism 71, but another mechanism (for example, a bevel gear or a worm mechanism) may be used.

歯車式の減速部73は、姿勢制御用アクチュエータ10の出力軸にカップリング75を介して回転伝達可能に連結された小歯車76と、基端側の端部リンク部材15に固定され前記小歯車76と噛み合う大歯車77とで構成されている。図示例では、小歯車76および大歯車77は平歯車であり、大歯車77は、扇形の周面にのみ歯が形成された扇形歯車である。大歯車77は小歯車76よりもピッチ円半径が大きく、姿勢制御用アクチュエータ10の出力軸の回転が基端側の端部リンク部材15へ、減速して伝達される。   The gear type reduction unit 73 includes a small gear 76 connected to an output shaft of the attitude control actuator 10 via a coupling 75 so as to be capable of transmitting rotation, and a small gear 76 fixed to the proximal end link member 15. 76 and a large gear 77 that meshes. In the illustrated example, the small gear 76 and the large gear 77 are spur gears, and the large gear 77 is a sector gear having teeth formed only on the peripheral surface of the sector. The large gear 77 has a larger pitch circle radius than the small gear 76, and the rotation of the output shaft of the attitude control actuator 10 is transmitted to the proximal end link member 15 at reduced speed.

この実施形態のようにパラレルリンク機構9および姿勢制御用アクチュエータ10を構成した場合も、コントローラ3の荷重推定手段5によって、前記第1の実施形態と同様に、装置先端に作用する様々な方向からの外力を、簡易で安価な構成で検出でき、装置全体の安全性の向上を図ることができる。   Also in the case where the parallel link mechanism 9 and the attitude control actuator 10 are configured as in this embodiment, the load estimating means 5 of the controller 3 can be used in various directions acting on the front end of the apparatus, as in the first embodiment. Can be detected with a simple and inexpensive configuration, and the safety of the entire apparatus can be improved.

図10,図11は、さらに他の実施形態を示す。特に説明する事項の他は、図1〜図7に示す第1の実施形態と同様であるので、重複する説明を省略する。この実施形態では、基端側のリンクハブ12および先端側のリンクハブ13は、その中心部にそれぞれ貫通孔が形成されて外形が球面状をしたドーナツ形状をしている。これら基端側のリンクハブ12および先端側のリンクハブ13の外周面の円周方向に等間隔の位置に、基端側の端部リンク部材15および先端側の端部リンク部材16がそれぞれ回転自在に連結されている。   10 and 11 show still another embodiment. Except for matters to be particularly described, they are the same as those of the first embodiment shown in FIGS. 1 to 7, and thus redundant description will be omitted. In this embodiment, the link hub 12 on the proximal end side and the link hub 13 on the distal end side have a donut shape having a spherical outer shape with a through hole formed at the center thereof. The proximal end link member 15 and the distal end link member 16 are respectively rotated at equal circumferential positions on the outer peripheral surfaces of the proximal link hub 12 and the distal link hub 13. They are freely connected.

図11は、基端側のリンクハブ12と基端側の端部リンク部材15の回転対偶部、および基端側の端部リンク部材15と中央リンク部材17の回転対偶部を示す断面図である。基端側のリンクハブ12は、外周部に半径方向の軸孔81が円周方向3箇所に形成され、各軸孔81内に設けた二つの軸受82により軸部材83がそれぞれ回転自在に支持されている。軸部材83の中心は、基端側のリンクハブ12と基端側の端部リンク部材15との回転対偶の中心軸と一致している。軸部材83の外側端部は基端側のリンクハブ12から突出し、その突出ねじ部83aに基端側の端部リンク部材15が結合され、ナット94によって締付け固定されている。   FIG. 11 is a cross-sectional view showing a rotating pair of the proximal link hub 12 and the proximal end link member 15, and a rotating pair of the proximal end link member 15 and the central link member 17. is there. The proximal end link hub 12 has radial shaft holes 81 formed in the outer peripheral portion at three locations in the circumferential direction, and the shaft members 83 are rotatably supported by two bearings 82 provided in each shaft hole 81. Have been. The center of the shaft member 83 coincides with the center axis of the rotation pair of the link hub 12 on the base end side and the end link member 15 on the base end side. The outer end of the shaft member 83 protrudes from the proximal link hub 12, and the proximal end link member 15 is coupled to the projecting screw portion 83 a, and is fastened and fixed by a nut 94.

前記軸受82は、例えば深溝玉軸受等の転がり軸受であり、その外輪(図示せず)が前記軸孔81の内周に嵌合し、その内輪(図示せず)が前記軸部材83の外周に嵌合している。外輪は止め輪85によって抜け止めされている。また、内輪と基端側の端部リンク部材15の間には間座86が介在し、ナット84の締付力が基端側の端部リンク部材15および間座86を介して内輪に伝達されて、軸受82に所定の予圧を付与している。   The bearing 82 is, for example, a rolling bearing such as a deep groove ball bearing. The outer ring (not shown) of the bearing 82 is fitted into the inner periphery of the shaft hole 81, and the inner ring (not shown) of the bearing 82 is formed on the outer periphery of the shaft member 83. Is fitted. The outer ring is retained by a retaining ring 85. A spacer 86 is interposed between the inner ring and the end link member 15 on the proximal side, and the tightening force of the nut 84 is transmitted to the inner ring via the end link member 15 on the proximal side and the spacer 86. Thus, a predetermined preload is applied to the bearing 82.

基端側の端部リンク部材15と中央リンク部材17の回転対偶部は、中央リンク部材17の両端に形成された連通孔88に二つの軸受89が設けられ、これら軸受89により、基端側の端部リンク部材15の先端の軸部90が回転自在に支持されている。軸受89は、間座91を介して、ナット92によって締付け固定されている。   Two bearings 89 are provided in communication holes 88 formed at both ends of the center link member 17 at the rotating pair of the end link member 15 and the center link member 17 on the base end side. The shaft portion 90 at the tip of the end link member 15 is rotatably supported. The bearing 89 is fastened and fixed by a nut 92 via a spacer 91.

前記軸受89は、例えば深溝玉軸受等の転がり軸受であり、その外輪(図示せず)が前記連通孔88の内周に嵌合し、その内輪(図示せず)が前記軸部90の外周に嵌合している。外輪は止め輪93によって抜け止めされている。軸部90の先端ねじ部90aに螺着したナット92の締付力が間座91を介して内輪に伝達されて、軸受89に所定の予圧を付与している。なお、図11では後述するかさ歯車57は省略している。   The bearing 89 is, for example, a rolling bearing such as a deep groove ball bearing. The outer ring (not shown) of the bearing 89 fits into the inner periphery of the communication hole 88, and the inner ring (not shown) of the bearing 89 is the outer periphery of the shaft portion 90. Is fitted. The outer ring is retained by a retaining ring 93. The tightening force of the nut 92 screwed to the tip screw portion 90 a of the shaft portion 90 is transmitted to the inner race via the spacer 91, and a predetermined preload is applied to the bearing 89. In FIG. 11, a bevel gear 57 described later is omitted.

以上、基端側のリンクハブ12と基端側の端部リンク部材15の回転対偶部、および基端側の端部リンク部材15と中央リンク部材17の回転対偶部について説明したが、先端側のリンクハブ13と先端側の端部リンク部材16の回転対偶部、および先端側の端部リンク部材16と中央リンク部材17の回転対偶部も同じ構成である(図示省略)。   As described above, the rotation pair of the base link hub 12 and the base end link member 15 and the rotation pair of the base end link member 15 and the center link member 17 have been described. The rotational pair of the link hub 13 and the distal end link member 16 and the rotational pair of the distal end link member 16 and the central link member 17 have the same configuration (not shown).

このように、各リンク機構14における4つの回転対偶部、つまり、基端側のリンクハブ12と基端側の端部リンク部材15の回転対偶部、先端側のリンクハブ13と先端側の端部リンク部材16の回転対偶部、基端側の端部リンク部材15と中央リンク部材17と回転対偶部、および先端側の端部リンク部材16と中央リンク部材17の回転対偶部に、軸受82,89を設けた構造とすることにより、各回転対偶での摩擦抵抗を抑えて回転抵抗の軽減を図ることができ、滑らかな動力伝達を確保できると共に耐久性を向上できる。   As described above, the four rotating pair portions of each link mechanism 14, that is, the rotating pair portion of the proximal link hub 12 and the proximal end link member 15, the distal link hub 13 and the distal end A bearing 82 is provided on the rotating pair of the partial link member 16, the rotating pair of the end link member 15 and the center link member 17 on the proximal side, and the rotating pair of the end link member 16 and the center link member 17 on the distal side. , 89, the frictional resistance at each rotating pair can be suppressed to reduce the rotational resistance, and smooth power transmission can be ensured and the durability can be improved.

図10において、ベース部材6の上面にスペーサ65を介して基端側のリンクハブ12が固定されている。ベース部材6の下面には前記姿勢制御用アクチュエータ10が垂下状態で取付けられている。姿勢制御用アクチュエータ10の数は、リンク機構14と同数の3個である。姿勢制御用アクチュエータ10はロータリアクチュエータからなり、その出力軸に取付けたかさ歯車56と基端側のリンクハブ12の軸部材83(図5)に取付けた扇形のかさ歯車57とが噛み合っている。
なお、この例では、リンク機構14と同数の姿勢制御用アクチュエータ10が設けられているが、3組のリンク機構14のうち少なくとも2組に姿勢制御用アクチュエータ10が設けられていれば、基端側のリンクハブ12に対する先端側のリンクハブ13の姿勢を確定することができる。
In FIG. 10, the base end side link hub 12 is fixed to the upper surface of the base member 6 via a spacer 65. The attitude control actuator 10 is attached to the lower surface of the base member 6 in a hanging state. The number of the posture control actuators 10 is the same as the number of the link mechanisms 14, three. The attitude control actuator 10 is a rotary actuator, and a bevel gear 56 attached to an output shaft thereof and a fan-shaped bevel gear 57 attached to a shaft member 83 (FIG. 5) of the link hub 12 on the base end side mesh with each other.
In this example, the same number of attitude control actuators 10 as the link mechanisms 14 are provided. However, if at least two of the three sets of link mechanisms 14 are provided with the attitude control actuators 10, The attitude of the link hub 13 on the distal end side with respect to the link hub 12 on the side can be determined.

このパラレルリンク機構9では、各姿勢制御用アクチュエータ10を回転駆動させることで、その回転が一対のかさ歯車56,57を介して軸部材83に伝達されて、基端側のリンクハブ12に対する基端側の端部リンク部材15の角度が変更する。それにより、基端側のリンクハブ12に対する先端側のリンクハブ13の位置および姿勢が決まる。ここでは、かさ歯車56,57を用いて基端側の端部リンク部材15の角度を変更しているが、その他の機構(例えば、平歯車やウォーム機構)でも良い。   In the parallel link mechanism 9, by rotating each of the attitude control actuators 10, the rotation is transmitted to the shaft member 83 via the pair of bevel gears 56 and 57, and the base member is connected to the base side link hub 12. The angle of the end link member 15 on the end side changes. Thereby, the position and posture of the distal link hub 13 with respect to the proximal link hub 12 are determined. Here, the angle of the end link member 15 on the proximal side is changed using the bevel gears 56 and 57, but another mechanism (for example, a spur gear or a worm mechanism) may be used.

この実施形態のようにパラレルリンク機構9および姿勢制御用アクチュエータ10を構成した場合も、コントローラ3の荷重推定手段5によって、前記第1の実施形態と同様に、装置先端に作用する様々な方向からの外力を、簡易で安価な構成で検出でき、装置全体の安全性の向上を図ることができる。   Also in the case where the parallel link mechanism 9 and the attitude control actuator 10 are configured as in this embodiment, the load estimating means 5 of the controller 3 can be used in various directions acting on the front end of the apparatus, as in the first embodiment. Can be detected with a simple and inexpensive configuration, and the safety of the entire apparatus can be improved.

以上、実施例に基づいて本発明を実施するための形態を説明したが、ここで開示した実施の形態は全ての点で例示であって制限的なものではない。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味および範囲内での全ての変更が含まれることが意図される。   Although the embodiments for carrying out the present invention have been described based on the embodiments, the embodiments disclosed herein are illustrative in all aspects and not restrictive. The scope of the present invention is defined by the terms of the claims, rather than the description above, and is intended to include any modifications within the scope and meaning equivalent to the terms of the claims.

1…リンク作動装置
3…コントローラ
4…姿勢制御手段
5…荷重推定手段
6…ベース部材
8…トルク検出手段
9…パラレルリンク機構
10…姿勢制御用アクチュエータ
12…基端側のリンクハブ
13…先端側のリンクハブ
14…リンク機構
15…基端側の端部リンク部材
16…先端側の端部リンク部材
17…中央リンク部材
O1…リンクハブと端部リンク部材の回転対偶の中心軸
O2…端部リンク部材と中央リンク部材の回転対偶の中心軸
PA,PB…球面リンク中心
QA,QB…リンクハブの中心軸
S…内部空間
DESCRIPTION OF SYMBOLS 1 ... Link actuating device 3 ... Controller 4 ... Attitude control means 5 ... Load estimation means 6 ... Base member 8 ... Torque detection means 9 ... Parallel link mechanism 10 ... Attitude control actuator 12 ... Base end side link hub 13 ... End side Link hub 14 ... Link mechanism 15 ... End end link member 16 ... End end link member 17 ... Center link member O1 ... Rotation of link hub and end link member Pairwise center axis O2 ... End The central axes PA, PB of the rotation pair of the link member and the central link member, the spherical link centers QA, QB, the central axis S of the link hub, the internal space.

Claims (2)

基端側のリンクハブに対し先端側のリンクハブを、3組以上のリンク機構を介して姿勢を変更可能に連結し、前記各リンク機構は、それぞれ前記基端側のリンクハブおよび先端側のリンクハブに一端が回転可能に連結された基端側および先端側の端部リンク部材と、これら基端側および先端側の端部リンク部材の他端に両端がそれぞれ回転可能に連結された中央リンク部材とでなり、前記各リンク機構は、このリンク機構を直線で表現した幾何学モデルが、前記中央リンク部材の中央部に対する基端側部分と先端側部分とが対称を成す形状であり、前記3組以上のリンク機構のうち2組以上のリンク機構に、前記基端側のリンクハブに対する前記先端側のリンクハブの姿勢を任意に変更させる姿勢制御用アクチュエータを設けた2自由度機構のリンク作動装置において、
前記各姿勢制御用アクチュエータを制御するコントローラが設けられ、このコントローラに、前記各姿勢制御用アクチュエータに指令を出力する姿勢制御手段、および前記先端側のリンクハブに作用する荷重を推定する荷重推定手段が設けられると共に、前記荷重推定手段は、前記各姿勢制御用アクチュエータに作用するトルク変化量より、前記先端側のリンクハブに作用する衝突を検知する衝突検知機能を有し、
前記荷重推定手段の衝突検知により前記各姿勢制御用アクチュエータの動作をオフにして自由とする衝突対応制御手段を備えたことを特徴とするリンク作動装置。
The distal-side link hub is connected to the proximal-side link hub via three or more sets of link mechanisms so that the posture can be changed, and each of the link mechanisms is connected to the proximal-side link hub and the distal-side link hub, respectively. A proximal end and a distal end link member having one end rotatably connected to the link hub, and a center having both ends rotatably connected to the other end of the proximal and distal end link members, respectively. A link member, wherein each of the link mechanisms has a geometric model in which the link mechanism is represented by a straight line, and has a shape in which a proximal end portion and a distal end portion with respect to the center of the central link member are symmetrical, A two-degree-of-freedom mechanism provided with an attitude control actuator for arbitrarily changing the attitude of the distal link hub with respect to the proximal link hub in at least two of the three or more link mechanisms. In the link actuating device,
A controller for controlling each of the attitude control actuators is provided. The controller has a controller for outputting a command to each of the attitude control actuators, and a load estimating means for estimating a load acting on the link hub on the distal end side. Is provided, the load estimating means has a collision detection function of detecting a collision acting on the link hub on the distal end side from a torque change amount acting on each of the attitude control actuators,
A link actuating device comprising: a collision handling control unit that turns off the operation of each of the attitude control actuators and makes it free by the collision detection of the load estimating unit.
請求項1に記載のリンク作動装置において、前記姿勢制御用アクチュエータのそれぞれがトルク検出手段を有し、これらのトルク検出手段の検出信号から、前記荷重推定手段による荷重の推定を行うリンク作動装置。

2. The link operating device according to claim 1, wherein each of said attitude control actuators has torque detecting means, and estimates a load by said load estimating means from a detection signal of said torque detecting means.

JP2019185071A 2019-10-08 2019-10-08 Link actuator Active JP6792687B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019185071A JP6792687B2 (en) 2019-10-08 2019-10-08 Link actuator

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019185071A JP6792687B2 (en) 2019-10-08 2019-10-08 Link actuator

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2014252744A Division JP6625322B2 (en) 2014-12-15 2014-12-15 Link actuator

Publications (2)

Publication Number Publication Date
JP2020006509A true JP2020006509A (en) 2020-01-16
JP6792687B2 JP6792687B2 (en) 2020-11-25

Family

ID=69150129

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019185071A Active JP6792687B2 (en) 2019-10-08 2019-10-08 Link actuator

Country Status (1)

Country Link
JP (1) JP6792687B2 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0991004A (en) * 1995-09-20 1997-04-04 Fanuc Ltd Method for estimating load weight
JPH09131690A (en) * 1995-11-09 1997-05-20 Mitsubishi Heavy Ind Ltd 6-shaft load detector
JPH10138187A (en) * 1996-11-01 1998-05-26 Nachi Fujikoshi Corp Automatic computing method of load weight and load center-of-gravity position of articulated robot
JP2001088072A (en) * 1999-09-17 2001-04-03 Toyoda Mach Works Ltd Four-freedom degree parallel robot
JP2009050921A (en) * 2007-08-23 2009-03-12 Fanuc Ltd Handling device
JP2013202725A (en) * 2012-03-28 2013-10-07 Ntn Corp Operating device for link actuation device

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0991004A (en) * 1995-09-20 1997-04-04 Fanuc Ltd Method for estimating load weight
JPH09131690A (en) * 1995-11-09 1997-05-20 Mitsubishi Heavy Ind Ltd 6-shaft load detector
JPH10138187A (en) * 1996-11-01 1998-05-26 Nachi Fujikoshi Corp Automatic computing method of load weight and load center-of-gravity position of articulated robot
JP2001088072A (en) * 1999-09-17 2001-04-03 Toyoda Mach Works Ltd Four-freedom degree parallel robot
JP2009050921A (en) * 2007-08-23 2009-03-12 Fanuc Ltd Handling device
JP2013202725A (en) * 2012-03-28 2013-10-07 Ntn Corp Operating device for link actuation device

Also Published As

Publication number Publication date
JP6792687B2 (en) 2020-11-25

Similar Documents

Publication Publication Date Title
JP6625322B2 (en) Link actuator
JP5951224B2 (en) Method for initial setting of origin position of link actuator and link actuator
WO2016129624A1 (en) Articulated robot using link actuation device
JP7022008B2 (en) Link actuator
JP5675258B2 (en) Link actuator
US10065310B2 (en) Device and method for controlling link actuation device
JP5973201B2 (en) Link actuator operating device
JP5785055B2 (en) Link actuator
JP6282764B2 (en) Parallel link mechanism, constant velocity universal joint, and link actuator
WO2013042577A1 (en) Link actuating device
WO2016129623A1 (en) Articulated robot using link actuation device
JP6883073B2 (en) Articulated robot using link operating device
JP2018167350A (en) Multi joint robot
JP6029969B2 (en) Link actuator
WO2018088445A1 (en) Working device and double-arm type working device
US20180207800A1 (en) Diagnostic device for link actuation device
JP2020006509A (en) Link operation device
WO2016035564A1 (en) Link actuating device
JP6133162B2 (en) Link actuator
JP2015224786A (en) Parallel link mechanism and link activating device
KR20180094456A (en) Haptic force feedback device
WO2024048561A1 (en) Control device for link actuation device
JP2023048813A (en) Parallel link mechanism and link operation device
JP2018094643A (en) Power transmission mechanism and robot
JPH03228587A (en) Rotation/direct action driving device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20191008

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: 20201020

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20201106

R150 Certificate of patent or registration of utility model

Ref document number: 6792687

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250