JP4051883B2 - 無人車位置計測方式 - Google Patents
無人車位置計測方式 Download PDFInfo
- Publication number
- JP4051883B2 JP4051883B2 JP2000386397A JP2000386397A JP4051883B2 JP 4051883 B2 JP4051883 B2 JP 4051883B2 JP 2000386397 A JP2000386397 A JP 2000386397A JP 2000386397 A JP2000386397 A JP 2000386397A JP 4051883 B2 JP4051883 B2 JP 4051883B2
- Authority
- JP
- Japan
- Prior art keywords
- unmanned vehicle
- reflecting plate
- reflected light
- reflector
- angle
- 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
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【発明の属する技術分野】
本発明は、無人車位置計測方式に関する。詳しくは、レーザレーダを用いて位置を検出する無人搬送車の位置検出方式における反射板のマッチング方式に関するものである。
【0002】
【従来の技術】
走査型レーザレーダのレーザ光を水平面状に回転走査し、測定対豪物の距離とその反射光を計測する走査型レーザレーダを無人車の位置検出に用いる方法がある。
この方式は従来の電磁誘導線や光学テープといったガイドの敷設工事は不要であるためコースコースレイアウトの変更が容易で、敷設工事費を削減することができる。
またこれに伴い床面条件の影響も受けない。
【0003】
走査型レーザレーダを用いた無人車位置検出方式には、図3及び図4に示すように、走行環境に複数配置された反射板までの距離、方向を検出し、三角測量の原理で位置を検出する方式がある。
即ち、走査型レーザレーダ10は、回転台1上に回転テーブル2を回転自在に載置すると共にこの回転テーブル2上に水平面に対し45度に傾いたミラー3を設置し、このミラー3の直上に水平面に対し45度に傾いたハーフミラー4を配設し、更に、このハーフミラー4の直上、水平方向側方にフォトダイオード5、レーザ6を設置したものである。
【0004】
従って、回転台1上の回転テーブル2、ミラー3を矢印で示すように回転させつつ、レーザ6から水平に出射されたレーザをハーフミラー3で垂直下方に折り曲げ、更に、ミラー3で水平方向に折り曲げて、反射板7へ投射するのである。
そして、反射板7から反射した光は、逆に、ミラー3で垂直上向きに折り曲げられ、ハーフミラー4を透過し、フォトダイオード5で検出されることになる。
【0005】
また、回転台1には、回転テーブル2の回転角度を検出するエンコーダ、タコジェネレータ等が設けられている。
このようなレーザレーダ10を、図4に示すように無人搬送車20に搭載し、レーザレーダ10から無人搬送車走行環境に複数配置された反射板30,40,50,60までの距離、方向を検出する。
【0006】
この方式の原理を以下に述べる。
反射板R1からR7は図5に示すようなXY平面座標上に予め決められた位置に配置されているとする。
無人車に搭載されたレーザレーダを走査することにより、無人車に対する反射板までの距離、方向を求める。
上図における反射板の距離、方向の測定結果を図6に示す。
同図の場合、反射板R1,R2,R3,R4,R5の距離の測定結果はそれぞれd1,d2,d3,d4,d5、方向の測定結果はθ1,θ2,θ3,θ4,θ5である。
【0007】
反射板からの反射光かどうかの判断は反射光レベルを検出することにより、その値が規定値より大きい場合、その反射光が反射板からのものであると判断する。
これらの検出された反射板の中から任意の2つの反射板を選択して無人車の位置演算を行う。
以下にその方法を述べる。
図7に示すように、無人車から2枚の反射板R1,R2が無人車に対して、(角度θ1,距離d1)、(角度θ2,距離d2)の値で検出されたとする。
反射板R1,R2の位置は既知で、それぞれ(X1,Y1)、(X2,Y2)とする。
【0008】
このときの無人車の位置(Xa,Ya)、方向θaを求める。
角度は図の矢印の方向を正とする(反時計方向が正)。
ここで、2枚の反射板の角度の関係は常にθ1>θ2とする。
これより、θ12>0となる。
反射板検出後、検出された反射板が実際にどの反射板からの反射光であるのか求める反射板マッチング処理を行う。
これは前回の処理で得られた無人車位置検出結果を基に求める。
ただし初期状態ではこのような前回位置がないので無人車をホームステーションと呼ばれる位置が明らかな場所に停止させ、この値を初期位置とする。
いまこの前回位置、初期位置を(Xa0,Ya0)、車体傾きをθa0とすると、図8より反射板R1の推定位置(Xr1,Yr1)が求められる。
【0009】
【数1】
【0010】
このようにして求められた反射板推定位置(Xr1,Yr1)と反射板設定位置とを比較し、その差が設定値より小さいとき、反射光がどの反射板からのものなのかを同定することができる。
このマッチング処理をすべての反射板反射光について行う。
どの反射板ともマッチングされない反射光は以下の位置演算には用いない。
【0011】
このようにマッチングされた反射板の中から任意の2つの反射板を選択する。
これらの反射板の位置は予め分かっているので、無人車の位置(Xa,Ya)は反射板位置と無人車から反射板までの距離出力からなる連立方程式を解くことにより求めることができる。
(2)式に反射板R1,R2をから無人車の位置を求める連立方程式を示す。
【0012】
【数2】
【0013】
この連立方程式を解くと、図9に示すように2つの無人車の位置(Xa,Ya)が求められる。
これらの解を(Xa1,Ya1)、(Xa2,Ya2)とすると、
【0014】
【数3】
【0015】
これら2つの解の中から正しい無人車位置を選択する方法を図10を例にして説明する。
ここで、角度の向きは図の矢印の方向を正とする(反時計方向が正)。
座標(Xa1,Ya1)における2枚の反射板の角度は次式で求めることができる。
【0016】
【数4】
【0017】
同様に座標(Xa2,Ya2)における2枚の反射板の角度は次式で求めることができる。
【0018】
【数5】
【0019】
そして、角度差φ12−φ11,φ22−φ21を求め、これらの中でθ12に近い値の座標を正しい無人車位置とする。
上図の場合、φ12−φ11はθ12に近い値となるが、φ22−φ21は負の値となるためθ12に近い値とはならない。
これより(Xa1,Ya1)が正しい無人車位置として選択される。
このときの無人車の方向θaは、
【0020】
【数6】
【0021】
となる。
さらに他の反射板の組合せの連立方程式から無人車の位置を算出し、得られた結果すべてを平均化することによって、より高粘度な位置検出が実現できる。
【0022】
【発明が解決しようとする課題】
無人車の位置を高精度に検出するためには反射板からの反射光が常に安定してレーザレーダに帰ってこなければならない。
従来では、平面状の反射板を用いているため、レーザが反射板に照射する入射角が大きいと、反射光が帰ってこなかったり、あるいは帰って来たり帰ってこなかったり不安定なときがある。
このような現象は無人車の位置検出誤差の原因となる。
【0023】
【課題を解決するための手段】
上記課題を解決する本発明の請求項1に係る無人車位置計測方式は、走査型レーザレーダ無人車の位置検出方式において、反射板からの反射光を安定して検出する方法として、レーザ光が反射板へ照射される入射角を求め、入射角が設定値以下のもののみを利用して、その反射板からの反射光に基づいて位置演算を行うことを特徴とする。
【0029】
【発明の実施の形態】
反射板からの反射光が安定して得られる実施例を以下に述べる。
〔実施例1〕
本発明の第1の実施例に係る無人車位置計測方式を図1に示す。
本実施例は、レーザ光が反射板R1へ照射される入射角θinを求め、入射角θinがある設定値よリ大きい場合、その反射板R1からの反射光は位置演算に用いない方法である。
即ち、入射角θinが大きくなると、反射光が帰ってきたり帰ってこなかったり不安定になる。
このような不安定な反射板R1を位置演算に用いることは大きな誤差原因となる。
【0030】
そこで、レーザ光が反射板へ照射される入射角θinを求め、ある設定値より大きい場合、例えば、60°より大きい場合、その反射板R1からの反射光は位置演算に用いないようにするのである。
具体的には、反射板R1に照射されるレーザ光の入射角θinは、反射板法線ベクトルとX軸に対する角度をθrとすると、次のように求められる。
【0031】
【数7】
【0032】
尚、各反射板の方線ベクトルは、反射板の設置のときに、反射板の位置といっしょに予め無人車の制御装置に記憶されているものとする。
【0033】
〔実施例2〕
本発明の第2の実施例に係る無人車位置計測方式を図2に示す。
本実施例は、図2に示すように、反射板70を三角柱形にする方法である。
反射板70を三角柱形にすることにより、平面形の反射板7に比較し、レーザが反躰板に照射する入射角を小さくすることができるため、安定した反射光を得ることができる。
【0034】
〔実施例3〕
本発明の第3の実施例に係る無人車位置計測方式を図11に示す。
実施例2において頂点角度が小さい場合、図11(a)に示すように、レーザ光が三角形正面から照射されると入射角が大きくなり、反射光が検出できなくなる。
また、頂点角度が大きすぎると、実施例1で述べた問題が起こる。
そこで、本実施例は、レーザ光がどの方向から照射されても安定した反射光が得られるように、図11(b)に示すように、頂点角度を45[deg]〜60[deg]に設定する方式である。
【0035】
〔実施例4〕
本発明の第4の実施例に係る無人車位置計測方式を図12に示す。
本実施例では、図12のように反射板72を円柱形にする方法である。
反射板72を円柱形にすることにより、平面形の反射板7に比較し、レーザが反射板に照射する入射角を小さくすることができるため、安定した反射光を得ることができる。
【0036】
〔実施例5〕
本発明の第5の実施例に係る無人車位置計測方式を図13に示す。
本実施例は、図13に示すように反射板73を蒲鉾形にする方法である。
反射板73を蒲鉾形にすることにより、レーザが反射板に照射する入射角を小さくすることができるため、安定した反射光を得ることができる。
【0037】
〔実施例6〕
本発明の第6の実施例に係る無人車位置計測方式を図14に示す。
本実施例は、図14に示すように反射板を半円筒形にする方法である。
反射板74を半円筒形にすることにより、レーザが反射板に照射する入射角を小さくすることができるため安定した反射光を得ることができる。
【0038】
【発明の効果】
以上、実施例に基づいて具体的に説明したように、本発明は、走査型レーザレーダ無人車の位置検出方式において、反射板からの反射光を安定して検出する方法として、レーザ光が反射板へ照射される入射角を求め、入射角がある設定値より大きい場合、その反射板からの反躰光は位置演算に用いないことにより、反射板からの反射光が安定して得られるという効果を奏する。
【図面の簡単な説明】
【図1】本発明の第1の実施例に係る無人車位置計測方式の説明図である。
【図2】本発明の第2の実施例に係る無人車位置計測方式の説明図である。
【図3】走査型レーザレーダの斜視図である。
【図4】走査型レーザレーダによる位置検出の説明図である。
【図5】反射板の配置図である。
【図6】反射板と無人搬送車との距離及び角度を示す説明図である。
【図7】無人搬送車の方向と二つの反射板との関係を示す説明図である。
【図8】無人搬送車の方向と二つの反射板との関係を示す説明図である。
【図9】無人搬送車の位置と二つの反射板との関係を示す説明図である。
【図10】二つの無人搬送車の位置の解から正しい無人搬送車の位置を選択する方法を示す説明図である。
【図11】本発明の第3の実施例に係る無人車位置計測方式の説明図である。
【図12】本発明の第4の実施例に係る無人車位置計測方式の説明図である。
【図13】本発明の第5の実施例に係る無人車位置計測方式の説明図である。
【図14】本発明の第6の実施例に係る無人車位置計測方式の説明図である。
【符号の説明】
10 走査型レーザレーダ
20 無人搬送車
30〜60,R1,R2,R3,R4,R5 反射板
70 バーコード反射板
Claims (1)
- 走査型レーザレーダ無人車の位置検出方式において、反射板からの反射光を安定して検出する方法として、レーザ光が反射板へ照射される入射角を求め、入射角が設定値以下のもののみを利用して、その反射板からの反射光に基づいて位置演算を行うことを特徴とする無人車位置計測方式。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000386397A JP4051883B2 (ja) | 2000-12-20 | 2000-12-20 | 無人車位置計測方式 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000386397A JP4051883B2 (ja) | 2000-12-20 | 2000-12-20 | 無人車位置計測方式 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2002188918A JP2002188918A (ja) | 2002-07-05 |
JP4051883B2 true JP4051883B2 (ja) | 2008-02-27 |
Family
ID=18853504
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2000386397A Expired - Fee Related JP4051883B2 (ja) | 2000-12-20 | 2000-12-20 | 無人車位置計測方式 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4051883B2 (ja) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5698969B2 (ja) * | 2009-12-25 | 2015-04-08 | 本田技研工業株式会社 | 測定装置、位置測定システム、測定方法、較正方法及びプログラム |
KR101140839B1 (ko) | 2010-01-04 | 2012-05-03 | (주)엔스퀘어 | 무인반송차량의 위치인식방법 및 그 장치 |
JP6364373B2 (ja) | 2015-03-26 | 2018-07-25 | 株式会社日立製作所 | 傾き検出方法、および、傾き検出装置 |
JP7392962B2 (ja) | 2017-09-05 | 2023-12-06 | 日本電気株式会社 | 空間認識装置、空間認識方法、プログラム |
JP7392963B2 (ja) | 2017-09-05 | 2023-12-06 | 日本電気株式会社 | 空間認識装置、空間認識方法、プログラム |
CN111337016B (zh) * | 2020-03-31 | 2024-06-11 | 广东技术师范大学天河学院 | 一种基于激光扫描仪的agv及其导航方法 |
-
2000
- 2000-12-20 JP JP2000386397A patent/JP4051883B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2002188918A (ja) | 2002-07-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2019020209A (ja) | 測量システム | |
JP3951473B2 (ja) | 無人搬送車位置検出方式 | |
JP4051883B2 (ja) | 無人車位置計測方式 | |
JP2002189518A (ja) | 無人車位置計測方式 | |
JP3997639B2 (ja) | 無人搬送車位置検出方式 | |
WO2022179227A1 (zh) | 扫地机的回充对准方法、装置及扫地机 | |
JP4200649B2 (ja) | 無人搬送車の位置検出装置 | |
CN114459355A (zh) | 一种悬臂轴位置检测系统及方法 | |
JPH11271448A (ja) | レーザ距離計用校正装置及びこれを備えたレーザ測距装置 | |
JP3940619B2 (ja) | トンネル掘削機の位置計測装置 | |
JP2000258227A (ja) | 鏡面、非鏡面物における表面の変位測定装置 | |
JP4172882B2 (ja) | 移動体の位置検出方法およびその設備 | |
JP3690260B2 (ja) | 車間距離計測方法 | |
JP2005127992A (ja) | レーザー距離計による移動体位置計測装置及び計測方法 | |
JPH11183174A (ja) | 移動体の位置計測装置 | |
JPH03264804A (ja) | 表面形状測定装置 | |
JP2001033207A (ja) | 移動体の位置特定方法及び装置 | |
JP2001033244A (ja) | 移動体の位置特定方法及び装置 | |
JP6464595B2 (ja) | センサ取付角度検出装置、およびセンサ取付角度検出プログラム | |
JPH11271043A (ja) | 移動体の位置計測装置 | |
JP2002055718A (ja) | 無人車位置検出方式 | |
JPS6227406B2 (ja) | ||
JPH0259931B2 (ja) | ||
JP2000097697A (ja) | 無人搬送車位置検出方式 | |
CN217331035U (zh) | 一种悬臂轴位置检测系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20051209 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20070809 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070814 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20071015 |
|
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: 20071113 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20071126 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101214 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4051883 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111214 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121214 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131214 Year of fee payment: 6 |
|
LAPS | Cancellation because of no payment of annual fees |