JP5935745B2 - Position / orientation discrimination system for article transport vehicles - Google Patents
Position / orientation discrimination system for article transport vehicles Download PDFInfo
- 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
Links
- 238000001514 detection method Methods 0.000 claims description 184
- 238000012546 transfer Methods 0.000 claims description 68
- 230000032258 transport Effects 0.000 description 108
- 238000000034 method Methods 0.000 description 4
- 238000005259 measurement Methods 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000010191 image analysis Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
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
特許文献1では、被検出部分61a、61b及び62が、上下方向に沿う平面状の被検出面を備えている。また、被検出部分61aの被検出面と被検出部分61bの被検出面とは同じ平面上に位置しており、かつ、平面視において、被検出面が上記基準方向に沿う方向となるように形成されている。さらに、被検出部分62の被検出面は、平面視において上記基準方向に対して設定角度傾斜するように形成されている。
In
そして、物品搬送車の前後方向に沿って離間して並ぶ3つの距離センサ201a、202、201bのうち、距離センサ201aが被検出部分61aの被検出面との距離を検出し、距離センサ201bが被検出部分61bの被検出面との距離を検出し、制御部が、距離センサ201aが検出する距離と距離センサ201bが検出する距離とに基づいて、物品搬送車のステーションの基準方向に対する物品搬送車の平面視での姿勢を判別するようになっている。すなわち、距離センサ201aが検出する距離と距離センサ201bが検出する距離とが等しい場合には、物品搬送車の基準方向に対する姿勢は傾斜していないと判別し、距離センサ201aが検出する距離と距離センサ201bが検出する距離とが異なっている場合には、物品搬送車の基準方向に対する姿勢は両センサの検出距離の差に対応する角度だけ傾斜していると判別する。
Of the three
制御部は、上記のように物品搬送車の姿勢を判別したのち、距離センサ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
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
しかしながら、上記特許文献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
本発明は、上記実情に鑑みてなされたものであって、その目的は、ステーションに対する物品搬送車の平面視での姿勢及びステーションに対する物品搬送車の前後方向の位置を検出する検出装置における被検出体の基準方向での寸法を小型化することが可能な位置姿勢判別システムを提供することにある。 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.
本発明に係る物品搬送車の位置姿勢判別システムの第2特徴構成は、上記第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.
以下、本発明の位置姿勢判別システムの実施形態を説明する。本実施形態は、本発明の位置姿勢判別システムを物品搬送設備に適用した例である。
図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
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
移載装置12は、平面視で物品搬送車10の前後方向と直交する横幅方向に沿って出退移動自在な出退作動部12aと、その出退作動部12aを上下方向に沿って昇降移動自在な昇降作動部12bとを備えている。出退作動部12aには、物品Bとしてのロール状物品の空芯に貫入された支持用棒状体Rの両端部を載置支持する一対の支持体13が車体前後方向に離間して立設されている。一対の支持体13の上端には、載置部13sが備えられ、物品Bを一対の支持体13にて支持する場合には、一対の支持体13夫々の載置部13sに支持用棒状体Rの両端が支持され、ロール状の物品Bが一対の支持体13の間に位置する状態となる。
The
図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
The controller H is electrically connected to a
The control unit H includes a posture determination unit H1 that determines the posture of the
制御部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
The article transport facility is provided with a position detection device (not shown) so that the travel position of the
制御部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 /
上記のように、物品搬送車10がステーションSTとの間で物品Bを移載する場合、出退作動部12a及びそれに備えられる一対の支持体13とステーションSTに備えられるステーション用支持体とが干渉しないようにするため、ステーションSTに対する物品Bの移載方向と直交し水平方向に沿う基準方向に対する物品搬送車10の姿勢を所定の姿勢とし、かつ、ステーションSTに対する物品搬送車10の前後方向での位置を所定の位置とした状態で停止させる必要がある。
As described above, when the
このため、本実施形態の物品搬送設備には、物品搬送車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
Then, based on the detection information of the detection device, the control unit H has a plan view posture of the
図2に示すように、検出装置は、ステーションSTに固定された被検出体50と、検出方向が物品搬送車10の横幅方向に沿うように物品搬送車10に固定された二次元形状センサ20とを備えている。二次元形状センサ20は、図7及び図8に示すように、物品搬送車10の前後方向で所定の検出範囲を有し、被検出体50が備える上下方向に沿う被検出面の、物品搬送車10との移載方向の形状を検出自在に構成されている。
As shown in FIG. 2, the detection device includes a
被検出体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
As shown in FIG. 5, the plurality of recessed
制御部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
The controller H stores correspondence information between the positions of the plurality of recessed
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
If it is determined in
ステップ#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において適正位置からのずれ量が許容範囲内であると判別した場合、又は、ステップ#9の処理が終了した場合は、本フローチャートの処理を終了する。
When it is determined in
The control unit H calculates the amount of deviation from the proper transfer position of the
In the present embodiment, since the state in which the recessed
If it is determined in
When it is determined in
本実施形態において、二次元形状センサ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-
Further, based on the concavo-convex shape in the reference direction of the detected surface detected by the two-
Therefore, the detected surface includes a posture detection region for detecting the posture of the
Thereby, it is possible to reduce the size of the
〔別実施形態〕
(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)上記実施形態では、検出部を二次元形状センサとしたが、このような構成に限定されるものではなく、検出部として三次元形状センサやカメラを用い、画像解析によって被検出体の面形状を検出するようにしてもよい。また、検出部として、複数の距離センサを、姿勢検出用部分までの距離及び前後位置検出用部分までの距離を検出可能に設けるものとしてもよい。 ( 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.
(3)上記実施形態では、複数の凹入溝52を、図5に示すように、被検出体50の上面視で基準面50mから距離L13だけ凹入する凹入溝52cの両側に、被検出体50の上面視で基準面50mから距離L12だけ凹入する凹入溝52b及び凹入溝52dを設け、さらにその両側に被検出体50の上面視で基準面50mから距離L11だけ凹入する凹入溝52a及び凹入溝52eを設けるように構成したが、このような構成に限定されるものではなく、例えば図9に示すように、被検出体50の基準方向に沿う一端側に設けられる凹入溝52aから他端側に設けられる凹入溝52eに向けて、その上面視で基準面50mからの距離が、徐々に大きくなるように構成してもよい。また、図9では、凹入溝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
Furthermore, in the said embodiment, although the number of the recessed
10 物品搬送車
20 検出部
50 被検出体
52 凹入溝
B 物品
H 制御部
P1 検出点
P2 検出点
S 被検出範囲
ST ステーション
DESCRIPTION OF
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 .
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)
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 |
-
2013
- 2013-04-08 JP JP2013080585A patent/JP5935745B2/en active Active
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 |