JP6950629B2 - Transport vehicle - Google Patents

Transport vehicle Download PDF

Info

Publication number
JP6950629B2
JP6950629B2 JP2018120118A JP2018120118A JP6950629B2 JP 6950629 B2 JP6950629 B2 JP 6950629B2 JP 2018120118 A JP2018120118 A JP 2018120118A JP 2018120118 A JP2018120118 A JP 2018120118A JP 6950629 B2 JP6950629 B2 JP 6950629B2
Authority
JP
Japan
Prior art keywords
distance
acquisition unit
vehicle body
reference position
unit
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
JP2018120118A
Other languages
Japanese (ja)
Other versions
JP2020001845A (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.)
Toyota Industries Corp
Original Assignee
Toyota Industries Corp
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 Toyota Industries Corp filed Critical Toyota Industries Corp
Priority to JP2018120118A priority Critical patent/JP6950629B2/en
Publication of JP2020001845A publication Critical patent/JP2020001845A/en
Application granted granted Critical
Publication of JP6950629B2 publication Critical patent/JP6950629B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Handcart (AREA)
  • Loading Or Unloading Of Vehicles (AREA)
  • Forklifts And Lifting Vehicles (AREA)

Description

本発明は、搬送車両に関する。 The present invention relates to a transport vehicle.

従来の搬送車両として、特許文献1に記載されたものが知られている。この搬送車両は、トラックのコンテナなどの収容体の内部で荷物の積み降ろしを行う自走式の搬送車両である。収容体の内部には、レーザ光を反射するための反射板が複数個所に設けられている。搬送車両は、反射板によって反射されるレーザ光を検出することにより、自らの位置を把握する。 As a conventional transport vehicle, the one described in Patent Document 1 is known. This transport vehicle is a self-propelled transport vehicle that loads and unloads luggage inside a container such as a truck container. Inside the housing, a plurality of reflectors for reflecting the laser beam are provided. The transport vehicle grasps its position by detecting the laser beam reflected by the reflector.

特開平7−101554号公報Japanese Unexamined Patent Publication No. 7-101554

しかしながら、上述の搬送車両では、収容体の内部に複数個所に反射板を設けなくてはならない。この場合、搬送車両の走行環境、すなわち作業対象となる収容体が変わるたびに、反射板を新たに設置しなおす必要があり、作業に大きな手間がかかる。従って、走行環境によらず、正確に自動制御を行うことができる搬送車両が求められていた。 However, in the above-mentioned transport vehicle, reflectors must be provided at a plurality of places inside the housing. In this case, every time the traveling environment of the transport vehicle, that is, the housing to be worked on changes, it is necessary to newly install the reflector, which requires a great deal of time and effort. Therefore, there has been a demand for a transport vehicle capable of performing accurate automatic control regardless of the traveling environment.

従って、本発明は、走行環境によらず、正確に自動制御を行うことができる搬送車両を提供することを目的とする。 Therefore, an object of the present invention is to provide a transport vehicle capable of performing accurate automatic control regardless of the traveling environment.

本発明の一態様に係る搬送車両は、収容体の内部で荷物の積み降ろしを行う自走式の搬送車両であって、走行を行う車体と、収容体の外部に配置されて車体の基準位置を設定する基準位置設定部材と、車体と基準位置設定部材との間の距離に関する情報を取得する第1の距離取得部及び第2の距離取得部と、を備え、第1の距離取得部と第2の距離取得部とは、車体の幅方向において互いに異なる箇所と、基準位置設定部材との間の距離に関する情報をそれぞれ取得する。 The transport vehicle according to one aspect of the present invention is a self-propelled transport vehicle that loads and unloads luggage inside the housing, and is arranged at a vehicle body for traveling and a reference position of the vehicle body outside the housing. A first distance acquisition unit and a second distance acquisition unit for acquiring information on the distance between the vehicle body and the reference position setting member are provided, and the first distance acquisition unit and the first distance acquisition unit are provided. The second distance acquisition unit acquires information on the distance between different points in the width direction of the vehicle body and the reference position setting member.

本発明の一態様に係る搬送車両は、収容体の外部に配置されて車体の基準位置を設定する基準位置設定部材と、車体と基準位置設定部材との間の距離に関する情報を取得する第1の距離取得部及び第2の距離取得部と、を備える。例えば、車体が直進状態から傾いた状態となった場合、車体の幅方向における一方の端部側の部分と、他方の端部側の部分とでは、基準位置設定部材に対する距離にずれが生じる。これに対し、第1の距離取得部と第2の距離取得部とは、車体の幅方向において互いに異なる箇所と、基準位置設定部材との間の距離に関する情報をそれぞれ取得する。従って、第1の距離取得部によって取得された距離情報と第2の距離取得部によって取得された距離情報を比較することにより、車体の走行状態を正確に把握することができる。これにより、正確に搬送車両の自動制御を行うことができる。そして、距離情報を取得するために用いられる基準位置設定部材は、収容体の外部に配置されるものであるため、収容体が変わることで走行環境が変わった場合でも、再度の設置などは不要とすることができる。以上により、走行環境によらず、正確に自動制御を行うことができる。 The transport vehicle according to one aspect of the present invention is the first to acquire information on a distance between a reference position setting member arranged outside the housing and setting a reference position of a vehicle body and a distance between the vehicle body and the reference position setting member. A distance acquisition unit and a second distance acquisition unit are provided. For example, when the vehicle body is tilted from the straight traveling state, the distance between the portion on one end side and the portion on the other end side in the width direction of the vehicle body with respect to the reference position setting member occurs. On the other hand, the first distance acquisition unit and the second distance acquisition unit acquire information on the distance between different points in the width direction of the vehicle body and the reference position setting member, respectively. Therefore, by comparing the distance information acquired by the first distance acquisition unit with the distance information acquired by the second distance acquisition unit, the traveling state of the vehicle body can be accurately grasped. As a result, it is possible to accurately automatically control the transport vehicle. Since the reference position setting member used for acquiring the distance information is arranged outside the housing, even if the traveling environment changes due to the change of the housing, it is not necessary to install it again. Can be. As described above, accurate automatic control can be performed regardless of the traveling environment.

搬送車両は、車体の走行状態を取得する走行状態取得部を更に備え、走行状態取得部は、第1の距離取得部で取得された第1の距離情報と第2の距離取得部で取得された第2の距離情報との間のずれに基づいて、車体の走行状態の異常を判定してよい。このように、第1の距離情報と第2の距離情報とのずれを用いて、容易に走行状態の異常を把握することができる。 The transport vehicle further includes a traveling state acquisition unit that acquires the traveling state of the vehicle body, and the traveling state acquisition unit is acquired by the first distance information acquired by the first distance acquisition unit and the second distance acquisition unit. The abnormality of the traveling state of the vehicle body may be determined based on the deviation from the second distance information. In this way, it is possible to easily grasp the abnormality of the traveling state by using the deviation between the first distance information and the second distance information.

搬送車両は、車体の幅方向において互いに異なる位置に設けられた第1の駆動部及び第2の駆動部と、第1の駆動部及び第2の駆動部を制御する駆動制御部と、を更に備え、駆動制御部は、第1の駆動部及び第2の駆動部を互いに異なる回転数とすることで、第1の距離情報と第2の距離情報との間のずれを補正してよい。これにより、駆動制御部は、車体を正常な走行状態に戻すことができる。 The transport vehicle further includes a first drive unit and a second drive unit provided at different positions in the width direction of the vehicle body, and a drive control unit that controls the first drive unit and the second drive unit. The drive control unit may correct the deviation between the first distance information and the second distance information by setting the first drive unit and the second drive unit to different rotation speeds. As a result, the drive control unit can return the vehicle body to the normal traveling state.

第1の距離取得部及び第2の距離取得部の各々は、引き出されたラインの長さを検出するラインエンコーダと、基準位置設定部材に設けられ、ラインの端部を固定して位置決めする位置決め部と、を備えてよい。このように、第1の距離取得部及び第2の距離取得部は、ラインエンコーダを用いることで、正確に距離を取得することができる。 Each of the first distance acquisition unit and the second distance acquisition unit is provided on a line encoder for detecting the length of the drawn line and a reference position setting member, and is positioned to fix and position the end of the line. It may be equipped with a part. As described above, the first distance acquisition unit and the second distance acquisition unit can accurately acquire the distance by using the line encoder.

本発明によれば、走行環境によらず、正確に自動制御を行うことができる搬送車両を提供することができる。 According to the present invention, it is possible to provide a transport vehicle capable of accurately performing automatic control regardless of the traveling environment.

本実施形態に係る搬送車両が荷物の積み降ろしを行っている様子を示す概略図である。It is a schematic diagram which shows the state that the transport vehicle which concerns on this embodiment carries out loading and unloading of cargo. 本実施形態に係る搬送車両の概略構成を示す概略構成図である。It is a schematic block diagram which shows the schematic structure of the transport vehicle which concerns on this embodiment. 各走行状態を示す概念図である。It is a conceptual diagram which shows each running state. 制御部の処理内容を示すフローチャートである。It is a flowchart which shows the processing content of a control part.

以下、本発明の実施形態について、図面を参照して詳細に説明する。 Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.

図1は、本実施形態に係る搬送車両1が荷物Wの積み降ろしを行っている様子を示す概略図である。搬送車両1は、トラックTの荷台やコンテナなどの収容体Cの内部で荷物Wの積み降ろしを行う。図1に示す例においては、搬送車両1は、収容体Cとして、トラックTの荷台の内部で作業を行っている。トラックTは、駐車スペースPにて停車している。駐車スペースPの後側(建屋側)には、当該駐車スペースPから上方へ立ち上がった段差部Sが形成されている。トラックTは、段差部Sに対して収容体Cの後端部の扉を開いた状態で、停車する。搬送車両1は、段差部Sから収容体Cの内部へ進入するように走行を行う。また、搬送車両1は、収容体Cの内部から外部へ出て、段差部Sへ戻るように走行を行う。 FIG. 1 is a schematic view showing a state in which the transport vehicle 1 according to the present embodiment is loading and unloading the cargo W. The transport vehicle 1 loads and unloads the luggage W inside the housing body C such as the loading platform and the container of the truck T. In the example shown in FIG. 1, the transport vehicle 1 works as the housing C inside the loading platform of the truck T. The truck T is stopped at the parking space P. On the rear side (building side) of the parking space P, a step portion S rising upward from the parking space P is formed. The truck T stops with the door at the rear end of the housing body C open with respect to the step portion S. The transport vehicle 1 travels so as to enter the inside of the housing body C from the step portion S. Further, the transport vehicle 1 travels so as to go out from the inside of the housing body C to the outside and return to the step portion S.

搬送車両1は、自動的に走行を行うと共に、自動的に荷物Wの積み降ろしを行う自走式の車両である。搬送車両1は、走行を行う車体2と、荷物Wの積み降ろしを行う荷役部3と、を備える。車体2は、複数の車輪を備え、当該車輪を駆動させることで、前後方向への走行を行う。荷役部3は、荷物Wを保持する保持部6と、保持部6を移動させるアーム部7と、を備える。アーム部7の一方の端部は車体2に固定され、他方の端部には保持部6が固定されている。アーム部7は複数の関節部及び複数のリンク部によって構成されている。 The transport vehicle 1 is a self-propelled vehicle that automatically travels and automatically loads and unloads the cargo W. The transport vehicle 1 includes a vehicle body 2 for traveling and a cargo handling unit 3 for loading and unloading the luggage W. The vehicle body 2 is provided with a plurality of wheels, and by driving the wheels, the vehicle body 2 travels in the front-rear direction. The cargo handling unit 3 includes a holding unit 6 for holding the cargo W and an arm unit 7 for moving the holding unit 6. One end of the arm portion 7 is fixed to the vehicle body 2, and the holding portion 6 is fixed to the other end. The arm portion 7 is composed of a plurality of joint portions and a plurality of link portions.

次に、図2を参照して、搬送車両1の構成について更に詳細に説明する。図2は、本実施形態に係る搬送車両1の概略構成を示す概略構成図である。本実施形態における搬送車両1は、外部から収容体Cへ進入する際に、または収容体Cから外部へ出る際に、前後方向に真っ直ぐに直進するように、自動走行を行う。図2に示すように、搬送車両1は、車体2に加えて、基準位置設定部材10と、距離取得部11A,11B(第1の距離取得部、第2の距離取得部)と、駆動部12A,12B(第1の駆動部、第2の駆動部)と、制御部20と、を備える。 Next, the configuration of the transport vehicle 1 will be described in more detail with reference to FIG. FIG. 2 is a schematic configuration diagram showing a schematic configuration of the transport vehicle 1 according to the present embodiment. The transport vehicle 1 in the present embodiment automatically travels so as to go straight in the front-rear direction when entering the accommodating body C from the outside or when exiting from the accommodating body C. As shown in FIG. 2, in addition to the vehicle body 2, the transport vehicle 1 includes a reference position setting member 10, distance acquisition units 11A and 11B (first distance acquisition unit, second distance acquisition unit), and a drive unit. 12A and 12B (first drive unit, second drive unit) and control unit 20 are provided.

基準位置設定部材10は、収容体Cの外部に配置されて車体2の基準位置を設定するための部材である。基準位置設定部材10は、収容体Cの後端部の開口部から更に後方へ離間した位置に配置されており、ここでは、段差部Sに配置されている(図1参照)。基準位置設定部材10は、車体2が収容体Cの外部から収容体C内へ進入しようとするときに、車体2の走行開始位置に配置される。基準位置設定部材10は、車体2の幅方向に沿って延びるような形状を有している。ここでは、基準位置設定部材10は、車体2の幅方向に沿って延びる直方体の形状を有している。 The reference position setting member 10 is a member arranged outside the housing body C to set the reference position of the vehicle body 2. The reference position setting member 10 is arranged at a position further rearward from the opening at the rear end of the accommodating body C, and is arranged at the step portion S here (see FIG. 1). The reference position setting member 10 is arranged at the traveling start position of the vehicle body 2 when the vehicle body 2 tries to enter the accommodation body C from the outside of the housing body C. The reference position setting member 10 has a shape extending along the width direction of the vehicle body 2. Here, the reference position setting member 10 has the shape of a rectangular parallelepiped extending along the width direction of the vehicle body 2.

距離取得部11A,11Bは、車体2と基準位置設定部材10との間の距離に関する情報を取得する。距離取得部11Aと距離取得部11Bとは、車体2の幅方向において互いに異なる箇所と、基準位置設定部材10との間の距離をそれぞれ取得する。本実施形態では、距離取得部11Aは車体2の幅方向における一方の端部2a付近に設けられ、距離取得部11Bは車体2の幅方向における他方の端部2b付近に設けられる。距離取得部11A,11Bは、ラインエンコーダ21A,21Bと、位置決め部22A,22Bと、を備えて構成される。 The distance acquisition units 11A and 11B acquire information regarding the distance between the vehicle body 2 and the reference position setting member 10. The distance acquisition unit 11A and the distance acquisition unit 11B acquire distances between different points in the width direction of the vehicle body 2 and the reference position setting member 10. In the present embodiment, the distance acquisition unit 11A is provided near one end 2a in the width direction of the vehicle body 2, and the distance acquisition unit 11B is provided near the other end 2b in the width direction of the vehicle body 2. The distance acquisition units 11A and 11B include line encoders 21A and 21B and positioning units 22A and 22B.

ラインエンコーダ21A,21Bは、引き出されたライン21aの長さを検出するエンコーダである。ラインエンコーダ21A,21Bは、車体2の後端側の任意の位置に設けられる。ラインエンコーダ21A,21Bは、前後方向において互いに同位置に配置される。ラインエンコーダ21Aは車体2の幅方向における一方の端部2a付近に設けられ、ラインエンコーダ21Bは車体2の幅方向における他方の端部2b付近に設けられる。本実施形態では、ラインエンコーダ21A,21Bは、車体2の後側の車輪26A,26Bよりも前側に設けられている。従って、ラインエンコーダ21A,21Bから引き出されたライン21aは、後側の車輪26A,26Bの車軸などと干渉しないように、車軸を回避するように配置される。ただし、ラインエンコーダ21A,21Bの前後方向における位置は特に限定されず、後側の車輪26A,26Bより後側に設けられてもよい。 The line encoders 21A and 21B are encoders that detect the length of the drawn line 21a. The line encoders 21A and 21B are provided at arbitrary positions on the rear end side of the vehicle body 2. The line encoders 21A and 21B are arranged at the same position in the front-rear direction. The line encoder 21A is provided near one end 2a in the width direction of the vehicle body 2, and the line encoder 21B is provided near the other end 2b in the width direction of the vehicle body 2. In the present embodiment, the line encoders 21A and 21B are provided on the front side of the wheels 26A and 26B on the rear side of the vehicle body 2. Therefore, the line 21a drawn from the line encoders 21A and 21B is arranged so as to avoid the axle so as not to interfere with the axles of the rear wheels 26A and 26B. However, the positions of the line encoders 21A and 21B in the front-rear direction are not particularly limited, and may be provided on the rear side of the rear wheels 26A and 26B.

位置決め部22A,22Bは、基準位置設定部材10に設けられ、ライン21aの端部を固定して位置決めする部分である。位置決め部22A,22Bは、ライン21aの端部を着脱可能に固定することができるブラケットによって構成される。位置決め部22A,22Bは、基準位置設定部材10の前側の端部10aに形成される。位置決め部22Aの幅方向の位置は、ラインエンコーダ21Aと同位置に設定される。位置決め部22Bの幅方向の位置は、ラインエンコーダ21Bと同位置に設定される。 The positioning portions 22A and 22B are provided on the reference position setting member 10 and are portions for fixing and positioning the end portion of the line 21a. The positioning portions 22A and 22B are configured by brackets to which the ends of the lines 21a can be detachably fixed. The positioning portions 22A and 22B are formed at the front end portion 10a of the reference position setting member 10. The position of the positioning portion 22A in the width direction is set to the same position as that of the line encoder 21A. The position of the positioning portion 22B in the width direction is set to the same position as that of the line encoder 21B.

上述のような構成により、車体2が基準位置設定部材10から離れるに従って、ラインエンコーダ21A,21Bから引き出されるライン21aの長さが長くなる。車体2が直進している状態にあるとき(図3(a)に示す状態)、ラインエンコーダ21Aから引き出されるライン21aの長さと、ラインエンコーダ21Bから引き出されるライン21aの長さとは、等しくなる。一方、車体2が直進状態から傾いた姿勢となったとき(図3(b)に示す状態)、ラインエンコーダ21Aから引き出されるライン21aの長さと、ラインエンコーダ21Bから引き出されるライン21aの長さとは、互いに異なる。 With the above configuration, the length of the line 21a drawn out from the line encoders 21A and 21B becomes longer as the vehicle body 2 is separated from the reference position setting member 10. When the vehicle body 2 is traveling straight (the state shown in FIG. 3A), the length of the line 21a drawn from the line encoder 21A and the length of the line 21a drawn from the line encoder 21B are equal. On the other hand, when the vehicle body 2 is tilted from the straight running state (the state shown in FIG. 3B), what is the length of the line 21a drawn from the line encoder 21A and the length of the line 21a drawn from the line encoder 21B? , Different from each other.

ラインエンコーダ21A,21Bは、引き出されたライン21aの長さを制御部20へ出力する。ラインエンコーダ21Aから引き出されたライン21aの長さは、車体2の一方の端部2a付近と基準位置設定部材10との間の距離の変化に伴って変化する値であるため、車体2の一方の端部2a付近と基準位置設定部材10との間の距離に関する情報に該当する。従って、以下の説明では、ラインエンコーダ21Aが検出したライン21aの長さの情報を「第1の距離情報」と称する場合がある。ラインエンコーダ21Bから引き出されたライン21aの長さは、車体2の他方の端部2b付近と基準位置設定部材10との間の距離の変化に伴って変化する値であるため、車体2の他方の端部2b付近と基準位置設定部材10との間の距離に関する情報に該当する。従って、以下の説明では、ラインエンコーダ21Bが検出したライン21aの長さの情報を「第2の距離情報」と称する場合がある。 The line encoders 21A and 21B output the length of the drawn line 21a to the control unit 20. Since the length of the line 21a drawn from the line encoder 21A is a value that changes with a change in the distance between the vicinity of one end 2a of the vehicle body 2 and the reference position setting member 10, one of the vehicle bodies 2 Corresponds to the information regarding the distance between the vicinity of the end portion 2a and the reference position setting member 10. Therefore, in the following description, the information on the length of the line 21a detected by the line encoder 21A may be referred to as "first distance information". Since the length of the line 21a drawn from the line encoder 21B is a value that changes with a change in the distance between the vicinity of the other end 2b of the vehicle body 2 and the reference position setting member 10, the other end of the vehicle body 2 Corresponds to the information regarding the distance between the vicinity of the end portion 2b and the reference position setting member 10. Therefore, in the following description, the information on the length of the line 21a detected by the line encoder 21B may be referred to as "second distance information".

駆動部12A,12Bは、車体2が走行するための駆動力を発生する部分である。駆動部12A,12Bは、車体2の幅方向において互いに異なる位置に設けられている。具体的に、駆動部12Aは、一方の端部2a側における前側の車輪27Aと、当該車輪27Aを回転させるモータ28Aと、を備える。駆動部12Bは、他方の端部2b側における前側の車輪27Bと、当該車輪27Bを回転させるモータ28Bと、を備える。モータ28A,28Bは、制御部20からの制御信号を受信し、当該制御信号に基づいた回転数で車輪27A,27Bを回転させる。 The drive units 12A and 12B are portions that generate a driving force for the vehicle body 2 to travel. The drive units 12A and 12B are provided at different positions in the width direction of the vehicle body 2. Specifically, the drive unit 12A includes a front wheel 27A on one end 2a side and a motor 28A that rotates the wheel 27A. The drive unit 12B includes a front wheel 27B on the other end 2b side and a motor 28B that rotates the wheel 27B. The motors 28A and 28B receive the control signal from the control unit 20 and rotate the wheels 27A and 27B at a rotation speed based on the control signal.

制御部20は、搬送車両1全体を統括的に管理するECU[ElectronicControl Unit]を備えている。ECUは、CPU[Central Processing Unit]、ROM[Read Only Memory]、RAM[Random Access Memory]、CAN[Controller Area Network]通信回路等を有する電子制御ユニットである。ECUでは、例えば、ROMに記憶されているプログラムをRAMにロードし、RAMにロードされたプログラムをCPUで実行することにより各種の機能を実現する。ECUは、複数の電子ユニットから構成されていてもよい。制御部20は、走行状態取得部31と、駆動制御部32と、を備える。また、ECUは外部機器(WMS[Warehouse Management System]、WCS[Warehouse Control System]など)からの指令により制御する事も可能である。 The control unit 20 includes an ECU [Electronic Control Unit] that comprehensively manages the entire transport vehicle 1. The ECU is an electronic control unit having a CPU [Central Processing Unit], a ROM [Read Only Memory], a RAM [Random Access Memory], a CAN [Controller Area Network] communication circuit, and the like. In the ECU, for example, various functions are realized by loading the program stored in the ROM into the RAM and executing the program loaded in the RAM in the CPU. The ECU may be composed of a plurality of electronic units. The control unit 20 includes a traveling state acquisition unit 31 and a drive control unit 32. The ECU can also be controlled by a command from an external device (WMS [Warehouse Management System], WCS [Warehouse Control System], etc.).

走行状態取得部31は、車体2の走行状態を取得する。走行状態取得部31は、距離取得部11Aで取得された第1の距離情報と距離取得部11Bで取得された第2の距離情報とに基づいて、車体2の走行状態を取得する。走行状態取得部31は、第1の距離情報と第2の距離情報とが等しい場合、図3(a)に示すように車体2は直進状態にあり、正常な走行がなされていると判定する。走行状態取得部31は、第1の距離情報と第2の距離情報との間のずれに基づいて、車体の走行状態の異常を判定する。走行状態取得部31は、第1の距離情報と第2の距離情報との間のずれ量が閾値を超えた場合に、車体の走行状態に異常があると判定する。例えば、収容体Cの床面の状態によって車輪27A,27Bの何れかがスリップした場合や、収容体Cの床面の段差などによって車体2の向きが変わった場合などは、図3(b)に示すように、車体2が基準方向SDから傾斜した状態となる。この状態で車体2が自動走行を継続すると、車体2は蛇行走行などを行う可能性がある。よって、走行状態取得部31は、図3(b)のように車体2が基準方向SDから傾斜した場合は、走行状態に異常があると判定する。 The traveling state acquisition unit 31 acquires the traveling state of the vehicle body 2. The traveling state acquisition unit 31 acquires the traveling state of the vehicle body 2 based on the first distance information acquired by the distance acquisition unit 11A and the second distance information acquired by the distance acquisition unit 11B. When the first distance information and the second distance information are equal to each other, the traveling state acquisition unit 31 determines that the vehicle body 2 is in a straight-ahead state and is traveling normally as shown in FIG. 3A. .. The traveling state acquisition unit 31 determines an abnormality in the traveling state of the vehicle body based on the deviation between the first distance information and the second distance information. When the amount of deviation between the first distance information and the second distance information exceeds the threshold value, the traveling state acquisition unit 31 determines that the traveling state of the vehicle body is abnormal. For example, when either the wheels 27A or 27B slips depending on the condition of the floor surface of the housing body C, or when the direction of the vehicle body 2 changes due to a step on the floor surface of the housing body C, etc., FIG. 3B As shown in the above, the vehicle body 2 is in a state of being inclined from the reference direction SD. If the vehicle body 2 continues automatic traveling in this state, the vehicle body 2 may meander. Therefore, when the vehicle body 2 is tilted from the reference direction SD as shown in FIG. 3B, the traveling state acquisition unit 31 determines that the traveling state is abnormal.

駆動制御部32は、駆動部12A,12Bを制御する。駆動制御部32は、車体2が直進するように、駆動部12A及び駆動部12Bを同じ回転数で駆動させる。一方、走行状態に異常があるときは、駆動制御部32は、当該異常状態を補正するための制御を行う。駆動制御部32は、駆動部12A及び駆動部12Bを互いに異なる回転数とすることで、第1の距離情報と第2の距離情報との間のずれを補正する。例えば、車体2の一方の端部2aと基準位置設定部材10との間の距離が、他方の端部2bと基準位置設定部材10との間の距離よりも大きくなると、第1距離情報の値は第2距離情報の値より大きくなる。この場合、駆動制御部32は、駆動部12Bの回転数を駆動部12Aの回転数よりも相対的に大きくなるように制御する。これにより、車体2の他方の端部2b側の方が一方の端部2a側よりも速く走行するため、車体2の傾きが補正されて、直進状態に戻ることができる。 The drive control unit 32 controls the drive units 12A and 12B. The drive control unit 32 drives the drive unit 12A and the drive unit 12B at the same rotation speed so that the vehicle body 2 travels straight. On the other hand, when there is an abnormality in the traveling state, the drive control unit 32 performs control for correcting the abnormal state. The drive control unit 32 corrects the deviation between the first distance information and the second distance information by setting the drive unit 12A and the drive unit 12B to different rotation speeds. For example, when the distance between one end 2a of the vehicle body 2 and the reference position setting member 10 is larger than the distance between the other end 2b and the reference position setting member 10, the value of the first distance information Is larger than the value of the second distance information. In this case, the drive control unit 32 controls the rotation speed of the drive unit 12B so as to be relatively larger than the rotation speed of the drive unit 12A. As a result, the other end 2b side of the vehicle body 2 travels faster than the one end 2a side, so that the inclination of the vehicle body 2 is corrected and the vehicle can return to the straight-ahead state.

次に、図4を参照して、制御部20の処理内容の一例について説明する。図4は、制御部20の処理内容を示すフローチャートである。 Next, an example of the processing content of the control unit 20 will be described with reference to FIG. FIG. 4 is a flowchart showing the processing contents of the control unit 20.

図4に示すように、まず、制御部20の走行状態取得部31は、距離取得部11A,11Bから第1の距離情報及び第2距離情報を取得する(ステップS10)。次に、走行状態取得部31は、走行状態に異常があるか否かを判定する(ステップS20)。S20では、走行状態取得部31は、第1の距離情報と第2の距離情報とを比較し、両者のずれ、すなわち両者の値の差が所定の閾値の範囲内にあるか否かを判断する。走行状態取得部31は、第1の距離情報と第2の距離情報との値の差が閾値の範囲内にあると判断した場合は、車体2は直進状態(図3(a)参照)にあると判定し、走行状態に異常は無いと判定する。この場合、図4に示す処理が終了し、再びS10から処理を開始する。 As shown in FIG. 4, first, the traveling state acquisition unit 31 of the control unit 20 acquires the first distance information and the second distance information from the distance acquisition units 11A and 11B (step S10). Next, the traveling state acquisition unit 31 determines whether or not there is an abnormality in the traveling state (step S20). In S20, the traveling state acquisition unit 31 compares the first distance information and the second distance information, and determines whether or not the deviation between the two, that is, the difference between the two values is within a predetermined threshold range. do. When the traveling state acquisition unit 31 determines that the difference between the values of the first distance information and the second distance information is within the threshold range, the vehicle body 2 is in a straight-ahead state (see FIG. 3A). It is determined that there is no abnormality in the running state. In this case, the process shown in FIG. 4 is completed, and the process is started again from S10.

一方、S20において、走行状態取得部31が第1の距離情報と第2の距離情報との値の差が閾値を超えていると判断した場合は、車体2が基準方向SDから傾いている状態(図3(b)参照)にあると判定し、走行状態に異常があると判定する。この場合、駆動制御部32は、第1の距離情報と第2の距離情報との間のずれを補正する(ステップS30)。S30では、駆動制御部32は、駆動部12A及び駆動部12Bを互いに異なる回転数とすることで、第1の距離情報と前記第2の距離情報との間のずれを補正する。 On the other hand, in S20, when the traveling state acquisition unit 31 determines that the difference between the values of the first distance information and the second distance information exceeds the threshold value, the vehicle body 2 is tilted from the reference direction SD. (Refer to FIG. 3B), it is determined that there is an abnormality in the running state. In this case, the drive control unit 32 corrects the deviation between the first distance information and the second distance information (step S30). In S30, the drive control unit 32 corrects the deviation between the first distance information and the second distance information by setting the drive unit 12A and the drive unit 12B to different rotation speeds.

走行状態取得部31は、距離取得部11A,11Bから第1の距離情報及び第2距離情報を取得する(ステップS40)。次に、走行状態取得部31は、補正が完了して走行状態が正常に戻ったか否かを判定する(ステップS50)。S50では、走行状態取得部31は、第1の距離情報と第2の距離情報とを比較し、両者のずれ、すなわち両者の値の差が所定の閾値の範囲内にあるか否かを判断する。走行状態取得部31は、第1の距離情報と第2の距離情報との値の差が閾値の範囲内にあると判断した場合は、車体2は直進状態(図3(a)参照)に戻ったと判定し、補正が完了したと判定する。この場合、図4に示す処理が終了し、再びS10から処理を開始する。S50において、補正が完了していないと判定された場合、S30から処理が繰り返される。このとき、駆動制御部32は、駆動部12A,12Bの回転数を前回のS30で設定した値に維持し、当該回転数での補正を継続してもよく、前回のS30よりも更に回転数差を大きくしてもよい。 The traveling state acquisition unit 31 acquires the first distance information and the second distance information from the distance acquisition units 11A and 11B (step S40). Next, the traveling state acquisition unit 31 determines whether or not the correction is completed and the traveling state has returned to normal (step S50). In S50, the traveling state acquisition unit 31 compares the first distance information and the second distance information, and determines whether or not the deviation between the two, that is, the difference between the two values is within a predetermined threshold range. do. When the traveling state acquisition unit 31 determines that the difference between the values of the first distance information and the second distance information is within the threshold range, the vehicle body 2 is in a straight-ahead state (see FIG. 3A). It is determined that it has returned, and it is determined that the correction has been completed. In this case, the process shown in FIG. 4 is completed, and the process is started again from S10. If it is determined in S50 that the correction is not completed, the process is repeated from S30. At this time, the drive control unit 32 may maintain the rotation speeds of the drive units 12A and 12B at the values set in the previous S30 and continue the correction at the rotation speeds, and the rotation speeds are further higher than those in the previous S30. The difference may be large.

次に、本実施形態に係る搬送車両1の作用・効果について説明する。 Next, the operation / effect of the transport vehicle 1 according to the present embodiment will be described.

本実施形態に係る搬送車両1は、収容体Cの外部に配置されて車体の基準位置を設定する基準位置設定部材10と、車体2と基準位置設定部材10との間の距離に関する情報を取得する距離取得部11A及び距離取得部11Bと、を備える。例えば、車体2が直進状態から傾いた状態となった場合、車体2の幅方向における一方の端部2a側の部分と、他方の端部2b側の部分とでは、基準位置設定部材10に対する距離にずれが生じる。これに対し、距離取得部11Aと距離取得部11Bとは、車体2の幅方向において互いに異なる箇所と、基準位置設定部材10との間の距離に関する情報をそれぞれ取得する。従って、距離取得部11Aによって取得された第1の距離情報と距離取得部11Bによって取得された第2の距離情報を比較することにより、車体2の走行状態を正確に把握することができる。これにより、正確に搬送車両1の自動制御を行うことができる。そして、距離情報を取得するために用いられる基準位置設定部材10は、収容体Cの外部に配置されるものであるため、収容体Cが変わることで走行環境が変わった場合でも、再度の設置などは不要とすることができる。以上により、走行環境によらず、正確に自動制御を行うことができる。 The transport vehicle 1 according to the present embodiment acquires information on the distance between the reference position setting member 10 which is arranged outside the housing body C and sets the reference position of the vehicle body and the vehicle body 2 and the reference position setting member 10. The distance acquisition unit 11A and the distance acquisition unit 11B are provided. For example, when the vehicle body 2 is tilted from the straight traveling state, the distance between the portion on the one end 2a side and the portion on the other end 2b side in the width direction of the vehicle body 2 with respect to the reference position setting member 10. There is a gap. On the other hand, the distance acquisition unit 11A and the distance acquisition unit 11B acquire information on the distance between different points in the width direction of the vehicle body 2 and the reference position setting member 10. Therefore, by comparing the first distance information acquired by the distance acquisition unit 11A with the second distance information acquired by the distance acquisition unit 11B, the traveling state of the vehicle body 2 can be accurately grasped. As a result, the transport vehicle 1 can be accurately controlled automatically. Since the reference position setting member 10 used for acquiring the distance information is arranged outside the accommodating body C, it is installed again even if the traveling environment changes due to the change of the accommodating body C. Etc. can be eliminated. As described above, accurate automatic control can be performed regardless of the traveling environment.

搬送車両1は、車体2の走行状態を取得する走行状態取得部31を更に備え、走行状態取得部31は、距離取得部11Aで取得された第1の距離情報と距離取得部11Bで取得された第2の距離情報との間のずれに基づいて、車体2の走行状態の異常を判定する。このように、第1の距離情報と第2の距離情報とのずれを用いて、容易に走行状態の異常を把握することができる。 The transport vehicle 1 further includes a traveling state acquisition unit 31 that acquires the traveling state of the vehicle body 2, and the traveling state acquisition unit 31 is acquired by the first distance information acquired by the distance acquisition unit 11A and the distance acquisition unit 11B. Based on the deviation from the second distance information, the abnormality of the traveling state of the vehicle body 2 is determined. In this way, it is possible to easily grasp the abnormality of the traveling state by using the deviation between the first distance information and the second distance information.

搬送車両1は、車体2の幅方向において互いに異なる位置に設けられた駆動部12A及び駆動部12Bと、駆動部12A及び駆動部12Bを制御する駆動制御部32と、を更に備え、駆動制御部32は、駆動部12A及び駆動部12Bを互いに異なる回転数とすることで、第1の距離情報と第2の距離情報との間のずれを補正する。これにより、駆動制御部32は、車体2を正常な走行状態に戻すことができる。 The transport vehicle 1 further includes a drive unit 12A and a drive unit 12B provided at different positions in the width direction of the vehicle body 2, and a drive control unit 32 for controlling the drive unit 12A and the drive unit 12B. 32 corrects the deviation between the first distance information and the second distance information by setting the drive unit 12A and the drive unit 12B to different rotation speeds. As a result, the drive control unit 32 can return the vehicle body 2 to the normal traveling state.

距離取得部11A及び距離取得部11Bの各々は、引き出されたライン21aの長さを検出するラインエンコーダ21A,21Bと、基準位置設定部材10に設けられ、ライン21aの端部を固定して位置決めする位置決め部22A、22Bと、を備える。このように、距離取得部11A,11Bは、ラインエンコーダ21A,21Bを用いることで、正確に距離を取得することができる。なお、ラインエンコーダ21A,21Bを用いる場合、基準位置設定部材10に加え、ライン21aが、車体2の後側に存在する。従って、荷物Wを運ぶ際は、基準位置設定部材10及びライン21aと干渉しないように作業を行う。 Each of the distance acquisition unit 11A and the distance acquisition unit 11B is provided on the line encoders 21A and 21B for detecting the length of the drawn line 21a and the reference position setting member 10, and the end portion of the line 21a is fixed and positioned. The positioning portions 22A and 22B are provided. In this way, the distance acquisition units 11A and 11B can accurately acquire the distance by using the line encoders 21A and 21B. When the line encoders 21A and 21B are used, the line 21a exists on the rear side of the vehicle body 2 in addition to the reference position setting member 10. Therefore, when carrying the luggage W, the work is performed so as not to interfere with the reference position setting member 10 and the line 21a.

本発明は、上述の実施形態に限定されるものではない。 The present invention is not limited to the above-described embodiment.

上述の実施形態では、走行状態取得部31は、ラインエンコーダ21A,21Bの値をそのまま用いて各判定を行っていた。これに代えて、制御部20は、ラインエンコーダ21A,21Bの値を演算によって変換し(例えば、車体2の後端部と基準位置設定部材10との間の距離など)、走行状態取得部31は、当該変換された値を距離情報として用いてよい。この場合、制御部20も距離取得部として機能する。 In the above-described embodiment, the traveling state acquisition unit 31 makes each determination using the values of the line encoders 21A and 21B as they are. Instead, the control unit 20 converts the values of the line encoders 21A and 21B by calculation (for example, the distance between the rear end portion of the vehicle body 2 and the reference position setting member 10), and the traveling state acquisition unit 31. May use the converted value as distance information. In this case, the control unit 20 also functions as a distance acquisition unit.

また、上述の実施形態では、車体2の走行状態が正常である場合は、ラインエンコーダ21Aから引き出されるライン21aの長さと、ラインエンコーダ21Bから引き出されるライン21aの長さが同一となっていた。これに代えて、正常な走行状態のときに、ラインエンコーダ21Aから引き出されるライン21aの長さと、ラインエンコーダ21Bから引き出されるライン21aの長さが異なっていてもよい。例えば、車体2の構造上の都合により、前後方向におけるラインエンコーダ21Aとラインエンコーダ21Bの位置が異なっていてもよい。また、設置の都合により、前後方向における位置決め部22Aと位置決め部22Bの位置が異なっていてよい。また、位置決め部22A,22Bの幅方向における位置が、ラインエンコーダ21A,21Bに対してずれていてよい。このような場合、制御部20は、ラインエンコーダ21A,21Bの値を演算によって、第1の距離情報と第2の距離情報とを比較し易い値に変換してよい。 Further, in the above-described embodiment, when the traveling state of the vehicle body 2 is normal, the length of the line 21a drawn from the line encoder 21A and the length of the line 21a drawn from the line encoder 21B are the same. Instead of this, the length of the line 21a drawn out from the line encoder 21A and the length of the line 21a drawn out from the line encoder 21B may be different in the normal running state. For example, the positions of the line encoder 21A and the line encoder 21B in the front-rear direction may be different due to the structural convenience of the vehicle body 2. Further, the positions of the positioning portion 22A and the positioning portion 22B in the front-rear direction may be different depending on the convenience of installation. Further, the positions of the positioning portions 22A and 22B in the width direction may be deviated from those of the line encoders 21A and 21B. In such a case, the control unit 20 may convert the values of the line encoders 21A and 21B into values that make it easy to compare the first distance information and the second distance information.

例えば、距離取得部としてラインエンコーダが用いられていた。これに代えて、非接触型のセンサを用いて距離取得部を構成してもよい。例えば、車体2の幅方向の異なる位置にレーザーセンサを設け、基準位置設定部にレーザ光を反射する反射板を設けることで、距離取得部を構成してもよい。なお、この場合は、複数の測定器を車体2に設けているが、一つの測定器であっても、車体の幅方向において異なる位置の距離を測定することができるものであれば採用してもよい。例えば、一つの測定器の中に、幅方向に広がるようにレーザーの送受信部が並べられるように配置されている場合、車両の幅方向において異なる位置の距離を測定できる。この場合は、一つの測定器の中に第1の距離取得部と第2の距離取得部が含まれることになる。 For example, a line encoder was used as a distance acquisition unit. Instead of this, the distance acquisition unit may be configured by using a non-contact type sensor. For example, the distance acquisition unit may be configured by providing laser sensors at different positions in the width direction of the vehicle body 2 and providing a reflector for reflecting the laser light in the reference position setting unit. In this case, a plurality of measuring instruments are provided on the vehicle body 2, but even one measuring instrument is adopted as long as it can measure the distances at different positions in the width direction of the vehicle body. May be good. For example, when the transmission / reception units of lasers are arranged so as to spread in the width direction in one measuring instrument, the distances at different positions in the width direction of the vehicle can be measured. In this case, the first distance acquisition unit and the second distance acquisition unit are included in one measuring instrument.

1…搬送車両、2…車体、10…基準位置設定部材、11A…距離取得部(第1の距離取得部)、11B…距離取得部(第2の距離取得部)、12A…駆動部(第1の駆動部)、12B…駆動部(第2の駆動部)、21A,21B…ラインエンコーダ、21a…ライン、22A,22B…位置決め部。 1 ... Transport vehicle, 2 ... Body, 10 ... Reference position setting member, 11A ... Distance acquisition unit (first distance acquisition unit), 11B ... Distance acquisition unit (second distance acquisition unit), 12A ... Drive unit (first) 1 drive unit), 12B ... drive unit (second drive unit), 21A, 21B ... line encoder, 21a ... line, 22A, 22B ... positioning unit.

Claims (4)

収容体の内部で荷物の積み降ろしを行う自走式の搬送車両であって、
走行を行う車体と、
前記収容体の外部に配置されて前記車体の基準位置を設定する基準位置設定部材と、
前記車体と前記基準位置設定部材との間の距離に関する情報を取得する第1の距離取得部及び第2の距離取得部と、を備え、
前記第1の距離取得部と前記第2の距離取得部とは、前記車体の幅方向において互いに異なる箇所と、前記基準位置設定部材との間の距離に関する情報をそれぞれ取得する、搬送車両。
A self-propelled transport vehicle that loads and unloads luggage inside the containment body.
The car body that runs and
A reference position setting member arranged outside the housing and setting a reference position of the vehicle body,
A first distance acquisition unit and a second distance acquisition unit for acquiring information regarding the distance between the vehicle body and the reference position setting member are provided.
The first distance acquisition unit and the second distance acquisition unit are transport vehicles that acquire information on distances between locations different from each other in the width direction of the vehicle body and the reference position setting member.
前記車体の走行状態を取得する走行状態取得部を更に備え、
前記走行状態取得部は、前記第1の距離取得部で取得された第1の距離情報と前記第2の距離取得部で取得された第2の距離情報との間のずれに基づいて、前記車体の走行状態の異常を判定する、請求項1に記載の搬送車両。
Further provided with a running state acquisition unit for acquiring the running state of the vehicle body,
The traveling state acquisition unit is based on the deviation between the first distance information acquired by the first distance acquisition unit and the second distance information acquired by the second distance acquisition unit. The transport vehicle according to claim 1, wherein an abnormality in the traveling state of the vehicle body is determined.
前記車体の前記幅方向において互いに異なる位置に設けられた第1の駆動部及び第2の駆動部と、
前記第1の駆動部及び前記第2の駆動部を制御する駆動制御部と、を更に備え、
前記駆動制御部は、前記第1の駆動部及び前記第2の駆動部を互いに異なる回転数とすることで、前記第1の距離情報と前記第2の距離情報との間のずれを補正する、請求項2に記載の搬送車両。
A first drive unit and a second drive unit provided at different positions in the width direction of the vehicle body,
A drive control unit that controls the first drive unit and the second drive unit is further provided.
The drive control unit corrects the deviation between the first distance information and the second distance information by setting the first drive unit and the second drive unit to different rotation speeds. , The transport vehicle according to claim 2.
前記第1の距離取得部及び前記第2の距離取得部の各々は、
引き出されたラインの長さを検出するラインエンコーダと、
前記基準位置設定部材に設けられ、前記ラインの端部を固定して位置決めする位置決め部と、を備える、請求項1〜3の何れか一項に記載の搬送車両。
Each of the first distance acquisition unit and the second distance acquisition unit
A line encoder that detects the length of the drawn line,
The transport vehicle according to any one of claims 1 to 3, further comprising a positioning portion provided on the reference position setting member and fixing and positioning an end portion of the line.
JP2018120118A 2018-06-25 2018-06-25 Transport vehicle Active JP6950629B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018120118A JP6950629B2 (en) 2018-06-25 2018-06-25 Transport vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018120118A JP6950629B2 (en) 2018-06-25 2018-06-25 Transport vehicle

Publications (2)

Publication Number Publication Date
JP2020001845A JP2020001845A (en) 2020-01-09
JP6950629B2 true JP6950629B2 (en) 2021-10-13

Family

ID=69098443

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018120118A Active JP6950629B2 (en) 2018-06-25 2018-06-25 Transport vehicle

Country Status (1)

Country Link
JP (1) JP6950629B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7489013B2 (en) * 2020-08-03 2024-05-23 中西金属工業株式会社 Automated Guided Vehicle System

Also Published As

Publication number Publication date
JP2020001845A (en) 2020-01-09

Similar Documents

Publication Publication Date Title
US7561254B2 (en) Traveling system for mobile bodies and control method therefor
CN110554690B (en) Positioning method and system of intelligent trolley
WO2020203253A1 (en) Weight estimation system
US11608063B2 (en) Vehicle safe stop
JP6950629B2 (en) Transport vehicle
EP3838672B1 (en) Autonomous vehicle and method for controlling it
JP6368147B2 (en) Parking system
JP2008052324A (en) Conveyance vehicle and conveyance vehicle system
JP2022028342A (en) Unmanned conveyance vehicle system
JP3524695B2 (en) Positioning device for loading cargo
JP6362815B2 (en) Optical axis control device for headlamps
JP6111684B2 (en) Automated guided vehicle
JP2011118585A (en) Automated guided vehicle
JP2022181514A (en) Drive control device of vehicle, drive control method of vehicle, drive system of vehicle, and vehicle
JP2003073093A (en) Automated forklift
CN117083504A (en) Method, system and computer program product for determining yaw-rate offset value
US11027776B2 (en) System and method for adapting parameters used in target slip estimation
WO2016013372A1 (en) Transport vehicle
JP6254908B2 (en) Parking system
JP2008250589A (en) Wheel radius estimation device
CN112407046B (en) Vehicle control method and vehicle control system
WO2024057487A1 (en) Mobile body and mobile body system
CN111766856A (en) Automatic guide transport vehicle, auxiliary positioning method and system thereof and vehicle-mounted controller
JP7370288B2 (en) Computing devices, vehicles, cargo handling systems, computing methods and programs
JP2853459B2 (en) Vehicle transfer method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200904

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20210726

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210906

R151 Written notification of patent or utility model registration

Ref document number: 6950629

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151