JP2020180796A - Obstacle detector and obstacle detection method - Google Patents

Obstacle detector and obstacle detection method Download PDF

Info

Publication number
JP2020180796A
JP2020180796A JP2019082092A JP2019082092A JP2020180796A JP 2020180796 A JP2020180796 A JP 2020180796A JP 2019082092 A JP2019082092 A JP 2019082092A JP 2019082092 A JP2019082092 A JP 2019082092A JP 2020180796 A JP2020180796 A JP 2020180796A
Authority
JP
Japan
Prior art keywords
obstacle
time
ultrasonic
reflected wave
wave
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
JP2019082092A
Other languages
Japanese (ja)
Other versions
JP7107274B2 (en
Inventor
翔三 幸元
Shozo Yukimoto
翔三 幸元
裕一 西野
Yuichi Nishino
裕一 西野
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Industries Corp
Original Assignee
Toyota Industries Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Industries Corp filed Critical Toyota Industries Corp
Priority to JP2019082092A priority Critical patent/JP7107274B2/en
Publication of JP2020180796A publication Critical patent/JP2020180796A/en
Application granted granted Critical
Publication of JP7107274B2 publication Critical patent/JP7107274B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

To provide an obstacle detector and an obstacle detection method with which it is possible to determine whether the detected obstacle is a near-distance or a far-distance obstacle.SOLUTION: An ultrasonic detector comprises an ultrasonic sensor, a transmission command unit for causing an ultrasonic wave to be repeatedly transmitted by the ultrasonic sensor, and a detection unit for detecting an obstacle from the result of having received a reflected wave by the ultrasonic sensor. The transmission command unit causes an ultrasonic wave to be transmitted at a first transmission interval Ta by the ultrasonic sensor and causes an ultrasonic wave to be transmitted at a second transmission interval Tb different from the first transmission interval Ta by the ultrasonic sensor when the detection unit detects an obstacle as a reflected wave is received by the ultrasonic sensor. The ultrasonic detector includes a determination unit for calculating a time for determination which is a difference between the receive time of a reflected wave for detection which is a reflected wave used for detecting an obstacle and the receive time of a reflected wave for determination which is a reflected wave received after the reflected wave for detection, and determining whether the obstacle is a near-distance or a far-distance obstacle on the basis of the result of comparison of the time for determination with a threshold.SELECTED DRAWING: Figure 7

Description

本発明は、障害物検出装置及び障害物検出方法に関する。 The present invention relates to an obstacle detection device and an obstacle detection method.

特許文献1には、超音波により障害物を検出する障害物検出装置が記載されている。障害物検出装置は、超音波を送信し、障害物によって反射された反射波を受信する超音波センサと、超音波センサによる超音波の送信を制御する送信指令部と、超音波センサによる反射波の受信結果から障害物を検出する検出部とを備える。検出部が障害物を検出した場合には、超音波センサが超音波を送信してから、障害物により反射した反射波を超音波センサが受信するまでの時間を測定することにより、超音波センサから障害物までの距離が分かる。超音波センサから障害物までの距離が長くなるほど、超音波センサが超音波を送信してから障害物により反射した反射波を超音波センサが受信するまでの時間も長くなる。 Patent Document 1 describes an obstacle detection device that detects an obstacle by ultrasonic waves. The obstacle detection device includes an ultrasonic sensor that transmits ultrasonic waves and receives the reflected waves reflected by the obstacles, a transmission command unit that controls the transmission of ultrasonic waves by the ultrasonic sensors, and reflected waves by the ultrasonic sensor. It is provided with a detection unit that detects obstacles from the reception result of. When the detection unit detects an obstacle, the ultrasonic sensor measures the time from when the ultrasonic sensor transmits ultrasonic waves to when the ultrasonic sensor receives the reflected wave reflected by the obstacle. You can see the distance from to the obstacle. The longer the distance from the ultrasonic sensor to the obstacle, the longer the time from when the ultrasonic sensor transmits ultrasonic waves to when the ultrasonic sensor receives the reflected wave reflected by the obstacle.

ところで、このような障害物検出装置では、送信指令部が超音波センサに超音波を繰り返し送信させることにより障害物の検出を繰り返し行う。このとき、超音波センサによる超音波の送信間隔を短くすれば障害物の検出間隔も短くなるため、障害物を早期に検出できる。 By the way, in such an obstacle detection device, the transmission command unit repeatedly detects an obstacle by causing an ultrasonic sensor to repeatedly transmit ultrasonic waves. At this time, if the ultrasonic wave transmission interval by the ultrasonic sensor is shortened, the obstacle detection interval is also shortened, so that the obstacle can be detected at an early stage.

特開2014−169927号公報Japanese Unexamined Patent Publication No. 2014-169927

その一方で、超音波の送信間隔を短くすると、超音波センサから障害物までの距離によっては、超音波の送信から反射波の受信までに要する時間が超音波の送信間隔以上になることがある。超音波の送信から反射波の受信までに要する時間が超音波の送信間隔よりも短くなるような障害物を近距離障害物とし、超音波の送信から反射波の受信までに要する時間が超音波の送信間隔以上になるような障害物を遠距離障害物とする。 On the other hand, if the ultrasonic wave transmission interval is shortened, the time required from the ultrasonic wave transmission to the reception of the reflected wave may be longer than the ultrasonic wave transmission interval depending on the distance from the ultrasonic sensor to the obstacle. .. A short-range obstacle is an obstacle in which the time required from the transmission of ultrasonic waves to the reception of reflected waves is shorter than the transmission interval of ultrasonic waves, and the time required from the transmission of ultrasonic waves to the reception of reflected waves is ultrasonic waves. Obstacles that exceed the transmission interval of are defined as long-distance obstacles.

例えば、図12(a)に示すように、障害物検出装置の超音波センサは、時刻t0において第1超音波Us1を送信し、時刻t0から時間Tp経過後の時刻t1において第2超音波Us2を送信する。つまり、超音波の送信間隔はTpである。この障害物検出装置を用いた障害物の検出例1,2を図12(b)及び図12(c)に示す。 For example, as shown in FIG. 12A, the ultrasonic sensor of the obstacle detection device transmits the first ultrasonic wave Us1 at time t0, and the second ultrasonic wave Us2 at time t1 after the time Tp has elapsed from time t0. To send. That is, the transmission interval of ultrasonic waves is Tp. Examples 1 and 2 of obstacle detection using this obstacle detection device are shown in FIGS. 12 (b) and 12 (c).

図12(b)に示す検出例1では、時刻t0には無かった障害物101が時刻t1に出現する。障害物101は、超音波センサ100から距離L1離れた位置にある近距離障害物である。この場合、時刻t1に送信された第2超音波Us2は障害物101によって反射し、超音波センサ100は第2超音波Us2の第2反射波Ur2を受信する。超音波センサ100が第2超音波Us2を送信してから第2反射波Ur2を受信するまでに要する時間Tqは、超音波の送信間隔Tpよりも短くなる。図12(a)に示すように、超音波センサ100は、第2超音波Us2が送信された時刻t1から時間Tq経過後の時刻t2において第2反射波Ur2を受信する。 In the detection example 1 shown in FIG. 12B, an obstacle 101 that was not present at the time t0 appears at the time t1. The obstacle 101 is a short-range obstacle located at a distance L1 from the ultrasonic sensor 100. In this case, the second ultrasonic wave Us2 transmitted at time t1 is reflected by the obstacle 101, and the ultrasonic sensor 100 receives the second reflected wave Ur2 of the second ultrasonic wave Us2. The time Tq required from the transmission of the second ultrasonic wave Us2 by the ultrasonic sensor 100 to the reception of the second reflected wave Ur2 is shorter than the transmission interval Tp of the ultrasonic waves. As shown in FIG. 12A, the ultrasonic sensor 100 receives the second reflected wave Ur2 at the time t2 after the time Tq elapses from the time t1 when the second ultrasonic wave Us2 is transmitted.

図12(c)に示す検出例2では、時刻t0において障害物102が存在する。障害物102は、超音波センサ100から距離L1よりも長い距離L2離れた位置にある遠距離障害物である。この場合、時刻t0に送信された第1超音波Us1は障害物102によって反射し、超音波センサ100は第1超音波Us1の第1反射波Ur1を受信する。超音波センサ100が第1超音波Us1を送信してから第1反射波Ur1を受信するまでに要する時間Trは、超音波の送信間隔Tpよりも長くなる。図12(a)に示すように、超音波センサ100は、第1超音波Us1が送信された時刻t0から時間Tr経過後の時刻t2において第1反射波Ur1を受信する。つまり、超音波センサ100は、第2超音波Us2の送信後に第1反射波Ur1を受信する。なお、図12(a)では、時間Trが、時間Tpと時間Tqとの和であるTp+Tqと一致する場合を示している。 In the detection example 2 shown in FIG. 12 (c), the obstacle 102 exists at time t0. The obstacle 102 is a long-distance obstacle located at a distance L2 longer than the distance L1 from the ultrasonic sensor 100. In this case, the first ultrasonic wave Us1 transmitted at time t0 is reflected by the obstacle 102, and the ultrasonic sensor 100 receives the first reflected wave Ur1 of the first ultrasonic wave Us1. The time Tr required from the transmission of the first ultrasonic wave Us1 by the ultrasonic sensor 100 to the reception of the first reflected wave Ur1 is longer than the ultrasonic wave transmission interval Tp. As shown in FIG. 12A, the ultrasonic sensor 100 receives the first reflected wave Ur1 at the time t2 after the time Tr has elapsed from the time t0 when the first ultrasonic wave Us1 was transmitted. That is, the ultrasonic sensor 100 receives the first reflected wave Ur1 after transmitting the second ultrasonic wave Us2. Note that FIG. 12A shows a case where the time Tr coincides with Tp + Tq, which is the sum of the time Tp and the time Tq.

このように、検出例1及び検出例2では超音波センサ100から障害物101,102までの距離が異なるにも関わらず、超音波センサ100は同じ時刻t2に反射波を受信する。ところが、図12(a)に示す超音波の送受信のタイミングからは、時刻t2において超音波センサ100が受信した反射波が第1反射波Ur1であるか第2反射波Ur2であるかは分からないため、超音波が近距離障害物によって反射したのか、遠距離障害物によって反射したのかを判定できない。その結果、検出した障害物101,102が近距離障害物であるか、遠距離障害物であるかを判定できない。 As described above, in the detection example 1 and the detection example 2, the ultrasonic sensor 100 receives the reflected wave at the same time t2 even though the distances from the ultrasonic sensor 100 to the obstacles 101 and 102 are different. However, from the timing of transmitting and receiving the ultrasonic waves shown in FIG. 12A, it is not known whether the reflected wave received by the ultrasonic sensor 100 at time t2 is the first reflected wave Ur1 or the second reflected wave Ur2. Therefore, it is not possible to determine whether the ultrasonic waves are reflected by a short-range obstacle or a long-range obstacle. As a result, it cannot be determined whether the detected obstacles 101 and 102 are short-distance obstacles or long-distance obstacles.

本発明は、上記課題を解決するためになされたものであり、その目的は、検出した障害物が近距離障害物か遠距離障害物かを判定できる障害物検出装置及び障害物検出方法を提供することにある。 The present invention has been made to solve the above problems, and an object of the present invention is to provide an obstacle detection device and an obstacle detection method capable of determining whether a detected obstacle is a short-distance obstacle or a long-distance obstacle. To do.

上記問題点を解決するための障害物検出装置は、超音波を送信し、障害物によって反射された反射波を受信する超音波センサと、前記超音波センサに繰り返し超音波を送信させる送信指令部と、前記超音波センサによる反射波の受信結果から前記障害物を検出する検出部と、を備える障害物検出装置であって、前記送信指令部は、第1送信間隔で前記超音波センサに超音波を送信させ、前記超音波センサが反射波を受信することにより前記検出部が障害物を検出すると、前記第1送信間隔とは異なる第2送信間隔で前記超音波センサに超音波を送信させ、前記障害物の検出に用いられる反射波である検出用反射波の受信時間と、前記検出用反射波よりも後に受信される反射波である判定用反射波の受信時間との差である判定用時間を算出し、前記判定用時間と閾値との比較結果に基づいて前記障害物が近距離障害物であるか遠距離障害物であるかを判定する判定部を備えることを要旨とする。 Obstacle detection devices for solving the above problems include an ultrasonic sensor that transmits ultrasonic waves and receives reflected waves reflected by the obstacle, and a transmission command unit that causes the ultrasonic sensor to repeatedly transmit ultrasonic waves. An obstacle detection device including a detection unit that detects the obstacle from the reception result of the reflected wave by the ultrasonic sensor, and the transmission command unit superimposes on the ultrasonic sensor at the first transmission interval. When the detection unit detects an obstacle by transmitting an ultrasonic wave and receiving the reflected wave by the ultrasonic sensor, the ultrasonic sensor is made to transmit ultrasonic waves at a second transmission interval different from the first transmission interval. , Judgment that is the difference between the reception time of the detection reflected wave, which is the reflected wave used for detecting the obstacle, and the reception time of the determination reflected wave, which is the reflected wave received after the detection reflected wave. The gist is to include a determination unit for calculating the usage time and determining whether the obstacle is a short-range obstacle or a long-range obstacle based on the comparison result between the determination time and the threshold value.

超音波センサが受信する反射波としては、反射波の受信直前に送信された超音波が近距離障害物によって反射したものである場合と、反射波の受信直前に送信された超音波よりも前に送信された超音波が遠距離障害物によって反射したものである場合とが考えられる。前者の場合、反射波を受信するタイミングは、反射波の受信直前に行われる超音波の送信のタイミングによって決まり、後者の場合、反射波を受信するタイミングは、反射波の受信直前の超音波の送信よりも前に行われる超音波の送信のタイミングによって決まる。このため、超音波の送信間隔を第1送信間隔と第2送信間隔とで異ならせると、判定用時間は前者の場合と後者の場合とで異なる。よって、判定用時間と閾値とを比較することで、その比較結果から検出した障害物が近距離障害物であるか遠距離障害物であるかを判定できる。 The reflected waves received by the ultrasonic sensor include the case where the ultrasonic waves transmitted immediately before the reception of the reflected waves are reflected by a short-range obstacle and the ultrasonic waves transmitted immediately before the reception of the reflected waves. It is considered that the ultrasonic waves transmitted to the above are reflected by a long-distance obstacle. In the former case, the timing of receiving the reflected wave is determined by the timing of transmitting the ultrasonic wave immediately before the reception of the reflected wave, and in the latter case, the timing of receiving the reflected wave is determined by the timing of the ultrasonic wave immediately before the reception of the reflected wave. It depends on the timing of ultrasonic transmission that occurs before transmission. Therefore, if the ultrasonic wave transmission interval is different between the first transmission interval and the second transmission interval, the determination time differs between the former case and the latter case. Therefore, by comparing the determination time with the threshold value, it is possible to determine whether the obstacle detected from the comparison result is a short-distance obstacle or a long-distance obstacle.

また、上記障害物検出装置について、前記検出用反射波の受信時間は、前記検出用反射波の受信時刻と前記検出用反射波の受信直前に行われた超音波の送信時刻との差であり、前記判定用反射波の受信時間は、前記判定用反射波の受信時刻と前記判定用反射波の受信直前に行われた超音波の送信時刻との差である。 Further, with respect to the obstacle detection device, the reception time of the detection reflected wave is the difference between the reception time of the detection reflected wave and the ultrasonic transmission time performed immediately before the reception of the detection reflected wave. The reception time of the determination reflected wave is the difference between the reception time of the determination reflected wave and the transmission time of the ultrasonic wave performed immediately before the reception of the determination reflected wave.

また、上記障害物検出装置について、前記障害物検出装置が搭載される移動体の速度に応じて前記閾値を変更させるのが好ましい。
反射波の受信時間は、障害物から超音波センサまでの距離に応じて決まる。このため、障害物検出装置が搭載された移動体が移動しながら障害物を検出する場合、障害物から超音波センサまでの距離が変化するため、反射波の受信時間が変化し、更には判定用時間が変化することがある。よって、移動体の速度に応じて閾値を変更することで、移動体の移動中であっても検出した障害物が近距離障害物であるか遠距離障害物であるかを判定できる。
Further, it is preferable to change the threshold value of the obstacle detection device according to the speed of the moving body on which the obstacle detection device is mounted.
The reception time of the reflected wave depends on the distance from the obstacle to the ultrasonic sensor. Therefore, when a moving body equipped with an obstacle detection device detects an obstacle while moving, the distance from the obstacle to the ultrasonic sensor changes, so that the reception time of the reflected wave changes, and further, the determination is made. Usage time may change. Therefore, by changing the threshold value according to the speed of the moving body, it is possible to determine whether the detected obstacle is a short-distance obstacle or a long-distance obstacle even while the moving body is moving.

上記問題点を解決するための障害物検出方法は、超音波を送信し、障害物によって反射された反射波を受信する超音波センサによる反射波の受信結果から前記障害物を検出する障害物検出方法であって、第1送信間隔で前記超音波センサから超音波を送信するステップと、前記超音波センサが前記反射波を受信した場合に、前記第1送信間隔とは異なる第2送信間隔で前記超音波センサから超音波を送信するステップと、前記障害物の検出に用いられた反射波である検出用反射波の受信時間を取得するステップと、前記検出用反射波よりも後に受信された反射波である判定用反射波の受信時間を取得するステップと、前記検出用反射波の受信時間と前記判定用反射波の受信時間との差である判定用時間を算出するステップと、前記判定用時間と閾値との比較結果に基づいて前記障害物が近距離障害物であるか遠距離障害物であるかを判定するステップと、を備えることを要旨とする。 The obstacle detection method for solving the above-mentioned problems is an obstacle detection method in which the obstacle is detected from the reception result of the reflected wave by the ultrasonic sensor that transmits ultrasonic waves and receives the reflected wave reflected by the obstacle. The method is a step of transmitting ultrasonic waves from the ultrasonic sensor at the first transmission interval and a second transmission interval different from the first transmission interval when the ultrasonic sensor receives the reflected wave. The step of transmitting ultrasonic waves from the ultrasonic sensor, the step of acquiring the reception time of the detected reflected wave which is the reflected wave used for detecting the obstacle, and the step of receiving the reflected wave after the detection reflected wave. The step of acquiring the reception time of the reflected wave for determination which is the reflected wave, the step of calculating the determination time which is the difference between the reception time of the reflected wave for detection and the reception time of the reflected wave for determination, and the determination. The gist is to include a step of determining whether the obstacle is a short-range obstacle or a long-range obstacle based on the comparison result between the usage time and the threshold value.

超音波センサが受信する反射波としては、反射波の受信直前に送信された超音波が近距離障害物によって反射したものである場合と、反射波の受信直前に送信された超音波よりも前に送信された超音波が遠距離障害物によって反射したものである場合とが考えられる。前者の場合、反射波を受信するタイミングは、反射波の受信直前に行われる超音波の送信のタイミングによって決まり、後者の場合、反射波を受信するタイミングは、反射波の受信直前の超音波の送信よりも前に行われる超音波の送信のタイミングによって決まる。このため、超音波の送信間隔を第1送信間隔と第2送信間隔とで異ならせると、判定用時間は前者の場合と後者の場合とで異なる。よって、判定用時間と閾値とを比較することで、その比較結果から検出した障害物が近距離障害物であるか遠距離障害物であるかを判定できる。 The reflected waves received by the ultrasonic sensor include the case where the ultrasonic waves transmitted immediately before the reception of the reflected waves are reflected by a short-range obstacle and the ultrasonic waves transmitted immediately before the reception of the reflected waves. It is considered that the ultrasonic waves transmitted to the above are reflected by a long-distance obstacle. In the former case, the timing of receiving the reflected wave is determined by the timing of transmitting the ultrasonic wave immediately before the reception of the reflected wave, and in the latter case, the timing of receiving the reflected wave is determined by the timing of the ultrasonic wave immediately before the reception of the reflected wave. It depends on the timing of ultrasonic transmission that occurs before transmission. Therefore, if the ultrasonic wave transmission interval is different between the first transmission interval and the second transmission interval, the determination time differs between the former case and the latter case. Therefore, by comparing the determination time with the threshold value, it is possible to determine whether the obstacle detected from the comparison result is a short-distance obstacle or a long-distance obstacle.

本発明によれば、検出した障害物が近距離障害物か遠距離障害物かを判定できる。 According to the present invention, it is possible to determine whether the detected obstacle is a short-distance obstacle or a long-distance obstacle.

障害物検出装置が搭載されるフォークリフトの概略側面図。Schematic side view of a forklift equipped with an obstacle detection device. フォークリフトの構成を示すブロック図。The block diagram which shows the structure of a forklift. 障害物検出装置の構成を示すブロック図。The block diagram which shows the structure of the obstacle detection apparatus. 障害物の検出範囲を示す概略図。The schematic diagram which shows the detection range of an obstacle. 障害物検出方法を示すフローチャート。A flowchart showing an obstacle detection method. (a)は例1−1における超音波センサ及び障害物の配置を示す概略図、(b)は例1−1における超音波の送受信タイミングを示す図。(A) is a schematic diagram showing the arrangement of the ultrasonic sensor and obstacles in Example 1-1, and (b) is a diagram showing the transmission / reception timing of ultrasonic waves in Example 1-1. (a)は例1−2における超音波センサ及び障害物の配置を示す概略図、(b)は例1−2における超音波の送受信タイミングを示す図。(A) is a schematic view showing the arrangement of the ultrasonic sensor and obstacles in Example 1-2, and (b) is a diagram showing the transmission / reception timing of ultrasonic waves in Example 1-2. (a)は例2−1における超音波センサ及び障害物の配置を示す概略図、(b)は例2−1における超音波の送受信タイミングを示す図。(A) is a schematic diagram showing the arrangement of the ultrasonic sensor and obstacles in Example 2-1 and (b) is a diagram showing the transmission / reception timing of ultrasonic waves in Example 2-1. (a)は例2−2における超音波センサ及び障害物の配置を示す概略図、(b)は例2−2における超音波の送受信タイミングを示す図。(A) is a schematic diagram showing the arrangement of the ultrasonic sensor and obstacles in Example 2-2, and (b) is a diagram showing the transmission / reception timing of ultrasonic waves in Example 2-2. (a),(b)は別例における超音波の送受信タイミングを示す図。(A) and (b) are diagrams showing the transmission / reception timing of ultrasonic waves in another example. (a),(b)は別例における超音波の送受信タイミングを示す図。(A) and (b) are diagrams showing the transmission / reception timing of ultrasonic waves in another example. (a)は超音波の送受信タイミングを示す図、(b),(c)は超音波センサ及び障害物の配置を示す概略図。(A) is a diagram showing the transmission / reception timing of ultrasonic waves, and (b) and (c) are schematic views showing the arrangement of ultrasonic sensors and obstacles.

(第1実施形態)
以下、障害物検出装置及び障害物検出方法を具体化した第1実施形態を図1〜図7にしたがって説明する。
(First Embodiment)
Hereinafter, the first embodiment in which the obstacle detection device and the obstacle detection method are embodied will be described with reference to FIGS. 1 to 7.

図1に示すように、移動体としてのフォークリフト10は、車体11と、車体11の前方に設けられた荷役装置12と、車体11の後方に設けられたカウンタウェイト13とを備える。なお、本実施形態のフォークリフト10は、搭乗者による運転が行われるフォークリフトである。 As shown in FIG. 1, the forklift 10 as a moving body includes a vehicle body 11, a cargo handling device 12 provided in front of the vehicle body 11, and a counterweight 13 provided behind the vehicle body 11. The forklift 10 of the present embodiment is a forklift that is operated by a passenger.

図2に示すように、フォークリフト10は、メインコントローラ17と、荷役装置12を動作させる荷役機構14と、フォークリフト10を走行させる駆動機構15と、フォークリフト10の起動状態と停止状態とを切り替えるキースイッチ16とを備える。 As shown in FIG. 2, the forklift 10 is a key switch that switches between a main controller 17, a cargo handling mechanism 14 that operates a cargo handling device 12, a drive mechanism 15 that runs the forklift 10, and a start state and a stop state of the forklift 10. It is provided with 16.

メインコントローラ17は、CPU18及びメモリ19を備える。メモリ19には、フォークリフト10を動作させるためのプログラム等が記憶されている。メインコントローラ17は、キースイッチ16によりフォークリフト10が起動状態にされている場合、駆動機構15や荷役機構14を制御することで荷役動作や走行動作をフォークリフト10に行わせる。一方で、メインコントローラ17は、キースイッチ16によりフォークリフト10が停止状態にされている場合、荷役動作や走行動作をフォークリフト10に行わせない。 The main controller 17 includes a CPU 18 and a memory 19. A program or the like for operating the forklift 10 is stored in the memory 19. When the forklift 10 is activated by the key switch 16, the main controller 17 controls the drive mechanism 15 and the cargo handling mechanism 14 to cause the forklift 10 to perform cargo handling operations and traveling operations. On the other hand, when the forklift 10 is stopped by the key switch 16, the main controller 17 does not allow the forklift 10 to perform a cargo handling operation or a traveling operation.

フォークリフト10には、超音波によって障害物を検出する障害物検出装置20が搭載されている。障害物検出装置20は、超音波センサ21を備える。超音波センサ21は、超音波の送信と受信の両方を1つの素子で行う送受信兼用型である。 The forklift 10 is equipped with an obstacle detection device 20 that detects obstacles by ultrasonic waves. The obstacle detection device 20 includes an ultrasonic sensor 21. The ultrasonic sensor 21 is a transmission / reception type that performs both transmission and reception of ultrasonic waves with one element.

超音波センサ21は、図示しない圧電振動子を備える。圧電振動子は、電気信号を振動に変換可能であるとともに、振動を電気信号に変換可能である。圧電振動子は、後述する送信指令部31から送信信号が入力されることにより振動する。圧電振動子が振動することにより、超音波センサ21から超音波が送信される。超音波の送信方向の先に障害物がある場合、超音波は障害物に当たって反射する反射波となる。圧電振動子は、反射波を受けると振動し、反射波を受信した旨の受信信号を後述する検出部32に出力する。つまり、超音波センサ21は、超音波を送信する送信機能と、反射波を受信する受信機能とを有する。本実施形態の超音波センサ21では、受信信号を検出部32に送信するか否かを判定するための反射波の受信強度の閾値は一定の値に設定されている。また、本実施形態の圧電振動子は送受信兼用型であるため、超音波センサ21が超音波を送信している間、反射波を受信することはできない。さらに、本実施形態の障害物検出装置20が備える超音波センサ21の数は「1」であるため、超音波の送信及び反射波の受信は、同一の超音波センサ21によって行われる。 The ultrasonic sensor 21 includes a piezoelectric vibrator (not shown). The piezoelectric vibrator can convert an electric signal into a vibration and can also convert a vibration into an electric signal. The piezoelectric vibrator vibrates when a transmission signal is input from the transmission command unit 31, which will be described later. When the piezoelectric vibrator vibrates, ultrasonic waves are transmitted from the ultrasonic sensor 21. When there is an obstacle ahead of the transmission direction of the ultrasonic wave, the ultrasonic wave becomes a reflected wave that hits the obstacle and is reflected. The piezoelectric vibrator vibrates when it receives the reflected wave, and outputs a received signal indicating that the reflected wave has been received to the detection unit 32 described later. That is, the ultrasonic sensor 21 has a transmission function for transmitting ultrasonic waves and a reception function for receiving reflected waves. In the ultrasonic sensor 21 of the present embodiment, the threshold value of the reception intensity of the reflected wave for determining whether or not to transmit the received signal to the detection unit 32 is set to a constant value. Further, since the piezoelectric vibrator of the present embodiment is a transmission / reception type, the reflected wave cannot be received while the ultrasonic sensor 21 transmits ultrasonic waves. Further, since the number of ultrasonic sensors 21 included in the obstacle detection device 20 of the present embodiment is "1", the transmission of ultrasonic waves and the reception of reflected waves are performed by the same ultrasonic sensors 21.

図1及び図4に示すように、超音波センサ21は、カウンタウェイト13に取り付けられ、車体11の後方に超音波を送信する。よって、障害物検出装置20により検出される障害物は、フォークリフト10の後方に存在する障害物である。本実施形態の障害物検出装置20では、フォークリフト10の後方3.0m以内の範囲内にある障害物を検出することを目的としている。よって、本実施形態での障害物検出装置20による検出対象範囲A(図4参照)は、実際に障害物を検出したい範囲に対して余裕をもたせた範囲として、超音波センサ21からフォークリフト10の後方3.4m以内の範囲に設定されている。以下、検出対象範囲A内にある障害物を近距離障害物とし、検出対象範囲A外にある障害物を遠距離障害物とする。 As shown in FIGS. 1 and 4, the ultrasonic sensor 21 is attached to the counterweight 13 and transmits ultrasonic waves to the rear of the vehicle body 11. Therefore, the obstacle detected by the obstacle detection device 20 is an obstacle existing behind the forklift 10. The obstacle detection device 20 of the present embodiment aims to detect an obstacle within a range of 3.0 m behind the forklift 10. Therefore, the detection target range A (see FIG. 4) by the obstacle detection device 20 in the present embodiment is defined as a range having a margin with respect to the range in which the obstacle is actually detected, from the ultrasonic sensor 21 to the forklift 10. It is set within a range of 3.4 m behind. Hereinafter, an obstacle within the detection target range A will be referred to as a short-distance obstacle, and an obstacle outside the detection target range A will be referred to as a long-distance obstacle.

図3に示すように、障害物検出装置20は、制御ECU30を備える。制御ECU30は、CPUと、RAM及びROM等からなる記憶部とを備える電子制御ユニット:Electronic Control Unitである。記憶部には、障害物検出装置20を制御するための種々のプログラムが記憶されている。制御ECU30は、各種処理のうち少なくとも一部の処理を実行する専用のハードウェア、例えば、特定用途向け集積回路:ASICを備えていてもよい。制御ECU30は、コンピュータプログラムに従って動作する1つ以上のプロセッサ、ASIC等の1つ以上の専用のハードウェア回路、あるいは、それらの組み合わせを含む回路として構成し得る。プロセッサは、CPU、並びにRAM及びROM等のメモリを含む。メモリは、処理をCPUに実行させるように構成されたプログラムコードまたは指令を格納している。メモリ、すなわちコンピュータ可読媒体は、汎用または専用のコンピュータでアクセスできるあらゆるものを含む。制御ECU30は、メインコントローラ17と相互に通信可能に接続されている。なお、本実施形態では、制御ECU30はメインコントローラ17とは別体で形成されている。 As shown in FIG. 3, the obstacle detection device 20 includes a control ECU 30. The control ECU 30 is an electronic control unit: an electronic control unit including a CPU and a storage unit including a RAM and a ROM. Various programs for controlling the obstacle detection device 20 are stored in the storage unit. The control ECU 30 may be provided with dedicated hardware that executes at least a part of various processes, for example, an integrated circuit for a specific application: ASIC. The control ECU 30 may be configured as one or more processors operating according to a computer program, one or more dedicated hardware circuits such as an ASIC, or a circuit including a combination thereof. The processor includes a CPU and a memory such as RAM and ROM. The memory stores a program code or a command configured to cause the CPU to execute the process. Memory, or computer-readable medium, includes anything that can be accessed by a general purpose or dedicated computer. The control ECU 30 is connected to the main controller 17 so as to be able to communicate with each other. In this embodiment, the control ECU 30 is formed separately from the main controller 17.

制御ECU30は、超音波センサ21に接続された送信指令部31を備える。送信指令部31は、超音波センサ21に送信信号を出力することで超音波センサ21に超音波を送信させる。送信指令部31は、キースイッチ16によりフォークリフト10が起動状態にされている間、繰り返し送信信号を出力する。超音波センサ21は、送信指令部31からの送信信号が入力される度に超音波を送信する。よって、送信指令部31による送信信号の出力間隔は、超音波センサ21による超音波の送信間隔と同じになる。 The control ECU 30 includes a transmission command unit 31 connected to the ultrasonic sensor 21. The transmission command unit 31 outputs a transmission signal to the ultrasonic sensor 21 to cause the ultrasonic sensor 21 to transmit ultrasonic waves. The transmission command unit 31 repeatedly outputs a transmission signal while the forklift 10 is activated by the key switch 16. The ultrasonic sensor 21 transmits ultrasonic waves each time a transmission signal from the transmission command unit 31 is input. Therefore, the output interval of the transmission signal by the transmission command unit 31 is the same as the transmission interval of the ultrasonic waves by the ultrasonic sensor 21.

制御ECU30は、超音波センサ21に接続された検出部32を備える。超音波センサ21が反射波を受信した場合、検出部32には超音波センサ21から受信信号が入力される。検出部32は、超音波センサ21による反射波の受信結果から障害物の有無を検出する。検出部32は、超音波センサ21から反射波の受信信号が入力されることにより、フォークリフト10の後方に障害物があることを検出する。 The control ECU 30 includes a detection unit 32 connected to the ultrasonic sensor 21. When the ultrasonic sensor 21 receives the reflected wave, the received signal is input from the ultrasonic sensor 21 to the detection unit 32. The detection unit 32 detects the presence or absence of an obstacle from the reception result of the reflected wave by the ultrasonic sensor 21. The detection unit 32 detects that there is an obstacle behind the forklift 10 by inputting a received signal of the reflected wave from the ultrasonic sensor 21.

制御ECU30は、送信指令部31及び検出部32に接続された測定部33と、測定部33に接続された判定部34とを備える。測定部33は、超音波の送信から反射波の受信までに要する時間(以下、反射波の受信時間という)を測定する。判定部34は、検出した障害物が近距離障害物であるか、遠距離障害物であるかを判定する。また、判定部34は、判定結果をメインコントローラ17に出力する。メインコントローラ17は、障害物が近距離障害物であると判定された場合、走行動作をフォークリフト10に行わせない。メインコントローラ17は、障害物が遠距離障害物であると判定された場合、走行動作をフォークリフト10に行わせる。 The control ECU 30 includes a measurement unit 33 connected to the transmission command unit 31 and the detection unit 32, and a determination unit 34 connected to the measurement unit 33. The measuring unit 33 measures the time required from the transmission of the ultrasonic wave to the reception of the reflected wave (hereinafter, referred to as the reception time of the reflected wave). The determination unit 34 determines whether the detected obstacle is a short-distance obstacle or a long-distance obstacle. Further, the determination unit 34 outputs the determination result to the main controller 17. When the main controller 17 determines that the obstacle is a short-distance obstacle, the main controller 17 does not cause the forklift 10 to perform a traveling operation. When the main controller 17 determines that the obstacle is a long-distance obstacle, the main controller 17 causes the forklift 10 to perform a traveling operation.

障害物検出装置20は、障害物の有無を検出し、検出部32が障害物を検出した場合には検出した障害物が近距離障害物であるか遠距離障害物であるかを判定する。障害物検出装置20は、初期状態では障害物の有無を検出するようになっており、障害物が近距離障害物であるか遠距離障害物であるかを判定部34が判定し終えると障害物の有無の検出を再開する。障害物検出装置20が障害物の有無を検出するときには、送信指令部31は、第1送信間隔Taで超音波センサ21に超音波を送信させる。また、障害物検出装置20が検出した障害物が近距離障害物であるか遠距離障害物であるかを判定するときには、送信指令部31は、第2送信間隔Tbで超音波センサ21に超音波を送信させる。後述するが、第1送信間隔Taは、障害物の検出対象範囲Aに基づいて設定され、第2送信間隔Tbは、第1送信間隔Taと異なるように設定される。 The obstacle detection device 20 detects the presence or absence of an obstacle, and when the detection unit 32 detects an obstacle, determines whether the detected obstacle is a short-distance obstacle or a long-distance obstacle. The obstacle detection device 20 is designed to detect the presence or absence of an obstacle in the initial state, and when the determination unit 34 finishes determining whether the obstacle is a short-distance obstacle or a long-distance obstacle, the obstacle is detected. Resume detection of the presence or absence of objects. When the obstacle detection device 20 detects the presence or absence of an obstacle, the transmission command unit 31 causes the ultrasonic sensor 21 to transmit ultrasonic waves at the first transmission interval Ta. Further, when determining whether the obstacle detected by the obstacle detection device 20 is a short-distance obstacle or a long-distance obstacle, the transmission command unit 31 superimposes on the ultrasonic sensor 21 at the second transmission interval Tb. Send ultrasonic waves. As will be described later, the first transmission interval Ta is set based on the obstacle detection target range A, and the second transmission interval Tb is set to be different from the first transmission interval Ta.

図4に示すように、超音波センサ21から障害物Xまでの距離L[m]は、音速V[m/sec]と反射波の受信時間t[sec]から、L=V×t/2で表される。よって、超音波センサ21から障害物Xまでの距離L[m]が長くなるほど、反射波の受信時間t[sec]も長くなる。上述したように、本実施形態では、超音波センサ21からフォークリフト10の後方3.4m以内の範囲が、障害物検出装置20による検出対象範囲Aに設定されている。このため、例えば、音速Vを340[m/sec]とすると、超音波センサ21が超音波を送信してから約20ms後までに反射波を受信しない場合、検出対象範囲A内には近距離障害物が存在しないといえる。 As shown in FIG. 4, the distance L [m] from the ultrasonic sensor 21 to the obstacle X is L = V × t / 2 from the speed of sound V [m / sec] and the reception time t [sec] of the reflected wave. It is represented by. Therefore, the longer the distance L [m] from the ultrasonic sensor 21 to the obstacle X, the longer the reception time t [sec] of the reflected wave. As described above, in the present embodiment, the range within 3.4 m behind the forklift 10 from the ultrasonic sensor 21 is set as the detection target range A by the obstacle detection device 20. Therefore, for example, when the sound velocity V is 340 [m / sec], if the ultrasonic sensor 21 does not receive the reflected wave within about 20 ms after transmitting the ultrasonic wave, it is within the detection target range A at a short distance. It can be said that there are no obstacles.

検出対象範囲Aは、フォークリフト10の走行動作に対する障害物を検出するために便宜上設定された範囲である。超音波センサ21から送信される超音波は、実際には検出対象範囲Aであるフォークリフト10の後方3.4mよりも更に後方まで到達する。本実施形態の超音波センサ21から送信される超音波は、フォークリフト10の後方10.0mまで到達するものとする。よって、超音波センサ21からフォークリフト10の後方10.0m以内の範囲は、障害物検出装置20による検出可能範囲B(図4参照)である。超音波は、検出対象範囲A内にある近距離障害物に当たることによって反射するだけでなく、検出対象範囲A外かつ検出可能範囲B内にある遠距離障害物に当たることによっても反射する。超音波センサ21は、検出対象範囲A内外に関わらず障害物によって反射した反射波を受信する。よって、超音波センサ21は、超音波を送信してから約20〜58.8ms経過するまでの間に、検出対象範囲A外にある遠距離障害物によって反射した反射波を受信する可能性がある。 The detection target range A is a range set for convenience in order to detect an obstacle to the traveling operation of the forklift 10. The ultrasonic waves transmitted from the ultrasonic sensor 21 actually reach further behind the forklift 10 which is the detection target range A, 3.4 m behind. The ultrasonic waves transmitted from the ultrasonic sensor 21 of the present embodiment shall reach 10.0 m behind the forklift 10. Therefore, the range within 10.0 m behind the forklift 10 from the ultrasonic sensor 21 is the detectable range B (see FIG. 4) by the obstacle detection device 20. The ultrasonic wave is reflected not only by hitting a short-distance obstacle within the detection target range A, but also by hitting a long-distance obstacle outside the detection target range A and within the detectable range B. The ultrasonic sensor 21 receives the reflected wave reflected by the obstacle regardless of whether it is inside or outside the detection target range A. Therefore, the ultrasonic sensor 21 may receive the reflected wave reflected by a long-distance obstacle outside the detection target range A between about 20 to 58.8 ms after transmitting the ultrasonic wave. is there.

これを踏まえ、超音波の送信間隔を例えば60msに設定することも考えられるが、送信した超音波が障害物に当たって反射することを利用して検出を行う性質上、超音波の送信間隔を長くするほど障害物の検出に要する時間も長くなる。逆にいえば、超音波の送信間隔を短くするほど障害物の検出に要する時間も短くなり、障害物の有無を早期に検出できる。本実施形態では、検出対象範囲A内にある近距離障害物を検出可能としつつ、障害物を早期に検出するために第1送信間隔Taを20msに設定している。障害物が近距離障害物である場合、反射波の受信時間は第1送信間隔Ta:20ms以下になり、障害物が遠距離障害物である場合、反射波の受信時間は第1送信間隔Ta:20msよりも長くなる。障害物検出装置20が障害物の有無を検出するとき、送信指令部31は、20ms毎に送信信号を超音波センサ21に出力し、超音波センサ21は、20ms毎に超音波を送信する。 Based on this, it is conceivable to set the ultrasonic wave transmission interval to, for example, 60 ms, but due to the nature of detecting by utilizing the fact that the transmitted ultrasonic wave hits an obstacle and is reflected, the ultrasonic wave transmission interval is lengthened. The longer it takes to detect an obstacle. Conversely, the shorter the ultrasonic transmission interval, the shorter the time required to detect an obstacle, and the presence or absence of an obstacle can be detected at an early stage. In the present embodiment, the first transmission interval Ta is set to 20 ms in order to detect an obstacle at an early stage while enabling detection of a short-distance obstacle within the detection target range A. When the obstacle is a short-distance obstacle, the reception time of the reflected wave is the first transmission interval Ta: 20 ms or less, and when the obstacle is a long-distance obstacle, the reception time of the reflected wave is the first transmission interval Ta: Ta. : Longer than 20 ms. When the obstacle detection device 20 detects the presence or absence of an obstacle, the transmission command unit 31 outputs a transmission signal to the ultrasonic sensor 21 every 20 ms, and the ultrasonic sensor 21 transmits ultrasonic waves every 20 ms.

次に、障害物検出方法について説明する。
キースイッチ16によりフォークリフト10が起動状態にされることにより、障害物検出装置20の運転が開始される。障害物検出装置20は、まず、障害物の有無を検出する。
Next, an obstacle detection method will be described.
When the forklift 10 is activated by the key switch 16, the operation of the obstacle detection device 20 is started. The obstacle detection device 20 first detects the presence or absence of an obstacle.

具体的には、図5に示すように、超音波センサ21から第1送信間隔Taで超音波を送信する(ステップS10)。超音波センサ21が反射波を受信しなかった場合(ステップS11でNO)、検出部32は、フォークリフト10の後方における検出可能範囲B内に障害物が無いことを検出する(ステップS12)。超音波センサ21が反射波を受信した場合(ステップS11でYES)、検出部32は、フォークリフト10の後方における検出可能範囲B内に障害物があることを検出する(ステップS13)。ステップS11において超音波センサ21が受信した反射波を検出用反射波とする。検出用反射波は、障害物の検出に用いられた反射波である。 Specifically, as shown in FIG. 5, ultrasonic waves are transmitted from the ultrasonic sensor 21 at the first transmission interval Ta (step S10). When the ultrasonic sensor 21 does not receive the reflected wave (NO in step S11), the detection unit 32 detects that there is no obstacle in the detectable range B behind the forklift 10 (step S12). When the ultrasonic sensor 21 receives the reflected wave (YES in step S11), the detection unit 32 detects that there is an obstacle in the detectable range B behind the forklift 10 (step S13). The reflected wave received by the ultrasonic sensor 21 in step S11 is used as the detected reflected wave. The detection reflected wave is a reflected wave used for detecting an obstacle.

次に、障害物検出装置20は、検出した障害物が近距離障害物であるか遠距離障害物であるかを判定する。
具体的には、測定部33は、第1検出時間Tcを測定する。第1検出時間Tcとは、検出用反射波の受信時刻と、検出用反射波の受信直前に行われた超音波の送信時刻との差である。言い換えると、超音波センサ21が検出用反射波を受信した時刻から、検出用反射波の受信直前に超音波センサ21が超音波を送信した時刻まで遡るのに要する時間である。測定部33は、測定した第1検出時間Tcを送信指令部31及び判定部34に送信する。送信指令部31は、第1送信間隔Ta及び第1検出時間Tcに基づいて第2送信間隔Tbを設定する。第2送信間隔Tbは、第1送信間隔Taと異なり、かつ第1送信間隔Taと第1検出時間Tcとの和であるTa+Tcと異なるように設定される。
Next, the obstacle detection device 20 determines whether the detected obstacle is a short-distance obstacle or a long-distance obstacle.
Specifically, the measuring unit 33 measures the first detection time Tc. The first detection time Tc is the difference between the reception time of the reflected reflected wave for detection and the transmission time of the ultrasonic wave performed immediately before the reception of the reflected reflected wave for detection. In other words, it is the time required to go back from the time when the ultrasonic sensor 21 receives the reflected wave for detection to the time when the ultrasonic sensor 21 transmits the ultrasonic wave immediately before receiving the reflected wave for detection. The measuring unit 33 transmits the measured first detection time Tc to the transmission command unit 31 and the determination unit 34. The transmission command unit 31 sets the second transmission interval Tb based on the first transmission interval Ta and the first detection time Tc. The second transmission interval Tb is set to be different from the first transmission interval Ta and different from Ta + Tc, which is the sum of the first transmission interval Ta and the first detection time Tc.

超音波センサ21から第2送信間隔Tbで超音波を2回送信する(ステップS14)。第2送信間隔Tbで送信された超音波は、障害物に当たって反射する。このため、超音波センサ21は、第2送信間隔Tbで送信された超音波の反射波を受信する。検出用反射波よりも後に超音波センサ21によって受信される反射波を判定用反射波とする。また、判定用反射波のうち、検出用反射波の受信後初めて受信される反射波を第1判定用反射波とし、第1判定用反射波の受信後に受信される反射波を第2判定用反射波とする。 Ultrasonic waves are transmitted twice from the ultrasonic sensor 21 at the second transmission interval Tb (step S14). The ultrasonic waves transmitted at the second transmission interval Tb hit an obstacle and are reflected. Therefore, the ultrasonic sensor 21 receives the reflected wave of the ultrasonic wave transmitted at the second transmission interval Tb. The reflected wave received by the ultrasonic sensor 21 after the detected reflected wave is defined as the determination reflected wave. Further, among the reflected waves for determination, the reflected wave received for the first time after receiving the reflected wave for detection is used as the reflected wave for first determination, and the reflected wave received after receiving the reflected wave for first determination is used for the second determination. Let it be a reflected wave.

測定部33は、第2検出時間Td及び第3検出時間Teを測定する。第2検出時間Tdとは、第1判定用反射波の受信時刻と、第1判定用反射波の受信直前に行われた超音波の送信時刻との差である。言い換えると、第2検出時間Tdは、超音波センサ21が第1判定用反射波を受信した時刻から、第1判定用反射波の受信直前に超音波センサ21が超音波を送信した時刻まで遡るのに要する時間である。第3検出時間Teとは、第2判定用反射波の受信時刻と、第2判定用反射波の受信直前に行われた超音波の送信時刻との差である。言い換えると、第3検出時間Teは、超音波センサ21が第2判定用反射波を受信した時刻から、第2判定用反射波の受信直前に超音波センサ21が超音波を送信した時刻まで遡るのに要する時間である。測定部33は、測定した第2検出時間Td及び第3検出時間Teを判定部34に出力する。 The measuring unit 33 measures the second detection time Td and the third detection time Te. The second detection time Td is the difference between the reception time of the reflected wave for first determination and the transmission time of ultrasonic waves performed immediately before the reception of the reflected wave for first determination. In other words, the second detection time Td goes back from the time when the ultrasonic sensor 21 receives the first determination reflected wave to the time when the ultrasonic sensor 21 transmits the ultrasonic wave immediately before the reception of the first determination reflected wave. It is the time required for. The third detection time Te is the difference between the reception time of the reflected wave for the second determination and the transmission time of the ultrasonic wave performed immediately before the reception of the reflected wave for the second determination. In other words, the third detection time Te goes back from the time when the ultrasonic sensor 21 receives the reflected wave for the second determination to the time when the ultrasonic sensor 21 transmits the ultrasonic wave immediately before the reception of the reflected wave for the second determination. It is the time required for. The measuring unit 33 outputs the measured second detection time Td and third detection time Te to the determination unit 34.

判定部34は、検出用反射波の受信時間である第1受信時間T1と、第1判定用反射波の受信時間である第2受信時間T2と、第2判定用反射波の受信時間である第3受信時間T3とを取得する(ステップS15)。本実施形態では、判定部34は、測定部33から入力された第1検出時間Tcを第1受信時間T1として取得する。判定部34は、測定部33から入力された第2検出時間Tdを第2受信時間T2として取得する。判定部34は、測定部33から入力された第3検出時間Teを第3受信時間T3として取得する。 The determination unit 34 is a first reception time T1 which is a reception time of the reflected wave for detection, a second reception time T2 which is a reception time of the reflected wave for the first determination, and a reception time of the reflected wave for the second determination. Acquire the third reception time T3 (step S15). In the present embodiment, the determination unit 34 acquires the first detection time Tc input from the measurement unit 33 as the first reception time T1. The determination unit 34 acquires the second detection time Td input from the measurement unit 33 as the second reception time T2. The determination unit 34 acquires the third detection time Te input from the measurement unit 33 as the third reception time T3.

判定部34は、判定用時間としての第1判定用時間ΔT1及び第2判定用時間ΔT2を算出する(ステップS16)。第1判定用時間ΔT1は、第1受信時間T1と第2受信時間T2との差|T1−T2|であり、第2判定用時間ΔT2は、第1受信時間T1と第3受信時間T3との差|T1−T3|である。判定部34は、第1判定用時間ΔT1及び第2判定用時間ΔT2と、予め設定された閾値ΔTxとを比較する(ステップS17)。閾値ΔTxは、判定用時間の算出結果から障害物が近距離障害物であるか遠距離障害物であるかを区別可能にするために予め設定された時間である。第1判定用時間ΔT1及び第2判定用時間ΔT2の両方が閾値ΔTx以下の場合(ステップS17でYES)、判定部34は障害物が近距離障害物であると判定する(ステップS18)。第1判定用時間ΔT1及び第2判定用時間ΔT2の少なくとも一方が閾値ΔTxよりも大きい場合(ステップS17でNO)、判定部34は障害物が遠距離障害物であると判定する(ステップS19)。 The determination unit 34 calculates the first determination time ΔT1 and the second determination time ΔT2 as the determination time (step S16). The first determination time ΔT1 is the difference between the first reception time T1 and the second reception time T2 | T1-T2 |, and the second determination time ΔT2 is the first reception time T1 and the third reception time T3. Difference | T1-T3 | The determination unit 34 compares the first determination time ΔT1 and the second determination time ΔT2 with the preset threshold value ΔTx (step S17). The threshold value ΔTx is a preset time for making it possible to distinguish whether the obstacle is a short-distance obstacle or a long-distance obstacle from the calculation result of the determination time. When both the first determination time ΔT1 and the second determination time ΔT2 are equal to or less than the threshold value ΔTx (YES in step S17), the determination unit 34 determines that the obstacle is a short-distance obstacle (step S18). When at least one of the first determination time ΔT1 and the second determination time ΔT2 is larger than the threshold value ΔTx (NO in step S17), the determination unit 34 determines that the obstacle is a long-distance obstacle (step S19). ..

なお、障害物検出装置20は、キースイッチ16によりフォークリフト10が停止状態にされるまで図5に示すフローを繰り返し行う。すなわち、ステップS12において障害物が無いことを検出した場合、ステップS18において障害物が近距離障害物であると判定した場合、又はステップS19において障害物が遠距離障害物であると判定した場合には、第1送信間隔Taで超音波センサ21から超音波を送信する。 The obstacle detection device 20 repeats the flow shown in FIG. 5 until the forklift 10 is stopped by the key switch 16. That is, when it is detected that there is no obstacle in step S12, when it is determined that the obstacle is a short-distance obstacle in step S18, or when it is determined that the obstacle is a long-distance obstacle in step S19. Transmits ultrasonic waves from the ultrasonic sensor 21 at the first transmission interval Ta.

以下、具体的な障害物の検出例について、例1−1,1−2を用いて詳述する。なお、例1−1,1−2では、障害物の検出が行われている間、フォークリフト10は走行動作せず、停止しているものとする。また、閾値ΔTxは、1msに設定されている。 Hereinafter, specific examples of detecting obstacles will be described in detail with reference to Examples 1-1 and 1-2. In Examples 1-1 and 1-2, it is assumed that the forklift 10 does not run and is stopped while the obstacle is detected. The threshold value ΔTx is set to 1 ms.

例1−1では、図6(a)に示すように、時刻0sにおいてフォークリフト10の後方に存在しなかった障害物X11が時刻20msにおいてフォークリフト10の後方に出現する場合について考える。障害物X11は、検出対象範囲A内である超音波センサ21の後方1.02mに存在する近距離障害物である。なお、障害物X11の形状を簡略化して図示している。また、障害物X11は、時刻20msにおいて出現した後、移動しないものとする。 In Example 1-1, as shown in FIG. 6A, consider a case where an obstacle X11 that did not exist behind the forklift 10 at time 0s appears behind the forklift 10 at time 20ms. The obstacle X11 is a short-distance obstacle existing 1.02 m behind the ultrasonic sensor 21 within the detection target range A. The shape of the obstacle X11 is shown in a simplified manner. Further, it is assumed that the obstacle X11 does not move after appearing at the time of 20 ms.

図6(b)に示すように、超音波センサ21は、第1送信間隔Taで超音波を送信する(ステップS10)。超音波センサ21から第1超音波S1が送信される時刻を0sとする。例1−1では、時刻0sには検出対象範囲A内に障害物X11は存在しないため、第1超音波S1は障害物X11に当たることなく減衰する。よって、超音波センサ21は、時刻0sから20ms経過するまでの間、反射波を受信しない。超音波センサ21は、第1送信間隔Taに従って、第1超音波S1の送信が行われた時刻0sから20ms後の時刻20msにおいて第2超音波S2を送信する。時刻20msでは検出対象範囲A内に障害物X11が存在する。このため、第2超音波S2は障害物X11に当たることにより反射する。超音波センサ21は、第2超音波S2の反射波R2を受信する(ステップS11でYES)。障害物X11は超音波センサ21の後方1.02mに存在するため、第2超音波S2の送信から反射波R2の受信までに要する時間は6msである。よって、超音波センサ21が反射波R2を受信する時刻は、第2超音波S2の送信が行われた時刻20msから6ms後の時刻26msである。検出部32は、フォークリフト10の後方における検出可能範囲B内に障害物X11があることを検出する(ステップS13)。反射波R2は、検出用反射波であり、第2超音波S2は、反射波R2の受信直前に送信された超音波である。 As shown in FIG. 6B, the ultrasonic sensor 21 transmits ultrasonic waves at the first transmission interval Ta (step S10). The time when the first ultrasonic wave S1 is transmitted from the ultrasonic sensor 21 is 0 s. In Example 1-1, since the obstacle X11 does not exist in the detection target range A at time 0s, the first ultrasonic wave S1 is attenuated without hitting the obstacle X11. Therefore, the ultrasonic sensor 21 does not receive the reflected wave from the time 0s to the elapse of 20ms. The ultrasonic sensor 21 transmits the second ultrasonic wave S2 at a time 20 ms 20 ms after the time 0 s when the first ultrasonic wave S1 is transmitted according to the first transmission interval Ta. At time 20 ms, the obstacle X11 exists within the detection target range A. Therefore, the second ultrasonic wave S2 is reflected by hitting the obstacle X11. The ultrasonic sensor 21 receives the reflected wave R2 of the second ultrasonic wave S2 (YES in step S11). Since the obstacle X11 exists 1.02 m behind the ultrasonic sensor 21, the time required from the transmission of the second ultrasonic wave S2 to the reception of the reflected wave R2 is 6 ms. Therefore, the time when the ultrasonic sensor 21 receives the reflected wave R2 is 26 ms after 6 ms from the time when the second ultrasonic wave S2 is transmitted. The detection unit 32 detects that the obstacle X11 is within the detectable range B behind the forklift 10 (step S13). The reflected wave R2 is a reflected wave for detection, and the second ultrasonic wave S2 is an ultrasonic wave transmitted immediately before receiving the reflected wave R2.

例1−2では、図7(a)に示すように、時刻0sにおいてフォークリフト10の後方に障害物X12が存在する場合について考える。障害物X12は、検出対象範囲A外かつ検出可能範囲B内である超音波センサ21の後方4.41mに存在する遠距離障害物である。なお、障害物X12の形状を簡略化して図示している。また、障害物X12は、障害物検出装置20による障害物の検出時、移動しないものとする。 In Example 1-2, as shown in FIG. 7A, consider the case where the obstacle X12 exists behind the forklift 10 at time 0s. The obstacle X12 is a long-distance obstacle existing 4.41 m behind the ultrasonic sensor 21 which is outside the detection target range A and within the detectable range B. The shape of the obstacle X12 is shown in a simplified form. Further, it is assumed that the obstacle X12 does not move when the obstacle detection device 20 detects the obstacle.

図7(b)に示すように、超音波センサ21は、第1送信間隔Taで超音波を送信する(ステップS10)。超音波センサ21から第1超音波S1が送信される時刻を0sとする。例1−2では、時刻0sにおいて検出可能範囲B内に障害物X12が存在する。このため、第1超音波S1は、障害物X12に当たることにより反射する。超音波センサ21は、第1超音波S1の反射波R10を受信する(ステップS11でYES)。障害物X12は超音波センサ21の後方4.41mに存在するため、第1超音波S1の送信から反射波R10の受信までに要する時間は26msである。よって、超音波センサ21が反射波R10を受信する時刻は、第1超音波S1の送信が行われた時刻0sから26ms後の時刻26msである。超音波センサ21は、時刻0sから20ms経過するまでの間に反射波を受信しない。超音波センサ21は、第1送信間隔Taに従って、第1超音波S1の送信が行われた時刻0sから20ms後の時刻20msにおいて第2超音波S2を送信する。検出部32は、フォークリフト10の後方における検出可能範囲B内に障害物X12があることを検出する(ステップS13)。反射波R10は、検出用反射波であり、第2超音波S2は、反射波R10の受信直前に送信された超音波である。 As shown in FIG. 7B, the ultrasonic sensor 21 transmits ultrasonic waves at the first transmission interval Ta (step S10). The time when the first ultrasonic wave S1 is transmitted from the ultrasonic sensor 21 is 0 s. In Example 1-2, the obstacle X12 exists within the detectable range B at time 0s. Therefore, the first ultrasonic wave S1 is reflected by hitting the obstacle X12. The ultrasonic sensor 21 receives the reflected wave R10 of the first ultrasonic wave S1 (YES in step S11). Since the obstacle X12 exists 4.41 m behind the ultrasonic sensor 21, the time required from the transmission of the first ultrasonic wave S1 to the reception of the reflected wave R10 is 26 ms. Therefore, the time when the ultrasonic sensor 21 receives the reflected wave R10 is 26 ms after the time 0 s when the first ultrasonic wave S1 is transmitted. The ultrasonic sensor 21 does not receive the reflected wave between the time 0s and the elapse of 20ms. The ultrasonic sensor 21 transmits the second ultrasonic wave S2 at a time 20 ms 20 ms after the time 0 s when the first ultrasonic wave S1 is transmitted according to the first transmission interval Ta. The detection unit 32 detects that the obstacle X12 is within the detectable range B behind the forklift 10 (step S13). The reflected wave R10 is a reflected wave for detection, and the second ultrasonic wave S2 is an ultrasonic wave transmitted immediately before receiving the reflected wave R10.

例1−1,1−2において、測定部33は、第1検出時間Tcを測定する。第1検出時間Tcは、第2超音波S2の送信から反射波R2,R10の受信に要する時間であり、6msである。測定部33は、測定した第1検出時間Tc:6msを送信指令部31及び判定部34に出力する。送信指令部31は、第2送信間隔Tbを設定する。第1送信間隔Taは20msであり、第1検出時間Tcは6msである。よって、第2送信間隔Tbは、20msと異なり、かつ26msと異なるように設定される。例1−1,1−2において、第2送信間隔Tbは、例えば、22msに設定される。 In Examples 1-1 and 1-2, the measuring unit 33 measures the first detection time Tc. The first detection time Tc is the time required from the transmission of the second ultrasonic wave S2 to the reception of the reflected waves R2 and R10, which is 6 ms. The measuring unit 33 outputs the measured first detection time Tc: 6 ms to the transmission command unit 31 and the determination unit 34. The transmission command unit 31 sets the second transmission interval Tb. The first transmission interval Ta is 20 ms, and the first detection time Tc is 6 ms. Therefore, the second transmission interval Tb is set to be different from 20 ms and different from 26 ms. In Examples 1-1 and 1-2, the second transmission interval Tb is set to, for example, 22 ms.

超音波センサ21は、第2送信間隔Tb:22msで超音波を2回送信する(ステップS14)。すなわち、超音波センサ21は、第2超音波S2の送信が行われた時刻20msから22ms後の時刻42msにおいて第3超音波S3を送信する。また、超音波センサ21は、第3超音波S3の送信が行われた時刻42msから22ms後の時刻64msにおいて第4超音波S4を送信する。 The ultrasonic sensor 21 transmits ultrasonic waves twice at a second transmission interval Tb: 22 ms (step S14). That is, the ultrasonic sensor 21 transmits the third ultrasonic wave S3 at a time 42 ms 22 ms after the time 20 ms when the second ultrasonic wave S2 was transmitted. Further, the ultrasonic sensor 21 transmits the fourth ultrasonic wave S4 at a time 64 ms 22 ms after the time 42 ms when the third ultrasonic wave S3 was transmitted.

例1−1では、第3超音波S3は障害物X11に当たって反射する。超音波センサ21は、第3超音波S3の反射波R3を受信し、検出部32は、フォークリフト10の後方に障害物X11があることを再度検出する。このとき、第3超音波S3の送信から反射波R3の受信までに要する時間は6msである。よって、図6(b)に示すように、超音波センサ21は、第3超音波S3の送信を行った時刻42msから6ms後の時刻48msにおいて反射波R3を受信する。反射波R3は、第1判定用反射波であり、第3超音波S3は、反射波R3の受信直前に送信された超音波である。 In Example 1-1, the third ultrasonic wave S3 hits the obstacle X11 and is reflected. The ultrasonic sensor 21 receives the reflected wave R3 of the third ultrasonic wave S3, and the detection unit 32 again detects that the obstacle X11 is behind the forklift 10. At this time, the time required from the transmission of the third ultrasonic wave S3 to the reception of the reflected wave R3 is 6 ms. Therefore, as shown in FIG. 6B, the ultrasonic sensor 21 receives the reflected wave R3 at a time of 48 ms, which is 6 ms after the time of transmitting the third ultrasonic wave S3, 42 ms. The reflected wave R3 is a reflected wave for the first determination, and the third ultrasonic wave S3 is an ultrasonic wave transmitted immediately before the reception of the reflected wave R3.

第4超音波S4は障害物X11に当たって反射する。超音波センサ21は、第4超音波S4の反射波R4を受信し、検出部32は、フォークリフト10の後方に障害物X11があることを再度検出する。このとき、第4超音波S4の送信から反射波R4の受信までに要する時間は6msである。よって、図6(b)に示すように、超音波センサ21は、第4超音波S4の送信を行った時刻64msから6ms後の時刻70msにおいて反射波R4を受信する。反射波R4は、第2判定用反射波であり、第4超音波S4は、反射波R4の受信直前に送信された超音波である。 The fourth ultrasonic wave S4 hits the obstacle X11 and is reflected. The ultrasonic sensor 21 receives the reflected wave R4 of the fourth ultrasonic wave S4, and the detection unit 32 again detects that the obstacle X11 is behind the forklift 10. At this time, the time required from the transmission of the fourth ultrasonic wave S4 to the reception of the reflected wave R4 is 6 ms. Therefore, as shown in FIG. 6B, the ultrasonic sensor 21 receives the reflected wave R4 at a time of 70 ms 6 ms after the time of transmitting the fourth ultrasonic wave S4. The reflected wave R4 is a reflected wave for the second determination, and the fourth ultrasonic wave S4 is an ultrasonic wave transmitted immediately before the reception of the reflected wave R4.

測定部33は、第2検出時間Td及び第3検出時間Teを測定し、測定した第2検出時間Td及び第3検出時間Teを判定部34に出力する。第2検出時間Tdは、第3超音波S3の送信から反射波R3の受信に要する時間であり、6msである。また、第3検出時間Teは、第4超音波S4の送信から反射波R4の受信に要する時間であり、6msである。判定部34は、第1〜第3受信時間T1〜T3を取得する(ステップS15)。判定部34は、測定部33から入力された第1検出時間Tc:6msを第1受信時間T1として取得する。判定部34は、測定部33から入力された第2検出時間Td:6msを第2受信時間T2として取得する。判定部34は、測定部33から入力された第3検出時間Te:6msを第3受信時間T3として取得する。 The measuring unit 33 measures the second detection time Td and the third detection time Te, and outputs the measured second detection time Td and the third detection time Te to the determination unit 34. The second detection time Td is the time required from the transmission of the third ultrasonic wave S3 to the reception of the reflected wave R3, which is 6 ms. The third detection time Te is the time required from the transmission of the fourth ultrasonic wave S4 to the reception of the reflected wave R4, which is 6 ms. The determination unit 34 acquires the first to third reception times T1 to T3 (step S15). The determination unit 34 acquires the first detection time Tc: 6 ms input from the measurement unit 33 as the first reception time T1. The determination unit 34 acquires the second detection time Td: 6 ms input from the measurement unit 33 as the second reception time T2. The determination unit 34 acquires the third detection time Te: 6 ms input from the measurement unit 33 as the third reception time T3.

例1−2では、第2超音波S2は障害物X12に当たって反射する。超音波センサ21は、第2超音波S2の反射波R20を受信し、検出部32は、フォークリフト10の後方に障害物X12があることを再度検出する。このとき、第2超音波S2の送信から反射波R20の受信までに要する時間は26msである。よって、図7(b)に示すように、超音波センサ21は、第2超音波S2の送信を行った時刻20msから26ms後の時刻46msにおいて反射波R20を受信する。反射波R20は、第1判定用反射波であり、第3超音波S3は、反射波R20の受信直前に送信された超音波である。 In Example 1-2, the second ultrasonic wave S2 hits the obstacle X12 and is reflected. The ultrasonic sensor 21 receives the reflected wave R20 of the second ultrasonic wave S2, and the detection unit 32 again detects that the obstacle X12 is behind the forklift 10. At this time, the time required from the transmission of the second ultrasonic wave S2 to the reception of the reflected wave R20 is 26 ms. Therefore, as shown in FIG. 7B, the ultrasonic sensor 21 receives the reflected wave R20 at a time of 46 ms 26 ms after the time of transmitting the second ultrasonic wave S2. The reflected wave R20 is a reflected wave for the first determination, and the third ultrasonic wave S3 is an ultrasonic wave transmitted immediately before the reception of the reflected wave R20.

第3超音波S3は障害物X12に当たって反射する。超音波センサ21は、第3超音波S3の反射波R30を受信し、検出部32は、フォークリフト10の後方に障害物X12があることを再度検出する。このとき、第3超音波S3の送信から反射波R30の受信までに要する時間は26msである。よって、図7(b)に示すように、超音波センサ21は、第3超音波S3の送信を行った時刻42msから26ms後の時刻68msにおいて反射波R30を受信する。反射波R30は、第2判定用反射波であり、第4超音波S4は、反射波R30の受信直前に送信された超音波である。 The third ultrasonic wave S3 hits the obstacle X12 and is reflected. The ultrasonic sensor 21 receives the reflected wave R30 of the third ultrasonic wave S3, and the detection unit 32 again detects that the obstacle X12 is behind the forklift 10. At this time, the time required from the transmission of the third ultrasonic wave S3 to the reception of the reflected wave R30 is 26 ms. Therefore, as shown in FIG. 7B, the ultrasonic sensor 21 receives the reflected wave R30 at a time of 68 ms 26 ms after the time of transmitting the third ultrasonic wave S3. The reflected wave R30 is a reflected wave for the second determination, and the fourth ultrasonic wave S4 is an ultrasonic wave transmitted immediately before the reception of the reflected wave R30.

測定部33は、第2検出時間Td及び第3検出時間Teを測定し、測定した第2検出時間Td及び第3検出時間Teを判定部34に出力する。第2検出時間Tdは、第3超音波S3の送信から反射波R20の受信に要する時間であり、4msである。また、第3検出時間Teは、第4超音波S4の送信から反射波R30の受信に要する時間であり、4msである。判定部34は、第1〜第3受信時間T1〜T3を取得する(ステップS15)。判定部34は、測定部33から入力された第1検出時間Tc:6msを第1受信時間T1として取得する。判定部34は、測定部33から入力された第2検出時間Td:4msを第2受信時間T2として取得する。判定部34は、測定部33から入力された第3検出時間Te:4msを第3受信時間T3として取得する。 The measuring unit 33 measures the second detection time Td and the third detection time Te, and outputs the measured second detection time Td and the third detection time Te to the determination unit 34. The second detection time Td is the time required from the transmission of the third ultrasonic wave S3 to the reception of the reflected wave R20, which is 4 ms. The third detection time Te is the time required from the transmission of the fourth ultrasonic wave S4 to the reception of the reflected wave R30, which is 4 ms. The determination unit 34 acquires the first to third reception times T1 to T3 (step S15). The determination unit 34 acquires the first detection time Tc: 6 ms input from the measurement unit 33 as the first reception time T1. The determination unit 34 acquires the second detection time Td: 4 ms input from the measurement unit 33 as the second reception time T2. The determination unit 34 acquires the third detection time Te: 4 ms input from the measurement unit 33 as the third reception time T3.

例1−1,1−2において、判定部34は、第1判定用時間ΔT1及び第2判定用時間ΔT2を算出する(ステップS16)。例1−1では、第1判定用時間ΔT1及び第2判定用時間ΔT2はそれぞれ0msとなる。例1−2では、第1判定用時間ΔT1及び第2判定用時間ΔT2はそれぞれ2msとなる。判定部34は、算出した第1判定用時間ΔT1及び第2判定用時間ΔT2と予め設定された閾値ΔTxとを比較する(ステップS17)。 In Examples 1-1 and 1-2, the determination unit 34 calculates the first determination time ΔT1 and the second determination time ΔT2 (step S16). In Example 1-1, the first determination time ΔT1 and the second determination time ΔT2 are 0 ms, respectively. In Example 1-2, the first determination time ΔT1 and the second determination time ΔT2 are 2 ms, respectively. The determination unit 34 compares the calculated first determination time ΔT1 and the second determination time ΔT2 with the preset threshold value ΔTx (step S17).

例1−1では、第1判定用時間ΔT1及び第2判定用時間ΔT2の両方が閾値ΔTx以下である(ステップS17でYES)ため、判定部34は、検出した障害物X11を近距離障害物であると判定する(ステップS18)。一方、例1−2では、第1判定用時間ΔT1及び第2判定用時間ΔT2の両方が閾値ΔTxより大きい(ステップS17でNO)ため、判定部34は、検出した障害物X12を遠距離障害物であると判定する(ステップS19)。 In Example 1-1, since both the first determination time ΔT1 and the second determination time ΔT2 are equal to or less than the threshold value ΔTx (YES in step S17), the determination unit 34 uses the detected obstacle X11 as a short-distance obstacle. (Step S18). On the other hand, in Example 1-2, since both the first determination time ΔT1 and the second determination time ΔT2 are larger than the threshold value ΔTx (NO in step S17), the determination unit 34 makes the detected obstacle X12 a long-distance obstacle. It is determined that it is a thing (step S19).

第1実施形態の作用について説明する。
超音波センサ21が受信する反射波としては、例1−1のように反射波の受信直前に送信された超音波が近距離障害物によって反射したものである場合と、例1−2のように反射波の受信直前に送信された超音波よりも前に送信された超音波が遠距離障害物によって反射したものである場合とが考えられる。
The operation of the first embodiment will be described.
The reflected waves received by the ultrasonic sensor 21 include the case where the ultrasonic waves transmitted immediately before the reception of the reflected waves are reflected by a short-range obstacle as in Example 1-1 and the case where the reflected waves are reflected by a short-range obstacle as in Example 1-2. It is considered that the ultrasonic wave transmitted before the ultrasonic wave transmitted immediately before the reception of the reflected wave is reflected by a long-distance obstacle.

例1−1の場合、反射波の受信のタイミングは、反射波の受信直前に行われる超音波の送信のタイミングによって決まる。このため、超音波の送信間隔を第1送信間隔Taと第2送信間隔Tbとで異ならせたとしても、第1受信時間T1と第2受信時間T2とはほぼ同じになり、第1受信時間T1と第3受信時間T3とはほぼ同じになる。よって、第1判定用時間ΔT1及び第2判定用時間ΔT2は閾値ΔTx以下となる。 In the case of Example 1-1, the timing of receiving the reflected wave is determined by the timing of transmitting the ultrasonic wave immediately before the reception of the reflected wave. Therefore, even if the ultrasonic wave transmission interval is different between the first transmission interval Ta and the second transmission interval Tb, the first reception time T1 and the second reception time T2 are almost the same, and the first reception time T1 and the third reception time T3 are almost the same. Therefore, the first determination time ΔT1 and the second determination time ΔT2 are equal to or less than the threshold value ΔTx.

例1−2の場合、反射波の受信のタイミングは、反射波の受信よりも2回前に行われる超音波の送信のタイミングによって決まる。このため、超音波の送信間隔を第1送信間隔Taと第2送信間隔Tbとで異ならせると、第1受信時間T1と第2受信時間T2とは異なり、第1受信時間T1と第3受信時間T3とは異なる。よって、第1判定用時間ΔT1及び第2判定用時間ΔT2は閾値ΔTxよりも大きくなる。 In the case of Example 1-2, the timing of receiving the reflected wave is determined by the timing of transmitting the ultrasonic wave two times before the reception of the reflected wave. Therefore, if the ultrasonic wave transmission interval is different between the first transmission interval Ta and the second transmission interval Tb, the first reception time T1 and the third reception are different from the first reception time T1 and the second reception time T2. Different from time T3. Therefore, the first determination time ΔT1 and the second determination time ΔT2 are larger than the threshold value ΔTx.

このように、障害物が近距離障害物であるときの第1判定用時間ΔT1及び第2判定用時間ΔT2は、障害物が遠距離障害物であるときの第1判定用時間ΔT1及び第2判定用時間ΔT2と異なる。よって、第1判定用時間ΔT1と閾値ΔTxとの比較結果、及び第2判定用時間ΔT2と閾値ΔTxとの比較結果から、検出した障害物が近距離障害物であるか近距離障害物であるかを判定できる。 As described above, the first determination time ΔT1 and the second determination time ΔT2 when the obstacle is a short-distance obstacle are the first determination time ΔT1 and the second determination time when the obstacle is a long-distance obstacle. It is different from the judgment time ΔT2. Therefore, from the comparison result between the first determination time ΔT1 and the threshold value ΔTx and the comparison result between the second determination time ΔT2 and the threshold value ΔTx, the detected obstacle is a short-distance obstacle or a short-distance obstacle. Can be determined.

第1実施形態の効果について説明する。
(1−1)超音波センサ21が受信する反射波としては、反射波の受信直前に送信された超音波が近距離障害物によって反射したものである場合と、反射波の受信直前に送信された超音波よりも前に送信された超音波が遠距離障害物によって反射したものである場合とが考えられる。前者の場合、反射波を受信するタイミングは、反射波の受信直前に行われる超音波の送信のタイミングによって決まり、後者の場合、反射波を受信するタイミングは、反射波の受信直前の超音波の送信よりも前に行われる超音波の送信のタイミングによって決まる。
The effect of the first embodiment will be described.
(1-1) The reflected wave received by the ultrasonic sensor 21 includes a case where the ultrasonic wave transmitted immediately before the reception of the reflected wave is reflected by a short-range obstacle and a case where the reflected wave is transmitted immediately before the reception of the reflected wave. It is conceivable that the ultrasonic waves transmitted before the ultrasonic waves are reflected by a long-distance obstacle. In the former case, the timing of receiving the reflected wave is determined by the timing of transmitting the ultrasonic wave immediately before the reception of the reflected wave, and in the latter case, the timing of receiving the reflected wave is determined by the timing of the ultrasonic wave immediately before the reception of the reflected wave. It depends on the timing of ultrasonic transmission that occurs before transmission.

障害物検出装置20は、障害物の有無を検出し、障害物を検出した場合には検出した障害物が近距離障害物であるか遠距離障害物であるかを判定する。障害物検出装置20が障害物の有無を検出するとき、送信指令部31は、第1送信間隔Taで超音波センサ21に超音波を送信させる。障害物検出装置20が検出した障害物が近距離障害物であるか遠距離障害物であるかを判定するとき、送信指令部31は、第1送信間隔Taとは異なる第2送信間隔Tbで超音波センサ21に超音波を送信させる。超音波の送信間隔を第1送信間隔Taと第2送信間隔Tbとで異ならせると、第1判定用時間ΔT1及び第2判定用時間ΔT2は、近距離障害物によって反射した反射波である場合と遠距離障害物によって反射した反射波である場合とで異なる。よって、障害物検出装置20の判定部34は、第1判定用時間ΔT1及び第2判定用時間ΔT2と閾値ΔTxとの比較結果に基づいて、検出した障害物が近距離障害物であるか遠距離障害物であるかを判定できる。 The obstacle detection device 20 detects the presence or absence of an obstacle, and when the obstacle is detected, determines whether the detected obstacle is a short-distance obstacle or a long-distance obstacle. When the obstacle detection device 20 detects the presence or absence of an obstacle, the transmission command unit 31 causes the ultrasonic sensor 21 to transmit ultrasonic waves at the first transmission interval Ta. When determining whether the obstacle detected by the obstacle detection device 20 is a short-distance obstacle or a long-distance obstacle, the transmission command unit 31 has a second transmission interval Tb different from the first transmission interval Ta. The ultrasonic sensor 21 is made to transmit ultrasonic waves. When the transmission interval of ultrasonic waves is different between the first transmission interval Ta and the second transmission interval Tb, the first determination time ΔT1 and the second determination time ΔT2 are reflected waves reflected by a short-distance obstacle. And the case where the reflected wave is reflected by a long-distance obstacle. Therefore, the determination unit 34 of the obstacle detection device 20 determines whether the detected obstacle is a short-distance obstacle or a long-distance obstacle based on the comparison result between the first determination time ΔT1 and the second determination time ΔT2 and the threshold value ΔTx. It can be determined whether it is a distance obstacle.

(第2実施形態)
以下、障害物検出装置及び障害物検出方法を具体化した第2実施形態を図8及び図9にしたがって説明する。なお、第1実施形態と同じ構成については説明を省略する。
(Second Embodiment)
Hereinafter, a second embodiment embodying the obstacle detection device and the obstacle detection method will be described with reference to FIGS. 8 and 9. The description of the same configuration as that of the first embodiment will be omitted.

図8(a)及び図9(a)に示すように、障害物検出装置20は、2つの超音波センサ21を備える。2つの超音波センサ21は、カウンタウェイト13に対し左右方向に並べて取り付けられている。各超音波センサ21は、車体11の後方に超音波を送信する。各超音波センサ21には、送信指令部31及び検出部32が接続されている。送信指令部31は、超音波の送信信号を各超音波センサ21に送信し、各超音波センサ21は、送信指令部31から送信信号が入力されると超音波を送信する。各超音波センサ21は、反射波を受信すると受信信号を検出部32に送信し、検出部32は、各超音波センサ21から送信信号が入力されることにより障害物を検出する。 As shown in FIGS. 8A and 9A, the obstacle detection device 20 includes two ultrasonic sensors 21. The two ultrasonic sensors 21 are attached side by side to the counterweight 13 in the left-right direction. Each ultrasonic sensor 21 transmits ultrasonic waves to the rear of the vehicle body 11. A transmission command unit 31 and a detection unit 32 are connected to each ultrasonic sensor 21. The transmission command unit 31 transmits an ultrasonic transmission signal to each ultrasonic sensor 21, and each ultrasonic sensor 21 transmits an ultrasonic wave when a transmission signal is input from the transmission command unit 31. When each ultrasonic sensor 21 receives the reflected wave, it transmits a received signal to the detection unit 32, and the detection unit 32 detects an obstacle by inputting a transmission signal from each ultrasonic sensor 21.

2つの超音波センサ21のうちの一方を第1超音波センサ21aとし、他方を第2超音波センサ21bとする。送信指令部31は、第1超音波センサ21a及び第2超音波センサ21bに交互に超音波を送信させる。第1超音波センサ21aは、第1超音波センサ21aが送信した超音波の反射波だけでなく、第2超音波センサ21bが送信した超音波の反射波も受信可能である。同様に、第2超音波センサ21bは、第2超音波センサ21bが送信した超音波の反射波だけでなく、第1超音波センサ21aが送信した超音波の反射波も受信可能である。よって、第2実施形態では、超音波を送信した超音波センサ21と反射波を受信する超音波センサ21とが同一の場合もあれば異なる場合もある。 One of the two ultrasonic sensors 21 is a first ultrasonic sensor 21a, and the other is a second ultrasonic sensor 21b. The transmission command unit 31 causes the first ultrasonic sensor 21a and the second ultrasonic sensor 21b to alternately transmit ultrasonic waves. The first ultrasonic sensor 21a can receive not only the reflected wave of the ultrasonic wave transmitted by the first ultrasonic sensor 21a but also the reflected wave of the ultrasonic wave transmitted by the second ultrasonic sensor 21b. Similarly, the second ultrasonic sensor 21b can receive not only the reflected wave of the ultrasonic wave transmitted by the second ultrasonic sensor 21b but also the reflected wave of the ultrasonic wave transmitted by the first ultrasonic sensor 21a. Therefore, in the second embodiment, the ultrasonic sensor 21 that transmits ultrasonic waves and the ultrasonic sensor 21 that receives reflected waves may or may not be the same.

第2実施形態では、第1実施形態と同様、超音波センサ21からフォークリフト10の後方3.4m以内の範囲を検出対象範囲Aとしている。また、検出対象範囲A内にある障害物を検出可能としつつ、障害物を早期に検出するために、第1送信間隔Taを20msに設定している。よって、障害物検出装置20が障害物の有無を検出するとき、送信指令部31は、20ms毎に送信信号を第1超音波センサ21a及び第2超音波センサ21bに交互に出力する。つまり、第1超音波センサ21aが超音波を送信した20ms後に第2超音波センサ21bは超音波を送信し、第2超音波センサ21bが超音波を送信した20ms後に第1超音波センサ21aは超音波を送信する。第2実施形態では、第2送信間隔Tbは、第1超音波センサ21aが超音波を送信してから第2超音波センサ21bが超音波を送信するまでの間隔を指す。 In the second embodiment, as in the first embodiment, the detection target range A is within 3.4 m behind the forklift 10 from the ultrasonic sensor 21. Further, the first transmission interval Ta is set to 20 ms in order to detect an obstacle within the detection target range A at an early stage while making it possible to detect the obstacle. Therefore, when the obstacle detection device 20 detects the presence or absence of an obstacle, the transmission command unit 31 alternately outputs a transmission signal to the first ultrasonic sensor 21a and the second ultrasonic sensor 21b every 20 ms. That is, the second ultrasonic sensor 21b transmits the ultrasonic wave 20 ms after the first ultrasonic sensor 21a transmits the ultrasonic wave, and the first ultrasonic sensor 21a transmits the ultrasonic wave 20 ms after the second ultrasonic sensor 21b transmits the ultrasonic wave. Send ultrasonic waves. In the second embodiment, the second transmission interval Tb refers to the interval from the transmission of ultrasonic waves by the first ultrasonic sensor 21a to the transmission of ultrasonic waves by the second ultrasonic sensor 21b.

次に、具体的な障害物の検出例について、例2−1,2−2を用いて説明する。なお、例2−1,2−2では、障害物の検出が行われている間、フォークリフト10は走行動作せず、停止しているものとする。また、閾値ΔTxは、1msに設定されている。 Next, a specific example of detecting an obstacle will be described with reference to Examples 2-1 and 2-2. In Examples 2-1 and 2, it is assumed that the forklift 10 does not run and is stopped while the obstacle is detected. The threshold value ΔTx is set to 1 ms.

例2−1では、図8(a)に示すように、時刻0sにおいてフォークリフト10の後方に存在しなかった障害物X21が時刻20msにおいてフォークリフト10の後方に出現する場合について考える。障害物X21は、第2超音波センサ21bの検出対象範囲A内である第2超音波センサ21bの後方1.02mに存在する近距離障害物である。なお、障害物X21の形状を簡略化して図示している。また、障害物X21は、時刻20msにおいて出現した後、移動しないものとする。 In Example 2-1 as shown in FIG. 8A, consider a case where an obstacle X21 that did not exist behind the forklift 10 at time 0s appears behind the forklift 10 at time 20ms. The obstacle X21 is a short-distance obstacle existing 1.02 m behind the second ultrasonic sensor 21b, which is within the detection target range A of the second ultrasonic sensor 21b. The shape of the obstacle X21 is shown in a simplified form. Further, it is assumed that the obstacle X21 does not move after appearing at the time of 20 ms.

図8(b)に示すように、第1超音波センサ21a及び第2超音波センサ21bは、第1送信間隔Taで超音波を送信する(ステップS10)。第1超音波センサ21aから第1超音波S1が送信される時刻を0sとする。例2−1では、時刻0sには第1超音波センサ21aの検出対象範囲A内に障害物X21は存在しないため、第1超音波S1は障害物X21に当たることなく減衰する。よって、第1超音波センサ21a及び第2超音波センサ21bは、時刻0sから20ms経過するまでの間、反射波を受信しない。第2超音波センサ21bは、第1送信間隔Taに従って、第1超音波S1の送信が行われた時刻0sから20ms後の時刻20msにおいて第2超音波S2を送信する。時刻20msでは、第2超音波センサ21bの検出対象範囲A内に障害物X21が存在する。このため、第2超音波S2は障害物X21に当たることにより第2超音波センサ21bに向けて反射する。第2超音波センサ21bは、第2超音波S2の反射波R2を受信する(ステップS11でYES)。このとき、第2超音波S2の送信から反射波R2の受信までに要する時間は6msである。よって、第2超音波センサ21bが反射波R2を受信する時刻は、第2超音波S2の送信が行われた時刻20msから6ms後の時刻26msである。検出部32は、フォークリフト10の後方における検出可能範囲B内に障害物X21があることを検出する(ステップS13)。反射波R2は、検出用反射波であり、第2超音波S2は、反射波R2の受信直前に送信された超音波である。 As shown in FIG. 8B, the first ultrasonic sensor 21a and the second ultrasonic sensor 21b transmit ultrasonic waves at the first transmission interval Ta (step S10). The time when the first ultrasonic wave S1 is transmitted from the first ultrasonic wave sensor 21a is set to 0s. In Example 2-1 because the obstacle X21 does not exist in the detection target range A of the first ultrasonic sensor 21a at time 0s, the first ultrasonic wave S1 is attenuated without hitting the obstacle X21. Therefore, the first ultrasonic sensor 21a and the second ultrasonic sensor 21b do not receive the reflected wave from the time 0s to the elapse of 20ms. The second ultrasonic sensor 21b transmits the second ultrasonic wave S2 at a time 20 ms 20 ms after the time 0 s when the first ultrasonic wave S1 is transmitted according to the first transmission interval Ta. At the time of 20 ms, the obstacle X21 exists within the detection target range A of the second ultrasonic sensor 21b. Therefore, the second ultrasonic wave S2 is reflected toward the second ultrasonic wave sensor 21b by hitting the obstacle X21. The second ultrasonic sensor 21b receives the reflected wave R2 of the second ultrasonic wave S2 (YES in step S11). At this time, the time required from the transmission of the second ultrasonic wave S2 to the reception of the reflected wave R2 is 6 ms. Therefore, the time when the second ultrasonic sensor 21b receives the reflected wave R2 is 26 ms after 6 ms from the time when the second ultrasonic wave S2 is transmitted. The detection unit 32 detects that the obstacle X21 is within the detectable range B behind the forklift 10 (step S13). The reflected wave R2 is a reflected wave for detection, and the second ultrasonic wave S2 is an ultrasonic wave transmitted immediately before receiving the reflected wave R2.

例2−2では、図9(a)に示すように、時刻0sにおいてフォークリフト10の後方に障害物X22が存在する場合について考える。障害物X22は、第1超音波センサ21aの検出対象範囲A外かつ検出可能範囲B内であって、第1超音波センサ21aの後方4.41mに存在する遠距離障害物である。なお、障害物X22の形状を簡略化して図示している。また、障害物X22は、障害物検出装置20による障害物の検出時、移動しないものとする。 In Example 2-2, as shown in FIG. 9A, consider the case where the obstacle X22 is behind the forklift 10 at time 0s. The obstacle X22 is a long-distance obstacle that is outside the detection target range A and within the detectable range B of the first ultrasonic sensor 21a and exists 4.41 m behind the first ultrasonic sensor 21a. The shape of the obstacle X22 is shown in a simplified form. Further, it is assumed that the obstacle X22 does not move when the obstacle detection device 20 detects the obstacle.

図9(b)に示すように、第1超音波センサ21a及び第2超音波センサ21bは、第1送信間隔Taで超音波を送信する(ステップS10)。第1超音波センサ21aから第1超音波S1が送信される時刻を0sとする。例2−2では、時刻0sにおいて第1超音波センサ21aの検出可能範囲B内に障害物X22が存在する。このため、第1超音波S1は、障害物X22に当たることにより第2超音波センサ21bに向けて反射する。第2超音波センサ21bは、第1超音波S1の反射波R10を受信する。このとき、第1超音波S1の送信から反射波R10の受信までに要する時間は26msである(ステップS11でYES)。よって、第2超音波センサ21bが反射波R10を受信する時刻は、第1超音波S1の送信が行われた時刻0sから26ms後の時刻26msである。第1超音波センサ21a及び第2超音波センサ21bは、時刻0sから20ms経過するまでの間に反射波を受信しない。第2超音波センサ21bは、第1送信間隔Taに従って、第1超音波S1の送信が行われた時刻0sから20ms後の時刻20msにおいて第2超音波S2を送信する。なお、第2超音波センサ21bの検出対象範囲A内に障害物X22は存在しないため、第2超音波S2は障害物X22に当たることなく減衰する。検出部32は、フォークリフト10の後方に障害物X22があることを検出する(ステップS13)。反射波R10は、検出用反射波であり、第2超音波S2は、反射波R10の受信直前に送信された超音波である。 As shown in FIG. 9B, the first ultrasonic sensor 21a and the second ultrasonic sensor 21b transmit ultrasonic waves at the first transmission interval Ta (step S10). The time when the first ultrasonic wave S1 is transmitted from the first ultrasonic wave sensor 21a is set to 0s. In Example 2-2, the obstacle X22 exists within the detectable range B of the first ultrasonic sensor 21a at time 0s. Therefore, the first ultrasonic wave S1 is reflected toward the second ultrasonic wave sensor 21b by hitting the obstacle X22. The second ultrasonic sensor 21b receives the reflected wave R10 of the first ultrasonic wave S1. At this time, the time required from the transmission of the first ultrasonic wave S1 to the reception of the reflected wave R10 is 26 ms (YES in step S11). Therefore, the time when the second ultrasonic sensor 21b receives the reflected wave R10 is 26 ms after the time 0s when the transmission of the first ultrasonic wave S1 is performed. The first ultrasonic sensor 21a and the second ultrasonic sensor 21b do not receive the reflected wave between the time 0s and the elapse of 20ms. The second ultrasonic sensor 21b transmits the second ultrasonic wave S2 at a time 20 ms 20 ms after the time 0 s when the first ultrasonic wave S1 is transmitted according to the first transmission interval Ta. Since the obstacle X22 does not exist in the detection target range A of the second ultrasonic sensor 21b, the second ultrasonic wave S2 is attenuated without hitting the obstacle X22. The detection unit 32 detects that there is an obstacle X22 behind the forklift 10 (step S13). The reflected wave R10 is a reflected wave for detection, and the second ultrasonic wave S2 is an ultrasonic wave transmitted immediately before the reception of the reflected wave R10.

例2−1,2−2において、測定部33は、第1検出時間Tcを測定する。第1検出時間Tcは、第2超音波S2の送信から反射波R2,R10の受信に要する時間であり、6msである。測定部33は、測定した第1検出時間Tc:6msを送信指令部31及び判定部34に出力する。送信指令部31は、第2送信間隔Tbを設定する。第2送信間隔Tbは、第1送信間隔Taと異なり、かつ第1送信間隔Taと第1検出時間Tcとの和であるTa+Tcと異なるように設定される。例2−1,2−2において、第2送信間隔Tbは、例えば、22msに設定される。 In Examples 2-1 and 2, the measuring unit 33 measures the first detection time Tc. The first detection time Tc is the time required from the transmission of the second ultrasonic wave S2 to the reception of the reflected waves R2 and R10, which is 6 ms. The measuring unit 33 outputs the measured first detection time Tc: 6 ms to the transmission command unit 31 and the determination unit 34. The transmission command unit 31 sets the second transmission interval Tb. The second transmission interval Tb is set to be different from the first transmission interval Ta and different from Ta + Tc, which is the sum of the first transmission interval Ta and the first detection time Tc. In Examples 2-1 and 2, the second transmission interval Tb is set to, for example, 22 ms.

第1超音波センサ21aは、第1送信間隔Taに従って、第2超音波S2の送信が行われた時刻20msから20ms後の時刻40msにおいて第3超音波S3を送信する。第2超音波センサ21bは、第2送信間隔Tbに従って、第3超音波S3の送信が行われた時刻40msから22ms後の時刻62msにおいて第4超音波S4を送信する。第1超音波センサ21aは、第1送信間隔Taに従って、第4超音波S4の送信が行われた時刻62msから20ms後の時刻82msにおいて第5超音波S5を送信する。第2超音波センサ21bは、第2送信間隔Tbに従って、第5超音波S5の送信が行われた時刻82msから22ms後の時刻104msにおいて第6超音波S6を送信する。つまり、第2超音波センサ21bは、第2送信間隔Tb:22msで超音波を2回送信する(ステップS14)。 The first ultrasonic sensor 21a transmits the third ultrasonic wave S3 at a time of 40 ms 20 ms after the time when the second ultrasonic wave S2 is transmitted according to the first transmission interval Ta. The second ultrasonic sensor 21b transmits the fourth ultrasonic wave S4 at a time 62 ms 22 ms after the time 40 ms when the third ultrasonic wave S3 was transmitted according to the second transmission interval Tb. The first ultrasonic sensor 21a transmits the fifth ultrasonic wave S5 at a time 82 ms 20 ms after the time when the fourth ultrasonic wave S4 is transmitted according to the first transmission interval Ta. The second ultrasonic sensor 21b transmits the sixth ultrasonic wave S6 at a time of 104 ms 22 ms after the time when the fifth ultrasonic wave S5 is transmitted according to the second transmission interval Tb. That is, the second ultrasonic sensor 21b transmits ultrasonic waves twice at the second transmission interval Tb: 22 ms (step S14).

例2−1では、第4超音波S4は、障害物X21に当たることにより第2超音波センサ21bに向けて反射する。第2超音波センサ21bは、第4超音波S4の反射波R4を受信し、検出部32は、フォークリフト10の後方に障害物X21があることを再度検出する。このとき、第4超音波S4の送信から反射波R4の受信までに要する時間は6msである。なお、第1超音波センサ21aの検出対象範囲A内には障害物X21が存在しないため、第3超音波S3は障害物X21に当たることなく減衰する。よって、図8(b)に示すように、第2超音波センサ21bは、第4超音波S4の送信を行った時刻62msから6ms後の時刻68msにおいて第4超音波S4の反射波R4を受信する。反射波R4は、第1判定用反射波であり、第4超音波S4は、反射波R4の受信直前に送信された超音波である。 In Example 2-1 the fourth ultrasonic wave S4 is reflected toward the second ultrasonic sensor 21b by hitting the obstacle X21. The second ultrasonic sensor 21b receives the reflected wave R4 of the fourth ultrasonic wave S4, and the detection unit 32 again detects that the obstacle X21 is behind the forklift 10. At this time, the time required from the transmission of the fourth ultrasonic wave S4 to the reception of the reflected wave R4 is 6 ms. Since the obstacle X21 does not exist in the detection target range A of the first ultrasonic sensor 21a, the third ultrasonic wave S3 is attenuated without hitting the obstacle X21. Therefore, as shown in FIG. 8B, the second ultrasonic sensor 21b receives the reflected wave R4 of the fourth ultrasonic wave S4 at a time of 68 ms 6 ms after the time when the fourth ultrasonic wave S4 is transmitted. To do. The reflected wave R4 is a reflected wave for the first determination, and the fourth ultrasonic wave S4 is an ultrasonic wave transmitted immediately before the reception of the reflected wave R4.

第6超音波S6は、障害物X21に当たることにより第2超音波センサ21bに向けて反射する。第2超音波センサ21bは、第6超音波S6の反射波R6を受信し、検出部32は、フォークリフト10の後方に障害物があることを再度検出する。このとき、第6超音波S6の送信から反射波R6の受信までに要する時間は6msである。なお、第5超音波S5は障害物X21に当たることなく減衰する。よって、図8(b)に示すように、第2超音波センサ21bは、第6超音波S6の送信を行った時刻104msから6ms後の時刻110msにおいて第6超音波S6の反射波R6を受信する。反射波R6は、第2判定用反射波であり、第4超音波S4は、反射波R4の受信直前に送信された超音波である。 The sixth ultrasonic wave S6 is reflected toward the second ultrasonic sensor 21b by hitting the obstacle X21. The second ultrasonic sensor 21b receives the reflected wave R6 of the sixth ultrasonic wave S6, and the detection unit 32 again detects that there is an obstacle behind the forklift 10. At this time, the time required from the transmission of the sixth ultrasonic wave S6 to the reception of the reflected wave R6 is 6 ms. The fifth ultrasonic wave S5 is attenuated without hitting the obstacle X21. Therefore, as shown in FIG. 8B, the second ultrasonic sensor 21b receives the reflected wave R6 of the sixth ultrasonic wave S6 at a time of 110 ms 6 ms after the time of transmitting the sixth ultrasonic wave S6. To do. The reflected wave R6 is a reflected wave for the second determination, and the fourth ultrasonic wave S4 is an ultrasonic wave transmitted immediately before the reception of the reflected wave R4.

測定部33は、第2検出時間Td及び第3検出時間Teを測定し、測定した第2検出時間Td及び第3検出時間Teを判定部34に出力する。第2検出時間Tdは、第4超音波S4の送信から反射波R4の受信に要する時間であり、6msである。また、第3検出時間Teは、第6超音波S6の送信から反射波R6の受信に要する時間であり、6msである。判定部34は、第1〜第3受信時間T1〜T3を取得する(ステップS15)。判定部34は、測定部33から入力された第1検出時間Tc:6msを第1受信時間T1として取得する。判定部34は、測定部33から入力された第2検出時間Td:6msを第2受信時間T2として取得する。判定部34は、測定部33から入力された第3検出時間Te:6msを第3受信時間T3として取得する。 The measuring unit 33 measures the second detection time Td and the third detection time Te, and outputs the measured second detection time Td and the third detection time Te to the determination unit 34. The second detection time Td is the time required from the transmission of the fourth ultrasonic wave S4 to the reception of the reflected wave R4, which is 6 ms. The third detection time Te is the time required from the transmission of the sixth ultrasonic wave S6 to the reception of the reflected wave R6, which is 6 ms. The determination unit 34 acquires the first to third reception times T1 to T3 (step S15). The determination unit 34 acquires the first detection time Tc: 6 ms input from the measurement unit 33 as the first reception time T1. The determination unit 34 acquires the second detection time Td: 6 ms input from the measurement unit 33 as the second reception time T2. The determination unit 34 acquires the third detection time Te: 6 ms input from the measurement unit 33 as the third reception time T3.

例2−2では、第3超音波S3は、障害物X22に当たることにより第2超音波センサ21bに向けて反射する。第2超音波センサ21bは、第3超音波S3の反射波R30を受信し、検出部32は、フォークリフト10の後方に障害物X22があることを再度検出する。このとき、第3超音波S3の送信から反射波R30の受信までに要する時間は26msである。なお、第2超音波センサ21bの検出対象範囲A内に障害物X22は存在しないため、第4超音波S4は障害物X22に当たることなく減衰する。よって、図9(b)に示すように、第2超音波センサ21bは、第3超音波S3の送信を行った時刻40msから26ms後の時刻66msにおいて第3超音波S3の反射波R30を受信する。反射波R30は、第1判定用反射波であり、第4超音波S4は、反射波R30の受信直前に送信された超音波である。 In Example 2-2, the third ultrasonic wave S3 is reflected toward the second ultrasonic wave sensor 21b by hitting the obstacle X22. The second ultrasonic sensor 21b receives the reflected wave R30 of the third ultrasonic wave S3, and the detection unit 32 again detects that there is an obstacle X22 behind the forklift 10. At this time, the time required from the transmission of the third ultrasonic wave S3 to the reception of the reflected wave R30 is 26 ms. Since the obstacle X22 does not exist in the detection target range A of the second ultrasonic sensor 21b, the fourth ultrasonic wave S4 is attenuated without hitting the obstacle X22. Therefore, as shown in FIG. 9B, the second ultrasonic sensor 21b receives the reflected wave R30 of the third ultrasonic wave S3 at a time of 66 ms 26 ms after the time of transmitting the third ultrasonic wave S3. To do. The reflected wave R30 is a reflected wave for the first determination, and the fourth ultrasonic wave S4 is an ultrasonic wave transmitted immediately before the reception of the reflected wave R30.

第5超音波S5は、障害物X22に当たることにより第2超音波センサ21bに向けて反射する。第2超音波センサ21bは、第5超音波S5の反射波R50を受信し、検出部32は、フォークリフト10の後方に障害物X22があることを再度検出する。このとき、第5超音波S5の送信から反射波R50の受信までに要する時間は26msである。よって、図9(b)に示すように、第2超音波センサ21bは、第5超音波S5の送信を行った時刻82msから26ms後の時刻108msにおいて第5超音波S5の反射波R50を受信する。反射波R50は、第2判定用反射波であり、第6超音波S6は、反射波R50の受信直前に送信された超音波である。 The fifth ultrasonic wave S5 is reflected toward the second ultrasonic wave sensor 21b by hitting the obstacle X22. The second ultrasonic sensor 21b receives the reflected wave R50 of the fifth ultrasonic wave S5, and the detection unit 32 again detects that there is an obstacle X22 behind the forklift 10. At this time, the time required from the transmission of the fifth ultrasonic wave S5 to the reception of the reflected wave R50 is 26 ms. Therefore, as shown in FIG. 9B, the second ultrasonic sensor 21b receives the reflected wave R50 of the fifth ultrasonic wave S5 at a time of 108 ms 26 ms after the time of transmitting the fifth ultrasonic wave S5. To do. The reflected wave R50 is a reflected wave for the second determination, and the sixth ultrasonic wave S6 is an ultrasonic wave transmitted immediately before the reception of the reflected wave R50.

測定部33は、第2検出時間Td及び第3検出時間Teを測定し、測定した第2検出時間Td及び第3検出時間Teを判定部34に出力する。第2検出時間Tdは、第4超音波S4の送信から反射波R30の受信に要する時間であり、4msである。また、第3検出時間Teは、第6超音波S6の送信から反射波R50の受信に要する時間であり、4msである。判定部34は、第1〜第3受信時間T1〜T3を取得する(ステップS15)。判定部34は、測定部33から入力された第1検出時間Tc:6msを第1受信時間T1として取得する。判定部34は、測定部33から入力された第2検出時間Td:4msを第2受信時間T2として取得する。判定部34は、測定部33から入力された第3検出時間Te:4msを第3受信時間T3として取得する。 The measuring unit 33 measures the second detection time Td and the third detection time Te, and outputs the measured second detection time Td and the third detection time Te to the determination unit 34. The second detection time Td is the time required from the transmission of the fourth ultrasonic wave S4 to the reception of the reflected wave R30, which is 4 ms. The third detection time Te is the time required from the transmission of the sixth ultrasonic wave S6 to the reception of the reflected wave R50, which is 4 ms. The determination unit 34 acquires the first to third reception times T1 to T3 (step S15). The determination unit 34 acquires the first detection time Tc: 6 ms input from the measurement unit 33 as the first reception time T1. The determination unit 34 acquires the second detection time Td: 4 ms input from the measurement unit 33 as the second reception time T2. The determination unit 34 acquires the third detection time Te: 4 ms input from the measurement unit 33 as the third reception time T3.

例2−1,2−2において、判定部34は、第1判定用時間ΔT1及び第2判定用時間ΔT2を算出する(ステップS16)。例1−1では、第1判定用時間ΔT1及び第2判定用時間ΔT2はそれぞれ0msとなる。例1−2では、第1判定用時間ΔT1及び第2判定用時間ΔT2はそれぞれ2msとなる。判定部34は、算出した第1判定用時間ΔT1及び第2判定用時間ΔT2と予め設定された閾値ΔTxとを比較する(ステップS17)。 In Examples 2-1 and 2, the determination unit 34 calculates the first determination time ΔT1 and the second determination time ΔT2 (step S16). In Example 1-1, the first determination time ΔT1 and the second determination time ΔT2 are 0 ms, respectively. In Example 1-2, the first determination time ΔT1 and the second determination time ΔT2 are 2 ms, respectively. The determination unit 34 compares the calculated first determination time ΔT1 and the second determination time ΔT2 with the preset threshold value ΔTx (step S17).

例2−1では、第1判定用時間ΔT1及び第2判定用時間ΔT2の両方が閾値ΔTx以下である(ステップS17でYES)ため、判定部34は、検出した障害物X11を近距離障害物であると判定する(ステップS18)。一方、例2−2では、第1判定用時間ΔT1及び第2判定用時間ΔT2の両方が閾値ΔTxより大きい(ステップS17でNO)ため、判定部34は、検出した障害物X12を遠距離障害物であると判定する(ステップS19)。 In Example 2-1 because both the first determination time ΔT1 and the second determination time ΔT2 are equal to or less than the threshold value ΔTx (YES in step S17), the determination unit 34 uses the detected obstacle X11 as a short-distance obstacle. (Step S18). On the other hand, in Example 2-2, since both the first determination time ΔT1 and the second determination time ΔT2 are larger than the threshold value ΔTx (NO in step S17), the determination unit 34 makes the detected obstacle X12 a long-distance obstacle. It is determined that it is a thing (step S19).

第2実施形態の作用について説明する。
第2超音波センサ21bが受信する反射波としては、例2−1のように反射波の受信直前に送信された超音波が近距離障害物によって反射したものである場合と、例2−2のように反射波の受信直前に送信された超音波よりも前に送信された超音波が遠距離障害物によって反射したものである場合とが考えられる。
The operation of the second embodiment will be described.
The reflected wave received by the second ultrasonic sensor 21b includes a case where the ultrasonic wave transmitted immediately before the reception of the reflected wave is reflected by a short-range obstacle as in Example 2-1 and Example 2-2. It is considered that the ultrasonic wave transmitted before the ultrasonic wave transmitted immediately before the reception of the reflected wave is reflected by a long-distance obstacle as in the above case.

例2−1の場合、反射波の受信のタイミングは、反射波の受信直前に行われる超音波の送信のタイミングによって決まる。このため、超音波の送信間隔を第1送信間隔Taと第2送信間隔Tbとで異ならせたとしても、第1受信時間T1と第2受信時間T2とはほぼ同じになり、第1受信時間T1と第3受信時間T3とはほぼ同じになる。よって、第1判定用時間ΔT1及び第2判定用時間ΔT2は閾値ΔTx以下になる。 In the case of Example 2-1 the reception timing of the reflected wave is determined by the transmission timing of the ultrasonic wave performed immediately before the reception of the reflected wave. Therefore, even if the ultrasonic wave transmission interval is different between the first transmission interval Ta and the second transmission interval Tb, the first reception time T1 and the second reception time T2 are almost the same, and the first reception time T1 and the third reception time T3 are almost the same. Therefore, the first determination time ΔT1 and the second determination time ΔT2 are equal to or less than the threshold value ΔTx.

例2−2の場合、反射波の受信のタイミングは、反射波の受信よりも2回前に行われる超音波の送信のタイミングによって決まる。このため、超音波の送信間隔を第1送信間隔Taと第2送信間隔Tbとで異ならせると、第1受信時間T1と第2受信時間T2とは異なり、第1受信時間T1と第3受信時間T3とは異なる。つまり、第1判定用時間ΔT1及び第2判定用時間ΔT2は閾値ΔTxよりも大きくなる。 In the case of Example 2-2, the timing of receiving the reflected wave is determined by the timing of transmitting the ultrasonic wave two times before the reception of the reflected wave. Therefore, if the ultrasonic wave transmission interval is different between the first transmission interval Ta and the second transmission interval Tb, the first reception time T1 and the third reception are different from the first reception time T1 and the second reception time T2. Different from time T3. That is, the first determination time ΔT1 and the second determination time ΔT2 are larger than the threshold value ΔTx.

このように、障害物が近距離障害物であるときの第1判定用時間ΔT1及び第2判定用時間ΔT2は、障害物が遠距離障害物であるときの第1判定用時間ΔT1及び第2判定用時間ΔT2と異なる。よって、第1判定用時間ΔT1と閾値ΔTxとの比較結果、及び第2判定用時間ΔT2と閾値ΔTxとの比較結果から、検出した障害物が近距離障害物であるか近距離障害物であるかを判定できる。 As described above, the first determination time ΔT1 and the second determination time ΔT2 when the obstacle is a short-distance obstacle are the first determination time ΔT1 and the second determination time when the obstacle is a long-distance obstacle. It is different from the judgment time ΔT2. Therefore, from the comparison result between the first determination time ΔT1 and the threshold value ΔTx and the comparison result between the second determination time ΔT2 and the threshold value ΔTx, the detected obstacle is a short-distance obstacle or a short-distance obstacle. Can be determined.

第2実施形態の効果について説明する。
(2−1)第1超音波センサ21aや第2超音波センサ21bが受信する反射波としては、反射波の受信直前に送信された超音波が近距離障害物によって反射したものである場合と、反射波の受信直前に送信された超音波よりも前に送信された超音波が遠距離障害物によって反射したものである場合とが考えられる。前者の場合、反射波を受信するタイミングは、反射波の受信直前に行われる超音波の送信のタイミングによって決まり、後者の場合、反射波を受信するタイミングは、反射波の受信直前の超音波の送信よりも前に行われる超音波の送信のタイミングによって決まる。
The effect of the second embodiment will be described.
(2-1) The reflected waves received by the first ultrasonic sensor 21a and the second ultrasonic sensor 21b include the case where the ultrasonic waves transmitted immediately before the reception of the reflected waves are reflected by a short-range obstacle. It is considered that the ultrasonic wave transmitted before the ultrasonic wave transmitted immediately before the reception of the reflected wave is reflected by a long-distance obstacle. In the former case, the timing of receiving the reflected wave is determined by the timing of transmitting the ultrasonic wave immediately before the reception of the reflected wave, and in the latter case, the timing of receiving the reflected wave is determined by the timing of the ultrasonic wave immediately before the reception of the reflected wave. It depends on the timing of ultrasonic transmission that occurs before transmission.

障害物検出装置20は、障害物の有無を検出し、障害物を検出した場合には検出した障害物が近距離障害物であるか遠距離障害物であるかを判定する。障害物検出装置20が障害物の有無を検出するとき、送信指令部31は、第1送信間隔Taで第1超音波センサ21a及び第2超音波センサ21bに超音波を送信させる。障害物検出装置20が検出した障害物が近距離障害物であるか遠距離障害物であるかを判定するとき、送信指令部31は、第1送信間隔Taとは異なる第2送信間隔Tbで第2超音波センサ21bに超音波を送信させる。超音波の送信間隔を第1送信間隔Taと第2送信間隔Tbとで異ならせると、第1判定用時間ΔT1及び第2判定用時間ΔT2は、近距離障害物によって反射した反射波である場合と遠距離障害物によって反射した反射波である場合とで異なる。よって、障害物検出装置20の判定部34は、第1判定用時間ΔT1及び第2判定用時間ΔT2と閾値ΔTxとの比較結果に基づいて、検出した障害物が近距離障害物であるか遠距離障害物であるかを判定できる。 The obstacle detection device 20 detects the presence or absence of an obstacle, and when the obstacle is detected, determines whether the detected obstacle is a short-distance obstacle or a long-distance obstacle. When the obstacle detection device 20 detects the presence or absence of an obstacle, the transmission command unit 31 causes the first ultrasonic sensor 21a and the second ultrasonic sensor 21b to transmit ultrasonic waves at the first transmission interval Ta. When determining whether the obstacle detected by the obstacle detection device 20 is a short-distance obstacle or a long-distance obstacle, the transmission command unit 31 has a second transmission interval Tb different from the first transmission interval Ta. The second ultrasonic sensor 21b is made to transmit ultrasonic waves. When the transmission interval of ultrasonic waves is different between the first transmission interval Ta and the second transmission interval Tb, the first determination time ΔT1 and the second determination time ΔT2 are reflected waves reflected by a short-distance obstacle. And the case where the reflected wave is reflected by a long-distance obstacle. Therefore, the determination unit 34 of the obstacle detection device 20 determines whether the detected obstacle is a short-distance obstacle or a long-distance obstacle based on the comparison result between the first determination time ΔT1 and the second determination time ΔT2 and the threshold value ΔTx. It can be determined whether it is a distance obstacle.

上記実施形態は、以下のように変更して実施することができる。上記実施形態及び変更例は、技術的に矛盾しない範囲で互いに組み合わせて実施することができる。
○ 障害物検出装置20が備える超音波センサ21の数は、1又は2に限定されず、3以上でもよい。
The above embodiment can be modified and implemented as follows. The above-described embodiments and modifications can be implemented in combination with each other within a technically consistent range.
○ The number of ultrasonic sensors 21 included in the obstacle detection device 20 is not limited to 1 or 2, and may be 3 or more.

○ 第1実施形態及び第2実施形態において、超音波センサ21は、カウンタウェイト13に形成された穴に超音波センサ21を挿入することでカウンタウェイト13に取り付けられていてもよいし、ブラケット等を介してカウンタウェイト13にネジ留めによって取り付けられていてもよい。 ○ In the first embodiment and the second embodiment, the ultrasonic sensor 21 may be attached to the counterweight 13 by inserting the ultrasonic sensor 21 into a hole formed in the counterweight 13, a bracket or the like. It may be attached to the counterweight 13 by screwing via.

○ 第2実施形態において、第1超音波センサ21a及び第2超音波センサ21bが並べられる方向は左右方向に限定されない。第1超音波センサ21a及び第2超音波センサ21bは、例えば、上下方向に並べられていてもよい。 ○ In the second embodiment, the direction in which the first ultrasonic sensor 21a and the second ultrasonic sensor 21b are arranged is not limited to the left-right direction. The first ultrasonic sensor 21a and the second ultrasonic sensor 21b may be arranged in the vertical direction, for example.

○ 第1実施形態及び第2実施形態において、障害物検出装置20は、フォークリフト10の前方や、フォークリフト10の側方に存在する障害物を検出するものでもよい。この場合、障害物を検出したい方向に超音波が送信されるように超音波センサをフォークリフト10に取り付ければよい。なお、障害物検出装置20としては、前方、後方、及び側方の何れかの方向の障害物を検出するものであってもよいし、複数の方向の障害物を検出するものであってもよい。 ○ In the first embodiment and the second embodiment, the obstacle detection device 20 may detect obstacles existing in front of the forklift 10 or on the side of the forklift 10. In this case, the ultrasonic sensor may be attached to the forklift 10 so that the ultrasonic wave is transmitted in the direction in which the obstacle is to be detected. The obstacle detection device 20 may detect obstacles in any of the front, rear, and side directions, or may detect obstacles in a plurality of directions. Good.

○ 第1実施形態において、第2送信間隔Tbは第1送信間隔Taよりも短く設定されてもよい。以下、第2送信間隔Tbが18msに設定された場合について、第1実施形態の例1−1,1−2を用いて説明する。 ○ In the first embodiment, the second transmission interval Tb may be set shorter than the first transmission interval Ta. Hereinafter, the case where the second transmission interval Tb is set to 18 ms will be described with reference to Examples 1-1 and 1-2 of the first embodiment.

図10(a)に示すように、例1−1では、超音波センサ21は、第2超音波S2を送信した時刻20msから18ms後の時刻38msにおいて第3超音波S3を送信する。超音波センサ21は、第3超音波S3を送信した時刻38msから6ms後の時刻44msにおいて第3超音波S3の反射波R3を受信する。さらに、超音波センサ21は、第3超音波S3を送信した時刻38msから18ms後の時刻56msにおいて第4超音波S4を送信する。超音波センサ21は、第4超音波S4を送信した時刻56msから6ms後の時刻62msにおいて第4超音波S4の反射波R4を受信する。よって、第1〜第3受信時間T1〜T3はそれぞれ6msであり、第1判定用時間ΔT1及び第2判定用時間ΔT2はそれぞれ0msである。 As shown in FIG. 10A, in Example 1-1, the ultrasonic sensor 21 transmits the third ultrasonic wave S3 at a time of 38 ms 18 ms after the time of transmitting the second ultrasonic wave S2. The ultrasonic sensor 21 receives the reflected wave R3 of the third ultrasonic wave S3 at a time 44 ms 6 ms after the time 38 ms when the third ultrasonic wave S3 is transmitted. Further, the ultrasonic sensor 21 transmits the fourth ultrasonic wave S4 at a time of 56 ms 18 ms after the time of transmitting the third ultrasonic wave S3. The ultrasonic sensor 21 receives the reflected wave R4 of the fourth ultrasonic wave S4 at a time 62 ms 6 ms after the time 56 ms when the fourth ultrasonic wave S4 is transmitted. Therefore, the first to third reception times T1 to T3 are 6 ms each, and the first determination time ΔT1 and the second determination time ΔT2 are 0 ms, respectively.

図10(b)に示すように、例1−2では、超音波センサ21は、第2超音波S2を送信した時刻20msから18ms後の時刻38msにおいて第3超音波S3を送信する。超音波センサ21は、第2超音波S2を送信した時刻20msから26ms後の時刻46msにおいて第2超音波S2の反射波R20を受信する。さらに、超音波センサ21は、第3超音波S3を送信した時刻38msから18ms後の時刻56msにおいて第4超音波S4を送信する。超音波センサ21は、第3超音波S3を送信した時刻38msから26ms後の時刻64msにおいて第3超音波S3の反射波R30を受信する。よって、第1受信時間T1は6msであり、第2受信時間T2及び第3受信時間T3はそれぞれ8msである。また、第1判定用時間ΔT1及び第2判定用時間ΔT2はそれぞれ2msである。 As shown in FIG. 10B, in Example 1-2, the ultrasonic sensor 21 transmits the third ultrasonic wave S3 at a time of 38 ms 18 ms after the time of transmitting the second ultrasonic wave S2. The ultrasonic sensor 21 receives the reflected wave R20 of the second ultrasonic wave S2 at a time of 46 ms 26 ms after the time of transmitting the second ultrasonic wave S2 20 ms. Further, the ultrasonic sensor 21 transmits the fourth ultrasonic wave S4 at a time of 56 ms 18 ms after the time of transmitting the third ultrasonic wave S3. The ultrasonic sensor 21 receives the reflected wave R30 of the third ultrasonic wave S3 at a time of 64 ms 26 ms after the time of transmitting the third ultrasonic wave S3. Therefore, the first reception time T1 is 6 ms, and the second reception time T2 and the third reception time T3 are 8 ms, respectively. Further, the first determination time ΔT1 and the second determination time ΔT2 are 2 ms, respectively.

このように、障害物X11が近距離障害物であるときの第1判定用時間ΔT1及び第2判定用時間ΔT2は、障害物X12が遠距離障害物であるときの第1判定用時間ΔT1及び第2判定用時間ΔT2と異なる。よって、第1実施形態において説明したように、第1判定用時間ΔT1及び第2判定用時間ΔT2と閾値ΔTxとの比較結果に基づいて、障害物が近距離障害物であるか遠距離障害物であるかを判定できる。 As described above, the first determination time ΔT1 and the second determination time ΔT2 when the obstacle X11 is a short-distance obstacle are the first determination time ΔT1 and the second determination time ΔT2 when the obstacle X12 is a long-distance obstacle. It is different from the second determination time ΔT2. Therefore, as described in the first embodiment, the obstacle is a short-distance obstacle or a long-distance obstacle based on the comparison result between the first determination time ΔT1 and the second determination time ΔT2 and the threshold value ΔTx. Can be determined.

○ 第2実施形態において、第2送信間隔Tbは第1送信間隔Taよりも短く設定されてもよい。以下、第2送信間隔Tbが18msに設定された場合について、第2実施形態の例2−1,2−2を用いて説明する。 ○ In the second embodiment, the second transmission interval Tb may be set shorter than the first transmission interval Ta. Hereinafter, the case where the second transmission interval Tb is set to 18 ms will be described with reference to Examples 2-1 and 2-2 of the second embodiment.

図11(a)に示すように、例2−1では、第2超音波センサ21bは、第2送信間隔Tbに従って、第3超音波S3が送信された時刻40msから18ms後の時刻58msにおいて第4超音波S4を送信する。第2超音波センサ21bは、第4超音波S4が送信された時刻58msから6ms後の時刻64msにおいて、第4超音波S4の反射波R4を受信する。第1超音波センサ21aは、第1送信間隔Taに従って、第4超音波S4が送信された時刻58msから20ms後の時刻78msにおいて第5超音波S5を送信する。第2超音波センサ21bは、第2送信間隔Tbに従って、第5超音波S5が送信された時刻78msから18ms後の時刻96msにおいて第6超音波S6を送信する。第2超音波センサ21bは、第6超音波S6が送信された時刻96msから6ms後の時刻102msにおいて、第6超音波S6の反射波R6を受信する。よって、第1〜第3受信時間T1〜T3はそれぞれ6msであり、第1判定用時間ΔT1及び第2判定用時間ΔT2はそれぞれ0msである。 As shown in FIG. 11 (a), in Example 2-1 the second ultrasonic sensor 21b has a third ultrasonic wave S3 at a time of 58 ms 18 ms after the transmission of the third ultrasonic wave S3 according to the second transmission interval Tb. 4 Ultrasonic wave S4 is transmitted. The second ultrasonic sensor 21b receives the reflected wave R4 of the fourth ultrasonic wave S4 at a time of 64 ms 6 ms after the time when the fourth ultrasonic wave S4 is transmitted 58 ms. The first ultrasonic sensor 21a transmits the fifth ultrasonic wave S5 at a time 78 ms 20 ms after the time 58 ms when the fourth ultrasonic wave S4 is transmitted according to the first transmission interval Ta. The second ultrasonic sensor 21b transmits the sixth ultrasonic wave S6 at a time 96 ms 18 ms after the time 78 ms when the fifth ultrasonic wave S5 is transmitted according to the second transmission interval Tb. The second ultrasonic sensor 21b receives the reflected wave R6 of the sixth ultrasonic wave S6 at a time 102 ms 6 ms after the time 96 ms when the sixth ultrasonic wave S6 is transmitted. Therefore, the first to third reception times T1 to T3 are 6 ms each, and the first determination time ΔT1 and the second determination time ΔT2 are 0 ms, respectively.

図11(b)に示すように、例2−2では、第2超音波センサ21bは、第2送信間隔Tbに従って、第3超音波S3が送信された時刻40msから18ms後の時刻58msにおいて第4超音波S4を送信する。第2超音波センサ21bは、第3超音波S3が送信された時刻40msから26ms後の時刻66msにおいて、第3超音波S3の反射波R30を受信する。第1超音波センサ21aは、第1送信間隔Taに従って、第4超音波S4を送信した時刻58msから20ms後の時刻78msにおいて第5超音波S5を送信する。第2超音波センサ21bは、第2送信間隔Tbに従って、第5超音波S5が送信された時刻78msから18ms後の時刻96msにおいて第6超音波S6を送信する。第2超音波センサ21bは、第5超音波S5が送信された時刻78msから26ms後の時刻104msにおいて、第6超音波S6の反射波R50を受信する。よって、第1受信時間T1は6msであり、第2受信時間T2及び第3受信時間T3はそれぞれ8msである。第1判定用時間ΔT1及び第2判定用時間ΔT2はそれぞれ2msである。 As shown in FIG. 11B, in Example 2-2, in Example 2-2, the second ultrasonic sensor 21b has a time 58 ms 18 ms after the time 40 ms when the third ultrasonic wave S3 is transmitted according to the second transmission interval Tb. 4 Ultrasonic wave S4 is transmitted. The second ultrasonic sensor 21b receives the reflected wave R30 of the third ultrasonic wave S3 at a time of 66 ms 26 ms after the time when the third ultrasonic wave S3 is transmitted 40 ms. The first ultrasonic sensor 21a transmits the fifth ultrasonic wave S5 at a time of 78 ms 20 ms after the time of transmitting the fourth ultrasonic wave S4 according to the first transmission interval Ta. The second ultrasonic sensor 21b transmits the sixth ultrasonic wave S6 at a time 96 ms 18 ms after the time 78 ms when the fifth ultrasonic wave S5 is transmitted according to the second transmission interval Tb. The second ultrasonic sensor 21b receives the reflected wave R50 of the sixth ultrasonic wave S6 at a time of 104 ms 26 ms after the time when the fifth ultrasonic wave S5 is transmitted 78 ms. Therefore, the first reception time T1 is 6 ms, and the second reception time T2 and the third reception time T3 are 8 ms, respectively. The first determination time ΔT1 and the second determination time ΔT2 are 2 ms, respectively.

このように、障害物X21が近距離障害物であるときの第1判定用時間ΔT1及び第2判定用時間ΔT2は、障害物X22が遠距離障害物であるときの第1判定用時間ΔT1及び第2判定用時間ΔT2と異なる。よって、第2実施形態において説明したように、第1判定用時間ΔT1及び第2判定用時間ΔT2と閾値ΔTxとの比較結果に基づいて、障害物が近距離障害物であるか遠距離障害物であるかを判定できる。 As described above, the first determination time ΔT1 and the second determination time ΔT2 when the obstacle X21 is a short-distance obstacle are the first determination time ΔT1 and the second determination time ΔT2 when the obstacle X22 is a long-distance obstacle. It is different from the second determination time ΔT2. Therefore, as described in the second embodiment, the obstacle is a short-distance obstacle or a long-distance obstacle based on the comparison result between the first determination time ΔT1 and the second determination time ΔT2 and the threshold value ΔTx. Can be determined.

○ 第1実施形態及び第2実施形態において、第1〜第3受信時間T1〜T3の定義を適宜変更してもよい。例えば、第1受信時間T1は、第1送信間隔Taと第1検出時間Tcとの和であるTa+Tcであってもよい。この場合、第2送信間隔Tbと第2検出時間Tdとの和であるTb+Tdを第2受信時間T2とし、第2送信間隔Tbと第3検出時間Teとの和であるTb+Teを第3受信時間T3とする。この場合、判定部34は、ステップS19でYESの場合に障害物を遠距離障害物と判定し(ステップS21)、ステップS19でNOの場合に障害物を近距離障害物と判定する(ステップS20)とする。 -In the first embodiment and the second embodiment, the definitions of the first to third reception times T1 to T3 may be changed as appropriate. For example, the first reception time T1 may be Ta + Tc, which is the sum of the first transmission interval Ta and the first detection time Tc. In this case, Tb + Td, which is the sum of the second transmission interval Tb and the second detection time Td, is defined as the second reception time T2, and Tb + Te, which is the sum of the second transmission interval Tb and the third detection time Te, is the third reception time. Let it be T3. In this case, the determination unit 34 determines that the obstacle is a long-distance obstacle if YES in step S19 (step S21), and determines the obstacle as a short-distance obstacle if NO in step S19 (step S20). ).

第1実施形態及び第2実施形態では、第1受信時間T1を決定するパラメータは、第1検出時間Tcの1つであるのに対し、上記の例では、第1受信時間T1を決定するパラメータは、第1送信間隔Taと第1検出時間Tcの2つである。このため、第1実施形態及び第2実施形態の第1受信時間T1の誤差による影響は、上記の例の第1受信時間T1の誤差による影響よりも相対的に小さくなる。第2受信時間T2及び第3受信時間T3の誤差による影響についても同様に、上記の例の第2受信時間T2及び第3受信時間T3の誤差による影響よりも相対的に小さくなる。よって、第1判定用時間ΔT1及び第2判定用時間ΔT2の誤差も小さくなる。その結果、閾値ΔTxをより小さい値に設定でき、障害物が近距離障害物であるか遠距離障害物であるかをより正確に判定できる。 In the first embodiment and the second embodiment, the parameter for determining the first reception time T1 is one of the first detection time Tc, whereas in the above example, the parameter for determining the first reception time T1 is determined. Is the first transmission interval Ta and the first detection time Tc. Therefore, the influence of the error of the first reception time T1 of the first embodiment and the second embodiment is relatively smaller than the influence of the error of the first reception time T1 of the above example. Similarly, the influence of the error of the second reception time T2 and the third reception time T3 is relatively smaller than the influence of the error of the second reception time T2 and the third reception time T3 in the above example. Therefore, the error between the first determination time ΔT1 and the second determination time ΔT2 is also reduced. As a result, the threshold value ΔTx can be set to a smaller value, and it is possible to more accurately determine whether the obstacle is a short-distance obstacle or a long-distance obstacle.

○ 第1実施形態及び第2実施形態において、測定部33を省略し、判定部34が第1〜第3検出時間Ta〜Tcを測定するようにしてもよい。
○ 第1実施形態及び第2実施形態において、超音波センサ21による第2送信間隔Tbでの超音波の送信を1回だけ行ってもよい。判定部34は、第1判定用時間ΔT1と閾値ΔTxとを比較することによって、障害物が近距離障害物であるか遠距離障害物であるかを判定する。この場合、判定用時間を短縮できる。
○ In the first embodiment and the second embodiment, the measurement unit 33 may be omitted, and the determination unit 34 may measure the first to third detection times Ta to Tc.
-In the first embodiment and the second embodiment, the ultrasonic wave sensor 21 may transmit the ultrasonic wave only once at the second transmission interval Tb. The determination unit 34 determines whether the obstacle is a short-distance obstacle or a long-distance obstacle by comparing the first determination time ΔT1 with the threshold value ΔTx. In this case, the determination time can be shortened.

○ 第1実施形態及び第2実施形態において、超音波センサ21による第2送信間隔Tbでの超音波の送信を3回以上行ってもよい。判定部34は、3つ以上の判定用時間と閾値ΔTxとを比較することによって、障害物が近距離障害物であるか遠距離障害物であるかを判定してもよい。この場合、判定精度が高くなる。また、例えば、4つの判定用時間と閾値ΔTxとの比較結果に基づいて、障害物が近距離障害物であるか遠距離障害物であるかを判定するとき、全ての判定用時間が閾値ΔTx以下である場合に近距離障害物であると判定するようにしてもよいし、3つの判定用時間が閾値ΔTx以下である場合に近距離障害物であると判定するようにしてもよい。 ○ In the first embodiment and the second embodiment, the ultrasonic wave sensor 21 may transmit ultrasonic waves three times or more at the second transmission interval Tb. The determination unit 34 may determine whether the obstacle is a short-distance obstacle or a long-distance obstacle by comparing three or more determination times with the threshold value ΔTx. In this case, the determination accuracy is high. Further, for example, when determining whether the obstacle is a short-distance obstacle or a long-distance obstacle based on the comparison result between the four determination times and the threshold value ΔTx, all the determination times are the threshold value ΔTx. If it is less than or equal to, it may be determined that it is a short-distance obstacle, or if it is three determination times of ΔTx or less, it may be determined that it is a short-distance obstacle.

○ 第1実施形態のように、超音波センサ21による第2送信間隔Tbでの超音波の送信を複数回行う場合、第2送信間隔Tbは一定の間隔でなくてもよい。例えば、例1−1,1−2において、第2超音波S2の送信と第3超音波S3の送信との第2送信間隔Tbを22msとし、第3超音波S3の送信と第4超音波S4の送信との第2送信間隔Tbを18msとしてもよい。ただし、第2送信間隔Tbは、第1送信間隔Taとは異なるものとする。 ○ When the ultrasonic sensor 21 transmits ultrasonic waves a plurality of times at the second transmission interval Tb as in the first embodiment, the second transmission interval Tb does not have to be a constant interval. For example, in Examples 1-1 and 1-2, the second transmission interval Tb between the transmission of the second ultrasonic wave S2 and the transmission of the third ultrasonic wave S3 is 22 ms, and the transmission of the third ultrasonic wave S3 and the fourth ultrasonic wave. The second transmission interval Tb with the transmission of S4 may be 18 ms. However, the second transmission interval Tb is different from the first transmission interval Ta.

○ 第2実施形態のように、第2超音波センサ21bによる第2送信間隔Tbでの超音波の送信を複数回行う場合、第2送信間隔Tbは一定の間隔でなくてもよい。例えば、例2−1,2−2において、第3超音波S3の送信と第4超音波S4の送信との第2送信間隔Tbを22msとし、第5超音波S5の送信と第6超音波S6の送信との第2送信間隔Tbを18msとしてもよい。ただし、第2送信間隔Tbは、第1送信間隔Taとは異なるものとする。 ○ When the second ultrasonic sensor 21b transmits ultrasonic waves a plurality of times at the second transmission interval Tb as in the second embodiment, the second transmission interval Tb does not have to be a constant interval. For example, in Examples 2-1, 2-2, the second transmission interval Tb between the transmission of the third ultrasonic wave S3 and the transmission of the fourth ultrasonic wave S4 is 22 ms, and the transmission of the fifth ultrasonic wave S5 and the sixth ultrasonic wave. The second transmission interval Tb with the transmission of S6 may be 18 ms. However, the second transmission interval Tb is different from the first transmission interval Ta.

○ 第1実施形態及び第2実施形態において、ステップS15において第1〜第3受信時間T1〜T3をまとめて取得したが、第1〜第3受信時間T1〜T3は個別のステップで取得されてもよい。例えば、検出部32が障害物を検出した直後に第1受信時間T1を取得してもよい。また、例えば、超音波センサ21が第1判定用反射波を受信した直後に第2受信時間T2を取得してもよい。さらに、例えば、超音波センサ21が第2判定用反射波を受信した直後に第3受信時間T3を取得してもよい。 ○ In the first embodiment and the second embodiment, the first to third reception times T1 to T3 are collectively acquired in step S15, but the first to third reception times T1 to T3 are acquired in individual steps. May be good. For example, the first reception time T1 may be acquired immediately after the detection unit 32 detects an obstacle. Further, for example, the second reception time T2 may be acquired immediately after the ultrasonic sensor 21 receives the reflected wave for the first determination. Further, for example, the third reception time T3 may be acquired immediately after the ultrasonic sensor 21 receives the reflected wave for the second determination.

○ 第1実施形態及び第2実施形態において、閾値ΔTxは、一定の値でなくてもよく、障害物の検出が行われる状況に応じて変更させてもよい。
障害物の検出が行われる状況の一例として、移動しない障害物に対してフォークリフト10が移動する状況が考えられる。障害物に対してフォークリフト10が近づく方向、すなわち後方に走行しながら障害物を検出する場合、障害物と超音波センサ21との距離は時間が経過するにつれて短くなる。このため、判定用反射波の受信時間は、検出用反射波の受信時間よりも短くなる。よって、判定用時間は、フォークリフト10及び障害物の両方が停止している場合よりも長くなる。逆に、障害物に対してフォークリフト10から離れる方向、すなわち前方に走行しながら障害物を検出する場合、障害物と超音波センサ21との距離は時間が経過するにつれて長くなる。このため、判定用反射波の受信時間は、検出用反射波の受信時間よりも長くなる。よって、判定用時間は、フォークリフト10及び障害物の両方が停止している場合よりも長くなる。
○ In the first embodiment and the second embodiment, the threshold value ΔTx does not have to be a constant value, and may be changed depending on the situation in which the obstacle is detected.
As an example of the situation where the obstacle is detected, the situation where the forklift 10 moves with respect to the obstacle that does not move can be considered. When the forklift 10 approaches the obstacle, that is, when the obstacle is detected while traveling backward, the distance between the obstacle and the ultrasonic sensor 21 becomes shorter as time passes. Therefore, the reception time of the determination reflected wave is shorter than the reception time of the detection reflected wave. Therefore, the determination time is longer than when both the forklift 10 and the obstacle are stopped. On the contrary, when the obstacle is detected in the direction away from the forklift 10 with respect to the obstacle, that is, while traveling forward, the distance between the obstacle and the ultrasonic sensor 21 becomes longer as time passes. Therefore, the reception time of the determination reflected wave is longer than the reception time of the detection reflected wave. Therefore, the determination time is longer than when both the forklift 10 and the obstacle are stopped.

以上のことを踏まえ、閾値ΔTxは、例えば、フォークリフト10の速度に基づいて設定されてもよい。具体的には、障害物検出装置20は、フォークリフト10の車速センサからフォークリフト10の車速情報を取得し、取得したフォークリフト10の車速を用いて障害物と超音波センサ21との距離の変化量を算出し、算出した変化量に基づいて閾値ΔTxの値を増減させる。この場合、フォークリフト10の走行中であっても検出した障害物が近距離障害物であるか遠距離障害物であるかをより正確に判定できる。 Based on the above, the threshold value ΔTx may be set based on, for example, the speed of the forklift 10. Specifically, the obstacle detection device 20 acquires vehicle speed information of the forklift 10 from the vehicle speed sensor of the forklift 10, and uses the acquired vehicle speed of the forklift 10 to determine the amount of change in the distance between the obstacle and the ultrasonic sensor 21. The value of the threshold value ΔTx is increased or decreased based on the calculated amount of change. In this case, it is possible to more accurately determine whether the detected obstacle is a short-distance obstacle or a long-distance obstacle even while the forklift 10 is traveling.

○ 第1実施形態及び第2実施形態において、超音波センサ21は、送信用の圧電振動子と受信用の圧電振動子とを備える超音波センサであってもよい。この場合、超音波センサ21が超音波を送信している間も反射波を受信できる。よって、第2送信間隔Tbは、第1送信間隔Taと異なっていれば、第1送信間隔Taと第1検出時間Tcとの和であるTa+Tcと同じでもよい。 -In the first embodiment and the second embodiment, the ultrasonic sensor 21 may be an ultrasonic sensor including a piezoelectric vibrator for transmission and a piezoelectric vibrator for reception. In this case, the reflected wave can be received even while the ultrasonic sensor 21 is transmitting ultrasonic waves. Therefore, the second transmission interval Tb may be the same as Ta + Tc, which is the sum of the first transmission interval Ta and the first detection time Tc, as long as it is different from the first transmission interval Ta.

○ 第1実施形態及び第2実施形態において、検出対象範囲Aの具体的な数値は、例えば、障害物検出装置20が搭載される装置や、検出する障害物に応じて適宜変更してよい。 ○ In the first embodiment and the second embodiment, the specific numerical value of the detection target range A may be appropriately changed depending on, for example, the device on which the obstacle detection device 20 is mounted and the obstacle to be detected.

○ 第1実施形態及び第2実施形態において、検出可能範囲Bの具体的な数値は、例えば、超音波センサ21の仕様によって異なる。
○ 第1実施形態及び第2実施形態において、音速Vは、例えば、障害物の検出が行われる環境の温度や媒質によって補正されてもよい。
○ In the first embodiment and the second embodiment, the specific numerical value of the detectable range B differs depending on, for example, the specifications of the ultrasonic sensor 21.
-In the first embodiment and the second embodiment, the sound velocity V may be corrected by, for example, the temperature or medium of the environment in which the obstacle is detected.

○ 第1実施形態及び第2実施形態において、第1送信間隔Ta及び第2送信間隔Tbの具体的な数値は、例えば、障害物の検出状況に応じて適宜変更してよい。
○ 第1実施形態及び第2実施形態において、制御ECU30は、メインコントローラ17と一体でもよい。
○ In the first embodiment and the second embodiment, the specific numerical values of the first transmission interval Ta and the second transmission interval Tb may be appropriately changed depending on, for example, the detection status of obstacles.
○ In the first embodiment and the second embodiment, the control ECU 30 may be integrated with the main controller 17.

○ 第1実施形態及び第2実施形態の超音波センサ21において、受信信号を検出部32に送信するか否かを判定するための反射波の受信強度の閾値は可変であってもよい。
○ フォークリフト10は、自動で運転が行われるフォークリフトであってもよい。
-In the ultrasonic sensor 21 of the first embodiment and the second embodiment, the threshold value of the reception intensity of the reflected wave for determining whether or not to transmit the received signal to the detection unit 32 may be variable.
○ The forklift 10 may be a forklift that is automatically operated.

○ 障害物検出装置20は、乗用車、トーイングトラクタ等の産業車両、自律移動するロボット等、障害物の検出を要する移動体であれば、どのような移動体に搭載されていてもよい。 ○ The obstacle detection device 20 may be mounted on any moving body such as a passenger car, an industrial vehicle such as a towing tractor, or an autonomously moving robot, as long as it is a moving body that requires detection of an obstacle.

10…移動体としてのフォークリフト、20…障害物検出装置、21…超音波センサ、31…送信指令部、32…検出部、34…判定部、R2,R10…検出用反射波としての反射波、R3,R4,R6,R20,R30,R50…判定用反射波としての反射波、T1…検出用反射波の受信時間である第1受信時間、T2…判定用反射波の受信時間である第2受信時間、T3…判定用反射波の受信時間である第3受信時間、Ta…第1送信間隔、Tb…第2送信間隔。 10 ... Forklift as a moving body, 20 ... Obstacle detection device, 21 ... Ultrasonic sensor, 31 ... Transmission command unit, 32 ... Detection unit, 34 ... Judgment unit, R2, R10 ... Reflected wave as a reflected wave for detection, R3, R4, R6, R20, R30, R50 ... The reflected wave as the judgment reflected wave, T1 ... The first reception time which is the reception time of the detection reflected wave, T2 ... The second reception time which is the reception time of the judgment reflected wave. Reception time, T3 ... Third reception time, which is the reception time of the reflected wave for determination, Ta ... First transmission interval, Tb ... Second transmission interval.

Claims (4)

超音波を送信し、障害物によって反射された反射波を受信する超音波センサと、
前記超音波センサに繰り返し超音波を送信させる送信指令部と、
前記超音波センサによる反射波の受信結果から前記障害物を検出する検出部と、
を備える障害物検出装置であって、
前記送信指令部は、第1送信間隔で前記超音波センサに超音波を送信させ、前記超音波センサが反射波を受信することにより前記検出部が障害物を検出すると、前記第1送信間隔とは異なる第2送信間隔で前記超音波センサに超音波を送信させ、
前記障害物の検出に用いられる反射波である検出用反射波の受信時間と、前記検出用反射波よりも後に受信される反射波である判定用反射波の受信時間との差である判定用時間を算出し、前記判定用時間と閾値との比較結果に基づいて前記障害物が近距離障害物であるか遠距離障害物であるかを判定する判定部を備えることを特徴とする障害物検出装置。
An ultrasonic sensor that transmits ultrasonic waves and receives reflected waves reflected by obstacles,
A transmission command unit that causes the ultrasonic sensor to repeatedly transmit ultrasonic waves,
A detection unit that detects the obstacle from the reception result of the reflected wave by the ultrasonic sensor, and
It is an obstacle detection device equipped with
The transmission command unit causes the ultrasonic sensor to transmit an ultrasonic wave at the first transmission interval, and when the detection unit detects an obstacle by receiving the reflected wave by the ultrasonic sensor, the first transmission interval is set. Causes the ultrasonic sensor to transmit ultrasonic waves at different second transmission intervals.
For determination, which is the difference between the reception time of the detection reflected wave, which is the reflected wave used for detecting the obstacle, and the reception time of the determination reflected wave, which is the reflected wave received after the detection reflected wave. An obstacle characterized by including a determination unit for calculating a time and determining whether the obstacle is a short-range obstacle or a long-range obstacle based on a comparison result between the determination time and a threshold value. Detection device.
前記検出用反射波の受信時間は、前記検出用反射波の受信時刻と前記検出用反射波の受信直前に行われた超音波の送信時刻との差であり、
前記判定用反射波の受信時間は、前記判定用反射波の受信時刻と前記判定用反射波の受信直前に行われた超音波の送信時刻との差である請求項1に記載の障害物検出装置。
The reception time of the detection reflected wave is the difference between the reception time of the detection reflected wave and the transmission time of the ultrasonic wave performed immediately before the reception of the detection reflected wave.
The obstacle detection according to claim 1, wherein the reception time of the determination reflected wave is the difference between the reception time of the determination reflected wave and the transmission time of the ultrasonic wave performed immediately before the reception of the determination reflected wave. apparatus.
前記障害物検出装置が搭載される移動体の速度に応じて前記閾値を変更させる請求項1又は請求項2に記載の障害物検出装置。 The obstacle detection device according to claim 1 or 2, wherein the threshold value is changed according to the speed of a moving body on which the obstacle detection device is mounted. 超音波を送信し、障害物によって反射された反射波を受信する超音波センサによる反射波の受信結果から前記障害物を検出する障害物検出方法であって、
第1送信間隔で前記超音波センサから超音波を送信するステップと、
前記超音波センサが前記反射波を受信した場合に、前記第1送信間隔とは異なる第2送信間隔で前記超音波センサから超音波を送信するステップと、
前記障害物の検出に用いられた反射波である検出用反射波の受信時間を取得するステップと、
前記検出用反射波よりも後に受信された反射波である判定用反射波の受信時間を取得するステップと、
前記検出用反射波の受信時間と前記判定用反射波の受信時間との差である判定用時間を算出するステップと、
前記判定用時間と閾値との比較結果に基づいて前記障害物が近距離障害物であるか遠距離障害物であるかを判定するステップと、
を備えることを特徴とする障害物検出方法。
An obstacle detection method that detects an obstacle from the reception result of the reflected wave by an ultrasonic sensor that transmits ultrasonic waves and receives the reflected wave reflected by the obstacle.
The step of transmitting ultrasonic waves from the ultrasonic sensor at the first transmission interval,
When the ultrasonic sensor receives the reflected wave, the step of transmitting ultrasonic waves from the ultrasonic sensor at a second transmission interval different from the first transmission interval, and
The step of acquiring the reception time of the reflected wave for detection, which is the reflected wave used for detecting the obstacle, and
The step of acquiring the reception time of the judgment reflected wave, which is the reflected wave received after the detection reflected wave, and
A step of calculating the determination time, which is the difference between the reception time of the detection reflected wave and the reception time of the determination reflection wave, and
A step of determining whether the obstacle is a short-distance obstacle or a long-distance obstacle based on the result of comparison between the determination time and the threshold value.
An obstacle detection method comprising.
JP2019082092A 2019-04-23 2019-04-23 Obstacle detection device and obstacle detection method Active JP7107274B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019082092A JP7107274B2 (en) 2019-04-23 2019-04-23 Obstacle detection device and obstacle detection method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019082092A JP7107274B2 (en) 2019-04-23 2019-04-23 Obstacle detection device and obstacle detection method

Publications (2)

Publication Number Publication Date
JP2020180796A true JP2020180796A (en) 2020-11-05
JP7107274B2 JP7107274B2 (en) 2022-07-27

Family

ID=73023842

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019082092A Active JP7107274B2 (en) 2019-04-23 2019-04-23 Obstacle detection device and obstacle detection method

Country Status (1)

Country Link
JP (1) JP7107274B2 (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58158573A (en) * 1982-03-16 1983-09-20 Nippon Denso Co Ltd Detection of backward obstacle for vehicle
JPS593279A (en) * 1982-06-28 1984-01-09 Kazuo Okada Ultrasonic distance measuring apparatus
JPS62156586A (en) * 1985-12-27 1987-07-11 Nec Corp Radar device
JPS63206679A (en) * 1987-02-24 1988-08-25 Mitsubishi Electric Corp Stagger trigger type pulse radar apparatus
JP2014169927A (en) * 2013-03-04 2014-09-18 Panasonic Corp Vehicle obstacle detection device and vehicle obstacle detection system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58158573A (en) * 1982-03-16 1983-09-20 Nippon Denso Co Ltd Detection of backward obstacle for vehicle
JPS593279A (en) * 1982-06-28 1984-01-09 Kazuo Okada Ultrasonic distance measuring apparatus
JPS62156586A (en) * 1985-12-27 1987-07-11 Nec Corp Radar device
JPS63206679A (en) * 1987-02-24 1988-08-25 Mitsubishi Electric Corp Stagger trigger type pulse radar apparatus
JP2014169927A (en) * 2013-03-04 2014-09-18 Panasonic Corp Vehicle obstacle detection device and vehicle obstacle detection system

Also Published As

Publication number Publication date
JP7107274B2 (en) 2022-07-27

Similar Documents

Publication Publication Date Title
US10180491B2 (en) Object detection device
KR101892763B1 (en) Method for detecting obstacle, apparatus for detecting obstacle and method and system for parking assistant
JP6474228B2 (en) Object detection device
JP6430778B2 (en) Object detection device
JP6404679B2 (en) Object detection device
KR102489386B1 (en) Parking assistance device for a vechicle and method for controlling parking of the same
JP6238156B2 (en) Vehicle object detection device
JP2016080641A (en) Object detector
JP6577767B2 (en) Object detection apparatus and object detection method
JP2009175045A (en) Periphery monitoring device
JP4535094B2 (en) Obstacle detection device for vehicles
JP2016081449A (en) Object detector
JP2011110958A (en) Collision damage reducing device
JP7107274B2 (en) Obstacle detection device and obstacle detection method
US20160356883A1 (en) Object detection apparatus
KR101509945B1 (en) Object detection method of vehicle, and method for controlling parking assist system using the same
JP2008026030A (en) Vehicle obstacle detector and vehicle control system
TWI674424B (en) Radar device for vehicle side mirror
JP6953166B2 (en) Automatic driving control device and automatic driving control method for electric vehicles
KR20160057533A (en) Nosie detecting device of ultrasonic sensor for vehicle and noise detecting method thereof
KR102356480B1 (en) Apparatus and method for detecting vehicle's lind spot
JPH07159531A (en) Obstacle detecting device of vehicle
KR20130112397A (en) Method for measuring distance using sensor
JP7027810B2 (en) Object detection device
KR20200076967A (en) Ultrasonic Sensor Apparatus, Apparatus and Method for Controlling Ultrasonic Sensor Apparatus

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210716

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220527

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220627

R151 Written notification of patent or utility model registration

Ref document number: 7107274

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151