JPH0526663A - 光応用距離センサ - Google Patents

光応用距離センサ

Info

Publication number
JPH0526663A
JPH0526663A JP18075591A JP18075591A JPH0526663A JP H0526663 A JPH0526663 A JP H0526663A JP 18075591 A JP18075591 A JP 18075591A JP 18075591 A JP18075591 A JP 18075591A JP H0526663 A JPH0526663 A JP H0526663A
Authority
JP
Japan
Prior art keywords
light
distance
convex mirror
receiving device
shape
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.)
Pending
Application number
JP18075591A
Other languages
English (en)
Inventor
Tadaaki Ishikawa
忠明 石川
Masamichi Tomita
正道 富田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hitachi Ltd
Original Assignee
Hitachi Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP18075591A priority Critical patent/JPH0526663A/ja
Publication of JPH0526663A publication Critical patent/JPH0526663A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Measurement Of Optical Distance (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

(57)【要約】 【構成】光源1と前記光源から発光させる光を平面光7
として投光させるミラー2とからなる発光装置と、二次
元画像が得られる受光器3と前記受光器に前記光源から
投光された光が対象物10上で反射した光8を導く凸面
鏡4とからなる受光装置を備えた光応用距離センサにお
いて、受光装置の凸面鏡4の形状を前記受光器3により
得られる画像上において測距対象物10からの反射光8
を示している点から凸面鏡4の頂点を示す点までの画像
上での距離と、前記センサから測距対象物までの距離が
比例する関係が得られる形状とする。 【効果】画像上での距離に対して、実際の測定距離が線
形な関係となり、測距精度が均一化され、2次元受光器
視野の有効利用ができると共に、距離計算も簡素化でき
る。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】この発明は、産業用ロボット等に
搭載するに好適な、光を用いた小型軽量の距離センサに
関する。
【0002】
【従来の技術】近年、アール.エイ.ジャービス アン
ド ジェン.シー.ビルン “アンオートメーテッド
ガイディッド ビークル ウィズ マップ ビルディン
グアンド パス ファインディング ケイパビリティー
ズ”プリプリンツオブザフォース インターナショナル
シンポジウム オブ ロボティックス リサーチ ペ
ージ.155−162 1987(R.A.jarvis and J.
C.Byrne “AnAutomated Guided Vehicle with Map Buil
ding and Path Finding Capabilities”Preprints of T
he 4th International Symposium of Robotics Researc
h pp.155−162 1987 以降、公知例1と呼
ぶ)。
【0003】にあるようなスリットを用いてリングパタ
ーンを投光する光源とこの光源から出るリングパターン
の光を反射して平面光にするための円錐形ミラーからな
る全周(360°)の視野を持つ受光装置による障害物
センサの実験が行われている。この方式では、受光用円
錐形ミラーは、発光装置とCCDカメラの間に置かれ、
その視野は受光用円錐形ミラーの側からの反射光を得る
のに適した配置となっている。この方式を利用した場
合、受光装置で得られる画像上での反射光位置は、測距
対象物までの距離が遠いほど画像上で中心に近く、距離
が近いほど画像中心から離れた所に得られる。対象物ま
での距離は、画像上での反射光位置から計算されるが、
反射光位置は画素単位で得られる。公知例1の方式では
水平平面内において測距対象物までの距離を一定とし、
測距対象物を全周に渡って移動させたとすると、画像上
において反射光位置の軌跡は円を描く。測距対象物まで
の距離が遠い場合ほど円は小さく、その位置を示す画素
の数は少ないということになる。測距対象物の位置計算
は、画素を単位として行うため、画素数が少ないと特定
できる位置が少なくなる。ところが、実際の世界では、
センサを中心に円を書いた場合、距離が遠いほど円周は
大きく、測距対象物の取りうる位置は多い。従って、公
知例1の方式では、遠距離になるほど急激に測距精度が
下がる。
【0004】
【発明が解決しようとする課題】ミラーを利用いた平面
光投光面と凸面鏡を利用した広視野型受光装置を用いて
広い視野を持つ従来のアクティブステレオ型のロボット
用光応用センサでは、遠距離になるほど急激に精度が下
がるという問題があった。本発明の目的は、凸面鏡形状
を特定することにより、遠距離でも高精度の測定ができ
る光応用距離センサを提供することにある。
【0005】
【課題を解決するための手段】上記目的は、光源と前記
光源から発光させる光を平面光として投光させるミラー
とからなる発光装置と、二次元画像が得られる受光器と
前記受光器に前記光源から投光された光が対象物上で反
射した光を導く凸面鏡とからなる受光装置を備えた光応
用距離センサにおいて、前記受光器により得られる画像
上において測距対象物からの反射光を示している点から
凸面鏡の頂点を示す点までの画像上での距離と、前記セ
ンサから測距対象物までの距離が比例する関係が得られ
る形状、または、前記凸面鏡の形状を受光面への測距対
象物からの反射光の入射角と、前記センサから測距対象
物までの距離が比例する関係が得られる形状、または、
前記受光器から見て測距対象物からの反射光を反射して
いる凸面鏡上の点から凸面鏡の中心軸までの距離と、前
記センサから測距対象物までの距離が比例する関係が得
られる形状、または、その特性を近似するために球面と
円錐台形状の組合わせによって作られた凸面鏡形状にす
ることにより達成される。
【0006】
【作用】本発明による作用を図4を用いて説明する。光
源1と前記光源から発光させる光を平面光として投光さ
せるミラー2とからなる発光装置と、二次元画像が得ら
れる受光器3と前記受光器に前記光源から投光された光
が対象物上で反射した光を導く凸面鏡4とからなる受光
装置を備えた光応用距離センサにおいて、受光装置の凸
面鏡4の形状を前記受光器により得られる画像上におい
て凸面鏡4の頂点を示す点から測距対象物からの反射光
8を示している点までの距離rと、前記センサから測距
対象物10までの距離Lr16が比例する関係が得られ
る形状とする。この関係を式で表すと、
【0007】
【数1】
【0008】となる。ここで、k1 は距離についての比
例定数である。rは、受光器最大視野角と画像サイズの
比から反射光8の入射角β15によって置き換える事が
でき、
【0009】
【数2】
【0010】となる。ここで、aは比例定数である。数
1を数2を用いて表すと、
【0011】
【数3】
【0012】となる。さらに凸面鏡4の上の反射点p1
7の位置座標(x13,y12)を用いて表すと、
【0013】
【数4】
【0014】ここで、凸面鏡4の表面形状が
【0015】
【数5】
【0016】で表されるものとし、反射点p17におけ
る垂直に対する反射角度をθ21とすると、
【0017】
【数6】
【0018】
【数7】
【0019】から、
【0020】
【数8】
【0021】となる。この微分方程式を解くことによ
り、数1の特性を持つ凸面鏡形状を求めることができ
る。ここで、rは画素単位の反射光位置をもとに計算さ
れるが、この形状を用いることにより、実際の距離の変
化に対する画像上での距離の変化すなわち、距離の分解
能を均一化することができる。従って、遠距離における
測距精度の低下を防ぎ、センサ有効範囲内の全領域にお
いて均一な測距精度を得ることができる。
【0022】また、前記受光装置の凸面鏡の形状を受光
器への測距対象物からの反射光の入射角と、前記センサ
から測距対象物までの距離が比例するような形状、また
は、前記受光器から見て測距対象物からの反射光を反射
している凸面鏡上の点から凸面鏡の中心軸までの距離
と、前記センサから測距対象物までの距離が比例するよ
うな形状とすることによっても、画像上での距離の変化
に対する実際の距離の変化を均一化、または近似的に均
一化することができ、同様に遠距離における測距精度の
低下を防ぎ、センサ有効範囲内の全領域においてほぼ均
一な測距精度を得ることができる。
【0023】また、前記した特性を近似的に得るために
球面と円錐台形状の組合わせによって凸面鏡形状構成す
る場合、あらかじめ計算によって求めた前記特性を持つ
凸面鏡形状の端部付近における底面に対する角度を円錐
台形の底面に対する角度とする円錐台形と、計算により
求めた凸面鏡頂点位置を球面の頂点とし、前記円錐台形
に滑らかにつながる球面とによって構成する。この形状
の凸面鏡を用いることにより、同様に遠距離における測
距精度の低下を軽減することができる。
【0024】
【実施例】図1は本発明による光応用距離センサの説明
図、図2は発光装置の説明図、図3は受光装置の説明
図、図4は距離計算原理説明図、図5は受光器により得
られる画像上において測距対象物からの反射光を示して
いる点から凸面鏡の頂点を示す点までの画像上での距離
と、前記センサから測距対象物までの距離が比例するよ
うな凸面鏡断面形状図、図6は図5に示した凸面鏡断面
形状を球面と円錐台形により近似した凸面鏡断面形状
図、図7は各凸面鏡形状による測距精度の説明図、図8
は本光応用距離センサを無人搬送車に適用した場合の説
明図、図9は無人搬送車上のセンサ視野の説明図、図1
0は宇宙用マニピュレータへの適用例の説明図、図11
は産業用ロボットへの適用例の説明図である。以下、図
に従って説明する。
【0025】図1において、センサヘッドは光源1と平
面光投光用ミラーからなる発光装置、二次元受光面3と
受光用凸面鏡4からなる受光装置及びこれらを支え、保
護するための無色透明円筒5により構成される。発光装
置から投光された平面光は測距対象物10に当たり、そ
の反射光8が受光装置に入るという構成になっている。
この反射光画像を処理装置6上で処理し、距離画像とす
る。
【0026】図2は、発光装置の構成例である。光源1
から投光された平行ビームは、90°の頂角を持つ円錐形
ミラーである平面光投光ミラー2によって反射され、平
面内全周方向に広がる平面光7となる。
【0027】図3は、受光装置の構成例であり、前記平
面光の測距対象物上での反射光8は、受光用凸面鏡4に
よって反射され、CCDカメラである二次元受光器3に
導かれる。
【0028】図4は、本方式による測距原理を表す図で
ある。センサから測距対象物までの距離Lr16は、凸
面鏡上での反射点p17の位置座標を(x13,y1
2)とするとx13及びLs14の和の形として表さ
れ、数6,数7となる。あらかじめ、凸面鏡形状が数5
の様に分かっているものとすると、数2,数9から、画
像上での距離rがわかれば、実際の距離Lrを求めるこ
とができる。
【0029】
【数9】
【0030】ここで、受光用凸面鏡の形状が数1を満足
したものであれば、画像上での距離rから一回の乗算の
みで実際の距離Lrを求めることができる。
【0031】図5は、2次元受光器の視野角を66°
(H)×66°(V)、凸面鏡半径を80mm、凸面鏡上
での最遠点反射位置から平面光までの高さdを250mm
とした場合の受光器により得られる画像上において測距
対象物からの反射光を示している点から凸面鏡の頂点を
示す点までの画像上での距離rと、前記センサから測距
対象物までの距離Lrが比例するような凸面鏡断面形状
図である。この断面形状は数8の微分方程式を解くこと
により得られる。
【0032】図6は、図5において求めた凸面鏡断面形
状を球面と円錐台形により近似した場合の凸面鏡断面形
状図である。図5における凸面鏡断面端部における角度
を円錐台形部における角度として利用している。そのた
め、センサとしての最大測定距離を変更することなく画
素の有効利用ができ、なおかつ、図5に示した断面形状
を持つ凸面鏡より、製作が簡単である。
【0033】これらの凸面鏡形状の比較のために、各形
状を用いた場合の画像上距離rに対する実際の距離Lr
を図7に示す。条件は図5の場合と同じで、2次元受光
器の視野内を200(H)×200(V)画素に分割し
たものとしている。この図から分かるように、単なる球
面形状を用いた場合24に比べて、図5に示した形状を
用いた場合25、図6に示した形状を用いた場合26の
方が一様な精度を持っている。
【0034】図8は、本発明による光応用距離センサ2
7を無人搬送車に適用した例である。これにより、図9
に示すように無人搬送車29周囲の測距対象物30を検
出することができる。本方式による光応用距離センサで
は、遠距離でも測距精度が比較的高いので、このデータ
をもとに無人搬送車29は障害物回避、パスプランニン
グなどを行うことができる。
【0035】図10は、光応用距離センサはマニピュレ
ータ33への適用した例である。ハンド部34に搭載す
ることにより、ハンド前方の測距対象物を効果的に発
見、測距できる。また、マニピュレータ33を動作させ
て、センサを移動させつつ、次々と測定することによ
り、対象物の3次元形状を認識させることも可能であ
る。
【0036】図11は、光応用距離センサ27を障害物
センサとして産業用ロボット35に搭載した例である。
アーム上にセンサを搭載することにより360°の視野
を確保し、アーム旋回範囲内の障害物を感知することが
できる。
【0037】
【発明の効果】本発明によれば、全周の視野を持つ光応
用距離センサの遠距離における測距精度を上げることが
可能となる。本方式は、凸面鏡形状を特定することによ
って測距精度の均一化を行うため、サブピクセル演算
等、画素単位以上の精度の計算をする場合でも、領域内
の測距精度の均一化に有効である。また、精度を均一化
することにより、同一の受光器に対して計算上の有効画
素数を増やすことができ、精度向上のために受光器の画
素数を増やすなどの負担を少なくすることができる。
【図面の簡単な説明】
【図1】本発明による光応用距離センサの説明図であ
る。
【図2】発光装置の説明図である。
【図3】受光装置の説明図である。
【図4】距離計算原理説明図である。
【図5】受光器により得られる画像上において測距対象
物からの反射光を示している点から凸面鏡の頂点を示す
点までの画像上での距離と、前記センサから測距対象物
までの距離が比例するような凸面鏡断面形状図である。
【図6】図5に示した凸面鏡断面形状を球面と円錐台形
により近似した凸面鏡断面形状図である。
【図7】各凸面鏡形状による測距精度の説明図である。
【図8】本光応用距離センサを無人搬送車に適用した場
合の説明図である。
【図9】無人搬送車上のセンサ視野の説明図である。
【図10】宇宙用マニピュレータへの適用例の説明図で
ある。
【図11】産業用ロボットへの適用例の説明図である。
【符号の説明】
1…光源、2…平面光投光ミラー、3…二次元受光器、
4…受光用凸面鏡、5…無色透明円筒、6…処理装置、
7…平面光、8…反射光、9…測距対象物上で反射光の
当たっている部分、10…測距対象物。

Claims (4)

    【特許請求の範囲】
  1. 【請求項1】光源と前記光源から発光させる光を平面光
    として投光させるミラーとからなる発光装置と、二次元
    画像が得られる受光面と前記受光器に前記光源から投光
    された光が対象物上で反射した光を導く凸面鏡とからな
    る受光装置を備えた光応用距離センサにおいて、受光装
    置の凸面鏡の形状は前記受光器により得られる画像上に
    おいて測距対象物からの反射光を示している点から凸面
    鏡の頂点を示す点までの画像上での距離と、前記センサ
    から測距対象物までの距離が比例する関係が得られる形
    状であることを特徴とする光応用距離センサ。
  2. 【請求項2】光源と前記光源から発光させる光を平面光
    として投光させるミラーとからなる発光装置と、二次元
    画像が得られる受光器と前記受光器に前記発光装置から
    投光された光が対象物上で反射した光を導く凸面鏡とか
    らなる受光装置を備えた光応用距離センサにおいて、受
    光装置の凸面鏡の形状は受光器への測距対象物からの反
    射光の入射角と、前記センサから測距対象物までの距離
    が比例する関係が得られる形状であることを特徴とする
    光応用距離センサ。
  3. 【請求項3】光源と前記光源から発光させる光を平面光
    として投光させるミラーとからなる発光装置と、二次元
    画像が得られる受光器と前記受光器に前記発光装置から
    投光された光が対象物上で反射した光を導く凸面鏡とか
    らなる受光装置を備えた光応用距離センサにおいて、受
    光装置の凸面鏡の形状は前記受光器から見て測距対象物
    からの反射光を反射している凸面鏡上の点から凸面鏡の
    中心軸までの距離と、前記センサから測距対象物までの
    距離が比例する関係が得られる形状であることを特徴と
    する光応用距離センサ。
  4. 【請求項4】請求項第1項から第3項における光応用距
    離センサを実現するための手段であって、前記凸面鏡の
    形状が球面と円錐台形状の組合わせによってなることを
    特徴とする光応用距離センサ。
JP18075591A 1991-07-22 1991-07-22 光応用距離センサ Pending JPH0526663A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP18075591A JPH0526663A (ja) 1991-07-22 1991-07-22 光応用距離センサ

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP18075591A JPH0526663A (ja) 1991-07-22 1991-07-22 光応用距離センサ

Publications (1)

Publication Number Publication Date
JPH0526663A true JPH0526663A (ja) 1993-02-02

Family

ID=16088754

Family Applications (1)

Application Number Title Priority Date Filing Date
JP18075591A Pending JPH0526663A (ja) 1991-07-22 1991-07-22 光応用距離センサ

Country Status (1)

Country Link
JP (1) JPH0526663A (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009047695A (ja) * 2007-08-13 2009-03-05 Honeywell Internatl Inc レンジ測定デバイス
JP2013195302A (ja) * 2012-03-21 2013-09-30 Toyota Central R&D Labs Inc 距離測定装置
WO2013183955A1 (en) * 2012-06-07 2013-12-12 Samsung Electronics Co., Ltd. Obstacle sensing module and cleaning robot including the same

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009047695A (ja) * 2007-08-13 2009-03-05 Honeywell Internatl Inc レンジ測定デバイス
JP2013195302A (ja) * 2012-03-21 2013-09-30 Toyota Central R&D Labs Inc 距離測定装置
WO2013183955A1 (en) * 2012-06-07 2013-12-12 Samsung Electronics Co., Ltd. Obstacle sensing module and cleaning robot including the same
JP2013252431A (ja) * 2012-06-07 2013-12-19 Samsung Electronics Co Ltd 障害物感知モジュール及びそれを備えた掃除ロボット
US9020641B2 (en) 2012-06-07 2015-04-28 Samsung Electronics Co., Ltd. Obstacle sensing module and cleaning robot including the same
US9846435B2 (en) 2012-06-07 2017-12-19 Samsung Electronics Co., Ltd. Obstacle sensing module and cleaning robot including the same

Similar Documents

Publication Publication Date Title
US11022692B2 (en) Triangulation scanner having flat geometry and projecting uncoded spots
US10401143B2 (en) Method for optically measuring three-dimensional coordinates and controlling a three-dimensional measuring device
US9279662B2 (en) Laser scanner
US7633628B2 (en) Optical lens system and position measurement system using the same
JP3494075B2 (ja) 移動体の自己位置標定装置
US20040004723A1 (en) Position measuring system
CN105974427A (zh) 结构光测距装置及方法
JP2002506976A (ja) 物体の位置を検出するための光学的センサシステム
CN210464466U (zh) 基于室内环境的辅助光视觉检测装置及移动机器人
CN111947594A (zh) 一种双波长激光三维形貌扫描装置及方法
JP2020076624A (ja) ターゲット装置及び測定システム
CN106872959A (zh) 正多面体激光雷达结构及其安装方法
US5568258A (en) Method and device for measuring distortion of a transmitting beam or a surface shape of a three-dimensional object
JP5874252B2 (ja) 対象物との相対位置計測方法と装置
EP4071578B1 (en) Light source control method for vision machine, and vision machine
JPH0526663A (ja) 光応用距離センサ
CN100582653C (zh) 一种采用多束光确定位置姿态的系统和方法
JP2007327966A (ja) 光源モジュールおよびこれを用いた位置計測システム
JP3343583B2 (ja) 焦点光源付ステレオカメラによる3次元面形状推定方法
US20190080473A1 (en) Method and apparatus for monitoring a position
JPH06207812A (ja) 三次元測定用測定点指示具
CN115685155B (zh) 一种激光雷达校准设备和方法
EP3446066B1 (en) Tilt detection apparatus and method thereof
JPH04204010A (ja) 光応用距離センサ
JP2008058204A (ja) 位置計測システム