(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2022-12-09
(45)【発行日】2022-12-19
(54)【発明の名称】作業車両の走行制御システム
(51)【国際特許分類】
G05D 1/02 20200101AFI20221212BHJP
A01B 69/00 20060101ALI20221212BHJP
【FI】
G05D1/02 N
A01B69/00 303J
A01B69/00 301
(21)【出願番号】P 2021139901
(22)【出願日】2021-08-30
(62)【分割の表示】P 2018057863の分割
【原出願日】2018-03-26
【審査請求日】2021-08-31
(73)【特許権者】
【識別番号】000006781
【氏名又は名称】ヤンマーパワーテクノロジー株式会社
(74)【代理人】
【識別番号】100167302
【氏名又は名称】種村 一幸
(74)【代理人】
【識別番号】100135817
【氏名又は名称】華山 浩伸
(74)【代理人】
【識別番号】100167830
【氏名又は名称】仲石 晴樹
(72)【発明者】
【氏名】横山 和寿
(72)【発明者】
【氏名】岩瀬 卓也
(72)【発明者】
【氏名】▲杉▼田 士郎
【審査官】今井 貞雄
(56)【参考文献】
【文献】特開2017-221164(JP,A)
【文献】米国特許出願公開第2015/0336546(US,A1)
【文献】特開平11-332329(JP,A)
(58)【調査した分野】(Int.Cl.,DB名)
G05D 1/02
A01B 69/00
(57)【特許請求の範囲】
【請求項1】
作業車両に備えられ、測定対象物までの距離を測定する距離センサと、
その距離センサの測定情報に基づいて、走行領域の
うち走行面の傾斜角度が変化し得る特定箇所における前記作業車両の走行面の傾斜角度を演算する傾斜角度演算部と、
その傾斜角度演算部にて演算された傾斜角度が可能範囲外である場合には、前記作業車両が前記走行領域の
前記特定箇所を走
行するのを牽制する牽制部とを備え、
前記作業車両が前記走行領域の
前記特定箇所に到達したと判定すると、前記傾斜角度演算部が、前記走行領域の
前記特定箇所における走行面の傾斜角度を演算する、
作業車両の走行制御システム。
【請求項2】
前記特定箇所は、前記走行領域の入口又は出口であって、
前記走行領域の入口の傾斜角度については前記可能範囲としての進入可能範囲外か否かを判定し、前記走行領域の出口の傾斜角度については前記可能範囲としての退場可能範囲外か否かを判定する判定部を更に備える、
請求項1に記載の作業車両の走行制御システム。
【請求項3】
前記特定箇所は、前記走行領域の入口又は出口であって、
前記走行領域の入口にて前記作業車両を自動走行させて前記走行領域内へ進入させる進入自動走行制御及び前記走行領域の出口にて前記作業車両を自動走行させて前記走行領域外へ退場させる退場自動走行制御を行う自動走行制御部が備えられ、
前記傾斜角度演算部にて演算された傾斜角度が可能範囲外である場合には、前記牽制部が、前記自動走行制御部による進入自動走行制御又は退場自動走行制御の実行を禁止している、
請求項1又は2に記載の作業車両の走行制御システム。
【請求項4】
前記傾斜角度演算部にて演算された傾斜角度が可能範囲外である場合には、前記牽制部が、報知を実行する、
請求項1~3の何れか1項に記載の作業車両の走行制御システム。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、作業車両の走行を制御する作業車両の走行制御システムに関する。
【背景技術】
【0002】
上記のような作業車両の走行制御システムは、例えば、作業車両を自動走行させる自動走行システムに適用され、衛星測位システムから得られる作業車両の位置情報に基づいて、予め設定された目標走行経路に沿って作業車両を自動走行させる自動走行制御を行うようにしている(例えば、特許文献1参照。)。
【0003】
特許文献1に記載のシステムでは、作業車両にて所定の作業を行う圃場等の走行領域内だけでなく、走行領域の入口から走行領域内の作業開始点までの前走行経路を設定して、その前走行経路に沿って作業車両を自動走行させるようにしている。
【先行技術文献】
【特許文献】
【0004】
【発明の概要】
【発明が解決しようとする課題】
【0005】
上記特許文献1に記載のシステムでは、前走行経路を設定するに当たり、圃場等の走行領域の入口における走行面傾斜情報を事前に記録された地図情報から取得し、その走行面傾斜情報を考慮して前走行経路を設定している。しかしながら、走行領域の入口における走行面の傾斜角度は、様々な状況の変化に応じて変化するものであり、走行面傾斜情報を取得した時点から走行面の傾斜角度が変化している場合がある。このような場合に、事前に設定された前走行経路に沿って作業車両を自動走行させると、急激な傾斜角度にて作業車両が走行領域内に進入することになり、作業車両の転倒が生じる可能性がある。
【0006】
この実情に鑑み、本発明の主たる課題は、急激な傾斜角度での走行領域内への進入を防止しながら、走行領域の入口にて作業車両を走行させることができる作業車両の走行制御システムを提供する点にある。
【課題を解決するための手段】
【0007】
本発明の一態様に係る作業車両の走行制御システムは、作業車両に備えられ、測定対象物までの距離を測定する距離センサと、その距離センサの測定情報に基づいて、走行領域の入口又は出口における前記作業車両の走行面の傾斜角度を演算する傾斜角度演算部と、その傾斜角度演算部にて演算された傾斜角度が可能範囲外である場合には、前記作業車両が前記走行領域の入口又は出口を走行して走行領域内へ進入又は走行領域外へ退場するのを牽制する牽制部とを備え、前記作業車両が前記走行領域の入口又は出口に到達したと判定すると、前記傾斜角度演算部が、前記走行領域の入口又は出口における走行面の傾斜角度を演算する。
【図面の簡単な説明】
【0008】
【
図2】自動走行システムの概略構成を示すブロック図
【
図4】正面視におけるトラクタの上方側部位を示す図
【
図5】背面視におけるトラクタの上方側部位を示す図
【
図6】側面視における使用位置でのアンテナユニット及び前ライダーセンサを示す図
【
図7】アンテナユニット及び前ライダーセンサの支持構造を示す斜視図
【
図8】側面視における非使用位置でのアンテナユニット及び前ライダーセンサを示す図
【
図9】使用位置及び非使用位置における側面視でのルーフ、アンテナユニット、前ライダーセンサ、及び、後ライダーセンサを示す図
【
図11】側面視における前ライダーセンサ及び後ライダーセンサの測定範囲を示す図
【
図12】平面視における前ライダーセンサ、後ライダーセンサ及びソナーユニットの測定範囲を示す図
【
図13】前ライダーセンサの測定情報から生成した3次元画像を示す図
【
図14】作業装置を下降位置に位置させた状態での後ライダーセンサの測定情報から生成した3次元画像を示す図
【
図15】作業装置を上昇位置に位置させた状態での後ライダーセンサの測定情報から生成した3次元画像を示す図
【
図16】走行領域の入口にて作業車両を走行領域内に進入させる状態を示す平面図
【
図17】走行領域の入口における作業車両の走行面を示す図
【
図18】進入自動走行制御における動作を示すフローチャート
【
図19】走行領域間及び走行領域の出入口における作業車両の走行状態を示す平面図
【発明を実施するための形態】
【0009】
本発明に係る作業車両の走行制御システムを備えた作業車両を自動走行システムに適用した場合の実施形態を図面に基づいて説明する。
この自動走行システムにおいては、
図1に示すように、本発明に係る作業車両としてトラクタ1を適用しているが、トラクタ以外の、乗用田植機、コンバイン、乗用草刈機、ホイールローダ、除雪車等の乗用作業車両、及び、無人草刈機等の無人作業車両を適用することができる。
【0010】
この自動走行システムは、
図1及び
図2に示すように、トラクタ1に搭載された自動走行ユニット2、及び、自動走行ユニット2と通信可能に通信設定された携帯通信端末3を備えている。携帯通信端末3には、タッチ操作可能な表示部51(例えば、液晶パネル)等を有するタブレット型のパーソナルコンピュータやスマートフォン等を採用することができる。
【0011】
トラクタ1は、駆動可能な操舵輪として機能する左右の前輪5、及び、駆動可能な左右の後輪6を有する走行機体7が備えられている。走行機体7の前方側には、ボンネット8が配置され、ボンネット8内には、コモンレールシステムを備えた電子制御式のディーゼルエンジン(以下、エンジンと称する)9が備えられている。走行機体7のボンネット8よりも後方側には、搭乗式の運転部を形成するキャビン10が備えられている。
【0012】
走行機体7の後部には、3点リンク機構11を介して、作業装置12の一例であるロータリ耕耘装置を昇降可能かつローリング可能に連結することで、トラクタ1をロータリ耕耘仕様に構成することができる。トラクタ1の後部には、ロータリ耕耘装置に代えて、プラウ、播種装置、散布装置、等の作業装置12を連結することができる。
【0013】
トラクタ1には、
図2に示すように、エンジン9からの動力を変速する電子制御式の変速装置13、左右の前輪5を操舵する全油圧式のパワーステアリング機構14、左右の後輪6を制動する左右のサイドブレーキ(図示せず)、左右のサイドブレーキの油圧操作を可能にする電子制御式のブレーキ操作機構15、ロータリ耕耘装置等の作業装置12への伝動を断続する作業クラッチ(図示せず)、作業クラッチの油圧操作を可能にする電子制御式のクラッチ操作機構16、ロータリ耕耘装置等の作業装置12を昇降駆動する電子油圧制御式の昇降駆動機構17、トラクタ1の自動走行等に関する各種の制御プログラム等を有する車載電子制御ユニット18、トラクタ1の車速を検出する車速センサ19、前輪5の操舵角を検出する舵角センサ20、及び、トラクタ1の現在位置及び現在方位を測定する測位ユニット21等が備えられている。
【0014】
なお、エンジン9には、電子ガバナを備えた電子制御式のガソリンエンジンを採用してもよい。変速装置13には、油圧機械式無段変速装置(HMT)、静油圧式無段変速装置(HST)、又は、ベルト式無段変速装置等を採用することができる。パワーステアリング機構14には、電動モータを備えた電動式のパワーステアリング機構14等を採用してもよい。
【0015】
キャビン10は、
図4及び
図5に示すように、キャビン10の骨組みを形成するキャビンフレーム31と、前方側を覆うフロントガラス32と、後方側を覆うリアガラス33と、上下方向に沿う軸心周りで揺動開閉可能な左右一対のドア34(
図1参照)と、天井側のルーフ35とを備えた箱状に構成されている。キャビンフレーム31は、前端部に配置された左右一対の前側支柱36と、後端部に配置された左右一対の後側支柱37とを備えている。平面視において、前方側の左右両側の隅部に前側支柱36が配置され、後方側の左右両側の隅部に後側支柱37が配置されている。キャビンフレーム31は、弾性体等の防振部材を介して走行機体7上に支持されており、走行機体7等からの振動がキャビン10に伝達されるのを防止する防振対策が施された状態で、キャビン10が備えられている。
【0016】
キャビン10の内部には、
図1に示すように、パワーステアリング機構14(
図2参照)を介した左右の前輪5の手動操舵を可能にするステアリングホイール38、搭乗者用の運転席39、タッチパネル式の表示部、及び、各種の操作具等が備えられている。キャビン10の前方側部位の両横側部には、キャビン10(運転席39)への乗降部となる乗降ステップ41が備えられている。
【0017】
図2に示すように、車載電子制御ユニット18は、変速装置13の作動を制御する変速制御部181、左右のサイドブレーキの作動を制御する制動制御部182、ロータリ耕耘装置等の作業装置12の作動を制御する作業装置制御部183、自動走行時に左右の前輪5の目標操舵角を設定してパワーステアリング機構14に出力する操舵角設定部184、及び、予め設定された自動走行用の目標走行経路P(例えば、
図3参照)等を記憶する不揮発性の車載記憶部185等を有している。
【0018】
図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が設置されている。
【0019】
トラクタ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の現在位置、現在方位、姿勢角(ヨー角、ロール角、ピッチ角)を高精度に測定することができる。
【0020】
トラクタ1に備えられるGPSアンテナ24、通信モジュール25、及び、慣性計測装置23は、
図1に示すように、アンテナユニット80に収納されている。アンテナユニット80は、キャビン10の前面側の上部位置に配置されている。
【0021】
図2に示すように、携帯通信端末3には、表示部51等の作動を制御する各種の制御プログラム等を有する端末電子制御ユニット52、及び、トラクタ側の通信モジュール25との間における測位情報を含む各種情報の無線通信を可能にする通信モジュール55、等が備えられている。端末電子制御ユニット52は、トラクタ1を自動走行させるための走行案内用の目標走行経路P(例えば、
図3参照)を生成する走行経路生成部53、及び、ユーザが入力した各種の入力情報や走行経路生成部53が生成した目標走行経路P等を記憶する不揮発性の端末記憶部54、等を有している。
【0022】
走行経路生成部53が目標走行経路Pを生成するに当たり、携帯通信端末3の表示部51に表示された目標走行経路設定用の入力案内に従って、運転者や管理者等のユーザ等が作業車両や作業装置12の種類や機種等の車体情報を入力しており、入力された車体情報が端末記憶部54に記憶されている。目標走行経路Pの生成対象となる走行領域S(
図3参照)を圃場としており、携帯通信端末3の端末電子制御ユニット52は、圃場の形状や位置を含む圃場情報を取得して端末記憶部54に記憶している。
【0023】
圃場情報の取得について説明すると、ユーザ等が運転してトラクタ1を実際に走行させることで、端末電子制御ユニット52は、測位ユニット21にて取得するトラクタ1の現在位置等から圃場の形状や位置等を特定するための位置情報を取得することができる。端末電子制御ユニット52は、取得した位置情報から圃場の形状及び位置を特定し、その特定した圃場の形状及び位置から特定した走行領域Sを含む圃場情報を取得している。
図3では、矩形状の走行領域Sが特定された例を示している。
【0024】
特定された圃場の形状や位置等を含む圃場情報が端末記憶部54に記憶されると、走行経路生成部53は、端末記憶部54に記憶されている圃場情報や車体情報を用いて、目標走行経路Pを生成する。
【0025】
図3に示すように、走行経路生成部53は、走行領域S内を中央領域R1と外周領域R2とに区分け設定している。中央領域R1は、走行領域Sの中央部に設定されており、先行してトラクタ1を往復方向に自動走行させて所定の作業(例えば、耕耘等の作業)を行う往復作業領域となっている。外周領域R2は、中央領域R1の周囲に設定されており、中央領域R1に後続してトラクタ1を周回方向に自動走行させて所定の作業を行う周回作業領域となっている。走行経路生成部53は、例えば、車体情報に含まれる旋回半径やトラクタ1の前後幅及び左右幅等から、トラクタ1を圃場の畔際で旋回走行させるために必要となる旋回走行用のスペース等を求めている。走行経路生成部53は、中央領域R1の外周に求めたスペース等を確保するように、走行領域S内を中央領域R1と外周領域R2とに区分けしている。
【0026】
走行経路生成部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は、あくまで一例であり、どのような目標走行経路を設定するかは適宜変更が可能である。
【0027】
走行経路生成部53にて生成された目標走行経路Pは、表示部51に表示可能であり、車体情報及び圃場情報等と関連付けた経路情報として端末記憶部54に記憶されている。経路情報には、目標走行経路Pの方位角、及び、目標走行経路Pでのトラクタ1の走行形態等に応じて設定された設定エンジン回転速度や目標走行速度、等が含まれている。
【0028】
このようにして、走行経路生成部53が目標走行経路Pを生成すると、端末電子制御ユニット52が、携帯通信端末3からトラクタ1に経路情報を転送することで、トラクタ1の車載電子制御ユニット18が、経路情報を取得することができる。車載電子制御ユニット18は、取得した経路情報に基づいて、測位ユニット21にて自己の現在位置(トラクタ1の現在位置)を取得しながら、目標走行経路Pに沿ってトラクタ1を自動走行させることができる。測位ユニット21にて取得するトラクタ1の現在位置については、リアルタイム(例えば、数秒周期)でトラクタ1から携帯通信端末3に送信されており、携帯通信端末3にてトラクタ1の現在位置を把握している。
【0029】
経路情報の転送に関しては、トラクタ1が自動走行を開始する前の段階において、経路情報の全体を端末電子制御ユニット52から車載電子制御ユニット18に一挙に転送することができる。また、例えば、目標走行経路Pを含む経路情報を、情報量の少ない所定距離ごとの複数の経路部分に分割することもできる。この場合には、トラクタ1が自動走行を開始する前の段階においては、経路情報の初期経路部分のみが端末電子制御ユニット52から車載電子制御ユニット18に転送される。自動走行の開始後は、トラクタ1が情報量等に応じて設定された経路取得地点に達するごとに、その地点に対応する以後の経路部分のみの経路情報が端末電子制御ユニット52から車載電子制御ユニット18に転送するようにしてもよい。
【0030】
トラクタ1の自動走行を開始する場合には、例えば、ユーザ等がスタート地点にトラクタ1を移動させて、各種の自動走行開始条件が満たされると、携帯通信端末3にて、ユーザが表示部51を操作して自動走行の開始を指示することで、携帯通信端末3は、自動走行の開始指示をトラクタ1に送信する。これにより、トラクタ1では、車載電子制御ユニット18が、自動走行の開始指示を受けることで、測位ユニット21にて自己の現在位置(トラクタ1の現在位置)を取得しながら、目標走行経路Pに沿ってトラクタ1を自動走行させる自動走行制御を開始する。車載電子制御ユニット18が、衛星測位システムを用いて測位ユニット21により取得されるトラクタ1の測位情報に基づいて、走行領域S内の目標走行経路Pに沿ってトラクタ1を自動走行させる自動走行制御を行う自動走行制御部として構成されている。
【0031】
自動走行制御には、変速装置13の作動を自動制御する自動変速制御、ブレーキ操作機構15の作動を自動制御する自動制動制御、左右の前輪5を自動操舵する自動操舵制御、及び、ロータリ耕耘装置等の作業装置12の作動を自動制御する作業用自動制御、等が含まれている。
【0032】
自動変速制御においては、変速制御部181が、目標走行速度を含む目標走行経路Pの経路情報と測位ユニット21の出力と車速センサ19の出力とに基づいて、目標走行経路Pでのトラクタ1の走行形態等に応じて設定された目標走行速度がトラクタ1の車速として得られるように変速装置13の作動を自動制御する。
【0033】
自動制動制御においては、制動制御部182が、目標走行経路Pと測位ユニット21の出力とに基づいて、目標走行経路Pの経路情報に含まれている制動領域において左右のサイドブレーキが左右の後輪6を適正に制動するようにブレーキ操作機構15の作動を自動制御する。
【0034】
自動操舵制御においては、トラクタ1が目標走行経路Pを自動走行するように、操舵角設定部184が、目標走行経路Pの経路情報と測位ユニット21の出力とに基づいて左右の前輪5の目標操舵角を求めて設定し、設定した目標操舵角をパワーステアリング機構14に出力する。パワーステアリング機構14が、目標操舵角と舵角センサ20の出力とに基づいて、目標操舵角が左右の前輪5の操舵角として得られるように左右の前輪5を自動操舵する。
【0035】
作業用自動制御においては、作業装置制御部183が、目標走行経路Pの経路情報と測位ユニット21の出力とに基づいて、トラクタ1が作業経路P1(例えば、
図3参照)の始端等の作業開始地点に達するのに伴って作業装置12による所定の作業(例えば耕耘作業)が開始され、かつ、トラクタ1が作業経路P1(例えば、
図3参照)の終端等の作業終了地点に達するのに伴って作業装置12による所定の作業が停止されるように、クラッチ操作機構16及び昇降駆動機構17の作動を自動制御する。
【0036】
このようにして、トラクタ1においては、変速装置13、パワーステアリング機構14、ブレーキ操作機構15、クラッチ操作機構16、昇降駆動機構17、車載電子制御ユニット18、車速センサ19、舵角センサ20、測位ユニット21、及び、通信モジュール25、等によって自動走行ユニット2が構成されている。
【0037】
この実施形態では、キャビン10にユーザ等が搭乗せずにトラクタ1を自動走行させるだけでなく、キャビン10にユーザ等が搭乗した状態でトラクタ1を自動走行させることも可能となっている。よって、キャビン10にユーザ等が搭乗せずに、車載電子制御ユニット18による自動走行制御により、トラクタ1を目標走行経路Pに沿って自動走行させることができるだけでなく、キャビン10にユーザ等が搭乗している場合でも、車載電子制御ユニット18による自動走行制御により、トラクタ1を目標走行経路Pに沿って自動走行させることができる。
【0038】
キャビン10にユーザ等が搭乗している場合には、車載電子制御ユニット18にてトラクタ1を自動走行させる自動走行状態と、ユーザ等の運転に基づいてトラクタ1を走行させる手動走行状態とに切り替えることができる。よって、自動走行状態にて目標走行経路Pを自動走行している途中に、自動走行状態から手動走行状態に切り替えることができ、逆に、手動走行状態にて走行している途中に、手動走行状態から自動走行状態に切り替えることができる。手動走行状態と自動走行状態との切り替えについては、例えば、運転席39の近傍に、自動走行状態と手動走行状態とに切り替えるための切替操作部を備えることができるとともに、その切替操作部を携帯通信端末3の表示部51に表示させることもできる。また、車載電子制御ユニット18による自動走行制御中に、ユーザがステアリングホイール38を操作すると、自動走行状態から手動走行状態に切り替えることができる。
【0039】
トラクタ1には、
図1及び
図2に示すように、トラクタ1(走行機体7)の周囲における障害物を検知して、障害物との衝突を回避するための障害物検知システム100が備えられている。障害物検知システム100は、レーザを用いて測定対象物までの距離を3次元で測定可能な複数のライダーセンサ(距離センサに相当する)101,102と、超音波を用いて測定対象物までの距離を測定可能な複数のソナーを有するソナーユニット103,104と、障害物検知部110と、衝突回避制御部111とが備えられている。ここで、ライダーセンサ101,102及びソナーユニット103~106にて測定する測定対象物は、物体や人等としている。
【0040】
障害物検知部110は、ライダーセンサ101,102及びソナーユニット103,104の測定情報に基づいて、所定距離内の物体や人等の測定対象物を障害物として検知する障害物検知処理を行うように構成されている。衝突回避制御部111は、障害物検知部110にて障害物を検知すると、衝突回避制御を行うように構成されている。障害物検知部110は、ライダーセンサ101,102及びソナーユニット103,104の測定情報に基づく障害物検知処理をリアルタイムで繰り返し行い、物体や人等の障害物を適切に検知しており、衝突回避制御部111は、リアルタイムで検知される障害物との衝突を回避するための衝突回避制御を行うようにしている。
【0041】
障害物検知部110及び衝突回避制御部111は、車載電子制御ユニット18に備えられている。車載電子制御ユニット18は、コモンレールシステムに含まれたエンジン用の電子制御ユニット、ライダーセンサ101,102、及び、ソナーユニット103,104、等にCAN(Controller Area Network)を介して通信可能に接続されている。
【0042】
ライダーセンサ101,102は、レーザ光(例えば、パルス状の近赤外レーザ光)が測定対象物に当たって跳ね返ってくるまでの往復時間から測定対象物までの距離を測定している(Time Of Flight)。ライダーセンサ101,102は、レーザ光を上下方向及び左右方向に高速で走査し、各走査角における測定対象物までの距離を順次測定していくことで、測定対象物までの距離を3次元で測定している。ライダーセンサ101,102は、測定範囲内における測定対象物までの距離をリアルタイムで繰り返し測定している。ライダーセンサ101,102は、測定情報から3次元画像を生成して外部に出力可能に構成されている。ライダーセンサ101,102の測定情報から生成された3次元画像は、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させて、ユーザ等に障害物の有無を視認させることができる。ちなみに、3次元画像では、例えば、色等を用いて遠近方向での距離を示すことができる。
【0043】
ライダーセンサ101,102として、
図11及び
図12に示すように、トラクタ1(走行機体7)の前方側を測定範囲Cとし、トラクタ1の前方側での障害物を検知するために用いる前ライダーセンサ101と、トラクタ1(走行機体7)の後方側を測定範囲Dとし、トラクタ1の後方側での障害物を検知するために用いる後ライダーセンサ102とが備えられている。
【0044】
以下、前ライダーセンサ101及び後ライダーセンサ102について説明するが、前ライダーセンサ101の支持構造、後ライダーセンサ102の支持構造、前ライダーセンサ101の測定範囲C、後ライダーセンサ102の測定範囲Dの順に説明する。
【0045】
前ライダーセンサ101の支持構造について説明する。
前ライダーセンサ101は、
図1及び
図7に示すように、キャビン10の前面側の上部位置に配置されたアンテナユニット80の底部に取り付けられているので、まず、アンテナユニット80の支持構造について説明し、次に、アンテナユニット80の底部への前ライダーセンサ101の取り付け構造を説明する。
【0046】
アンテナユニット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が強固に支持されている。
【0047】
アンテナユニット支持ステー81に対するアンテナユニット80の取り付け構造については、
図6及び
図7に示すように、アンテナユニット80側に固定された第2取付プレート202とアンテナユニット支持ステー81側に固定された第3取付プレート203とをボルトナット等の連結具50により締結することで、アンテナユニット80がアンテナユニット支持ステー81に取り付けられている。
【0048】
第2取付プレート202は、
図7に示すように、走行機体7の左右方向に所定間隔を隔てて左右一対備えられている。第2取付プレート202は、左右方向に延びるユニット側取付部202aの外側端部から下方側に延びるステー側取付部202bを有するL字状に屈曲された板状体にて構成されている。第2取付プレート202は、ユニット側取付部202aが連結具50等によりアンテナユニット80の底部に固定連結され、ステー側取付部202bが下方側に延びる姿勢で取り付けられている。第2取付プレート202のステー側取付部202bには、図示は省略するが、連結具等による連結用の丸孔が前後一対形成されている。
【0049】
第3取付プレート203は、
図6及び
図7に示すように、前方側部位が後方側部位よりも下方側に延びるL字状の板状体にて構成されている。第3取付プレート203は、第2取付プレート202と同様に、走行機体7の左右方向に所定間隔を隔てて左右一対備えられている。第3取付プレート203は、後方側部位の下端縁が溶接等によりアンテナユニット支持ステー81の上部に固定連結され、前方側部位がアンテナユニット支持ステー81の前方側に位置する姿勢で取り付けられている。第3取付プレート203には、前方側部位から後方側部位に亘って走行機体7の前後方向に沿って延びる長尺な長孔203aが形成され、前方側部位の下方側に連結用の丸孔203bが形成されている。
【0050】
アンテナユニット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による連結箇所となっている。
【0051】
アンテナユニット80は、
図6に示すように、使用位置だけでなく、
図8に示すように、アンテナユニット支持ステー81の前方側にアンテナユニット80を位置させて、通信モジュール25のアンテナが前方側に延びる非使用位置でも、アンテナユニット支持ステー81に取付自在に構成されている。
【0052】
アンテナユニット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に取り付けることができる。
【0053】
例えば、アンテナユニット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を使用位置から非使用位置に位置変更することができる。
【0054】
アンテナユニット80を使用位置にて取り付けた状態では、
図9(a)に示すように、ルーフ35の最高部位35aを通る最高位線Zよりもアンテナユニット80の一部が上方側に突出しており、通信モジュール25のアンテナをより上方側に配置させることができ、通信モジュール25の無線通信を適切に行えるようにしている。それに対して、アンテナユニット80を非使用位置にて取り付けた状態では、
図9(b)に示すように、アンテナユニット80の上端部を最高位線Zと同じ高さ位置又は最高位線Zよりも低い位置に配置させている。これにより、トラクタ1を輸送する際やトラクタ1を納屋等の収納箇所に収納する際に、アンテナユニット80が最高位線Zよりも上方側に突出することなく、アンテナユニット80が邪魔になったり、障害物等への接触によるアンテナユニット80の破損等が生じるのを防止することができる。
【0055】
アンテナユニット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にて挟み込まれる状態で取り付けられている。
【0056】
前ライダーセンサ101は、
図7に示すように、第4取付プレート204及び第5取付プレート205を介して、アンテナユニット80に着脱自在に構成されている。前ライダーセンサ101を後付けすることも可能であり、前ライダーセンサ101だけを取り外すことも可能となっている。また、アンテナユニット80も、アンテナユニット支持ステー81を介して、ミラー取付部45に着脱自在に構成されているので、前ライダーセンサ101は、前ライダーセンサ101単体で走行機体7に対して着脱することができるとともに、アンテナユニット80とともに走行機体7に対して着脱することもできる。前ライダーセンサ101は、アンテナユニット80を支持するアンテナユニット支持ステー81等を共通の支持ステーとして利用しており、アンテナユニット80と同様に、前ライダーセンサ101への振動の伝達等を防止しながら強固に支持されている。
【0057】
前ライダーセンサ101は、アンテナユニット80に一体的に備えられているので、アンテナユニット80を使用位置と非使用位置との間で位置変更することで、
図6に示すように、前ライダーセンサ101も、走行機体7の前方側を向いて走行機体7の前方側の障害物検知に使用される使用位置と、
図8に示すように、下方側を向いて障害物検知に使用されない非使用位置とに位置変更自在に構成されている。
【0058】
前ライダーセンサ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にて遮られるのを抑制することができる。
【0059】
前ライダーセンサ101が非使用位置に位置するときには、
図8及び
図9(b)に示すように、アンテナユニット80と同様に、前ライダーセンサ101の上端部を最高位線Z(
図9(b)参照)よりも低い位置に配置させている。これにより、トラクタ1を輸送する際やトラクタ1を納屋等の収納箇所に収納する際に、アンテナユニット80だけでなく、前ライダーセンサ101も最高位線Zよりも上方側に突出するのを防止している。
【0060】
前ライダーセンサ101の配置位置について、走行機体7の左右方向では、アンテナユニット80の左右方向の中央部に配置されている。アンテナユニット80は、走行機体7の左右方向においてキャビン10の中央部に相当する位置に配置されているので、前ライダーセンサ101も、走行機体7の左右方向においてキャビン10の中央部に相当する位置に配置されている。
【0061】
第5取付プレート205には、
図6及び
図7に示すように、前ライダーセンサ101に加えて、走行機体7の前方側を撮像範囲とする前カメラ108が連結具等により取り付けられている。前カメラ108は、前ライダーセンサ101の上方側に配置されている。前カメラ108は、前ライダーセンサ101と同様に、前方側部位ほど下方側に位置する前下がり姿勢にて取り付けられている。前カメラ108は、走行機体7の前方側を斜め上方側から見下ろす状態で撮像するように備えられている。前カメラ108にて撮像した撮像画像を外部に出力可能に構成されている。前カメラ108の撮像画像は、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させて、ユーザ等にトラクタ1の周囲の状況を視認させることができる。
【0062】
次に、後ライダーセンサ102の支持構造について説明する。
後ライダーセンサ102は、
図5及び
図10に示すように、走行機体7の左右方向においてキャビン10の全長に亘るパイプ状のセンサ支持ステー301に取り付けられている。後ライダーセンサ102は、走行機体7の左右方向においてキャビン10の中央部に相当する位置に配置されている。
【0063】
センサ支持ステー301は、
図5及び
図10に示すように、キャビン10の左右両端部に位置する左右の後側支柱37に亘る状態で固定連結されている。センサ支持ステー301は、その左右両端側部位が斜め前方側に湾曲された平面視でブリッジ状に形成されている。センサ支持ステー301の左右両端部は、第6取付プレート206を介して、左右の後側支柱37の上端側部位に備えられた取付部材に固定連結されている。センサ支持ステー301の左右両端部には、溶接等により第6取付プレート206が固定連結されている。第6取付プレート206と後側支柱37の上端側部位に備えられた取付部材とを連結具50にて締結することで、センサ支持ステー301が水平方向に延びる姿勢で固定連結されている。
【0064】
センサ支持ステー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とに亘る状態で備えられている。
【0065】
後ライダーセンサ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にて遮られるのを抑制することができる。
【0066】
後ライダーセンサ102は、
図10に示すように、センサ支持ステー301、第7取付プレート207及び第8取付プレート208を介して、後側支柱37に着脱自在に構成されている。後ライダーセンサ102を後付けすることも可能であり、後ライダーセンサ102を取り外すことも可能となっている。後ライダーセンサ102は、センサ支持ステー301を介して、キャビンフレーム31を構成する後側支柱37に支持されているので、後ライダーセンサ102への振動の伝達等を防止しながら強固に支持されている。
【0067】
第8取付プレート208には、
図10に示すように、後ライダーセンサ102に加えて、走行機体7の後方側を撮像範囲とする後カメラ109が連結具等により取り付けられている。後カメラ109は、後ライダーセンサ102の上方側に配置されている。後カメラ109は、後ライダーセンサ102と同様に、後方側部位ほど下方側に位置する後下がり姿勢にて取り付けられている。後カメラ109は、走行機体7の後方側を斜め上方側から見下ろす状態で撮像するように備えられている。後カメラ109にて撮像した撮像画像を外部に出力可能に構成されている。後カメラ109の撮像画像は、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させて、ユーザ等にトラクタ1の周囲の状況を視認させることができる。
【0068】
前ライダーセンサ101の測定範囲Cについて説明する。
前ライダーセンサ101は、
図12に示すように、左右方向における左右測定範囲C1を有しているとともに、
図11に示すように、上下方向における上下測定範囲C2を有している。これにより、前ライダーセンサ101は、自己から第1設定距離X1(
図12参照)だけ離れた位置までの範囲において、左右測定範囲C1と上下測定範囲C2に含まれる上下、左右及び前後の四角錐形状の測定範囲Cが設定されている。
【0069】
前ライダーセンサ101における左右測定範囲C1は、
図12に示すように、走行機体7の左右方向において走行機体7の左右中心線を対称軸とする左右対称な範囲である。左右測定範囲C1は、前ライダーセンサ101から延びる第1境界線E1と第2境界線E2との間の第1設定角度α1の範囲に設定されている。左右測定範囲C1は、走行機体7の横幅方向において、トラクタ1の横幅、及び、作業装置12の横幅よりも大きな範囲に設定されている。左右測定範囲C1は、どのような大きさの範囲とするかは適宜変更が可能である。
【0070】
前ライダーセンサ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の前方側端部)の近傍位置等に物体や人等の測定対象物が存在していても、その測定対象物を測定可能としている。
【0071】
前ライダーセンサ101における上下測定範囲C2には、
図11に示すように、ボンネット8の一部、及び、前輪5の一部が入り込んでいるので、障害物検知部110が、前ライダーセンサ101の測定情報に基づいて障害物検知処理を行うと、ボンネット8の一部や前輪5の一部を障害物として誤検知してしまう可能性がある。そこで、その誤検知を防止するための第1マスキング処理が施されている。第1マスキング処理では、前ライダーセンサ101の測定範囲C内において、ボンネット8の一部及び前輪5の一部が存在する範囲を、障害物としての検知を行わないマスキング範囲L(
図13参照)として予め設定している。
【0072】
例えば、第1マスキング処理では、前ライダーセンサ101を使用する前処理として、実際に前ライダーセンサ101による測定を行い、そのときの測定情報から生成した3次元画像を、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させる。ユーザ等が、表示装置の3次元画像を確認しながら、表示装置を操作することで、障害物としての検知を行わないマスキング範囲Lを設定している。
図13に示すように、3次元画像上に、ボンネット8の一部、及び、前輪5の一部が存在していると、そのボンネット8の一部が存在する範囲La、及び、前輪5の一部が存在する範囲Lbを含む基準範囲に基づいて、マスキング範囲Lを設定している。前輪5は、
図13中点線にて示すように、ステアリングホイール38やパワーステアリング機構14等の操作によって左右に操舵されるので、前輪5が左右に操舵される操舵範囲も含むように、マスキング範囲Lを設定するのが好ましい。
【0073】
図13に示すものでは、ボンネット8の一部が存在する範囲La、及び、前輪5の一部が存在する範囲Lbを含む基準範囲よりも設定範囲だけ大きな山形形状の範囲をマスキング範囲Lとして設定している。ちなみに、マスキング範囲Lは、前後方向、左右方向及び上下方向の3次元での範囲に設定されている。マスキング範囲Lについては、例えば、ボンネット8の一部が存在する範囲La、及び、前輪5の一部が存在する範囲Lbだけを含むように、ボンネット8や前輪5の形状に応じた形状に設定することもでき、マスキング範囲Lをどのような範囲及び形状とするかは適宜変更が可能である。
【0074】
このようにして、障害物検知部110は、前ライダーセンサ101の測定情報に基づいて障害物検知処理を行うことで、左右方向で左右測定範囲C1(
図12参照)に含まれ、且つ、上下方向で上下測定範囲C2(
図11参照)に含まれる範囲において、マスキング範囲Lを除く範囲にて障害物の存否を検知している。
【0075】
後ライダーセンサ102の測定範囲Dについて説明する。
後ライダーセンサ102は、前ライダーセンサ101と同様に、
図12に示すように、左右方向における左右測定範囲D1を有しているとともに、
図11に示すように、上下方向における上下測定範囲D2を有している。これにより、後ライダーセンサ102は、自己から第3設定距離X3(
図12参照)だけ離れた位置までの範囲において、左右測定範囲D1と上下測定範囲D2に含まれる上下、左右及び前後の四角錐形状の測定範囲Dが設定されている。ちなみに、X1とX3は、同じ距離に設定したり、異なる距離に設定することもできる。
【0076】
後ライダーセンサ102における左右測定範囲D1は、
図12に示すように、前ライダーセンサ101と同様に、後ライダーセンサ102から延びる第5境界線E5と第6境界線E6との間の第3設定角度α3の範囲に設定されている。左右測定範囲D1は、前ライダーセンサ101と同様に、走行機体7の横幅方向において、トラクタ1の横幅、及び、作業装置12の横幅よりも大きな範囲に設定されている。
【0077】
後ライダーセンサ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の後方側端部の近傍位置等に物体や人等の測定対象物が存在していても、その測定対象物を測定可能としている。
【0078】
後ライダーセンサ102における上下測定範囲D2には、作業装置12の一部が入り込んでいるので、障害物検知部110が、後ライダーセンサ102の測定情報に基づいて障害物検知処理を行うと、作業装置12の一部を障害物として誤検知してしまう可能性がある。そこで、その誤検知を防止するための第2マスキング処理が施されている。第2マスキング処理では、後ライダーセンサ102の測定範囲D内において、作業装置12の一部が存在する範囲を、障害物としての検知を行わないマスキング範囲L(
図14、
図15参照)として予め設定している。
【0079】
例えば、第2マスキング処理では、第1マスキング処理と同様に、後ライダーセンサ102を使用する前処理として、実際に後ライダーセンサ102による測定を行い、そのときの測定情報から生成した3次元画像を、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させる。ユーザ等が、表示装置の3次元画像を確認しながら、表示装置を操作することで、障害物を検知しないマスキング範囲Lを設定している。
【0080】
作業装置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を設定している。
【0081】
図14及び
図15に示すものでは、作業装置12が存在する範囲Lcを含む基準範囲よりも設定範囲だけ大きな矩形状の範囲をマスキング範囲L1,L2として設定している。ちなみに、マスキング範囲Lは、前後方向、左右方向及び上下方向の3次元での範囲に設定されている。マスキング範囲Lについては、例えば、作業装置12が存在する範囲Lcだけを含むように、作業装置12の形状に応じた形状に設定することもでき、マスキング範囲L1,L2をどのような範囲及び形状とするかは適宜変更が可能である。
【0082】
このようにして、障害物検知部110は、後ライダーセンサ102の測定情報に基づいて障害物検知処理を行うことで、左右方向で左右測定範囲D1(
図12参照)に含まれ、且つ、上下方向で上下測定範囲D2(
図11参照)に含まれる範囲において、マスキング範囲L1,L2を除く範囲にて障害物の存否を検知している。障害物検知部110は、作業装置12が下降位置に位置するときには、下降位置用のマスキング範囲L1を用いて障害物検知処理を行っており、作業装置12が上昇位置に位置するときには、上昇位置用のマスキング範囲L2を用いて障害物検知処理を行っている。
【0083】
以下、ソナーユニット103,104について説明する。
ソナーユニット103,104は、投射した超音波が測定対象物に当たって跳ね返ってくるまでの往復時間から測定対象物までの距離を測定するように構成されている。ソナーユニット103~106は、測定範囲内に、何らかの物体が測定対象物として存在すると、その測定対象物を障害物として検知し、障害物までの距離を測定するように構成されている。
【0084】
ソナーユニット103,104として、
図12に示すように、トラクタ1(走行機体7)の右側を測定範囲とする右側のソナーユニット103と、
図12に示すように、トラクタ1(走行機体7)の左側を測定範囲とする左側のソナーユニット104とが備えられている。
【0085】
図12に示すように、右側のソナーユニット103の測定範囲Nと、左側のソナーユニット104の測定範囲Nとは、走行機体7から延びる方向が左右逆方向になっている点が異なるだけであり、右側と左側とで左右対称の測定範囲Nとなっている。
【0086】
ソナーユニット103,104は、走行機体7の機体外方を測定対象とするものである。ソナーユニット103,104は、水平方向よりも所定角度だけ下方側に向けて超音波を投射するように走行機体7に取り付けられ、ソナーユニット103,104から所定角度だけ下方側を向く方向に延びるように測定範囲Nが設定されている。ソナーユニット103,104の測定範囲Nは、ソナーユニット103,104から走行機体7の外方側に向けて所定距離までの距離を半径とする範囲であり、走行機体7の前後方向において、前ライダーセンサ101における左右測定範囲C1と後ライダーセンサ102における左右測定範囲D1との間に設定されている。
【0087】
このようにして、障害物検知部110は、ソナーユニット103,104の測定情報に基づいて障害物検知処理を行うことで、左右の測定範囲Nにて障害物の存否を検知している。
【0088】
以下、障害物検知部110による障害物検知処理、及び、衝突回避制御部111による衝突回避制御について説明するが、まず、ライダーセンサ101,102の測定情報に基づく障害物検知処理にて障害物を検知した場合の衝突回避制御について説明し、次に、ソナーユニット103,104の測定情報に基づく障害物検知処理において障害物を検知した場合の衝突回避制御を説明する。
【0089】
ライダーセンサとして、前ライダーセンサ101と後ライダーセンサ102との2つのライダーセンサを備えているが、障害物検知部110は、目標走行経路Pに含まれた前後進切り替え地点での前後進の切り替え、又は、キャビン10の内部に備えられた前後進切り替え用のリバーサレバーによる前後進の切り替えに基づいて障害物検知状態を切り替える。トラクタ1が前進走行する場合には、前ライダーセンサ101による測定を行い、障害物検知部110が前ライダーセンサ101の測定情報に基づく障害物検知処理を行う前進検知状態に切り替え、トラクタ1が後進走行する場合には、後ライダーセンサ102による測定を行い、障害物検知部110が後ライダーセンサ102の測定情報に基づく障害物検知処理を行う後進検知状態に切り替えている。このように、トラクタ1が前進走行しているか後進走行しているかによって、前ライダーセンサ101と後ライダーセンサ102のどちらのライダーセンサを用いて障害物の検知を行うかを切り替えることで、処理負担の軽減を図りながら、障害物の検知を行うようにしている。
【0090】
前進検知状態では、障害物検知部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参照)を除く範囲にて障害物の存否を検知している。
【0091】
前ライダーセンサ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がその順に近くなるように設定されている。
【0092】
前ライダーセンサ101又は後ライダーセンサ102を用いて障害物を検知した場合の衝突回避制御の制御内容は、トラクタ1が前進走行している場合も後進走行している場合も同様であるので、以下、トラクタ1が前進走行している場合について説明する。
【0093】
トラクタ1が前進走行しているときに、
図12に示すように、障害物検知処理において第1検知範囲J1内で障害物を検知した場合には、衝突回避制御部111が、衝突回避制御として、報知ブザーや報知ランプ等の報知装置26を制御して、第1検知範囲J1内に障害物が存在することを報知する第1報知制御を行う。第1報知制御では、例えば、衝突回避制御部111が、報知ブザーを所定周波数にて断続作動させ、且つ、報知ランプを所定色にて点灯させるように、報知装置26を制御している。
【0094】
障害物検知処理において第2検知範囲J2内で障害物を検知した場合には、衝突回避制御部111が、衝突回避制御として、報知ブザーや報知ランプ等の報知装置26を制御して、第2検知範囲J2内に障害物が存在することを報知する第2報知制御を行うとともに、トラクタ1の車速を減速させる第1減速制御を行う。第2報知制御では、例えば、衝突回避制御部111が、報知ブザーを所定周波数にて断続作動させ、且つ、報知ランプを所定色にて点灯させるように、報知装置26を制御している。第1減速制御では、例えば、衝突回避制御部111が、現在のトラクタ1の車速や障害物までの距離等に基づいて、トラクタ1が障害物に衝突するまでの衝突予測時間を求めている。衝突回避制御部111は、求めた衝突予測時間が設定時間(例えば、3秒)に維持される状態でトラクタ1の車速を減速させるように、エンジン9、変速装置13及びブレーキ操作機構15等を制御している。
【0095】
障害物検知処理において第3検知範囲J3内で障害物を検知した場合には、衝突回避制御部111が、衝突回避制御として、報知ブザーや報知ランプ等の報知装置26を制御して、第3検知範囲J3内に障害物が存在することを報知する第3報知制御を行うとともに、トラクタ1を停止させる停止制御を行う。第3報知制御では、例えば、衝突回避制御部111が、報知ブザーを連続作動させ、且つ、報知ランプを所定色にて点灯させるように、報知装置26を制御している。停止制御では、例えば、衝突回避制御部111が、トラクタ1を停止させるように、ブレーキ操作機構15等を制御している。
【0096】
ちなみに、第1報知制御及び第2報知制御において報知ブザーを断続させる所定周波数は、同じ周波数でもよく、異なる周波数でもよい。また、第1~第3報知制御において報知ランプを点灯させる所定色は、同じ色でもよく、異なる色でもよい。衝突回避制御部111は、第1~第3報知制御において、トラクタ1の報知装置26の制御に加えて、第1~第3検知範囲J1~J3の何れかに障害物が存在することを示す表示内容を携帯通信端末3の表示部51に表示させるように、端末電子制御ユニット52を制御することもできる。
【0097】
例えば、第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と障害物との衝突を適切に回避することができる。
【0098】
ライダーセンサ101,102を用いる場合には、人等の移動する測定対象物も障害物として検知する。よって、検知範囲J内で障害物が検知されても、障害物自体が移動することで、障害物が検知範囲Jから外れることがある。そこで、障害物が第1検知範囲J1から外れた場合には、衝突回避制御部111が、第1報知制御を終了する。障害物が第2検知範囲J2から外れた場合には、衝突回避制御部111が、第2報知制御を終了するとともに、トラクタ1の車速を設定車速まで増速させるように、エンジン9や変速装置13等を制御する車速回復制御を行う。障害物が第3検知範囲J3から外れた場合には、衝突回避制御部111が、トラクタ1を走行停止状態に維持しながら、第3報知制御を終了する。この場合には、ユーザ等によりトラクタ1の自動走行の再開等が指令されることで、トラクタ1の自動走行を再開することができる。
【0099】
次に、ソナーユニット103,104の測定情報に基づく障害物検知処理にて障害物を検知した場合の衝突回避制御について説明する。
ソナーユニット103,104は、左右に備えられているが、トラクタ1が前進走行する場合もトラクタ1が後進走行する場合も、障害物検知部110は、左右両側のソナーユニット103,104の全ての測定情報に基づいて障害物検知処理を行う。
【0100】
ソナーユニット103,104の測定情報に基づく障害物検知処理にて障害物を検知した場合には、衝突回避制御部111が、衝突回避制御として、報知ブザーや報知ランプ等の報知装置26を制御して、ソナーユニット103,104の何れかの測定範囲N内に障害物が存在することを報知する第4報知制御を行うとともに、トラクタ1の車速を減速させる第2減速制御を行う。第4報知制御では、例えば、衝突回避制御部111が、報知ブザーを所定周波数にて断続作動させ、且つ、報知ランプを所定色にて点灯させるように、報知装置26を制御している。第2減速制御では、例えば、衝突回避制御部111が、トラクタ1の車速を設定車速に減速させるように、エンジン9、変速装置13及びブレーキ操作機構15等を制御している。
【0101】
このようにして、障害物検知システム100は、前ライダーセンサ101及び後ライダーセンサ102を用いて走行機体7の前方側及び後方側における障害物の存否を検知するとともに、ソナーユニット103,104を用いて走行機体7の左右における障害物の存否を検知することができる。障害物検知システム100は、障害物検知部110にて障害物の存在を検知すると、衝突回避制御部111が衝突回避制御を行うことによって、障害物の存在をユーザ等に報知して、ユーザ等に障害物との衝突を回避するように促すことができるとともに、仮にトラクタ1と障害物とが衝突する可能性が生じても、トラクタ1を減速や停止させて、トラクタ1と障害物との衝突を適切に回避することができる。
【0102】
自動走行状態では、車載電子制御ユニット18にて自動走行制御が行われるので、障害物検知システム100によりトラクタ1を減速や停止させて、障害物との衝突を回避しながら、トラクタ1を自動走行させることができる。手動走行状態においても、運転しているユーザ等に対しても、障害物検知システム100により障害物の存在を報知したり、トラクタ1と障害物との衝突を回避するための運転をサポートすることができる。
【0103】
トラクタ1の自動走行については、走行領域S内でトラクタ1を自動走行させるだけでなく、
図16に示すように、走行領域Sの入口S1にてトラクタ1を自動走行させて走行領域S内へ進入させるようにしている。圃場等を走行領域Sとした場合には、
図17に示すように、走行領域Sの端部に畔等が存在しており、走行領域Sの端部が畔によって走行領域Sの内側よりも一段高い位置となっている。よって、走行領域Sの入口S1は、走行領域Sの内側が外側よりも低い傾斜状になっている。
【0104】
以下、走行領域Sの入口S1でのトラクタ1の自動走行について説明する。
走行経路生成部53は、例えば、走行領域Sの入口S1における位置情報や走行面傾斜情報等の入口S1に関する入口情報を地図情報から取得している。走行経路生成部53は、走行領域S内に目標走行経路P(
図3参照)を生成するとともに、
図16に示すように、取得した入口情報に基づいて、入口S1にトラクタ1を自動走行させる進入経路P4を生成している。進入経路P4は、例えば、始端P4aから終端P4bまでの直線状の経路となっている。走行領域S内の目標走行経路P及び入口S1の進入経路P4を生成するに当たり、走行経路生成部53は、進入経路P4の終端P4bと目標走行経路Pの始端とを同一位置として、進入経路P4を目標走行経路Pに接続するように、目標走行経路P及び進入経路P4を生成することができる。
【0105】
このように、走行経路生成部53が進入経路P4を生成することで、車載電子制御ユニット18(自動走行制御部に相当する)は、走行領域Sの入口S1にて進入経路P4に沿ってトラクタ1を自動走行させて走行領域S内へ進入させる進入自動走行制御を実行可能に構成されている。進入自動走行制御は、上述の自動走行制御と同様の制御であり、トラクタ1を自動走行させる経路が進入経路P4となっている点が異なるだけである。
【0106】
図16の点線矢印にて示すように、ユーザ等が進入経路P4の始端P4aにトラクタ1を移動させる。各種の自動走行開始条件が満たされると、携帯通信端末3にて、ユーザが表示部51を操作して自動走行の開始を指示することで、車載電子制御ユニット18が進入自動走行制御を行い、入口S1でのトラクタ1の自動走行を開始する。
図16に示すものでは、進入経路P4が目標走行経路Pに接続されているので、トラクタ1が進入経路P4の終端P4bに到達すると、車載電子制御ユニット18が、進入自動走行制御に引き続いて自動走行制御を行い、引き続いて目標走行経路Pに沿ってトラクタ1を自動走行させる。
【0107】
走行領域Sの入口S1における走行面の傾斜角度は、様々な状況の変化に応じて変化するものであり、走行経路生成部53が走行面傾斜情報を取得した時点から走行面の傾斜角度が変化している場合がある。そこで、
図17に示すように、ライダーセンサ101,102の測定情報に基づいて、走行領域Sの入口S1におけるトラクタ1の走行面S1aの傾斜角度α5を求め、その求めた傾斜角度α5が進入可能範囲外であると、トラクタ1が走行領域Sの入口S1を走行して走行領域S内へ進入するのを牽制している。そのために、
図2に示すように、車載電子制御ユニット18には、傾斜角度演算部112と判定部113と進入牽制部114とが備えられている。
【0108】
傾斜角度演算部112は、ライダーセンサ101,102の測定情報に基づいて、走行領域Sの入口S1におけるトラクタ1の走行面S1aの傾斜角度α5を演算している。
図17に示すように、例えば、傾斜角度演算部112は、前ライダーセンサ101の測定情報から入口S1の走行面S1a上における第1地点H1と第2地点H2までの3次元での距離K1,K2を取得しているので、第1地点H1と第2地点H2との高低差K3を求めることができる。傾斜角度演算部112は、第1地点H1の距離を測定した時点と第2地点H2の距離を測定した時点との間の走査角α6を取得している。例えば、走査角α6が同じ角度である場合に、第1地点H1と第2地点H2との高低差K3が大きくなれば、走行面S1aの傾斜角度α5も大きくなる。そこで、例えば、走査角α6、高低差K3、及び、傾斜角度α5の関係を示す関係式等を予め設定している。傾斜角度演算部112は、距離K1,K2から求めた高低差K3、及び、予め設定した関係式等を用いて、走行面S1aの傾斜角度α5を求めることができる。第1地点H1は、トラクタ1から第1所定距離だけ前方側に設定され、第2地点H2は、トラクタ1から第1所定距離よりも大きい第2所定距離だけ前方側に設定されている。第1所定距離及び第2所定距離をどのような大きさとするかは適宜変更が可能である。
【0109】
ちなみに、
図17では、前進走行にて入口S1を走行する場合を示しているが、例えば、後進走行にて入口S1を走行する場合には、傾斜角度演算部112が、後ライダーセンサ102の測定情報に基づいて、入口S1の走行面S1aにおける傾斜角度α5を演算することができる。
【0110】
判定部113は、傾斜角度演算部112にて演算された走行面S1aの傾斜角度α5を用いて、その傾斜角度α5が進入可能範囲外であるか否かを判定している。進入可能範囲は、例えば、ゼロ度から所定角度までの範囲として設定することができ、所定角度をどのような角度にするかは適宜変更が可能である。
【0111】
進入牽制部114は、判定部113にて傾斜角度α5が進入可能範囲内であると判定すると、車載電子制御ユニット18による進入自動走行制御の実行を許容している。進入牽制部114は、判定部113にて傾斜角度α5が進入可能範囲外であると判定すると、車載電子制御ユニット18による進入自動走行制御の実行を禁止している。
【0112】
図18に示すフローチャートに基づいて、進入経路P4に沿ってトラクタ1を自動走行させるときの動作について説明する。
車載電子制御ユニット18は、測位ユニット21にて取得されるトラクタ1の位置情報に基づいて、トラクタ1が入口S1における進入経路P4の始端P4aに到達したと判定すると、傾斜角度演算部112が、ライダーセンサ101,102の測定情報に基づいて、走行領域Sの入口S1におけるトラクタ1の走行面S1aの実際の傾斜角度α5を演算する(ステップ#1のYesの場合、ステップ#2)。
【0113】
判定部113は、傾斜角度演算部112にて演算された走行面S1aの傾斜角度α5が進入可能範囲内であるか否かを判定する(ステップ#3)。判定部113にて傾斜角度α5が進入可能範囲外であると判定されると、進入牽制部114が、車載電子制御ユニット18による進入自動走行制御の実行を禁止する(ステップ#3のNoの場合、ステップ#4)。このとき、車載電子制御ユニット18が、携帯通信端末3の表示部51に進入自動走行制御が禁止されていることを示す報知を行うことができ、トラクタ1の報知装置26によっても同様の報知を行うことができる。
【0114】
判定部113にて傾斜角度α5が進入可能範囲内であると判定されると、進入牽制部114が、車載電子制御ユニット18による進入自動走行制御の実行を許容するので、車載電子制御ユニット18が進入自動走行制御を実行する(ステップ#3のYesの場合、ステップ#5)。
【0115】
車載電子制御ユニット18が進入自動走行制御を実行すると、測位ユニット21にて取得されるトラクタ1の位置情報に基づいて、トラクタ1が入口S1における進入経路P4の終端P4bに到達したと判定されるまで、傾斜角度演算部112による走行面S1aの傾斜角度α5の演算、及び、判定部113による傾斜角度α5が進入可能範囲内であるか否かの判定が繰り返し行われる(ステップ#6のNoの場合)。
【0116】
このようにして、判定部113にて傾斜角度α5が進入可能範囲外であると判定されると、車載電子制御ユニット18による進入自動走行制御の実行が禁止されるので、急激な傾斜角度での走行領域S内への進入を防止しながら、入口S1の進入経路P4に沿ってトラクタ1を自動走行させることができる。トラクタ1が入口S1における進入経路P4の終端P4bに到達するまで、傾斜角度演算部112による走行面S1aの傾斜角度α5の演算、及び、判定部113による傾斜角度α5が進入可能範囲内であるか否かの判定が繰り返し行われるので、走行面S1aの途中にて傾斜角度が変化する場合でも、急激な傾斜角度での走行領域S内への進入を防止することができる。
【0117】
図16に示すように、車載電子制御ユニット18は、走行領域Sの入口S1をトラクタ1の自動走行にて進入させるだけでなく、
図19に示すように、車載電子制御ユニット18は、走行領域Sの出入口S2を走行してトラクタ1を走行領域S外に退場させる退場自動走行制御、及び、走行領域Sの出入口S2から他の走行領域Sの出入口S2までトラクタ1を自動走行させる走行領域間自動走行制御を実行可能に構成されている。退場自動走行制御、及び、走行領域間自動走行制御は、上述の自動走行制御と同様の制御であり、トラクタ1を自動走行させる経路が異なるだけである。
【0118】
図19に示すものでは、複数の走行領域Sの夫々において、走行領域Sの入口と出口とを兼用する出入口S2が設定されている。走行経路生成部53は、出入口S2に対して、進入経路P4に加えて、直線状の退場経路P5を生成している。走行経路生成部53は、公道、農道や私道等の道路400の位置情報や形状等の道路400に関する道路情報を地図情報等から取得しており、その取得した道路情報に基づいて、走行領域Sの出入口S2同士を繋ぐ走行領域間経路P6を道路400に生成している。
【0119】
図19に示すものでは、走行経路生成部53が、走行領域Sの出入口S2の退場経路P5の終端と走行領域間経路S6の始端とを同一位置として、退場経路P5と走行領域間経路S6とを一連の経路として接続し、且つ、走行領域間経路S6の終端と走行領域Sの出入口S2の進入経路P4の始端とを同一位置として、走行領域間経路S6と進入経路P4とを一連の経路として接続している。これにより、退場経路P5、走行領域間経路S6、進入経路P4が一連の経路として生成されている。
【0120】
車載電子制御ユニット18は、
図19に示すように、退場自動走行制御を行うことで、走行領域Sの出入口S2において退場経路P5に沿ってトラクタ1を自動走行させることができる。車載電子制御ユニット18が、退場自動走行制御に引き続いて走行領域間自動走行制御を行うことで、道路400の走行領域間経路P6に沿ってトラクタ1を自動走行させることができる。車載電子制御ユニット18は、測位ユニット21にて取得するトラクタ1の位置情報に基づいて、トラクタ1が進入経路P4の始端P4a(走行領域間経路P6の終端)に到達したか否かを判定することができる。車載電子制御ユニット18にてトラクタ1が進入経路P4の始端P4aに到達したと判定すると、傾斜角度演算部112が、ライダーセンサ101,102の測定情報に基づいて、出入口S2の走行面における傾斜角度α5(
図17参照)を求め、判定部113が、求めた傾斜角度α5が進入可能範囲内であるか否かの判定を自動的に行うことができる。これにより、トラクタ1が走行領域Sの出入口S2に到達した時点で、実際の走行面の傾斜角度α5が進入可能範囲外であれば、進入牽制部114が、車載電子制御ユニット18による進入自動走行制御の実行を禁止して、急激な傾斜角度でのトラクタ1の自動走行による走行領域S内への進入を適切に防止することができる。
【0121】
上述の如く、車載電子制御ユニット18が進入自動走行制御を行う際に、傾斜角度演算部112による傾斜角度α5の演算、及び、判定部113による判定を行い、進入牽制部114が、判定部113の判定結果に基づいて、車載電子制御ユニット18の進入自動走行制御の実行を禁止している。同様に、車載電子制御ユニット18が退場自動走行制御を行う際に、傾斜角度演算部112による傾斜角度α5の演算、及び、判定部113による判定を行い、判定部113の判定結果に基づいて、車載電子制御ユニット18の退場自動走行制御の実行を禁止することができる。そのために、
図2に示すように、車載電子制御ユニット18には、退場牽制部115が備えられている。
【0122】
車載電子制御ユニット18は、
図19に示すように、測位ユニット21にて取得するトラクタ1の位置情報に基づいて、トラクタ1が退場経路P5の始端P5aに到達したか否かを判定することができる。車載電子制御ユニット18にてトラクタ1が退場経路P5の始端P5aに到達したと判定すると、傾斜角度演算部112は、ライダーセンサ101,102の測定情報に基づいて、出入口S2の走行面における傾斜角度α5(
図17参照)を求めている。判定部113が、傾斜角度演算部112にて求めた傾斜角度α5が退場可能範囲内であるか否かの判定を行う。退場可能範囲は、進入可能範囲と同一範囲でもよく、異なる範囲でもよい。これにより、トラクタ1が走行領域Sの出入口S2に到達した時点で、実際の走行面の傾斜角度α5が退場可能範囲外であると、退場牽制部115が、車載電子制御ユニット18による退場自動走行制御の実行を禁止して、急激な傾斜角度でのトラクタ1の自動走行による走行領域S外への退場を適切に防止することができる。
【0123】
このように、車載電子制御ユニット18が退場自動走行制御を実行する際に、判定部113にて傾斜角度α5が退場可能範囲内であるか否かの判定を行う場合に、傾斜角度α5については、進入自動走行制御を行う際に、傾斜角度演算部112がライダーセンサ101,102の測定情報に基づいて求めた傾斜角度α5を用いることもできる。車載電子制御ユニット18が、退場自動走行制御を行う前に、進入自動走行制御を行っているので、判定部113は、進入自動走行制御を行う際に取得した傾斜角度を用いることで、新たに傾斜角度α5を求めることなく、既に取得している傾斜角度α5が退場可能範囲内であるか否かの判定を行うことができる。
【0124】
図16~
図18では、進入経路P4に沿ってトラクタ1を自動走行させる場合について説明したが、ユーザ等による手動運転にてトラクタ1を走行領域Sの入口S1を走行させて走行領域S内に進入させる場合においても、同様に、傾斜角度演算部112による傾斜角度α5の演算、及び、判定部113による判定を行うことができる。この場合には、判定部113にて傾斜角度α5が進入可能範囲外であると判定すると、進入牽制部114が、傾斜角度α5が進入可能範囲外であることを報知装置26にて報知するとともに、エンジン9を停止させる等により、トラクタ1の走行を停止させて、トラクタ1が走行領域Sの入口S1を走行して走行領域S内へ進入するのを牽制している。ちなみに、進入牽制部114は、トラクタ1の走行を停止させることなく、傾斜角度α5が進入可能範囲外であることを報知装置26にて報知するのみで、ユーザ等に急激な傾斜角度であることを認識させて、トラクタ1が走行領域Sの入口S1を走行して走行領域S内へ進入するのを牽制することもできる。
【0125】
図19に示すように、ユーザ等による手動運転にてトラクタ1を走行領域Sの出入口S2を走行させて走行領域S外に退場される場合においても、同様に、傾斜角度演算部112による傾斜角度α5の演算、及び、判定部113による判定を行うことができる。
【0126】
〔別実施形態〕
本発明の他の実施形態について説明する。
尚、以下に説明する各実施形態の構成は、夫々単独で適用することに限らず、他の実施形態の構成と組み合わせて適用することも可能である。
【0127】
(1)作業車両の構成は種々の変更が可能である。
例えば、作業車両は、エンジン9と走行用の電動モータとを備えるハイブリット仕様に構成されていてもよく、また、エンジン9に代えて走行用の電動モータを備える電動仕様に構成されていてもよい。
例えば、作業車両は、走行部として、左右の後輪6に代えて左右のクローラを備えるセミクローラ仕様に構成されていてもよい。
例えば、作業車両は、左右の後輪6が操舵輪として機能する後輪ステアリング仕様に構成されていてもよい。
【0128】
(2)上記実施形態では、前ライダーセンサ101及び後ライダーセンサ102を、上下方向において、ルーフ35に相当する位置に配置しているが、例えば、前ライダーセンサ101は、ボンネット8の前方側端部に配置することができる。前ライダーセンサ101及び後ライダーセンサ102の配置位置は、乗降部となる乗降ステップ41よりも上方側であればよく、その配置位置は適宜変更することができる。
【0129】
前ライダーセンサ101の配置位置と後ライダーセンサ102の配置位置とを、上下方向で異なる高さとすることもできる。例えば、前ライダーセンサ101をボンネット8の前方側端部に配置し、後ライダーセンサ102をルーフ35に相当する位置に配置することができる。
【0130】
(3)上記実施形態では、前ライダーセンサ101をアンテナユニット80の底部に取り付けているが、例えば、前ライダーセンサ101を、支持ステーを介してルーフ35に取り付けることもでき、前ライダーセンサ101をどのような部材に取り付けるかは適宜変更が可能である。
【0131】
(4)上記実施形態では、前ライダーセンサ101と後ライダーセンサ102の2つのライダーセンサを備えた例を示したが、ライダーセンサの数については適宜変更が可能であり、1つや3つ以上とすることができる。
【0132】
(5)上記実施形態では、障害物検知部110が、ライダーセンサ101,102の測定情報に基づいて、障害物検知処理を行うようにしているが、ライダーセンサ101,102に制御部を備えて、その制御部が障害物検知処理を行うこともできる。このように、障害物検知処理については、センサ側で行うか、作業車両側で行うかは、適宜変更が可能である。
【0133】
(6)上記実施形態では、障害物検知部110、衝突回避制御部111、傾斜角度演算部112、判定部113をトラクタ1に備えた例を示したが、例えば、携帯通信端末3等、トラクタ1とは別の装置に備えさせることもできる。
【0134】
<発明の付記>
本発明の第1特徴構成は、作業車両に備えられ、測定対象物までの距離を3次元にて測定する距離センサと、
その距離センサの測定情報に基づいて、走行領域の入口における前記作業車両の走行面の傾斜角度を演算する傾斜角度演算部と、
その傾斜角度演算部にて演算された傾斜角度が進入可能範囲外である場合には、前記作業車両が前記走行領域の入口を走行して走行領域内へ進入するのを牽制する進入牽制部とが備えられている点にある。
【0135】
本構成によれば、距離センサは、測定対象物までの距離を3次元にて測定するので、傾斜角度演算部は、距離センサの測定情報に基づいて、走行領域の入口における実際の走行面の傾斜角度を演算することができる。走行領域の入口における走行面の傾斜角度が、様々な状況の変化に応じて変化していても、傾斜角度演算部は、作業車両が走行領域の入口に位置したときの実際の走行面の傾斜角度を取得することができる。実際の走行面の傾斜角度が進入可能範囲外である場合には、進入牽制部が、作業車両が走行領域の入口を走行して走行領域内へ進入するのを牽制するので、急激な傾斜角度での走行領域内への作業車両の進入を防止することができる。
【0136】
本発明の第2特徴構成は、前記走行領域内において前記作業車両を自動走行させる場合に、前記作業車両の周囲に存在する障害物までの距離を前記距離センサにて測定自在に構成されている点にある。
【0137】
本構成によれば、距離センサを走行領域の入口における走行面の傾斜角度を取得するために用いるだけでなく、走行領域内において作業車両を自動走行させる場合に、作業車両の周囲に存在する障害物までの距離を測定するためにも用いることができ、構成の簡素化を図ることができる。
【0138】
本発明の第3特徴構成は、前記走行領域の入口にて前記作業車両を自動走行させて前記走行領域内へ進入させる進入自動走行制御を行う自動走行制御部が備えられ、
前記傾斜角度演算部にて演算された傾斜角度が進入可能範囲外である場合には、前記進入牽制部が、前記自動走行制御部による進入自動走行制御の実行を禁止している点にある。
【0139】
本構成によれば、自動走行制御部が進入自動走行制御を行うことで、走行領域の入口を通した走行領域内への作業車両の進入を作業車両の自動走行にて行うことができる。自動走行制御部が進入自動走行制御を行うに当たり、傾斜角度演算部にて演算された傾斜角度が進入可能範囲外である場合には、進入牽制部が、自動走行制御部による進入自動走行制御の実行を禁止するので、急激な傾斜角度での作業車両の自動走行を適切に防止することができる。
【0140】
本発明の第4特徴構成は、走行領域の出口から他の走行領域の入口まで前記作業車両を自動走行させる走行領域間自動走行制御を行う自動走行制御部と、
前記作業車両が前記走行領域の入口に到達した場合に、前記傾斜角度演算部にて演算された走行面の傾斜角度を用いて、その傾斜角度が進入可能範囲外であるか否かを判定する判定部とが備えられている点にある。
【0141】
本構成によれば、自動走行制御部が走行領域間自動走行制御を行うことで、走行領域の出口から他の走行領域の入口まで作業車両を自動走行させることができる。自動走行制御部による走行領域間自動走行制御により、作業車両が走行領域の入口に到達した場合に、判定部が、傾斜角度演算部にて演算された走行面の傾斜角度を用いて、その傾斜角度が進入可能範囲外であるか否かを判定するので、走行面の傾斜角度の演算、及び、傾斜角度が進入可能範囲外であるか否かの判定を自動的に行うことができる。作業車両が走行領域の入口に到達した時点で、実際の走行面の傾斜角度が進入可能範囲外であれば、進入牽制部が、作業車両が走行領域の入口を走行して走行領域内へ進入するのを牽制するので、急激な傾斜角度での作業車両の自動走行を適切に防止することができる。
【符号の説明】
【0142】
1 トラクタ(作業車両)
18 車載電子制御ユニット(自動走行制御部)
101 前ライダーセンサ(距離センサ)
102 後ライダーセンサ(距離センサ)
112 傾斜角度演算部
113 判定部
114 進入牽制部