JP2009291878A - Parallel mechanism and its calibration method - Google Patents
Parallel mechanism and its calibration method Download PDFInfo
- Publication number
- JP2009291878A JP2009291878A JP2008147360A JP2008147360A JP2009291878A JP 2009291878 A JP2009291878 A JP 2009291878A JP 2008147360 A JP2008147360 A JP 2008147360A JP 2008147360 A JP2008147360 A JP 2008147360A JP 2009291878 A JP2009291878 A JP 2009291878A
- Authority
- JP
- Japan
- Prior art keywords
- link
- head
- axis
- parallel
- pair
- 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
Links
Images
Landscapes
- Machine Tool Units (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
Description
本発明は、例えば被加工物（ワーク）を加工するための工具（加工ツール）を変位させる場合に駆動力伝達機構として用いるパラレルメカニズム及びそのキャリブレーション方法に関する。 The present invention relates to a parallel mechanism used as a driving force transmission mechanism and a calibration method thereof when, for example, a tool (machining tool) for machining a workpiece (workpiece) is displaced.
周知のように、工作機械には研削盤及び旋盤・フライス盤等があり、これら各種の工作機械はその加工内容に応じて選択的に用いられる。 As is well known, machine tools include a grinding machine, a lathe and a milling machine, and these various machine tools are selectively used according to the processing content.
このような工作機械においては、砥石，切削工具等の加工ツールを支持する主軸ヘッドや、ワークを支持するテーブル等を所望の位置に移動させたり、所望の角度で回動させたりすることにより、ワークと加工ツールとを相対的に変位させて研削や切削等の加工が行われる。 In such a machine tool, by moving a spindle head that supports a processing tool such as a grindstone or a cutting tool, a table that supports a workpiece, or the like to a desired position, or by rotating at a desired angle, Processing such as grinding and cutting is performed by relatively displacing the workpiece and the processing tool.
近年、この種の工作機械には、高剛性・高精度・高速性を実現する機構として有効であることから、ベースからリンクヘッドまでが並列に連結されたリンクを有するパラレルメカニズムを備えたものが注目されてきており、例えば図１１に示すような工作機械（一部）が知られている（例えば特許文献１）。 In recent years, this type of machine tool is effective as a mechanism that achieves high rigidity, high accuracy, and high speed, and therefore, a machine having a parallel mechanism having a link in which the base to the link head are connected in parallel. For example, a machine tool (partial) as shown in FIG. 11 is known (for example, Patent Document 1).
この工作機械につき、図１１を用いて説明すると、図１１において、符号１９で示す工作機械は、加工ツールＴを支持するリンクヘッド１９Ａ、及びこのリンクヘッド１９Ａを移動・回動させる１対のリンク１９０Ｂ，１９１Ｂを有するパラレルメカニズム１９Ｂとを備えている。
This machine tool will be described with reference to FIG. 11. In FIG. 11, a machine tool indicated by
リンクヘッド１９Ａは、その長手方向に沿って基準線Ｂを有する平面矩形状のツール支持台からなり、ベース（図示せず）上の第１ガイド１９Ｃにヘッドスライダ１９Ｄを介して回動かつ移動可能に支持されている。
The
一方のリンク１９０Ｂは、一端がリンクヘッド１９Ａに共通枢支部１９Ｅを介して回動可能に枢支され、他端が第１ガイド１９Ｃと平行なベース上の第２ガイド１９Ｆに一方のリンクスライダ１９Ｇを介して回動かつ移動可能に支持されている。
One
他方のリンク１９１Ｂは、一端がリンクヘッド１９Ａに共通枢支部１９Ｅを介して回動可能に枢支され、他端が第１ガイド１９Ｃ及び第２ガイド１９Ｆと平行なベース上の第３ガイド１９Ｈに他方のリンクスライダ１９Ｉを介して回動かつ移動可能に支持されている。
One end of the
以上の構成により、一方のリンク１９０Ｂを第２ガイド１９Ｆ（Ｘ軸方向）に沿って、また他方のリンク１９０Ｃを第３ガイド１９Ｈ（Ｘ軸方向）に沿ってそれぞれ移動させると、リンクヘッド１９Ａがリンクスライダ１９Ｇ上でＸ軸方向と直交する軸線の回り（Ｂ軸方向）に回動するとともに、第１ガイド１９Ｃに沿って移動する。
With the above configuration, when one
一方、ワーク支持台（図示せず）を第１ガイド１９Ｃ及び第２ガイド１９Ｆ・第３ガイド１９Ｈと直交する軸線方向（Ｚ軸方向）に移動させるとともに、この移動方向に沿う軸線の回りに回動させると、ワークがＺ軸方向に移動するとともに、この移動方向に沿う軸線の回りに回動する。
On the other hand, the work support base (not shown) is moved in the axial direction (Z-axis direction) orthogonal to the first guide 19C, the
これにより、ワークに対する加工ツールによる３軸方向（Ｘ軸方向及びＺ軸方向・Ｂ軸回り）の加工が行われる。 As a result, the workpiece is processed in the three-axis direction (X-axis direction, Z-axis direction, and B-axis direction) with the processing tool.
ところで、この種の工作機械においては、直交座標系で与えられる工具の先端位置情報等に対応する指令値をアクチュエータの出力値に変換（逆変換）し、アクチュエータを駆動制御することが行われる。
しかしながら、特許文献１に示す工作機械によると、各構成部品の製造誤差や組付誤差によって機構パラメータは必ずしもその設計値とは一致しない。また、その稼動状況や周囲環境の温度変化によって各構成部品の傾斜角度や長さ等の機構パラメータが変動する。このため、機構パラメータの誤差や変動に応じてアクチュエータが駆動制御されず、リンクヘッドの位置精度を高めることができないという問題があった。 However, according to the machine tool shown in Patent Document 1, the mechanism parameter does not necessarily match the design value due to the manufacturing error and assembly error of each component. In addition, the mechanism parameters such as the inclination angle and length of each component vary depending on the operating conditions and temperature changes in the surrounding environment. For this reason, there is a problem that the actuator is not driven and controlled in accordance with the error or fluctuation of the mechanism parameter, and the position accuracy of the link head cannot be increased.
従って、本発明の目的は、機構パラメータの誤差や変動に応じてアクチュエータを駆動制御することができ、もってリンクヘッドの位置精度を高めることができるパラレルメカニズム及びそのキャリブレーション方法を提供することにある。 Accordingly, it is an object of the present invention to provide a parallel mechanism and a calibration method thereof that can drive and control an actuator in accordance with an error or fluctuation of a mechanism parameter, and can improve the position accuracy of a link head. .
（１）本発明は、上記目的を達成するために、ワークを加工する加工ツール、及び前記ワークのうち一方を支持するリンクヘッドを第１軸線の回りに回動させるとともに、前記第１軸線と直交する平面内で移動させることにより、前記リンクヘッドの少なくとも２自由度の動作が制御可能なパラレルメカニズムであって、前記リンクヘッドを前記第１軸線と直交する第２軸線に沿って移動させるためのヘッド駆動機構と、一端が前記リンクヘッドにリンク回動部を介して前記第１軸線と直交する平面内で互いに回動可能に接続され、他端が前記第１軸線と平行な軸線の回りに回動可能にかつ前記第１軸線と直交する平面内で移動可能に支持された１対のリンクからなるリンク機構と、前記１対のリンクの他端を前記第１軸線と直交する平面内でそれぞれ移動させるための１対のリンク駆動機構と、前記リンクヘッドの前記第１軸線の回りの回動量を検出する検出器と、直交座標系で与えられる前記リンクヘッドの回動位置及び移動位置に対応する指令値を、パラレルメカニズム全体の構成を規定する機構パラメータに基づいて前記ヘッド駆動機構及び前記１対のリンク駆動機構に対する指令値に変換し、前記ヘッド駆動機構及び前記１対のリンク駆動機構を制御する制御部とを備え、前記制御部は、前記リンクヘッドを所定の回動量及び移動量で動作させたときの前記ヘッド駆動機構及び前記１対のリンク駆動機構に対する指令値とそのときの前記検出器の出力値とに基づいて前記機構パラメータを補正することを特徴とするパラレルメカニズムを提供する。 (1) In order to achieve the above object, the present invention rotates a work tool for machining a workpiece and a link head supporting one of the workpieces about a first axis, and the first axis and A parallel mechanism capable of controlling movement of at least two degrees of freedom of the link head by moving in an orthogonal plane for moving the link head along a second axis perpendicular to the first axis. And one end of the head driving mechanism is connected to the link head via a link rotating unit so as to be rotatable in a plane perpendicular to the first axis, and the other end is rotated around an axis parallel to the first axis. A link mechanism comprising a pair of links supported so as to be rotatable in a plane orthogonal to the first axis, and the other end of the pair of links in a plane orthogonal to the first axis A pair of link drive mechanisms for moving each, a detector for detecting a rotation amount of the link head around the first axis, and a rotation position and a movement position of the link head given by an orthogonal coordinate system A corresponding command value is converted into a command value for the head drive mechanism and the pair of link drive mechanisms based on a mechanism parameter that defines the configuration of the entire parallel mechanism, and the head drive mechanism and the pair of link drive mechanisms A control unit for controlling the head drive mechanism and the pair of link drive mechanisms when the link head is operated with a predetermined amount of rotation and movement, and a command value at that time. A parallel mechanism is provided, wherein the mechanism parameter is corrected based on an output value of the detector.
（２）本発明は、上記目的を達成するために、上記（１）に記載のパラレルメカニズムのキャリブレーション方法であって、ｋ（ｋ：自然数）個の前記機構パラメータに対して、前記リンクヘッドの少なくともｋ回の異なる位置及び姿勢への回動及び移動の少なくとも一方の動作を実行させてそのときのｋ個の前記検出器の出力値を取得し、前記ｋ回の前記リンクヘッドの回動及び移動の際の前記ヘッド駆動機構及び前記１対のリンク駆動機構に対する指令値と前記ｋ個の前記検出器の出力値とに基づいて前記ｋ個の機構パラメータの補正値を同定することを特徴とするパラレルメカニズムのキャリブレーション方法を提供する。 (2) In order to achieve the above object, the present invention provides the parallel mechanism calibration method according to (1), wherein the link head is used for k (k: natural number) mechanism parameters. At least k times of rotation and movement to different positions and orientations are executed to obtain output values of k detectors at that time, and k times of rotation of the link head And k mechanism parameter correction values are identified based on command values for the head drive mechanism and the pair of link drive mechanisms during movement and output values of the k detectors. A parallel mechanism calibration method is provided.
本発明によると、機構パラメータの誤差や変動に応じてアクチュエータを駆動制御することができ、リンクヘッドの位置精度を高めることができる。 According to the present invention, the actuator can be driven and controlled according to the error and fluctuation of the mechanism parameter, and the position accuracy of the link head can be improved.
[実施の形態]
図１は、本発明の実施の形態に係る工作機械の全体を説明するために示す平面図である。図２は、本発明の実施の形態に係る工作機械の要部を説明するために示す斜視図である。図３は、本発明の実施の形態に係る工作機械の要部を説明するために示す平面図である。図４は、本発明の実施の形態に係る工作機械の制御装置を説明するために示すブロック図である。なお、以下の説明においては、互いに直交する３つの方向をそれぞれＺ軸方向（図１における主軸方向）及びＸ軸方向（図１における紙面に平行しかつＺ軸に直交する方向）・Ｙ軸方向（Ｘ軸及びＺ軸に直交する方向）とする。
[Embodiment]
FIG. 1 is a plan view for explaining the entire machine tool according to the embodiment of the present invention. FIG. 2 is a perspective view for explaining a main part of the machine tool according to the embodiment of the present invention. FIG. 3 is a plan view for explaining the main part of the machine tool according to the embodiment of the present invention. FIG. 4 is a block diagram for explaining the machine tool control apparatus according to the embodiment of the present invention. In the following description, the three directions orthogonal to each other are the Z-axis direction (main axis direction in FIG. 1) and the X-axis direction (direction parallel to the paper surface in FIG. 1 and perpendicular to the Z-axis) and Y-axis direction, respectively. (A direction perpendicular to the X axis and the Z axis).
〔工作機械の全体構成〕
図１〜図４において、符号１で示す工作機械は、例えば円筒研削盤からなり、工作機械本体２及び制御装置３・付属装置（図示せず）から大略構成されている。
[Overall configuration of machine tool]
1 to 4, a machine tool indicated by reference numeral 1 is composed of, for example, a cylindrical grinding machine, and is generally configured by a machine tool
（工作機械本体２の構成）
工作機械本体２は、図１に示すように、ワークＷを回転駆動可能に支持するワーク支持駆動ユニット１００と、砥石等の加工ツール５０１が着脱可能に装着されるホイール回転主軸ユニット２００と、リンクヘッド３０１をツール取付側で支持するパラレルメカニズム３００とを備えている。
(Configuration of machine tool body 2)
As shown in FIG. 1, the machine tool
<ワーク支持駆動ユニット１００の構成>
ワーク支持駆動ユニット１００は、図１に示すように、主軸台ベース１０１及び左右２つの主軸台１０３，１０３を有し、ベッド（基台）１０上の前方端部（図１では下側）に載置されている。
<Configuration of Work Support Drive
As shown in FIG. 1, the work
主軸台ベース１０１の背面部（図１では上側）には、左右（Ｚ軸）方向に所定の間隔をもって互いに並列し、かつＺ軸方向に延在する２つの主軸台スライドガイド１０２，１０２が配設されている。
On the rear surface (upper side in FIG. 1) of the
主軸台１０３，１０３は、それぞれが対応する主軸台スライドガイド１０２，１０２上にＺ軸方向に沿って移動自在に配設されている。そして、それぞれが各主軸台スライドガイド１０２，１０２上における所定の位置に位置決めされ、その両中心部間でワークＷを挟持するように構成されている。主軸台１０３，１０３には、それぞれ主軸１０５，１０５を所定の回転数で回転駆動する主軸駆動モータ１０４，１０４が搭載されている。
The
<ホイール回転主軸ユニット２００の構成>
ホイール回転主軸ユニット２００は、図１に示すように、加工ツール５０１の被把持部を把持可能なホイール回転主軸２０１、及びこのホイール回転主軸２０１を回転駆動するホイール回転主軸駆動モータ（図示せず）を有し、リンクヘッド３０１に搭載されている。そして、ホイール回転主軸駆動モータの回転駆動力をホイール回転主軸２０１に伝達し、さらにホイール回転主軸２０１上の加工ツール５０１を所定の回転数で回転駆動するように構成されている。
<Configuration of wheel
As shown in FIG. 1, the wheel
<パラレルメカニズム３００の構成>
パラレルメカニズム３００は、図２及び図３に示すように、リンクヘッド３０１をＸ軸方向に沿って移動させるためのヘッド駆動機構３０２と、一端（ヘッド側端部）がＸ軸及びＺ軸と平行な水平面内でＹ軸と平行な軸線の回りに回動可能に互いに接続された１対のリンク３０３Ａ，３０３Ｂからなるリンク機構３０３と、このリンク機構３０３のリンク３０３Ａ，３０３Ｂの他端（レール側端部）をＸ軸方向に沿ってそれぞれ移動させるための１対のリンク駆動機構３０４，３０５とを備え、ベッド１０（図示せず）上に配置されている。
<Configuration of parallel mechanism 300>
2 and 3, the parallel mechanism 300 includes a head drive mechanism 302 for moving the
リンクヘッド３０１は、ヘッド回転ジョイント３０１０及び直動ジョイント３０１１を有し、ヘッド回転ジョイント３０１０がベッド１０上のスライダ案内用のレール３０６，３０６にスライダ３０１２を介して移動可能に配置され、かつ直動ジョイント３０１１がリンク機構３０３（リンク３０３Ａ，３０３Ｂ）のヘッド取付側端部（リンク自由端部）にリンク連結用回転ジョイント３０３０を介して回動可能に支持されている。そして、レール３０６，３０６上でスライダ３０１２を介してＸ軸（第２軸線）方向に移動し、かつヘッド回転ジョイント３０１０でＹ軸と平行な軸線（第１軸線：Ｂ軸）の回りに回動し得るように構成されている。
The
リンク連結用回転ジョイント３０３０は、Ｙ軸と平行な軸線の回りに回動する１自由度のジョイントして機能するように構成されている。
The link connecting
リンクヘッド３０１の上面部には、加工ツール５０１の回転軸線Ｔ（図３に示す）と平行な方向に延在し、かつ直動ジョイント３０１１をＹ軸と直交する一軸線方向に案内するジョイント案内用のレール３０１３（図２に示す）が配置されている。
A joint guide that extends in a direction parallel to the rotation axis T (shown in FIG. 3) of the
リンクヘッド３０１の下面部には、ヘッド回転ジョイント３０１０の回転量（回転角度）を検出するエンコーダ等の角度センサ３８０（図４に示す）が配設されている。
An angle sensor 380 (shown in FIG. 4) such as an encoder for detecting the rotation amount (rotation angle) of the head rotation joint 3010 is disposed on the lower surface of the
ヘッド回転ジョイント３０１０は、Ｙ軸と平行な軸線の回りに回転する１自由度のジョイントして機能し、リンクヘッド３０１の下面部に配設され、かつリンク連結用回転ジョイント３０３０の配設位置とは直動ジョイント３０１１の移動方向にオフセットされた位置で移動不能に配置されている。
The head rotation joint 3010 functions as a one-degree-of-freedom joint that rotates about an axis parallel to the Y axis, is disposed on the lower surface of the
直動ジョイント３０１１は、レール３０１３上に移動可能に配置されている。これにより、リンク連結用回転ジョイント３０３０が直動ジョイント３０１１と共にレール３０１３に沿って移動案内される。
The linear motion joint 3011 is movably disposed on the
ヘッド駆動機構３０２は、スライダ３０１２を移動させる送りねじ３０２０、及びこの送りねじ３０２０を駆動するサーボモータ３０２１からなり、制御装置３（インターフェース７３）にサーボモータユニット８０を介して接続されている。そして、スライダ３０１２を介してリンクヘッド３０１をＸ軸方向に沿って移動させ、リンク駆動機構３０４，３０５と共にリンクヘッド３０１の位置及び姿勢を変更し得るように構成されている。ヘッド駆動機構３０２には、サーボモータ３０２１の回転量を検出するモータ回転検出用エンコーダ３０２２が取り付けられている。
The head drive mechanism 302 includes a
リンク機構３０３は、リンクヘッド３０１の移動・回動平面と同一の仮想平面内で揺動可能な１対のリンク３０３Ａ，３０３Ｂを有し、ワーク支持駆動ユニット１００の後方に配置されている。そして、前述したようにツール取付部（リンク自由端部）側にリンクヘッド３０１の上方部を保持するように構成されている。
The link mechanism 303 has a pair of links 303 </ b> A and 303 </ b> B that can swing in the same virtual plane as the movement / rotation plane of the
一方のリンク３０３Ａは、一方側のリンク端部がベッド１０上におけるスライダ案内用のレール３０３０Ａを移動するスライダ３０３１Ａにリンク回転ジョイント３０３２Ａを介して回動可能に連結され、他方側のリンク端部がリンクヘッド３０１にリンク連結用回転ジョイント３０３０を介して回動可能に連結されている。
One link 303A is rotatably connected via a link rotary joint 3032A to a
レール３０３０Ａは、Ｘ軸方向に沿って延在するガイド部材によって形成され、一方のリンク３０３Ａにおける一方側のリンク端部を案内するように構成されている。なお、本実施の形態に示すレール３０３０Ａは、Ｘ軸（レール３０６，３０６）と平行である場合について説明したが、本発明はこれに限定されず、Ｙ軸と直交する平面内であれば、Ｘ軸に対して傾斜してもよい。リンク回転ジョイント３０３２Ａは、Ｙ軸と平行な軸線の回りに回転する１自由度のジョイントとして機能するように構成されている。
The rail 3030A is formed by a guide member extending along the X-axis direction, and is configured to guide a link end portion on one side of the one link 303A. Note that although the rail 3030A shown in this embodiment is described as being parallel to the X axis (
他方のリンク３０３Ｂは、一方側のリンク端部がベッド１０上におけるスライダ案内用のレール３０３０Ｂを移動するスライダ３０３１Ｂにリンク回転ジョイント３０３２Ｂを介して回動可能に連結され、他方側のリンク端部がリンクヘッド３０１にリンク連結用回転ジョイント３０３０を介して回動可能に連結されている。リンク３０３Ｂのリンク長は、リンク３０３Ａのリンク長と同一の寸法に設定されている。
The other link 303B is rotatably connected via a link rotary joint 3032B to a slider 3031B whose one link end moves on a
レール３０３０Ｂは、レール３０３０ＡとＺ軸方向に所定の間隔をもって並列し、かつＸ軸方向に沿って延在するガイド部材によって形成されている。そして、他方のリンク３０３Ｂにおける一方側のリンク端部を案内するように構成されている。なお、本実施の形態に示すレール３０３０Ｂは、Ｘ軸（レール３０６，３０６）と平行である場合について説明したが、本発明はこれに限定されず、Ｙ軸と直交する平面内であれば、Ｘ軸に対して傾斜してもよい。リンク回転ジョイント３０３２Ｂは、Ｙ軸と平行な軸線の回りに回転する１自由度のジョイントとして機能するように構成されている。
The
一方のリンク駆動機構３０４は、スライダ３０３１Ａを移動させる送りねじ３０４０、及びこの送りねじ３０４０を駆動するサーボモータ３０４１からなり、制御装置３（インターフェース７３）にサーボモータユニット８０を介して接続されている。そして、スライダ３０３１Ａを介してリンク３０３Ａの一方側のリンク端部をＸ軸方向に沿って移動させ、リンクヘッド３０１をＹ軸と平行な軸線の回りに回動させるように構成されている。リンク駆動機構３０４には、サーボモータ３０４１の回転量を検出するモータ回転検出用エンコーダ３０４２が取り付けられている。
One link driving mechanism 304 includes a
他方のリンク駆動機構３０５は、スライダ３０３１Ｂを移動させる送りねじ３０５０、及びこの送りねじ３０５０を駆動するサーボモータ３０５１からなり、制御装置３（インターフェース７３）にサーボモータユニット８０を介して接続されている。そして、スライダ３０３１Ｂを介してリンク３０３Ｂの一方側のリンク端部をＸ軸方向に沿って移動させ、リンクヘッド３０１をＹ軸と平行な軸線の回りに回動させるように構成されている。リンク駆動機構３０５には、サーボモータ３０５１の回転量を検出するモータ回転検出用エンコーダ３０５２が取り付けられている。
The other link drive mechanism 305 includes a
（制御装置３の構成）
制御装置３は、図４に示すように、ＣＰＵ（中央演算処理装置）７１及びメモリ７２・インターフェイス（Ｉ／Ｆ）７３〜７５を備え、直交座標系で与えられるリンクヘッド３０１の移動位置情報に対応する指令値Ｕを機構パラメータＰに基づいてヘッド駆動機構３０２及びリンク駆動機構３０４，３０５の出力値に変換し、これらヘッド駆動機構３０２及びリンク駆動機構３０４，３０５を駆動制御するように構成されている。
(Configuration of control device 3)
As shown in FIG. 4, the
<ＣＰＵ７１の構成>
ＣＰＵ７１は、メモリ７２あるいは外部記憶装置７８に記憶された加工プログラムを読み出し解析し、直交座標系で与えられるリンクヘッド３０１の移動位置・姿勢情報を機構パラメータＰに基づきヘッド駆動機構３０２及びリンク駆動機構３０４，３０５への駆動指令値に変換してサーボモータユニット８０へ出力する。
<Configuration of
The
<メモリ７２の構成>
メモリ７２には、加工ツール５０１による実加工処理を実行するための加工プログラムや機構パラメータＰ等の各種情報が記憶されている。
<Configuration of
The
<インターフェース７３〜７５の構成>
インターフェース７３には、ヘッド駆動機構３０２（サーボモータ３０２１）及びリンク駆動機構３０４，３０５（サーボモータ３０４１，３０５１）を駆動するサーボモータユニット８０（８１〜８３）が接続されている。サーボモータユニット８１〜８３は、ＣＰＵ７１からの指令値に基づいてヘッド駆動機構３０２及びリンク駆動機構３０４，３０５をそれぞれ駆動し、これらヘッド駆動機構３０２のモータ回転検出用エンコーダ３０２２及びリンク駆動機構３０４，３０５のモータ回転検出用エンコーダ３０４２，３０５２からの出力によってフィードバック制御を実行する。インターフェース７４には、加工データ等を入力するためのキーボード（ＫＢ）７６及び加工データや工作機械１の状態等を表示する画像表示装置（ＣＲＴ）７７・加工データを記憶する外部記憶装置７８が接続されている。インターフェース７５には角度センサ３８０が接続されている。
<Configuration of
A servo motor unit 80 (81-83) that drives the head drive mechanism 302 (servo motor 3021) and link drive mechanisms 304, 305 (
（付属装置の構成）
付属装置は、オイル供給装置・冷却装置・エア供給装置・クーラント供給装置と、これら装置を工作機械本体２に接続するダクト装置等とから構成されている。
(Attachment configuration)
The accessory device includes an oil supply device, a cooling device, an air supply device, a coolant supply device, and a duct device that connects these devices to the
〔工作機械１の動作〕
次に、本実施の形態に係る工作機械の動作につき、図５〜図８を用いて説明する。図５は、本発明の第１の実施の形態に係る工作機械におけるリンクヘッドのＸ軸平行動作を説明するために示す平面図である。図６は、本発明の第１の実施の形態に係る工作機械におけるリンクヘッドの回動動作を説明するために示す平面図である。図７は、本発明の第１の実施の形態に係る工作機械にヘッド駆動機構を備えた場合の利点について説明するために示す平面図である。図８は、本発明の第１の実施の形態に係る工作機械におけるリンクヘッドのＸ軸平行・回動動作を説明するために示す平面図である。なお、図５〜図８においては、直動ジョイント等が省略されている。
[Operation of machine tool 1]
Next, the operation of the machine tool according to the present embodiment will be described with reference to FIGS. FIG. 5 is a plan view for explaining the X-axis parallel operation of the link head in the machine tool according to the first embodiment of the present invention. FIG. 6 is a plan view for explaining the rotation operation of the link head in the machine tool according to the first embodiment of the present invention. FIG. 7 is a plan view for explaining an advantage when the machine tool according to the first embodiment of the present invention is provided with a head drive mechanism. FIG. 8 is a plan view for explaining the X-axis parallel / rotating operation of the link head in the machine tool according to the first embodiment of the present invention. 5 to 8, the linear motion joint and the like are omitted.
「Ｘ軸平行動作」
ヘッド回転ジョイント３０１０（スライダ３０１２）をレール３０１３に沿って、またリンク回転ジョイント３０３２Ａ，３０３２Ｂ（スライダ３０３１Ａ，３０３１Ｂ）をレール３０３０Ａ，３０３０Ｂに沿って同一の方向及び同一の移動量Ｘ１でそれぞれ移動させると、加工ツール５０１の回転軸線Ｔを基準線Ｏに合致させた状態でリンクヘッド３０１が図５に２点鎖線で示す初期位置からＸ軸方向に移動して図５に実線で示す位置に配置される。
"X-axis parallel motion"
Head rotary joint 3010 (sliders 3012) along the
「回動動作」
リンク回転ジョイント３０３２Ａ，３０３２Ｂ（スライダ３０３１Ａ，３０３１Ｂ）をレール３０３０Ａ，３０３０Ｂに沿って互いに異なる移動量Ｘ１，Ｘ２（Ｘ１＞Ｘ２）で同方向に移動させると、リンクヘッド３０１が図６に２点鎖線で示す初期位置からＹ軸と平行な軸線を中心に反時計方向に回動して例えば加工ツール５０１の回転軸線Ｔを基準線Ｏと交差させた状態で図６に実線で示す位置に配置される。
"Rotating motion"
When the
ここで、図７に示すように、ワーク加工時にリンクヘッド３０１が加工ツール５０１の回転軸線Ｔを基準線Ｏと直交させた状態で配置されると、ヘッド回転ジョイント３０１０（スライダ３０１２）をレール３０６に沿ってワーク側（図７では下方）に移動させることができ、すなわちＸ軸方向の作用力ｆ１，ｆ２に対するリンクヘッド３０１に反力Ｆを発生させることができる。このため、Ｘ軸方向の作用力ｆ１，ｆ２に対するリンクヘッド３０１に反力Ｆを発生させることができない、従来存在した特異点を無くすことができる。
Here, as shown in FIG. 7, when the
「Ｘ軸平行・回動動作」
リンク回転ジョイント３０３２Ａ，３０３２Ｂ（スライダ３０３１Ａ，３０３１Ｂ）をレール３０３０Ａ，３０３０Ｂに沿って互いに異なる移動量Ｘ１，Ｘ２（Ｘ１＞Ｘ２）で同方向に移動させた後、ヘッド回転ジョイント３０１０（スライダ３０１２）をレール３０１３に沿って、またリンク回転ジョイント３０３２Ａ，３０３２Ｂ（スライダ３０３１Ａ，３０３１Ｂ）をレール３０３０Ａ，３０３０Ｂに沿って同一の方向及び同一の移動量Ｘ３でそれぞれ移動させると、リンクヘッド３０１が図８に２点鎖線で示す初期位置からＹ軸と平行な軸線を中心に反時計方向に回動して例えば加工ツール５０１の回転軸線Ｔを基準線Ｏと交差させた状態で図８に１点鎖線で示す位置に配置され、さらにＸ軸方向に移動して図８に実線で示す位置に配置される。
"X-axis parallel rotation operation"
After the
このように、本実施の形態においては、リンクヘッド３０１をＸ軸に沿って移動させるとともに、Ｙ軸と平行な軸線の回りに回動させることによりリンクヘッド３０１の位置及び姿勢を制御し、さらに主軸台１０３，１０３をＺ軸方向に沿って移動させることによりワークＷの位置を制御し、主軸台１０３，１０３によって挟持されたワークＷに対する加工を行うことができる。
As described above, in this embodiment, the
この場合、スライダ３０１２，３０３１Ａ，３０３１Ｂを位置決めすると、リンクヘッド３０１上のリンク連結用回転ジョイント３０３０の位置が決定されるため、リンクヘッド３０１の移動・回動位置（加工ツール５０１の先端位置）が決定される。このため、リンクヘッド３０１を所望の移動・回動位置に位置決めするには、これら移動・回動位置から特定の演算式（逆変換式）に基づいてスライダ３０１２，３０３１Ａ，３０３１Ｂの位置を演算し、これら演算値に対応する位置にスライダ３０１２，３０３１Ａ，３０３１Ｂを移動させる。
In this case, when the sliders 3012, 3031 </ b> A, and 3031 </ b> B are positioned, the position of the link coupling rotary joint 3030 on the
〔工作機械１のキャリブレーション方法〕
次に、本実施の形態に係る工作機械１のキャリブレーション方法につき、図９及び図１０を用いて説明する。図９は、本発明の実施の形態に係る工作機械のキャリブレーション方法を説明するために示す平面図である。図１０は、本発明の実施の形態に係る工作機械（パラレルメカニズム）のキャリブレーション方法を説明するために示すフローチャートである。
[Calibration method for machine tool 1]
Next, a calibration method for the machine tool 1 according to the present embodiment will be described with reference to FIGS. FIG. 9 is a plan view for explaining the machine tool calibration method according to the embodiment of the present invention. FIG. 10 is a flowchart shown for explaining the calibration method of the machine tool (parallel mechanism) according to the embodiment of the present invention.
本実施の形態に示す工作機械１の制御装置３においては、直交座標系で与えられるリンクヘッド３０１の移動位置情報に対応する指令値（Ｘ，Ｂ）をアクチュエータ（ヘッド駆動機構３０２及びリンク駆動機構３０４，３０５）の出力値に機構パラメータＰ（スライド原点位置：ＳＬＯｘu1，ＳＬＯｚu1，ＳＬＯｘu2，ＳＬＯｚu2，ＳＬＯｘu3，ＳＬＯzu3、スライド角度：ＳＬＡu1，ＳＬＡu2，ＳＬＡu3、リンク長：ＲＬ１，ＲＬ２）に基づいて変換してアクチュエータ座標Ｕ（Ｕ１〜Ｕ３）を求め、ヘッド駆動機構３０２及びリンク駆動機構３０４，３０５を駆動制御する。この場合、次に示す手順を経て機構パラメータＰのキャリブレーションが一定周期毎あるいは任意のタイミングで実施される。
In the
本実施の形態におけるキャリブレーションは、ヘッド回転ジョイント３０１０の回動角の誤差ｄＢを角度センサ３８０で測定し、この誤差ｄＢを用いて機構パラメータＰの誤差を求めることにより実施される。 Calibration in the present embodiment is performed by measuring the error dB of the rotation angle of the head rotary joint 3010 with the angle sensor 380 and obtaining the error of the mechanism parameter P using this error dB.
先ず、ヘッド駆動機構３０２及びリンク駆動機構３０４，３０５を駆動し、リンクヘッド３０１を任意の位置に位置決めする（図１０のステップＳ１）。次に、このリンクヘッド３０１の位置決め状態において角度センサ３８０から出力値を測定し、ヘッド回転ジョイント３０１０の回転角の誤差ｄＢを求める（図１０のステップＳ２）。これをｋ回繰り返してｋ個の異なる位置にリンクヘッド３０１を位置決めし、ｋ個の誤差ｄＢを得る（図１０のステップＳ３）。この場合、ｋの回数としては、機構パラメータＰの数、すなわち本実施の形態においては１１個の機構パラメータがあるので、１１回が最低限必要な回数である。ここで、精度を高める上では、これ以上の回数を繰り返して多数の誤差ｄＢを得ることが好ましい。また、リンクヘッド３０１の位置・姿勢については、Ｘ軸方向・Ｂ軸回りの広い範囲にリンクヘッド３０１を位置決めして誤差ｄＢを得ることが精度を高める上では好ましい。
First, the head drive mechanism 302 and the link drive mechanisms 304 and 305 are driven to position the
このようにして、ｋ個の誤差ｄＢを得る（図１０のステップＳ３のＹＥＳ）と、これらｋ個の誤差ｄＢとそのときのアクチュエータ座標（スライダ３０３１Ａ，３０３１Ｂ，３０１２への位置指令値）Ｕとを用いて機構パラメータＰを同定する（図１０のステップＳ４）。以下、機構パラメータＰの同定の仕方を説明する。なお、図１０のステップＳ３において、誤差ｄＢの個数が（ｋ−１）個である（図１０のステップＳ３のＮＯ）場合にはステップＳ１に戻る。
In this way, k errors dB are obtained (YES in step S3 of FIG. 10). These k errors dB and the actuator coordinates (position command values to the
アクチュエータ座標（指令値）ＵをＵ＝（Ｕ1，Ｕ2，Ｕ3）とするとともに、そのときのスライダ３０３１Ａ，３０３１Ｂ，３０１２（図３に示す）の座標をそれぞれ（ｘ1，ｚ1）・（ｘ2，ｚ2）・（ｘ０，ｚ０）とすると、リンク長ＲＬ１，ＲＬ２は座標（ｘ1，ｚ1）・（ｘ2，ｚ2）・（ｘ0，ｚ0）を用いて次のように表すことができる。
The actuator coordinates (command value) U is set to U = (U 1 , U 2 , U 3 ), and the coordinates of the
（１）よりｚ0を求めると、次のようになる。 When z 0 is obtained from (1), it is as follows.
（３）を（２）に代入すると、次のようになる。 Substituting (3) into (2) results in the following.
これを次のように置き換える。 Replace this with:
これを整理すると、次に示すようになる。 This can be summarized as follows.
ここで、δ，σ，ηを用いて（４）を表わすと、次に示すようになる。 Here, when (4) is expressed using δ, σ, and η, the following is obtained.
（５）よりｘ0（小さい方の解）を求めると、次のようになる。 When x 0 (smaller solution) is obtained from (5), it is as follows.
一方、（１）−（２）を演算し、この演算式に（６）を代入すると、ｚ0が得られる。同様にして、ｘ1，ｚ1とｘ2，ｚ2についても求めることができる。これより、ヘッド回転ジョイント３０１０とリンク連結用回転ジョイント３０３０との間の距離ｄpaは次のようになる。 On the other hand, by calculating (1)-(2) and substituting (6) into this equation, z 0 is obtained. Similarly, x 1 and z 1 and x 2 and z 2 can be obtained. Accordingly, the distance d pa between the head rotary joint 3010 and the link connecting rotary joint 3030 is as follows.
また、ヘッド回転ジョイント３０１０の座標は次のようになる。 The coordinates of the head rotary joint 3010 are as follows.
上式Ｂpaは、機構パラメータＰ及び指令値Ｕの関数とすると、次のように表わせる。
上式を機構パラメータＰについて全微分すると、次のようになる。 When the above equation is fully differentiated with respect to the mechanism parameter P, the following is obtained.
ここで、ｋ個の位置Ｕ（Ｕ＝Ｕ1，Ｕ2，…，Ｕk）について誤差ｄＢ（ｄＢ＝ｄＢ1，ｄＢ2，…，ｄＢk）を考えると、次のようになる。 Here, the error dB (dB = dB 1 , dB 2 ,..., DB k ) is considered for k positions U (U = U 1 , U 2 ,..., U k ) as follows.
これを行列表記すると、次のようになる。 This is expressed in matrix form as follows.
従って、パラメータ誤差は、次のように表わせる。 Accordingly, the parameter error can be expressed as follows.
関数ｆは非線形であるため、求められた機構パラメータＰ1を新たなパラメータ値として上記計算を繰り返し、パラメータ誤差が許容値以下になるまで収束計算を行い、機構パラメータＰを補正する。 Since the function f is non-linear, the above calculation is repeated using the obtained mechanism parameter P 1 as a new parameter value, and convergence calculation is performed until the parameter error is less than or equal to an allowable value, thereby correcting the mechanism parameter P.
この後、補正後の機構パラメータを新たな機構パラメータＰとして置換し（図１０のステップＳ５）、作業が終了される。その後のリンクヘッド３０１の制御においては、ここで求められた補正後の機構パラメータＰを用い、リンクヘッド３０１の位置及び姿勢の指令値からアクチュエータ座標が演算される。
Thereafter, the corrected mechanism parameter is replaced with a new mechanism parameter P (step S5 in FIG. 10), and the operation is completed. In the subsequent control of the
このようにして、機構パラメータＰのキャリブレーションを実施することができる。これにより、定期的にキャリブレーション作業を行うことにより、経年変化による機構部品の磨耗により生じる機構パラメータＰの誤差にも対応可能となる。 In this way, the calibration of the mechanism parameter P can be performed. Thus, by performing the calibration work periodically, it is possible to cope with an error in the mechanism parameter P caused by wear of the mechanism parts due to aging.
[実施の形態の効果]
以上説明した実施の形態によれば、次に示す効果が得られる。
[Effect of the embodiment]
According to the embodiment described above, the following effects can be obtained.
（１）機構パラメータＰの変動に応じてアクチュエータ（ヘッド駆動機構３０２及びリンク駆動機構３０４，３０５）を駆動制御することができ、リンクヘッド３０１の位置精度を高めることができる。
(1) The actuators (head drive mechanism 302 and link drive mechanisms 304 and 305) can be driven and controlled according to the fluctuation of the mechanism parameter P, and the positional accuracy of the
（２）機構パラメータＰのキャリブレーションが一定周期毎あるいは任意のタイミングで実施されるため、機構パラメータＰの熱変位による変動の影響を小さくすることができる。 (2) Since the calibration of the mechanism parameter P is performed at regular intervals or at an arbitrary timing, the influence of the variation of the mechanism parameter P due to the thermal displacement can be reduced.
（３）リンク連結用回転ジョイント３０３０が直動ジョイント３０１１を介してリンクヘッド３０１上で移動可能であるため、各構成部品の加工精度や構成部品同士の組付精度が悪い場合や、またリンク３０３Ａ，３０３Ｂが使用時等の熱変化によって伸縮する場合等の機構パラメータＰに起因する各種誤差を吸収することができ、これら寸法誤差に起因する構成部品及びアクチュエータへの過負荷発生を防止することができる。
(3) Since the link connecting rotary joint 3030 can move on the
以上、本発明の工作機械（パラレルメカニズム）を上記の実施の形態に基づいて説明したが、本発明は上記の実施の形態に限定されるものではなく、その要旨を逸脱しない範囲で種々の態様において実施することが可能であり、例えば次に示すような変形も可能である。 As mentioned above, although the machine tool (parallel mechanism) of this invention was demonstrated based on said embodiment, this invention is not limited to said embodiment, Various aspects in the range which does not deviate from the summary. For example, the following modifications are possible.
（１）本実施の形態では、リンク連結用回転ジョイント３０３０がリンクヘッド３０１の上面部に直動ジョイント３０１１を介して配置されている場合について説明したが、本発明はこれに限定されず、リンクヘッドの上下両面にそれぞれ直動ジョイントを介してリンク連結用回転ジョイントを配置してもよい。
(1) In the present embodiment, the case where the link coupling rotary joint 3030 is arranged on the upper surface portion of the
（２）本実施の形態では、制御対象としての加工ツール５０１がリンクヘッド３０１に保持されるパラレルメカニズム３００である場合について説明したが、本発明はこれに限定されず、リンクヘッドにワークを保持するパラレルメカニズムであってもよい。
(2) In the present embodiment, the case where the
（３）本実施の形態では、リンクヘッド３０１をＢ軸（Ｙ軸と平行な軸線）回りに回動させるとともに、Ｘ軸方向に沿って移動させることにより、リンクヘッド３０１の２自由度の動作が制御可能なパラレルメカニズム３００である場合について説明したが、本発明はこれに限定されず、リンクヘッドをＢ軸回りに回動させるとともに、Ｘ軸方向及びＺ軸方向に沿って移動させることにより、リンクヘッド３０１の３自由度の動作が制御可能なパラレルメカニズムであってもよい。すなわち要するに、本発明は、リンクヘッドを第１軸線の回りに回動させるとともに、第１軸線と直交する平面内で移動させることにより、リンクヘッドの少なくとも２自由度の動作が制御可能なパラレルメカニズムであればよい。
(3) In the present embodiment, the
（４）本実施の形態では、砥石を加工ツール５０１とする工作機械１に適用する場合について説明したが、本発明はこれに限定されず、例えば旋削用電着ホイール等の旋削工具あるいはレーザ焼入れヘッド等の熱処理工具・表面仕上げ工具等を加工ツールとする他の工作機械に適用し得ることは勿論である。
(4) In the present embodiment, the case where the grindstone is applied to the machine tool 1 using the
１…工作機械
２…工作機械本体
３…制御装置
１０…ベッド
７１…ＣＰＵ
７２…メモリ
７３〜７５…インターフェース
７６…キーボード
７７…画像表示装置
７８…外部記憶装置
８０〜８３…サーボモータユニット
１００…ワーク支持駆動ユニット、１０１…主軸台ベース、１０２…主軸台スライドガイド、１０３…主軸台、１０４…主軸駆動モータ、１０５…主軸
３００，８１，９１，１１１，１２１，１６１，１７１…パラレルメカニズム
３０１…リンクヘッド、３０１０…ヘッド回転ジョイント、３０１１…直動ジョイント、３０１２…スライダ、３０１３…ジョイント案内用のレール、３０１４…連結部
３０２…ヘッド駆動機構、３０２０…送りねじ、３０２１…サーボモータ、３０２２…モータ回転検出用エンコーダ
３０３…リンク機構、３０３０…リンク連結用回転ジョイント
３０３Ａ…リンク、３０３０Ａ…スライダ案内用のレール、３０３１Ａ…スライダ、３０３２Ａ…リンク回転用ジョイント、３０３３Ａ…リンク分岐部
３０３Ｂ…リンク、３０３０Ｂ…スライダ案内用のレール、３０３１Ｂ…スライダ、３０３３Ｂ…リンク分岐部
３０４…リンク駆動機構、３０４０…送りねじ、３０４１…サーボモータ、３０４２…モータ回転検出用エンコーダ
３０５…リンク駆動機構、３０５０…送りねじ、３０５１…サーボモータ、３０５２…モータ回転検出用エンコーダ
３０２…ヘッド駆動機構
３８０…角度センサ
４００…テーブル
５００…スライダ
５０１…加工ツール
１０００…パラレルメカニズム支持体、１００１…天井部、１００２…側壁部、１００３…底面部
Ｏ…基準線
Ｔ…回転軸線
Ｗ…ワーク
１９…工作機械、１９Ａ…リンクヘッド、１９Ｂ…パラレルメカニズム、１９０Ｂ，１９１Ｂ…リンク、１９Ｃ…第１ガイド、１９Ｄ…ヘッドスライダ、１９Ｅ…共通枢支部、１９Ｆ…第２ガイド、１９Ｇ…リンクスライダ、１９Ｈ…第３ガイド、１９Ｉ…リンクスライダ
DESCRIPTION OF SYMBOLS 1 ...
72 ... Memory 73-75 ...
Claims (4)
前記リンクヘッドを前記第１軸線と直交する第２軸線に沿って移動させるためのヘッド駆動機構と、
一端が前記リンクヘッドにリンク回動部を介して前記第１軸線と直交する平面内で互いに回動可能に接続され、他端が前記第１軸線と平行な軸線の回りに回動可能にかつ前記第１軸線と直交する平面内で移動可能に支持された１対のリンクからなるリンク機構と、
前記１対のリンクの他端を前記第１軸線と直交する平面内でそれぞれ移動させるための１対のリンク駆動機構と、
前記リンクヘッドの前記第１軸線の回りの回動量を検出する検出器と、
直交座標系で与えられる前記リンクヘッドの回動位置及び移動位置に対応する指令値を、パラレルメカニズム全体の構成を規定する機構パラメータに基づいて前記ヘッド駆動機構及び前記１対のリンク駆動機構に対する指令値に変換し、前記ヘッド駆動機構及び前記１対のリンク駆動機構を制御する制御部とを備え、
前記制御部は、前記リンクヘッドを所定の回動量及び移動量で動作させたときの前記ヘッド駆動機構及び前記１対のリンク駆動機構に対する指令値とそのときの前記検出器の出力値とに基づいて前記機構パラメータを補正する
ことを特徴とするパラレルメカニズム。 By rotating a processing tool for processing a workpiece and a link head supporting one of the workpieces around a first axis and moving in a plane perpendicular to the first axis, at least the link head A parallel mechanism that can control the movement of two degrees of freedom,
A head drive mechanism for moving the link head along a second axis perpendicular to the first axis;
One end is connected to the link head via a link rotation unit so as to be rotatable in a plane perpendicular to the first axis, and the other end is rotatable about an axis parallel to the first axis. A link mechanism comprising a pair of links supported movably in a plane perpendicular to the first axis;
A pair of link driving mechanisms for moving the other ends of the pair of links in a plane perpendicular to the first axis;
A detector for detecting a rotation amount of the link head around the first axis;
Command values corresponding to the rotation position and movement position of the link head given in the Cartesian coordinate system are sent to the head drive mechanism and the pair of link drive mechanisms based on mechanism parameters that define the configuration of the entire parallel mechanism. A control unit for converting into a value and controlling the head drive mechanism and the pair of link drive mechanisms;
The control unit is based on a command value for the head drive mechanism and the pair of link drive mechanisms when the link head is operated with a predetermined rotation amount and movement amount, and an output value of the detector at that time. And correcting the mechanism parameter.
ｋ（ｋ：自然数）個の前記機構パラメータに対して、前記リンクヘッドの少なくともｋ回の異なる位置及び姿勢への回動及び移動の少なくとも一方の動作を実行させてそのときのｋ個の前記検出器の出力値を取得し、
前記ｋ回の前記リンクヘッドの回動及び移動の際の前記ヘッド駆動機構及び前記１対のリンク駆動機構に対する指令値と前記ｋ個の前記検出器の出力値とに基づいて前記ｋ個の機構パラメータの補正値を同定する
ことを特徴とするパラレルメカニズムのキャリブレーション方法。 A parallel mechanism calibration method according to claim 1 or 2,
With respect to k (k: natural number) mechanism parameters, at least one of rotation and movement of the link head to at least k different positions and postures is executed, and k detections at that time are performed. The output value of the instrument
The k mechanisms based on command values for the head driving mechanism and the pair of link driving mechanisms and the output values of the k detectors when the k link heads rotate and move. A parallel mechanism calibration method characterized by identifying a correction value of a parameter.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2008147360A JP5071250B2 (en) | 2008-06-04 | 2008-06-04 | Parallel mechanism and calibration method thereof |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2008147360A JP5071250B2 (en) | 2008-06-04 | 2008-06-04 | Parallel mechanism and calibration method thereof |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2009291878A true JP2009291878A (en) | 2009-12-17 |
| JP5071250B2 JP5071250B2 (en) | 2012-11-14 |
Family
ID=41540541
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2008147360A Expired - Fee Related JP5071250B2 (en) | 2008-06-04 | 2008-06-04 | Parallel mechanism and calibration method thereof |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5071250B2 (en) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101844350A (en) * | 2010-06-07 | 2010-09-29 | 浙江理工大学 | Three degree of freedom parallel robot mechanism |
| CN102152307A (en) * | 2011-01-24 | 2011-08-17 | 西安交通大学 | Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot |
| CN104999458A (en) * | 2015-06-29 | 2015-10-28 | 张荣华 | Robot |
| JP2019188575A (en) * | 2018-04-27 | 2019-10-31 | ファナック株式会社 | Parallel link robot |
| CN113580148A (en) * | 2021-09-13 | 2021-11-02 | 浙江理工大学 | Parallel robot kinematics calibration method based on equivalent kinematic chain |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2003291041A (en) * | 2002-03-29 | 2003-10-14 | Toyoda Mach Works Ltd | Displacing body structure for machine tool |
| JP2006281390A (en) * | 2005-04-01 | 2006-10-19 | Jtekt Corp | Combined machine tool, and method for machining workpiece using the same |
| JP2007144542A (en) * | 2005-11-25 | 2007-06-14 | Jtekt Corp | Parallel mechanism and its calibration method |
| JP2009291877A (en) * | 2008-06-04 | 2009-12-17 | Jtekt Corp | Parallel mechanism and machine tool having the same |
-
2008
- 2008-06-04 JP JP2008147360A patent/JP5071250B2/en not_active Expired - Fee Related
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2003291041A (en) * | 2002-03-29 | 2003-10-14 | Toyoda Mach Works Ltd | Displacing body structure for machine tool |
| JP2006281390A (en) * | 2005-04-01 | 2006-10-19 | Jtekt Corp | Combined machine tool, and method for machining workpiece using the same |
| JP2007144542A (en) * | 2005-11-25 | 2007-06-14 | Jtekt Corp | Parallel mechanism and its calibration method |
| JP2009291877A (en) * | 2008-06-04 | 2009-12-17 | Jtekt Corp | Parallel mechanism and machine tool having the same |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101844350A (en) * | 2010-06-07 | 2010-09-29 | 浙江理工大学 | Three degree of freedom parallel robot mechanism |
| CN102152307A (en) * | 2011-01-24 | 2011-08-17 | 西安交通大学 | Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot |
| CN102152307B (en) * | 2011-01-24 | 2012-09-05 | 西安交通大学 | Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot |
| CN104999458A (en) * | 2015-06-29 | 2015-10-28 | 张荣华 | Robot |
| JP2019188575A (en) * | 2018-04-27 | 2019-10-31 | ファナック株式会社 | Parallel link robot |
| US11420343B2 (en) | 2018-04-27 | 2022-08-23 | Fanuc Corporation | Parallel link robot |
| CN113580148A (en) * | 2021-09-13 | 2021-11-02 | 浙江理工大学 | Parallel robot kinematics calibration method based on equivalent kinematic chain |
| CN113580148B (en) * | 2021-09-13 | 2022-12-09 | 浙江理工大学 | Parallel robot kinematics calibration method based on equivalent kinematic chain |
Also Published As
| Publication number | Publication date |
|---|---|
| JP5071250B2 (en) | 2012-11-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5399624B2 (en) | Numerical control method and numerical control device | |
| US7938602B2 (en) | Three degree of freedom parallel mechanism, multi-axis control machine tool using the mechanism and control method for the mechanism | |
| US7905765B2 (en) | Parallel mechanism, calibration method for use in the same, and machine tool including the same | |
| JP5030653B2 (en) | Numerical control machine tool and numerical control device | |
| US20150160049A1 (en) | Geometric error identification method of multi-axis machine tool and multi-axis machine tool | |
| JP5418272B2 (en) | Thermal displacement correction method and thermal displacement correction apparatus for machine tool | |
| JP5673855B2 (en) | Machine Tools | |
| JP5071250B2 (en) | Parallel mechanism and calibration method thereof | |
| JP5355037B2 (en) | Accuracy measuring method, error control method for numerically controlled machine tool, and numerically controlled machine tool having error correcting function | |
| JP5317627B2 (en) | Error correction method | |
| JP4882352B2 (en) | Parallel mechanism and machine tool equipped with the same | |
| JP4962757B2 (en) | Control method of space 3 degrees of freedom parallel mechanism and space 3 degrees of freedom parallel mechanism | |
| JP2009291877A (en) | Parallel mechanism and machine tool having the same | |
| JP4626499B2 (en) | Parallel mechanism and calibration method thereof | |
| JP6803043B2 (en) | How to measure geometric error of machine tools | |
| JP4984114B2 (en) | Spatial 3-DOF parallel mechanism and multi-axis control machine tool using the spatial 3-DOF parallel mechanism | |
| JP2009012123A (en) | Parallel mechanism and machine tool provided with the same mechanism | |
| US6539274B1 (en) | Method for compensating for temperature-related dimensional deviations in machine geometry | |
| JP2009000800A (en) | Parallel mechanism and machine tool including the same mechanism | |
| JP2009023056A (en) | Machine tool with parallel mechanism | |
| JP2012033203A (en) | Numerical control machine tool | |
| JP2003121134A (en) | Measuring method for geometric accuracy of motion | |
| JP7469466B2 (en) | Machine tool control device, control system | |
| JP2016038674A (en) | Correction value computing method and correction value computing program for machine tool | |
| JP2010029960A (en) | Hybrid mechanism and machine tool with the same |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110221 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20111025 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20120712 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20120724 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120806 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150831 Year of fee payment: 3 |
|
| LAPS | Cancellation because of no payment of annual fees |