JP5200582B2 - 長軸部を有する物体の長軸部の先端座標と該物体の位置姿勢を定義する手段との3次元相対関係測定方法およびシステム - Google Patents
長軸部を有する物体の長軸部の先端座標と該物体の位置姿勢を定義する手段との3次元相対関係測定方法およびシステム Download PDFInfo
- Publication number
- JP5200582B2 JP5200582B2 JP2008045332A JP2008045332A JP5200582B2 JP 5200582 B2 JP5200582 B2 JP 5200582B2 JP 2008045332 A JP2008045332 A JP 2008045332A JP 2008045332 A JP2008045332 A JP 2008045332A JP 5200582 B2 JP5200582 B2 JP 5200582B2
- Authority
- JP
- Japan
- Prior art keywords
- dimensional
- measured
- dimensional shape
- marker
- relative relationship
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Description
この手術支援(手術ナビゲーション)においては体内に挿入した手術器具の位置姿勢を正確に検出することが必要であるが、この方法として例えば以下の特許文献1(特開2007−209531号公報)に記載されたように、手術器具の体外に出ている箇所に少なくとも3つの定点を定義可能な物体を取り付け、手術の期間中、人体および手術器具の3次元形状を測定し続け、3次元形状データを処理することで少なくとも3つの定点座標を検出し、検出した定点座標から手術器具の位置姿勢を検出する方法がある。
この方法においてはあらかじめ手術器具を3次元形状測定して手術器具の3次元形状データと少なくとも3つの定点座標とを取得して記憶し、手術の期間中の3次元形状測定から検出した少なくとも3つの定点座標と記憶している少なくとも3つの定点座標から座標変換係数を算出し、算出した座標変換係数を用いて記憶している手術器具の3次元形状データを座標変換して、同一座標系で人体の3次元形状データと手術器具の3次元形状データとを得ている。
この方法は手術器具の3次元形状測定を精度よく行えば、手術の期間中は少なくとも3つの定点座標を精度よく取得するのみで高精度で手術器具の位置姿勢を検出することができる。
特許文献1には、本発明者らによる手術支援システムが記載されおり、手術器具に位置姿勢検出用の標識部(図1および2の球体36A)を設けることも記載されている。この特許文献1においては、前記標識部と手術器具の先端との3次元相対関係は既にわかっていることを前提にしている。しかしながら、仮に予め体内挿入器具(手術器具)の先端部と位置姿勢検出用の標識部との3次元相対関係が正確にわかっていたとしても、実際には使用のたびに器具の先端部が少しずつ変形している可能性が高く、長期間の間に前記3次元相対関係が変化し、精度の高い手術をすることが困難になるという問題がある。
特許文献2には、手術支援システムにおける手術器具の追跡アセンブリ90(位置姿勢を定義する手段)と先端部との相対位置を追跡アセンブリ100を用いて較正することが示唆されている。これによれば定期的に較正を行うことで特許文献1における上記問題点はなくなる。しかしながら、特許文献2においては、前記追跡アセンブリ90,100の追跡要素95,102はLEDを用いているため、前記手術器具の位置および姿勢を検出するためには、患者の表面形状を測定する3次元形状測定装置とは別の位置検出装置が必要であるという問題がある。
3次元形状測定装置と、
長軸部と、前記3次元形状測定装置により位置および姿勢が測定可能な第1標識部とを有する被測定物体と、
前記被測定物体の長軸部の先端部に着脱自在であって、前記被測定物体の長軸部の先端部と当接する当接部と、前記3次元形状測定装置により位置および立体形状が測定可能な第2標識部とを有し、前記当接部と前記第2標識部との3次元相対関係が予めわかっているか、または前記3次元形状測定装置により前記当接部と前記第2標識部との3次元相対関係が測定可能な較正用物体と、
を有する3次元形状測定システムにおける、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を測定する3次元相対関係測定方法であって、
前記較正用物体を、前記被測定物体の長軸部の先端部に取付けるステップと、
前記3次元形状測定装置により、前記被測定物体および前記較正用物体の立体形状データ群を測定するステップと、
前記立体形状データ群から、前記第1標識部の位置および姿勢と前記第2標識部の位置および立体形状とを算出するステップと、
前記第2標識部の位置および立体形状と、前記当接部と前記第2標識部との3次元相対関係とに基づいて、前記当接部の3次元座標を算出するステップと、
前記第1標識部の位置および姿勢と、前記当接部の3次元座標とに基づいて、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を算出するステップと、
を有する、3次元相対関係測定方法。
3次元形状測定装置と、
長軸部と、前記3次元形状測定装置により位置および姿勢が測定可能な第1標識部とを有する被測定物体と、
前記被測定物体の長軸部の先端部に着脱自在であって、前記被測定物体の長軸部の先端部と当接する当接部と、前記3次元形状測定装置により位置および立体形状が測定可能な第2標識部とを有し、前記当接部と前記第2標識部との3次元相対関係が予めわかっているか、または前記3次元形状測定装置により前記当接部と前記第2標識部との3次元相対関係が測定可能な較正用物体と、
を有する3次元形状測定システムにおける、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を測定する3次元相対関係測定プログラムであって、
前記較正用物体を前記被測定物体の長軸部の先端部に取付けた状態で、前記3次元形状測定装置により、前記被測定物体および前記較正用物体の立体形状データ群を測定するステップと、
前記立体形状データ群から、前記第1標識部の位置および姿勢と前記第2標識部の位置および立体形状とを算出するステップと、
前記第2標識部の位置および立体形状と、前記当接部と前記第2標識部との3次元相対関係とに基づいて、前記当接部の3次元座標を算出するステップと、
前記第1標識部の位置および姿勢と、前記当接部の3次元座標とに基づいて、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を算出するステップと、
を有する、3次元相対関係測定プログラム。
3次元形状測定装置と、
長軸部と、前記3次元形状測定装置により位置および姿勢が測定可能な第1標識部とを有する被測定物体と、
前記被測定物体の長軸部の先端部に着脱自在であって、前記被測定物体の長軸部の先端部と当接する当接部と、前記3次元形状測定装置により位置および立体形状が測定可能な第2標識部とを有し、前記当接部と前記第2標識部との3次元相対関係が予めわかっているか、または前記3次元形状測定装置により前記当接部と前記第2標識部との3次元相対関係が測定可能な較正用物体と、を有し、
前記較正用物体を前記被測定物体の長軸部の先端部に取付けた状態で、前記3次元形状測定装置により、前記被測定物体および前記較正用物体の立体形状データ群を測定する手段と、
前記立体形状データ群から、前記第1標識部の位置および姿勢と前記第2標識部の位置および立体形状とを算出する手段と、
前記第2標識部の位置および立体形状と、前記当接部と前記第2標識部との3次元相対関係とに基づいて、前記当接部の3次元座標を算出する手段と、
前記第1標識部の位置および姿勢と、前記当接部の3次元座標とに基づいて、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を算出する手段と、
を有する、3次元相対関係測定システム。
前記較正用物体の前記第2標識部は、予め立体形状がわかっており、前記当接部と前記第2標識部との3次元相対関係は、前記第2標識部の立体形状に関連するベクトルまたは定点位置と、前記当接部の相対位置との関係により定義される。
前記較正用物体の当接部と前記第2標識部の定点位置とは等しいか、または前記較正用物体の当接部は前記第2標識部における2つ以上の定点を用いて定義される点である。
前記較正用物体の当接部は、前記第2標識部における2つの定点を結んだ直線または前記第2標識部における定点とベクトルから定まる直線上において、定点から前記第2標識体の立体形状に関連する長さにより定まる点である。
前記較正用物体は、前記被測定物体の長軸部の先端部を挿入可能な細穴部を有している。
前記較正用物体は、球体、多面体、円柱、円錐のいずれかの形状を一部または全体に有している。
前記較正用物体は、前記被測定物体の長軸部の先端部を固定するために、少なくとも突起または空孔が形成されている。
前記被測定物体は体内挿入器具であって、前記長軸部は体内挿入部であり、前記第1標識部は体内に挿入されない部分に設けられている。
前記第2標識部は3次元形状測定装置により立体形状を測定できるものであれば何でも良い。前記較正用物体の立体形状そのものを第2標識部としても良いし、前記較正用物体の一部に球体などを取り付けて第2標識部としても良い。演算処理のスピードなどを考慮すると、較正用物体の一部に球体等の第2標識部を取り付ける方が好ましい。
本実施形態においては、長軸部を有する物体は手術器具10であるとする。
なお、球体12により少なくとも3つの定点を定義する方法が、後述する点群データから定点座標を算出するデータ処理が簡単に行えるため適切な方法であるが、位置および姿勢を定義することを可能にするものは、
・少なくとも2つの定点と1つのベクトル
・少なくとも1つの定点と2つのベクトル
が定義可能であってもよく。また定点やベクトルが定義可能な物体としては、球体以外に多面体、円柱、円錐等がある。
また直方体21の前面の中央部分には手術器具10の先端を刺し込むための突起(当接部)24がある。この突起24は円錐の途中を切り落とした形状であり、底面の径は手術器具10の先端の内径より僅かに小さく手術器具10の先端を刺し込んだときがたつきがない形状である。なお突起24は手術器具10の先端が円管状であることを想定した形状であり、先端がこの形状ではない場合は突起24の形状は手術器具10の先端の形状に合わせて定めればよい。また突起24の替わりに円柱状や円錐状の空孔がある物体を取り付け、手術器具10の先端を挿入するようにしてもよい。
また、突起24の回りには固定治具25が取り付けられている。固定治具25は円柱状で中心線の位置に円柱状の空孔があり、この空孔は手術器具10の先端の径よりやや大きく、この空孔に手術器具10が挿入され、手術器具10の先端位置が突起24に刺し込まれると手術器具10が固定されるようになっている。また固定治具25の空孔周りは弾力性のある物体でできており、手術器具10が変形するような力が加わらないようになっている。
また固定治具25はボルトで直方体21の前面に取り付けられており、後述するように手術器具10のセット位置(突起24の底面の中心位置)の座標と球体A22,球体B23の中心座標と直方体21の前面の法線ベクトル成分とを同一座標系で検出する際には取り除かれる。
図2(a)のように定点定義可能な物体20から固定治具25を取り除き、図2(b)のように円管の中心軸が球体の中心を通るように形成された球体C26を突起24に刺し込む。
この状態で3次元形状測定を行い、点群データを取得する。3次元形状測定の方向は、3つの球体22,23,26,直方体21の前面を測定できる方向であればどのような方向でもよい。
3次元形状測定は非接触で物体表面の点群データを取得することができるものであれば、どのような測定原理のものでもよい。
取得した点群データから、3つの球体22,23,26の点群データを抽出する。3つの球体22,23,26の径はコンピュータに記憶されており、球体という情報および径の数値を用いて抽出を行う。抽出方法は特開2004−333371号公報に詳細に記載されているのでそちらを参照する。抽出した点群データから球体の式(x−a)2+(y−b)2+(z−c)2=d2を最小2乗法により求める。(a,b,c)が球体の中心座標になる。
取得した点群データから3つの球体22,23,26の点群データを除いた残りの点群データの中で球体C26の中心座標の近傍にある一部の点群データを抽出し、平面の式a・x+b・y+c・z+1=0に代入して最小2乗法により係数a,b,cを計算する。次にすべての点群データから、この平面からの距離が所定の範囲内にある点群データを抽出する。このとき抽出された点群データが所定数以上あれば、最初に抽出した点群データはすべて直方体21の前面のものと判定して、抽出した点群データすべてを、平面の式a・x+b・y+c・z+1=0に代入して最小2乗法により係数a,b,cを計算する。
もし、抽出された点群データが所定数未満であれば、最初に抽出した点群データは直方体21の前面以外のもの含むと判定して、最初に抽出した点群データからより球体C26の中心座標の近傍にあるデータを抽出して同一の処理を行う。この処理を係数a,b,cが計算されるまで行う。
直方体21の前面の法線ベクトルは(a,b,c),(−a,−b,−c)の2つがあり、直方体21の前面から球体C26側に向かう法線ベクトルを選定する。それには、3次元形状測定器の原点座標から球体C26の中心座標に向かうベクトルA(ベクトル成分は球体C26の中心座標に等しい)と(a,b,c),(−a,−b,−c)の法線ベクトルをベクトルBとしたときの以下の内積の式から角度Θを計算し、角度Θが90度より大きい方の法線ベクトルを選定する。
A・B=|A|・|B|・COSΘ
球体C26の中心座標(xc,yc,zc)を通り、直方体21の前面の法線ベクトル(a,b,c)に平行な直線の方程式(x−xc)/a = (y−yc)/b = (z−zc)/cと、直方体21の前面の平面方程式a・x+b・y+c・z+1=0からなる連立方程式を解いてx,y,zを算出する。このx,y,zが、直線と直方体21の前面の交点座標であり、手術器具10のセット位置(突起24の底面の中心位置)の座標(xs,ys,zs)である。
ここまでの処理により球体A22,球体B23の中心座標(xa,ya,za),(xb,yb,zb),直方体21の前面の法線ベクトル(a,b,c),手術器具10のセット位置座標(xs,ys,zs)を同一座標系で得ることができる。この座標系を座標系Aとする。
図1のように定点定義可能な物体20に固定治具25を取り付け、手術器具10の先端を突起24に刺し込む。これで定点定義可能な物体20に手術器具10がセットされ固定される。
この状態で3次元形状測定を行い、点群データを取得する。3次元形状測定の方向は、定点定義可能な物体20の2つの球体22,23,直方体21の前面,手術器具10の複数の球体12を測定できる方向であればどのような方向でもよい。
取得した点群データから、上記(2)と同じ方法により定点定義可能な物体20の2つの球体22,23の中心座標(xa’,ya’,za’),(xb’,yb’,zb’)および手術器具10の複数の球体12の中心座標を計算する。
取得した点群データから球体22,23,12の点群データを除いた残りの点群データの中で一部の点群データを抽出し、平面の式a・x+b・y+c・z+1=0に代入して最小2乗法により係数a,b,cを計算する。次にすべての点群データから、この平面からの距離が所定の範囲内にある点群データを抽出する。このとき抽出された点群データが所定数以上あれば、最初に抽出した点群データは同一平面内のものと判定して、抽出した点群データすべてを、平面の式a・x+b・y+c・z+1=0に代入して最小2乗法により係数a,b,cを計算する。
もし、抽出された点群データが所定数未満であれば、最初に抽出した点群データは同一平面内のものではないと判定して、最初に抽出した点群データの隣の点群データを抽出して同一の処理を行う。この処理を係数a,b,cが計算されるまで行う。
次に2つの球体22,23の中心座標(xa’,ya’,za’),(xb’,yb’,zb’)の片方から片方へ向かうベクトルとベクトル(a,b,c)とがなす角度を内積の式から計算し、2つのベクトルがなす角度が90度に近いか否か判定する。90度に近ければ平面の式a・x+b・y+c・z+1=0は直方体21の前面のものと判定し、90度より離れていれば別の平面のものと判定して平面の式算出に使用した点群データを球体22,23,12の点群データを除いた残りの点群データから除き、残った点群データを用いて上記と同様の処理を行う。この処理を2つの球体の中心座標(xa’,ya’,za’),(xb’,yb’,zb’)の片方から片方へ向かうベクトルとベクトル(a,b,c)とがなす角度が90度に近いと判定するまで行う。
次に直方体21の前面の法線ベクトル(a,b,c),(−a,−b,−c)の内、直方体21の前面から手術器具10の複数の球体12側に向かう法線ベクトルの選定を上記(3)と同じ方法により行う。この場合は球体C26はないので、3次元形状測定器の原点座標から球体A22または球体B23の中心座標に向かうベクトルをベクトルAとすればよい。
算出した直方体21の前面の法線ベクトル(a’,b’,c’)とすると、ここまでの処理により球体A22,球体B23の中心座標(xa’,ya’,za’),(xb’,yb’,zb’),直方体21の前面の法線ベクトル(a’,b’,c’),手術器具10の複数の球体12の中心座標を同一の座標系で得ることができる。この座標系を座標系Bとする。
座標系Aでの球体A22,球体B23の中心座標(xa,ya,za),(xb,yb,zb)、直方体21の前面の法線ベクトル(a,b,c)と座標系Bでの球体A22,球体B23の中心座標(xa’,ya’,za’),(xb’,yb’,zb’)、直方体21の前面の法線ベクトル(a’,b’,c’)から座標系Aの座標を座標系Bの座標に座標変換する座標変換係数Fを計算する。計算は以下のように行う。
座標変換係数Fは、以下の式における回転成分Mと移動成分(α,β,γ)である。座標変換係数Fを計算するとは、回転成分Mのg11〜g33と移動成分α,β,γを計算することである。
上記式のx’,y’,z’に(xa’,ya’,za’)を代入し、x,y,zに(xa,ya,za)を代入した式と、上記式のx’,y’,z’に(xb’,yb’,zb’)を代入し、x,y,zに(xb,yb,zb)を代入した式と、上記式の移動成分(α,β,γ)を除いた式のx’,y’,z’に(a’,b’,c’)を代入し、x,y,zに(a,b,c)を代入した式により9つの式が成立する。
次に(xa’,ya’,za’)から(xb’,yb’,zb’)へ向かうベクトルとベクトル(a’,b’,c’)の外積によるベクトルの成分(d’,e’,f’)を計算し、(xa,ya,za)から(xb,yb,zb)へ向かうベクトルとベクトル(a,b,c)の外積によるベクトルの成分(d,e,f)を計算する。そして上記式の移動成分(α,β,γ)を除いた式のx’,y’,z’に(d’,e’,f’)を代入し、x,y,zに(d,e,f)を代入した式により3つの式が成立し、合わせて12の式が成立する。この12の式からg11〜g33が同じものを集めて連立方程式を作成し、この連立方程式を解くことによりg11〜g33およびα,β,γ
を計算することができる。詳細は特開2005−249402号公報の段落0104〜0118を参照する。
手術器具10のセット位置座標(xs,ys,zs)は座標系Aによる座標である。この座標を座標変換係数Fにより座標系Bによる座標(xs’,ys’,zs’)に座標変換する。
これらの座標を記憶しておけば、手術の期間中の3次元形状測定から検出した手術器具10の複数の球体12の中心座標と記憶している複数の球体12の中心座標とから座標変換係数を算出し、算出した座標変換係数を用いて記憶している手術器具10のセット位置座標(即ち先端座標)を座標変換すれば、同一座標系で人体の3次元形状データと手術器具10の先端座標を得ることができる。
上記実施形態は様々な変形が可能である。
1.変形例1
上記実施形態では定点定義可能な物体20として2つの大きさが異なる球体が取り付けられた直方体を用いたが、定点定義可能な物体20を以下の1)〜3)のようにし、定点定義可能な物体20における定点およびベクトル検出と座標変換係数の計算を以下のようにすることもできる。
上記実施形態の(2)と同じ方法により3つ以上ある球体の中心座標を座標系A,座標系Bで検出し、座標変換係数を3つ以上ある球体の中心座標を用いて計算する。座標変換係数の計算は球体が少なくと3つあれば可能であるので球体が3つより多くあるときは、それぞれの3つの組で計算した座標変換係数を平均する。計算は以下のように行う。
座標変換係数を計算するとは、上記実施形態の(8)で示したように、回転成分Mのg11〜g33と移動成分α,β,γを計算することである。座標系Aでの3つの球体の中心座標を(xa,ya,za),(xb,yb,zb),(xc,yc,zc)、座標系Bでの3つの球体の中心座標を(xa’,ya’,za’),(xb’,yb’,zb’),(xc’,yc’,zc’)とし、これらの座標を上記実施形態の(8)で示した式に代入すると9つの式が成立する。
次に(xa’,ya’,za’)から(xb’,yb’,zb’)へ向かうベクトルと(xb’,yb’,zb’)から(xc’,yc’,zc’)へ向かうベクトルとの外積によるベクトルの成分(d’,e’,f’)を計算し、(xa,ya,za)から(xb,yb,zb)へ向かうベクトルと(xb,yb,zb)から(xc,yc,zc)へ向かうベクトルとの外積によるベクトルの成分(d,e,f)を計算する。そして上記実施形態の(8)で示した式の移動成分(α,β,γ)を除いた式のx’,y’,z’に(d’,e’,f’)を代入し、x,y,zに(d,e,f)を代入した式により3つの式が成立し、合わせて12の式が成立する。この12の式からg11〜g33が同じものを集めて連立方程式を作成し、この連立方程式を解くことによりg11〜g33およびα,β,γを計算することができる。詳細は、特開2005−249402号公報の段落0063〜0080を参照する。
上記実施形態の(2)と同じ方法により1つの球体A22の中心座標を座標系A,座標系Bで検出する。
直方体21の前面と側面または上面の2つの法線ベクトルのベクトル成分の検出を以下の方法で行う。
・座標系A(定点定義可能な物体20に球体C26を取り付けての3次元測定)
上記実施形態の(3)と同じ方法により直方体21の前面の平面式および法線ベクトルを算出する。
次に直方体21の前面以外の点群データを用いて上記実施形態の(7)に書かれた平面の点群データ抽出と平面式の計算方法によりいずれかの平面の平面式を算出する。この平面と球体Aの中心座標との距離を計算した距離から平面が直方体21の側面か上面か直方体21が置かれた台の平面かを判定し、設定した平面の平面式が算出されるまで上記処理を繰り返す。平面式の係数a,b,cから法線ベクトル(a,b,c),(−a,−b,−c)が出るので、直方体21の平面から直方体21の外側に向かう法線ベクトルの選定を上記実施形態の(3)と同じ方法により行う。
・座標系B(定点定義可能な物体20に手術器具10をセットしての3次元測定)
上記実施形態の(7)に書かれた平面の点群データ抽出と平面式の計算方法によりいずれかの平面の平面式を算出する。この平面の法線ベクトルと手術器具10の複数の球体の1つ球体における中心座標から球体Aの中心座標へ向かうベクトルとがなす角度により平面式が直方体21の前面の平面か否かを判定する。この処理を直方体21の前面の平面式と判定されるまで行う。
次に上記の座標系Aの場合と同じ方法により直方体21の側面か上面の内、設定した平面の平面式を算出する。平面式の係数a,b,cから法線ベクトル(a,b,c),(−a,−b,−c)が出るので、直方体21の平面から直方体21の外側に向かう法線ベクトルの選定を上記実施形態の(3)と同じ方法により行う。この場合は球体C26はないので、3次元形状測定器の原点座標から球体A22の中心座標に向かうベクトルをベクトルAとする。
座標系A,座標系Bでの球体A22の中心座標と2つの平面の法線ベクトルとから座標変換係数を計算する。計算は以下のように行う。
座標変換係数を計算するとは、上記実施形態の(8)で示したように、回転成分Mのg11〜g33と移動成分α,β,γを計算することである。座標系Aでの球体の中心座標を(xa,ya,za),2つの法線ベクトルを(a1,b1,c1),(a2,b2,c2)とし、座標系Bでの球体の中心座標を(xa’,ya’,za’),2つの法線ベクトルを(a1’,b1’,c1’),(a2’,b2’,c2’)とし、これらの座標を上記実施形態の(8)で示した式に代入し、ベクトル成分を上記実施形態の(8)で示した式から移動成分(α,β,γ)を除いた式に代入すると9つの式が成立する。
次に(a1’,b1’,c1’)と(a2’,b2’,c2’)との外積によるベクトルの成分(d’,e’,f’)を計算し、(a1,b1,c1)と(a2,b2,c2)との外積によるベクトルの成分(d,e,f)を計算する。そして上記実施形態の(8)で示した式の移動成分(α,β,γ)を除いた式のx’,y’,z’に(d’,e’,f’)を代入し、x,y,zに(d,e,f)を代入した式により3つの式が成立し、合わせて12の式が成立する。この12の式からg11〜g33が同じものを集めて連立方程式を作成し、この連立方程式を解くことによりg11〜g33およびα,β,γを計算することができる。詳細は、特開2005−249402号公報の式(数19)における座標の座標変換の1つをベクトルの座標変換に変えるのみで段落0104〜0118に示される計算の仕方と同じである。
直方体21の前面と側面と上面でできる角の座標の算出と直方体21の前面と側面または上面の2つの法線ベクトルのベクトル成分の算出を以下の方法で行う。
上記実施形態の(7)に書かれた平面の点群データ抽出と平面式の計算方法により、複数の平面の平面式を可能な限り算出する。算出される平面式は直方体21の前面と側面と上面と直方体21が置かれた台の平面の平面式4つである。
法線ベクトルのなす角度を内積の式から算出し、互いに90度近い角度になる3つの平面の平面式でなる連立方程式を解いて3つの平面式でできる角の座標を計算する。計算される角の座標は直方体21の前面と側面と上面でできる角と、直方体21の前面と側面と直方体21が置かれた台の平面でできる角の2つである。
法線ベクトルのなす角度を内積の式から算出し、互いに90度近い角度になる2つの平面の平面式で直線の式を算出する。これにより5つの直線の式が計算される。
直線の式に点群データを代入して、直線の近傍にある点群データを抽出する。そして抽出した点群データの内、直線内にある角の座標からの距離が最も大きいものを抽出する。直方体21の3辺の長さが既知であれば、この距離から直線が直方体21のどの辺のものか判別できる。5つの直線の式すべてにおいてこの距離を計算して直方体21の3辺の直線の式を判別し、この直線の式を算出した平面式がいずれであるかより直方体21の前面と側面と上面と直方体21が置かれた台の平面の4つの平面式を判別する。
これにより直方体21の前面と側面と上面でできる角の座標の算出と直方体21の前面と側面または上面の2つの法線ベクトルのベクトル成分が算出される。
なお座標系Aの場合は球体C26と平面との距離を平面式を判別する条件に入れてもよい。
平面式の係数a,b,cから出る法線ベクトル(a,b,c),(−a,−b,−c)の内、直方体21の平面から直方体21の外側に向かう法線ベクトルの選定は上記の2)球体を1つ取り付ける場合と同じである。なお座標系Bの場合は球体C26の中心座標の代わりに直方体21の前面と側面と上面でできる角の座標を使う。座標変換係数の計算は上記の2)球体を1つ取り付ける場合と同じである。
上記実施形態では(1)〜(9)の手順により、定点定義可能な物体20の定点座標および法線ベクトル成分と手術器具10のセット位置座標とを座標系Aにより求め、手術器具10をセットしたときの定点定義可能な物体20の定点座標および法線ベクトル成分を座標系Bにより求め、座標系Aによる座標を座標系Bによる座標に変換する座標変換係数を求め、座標系Bによる手術器具10の先端座標を、座標系Aにおける手術器具10のセット位置座標を座標系Bの座標に座標変換することで求めたが、定点定義可能な物体20を以下のようにすれば、定点定義可能な物体20の定点座標を用いて手術器具10のセット位置座標を求めることができる。すなわち、上記実施形態の(1)〜(4)の作業が不要になり、最初から定点定義可能な物体20に手術器具10をセットし、手術器具10の先端座標(セット位置座標)を求めることができる。これによれば、定点定義可能な物体30の加工を精度よく行う必要があるが、手術器具10の先端座標と手術器具10の位置姿勢を定義する手段である複数の球体12の中心座標との関係を同一座標系で検出する作業が簡単になるという効果がある。
この場合は手術器具10の先端座標(セット位置座標)を次のように求める。定点定義可能な物体30に手術器具10をセットして3次元形状測定し、取得した点群データを用いて上記変形例1の3)に記載された平面式の算出と平面式の判別から、直方体31の前面、側面、上面を判別し、直方体31の前面、側面、上面でなる角P1の座標を求める、次に既知である直方体31の3辺の長さと直方体31の前面、側面、上面の判別の過程で求めた直線の式から、角P2〜P4の座標を求める。
次に角P1と角P4、角P2と角P3を結ぶ直線の式を計算し、直線の式からなる連立方程式を解いて直線の交点座標を計算する。計算された交点座標が手術器具10の先端座標(セット位置座標)になる。
なお、この場合も変形例1の3)と同様、直方体21の反射率を直方体21が置かれる台の反射率と大きく異ならせたり、直方体21のそれぞれの平面の反射率を異ならせ、3次元形状測定の際、同時に反射光量を測定して反射光量により点群データを分類すれば、データ処理の時間を大幅に短縮することができる。
この場合は手術器具10の先端座標(セット位置座標)を次のように求める。定点定義可能な物体40に手術器具10をセットして3次元形状測定し、取得した点群データを用いて 上記実施形態の(7)に書かれた平面の点群データ抽出と平面式の計算方法によりいずれかの平面の平面式を算出する。この平面を法線ベクトル方向に所定距離移動した式を算出し、その平面から所定距離範囲内にある点群データを抽出して、抽出した点群データが円の方程式に当てはまるか否かを判定する。当てはまれば平面式は円柱41の上面のものであると判定し、当てはまらなければ、円柱41が置かれた台の平面と判定する。この処理を円柱41の上面の平面式が算出されるまで行う。
次に円柱41の上面である平面をその法線ベクトル方向に所定間隔ごとに移動したときの平面式を複数算出し、それぞれの平面において平面から所定距離範囲内にある点群データを抽出して、抽出した点群データから最小2乗法により円の方程式を算出し、円の中心座標を算出する。
次に複数の円の中心座標から最小2乗法により直線の方程式を算出し、直線の方程式と円柱41の上面の平面式からなる連立方程式を解いて円柱41の中心線と円柱41の上面が交わる点(即ち円である上面の中心点)の座標を算出する。
算出された交点座標が手術器具10の先端座標(セット位置座標)になる。
この場合は手術器具10の先端座標(セット位置座標)を次のように求める。定点定義可能な物体50に手術器具10をセットして3次元形状測定し、取得した点群データを用いて上記実施形態の(7)に書かれた平面の点群データ抽出と平面式の計算方法によりいずれかの平面の平面式を算出する。この平面を法線ベクトル方向に所定距離移動した式を算出し、その平面から所定距離範囲内にある点群データを抽出して、抽出した点群データが円の方程式に当てはまるか否かを判定する。当てはまれば平面式は直方体51の前面のものであると判定し、当てはまらなければそれ以外の平面と判定する。この処理を直方体51の前面の平面式が算出されるまで行う。
次に直方体51の前面である平面をその法線ベクトル方向に所定間隔ごとに移動したときの平面式を複数算出し、それぞれの平面において平面から所定距離範囲内にある点群データを抽出して、抽出した点群データから最小2乗法により円の方程式を算出し、円の半径と円の中心座標を算出する。
次に複数の円の中心座標から最小2乗法により直線の方程式を算出し、直線の方程式と直方体51の前面の平面式からなる連立方程式を解いて円錐52の中心線と直方体51の前面が交わる点の座標Cを算出する。そして直方体51の前面からの所定間隔ごとにおけるそれぞれの円の半径が減少する割合から半径が0になる(即ち、円錐52の頂点に到達する)直方体51の前面からの距離Lを算出し、直方体51の前面の法線ベクトルで大きさがLのベクトルDの成分を計算する。
交点座標CにベクトルDの成分を加算した座標(即ち、円錐52の頂点座標)が手術器具10の先端座標(セット位置座標)になる。
上記変形例2では、定点定義可能な物体に設けた突起に手術器具10の先端を刺し込んでセットしたが、定点定義可能な物体20の定点を通る細長い穴に手術器具10の先端をがたつきがないようセットできれば、さらに容易に手術器具10の先端座標(セット位置座標)を求めることができる。なおこの場合は、手術器具10の先端が直線状であり、細長い穴に挿入したとき手術器具10の先端が変形しないといった条件が必要である。
この場合は手術器具10の先端座標(セット位置座標)を次のように求める。定点定義可能な物体60である球体に形成された細長い穴61に手術器具10の先端を挿入して3次元形状測定し、取得した点群データから上記実施形態の(2)の方法により球体の点群データを抽出する。抽出した点群データから最小2乗法により球体の式を計算し、球体の中心座標を求める。球体の中心座標が手術器具10の先端座標(セット位置座標)になる。
この場合は手術器具10の先端座標(セット位置座標)を次のように求める。定点定義可能な物体70である球体71,72に形成された細長い穴73,74に手術器具10を挿入して手術器具10の先端を球体71の面に合わせる。この状態で3次元形状測定し、取得した点群データから上記実施形態の(2)の方法により球体71,72の点群データを抽出する。
抽出した点群データから最小2乗法により球体の式を計算し、球体の中心座標を求める。球体71の中心座標から球体72の中心座標に向かうベクトルの成分を計算し、このベクトル成分と球体71の中心座標と球体71の半径値とから手術器具10の先端座標を算出する。
この場合は手術器具10の先端座標(セット位置座標)を次のように求める。定点定義可能な物体80である円柱に形成された細長い穴81に手術器具10を挿入して手術器具10の先端を円柱の底面に合わせる。この状態で3次元形状測定し、取得した点群データから変形例2の2)に記載された方法により円柱上面の中心点座標と中心軸方向のベクトルの成分(直線の式)を計算する。
中心点座標と、ベクトル成分と、既知である円柱の長さLとから手術器具10の先端座標を算出する。
この場合は手術器具10の先端座標(セット位置座標)を次のように求める。定点定義可能な物体90である直方体に形成された細長い穴91に手術器具10を挿入して手術器具10の先端を直方体の底面に合わせる。この状態で3次元形状測定し、取得した点群データから変形例1の3)に記載された方法により直方体前面の法線ベクトルの成分、前面と2つの側面とからなる角の座標、前面と2つの側面とからなる3辺のベクトル成分(直線の式)を計算する。次に変形例2の1)に記載された方法により直方体前面の中心座標を算出し、この中心座標と直方体前面の法線ベクトルの成分と、既知である側面と側面からなる辺の長さLとから手術器具10の先端座標を算出する。
上記実施形態では定点定義可能な物体20は直方体に球体を取り付けた構造であったが、定点または定点およびベクトルが定義できる形状を有し、手術器具10の先端を取り付けることができる突起または空孔が形成された物体を設けることができれば、色々な構造のものが考えられる。
以上のように本発明の目的を逸脱しなければ様々な変形が可能である。
Claims (10)
- 3次元形状測定装置と、
長軸部と、前記3次元形状測定装置により位置および姿勢が測定可能な第1標識部とを有する被測定物体と、
前記被測定物体の長軸部の先端部に着脱自在であって、前記被測定物体の長軸部の先端部と当接する当接部と、前記3次元形状測定装置により位置および立体形状が測定可能な第2標識部とを有し、前記当接部と前記第2標識部との3次元相対関係が予めわかっているか、または前記3次元形状測定装置により前記当接部と前記第2標識部との3次元相対関係が測定可能な較正用物体と、
を有する3次元形状測定システムにおける、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を測定する3次元相対関係測定方法であって、
前記較正用物体を、前記被測定物体の長軸部の先端部に取付けるステップと、
前記3次元形状測定装置により、前記被測定物体および前記較正用物体の立体形状データ群を測定するステップと、
前記立体形状データ群から、前記第1標識部の位置および姿勢と前記第2標識部の位置および立体形状とを算出するステップと、
前記第2標識部の位置および立体形状と、前記当接部と前記第2標識部との3次元相対関係とに基づいて、前記当接部の3次元座標を算出するステップと、
前記第1標識部の位置および姿勢と、前記当接部の3次元座標とに基づいて、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を算出するステップと、
を有する、3次元相対関係測定方法。 - 前記較正用物体の前記第2標識部は、予め立体形状がわかっており、
前記当接部と前記第2標識部との3次元相対関係は、前記第2標識部の立体形状に関連するベクトルまたは定点位置と、前記当接部の相対位置との関係により定義される、
請求項1記載の3次元相対関係測定方法。 - 前記較正用物体の当接部と前記第2標識部の定点位置とは等しいか、または前記較正用物体の当接部は前記第2標識部における2つ以上の定点を用いて定義される点であることを特徴とする請求項2記載の3次元相対関係測定方法。
- 前記較正用物体の当接部は、前記第2標識部における2つの定点を結んだ直線または前記第2標識部における定点とベクトルから定まる直線上において、定点から前記第2標識体の立体形状に関連する長さにより定まる点であることを特徴とする請求項2または3記載の3次元相対関係測定方法。
- 前記較正用物体は、前記被測定物体の長軸部の先端部を挿入可能な細穴部を有している、請求項1乃至4いずれか記載の3次元相対関係測定方法。
- 前記較正用物体は、球体、多面体、円柱、円錐のいずれかの形状を一部または全体に有している、請求項1乃至5いずれか記載の3次元相対関係測定方法。
- 前記較正用物体は、前記被測定物体の長軸部の先端部を固定するために、少なくとも突起または空孔が形成されている、請求項1乃至6いずれか記載の3次元相対関係測定方法。
- 前記被測定物体は体内挿入器具であって、前記長軸部は体内挿入部であり、前記第1標識部は体内に挿入されない部分に設けられている、請求項1乃至7いずれか記載の3次元相対関係測定方法。
- 3次元形状測定装置と、
長軸部と、前記3次元形状測定装置により位置および姿勢が測定可能な第1標識部とを有する被測定物体と、
前記被測定物体の長軸部の先端部に着脱自在であって、前記被測定物体の長軸部の先端部と当接する当接部と、前記3次元形状測定装置により位置および立体形状が測定可能な第2標識部とを有し、前記当接部と前記第2標識部との3次元相対関係が予めわかっているか、または前記3次元形状測定装置により前記当接部と前記第2標識部との3次元相対関係が測定可能な較正用物体と、
を有する3次元形状測定システムにおける、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を測定する3次元相対関係測定プログラムであって、
前記較正用物体を前記被測定物体の長軸部の先端部に取付けた状態で、前記3次元形状測定装置により、前記被測定物体および前記較正用物体の立体形状データ群を測定するステップと、
前記立体形状データ群から、前記第1標識部の位置および姿勢と前記第2標識部の位置および立体形状とを算出するステップと、
前記第2標識部の位置および立体形状と、前記当接部と前記第2標識部との3次元相対関係とに基づいて、前記当接部の3次元座標を算出するステップと、
前記第1標識部の位置および姿勢と、前記当接部の3次元座標とに基づいて、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を算出するステップと、
を有する、3次元相対関係測定プログラム。 - 3次元形状測定装置と、
長軸部と、前記3次元形状測定装置により位置および姿勢が測定可能な第1標識部とを有する被測定物体と、
前記被測定物体の長軸部の先端部に着脱自在であって、前記被測定物体の長軸部の先端部と当接する当接部と、前記3次元形状測定装置により位置および立体形状が測定可能な第2標識部とを有し、前記当接部と前記第2標識部との3次元相対関係が予めわかっているか、または前記3次元形状測定装置により前記当接部と前記第2標識部との3次元相対関係が測定可能な較正用物体と、を有し、
前記3次元形状測定装置は少なくとも、前記較正用物体を前記被測定物体の長軸部の先端部に取付けた状態で、前記被測定物体および前記較正用物体の立体形状データ群を測定するものであり、
前記立体形状データ群から、前記第1標識部の位置および姿勢と前記第2標識部の位置および立体形状とを算出する手段と、
前記第2標識部の位置および立体形状と、前記当接部と前記第2標識部との3次元相対関係とに基づいて、前記当接部の3次元座標を算出する手段と、
前記第1標識部の位置および姿勢と、前記当接部の3次元座標とに基づいて、前記被測定物体の長軸部の先端部と前記第1標識部との3次元相対関係を算出する手段と、
を有する、3次元相対関係測定システム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008045332A JP5200582B2 (ja) | 2008-02-27 | 2008-02-27 | 長軸部を有する物体の長軸部の先端座標と該物体の位置姿勢を定義する手段との3次元相対関係測定方法およびシステム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008045332A JP5200582B2 (ja) | 2008-02-27 | 2008-02-27 | 長軸部を有する物体の長軸部の先端座標と該物体の位置姿勢を定義する手段との3次元相対関係測定方法およびシステム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009204372A JP2009204372A (ja) | 2009-09-10 |
JP5200582B2 true JP5200582B2 (ja) | 2013-06-05 |
Family
ID=41146816
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008045332A Expired - Fee Related JP5200582B2 (ja) | 2008-02-27 | 2008-02-27 | 長軸部を有する物体の長軸部の先端座標と該物体の位置姿勢を定義する手段との3次元相対関係測定方法およびシステム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5200582B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6293110B2 (ja) * | 2015-12-07 | 2018-03-14 | 株式会社Hielero | 点群データ取得システム及びその方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4053156B2 (ja) * | 1998-09-22 | 2008-02-27 | オリンパス株式会社 | 光学素子の面間の位置関係を測定する装置に用いる光学素子を保持する保持具 |
WO2001074266A1 (en) * | 2000-03-30 | 2001-10-11 | The Board Of Trustees Of The Leland Stanford Junior University | Apparatus and method for calibrating an endoscope |
JP3952467B2 (ja) * | 2003-05-09 | 2007-08-01 | パルステック工業株式会社 | 3次元データ抽出方法および3次元データ抽出装置 |
JP4291178B2 (ja) * | 2004-03-01 | 2009-07-08 | パルステック工業株式会社 | 3次元形状測定システム、同測定方法および3次元形状測定用ステージ装置 |
JP4836122B2 (ja) * | 2006-02-09 | 2011-12-14 | 国立大学法人浜松医科大学 | 手術支援装置、方法及びプログラム |
JP5213200B2 (ja) * | 2008-02-27 | 2013-06-19 | 国立大学法人浜松医科大学 | 手術支援システム用体内挿入器具 |
-
2008
- 2008-02-27 JP JP2008045332A patent/JP5200582B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2009204372A (ja) | 2009-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6336661B2 (ja) | 捻転に対する感度の低い形状センサを用いた絶対的3次元測定のための方法およびシステム | |
US7427272B2 (en) | Method for locating the mechanical axis of a femur | |
EP1883780B1 (en) | Method and apparatus for calibrating spherical objects using a computer system | |
CN101902966B (zh) | 医用摄影用标记 | |
JP2009150883A (ja) | 拡張現実検査およびデータ可視化のシステムおよび方法 | |
JP2009150883A6 (ja) | 拡張現実検査およびデータ可視化のシステムおよび方法 | |
EP3118618A3 (en) | Automated calibration of non-destructive testing equipment | |
US9974618B2 (en) | Method for determining an imaging specification and image-assisted navigation as well as device for image-assisted navigation | |
JP2016515862A5 (ja) | ||
JP2017508151A (ja) | 視覚プローブを使用して物体を検査する方法 | |
JP2005152187A (ja) | 3次元超音波ファントム | |
CN116327079A (zh) | 内窥镜测量系统和工具 | |
KR100996826B1 (ko) | 수술용 항법 장치용 도구의 교정 방법 | |
JP5200582B2 (ja) | 長軸部を有する物体の長軸部の先端座標と該物体の位置姿勢を定義する手段との3次元相対関係測定方法およびシステム | |
Wanninayake et al. | Novel indentation depth measuring system for stiffness characterization in soft tissue palpation | |
JP5213201B2 (ja) | 体内挿入器具の種類を識別可能な手術支援システム | |
EP2747694A1 (en) | Method or determining the shape of a surgical instrument and surgical instrument having a deformable body | |
WO2017170488A1 (ja) | 光軸位置測定システム、光軸位置測定方法、光軸位置測定プログラム、光軸位置測定装置 | |
Peirs et al. | Design of an optical force sensor for force feedback during minimally invasive robotic surgery | |
JP6635679B2 (ja) | マーカーの解析方法 | |
JP5560424B2 (ja) | 長軸部先端からの光軸を有する物体における光軸位置と該物体の位置姿勢を定義する手段との3次元相対関係測定方法、装置およびシステム | |
KR101544712B1 (ko) | 수술용 항법 시스템의 교정 방법 | |
KR100505198B1 (ko) | 영상 유도 수술을 위한 수술 도구를 보정하는 방법 | |
US8551024B2 (en) | Method and device for determining a characteristic property of an anatomical structure | |
JP2017185212A (ja) | 光軸位置測定システム、光軸位置測定方法、光軸位置測定プログラム、光軸位置測定装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110225 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110313 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20121018 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20121023 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20121218 |
|
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: 20130116 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130128 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5200582 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20160222 Year of fee payment: 3 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |