JP4298155B2 - 距離測定装置、及び距離測定方法 - Google Patents
距離測定装置、及び距離測定方法 Download PDFInfo
- Publication number
- JP4298155B2 JP4298155B2 JP2000351867A JP2000351867A JP4298155B2 JP 4298155 B2 JP4298155 B2 JP 4298155B2 JP 2000351867 A JP2000351867 A JP 2000351867A JP 2000351867 A JP2000351867 A JP 2000351867A JP 4298155 B2 JP4298155 B2 JP 4298155B2
- Authority
- JP
- Japan
- Prior art keywords
- distance
- slit
- slit light
- leg
- reflected light
- 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
- 238000000034 method Methods 0.000 title claims description 21
- 238000005259 measurement Methods 0.000 claims description 26
- 238000003384 imaging method Methods 0.000 claims description 13
- 238000001514 detection method Methods 0.000 claims description 8
- 238000009472 formulation Methods 0.000 claims description 5
- 239000000203 mixture Substances 0.000 claims description 5
- 230000003542 behavioural effect Effects 0.000 claims description 3
- 230000010391 action planning Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 7
- 230000015654 memory Effects 0.000 description 6
- 230000003287 optical effect Effects 0.000 description 6
- 238000009792 diffusion process Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000006399 behavior Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/87—Combinations of systems using electromagnetic waves other than radio waves
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/02—Picture taking arrangements specially adapted for photogrammetry or photographic surveying, e.g. controlling overlapping of pictures
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C3/00—Measuring distances in line of sight; Optical rangefinders
- G01C3/02—Details
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/481—Constructional features, e.g. arrangements of optical elements
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0248—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means in combination with a laser
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0251—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Multimedia (AREA)
- Optics & Photonics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Measurement Of Optical Distance (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Manipulator (AREA)
- Image Processing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Image Analysis (AREA)
Description
【発明の属する技術分野】
本発明は、自己が発したスリット光の反射光を撮像し、スリット光の発光位置と撮像位置の位置関係から物体までの距離を測定する距離測定装置、及び距離測定方法に関する。
【0002】
【従来の技術】
近年、CCDカメラやコンピュータ画像処理の発展に伴って画像を使用した3次元計測が一般的になってきている。CCDカメラとコンピュータ画像処理を用いた3次元計測の一つとして光切断法がある。この光切断法は、測定対象物体に対してスリット光を投影し、あたかも光の帯で物体を切断するかのようにして、別の方向からその光による切断面を観察するものである。また、レーザの出現により非常に細かく高輝度な光束が得られるようになったため、光切断法による3次元計測は、自由曲面を有している物体であっても高速で高精度な計測が行えるようになっている。
【0003】
【発明が解決しようとする課題】
光切断法は、自己が発したスリット光を自己に備えられたCCDカメラによって物体の表面におけるスリット光の反射光を撮像し、スリット光を発した方向、光源の位置、及びCCDカメラの位置から、自己と物体との間の距離を測定するものである。したがって、対象物体の全体を計測しようとする場合、スリット光を物体表面で少しずつ移動させながら、その都度反射光を撮像することによって対象物体の全体を計測するのが一般的である。この方法は、スリット光を移動させながら撮像を行うために全体像を測定するのに時間がかかるという問題がある。この問題を解決するために、スリット光を物体表面上で移動させずに自己が発するスリット光の数を複数にして、一度の撮像動作で対象物体の全体像を計測する方法がある。この方法は、一部のスリット光が撮像できなかった場合に、どのスリット光が撮像できなかったかを特定するために、スリット光に固有の幅やパターンを持たせたり、さらには色分けするなどして撮像されたスリット光を特定している。
【0004】
しかしながら、自律移動ロボット等の視覚センサとして光切断法を応用して床面及び床面に存在する障害物を検出する場合、測定対象の物体までの距離や物体形状は未知であるために、スリット光に固有の幅やパターンを持たせてその反射光を撮像して計測を行うと、画像処理の負荷が増大するという問題がある。また、色分けされた複数のスリット光を特定するには、カラーのカメラを用いて得られたカラー画像を対象にして画像処理を行う必要があるため装置が高価になるとともに、カラー画像の処理は複雑になるため画像処理の負荷が増大し、結果的に処理時間が長くなるという問題がある。さらに、スリット光に固有の幅やパターンを持たせたり、色分けされたスリット光を発光するにはスリット光を発光する機構が複雑になるという問題もある。
【0005】
本発明は、このような事情に鑑みてなされたもので、スリット光に対して特徴を付与せずに短時間で対象物体の全体像を測定することができる光切断法を用いた距離測定装置及び距離測定方法を提供することを目的とする。
【0006】
【課題を解決するための手段】
請求項1に記載の発明は、床面に対し、同時に複数のスリット光を発光するスリット光発光手段と、前記スリット光発光手段からの距離が短い位置に配置され、前記測定対象物体における前記スリット光の反射光を撮像する第1の画像撮像手段と、前記スリット光発光手段からの距離が長い位置に配置され、前記測定対象物体における前記スリット光の反射光を撮像する第2の画像撮像手段と、第1の画像撮像手段によって得られた画像における前記スリット光の反射光に基づいて反射面までの距離を算出し、前記床面の形状及び障害物を検出する検出手段と、前記検出手段における検出結果に基づいて行動計画を策定する行動計画策定手段と、前記第2の画像撮像手段によって得られた画像における前記スリット光の反射光に基づいて反射面までの距離を算出し、距離の算出結果と前記行動計画策定手段によって策定された行動計画とに基づいて、踏み出す脚の位置を決定する位置決定手段と、を備えたことを特徴とする。
【0007】
請求項2に記載の発明は、前記位置決定手段は、脚の踏み出す方向と、脚を上げる高さと、歩幅とを決定することによって前記着地位置を決定することを特徴とする。
【0008】
請求項3に記載の発明は、床面に対し、同時に複数のスリット光を発光するスリット光発光手段と、前記スリット光発光手段からの距離が短い位置に配置され、前記測定対象物体における前記スリット光の反射光を撮像する第1の画像撮像手段と、前記スリット光発光手段からの距離が長い位置に配置され、前記測定対象物体における前記スリット光の反射光を撮像する第2の画像撮像手段と、を備える歩行ロボットが、前記第1の画像撮像手段によって撮像して得られた画像における前記スリット光の反射光に基づいて反射面までの距離を算出し、前記床面の形状及び障害物を検出する検出過程と、検出結果に基づいて行動計画を策定する行動計画策定過程と、前記第2の画像撮像手段によって撮像して得られた画像における前記スリット光の反射光に基づいて反射面までの距離を算出し、距離の算出結果と策定された行動計画とに基づいて、踏み出す脚の位置を決定する位置決定過程と、を実行することを特徴とする。
【0009】
請求項4に記載の発明は、前記位置決定過程は、脚の踏み出す方向と、脚を上げる高さと、歩幅とを決定することによって前記着地位置を決定することを特徴とする。
【0010】
【発明の実施の形態】
以下、本発明の一実施形態による距離測定装置を図面を参照して説明する。
初めに、図3を参照して、距離測定装置が取り付けられる2足歩行ロボットについて説明する。図3において、符号1は、自律型の2足歩行ロボット(以下、単にロボットと称する)である。符号2は、ロボット1の腰の高さに取り付けられた距離測定装置の光学系装置である。符号3は、距離測定装置2が照射するレーザ光の照射範囲であり、レーザ光を一方向に60°拡散し、スリット光にして床面4に照射する。さらに、このスリット光がロボット1のつま先から前方の床面を照射するように光学系装置2の向きを調整する。
【0011】
図1は同実施形態の構成を示すブロック図である。この図において、符号11は、測定対象の物体に対して照射するレーザ光を発するレーザ光源である。符号12は、レーザ光源11との配置距離が短い短基線長カメラであり、インタレース走査のCCDカメラで構成される。この短基線長カメラ12は、基線長が短いために、距離測定精度が低い代わりにロボット1の前方を広い距離範囲で見渡すことができるという特徴を有している。符号13は、レーザ光源11との配置距離が長い長基線長カメラであり、インタレース走査のCCDカメラで構成される。この長基線長カメラ13は、基線長が長いために距離測定精度が高い代わりにロボット1の前方を見渡す距離範囲が制限されるという特徴を有している。また、短基線長カメラ12、及び長基線長カメラ13は、外部から同期信号を入力して動作可能なカメラである。
【0012】
符号2は、図3に示す光学系装置であり、レーザ光源11、短基線長カメラ12、及び長基線長カメラ13からなる。符号14は、レーザ光源11に対して、レーザ光の発光を制御する制御信号を出力してレーザ光源を制御する発光制御部であり、短基線長カメラ12及び長基線長カメラ13に対して垂直同期信号を出力する。符号15は、2台のカメラから出力される画像信号を取り込むための2つの画像メモリ15a、15bを備えた画像取り込み部である。画像取り込み部15は、2台の短基線長カメラ12、長基線長カメラ13の画像をそれぞれ2つの画像メモリへ格納する。
【0013】
符号16は、画像メモリ15aに取り込まれた短基線長カメラ12の画像データに基づいて、前景の測定対象物体の高さを推定する高さ推定部である。符号17は、高さ推定部16において推定された物体の状態に応じて、ロボット1の行動計画を策定する行動計画策定部である。ここでいう行動計画とは、高さ推定部16において推定された測定対象物体の高さに基づいて、移動経路を決定する場合に、障害物を避けて歩行するのか、障害物を跨いで避けるのか等のロボット1の行動を予め決めることである。符号18は、行動計画策定部17において策定された行動計画と高さ推定部16において推定された物体高さとからロボット1の脚をどのように上げてどの位置に着地されるかを決定する着地位置決定部である。符号19は、着地位置決定部18において決定された着地位置へ脚を着地させるため、脚の駆動部の制御を行う脚制御部である。
【0014】
次に、図2を参照して、図1に示すレーザ光源11の詳細な構成を説明する。図2は、図1に示すレーザ光源11の構成を示すブロック図である。図2において、符号21は、レーザ光を発光するレーザ発光部である。符号22は、レーザ発光部21から発せられたレーザ光を集光して細いビームする集光レンズである。符号23は、集光レンズ22によって細いビームにされたレーザ光を複数のビームに分ける回折格子であり、図2の紙面に垂直な方向へビームを分けるものである。符号24は、シリンドリカルレンズ等で構成されるビーム拡散レンズであり、レーザ光のビームを1方向に拡散してスリット光を生成するものである。このビーム拡散レンズ24によって、複数のビームのそれぞれは、拡散の角度が60°になるようにする。
【0015】
なお、図2において、床面の位置関係を示すと、符号4で示す直線が床面となり、符号Aの地点が、ロボット1のつま先の位置となる。また、光学系装置2をロボット1の腰の位置に取り付け、レーザ光を発光した状態を図4の模式図で示す。図4において、符号11はレーザ光源である。符号3は、床面4におけるレーザ光源から発せられたレーザ光の照射範囲を示している。ここでは、回折格子23によって、5つのビームに分けられており、さらにビーム拡散レンズ24によって5つのビームが60°に拡散されている。これらのレーザ光は、床面4に対して照射され、その反射光が基線長カメラ12及び長基線長カメラ13によって撮像される。図4においては、図を分かり易くするために回折格子23によって分けるビームの数を「5」としたが、実際には、図4に示す角度Bが32°であり、角度Cが1.6°である。したがって、ビームの数は「21」となる。
【0016】
次に、図5、6を参照して、測定動作について説明する。図5は、レーザ光源11、短基線長カメラ12、及び長基線長カメラ13の位置関係を示す図である。この図において、符号3は、レーザ光の照射範囲を示している。ここでは、図を分かり易くするために5つのビームのみを図示する。また符号L1、L2は各カメラの基線長である。基線長とは、レーザ光の発光位置とその反射光を撮像する撮像位置との距離である。長基線長カメラ13の基線長は、短基線長カメラ12の基線長より長くなるように配置されている。光切断法は、いわゆる三角測量の原理で距離を求めるのが一般的である。三角測量は、既知の2点を基準として、任意の他の地点を結ぶ三角形を作り、その角度を測ることによってその地点の位置を求めるものである。したがって、その原理から既知の2点の距離(基線長に相当)が長いほど距離精度は向上する。
【0017】
図5に示すように、基線長L2を長くするほど長基線長カメラ13の向きを決める角度(図5に示す角度D)を大きくしなければスリット光の反射光を撮像することが困難となる。しかし、基線長L2を長くして、角度Dを大きくするということは、各スリット光の識別が困難になってくる。
【0018】
一方、基線長L1を短くすれば、短基線長カメラ12の向きを決める角度(図5に示す角度E)を小さくすることができるため、測定可能距離範囲を長くすることができるとともに、各スリット光の識別が容易になるという利点がある。しかし、前述した理由から求められる距離精度は低下してしまう。
【0019】
このような特徴を利用して、距離を正確に測定し、ロボット1の歩行制御を行なえるようにする為には、それぞれの利点のみを使用して測定を行うようにすればよい。すなわち、距離精度の低い短基線長カメラ12によって、測定対象を広い距離範囲で測定し、大まかな距離の推定を行った後に、距離精度の高い長基線長カメラ13によって必要な測定対象の物体までの距離を確定する。
【0020】
この動作を図6を参照して説明する。図6は、距離測定の動作を示すフローチャートである。まず、画像取り込み部15は、短基線長カメラ12及び長基線長カメラ13で撮像した画像を取り込み、それぞれの画像を画像メモリ15a、15bに格納する(ステップS1)。
【0021】
次に、高さ推定部16は、短基線長カメラ12によって撮像され、画像メモリ15aに格納された画像データを処理して、床全体の形状及び障害物を検出する(ステップS2)。この検出は、前述した三角測量の原理によって、スリット光の反射光が映っている画素のそれぞれについて距離を求めることによって行われる。
【0022】
次に、行動計画策定部17は、高さ推定部26において検出された床や障害物を考慮して、ロボット1の行動計画を策定する(ステップS3)。この行動計画を策定して得られる結果は、例えば、「右に迂回して移動する」、「この先階段があるので階段の直前までこのまま移動して、階段の直前で一度停止し、階段を昇って移動する」などである。
【0023】
次に、着地位置決定部18は、長基線長カメラ13によって撮像され、画像メモリ15bに格納された画像データを処理して、踏み出す脚の位置を決定する(ステップS4)。このとき、着地位置決定部18は、行動計画及び高さ推定部16における障害物検出結果を参考にして着地位置を決定する。着地位置を決定するには、脚の踏み出す方向と脚を上げる高さを決定するとともに、歩幅を決定する必要がある。これらを決定するには、精度の高い距離計測データを必要とするために長基線長カメラ13の画像を用いる。これによって、正確な脚の着地位置が決定できる。また、一部のスリット光が撮像できなかった場合であっても、短基線長カメラ12によって得られた画像によって床の全体形状と障害物の検出が既にされているために、長基線長カメラ13によって撮像されたスリット光は、距離の精度を向上させるために用いればよい。
【0024】
次に、脚制御部19は、着地位置決定部18において決定された着地位置に脚が踏み出されるように脚の駆動部を制御して、ロボット1を移動する(ステップS5)。
【0025】
このように、複数のスリット光を同時に発光して、短基線長カメラ12によって得られた画像から大まかな距離推定を行い、その推定結果を参考にして、長基線長カメラ13によって得られた画像から測定距離を確定するようにしたため、必要な領域において精度良く距離測定が可能となる。また、1つの光源(レーザ発光部21)から複数のスリット光を生成するようにしたため、カラー画像を得る必要はなく、輝度情報が得られるカメラを用いて処理することが可能となる。さらに、複数のスリット光を回折格子23とビーム拡散レンズ24によって生成したため、レーザ光源11の構成を簡単にすることができる。
【0026】
なお、図5における基線長L1は、行動計画を策定するのに必要な距離精度が得られる最短距離とすればよい。また、角度Eは、行動計画を策定するのに必要な測定領域が使用するカメラの画角でも見渡せる最小角度とすればよい。
また、基線長L2は、脚の着地位置を決定するのに必要な距離とすればよい。また、角度Dは、脚の最大歩幅から決まる領域が見渡せる角度とすればよい。
【0027】
また、2台のカメラから得られた2つの画像に対してステレオ立体視処理を施し、その結果に基づいて距離画像を生成して、この距離画像を着地位置を決定する処理に用いてもよい。このようにすることによって、さらに測定距離を確定する場合に、精度の向上を図ることができる。また、レーザ光源11を短基線長カメラ12と長基線長カメラ13との間に配置したため、照射したスリット光を効率良く撮像することが可能となる。
【0028】
【発明の効果】
以上説明したように、この発明によれば、自己が発したスリット光の反射光を撮像し、スリット光の発光位置と撮像位置の位置関係から物体までの距離を測定する場合に、複数のスリット光を同時に発光して、短基線長カメラによって得られた画像から大まかな距離推定を行い、その推定結果を参考にして、長基線長カメラによって得られた画像から測定距離を確定するようにしたため、必要な領域において精度良く短時間で距離測定が可能になるという効果が得られる。また、1つの光源(レーザ発光部)から複数のスリット光を生成するようにしたため、カラー画像を得る必要はなく、輝度情報が得られるカメラを用いて処理することが可能になるという効果が得られる。さらに、複数のスリット光を回折格子とビーム拡散レンズによって生成したため、レーザ光源の構成を簡単にすることができるという効果が得られる。
【図面の簡単な説明】
【図1】 本発明の一実施形態の構成を示すブロック図である。
【図2】 図1に示すレーザ光源11の構成を示すブロック図である。
【図3】 2足歩行ロボット1の外観を示す説明図である。
【図4】 光学系装置2からレーザ光を発光した状態を示す模式図である。
【図5】 レーザ光源11、短基線長カメラ12、及び長基線長カメラ13の位置関係を示す説明図である。
【図6】 距離測定動作を示すフローチャートである。
【符号の説明】
1・・・ロボット、
2・・・光学系装置、
3・・・レーザ照射範囲、
4・・・床面、
11・・・レーザ光源、
12・・・短基線長カメラ、
13・・・長基線長カメラ、
14・・・発光制御部、
15・・・画像取り込み部、
16・・・高さ推定部、
17・・・行動計画策定部、
18・・・着地位置決定部、
19・・・脚制御部、
21・・・レーザ発光部、
22・・・集光レンズ、
23・・・回折格子、
24・・・ビーム拡散レンズ。
Claims (4)
- 床面に対し、同時に複数のスリット光を発光するスリット光発光手段と、
前記スリット光発光手段からの距離が短い位置に配置され、測定対象物体における前記スリット光の反射光を撮像する第1の画像撮像手段と、
前記スリット光発光手段からの距離が長い位置に配置され、前記測定対象物体における前記スリット光の反射光を撮像する第2の画像撮像手段と、
第1の画像撮像手段によって得られた画像における前記スリット光の反射光に基づいて反射面までの距離を算出し、前記床面の形状及び障害物を検出する検出手段と、
前記検出手段における検出結果に基づいて行動計画を策定する行動計画策定手段と、
前記第2の画像撮像手段によって得られた画像における前記スリット光の反射光に基づいて反射面までの距離を算出し、距離の算出結果と前記行動計画策定手段によって策定された行動計画とに基づいて、踏み出す脚の位置を決定する位置決定手段と、
を備えたことを特徴とする歩行ロボット。 - 前記位置決定手段は、脚の踏み出す方向と、脚を上げる高さと、歩幅とを決定することによって前記着地位置を決定することを特徴とする請求項1に記載の歩行ロボット。
- 床面に対し、同時に複数のスリット光を発光するスリット光発光手段と、前記スリット光発光手段からの距離が短い位置に配置され、測定対象物体における前記スリット光の反射光を撮像する第1の画像撮像手段と、前記スリット光発光手段からの距離が長い位置に配置され、前記測定対象物体における前記スリット光の反射光を撮像する第2の画像撮像手段と、を備える歩行ロボットが、
前記第1の画像撮像手段によって撮像して得られた画像における前記スリット光の反射光に基づいて反射面までの距離を算出し、前記床面の形状及び障害物を検出する検出過程と、
検出結果に基づいて行動計画を策定する行動計画策定過程と、
前記第2の画像撮像手段によって撮像して得られた画像における前記スリット光の反射光に基づいて反射面までの距離を算出し、距離の算出結果と策定された行動計画とに基づいて、踏み出す脚の位置を決定する位置決定過程と、
を実行することを特徴とする歩行ロボット制御方法。 - 前記位置決定過程は、脚の踏み出す方向と、脚を上げる高さと、歩幅とを決定することによって前記着地位置を決定することを特徴とする請求項3に記載の歩行ロボット制御方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000351867A JP4298155B2 (ja) | 2000-11-17 | 2000-11-17 | 距離測定装置、及び距離測定方法 |
US09/985,432 US6483536B2 (en) | 2000-11-17 | 2001-11-02 | Distance measuring apparatus and method employing two image taking devices having different measurement accuracy |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000351867A JP4298155B2 (ja) | 2000-11-17 | 2000-11-17 | 距離測定装置、及び距離測定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2002156209A JP2002156209A (ja) | 2002-05-31 |
JP4298155B2 true JP4298155B2 (ja) | 2009-07-15 |
Family
ID=18824846
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2000351867A Expired - Fee Related JP4298155B2 (ja) | 2000-11-17 | 2000-11-17 | 距離測定装置、及び距離測定方法 |
Country Status (2)
Country | Link |
---|---|
US (1) | US6483536B2 (ja) |
JP (1) | JP4298155B2 (ja) |
Families Citing this family (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1364275A (zh) * | 2000-02-10 | 2002-08-14 | 索尼公司 | 自动装置、信息提供装置、机器人装置和交易方法 |
JP2002139304A (ja) | 2000-10-30 | 2002-05-17 | Honda Motor Co Ltd | 距離測定装置、及び距離測定方法 |
DE10063380B4 (de) * | 2000-12-19 | 2005-06-09 | Heraeus Med Gmbh | Verfahren und Vorrichtung zur Video-Aufnahme eines beleuchteten Feldes |
US6801875B1 (en) * | 2001-04-18 | 2004-10-05 | Caliper Life Sciences, Inc. | Methods, systems, and software for performing measurements |
US6507773B2 (en) * | 2001-06-14 | 2003-01-14 | Sharper Image Corporation | Multi-functional robot with remote and video system |
KR100556612B1 (ko) * | 2002-06-29 | 2006-03-06 | 삼성전자주식회사 | 레이저를 이용한 위치 측정 장치 및 방법 |
US7424133B2 (en) * | 2002-11-08 | 2008-09-09 | Pictometry International Corporation | Method and apparatus for capturing, geolocating and measuring oblique images |
WO2005008174A1 (ja) * | 2003-07-23 | 2005-01-27 | Brother Kogyo Kabushiki Kaisha | 3次元形状検出装置、撮像装置、及び、3次元形状検出方法 |
JP2005176018A (ja) * | 2003-12-12 | 2005-06-30 | Olympus Corp | 制御装置、制御プログラム、記憶媒体及び制御方法 |
DE102004010710B4 (de) * | 2004-03-04 | 2006-06-08 | Siemens Ag | Verfahren zum Betreiben einer mobilen Einrichtung zur Projektion von Bilddaten sowie mobile Projektoreinrichtung |
JP4477924B2 (ja) * | 2004-03-31 | 2010-06-09 | 本田技研工業株式会社 | 移動ロボットの外部検出装置 |
US7327440B2 (en) * | 2004-08-16 | 2008-02-05 | James N. Horn | Distance measuring device |
US7375801B1 (en) * | 2005-04-13 | 2008-05-20 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Video sensor with range measurement capability |
US7609249B2 (en) * | 2005-04-21 | 2009-10-27 | Avago Technologies Ecbu Ip (Singapore) Pte. Ltd. | Position determination utilizing a cordless device |
US20070109527A1 (en) * | 2005-11-14 | 2007-05-17 | Wenstrand John S | System and method for generating position information |
JP5320880B2 (ja) * | 2007-11-30 | 2013-10-23 | 日産自動車株式会社 | 距離計測装置、距離計測方法および車両 |
JP5150234B2 (ja) * | 2007-12-14 | 2013-02-20 | 株式会社トプコン | 測量装置 |
JP4985420B2 (ja) * | 2008-01-18 | 2012-07-25 | トヨタ自動車株式会社 | 床面検出システム、移動ロボット及び床面検出方法 |
JP5310236B2 (ja) * | 2009-04-28 | 2013-10-09 | トヨタ自動車株式会社 | 脚式ロボットとその制御方法 |
JP5418061B2 (ja) * | 2009-08-20 | 2014-02-19 | 沖電気工業株式会社 | 遠隔コミュニケーション装置、遠隔コミュニケーション方法、および遠隔コミュニケーションシステム |
US20130027548A1 (en) * | 2011-07-28 | 2013-01-31 | Apple Inc. | Depth perception device and system |
CN102538793B (zh) * | 2011-12-23 | 2015-03-18 | 北京控制工程研究所 | 一种双基线非合作目标双目测量系统 |
US9784577B2 (en) * | 2012-03-16 | 2017-10-10 | Lg Innotek Co., Ltd. | Measuring distance from object by using size of pattern projected onto object |
JP6161714B2 (ja) * | 2012-11-07 | 2017-07-12 | アルテック・ヨーロッパ・ソシエテ・ア・レスポンサビリテ・リミテ | 3次元の物体の直線寸法を制御する方法 |
CN104392629B (zh) * | 2014-11-07 | 2015-12-09 | 深圳市中天安驰有限责任公司 | 检测车距的方法和装置 |
CN106716282B (zh) * | 2016-12-17 | 2019-06-11 | 深圳前海达闼云端智能科技有限公司 | 一种对目标进行控制的方法、控制装置及控制设备 |
JP6509279B2 (ja) * | 2017-05-31 | 2019-05-08 | 本田技研工業株式会社 | 物標認識システム、物標認識方法、およびプログラム |
EP3792189A4 (en) * | 2018-05-09 | 2022-01-26 | Kawasaki Jukogyo Kabushiki Kaisha | SAMPLING METHOD AND SAMPLING SYSTEM |
CN109631836A (zh) * | 2019-01-15 | 2019-04-16 | 山东省国土测绘院 | 一种云底高度快速测量方法 |
US11568636B2 (en) * | 2019-05-02 | 2023-01-31 | Advanced Geosciences, Inc. | Reflective cable locating system |
US10937232B2 (en) | 2019-06-26 | 2021-03-02 | Honeywell International Inc. | Dense mapping using range sensor multi-scanning and multi-view geometry from successive image frames |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA1266562A (en) * | 1986-09-24 | 1990-03-13 | Donald Stewart | Distance measuring apparatus |
JPH01265510A (ja) | 1988-04-15 | 1989-10-23 | Showa Denko Kk | 固体電解コンデンサの製造方法 |
US4957369A (en) * | 1989-01-23 | 1990-09-18 | California Institute Of Technology | Apparatus for measuring three-dimensional surface geometries |
DE4130237A1 (de) * | 1991-09-11 | 1993-03-18 | Zeiss Carl Fa | Verfahren und vorrichtung zur dreidimensionalen optischen vermessung von objektoberflaechen |
US5374985A (en) * | 1992-01-02 | 1994-12-20 | Ocutech, Inc. | Method and apparatus for measuring range by use of multiple range baselines |
JP2800531B2 (ja) * | 1992-02-28 | 1998-09-21 | 三菱電機株式会社 | 車両用障害物検出装置 |
JPH06265321A (ja) | 1993-03-11 | 1994-09-20 | Mitsubishi Heavy Ind Ltd | 外観検査方法 |
JPH06265320A (ja) | 1993-03-11 | 1994-09-20 | Mitsubishi Heavy Ind Ltd | 外観検査方法 |
JPH07174553A (ja) | 1993-12-20 | 1995-07-14 | Nippon Telegr & Teleph Corp <Ntt> | ステレオカメラ装置および距離導出方法 |
JP3178205B2 (ja) | 1993-12-20 | 2001-06-18 | ミノルタ株式会社 | 画像入力システム |
JP3282332B2 (ja) | 1993-12-20 | 2002-05-13 | ミノルタ株式会社 | 画像入力システム |
US5699161A (en) | 1995-07-26 | 1997-12-16 | Psc, Inc. | Method and apparatus for measuring dimensions of objects on a conveyor |
DE19615246A1 (de) * | 1996-04-18 | 1997-10-23 | Krupp Foerdertechnik Gmbh | Photogrammetrie-Verfahren zur dreidimensionalen Verfolgung von bewegten Objekten |
US5812269A (en) * | 1996-07-29 | 1998-09-22 | General Scanning, Inc. | Triangulation-based 3-D imaging and processing method and system |
-
2000
- 2000-11-17 JP JP2000351867A patent/JP4298155B2/ja not_active Expired - Fee Related
-
2001
- 2001-11-02 US US09/985,432 patent/US6483536B2/en not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
US20020060783A1 (en) | 2002-05-23 |
JP2002156209A (ja) | 2002-05-31 |
US6483536B2 (en) | 2002-11-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4298155B2 (ja) | 距離測定装置、及び距離測定方法 | |
US7800643B2 (en) | Image obtaining apparatus | |
JP6528447B2 (ja) | 視差演算システム及び距離測定装置 | |
JP2002139304A (ja) | 距離測定装置、及び距離測定方法 | |
JP2002131016A (ja) | 距離測定装置、及び距離測定方法 | |
US20170010356A1 (en) | 3d measuring machine | |
JP2006505784A (ja) | 測距装置 | |
JP2001249007A (ja) | オフセット測定方法、ツール位置検出方法およびボンディング装置 | |
JPH0683442A (ja) | 走行ロボット | |
JP2008241643A (ja) | 3次元形状測定装置 | |
JP2005509879A (ja) | 三次元計測における対応ポイントを決定する方法 | |
JP2007093412A (ja) | 3次元形状測定装置 | |
JP2002139310A (ja) | 三次元計測装置および三次元計測方法 | |
JPH04158205A (ja) | 形状計測内視鏡装置 | |
JP3324809B2 (ja) | 三次元測定用測定点指示具 | |
EP1202074B1 (en) | Distance measuring apparatus and distance measuring method | |
JP2002131017A (ja) | 距離測定装置、及び距離測定方法 | |
JP3640012B2 (ja) | 露光装置におけるマスクあるいはウエハのレベリング用計測方法及び計測制御装置 | |
JP2004020536A (ja) | 三次元形状計測装置 | |
JP2504944B2 (ja) | 3次元情報処理方法 | |
JPS5855804A (ja) | 物体検知装置 | |
JPH08304040A (ja) | 3次元形状測定装置 | |
JPH11183142A (ja) | 三次元画像撮像方法及び三次元画像撮像装置 | |
JP2003185420A (ja) | 三次元形状測定方法、三次元形状測定装置 | |
JPS62291512A (ja) | 距離測定装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20061201 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20081009 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081014 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20081215 |
|
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: 20090407 |
|
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: 20090415 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 4298155 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120424 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130424 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130424 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140424 Year of fee payment: 5 |
|
LAPS | Cancellation because of no payment of annual fees |