JP6912205B2 - 12-axis spherical coordinate control device - Google Patents

12-axis spherical coordinate control device Download PDF

Info

Publication number
JP6912205B2
JP6912205B2 JP2017005465A JP2017005465A JP6912205B2 JP 6912205 B2 JP6912205 B2 JP 6912205B2 JP 2017005465 A JP2017005465 A JP 2017005465A JP 2017005465 A JP2017005465 A JP 2017005465A JP 6912205 B2 JP6912205 B2 JP 6912205B2
Authority
JP
Japan
Prior art keywords
arc
base
arcuate
base frame
frame
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.)
Active
Application number
JP2017005465A
Other languages
Japanese (ja)
Other versions
JP2017125612A (en
Inventor
崔文▲徳▼
林淑青
Original Assignee
崔文▲徳▼
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
Priority claimed from TW105101295A external-priority patent/TWI623345B/en
Priority claimed from TW105143085A external-priority patent/TWI652430B/en
Application filed by 崔文▲徳▼ filed Critical 崔文▲徳▼
Publication of JP2017125612A publication Critical patent/JP2017125612A/en
Application granted granted Critical
Publication of JP6912205B2 publication Critical patent/JP6912205B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/08Programme-controlled manipulators characterised by modular constructions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/02Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • B25J9/046Revolute coordinate type

Description

本発明は、12軸幾何構造に築いて、球面座標に基づいて操縦される機構である。多軸マルチタスク加工機械または多次元測定装置(CMM)に応用でき、かつロボットの肩関節または股関節部にも応用できる。
The present invention is a mechanism built in a 12-axis geometric structure and steered based on spherical coordinates. It can be applied to multi-axis multitasking machines or coordinate measuring devices (CMMs), and can also be applied to the shoulder joints or hip joints of robots.

本出願は出願人の二つの先行関連出願がある。それぞれはすでに米国で登録した特許US8579714B2(公開番号US20120083347A1、以下は引用文献1と称する)と、すでに査定通知を取得した特許出願(公開番号US20150082934A1、以下は引用文献2と称する)である。
This application has two prior related applications of the applicant. Each is a patent US8579714B2 already registered in the United States (publication number US20120083347A1, hereinafter referred to as cited document 1) and a patent application for which an assessment notice has already been obtained (publication number US20150082934A1, hereinafter referred to as cited document 2).

本出願は前記二つの特許出願の12軸幾何構造に従い、12軸トルクを四組の円弧状梃組を通じて並列かつ直列して纏めて出力する。そして、12軸機構の相互干渉やシンギュラリティ現象(singularity phenomenon)を避けることを課題とする。そのため、本案では引用文献1に開示した各シンギュラリティ現象およびその対策である幾何規制を参考している。また、本案では、引用文献2の二つタイプの基本リングレール構成を取り入れながら、引用文献1、2の内容を纏めて、本案において四つのタイプのリングレール構造とする。引用文献2における「少なくとも一組」の終端円弧状梃組を、本案においては「最大で二組」のクランク組に変える。本案の新規特徴について、引用文献1、2で定義した二組の幾何四面体構造のどちらかを、各自独立した二つの幾何円弧からなる、二つの端枠構造にばらす。もう一組の四面体構造に関して、本案ではその幾何定義をそのまま保留する。本来の単一の幾何四面体と比べて、各自独立した二つの幾何円弧の場合は、互いの干渉や影響が減って、機構の動作空間も広くなる。端枠構造にさらに端枠サポータを設置すれば、機構負荷量を上げることができる。そのため、この新規特徴は大幅に12軸球面座標作動機構の応用可能性を高めている。
In accordance with the 12-axis geometric structure of the two patent applications, this application outputs 12-axis torque in parallel and in series through four sets of arcuate levers. Then, it is an object to avoid mutual interference of the 12-axis mechanism and the singularity phenomenon. Therefore, this proposal refers to each singularity phenomenon disclosed in Cited Document 1 and the geometric regulation as a countermeasure. Further, in this proposal, while incorporating the two types of basic ring rail configurations of Cited Document 2, the contents of Cited Documents 1 and 2 are summarized into four types of ring rail structures in this draft. In this proposal, the "at least one set" of the terminal arcuate lever set in Reference 2 is changed to the "up to two sets" of the crank set. Regarding the new feature of this proposal, either of the two sets of geometric tetrahedral structures defined in References 1 and 2 is divided into two end frame structures each consisting of two independent geometric arcs. Regarding the other set of tetrahedral structures, the geometric definition is reserved as it is in this proposal. Compared to the original single geometric tetrahedron, in the case of two independent geometric arcs, the interference and influence of each other are reduced, and the operating space of the mechanism is also widened. If an end frame supporter is further installed in the end frame structure, the mechanical load can be increased. Therefore, this new feature greatly enhances the applicability of the 12-axis spherical coordinate operating mechanism.

本発明は、12軸幾何構造に築いて、球面座標に基づいて操縦される機構である。多軸マルチタスク加工機械または多次元測定装置(CMM)に応用でき、かつロボットの肩関節または股関節部にも応用できる。 The present invention is a mechanism built in a 12-axis geometric structure and steered based on spherical coordinates. It can be applied to multi-axis multitasking machines or coordinate measuring devices (CMMs), and can also be applied to the shoulder joints or hip joints of robots.

本発明は12軸機構を提供している。12軸機構は、一組のベース枠組と、二組の端枠組と、四組の円弧状梃組と、二組以内のクランク組とを含む。ベース枠組は、複数の円弧状枠からなるベース枠構造と、前記ベース枠構造に配置した四つのベース枠回転モジュールとを含む。いずれの端枠組には、端枠構造および前記端枠構造に配置される二つの端枠回転モジュールを含む。いずれの円弧状梃組は、ベース接続円弧状梃と、端接続円弧状梃および円弧状梃回転モジュールとを含む。いずれのクランク組は、円弧状クランクおよびクランク回転モジュールとを含む。机溝は合計12軸があって、それぞれ四つのベース枠回転モジュール0aと、四つの円弧状梃回転モジュール2aおよび四つの端枠回転モジュール4aとを通じて12軸のトルクを並列かつ直列してからまとめて出力する。 The present invention provides a 12-axis mechanism. The 12-axis mechanism includes one set of base frames, two sets of end frames, four sets of arc levers, and up to two sets of crank sets. The base frame includes a base frame structure composed of a plurality of arcuate frames and four base frame rotation modules arranged in the base frame structure. Each end frame includes an end frame structure and two end frame rotation modules arranged in the end frame structure. Each arc-shaped lever includes a base-connected arc-shaped lever and an end-connected arc-shaped lever and an arc-shaped lever rotating module. Both crank sets include an arcuate crank and a crank rotation module. There are a total of 12 axes in the desk groove, and the torque of 12 axes is put together in parallel and in series through the four base frame rotation modules 0a, the four arc-shaped lever rotation modules 2a, and the four end frame rotation modules 4a, respectively. And output.

上記最大で二組のクランク組を設置でき、すなわち、二組、一組、または設置しないことである。内容を明確するために、本発明ではクランク組を設置しない実施例を、独立請求項6とする。この独立項において一組のベース枠組と、二組の端枠組および四組の円弧状梃組とを含み、その定義および組立方法は前記内容と同じである。 A maximum of two cranksets can be installed, that is, two, one, or no. In order to clarify the contents, an embodiment in which the crank set is not installed in the present invention is referred to as independent claim 6. This independent term includes one set of base frames, two sets of end frames and four sets of arcuate levers, the definition and assembly method of which is the same as described above.

本発明の上記目的、特徴および長所をわかりやすくするために、後述内容は各部品の幾何定義および設計構成、パラメータ設定を実施例および図面にあわせて詳しく説明する。ここで注意すべきなことは、図面での各部材はただ見取図であり、各部材の実際比例に沿って描いたものではない。
In order to make the above object, features, and advantages of the present invention easy to understand, the contents described later will explain in detail the geometric definition, design configuration, and parameter setting of each part together with examples and drawings. It should be noted here that each member in the drawing is just a sketch, not drawn in actual proportion of each member.

ベース枠構造の設計形態1の幾何定義図および立体図である。It is a geometric definition diagram and a three-dimensional diagram of the design form 1 of the base frame structure. ベース枠構造の設計形態2の幾何定義図および立体図である。It is a geometric definition diagram and a three-dimensional diagram of the design form 2 of the base frame structure. ベース枠構造の設計形態3の幾何定義図および立体図である。It is a geometric definition diagram and a three-dimensional diagram of the design form 3 of the base frame structure. ベース枠構造の設計形態4の幾何定義図および立体図である。It is a geometric definition drawing and a three-dimensional drawing of the design form 4 of a base frame structure. 円弧状梃組のリングレールの設定1の幾何定義図および立体図である。It is a geometric definition diagram and a three-dimensional diagram of setting 1 of a ring rail of an arcuate lever. 円弧状梃組のリングレールの設定2の幾何定義図および立体図である。It is a geometric definition diagram and a three-dimensional diagram of setting 2 of a ring rail of an arcuate lever. 円弧状梃組のリングレールの設定3の幾何定義図および立体図である。It is a geometric definition diagram and a three-dimensional diagram of setting 3 of a ring rail of an arcuate lever. 円弧状梃組のリングレールの設定4の幾何定義図および立体図である。It is a geometric definition diagram and a three-dimensional diagram of setting 4 of a ring rail of an arcuate lever. クランク組の枢接形態1の幾何定義図および立体図である。It is a geometric definition diagram and a three-dimensional diagram of the pivotal contact form 1 of a crank set. クランク組の枢接形態2の幾何定義図および立体図である。It is a geometric definition diagram and a three-dimensional diagram of the pivotal contact form 2 of a crank set. 第一実施例の三面図である。円弧状梃組のリングレールの設定1に一つのクランク組が設置される。It is a three-sided view of the first embodiment. One crank set is installed in setting 1 of the ring rail of the arc-shaped lever set. 第一実施例の三面図である。円弧状梃組のリングレールの設定1に一つのクランク組が設置される。It is a three-sided view of the first embodiment. One crank set is installed in setting 1 of the ring rail of the arc-shaped lever set. 第一実施例の三面図である。円弧状梃組のリングレールの設定1に一つのクランク組が設置される。It is a three-sided view of the first embodiment. One crank set is installed in setting 1 of the ring rail of the arc-shaped lever set. 第二実施例の三面図である。円弧状梃組のリングレールの設定2に一つのクランク組が設置される。It is a three-sided view of the second embodiment. One crank set is installed in setting 2 of the ring rail of the arc-shaped lever set. 第二実施例の三面図である。円弧状梃組のリングレールの設定2に一つのクランク組が設置される。It is a three-sided view of the second embodiment. One crank set is installed in setting 2 of the ring rail of the arc-shaped lever set. 第二実施例の三面図である。円弧状梃組のリングレールの設定2に一つのクランク組が設置される。It is a three-sided view of the second embodiment. One crank set is installed in setting 2 of the ring rail of the arc-shaped lever set. 第三実施例の三面図である。円弧状梃組のリングレールの設定3に二つのクランク組が設置される。It is a three-sided view of the third embodiment. Two crank sets are installed in setting 3 of the ring rail of the arc-shaped lever set. 第三実施例の三面図である。円弧状梃組のリングレールの設定3に二つのクランク組が設置される。It is a three-sided view of the third embodiment. Two crank sets are installed in setting 3 of the ring rail of the arc-shaped lever set. 第三実施例の三面図である。円弧状梃組のリングレールの設定3に二つのクランク組が設置される。It is a three-sided view of the third embodiment. Two crank sets are installed in setting 3 of the ring rail of the arc-shaped lever set. 第四実施例の三面図である。円弧状梃組のリングレールの設定4に二つのクランク組が設置される。It is a three-sided view of the fourth embodiment. Two crank sets are installed in setting 4 of the ring rail of the arc-shaped lever set. 第四実施例の三面図である。円弧状梃組のリングレールの設定4に二つのクランク組が設置される。It is a three-sided view of the fourth embodiment. Two crank sets are installed in setting 4 of the ring rail of the arc-shaped lever set. 第四実施例の三面図である。円弧状梃組のリングレールの設定4に二つのクランク組が設置される。It is a three-sided view of the fourth embodiment. Two crank sets are installed in setting 4 of the ring rail of the arc-shaped lever set. 第五実施例の三面図である。円弧状梃組のリングレールの設定3にクランク組が設置されていない。It is a three-sided view of the fifth embodiment. The crank assembly is not installed in setting 3 of the ring rail of the arc-shaped lever assembly. 第五実施例の三面図である。円弧状梃組のリングレールの設定3にクランク組が設置されていない。It is a three-sided view of the fifth embodiment. The crank assembly is not installed in setting 3 of the ring rail of the arc-shaped lever assembly. 第五実施例の三面図である。円弧状梃組のリングレールの設定3にクランク組が設置されていない。It is a three-sided view of the fifth embodiment. The crank assembly is not installed in setting 3 of the ring rail of the arc-shaped lever assembly. 第六実施例の三面図である。円弧状梃組のリングレールの設定4にクランク組が設置されていない。It is a three-sided view of the sixth embodiment. The crank assembly is not installed in setting 4 of the ring rail of the arc-shaped lever assembly. 第六実施例の三面図である。円弧状梃組のリングレールの設定4にクランク組が設置されていない。It is a three-sided view of the sixth embodiment. The crank assembly is not installed in setting 4 of the ring rail of the arc-shaped lever assembly. 第六実施例の三面図である。円弧状梃組のリングレールの設定4にクランク組が設置されていない。It is a three-sided view of the sixth embodiment. The crank assembly is not installed in setting 4 of the ring rail of the arc-shaped lever assembly.

本案の機構は、12軸幾何機構からなり、球面座標に基づいて作動操縦できるものである。その中に、一組のベース枠組と、二組の端枠組と、四組の円弧状梃組および二組以内のクランク組を含む。 The mechanism of the present invention consists of a 12-axis geometric mechanism and can be operated and steered based on spherical coordinates. It includes one set of base frames, two sets of end frames, four sets of arc levers and up to two sets of crank sets.

ベース枠組は複数の円弧状梃組からなるベース枠構造0cおよびベース枠構造0cが配置された四つのベース枠回転モジュール0aを含む。ベース枠組構造0cにある四つの角がベース枠幾何四面体を定義できる。また、四つのベース枠回転モジュール0aの出力軸を決め、単位ベクトルUiと表し、iは1〜4である。四つの出力軸は、それぞれベース枠幾何四面体の四つ角の中線と重なり、かつ四角中線はまん中へ、ベース枠回転モジュール0aの中心に交わる。ベース枠構造0cは四つのベース枠回転モジュール0aに固定接続され、任意の二つのベース枠幾何四面体の四つ角の中線の間の角度の幾何表示はΛij=ArcCos(Ui・Uj)となる。その中にi≠j。任意の二つのベース枠幾何四面体の四つ角の中線の間の角度は75度以上かつ150度以下である。すなわち、75°<Λij<150°である。ベース枠構造幾何定義は図1A、図2A,図3Aおよび図4Aに示している通りである。

The base frame includes a base frame structure 0c composed of a plurality of arcuate levers and four base frame rotation modules 0a in which the base frame structure 0c is arranged. The four corners in the base frame structure 0c can define the base frame geometric tetrahedron. Further, the output axes of the four base frame rotation modules 0a are determined and expressed as the unit vector Ui, and i is 1 to 4. Each of the four output axes overlaps the center of the four corners of the base frame geometric tetrahedron, and the square center line intersects the center of the base frame rotation module 0a. The base frame structure 0c is fixedly connected to the four base frame rotation modules 0a, and the geometric display of the angle between the four corner midlines of any two base frame geometric tetrahedra is Λij = ArcCos (Ui · Uj). In it i ≠ j. The angle between the midlines of the four corners of any two base frame geometric tetrahedra is greater than or equal to 75 degrees and less than or equal to 150 degrees. That is, 75 ° <Λij <150 °. The base frame structure geometric definition is as shown in FIGS. 1A, 2A, 3A and 4A.

引用文献1の開示内容に基づいて、ベース枠構造0cの幾何定義が正四面体となる場合、単一対称といった特徴がよりパラメータの設定およびシミュレート演算に向いている。この場合、ベース枠構造0cの各角中線の間の、六つのなす角は同じく約109.5°となる。すなわち、Λ12=Λ13=Λ14=Λ23=Λ24=Λ34≒109.5°である。引用文献1においてすでに明確に指摘したように、正四面体は一番シンギュラリティ現象が起きやすい。そのため、シンギュラリティ現象を避けるために、ベース枠構造0cの幾何定義は正四面体でなくでもよい。しかも引用文献1の図12〜15の開示内容によると、可変四面体機構の実施例およびシンギュラリティ現象を避けるためのパラメータ設定と最大なす角の変動範囲を検証した。そこで上記なす角を75度〜150度との範囲を請求項とするともに、幾何機構を解析する時の最大実施可能形態を開示する。
Based on the disclosure content of Cited Document 1, when the geometric definition of the base frame structure 0c is a regular tetrahedron, features such as single symmetry are more suitable for parameter setting and simulation calculation. In this case, the six formed angles between the midlines of each angle of the base frame structure 0c are also about 109.5 °. That is, Λ12 = Λ13 = Λ14 = Λ23 = Λ24 = Λ34 ≒ 109.5 °. As already clearly pointed out in Cited Document 1, the regular tetrahedron is most likely to cause the singularity phenomenon. Therefore, in order to avoid the singularity phenomenon, the geometric definition of the base frame structure 0c does not have to be a regular tetrahedron. Moreover, according to the disclosure contents of FIGS. 12 to 15 of Cited Document 1, the example of the variable tetrahedron mechanism, the parameter setting for avoiding the singularity phenomenon, and the fluctuation range of the maximum angle formed were verified. Therefore, the above-mentioned angle of 75 degrees to 150 degrees is claimed, and the maximum feasible embodiment when analyzing the geometric mechanism is disclosed.

二組の端枠組において、それぞれの端枠組には一つの端枠構造4cおよび端枠構造4cの二つの端枠回転モジュール4aとを含む。端枠構造4cにある二つの端部角は、端枠幾何円弧状を定義でき、二つの端枠回転モジュール4aの出力軸は、それぞれ端枠幾何円弧状の二つの角の中線とかさなり、かつこの二つの角の中線がまん中へベース枠構造中心に交わって、前記端枠組をレールに沿って同心回転させる。端枠構造4cの幾何レール半径はr4と表記し、ベース枠構造0cの幾何レール半径表記はr0と表示する。
In the two sets of end frames, each end frame includes one end frame structure 4c and two end frame rotation modules 4a of the end frame structure 4c. The two end angles in the end frame structure 4c can define the end frame geometric arc shape, and the output axes of the two end frame rotation modules 4a overlap with the midlines of the two corners of the end frame geometric arc shape, respectively. The midlines of these two corners intersect the center of the base frame structure in the center, and the end frame is concentrically rotated along the rail. The geometric rail radius of the end frame structure 4c is expressed as r4, and the geometric rail radius of the base frame structure 0c is expressed as r0.

第一端枠の幾何円弧状の二つの角の中線は、V1およびV2と表記する。第一端枠の幾何円弧状の二つの角の中線のなす角の幾何表記はλ12 =ArcCos(V1・V2)となる。第二端枠の幾何円弧状の二つの角の中線は、単位ベクトルV3及V4と表記する。第二端枠の幾何円弧状の二つの角の中線の間のなす角の幾何表示はλ34=ArcCos(V3・V4)となっている。
The middle lines of the two corners of the geometric arc shape of the first end frame are written as V1 and V2. Geometric of the first end frame The geometric notation of the angle formed by the middle line of the two arc-shaped corners is λ12 = ArcCos (V1 ・ V2). The middle lines of the two corners of the geometric arc shape of the second end frame are expressed as the unit vectors V3 and V4. The geometric display of the angle formed between the midlines of the two corners of the geometric arc shape of the second end frame is λ34 = ArcCos (V3 ・ V4).

それぞれの端枠の幾何円弧状の二つの角の中線の間のなす角は75度以上かつ150度以下であって、すなわち、75°<λ12 <150°及75°<λ34 <150°。端枠機構幾何定義は図5A、図6A、図7Aおよび図8Aに示す通りである。
The angle between the midlines of the two geometric arcs of each end frame is greater than or equal to 75 degrees and less than or equal to 150 degrees, that is, 75 ° <λ12 <150 ° and 75 ° <λ34 <150 °. The geometric definition of the end frame mechanism is as shown in FIGS. 5A, 6A, 7A and 8A.

二組の端枠組において、ものを負荷するために、それぞれの端枠組はさらに端枠サポータ4sを、端枠機構4cにおいてベース接続円弧状梃2cとの対向側に装着してもよい。端枠サポータ4sはアームが伸縮するリフト機構であってもよい。たとえばシリンダ、オイルシリンダ、電動スパイラルステムである。ロボットの肩関節または股関節部に応用できる。
In the two sets of end frames, in order to load an object, each end frame may further mount an end frame supporter 4s on the side of the end frame mechanism 4c opposite to the base connecting arc-shaped lever 2c. The end frame supporter 4s may be a lift mechanism in which the arm expands and contracts. For example, cylinders, oil cylinders, electric spiral stems. It can be applied to the shoulder joint or hip joint of a robot.

四組の円弧状梃組において、それぞれの円弧状梃組は、ベース接続円弧状梃1cと、ベース接続円弧状梃2cおよび円弧状梃回転モジュール2aを含む。ベース接続円弧状梃1cの一端部は、端部接続円弧状梃2cの一端部とは円弧状梃回転モジュール2aによって枢接している。ベース接続円弧状梃1cの他端部は、ベース枠回転モジュール0aと枢接している。端部接続円弧状梃2cの他端部は、端枠回転モジュール4aと枢接している。円弧状梃回転モジュール2aの出力軸は、Wiと表記する。i=1~4である。前記出力軸は常にベース枠の中心に指すことで、前記円弧状梃組をレールに沿って、ベース枠機構0cと二組の端枠機構4cとの間に同心回転させる。ベース接続円弧状梃1cの幾何レール半径表示はr1であって、端部接続円弧状梃2cの幾何レール半径表示はr2である。四組の円弧状梃組は合計12軸があって、それぞれ四つのベース枠回転モジュール0aと、四つの円弧状梃回転モジュール2aおよび四つの端枠回転モジュール4aとを通じて12軸のトルクを並列かつ直列してからまとめて出力する。
In the four sets of arc-shaped levers, each arc-shaped lever includes a base connecting arc-shaped lever 1c, a base connecting arc-shaped lever 2c, and an arc-shaped lever rotating module 2a. One end of the base connecting arc lever 1c is pivotally contacted with one end of the end connecting arc lever 2c by the arc lever rotating module 2a. The other end of the base connection arc-shaped lever 1c is pivotally in contact with the base frame rotation module 0a. The other end of the end connection arc-shaped lever 2c is pivotally in contact with the end frame rotation module 4a. The output shaft of the arc-shaped lever rotation module 2a is referred to as Wi. i = 1 ~ 4. By always pointing the output shaft to the center of the base frame, the arcuate lever is concentrically rotated between the base frame mechanism 0c and the two sets of end frame mechanisms 4c along the rail. The geometric rail radius display of the base connecting arc lever 1c is r1, and the geometric rail radius display of the end connecting arc lever 2c is r2. The four sets of arc-shaped levers have a total of 12 axes, and the torque of 12 axes is paralleled through the four base frame rotation modules 0a, the four arc-shaped lever rotation modules 2a, and the four end frame rotation modules 4a, respectively. Output in series and then collectively.

ベース接続円弧状梃1cの円弧角は、ベース枠回転モジュール0aの出力軸と円弧状梃回転モジュール2aの出力軸とのなす角となり、幾何表記はαi=ArcCos(Ui・Wi)である。ベース接続円弧状梃2cの円弧の長さは、端枠回転モジュール4aの出力軸と円弧状梃回転モジュール2aの出力軸とのなす角であって、幾何表記はβi=ArcCos(Vi・Wi)である。
The arc angle of the base connecting arcuate rod 1c is the angle formed by the output shaft of the base frame rotation module 0a and the output shaft of the arcuate arcuate rotation module 2a, and the geometric notation is αi = ArcCos (Ui · Wi). The arc length of the base connection arc-shaped 2c is the angle formed by the output shaft of the end frame rotation module 4a and the output shaft of the arc-shaped 梃 rotation module 2a, and the geometric notation is βi = ArcCos (Vi ・ Wi). Is.

引用文献1に示した各種のシンギュラリティ現象および対策となる幾何規制を参考する。任意の二つのベース枠幾何四面体の四つ角の中線の間のなす角は、対応する二つのベース接続円弧状梃1cの円弧の長さと同じ、またはより小さい。すなわち、Λij≦αi+αjであって、その中にi≠jである。任意の一つの端枠の幾何円弧状の二つの角の中線の間のなす角は、対応する二つの端部接続円弧状梃2cの円弧状梃の長さの合計値と同じ、またはより小さい。すなわち、λ12≦β1 +β2またはλ34≦β3 +β4である。
本出願は前記二つの特許出願の12軸幾何構造に従い、そして、12軸機構の相互干渉やシンギュラリティ現象(singularity phenomenon)を避けることを課題とする。
Refer to various singularity phenomena shown in Cited Document 1 and geometric regulations as countermeasures. The angle between the midlines of the four corners of any two base frame geometric tetrahedra is equal to or less than the arc length of the corresponding two base connecting arc levers 1c. That is, Λij ≤ αi + αj, and i ≠ j in it. The angle between the midlines of the two geometric arcs of any one end frame is equal to or greater than the sum of the lengths of the arc levers of the corresponding two end connecting arc levers 2c. small. That is, λ12 ≦ β1 + β2 or λ34 ≦ β3 + β4.
The present application follows the 12-axis geometric structure of the two patent applications and aims to avoid mutual interference and singularity phenomenon of the 12-axis mechanism.

12軸の座標作動機構について、一番避けられない状況は四軸折合シンギュラリティ現象であって、詳しい幾何定義および図面は、引用文献1の図16〜図21を参照する。四軸折合シンギュラリティ現象は、よく中央揃えの姿に起きるため、一旦四軸折合シンギュラリティ現象が起きるとその状態から脱出することが難しい。なおかつ中央揃えの姿はイニシャルや回復途中に必ず成る姿であるため、回避することが難しい。引用文献1では四軸折合シンギュラリティ現象を避けるための三つのパラメータ設定を挙げている。
Regarding the 12-axis coordinate operating mechanism, the most unavoidable situation is the four-axis folding singularity phenomenon, and for detailed geometric definitions and drawings, refer to FIGS. 16 to 21 of Reference 1. Since the four-axis folding singularity phenomenon often occurs in a centered shape, it is difficult to escape from that state once the four-axis folding singularity phenomenon occurs. Moreover, it is difficult to avoid the centered figure because it is always in the middle of initials and recovery. Cited Document 1 lists three parameter settings for avoiding the four-axis folding singularity phenomenon.

このシンギュラリティ現象を帰納して分析して、さらに機構のパラメータ設定を新しく設定を追加して、本案では下記の第四のパラメータ設定を提出する。同一の円弧状梃組のベース接続円弧状梃1cおよび端部接続円弧状梃2cを、同一の幾何レールに同心回転させる。その理由は、同じレールにいれば完全に折合することが難しい。つまり、それぞれのベース接続円弧状梃1cのレール半径を、各端部接続円弧状梃2のレール半径と同じようにする。その他、本案は引用文献2の二つの基本リングレール設定を取り入れる。一つの基本リングレール設定は、ベース枠機構0cのレール半径は、端枠機構4cのレール半径より大きい。もう一つの基本リングレール設定は、ベース枠機構0cのレール半径は、端枠機構4cのレール半径より小さい。
Inductively analyze this singularity phenomenon, add new settings for the parameter settings of the mechanism, and submit the fourth parameter setting below in this proposal. The base connecting arc lever 1c and the end connecting arc lever 2c of the same arc lever are concentrically rotated on the same geometric rail. The reason is that it is difficult to completely harmonize if they are on the same rail. That is, the rail radius of each base connecting arc lever 1c is set to be the same as the rail radius of each end connecting arc lever 2. In addition, this proposal incorporates the two basic ring rail settings of Cited Document 2. In one basic ring rail setting, the rail radius of the base frame mechanism 0c is larger than the rail radius of the end frame mechanism 4c. Another basic ring rail setting is that the rail radius of the base frame mechanism 0c is smaller than the rail radius of the end frame mechanism 4c.

そのため、上記二つの引用文献と上記のことなどに基づいて、本案はさらに四つのリングレール設定を分けられる。リングレール設定1は、ベース枠機構0cのレール半径は、端枠機構4cのレール半径より大きく、かつ各ベース接続円弧状梃1cのレール半径は、各端部接続円弧状梃2cのレール半径と同じで、すなわちr0>r1=r2>r4、図5A〜図5Bに示す通りである。リングレール設定2は、ベース枠機構0cのレール半径は、端枠機構4cのレール半径より小さく、かつ各ベース接続円弧状梃1cのレール半径は、各端枠機構4cのレール半径と同じである。すなわち、r0<r1=r2<r4、図6A〜図6Bに示す通りである。リングレール設定3は、ベース枠機構0cのレール半径は、端枠機構4cのレール半径より大きく、かつ各ベース接続円弧状梃1cのレール半径は各端部接続円弧状梃2cのレール半径より大きく、すなわち、r0>r1>r2>r4、図7A〜図7Bに示す通りである。リングレール設定4は、ベース枠機構0cのレール半径は、端枠機構4cのレール半径より小さく、かつ各ベース接続円弧状梃1cのレール半径は、各端部接続円弧状梃2cのレール半径より小さく、すなわち、r0<r1<r2<r4、図8A〜図8Bに示す通りである。
Therefore, based on the above two references and the above, the present proposal can be further divided into four ring rail settings. In the ring rail setting 1, the rail radius of the base frame mechanism 0c is larger than the rail radius of the end frame mechanism 4c, and the rail radius of each base connecting arcuate rod 1c is the rail radius of each end connecting arcuate rod 2c. The same, that is, r0> r1 = r2> r4, as shown in FIGS. 5A to 5B. In the ring rail setting 2, the rail radius of the base frame mechanism 0c is smaller than the rail radius of the end frame mechanism 4c, and the rail radius of each base connecting arcuate rod 1c is the same as the rail radius of each end frame mechanism 4c. .. That is, r0 <r1 = r2 <r4, as shown in FIGS. 6A to 6B. In the ring rail setting 3, the rail radius of the base frame mechanism 0c is larger than the rail radius of the end frame mechanism 4c, and the rail radius of each base connecting arcuate rod 1c is larger than the rail radius of each end connecting arcuate rod 2c. That is, r0>r1>r2> r4, as shown in FIGS. 7A to 7B. In the ring rail setting 4, the rail radius of the base frame mechanism 0c is smaller than the rail radius of the end frame mechanism 4c, and the rail radius of each base connecting arcuate rod 1c is smaller than the rail radius of each end connecting arcuate rod 2c. Small, that is, r0 <r1 <r2 <r4, as shown in FIGS. 8A-8B.

最大で二組のクランクにおいて、それぞれのクランク組には、一つの円弧状クランク3cおよび一つのクランク回転モジュール3aを含む。円弧状クランク3cの一端部は、一つの梃においてベース枠機構0cの対向側に向心的に伸び、前記梃の延長線は単位ベクトルNiと表記し、i=1~2である。円弧状クランク3cの他端部はベース接続円弧状梃1cの一端部とは同軸にベース枠回転モジュール1a挿入することによって、円弧状クランク3cが端部接続円弧状梃2cと端枠機構4cとの間に、レールに沿って同心回転させる。円弧状クランク3cの幾何レール半径はr3と表記する。クランク回転モジュール3aは前記ベース枠回転モジュールとともに同軸に装着する。円弧状クランク3cの円弧の長さは、ベース枠回転モジュール0aが円弧状クランク3cとの出力軸とのなす角で、幾何表記はδi=ArcCos(Ui・Ni)で、その中にi=1~2である。円弧状クランク3cの円弧の長さは90度より小さく、または等しいです。すなわち、δi≦90°である。その中にi=1~2である。回転モジュールクランク組の幾何定義は図9A〜図9Bおよび図10A〜図10Bに示す通りである。
In a maximum of two sets of cranks, each set of cranks includes one arcuate crank 3c and one crank rotation module 3a. One end of the arcuate crank 3c extends centripetally toward the opposite side of the base frame mechanism 0c in one lever, and the extension line of the lever is expressed as a unit vector Ni, and i = 1 to 2. The other end of the arc-shaped crank 3c is connected to the base. By inserting the base frame rotation module 1a coaxially with one end of the arc-shaped lever 1c, the arc-shaped crank 3c is connected to the end-connecting arc-shaped lever 2c and the end frame mechanism 4c. In between, rotate concentrically along the rail. The geometric rail radius of the arcuate crank 3c is expressed as r3. The crank rotation module 3a is mounted coaxially with the base frame rotation module. The arc length of the arc-shaped crank 3c is the angle formed by the base frame rotation module 0a with the output shaft of the arc-shaped crank 3c, and the geometric notation is δi = ArcCos (Ui ・ Ni), in which i = 1. ~ 2. The arc length of the arc crank 3c is less than or equal to 90 degrees. That is, δi ≦ 90 °. Among them, i = 1 ~ 2. The geometric definitions of the rotary module crank set are as shown in FIGS. 9A-9B and 10A-10B.

クランク回転モジュール3aは適切に円弧状クランク3cを駆動し、端部接続円弧状梃2cまたは端枠機構4cとの干渉を回避することができる。それぞれのクランク組は、ものを負荷するために、円弧状クランク3cの梃においてベース枠機構0cの対向側に、追加で一つのクランクサポータ3sを装着してもよい。サポータ3sは保持器具であって、例えば工作機のグリップ器具で、多軸のマルチタスク機械や多次元検査機械に用いることができる。
The crank rotation module 3a can appropriately drive the arcuate crank 3c and avoid interference with the end connection arcuate lever 2c or the end frame mechanism 4c. Each crank set may additionally be equipped with one crank supporter 3s on the opposite side of the base frame mechanism 0c in the lever of the arcuate crank 3c in order to load an object. The supporter 3s is a holding tool, for example, a grip tool for a machine tool, and can be used for a multi-axis multitasking machine or a multidimensional inspection machine.

引用文献2の終端円弧状梃組は本案においてクランク組と称すし、そして、引用文献2の「少なくとも一つの」終端円弧状梃組は、本案において「二組以内」のクランク組となる。幾何機構から解析すると、ベース枠機構は最大で四組のクランクと枢接することができるが、シミュレーションで検証すると、二組以上のクランクは、ベース枠機構または円弧状梃組と干渉しやすく、作動空間は制限され、応用効果が大幅に減る。二組のクランク組の工作空間は少し制限されるが、共同でものを把持することができるため、許容範囲以内だと考えられる。一組のクランク組の工作空間はより大きくなるが、単一把持の場合は振れやすい。また、クランク組を設置しない場合、作動空間は比較的に自由で、機構内にクランクサポータ3sがなくても、端枠サポータ4sを装着することでものを負荷することができる。そのため、二組以下のクランクといった配置は、それぞれの適用場面がある。従って、本案は引用文献2の「少なくとも一組」を、「二組以内」のクランク組を請求項とし、幾何機構の解析後の最大実施可能形態を開示する。
The terminating arc-shaped lever of Cited Document 2 is referred to as a crank set in the present invention, and the "at least one" terminating arc-shaped lever of Cited Document 2 is a crank set of "within two sets" in the present proposal. When analyzed from the geometric mechanism, the base frame mechanism can be pivotally contacted with up to four sets of cranks, but when verified by simulation, two or more sets of cranks easily interfere with the base frame mechanism or the arc-shaped lever and operate. The space is limited and the application effect is greatly reduced. The work space of the two cranksets is a little limited, but it is considered to be within the permissible range because they can grip the ones jointly. The work space of one set of cranks is larger, but it is easy to swing in the case of a single grip. Further, when the crank assembly is not installed, the operating space is relatively free, and even if there is no crank supporter 3s in the mechanism, it is possible to load by installing the end frame supporter 4s. Therefore, arrangements such as two or less cranks have their respective application situations. Therefore, this proposal claims "at least one set" of Cited Document 2 and "within two sets" of crank sets, and discloses the maximum feasible embodiment after analysis of the geometric mechanism.

本案のベース枠機構0cの設計は、閉鎖リングと開放リングと分けられる。閉鎖リングの設計の要点、構造強度を強化して、振動や変形を避けることである。開放リングの設計要点は、円弧状梃組やクランク組の作動を避けることである。それでベース枠機構0cは四つの設計形態に分けられ、形態1は図1A、1Bで、形態2は図2A、2Bで、形態3は図3A、3Bで、形態4は図4A、4Bのように示される。
The design of the base frame mechanism 0c of the present invention is divided into a closing ring and an opening ring. The main point of the design of the closing ring is to strengthen the structural strength and avoid vibration and deformation. The design point of the open ring is to avoid the operation of the arc-shaped lever and crank assembly. Therefore, the base frame mechanism 0c is divided into four design forms, in which form 1 is shown in FIGS. 1A and 1B, form 2 is shown in FIGS. 2A and 2B, form 3 is shown in FIGS. 3A and 3B, and form 4 is shown in FIGS. 4A and 4B. Shown in.

本案のクランク組は二つの枢接形態に分けられることは、引用文献2の二つの基本リングレール設定を取り入れる。枢接形態1は、円弧状クランク3cが、端部接続円弧状梃2cと端枠機構4cとの間にレールに沿って同心回転する。このとき、それぞれの端部接続円弧状梃2cのレール半径は端枠機構4cのレール半径より大きく、すなわち、r2>r3>r4であって、例えば図9A〜9Bに示す通りである。枢接形態2は、円弧状梃クランク3cが端部接続円弧状梃2cと端枠機構4cとの間にレールに沿って同心回転し、このとき各端部接続円弧状梃2cのレール半径は端枠機構4cのレール半径より小さく、すなわち、r2<r3<r4で、例えば図10A〜10Bに示す通りである。
The fact that the crankset of the present proposal can be divided into two pivotal forms incorporates the two basic ring rail settings of Reference 2. In the pivotal form 1, the arcuate crank 3c rotates concentrically along the rail between the end connection arcuate lever 2c and the end frame mechanism 4c. At this time, the rail radius of each end connecting arc-shaped lever 2c is larger than the rail radius of the end frame mechanism 4c, that is, r2>r3> r4, as shown in FIGS. 9A to 9B, for example. In the pivotal contact form 2, the arc-shaped lever crank 3c rotates concentrically along the rail between the end-connecting arc-shaped lever 2c and the end frame mechanism 4c, and at this time, the rail radius of each end-connecting arc-shaped lever 2c is It is smaller than the rail radius of the end frame mechanism 4c, that is, r2 <r3 <r4, as shown in FIGS. 10A to 10B, for example.

本案の各タイプの回転モジュールに関して、ベース枠回転モジュール0aはトルク出力装置、角度検出装置、スピンドルと軸受けとのいずれまたはそれの組み合わせである。円弧状梃回転モジュール2aはトルク出力装置、角度検出装置、スピンドルと軸受けとのいずれまたはそれの組み合わせである。端枠回転モジュール4aトルク出力装置、角度検出装置、スピンドルと軸受けとのいずれまたはそれの組み合わせである。クランク回転モジュール3aは、トルク出力装置、角度検出装置、スピンドルと軸受けとのいずれまたはそれの組み合わせである。その中に、上記トルク出力装置は例としてモータやオイル回転シリンダでよい。
For each type of rotary module of the present invention, the base frame rotary module 0a is a torque output device, an angle detector, a spindle and a bearing, or a combination thereof. The arc-shaped lever rotation module 2a is a torque output device, an angle detection device, a spindle and a bearing, or a combination thereof. End frame rotation module 4a Torque output device, angle detection device, spindle and bearing, or a combination thereof. The crank rotation module 3a is a torque output device, an angle detection device, a spindle and a bearing, or a combination thereof. Among them, the torque output device may be a motor or an oil rotary cylinder as an example.

本案の新規特徴は六つの実施例で示すことができる。第一実施例は円弧状梃のリングレール設定1に一つのクランク組を装着する。例えば図11A〜11Cに示す通りである。第二実施例は円弧状梃組のリングレール設定2に一つのクランク組を装着する。例えば図12A〜12Cに示す通りである。第三実施例は円弧状梃組のリングレール設定3に二つのクランク組を装着する。例えば図13A〜13Cに示す通りである。第四実施例は円弧状梃組のリングレール設定4に二組のクランク組を装着する。例えば図14A〜14Cに示す通りである。第五実施例は円弧状梃組のリングレール設定2にクランク組を設置しない。例えば図15A〜図15Cに示す通りである。第六実施例は円弧状梃組のリングレール設定2にクランク組を設置しない。例えば図16A〜16Cに示す通りである。
The new features of the present proposal can be shown in six examples. In the first embodiment, one crank set is attached to the ring rail setting 1 of the arc-shaped lever. For example, as shown in FIGS. 11A to 11C. In the second embodiment, one crank set is attached to the ring rail setting 2 of the arc-shaped lever set. For example, as shown in FIGS. 12A to 12C. In the third embodiment, two crank sets are attached to the ring rail setting 3 of the arc-shaped lever set. For example, as shown in FIGS. 13A to 13C. In the fourth embodiment, two sets of crank sets are attached to the ring rail setting 4 of the arc-shaped lever set. For example, as shown in FIGS. 14A to 14C. In the fifth embodiment, the crank assembly is not installed in the ring rail setting 2 of the arc-shaped lever assembly. For example, as shown in FIGS. 15A to 15C. In the sixth embodiment, the crank assembly is not installed in the ring rail setting 2 of the arc-shaped lever assembly. For example, as shown in FIGS. 16A to 16C.

上記実施例は単に説明のために例を挙げている。当業者の技術者による修正、調整があっても、請求項に記載される権利請求範囲から離脱しない。
The above embodiment gives an example merely for the sake of explanation. Even if it is modified or adjusted by a technician of a person skilled in the art, it does not deviate from the claims stated in the claims.

円弧状梃組の実施について補足する。引用文献1に開示した通りで、「同一の円弧状梃組のベース接続円弧状梃と、端部接続円弧状梃との円弧の角度合計値は180度より小さく、または等しいである。つまりαi+βi≦180°。そうでないと、幾何意義が失う」。好意の開示によって特許の最大実施形態を開示するために、上記幾何の概念についてより詳しく説明する。ただし、この開示は、悪意の権利侵害者は故意に同一の円弧状梃組の二つの円弧状梃の円弧の角度合計値をやや180度以上に作る可能性がある。180度の臨界プラスマイナス公差は精密計測できないため、それを利用して侵害者がわずかな角度の差で侵害の責任から逃げる可能性がある。そのため、本案はこの好意の開示の幾何解析を円弧状梃組の権利範囲に入れていない。 Supplementary information on the implementation of arc-shaped levers. As disclosed in Cited Document 1, "The total value of the angles of the arcs of the base connecting arc lever of the same arc lever and the end connecting arc lever is less than or equal to 180 degrees, that is, αi. + βi ≤ 180 °, otherwise the geometric significance is lost. " In order to disclose the maximum embodiment of the patent by the disclosure of favor, the concept of geometry will be described in more detail. However, in this disclosure, a malicious infringer may intentionally make the total angle of the arcs of two arcs of the same arc lever slightly more than 180 degrees. Since the 180 degree critical plus or minus tolerance cannot be measured precisely, it can be used by an infringer to escape liability for infringement with a slight angle difference. Therefore, the proposal does not include the geometric analysis of this favorable disclosure within the scope of rights of the arc lever.

Claims (9)

12軸幾何によって構築され、球面座標作動に従って操縦される機構であって、
一組のベース枠組で、複数の円弧状梃組からなるベース枠構造および前記ベース枠構造が配置された四つのベース枠回転モジュールを含み、ベース枠組構造には四つの角があって、前記四つの角はベース枠幾何四面体を定義し、かつ前記四つのベース枠回転モジュールの出力軸は、それぞれ前記ベース枠幾何四面体の四つ角の中線と重なり、かつ四角中線は向心的に前記ベース枠回転モジュールの中心に交わり、任意の二つのベース枠幾何四面体の四つ角の中線の間の角度は75度以上かつ150度以下である、ベース枠組と、
二組の端枠組で、それぞれの端枠組は端枠機構および前記端枠機構に配置された二つの端枠回転モジュールを含み、前記端枠機構に二つの角があって、前記二つの角が端枠の幾何円弧状を定義でき、前記二つの端枠回転モジュールの出力軸はそれぞれ前記端枠の幾何円弧状の二つの角の中線とかさなり、かつ前記二つの角の中線は前記ベース枠構造中心に交わり、前記端枠組を同心回転させ、また、任意の二つの端枠回転モジュールの出力軸のなす角は75度より大きく、150度より小さい端枠組と、
四組の円弧状梃組で、それぞれの円弧状梃組はベース接続円弧状梃と、端部接続円弧状梃と、円弧状梃回転モジュールとを含み、前記ベース接続円弧状梃の一端部は、前記端部接続円弧状梃の一端部とは、前記円弧状梃回転モジュールによって枢接し、前記ベース接続円弧状梃の他端部は、ベース回転モジュールと枢接し、前記端部接続円弧状梃の他端部は、端枠回転モジュールと枢接し、かつ円弧状梃回転モジュールの出力軸は常に前記ベース枠構造中心に指すことで、前記円弧状梃組を前ベース枠構造および前記二つの端枠機構との間に同心回転させ、また、任意の二つのベース枠幾何四面体の四つ角の中線の間のなす角は、対応する二つのベース接続円弧状梃の円弧の長さの合計値より小さく、または等しくなり、また、任意の一つの端枠の二つの端枠回転モジュールの出力軸の間のなす角は、対応する二つの端部接続円弧状梃の円弧の長さの合計値より小さく、または等しくなる、円弧状梃組と、
二組以内のクランク組で、それぞれのクランク組は、円弧状クランクおよびクランク回転モジュールを含み、前記円弧状クランクの一端部は、前記ベース枠構造の対向側に対して向心的に伸びる梃を固定装着し、前記円弧状クランクの他端部は、ベース接続円弧状梃組とともにベース枠回転モジュールに挿入することで、前記円弧状クランクを、端部接続円弧状梃と端枠機構との間に同心回転させ、前記クランク回転モジュールは、前記ベース枠回転モジュールとともに同軸に装着し、前記円弧状クランクの円弧の長さは90度より小さく、または等しいとなるクランク組とを含むこと
を特徴とする機構。
A mechanism constructed by 12-axis geometry and steered according to spherical coordinate operation .
A set of base frames includes a base frame structure composed of a plurality of arcuate geometries and four base frame rotation modules in which the base frame structures are arranged, and the base frame structure has four corners. The two corners define the base frame geometric tetrahedron, and the output axes of the four base frame rotation modules each overlap the center line of the four corners of the base frame geometric tetrahedron, and the square center line is centripetal. With a base frame that intersects the center of the base frame rotation module and the angle between the midlines of the four corners of any two base frame geometric tetrahedrons is greater than or equal to 75 degrees and less than or equal to 150 degrees.
Two sets of end frames, each end frame containing an end frame mechanism and two end frame rotation modules arranged in the end frame mechanism, the end frame mechanism having two corners, the two corners The geometric arc shape of the end frame can be defined, the output axes of the two end frame rotation modules overlap with the midlines of the two corners of the geometric arc shape of the end frame, and the midlines of the two corners are the bases. intersection to the frame structure around, the end framework is rotated the heart, also the angle of the output shaft of any two end frame rotation module is greater than 75 degrees, and 150 degrees is smaller than end framework,
There are four sets of arcuate sets, each of which includes a base connection arcuate, an end connection arcuate, and an arcuate rotating module, and one end of the base connection arcuate is , One end of the end connecting arcuate rod is pivotally contacted by the arcuate rotating module, and the other end of the base connecting arcuate is pivotally contacted with the base rotating module, and the end connecting arcuate rod is pivotally contacted. the other end is in contact with the end frame rotation module and pivot, and the output shaft of the arc-shaped lever rotation module that always points to the base frame, the geometric center, the arcuate lever assembly before Symbol base frame structure and the two Concentrically rotated between the end frame mechanism and the angle formed between the midlines of the four corners of any two base frame geometric tetrahedrons is the sum of the arc lengths of the corresponding two base connecting arcs. The angle between the output axes of the two end frame rotation modules of any one end frame is less than or equal to the value, and the sum of the arc lengths of the corresponding two end connecting arcs. With an arcuate set that is less than or equal to the value,
Within two sets of cranks, each crank set includes an arc-shaped crank and a crank rotation module, and one end of the arc-shaped crank has a lever that extends centripetally with respect to the opposite side of the base frame structure. The other end of the arc-shaped crank is fixedly mounted, and the other end of the arc-shaped crank is inserted into the base frame rotation module together with the base connecting arc-shaped cage, so that the arc-shaped crank is placed between the end-connecting arc-shaped crank and the end frame mechanism. to rotate the heart, the crank rotation module, mounted coaxially with the base frame rotation module, characterized in that the length of the arc of the arcuate crank includes a crank assembly to be smaller than 90 degrees or equal to, Mechanism.
それぞれの端枠組は、ものを負荷するために、前記端枠機構においてベース接続円弧状梃との対向側に端枠サポータを装着する、請求項1に記載の機構。 The mechanism according to claim 1, wherein each end frame is equipped with an end frame supporter on the opposite side of the base connection arc-shaped lever in the end frame mechanism in order to load an object. それぞれのクランク組に、ものを負荷するために、前記円弧状クランクにおいて梃のベース枠構造との対向側に、クランクサポータを増設する、請求項1に記載の機構。 The mechanism according to claim 1, wherein a crank supporter is added to each crank set on the opposite side of the arc-shaped crank to the base frame structure of the lever. 前記ベース枠回転モジュールはトルク出力装置、角度検出装置、スピンドルと軸受けとのいずれまたはそれの組み合わせであって、前記端枠回転モジュールは、トルク出力装置、角度検出装置、スピンドルと軸受けとのいずれまたはそれの組み合わせであって、前記円弧状梃回転モジュールは、トルク出力装置、角度検出装置、スピンドルと軸受けとのいずれまたはそれの組み合わせであって、前記クランク回転モジュールは、トルク出力装置、角度検出装置、スピンドルと軸受けとのいずれまたはそれの組み合わせである、請求項1
に記載の機構。
The base frame rotation module is a torque output device, an angle detection device, a spindle and a bearing, or a combination thereof, and the end frame rotation module is a torque output device, an angle detection device, a spindle and a bearing, or a combination thereof. In a combination thereof, the arcuate rotary module is a torque output device , an angle detection device, any one of a spindle and a bearing, or a combination thereof, and the crank rotation module is a torque output device , an angle detection device. , Any or a combination of a spindle and a bearing, claim 1
The mechanism described in.
前記ベース枠組のベース枠構造は、構造強度を強化して、振動や変形を避けるための閉鎖リング設計であって、または円弧状梃組やクランク組の作動への干渉を避けるための開放リングである、請求項1に記載の機構。 The base frame structure of the base frame is a closing ring design to enhance the structural strength and avoid vibration and deformation, or an open ring to avoid interference with the operation of the arc-shaped lever and crank assembly. The mechanism according to claim 1. 12軸幾何によって構築され、球面座標作動に従って操縦される機構であって、
一組のベース枠組で、複数の円弧状梃組からなるベース枠構造および前記ベース枠構造が配置された四つのベース枠回転モジュールを含み、ベース枠組構造には四つの角があって、前記四つの角はベース枠幾何四面体を定義し、かつ前記四つのベース枠回転モジュールの出力軸は、それぞれ前記ベース枠幾何四面体の四つ角の中線と重なり、かつ四角中線は向心的に前記ベース枠回転モジュールの中心に交わり、任意の二つのベース枠幾何四面体の四つ角の中線の間の角度は75度以上かつ150度以下である、ベース枠組と、
二組の端枠組で、それぞれの端枠組は端枠機構および前記端枠機構に配置された二つの端枠回転モジュールを含み、前記端枠機構に二つの角があって、前記二つの角が端枠の幾何円弧状を定義でき、前記二つの端枠回転モジュールの出力軸はそれぞれ前記端枠の幾何円弧状の二つの角の中線とかさなり、かつ前記二つの角の中線は前記ベース枠構造中心に交わり、前記端枠組を同心回転させ、また、任意の二つの端枠回転モジュールの出力軸のなす角は75度より大きく、150度より小さい端枠組と、
四組の円弧状梃組で、それぞれの円弧状梃組はベース接続円弧状梃と、端部接続円弧状梃と、円弧状梃回転モジュールとを含み、前記ベース接続円弧状梃の一端部は、前記端部接続円弧状梃の一端部とは、前記円弧状梃回転モジュールによって枢接し、前記ベース接続円弧状梃の他端部は、ベース回転モジュールと枢接し、前記端部接続円弧状梃の他端部は、端枠回転モジュールと枢接し、かつ円弧状梃回転モジュールの出力軸は常に前記ベース枠構造中心に指すことで、前記円弧状梃組を前ベース枠構造および前記二つの端枠機構との間に同心回転させ、また、任意の二つのベース枠幾何四面体の四つ角の中線の間のなす角は、対応する二つのベース接続円弧状梃の円弧の長さの合計値より小さく、または等しくなり、また、任意の一つの端枠の二つ端枠回転モジュールの出力軸の間のなす角は、対応する二つの端部接続円弧状梃の円弧の長さの合計値より小さく、または等しくなる、円弧状梃組と、
を含むことを特徴とする機構。
A mechanism constructed by 12-axis geometry and steered according to spherical coordinate operation .
A set of base frames includes a base frame structure composed of a plurality of arcuate geometries and four base frame rotation modules in which the base frame structures are arranged, and the base frame structure has four corners. The two corners define the base frame geometric tetrahedron, and the output axes of the four base frame rotation modules each overlap the center line of the four corners of the base frame geometric tetrahedron, and the square center line is centripetal. With a base frame that intersects the center of the base frame rotation module and the angle between the midlines of the four corners of any two base frame geometric tetrahedrons is greater than or equal to 75 degrees and less than or equal to 150 degrees.
Two sets of end frames, each end frame containing an end frame mechanism and two end frame rotation modules arranged in the end frame mechanism, the end frame mechanism having two corners, the two corners The geometric arc shape of the end frame can be defined, the output axes of the two end frame rotation modules overlap with the midlines of the two corners of the geometric arc shape of the end frame, and the midlines of the two corners are the bases. intersection to the frame structure around, the end framework is rotated the heart, also the angle of the output shaft of any two end frame rotation module is greater than 75 degrees, and 150 degrees is smaller than end framework,
There are four sets of arcuate sets, each of which includes a base connection arcuate, an end connection arcuate, and an arcuate rotating module, and one end of the base connection arcuate is , One end of the end connecting arcuate rod is pivotally contacted by the arcuate rotating module, and the other end of the base connecting arcuate is pivotally contacted with the base rotating module, and the end connecting arcuate rod is pivotally contacted. the other end is in contact with the end frame rotation module and pivot, and the output shaft of the arc-shaped lever rotation module that always points to the base frame, the geometric center, the arcuate lever assembly before Symbol base frame structure and the two Concentrically rotated between the end frame mechanism and the angle formed between the midlines of the four corners of any two base frame geometric tetrahedrons is the sum of the arc lengths of the corresponding two base connecting arcs. The angle between the output axes of the two end frame rotation modules of any one end frame is less than or equal to the value of the arc length of the corresponding two end connecting arcs. With arcs that are less than or equal to the sum,
A mechanism characterized by including.
それぞれの端枠組は、ものを負荷するために、前記端枠機構においてベース接続円弧状梃との対向側に端枠サポータを装着する、請求項6に記載の機構。 The mechanism according to claim 6, wherein each end frame is equipped with an end frame supporter on the opposite side of the base connection arc-shaped lever in the end frame mechanism in order to load an object. 前記円弧状梃回転モジュールは、トルク出力装置、角度検出装置、スピンドルと軸受けとのいずれまたはそれの組み合わせである、請求項6に記載の機構。 The mechanism according to claim 6, wherein the arc-shaped lever rotation module is any one of a torque output device , an angle detection device, a spindle and a bearing, or a combination thereof. 前記ベース枠組のベース枠構造は、構造強度を強化して、振動や変形を避けるための閉鎖リング設計であって、または円弧状梃組の作動への干渉を避けるための開放リングである、請求項6に記載の機構。 The base frame structure of the base frame is a closing ring design for enhancing structural strength to avoid vibration and deformation, or an opening ring for avoiding interference with the operation of the arcuate lever. Item 6. The mechanism according to item 6.
JP2017005465A 2016-01-15 2017-01-16 12-axis spherical coordinate control device Active JP6912205B2 (en)

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
TW105101295A TWI623345B (en) 2016-01-15 2016-01-15 Arc-links assembly mechanism
TW105101295 2016-01-15
TW105143085 2016-12-23
TW105143085A TWI652430B (en) 2016-12-23 2016-12-23 Twelve axes mechanism for spherical coordinates orientating

Publications (2)

Publication Number Publication Date
JP2017125612A JP2017125612A (en) 2017-07-20
JP6912205B2 true JP6912205B2 (en) 2021-08-04

Family

ID=59363945

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017005465A Active JP6912205B2 (en) 2016-01-15 2017-01-16 12-axis spherical coordinate control device

Country Status (2)

Country Link
JP (1) JP6912205B2 (en)
CN (1) CN107030682B (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107877189B (en) * 2017-11-08 2020-06-16 弗埃斯工业技术(苏州)有限公司 Spherical processing machine seat
CN108000508B (en) * 2018-01-25 2024-01-26 西南石油大学 Motion adjusting device
CN109333510B (en) * 2018-11-08 2021-08-06 天津大学 Coordinate type zero-coupling parallel mechanism for translating two rotating balls
CN110696007B (en) * 2019-09-27 2020-11-10 北京交通大学 Combined tetrahedral mobile robot

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6165790A (en) * 1984-09-05 1986-04-04 新明和工業株式会社 Three-dimensional wrist device
DE3810477C1 (en) * 1988-03-26 1989-10-19 Gerhart Dr.Med. 6718 Gruenstadt De Faber
TWI440499B (en) * 2010-10-04 2014-06-11 A space orientation mechanism
CN103158157A (en) * 2013-04-01 2013-06-19 天津工业大学 Simulated joint mechanism with radial direction buffering function
US9579786B2 (en) * 2013-09-26 2017-02-28 Wen-Der TRUI Spherical coordinates manipulating mechanism
CN103639712B (en) * 2013-11-25 2016-04-27 浙江理工大学 A kind of three rotation spherical parallel institutions

Also Published As

Publication number Publication date
JP2017125612A (en) 2017-07-20
CN107030682A (en) 2017-08-11
CN107030682B (en) 2020-07-14

Similar Documents

Publication Publication Date Title
JP6912205B2 (en) 12-axis spherical coordinate control device
Huo et al. The joint‐limits and singularity avoidance in robotic welding
CN110288660B (en) Robot hand-eye calibration method based on convex relaxation global optimization algorithm
WO2018090323A1 (en) Method, system, and device for calibrating coordinate system
CN103302663B (en) For having calibration steps and the calibration system of the robot of redundancy
Hawkins Analytic inverse kinematics for the universal robots UR-5/UR-10 arms
Almaged Forward and inverse kinematic analysis and validation of the ABB IRB 140 industrial robot
Zheng et al. Measurement accuracy of articulated arm CMMs with circular grating eccentricity errors
CN104385283A (en) Quick judging method for singular configuration of six-degree-of-freedom mechanical arm
Cuan-Urquizo et al. Kinematic analysis of the 3-CUP parallel mechanism
Guo et al. Enhanced DH: an improved convention for establishing a robot link coordinate system fixed on the joint
Lee et al. On the kinematics of a new parallel mechanism with Schoenflies motion
Huang et al. A unified methodology for mobility analysis based on screw theory
My et al. Kinematic and dynamic analysis of a serial manipulator with local closed loop mechanisms
Santosh et al. Design and analysis of a robotic arm under different loading conditions using FEA simulation
Yu et al. Mobility and singularity analysis of a class of 2-DOF rotational parallel mechanisms using a visual graphic approach
Dirven et al. A systematic design strategy for antagonistic joints actuated by artificial muscles
Chen et al. Dimension optimization of a planar 3-RRR parallel manipulator considering motion and force transmissibility
Su et al. Mobility analysis and type synthesis with screw theory: from rigid body linkages to compliant mechanisms
JP2014180726A (en) Compensating device for spring constant of multi-joint robot
Cao et al. Singularity kinematics principle and position-singularity analyses of the 6-3 Stewart-Gough parallel manipulators
Wang et al. Kinematics analysis and simulation of a new 3 degrees of freedom spatial robot mechanism composed by closed chain
Guo et al. An improved DH convention for establishing a link coordinate system
Jin et al. Constrained motion interpolation for planar open kinematic chains
JP2021146410A (en) Inverse kinematics operation unit and inverse kinematics operation method

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20170322

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20180706

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20180706

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200110

RD01 Notification of change of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7421

Effective date: 20200110

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20200110

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201203

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201208

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210308

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210708

R150 Certificate of patent or registration of utility model

Ref document number: 6912205

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250