JPH04312105A - Stop position detecting display device - Google Patents
Stop position detecting display deviceInfo
- Publication number
- JPH04312105A JPH04312105A JP3078777A JP7877791A JPH04312105A JP H04312105 A JPH04312105 A JP H04312105A JP 3078777 A JP3078777 A JP 3078777A JP 7877791 A JP7877791 A JP 7877791A JP H04312105 A JPH04312105 A JP H04312105A
- Authority
- JP
- Japan
- Prior art keywords
- light
- light emitting
- matter
- reference member
- stop position
- 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
Landscapes
- Manipulator (AREA)
- Special Conveying (AREA)
- Control Of Conveyors (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
【0001】0001
【産業上の利用分野】本発明は、移動車が自動走行する
ステーションに、平面視での基準位置情報を表示するた
めの発光式の基準部材が設けられた停止位置検出用表示
装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a display device for detecting a stop position, which is provided with a light-emitting reference member for displaying reference position information in plan view at a station where a mobile vehicle automatically travels.
【0002】0002
【従来の技術】従来、発光式の基準部材が設けられた停
止位置検出用表示装置は、光通過用の開口部が形成され
た遮光体と、その遮光体の各開口部の後方に配置されて
前記開口部を通して前方に発光するLED等の光源で構
成されていた。2. Description of the Related Art Conventionally, a display device for detecting a stop position provided with a light-emitting reference member includes a light-shielding body in which an opening for passing light is formed, and a light-shielding body disposed behind each opening of the light-shielding body. It was constructed with a light source such as an LED that emits light forward through the opening.
【0003】0003
【発明が解決しようとする課題】ところが、この種の停
止位置検出用表示装置では、上記の構成からも判るよう
に、多数の光源を前記各開口部に位置合わせして設置す
ることが必要であり、その手間と費用が多くかかるとい
う問題があった。また、前記光源のうち1個でも故障す
れば表示装置として使用不可となるので、その度に故障
した1個の光源を交換し再位置合わせして設置すること
が必要となり、保守面の手間と費用も大きくなるという
不具合もあった。However, in this type of stop position detection display device, as can be seen from the above configuration, it is necessary to install a large number of light sources aligned with each of the openings. However, there was a problem in that it required a lot of effort and cost. In addition, if even one of the light sources fails, it becomes unusable as a display device, so it is necessary to replace the failed light source each time, realign the position, and install it, which increases maintenance time and effort. There was also the problem of increased costs.
【0004】また、上記の停止位置検出用表示装置が設
けられたステーションに移動車が停止した時の停止位置
のずれ量を検出する場合においては、ステーション上の
前記基準部材を移動車に設けたカメラ等の撮像手段で撮
像し、その撮像情報から上記ずれ量を求めるが、この時
、前記撮像手段が前記基準部材を斜め方向から撮像した
場合には、前記開口部を通過した前記光源からの光を均
一に検出できないことがあり、この為、前記開口部の形
状を正しく認識できず、結果的に上記停止位置のずれ量
を精度良く求めることが出来ない場合があった。[0004] Furthermore, in the case of detecting the amount of deviation of the stop position when a moving vehicle has stopped at a station provided with the above-mentioned display device for detecting the stop position, it is preferable that the reference member on the station is provided on the moving vehicle. An image is taken by an imaging means such as a camera, and the amount of deviation is determined from the imaging information. At this time, if the imaging means takes an image of the reference member from an oblique direction, the amount of deviation from the light source that has passed through the opening is The light may not be detected uniformly, and therefore the shape of the opening may not be correctly recognized, and as a result, the amount of deviation of the stop position may not be determined with high accuracy.
【0005】本発明は、上記実情に鑑みてなされたもの
であって、その目的は、製作面および保守面での手間と
費用が少なくて済み、また、撮像手段の撮像方向による
停止位置ずれ検出の精度低下を防止することが出来る停
止位置検出用表示装置を提供する事にある。The present invention has been made in view of the above-mentioned circumstances, and its purpose is to reduce labor and costs in terms of production and maintenance, and to detect deviations in the stop position of the imaging means depending on the imaging direction. An object of the present invention is to provide a display device for detecting a stop position that can prevent a decrease in accuracy.
【0006】[0006]
【課題を解決するための手段】本発明による停止位置検
出用表示装置の第1の特徴手段は、前記基準部材が、発
光面が二次元平面状に形成された発光体と、その発光体
の前記発光面側に配置され且つ、光通過用の開口部が形
成された遮光体とから構成されている点にある。[Means for Solving the Problems] A first feature of the display device for detecting a stop position according to the present invention is that the reference member includes a light emitting body whose light emitting surface is formed in a two-dimensional planar shape, and a light emitting body of the light emitting body. and a light shielding body disposed on the light emitting surface side and having an opening for light passage.
【0007】また、第2の特徴手段は、前記遮光体の前
記発光体に対向する面を光反射面に構成した点にある。A second characteristic feature is that the surface of the light shielding body facing the light emitting body is configured as a light reflecting surface.
【0008】[0008]
【作用】本発明の第1の特徴手段によれば、停止位置検
出用表示装置の製作に当たっては、二次元平面状に形成
された発光体の発光面側に、光通過用の開口部が形成さ
れた遮光体を設置するだけで済み、この際、発光体と遮
光体の各開口部との位置合わせは不要である。また、発
光体が故障した時は、その故障した発光体を交換するだ
けの保守作業で済む。[Operation] According to the first characteristic means of the present invention, in manufacturing a display device for detecting a stop position, an opening for light passage is formed on the light emitting surface side of the light emitting body formed in a two-dimensional planar shape. All that is required is to install the light shielding body, and at this time, there is no need to align the light emitting body and each opening of the light shielding body. Furthermore, when a light emitting body breaks down, maintenance work is only required to replace the failed light emitting body.
【0009】また、停止位置検出用表示装置の動作にお
いては、発光体の二次元平面状に形成された発光面全体
が光源になり、ここから発光した光が、遮光体の光通過
用の開口部の開いている所ではその開口部を通過し、開
口部の開いていない所では通過を阻止される。ここで、
カメラ等の撮像手段で撮像する場合、前記基準部材を撮
像する方向に関係なく前記開口部から均一な光が出てく
るので、前記開口部の形状を正しく認識できることにな
る。In addition, in the operation of the stop position detection display device, the entire two-dimensional planar light emitting surface of the light emitting body serves as a light source, and the light emitted from the light emitting surface is emitted from the light passing opening of the light shielding body. Where the opening is open, it passes through the opening, and where the opening is not open, it is blocked. here,
When taking an image with an imaging means such as a camera, uniform light comes out from the opening regardless of the direction in which the reference member is imaged, so that the shape of the opening can be correctly recognized.
【0010】また、第2の特徴手段によれば、二次元平
面状に形成された発光体の発光面からの光のうち、遮光
体の非開口部に当たった光が、その発光体に対向する面
で反射されて発光面との間を通った後前記開口部から放
射される。この為、前記開口部からの光量が増加してこ
の光を撮像する撮像手段の撮像信号のレベルが大きくな
り、撮像手段が前記開口部の形状をより正しく認識でき
るようになる。According to the second characteristic means, among the light emitted from the light emitting surface of the light emitting body formed in a two-dimensional plane, the light that hits the non-opening part of the light shielding body is directed toward the light emitting body. After being reflected by the surface and passing between the light emitting surface and the light emitting surface, the light is emitted from the opening. Therefore, the amount of light from the opening increases, and the level of the imaging signal of the imaging means for imaging this light increases, allowing the imaging means to more accurately recognize the shape of the opening.
【0011】[0011]
【発明の効果】従って、本発明の第1の特徴手段によれ
ば、停止位置検出用表示装置の製作および保守での手間
と費用が少なくて済み、同時に、その撮像方向と無関係
に移動車の停止位置ずれの検出精度を確保することが出
来るものとなる。Therefore, according to the first characteristic means of the present invention, it is possible to reduce the effort and cost in manufacturing and maintaining the display device for detecting the stop position, and at the same time, the display device for detecting the stop position can be easily detected by the moving vehicle regardless of the imaging direction. This makes it possible to ensure the detection accuracy of stop position deviation.
【0012】また、第2の特徴手段によれば、移動車の
停止位置ずれの検出精度がより高く確保でき、第1の特
徴手段による効果をより一層高めるものとなる。Further, according to the second characteristic means, it is possible to ensure a higher accuracy in detecting the deviation of the stop position of the moving vehicle, thereby further enhancing the effect of the first characteristic means.
【0013】[0013]
【実施例】以下、本発明の実施例を図面に基づいて説明
する。先ず、本発明の停止位置検出用表示装置が適用さ
れる移動車の走行制御システムについて説明すれば、図
3〜図4に示すように、作業装置としての荷移載用マニ
プレータ16が搭載された移動車Aの走行路の横側部に
、作業用ステーションとしての荷移載用ステーションS
Tの複数個が設置されている。そして、前記移動車Aが
指示されたステーションSTに停止するに伴って、前記
マニプレータ16によって、ステーションSTと移動車
Aとの間で荷Nの移載作業を自動的に行うように構成さ
れている。Embodiments Hereinafter, embodiments of the present invention will be explained based on the drawings. First, the traveling control system of a moving vehicle to which the stop position detection display device of the present invention is applied will be described. As shown in FIGS. 3 and 4, a load transfer manipulator 16 as a working device is mounted. A load transfer station S as a work station is located on the side of the travel path of the mobile vehicle A.
A plurality of T's are installed. Then, as the mobile vehicle A stops at the designated station ST, the manipulator 16 is configured to automatically transfer the load N between the station ST and the mobile vehicle A. There is.
【0014】但し、前記移動車Aは、走行用ガイド等を
用いないでステーションST間に亘って自律走行するよ
うに構成されている。そして、前記ステーションSTに
停止したときのステーションSTに対する平面視での基
準位置に対する車体横幅方向でのずれ量Yα、車体前後
方向でのずれ量Xα、及び、車体前後方向での傾きθの
各ずれ量情報に基づいて、次のステーションSTに対す
る走行経路を自動補正できるように構成されている。However, the mobile vehicle A is configured to autonomously travel between stations ST without using a travel guide or the like. Then, when stopped at the station ST, the displacement amount Yα in the width direction of the vehicle body, the displacement amount Xα in the longitudinal direction of the vehicle body, and the inclination θ in the longitudinal direction of the vehicle body with respect to the reference position in a plan view with respect to the station ST. Based on the amount information, the travel route to the next station ST can be automatically corrected.
【0015】尚、図中、移動車の走行制御システムの静
止基準座標軸(以下、レイアウト座標軸と称する)を、
X”,Y” 軸とし、移動車Aに固定された基準座標軸
として、車体前後方向を、X’ 軸、車体横幅方向をY
’ 軸とする。そして、移動車Aの中心ACを、X’,
Y’ 座標軸の原点とし、更に移動車Aが、ステーショ
ンSTに対する設定適正停止状態で停止する場合には、
前記中心ACがレイアウト座標軸上の基準位置LCと一
致し、且つ、X”軸とX’軸は平行であり、Y” 軸と
Y’ 軸は平行である。In the figure, the stationary reference coordinate axes (hereinafter referred to as layout coordinate axes) of the travel control system of the moving vehicle are
The X' and Y' axes are the reference coordinate axes fixed to moving vehicle A, and the longitudinal direction of the vehicle is the
' axis. Then, the center AC of moving vehicle A is defined as X',
Y' is the origin of the coordinate axis, and when moving vehicle A stops in the properly set stop state with respect to station ST,
The center AC coincides with the reference position LC on the layout coordinate axes, the X'' axis and the X' axis are parallel, and the Y'' axis and the Y' axis are parallel.
【0016】前記ステーションSTには、前記移動車A
が指示されたステーションSTにおいて停止したときに
、ステーションSTに対する前記移動車Aの設定適正停
止状態からのずれ量を検出して、前記マニプレータ16
の作動量を自動補正させたり、前記移動車Aを次のステ
ーションSTに向けて走行させるときの走行経路を自動
補正させたりするために、前記ステーションSTに対す
る基準位置情報を表示する基準部材1が設けられている
。[0016] The mobile vehicle A is located at the station ST.
When the mobile vehicle A stops at the designated station ST, the amount of deviation of the mobile vehicle A from the properly set stop state with respect to the station ST is detected, and the manipulator 16
In order to automatically correct the operating amount of the mobile vehicle A and automatically correct the travel route when the mobile vehicle A travels toward the next station ST, a reference member 1 that displays reference position information with respect to the station ST is provided. It is provided.
【0017】一方、前記移動車Aは、一対の電動モータ
5にて各別に駆動停止並びに逆転自在な状態で、車体前
後方向の略中央に設けられた左右一対の推進車輪6と、
車体前後端部の夫々に設けられた左右一対の遊転輪7と
を備えている。つまり、前記移動車Aはその場で向き変
更することができるように構成されているのである。On the other hand, the mobile vehicle A has a pair of left and right propulsion wheels 6, each of which can be stopped and reversed independently by a pair of electric motors 5, and which are provided approximately in the center of the vehicle body in the longitudinal direction.
The vehicle includes a pair of left and right idle wheels 7 provided at the front and rear ends of the vehicle body, respectively. In other words, the mobile vehicle A is configured to be able to change direction on the spot.
【0018】又、前記移動車Aには、光ファィバ式のジ
ャイロ装置Sbが搭載され、そのジャイロ装置Sbの情
報に基づいて予定走行路に対する走行方向のずれを検出
して、前記左右一対の推進車輪6の回転速度に差を付け
るように前記一対の電動モータ5を変速操作して操向さ
せるようになっている。尚、図中、Scは前記左右一対
の推進車輪6の旋回中心となる箇所に設けられた接地輪
式の走行距離検出用センサーである。Furthermore, the moving vehicle A is equipped with an optical fiber type gyro device Sb, and based on the information of the gyro device Sb, a deviation in the traveling direction with respect to the planned traveling route is detected, and the pair of left and right propulsion is detected. The pair of electric motors 5 are operated to change gears so as to differentiate the rotational speeds of the wheels 6 for steering. In the figure, Sc is a ground-contact wheel-type travel distance detecting sensor provided at the center of rotation of the pair of left and right propulsion wheels 6.
【0019】前記マニプレータ16について説明すれば
、図4に示すように、いわゆる多関節型に構成されてい
るものであって、その先端部に、荷把持具17と、前記
基準部材1の表示情報を読み取るカメラとしての二次元
イメージセンサSaとが取り付けられている。尚、詳述
はしないが、前記マニプレータ16は、各関節に設けら
れた電動モータの作動量を、その作動量を検出するエン
コーダの情報と、予め記憶された各種制御情報とに基づ
いて制御されて、荷移載作業を行うことになる。To explain the manipulator 16, as shown in FIG. 4, it is constructed in a so-called multi-joint type, and has a load gripping tool 17 and display information of the reference member 1 at its tip. A two-dimensional image sensor Sa as a camera for reading the image is attached. Although not described in detail, the manipulator 16 controls the operating amount of the electric motor provided at each joint based on information from an encoder that detects the operating amount and various control information stored in advance. Then, cargo transfer work will be carried out.
【0020】次に、前記移動車Aの制御構成について、
図5により説明する。前記移動車Aの運行を管理する地
上側の中央制御装置8と前記移動車Aとの間で、前記移
動車Aの行き先情報や前記マニプレータ16の作動指令
情報等の各種情報を通信するための無線式の通信装置9
a,9bが、前記移動車Aと地上側とに設けられている
。尚、前記地上側の通信装置9bは前記中央制御装置8
に接続され、移動車側の通信装置9aは、前記移動車A
の走行及び前記マニプレータ16の作動を制御するため
に前記移動車Aに搭載されたマイクロコンピュータ利用
の移動車コントローラ10に接続されている。Next, regarding the control configuration of the moving vehicle A,
This will be explained with reference to FIG. A system for communicating various information such as destination information of the mobile vehicle A and operation command information of the manipulator 16 between the ground-side central control device 8 that manages the operation of the mobile vehicle A and the mobile vehicle A. Wireless communication device 9
a and 9b are provided on the mobile vehicle A and on the ground side. The communication device 9b on the ground side is connected to the central control device 8.
The communication device 9a on the mobile vehicle side is connected to the mobile vehicle A.
It is connected to a microcomputer-based mobile vehicle controller 10 mounted on the mobile vehicle A to control the travel of the vehicle A and the operation of the manipulator 16.
【0021】尚、図5中、11は前記イメージセンサS
aの撮像情報を画像処理して前記基準部材1の情報を前
記移動車コントローラ10に伝達する画像処理部、12
は前記移動車コントローラ10の指令に基づいて前記マ
ニプレータ16の動作を制御するマニプレータ用コント
ローラ、13は前記左右両推進車輪6を駆動する走行用
モータ5の作動を制御する走行用コントローラ、14は
前記走行用コントローラ13の指令に基づいて前記走行
用モータ5を駆動する駆動装置、15はティーチング時
等において移動車Aに対して行き先情報を手動設定した
り、非常停止時等の復旧を行うために各種情報を手動設
定するための設定器である。In FIG. 5, 11 is the image sensor S.
an image processing unit 12 that performs image processing on the imaged information of a and transmits information on the reference member 1 to the mobile vehicle controller 10;
1 is a manipulator controller that controls the operation of the manipulator 16 based on commands from the mobile vehicle controller 10; 13 is a travel controller that controls the operation of the travel motor 5 that drives the left and right propulsion wheels 6; 14 is the travel controller A drive device 15 drives the traveling motor 5 based on commands from the traveling controller 13, and is used to manually set destination information for the mobile vehicle A during teaching, etc., and to perform recovery in the event of an emergency stop, etc. This is a setting device for manually setting various information.
【0022】前記基準部材1について説明すれば、図2
に示すように、前記基準部材1の全体に対する自己の配
置箇所を特定するための情報を表示する要素部としての
要素マーク1cが、前記基準部材1の中央点O’ を中
心とする所定半径の円周上に2次元的に分散配置されて
いる。尚、図中、X軸は車体前後方向、Y軸は車体横幅
方向に対応し、夫々前記レイアウト座標軸のX”,Y”
軸に平行であり、また前記中央点O’が、X,Y座標の
原点である。前記要素マーク1cは、上記X軸上及びY
軸上、及び各軸と45度をなす直線軸上に設けられてい
る。但し、X軸の一方向には設けられていない。更に、
各要素マーク1cは、3個の径の異なる円(大円、中円
、小円)がそれらの重心を結ぶ一直線上に、しかも大き
さの順で所定距離離して配置され、且つ、この直線の延
長上で径の大きい側の所定距離の所に、前記中央点O’
があるように構成されている。また、前記基準部材1
の中央部の前記X軸上及びY軸上で前記中央点O’から
等距離の位置には、前記中央点O’の位置を精度良く検
出するための4個の小円から成る中央マーク1dが設け
られている。The reference member 1 will be explained as shown in FIG.
As shown in FIG. 2, an element mark 1c serving as an element section displaying information for specifying the location of the reference member 1 with respect to the entire reference member 1 has a predetermined radius around the center point O' of the reference member 1. They are distributed two-dimensionally on the circumference. In the figure, the X-axis corresponds to the longitudinal direction of the vehicle body, and the Y-axis corresponds to the lateral direction of the vehicle body, and corresponds to the layout coordinate axes X" and Y", respectively.
The center point O' is parallel to the axis and is the origin of the X, Y coordinates. The element mark 1c is located on the X axis and on the Y axis.
It is provided on the axis and on a straight axis that makes 45 degrees with each axis. However, it is not provided in one direction of the X axis. Furthermore,
Each element mark 1c is arranged on a straight line connecting three circles with different diameters (a large circle, a medium circle, and a small circle) and their centroids, and separated by a predetermined distance in order of size, and The center point O' is located at a predetermined distance on the larger diameter side on the extension of
It is configured so that there is. Further, the reference member 1
At a position equidistant from the center point O' on the X and Y axes at the center of the center, there is a center mark 1d consisting of four small circles for accurately detecting the position of the center point O'. is provided.
【0023】又、前記基準部材1のX軸上の前記要素マ
ーク1cが設けられていない位置には、前記移動車Aが
停止しているステーションSTが何れであるかを識別す
るために、予め付与されたアドレス情報を表示する為の
マーク群が設けられている。これらマーク群は、正方形
の各頂点に位置する4個の基準位置マークa〜dと、上
記基準位置マークa〜dの内側に位置して前記アドレス
情報をバイナリーコードの形態で表示する複数個のアド
レスマークe〜lと、そのアドレスマークe〜lに対す
るパリティーマークm〜pの3種類のマーク及び、上記
マークaとcを結ぶ直線とX軸が交差する点を中心とす
る小円tから成る。尚、上記でマークf,j,nの中心
は、X軸上にあるとする。Further, in a position on the X-axis of the reference member 1 where the element mark 1c is not provided, a mark is placed in advance in order to identify which station ST the moving vehicle A is stopped at. A group of marks are provided to display assigned address information. These mark groups include four reference position marks a to d located at each vertex of a square, and a plurality of reference position marks a to d located inside the reference position marks a to d and displaying the address information in the form of a binary code. Consists of three types of marks: address marks e to l, parity marks m to p for the address marks e to l, and a small circle t centered at the point where the X-axis intersects the straight line connecting marks a and c. . In the above, it is assumed that the centers of marks f, j, and n are on the X axis.
【0024】又、前記基準部材1のX軸上で、前記アド
レス情報を表示する為のマーク群が設けられている位置
の反対側には、前記ステーションSTに対する前記移動
車Aの停止時の車体の傾きを検出する際に使用する傾き
検出用マーク1eが設けられている。この傾き検出用マ
ーク1eは、X軸上にある大円と、この大円の中心を通
りY軸に平行な直線上の上下等距離の位置にある2個の
小円からなる。更に、前記小円tの中心と上記傾き検出
用マーク1eの大円の中心の距離は、Lに設定されてい
る。[0024] Further, on the X-axis of the reference member 1, on the opposite side of the position where the mark group for displaying the address information is provided, there is a position where the vehicle body when the mobile vehicle A is stopped with respect to the station ST is located. A tilt detection mark 1e used for detecting the tilt of is provided. This inclination detection mark 1e consists of a large circle on the X-axis and two small circles located at equal distances above and below on a straight line passing through the center of the large circle and parallel to the Y-axis. Further, the distance between the center of the small circle t and the center of the large circle of the tilt detection mark 1e is set to L.
【0025】又、前記基準部材1の光学特性について説
明すれば、その構造は図1に示すように、二次元平面状
の発光面2cが内部に形成された発光体2と、その発光
体2の前記発光面2c側に配置され且つ、前記マークの
位置に対応して光通過用の開口部4が形成された、表面
が黒色艶消し塗装された樹脂製のシートから成る遮光体
3とから構成されている。従って、上記開口部4は、前
記要素マーク1c、前記中央マーク1d、前記傾き検出
用マーク1e、前記中央点O’、及び前記アドレス情報
を表示する為のマーク群a〜pと小円tに対応している
ことになる。尚、図1は、図2のX軸に沿った断面構造
を示すものである。Further, to explain the optical characteristics of the reference member 1, its structure, as shown in FIG. a light-shielding body 3 made of a resin sheet with a matte black surface, disposed on the light-emitting surface 2c side, and having an opening 4 for light passage formed therein corresponding to the position of the mark; It is configured. Therefore, the opening 4 is formed into the element mark 1c, the center mark 1d, the inclination detection mark 1e, the center point O', the mark group a to p for displaying the address information, and the small circle t. This means that it is compatible. Note that FIG. 1 shows a cross-sectional structure taken along the X-axis in FIG. 2.
【0026】前記発光体2は、透明ガラスから成る支持
板2aと、この支持板2aの前記遮光体3と反対側に設
けた発光材料としてのエレクトロルミネッセンス材料か
ら成る層状の発光部2bとから構成されている。尚、図
示はしないが、前記発光部2bは、前記支持板2a側を
透明電極に、また前記支持板2aの反対側を反射電極に
して層方向に電圧が印加されて発光するようになってい
る。また、前記遮光体3の発光体2に対向する面を光反
射面に構成する為に、その面に銀色の光反射シート3a
を張りつけられている。The light emitting body 2 is composed of a support plate 2a made of transparent glass, and a layered light emitting portion 2b made of an electroluminescent material as a light emitting material provided on the opposite side of the support plate 2a from the light shielding body 3. has been done. Although not shown in the drawings, the light emitting section 2b emits light by applying a voltage in the layer direction using a transparent electrode on the support plate 2a side and a reflective electrode on the opposite side of the support plate 2a. There is. Further, in order to configure the surface of the light shielding body 3 facing the light emitting body 2 as a light reflecting surface, a silver light reflecting sheet 3a is applied to that surface.
is attached.
【0027】次に、自動運転時に移動車Aがステーショ
ンSTに停止した状態において、移動車Aの設定適正停
止状態からのずれ量Xα,Yα,θを検出する停止位置
検出の概略について説明する。先ず、前記マニプレータ
16が、マニプレータ用コントローラ12の指令に基づ
いて、基準部材1に対応する読み取り用設定位置に、二
次元イメージセンサSaを自動移動させ、ここでイメー
ジセンサSaが基準部材1を読み取った読み取り情報を
前記画像処理部11が処理した結果に基づいて、前記移
動車コントローラ10が前記ずれ量Xα,Yα,θを検
出するのである。尚、前記読み取り用設定位置で、二次
元イメージセンサSaの画像上の座標軸x,yの夫々は
、移動車Aの座標軸X’,Y’ と平行となるように構
成されている。Next, an outline of stop position detection for detecting the deviation amounts Xα, Yα, and θ of the moving vehicle A from the set proper stopped state when the moving vehicle A is stopped at the station ST during automatic operation will be explained. First, the manipulator 16 automatically moves the two-dimensional image sensor Sa to a reading setting position corresponding to the reference member 1 based on a command from the manipulator controller 12, and here the image sensor Sa reads the reference member 1. The moving vehicle controller 10 detects the deviation amounts Xα, Yα, and θ based on the result of processing the read information by the image processing unit 11. At the reading setting position, the coordinate axes x and y on the image of the two-dimensional image sensor Sa are parallel to the coordinate axes X' and Y' of the mobile vehicle A, respectively.
【0028】位置ずれ検出の動作を、図6〜図8を用い
て説明すれば、前記マニプレータ16によって読み取り
用設定位置に移動させられた前記イメージセンサSaの
撮像視野S1において、通常、自律走行後の誤差が0で
はないので、基準部材1のX―Y軸とイメージセンサS
aの撮像視野のx―y軸は一致せず、またX―Y軸の原
点である前記中央点O’ とx―y軸の原点Gもずれて
いる(図6参照)。図示の状態は、イメージセンサSa
が、読み取り分解能の高い狭視野の撮像手段であり、ま
た位置ずれが比較的大きい為に、基準部材1の中央点O
’ が撮像視野S1内に入っていないが、要素マーク1
cの1個をとらえている状態を示す。To explain the positional deviation detection operation using FIGS. 6 to 8, in the imaging field of view S1 of the image sensor Sa moved to the reading setting position by the manipulator 16, normally after autonomous driving, Since the error is not 0, the X-Y axis of the reference member 1 and the image sensor S
The xy axes of the imaging field of view a do not match, and the center point O', which is the origin of the XY axes, and the origin G of the xy axes are also shifted (see FIG. 6). The illustrated state is image sensor Sa
is a narrow field of view imaging means with high reading resolution, and since the positional deviation is relatively large, the center point O of the reference member 1 is
' is not within the imaging field of view S1, but element mark 1
This shows a state where one piece of c is captured.
【0029】ここにおいて、イメージセンサSaからの
撮像信号は画像処理部11に入力され、その撮像信号の
コントラストの大小に基づいて2値化されてから、撮像
視野S1内にある要素マーク1cの基準部材1の全体に
対する座標検出情報として出力される。図において、要
素マーク1cを構成する3個の円のうち、一番小さい円
の重心をP、一番大きい円の重心をRとする。既述のよ
うに、点Pと点Rを結ぶ延長線上の所定距離の位置に基
準部材1の中央点O’があるので、前記の点P又は点R
の画面上のx―y座標軸での座標値から、前記中央点O
’とx―y軸の原点Gの距離が具体的な検出距離量(x
0,y0)が求まる。Here, the imaging signal from the image sensor Sa is input to the image processing section 11, where it is binarized based on the magnitude of the contrast of the imaging signal, and then the reference of the element mark 1c within the imaging field of view S1 is determined. It is output as coordinate detection information for the entire member 1. In the figure, among the three circles constituting the element mark 1c, the center of gravity of the smallest circle is P, and the center of gravity of the largest circle is R. As mentioned above, since the center point O' of the reference member 1 is located at a predetermined distance on the extension line connecting point P and point R, the above point P or point R
From the coordinate values on the x-y coordinate axes on the screen, the center point O
' and the origin G of the x-y axis is the specific detection distance amount (x
0, y0) is found.
【0030】次に、上記で求められた検出距離量(x0
,y0)を使い、又、前記中央点O’から車体前後方向
に対応するX軸上で左右方向の既値である位置に配置さ
れている小円t及び、傾き検出用マーク1eの大円を撮
像する位置へ、前記マニプレータ16を作動操作させて
前記イメージセンサSaを移動させる。前記小円tを撮
像した画面を撮像視野SL 、前記傾き検出用マーク1
eを撮像した画面を撮像視野SRとする(図7参照)。Next, the detection distance amount (x0
. The manipulator 16 is operated to move the image sensor Sa to a position where the image is captured. The screen on which the small circle t is imaged is the imaging field of view SL, and the tilt detection mark 1
The screen where e is imaged is defined as the imaging field of view SR (see FIG. 7).
【0031】ここにおいて、移動車AのステーションS
Tとの車体前後方向に対するずれ角θを求めるやり方を
図8により説明する。各撮像視野SL,SRにおいて、
前記傾き検出用マーク1eの大円及び、小円tの重心位
置の画面上での座標値を各々(x4,y4),(x5,
y5)とする。また、前記傾き検出用マーク1eの大円
と小円tの各重心とを結ぶ直線つまりX軸と画面座標x
軸とのなす角度をθとする。ここで、前記傾き検出用マ
ーク1eの大円と小円tの各重心間の距離Lは基準部材
1の構成上予め決っているので、前記傾きθが下式のよ
うに求められることになる。
θ=sin−1(|x4−x5|/L)Here, station S of mobile vehicle A
A method for determining the deviation angle θ with respect to the longitudinal direction of the vehicle will be explained with reference to FIG. In each imaging field of view SL, SR,
The coordinate values on the screen of the centroid positions of the large circle and small circle t of the inclination detection mark 1e are (x4, y4), (x5,
y5). In addition, a straight line connecting each center of gravity of the large circle and small circle t of the tilt detection mark 1e, that is, the X axis, and the screen coordinate x
Let θ be the angle formed with the axis. Here, since the distance L between the centers of gravity of the large circle and small circle t of the inclination detection mark 1e is predetermined due to the configuration of the reference member 1, the inclination θ can be obtained as shown in the following formula. . θ=sin-1(|x4-x5|/L)
【0032】一
方、基準部材1の車体前後方向に対応するX軸は、ステ
ーションSTの車体前後方向に対応するレイアウト座標
軸X” 軸に平行になるように取りつけられており、画
面座標軸の車体前後方向に対応するx軸は、車体A上に
固定された座標軸の車体前後方向に対応するX’ 軸と
平行になるように構成されているので、結局、ステーシ
ョンSTに対する車体Aのずれ角がθで与えられること
になる。On the other hand, the X-axis of the reference member 1 corresponding to the longitudinal direction of the vehicle body is attached so as to be parallel to the layout coordinate axis X" axis of the station ST corresponding to the longitudinal direction of the vehicle body, and the Since the x-axis corresponding to the station ST is configured to be parallel to the X' axis corresponding to the longitudinal direction of the vehicle body, which is a coordinate axis fixed on the vehicle body A, the deviation angle of the vehicle body A with respect to the station ST is θ. It will be given to you.
【0033】又、前記のように、読み取り用設定位置に
イメージセンサSaが予じめ決められた作動量分移動さ
せられていることから、撮像画面の中心位置Gと前記移
動車Aの中心ACの距離関係が決まり、これに前記検出
済の基準部材1の中央点O’と撮像画面の中心位置Gと
の距離量(x0,y0)を補正量として加算してやるこ
とで、最終的にレイアウト座標軸での基準停止位置LC
と、移動車Aの中心位置ACとの距離に相当するずれ量
Xα,Yαを求める事ができるのである。Furthermore, as described above, since the image sensor Sa is moved by a predetermined amount of operation to the reading setting position, the center position G of the image pickup screen and the center AC of the moving vehicle A are The distance relationship is determined, and by adding the distance (x0, y0) between the detected center point O' of the reference member 1 and the center position G of the imaging screen as a correction amount, the layout coordinate axes are finally determined. Reference stopping position LC at
Then, the deviation amounts Xα and Yα corresponding to the distance from the center position AC of the moving vehicle A can be obtained.
【0034】この後は、前記ずれ量Xα,Yαの値と前
記傾きθの値とに基づいて、予め設定記憶された各関節
の作動量を補正することにより、前記移動車Aの停止時
における姿勢が前記ステーションSTに対する設定適正
停止状態からずれても、前記マニプレータ16の荷把持
具17が、基準部材1に対して既値の位置にある荷Nを
適正通りに把持できるようにしているのである。Thereafter, based on the values of the deviation amounts Xα and Yα and the value of the inclination θ, the amount of movement of each joint that is set and stored in advance is corrected, so that when the mobile vehicle A is stopped, Even if the posture deviates from the properly set stop state with respect to the station ST, the load gripping tool 17 of the manipulator 16 is configured to properly grip the load N at the predetermined position with respect to the reference member 1. be.
【0035】又、前記マークa〜pを撮像している前記
撮像視野SL において、前記アドレスマークe〜l及
び前記パリティーマークm〜pを、それらの大きさと予
め設定記憶されている前記基準位置マークa〜dに対す
る位置関係とから、前記アドレスマークe〜l及び前記
パリティーマークm〜pの有無を判別し、且つ、そのマ
ークの有無の組み合せに基づいて、前記移動車Aが現在
停止しているステーションSTのアドレスを判別させる
ことになる。Further, in the imaging field SL in which the marks a to p are imaged, the address marks e to l and the parity marks m to p are arranged according to their sizes and the reference position marks that have been set and stored in advance. Based on the positional relationships with respect to a to d, the presence or absence of the address marks e to l and the parity marks m to p is determined, and based on the combination of the presence or absence of the marks, the moving vehicle A is currently stopped. The address of station ST will be determined.
【0036】そして、荷移載作業が終了するに伴って、
予め記憶された、又は、前記通信装置9a,9bを介し
て前記中央制御装置8から指示される次のステーション
STまでの走行経路の情報と、前記基準停止位置LCに
対する移動車Aの中心ACのずれ量Xα,Yα及び前記
傾きθの情報に基づいて、次のステーションSTに走行
するための走行方向を修正して自動走行を開始させるこ
とになる。[0036] Then, as the cargo transfer work is completed,
Information on the travel route to the next station ST stored in advance or instructed by the central control device 8 via the communication devices 9a, 9b, and the center AC of the moving vehicle A with respect to the reference stop position LC. Based on the information on the deviation amounts Xα, Yα and the inclination θ, the traveling direction for traveling to the next station ST is corrected and automatic traveling is started.
【0037】〔別実施例〕上記実施例では、二次元平面
状の発光面2cが形成された発光体として、エレクトロ
ルミネッセンス材料から成る層状の発光部2bで構成さ
れるものを示したが、これ以外に、プラズマ放電管等の
二次元平面状の発光面を有する他のものが使用可能であ
る。[Another Embodiment] In the above embodiment, a light emitting body formed with a two-dimensional planar light emitting surface 2c is composed of a layered light emitting portion 2b made of an electroluminescent material. In addition, other devices having a two-dimensional planar light emitting surface, such as a plasma discharge tube, can be used.
【0038】又、前記遮光体3の発光体2に対向する面
を光反射面に構成するのに、その面に銀色の光反射シー
ト3aを張りつける上記実施例以外に、前記遮光体3の
発光体2に対向する面に光反射の高い金属等の蒸着層を
形成するものでも良い。In addition to the above embodiment in which the surface of the light shielding body 3 facing the light emitting body 2 is configured as a light reflecting surface, a silver light reflecting sheet 3a is pasted on that surface. A vapor-deposited layer of metal or the like having high light reflection may be formed on the surface facing the body 2.
【0039】又、上記実施例の基準部材1では、2次元
的に配置された円状のマーク群を光が通過する開口部4
に構成していたが、これとは逆に、前記円状のマーク群
以外の部分を光が通過する開口部4に構成することも可
能である。Further, in the reference member 1 of the above embodiment, there is an opening 4 through which light passes through a group of circular marks arranged two-dimensionally.
However, on the contrary, it is also possible to configure a portion other than the circular mark group to be an opening 4 through which light passes.
【0040】又、上記実施例では、移動車Aを自律走行
させるように構成した場合を例示したが、例えば、光反
射テープや磁気を帯びた誘導帯を利用した走行用ガイド
を用いて自動走行させるように構成してもよく、本発明
を実施する上で必要となる各部の具体構成は各種変更で
きる。[0040]Also, in the above embodiment, the mobile vehicle A is configured to run autonomously. The specific configuration of each part required to carry out the present invention may be modified in various ways.
【0041】尚、特許請求の範囲の項に図面との対照を
便利にするために符号を記すが、該記入により本発明は
添付図面の構成に限定されるものではない。[0041] Although reference numerals are written in the claims for convenience of comparison with the drawings, the present invention is not limited to the structure shown in the accompanying drawings.
【図1】基準部材の断面構造図[Figure 1] Cross-sectional structural diagram of the reference member
【図2】基準部材の平面図[Figure 2] Plan view of reference member
【図3】移動車がステーションで停止している状態の平
面図[Figure 3] Plan view of the moving vehicle stopped at the station
【図4】同正面図[Figure 4] Front view of the same
【図5】制御構成のブロック図[Figure 5] Block diagram of control configuration
【図6】位置ずれ検出の説明図[Figure 6] Explanatory diagram of positional deviation detection
【図7】角度ずれ検出の説明図[Figure 7] Explanatory diagram of angular shift detection
【図8】角度ずれ検出の説明図[Figure 8] Explanatory diagram of angular shift detection
1 基準部材 2 発光体 2c 発光面 3 遮光体 4 開口部 A 移動車 ST ステーション 1 Standard member 2. Luminous body 2c Light emitting surface 3. Light shielding body 4 Opening A Moving vehicle ST station
Claims (2)
ョン(ST)に、平面視での基準位置情報を表示するた
めの発光式の基準部材(1)が設けられた停止位置検出
用表示装置であって、前記基準部材(1)が、発光面(
2c)が二次元平面状に形成された発光体(2)と、そ
の発光体(2)の前記発光面(2c)側に配置され且つ
、光通過用の開口部(4)が形成された遮光体(3)と
から構成されている停止位置検出用表示装置。1. A display device for detecting a stop position, which is provided with a light-emitting reference member (1) for displaying reference position information in plan view at a station (ST) where a moving vehicle (A) automatically travels. The reference member (1) has a light emitting surface (
2c) has a light emitting body (2) formed in a two-dimensional planar shape, and is arranged on the light emitting surface (2c) side of the light emitting body (2), and an opening (4) for light passage is formed. A stop position detection display device comprising a light shielding body (3).
置であって、前記遮光体(3)の前記発光体(2)に対
向する面を光反射面に構成した停止位置検出用表示装置
。2. The display device for detecting a stop position according to claim 1, wherein a surface of the light shielding body (3) facing the light emitting body (2) is configured as a light reflecting surface. .
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3078777A JPH04312105A (en) | 1991-04-11 | 1991-04-11 | Stop position detecting display device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3078777A JPH04312105A (en) | 1991-04-11 | 1991-04-11 | Stop position detecting display device |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPH04312105A true JPH04312105A (en) | 1992-11-04 |
Family
ID=13671331
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP3078777A Pending JPH04312105A (en) | 1991-04-11 | 1991-04-11 | Stop position detecting display device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPH04312105A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH09160641A (en) * | 1995-12-08 | 1997-06-20 | Shinko Electric Co Ltd | Stopping posture correction device for moving objects |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01217289A (en) * | 1988-02-26 | 1989-08-30 | Citizen Watch Co Ltd | Constellation disc and preparation thereof |
| JPH02260010A (en) * | 1989-03-31 | 1990-10-22 | Daifuku Co Ltd | Stop position detector for mobile vehicle |
-
1991
- 1991-04-11 JP JP3078777A patent/JPH04312105A/en active Pending
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01217289A (en) * | 1988-02-26 | 1989-08-30 | Citizen Watch Co Ltd | Constellation disc and preparation thereof |
| JPH02260010A (en) * | 1989-03-31 | 1990-10-22 | Daifuku Co Ltd | Stop position detector for mobile vehicle |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH09160641A (en) * | 1995-12-08 | 1997-06-20 | Shinko Electric Co Ltd | Stopping posture correction device for moving objects |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR102105580B1 (en) | Board conveying device and teaching method of board conveying robot | |
| CN216917266U (en) | Tray deviation correcting device and storage system with same | |
| JP2010162635A (en) | Method for correcting position and attitude of self-advancing robot | |
| JP2016216936A (en) | Vehicle transport device | |
| CN109189076A (en) | A kind of heavy guiding vehicle localization method and heavy guiding vehicle of view-based access control model sensor | |
| CN113977558B (en) | Device and method for visually and dynamically displaying tail end track of parallel robot | |
| JPH04312105A (en) | Stop position detecting display device | |
| JPS60258613A (en) | Drive control equipment of truck | |
| US20140144376A1 (en) | Mobile apparatus with local position referencing elements | |
| JP2660744B2 (en) | Mobile vehicle stop position detection device | |
| JP2727376B2 (en) | Mobile vehicle stop position detection device | |
| JP7682444B2 (en) | Traveling vehicle system and method for detecting deviation of marker | |
| JPH02235116A (en) | Operation control installation for working vehicle | |
| JPH10128689A (en) | Vision correction device for unmanned moving objects | |
| JP2727375B2 (en) | Mobile vehicle stop position detection device | |
| JP2741284B2 (en) | Stop position detecting display device and stop position detecting device | |
| JPH02257313A (en) | Drive control facility for moving vehicle | |
| JPH03219309A (en) | Device for instructing control information for moving vehicle | |
| JPH04287206A (en) | Display device for detecting stopping position | |
| JPH04293108A (en) | Running controller of moving car | |
| JPH11312726A (en) | Substrate carrying device | |
| JPH04241605A (en) | Device for detecting deviated amount of moving vehicle | |
| JPH079370A (en) | Stop position detection display device and stop position detection device | |
| JP2660534B2 (en) | Guidance traveling control device for moving objects | |
| US20260029792A1 (en) | Autonomous mobile robot and system for controlling autonomous mobile robot |