JPH1029178A - Manipulator - Google Patents
ManipulatorInfo
- Publication number
- JPH1029178A JPH1029178A JP18491096A JP18491096A JPH1029178A JP H1029178 A JPH1029178 A JP H1029178A JP 18491096 A JP18491096 A JP 18491096A JP 18491096 A JP18491096 A JP 18491096A JP H1029178 A JPH1029178 A JP H1029178A
- Authority
- JP
- Japan
- Prior art keywords
- universal joint
- center
- axis
- traveling plate
- plate
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Landscapes
- Manipulator (AREA)
Abstract
Description
【０００１】[0001]
【発明の属する技術分野】本発明は、工業用ロボット等
において、工具あるいはワークを支持してその三次元的
な位置及び姿勢を制御するマニプレータの構造に係る。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a structure of a manipulator for supporting a tool or a work and controlling its three-dimensional position and attitude in an industrial robot or the like.
【０００２】[0002]
【従来の技術】いわゆるパラレルメカニズム（パラレル
リンク機構）は、高剛性、高速度、高精度など優れた特
徴を備え、工作機械、ロボットなどへの適用が検討さ
れ、注目を集めている。2. Description of the Related Art A so-called parallel mechanism (parallel link mechanism) has excellent features such as high rigidity, high speed, and high accuracy, and is being considered for application to machine tools, robots, and the like, and has attracted attention.
【０００３】パラレルメカニズムの一例として、上下二
つのプラットホーム（トラベリングプレート及びベース
プレート）を、６本の伸縮型のリンクで連結したスチュ
ワートプラットフォーム、あるいは、特公平６−５７３
９４号公報に記載された４本のリンクを備えた装置など
が広く知られている。As an example of the parallel mechanism, a Stewart platform in which two upper and lower platforms (a traveling plate and a base plate) are connected by six telescopic links, or Japanese Patent Publication No. 6-573.
An apparatus having four links described in Japanese Patent Publication No. 94 is widely known.
【０００４】しかし、上記の機構は、上側プラットホー
ム（トラベリングプレート）の位置及び姿勢の制御をボ
ールネジを用いたリンクの伸縮によって行っているの
で、位置及び姿勢の可動範囲が比較的狭い。また、スチ
ュワートプラットフォームの場合、リンクの数が多いこ
とに起因して、リンク相互の干渉が起き易いという問題
がある。また、自在継手の揺動軸が離間していて交わっ
ていない構造の場合には、運動解析が複雑になり制御演
算時間も長くなるという問題もある。以上の様に、パラ
レルメカニズムにはそれに特有の制約があり、このた
め、実用的な適用範囲が制限されていた。[0004] However, in the above mechanism, since the position and posture of the upper platform (traveling plate) are controlled by expanding and contracting the link using a ball screw, the movable range of the position and posture is relatively narrow. Further, in the case of the Stewart platform, there is a problem that the mutual interference easily occurs due to the large number of links. Further, in the case of a structure in which the swing axes of the universal joint are separated and do not intersect, there is a problem that the motion analysis becomes complicated and the control calculation time becomes longer. As described above, the parallel mechanism has its own limitations, which limits the practical application range.
【０００５】[0005]
【発明が解決しようとする課題】本発明の目的は、高剛
性、高速度、高精度などのパラレルメカニズムの優れた
特徴を生かすとともに、制御軸数を最小限とし、且つ幾
何学的に比較的単純な構造とすることによって、制御演
算時間が短く、しかも可動範囲が大きいマニプレータを
提供することにある。SUMMARY OF THE INVENTION It is an object of the present invention to take advantage of the excellent features of a parallel mechanism such as high rigidity, high speed and high precision, to minimize the number of control axes, and to make it relatively geometrical. An object of the present invention is to provide a manipulator having a simple structure and a short control operation time and a large movable range.
【０００６】[0006]
【課題を解決するための手段】本発明のマニプレータ
は、ベースプレート及びベースプレートの上方にこれと
対向する様に配置された上部フレームを備えたフレーム
と、ベースプレートと上部フレームの間に配置された可
動式のトラベリングプレートと、ベースプレートとトラ
ベリングプレートを互いに連結する３本のリンクと、上
部フレームとトラベリングプレートを互いに連結するセ
ンターリンクと、を備えたマニプレータであって、前記
ベースプレートは、その周縁部の３箇所に二軸回りの傾
動が可能な第一の自在継手、及び当該第一の自在継手の
可動側コア部に内蔵され、当該可動側コア部を貫通する
ロッドを軸方向に駆動する軸方向駆動機構を備え、前記
各リンクの一端は、それぞれ当該ロッドに接続され、前
記トラベリングプレートは、その下面側の周縁部の３箇
所に二軸回りの傾動が可能な第二の自在継手を備え、前
記各リンクの他端は、これらの第二の自在継手を介し
て、それぞれ前記トラベリングプレートに接続され、前
記上部フレームは、二軸回りの傾動が可能で且つネジリ
剛性を有する第三の自在継手、及び当該第三の自在継手
の可動側コア部に内蔵され、前記センターリンクの一端
を軸方向の摺動のみが可能な状態で支持する軸受を備
え、前記センターリンクの他端は、前記トラベリングプ
レートの上面に垂直に固定され、前記各ロッドのストロ
ークを、それぞれ独立に制御することによって、前記ト
ラベリングプレートの前記ベースプレートに対する三次
元位置を制御することを特徴とする。SUMMARY OF THE INVENTION A manipulator according to the present invention comprises a frame having a base plate and an upper frame disposed above and opposed to the base plate, and a movable type disposed between the base plate and the upper frame. A manipulator comprising a traveling plate, three links connecting the base plate and the traveling plate to each other, and a center link connecting the upper frame and the traveling plate to each other. A first universal joint capable of tilting around two axes, and an axial drive mechanism built in the movable core portion of the first universal joint and axially driving a rod passing through the movable core portion. One end of each link is connected to the rod, Is equipped with second universal joints capable of tilting around two axes at three locations on the lower surface side of the peripheral portion, and the other ends of the links are respectively connected to the second universal joints via the second universal joints. Connected to a traveling plate, the upper frame is capable of being tilted around two axes and has a torsionally rigid third universal joint, and is incorporated in a movable-side core portion of the third universal joint; A bearing that supports one end in a state that allows only sliding in the axial direction, and the other end of the center link is vertically fixed to an upper surface of the traveling plate, and independently controls a stroke of each rod. Thereby, a three-dimensional position of the traveling plate with respect to the base plate is controlled.
【０００７】好ましくは、上記マニプレータにおいて、
前記第一の自在継手を、前記ベースプレート上の、第一
の円周上の互いに等角度をなす位置に配置し、前記第二
の自在継手を、前記トラベリングプレートの下面側の、
第二の円周上の互いに等角度をなす位置に配置し、前記
第三の自在継手を、前記上部フレーム上の、前記第一の
円周の中心軸の延長線上に当る位置に配置し、前記セン
ターリンクの他端を、前記トラベリングプレートの上面
側の、前記第二の円周の中心軸の延長線上に当る位置に
配置する。[0007] Preferably, in the above manipulator,
The first universal joint is arranged on the base plate at a position on the first circumference that is at an equal angle to each other, and the second universal joint is located on the lower surface side of the traveling plate.
Arranged at positions equiangular to each other on a second circumference, and the third universal joint is arranged on the upper frame at a position corresponding to an extension of a central axis of the first circumference, The other end of the center link is disposed at a position on the upper surface side of the traveling plate on an extension of a center axis of the second circumference.
【０００８】更に、好ましくは、上記マニプレータにお
いて、前記第一の自在継手、前記第二の自在継手及び前
記第三の自在継手は、それぞれ、互いに揺動中心におい
て直交する二つの傾動軸を持ち、前記各リンクの軸心
は、それぞれ、前記第一の自在継手の揺動中心及び前記
第二の自在継手の揺動中心を通り、前記センターリンク
の軸心は前記第三の自在継手の揺動中心を通る様に、上
記のマニプレータを構成する。More preferably, in the above-mentioned manipulator, the first universal joint, the second universal joint, and the third universal joint each have two tilting axes that are orthogonal to each other at a swing center. The axis of each link passes through the swing center of the first universal joint and the swing center of the second universal joint, respectively, and the axis of the center link swings through the swing of the third universal joint. The above-described manipulator is configured to pass through the center.
【０００９】本発明のマニプレータは、第一の自在継手
の可動側コア部に内蔵された軸方向駆動機構を用いて、
当該可動側コア部の内部を貫通するロッドを軸方向に駆
動することによって、３本のリンクの軸方向の移動量を
独立に能動的に制御し、この動きに対して、第二の自在
継手の二軸回りの傾動、第三の自在継手の二軸回りの傾
動、及び第三の自在継手の可動側コア部に内蔵された軸
受を貫通するセンターリンクの軸方向の摺動を受動的に
追従させることによって、トラベリングプレートを、上
部フレーム上に配置された第三の自在継手の二つの傾動
軸を中心とする曲面群に沿った姿勢で、任意の位置に位
置決めすることができる。これにより、トラベリングプ
レートの三次元位置の制御が実現される。The manipulator of the present invention uses an axial drive mechanism built in the movable core of the first universal joint,
By axially driving a rod penetrating the inside of the movable side core portion, the axial movement amounts of the three links are independently and actively controlled. Of the center link passing through the bearing built into the movable side core of the third universal joint, and the axial sliding of the third universal joint in the axial direction passively. By following this, the traveling plate can be positioned at an arbitrary position in a posture along the curved surface group centered on the two tilt axes of the third universal joint arranged on the upper frame. Thereby, control of the three-dimensional position of the traveling plate is realized.
【００１０】更に上記の様に、第一、第二及び第三の各
自在継手を幾何学的に最も単純な構造となる様に配置す
ることによって、上記マニプレータの構造的な強度を効
率良く確保するとともに、制御演算時間を短縮すること
ができる。Further, as described above, by arranging the first, second and third universal joints in a geometrically simple structure, the structural strength of the manipulator can be efficiently secured. In addition, the control calculation time can be reduced.
【００１１】更に上記の様に、各自在継手をそれぞれ二
つの傾動軸が互いに直交する構造、即ち、二つの傾動軸
が揺動中心において交差する構造とするとともに、３本
のリンク及びセンターリンクの軸心が各自在継手の揺動
中心を通る様に上記マニプレータを構成することによっ
て、幾何学的な条件が更に単純化され、制御演算時間を
更に短縮することができる。なお、この場合には、トラ
ベリングプレートは、第三の自在継手の揺動中心を中心
とする同心球面に沿った姿勢で位置決めされる。Further, as described above, each universal joint has a structure in which two tilting axes are orthogonal to each other, that is, a structure in which the two tilting axes intersect at the center of swing, and the three links and the center link have the same structure. By configuring the manipulator such that the axis passes through the swing center of each universal joint, the geometric conditions can be further simplified, and the control calculation time can be further reduced. In this case, the traveling plate is positioned in a posture along a concentric spherical surface centered on the swing center of the third universal joint.
【００１２】また、工具あるいはワークを保持するため
の掴み部を、前記トラベリングプレートの下面側に、前
記センターリンクの軸回りに回動する第一の回転駆動機
構、及び前記センターリンクの軸心と直交する軸回りに
回動する第二の回転駆動機構を介して接続することによ
って、この掴み部に取付けられる工具あるいはワークの
位置及び姿勢についての五自由度制御機構を実現するこ
とができる。[0012] Further, a grip portion for holding a tool or a work is provided on a lower surface side of the traveling plate with a first rotation drive mechanism which rotates around the axis of the center link, and an axis of the center link. By connecting via a second rotation drive mechanism that rotates about an orthogonal axis, a five-degree-of-freedom control mechanism for the position and orientation of a tool or a work attached to the gripper can be realized.
【００１３】[0013]
【発明の実施の形態】図１に本発明に基くマニプレータ
の実施の形態の一例を示す。図１は、三軸制御式のマニ
プレータを模式的に例示したもので、図中、８はフレー
ム、１はベースプレート、９は上部フレーム、２はトラ
ベリングプレート、３はリンク、４はセンターリンク、
２１は第一の自在継手、３１は第二の自在継手、４１は
第三の自在継手を表す。FIG. 1 shows an embodiment of a manipulator according to the present invention. FIG. 1 schematically illustrates a three-axis control type manipulator, in which 8 is a frame, 1 is a base plate, 9 is an upper frame, 2 is a traveling plate, 3 is a link, 4 is a center link,
21 denotes a first universal joint, 31 denotes a second universal joint, and 41 denotes a third universal joint.
【００１４】フレーム８の下部にはベースプレート１が
固定され、フレーム８の上部にはベースプレート１と対
向する様に上部フレーム９が固定されている。ベースプ
レート１と上部フレーム９との間の空間部には作業領域
が設定され、トラベリングプレート２はこの作業領域内
に配置される。トラベリングプレート２の下面側は３本
のリンクを介してベースプレート１と連結され、また、
上面側はセンターリンク４を介して上部フレーム９と連
結されている。ワーク１０はベースプレート１に固定さ
れる。A base plate 1 is fixed to a lower portion of the frame 8, and an upper frame 9 is fixed to an upper portion of the frame 8 so as to face the base plate 1. A work area is set in a space between the base plate 1 and the upper frame 9, and the traveling plate 2 is arranged in the work area. The lower surface side of the traveling plate 2 is connected to the base plate 1 via three links.
The upper surface is connected to the upper frame 9 via the center link 4. The work 10 is fixed to the base plate 1.
【００１５】ベースプレート１には、円周上（第一の円
周上）の互いに１２０度離れた位置に、３個の自在継手
２１（第一の自在継手）が配置されている。トラベリン
グプレート２の下面側には、円周上（第二の円周上）の
互いに１２０度離れた位置に、３個の自在継手３１（第
二の自在継手）が配置されている。上記の３本のリンク
３の一端は、後述する様に、第一の自在継手２１を貫通
するロッド２３に接続され、他端は、自在継手３１を介
して、それぞれトラベリングプレート２に接続されてい
る。Three universal joints 21 (first universal joints) are arranged on the base plate 1 at positions 120 degrees apart from each other on the circumference (on the first circumference). On the lower surface side of the traveling plate 2, three universal joints 31 (second universal joints) are arranged at positions separated from each other by 120 degrees on the circumference (on the second circumference). One end of each of the three links 3 is connected to a rod 23 that penetrates the first universal joint 21 as described later, and the other end is connected to the traveling plate 2 via a universal joint 31. I have.
【００１６】また、上部フレーム９の中央部には、自在
継手４１（第三の自在継手）が配置され、上記のセンタ
ーアーム４の一端は、後述する様に、自在継手４１を貫
通する形で自在継手４１に接続され、他端は、トラベリ
ングプレート２の上面の中央に垂直に固定されている。A universal joint 41 (third universal joint) is disposed at the center of the upper frame 9, and one end of the center arm 4 penetrates the universal joint 41 as described later. The other end is connected to the universal joint 41, and the other end is vertically fixed to the center of the upper surface of the traveling plate 2.
【００１７】上記の自在継手２１は、リンク３の軸心に
直交する二本の軸回りの傾動が可能な２自由度の回転対
偶型の構造を備える。更に、この自在継手２１の可動側
コア部（グリ玉）２２には、ボールネジ（軸方向駆動機
構）及びこれを駆動するサーボモータが内蔵されてお
り、このボールネジのロッド部２３にリンク３が接続さ
れている。サーボモータを駆動してボールネジのナット
部を回転させることによって、リンク３の移動量、即
ち、自在継手２１の可動側コア部２２を貫通する軸方向
の移動量が制御される。The above-mentioned universal joint 21 has a two-degree-of-freedom rotary pair structure capable of tilting about two axes perpendicular to the axis of the link 3. Further, a ball screw (axial driving mechanism) and a servomotor for driving the ball screw are built in the movable core portion (grinding ball) 22 of the universal joint 21, and the link 3 is connected to a rod portion 23 of the ball screw. Have been. By driving the servomotor to rotate the nut portion of the ball screw, the amount of movement of the link 3, that is, the amount of movement of the universal joint 21 in the axial direction passing through the movable core portion 22 is controlled.
【００１８】一方、自在継手３１は、リンク３の軸回り
の回転が拘束され、リンク３の軸心に直交する二本の軸
回りにのみ傾動可能な２自由度の回転対偶型の構造を備
える。On the other hand, the universal joint 31 has a two-degree-of-freedom rotary-even structure in which rotation about the axis of the link 3 is restricted and can be tilted only about two axes orthogonal to the axis of the link 3. .
【００１９】また、自在継手４１は、センターリンク４
の軸回りの回転が拘束され、センターリンク４の軸に直
交する二本の軸回りにのみ傾動可能な２自由度の回転対
偶型の構造を備える。更に、自在継手４１の可動側コア
部（グリ玉）４２にはボールスプライン（軸受）が内蔵
されており、センターリンク４は、このボールスプライ
ンを貫通する形で自在継手４１に支持されている。従っ
て、センターリンク４は、自在継手４１に対して軸方向
の摺動が可能であり、また、センターリンク４の軸回り
のネジリトルクに対しては十分な剛性を備えている。The universal joint 41 has a center link 4
Is restricted, and has a two-degree-of-freedom rotational pair structure that can be tilted only around two axes orthogonal to the axis of the center link 4. Further, a ball spline (bearing) is built in the movable core portion (grinding ball) 42 of the universal joint 41, and the center link 4 is supported by the universal joint 41 so as to penetrate the ball spline. Therefore, the center link 4 can slide in the axial direction with respect to the universal joint 41, and has sufficient rigidity against torsion torque around the axis of the center link 4.
【００２０】また、自在継手２１、自在継手３１及び自
在継手４１は、それぞれ、二本の傾動軸が互いに直交す
る構造を備える。これらの直交する二本の傾動軸の交点
は揺動中心と呼ばれる。３本のリンク３の各軸心は、そ
れぞれ、第一の自在継手２１の揺動中心及び自在継手３
１の揺動中心を通り、センターリンク４の軸心は、自在
継手４１の揺動中心を通る。The universal joint 21, universal joint 31, and universal joint 41 each have a structure in which two tilting axes are orthogonal to each other. The point of intersection of these two orthogonal tilt axes is called the center of oscillation. The axes of the three links 3 are respectively the center of swing of the first universal joint 21 and the universal joint 3.
1, the axis of the center link 4 passes through the center of the swing of the universal joint 41.
【００２１】また、自在継手２１の各揺動中心は、ベー
スプレート上の、円周上（第一の円周上）の互いに等角
度をなす位置に配置され、自在継手４１の揺動中心は、
自在継手２１の揺動中心が配置されている前記円周（第
一の円周）の中心軸の延長線上にある。自在継手３１の
各揺動中心は、トラベリングプレートの下面側の、円周
上（第二の円周上）の互いに等角度をなす位置に配置さ
れ、センターリンク４の軸心は、自在継手３１の揺動中
心が配置されている前記円周（第二の円周）の中心軸の
延長線上にある。The center of swing of the universal joint 21 is arranged at a position on the base plate that is at an equal angle on the circumference (on the first circumference), and the center of swing of the universal joint 41 is
The swing center of the universal joint 21 is on an extension of the center axis of the circumference (first circumference) where the center is arranged. Each swing center of the universal joint 31 is disposed at a position on the lower surface side of the traveling plate that is at an equal angle on the circumference (on the second circumference). Is located on an extension of the center axis of the circumference (second circumference) in which the swing center is disposed.
【００２２】上記の機構において、センターリンク４の
軸心は自在継手４１の揺動中心を通るので、センターリ
ンク４に対して固定的に接続されたトラベリングプレー
ト２は、自在継手４１の揺動中心を中心とする同心球面
に沿った姿勢を常に保った状態で、位置及び姿勢につい
ての三次元位置の制御機構が実現される。In the above mechanism, since the axis of the center link 4 passes through the center of swing of the universal joint 41, the traveling plate 2 fixedly connected to the center link 4 moves the center of swing of the universal joint 41. The control mechanism of the three-dimensional position of the position and the posture is realized while always keeping the posture along the concentric spherical surface centered at the center.
【００２３】図２に、本発明に基くマニプレータの実施
の形態の第二の例を示す。図２は、五軸制御式のマニプ
レータを模式的に例示したもので、図中、５２は第一の
回転駆動機構、５３は第二の回転駆動機構、５４は掴み
部を表す。その他の構成に関しては、図１に示した装置
と共通であるので、同一の符号を付して、その説明を省
略する。FIG. 2 shows a second example of the embodiment of the manipulator according to the present invention. FIG. 2 schematically illustrates a five-axis control type manipulator. In the figure, reference numeral 52 denotes a first rotary drive mechanism, 53 denotes a second rotary drive mechanism, and 54 denotes a gripper. Other configurations are the same as those of the apparatus shown in FIG. 1, and therefore, the same reference numerals are given and the description thereof will be omitted.
【００２４】トラベリングプレート２の下面側の中央部
には、センターリンク４の軸回りに回動する第一の回転
駆動機構５２、及びセンターリンク４の軸と直交する軸
回りに回動する第二の回転駆動機構５３を介して、掴み
部５４が接続されている。この掴み部５４に工具が取付
けられる。At the center on the lower surface side of the traveling plate 2, a first rotation drive mechanism 52 that rotates around the axis of the center link 4 and a second rotation drive mechanism 52 that rotates around an axis orthogonal to the axis of the center link 4. The gripping portion 54 is connected via the rotary drive mechanism 53 of the first embodiment. A tool is attached to the grip 54.
【００２５】三次元位置の制御がされるトラベリングプ
レート２に、二つの一軸回りの回転駆動機構５２、５３
を介して掴み部５４を接続することによって、掴み部５
４の先に取付けられる工具の位置及び姿勢についての五
自由度制御機構を実現することができる。The traveling plate 2 for controlling the three-dimensional position is provided with two rotary drive mechanisms 52, 53 around one axis.
By connecting the gripping section 54 via the
It is possible to realize a five-degree-of-freedom control mechanism for the position and orientation of the tool attached ahead of the fourth.
【００２６】なお、この様な構造は、いわゆるパラレル
メカニズムに、いわゆるシリアルメカニズムを重畳した
構造となるが、パラレルメカニズムに対して付加される
部分が、いずれも、剛性、速度及び精度の点で有利な一
軸回りの回転運動であるので、パラレルメカニズムの性
能を著しく劣化させる要因とはならない。Although such a structure is a structure in which a so-called serial mechanism is superimposed on a so-called parallel mechanism, all of the parts added to the parallel mechanism are advantageous in terms of rigidity, speed and accuracy. Since the rotation is about one axis, it does not significantly degrade the performance of the parallel mechanism.
【００２７】上記の五自由度制御の機構は、先に示した
三自由度制御の機構と比較して、最終段の位置および姿
勢を、より高い自由度で制御することができるので、そ
の適用範囲を更に広げることができる。例えば、掴み部
５４にモータで回転される刃を持つ回転工具を搭載すれ
ば、上記の機構をワーク１０の切削加工あるいは研削加
工などに適用することができる。その他、溶接、塗装、
組立てなどの作業に適用可能である。なお、ワーク１０
を固定する装置として、水平軸あるいは鉛直軸の一軸な
いし二軸回りの回動が可能な機構を採用すれば、更にそ
の適用範囲を拡げることができる。The above-described five-degree-of-freedom control mechanism can control the position and orientation of the final stage with a higher degree of freedom than the three-degree-of-freedom control mechanism described above. The range can be further expanded. For example, if a rotary tool having a blade rotated by a motor is mounted on the grip portion 54, the above mechanism can be applied to cutting or grinding of the work 10. Other, welding, painting,
It is applicable to work such as assembly. The work 10
If a mechanism that can rotate around one or two axes of a horizontal axis or a vertical axis is adopted as a device for fixing the above, the applicable range can be further expanded.
【００２８】本発明に基くマニプレータは、接触して相
対運動を行う全ての箇所に、コロ軸受、玉軸受、ボール
スプラインあるいはボールネジなどの予圧を与えたコロ
ガリ機械要素を使用することができるので、高剛性、高
速度及び高精度を確保することができる。The manipulator according to the present invention can use a pre-loaded roller element, such as a roller bearing, a ball bearing, a ball spline, or a ball screw, at all places where the relative motion is brought into contact with the manipulator. Rigidity, high speed and high accuracy can be ensured.
【００２９】また、対象作業の作業領域、負荷の掛かり
方、要求精度などに応じて、第一の自在継手を配置する
半径Ｒ１と、第二の自在継手を配置する半径Ｒ２との比
（Ｒ１／Ｒ２）をバランス良く設定することによって、
垂直方向及び水平方向の剛性と位置決め精度を合理的に
確保することができる。例えば、作業領域が垂直方向に
浅く、水平方向の負荷が大きい場合にはＲ１／Ｒ２を大
きく設ける方が合理的である。The ratio (R1) of the radius R1 at which the first universal joint is arranged to the radius R2 at which the second universal joint is arranged is determined according to the work area of the target work, how to apply the load, the required accuracy, and the like. / R2) by setting a good balance
The rigidity and positioning accuracy in the vertical and horizontal directions can be reasonably secured. For example, when the work area is shallow in the vertical direction and the load in the horizontal direction is large, it is reasonable to provide R1 / R2 large.
【００３０】[0030]
【発明の効果】本発明に基くマニプレータは、可動部材
（トラベリングプレート）をベースプレートと上部フレ
ームの間に配置して、これを３本のリンク及び捩り剛性
を有する１本のセンターリンクによって支持するととも
に、当該３本のリンクを用いて駆動する構造となってい
る。従って、構造が極めて単純であり、且つ制御軸の数
も最小限の３本のみである。このため、剛性、高速性、
位置精度に優れたパラレルメカニズムの特徴を備えると
ともに、制御演算時間も短い。According to the manipulator of the present invention, a movable member (traveling plate) is arranged between a base plate and an upper frame, and this is supported by three links and one center link having torsional rigidity. , And driven using the three links. Therefore, the structure is extremely simple, and the number of control axes is only a minimum of three. For this reason, rigidity, high speed,
In addition to the features of the parallel mechanism with excellent position accuracy, the control operation time is short.
【００３１】また、自在継手として２本の傾動軸が互い
に直交する様な構造のタイプを採用するとともに、各リ
ンク及びセンターリンクの軸心が、それぞれの自在継手
の二本の傾動軸の交点（揺動軸）を通る様にし、更に、
各自在継手の配置を幾何学的に最も単純な配置とするこ
とによって、全体の構造が幾何学的に単純化され、運動
解析が複雑にならず、制御演算時間を更に短縮すること
ができる。In addition, a universal joint having a structure in which two tilt axes are orthogonal to each other is employed, and the axis of each link and the center link is set at the intersection of the two tilt axes of the respective universal joint. Swing axis), and
By arranging the universal joints as the geometrically simplest arrangement, the overall structure is geometrically simplified, the motion analysis is not complicated, and the control calculation time can be further reduced.
【００３２】また、トラベリングプレートに二軸の回転
駆動機構を付加することによって、幅広い適用範囲を備
えた五自由度制御式のマニプレータを実現することがで
きる。Further, by adding a biaxial rotary drive mechanism to the traveling plate, a five-degree-of-freedom control type manipulator having a wide range of application can be realized.
【図面の簡単な説明】[Brief description of the drawings]
【図１】本発明の三軸制御式のマニプレータの一例を示
す模式図。FIG. 1 is a schematic view showing an example of a three-axis control type manipulator of the present invention.
【図２】本発明の五軸制御式のマニプレータの一例を示
す模式図。FIG. 2 is a schematic view showing an example of a five-axis control type manipulator of the present invention.
１・・・ベースプレート、 ２・・・トラベリングプレート、 ３・・・リンク、 ４・・・センターリンク、 ８・・・フレーム、 ９・・・上部フレーム９、 １０・・・ワーク、 ２１・・・第一の自在継手、 ２２・・・可動側コア部（ボールネジ、軸方向駆動機
構）、 ２３・・・ロッド部（ロッド）、 ３１・・・第二の自在継手、 ４１・・・第三の自在継手、 ４２・・・可動側コア部（ボールスプライン、軸受）、 ５２・・・第一の回転駆動機構、 ５３・・・第二の回転駆動機構、 ５４・・・掴み部。DESCRIPTION OF SYMBOLS 1 ... Base plate, 2 ... Traveling plate, 3 ... Link, 4 ... Center link, 8 ... Frame, 9 ... Upper frame 9, 10 ... Work, 21 ... First universal joint, 22: movable side core portion (ball screw, axial drive mechanism), 23: rod portion (rod), 31: second universal joint, 41: third Universal joint, 42: movable side core part (ball spline, bearing), 52: first rotary drive mechanism, 53: second rotary drive mechanism, 54: gripping part.
Claims (4)
方にこれと対向する様に配置された上部フレームを備え
たフレームと、 ベースプレートと上部フレームの間に配置された可動式
のトラベリングプレートと、 ベースプレートとトラベリングプレートを互いに連結す
る３本のリンクと、 上部フレームとトラベリングプレートを互いに連結する
センターリンクと、を備えたマニプレータであって、 前記ベースプレートは、その周縁部の３箇所に二軸回り
の傾動が可能な第一の自在継手、及び当該第一の自在継
手の可動側コア部に内蔵され、当該可動側コア部を貫通
するロッドを軸方向に駆動する軸方向駆動機構を備え、
前記各リンクの一端は、それぞれ当該ロッドに接続さ
れ、 前記トラベリングプレートは、その下面側の周縁部の３
箇所に二軸回りの傾動が可能な第二の自在継手を備え、
前記各リンクの他端は、これらの第二の自在継手を介し
て、それぞれ前記トラベリングプレートに接続され、 前記上部フレームは、二軸回りの傾動が可能で且つネジ
リ剛性を有する第三の自在継手、及び当該第三の自在継
手の可動側コア部に内蔵され、前記センターリンクの一
端を軸方向の摺動のみが可能な状態で支持する軸受を備
え、 前記センターリンクの他端は、前記トラベリングプレー
トの上面に垂直に固定され、 前記各ロッドのストロークを、それぞれ独立に制御する
ことによって、前記トラベリングプレートの前記ベース
プレートに対する三次元位置を制御することを特徴とす
るマニプレータ。1. A frame comprising a base plate and an upper frame disposed above and facing the base plate, a movable traveling plate disposed between the base plate and the upper frame, and a base plate and a traveling plate. A manipulator comprising: three links connected to each other; and a center link connecting the upper frame and the traveling plate to each other. One universal joint, and an axial drive mechanism that is built in the movable core portion of the first universal joint and axially drives a rod that passes through the movable core portion,
One end of each of the links is connected to the corresponding rod, and the traveling plate has a lower peripheral portion 3
Equipped with a second universal joint capable of tilting around two axes at the location,
The other ends of the links are respectively connected to the traveling plate via these second universal joints, and the upper frame is capable of tilting around two axes and has a torsionally rigid third universal joint. And a bearing that is built into the movable core portion of the third universal joint and supports one end of the center link in a state that allows only sliding in the axial direction. The other end of the center link includes the traveling A manipulator fixed vertically to a top surface of the plate and controlling a three-dimensional position of the traveling plate with respect to the base plate by independently controlling a stroke of each of the rods.
ート上の、第一の円周上の互いに等角度をなす位置に配
置され、 前記第二の自在継手は、前記トラベリングプレートの下
面側の、第二の円周上の互いに等角度をなす位置に配置
され、 前記第三の自在継手は、前記上部フレーム上の、前記第
一の円周の中心軸の延長線上に当る位置に配置され、 前記センターリンクの他端は、前記トラベリングプレー
トの上面側の、前記第二の円周の中心軸の延長線上に当
る位置に配置されている、 ことを特徴とする請求項１に記載のマニプレータ。2. The first universal joint is disposed at a position on the base plate at an equal angle on a first circumference, and the second universal joint is provided on a lower surface side of the traveling plate. The third universal joint is disposed on the upper frame at a position on an extension of the central axis of the first circumference. 2. The manipulator according to claim 1, wherein the other end of the center link is disposed at a position on an upper surface side of the traveling plate on an extension of a central axis of the second circumference. 3. .
手及び前記第三の自在継手は、それぞれ、互いに揺動中
心において直交する二つの傾動軸を持ち、 前記各リンクの軸心は、それぞれ、前記第一の自在継手
の揺動中心及び前記第二の自在継手の揺動中心を通り、 前記センターリンクの軸心は、前記第三の自在継手の揺
動中心を通る、 ことを特徴とする請求項２に記載のマニプレータ。3. The first universal joint, the second universal joint, and the third universal joint each have two tilt axes that are orthogonal to each other at the center of swing, and the axis of each link is Respectively passing through the swing center of the first universal joint and the swing center of the second universal joint, and the axis of the center link passes through the swing center of the third universal joint. The manipulator according to claim 2, characterized in that:
み部を備え、当該掴み部は、前記トラベリングプレート
の下面側に、前記センターリンクの軸回りに回動する第
一の回転駆動機構、及び前記センターリンクの軸心と直
交する軸回りに回動する第二の回転駆動機構を介して接
続されていること、を特徴とする請求項１から請求項３
のいずれかに記載のマニプレータ。4. A gripping portion for holding a tool or a work, wherein the gripping portion is provided on a lower surface side of the traveling plate, a first rotation drive mechanism that rotates around an axis of the center link, and 4. A connection is made via a second rotation drive mechanism that rotates about an axis perpendicular to the axis of the center link.
The manipulator according to any one of the above.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP18491096A JPH1029178A (en) | 1996-07-15 | 1996-07-15 | Manipulator |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP18491096A JPH1029178A (en) | 1996-07-15 | 1996-07-15 | Manipulator |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPH1029178A true JPH1029178A (en) | 1998-02-03 |
Family
ID=16161481
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP18491096A Pending JPH1029178A (en) | 1996-07-15 | 1996-07-15 | Manipulator |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPH1029178A (en) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002512893A (en) * | 1998-04-27 | 2002-05-08 | コンストラクションズ メカニックス デ ヴォージュ ソシエテ アノニム | Hexapod pod compensation system |
| JP2010196804A (en) * | 2009-02-25 | 2010-09-09 | Nsk Ltd | Universal joint |
| CN102990646A (en) * | 2012-12-12 | 2013-03-27 | 常州大学 | Three-dimensional motion device for analyzing positive solution of position and partially decoupling control |
| CN105538263A (en) * | 2016-02-19 | 2016-05-04 | 巢湖学院 | Precise horizontal adjustment device |
| EP3336381A4 (en) * | 2015-08-10 | 2019-04-17 | NTN Corporation | Work machine provided with parallel link mechanism |
-
1996
- 1996-07-15 JP JP18491096A patent/JPH1029178A/en active Pending
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002512893A (en) * | 1998-04-27 | 2002-05-08 | コンストラクションズ メカニックス デ ヴォージュ ソシエテ アノニム | Hexapod pod compensation system |
| JP4742377B2 (en) * | 1998-04-27 | 2011-08-10 | コンストラクションズ メカニックス デ ヴォージュ ソシエテ アノニム | Hexapod pod compensation system |
| JP2010196804A (en) * | 2009-02-25 | 2010-09-09 | Nsk Ltd | Universal joint |
| CN102990646A (en) * | 2012-12-12 | 2013-03-27 | 常州大学 | Three-dimensional motion device for analyzing positive solution of position and partially decoupling control |
| EP3336381A4 (en) * | 2015-08-10 | 2019-04-17 | NTN Corporation | Work machine provided with parallel link mechanism |
| US10556308B2 (en) | 2015-08-10 | 2020-02-11 | Ntn Corporation | Work machine provided with parallel link mechanism |
| CN105538263A (en) * | 2016-02-19 | 2016-05-04 | 巢湖学院 | Precise horizontal adjustment device |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US7337691B2 (en) | Parallel kinematics mechanism with a concentric spherical joint | |
| CA1181113A (en) | Multi-arm robot | |
| US4976582A (en) | Device for the movement and positioning of an element in space | |
| US8109173B2 (en) | Parallel robot provided with wrist section having three degrees of freedom | |
| JP3640087B2 (en) | Machine Tools | |
| US8099188B2 (en) | Parallel kinematic robot and method for controlling this robot | |
| US7011489B2 (en) | Industrial robot | |
| EP0182907A1 (en) | Robotic manipulator. | |
| JP2005516784A (en) | Industrial robot | |
| JPH10118966A (en) | Parallel robot | |
| JP2001293676A (en) | Parallel link robot | |
| JP4696384B2 (en) | Parallel link robot | |
| JPS63278674A (en) | Offset mechanism for rotating center | |
| CN111300380B (en) | Six-degree-of-freedom parallel robot based on redundant drive | |
| US20040013509A1 (en) | Parallel kinematics mechanism with a concentric spherical joint | |
| JPH0438553B2 (en) | ||
| JPH1029178A (en) | Manipulator | |
| JPH10109285A (en) | Manipulator | |
| JPH1094983A (en) | Actuator mechanism | |
| JPH11887A (en) | Parallel link manipulator | |
| JPH0947995A (en) | Parallel link manipulator | |
| KR100237552B1 (en) | Parallel mechanism structure for controlling of 3-dimensional position and orientation | |
| JPH09295295A (en) | Polar coordinate type robot | |
| JPH10286792A (en) | Positioning device having leg composed of parallel link and machine tool | |
| WO2024004290A1 (en) | Rotating structure |