JP2011180103A - 三次元測距装置及び移動ロボット - Google Patents

Abstract

【課題】小型化及び移動ロボットに容易に搭載可能な三次元測距装置を提供する。
【解決手段】三次元測距装置１は、光学部２０と信号処理部３０を備える。光学部２０は、レーザ光を受光及び発光するレーザ受発光部２と、複数のミラー面を有し、レーザ受発光部２から発光するレーザ光の光軸と直交する軸Ｃ１を回転軸として回転駆動され、レーザ受発光部２から照射されたレーザ光をミラー面で反射して対象物に照射すると共に、対象物から反射されたレーザ光を反射してレーザ受発光部２に導くポリゴンミラー３と、を有する。信号処理部３０は、ポリゴンミラー３の回転制御とレーザ受発光部２からのレーザ光の照射タイミングの制御を行うと共に、レーザ光の受光タイミングから対象物までの距離情報を演算する。光学部２０は、回転軸Ｃ１に直交する軸を回転軸Ｃ２として、外部駆動装置を用いて揺動又は回転動作される。
【選択図】図１

Description

本発明は、例えば外界の対象物までの距離情報を取得する三次元測距装置及び移動ロボットに関する。

環境内を自律的に移動する移動ロボットは、外界情報を認識するため、三次元空間を計測することが重要となる。三次元計測に用いるセンサとしては、レーザレンジセンサや、ステレオカメラや、デプスイメージャーなどが知られている。

特許文献１には、レーザレンジセンサを用いて、三次元空間を測定する手法が開示されている。特許文献１に開示される手法では、左右方向にレーザ光を走査するレーザレンジセンサを移動ロボットに搭載し、搭載したセンサを上下方向（ピッチ方向）に揺動することで、移動ロボット前方の環境の三次元計測を可能とする。

また、本発明に関連する他の技術として、特許文献２乃至５には、ポリゴンミラーを用いて水平方向を走査させると共に、ポリゴンミラー全体や他のミラーをモータにより回転駆動制御することで垂直方向を走査させるレーザ距離測定装置が開示されている。

特開２００９−１７５０６６号公報 特開２００５−０６９９７５号公報 特開２００８−２９８５２０号公報 特開平１０−７３４３４号公報 特開２００６−３２３７６５号公報

しかしながら、レーザレンジセンサを用いた手法は、他の種類のセンサを用いた手法と比較して距離精度や外乱光に強いという利点を有しているものの、センサ自体の外形が大きなものであるという問題がある。

また、特許文献１に開示される手法では、外形の大きなレーザレンジセンサ自体を揺動させる構成であるため、三次元計測に必要とする機構が大きなものとなってしまう。

特許文献２乃至５に記載のレーザ距離測定装置によれば、比較的速い走査速度を必要とする水平方向の走査にはポリゴンミラーを使用し、比較的遅い走査速度でも構わない垂直軸方向の走査にはポリゴンミラー全体や他のミラーをモータにより回転制御することで、３次元の距離画像信号を取得することができる。しかし、特許文献２乃至５に記載の技術には、以下に説明する問題がある。

特許文献２には、レーザ光の発光部と受光部とを光軸上に対峙するように配置し、回転7駆動するポリゴンミラーにレーザ光が照射され、ポリゴンミラーのミラー面のひとつでレーザ光を反射して対象物に照射すると共に、対象物によるレーザ光の反射を異なるミラー面で反射して受光部に導くレーザ距離測定装置が開示されている。

しかし、特許文献２に開示されるレーザ距離測定装置では、それぞれ異なるミラー面を用いて、発光部から入射するレーザ光と受光部へと反射して導かれるレーザ光とを入反射するものであり、受光部及び発光部の配置構成から、小型化に制約がある。また、特許文献２に開示されるレーザ距離測定装置では、ポリゴンミラーのみを搭載した把持具自体を所定の角度範囲で往復揺動させるのみであり、発光部を含む構成全体を揺動させることは開示していないものである。このため、三次元測距装置の構成として小型化を図ると共に、限られた移動ロボットの搭載スペースに対しても容易に搭載可能とするものではない。

特許文献３及び５に開示された技術では、ポリゴンミラーや他のミラーを回転駆動させるモータが方持ち構成であるため、水平方向のアクチュエータの回転バランスをとるのが難しい。特に、装置に対して振動が加わると、共振により回転バランスが変化してしまうため、安定した３次元データを取得することができない。従って、例えば振動が大きなロボットなどに対しては、このままでは搭載させることができない。

また、特許文献４及び５に開示された技術では、ミラー・スキャナ光学系と投受光部とを分けた構成とするため、水平方向の回転に対して大きなスペースを確保する必要があり、コンパクトな設計が難しい。さらに、距離計の場合には、感度を上げるためにはできるだけ受光レンズを大きくする必要があるため、光学系を小さくすることができない。

また、特許文献４及び５に開示された技術では、ポリゴンミラーに加えて他のミラーを必要とし、投受光光学系において４回のミラー反射が必要である。レーザ距離計では、使用者に不快感を与えないため、一般的に８００〜１０００ｎｍの波長域の目に見えない赤外光を使用する。安価なミラーを使えば９５％程度の反射率しか実現できず、４回の反射により効率が８０%にまで低下する。一方で、反射率９９%の金のミラーを使用すれば、高価となってしまう。

このように従来技術では、レーザ光を走査するための構造やミラーの形状が最適でなく、また、光学部と信号処理部とが一体的に形成されているものであった。このため、三次元計測に必要とする機構全てを移動ロボットの内部に搭載することが困難である。また、移動ロボットの外形カバーの内側に収めることが可能な三次元測距装置が強く求められている。

従って、本発明の目的は、小型化を図ると共に、限られた移動ロボットの搭載スペースに対しても容易に搭載可能な三次元測距装置及びその構成を搭載した移動ロボットを提供することにある。

本発明に係る三次元測距装置は、外界の対象物までの距離情報を取得する三次元測距装置であって、光学部と、前記光学部と配線を介して接続される信号処理部と、を備え、前記光学部は、レーザ光を受光及び発光するレーザ受発光部と、複数のミラー面を有し、前記レーザ受発光部から発光するレーザ光の光軸と直交する軸を回転軸として回転駆動され、前記レーザ受発光部から照射されたレーザ光を前記ミラー面で反射して対象物に照射すると共に、対象物から反射されたレーザ光を反射して前記レーザ受発光部に導くポリゴンミラーと、を有し、前記信号処理部は、前記ポリゴンミラーの回転制御と前記レーザ受発光部からのレーザ光の照射タイミングの制御を行うと共に、レーザ光の受光タイミングから対象物までの距離情報を演算し、前記光学部は、前記ポリゴンミラーの回転軸に直交する軸を回転軸として、外部駆動装置を用いて揺動又は回転動作されることを特徴とする。

このように、三次元測距装置を、光学部と、光学部と配線を介して接続される信号処理部とに分離して構成し、信号処理部では光学部の制御及び距離情報の演算を行うものとして、光学部では、レーザ光を受光及び発光するレーザ受発光部を含むと共に、ポリゴンミラーの配置をレーザ受発光部から発光するレーザ光の光軸と直交する軸を回転軸として回転駆動される配置とし、外部駆動装置を用いて、ポリゴンミラーの回転軸に直交する軸を回転軸として光学部自体を揺動又は回転動作される構成としたことで、三次元測距装置の構成の小型化を図ると共に、限られた移動ロボットの搭載スペースに対しても容易に搭載することができる。

また、前記レーザ受発光部及び前記ポリゴンミラーを前記光学部の回転軸上に配置するようにしてもよい。これにより、光学部を揺動又は回転動作させる際に、光学部の回転径をより小さくすることができる。

さらにまた、前記光学部は、前記ポリゴンミラーの回転軸に直交する軸であって、前記光学部の略重心位置を通過する軸を回転軸として、前記外部駆動装置を用いて揺動又は回転動作されるようにしてもよい。これにより、光学部を揺動又は回転動作させる際には、より少ない駆動力により、揺動又は回転動作を実現することができる。

また、前記ポリゴンミラーは、三面又は四面のミラー面を有するようにしてもよい。これにより、光学部の外形を小さくすると共に、計測範囲及び計測周期を最大化することができる。

さらにまた、前記光学部は、前記駆動部に回転自在に支持される支持部であって、中空状に形成された支持部を側面に備え、前記光学部からの配線は、前記支持部内を通って前記信号処理部に接続されるようにしてもよい。これにより、光学部からの配線を気にせずに、無限回転を実現することができる。

さらにまた、前記光学部は、前記駆動部に回転自在に支持される支持部であって、スリップリングが端部に設けられた支持部を側面に備え、前記光学部からの配線は、前記スリップリングを介して前記信号処理部に電気的に接続されるようにしてもよい。これにより、光学部からの配線を気にせずに、無限回転を実現することができる。

また、前記信号処理部は、前記レーザ受発光部で検出したアナログ信号をデジタル信号に変換するＡＤコンバータを有するようにしてもよい。ＡＤコンバータを信号処理部側に配置することで、信号処理部と光学部間のケーブル構成をより簡素化することができる。

また、前記光学部は、前記レーザ受発光部で検出したアナログ信号をデジタル信号に変換するＡＤコンバータを有するようにしてもよい。ＡＤコンバータを光学部側に配置することで、配線で発生するノイズの影響を低減することができる。

さらにまた、前記ポリゴンミラーは、当該ポリゴンミラーを回転動作させる駆動部を内蔵するようにしてもよい。これにより、より小型化を図ることができる。

本発明に係る移動ロボットは、外界の対象物までの距離情報を取得する移動ロボットであって、光学部と、前記光学部と配線を介して接続される信号処理部と、前記光学部を揺動又は回転動作させる駆動部と、を備え、前記光学部は、レーザ光を受光及び発光するレーザ受発光部と、複数のミラー面を有し、前記レーザ受発光部から発光するレーザ光の光軸と直交する軸を回転軸として回転駆動され、前記レーザ受発光部から照射されたレーザ光を前記ミラー面で反射して対象物に照射すると共に、対象物から反射されたレーザ光を反射して前記レーザ受発光部に導くポリゴンミラーと、を有し、前記信号処理部は、前記ポリゴンミラーの回転制御と前記レーザ受発光部からのレーザ光の照射タイミングの制御を行うと共に、レーザ光の受光タイミングから対象物までの距離情報を演算し、前記駆動部は、前記ポリゴンミラーの回転軸に直交する軸を回転軸として、前記光学部を揺動又は回転動作させることを特徴とするものである。

これにより、小型化かつ少ない搭載スペースに対しても容易に搭載可能な三次元測距装置の構成を備えた移動ロボットを実現することができる。

本発明によれば、小型化を図ると共に、限られた移動ロボットの搭載スペースに対しても容易に搭載可能な三次元測距装置及びその構成を搭載した移動ロボットを提供することができる。

実施の形態１に係る三次元測距装置の光学部を示す斜視図である。 実施の形態１に係る光学部の構成を示す上面図である。 実施の形態１に係る光学部の構成を示す断面図である。 実施の形態１に係る光学部のポリゴンミラーの構成図である。 実施の形態１に係る光学部の回転動作を説明するための側面図である。 実施の形態１に係る三次元測距装置の外観構成図である。 実施の形態１に係る三次元測距装置の機能構成図である。 実施の形態１に係る光学部と信号処理部とを接続するケーブル構成を説明するための図である。 実施の形態１に係る他のケーブル構成を説明するための図である。 実施の形態１に係る三面ポリゴンミラーを用いた場合の計測状況を説明するための図である。 実施の形態１に係る二面ポリゴンミラーを用いた場合の計測状況を説明するための図である。 実施の形態１に係る大型の二面ポリゴンミラーを用いた場合の計測状況を説明するための図である。 実施の形態１に係る光学部の配置と計測状況を説明するための図である。 実施の形態１に係る光学部の配置と計測状況を説明するための図である。 実施の形態１に係る光学部の配置と計測状況を説明するための図である。 実施の形態１に係る光学部の配置と計測状況を説明するための図である。 実施の形態１に係る三次元測距装置により検出される検出点を例示する図である。

実施の形態１．
以下、図面を参照して本発明の実施の形態について説明する。図１は、本実施の形態に係る三次元測距装置の光学部を示す斜視図である。後述するように、三次元測距装置１は、光学部２０と信号処理部３０とから構成され、光学部２０の各機能は、筐体１０に備えられた各要素により実現される。

筐体１０の左右の側面部には、支持部１１が設けられている。筐体１０は、支持部１１を介して、モータなどの外部駆動装置（不図示）に回転自在に取り付けられている。筐体１０は、外部駆動装置の駆動により、Ｃ２を回転軸として所定の範囲内で揺動又は回転動作する。また、筐体１０の前面には光学部２０へのレーザ光入出射用の窓部が形成されている。窓部には平板ガラスなどの光学素子を用いたレーザ透過部材が固定されている。

筐体１０は、レーザ受発光部２と、ポリゴンミラー３と、を内部に備えている。レーザ受発光部２とポリゴンミラー３は、レーザ受発光部２の光軸とポリゴンミラー３の回転軸とが互いに直交するように配置されている。

レーザ受発光部２は、ポリゴンミラー３に向けてレーザ光を照射すると共に、ポリゴンミラー３から反射したレーザ光を受光する。レーザ受発光部２の詳細については後述する。

ポリゴンミラー３は、モータ（不図示）を内蔵した回転ポリゴンミラーである。ポリゴンミラー３は、Ｃ１を回転軸として回転動作する。ポリゴンミラー３は、回転軸Ｃ１に対して所定の角度に位置づけられた複数のミラー面を有している。なお、図に示す例では、ポリゴンミラー３は四面ミラーとして説明しているが、後述するように、四面以外のポリゴンミラーとしてもよい。

レーザ受発光部２から照射されたレーザ光は、ポリゴンミラー３により反射され、筐体１０前面の窓部を通過して外部へと照射される。外部の測定対象物により反射されたレーザ光は、筐体１０前面の窓部を通過してポリゴンミラー３へと入射し、ポリゴンミラー３により反射されたレーザ光がレーザ受発光部２へと入射する。ここで、レーザ受発光部２からのレーザ光が入射するポリゴンミラー３のミラー面と、外部の対象物から反射したレーザ光が入射するポリゴンミラー３のミラー面とは、同一のミラー面となる。

ポリゴンミラー３がＣ１を回転軸として回転動作することで、筐体１０前面の左右方向にわたって、レーザ受発光部２からのレーザ光が走査される。さらに、筐体１０がＣ２を回転軸として揺動又は回転動作することで、筐体１０前面の上下方向（ピッチ方向）にわたって、レーザ受発光部２からのレーザ光が走査される。このようにポリゴンミラー３を光学部２０内に配置し、光学部２０をピッチ方向に揺動又は回転動作することで、筐体１０の前面の所定の三次元領域にわたって、レーザ受発光部２からのレーザ光を走査させることができる。これにより、小型、かつ、回転半径の小さな光学部２０を用いて三次元測距装置１を実現することができる。

図２は、光学部の構成を示す上面図である。
ポリゴンミラー３及びレーザ受発光部２は、回転軸Ｃ２方向に沿って配置される。図２に示す例では、ポリゴンミラー３の回転軸Ｃ１と、レーザ受発光部２を含むケースとが、筐体１０の回転軸Ｃ２上に位置するように配置されている。このように、回転軸Ｃ２に対して、ポリゴンミラー３及びレーザ受発光部２の配置を規定することで、筐体１０を揺動又は回転動作させる際には、回転軸Ｃ２を中心とする光学部２０の回転半径を小さくすることができる。

なお、図に示す例では、レーザ受発光部２から照射されて光学部２０の外部に出射するレーザ光を破線により示している。また、光学部２０の外部から内部に入射されるレーザ光は広がりを持つため、そのレーザ光はハッチングにより示している。

図３は、光学部の構成を示す断面図である。尚、図に示した例では、光学部からの信号を外部へと伝達するためのケーブル４が、筐体１０の左側の側面部に設けられた支持部１１を介して引き出されているが、右側の側面部に設けられた支持部１１から引き出される配置としてもよい。

ポリゴンミラー３は、ミラー面に設けられた投受光光学仕切り板により、各面が２つの領域に分割されている。図に示す例では、外部の測定対象物により反射されたレーザ光が、受光レンズ５１及び受光素子５２へと至る際に通過する受光光学経路は、分割されたミラー面の領域のうち、上側の領域に位置する。レーザ５３から照射されたレーザ光が、ポリゴンミラー３に入射する際に通過する投光光学経路は、分割されたミラー面の領域のうち、上側の領域に位置する。

レーザ受発光部２は、受光レンズ５１と、受光素子５２と、レーザ５３と、投光レンズ５４と、を備えている。図に示す例では、投光光学系を構成するレーザ５３及び投光レンズ５４は、受光光学系を構成する受光レンズ５１及び受光素子５２の上方に配置されている。レーザ５３から投光されたレーザ光が、投光レンズ５４を介してポリゴンミラー３に照射される。ポリゴンミラー３から反射されたレーザ光が、受光レンズ５１へと入射される。受光レンズ５１は、外部から入射されたレーザ光を集光する。受光素子５２は、集光されたレーザ光を受光する。受光素子５２としては、例えば、アバランシェ・フォトダイオード（ＡＰＤ）を用いることができる。レーザ５３としては、例えば、レーザダイオード（ＬＤ）を用いることができる。

ポリゴンミラー３の上方には、エンコーダ２２が設けられている。エンコーダ２２は、ポリゴンミラー３の回転角度（角速度）を計測する。また、ポリゴンミラーは、図４（Ａ）、（Ｂ）に示すように、内部にモータ６を内蔵している。図４（Ａ）、（Ｂ）は、ポリゴンミラー３の上面図及び断面図を示す図である。ポリゴンミラー３の内部に駆動部としてのモータを備える構成とすることで、より小型化を図ることができる。

図５は、光学部の回転動作を説明するための側面図である。
上述したように、筐体１０（光学部２０）は、Ｃ２を回転軸として揺動又は回転動作する。図５に示す例では、上方向及び下方向にそれぞれ４５度回転させる場合（すなわち上下に９０度回転させる場合）の計測範囲を示している。なお、筐体１０が揺動又は回転動作する際の回転軸Ｃ２は、筐体１０（光学部２０）の重心位置付近を通過するように配置してもよい。また、例えば図５の側面図で見た場合に、筐体１０の側面の中心部を通るように配置してもよい。これにより、外部駆動装置により筐体１０を駆動する際には、より少ない駆動力により、揺動又は回転動作を実現することができる。

図６は、三次元測距装置の外観構成図である。
図６に示すように、三次元測距装置１は、Ｃ２を回転軸として揺動又は回転動作する光学部２０と、光学部２０とケーブルを介して接続される信号処理部３０と、を備えている。光学部２０と信号処理部３０とを分離型として構成することで、回転体である光学部２０は必要な要素のみを搭載すれば済むため、三次元測距装置１の光学部２０の外形をより小型化することができる。

図７は、三次元測距装置の機能構成図である。
光学部２０は、パルス出力部２１と、エンコーダ２２と、発光部２３と、受光部２４とを備えている。信号処理部３０は、制御部３１と、発光タイミング制御部３２と、距離演算部３３と、ＡＤコンバータ３４と、を備えている。光学部２０と信号処理部３０の各要素は、ケーブルに含まれる信号線により互いに接続されている。

パルス出力部２１は、制御部３１から送信されるモータ指令値に応じたモータパルスを、ポリゴンミラー３に内蔵されたモータに出力する。エンコーダ２２は、ポリゴンミラー３の回転角度（角速度）を計測する。

制御部３１は、ＣＰＵを用いて構成される。制御部３１は、ポリゴンミラー３の回転動作を制御すると共に、発光部２３からのレーザ光の発光を制御する。発光タイミング制御部３２は、エンコーダ２２の出力からポリゴンミラー３のモータの回転角度（角速度）を判定し、モータの回転角度（角速度）に応じて、レーザ光の発光タイミングを制御する。

距離演算部３３は、発光部２３からレーザ光を発光したタイミングと、受光部２４でレーザ光を受光したタイミングとから、レーザ光の飛行時間の原理（ＴＯＦ）に基づいて、対象物体までの距離情報を演算する。これにより、三次元測距装置１は、測定対象物に関する距離画像データを取得する。ここで距離画像データとは、レーザ光の照射方向を２次元走査することによって得られる複数点の距離データの集合である。

ＡＤコンバータ３４は、受光部２４で検出したアナログ信号をデジタル信号に変換する。ＡＤコンバータ３４を信号処理部３０側に配置することで、光学部２０と信号処理部３０との間のケーブル構成をより簡素化することができる。尚、本実施の形態では、ＡＤコンバータ３４を信号処理部３０側に配置した構成を例示するが、ＡＤコンバータ３４を光学部２０側に配置する構成としてもよい。ＡＤコンバータ３４を光学部２０側に配置した場合には、ケーブルを通過する際に発生するノイズの影響を低減することができる。

図８は、光学部と信号処理部とを接続するケーブル構成を説明するための図である。回転体である光学部２０から取り出されるケーブルの構成としては、さまざまな構成を採用することができる。例えば、図８に示すように、支持部１１の内部を中空構造に形成し、筐体１０の回転軸Ｃ２に沿ってケーブル４０を取り出す構成としてもよい。また、図９に示すように、信号処理部３０からのケーブル４１の信号線と、光学部２０の各要素との間を、支持部１１の端部に設けたスリップリング機構４２を用いて電気的に接続する構成としてもよい。これにより、光学部２０からの配線を気にせずに、無限回転を実現することができる。

ここで、図１、及び図１０乃至１３を参照して、ポリゴンミラーの形状や計測範囲などの関係を説明する。
図１に示したように、ポリゴンミラー３を四面のミラー形状とした場合には、比較的小さな外形とすることができ、ポリゴンミラー３前方の左方向及び右方向にそれぞれ３０度の計測範囲（すなわち、左右に６０度の計測範囲）であり、右方向から左方向にわたっての走査を１回のスキャンとして、ポリゴンミラー３の一回転ごとに４回のスキャンが可能である。

図１０（Ａ）、（Ｂ）は、三面ポリゴンミラーを用いた場合の計測状況を説明するための図である。
図１０（Ａ）、（Ｂ）に示すように、ポリゴンミラー３を三面のミラー形状とした場合には、比較的小さな外形とすることができ、ポリゴンミラー３前方の左方向及び右方向にそれぞれ４５度の計測範囲であり、ポリゴンミラー３の一回転ごとに３回のスキャンが可能である。また、ポリゴンミラー３が反時計回りに回転することで、図１０（Ａ）に示した状態から図１０（Ｂ）に示した状態へとレーザ光の走査方向が変化する。

図１１（Ａ）、（Ｂ）は、二面ポリゴンミラーを用いた場合の計測状況を説明するための図である。
図１１（Ａ）、（Ｂ）に示すように、ポリゴンミラー３を二面のミラー形状とした場合には、比較的小さな外形とすることができ、ポリゴンミラー３前方の左方向及び右方向にそれぞれ５０度の計測範囲であり、ポリゴンミラー３の一回転ごとに２回のスキャンが可能である。また、ポリゴンミラー３が反時計回りに回転することで、図１１（Ａ）に示した状態から図１１（Ｂ）に示した状態へとレーザ光の走査方向が変化する。

図１２（Ａ）、（Ｂ）は、大型の二面ポリゴンミラーを用いた場合の計測状況を説明するための図である。
図１２（Ａ）、（Ｂ）に示すように、ポリゴンミラー３を図１１（Ａ）、（Ｂ）に示した二面のポリゴンミラーと比較してより大型の二面ポリゴンミラー形状とした場合には、外形は大きくなるものの、ポリゴンミラー３前方の左方向及び右方向にそれぞれ７５度の計測範囲となり、ポリゴンミラー３の一回転ごとに２回のスキャンが可能である。また、ポリゴンミラー３が反時計回りに回転することで、図１２（Ａ）に示した状態から図１２（Ｂ）に示した状態へとレーザ光の走査方向が変化する。

このように、二面形状のポリゴンミラーでは計測周期が小さく、また、外形が大きなものとなることがある。これに対して、三面形状のポリゴンミラーでは、計測範囲や計測周期のバランスがとれており、また、四面形状のポリゴンミラーでは、用途に応じて使用すればよい。従って、ポリゴンミラー３の形状は限定されないが、例えば三面又は四面形状のポリゴンミラーを採用した場合には、光学部２０の外形を小さくすると共に、計測範囲及び計測周期を最大化することができる。

コンパクト設計で広い走査角を実現するためには、三面又は四面形状のポリゴンミラーを採用すると好適である。コンパクトなポリゴンミラー光学系を実現しようとすれば、投受光器が影となって光路をふさぐため、走査角度は、四面形状の場合には６０度、三面形状の場合には９０度が最適であった。

ポリゴンミラーと走査角度の関係は、理論値では、六面形状では最大１２０度、四面形状では１８０度、三面形状では２４０度まで取ることができる。しかし、コンパクト設計を考慮すれば理論値の１／３程度しか走査はできない。ポリゴンミラーを大きくし、光学系のスペースを広げればもう少し大きな走査角度を確保できるが、小型ロボットに搭載するには大きすぎるものとなる。

一方で、ポリゴンミラーを二面形状とすればより小型化が可能であるが、同一の走査速度を維持するためには、さらに高速回転のモータが必要である。例えば、走査速度が１０ｍｓの場合、三面形状では２０００ｒｐｍ、二面形状では３０００ｒｐｍとなる。長期間安定して連続使用するロボットの場合には、回転数が低ければ寿命が長くなる。従って、必要な走査角度と、モータの回転数と、スペースファクタとから、三面形状のポリゴンとすると好適である。

図１３乃至１６を参照して、三次元測距装置１を移動ロボットに搭載した場合の、計測のようすを説明する。図では、移動ロボットの一例としての脚式ヒューマノイドロボット１００（以下、単にロボット１００と称する。）に対して、その胴体部又は腰部に三次元測距装置１の光学部２０を搭載している。なお、ロボット１００は、脚歩行型の移動ロボットであり、移動機構として脚リンク及びこれを駆動するアクチュエータ（不図示）を有している。

例えば図１３に示すように、ロボット１００の腰部に対して三次元測距装置１の光学部２０が取り付けられる。光学部２０がＣ２を回転軸として上下方向に揺動又は回転動作することで、ロボット１００の前方を走査することができる。なお、図では、説明のため光学部２０をロボット１００の外形カバーの外側に示しているが、本実施の形態に係る三次元測距装置１の光学部２０は小型かつ薄型であるために、ロボット１００の外形カバーの内側に光学部２０を収納することが可能である。さらに、三次元測距装置１の光学部２０は、支持部１１を介して、ロボット１００の体幹部に回転自在に支持される。光学部２０を回転駆動させる駆動部としてのモータ（不図示）は、回転軸Ｃ２が水平方向となるようにロボット１００に固定されている。

また、例えば図１４に示すように、光学部２０を鉛直方向に沿って腰部から胴部にかけて配置し、Ｃ３を回転軸として光学部２０を左右方向に揺動又は回転動作することで、ロボット１００の前方を走査するようにしてもよい。

三次元測距装置１は、ロボット１００が自律移動するための路面認識に用いることができる。例えば、図１５に示すように、光学部２０を揺動又は回転動作させない状態において、ロボット１００の前方下方の路面に向けてレーザ光が照射されるように、所定の傾斜角度で光学部２０が腰部に配置されている。図に示す状態では、線分Ｌ上の検出点について、路面（各検出点）の距離情報を取得する。

また、例えば、図１６の側面視に示すように、光学部２０を揺動又は回転動作させる場合には、三次元測距装置１は、前方斜め下方向を基準方向として、上下方向にそれぞれ４５度の揺動又は回転動作を行う。これにより、図に示す例では、ロボット１００の鉛直方向下方向から水平方向へとわたって、９０度の計測範囲を実現することができる。

図１７は、三次元測距装置１により取得される検出点を例示する図である。図に示す例では、ロボット１００の前方の路面上の検出点と、路面上に存在する障害物上の検出点について、それら対象物上の検出点までの距離情報が取得される。

以上説明したように、本発明によれば、三次元測距装置１を、光学部２０と、光学部２０と配線を介して接続される信号処理部３０とに分離して構成する。信号処理部３０では、光学部２０の制御及び距離情報の演算を行う。光学部２０では、レーザ光を受光及び発光するレーザ受発光部２を含むと共に、ポリゴンミラー３の配置をレーザ受発光部２から発光するレーザ光の光軸と直交する軸を回転軸として回転駆動される配置とし、外部駆動装置を用いて、ポリゴンミラー３の回転軸に直交する軸を回転軸として光学部２０自体を揺動又は回転動作される構成としている。これにより、三次元測距装置１の構成の小型化を図ると共に、限られた移動ロボットの搭載スペースに対しても容易に搭載することができる。

また、本発明によれば、必要な信号処理回路を光学部２０（センサ）の外部に配置し、レーザ受発光部２とポリゴンミラー３のみを光学部２０内に収容している。また、レーザ受発光部２の投光器及び受光器を、ポリゴンミラー３の回転方向Ｃ１に対して上下方向に配置している。このような構成により、光学部２０内に搭載する部品を少なくすることができ、軽量かつコンパクトな三次元測距装置１を実現することができる。

さらに、三次元測距装置１は、光学部２０の回転中心と重心とが一致しているため、回転トルクの低い小さくて安価なモータにより回転させることができる。また、光学部２０を縦方向に厚く構成することができ、光学部２０を回転させる構成として無駄なスペースがなくなり、性能対スペースファクタの高い三次元測距装置１は、を実現できる。

また、従来技術では、ポリゴンミラーと光源とを同一の部材上に配置して回転させる構成とした場合には、配線の取り回しが複雑になるものであった。これに対して、本発明によれば、上述したようにして、筐体１０内部のポリゴンミラー３やレーザ受発光部２内の受光素子５２及びレーザ５３などを配置する構成としたことで、配線の取り回しを複雑化させずに、レーザ受発光部２とポリゴンミラー３とを同一の部材上に配置することができる。

なお、本発明は上述した実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。
例えば、上述した実施の形態においては、ロボットとして脚式の移動ロボットを例に説明したが、移動ロボットの構成としては、三次元測距装置を搭載可能なものであれば特に限定されるものではない。例えば、車輪を駆動することで移動する構成を備えるロボットでもよい。

本発明は、例えば外界の対象物までの距離情報を取得する三次元測距装置及び移動ロボットに利用できる。

１ 三次元測距装置、
２ レーザ受発光部、
３ ポリゴンミラー、
４ ケーブル、
５ 投受光光学仕切り板、
６ モータ、
１１ 支持部、
Ｃ１、Ｃ２、Ｃ３ 回転軸、
２０ 光学部、
２１ パルス出力部、
２２ エンコーダ、
２３ 発光部、
２４ 受光部、
３０ 信号処理部、
３１ 制御部、
３２ 発光タイミング制御部、
３３ 距離演算部、
３４ ＡＤコンバータ、
４０、４１ ケーブル、
４２ スリップリング機構、
５１ 受光レンズ、
５２ 受光素子、
５３ レーザ、
５４ 投光レンズ

１００ ロボット

Claims (18)

1. 外界の対象物までの距離情報を取得する三次元測距装置であって、
   光学部と、前記光学部と配線を介して接続される信号処理部と、を備え、
   前記光学部は、
   レーザ光を受光及び発光するレーザ受発光部と、
   複数のミラー面を有し、前記レーザ受発光部から発光するレーザ光の光軸と直交する軸を回転軸として回転駆動され、前記レーザ受発光部から照射されたレーザ光を前記ミラー面で反射して対象物に照射すると共に、対象物から反射されたレーザ光を反射して前記レーザ受発光部に導くポリゴンミラーと、を有し、
   前記信号処理部は、
   前記ポリゴンミラーの回転制御と前記レーザ受発光部からのレーザ光の照射タイミングの制御を行うと共に、レーザ光の受光タイミングから対象物までの距離情報を演算し、
   前記光学部は、前記ポリゴンミラーの回転軸に直交する軸を回転軸として、外部駆動装置を用いて揺動又は回転動作される
   ことを特徴とする三次元測距装置。
2. 前記レーザ受発光部及び前記ポリゴンミラーを前記光学部の回転軸上に配置する
   ことを特徴とする請求項１に記載の三次元測距装置。
3. 前記光学部は、前記ポリゴンミラーの回転軸に直交する軸であって、前記光学部の略重心位置を通過する軸を回転軸として、前記外部駆動装置を用いて揺動又は回転動作される
   ことを特徴とする請求項１又は２に記載の三次元測距装置。
4. 前記ポリゴンミラーは、三面又は四面のミラー面を有する
   ことを特徴とする請求項１乃至３いずれか１項に記載の三次元測距装置。
5. 前記光学部は、前記駆動部に回転自在に支持される支持部であって、中空状に形成された支持部を側面に備え、
   前記光学部からの配線は、前記支持部内を通って前記信号処理部に接続される
   ことを特徴とする請求項１乃至４いずれか１項に記載の三次元測距装置。
6. 前記光学部は、前記駆動部に回転自在に支持される支持部であって、スリップリングが端部に設けられた支持部を側面に備え、
   前記光学部からの配線は、前記スリップリングを介して前記信号処理部に電気的に接続される
   ことを特徴とする請求項１乃至４いずれか１項に記載の三次元測距装置。
7. 前記信号処理部は、前記レーザ受発光部で検出したアナログ信号をデジタル信号に変換するＡＤコンバータを有する
   ことを特徴とする請求項１乃至６いずれか１項に記載の三次元測距装置。
8. 前記光学部は、前記レーザ受発光部で検出したアナログ信号をデジタル信号に変換するＡＤコンバータを有する
   ことを特徴とする請求項１乃至６いずれか１項に記載の三次元測距装置。
9. 前記ポリゴンミラーは、当該ポリゴンミラーを回転動作させる駆動部を内蔵する
   ことを特徴とする請求項１乃至８いずれか１項に記載の三次元測距装置。
10. 外界の対象物までの距離情報を取得する移動ロボットであって、
    光学部と、前記光学部と配線を介して接続される信号処理部と、前記光学部を揺動又は回転動作させる駆動部と、を備え、
    前記光学部は、
    レーザ光を受光及び発光するレーザ受発光部と、
    複数のミラー面を有し、前記レーザ受発光部から発光するレーザ光の光軸と直交する軸を回転軸として回転駆動され、前記レーザ受発光部から照射されたレーザ光を前記ミラー面で反射して対象物に照射すると共に、対象物から反射されたレーザ光を反射して前記レーザ受発光部に導くポリゴンミラーと、を有し、
    前記信号処理部は、
    前記ポリゴンミラーの回転制御と前記レーザ受発光部からのレーザ光の照射タイミングの制御を行うと共に、レーザ光の受光タイミングから対象物までの距離情報を演算し、
    前記駆動部は、
    前記ポリゴンミラーの回転軸に直交する軸を回転軸として、前記光学部を揺動又は回転動作させる
    ことを特徴とする移動ロボット。
11. 前記レーザ受発光部及び前記ポリゴンミラーを前記光学部の回転軸上に配置する
    ことを特徴とする請求項１０に記載の移動ロボット。
12. 前記駆動部は、前記ポリゴンミラーの回転軸に直交する軸であって、前記光学部の略重心位置を通過する軸を回転軸として、前記光学部を揺動又は回転動作させる
    ことを特徴とする請求項１０又は１１に記載の移動ロボット。
13. 前記ポリゴンミラーは、三面又は四面のミラー面を有する
    ことを特徴とする請求項１０乃至１２いずれか１項に記載の移動ロボット。
14. 前記光学部は、前記駆動部に回転自在に支持される支持部であって、中空状に形成された支持部を側面に備え、
    前記光学部からの配線は、前記支持部内を通って前記信号処理部に接続される
    ことを特徴とする請求項１０乃至１３いずれか１項に記載の移動ロボット。
15. 前記光学部は、前記駆動部に回転自在に支持される支持部であって、スリップリングが端部に設けられた支持部を側面に備え、
    前記光学部からの配線は、前記スリップリングを介して前記信号処理部に電気的に接続される
    ことを特徴とする請求項１０乃至１４いずれか１項に記載の移動ロボット。
16. 前記信号処理部は、前記レーザ受発光部で検出したアナログ信号をデジタル信号に変換するＡＤコンバータを有する
    ことを特徴とする請求項１０乃至１５いずれか１項に記載の移動ロボット。
17. 前記光学部は、前記レーザ受発光部で検出したアナログ信号をデジタル信号に変換するＡＤコンバータを有する
    ことを特徴とする請求項１０乃至１５いずれか１項に記載の移動ロボット。
18. 前記ポリゴンミラーは、当該ポリゴンミラーを回転動作させる駆動部を内蔵する
    ことを特徴とする請求項１０乃至１７いずれか１項に記載の移動ロボット。