JP2019168888A - Obstacle detection system - Google Patents

Obstacle detection system Download PDF

Info

Publication number
JP2019168888A
JP2019168888A JP2018055616A JP2018055616A JP2019168888A JP 2019168888 A JP2019168888 A JP 2019168888A JP 2018055616 A JP2018055616 A JP 2018055616A JP 2018055616 A JP2018055616 A JP 2018055616A JP 2019168888 A JP2019168888 A JP 2019168888A
Authority
JP
Japan
Prior art keywords
obstacle
tractor
range
unit
rider sensor
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
JP2018055616A
Other languages
Japanese (ja)
Other versions
JP6923472B2 (en
Inventor
横山 和寿
Kazuhisa Yokoyama
和寿 横山
卓也 岩瀬
Takuya IWASE
卓也 岩瀬
士郎 ▲杉▼田
士郎 ▲杉▼田
Shiro SUGITA
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.)
Yanmar Co Ltd
Original Assignee
Yanmar Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yanmar Co Ltd filed Critical Yanmar Co Ltd
Priority to JP2018055616A priority Critical patent/JP6923472B2/en
Publication of JP2019168888A publication Critical patent/JP2019168888A/en
Application granted granted Critical
Publication of JP6923472B2 publication Critical patent/JP6923472B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Guiding Agricultural Machines (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

To appropriately detect an obstacle within a travel area while preventing an object outside of the travel area from being erroneously detected as an obstacle.SOLUTION: An obstacle detection system comprises: an automatic travel control unit which automatically travels a work vehicle 1 within a travel area S on the basis of positioning information of the work vehicle 1 that is acquired by a satellite positioning system; a distance sensor 101 which is provided in the work vehicle 1 and capable of measuring a distance to a measurement object in a three-dimensional manner; and an obstacle detection unit which detects a measurement object within a predetermined distance as an obstacle on the basis of measurement information of the distance sensor 101. The obstacle detection unit has a partial non-detection mode in which, on the basis of the measurement information of the distance sensor 101, a distance to an end S1 of the travel area S is detected in the three-dimensional manner and a measurement object that is located farther than the end S1 of the travel area S is not detected as an obstacle.SELECTED DRAWING: Figure 16

Description

本発明は、作業車両に用いられる障害物検知システムに関する。   The present invention relates to an obstacle detection system used for a work vehicle.

上記のような障害物検知システムは、例えば、衛星測位システムから得られる測位情報を用いて、作業車両を自動走行させる自動走行システムに適用されている。障害物検知システムは、作業車両の周囲における障害物を検知する障害物センサが作業車両に取り付けられ、障害物センサの測定情報に基づいて、所定距離内の測定対象物を障害物として検知する障害物検知処理を行う。障害物検知処理において、障害物を検知すると、報知ブザーを作動させる等の衝突回避制御を行っている(例えば、特許文献1参照。)。   The obstacle detection system as described above is applied to, for example, an automatic travel system that automatically causes a work vehicle to travel using positioning information obtained from a satellite positioning system. In the obstacle detection system, an obstacle sensor that detects an obstacle around a work vehicle is attached to the work vehicle, and an obstacle that detects a measurement object within a predetermined distance as an obstacle based on measurement information of the obstacle sensor. Perform object detection processing. In the obstacle detection processing, when an obstacle is detected, collision avoidance control such as operating a notification buzzer is performed (see, for example, Patent Document 1).

作業車両は、圃場等を走行領域とし、走行領域内を自動走行しながら所定の作業を行っている。作業車両が圃場の外周等、走行領域の端部側(畦際)を自動走行している場合には、走行領域内の範囲だけでなく、走行領域外の範囲も障害物センサの測定範囲に含まれるので、走行領域外の物体を障害物として誤検知してしまう可能性がある。   The work vehicle uses a farm field or the like as a travel area, and performs a predetermined work while automatically traveling in the travel area. When the work vehicle automatically travels on the end side (bump) of the traveling area, such as the outer periphery of the field, not only the range within the traveling area but also the range outside the traveling area is included in the measurement range of the obstacle sensor. Since it is included, there is a possibility that an object outside the traveling area is erroneously detected as an obstacle.

そこで、特許文献1に記載のシステムでは、走行領域の端部から作業車両までの距離が設定距離以下になると、障害物センサの測定範囲を小さく変更して、走行領域外の範囲が測定範囲に含まれないようにしている。これにより、走行領域の端部側の範囲についても、走行領域外の範囲に存在する物体を障害物として誤検知することなく、作業車両が所定の作業を行いながら自動走行できるようにしている。   Therefore, in the system described in Patent Document 1, when the distance from the end of the travel area to the work vehicle is equal to or less than the set distance, the measurement range of the obstacle sensor is changed to be small, and the range outside the travel area becomes the measurement range. It is not included. Accordingly, the work vehicle can automatically travel while performing a predetermined work without erroneously detecting an object existing outside the travel area as an obstacle in the range on the end side of the travel area.

国際公開2015/147149号International Publication No. 2015/147149

上記特許文献1に記載のシステムでは、走行領域の端部から作業車両までの距離を取得するために、衛星測位システムから得られる測位情報を用いている。しかしながら、衛星測位システムから得られる測位情報には誤差が含まれているので、特許文献1に記載のシステムでは、走行領域の端部から作業車両までの距離を正確に取得できず、未だ走行領域外に存在する物体を障害物として誤検知してしまう可能性があり、改良の余地があった。   In the system described in Patent Document 1, the positioning information obtained from the satellite positioning system is used to acquire the distance from the end of the traveling area to the work vehicle. However, since the positioning information obtained from the satellite positioning system includes an error, the system described in Patent Document 1 cannot accurately acquire the distance from the end of the traveling area to the work vehicle, and is still in the traveling area. There is a possibility that an object existing outside may be erroneously detected as an obstacle, and there is room for improvement.

例えば、走行領域の端部から作業車両までの距離について、測位情報を用いて取得した距離が実際の距離よりも小さければ、走行領域外の範囲も障害物センサの測定範囲に含まれてしまい、走行領域外の物体を障害物として誤検知してしまう。逆に、測位情報を用いて取得した距離が実際の距離よりも大きくなると、障害物センサの測定範囲が走行領域の端部まで届かず、走行領域内の障害物を検知できない可能性がある。   For example, for the distance from the end of the travel area to the work vehicle, if the distance acquired using the positioning information is smaller than the actual distance, the range outside the travel area is also included in the measurement range of the obstacle sensor, An object outside the traveling area is erroneously detected as an obstacle. Conversely, if the distance acquired using the positioning information becomes larger than the actual distance, the measurement range of the obstacle sensor does not reach the end of the traveling area, and there is a possibility that the obstacle in the traveling area cannot be detected.

この実情に鑑み、本発明の主たる課題は、走行領域外の物体を障害物として誤検知することなく、走行領域内の障害物を適切に検知することができる障害物検知システムを提供する点にある。   In view of this situation, a main problem of the present invention is to provide an obstacle detection system that can appropriately detect an obstacle in the traveling region without erroneously detecting an object outside the traveling region as an obstacle. is there.

本発明の第1特徴構成は、衛星測位システムにより取得される作業車両の測位情報に基づいて、走行領域内で作業車両を自動走行させる自動走行制御部と、
前記作業車両に備えられ、測定対象物までの距離を3次元にて測定可能な距離センサと、
その距離センサの測定情報に基づいて、所定距離内の測定対象物を障害物として検知する障害物検知部とを備え、
前記障害物検知部は、前記距離センサの測定情報に基づいて、走行領域の端部までの距離を3次元にて検出し、走行領域の端部よりも遠方に位置する測定対象物を障害物として検知しない一部非検知モードを有している点にある。
The first characteristic configuration of the present invention includes an automatic travel control unit that automatically travels a work vehicle in a travel region based on the work vehicle positioning information acquired by the satellite positioning system;
A distance sensor provided in the work vehicle and capable of measuring a distance to a measurement object in three dimensions;
Based on the measurement information of the distance sensor, an obstacle detection unit that detects a measurement object within a predetermined distance as an obstacle,
The obstacle detection unit detects the distance to the end of the travel area in three dimensions based on the measurement information of the distance sensor, and the object to be measured located farther from the end of the travel area is an obstacle. It has a part non-detection mode which does not detect as.

本構成によれば、距離センサにて走行領域の端部を3次元にて測定することができるので、障害物検知部は、距離センサの測定情報に基づいて、走行領域の端部における上端部の位置や走行領域の端部における高さを検出することができる。障害物検知部は、一部検知モードを実行することで、走行領域の端部を特定して、走行領域の端部までの距離を正確に検出できるので、走行領域の端部よりも遠方に位置する測定対象物を走行領域外に存在するとして、その測定対象物を障害物として検知していない。よって、走行領域外の物体を障害物として誤検知することなく、走行領域内の障害物を適切に検知することができる。   According to this configuration, since the end of the travel area can be measured in three dimensions with the distance sensor, the obstacle detection unit is configured to detect the upper end of the end of the travel area based on the measurement information of the distance sensor. And the height at the end of the travel area can be detected. Since the obstacle detection unit can execute the partial detection mode to identify the end of the travel area and accurately detect the distance to the end of the travel area, it is farther than the end of the travel area. Assuming that the measurement object located is outside the travel area, the measurement object is not detected as an obstacle. Therefore, it is possible to appropriately detect an obstacle in the traveling area without erroneously detecting an object outside the traveling area as an obstacle.

本発明の第2特徴構成は、走行領域の端部に対して作業車両が接近している接近状態であるか否かを判定する接近状態判定部が備えられ、
前記接近状態判定部にて接近状態であることを判定した場合に、前記障害物検知部は、前記一部非検知モードを実行する点にある。
The second characteristic configuration of the present invention includes an approach state determination unit that determines whether or not the work vehicle is approaching the end of the traveling region.
When it is determined that the approaching state determination unit is in the approaching state, the obstacle detection unit is in a point of executing the partial non-detection mode.

距離センサの測定範囲内に走行領域外の範囲が含まれる可能性があるのは、走行領域の端部に対して作業車両が接近している接近状態のときである。そこで、本構成によれば、接近状態判定部にて接近状態であることを判定した場合に、障害物検知部が一部非検知モードを実行している。これにより、適切なタイミングにて一部非検知モードを実行することができ、走行領域外の物体を障害物として誤検知することなく、走行領域内の障害物を検知することをより適切に行うことができる。   The range outside the travel area may be included in the measurement range of the distance sensor when the work vehicle is approaching the end of the travel area. So, according to this structure, when it determines with an approach state determination part being an approach state, the obstruction detection part is performing partial non-detection mode. As a result, the partial non-detection mode can be executed at an appropriate timing, and it is possible to more appropriately detect an obstacle in the traveling area without erroneously detecting an object outside the traveling area as an obstacle. be able to.

本発明の第3特徴構成は、前記障害物検知部は、前記一部非検知モードにおいて、予め設定された走行領域の端部の高さに応じて、走行領域の端部を特定している点にある。   According to a third characteristic configuration of the present invention, the obstacle detection unit specifies an end portion of the travel region according to a preset height of the end portion of the travel region in the partial non-detection mode. In the point.

本構成によれば、障害物検知部は、距離センサの測定情報に基づいて、走行領域の端部における上端部の位置や走行領域の端部の高さを検出することができる。障害物検知部は、その検出した走行領域の端部における高さと予め設定された走行領域の端部の高さとを比較することで、走行領域の端部を適切に特定することができる。よって、障害物検知部は、走行領域の端部までの距離をより正確に検出できるので、走行領域外の物体を障害物として誤検知することなく、走行領域内の障害物を検知することをより適切に行うことができる。   According to this configuration, the obstacle detection unit can detect the position of the upper end at the end of the travel region and the height of the end of the travel region based on the measurement information of the distance sensor. The obstacle detection unit can appropriately identify the end of the travel region by comparing the detected height of the end of the travel region with the preset height of the end of the travel region. Therefore, the obstacle detection unit can more accurately detect the distance to the end of the travel area, so that it can detect an obstacle in the travel area without erroneously detecting an object outside the travel area as an obstacle. It can be done more appropriately.

自動走行システムの概略構成を示す図The figure which shows schematic structure of an automatic traveling system 自動走行システムの概略構成を示すブロック図Block diagram showing schematic configuration of automatic driving system 目標走行経路を示す図Diagram showing the target travel route 正面視におけるトラクタの上方側部位を示す図The figure which shows the upper part part of the tractor in front view 背面視におけるトラクタの上方側部位を示す図The figure which shows the upper part part of a tractor in a rear view 側面視における使用位置でのアンテナユニット及び前ライダーセンサを示す図The figure which shows the antenna unit and front rider sensor in the use position in a side view アンテナユニット及び前ライダーセンサの支持構造を示す斜視図The perspective view which shows the support structure of an antenna unit and a front rider sensor 側面視における非使用位置でのアンテナユニット及び前ライダーセンサを示す図The figure which shows the antenna unit and front rider sensor in the non-use position in a side view 使用位置及び非使用位置における側面視でのルーフ、アンテナユニット、前ライダーセンサ、及び、後ライダーセンサを示す図The figure which shows the roof in a side view in a use position and a non-use position, an antenna unit, a front rider sensor, and a rear rider sensor 後ライダーセンサの支持構造を示す斜視図Perspective view showing support structure of rear rider sensor 側面視における前ライダーセンサ及び後ライダーセンサの測定範囲を示す図The figure which shows the measurement range of the front rider sensor and the rear rider sensor in the side view 平面視における前ライダーセンサ、後ライダーセンサ及びソナーの測定範囲を示す図The figure which shows the measurement range of the front rider sensor, rear rider sensor and sonar in plan view 前ライダーセンサの測定情報から生成した3次元画像を示す図The figure which shows the three-dimensional image produced | generated from the measurement information of the front rider sensor 作業装置を下降位置に位置させた状態での後ライダーセンサの測定情報から生成した3次元画像を示す図The figure which shows the three-dimensional image produced | generated from the measurement information of the rear rider sensor in the state which has located the working device in the descent position 作業装置を上昇位置に位置させた状態での後ライダーセンサの測定情報から生成した3次元画像を示す図The figure which shows the three-dimensional image produced | generated from the measurement information of the rear rider sensor in the state which has located the working device in the raising position 前ライダーセンサにて走行領域の端部までの距離を測定している状態を示す図The figure which shows the state which measures the distance to the edge part of a run area with a front rider sensor 前ライダーセンサの検知範囲と非検知範囲とを示す平面図Plan view showing the detection range and non-detection range of the front rider sensor 前ライダーセンサの検知範囲と非検知範囲とを示す平面図Plan view showing the detection range and non-detection range of the front rider sensor 後ライダーセンサの検知範囲と非検知範囲とを示す平面図Plan view showing the detection range and non-detection range of the rear rider sensor 障害物検知部の動作を示すフローチャートFlow chart showing the operation of the obstacle detection unit

本発明に係る障害物検知システムを備えた作業車両を自動走行システムに適用した場合の実施形態を図面に基づいて説明する。
この自動走行システムにおいては、図1に示すように、本発明に係る作業車両としてトラクタ1を適用しているが、トラクタ以外の、乗用田植機、コンバイン、乗用草刈機、ホイールローダ、除雪車等の乗用作業車両、及び、無人草刈機等の無人作業車両を適用することができる。
An embodiment when a work vehicle provided with an obstacle detection system according to the present invention is applied to an automatic travel system will be described with reference to the drawings.
In this automatic traveling system, as shown in FIG. 1, a tractor 1 is applied as a work vehicle according to the present invention. Other than the tractor, a riding rice transplanter, a combiner, a riding mower, a wheel loader, a snowplow, etc. It is possible to apply a passenger work vehicle and an unmanned work vehicle such as an unmanned mower.

この自動走行システムは、図1及び図2に示すように、トラクタ1に搭載された自動走行ユニット2、及び、自動走行ユニット2と通信可能に通信設定された携帯通信端末3を備えている。携帯通信端末3には、タッチ操作可能な表示部51(例えば、液晶パネル)等を有するタブレット型のパーソナルコンピュータやスマートフォン等を採用することができる。   As shown in FIGS. 1 and 2, the automatic traveling system includes an automatic traveling unit 2 mounted on the tractor 1 and a mobile communication terminal 3 that is set to communicate with the automatic traveling unit 2. The mobile communication terminal 3 can employ a tablet personal computer, a smartphone, or the like having a display unit 51 (for example, a liquid crystal panel) that can be touch-operated.

トラクタ1は、駆動可能な操舵輪として機能する左右の前輪5、及び、駆動可能な左右の後輪6を有する走行機体7が備えられている。走行機体7の前方側には、ボンネット8が配置され、ボンネット8内には、コモンレールシステムを備えた電子制御式のディーゼルエンジン(以下、エンジンと称する)9が備えられている。走行機体7のボンネット8よりも後方側には、搭乗式の運転部を形成するキャビン10が備えられている。   The tractor 1 includes a traveling machine body 7 having left and right front wheels 5 that function as drivable steering wheels, and drivable left and right rear wheels 6. A bonnet 8 is disposed on the front side of the traveling machine body 7, and an electronically controlled diesel engine (hereinafter referred to as an engine) 9 having a common rail system is provided in the bonnet 8. A cabin 10 that forms a boarding type driving unit is provided behind the hood 8 of the traveling machine body 7.

走行機体7の後部には、3点リンク機構11を介して、作業装置12の一例であるロータリ耕耘装置を昇降可能かつローリング可能に連結することで、トラクタ1をロータリ耕耘仕様に構成することができる。トラクタ1の後部には、ロータリ耕耘装置に代えて、プラウ、播種装置、散布装置、等の作業装置12を連結することができる。   A rotary cultivator, which is an example of the working device 12, is connected to the rear portion of the traveling machine body 7 via a three-point link mechanism 11 so as to be movable up and down and rollable so that the tractor 1 can be configured to have a rotary cultivating specification. it can. A work device 12 such as a plow, a seeding device, or a spraying device can be connected to the rear portion of the tractor 1 instead of the rotary tiller.

トラクタ1には、図2に示すように、エンジン9からの動力を変速する電子制御式の変速装置13、左右の前輪5を操舵する全油圧式のパワーステアリング機構14、左右の後輪6を制動する左右のサイドブレーキ(図示せず)、左右のサイドブレーキの油圧操作を可能にする電子制御式のブレーキ操作機構15、ロータリ耕耘装置等の作業装置12への伝動を断続する作業クラッチ(図示せず)、作業クラッチの油圧操作を可能にする電子制御式のクラッチ操作機構16、ロータリ耕耘装置等の作業装置12を昇降駆動する電子油圧制御式の昇降駆動機構17、トラクタ1の自動走行等に関する各種の制御プログラム等を有する車載電子制御ユニット18、トラクタ1の車速を検出する車速センサ19、前輪5の操舵角を検出する舵角センサ20、及び、トラクタ1の現在位置及び現在方位を測定する測位ユニット21等が備えられている。   As shown in FIG. 2, the tractor 1 includes an electronically controlled transmission 13 that shifts the power from the engine 9, an all-hydraulic power steering mechanism 14 that steers the left and right front wheels 5, and the left and right rear wheels 6. Left and right side brakes (not shown) for braking, an electronically controlled brake operating mechanism 15 that enables hydraulic operation of the left and right side brakes, and a work clutch that intermittently transmits power to the work device 12 such as a rotary tiller (see FIG. (Not shown), an electronically controlled clutch operating mechanism 16 that enables hydraulic operation of the work clutch, an electrohydraulic control type lifting drive mechanism 17 that drives the working device 12 such as a rotary tiller, etc., automatic travel of the tractor 1, etc. Vehicle-mounted electronic control unit 18 having various control programs and the like, a vehicle speed sensor 19 for detecting the vehicle speed of the tractor 1, and a steering angle sensor for detecting the steering angle of the front wheels 5 20, and the positioning unit 21 and the like for measuring the current position and current heading of the tractor 1 is provided.

なお、エンジン9には、電子ガバナを備えた電子制御式のガソリンエンジンを採用してもよい。変速装置13には、油圧機械式無段変速装置(HMT)、静油圧式無段変速装置(HST)、又は、ベルト式無段変速装置等を採用することができる。パワーステアリング機構14には、電動モータを備えた電動式のパワーステアリング機構14等を採用してもよい。   The engine 9 may be an electronically controlled gasoline engine equipped with an electronic governor. As the transmission 13, a hydraulic mechanical continuously variable transmission (HMT), a hydrostatic continuously variable transmission (HST), a belt-type continuously variable transmission, or the like can be employed. The power steering mechanism 14 may be an electric power steering mechanism 14 provided with an electric motor.

キャビン10は、図4及び図5に示すように、キャビン10の骨組みを形成するキャビンフレーム31と、前方側を覆うフロントガラス32と、後方側を覆うリアガラス33と、上下方向に沿う軸心周りで揺動開閉可能な左右一対のドア34(図1参照)と、天井側のルーフ35とを備えた箱状に構成されている。キャビンフレーム31は、前端部に配置された左右一対の前側支柱36と、後端部に配置された左右一対の後側支柱37とを備えている。平面視において、前方側の左右両側の隅部に前側支柱36が配置され、後方側の左右両側の隅部に後側支柱37が配置されている。キャビンフレーム31は、弾性体等の防振部材を介して走行機体7上に支持されており、走行機体7等からの振動がキャビン10に伝達されるのを防止する防振対策が施された状態で、キャビン10が備えられている。   As shown in FIGS. 4 and 5, the cabin 10 includes a cabin frame 31 that forms a framework of the cabin 10, a front glass 32 that covers the front side, a rear glass 33 that covers the rear side, and an axis around the vertical direction. And a pair of left and right doors 34 (see FIG. 1) that can swing open and close and a roof 35 on the ceiling side. The cabin frame 31 includes a pair of left and right front columns 36 disposed at the front end and a pair of left and right rear columns 37 disposed at the rear end. In a plan view, front struts 36 are disposed at the left and right corners on the front side, and rear struts 37 are disposed at the left and right corners on the rear side. The cabin frame 31 is supported on the traveling machine body 7 via an anti-vibration member such as an elastic body, and anti-vibration measures are taken to prevent vibration from the traveling machine body 7 and the like from being transmitted to the cabin 10. In the state, a cabin 10 is provided.

キャビン10の内部には、図1に示すように、パワーステアリング機構14(図2参照)を介した左右の前輪5の手動操舵を可能にするステアリングホイール38、搭乗者用の運転席39、タッチパネル式の表示部、及び、各種の操作具等が備えられている。キャビン10の前方側部位の両横側部には、キャビン10(運転席39)への乗降部となる乗降ステップ41が備えられている。   Inside the cabin 10, as shown in FIG. 1, a steering wheel 38 that enables manual steering of the left and right front wheels 5 via a power steering mechanism 14 (see FIG. 2), a driver's seat 39 for passengers, a touch panel An expression display unit and various operation tools are provided. On both lateral sides of the front portion of the cabin 10, a boarding / alighting step 41 serving as a boarding / alighting unit for the cabin 10 (driver's seat 39) is provided.

図2に示すように、車載電子制御ユニット18は、変速装置13の作動を制御する変速制御部181、左右のサイドブレーキの作動を制御する制動制御部182、ロータリ耕耘装置等の作業装置12の作動を制御する作業装置制御部183、自動走行時に左右の前輪5の目標操舵角を設定してパワーステアリング機構14に出力する操舵角設定部184、及び、予め設定された自動走行用の目標走行経路P(例えば、図3参照)等を記憶する不揮発性の車載記憶部185等を有している。   As shown in FIG. 2, the on-vehicle electronic control unit 18 includes a shift control unit 181 that controls the operation of the transmission 13, a brake control unit 182 that controls the operation of the left and right side brakes, and a work device 12 such as a rotary tillage device. A work device control unit 183 that controls the operation, a steering angle setting unit 184 that sets the target steering angle of the left and right front wheels 5 during automatic traveling and outputs the target steering angle to the power steering mechanism 14, and a preset target traveling for automatic traveling A non-volatile in-vehicle storage unit 185 and the like for storing the route P (for example, see FIG. 3) and the like are included.

図2に示すように、測位ユニット21には、衛星測位システム(NSS:Navigation Satellite System)の一例であるGPS(Global Positioning System)を利用してトラクタ1の現在位置と現在方位とを測定する衛星航法装置22、及び、3軸のジャイロスコープ及び3方向の加速度センサ等を有してトラクタ1の姿勢や方位等を測定する慣性計測装置(IMU:Inertial Measurement Unit)23等が備えられている。GPSを利用した測位方法には、DGPS(Differential GPS:相対測位方式)やRTK−GPS(Real Time Kinematic GPS:干渉測位方式)等がある。本実施形態においては、移動体の測位に適したRTK−GPSが採用されている。そのため、圃場周辺の既知位置には、図1及び図2に示すように、RTK−GPSによる測位を可能にする基準局4が設置されている。   As shown in FIG. 2, the positioning unit 21 includes a satellite that measures the current position and the current direction of the tractor 1 using a GPS (Global Positioning System) which is an example of a satellite positioning system (NSS: Navigation Satellite System). A navigation device 22, an inertial measurement unit (IMU: 23) 23 that has a three-axis gyroscope, a three-direction acceleration sensor, and the like and measures the attitude, orientation, and the like of the tractor 1 are provided. Positioning methods using GPS include DGPS (Differential GPS) and RTK-GPS (Real Time Kinematic GPS). In the present embodiment, RTK-GPS suitable for positioning of a moving body is employed. Therefore, a reference station 4 that enables positioning by RTK-GPS is installed at a known position around the field as shown in FIGS.

トラクタ1と基準局4との夫々には、図2に示すように、GPS衛星71(図1参照)から送信された電波を受信するGPSアンテナ24,61、及び、トラクタ1と基準局4との間における測位情報を含む各種情報の無線通信を可能にする通信モジュール25,62等が備えられている。これにより、衛星航法装置22は、トラクタ側のGPSアンテナ24がGPS衛星71からの電波を受信して得た測位情報と、基地局側のGPSアンテナ61がGPS衛星71からの電波を受信して得た測位情報とに基づいて、トラクタ1の現在位置及び現在方位を高い精度で測定することができる。また、測位ユニット21は、衛星航法装置22と慣性計測装置23とを備えることにより、トラクタ1の現在位置、現在方位、姿勢角(ヨー角、ロール角、ピッチ角)を高精度に測定することができる。   Each of the tractor 1 and the reference station 4 includes, as shown in FIG. 2, GPS antennas 24 and 61 that receive radio waves transmitted from the GPS satellite 71 (see FIG. 1), and between the tractor 1 and the reference station 4. Communication modules 25, 62, and the like that enable wireless communication of various types of information including positioning information in are provided. Thereby, the satellite navigation device 22 receives the positioning information obtained by the GPS antenna 24 on the tractor side receiving the radio wave from the GPS satellite 71, and the GPS antenna 61 on the base station side receives the radio wave from the GPS satellite 71. Based on the obtained positioning information, the current position and the current direction of the tractor 1 can be measured with high accuracy. In addition, the positioning unit 21 includes the satellite navigation device 22 and the inertial measurement device 23, thereby measuring the current position, current azimuth, and attitude angle (yaw angle, roll angle, pitch angle) of the tractor 1 with high accuracy. Can do.

トラクタ1に備えられるGPSアンテナ24、通信モジュール25、及び、慣性計測装置23は、図1に示すように、アンテナユニット80に収納されている。アンテナユニット80は、キャビン10の前面側の上部位置に配置されている。   As shown in FIG. 1, the GPS antenna 24, the communication module 25, and the inertial measurement device 23 provided in the tractor 1 are housed in an antenna unit 80. The antenna unit 80 is disposed at an upper position on the front side of the cabin 10.

図2に示すように、携帯通信端末3には、表示部51等の作動を制御する各種の制御プログラム等を有する端末電子制御ユニット52、及び、トラクタ側の通信モジュール25との間における測位情報を含む各種情報の無線通信を可能にする通信モジュール55、等が備えられている。端末電子制御ユニット52は、トラクタ1を自動走行させるための走行案内用の目標走行経路P(例えば、図3参照)を生成する走行経路生成部53、及び、ユーザが入力した各種の入力情報や走行経路生成部53が生成した目標走行経路P等を記憶する不揮発性の端末記憶部54、等を有している。   As shown in FIG. 2, the mobile communication terminal 3 includes positioning information between the terminal electronic control unit 52 having various control programs for controlling the operation of the display unit 51 and the like, and the communication module 25 on the tractor side. A communication module 55 that enables wireless communication of various types of information is provided. The terminal electronic control unit 52 includes a travel route generation unit 53 that generates a target travel route P (for example, see FIG. 3) for travel guidance for automatically traveling the tractor 1, and various input information input by the user. A non-volatile terminal storage unit 54 that stores the target travel route P and the like generated by the travel route generation unit 53 is included.

走行経路生成部53が目標走行経路Pを生成するに当たり、携帯通信端末3の表示部51に表示された目標走行経路設定用の入力案内に従って、運転者や管理者等のユーザ等が作業車両や作業装置12の種類や機種等の車体情報を入力しており、入力された車体情報が端末記憶部54に記憶されている。目標走行経路Pの生成対象となる走行領域S(図3参照)を圃場としており、携帯通信端末3の端末電子制御ユニット52は、圃場の形状や位置を含む圃場情報を取得して端末記憶部54に記憶している。   When the travel route generation unit 53 generates the target travel route P, a driver or a user such as a driver or the like follows the input information for setting the target travel route displayed on the display unit 51 of the mobile communication terminal 3. Vehicle body information such as the type and model of the work device 12 is input, and the input vehicle body information is stored in the terminal storage unit 54. A travel region S (see FIG. 3) that is a target for generating the target travel route P is used as a field, and the terminal electronic control unit 52 of the mobile communication terminal 3 acquires field information including the shape and position of the field to obtain a terminal storage unit. 54.

圃場情報の取得について説明すると、ユーザ等が運転してトラクタ1を実際に走行させることで、端末電子制御ユニット52は、測位ユニット21にて取得するトラクタ1の現在位置等から圃場の形状や位置等を特定するための位置情報を取得することができる。端末電子制御ユニット52は、取得した位置情報から圃場の形状及び位置を特定し、その特定した圃場の形状及び位置から特定した走行領域Sを含む圃場情報を取得している。図3では、矩形状の走行領域Sが特定された例を示している。   The acquisition of the field information will be described. When the user or the like drives and actually travels the tractor 1, the terminal electronic control unit 52 determines the shape and position of the field from the current position of the tractor 1 acquired by the positioning unit 21. It is possible to acquire position information for specifying the like. The terminal electronic control unit 52 specifies the shape and position of the field from the acquired position information, and acquires the field information including the travel region S specified from the specified shape and position of the field. FIG. 3 shows an example in which a rectangular traveling area S is specified.

特定された圃場の形状や位置等を含む圃場情報が端末記憶部54に記憶されると、走行経路生成部53は、端末記憶部54に記憶されている圃場情報や車体情報を用いて、目標走行経路Pを生成する。   When the field information including the shape and position of the identified field is stored in the terminal storage unit 54, the travel route generation unit 53 uses the field information and the vehicle body information stored in the terminal storage unit 54 to generate the target A travel route P is generated.

図3に示すように、走行経路生成部53は、走行領域S内を中央領域R1と外周領域R2とに区分け設定している。中央領域R1は、走行領域Sの中央部に設定されており、先行してトラクタ1を往復方向に自動走行させて所定の作業(例えば、耕耘等の作業)を行う往復作業領域となっている。外周領域R2は、中央領域R1の周囲に設定されており、中央領域R1に後続してトラクタ1を周回方向に自動走行させて所定の作業を行う周回作業領域となっている。走行経路生成部53は、例えば、車体情報に含まれる旋回半径やトラクタ1の前後幅及び左右幅等から、トラクタ1を圃場の畔際で旋回走行させるために必要となる旋回走行用のスペース等を求めている。走行経路生成部53は、中央領域R1の外周に求めたスペース等を確保するように、走行領域S内を中央領域R1と外周領域R2とに区分けしている。   As shown in FIG. 3, the travel route generating unit 53 sets the travel region S into a central region R1 and an outer peripheral region R2. The central area R1 is set at the center of the traveling area S, and is a reciprocating work area in which a predetermined operation (for example, work such as tillage) is performed by automatically traveling the tractor 1 in the reciprocating direction in advance. . The outer peripheral region R2 is set around the central region R1, and is a circular work region in which the tractor 1 automatically travels in the circular direction following the central region R1 and performs a predetermined operation. For example, the travel route generation unit 53 uses the turning radius included in the vehicle body information, the front / rear width and the left / right width of the tractor 1, and the space required for turning the tractor 1 to turn around the field. Seeking. The traveling route generation unit 53 divides the traveling region S into a central region R1 and an outer peripheral region R2 so as to ensure the space obtained on the outer periphery of the central region R1.

走行経路生成部53は、図3に示すように、車体情報や圃場情報等を用いて、目標走行経路Pを生成している。例えば、目標走行経路Pは、中央領域R1において同じ直進距離を有して作業幅に対応する一定距離をあけて平行に配置設定された複数の作業経路P1と、隣接する作業経路P1の始端と終端とを連結する連結経路P2と、外周領域R2において周回する周回経路P3(図中点線にて示している)とを有している。複数の作業経路P1は、トラクタ1を直進走行させながら、所定の作業を行うための経路である。連結経路P2は、所定の作業を行わずに、トラクタ1の走行方向を180度転換させるためのUターン経路であり、作業経路P1の終端と隣接する次の作業経路P1の始端とを連結している。周回経路P3は、外周領域R2にてトラクタ1を周回走行させながら、所定の作業を行うための経路である。周回経路P3は、走行領域Sの四隅に相当する位置において、トラクタ1を前進走行と後進走行とに切り替えることで、トラクタ1の走行方向を90度転換させるようにしている。ちなみに、図3に示す目標走行経路Pは、あくまで一例であり、どのような目標走行経路を設定するかは適宜変更が可能である。   As illustrated in FIG. 3, the travel route generation unit 53 generates a target travel route P using vehicle body information, farm field information, and the like. For example, the target travel route P includes a plurality of work routes P1 that are arranged in parallel at a constant distance corresponding to the work width and have the same straight traveling distance in the central region R1, and the start ends of the adjacent work routes P1. It has the connection path | route P2 which connects a termination | terminus, and the circulation path | route P3 (it shows with the dotted line in the figure) which circulates in outer periphery area | region R2. The plurality of work paths P1 are paths for performing predetermined work while causing the tractor 1 to travel straight ahead. The connection path P2 is a U-turn path for changing the traveling direction of the tractor 1 by 180 degrees without performing a predetermined work, and connects the end of the work path P1 and the start end of the next adjacent work path P1. ing. The circulation path P3 is a path for performing a predetermined operation while the tractor 1 travels around in the outer peripheral region R2. The circulatory path P3 switches the traveling direction of the tractor 1 90 degrees by switching the tractor 1 between forward traveling and backward traveling at positions corresponding to the four corners of the traveling region S. Incidentally, the target travel route P shown in FIG. 3 is merely an example, and what target travel route is set can be appropriately changed.

走行経路生成部53にて生成された目標走行経路Pは、表示部51に表示可能であり、車体情報及び圃場情報等と関連付けた経路情報として端末記憶部54に記憶されている。経路情報には、目標走行経路Pの方位角、及び、目標走行経路Pでのトラクタ1の走行形態等に応じて設定された設定エンジン回転速度や目標走行速度、等が含まれている。   The target travel route P generated by the travel route generation unit 53 can be displayed on the display unit 51 and is stored in the terminal storage unit 54 as route information associated with vehicle body information, farm field information, and the like. The route information includes the azimuth angle of the target travel route P, the set engine speed and the target travel speed set according to the travel mode of the tractor 1 on the target travel route P, and the like.

このようにして、走行経路生成部53が目標走行経路Pを生成すると、端末電子制御ユニット52が、携帯通信端末3からトラクタ1に経路情報を転送することで、トラクタ1の車載電子制御ユニット18が、経路情報を取得することができる。車載電子制御ユニット18は、取得した経路情報に基づいて、測位ユニット21にて自己の現在位置(トラクタ1の現在位置)を取得しながら、目標走行経路Pに沿ってトラクタ1を自動走行させることができる。測位ユニット21にて取得するトラクタ1の現在位置については、リアルタイム(例えば、数秒周期)でトラクタ1から携帯通信端末3に送信されており、携帯通信端末3にてトラクタ1の現在位置を把握している。   In this way, when the travel route generation unit 53 generates the target travel route P, the terminal electronic control unit 52 transfers the route information from the mobile communication terminal 3 to the tractor 1, whereby the in-vehicle electronic control unit 18 of the tractor 1. However, route information can be acquired. The in-vehicle electronic control unit 18 causes the tractor 1 to automatically travel along the target travel route P while acquiring its current position (current position of the tractor 1) by the positioning unit 21 based on the acquired route information. Can do. The current position of the tractor 1 acquired by the positioning unit 21 is transmitted from the tractor 1 to the mobile communication terminal 3 in real time (for example, every several seconds), and the mobile communication terminal 3 grasps the current position of the tractor 1. ing.

経路情報の転送に関しては、トラクタ1が自動走行を開始する前の段階において、経路情報の全体を端末電子制御ユニット52から車載電子制御ユニット18に一挙に転送することができる。また、例えば、目標走行経路Pを含む経路情報を、情報量の少ない所定距離ごとの複数の経路部分に分割することもできる。この場合には、トラクタ1が自動走行を開始する前の段階においては、経路情報の初期経路部分のみが端末電子制御ユニット52から車載電子制御ユニット18に転送される。自動走行の開始後は、トラクタ1が情報量等に応じて設定された経路取得地点に達するごとに、その地点に対応する以後の経路部分のみの経路情報が端末電子制御ユニット52から車載電子制御ユニット18に転送するようにしてもよい。   Regarding the transfer of the route information, the entire route information can be transferred from the terminal electronic control unit 52 to the in-vehicle electronic control unit 18 at a time before the tractor 1 starts the automatic travel. Further, for example, the route information including the target travel route P can be divided into a plurality of route portions for each predetermined distance with a small amount of information. In this case, only the initial route portion of the route information is transferred from the terminal electronic control unit 52 to the in-vehicle electronic control unit 18 before the tractor 1 starts automatic traveling. After the start of automatic driving, every time the tractor 1 reaches a route acquisition point set according to the amount of information or the like, route information of only the subsequent route portion corresponding to that point is transmitted from the terminal electronic control unit 52 to the on-vehicle electronic control. It may be transferred to the unit 18.

トラクタ1の自動走行を開始する場合には、例えば、ユーザ等がスタート地点にトラクタ1を移動させて、各種の自動走行開始条件が満たされると、携帯通信端末3にて、ユーザが表示部51を操作して自動走行の開始を指示することで、携帯通信端末3は、自動走行の開始指示をトラクタ1に送信する。これにより、トラクタ1では、車載電子制御ユニット18が、自動走行の開始指示を受けることで、測位ユニット21にて自己の現在位置(トラクタ1の現在位置)を取得しながら、目標走行経路Pに沿ってトラクタ1を自動走行させる自動走行制御を開始する。車載電子制御ユニット18が、衛星測位システムを用いて測位ユニット21により取得されるトラクタ1の測位情報に基づいて、走行領域S内の目標走行経路Pに沿ってトラクタ1を自動走行させる自動走行制御を行う自動走行制御部として構成されている。   When starting the automatic traveling of the tractor 1, for example, when the user or the like moves the tractor 1 to the start point and various automatic traveling start conditions are satisfied, the user can display the display unit 51 on the mobile communication terminal 3. The mobile communication terminal 3 transmits an instruction to start automatic driving to the tractor 1 by instructing start of automatic driving by operating. As a result, in the tractor 1, the in-vehicle electronic control unit 18 receives an instruction to start automatic traveling, and the positioning unit 21 obtains its current position (current position of the tractor 1) while obtaining the target traveling route P. The automatic traveling control for automatically traveling the tractor 1 is started. Automatic traveling control in which the in-vehicle electronic control unit 18 automatically travels the tractor 1 along the target traveling route P in the traveling region S based on the positioning information of the tractor 1 acquired by the positioning unit 21 using the satellite positioning system. It is comprised as an automatic travel control part which performs.

自動走行制御には、変速装置13の作動を自動制御する自動変速制御、ブレーキ操作機構15の作動を自動制御する自動制動制御、左右の前輪5を自動操舵する自動操舵制御、及び、ロータリ耕耘装置等の作業装置12の作動を自動制御する作業用自動制御、等が含まれている。   The automatic travel control includes automatic shift control for automatically controlling the operation of the transmission 13, automatic braking control for automatically controlling the operation of the brake operating mechanism 15, automatic steering control for automatically steering the left and right front wheels 5, and a rotary tillage device. The automatic operation control for automatically controlling the operation of the working device 12 is included.

自動変速制御においては、変速制御部181が、目標走行速度を含む目標走行経路Pの経路情報と測位ユニット21の出力と車速センサ19の出力とに基づいて、目標走行経路Pでのトラクタ1の走行形態等に応じて設定された目標走行速度がトラクタ1の車速として得られるように変速装置13の作動を自動制御する。   In the automatic shift control, the shift control unit 181 determines whether the tractor 1 on the target travel route P is based on the route information of the target travel route P including the target travel speed, the output of the positioning unit 21, and the output of the vehicle speed sensor 19. The operation of the transmission 13 is automatically controlled so that the target travel speed set according to the travel mode and the like is obtained as the vehicle speed of the tractor 1.

自動制動制御においては、制動制御部182が、目標走行経路Pと測位ユニット21の出力とに基づいて、目標走行経路Pの経路情報に含まれている制動領域において左右のサイドブレーキが左右の後輪6を適正に制動するようにブレーキ操作機構15の作動を自動制御する。   In the automatic braking control, the braking control unit 182 causes the left and right side brakes to move rearward in the braking area included in the route information of the target traveling route P based on the target traveling route P and the output of the positioning unit 21. The operation of the brake operation mechanism 15 is automatically controlled so as to properly brake the wheel 6.

自動操舵制御においては、トラクタ1が目標走行経路Pを自動走行するように、操舵角設定部184が、目標走行経路Pの経路情報と測位ユニット21の出力とに基づいて左右の前輪5の目標操舵角を求めて設定し、設定した目標操舵角をパワーステアリング機構14に出力する。パワーステアリング機構14が、目標操舵角と舵角センサ20の出力とに基づいて、目標操舵角が左右の前輪5の操舵角として得られるように左右の前輪5を自動操舵する。   In the automatic steering control, the steering angle setting unit 184 determines the target of the left and right front wheels 5 based on the route information of the target travel route P and the output of the positioning unit 21 so that the tractor 1 travels automatically on the target travel route P. The steering angle is obtained and set, and the set target steering angle is output to the power steering mechanism 14. Based on the target steering angle and the output of the steering angle sensor 20, the power steering mechanism 14 automatically steers the left and right front wheels 5 so that the target steering angle is obtained as the steering angle of the left and right front wheels 5.

作業用自動制御においては、作業装置制御部183が、目標走行経路Pの経路情報と測位ユニット21の出力とに基づいて、トラクタ1が作業経路P1(例えば、図3参照)の始端等の作業開始地点に達するのに伴って作業装置12による所定の作業(例えば耕耘作業)が開始され、かつ、トラクタ1が作業経路P1(例えば、図3参照)の終端等の作業終了地点に達するのに伴って作業装置12による所定の作業が停止されるように、クラッチ操作機構16及び昇降駆動機構17の作動を自動制御する。   In the automatic work control, the work device control unit 183 operates the tractor 1 at the start of the work route P1 (for example, see FIG. 3) based on the route information of the target travel route P and the output of the positioning unit 21. As the start point is reached, a predetermined work (for example, tillage work) by the work device 12 is started, and the tractor 1 reaches the work end point such as the end of the work path P1 (for example, see FIG. 3). Along with this, the operations of the clutch operation mechanism 16 and the lifting drive mechanism 17 are automatically controlled so that the predetermined work by the work device 12 is stopped.

このようにして、トラクタ1においては、変速装置13、パワーステアリング機構14、ブレーキ操作機構15、クラッチ操作機構16、昇降駆動機構17、車載電子制御ユニット18、車速センサ19、舵角センサ20、測位ユニット21、及び、通信モジュール25、等によって自動走行ユニット2が構成されている。   Thus, in the tractor 1, the transmission 13, the power steering mechanism 14, the brake operation mechanism 15, the clutch operation mechanism 16, the lift drive mechanism 17, the on-vehicle electronic control unit 18, the vehicle speed sensor 19, the steering angle sensor 20, positioning. The automatic traveling unit 2 is configured by the unit 21, the communication module 25, and the like.

この実施形態では、キャビン10にユーザ等が搭乗せずにトラクタ1を自動走行させるだけでなく、キャビン10にユーザ等が搭乗した状態でトラクタ1を自動走行させることも可能となっている。よって、キャビン10にユーザ等が搭乗せずに、車載電子制御ユニット18による自動走行制御により、トラクタ1を目標走行経路Pに沿って自動走行させることができるだけでなく、キャビン10にユーザ等が搭乗している場合でも、車載電子制御ユニット18による自動走行制御により、トラクタ1を目標走行経路Pに沿って自動走行させることができる。   In this embodiment, not only the user or the like does not get on the cabin 10 but also the tractor 1 automatically runs, and the tractor 1 can also automatically run while the user or the like gets on the cabin 10. Accordingly, not only the user or the like does not board the cabin 10 but also the tractor 1 can automatically travel along the target travel route P by the automatic traveling control by the in-vehicle electronic control unit 18, and the user or the like can board the cabin 10. Even in this case, the tractor 1 can be automatically driven along the target travel route P by the automatic travel control by the in-vehicle electronic control unit 18.

キャビン10にユーザ等が搭乗している場合には、車載電子制御ユニット18にてトラクタ1を自動走行させる自動走行状態と、ユーザ等の運転に基づいてトラクタ1を走行させる手動走行状態とに切り替えることができる。よって、自動走行状態にて目標走行経路Pを自動走行している途中に、自動走行状態から手動走行状態に切り替えることができ、逆に、手動走行状態にて走行している途中に、手動走行状態から自動走行状態に切り替えることができる。手動走行状態と自動走行状態との切り替えについては、例えば、運転席39の近傍に、自動走行状態と手動走行状態とに切り替えるための切替操作部を備えることができるとともに、その切替操作部を携帯通信端末3の表示部51に表示させることもできる。また、車載電子制御ユニット18による自動走行制御中に、ユーザがステアリングホイール38を操作すると、自動走行状態から手動走行状態に切り替えることができる。   When a user or the like is in the cabin 10, the vehicle-mounted electronic control unit 18 switches between an automatic running state in which the tractor 1 is automatically run and a manual running state in which the tractor 1 is run based on the operation of the user or the like. be able to. Therefore, the automatic travel state can be switched from the automatic travel state to the manual travel state during the automatic travel on the target travel route P, and conversely, the manual travel can be performed while the manual travel state is traveling. The state can be switched to the automatic running state. For switching between the manual driving state and the automatic driving state, for example, a switching operation unit for switching between the automatic driving state and the manual driving state can be provided in the vicinity of the driver's seat 39, and the switching operation unit is carried around. It can also be displayed on the display unit 51 of the communication terminal 3. Further, when the user operates the steering wheel 38 during the automatic traveling control by the in-vehicle electronic control unit 18, the automatic traveling state can be switched to the manual traveling state.

トラクタ1には、図1及び図2に示すように、トラクタ1(走行機体7)の周囲における障害物を検知して、障害物との衝突を回避するための障害物検知システム100が備えられている。障害物検知システム100は、レーザを用いて測定対象物までの距離を3次元で測定可能な複数のライダーセンサ(距離センサに相当する)101,102と、超音波を用いて測定対象物までの距離を測定可能な複数のソナーを有するソナーユニット103,104と、障害物検知部110と、衝突回避制御部111とが備えられている。ここで、ライダーセンサ101,102及びソナーユニット103,104にて測定する測定対象物は、物体や人等としている。   As shown in FIGS. 1 and 2, the tractor 1 is provided with an obstacle detection system 100 for detecting an obstacle around the tractor 1 (the traveling machine body 7) and avoiding a collision with the obstacle. ing. The obstacle detection system 100 includes a plurality of rider sensors (corresponding to distance sensors) 101 and 102 that can measure a distance to a measurement object in three dimensions using a laser, and an ultrasonic wave to the measurement object. Sonar units 103 and 104 having a plurality of sonars capable of measuring distances, an obstacle detection unit 110, and a collision avoidance control unit 111 are provided. Here, the measurement object to be measured by the rider sensors 101 and 102 and the sonar units 103 and 104 is an object or a person.

障害物検知部110は、ライダーセンサ101,102及びソナーユニット103,104の測定情報に基づいて、所定距離内の物体や人等の測定対象物を障害物として検知する障害物検知処理を行うように構成されている。衝突回避制御部111は、障害物検知部110にて障害物を検知すると、衝突回避制御を行うように構成されている。障害物検知部110は、ライダーセンサ101,102及びソナーユニット103,104の測定情報に基づく障害物検知処理をリアルタイムで繰り返し行い、物体や人等の障害物を適切に検知しており、衝突回避制御部111は、リアルタイムで検知される障害物との衝突を回避するための衝突回避制御を行うようにしている。   The obstacle detection unit 110 performs an obstacle detection process for detecting a measurement object such as an object or a person within a predetermined distance as an obstacle based on the measurement information of the rider sensors 101 and 102 and the sonar units 103 and 104. It is configured. The collision avoidance control unit 111 is configured to perform collision avoidance control when the obstacle detection unit 110 detects an obstacle. The obstacle detection unit 110 repeatedly performs obstacle detection processing based on measurement information of the rider sensors 101 and 102 and the sonar units 103 and 104 in real time, appropriately detects obstacles such as objects and people, and avoids collision. The control unit 111 performs collision avoidance control for avoiding a collision with an obstacle detected in real time.

障害物検知部110及び衝突回避制御部111は、車載電子制御ユニット18に備えられている。車載電子制御ユニット18は、コモンレールシステムに含まれたエンジン用の電子制御ユニット、ライダーセンサ101,102、及び、ソナーユニット103,104、等にCAN(Controller Area Network)を介して通信可能に接続されている。   The obstacle detection unit 110 and the collision avoidance control unit 111 are provided in the in-vehicle electronic control unit 18. The in-vehicle electronic control unit 18 is connected to an engine electronic control unit included in the common rail system, the rider sensors 101 and 102, the sonar units 103 and 104, and the like in a communicable manner via a CAN (Controller Area Network). ing.

ライダーセンサ101,102は、レーザ光(例えば、パルス状の近赤外レーザ光)が測定対象物に当たって跳ね返ってくるまでの往復時間から測定対象物までの距離を測定している(Time Of Flight)。ライダーセンサ101,102は、レーザ光を上下方向及び左右方向に高速で走査し、各走査角における測定対象物までの距離を順次測定していくことで、測定対象物までの距離を3次元で測定している。ライダーセンサ101,102は、測定範囲内における測定対象物までの距離をリアルタイムで繰り返し測定している。ライダーセンサ101,102は、測定情報から3次元画像を生成して外部に出力可能に構成されている。ライダーセンサ101,102の測定情報から生成された3次元画像は、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させて、ユーザ等に障害物の有無を視認させることができる。ちなみに、3次元画像では、例えば、色等を用いて遠近方向での距離を示すことができる。   The rider sensors 101 and 102 measure the distance from the round-trip time until the laser beam (for example, pulsed near-infrared laser beam) bounces off the measurement object to the measurement object (Time Of Flight). . The rider sensors 101 and 102 scan the laser beam at high speed in the vertical and horizontal directions at a high speed, and sequentially measure the distance to the measurement object at each scanning angle, so that the distance to the measurement object is three-dimensionally. Measuring. The rider sensors 101 and 102 repeatedly measure the distance to the measurement object within the measurement range in real time. The rider sensors 101 and 102 are configured to be able to generate a three-dimensional image from measurement information and output it to the outside. The three-dimensional image generated from the measurement information of the rider sensors 101 and 102 is displayed on a display device such as the display unit of the tractor 1 or the display unit 51 of the mobile communication terminal 3 so that the user or the like can visually recognize the presence or absence of an obstacle. be able to. By the way, in the three-dimensional image, for example, the distance in the perspective direction can be shown using color or the like.

ライダーセンサ101,102として、図11及び図12に示すように、トラクタ1(走行機体7)の前方側を測定範囲Cとし、トラクタ1の前方側での障害物を検知するために用いる前ライダーセンサ101と、トラクタ1(走行機体7)の後方側を測定範囲Dとし、トラクタ1の後方側での障害物を検知するために用いる後ライダーセンサ102とが備えられている。   As the rider sensors 101 and 102, as shown in FIG. 11 and FIG. 12, the front rider used for detecting an obstacle on the front side of the tractor 1 with the front side of the tractor 1 (running vehicle body 7) as the measurement range C A sensor 101 and a rear rider sensor 102 used for detecting an obstacle on the rear side of the tractor 1 with the rear side of the tractor 1 (the traveling machine body 7) as a measurement range D are provided.

以下、前ライダーセンサ101及び後ライダーセンサ102について説明するが、前ライダーセンサ101の支持構造、後ライダーセンサ102の支持構造、前ライダーセンサ101の測定範囲C、後ライダーセンサ102の測定範囲Dの順に説明する。   The front rider sensor 101 and the rear rider sensor 102 will be described below. The support structure of the front rider sensor 101, the support structure of the rear rider sensor 102, the measurement range C of the front rider sensor 101, and the measurement range D of the rear rider sensor 102 are described below. These will be described in order.

前ライダーセンサ101の支持構造について説明する。
前ライダーセンサ101は、図1及び図7に示すように、キャビン10の前面側の上部位置に配置されたアンテナユニット80の底部に取り付けられているので、まず、アンテナユニット80の支持構造について説明し、次に、アンテナユニット80の底部への前ライダーセンサ101の取り付け構造を説明する。
A support structure for the front rider sensor 101 will be described.
As shown in FIGS. 1 and 7, the front rider sensor 101 is attached to the bottom of the antenna unit 80 disposed at the upper position on the front side of the cabin 10. First, the support structure of the antenna unit 80 will be described. Next, a structure for attaching the front rider sensor 101 to the bottom of the antenna unit 80 will be described.

アンテナユニット80は、図4、図6及び図7に示すように、走行機体7の左右方向においてキャビン10の全長に亘るパイプ状のアンテナユニット支持ステー81に取り付けられている。アンテナユニット80は、走行機体7の左右方向においてキャビン10の中央部に相当する位置に配置されている。アンテナユニット支持ステー81は、キャビン10の左右斜め前方側に位置する左右のミラー取付部45に亘る状態で固定連結されている。ミラー取付部45は、前側支柱36に固定されたミラー取付用基材46と、ミラー取付用基材46に固定されたミラー取付用ブラケット47と、ミラー取付用ブラケット47に設けられたヒンジ部49により回動自在なミラー取付用アーム48とが備えられている。アンテナユニット支持ステー81は、図7に示すように、その左右両端側部位が下方側に湾曲されたブリッジ状に形成されている。アンテナユニット支持ステー81の左右両端部が、第1取付プレート201を介して、ミラー取付用ブラケット47の上端側部位に固定連結されている。図6及び図7に示すように、ミラー取付用ブラケット47の上端側部位には、水平面状の取付面が形成され、第1取付プレート201の下端側部位にも、水平面状の取付面が形成されている。両取付面を上下に重ね合わせる状態でボルトナット等の連結具50にて締結することで、アンテナユニット支持ステー81が水平方向に延びる姿勢で固定連結されている。アンテナユニット80は、アンテナユニット支持ステー81及びミラー取付部45を介して、キャビンフレーム31を構成する前側支柱36に支持されているので、アンテナユニット80への振動の伝達等を防止しながら、アンテナユニット80が強固に支持されている。   As shown in FIGS. 4, 6, and 7, the antenna unit 80 is attached to a pipe-shaped antenna unit support stay 81 that extends over the entire length of the cabin 10 in the left-right direction of the traveling machine body 7. The antenna unit 80 is disposed at a position corresponding to the central portion of the cabin 10 in the left-right direction of the traveling machine body 7. The antenna unit support stay 81 is fixedly connected in a state extending over the left and right mirror mounting portions 45 located on the left and right oblique front sides of the cabin 10. The mirror mounting portion 45 includes a mirror mounting base material 46 fixed to the front support column 36, a mirror mounting bracket 47 fixed to the mirror mounting base material 46, and a hinge portion 49 provided on the mirror mounting bracket 47. , And a mirror mounting arm 48 that is rotatable. As shown in FIG. 7, the antenna unit support stay 81 is formed in a bridge shape in which left and right end portions are curved downward. The left and right ends of the antenna unit support stay 81 are fixedly connected to the upper end side portion of the mirror mounting bracket 47 via the first mounting plate 201. As shown in FIGS. 6 and 7, a horizontal mounting surface is formed on the upper end portion of the mirror mounting bracket 47, and a horizontal mounting surface is also formed on the lower end portion of the first mounting plate 201. Has been. The antenna unit support stay 81 is fixedly connected in a posture extending in the horizontal direction by being fastened by a connecting tool 50 such as a bolt and nut in a state in which both mounting surfaces are superposed on each other. Since the antenna unit 80 is supported by the front column 36 constituting the cabin frame 31 via the antenna unit support stay 81 and the mirror mounting portion 45, the antenna unit 80 is prevented from transmitting vibration to the antenna unit 80 and the like. The unit 80 is firmly supported.

アンテナユニット支持ステー81に対するアンテナユニット80の取り付け構造については、図6及び図7に示すように、アンテナユニット80側に固定された第2取付プレート202とアンテナユニット支持ステー81側に固定された第3取付プレート203とをボルトナット等の連結具50により締結することで、アンテナユニット80がアンテナユニット支持ステー81に取り付けられている。   As shown in FIGS. 6 and 7, the mounting structure of the antenna unit 80 to the antenna unit support stay 81 is the second mounting plate 202 fixed to the antenna unit 80 side and the second mounting plate 202 fixed to the antenna unit support stay 81 side. The antenna unit 80 is attached to the antenna unit support stay 81 by fastening the 3 attachment plate 203 with a connector 50 such as a bolt and nut.

第2取付プレート202は、図7に示すように、走行機体7の左右方向に所定間隔を隔てて左右一対備えられている。第2取付プレート202は、左右方向に延びるユニット側取付部202aの外側端部から下方側に延びるステー側取付部202bを有するL字状に屈曲された板状体にて構成されている。第2取付プレート202は、ユニット側取付部202aが連結具50等によりアンテナユニット80の底部に固定連結され、ステー側取付部202bが下方側に延びる姿勢で取り付けられている。第2取付プレート202のステー側取付部202bには、図示は省略するが、連結具等による連結用の丸孔が前後一対形成されている。   As shown in FIG. 7, the second mounting plate 202 is provided as a pair on the left and right sides with a predetermined interval in the left-right direction of the traveling machine body 7. The second mounting plate 202 is configured by a plate-like body bent in an L shape having a stay side mounting portion 202b extending downward from an outer end portion of the unit side mounting portion 202a extending in the left-right direction. The second mounting plate 202 is mounted in such a manner that the unit side mounting portion 202a is fixedly connected to the bottom portion of the antenna unit 80 by the connector 50 or the like, and the stay side mounting portion 202b extends downward. Although not shown in the drawings, a pair of front and rear circular holes for connection by a connector or the like is formed in the stay side mounting portion 202b of the second mounting plate 202.

第3取付プレート203は、図6及び図7に示すように、前方側部位が後方側部位よりも下方側に延びるL字状の板状体にて構成されている。第3取付プレート203は、第2取付プレート202と同様に、走行機体7の左右方向に所定間隔を隔てて左右一対備えられている。第3取付プレート203は、後方側部位の下端縁が溶接等によりアンテナユニット支持ステー81の上部に固定連結され、前方側部位がアンテナユニット支持ステー81の前方側に位置する姿勢で取り付けられている。第3取付プレート203には、前方側部位から後方側部位に亘って走行機体7の前後方向に沿って延びる長尺な長孔203aが形成され、前方側部位の下方側に連結用の丸孔203bが形成されている。   As shown in FIGS. 6 and 7, the third mounting plate 203 is configured by an L-shaped plate-like body whose front side portion extends below the rear side portion. Similarly to the second mounting plate 202, the third mounting plate 203 is provided as a pair on the left and right sides with a predetermined interval in the left-right direction of the traveling machine body 7. The third attachment plate 203 is attached in such a manner that the lower end edge of the rear part is fixedly connected to the upper part of the antenna unit support stay 81 by welding or the like, and the front part is located on the front side of the antenna unit support stay 81. . The third mounting plate 203 is formed with a long elongated hole 203a extending along the front-rear direction of the traveling machine body 7 from the front side portion to the rear side portion, and a connecting round hole on the lower side of the front side portion. 203b is formed.

アンテナユニット80をアンテナユニット支持ステー81に取り付ける場合には、図6及び図7に示すように、アンテナユニット80を、アンテナユニット支持ステー81の上方側に配置させて、通信モジュール25のアンテナが上方側に延びる使用位置に位置させる。第2取付プレート202のステー側取付部202bにおける前後の丸孔を第3取付プレート203の長孔203aにおける前方側端部と後方側端部に合致させるように、第2取付プレート202を第3取付プレート203よりも内方側に位置させる状態で第2取付プレート202と第3取付プレート203とを重ね合わせる。第2取付プレート202の前後の丸孔と第3取付プレート203の長孔203aとに亘って連結具50を挿通させて締結することで、アンテナユニット80を使用位置にてアンテナユニット支持ステー81に取り付けることができる。このとき、長孔203aにおける前方側端部と後方側端部に相当する箇所が連結具50による連結箇所に設定されており、左右一対の第2取付プレート202及び第3取付プレート203の夫々における前方側部位と後方側部位との合計4箇所が連結具50による連結箇所となっている。   When the antenna unit 80 is attached to the antenna unit support stay 81, as shown in FIGS. 6 and 7, the antenna unit 80 is disposed above the antenna unit support stay 81, and the antenna of the communication module 25 is placed upward. It is located in the use position extending to the side. The second mounting plate 202 is connected to the third mounting plate 202 so that the front and rear round holes of the stay mounting portion 202b of the second mounting plate 202 are aligned with the front end and the rear end of the elongated hole 203a of the third mounting plate 203. The second mounting plate 202 and the third mounting plate 203 are overlapped with each other while being positioned on the inner side of the mounting plate 203. The coupling unit 50 is inserted and fastened across the round holes before and after the second mounting plate 202 and the long holes 203a of the third mounting plate 203, so that the antenna unit 80 is attached to the antenna unit support stay 81 at the use position. Can be attached. At this time, locations corresponding to the front end portion and the rear end portion of the long hole 203a are set as connection locations by the connector 50, and in each of the pair of left and right second mounting plates 202 and third mounting plates 203. A total of four locations including the front portion and the rear portion are connected portions by the connector 50.

アンテナユニット80は、図6に示すように、使用位置だけでなく、図8に示すように、アンテナユニット支持ステー81の前方側にアンテナユニット80を位置させて、通信モジュール25のアンテナが前方側に延びる非使用位置でも、アンテナユニット支持ステー81に取付自在に構成されている。   As shown in FIG. 6, the antenna unit 80 is located not only at the use position, but also at the front side of the antenna unit support stay 81 as shown in FIG. The antenna unit support stay 81 can be attached to the antenna unit support stay 81 even in a non-use position extending to the position.

アンテナユニット80を非使用位置にてアンテナユニット支持ステー81に取り付ける場合には、図8に示すように、アンテナユニット80を非使用位置に位置させ、第2取付プレート202のステー側取付部202bにおける前後の丸孔を第3取付プレート203の丸孔203bと長孔203aの前方側端部に合致させるように、第2取付プレート202を第3取付プレート203よりも内方側に位置させる状態で第2取付プレート202と第3取付プレート203とを重ね合わせる。第2取付プレート202のステー側取付部202bにおける前側の丸孔と第3取付プレート203の丸孔203bに亘って連結具50を挿通させるとともに、第2取付プレート202のステー側取付部202bにおける後側の丸孔と長孔203aの前方側端部とに亘って連結具50を挿通させて締結することで、アンテナユニット80を非使用位置にてアンテナユニット支持ステー81に取り付けることができる。   When the antenna unit 80 is attached to the antenna unit support stay 81 in the non-use position, as shown in FIG. 8, the antenna unit 80 is located in the non-use position and the second attachment plate 202 has a stay side attachment portion 202b. In a state in which the second mounting plate 202 is positioned inward of the third mounting plate 203 so that the front and rear circular holes are aligned with the front end portions of the circular holes 203b and the long holes 203a of the third mounting plate 203. The second mounting plate 202 and the third mounting plate 203 are overlapped. The connecting tool 50 is inserted through the front round hole in the stay side mounting portion 202b of the second mounting plate 202 and the round hole 203b in the third mounting plate 203, and the rear of the second mounting plate 202 in the stay side mounting portion 202b. The antenna unit 80 can be attached to the antenna unit support stay 81 at the non-use position by inserting and fastening the connector 50 across the side round hole and the front side end of the long hole 203a.

例えば、アンテナユニット80を使用位置(図6参照)から非使用位置(図8参照)に変更する場合には、図6に示すように、第3取付プレート203の長孔203aの前方側端部に位置する連結具50を取り外し、第3取付プレート203の長孔203aの後方側端部に位置する連結具50を緩めて、その連結具50を長孔203aに挿通させた状態を維持する。連結具50を長孔203aに沿って後方側端部から前方側端部まで前方側に移動操作して、連結具50を枢支軸としてアンテナユニット80を前方下方側に垂下させることで、図8に示すように、アンテナユニット80を非使用位置に位置変更させる。よって、第2取付プレート202の前側の丸孔と第3取付プレート203の丸孔203bに亘って連結具50を挿通させるとともに、第2取付プレート202の後側の丸孔と長孔203aの前方側端部とに亘って連結具50を挿通させて締結することができ、アンテナユニット80を使用位置から非使用位置に位置変更することができる。   For example, when the antenna unit 80 is changed from the use position (see FIG. 6) to the non-use position (see FIG. 8), as shown in FIG. 6, the front end of the long hole 203a of the third mounting plate 203 is used. The connecting tool 50 located at the rear is removed, the connecting tool 50 located at the rear end of the long hole 203a of the third mounting plate 203 is loosened, and the state where the connecting tool 50 is inserted into the long hole 203a is maintained. By moving the connector 50 forward along the long hole 203a from the rear side end to the front side end, the antenna unit 80 is suspended downwardly with the connector 50 as a pivot shaft. As shown in FIG. 8, the position of the antenna unit 80 is changed to the non-use position. Therefore, the connecting tool 50 is inserted through the round hole on the front side of the second mounting plate 202 and the round hole 203b on the third mounting plate 203, and the front side of the round hole on the rear side of the second mounting plate 202 and the long hole 203a. The connector 50 can be inserted and fastened over the side end portion, and the antenna unit 80 can be repositioned from the use position to the non-use position.

アンテナユニット80を使用位置にて取り付けた状態では、図9(a)に示すように、ルーフ35の最高部位35aを通る最高位線Zよりもアンテナユニット80の一部が上方側に突出しており、通信モジュール25のアンテナをより上方側に配置させることができ、通信モジュール25の無線通信を適切に行えるようにしている。それに対して、アンテナユニット80を非使用位置にて取り付けた状態では、図9(b)に示すように、アンテナユニット80の上端部を最高位線Zと同じ高さ位置又は最高位線Zよりも低い位置に配置させている。これにより、トラクタ1を輸送する際やトラクタ1を納屋等の収納箇所に収納する際に、アンテナユニット80が最高位線Zよりも上方側に突出することなく、アンテナユニット80が邪魔になったり、障害物等への接触によるアンテナユニット80の破損等が生じるのを防止することができる。   In a state where the antenna unit 80 is attached at the use position, as shown in FIG. 9A, a part of the antenna unit 80 protrudes upward from the highest level line Z passing through the highest part 35a of the roof 35. The antenna of the communication module 25 can be arranged on the upper side so that the wireless communication of the communication module 25 can be performed appropriately. On the other hand, when the antenna unit 80 is attached at the non-use position, the upper end of the antenna unit 80 is located at the same height position as the highest level line Z or the highest level line Z as shown in FIG. Is also placed at a low position. As a result, when the tractor 1 is transported or when the tractor 1 is stored in a storage location such as a barn, the antenna unit 80 does not protrude above the highest level line Z, and the antenna unit 80 becomes an obstacle. Further, it is possible to prevent the antenna unit 80 from being damaged due to contact with an obstacle or the like.

アンテナユニット80に対する前ライダーセンサ101の取り付け構造は、図7に示すように、第4取付プレート204及び第5取付プレート205を介して、ボルトナット等の連結具50により締結することで、前ライダーセンサ101がアンテナユニット80の底部に取り付けられている。第4取付プレート204は、左右方向に延びる取付面部204aを有し、取付面部204aの両端部が下方側に延設されたブリッジ状に形成されている。第5取付プレート205は、左右方向で対向する左右一対の取付面部205aを有し、取付面部205aの上端部同士が連結されたブリッジ状に形成されている。第4取付プレート204の取付面部204aが、連結具50によりアンテナユニット80の底部に固定連結されている。第4取付プレート204の前方側部位と第5取付プレート205の後方側部位とが連結具50により固定連結されている。第5取付プレート205の左右一対の取付面部205aが連結具50により前ライダーセンサ101の両横側部に固定連結されている。前ライダーセンサ101は、左右方向で第5取付プレート205の左右の取付面部205aにて挟み込まれる状態で取り付けられている。   As shown in FIG. 7, the mounting structure of the front rider sensor 101 to the antenna unit 80 is fastened by a connecting tool 50 such as a bolt and nut via a fourth mounting plate 204 and a fifth mounting plate 205, thereby A sensor 101 is attached to the bottom of the antenna unit 80. The fourth mounting plate 204 has a mounting surface portion 204a extending in the left-right direction, and is formed in a bridge shape in which both end portions of the mounting surface portion 204a extend downward. The fifth mounting plate 205 has a pair of left and right mounting surface portions 205a facing each other in the left-right direction, and is formed in a bridge shape in which upper end portions of the mounting surface portions 205a are connected to each other. The mounting surface portion 204 a of the fourth mounting plate 204 is fixedly connected to the bottom portion of the antenna unit 80 by the connector 50. A front side portion of the fourth mounting plate 204 and a rear side portion of the fifth mounting plate 205 are fixedly connected by the connector 50. A pair of left and right mounting surface portions 205 a of the fifth mounting plate 205 are fixedly connected to both lateral side portions of the front rider sensor 101 by the connector 50. The front rider sensor 101 is attached so as to be sandwiched between the left and right attachment surface portions 205a of the fifth attachment plate 205 in the left-right direction.

前ライダーセンサ101は、図7に示すように、第4取付プレート204及び第5取付プレート205を介して、アンテナユニット80に着脱自在に構成されている。前ライダーセンサ101を後付けすることも可能であり、前ライダーセンサ101だけを取り外すことも可能となっている。また、アンテナユニット80も、アンテナユニット支持ステー81を介して、ミラー取付部45に着脱自在に構成されているので、前ライダーセンサ101は、前ライダーセンサ101単体で走行機体7に対して着脱することができるとともに、アンテナユニット80とともに走行機体7に対して着脱することもできる。前ライダーセンサ101は、アンテナユニット80を支持するアンテナユニット支持ステー81等を共通の支持ステーとして利用しており、アンテナユニット80と同様に、前ライダーセンサ101への振動の伝達等を防止しながら強固に支持されている。   As shown in FIG. 7, the front rider sensor 101 is configured to be detachable from the antenna unit 80 via a fourth mounting plate 204 and a fifth mounting plate 205. The front rider sensor 101 can be retrofitted, and only the front rider sensor 101 can be removed. Further, since the antenna unit 80 is also detachably attached to the mirror attachment portion 45 via the antenna unit support stay 81, the front rider sensor 101 is attached to and detached from the traveling machine body 7 by the front rider sensor 101 alone. And can be attached to and detached from the traveling machine body 7 together with the antenna unit 80. The front rider sensor 101 uses an antenna unit support stay 81 and the like that support the antenna unit 80 as a common support stay, and, like the antenna unit 80, prevents transmission of vibration to the front rider sensor 101. Strongly supported.

前ライダーセンサ101は、アンテナユニット80に一体的に備えられているので、アンテナユニット80を使用位置と非使用位置との間で位置変更することで、図6に示すように、前ライダーセンサ101も、走行機体7の前方側を向いて走行機体7の前方側の障害物検知に使用される使用位置と、図8に示すように、下方側を向いて障害物検知に使用されない非使用位置とに位置変更自在に構成されている。   Since the front rider sensor 101 is provided integrally with the antenna unit 80, by changing the position of the antenna unit 80 between the use position and the non-use position, as shown in FIG. However, as shown in FIG. 8, the use position that is used for obstacle detection on the front side of the traveling machine body 7 and the non-use position that is not used for obstacle detection as shown in FIG. The position can be changed freely.

前ライダーセンサ101が使用位置に位置するときには、図6及び図9(a)に示すように、前ライダーセンサ101が、上下方向において、キャビン10(運転席39)への乗降部となる乗降ステップ41(図1参照)よりも高い位置で、ルーフ35に相当する位置に配置されている。前ライダーセンサ101は、前方側部位ほど下方側に位置する前下がり姿勢にて取り付けられている。前ライダーセンサ101は、走行機体7の前方側を斜め上方側から見下ろす状態で測定するように備えられている。アンテナユニット支持ステー81は、走行機体7の前後方向でルーフ35の前端部位35bと重複する位置で、且つ、上下方向でルーフ35の前端部位35bの近傍位置に配置されているので、前ライダーセンサ101は、アンテナユニット80の下方側空間を利用して、ルーフ35の前端部位35bに対して前方斜め上方側の近傍位置に配置されている。これにより、図11に示すように、運転席39に着座する搭乗者Tの視線から、前ライダーセンサ101の少なくとも一部がルーフ35の前端部位35bと重複することになる。前ライダーセンサ101の配置位置は、ルーフ35の前端部位35bにて前ライダーセンサ101の少なくとも一部が隠れる位置となっている。運転席39に着座する搭乗者Tの前方側の視認可能範囲B1から前ライダーセンサ101の一部が外れる位置に存在しており、運転席39に着座する搭乗者Tの視界が前ライダーセンサ101にて遮られるのを抑制することができる。   When the front rider sensor 101 is located at the use position, as shown in FIGS. 6 and 9A, the front rider sensor 101 serves as a boarding / alighting portion for the cabin 10 (driver's seat 39) in the vertical direction. It is disposed at a position higher than 41 (see FIG. 1) and corresponding to the roof 35. The front rider sensor 101 is attached in a front lowering posture that is located on the lower side as the front side portion is located. The front rider sensor 101 is provided to measure in a state where the front side of the traveling machine body 7 is looked down obliquely from the upper side. Since the antenna unit support stay 81 is disposed at a position overlapping the front end portion 35b of the roof 35 in the front-rear direction of the traveling machine body 7 and in the vicinity of the front end portion 35b of the roof 35 in the vertical direction, the front rider sensor 101 is disposed in the vicinity of the front obliquely upper side with respect to the front end portion 35 b of the roof 35 using the lower space of the antenna unit 80. Thus, as shown in FIG. 11, at least a part of the front rider sensor 101 overlaps with the front end portion 35 b of the roof 35 from the line of sight of the passenger T sitting on the driver's seat 39. The arrangement position of the front rider sensor 101 is a position where at least a part of the front rider sensor 101 is hidden at the front end portion 35 b of the roof 35. The front rider sensor 101 exists in a position where a part of the front rider sensor 101 deviates from the visible range B1 on the front side of the occupant T seated in the driver's seat 39. Can be prevented from being blocked.

前ライダーセンサ101が非使用位置に位置するときには、図8及び図9(b)に示すように、アンテナユニット80と同様に、前ライダーセンサ101の上端部を最高位線Z(図9(b)参照)よりも低い位置に配置させている。これにより、トラクタ1を輸送する際やトラクタ1を納屋等の収納箇所に収納する際に、アンテナユニット80だけでなく、前ライダーセンサ101も最高位線Zよりも上方側に突出するのを防止している。   When the front rider sensor 101 is located at the non-use position, as shown in FIGS. 8 and 9B, the upper end portion of the front rider sensor 101 is placed at the highest level line Z (FIG. 9B) as in the antenna unit 80. ) Refer to the above)). Thereby, when transporting the tractor 1 or when storing the tractor 1 in a storage location such as a barn, not only the antenna unit 80 but also the front rider sensor 101 is prevented from protruding above the highest level line Z. is doing.

前ライダーセンサ101の配置位置について、走行機体7の左右方向では、アンテナユニット80の左右方向の中央部に配置されている。アンテナユニット80は、走行機体7の左右方向においてキャビン10の中央部に相当する位置に配置されているので、前ライダーセンサ101も、走行機体7の左右方向においてキャビン10の中央部に相当する位置に配置されている。   About the arrangement position of the front rider sensor 101, it is arrange | positioned in the center part of the left-right direction of the antenna unit 80 in the left-right direction of the traveling body 7. FIG. Since the antenna unit 80 is disposed at a position corresponding to the central portion of the cabin 10 in the left-right direction of the traveling aircraft body 7, the front rider sensor 101 is also a position corresponding to the central portion of the cabin 10 in the lateral direction of the traveling aircraft body 7. Is arranged.

第5取付プレート205には、図6及び図7に示すように、前ライダーセンサ101に加えて、走行機体7の前方側を撮像範囲とする前カメラ108が連結具等により取り付けられている。前カメラ108は、前ライダーセンサ101の上方側に配置されている。前カメラ108は、前ライダーセンサ101と同様に、前方側部位ほど下方側に位置する前下がり姿勢にて取り付けられている。前カメラ108は、走行機体7の前方側を斜め上方側から見下ろす状態で撮像するように備えられている。前カメラ108にて撮像した撮像画像を外部に出力可能に構成されている。前カメラ108の撮像画像は、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させて、ユーザ等にトラクタ1の周囲の状況を視認させることができる。   As shown in FIGS. 6 and 7, in addition to the front rider sensor 101, a front camera 108 whose imaging range is the front side of the traveling machine body 7 is attached to the fifth mounting plate 205 by a connector or the like. The front camera 108 is disposed above the front rider sensor 101. Similar to the front rider sensor 101, the front camera 108 is attached in a front-down posture that is located on the lower side as the front side portion is located. The front camera 108 is provided so as to take an image in a state where the front side of the traveling machine body 7 is looked down obliquely from above. A captured image captured by the front camera 108 can be output to the outside. The captured image of the front camera 108 can be displayed on a display device such as the display unit of the tractor 1 or the display unit 51 of the mobile communication terminal 3 so that a user or the like can visually recognize the situation around the tractor 1.

次に、後ライダーセンサ102の支持構造について説明する。
後ライダーセンサ102は、図5及び図10に示すように、走行機体7の左右方向においてキャビン10の全長に亘るパイプ状のセンサ支持ステー301に取り付けられている。後ライダーセンサ102は、走行機体7の左右方向においてキャビン10の中央部に相当する位置に配置されている。
Next, a support structure for the rear rider sensor 102 will be described.
As shown in FIGS. 5 and 10, the rear rider sensor 102 is attached to a pipe-like sensor support stay 301 over the entire length of the cabin 10 in the left-right direction of the traveling machine body 7. The rear rider sensor 102 is disposed at a position corresponding to the central portion of the cabin 10 in the left-right direction of the traveling machine body 7.

センサ支持ステー301は、図5及び図10に示すように、キャビン10の左右両端部に位置する左右の後側支柱37に亘る状態で固定連結されている。センサ支持ステー301は、その左右両端側部位が斜め前方側に湾曲された平面視でブリッジ状に形成されている。センサ支持ステー301の左右両端部は、第6取付プレート206を介して、左右の後側支柱37の上端側部位に備えられた取付部材に固定連結されている。センサ支持ステー301の左右両端部には、溶接等により第6取付プレート206が固定連結されている。第6取付プレート206と後側支柱37の上端側部位に備えられた取付部材とを連結具50にて締結することで、センサ支持ステー301が水平方向に延びる姿勢で固定連結されている。   As shown in FIGS. 5 and 10, the sensor support stay 301 is fixedly connected so as to extend over the left and right rear columns 37 located at the left and right ends of the cabin 10. The sensor support stay 301 is formed in a bridge shape in a plan view in which the left and right ends are curved obliquely forward. The left and right end portions of the sensor support stay 301 are fixedly connected to attachment members provided at upper end portions of the left and right rear columns 37 via a sixth attachment plate 206. A sixth mounting plate 206 is fixedly connected to the left and right ends of the sensor support stay 301 by welding or the like. The sensor support stay 301 is fixedly connected in a posture extending in the horizontal direction by fastening the sixth mounting plate 206 and a mounting member provided at an upper end side portion of the rear column 37 with the connecting tool 50.

センサ支持ステー301に対する後ライダーセンサ102の取り付け構造は、図10に示すように、第7取付プレート207及び第8取付プレート208を介して、後ライダーセンサ102がセンサ支持ステー301に取り付けられている。第7取付プレート207は、左右方向で対向する左右一対の側壁面部207aを有し、側壁面部207aの上端部同士が連結されたブリッジ状に形成されている。第8取付プレート208は、左右方向で対向する左右一対の取付面部208aを有し、取付面部208aの上端部同士が連結されたブリッジ状に形成されている。第7取付プレート207の側壁面部207aにおける下端縁が溶接等によりセンサ支持ステー301に固定連結されている。第7取付プレート207の後方側部位と第8取付プレート208の前方側部位とが連結具50により固定連結されている。第8取付プレート208の左右一対の取付面部208aが連結具50により後ライダーセンサ102の両横側部に固定連結されている。後ライダーセンサ102は、左右方向で第8取付プレート208の左右の取付面部208aにて挟み込まれる状態で取り付けられている。第7取付プレート207の前方側部位には、補強プレート302が連結具等により固定連結されている。補強プレート302の前方側部位がルーフ35の上面部に連結具50により固定連結されている。補強プレート302は、左右方向の両側端部を上方側に折り曲げた起立壁を有するU字状で前後方向に延びており、ルーフ35と第7取付プレート207及びセンサ支持ステー301とに亘る状態で備えられている。   As shown in FIG. 10, the rear rider sensor 102 is attached to the sensor support stay 301 via a seventh attachment plate 207 and an eighth attachment plate 208 as shown in FIG. . The seventh mounting plate 207 has a pair of left and right side wall surface portions 207a facing each other in the left and right direction, and is formed in a bridge shape in which upper end portions of the side wall surface portions 207a are connected to each other. The eighth mounting plate 208 has a pair of left and right mounting surface portions 208a facing each other in the left-right direction, and is formed in a bridge shape in which the upper end portions of the mounting surface portion 208a are connected to each other. The lower end edge of the side wall surface portion 207a of the seventh mounting plate 207 is fixedly connected to the sensor support stay 301 by welding or the like. The rear part of the seventh mounting plate 207 and the front part of the eighth mounting plate 208 are fixedly connected by the connector 50. A pair of left and right mounting surface portions 208 a of the eighth mounting plate 208 are fixedly connected to both lateral side portions of the rear rider sensor 102 by the connector 50. The rear rider sensor 102 is attached so as to be sandwiched between the left and right attachment surface portions 208a of the eighth attachment plate 208 in the left-right direction. A reinforcing plate 302 is fixedly connected to the front portion of the seventh mounting plate 207 by a connector or the like. A front side portion of the reinforcing plate 302 is fixedly connected to the upper surface portion of the roof 35 by a connecting tool 50. The reinforcing plate 302 extends in the front-rear direction in a U-shape having an upright wall with both side ends in the left-right direction bent upward, and extends across the roof 35, the seventh mounting plate 207, and the sensor support stay 301. Is provided.

後ライダーセンサ102は、図9(b)及び図10に示すように、上下方向において、乗降ステップ41(図1参照)よりも高い位置で、ルーフ35に相当する位置に配置されている。後ライダーセンサ102は、後方側部位ほど下方側に位置する後下がり姿勢にてセンサ支持ステー301に取り付けられている。後ライダーセンサ102は、走行機体7の後方側を斜め上方側から見下ろす状態で測定するように備えられている。センサ支持ステー301は、走行機体7の前後方向でルーフ35の後端部位35cの近傍位置で、且つ、上下方向でルーフ35の後端部位35cと重複する位置に配置されているので、後ライダーセンサ102は、ルーフ35の後端部位35cに対して略同じ高さ又はそれよりも後方斜め上方側の近傍位置に配置されている。これにより、図11に示すように、運転席39に着座する搭乗者Tの視線から、後ライダーセンサ102の少なくとも一部がルーフ35の後端部位35cと重複することになる。後ライダーセンサ102の配置位置は、ルーフ35の後端部位35cにて後ライダーセンサ102の少なくとも一部が隠れる位置となっている。運転席39に着座する搭乗者Tにおいて、後方側の視認可能範囲B2から後ライダーセンサ102の一部が外れる位置に存在しており、運転席39に着座する搭乗者Tの視界が後ライダーセンサ102にて遮られるのを抑制することができる。   As shown in FIGS. 9B and 10, the rear rider sensor 102 is disposed at a position higher than the getting-on / off step 41 (see FIG. 1) and in a position corresponding to the roof 35 in the vertical direction. The rear rider sensor 102 is attached to the sensor support stay 301 in a rearwardly lowered posture that is located on the lower side as the rear side portion is located. The rear rider sensor 102 is provided so as to perform measurement in a state where the rear side of the traveling machine body 7 is looked down obliquely from above. The sensor support stay 301 is disposed in the vicinity of the rear end portion 35c of the roof 35 in the front-rear direction of the traveling machine body 7 and at the position overlapping the rear end portion 35c of the roof 35 in the vertical direction. The sensor 102 is disposed at substantially the same height with respect to the rear end portion 35c of the roof 35 or at a position in the vicinity of the rear obliquely upper side. Accordingly, as shown in FIG. 11, at least a part of the rear rider sensor 102 overlaps with the rear end portion 35 c of the roof 35 from the line of sight of the passenger T sitting on the driver's seat 39. The rear rider sensor 102 is disposed at a position where at least a part of the rear rider sensor 102 is hidden at the rear end portion 35 c of the roof 35. The occupant T seated in the driver's seat 39 is located at a position where a part of the rear rider sensor 102 deviates from the rear viewable range B2, and the view of the occupant T seated in the driver's seat 39 is the rear rider sensor. Blocking at 102 can be suppressed.

後ライダーセンサ102は、図10に示すように、センサ支持ステー301、第7取付プレート207及び第8取付プレート208を介して、後側支柱37に着脱自在に構成されている。後ライダーセンサ102を後付けすることも可能であり、後ライダーセンサ102を取り外すことも可能となっている。後ライダーセンサ102は、センサ支持ステー301を介して、キャビンフレーム31を構成する後側支柱37に支持されているので、後ライダーセンサ102への振動の伝達等を防止しながら強固に支持されている。   As shown in FIG. 10, the rear rider sensor 102 is configured to be detachable from the rear column 37 via a sensor support stay 301, a seventh mounting plate 207, and an eighth mounting plate 208. The rear rider sensor 102 can be retrofitted, and the rear rider sensor 102 can be removed. Since the rear rider sensor 102 is supported by the rear column 37 constituting the cabin frame 31 via the sensor support stay 301, the rear rider sensor 102 is firmly supported while preventing transmission of vibration to the rear rider sensor 102. Yes.

第8取付プレート208には、図10に示すように、後ライダーセンサ102に加えて、走行機体7の後方側を撮像範囲とする後カメラ109が連結具等により取り付けられている。後カメラ109は、後ライダーセンサ102の上方側に配置されている。後カメラ109は、後ライダーセンサ102と同様に、後方側部位ほど下方側に位置する後下がり姿勢にて取り付けられている。後カメラ109は、走行機体7の後方側を斜め上方側から見下ろす状態で撮像するように備えられている。後カメラ109にて撮像した撮像画像を外部に出力可能に構成されている。後カメラ109の撮像画像は、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させて、ユーザ等にトラクタ1の周囲の状況を視認させることができる。   As shown in FIG. 10, in addition to the rear rider sensor 102, a rear camera 109 whose imaging range is the rear side of the traveling machine body 7 is attached to the eighth mounting plate 208 by a connector or the like. The rear camera 109 is disposed above the rear rider sensor 102. Similar to the rear rider sensor 102, the rear camera 109 is attached in a rear-lowering posture that is located on the lower side as the rear part is located. The rear camera 109 is provided so as to take an image in a state where the rear side of the traveling machine body 7 is looked down obliquely from above. A captured image captured by the rear camera 109 can be output to the outside. The captured image of the rear camera 109 can be displayed on a display device such as the display unit of the tractor 1 or the display unit 51 of the mobile communication terminal 3 so that a user or the like can visually recognize the situation around the tractor 1.

前ライダーセンサ101の測定範囲Cについて説明する。
前ライダーセンサ101は、図12に示すように、左右方向における左右測定範囲C1を有しているとともに、図11に示すように、上下方向における上下測定範囲C2を有している。これにより、前ライダーセンサ101は、自己から第1設定距離X1(図12参照)だけ離れた位置までの範囲において、左右測定範囲C1と上下測定範囲C2に含まれる上下、左右及び前後の四角錐形状の測定範囲Cが設定されている。
The measurement range C of the front rider sensor 101 will be described.
As shown in FIG. 12, the front rider sensor 101 has a left / right measurement range C1 in the left / right direction, and also has an up / down measurement range C2 in the up / down direction as shown in FIG. As a result, the front rider sensor 101 has a quadrangular pyramid that is included in the left / right measurement range C1 and the vertical measurement range C2 in the range from the self to the position separated by the first set distance X1 (see FIG. 12). A shape measurement range C is set.

前ライダーセンサ101における左右測定範囲C1は、図12に示すように、走行機体7の左右方向において走行機体7の左右中心線を対称軸とする左右対称な範囲である。左右測定範囲C1は、前ライダーセンサ101から延びる第1境界線E1と第2境界線E2との間の第1設定角度α1の範囲に設定されている。左右測定範囲C1は、走行機体7の横幅方向において、トラクタ1の横幅、及び、作業装置12の横幅よりも大きな範囲に設定されている。左右測定範囲C1は、どのような大きさの範囲とするかは適宜変更が可能である。   As shown in FIG. 12, the left-right measurement range C1 in the front rider sensor 101 is a left-right symmetric range with the left-right center line of the traveling aircraft body 7 as the symmetry axis in the left-right direction of the traveling aircraft body 7. The left / right measurement range C1 is set to a range of a first set angle α1 between a first boundary line E1 and a second boundary line E2 extending from the front rider sensor 101. The lateral measurement range C <b> 1 is set to be larger than the lateral width of the tractor 1 and the lateral width of the work device 12 in the lateral width direction of the traveling machine body 7. The size of the left and right measurement range C1 can be changed as appropriate.

前ライダーセンサ101における上下測定範囲C2は、図11に示すように、前ライダーセンサ101から延びる第3境界線E3と第4境界線E4との間の第2設定角度α2の範囲に設定されている。第3境界線E3は、前ライダーセンサ101から前方側に水平方向に沿って延びる水平線に設定され、第4境界線E4は、前ライダーセンサ101から前輪5の前上部への第1接線G1よりも下方側に位置する直線に設定されている。上下測定範囲C2は、第3境界線E3と第4境界線E4との間の第1中心線F1が、ボンネット8よりも上方側に位置するように設定されており、ボンネット8の上方側に十分な大きさの測定範囲を確保している。第4境界線E4を第1接線G1よりも下方側に設定することで、走行機体7の前方側端部(ボンネット8の前方側端部)の近傍位置等に物体や人等の測定対象物が存在していても、その測定対象物を測定可能としている。   As shown in FIG. 11, the vertical measurement range C2 in the front rider sensor 101 is set to a range of a second set angle α2 between the third boundary line E3 and the fourth boundary line E4 extending from the front rider sensor 101. Yes. The third boundary line E3 is set as a horizontal line extending in the horizontal direction forward from the front rider sensor 101, and the fourth boundary line E4 is based on a first tangent line G1 from the front rider sensor 101 to the front upper portion of the front wheel 5. Is also set to a straight line located on the lower side. The vertical measurement range C2 is set so that the first center line F1 between the third boundary line E3 and the fourth boundary line E4 is located above the bonnet 8. A sufficiently large measuring range is secured. By setting the fourth boundary line E4 below the first tangent line G1, a measurement object such as an object or a person is positioned near the front end of the traveling machine body 7 (the front end of the bonnet 8). Even if exists, the measurement object can be measured.

前ライダーセンサ101における上下測定範囲C2には、図11に示すように、ボンネット8の一部、及び、前輪5の一部が入り込んでいるので、障害物検知部110が、前ライダーセンサ101の測定情報に基づいて障害物検知処理を行うと、ボンネット8の一部や前輪5の一部を障害物として誤検知してしまう可能性がある。そこで、その誤検知を防止するための第1マスキング処理が施されている。第1マスキング処理では、前ライダーセンサ101の測定範囲C内において、ボンネット8の一部及び前輪5の一部が存在する範囲を、障害物としての検知を行わないマスキング範囲L(図13参照)として予め設定している。   As shown in FIG. 11, a part of the bonnet 8 and a part of the front wheel 5 enter the vertical measurement range C <b> 2 in the front rider sensor 101. If the obstacle detection process is performed based on the measurement information, a part of the hood 8 or a part of the front wheel 5 may be erroneously detected as an obstacle. Therefore, a first masking process for preventing the erroneous detection is performed. In the first masking process, in the measurement range C of the front rider sensor 101, a masking range L in which a part of the hood 8 and a part of the front wheel 5 are present is not detected as an obstacle (see FIG. 13). Is set in advance.

例えば、第1マスキング処理では、前ライダーセンサ101を使用する前処理として、実際に前ライダーセンサ101による測定を行い、そのときの測定情報から生成した3次元画像を、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させる。ユーザ等が、表示装置の3次元画像を確認しながら、表示装置を操作することで、障害物としての検知を行わないマスキング範囲Lを設定している。図13に示すように、3次元画像上に、ボンネット8の一部、及び、前輪5の一部が存在していると、そのボンネット8の一部が存在する範囲La、及び、前輪5の一部が存在する範囲Lbを含む基準範囲に基づいて、マスキング範囲Lを設定している。前輪5は、図13中点線にて示すように、ステアリングホイール38やパワーステアリング機構14等の操作によって左右に操舵されるので、前輪5が左右に操舵される操舵範囲も含むように、マスキング範囲Lを設定するのが好ましい。   For example, in the first masking process, as a pre-process using the front rider sensor 101, a measurement is actually performed by the front rider sensor 101, and a three-dimensional image generated from the measurement information at that time is displayed on the display unit of the tractor 1 or a mobile phone. The information is displayed on a display device such as the display unit 51 of the communication terminal 3. A user or the like operates the display device while confirming a three-dimensional image of the display device, thereby setting a masking range L in which detection as an obstacle is not performed. As shown in FIG. 13, if a part of the bonnet 8 and a part of the front wheel 5 are present on the three-dimensional image, a range La in which a part of the bonnet 8 is present and the front wheel 5. The masking range L is set based on a reference range including a partially existing range Lb. As shown by the dotted line in FIG. 13, the front wheel 5 is steered left and right by operating the steering wheel 38, the power steering mechanism 14 and the like, so that the masking range includes the steering range in which the front wheel 5 is steered left and right. It is preferable to set L.

図13に示すものでは、ボンネット8の一部が存在する範囲La、及び、前輪5の一部が存在する範囲Lbを含む基準範囲よりも設定範囲だけ大きな山形形状の範囲をマスキング範囲Lとして設定している。ちなみに、マスキング範囲Lは、前後方向、左右方向及び上下方向の3次元での範囲に設定されている。マスキング範囲Lについては、例えば、ボンネット8の一部が存在する範囲La、及び、前輪5の一部が存在する範囲Lbだけを含むように、ボンネット8や前輪5の形状に応じた形状に設定することもでき、マスキング範囲Lをどのような範囲及び形状とするかは適宜変更が可能である。   In the example shown in FIG. 13, a chevron-shaped range larger than the reference range including the range La in which a part of the bonnet 8 exists and the range Lb in which a part of the front wheel 5 exists is set as the masking range L. is doing. Incidentally, the masking range L is set to a three-dimensional range in the front-rear direction, the left-right direction, and the up-down direction. For example, the masking range L is set to a shape corresponding to the shape of the hood 8 or the front wheel 5 so as to include only the range La where a part of the bonnet 8 exists and the range Lb where a part of the front wheel 5 exists. The range and shape of the masking range L can be appropriately changed.

このようにして、障害物検知部110は、前ライダーセンサ101の測定情報に基づいて障害物検知処理を行うことで、左右方向で左右測定範囲C1(図12参照)に含まれ、且つ、上下方向で上下測定範囲C2(図11参照)に含まれる範囲において、マスキング範囲Lを除く範囲にて障害物の存否を検知している。   In this way, the obstacle detection unit 110 is included in the left / right measurement range C1 (see FIG. 12) in the left / right direction by performing the obstacle detection process based on the measurement information of the front rider sensor 101, and In the range included in the vertical measurement range C2 (see FIG. 11) in the direction, the presence or absence of an obstacle is detected in a range excluding the masking range L.

後ライダーセンサ102の測定範囲Dについて説明する。
後ライダーセンサ102は、前ライダーセンサ101と同様に、図12に示すように、左右方向における左右測定範囲D1を有しているとともに、図11に示すように、上下方向における上下測定範囲D2を有している。これにより、後ライダーセンサ102は、自己から第3設定距離X3(図12参照)だけ離れた位置までの範囲において、左右測定範囲D1と上下測定範囲D2に含まれる上下、左右及び前後の四角錐形状の測定範囲Dが設定されている。ちなみに、X1とX3は、同じ距離に設定したり、異なる距離に設定することもできる。
The measurement range D of the rear rider sensor 102 will be described.
Like the front rider sensor 101, the rear rider sensor 102 has a left / right measurement range D1 in the left / right direction as shown in FIG. 12, and an up / down measurement range D2 in the up / down direction as shown in FIG. Have. As a result, the rear rider sensor 102 has a quadrangular pyramid that is included in the left and right measurement range D1 and the vertical measurement range D2 in the range from the self to the position separated by the third set distance X3 (see FIG. 12). A shape measurement range D is set. Incidentally, X1 and X3 can be set to the same distance or different distances.

後ライダーセンサ102における左右測定範囲D1は、図12に示すように、前ライダーセンサ101と同様に、後ライダーセンサ102から延びる第5境界線E5と第6境界線E6との間の第3設定角度α3の範囲に設定されている。左右測定範囲D1は、前ライダーセンサ101と同様に、走行機体7の横幅方向において、トラクタ1の横幅、及び、作業装置12の横幅よりも大きな範囲に設定されている。   As shown in FIG. 12, the left and right measurement range D1 in the rear rider sensor 102 is set to a third setting between the fifth boundary line E5 and the sixth boundary line E6 extending from the rear rider sensor 102, as in the front rider sensor 101. The angle α3 is set in a range. Similar to the front rider sensor 101, the left / right measurement range D <b> 1 is set to a range larger than the lateral width of the tractor 1 and the lateral width of the work device 12 in the lateral width direction of the traveling machine body 7.

後ライダーセンサ102における上下測定範囲D2は、図11に示すように、後ライダーセンサ102から延びる第7境界線E7と第8境界線E8との間の第4設定角度α4の範囲に設定されている。作業装置12は、上昇位置と下降位置との間で昇降自在に備えられているので、図11では、下降位置に位置する作業装置12を実線にて示しており、上昇位置に位置する作業装置12を点線にて示している。第7境界線E7は、後ライダーセンサ102から後方側に水平方向に沿って延びる水平線に設定され、第8境界線E8は、後ライダーセンサ102から下降位置に位置する作業装置12の後上部に向かう第2接線G2よりも下方側に位置する直線に設定されている。上下測定範囲D2は、第7境界線E7と第8境界線E8との間の第2中心線F2が、上昇位置の作業装置12(図11中点線にて示す)よりも上方側に位置するように設定されており、上昇位置の作業装置12の上方側に十分な大きさの測定範囲を確保している。第8境界線E8を第2接線G2よりも下方側に設定することで、下降位置の作業装置12の後方側端部の近傍位置等に物体や人等の測定対象物が存在していても、その測定対象物を測定可能としている。   As shown in FIG. 11, the vertical measurement range D2 in the rear rider sensor 102 is set to a range of a fourth set angle α4 between the seventh boundary line E7 and the eighth boundary line E8 extending from the rear rider sensor 102. Yes. Since the working device 12 is provided so as to freely move up and down between the raised position and the lowered position, in FIG. 11, the working device 12 located at the lowered position is indicated by a solid line, and the working device located at the raised position. 12 is indicated by a dotted line. The seventh boundary line E7 is set as a horizontal line extending in the horizontal direction rearward from the rear rider sensor 102, and the eighth boundary line E8 is formed at the rear upper part of the work device 12 located at the lowered position from the rear rider sensor 102. It is set to a straight line located below the second tangent line G2 that faces. In the vertical measurement range D2, the second center line F2 between the seventh boundary line E7 and the eighth boundary line E8 is located above the working device 12 in the ascending position (shown by a dotted line in FIG. 11). Thus, a sufficiently large measurement range is secured on the upper side of the working device 12 in the raised position. By setting the eighth boundary line E8 below the second tangent line G2, even if there is a measurement object such as an object or a person in the vicinity of the rear end of the working device 12 at the lowered position, etc. The measurement object can be measured.

後ライダーセンサ102における上下測定範囲D2には、作業装置12の一部が入り込んでいるので、障害物検知部110が、後ライダーセンサ102の測定情報に基づいて障害物検知処理を行うと、作業装置12の一部を障害物として誤検知してしまう可能性がある。そこで、その誤検知を防止するための第2マスキング処理が施されている。第2マスキング処理では、後ライダーセンサ102の測定範囲D内において、作業装置12の一部が存在する範囲を、障害物としての検知を行わないマスキング範囲L(図14、図15参照)として予め設定している。   Since a part of the work device 12 enters the vertical measurement range D2 of the rear rider sensor 102, when the obstacle detection unit 110 performs the obstacle detection process based on the measurement information of the rear rider sensor 102, the work is performed. There is a possibility that a part of the device 12 is erroneously detected as an obstacle. Therefore, a second masking process for preventing the erroneous detection is performed. In the second masking process, a range in which a part of the work device 12 exists within the measurement range D of the rear rider sensor 102 is preliminarily set as a masking range L (see FIGS. 14 and 15) in which detection as an obstacle is not performed. It is set.

例えば、第2マスキング処理では、第1マスキング処理と同様に、後ライダーセンサ102を使用する前処理として、実際に後ライダーセンサ102による測定を行い、そのときの測定情報から生成した3次元画像を、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させる。ユーザ等が、表示装置の3次元画像を確認しながら、表示装置を操作することで、障害物を検知しないマスキング範囲Lを設定している。   For example, in the second masking process, similarly to the first masking process, as a pre-process for using the rear rider sensor 102, a measurement is actually performed by the rear rider sensor 102, and a three-dimensional image generated from the measurement information at that time is generated. The information is displayed on a display device such as the display unit of the tractor 1 or the display unit 51 of the mobile communication terminal 3. A user or the like sets a masking range L in which an obstacle is not detected by operating the display device while checking a three-dimensional image of the display device.

作業装置12は、図12に示すように、下降位置と上昇位置(図中、点線にて示す位置)との間で昇降される。トラクタ1は、作業装置12を下降位置に下降させて所定の作業を行いながら走行し、作業装置12を上昇位置に上昇させて所定の作業を行わずに走行だけを行う。そこで、第2マスキング処理では、マスキング範囲Lとして、図14に示すように、下降位置用のマスキング範囲L1と、図15に示すように、上昇位置用のマスキング範囲L2とを設定している。図14及び図15において、作業装置12について、後ライダーセンサ102の測定範囲D内に存在する部分を実線にて示しており、後ライダーセンサ102の測定範囲D外に存在する部分を点線にて示している。キャビン10内の昇降用の操作具を操作することで、作業装置12を下降位置に位置させ、そのときの後ライダーセンサ102の測定情報から生成される3次元画像を用いて、下降位置用のマスキング範囲L1を設定している。キャビン10内の昇降用の操作具を操作することで、作業装置12を上昇位置に位置させ、そのときの後ライダーセンサ102の測定情報から生成される3次元画像を用いて、上昇位置用のマスキング範囲L2を設定している。   As shown in FIG. 12, the working device 12 is raised and lowered between a lowered position and a raised position (position indicated by a dotted line in the figure). The tractor 1 travels while performing the predetermined work by lowering the working device 12 to the lowered position, and performs only traveling without raising the working device 12 to the raised position and performing the predetermined work. Thus, in the second masking process, as the masking range L, a masking range L1 for the lowered position is set as shown in FIG. 14, and a masking range L2 for the raised position is set as shown in FIG. 14 and 15, with respect to the work device 12, a portion existing within the measurement range D of the rear rider sensor 102 is indicated by a solid line, and a portion existing outside the measurement range D of the rear rider sensor 102 is indicated by a dotted line. Show. By operating the lifting / lowering operation tool in the cabin 10, the work device 12 is positioned at the lowered position, and the three-dimensional image generated from the measurement information of the rear rider sensor 102 at that time is used to lower the working position. A masking range L1 is set. By operating the lifting and lowering operation tool in the cabin 10, the work device 12 is positioned at the raised position, and the three-dimensional image generated from the measurement information of the rear rider sensor 102 at that time is used for the raised position. A masking range L2 is set.

図14及び図15に示すものでは、作業装置12が存在する範囲Lcを含む基準範囲よりも設定範囲だけ大きな矩形状の範囲をマスキング範囲L1,L2として設定している。ちなみに、マスキング範囲Lは、前後方向、左右方向及び上下方向の3次元での範囲に設定されている。マスキング範囲Lについては、例えば、作業装置12が存在する範囲Lcだけを含むように、作業装置12の形状に応じた形状に設定することもでき、マスキング範囲L1,L2をどのような範囲及び形状とするかは適宜変更が可能である。   14 and 15, rectangular ranges larger than the reference range including the range Lc in which the work device 12 exists are set as masking ranges L1 and L2. Incidentally, the masking range L is set to a three-dimensional range in the front-rear direction, the left-right direction, and the up-down direction. The masking range L can be set to a shape according to the shape of the work device 12 so as to include only the range Lc where the work device 12 exists, and the masking ranges L1 and L2 can be set to any range and shape. It can be changed as appropriate.

このようにして、障害物検知部110は、後ライダーセンサ102の測定情報に基づいて障害物検知処理を行うことで、左右方向で左右測定範囲D1(図12参照)に含まれ、且つ、上下方向で上下測定範囲D2(図11参照)に含まれる範囲において、マスキング範囲L1,L2を除く範囲にて障害物の存否を検知している。障害物検知部110は、作業装置12が下降位置に位置するときには、下降位置用のマスキング範囲L1を用いて障害物検知処理を行っており、作業装置12が上昇位置に位置するときには、上昇位置用のマスキング範囲L2を用いて障害物検知処理を行っている。   In this way, the obstacle detection unit 110 performs the obstacle detection processing based on the measurement information of the rear rider sensor 102, so that it is included in the left / right measurement range D1 (see FIG. 12) in the left / right direction, and In the range included in the vertical measurement range D2 (see FIG. 11) in the direction, the presence or absence of an obstacle is detected in a range excluding the masking ranges L1 and L2. The obstacle detection unit 110 performs the obstacle detection process using the masking range L1 for the lowered position when the work device 12 is located at the lowered position, and the raised position when the work device 12 is located at the raised position. Obstacle detection processing is performed using the masking range L2.

以下、ソナーユニット103,104について説明する。
ソナーユニット103,104は、投射した超音波が測定対象物に当たって跳ね返ってくるまでの往復時間から測定対象物までの距離を測定するように構成されている。ソナーユニット103,104は、測定範囲内に、何らかの物体が測定対象物として存在すると、その測定対象物を障害物として検知し、障害物までの距離を測定するように構成されている。
Hereinafter, the sonar units 103 and 104 will be described.
The sonar units 103 and 104 are configured to measure the distance from the round trip time until the projected ultrasonic wave bounces off the measurement object and bounces back to the measurement object. The sonar units 103 and 104 are configured to detect a measurement object as an obstacle and measure the distance to the obstacle when any object is present as the measurement object in the measurement range.

ソナーユニット103,104として、図12に示すように、トラクタ1(走行機体7)の右側を測定範囲とする右側のソナーユニット103と、図12に示すように、トラクタ1(走行機体7)の左側を測定範囲とする左側のソナーユニット104とが備えられている。   As shown in FIG. 12, as the sonar units 103 and 104, the right sonar unit 103 whose measurement range is the right side of the tractor 1 (traveling machine body 7) and the tractor 1 (traveling machine body 7) as shown in FIG. A left sonar unit 104 having a measurement range on the left side is provided.

図12に示すように、右側のソナーユニット103の測定範囲Nと、左側のソナーユニット104の測定範囲Nとは、走行機体7から延びる方向が左右逆方向になっている点が異なるだけであり、右側と左側とで左右対称の測定範囲Nとなっている。   As shown in FIG. 12, the measurement range N of the right sonar unit 103 is different from the measurement range N of the left sonar unit 104 only in that the direction extending from the traveling machine body 7 is opposite to the left and right. The measurement range N is symmetrical between the right side and the left side.

ソナーユニット103,104は、走行機体7の機体外方を測定対象とするものである。ソナーユニット103,104は、水平方向よりも所定角度だけ下方側に向けて超音波を投射するように走行機体7に取り付けられ、ソナーユニット103,104から所定角度だけ下方側を向く方向に延びるように測定範囲Nが設定されている。ソナーユニット103,104の測定範囲Nは、ソナーユニット103,104から走行機体7の外方側に向けて所定距離までの距離を半径とする範囲であり、走行機体7の前後方向において、前ライダーセンサ101における左右測定範囲C1と後ライダーセンサ102における左右測定範囲D1との間に設定されている。   The sonar units 103 and 104 measure the outside of the traveling machine body 7. The sonar units 103 and 104 are attached to the traveling machine body 7 so as to project ultrasonic waves toward the lower side by a predetermined angle from the horizontal direction, and extend from the sonar units 103 and 104 to the lower side by a predetermined angle. The measurement range N is set in. The measurement range N of the sonar units 103 and 104 is a range in which the distance from the sonar units 103 and 104 to the predetermined distance toward the outer side of the traveling machine body 7 is a radius. It is set between the left / right measurement range C1 of the sensor 101 and the left / right measurement range D1 of the rear rider sensor 102.

このようにして、障害物検知部110は、ソナーユニット103,104の測定情報に基づいて障害物検知処理を行うことで、左右の測定範囲Nにて障害物の存否を検知している。   In this manner, the obstacle detection unit 110 detects the presence or absence of an obstacle in the left and right measurement ranges N by performing the obstacle detection process based on the measurement information of the sonar units 103 and 104.

以下、障害物検知部110による障害物検知処理、及び、衝突回避制御部111による衝突回避制御について説明するが、まず、ライダーセンサ101,102の測定情報に基づく障害物検知処理にて障害物を検知した場合の衝突回避制御について説明し、次に、ソナーユニット103,104の測定情報に基づく障害物検知処理において障害物を検知した場合の衝突回避制御を説明する。   Hereinafter, the obstacle detection process by the obstacle detection unit 110 and the collision avoidance control by the collision avoidance control unit 111 will be described. First, an obstacle is detected by the obstacle detection process based on the measurement information of the rider sensors 101 and 102. The collision avoidance control when detected will be described, and then collision avoidance control when an obstacle is detected in the obstacle detection process based on the measurement information of the sonar units 103 and 104 will be described.

ライダーセンサとして、前ライダーセンサ101と後ライダーセンサ102との2つのライダーセンサを備えているが、障害物検知部110は、目標走行経路Pに含まれた前後進切り替え地点での前後進の切り替え、又は、キャビン10の内部に備えられた前後進切り替え用のリバーサレバーによる前後進の切り替えに基づいて障害物検知状態を切り替える。トラクタ1が前進走行する場合には、前ライダーセンサ101による測定を行い、障害物検知部110が前ライダーセンサ101の測定情報に基づく障害物検知処理を行う前進検知状態に切り替え、トラクタ1が後進走行する場合には、後ライダーセンサ102による測定を行い、障害物検知部110が後ライダーセンサ102の測定情報に基づく障害物検知処理を行う後進検知状態に切り替えている。このように、トラクタ1が前進走行しているか後進走行しているかによって、前ライダーセンサ101と後ライダーセンサ102のどちらのライダーセンサを用いて障害物の検知を行うかを切り替えることで、処理負担の軽減を図りながら、障害物の検知を行うようにしている。   Two rider sensors, a front rider sensor 101 and a rear rider sensor 102, are provided as rider sensors. The obstacle detection unit 110 switches between forward and backward travel at a forward / reverse switching point included in the target travel route P. Alternatively, the obstacle detection state is switched based on forward / reverse switching by a reversing lever for forward / reverse switching provided in the cabin 10. When the tractor 1 travels forward, measurement is performed by the front rider sensor 101, the obstacle detection unit 110 switches to a forward detection state in which obstacle detection processing is performed based on measurement information of the front rider sensor 101, and the tractor 1 moves backward. When traveling, measurement is performed by the rear rider sensor 102, and the obstacle detection unit 110 is switched to a reverse detection state in which obstacle detection processing based on measurement information of the rear rider sensor 102 is performed. In this way, depending on whether the tractor 1 is traveling forward or backward, switching between using the rider sensor of the front rider sensor 101 and the rear rider sensor 102 to detect obstacles, the processing burden is increased. Obstacles are detected while mitigating the problem.

前進検知状態では、障害物検知部110が、前ライダーセンサ101の測定情報に基づいて障害物検知処理を行い、左右方向で左右測定範囲C1(図12参照)に含まれ、且つ、上下方向で上下測定範囲C2(図11参照)に含まれる範囲において、マスキング範囲L(図13参照)を除く範囲にて障害物の存否を検知している。後進検知状態では、作業装置12が下降位置に位置する場合に、障害物検知部110が、後ライダーセンサ102の測定情報に基づいて障害物検知処理を行い、左右方向で左右測定範囲D1(図12参照)に含まれ、且つ、上下方向で上下測定範囲D2(図11参照)に含まれる範囲において、下降位置用のマスキング範囲L1(図14参照)を除く範囲にて障害物の存否を検知している。後進検知状態では、作業装置12が上昇位置に位置する場合に、障害物検知部110が、後ライダーセンサ102の測定情報に基づいて障害物検知処理を行い、左右方向で左右測定範囲D1(図12参照)に含まれ、且つ、上下方向で上下測定範囲D2(図11参照)に含まれる範囲において、上昇位置用のマスキング範囲L2(図15参照)を除く範囲にて障害物の存否を検知している。   In the forward detection state, the obstacle detection unit 110 performs an obstacle detection process based on the measurement information of the front rider sensor 101, and is included in the left-right measurement range C1 (see FIG. 12) and in the vertical direction. In the range included in the vertical measurement range C2 (see FIG. 11), the presence or absence of an obstacle is detected in a range excluding the masking range L (see FIG. 13). In the reverse detection state, when the work device 12 is in the lowered position, the obstacle detection unit 110 performs an obstacle detection process based on the measurement information of the rear rider sensor 102, and the left and right measurement ranges D1 (see FIG. 12) and in the range included in the vertical measurement range D2 (see FIG. 11) in the vertical direction, the presence / absence of an obstacle is detected in a range excluding the masking range L1 for the lowered position (see FIG. 14). is doing. In the reverse detection state, when the work device 12 is positioned at the raised position, the obstacle detection unit 110 performs an obstacle detection process based on the measurement information of the rear rider sensor 102, and the left and right measurement ranges D1 (see FIG. 12) and in the range included in the vertical measurement range D2 (see FIG. 11) in the vertical direction, the presence / absence of an obstacle is detected in a range excluding the masking range L2 for the ascending position (see FIG. 15). is doing.

前ライダーセンサ101又は後ライダーセンサ102を用いて障害物を検知した場合には、図12に示すように、測定範囲C,Dである障害物検知用の検知範囲のうち、どの範囲にて障害物を検知したかによって、衝突回避制御部111による衝突回避制御の制御内容が異なるように設定されている。測定範囲C,D(検知範囲)は、前ライダーセンサ101又は後ライダーセンサ102からの距離に応じて、第1検知範囲J1と第2検知範囲J2と第3検知範囲J3との3つの範囲が設定されている。第1検知範囲J1は、前ライダーセンサ101又は後ライダーセンサ102からの距離が、第4設定距離X4から第1設定距離X1まで又は第4設定距離X4から第3設定距離X3までの範囲に設定されている。第2検知範囲J2は、前ライダーセンサ101又は後ライダーセンサ102からの距離が第5設定距離X5から第4設定距離X4までの範囲に設定されている。第3検知範囲J3は、前ライダーセンサ101又は後ライダーセンサ102からの距離が第5設定距離X5までの範囲に設定されている。よって、前ライダーセンサ101、後ライダーセンサ102、及び、作業装置12を含むトラクタ1に対して、第1検知範囲J1、第2検知範囲J2、第3検知範囲J3がその順に近くなるように設定されている。   When an obstacle is detected using the front rider sensor 101 or the rear rider sensor 102, as shown in FIG. 12, in which range of obstacle detection detection ranges that are measurement ranges C and D, the obstacle is detected. The control content of the collision avoidance control by the collision avoidance control unit 111 is set differently depending on whether an object is detected. The measurement ranges C and D (detection ranges) have three ranges of the first detection range J1, the second detection range J2, and the third detection range J3 according to the distance from the front rider sensor 101 or the rear rider sensor 102. Is set. The first detection range J1 is set such that the distance from the front rider sensor 101 or the rear rider sensor 102 ranges from the fourth set distance X4 to the first set distance X1 or from the fourth set distance X4 to the third set distance X3. Has been. In the second detection range J2, the distance from the front rider sensor 101 or the rear rider sensor 102 is set to a range from the fifth set distance X5 to the fourth set distance X4. The third detection range J3 is set such that the distance from the front rider sensor 101 or the rear rider sensor 102 is a range up to the fifth set distance X5. Therefore, for the tractor 1 including the front rider sensor 101, the rear rider sensor 102, and the work device 12, the first detection range J1, the second detection range J2, and the third detection range J3 are set to be closer to each other in that order. Has been.

前ライダーセンサ101又は後ライダーセンサ102を用いて障害物を検知した場合の衝突回避制御の制御内容は、トラクタ1が前進走行している場合も後進走行している場合も同様であるので、以下、トラクタ1が前進走行している場合について説明する。   The control content of the collision avoidance control when an obstacle is detected using the front rider sensor 101 or the rear rider sensor 102 is the same whether the tractor 1 is traveling forward or backward. The case where the tractor 1 is traveling forward will be described.

トラクタ1が前進走行しているときに、図12に示すように、障害物検知処理において第1検知範囲J1内で障害物を検知した場合には、衝突回避制御部111が、衝突回避制御として、報知ブザーや報知ランプ等の報知装置26を制御して、第1検知範囲J1内に障害物が存在することを報知する第1報知制御を行う。第1報知制御では、例えば、衝突回避制御部111が、報知ブザーを所定周波数にて断続作動させ、且つ、報知ランプを所定色にて点灯させるように、報知装置26を制御している。   When the tractor 1 is traveling forward, as shown in FIG. 12, when an obstacle is detected within the first detection range J1 in the obstacle detection process, the collision avoidance control unit 111 performs the collision avoidance control. The first notification control is performed to control the notification device 26 such as a notification buzzer or a notification lamp to notify that an obstacle exists in the first detection range J1. In the first notification control, for example, the collision avoidance control unit 111 controls the notification device 26 so that the notification buzzer is intermittently operated at a predetermined frequency and the notification lamp is lit in a predetermined color.

障害物検知処理において第2検知範囲J2内で障害物を検知した場合には、衝突回避制御部111が、衝突回避制御として、報知ブザーや報知ランプ等の報知装置26を制御して、第2検知範囲J2内に障害物が存在することを報知する第2報知制御を行うとともに、トラクタ1の車速を減速させる第1減速制御を行う。第2報知制御では、例えば、衝突回避制御部111が、報知ブザーを所定周波数にて断続作動させ、且つ、報知ランプを所定色にて点灯させるように、報知装置26を制御している。第1減速制御では、例えば、衝突回避制御部111が、現在のトラクタ1の車速や障害物までの距離等に基づいて、トラクタ1が障害物に衝突するまでの衝突予測時間を求めている。衝突回避制御部111は、求めた衝突予測時間が設定時間(例えば、3秒)に維持される状態でトラクタ1の車速を減速させるように、エンジン9、変速装置13及びブレーキ操作機構15等を制御している。   When an obstacle is detected in the second detection range J2 in the obstacle detection process, the collision avoidance control unit 111 controls the notification device 26 such as a notification buzzer or a notification lamp as the collision avoidance control, and the second While performing 2nd alerting | reporting control which alert | reports that an obstruction exists in the detection range J2, 1st deceleration control which decelerates the vehicle speed of the tractor 1 is performed. In the second notification control, for example, the collision avoidance control unit 111 controls the notification device 26 so that the notification buzzer is intermittently operated at a predetermined frequency and the notification lamp is lit in a predetermined color. In the first deceleration control, for example, the collision avoidance control unit 111 obtains the predicted collision time until the tractor 1 collides with the obstacle based on the current vehicle speed of the tractor 1, the distance to the obstacle, and the like. The collision avoidance control unit 111 controls the engine 9, the transmission 13, the brake operation mechanism 15, and the like so as to decelerate the vehicle speed of the tractor 1 while maintaining the calculated predicted collision time for a set time (for example, 3 seconds). I have control.

障害物検知処理において第3検知範囲J3内で障害物を検知した場合には、衝突回避制御部111が、衝突回避制御として、報知ブザーや報知ランプ等の報知装置26を制御して、第3検知範囲J3内に障害物が存在することを報知する第3報知制御を行うとともに、トラクタ1を停止させる停止制御を行う。第3報知制御では、例えば、衝突回避制御部111が、報知ブザーを連続作動させ、且つ、報知ランプを所定色にて点灯させるように、報知装置26を制御している。停止制御では、例えば、衝突回避制御部111が、トラクタ1を停止させるように、ブレーキ操作機構15等を制御している。   When an obstacle is detected in the third detection range J3 in the obstacle detection process, the collision avoidance control unit 111 controls the notification device 26 such as a notification buzzer or a notification lamp as the collision avoidance control, While performing 3rd alerting | reporting control which alert | reports that an obstruction exists in the detection range J3, stop control which stops the tractor 1 is performed. In the third notification control, for example, the collision avoidance control unit 111 controls the notification device 26 so that the notification buzzer is continuously operated and the notification lamp is lit in a predetermined color. In the stop control, for example, the collision avoidance control unit 111 controls the brake operation mechanism 15 and the like so as to stop the tractor 1.

ちなみに、第1報知制御及び第2報知制御において報知ブザーを断続させる所定周波数は、同じ周波数でもよく、異なる周波数でもよい。また、第1〜第3報知制御において報知ランプを点灯させる所定色は、同じ色でもよく、異なる色でもよい。衝突回避制御部111は、第1〜第3報知制御において、トラクタ1の報知装置26の制御に加えて、第1〜第3検知範囲J1〜J3の何れかに障害物が存在することを示す表示内容を携帯通信端末3の表示部51に表示させるように、端末電子制御ユニット52を制御することもできる。   Incidentally, the predetermined frequency for intermittently generating the notification buzzer in the first notification control and the second notification control may be the same frequency or different frequencies. In addition, the predetermined color for lighting the notification lamp in the first to third notification control may be the same color or different colors. In the first to third notification control, the collision avoidance control unit 111 indicates that an obstacle exists in any of the first to third detection ranges J1 to J3 in addition to the control of the notification device 26 of the tractor 1. The terminal electronic control unit 52 can also be controlled so that the display content is displayed on the display unit 51 of the mobile communication terminal 3.

例えば、第1検知範囲J1内で障害物が検知された場合には、衝突回避制御部111が第1報知制御を行うことで、第1検知範囲J1内に障害物が存在することをユーザ等に報知することができる。そのままトラクタ1の走行が継続されて、障害物の検知範囲が第1検知範囲J1から第2検知範囲J2に近づくと、衝突回避制御部111が、第2報知制御に加えて、第1減速制御を行うことで、トラクタ1と障害物との衝突を回避可能とするために、トラクタ1の車速を減速させておくことができる。トラクタ1を減速させても、障害物の検知範囲が第2検知範囲J2から第3検知範囲J3に近づくと、衝突回避制御部111が、第3報知制御に加えて、停止制御を行うことで、トラクタ1を停止させることができ、トラクタ1と障害物との衝突を適切に回避することができる。   For example, when an obstacle is detected in the first detection range J1, the collision avoidance control unit 111 performs the first notification control, so that the user or the like indicates that there is an obstacle in the first detection range J1. Can be notified. When the traveling of the tractor 1 is continued and the obstacle detection range approaches the second detection range J2 from the first detection range J1, the collision avoidance control unit 111 performs the first deceleration control in addition to the second notification control. In order to avoid a collision between the tractor 1 and the obstacle, the vehicle speed of the tractor 1 can be reduced. Even if the tractor 1 is decelerated, when the obstacle detection range approaches the third detection range J3 from the second detection range J2, the collision avoidance control unit 111 performs stop control in addition to the third notification control. The tractor 1 can be stopped, and the collision between the tractor 1 and the obstacle can be avoided appropriately.

ライダーセンサ101,102を用いる場合には、人等の移動する測定対象物も障害物として検知する。よって、検知範囲J内で障害物が検知されても、障害物自体が移動することで、障害物が検知範囲Jから外れることがある。そこで、障害物が第1検知範囲J1から外れた場合には、衝突回避制御部111が、第1報知制御を終了する。障害物が第2検知範囲J2から外れた場合には、衝突回避制御部111が、第2報知制御を終了するとともに、トラクタ1の車速を設定車速まで増速させるように、エンジン9や変速装置13等を制御する車速回復制御を行う。障害物が第3検知範囲J3から外れた場合には、衝突回避制御部111が、トラクタ1を走行停止状態に維持しながら、第3報知制御を終了する。この場合には、ユーザ等によりトラクタ1の自動走行の再開等が指令されることで、トラクタ1の自動走行を再開することができる。   When the rider sensors 101 and 102 are used, a moving measurement object such as a person is also detected as an obstacle. Therefore, even if an obstacle is detected within the detection range J, the obstacle may move out of the detection range J due to the movement of the obstacle itself. Therefore, when the obstacle is out of the first detection range J1, the collision avoidance control unit 111 ends the first notification control. When the obstacle is out of the second detection range J2, the collision avoidance control unit 111 terminates the second notification control and increases the vehicle speed of the tractor 1 to the set vehicle speed. Car speed recovery control is performed to control 13 and the like. When the obstacle is out of the third detection range J3, the collision avoidance control unit 111 ends the third notification control while maintaining the tractor 1 in the travel stop state. In this case, the automatic traveling of the tractor 1 can be resumed by instructing the user to resume the automatic traveling of the tractor 1 or the like.

次に、ソナーユニット103,104の測定情報に基づく障害物検知処理にて障害物を検知した場合の衝突回避制御について説明する。
ソナーユニット103,104は、左右に備えられているが、トラクタ1が前進走行する場合もトラクタ1が後進走行する場合も、障害物検知部110は、左右両側のソナーユニット103,104の全ての測定情報に基づいて障害物検知処理を行う。
Next, collision avoidance control when an obstacle is detected in the obstacle detection process based on the measurement information of the sonar units 103 and 104 will be described.
Although the sonar units 103 and 104 are provided on the left and right, the obstacle detection unit 110 is configured to detect all of the sonar units 103 and 104 on both the left and right sides when the tractor 1 travels forward and when the tractor 1 travels backward. Obstacle detection processing is performed based on the measurement information.

ソナーユニット103,104の測定情報に基づく障害物検知処理にて障害物を検知した場合には、衝突回避制御部111が、衝突回避制御として、報知ブザーや報知ランプ等の報知装置26を制御して、ソナーユニット103,104の何れかの測定範囲N内に障害物が存在することを報知する第4報知制御を行うとともに、トラクタ1の車速を減速させる第2減速制御を行う。第4報知制御では、例えば、衝突回避制御部111が、報知ブザーを所定周波数にて断続作動させ、且つ、報知ランプを所定色にて点灯させるように、報知装置26を制御している。第2減速制御では、例えば、衝突回避制御部111が、トラクタ1の車速を設定車速に減速させるように、エンジン9、変速装置13及びブレーキ操作機構15等を制御している。   When an obstacle is detected in the obstacle detection process based on the measurement information of the sonar units 103 and 104, the collision avoidance control unit 111 controls the notification device 26 such as a notification buzzer and a notification lamp as the collision avoidance control. Then, the fourth notification control for notifying that an obstacle is present in the measurement range N of any one of the sonar units 103 and 104 is performed, and the second deceleration control for decreasing the vehicle speed of the tractor 1 is performed. In the fourth notification control, for example, the collision avoidance control unit 111 controls the notification device 26 so that the notification buzzer is intermittently operated at a predetermined frequency and the notification lamp is lit in a predetermined color. In the second deceleration control, for example, the collision avoidance control unit 111 controls the engine 9, the transmission 13, the brake operation mechanism 15, and the like so as to decelerate the vehicle speed of the tractor 1 to the set vehicle speed.

このようにして、障害物検知システム100は、前ライダーセンサ101及び後ライダーセンサ102を用いて走行機体7の前方側及び後方側における障害物の存否を検知するとともに、ソナーユニット103,104を用いて走行機体7の左右における障害物の存否を検知することができる。障害物検知システム100は、障害物検知部110にて障害物の存在を検知すると、衝突回避制御部111が衝突回避制御を行うことによって、障害物の存在をユーザ等に報知して、ユーザ等に障害物との衝突を回避するように促すことができるとともに、仮にトラクタ1と障害物とが衝突する可能性が生じても、トラクタ1を減速や停止させて、トラクタ1と障害物との衝突を適切に回避することができる。   In this way, the obstacle detection system 100 detects the presence or absence of an obstacle on the front side and the rear side of the traveling body 7 using the front rider sensor 101 and the rear rider sensor 102, and uses the sonar units 103 and 104. Thus, the presence or absence of an obstacle on the left and right of the traveling machine body 7 can be detected. When the obstacle detection system 110 detects the presence of an obstacle, the obstacle detection system 110 notifies the user of the presence of the obstacle by the collision avoidance control unit 111 performing collision avoidance control. To avoid a collision with an obstacle, and even if there is a possibility that the tractor 1 and the obstacle collide, the tractor 1 is decelerated or stopped so that the tractor 1 and the obstacle A collision can be avoided appropriately.

自動走行状態では、車載電子制御ユニット18にて自動走行制御が行われるので、障害物検知システム100によりトラクタ1を減速や停止させて、障害物との衝突を回避しながら、トラクタ1を自動走行させることができる。手動走行状態においても、運転しているユーザ等に対しても、障害物検知システム100により障害物の存在を報知したり、トラクタ1と障害物との衝突を回避するための運転をサポートすることができる。   In the automatic travel state, the on-vehicle electronic control unit 18 performs automatic travel control. Therefore, the tractor 1 is automatically traveled while the tractor 1 is decelerated or stopped by the obstacle detection system 100 to avoid collision with the obstacle. Can be made. Even in a manual driving state, to the user who is driving, the obstacle detection system 100 notifies the presence of an obstacle, and supports driving for avoiding a collision between the tractor 1 and the obstacle. Can do.

以下、自動走行状態において、ライダーセンサ101,102の測定情報に基づく障害物検知部110による障害物検知処理について説明を加える。
障害物検知部110は、障害物検知処理において、前ライダーセンサ101及び後ライダーセンサ102の測定範囲C,Dの全体において測定対象物を障害物として検知する全体検知モードと、前ライダーセンサ101及び後ライダーセンサ102の測定範囲C,Dの一部では測定対象物を障害物として検知しない一部非検知モードとを実行可能に構成されている。障害物検知部110は、自動走行状態だけでなく、手動走行状態においても、全体検知モードと一部非検知モードとを実行可能に構成されている。
Hereinafter, the obstacle detection processing by the obstacle detection unit 110 based on the measurement information of the rider sensors 101 and 102 in the automatic running state will be described.
In the obstacle detection process, the obstacle detection unit 110 detects an object to be measured as an obstacle in the entire measurement ranges C and D of the front rider sensor 101 and the rear rider sensor 102, the front rider sensor 101, A part of the measurement ranges C and D of the rear rider sensor 102 is configured to be able to execute a partial non-detection mode in which the measurement target is not detected as an obstacle. The obstacle detection unit 110 is configured to be able to execute the entire detection mode and the partial non-detection mode not only in the automatic driving state but also in the manual driving state.

全体検知モードでは、障害物検知部110が、前ライダーセンサ101及び後ライダーセンサ102の測定範囲C,Dの全体を障害物の検知範囲としている。全体検知モードでは、障害物検知部110が、前ライダーセンサ101及び後ライダーセンサ102に基づいて、その検知範囲にて物体や人等の測定対象物を障害物として検知している。これにより、前ライダーセンサ101及び後ライダーセンサ102の測定範囲C,Dの全体を用いて、障害物の検知を行うことができ、その障害物との衝突を回避する衝突回避制御部111による衝突回避制御を効果的に行うことができる。   In the entire detection mode, the obstacle detection unit 110 sets the entire measurement ranges C and D of the front rider sensor 101 and the rear rider sensor 102 as an obstacle detection range. In the whole detection mode, the obstacle detection unit 110 detects a measurement object such as an object or a person as an obstacle in the detection range based on the front rider sensor 101 and the rear rider sensor 102. Thus, the obstacle can be detected using the entire measurement ranges C and D of the front rider sensor 101 and the rear rider sensor 102, and the collision by the collision avoidance control unit 111 that avoids the collision with the obstacle. Avoidance control can be performed effectively.

一部非検知モードでは、図16〜図19に示すように、障害物検知部110が、前ライダーセンサ101及び後ライダーセンサ102の測定情報に基づいて、走行領域Sの端部S1までの距離を3次元にて検出し、走行領域Sの端部S1よりも遠方に位置する測定対象物を障害物として検知していない。   In the partial non-detection mode, as shown in FIGS. 16 to 19, the obstacle detection unit 110 is based on the measurement information of the front rider sensor 101 and the rear rider sensor 102, and is a distance to the end S <b> 1 of the travel region S. Is detected in three dimensions, and the measurement object located farther from the end S1 of the travel region S is not detected as an obstacle.

図16は、前ライダーセンサ101の測定情報に基づいて、走行領域Sの端部S1までの距離を3次元にて検出している場合を示しているが、後ライダーセンサ102の測定情報に基づいて走行領域Sの端部S1までの距離を3次元にて検出する場合も同様であるので、説明及び図示は省略する。   FIG. 16 shows a case in which the distance to the end S1 of the traveling region S is detected in three dimensions based on the measurement information of the front rider sensor 101, but based on the measurement information of the rear rider sensor 102. The same applies to the case where the distance to the end S1 of the travel region S is detected in three dimensions, and the description and illustration are omitted.

図16に示すように、走行領域Sを圃場等とした場合には、走行領域Sの端部S1に畔が存在しており、走行領域Sの端部S1が畔によって走行領域Sの内側よりも一段高い位置となっている。また、走行領域Sの端部S1に壁等の区画体が設けられる場合も、走行領域Sの端部S1が走行領域Sよりも高い位置となっている。そこで、障害物検知部110は、前ライダーセンサ101の測定情報に基づいて、走行領域Sの端部S1における上端部までの距離K1及び下端部までの距離K2を検出して、走行領域Sの端部S1における高さK3を検出している。   As shown in FIG. 16, when the travel area S is an agricultural field or the like, there is a shore at the end S1 of the travel area S, and the end S1 of the travel area S is from the inside of the travel area S by the shore. Is one step higher. Further, when a partition such as a wall is provided at the end S1 of the traveling area S, the end S1 of the traveling area S is at a higher position than the traveling area S. Therefore, the obstacle detection unit 110 detects the distance K1 to the upper end and the distance K2 to the lower end of the end S1 of the travel area S based on the measurement information of the front rider sensor 101, and detects the distance of the travel area S. The height K3 at the end S1 is detected.

前ライダーセンサ101は、測定範囲C内に存在する測定対象物までの距離を測定しているので、走行領域Sの端部S1までの距離を正確に検出するために、検出した高さK3と予め設定されている走行領域Sの端部S1の高さとを用いて、走行領域Sの端部S1を特定している。走行領域Sの端部S1の高さや走行領域Sの位置等が登録された地図情報等から走行領域Sの端部S1の高さを取得して、走行領域Sの端部S1の高さを予め設定している。障害物検知部110は、検出した高さK3と予め設定されている走行領域Sの端部S1の高さと比較することで、その高さが同じであれば、検出した高さK3が走行領域Sの端部S1の高さであるとして、走行領域Sの端部S1を特定している。   Since the front rider sensor 101 measures the distance to the measurement object existing in the measurement range C, in order to accurately detect the distance to the end S1 of the traveling region S, the detected height K3 and The end S1 of the travel area S is specified using the height of the end S1 of the travel area S set in advance. The height of the end S1 of the travel area S is obtained from the map information etc. in which the height of the end S1 of the travel area S, the position of the travel area S, etc. are registered. It is set in advance. The obstacle detection unit 110 compares the detected height K3 with the preset height of the end S1 of the travel region S. If the height is the same, the detected height K3 is the travel region. The end S1 of the traveling region S is specified as the height of the end S1 of S.

障害物検知部110は、走行領域Sの端部S1の高さK3に基づいて、走行領域Sの端部S1を特定し、図16〜図19に示すように、特定した走行領域Sの端部S1の上端部よりも遠い範囲を、障害物を検知しない非検知範囲H2に設定し、特定した走行領域Sの端部S1の上端部よりも近い範囲を、障害物を検知する検知範囲H1に設定している。   The obstacle detection unit 110 identifies the end S1 of the travel area S based on the height K3 of the end S1 of the travel area S, and as illustrated in FIGS. 16 to 19, the end of the identified travel area S is identified. A range farther than the upper end of the part S1 is set as a non-detection range H2 where no obstacle is detected, and a range closer to the upper end of the end S1 of the specified travel region S is detected as an detection range H1. Is set.

図17は、走行領域Sの端部S1の近くで、周回経路P3に沿ってトラクタ1を前進状態で直進走行させた場合の検知範囲H1及び非検知範囲H2を示す図である。図18は、走行領域Sの端部S1の近くで、周回経路P3に沿ってトラクタ1を前進状態で旋回走行させた場合の検知範囲H1及び非検知範囲H2を示す図である。図19は、走行領域Sの端部S1の近くで、周回経路P3に沿ってトラクタ1を後進状態で直進走行させた場合の検知範囲H1及び非検知範囲H2を示す図である。   FIG. 17 is a diagram showing a detection range H1 and a non-detection range H2 when the tractor 1 travels straight in the forward state along the circulation path P3 near the end S1 of the travel region S. FIG. 18 is a diagram showing a detection range H1 and a non-detection range H2 when the tractor 1 is swung in the forward state along the circulation path P3 near the end S1 of the travel region S. FIG. 19 is a diagram showing a detection range H1 and a non-detection range H2 when the tractor 1 travels straight in the reverse state along the circuit path P3 near the end S1 of the travel region S.

このようにして、障害物検知部110は、一部非検知モードを実行することで、前進状態でも後進状態でも、走行領域Sの端部S1の上端部よりも遠い非検知範囲H2において、前ライダーセンサ101及び後ライダーセンサ102の測定情報に基づいて測定対象物を測定しても、その測定対象物を障害物として検知していない。これにより、走行領域S内の測定対象物を障害物として適切に検知することができながら、走行領域S外の測定対象物を障害物として誤検知することを防止している。   In this manner, the obstacle detection unit 110 executes the partial non-detection mode, so that the front detection unit 110 can move forward in the non-detection range H2 farther than the upper end of the end S1 of the traveling region S in both the forward state and the reverse state. Even if the measurement object is measured based on the measurement information of the rider sensor 101 and the rear rider sensor 102, the measurement object is not detected as an obstacle. Thereby, while being able to appropriately detect the measurement object in the travel area S as an obstacle, it is possible to prevent the measurement object outside the travel area S from being erroneously detected as an obstacle.

ちなみに、一部非検知モードでは、非検知範囲H2を設定するので、図12において、第1検知範囲J1〜第3検知範囲J3内に、障害物の検知が行われない非検知範囲H2が設定されることになる。   Incidentally, since the non-detection range H2 is set in the partial non-detection mode, the non-detection range H2 in which no obstacle is detected is set in the first detection range J1 to the third detection range J3 in FIG. Will be.

図20のフローチャートに基づいて、障害物検知部110による全体検知モードと一部非検知モードにおける動作について説明する。
まず、接近状態判定部112(図2参照)は、走行領域Sの端部S1に対してトラクタ1が接近している接近状態であるか否かを判定している(ステップ#1)。図2に示すように、トラクタ1には、車載電子制御ユニット18に接近状態判定部112が備えられている。接近状態判定部112は、測位ユニット21にてトラクタ1の現在位置を取得しているので、トラクタ1の現在位置と走行領域Sの端部S1との間の距離が設定距離以下の場合に、接近状態であると判定している。走行領域Sの端部S1の位置については、圃場情報等から予め取得している。また、図3に示すような目標走行経路Pが生成されている場合には、トラクタ1が周回経路P3に沿って自動走行するときに、走行領域Sの端部S1に対してトラクタ1が接近するので、接近状態判定部112は、トラクタ1が周回経路P3に沿って自動走行しているときに接近状態であると判定することもできる。
Based on the flowchart of FIG. 20, the operation | movement in the whole detection mode and the partial non-detection mode by the obstruction detection part 110 is demonstrated.
First, the approach state determination unit 112 (see FIG. 2) determines whether or not it is an approach state in which the tractor 1 is approaching the end S1 of the travel region S (step # 1). As shown in FIG. 2, the tractor 1 is provided with an approach state determination unit 112 in the in-vehicle electronic control unit 18. Since the approaching state determination unit 112 acquires the current position of the tractor 1 in the positioning unit 21, when the distance between the current position of the tractor 1 and the end S1 of the traveling region S is equal to or less than the set distance, It is determined that the vehicle is approaching. The position of the end S1 of the traveling area S is acquired in advance from the field information and the like. When the target travel route P as shown in FIG. 3 is generated, the tractor 1 approaches the end S1 of the travel region S when the tractor 1 automatically travels along the circulation route P3. Therefore, the approaching state determination unit 112 can also determine that the approaching state is in the approaching state when the tractor 1 is automatically traveling along the circulation route P3.

接近状態判定部112にて接近状態ではないと判定した場合には、障害物検知部110が、全体検知モードにて障害物検知処理を行う(ステップ#1のNoの場合、ステップ#2)。この場合には、障害物検知部110が、図11及び図12に示すように、前ライダーセンサ101及び後ライダーセンサ102の測定範囲C,Dの全体を検知範囲として、前ライダーセンサ101及び後ライダーセンサ102の測定情報に基づいて、検知範囲内の測定対象物を障害物として検知している(ステップ#6)。   When the approach state determination unit 112 determines that the vehicle is not in the approach state, the obstacle detection unit 110 performs an obstacle detection process in the entire detection mode (in the case of No in step # 1, step # 2). In this case, as shown in FIGS. 11 and 12, the obstacle detection unit 110 uses the entire measurement ranges C and D of the front rider sensor 101 and the rear rider sensor 102 as detection ranges, and Based on the measurement information of the rider sensor 102, the measurement object within the detection range is detected as an obstacle (step # 6).

接近状態判定部112にて接近状態であると判定した場合には、障害物検知部110が、一部検知モードを実行する(ステップ#1のYesの場合、ステップ#3)。障害物検知部110は、図16に示すように、走行領域Sの端部S1の高さK3等を検出し、その高さK3に応じて、検知範囲H1と非検知範囲H2とを設定している(ステップ#4,#5)。この場合は、障害物検知部110が、障害物検知処理において、前ライダーセンサ101及び後ライダーセンサ102の測定情報に基づいて、検知範囲H1内の測定対象物を障害物として検知している(ステップ#6)。   When the approach state determination unit 112 determines that the vehicle is in the approach state, the obstacle detection unit 110 executes the partial detection mode (in the case of Yes in step # 1, step # 3). As shown in FIG. 16, the obstacle detection unit 110 detects the height K3 and the like of the end S1 of the traveling region S, and sets a detection range H1 and a non-detection range H2 according to the height K3. (Steps # 4 and # 5). In this case, the obstacle detection unit 110 detects the measurement object in the detection range H1 as an obstacle based on the measurement information of the front rider sensor 101 and the rear rider sensor 102 in the obstacle detection process ( Step # 6).

〔別実施形態〕
本発明の他の実施形態について説明する。
尚、以下に説明する各実施形態の構成は、夫々単独で適用することに限らず、他の実施形態の構成と組み合わせて適用することも可能である。
[Another embodiment]
Another embodiment of the present invention will be described.
Note that the configuration of each embodiment described below is not limited to being applied alone, but may be applied in combination with the configuration of another embodiment.

(1)作業車両の構成は種々の変更が可能である。
例えば、作業車両は、エンジン9と走行用の電動モータとを備えるハイブリット仕様に構成されていてもよく、また、エンジン9に代えて走行用の電動モータを備える電動仕様に構成されていてもよい。
例えば、作業車両は、走行部として、左右の後輪6に代えて左右のクローラを備えるセミクローラ仕様に構成されていてもよい。
例えば、作業車両は、左右の後輪6が操舵輪として機能する後輪ステアリング仕様に構成されていてもよい。
(1) Various changes can be made to the configuration of the work vehicle.
For example, the work vehicle may be configured in a hybrid specification including an engine 9 and an electric motor for traveling, or may be configured in an electric specification including an electric motor for traveling instead of the engine 9. .
For example, the work vehicle may be configured as a semi-crawler specification including left and right crawlers instead of the left and right rear wheels 6 as a traveling unit.
For example, the work vehicle may be configured to have a rear wheel steering specification in which the left and right rear wheels 6 function as steering wheels.

(2)上記実施形態では、前ライダーセンサ101及び後ライダーセンサ102を、上下方向において、ルーフ35に相当する位置に配置しているが、例えば、前ライダーセンサ101は、ボンネット8の前方側端部に配置することができる。前ライダーセンサ101及び後ライダーセンサ102の配置位置は、乗降部となる乗降ステップ41よりも上方側であればよく、その配置位置は適宜変更することができる。 (2) In the above embodiment, the front rider sensor 101 and the rear rider sensor 102 are arranged at positions corresponding to the roof 35 in the vertical direction. For example, the front rider sensor 101 is provided at the front end of the bonnet 8. Can be arranged in the part. The arrangement positions of the front rider sensor 101 and the rear rider sensor 102 need only be above the boarding / alighting step 41 serving as a boarding / alighting section, and the arrangement positions can be changed as appropriate.

前ライダーセンサ101の配置位置と後ライダーセンサ102の配置位置とを、上下方向で異なる高さとすることもできる。例えば、前ライダーセンサ101をボンネット8の前方側端部に配置し、後ライダーセンサ102をルーフ35に相当する位置に配置することができる。   The arrangement position of the front rider sensor 101 and the arrangement position of the rear rider sensor 102 may be different in the vertical direction. For example, the front rider sensor 101 can be disposed at the front end of the bonnet 8 and the rear rider sensor 102 can be disposed at a position corresponding to the roof 35.

(3)上記実施形態では、前ライダーセンサ101をアンテナユニット80の底部に取り付けているが、例えば、前ライダーセンサ101を、支持ステーを介してルーフ35に取り付けることもでき、前ライダーセンサ101をどのような部材に取り付けるかは適宜変更が可能である。 (3) In the above embodiment, the front rider sensor 101 is attached to the bottom of the antenna unit 80. However, for example, the front rider sensor 101 can be attached to the roof 35 via a support stay. What kind of member is attached can be changed as appropriate.

(4)上記実施形態では、前ライダーセンサ101と後ライダーセンサ102の2つのライダーセンサを備えた例を示したが、ライダーセンサの数については適宜変更が可能であり、1つや3つ以上とすることができる。 (4) In the above-described embodiment, an example in which two rider sensors, the front rider sensor 101 and the rear rider sensor 102, are shown. However, the number of rider sensors can be changed as appropriate, and can be one, three or more. can do.

(5)上記実施形態では、障害物検知部110が、ライダーセンサ101,102の測定情報に基づいて、障害物検知処理を行うようにしているが、ライダーセンサ101,102に制御部を備えて、その制御部が障害物検知処理を行うこともできる。このように、障害物検知処理については、センサ側で行うか、作業車両側で行うかは、適宜変更が可能である。 (5) In the above embodiment, the obstacle detection unit 110 performs the obstacle detection process based on the measurement information of the rider sensors 101 and 102. However, the rider sensors 101 and 102 include a control unit. The control unit can also perform obstacle detection processing. As described above, whether the obstacle detection process is performed on the sensor side or the work vehicle side can be appropriately changed.

(6)上記実施形態では、障害物検知部110、衝突回避制御部111、接近状態判定部112をトラクタ1に備えた例を示したが、例えば、携帯通信端末3等、トラクタ1とは別の装置に備えさせることもできる。 (6) In the above embodiment, an example in which the obstacle detection unit 110, the collision avoidance control unit 111, and the approach state determination unit 112 are provided in the tractor 1 has been described. This device can also be provided.

(7)上記実施形態において、一部非検知モードでは、走行領域Sの端部S1の上端部よりも遠い非検知範囲H2を設定し、非検知範囲H2において、測定対象物を測定しても、その測定対象物を障害物として検知せず、衝突回避制御部111による衝突回避制御を実行していない。これに代えて、一部非検知モードにおいて、非検知範囲H2にて測定対象物を測定すると、衝突回避制御部111が衝突回避制御とは異なる走行領域外用の車速制御を行うこともできる。 (7) In the above embodiment, in the partial non-detection mode, a non-detection range H2 farther than the upper end of the end S1 of the travel region S is set, and the measurement object is measured in the non-detection range H2. The measurement object is not detected as an obstacle, and the collision avoidance control by the collision avoidance control unit 111 is not executed. Instead of this, when the measurement object is measured in the non-detection range H2 in the partial non-detection mode, the collision avoidance control unit 111 can perform vehicle speed control outside the traveling region different from the collision avoidance control.

走行領域外用の車速制御として、例えば、測定対象物が人であれば、衝突回避制御部111が、トラクタ1の車速を所定車速に減速させる減速制御を行い、測定対象物が人以外の物体であれば、衝突回避制御部111にてトラクタ1の車速を変更(減速)することを行わないようにしている。このように、前ライダーセンサ101及び後ライダーセンサ102の測定情報に基づいて測定対象物の種類が判別できれば、測定対象物の種類に応じた制御を行うことができる。   For example, if the measurement object is a person, the collision avoidance control unit 111 performs deceleration control to reduce the vehicle speed of the tractor 1 to a predetermined vehicle speed, and the measurement object is an object other than a person. If there is, the collision avoidance control unit 111 does not change (decelerate) the vehicle speed of the tractor 1. As described above, if the type of the measurement object can be determined based on the measurement information of the front rider sensor 101 and the rear rider sensor 102, control according to the type of the measurement object can be performed.

1 トラクタ(作業車両)
18 車載電子制御ユニット(自動走行制御部)
101 前ライダーセンサ(距離センサ)
102 後ライダーセンサ(距離センサ)
110 障害物検知部
112 接近状態判定部

1 Tractor (work vehicle)
18 On-vehicle electronic control unit (automatic running control unit)
101 Front rider sensor (distance sensor)
102 Rear rider sensor (distance sensor)
110 Obstacle detection unit 112 Approach state determination unit

Claims (3)

衛星測位システムにより取得される作業車両の測位情報に基づいて、走行領域内で作業車両を自動走行させる自動走行制御部と、
前記作業車両に備えられ、測定対象物までの距離を3次元にて測定可能な距離センサと、
その距離センサの測定情報に基づいて、所定距離内の測定対象物を障害物として検知する障害物検知部とを備え、
前記障害物検知部は、前記距離センサの測定情報に基づいて、走行領域の端部までの距離を3次元にて検出し、走行領域の端部よりも遠方に位置する測定対象物を障害物として検知しない一部非検知モードを有している障害物検知システム。
Based on the positioning information of the work vehicle acquired by the satellite positioning system, an automatic travel control unit that automatically travels the work vehicle in the travel area;
A distance sensor provided in the work vehicle and capable of measuring a distance to a measurement object in three dimensions;
Based on the measurement information of the distance sensor, an obstacle detection unit that detects a measurement object within a predetermined distance as an obstacle,
The obstacle detection unit detects the distance to the end of the travel area in three dimensions based on the measurement information of the distance sensor, and the object to be measured located farther from the end of the travel area is an obstacle. Obstacle detection system that has a part non-detection mode that does not detect as.
走行領域の端部に対して作業車両が接近している接近状態であるか否かを判定する接近状態判定部が備えられ、
前記接近状態判定部にて接近状態であることを判定した場合に、前記障害物検知部は、前記一部非検知モードを実行する請求項1に記載の障害物検知システム。
An approach state determination unit for determining whether or not the work vehicle is approaching the end of the travel region is provided,
The obstacle detection system according to claim 1, wherein the obstacle detection unit executes the partial non-detection mode when the approach state determination unit determines that the vehicle is in the approach state.
前記障害物検知部は、前記一部非検知モードにおいて、予め設定された走行領域の端部の高さに応じて、走行領域の端部を特定している請求項1又は2に記載の障害物検知システム。

3. The obstacle according to claim 1, wherein the obstacle detection unit specifies an end of the traveling area according to a preset height of the end of the traveling area in the partial non-detection mode. Object detection system.

JP2018055616A 2018-03-23 2018-03-23 Obstacle detection system Active JP6923472B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018055616A JP6923472B2 (en) 2018-03-23 2018-03-23 Obstacle detection system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018055616A JP6923472B2 (en) 2018-03-23 2018-03-23 Obstacle detection system

Publications (2)

Publication Number Publication Date
JP2019168888A true JP2019168888A (en) 2019-10-03
JP6923472B2 JP6923472B2 (en) 2021-08-18

Family

ID=68106802

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018055616A Active JP6923472B2 (en) 2018-03-23 2018-03-23 Obstacle detection system

Country Status (1)

Country Link
JP (1) JP6923472B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021111213A (en) * 2020-01-14 2021-08-02 株式会社ダイフク Article transportation facility
KR20220084266A (en) 2019-10-18 2022-06-21 얀마 파워 테크놀로지 가부시키가이샤 Obstacle detection system
DE112020007538T5 (en) 2020-08-27 2023-08-03 Mitsubishi Electric Corporation Driving assistance device, learning device, driving assistance method, driving assistance program, learned model creation method, and learned model creation program data carrier

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05205198A (en) * 1992-01-29 1993-08-13 Mazda Motor Corp Obstacle detection device for vehicle
JP2008092818A (en) * 2006-10-06 2008-04-24 Yanmar Co Ltd Agricultural work vehicle
JP2008238968A (en) * 2007-03-27 2008-10-09 Toyota Motor Corp Collision avoiding device
JP2011062115A (en) * 2009-09-16 2011-03-31 Iseki & Co Ltd Working vehicle
JP2013167965A (en) * 2012-02-14 2013-08-29 Toyota Motor Corp Collision warning device
JP2014002608A (en) * 2012-06-19 2014-01-09 Toyota Motor Corp Road side object detection device
WO2015147149A1 (en) * 2014-03-28 2015-10-01 ヤンマー株式会社 Autonomously traveling work vehicle
US20170118915A1 (en) * 2015-11-03 2017-05-04 Claas Selbstfahrende Erntemaschinen Gmbh Surroundings detection device for agricultural work machines
JP2018043599A (en) * 2016-09-13 2018-03-22 日立建機株式会社 Mine work machine and method of monitoring backward thereof

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05205198A (en) * 1992-01-29 1993-08-13 Mazda Motor Corp Obstacle detection device for vehicle
JP2008092818A (en) * 2006-10-06 2008-04-24 Yanmar Co Ltd Agricultural work vehicle
JP2008238968A (en) * 2007-03-27 2008-10-09 Toyota Motor Corp Collision avoiding device
JP2011062115A (en) * 2009-09-16 2011-03-31 Iseki & Co Ltd Working vehicle
JP2013167965A (en) * 2012-02-14 2013-08-29 Toyota Motor Corp Collision warning device
JP2014002608A (en) * 2012-06-19 2014-01-09 Toyota Motor Corp Road side object detection device
WO2015147149A1 (en) * 2014-03-28 2015-10-01 ヤンマー株式会社 Autonomously traveling work vehicle
US20170118915A1 (en) * 2015-11-03 2017-05-04 Claas Selbstfahrende Erntemaschinen Gmbh Surroundings detection device for agricultural work machines
JP2018043599A (en) * 2016-09-13 2018-03-22 日立建機株式会社 Mine work machine and method of monitoring backward thereof

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20220084266A (en) 2019-10-18 2022-06-21 얀마 파워 테크놀로지 가부시키가이샤 Obstacle detection system
JP2021111213A (en) * 2020-01-14 2021-08-02 株式会社ダイフク Article transportation facility
JP7327174B2 (en) 2020-01-14 2023-08-16 株式会社ダイフク Goods transport equipment
DE112020007538T5 (en) 2020-08-27 2023-08-03 Mitsubishi Electric Corporation Driving assistance device, learning device, driving assistance method, driving assistance program, learned model creation method, and learned model creation program data carrier

Also Published As

Publication number Publication date
JP6923472B2 (en) 2021-08-18

Similar Documents

Publication Publication Date Title
JP6926020B2 (en) Obstacle detection system
WO2019187937A1 (en) Obstacle detection system and work vehicle
WO2019187884A1 (en) Work vehicle autonomous travel device
JP2019169059A (en) Travel area shape specification device
WO2020044802A1 (en) Obstacle sensing system
US20210018617A1 (en) Obstacle Detection System for Work Vehicle
JP7122845B2 (en) Automatic traveling device for work vehicle
JP6949771B2 (en) Travel area shape identification device
JP2022159351A (en) work vehicle
JP7192061B2 (en) Work vehicle travel control system
JP2019168888A (en) Obstacle detection system
JP7162704B2 (en) Automatic traveling device for work vehicle
JP6942664B2 (en) Travel control system for work vehicles
JP2021182001A (en) Work vehicle
WO2019187938A1 (en) Travel control system of work vehicle
JP2019175050A (en) Collaboration system
JP6923480B2 (en) Obstacle detection system
JP2019175318A (en) Travel control system for work vehicle
WO2020044801A1 (en) Obstacle detection system
WO2020044800A1 (en) Obstacle detection system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200130

RD03 Notification of appointment of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7423

Effective date: 20200814

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201130

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201208

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210202

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210729

R150 Certificate of patent or registration of utility model

Ref document number: 6923472

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150