JP2968612B2 - 移動体の位置検知装置 - Google Patents

移動体の位置検知装置

Info

Publication number
JP2968612B2
JP2968612B2 JP3126515A JP12651591A JP2968612B2 JP 2968612 B2 JP2968612 B2 JP 2968612B2 JP 3126515 A JP3126515 A JP 3126515A JP 12651591 A JP12651591 A JP 12651591A JP 2968612 B2 JP2968612 B2 JP 2968612B2
Authority
JP
Japan
Prior art keywords
light
azimuth
light beam
swing
self
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
Application number
JP3126515A
Other languages
English (en)
Other versions
JPH04329389A (ja
Inventor
健二 上村
貞親 都築
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.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co 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 Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to JP3126515A priority Critical patent/JP2968612B2/ja
Priority to AU13919/92A priority patent/AU641315B2/en
Priority to US07/864,468 priority patent/US5258822A/en
Priority to DE4211854A priority patent/DE4211854C2/de
Priority to FR9204338A priority patent/FR2676544B1/fr
Publication of JPH04329389A publication Critical patent/JPH04329389A/ja
Application granted granted Critical
Publication of JP2968612B2 publication Critical patent/JP2968612B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Optical Radar Systems And Details Thereof (AREA)

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、移動体の位置検知装置
に関し、特に、農業および土木作業に使用される自走式
機械や、工場内で使用される自動搬送装置などの、移動
体の位置検知装置に関する。
【0002】
【従来の技術】従来、上記のような移動体の現在位置を
検知する装置として、移動体で発生された光ビームを移
動体を中心として円周方向に走査する手段と、移動体か
ら離れた少なくとも3か所に固定され、入射方向に光を
反射する光反射手段と、この光反射手段によって反射さ
れた光を受光する受光手段とを具備した装置が提案され
ている(特開昭59−67476号公報)。
【0003】この装置では、前記移動体から見た前記3
つの光反射手段相互間の開き角を前記受光手段の出力信
号に基づいて検出する。そして、検出された開き角とあ
らかじめ設定されている各光反射手段の位置を表す情報
(位置情報)とから移動体の位置を演算するように構成
している。
【0004】上記の装置においては、移動体つまり自走
車が傾斜した状態のまま走行したり、走行中に揺れたり
することによって自走車から発せられた光ビームを光反
射手段に照射できない場合がある。そうすると、光反射
手段で反射されるべき前記光ビームの反射光が受光手段
で検出されない。これとは反対に、予定の光反射手段以
外の反射物体からの余計な光を受光してしまうような場
合もあった。光反射手段からの光を検出できなかった
り、誤って、他からの光を予定の光反射手段の反射光と
して検出してしまうと、自走車の位置を正確に算出でき
ず、予定されたコース上に自走車を走らせられなくなる
場合がある。
【0005】これに対し、本出願人は、次のような制御
装置を提案した(特開平2−109107号公報)。こ
の装置では、今回および前回の走査によってすでに検出
された自走車の進行方向を基準とした各光反射手段の方
位角データに基づき、その次の走査で同じ光反射手段が
検出されるはずの方位角を予測する。そして、この方位
角で示される予測方位から入射する光を予定の反射手段
からの正常な反射光であると判断する。そして、もしも
予測方位から光が入射されないことが繰返された場合に
は自走車を停止させるようにしている。
【0006】また、本出願人は、前記予測方位で光が検
出されない場合の応急的な処置として、光反射手段が少
なくとも前記予測方位の近辺に存在するはずであるとい
う判断のもとに、この予測方位データを実際の方位角の
代わりに使用して自走車の位置検知を行うようにした制
御装置も提案した(特願平2−12424号)。
【0007】この制御装置では、光反射手段の見失いが
一時的な場合は、自走車を停止させないで、予測方位を
実際の光反射手段が存在する方位であるとみなし、この
予測方位データを使用して自走車の位置を検知する。こ
のような処理を行っても、光反射手段の見失いが一時的
であれば、予測方位と実際の方位との誤差は小さいので
実用上の支障はない。しかし、自走車が走行する路面の
状態によっては、光反射手段を頻繁に見失ったり見失い
が長時間にわたることがあり、このような場合には、ま
た新たな対応手段が必要になる。
【0008】これに対して、上記のような、光反射手段
を見失った後の対応ではなく、光反射手段を見失う前の
対応策も考えられている。例えば、光ビームを光反射手
段に確実に照射できるようにすることを目的として、発
生した光ビームをガルバノミラーやポリゴンミラーを利
用して上下方向に高速に振動させつつ水平方向に走査さ
せるようなビーム光走査装置が提案されている(特開昭
60−242313号公報)。このように光ビームを上
下方向にも走査することによって、自走車が路面の傾斜
地部分を走行したり揺れたりしても、自走車から投射す
る光ビームが光反射手段に照射できる確率が高くなる。
【0009】図17は、このような従来の装置による光
ビームの走査軌跡(光跡)を示す図である。同図(a)
は光ビームを水平方向に回転走査させつつ、この光ビー
ムをガルバノミラーで上下方向にも揺動走査した場合の
光跡の一部分を示す。同図(b)は前記光ビームの上下
方向の揺動走査をポリゴンミラーで行った場合の光跡の
一部分を示す。
【0010】
【発明が解決しようとする課題】上記のビーム光走査装
置では、次のような問題点があった。ガルバノミラーを
利用して所定の振れ幅で光ビームを上下方向にも揺動走
査する上記の方式では、自走車と光反射手段との距離が
大きくなるに従って光反射手段位置での光跡の振れ幅が
大きくなるとともに波長も長くなる。そのために、例え
ば図17(a)に示すように光反射手段6が光ビームと
交差できなくなってしまうことが有り得る。
【0011】また、ポリゴンミラーを利用した方式にお
いても、自走車と光反射手段6との距離が大きくなるに
従って光反射手段位置での光跡の間隔が広くなる。その
ために、例えば図17(b)に示すように光反射手段6
と光ビームとが交差できなくなってしまうことが有り得
る。
【0012】光跡の波長もしくは間隔を小さくして光反
射手段6に光ビームの光跡を交差させやすくするために
は、回転走査に対する上下揺動走査の速度比を上げる必
要がある。つまり、上下揺動走査の駆動速度を大きくす
るか回転走査速度を小さくすることが必要になる。
【0013】ところが、ガルバノミラーやポリゴンミラ
ーの駆動速度を大きくするのは機械構造的な制約もあっ
て大変難しい。また、水平方向の走査速度を小さくする
と、一定時間あたりの受光データ数が少なくなって位置
検出精度が低下し、特に、自走車等のような移動体の位
置検知用として使用する場合、検出精度の低下が著し
い。
【0014】本発明は、上記従来技術の問題点に対し
て、移動体から投射する光ビームを各光反射手段に高い
確率で照射できるように構成することによって、位置検
出精度を高めることができる移動体の位置検知装置を提
供することにある。
【0015】
【課題を解決するための手段】前記の問題点に対処し、
位置検出精度を高めるという目的を達成するために、本
発明は、移動体に搭載された光ビーム発生手段から投射
された光ビームを、前記移動体を中心として略水平面内
で回転走査する手段と、この光ビームを前記回転走査が
複数回行われる間に上下方向に1回揺動させる揺動走査
手段と、前記揺動の単位揺動サイクルにおいて受光した
光信号の方位角を記憶する手段と、移動体から離れた位
置に設けられた光反射手段からの前記光ビームの反射光
が次回の揺動走査で検出されるはずの方位角を、現在ま
でに検出された方位角に基づいて予測する予測方位角決
定手段と、前記記憶された各方位角と前記予測方位角と
を照合して実際の受光方位角を前記単位揺動サイクル毎
に判別する手段とを具備し、判別の結果得られたデータ
に基づいて移動体の位置を検知するように構成した点に
特徴がある。
【0016】
【作用】上記の特徴を有する本発明では、前記光ビーム
の揺動の1サイクル中に複数回の回転走査が行われる。
したがって、移動体を中心とする円筒面を想定した場
合、その円筒面上で光ビームによる網目状の光跡が描か
れる。
【0017】すなわち、垂直方向に立てられた光反射手
段の近辺において、揺動の1サイクル中、垂直方向の高
さが異なる数回以上の回転走査が行われる。その結果、
揺動1サイクル中に高い確率で光跡が光反射手段を横切
ることになり、それだけ光反射手段で反射された光ビー
ムを受光する確率が高くなる。
【0018】揺動の1サイクルにおいて回転走査は複数
回行われるので、1つの基準点からの反射光を複数検出
することもあるが、その場合でも各基準点毎の方位角は
単位揺動サイクル毎に更新され、これに基づく移動体の
位置検知も同様に単位揺動サイクル毎に1回だけ行われ
るので、演算処理が複雑になるのを回避できる。したが
って、位置検知のためのデータを数多く検出できるよう
に回転走査の速度を速くしてもデータ処理時間を十分に
とることができる。
【0019】
【実施例】以下に、図面を参照して本発明の一実施例を
説明する。図2は本発明の位置検知装置を搭載し、所定
の領域を走行する自走車を示す斜視図である。図2にお
いて、移動体としての自走車1が走行している領域の周
囲には、入射した光をその入射方向に反射する反射面を
有する光反射器(以下、単に反射器という)6a〜6d
が配設されている。反射器6a〜6dの反射面には、コ
ーナキューブプリズム等周知の光反射手段が使用されて
いる。自走車1は、例えばその下面に図示しない芝刈作
業用カッタブレードを有する芝刈り機である。自走車1
の上部には、光ビーム走査装置(以下、単に走査装置と
いう)2が搭載されている。この走査装置2は、光ビー
ム2Eを発生する発光器、および前記反射器6a〜6d
で反射された光ビーム2Eの反射光2Rを受ける受光器
を有する。発光器は発光ダイオードを有し、受光器は入
射された光を電気的信号に変換するフォトダイオードを
有している。発光器および受光器はケーシング3に収容
されている。
【0020】発光器から出た光ビームは回転ミラー(以
下、単にミラーという)4で直角方向に屈折反射される
ことにより、方向転換されて走査装置2から外部に投射
される。ミラー4はモータ5によって回転中心軸8のま
わりで矢印17の方向に回転され、このミラー4の回転
によって光ビーム2Eは回転中心軸8を中心として矢印
R方向に回転走査される。ミラー4の回転位置で決まる
光ビーム2Eの投射方向つまりモータ5の回転角度はエ
ンコーダ7で検出される。
【0021】走査装置2は、光ビーム2Eの光跡で描か
れる回転走査面の角度を連続変化(揺動走査)させるた
めのジンバル揺動機構を有している。この揺動機構は、
ブラケット9の軸12およびブラケット10の図示しな
い軸に対して揺動自在に軸支された外側リング部材11
と、この外側リング部材11の内側に設けられた内側リ
ング部材14とを有する。この内側リング部材14は、
前記外側リング部材11の支軸の延長線と直交する線上
で外側リング部材11に設けられた軸13およびこの軸
13と対向する位置に設けられた他方の軸20(図1に
示す)によって揺動自在に軸支されている。
【0022】ジンバル揺動機構は揺動駆動用のモータ1
5によって駆動される。このジンバル揺動機構によっ
て、ミラー4の回転中心軸8は垂直から角度φだけ傾斜
するように取付けられており、かつその傾斜方向(以
下、揺動方向という)は連続的に変化して、矢印17a
の方向に回動する。このような回転中心軸8の回動によ
って光ビーム2Eの回転走査による走査面の角度が連続
的に変化する。すなわち、光ビーム2Eの投射方向が上
下方向に連続的に変化し、揺動走査されるのである。
【0023】次に、前記走査装置およびジンバル揺動機
構の揺動駆動装置について詳述する。図1は自走車1に
搭載された走査装置2の要部断面図であり、図2と同符
号は同一または同等部分を示す。まず、走査装置2につ
いて説明する。ミラー4は台座4aを介してモータ5の
軸の一端5aに取付けられていている。一方、モータ5
の軸の他端5bは連結金具19によってエンコーダ7の
軸7aと連結されている。エンコーダ7の出力パルスは
図示しない制御装置に送信され、ミラー4の回転角度や
回転数の演算に供される。
【0024】前記ミラー4の台座4aには吸着板34が
設けられている。この吸着板34は、磁性体、例えば鉄
で作られていて、電磁石16が付勢されることにより電
磁石16に吸着される。この吸着動作によって、電磁石
16が付勢された任意のタイミングでミラー4の停止位
置が固定される。
【0025】内側リング部材14の下方には、ケーシン
グ3が取付けられている。このケーシング3の取付手段
は図示していないが、ボルト締めなど、周知の締結手段
を適宜使用すればよい。
【0026】次に、ジンバル揺動機構の揺動駆動装置に
ついて説明する。揺動駆動装置は自走車1の上面に設け
られている。自走車1の上面に取付けられた軸受け21
には軸22が挿通されており、この軸22の一端には小
円盤23が固結され、他端には大円盤24が固結されて
いる。小円盤23には軸22に対して偏心した位置に偏
心軸23aが突設され、大円盤24には同様に偏心軸2
4aが突設されている。偏心軸23aおよび偏心軸24
aの偏心方向は互いに90度ずらしてある。
【0027】揺動用モータ15の軸15aは前記軸22
と一直線上に配置してあり、かつ軸15aにはL字形状
のブロック32が固結されている。つまり、偏心軸23
a,24aは軸15aに対しても軸22に対する偏心量
と同じだけ偏心していて、モータ15の軸15a、偏心
軸23a、軸22、および偏心軸24aはクランク軸を
形成している。揺動用モータ15によって回転軸15a
が回転されると、この回転はブロック32によって偏心
軸23aに伝達され、軸22が回転する。その結果、偏
心軸24aも軸22を中心に回転する。
【0028】偏心軸23aは外接リング23bに対して
回転自在に嵌挿されており、この外接リング23bには
ブロック25が揺動自在に軸支されている。このブロッ
ク25は連結ボルト26によって内側リング部材14に
突設された軸(図示しない)を受ける球面軸受27と連
結されている。
【0029】このように、小円盤23と内側リング部材
14とが連結されているので、小円盤23に対する偏心
軸23aの回転運動は、軸13,20を中心とする内側
リング部材14の上下方向の揺動運動に変換される。
【0030】一方、大円盤24に突設された偏心軸24
aは球面軸受28で受けられている。外側リング部材1
1には軸29が突設されていて、この軸29によって球
面軸受30が支承されている。球面軸受28と球面軸受
30とは連結ボルト31で連結されている。このような
構成により、外側リング部材11も、内側リング部材1
4と同様、前記軸12およびこれと対向する位置の軸
(図示しない)を中心として揺動される。
【0031】前記外側リング部材11および内側リング
部材14の揺動が合成されると、内側リング部材14に
取付けられている走査装置2のミラー4の回転中心軸8
が、両リング部材11および14のそれぞれの揺動中心
軸の交点を中心にして、所定の傾斜角度を有して旋回す
る。換言すれば、この旋回による回転中心軸8の軌跡
は、前記交点を頂点とする円錐の側面(以下、単に円錐
という)となる。前記発光器および受光器を収容してい
るケーシング3も、内側リング部材14の下面に取付け
られているので、この内側リング部材14と一体となっ
て揺動する。
【0032】連結ボルト26の両端には互いに逆方向の
ねじが切られていて、連結ボルト26を回転させると、
この連結ボルト26はブロック25および球面軸受け2
7に対して進退し、球面軸受27とブロック25との連
結長さを調節することができる。連結ボルト31も、連
結ボルト26と同様、この連結ボルト31が螺入されて
いる球面軸受28,30との連結長さを調節するもので
ある。
【0033】前記大円盤24には薄円盤24bが設けら
れ、この薄円盤24bにはこれを跨いで揺動基準検出用
のセンサ33が設けられている。例えばセンサ33は金
属検知センサまたは光透過型センサであって、薄円盤2
4bの円周の予定位置にスリットを穿設しておくことに
より、センサ33から出力される前記スリットの検出信
号に基づいて揺動の基準位置が検出できる。
【0034】モータ15の背後には、このモータ15の
回転位置を検出するためのエンコーダ35が付設されて
いる。このエンコーダ35の出力信号と、センサ33の
出力信号とによってミラー4の回転中心軸8の傾きφを
検出できる。回転中心軸8の揺動方向を検出する手段
は、エンコーダ35とセンサ33とを用いるものに限ら
ない。例えば、薄円盤24bに、前記基準位置検出用の
スリットとは別に薄円盤24bの回転量検出用のスリッ
トを穿設し、2つのセンサによってこれら2種類のスリ
ットをそれぞれ検出するようにしてもよい。また、エン
コーダ35からモータ15の回転量と回転基準位置とを
示す信号の双方を取出すように構成してもよい。
【0035】なお、光ビームを上下方向にむらなく走査
し、その反射光の受光処理を簡単にするためには回転中
心軸8の揺動軌跡は円錐であるのが望ましいが、必ずし
も円錐でなくとも底面が円以外の錐であってもよい。例
えば、前記偏心軸23aおよび24aの偏心量を変化さ
せ、外側リング部材11と内側リング部材14のそれぞ
れの最大傾斜角度が異なるようにすれば、回転中心軸8
の揺動によって描かれる軌跡は楕円錐となる。
【0036】本実施例ではこの揺動軌跡がほぼ円錐とな
るよう、つまり、外側リング部材11と内側リング部材
14のそれぞれの最大傾斜角度が同じになるように偏心
軸23aおよび24aの偏心量を設定している。
【0037】なお、本実施例では外側リング部材11お
よび内側リング部材14を1つのモータで駆動するよう
にしたが、それぞれのリング部材を別個のモータで駆動
するようにしてもよい。その場合、各モータは回転中心
軸8が所望の錐形状を描くように、同期させて回転させ
るのはもちろんである。
【0038】以上説明した揺動機構を駆動させて光ビー
ムを投射させると、ミラー4の回転中心軸8自体が円錐
を描いて回動する揺動走査が行われ、ミラー4の回転に
よって光跡で描かれる面(回転走査面)は一平面に固定
されず、揺動1サイクルの間は常に変化する。
【0039】なお、回転中心軸8が円錐を描いて1回転
する周期よりミラー4が1回転する周期の方を十分に短
くすることにより、後述するようなきめの細かいピッチ
で走査軌跡を描かせることができる。本実施例では、ミ
ラー4を2700rpmで回転させ、回転中心軸8を揺
動させる軸22を90rpmで回転させるようにした。
【0040】次に、図を参照して本実施例の走査装置に
よる光ビームの光跡について説明する。図3は前記ミラ
ー4を中心とした一定の半径を有する仮想の円筒面に描
かれた光跡をモデル化して示している。
【0041】図示のように、前記走査装置2から投射さ
れた光ビーム2Eは、ミラー4の回転中心軸8が円錐運
動をすることにより、前記想定された円筒面上に網目状
の光跡を描く。本実施例では、ミラー4の回転数を27
00rpm、回転中心軸8の揺動回数つまり軸22の回
転数を90rpmとしたので、回転中心軸8が円錐状に
1回転する間にミラー4自体は30回転する。すなわ
ち、回転中心軸8が円錐を描いて1回転する間に、円筒
面上の任意の垂直線18を30本の光跡が横切る。
【0042】次に、前記垂直線18上に反射器を配設し
た場合、揺動1サイクルの中でどれだけ光ビームが反射
器に照射されやすくなるかを説明する。図4は前記光跡
の一部を拡大して示したものである。同図において、符
号6Hで示すように自走車1と反射器6とが近く、反射
器6の高さ方向の寸法が光跡の揺動幅BBに対して十分
に長い場合は、30本の光跡がすべてこの反射器6を横
切る。これに対し、符号6Lで示すように、自走車1と
反射器6との距離が非常に長い場合は、反射器6の高さ
方向の寸法は光跡の揺動幅BBに対して相対的に短くな
る。しかしながら、このように、反射器6の高さ方向寸
法が相対的に短い場合であっても、光跡の垂直方向の最
大間隔Hが反射器6の高さ方向の寸法より相対的に小さ
ければ、回転中心軸8が円錐運動を1回行う間に少なく
とも1回は反射器6を光跡が横切る。なお、図3,図4
は、繁雑さを回避し、作図を容易にするためモデル化し
て示してあるので、光跡の本数は実際より少なく記載し
てある。
【0043】次に、上記の構成を有する走査装置2を搭
載した自走車1が、その走行領域内のどの位置にある
か、またどの方向に走行しているかを検知するための基
本的原理を説明する。図5および図6は、自走車1の走
行領域を示す座標系における自走車1および反射器6a
〜6dの位置を示す図である。同図において、反射器6
a〜6dの配置位置、つまり基準点A,B,C,D,お
よび自走車1の位置T(Xp,Yp)は、基準点Bを原
点とし、基準点BおよびCを結ぶ直線をx軸とするx−
y座標系で表される。
【0044】図示のように、自走車1の位置Tは、三角
形ATBの外接円上に存在すると同時に、三角形BTC
の外接円上に存在する。したがって、自走車1の位置
は、これら2つの三角形の外接円QおよびPの交点を算
出することによって求められる。外接円QおよびPの2
つの交点のうち、一方の交点は基準点Bつまり原点であ
るから、他方の交点が自走車1の位置ということにな
る。このような原理に従って自走車1の位置を求める算
出式は、本出願人がすでに出願している特開平1−28
7415号および特開平1−316808号公報に詳細
が示されている。
【0045】また、自走車1の進行方向は次式を用いて
算出される。図6において、自走車1の進行方向とx軸
とのなす角度をθf、進行方向を基準とした基準点Cの
方位角をθc、基準点Cのx座標をxc、自走車1のy
座標をYpとした場合、θf=360°−tan-1{Y
p/(xc−x)}−θc………(1)となる。
【0046】次に、上記公報に記載された算出式および
上記算出式(1)によって求められた位置情報に基づい
て自走車1の走行方向を制御する操向制御について説明
する。図7は自走車1と基準点A〜Dとの位置関係を示
す図である。
【0047】自走車1は基準点Bの近くのスタート位置
から走行を始め、予定の走行コース36を走行してホー
ムポジション63に戻るものとする。走行コースは間隔
Lを有して平行に設定された直進行程と、各直進行程を
つなぐ旋回行程とからなる。自走車1は直進行程を走行
した後、y座標がYtnまたはYtfに達した位置で、
操舵角度を一定の値に固定して旋回行程を走行し、隣接
する次の直進行程に移行する。そして、直進行程のx座
標が最終のx座標Xendを超過した場合、その直進行
程走行後、最終旋回行程を経てホームポジション63に
戻る。
【0048】なお、図7においては、説明を簡単にする
ため、各基準点A,B,C,Dを、それらを結ぶ直線で
長方形が形成されるように配置した上で、直進行程は基
準点AとBとを結ぶ直線つまりy軸と平行にしたが、基
準点A〜Dを走行コースの周囲に配置してあれば、走行
コース36は任意に設定できる。
【0049】続いて、フローチャートを参照して制御手
順を説明する。この説明のために参照されるフローチャ
ートで使用される各種パラメータ(記号)の意味は次の
とおりである。θ(n)…受光信号に基づいて決定され
た方位角、θq(n)…予測方位角、Cg(i)…検出
ブロック別受光回数、Am(i)…検出ブロック別検出
方位角、Cp(n)…基準点nの受光回数、Ap[n,
I]…基準点nの受光方位角、As[n,I]…基準点
n検出時の揺動方向、Cm[n,I]…基準点n検出時
のミラー回転数カウンタ値、Aps(k)…受光回数が
しきい値以上の検出ブロックを代表する方位角、Aps
(n)…Aps(k)を小さい順にn=1〜4にセット
した方位角、i…検出ブロックの番号、j…受光回数が
第1のしきい値以上の検出ブロックの数、k…受光回数
が第2のしきい値以上の検出ブロックの数まず、操向制
御の基本となる反射光受光処理について説明する。走査
装置2から発射され、反射器6a〜6dで反射された光
ビームつまり反射光の受光処理は以下のとおり行われ
る。
【0050】本実施例では、前述のようにミラーの回転
中心軸8が円錐状軌跡を描いて1回転する間にミラー4
は30回転する。すなわち回転中心軸8が円錐状軌跡を
描いて1回転する間に、回転走査が30回行われるので
ある。この30回の回転走査によって同一の反射器から
の反射光を多数回受光する可能性がある。したがって、
この反射光受光処理では、検出された受光信号の方位角
がほぼ同一であるものは、その受光信号の受光データを
1つのブロックでまとめて処理するようにしている。以
下、このブロックを検出ブロックと呼ぶ。
【0051】各検出ブロックの受光データとしてその検
出ブロックでの受光回数Cg(i)およびその検出ブロ
ックを代表する方位角Am(i)を記憶するようにして
いる。本実施例では、各検出ブロックを代表する方位角
Am(i)として回転走査における最新の検出方位角を
記憶するようにしている。これによって方位角を記憶す
るメモリの容量を節約できるし、処理の繁雑さも回避で
きる。
【0052】予定の反射器からのみ光信号が入射された
場合は、前記検出ブロックは、設置された反射器6a〜
6dの総数と一致するはずである。ところが実際には、
他の反射物体等からの光信号が検出されることも有り得
るため、検出ブロックの数はこの数に限らない。
【0053】そこで、本実施例では、各検出ブロックを
代表する方位角を、別の処理で決定される各基準点の予
測方位角と比較して、それとほぼ一致するか否かで、各
検出ブロックと基準点とを対応付けるようにしている。
【0054】図8は反射光受光処理の制御手順を示すフ
ローチャートである。まずステップS100において、
受光器で光信号が検出されたと判定されるとステップS
101に進み、この光信号がチャタリングによるもので
ないかどうかが確認される。前回の処理後、ミラー4が
微小角度しか回転しないうちに続けて検出された光信号
はチャタリングによるものと判断されて無視される。チ
ャタリングでなければ、ステップS102に進む。
【0055】ステップS102では、検出ブロック番号
を示す変数iに“0”をセットする。 ステップS10
3では、検出ブロック別の受光回数Cg(i)が“0”
か否かを判断する。ここでの最初の処理では、ステップ
S102でパラメータiに“0”がセットされたので、
今回検出された受光信号が検出ブロック(0)での最初
の受光信号か否かが判断される。
【0056】この判断が肯定の場合はステップS106
に進み、検出ブロック(i)を代表する方位角Am
(i)として今回検出された方位角つまりミラー4の回
転角度を記憶し、当該検出ブロック(i)での受光回数
Cg(i)の値をインクリメントする。
【0057】ステップS107では、基準点A〜Dを識
別するカウンタの値nをクリアする。本実施例では、カ
ウンタ値“1”は基準点Aに、カウンタ値“2”は基準
点Bに、カウンタ値“3”は基準点Cに、カウンタ値
“4”は基準点Dにそれぞれ対応させてある。ステップ
S108ではそのカウンタの値nをインクリメントす
る。
【0058】ステップS109では、今回検出した方位
角が、後述のイニシャルポール識別処理や往路直進処理
で設定された予測方位角θq(n)とほぼ同一か否かが
判断される。すなわち、ステップS108でカウンタ値
nは“1”になっているので、このカウンタ値“1”に
対応する基準点Aの予測方位角θq(1)に関し、これ
と検出方位角とがほぼ一致するか否かが判断される。予
測方位角θq(n)は、例えば、今回検出時の方位角に
予測変化量αを加算した値でも良いが、今回の値と同値
を予測方位角としてもよい。自走車1の移動量に対して
反射光の受光間隔が短いので今回の値と同値を予測方位
角としても実用上支障がないし、処理も簡単である。
【0059】ステップS109の判断が否定の場合は、
ステップS110において、カウンタ値nが基準点の個
数“4”と一致したか否かが判別される。ステップS1
10の判断が肯定になるまでステップS108,S10
9の処理が繰返され、基準点A〜Dのすべての予測方位
角に関して、これと検出方位角とがほぼ一致するか否か
が判断される。
【0060】予測方位角θq(n)が検出方位角とほぼ
一致していれば、ステップS109からステップS11
1に進む。ステップS111では、予定の基準点を検出
したとして、カウンタ値nで示される基準点の受光回数
Cp(n)がインクリメントされる。さらに、ステップ
S111では、その基準点の検出方位角Ap[n,Cp
(n)]、ミラー4の回転中心軸8の傾斜方向つまり揺
動方向As[n,Cp(n)]、ならびにミラー4の回
転カウンタ値Cm[n,Cp(n)]を記憶する。ミラ
ー4の回転カウンタ値は、揺動方向がセンサ33の出力
信号に基づく予定の方向にある時を基準として、そこか
ら計数したミラー4の回転が何回転目かを示す値であ
る。
【0061】なお、ステップS103で、検出ブロック
(i)での反射光の受光回数Cg(i)が“0”でな
い、つまり初めての受光でないと判断された場合は、ス
テップS104に進む。ステップS104では、先に記
憶されている検出ブロック(i)の方位角Am(i)と
今回の検出方位角とがほぼ一致しているか否かが判断さ
れる。両者がほぼ一致していればステップS106に進
み、今回の検出方位角で検出ブロック(i)の方位角A
m(i)を更新する。
【0062】また、記憶されている検出ブロック(i)
の方位角Am(i)と今回検出された方位角とが一致し
ていない場合は、受光信号が他の検出ブロックからの光
であると判断してステップS104からステップS10
5に進み、検出ブロック番号(i)をインクリメントす
る。検出ブロック番号(i)をインクリメントした後、
ステップS103にて、インクリメントされた検出ブロ
ック番号(i)について初めての受光か否かの判断がな
される。
【0063】前記反射光受光処理によって記憶された受
光信号の方位角つまり基準点の方位角に基づいて自走車
1の位置と進行方向とが演算され、自走車1を走行コー
ス上で走行させる操向制御が行われる。
【0064】まず、操向制御の前段階として行われるイ
ニシャルポール識別処理を説明する。このイニシャルポ
ール識別処理では、基準点A〜Dに設定された反射器6
a〜6dに確実に光ビームを照射させられるように、自
走車1を停止させ、かつ光ビームの揺動走査の速度つま
りモータ15の速度は低速にしている。
【0065】図11はイニシャルポール識別処理のフロ
ーチャートである。同図において、ステップS120で
は、前記揺動基準検出用のセンサ33の出力信号に基づ
いて揺動方向が“0°”になったか否か、つまり予定の
基準位置が検出されたか否かを判断する。揺動方向が
“0°”になったと判断されると、ステップS121に
進み、前記反射光受光処理によって得られたデータを記
憶するメモリ領域のデータをクリアする。
【0066】ステップS122では、図8に示した反射
光受光処理を行う。このイニシャルポール識別処理にお
ける反射光受光処理では、この処理以前に予測方位角が
決定されていないので、図8に示した処理のうち、ステ
ップS100〜S106に相当する処理のみが行われ
る。
【0067】ステップS123では、再び揺動方向が
“0°”か否かを判断して、回転中心軸8が円錐を描く
揺動の1サイクルが終了したか否かが判断される。1サ
イクルの終了までは反射光受光処理を続け、1サイクル
が終了すると、ステップS124に進む。
【0068】ステップS124では、基準点の選択処理
(ポール選択処理)を行う。この選択処理では、反射光
受光処理において検出された検出ブロックのうち受光回
数Cg(i)の多い4つの検出ブロックを選択し、その
検出ブロックを代表する検出方位角Am(i)を方位角
の小さい順にAps(n)にセットする。なお本実施例
では基準点はA,B,C,Dの4本なのでn=1〜4で
ある。図8の反射光受光処理のフローチャートで示した
ように、検出ブロックを代表する検出方位角Am(i)
は、その検出ブロックで検出された方位角の最新データ
である。
【0069】また、ステップS124では、次のステッ
プS125における判断の材料となるポール選択モード
「1」〜「3」も決定される。ポール選択処理は、さら
に図12に関して詳細に述べる。
【0070】ステップS125では、ポール選択処理で
決定されたポール選択モードが「1」〜「3」のいずれ
であるかを判別する。ポール選択モードが「1」の場合
は、4本の基準点のすべてが識別でき、その方位角を検
出できたとしてステップS126に進む。ステップS1
26では、基準点の方位角θ(n)として、ステップS
124の処理で得られた方位角Aps(n)をセットす
る。また、ポール選択モードが「2」の場合は、受光回
数Cg(i)が少なくて4本の基準点を選択できない、
つまり選択できた基準点が4本に至らない場合であり、
ステップS122に戻って反射光受光処理を継続する。
さらに、ポール選択モードが「3」の場合は、予定外の
反射物体があったりして、受光回数Cg(i)が所定値
以上の検出ブロックが5つ以上の場合である。この場合
は検出ブロックの中から基準点を特定することができな
かったとしてステップS121に戻り、最初からこのイ
ニシャルポール識別処理をやり直す。
【0071】このイニシャルポール識別処理における反
射光受光処理で得られたデータの例を示す。イニシャル
ポール識別処理では、回転中心軸8が1回揺動する間、
つまりミラー4が30回転する間に記憶された受光デー
タに基づいて基準点の識別処理を行う。ミラー4が30
回転する間に蓄積された受光データの例を図16に示
す。
【0072】同図において、縦軸は検出ブロック(i)
の受光回数Cg(i)であり、横軸は各検出ブロック
(i)の方位角Am(i)である。図示のように、検出
ブロックの数が7つ(i=0〜6)あったとすれば、こ
れはミラー4が30回転する間に7方向から光信号が受
光されたことを示す。受光回数Cg(i)が複数回の検
出ブロックでは、方位角Am(i)は前述のように最新
の検出データである。なお、検出ブロックの番号iが必
ずしも方位角の小さい順に並んでいないのは、受光した
順に番号が付されているためである。
【0073】この受光データを参照しながら前記ポール
選択処理の詳細を説明する。図12はポール選択処理の
フローチャートである。このポール選択処理では、受光
回数Cg(i)が予定のしきい値に達している検出ブロ
ックを抽出し、抽出した検出ブロックの数が予定の基準
点の総数つまり“4”と一致しているかどうかを判別す
る。一致していればその検出ブロックの受光データを予
定の基準点A〜Dに関するデータであると決定する。ま
た、抽出された検出ブロックの数が多い場合は基準点を
特定できないと判断して改めてデータの採取を行い、ま
た、抽出された検出ブロックの数が少ない場合はさらに
データの採取を継続する。
【0074】本実施例では、しきい値を“3”と“5”
の2段階設定した。そして、受光回数Cg(i)が第1
のしきい値“3”に達している検出ブロックの数はパラ
メータjで記憶し、第2のしきい値“5”に達している
検出ブロックの数はパラメータkで記憶するようにして
いる。そして、このパラメータj,kに基づき、基準点
を識別してよいか否かを判断するのである。
【0075】図12において、まず、ステップS130
では、反射光受光処理で得られたデータつまり光検出方
位角Am(i)と反射光の受光回数Cg(i)とを読込
む。
【0076】ステップS131では、パラメータi,
j,kをクリアする。ステップS132では、当該検出
ブロック(i)が、反射光の受光回数Cg(i)が3回
より多い検出ブロックか否かを判断する。受光回数Cg
(i)が3回より多い検出ブロックであったならば、ス
テップS133に進み、パラメータjをインクリメント
する。
【0077】ステップS134では、当該検出ブロック
(i)が、受光回数Cg(i)が5回より多い検出ブロ
ックか否かを判断する。受光回数Cg(i)が5回より
多い検出ブロックであったならば、ステップS135に
進み、パラメータkをインクリメントする。
【0078】ステップS136では、パラメータkの値
が“4”以上か否かによって受光回数Cg(i)が5回
を超える検出ブロックが4つすなわち予定の基準点の総
数以上あったか否かを判定する。受光回数Cg(i)が
5回を超える検出ブロックが4つ以下の場合は、ステッ
プS137において、受光回数Cg(i)が5回以上あ
った検出ブロックを代表する検出方位角Am(i)を予
定の基準点のうちの1つの方位角Aps(k)として記
憶する。
【0079】ステップS138では、検出ブロックを示
す番号iをインクリメントする。ステップS139で
は、受光回数Cg(i)が“0”か否かを判断する。受
光回数Cg(i)が“0”でなければ、まだ、受光回数
が記憶されている検出ブロックがあると判断して、ステ
ップS132に戻る。受光回数Cg(i)が“0”であ
れば、もう、受光回数が記憶されている検出ブロックは
ないと判断してステップS140に進む。
【0080】ステップS140では、パラメータj,k
が共に“4”か否か、つまり受光回数が3回以上あった
検出ブロックの数と、5回以上あった検出ブロックの数
とが共に4つであったか否かを判断する。
【0081】ステップS140が肯定の場合は、予定の
反射器以外からの光を受光していないと判断してステッ
プS141に進み、ステップS137で記憶された検出
方位角Aps(k)を、小さい順に方位角Aps(1)
〜Aps(4)としてセットする。ステップS142で
は、ポール選択モードを「1」とする。
【0082】前記ステップS140の判断が否定の場合
は、ステップS143に進んでパラメータjが“4”以
上か否か、つまり受光回数が3回以上あった検出ブロッ
クが4つ以上あったか否かを検出する。ステップS14
3が否定の場合は、ステップS144でポール選択モー
ドを「2」とし、肯定の場合は、ステップS145でポ
ール選択モードを「3」とする。決定されたこれらのポ
ール選択モードに従い、図11のイニシャルポール識別
処理におけるステップS125の判断を行う。
【0083】例えば、図16に示した受光データの例で
は、受光回数Cg(i)が5回を超えている検出ブロッ
ク(番号i=0,2,3,5)の方位角が予定の基準点
の方位角であると識別される。
【0084】続いて、前記イニシャルポール識別処理を
含む操向制御について説明する。図9,図10は操向制
御の全体を示すゼネラルフローチャートである。図9に
おいて、ステップS1ではモータ5および15を起動し
てミラー4を回転させると共に、その回転中心軸8が円
錐状の軌跡を描くようにジンバル揺動機構を動作させ
る。ここでは、基準点A〜Dに設定された反射器6a〜
6dに確実に光ビームを照射させられるようにモータ1
5は低速で回転させる。
【0085】ステップS2では、前記イニシャルポール
識別処理を行う。
【0086】ステップS3では、自走車1から基準点A
〜Dまでの各距離を測定して各基準点の位置つまり前記
x−y座標系における基準座標値を計算するポール位置
計測処理を行う。自走車1から基準点A〜Dまでの各距
離は、例えば、基準点に対して発射された光ビームとそ
の反射光の位相差に基づいて測定できる。また、各基準
点の位置は距離の測定結果および反射光の方位角に基づ
いて算出される。この処理は本発明とは直接関係ないの
で詳細な説明は省略する。
【0087】ステップS4では、ステップS2とステッ
プS3で算出された基準点の方位角および座標値に基づ
き、自走車1の現在の位置座標(Xp,Yp)を算出す
る。
【0088】ステップS5では、自走車1の現在のx座
標Xpを第1番目の直進行程のx座標Xrefとしてセ
ットする。但し、この座標のセットは、自走車1が走行
開始位置にある場合である。
【0089】ステップS6では、モータ5および15を
所定の速度で高速回転させてミラー4を回転および揺動
させる。ステップS7では、自走車1のエンジン回転を
駆動輪に接続して走行を開始させる。
【0090】図10のステップS8では、自走車1をそ
のy座標値が大きくなる方向に直進行程を走行させる往
路直進処理を行う。この処理の詳細は図13に関して後
述する。ステップS9では、自走車1のy座標Ypが予
定のy座標Ytfより大きくなったか否かによって第1
番目の直進行程の走行を終了したか否かを判断する。自
走車1が直進行程の走行を終了したと判断されるとステ
ップS10に進む。ステップS10では、直進行程のx
座標Xrefに、隣接する直進行程までの距離Lを加算
して次の直進行程を設定する。ステップS11では、旋
回行程の走行を終了させる方位角を設定する右ターン解
除角セット処理を行う。この右ターン解除角は次のUタ
ーン処理で右方向に旋回を開始した自走車1が、その旋
回を停止して再び直進行程の走行に移行する地点におけ
る各基準点の方位角である。この右ターン解除角は基準
点のx,y座標と直進行程のx座標Xrefおよびy座
標Ytfに基づいて算出する。
【0091】ステップS12では、自走車1の操舵角を
予定値に固定して一定の旋回半径で右方向に旋回する旋
回行程で自走車1を走行させるUターン処理を行う。
【0092】ステップS13では、自走車1から見た方
位角がステップS11で算出された右ターン解除角に達
した基準点の数を計数する解除カウンタの値が“1”を
超過しているか否かを判断する。この判断が肯定の場合
は、旋回行程の走行を終了したと判断してステップS1
4に進む。
【0093】ステップS14では、自走車1をそのy座
標値が小さくなる方向に直進行程を走行させる復路直進
処理を行う。この復路直進処理はステップS8の往路直
進処理と同様に行われる。ステップS15では、自走車
1のy座標Ypが予定のy座標Ytnより小さいか否か
によって第2番目の直進行程の走行を終了したか否かを
判断する。ステップS16では、直進行程のx座標Xr
efが走行終了予定地点のx座標Xendを超過したか
否かを判断する。ステップS16の判断が否定の場合
は、ステップS17に進んで次の直進行程を設定する。
ステップS18では、左方向旋回行程の走行を終了させ
る方位角を設定する左ターン解除角セット処理を行う。
この処理は計算に使用される直進行程のy座標値がYt
nになる他は前記右ターン解除角セット処理と同様であ
る。ステップS19では、Uターン処理を行う。ステッ
プS20では、解除カウンタの値が“1”を超過してい
るか否かを判断する。この判断が肯定の場合は、左方向
への旋回を終了したと判断してステップS8に戻る。
【0094】また、ステップS16の判断が肯定の場合
は、ステップS21に進む。ステップS16の判断が肯
定の場合はすべての直進行程の走行を終了した場合であ
り、ステップS21では、最終の旋回行程における解除
角をセットする処理を行う。この処理は右ターン解除角
セットおよび左ターン解除角セットなどと同様に処理さ
れる。
【0095】ステップS22ではUターン処理を行い、
ステップS23では、解除カウンタの値が1を超過して
いるか否かを判断する。ステップS24では、ホームポ
ジション63に戻る直進行程を走行させる処理を行う。
この処理は往路直進処理と同様である。
【0096】ステップS25では、自走車1のx座標X
pがホームポジション63のx座標Xhomeより小さ
くなったか否かを判断する。この判断が肯定ならば、自
走車1がホームポジション63に戻ったと判断して処理
を終える。
【0097】続いて、前記ステップS8の往路直進処理
の詳細を説明する。図13は往路直進処理のフローチャ
ートである。同図において、ステップS200では、反
射光受光処理を行う。ステップS201では、揺動方向
が“0°”か否かによって、回転中心軸8が円錐を描く
揺動を1サイクル終えたかどうかを判断する。この揺動
の1サイクルを終了するまで反射光の受光処理を行い、
ステップS202で、この反射光受光処理によって得ら
れたデータを読込む。ステップS203では、反射光受
光処理によって得られた方位角Am(i)の中から予測
方位角θq(n)に最も近いものを抽出し、各基準点の
方位角Ac(n)に格納する。ステップS204では、
カウンタ値nをクリアし、ステップS205ではその値
をインクリメントする。ステップS206では、基準点
nの方位角θ(n)および予測方位角θq(n)に前記
方位角Ac(n)をセットする。
【0098】すべての基準点A〜Dについて方位角θ
(n)と予測方位角θq(n)との更新が終了したとい
うことがステップS207で判断されたならば、ステッ
プS208に進み、反射光受光処理によって得られたデ
ータをクリアしてステップS209に進む。
【0099】ステップS209では、以上のようにして
測定した各基準点A〜Dについての方位角θ(n)とそ
の位置情報に基づいて、図5,図6ですでに説明したよ
うにして自走車1の位置(Xp,Yp)および進行方向
θfを算出する。ステップS210では、設定された走
行コース(直進行程)に対するx座標Xrefと自走車
1のx座標Xpとのずれ量ΔX、および進行方向θfが
直進状態からずれている角度Δθを算出する。ステップ
S211では、前記ずれ量ΔXおよびずれ角度Δθを修
正するように操向制御を行う。
【0100】次に、以上の動作を行わせるための制御機
能を説明する。まず、反射光受光処理の機能について説
明する。図14は反射光受光処理部の要部機能を示すブ
ロック図である。同図に示した反射光受光処理部の機能
は、図8,図11,図12のフローチャートに示した反
射光受光処理、イニシャルポール識別処理、ポール選択
処理の内容に対応する。
【0101】同図において、外部からの光信号は方位角
検出部37および揺動方向検出部38に入力される。方
位角検出部37はエンコーダ7から入力されるパルス信
号の数を計数するカウンタを持っており、光信号が入力
された時のパルス計数値に基づき、自走車1から見た光
信号入射方位(=方位角)が検出される。検出された方
位角はブロック別方位角記憶部39に記憶される。
【0102】例えば、最初に検出された方位角は第1検
出ブロックの方位角として記憶領域Am(0)に格納さ
れる。第2回目に検出された方位角は、これが第1検出
ブロックで先に検出された方位角とほぼ一致していれ
ば、Am(0)の記憶データは第2回目に検出された方
位角で更新され、一致していなければ第2検出ブロック
の方位角として新たに記憶領域Am(1)に格納され
る。こうして同一方向から入射した光信号は同一の検出
ブロックのデータAm(i)として記憶される。
【0103】ブロック別受光回数記憶部40には、前記
検出ブロック別に受光回数Cg(i)が記憶される。受
光回数判定部41は、受光回数Cg(i)が多い検出ブ
ロックを判別し、受光回数Cg(i)が多い順に4つの
検出ブロックを抽出する。そして、それらの検出ブロッ
クを代表する方位角を、前記ブロック別方位角記憶部3
9から読出して方位角記憶部42に格納する。この際、
方位角の小さい順に記憶領域Aps(1)〜Aps
(4)に格納する。予測方位角記憶部43には、今回検
出された方位角に基づいて次回の走査で検出されるはず
の方位つまり予測方位角を記憶する。この予測方位角は
今回検出の方位角と同値でも良いし、予定の値を加算し
た値でも良いことは前に述べたとおりである。
【0104】方位角比較部44では、予測方位角と今回
の検出方位角とが比較され、双方の角度がほぼ一致した
場合は、一致信号aを出力する。この一致信号に応答し
て、常時開のスイッチSW1およびSW2が閉成され
て、基準点別データ記憶部45に各種データが入力され
て記憶される。この各種データは、方位角Ap,揺動方
向As,およびセンサ33の出力を基準とし、その出力
時点からのミラー4の回転回数Cm、ならびに基準点別
受光回数Cp(n)である。ここで、値Ap,As,C
mは、基準点nおよび基準点別受光回数Cp(n)の関
数として記憶される。続いて、自走車1が走行中の制御
を行う操向制御部の機能を説明する。図15は操向制御
部の要部機能を示すブロック図である。同図において、
前記基準点位置演算部53では、自走車1および基準点
間の距離と、自走車1から見た基準点の方位角に基づい
て基準点の位置座標が算出される。この位置座標は自走
車1を原点とする座標系における座標値である。したが
って、この座標値は、座標変換部54で基準点A〜Dの
いずれか1つ、例えば基準点Bを原点とし、基準点B,
Cを結ぶ直線をx軸とする座標系での座標値に変換す
る。座標変換された基準点の座標値は、自走車1の位置
および進行方向を算出する位置・進行方向演算部55に
供給される。
【0105】位置・進行方向演算部55では、基準点A
〜Dの位置座標および反射光受光処理によって検出され
た方位角θ(n)に基づき、自走車1の位置(Xp,Y
p)、および進行方向θfが算出される。
【0106】また、ターン解除角設定部56では、基準
点の座標およびあらかじめ決められている旋回終了位置
の座標に基づいて右ターン解除角、左ターン解除角およ
び最終ターン解除角がそれぞれ計算されて設定される。
比較部57では、自走車1の位置および進行方向と走行
コース設定部58で設定された走行コースとを比較して
その偏差を操舵部59に出力する。操舵部59は供給さ
れた偏差に基づいてこれを補正するための操舵角を決定
する。決定された操舵角は操舵モータ60に供給され、
この操舵角に従って車輪が操舵される。
【0107】さらに、比較部57は自走車1の位置およ
び進行方向と走行コースとを比較して自走車1を旋回さ
せるタイミングを検出する。そして、このタイミングを
検出したならば、検出信号を操舵角固定部61に出力す
る。操舵角固定部61はこの検出信号に応答して予定の
ターン用操舵角を操舵部59に供給し、操舵角を固定さ
せる。
【0108】解除検知部62は、自走車1の進行方向が
ターン解除角に一致するのを監視している。そして、両
者が一致したならば、操舵角固定部61にターン用操舵
角の出力を停止させる指令信号を出力して旋回を終了さ
せる。
【0109】このように、本実施例では、比較部57で
得られた偏差によって決定される操舵角およびターン用
操舵角に従って車輪を操舵し、予定の走行コースに自走
車1を走行させるようにしている。
【0110】
【発明の効果】以上の説明から明らかなように、本発明
によれば、移動体から投射する光ビームの回転走査を高
速で行うことができ、移動体から離れた位置に立設され
ている光反射器に対し、必ずこれを横切って光ビームを
照射できるように設定可能になる。そのために、移動体
自体が傾斜し続けたり揺れたりした場合にも、基準点に
配置された光反射器に対して光ビームを照射し易くな
る。
【0111】つまり、基準点を見失うことが少なくな
り、光反射器からの反射光検出信号に基づく移動体の位
置検出精度が高くなって誘導の精度が格段に向上する。
【0112】そして、単位揺動走査における高速の回動
走査によって複数の受光信号が検出された場合でも、略
同一方位で検出された光信号の方位角は、それを1つの
データで代表させて記憶することができる。したがっ
て、この方位角を記憶するための記憶手段の容量を節約
することができるし、データ処理も容易になる。
【0113】さらに、前記記憶された方位角データに基
づいて単位揺動走査毎に移動体の位置を算出するように
したので、回動走査が高速であっても移動体の位置算出
の時間を十分にとることができる。
【図面の簡単な説明】
【図1】 光ビーム走査装置の要部断面図である。
【図2】 自走車の走行状態を示す斜視図である。
【図3】 光ビームの光跡を示す斜視図である。
【図4】 光跡と光反射器との関係を示す図である。
【図5】 自走車位置算出の原理説明図である。
【図6】 自走車進行方向算出の原理説明図である。
【図7】 自走車の走行コースと反射器の配置状態を
示す図である。
【図8】 反射光受光処理のフローチャートである。
【図9】 自走車の操向制御を示すフローチャートで
ある。
【図10】 自走車の操向制御を示すフローチャートで
ある。
【図11】 イニシャルポール識別処理のフローチャー
トである。
【図12】 ポール選択処理のフローチャートである。
【図13】 自走車の往路直進処理のフローチャートで
ある。
【図14】 反射光受光処理の要部機能を示すブロック
図である。
【図15】 自走車操向制御の要部機能を示すブロック
図である。
【図16】 検出ブロック別の方位角と受光回数とを示
す図である。
【図17】 従来技術による光ビームの光跡および反射
器の関係を示す図である。
【符号の説明】
1…自走車、 2…光ビーム走査装置、 4…回転ミラ
ー、 5…ミラー駆動モータ、 6,6a〜6d…光反
射器、 7…エンコーダ、 8…回転中心軸、9,10
…ブラケット、 11…外側リング部材、 14…内側
リング部材、15…揺動用モータ、 16…電磁石、
19…連結金具、 23…大円盤、24…小円盤、 2
6,31…連結ボルト、 33…揺動基準検出用セン
サ、34…吸着板、 35…エンコーダ、 36…走行
コース、 37…方位角検出部、38…揺動方向検出
部、 39…ブロック別方位角記憶部、 40…ブロッ
ク別受光回数記憶部、 41…受光回数判定部、 42
…方位角記憶部、 43…予測方位角記憶部、 44…
方位角比較部、 45…基準点別データ記憶部、53…
基準点位置演算部、 54…座標変換部、 55…位置
・進行方向演算部、 56…ターン解除角設定部、 5
7…比較部、 58…走行コース設定部、 59…操舵
部、 61…操舵角固定部、 62…解除検知部
───────────────────────────────────────────────────── フロントページの続き (58)調査した分野(Int.Cl.6,DB名) G01S 5/16 G01S 7/48 - 7/51 G01S 17/00 - 17/95 G02B 26/10

Claims (3)

    (57)【特許請求の範囲】
  1. 【請求項1】 移動体を中心として略水平面内で光ビー
    ムを回転走査する回転走査手段と、前記移動体から離れ
    た位置に設置された光反射手段で反射された前記光ビー
    ムを前記移動体に搭載された受光手段で受光することに
    より、前記移動体と前記光反射手段との位置関係を検出
    し、この検出結果に基づいて前記移動体の位置を検知す
    る移動体の位置検知装置において、前記光ビームを上下
    方向に揺動させるための揺動手段を有し、この上下方向
    の単位揺動サイクル中に前記光ビームの回転走査が複数
    回行われるように構成すると共に、前記揺動の単位揺動
    サイクルにおいて受光した光信号の方位角を記憶する手
    段と、前記光反射手段からの光ビームの反射光が次回の
    揺動走査で検出されるはずの方位角を、現在までに検出
    された方位角に基づいて予測する予測方位角決定手段
    と、前記記憶された各方位角と前記予測方位角とを前記
    単位揺動サイクル毎に照合して実際の受光方位角を判別
    する手段とを具備し、この判別結果により得られたデー
    タに基づいて移動体の位置を検知するように構成したこ
    とを特徴とする移動体の位置検知装置。
  2. 【請求項2】 単位揺動サイクルにおいて略同一方位角
    で複数の光信号が受光された場合は、最新の受光信号の
    方位角のみを記憶するようにしたことを特徴とする請求
    項1記載の移動体の位置検知装置
  3. 【請求項3】 前記揺動手段は、前記光ビームの回転走
    査手段の回転中心軸上の一点を中心としてこの光ビーム
    走査手段の回転中心軸を所定角度傾斜させた状態で回動
    することにより、前記光ビームが上下方向に周期的に揺
    動するように構成したことを特徴とする請求項1または
    2記載の移動体の位置検知装置。
JP3126515A 1991-04-11 1991-05-01 移動体の位置検知装置 Expired - Fee Related JP2968612B2 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP3126515A JP2968612B2 (ja) 1991-05-01 1991-05-01 移動体の位置検知装置
AU13919/92A AU641315B2 (en) 1991-04-11 1992-03-30 System for detecting the position of moving body
US07/864,468 US5258822A (en) 1991-04-11 1992-04-06 System for detecting the position of a moving body
DE4211854A DE4211854C2 (de) 1991-04-11 1992-04-08 System zur Erfassung der Position eines sich bewegenden Körpers
FR9204338A FR2676544B1 (fr) 1991-04-11 1992-04-09 Systeme pour detecter la position d'un corps mobile.

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP3126515A JP2968612B2 (ja) 1991-05-01 1991-05-01 移動体の位置検知装置

Publications (2)

Publication Number Publication Date
JPH04329389A JPH04329389A (ja) 1992-11-18
JP2968612B2 true JP2968612B2 (ja) 1999-10-25

Family

ID=14937121

Family Applications (1)

Application Number Title Priority Date Filing Date
JP3126515A Expired - Fee Related JP2968612B2 (ja) 1991-04-11 1991-05-01 移動体の位置検知装置

Country Status (1)

Country Link
JP (1) JP2968612B2 (ja)

Also Published As

Publication number Publication date
JPH04329389A (ja) 1992-11-18

Similar Documents

Publication Publication Date Title
US5258822A (en) System for detecting the position of a moving body
JP2802560B2 (ja) 移動体の操向制御装置
AU755485B2 (en) Method for determining the position of an automated guided vehicle
JPH01316808A (ja) 自走車の操向制御装置
JP2712061B2 (ja) 移動体の位置検出装置
JPH0844428A (ja) 無人走行車
JP3001701B2 (ja) 移動体の操向制御装置
JP2968612B2 (ja) 移動体の位置検知装置
JP2947427B2 (ja) 移動体の位置検出装置
US5260770A (en) System for detecting the position of observation spot
US5170350A (en) Steering control system for moving vehicle
JP3025574B2 (ja) 位置検出装置
JP2968611B2 (ja) 位置検出装置
JP2908601B2 (ja) 位置検出装置
JP3071952B2 (ja) 位置検出装置
JP3172272B2 (ja) 移動体の操向制御装置
JP2908612B2 (ja) 位置検出装置
JPH0260124B2 (ja)
JPH0833770B2 (ja) 自走車の操向位置検出装置
JPH04361189A (ja) 移動体の位置検出装置
JPH04344905A (ja) 移動体の操向制御装置
JP2769904B2 (ja) 自走車の操向制御装置
JP2802525B2 (ja) 自走車の走行コース設定装置
JP2535213B2 (ja) 自走車の操向位置検出装置
JPH0774973B2 (ja) 自走車の操向制御装置

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees