JP7363495B2 - Transport vehicle, running monitoring method, and mast monitoring method - Google Patents

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

Info

Publication number
JP7363495B2
JP7363495B2 JP2020002845A JP2020002845A JP7363495B2 JP 7363495 B2 JP7363495 B2 JP 7363495B2 JP 2020002845 A JP2020002845 A JP 2020002845A JP 2020002845 A JP2020002845 A JP 2020002845A JP 7363495 B2 JP7363495 B2 JP 7363495B2
Authority
JP
Japan
Prior art keywords
height
mast
obstacle
obstacle sensor
vehicle
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
JP2020002845A
Other languages
Japanese (ja)
Other versions
JP2021111138A (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 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)

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 guided vehicles include an obstacle sensor that detects obstacles in the traveling direction of the guided vehicle, and the traveling of the guided vehicle is controlled based on the detection results of the obstacle sensor. A related technique is Patent Document 1.

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

そのため、上記搬送車では、障害物の高さが障害物センサにより検知できない高さに変化したり、荷やマストの高さが変化して荷やマストの高さが不明になったりすると、荷やマストを障害物に衝突させてしまうおそれがある。 Therefore, with the above-mentioned transport vehicle, if the height of an 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 is unknown, Otherwise, the mast may collide with an obstacle.

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

本発明の一側面に係る目的は、障害物や搬送車に積載される荷や搬送車に備えられるマストの高さが変化する場合において、荷やマストが障害物に衝突することを抑制することが可能な搬送車並びにその搬送車に適用される走行監視方法及びマスト監視方法を提供することである。 An object of one aspect of the present invention is to prevent the load or the 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. It is an object of the present invention to provide a transport vehicle capable of performing the following, as well as a running monitoring method and a mast monitoring method applied to the transport vehicle.

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

制御部は、障害物センサの検知結果を用いて障害物センサの高さを基準とする荷またはマストの高さを算出し、障害物センサから搬送車の走行方向に第1距離離れた位置を通る方向と、障害物センサから搬送車の走行方向に第1距離離れ、さらに荷またはマストの高さの方向に荷またはマストの高さの距離離れた位置を通る方向とがなす角度の範囲に、障害物センサにより障害物が検知されると、搬送車の走行を禁止または停止させる。 The control unit calculates the height of the load or the mast based on the height of the obstacle sensor using the detection result of the obstacle sensor, and calculates a position a first distance away from the obstacle sensor in the traveling direction of the transport vehicle. In the range of angles formed between the passing direction and the direction passing through a position that is a first distance away from the obstacle sensor in the traveling direction of the transport vehicle and further separated by a distance of the height of the load or mast in the direction of the height of the load or mast. When an obstacle is detected by the obstacle sensor, the traveling 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 conveyance vehicle, and prohibits or stops the conveyance vehicle from traveling. Therefore, even if the height of the obstacle, load, or mast changes, it is possible to prevent the load or mast from colliding with the obstacle.

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

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

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

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

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

制御部は、障害物センサの検知結果を用いて障害物センサの高さを基準とする搬送車の上方向にある障害物までの高さよりも低い第1の高さを算出するとともに、障害物センサの検知結果を用いて障害物センサの高さを基準とするマストの上端部までの第2の高さを算出し、第2の高さが第1の高さ以上になると、マストの上昇を禁止または停止させる。 The control unit uses the detection results of the obstacle sensor to calculate a first height that is lower than the height of the obstacle located above the carrier based on the height of the obstacle sensor, and also calculates a first height of the obstacle. A second height to the top of the mast based on the height of the obstacle sensor is calculated using the sensor detection results, and when the second height is equal to or higher than the first height, the mast is raised. prohibited or suspended.

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

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

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

これにより、マストの上昇開始直前において、マストが天井などの障害物に衝突する可能性があるときにマストの上昇を禁止させることができるため、マストが天井などの障害物に衝突することを抑制することができる。 This allows the mast to be prohibited from rising just before the mast starts to rise, when there is a possibility that the mast will collide with an obstacle such as the ceiling, thereby preventing the mast from colliding with an obstacle such as the ceiling. can do.

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

これにより、搬送車の走行方向において荷あるいはマストの高さと同じ位置の障害物または荷あるいはマストの高さより低い位置の障害物を障害物センサが検知して搬送車の走行を禁止または停止させることができるため、障害物や荷やマストの高さが変化する場合であっても、荷やマストが障害物に衝突することを抑制することができる。 This allows the obstacle sensor to detect an obstacle at the same height as 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 prohibit or stop the transport vehicle. Therefore, even if the height of the obstacle, load, or mast changes, it is possible to prevent the load or mast from colliding with the obstacle.

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

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

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

これにより、マストの上昇開始直前において、マストが天井などの障害物に衝突する可能性があるときにマストの上昇を禁止させることができるため、マストが天井などの障害物に衝突することを抑制することができる。 This allows the mast to be prohibited from rising just before the mast starts to rise, when there is a possibility that the mast will collide with an obstacle such as the ceiling, thereby preventing the mast from colliding with an obstacle such as the ceiling. can do.

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

第1実施形態の搬送車を示す図である。It is a figure showing a conveyance vehicle of a 1st embodiment. 第1実施形態の走行監視方法を示すフローチャートである。It is a flowchart which shows the driving monitoring method of 1st Embodiment. 第2実施形態の搬送車を示す図である。It is a figure which shows the conveyance vehicle of 2nd Embodiment. 第2実施形態の走行監視方法を示すフローチャートである。It is a flowchart which shows the driving|running|working monitoring method of 2nd Embodiment. 第3実施形態の搬送車を示す図である。It is a figure which shows the conveyance 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 conveyance vehicle of 4th Embodiment. 第4実施形態のマスト監視方法を示すフローチャートである。It is a flowchart which shows the mast monitoring method of 4th embodiment.

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

図1に示す搬送車Veは、車体に荷Aを積載して走行する無人搬送車または有人搬送車などであり、障害物センサ1と、制御部2とを備える。 The guided vehicle Ve shown in FIG. 1 is an unmanned guided vehicle or a manned guided 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 carrier vehicle Ve, and detects obstacles (shutters, cranes, etc.) within a range of at least 180 degrees in the upper 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 results of the obstacle sensor 1 to control the transport vehicle Ve. control the running (speed, etc.) of the vehicle.

また、制御部2は、搬送車Veの状態を示す情報を上位制御装置3に送信し、その情報に基づいて上位制御装置3から送信される制御信号により、搬送車Veの速度や走行経路などを制御する。 In addition, the control unit 2 transmits information indicating the state of the guided vehicle Ve to the higher level control device 3, and based on the information, the speed of the guided vehicle Ve, the traveling route, etc. are controlled by control signals transmitted from the higher level control device 3. control.

また、制御部2は、制御タイミング毎に、走行監視方法を実行する。
図2は、第1実施形態の走行監視方法を示すフローチャートである。なお、図2に示すフローチャートは、搬送車Veの走行開始直前または走行中に実行されるものとする。
Further, the control unit 2 executes the driving monitoring method at each control timing.
FIG. 2 is a flowchart showing the driving monitoring method according to the first embodiment. It is assumed that the flowchart shown in FIG. 2 is executed immediately before or while the guided vehicle Ve starts 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 uses the detection results of the obstacle sensor 1 to calculate the height H1 of the load A based on the height of the obstacle sensor 1 (height of the top surface of the vehicle Ve). Step S11). For example, the control unit 2 detects a direction a1 passing through an intersection a (lower end of the load A) between a perpendicular line extending downward from the upper end of the load A and the upper surface of the vehicle body of the transport vehicle Ve (lower end of the load A) with the obstacle sensor 1 as a reference. Obtain the angle θa between the sensor 1 and the direction a2 passing through the upper end of the load A, and calculate 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 the height H1 has changed (step S12). For example, if the difference between the height H1 calculated at the previous control timing and the height H1 calculated at the current control timing is greater than or equal to the threshold, the control unit 2 determines that the height H1 has changed, and the difference is If it is smaller than the threshold, it is determined that the height H1 is not changing.

次に、制御部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 changed (step S12: Yes), it transmits a notification that the height H1 has changed to the higher-level control device 3 (step S13), and changes the current driving monitoring method. finish. When receiving the notification that the height H1 has changed, the host control device 3 determines whether the current position of the guided vehicle Ve is the transfer location, and if it determines that the current location of the guided vehicle Ve is not the transfer location. , transmits an instruction to the control unit 2 to prohibit or stop the traveling of the guided vehicle Ve.

一方、制御部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, if the control unit 2 determines that the height H1 is not changing (step S12: No), the control unit 2 passes a position a certain distance Lb (second distance) away from the obstacle sensor 1 in the traveling direction of the guided vehicle Ve. The angle θb formed by the direction b1 and the direction b2 passing through a position that is a certain distance Lb away from the obstacle sensor 1 in the traveling direction of the guided vehicle Ve and further away by a distance H1 in the height H1 direction is calculated (step S14). ). For example, the control unit 2 calculates the angle θb by calculating tan(θb)=height H1/fixed 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 selects a direction c1 passing through a position a certain distance Lc (first distance) away from the obstacle sensor 1 in the traveling direction of the guided vehicle Ve, and a direction c1 that passes from the obstacle sensor 1 to a constant distance in the traveling direction of the guided vehicle An angle θc formed by a direction c2 that passes through a position that is a distance Lc away and further in the height H1 direction is calculated (step S15). For example, the control unit 2 calculates the angle θc by calculating tan(θb)=height H1/fixed distance Lc. Note that the constant distance Lc<the constant distance Lb. Further, the fixed distance Lc is set to be longer than the distance that the guided vehicle Ve moves from when the guided vehicle Ve is decelerated until when the guided vehicle Ve is stopped. Furthermore, the order of step S14 and step S15 may be changed.

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

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

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

また、ステップS12及びステップS13を省略してもよい。
また、ステップS14、ステップS16、及びステップS17を省略してもよい。
Further, step S12 and step 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 using the detection result of the obstacle sensor 1, and A direction c1 passing through a position that is a certain distance Lc away from the traveling direction of the guided vehicle Ve, and a position that is a certain distance Lc away from the obstacle sensor 1 in the traveling direction of the guided vehicle Ve, and further 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 guide vehicle Ve, the traveling of the guided 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 conveyance vehicle Ve, and the obstacle sensor 1 detects an obstacle at a position lower than the height H1 of the load A and prevents the conveyance vehicle Ve from traveling. Since the vehicle can be prohibited or stopped, collisions between the obstacle and the load A can be suppressed even if 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に送信する構成である。 In addition, the control unit 2 of the first embodiment has a direction b1 passing through a position a certain distance Lb away from the obstacle sensor 1 in the running direction of the guided vehicle Ve, and a certain distance from the obstacle sensor 1 in the running direction of the guided vehicle Ve. When an obstacle is detected by the obstacle sensor 1 in the range of angle θb formed by the direction b2 passing through a position Lb away from the vehicle and passing through a position further away by a distance of height H1 in the height H1 direction, the obstacle is detected by the obstacle sensor 1 in the traveling direction of the guided vehicle Ve. This configuration transmits to the higher-level control device 3 that there is an obstacle.

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

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

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

<第2実施形態>
図3は、第2実施形態の搬送車を示す図である。なお、図1に示す構成と同じ構成には同じ符号を付し、その説明を省略する。
<Second embodiment>
FIG. 3 is a diagram showing a transport vehicle according to the second embodiment. Note that the same components as those shown in FIG. 1 are denoted 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 guided vehicle, or the like, and includes a mast M, an obstacle sensor 1, and a control unit 2. Note that the 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 a driving monitoring method according to the second embodiment. Note that the flowchart shown in FIG. 4 is executed immediately before or while the guided vehicle Ve starts 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 uses the detection result of the obstacle sensor 1 to calculate the height H2 of the mast M based on the height of the obstacle sensor 1 (step S21). For example, the control unit 2 can move the direction d1 passing through the intersection d of the perpendicular extending downward from the upper end of the mast M with the obstacle sensor 1 as a reference and the upper surface of the vehicle body of the guided vehicle Ve, and the direction d1 from the obstacle sensor 1 to the upper end of the mast M. The height H2 is obtained by obtaining the angle θd formed by the direction d2 passing through the section, 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 selects a direction e1 that passes through a position a certain distance Le (second distance) away from the obstacle sensor 1 in the traveling direction of the guided vehicle Ve, and a direction e1 that passes through a position that is a certain distance Le (second distance) from the obstacle sensor 1 in the traveling direction of the guided vehicle Ve. The angle θe formed by the distance Le and the direction e2 that passes through a position further away by a distance of height H2 in the height H2 direction is calculated (step S22). For example, the control unit 2 calculates the angle θe by calculating tan(θe)=height H2/fixed 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 selects a direction f1 that passes through a position a certain distance Lf (first distance) away from the obstacle sensor 1 in the traveling direction of the guided vehicle Ve, and a direction f1 that passes from the obstacle sensor 1 to a constant distance An angle θf formed by a direction f2 that passes through a position that is a distance Lf away and further in the height H2 direction is calculated (step S23). For example, the control unit 2 calculates the angle θf by calculating tan(θf)=height H2/fixed distance Lf. Note that the constant distance Lf<the constant distance Le. Moreover, the fixed distance Lf is set to be longer than the distance that the guided vehicle Ve moves from when the guided vehicle Ve is decelerated until when the guided 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 detects no obstacle within the range of the angle θe (step S24: No), the control unit 2 returns to the process of step S21, and the obstacle sensor 1 detects the obstacle within the range of the angle θe. If an obstacle is detected (step S24: Yes), the mast M is located between a position a certain distance Le away from the obstacle sensor 1 and a position a certain distance Lf away from the obstacle sensor 1 in the traveling direction of the guided vehicle Ve. A message is sent to the host controller 3 to the effect that there is an obstacle that may collide with the host controller 3 (step S25).

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

なお、制御部2は、ステップS27において、搬送車Veを減速させた後、搬送車Veを停止させるように構成してもよい。
また、ステップS22、ステップS24、及びステップS25を省略してもよい。
Note that the control unit 2 may be configured to decelerate the guided vehicle Ve and then stop the guided 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 using the detection result of the obstacle sensor 1, and A direction f1 passing through a position a certain distance Lf in the traveling direction of the guided vehicle Ve, and a position a certain distance Lf away from the obstacle sensor 1 in the traveling direction of the guided vehicle Ve, and further a distance H2 in the height H2 direction. When an obstacle is detected by the obstacle sensor 1 within the range of angle θf formed by the direction f2 passing through the guide vehicle Ve, the traveling of the guided 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 guided vehicle Ve, and prevents the guided vehicle Ve from traveling. Since the mast M can be prohibited or stopped, collisions between the obstacle and the mast M can be suppressed even if 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に送信する構成である。 In addition, the control unit 2 of the first embodiment has a direction e1 passing through a position a certain distance Le away from the obstacle sensor 1 in the running direction of the guided vehicle Ve, and a certain distance Le from the obstacle sensor 1 in the running direction of the guided vehicle Ve. When an obstacle is detected by the obstacle sensor 1 within the range of angle θe formed by the direction e2 passing through a position a distance away from Le and further in the height H2 direction, the obstacle is detected by the obstacle sensor 1 in the traveling direction of the guided vehicle Ve. This configuration transmits to the higher-level control device 3 that there is an obstacle.

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

<第3実施形態>
図5は、第3実施形態の搬送車を示す図である。なお、図3に示す構成と同じ構成には同じ符号を付し、その説明を省略する。
<Third embodiment>
FIG. 5 is a diagram showing a transport vehicle according to the third embodiment. Note that the same components as those shown in FIG. 3 are denoted 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 guided vehicle, or the like, and includes a mast M, an obstacle sensor 1, and a control unit 2. Note that the 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 vertical movement of the mast M using the detection result of the obstacle sensor 1.
Further, the control unit 2 executes the mast monitoring method at each control timing.

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

まず、制御部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 uses the detection result of the obstacle sensor 1 to calculate the height H3 of the guided vehicle Ve to an obstacle (ceiling, etc.) located above the height of the obstacle sensor 1 as a reference. (Step S31). For example, the control unit 2 controls a direction g1 passing through an intersection point g between a perpendicular line extending downward from the upper end of the mast M and the upper surface of the vehicle body of the guided vehicle Ve with the obstacle sensor 1 as a reference, and Obtain the angle θg formed by the direction g2 passing through the obstacle above, and calculate the height H3 = tan (θg) x (distance Lg from the obstacle sensor 1 to the intersection g). demand.

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

次に、制御部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 uses the detection result of the obstacle sensor 1 to calculate a height H6 (second height) to the upper end of the mast M based on the height of the obstacle sensor 1. (Step S34). For example, the control unit 2 obtains the angle θh formed by the direction g1 passing from the obstacle sensor 1 through the intersection g and the direction h passing from the obstacle sensor 1 to the upper end of the mast M, and calculates the height H6=tan(θh )×(distance Lg) to find 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 greater than or equal to the height H5 (step S35: Yes), the control unit 2 A message is sent to the host controller 3 to the effect that there is a risk that the mast M will collide with an obstacle in the upward direction of the mast M (step S36). As a result, when the host controller 3 receives a notification that the mast M is likely to collide with an obstacle, it can prohibit or stop the mast M from rising, thereby suppressing the collision between the mast M and the obstacle. 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 if the height H6 is lower than the height H4 (step S38: No), repeats steps S37 and S38 to calculate the height H6. When the height becomes equal to or higher than the height H4 (step S38: Yes), the mast M is prohibited or stopped from rising (step S39), and the current mast monitoring method is ended.
Note that steps S33 to S36 may be omitted.

このように、第3実施形態の制御部2は、障害物センサ1の検知結果を用いて障害物センサ1の高さを基準とする搬送車Veの上方向にある障害物までの高さH3より低い高さH4を算出するとともに、障害物センサ1の検知結果を用いて障害物センサ1の高さを基準とするマストMの上端部までの高さH6を算出し、高さH6が高さH4以上になると、マストMの上昇を禁止または停止させる構成である。 In this way, the control unit 2 of the third embodiment uses the detection results of the obstacle sensor 1 to determine the height H3 of the obstacle located above the guided vehicle Ve based on the height of the obstacle sensor 1. In addition to calculating the lower height H4, 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 When the height reaches H4 or higher, the mast M is prohibited or stopped from rising.

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

<第4実施形態>
図7は、第4実施形態の搬送車を示す図である。なお、図5に示す構成と同じ構成には同じ符号を付し、その説明を省略する。
<Fourth embodiment>
FIG. 7 is a diagram showing a transport vehicle according to the fourth embodiment. Note that the same components as those shown in FIG. 5 are denoted 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 guided vehicle, or the like, and includes a mast M, an obstacle sensor 1, and a control unit 2. Note that the 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 vertical movement of the mast M using the detection result of the obstacle sensor 1.
FIG. 8 is a flowchart showing a mast monitoring method according to the fourth embodiment. It is assumed that the flowchart shown in FIG. 8 is executed immediately before the mast M starts rising.

まず、制御部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 determine a direction g1 passing through the intersection g of a perpendicular extending downward from the upper end of the mast M and the upper surface of the vehicle body of the guided vehicle Ve with the obstacle sensor 1 as a reference. An angle θi between the obstacle sensor 1 and the direction i passing through the upper end of the mast M at maximum rise is calculated (step S41). For example, the control unit 2 calculates tan(θi)=(height H7 from the upper end of mast M to intersection g at maximum rise)/(distance Lg from obstacle sensor 1 to intersection g). , find the angle θi.

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

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

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

また、本発明は、以上の実施の形態に限定されるものでなく、本発明の要旨を逸脱しない範囲内で種々の改良、変更が可能である。 Furthermore, the present invention is not limited to the above-described 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)

荷が車体に積載される搬送車またはマストを備える搬送車であって、
前記車体の上面に設けられ、前記車体の上方向において少なくとも180度の範囲の障害物を検知する一つの障害物センサと、
前記搬送車の走行を制御する制御部と、
を備え、
前記制御部は、前記障害物センサの検知結果を用いて前記障害物センサの高さを基準とする前記荷または前記マストの高さを算出し、前記障害物センサから前記搬送車の走行方向に第1距離離れた位置を通る方向と、前記障害物センサから前記搬送車の走行方向に前記第1距離離れ、さらに前記高さの方向に前記高さの距離離れた位置を通る方向とがなす角度の範囲に、前記障害物センサにより障害物が検知されると、前記搬送車の走行を禁止または停止させる
ことを特徴とする搬送車。
A transport vehicle on which a load is loaded on the vehicle body or a transport vehicle equipped with a mast,
one obstacle sensor that is provided on the upper surface of the vehicle body and detects obstacles within a range of at least 180 degrees in the upper direction of the vehicle body;
a control unit that controls traveling of the conveyance vehicle;
Equipped with
The control unit calculates the height of the load or the mast based on the height of the obstacle sensor using the detection result of the obstacle sensor, and calculates the height of the load or the mast based on the height of the obstacle sensor, and A direction that passes through a position that is a first distance away from the obstacle sensor, and a direction that passes through a position that is the first distance away from the obstacle sensor in the traveling direction of the conveyance vehicle, and further that is a distance away from the height in the direction of the height. A conveyance vehicle characterized in that when an obstacle is detected by the obstacle sensor within an angular range, traveling of the conveyance vehicle is prohibited or stopped.
請求項1に記載の搬送車であって、
前記搬送車の走行中に前記荷または前記マストの高さが変化し、
前記制御部は、前記障害物センサから前記搬送車の走行方向に前記第1距離より長い第2距離離れた位置を通る方向と、前記障害物センサから前記搬送車の走行方向に前記第2距離離れ、さらに前記高さの方向に前記高さの距離離れた位置を通る方向とがなす角度の範囲に、前記障害物センサにより障害物が検知されると、前記搬送車の走行方向に障害物がある旨を、前記搬送車の走行を制御する上位制御装置に送信する
ことを特徴とする搬送車。
The transport vehicle according to claim 1,
The height of the load or the mast changes while the transport vehicle is running;
The control unit includes a direction passing a second distance from the obstacle sensor in the traveling direction of the guided vehicle, which is longer than the first distance, and a second distance from the obstacle sensor in the traveling direction of the guided vehicle. When the obstacle is detected by the obstacle sensor in the range of the angle formed by the direction passing through the position further away from the height, the obstacle is detected in the traveling direction of the conveyance vehicle. A conveyance vehicle, characterized in that the conveyance vehicle transmits information to the effect that the conveyance vehicle is present to a higher-level control device that controls traveling of the conveyance vehicle.
請求項1または請求項2に記載の搬送車であって、
前記制御部は、前記荷の高さが変動した場合、前記荷の高さが変動した旨を、前記搬送車の走行を制御する上位制御装置に送信する
ことを特徴とする搬送車。
The transport vehicle according to claim 1 or claim 2,
The conveying vehicle is characterized in that, when the height of the load changes, the control unit transmits a notification to the effect that the height of the load has changed to a host control device that controls travel of the conveying vehicle.
請求項1に記載の搬送車であって、
前記制御部は、前記障害物センサの検知結果を用いて前記障害物センサの高さを基準とする前記搬送車の上方向にある障害物までの高さよりも低い第1の高さを算出するとともに、前記障害物センサの検知結果を用いて前記障害物センサを基準とする前記マストの上端部までの第2の高さを算出し、前記第2の高さが前記第1の高さ以上になると、前記マストの上昇を禁止または停止させる
ことを特徴とする搬送車。
The transport vehicle according to claim 1,
The control unit uses the detection result of the obstacle sensor to calculate a first height that is lower than a height to an obstacle located above the carrier based on the height of the obstacle sensor. At the same time, a second height from the obstacle sensor to the upper end of the mast is calculated using the detection result of the obstacle sensor, and the second height is equal to or higher than the first height. The transport vehicle is characterized in that the mast is prohibited or stopped from rising when the mast is reached.
請求項1に記載の搬送車であって、
前記制御部は、前記障害物センサを基準として前記マストの上端部から下方に伸びる垂線と前記搬送車の車体上面との交点を通る方向と、前記障害物センサから最大上昇時の前記マストの上端部を通る方向とがなす角度の範囲に、前記障害物センサにより前記マスト以外の障害物が検知されると、前記マストの上昇を禁止させる
ことを特徴とする搬送車。
The transport vehicle according to claim 1,
The control unit is configured to control a direction passing through an intersection between a perpendicular line extending downward from the upper end of the mast and an upper surface of the vehicle body of the transport vehicle with the obstacle sensor as a reference, and a direction from the obstacle sensor to the upper end of the mast at the time of maximum rise. A conveyance vehicle, wherein when the obstacle sensor detects an obstacle other than the mast within an angular range formed by a direction passing through the mast, the mast is prohibited from rising.
荷が車体に積載される搬送車またはマストを備える搬送車の制御部により実行される走行監視方法であって、
前記制御部は、
前記車体の上面に設けられ、前記車体の上方向において少なくとも180度の範囲の障害物を検知する一つの障害物センサの検知結果を用いて前記障害物センサの高さを基準とする前記荷または前記マストの高さを算出し、
前記障害物センサから前記搬送車の走行方向に第1距離離れた位置を通る方向と、前記障害物センサから前記搬送車の走行方向に前記第1距離離れ、さらに前記高さの方向に前記高さの距離離れた位置を通る方向とがなす角度の範囲に、前記障害物センサにより障害物が検知されると、前記搬送車の走行を禁止または停止させる
ことを特徴とする走行監視方法。
A traveling monitoring method executed by a control unit of a transport vehicle on which a load is loaded on a vehicle body or a transport vehicle equipped with a mast, the method comprising:
The control unit includes:
The load or Calculating the height of the mast;
A direction passing through a position a first distance away from the obstacle sensor in the traveling direction of the transport vehicle, and a direction passing the first distance away from the obstacle sensor in the travel direction of the transport vehicle, and further in a direction of the height. A traveling monitoring method, comprising: prohibiting or stopping traveling of the transport vehicle when the obstacle sensor detects an obstacle within an angle range formed by a direction passing a position a distance away from the transport vehicle.
請求項6に記載の走行監視方法であって、
前記制御部は、
前記障害物センサの検知結果を用いて前記障害物センサの高さを基準とする前記搬送車の上方向にある障害物までの高さよりも低い第1の高さを算出するとともに、前記障害センサの検知結果を用いて前記障害物センサの高さを基準とする前記マストの上端部までの第2の高さを算出し、
前記第2の高さが前記第1の高さ以上になると、前記マストの上昇を禁止または停止させる
ことを特徴とする走行監視方法。
The driving monitoring method according to claim 6,
The control unit includes:
Using the detection result of the obstacle sensor, calculate a first height that is lower than the height of the obstacle located above the transport vehicle based on the height of the obstacle sensor, and Calculating a second height to the upper end of the mast based on the height of the obstacle sensor using the detection result of the sensor,
A travel monitoring method characterized in that, when the second height becomes equal to or higher than the first height, raising of the mast is prohibited or stopped.
請求項6に記載の走行監視方法であって、
前記制御部は、前記障害物センサを基準として前記マストの上端部から下方に伸びる垂線と前記搬送車の車体上面との交点を通る方向と、前記障害物センサから最大上昇時の前記マストの上端部を通る方向とがなす角度の範囲に、前記障害物センサにより前記マスト以外の障害物が検知されると、前記マストの上昇を禁止させる
ことを特徴とする走行監視方法。
The driving monitoring method according to claim 6,
The control unit is configured to control a direction passing through an intersection between a perpendicular line extending downward from the upper end of the mast and an upper surface of the vehicle body of the transport vehicle with the obstacle sensor as a reference, and a direction from the obstacle sensor to the upper end of the mast at the time of maximum rise. 1. A running monitoring method, comprising: prohibiting the mast from rising if the obstacle sensor detects an obstacle other than the mast within an angular range formed by a direction passing through the mast.
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 JP2021111138A (en) 2021-08-02
JP7363495B2 true 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 (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
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

Family Cites Families (2)

* 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

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
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
JP2021111138A (en) 2021-08-02

Similar Documents

Publication Publication Date Title
JP7113343B2 (en) Mobile robot control system and mobile robot control method
US11440188B2 (en) Robot system
EP3401186B1 (en) Article transport vehicle
JP5062364B2 (en) Autonomous mobile body and control method thereof
JP6272347B2 (en) Autonomous traveling vehicle and autonomous traveling system
EP2855332B1 (en) Determining movement distance of lifting device
JP2015170284A (en) Forklift type unmanned carrier vehicle, control method of the same, and control device of the same
JP5390419B2 (en) Automated guided vehicle
RU2719083C1 (en) Method for controlling movement and device for controlling movement of vehicle
JP2019182056A (en) Drive support apparatus
US11027953B2 (en) Method for monitoring the road path of a truck and a floor conveyor
US20210130139A1 (en) Method for generating a trajectory for a hoisting appliance
JP7363495B2 (en) Transport vehicle, running monitoring method, and mast monitoring method
US11420640B2 (en) Method for autonomously operating a vehicle, controller device for a vehicle, and vehicle
CN113396123B (en) Collision-free routing of loads suspended on a cable
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
US11667502B2 (en) Industrial truck, configured for driverless, autonomously acting operation for a load to be transported
JP6964542B2 (en) Observation system
CN112783148A (en) Automatic guided vehicle
KR102007568B1 (en) System and Method for Safe Driving of Crane
JP2021011167A (en) Driving control method and driving control device
WO2022059243A1 (en) Traffic control system and traffic control method
Bosio How sensors are moving materials handling towards safe automation
KR102279793B1 (en) Method and device for controlling vehicle of Overhead Hoist Transfer

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