JP2004177252A

JP2004177252A - 姿勢計測装置および方法

Info

Publication number: JP2004177252A
Application number: JP2002343428A
Authority: JP
Inventors: Isao Miyagawa; 勲宮川; Kaori Hashimoto; 香織橋本; Yoshiori Wakabayashi; 佳織若林; Tomohiko Arikawa; 知彦有川
Original assignee: Nippon Telegraph and Telephone Corp
Current assignee: Nippon Telegraph and Telephone Corp
Priority date: 2002-11-27
Filing date: 2002-11-27
Publication date: 2004-06-24

Abstract

【課題】物体の周りに配置した測量手段や計測手段から取得した複数の距離情報からカメラなどと一体となっている物体の姿勢を正確に計測する。
【解決手段】レーザ光発信部１は、計測するためのレーザ光を複数の計測点から道路面に向けて照射する。レーザ光受信部２は、道路面からのレーザ光の反射を各計測点毎に受光する。反射波フィルタ部３は、それぞれ受光した反射波においてノイズ等をカットする。パルス計測部４は、レーザ光発信部１による各計測点からのレーザ照射により道路面から反射されるレーザ光をレーザ光受信部２で受光するまでのパルスをカウントする。高さ計測部５は、パルス計測部４からのパルスカウント値を距離に換算して各計測点の道路面からの高さを求める。姿勢計測部６は、複数の計測点の高さ情報から車両の姿勢を求める。姿勢情報記録部７は、逐次求めた車両の姿勢を記録する。
【選択図】図１

Description

【０００１】
【発明の属する技術分野】
本発明は、指定した平面、または基準とする平面に対する傾きを測定する計測・測量技術に関係する。また、複数のＧＰＳセンサ装置などを使って複数の位置情報から平面を求めて基準面からの姿勢を得る、または、ジャイロセンサなどを計測センサとして使って基準面からの姿勢情報を得る技術に関係する。また、市街地走行中の車両の振動、または、路面の凹凸に対する車両の傾き形状を計測する技術に関係する。
【０００２】
【従来の技術】
姿勢を計測する手段として、車速センサやジャイロセンサが代表的であり、車両やヘリコプターなどに搭載されている。これらのジャイロセンサは、時々刻々と変化する姿勢情報を計測可能である。また、複数の高精度なＤＧＰＳ装置［非特許文献２］を使って、姿勢を計測する技術も存在する。
【０００３】
また、車両などの移動手段を使って屋外環境の景観を撮影する場合、カメラの姿勢は重要なカメラパラメータとして利用される。このため、カメラ姿勢を正確に検出、推定する手法として、エピポーラ解析や因子分解法やモーションステレオによる動画像解析手法がある。さらに、外界の景観情報の全周囲景観を撮像する画像入力装置として全方位カメラが存在するが、全方位カメラの視点（光学的中心）に関する位置、方位、姿勢などのカメラパラメータ推定は全方位カメラを利用した空間測量や画像計測において重要なパラメータとなっている。
【０００４】
一方、レーザ計測技術が進歩する中で、レーザジャイロによる物体の姿勢を高精度に計測する技術がある。図７は光ファイバジャイロ（ＦＯＧ：ＦｉｂｅｒＯｐｔｉｃＧｙｒｏｓｃｏｐｅ）、または、リングレーザジャイロ（ＲＬＧ：ＲｉｎｇＬａｓｅｒＧｙｒｏｓｃｏｐｅ）の計測原理である。この計測原理は、右回りのレーザ光と左回りのレーザ光との合成光の強度変化により位相差を求めることで角速度を検出することができる。図７は、一軸周りの回転を示しているが、三軸周りの回転へも応用されており、これによりロケットなどのＲｏｌｌ，Ｐｉｔｃｈ，Ｙａｗ回転を計測する技術として航空機制御において使用されている。さらに、複合現実感などの研究では、視点位置合わせに高精度なレーザジャイロを使用している［非特許文献１］。
【０００５】
【非特許文献１】
佐藤清秀、穴吹まほろ、山本裕之、田村秀行、“屋外装着型複合現実感のためのハイブリッド位置合わせ手法”、日本バーチャルリアリティ学会論文誌、ｖｏｌ７，ｎｏ．２，ｐｐ．１２９−１３７，Ｊｕｎｅ２００２
【０００６】
【非特許文献２】
パイオニア株式会社「現在地がわかる仕組み」、［ｏｎｌｉｎｅ］、２００１年６月２６日、パイオニア株式会社［平成１４年１０月１５日検索］、インターネット、＜ＵＲＬ：ｈｔｔｐ：／／ｗｗｗ．ｐｉｏｎｅｅｒ．ｃｏ．ｊｐ／ｅ−ｐｌａｃｅ／０３／０２．ｈｔｍｌ＞
【０００７】
【発明が解決しようとする課題】
車両などの移動手段にカメラやセンサなどの計器類を搭載した屋外での移動撮影・計測は、市街地景観に関する空間データ収集の迅速性、空間情報に対する情報更新性に優れている。しかし、車両は移動中において、撮影環境の影響を受けて微小な運動をするなど、車両並びにヘリコプターなどの移動手段は屋外環境に応じて微小に変動する場合がある。例えば、道路は常に理想的な平面ではなく、上り下り坂や微小に傾きが変化する坂があり、アスファルトのメンテナンスの頻度が多くなると路面は左右で微小に傾いていることがあり、時々刻々変化する方位や姿勢を検出する必要がある。このときの微小な運動をジャイロセンサなどのセンサを利用しても正確な運動として検出することは難しい。また、屋外計測において、ＤＧＰＳ（ＤｉｆｆｅｒｅｎｔｉａｌＧｌｏｂａｌＰｏｓｉｔｉｏｎｉｎｇＳｙｓｔｅｍ）測位値などの高精度な位置情報で検出することが可能であるが、高層の建物が並ぶ場所ではビルシャドウなどにより見通し悪く、高精度なＤＧＰＳ装置を利用したとしても、それから取得する測位情報はデータ品質が悪く姿勢計測は不向きである。
【０００８】
そこで、本発明は、このような時々刻々に撮影環境に応じた微小な姿勢情報を検出、または、計測することを課題としている。
【０００９】
また、カメラなどの撮影機器を車両などの移動手段に搭載して、屋外などの環境で撮影するとき、カメラの姿勢は、ジャイロセンサなどを利用した手段だけでは計測することは困難であった。さらに、レーザジャイロを利用した姿勢計測は１０〜２０ｃｍ／秒などの極端に低速な運動に関して検知精度に及ぼす角速度の計測誤差が発生する。また、レーザジャイロは、積分計算により位置情報などを求めている場合もあり、ドリフト誤差（時間が経過するにつれての誤差）が蓄積し、場合によっては正確な位置合わせができないなどの問題がある。
【００１０】
これに対して、本発明は、物体の周りに配置した光学的計測センサまたは光学的距離測定センサなどの測量手段や計測手段を用いて取得した複数の距離情報から、例えばカメラなどと一体となっている物体の傾きや姿勢を正確に計測することを課題としている。
【００１１】
【課題を解決するための手段】
上記の課題を解決するため、本発明は、光学的な測量手段または計測手段を搭載した移動手段を使って、移動手段の姿勢情報を計測する装置であって、移動手段の周りに、ある幾何パターンに従って配置した複数の光学的な測量手段または計測手段を使って、道路または地面までの距離情報を取得する機能手段と、前記複数の光学的な測量手段または計測手段が取得した各々の距離情報から、ある基準平面に対する前記移動手段の傾斜または姿勢を測定する機能手段と、を具備することを特徴とする姿勢計測装置を、その課題の解決手段とする。
【００１２】
あるいは、光学的な測量手段または計測手段を搭載した移動手段を使って、移動手段の姿勢情報を計測する装置であって、移動手段が移動することを検出し、ある一定量移動したときの位置情報を測定する機能手段と、前記移動手段の周りに、ある幾何パターンに従って配置した複数の光学的な測量手段または計測手段を使って、道路または地面までの距離情報を取得する機能手段と、前記複数の光学的な測量手段または計測手段が取得した各々の距離情報から、前記測定された各位置情報における、ある基準平面に対する前記移動手段の傾斜または姿勢を測定する機能手段と、を具備することを特徴とする姿勢計測装置を、その課題の解決手段とする。
【００１３】
あるいは、上記の姿勢計測装置において、前記ある基準平面とする平面を設定する機能手段を具備し、前記移動手段の傾斜または姿勢を測定する機能手段では、前記設定した基準平面からの姿勢を測定することを特徴とする姿勢計測装置を、その課題の解決手段とする。
【００１４】
あるいは、光学的な測量手段または計測手段を搭載した移動手段を使って、移動手段の姿勢情報を計測する方法であって、移動手段の周りに、ある幾何パターンに従って配置した複数の光学的な測量手段または計測手段を使って、道路または地面までの距離情報を取得する段階と、前記複数の光学的な測量手段または計測手段が取得した各々の距離情報から、ある基準平面に対する前記移動手段の傾斜または姿勢を測定する段階と、を具備することを特徴とする姿勢計測方法を、その課題の解決手段とする。
【００１５】
あるいは、光学的な測量手段または計測手段を搭載した移動手段を使って、移動手段の姿勢情報を計測する方法であって、移動手段が移動することを検出し、ある一定量移動したときの位置情報を測定する段階と、前記移動手段の周りに、ある幾何パターンに従って配置した複数の光学的な測量手段または計測手段を使って、道路または地面までの距離情報を取得する段階と、前記複数の光学的な測量手段または計測手段が取得した各々の距離情報から、前記測定された各位置情報における、ある基準平面に対する前記移動手段の傾斜または姿勢を測定する段階と、を具備することを特徴とする姿勢計測方法を、その課題の解決手段とする。
【００１６】
あるいは、上記の姿勢計測方法において、前記移動手段の傾斜または姿勢を測定する段階の前に、前記ある基準平面とする平面を設定する段階を具備し、前記移動手段の傾斜または姿勢を測定する段階では、前記設定した基準平面からの姿勢を測定することを特徴とする姿勢計測方法を、その課題の解決手段とする。
【００１７】
本発明では、光学的な測量手段や計測手段を図３の車両などの移動手段の複数の計測点に取り付けて求めた各計測点の高さ情報を用いることにより、道路面の微小な傾き並びにタイヤによる振動吸収とそれに伴う車両の傾きや姿勢情報を高精度に計測する。また、カメラなどの撮像装置と組み合わせることにより、視点の姿勢を計測可能とする。本発明により計測した姿勢情報は、コンピュータビジョンにおけるカメラパラメータなどとして利用することができ、外界の物体の空間情報を高精度に計測する（空間計測、空間測量、車両を使った移動式測量）ことが可能となる。
【００１８】
【発明の実施の形態】
以下、本発明の実施の形態について図を用いて詳細に説明する。
【００１９】
［実施形態例１］
図１は本発明の第１の実施形態例に関する基本構成図である。なお、図３に示すように、本実施形態例では、姿勢計測装置を車両に取り付けた応用例について説明し、道路などの地表を走行しているときの時間的に変化する車両の姿勢を計測することを説明する。
【００２０】
本実施形態例による姿勢計測装置は、計測するためのレーザ光を発信するためのレーザ光発信部１、車両周りの複数の計測点から道路面に向けて照射されたレーザ光の道路面からの反射光を各計測点で受光するレーザ光受信部２、受光した反射波においてノイズ等をカットする反射波フィルタ部３、各計測点でのレーザ光発信部１からのレーザ光と道路面からの反射光を合波してその間のパルスをカウントするパルス計測部４、パルス計測部４からのパルスカウント値を距離に換算して道路面からの計測点の高さを求める高さ計測部５、複数の高さ情報から車両の姿勢を求める姿勢計測部６、並びに、逐次求めた車両の姿勢を記録する姿勢情報記録部７から構成される。
【００２１】
図２は、本実施形態例における処理フローを示しており、図４にはレーザ計測センサ３個を取り付けた場合、図５には４個を取り付けた場合、図６には６個を取り付けた場合の例を示す。図面左側が運転席（進行方向）であり、天井から見た図に示すような、ある幾何パターンに従った配置でレーザ計測センサを設置する。ここで、ｘｙは天井面で設定した座標系である。
【００２２】
図４では、車両の幅をＷとして、その距離を隔ててＰ_２とＰ_３の位置に２個のセンサを取り付け、その場合のｘ軸座標系での位置から車両の頭部までの長さをＬとし、その距離を隔ててＰ_１の位置に１個のセンサを取り付ける。また、図５では、車両の幅をＷとして、その距離を隔ててＰ_１とＰ_４の位置に２個のセンサを取り付け、その場合のｘ軸座標系での位置から長さをＬだけ隔てて、Ｗの幅でＰ_２とＰ_３の位置に２個のセンサを取り付けている。さらに、図６では、車両の幅をＷとして、その距離を隔ててＰ_４とＰ_５の位置に２個のセンサを取り付け、その場合のｘ軸座標系での位置から長さをＬだけ隔てて、Ｗの幅でＰ_２とＰ_３の位置に２個のセンサを取り付け、Ｐ_４とＰ_５のｘ軸座標系での位置から長さをＬ＋Ｄ_１だけ隔ててＰ_１を取り付け、Ｐ_４とＰ_５のｘ軸座標系での位置から長さを−Ｄ_２だけ隔ててＰ_６を取り付けている。これ以降、図４に示す３個のセンサ（レーザ受信部２）を有する場合を説明する。
【００２３】
図３は、３個のセンサを車両１１に搭載した場合について側面からみた図である。本実施形態例のレーザ光発信部１では、コンデンサーバンク１２などにより充電を行い、所定の電圧に達するとフラッシュランプが発光するなどして、レーザ光発信部１からレーザ光が照射される。このとき、ハーフミラー１３により車両１１の前方を計測する光と車両１１の後方を計測するためのレーザ光に分岐される。次に、目標物、すなわち、地表面（道路面）に照射される前に、一部の光を光分岐部１４で分岐して、スタートパルスとしてパルスカウンタ４−１のゲート回路をオープンにする。一方、光分岐部１４を通過したレーザ光は反射板により曲げられて車両１１の真下の点Ｐ_１の照射口１５から道路面へ照射される。
【００２４】
次に、道路面から反射した光は、点Ｐ_１の受光窓１６により検出され、その後、図略のフィルタ部において太陽光などの背景雑音が除去される。続いて、パルスカウンタ４−１に入射することで、この受光パルスはストップパルスとして機能し、ゲート回路をクローズする。ここで、スタートパルスによる時間とストップパルスによる時間差がパルスでカウントされ、高さ計測部５−１において、このパルスカウント値が距離に換算されて点Ｐ_１から道路面までの距離Ｚ_１が計測される。
【００２５】
同様に、ハーフミラー１３で分けられた光は、光分岐部１７においてパルスカウンタ４−２のゲート回路をオープンし、反射板（図４の反射ミラー２１，２２を含む）を経由して点Ｐ_２の照射口１８から車両１１後方に位置する道路面へ照射される。さらに、道路面から反射した光は点Ｐ_２の受光窓１９で検出され、図略のフィルタ部において、太陽光などの背景雑音を除去されてからパルスカウンタ４−２に入射されてゲート回路をクローズすることより、ゲート回路のスタートからクローズまでの時間差がパルスでカウントされ、高さ計測部５−２において、このパルスカウント値が距離に換算されて距離Ｚ_２が計測される。これと同じように、点Ｐ_３においても、図４のようにハーフミラー２０で反射されて分岐され反射ミラー２３，２４を含む反射板によりレーザ光が照射され、点Ｐ_３から道路面までの距離Ｚ_３が計測される。
【００２６】
各時間での高さ情報を示すために、時間を表すサフィックスとしてｉを使用し、各位置：点Ｐ_１，Ｐ_２，Ｐ_３での高さ情報をそれぞれＺ_ｉ１，Ｚ_ｉ２，Ｚ_ｉ３とする。高さ計測部５−１，５−２など（図１の高さ計測部５）から出力された各位置：点Ｐ_１，Ｐ_２，Ｐ_３での高さ情報から、姿勢計測部６は各時間での姿勢情報を算出する。つまり、図２での法線ベクトル計算では、式（１）に示す行列演算を行い、法線ベクトル（α_ｉ，β_ｉ，γ_ｉ）を求める。次に、式（２）と式（３）の演算を行い、Ｒｏｌｌ回転ψ_ｉ、並びに、Ｐｉｔｃｈ回転ω_ｉを得る。
【００２７】
【数１】

【００２８】
最後に、姿勢情報記録部７において、求めた姿勢情報（Ｒｏｌｌ回転ψ_ｉ，Ｐｉｔｃｈ回転ω_ｉ）を時系列に記録する。
【００２９】
レーザ距離計測における距離分解能、すなわち、測定誤差はレーザ光のクロック周波数に依存する。最近のレーザ光ではセンチメートルまでの測定分解能を有するレーザ計測装置が実用化されており、このレーザ光を利用する場合は、点Ｐ_１，Ｐ_２，Ｐ_３での高さ情報Ｚ_ｉ１，Ｚ_ｉ２，Ｚ_ｉ３はセンチメートルの測定誤差以内で計測可能である。本発明では、さらにクロック周波数の高いレーザ光を利用することにより、ミリメートルレベルでの高さ計測が実現できる。
【００３０】
このようにして、逐次、車両の姿勢を得ることができ、ＧＰＳ測位を利用したリモートセンシングと異なり、高層なビルが立ち並ぶ市街地環境においても高精度に車両の動く姿勢をリアルタイムに測定することができる。
【００３１】
また、図５のような幾何的パターンにセンサを配置した場合は、式（４）に従って、法線ベクトル（α_ｉ，β_ｉ，γ_ｉ）を求め、図６のような幾何的パターンに配置した場合は、式（５）に従って、法線ベクトル（α_ｉ，β_ｉ，γ_ｉ）を求めて、上記と同様に、各時間でのＲｏｌｌ回転ψ_ｉ、並びに、Ｐｉｔｃｈ回転ω_ｉを得ることができる。
【００３２】
【数２】

【００３３】
［実施形態例２］
本発明による第２の実施形態例を説明する。図８は本実施形態例に関係する基本構成図であり、実施形態例１に対して、測位計測部８があり、各時間に対応する測位情報（緯度経度、標高、方位など）を測定する。ＧＰＳ測位では位置情報と方位が取得できるだけであるため、ＧＰＳ測位に実施形態例１で測定したＲｏｌｌ回転とＰｉｔｃｈ回転を回転情報を追加して、運動情報として運動情報記録部９に記録することができる。
【００３４】
処理フローは、図２と同じであるが、図１１の処理フローで示すように、測位計測部８により得た測位情報から位置情報を求めて移動物体の移動量（１つ前に測定した点との距離など）を算出して、その距離が許容範囲以上であれば、そのときの光学的距離センサなどによる高さ情報から、その位置における姿勢情報、すなわち、Ｒｏｌｌ回転とＰｉｔｃｈ回転を計測して、測位情報から得た方位（Ｙａｗ回転）、位置情報（Ｘ，Ｙ，Ｚ）と合わせて、運動情報として記録する。つまり、静止している状態では逐次姿勢を求めない仕組みになっている。
【００３５】
［実施形態例３］
本発明による第３の実施形態例を説明する。図９は本実施形態例に関係する基本構成図である。本実施形態例における、構成、および処理フローは実施形態例１と同様であり、異なる点は、図１２の処理フローで示すように、姿勢を測定するときの基準とする面を設定する基準面設定部１０を有することである。
【００３６】
初期状態において、車両における点Ｐ_１，Ｐ_２，Ｐ_３の高さは、特に限定する必要は無い。つまり、図４から図５のような幾何的パターンで、点Ｐ_１，Ｐ_２，Ｐ_３を配置するだけで、高さ方向には適当に配置させる。その代わり、初期状態とする姿勢を本実施形態例により検出し、初期の法線ベクトル（α_１，β_１，γ_１）で張られる平面を基準面とし、それ以降に時々刻々変化する法線ベクトル（α_ｉ，β_ｉ，γ_ｉ）を初期の法線ベクトル（α_１，β_１，γ_１）からの相対的な姿勢情報として検出する。これにより、点Ｐ_１，Ｐ_２，Ｐ_３の高さを水平に同一の高さに固定しなくてもよく、基準面さえ同定するだけで、姿勢からの相対的な姿勢情報を高精度に計測することができる。
【００３７】
［実施形態例４］
本発明による第４の実施形態例を説明する。図１０は本実施形態例に関係する基本構成図である。本実施形態例は、上記した実施形態例２に実施形態例３を適用した例である。すなわち、実施形態例１に加えて、実施形態例２で説明した各時間に対応する測位情報（緯度経度、標高、方位など）を測定する測位計測部８を有するとともに、実施形態例３で説明した姿勢を測定するときの基準とする面を設定する基準面設定部１０を有する。これにより、初期状態において、車両における点Ｐ_１，Ｐ_２，Ｐ_３の高さは、特に限定する必要は無く、基準面さえ同定するだけで、姿勢からの相対的な姿勢情報と高精度に計測することができるとともに、ＧＰＳ測位では位置情報と方位が取得できるだけであるため、ＧＰＳ測位に実施形態例１で測定したＲｏｌｌ回転とＰｉｔｃｈ回転を回転情報を追加して、運動情報として運動情報記録部９に記録することができる。
【００３８】
なお、図１、図８，図９および図１０で示した装置のうちデータ処理を行う部分についは、その一部もしくは全部を、コンピュータ等の演算処理手段や制御手段を用いて実現できること、あるいは、図２、図１１および図１２で示した処理のうちデータ処理を行う手順については、その手順をコンピュータ等に実行させることができることは言うまでもなく、コンピュータ等でその各部の処理機能を実現するためのプログラム、あるいは、コンピュータ等にその処理手順を実行させるためのプログラムを、そのコンピュータ等が読み取り可能な記録媒体、例えば、フレキシブルディスクや、ＭＯ、ＲＯＭ、メモリカード、ＣＤ、ＤＶＤ、リムーバルディスクなどに記録して、保存したり、提供したりすることが可能であり、また、インターネットのような通信ネットワークを通じて、該プログラムを提供したりすることが可能である。このようにして記録媒体や通信ネットワークにより提供されたプログラムを、コンピュータ等の演算処理手段や制御手段にインストールすることで、本発明が実施可能となる。
【００３９】
【発明の効果】
本発明は、屋外撮影時などでの微小な振動に対しても、カメラ視点などの姿勢を高精度に計測できる効果があり、カメラや測量装置を取り付けた車両を使ったモービルマッピングに適用すれば、車両を剛体としたときの運動、並びに、車両に取り付けたカメラに対するカメラパラメータとしても利用することができ、屋外景観の測量、計測などに利用することができる。
【図面の簡単な説明】
【図１】本発明による第１の実施形態例に関係する基本的構成図である。
【図２】第１の実施形態例の計測点を３点とした場合の車両姿勢計測の処理フロー図である。
【図３】本発明による装置を車両に搭載した場合の実施形態例を示す図である。
【図４】３点から車両姿勢を求めるための天井からみた配置図である。
【図５】４点から車両姿勢を求めるための天井からみた配置図である。
【図６】６点から車両姿勢を求めるための天井からみた配置図である。
【図７】光ファイバジャイロ、レーザジャイロの計測原理を説明する図である。
【図８】本発明による第２の実施形態例に関係する基本的構成図である。
【図９】本発明による第３の実施形態例に関係する基本的構成図である。
【図１０】本発明による第４の実施形態例に関係する基本的構成図である。
【図１１】第２の実施形態例における距離計測を行う処理フロー図である。
【図１２】第３の実施形態例における初期状態での姿勢（基準平面）を設定する処理フロー図である。
【符号の説明】
１…レーザ光発信部
２…レーザ光受信部
３…反射波フィルタ部
４…パルス計測部４
５…高さ計測部
６…姿勢計測部
７…姿勢情報記録部
８…測位計測部
９…運動情報記録部
１０…基準面設定部

Claims

光学的な測量手段または計測手段を搭載した移動手段を使って、移動手段の姿勢情報を計測する装置であって、
移動手段の周りに、ある幾何パターンに従って配置した複数の光学的な測量手段または計測手段を使って、道路または地面までの距離情報を取得する機能手段と、
前記複数の光学的な測量手段または計測手段が取得した各々の距離情報から、ある基準平面に対する前記移動手段の傾斜または姿勢を測定する機能手段と、を具備する
ことを特徴とする姿勢計測装置。
光学的な測量手段または計測手段を搭載した移動手段を使って、移動手段の姿勢情報を計測する装置であって、
移動手段が移動することを検出し、ある一定量移動したときの位置情報を測定する機能手段と、
前記移動手段の周りに、ある幾何パターンに従って配置した複数の光学的な測量手段または計測手段を使って、道路または地面までの距離情報を取得する機能手段と、
前記複数の光学的な測量手段または計測手段が取得した各々の距離情報から、前記測定された各位置情報における、ある基準平面に対する前記移動手段の傾斜または姿勢を測定する機能手段と、を具備する
ことを特徴とする姿勢計測装置。
請求項１または請求項２に記載の姿勢計測装置において、
前記ある基準平面とする平面を設定する機能手段を具備し、
前記移動手段の傾斜または姿勢を測定する機能手段では、前記設定した基準平面からの姿勢を測定する
ことを特徴とする姿勢計測装置。
光学的な測量手段または計測手段を搭載した移動手段を使って、移動手段の姿勢情報を計測する方法であって、
移動手段の周りに、ある幾何パターンに従って配置した複数の光学的な測量手段または計測手段を使って、道路または地面までの距離情報を取得する段階と、
前記複数の光学的な測量手段または計測手段が取得した各々の距離情報から、ある基準平面に対する前記移動手段の傾斜または姿勢を測定する段階と、を具備する
ことを特徴とする姿勢計測方法。
光学的な測量手段または計測手段を搭載した移動手段を使って、移動手段の姿勢情報を計測する方法であって、
移動手段が移動することを検出し、ある一定量移動したときの位置情報を測定する段階と、
前記移動手段の周りに、ある幾何パターンに従って配置した複数の光学的な測量手段または計測手段を使って、道路または地面までの距離情報を取得する段階と、
前記複数の光学的な測量手段または計測手段が取得した各々の距離情報から、前記測定された各位置情報における、ある基準平面に対する前記移動手段の傾斜または姿勢を測定する段階と、を具備する
ことを特徴とする姿勢計測方法。
請求項４または請求項５に記載の姿勢計測方法において、
前記移動手段の傾斜または姿勢を測定する段階の前に、前記ある基準平面とする平面を設定する段階を具備し、
前記移動手段の傾斜または姿勢を測定する段階では、前記設定した基準平面からの姿勢を測定する
ことを特徴とする姿勢計測方法。