JP2021028266A - Working machine and control method of working machine - Google Patents

Working machine and control method of working machine Download PDF

Info

Publication number
JP2021028266A
JP2021028266A JP2019147844A JP2019147844A JP2021028266A JP 2021028266 A JP2021028266 A JP 2021028266A JP 2019147844 A JP2019147844 A JP 2019147844A JP 2019147844 A JP2019147844 A JP 2019147844A JP 2021028266 A JP2021028266 A JP 2021028266A
Authority
JP
Japan
Prior art keywords
forklift
vehicle speed
range
alarm
unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2019147844A
Other languages
Japanese (ja)
Other versions
JP7370189B2 (en
Inventor
洋平 関
Yohei Seki
洋平 関
将崇 尾崎
Masataka Ozaki
将崇 尾崎
大 佐藤
Masaru Sato
大 佐藤
友紀 諏訪
Yuki Suwa
友紀 諏訪
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.)
Komatsu Ltd
Original Assignee
Komatsu Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Komatsu Ltd filed Critical Komatsu Ltd
Priority to JP2019147844A priority Critical patent/JP7370189B2/en
Publication of JP2021028266A publication Critical patent/JP2021028266A/en
Priority to JP2023178898A priority patent/JP2023174836A/en
Application granted granted Critical
Publication of JP7370189B2 publication Critical patent/JP7370189B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Forklifts And Lifting Vehicles (AREA)

Abstract

To provide a working machine and a control method of the working machine capable of properly detecting surrounding objects.SOLUTION: An object detection system comprises: an object detection device 70 to detect objects surrounding a working machine; a vehicle speed sensor 62 to detect the vehicle speed of the working machine; a setting unit 93 to set a first detection range and a second detection range for detecting the objects surrounding the working machine; a switching unit 92 to switch the first detection range and the second detection range according to the vehicle speed detected by the vehicle speed sensor 62; and a determination unit 95 to determine whether or not the object is detected in the first detection range and the second detection range switched by the switching unit 92.SELECTED DRAWING: Figure 2

Description

本開示は、作業機械及び作業機械の制御方法に関する。 The present disclosure relates to a work machine and a method for controlling the work machine.

例えば、フォークリフトを含む作業機械において、周辺に人を含む物体が存在するか否かを検出する検出装置を備えることが知られている(例えば、特許文献1参照)。 For example, it is known that a work machine including a forklift is provided with a detection device for detecting whether or not an object including a person is present in the vicinity (see, for example, Patent Document 1).

特開2016−194481号公報Japanese Unexamined Patent Publication No. 2016-194481

作業機械は、倉庫又は工場のように、周辺に様々な物体が存在する場所を走行する。作業機械に設置された検出装置が検出可能な範囲に侵入した物体をすべて検出して、警報を出力する場合、警報が頻繁に発せられることになる。 Work machines travel in places where various objects exist in the vicinity, such as warehouses or factories. When the detection device installed in the work machine detects all the objects that have entered the detectable range and outputs an alarm, the alarm is issued frequently.

本開示の態様は、周辺の物体を適切に検出可能な作業機械及び作業機械の制御方法を提供することを目的とする。 It is an object of the present disclosure to provide a work machine and a control method of the work machine capable of appropriately detecting a surrounding object.

本開示の態様に従えば、作業機械の周辺の物体を検出する物体検出部と、前記作業機械の車速を検出する車速検出部と、前記作業機械の周辺において前記物体を検出する第1検出範囲と第2検出範囲とを設定する設定部と、前記車速検出部が検出した車速に応じて、前記第1検出範囲と前記第2検出範囲とを切り替える切替部と、前記切替部が切り替えた前記第1検出範囲又は前記第2検出範囲において、前記物体が検出されたか否かを判定する判定部とを備える作業機械が提供される。 According to the aspect of the present disclosure, an object detection unit that detects an object around the work machine, a vehicle speed detection unit that detects the vehicle speed of the work machine, and a first detection range that detects the object around the work machine. The setting unit that sets the first detection range and the second detection range, the switching unit that switches between the first detection range and the second detection range according to the vehicle speed detected by the vehicle speed detection unit, and the switching unit that the switching unit switches. A work machine including a determination unit for determining whether or not the object is detected in the first detection range or the second detection range is provided.

本開示の態様に従えば、作業機械の周辺の物体を物体検出部によって検出することと、前記作業機械の車速を車速検出部によって検出することと、前記作業機械の周辺において前記物体を検出する第1検出範囲と第2検出範囲とを設定することと、前記車速検出部によって検出された車速に応じて、前記第1検出範囲と前記第2検出範囲とを切り替えることと、切り替えられた前記第1検出範囲又は前記第2検出範囲において、前記物体が検出されたか否かを判定することとを含む作業機械の制御方法が提供される。 According to the aspect of the present disclosure, the object around the work machine is detected by the object detection unit, the vehicle speed of the work machine is detected by the vehicle speed detection unit, and the object is detected around the work machine. The first detection range and the second detection range are set, the first detection range and the second detection range are switched according to the vehicle speed detected by the vehicle speed detection unit, and the switched state is described. A method for controlling a work machine is provided, which includes determining whether or not the object is detected in the first detection range or the second detection range.

本開示の態様によれば、周辺の物体を適切に検出することができる作業機械及び作業機械の制御方法が提供される。 According to the aspect of the present disclosure, there is provided a work machine and a control method of the work machine capable of appropriately detecting a surrounding object.

図1は、本実施形態に係るフォークリフトを左後方斜め上側から見た状態を示した斜視図である。FIG. 1 is a perspective view showing a state in which the forklift according to the present embodiment is viewed from the diagonally upper left rear side. 図2は、本実施形態に係るフォークリフトの制御システムの一例を示す機能ブロック図である。FIG. 2 is a functional block diagram showing an example of a forklift control system according to the present embodiment. 図3は、第1範囲の一例を示す模式図である。FIG. 3 is a schematic view showing an example of the first range. 図4は、第2範囲の一例を示す模式図である。FIG. 4 is a schematic view showing an example of the second range. 図5は、第2範囲の他の例を示す模式図である。FIG. 5 is a schematic view showing another example of the second range. 図6は、第2範囲の他の例を示す模式図である。FIG. 6 is a schematic view showing another example of the second range. 図7は、第2範囲の他の例を示す模式図である。FIG. 7 is a schematic view showing another example of the second range. 図8は、警報レベルの一例を説明する図である。FIG. 8 is a diagram illustrating an example of an alarm level. 図9は、物体検出システムの処理の一例を示すフローチャートである。FIG. 9 is a flowchart showing an example of processing of the object detection system. 図10は、物体検出システムの第1範囲における物体検出処理の一例を示すフローチャートである。FIG. 10 is a flowchart showing an example of the object detection process in the first range of the object detection system. 図11は、物体検出システムの第2範囲における物体検出処理の一例を示すフローチャートである。FIG. 11 is a flowchart showing an example of the object detection process in the second range of the object detection system. 図12は、本実施形態に係るコンピュータシステムの一例を示すブロック図である。FIG. 12 is a block diagram showing an example of a computer system according to the present embodiment.

以下、本開示に係る実施形態について図面を参照しながら説明するが、本開示はこれに限定されない。以下で説明する各実施形態の構成要素は、適宜組み合わせることができる。また、一部の構成要素を用いない場合もある。 Hereinafter, embodiments according to the present disclosure will be described with reference to the drawings, but the present disclosure is not limited thereto. The components of each embodiment described below can be combined as appropriate. In addition, some components may not be used.

本実施形態においては、作業機械として、バッテリからの電力又はエンジン等によって駆動される発電機から得られた電力で駆動されるフォークリフト1を例として説明するが、作業機械はこれに限定されない。例えば、作業機械は、バッテリからの電力又はエンジン等によって駆動される発電機から得られた電力で駆動されるホイールローダ等であってもよい。また、作業機械は、電力によって駆動されるものに限定されず、油圧によって駆動されるフォークリフト等であってもよい。 In the present embodiment, the forklift 1 driven by the electric power from the battery or the electric power obtained from the generator driven by the engine or the like will be described as an example of the working machine, but the working machine is not limited thereto. For example, the work machine may be a wheel loader or the like driven by electric power from a battery or electric power obtained from a generator driven by an engine or the like. Further, the work machine is not limited to one driven by electric power, and may be a forklift or the like driven by flood control.

図1は、本実施形態に係るフォークリフト1を左後方斜め上側から見た状態を示した斜視図である。以下において、フォークリフト1は、フォーク13が設けられている側が前方であり、カウンタウエイト20が設けられている側が後方である。作業機械がフォークリフトでない場合、運転席34から操作装置としてのハンドル36に向かう側が前方であり、ハンドル36から運転席34に向かう側が後方である。操作装置としては、作業機械の操舵に用いるハンドル36の他、油圧ショベル又はホイールローダ等においては作業機を操作するための操作レバーも含まれる。 FIG. 1 is a perspective view showing a state in which the forklift 1 according to the present embodiment is viewed from the diagonally upper left rear side. In the following, the forklift 1 has a front side on which the fork 13 is provided and a rear side on which the counterweight 20 is provided. When the work machine is not a forklift, the side from the driver's seat 34 toward the handle 36 as an operating device is the front, and the side from the handle 36 toward the driver's seat 34 is the rear. The operating device includes a handle 36 used for steering the working machine, and an operating lever for operating the working machine in a hydraulic excavator, a wheel loader, or the like.

本実施形態においては、左右とは前方に対する左右をいうものとする。左右方向は、作業機械の本体としての車体10の幅方向である。上方は、前輪11及び後輪12のうち少なくとも3個と接触する平面(接地平面)に直交し、かつ接地平面から前輪11又は後輪12の回転中心軸に向かう側である。下方は、前輪11又は後輪12の回転中心軸から接地平面に向かう側である。車体10の前後方向に向かい、かつ車体10の幅方向中心を通る軸を前後軸といい、前後軸に直交し、設置平面と平行かつ車体10の左右方向に向かう軸を左右軸という。車体10の上下方向に向かう軸を上下軸という。上下軸は、前後軸と左右軸との両方に直交する。以下において、平面視とは、上方から見た状態をいうものとする。 In the present embodiment, the left and right means the left and right with respect to the front. The left-right direction is the width direction of the vehicle body 10 as the main body of the work machine. The upper side is orthogonal to a plane (ground plane) in contact with at least three of the front wheels 11 and the rear wheels 12, and is a side from the ground plane toward the rotation center axis of the front wheels 11 or the rear wheels 12. The lower side is the side from the rotation center axis of the front wheel 11 or the rear wheel 12 toward the ground plane. The axis that goes in the front-rear direction of the vehicle body 10 and passes through the center of the vehicle body 10 in the width direction is called the front-rear axis, and the axis that is orthogonal to the front-rear axis and is parallel to the installation plane and in the left-right direction of the vehicle body 10 is called the left-right axis. The axis of the vehicle body 10 in the vertical direction is called the vertical axis. The vertical axis is orthogonal to both the front-rear axis and the left-right axis. In the following, the plan view means a state viewed from above.

<フォークリフトの全体構成>
フォークリフト1は、車体10の前方の左右の端部にそれぞれ前輪11が設置され、車体10の後方の左右の端部にそれぞれ後輪12が設置されている。車体10の前方には、荷物の積み降ろし又は移動を行うためのフォーク13が設置されている。フォーク13は、上下方向に沿って設置されたマスト14に支持されている。フォーク13は、マスト14との間に設置されたマストシリンダ15が駆動することによって、マスト14に沿って昇降する。マスト14は、下端部が、左右軸回りに回転可能に車体10に取り付けられている。マスト14は、車体10との間に設置された、図示しないチルトシリンダが駆動することによって、車体10に対して前傾姿勢又は後傾姿勢をとることが可能である。
<Overall configuration of forklift>
In the forklift 1, front wheels 11 are installed at the front left and right ends of the vehicle body 10, and rear wheels 12 are installed at the rear left and right ends of the vehicle body 10. A fork 13 for loading / unloading or moving luggage is installed in front of the vehicle body 10. The fork 13 is supported by a mast 14 installed along the vertical direction. The fork 13 moves up and down along the mast 14 by being driven by a mast cylinder 15 installed between the fork 13 and the mast 14. The lower end of the mast 14 is attached to the vehicle body 10 so as to be rotatable around the left and right axes. The mast 14 can take a forward leaning posture or a backward leaning posture with respect to the vehicle body 10 by driving a tilt cylinder (not shown) installed between the mast 14 and the vehicle body 10.

車体10の後端部には、カウンタウエイト20が設けられている。フォークリフト1は、カウンタバランス型のフォークリフトであるが、これに限定されない。カウンタウエイト20は、フォーク13が荷物を支持した場合に釣り合いをとるためのウエイトである。 A counterweight 20 is provided at the rear end of the vehicle body 10. The forklift 1 is a counterbalance type forklift, but the forklift 1 is not limited to this. The counterweight 20 is a weight for balancing when the fork 13 supports the load.

フォークリフト1は、アクセルペダル37、ブレーキペダル38及び進行方向切替レバー39を備える。アクセルペダル37は、図示しない走行用電動機の出力及び回転方向を制御する操作用の部材である。ブレーキペダル38は、フォークリフト1を停止させるための操作用の部材である。進行方向切替レバー39は、フォークリフト1の進行方向を前方又は後方のいずれか一方に切り替えるための操作用の部材である。 The forklift 1 includes an accelerator pedal 37, a brake pedal 38, and a traveling direction switching lever 39. The accelerator pedal 37 is an operation member that controls the output and rotation direction of a traveling electric motor (not shown). The brake pedal 38 is an operation member for stopping the forklift 1. The traveling direction switching lever 39 is an operation member for switching the traveling direction of the forklift 1 to either the front or the rear.

フォークリフト1は、ハンドル36の前方に、表示装置としての表示パネル52が設置されている。表示パネル52は、フォークリフト1に対して様々な設定をするための入力部と、フォークリフト1の状態等に関する情報を表示する表示部とを有している。フォークリフト1のオペレータは、表示パネル52を介して、フォークリフト1に対して様々な設定をする。フォークリフト1の状態等に関する情報は、例えば、フォークリフト1の周辺に物体が検出されたことを示す警報等である。物体とは、例えば、フォークリフト1の周辺の作業者、他の作業機械、又は、障害物等を含む。 In the forklift 1, a display panel 52 as a display device is installed in front of the handle 36. The display panel 52 has an input unit for making various settings for the forklift 1 and a display unit for displaying information regarding the state of the forklift 1. The operator of the forklift 1 makes various settings for the forklift 1 via the display panel 52. The information regarding the state of the forklift 1 and the like is, for example, an alarm indicating that an object has been detected around the forklift 1. The object includes, for example, a worker around the forklift 1, another work machine, an obstacle, or the like.

<フォークリフトの全体の制御系>
次に、本実施形態に係るフォークリフト1の制御系の一例について説明する。図2に示すように、フォークリフト1の制御系は、フォークリフト1を制御する車両制御装置69を含む。図2は、本実施形態に係るフォークリフト1の制御システムの一例を示す機能ブロック図である。
<Overall control system for forklifts>
Next, an example of the control system of the forklift 1 according to the present embodiment will be described. As shown in FIG. 2, the control system of the forklift 1 includes a vehicle control device 69 that controls the forklift 1. FIG. 2 is a functional block diagram showing an example of the control system of the forklift 1 according to the present embodiment.

車両制御装置69は、CPU(Central Processing Unit)のような数値演算装置(プロセッサ)を含む。車両制御装置69は、フォークリフト1の走行状態を制御可能である。車両制御装置69は、フォークリフト1の走行状態を示す各種データを取得する。より詳しくは、車両制御装置69は、例えば、フォークリフト1のタイヤ切れ角を示すデータ、車速を示すデータ、進行方向を示すデータ、図示しないパーキングブレーキの状態を示すデータを取得する。 The vehicle control device 69 includes a numerical arithmetic unit (processor) such as a CPU (Central Processing Unit). The vehicle control device 69 can control the traveling state of the forklift 1. The vehicle control device 69 acquires various data indicating the traveling state of the forklift 1. More specifically, the vehicle control device 69 acquires, for example, data indicating the tire turning angle of the forklift 1, data indicating the vehicle speed, data indicating the traveling direction, and data indicating the state of the parking brake (not shown).

このような車両制御装置69は、フォークリフト1の車体10の状態量を示すデータを検出する車体データ取得装置60の一部として機能する。車体データ取得装置60については、後述する。 Such a vehicle control device 69 functions as a part of the vehicle body data acquisition device 60 that detects data indicating the state quantity of the vehicle body 10 of the forklift 1. The vehicle body data acquisition device 60 will be described later.

<物体検出システム>
次に、本実施形態に係る物体検出システム300について説明する。フォークリフト1は、フォークリフト1の周辺の物体を検出可能な物体検出システム300を備える。本実施形態において、フォークリフト1は、一例としてフォークリフト1の後方の物体を検出可能な物体検出システム300を備えるものとして説明する。フォークリフト1は、フォークリフト1の前方の物体を検出可能な物体検出システム300を備えてもよい。
<Object detection system>
Next, the object detection system 300 according to the present embodiment will be described. The forklift 1 includes an object detection system 300 capable of detecting an object around the forklift 1. In the present embodiment, the forklift 1 will be described as including, for example, an object detection system 300 capable of detecting an object behind the forklift 1. The forklift 1 may include an object detection system 300 capable of detecting an object in front of the forklift 1.

本実施形態においては、物体検出システム300は、フォークリフト1の前後方向の後方の物体を検出し、前方の物体を検出しない場合について説明する。フォークリフト1の前方にはフォーク13が設置されている。このため、物体検出装置70が、フォーク13に載置された積荷を検出する可能性が高く、誤警報を出力するおそれがある。また、前方は、運転席に座ったオペレータが、目視で確認することが可能である。これらにより、物体検出システム300は、フォークリフト1の後方の物体を検出するものとして説明する。なお、物体検出システム300は、前方の物体を検出する場合、例えば、フォーク13に載置された積荷が検出されにくい位置に、物体検出装置70を設置する等してもよい。 In the present embodiment, the case where the object detection system 300 detects an object behind the forklift 1 in the front-rear direction and does not detect an object in front of the forklift 1 will be described. A fork 13 is installed in front of the forklift 1. Therefore, the object detection device 70 is likely to detect the load mounted on the fork 13, and may output a false alarm. In addition, the front can be visually confirmed by the operator sitting in the driver's seat. From these, the object detection system 300 will be described as detecting an object behind the forklift 1. When the object detection system 300 detects an object in front, for example, the object detection device 70 may be installed at a position where the load placed on the fork 13 is difficult to detect.

物体検出システム300は、フォークリフト1の車体データを取得する車体データ取得装置60と、フォークリフト1の後方の物体を検出する物体検出装置(物体検出部)70と、警報を出力する警報装置(警報部)80と、フォークリフト1を制御する制御装置90とを備える。車体データ取得装置60の検出結果及び物体検出装置70の検出結果は、制御装置90に出力される。制御装置90は、それらの検出結果に基づいて、警報装置80から警報を出力する。 The object detection system 300 includes a vehicle body data acquisition device 60 that acquires vehicle body data of the forklift 1, an object detection device (object detection unit) 70 that detects an object behind the forklift 1, and an alarm device (alarm unit) that outputs an alarm. ) 80 and a control device 90 for controlling the forklift 1. The detection result of the vehicle body data acquisition device 60 and the detection result of the object detection device 70 are output to the control device 90. The control device 90 outputs an alarm from the alarm device 80 based on the detection results thereof.

<車体データ取得装置>
車体データ取得装置60は、フォークリフト1の車両制御装置69と、フォークリフト1のタイヤ切れ角(操舵角)を検出する切れ角センサ(操舵角検出部)61と、フォークリフト1の車速を検出する車速センサ(車速検出部)62とを含む。
<Body data acquisition device>
The vehicle body data acquisition device 60 includes a vehicle control device 69 of the forklift 1, a turning angle sensor (steering angle detection unit) 61 that detects the tire turning angle (steering angle) of the forklift 1, and a vehicle speed sensor that detects the vehicle speed of the forklift 1. (Vehicle speed detection unit) 62 and the like.

切れ角センサ61は、フォークリフト1のタイヤ切れ角を算出可能なセンサデータを検出する。切れ角センサ61は、例えば、フォークリフト1の図示しない操舵装置の操舵角を検出するステアリングセンサを含む。例えば、ステアリングセンサとしてロータリーエンコーダを用いることができる。切れ角センサ61は、フォークリフト1の図示しない走行方向操作部の回転量又は操舵角を検出する回転量センサを含んでもよい。切れ角センサ61は、検出したセンサデータを検出結果として車両制御装置69に出力する。車両制御装置69では、切れ角センサ61の検出結果から、切れ角を算出する。 The turning angle sensor 61 detects sensor data capable of calculating the tire turning angle of the forklift 1. The turning angle sensor 61 includes, for example, a steering sensor that detects the steering angle of a steering device (not shown) of the forklift 1. For example, a rotary encoder can be used as the steering sensor. The turning angle sensor 61 may include a rotation amount sensor that detects the rotation amount or steering angle of a traveling direction operation unit (not shown) of the forklift 1. The turning angle sensor 61 outputs the detected sensor data as a detection result to the vehicle control device 69. The vehicle control device 69 calculates the turning angle from the detection result of the turning angle sensor 61.

車速センサ62は、フォークリフト1の車速を検出する。より詳しくは、車速センサ62は、フォークリフト1の車速を算出可能なセンサデータを検出する。車速センサ62は、前輪11又は後輪12の回転速度を検出する回転速度センサを含む。車速センサ62は、検出したセンサデータを検出結果として車両制御装置69に出力する。車両制御装置69では、車速センサ62の検出結果から、車速を算出する。 The vehicle speed sensor 62 detects the vehicle speed of the forklift 1. More specifically, the vehicle speed sensor 62 detects sensor data capable of calculating the vehicle speed of the forklift 1. The vehicle speed sensor 62 includes a rotation speed sensor that detects the rotation speed of the front wheels 11 or the rear wheels 12. The vehicle speed sensor 62 outputs the detected sensor data to the vehicle control device 69 as a detection result. The vehicle control device 69 calculates the vehicle speed from the detection result of the vehicle speed sensor 62.

進行方向センサ63は、フォークリフト1の進行方向を検出する。より詳しくは、進行方向センサ63は、フォークリフト1の前進又は後進と、中立とを切り替える前後進レバーの操作状態を示すデータを検出する。進行方向センサ63は、進行方向を示す、前後進レバーの位置を検出する。進行方向センサ63は、前後進レバーの操作位置が前進である場合、進行方向が前進であることを示すデータを検出する。進行方向センサ63は、前後進レバーの操作位置が後進である場合、進行方向が後進であることを示すデータを検出する。進行方向センサ63は、前後進レバーの操作位置が中立である場合、進行方向が中立であることを示すデータを検出する。進行方向センサ63は、検出結果を車両制御装置69に出力する。 The traveling direction sensor 63 detects the traveling direction of the forklift 1. More specifically, the traveling direction sensor 63 detects data indicating an operating state of the forward / backward lever for switching between forward / backward movement and neutrality of the forklift 1. The traveling direction sensor 63 detects the position of the forward / backward lever indicating the traveling direction. When the operating position of the forward / backward lever is forward, the traveling direction sensor 63 detects data indicating that the traveling direction is forward. The traveling direction sensor 63 detects data indicating that the traveling direction is backward when the operation position of the forward / backward lever is backward. When the operating position of the forward / backward lever is neutral, the traveling direction sensor 63 detects data indicating that the traveling direction is neutral. The traveling direction sensor 63 outputs the detection result to the vehicle control device 69.

パーキングブレーキセンサ64は、フォークリフト1のパーキングブレーキの踏込状態を検出する。パーキングブレーキセンサ64は、パーキングブレーキの踏込量に基づいて、パーキングブレーキがかけられているか、パーキングブレーキが解除されているかを検出する。パーキングブレーキセンサ64は、検出結果を車両制御装置69に出力する。 The parking brake sensor 64 detects the depressed state of the parking brake of the forklift 1. The parking brake sensor 64 detects whether the parking brake is applied or the parking brake is released based on the amount of depression of the parking brake. The parking brake sensor 64 outputs the detection result to the vehicle control device 69.

<物体検出装置>
物体検出装置70は、フォークリフト1の周辺の物体を検出する。本実施形態では、物体検出装置70は、フォークリフト1の後方に存在する物体を非接触で検出する。物体検出装置70は、例えば、ミリ波レーダ装置のようなレーダ装置を含む。レーダ装置は、例えば、電波又は超音波を発信して、物体で反射した電波又は超音波を受信することによって、レーダ装置の前方に存在する物体の有無を検出可能である。また、レーダ装置は、物体の有無のみならず、物体との相対位置として相対距離及び方位、及び、物体との相対速度を検出可能である。なお、物体検出装置70は、レーザスキャナ及び3次元距離センサの少なくとも一つで構成されてもよい。また、物体検出装置70は、複数設置されていてもよい。
<Object detection device>
The object detection device 70 detects an object around the forklift 1. In the present embodiment, the object detection device 70 detects an object existing behind the forklift 1 in a non-contact manner. The object detection device 70 includes a radar device such as a millimeter wave radar device, for example. The radar device can detect the presence or absence of an object existing in front of the radar device by, for example, transmitting radio waves or ultrasonic waves and receiving radio waves or ultrasonic waves reflected by the object. Further, the radar device can detect not only the presence / absence of the object but also the relative distance and direction as the relative position with the object and the relative velocity with the object. The object detection device 70 may be composed of at least one of a laser scanner and a three-dimensional distance sensor. Further, a plurality of object detection devices 70 may be installed.

物体検出装置70は、フォークリフト1の後部に設置される。本実施形態において、物体検出装置70は、図1に示すように、リヤピラー16に設置される。なお、物体検出装置70は、フォークリフト1の後方の物体を検出できれば、他の位置に設置されていてもよい。 The object detection device 70 is installed at the rear of the forklift 1. In this embodiment, the object detection device 70 is installed on the rear pillar 16 as shown in FIG. The object detection device 70 may be installed at another position as long as it can detect an object behind the forklift 1.

本実施形態では、物体検出装置70は、フォークリフト1の後方に検出領域を有する。より詳しくは、物体検出装置70は、フォークリフト1の後方において上下方向及び左右方向のそれぞれに放射状に広がる検出領域を有する。物体検出装置70は、検出領域に存在する物体を検出可能である。物体検出装置70は、フォークリフト1と検出領域に存在する物体との相対位置を示す相対距離と方位、及び、物体との相対速度を検出可能である。 In the present embodiment, the object detection device 70 has a detection area behind the forklift 1. More specifically, the object detection device 70 has a detection region that extends radially in each of the vertical direction and the horizontal direction behind the forklift 1. The object detection device 70 can detect an object existing in the detection area. The object detection device 70 can detect the relative distance and direction indicating the relative position between the forklift 1 and the object existing in the detection area, and the relative velocity with the object.

物体検出装置70の検出領域のフォークリフト1の前後方向の長さはXa[m]である。長さXa[m]は、物体検出装置70の図示しない射出部と検出領域の先端部との距離である。長さXa[m]は、例えば、5m程度である。 The length of the detection area of the object detection device 70 in the front-rear direction of the forklift 1 is Xa [m]. The length Xa [m] is the distance between the injection portion (not shown) of the object detection device 70 and the tip portion of the detection region. The length Xa [m] is, for example, about 5 m.

本実施形態では、物体検出装置70は、一対として設置された、左レーダ(物体検出部)70L及び右レーダ(物体検出部)70Rを含む。左レーダ70Lは、フォークリフト1の後方左側に設置される。左レーダ70Lは、フォークリフト1の後方左側の物体を検出可能である。右レーダ70Rは、フォークリフト1の後方右側に設置される。右レーダ70Rは、フォークリフト1の後方右側の物体を検出可能である。左レーダ70Lの検出領域及び右レーダ70Rの検出領域の一部が重複するように左レーダ70L、及び右レーダ70Rをフォークリフト1の後方に設置してもよいし、左レーダ70Lの検出領域及び右レーダ70Rの検出領域が重複しないように設置してもよい。左レーダ70L及び右レーダ70Rによって、フォークリフト1の後方に存在する物体が検出される。 In the present embodiment, the object detection device 70 includes a left radar (object detection unit) 70L and a right radar (object detection unit) 70R installed as a pair. The left radar 70L is installed on the rear left side of the forklift 1. The left radar 70L can detect an object on the left rear side of the forklift 1. The right radar 70R is installed on the rear right side of the forklift 1. The right radar 70R can detect an object on the rear right side of the forklift 1. The left radar 70L and the right radar 70R may be installed behind the forklift 1 so that the detection area of the left radar 70L and a part of the detection area of the right radar 70R overlap, or the detection area of the left radar 70L and the right It may be installed so that the detection areas of the radar 70R do not overlap. The left radar 70L and the right radar 70R detect an object existing behind the forklift 1.

<警報装置>
警報装置80は、後述する制御装置90の判定部95が、警報レベルが0より大きく、フォークリフト1が後退可能であると判定する場合、警報を出力する。警報装置80は、判定部95が判定した警報レベルに応じた警報を出力してもよい。警報装置80は、オペレータに対する注意喚起のための警報発生処理を実行する。警報装置80は、例えばスピーカーやランプを用い、後方に物体が存在することを知らせる旨の音声又は光を発してオペレータに注意喚起する。警報装置80は、表示パネル52に表示してもよい。警報装置80は、複数設置されていてもよい。
<Alarm device>
The alarm device 80 outputs an alarm when the determination unit 95 of the control device 90, which will be described later, determines that the alarm level is higher than 0 and the forklift 1 can be retracted. The alarm device 80 may output an alarm according to the alarm level determined by the determination unit 95. The alarm device 80 executes an alarm generation process for alerting the operator. The alarm device 80 uses, for example, a speaker or a lamp to alert the operator by emitting a voice or light to notify that an object exists behind. The alarm device 80 may be displayed on the display panel 52. A plurality of alarm devices 80 may be installed.

警報装置80は、例えば、フォークリフト1の運転席の周辺に設置される。本実施形態において、警報装置80は、図2に示すように、リヤピラー16に物体検出装置70とともに設置される。なお、警報装置80は、運転席のオペレータ又はフォークリフト1の周辺に警報を報知することできれば、他の位置に設置されていてもよい。 The alarm device 80 is installed, for example, around the driver's seat of the forklift 1. In the present embodiment, the alarm device 80 is installed on the rear pillar 16 together with the object detection device 70, as shown in FIG. The alarm device 80 may be installed at another position as long as the alarm can be notified to the operator in the driver's seat or the vicinity of the forklift 1.

警報装置80は、フォークリフト1の運転席の周辺に複数が設置されていてもよい。本実施形態では、警報装置80は、一対として設置された、左警報装置(警報部)80L及び右警報装置(警報部)80Rを含む。左警報装置80Lは、フォークリフト1の後方左側に設置される。左警報装置80Lは、左レーダ70Lの前側に設置される。右警報装置80Rは、フォークリフト1の後方右側に設置される。右警報装置80Rは、右レーダ70Rの前側に設置される。左警報装置80Lと右警報装置80Rとは、同時に警報音を出力したり、点灯したりしてもよい。または、物体の検出方向に対応した左警報装置80L又は右警報装置80Rから警報を出力してもよい。より詳しくは、左レーダ70Lによって物体が検出された場合、又は、フォークリフト1の前後軸より左側に物体が検出された場合に限って、左警報装置80Lから警報を出力してもよい。右レーダ70Rによって物体が検出された場合、又は、フォークリフト1の前後軸より右側に物体が検出された場合に限って、右警報装置80Rから警報を出力してもよい。 A plurality of alarm devices 80 may be installed around the driver's seat of the forklift 1. In the present embodiment, the alarm device 80 includes a left alarm device (alarm unit) 80L and a right alarm device (alarm unit) 80R installed as a pair. The left alarm device 80L is installed on the rear left side of the forklift 1. The left alarm device 80L is installed in front of the left radar 70L. The right alarm device 80R is installed on the rear right side of the forklift 1. The right alarm device 80R is installed in front of the right radar 70R. The left alarm device 80L and the right alarm device 80R may output an alarm sound or light up at the same time. Alternatively, an alarm may be output from the left alarm device 80L or the right alarm device 80R corresponding to the detection direction of the object. More specifically, an alarm may be output from the left alarm device 80L only when an object is detected by the left radar 70L or when an object is detected on the left side of the front-rear axis of the forklift 1. An alarm may be output from the right alarm device 80R only when an object is detected by the right radar 70R or when an object is detected on the right side of the front-rear axis of the forklift 1.

<物体検出システムの制御系>
制御装置90に、物体検出装置70及び警報装置80が接続される。制御装置90は、CPUのような数値演算装置(プロセッサ)を含む。制御装置90は、物体検出装置70の検出結果に基づいて、フォークリフト1の周辺の物体を検出して、警報の出力を制御する。制御装置90は、車体データ取得部91と、切替部92と、設定部93と、物体データ取得部94と、判定部95と、警報制御部96と、記憶部99とを備える。
<Control system of object detection system>
An object detection device 70 and an alarm device 80 are connected to the control device 90. The control device 90 includes a numerical arithmetic unit (processor) such as a CPU. The control device 90 detects an object around the forklift 1 based on the detection result of the object detection device 70, and controls the output of the alarm. The control device 90 includes a vehicle body data acquisition unit 91, a switching unit 92, a setting unit 93, an object data acquisition unit 94, a determination unit 95, an alarm control unit 96, and a storage unit 99.

車体データ取得部91は、車両制御装置69からフォークリフト1の車体データを取得する。車体データ取得部91は、切れ角取得部911と車速取得部912とを含む。車体データ取得部91は、取得した車体データを切替部92と設定部93と判定部95とへ出力する。 The vehicle body data acquisition unit 91 acquires the vehicle body data of the forklift 1 from the vehicle control device 69. The vehicle body data acquisition unit 91 includes a turning angle acquisition unit 911 and a vehicle speed acquisition unit 912. The vehicle body data acquisition unit 91 outputs the acquired vehicle body data to the switching unit 92, the setting unit 93, and the determination unit 95.

切れ角取得部911は、車両制御装置69からフォークリフト1の後輪12のタイヤ切れ角を取得する。取得したフォークリフト1のタイヤ切れ角は、車体データに含んで切替部92と設定部93と判定部95とへ出力される。 The turning angle acquisition unit 911 acquires the tire turning angle of the rear wheel 12 of the forklift 1 from the vehicle control device 69. The acquired tire turning angle of the forklift 1 is included in the vehicle body data and output to the switching unit 92, the setting unit 93, and the determination unit 95.

車速取得部912は、車両制御装置69からフォークリフト1の車速を取得する。取得したフォークリフト1の車速は、車体データに含んで切替部92と設定部93と判定部95とへ出力される。 The vehicle speed acquisition unit 912 acquires the vehicle speed of the forklift 1 from the vehicle control device 69. The acquired vehicle speed of the forklift 1 is included in the vehicle body data and output to the switching unit 92, the setting unit 93, and the determination unit 95.

切替部92は、フォークリフト1の車速に応じて、フォークリフト1の周辺で物体を検出する範囲である、第1検出範囲(以下、「第1範囲」という。)A1と第2検出範囲(以下、「第2範囲」という。)A2とを切り替える。本実施形態では、切替部92は、フォークリフト1が停止している場合、物体を検出する範囲を、第1範囲A1に切り替える。切替部92は、フォークリフト1が停止していない場合、物体を検出する範囲を、第2範囲A2に切り替える。切替部92による、第1範囲A1と第2範囲A2との切り替えは、上記の条件に限定されない。 The switching unit 92 is a range for detecting an object in the vicinity of the forklift 1 according to the vehicle speed of the forklift 1, a first detection range (hereinafter referred to as “first range”) A1 and a second detection range (hereinafter, referred to as “first range”). It is called "second range".) Switch with A2. In the present embodiment, when the forklift 1 is stopped, the switching unit 92 switches the range for detecting an object to the first range A1. When the forklift 1 is not stopped, the switching unit 92 switches the range for detecting an object to the second range A2. Switching between the first range A1 and the second range A2 by the switching unit 92 is not limited to the above conditions.

切替部92は、フォークリフト1の車速が車速第二閾値以下である場合、物体を検出する範囲を、第1範囲A1に切り替えてもよい。より詳しくは、フォークリフト1の前後進レバーが「後進」位置であり、パーキングブレーキが解除され、フォークリフト1の車速が車速第二閾値以下である場合において、物体を検出範囲を、第1範囲A1に切り替えてもよい。また、切替部92は、フォークリフト1の車速が車速第二閾値より高い場合、物体を検出する範囲を、第2範囲A2に切り替えてもよい。より詳しくは、切替部92は、フォークリフト1が後進している場合、言い換えると、フォークリフト1の前後進レバーが「後進」位置であり、パーキングブレーキが解除され、フォークリフト1の車速が車速第二閾値より高い場合において、物体を検出する範囲を、第2範囲A2に切り替えてもよい。 When the vehicle speed of the forklift 1 is equal to or lower than the vehicle speed second threshold value, the switching unit 92 may switch the range for detecting an object to the first range A1. More specifically, when the forward / backward lever of the forklift 1 is in the "reverse" position, the parking brake is released, and the vehicle speed of the forklift 1 is equal to or less than the vehicle speed second threshold value, the object detection range is set to the first range A1. You may switch. Further, when the vehicle speed of the forklift 1 is higher than the vehicle speed second threshold value, the switching unit 92 may switch the range for detecting an object to the second range A2. More specifically, in the switching unit 92, when the forklift 1 is moving backward, in other words, the forward / backward lever of the forklift 1 is in the "backward" position, the parking brake is released, and the vehicle speed of the forklift 1 is the second threshold value of the vehicle speed. In a higher case, the range for detecting the object may be switched to the second range A2.

設定部93は、フォークリフト1の周辺において物体を検出する第1範囲A1及び第2範囲A2を設定する。第1範囲A1及び第2範囲A2は、物体検出装置70の検出領域に含まれる範囲である。設定部93は、第1範囲A1及び第2範囲A2について、フォークリフト1の幅方向の幅と、フォークリフト1の走行方向の長さとを設定する。より詳しくは、設定部93は、第1範囲A1を、フォークリフト1から固定距離(所定距離)の範囲を含む、固定形状の範囲として設定とする。設定部93は、第2範囲A2を、フォークリフト1の車速に応じて形状が変化する範囲として設定する。設定部93は、第2範囲A2を、フォークリフト1の車速及びタイヤ切れ角に応じて形状が変化する範囲として設定してもよい。設定部93は、設定した第1範囲A1及び第2範囲A2を記憶部99に記憶する。 The setting unit 93 sets a first range A1 and a second range A2 for detecting an object around the forklift 1. The first range A1 and the second range A2 are ranges included in the detection area of the object detection device 70. The setting unit 93 sets the width of the forklift 1 in the width direction and the length of the forklift 1 in the traveling direction for the first range A1 and the second range A2. More specifically, the setting unit 93 sets the first range A1 as a fixed shape range including a range of a fixed distance (predetermined distance) from the forklift 1. The setting unit 93 sets the second range A2 as a range in which the shape changes according to the vehicle speed of the forklift 1. The setting unit 93 may set the second range A2 as a range in which the shape changes according to the vehicle speed of the forklift 1 and the tire turning angle. The setting unit 93 stores the set first range A1 and second range A2 in the storage unit 99.

設定部93は、第1範囲A1及び第2範囲A2を、警報レベルが分類可能な、複数の範囲にわけて設定してもよい。設定部93は、警報レベルに応じて、第1範囲A1を複数の部分にわけて設定する。例えば、設定部93は、第1範囲A1を、第1部分A11及び第2部分A12の2つの部分にわけて設定する。設定部93は、警報レベルに応じて、第2範囲A2を複数の部分にわけて設定する。例えば、設定部93は、第2範囲A2を、第1部分A21及び第2部分A22の2つの部分にわけて設定する。 The setting unit 93 may set the first range A1 and the second range A2 by dividing them into a plurality of ranges in which alarm levels can be classified. The setting unit 93 divides the first range A1 into a plurality of parts and sets it according to the alarm level. For example, the setting unit 93 divides the first range A1 into two parts, a first part A11 and a second part A12. The setting unit 93 divides the second range A2 into a plurality of parts and sets it according to the alarm level. For example, the setting unit 93 divides the second range A2 into two parts, a first part A21 and a second part A22.

<第1範囲A1>
図3は、第1範囲A1の一例を示す模式図である。第1範囲A1の外形は、矩形状である。第1範囲A1は、フォークリフト1の幅方向に幅W、フォークリフト1の走行方向である後進方向に長さLの範囲を含む。幅Wは、フォークリフト1の車幅Wrを含む。
<First range A1>
FIG. 3 is a schematic view showing an example of the first range A1. The outer shape of the first range A1 is rectangular. The first range A1 includes a range of width W in the width direction of the forklift 1 and length L in the reverse direction which is the traveling direction of the forklift 1. The width W includes the vehicle width Wr of the forklift 1.

第1範囲A1は、第1部分A11と、走行方向である後進方向において第1部分A11よりフォークリフト1から遠い第2部分A12とを含む。 The first range A1 includes a first portion A11 and a second portion A12 that is farther from the forklift 1 than the first portion A11 in the reverse direction, which is the traveling direction.

第1部分A11は、フォークリフト1の後端部から後進方向に長さL1を有する。第2部分A12は、第1部分A11の後端部から後進方向に長さL2を有する。第1部分A11及び第2部分A12は、いずれも幅Wを有する。長さL1、長さL2、及び、幅Wは、固定値である。 The first portion A11 has a length L1 in the backward direction from the rear end portion of the forklift 1. The second portion A12 has a length L2 in the backward direction from the rear end portion of the first portion A11. Both the first portion A11 and the second portion A12 have a width W. The length L1, the length L2, and the width W are fixed values.

本実施形態では、第1部分A11を、警報レベルがレベル2(第1レベル)の危険域と規定する。第2部分A12を、警報レベルがレベル2より低いレベル1(第2レベル)の警告域と規定する。第1部分A11及び第2部分A12以外の部分を、警報レベルがレベル1より低いレベル0(第3レベル)と規定する。 In the present embodiment, the first part A11 is defined as a danger zone having an alarm level of level 2 (first level). The second part A12 is defined as a level 1 (second level) warning area where the warning level is lower than level 2. The part other than the first part A11 and the second part A12 is defined as level 0 (third level) whose alarm level is lower than level 1.

このように、設定部93は、記憶部99に記憶された、長さL1、長さL2、及び、幅Wに基づいて、固定形状の第1範囲A1を設定する。設定部93は、警報レベルがレベル2の第1部分A11と、フォークリフト1の走行方向である前方方向において第1部分A11よりフォークリフト1から遠く、レベル2より低い警報レベルであるレベル1の第2部分A12とを含む、第1検出範囲A1を設定してもよい。 In this way, the setting unit 93 sets the first range A1 of the fixed shape based on the length L1, the length L2, and the width W stored in the storage unit 99. The setting unit 93 has a first portion A11 having an alarm level of level 2 and a second level 1 alarm level having a warning level lower than that of the forklift 1 and farther from the forklift 1 than the first portion A11 in the forward direction, which is the traveling direction of the forklift 1. The first detection range A1 including the portion A12 may be set.

<第2範囲A2>
図4は、第2範囲A2の一例を示す模式図である。第2範囲A2の外形は、フォークリフト1のタイヤ切れ角に応じて予測される進路に沿うように、矩形状又は円弧形状に変化する。図4においては、一例として、第2範囲A2が円弧形状である状態を示す。図4に示す第2範囲A2は、フォークリフト1のタイヤ切れ角に対応する、回転中心をCとした半径Rの円弧形状である。第2範囲A2は、フォークリフト1の幅方向に幅W、フォークリフト1の走行方向に長さLの範囲を含む。幅Wは、フォークリフト1の車幅Wrを含む。長さLは、フォークリフト1の車速に応じて変化する。
<Second range A2>
FIG. 4 is a schematic view showing an example of the second range A2. The outer shape of the second range A2 changes into a rectangular shape or an arc shape so as to follow the path predicted according to the tire turning angle of the forklift 1. In FIG. 4, as an example, a state in which the second range A2 has an arc shape is shown. The second range A2 shown in FIG. 4 is an arc shape having a radius R with the center of rotation as C, which corresponds to the tire turning angle of the forklift 1. The second range A2 includes a range of width W in the width direction of the forklift 1 and length L in the traveling direction of the forklift 1. The width W includes the vehicle width Wr of the forklift 1. The length L changes according to the vehicle speed of the forklift 1.

第2範囲A2は、第1部分A21と、走行方向である後進方向において第1部分A21よりフォークリフト1から遠い第2部分A22とを含む。 The second range A2 includes a first portion A21 and a second portion A22 that is farther from the forklift 1 than the first portion A21 in the reverse direction, which is the traveling direction.

第1部分A21及び第2部分A22は、いずれも幅Wを有する。第1部分A21は、フォークリフト1の後端部から走行方向に長さL1を有する。言い換えると、フォークリフト1の後端部の、前後軸上に位置する基準点P0から、第1部分A21の先端部の点P1までの長さがL1である。第2部分A22は、第1部分A21の後端部から走行方向に長さL2を有する。言い換えると、点P1から、第2部分A22の先端部の点P2までの長さがL2である。基準点P0、点P1、点P2は、フォークリフト1のタイヤ切れ角の回転中心Cから半径Rの円弧状に位置する。長さL1及び長さL2は、フォークリフト1の車速に応じて変化する。 Both the first portion A21 and the second portion A22 have a width W. The first portion A21 has a length L1 in the traveling direction from the rear end portion of the forklift 1. In other words, the length from the reference point P0 located on the front-rear axis of the rear end of the forklift 1 to the point P1 of the tip of the first portion A21 is L1. The second portion A22 has a length L2 in the traveling direction from the rear end portion of the first portion A21. In other words, the length from the point P1 to the point P2 at the tip of the second portion A22 is L2. The reference point P0, the point P1, and the point P2 are located in an arc shape having a radius R from the rotation center C of the tire cutting angle of the forklift 1. The length L1 and the length L2 change according to the vehicle speed of the forklift 1.

設定部93は、車速取得部912が取得した、フォークリフト1の車速に基づいて、第2範囲A2の長さLを変更する。より詳しくは、設定部93は、フォークリフト1の車速が低い場合、第2範囲A2の長さLを短くする。設定部93は、フォークリフト1の車速が高い場合、第2範囲A2の長さLを長くする。図5は、第2範囲A2の他の例を示す模式図である。図5においては、図4に比べてフォークリフト1の車速が低くなって、第2範囲A2の長さLが短くなった例を示す。 The setting unit 93 changes the length L of the second range A2 based on the vehicle speed of the forklift 1 acquired by the vehicle speed acquisition unit 912. More specifically, the setting unit 93 shortens the length L of the second range A2 when the vehicle speed of the forklift 1 is low. When the vehicle speed of the forklift 1 is high, the setting unit 93 increases the length L of the second range A2. FIG. 5 is a schematic view showing another example of the second range A2. FIG. 5 shows an example in which the vehicle speed of the forklift 1 is lower than that of FIG. 4, and the length L of the second range A2 is shorter.

設定部93は、第2範囲A2の長さLを変更する場合、フォークリフト1の走行方向において第2範囲A2の先端部の位置を変化させる。例えば、設定部93は、第2範囲A2の長さLを短くする場合、第2範囲A2の先端部がフォークリフト1に近付くように、第2範囲A2の先端部とフォークリフト1との相対位置を、予測される進路に沿って変化させる。設定部93は、第2範囲A2の長さLを長くする場合、第2範囲A2の先端部がフォークリフト1から離れるように、第2範囲A2の先端部とフォークリフト1との相対位置を、予測される進路に沿って変化させる。 When the length L of the second range A2 is changed, the setting unit 93 changes the position of the tip portion of the second range A2 in the traveling direction of the forklift 1. For example, when the length L of the second range A2 is shortened, the setting unit 93 sets the relative position between the tip of the second range A2 and the forklift 1 so that the tip of the second range A2 approaches the forklift 1. , Change along the expected course. When the length L of the second range A2 is lengthened, the setting unit 93 predicts the relative position between the tip of the second range A2 and the forklift 1 so that the tip of the second range A2 is separated from the forklift 1. Change along the course to be done.

設定部93は、切れ角取得部911が取得した、フォークリフト1のタイヤ切れ角に基づいて、第2範囲A2の形状を変形させる。例えば、図4に示すように、フォークリフト1のタイヤ切れ角が、フォークリフト1の走行方向が右に変化して右旋回することを示す場合、設定部93は、フォークリフト1の走行方向に沿うように、第2範囲A2の形状を右へ曲げて設定する。設定部93は、第2範囲A2の先端部がフォークリフト1の前後方向に対して右に移動するように、第2範囲A2の形状を設定する。図6は、第2範囲A2の他の例を示す模式図である。例えば、図6に示すように、フォークリフト1のタイヤ切れ角が、フォークリフト1の走行方向が左に変化して左旋回することを示す場合、設定部93は、フォークリフト1の走行方向に沿うように、第2範囲A2の形状を左へ曲げて設定する。設定部93は、第2範囲A2の先端部がフォークリフト1の前後方向に対して左に移動するように、第2範囲A2の形状を設定する。 The setting unit 93 deforms the shape of the second range A2 based on the tire turning angle of the forklift 1 acquired by the turning angle acquisition unit 911. For example, as shown in FIG. 4, when the tire turning angle of the forklift 1 indicates that the traveling direction of the forklift 1 changes to the right and turns to the right, the setting unit 93 should follow the traveling direction of the forklift 1. The shape of the second range A2 is bent to the right and set. The setting unit 93 sets the shape of the second range A2 so that the tip portion of the second range A2 moves to the right with respect to the front-rear direction of the forklift 1. FIG. 6 is a schematic view showing another example of the second range A2. For example, as shown in FIG. 6, when the tire turning angle of the forklift 1 indicates that the traveling direction of the forklift 1 changes to the left and turns to the left, the setting unit 93 is set to follow the traveling direction of the forklift 1. , The shape of the second range A2 is bent to the left and set. The setting unit 93 sets the shape of the second range A2 so that the tip portion of the second range A2 moves to the left with respect to the front-rear direction of the forklift 1.

設定部93は、切れ角取得部911が取得した、フォークリフト1のタイヤ切れ角に基づいて、第2範囲A2の形状を変更する。より詳しくは、設定部93は、フォークリフト1のタイヤ切れ角が大きい場合、第2範囲A2のカーブを急にする。設定部93は、フォークリフト1のタイヤ切れ角が小さい場合、第2範囲A2のカーブを緩やかにする。 The setting unit 93 changes the shape of the second range A2 based on the tire turning angle of the forklift 1 acquired by the turning angle acquisition unit 911. More specifically, the setting unit 93 steers the curve of the second range A2 when the tire turning angle of the forklift 1 is large. When the tire turning angle of the forklift 1 is small, the setting unit 93 makes the curve of the second range A2 gentle.

ここで、設定部93は、各車速において、レベル2の危険域を、第2範囲A2の第1部分A21として設定する。設定部93は、各車速において、レベル1の警告域を、第2範囲A2の第2部分A22として設定する。設定部93は、各車速において、第1部分A21及び第2部分A22以外の部分を、レベル0の領域として設定する。第2範囲A2の長さLを、所定の割合で分割して、第1部分A21及び第2部分A22を設定してもよい。また、車速に応じて、分割する割合を変更するようにしてもよい。 Here, the setting unit 93 sets the danger zone of level 2 as the first portion A21 of the second range A2 at each vehicle speed. The setting unit 93 sets the level 1 warning area as the second part A22 of the second range A2 at each vehicle speed. The setting unit 93 sets a portion other than the first portion A21 and the second portion A22 as a level 0 region at each vehicle speed. The length L of the second range A2 may be divided by a predetermined ratio to set the first portion A21 and the second portion A22. Further, the division ratio may be changed according to the vehicle speed.

第2範囲A2は、相対速度が小さくなるにつれて、言い換えると、フォークリフト1の車速がゼロに近くなるにつれて、長さLがゼロに近くなる。そこで、設定部93は、フォークリフト1の車速が車速第一閾値以下である場合、第2範囲A2のうち、第1部分A21を固定範囲として設定してもよい。車速第一閾値は、フォークリフト1が後進を開始した直後のように、ゼロに近い値を設定してもよい。本実施形態では、設定部93は、車速が車速第一閾値以下である場合、第1部分A21の長さL1を固定の長さXbとして第2範囲A2を設定する。車速が車速第一閾値を超えた場合、固定の長さXbは、車速に応じて、長くしてもよい。図7は、第2範囲A2の他の例を示す模式図である。この場合、図7に示すように、第2範囲A2は、第1部分A21のみを有する。また、固定範囲は、第1部分A21と第2部分A22のそれぞれに設定してもよい。なお、車速第一閾値は、車速第二閾値と同じ値でもよい。 In the second range A2, the length L becomes closer to zero as the relative speed becomes smaller, in other words, as the vehicle speed of the forklift 1 becomes closer to zero. Therefore, when the vehicle speed of the forklift 1 is equal to or lower than the vehicle speed first threshold value, the setting unit 93 may set the first portion A21 of the second range A2 as a fixed range. The vehicle speed first threshold value may be set to a value close to zero, such as immediately after the forklift 1 starts moving backward. In the present embodiment, when the vehicle speed is equal to or less than the vehicle speed first threshold value, the setting unit 93 sets the second range A2 with the length L1 of the first portion A21 as the fixed length Xb. When the vehicle speed exceeds the vehicle speed first threshold value, the fixed length Xb may be increased according to the vehicle speed. FIG. 7 is a schematic view showing another example of the second range A2. In this case, as shown in FIG. 7, the second range A2 has only the first portion A21. Further, the fixed range may be set in each of the first portion A21 and the second portion A22. The vehicle speed first threshold value may be the same value as the vehicle speed second threshold value.

このように、設定部93は、フォークリフト1のタイヤ切れ角に応じて予測される進路に沿うように、矩形状又は円弧形状に変化させた第2範囲A2を設定する。そして、設定部93は、フォークリフト1の車速に応じて、第2範囲A2の長さLを変化させる。設定部93は、警報レベルがレベル2の第1部分A21と、フォークリフト1の走行方向である前方方向において第1部分A21よりフォークリフト1から遠く、レベル2より低い警報レベルであるレベル1の第2部分A22とを含む、第2検出範囲A2を設定してもよい。 In this way, the setting unit 93 sets the second range A2 changed into a rectangular shape or an arc shape so as to follow the path predicted according to the tire turning angle of the forklift 1. Then, the setting unit 93 changes the length L of the second range A2 according to the vehicle speed of the forklift 1. The setting unit 93 has a first portion A21 having an alarm level of level 2 and a second level 1 alarm level having a warning level lower than that of the forklift 1 and farther from the forklift 1 than the first portion A21 in the forward direction, which is the traveling direction of the forklift 1. A second detection range A2 may be set, including the portion A22.

物体データ取得部94は、物体検出装置70から、物体の検出結果を物体データとして取得する。物体データ取得部94が取得した物体データには、物体検出装置70の検出範囲のすべての検出結果が含まれる。 The object data acquisition unit 94 acquires an object detection result as object data from the object detection device 70. The object data acquired by the object data acquisition unit 94 includes all the detection results of the detection range of the object detection device 70.

判定部95は、物体データ取得部94が取得した物体データに基づいて、フォークリフト1の周辺において物体が検出されたか否かを判定する。判定部95は、切替部92が切り替えた、フォークリフト1の周辺で物体を検出する範囲である、第1範囲A1又は第2範囲A2において、物体が検出されたか否かを判定する。 The determination unit 95 determines whether or not an object has been detected in the vicinity of the forklift 1 based on the object data acquired by the object data acquisition unit 94. The determination unit 95 determines whether or not the object is detected in the first range A1 or the second range A2, which is the range in which the switching unit 92 switches to detect the object around the forklift 1.

より詳しくは、判定部95は、フォークリフト1の車体データがフォークリフト1が停止していることを示す場合、物体データの相対位置と相対速度とに基づいて、第1範囲A1に物体が存在するか否かを判定する。判定部95は、物体データの相対位置と相対速度とが第1範囲A1に物体が存在することを示す場合、フォークリフト1の周辺において物体が検出されたと判定する。 More specifically, when the vehicle body data of the forklift 1 indicates that the forklift 1 is stopped, the determination unit 95 determines whether an object exists in the first range A1 based on the relative position and the relative velocity of the object data. Judge whether or not. When the relative position and the relative velocity of the object data indicate that the object exists in the first range A1, the determination unit 95 determines that the object has been detected around the forklift 1.

判定部95は、例えば、フォークリフト1の車体データがフォークリフト1が停止していないことを示す場合、物体データの相対位置と相対速度とに基づいて、第2範囲A2に物体が存在するか否かを判定する。判定部95は、物体データの相対位置と相対速度とが第2範囲A2に物体が存在することを示す場合、フォークリフト1の周辺において物体が検出されたと判定する。なお、判定部95は、車体データに含まれる車速が車速第二閾値以上であることを示す場合に、第2範囲A2に物体が存在するか否か判定するようにしてもよい。 For example, when the vehicle body data of the forklift 1 indicates that the forklift 1 is not stopped, the determination unit 95 determines whether or not an object exists in the second range A2 based on the relative position and the relative velocity of the object data. To judge. When the relative position and the relative velocity of the object data indicate that the object exists in the second range A2, the determination unit 95 determines that the object has been detected around the forklift 1. The determination unit 95 may determine whether or not an object exists in the second range A2 when it indicates that the vehicle speed included in the vehicle body data is equal to or higher than the vehicle speed second threshold value.

判定部95は、フォークリフト1の周辺において物体が検出されたと判定する場合、さらに、警報レベルを判定してもよい。判定部95は、物体が検出された位置に応じて、最も高いレベル2と、レベル1に次いで高いレベル1と、低いレベル0とにわけて判定する。判定部95は、第1部分A11又は第1部分A21と、第2部分A12又は第2部分A22とのいずれにおいて、物体が検出されたかに応じて、警報レベルを判定する。より詳しくは、判定部95は、物体検出装置70の検出結果に基づいて、物体が第1部分A11又は第1部分A21に存在すると判定する場合、警報レベルがレベル2であると判定する。判定部95は、物体検出装置70の検出結果に基づいて、物体が第2部分A12又は第2部分A22に存在すると判定する場合、警報レベルがレベル1であると判定する。判定部95は、物体検出装置70の検出結果に基づいて、物体が第1部分A11、第1部分A21、第2部分A12又は第2部分A22に存在すると判定しない場合、警報レベルがレベル0であると判定する。 When the determination unit 95 determines that an object has been detected in the vicinity of the forklift 1, the determination unit 95 may further determine the alarm level. The determination unit 95 determines the highest level 2, the highest level 1 next to the level 1, and the lowest level 0 according to the position where the object is detected. The determination unit 95 determines the alarm level according to whether the object is detected in the first portion A11 or the first portion A21 and the second portion A12 or the second portion A22. More specifically, when the determination unit 95 determines that the object exists in the first portion A11 or the first portion A21 based on the detection result of the object detection device 70, the determination unit 95 determines that the alarm level is level 2. When the determination unit 95 determines that the object exists in the second portion A12 or the second portion A22 based on the detection result of the object detection device 70, the determination unit 95 determines that the alarm level is level 1. If the determination unit 95 does not determine that the object exists in the first portion A11, the first portion A21, the second portion A12, or the second portion A22 based on the detection result of the object detection device 70, the alarm level is level 0. Judge that there is.

判定部95は、フォークリフト1の車速が車速第三閾値以上である場合、物体の検出処理をキャンセルする、言い換えると、警報を出力しないと判定してもよい。車速第三閾値は、車速第一閾値及び車速第二閾値より大きい値である。車速が車速第三閾値以上である場合、物体を検出してから警報が出力されるまでにフォークリフト1が移動する距離が長くなるので、適切なタイミングで警報が出力されないおそれがあるためである。判定部95は、フォークリフト1の車速が車速第三閾値以上であっても、物体検出装置70の検出領域内では、物体の検出処理を行ってもよい。 When the vehicle speed of the forklift 1 is equal to or higher than the vehicle speed third threshold value, the determination unit 95 may cancel the object detection process, in other words, determine that the alarm is not output. The vehicle speed third threshold value is a value larger than the vehicle speed first threshold value and the vehicle speed second threshold value. This is because when the vehicle speed is equal to or higher than the vehicle speed third threshold value, the distance traveled by the forklift 1 from the detection of the object to the output of the alarm becomes long, so that the alarm may not be output at an appropriate timing. Even if the vehicle speed of the forklift 1 is equal to or higher than the vehicle speed third threshold value, the determination unit 95 may perform object detection processing within the detection region of the object detection device 70.

判定部95は、フォークリフト1のタイヤ切れ角が切れ角閾値以上である場合、物体の検出処理をキャンセルする、言い換えると、警報を出力しないと判定してもよい。切れ角閾値は、例えば、フォークリフト1をUターンさせたり、急激に方向転換をするような場合の値である。タイヤ切れ角が切れ角閾値以上である場合、物体検出装置70の検出範囲から第2範囲A2が外れるためである。判定部95は、フォークリフト1のタイヤ切れ角が切れ角閾値以上であっても、フォークリフト1の予測される進路が物体検出装置70の検出領域内であれば、物体の検出処理を行ってもよい。 When the tire turning angle of the forklift 1 is equal to or greater than the turning angle threshold value, the determination unit 95 may cancel the object detection process, in other words, determine that the alarm is not output. The turning angle threshold value is, for example, a value when the forklift 1 is made to make a U-turn or suddenly changes direction. This is because when the tire turning angle is equal to or larger than the turning angle threshold value, the second range A2 deviates from the detection range of the object detection device 70. Even if the tire turning angle of the forklift 1 is equal to or larger than the turning angle threshold value, the determination unit 95 may perform the object detection process as long as the predicted course of the forklift 1 is within the detection region of the object detection device 70. ..

警報制御部96は、判定部95が警報レベルが0より大きく、フォークリフト1が後退可能であると判定する場合、警報装置80に対して警報を出力する制御を行う。より詳しくは、警報制御部96は、オペレータに注意喚起するために、スピーカを介して音声を出力したり、警報ランプを介して光を発するよう制御信号を出力する。警報制御部96は、オペレータに注意喚起するために、表示パネル52を介して警報画像を出力してもよい。本実施形態では、警報制御部96は、判定部95によって判定された警報レベルに応じて警報を出力するように制御してもよい。 When the determination unit 95 determines that the alarm level is higher than 0 and the forklift 1 can be retracted, the alarm control unit 96 controls to output an alarm to the alarm device 80. More specifically, the alarm control unit 96 outputs a voice through a speaker or outputs a control signal to emit light through an alarm lamp in order to alert the operator. The alarm control unit 96 may output an alarm image via the display panel 52 in order to alert the operator. In the present embodiment, the alarm control unit 96 may be controlled to output an alarm according to the alarm level determined by the determination unit 95.

図8を用いて、警報レベルごとに出力する警報パターンについて説明する。図8は、警報レベルの一例を説明する図である。警報レベルがレベル2の場合は、警報装置80のスピーカから、例えば「ピー」と連続的なブザー音声が出力され、警報装置80の警報ランプが4[Hz]で点滅される。警報レベルがレベル1の場合は、警報装置80のスピーカから、例えば「ピッピッピッ」と断続的なブザー音声が出力され、警報装置80の警報ランプが2[Hz]で点滅される。警報レベルがレベル0の場合は、ブザー音声は停止され、警報ランプが消灯される。言い換えると、警報レベルがレベル0では、警報が出力されない。 An alarm pattern to be output for each alarm level will be described with reference to FIG. FIG. 8 is a diagram illustrating an example of an alarm level. When the alarm level is level 2, for example, a continuous buzzer sound is output from the speaker of the alarm device 80, and the alarm lamp of the alarm device 80 blinks at 4 [Hz]. When the alarm level is level 1, the speaker of the alarm device 80 outputs, for example, an intermittent buzzer sound, and the alarm lamp of the alarm device 80 blinks at 2 [Hz]. When the alarm level is level 0, the buzzer sound is stopped and the alarm lamp is turned off. In other words, when the alarm level is level 0, no alarm is output.

警報制御部96は、判定部95が警報レベルが0より大きく、フォークリフト1が後退可能であると判定する場合、物体の検出方向に対応した左警報装置80L又は右警報装置80Rから警報を出力するように制御してもよい。より詳しくは、警報制御部96は、左レーダ70Lによって物体が検出された場合、又は、フォークリフト1の前後軸より左側に物体が検出された場合に限って、左警報装置80Lから警報を出力するように制御してもよい。警報制御部96は、右レーダ70Rによって物体が検出された場合、又は、フォークリフト1の前後軸より右側に物体が検出された場合に限って、右警報装置80Rから警報を出力するように制御してもよい。 When the determination unit 95 determines that the alarm level is higher than 0 and the forklift 1 can be retracted, the alarm control unit 96 outputs an alarm from the left alarm device 80L or the right alarm device 80R corresponding to the detection direction of the object. It may be controlled as follows. More specifically, the alarm control unit 96 outputs an alarm from the left alarm device 80L only when an object is detected by the left radar 70L or when an object is detected on the left side of the front-rear axis of the forklift 1. It may be controlled as follows. The alarm control unit 96 controls to output an alarm from the right alarm device 80R only when an object is detected by the right radar 70R or when an object is detected on the right side of the front-rear axis of the forklift 1. You may.

記憶部99は、RAM(Random Access Memory)、ROM(Read Only Memory)、フラッシュメモリ、及びハードディスクドライブの少なくとも一つを含む。 The storage unit 99 includes at least one of a RAM (Random Access Memory), a ROM (Read Only Memory), a flash memory, and a hard disk drive.

<物体検出システムの処理>
フォークリフト1の動作時、言い換えると、フォークリフト1のキースイッチON時、物体検出システム300が起動するものとする。物体検出システム300が起動している間、車体データ取得装置60がフォークリフト1の走行状態を検出し、物体検出装置70がフォークリフト1の周辺の物体を検出する。車体データ取得装置60及び物体検出装置70の検出結果は、制御装置90に出力される。制御装置90は、車体データ取得装置60から、フォークリフト1の車体データを取得する。制御装置90は、物体検出装置70から、検出結果を取得する。
<Processing of object detection system>
It is assumed that the object detection system 300 is activated when the forklift 1 is operating, in other words, when the key switch of the forklift 1 is turned on. While the object detection system 300 is activated, the vehicle body data acquisition device 60 detects the traveling state of the forklift 1, and the object detection device 70 detects an object around the forklift 1. The detection results of the vehicle body data acquisition device 60 and the object detection device 70 are output to the control device 90. The control device 90 acquires the vehicle body data of the forklift 1 from the vehicle body data acquisition device 60. The control device 90 acquires the detection result from the object detection device 70.

図9ないし図11を用いて、フォークリフト1の制御方法、より詳しくは、物体検出システム300の制御装置90における処理について説明する。図9は、物体検出システム300の処理の一例を示すフローチャートである。図10は、物体検出システム300の第1範囲A1における物体検出処理の一例を示すフローチャートである。図11は、物体検出システム300の第2範囲A2における物体検出処理の一例を示すフローチャートである。 The control method of the forklift 1 and, more specifically, the process in the control device 90 of the object detection system 300 will be described with reference to FIGS. 9 to 11. FIG. 9 is a flowchart showing an example of processing of the object detection system 300. FIG. 10 is a flowchart showing an example of the object detection process in the first range A1 of the object detection system 300. FIG. 11 is a flowchart showing an example of the object detection process in the second range A2 of the object detection system 300.

まず、図9を用いて、物体検出システム300の制御装置90が、フォークリフト1の走行状態に応じて、第1範囲A1及び第2範囲A2を切り替える方法について説明する。 First, a method in which the control device 90 of the object detection system 300 switches between the first range A1 and the second range A2 according to the traveling state of the forklift 1 will be described with reference to FIG.

制御装置90は、切れ角取得部911によって、車体データ取得部91が取得したフォークリフト1の車体データから、フォークリフト1のタイヤ切れ角を取得する(ステップS11)。制御装置90は、ステップS12へ進む。 The control device 90 acquires the tire turning angle of the forklift 1 from the vehicle body data of the forklift 1 acquired by the vehicle body data acquisition unit 91 by the turning angle acquisition unit 911 (step S11). The control device 90 proceeds to step S12.

制御装置90は、車速取得部912によって、車体データ取得部91が取得したフォークリフト1の車体データから、フォークリフト1の車速を取得する(ステップS12)。制御装置90は、ステップS13へ進む。 The control device 90 acquires the vehicle speed of the forklift 1 from the vehicle body data of the forklift 1 acquired by the vehicle body data acquisition unit 91 by the vehicle speed acquisition unit 912 (step S12). The control device 90 proceeds to step S13.

制御装置90は、切替部92によって、フォークリフト1が停止しているか否かを判定する(ステップS13)。切替部92によって、車体データ取得部91が取得した車体データが、車速が車速第二閾値以下であり、例えば、フォークリフト1が停止していることを示すと判定する場合(ステップS13でYes)、物体の検出処理における、物体の検出範囲を第1範囲A1に切り替える。フォークリフト1が停止していると判定する場合(ステップS13でYes)、ステップS14へ進む。切替部92によって、車体データ取得部91が取得した車体データが、車速が車速第二閾値より大きく、例えば、フォークリフト1が停止していないことを示すと判定する場合(ステップS13でNo)、ステップS16へ進む。 The control device 90 determines whether or not the forklift 1 is stopped by the switching unit 92 (step S13). When the switching unit 92 determines that the vehicle body data acquired by the vehicle body data acquisition unit 91 indicates that the vehicle speed is equal to or less than the vehicle speed second threshold value and that, for example, the forklift 1 is stopped (Yes in step S13). The object detection range in the object detection process is switched to the first range A1. When it is determined that the forklift 1 is stopped (Yes in step S13), the process proceeds to step S14. When the switching unit 92 determines that the vehicle body data acquired by the vehicle body data acquisition unit 91 indicates that the vehicle speed is higher than the vehicle speed second threshold value and that, for example, the forklift 1 is not stopped (No in step S13), step. Proceed to S16.

フォークリフト1が停止していると判定する場合(ステップS13でYes)、制御装置90は、設定部93によって、記憶部99に記憶された固定形状の第1範囲A1を、物体の検出範囲として設定する(ステップS14)。より詳しくは、設定部93によって、記憶部99に記憶された、長さL1、長さL2、及び、幅Wに基づいて、固定形状の第1範囲A1を、物体の検出範囲として設定する。また、設定部93によって、警報レベルがレベル2の第1部分A11と、警報レベルがレベル1の第2部分A12とを含んで、第1検出範囲A1を設定する。なお、第1部分A11と第2部分A12に分けずに、第1検出範囲A1を設定してもよい。制御装置90は、ステップS15へ進む。 When it is determined that the forklift 1 is stopped (Yes in step S13), the control device 90 sets the fixed-shaped first range A1 stored in the storage unit 99 as the object detection range by the setting unit 93. (Step S14). More specifically, the setting unit 93 sets the first range A1 of the fixed shape as the detection range of the object based on the length L1, the length L2, and the width W stored in the storage unit 99. Further, the setting unit 93 sets the first detection range A1 including the first portion A11 having the alarm level of level 2 and the second portion A12 having the alarm level of level 1. The first detection range A1 may be set without dividing into the first portion A11 and the second portion A12. The control device 90 proceeds to step S15.

制御装置90は、判定部95によって、設定した第1範囲A1における物体の検出処理を実行する(ステップS15)。第1範囲A1における物体の検出処理については、後述する。制御装置90は、ステップS18へ進む。 The control device 90 executes the object detection process in the set first range A1 by the determination unit 95 (step S15). The object detection process in the first range A1 will be described later. The control device 90 proceeds to step S18.

フォークリフト1が停止していないと判定する場合(ステップS13でNo)、制御装置90は、設定部93によって、フォークリフト1の車速及びタイヤ切れ角に応じた第2範囲A2を、物体の検出範囲として設定する(ステップS16)。より詳しくは、設定部93によって、フォークリフト1のタイヤ切れ角に応じて予測される進路に沿うように、矩形状又は円弧形状に変化させた第2範囲A2を設定する。また、設定部93によって、フォークリフト1の車速に応じて、第2範囲A2の長さLを変化させる。さらに、設定部93によって、警報レベルがレベル2の第1部分A21と、警報レベルがレベル1の第2部分A22とを含んで、第2検出範囲A2を設定する。なお、第1部分A21と第2部分A22に分けずに、第2検出範囲A2を設定してもよい。制御装置90は、ステップS17へ進む。 When it is determined that the forklift 1 is not stopped (No in step S13), the control device 90 sets the second range A2 according to the vehicle speed and the tire turning angle of the forklift 1 as the object detection range by the setting unit 93. Set (step S16). More specifically, the setting unit 93 sets the second range A2 changed into a rectangular shape or an arc shape so as to follow the path predicted according to the tire turning angle of the forklift 1. Further, the setting unit 93 changes the length L of the second range A2 according to the vehicle speed of the forklift 1. Further, the setting unit 93 sets the second detection range A2 including the first portion A21 having an alarm level of level 2 and the second portion A22 having an alarm level of level 1. The second detection range A2 may be set without dividing into the first portion A21 and the second portion A22. The control device 90 proceeds to step S17.

制御装置90は、判定部95によって、設定した第2範囲A2における物体の検出処理を実行する(ステップS17)。第2範囲A2における物体の検出処理については、後述する。制御装置90は、ステップS18へ進む。 The control device 90 executes the object detection process in the set second range A2 by the determination unit 95 (step S17). The object detection process in the second range A2 will be described later. The control device 90 proceeds to step S18.

制御装置90は、判定部95によって、警報レベルが0より大きく、かつ、フォークリフト1が後進可能であるか否かを判定する(ステップS18)。判定部95によって、警報レベルが0より大きいか否か、及び、車体データ取得部91が取得した車体データが、フォークリフト1が後進可能であることを示すか否かを判定する。より詳しくは、判定部95によって、警報レベルが0より大きく、かつ、車体データが、フォークリフト1の前後進レバーが「後進」位置であることを示す場合、警報レベルが0より大きく、かつ、フォークリフト1が後進可能であると判定する(ステップS18でYes)。なお、フォークリフト1の前後進レバーが「後進」位置であり、かつパーキングブレーキが解除されている場合に、フォークリフト1が後進可能であると判定してもよい。判定部95によって、警報レベルが0より大きく、かつ、フォークリフト1が後進可能であると判定する場合(ステップS18でYes)、ステップS19へ進む。判定部95によって、車体データが、警報レベルが0である、または、フォークリフト1の前後進レバーが「後進」位置ではないことを示す場合(ステップS18でNo)、ステップS20へ進む。 The control device 90 determines by the determination unit 95 whether or not the alarm level is higher than 0 and the forklift 1 can move backward (step S18). The determination unit 95 determines whether or not the alarm level is greater than 0, and whether or not the vehicle body data acquired by the vehicle body data acquisition unit 91 indicates that the forklift 1 can move backward. More specifically, when the determination unit 95 indicates that the alarm level is greater than 0 and the vehicle body data indicates that the forward / backward lever of the forklift 1 is in the "reverse" position, the alarm level is greater than 0 and the forklift It is determined that 1 can move backward (Yes in step S18). When the forward / backward lever of the forklift 1 is in the "reverse" position and the parking brake is released, it may be determined that the forklift 1 can move backward. When the determination unit 95 determines that the alarm level is higher than 0 and the forklift 1 can move backward (Yes in step S18), the process proceeds to step S19. If the vehicle body data indicates by the determination unit 95 that the alarm level is 0 or that the forward / backward lever of the forklift 1 is not in the "reverse" position (No in step S18), the process proceeds to step S20.

警報レベルが0より大きく、かつ、フォークリフト1が後進可能であると判定する場合(ステップS18でYes)、制御装置90は、警報を出力する(ステップS19)。 When it is determined that the alarm level is higher than 0 and the forklift 1 can move backward (Yes in step S18), the control device 90 outputs an alarm (step S19).

例えば、制御装置90は、警報レベルがレベル2の場合、警報制御部96によって、レベル2の警報を出力する。警報制御部96によって、警報装置80のスピーカを介して「ピー」と連続的なブザー音声を出力させる制御信号を出力する。警報制御部96によって、警報装置80の警報ランプが4[Hz]で点滅するよう制御信号を出力する。 For example, when the alarm level is level 2, the control device 90 outputs a level 2 alarm by the alarm control unit 96. The alarm control unit 96 outputs a control signal for outputting a continuous buzzer sound through the speaker of the alarm device 80. The alarm control unit 96 outputs a control signal so that the alarm lamp of the alarm device 80 blinks at 4 [Hz].

例えば、制御装置90は、警報レベルがレベル1の場合、警報制御部96によって、レベル1の警報を出力する。警報制御部96によって、警報装置80のスピーカを介して「ピッピッピッ」と断続的なブザー音声を出力させる制御信号を出力する。警報制御部96によって、警報装置80の警報ランプが2[Hz]で点滅するよう制御信号を出力する。 For example, when the alarm level is level 1, the control device 90 outputs a level 1 alarm by the alarm control unit 96. The alarm control unit 96 outputs a control signal for outputting an intermittent buzzer sound through the speaker of the alarm device 80. The alarm control unit 96 outputs a control signal so that the alarm lamp of the alarm device 80 blinks at 2 [Hz].

警報レベルが0である場合、または、フォークリフト1が後進可能であると判定されない場合(ステップS18でNo)、制御装置90は、警報を停止する(ステップS20)。 When the alarm level is 0, or when it is not determined that the forklift 1 can move backward (No in step S18), the control device 90 stops the alarm (step S20).

つぎに、図10を用いて、物体検出システム300の制御装置90による、第1範囲A1における物体検出方法について説明する。制御装置90は、判定部95によって、物体データ取得部94が取得した物体データの相対位置が、第1範囲A1の第1部分A11において物体が検出されたことを示すか否かを判定する(ステップS21)。制御装置90は、第1範囲A1の第1部分A11において物体が検出されたことを示す場合(ステップS21でYes)、ステップS22へ進む。制御装置90は、第1範囲A1の第1部分A11において物体が検出されたことを示さない場合(ステップS21でNo)、ステップS23へ進む。 Next, the object detection method in the first range A1 by the control device 90 of the object detection system 300 will be described with reference to FIG. The control device 90 determines whether or not the relative position of the object data acquired by the object data acquisition unit 94 indicates that the object has been detected in the first portion A11 of the first range A1 by the determination unit 95 ((). Step S21). When the control device 90 indicates that an object has been detected in the first portion A11 of the first range A1 (Yes in step S21), the control device 90 proceeds to step S22. If the control device 90 does not indicate that an object has been detected in the first portion A11 of the first range A1 (No in step S21), the control device 90 proceeds to step S23.

第1範囲A1の第1部分A11において物体が検出されたことを示す場合(ステップS21でYes)、制御装置90は、判定部95によって、警報レベルをレベル2に設定する(ステップS22)。制御装置90は、処理を終了する。 When indicating that an object has been detected in the first portion A11 of the first range A1 (Yes in step S21), the control device 90 sets the alarm level to level 2 by the determination unit 95 (step S22). The control device 90 ends the process.

第1範囲A1の第1部分A11において物体が検出されたことを示さない場合(ステップS21でNo)、判定部95によって、物体データ取得部94が取得した物体データの相対位置が、第1範囲A1の第2部分A12において物体が検出されたことを示すか否かを判定する(ステップS23)。制御装置90は、第1範囲A1の第2部分A12において物体が検出されたことを示す場合(ステップS23でYes)、ステップS24へ進む。制御装置90は、第1範囲A1の第2部分A12において物体が検出されたことを示さない場合(ステップS23でNo)、処理を終了する。 When it is not indicated that the object is detected in the first portion A11 of the first range A1 (No in step S21), the relative position of the object data acquired by the object data acquisition unit 94 by the determination unit 95 is the first range. It is determined whether or not it indicates that the object has been detected in the second part A12 of A1 (step S23). When the control device 90 indicates that the object has been detected in the second portion A12 of the first range A1 (Yes in step S23), the control device 90 proceeds to step S24. If the control device 90 does not indicate that an object has been detected in the second portion A12 of the first range A1 (No in step S23), the control device 90 ends the process.

第1範囲A1の第2部分A22において物体が検出されたことを示す場合(ステップS23でYes)、制御装置90は、判定部95によって、警報レベルをレベル1に設定する(ステップS24)。制御装置90は、処理を終了する。 When indicating that an object has been detected in the second portion A22 of the first range A1 (Yes in step S23), the control device 90 sets the alarm level to level 1 by the determination unit 95 (step S24). The control device 90 ends the process.

つぎに、図11を用いて、物体検出システム300の制御装置90による、第2範囲A2における物体検出方法について説明する。ステップS32、ステップS34の処理は、図10に示すフローチャートのステップS22、ステップS24の処理と同様である。制御装置90は、判定部95によって、物体データ取得部94が取得した物体データの相対位置が、第2範囲A2の第1部分A21において物体が検出されたことを示すか否かを判定する(ステップS31)。制御装置90は、第2範囲A2の第1部分A21において物体が検出されたことを示す場合(ステップS31でYes)、ステップS32へ進む。制御装置90は、第2範囲A2の第1部分A21において物体が検出されたことを示さない場合(ステップS31でNo)、ステップS33へ進む。 Next, the object detection method in the second range A2 by the control device 90 of the object detection system 300 will be described with reference to FIG. The processing of steps S32 and S34 is the same as the processing of steps S22 and S24 of the flowchart shown in FIG. The control device 90 determines whether or not the relative position of the object data acquired by the object data acquisition unit 94 indicates that the object has been detected in the first portion A21 of the second range A2 by the determination unit 95 ((). Step S31). When the control device 90 indicates that the object has been detected in the first portion A21 of the second range A2 (Yes in step S31), the control device 90 proceeds to step S32. If the control device 90 does not indicate that an object has been detected in the first portion A21 of the second range A2 (No in step S31), the control device 90 proceeds to step S33.

第2範囲A2の第1部分A21において物体が検出されたことを示さない場合(ステップS31でNo)、判定部95によって、物体データ取得部94が取得した物体データの相対位置が、第2範囲A2の第2部分A22において物体が検出されたことを示すか否かを判定する(ステップS33)。制御装置90は、第2範囲A2の第2部分A22において物体が検出されたことを示す場合(ステップS33でYes)、ステップS34へ進む。制御装置90は、第2範囲A2の第2部分A22において物体が検出されたことを示さない場合(ステップS33でNo)、処理を終了する。 When it is not indicated that the object is detected in the first part A21 of the second range A2 (No in step S31), the relative position of the object data acquired by the object data acquisition unit 94 by the determination unit 95 is the second range. It is determined whether or not it indicates that the object has been detected in the second part A22 of A2 (step S33). When the control device 90 indicates that an object has been detected in the second portion A22 of the second range A2 (Yes in step S33), the control device 90 proceeds to step S34. If the control device 90 does not indicate that an object has been detected in the second portion A22 of the second range A2 (No in step S33), the control device 90 ends the process.

オペレータは、警報装置80から発せられた音声又は光によって、フォークリフト1の周辺に物体が検出されたことと、警報レベルとを確認する。そして、オペレータにより、物体との衝突を回避するための操作が行われる。オペレータは、例えば、ブレーキ操作を行ったり、アクセルの踏込を解除する操作を行ったり、ハンドル操作を行ったりする。 The operator confirms that an object has been detected around the forklift 1 and the alarm level by the voice or light emitted from the alarm device 80. Then, the operator performs an operation for avoiding a collision with an object. The operator, for example, performs a brake operation, an operation of releasing the depression of the accelerator, and a steering wheel operation.

<物体の検出処理のキャンセル>
ここで、フォークリフト1の車速が車速第三閾値以上である場合、又は、フォークリフト1のタイヤ切れ角が切れ角閾値以上である場合、物体の検出処理をキャンセルする場合について説明する。この場合、図9に示すフローチャートのステップS13でNoと判定された後、ステップS16の処理を実行する前に、言い換えると、物体の検出処理を実行する前に、判定部95によって、フォークリフト1の車速が車速第三閾値以上であるか、又は、フォークリフト1のタイヤ切れ角が切れ角閾値以上であるかを判定するステップを設ける(ステップS13−2)。そして、判定部95によって、フォークリフト1の車速が車速第三閾値以上である、又は、フォークリフト1のタイヤ切れ角が切れ角閾値以上であると判定される場合(ステップS13−2でYes)、物体の検出処理であるステップS16、ステップS17を実行せずに、処理を終了する。ステップS16、ステップS17を実行しない場合、警報装置80のスピーカを介したブザー音声または警報ランプによって、物体の検出処理がキャンセルされていることを、オペレータに通知してもよい。また、ステップS16、ステップS17を実行しない場合、警報装置80のスピーカを介したブザー音声または警報ランプによって、物体の検出処理がキャンセルされていることを、表示パネル52に表示してもよい。判定部95によって、フォークリフト1の車速が車速第三閾値以上ではなく、フォークリフト1のタイヤ切れ角が切れ角閾値以上ではないと判定される場合(ステップS13−2でNo)、ステップS16へ進んで、物体の検出処理を実行する。
<Cancellation of object detection process>
Here, a case where the vehicle speed of the forklift 1 is equal to or higher than the vehicle speed third threshold value, or when the tire turning angle of the forklift 1 is equal to or higher than the turning angle threshold value, and the object detection process is canceled will be described. In this case, after the determination in step S13 of the flowchart shown in FIG. 9, before executing the process of step S16, in other words, before executing the object detection process, the forklift 1 is subjected to the determination unit 95. A step is provided for determining whether the vehicle speed is equal to or higher than the vehicle speed third threshold value or the tire turning angle of the forklift 1 is equal to or higher than the turning angle threshold value (step S13-2). Then, when the determination unit 95 determines that the vehicle speed of the forklift 1 is equal to or higher than the vehicle speed third threshold value, or the tire turning angle of the forklift 1 is equal to or higher than the turning angle threshold value (Yes in step S13-2), the object. The process is terminated without executing steps S16 and S17, which are the detection processes of. If the steps S16 and S17 are not executed, the operator may be notified by the buzzer sound or the alarm lamp through the speaker of the alarm device 80 that the object detection process has been cancelled. Further, when the steps S16 and S17 are not executed, the display panel 52 may indicate that the object detection process has been canceled by the buzzer sound or the alarm lamp through the speaker of the alarm device 80. When the determination unit 95 determines that the vehicle speed of the forklift 1 is not equal to or higher than the vehicle speed third threshold value and the tire turning angle of the forklift 1 is not equal to or higher than the turning angle threshold value (No in step S13-2), the process proceeds to step S16. , Executes the object detection process.

なお、図9に示すフローチャートのステップS18でYesと判定された後に、フォークリフト1の車速が車速第三閾値以上であるか、又は、フォークリフト1のタイヤ切れ角が切れ角閾値以上であるかを判定するステップを設け、判定部95によって、フォークリフト1の車速が車速第三閾値以上である、又は、フォークリフト1のタイヤ切れ角が切れ角閾値以上であると判定される場合、警報を出力するステップS19を実行せずに、処理を終了してもよい。 After the determination is Yes in step S18 of the flowchart shown in FIG. 9, it is determined whether the vehicle speed of the forklift 1 is equal to or higher than the vehicle speed third threshold value or the tire turning angle of the forklift 1 is equal to or higher than the turning angle threshold value. Step S19 to output an alarm when the determination unit 95 determines that the vehicle speed of the forklift 1 is equal to or higher than the vehicle speed third threshold value or the tire turning angle of the forklift 1 is equal to or higher than the turning angle threshold value. You may end the process without executing.

<コンピュータシステム>
図12は、本実施形態に係るコンピュータシステム1000の一例を示すブロック図である。上述の制御装置90は、コンピュータシステム1000を含む。コンピュータシステム1000は、CPU(Central Processing Unit)のようなプロセッサ1001と、ROM(Read Only Memory)のような不揮発性メモリ及びRAM(Random Access Memory)のような揮発性メモリを含むメインメモリ1002と、ストレージ1003と、入出力回路を含むインターフェース1004とを有する。上述の制御装置90の機能は、プログラムとしてストレージ1003に記憶されている。プロセッサ1001は、プログラムをストレージ1003から読み出してメインメモリ1002に展開し、プログラムに従って上述の処理を実行する。なお、プログラムは、ネットワークを介してコンピュータシステム1000に配信されてもよい。
<Computer system>
FIG. 12 is a block diagram showing an example of the computer system 1000 according to the present embodiment. The control device 90 described above includes a computer system 1000. The computer system 1000 includes a processor 1001 such as a CPU (Central Processing Unit), a main memory 1002 including a non-volatile memory such as a ROM (Read Only Memory) and a volatile memory such as a RAM (Random Access Memory). It has a storage 1003 and an interface 1004 including an input / output circuit. The function of the control device 90 described above is stored in the storage 1003 as a program. The processor 1001 reads the program from the storage 1003, expands it into the main memory 1002, and executes the above-described processing according to the program. The program may be distributed to the computer system 1000 via the network.

<効果>
以上説明したように、本実施形態では、切替部92によって、フォークリフト1の車速に応じて、物体を検出する範囲が、第1範囲A1と第2範囲A2とで切り替えられる。本実施形態では、判定部95によって、切替部92が切り替えた第1範囲A1又は第2範囲A2において、物体が検出されたか否かが判定される。本実施形態によれば、フォークリフト1の車速に応じて第1範囲A1と第2範囲A2とを切り替えて、フォークリフト1の周辺に物体が存在するか否かを適切に判定することができる。
<Effect>
As described above, in the present embodiment, the switching unit 92 switches the range for detecting the object between the first range A1 and the second range A2 according to the vehicle speed of the forklift 1. In the present embodiment, the determination unit 95 determines whether or not an object is detected in the first range A1 or the second range A2 switched by the switching unit 92. According to the present embodiment, the first range A1 and the second range A2 can be switched according to the vehicle speed of the forklift 1, and it can be appropriately determined whether or not an object exists in the vicinity of the forklift 1.

本実施形態では、第1範囲A1及び第2範囲A2は、物体検出装置70の検出領域に含まれる。本実施形態では、第1範囲A1又は第2範囲A2に物体が存在すると判定された場合、警報装置80から警報が出力される。本実施形態によれば、フォークリフト1の周辺に物体が存在する場合に、警報を適切に出力することができる。このようにして、本実施形態によれば、警報が不用意に頻繁に発せられることを抑制することができる。 In the present embodiment, the first range A1 and the second range A2 are included in the detection area of the object detection device 70. In the present embodiment, when it is determined that an object exists in the first range A1 or the second range A2, an alarm is output from the alarm device 80. According to the present embodiment, when an object exists in the vicinity of the forklift 1, an alarm can be appropriately output. In this way, according to the present embodiment, it is possible to prevent the alarm from being inadvertently and frequently issued.

本実施形態では、第1範囲A1及び第2範囲A2の幅Wは、フォークリフト1の車幅Wrを含む。本実施形態では、フォークリフト1の走行に必要最小限の幅を有する第1範囲A1及び第2範囲A2が設定される。本実施形態によれば、フォークリフト1の周辺に物体が存在するか否かを適切に判定することができる。 In the present embodiment, the width W of the first range A1 and the second range A2 includes the vehicle width Wr of the forklift 1. In the present embodiment, the first range A1 and the second range A2 having the minimum width necessary for the forklift 1 to travel are set. According to this embodiment, it is possible to appropriately determine whether or not an object exists in the vicinity of the forklift 1.

本実施形態では、例えば、フォークリフト1が停止している場合、物体を検出する範囲を、第1範囲A1に切り替える。本実施形態では、フォークリフト1が後進している場合、物体を検出する範囲を、第2範囲A2に切り替える。本実施形態によれば、フォークリフト1の停止時のように車速が低い場合でも、フォークリフト1の周辺に物体が存在するか否かを適切に判定することができる。 In the present embodiment, for example, when the forklift 1 is stopped, the range for detecting an object is switched to the first range A1. In the present embodiment, when the forklift 1 is moving backward, the range for detecting an object is switched to the second range A2. According to the present embodiment, even when the vehicle speed is low such as when the forklift 1 is stopped, it is possible to appropriately determine whether or not an object exists in the vicinity of the forklift 1.

本実施形態では、物体を検出する範囲が第2範囲A2に切り替えられている場合において、フォークリフト1が後進を開始した直後のように、フォークリフト1の車速が車速第一閾値以下である場合、第2範囲A2のうち、例えば、第1部分A21を固定範囲として設定する。本実施形態によれば、フォークリフト1が後進を開始した直後など、車速が低い場合でも、第2範囲A2の長さLがゼロにならないようにすることができる。また、固定範囲を第1範囲よりも短くすることで、第1範囲で物体を検出している際は、広い範囲で物体を検出することで、フォークリフトの周囲の安全を確認しながらフォークリフトを作動することができ、第2範囲に切り替わった後は、不要な警報を抑制することができる。 In the present embodiment, when the range for detecting an object is switched to the second range A2 and the vehicle speed of the forklift 1 is equal to or less than the vehicle speed first threshold value, such as immediately after the forklift 1 starts moving backward, the first Of the two ranges A2, for example, the first portion A21 is set as a fixed range. According to the present embodiment, the length L of the second range A2 can be prevented from becoming zero even when the vehicle speed is low, such as immediately after the forklift 1 starts moving backward. In addition, by making the fixed range shorter than the first range, when an object is detected in the first range, the forklift is operated while checking the safety around the forklift by detecting the object in a wide range. This can be done, and after switching to the second range, unnecessary alarms can be suppressed.

本実施形態では、フォークリフト1が後進している場合、フォークリフト1の車速及びタイヤ切れ角に応じて、第2範囲A2の形状を変更する。本実施形態によれば、フォークリフト1の予測される進路に沿って、必要最小限の大きさ及び最適な形状を有する第2範囲A2を設定することができる。 In the present embodiment, when the forklift 1 is moving backward, the shape of the second range A2 is changed according to the vehicle speed of the forklift 1 and the tire turning angle. According to the present embodiment, the second range A2 having the minimum necessary size and the optimum shape can be set along the predicted course of the forklift 1.

本実施形態では、第1範囲A1及び第2範囲A2が、異なる警報レベルに関連付けられた、複数の部分にわけられている。本実施形態では、物体が、第1部分A11、第2部分A12、第1部分A21、及び第2部分A22のいずれかに存在する場合、警報レベルに基づいて、適切な警報を出力させることができる。本実施形態によれば、オペレータが警報レベルを確認することができる。 In this embodiment, the first range A1 and the second range A2 are divided into a plurality of parts associated with different alarm levels. In the present embodiment, when the object is present in any of the first part A11, the second part A12, the first part A21, and the second part A22, an appropriate alarm can be output based on the alarm level. it can. According to this embodiment, the operator can confirm the alarm level.

本実施形態では、車速が車速第三閾値以上である場合、警報を出力しないようにすることができる。車速が車速第三閾値以上である場合、物体を検出してから警報が出力されるまでにフォークリフト1が移動する距離が長くなる。これにより、物体が検出されて警報が出力されるまでの時間で、フォークリフト1と物体との相対位置が大きく変化しているおそれがある。本実施形態によれば、不適切なタイミングでの警報の出力を抑制することができる。 In the present embodiment, when the vehicle speed is equal to or higher than the vehicle speed third threshold value, the alarm can be prevented from being output. When the vehicle speed is equal to or higher than the vehicle speed third threshold value, the distance traveled by the forklift 1 from the detection of the object to the output of the alarm becomes long. As a result, the relative position between the forklift 1 and the object may change significantly in the time until the object is detected and the alarm is output. According to this embodiment, it is possible to suppress the output of an alarm at an inappropriate timing.

本実施形態では、フォークリフト1のタイヤ切れ角が切れ角閾値以上である場合、警報を出力しないようにすることができる。タイヤ切れ角が切れ角閾値以上である場合、物体検出装置70の検出範囲から第2範囲A2が外れることがある。本実施形態によれば、第2範囲A2を適切に設定することができる。 In the present embodiment, when the tire turning angle of the forklift 1 is equal to or larger than the turning angle threshold value, the alarm can be prevented from being output. When the tire turning angle is equal to or larger than the turning angle threshold value, the second range A2 may deviate from the detection range of the object detection device 70. According to this embodiment, the second range A2 can be appropriately set.

本実施形態では、左レーダ70Lによって物体が検出された場合、又は、フォークリフト1の前後軸より左側に物体が検出された場合に限って、左警報装置80Lから警報を出力してもよい。本実施形態では、右レーダ70Rによって物体が検出された場合、又は、フォークリフト1の前後軸より右側に物体が検出された場合に限って、右警報装置80Rから警報を出力してもよい。本実施形態によれば、オペレータが物体が存在する方向を直感的に確認することができる。 In the present embodiment, an alarm may be output from the left alarm device 80L only when an object is detected by the left radar 70L or when an object is detected on the left side of the front-rear axis of the forklift 1. In the present embodiment, an alarm may be output from the right alarm device 80R only when an object is detected by the right radar 70R or when an object is detected on the right side of the front-rear axis of the forklift 1. According to this embodiment, the operator can intuitively confirm the direction in which the object exists.

<変形例>
上記において、判定部95によって警報レベルが0より大きく、フォークリフト1が後退可能であると判定する場合、制御装置90が、車両制御装置69へ対して、フォークリフト1の走行状態を制御させるための制御信号を出力してもよい。例えば、車両制御装置69では、出力低減処理が実行されるように、動力発生装置に制御信号を出力してもよい。これにより、フォークリフト1の車速が低減され、フォークリフト1が停止される。例えば、車両制御装置69では、ブレーキ処理が実行されるように、制御信号を出力してもよい。これにより、フォークリフト1の車速が低減又はフォークリフト1の走行が停止される。例えば、車両制御装置69では、走行方向変更処理が実行されるように、操舵装置に制御信号を出力してもよい。これにより、フォークリフト1の進路上に物体が存在しないようにフォークリフト1の走行方向が変更される。
<Modification example>
In the above, when the determination unit 95 determines that the alarm level is higher than 0 and the forklift 1 can be retracted, the control device 90 controls the vehicle control device 69 to control the traveling state of the forklift 1. A signal may be output. For example, the vehicle control device 69 may output a control signal to the power generator so that the output reduction process is executed. As a result, the vehicle speed of the forklift 1 is reduced, and the forklift 1 is stopped. For example, the vehicle control device 69 may output a control signal so that the braking process is executed. As a result, the vehicle speed of the forklift 1 is reduced or the running of the forklift 1 is stopped. For example, the vehicle control device 69 may output a control signal to the steering device so that the traveling direction change process is executed. As a result, the traveling direction of the forklift 1 is changed so that no object exists in the path of the forklift 1.

上記では、物体検出装置70は、左レーダ70L及び右レーダ70Rを含むものとして説明したが、これに限定されない。物体検出装置70は、1つでも、3つ以上でもよい。 In the above, the object detection device 70 has been described as including the left radar 70L and the right radar 70R, but is not limited thereto. The object detection device 70 may be one or three or more.

上記では、警報レベルを3段階として説明したが、これに限定されない。警報レベルは、4段階以上でも、2段階でもよい。 In the above, the alarm level has been described as three levels, but the present invention is not limited to this. The alarm level may be 4 levels or more or 2 levels.

上記では、切れ角取得部911は、車両制御装置69からタイヤ切れ角を取得するものとして説明したが、これに限定されない。切れ角取得部911は、車両制御装置69から取得したフォークリフト1の車体データに基づいて、フォークリフト1の操舵装置の操作量を検出して、フォークリフト1の後輪12のタイヤ切れ角を算出してもよい。 In the above, the turning angle acquisition unit 911 has been described as acquiring the tire turning angle from the vehicle control device 69, but the present invention is not limited to this. The turning angle acquisition unit 911 detects the operation amount of the steering device of the forklift 1 based on the vehicle body data of the forklift 1 acquired from the vehicle control device 69, and calculates the tire turning angle of the rear wheels 12 of the forklift 1. May be good.

上記では、車速取得部912は、車両制御装置69から車速を取得するものとして説明したが、これに限定されない。車速取得部912は、車両制御装置69から取得したフォークリフト1の車体データに含まれる、回転速度センサの検出値としての回転速度値に基づいて、フォークリフト1の車速を算出してもよい。また、車速取得部912は、取得したフォークリフト1の車体データに含まれる、回転速度センサの検出値に基づいて、フォークリフト1の車速を検出してもよい。 In the above, the vehicle speed acquisition unit 912 has been described as acquiring the vehicle speed from the vehicle control device 69, but the present invention is not limited to this. The vehicle speed acquisition unit 912 may calculate the vehicle speed of the forklift 1 based on the rotation speed value as the detection value of the rotation speed sensor included in the vehicle body data of the forklift 1 acquired from the vehicle control device 69. Further, the vehicle speed acquisition unit 912 may detect the vehicle speed of the forklift 1 based on the detection value of the rotation speed sensor included in the acquired vehicle body data of the forklift 1.

上記では、幅Wは、フォークリフト1の車幅Wrを含むものとして説明したが、これに限定されない。幅Wは、フォークリフト1の車幅Wrよりも短い幅としてもよい。 In the above, the width W has been described as including the vehicle width Wr of the forklift 1, but the width W is not limited to this. The width W may be shorter than the vehicle width Wr of the forklift 1.

上記では、作業機械がフォークリフト1であるものとして説明したが、これに限定されない。作業機械は、バッテリからの電力又はエンジン等によって駆動される発電機から得られた電力で駆動されるホイールローダ又は油圧ショベル等であってもよい。 In the above, the work machine is described as the forklift 1, but the present invention is not limited to this. The work machine may be a wheel loader, a hydraulic excavator, or the like driven by electric power from a battery or electric power obtained from a generator driven by an engine or the like.

1…フォークリフト(作業機械)、10…車体、13…フォーク、16…リヤピラー、60…車体データ取得装置、61…切れ角センサ(操舵角検出部)、62…車速センサ(車速検出部)、69…車両制御装置、70…物体検出装置(物体検出部)、70L…左レーダ(物体検出部)、70R…右レーダ(物体検出部)、80…警報装置(警報部)、80L…左警報装置、80R…右警報装置、90…制御装置、91…車体データ取得部、92…切替部、93…設定部、94…物体データ取得部、95…判定部、96…警報制御部、99…記憶部、300…物体検出システム、A1…第1範囲(第1検出範囲)、A11…第1部分、A12…第2部分、A2…第2範囲(第2検出範囲)、A21…第1部分、A22…第2部分 1 ... Fork lift (working machine), 10 ... Body, 13 ... Fork, 16 ... Rear pillar, 60 ... Body data acquisition device, 61 ... Turning angle sensor (steering angle detection unit), 62 ... Vehicle speed sensor (vehicle speed detection unit), 69 ... Vehicle control device, 70 ... Object detection device (object detection unit), 70L ... Left radar (object detection unit), 70R ... Right radar (object detection unit), 80 ... Alarm device (alarm unit), 80L ... Left alarm device , 80R ... right alarm device, 90 ... control device, 91 ... vehicle body data acquisition unit, 92 ... switching unit, 93 ... setting unit, 94 ... object data acquisition unit, 95 ... judgment unit, 96 ... alarm control unit, 99 ... storage Part, 300 ... Object detection system, A1 ... 1st range (1st detection range), A11 ... 1st part, A12 ... 2nd part, A2 ... 2nd range (2nd detection range), A21 ... 1st part, A22 ... Part 2

Claims (10)

作業機械の周辺の物体を検出する物体検出部と、
前記作業機械の車速を検出する車速検出部と、
前記作業機械の周辺において前記物体を検出する第1検出範囲と第2検出範囲とを設定する設定部と、
前記車速検出部が検出した車速に応じて、前記第1検出範囲と前記第2検出範囲とを切り替える切替部と、
前記切替部が切り替えた前記第1検出範囲又は前記第2検出範囲において、前記物体が検出されたか否かを判定する判定部と、
を備える作業機械。
An object detector that detects objects around the work machine,
A vehicle speed detection unit that detects the vehicle speed of the work machine,
A setting unit that sets a first detection range and a second detection range for detecting the object around the work machine, and
A switching unit that switches between the first detection range and the second detection range according to the vehicle speed detected by the vehicle speed detection unit.
A determination unit for determining whether or not the object is detected in the first detection range or the second detection range switched by the switching unit.
A work machine equipped with.
前記設定部は、前記車速検出部が検出した車速が車速第一閾値以下である場合、前記第2検出範囲を固定とする
請求項1に記載の作業機械。
The work machine according to claim 1, wherein the setting unit fixes the second detection range when the vehicle speed detected by the vehicle speed detection unit is equal to or less than the vehicle speed first threshold value.
前記作業機械の操舵角を検出する操舵角検出部、
を備え、
前記設定部は、前記作業機械に対して所定距離の範囲を前記第1検出範囲として設定し、前記車速検出部が検出した車速と前記操舵角検出部が検出した操舵角とに基づいて、前記第2検出範囲を設定する、
請求項1又は請求項2に記載の作業機械。
Steering angle detection unit that detects the steering angle of the work machine,
With
The setting unit sets a range of a predetermined distance to the work machine as the first detection range, and based on the vehicle speed detected by the vehicle speed detection unit and the steering angle detected by the steering angle detection unit, the setting unit Set the second detection range,
The work machine according to claim 1 or 2.
前記切替部は、前記車速検出部が検出した車速が車速第二閾値以下である場合、前記第1検出範囲に切り替え、前記車速検出部が検出した車速が車速第二閾値より高い場合、前記第2検出範囲に切り替える、
請求項1から3のいずれか一項に記載の作業機械。
The switching unit switches to the first detection range when the vehicle speed detected by the vehicle speed detection unit is equal to or less than the vehicle speed second threshold value, and when the vehicle speed detected by the vehicle speed detection unit is higher than the vehicle speed second threshold value, the first detection unit 2 Switch to the detection range,
The work machine according to any one of claims 1 to 3.
前記設定部は、警報レベルが第1レベルの第1部分と、作業機械の走行方向において前記第1部分より作業機械から遠く、前記第1レベルより低い警報レベルの第2レベルの第2部分とを含む、前記第1検出範囲と前記第2検出範囲とを設定し、
前記判定部は、前記第1部分と前記第2部分とのどちらにおいて、前記物体が検出されたかに応じて、前記警報レベルを判定する、
請求項1から4のいずれか一項に記載の作業機械。
The setting unit includes a first portion having an alarm level of the first level and a second portion of a second level having an alarm level lower than the first level, which is farther from the work machine than the first portion in the traveling direction of the work machine. The first detection range and the second detection range including the above are set.
The determination unit determines the alarm level depending on whether the object is detected in the first portion or the second portion.
The work machine according to any one of claims 1 to 4.
前記判定部によって前記物体が検出されたと判定する場合、警報を出力する警報部、
を備え、
前記警報部は、前記判定部が判定した前記警報レベルに応じた警報を出力する、
請求項5に記載の作業機械。
When it is determined that the object has been detected by the determination unit, an alarm unit that outputs an alarm,
With
The alarm unit outputs an alarm according to the alarm level determined by the determination unit.
The work machine according to claim 5.
前記警報部は、前記作業機械の運転席の周辺に、複数が設置され、前記判定部によって前記物体が検出されたと判定する場合、前記物体の検出方向に対応した前記警報部から警報を出力する、
請求項6に記載の作業機械。
When a plurality of the alarm units are installed around the driver's seat of the work machine and it is determined that the object is detected by the determination unit, an alarm is output from the alarm unit corresponding to the detection direction of the object. ,
The work machine according to claim 6.
前記判定部は、前記車速検出部が検出した車速が車速第三閾値以上である場合、警報を出力しないと判定する、
請求項5に記載の作業機械。
The determination unit determines that the alarm is not output when the vehicle speed detected by the vehicle speed detection unit is equal to or higher than the vehicle speed third threshold value.
The work machine according to claim 5.
前記判定部は、前記操舵角検出部が検出した前記作業機械の操舵角が操舵角閾値以上である場合、警報を出力しないと判定する、
請求項3に記載の作業機械。
The determination unit determines that the alarm is not output when the steering angle of the work machine detected by the steering angle detection unit is equal to or greater than the steering angle threshold value.
The work machine according to claim 3.
作業機械の周辺の物体を物体検出部によって検出することと、
前記作業機械の車速を車速検出部によって検出することと、
前記作業機械の周辺において前記物体を検出する第1検出範囲と第2検出範囲とを設定することと、
前記車速検出部によって検出された車速に応じて、前記第1検出範囲と前記第2検出範囲とを切り替えることと、
切り替えられた前記第1検出範囲又は前記第2検出範囲において、前記物体が検出されたか否かを判定することと、
を含む作業機械の制御方法。
Detecting objects around the work machine with the object detector,
The vehicle speed of the work machine is detected by the vehicle speed detection unit, and
Setting a first detection range and a second detection range for detecting the object around the work machine, and
Switching between the first detection range and the second detection range according to the vehicle speed detected by the vehicle speed detection unit.
Determining whether or not the object is detected in the switched first detection range or the second detection range, and
How to control work machines, including.
JP2019147844A 2019-08-09 2019-08-09 Work machines and work machine control methods Active JP7370189B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2019147844A JP7370189B2 (en) 2019-08-09 2019-08-09 Work machines and work machine control methods
JP2023178898A JP2023174836A (en) 2019-08-09 2023-10-17 Working machine and control method of working machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019147844A JP7370189B2 (en) 2019-08-09 2019-08-09 Work machines and work machine control methods

Related Child Applications (1)

Application Number Title Priority Date Filing Date
JP2023178898A Division JP2023174836A (en) 2019-08-09 2023-10-17 Working machine and control method of working machine

Publications (2)

Publication Number Publication Date
JP2021028266A true JP2021028266A (en) 2021-02-25
JP7370189B2 JP7370189B2 (en) 2023-10-27

Family

ID=74667188

Family Applications (2)

Application Number Title Priority Date Filing Date
JP2019147844A Active JP7370189B2 (en) 2019-08-09 2019-08-09 Work machines and work machine control methods
JP2023178898A Pending JP2023174836A (en) 2019-08-09 2023-10-17 Working machine and control method of working machine

Family Applications After (1)

Application Number Title Priority Date Filing Date
JP2023178898A Pending JP2023174836A (en) 2019-08-09 2023-10-17 Working machine and control method of working machine

Country Status (1)

Country Link
JP (2) JP7370189B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20220159824A (en) * 2021-05-26 2022-12-05 넥센타이어 주식회사 Tire and method for detection falure of tire
JP7396227B2 (en) 2020-08-20 2023-12-12 株式会社豊田自動織機 Forklift notification device

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1143299A (en) * 1997-07-25 1999-02-16 Toyo Umpanki Co Ltd Carrier vehicle
JP2015170284A (en) * 2014-03-10 2015-09-28 株式会社日立製作所 Forklift type unmanned carrier vehicle, control method of the same, and control device of the same
JP2019105995A (en) * 2017-12-12 2019-06-27 株式会社豊田自動織機 Automatic operation forklift

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2722687B1 (en) 2012-10-22 2015-04-29 Sick Ag Safety device for a vehicle

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1143299A (en) * 1997-07-25 1999-02-16 Toyo Umpanki Co Ltd Carrier vehicle
JP2015170284A (en) * 2014-03-10 2015-09-28 株式会社日立製作所 Forklift type unmanned carrier vehicle, control method of the same, and control device of the same
JP2019105995A (en) * 2017-12-12 2019-06-27 株式会社豊田自動織機 Automatic operation forklift

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7396227B2 (en) 2020-08-20 2023-12-12 株式会社豊田自動織機 Forklift notification device
KR20220159824A (en) * 2021-05-26 2022-12-05 넥센타이어 주식회사 Tire and method for detection falure of tire
KR102547342B1 (en) * 2021-05-26 2023-06-26 넥센타이어 주식회사 Tire and method for detection falure of tire

Also Published As

Publication number Publication date
JP7370189B2 (en) 2023-10-27
JP2023174836A (en) 2023-12-08

Similar Documents

Publication Publication Date Title
JP2023174836A (en) Working machine and control method of working machine
US10941544B2 (en) Warning system for a working machine
JP5411976B1 (en) Work vehicle periphery monitoring system and work vehicle
CA2893470C (en) Transporter vehicle, dump truck, and transporter vehicle control method
US9633563B2 (en) Integrated object detection and warning system
JP3219005U (en) Construction vehicle
JP2010073134A (en) Vehicle surrounding recognition support system
JP5904280B2 (en) Vehicle alarm device
EP3919688A1 (en) Work machinery
JP2021020497A (en) Collision avoidance support device
JP2006195877A (en) Working machine
JP6747141B2 (en) Speed control device
KR102031400B1 (en) A vehicle having functoin of projecting to the ground
JP2020165230A (en) Wheel loader
JP5901525B2 (en) Industrial vehicle and alarm system for industrial vehicle
EP4049964A1 (en) Industrial vehicle
JP2020170237A (en) Manned-unmanned forklift and travel control method
JP5341705B2 (en) Vehicle travel safety device
JP6338710B1 (en) Alarm device and alarm method
JP2020170238A (en) Manned-unmanned forklift and travel control method
JP2021070988A (en) Construction machine
US20240152149A1 (en) Industrial vehicle
KR20190004881A (en) Automobile and method for controlling automobile
JP2022133832A (en) Periphery monitoring device for work vehicle, and work vehicle
KR20100073922A (en) Apparatus and method for alerting collision of automobile

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220719

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230511

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230523

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230718

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20231017

R151 Written notification of patent or utility model registration

Ref document number: 7370189

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151