JPH04226878A - Motion transmission device - Google Patents

Motion transmission device

Info

Publication number
JPH04226878A
JPH04226878A JP11838291A JP11838291A JPH04226878A JP H04226878 A JPH04226878 A JP H04226878A JP 11838291 A JP11838291 A JP 11838291A JP 11838291 A JP11838291 A JP 11838291A JP H04226878 A JPH04226878 A JP H04226878A
Authority
JP
Japan
Prior art keywords
rotating
link member
link
rotatably connected
auxiliary
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
JP11838291A
Other languages
Japanese (ja)
Other versions
JP3165170B2 (en
Inventor
Hiroyuki Banba
番場 弘行
Nobuhito Matsuhira
松日楽 信人
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.)
Toshiba Corp
Original Assignee
Toshiba 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 Toshiba Corp filed Critical Toshiba Corp
Priority to JP11838291A priority Critical patent/JP3165170B2/en
Publication of JPH04226878A publication Critical patent/JPH04226878A/en
Application granted granted Critical
Publication of JP3165170B2 publication Critical patent/JP3165170B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

PURPOSE:To provide a small-sized and light motion transmission device which can ensure a wide range of operation. CONSTITUTION:A link mechanism 1 (motion transmission device) is composed by arranging a first parallel link 3 and a third parallel link 5 in parallel. Respective rotary link members 27, 29, 31, 33, 35, 37 are connected to connecting members 39, 41, 43 so that they can freely rotate. In such motion transmission device, when the connecting member 39 or 41 is driven in any direction by a distance (n), the connecting member 41 is driven by a distance (nXk) without changing its attitude. (k is a link ratio.)

Description

【発明の詳細な説明】[Detailed description of the invention]

[発明の目的] [Purpose of the invention]

【0001】0001

【産業上の利用分野】本発明は、マニピュレータの先端
に位置する手首部やグリップを位置決めするためなどに
用いることが可能な運動伝達装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a motion transmission device that can be used to position a wrist or grip located at the tip of a manipulator.

【0002】0002

【従来の技術】危険な環境下の作業や、危険物を空間的
に移動させる作業などを人間に代わって行うための機械
として、マスタ・スレーブマニピュレータが知られてい
る。
2. Description of the Related Art A master-slave manipulator is known as a machine for performing work in a dangerous environment or spatially moving dangerous materials in place of a human.

【0003】マスタ・スレーブマニピュレータは、操縦
者が操作するマスタマニピュレータと、このマスタマニ
ピュレータの操作によって検出された指令信号に基づき
、実際に物体を空間的に移動させるなどの作業を行うス
レーブマニピュレータとから構成されている。
[0003] The master/slave manipulator consists of a master manipulator operated by an operator, and a slave manipulator that actually performs work such as spatially moving an object based on a command signal detected by the operation of this master manipulator. It is configured.

【0004】さらに、それぞれのマニピュレータは、手
首部を3次元的に駆動して位置決めする位置駆動軸と、
手首に相当し前記手首部の姿勢を決定する姿勢駆動軸と
、この姿勢駆動軸の先端に設けられたハンドや操作グリ
ップなどとで構成されている。
Furthermore, each manipulator includes a position drive shaft for three-dimensionally driving and positioning the wrist;
It is composed of a posture drive shaft that corresponds to the wrist and determines the posture of the wrist portion, and a hand, an operation grip, etc. provided at the tip of this posture drive shaft.

【0005】ところで、マスタ・スレーブマニピュレー
タのマスタマニピュレータ、あるいはスレーブマニピュ
レータには、その軸構成として多関節型,直交座標型な
どいくつかの種類がある。こういった軸構成は、要求さ
れる運動伝達の形態に応じて種々選択されて使用されて
いる。
By the way, there are several types of master manipulators or slave manipulators in terms of their axis configurations, such as multi-joint type and orthogonal coordinate type. Various shaft configurations are selected and used depending on the required form of motion transmission.

【0006】位置駆動軸の動作形態を多関節型とすると
、3次元を形成する第1軸,第2軸,第3軸が互いに影
響するため、先端の位置を検出するために座標変換演算
が要求される。一般的に、こういった座標変換演算は制
御系の負担となるので、座標変換演算をできるだけ少な
くして負担を軽減する構成とすることが望ましい。
[0006] When the operation form of the position drive axis is multi-jointed, the first, second, and third axes forming a three-dimensional structure influence each other, so coordinate transformation calculations are required to detect the position of the tip. required. Generally, such coordinate transformation calculations place a burden on the control system, so it is desirable to have a configuration that reduces the burden by minimizing the number of coordinate transformation calculations.

【0007】そこで、位置駆動軸をすべて直交させた直
交座標型とすると、3次元を形成する第1軸,第2軸,
第3軸が互いに影響することがなくなり、各軸を独立に
駆動させることができる。したがって、座標変換演算が
不要となり、制御系の負担が軽減される。
[0007] Therefore, if the position drive axes are all orthogonal coordinates, the first axis, second axis,
The third axes no longer influence each other, and each axis can be driven independently. Therefore, coordinate transformation calculations are not required, and the burden on the control system is reduced.

【0008】また、直交座標型を採用した場合、位置制
御軸と姿勢制御軸とを機構的に分離することができるの
で、先端の位置が変化しても姿勢が変化することがない
。したがって、この点からも座標変換演算がさらに軽減
されている。位置駆動軸を直交座標型とした従来の運動
伝達装置について、図18を参照して説明する。図18
は、マスタ・スレーブマニピュレータのマスタマニピュ
レータに運動伝達装置を適用した状態を示す斜視図であ
る。
Further, when the orthogonal coordinate type is adopted, the position control axis and the attitude control axis can be mechanically separated, so even if the position of the tip changes, the attitude does not change. Therefore, from this point of view as well, the coordinate transformation calculations are further reduced. A conventional motion transmission device in which the position drive shaft is of the orthogonal coordinate type will be described with reference to FIG. 18. Figure 18
FIG. 2 is a perspective view showing a state in which a motion transmission device is applied to a master manipulator of the master/slave manipulator.

【0009】マスタマニピュレータ200 には、両側
部が同方向へ直角に折り曲げられて側壁が形成された支
持ブロック201 と、この支持ブロック201 上を
一対のガイド203およびネジ軸205 で第1の方向
(図18中のY軸方向)へ案内される第1の移動台20
7 とが備えられている。ネジ軸205 の一方の側部
は支持ブロック201 の側壁を貫通しており、その先
端部はモータ223 の駆動軸とベルト222 を介し
て連結されている。このモータ223 の駆動軸の後端
にはエンコーダ224 が連結されている。エンコーダ
224 はモータ223 の回転量を検出することによ
り、第1の移動台207のY軸方向への移動距離を検出
するようになっている。
The master manipulator 200 includes a support block 201 whose side walls are formed by bending both sides at right angles in the same direction, and a pair of guides 203 and a screw shaft 205 that move the top of the support block 201 in a first direction ( The first movable table 20 guided in the Y-axis direction (in FIG. 18)
7 is provided. One side of the screw shaft 205 passes through the side wall of the support block 201, and its tip is connected to the drive shaft of a motor 223 via a belt 222. An encoder 224 is connected to the rear end of the drive shaft of this motor 223. The encoder 224 is designed to detect the moving distance of the first moving table 207 in the Y-axis direction by detecting the amount of rotation of the motor 223 .

【0010】第1の移動台207 上には、第1の支持
ブロック209 が載置されている。この第1の支持ブ
ロック209 には一対のガイド211 およびネジ軸
213 が支持されており、ネジ軸213 の回転によ
り第2の移動第215 が第2の方向(図18のZ軸方
向)へ案内される。ネジ軸213 の一方の端部は第1
の支持ブロツク209 を貫通しており、その先端部は
モータ225 の駆動軸とベルト226を介して連結さ
れている。モータ225 の駆動軸の後端にはエンコー
ダ228 が連結されており、モータ225 の回転量
を検出することにより、第2の移動第215 のZ軸方
向への移動距離を検出するようになっている。
A first support block 209 is placed on the first moving table 207 . A pair of guides 211 and a screw shaft 213 are supported on this first support block 209, and the rotation of the screw shaft 213 guides a second moving member 215 in a second direction (Z-axis direction in FIG. 18). be done. One end of the screw shaft 213
It passes through the support block 209 , and its tip is connected to the drive shaft of a motor 225 via a belt 226 . An encoder 228 is connected to the rear end of the drive shaft of the motor 225, and by detecting the amount of rotation of the motor 225, the distance traveled in the Z-axis direction of the second movement 215 is detected. There is.

【0011】第2の移動台215 には、第2の支持ブ
ロツク217 が固着されている。この第2の支持ブロ
ツク217 をネジ軸213 と直交する第3の方向(
図18中のX軸方向)へ移動できるように移動ガイド2
19 とネジ軸221 が貫通している。なお、移動ガ
イド219 は中空円筒状に形成されている。第2の支
持ブロック217 の側方にはモータ227 が配置さ
れており、その駆動軸は第2の支持ブロック217 内
で支持されたネジ軸221 に螺合する図示しないナッ
トとベルト等を介して連結されている。モータ227 
の駆動軸の後端には、エンコーダ230 が連結されて
いる。このエンコーダ230 はモータ227 の回転
量を検出して、移動ガイド219 とネジ軸221 の
X軸方向への移動距離を検出するようになっている。
A second support block 217 is fixed to the second movable table 215. This second support block 217 is moved in a third direction (
The movement guide 2
19 and the screw shaft 221 pass through it. Note that the movement guide 219 is formed into a hollow cylindrical shape. A motor 227 is disposed on the side of the second support block 217, and its drive shaft is connected to a screw shaft 221 supported within the second support block 217 through a nut and belt (not shown). connected. motor 227
An encoder 230 is connected to the rear end of the drive shaft. This encoder 230 detects the amount of rotation of the motor 227 and detects the moving distance of the moving guide 219 and the screw shaft 221 in the X-axis direction.

【0012】移動ガイド219 の一方の端部には、操
作部229 が支持されている。この操作部229 は
、端部が互いに回転自在に連結された一対のコ字型部材
231,233 とコ字型部材233 に支持されたグ
リップ235 とで構成されている。また、グリップ2
35 は、図18に示したθx,θy,θz各方向へ回
転自在となっている。
An operating section 229 is supported at one end of the moving guide 219. The operating section 229 is composed of a pair of U-shaped members 231 and 233 whose ends are rotatably connected to each other, and a grip 235 supported by the U-shaped member 233. Also, grip 2
35 is rotatable in each of the θx, θy, and θz directions shown in FIG.

【0013】また移動ガイド219 の他方の端部には
モータ241 およびエンコーダ249 が配置されて
いる。モータ241 の駆動軸は、移動ガイド219 
内の中空部で回転自在に支持された図示しない連結軸と
接続している。これにより、モータ241 の駆動力で
モータ241の駆動軸が回転し、連結軸の他方の端部に
固着されたコ字型部材231をθx方向への回転量を検
出する。
A motor 241 and an encoder 249 are arranged at the other end of the moving guide 219. The drive shaft of the motor 241 is connected to the movement guide 219
It is connected to a connecting shaft (not shown) that is rotatably supported in a hollow space inside. As a result, the drive shaft of the motor 241 is rotated by the driving force of the motor 241, and the amount of rotation of the U-shaped member 231 fixed to the other end of the connecting shaft in the θx direction is detected.

【0014】グリップ235 には図示しない力検出器
が埋設されている。例えば操縦者がグリップ235 を
θx方向へ回転しようとしてθx方向へ力(トルク)を
加えると、この力が力検出器によって検出され、検出結
果に基づいてモータ241 を駆動し、グリップ235
 をθx方向へ回転駆動する。
A force detector (not shown) is embedded in the grip 235. For example, when the operator applies force (torque) in the θx direction in an attempt to rotate the grip 235 in the θx direction, this force is detected by the force detector, and based on the detection result, the motor 241 is driven and the grip 235 is rotated in the θx direction.
is rotated in the θx direction.

【0015】また、コ字型部材231 とコ字型部材2
33 との連結部にはモータ237 およびエンコーダ
243 が配置されている。このエンコーダ243 は
グリップ235 のθy方向への回転量を検出する。
Furthermore, the U-shaped member 231 and the U-shaped member 2
A motor 237 and an encoder 243 are arranged at the connection portion with 33. This encoder 243 detects the amount of rotation of the grip 235 in the θy direction.

【0016】さらに、コ字型部材233 の下面側には
モータ239 およびエンコーダ245 が配置されて
いる。このエンコーダ245 はグリップ235 のθ
z方向への回転量を検出する。モータ239 の駆動軸
はグリップ235 と連結している。
Further, a motor 239 and an encoder 245 are arranged on the lower surface side of the U-shaped member 233. This encoder 245 is the θ of the grip 235
Detects the amount of rotation in the z direction. The drive shaft of the motor 239 is connected to the grip 235.

【0017】また、マスタマニピュレータ200 をY
,Z,X軸方向へ並進させようとする場合にも、同様に
、グリップ235 に埋設された力検出器によってグリ
ップ235 の並進方向が検出され、この検出結果に基
づいてモータ223,225,227 が回転駆動され
る。
[0017] Furthermore, the master manipulator 200 is
, Z, and X-axis directions, the translational direction of the grip 235 is similarly detected by the force detector embedded in the grip 235, and the motors 223, 225, 227 are controlled based on this detection result. is driven to rotate.

【0018】以上のように構成された従来のマスタマニ
ピュレータ200 は、操縦者がグリップ235 をX
,Y,Z軸方向、θx,θy,θz方向へ操作すると、
それぞれの方向の操作力が力検出器によって検出される
。そして力検出器からの検出信号に基づいてモータ22
3,225,227,237,239,241 が回転
駆動され、エンコーダ224,228,230,243
,245,249 によって回転量が検出される。この
検出信号が指令信号としてスレーブマニピュレータへ送
られ、スレーブマニピュレータが駆動される。
In the conventional master manipulator 200 configured as described above, the operator holds the grip 235 in the
, Y, Z axis direction, θx, θy, θz direction,
The operating force in each direction is detected by a force detector. Then, based on the detection signal from the force detector, the motor 22
3,225,227,237,239,241 are rotationally driven, and encoders 224,228,230,243
, 245, 249, the amount of rotation is detected. This detection signal is sent as a command signal to the slave manipulator, and the slave manipulator is driven.

【0019】しかしながら、一般的に直交座標型のマニ
ピュレータは、必要な動作範囲の分だけ駆動部の直動機
構長さを確保しなければならない。そのため、直交する
3軸のそれぞれの軸方向長さが長くなってしまい、必然
的にマニピュレータが大型化,高重量化してしまうとい
う問題があった。
However, in the orthogonal coordinate type manipulator, it is generally necessary to ensure the length of the linear motion mechanism of the drive unit for the necessary operating range. As a result, the axial length of each of the three orthogonal axes becomes long, resulting in a problem that the manipulator inevitably becomes larger and heavier.

【0020】[0020]

【発明が解決しようとする課題】このように、マニピュ
レータなどに利用される従来の運動伝達装置においては
、座標変換に係る演算量を少なくするためには直交座標
型を採用することが有利となる。しかしながら必要な動
作範囲分だけ駆動部の直動機構長さを確保しなければな
らず、直交する3軸のそれぞれの軸方向長さが長くなっ
てしまい、必然的に運動伝達装置が大型化,高重量化し
てしまうという問題があった。
[Problem to be Solved by the Invention] As described above, in conventional motion transmission devices used in manipulators, etc., it is advantageous to adopt the orthogonal coordinate type in order to reduce the amount of calculations related to coordinate transformation. . However, it is necessary to ensure the length of the linear motion mechanism of the drive part for the necessary operating range, and the axial length of each of the three orthogonal axes becomes long, which inevitably increases the size of the motion transmission device. There was a problem that the weight was increased.

【0021】本発明はこういった従来の問題点を解決す
るためになされたものであり、小型,軽量ながら広い動
作範囲を確保することのできる運動伝達装置の提供を目
的とするものである。 [発明の構成]
The present invention has been made to solve these conventional problems, and aims to provide a motion transmission device that is small and lightweight, yet can ensure a wide range of motion. [Structure of the invention]

【0022】[0022]

【課題を解決するための手段】上記の目的を達成するた
めに本発明においては、第1リンク部材と、前記第1リ
ンク部材と第1回転部で回転自在に連結された第2リン
ク部材と、前記第1リンク部材の中間部と第2回転部で
回転自在に連結された第3リンク部材と、前記第3リン
ク部材と第3回転部で回転自在に連結されるとともに前
記第2リンク部材の中間部の第4回転部で回転自在に連
結された第4リンク部材と、前記第1リンク部材の前記
第1回転部と第2回転部とを結ぶ延長線上に形成された
第5回転部と、前記第2リンク部材の前記第1回転部と
前記第4回転部の延長線上に形成された第6回転部と、
前記第3回転部を支持し、かつ前記第3回転部の軸中心
方向に対して直角方向を中心に前記第3回転部と回転自
在に連結された第1回転リンク部材と、前記第5回転部
を支持し、かつ前記第5回転部の軸中心方向に対して直
角方向を中心に前記第5回転部と回転自在に連結された
第2回転リンク部材と、前記第6回転部を支持し、かつ
前記第6回転部の軸中心方向に対して直角方向を中心に
前記第6回転部と回転自在に連結された第3回転リンク
部材とを備えたリンク機構を有する運動伝達装置におい
て、前記リンク機構の複数組を平行に配置し、かつ第3
回転リンク部材どうしをそれぞれ回転自在に第1連結部
材で連結した構成の運動伝達装置とした。
[Means for Solving the Problems] In order to achieve the above object, the present invention includes a first link member, a second link member rotatably connected to the first link member by a first rotating part, , a third link member rotatably connected to an intermediate portion of the first link member and a second rotating portion, and a third link member rotatably connected to the third link member and a third rotating portion, and the second link member a fourth link member rotatably connected at a fourth rotating part in an intermediate portion of the fourth link member; and a fifth rotating part formed on an extension line connecting the first rotating part and the second rotating part of the first link member. and a sixth rotating part formed on an extension line of the first rotating part and the fourth rotating part of the second link member,
a first rotating link member that supports the third rotating section and is rotatably connected to the third rotating section about a direction perpendicular to the axial center direction of the third rotating section; a second rotating link member that supports the fifth rotating section and is rotatably connected to the fifth rotating section about a direction perpendicular to the axial center direction of the fifth rotating section, and a second rotating link member that supports the sixth rotating section; , and a motion transmission device having a link mechanism including a third rotary link member rotatably connected to the sixth rotary part about a direction perpendicular to the axial center direction of the sixth rotary part, Multiple sets of link mechanisms are arranged in parallel, and a third
The motion transmission device has a structure in which rotating link members are rotatably connected to each other by a first connecting member.

【0023】[0023]

【作用】このように構成された本発明によれば、各第1
回転リンク部材または各第2回転リンク部材を同量だけ
同方向に並進移動させると、複数組のリンク機構が同一
の運動を行う。そして第3回転リンク部材の変位が拡大
される。これにより、第1回転リンク部材や第2回転リ
ンク部材の移動量を少なく抑えながらも広い動作範囲を
確保することができる運動伝達装置が実現する。
[Operation] According to the present invention configured as described above, each first
When the rotating link member or each second rotating link member is translated by the same amount in the same direction, the plurality of link mechanisms perform the same movement. Then, the displacement of the third rotating link member is expanded. Thereby, a motion transmission device is realized that can secure a wide range of motion while suppressing the amount of movement of the first rotary link member and the second rotary link member.

【0024】[0024]

【実施例】以下、図面に基づいて本発明の運動伝達装置
について、詳細に説明する。図1は、運動伝達装置の第
1実施例を示す斜視図である。なお、図1においてX,
Y,Z軸は運動伝達装置の各直交駆動軸を表している。
DESCRIPTION OF THE PREFERRED EMBODIMENTS The motion transmission device of the present invention will be described in detail below with reference to the drawings. FIG. 1 is a perspective view showing a first embodiment of a motion transmission device. In addition, in FIG. 1, X,
The Y and Z axes represent the orthogonal drive axes of the motion transmission device.

【0025】リンク機構1 (運動伝達装置)は一対の
平行リンク3,5によって構成されている。第1平行リ
ンク3 は同図に示されるように、第1リンク部材7 
の一端は、第1回転部11を介して第2リンク部材9 
と回転自在に連結している。
The link mechanism 1 (motion transmitting device) is composed of a pair of parallel links 3 and 5. As shown in the figure, the first parallel link 3 is a first link member 7.
One end of the second link member 9 is connected to the second link member 9 via the first rotating part 11.
It is rotatably connected.

【0026】また第1リンク部材7 の長手方向中間部
には、第2回転部15を介して第3リンク部材13の一
端と回転自在に連結されている。第3リンク部材13の
他端は、第3回転部19を介して第4リンク部材17の
一端と回転自在に連結している。第4リンク部材17の
他端は、第2リンク部材9 の長手方向中間部の第4回
転部21で回転自在に連結されている。
The longitudinally intermediate portion of the first link member 7 is rotatably connected to one end of the third link member 13 via a second rotating portion 15. The other end of the third link member 13 is rotatably connected to one end of the fourth link member 17 via the third rotating portion 19 . The other end of the fourth link member 17 is rotatably connected to the second link member 9 at a fourth rotating portion 21 located at a longitudinally intermediate portion.

【0027】これら第3リンク部材13,第4リンク部
材17は、それぞれ第1リンク部材7 ,第2リンク部
材9 と平行に配置されており、パンタグラフ式平行リ
ンクを構成している。
The third link member 13 and the fourth link member 17 are arranged parallel to the first link member 7 and the second link member 9, respectively, and constitute a pantograph type parallel link.

【0028】第1リンク部材7 の第1回転部11と第
2回転部15とを結ぶ延長線上には、第5回転部23が
設けられている。さらに第2リンク部材9 の第1回転
部11と第4回転部21とを結ぶ延長線上には、第6回
転部25が設けられている。
A fifth rotating section 23 is provided on an extension line connecting the first rotating section 11 and the second rotating section 15 of the first link member 7 . Further, a sixth rotating section 25 is provided on an extension line connecting the first rotating section 11 and the fourth rotating section 21 of the second link member 9 .

【0029】これら第5回転部23,第6回転部25,
および第3回転部19には、軸中心がそれぞれこれらと
直角に交わる第2回転リンク部材27,第3回転リンク
部材31,第1回転リンク部材29が設けられている。
These fifth rotating section 23, sixth rotating section 25,
The third rotating portion 19 is provided with a second rotating link member 27, a third rotating link member 31, and a first rotating link member 29 whose axial centers intersect at right angles to these members.

【0030】図2は、第1平行リンク3 を示す斜視図
である。同図に示すように、第1回転部11の軸中心を
B、第2回転部15の軸中心をA、第4回転部21の軸
中心をC、第3回転部19の軸中心をD、第5回転部の
軸中心をE、第6回転部25の軸中心をF、第2回転リ
ンク部材27の軸中心をH、第1回転リンク部材29の
軸中心をG、第3回転リンク部材31の軸中心をIとす
ると、各回転部の軸間距離は次式の条件に設定されてい
る。   (なお、ここで例えば「AB」とは、第1回転部1
1と第2回転部15との軸間距離を意味している。)
FIG. 2 is a perspective view showing the first parallel link 3. As shown in the figure, the axial center of the first rotating section 11 is B, the axial center of the second rotating section 15 is A, the axial center of the fourth rotating section 21 is C, and the axial center of the third rotating section 19 is D. , the axial center of the fifth rotating part is E, the axial center of the sixth rotating part 25 is F, the axial center of the second rotating link member 27 is H, the axial center of the first rotating link member 29 is G, the third rotating link Assuming that the axial center of the member 31 is I, the distance between the axes of each rotating part is set to the following condition. (Note that here, for example, "AB" refers to the first rotating part 1
1 and the second rotating part 15. )


0031】一方、第2平行リンク5 は第1平行リンク
3 と同構成である。第1リンク部材7a,第2リンク
部材9aが第1回転部11a で回転自在に連結されて
いる。一方、第1リンク部材7aと第2リンク部材9a
と平行に、第3回転部19a で回転自在に連結された
第3リンク部材13a と第4リンク部材17a がそ
れぞれ配置され、第2回転部15a ,第4回転部21
a で回転自在に連結されることによって、パンタグラ
フ式平行リンクを構成している。
[
On the other hand, the second parallel link 5 has the same structure as the first parallel link 3. The first link member 7a and the second link member 9a are rotatably connected by a first rotating portion 11a. On the other hand, the first link member 7a and the second link member 9a
A third link member 13a and a fourth link member 17a, which are rotatably connected by a third rotating part 19a, are arranged parallel to the second rotating part 15a and a fourth rotating part 21, respectively.
A is rotatably connected to form a pantograph-type parallel link.

【0032】さらに、第1リンク部材7aの第1回転部
11a と第2回転部15a とを結ぶ延長線上には、
第5回転部23a が形成され、第2リンク部材9aの
第1回転部11a と第4回転部21a とを結ぶ直線
の延長線上には、第6回転部25a が形成されている
Furthermore, on the extension line connecting the first rotating part 11a and the second rotating part 15a of the first link member 7a,
A fifth rotating portion 23a is formed, and a sixth rotating portion 25a is formed on an extension of the straight line connecting the first rotating portion 11a and the fourth rotating portion 21a of the second link member 9a.

【0033】また、第3回転部19a ,第5回転部2
3a ,第6回転部25a には、第1回転リンク部材
35,第2回転リンク部材33,第3回転リンク部材3
7が連結されている。これらの回転リンク部材33,3
5,37は、第1平行リンクの回転リンク部材27,2
9,31より長くなっている。また各第2回転リンク部
材27,33 は、それぞれ連結部材39に回転自在に
接続され、また各第1回転リンク部材29,35 は、
それぞれ連結部材41に回転自在に接続されている。 さらに、各第3回転リンク部材31,37 はそれぞれ
第1連結部材43に回転自在に接続されている。
[0033] Also, the third rotating part 19a and the fifth rotating part 2
3a and the sixth rotating part 25a, the first rotating link member 35, the second rotating link member 33, and the third rotating link member 3
7 are connected. These rotating link members 33, 3
5, 37 are rotating link members 27, 2 of the first parallel link.
It is longer than 9.31. Further, each second rotating link member 27, 33 is rotatably connected to a connecting member 39, and each first rotating link member 29, 35 is
Each is rotatably connected to a connecting member 41. Furthermore, each of the third rotating link members 31 and 37 is rotatably connected to the first connecting member 43, respectively.

【0034】また、第1平行リンク3 の軸中心A〜I
に対応するように、第2平行リンク5の各軸中心をA’
〜I’とすると、第1平行リンク3 と同様に各回転部
の軸間距離は次の条件に設定されている。 また、第1平行リンク3 の各回転部と第2平行リンク
5 の各回転部との関係は、以下の条件に設定されてい
る。 つまり、第1平行リンク3 と第2平行リンク5 は、
各回転部の軸中心が等しくずれた位置で連結部材39,
41 ,および第1連結部材43に回転自在に接続され
ている。
[0034] Also, the axial center A to I of the first parallel link 3
The center of each axis of the second parallel link 5 is set at A' so as to correspond to
~I', the distance between the axes of each rotating part is set to the following conditions, similar to the first parallel link 3. Further, the relationship between each rotating portion of the first parallel link 3 and each rotating portion of the second parallel link 5 is set to the following conditions. In other words, the first parallel link 3 and the second parallel link 5 are
The connecting member 39,
41 , and is rotatably connected to the first connecting member 43 .

【0035】次に、第1平行リンク3 の連結部材39
をZ軸方向へ、連結部材41をX軸方向およびY軸方向
へ並進させた場合の動作および動作範囲S1 〜S3 
(ただし、S1とS2 は同じ大きさ)を図3(a),
(b),(c) に示した模式図を用いて説明する。な
お図3において図2と同一の構成要素には同一の符号を
付してある。
Next, the connecting member 39 of the first parallel link 3
Movement and movement range S1 to S3 when the connecting member 41 is translated in the Z-axis direction and in the X-axis and Y-axis directions
(However, S1 and S2 are the same size) as shown in Fig. 3(a).
This will be explained using the schematic diagrams shown in (b) and (c). In FIG. 3, the same components as in FIG. 2 are given the same reference numerals.

【0036】図3(a) にはX軸方向への動作および
XZ平面での動作範囲S1 が示されている。第3回転
部19が第5回転部23側に位置している状態(実線で
示される状態)から第3回転部19を図3(a)の紙面
右側(X軸方向)へ距離nだけ移動させると、第1平行
リンク3 が開いて、鎖線で示されるように、第6回転
部25が図3(a)の紙面右側へ距離(n×k)だけ移
動する。つまり、第6回転部25の移動距離は、第3回
転部19の移動距離のk倍に拡大される。
FIG. 3(a) shows the motion in the X-axis direction and the motion range S1 on the XZ plane. The third rotating unit 19 is moved by a distance n to the right (X-axis direction) in the paper of FIG. As a result, the first parallel link 3 opens and the sixth rotating portion 25 moves by a distance (n×k) to the right in the paper of FIG. 3(a), as shown by the chain line. In other words, the moving distance of the sixth rotating section 25 is expanded to k times the moving distance of the third rotating section 19.

【0037】図3(b) には、Z軸方向への動作およ
びXZ平面での動作範囲S2 が示されている。実線で
示す状態から第5回転部23を図3(b) の紙面上方
(Z方向)へ距離nだけ移動させると、鎖線で示される
ように、第6回転部25が距離(n×(k−1))だけ
図3(c) の紙面下方(Z方向)へ移動する。つまり
、第6回転部25の移動距離は、第5回転部23の移動
方向と反対方向に、第5回転部23の移動距離の(k−
1)倍に拡大される。
FIG. 3(b) shows the movement in the Z-axis direction and the movement range S2 in the XZ plane. When the fifth rotating section 23 is moved from the state shown by the solid line by a distance n toward the top of the page (Z direction) in FIG. 3(b), the sixth rotating section 25 moves by a distance (n −1)) downwards (in the Z direction) on the paper in FIG. 3(c). In other words, the moving distance of the sixth rotating section 25 is the moving distance of the fifth rotating section 23 in the opposite direction to the moving direction of the fifth rotating section 23 (k-
1) It will be enlarged twice.

【0038】また、図3(c) には、Y軸方向への動
作およびXY平面での動作範囲S3 が示されている。 実線で示す状態から第1回転リンク部材29を図3(c
) の紙面下方(Y軸方向)へ距離nだけ移動させると
、鎖線で示されるように、第3回転リンク部材31が距
離(n×k)だけ図3(c) の紙面下方(Y軸方向)
へ移動する。つまり、第3回転リンク部材31の移動距
離は、第1回転リンク部材29の移動距離のk倍に拡大
される。また、第2平行リンク5 の第3回転リンク部
材37先端の動作範囲も、図3(a),(b),(c)
 に二点鎖線で示される動作範囲S1 〜S3 となる
。次に、本実施例の作用について説明する。
Further, FIG. 3(c) shows the movement in the Y-axis direction and the movement range S3 on the XY plane. The first rotating link member 29 is moved from the state shown by the solid line in FIG.
), the third rotary link member 31 moves a distance (n x k) downward (in the Y-axis direction) in the paper of FIG. 3(c), as shown by the chain line. )
Move to. In other words, the moving distance of the third rotating link member 31 is expanded to k times the moving distance of the first rotating link member 29. Furthermore, the operating range of the tip of the third rotating link member 37 of the second parallel link 5 is also shown in FIGS. 3(a), (b), and (c).
The operating range S1 to S3 is indicated by the two-dot chain line. Next, the operation of this embodiment will be explained.

【0039】上記のように構成された第1平行リンク3
 および第2平行リンク5 は、連結部材41をX軸方
向へ距離nだけ移動させることによって第3回転部19
,19aを同量だけ同方向へ移動させると、第6回転部
25,25aが連結部材41の移動距離のk倍だけ同方
向に移動する。そのため、第6回転部25,25aを連
結した第1連結部材43はその姿勢を保ったままの状態
で同方向に距離(n×k)だけ移動する。
The first parallel link 3 configured as described above
And the second parallel link 5 is connected to the third rotating part 19 by moving the connecting member 41 by a distance n in the X-axis direction.
, 19a in the same direction by the same amount, the sixth rotating parts 25, 25a move in the same direction by k times the moving distance of the connecting member 41. Therefore, the first connecting member 43 connecting the sixth rotating parts 25 and 25a moves by a distance (n×k) in the same direction while maintaining its posture.

【0040】また、連結部材39をZ軸方向へ距離nだ
け移動させて第5回転部23,23aを同量だけ同方向
へ移動させると、第6回転部25,25aが連結部材3
9の移動距離の(k−1)倍だけ反対方向に移動する。 そのため、やはり第1連結部材43はその姿勢を保った
ままの状態で反対方向に距離(n×(k−1))だけ移
動する。
Furthermore, when the connecting member 39 is moved by a distance n in the Z-axis direction and the fifth rotating parts 23, 23a are moved by the same amount in the same direction, the sixth rotating parts 25, 25a are moved by the connecting member 3.
9 moves in the opposite direction by (k-1) times the moving distance. Therefore, the first connecting member 43 moves by a distance (n×(k-1)) in the opposite direction while maintaining its posture.

【0041】さらに、連結部材41をY軸方向へ距離n
だけ移動させると、第1回転リンク部材29,35 が
距離nだけ移動し、第3回転リンク部材31,37 が
連結部材41の移動距離のk倍だけ同方向に移動する。 そのため、やはり第1連結部材43はその姿勢を保った
ままの状態で同方向に距離(n×k)だけ移動する。
Furthermore, the connecting member 41 is moved by a distance n in the Y-axis direction.
When the first rotary link members 29, 35 are moved by a distance n, the third rotary link members 31, 37 are moved by k times the moving distance of the connecting member 41 in the same direction. Therefore, the first connecting member 43 moves by a distance (n×k) in the same direction while maintaining its posture.

【0042】つまり、連結部材39を固定した状態で連
結部材41をどの方向へ移動させても、姿勢を維持した
状態で第1連結部材43は連結部材41の移動量のk倍
の距離だけ同方向に移動する。
In other words, even if the connecting member 41 is moved in any direction with the connecting member 39 fixed, the first connecting member 43 will remain the same for a distance k times the amount of movement of the connecting member 41 while maintaining its posture. move in the direction.

【0043】同様に、連結部材41を固定した状態で連
結部材39をどの方向へ移動させても、姿勢を維持した
状態で第1連結部材43は連結部材39の移動量の(k
−1)倍の距離だけこれとは反対方向に移動する。した
がって、第1回転リンク部材7 や第2回転リンク部材
9 の移動量を少なく抑えながらも広い動作範囲を確保
することができる。続いて、本発明の第2実施例として
、上記の原理によるリンク機構1 が適用されたマスタ
マニピュレータ45について、図4および図5を用いて
説明する。図4は本発明の第2実施例に係るマスタマニ
ピュレータを示す斜視図、図5は図4のマスタマニピュ
レータを模式的に表現した斜視図である。
Similarly, even if the connecting member 39 is moved in any direction with the connecting member 41 fixed, the first connecting member 43 will move by the amount (k) of the movement of the connecting member 39 while maintaining its posture.
-1) Move twice the distance in the opposite direction. Therefore, a wide range of motion can be ensured while keeping the amount of movement of the first rotating link member 7 and the second rotating link member 9 small. Next, as a second embodiment of the present invention, a master manipulator 45 to which the link mechanism 1 based on the above principle is applied will be described with reference to FIGS. 4 and 5. FIG. 4 is a perspective view showing a master manipulator according to a second embodiment of the present invention, and FIG. 5 is a perspective view schematically representing the master manipulator of FIG. 4.

【0044】図4に示されるように、マスタマニピュレ
ータ45には、上記平行リンク機構1の平行リンク3 
と平行リンク5 に対応する部材として第1平行リンク
53と第2平行リンク55とが設けられている。
As shown in FIG. 4, the master manipulator 45 has parallel links 3 of the parallel link mechanism 1.
A first parallel link 53 and a second parallel link 55 are provided as members corresponding to the parallel link 5 .

【0045】第1平行リンク53には、上記第1リンク
部材7 に対応する第1リンク部材57と上記第2リン
ク部材9 に対応する第2リンク部材59とが、上記第
1回転部11に対応する第1回転部61で回転自在に連
結されている。
The first parallel link 53 includes a first link member 57 corresponding to the first link member 7 and a second link member 59 corresponding to the second link member 9, which are connected to the first rotating part 11. They are rotatably connected by corresponding first rotating parts 61.

【0046】また第1リンク部材57には、上記第3リ
ンク部材13に対応した第3リンク部材63が第2回転
部15に対応する第2回転部65を介して回転自在に連
結されている。この第3リンク部材63と上記第4リン
ク部材17に対応し第4リンク部材67とは、上記第3
回転部19に対応した第3回転部69を介して回転自在
に連結されている。第4リンク部材67は、上記第4回
転部21に対応する第4回転部71で第2リンク部材5
9に回転自在に連結されている。
A third link member 63 corresponding to the third link member 13 is rotatably connected to the first link member 57 via a second rotating part 65 corresponding to the second rotating part 15. . The fourth link member 67 corresponds to the third link member 63 and the fourth link member 17.
It is rotatably connected via a third rotating section 69 corresponding to the rotating section 19 . The fourth link member 67 is connected to the second link member 5 at a fourth rotating section 71 corresponding to the fourth rotating section 21.
It is rotatably connected to 9.

【0047】また、第1リンク部材57には、上記第5
回転部23に対応した第5回転部73が設けられ、一方
、第2リンク部材59には、上記第6回転部25に対応
した第6回転部75が設けられている。
The first link member 57 also has the fifth
A fifth rotating section 73 corresponding to the rotating section 23 is provided, while a sixth rotating section 75 corresponding to the sixth rotating section 25 is provided on the second link member 59.

【0048】さらに、上記第2回転リンク部材27に対
応した第2回転リンク部材77が、また上記第1回転リ
ンク部材29に対応した第1回転リンク部材79が、上
記第3回転リンク部材31に対応した第3回転リンク部
材81がそれぞれ設けられている。
Further, a second rotary link member 77 corresponding to the second rotary link member 27 and a first rotary link member 79 corresponding to the first rotary link member 29 are connected to the third rotary link member 31. A corresponding third rotating link member 81 is provided, respectively.

【0049】一方、第1平行リンク53と平行に配置さ
れた第2平行リンク55は、第1平行リンク53の各部
に対応して第1リンク部材57a,第2リンク部材59
a ,第3リンク部材63a ,第4リンク部材67a
 が、第1回転部61a ,第2回転部65a ,第3
回転部69a ,第4回転部71a にてそれぞれ回転
自在に連結されている。
On the other hand, the second parallel link 55 arranged parallel to the first parallel link 53 has a first link member 57a and a second link member 59 corresponding to each part of the first parallel link 53.
a, third link member 63a, fourth link member 67a
However, the first rotating section 61a, the second rotating section 65a, and the third rotating section
The rotating portion 69a and the fourth rotating portion 71a are rotatably connected to each other.

【0050】また、第1リンク部材57a の第1回転
部61a と第2回転部65a とを結ぶ延長線上には
、第5回転部73a が形成されており、第2リンク部
材59a の第1回転部61a と第4回転部71a 
とを結ぶ延長線上には、第6回転部75a が形成され
ている。
Further, a fifth rotating portion 73a is formed on the extension line connecting the first rotating portion 61a and the second rotating portion 65a of the first link member 57a, and the first rotation of the second link member 59a is part 61a and fourth rotating part 71a
A sixth rotating portion 75a is formed on the extended line connecting the two.

【0051】さらに、第5回転部73a には第2回転
リンク部材77に対応して、この第2回転リンク部材7
7より長い第2回転リンク部材83が連結されている。 また、第1回転リンク部材79は第1回転部材85と連
結部材91で連結され、第3回転リンク部材81と第3
回転リンク部材87は第1連結部材93で連結されてい
る。
Furthermore, the fifth rotating portion 73a has a second rotating link member 7 corresponding to the second rotating link member 77.
A second rotating link member 83 longer than 7 is connected. Further, the first rotating link member 79 is connected to the first rotating member 85 by a connecting member 91, and the third rotating link member 81 and the third rotating link member 85 are connected to each other by a connecting member 91.
The rotating link members 87 are connected by a first connecting member 93.

【0052】さらにこの実施例では、第1平行リンク5
3の第1回転部61と第2平行リンク55の第1回転部
61a は連結部材95を介して回転自在に連結されて
いる。このため、第1平行リンク53と第2平行リンク
55の取り付け剛性は、連結部材95が存在しない場合
に比べて大きくなっている。
Furthermore, in this embodiment, the first parallel link 5
The first rotating portion 61 of No. 3 and the first rotating portion 61a of the second parallel link 55 are rotatably connected via a connecting member 95. Therefore, the mounting rigidity of the first parallel link 53 and the second parallel link 55 is greater than that in the case where the connecting member 95 does not exist.

【0053】ベース97上の側部には、コ字型ブロック
99が、一方の側壁をベース97上に固定された状態で
配置されている。このコ字型ブロック99の両側壁には
、ネジ軸101が回転自在に軸支されている。
A U-shaped block 99 is disposed on the side of the base 97 with one side wall fixed on the base 97. A screw shaft 101 is rotatably supported on both side walls of this U-shaped block 99.

【0054】移動部103 は連結部材89と一体に形
成されており、その内部には図示しないナットが設けら
れている。ネジ軸101 は、このナットを介して移動
部103 と螺合している。
The moving part 103 is formed integrally with the connecting member 89, and a nut (not shown) is provided inside the moving part 103. The screw shaft 101 is screwed into the moving part 103 through this nut.

【0055】また、コ字型ブロック99の両側壁間には
リニヤガイド105 が配置されている。このリニヤガ
イド105 には、ネジ軸101と螺合する移動部10
3 がネジ軸101 の長手方向に移動自在となるよう
に嵌合している。
Furthermore, a linear guide 105 is arranged between both side walls of the U-shaped block 99. This linear guide 105 has a moving part 10 that is threadedly engaged with the screw shaft 101.
3 is fitted so as to be movable in the longitudinal direction of the screw shaft 101.

【0056】このネジ軸101 の一方の端部とモータ
107 の駆動軸とは、図示しない伝達手段で連結され
ている。 そして、モータ107 の回転駆動力が伝達されてネジ
軸101 が回転し、移動部103 がリニヤガイド1
05 に沿って移動する。
One end of the screw shaft 101 and the drive shaft of the motor 107 are connected by a transmission means (not shown). Then, the rotational driving force of the motor 107 is transmitted, the screw shaft 101 rotates, and the moving part 103 moves the linear guide 1
Move along 05.

【0057】さらに、モータ107 の図示しない駆動
軸の後端部には、エンコーダ109 が連結されている
。このエンコーダ109 はモータ107 の回転量を
検出することにより、移動部103 の移動距離を検出
する。
Furthermore, an encoder 109 is connected to the rear end of the drive shaft (not shown) of the motor 107 . This encoder 109 detects the moving distance of the moving unit 103 by detecting the amount of rotation of the motor 107.

【0058】また、ベース97上には、後述する操作部
121 の自重を補償するための定力バネ装置161 
が設けられている。定力バネ装置161 は、軸163
 を中心に巻装された定力バネ165 の一端を移動部
103 に固定した構成となっている。
A constant force spring device 161 is also mounted on the base 97 to compensate for the weight of the operating section 121, which will be described later.
is provided. The constant force spring device 161 has a shaft 163
It has a configuration in which one end of a constant force spring 165 wound around the center is fixed to the moving part 103.

【0059】また、ベース97上の中央部には、上部が
コ字型に形成された支持ブロック111が配置されてい
る。 この支持ブロック111 の両側壁間には、ネジ軸11
3 が配置されている。
Further, a support block 111 having a U-shaped upper part is arranged at the center of the base 97. A screw shaft 11 is provided between both side walls of this support block 111.
3 are placed.

【0060】移動部115 は、連結部材91と一体に
形成されており、その内部には図示しないナットが設け
られている。ネジ軸113 はこのナットを介して移動
部115 と螺合している。
The moving part 115 is formed integrally with the connecting member 91, and a nut (not shown) is provided inside the moving part 115. The screw shaft 113 is screwed into the moving part 115 through this nut.

【0061】このネジ軸113 の一方の端部はモータ
117 の駆動軸と図示しない伝達手段で連結されてお
り、モータの回転駆動力が伝達されてネジ軸113 が
回転し、移動部115 がリニヤガイド118 に沿っ
て移動する。また、モータ117 の駆動軸にはエンコ
ーダ119 が連結されている。このエンコーダ119
 はモータ117 の回転量を検出し、移動部115 
の移動距離を検出する。
One end of this screw shaft 113 is connected to the drive shaft of a motor 117 by a transmission means (not shown), and the rotational driving force of the motor is transmitted, the screw shaft 113 rotates, and the moving part 115 moves linearly. It moves along the guide 118. Further, an encoder 119 is connected to the drive shaft of the motor 117. This encoder 119
detects the amount of rotation of the motor 117 and moves the moving part 115
Detect the distance traveled.

【0062】支持ブロック111 は、移動部153 
へ固着されている。この移動部153 は、ベース97
上に載置された支持ブロック155 の両側壁間に配置
されたネジ軸157 に対し、図示しないナットを介し
て螺合している。また、移動部153 の下部は、支持
ブロック155 に固着されたリニヤガイド160 に
対し、ネジ軸157 の長手方向に移動自在に嵌合して
いる。
[0062] The support block 111 is connected to the moving part 153.
It is fixed to. This moving part 153 is based on the base 97
It is screwed into a screw shaft 157 disposed between both side walls of a support block 155 placed above through a nut (not shown). Further, the lower part of the moving part 153 is fitted into a linear guide 160 fixed to the support block 155 so as to be movable in the longitudinal direction of the screw shaft 157.

【0063】このネジ軸157 の一方の端部は、支持
ブロック155 の側壁の一方を貫通しており、その先
端部は図示しない伝達手段でモータ159 の駆動軸と
連結している。これにより、伝達されたモータ159 
の回転駆動力でネジ軸157 が回転駆動され、移動部
153 がネジ軸157 の軸方向へ移動するようにな
っている。
One end of this screw shaft 157 passes through one side wall of the support block 155, and its tip is connected to the drive shaft of a motor 159 by a transmission means (not shown). As a result, the transmitted motor 159
The screw shaft 157 is rotationally driven by the rotational driving force of the screw shaft 157, and the moving part 153 is moved in the axial direction of the screw shaft 157.

【0064】第1連結部材93には、操作部121 が
連結されている。この操作部121 は、2枚のL字状
プレート123,125 の一方の端部どうしをθy方
向へ回転自在に連結し、プレート123 の他方の端部
を第1連結部材93にθx方向へ回転自在に連結してな
るものである。また、プレート123 の他方の端部は
、図示しないベルトを介してモータ127 の駆動軸と
連結しており、モータ127 の回転駆動によってプレ
ート123 がθx方向へ回転するようになっている。 また、モータ127 にはエンコーダ131 が連結さ
れており、モータ127 の回転量を検出することによ
ってプレート123の回転角が検出される。
[0064] An operating section 121 is connected to the first connecting member 93. This operation part 121 connects one end of two L-shaped plates 123 and 125 rotatably in the θy direction, and connects the other end of the plate 123 to a first connecting member 93 for rotation in the θx direction. They can be freely connected. The other end of the plate 123 is connected to a drive shaft of a motor 127 through a belt (not shown), so that the rotation of the motor 127 causes the plate 123 to rotate in the θx direction. Further, an encoder 131 is connected to the motor 127, and the rotation angle of the plate 123 is detected by detecting the amount of rotation of the motor 127.

【0065】プレート123 とプレート125 の連
結部は、図示しないベルトによりモータ133の駆動軸
と連結されており、モータ133の回転駆動によってプ
レート125 がθy方向へ回転するようになっている
The connecting portion between the plates 123 and 125 is connected to the drive shaft of a motor 133 by a belt (not shown), so that the rotation of the motor 133 causes the plate 125 to rotate in the θy direction.

【0066】プレート125 の中間部には、円筒状の
グリップ135 が固着されている。このグリップ13
5 はプレート125 に対して回転自在に取り付けら
れている。このグリップ135 の下部はプレート12
5 を貫通しており、図示しないベルトを介してモータ
137 の駆動軸と連結されている。また、グリップ1
35 は図4に示されるように、θx,θy,θzの各
方向へ回転自在となっている。
A cylindrical grip 135 is fixed to the intermediate portion of the plate 125. This grip 13
5 is rotatably attached to the plate 125. The lower part of this grip 135 is the plate 12
5 and is connected to the drive shaft of the motor 137 via a belt (not shown). Also, grip 1
35 is rotatable in each direction of θx, θy, and θz, as shown in FIG.

【0067】また、グリップ135 の内部には、図示
しない6軸力センサが配置されている。6軸力センサは
X,Y,Z軸方向の力およびθx,θy,θz方向のト
ルクを検出する。力センサによって検出された結果は図
示しない制御装置へ伝達され、制御装置はこの結果に基
づいて各モータを駆動させる。次に、マスタマニピュレ
ータ45の作用について説明する。
Furthermore, a six-axis force sensor (not shown) is arranged inside the grip 135. The six-axis force sensor detects forces in the X, Y, and Z axis directions and torques in the θx, θy, and θz directions. The results detected by the force sensor are transmitted to a control device (not shown), and the control device drives each motor based on the results. Next, the operation of the master manipulator 45 will be explained.

【0068】まず、グリップ135 にX軸方向の力を
作用させると、これを力センサが検出する。この検出結
果は制御装置へ伝達され、制御装置はモータ159 を
作動させる。そして、グリップ135 をX軸方向へ距
離nだけ移動させると、連結部材91が距離(n/k)
だけ同方向へ移動する。すなわち、連結部材91を距離
nだけ移動させると、グリップ135 は距離(n×k
)に拡大されて移動する。この移動距離がエンコーダ1
61 によって検出される。この検出された移動距離を
示す信号はスレーブマニピュレータへの指令信号となる
First, when a force is applied to the grip 135 in the X-axis direction, the force sensor detects this force. This detection result is transmitted to the control device, and the control device operates the motor 159. Then, when the grip 135 is moved by a distance n in the X-axis direction, the connecting member 91 is moved a distance (n/k)
move in the same direction. That is, when the connecting member 91 is moved by a distance n, the grip 135 is moved by a distance (n×k
) and move it. This moving distance is encoder 1
Detected by 61. This signal indicating the detected moving distance becomes a command signal to the slave manipulator.

【0069】また、グリップ135 にY軸方向の力を
作用させると、これが力センサによって検出され、制御
装置によってモータ117 が作動される。そして、グ
リップ135 をY軸方向へ距離nだけ移動させると、
連結部材91が距離(n/k)だけ同方向へ移動する。
Furthermore, when a force in the Y-axis direction is applied to the grip 135, this is detected by the force sensor, and the motor 117 is operated by the control device. Then, when the grip 135 is moved by a distance n in the Y-axis direction,
The connecting member 91 moves in the same direction by a distance (n/k).

【0070】このモータ117 の作動によって移動ブ
ロック115 がネジ軸113 の長手方向に移動する
。また、このモータ117 の回転量はエンコーダ11
9 により検出されて制御装置へ伝達され、スレーブマ
ニピュレータへの指令信号となる。グリップ135 に
Z軸方向の力を作用させると、これが力センサにより検
出されて、モータ107 が作動される。この作動で距
離nだけ移動すると、第1連結部材93が距離(n×(
1−k))だけ移動する。このモータ107 の回転量
はエンコーダ109 により検出され、制御装置へ伝達
され、スレーブマニピュレータへの指令信号となる。
The movement of the motor 117 causes the moving block 115 to move in the longitudinal direction of the screw shaft 113. Also, the rotation amount of this motor 117 is determined by the encoder 11
9 is detected and transmitted to the control device, and becomes a command signal to the slave manipulator. When a force in the Z-axis direction is applied to the grip 135, this is detected by the force sensor and the motor 107 is activated. When the first connecting member 93 moves by a distance n by this operation, the first connecting member 93 moves a distance (n×(
1-k)). The amount of rotation of the motor 107 is detected by the encoder 109, transmitted to the control device, and becomes a command signal to the slave manipulator.

【0071】したがって、連結部材91,89 を移動
すると、この移動が拡大されてグリップ135 を移動
することができる。そのため、グリップ135 の動作
範囲を広く確保することができ、かつ小型,軽量とする
ことができる。
Therefore, when the connecting members 91, 89 are moved, this movement is expanded and the grip 135 can be moved. Therefore, a wide range of motion of the grip 135 can be ensured, and the grip 135 can be made small and lightweight.

【0072】なお、本実施例では1組の平行リンク(平
行リンク3,5 )を用いた場合について説明したが、
これに限らず、複数組の平行リンクでリンク機構を構成
してもよい。(なお、平行リンクを複数組設けた例は後
の実施例で説明する。)
[0072] In this embodiment, a case was explained in which a pair of parallel links (parallel links 3 and 5) was used.
The link mechanism is not limited to this, and the link mechanism may be composed of multiple sets of parallel links. (An example in which multiple sets of parallel links are provided will be explained in a later example.)

【0073】また本実施例では、第1平行リンク3 と
第2平行リンク5の第1回転部61,61aを連結部材
95で連結したが、連結部材95を設けない構造として
もよい。また他の回転部どうしを連結部材で連結しても
よい。
Further, in this embodiment, the first rotating portions 61, 61a of the first parallel link 3 and the second parallel link 5 are connected by the connecting member 95, but a structure in which the connecting member 95 is not provided may be used. Further, other rotating parts may be connected to each other by a connecting member.

【0074】なお、本実施例ではバイラテラルサーボ系
のマスタ・スレーブマニピュレータへの適用例を説明し
たので、スレーブマニピュレータからマスタマニピュレ
ータへの力フィードバックのために駆動手段96を設け
ている。しかし、連結部材89,91 をレールなどの
案内手段とすることにより駆動手段96を省略し、ユニ
ラテラルサーボ系のマスタ・スレーブマニピュレータへ
の適用とすることもできる。
In this embodiment, an example of application of the bilateral servo system to the master/slave manipulator has been described, so a driving means 96 is provided for force feedback from the slave manipulator to the master manipulator. However, by using the connecting members 89, 91 as guide means such as rails, the driving means 96 can be omitted and the present invention can be applied to a unilateral servo system master/slave manipulator.

【0075】また本実施例では、連結部材89,91 
をZ,Y軸方向への駆動のために用いたが、例えば、連
結部材89をY,Z軸方向,連結部材91をX軸方向と
しても、あるいは連結部材91をX,Y,Z軸方向に駆
動し連結部材89を固定してもよく、また、その逆に構
成してもよい。 あるいは、全部並進としなくてもよい。
Furthermore, in this embodiment, the connecting members 89, 91
was used for driving in the Z and Y axis directions, but for example, the connecting member 89 could be driven in the Y and Z axis directions, and the connecting member 91 could be driven in the X axis direction, or the connecting member 91 could be driven in the X, Y, and Z axis directions. The connecting member 89 may be fixed by driving the connecting member 89, or vice versa. Alternatively, it is not necessary to make all the translations.

【0076】また、前記定力バネ装置161 により操
作部121 の自重G[Kgf ]を補償する場合、定
力バネ165 に作用する力を(G×(k−1))[K
gf ]とすることができる。そのため、操作力を低減
して操縦を容易にすることが可能である。また、本実施
例をスレーブマニピュレータに適用することももちろん
可能である。
Furthermore, when the constant force spring device 161 compensates for the dead weight G [Kgf] of the operating section 121, the force acting on the constant force spring 165 is expressed as (G×(k-1))[K
gf ]. Therefore, it is possible to reduce the operating force and make the operation easier. Furthermore, it is of course possible to apply this embodiment to a slave manipulator.

【0077】次に、本発明の第3実施例について、図6
および図7を用いて説明する。本実施例のリンク機構3
01 は、第1実施例として説明したリンク機構1 に
補助リンク機構303 を設けたものである。これによ
り、平行リンク5 と補助リンク機構303とで新たな
平行リンク部が形成される。なお、図7は図6の矢視a
方向から見た補助リンク機構303 の側面図である。
Next, regarding the third embodiment of the present invention, FIG.
This will be explained using FIG. Link mechanism 3 of this embodiment
01 is one in which an auxiliary link mechanism 303 is provided in the link mechanism 1 described as the first embodiment. As a result, a new parallel link portion is formed by the parallel link 5 and the auxiliary link mechanism 303. Note that FIG. 7 shows the arrow a in FIG. 6.
FIG. 3 is a side view of the auxiliary link mechanism 303 as seen from the direction.

【0078】なお、補助リンク機構303 を図示する
ため、図6のリンク機構301 は図1のリンク機構1
 と反対方向から見た斜視図としてある。また図6にお
いて、図1および図4に示されるリンク機構と同一構成
要素については図面に同符号を付して説明を省略する。
Note that in order to illustrate the auxiliary link mechanism 303, the link mechanism 301 in FIG. 6 is replaced by the link mechanism 1 in FIG.
It is a perspective view seen from the opposite direction. Further, in FIG. 6, the same components as those of the link mechanism shown in FIGS. 1 and 4 are denoted by the same reference numerals in the drawing, and the description thereof will be omitted.

【0079】補助リンク機構303 は第2回転リンク
部材33に対して、一端が第7回転部307で回転自在
に連結された第5補助リンク部材305 と、第8回転
部309 を介して第5補助リンク部材305 の他端
と回転自在に一端が連結されるとともに、第9回転部3
11 を介して第3回転リンク部材37と回転自在に他
端が連結された第6補助リンク部材313 と、第1回
転部11a と第8回転部309 とを回転自在に連結
する第2連結部材315 とで構成されている。
The auxiliary link mechanism 303 connects to the second rotating link member 33 through a fifth auxiliary link member 305 whose one end is rotatably connected to the seventh rotating section 307 and an eighth rotating section 309 . One end is rotatably connected to the other end of the auxiliary link member 305, and the ninth rotating part 3
A sixth auxiliary link member 313 whose other end is rotatably connected to the third rotating link member 37 via 11; and a second connecting member which rotatably connects the first rotating section 11a and the eighth rotating section 309. It consists of 315.

【0080】また、第7回転部307 の軸中心は第5
回転部23の軸中心Eと同軸になっており、また、第9
回転部311 の軸中心は第6回転部25の軸中心Fと
同軸となっている。しかし、これら各軸は同軸に構成さ
れていなくてもよい。また、平行リンク3 の軸中心A
〜Eに対して、平行リンク5 の軸中心A’〜E’は同
軸に構成されていても、あるいはそうでなくてもよい。
[0080] Furthermore, the axial center of the seventh rotating part 307 is the fifth
It is coaxial with the axial center E of the rotating part 23, and the ninth
The axial center of the rotating part 311 is coaxial with the axial center F of the sixth rotating part 25. However, these axes do not have to be coaxial. Also, the axis center A of parallel link 3
~E, the axial centers A' to E' of the parallel links 5 may or may not be configured coaxially.

【0081】したがって、本実施例によれば、連結部材
41をX軸方向へ移動させて第3回転部19,19aを
同量だけ同方向へ移動させると、第6回転部25,25
aは連結部材41の移動距離のk倍だけ同方向に移動す
る。そのため、第1連結部43はその姿勢を保ったまま
の状態で連結部材41の移動距離のk倍の距離だけX軸
方向へ移動する。
Therefore, according to this embodiment, when the connecting member 41 is moved in the X-axis direction and the third rotating parts 19, 19a are moved in the same direction by the same amount, the sixth rotating parts 25, 25
a moves in the same direction by k times the moving distance of the connecting member 41. Therefore, the first connecting portion 43 moves in the X-axis direction by a distance k times the moving distance of the connecting member 41 while maintaining its posture.

【0082】また、連結部材39をZ軸方向へ距離nだ
け移動させて第5回転部23,23aと第7回転部30
7 を距離nだけZ軸方向へ移動させると、第6回転部
25,25aがこれとは反対方向に距離(n×(k−1
))だけ移動する。 そのため、連結部材43はその姿勢を保ったまま、反対
方向へ距離(n×(k−1))だけ移動する。
[0082] Furthermore, by moving the connecting member 39 by a distance n in the Z-axis direction, the fifth rotating parts 23, 23a and the seventh rotating part 30 are connected.
7 in the Z-axis direction by a distance n, the sixth rotating parts 25, 25a move in the opposite direction by a distance (n×(k-1
)). Therefore, the connecting member 43 moves by a distance (n×(k-1)) in the opposite direction while maintaining its posture.

【0083】さらに、連結部材41をY軸方向へ距離n
だけ移動させると、第1回転リンク部材29,35 が
同方向に距離nだけ移動し、第3リンク部材31,37
 が同方向へ距離(n×k)だけ移動する。
Furthermore, the connecting member 41 is moved by a distance n in the Y-axis direction.
When the first rotary link members 29, 35 are moved by a distance n in the same direction, the third link members 31, 37 are moved by a distance n.
moves a distance (n×k) in the same direction.

【0084】つまり、連結部材39を固定した状態で連
結部材41をどの方向へ移動させても、姿勢を維持した
状態で第1連結部材43は連結部材41の移動量のk倍
の距離だけこれと同方向に移動する。このとき、補助リ
ンク機構303 の第9回転部311 も同方向へ移動
する。
In other words, even if the connecting member 41 is moved in any direction with the connecting member 39 fixed, the first connecting member 43 will move a distance k times the amount of movement of the connecting member 41 while maintaining its posture. move in the same direction. At this time, the ninth rotating portion 311 of the auxiliary link mechanism 303 also moves in the same direction.

【0085】同様に、連結部材41を固定した状態で、
連結部材39をどの方向へ移動させても、姿勢を維持し
た状態で第1連結部材43は連結部材39の移動量の(
k−1)倍の距離だけこれと反対方向に移動する。また
、本実施例のリンク機構301 においては、補助リン
ク機構303 を設けることにより、装置の組み立て精
度や剛性を向上させることができる。
Similarly, with the connecting member 41 fixed,
No matter which direction the connecting member 39 is moved, the first connecting member 43 maintains its posture and the first connecting member 43 is moved by the amount of movement of the connecting member 39 (
k-1) times the distance in the opposite direction. Further, in the link mechanism 301 of this embodiment, by providing an auxiliary link mechanism 303, it is possible to improve the assembly accuracy and rigidity of the device.

【0086】次に、本発明の第4実施例について図8お
よび図9を用いて説明する。第4実施例のリンク機構3
17 は、図1に示されるリンク機構1 に、第3実施
例の補助リンク機構301 とは異なる補助リンク機構
319 を設けたものである。これにより、平行リンク
5 の一部と補助リンク機構319 とで新たな平行リ
ンク部が形成される。 なお、図9は図8の矢視b方向から見た補助リンク機構
319 の側面図である。
Next, a fourth embodiment of the present invention will be described using FIGS. 8 and 9. Link mechanism 3 of fourth embodiment
17 is the link mechanism 1 shown in FIG. 1 provided with an auxiliary link mechanism 319 different from the auxiliary link mechanism 301 of the third embodiment. As a result, a new parallel link portion is formed by a portion of the parallel link 5 1 and the auxiliary link mechanism 319 . Note that FIG. 9 is a side view of the auxiliary link mechanism 319 seen from the direction of arrow b in FIG.

【0087】第4実施例の補助リンク機構319 は、
第10回転部321 を介して第1回転リンク部材35
と回転自在に連結された第7補助リンク部材323 と
、第11回転部325 を介して第7補助リンク部材3
23 と回転自在に連結されるとともに、第12回転部
327を介して第3回転リンク部材37と回転自在に連
結された第8補助リンク部材329と、第4回転部21
a と第11回転部325とを回転自在に連結する第3
連結部331 とで構成されている。また、平行リンク
3 の軸中心A〜Eに対して、平行リンク5 の軸中心
A’〜E’は同軸に構成されていても、あるいはそうで
なくてもよい。
The auxiliary link mechanism 319 of the fourth embodiment is as follows:
The first rotating link member 35 via the tenth rotating part 321
The seventh auxiliary link member 323 is rotatably connected to the seventh auxiliary link member 3 via the eleventh rotating part 325.
23 and an eighth auxiliary link member 329 rotatably connected to the third rotating link member 37 via the twelfth rotating section 327;
a and the 11th rotating part 325 in a rotatable manner.
It is composed of a connecting portion 331. Further, the axial centers A' to E' of the parallel links 5 may or may not be coaxial with the axial centers A to E of the parallel links 3.

【0088】したがって、連結部材39を固定した状態
で連結部材41をどの方向へ移動させても、姿勢を維持
した状態で第1連結部材43は連結部材41の移動量の
k倍の距離だけこれと同方向に移動する。このとき、補
助リンク機構317 の第12回転部327 も同方向
へ移動する。
Therefore, even if the connecting member 41 is moved in any direction with the connecting member 39 fixed, the first connecting member 43 will move a distance k times the amount of movement of the connecting member 41 while maintaining its posture. move in the same direction. At this time, the twelfth rotating portion 327 of the auxiliary link mechanism 317 also moves in the same direction.

【0089】同様に、連結部材41を固定した状態で連
結部材39をどの方向へ移動させても、姿勢を維持した
状態で第1連結部材43は連結部材39の移動量の(k
−1)倍の距離だけこれとは反対方向に移動する。また
、本実施例のリンク機構317 においては、補助リン
ク機構319 を設けることによりその剛性を向上させ
ることができる。
Similarly, even if the connecting member 39 is moved in any direction with the connecting member 41 fixed, the first connecting member 43 will move by the amount (k) of the movement of the connecting member 39 while maintaining its posture.
-1) Move twice the distance in the opposite direction. Further, in the link mechanism 317 of this embodiment, the rigidity can be improved by providing an auxiliary link mechanism 319.

【0090】次に、図10を用いて本発明の第5実施例
について説明する。本実施例のリンク機構333 は、
図1に示されるリンク機構1 に対して平行リンク3 
を2組設け、これらの間に第6回転部25,25aどう
しがずれた状態で平行リンク5 を配置した例である。
Next, a fifth embodiment of the present invention will be described using FIG. 10. The link mechanism 333 of this embodiment is
Parallel link 3 to link mechanism 1 shown in Figure 1
In this example, two sets are provided, and a parallel link 5 is arranged between them with the sixth rotating parts 25, 25a being shifted from each other.

【0091】本実施例のリンク機構33は、一対の平行
リンク3 の間に第2平行リンク5 が配置されている
。一対の平行リンク3 はそれぞれの第6回転部25が
同軸上となるように配置され、一方、平行リンク5 は
一対の平行リンク3 の第6回転部25の軸中心とずれ
た状態で配置されている。
In the link mechanism 33 of this embodiment, a second parallel link 5 is disposed between a pair of parallel links 3. The pair of parallel links 3 are arranged so that their respective sixth rotating parts 25 are coaxial, while the parallel links 5 are arranged offset from the axial center of the sixth rotating parts 25 of the pair of parallel links 3. ing.

【0092】一対の平行リンク3 の第3回転リンク部
材31どうしをそれぞれ連結する第1連結部材43には
、平行リンク5 の第3回転リンク部材37が連結され
ている。これと同様に、第1回転リンク部材29をそれ
ぞれ連結する連結部材41には、平行リンク5 の第1
回転リンク部材35が回転自在に連結されている。
The third rotating link member 37 of the parallel link 5 is connected to the first connecting member 43 that connects the third rotating link members 31 of the pair of parallel links 3 to each other. Similarly, the connecting members 41 that connect the first rotating link members 29 each include the first parallel link 5.
A rotary link member 35 is rotatably connected.

【0093】さらに、一対の平行リンク3 の第2回転
リンク部材27をそれぞれ連結する連結部材39には、
平行リンク5 の第2回転リンク部材33が回転自在に
連結されている。
Furthermore, the connecting members 39 that respectively connect the second rotating link members 27 of the pair of parallel links 3 include:
A second rotating link member 33 of the parallel link 5 is rotatably connected.

【0094】したがって、連結部材39を固定した状態
で連結部材41をどの方向へ移動させても、第1連結部
材43は姿勢を維持した状態で連結部材41の移動量の
k倍の距離だけこれと同方向に移動する。
Therefore, even if the connecting member 41 is moved in any direction with the connecting member 39 fixed, the first connecting member 43 will move a distance k times the amount of movement of the connecting member 41 while maintaining its posture. move in the same direction.

【0095】同様に、連結部材41を固定した状態で連
結部材39をどの方向へ移動させても、第1連結部材4
3は姿勢を維持した状態で連結部材39の移動量の(k
−1)倍の距離だけこれとは反対方向に移動する。
Similarly, no matter which direction the connecting member 39 is moved with the connecting member 41 fixed, the first connecting member 4
3 is the amount of movement (k) of the connecting member 39 while maintaining its posture.
-1) Move twice the distance in the opposite direction.

【0096】また、本実施例のリンク機構333 にお
いては、一対の平行リンク3 と、これらの間に配置さ
れ平行リンク5 を設けることにより、その剛性を向上
させることができる。
Furthermore, in the link mechanism 333 of this embodiment, its rigidity can be improved by providing a pair of parallel links 3 and a parallel link 5 disposed between them.

【0097】次に、図11および図12を用いて本発明
の第6実施例について説明する。本実施例のリンク機構
337 は、図6に示される第3実施例のリンク機構3
01 と異なるリンク機構339 が設けられたもので
ある。なお、図12は図11の矢視c方向から見た補助
リンク機構339 の側面図である。
Next, a sixth embodiment of the present invention will be described using FIGS. 11 and 12. The link mechanism 337 of this embodiment is the link mechanism 3 of the third embodiment shown in FIG.
A link mechanism 339 different from 01 is provided. Note that FIG. 12 is a side view of the auxiliary link mechanism 339 seen from the direction of arrow c in FIG.

【0098】補助リンク機構339 は、第13回転部
341 を介して第2回転リンク部材33と一端が回転
自在に連結された第9補助リンク部材343 と、第1
9回転部361 を介して第9補助リンク部材343 
の他端に回転自在に一端が連結され、他端が第14回転
部349 を介して第3回転リンク部材37と回転自在
に連結された第10補助リンク部材345 と、第15
回転部351 を介して第10補助リンク部材345 
の中間部に一端が回転自在に連結されるとともに、他端
が第16回転部353 を介して第1回転リンク部材3
5に回転自在に連結された第11補助リンク部材347
 と、第16回転部353 を介して第11補助リンク
部材347 の他端に第12補助リンク部材355 の
一端が回転自在に連結され、他端が第18回転部359
 を介して第9補助リンク部材343 の中間部に連結
された第12補助リンク部材355 とで構成されてい
る。
The auxiliary link mechanism 339 includes a ninth auxiliary link member 343 whose one end is rotatably connected to the second rotating link member 33 via a thirteenth rotating portion 341 , and a first
The ninth auxiliary link member 343 via the ninth rotating part 361
a tenth auxiliary link member 345 whose one end is rotatably connected to the other end, and whose other end is rotatably connected to the third rotating link member 37 via a fourteenth rotating part 349;
The tenth auxiliary link member 345 via the rotating part 351
One end is rotatably connected to the intermediate portion of
5, the eleventh auxiliary link member 347 is rotatably connected to
One end of the twelfth auxiliary link member 355 is rotatably connected to the other end of the eleventh auxiliary link member 347 via the sixteenth rotating part 353 , and the other end is connected to the 18th rotating part 359 .
A twelfth auxiliary link member 355 is connected to an intermediate portion of the ninth auxiliary link member 343 through a twelfth auxiliary link member 355.

【0099】また、第14回転部349 の軸中心は第
2リンク部材9 の第6回転部25の軸中心と同軸とな
っている。 さらに、第13回転部341 は第5回転部23の軸中
心と同軸となっている。しかし、これらの各軸は同軸に
構成されていなくてもよい。
Further, the axial center of the fourteenth rotating section 349 is coaxial with the axial center of the sixth rotating section 25 of the second link member 9. Further, the thirteenth rotating section 341 is coaxial with the axial center of the fifth rotating section 23. However, these axes do not have to be coaxial.

【0100】また、リンク機構339 は、2次元のパ
ンタグラフ式平行リンクを形成している。回転部359
,361,351,353,341,349 は、それ
ぞれ第1〜第6回転部に相当し、各軸間距離は、AB,
BC,CD,AD,EA,EB,EFに等しい。
Further, the link mechanism 339 forms a two-dimensional pantograph type parallel link. Rotating part 359
, 361, 351, 353, 341, 349 correspond to the first to sixth rotating parts, respectively, and the distance between the axes is AB,
Equal to BC, CD, AD, EA, EB, EF.

【0101】したがって、連結部材39を固定した状態
で連結部材41をどの方向へ移動させても、姿勢を維持
した状態で第1連結部材43は連結部材41の移動量の
k倍の距離だけこれと同方向に移動する。このとき、リ
ンク機構337 の第14回転部349 も同方向へ移
動する。
Therefore, even if the connecting member 41 is moved in any direction with the connecting member 39 fixed, the first connecting member 43 will move a distance k times the amount of movement of the connecting member 41 while maintaining its posture. move in the same direction. At this time, the fourteenth rotating portion 349 of the link mechanism 337 also moves in the same direction.

【0102】同様に、連結部材41を固定して、連結部
材39をどの方向へ移動させても、姿勢を維持した状態
で第1連結部材43は連結部材39の移動量の(k−1
)倍の距離だけこれとは反対方向に移動する。また、本
実施例のリンク機構337 においては、上記第5実施
例と同様に補助リンク機構339 を設けることにより
、その剛性を向上させることができる。
Similarly, even if the connecting member 41 is fixed and the connecting member 39 is moved in any direction, the first connecting member 43 maintains its posture by the amount (k-1) of the movement of the connecting member 39.
) move twice the distance in the opposite direction. Further, in the link mechanism 337 of this embodiment, by providing an auxiliary link mechanism 339 as in the fifth embodiment, its rigidity can be improved.

【0103】次に、本発明の第7実施例について図13
を用いて説明する。第7実施例は、第6回転部の軸中心
どうしを同軸として一対の平行リンク3 を配置し、こ
れらの平行リンク3 の側面に補助リンク機構391 
を配置したものである。
Next, FIG. 13 shows a seventh embodiment of the present invention.
Explain using. In the seventh embodiment, a pair of parallel links 3 are arranged with the axes of the sixth rotating part coaxial with each other, and an auxiliary link mechanism 391 is provided on the side surface of these parallel links 3.
is arranged.

【0104】補助リンク機構391 は、一対の平行リ
ンク3 の第3回転リンク部材31どうしを連結する連
結部材365 に回転自在に連結された第4回転リンク
部材371 と、第20回転部373 を介して一端が
第4回転リンク部材371 に回転自在に連結された第
15補助リンク部材393 と、第21回転部379 
を介して第15補助リンク部材393 の他端側と回転
自在に連結されるとともに、第22回転部377 を介
して第5回転リンク部材375 に回転自在に連結され
た第14補助リンク部材395 とで構成されている。
The auxiliary link mechanism 391 connects the third rotary link members 31 of the pair of parallel links 3 through a fourth rotary link member 371 rotatably connected to a connecting member 365 that connects the third rotary link members 31 of the pair of parallel links 3 , and a twentieth rotary part 373 . a 15th auxiliary link member 393 whose one end is rotatably connected to the fourth rotating link member 371; and a 21st rotating part 379.
The 14th auxiliary link member 395 is rotatably connected to the other end of the 15th auxiliary link member 393 via the 15th auxiliary link member 393 and the 14th auxiliary link member 395 is rotatably connected to the 5th rotating link member 375 via the 22nd rotating portion 377 . It consists of

【0105】また、第4回転リンク部材371 には第
13補助リンク部材383 の一端が第23回転部38
1 を介して回転自在に連結されている。この第13補
助リンク部材383 の他端は、一端が第25回転部3
97 を介して第5回転リンク部材375 に回転自在
に連結された第16補助リンク部材385 の他端と、
第24回転部387 を介して回転自在に連結されてい
る。
[0105] Also, one end of the thirteenth auxiliary link member 383 is attached to the fourth rotating link member 371, and one end of the thirteenth auxiliary link member 383
1 and are rotatably connected. The other end of this thirteenth auxiliary link member 383 has one end connected to the twenty-fifth rotating part 3
the other end of the 16th auxiliary link member 385 rotatably connected to the 5th rotation link member 375 via 97;
They are rotatably connected via a 24th rotating section 387.

【0106】さらに、第24回転部387 には連結部
材389 の一端が回転自在に連結されており、第21
回転部379 を介して連結部材389 の他端は第1
5補助リンク部材393 と回転自在に連結されている
Furthermore, one end of a connecting member 389 is rotatably connected to the 24th rotating section 387, and the 21st
The other end of the connecting member 389 is connected via the rotating part 379 to the first
5 auxiliary link member 393 and is rotatably connected.

【0107】したがって、連結部材369 を固定した
状態で連結部材367 をどの方向へ移動させても、姿
勢を維持した状態で第1連結部材365 は連結部材3
67 の移動量のk倍の距離だけこれと同方向に移動す
る。このとき、第4回転リンク部材371 の第20回
転部373 と第23回転部381 も同方向へ移動す
る。
Therefore, even if the connecting member 367 is moved in any direction while the connecting member 369 is fixed, the first connecting member 365 will move to the connecting member 3 while maintaining its posture.
67 in the same direction as this by a distance k times the amount of movement. At this time, the 20th rotating part 373 and the 23rd rotating part 381 of the 4th rotating link member 371 also move in the same direction.

【0108】同様に、連結部材367 を固定した状態
で、連結部材369 をどの方向へ移動させても、姿勢
を維持した状態で第1連結部材365は連結部材369
 の移動量の(k−1)倍の距離だけこれとは反対方向
に移動する。 また、本実施例のリンク機構363 は、やはり補助リ
ンク機構391 を設けることによりその剛性を向上さ
せることができる。次に本発明の第8実施例について、
図14および図15を用いて説明する。なお図15は図
14の矢視d方向から見た補助リンク機構403 の側
面図である。図14および図15に示されるリンク機構
401 には、前記第7実施例の補助リンク機構391
 と異なる補助リンク機構403 が設けられたもので
ある。
Similarly, with the connecting member 367 fixed, even if the connecting member 369 is moved in any direction, the first connecting member 365 will move the connecting member 369 while maintaining its posture.
moves in the opposite direction by a distance (k-1) times the amount of movement. Furthermore, the rigidity of the link mechanism 363 of this embodiment can be improved by providing an auxiliary link mechanism 391. Next, regarding the eighth embodiment of the present invention,
This will be explained using FIGS. 14 and 15. Note that FIG. 15 is a side view of the auxiliary link mechanism 403 seen from the direction of arrow d in FIG. The link mechanism 401 shown in FIGS. 14 and 15 includes the auxiliary link mechanism 391 of the seventh embodiment.
A different auxiliary link mechanism 403 is provided.

【0109】第4回転リンク部材371 には、平行リ
ンク3 の第2リンク部材9 より短い第17補助リン
ク部材405 の一端が第29回転部421 を介して
回転自在に連結されている。この第17補助リンク部材
405 の他端には、第26回転部407 を介して連
結部材409 の一端と回転自在に連結されている。
One end of a seventeenth auxiliary link member 405, which is shorter than the second link member 9 of the parallel link 3, is rotatably connected to the fourth rotating link member 371 via a twenty-ninth rotating portion 421. The other end of this seventeenth auxiliary link member 405 is rotatably connected to one end of a connecting member 409 via a twenty-sixth rotating portion 407 .

【0110】連結部材409 の他端は、第27回転部
411 を介して第4回転リンク部材371 と回転自
在に連結された第18補助リンク部材413 と、第3
0回転部412 を介して回転自在に連結されている。 また、第28回転部415 を介して連結部材367 
の第5回転リンク部材375 と回転自在に連結された
第19補助リンク部材417 は、第30回転部412
 を介して回転自在に連結されている。
The other end of the connecting member 409 is connected to an eighteenth auxiliary link member 413 which is rotatably connected to the fourth rotary link member 371 via a twenty-seventh rotating part 411, and a third rotary link member 413.
They are rotatably connected via a zero-rotation portion 412 . In addition, the connecting member 367 is connected via the 28th rotating section 415.
The 19th auxiliary link member 417 rotatably connected to the 5th rotating link member 375 is the 30th rotating part 412
are rotatably connected via.

【0111】さらに、第26回転部407 は連結部材
367 の第5回転リンク部材375 に第31回転部
423 で回転自在に連結された第20補助リンク部材
419 と回転自在に連結されている。
Furthermore, the 26th rotating section 407 is rotatably connected to a 20th auxiliary link member 419, which is rotatably connected to the 5th rotating link member 375 of the connecting member 367 by the 31st rotating section 423.

【0112】したがって、連結部材369 を固定した
状態で連結部材367 をどの方向へ移動させても、姿
勢を維持した状態で第1連結部材365 は連結部材3
67 の移動量のk倍の距離だけこれと同方向に移動す
る。このとき、第4回転リンク部材371 の第29回
転部421 と第27回転部411 も同方向へ移動す
る。
Therefore, even if the connecting member 367 is moved in any direction while the connecting member 369 is fixed, the first connecting member 365 will move to the connecting member 3 while maintaining its posture.
67 in the same direction as this by a distance k times the amount of movement. At this time, the 29th rotating part 421 and the 27th rotating part 411 of the 4th rotating link member 371 also move in the same direction.

【0113】同様に、連結部材367 を固定した状態
で連結部材369をどの方向へ移動させても、姿勢を維
持した状態で第1連結部材365 は連結部材369 
の移動量の(k−1)倍の距離だけこれとは反対方向に
移動する。また、本実施例のリンク機構401 は上記
実施例と同様に補助リンク機構365 の姿勢を維持す
ることが可能となる。
Similarly, even if the connecting member 369 is moved in any direction with the connecting member 367 fixed, the first connecting member 365 will move to the connecting member 369 while maintaining its posture.
moves in the opposite direction by a distance (k-1) times the amount of movement. Further, the link mechanism 401 of this embodiment can maintain the posture of the auxiliary link mechanism 365 as in the above embodiment.

【0114】また、第7および第8実施例では、平行リ
ンク3 を2つ配置しているが、平行リンク3 と平行
リンク5 との組み合わせでもよい。つまり、各平行リ
ンク3,5 の第1〜第6回転部の軸中心は同軸で構成
されていなくてもよい。
Further, in the seventh and eighth embodiments, two parallel links 3 are arranged, but a combination of parallel links 3 and 5 may also be used. That is, the axial centers of the first to sixth rotating parts of each parallel link 3, 5 do not need to be coaxial.

【0115】次に、本発明の第9実施例について図16
および図17を用いて説明する。第9実施例のリンク機
構501 は、図1に示されるリンク機構1 に、第3
実施例の補助リンク301 とは異なる補助リンク機構
503 を設けた例である。これにより、平行リンク5
 の一部と補助リンク機構503 とで新たな平行リン
ク部が形成される。
Next, regarding the ninth embodiment of the present invention, FIG.
This will be explained using FIG. The link mechanism 501 of the ninth embodiment has a third link mechanism 1 shown in FIG.
This is an example in which an auxiliary link mechanism 503 different from the auxiliary link 301 of the embodiment is provided. As a result, parallel link 5
A new parallel link portion is formed by a part of the auxiliary link mechanism 503 and the auxiliary link mechanism 503.

【0116】第9実施例の補助リンク機構503 は、
第29回転部511 を介して第2回転リンク部材33
と回転自在に連結された第1補助リンク部材521 と
、第30回転部512 を介して第21補助リンク部材
521 の他端を回転自在に支持するとともに第1回転
部11a を回転自在に連結する第2回転部材315 
と、第31回転部513 を介して第2連結部材315
 と回転自在に連結されるとともに、他端を第32回転
部514 を介して第3回転リンク部材37と回転自在
に連結された第22補助リンク部材とで構成されている
The auxiliary link mechanism 503 of the ninth embodiment is as follows:
The second rotating link member 33 via the 29th rotating part 511
The first auxiliary link member 521 is rotatably connected to the first auxiliary link member 521 , and the other end of the 21st auxiliary link member 521 is rotatably supported via the 30th rotating portion 512 , and the first rotating portion 11a is rotatably connected to the first auxiliary link member 521 . Second rotating member 315
and the second connecting member 315 via the 31st rotating part 513
The 22nd auxiliary link member is rotatably connected to the third rotating link member 37 via the 32nd rotating part 514 at the other end.

【0117】第5回転部23a と第29回転部511
 との軸間距離は第1回転部11a と第30回転部5
12 との軸間距離に等しく、第29回転部511 と
第30回転部512 との軸間距離はE’B’に等しい
。また、第30回転部512 と第31回転部513 
との軸間距離は第6回転部25a と第32回転部51
4 との軸間距離に等しく、第31回転部513 と第
32回転部514 との軸間距離はB’F’に等しい。 したがって、平行リンク5 の一部と第21補助リンク
部材521 ,第22補助リンク部材522 とで複数
の平行リンク部が構成されている。
[0117] Fifth rotating section 23a and 29th rotating section 511
The distance between the axes is between the first rotating part 11a and the 30th rotating part 5.
12 and the center distance between the 29th rotating section 511 and the 30th rotating section 512 is equal to E'B'. In addition, the 30th rotating section 512 and the 31st rotating section 513
The distance between the axes is between the sixth rotating section 25a and the 32nd rotating section 51.
The distance between the axes of the 31st rotating part 513 and the 32nd rotating part 514 is equal to B'F'. Therefore, a plurality of parallel link parts are constituted by a part of the parallel link 5 , the 21st auxiliary link member 521 , and the 22nd auxiliary link member 522 .

【0118】このように、第3実施例で示した第5補助
リンク部材305 と第6補助リンク部材313 とを
第8回転部309 で回転自在に(同一回転部で)連結
するよりも、本実施例のように2つの補助リンク部材を
それぞれ異なった回転部で連結した方が、第1連結部材
43の姿勢が維持される動作範囲を広く確保することが
できる。
[0118] In this way, rather than connecting the fifth auxiliary link member 305 and the sixth auxiliary link member 313 rotatably by the eighth rotating part 309 (in the same rotating part) as shown in the third embodiment, the main By connecting the two auxiliary link members at different rotating parts as in the embodiment, it is possible to secure a wider range of motion in which the posture of the first connecting member 43 is maintained.

【0119】つまり、各補助リンク部材を任意の位置に
設置できるため、平行リンク5 の一部と補助リンク部
材とで形成される各平行リンク部が特異姿勢とならない
ように、独立に設定することができる。
[0119] In other words, since each auxiliary link member can be installed at any position, each parallel link part formed by a part of the parallel link 5 and the auxiliary link member can be set independently so that it does not have a singular posture. I can do it.

【0120】同様に、第4実施例で示した第7補助リン
ク部材323 と第8補助リンク部材329 とを第1
1回転部325 で(同一回転部で)連結せずに、複数
の補助リンク部材を第3連結部材331 の異なる回転
部で連結し、第1回転リンク部材35と第3回転リンク
部材331 の異なる回転部で連結し、第1回転リンク
部材35とで第3回転リンク部材を連結してもよい。
Similarly, the seventh auxiliary link member 323 and the eighth auxiliary link member 329 shown in the fourth embodiment are
A plurality of auxiliary link members are connected at different rotation parts of the third connection member 331 without being connected at one rotation part 325 (at the same rotation part), and the first rotation link member 35 and the third rotation link member 331 are connected at different rotation parts. The third rotating link member may be connected to the first rotating link member 35 by connecting at a rotating part.

【0121】なお、本発明の運動伝達装置は、例えば歩
行ロボットの脚駆動に適用することもできる。この場合
、脚の接地面を常に地面と水平になるようにすることが
できる。
The motion transmission device of the present invention can also be applied to, for example, driving the legs of a walking robot. In this case, the contact surfaces of the legs can always be made parallel to the ground.

【0122】[0122]

【発明の効果】以上のように本発明の運動伝達装置によ
れば、第1回転リンク部材や第2回転リンク部材の移動
量を少なく抑えながらも広い動作範囲を確保することが
可能となる。
As described above, according to the motion transmission device of the present invention, it is possible to secure a wide range of motion while suppressing the amount of movement of the first rotary link member and the second rotary link member.

【図面の簡単な説明】[Brief explanation of the drawing]

【図1】  運動伝達装置の第1実施例を示す斜視図。FIG. 1 is a perspective view showing a first embodiment of a motion transmission device.

【図2】  運動伝達装置に用いられる第1平行リンク
を示す斜視図である。
FIG. 2 is a perspective view showing a first parallel link used in the motion transmission device.

【図3】  運動伝達装置の動作範囲を示した模式図。FIG. 3 is a schematic diagram showing the operating range of the motion transmission device.

【図4】  運動伝達装置の第2実施例に係り、運動伝
達装置をマスタマニピュレータに適用した状態を示す斜
視図。
FIG. 4 is a perspective view showing a state in which the motion transmission device is applied to a master manipulator according to a second embodiment of the motion transmission device.

【図5】  図4のマスタマニピュレータを模式的に表
現した斜視図。
5 is a perspective view schematically representing the master manipulator of FIG. 4. FIG.

【図6】  運動伝達装置の第3実施例を示す斜視図。FIG. 6 is a perspective view showing a third embodiment of the motion transmission device.

【図7】  図6の矢視a方向から見た補助リンク機構
の側面図。
7 is a side view of the auxiliary link mechanism seen from the direction of arrow a in FIG. 6. FIG.

【図8】  運動伝達装置の第4実施例を示す斜視図。FIG. 8 is a perspective view showing a fourth embodiment of the motion transmission device.

【図9】  図8の矢視b方向から見た補助リンク機構
の側面図。
9 is a side view of the auxiliary link mechanism seen from the direction of arrow b in FIG. 8. FIG.

【図10】運動伝達装置の第5実施例を示す斜視図。FIG. 10 is a perspective view showing a fifth embodiment of the motion transmission device.

【図11】運動伝達装置の第6実施例を示す斜視図。FIG. 11 is a perspective view showing a sixth embodiment of the motion transmission device.

【図12】図11の矢視c方向から見た補助リンク機構
の側面図。
12 is a side view of the auxiliary link mechanism seen from the direction of arrow c in FIG. 11. FIG.

【図13】運動伝達装置の第7実施例を示す斜視図。FIG. 13 is a perspective view showing a seventh embodiment of the motion transmission device.

【図14】運動伝達装置の第8実施例を示す斜視図。FIG. 14 is a perspective view showing an eighth embodiment of the motion transmission device.

【図15】図14の矢視d方向から見た補助リンク機構
の側面図。
15 is a side view of the auxiliary link mechanism seen from the direction of arrow d in FIG. 14. FIG.

【図16】運動伝達装置の第9実施例を示す斜視図。FIG. 16 is a perspective view showing a ninth embodiment of the motion transmission device.

【図17】運動伝達装置の第9実施例を示す側面図。FIG. 17 is a side view showing a ninth embodiment of the motion transmission device.

【図18】従来の運動伝達装置をマスタ・スレーブマニ
ピュレータのマスタマニピュレータに適用した状態を示
す斜視図。
FIG. 18 is a perspective view showing a state in which a conventional motion transmission device is applied to a master manipulator of master/slave manipulators.

【符号の説明】[Explanation of symbols]

1,301,317,333,337,363,401
   リンク機構(運動伝達装置) 3,5   平行リンク 45  マニピュレータ 53  第1平行リンク 55  第2平行リンク 7,7a,57,57a   第1リンク部材9,9a
,59,59a   第2リンク部材13,13a,6
3,63a   第3リンク部材17,17a,67,
67a   第4リンク部材303,319,339,
391,403   補助リンク部材305   第5
補助リンク部材 313   第6補助リンク部材 323   第7補助リンク部材 329   第8補助リンク部材 343   第9補助リンク部材 345   第10補助リンク部材 347   第1 補助リンク部材 355   第12補助リンク部材 383   第13補助リンク部材 385   第14補助リンク部材 393   第15補助リンク部材 395   第16補助リンク部材 405   第17補助リンク部材 413   第18補助リンク部材 417   第19補助リンク部材 419   第20補助リンク部材 29,35,79,85   第1回転リンク部材27
,33,77,83   第2回転リンク部材31,3
7,81,87   第3回転リンク部材371   
第4回転リンク部材 375   第5回転リンク部材 39,41,89,91,93,95,335,365
,367,369,389,399,409   連結
部材 43  第1連結部材 315 第2連結部材 331 第3連結部材 11,11a,61,61a   第1回転部15,1
5a,65,65a   第2回転部19,19a,6
9,69a   第3回転部21,21a,71,71
a   第4回転部23,23a,73,73a   
第5回転部25,25a,75,75a   第6回転
部307   第7回転部 309   第8回転部 311   第9回転部 321   第10回転部第7回転部 325   第11回転部 327   第12回転部 341   第13回転部 349   第14回転部 351   第15回転部 353   第16回転部 357   第17回転部 359   第18回転部 361   第19回転部 373   第20回転部 377   第21回転部 379   第22回転部 381   第23回転部 387   第24回転部 397   第25回転部 407   第26回転部 411   第27回転部 415   第28回転部
1,301,317,333,337,363,401
Link mechanism (motion transmission device) 3, 5 Parallel link 45 Manipulator 53 First parallel link 55 Second parallel link 7, 7a, 57, 57a First link member 9, 9a
, 59, 59a Second link member 13, 13a, 6
3, 63a third link member 17, 17a, 67,
67a fourth link member 303, 319, 339,
391,403 Auxiliary link member 305 5th
Auxiliary link member 313 6th auxiliary link member 323 7th auxiliary link member 329 8th auxiliary link member 343 9th auxiliary link member 345 10th auxiliary link member 347 1st auxiliary link member 355 12th auxiliary link member 383 13th auxiliary link Member 385 14th auxiliary link member 393 15th auxiliary link member 395 16th auxiliary link member 405 17th auxiliary link member 413 18th auxiliary link member 417 19th auxiliary link member 419 20th auxiliary link member 29, 35, 79, 85 First rotating link member 27
, 33, 77, 83 Second rotating link member 31, 3
7, 81, 87 Third rotating link member 371
Fourth rotating link member 375 Fifth rotating link member 39, 41, 89, 91, 93, 95, 335, 365
, 367, 369, 389, 399, 409 Connecting member 43 First connecting member 315 Second connecting member 331 Third connecting member 11, 11a, 61, 61a First rotating part 15, 1
5a, 65, 65a Second rotating part 19, 19a, 6
9, 69a Third rotating part 21, 21a, 71, 71
a Fourth rotating part 23, 23a, 73, 73a
5th rotating section 25, 25a, 75, 75a 6th rotating section 307 7th rotating section 309 8th rotating section 311 9th rotating section 321 10th rotating section 7th rotating section 325 11th rotating section 327 12th rotating section 341 13th rotating section 349 14th rotating section 351 15th rotating section 353 16th rotating section 357 17th rotating section 359 18th rotating section 361 19th rotating section 373 20th rotating section 377 21st rotating section 379 22nd rotating section 381 23rd rotating section 387 24th rotating section 397 25th rotating section 407 26th rotating section 411 27th rotating section 415 28th rotating section

Claims (6)

【特許請求の範囲】[Claims] 【請求項1】  第1リンク部材と、前記第1リンク部
材と第1回転部で回転自在に連結された第2リンク部材
と、前記第1リンク部材の中間部と第2回転部で回転自
在に連結された第3リンク部材と、前記第3リンク部材
と第3回転部で回転自在に連結されるとともに前記第2
リンク部材の中間部の第4回転部で回転自在に連結され
た第4リンク部材と、前記第1リンク部材の前記第1回
転部と第2回転部とを結ぶ延長線上に形成された第5回
転部と、前記第2リンク部材の前記第1回転部と前記第
4回転部の延長線上に形成された第6回転部と、前記第
3回転部を支持し、かつ前記第3回転部の軸中心方向に
対して直角方向を中心に前記第3回転部と回転自在に連
結された第1回転リンク部材と、前記第5回転部を支持
し、かつ前記第5回転部の軸中心方向に対して直角方向
を中心に前記第5回転部と回転自在に連結された第2回
転リンク部材と、前記第6回転部を支持し、かつ前記第
6回転部の軸中心方向に対して直角方向を中心に前記第
6回転部と回転自在に連結された第3回転リンク部材と
、を備えたリンク機構を有する運動伝達装置において、
前記リンク機構の複数組を平行に配置し、かつ第3回転
リンク部材どうしをそれぞれ回転自在に第1連結部材で
連結したことを特徴とする運動伝達装置。
1. A first link member, a second link member rotatably connected to the first link member and a first rotating portion, and a second link member rotatably connected to an intermediate portion of the first link member and a second rotating portion; a third link member connected to the second link member, and a third link member rotatably connected to the third link member by a third rotating portion
A fifth link member formed on an extension line connecting a fourth link member rotatably connected at a fourth rotating portion in the intermediate portion of the link member, and the first rotating portion and the second rotating portion of the first link member. a rotating part, a sixth rotating part formed on an extension line of the first rotating part and the fourth rotating part of the second link member, supporting the third rotating part, and supporting the third rotating part; a first rotating link member rotatably connected to the third rotating section in a direction perpendicular to the axial center direction; and a first rotating link member supporting the fifth rotating section and extending in the axial center direction of the fifth rotating section; a second rotating link member rotatably connected to the fifth rotating section about a direction perpendicular to the second rotating section; A motion transmission device having a link mechanism including a third rotating link member rotatably connected to the sixth rotating part around
A motion transmission device characterized in that a plurality of sets of the link mechanisms are arranged in parallel, and the third rotating link members are rotatably connected to each other by a first connecting member.
【請求項2】  複数組設けられたリンク機構のうち、
少なくとも2組のリンク機構の一方の第6回転部の軸中
心と他方のリンク機構の第6回転部の軸中心とがずれた
状態で構成されていることを特徴とする請求項1記載の
運動伝達装置。
[Claim 2] Among the link mechanisms provided in plural sets,
The motion according to claim 1, wherein the axial center of the sixth rotating section of one of the at least two link mechanisms is shifted from the axial center of the sixth rotating section of the other link mechanism. transmission device.
【請求項3】  複数組設けられたリンク機構のうち、
少なくとも1組のリンク機構に補助リンク機構を設け、
第1リンク部材が移動しても姿勢が変化しないようにリ
ンク機構の各リンク部材と前記補助リンク部材とを連結
して構成したことを特徴とする請求項1記載の運動伝達
装置。
[Claim 3] Among the link mechanisms provided in plural sets,
providing an auxiliary link mechanism in at least one set of link mechanisms;
2. The motion transmission device according to claim 1, wherein each link member of the link mechanism and the auxiliary link member are connected to each other so that the posture of the first link member does not change even if the first link member moves.
【請求項4】  複数組設けられたリンク機構のうち、
少なくとも1組のリンク機構に補助リンク機構を設け、
第1リンク部材が移動しても姿勢が変化しないように前
記リンク機構の各リンク部材と複数の前記補助リンクと
を連結して構成したことを特徴とする請求項1記載の運
動伝達装置。
[Claim 4] Among the link mechanisms provided in plural sets,
providing an auxiliary link mechanism in at least one set of link mechanisms;
2. The motion transmission device according to claim 1, wherein each link member of the link mechanism is connected to a plurality of the auxiliary links so that the posture of the first link member does not change even if the first link member moves.
【請求項5】  補助リンク機構は、第2回転リンク部
材と第7回転部で回転自在に連結された第5補助リンク
部材と、前記第5補助リンク部材と第8回転部で回転自
在に連結されるとともに、第3回転リンク部材と第9回
転部で回転自在に連結された第6補助リンク部材と、第
1回転部と前記第8回転部を回転自在に連結する第2連
結部材とで構成されていることを特徴とする請求項4記
載の運動伝達装置。
5. The auxiliary link mechanism includes a fifth auxiliary link member rotatably connected to the second rotating link member and a seventh rotating portion, and a fifth auxiliary link member rotatably connected to the fifth auxiliary link member and an eighth rotating portion. and a sixth auxiliary link member rotatably connected to the third rotating link member and the ninth rotating section, and a second connecting member rotatably connecting the first rotating section and the eighth rotating section. The motion transmission device according to claim 4, characterized in that the motion transmission device comprises:
【請求項6】  補助リンク機構は、第1回転リンク部
材と第10回転部とで回転自在に連結された第7補助リ
ンク部材と、前記第7補助リンク部材と第11回転部と
で回転自在に連結されるとともに第3回転リンク部材と
第12回転部とで回転自在に連結された第8補助リンク
部材と、第4回転部と前記第11回転部とを回転自在に
連結する第3連結部材とで構成されていることを特徴と
する請求項4記載の運動伝達装置。
6. The auxiliary link mechanism includes a seventh auxiliary link member rotatably connected to a first rotating link member and a tenth rotating section, and a seventh auxiliary link member rotatably connected to the seventh auxiliary link member and an eleventh rotating section. an eighth auxiliary link member rotatably connected to the third rotating link member and the twelfth rotating section; and a third connection rotatably connecting the fourth rotating section and the eleventh rotating section. The motion transmission device according to claim 4, characterized in that it is comprised of a member.
JP11838291A 1990-05-24 1991-05-23 Exercise transmission device Expired - Fee Related JP3165170B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP11838291A JP3165170B2 (en) 1990-05-24 1991-05-23 Exercise transmission device

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP13249990 1990-05-24
JP2-132499 1990-05-24
JP11838291A JP3165170B2 (en) 1990-05-24 1991-05-23 Exercise transmission device

Publications (2)

Publication Number Publication Date
JPH04226878A true JPH04226878A (en) 1992-08-17
JP3165170B2 JP3165170B2 (en) 2001-05-14

Family

ID=26456335

Family Applications (1)

Application Number Title Priority Date Filing Date
JP11838291A Expired - Fee Related JP3165170B2 (en) 1990-05-24 1991-05-23 Exercise transmission device

Country Status (1)

Country Link
JP (1) JP3165170B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4964777B2 (en) * 2005-09-16 2012-07-04 株式会社アルバック Conveying mechanism, conveying apparatus, and vacuum processing apparatus
CN104476539A (en) * 2014-12-18 2015-04-01 广西大学 Controllable mechanism type wheeled movable palletizing robot

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4964777B2 (en) * 2005-09-16 2012-07-04 株式会社アルバック Conveying mechanism, conveying apparatus, and vacuum processing apparatus
CN104476539A (en) * 2014-12-18 2015-04-01 广西大学 Controllable mechanism type wheeled movable palletizing robot

Also Published As

Publication number Publication date
JP3165170B2 (en) 2001-05-14

Similar Documents

Publication Publication Date Title
US5673595A (en) Four degree-of-freedom manipulator
US7337691B2 (en) Parallel kinematics mechanism with a concentric spherical joint
EP1863734B1 (en) Parallel robot
JP3806273B2 (en) 4-DOF parallel robot
CA2176899C (en) Mechanism for control of position and orientation in three dimensions
US7281447B2 (en) Articulated mechanism comprising a cable reduction gear for use in a robot arm
US8099188B2 (en) Parallel kinematic robot and method for controlling this robot
US5271290A (en) Actuator assembly
JP3640087B2 (en) Machine Tools
US20030005786A1 (en) Parallel mechanism
JP4289506B2 (en) 4-DOF parallel robot
JP2004512187A (en) Industrial robot
JP2001293676A (en) Parallel link robot
JP4696384B2 (en) Parallel link robot
US20040013509A1 (en) Parallel kinematics mechanism with a concentric spherical joint
KR102246778B1 (en) Finger apparatus and robot hand having the finger apparatus
JPH04226878A (en) Motion transmission device
EP0540197A1 (en) Actuator assembly of a hand-controller
CN115476331B (en) Manipulator and master-slave follow-up equipment
JPH08373B2 (en) manipulator
JPH0871963A (en) Industrial robot
JP2023173620A (en) Articulated robot, control method of articulated robot, robot system, and method of manufacturing goods
JPH0445305B2 (en)
JPH0890462A (en) Parallel link manipulator
JP2002264045A (en) Force feedback type operating device

Legal Events

Date Code Title Description
FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080302

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090302

Year of fee payment: 8

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100302

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100302

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110302

Year of fee payment: 10

LAPS Cancellation because of no payment of annual fees