JP5935745B2 - Position / orientation discrimination system for article transport vehicles - Google Patents

Position / orientation discrimination system for article transport vehicles Download PDF

Info

Publication number
JP5935745B2
JP5935745B2 JP2013080585A JP2013080585A JP5935745B2 JP 5935745 B2 JP5935745 B2 JP 5935745B2 JP 2013080585 A JP2013080585 A JP 2013080585A JP 2013080585 A JP2013080585 A JP 2013080585A JP 5935745 B2 JP5935745 B2 JP 5935745B2
Authority
JP
Japan
Prior art keywords
detection
transport vehicle
article
article transport
posture
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.)
Active
Application number
JP2013080585A
Other languages
Japanese (ja)
Other versions
JP2014203354A (en
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.)
Daifuku Co Ltd
Original Assignee
Daifuku 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 Daifuku Co Ltd filed Critical Daifuku Co Ltd
Priority to JP2013080585A priority Critical patent/JP5935745B2/en
Publication of JP2014203354A publication Critical patent/JP2014203354A/en
Application granted granted Critical
Publication of JP5935745B2 publication Critical patent/JP5935745B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本発明は、無軌道の走行経路に沿って走行して、前記走行経路の側脇に配置されたステーションとの間で搬送対象の物品を移載する物品搬送車と、前記物品搬送車の走行作動及び前記物品搬送車の平面視姿勢を制御する制御部と、を備え、前記物品搬送車が前記ステーションに対して前記物品を移載する移載用位置に停止した状態、又は、前記物品搬送車が前記移載用位置に近接する位置で走行している状態において、前記ステーションに対する物品の移載方向と直交し水平方向に沿う基準方向に対する前記物品搬送車の平面視での姿勢及び前記ステーションに対する前記物品搬送車の前後方向の位置を検出する検出装置が設けられた物品搬送車の位置姿勢判別システムに関する。   The present invention relates to an article transport vehicle that travels along a trackless travel route and transfers an article to be transported to and from a station disposed on the side of the travel route, and a travel operation of the article transport vehicle. And a control unit for controlling the posture of the article transport vehicle in plan view, wherein the article transport vehicle is stopped at the transfer position for transferring the article to the station, or the article transport vehicle. In a state where the vehicle is traveling at a position close to the transfer position, the posture of the article transport vehicle in a plan view with respect to a reference direction perpendicular to the transfer direction of the article with respect to the station and along the horizontal direction, and with respect to the station The present invention relates to a position / posture determination system for an article transport vehicle provided with a detection device for detecting a position in the front-rear direction of the article transport vehicle.

このような位置姿勢判別システムにおける検出装置として、従来、図10及び図11に示すように、物品搬送車が移載用位置に位置するときにステーションと対向する物品搬送車の側面に、移載方向に沿う方向での距離を検出自在な3つの距離センサ201a、202、201bを物品搬送車の前後方向に沿って離間して並べて設け、ステーションにおける移載用位置側を向く側面に、物品搬送車が備える上記3つの距離センサにて検出される被検出部分61a、62、61bを上記基準方向に沿って並べて備える被検出体60を設けたものがあった(例えば、特許文献1参照)。 As a detection device in such a position and orientation discrimination system, as shown in FIGS. 10 and 11 , conventionally, transfer is performed on the side of the article transport vehicle that faces the station when the article transport vehicle is located at the transfer position. The three distance sensors 201a, 202, 201b that can detect the distance in the direction along the direction are arranged side by side along the front-rear direction of the article transport vehicle, and the article is transported on the side facing the transfer position side in the station. There has been provided a detected body 60 that includes detected portions 61a, 62, and 61b that are detected by the three distance sensors included in the vehicle along the reference direction (see, for example, Patent Document 1).

特許文献1では、被検出部分61a、61b及び62が、上下方向に沿う平面状の被検出面を備えている。また、被検出部分61aの被検出面と被検出部分61bの被検出面とは同じ平面上に位置しており、かつ、平面視において、被検出面が上記基準方向に沿う方向となるように形成されている。さらに、被検出部分62の被検出面は、平面視において上記基準方向に対して設定角度傾斜するように形成されている。   In Patent Document 1, the detected portions 61a, 61b, and 62 are provided with a flat detected surface along the vertical direction. Further, the detected surface of the detected portion 61a and the detected surface of the detected portion 61b are located on the same plane, and the detected surface is in a direction along the reference direction in plan view. Is formed. Further, the detection surface of the detection portion 62 is formed so as to be inclined at a set angle with respect to the reference direction in plan view.

そして、物品搬送車の前後方向に沿って離間して並ぶ3つの距離センサ201a、202、201bのうち、距離センサ201aが被検出部分61aの被検出面との距離を検出し、距離センサ201bが被検出部分61bの被検出面との距離を検出し、制御部が、距離センサ201aが検出する距離と距離センサ201bが検出する距離とに基づいて、物品搬送車のステーションの基準方向に対する物品搬送車の平面視での姿勢を判別するようになっている。すなわち、距離センサ201aが検出する距離と距離センサ201bが検出する距離とが等しい場合には、物品搬送車の基準方向に対する姿勢は傾斜していないと判別し、距離センサ201aが検出する距離と距離センサ201bが検出する距離とが異なっている場合には、物品搬送車の基準方向に対する姿勢は両センサの検出距離の差に対応する角度だけ傾斜していると判別する。   Of the three distance sensors 201a, 202, and 201b that are separated from each other along the front-rear direction of the article transport vehicle, the distance sensor 201a detects the distance from the detected surface of the detected portion 61a, and the distance sensor 201b The distance between the detected portion 61b and the surface to be detected is detected, and the controller conveys the article with respect to the reference direction of the station of the article conveying vehicle based on the distance detected by the distance sensor 201a and the distance detected by the distance sensor 201b. The posture of the car in plan view is discriminated. That is, when the distance detected by the distance sensor 201a is equal to the distance detected by the distance sensor 201b, it is determined that the posture of the article transport vehicle with respect to the reference direction is not inclined, and the distance and the distance detected by the distance sensor 201a are detected. When the distance detected by the sensor 201b is different, it is determined that the posture of the article transport vehicle with respect to the reference direction is inclined by an angle corresponding to the difference between the detection distances of both sensors.

制御部は、上記のように物品搬送車の姿勢を判別したのち、距離センサ202と被検出部分62の被検出面との距離とに基づいて、ステーションに対する物品搬送車の前後方向の位置を検出する。説明を加えると、被検出部分62の被検出面は、平面視で上記基準方向に対して設定角度傾斜しているため、距離センサ202が検出する距離はステーションに対する物品搬送車の前後方向(図11における左右方向)の位置に応じて変化することになる。このため、制御部は、距離センサ202が検出する距離によってステーションに対する物品搬送車の前後方向の位置を判別することができる。
自律走行システムや遠隔操作システムでは、物品搬送車を移載用位置へ向かって走行させるように制御する。物品搬送車を走行状態から移載用位置に停止させるための制御は、走行用の位置計測システムによって計測された位置に基づいて行われることになるが、走行用の位置計測システムの位置計測精度は一般に高くはないため、移載用位置に対する物品搬送車の前後方向での位置のずれや、基準方向に対する物品搬送車の平面視での傾きが問題となる。特許文献1の位置姿勢判別システムは、これら移載用位置に対する物品搬送車の前後方向での位置のずれや、基準方向に対する物品搬送車の平面視での傾きを精度よく計測するために用いられる。
After determining the posture of the article transport vehicle as described above, the control unit detects the position of the article transport vehicle in the front-rear direction with respect to the station based on the distance between the distance sensor 202 and the detected surface of the detected portion 62. To do. In other words, since the detection surface of the detection portion 62 is inclined at a set angle with respect to the reference direction in plan view, the distance detected by the distance sensor 202 is the front-rear direction (see FIG. 11 in the left-right direction). For this reason, the control part can discriminate | determine the position of the front-back direction of the article conveyance vehicle with respect to a station with the distance which the distance sensor 202 detects.
In the autonomous traveling system and the remote operation system, control is performed so that the article transport vehicle travels toward the transfer position. Although the control for stopping the article transport vehicle from the traveling state to the transfer position is performed based on the position measured by the traveling position measurement system, the position measurement accuracy of the traveling position measurement system is determined. In general, since the height is not high, there is a problem in the positional deviation of the article transport vehicle in the front-rear direction with respect to the transfer position and the inclination of the article transport vehicle in plan view with respect to the reference direction. The position / orientation determination system of Patent Document 1 is used to accurately measure the positional deviation of the article transport vehicle in the front-rear direction with respect to the transfer position and the inclination of the article transport vehicle in plan view with respect to the reference direction. .

特開2000−194418号公報JP 2000-194418 A

しかしながら、上記特許文献1の位置姿勢判別システムにおける検出装置は、ステーションに対する移載用位置に物品搬送車を停止させ又は移載用位置の近傍で低速走行させ、当該検出装置にてステーションに対する物品搬送車の平面視での姿勢及びステーションに対する物品搬送車の走行前後方向の位置を検出するためのものであり、検出結果に基づいて停止位置を修正したり物品搬送車が備える移載装置の移載作動に反映したりされる。その為、検出装置によってステーションに対する物品搬送車の平面視での姿勢及びステーションに対する物品搬送車の前後方向の位置を検出する当初より、移載用位置に精度よく接近しているとは限らない。このため、物品搬送車が移載用位置からずれていても、距離センサ201a、202、201bの夫々が被検出部分61a、62、61bの夫々を検出可能とすべく、被検出部分61a、62、61bの基準方向に沿う寸法を設定する必要があった。そして、被検出部分61a、62、61bは基準方向に沿って並べて備えられるものであるから、被検出体60の基準方向での寸法が大きいものとなっていた。   However, the detection device in the position and orientation determination system of Patent Document 1 stops the article transport vehicle at the transfer position with respect to the station or runs at a low speed in the vicinity of the transfer position, and the detection apparatus transfers the article to the station. It is for detecting the posture of the vehicle in plan view and the position of the article transport vehicle in the front-rear direction relative to the station. The stop position is corrected based on the detection result, or the transfer device provided in the article transport vehicle is transferred. Or reflected in operation. Therefore, the detection device does not always approach the transfer position with high accuracy from the beginning of detecting the posture of the article transport vehicle in plan view with respect to the station and the position of the article transport vehicle in the front-rear direction with respect to the station. For this reason, even if the article transport vehicle is deviated from the transfer position, the detected parts 61a, 62 are designed so that the distance sensors 201a, 202, 201b can detect the detected parts 61a, 62, 61b, respectively. , 61b needs to be set along the reference direction. And since the to-be-detected parts 61a, 62, 61b are arranged side by side along the reference direction, the dimension of the to-be-detected body 60 in the reference direction is large.

本発明は、上記実情に鑑みてなされたものであって、その目的は、ステーションに対する物品搬送車の平面視での姿勢及びステーションに対する物品搬送車の前後方向の位置を検出する検出装置における被検出体の基準方向での寸法を小型化することが可能な位置姿勢判別システムを提供することにある。   The present invention has been made in view of the above circumstances, and the object thereof is to be detected in a detection device that detects the posture of the article transport vehicle in plan view with respect to the station and the position of the article transport vehicle in the front-rear direction with respect to the station. An object of the present invention is to provide a position and orientation determination system capable of reducing the size of the body in the reference direction.

本発明に係る物品搬送車の位置姿勢判別システムの第1特徴構成は、無軌道の走行経路に沿って走行して、前記走行経路の側脇に配置されたステーションとの間で搬送対象の物品を移載する物品搬送車と、前記物品搬送車の走行作動及び前記物品搬送車の平面視姿勢を制御する制御部と、を備え、前記物品搬送車が前記ステーションに対して前記物品を移載する移載用位置に停止した状態、又は、前記物品搬送車が前記移載用位置に近接する位置で走行している状態において、前記ステーションに対する物品の移載方向と直交し水平方向に沿う基準方向に対する前記物品搬送車の平面視での姿勢及び前記ステーションに対する前記物品搬送車の前後方向の位置を検出する検出装置が設けられた物品搬送車の位置姿勢判別システムであって、
前記検出装置が、前記ステーションに固定された被検出体と、検出方向が前記物品搬送車の横幅方向に沿うように前記物品搬送車に固定され、少なくとも前記物品搬送車の前後方向で所定の検出範囲を有し、前記被検出体が備える上下方向に沿う被検出面の面形状を検出する検出部とを備え、前記検出部が、前記被検出面の前記移載方向での形状を検出自在な形状センサにて構成され、前記被検出面は、前記物品搬送車の前記姿勢を検出するための姿勢検出用領域と、前記物品搬送車の前後方向の位置を検出するための前後位置検出用領域と、を備え、かつ、前記物品搬送車の前後方向で、前記姿勢検出用領域が前記前後位置検出用領域を含んでおり、前記被検出面は、さらに、前記ステーションに対する前記物品搬送車の前後方向の位置が異なっても前記検出部の前記検出範囲に相当する被検出範囲に前記姿勢検出用領域の一部である姿勢検出用部分と前記前後位置検出用領域の一部である前後位置検出用部分とが含まれるように、かつ、前記ステーションに対する前記物品搬送車の前後方向の位置に対応して前記被検出範囲における面形状が異なるように形成され、前記制御部は、前記検出部による前記複数の姿勢検出用部分についての検出情報に基づいて前記物品搬送車の前記姿勢を判別し、前記ステーションに対する前記物品搬送車の前後方向の位置と前記被検出面の前記被検出範囲における面形状との対応関係に基づいて前記物品搬送車の前後方向の位置を判別し、前記姿勢検出用領域及び前記前後位置検出用領域の夫々が、前記基準方向に沿い且つ前記移載方向で異なった位置に位置する面上に設定され、前記姿勢検出用領域が、前記基準方向に沿って複数の前記姿勢検出用部分に分散され、かつ、前記前後位置検出用領域が、前記基準方向に沿って複数の前記前後位置検出用部分に分散され、前記被検出面は、前記姿勢検出用部分と前記前後位置検出用部分とを前記基準方向に交互に並べて形成され、前記制御部が、前記形状センサが検出した前記被検出面の前記基準方向での凹凸形状に基づいて、前記姿勢検出用部分に対応する検出点での前記移載方向での距離と前記前後位置検出用部分に対応する検出点での前記移載方向での距離とを検出するように構成されている点にある。
A first characteristic configuration of a position and orientation determination system for an article transport vehicle according to the present invention is to travel along a trackless travel route, and to transfer an article to be transported with a station arranged on the side of the travel route. An article transfer vehicle to be transferred; and a control unit that controls a travel operation of the article transfer vehicle and a plan view posture of the article transfer vehicle, and the article transfer vehicle transfers the article to the station. A reference direction perpendicular to the transfer direction of the article with respect to the station and along the horizontal direction in a state where the transfer is stopped at the transfer position or the article transport vehicle is running at a position close to the transfer position. A position / posture discrimination system for an article transport vehicle provided with a detection device for detecting a posture of the article transport vehicle in plan view relative to the station and a position of the article transport vehicle in the front-rear direction with respect to the station,
The detection apparatus is fixed to the article carrier so that the detection object is fixed to the station, and the detection direction is along the width direction of the article carrier, and at least predetermined detection is performed in the front-rear direction of the article carrier. And a detection unit that detects a surface shape of the detection surface along the vertical direction of the detection target, and the detection unit is capable of detecting the shape of the detection surface in the transfer direction. The detected surface includes a posture detection region for detecting the posture of the article transport vehicle and a front / rear position detection for detecting a position in the front / rear direction of the article transport vehicle. The posture detection region includes the front / rear position detection region in the front-rear direction of the article transport vehicle, and the detected surface further includes the region of the article transport vehicle with respect to the station. The position in the front-rear direction is Even in this case, the detected range corresponding to the detection range of the detection unit includes a posture detection portion that is a part of the posture detection region and a front and rear position detection portion that is a part of the front and rear position detection region. to include, and the surface shape is formed differently in the object detection range corresponding to the longitudinal position of the article transport vehicle to said station, before Symbol controller, the plurality of by the detection unit The posture of the article transport vehicle is determined based on detection information about the position detection portion, and the correspondence between the position of the article transport vehicle in the front-rear direction with respect to the station and the surface shape of the detected surface in the detected range. to determine the longitudinal position of the article transport vehicle on the basis of the relation, each of the posture detection region and the front and rear position detecting area, different in and the transfer direction along the reference direction The posture detection region is distributed to the plurality of posture detection portions along the reference direction, and the front-rear position detection region is along the reference direction. Distributed in a plurality of the front and rear position detection parts, and the detected surface is formed by alternately arranging the posture detection parts and the front and rear position detection parts in the reference direction, and the control unit has the shape Based on the uneven shape in the reference direction of the detected surface detected by the sensor, the distance in the transfer direction at the detection point corresponding to the posture detection portion and the detection corresponding to the front and rear position detection portion It is in the point comprised so that the distance in the said transfer direction in a point may be detected .

すなわち、検出部は、複数の姿勢検出用領域までの距離情報に基づいて物品搬送車の平面視姿勢を判別し、ステーションに対する物品搬送車の前後方向の位置と前後位置検出用領域の被検出範囲における面形状との対応関係に基づいてステーションに対する物品搬送車の前後方向の位置を判別することができる。
そして、被検出面は、ステーションに対する物品搬送車の前後方向の位置が異なっても、検出部の検出範囲に相当する被検出面の被検出範囲に、姿勢検出用領域の一部である複数の姿勢検出用部分と前後位置検出用領域の一部である前後位置検出用部分とが含まれるように構成されているから、検出部は、検出範囲における被検出面の面形状を検出することで、物品搬送車の平面視姿勢を判別するために必要な検出情報及び物品搬送車の前後方向での位置を判別するために必要な検出情報の双方を得ることができる。このため、被検出体は、物品搬送車の平面視姿勢を判別するために必要な複数の姿勢検出用領域と、物品搬送車の前後方向での位置を判別するために必要な前後位置検出用領域とを、基準方向に並べて備える必要がない。
したがって、ステーションに対す物品搬送車の平面視での姿勢及びステーションに対する物品搬送車の前後方向の位置を検出する検出装置における被検出体の基準方向での寸法を小型化することが可能な位置姿勢判別システムを提供できる。
That is, the detection unit determines a planar view posture of the article transport vehicle based on distance information to a plurality of posture detection areas, and a position in the front-rear direction of the article transport vehicle with respect to the station and a detection range of the front-rear position detection area The position of the article transport vehicle in the front-rear direction with respect to the station can be determined based on the correspondence relationship with the surface shape.
And even if the position in the front-rear direction of the article transport vehicle with respect to the station is different, the detected surface is a part of the posture detection region within the detected range of the detected surface corresponding to the detection range of the detection unit. Since the posture detection part and the front / rear position detection part that is a part of the front / rear position detection region are included, the detection unit detects the surface shape of the detection surface in the detection range. It is possible to obtain both detection information necessary for determining the planar view posture of the article transport vehicle and detection information necessary for determining the position of the article transport vehicle in the front-rear direction. Therefore, the object to be detected is for detecting a plurality of posture detection areas necessary for determining the planar view posture of the article transport vehicle and for detecting the front-rear position necessary for determining the position of the article transport vehicle in the front-rear direction. It is not necessary to arrange the areas side by side in the reference direction.
Thus, the dimensions possible position to reduce the size of the in the reference direction of the detection object in the attitude and detection device for detecting the longitudinal position of the article transport vehicle for stations in a plan view of the article transport vehicle against the station An attitude discrimination system can be provided.

また、姿勢検出用部分と前後位置検出用部分とが、基準方向に交互に並ぶ状態で配置されるから、検出部は、検出範囲における被検出面の面形状を検出することで姿勢検出用部分までの距離と前後位置検出用部分までの距離との双方を検出することができ、それら姿勢検出用部分までの距離と前後位置検出用部分までの距離とに基づいて、物品搬送車の平面視での姿勢及びステーションに対する前記物品搬送車の前後方向の位置の双方を判別することができる。
そして、このような被検出体を形成するには、例えば、上下方向及び基準方向に沿う基準面を有する平板状体に、複数の前後位置検出用部分に相当する凹入溝又は突起部を基準方向に離間する状態で備えさせることが考えられる。つまり、基準面に対して基準方向に離間する状態で設けられた凹入溝又は突起部が存在しない部分が姿勢検出用部分となるため、被検出体を簡易に形成することができるものとなる。
このように、本特徴構成によれば、基準方向での寸法を小型化することが可能で、かつ、簡易に形成可能な被検出体を備えた位置姿勢判別システムを提供できる。
In addition , since the posture detection portion and the front / rear position detection portion are arranged alternately in the reference direction, the detection portion detects the surface shape of the detected surface in the detection range, thereby detecting the posture detection portion. And the distance to the front-rear position detection part, and the plan view of the article transport vehicle based on the distance to the posture detection part and the distance to the front-rear position detection part. It is possible to discriminate both the posture at the front and the position in the front-rear direction of the article transport vehicle with respect to the station.
In order to form such an object to be detected, for example, a flat plate having a reference surface along the vertical direction and the reference direction is provided with reference to recessed grooves or protrusions corresponding to a plurality of front and rear position detecting portions. It is conceivable to prepare them in a state of being separated in the direction. In other words, since the portion where there is no recessed groove or protrusion provided in a state of being separated in the reference direction with respect to the reference surface is the posture detection portion, the detection target can be easily formed. .
Thus, according to this characteristic configuration, it is possible to provide a position / orientation determination system including a detected body that can be reduced in size in the reference direction and can be easily formed.

さらに、検出部が被検出面の物品搬送車との移載方向の形状を検出自在な形状センサにて構成されているから、被検出面の基準方向での凹凸形状を検出することができる。制御部は、検出した凹凸形状に基づいて、凹凸形状において姿勢検出用部分に対応する検出点と凹凸形状において前後位置検出用部分に対応する検出点とを抽出し、抽出した検出点までの距離に基づいて、ステーションに対す物品搬送車の平面視での姿勢及びステーションに対する物品搬送車の前後方向の位置を検出することができる。
例えば、検出部に姿勢検出用部分を検出する部分と前後位置検出用部分を検出する部分とを各別に備える場合には、姿勢検出用部分及び前後位置検出用部分を適正に検出するために、姿勢検出用部分と前後位置検出用部分との間隔と、検出部における姿勢検出用部分を検出する部分と前後位置検出用部分を検出する部分との間隔を調整するという煩雑な作業を行う必要があるが、本特徴構成によれば、このような煩雑な作業を行う必要がないものとなる。
Furthermore , since the detection unit is configured by a shape sensor that can detect the shape of the detection surface in the transfer direction with respect to the article transport vehicle, the uneven shape in the reference direction of the detection surface can be detected. Based on the detected concavo-convex shape, the control unit extracts a detection point corresponding to the position detection portion in the concavo-convex shape and a detection point corresponding to the front-rear position detection portion in the concavo-convex shape, and the distance to the extracted detection point based on, it is possible to detect the longitudinal position of the article transport vehicle for attitude and station in plan view of the article transport vehicle against the station.
For example, when the detection unit includes a part for detecting the posture detection part and a part for detecting the front-rear position detection part separately, in order to properly detect the posture detection part and the front-rear position detection part, It is necessary to perform complicated work of adjusting the interval between the posture detection portion and the front-rear position detection portion and the interval between the portion detecting the posture detection portion and the portion detecting the front-rear position detection portion in the detection unit. However, according to the present feature configuration, it is not necessary to perform such a complicated operation.

本発明に係る物品搬送車の位置姿勢判別システムの第特徴構成は、上記第1特徴構成に加えて、前記制御部が、前記検出装置の検出情報に基づいて、前記ステーションに対する前記物品搬送車の平面視姿勢が移載用の適正姿勢であり、前記ステーションに対する前記物品搬送車の前後方向の位置が移載用の適正走行位置である状態で前記物品搬送車を停止させるように構成されている点にある。 The second characteristic configuration of the position and orientation determination system of the article transport vehicle according to the present invention, in addition to the first feature structure, the control section, based on the detection information of the detecting device, the article transport relative to the station The plan view posture of the car is an appropriate posture for transfer, and the article transport vehicle is stopped in a state where the position of the article transport vehicle in the front-rear direction with respect to the station is an appropriate travel position for transfer. There is in point.

すなわち、上記第1特徴構成のような構成を適用することで、ステーションに対す物品搬送車の平面視での姿勢及びステーションに対する物品搬送車の前後方向の位置を検出する検出装置における被検出体の基準方向での寸法を小型化できながらも、物品搬送車を、ステーションに対する物品搬送車の平面視姿勢が移載用の適正姿勢であり、ステーションに対する物品搬送車の前後方向の位置が移載用の適正走行位置である状態で適切に停止させることができる。 That is, the by first applying the configuration as feature configuration, the detection in the detection device which detects the longitudinal position of the article transport vehicle for attitude and station in plan view of the article transport vehicle against the station Although the size of the body in the reference direction can be reduced, the position of the article transport vehicle in plan view with respect to the station is the proper posture for transfer, and the position of the article transport vehicle in the front-rear direction relative to the station is shifted. It can be stopped appropriately in a state where it is in the proper travel position.

実施形態の物品搬送車を示す斜視図The perspective view which shows the article conveyance vehicle of embodiment 物品搬送車の検出部とステーションの被検出体との位置関係を示す平面図The top view which shows the positional relationship of the detection part of an article conveyance vehicle, and the to-be-detected body of a station 制御部の制御ブロック図Control block diagram of control unit 被検出体の全体斜視図Overall perspective view of detected object 被検出体の凹入溝を示す上面図Top view showing the recessed groove of the object to be detected 制御部が実行する処理を表すフローチャートA flowchart showing processing executed by the control unit 物品搬送車の姿勢の判別を説明する図The figure explaining discrimination | determination of the attitude | position of an article conveyance vehicle 物品搬送車の前後方向の位置の判別を説明する図The figure explaining the discrimination of the position of the article conveyance vehicle in the front-rear direction 被検出体の凹入溝の別形態を示す上面図Top view showing another form of recessed groove in the object to be detected 従来の物品搬送設備における被検出体を示す図The figure which shows the to-be-detected body in the conventional article conveyance equipment 従来の物品搬送設備における被検出体に対する識別部の識別作用を示す図The figure which shows the identification effect | action of the identification part with respect to the to-be-detected body in the conventional article conveyance equipment

以下、本発明の位置姿勢判別システムの実施形態を説明する。本実施形態は、本発明の位置姿勢判別システムを物品搬送設備に適用した例である。
図1及び図2に示すように、物品搬送設備には、物品搬送車10が備えられており、物品搬送車10は、物品BをステーションSTと自己との間で移載する移載装置12を備えて、物品Bを複数のステーションSTの間で搬送するようになっている。物品搬送車10
は無軌道の走行経路に沿って走行するようになっており、ステーションSTは、上記走行経路の側脇に複数配設されている。
Hereinafter, embodiments of the position and orientation determination system of the present invention will be described. This embodiment is an example in which the position and orientation determination system of the present invention is applied to an article transport facility.
As shown in FIGS. 1 and 2, the article transport facility includes an article transport vehicle 10, and the article transport vehicle 10 transfers the article B between the station ST and itself. The article B is conveyed between the plurality of stations ST. Goods carrier 10
The vehicle travels along a trackless travel route, and a plurality of stations ST are arranged on the side of the travel route.

物品搬送車10の台車本体11は平面視矩形状に形成され、長手方向を前後方向として、この前後方向の両端部に離間して駆動車輪(図示省略)が設けられている。駆動車輪は、平面視における台車本体11の短手方向中央かつ平面視における長手方向両端に離間して一対設けられている。また、平面視における台車本体11の前後方向中央部でかつ平面視における短手方向両端に離間して、従動車輪(図示省略)が一対設けられている。 The cart body 11 of the article transporting vehicle 10 is formed in a rectangular shape in plan view, and driving wheels (not shown) are provided apart from both ends in the front-rear direction with the longitudinal direction as the front-rear direction. A pair of drive wheels are provided spaced apart at the center in the lateral direction of the carriage body 11 in plan view and at both ends in the longitudinal direction in plan view. In addition, a pair of driven wheels (not shown) are provided at a central portion in the front-rear direction of the carriage main body 11 in a plan view and at both ends in a short direction in the plan view.

移載装置12は、平面視で物品搬送車10の前後方向と直交する横幅方向に沿って出退移動自在な出退作動部12aと、その出退作動部12aを上下方向に沿って昇降移動自在な昇降作動部12bとを備えている。出退作動部12aには、物品Bとしてのロール状物品の空芯に貫入された支持用棒状体Rの両端部を載置支持する一対の支持体13が車体前後方向に離間して立設されている。一対の支持体13の上端には、載置部13sが備えられ、物品Bを一対の支持体13にて支持する場合には、一対の支持体13夫々の載置部13sに支持用棒状体Rの両端が支持され、ロール状の物品Bが一対の支持体13の間に位置する状態となる。   The transfer device 12 includes a retracting / moving part 12a that can be moved back and forth along a lateral direction perpendicular to the front-rear direction of the article transport vehicle 10 in a plan view, and the lifting / lowering operation part 12a is moved up and down along the vertical direction. And a freely raising / lowering operation part 12b. A pair of support bodies 13 that place and support both ends of the support rod R inserted into the air core of the roll-shaped article as the article B are vertically spaced apart from each other in the longitudinal direction of the vehicle body. Has been. At the upper ends of the pair of support bodies 13, a placement portion 13 s is provided. When the article B is supported by the pair of support bodies 13, a support rod-like body is provided on each placement portion 13 s of the pair of support bodies 13. Both ends of R are supported, and the roll-shaped article B is positioned between the pair of supports 13.

図3に示すように、物品搬送車10には、当該物品搬送車10の走行を制御する制御部Hが設けられている。
制御部Hには、前後一対の駆動車輪の夫々の走行方向を変更する操向アクチュエータ15aと、駆動車輪を走行駆動する走行モータ15mとが電気的に接続されている。また、制御部Hには、移載装置12の出退作動部12aを出退作動させる駆動部と、昇降作動部12bを昇降作動させる駆動部とが電気的に接続され、その作動を制御されるようになっている。さらに、制御部Hには、後述する被検出体の被検出面の移載方向の形状を検出自在な二次元形状センサ20が接続され、二次元形状センサ20の検出情報を読み込むことが可能となっている。
なお、制御部Hには、上記二次元形状センサ20の検出情報に基づいて物品搬送車10の平面視での姿勢を判別する姿勢判別部H1と、上記二次元形状センサ20の検出情報に基づいてステーションSTに対する物品搬送車10の前後方向の位置を判別する位置判別部H2とを備えている。
As shown in FIG. 3, the article transport vehicle 10 is provided with a control unit H that controls the travel of the article transport vehicle 10.
The controller H is electrically connected to a steering actuator 15a that changes the traveling direction of each of the pair of front and rear drive wheels, and a travel motor 15m that travels and drives the drive wheels. Further, the control unit H is electrically connected to a drive unit for moving the moving-out / out operation unit 12a of the transfer device 12 and a driving unit for moving up / down the moving-up / down operation unit 12b. It has become so. Furthermore, the control unit H is connected to a two-dimensional shape sensor 20 that can detect the shape of the detection surface of the detection target, which will be described later, in the transfer direction, and can read the detection information of the two-dimensional shape sensor 20. It has become.
The control unit H includes a posture determination unit H1 that determines the posture of the article transport vehicle 10 in plan view based on the detection information of the two-dimensional shape sensor 20, and the detection information of the two-dimensional shape sensor 20. And a position discriminating section H2 for discriminating the position of the article transport vehicle 10 in the front-rear direction with respect to the station ST.

制御部Hは、外部の管理装置(図示省略)からの指令に基づいて、搬送対象の物品Bを搬送元のステーションSTから搬送先のステーションSTに搬送するべく、前後一対の駆動車輪夫々における操向アクチュエータ15a及び走行モータ15mの作動を制御する。これによって、制御部Hは、物品搬送車10の走行作動及び物品搬送車10の平面視姿勢を制御することができる。
なお、物品搬送設備には、図示しない位置検出装置が設けられ、走行経路における物品搬送車10の走行位置を検出自在となっている。制御部Hは、この位置検出装置からの物品搬送車10の走行位置情報と上記管理装置からの指令とに基づいて、物品搬送車10の走行を制御することになる。
Based on a command from an external management device (not shown), the control unit H controls each of the pair of front and rear drive wheels to transport the article B to be transported from the transport source station ST to the transport destination station ST. The operation of the direction actuator 15a and the traveling motor 15m is controlled. Accordingly, the control unit H can control the traveling operation of the article transport vehicle 10 and the planar view posture of the article transport vehicle 10.
The article transport facility is provided with a position detection device (not shown) so that the travel position of the article transport vehicle 10 on the travel route can be detected. The control unit H controls the travel of the article transport vehicle 10 based on the travel position information of the article transport vehicle 10 from the position detection device and the command from the management device.

制御部Hは、ステーションSTとの間で物品Bを移載する場合は、出退作動部12aをステーションSTと重複する移載用位置に突出させる。ステーションSTには、物品Bの支持用棒状体Rの両端を載置支持する一対のステーション側支持体(図示省略)が設けられている。一対のステーション側支持体は、出退作動部12aが移載用位置に位置する状態において、物品搬送車10における一対の支持体13の並び方向で一対の支持体13の外方に位置するように配設されており、昇降作動部12bの昇降作動により、物品搬送車10における一対の支持体13にて支持用棒状体Rを支持する状態と一対のステーション側支持体にて支持用棒状体Rを支持する状態とを切換えることで、物品Bを移載装置12とステーションSTとの間で移載するようになっている。   When the article B is transferred to or from the station ST, the control unit H causes the withdrawal / operation unit 12a to protrude to the transfer position overlapping the station ST. The station ST is provided with a pair of station side supports (not shown) for placing and supporting both ends of the support rod R for the article B. The pair of station-side supports are positioned outside the pair of supports 13 in the direction in which the pair of supports 13 in the article transport vehicle 10 are arranged in a state where the retracting / moving operation portion 12a is located at the transfer position. The support rod-like body is supported by the pair of station-side supports and the state in which the support rod-like body R is supported by the pair of support bodies 13 in the article transporting vehicle 10 by the raising / lowering operation of the raising / lowering operation portion 12b. By switching the state of supporting R, the article B is transferred between the transfer device 12 and the station ST.

上記のように、物品搬送車10がステーションSTとの間で物品Bを移載する場合、出退作動部12a及びそれに備えられる一対の支持体13とステーションSTに備えられるステーション用支持体とが干渉しないようにするため、ステーションSTに対する物品Bの移載方向と直交し水平方向に沿う基準方向に対する物品搬送車10の姿勢を所定の姿勢とし、かつ、ステーションSTに対する物品搬送車10の前後方向での位置を所定の位置とした状態で停止させる必要がある。   As described above, when the article transport vehicle 10 transfers the article B to and from the station ST, the exit / retreat operation unit 12a and the pair of support bodies 13 provided therein and the station support body provided in the station ST are provided. In order to avoid interference, the posture of the article transport vehicle 10 with respect to a reference direction perpendicular to the transfer direction of the article B with respect to the station ST and along the horizontal direction is set to a predetermined posture, and the front and rear direction of the article transport vehicle 10 with respect to the station ST It is necessary to stop in a state where the position at is a predetermined position.

このため、本実施形態の物品搬送設備には、物品搬送車10がステーションSTに対して物品Bを移載する移載用位置に停止した状態、又は、物品搬送車10が移載用位置に近接する位置で移載用位置へ向けて走行している状態において、ステーションSTについての上記基準方向に対する物品搬送車10の平面視での姿勢及びステーションSTに対する物品搬送車10の前後方向の位置を検出する検出装置を設けている。
そして、制御部Hが、上記検出装置の検出情報に基づいて、ステーションSTに対する物品搬送車10の平面視姿勢が移載用の適正姿勢であり、ステーションSTに対する物品搬送車10の前後方向の位置が移載用の適正走行位置である状態で物品搬送車10を停止させるべく、物品搬送車10の走行作動及び物品搬送車10の平面視姿勢を制御するようになっている。
For this reason, in the article conveyance facility of the present embodiment, the article conveyance vehicle 10 is stopped at the transfer position where the article B is transferred to the station ST, or the article conveyance vehicle 10 is at the transfer position. In a state where the vehicle travels toward the transfer position at a close position, the posture of the article transport vehicle 10 in the plan view with respect to the reference direction with respect to the station ST and the position of the article transport vehicle 10 in the front-rear direction with respect to the station ST are determined. A detection device for detection is provided.
Then, based on the detection information of the detection device, the control unit H has a plan view posture of the article transport vehicle 10 with respect to the station ST as an appropriate posture for transfer, and a position in the front-rear direction of the article transport vehicle 10 with respect to the station ST. In order to stop the article transport vehicle 10 in a state where is an appropriate travel position for transfer, the travel operation of the article transport vehicle 10 and the planar view posture of the article transport vehicle 10 are controlled.

図2に示すように、検出装置は、ステーションSTに固定された被検出体50と、検出方向が物品搬送車10の横幅方向に沿うように物品搬送車10に固定された二次元形状センサ20とを備えている。二次元形状センサ20は、図7及び図8に示すように、物品搬送車10の前後方向で所定の検出範囲を有し、被検出体50が備える上下方向に沿う被検出面の、物品搬送車10との移載方向の形状を検出自在に構成されている。   As shown in FIG. 2, the detection device includes a detection target 50 fixed to the station ST, and a two-dimensional shape sensor 20 fixed to the article transport vehicle 10 so that the detection direction is along the lateral width direction of the article transport vehicle 10. And. As shown in FIGS. 7 and 8, the two-dimensional shape sensor 20 has a predetermined detection range in the front-rear direction of the article transport vehicle 10, and transports the article on the detected surface along the vertical direction of the detected body 50. The shape of the transfer direction with the car 10 is configured to be freely detected.

被検出体50は、図4及び5に示すように、基準方向に沿って長い平板状体にて構成され、その平板状体に、上下方向に沿う複数の凹入溝52が離間して設けられている。
複数の凹入溝52は、図5に示すように、被検出体50の基準面50mから被検出体50の厚さ以下の距離だけ凹入する形態で構成されている。つまり、図5に示すように、被検出体50の上面視で基準面50mから距離L13だけ凹入する凹入溝52cの両側に、被検出体50の上面視で基準面50mから距離L12だけ凹入する凹入溝52b及び凹入溝52dが設けられ、さらにその両側に被検出体50の上面視で基準面50mから距離L11だけ凹入する凹入溝52a及び凹入溝52eが設けられている。なお、本実施形態では、凹入溝52cが基準方向でのステーションSTの中央となるように被検出体50が取り付けられている。
As shown in FIGS. 4 and 5, the detected object 50 is configured by a flat plate-like body that is long along the reference direction, and a plurality of recessed grooves 52 are provided in the flat plate-like body so as to be spaced apart from each other. It has been.
As shown in FIG. 5, the plurality of recessed grooves 52 are configured to be recessed from the reference surface 50 m of the detected object 50 by a distance equal to or less than the thickness of the detected object 50. That is, as shown in FIG. 5, on both sides of the recessed groove 52 c that is recessed by a distance L <b> 13 from the reference surface 50 m in the top view of the detection target 50, only a distance L <b> 12 from the reference surface 50 m in the top view of the detection target 50. A recessed groove 52b and a recessed groove 52d that are recessed are provided, and a recessed groove 52a and a recessed groove 52e that are recessed from the reference surface 50m by a distance L11 when viewed from above are provided on both sides thereof. ing. In the present embodiment, the detected object 50 is attached so that the recessed groove 52c is at the center of the station ST in the reference direction.

制御部Hは、図6及び図7に示すように、二次元形状センサ20が検出した被検出面の基準方向での凹凸形状において、基準方向に離間しかつ基準面50mに相当する検出点P1を2か所選択する(図6のステップ#1、2)。なお、2か所の検出点P1は、基準方向で二次元形状センサ20の検出範囲に相当する被検出範囲Sの両端部に離間するように選択する。
制御部Hは、複数の凹入溝52a〜52eの位置と基準方向におけるステーションSTの位置との対応関係情報を記憶している。
そして、制御部Hは、2か所の点P1夫々までの距離より、その差(ずれ量)を算出し、物品搬送車10の平面視姿勢が基準方向に沿う移載用の適正姿勢であるか否かを判別する(図6のステップ#3、4)。
ステップ#4において、適正姿勢からのずれがあると判別すると、引き続き、制御部Hは、上記2か所の点P1夫々までの距離の差(図7のY1,Y2に示す)に基づいて、基準方向に対する角度を求め、これを物品搬送車10の姿勢を示す情報として一旦記憶する。そして、物品搬送車10の平面視姿勢を移載用の適正姿勢とすべく、上記物品搬送車10の姿勢を示す情報に基づいて、操向アクチュエータ15aと走行モータ15mとの作動を制御する姿勢補正移動処理を実行する(ステップ#5)。
As shown in FIGS. 6 and 7, the control unit H detects the detection point P1 that is separated in the reference direction and corresponds to the reference surface 50m in the uneven shape in the reference direction of the detection surface detected by the two-dimensional shape sensor 20. Are selected (steps # 1 and # 2 in FIG. 6). The two detection points P1 are selected so as to be separated from both ends of the detection range S corresponding to the detection range of the two-dimensional shape sensor 20 in the reference direction.
The controller H stores correspondence information between the positions of the plurality of recessed grooves 52a to 52e and the position of the station ST in the reference direction.
And the control part H calculates the difference (deviation amount) from the distance to each of the two points P1, and the planar view posture of the article transport vehicle 10 is an appropriate posture for transfer along the reference direction. (Steps # 3 and 4 in FIG. 6).
If it is determined in step # 4 that there is a deviation from the appropriate posture, the control unit H continues to determine the difference between the distances to the two points P1 (shown as Y1 and Y2 in FIG. 7). An angle with respect to the reference direction is obtained, and this is temporarily stored as information indicating the posture of the article transport vehicle 10. And the attitude | position which controls the action | operation of the steering actuator 15a and the traveling motor 15m based on the information which shows the attitude | position of the said article conveyance vehicle 10 so that the planar view attitude | position of the article conveyance vehicle 10 may be made into the appropriate attitude | position for transfer. A correction movement process is executed (step # 5).

ステップ#4において適正姿勢からのずれがないと判別した場合、又は、ステップ#5の処理が終了した場合は、続いて、図8に示すように、二次元形状センサ20が検出した被検出面の基準方向での凹凸形状において、凹入溝52に相当する検出点P2を選択する。
制御部Hは、基準方向におけるステーションSTの位置と複数の凹入溝52a〜52eの位置との対応関係情報に基づいて、物品搬送車10の移載用適正位置からのずれ量を算出して一旦記憶し、物品搬送車10の前後方向の位置が移載用の適正位置であるか否かを判別する(図6のステップ#7、8)。
なお、本実施形態では、検出点Pに凹入溝52cを検出している状態を移載用の適正位置としているため、制御部Hは、凹入溝52cとのずれ量を検出することになる。つまり、被検出範囲Sの中点P2' (すなわち被検出範囲の両端からの距離W2が等しくなる点)と凹入溝52cに対応する検出点P2との距離Xが許容範囲以上であるか否かを判別する。
ステップ#8において、適正位置からのずれ量が許容範囲以上であると判別すると、引き続き、制御部Hは、物品搬送車10の前後方向の位置を移載用の適正位置とすべく、記憶したずれ量に基づいて、操向アクチュエータ15aと走行モータ15mとの作動を制御する位置補正移動処理を実行する(ステップ#9)。
ステップ#8において適正位置からのずれ量が許容範囲内であると判別した場合、又は、ステップ#の処理が終了した場合は、本フローチャートの処理を終了する。
When it is determined in step # 4 that there is no deviation from the proper posture, or when the process of step # 5 is completed, subsequently, the detected surface detected by the two-dimensional shape sensor 20 as shown in FIG. In the uneven shape in the reference direction, the detection point P2 corresponding to the recessed groove 52 is selected.
The control unit H calculates the amount of deviation from the proper transfer position of the article transport vehicle 10 based on correspondence information between the position of the station ST and the positions of the plurality of recessed grooves 52a to 52e in the reference direction. Once stored, it is determined whether or not the position of the article transport vehicle 10 in the front-rear direction is an appropriate position for transfer (steps # 7 and # 8 in FIG. 6).
In the present embodiment, since the state in which the recessed groove 52c is detected at the detection point P is set as an appropriate position for transfer, the control unit H detects the amount of deviation from the recessed groove 52c. Become. That is, whether or not the distance X between the midpoint P2 ′ of the detected range S (that is, the point at which the distance W2 from both ends of the detected range becomes equal) and the detected point P2 corresponding to the recessed groove 52c is greater than or equal to the allowable range. Is determined.
If it is determined in step # 8 that the amount of deviation from the appropriate position is greater than or equal to the allowable range, the control unit H stores the position in the front-rear direction of the article transport vehicle 10 as the appropriate position for transfer. Based on the amount of deviation, position correction movement processing for controlling the operation of the steering actuator 15a and the traveling motor 15m is executed (step # 9).
When it is determined in step # 8 that the amount of deviation from the appropriate position is within the allowable range, or when the process of step # 9 is completed, the process of this flowchart is terminated.

本実施形態において、二次元形状センサ20が検出部に相当し、複数の基準面50mの夫々が姿勢検出用部分に相当し、複数の凹入溝52の夫々が前後位置検出用部分に相当する。すなわち、複数の基準面50mにて構成される姿勢検出用領域及び複数の凹入溝52にて構成される前後位置検出用領域の夫々が、基準方向に沿い且つ移載方向で異なった位置に位置する面上に設定されている。姿勢検出用領域が、基準方向に沿って複数の基準面50mに分散され、かつ、前後位置検出用領域が、基準方向に沿って複数の凹入溝52に分散され、被検出面は、基準面50mと凹入溝52とを基準方向に交互に並べて形成されている。そして、二次元形状センサ20は、基準面50mまでの距離及び凹入溝52までの距離を計測するように構成されている。
また、制御部Hが、二次元形状センサ20が検出した被検出面の基準方向での凹凸形状に基づいて、基準面50mに対応する検出点P1での移載方向での距離と凹入溝52の底部に対応する中点P2’での移載方向での距離とを検出するように構成されている。
したがって、被検出面は、物品搬送車10の姿勢を検出するための姿勢検出用領域と、物品搬送車10の前後方向の位置を検出するための前後位置検出用領域と、を備えて、ステーションSTに対する物品搬送車10の前後方向の位置が異なっても二次元形状センサ20の検出範囲に相当する被検出範囲Sに姿勢検出用領域の一部である基準面50mと前後位置検出用領域の一部である複数の凹入溝52のうちのいずれかと、が含まれるように、かつ、ステーションSTに対する物品搬送車10の前後方向の位置に対応して被検出範囲Sにおける面形状が異なるように形成されている。
これにより、被検出体50の基準方向での寸法を小型化することが可能となる。
In the present embodiment, the two-dimensional shape sensor 20 corresponds to a detection unit, each of the plurality of reference surfaces 50m corresponds to a posture detection portion, and each of the plurality of recessed grooves 52 corresponds to a front / rear position detection portion. . That is, each of the posture detection area constituted by the plurality of reference surfaces 50m and the front / rear position detection area constituted by the plurality of recessed grooves 52 is located at different positions along the reference direction and in the transfer direction. It is set on the surface to be positioned. The posture detection areas are distributed on the plurality of reference surfaces 50m along the reference direction, and the front and rear position detection areas are distributed on the plurality of recessed grooves 52 along the reference direction. The surfaces 50m and the recessed grooves 52 are formed alternately in the reference direction. The two-dimensional shape sensor 20 is configured to measure the distance to the reference surface 50 m and the distance to the recessed groove 52.
Further, based on the concavo-convex shape in the reference direction of the detected surface detected by the two-dimensional shape sensor 20, the control unit H determines the distance in the transfer direction and the recessed groove at the detection point P1 corresponding to the reference surface 50m. 52 is configured to detect the distance in the transfer direction at the midpoint P2 ′ corresponding to the bottom of 52.
Therefore, the detected surface includes a posture detection region for detecting the posture of the article transport vehicle 10 and a front / rear position detection region for detecting the front / rear position of the article transport vehicle 10. Even if the position of the article transporting vehicle 10 in the front-rear direction with respect to ST is different, the reference surface 50m, which is a part of the posture detection region, and the front-rear position detection region are detected in the detection range S corresponding to the detection range of the two-dimensional shape sensor 20. The surface shape in the detection range S is different so as to include any one of the plurality of recessed grooves 52 that are a part and corresponding to the position of the article transport vehicle 10 in the front-rear direction with respect to the station ST. Is formed.
Thereby, it is possible to reduce the size of the detection target 50 in the reference direction.

〔別実施形態〕
(1)上記実施形態では、物品Bをロール状物品とする構成を説明したが、物品Bをロール状物品以外の物品(例えば、パレットに載置した物品や半導体保管又は搬送用容器等)であってもよい。
[Another embodiment]
(1) In the above embodiment, the configuration in which the article B is a roll-shaped article has been described. However, the article B is an article other than the roll-shaped article (for example, an article placed on a pallet, a semiconductor storage or transport container, etc.). There may be.

)上記実施形態では、検出部を二次元形状センサとしたが、このような構成に限定されるものではなく、検出部として三次元形状センサやカメラを用い、画像解析によって被検出体の面形状を検出するようにしてもよい。また、検出部として、複数の距離センサを、姿勢検出用部分までの距離及び前後位置検出用部分までの距離を検出可能に設けるものとしてもよい。 ( 2 ) In the above embodiment, the detection unit is a two-dimensional shape sensor. However, the detection unit is not limited to such a configuration. A three-dimensional shape sensor or a camera is used as the detection unit, and the detected object is analyzed by image analysis. The surface shape may be detected. Further, as the detection unit, a plurality of distance sensors may be provided so as to detect the distance to the posture detection portion and the distance to the front and rear position detection portion.

)上記実施形態では、複数の凹入溝52を、図5に示すように、被検出体50の上面視で基準面50mから距離L13だけ凹入する凹入溝52cの両側に、被検出体50の上面視で基準面50mから距離L12だけ凹入する凹入溝52b及び凹入溝52dを設け、さらにその両側に被検出体50の上面視で基準面50mから距離L11だけ凹入する凹入溝52a及び凹入溝52eを設けるように構成したが、このような構成に限定されるものではなく、例えば図に示すように、被検出体50の基準方向に沿う一端側に設けられる凹入溝52aから他端側に設けられる凹入溝52eに向けて、その上面視で基準面50mからの距離が、徐々に大きくなるように構成してもよい。また、図では、凹入溝52a〜52eの基準面50mからの距離L21〜距離L25が、等差状に形成される例を示したが、凹入溝52a〜52eの基準面50mからの距離を、その基準方向での並び順に拘わらずランダムに異ならせるようにしてもよい。
さらに、上記実施形態では、凹入溝52の数を5個としたが、凹入溝52の数はこれに限られるものではなく、4個以下又は6個以上としてもよい。さらに、上記実施形態では、前後位置検出用部分を上下方向に沿う直線状の凹入溝52としたが、例えば突条とすることもできる。さらに、前後位置検出用部分を直線状以外の形状、例えば、基準面50mから凹入する有底円孔状や有底多角形状、基準面50mから突出する円状突起や多角形状突起としてもよい。
( 3 ) In the above embodiment, as shown in FIG. 5, the plurality of recessed grooves 52 are formed on both sides of the recessed grooves 52c that are recessed from the reference surface 50m by a distance L13 as viewed from above. A recessed groove 52b and a recessed groove 52d that are recessed by a distance L12 from the reference surface 50m in the top view of the detection body 50 are provided, and further, recessed on both sides thereof by a distance L11 from the reference surface 50m in the top view. However, the present invention is not limited to such a configuration. For example, as shown in FIG. 9 , at one end side along the reference direction of the detected object 50, the concave groove 52a and the concave groove 52e are provided. You may comprise so that the distance from the reference surface 50m may become large gradually in the top view toward the concave groove 52e provided in the other end side from the concave groove 52a provided. 9 shows an example in which the distances L21 to L25 from the reference surface 50m of the recessed grooves 52a to 52e are formed in an equal shape, but the distance from the reference surface 50m of the recessed grooves 52a to 52e is shown. The distance may be varied randomly regardless of the arrangement order in the reference direction.
Furthermore, in the said embodiment, although the number of the recessed grooves 52 was five, the number of the recessed grooves 52 is not restricted to this, It is good also as 4 or less or 6 or more. Furthermore, in the said embodiment, although the front-back position detection part was made into the linear recessed groove | channel 52 along an up-down direction, it can also be made into a protrusion, for example. Further, the front / rear position detecting portion may have a shape other than a linear shape, for example, a bottomed circular hole shape or a bottomed polygonal shape recessed from the reference surface 50m, a circular protrusion or a polygonal protrusion protruding from the reference surface 50m. .

10 物品搬送車
20 検出部
50 被検出体
52 凹入溝
B 物品
H 制御部
P1 検出点
P2 検出点
S 被検出範囲
ST ステーション
DESCRIPTION OF SYMBOLS 10 Article conveyance vehicle 20 Detection part 50 Detected object 52 Recessed groove B Article H Control part P1 Detection point P2 Detection point S Detection range ST Station

Claims (2)

無軌道の走行経路に沿って走行して、前記走行経路の側脇に配置されたステーションとの間で搬送対象の物品を移載する物品搬送車と、
前記物品搬送車の走行作動及び前記物品搬送車の平面視姿勢を制御する制御部と、を備え、
前記物品搬送車が前記ステーションに対して前記物品を移載する移載用位置に停止した状態、又は、前記物品搬送車が前記移載用位置に近接する位置で走行している状態において、前記ステーションに対する物品の移載方向と直交し水平方向に沿う基準方向に対する前記物品搬送車の平面視での姿勢及び前記ステーションに対する前記物品搬送車の前後方向の位置を検出する検出装置が設けられた物品搬送車の位置姿勢判別システムであって、
前記検出装置が、前記ステーションに固定された被検出体と、検出方向が前記物品搬送車の横幅方向に沿うように前記物品搬送車に固定され、少なくとも前記物品搬送車の前後方向で所定の検出範囲を有し、前記被検出体が備える上下方向に沿う被検出面の面形状を検出する検出部とを備え、
前記検出部が、前記被検出面の前記移載方向での形状を検出自在な形状センサにて構成され、
前記被検出面は、前記物品搬送車の前記姿勢を検出するための姿勢検出用領域と、前記物品搬送車の前後方向の位置を検出するための前後位置検出用領域と、を備え、かつ、前記物品搬送車の前後方向で、前記姿勢検出用領域が前記前後位置検出用領域を含んでおり、
前記被検出面は、さらに、前記ステーションに対する前記物品搬送車の前後方向の位置が異なっても前記検出部の前記検出範囲に相当する被検出範囲に前記姿勢検出用領域の一部である姿勢検出用部分と前記前後位置検出用領域の一部である前後位置検出用部分とが含まれるように、かつ、前記ステーションに対する前記物品搬送車の前後方向の位置に対応して前記被検出範囲における面形状が異なるように形成され
記制御部は、前記検出部による前記複数の姿勢検出用部分についての検出情報に基づいて前記物品搬送車の前記姿勢を判別し、前記ステーションに対する前記物品搬送車の前後方向の位置と前記被検出面の前記被検出範囲における面形状との対応関係に基づいて前記物品搬送車の前後方向の位置を判別し
前記姿勢検出用領域及び前記前後位置検出用領域の夫々が、前記基準方向に沿い且つ前記移載方向で異なった位置に位置する面上に設定され、
前記姿勢検出用領域が、前記基準方向に沿って複数の前記姿勢検出用部分に分散され、かつ、前記前後位置検出用領域が、前記基準方向に沿って複数の前記前後位置検出用部分に分散され、
前記被検出面は、前記姿勢検出用部分と前記前後位置検出用部分とを前記基準方向に交互に並べて形成され、
前記制御部が、前記形状センサが検出した前記被検出面の前記基準方向での凹凸形状に基づいて、前記姿勢検出用部分に対応する検出点での前記移載方向での距離と前記前後位置検出用部分に対応する検出点での前記移載方向での距離とを検出するように構成されている物品搬送車の位置姿勢判別システム。
An article transport vehicle that travels along a trackless travel route and transfers an article to be transported to and from a station disposed on the side of the travel route;
A control unit for controlling the travel operation of the article transport vehicle and the planar view posture of the article transport vehicle,
In a state where the article transport vehicle is stopped at a transfer position for transferring the article relative to the station, or in a state where the article transport vehicle is running at a position close to the transfer position, Article provided with a detection device for detecting a posture of the article transport vehicle in a plan view with respect to a reference direction orthogonal to a transfer direction of the article with respect to the station and along a horizontal direction, and a position of the article transport vehicle in the front-rear direction with respect to the station A position and orientation determination system for a transport vehicle,
The detection apparatus is fixed to the article carrier so that the detection object is fixed to the station, and the detection direction is along the width direction of the article carrier, and at least predetermined detection is performed in the front-rear direction of the article carrier. A detection unit for detecting a surface shape of a detection surface along a vertical direction provided in the detection object, and having a range;
The detection unit is configured by a shape sensor capable of detecting the shape of the detection surface in the transfer direction,
The detected surface includes an attitude detection area for detecting the attitude of the article transport vehicle, and a front / rear position detection area for detecting a position in the front / rear direction of the article transport vehicle , and In the front-rear direction of the article transport vehicle, the posture detection region includes the front-rear position detection region,
The posture detection is further part of the posture detection region in the detection range corresponding to the detection range of the detection unit even if the position of the article transport vehicle in the front-rear direction with respect to the station is different. A surface in the detected range corresponding to a position in the front-rear direction of the article transporting vehicle with respect to the station so as to include a front-rear position detecting portion that is a part of the front-rear position detecting region Formed in different shapes ,
Prior Symbol controller, based on the detected information about said plurality of posture detection portion by the detector to determine the orientation of the article transport vehicle, the front and rear direction of the position of the article transport vehicle to said station to be Determining the position of the article transport vehicle in the front-rear direction based on the correspondence with the surface shape in the detected range of the detection surface ;
Each of the posture detection region and the front-rear position detection region is set on a surface located at a different position along the reference direction and in the transfer direction,
The posture detection region is distributed to the plurality of posture detection portions along the reference direction, and the front and rear position detection region is distributed to the plurality of front and rear position detection portions along the reference direction. And
The detected surface is formed by alternately arranging the posture detection portions and the front-rear position detection portions in the reference direction,
Based on the concavo-convex shape in the reference direction of the detected surface detected by the shape sensor, the control unit detects the distance in the transfer direction and the front-rear position at a detection point corresponding to the posture detection portion. A position / posture determination system for an article transport vehicle configured to detect a distance in the transfer direction at a detection point corresponding to a detection portion .
前記制御部が、前記検出装置の検出情報に基づいて、前記ステーションに対する前記物品搬送車の平面視姿勢が移載用の適正姿勢であり、前記ステーションに対する前記物品搬送車の前後方向の位置が移載用の適正走行位置である状態で前記物品搬送車を停止させるように構成されている請求項1に記載の物品搬送車の位置姿勢判別システム。 Based on the detection information of the detection device, the control unit has an appropriate posture for transfer of the article transport vehicle with respect to the station, and the position of the article transport vehicle in the front-rear direction with respect to the station is shifted. The position / posture determination system for an article transporting vehicle according to claim 1 , wherein the article transporting vehicle is configured to stop in a state where the proper traveling position is set .
JP2013080585A 2013-04-08 2013-04-08 Position / orientation discrimination system for article transport vehicles Active JP5935745B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2013080585A JP5935745B2 (en) 2013-04-08 2013-04-08 Position / orientation discrimination system for article transport vehicles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2013080585A JP5935745B2 (en) 2013-04-08 2013-04-08 Position / orientation discrimination system for article transport vehicles

Publications (2)

Publication Number Publication Date
JP2014203354A JP2014203354A (en) 2014-10-27
JP5935745B2 true JP5935745B2 (en) 2016-06-15

Family

ID=52353717

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2013080585A Active JP5935745B2 (en) 2013-04-08 2013-04-08 Position / orientation discrimination system for article transport vehicles

Country Status (1)

Country Link
JP (1) JP5935745B2 (en)

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08305439A (en) * 1995-05-09 1996-11-22 Meidensha Corp Guiding method for unmanned vehicle
JP2000194418A (en) * 1998-12-25 2000-07-14 Murata Mach Ltd Position correction system for ummanned carriage
JP4074999B2 (en) * 2004-01-13 2008-04-16 村田機械株式会社 Conveyor cart system
JP2011243129A (en) * 2010-05-21 2011-12-01 Murata Mach Ltd Transportation vehicle system

Also Published As

Publication number Publication date
JP2014203354A (en) 2014-10-27

Similar Documents

Publication Publication Date Title
JP6507894B2 (en) Travel control method at unloading in unmanned forklift and travel control device at unloading
US10773938B2 (en) Forklift system and control method thereof
US7408314B2 (en) Control device for movable body
TWI414471B (en) Transporting system, and teaching method in the transporting system
JP6664830B2 (en) Manufacturing system
CN101795923A (en) Automatic transport loading system and method
KR101970900B1 (en) Driverless transport vehicle and method for operating a driverless transport vehicle
CN101999102A (en) Automatic transport loading system and method
US20180057261A1 (en) Article Transport Facility
JP6291284B2 (en) Warehousing part detection device and mechanical parking equipment equipped with it
KR102390053B1 (en) Article transport facility
JP7469494B2 (en) Method for controlling an automated guided vehicle and a control system configured to carry out said method - Patents.com
US20200307776A1 (en) Automated weight balancing for automated guided vehicle
JP2007219960A (en) Position deviation detection device
JP2020154454A (en) Autonomous mobile device, guidance system, and movement method of autonomous mobile device
JP5372422B2 (en) Work transfer equipment for transport cart
US20230192412A1 (en) Article Transport Facility
JP5935745B2 (en) Position / orientation discrimination system for article transport vehicles
JP2008184112A (en) Carriage connecting structure
JP2021046287A (en) Carrier system
JP5413285B2 (en) Moving object and its turning radius calculation method
CN113552876A (en) Control device, movement control system, control method, and program
JP2011243129A (en) Transportation vehicle system
KR101419348B1 (en) Position recognition method of transfer system and position recognition jig thereof
JP7283152B2 (en) Autonomous mobile device, program and steering method for autonomous mobile device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20150223

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20160113

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20160126

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20160323

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: 20160412

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160425

R150 Certificate of patent or registration of utility model

Ref document number: 5935745

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250