(57)【要約】一実施形態に係るロボットは、複数のリンク部材を備えるリンク部及び前記リンク部材を回転させる駆動部を含み、前記リンク部材の端部の前記駆動部の回転軸は同じ地点で接することができる。【選択図】図１
2016519001.tif 000002
【特許請求の範囲】
【請求項１】
複数のリンク部材を備えるリンク部と、
前記リンク部材を回転させる駆動部と、
を含み、
前記リンク部材の端部の前記駆動部の回転軸は同じ地点で接することを特徴とするロボット。
【請求項２】
前記リンク部は、
第１リンク部材と、
前記第１リンク部材の端部に接続した第２リンク部材と、
を含むことを特徴とする請求項１に記載のロボット。
【請求項３】
前記第１リンク部材及び前記第２リンク部材は弧状に備えられ、前記第１リンク部材及び前記第２リンク部材は同心球上にそれぞれ位置することを特徴とする請求項２に記載のロボット。
【請求項４】
前記駆動部の回転軸は、前記同心球の中心で接することを特徴とする請求項３に記載のロボット。
【請求項５】
前記第１リンク部材及び前記第２リンク部材は、互いに非干渉的に回転するよう放射状に離隔する位置から離れて位置することを特徴とする請求項２に記載のロボット。
【請求項６】
前記第１リンク部材及び前記第２リンク部材は、互いに異なる長さを備え、前記第１リンク部材と前記第２リンク部材のうち、外側に位置するリンク部材の長さが内側に位置するリンク部材の長さよりも大きく設けられることを特徴とする請求項２に記載のロボット。
【請求項７】
前記駆動部は、
前記第１リンク部材の一端に取り付けられ、第１回転軸を中心に前記第１リンク部材を回転させる第１駆動部材と、
前記第１リンク部材の他端に取り付けられ、第２回転軸を中心に前記第２リンク部材を回転させる第２駆動部材と、
を含むことを特徴とする請求項２に記載のロボット。
【請求項８】
前記第１回転軸及び前記第２回転軸は前記同じ地点で接し、前記第１回転軸と前記第２回転軸との間の角度に応じて前記第１リンク部材の長さが決定されることを特徴とする請求項７に記載のロボット。
【請求項９】
前記第１回転軸は、前記第１リンク部材の端部の接線方向に沿って垂直であり、前記第２回転軸は、前記第２リンク部材の端部の接線方向に沿って垂直であることを特徴とする請求項７に記載のロボット。
【請求項１０】
前記第２リンク部材の他端には、ターゲットに向かうように取り付けられた放出部材が設けられ、前記放出部材は、放射線治療のために放射線を照射する線形加速器に設けられることを特徴とする請求項２に記載のロボット。
【請求項１１】
前記放出部材は、前記第２リンク部材端部の接線方向に沿って垂直に位置することを特徴とする請求項１０に記載のロボット。
【請求項１２】
前記放出部材は、前記ターゲットを中心に前記第２リンク部材の回転軌跡に沿って球状に移動することを特徴とする請求項１０に記載のロボット。
【請求項１３】
前記第２リンク部材又は前記放出部材には角度調整要素が取り付けられ、前記放出部材が前記ターゲットに向かう角度を調整することを特徴とする請求項１０に記載のロボット。
【請求項１４】
第１リンク部材と、
前記第１リンク部材の一端に取り付けられ、第１回転軸を中心に前記第１リンク部材を回転させる第１駆動部材と、
前記第１リンク部材の他端に接続する第２リンク部材と、
前記第１リンク部材と前記第２リンク部材との間に配置し、第２回転軸を中心に前記第２リンク部材を回転させる第２駆動部材と、
前記第２リンク部材の端部に取り付けられてターゲットに向かう放出部材と、
を含み、
前記第１回転軸及び前記第２回転軸は、前記ターゲットで接することを特徴とするロボット。
【請求項１５】
前記第１リンク部材及び前記第２リンク部材は弧状に設けられ、前記第１リンク部材及び前記第２リンク部材は、前記ターゲットを中心にする同心球上にそれぞれ位置することを特徴とする請求項１４に記載のロボット。
【請求項１６】
前記第１リンク部材及び前記第２リンク部材は、互いに非干渉的に回転するよう放射状に離隔する位置から離れて位置することを特徴とする請求項１４に記載のロボット。
【請求項１７】
前記第１回転軸と前記第２回転軸との間の角度に応じて、前記第１リンク部材の長さが決定されることを特徴とする請求項１４に記載のロボット。
【請求項１８】
前記第１回転軸は前記第１リンク部材の端部の接線方向に沿って垂直であり、前記第２回転軸は前記第２リンク部材の端部の接線方向に沿って垂直であることを特徴とする請求項１４に記載のロボット。
【請求項１９】
前記ターゲットから前記放出部材を延長して第３軸が形成され、前記第２回転軸と前記第３軸との間の角度に応じて、前記第２リンク部材の長さが決定されることを特徴とする請求項１４に記載のロボット。
【請求項２０】
前記第２リンク部材又は前記放出部材には角度調整要素が取り付けられ、前記放出部材が前記ターゲットに向かう角度を調整することを特徴とする請求項１４に記載のロボット。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明はロボットに関し、詳しくは、ターゲットに向かって正確かつ迅速に狙うことができるロボットに関する。
【背景技術】
【０００２】
放射線治療とは、高エネルギー放射線を用いてガン細胞を殺す治療をいう。ここで、放射線とは、エネルギーが空間を通して伝搬現象又は電波を媒介する物質を示し、Ｘ線が代表的な例である。
【０００３】
放射線治療は、外科的手術、坑ガン化学療法と共に、ガン治療の３代治療法の１つとして、普通入院することなく、１日を基準に数分から２０〜３０分程度の時間を必要とし、治療時に苦痛を伴わないという長所がある。
【０００４】
このような放射線治療に関する装備として、Ｘ−Ｋｎｉｆｅ（Ｒａｄｉｏｎｉｃｓ、ＵＳＡ）、Ｎｏｖａｌｉｓ  Ｔｘ（ＢｒａｉｎＬＡＢ、Ｇｅｒｍａｎｙ）、Ｐｅａｃｏｋ（ＮＯＭＯＳ  Ｃｏｒｐ、ＵＳＡ）、Ｔｒｉｌｏｇｙ（Ｖａｒｉａｎ  Ｍｅｄｉｃａｌ  Ｓｙｓｔｅｍ、ＵＳＡ）、ＣｙｂｅｒＫｎｉｆｅ（Ａｃｃｕｒａｙ  Ｉｎｃ．ＵＳＡ）などが知られており、その大部分は、線形加速器と画像誘導放射線治療（Ｉｍａｇｅ  Ｇｕｉｄｅｄ  Ｒａｄｉｏｔｈｅｒａｐｙ：ＩＧＲＴ）の技術に基づいて治療時に発生する誤差を減らし、正確度を高める方案に進んでいる。
【０００５】
前記装備のうち、サイバーナイフ（ＣｙｂｅｒＫｎｉｆｅ）は、小型の線形加速器を６個の関節に自由に動いているロボットアームに装着して様々な方向に腫瘍部位に放射線を集中照射する、精密度の極めて高い定位放射線治療の専用装備である。
【０００６】
サイバーナイフは、浸湿的な固定機構なしでリアルタイムに映像誘導技術を用いて身体の骨格映像及び身体内に挿入される金針の座標を追跡することで、精密に治療できる長所がある。また、脳腫瘍だけを治療することのできるガンマナイフとは異なって、全身のガン治療にも用いられ、一回ではない数回にかけて分割治療する場合も多い。
【０００７】
最近、サイバーナイフに対する研究が盛んに行われ、２００９年４月３０日に出願された先行文献ＫＲ第２００９−００３８０５１号では、放射線治療計画情報統合照会システムが開示されている。
【発明の概要】
【発明が解決しようとする課題】
【０００８】
一実施形態に係る目的は、コンパクトな設計を備え、総重量を減少することのできるロボットを提供する。
【０００９】
一実施形態に係る目的は、制御が容易で、ターゲットに対する方向性を向上させるロボットを提供する。
【００１０】
一実施形態に係る目的は、ターゲットに向かって迅速かつ正確に狙って、治療又は手術時間を短縮させるロボットを提供する。
【００１１】
一実施形態に係る目的は、駆動部の作動時にリンク部材間の相互衝突を防止することのできるロボットを提供する。
【００１２】
一実施形態に係る目的は、第２リンク部材の端部又は放出部材に追加的な角度調整要素が備えられ、放出部材がターゲットに向かう角度を効率よく調整できるロボットを提供する。
【課題を解決するための手段】
【００１３】
上記のような目的を達成するための一実施形態に係るロボットは、複数のリンク部材を備えるリンク部と、前記リンク部材を回転させる駆動部とを含み、前記リンク部材の端部の前記駆動部の回転軸は同じ地点で接することができる。
【００１４】
一実施形態によると、前記リンク部は、第１リンク部材と、前記第１リンク部材の端部に接続した第２リンク部材とを含んでもよい。
【００１５】
一実施形態によると、前記第１リンク部材及び前記第２リンク部材は弧状に備えられ、前記第１リンク部材及び前記第２リンク部材は同心球上にそれぞれ位置してもよい。
【００１６】
一実施形態によると、前記駆動部は、前記第１リンク部材の一端に取り付けられ、第１回転軸を中心に前記第１リンク部材を回転させる第１駆動部材と、前記第１リンク部材の他端に取り付けられ、第２回転軸を中心に前記第２リンク部材を回転させる第２駆動部材とを含んでもよい。
【００１７】
一実施形態によると、前記第２リンク部材の他端には、ターゲットに向かうように取り付けられた放出部材が設けられてもよい。
【００１８】
前記の目的を達成するための一実施形態に係るロボットは、第１リンク部材と、前記第１リンク部材の一端に取り付けられ、第１回転軸を中心に前記第１リンク部材を回転させる第１駆動部材と、前記第１リンク部材の他端に接続する第２リンク部材と、前記第１リンク部材と前記第２リンク部材との間に配置し、第２回転軸を中心に前記第２リンク部材を回転させる第２駆動部材と、前記第２リンク部材の端部に取り付けられてターゲットに向かう放出部材とを含み、前記第１回転軸及び前記第２回転軸は、前記ターゲットで接することができる。
【００１９】
一実施形態によると、前記第１リンク部材及び前記第２リンク部材は弧状に設けられ、前記第１リンク部材及び前記第２リンク部材は、前記ターゲットを中心にする同心球上にそれぞれ位置してもよい。
【００２０】
一実施形態によると、前記第２リンク部材又は前記放出部材には角度調整要素が取り付けられ、前記放出部材が前記ターゲットに向かう角度を調整してもよい。
【発明の効果】
【００２１】
一実施形態に係るロボットは、コンパクトな設計を備え、総重量を減少することができる。
【００２２】
一実施形態に係るロボットは、制御が容易で、ターゲットに対する方向性を向上させ得る。
【００２３】
一実施形態に係るロボットは、ターゲットに向かって迅速かつ正確に狙って、治療又は手術時間を短縮させ得る。
【００２４】
一実施形態に係るロボットは、駆動部の作動時にリンク部材間の相互衝突を防止することができる。
【００２５】
一実施形態に係るロボットは、第２リンク部材の端部又は放出部材に追加的な角度調整要素が備えられ、放出部材がターゲットに向かう角度を効率よく調整することができる。
【図面の簡単な説明】
【００２６】
【図１】一実施形態に係るロボットの正面図である。
【図２】一実施形態に係るロボットで回転軸が同じ地点で接する形状を示す。
【図３】一実施形態に係るロボットの放出部材に角度調整要素が取り付けられた形状を示す。
【図４】一実施形態に係るロボットの放出部材によって放射線が照射される範囲を示す。
【図５】一実施形態に係るロボットで放出部材の方向を示す。
【図６】球面座標を示す。
【発明を実施するための形態】
【００２７】
以下、本発明に係る実施形態を添付する図面を参照しながら詳細に説明する。しかし、本発明が実施形態によって制限されたり限定されることはない。各図面に提示された同一の参照符号は同一の部材を示す。
【００２８】
図１は、一実施形態に係るロボットの正面図であり、図２は、一実施形態に係るロボットで回転軸が同じ地点で接する形状を示し、図３は、一実施形態に係るロボットの放出部材に角度調整要素が取り付けられた形状を示し、図４は、一実施形態に係るロボットの放出部材によって放射線が照射される範囲を示す。
【００２９】
図１を参照すると、一実施形態に係るロボット１０は、リンク部１００及び駆動部２００を含む。
【００３０】
前記リンク部１００は複数のリンク部材を備え、複数のリンク部材は、第１リンク部材１１０及び第２リンク部材１２０を備えている。
【００３１】
前記第１リンク部材１１０及び第２リンク部材１２０は互いに接続してもよい。
【００３２】
具体的に、第１リンク部材１１０及び第２リンク部材１２０は、駆動部２００を挟んで接続されてもよい。
【００３３】
また、第１リンク部材１１０及び第２リンク部材１２０は、それぞれ同心球上に弧状に位置してもよい。
【００３４】
例えば、第１リンク部材１１０は大きい同心球上に位置する弧であってもよく、第２リンク部材１２０は小さい同心球上に位置する弧であってもよく、第１リンク部材１１０及び第２リンク部材１２０は、放射状に離隔する位置から離れて位置してもよい。
【００３５】
そして、第１リンク部材１１０及び第２リンク部材１２０は互いに異なる長さを有し、例えば、第１リンク部材１１０は第２リンク部材１２０よりも大きい長さを有してもよい。これによって、第１リンク部材１１０内で第２リンク部材１２０が回転するとき、第１リンク部材１１０及び第２リンク部材１２０の相互衝突を防止することができる。
【００３６】
しかし、第１リンク部材１１０及び第２リンク部材１２０の形状及び配置はこれに限定することなく、第１リンク部材１１０及び第２リンク部材１２０が駆動部２００の作動によって回転しながら相互衝突しなければ、いずれの形状も可能である。
【００３７】
前記第１リンク部材１１０及び第２リンク部材１２０には、第１リンク部材１１０及び第２リンク部材１２０を回転させるための駆動部２００が取り付けられてもよい。
【００３８】
前記駆動部２００は、第１駆動部材２１０及び第２駆動部材２２０を含む。
【００３９】
前記第１駆動部材２１０は、第１リンク部材１１０の一端に取り付けられ、例えば、第１リンク部材１１０は、第１駆動部材１２０の上部に取り付けられてもよい。
【００４０】
特に、図２を参照すると、第１駆動部材２１０は、第１回転軸Ｘ１を中心に第１リンク部材１１０を回転させる。例えば、第１駆動部材２１０の長手方向の中心軸が第１回転軸Ｘ１と一致する場合、第１リンク部材１１０は、第１駆動部材２１０の長手方向の中心軸を中心に回転してもよい。
【００４１】
前記第２駆動部材２２０は、第１リンク部材１１０の他端に取り付けられてもよい。
【００４２】
例えば、第１リンク部材１１０と第２駆動部材２２０との間に段差を連結するための接続要素１１２がある場合、第２駆動部材２２０は接続要素１１２に取り付けられてもよい。
【００４３】
ここで、接続要素１１２は第２駆動部材２２０と同軸に配置し、第２駆動部材２２０の上端部に接するように配置してもよい。
【００４４】
そして、第２駆動部材２２０は、第２リンク部材１２０の一端に取り付けられ、例えば、第２リンク部材１２０は、第２駆動部材２２０の下部に取り付けられてもよい。
【００４５】
また、第２駆動部材２２０は、第２回転軸Ｘ２を中心に第２リンク部材１２０を回転させる。例えば、第２駆動部材２２０の長手方向の中心軸が第２回転軸Ｘ２と一致する場合、第２リンク部材１２０は、第２駆動部材２２０の長手方向の中心軸を中心に回転してもよい。
【００４６】
前記第１回転軸Ｘ１と第２回転軸Ｘ２は、延長して同じ地点で接することができる。
【００４７】
具体的に、第１回転軸Ｘ１が垂直方向に形成される場合、第２回転軸Ｘ２は第１回転軸Ｘ１に対してα°だけ傾斜するように形成される。言い換えると、第１回転軸Ｘ１と第２回転軸Ｘ２との間の角度はα°である。
【００４８】
ここで、第１リンク部材１１０の両端部に備えられている第１回転軸Ｘ１と第２回転軸Ｘ２が接する同じ地点は、第１リンク部材１１０及び第２リンク部材１２０が位置する同心球の中心点０である。
【００４９】
これによって、後述する放出部材３００が第２リンク部材１２０に取り付けられている場合、放出部材３００がターゲットに向かって容易に狙うことができる。
【００５０】
このように駆動部２００は、第１駆動部材２１０及び第２駆動部材２２０によって２つの自由度を備え、放出部材３００を球形に移動させることができる。ここで、必要なモータ数は２個で、比較的に少ない数のモータを必要とし、ロボット１０の総重量を減少させ得る。
【００５１】
そして、第１リンク部材１１０及び第２リンク部材１２０が第１回転軸Ｘ１と第２回転軸Ｘ２に基づいて互いに異なる領域で回転させることができるため、第１駆動部材２１０と第２駆動部材２２０によって第１リンク部材１１０及び第２リンク部材１２０がアクセスする領域を拡張することができる。そのため、リンク部１００のターゲットに対する方向性を向上させ得る。
【００５２】
また、第２リンク部材１２０の他端には放出部材３００が備えられてもよい。
【００５３】
以下、放出部材３００を放射線治療のために放射線を照射する線形加速器を例に挙げて説明することにする。
【００５４】
しかし、放出部材３００はこれに限定することなく、液体又は気体を含む他の物質を放出してもよい。
【００５５】
前記第２リンク部材１２０は、放出部材３００の中央部分に取り付けられてもよく、放出部材３００は、第２リンク部材１２０の端部の接線方向に沿って垂直に位置してもよい。
【００５６】
また、放出部材３００の下端部から放射線又はその他の物質が放出されてもよく、放出部材３００が傾いた角度に応じて、放射線又はその他の物質が放出される角度は変化し得る。
【００５７】
再び図２を参照すると、放出部材３００は、第２回転軸Ｘ２に対してβ°だけ傾斜するように位置し、第１回転軸Ｘ１に対してα°＋β°だけ傾斜するように位置してもよい。
【００５８】
ここで、α及びβは、第１リンク部材１１０及び第２リンク部材１２０が第１駆動部材２１０と第２駆動部材２２０によって円滑に回転し、広い領域にわたって放出部材３００が狙うことができるように選択される。
【００５９】
そして、放出部材３００で放射線が放出する部分が第３軸Ｘ３上に位置し、放出部材３００から放射線は第３軸Ｘ３に沿って放出又は照射されてもよい。
【００６０】
前記第３軸Ｘ３も第１回転軸Ｘ１及び第２回転軸Ｘ２と同様に、同心球の中心点０で接する。
【００６１】
すなわち、第１回転軸Ｘ１、第２回転軸Ｘ２及び第３軸Ｘ３は全て第１リンク部材１１０及び第２リンク部材１２０の同心球中心点０で接することになる。
【００６２】
したがって、前述したリンク部１００及び駆動部２００によって放出部材３００を介して放射線が照射される地点を調整することができる。
【００６３】
さらに、図３を参照すると、第２リンク部材１２０の端部又は放出部材３００には追加的な角度調整要素３１０が備えられてもよい。
【００６４】
前記角度調整要素３１０は、放出部材３００と第２リンク部材１２０が接する地点に取り付けられ、放出部材３００は、第３軸Ｘ３を中心に矢印方向に動き、ヨーイング動き（ｙａｗｉｎｇ  ｍｏｖｅｍｅｎｔ）を有してもよい。
【００６５】
このように角度調整要素３１０を備え、放出部材３００は小さい角度の動きが可能であるため、駆動部２００によって放出部材３００がターゲットに向かって狙われた後、微細な角度調整が必要な場合に有効に使える。
【００６６】
また、一実施形態に係るロボット１０は制御部（図示せず）をさらに含み、前記制御部によって第１駆動部材２１０及び第２駆動部材２２０を容易に制御することができる。
【００６７】
具体的に、放出部材３００がターゲットに向かうように、第１駆動部材２１０又は第２駆動部材２２０を選択的又は同時的に作動させ、必要に応じて角度調整要素３１０を作動させ得る。
【００６８】
また、第１駆動部材２１０又は第２駆動部材２２０の作動を制御し、第１リンク部材１１０又は第２リンク部材１２０の回転速度又は回転方向を調整してもよい。これにより、放射線によって手術又は治療する時間を短縮することができる。
【００６９】
このように構成された一実施形態に係るロボット１０は、次のように作動する。
【００７０】
まず、第１駆動部材２１０又は第２駆動部材２２０を作動させて第１リンク部材１１０又は第２リンク部材１２０を回転させる。
【００７１】
ここで、第１リンク部材１１０及び第２リンク部材１２０は同心球上にそれぞれ位置し、互いに異なる回転軸Ｘ１、Ｘ２に基づいて相対回転するため、第１リンク部材１１０及び第２リンク部材１２０は互いに衝突することなく、円滑に回転することができる。
【００７２】
さらに、第１駆動部材２１０と第２駆動部材２２０は、同時的又は選択的に作動するため、第１駆動部材２１０と第２駆動部材２２０が共に作動して、第１リンク部材１１０及び第２リンク部材１２０が共に回転したり、第１駆動部材２１０を作動させて第１リンク部材１１０を回転させた後、第２駆動部材２２０を作動させて第２リンク部材１２０を回転させることができる。
【００７３】
このように、第１リンク部材１１０及び第２リンク部材１２０の回転により、第２リンク部材１２０の端部に取り付けられた放出部材３００は球状に形移動してもよい。
【００７４】
また、角度調整要素３１０を選択的に作動してもよい。
【００７５】
角度調整要素３１０は、放出部材３００が第３軸Ｘ３を基準にしてヨーイング動きを行って微細に角度調整を可能にする。
【００７６】
その次に、放出部材３００を介して放射線を照射する。
【００７７】
ここで、放射線はターゲットＴ、例えば、患者の患部を治療するために用いてもよい。
【００７８】
図４に示すように、放出部材３００は、Ａ領域内で放射線を放出又は照射することができる。
【００７９】
具体的に、Ａ領域は、第１リンク部材１１０が第１駆動部材２１０によって第１回転軸Ｘ１を基準にして回転する領域と、第２リンク部材１２０が第２駆動部材２２０によって第２回転軸Ｘ２を基準にして回転する領域とを含む。
【００８０】
第１駆動部材２１０と第２駆動部材２２０が同時に作動する場合、放出部材３００はＡ領域内で自由に調整される。
【００８１】
このように、第１駆動部材２１０及び第２駆動部材２２０の作動により放出部材３００は、ターゲットＴ又は治療部位に向かって狙うことができ、ターゲットＴに向かって放出部材３００からの放射線は集中される。
【００８２】
もし、治療中に放出部材３００の位置を移動させる必要がある場合、制御部を用いて第１駆動部材２１０、第２駆動部材２２０又は角度調整要素３１０を制御することで、より迅速かつ正確に実行でき、放出部材３００の位置移動後に微細調整が必要な場合、角度調整要素３１０の制御により行うことができる。
【００８３】
このような実施形態に係るロボットは、ターゲットに向かって迅速かつ正確に狙って、治療又は手術時間を短縮させることができ、制御が容易で、ターゲットに対する方向性を向上させることができ、コンパクトな設計を備え、総重量を減少させ得る。さらに、駆動部の作動時にリンク部材間の相互衝突を防止することができ、第２リンク部材の端部又は放出部材に追加的な角度調整要素が備えられ、放出部材から物質が放出される角度又は放出部材がターゲットに向かう角度を調整できる。
【００８４】
以下は、一実施形態に係るロボット１０の構造の運動学的な分析について詳細に説明する。
【００８５】
まず、ロボットアームの順運動学（ｆｏｒｗａｒｄ  ｋｉｎｅｍａｔｉｃｓ）は次の通りである。
【００８６】
【数１】
2016519001.tif 000003
【００８７】
ここで、θはジョイント角度であり、Χはエンドエフェクタ（ｅｎｄ−ｅｆｆｅｃｔｏｒ）位置及び方向を示す。
【００８８】
このように、リンク部材が互いに接続した角度に応じて放出部材の座標を予測することができる。
【００８９】
また、デナビット−ハーテンバーグ（Ｄｅｎａｖｉｔ−Ｈａｒｔｅｎｂｅｒｇ、Ｄ−Ｈ）表示法を用いて表現する場合、ロボットの運動学はリンク部材のリンクの長さ（ａ）、リンクオフセット（ｄ）、リンクゆがみ（α）、及びジョイント角度（θ）のように４個の媒介変数からなる。
【００９０】
ここで、ジョイントがｚ軸周辺で回転する場合、その変換行列（ｔｒａｎｓｆｏｒｍａｔｉｏｎ  ｍａｔｒｉｘ）は次の通りである。
【００９１】
【数２】
2016519001.tif 000004
【００９２】
【数３】
2016519001.tif 000005
【００９３】
ここで、ｓとｃはそれぞれサイン（ｓｉｎｅ）とコサイン（ｃｏｓｉｎｅ）を示す。
【００９４】
上記の２つの変換行列により、次のような変換行列が導き出される。
【００９５】
【数４】
2016519001.tif 000006
【００９６】
上記の変換行列は２つのリンク部材を備える場合を示し、変換行列によって３次元座標上でいずれか１つの点が移動（ｔｒａｎｓｌａｔｉｏｎ、ｏｆｆｓｅｔ）、大きさ（ｓｃａｌｅ）、回転によりいずれかの点に移動したかを予測することができる。
【００９７】
また、エンドエフェクタ、または放出部材３００の位置及び方向は次の通りである。
【００９８】
【数５】
2016519001.tif 000007
【００９９】
【数６】
2016519001.tif 000008
【０１００】
ここで、エンドエフェクタ又は放出部材３００の位置は常に一定である。
【０１０１】
図５は、一実施形態に係るロボットで放出部材３００の方向を示す。
【０１０２】
図５を参照すると、放出部材３００はｚ軸に向かい、ｚ軸を基準にして回転するロール（ｒｏｌｌ）、ｚ軸を基準にして上下に振動するヨー（ｙａｗ）、及びｚ軸を基準にして上下に回転するピッチ（ｐｉｔｃｈ）の動きを含んでもよい。
【０１０３】
ここで、ロール方向は放出部材３００において重要ではない。
【０１０４】
そして、単に放出部材３００の方向のためにはｚ−ベクトル（ｖｅｃｔｏｒ）のみを考慮する。
それにより、変換行列（３）は次のように整理される
【０１０５】
【数７】
2016519001.tif 000009
【０１０６】
一方、放出部材３００の所望する方向は、図６に示す球面座標（ｓｐｈｅｒｉｃａｌ  ｃｏｏｒｄｉｎａｔｅ）のα及びβ値に指定してもよい。このように図６に示すα及びβ値に方向が与えられた場合、その方向に該当する回転行列は次の通りである。
【０１０７】
【数８】
2016519001.tif 000010
【０１０８】
【数９】
2016519001.tif 000011
【０１０９】
回転行列（８）及び（９）からα及びβを用いて０χ２＝［χ１，χ２，χ３］Ｔ，０ｙ２＝ｙ１，ｙ２，ｙ３］Ｔ，０ｚ２＝［ｚ１，ｚ２，ｚ３］Ｔを決定し、さらにθ１、θ２を決定してもよい。
【０１１０】
このような関係を逆運動学（ｉｎｖｅｒｓｅ  ｋｉｎｅｍａｔｉｃｓ）に表示すると次の通りである。
【０１１１】
【数１０】
2016519001.tif 000012
【０１１２】
ここで、ｘはベクトル０ｚ２＝［ｚ１，ｚ２，ｚ３］Ｔであり、θはθ１、θ２からなるベクトルである。そして、数式（１０）は数式（１）の逆関数である。
【０１１３】
直交正規ベクトルの０χ２，０ｙ２，０ｚ２を考慮してジョイント角度であるθ１、θ２を把握することができる。このようなベクトルを算出する直観的な方法は、球面座標を用いるものであり、α及びβ値に方向が与えられた場合、その方向に該当する回転行列は次のように示す。
【０１１４】
【数１１】
2016519001.tif 000013
【０１１５】
ここで、ベクトルの構成要素は０χ２＝［χ１，χ２，χ３］Ｔ，０ｙ２＝［ｙ１，ｙ２，ｙ３］Ｔ，０ｚ２＝［ｚ１，ｚ２，ｚ３］Ｔである。
【０１１６】
変換行列（４）から次の等式が抽出される。
【０１１７】
【数１２】
2016519001.tif 000014
【０１１８】
ここで、θ２が次のように誘導されてもよい。
【０１１９】
【数１３】
2016519001.tif 000015
【０１２０】
２つの入力変数を有するアークタン（ａｒｃｔａｎ）関数であるアークタン２関数は、ゼロ入力値に近接する安定性及び最終的な角度が適切な四分面に復元する特性を有するため使用される。
【０１２１】
θ１の値は次のように算出されてもよい。
【０１２２】
変換行列（５）から次の数式を取得することができる。
【０１２３】
【数１４】
2016519001.tif 000016
【０１２４】
【数１５】
2016519001.tif 000017
【０１２５】
【数１６】
2016519001.tif 000018
【０１２６】
また、次のように仮定してもよい。
【０１２７】
【数１７】
2016519001.tif 000019
【０１２８】
数式（１６）及び（１７）により次のように算出されてもよい。
【０１２９】
【数１８】
2016519001.tif 000020
【０１３０】
すなわち、数式（１５）及び（１８）により次のような値を取得できる。
【０１３１】
【数１９】
2016519001.tif 000021
【０１３２】
数式（１３）及び（１９）から２つのジョイント角θ１、θ２を決定する。
【０１３３】
最後に、ヤコビアン（ｊａｃｏｂｉａｎ）行列について説明する。
【０１３４】
θ−空間とχ−空間の間の線形マッピングは次の通りである。
【０１３５】
数式（１）を微分すれば次の通りである。
【０１３６】
【数２０】
2016519001.tif 000022
【０１３７】
【数２１】
2016519001.tif 000023
【０１３８】
そして、変換行列（２）は次の通りである。
【０１３９】
【数２２】
2016519001.tif 000024
すなわち、ヤコビアン行列は次の通りである。
【０１４０】
【数２３】
2016519001.tif 000025
【０１４１】
【数２４】
2016519001.tif 000026
【０１４２】
したがって、ヤコビアン行列は次の通りである。
【０１４３】
【数２５】
2016519001.tif 000027
【０１４４】
行列（２５）により、単なる角速度のみが考慮され、並進的な速度は考慮されることなく、α＝ｎπ、ｎ∈Ｎである場合を除いては、唯一性を有することはできない。
【０１４５】
このようにヤコビアン行列を用いて、リンク部材のジョイント速度と放出部材の速度との間の関係が決定されるため、リンク部材のジョイント速度に応じて放出部材の移動速度を予測できるだけではなく、放出部材の所望する速度が与えられれば、それを可能にするリンク部材のジョイント速度を逆算することができる。
【０１４６】
具体的に、リンク部材の現在位置に応じて放出部材の位置を予測することができ、それとは反対に、放出部材が中心点又はターゲットに向かうようにするため、放出部材の現在位置に応じてリンク部材の作動を制御することができる。
【０１４７】
上述したように本発明の実施形態では、多様なコンピュータ手段を介して様々な処理を実行することができるプログラム命令の形態で実現され、コンピュータで読取可能な記録媒体に記録されてもよい。コンピュータ読取可能な媒体は、プログラム命令、データファイル、データ構造などのうち１つまたはその組合せを含んでもよい。媒体に記録されるプログラム命令は、本発明の目的のために特別に設計されて構成されたものでもよく、コンピュータソフトウェア分野の技術を有する当業者にとって公知のものであり、使用可能なものであってもよい。コンピュータ読取可能な記録媒体の例としては、ハードディスク、フロッピー（登録商標）ディスク及び磁気テープのような磁気媒体、ＣＤ−ＲＯＭ、ＤＶＤのような光記録媒体、光ディスクのような光磁気媒体、及びＲＯＭ、ＲＡＭ、フラッシュメモリなどのようなプログラム命令を保存して実行するように特別に構成されたハードウェア装置が含まれてもよい。プログラム命令の例には、コンパイラによって作られるような機械語コードだけでなく、インタープリタなどを用いてコンピュータによって実行できる高級言語コードが含まれる。前記したハードウェア装置は、本発明の動作を行うために１つ以上のソフトウェアモジュールとして動作するように構成されてもよく、その逆も同様である。
【０１４８】
上述したように、本発明を限定された実施形態と図面によって説明したが、本発明は、上記の実施形態に限定されることなく、本発明が属する分野における通常の知識を有する者であれば、このような実施形態から多様な修正及び変形が可能である。
【０１４９】
したがって、本発明の範囲は、開示された実施形態に限定されるものではなく、特許請求の範囲だけではなく特許請求の範囲と均等なものなどによって定められるものである。
【符号の説明】
【０１５０】
１０：ロボット
１００：リンク部
１１０：第１リンク部材
１１２：接続要素
１２０：第２リンク部材
２００：駆動部
２１０：第１駆動部材
２２０：第２駆動部材
３００：放出部材
３１０：角度調整要素
Ｘ１：第１回転軸
Ｘ２：第２回転軸
Ｘ３：第３軸
【図１】
2016519001.tif 000028
【図２】
2016519001.tif 000029
【図３】
2016519001.tif 000030
【図４】
2016519001.tif 000031
【図５】
2016519001.tif 000032
【図６】
2016519001.tif 000033
【国際調査報告】
2016519001.tif 000034
2016519001.tif 000035
2016519001.tif 000036