JP2008275395A - 位置姿勢検出システム及びその検出方法並びに位置姿勢検出装置 - Google Patents
位置姿勢検出システム及びその検出方法並びに位置姿勢検出装置 Download PDFInfo
- Publication number
- JP2008275395A JP2008275395A JP2007117670A JP2007117670A JP2008275395A JP 2008275395 A JP2008275395 A JP 2008275395A JP 2007117670 A JP2007117670 A JP 2007117670A JP 2007117670 A JP2007117670 A JP 2007117670A JP 2008275395 A JP2008275395 A JP 2008275395A
- Authority
- JP
- Japan
- Prior art keywords
- magnetic field
- unit
- axis
- coil
- detection unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
Abstract
【解決手段】Xg軸コイル電源群1aとXg軸コイル群1bとからなるXg軸方向磁場発生部1は、指向性を有する交流磁場を少なくとも1つ発生する。Yg軸コイル電源群2aとYg軸コイル群2bとからなるYg軸方向磁場発生部2は、Xg軸方向磁場発生部1とは異なる指向性で、かつXg軸方向磁場発生部1が発生する磁場の周波数とは異なる周波数を有する交流磁場を少なくとも1つ発生する。磁場検出部11は、Xg軸方向磁場発生部1とYg軸方向磁場発生部2から発生する磁場を検出する多軸の磁気センサ10a,10b,10cを有する。演算部4は、Xg軸方向磁場発生部1とYg軸方向磁場発生部2と磁場検出部11の方向関係を特定することで磁場検出部11の位置情報と姿勢情報を算出する。
【選択図】図1
Description
[実施例1]
図1は、本発明の位置姿勢検出システムの実施例1を示す全体構成図で、図中符号1はXg軸方向磁場発生部、1aはXg軸コイル電源群、1bはXg軸コイル群、2はYg軸方向磁場発生部、2aはYg軸コイル電源群、2bはYg軸コイル群、3は磁場検出部11を有する情報端末、4は演算部、5はデータ表示部を示している。なお、符号10は方位角センサを示している。
Θ=Mωt+Ωθ ・・・(1)
Φ=Nωt+Ωφ ・・・(2)
(第1の周波数成分、第2の周波数成分ともに時間t=0においてそれぞれΩθ、Ωφであるとする)。
η_x=M×φ_x(Nω)−N×θ_x(Mω)(但し、0≦η_x<2π)・・・(式3)
磁気センサの正方向と、発生磁場の正方向が一致している場合、
θ_x(Mω)=Mωt+Ωθ−2πp・・・(式4)
φ_x(Nω)=Nωt+Ωφ−2πq・・・(式5)
(但し、p、qは0≦θ_x(Mω),φ_x(Nω)<2πにするための整数)となり、(式3)から
η_x=(MΩθ−NΩφ)+2π(Np−Mq)−2πν・・・(式6)
となる(但し、νは0≦η_x<2πにするための整数)。
θ_x(Mω)=Mωt+Ωθ+π−2πp’ ・・・(式7)
φ_x(Nω)=Nωt+Ωφ+π−2πq’ ・・・(式8)
(但し、p’、q’は0≦θ_x(Mω),φ_x(Nω)<2πにするための整数)となるので、
η_x=(MΩθ−NΩφ)+π(M−N)+2π(Np’−Mq’)−2πν’・・・(式9)
となる(但し、ν’は0≦η_x<2πにするための整数)。(式6)と(式9)の振幅符号判定値は、π(M−N)分異なっている。このことから、磁気センサの正方向と発生磁場の正方向の関係が判断できる。
A_x’(Mω)=A_x(Mω)×Sign(Sin(η_x))・・・(式10)
として算出される(但し、Sign(k)はkの符号を表し、−1又は+1となる)。なお、η_xによって適切な符号が算出できるようにSign関数を決めておけば、MΩθ−NΩφ=π/2でなくても良い。
mxi=(A_x’(Mω),A_y’(Mω),A_z’(Mω))T・・・(式11)
(ATはAの転置を表す)。同様に、その他の各コイルからの磁場についても磁場ベクトルを算出することができる。
Ri-1,i=|mxi-1|/|mxi|・・・(式12)
Ri+1,i=|mxi+1|/|mxi|・・・(式13)
として、
Ri-1,i=Ri+1,i・・・(式14)
ならば、コイルXiの中心軸上であるXg座標Xiと判定できる。また、Ri-1,i<Ri+1,iであれば、コイルXiからコイルXi+1の間である。Ri-1,i>Ri+1,iであれば、コイルXi-1からコイルXiの間である。或いは、(式14)の関係からずれている場合、ある閾値Rthを決めて、
1−Rth<Ri-1,i/Ri+1,i<1+Rth・・・(式15)
の関係に収まっている場合に、Xg座標をXiと判断しても良い。つまり、各コイル群から大きさが最大となる磁場ベクトルmxiを検出し、その大きさと一つ隣のコイルからの磁場の大きさとの比を利用して、Xg軸コイル群1bに対しての情報端末3の位置座標を検出できる。また、その最大の大きさの磁場ベクトルmxiを発生しているコイルXiは、Xg軸コイル群1bのうち情報端末3から最短の距離の方向にあるものである。同様な方法で、Yg軸コイル群2bに対して大きさが最大となる磁場ベクトルmyjを検出し、Yg座標Yjを検出できる。なお、Zg軸座標については、Xg軸コイル群1bからの磁場ベクトルで位置座標を決定する際に、どの列のコイルであることがわかるので、Zg座標Zk検出はできている。このようにして、情報端末3の位置データ(Xi,Yj,Zk)を算出できる。すなわち、大きさが最大の磁場ベクトルを特定することで、現在の情報端末3の位置から各磁場発生部の最短距離のコイルを特定し、対応するコイルと情報端末3の方向関係を特定することで、位置情報を算出したことになる。
mx・my=0・・・(式16)
となる磁場ベクトルの組み合わせmxi、myjを検出し、位置データを算出するのでも良い。すなわち、磁場同士の角度が所定値(90度)であるような磁場を発生する各磁場発生部のコイルを、磁場ベクトル同士の所望の内積(式16)から特定し、対応するコイルと情報端末3の方向関係を特定することで、位置情報を算出したことになる。
検出された端末座標系の磁場ベクトルmxi、myjから絶対座標系を表す正規直交基底ベクトルex、ey、ezが次のように表現できる。
ex=mxi/|mxi|・・・(式17)
ey=myj/|myj|・・・(式18)
ez=mxi×my/|mxi×myj|・・・(式19)
Xrg=r・・・(式20)
rg=X-1r=XTr・・・(式21)
として、絶対座標系でのベクトルrgへと変換することができる。
ψ=tan-1(Ry/Rx)・・・(式22)
α=tan-1(Rz/(Rx2+Ry2)1/2)・・・(式23)
また、実施例1は、2次元平面の位置姿勢検出にも適用できる。その場合、2軸の磁気センサを有する方位角センサでも良い。
図7は、本発明の位置姿勢検出システムの実施例2を示す全体構成図である。この位置姿勢検出システムは、磁場発生部30aと磁場発生部30bと磁場検出部11を有する情報端末3と演算部4とデータ表示部5とから構成されている。
ΘA=MAωAt+ΩθA ・・・(24)
ΦA=NAωAt+ΩφA ・・・(25)
(第1の周波数成分、第2の周波数成分ともに時間t=0においてそれぞれΩθA、ΩφAであるとする)。BBについても同様な形式で表現できるものとする。
最初の各コイル(コイル33a,33b)の磁場発生方向において、磁場ベクトル算出部19で算出された端末座標系の磁場ベクトルma、mbをまず保持し、次に各コイルの磁場発生方向を変更した後、もう一度測定を行い磁場ベクトルma’、mb’を算出する。この操作を繰り返し、いくつかの磁場発生方向に対するいくつかの磁場ベクトルが得られると、その中で絶対値(ベクトルの大きさ)が極大を示す磁場ベクトルmamax、mbmaxが存在する。すると、その極大値を示す磁場ベクトルの方向が、各コイルと情報端末3の最短距離となる方向であり、各コイルから発生する磁場の方向が情報端末3のある方向に一致する。すなわち、各磁場発生部のコイル(コイル33a,33b)と磁場検出部11(方位角センサ10)の方向関係が特定されたことになる。
BAmax=BA(cosαAcosβA,sinαAcosβA,−sinβA)・・・(式26)
BBmax=BB(cosαBcosβB,sinαBcosβB,−sinβB)・・・(式27)
と表現できる。
σA’=∠P’A’B’−3π/2・・・(式28)
σB’=π/2−∠P’B’A’・・・(式29)
となって、以下のようにP’点のXp,Zpを算出できる。
Xp=(−ZA+ZB+XAtanσA’−XBtanσB’)/(tanσA’−tanσB’) ・・・(式30)
Zp=(−XA+XB+ZAcotσA’−ZBcotσB’)/(cotσA’−cotσB’) ・・・(式31)
MA=BAmax/|BAmax|・・・(式32)
MB=BBmax/|BBmax|・・・(式33)
とすると、これらは磁場の発生方向を示すベクトルであり、1次独立な正規直交基底を形成する。その正規直交基底で表現されるMAMB座標系から地上座標系への変換行列Hが求められて、MAMB座標系のベクトルrHは、任意の絶対座標系のベクトルrgへと変換される。
HrH=rg・・・(式34)
LrH=rp・・・(式35)
HL-1rp=rg・・・(式36)
として、端末座標系から地上座標系へと変換できる。したがって、情報端末3の姿勢データを実施例1と同様に算出することができる。
1a Xg軸コイル電源群
1b Xg軸コイル群
2 Yg軸方向磁場発生部
2a Yg軸コイル電源群
2b Yg軸コイル群
3 情報端末
4 演算部
5 データ表示部
10 方位角センサ
10a x軸磁気センサ
10b y軸磁気センサ
10c z軸磁気センサ
11 磁場検出部
12 マルチプレクサ部
13 磁気センサ駆動部
14 信号増幅部
15 A/D変換部
16 データ送信部
17 データ受信部
18 フーリエ変換部
19 磁場ベクトル算出部
20 位置姿勢算出部
30a,30b 磁場発生部
31a,31b コイル用電源
32a,32b コイル磁場発生方向変更部
33a,33b コイル
Claims (24)
- 指向性を有する交流磁場を少なくとも1つ発生する第1の磁場発生部と、
該第1の磁場発生部とは異なる指向性で、かつ前記第1の磁場発生部が発生する磁場の周波数とは異なる周波数を有する交流磁場を少なくとも1つ発生する第2の磁場発生部と、
前記第1及び第2の磁場発生部から発生する磁場を検出する多軸の磁気センサを有する磁場検出部と、
該磁場検出部により検出された磁場から、前記第1及び第2の磁場発生部と前記磁場検出部の方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する演算部と
を備えたことを特徴とする位置姿勢検出システム。 - 前記交流磁場は、異なる複数の周波数成分の位相関係が既知である磁場であることを特徴とする請求項1に記載の位置姿勢検出システム。
- 前記第1の磁場発生部は、第1の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなり、前記第2の磁場発生部は、第2の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなり、
前記演算部は、前記第1及び第2の磁場発生部において前記複数の磁場発生コイルのいずれから発生した磁場の強度が最大であるかを特定し、対応する磁場発生コイルと前記磁場検出部との方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出することを特徴とする請求項1又は2に記載の位置姿勢検出システム。 - 前記演算部は、
前記磁場検出部の各軸の出力信号に基づいて、前記各軸における前記複数の周波数成分における位相と振幅を算出するフーリエ変換部と、
該フーリエ変換部からの出力信号に基づいて、前記各軸の前記複数の周波数成分の位相関係から、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅について符号を算出するとともに、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅と前記符号とから、前記第1及び第2の磁場発生部から発生された磁場に基づく向きと大きさを表す第1及び第2の磁場ベクトルを算出する磁場ベクトル算出部と、
該磁場ベクトル算出部からの出力信号に基づいて、前記第1及び第2の磁場発生部において前記複数の磁場発生コイルのいずれから発生した磁場の強度が最大であるかを特定し、対応する磁場発生コイルと前記磁場検出部の方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する位置姿勢算出部と
を備えたことを特徴とする請求項3に記載の位置姿勢検出システム。 - 前記第1の磁場発生部は、第1の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなり、前記第2の磁場発生部は、第2の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなり、
前記演算部は、前記第1及び第2の磁場発生部において前記複数の磁場発生コイルのいずれから発生した磁場同士の角度が所定値かを特定し、対応する磁場発生コイルと前記磁場検出部との方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出することを特徴とする請求項1又は2に記載の位置姿勢検出システム。 - 前記演算部は、
前記磁場検出部の各軸の出力信号に基づいて、前記各軸における前記複数の周波数成分における位相と振幅を算出するフーリエ変換部と、
該フーリエ変換部からの出力信号に基づいて、前記各軸の前記複数の周波数成分の位相関係から、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅について符号を算出するとともに、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅と前記符号とから、前記第1及び第2の磁場発生部から発生された磁場に基づく向きと大きさを表す第1及び第2の磁場ベクトルを算出する磁場ベクトル算出部と、
該磁場ベクトル算出部からの出力信号に基づいて、前記第1及び第2の磁場発生部において前記複数の磁場発生コイルのいずれから発生した磁場同士の角度が所定値かを特定し、対応する磁場発生コイルと前記磁場検出部の方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する位置姿勢算出部と
を備えたことを特徴とする請求項5に記載の位置姿勢検出システム。 - 前記第1及び第2の磁場発生部は、それぞれ磁場の発生方向を独立して変更できる磁場発生コイルからなり、
前記演算部は、前記各磁場発生コイルから発生する磁場の強度が最大となるように前記磁場発生コイルの向きを変更させて、前記磁場検出部と前記磁場発生コイルの方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出することを特徴とする請求項1又は2に記載の位置姿勢検出システム。 - 前記演算部は、
前記磁場検出部の各軸の出力信号に基づいて、前記各軸における前記複数の周波数成分における位相と振幅を算出するフーリエ変換部と、
該フーリエ変換部からの出力信号に基づいて、前記各軸の前記複数の周波数成分の位相関係から、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅について符号を算出するとともに、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅と前記符号とから、前記第1及び第2の磁場発生部から発生された磁場に基づく向きと大きさを表す第1及び第2の磁場ベクトルを算出する磁場ベクトル算出部と、
該磁場ベクトル算出部からの出力信号に基づいて、前記各磁場発生コイルから発生する磁場の強度が最大となるように前記磁場発生コイルの向きを変更させて、前記磁場検出部と前記磁場発生コイルの方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する位置姿勢算出部と
を備えたことを特徴とする請求項7に記載の位置姿勢検出システム。 - 指向性を有する交流磁場を少なくとも1つ発生する第1の磁場発生部による第1の磁場発生ステップと、
該第1の磁場発生部とは異なる指向性で、かつ前記第1の磁場発生部が発生する磁場の周波数とは異なる周波数を有する交流磁場を少なくとも1つ発生する第2の磁場発生部による第2の磁場発生ステップと、
前記第1及び第2の磁場発生部から発生する磁場を検出する多軸の磁気センサを有する磁場検出部による磁場検出ステップと、
該磁場検出ステップにより検出された磁場から、前記第1及び第2の磁場発生部と前記磁場検出部の方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する演算ステップと
を有することを特徴とする位置姿勢検出方法。 - 前記交流磁場は、異なる複数の周波数成分の位相関係が既知である磁場であることを特徴とする請求項9に記載の位置姿勢検出方法。
- 前記演算ステップは、
第1の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなる前記第1の磁場発生部及び、第2の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなる前記第2の磁場発生部における、前記複数の磁場発生コイルのいずれから発生した磁場の強度が最大であるかを特定し、対応する磁場発生コイルと前記磁場検出部との方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出することを特徴とする請求項9又は10に記載の位置姿勢検出方法。 - 前記演算ステップは、
前記磁場検出ステップによる各軸の出力信号に基づいて、前記各軸における前記複数の周波数成分における位相と振幅を算出するフーリエ変換ステップと、
該フーリエ変換ステップからの出力信号に基づいて、前記各軸の前記複数の周波数成分の位相関係から、前記第1及び第2の磁場発生ステップからの磁場に基づく前記各軸の振幅について符号を算出するとともに、前記第1及び第2の磁場発生ステップからの磁場に基づく前記各軸の振幅と前記符号とから、前記第1及び第2の磁場発生ステップから発生された磁場に基づく向きと大きさを表す第1及び第2の磁場ベクトルを算出する磁場ベクトル算出ステップと、
該磁場ベクトル算出ステップからの出力信号に基づいて、前記第1及び第2の磁場発生ステップにおいて前記複数の磁場発生コイルのいずれから発生した磁場の強度が最大であるかを特定し、対応するコイルと前記磁場検出部の方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する位置姿勢算出ステップと
を有することを特徴とする請求項11に記載の位置姿勢検出方法。 - 前記演算ステップは、
第1の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなる前記第1の磁場発生部及び、第2の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなる前記第2の磁場発生部における、前記複数の磁場発生コイルのいずれから発生した磁場同士の角度が所定値であるかを特定し、対応する磁場発生コイルと前記磁場検出部との方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出することを特徴とする請求項9又は10に記載の位置姿勢検出方法。 - 前記演算ステップは、
前記磁場検出ステップによる各軸の出力信号に基づいて、前記各軸における前記複数の周波数成分における位相と振幅を算出するフーリエ変換ステップと、
該フーリエ変換ステップからの出力信号に基づいて、前記各軸の前記複数の周波数成分の位相関係から、前記第1及び第2の磁場発生ステップからの磁場に基づく前記各軸の振幅について符号を算出するとともに、前記第1及び第2の磁場発生ステップからの磁場に基づく前記各軸の振幅と前記符号とから、前記第1及び第2の磁場発生ステップから発生された磁場に基づく向きと大きさを表す第1及び第2の磁場ベクトルを算出する磁場ベクトル算出ステップと、
該磁場ベクトル算出ステップからの出力信号に基づいて、前記第1及び第2の磁場発生ステップにおいて前記複数の磁場発生コイルのいずれから発生した磁場同士の角度が所定値であるかを特定し、対応するコイルと前記磁場検出部の方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する位置姿勢算出ステップと
を有することを特徴とする請求項13に記載の位置姿勢検出方法。 - 前記演算ステップは、
それぞれ磁場の発生方向を独立して変更できる磁場発生コイルから発生する磁場の強度が最大となるように前記磁場発生コイルの向きを変更させて、前記磁場検出部と前記磁場発生コイルの方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出することを特徴とする請求項9又は10に記載の位置姿勢検出方法。 - 前記演算ステップは、
前記磁場検出ステップによる各軸の出力信号に基づいて、前記各軸における前記複数の周波数成分における位相と振幅を算出するフーリエ変換ステップと、
該フーリエ変換ステップからの出力信号に基づいて、前記各軸の前記複数の周波数成分の位相関係から、前記第1及び第2の磁場発生ステップからの磁場に基づく前記各軸の振幅について符号を算出するとともに、前記第1及び第2の磁場発生ステップからの磁場に基づく前記各軸の振幅と前記符号とから、前記第1及び第2の磁場発生ステップから発生された磁場に基づく向きと大きさを表す第1及び第2の磁場ベクトルを算出する磁場ベクトル算出ステップと、
該磁場ベクトル算出ステップからの出力信号に基づいて、前記各磁場発生コイルから発生する磁場の強度が最大となるように前記磁場発生コイルの向きを変更させて、前記磁場検出部と前記磁場発生コイルの方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する位置姿勢算出ステップと
を有することを特徴とする請求項15に記載の位置姿勢検出方法。 - 指向性を有する交流磁場を少なくとも1つ発生する第1の磁場発生部と、該第1の磁場発生部とは異なる指向性で、かつ前記第1の磁場発生部が発生する磁場の周波数とは異なる周波数を有する交流磁場を少なくとも1つ発生する第2の磁場発生部とから発生する磁場を検出する多軸の磁気センサを有する磁場検出部と、
該磁場検出部により検出された磁場から、前記第1及び第2の磁場発生部と前記磁場検出部の方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する演算部と
を備えたことを特徴とする位置姿勢検出装置。 - 前記交流磁場は、異なる複数の周波数成分の位相関係が既知である磁場であることを特徴とする請求項17に記載の位置姿勢検出装置。
- 前記演算部は、
第1の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなる前記第1の磁場発生部及び、第2の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなる前記第2の磁場発生部における、前記複数の磁場発生コイルのいずれから発生した磁場の強度が最大であるかを特定し、対応する磁場発生コイルと前記磁場検出部との方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出することを特徴とする請求項17又は18に記載の位置姿勢検出装置。 - 前記演算部は、
前記磁場検出部の各軸の出力信号に基づいて、前記各軸における前記複数の周波数成分における位相と振幅を算出するフーリエ変換部と、
該フーリエ変換部からの出力信号に基づいて、前記各軸の前記複数の周波数成分の位相関係から、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅について符号を算出するとともに、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅と前記符号とから、前記第1及び第2の磁場発生部から発生された磁場に基づく向きと大きさを表す第1及び第2の磁場ベクトルを算出する磁場ベクトル算出部と、
該磁場ベクトル算出部からの出力信号に基づいて、前記第1及び第2の磁場発生部において前記複数の磁場発生コイルのいずれから発生した磁場の強度が最大であるかを特定し、対応するコイルと前記磁場検出部の方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する位置姿勢算出部と
を備えたことを特徴とする請求項19に記載の位置姿勢検出装置。 - 前記演算部は、
第1の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなる前記第1の磁場発生部及び、第2の方向に指向性を有するように配置され、互いに異なる周波数の交流磁場を発生する複数の磁場発生コイルからなる前記第2の磁場発生部における、前記複数の磁場発生コイルのいずれから発生した磁場同士の角度が所定値であるかを特定し、対応する磁場発生コイルと前記磁場検出部との方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出することを特徴とする請求項17又は18に記載の位置姿勢検出装置。 - 前記演算部は、
前記磁場検出部の各軸の出力信号に基づいて、前記各軸における前記複数の周波数成分における位相と振幅を算出するフーリエ変換部と、
該フーリエ変換部からの出力信号に基づいて、前記各軸の前記複数の周波数成分の位相関係から、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅について符号を算出するとともに、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅と前記符号とから、前記第1及び第2の磁場発生部から発生された磁場に基づく向きと大きさを表す第1及び第2の磁場ベクトルを算出する磁場ベクトル算出部と、
該磁場ベクトル算出部からの出力信号に基づいて、前記第1及び第2の磁場発生部において前記複数の磁場発生コイルのいずれから発生した磁場同士の角度が所定値であるかを特定し、対応するコイルと前記磁場検出部の方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する位置姿勢算出部と
を備えたことを特徴とする請求項21に記載の位置姿勢検出装置。 - 前記演算部は、
それぞれ磁場の発生方向を独立して変更できる磁場発生コイルから発生する磁場の強度が最大となるように前記磁場発生コイルの向きを変更させて、前記磁場検出部と前記磁場発生コイルの方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出することを特徴とする請求項17又は18に記載の位置姿勢検出装置。 - 前記演算部は、
前記磁場検出部の各軸の出力信号に基づいて、前記各軸における前記複数の周波数成分における位相と振幅を算出するフーリエ変換部と、
該フーリエ変換部からの出力信号に基づいて、前記各軸の前記複数の周波数成分の位相関係から、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅について符号を算出するとともに、前記第1及び第2の磁場発生部からの磁場に基づく前記各軸の振幅と前記符号とから、前記第1及び第2の磁場発生部から発生された磁場に基づく向きと大きさを表す第1及び第2の磁場ベクトルを算出する磁場ベクトル算出部と、
該磁場ベクトル算出部からの出力信号に基づいて、前記各磁場発生コイルから発生する磁場の強度が最大となるように前記磁場発生コイルの向きを変更させて、前記磁場検出部と前記磁場発生コイルの方向関係を特定することで、前記磁場検出部の位置情報と姿勢情報を算出する位置姿勢算出部と
を備えたことを特徴とする請求項23に記載の位置姿勢検出装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007117670A JP5004646B2 (ja) | 2007-04-26 | 2007-04-26 | 位置姿勢検出システム及びその検出方法並びに位置姿勢検出装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007117670A JP5004646B2 (ja) | 2007-04-26 | 2007-04-26 | 位置姿勢検出システム及びその検出方法並びに位置姿勢検出装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008275395A true JP2008275395A (ja) | 2008-11-13 |
JP5004646B2 JP5004646B2 (ja) | 2012-08-22 |
Family
ID=40053528
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007117670A Active JP5004646B2 (ja) | 2007-04-26 | 2007-04-26 | 位置姿勢検出システム及びその検出方法並びに位置姿勢検出装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5004646B2 (ja) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011234819A (ja) * | 2010-05-07 | 2011-11-24 | Alps Electric Co Ltd | 球技装置用の磁界検知装置およびこれを使用した球技装置 |
JP2012058251A (ja) * | 2011-11-02 | 2012-03-22 | Alps Electric Co Ltd | 球技装置用の磁界検知装置およびこれを使用した球技装置 |
WO2015087735A1 (ja) | 2013-12-10 | 2015-06-18 | オリンパス株式会社 | 位置検出システム |
CN106983487A (zh) * | 2017-03-14 | 2017-07-28 | 宜宾学院 | 无线胶囊内窥镜三维位置和三维姿态的定位系统及其定位方法 |
CN108042094A (zh) * | 2017-12-22 | 2018-05-18 | 宜宾学院 | 无线胶囊内窥镜5自由度的定位系统及其定位方法 |
JP2019052958A (ja) * | 2017-09-15 | 2019-04-04 | 株式会社東芝 | 測位システムおよび装置 |
Citations (46)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5045667A (ja) * | 1973-07-30 | 1975-04-23 | ||
US4054881A (en) * | 1976-04-26 | 1977-10-18 | The Austin Company | Remote object position locater |
JPS53135671A (en) * | 1977-05-01 | 1978-11-27 | Nippon Telegr & Teleph Corp <Ntt> | Horizontal position detecting method of shield machines |
JPS5690210A (en) * | 1979-12-22 | 1981-07-22 | Nippon Telegr & Teleph Corp <Ntt> | Measurement device for position and posture angle of underground boring machine |
US4287809A (en) * | 1979-08-20 | 1981-09-08 | Honeywell Inc. | Helmet-mounted sighting system |
JPS5747200A (en) * | 1980-06-30 | 1982-03-17 | Austin Co | Apparatus for determining position and direction of remote object |
JPS60221820A (ja) * | 1983-08-05 | 1985-11-06 | Wacom Co Ltd | 位置検出装置 |
JPS625121A (ja) * | 1985-07-01 | 1987-01-12 | Hitachi Constr Mach Co Ltd | 掘進機の位置検出装置 |
JPS6238301A (ja) * | 1985-08-13 | 1987-02-19 | コミツサリア ア レネルジイ アトミツク | 物体の空間における位置及び方向を決定する装置及び方法 |
JPS63171996A (ja) * | 1986-07-22 | 1988-07-15 | 日立建機株式会社 | 掘進機の姿勢検出装置 |
JPH021241A (ja) * | 1988-11-02 | 1990-01-05 | Eiichi Bando | 顎運動の測定装置 |
JPH03162693A (ja) * | 1989-11-20 | 1991-07-12 | Sumitomo Metal Ind Ltd | 位置検出方法及び装置 |
JPH0415501A (ja) * | 1990-05-09 | 1992-01-20 | Fujikura Ltd | 金属長尺物埋設位置測定装置 |
JPH04264201A (ja) * | 1991-02-19 | 1992-09-21 | Sumitomo Metal Ind Ltd | 位置検出方法及びその装置 |
JPH04336196A (ja) * | 1991-05-10 | 1992-11-24 | Furukawa Electric Co Ltd:The | 地中推進機の推進方法 |
JPH06109862A (ja) * | 1992-09-30 | 1994-04-22 | Tokyo Gas Co Ltd | 埋設管に於ける対象個所の検知方法 |
JPH07260410A (ja) * | 1994-03-09 | 1995-10-13 | Philips Electron Nv | センサ素子の空間位置決定装置 |
JPH07295736A (ja) * | 1994-04-25 | 1995-11-10 | Sony Corp | 3次元位置検出装置 |
WO1996001539A1 (fr) * | 1994-07-01 | 1996-01-18 | Makoto Hyuga | Procede et appareil de communication |
JPH08146145A (ja) * | 1994-11-28 | 1996-06-07 | Sekisui Chem Co Ltd | 位置検出方法 |
JPH09166404A (ja) * | 1995-12-15 | 1997-06-24 | Osaka Gas Co Ltd | 物体の位置特定方法及び装置 |
JPH09325003A (ja) * | 1996-06-04 | 1997-12-16 | Sekisui Chem Co Ltd | 位置検出方法 |
JPH10108853A (ja) * | 1996-10-08 | 1998-04-28 | Eiichi Bando | 人体用の立体変位センサー |
JPH10148502A (ja) * | 1996-11-15 | 1998-06-02 | Kandenko Co Ltd | 位置検出方法 |
JPH10267655A (ja) * | 1997-03-27 | 1998-10-09 | Nippon Telegr & Teleph Corp <Ntt> | 掘削推進機の位置探査装置及び位置探査方法 |
JPH10332309A (ja) * | 1997-05-29 | 1998-12-18 | Olympus Optical Co Ltd | コイル位置測定方法 |
JPH11153674A (ja) * | 1997-11-18 | 1999-06-08 | Yotsugi Kk | 埋設物探知器 |
JP2000292111A (ja) * | 1999-04-01 | 2000-10-20 | Japan Science & Technology Corp | 姿勢位置測定装置及び測定方法 |
JP2002131009A (ja) * | 1998-03-18 | 2002-05-09 | Olympus Optical Co Ltd | 位置推定方法 |
JP2002365005A (ja) * | 2001-06-08 | 2002-12-18 | San Shield Kk | シールド機の位置検出方法及びシールド機の位置検出装置 |
JP2003004409A (ja) * | 2001-06-26 | 2003-01-08 | Reideikku:Kk | 位置測定方式及び位置測定装置 |
JP2003044217A (ja) * | 2001-08-01 | 2003-02-14 | Japan Science & Technology Corp | 位置・姿勢検出装置及びそれを用いたコンピュータ情報入力装置 |
JP2003084051A (ja) * | 2001-09-17 | 2003-03-19 | Ricoh Co Ltd | 磁界ベクトルセンサ及びセンサシステム |
JP2003513260A (ja) * | 1999-10-29 | 2003-04-08 | アセンション テクノロジー コーポレイション | 渦電流による誤差を低減したac磁気ポジション測定システム |
JP2003114101A (ja) * | 2001-10-03 | 2003-04-18 | Nippon Telegr & Teleph Corp <Ntt> | 磁気式3次元位置検出装置および検出方法 |
JP2003121151A (ja) * | 2001-10-16 | 2003-04-23 | Hitachi Metals Ltd | 掘削体の位置探査方法及び位置探査装置 |
JP2003526099A (ja) * | 2000-03-07 | 2003-09-02 | コミツサリア タ レネルジー アトミーク | 磁界を使用して対象物の位置または向きを決定するための方法ならびに対応するデバイス |
JP2003530557A (ja) * | 2000-04-07 | 2003-10-14 | ノーザン・デジタル・インコーポレイテッド | 磁気的な位置または配向の決定における誤差の検出方法 |
JP2004229943A (ja) * | 2003-01-30 | 2004-08-19 | Eiichi Bando | 顎運動の測定装置 |
JP2004295443A (ja) * | 2003-03-27 | 2004-10-21 | Japan Science & Technology Agency | 物体追跡装置 |
JP2004536298A (ja) * | 2001-06-26 | 2004-12-02 | ノーザン・デジタル・インコーポレイテッド | 利得係数および位置決定システム |
JP2005517230A (ja) * | 2002-02-05 | 2005-06-09 | センソパッド テクノロジーズ リミテッド | 計測器および方法 |
JP2006214979A (ja) * | 2005-02-07 | 2006-08-17 | Nec Tokin Corp | 磁気式位置検出装置 |
WO2007043458A1 (ja) * | 2005-10-06 | 2007-04-19 | Olympus Corporation | 位置検出システム |
JP2008524588A (ja) * | 2004-12-21 | 2008-07-10 | キュー−トラック,コーポレーション | 近距離場位置測定システムおよび方法 |
WO2008096856A1 (ja) * | 2007-02-09 | 2008-08-14 | Asahi Kasei Emd Corporation | 空間情報検出システム及びその検出方法並びに空間情報検出装置 |
-
2007
- 2007-04-26 JP JP2007117670A patent/JP5004646B2/ja active Active
Patent Citations (46)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5045667A (ja) * | 1973-07-30 | 1975-04-23 | ||
US4054881A (en) * | 1976-04-26 | 1977-10-18 | The Austin Company | Remote object position locater |
JPS53135671A (en) * | 1977-05-01 | 1978-11-27 | Nippon Telegr & Teleph Corp <Ntt> | Horizontal position detecting method of shield machines |
US4287809A (en) * | 1979-08-20 | 1981-09-08 | Honeywell Inc. | Helmet-mounted sighting system |
JPS5690210A (en) * | 1979-12-22 | 1981-07-22 | Nippon Telegr & Teleph Corp <Ntt> | Measurement device for position and posture angle of underground boring machine |
JPS5747200A (en) * | 1980-06-30 | 1982-03-17 | Austin Co | Apparatus for determining position and direction of remote object |
JPS60221820A (ja) * | 1983-08-05 | 1985-11-06 | Wacom Co Ltd | 位置検出装置 |
JPS625121A (ja) * | 1985-07-01 | 1987-01-12 | Hitachi Constr Mach Co Ltd | 掘進機の位置検出装置 |
JPS6238301A (ja) * | 1985-08-13 | 1987-02-19 | コミツサリア ア レネルジイ アトミツク | 物体の空間における位置及び方向を決定する装置及び方法 |
JPS63171996A (ja) * | 1986-07-22 | 1988-07-15 | 日立建機株式会社 | 掘進機の姿勢検出装置 |
JPH021241A (ja) * | 1988-11-02 | 1990-01-05 | Eiichi Bando | 顎運動の測定装置 |
JPH03162693A (ja) * | 1989-11-20 | 1991-07-12 | Sumitomo Metal Ind Ltd | 位置検出方法及び装置 |
JPH0415501A (ja) * | 1990-05-09 | 1992-01-20 | Fujikura Ltd | 金属長尺物埋設位置測定装置 |
JPH04264201A (ja) * | 1991-02-19 | 1992-09-21 | Sumitomo Metal Ind Ltd | 位置検出方法及びその装置 |
JPH04336196A (ja) * | 1991-05-10 | 1992-11-24 | Furukawa Electric Co Ltd:The | 地中推進機の推進方法 |
JPH06109862A (ja) * | 1992-09-30 | 1994-04-22 | Tokyo Gas Co Ltd | 埋設管に於ける対象個所の検知方法 |
JPH07260410A (ja) * | 1994-03-09 | 1995-10-13 | Philips Electron Nv | センサ素子の空間位置決定装置 |
JPH07295736A (ja) * | 1994-04-25 | 1995-11-10 | Sony Corp | 3次元位置検出装置 |
WO1996001539A1 (fr) * | 1994-07-01 | 1996-01-18 | Makoto Hyuga | Procede et appareil de communication |
JPH08146145A (ja) * | 1994-11-28 | 1996-06-07 | Sekisui Chem Co Ltd | 位置検出方法 |
JPH09166404A (ja) * | 1995-12-15 | 1997-06-24 | Osaka Gas Co Ltd | 物体の位置特定方法及び装置 |
JPH09325003A (ja) * | 1996-06-04 | 1997-12-16 | Sekisui Chem Co Ltd | 位置検出方法 |
JPH10108853A (ja) * | 1996-10-08 | 1998-04-28 | Eiichi Bando | 人体用の立体変位センサー |
JPH10148502A (ja) * | 1996-11-15 | 1998-06-02 | Kandenko Co Ltd | 位置検出方法 |
JPH10267655A (ja) * | 1997-03-27 | 1998-10-09 | Nippon Telegr & Teleph Corp <Ntt> | 掘削推進機の位置探査装置及び位置探査方法 |
JPH10332309A (ja) * | 1997-05-29 | 1998-12-18 | Olympus Optical Co Ltd | コイル位置測定方法 |
JPH11153674A (ja) * | 1997-11-18 | 1999-06-08 | Yotsugi Kk | 埋設物探知器 |
JP2002131009A (ja) * | 1998-03-18 | 2002-05-09 | Olympus Optical Co Ltd | 位置推定方法 |
JP2000292111A (ja) * | 1999-04-01 | 2000-10-20 | Japan Science & Technology Corp | 姿勢位置測定装置及び測定方法 |
JP2003513260A (ja) * | 1999-10-29 | 2003-04-08 | アセンション テクノロジー コーポレイション | 渦電流による誤差を低減したac磁気ポジション測定システム |
JP2003526099A (ja) * | 2000-03-07 | 2003-09-02 | コミツサリア タ レネルジー アトミーク | 磁界を使用して対象物の位置または向きを決定するための方法ならびに対応するデバイス |
JP2003530557A (ja) * | 2000-04-07 | 2003-10-14 | ノーザン・デジタル・インコーポレイテッド | 磁気的な位置または配向の決定における誤差の検出方法 |
JP2002365005A (ja) * | 2001-06-08 | 2002-12-18 | San Shield Kk | シールド機の位置検出方法及びシールド機の位置検出装置 |
JP2004536298A (ja) * | 2001-06-26 | 2004-12-02 | ノーザン・デジタル・インコーポレイテッド | 利得係数および位置決定システム |
JP2003004409A (ja) * | 2001-06-26 | 2003-01-08 | Reideikku:Kk | 位置測定方式及び位置測定装置 |
JP2003044217A (ja) * | 2001-08-01 | 2003-02-14 | Japan Science & Technology Corp | 位置・姿勢検出装置及びそれを用いたコンピュータ情報入力装置 |
JP2003084051A (ja) * | 2001-09-17 | 2003-03-19 | Ricoh Co Ltd | 磁界ベクトルセンサ及びセンサシステム |
JP2003114101A (ja) * | 2001-10-03 | 2003-04-18 | Nippon Telegr & Teleph Corp <Ntt> | 磁気式3次元位置検出装置および検出方法 |
JP2003121151A (ja) * | 2001-10-16 | 2003-04-23 | Hitachi Metals Ltd | 掘削体の位置探査方法及び位置探査装置 |
JP2005517230A (ja) * | 2002-02-05 | 2005-06-09 | センソパッド テクノロジーズ リミテッド | 計測器および方法 |
JP2004229943A (ja) * | 2003-01-30 | 2004-08-19 | Eiichi Bando | 顎運動の測定装置 |
JP2004295443A (ja) * | 2003-03-27 | 2004-10-21 | Japan Science & Technology Agency | 物体追跡装置 |
JP2008524588A (ja) * | 2004-12-21 | 2008-07-10 | キュー−トラック,コーポレーション | 近距離場位置測定システムおよび方法 |
JP2006214979A (ja) * | 2005-02-07 | 2006-08-17 | Nec Tokin Corp | 磁気式位置検出装置 |
WO2007043458A1 (ja) * | 2005-10-06 | 2007-04-19 | Olympus Corporation | 位置検出システム |
WO2008096856A1 (ja) * | 2007-02-09 | 2008-08-14 | Asahi Kasei Emd Corporation | 空間情報検出システム及びその検出方法並びに空間情報検出装置 |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011234819A (ja) * | 2010-05-07 | 2011-11-24 | Alps Electric Co Ltd | 球技装置用の磁界検知装置およびこれを使用した球技装置 |
JP2012058251A (ja) * | 2011-11-02 | 2012-03-22 | Alps Electric Co Ltd | 球技装置用の磁界検知装置およびこれを使用した球技装置 |
WO2015087735A1 (ja) | 2013-12-10 | 2015-06-18 | オリンパス株式会社 | 位置検出システム |
JP5797362B1 (ja) * | 2013-12-10 | 2015-10-21 | オリンパス株式会社 | 位置検出システム |
CN105407783A (zh) * | 2013-12-10 | 2016-03-16 | 奥林巴斯株式会社 | 位置检测系统 |
US9591991B2 (en) | 2013-12-10 | 2017-03-14 | Olympus Corporation | Position detection system |
CN106983487A (zh) * | 2017-03-14 | 2017-07-28 | 宜宾学院 | 无线胶囊内窥镜三维位置和三维姿态的定位系统及其定位方法 |
JP2019052958A (ja) * | 2017-09-15 | 2019-04-04 | 株式会社東芝 | 測位システムおよび装置 |
CN108042094A (zh) * | 2017-12-22 | 2018-05-18 | 宜宾学院 | 无线胶囊内窥镜5自由度的定位系统及其定位方法 |
CN108042094B (zh) * | 2017-12-22 | 2024-02-13 | 宜宾学院 | 无线胶囊内窥镜5自由度的定位系统及其定位方法 |
Also Published As
Publication number | Publication date |
---|---|
JP5004646B2 (ja) | 2012-08-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4875110B2 (ja) | 空間情報検出システム及びその検出方法並びに空間情報検出装置 | |
JP5004646B2 (ja) | 位置姿勢検出システム及びその検出方法並びに位置姿勢検出装置 | |
EP3644018B1 (en) | Magnetic orientation and position measurement device | |
EP2395912A1 (en) | Method and device for magnetic induction tomography | |
JP2011033609A (ja) | 室内位置検出装置 | |
JP2005061969A (ja) | 方位角計測装置及び方位角計測方法 | |
JP2011059091A (ja) | 室内位置検出装置 | |
WO2017175313A1 (ja) | 磁場センサシステム及びそれを備える軟性装置 | |
JP2000292111A (ja) | 姿勢位置測定装置及び測定方法 | |
RU2542793C1 (ru) | Устройство для определения положения объекта в пространстве | |
Lin et al. | Mathematical models of 3D magnetic field and 3D positioning system by magnetic field | |
CN116625363A (zh) | 一种多通道六自由度电磁定位跟踪方法 | |
EP3918272A1 (en) | Magnetic localization using a dc magnetometer | |
JP4648423B2 (ja) | 回転角度計測装置及び回転角度計測方法 | |
CN105651316B (zh) | 磁性位置检测装置 | |
US12031850B2 (en) | Magnetic localization using a DC magnetometer | |
US20170354347A1 (en) | Position detection system and capsule medical apparatus guidance system | |
JPH07198407A (ja) | 磁気測定器 | |
JP7023368B2 (ja) | 内視鏡システム及び内視鏡検査装置の作動方法 | |
JPH08201060A (ja) | 地磁気方位計 | |
JP6619179B2 (ja) | 位置・姿勢検出装置 | |
JP2012042401A (ja) | 電磁界ベクトル表示装置 | |
JP2011226804A (ja) | 電流検出プローブ、電流測定装置及び電流検出デバイス | |
Tadayon et al. | Wearable Magnetic Field based 3D-Orientation and-Position Acquisition | |
JP2006214979A (ja) | 磁気式位置検出装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100330 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110915 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110922 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20111027 |
|
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: 20120518 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120522 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150601 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5004646 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |