JP2021111138A - Transport vehicle, travel monitoring method, and mast monitoring method - Google Patents

Transport vehicle, travel monitoring method, and mast monitoring method Download PDF

Info

Publication number
JP2021111138A
JP2021111138A JP2020002845A JP2020002845A JP2021111138A JP 2021111138 A JP2021111138 A JP 2021111138A JP 2020002845 A JP2020002845 A JP 2020002845A JP 2020002845 A JP2020002845 A JP 2020002845A JP 2021111138 A JP2021111138 A JP 2021111138A
Authority
JP
Japan
Prior art keywords
mast
transport vehicle
height
obstacle sensor
obstacle
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.)
Granted
Application number
JP2020002845A
Other languages
Japanese (ja)
Other versions
JP7363495B2 (en
Inventor
裕司 石原
Yuji Ishihara
裕司 石原
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 JP2020002845A priority Critical patent/JP7363495B2/en
Publication of JP2021111138A publication Critical patent/JP2021111138A/en
Application granted granted Critical
Publication of JP7363495B2 publication Critical patent/JP7363495B2/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)

Abstract

To prevent a load or a mast from colliding with an obstacle when the height of the obstacle, the load loaded on the transport vehicle, or the mast provided on the transport vehicle changes.SOLUTION: A transport vehicle Ve calculates a height H1 of a load A with reference to the height of an obstacle sensor 1 using a detection result of the obstacle sensor 1 and prohibits or stops the transport vehicle from traveling when an obstacle is detected by the obstacle sensor 1 in a range of an angle θc between a direction c1 passing through a point away from the obstacle sensor 1 by a distance Lc in the direction of travel of the transport vehicle Ve and a direction c2 passing through a point away from the obstacle sensor 1 by a distance Lc in the direction of travel of the transport vehicle Ve and at a distance of the height H1 of the load A in the direction of the height H1 of the load A.SELECTED DRAWING: Figure 1

Description

本発明は、搬送車並びにその搬送車に適用される走行監視方法及びマスト監視方法に関する。 The present invention relates to a transport vehicle and a traveling monitoring method and a mast monitoring method applied to the transport vehicle.

搬送車として、搬送車の走行方向にある障害物を検知する障害物センサを備え、障害物センサの検知結果により搬送車の走行を制御するものがある。関連する技術として、特許文献1がある。 Some transport vehicles are provided with an obstacle sensor that detects an obstacle in the traveling direction of the transport vehicle, and control the travel of the transport vehicle based on the detection result of the obstacle sensor. Patent Document 1 is a related technique.

ところで、障害物(クレーンやシャッタなど)や搬送車に積載される荷や搬送車に備えられるマストの高さは、その時々で様々な高さに変化する可能性がある。 By the way, the height of obstacles (crane, shutter, etc.), the load loaded on the transport vehicle, and the mast provided on the transport vehicle may change to various heights from time to time.

そのため、上記搬送車では、障害物の高さが障害物センサにより検知できない高さに変化したり、荷やマストの高さが変化して荷やマストの高さが不明になったりすると、荷やマストを障害物に衝突させてしまうおそれがある。 Therefore, in the above-mentioned transport vehicle, if the height of the obstacle changes to a height that cannot be detected by the obstacle sensor, or if the height of the load or mast changes and the height of the load or mast becomes unknown, the load is loaded. And the mast may collide with obstacles.

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

本発明の一側面に係る目的は、障害物や搬送車に積載される荷や搬送車に備えられるマストの高さが変化する場合において、荷やマストが障害物に衝突することを抑制することが可能な搬送車並びにその搬送車に適用される走行監視方法及びマスト監視方法を提供することである。 An object of one aspect of the present invention is to prevent a load or mast from colliding with an obstacle when the height of a load loaded on an obstacle or a transport vehicle or a mast provided on the transport vehicle changes. It is to provide a transport vehicle capable of the above, and a traveling monitoring method and a mast monitoring method applied to the transport vehicle.

本発明に係る一つの形態である搬送車は、荷が車体に積載される搬送車またはマストを備える搬送車であって、障害物センサと、搬送車の走行を制御する制御部とを備える。 The transport vehicle according to the present invention is a transport vehicle including a transport vehicle or a mast on which a load is loaded on a vehicle body, and includes an obstacle sensor and a control unit for controlling the traveling of the transport vehicle.

制御部は、障害物センサの検知結果を用いて障害物センサの高さを基準とする荷またはマストの高さを算出し、障害物センサから搬送車の走行方向に第1距離離れた位置を通る方向と、障害物センサから搬送車の走行方向に第1距離離れ、さらに荷またはマストの高さの方向に荷またはマストの高さの距離離れた位置を通る方向とがなす角度の範囲に、障害物センサにより障害物が検知されると、搬送車の走行を禁止または停止させる。 The control unit calculates the height of the load or mast based on the height of the obstacle sensor using the detection result of the obstacle sensor, and determines the position one distance away from the obstacle sensor in the traveling direction of the transport vehicle. Within the range of the angle between the passing direction and the direction of passing the obstacle sensor by the first distance in the traveling direction of the transport vehicle and further in the direction of the height of the load or mast by the distance of the height of the load or mast. When an obstacle is detected by the obstacle sensor, the traveling vehicle is prohibited or stopped.

これにより、搬送車の走行方向において荷あるいはマストの高さと同じ位置の障害物または荷あるいはマストの高さより低い位置の障害物を障害物センサが検知して搬送車の走行を禁止または停止させることができるため、障害物や荷やマストの高さが変化する場合であっても、荷やマストが障害物に衝突することを抑制することができる。 As a result, the obstacle sensor detects an obstacle at the same position as the height of the load or mast or an obstacle at a position lower than the height of the load or mast in the traveling direction of the transport vehicle, and prohibits or stops the traveling of the transport vehicle. Therefore, even when the height of the obstacle, the load, or the mast changes, it is possible to prevent the load or the mast from colliding with the obstacle.

また、制御部は、障害物センサから搬送車の走行方向に第1距離より長い第2距離離れた位置を通る方向と、障害物センサから搬送車の走行方向に第2距離離れ、さらに荷またはマストの高さの方向に荷またはマストの高さの距離離れた位置を通る方向とがなす角度の範囲に、障害物センサにより障害物が検知されると、搬送車の走行方向に障害物がある旨を、搬送車の走行を制御する上位制御装置に送信するように構成してもよい。 Further, the control unit passes through a position that is longer than the first distance by a second distance in the traveling direction of the transport vehicle from the obstacle sensor, and is separated by a second distance in the traveling direction of the transport vehicle from the obstacle sensor, and is further loaded or loaded. When an obstacle is detected by the obstacle sensor within the range of the angle formed by the load or the direction of passing the mast at a distance in the direction of the mast height, an obstacle is detected in the traveling direction of the transport vehicle. A certain fact may be configured to be transmitted to a higher-level control device that controls the traveling of the transport vehicle.

これにより、上位制御装置は、搬送車の走行方向に障害物がある旨を受信すると、搬送車の走行を禁止または停止させたり、搬送車の走行経路を変更させたりすることができるため、荷やマストが障害物に衝突することを抑制することができる。 As a result, when the host control device receives that there is an obstacle in the traveling direction of the transport vehicle, it can prohibit or stop the traveling of the transport vehicle or change the traveling route of the transport vehicle. And the mast can be prevented from colliding with obstacles.

また、制御部は、荷の高さが変動した場合、荷の高さが変動した旨を、搬送車の走行を制御する上位制御装置に送信するように構成してもよい。 Further, when the height of the load fluctuates, the control unit may be configured to transmit the fact that the height of the load has fluctuated to a higher-level control device that controls the traveling of the transport vehicle.

これにより、上記制御装置は、荷の高さが変動した旨を受信したときの搬送車の現在位置が移載場所でない場合、搬送車の走行を禁止または停止させることができるため、荷崩れなどが発生して荷の高さがさらに変動することを抑制することができる。 As a result, the control device can prohibit or stop the traveling of the transport vehicle when the current position of the transport vehicle when receiving the notification that the height of the load has changed is not the transfer location, so that the load collapses, etc. Can be prevented from further fluctuating the height of the load due to the occurrence of.

本発明に係る一つの形態である搬送車は、マストと、障害物センサと、マストの昇降を制御する制御部とを備える。 A transport vehicle according to the present invention includes a mast, an obstacle sensor, and a control unit that controls the raising and lowering of the mast.

制御部は、障害物センサの検知結果を用いて障害物センサの高さを基準とする搬送車の上方向にある障害物までの高さよりも低い第1の高さを算出するとともに、障害物センサの検知結果を用いて障害物センサの高さを基準とするマストの上端部までの第2の高さを算出し、第2の高さが第1の高さ以上になると、マストの上昇を禁止または停止させる。 The control unit uses the detection result of the obstacle sensor to calculate the first height, which is lower than the height to the obstacle in the upward direction of the transport vehicle based on the height of the obstacle sensor, and the obstacle. The second height to the upper end of the mast is calculated based on the height of the obstacle sensor using the detection result of the sensor, and when the second height becomes equal to or higher than the first height, the mast rises. Prohibit or stop.

これにより、マストが天井などの障害物に衝突する前にマストの上昇を禁止または停止させることができるため、マストが天井などの障害物に衝突することを抑制することができる。 As a result, it is possible to prohibit or stop the mast from rising before it collides with an obstacle such as the ceiling, so that it is possible to prevent the mast from colliding with an obstacle such as the ceiling.

本発明に係る一つの形態である搬送車は、マストと、搬送車の車体上面に設けられる障害物センサと、マストの昇降を制御する制御部とを備える。 The transport vehicle according to the present invention includes a mast, an obstacle sensor provided on the upper surface of the vehicle body of the transport vehicle, and a control unit for controlling the raising and lowering of the mast.

制御部は、障害物センサを基準としてマストの上端部から下方に伸びる垂線と搬送車の車体上面との交点を通る方向と、障害物センサから最大上昇時のマストの上端部を通る方向とがなす角度の範囲に、障害物センサによりマスト以外の障害物が検知されると、マストの上昇を禁止させる。 The control unit has a direction that passes through the intersection of the vertical line extending downward from the upper end of the mast and the upper surface of the vehicle body of the transport vehicle with the obstacle sensor as a reference, and a direction that passes through the upper end of the mast when the mast rises from the obstacle sensor to the maximum. When an obstacle other than the mast is detected by the obstacle sensor within the range of the angle to be formed, the mast is prohibited from rising.

これにより、マストの上昇開始直前において、マストが天井などの障害物に衝突する可能性があるときにマストの上昇を禁止させることができるため、マストが天井などの障害物に衝突することを抑制することができる。 This makes it possible to prohibit the mast from rising when the mast may collide with an obstacle such as the ceiling immediately before the mast starts to rise, thus suppressing the mast from colliding with an obstacle such as the ceiling. can do.

本発明に係る一つの形態である走行監視方法は、荷が車体に積載される搬送車またはマストを備える搬送車の制御部により実行される走行監視方法であって、制御部が、障害物センサの検知結果を用いて障害物センサの高さを基準とする荷またはマストの高さを算出し、障害物センサから搬送車の走行方向に第1距離離れた位置を通る方向と、障害物センサから搬送車の走行方向に第1距離離れ、さらに荷またはマストの高さの方向に荷またはマストの高さの距離離れた位置を通る方向とがなす角度の範囲に、障害物センサにより障害物が検知されると、搬送車の動向を禁止または停止させる。 The travel monitoring method, which is one embodiment of the present invention, is a travel monitoring method executed by a control unit of a transport vehicle or a transport vehicle having a mast on which a load is loaded on a vehicle body, and the control unit is an obstacle sensor. The height of the load or mast is calculated based on the height of the obstacle sensor using the detection result of, and the direction of passing the first distance away from the obstacle sensor in the traveling direction of the transport vehicle and the obstacle sensor Obstacles by the obstacle sensor within the range of the angle formed by the first distance away from the traveling direction of the transport vehicle and the direction of passing the load or mast height distance away from the load or mast height. When is detected, the movement of the transport vehicle is prohibited or stopped.

これにより、搬送車の走行方向において荷あるいはマストの高さと同じ位置の障害物または荷あるいはマストの高さより低い位置の障害物を障害物センサが検知して搬送車の走行を禁止または停止させることができるため、障害物や荷やマストの高さが変化する場合であっても、荷やマストが障害物に衝突することを抑制することができる。 As a result, the obstacle sensor detects an obstacle at the same position as the height of the load or mast or an obstacle at a position lower than the height of the load or mast in the traveling direction of the transport vehicle, and prohibits or stops the traveling of the transport vehicle. Therefore, even when the height of the obstacle, the load, or the mast changes, it is possible to prevent the load or the mast from colliding with the obstacle.

本発明に係る一つの形態であるマスト監視方法は、マストと、障害物センサと、マストの昇降を制御する制御部とを備える搬送車において、制御部により実行されるマスト監視方法であって、制御部が、障害物センサの検知結果を用いて障害物センサの高さを基準とする搬送車の上方向にある障害物までの高さよりも低い第1の高さを算出するとともに、障害物センサの検知結果を用いて障害物センサの高さを基準とするマストの上端部までの第2の高さを算出し、第2の高さが第1の高さ以上になると、マストの上昇を禁止または停止させる。 The mast monitoring method, which is one embodiment of the present invention, is a mast monitoring method executed by the control unit in a transport vehicle including a mast, an obstacle sensor, and a control unit for controlling the raising and lowering of the mast. The control unit uses the detection result of the obstacle sensor to calculate the first height, which is lower than the height to the obstacle in the upward direction of the transport vehicle based on the height of the obstacle sensor, and the obstacle. The second height to the upper end of the mast is calculated based on the height of the obstacle sensor using the detection result of the sensor, and when the second height is equal to or higher than the first height, the mast rises. Prohibit or stop.

これにより、マストが天井などの障害物に衝突する前にマストの上昇を禁止または停止させることができるため、マストが天井などの障害物に衝突することを抑制することができる。 As a result, it is possible to prohibit or stop the mast from rising before it collides with an obstacle such as the ceiling, so that it is possible to prevent the mast from colliding with an obstacle such as the ceiling.

本発明に係る一つの形態であるマスト監視方法は、マストと、搬送車の車体上面に設けられる障害物センサと、マストの昇降を制御する制御部とを備える搬送車において、制御部により実行されるマスト監視方法であって、制御部が、障害物センサを基準としてマストの上端部から下方に伸びる垂線と搬送車の車体上面との交点を通る方向と、障害物センサから最大上昇時のマストの上端部を通る方向とがなす角度の範囲に、障害物センサによりマスト以外の障害物が検知されると、マストの上昇を禁止させる。 The mast monitoring method, which is one embodiment of the present invention, is executed by the control unit in a transport vehicle including the mast, an obstacle sensor provided on the upper surface of the vehicle body of the transport vehicle, and a control unit for controlling the raising and lowering of the mast. This is a mast monitoring method in which the control unit passes through the intersection of the vertical line extending downward from the upper end of the mast and the upper surface of the vehicle body of the transport vehicle with reference to the obstacle sensor, and the mast at the maximum rise from the obstacle sensor. When an obstacle other than the mast is detected by the obstacle sensor within the range of the angle formed by the direction passing through the upper end of the mast, the mast is prohibited from rising.

これにより、マストの上昇開始直前において、マストが天井などの障害物に衝突する可能性があるときにマストの上昇を禁止させることができるため、マストが天井などの障害物に衝突することを抑制することができる。 This makes it possible to prohibit the mast from rising when the mast may collide with an obstacle such as the ceiling immediately before the mast starts to rise, thus suppressing the mast from colliding with an obstacle such as the ceiling. can do.

本発明によれば、障害物や搬送車に積載される荷や搬送車に備えられるマストの高さが変化する場合において、荷やマストが障害物に衝突することを抑制することができる。 According to the present invention, it is possible to prevent the load or mast from colliding with the obstacle when the height of the load loaded on the obstacle or the transport vehicle or the mast provided on the transport vehicle changes.

第1実施形態の搬送車を示す図である。It is a figure which shows the transport vehicle of 1st Embodiment. 第1実施形態の走行監視方法を示すフローチャートである。It is a flowchart which shows the traveling monitoring method of 1st Embodiment. 第2実施形態の搬送車を示す図である。It is a figure which shows the transport vehicle of 2nd Embodiment. 第2実施形態の走行監視方法を示すフローチャートである。It is a flowchart which shows the traveling monitoring method of 2nd Embodiment. 第3実施形態の搬送車を示す図である。It is a figure which shows the transport vehicle of 3rd Embodiment. 第3実施形態のマスト監視方法を示すフローチャートである。It is a flowchart which shows the mast monitoring method of 3rd Embodiment. 第4実施形態の搬送車を示す図である。It is a figure which shows the transport vehicle of 4th Embodiment. 第4実施形態のマスト監視方法を示すフローチャートである。It is a flowchart which shows the mast monitoring method of 4th Embodiment.

以下図面に基づいて実施形態について詳細を説明する。
<第1実施形態>
図1は、第1実施形態の搬送車を示す図である。
Hereinafter, embodiments will be described in detail based on the drawings.
<First Embodiment>
FIG. 1 is a diagram showing a transport vehicle of the first embodiment.

図1に示す搬送車Veは、車体に荷Aを積載して走行する無人搬送車または有人搬送車などであり、障害物センサ1と、制御部2とを備える。 The automatic guided vehicle Ve shown in FIG. 1 is an automatic guided vehicle or a manned vehicle that travels with a load A loaded on the vehicle body, and includes an obstacle sensor 1 and a control unit 2.

障害物センサ1は、レーザー式障害物センサまたはステレオカメラなどにより構成される。また、障害物センサ1は、搬送車Veの車体上面に設けられ、車体の上方向において少なくとも180度の範囲の障害物(シャッタやクレーンなど)を検知する。 The obstacle sensor 1 is composed of a laser obstacle sensor, a stereo camera, or the like. Further, the obstacle sensor 1 is provided on the upper surface of the vehicle body of the transport vehicle Ve, and detects obstacles (shutters, cranes, etc.) in a range of at least 180 degrees in the upward direction of the vehicle body.

制御部2は、CPU(Central Processing Unit)またはプログラマブルなデバイス(FPGA(Field Programmable Gate Array)やPLD(Programmable Logic Device))などにより構成され、障害物センサ1の検知結果を用いて、搬送車Veの走行(速度など)を制御する。 The control unit 2 is composed of a CPU (Central Processing Unit) or a programmable device (FPGA (Field Programmable Gate Array) or PLD (Programmable Logic Device)), and uses the detection result of the obstacle sensor 1 to carry the vehicle Ve. Control the running (speed, etc.) of.

また、制御部2は、搬送車Veの状態を示す情報を上位制御装置3に送信し、その情報に基づいて上位制御装置3から送信される制御信号により、搬送車Veの速度や走行経路などを制御する。 Further, the control unit 2 transmits information indicating the state of the carrier vehicle Ve to the upper control device 3, and based on the information, the control signal transmitted from the upper control device 3 causes the speed and travel path of the carrier vehicle Ve, etc. To control.

また、制御部2は、制御タイミング毎に、走行監視方法を実行する。
図2は、第1実施形態の走行監視方法を示すフローチャートである。なお、図2に示すフローチャートは、搬送車Veの走行開始直前または走行中に実行されるものとする。
Further, the control unit 2 executes a travel monitoring method for each control timing.
FIG. 2 is a flowchart showing the traveling monitoring method of the first embodiment. The flowchart shown in FIG. 2 is assumed to be executed immediately before the start of traveling of the transport vehicle Ve or during traveling.

まず、制御部2は、障害物センサ1の検知結果を用いて、障害物センサ1の高さ(搬送車Veの車体上面の高さ)を基準とする荷Aの高さH1を算出する(ステップS11)。例えば、制御部2は、障害物センサ1を基準として荷Aの上端部から下方に伸びる垂線と搬送車Veの車体上面との交点a(荷Aの下端部)を通る方向a1と、障害物センサ1から荷Aの上端部を通る方向a2とがなす角度θaを取得し、高さH1=tan(θa)×(障害物センサ1から交点aまでの距離La)を計算することにより、高さH1を求める。 First, the control unit 2 calculates the height H1 of the load A based on the height of the obstacle sensor 1 (the height of the upper surface of the vehicle body of the transport vehicle Ve) by using the detection result of the obstacle sensor 1 ( Step S11). For example, the control unit 2 has a direction a1 passing through an intersection a (lower end of the load A) between a vertical line extending downward from the upper end of the load A and the upper surface of the vehicle body of the transport vehicle Ve with the obstacle sensor 1 as a reference, and an obstacle. The height is obtained by acquiring the angle θa formed by the sensor 1 and the direction a2 passing through the upper end of the load A, and calculating the height H1 = tan (θa) × (distance La from the obstacle sensor 1 to the intersection a). Find H1.

次に、制御部2は、高さH1が変動したか否かを判断する(ステップS12)。例えば、制御部2は、前回の制御タイミングで算出した高さH1と今回の制御タイミングで算出した高さH1との差が閾値以上である場合、高さH1が変動したと判断し、差が閾値より小さい場合、高さH1が変動していないと判断する。 Next, the control unit 2 determines whether or not the height H1 has fluctuated (step S12). For example, when the difference between the height H1 calculated at the previous control timing and the height H1 calculated at the current control timing is equal to or greater than the threshold value, the control unit 2 determines that the height H1 has fluctuated, and the difference is If it is smaller than the threshold value, it is determined that the height H1 does not fluctuate.

次に、制御部2は、高さH1が変動したと判断すると(ステップS12:Yes)、高さH1が変動した旨を上位制御装置3に送信し(ステップS13)、今回の走行監視方法を終了する。上位制御装置3は、高さH1が変動した旨を受信すると、搬送車Veの現在位置が移載場所であるか否かを判断し、搬送車Veの現在位置が移載場所でないと判断すると、搬送車Veの走行を禁止または停止させる指示を制御部2に送信する。 Next, when the control unit 2 determines that the height H1 has fluctuated (step S12: Yes), the control unit 2 transmits to the upper control device 3 that the height H1 has fluctuated (step S13), and performs the current travel monitoring method. finish. Upon receiving the fact that the height H1 has changed, the host control device 3 determines whether or not the current position of the transport vehicle Ve is the transfer location, and determines that the current position of the transport vehicle Ve is not the transfer location. , The instruction to prohibit or stop the traveling of the transport vehicle Ve is transmitted to the control unit 2.

一方、制御部2は、高さH1が変動していないと判断すると(ステップS12:No)、障害物センサ1から搬送車Veの走行方向に一定距離Lb(第2距離)離れた位置を通る方向b1と、障害物センサ1から搬送車Veの走行方向に一定距離Lb離れ、さらに高さH1方向に高さH1の距離離れた位置を通る方向b2とがなす角度θbを算出する(ステップS14)。例えば、制御部2は、tan(θb)=高さH1/一定距離Lbを計算することにより、角度θbを求める。 On the other hand, when the control unit 2 determines that the height H1 has not changed (step S12: No), the control unit 2 passes through a position separated from the obstacle sensor 1 by a certain distance Lb (second distance) in the traveling direction of the transport vehicle Ve. The angle θb formed by the direction b1 and the direction b2 passing through a position separated from the obstacle sensor 1 by a certain distance Lb in the traveling direction of the transport vehicle Ve and further separated by a distance H1 in the height H1 direction is calculated (step S14). ). For example, the control unit 2 obtains the angle θb by calculating tan (θb) = height H1 / constant distance Lb.

次に、制御部2は、障害物センサ1から搬送車Veの走行方向に一定距離Lc(第1距離)離れた位置を通る方向c1と、障害物センサ1から搬送車Veの走行方向に一定距離Lc離れ、さらに高さH1方向に高さH1の距離離れた位置を通る方向c2とがなす角度θcを算出する(ステップS15)。例えば、制御部2は、tan(θb)=高さH1/一定距離Lcを計算することにより、角度θcを求める。なお、一定距離Lc<一定距離Lbとする。また、一定距離Lcは、搬送車Veを減速させてから搬送車Veを停止させるまでに搬送車Veが移動する距離より長い距離とする。また、ステップS14とステップS15の順番を入れ替えてもよい。 Next, the control unit 2 passes through a position c1 that is a certain distance Lc (first distance) away from the obstacle sensor 1 in the traveling direction of the transport vehicle Ve, and is constant in the traveling direction of the transport vehicle Ve from the obstacle sensor 1. The angle θc formed by the direction c2 passing through the position separated by the distance Lc and further separated by the distance H1 in the height H1 is calculated (step S15). For example, the control unit 2 obtains the angle θc by calculating tan (θb) = height H1 / constant distance Lc. It should be noted that constant distance Lc <constant distance Lb. Further, the constant distance Lc is a distance longer than the distance that the transport vehicle Ve moves from the time when the transport vehicle Ve is decelerated to the time when the transport vehicle Ve is stopped. Further, the order of step S14 and step S15 may be exchanged.

次に、制御部2は、障害物センサ1により角度θbの範囲に障害物が検知されていない場合(ステップS16:No)、ステップS11の処理に戻り、障害物センサ1により角度θbの範囲に障害物が検知された場合(ステップS16:Yes)、搬送車Veの走行方向において障害物センサ1から一定距離Lb離れた位置と障害物センサ1から一定距離Lc離れた位置との間に荷Aと衝突するおそれがある障害物がある旨を上位制御装置3に送信する(ステップS17)。 Next, when the obstacle sensor 1 does not detect an obstacle in the range of the angle θb (step S16: No), the control unit 2 returns to the process of step S11 and returns to the range of the angle θb by the obstacle sensor 1. When an obstacle is detected (step S16: Yes), the load A is between a position Lb away from the obstacle sensor 1 by a certain distance Lb and a position Lc away from the obstacle sensor 1 in the traveling direction of the transport vehicle Ve. It is transmitted to the host control device 3 that there is an obstacle that may collide with (step S17).

そして、制御部2は、障害物センサ1により角度θcの範囲に障害物が検知されていない場合(ステップS18:No)、障害物センサ1により角度θcの範囲に障害物が検知されたか否かを繰り返し判断し、障害物センサ1により角度θcの範囲に障害物が検知された場合(ステップS18:Yes)、搬送車Veの走行を禁止または停止させて(ステップS19)、今回の走行監視方法を終了する。 Then, when the obstacle sensor 1 does not detect an obstacle in the range of the angle θc (step S18: No), the control unit 2 determines whether or not the obstacle sensor 1 has detected an obstacle in the range of the angle θc. When an obstacle is detected in the range of the angle θc by the obstacle sensor 1 (step S18: Yes), the traveling of the transport vehicle Ve is prohibited or stopped (step S19), and the traveling monitoring method of this time is performed. To finish.

なお、制御部2は、ステップS19において、搬送車Veを減速させた後、搬送車Veを停止させるように構成してもよい。 The control unit 2 may be configured to stop the transport vehicle Ve after decelerating the transport vehicle Ve in step S19.

また、ステップS12及びステップS13を省略してもよい。
また、ステップS14、ステップS16、及びステップS17を省略してもよい。
Further, steps S12 and S13 may be omitted.
Further, step S14, step S16, and step S17 may be omitted.

このように、第1実施形態の制御部2は、障害物センサ1の検知結果を用いて障害物センサ1の高さを基準とする荷Aの高さH1を算出し、障害物センサ1から搬送車Veの走行方向に一定距離Lc離れた位置を通る方向c1と、障害物センサ1から搬送車Veの走行方向に一定距離Lc離れ、さらに高さH1方向に高さH1の距離離れた位置を通る方向c2とがなす角度θcの範囲に、障害物センサ1により障害物が検知されると、搬送車Veの走行を禁止または停止させる構成である。 In this way, the control unit 2 of the first embodiment calculates the height H1 of the load A based on the height of the obstacle sensor 1 by using the detection result of the obstacle sensor 1, and starts from the obstacle sensor 1. A position c1 passing through a position Lc away from the obstacle sensor 1 by a certain distance Lc in the traveling direction of the transport vehicle Ve, a constant distance Lc away from the obstacle sensor 1 in the traveling direction of the transport vehicle Ve, and a distance H1 in the height H1 direction. When an obstacle is detected by the obstacle sensor 1 within the range of the angle θc formed by the direction c2 passing through the vehicle, the traveling vehicle Ve is prohibited or stopped.

これにより、搬送車Veの走行方向において荷Aの高さH1と同じ位置の障害物または荷Aの高さH1より低い位置の障害物を障害物センサ1が検知して搬送車Veの走行を禁止または停車させることができるため、障害物や荷Aの高さが変化する場合であっても、障害物と荷Aとの衝突を抑制することができる。 As a result, the obstacle sensor 1 detects an obstacle at the same position as the height H1 of the load A or an obstacle at a position lower than the height H1 of the load A in the traveling direction of the transport vehicle Ve, and travels the transport vehicle Ve. Since the vehicle can be prohibited or stopped, the collision between the obstacle and the load A can be suppressed even when the height of the obstacle or the load A changes.

また、第1実施形態の制御部2は、障害物センサ1から搬送車Veの走行方向に一定距離Lb離れた位置を通る方向b1と、障害物センサ1から搬送車Veの走行方向に一定距離Lb離れ、さらに高さH1方向に高さH1の距離離れた位置を通る方向b2とがなす角度θbの範囲に、障害物センサ1により障害物が検知されると、搬送車Veの走行方向に障害物がある旨を、上位制御装置3に送信する構成である。 Further, the control unit 2 of the first embodiment has a direction b1 passing through a position Lb away from the obstacle sensor 1 in the traveling direction of the transport vehicle Ve by a certain distance, and a constant distance in the traveling direction of the transport vehicle Ve from the obstacle sensor 1. When an obstacle is detected by the obstacle sensor 1 in the range of the angle θb formed by the direction b2 passing away from the Lb and further away from the height H1 by the distance of the height H1, the vehicle Ve travels in the direction of travel. The configuration is such that the fact that there is an obstacle is transmitted to the host control device 3.

これにより、上位制御装置3は、搬送車Veの走行方向に障害物がある旨を受信すると、搬送車Veの走行を禁止または停止させたり、搬送車Veの走行経路を変更させたりすることができるため、荷Aと障害物との衝突を抑制することができる。 As a result, when the host control device 3 receives that there is an obstacle in the traveling direction of the transport vehicle Ve, the host control device 3 may prohibit or stop the traveling of the transport vehicle Ve or change the traveling route of the transport vehicle Ve. Therefore, the collision between the load A and the obstacle can be suppressed.

また、第1実施形態の制御部2は、荷Aの高さが変動した場合、荷Aの高さが変動した旨を、上位制御装置3に送信する構成である。 Further, the control unit 2 of the first embodiment has a configuration in which when the height of the load A fluctuates, the fact that the height of the load A fluctuates is transmitted to the upper control device 3.

これにより、上記制御装置3は、荷Aの高さが変動した旨を受信したときの搬送車Veの現在位置が移載場所でない場合、搬送車Veの走行を禁止または停止させることができるため、荷崩れなどが発生して荷Aの高さがさらに変動することを抑制することができる。 As a result, the control device 3 can prohibit or stop the traveling of the transport vehicle Ve when the current position of the transport vehicle Ve when receiving the notification that the height of the load A has changed is not the transfer location. , It is possible to prevent the height of the load A from further fluctuating due to the occurrence of a load collapse or the like.

<第2実施形態>
図3は、第2実施形態の搬送車を示す図である。なお、図1に示す構成と同じ構成には同じ符号を付し、その説明を省略する。
<Second Embodiment>
FIG. 3 is a diagram showing a transport vehicle of the second embodiment. The same components as those shown in FIG. 1 are designated by the same reference numerals, and the description thereof will be omitted.

図3に示す搬送車Veは、フォークリフトまたは無人搬送車または有人搬送車などであり、マストMと、障害物センサ1と、制御部2とを備える。なお、マストMとともに昇降するフォークに荷が積載されてもよい。 The guided vehicle Ve shown in FIG. 3 is a forklift, an automatic guided vehicle, a manned vehicle, or the like, and includes a mast M, an obstacle sensor 1, and a control unit 2. A load may be loaded on a fork that moves up and down together with the mast M.

図4は、第2実施形態の走行監視方法を示すフローチャートである。なお、図4に示すフローチャートは、搬送車Veの走行開始直前または走行中に実行されるものとする。 FIG. 4 is a flowchart showing the traveling monitoring method of the second embodiment. The flowchart shown in FIG. 4 is assumed to be executed immediately before the start of traveling of the transport vehicle Ve or during traveling.

まず、制御部2は、障害物センサ1の検知結果を用いて、障害物センサ1の高さを基準とするマストMの高さH2を算出する(ステップS21)。例えば、制御部2は、障害物センサ1を基準としてマストMの上端部から下方に伸びる垂線と搬送車Veの車体上面との交点dを通る方向d1と、障害物センサ1からマストMの上端部を通る方向d2とがなす角度θdを取得し、高さH2=tan(θd)×(障害物センサ1から交点dまでの距離Ld)を計算することにより、高さH2を求める。 First, the control unit 2 calculates the height H2 of the mast M based on the height of the obstacle sensor 1 by using the detection result of the obstacle sensor 1 (step S21). For example, the control unit 2 has a direction d1 passing through an intersection d between a vertical line extending downward from the upper end portion of the mast M and the upper surface of the vehicle body of the transport vehicle Ve with reference to the obstacle sensor 1, and the upper end of the mast M from the obstacle sensor 1. The height H2 is obtained by acquiring the angle θd formed by the direction d2 passing through the portion and calculating the height H2 = tan (θd) × (distance Ld from the obstacle sensor 1 to the intersection d).

次に、制御部2は、障害物センサ1から搬送車Veの走行方向に一定距離Le(第2距離)離れた位置を通る方向e1と、障害物センサ1から搬送車Veの走行方向に一定距離Le離れ、さらに高さH2方向に高さH2の距離離れた位置を通る方向e2とがなす角度θeを算出する(ステップS22)。例えば、制御部2は、tan(θe)=高さH2/一定距離Leを計算することにより、角度θeを求める。 Next, the control unit 2 has a direction e1 passing through a position separated from the obstacle sensor 1 by a certain distance Le (second distance) in the traveling direction of the transport vehicle Ve, and a constant direction e1 from the obstacle sensor 1 in the traveling direction of the transport vehicle Ve. The angle θe formed by the distance Le and the direction e2 passing through the position further separated by the height H2 in the height H2 direction is calculated (step S22). For example, the control unit 2 obtains the angle θe by calculating tan (θe) = height H2 / constant distance Le.

次に、制御部2は、障害物センサ1から搬送車Veの走行方向に一定距離Lf(第1距離)離れた位置を通る方向f1と、障害物センサ1から搬送車Veの走行方向に一定距離Lf離れ、さらに高さH2方向に高さH2の距離離れた位置を通る方向f2とがなす角度θfを算出する(ステップS23)。例えば、制御部2は、tan(θf)=高さH2/一定距離Lfを計算することにより、角度θfを求める。なお、一定距離Lf<一定距離Leとする。また、一定距離Lfは、搬送車Veを減速させてから搬送車Veを停止させるまでに搬送車Veが移動する距離より長い距離とする。また、ステップS21〜S23の順番は特に限定されない。 Next, the control unit 2 has a direction f1 passing through a position separated from the obstacle sensor 1 by a certain distance Lf (first distance) in the traveling direction of the transport vehicle Ve, and a constant direction f1 from the obstacle sensor 1 in the traveling direction of the transport vehicle Ve. The angle θf formed by the distance f2 and the direction f2 passing through the position separated by the height H2 in the height H2 direction is calculated (step S23). For example, the control unit 2 obtains the angle θf by calculating tan (θf) = height H2 / constant distance Lf. It should be noted that constant distance Lf <constant distance Le. Further, the constant distance Lf is set to be a distance longer than the distance that the transport vehicle Ve moves from the time when the transport vehicle Ve is decelerated to the time when the transport vehicle Ve is stopped. Further, the order of steps S21 to S23 is not particularly limited.

次に、制御部2は、障害物センサ1により角度θeの範囲に障害物が検知されていない場合(ステップS24:No)、ステップS21の処理に戻り、障害物センサ1により角度θeの範囲に障害物が検知された場合(ステップS24:Yes)、搬送車Veの走行方向において障害物センサ1から一定距離Le離れた位置と障害物センサ1から一定距離Lf離れた位置との間にマストMと衝突するおそれがある障害物がある旨を上位制御装置3に送信する(ステップS25)。 Next, when the obstacle sensor 1 does not detect an obstacle in the range of the angle θe (step S24: No), the control unit 2 returns to the process of step S21 and returns to the range of the angle θe by the obstacle sensor 1. When an obstacle is detected (step S24: Yes), the mast M is between a position Le away from the obstacle sensor 1 by a certain distance Le and a position Lf away from the obstacle sensor 1 in the traveling direction of the transport vehicle Ve. It is transmitted to the host control device 3 that there is an obstacle that may collide with (step S25).

そして、制御部2は、障害物センサ1により角度θfの範囲に障害物が検知されていない場合(ステップS26:No)、障害物センサ1により角度θfの範囲に障害物が検知されたか否かを繰り返し判断し、障害物センサ1により角度θfの範囲に障害物が検知された場合(ステップS26:Yes)、搬送車Veの走行を禁止または停止させて(ステップS27)、今回の走行監視方法を終了する。 Then, when the obstacle sensor 1 does not detect an obstacle in the range of the angle θf (step S26: No), the control unit 2 determines whether or not the obstacle sensor 1 has detected an obstacle in the range of the angle θf. When an obstacle is detected in the range of the angle θf by the obstacle sensor 1 (step S26: Yes), the traveling of the transport vehicle Ve is prohibited or stopped (step S27), and the traveling monitoring method of this time is performed. To finish.

なお、制御部2は、ステップS27において、搬送車Veを減速させた後、搬送車Veを停止させるように構成してもよい。
また、ステップS22、ステップS24、及びステップS25を省略してもよい。
The control unit 2 may be configured to stop the transport vehicle Ve after decelerating the transport vehicle Ve in step S27.
Further, step S22, step S24, and step S25 may be omitted.

このように、第2実施形態の制御部2は、障害物センサ1の検知結果を用いて障害物センサ1の高さを基準とするマストMの高さH2を算出し、障害物センサ1から搬送車Veの走行方向に一定距離Lf離れた位置を通る方向f1と、障害物センサ1から搬送車Veの走行方向に一定距離Lf離れ、さらに高さH2方向に高さH2の距離離れた位置を通る方向f2とがなす角度θfの範囲に、障害物センサ1により障害物が検知されると、搬送車Veの走行を禁止または停止させる構成である。 In this way, the control unit 2 of the second embodiment calculates the height H2 of the mast M based on the height of the obstacle sensor 1 by using the detection result of the obstacle sensor 1, and starts from the obstacle sensor 1. A position f1 passing through a position Lf away from the obstacle sensor 1 by a certain distance Lf in the traveling direction of the transport vehicle Ve, a constant distance Lf away from the obstacle sensor 1 in the traveling direction of the transport vehicle Ve, and a distance H2 in the height H2 direction. When an obstacle is detected by the obstacle sensor 1 in the range of the angle θf formed by the direction f2 passing through the vehicle, the traveling vehicle Ve is prohibited or stopped.

これにより、搬送車Veの走行方向においてマストMの高さH2と同じ位置の障害物またはマストMの高さH2より低い位置の障害物を障害物センサ1が検知して搬送車Veの走行を禁止または停車させることができるため、障害物やマストMの高さが変化する場合であっても、障害物とマストMとの衝突を抑制することができる。 As a result, the obstacle sensor 1 detects an obstacle at the same position as the height H2 of the mast M or an obstacle at a position lower than the height H2 of the mast M in the traveling direction of the transport vehicle Ve, and travels the transport vehicle Ve. Since the vehicle can be prohibited or stopped, collision between the obstacle and the mast M can be suppressed even when the height of the obstacle or the mast M changes.

また、第1実施形態の制御部2は、障害物センサ1から搬送車Veの走行方向に一定距離Le離れた位置を通る方向e1と、障害物センサ1から搬送車Veの走行方向に一定距離Le離れ、さらに高さH2方向に高さH2の距離離れた位置を通る方向e2とがなす角度θeの範囲に、障害物センサ1により障害物が検知されると、搬送車Veの走行方向に障害物がある旨を、上位制御装置3に送信する構成である。 Further, the control unit 2 of the first embodiment has a direction e1 passing through a position Le away from the obstacle sensor 1 in the traveling direction of the transport vehicle Ve by a certain distance, and a constant distance in the traveling direction of the transport vehicle Ve from the obstacle sensor 1. When an obstacle is detected by the obstacle sensor 1 in the range of the angle θe formed by the direction e2 passing away from Le and further away from the height H2 by the distance of the height H2, the traveling direction of the transport vehicle Ve The configuration is such that the fact that there is an obstacle is transmitted to the host control device 3.

これにより、上位制御装置3は、搬送車Veの走行方向に障害物がある旨を受信すると、搬送車Veの走行を禁止または停止させたり、搬送車Veの走行経路を変更させたりすることができるため、障害物とマストMとの衝突を抑制することができる。 As a result, when the host control device 3 receives that there is an obstacle in the traveling direction of the transport vehicle Ve, the host control device 3 may prohibit or stop the traveling of the transport vehicle Ve or change the traveling route of the transport vehicle Ve. Therefore, the collision between the obstacle and the mast M can be suppressed.

<第3実施形態>
図5は、第3実施形態の搬送車を示す図である。なお、図3に示す構成と同じ構成には同じ符号を付し、その説明を省略する。
<Third Embodiment>
FIG. 5 is a diagram showing a transport vehicle according to a third embodiment. The same components as those shown in FIG. 3 are designated by the same reference numerals, and the description thereof will be omitted.

図5に示す搬送車Veは、フォークリフトまたは無人搬送車または有人搬送車などであり、マストMと、障害物センサ1と、制御部2とを備える。なお、マストMとともに昇降するフォークに荷が積載されてもよい。 The guided vehicle Ve shown in FIG. 5 is a forklift, an automatic guided vehicle, a manned vehicle, or the like, and includes a mast M, an obstacle sensor 1, and a control unit 2. A load may be loaded on a fork that moves up and down together with the mast M.

制御部2は、障害物センサ1の検知結果を用いてマストMの昇降動作を制御する。
また、制御部2は、制御タイミング毎に、マスト監視方法を実行する。
The control unit 2 controls the raising and lowering operation of the mast M by using the detection result of the obstacle sensor 1.
Further, the control unit 2 executes the mast monitoring method for each control timing.

図6は、第3実施形態のマスト監視方法を示すフローチャートである。なお、図6に示すフローチャートは、マストMの上昇開始直前または上昇中に実行されるものとする。 FIG. 6 is a flowchart showing the mast monitoring method of the third embodiment. The flowchart shown in FIG. 6 is assumed to be executed immediately before or during the rise of the mast M.

まず、制御部2は、障害物センサ1の検知結果を用いて、障害物センサ1の高さを基準として搬送車Veの上方向にある障害物(天井など)までの高さH3を算出する(ステップS31)。例えば、制御部2は、障害物センサ1を基準としてマストMの上端部から下方に伸びる垂線と搬送車Veの車体上面との交点gを通る方向g1と、障害物センサ1から搬送車Veの上方にある障害物を通る方向g2とがなす角度θgを取得し、高さH3=tan(θg)×(障害物センサ1から交点gまでの距離Lg)を計算することにより、高さH3を求める。 First, the control unit 2 calculates the height H3 to the obstacle (ceiling or the like) in the upward direction of the transport vehicle Ve based on the height of the obstacle sensor 1 by using the detection result of the obstacle sensor 1. (Step S31). For example, the control unit 2 has a direction g1 passing through an intersection g of a vertical line extending downward from the upper end of the mast M and the upper surface of the vehicle body of the transport vehicle Ve with reference to the obstacle sensor 1, and the obstacle sensor 1 to the transport vehicle Ve. The height H3 is calculated by acquiring the angle θg formed by the direction g2 passing through the obstacle above and calculating the height H3 = tan (θg) × (distance Lg from the obstacle sensor 1 to the intersection g). Ask.

次に、制御部2は、高さH3より低い高さH4(第1の高さ)を算出する(ステップS32)。例えば、制御部2は、高さH3から所定距離x1を減算した結果を、高さH4として求める。 Next, the control unit 2 calculates a height H4 (first height) lower than the height H3 (step S32). For example, the control unit 2 obtains the result of subtracting the predetermined distance x1 from the height H3 as the height H4.

次に、制御部2は、高さH4より低い高さH5を算出する(ステップS33)。例えば、制御部2は、高さH4から所定距離x2を減算した結果を、高さH5として求める。 Next, the control unit 2 calculates a height H5 lower than the height H4 (step S33). For example, the control unit 2 obtains the result of subtracting the predetermined distance x2 from the height H4 as the height H5.

次に、制御部2は、障害物センサ1の検知結果を用いて、障害物センサ1の高さを基準とするマストMの上端部までの高さH6(第2の高さ)を算出する(ステップS34)。例えば、制御部2は、障害物センサ1から交点gを通る方向g1と、障害物センサ1からマストMの上端部を通る方向hとがなす角度θhを取得し、高さH6=tan(θh)×(距離Lg)を計算することにより、高さH6を求める。 Next, the control unit 2 calculates the height H6 (second height) to the upper end of the mast M based on the height of the obstacle sensor 1 by using the detection result of the obstacle sensor 1. (Step S34). For example, the control unit 2 acquires an angle θh formed by the direction g1 passing through the intersection g from the obstacle sensor 1 and the direction h passing through the upper end portion of the mast M from the obstacle sensor 1, and the height H6 = tan (θh). ) X (distance Lg) to obtain the height H6.

次に、制御部2は、高さH6が高さH5より低い場合(ステップS35:No)、ステップS31の処理に戻り、高さH6が高さH5以上になると(ステップS35:Yes)、マストMの上昇方向においてマストMが障害物と衝突するおそれがある旨を上位制御装置3に送信する(ステップS36)。これにより、上位制御装置3は、マストMが障害物と衝突するおそれがある旨を受信すると、マストMの上昇を禁止または停止させることができるため、障害物とマストMとの衝突を抑制することができる。 Next, when the height H6 is lower than the height H5 (step S35: No), the control unit 2 returns to the process of step S31, and when the height H6 becomes the height H5 or more (step S35: Yes), the mast The fact that the mast M may collide with an obstacle in the ascending direction of M is transmitted to the upper control device 3 (step S36). As a result, when the host control device 3 receives that the mast M may collide with an obstacle, the mast M can be prohibited or stopped from rising, so that the collision between the obstacle and the mast M is suppressed. be able to.

そして、制御部2は、再度、高さH6を算出し(ステップS37)、高さH6が高さH4より低い場合(ステップS38:No)、繰り返しステップS37及びステップS38を実行し、高さH6が高さH4以上になると(ステップS38:Yes)、マストMの上昇を禁止または停止させて(ステップS39)、今回のマスト監視方法を終了する。
なお、ステップS33〜S36を省略してもよい。
Then, the control unit 2 calculates the height H6 again (step S37), and when the height H6 is lower than the height H4 (step S38: No), repeatedly executes the steps S37 and S38 to execute the height H6. When the height becomes H4 or higher (step S38: Yes), the rise of the mast M is prohibited or stopped (step S39), and the current mast monitoring method is terminated.
Note that steps S33 to S36 may be omitted.

このように、第3実施形態の制御部2は、障害物センサ1の検知結果を用いて障害物センサ1の高さを基準とする搬送車Veの上方向にある障害物までの高さH3より低い高さH4を算出するとともに、障害物センサ1の検知結果を用いて障害物センサ1の高さを基準とするマストMの上端部までの高さH6を算出し、高さH6が高さH4以上になると、マストMの上昇を禁止または停止させる構成である。 As described above, the control unit 2 of the third embodiment uses the detection result of the obstacle sensor 1 to reach the height H3 to the obstacle in the upward direction of the transport vehicle Ve based on the height of the obstacle sensor 1. A lower height H4 is calculated, and the height H6 to the upper end of the mast M based on the height of the obstacle sensor 1 is calculated using the detection result of the obstacle sensor 1, and the height H6 is higher. When the height is H4 or higher, the mast M is prohibited or stopped from rising.

これにより、マストMが天井などの障害物に衝突する前にマストMの上昇を禁止または停止させることができるため、マストMが天井などの障害物に衝突することを抑制することができる。 As a result, the rise of the mast M can be prohibited or stopped before the mast M collides with an obstacle such as the ceiling, so that the mast M can be prevented from colliding with the obstacle such as the ceiling.

<第4実施形態>
図7は、第4実施形態の搬送車を示す図である。なお、図5に示す構成と同じ構成には同じ符号を付し、その説明を省略する。
<Fourth Embodiment>
FIG. 7 is a diagram showing a transport vehicle according to a fourth embodiment. The same components as those shown in FIG. 5 are designated by the same reference numerals, and the description thereof will be omitted.

図7に示す搬送車Veは、フォークリフトまたは無人搬送車または有人搬送車などであり、マストMと、障害物センサ1と、制御部2とを備える。なお、マストMとともに昇降するフォークに荷が積載されてもよい。 The guided vehicle Ve shown in FIG. 7 is a forklift, an automatic guided vehicle, a manned vehicle, or the like, and includes a mast M, an obstacle sensor 1, and a control unit 2. A load may be loaded on a fork that moves up and down together with the mast M.

制御部2は、障害物センサ1の検知結果を用いてマストMの昇降動作を制御する。
図8は、第4実施形態のマスト監視方法を示すフローチャートである。なお、図8に示すフローチャートは、マストMの上昇開始直前に実行されるものとする。
The control unit 2 controls the raising and lowering operation of the mast M by using the detection result of the obstacle sensor 1.
FIG. 8 is a flowchart showing the mast monitoring method of the fourth embodiment. The flowchart shown in FIG. 8 is assumed to be executed immediately before the start of ascending of the mast M.

まず、制御部2は、障害物センサ1の検知結果を用いて、障害物センサ1を基準としてマストMの上端部から下方に伸びる垂線と搬送車Veの車体上面との交点gを通る方向g1と、障害物センサ1から最大上昇時のマストMの上端部を通る方向iとがなす角度θiを算出する(ステップS41)。例えば、制御部2は、tan(θi)=(最大上昇時のマストMの上端部から交点gまでの高さH7)/(障害物センサ1から交点gまでの距離Lg)を計算することにより、角度θiを求める。 First, the control unit 2 uses the detection result of the obstacle sensor 1 to pass through the intersection g of the vertical line extending downward from the upper end of the mast M and the upper surface of the vehicle body of the transport vehicle Ve with the obstacle sensor 1 as a reference. And the angle θi formed by the obstacle sensor 1 and the direction i passing through the upper end of the mast M at the time of maximum ascent (step S41). For example, the control unit 2 calculates tan (θi) = (height H7 from the upper end of the mast M at the maximum rise to the intersection g) / (distance Lg from the obstacle sensor 1 to the intersection g). , Find the angle θi.

次に、制御部2は、障害物センサ1により角度θiの範囲にマストM以外の障害物が検知されていない場合(ステップS42:No)、今回のマスト監視方法を終了し、障害物センサ1により角度θiの範囲にマストM以外の障害物が検知されると(ステップS42:Yes)、マストMの上昇を禁止させて(ステップS43)、今回のマスト監視方法を終了する。 Next, when the obstacle sensor 1 does not detect an obstacle other than the mast M in the range of the angle θi (step S42: No), the control unit 2 ends the mast monitoring method this time, and the obstacle sensor 1 ends. When an obstacle other than the mast M is detected in the range of the angle θi (step S42: Yes), the mast M is prohibited from rising (step S43), and the mast monitoring method this time is terminated.

このように、第4実施形態の制御部2は、障害物センサ1を基準としてマストMの上端部から下方に伸びる垂線と搬送車Veの車体上面との交点gを通る方向g1と、障害物センサ1から最大上昇時のマストMの上端部を通る方向iとがなす角度θiの範囲に、障害物センサ1によりマストM以外の障害物が検知されると、マストMの上昇を禁止させる構成である。 As described above, the control unit 2 of the fourth embodiment has the direction g1 passing through the intersection g of the vertical line extending downward from the upper end portion of the mast M and the upper surface of the vehicle body of the transport vehicle Ve with the obstacle sensor 1 as a reference, and the obstacle. When the obstacle sensor 1 detects an obstacle other than the mast M within the range of the angle θi formed by the direction i passing through the upper end of the mast M at the time of maximum ascent from the sensor 1, the mast M is prohibited from ascending. Is.

これにより、マストMの上昇開始直前において、マストMが天井などの障害物に衝突する可能性があるときにマストMの上昇を禁止させることができるため、マストMが天井などの障害物に衝突することを抑制することができる。 As a result, it is possible to prohibit the mast M from rising when the mast M may collide with an obstacle such as the ceiling immediately before the mast M starts to rise, so that the mast M collides with an obstacle such as the ceiling. Can be suppressed.

また、本発明は、以上の実施の形態に限定されるものでなく、本発明の要旨を逸脱しない範囲内で種々の改良、変更が可能である。 Further, the present invention is not limited to the above embodiments, and various improvements and changes can be made without departing from the gist of the present invention.

1 障害物センサ
2 制御部
3 上位制御装置
Ve 車両
A 荷
M マスト
1 Obstacle sensor 2 Control unit 3 Upper control device Ve Vehicle A Load M mast

Claims (8)

荷が車体に積載される搬送車またはマストを備える搬送車であって、
障害物センサと、
当該搬送車の走行を制御する制御部と、
を備え、
前記制御部は、前記障害物センサの検知結果を用いて前記障害物センサの高さを基準とする前記荷または前記マストの高さを算出し、前記障害物センサから当該搬送車の走行方向に第1距離離れた位置を通る方向と、前記障害物センサから当該搬送車の走行方向に前記第1距離離れ、さらに前記高さの方向に前記高さの距離離れた位置を通る方向とがなす角度の範囲に、前記障害物センサにより障害物が検知されると、当該搬送車の走行を禁止または停止させる
ことを特徴とする搬送車。
A transport vehicle or a transport vehicle equipped with a mast in which the load is loaded on the vehicle body.
Obstacle sensor and
A control unit that controls the running of the carrier and
With
The control unit calculates the height of the load or the mast based on the height of the obstacle sensor by using the detection result of the obstacle sensor, and moves from the obstacle sensor to the traveling direction of the transport vehicle. The direction of passing the position separated by the first distance and the direction of passing the position separated from the obstacle sensor by the first distance in the traveling direction of the transport vehicle and further separated by the height in the direction of the height are formed. A transport vehicle characterized in that when an obstacle is detected by the obstacle sensor within an angle range, the transport vehicle is prohibited or stopped from traveling.
請求項1に記載の搬送車であって、
前記制御部は、前記障害物センサから当該搬送車の走行方向に前記第1距離より長い第2距離離れた位置を通る方向と、前記障害物センサから当該搬送車の走行方向に前記第2距離離れ、さらに前記高さの方向に前記高さの距離離れた位置を通る方向とがなす角度の範囲に、前記障害物センサにより障害物が検知されると、当該搬送車の走行方向に障害物がある旨を、当該搬送車の走行を制御する上位制御装置に送信する
ことを特徴とする搬送車。
The transport vehicle according to claim 1.
The control unit passes through a position separated from the obstacle sensor by a second distance longer than the first distance in the traveling direction of the transport vehicle, and the second distance in the traveling direction of the transport vehicle from the obstacle sensor. When an obstacle is detected by the obstacle sensor within the range of the angle formed by the direction of the distance and the direction of passing the distance away from the height, the obstacle is detected in the traveling direction of the transport vehicle. A transport vehicle characterized in that the presence is transmitted to a higher-level control device that controls the travel of the transport vehicle.
請求項1または請求項2に記載の搬送車であって、
前記制御部は、前記荷の高さが変動した場合、前記荷の高さが変動した旨を、当該搬送車の走行を制御する上位制御装置に送信する
ことを特徴とする搬送車。
The transport vehicle according to claim 1 or 2.
The control unit is characterized in that when the height of the load fluctuates, the fact that the height of the load fluctuates is transmitted to a higher-level control device that controls the traveling of the transport vehicle.
マストと、
障害物センサと、
前記マストの昇降を制御する制御部と、
を備え、
前記制御部は、前記障害物センサの検知結果を用いて前記障害物センサの高さを基準とする当該搬送車の上方向にある障害物までの高さよりも低い第1の高さを算出するとともに、前記障害物センサの検知結果を用いて前記障害物センサを基準とする前記マストの上端部までの第2の高さを算出し、前記第2の高さが前記第1の高さ以上になると、前記マストの上昇を禁止または停止させる
ことを特徴とする搬送車。
With the mast
Obstacle sensor and
A control unit that controls the raising and lowering of the mast,
With
The control unit calculates a first height lower than the height to the obstacle in the upward direction of the transport vehicle based on the height of the obstacle sensor by using the detection result of the obstacle sensor. At the same time, the second height to the upper end of the mast based on the obstacle sensor is calculated using the detection result of the obstacle sensor, and the second height is equal to or higher than the first height. When the mast becomes, the transport vehicle is characterized by prohibiting or stopping the ascent of the mast.
マストと、
当該搬送車の車体上面に設けられる障害物センサと、
前記マストの昇降を制御する制御部と、
を備え、
前記制御部は、前記障害物センサを基準として前記マストの上端部から下方に伸びる垂線と前記搬送車の車体上面との交点を通る方向と、前記障害物センサから最大上昇時の前記マストの上端部を通る方向とがなす角度の範囲に、前記障害物センサにより前記マスト以外の障害物が検知されると、前記マストの上昇を禁止させる
ことを特徴とする搬送車。
With the mast
An obstacle sensor provided on the upper surface of the vehicle body of the transport vehicle and
A control unit that controls the raising and lowering of the mast,
With
The control unit passes through the intersection of the vertical line extending downward from the upper end of the mast and the upper surface of the vehicle body of the transport vehicle with reference to the obstacle sensor, and the upper end of the mast when the mast rises maximum from the obstacle sensor. A transport vehicle characterized in that when an obstacle other than the mast is detected by the obstacle sensor within a range of an angle formed by a direction passing through the portion, the mast is prohibited from rising.
荷が車体に積載される搬送車またはマストを備える搬送車の制御部により実行される走行監視方法であって、
前記制御部は、
障害物センサの検知結果を用いて前記障害物センサの高さを基準とする前記荷または前記マストの高さを算出し、
前記障害物センサから前記搬送車の走行方向に第1距離離れた位置を通る方向と、前記障害物センサから前記搬送車の走行方向に前記第1距離離れ、さらに前記高さの方向に前記高さの距離離れた位置を通る方向とがなす角度の範囲に、前記障害物センサにより障害物が検知されると、前記搬送車の走行を禁止または停止させる
ことを特徴とする走行監視方法。
A traveling monitoring method executed by a control unit of a transport vehicle or a transport vehicle having a mast in which a load is loaded on a vehicle body.
The control unit
Using the detection result of the obstacle sensor, the height of the load or the mast based on the height of the obstacle sensor is calculated.
The height is separated from the obstacle sensor by a first distance in the traveling direction of the transport vehicle, from the obstacle sensor by the first distance in the traveling direction of the transport vehicle, and further in the height direction. A traveling monitoring method characterized in that when an obstacle is detected by the obstacle sensor within a range of angles formed by a direction passing through a position separated by a distance, the traveling of the transport vehicle is prohibited or stopped.
マストと、障害物センサと、前記マストの昇降を制御する制御部とを備える搬送車において、前記制御部により実行されるマスト監視方法であって、
前記制御部は、
前記障害物センサの検知結果を用いて前記障害物センサの高さを基準とする前記搬送車の上方向にある障害物までの高さよりも低い第1の高さを算出するとともに、前記障害物センサの検知結果を用いて前記障害物センサの高さを基準とする前記マストの上端部までの第2の高さを算出し、
前記第2の高さが前記第1の高さ以上になると、前記マストの上昇を禁止または停止させる
ことを特徴とするマスト監視方法。
A mast monitoring method executed by the control unit in a transport vehicle including a mast, an obstacle sensor, and a control unit that controls the raising and lowering of the mast.
The control unit
Using the detection result of the obstacle sensor, a first height lower than the height to the obstacle in the upward direction of the transport vehicle based on the height of the obstacle sensor is calculated, and the obstacle is calculated. Using the detection result of the sensor, the second height to the upper end of the mast based on the height of the obstacle sensor is calculated.
A mast monitoring method comprising prohibiting or stopping the ascent of the mast when the second height becomes equal to or higher than the first height.
マストと、搬送車の車体上面に設けられる障害物センサと、前記マストの昇降を制御する制御部とを備える前記搬送車において、前記制御部により実行されるマスト監視方法であって、
前記制御部は、前記障害物センサを基準として前記マストの上端部から下方に伸びる垂線と前記搬送車の車体上面との交点を通る方向と、前記障害物センサから最大上昇時の前記マストの上端部を通る方向とがなす角度の範囲に、前記障害物センサにより前記マスト以外の障害物が検知されると、前記マストの上昇を禁止させる
ことを特徴とするマスト監視方法。
A mast monitoring method executed by the control unit in the transport vehicle including the mast, an obstacle sensor provided on the upper surface of the vehicle body of the transport vehicle, and a control unit for controlling the raising and lowering of the mast.
The control unit passes through the intersection of the vertical line extending downward from the upper end of the mast and the upper surface of the vehicle body of the transport vehicle with reference to the obstacle sensor, and the upper end of the mast when the mast rises maximum from the obstacle sensor. A mast monitoring method characterized in that when an obstacle other than the mast is detected by the obstacle sensor within a range of an angle formed by a direction passing through the mast, the mast is prohibited from rising.
JP2020002845A 2020-01-10 2020-01-10 Transport vehicle, running monitoring method, and mast monitoring method Active JP7363495B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020002845A JP7363495B2 (en) 2020-01-10 2020-01-10 Transport vehicle, running monitoring method, and mast monitoring method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020002845A JP7363495B2 (en) 2020-01-10 2020-01-10 Transport vehicle, running monitoring method, and mast monitoring method

Publications (2)

Publication Number Publication Date
JP2021111138A true JP2021111138A (en) 2021-08-02
JP7363495B2 JP7363495B2 (en) 2023-10-18

Family

ID=77059921

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020002845A Active JP7363495B2 (en) 2020-01-10 2020-01-10 Transport vehicle, running monitoring method, and mast monitoring method

Country Status (1)

Country Link
JP (1) JP7363495B2 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0772249A (en) * 1993-09-03 1995-03-17 Nec Corp Unmanned carrier vehicle
JPH10231096A (en) * 1997-02-19 1998-09-02 Toyota Autom Loom Works Ltd Safety system for forklift truck
JP2006123854A (en) * 2004-11-01 2006-05-18 Matsushita Electric Ind Co Ltd Cargo transportation robot
JP2011060113A (en) * 2009-09-11 2011-03-24 Mitsubishi Fuso Truck & Bus Corp Collision avoidance support device for vehicle

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0772249A (en) * 1993-09-03 1995-03-17 Nec Corp Unmanned carrier vehicle
JPH10231096A (en) * 1997-02-19 1998-09-02 Toyota Autom Loom Works Ltd Safety system for forklift truck
JP2006123854A (en) * 2004-11-01 2006-05-18 Matsushita Electric Ind Co Ltd Cargo transportation robot
JP2011060113A (en) * 2009-09-11 2011-03-24 Mitsubishi Fuso Truck & Bus Corp Collision avoidance support device for vehicle

Also Published As

Publication number Publication date
JP7363495B2 (en) 2023-10-18

Similar Documents

Publication Publication Date Title
US11440188B2 (en) Robot system
US10155646B2 (en) Forklift including an apparatus for controlling the forklift
US9164512B2 (en) Autonomous moving body and control method thereof
KR20200030617A (en) Position error correction method and position error correction device for driving assistance vehicles
US9862383B2 (en) Method for operating a vehicle based on one or more setpoint trajectories
JP2019182056A (en) Drive support apparatus
US20190256092A1 (en) Travel Control Method and Travel Control Device
JP6436235B2 (en) Tracking control device and tracking control method
JP5390419B2 (en) Automated guided vehicle
US11027953B2 (en) Method for monitoring the road path of a truck and a floor conveyor
JP2017211973A (en) Vehicle controller and vehicle controlling method
JP2011141663A (en) Automated guided vehicle and travel control method for the same
US11420640B2 (en) Method for autonomously operating a vehicle, controller device for a vehicle, and vehicle
JP2021081833A (en) Vehicle control system
JP6446245B2 (en) Automatic operation control device
CN113396123B (en) Collision-free routing of loads suspended on a cable
JP7363495B2 (en) Transport vehicle, running monitoring method, and mast monitoring method
JP2010176203A (en) Autonomous mobile robot system
JP2020144721A (en) Vehicle control device
JP6632671B1 (en) Unmanned vehicle control device and unmanned vehicle control method
CN115026829A (en) Control method, robot, control system, and computer-readable storage medium
KR102515061B1 (en) Method for preventing collision of automated guided vehicle for automated guided vehicle system
JP6964542B2 (en) Observation system
KR102279793B1 (en) Method and device for controlling vehicle of Overhead Hoist Transfer
JP7540195B2 (en) Mobile robot

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220415

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230322

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230404

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230515

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230801

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230810

RD03 Notification of appointment of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7423

Effective date: 20230810

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230918

R151 Written notification of patent or utility model registration

Ref document number: 7363495

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151