JP2021013381A - 作業車 - Google Patents

作業車 Download PDF

Info

Publication number
JP2021013381A
JP2021013381A JP2020173310A JP2020173310A JP2021013381A JP 2021013381 A JP2021013381 A JP 2021013381A JP 2020173310 A JP2020173310 A JP 2020173310A JP 2020173310 A JP2020173310 A JP 2020173310A JP 2021013381 A JP2021013381 A JP 2021013381A
Authority
JP
Japan
Prior art keywords
vehicle body
vehicle
control unit
obstacle
unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2020173310A
Other languages
English (en)
Other versions
JP7094337B2 (ja
Inventor
西 啓四郎
Keishiro Nishi
啓四郎 西
敦 新海
Atsushi Shinkai
敦 新海
智章 福永
Tomoaki Fukunaga
智章 福永
貴裕 中務
Takahiro Nakatsukasa
貴裕 中務
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.)
Kubota Corp
Original Assignee
Kubota Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kubota Corp filed Critical Kubota Corp
Priority to JP2020173310A priority Critical patent/JP7094337B2/ja
Publication of JP2021013381A publication Critical patent/JP2021013381A/ja
Application granted granted Critical
Publication of JP7094337B2 publication Critical patent/JP7094337B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

【課題】全地球航法衛星システムを利用した車体の位置及び方位の測定を、より簡単に精度良く行えるようにする。【解決手段】作業車は、車体を自動で走行させる自動運転用の電子制御システムと、内部に振動子を有するソナーからなり、車体の周囲に存在する障害物を検出する複数の障害物探査器68と、が備えられ、複数の障害物探査器68として、車体の前端側に取り付けられた左右の第1測距センサ68Aと、車体の前側部分における左右両側方に取り付けられた左右の第2測距センサ68Bと、車体のうち第2測距センサ68Bの後方における左右両側方に取り付けられた左右の第3測距センサ68Cと、車体のうち第3測距センサ68Cの後方における左右両側方に取り付けられた左右の第4測距センサ68Dと、が備えられている。【選択図】図2

Description

本発明は、車体を自動で運転する自動運転用の電子制御システムを備えた作業車に関する。
上記のような作業車においては、例えば、車体の前部に、車体の前方における障害物の有無を検出する障害物検出手段が備えられたものがある(例えば特許文献1参照)。
そして、特許文献1に記載の作業車においては、障害物検出手段が障害物を検出したときに、車体の自動運転(自律走行)を停止させることにより、車体と車体前方の障害物とが接触して破損する不都合の発生を防止することが考えられている。
又、障害物検出手段が畦を障害物として検出するまでの間、自動運転によって車体を圃場端に向けて直進させ、障害物検出手段が畦を障害物として検出したときに、車体の自動運転を停止させることにより、車体を圃場端にて自動停止させることが考えられている。
特開2008−92818号公報(段落番号0049〜0051、図1〜2)
特許文献1に記載の作業車は、車体の前方における障害物の有無を検出する障害物検出手段を備えるだけであることから、例えば、自動運転中の圃場端での旋回走行(いわゆる畦際旋回)などにおいて、万が一、ステアリング機構の作動不良や走行装置のスリップなどに起因して、車体が大回りして作業車の横側部が畦などの障害物に異常接近しても、この障害物の存在を検出することができないようになっている。そのため、前述した異常接近に対する適正な処置を取ることができず、作業車の横側部が障害物に接触する不具合を招く虞がある。
つまり、自動運転中に作業車が障害物に接触する虞をより確実に回避できるようにすることが望まれている。
上記の課題を解決するための手段として、
本発明に係る作業車は、車体を自動で運転する自動運転用の電子制御システムを備え、
前記電子制御システムは、障害物の有無を検出する障害物検出モジュールと、前記障害物検出モジュールが障害物を検出したときに障害物との接触を回避する接触回避制御を行う接触回避制御部とを備え、
前記障害物検出モジュールは、車体の前方と左右両側方とが探査対象領域になるように車体の前端部と左右両端部とに分散して配置された複数の障害物探査器を備えている。
この手段によると、自動運転中の車体の前方又は左右の横側方において障害物が車体に接近した場合は、障害物検出モジュールが、いずれかの障害物探査器からの探査情報に基づいて、その障害物を検出する。そして、この検出に基づいて、接触回避制御部が接触回避制御を行うことにより、自動運転中に車体の前部又は左右の横側部が障害物に接触する虞を回避することができる。
そして、作業車は、車体の後部に作業装置が昇降可能に取り付けられることが多いことから、車体の後端部には障害物探査器が備えられていないことにより、例えば、車体の後部に作業装置が昇降可能に取り付けられた場合に、この作業装置を障害物検出モジュールが障害物として誤検出する虞を回避することができる。又、その誤検出に基づいて接触回避制御部が接触回避制御を行うことに起因して、作業効率の低下が生じる虞を回避することができる。
その結果、自動運転中に作業車が障害物に接触する虞をより確実に回避することができるとともに、誤検出に基づく作業効率の低下を回避することができる。
ちなみに、障害物検出モジュールは、例えば、作業車が自動運転によって畦に向かって走行しているとき、又は、作業車が自動運転によって畦際で畦に沿って走行しているときに、畦が車体に接近した場合は、この畦を障害物として検出する。又、移動体が車体に接近した場合は、この移動体を障害物として検出する。
本発明をより好適にするための手段の一つとして、
車体の前部側にボンネットが配置され、車体の後部側にキャビンと左右のリアフェンダとが配置され、
複数の前記障害物探査器として、前記ボンネットの前端部に取り付けられた左右の第1測距センサと、前記ボンネットの左右両側部における左右の走行装置よりも上側の部位に取り付けられた左右の第2測距センサと、前記キャビンにおける車体の前後中間部に位置する左右のフロントピラーに取り付けられた左右の第3測距センサと、左右の前記リアフェンダにおける前記走行装置よりも上側の部位に取り付けられた左右の第4測距センサとを備えている。
この手段によると、左右の第1測距センサにより、車体前方の探査対象領域を左右方向に広くすることができる。その結果、車体前方での障害物の有無を、障害物検出モジュールによって洩れなく検出することができる。
又、車体の左右両側方のうち、ボンネットなどが配置された車体前部側の左右両側方は、左右の第2測距センサの探査対象領域になり、左右のフロントピラーなどが配置された車体の前後中央側の左右両側方は、左右の第3測距センサの探査対象領域になり、左右のリアフェンダなどが配置された車体後部側の左右両側方は、左右の第4測距センサの探査対象領域になる。
つまり、左右の第2測距センサと左右の第3測距センサと左右の第4測距センサにより、前後方向に広い車体横側方の領域全体を探査対象領域にすることができる。その結果、車体横側方での障害物の有無を、各測距センサによって漏れなく探査することができる。
その結果、自動運転中に作業車が障害物に接触する虞を、各測距センサを使用した探査に基づいてより確実に回避することができる。
本発明をより好適にするための手段の一つとして、
前記障害物探査器には振動子を有するソナーが採用され、
前記ソナーは、樹脂製の共振防止部材を介して車体に取り付けられている。
この手段によると、例えば、ソナーを鋼板製のボンネット又はリアフェンダなどに直に取り付けた場合に生じる共振を防止することができる。
障害物探査器の配置などを示すトラクタの左側面図である。 障害物探査器の配置などを示すトラクタの平面図である。 障害物探査器の配置などを示すトラクタの斜視図である。 障害物探査器の支持構造など示すトラクタ前端部の縦断左側面図である。 トラクタ前端部の構成を示す要部の斜視図である。 運転部の構成を示す要部の横断平面図である。 制御系の概略構成を示すブロック図である。 アンテナユニット及び監視カメラなどの配置を示すキャビン上部の正面図である。 アンテナユニット及び監視カメラなどの配置を示すキャビン上部の背面図である。 アンテナユニット及び監視カメラなどの配置を示すキャビン上部の左側面図である。 キャビンのフレーム構造を示す要部の斜視図である。 第1測距センサ及び第2測距センサの取り付け構造を示す要部の縦断正面図である。 第3測距センサの取り付け構造を示す要部の縦断正面図である。 第3測距センサの取り付け構造を示す要部の分解斜視図である。 第4測距センサの取り付け構造を示す要部の縦断正面図である。 第4測距センサの取り付け構造を示す要部の分解斜視図である。
以下、本発明を実施するための形態の一例として、本発明が、作業車の一例であるトラクタに適用された実施形態を図面に基づいて説明する。
尚、図1に記載された符号Fの矢印が指し示す方向がトラクタの前側であり、符号Uの矢印が指し示す方向がトラクタの上側である。
又、図2に記載された符号Fの矢印が指し示す方向がトラクタの前側であり、符号Rの矢印が指し示す方向がトラクタの右側である。
図1〜3に示すように、本実施形態に例示されたトラクタは、車体の前後両端にわたる車体フレーム1、車体フレーム1の左右に配置された左右の走行装置2、車体フレーム1の前部側に配置された原動部3、車体フレーム1の後部側に配置されたキャビン4、及び、車体フレーム1の後端部に昇降揺動可能に取り付けられた作業装置連結用の3点リンク機構5、などを備えている。
図1〜5に示すように、車体フレーム1は、原動部3に配置されたエンジン6の下部から車体前側に延出する前部フレーム7、及び、エンジン6の後端下部から車体後側に延出する後部フレーム兼用のケースユニット8、などを備えている。図示は省略するが、ケースユニット8の内部には、エンジン6からの動力を断続するペダル操作式の主クラッチ、主クラッチを経由した動力を走行用と作業用とに分岐して変速する変速伝動ユニット、及び、左右の走行装置2に作用する左右のサイドブレーキ、などが備えられている。
左右の走行装置2は、駆動可能な操舵輪として機能する左右の前輪9と、駆動輪として機能する左右の後輪10とを備えている。左右の前輪9は、前部フレーム7にローリング可能に支持された車輪支持部材11の左右両端部に操舵可能な状態で駆動可能に支持されている。車輪支持部材11は、前輪駆動用の伝動軸11Aなどを内部に備えた前車軸ケースである。左右の後輪10は、ケースユニット8に駆動可能に支持されるとともに、各後輪10の上部側が、車体の後部側に配置された左右のリアフェンダ12によって覆われている。
原動部3は、原動部3の冷却方向下手側となる原動部3の車体後部側に配置された水冷式のエンジン6、エンジン6よりも冷却方向上手側となる車体前側に配置された冷却ファン13、冷却ファン13よりも車体前側に配置されたラジエータ14、ラジエータ14よりも車体前側に配置されたバッテリ15、エンジン6の後部上方に配置された排気処理装置(図示せず)、エンジン6の前部上方に配置されたエアクリーナ(図示せず)、及び、エンジン6やラジエータ14などを上方から覆う揺動開閉式のボンネット16、などを備えている。エンジン6には、コモンレールシステムを備えた電子制御式のディーゼルエンジンが採用されている。排気処理装置は、DOC((Diesel Oxidation Catalyst)とDPF(Diesel particulate filter)とを内部に備えている。
図1〜4、図6に示すように、キャビン4は、車体の後部側に運転部17と搭乗空間とを形成している。運転部17には、主クラッチの操作を可能にするクラッチペダル18、左右のサイドブレーキの操作を可能にする左右のブレーキペダル49、左右の前輪9の手動操舵を可能にする手動操舵用のステアリングホイール19、前後進切り換え用のシャトルレバー20、右腕用のアームレスト21を有する運転座席22、及び、タッチ操作可能な液晶パネル23Aなどを有する表示ユニット23、などが備えられている。ステアリングホイール19は、全油圧式のパワーステアリングユニット(以下、PSユニットと称する)24を有するステアリング機構25を介して左右の前輪9に連係されている。アームレスト21には、主変速レバー26、作業装置の高さ位置を設定する昇降レバー27、及び、作業装置の昇降を指令する昇降スイッチ28が備えられている。
図7に示すように、3点リンク機構5は、車体に備えられた電子油圧制御式の昇降駆動ユニット29の作動によって上下方向に揺動駆動される。図示は省略するが、3点リンク機構5には、ロータリ耕耘装置、プラウ、ディスクハロー、カルチベータ、サブソイラ、播種装置、及び、散布装置、などの作業装置を連結することができる。そして、3点リンク機構5に連結される作業装置が、車体からの動力によって駆動されるロータリ耕耘装置などである場合は、変速ユニットから取り出された作業用の動力が外部伝動軸を介して伝達される。
車体には、車体の走行に関する制御を行う走行制御部30A、及び、作業装置に関する制御を行う作業制御部30B、などを備えたメインの電子制御ユニット(以下、メインECUと称する)30が搭載されている。メインECU30は、前述した電子油圧制御式の昇降駆動ユニット29、エンジン用の電子制御ユニット(以下、エンジンECUと称する)31、変速伝動ユニットに備えられた電子制御式の主変速装置32と前後進切換装置33とPTOクラッチ34、左右のサイドブレーキの自動操作を可能にする電子油圧式のブレーキ操作ユニット35、及び、車速を含む車内情報を取得する車内情報取得ユニット36、などに、CAN(Controller Area Network)などの車内LAN又は通信線を介して通信可能に接続されている。メインECU30及びエンジンECU31は、CPU及びEEPROMなどを有するマイクロプロセッサを備えている。走行制御部30Aは、車体の走行に関する制御を可能にする各種の制御プログラムなどを有している。作業制御部30Bは、作業装置に関する制御を可能にする各種の制御プログラムなどを有している。
主変速装置32には、走行用の動力を無段階で変速する静油圧式の無段変速装置が採用されている。前後進切換装置33は、走行用の動力を断続する走行クラッチを兼ねている。図示は省略するが、変速伝動ユニットには、主変速装置32などとともに、走行用の動力を有段階で変速する副変速装置、及び、作業用の動力を有段階で変速するPTO変速装置、などが備えられている。
車内情報取得ユニット36には、エンジン6の出力回転数を検出する回転センサ37、副変速装置の出力回転数を車速として検出する車速センサ38、主変速レバー26の操作位置を検出する第1レバーセンサ39、運転部17に備えられた副変速レバー40の操作位置を検出する第2レバーセンサ41、シャトルレバー20の操作位置を検出する第3レバーセンサ42、昇降レバー27の操作位置を検出する第4レバーセンサ43、前述した昇降スイッチ28、運転部17に備えられた旋回上昇スイッチ44と後進上昇スイッチ45とPTOスイッチ46、昇降駆動ユニット29における左右のリフトアーム(図示せず)の上下揺動角度を作業装置の高さ位置として検出する高さセンサ47、及び、前輪9の舵角を検出する舵角センサ48、などの各種センサ及びスイッチ類が含まれている。
走行制御部30Aは、回転センサ37の出力と車速センサ38の出力と第1レバーセンサ39の出力と第2レバーセンサ41の出力とに基づいて、車速が、エンジン回転数と主変速レバー26の操作位置と副変速レバー40の操作位置とから求めた制御目標車速に達するように、主変速装置32のトラニオン軸(図示せず)を操作する車速制御を行う。これにより、運転者は、主変速レバー26を任意の操作位置に操作することにより、車速を任意の速度に変更することができる。
走行制御部30Aは、第3レバーセンサ42の出力に基づいて、シャトルレバー20の操作位置に応じた伝動状態に前後進切換装置33を切り換える前後進切り換え制御を行う。これにより、運転者は、シャトルレバー20を前進位置に操作することにより、車体の進行方向を前進方向に設定することができる。運転者は、シャトルレバー20を後進位置に操作することにより、車体の進行方向を後進方向に設定することができる。
作業制御部30Bは、第4レバーセンサ43の出力と高さセンサ47の出力とに基づいて、昇降レバー27の操作位置に応じた高さ位置に作業装置が位置するように昇降駆動ユニット29の作動を制御するポジション制御を行う。これにより、運転者は、昇降レバー27を任意の操作位置に操作することにより、作業装置の高さ位置を任意の高さ位置に変更することができる。
作業制御部30Bは、昇降スイッチ28の手動操作によって昇降スイッチ28が上昇指令状態に切り換えられると、昇降スイッチ28からの上昇指令と高さセンサ47の出力とに基づいて、作業装置が予め設定された上限位置まで上昇するように昇降駆動ユニット29の作動を制御する上昇制御を行う。これにより、運転者は、昇降スイッチ28を上昇指令状態に切り換えることにより、作業装置を上限位置まで自動的に上昇させることができる。
作業制御部30Bは、昇降スイッチ28の手動操作によって昇降スイッチ28が下降指令状態に切り換えられると、昇降スイッチ28からの下降指令と第4レバーセンサ43の出力と高さセンサ47の出力とに基づいて、作業装置が昇降レバー27によって設定された作業高さ位置まで下降するように昇降駆動ユニット29の作動を制御する下降制御を行う。これにより、運転者は、昇降スイッチ28を下降指令状態に切り換えることにより、作業装置を作業高さ位置まで自動的に下降させることができる。
作業制御部30Bは、旋回上昇スイッチ44の手動操作によって旋回連動上昇制御の実行が選択された場合は、前輪9の舵角を検出する舵角センサ48の出力に基づいて、前輪9の舵角が畦際旋回用の設定角度に達したことを検知したときに、前述した上昇制御を自動的に行う。これにより、運転者は、旋回連動上昇制御の実行を選択しておくことにより、畦際旋回の開始に連動して、作業装置を上限位置まで自動的に上昇させることができる。
作業制御部30Bは、後進上昇スイッチ45の手動操作によって後進連動上昇制御の実行が選択された場合は、第3レバーセンサ42の出力に基づいて、シャトルレバー20の後進位置への手動操作を検知したときに、前述した上昇制御を自動的に行う。これにより、運転者は、後進連動上昇制御の実行を選択しておくことにより、後進走行への切り換えに連動して、作業装置を上限位置まで自動的に上昇させることができる。
作業制御部30Bは、PTOスイッチ46の手動操作によってPTOスイッチ46の操作位置が入り位置に切り換えられると、入り位置への切り換えに基づいて、作業用の動力が作業装置に伝達されるようにPTOクラッチ34を入り状態に切り換えるクラッチ入り制御を行う。これにより、運転者は、PTOスイッチ46を入り位置に操作することによって作業装置を作動させることができる。
作業制御部30Bは、PTOスイッチ46の手動操作によってPTOスイッチ46の操作位置が切り位置に切り換えられると、切り位置への切り換えに基づいて、作業用の動力が作業装置に伝達されないようにPTOクラッチ34を切り状態に切り換えるクラッチ切り制御を行う。これにより、運転者は、PTOスイッチ46を切り位置に操作することによって作業装置を停止させることができる。
作業制御部30Bは、PTOスイッチ46の手動操作によってPTOスイッチ46の操作位置が自動位置に切り換えられると、前述した上昇制御の実行に連動して前述したクラッチ切り制御を自動的に行い、又、前述した下降制御の実行に連動して前述したクラッチ入り制御を自動的に行う。これにより、運転者は、PTOスイッチ46を自動位置に操作しておくことにより、作業装置の上限位置への自動上昇に連動して作業装置を停止させることができ、又、作業装置の作業高さ位置への自動下降に連動して作業装置を作動させることができる。
図1〜5、図7に示すように、このトラクタは、運転モードの手動運転モード及び自動運転モードなどの選択を可能にする選択イッチ50と、自動運転モードが選択された場合に車体を自動で運転する自動運転用の電子制御システム51とを備えている。電子制御システム51は、前述したメインECU30、左右の前輪9の自動操舵を可能にする自動操舵ユニット52、車体の位置及び方位を測定する測位ユニット53、及び、車体の周囲を監視する監視ユニット54、などを備えている。
図2〜4、図7に示すように、自動操舵ユニット52は、前述したPSユニット24によって構成されている。PSユニット24は、手動運転モードが選択された場合は、ステアリングホイール19の回動操作に基づいて左右の前輪9を操舵する。又、PSユニット24は、自動運転モードが選択された場合は、メインECU30からの制御指令に基づいて左右の前輪9を操舵する。
つまり、自動操舵専用のステアリングユニットを備えることなく、左右の前輪9を自動で操舵することができる。又、PSユニット24の電気系に不具合が生じた場合は、搭乗者による手動操舵に簡単に切り換えることができ、車体の運転を継続することができる。
図1〜3、図7〜10に示すように、測位ユニット53は、全地球航法衛星システム(GNSS:Global Navigation Satellite System)の一例である周知のGPS(Global Positioning System)を利用して車体の位置及び方位を測定する衛星航法装置60を備えている。GPSを利用した測位方法には、DGPS(Differential GPS)やRTK−GPS(Real Time Kinematic GPS)などがあるが、本実施形態においては、移動体の測位に適したRTK−GPSが採用されている。
衛星航法装置60は、GPS衛星(図示せず)から送信された電波と、既知位置に設置された基準局(図示せず)から送信された測位データとを受信する衛星航法用のアンテナユニット61を備えている。基準局は、GPS衛星からの電波を受信して得た測位データを衛星航法装置60に送信する。衛星航法装置60は、GPS衛星からの電波を受信して得た測位データと、基準局からの測位データとに基づいて、車体の位置及び方位を求める。
アンテナユニット61は、GPS衛星からの電波の受信感度が高くなるように、車体の最上部に位置するキャビン4のルーフ62に取り付けられている。そのため、GPSを利用して測定した車体の位置及び方位には、車体のヨーイング、ピッチング、又は、ローリングに伴うアンテナユニット61の位置ズレに起因した測位誤差が含まれている。
そこで、車体には、上記の測位誤差を取り除く補正を可能にするために、3軸のジャイロスコープ(図示せず)と3方向の加速度センサ(図示せず)とを有して車体のヨー角、ピッチ角、ロール角、などを計測する慣性計測装置(IMU:Inertial Measurement Unit)63が備えられている。慣性計測装置63は、前述したアンテナユニット61の位置ズレ量を求め易くするために、アンテナユニット61の内部に備えられている。アンテナユニット61は、平面視において車体におけるトレッドTの中央部でホイールベースLの中央部に位置するように、キャビン4のルーフ62における前部上面の左右中央箇所に取り付けられている(図2参照)。
上記の構成により、少なくとも、平面視においては慣性計測装置63の取り付け位置が車体の重心位置に近くなる。これにより、慣性計測装置63が計測したヨー角などを、車体の重心位置からの慣性計測装置63の位置ズレ量に基づいて補正するための演算が簡単になり、よって、慣性計測装置63の計測結果を迅速に正しく補正することができる。つまり、慣性計測装置63による車体のヨー角などの計測を迅速に精度良く行うことができる。
これにより、衛星航法装置60が車体の位置及び方位を測定する場合において、車体のヨーイング、ピッチング、又は、ローリングに起因して、アンテナユニット61に位置ズレが生じたときは、このときのアンテナユニット61の位置ズレ量を、慣性計測装置63が計測する車体のヨー角、ピッチ角、ロール角、などから迅速に精度良く求めることができる。そして、衛星航法装置60が計測した車体の位置及び方位に含まれるアンテナユニット61の位置ズレに起因した測位誤差を、慣性計測装置63の計測結果から求められるアンテナユニット61の位置ズレ量に基づいて迅速に精度良く求めることができ、この測位誤差を衛星航法装置60の測定結果から取り除く補正を迅速かつ適正に行える。
その結果、全地球航法衛星システムを利用した車体の位置及び方位の測定を、より簡単かつ迅速に精度良く行うことができる。
図7に示すように、メインECU30は、車体の自動運転を可能にする各種の制御プログラムなどを有する自動運転制御部30Cを備えている。自動運転制御部30Cは、車体が予め設定された圃場の目標走行経路を設定速度で適正に作業を行いながら自動走行するように、目標走行経路及び測位ユニット53の測位結果などに基づいて、走行制御部30A及び作業制御部30Bなどに各種の制御指令を適切なタイミングで送信する。走行制御部30Aは、自動運転制御部30Cからの各種の制御指令及び車内情報取得ユニット36の各種取得情報などに基づいて、主変速装置32及び前後進切換装置33などに各種の制御指令を適切なタイミングで送信して主変速装置32及び前後進切換装置33などの作動を制御する。作業制御部30Bは、自動運転制御部30Cからの各種の制御指令及び車内情報取得ユニット36の各種取得情報などに基づいて、昇降駆動ユニット29及びPTOクラッチ34などに各種の制御指令を適切なタイミングで送信して昇降駆動ユニット29及びPTOクラッチ34などの作動を制御する。
目標走行経路は、圃場での手動運転による作業走行時に走行した走行経路、及び、畦際旋回開始地点などが、測位ユニット53の測位結果などに基づいてデータ化されたものであってよい。又、目標走行経路は、圃場での手動運転によるティーチング走行時に走行した走行経路、及び、畦際旋回開始地点などが、測位ユニット53の測位結果などに基づいてデータ化されたものであってよい。
図1〜5、図7〜10に示すように、監視ユニット54は、車体に対する至近距離内(例えば1m以内)での障害物の有無を検出する障害物検出モジュール64、車体に対する近距離(例えば10m以内)での障害物の接近を検出する前後の障害物探知器65、障害物との接触を回避する接触回避制御を行う接触回避制御部30D、車体の周囲を撮影する6台の監視カメラ66、監視カメラ66が撮影した画像を処理する画像処理装置67、などを備えている。
障害物検出モジュール64は、車体に対する至近距離内において障害物を探査する8個の障害物探査器68と、各障害物探査器68からの探査情報に基づいて車体に対する至近距離内に障害物が接近したか否かの判別処理を行う2台の探査情報処理装置69とを備えている。
各障害物探査器68には、測距センサの一例として測距に超音波を使用するソナー68が採用されている。8個のソナー68は、車体の前方と左右両側方とが探査対象領域になるように、車体の前端部と左右両端部とに分散して配置されている。各ソナー68は、それらの探査で得た探査情報を対応する探査情報処理装置69に送信する。
各探査情報処理装置69は、対応する各ソナー68における超音波の発信から受信までの時間に基づいて、車体に対する至近距離内に障害物が接近したか否かの判別処理を行い、この判別結果を接触回避制御部30Dに出力する。
これにより、自動運転中の車体の前方又は左右の横側方において障害物が車体に対する至近距離内に異常接近した場合は、この障害物の接近が障害物検出モジュール64によって検出される。又、車体の後端部にはソナー68が備えられていないことにより、障害物検出モジュール64が、車体の後部に昇降可能に取り付けられた作業装置を障害物として誤検出することが回避されている。
ちなみに、障害物検出モジュール64は、例えば、車体が自動運転によって畦に向かって走行しているとき、又は、車体が自動運転によって畦際で畦に沿って走行しているときに、畦が車体に対する至近距離内に異常接近した場合は、この畦を障害物として検出する。又、移動体が車体に対する至近距離内に異常接近した場合は、この移動体を障害物として検出する。
各障害物探知器65には、約270度程度の検出角度を有するレーザスキャナ65が採用されている。各レーザスキャナ65は、障害物の探知を行う探知部65Aと、探知部65Aからの探知情報を処理する処理部65Bとを備えている。探知部65Aは、探知対象領域にレーザ光線を照射して反射光を受け取る。処理部65Bは、レーザ光線の照射から受光までの時間に基づいて、車体に対する近距離において障害物が接近しているか否かなどを判別し、判別結果を接触回避制御部30Dに出力する。前側のレーザスキャナ65は、車体前側の領域が探知対象領域に設定されている。後側のレーザスキャナ65は、車体後側の領域が探知対象領域に設定されている。
接触回避制御部30Dは、接触回避制御の実行を可能にする制御プログラムなどを有してメインECU30に備えられている。接触回避制御部30Dは、各レーザスキャナ65の判別結果に基づいて、車体に対する近距離での障害物の接近を確認したときに、自動運転制御部30Cの制御作動に基づく自動運転に優先して接触回避制御を開始する。そして、接触回避制御部30Dは、各レーザスキャナ65及び各探査情報処理装置69の判別結果に基づいて接触回避制御を行う。
接触回避制御において、接触回避制御部30Dは、接触回避制御の開始とともに走行制御部30Aに減速指令を出力する。これにより、接触回避制御部30Dは、走行制御部30Aの制御作動によって主変速装置32を減速作動させて、車速を通常走行用の設定速度から接触回避用の設定速度まで低下させる。接触回避制御部30Dは、この低速走行状態において、いずれかの探査情報処理装置69の判別結果に基づいて、車体に対する至近距離内への障害物の接近を確認したときに、走行制御部30A及び作業制御部30Bに緊急停止指令を出力する。これにより、接触回避制御部30Dは、走行制御部30Aの制御作動によって前後進切換装置33を中立状態に切り換えるとともに、ブレーキ操作ユニット35の作動によって左右のブレーキを作動させて左右の前輪9と左右の後輪10とを制動させる。又、接触回避制御部30Dは、作業制御部30Bの作動によってPTOクラッチ34を切り状態に切り換えて作業装置の作動を停止させる。その結果、車体に対する至近距離内への障害物の接近に基づいて、車体の走行停止と作業装置の作動停止とを迅速に行うことができ、車体が障害物に接触する虞を回避することができる。接触回避制御部30Dは、この低速走行状態において、各レーザスキャナ65の判別結果に基づいて、車体に対する近距離内において障害物が存在しないことを確認したときに、走行制御部30Aに増速指令を出力し、その後、接触回避制御を終了する。これにより、接触回避制御部30Dは、走行制御部30Aの制御作動によって主変速装置32を増速作動させて、車速を接触回避用の設定速度から通常走行用の設定速度まで上昇させた後、自動運転制御部30Cの制御作動に基づく自動運転を再開させる。
図1〜3、図7〜10に示すように、各監視カメラ66には、広角の可視光用CCDカメラが採用されている。6台の監視カメラ66のうちの1台は、車体の前方撮影用であり、この監視カメラ66は、撮影方向が前下方向きになる傾斜姿勢で、キャビン4の上端部における前端の左右中央箇所に設置されている。6台の監視カメラ66のうちの2台は、車体の右方撮影用であり、これらの監視カメラ66は、撮影方向が右下方向きになる傾斜姿勢で、キャビン4の上端部における右端箇所に前後に所定間隔をあけて設置されている。6台の監視カメラ66のうちの2台は、車体の左方撮影用であり、これらの監視カメラ66は、撮影方向が左下方向きになる傾斜姿勢で、キャビン4の上端部における左端箇所に前後に所定間隔をあけて設置されている。6台の監視カメラ66のうちの1台は、車体の後方撮影用であり、この監視カメラ66は、撮影方向が後下方向きになる傾斜姿勢で、キャビン4の上端部における後端の左右中央箇所に設置されている。これにより、車体の周囲を漏れなく撮影することができる。
尚、右監視カメラ66と左監視カメラ66とを1台ずつにして、キャビン4の上端部における左右両端の適正箇所に設置するようにしてもよい。
画像処理装置67は、各監視カメラ66からの映像信号を処理して、車体前方画像、車体右側方画像、車体左側方画像、車体後方画像、及び、車体の真上から見下ろしたような俯瞰画像、などを生成して表示ユニット23などに送信する。表示ユニット23は、液晶パネル23Aに表示される各種の操作スイッチ(図示せず)の人為操作などに基づいて、液晶パネル23Aに表示される画像を切り換える制御部23B、などを有している。
上記の構成により、手動運転時においては、運転者は、画像処理装置67からの画像を液晶パネル23Aに表示させることにより、運転中の車体の周辺状況や作業状況を容易に視認することができる。これにより、運転者は、作業の種類などに応じた良好な車体の運転を容易に行うことができる。又、自動運転時に管理者が車体に搭乗する場合においては、管理者は、画像処理装置67からの画像を液晶パネル23Aに表示させることにより、自動運転中の車体の周辺状況や作業状況を容易に視認することができる。そして、管理者は、自動運転中の車体周辺又は作業状況などにおける異常を視認した場合は、その異常の種類や程度などに応じた適切な処置を速やかに行うことができる。
図7に示すように、電子制御システム51は、選択イッチ50の人為操作によって協調運転モードが選択された場合に、車体を同じ仕様の他車と協調して自動走行させる協調制御ユニット70を備えている。協調制御ユニット70は、車体の位置情報を含む他車との協調走行に関する情報を他車との間で無線通信する通信モジュール71と、他車からの情報に基づいて協調運転制御を行う協調運転制御部30Eとを備えている。協調運転制御部30Eは、協調運転制御の実行を可能にする制御プログラムなどを有してメインECU30に備えられている。
協調運転モードにおいて、自動運転制御部30Cは、車体が予め設定された併走用の目標走行経路を設定速度で適正に作業を行いながら自動走行するように、併走用の目標走行経路及び測位ユニット53の測位結果などに基づいて、走行制御部30A及び作業制御部30Bなどに各種の制御指令を適切なタイミングで送信する。協調運転制御部30Eは、自車の併走用の目標走行経路、測位ユニット53の測位結果、他車の併走用の目標走行経路、及び、他車の位置情報、などに基づいて、先行する他車と自車との進行方向での車間距離、及び、先行する他車と自車との併走方向での車間距離、などが適正であるか否かを判別する。そして、いずれかの車間距離が適正でない場合は、その車間距離が適正になるように、自動運転制御部30Cの制御作動に基づく自動運転に優先して協調運転制御を開始する。
協調運転制御において、協調運転制御部30Eは、進行方向での車間距離が適正距離よりも短い場合は、走行制御部30Aに減速指令を出力する。これにより、協調運転制御部30Eは、走行制御部30Aの制御作動によって主変速装置32を減速作動させて、進行方向での車間距離を適正距離に復帰させる。そして、協調運転制御部30Eは、進行方向での車間距離が適正距離に復帰するのに伴って、自動運転制御部30Cの制御作動に基づく自動運転を再開させることにより、車速を通常走行用の設定速度まで上昇させて進行方向での車間距離を適正距離に維持する。
協調運転制御部30Eは、進行方向での車間距離が適正距離よりも長い場合は、走行制御部30Aに増速指令を出力する。これにより、協調運転制御部30Eは、走行制御部30Aの制御作動によって主変速装置32を増速作動させて、進行方向での車間距離を適正距離に復帰させる。そして、協調運転制御部30Eは、進行方向での車間距離が適正距離に復帰するのに伴って、自動運転制御部30Cの制御作動に基づく自動運転を再開させることにより、車速を通常走行用の設定速度まで低下させて進行方向での車間距離を適正距離に維持する。
協調運転制御部30Eは、併走方向での車間距離が適正距離よりも長い場合は、走行制御部30Aに他車側への操舵指令を出力する。これにより、協調運転制御部30Eは、走行制御部30Aの制御作動によって左右の前輪9を他車側に操舵させて、併走方向での車間距離を適正距離に復帰させる。そして、協調運転制御部30Eは、併走方向での車間距離が適正距離に復帰するのに伴って、自動運転制御部30Cの制御作動に基づく自動運転を再開させることにより、車体の進行方向を通常走行用の進行方向に戻して併走方向での車間距離を適正距離に維持する。
協調運転制御部30Eは、併走方向での車間距離が適正距離よりも短い場合は、走行制御部30Aに他車から離れる側への操舵指令を出力する。これにより、協調運転制御部30Eは、走行制御部30Aの制御作動によって左右の前輪9を他車から離れる側に操舵させて、併走方向での車間距離を適正距離に復帰させる。そして、協調運転制御部30Eは、併走方向での車間距離が適正距離に復帰するのに伴って、自動運転制御部30Cの制御作動に基づく自動運転を再開させることにより、車体の進行方向を通常走行用の進行方向に戻して併走方向での車間距離を適正距離に維持する。
これにより、自車を、先行する他車に対して、進行方向での車間距離と併走方向での車間距離とを訂正に維持しながら自動で適正に併走させることができる。
図1〜3、図6、図8〜11に示すように、キャビン4は、ルーフ62などを支持するルーフフレーム72、ルーフフレーム72の前端部を支持する左右のフロントピラー73、ルーフフレーム72の前後中間部を支持する左右のセンタピラー74、ルーフフレーム72の後部側を支持する左右のリアピラー75、キャビン4の前面を形成するフロントパネル76、左右のセンタピラー74に開閉揺動可能に支持された左右のドアパネル77、キャビン4の後部側面を形成する左右のサイドパネル78、及び、ルーフフレーム72に開閉揺動可能に支持されたリヤパネル79、などを備えている。
ルーフフレーム72は、左右のフロントピラー73にわたるフロントビーム98、左右いずれかのフロントピラー73とリアピラー75とにわたる左右のサイドビーム99、及び、左右のリアピラー75にわたるリアビーム100、などを備えて平面視略矩形状に形成されている。
左右のフロントピラー73は、車体におけるホイールベースLの中央部よりも車体前側に配置されている。左右のフロントピラー73は、正面視においては上半部の上側ほど車体の左右中央側に位置し、かつ、側面視においては上半部の上側ほど車体の前後中央側に位置するように上半部が湾曲している。
左右のセンタピラー74及び左右のリアピラー75は、運転座席22の左右に配置された左右のリアフェンダ12とルーフフレーム72との間に配置されている。左右のセンタピラー74は、正面視においては上側ほど車体の左右中央側に位置し、かつ、側面視においては上側ほど車体の前後中央側に位置するように湾曲している。左右のリアピラー75は、正面視においては上側ほど車体の左右中央側に位置し、かつ、側面視においては略垂直姿勢になるように湾曲している。
各パネル76〜79には、対応するピラー73〜75などに沿って湾曲するガラス製又は透明アクリル樹脂製などの曲面パネルが採用されている。
上記の構成により、キャビン4の下半部においては、運転座席22に着座した運転者の手足による各種の操作が行い易い広い空間を確保しながら、キャビン4の上半部においては、居住性を損なわない程度でルーフフレーム72の前後幅及び左右幅を狭くすることができる。その結果、搭乗空間での操作性及び居住性を低下させることなく、キャビン上部の小型軽量化による車体の安定性の向上を図ることができる。
図1〜3、図9〜11に示すように、キャビン4は、左右のリアピラー75の上端部から後方に延出する補助フレーム90を備えている。補助フレーム90は、後側のレーザスキャナ65及び後方撮影用の監視カメラ66などを支持している。
図1、図3、図4に示すように、各ソナー68は、少なくとも車体における左右の前輪9よりも上側の部位に設置されている。これにより、例えば、作業走行中に、圃場の起伏などに応じて車体がローリング又はピッチングすることにより、いずれかのソナー68が圃場の地面に近づいた場合であっても、このときの各ソナー68の地面からの離間距離を、各ソナー68の探査距離よりも長い状態に維持することができる。
つまり、各ソナー68は、作業走行中に圃場の起伏などに応じて車体がローリング又はピッチングした場合であっても、圃場の地面が、各ソナー68の探査距離内に入り込む虞を回避することができる適切な高さ位置に配置されている。これにより、作業走行中の車体のローリング又はピッチングに起因して、各ソナー68が圃場の地面を障害物として誤検出する虞を回避することができる。
図1〜4に示すように、前述した8個のソナー68のうち、2個の第1ソナー68Aは、ボンネット16における前端部の上下中央部に、左右方向に所定間隔をあけて取り付けられている。つまり、左右の第1ソナー68Aにより、車体前方の探査対象領域を左右方向に広くすることができる。その結果、車体に対する車体前方の至近距離内への障害物の接近を洩れなく探査することができる。
図1〜3に示すように、残りの6個のソナー68のうち、2個の第2ソナー68Bは、ボンネット16の左右両側部における左右の前輪9よりも上側の部位に取り付けられている。2個の第3ソナー68Cは、キャビン4における車体の前後中間部に位置する左右のフロントピラー73に取り付けられている。2個の第4ソナー68Dは、左右のリアフェンダ12における左右の後輪10よりも上側の部位に取り付けられている。
上記の取り付けにより、車体の左右両側方のうち、ボンネット16などが配置された車体前部側の左右両側方は、左右の第2ソナー68Bの探査対象領域になり、左右のフロントピラー73などが配置された車体の前後中央側の左右両側方は、左右の第3ソナー68Cの探査対象領域になり、左右のリアフェンダ12などが配置された車体後部側の左右両側方は、左右の第4ソナー68Dの探査対象領域になる。つまり、左右の第2ソナー68Bと左右の第3ソナー68Cと左右の第4ソナー68Dにより、前後方向に広い車体横側方の領域全体を探査対象領域にすることができる。その結果、車体に対する車体横側方の至近距離内への障害物の接近を漏れなく探査することができる。
その結果、自動運転中に車体が障害物に接触する虞を、各ソナー68の探査に基づいてより確実に回避することができる。
図1〜4、図12〜16に示すように、左右の第1ソナー68Aは、ボンネット16における前端部の上下中央部に配置された鋼板製の第1支持部材91に、樹脂製の第1共振防止部材92を介して取り付けられている。左右の第2ソナー68Bは、ボンネット16における左右両側部の前端側に配置された鋼板製の第2支持部材93に、樹脂製の第1共振防止部材92を介して取り付けられている。左右の第3ソナー68Cは、左右のフロントピラー73の上下中央側に配置された鋼板製の第3支持部材94に、樹脂製の第2共振防止部材95を介して取り付けられている。左右の第4ソナー68Dは、左右のリアフェンダ12の上端部から車体横外方に向けて突出する鋼板製の第4支持部材96に、樹脂製の第3共振防止部材97を介して取り付けられている。
上記の構成により、内部に振動子(図示せず)を有する各ソナー68を鋼板製の支持部材91,93,94,96に直に取り付けた場合に生じる共振を防止することができる。
又、ボンネット16に対する各ソナー68A,68Bの取り付けには、それぞれ同じ第1共振防止部材92を使用することから、部品の共通化によるコストの削減などを図ることができる。
図1、図3、図4、図12に示すように、第1支持部材91は、ボンネット16の前端部に備えられた補強フレーム106に取り付けられている。補強フレーム106は、ボンネット16の前端上部に配置されたヘッドライト107などを支持する支持フレームに兼用されている。
図1〜3に示すように、左右の第3ソナー68Cは、左右のフロントピラー73に取り付けられることにより、左右の前輪9と左右の後輪10との間に配置されている。これにより、左右の前輪9と左右の後輪10との間の領域を左右の第3ソナー68Cの探査対象領域に含むことができ、左右の前輪9と左右の後輪10との間における障害物の有無を、左右の第3ソナー68Cによって検出することができる。
図2に示すように、左右の第4ソナー68Dは、左右の第4支持部材96を介して左右のリアフェンダ12に取り付けられることにより、左右の後輪10における横外側端の上方に配置されている。これにより、左右の第4ソナー68Dによる障害物の探査を、左右の後輪10によって阻害されることなく良好に行うことができる。
図1〜4、図12、図13、図15に示すように、右側の第1ソナー68Aの取り付け姿勢は、送受信面が右前向きになる右前向き姿勢に設定されている。左側の第1ソナー68Aの取り付け姿勢は、送受信面が左前向きになる左前向き姿勢に設定されている。右側の第2ソナー68Bの取り付け姿勢は、送受信面が右横向きになる右向き姿勢に設定されている。左側の第2ソナー68Bの取り付け姿勢は、送受信面が左横向きになる左向き姿勢に設定されている。右側の第3ソナー68C及び第4ソナー68Dの取り付け姿勢は、送受信面が右下向きになる右下向き姿勢に設定されている。左側の第3ソナー68C及び第4ソナー68Dの取り付け姿勢は、送受信面が左下向きになる左下向き姿勢に設定されている。
〔別実施形態〕
本発明は、上記の実施形態で例示した構成に限定されるものではなく、以下、本発明に関する代表的な別実施形態を例示する。
〔1〕作業車は、以下に例示する構成が採用されていてもよい。
例えば、作業車は、左右の後輪10に代えて左右のクローラを備えるセミクローラ仕様に構成されていてもよい。
例えば、作業車は、左右の前輪9及び左右の後輪10に代えて左右のクローラを備えるフルクローラ仕様に構成されていてもよい。
例えば、作業車は、左右の前輪9と左右の後輪10とのいずれか一方が駆動される二輪駆動式であってもよい。
例えば、作業車は、エンジン6の代わりに電動モータを備える電動仕様に構成されていてもよい。
例えば、作業車は、エンジン6と電動モータとを備えるハイブリッド仕様に構成されていてもよい。
例えば、作業車は、キャビン4に代えて保護フレームを備えていてもよい。
〔2〕障害物検出モジュール64における障害物探査器68の数量及び配置などは、作業車の構成や大きさなどに応じて種々の変更が可能である。
例えば、作業車の全長が長ければ、障害物探査器68の数量を10個以上にしてもよく、作業車の全長が短ければ、障害物探査器68の数量を6個以下にしてもよい。
例えば、作業車が、キャビン4の代わりに保護フレームを備えていれば、障害物探査器68を保護フレームに取り付けるようにしてもよい。
〔3〕障害物探査器68には、赤外線測距センサなどを採用してもよい。
〔4〕左右の第1ソナー68Aは、ボンネット16の前端部におけるヘッドライト107よりも上方の位置に配置されていてもよい。
本発明は、車体を自動で運転する自動運転用の電子制御システムを備えたトタクタ、乗用草刈機、コンバイン、乗用田植機、及び、ホイルローダ、などの作業車に適用することができる。
2 走行装置
4 キャビン
12 リアフェンダ
16 ボンネット
30D 接触回避制御部
51 電子制御システム
64 障害物検出モジュール
68 障害物探査器
68A 第1測距センサ(ソナー)
68B 第2測距センサ(ソナー)
68C 第3測距センサ(ソナー)
68D 第4測距センサ(ソナー)
73 フロントピラー
92 共振防止部材
95 共振防止部材
97 共振防止部材
本発明は、車体を自動で運転する自動運転用の電子制御システムを備えた作業車に関する。
上記のような作業車においては、例えば、車体の前部に、車体の前方における障害物の有無を検出する障害物検出手段が備えられたものがある(例えば特許文献1参照)。
そして、特許文献1に記載の作業車においては、障害物検出手段が障害物を検出したときに、車体の自動運転(自律走行)を停止させることにより、車体と車体前方の障害物とが接触して破損する不都合の発生を防止することが考えられている。
又、障害物検出手段が畦を障害物として検出するまでの間、自動運転によって車体を圃場端に向けて直進させ、障害物検出手段が畦を障害物として検出したときに、車体の自動運転を停止させることにより、車体を圃場端にて自動停止させることが考えられている。
特開2008−92818号公報(段落番号0049〜0051、図1〜2)
特許文献1に記載の作業車は、車体の前方における障害物の有無を検出する障害物検出手段を備えるだけであることから、例えば、自動運転中の圃場端での旋回走行(いわゆる畦際旋回)などにおいて、万が一、ステアリング機構の作動不良や走行装置のスリップなどに起因して、車体が大回りして作業車の横側部が畦などの障害物に異常接近しても、この障害物の存在を検出することができないようになっている。そのため、前述した異常接近に対する適正な処置を取ることができず、作業車の横側部が障害物に接触する不具合を招く虞がある。
つまり、自動運転中に作業車が障害物に接触する虞をより確実に回避できるようにすることが望まれている。
上記の課題を解決するための手段として、
本発明に係る作業車は、車体を自動で走行させる自動運転用の電子制御システムと、内部に振動子を有するソナーからなり、前記車体の周囲に存在する障害物を検出する複数の障害物探査器と、が備えられ、複数の前記障害物探査器として、前記車体の前端側に取り付けられた左右の第1測距センサと、前記車体の前側部分における左右両側方に取り付けられた左右の第2測距センサと、前記車体のうち前記第2測距センサの後方における左右両側方に取り付けられた左右の第3測距センサと、前記車体のうち前記第3測距センサの後方における左右両側方に取り付けられた左右の第4測距センサと、が備えられ、右側の前記第1測距センサの取り付け姿勢は、送受信面が右前向きになる右前向き姿勢に設定され、左側の前記第1測距センサの取り付け姿勢は、送受信面が左前向きになる左前向き姿勢に設定され、右側の前記第2測距センサの取り付け姿勢は、送受信面が右横向きになる右向き姿勢に設定され、左側の前記第2測距センサの取り付け姿勢は、送受信面が左横向きになる左向き姿勢に設定され、右側の前記第3測距センサ及び前記第4測距センサの取り付け姿勢は、送受信面が右下向きになる右下向き姿勢に設定され、左側の前記第3測距センサ及び前記第4測距センサの取り付け姿勢は、送受信面が左下向きになる左下向き姿勢に設定されている。
本発明をより好適にするための手段の一つとして、
前記車体の前部部分に配置されたボンネットが備えられ、前記ボンネットの前端部に左右の前記第1測距センサが取り付けられ、前記ボンネットの左右両側部分に左右の前記第2測距センサが取り付けられている。
本発明をより好適にするための手段の一つとして、
前記車体の後部部分に設けられたキャビンと、が備えられ、前記キャビンの前部に設けられた左右のフロントピラーと、左右の前記フロントピラーに前記第3測距センサが取り付けられている。
本発明をより好適にするための手段の一つとして、
前記車体の左右両側に後輪を覆うフェンダが備えられ、左右の前記フェンダに前記第4測距センサが取り付けられている。
障害物探査器の配置などを示すトラクタの左側面図である。 障害物探査器の配置などを示すトラクタの平面図である。 障害物探査器の配置などを示すトラクタの斜視図である。 障害物探査器の支持構造など示すトラクタ前端部の縦断左側面図である。 トラクタ前端部の構成を示す要部の斜視図である。 運転部の構成を示す要部の横断平面図である。 制御系の概略構成を示すブロック図である。 アンテナユニット及び監視カメラなどの配置を示すキャビン上部の正面図である。 アンテナユニット及び監視カメラなどの配置を示すキャビン上部の背面図である。 アンテナユニット及び監視カメラなどの配置を示すキャビン上部の左側面図である。 キャビンのフレーム構造を示す要部の斜視図である。 第1測距センサ及び第2測距センサの取り付け構造を示す要部の縦断正面図である。 第3測距センサの取り付け構造を示す要部の縦断正面図である。 第3測距センサの取り付け構造を示す要部の分解斜視図である。 第4測距センサの取り付け構造を示す要部の縦断正面図である。 第4測距センサの取り付け構造を示す要部の分解斜視図である。
以下、本発明を実施するための形態の一例として、本発明が、作業車の一例であるトラクタに適用された実施形態を図面に基づいて説明する。
尚、図1に記載された符号Fの矢印が指し示す方向がトラクタの前側であり、符号Uの矢印が指し示す方向がトラクタの上側である。
又、図2に記載された符号Fの矢印が指し示す方向がトラクタの前側であり、符号Rの矢印が指し示す方向がトラクタの右側である。
図1〜3に示すように、本実施形態に例示されたトラクタは、車体の前後両端にわたる車体フレーム1、車体フレーム1の左右に配置された左右の走行装置2、車体フレーム1の前部側に配置された原動部3、車体フレーム1の後部側に配置されたキャビン4、及び、車体フレーム1の後端部に昇降揺動可能に取り付けられた作業装置連結用の3点リンク機構5、などを備えている。
図1〜5に示すように、車体フレーム1は、原動部3に配置されたエンジン6の下部から車体前側に延出する前部フレーム7、及び、エンジン6の後端下部から車体後側に延出する後部フレーム兼用のケースユニット8、などを備えている。図示は省略するが、ケースユニット8の内部には、エンジン6からの動力を断続するペダル操作式の主クラッチ、主クラッチを経由した動力を走行用と作業用とに分岐して変速する変速伝動ユニット、及び、左右の走行装置2に作用する左右のサイドブレーキ、などが備えられている。
左右の走行装置2は、駆動可能な操舵輪として機能する左右の前輪9と、駆動輪として機能する左右の後輪10とを備えている。左右の前輪9は、前部フレーム7にローリング可能に支持された車輪支持部材11の左右両端部に操舵可能な状態で駆動可能に支持されている。車輪支持部材11は、前輪駆動用の伝動軸11Aなどを内部に備えた前車軸ケースである。左右の後輪10は、ケースユニット8に駆動可能に支持されるとともに、各後輪10の上部側が、車体の後部側に配置された左右のリアフェンダ12によって覆われている。
原動部3は、原動部3の冷却方向下手側となる原動部3の車体後部側に配置された水冷式のエンジン6、エンジン6よりも冷却方向上手側となる車体前側に配置された冷却ファン13、冷却ファン13よりも車体前側に配置されたラジエータ14、ラジエータ14よりも車体前側に配置されたバッテリ15、エンジン6の後部上方に配置された排気処理装置(図示せず)、エンジン6の前部上方に配置されたエアクリーナ(図示せず)、及び、エンジン6やラジエータ14などを上方から覆う揺動開閉式のボンネット16、などを備えている。エンジン6には、コモンレールシステムを備えた電子制御式のディーゼルエンジンが採用されている。排気処理装置は、DOC((Diesel Oxidation Catalyst)とDPF(Diesel particulate filter)とを内部に備えている。
図1〜4、図6に示すように、キャビン4は、車体の後部側に運転部17と搭乗空間とを形成している。運転部17には、主クラッチの操作を可能にするクラッチペダル18、左右のサイドブレーキの操作を可能にする左右のブレーキペダル49、左右の前輪9の手動操舵を可能にする手動操舵用のステアリングホイール19、前後進切り換え用のシャトルレバー20、右腕用のアームレスト21を有する運転座席22、及び、タッチ操作可能な液晶パネル23Aなどを有する表示ユニット23、などが備えられている。ステアリングホイール19は、全油圧式のパワーステアリングユニット(以下、PSユニットと称する)24を有するステアリング機構25を介して左右の前輪9に連係されている。アームレスト21には、主変速レバー26、作業装置の高さ位置を設定する昇降レバー27、及び、作業装置の昇降を指令する昇降スイッチ28が備えられている。
図7に示すように、3点リンク機構5は、車体に備えられた電子油圧制御式の昇降駆動ユニット29の作動によって上下方向に揺動駆動される。図示は省略するが、3点リンク機構5には、ロータリ耕耘装置、プラウ、ディスクハロー、カルチベータ、サブソイラ、播種装置、及び、散布装置、などの作業装置を連結することができる。そして、3点リンク機構5に連結される作業装置が、車体からの動力によって駆動されるロータリ耕耘装置などである場合は、変速ユニットから取り出された作業用の動力が外部伝動軸を介して伝達される。
車体には、車体の走行に関する制御を行う走行制御部30A、及び、作業装置に関する制御を行う作業制御部30B、などを備えたメインの電子制御ユニット(以下、メインECUと称する)30が搭載されている。メインECU30は、前述した電子油圧制御式の昇降駆動ユニット29、エンジン用の電子制御ユニット(以下、エンジンECUと称する)31、変速伝動ユニットに備えられた電子制御式の主変速装置32と前後進切換装置33とPTOクラッチ34、左右のサイドブレーキの自動操作を可能にする電子油圧式のブレーキ操作ユニット35、及び、車速を含む車内情報を取得する車内情報取得ユニット36、などに、CAN(Controller Area Network)などの車内LAN又は通信線を介して通信可能に接続されている。メインECU30及びエンジンECU31は、CPU及びEEPROMなどを有するマイクロプロセッサを備えている。走行制御部30Aは、車体の走行に関する制御を可能にする各種の制御プログラムなどを有している。作業制御部30Bは、作業装置に関する制御を可能にする各種の制御プログラムなどを有している。
主変速装置32には、走行用の動力を無段階で変速する静油圧式の無段変速装置が採用されている。前後進切換装置33は、走行用の動力を断続する走行クラッチを兼ねている。図示は省略するが、変速伝動ユニットには、主変速装置32などとともに、走行用の動力を有段階で変速する副変速装置、及び、作業用の動力を有段階で変速するPTO変速装置、などが備えられている。
車内情報取得ユニット36には、エンジン6の出力回転数を検出する回転センサ37、副変速装置の出力回転数を車速として検出する車速センサ38、主変速レバー26の操作位置を検出する第1レバーセンサ39、運転部17に備えられた副変速レバー40の操作位置を検出する第2レバーセンサ41、シャトルレバー20の操作位置を検出する第3レバーセンサ42、昇降レバー27の操作位置を検出する第4レバーセンサ43、前述した昇降スイッチ28、運転部17に備えられた旋回上昇スイッチ44と後進上昇スイッチ45とPTOスイッチ46、昇降駆動ユニット29における左右のリフトアーム(図示せず)の上下揺動角度を作業装置の高さ位置として検出する高さセンサ47、及び、前輪9の舵角を検出する舵角センサ48、などの各種センサ及びスイッチ類が含まれている。
走行制御部30Aは、回転センサ37の出力と車速センサ38の出力と第1レバーセンサ39の出力と第2レバーセンサ41の出力とに基づいて、車速が、エンジン回転数と主変速レバー26の操作位置と副変速レバー40の操作位置とから求めた制御目標車速に達するように、主変速装置32のトラニオン軸(図示せず)を操作する車速制御を行う。これにより、運転者は、主変速レバー26を任意の操作位置に操作することにより、車速を任意の速度に変更することができる。
走行制御部30Aは、第3レバーセンサ42の出力に基づいて、シャトルレバー20の操作位置に応じた伝動状態に前後進切換装置33を切り換える前後進切り換え制御を行う。これにより、運転者は、シャトルレバー20を前進位置に操作することにより、車体の進行方向を前進方向に設定することができる。運転者は、シャトルレバー20を後進位置に操作することにより、車体の進行方向を後進方向に設定することができる。
作業制御部30Bは、第4レバーセンサ43の出力と高さセンサ47の出力とに基づいて、昇降レバー27の操作位置に応じた高さ位置に作業装置が位置するように昇降駆動ユニット29の作動を制御するポジション制御を行う。これにより、運転者は、昇降レバー27を任意の操作位置に操作することにより、作業装置の高さ位置を任意の高さ位置に変更することができる。
作業制御部30Bは、昇降スイッチ28の手動操作によって昇降スイッチ28が上昇指令状態に切り換えられると、昇降スイッチ28からの上昇指令と高さセンサ47の出力とに基づいて、作業装置が予め設定された上限位置まで上昇するように昇降駆動ユニット29の作動を制御する上昇制御を行う。これにより、運転者は、昇降スイッチ28を上昇指令状態に切り換えることにより、作業装置を上限位置まで自動的に上昇させることができる。
作業制御部30Bは、昇降スイッチ28の手動操作によって昇降スイッチ28が下降指令状態に切り換えられると、昇降スイッチ28からの下降指令と第4レバーセンサ43の出力と高さセンサ47の出力とに基づいて、作業装置が昇降レバー27によって設定された作業高さ位置まで下降するように昇降駆動ユニット29の作動を制御する下降制御を行う。これにより、運転者は、昇降スイッチ28を下降指令状態に切り換えることにより、作業装置を作業高さ位置まで自動的に下降させることができる。
作業制御部30Bは、旋回上昇スイッチ44の手動操作によって旋回連動上昇制御の実行が選択された場合は、前輪9の舵角を検出する舵角センサ48の出力に基づいて、前輪9の舵角が畦際旋回用の設定角度に達したことを検知したときに、前述した上昇制御を自動的に行う。これにより、運転者は、旋回連動上昇制御の実行を選択しておくことにより、畦際旋回の開始に連動して、作業装置を上限位置まで自動的に上昇させることができる。
作業制御部30Bは、後進上昇スイッチ45の手動操作によって後進連動上昇制御の実行が選択された場合は、第3レバーセンサ42の出力に基づいて、シャトルレバー20の後進位置への手動操作を検知したときに、前述した上昇制御を自動的に行う。これにより、運転者は、後進連動上昇制御の実行を選択しておくことにより、後進走行への切り換えに連動して、作業装置を上限位置まで自動的に上昇させることができる。
作業制御部30Bは、PTOスイッチ46の手動操作によってPTOスイッチ46の操作位置が入り位置に切り換えられると、入り位置への切り換えに基づいて、作業用の動力が作業装置に伝達されるようにPTOクラッチ34を入り状態に切り換えるクラッチ入り制御を行う。これにより、運転者は、PTOスイッチ46を入り位置に操作することによって作業装置を作動させることができる。
作業制御部30Bは、PTOスイッチ46の手動操作によってPTOスイッチ46の操作位置が切り位置に切り換えられると、切り位置への切り換えに基づいて、作業用の動力が作業装置に伝達されないようにPTOクラッチ34を切り状態に切り換えるクラッチ切り制御を行う。これにより、運転者は、PTOスイッチ46を切り位置に操作することによって作業装置を停止させることができる。
作業制御部30Bは、PTOスイッチ46の手動操作によってPTOスイッチ46の操作位置が自動位置に切り換えられると、前述した上昇制御の実行に連動して前述したクラッチ切り制御を自動的に行い、又、前述した下降制御の実行に連動して前述したクラッチ入り制御を自動的に行う。これにより、運転者は、PTOスイッチ46を自動位置に操作しておくことにより、作業装置の上限位置への自動上昇に連動して作業装置を停止させることができ、又、作業装置の作業高さ位置への自動下降に連動して作業装置を作動させることができる。
図1〜5、図7に示すように、このトラクタは、運転モードの手動運転モード及び自動運転モードなどの選択を可能にする選択イッチ50と、自動運転モードが選択された場合に車体を自動で運転する自動運転用の電子制御システム51とを備えている。電子制御システム51は、前述したメインECU30、左右の前輪9の自動操舵を可能にする自動操舵ユニット52、車体の位置及び方位を測定する測位ユニット53、及び、車体の周囲を監視する監視ユニット54、などを備えている。
図2〜4、図7に示すように、自動操舵ユニット52は、前述したPSユニット24によって構成されている。PSユニット24は、手動運転モードが選択された場合は、ステアリングホイール19の回動操作に基づいて左右の前輪9を操舵する。又、PSユニット24は、自動運転モードが選択された場合は、メインECU30からの制御指令に基づいて左右の前輪9を操舵する。
つまり、自動操舵専用のステアリングユニットを備えることなく、左右の前輪9を自動で操舵することができる。又、PSユニット24の電気系に不具合が生じた場合は、搭乗者による手動操舵に簡単に切り換えることができ、車体の運転を継続することができる。
図1〜3、図7〜10に示すように、測位ユニット53は、全地球航法衛星システム(GNSS:Global Navigation Satellite System)の一例である周知のGPS(Global Positioning System)を利用して車体の位置及び方位を測定する衛星航法装置60を備えている。GPSを利用した測位方法には、DGPS(Differential GPS)やRTK−GPS(Real Time Kinematic GPS)などがあるが、本実施形態においては、移動体の測位に適したRTK−GPSが採用されている。
衛星航法装置60は、GPS衛星(図示せず)から送信された電波と、既知位置に設置された基準局(図示せず)から送信された測位データとを受信する衛星航法用のアンテナユニット61を備えている。基準局は、GPS衛星からの電波を受信して得た測位データを衛星航法装置60に送信する。衛星航法装置60は、GPS衛星からの電波を受信して得た測位データと、基準局からの測位データとに基づいて、車体の位置及び方位を求める。
アンテナユニット61は、GPS衛星からの電波の受信感度が高くなるように、車体の最上部に位置するキャビン4のルーフ62に取り付けられている。そのため、GPSを利用して測定した車体の位置及び方位には、車体のヨーイング、ピッチング、又は、ローリングに伴うアンテナユニット61の位置ズレに起因した測位誤差が含まれている。
そこで、車体には、上記の測位誤差を取り除く補正を可能にするために、3軸のジャイロスコープ(図示せず)と3方向の加速度センサ(図示せず)とを有して車体のヨー角、ピッチ角、ロール角、などを計測する慣性計測装置(IMU:Inertial Measurement Unit)63が備えられている。慣性計測装置63は、前述したアンテナユニット61の位置ズレ量を求め易くするために、アンテナユニット61の内部に備えられている。アンテナユニット61は、平面視において車体におけるトレッドTの中央部でホイールベースLの中央部に位置するように、キャビン4のルーフ62における前部上面の左右中央箇所に取り付けられている(図2参照)。
上記の構成により、少なくとも、平面視においては慣性計測装置63の取り付け位置が車体の重心位置に近くなる。これにより、慣性計測装置63が計測したヨー角などを、車体の重心位置からの慣性計測装置63の位置ズレ量に基づいて補正するための演算が簡単になり、よって、慣性計測装置63の計測結果を迅速に正しく補正することができる。つまり、慣性計測装置63による車体のヨー角などの計測を迅速に精度良く行うことができる。
これにより、衛星航法装置60が車体の位置及び方位を測定する場合において、車体のヨーイング、ピッチング、又は、ローリングに起因して、アンテナユニット61に位置ズレが生じたときは、このときのアンテナユニット61の位置ズレ量を、慣性計測装置63が計測する車体のヨー角、ピッチ角、ロール角、などから迅速に精度良く求めることができる。そして、衛星航法装置60が計測した車体の位置及び方位に含まれるアンテナユニット61の位置ズレに起因した測位誤差を、慣性計測装置63の計測結果から求められるアンテナユニット61の位置ズレ量に基づいて迅速に精度良く求めることができ、この測位誤差を衛星航法装置60の測定結果から取り除く補正を迅速かつ適正に行える。
その結果、全地球航法衛星システムを利用した車体の位置及び方位の測定を、より簡単かつ迅速に精度良く行うことができる。
図7に示すように、メインECU30は、車体の自動運転を可能にする各種の制御プログラムなどを有する自動運転制御部30Cを備えている。自動運転制御部30Cは、車体が予め設定された圃場の目標走行経路を設定速度で適正に作業を行いながら自動走行するように、目標走行経路及び測位ユニット53の測位結果などに基づいて、走行制御部30A及び作業制御部30Bなどに各種の制御指令を適切なタイミングで送信する。走行制御部30Aは、自動運転制御部30Cからの各種の制御指令及び車内情報取得ユニット36の各種取得情報などに基づいて、主変速装置32及び前後進切換装置33などに各種の制御指令を適切なタイミングで送信して主変速装置32及び前後進切換装置33などの作動を制御する。作業制御部30Bは、自動運転制御部30Cからの各種の制御指令及び車内情報取得ユニット36の各種取得情報などに基づいて、昇降駆動ユニット29及びPTOクラッチ34などに各種の制御指令を適切なタイミングで送信して昇降駆動ユニット29及びPTOクラッチ34などの作動を制御する。
目標走行経路は、圃場での手動運転による作業走行時に走行した走行経路、及び、畦際旋回開始地点などが、測位ユニット53の測位結果などに基づいてデータ化されたものであってよい。又、目標走行経路は、圃場での手動運転によるティーチング走行時に走行した走行経路、及び、畦際旋回開始地点などが、測位ユニット53の測位結果などに基づいてデータ化されたものであってよい。
図1〜5、図7〜10に示すように、監視ユニット54は、車体に対する至近距離内(例えば1m以内)での障害物の有無を検出する障害物検出モジュール64、車体に対する近距離(例えば10m以内)での障害物の接近を検出する前後の障害物探知器65、障害物との接触を回避する接触回避制御を行う接触回避制御部30D、車体の周囲を撮影する6台の監視カメラ66、監視カメラ66が撮影した画像を処理する画像処理装置67、などを備えている。
障害物検出モジュール64は、車体に対する至近距離内において障害物を探査する8個の障害物探査器68と、各障害物探査器68からの探査情報に基づいて車体に対する至近距離内に障害物が接近したか否かの判別処理を行う2台の探査情報処理装置69とを備えている。
各障害物探査器68には、測距センサの一例として測距に超音波を使用するソナー68が採用されている。8個のソナー68は、車体の前方と左右両側方とが探査対象領域になるように、車体の前端部と左右両端部とに分散して配置されている。各ソナー68は、それらの探査で得た探査情報を対応する探査情報処理装置69に送信する。
各探査情報処理装置69は、対応する各ソナー68における超音波の発信から受信までの時間に基づいて、車体に対する至近距離内に障害物が接近したか否かの判別処理を行い、この判別結果を接触回避制御部30Dに出力する。
これにより、自動運転中の車体の前方又は左右の横側方において障害物が車体に対する至近距離内に異常接近した場合は、この障害物の接近が障害物検出モジュール64によって検出される。又、車体の後端部にはソナー68が備えられていないことにより、障害物検出モジュール64が、車体の後部に昇降可能に取り付けられた作業装置を障害物として誤検出することが回避されている。
ちなみに、障害物検出モジュール64は、例えば、車体が自動運転によって畦に向かって走行しているとき、又は、車体が自動運転によって畦際で畦に沿って走行しているときに、畦が車体に対する至近距離内に異常接近した場合は、この畦を障害物として検出する。又、移動体が車体に対する至近距離内に異常接近した場合は、この移動体を障害物として検出する。
各障害物探知器65には、約270度程度の検出角度を有するレーザスキャナ65が採用されている。各レーザスキャナ65は、障害物の探知を行う探知部65Aと、探知部65Aからの探知情報を処理する処理部65Bとを備えている。探知部65Aは、探知対象領域にレーザ光線を照射して反射光を受け取る。処理部65Bは、レーザ光線の照射から受光までの時間に基づいて、車体に対する近距離において障害物が接近しているか否かなどを判別し、判別結果を接触回避制御部30Dに出力する。前側のレーザスキャナ65は、車体前側の領域が探知対象領域に設定されている。後側のレーザスキャナ65は、車体後側の領域が探知対象領域に設定されている。
接触回避制御部30Dは、接触回避制御の実行を可能にする制御プログラムなどを有してメインECU30に備えられている。接触回避制御部30Dは、各レーザスキャナ65の判別結果に基づいて、車体に対する近距離での障害物の接近を確認したときに、自動運転制御部30Cの制御作動に基づく自動運転に優先して接触回避制御を開始する。そして、接触回避制御部30Dは、各レーザスキャナ65及び各探査情報処理装置69の判別結果に基づいて接触回避制御を行う。
接触回避制御において、接触回避制御部30Dは、接触回避制御の開始とともに走行制御部30Aに減速指令を出力する。これにより、接触回避制御部30Dは、走行制御部30Aの制御作動によって主変速装置32を減速作動させて、車速を通常走行用の設定速度から接触回避用の設定速度まで低下させる。接触回避制御部30Dは、この低速走行状態において、いずれかの探査情報処理装置69の判別結果に基づいて、車体に対する至近距離内への障害物の接近を確認したときに、走行制御部30A及び作業制御部30Bに緊急停止指令を出力する。これにより、接触回避制御部30Dは、走行制御部30Aの制御作動によって前後進切換装置33を中立状態に切り換えるとともに、ブレーキ操作ユニット35の作動によって左右のブレーキを作動させて左右の前輪9と左右の後輪10とを制動させる。又、接触回避制御部30Dは、作業制御部30Bの作動によってPTOクラッチ34を切り状態に切り換えて作業装置の作動を停止させる。その結果、車体に対する至近距離内への障害物の接近に基づいて、車体の走行停止と作業装置の作動停止とを迅速に行うことができ、車体が障害物に接触する虞を回避することができる。接触回避制御部30Dは、この低速走行状態において、各レーザスキャナ65の判別結果に基づいて、車体に対する近距離内において障害物が存在しないことを確認したときに、走行制御部30Aに増速指令を出力し、その後、接触回避制御を終了する。これにより、接触回避制御部30Dは、走行制御部30Aの制御作動によって主変速装置32を増速作動させて、車速を接触回避用の設定速度から通常走行用の設定速度まで上昇させた後、自動運転制御部30Cの制御作動に基づく自動運転を再開させる。
図1〜3、図7〜10に示すように、各監視カメラ66には、広角の可視光用CCDカメラが採用されている。6台の監視カメラ66のうちの1台は、車体の前方撮影用であり、この監視カメラ66は、撮影方向が前下方向きになる傾斜姿勢で、キャビン4の上端部における前端の左右中央箇所に設置されている。6台の監視カメラ66のうちの2台は、車体の右方撮影用であり、これらの監視カメラ66は、撮影方向が右下方向きになる傾斜姿勢で、キャビン4の上端部における右端箇所に前後に所定間隔をあけて設置されている。6台の監視カメラ66のうちの2台は、車体の左方撮影用であり、これらの監視カメラ66は、撮影方向が左下方向きになる傾斜姿勢で、キャビン4の上端部における左端箇所に前後に所定間隔をあけて設置されている。6台の監視カメラ66のうちの1台は、車体の後方撮影用であり、この監視カメラ66は、撮影方向が後下方向きになる傾斜姿勢で、キャビン4の上端部における後端の左右中央箇所に設置されている。これにより、車体の周囲を漏れなく撮影することができる。
尚、右監視カメラ66と左監視カメラ66とを1台ずつにして、キャビン4の上端部における左右両端の適正箇所に設置するようにしてもよい。
画像処理装置67は、各監視カメラ66からの映像信号を処理して、車体前方画像、車体右側方画像、車体左側方画像、車体後方画像、及び、車体の真上から見下ろしたような俯瞰画像、などを生成して表示ユニット23などに送信する。表示ユニット23は、液晶パネル23Aに表示される各種の操作スイッチ(図示せず)の人為操作などに基づいて、液晶パネル23Aに表示される画像を切り換える制御部23B、などを有している。
上記の構成により、手動運転時においては、運転者は、画像処理装置67からの画像を液晶パネル23Aに表示させることにより、運転中の車体の周辺状況や作業状況を容易に視認することができる。これにより、運転者は、作業の種類などに応じた良好な車体の運転を容易に行うことができる。又、自動運転時に管理者が車体に搭乗する場合においては、管理者は、画像処理装置67からの画像を液晶パネル23Aに表示させることにより、自動運転中の車体の周辺状況や作業状況を容易に視認することができる。そして、管理者は、自動運転中の車体周辺又は作業状況などにおける異常を視認した場合は、その異常の種類や程度などに応じた適切な処置を速やかに行うことができる。
図7に示すように、電子制御システム51は、選択イッチ50の人為操作によって協調運転モードが選択された場合に、車体を同じ仕様の他車と協調して自動走行させる協調制御ユニット70を備えている。協調制御ユニット70は、車体の位置情報を含む他車との協調走行に関する情報を他車との間で無線通信する通信モジュール71と、他車からの情報に基づいて協調運転制御を行う協調運転制御部30Eとを備えている。協調運転制御部30Eは、協調運転制御の実行を可能にする制御プログラムなどを有してメインECU30に備えられている。
協調運転モードにおいて、自動運転制御部30Cは、車体が予め設定された併走用の目標走行経路を設定速度で適正に作業を行いながら自動走行するように、併走用の目標走行経路及び測位ユニット53の測位結果などに基づいて、走行制御部30A及び作業制御部30Bなどに各種の制御指令を適切なタイミングで送信する。協調運転制御部30Eは、自車の併走用の目標走行経路、測位ユニット53の測位結果、他車の併走用の目標走行経路、及び、他車の位置情報、などに基づいて、先行する他車と自車との進行方向での車間距離、及び、先行する他車と自車との併走方向での車間距離、などが適正であるか否かを判別する。そして、いずれかの車間距離が適正でない場合は、その車間距離が適正になるように、自動運転制御部30Cの制御作動に基づく自動運転に優先して協調運転制御を開始する。
協調運転制御において、協調運転制御部30Eは、進行方向での車間距離が適正距離よりも短い場合は、走行制御部30Aに減速指令を出力する。これにより、協調運転制御部30Eは、走行制御部30Aの制御作動によって主変速装置32を減速作動させて、進行方向での車間距離を適正距離に復帰させる。そして、協調運転制御部30Eは、進行方向での車間距離が適正距離に復帰するのに伴って、自動運転制御部30Cの制御作動に基づく自動運転を再開させることにより、車速を通常走行用の設定速度まで上昇させて進行方向での車間距離を適正距離に維持する。
協調運転制御部30Eは、進行方向での車間距離が適正距離よりも長い場合は、走行制御部30Aに増速指令を出力する。これにより、協調運転制御部30Eは、走行制御部30Aの制御作動によって主変速装置32を増速作動させて、進行方向での車間距離を適正距離に復帰させる。そして、協調運転制御部30Eは、進行方向での車間距離が適正距離に復帰するのに伴って、自動運転制御部30Cの制御作動に基づく自動運転を再開させることにより、車速を通常走行用の設定速度まで低下させて進行方向での車間距離を適正距離に維持する。
協調運転制御部30Eは、併走方向での車間距離が適正距離よりも長い場合は、走行制御部30Aに他車側への操舵指令を出力する。これにより、協調運転制御部30Eは、走行制御部30Aの制御作動によって左右の前輪9を他車側に操舵させて、併走方向での車間距離を適正距離に復帰させる。そして、協調運転制御部30Eは、併走方向での車間距離が適正距離に復帰するのに伴って、自動運転制御部30Cの制御作動に基づく自動運転を再開させることにより、車体の進行方向を通常走行用の進行方向に戻して併走方向での車間距離を適正距離に維持する。
協調運転制御部30Eは、併走方向での車間距離が適正距離よりも短い場合は、走行制御部30Aに他車から離れる側への操舵指令を出力する。これにより、協調運転制御部30Eは、走行制御部30Aの制御作動によって左右の前輪9を他車から離れる側に操舵させて、併走方向での車間距離を適正距離に復帰させる。そして、協調運転制御部30Eは、併走方向での車間距離が適正距離に復帰するのに伴って、自動運転制御部30Cの制御作動に基づく自動運転を再開させることにより、車体の進行方向を通常走行用の進行方向に戻して併走方向での車間距離を適正距離に維持する。
これにより、自車を、先行する他車に対して、進行方向での車間距離と併走方向での車間距離とを訂正に維持しながら自動で適正に併走させることができる。
図1〜3、図6、図8〜11に示すように、キャビン4は、ルーフ62などを支持するルーフフレーム72、ルーフフレーム72の前端部を支持する左右のフロントピラー73、ルーフフレーム72の前後中間部を支持する左右のセンタピラー74、ルーフフレーム72の後部側を支持する左右のリアピラー75、キャビン4の前面を形成するフロントパネル76、左右のセンタピラー74に開閉揺動可能に支持された左右のドアパネル77、キャビン4の後部側面を形成する左右のサイドパネル78、及び、ルーフフレーム72に開閉揺動可能に支持されたリヤパネル79、などを備えている。
ルーフフレーム72は、左右のフロントピラー73にわたるフロントビーム98、左右いずれかのフロントピラー73とリアピラー75とにわたる左右のサイドビーム99、及び、左右のリアピラー75にわたるリアビーム100、などを備えて平面視略矩形状に形成されている。
左右のフロントピラー73は、車体におけるホイールベースLの中央部よりも車体前側に配置されている。左右のフロントピラー73は、正面視においては上半部の上側ほど車体の左右中央側に位置し、かつ、側面視においては上半部の上側ほど車体の前後中央側に位置するように上半部が湾曲している。
左右のセンタピラー74及び左右のリアピラー75は、運転座席22の左右に配置された左右のリアフェンダ12とルーフフレーム72との間に配置されている。左右のセンタピラー74は、正面視においては上側ほど車体の左右中央側に位置し、かつ、側面視においては上側ほど車体の前後中央側に位置するように湾曲している。左右のリアピラー75は、正面視においては上側ほど車体の左右中央側に位置し、かつ、側面視においては略垂直姿勢になるように湾曲している。
各パネル76〜79には、対応するピラー73〜75などに沿って湾曲するガラス製又は透明アクリル樹脂製などの曲面パネルが採用されている。
上記の構成により、キャビン4の下半部においては、運転座席22に着座した運転者の手足による各種の操作が行い易い広い空間を確保しながら、キャビン4の上半部においては、居住性を損なわない程度でルーフフレーム72の前後幅及び左右幅を狭くすることができる。その結果、搭乗空間での操作性及び居住性を低下させることなく、キャビン上部の小型軽量化による車体の安定性の向上を図ることができる。
図1〜3、図9〜11に示すように、キャビン4は、左右のリアピラー75の上端部から後方に延出する補助フレーム90を備えている。補助フレーム90は、後側のレーザスキャナ65及び後方撮影用の監視カメラ66などを支持している。
図1、図3、図4に示すように、各ソナー68は、少なくとも車体における左右の前輪9よりも上側の部位に設置されている。これにより、例えば、作業走行中に、圃場の起伏などに応じて車体がローリング又はピッチングすることにより、いずれかのソナー68が圃場の地面に近づいた場合であっても、このときの各ソナー68の地面からの離間距離を、各ソナー68の探査距離よりも長い状態に維持することができる。
つまり、各ソナー68は、作業走行中に圃場の起伏などに応じて車体がローリング又はピッチングした場合であっても、圃場の地面が、各ソナー68の探査距離内に入り込む虞を回避することができる適切な高さ位置に配置されている。これにより、作業走行中の車体のローリング又はピッチングに起因して、各ソナー68が圃場の地面を障害物として誤検出する虞を回避することができる。
図1〜4に示すように、前述した8個のソナー68のうち、2個の第1ソナー68Aは、ボンネット16における前端部の上下中央部に、左右方向に所定間隔をあけて取り付けられている。つまり、左右の第1ソナー68Aにより、車体前方の探査対象領域を左右方向に広くすることができる。その結果、車体に対する車体前方の至近距離内への障害物の接近を洩れなく探査することができる。
図1〜3に示すように、残りの6個のソナー68のうち、2個の第2ソナー68Bは、ボンネット16の左右両側部における左右の前輪9よりも上側の部位に取り付けられている。2個の第3ソナー68Cは、キャビン4における車体の前後中間部に位置する左右のフロントピラー73に取り付けられている。2個の第4ソナー68Dは、左右のリアフェンダ12における左右の後輪10よりも上側の部位に取り付けられている。
上記の取り付けにより、車体の左右両側方のうち、ボンネット16などが配置された車体前部側の左右両側方は、左右の第2ソナー68Bの探査対象領域になり、左右のフロントピラー73などが配置された車体の前後中央側の左右両側方は、左右の第3ソナー68Cの探査対象領域になり、左右のリアフェンダ12などが配置された車体後部側の左右両側方は、左右の第4ソナー68Dの探査対象領域になる。つまり、左右の第2ソナー68Bと左右の第3ソナー68Cと左右の第4ソナー68Dにより、前後方向に広い車体横側方の領域全体を探査対象領域にすることができる。その結果、車体に対する車体横側方の至近距離内への障害物の接近を漏れなく探査することができる。
その結果、自動運転中に車体が障害物に接触する虞を、各ソナー68の探査に基づいてより確実に回避することができる。
図1〜4、図12〜16に示すように、左右の第1ソナー68Aは、ボンネット16における前端部の上下中央部に配置された鋼板製の第1支持部材91に、樹脂製の第1共振防止部材92を介して取り付けられている。左右の第2ソナー68Bは、ボンネット16における左右両側部の前端側に配置された鋼板製の第2支持部材93に、樹脂製の第1共振防止部材92を介して取り付けられている。左右の第3ソナー68Cは、左右のフロントピラー73の上下中央側に配置された鋼板製の第3支持部材94に、樹脂製の第2共振防止部材95を介して取り付けられている。左右の第4ソナー68Dは、左右のリアフェンダ12の上端部から車体横外方に向けて突出する鋼板製の第4支持部材96に、樹脂製の第3共振防止部材97を介して取り付けられている。
上記の構成により、内部に振動子(図示せず)を有する各ソナー68を鋼板製の支持部材91,93,94,96に直に取り付けた場合に生じる共振を防止することができる。
又、ボンネット16に対する各ソナー68A,68Bの取り付けには、それぞれ同じ第1共振防止部材92を使用することから、部品の共通化によるコストの削減などを図ることができる。
図1、図3、図4、図12に示すように、第1支持部材91は、ボンネット16の前端部に備えられた補強フレーム106に取り付けられている。補強フレーム106は、ボンネット16の前端上部に配置されたヘッドライト107などを支持する支持フレームに兼用されている。
図1〜3に示すように、左右の第3ソナー68Cは、左右のフロントピラー73に取り付けられることにより、左右の前輪9と左右の後輪10との間に配置されている。これにより、左右の前輪9と左右の後輪10との間の領域を左右の第3ソナー68Cの探査対象領域に含むことができ、左右の前輪9と左右の後輪10との間における障害物の有無を、左右の第3ソナー68Cによって検出することができる。
図2に示すように、左右の第4ソナー68Dは、左右の第4支持部材96を介して左右のリアフェンダ12に取り付けられることにより、左右の後輪10における横外側端の上方に配置されている。これにより、左右の第4ソナー68Dによる障害物の探査を、左右の後輪10によって阻害されることなく良好に行うことができる。
図1〜4、図12、図13、図15に示すように、右側の第1ソナー68Aの取り付け姿勢は、送受信面が右前向きになる右前向き姿勢に設定されている。左側の第1ソナー68Aの取り付け姿勢は、送受信面が左前向きになる左前向き姿勢に設定されている。右側の第2ソナー68Bの取り付け姿勢は、送受信面が右横向きになる右向き姿勢に設定されている。左側の第2ソナー68Bの取り付け姿勢は、送受信面が左横向きになる左向き姿勢に設定されている。右側の第3ソナー68C及び第4ソナー68Dの取り付け姿勢は、送受信面が右下向きになる右下向き姿勢に設定されている。左側の第3ソナー68C及び第4ソナー68Dの取り付け姿勢は、送受信面が左下向きになる左下向き姿勢に設定されている。
〔別実施形態〕
本発明は、上記の実施形態で例示した構成に限定されるものではなく、以下、本発明に関する代表的な別実施形態を例示する。
〔1〕作業車は、以下に例示する構成が採用されていてもよい。
例えば、作業車は、左右の後輪10に代えて左右のクローラを備えるセミクローラ仕様に構成されていてもよい。
例えば、作業車は、左右の前輪9及び左右の後輪10に代えて左右のクローラを備えるフルクローラ仕様に構成されていてもよい。
例えば、作業車は、左右の前輪9と左右の後輪10とのいずれか一方が駆動される二輪駆動式であってもよい。
例えば、作業車は、エンジン6の代わりに電動モータを備える電動仕様に構成されていてもよい。
例えば、作業車は、エンジン6と電動モータとを備えるハイブリッド仕様に構成されていてもよい。
例えば、作業車は、キャビン4に代えて保護フレームを備えていてもよい。
〔2〕障害物検出モジュール64における障害物探査器68の数量及び配置などは、作業車の構成や大きさなどに応じて種々の変更が可能である。
例えば、作業車の全長が長ければ、障害物探査器68の数量を10個以上にしてもよく、作業車の全長が短ければ、障害物探査器68の数量を6個以下にしてもよい。
例えば、作業車が、キャビン4の代わりに保護フレームを備えていれば、障害物探査器68を保護フレームに取り付けるようにしてもよい。
〔3〕障害物探査器68には、赤外線測距センサなどを採用してもよい。
〔4〕左右の第1ソナー68Aは、ボンネット16の前端部におけるヘッドライト107よりも上方の位置に配置されていてもよい。
本発明は、車体を自動で運転する自動運転用の電子制御システムを備えたトタクタ、乗用草刈機、コンバイン、乗用田植機、及び、ホイルローダ、などの作業車に適用することができる。
2 走行装置
4 キャビン
12 リアフェンダ
16 ボンネット
30D 接触回避制御部
51 電子制御システム
64 障害物検出モジュール
68 障害物探査器
68A 第1測距センサ(ソナー)
68B 第2測距センサ(ソナー)
68C 第3測距センサ(ソナー)
68D 第4測距センサ(ソナー)
73 フロントピラー
92 共振防止部材
95 共振防止部材
97 共振防止部材

Claims (4)

  1. 車体を自動で走行させる自動運転用の電子制御システムと、
    内部に振動子を有するソナーからなり、前記車体の周囲に存在する障害物を検出する複数の障害物探査器と、が備えられ、
    複数の前記障害物探査器として、前記車体の前端側に取り付けられた左右の第1測距センサと、前記車体の前側部分における左右両側方に取り付けられた左右の第2測距センサと、前記車体のうち前記第2測距センサの後方における左右両側方に取り付けられた左右の第3測距センサと、前記車体のうち前記第3測距センサの後方における左右両側方に取り付けられた左右の第4測距センサと、が備えられ、
    右側の前記第1測距センサの取り付け姿勢は、送受信面が右前向きになる右前向き姿勢に設定され、左側の前記第1測距センサの取り付け姿勢は、送受信面が左前向きになる左前向き姿勢に設定され、
    右側の前記第2測距センサの取り付け姿勢は、送受信面が右横向きになる右向き姿勢に設定され、左側の前記第2測距センサの取り付け姿勢は、送受信面が左横向きになる左向き姿勢に設定され、
    右側の前記第3測距センサ及び前記第4測距センサの取り付け姿勢は、送受信面が右下向きになる右下向き姿勢に設定され、
    左側の前記第3測距センサ及び前記第4測距センサの取り付け姿勢は、送受信面が左下向きになる左下向き姿勢に設定されている作業車。
  2. 前記車体の前部部分に配置されたボンネットが備えられ、
    前記ボンネットの前端部に左右の前記第1測距センサが取り付けられ、
    前記ボンネットの左右両側部分に左右の前記第2測距センサが取り付けられている請求項1に記載の作業車。
  3. 前記車体の後部部分に設けられたキャビンと、が備えられ、
    前記キャビンの前部に設けられた左右のフロントピラーと、
    左右の前記フロントピラーに前記第3測距センサが取り付けられている請求項1又は2に記載の作業車。
  4. 前記車体の左右両側に後輪を覆うフェンダが備えられ、
    左右の前記フェンダに前記第4測距センサが取り付けられている請求項1から3のいずれか一項に記載の作業車。
JP2020173310A 2020-10-14 2020-10-14 作業車 Active JP7094337B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020173310A JP7094337B2 (ja) 2020-10-14 2020-10-14 作業車

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020173310A JP7094337B2 (ja) 2020-10-14 2020-10-14 作業車

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2017008346A Division JP6781055B2 (ja) 2017-01-20 2017-01-20 作業車

Publications (2)

Publication Number Publication Date
JP2021013381A true JP2021013381A (ja) 2021-02-12
JP7094337B2 JP7094337B2 (ja) 2022-07-01

Family

ID=74530215

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020173310A Active JP7094337B2 (ja) 2020-10-14 2020-10-14 作業車

Country Status (1)

Country Link
JP (1) JP7094337B2 (ja)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02114305A (ja) * 1988-10-25 1990-04-26 Komatsu Ltd 建設機械用障害物検出装置
JPH0994006A (ja) * 1995-09-29 1997-04-08 Matsushita Electric Ind Co Ltd 無人農作業装置
JP2000276232A (ja) * 1999-03-25 2000-10-06 Fuji Heavy Ind Ltd 自律走行作業車の障害物回避制御装置
US20040068352A1 (en) * 2002-10-03 2004-04-08 Deere & Company, A Delaware Corporation Method and system for determining an energy-efficient path of a machine
US20080122598A1 (en) * 2004-09-15 2008-05-29 Daimlerchrysler Ag Device For Predictively Detecting And Avoiding Collisions
JP6781055B2 (ja) * 2017-01-20 2020-11-04 株式会社クボタ 作業車

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02114305A (ja) * 1988-10-25 1990-04-26 Komatsu Ltd 建設機械用障害物検出装置
JPH0994006A (ja) * 1995-09-29 1997-04-08 Matsushita Electric Ind Co Ltd 無人農作業装置
JP2000276232A (ja) * 1999-03-25 2000-10-06 Fuji Heavy Ind Ltd 自律走行作業車の障害物回避制御装置
US20040068352A1 (en) * 2002-10-03 2004-04-08 Deere & Company, A Delaware Corporation Method and system for determining an energy-efficient path of a machine
US20080122598A1 (en) * 2004-09-15 2008-05-29 Daimlerchrysler Ag Device For Predictively Detecting And Avoiding Collisions
JP6781055B2 (ja) * 2017-01-20 2020-11-04 株式会社クボタ 作業車

Also Published As

Publication number Publication date
JP7094337B2 (ja) 2022-07-01

Similar Documents

Publication Publication Date Title
US11904851B2 (en) Work vehicle
JP6781055B2 (ja) 作業車
JP6680701B2 (ja) 作業車
JP6837902B2 (ja) 作業車
KR102443415B1 (ko) 작업차
JP6742928B2 (ja) 作業車
JP6669678B2 (ja) 作業車
JP6837903B2 (ja) 作業車
JP6804380B2 (ja) 作業車
JP6785671B2 (ja) 作業車
JP6781056B2 (ja) 作業車
JP7094337B2 (ja) 作業車
JP6873211B2 (ja) 作業車
JP7094338B2 (ja) 作業車
JP7058679B2 (ja) 作業車
JP7475295B2 (ja) 作業車
JP7168705B2 (ja) 作業車
JP6832716B2 (ja) 作業車
JP6972215B2 (ja) 作業車及び協調制御システム
JP6991285B2 (ja) 作業車

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20201112

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201120

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20211109

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220105

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220621

R150 Certificate of patent or registration of utility model

Ref document number: 7094337

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150