JPH08271227A - 段差検出装置 - Google Patents
段差検出装置Info
- Publication number
- JPH08271227A JPH08271227A JP7073018A JP7301895A JPH08271227A JP H08271227 A JPH08271227 A JP H08271227A JP 7073018 A JP7073018 A JP 7073018A JP 7301895 A JP7301895 A JP 7301895A JP H08271227 A JPH08271227 A JP H08271227A
- Authority
- JP
- Japan
- Prior art keywords
- group
- light
- light beam
- light emitting
- moving device
- 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
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 16
- 238000013459 approach Methods 0.000 claims abstract description 30
- 108091008695 photoreceptors Proteins 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 14
- 238000000034 method Methods 0.000 description 13
- 238000006243 chemical reaction Methods 0.000 description 4
- 230000003287 optical effect Effects 0.000 description 2
- 101001080825 Homo sapiens PH and SEC7 domain-containing protein 1 Proteins 0.000 description 1
- 241000255777 Lepidoptera Species 0.000 description 1
- 102100027472 PH and SEC7 domain-containing protein 1 Human genes 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000001771 impaired effect Effects 0.000 description 1
- 230000001678 irradiating effect Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
- 238000011179 visual inspection Methods 0.000 description 1
Landscapes
- Length Measuring Devices By Optical Means (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】
【目的】 移動装置が進行方向前方の段差に進入する
際、段差に対する進入角として簡単に検出し、安全性の
高いかつコンパクトな段差検出装置を提供する。 【構成】 移動装置1の移動方向前方に前記光ビームの
スポット群をM行×N列アレイ状に配置形成するように
照射する複数の発光素子2と、前記形成された光ビーム
スポット群の夫々からの反射ビームを検出する受光素子
群4と、前記受光素子群からの信号出力を処理する信号
処理装置5とを有し、該信号処理装置5が、前記受光素
子群からの出力値に基づき算出された段差稜線部と予め
設定された前記光ビームスポット群の行間間隔と列間間
隔とから算出される幾何学的値とを比較判断し、前記段
差稜線部と前記移動装置の移動方向との相対角度を演算
処理する。
際、段差に対する進入角として簡単に検出し、安全性の
高いかつコンパクトな段差検出装置を提供する。 【構成】 移動装置1の移動方向前方に前記光ビームの
スポット群をM行×N列アレイ状に配置形成するように
照射する複数の発光素子2と、前記形成された光ビーム
スポット群の夫々からの反射ビームを検出する受光素子
群4と、前記受光素子群からの信号出力を処理する信号
処理装置5とを有し、該信号処理装置5が、前記受光素
子群からの出力値に基づき算出された段差稜線部と予め
設定された前記光ビームスポット群の行間間隔と列間間
隔とから算出される幾何学的値とを比較判断し、前記段
差稜線部と前記移動装置の移動方向との相対角度を演算
処理する。
Description
【0001】
【産業上の利用分野】本発明は、移動装置が段差に進入
する時に、その進入角度を検出する装置に関するもので
ある。
する時に、その進入角度を検出する装置に関するもので
ある。
【0002】
【従来の技術】従来の自走式移動装置は、路面状態が平
坦で段差がない整備された工場内など限られた環境で使
用されていた。その路面検出法は、床に設置された磁気
テープや光学的な反射テープを専用の装置で検出するな
ど予め決められた走行経路によって誘導していた。しか
しながら最近になり、決められた経路でなく自由度をも
った移動装置の検討がなされている。移動装置が、走行
する際、平坦な所ばかりでなく傾斜や段差ならびに階段
などのある複雑な路面を安全に走行できるか否かを事前
に判断する必要がある。従来、移動装置が移動する方向
の路面状態を事前に検出する段差検出手段を備えた路面
検出装置に関するものとして、例えば特開昭62−16
2112号公報に記載されているものがある。この段差
検出法は、1つの光ビームや複数の光ビームを用いて、
三角測量の原理から路面の凹凸を検出する方法である。
坦で段差がない整備された工場内など限られた環境で使
用されていた。その路面検出法は、床に設置された磁気
テープや光学的な反射テープを専用の装置で検出するな
ど予め決められた走行経路によって誘導していた。しか
しながら最近になり、決められた経路でなく自由度をも
った移動装置の検討がなされている。移動装置が、走行
する際、平坦な所ばかりでなく傾斜や段差ならびに階段
などのある複雑な路面を安全に走行できるか否かを事前
に判断する必要がある。従来、移動装置が移動する方向
の路面状態を事前に検出する段差検出手段を備えた路面
検出装置に関するものとして、例えば特開昭62−16
2112号公報に記載されているものがある。この段差
検出法は、1つの光ビームや複数の光ビームを用いて、
三角測量の原理から路面の凹凸を検出する方法である。
【0003】また、段差や階段などの不整地を走行する
移動装置として、クローラ式移動装置がある。特に、こ
の方式で階段の昇降を安全に行わせるためには、適切な
角度で階段(または段差)に進入することが重要であ
る。この移動装置の進入角度の判断は、人間の視覚的判
断により行われているのが現状である。
移動装置として、クローラ式移動装置がある。特に、こ
の方式で階段の昇降を安全に行わせるためには、適切な
角度で階段(または段差)に進入することが重要であ
る。この移動装置の進入角度の判断は、人間の視覚的判
断により行われているのが現状である。
【0004】
【発明が解決しようとする課題】しかしながら、従来の
光ビームを用いて三角測量の原理から段差を検出する方
法では、段差の高さ情報は得られるが、水平方向の情報
が直接的に得ることができず、段差が階段であるかどう
かの判断ができないという欠点がある。また、前記のよ
うなクローラ式移動装置が段差部に進入し昇降する際、
人間の目測のみに頼って正しい角度で進入するため、走
行可能な段差に対する進入角度が大きいとクローラが段
差にかみ合わずに、移動装置が転倒してしまい危険であ
るという安全性の問題がある。
光ビームを用いて三角測量の原理から段差を検出する方
法では、段差の高さ情報は得られるが、水平方向の情報
が直接的に得ることができず、段差が階段であるかどう
かの判断ができないという欠点がある。また、前記のよ
うなクローラ式移動装置が段差部に進入し昇降する際、
人間の目測のみに頼って正しい角度で進入するため、走
行可能な段差に対する進入角度が大きいとクローラが段
差にかみ合わずに、移動装置が転倒してしまい危険であ
るという安全性の問題がある。
【0005】本発明の目的は、移動装置が進行方向前方
の段差に進入する際、段差に対する進入角度を簡単に検
出し、安全性の高いかつコンパクトな段差検出装置を提
供しようとするものである。
の段差に進入する際、段差に対する進入角度を簡単に検
出し、安全性の高いかつコンパクトな段差検出装置を提
供しようとするものである。
【0006】
【課題を解決するための手段】上記課題を解決するため
に、請求項1は、移動装置に設けられた発光素子から照
射された光ビームにより、移動装置に対する段差の方向
位置を検出する段差検出装置において、移動方向前方に
前記光ビームのスポット群をM行×N列アレイ状に配置
形成するように照射する複数の発光素子と、前記形成さ
れた光ビームスポット群の夫々からの反射ビームを検出
する受光素子群と、前記受光素子群からの信号出力を処
理する信号処理装置とを有し、該信号処理装置が、受光
素子群からの出力値に基づき算出された段差稜線部と予
め設定された前記光ビームスポット群の行間間隔と列間
間隔とから算出される幾何学的値とを比較判断し、前記
段差稜線部と前記移動装置の移動方向との相対角度を演
算処理することを特徴とする。
に、請求項1は、移動装置に設けられた発光素子から照
射された光ビームにより、移動装置に対する段差の方向
位置を検出する段差検出装置において、移動方向前方に
前記光ビームのスポット群をM行×N列アレイ状に配置
形成するように照射する複数の発光素子と、前記形成さ
れた光ビームスポット群の夫々からの反射ビームを検出
する受光素子群と、前記受光素子群からの信号出力を処
理する信号処理装置とを有し、該信号処理装置が、受光
素子群からの出力値に基づき算出された段差稜線部と予
め設定された前記光ビームスポット群の行間間隔と列間
間隔とから算出される幾何学的値とを比較判断し、前記
段差稜線部と前記移動装置の移動方向との相対角度を演
算処理することを特徴とする。
【0007】さらに、請求項2は請求項1に付け加え、
前記発光素子群は、予め設定された段差稜線部に対する
移動装置の進入角度に基づいて、光ビームスポット群が
M行×N列アレイ状に配置形成するように照射し、前記
設定された進入角度と前記受光素子群から得られた信号
出力値とを比較判断して、前記段差稜線部に対する移動
装置の進入の可否を判断することを特徴とする。
前記発光素子群は、予め設定された段差稜線部に対する
移動装置の進入角度に基づいて、光ビームスポット群が
M行×N列アレイ状に配置形成するように照射し、前記
設定された進入角度と前記受光素子群から得られた信号
出力値とを比較判断して、前記段差稜線部に対する移動
装置の進入の可否を判断することを特徴とする。
【0008】
【作用】本発明においては、前記光ビームスポット群を
有する簡単な構成にしたことにより、非常に単純なアル
ゴリズムで瞬時に進入角度の良否が判断できる。また、
光ビームの照射スポット位置の変更や光ビーム数の増減
が容易にできるので、種々の状況に応じて検出できる角
度を容易に調整できるようになった。本発明の段差検出
装置を備えた移動装置は、階段のような段差のテンプレ
ートを持つことに相当し、段差を高速かつ的確に判断で
きるようになった。
有する簡単な構成にしたことにより、非常に単純なアル
ゴリズムで瞬時に進入角度の良否が判断できる。また、
光ビームの照射スポット位置の変更や光ビーム数の増減
が容易にできるので、種々の状況に応じて検出できる角
度を容易に調整できるようになった。本発明の段差検出
装置を備えた移動装置は、階段のような段差のテンプレ
ートを持つことに相当し、段差を高速かつ的確に判断で
きるようになった。
【0009】
【実施例】以下に本発明の実施例を説明する。図1は、
本発明による段差検出装置を搭載した移動装置の構成斜
視図である。また、図2は、本発明の段差検出装置の構
成ブロック図である。本発明の段差検出装置は、複数の
発光素子を一定の照射ビームを形成するように組み込ん
だ発光素子群2、移動装置1前方の路面状態に応じて複
数の発光素子の照射角を制御する照射角制御装置3、光
ビームの路面での反射光を受光する受光素子群4、前記
受光素子からの出力信号を処理する信号処理部及び演算
処理部5(図2に図示)とから構成されている。
本発明による段差検出装置を搭載した移動装置の構成斜
視図である。また、図2は、本発明の段差検出装置の構
成ブロック図である。本発明の段差検出装置は、複数の
発光素子を一定の照射ビームを形成するように組み込ん
だ発光素子群2、移動装置1前方の路面状態に応じて複
数の発光素子の照射角を制御する照射角制御装置3、光
ビームの路面での反射光を受光する受光素子群4、前記
受光素子からの出力信号を処理する信号処理部及び演算
処理部5(図2に図示)とから構成されている。
【0010】図1には、本発明の段差検出装置の発光素
子群から照射された光ビームが、移動装置の進行方向前
方の路面上に前後2列のビームスポットを形成する動作
を示した。(図には反射ビームから受光素子までの光路
は示していない)図2のブロック図には、移動装置1と
しての駆動装置6及び操舵装置7も図示してある。ま
た、ビームを真下に照射する発光素子群及び受光素子群
は、移動装置本体に格納できるようにし、必要なときに
本体から前にせりだすような構成としてもよい。
子群から照射された光ビームが、移動装置の進行方向前
方の路面上に前後2列のビームスポットを形成する動作
を示した。(図には反射ビームから受光素子までの光路
は示していない)図2のブロック図には、移動装置1と
しての駆動装置6及び操舵装置7も図示してある。ま
た、ビームを真下に照射する発光素子群及び受光素子群
は、移動装置本体に格納できるようにし、必要なときに
本体から前にせりだすような構成としてもよい。
【0011】次に、本発明の段差検出装置の段差検出方
法について説明する。図3は、1つのスポットに注目し
た照射ビームから段差検出を説明する概念説明図であ
る。発光素子から照射される光ビームの照射角をθiと
し、ビームスポットの位置をPi、各発光素子からPiま
での距離をLi、路面から発光部までの高さをHとする
と、HはθiとLiとから以下の式で得られる。
法について説明する。図3は、1つのスポットに注目し
た照射ビームから段差検出を説明する概念説明図であ
る。発光素子から照射される光ビームの照射角をθiと
し、ビームスポットの位置をPi、各発光素子からPiま
での距離をLi、路面から発光部までの高さをHとする
と、HはθiとLiとから以下の式で得られる。
【0012】Hi=Li×cosθi θiを固定して平地でHを記憶しておけば、Liの変化に
よって前方の段差の検出と高さの検出を容易に行うこと
ができる。光ビームを照射する角度は、手動でも状況に
応じて自動的に設定してもいずれでもかまわない。図2
には、照射角度制御装置を示してある。
よって前方の段差の検出と高さの検出を容易に行うこと
ができる。光ビームを照射する角度は、手動でも状況に
応じて自動的に設定してもいずれでもかまわない。図2
には、照射角度制御装置を示してある。
【0013】本発明の段差検出方法は、まず検出された
値Hiを平地からどの程度変化したときに段差とするか
を判断する基準値を予め設定し、検出された値をその基
準値と比較判断して段差であるか判断する。例えば、基
準値を3cmとすると、平地でのHの値に対して±3c
m以上の変化があった場合に段差であると判断する。し
かし、昇り段差の場合は垂直面にビームが照射されると
判断を誤り易いので、ビームの照射角は余り大きくしな
い方がよい。
値Hiを平地からどの程度変化したときに段差とするか
を判断する基準値を予め設定し、検出された値をその基
準値と比較判断して段差であるか判断する。例えば、基
準値を3cmとすると、平地でのHの値に対して±3c
m以上の変化があった場合に段差であると判断する。し
かし、昇り段差の場合は垂直面にビームが照射されると
判断を誤り易いので、ビームの照射角は余り大きくしな
い方がよい。
【0014】図4(a)は、移動装置本体の前方に照射
されたM行×N列のアレイ状の複数の光ビームスポット
配列の代表的な例として5行×2列アレイ状のスポット
配列を示したものである。各列は平行に配列されてお
り、この図では各列5個のビームスポットの位置をP1
i、2列目のビームスポットの位置をP2iとする。ま
た、ビームスポットの1列目と2列目との間の距離をD
とする。
されたM行×N列のアレイ状の複数の光ビームスポット
配列の代表的な例として5行×2列アレイ状のスポット
配列を示したものである。各列は平行に配列されてお
り、この図では各列5個のビームスポットの位置をP1
i、2列目のビームスポットの位置をP2iとする。ま
た、ビームスポットの1列目と2列目との間の距離をD
とする。
【0015】図4(b)は、進入角度を検出するための
ビーム配列の説明である。1列目の各スポットをP1iと
し、最端スポットであるP11から各Pliまでの距離をd
iとする。2列目の最端スポットであるP21と1列目の
任意のスポットPliを結んだ直線と、1列目の各スポッ
トを結んだ直線で形成される角度をαiとすると、次の
関係式が成り立つ。
ビーム配列の説明である。1列目の各スポットをP1iと
し、最端スポットであるP11から各Pliまでの距離をd
iとする。2列目の最端スポットであるP21と1列目の
任意のスポットPliを結んだ直線と、1列目の各スポッ
トを結んだ直線で形成される角度をαiとすると、次の
関係式が成り立つ。
【0016】αi=tanー1(D/di) ここで、P21からP1iを結んだ線分を段差の稜線と考え
ると、αiは段差に対する進入角度を表すことになる。
αiは、予めスポットの配置により決まっているため、
どのスポットが段差を検出したか大まかな進入角度を知
ることができる。
ると、αiは段差に対する進入角度を表すことになる。
αiは、予めスポットの配置により決まっているため、
どのスポットが段差を検出したか大まかな進入角度を知
ることができる。
【0017】1列目と2列目から2点間の距離が最大に
なるように対角のスポット2点を結んで得られる角度
が、この配列構成で検出できる最小角度である。図4
(b)の場合は、α5の値が検出可能な最小角度であ
る。図5(a)は、図4(a)の配列を利用して、移動
装置が段差に対して垂直に進入したときのビームスポッ
トの位置を示したものである。斜線部は段差を表してい
る。平地を検出したビームスポットは黒丸、段差を検出
したスポットは白丸で表している。段差に対して移動装
置が垂直に進入した場合、段差の稜線部(稜線は直線で
あると仮定する)と各列のスポットの並びは平行にな
る。つまり、同じ列の発光素子から照射される光ビーム
は同時に段差を検出することになるので、列毎に一定の
Hが得られる。ビームスポットの各列間はDだけ離れて
いるので、段差の稜線部がビームスポットの前後列の間
にあるとき、1列目の受光素子からの情報では段差を検
出し、2列目は平地を検出することになる。この時、進
入角度はα5より小さいことは明かである。
なるように対角のスポット2点を結んで得られる角度
が、この配列構成で検出できる最小角度である。図4
(b)の場合は、α5の値が検出可能な最小角度であ
る。図5(a)は、図4(a)の配列を利用して、移動
装置が段差に対して垂直に進入したときのビームスポッ
トの位置を示したものである。斜線部は段差を表してい
る。平地を検出したビームスポットは黒丸、段差を検出
したスポットは白丸で表している。段差に対して移動装
置が垂直に進入した場合、段差の稜線部(稜線は直線で
あると仮定する)と各列のスポットの並びは平行にな
る。つまり、同じ列の発光素子から照射される光ビーム
は同時に段差を検出することになるので、列毎に一定の
Hが得られる。ビームスポットの各列間はDだけ離れて
いるので、段差の稜線部がビームスポットの前後列の間
にあるとき、1列目の受光素子からの情報では段差を検
出し、2列目は平地を検出することになる。この時、進
入角度はα5より小さいことは明かである。
【0018】図5(b)は、段差に対して任意の角度で
移動装置が進入したときのビームスポットの位置を示し
た図である。各列のビームスポットは全て同じ段差を検
出できないので、列毎に一定のHを得ることができな
い。各列の発光素子が3個以上であれば、段差を検出し
た各スポット位置とDよりおおよその進入角度を求める
ことができる。この例では、P14までが段差を検出して
おり、進入角度はα5より大きく、α4より小さい値であ
ることがわかる。
移動装置が進入したときのビームスポットの位置を示し
た図である。各列のビームスポットは全て同じ段差を検
出できないので、列毎に一定のHを得ることができな
い。各列の発光素子が3個以上であれば、段差を検出し
た各スポット位置とDよりおおよその進入角度を求める
ことができる。この例では、P14までが段差を検出して
おり、進入角度はα5より大きく、α4より小さい値であ
ることがわかる。
【0019】理論上は各列のビームスポット間隔が小さ
いほど正確な進入角度を検出できるが、発光素子の数が
不要に多くなってしまう。また、スポット間隔が狭すぎ
ると光の干渉が生じ正確な検出ができなくなる恐れもあ
る。そのため、実用的に安全性に支障をきたさない程度
に発光素子の数を決定し、それら発光素子の配列を適度
に調整できるようにすることが望ましい。
いほど正確な進入角度を検出できるが、発光素子の数が
不要に多くなってしまう。また、スポット間隔が狭すぎ
ると光の干渉が生じ正確な検出ができなくなる恐れもあ
る。そのため、実用的に安全性に支障をきたさない程度
に発光素子の数を決定し、それら発光素子の配列を適度
に調整できるようにすることが望ましい。
【0020】次に、本発明の装置の検出最小角度調整
(設定)方法について説明する。本発明の装置は、列間
隔Dの値によって検出される最小進入角度を調整(設
定)することができる。図6は、本発明の段差検出装置
の進入角度の精度調整方法の説明図である。図6に示す
ように、各列両端の4個のスポット位置を対角線状に2
本の線分を引く。この線分のスポット列に対する角度は
どちらも同じ値であり、この値をβとし、進入角度制限
値と呼ぶ。この2本の線分をそれぞれ段差の稜線である
とすると、いずれの場合も1列目のスポットが全て段差
を検出し、2列目のスポットは、全て平地を検出するの
で、その進入角度はどちらもゼロであると判断される。
つまり、β以下の進入角度は本方式では検出不可能であ
り、βが小さいほど検出できる最小進入角度が小さくで
きることになる。
(設定)方法について説明する。本発明の装置は、列間
隔Dの値によって検出される最小進入角度を調整(設
定)することができる。図6は、本発明の段差検出装置
の進入角度の精度調整方法の説明図である。図6に示す
ように、各列両端の4個のスポット位置を対角線状に2
本の線分を引く。この線分のスポット列に対する角度は
どちらも同じ値であり、この値をβとし、進入角度制限
値と呼ぶ。この2本の線分をそれぞれ段差の稜線である
とすると、いずれの場合も1列目のスポットが全て段差
を検出し、2列目のスポットは、全て平地を検出するの
で、その進入角度はどちらもゼロであると判断される。
つまり、β以下の進入角度は本方式では検出不可能であ
り、βが小さいほど検出できる最小進入角度が小さくで
きることになる。
【0021】本発明の装置の進入角度の検出最小角度
は、各列両端のスポット間の距離Dによって決定され
る。特に、Dを使用して検出最小角度の設定を行うこと
は非常に容易である。実際には、移動装置の進入角度の
制限値がβになるようにDを設定するようにすればよ
い。次の実施例では、進入角度の良否判定のみ行う方法
について説明する。図7(a)は、各列の発光素子が最
小の2個である場合を示したものである。進入角度の制
限値とβが等しくなるように4個のスポット位置を調整
する。これにより、移動装置が進入するか否かの方法は
次の手順により行われる。
は、各列両端のスポット間の距離Dによって決定され
る。特に、Dを使用して検出最小角度の設定を行うこと
は非常に容易である。実際には、移動装置の進入角度の
制限値がβになるようにDを設定するようにすればよ
い。次の実施例では、進入角度の良否判定のみ行う方法
について説明する。図7(a)は、各列の発光素子が最
小の2個である場合を示したものである。進入角度の制
限値とβが等しくなるように4個のスポット位置を調整
する。これにより、移動装置が進入するか否かの方法は
次の手順により行われる。
【0022】最初に、1列目のビームスポットが段差を
検出し、次に段差を検出するビームスポットが同じ列の
ものであれば図7(b)に示すように進入角度はβ以下
となるので”良”と判断し、2列目のものであれば図7
(c)に示すように、進入角度度はβより大となるの
で”否”と判断される。このように、この方法は良否判
定のみであるため非常に単純で信頼性も高く、その上高
速でコストも安い利点がある。
検出し、次に段差を検出するビームスポットが同じ列の
ものであれば図7(b)に示すように進入角度はβ以下
となるので”良”と判断し、2列目のものであれば図7
(c)に示すように、進入角度度はβより大となるの
で”否”と判断される。このように、この方法は良否判
定のみであるため非常に単純で信頼性も高く、その上高
速でコストも安い利点がある。
【0023】以上、本発明の実施例では距離検出の発光
ビームの配列M行×N列が、5行×2列、2行×2列の
場合で説明したが、発光素子の数を多く、隣との間隔を
干渉しない程度に短く、各列間の距離を小さくすること
によって、進入角度の検出精度を高くすることができ
る。実際に、検出したい段差の仕様や許容誤差範囲、使
用するセンサーの発光ビームのスポット径などを留意し
て発光ビームの数や列間隔で配置するべきである。
ビームの配列M行×N列が、5行×2列、2行×2列の
場合で説明したが、発光素子の数を多く、隣との間隔を
干渉しない程度に短く、各列間の距離を小さくすること
によって、進入角度の検出精度を高くすることができ
る。実際に、検出したい段差の仕様や許容誤差範囲、使
用するセンサーの発光ビームのスポット径などを留意し
て発光ビームの数や列間隔で配置するべきである。
【0024】発光ビームの数は各列3個から5個が好ま
しい。移動装置が段差に進入する角度の良否判定のみを
行う場合は、各列2個の配置構成で十分である。本発明
の段差検出装置の2つの信号処理方法について説明す
る。図8は受光素子が時間分割により信号を検出する場
合の第1の信号処理回路のブロック図である。ここで
は、発光素子を3個、受光素子を1個を用いた例を示し
た。発光素子LED1〜LED3は時分割点灯回路11
により、同期クロック12に同期して図9に示すような
タイミングで一定時間毎に分割して点灯される。 発光
素子LED1〜LED3から発光された光ビームは、路
面で反射して受光素子PSD1に入射する。受光素子P
SD1からの信号はヘッドアンプ13を経てI/V変換
回路14に送られ電流信号から電圧信号に変換される。
その後に、アナログ演算回路15で演算され距離情報に
なる。電圧に変換された信号は、A/D変換回路16に
送られ、デジタル情報としてラッチ回路17に送られ、
クロック回路21からの同期クロック12を基準にラッ
チタイミング指令回路23により図9に示すようなタイ
ミングで、D1〜D3の各々に図8のL1〜L3の距離
情報データとしてラッチされる。ラッチ回路17にラッ
チされた距離情報L1〜L3はI/Oポート18を経
て、演算処理部22のCPU19に取り込まれ、そのデ
ータとビームの照射角度の値θiから、発光素子から点
P1〜P3までの水平距離と各々の発光素子の位置から
段差面までの高さH1〜H3とを求める。更に、CPU
19は、求めた水平距離と高さのデータから、図3に示
すように、移動装置前方の路面の距離Xの位置に高さY
の段差があることを検出することができる。
しい。移動装置が段差に進入する角度の良否判定のみを
行う場合は、各列2個の配置構成で十分である。本発明
の段差検出装置の2つの信号処理方法について説明す
る。図8は受光素子が時間分割により信号を検出する場
合の第1の信号処理回路のブロック図である。ここで
は、発光素子を3個、受光素子を1個を用いた例を示し
た。発光素子LED1〜LED3は時分割点灯回路11
により、同期クロック12に同期して図9に示すような
タイミングで一定時間毎に分割して点灯される。 発光
素子LED1〜LED3から発光された光ビームは、路
面で反射して受光素子PSD1に入射する。受光素子P
SD1からの信号はヘッドアンプ13を経てI/V変換
回路14に送られ電流信号から電圧信号に変換される。
その後に、アナログ演算回路15で演算され距離情報に
なる。電圧に変換された信号は、A/D変換回路16に
送られ、デジタル情報としてラッチ回路17に送られ、
クロック回路21からの同期クロック12を基準にラッ
チタイミング指令回路23により図9に示すようなタイ
ミングで、D1〜D3の各々に図8のL1〜L3の距離
情報データとしてラッチされる。ラッチ回路17にラッ
チされた距離情報L1〜L3はI/Oポート18を経
て、演算処理部22のCPU19に取り込まれ、そのデ
ータとビームの照射角度の値θiから、発光素子から点
P1〜P3までの水平距離と各々の発光素子の位置から
段差面までの高さH1〜H3とを求める。更に、CPU
19は、求めた水平距離と高さのデータから、図3に示
すように、移動装置前方の路面の距離Xの位置に高さY
の段差があることを検出することができる。
【0025】図10は、複数個の発光素子それぞれが異
なる周波数で変調した場合の第2の信号処理回路のブロ
ック図である。発光素子及び受光素子の数は前述の実施
例と同様であるが、発光素子LED11〜LED13の
発光をそれぞれ異なる周波数で変調して同時に発光させ
る。変調光は段差面で反射して、受光素子PSD11に
入る。受光素子PSD11からの信号はヘッドアンプ2
4を経て、I/V変換回路25に送られ、電流信号から
電圧信号に変換される。電圧信号に変換された信号は、
発光素子を変調したそれぞれの周波数に合わせたバンド
パスフィルター26〜28で分離され、さらに、それぞ
れの復調回路29〜31で復調され、アナログ演算回路
32〜34を経て距離情報に変換される。距離情報は、
更にA/D変換回路35〜37でデジタル情報に変換さ
れる。変換された距離情報は、I/Oポート40を経て
演算処理部38のCPU39に取り込まれる。以後前述
の時分割回路の場合と同様に演算処理される。
なる周波数で変調した場合の第2の信号処理回路のブロ
ック図である。発光素子及び受光素子の数は前述の実施
例と同様であるが、発光素子LED11〜LED13の
発光をそれぞれ異なる周波数で変調して同時に発光させ
る。変調光は段差面で反射して、受光素子PSD11に
入る。受光素子PSD11からの信号はヘッドアンプ2
4を経て、I/V変換回路25に送られ、電流信号から
電圧信号に変換される。電圧信号に変換された信号は、
発光素子を変調したそれぞれの周波数に合わせたバンド
パスフィルター26〜28で分離され、さらに、それぞ
れの復調回路29〜31で復調され、アナログ演算回路
32〜34を経て距離情報に変換される。距離情報は、
更にA/D変換回路35〜37でデジタル情報に変換さ
れる。変換された距離情報は、I/Oポート40を経て
演算処理部38のCPU39に取り込まれる。以後前述
の時分割回路の場合と同様に演算処理される。
【0026】
【発明の効果】以上のように、本発明によれば、移動装
置は段差部への進入角度の検出及び良否の判定を簡単な
処理で高速に行うことができる。本発明によれば、移動
装置が誤った角度で段差部に進入した際に、それを検出
し、移動装置が段差部に進入する直前で停止制御を行う
ことは十分に可能である。これによって従来問題となっ
ていた段差昇降時の安全性が確保できる。また、検出精
度の調整は各列の発光素子間隔、許容角度の設定は各列
間隔距離を調整することによって使用環境に合った仕様
に調整することができる。
置は段差部への進入角度の検出及び良否の判定を簡単な
処理で高速に行うことができる。本発明によれば、移動
装置が誤った角度で段差部に進入した際に、それを検出
し、移動装置が段差部に進入する直前で停止制御を行う
ことは十分に可能である。これによって従来問題となっ
ていた段差昇降時の安全性が確保できる。また、検出精
度の調整は各列の発光素子間隔、許容角度の設定は各列
間隔距離を調整することによって使用環境に合った仕様
に調整することができる。
【図1】本発明の段差検出装置を搭載した移動装置の構
成斜視図
成斜視図
【図2】本発明の段差検出装置を搭載した移動装置の構
成ブロック図
成ブロック図
【図3】本発明の段差検出装置による進入角度検出方法
のパラメータ説明図
のパラメータ説明図
【図4】本発明の段差検出装置の発光素子群の配列説明
図
図
【図5】本発明の段差検出装置の動作説明図
【図6】本発明の段差検出装置の進入角度の精度調整方
法の説明図
法の説明図
【図7】本発明の段差検出装置による進入角度の良否判
断説明図
断説明図
【図8】本発明の段差検出装置の第1の信号処理装置の
回路ブロック図
回路ブロック図
【図9】本発明の段差検出装置の信号処理波形図
【図10】本発明の段差検出装置の第2の信号処理装置
の回路ブロック図
の回路ブロック図
1 移動装置本体 2 発光素子群 3 照射角制御装置 4 受光素子群 5 信号処理装置 6 駆動装置 7 操舵装置
Claims (2)
- 【請求項1】 移動装置に設けられた複数の発光素子か
ら照射された光ビームにより、移動装置に対する段差の
方向位置を検出する段差検出装置において、 移動方向前方に前記光ビームのスポット群をM行×N列
アレイ状に配置形成するように照射する複数の発光素子
と、前記形成された光ビームスポット群の夫々からの反
射ビームを検出する受光素子群と、前記受光素子群から
の信号出力を処理する信号処理装置とを有し、該信号処
理装置が、前記受光素子群からの出力値に基づき算出さ
れた段差稜線部と予め設定された前記光ビームスポット
群の行間間隔と列間間隔とから算出される幾何学的値と
を比較判断し、前記段差稜線部と前記移動装置の移動方
向との相対角度を演算処理することを特徴とする段差検
出装置。 - 【請求項2】 前記発光素子群は、予め設定された段差
稜線部に対する移動装置の進入角度に基づいて、光ビー
ムスポット群がM行×N列アレイ状に配置形成するよう
に照射し、前記設定された進入角度と前記受光素子群か
ら得られた信号出力値とを比較判断して、前記段差稜線
部に対する移動装置の進入の可否を判断することを特徴
とする請求項1記載の段差検出装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP7073018A JPH08271227A (ja) | 1995-03-30 | 1995-03-30 | 段差検出装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP7073018A JPH08271227A (ja) | 1995-03-30 | 1995-03-30 | 段差検出装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH08271227A true JPH08271227A (ja) | 1996-10-18 |
Family
ID=13506186
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP7073018A Pending JPH08271227A (ja) | 1995-03-30 | 1995-03-30 | 段差検出装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH08271227A (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007161198A (ja) * | 2005-12-16 | 2007-06-28 | Sony Corp | 走行装置及びその制御方法 |
JP2008146617A (ja) * | 2006-12-06 | 2008-06-26 | Samsung Kwangju Electronics Co Ltd | ロボット掃除機システム |
JP2013101593A (ja) * | 2011-10-17 | 2013-05-23 | Nsk Ltd | 車輪型ロボット |
JP2016503931A (ja) * | 2013-01-07 | 2016-02-08 | アセンティア イメージング, インコーポレイテッド | 相互に別々の信号修正センサを使用する光学誘導システムおよび方法 |
CN108303025A (zh) * | 2018-01-22 | 2018-07-20 | 中国地质大学(武汉) | 一种测量边坡土***移的装置 |
-
1995
- 1995-03-30 JP JP7073018A patent/JPH08271227A/ja active Pending
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007161198A (ja) * | 2005-12-16 | 2007-06-28 | Sony Corp | 走行装置及びその制御方法 |
JP2008146617A (ja) * | 2006-12-06 | 2008-06-26 | Samsung Kwangju Electronics Co Ltd | ロボット掃除機システム |
JP4522426B2 (ja) * | 2006-12-06 | 2010-08-11 | 三星光州電子株式会社 | ロボット掃除機システム |
US7787991B2 (en) | 2006-12-06 | 2010-08-31 | Samsung Gwangju Electronics Co., Ltd. | Robot cleaner system and control method thereof |
JP2013101593A (ja) * | 2011-10-17 | 2013-05-23 | Nsk Ltd | 車輪型ロボット |
JP2016503931A (ja) * | 2013-01-07 | 2016-02-08 | アセンティア イメージング, インコーポレイテッド | 相互に別々の信号修正センサを使用する光学誘導システムおよび方法 |
CN108303025A (zh) * | 2018-01-22 | 2018-07-20 | 中国地质大学(武汉) | 一种测量边坡土***移的装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20210109205A1 (en) | Dynamic calibration of lidar sensors | |
JP2852639B2 (ja) | 車両と側方にある車道標識との間隔を求める装置 | |
JP5488518B2 (ja) | 道路端検出装置、運転者支援装置、および道路端検出方法 | |
US20130258108A1 (en) | Road Surface Shape Recognition System and Autonomous Mobile Apparatus Using Same | |
KR19980033400A (ko) | 차량바퀴의 캠버와 캐스터의 비접촉측정방법과 장치 | |
KR100632650B1 (ko) | 인쇄땜납 검사장치 | |
JPH08271227A (ja) | 段差検出装置 | |
EP0807801B1 (en) | Apparatus for inspecting deformation of pipe | |
JP2000181541A (ja) | 自走式車輌 | |
JP3804418B2 (ja) | 車軸検知装置 | |
JPH10105868A (ja) | 車両計測装置及び車両計測方法 | |
JPH07229724A (ja) | 段差認識装置 | |
JPH09304535A (ja) | 計測装置および方法 | |
JPH01240811A (ja) | 車両用の距離判別装置 | |
JPH038684B2 (ja) | ||
JP2614446B2 (ja) | 距離測定装置 | |
CN115243824A (zh) | 激光加工装置 | |
JP2946937B2 (ja) | パルスレーザ測距装置 | |
JP7518363B2 (ja) | キャリアパレット車及びキャリアパレット車の誘導方法 | |
JPH10105719A (ja) | 孔位置の光学的計測方法 | |
JP7319831B2 (ja) | 架線相互離隔測定装置及び架線相互離隔測定方法 | |
JP3755402B2 (ja) | 車軸検知装置 | |
JP2002108452A (ja) | 無人搬送車の走行制御装置 | |
JP2503534Y2 (ja) | 車***置・速度検出装置 | |
JPH04247599A (ja) | 車両検出方法及びその装置 |