JP2004008053A

JP2004008053A - Agricultural work vehicle

Info

Publication number: JP2004008053A
Application number: JP2002164652A
Authority: JP
Inventors: Toshiki Minaishi; 南石　俊樹; Takashi Yamada; 山田　隆史; Akihiro Kubo; 久保　昭博; Kenji Monzen; 門前　健二; Kazuto Ando; 安藤　和登; Yuji Yamaguchi; 山口　雄司
Original assignee: Yanmar Agricultural Equipment Co Ltd; Yanmar Co Ltd
Current assignee: Yanmar Agricultural Equipment Co Ltd; Yanmar Co Ltd
Priority date: 2002-06-05
Filing date: 2002-06-05
Publication date: 2004-01-15
Anticipated expiration: 2022-06-05
Also published as: JP3814230B2

Abstract

【課題】例えば、水田で散布作業機を使用する場合、水田の中まで該散布作業車に乗って走行し、作業開始位置で停車させた後、オペレータは稲の植わった水田の中を歩いて畦まで戻ることにより圃場の外に退出しなければならず、オペレータの負担となっていた。
【解決手段】ＧＰＳユニット１０２の移動局ユニット１０３と、内界センサ１２２と、株倣いセンサ１２３とを搭載し、自律走行開始地点（作業車進入地点１２７）と作業開始地点１２８とを異なる場所に設定可能に農業用作業車１０１を構成した。
【選択図】　　　　図６For example, when using a spraying machine in a paddy field, the operator travels on the spraying work vehicle into the paddy field, stops at a work start position, and then walks in the paddy field where rice is planted. By returning to the ridge, it was necessary to exit the field, which was a burden on the operator.
A mobile station unit of a GPS unit, an inner field sensor, and a stock copy sensor are mounted, and an autonomous traveling start point (work vehicle approaching point) and a work start point are located in different places. The agricultural work vehicle 101 is configured to be settable.
[Selection] Fig. 6

Description

【０００１】
【発明の属する技術分野】
本発明は、ＧＰＳ（グローバル・ポジショニング・システム）と、方位センサや傾斜センサ、車速センサなどの内界センサと、株倣いセンサとを搭載し、自律的に作業を行う農業用作業車の走行作業管理の技術に関する。
詳細には、ＧＰＳにより、対象となる圃場と農業用作業車との位置関係を計測し、その計測情報を基に圃場の内部から自律走行を開始する技術に関する。
【０００２】
【従来の技術】
従来から、既に作物が植わっている圃場において、ＧＰＳやセンサ類を備え、自律的に走行・作業を行う農業用作業車が知られている。該農業用作業車の例としては、耕耘装置を備えたトラクタや、散布機を搭載した散布作業機などが挙げられる。このような農業用作業車は、圃場内の作業開始地点まではオペレータが農業用作業車を運転する。そして、オペレータは作業開始地点に到達後、該作業車から降りて圃場の外に退出し、作業車は自律走行・作業を開始する。
【０００３】
【発明が解決しようとする課題】
例えば、水田で前述の農業用作業車の一形態である散布作業機を使用する場合、水田の中まで散布作業車に乗って走行し、作業開始位置で停車させた後、オペレータは稲の植わった水田の中を歩いて畦まで戻ることにより圃場の外に退出しなければならず、オペレータの負担となっていた。
【０００４】
【課題を解決するための手段】
本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段を説明する。
【０００５】
即ち、請求項１においては、ＧＰＳと、内界センサとを搭載し、自律的に作業を行う農業用作業車であって、
自律走行開始地点と作業開始地点とを異なる場所に設定可能とするものである。
【０００６】
請求項２においては、自律走行開始地点から作業開始地点までの走行経路を自動的に生成し、該走行経路に沿って自律走行するものである。
【０００７】
請求項３においては、前記作業開始地点まで自律走行後、続けて作業を開始するものである。
【０００８】
【発明の実施の形態】
次に、発明の実施の形態を説明する。
図１は本発明の農業用作業車の一実施例である散布作業機の側面図、図２は本発明の農業用作業車の一実施例である散布作業機の平面図、図３は本発明における自律走行システムの模式図、図４は移動局ユニットを示す図、図５は基準局ユニットを示す図、図６は本発明の農業用作業車による自律走行経路を示す模式図、図７は従来の農業用作業車による自律走行経路を示す模式図、図８は本発明における自律走行のフローチャート図、図９は圃場内のスリップ率分布を示す図、図１０は本発明における異常検出のフローチャート図、図１１は自律走行途中で薬剤を補充する場合の自律誘導経路を示す模式図、図１２はステアリング制御に係る自律操作手段を示す模式図、図１３はステアリング制御方法の実施例を示す模式図、図１４はアクセルアクチュエータの連結方法を示す模式図である。
【０００９】
まず、本発明に係る農業用作業車の実施の一形態である散布作業機１０１について、図１および図２を用いて説明する。なお、本発明は本実施例の散布作業機に限定されるものではなく、圃場表面を走査しつつ作業を行う農業作業車に適用可能である。
散布作業機１０１は乗用型の走行機体２２と、薬液を散布するための複数のノズル２３・２３・・・を有するブーム４０と、該ブーム４０の昇降や展開を行うための機構よりなるブーム駆動部３５と、エンジン９から動力を得て薬液タンク２４内の薬液をノズル２３・２３・・・へ圧送する噴霧ポンプ４及び該噴霧ポンプ４から吐出される薬液の制御に関わる散布量制御装置３等よりなるポンプ部３６等で構成される。なお、本実施例では、ブーム駆動部３５は走行機体２２の前部及び側部に配設され、ポンプ部３６は後部に配設されている。
走行機体２２の機体前端より後方へ向けて、左右一対の機体フレーム６Ｌ・６Ｒが平行に水平方向に延設されている。該機体フレーム６Ｌ・６Ｒの前部下方には前車輪７・７が支承され、後部下方に後車輪８・８が支承されている。
【００１０】
また、走行機体２２前部の機体フレーム６Ｌ・６Ｒ上にはエンジン９を被覆するボンネット１０が配設されている。該ボンネット１０後方のカバー上に操作パネル１１が設けられており、該操作パネル１１の上方には運転ハンドル１２が設けられて、操作パネル１１及び運転ハンドル１２等で散布作業機１０１の操縦部を構成している。前記操作パネル１１下方より後方に向けて、機体フレーム６Ｌ・６Ｒ上にはステップ１３を設けている。また機体フレーム６Ｌ・６Ｒ後部上には薬液タンク２４が配設されており、該薬液タンク２４の前部中央には運転席１４が形成されて、該薬液タンク２４によって側部と後部を取り囲まれるように載置されている。
また、散布作業機１０１のフレームの各構成部材である機体フレーム６Ｌ・６Ｒ、サブフレーム５２Ｌ・５２Ｒは夫々中空の四角または丸型のパイプまたはＬ型やＨ型等の鋼材を用いて、軽量かつ高剛性に構成されている。
【００１１】
前記ブーム駆動部３５は、薬液散布用のブーム４０と、昇降リンク機構３７とから構成される。ブーム４０は走行機体２２の前方の前方ブーム４１及び、該前方ブーム４１の両端に枢支して、折畳み可能に側方に延設される左右の側方ブーム４２Ｌ・４２Ｒから構成されている。そして、該ブーム４０には薬液を散布するための複数のノズル２３・２３・・・が一定間隔をおいて配設されている。
前記前方ブーム４１と側方ブーム４２Ｌ・４２Ｒの間には、それぞれシリンダ４３・４３が介装され、該シリンダ４３・４３を伸縮させることによって、側方ブーム４２Ｌ・４２Ｒを左右水平方向へ延設した作業位置と、前後方向で後ろ上がりに位置させた収納位置に回動可能としている。
【００１２】
また、昇降リンク機構３７は平行リンクにより前方ブーム４１と機体フレーム６Ｌ・６Ｒの前部の間を連結し、該平行リンクの一方と機体フレーム６Ｌ・６Ｒの間にシリンダ３８・３８を介装して、該シリンダ３８・３８を伸縮させることによってブーム４０を上下昇降可能としている。
そして、前方ブーム４１の左右中央が昇降リンク機構３７に対して枢支されて左右傾倒可能に支持され、該前方ブーム４１と昇降リンク機構３７の間にシリンダ３９を介装して、ブーム４０を水平制御する構成としている。
【００１３】
ポンプ部３６は、走行機体２２の後部に延設したサブフレーム５２Ｌ・５２Ｒ上に支持部材を介して噴霧ポンプ４のクランク軸が機体前後方向に位置するよう配設されている。ポンプ部３６は主に噴霧ポンプ４及び散布量制御装置３より構成され、該噴霧ポンプ４のクランクケース２６の右上部に図示せぬエアチャンバや安全弁等が設けられている。そして、散布量制御装置３は図示せぬ流量制御弁及び該流量制御弁の開閉に関わるモータ等より構成される。
【００１４】
次に、本発明の農業用作業車におけるＧＰＳについて説明する。
ＧＰＳ（グローバル・ポジショニング・システム）とは、元来航空機・船舶等の航法支援用として開発されたシステムであって、上空約二万キロメートルを周回する二十四個のＧＰＳ衛星（六軌道面に四個ずつ配置）、ＧＰＳ衛星の追跡と管制を行う管制局、測位を行うための利用者の受信機で構成される。
ＧＰＳを用いた測量方法としては、単独側位、相対側位、ＤＧＰＳ（ディファレンシャルＧＰＳ）側位、ＲＴＫ−ＧＰＳ（リアルタイムキネマティック−ＧＰＳ）側位など種々の方法が挙げられる。
【００１５】
単独側位とは、ＧＰＳ衛星から送信される衛星の位置や時刻などの情報を一台のアンテナで受信する方法である。衛星から電波が発信されてから受信機に到達するまでに要した時間を測り、該時間と電波の速度から距離を求める
このとき、位置の判っているＧＰＳ衛星を動く基準点とし、四個以上の衛星から観測点までの距離を同時に知ることにより観測点の位置を決定する。
【００１６】
相対側位とは、二台以上の受信機を使い、同時に四個以上の同じＧＰＳ衛星を観測する方法であり、ＧＰＳ衛星の位置を基準として、ＧＰＳ衛星からの電波信号それぞれの受信機に到達する時間差（電波の位相差）を測定して、二点（二台の受信機）間の相対的な位置関係を求める。
各測定点で同じ衛星の電波を受信し、衛星から発射された電波が同じような気象条件の中を通過してくることから、二点（二台の受信機）間の観測値の差を取ることにより、観測値に含まれる衛星の位置誤差や対流圏・電離層遅延量などの誤差を解消することができる。
【００１７】
ＤＧＰＳ（ディファレンシャルＧＰＳ）側位、ＲＴＫ−ＧＰＳ（リアルタイムキネマティック−ＧＰＳ）側位は、位置が判っている基準局と、位置を求めようとする観測点とで同時にＧＰＳ観測を行い、基準局で観測したデータを無線等の方法で観測点にリアルタイムで送信し、基準局の位置成果に基づいて観測点の位置をリアルタイムに求める方法である。
ＤＧＰＳ（ディファレンシャルＧＰＳ）側位は、基準局と観測点の両点で単独側位を行い、基準局において位置成果と観測された座標値の差を求め、観測点に補正情報として送信する。
ＲＴＫ−ＧＰＳ（リアルタイムキネマティック−ＧＰＳ）側位は、基準局と観測点の両点で位相の測定（相対側位）を行い、基準局で観測した位相データを観測点に送信する、
観測点のＧＰＳ受信機では、受信データと基準局から送信されたデータとをリアルタイムで解析することにより、観測点の位置を決定する。
【００１８】
本発明においては、測定精度の高いＲＴＫ−ＧＰＳ側位方式が採用されているが、前記他の方式を用いてもよく、限定されない。
【００１９】
図３に示すように、本発明におけるＧＰＳユニット１０２は、主に、散布作業機１０１本体に搭載される移動局ユニット１０３と、水田などの圃場の近くに設置される基準局側ユニット１０４からなる。該基準局ユニット１０４は地面に固定された基準局の役割を果たし、移動局側ユニット１０３は位置を求めようとする移動局（観測点）として機能する。
図４に示すように、散布作業機１０１本体上面の運転席１４の後部から正面視門型のフレーム１０５が立設されている。フレーム１０５の横架部１０５ａおよび立設部１０５ｂ・１０５ｂで囲まれる部分には収納部１０６が設けられ、該収納部１０６に移動局ユニット１０３の内、ＧＰＳアンテナ１０８を除く部材が収納される。ＧＰＳアンテナ１０８はフレーム１０５の横架部１０５ａ上面に固設される。
【００２０】
移動局ユニット１０３は、ＧＰＳアンテナ１０８の他、ＧＰＳ受信部１０９、ＣＰＵやＲＡＭやＲＯＭ等を備える制御手段となる処理部１１０、操作部１１１、表示部１１２、無線部１１３などで構成される。
ＧＰＳアンテナ１０８で受信されたＧＰＳ衛星からの電波信号は、ケーブルでＧＰＳ受信部１０９を経て処理部１１０に送信される。操作部１１１は後述する自律走行の設定や、ＧＰＳの初期設定などを行うためのインターフェースであり、処理部１１０にケーブル接続されている。表示部１１２は処理部１１０にケーブル接続されており、処理部１１０におけるデータ処理の状況や、操作部１１１により入力された各種設定を表示する。無線部１１３は基準局ユニット１０４およびオペレータが携帯する無線操作手段１３３と、移動局ユニット１０３とが無線交信するためのものである。また、無線操作手段１３３からの制御信号を受信し、該無線操作手段１３３からの作動確認信号が途絶えたときは散布作業機１０１の自律走行を停止させるための受信部１０７が設けられている。
なお、本実施例においては移動局ユニット１０３をフレーム１０５に固設しているが、例えばＧＰＳアンテナ１０８以外の移動局ユニット１０３を構成する他の部材はボンネット９に収納し、運転席１４の前に位置する操縦部の操作パネル１１に、操作部１１１および表示部１１２を組み込む構成としても良い。
また、操作部１１１はキーボードやスイッチ、レバー、押しボタン、ダイアルなどオペレータが操作可能であればよく、その形式は限定されない。さらに、操作部１１１と表示部１１２をタッチパネルとし、一体化してもよい。
また、処理部１１０、操作部１１１および表示部１１２として、既存のパソコンを使用してもよい。
【００２１】
基準局ユニット１０４も移動局ユニット１０３と略同じ構成であり、ＧＰＳアンテナ１１４、ＧＰＳ受信部１１５、処理部１１６、操作部１１７、表示部１１８、無線部１１９などで構成される。
【００２２】
図５に示すように、ＧＰＳアンテナ１１４は支柱１１４ａにより地面より立設される。基準局ユニット１０４を構成するＧＰＳアンテナ１１４以外の部材は筐体１２０に収納可能に構成される。
なお、基準局ユニット１０４は本発明の散布作業機１０１を使用する圃場の近傍に常設してもよく、あるいは使用後撤去可能な構成としても良い。
【００２３】
次に、本発明の散布作業機１０１における自律走行システムについて、図３を用いて説明する。該自律走行システムは、前述のＧＰＳユニット１０２の他、自律走行プログラム１２１や、散布作業機１０１の種々の情報を検出する内界センサ１２２、株倣いセンサ１２３、自律走行・作業をするための自律操作手段１２４などからなる。
【００２４】
ある時刻に発信されたＧＰＳ衛星１２５からの電波信号は、散布作業機１０１に設けられた移動局ユニット１０３のＧＰＳアンテナ１０８により受信され、ＧＰＳ受信部１０９を経て処理部１１０に送信される。
【００２５】
一方、前記ＧＰＳ衛星１２５から同時刻に発信された電波信号は、圃場付近に設置された基準局ユニット１０４のＧＰＳアンテナ１１４によっても受信され、ＧＰＳ受信部１１５を経て処理部１１６に送信される。さらに、無線部１１９から無線部１１３を経て処理部１１０に無線送信される。
【００２６】
処理部１１０では、前記基準局ユニット１０４において受信された電波信号と、移動局ユニット１０３において受信された電波信号とを比較対照し、同時刻に発信された電波信号がＧＰＳアンテナ１０８およびＧＰＳアンテナ１１４で受信されたときの位相差や、複数の衛星からの電波信号情報に基づき、移動局ユニット１０３と基準局ユニット１０４との相対位置を計算し、移動局ユニット１０３の位置計算を行う。上記の計算は処理部１１０に格納された自律走行プログラム１２１により行われる。
【００２７】
このように構成することにより、散布作業機１０１と基準局ユニット１０４との三次元の相対位置、すなわち、圃場内における散布作業機１０１の位置（高さ方向のデータを含む）を高精度かつリアルタイムで測定可能である。
【００２８】
内界センサ１２２は、速度、姿勢、エンジン回転数、ステアリングの操舵角など、散布作業機１０１を自律走行させる上で必要な情報を検知するためのセンサ類を指す。より具体的には、エンジン回転数センサ、車速センサ、操舵角センサ、方位センサ、ロール傾斜センサ、ピッチ傾斜センサなどである。これら内界センサ１２２からの検知信号は、処理部１１０に送信される。なお、本実施例においては、内界センサ１２２のうち、方位センサ、ロール傾斜センサ、ピッチ傾斜センサなどは移動局ユニット１０３と同じ収納部１０６内に配設されているが、これらのセンサ類の配設位置については特に限定されない。
【００２９】
株倣いセンサ１２３は、散布作業機１０１の機体前部下面に配設される。株倣いセンサ１２３は散布作業機１０１が作物を車輪で踏んだりしないように、圃場に所定の間隔を空けて植わっている作物を検知し、該散布作業機１０１の走行方向を制御するために用いられる。株倣いセンサ１２３からの検知信号も処理部１１０に送信される。
【００３０】
内界センサ１２２、株倣いセンサ１２３からの検知信号、およびＧＰＳユニット１０２による散布作業機１０１の位置情報に基づき、処理部１１０内に格納された自律走行プログラム１２１によって散布作業機１０１の速度、姿勢、エンジン回転数、ステアリングの操舵角などを自律操作するための信号が自律操作手段１２４に送信される。該自律操作手段１２４は、より具体的には、ステアリング駆動アクチュエータやステアリング駆動電磁弁（図示せず）、ブーム昇降用パワーシリンダ（シリンダ３８に相当）、ブーム開閉用パワーシリンダ（シリンダ４３に相当）、ブーム水平制御用パワーシリンダ（シリンダ３９に相当）、アクセルアクチュエータ、主クラッチ用アクチュエータなどである。
なお、本実施例においては、ＧＰＳユニット１０２から得られる散布作業機１０１の位置情報は高さ方向に対しても高い精度を持つ。そのため、自律作業中に圃場からブームまでの高さが略一定となるようシリンダ３８を制御し、薬剤の散布状態を一定にすることが可能である。
【００３１】
無線操作手段１３３はオペレータが携帯し、散布作業車１０１から離れた位置から各種の操作をおこなうためのものである。より具体的には、後で詳述する散布作業車１０１の自律走行の開始・停止、エンジンの停止、側方ブーム４２Ｌ・４２Ｒの開閉、ブーム４０の昇降などを該無線操作手段１３３で操作可能に構成される。
【００３２】
続いて、本発明の要部である散布作業の実施方法を図６から図８を用いて説明する。
例えば図６や図７に示すような平面視長方形の圃場である水田１２６で散布作業を行う場合、水田１２６内に均一に（言い換えれば、一度も散布されていない場所や複数回散布される場所が極力発生しないように）薬剤を散布するためには、散布作業を行う散布作業機１０１が側方ブーム４２Ｌ・４２Ｒを車体側方に伸ばした時の横幅（以後「作業幅」と呼ぶ。１０メートル程度）と略同じ幅を持つ水田１２６の外縁部１２６ａ（図６および図７における斜線部）を残し、外縁部の内側に位置する作業開始地点１２８（または作業開始地点１３１）から散布作業を開始する。最後に外縁部を一周しながら散布作業して作業終了地点１２９（または作業終了地点１３２）から散布作業機１０１が水田１２６の外に退出する。すなわち、図６および図７において実線および点線で示された経路に沿って散布作業機１０１が走行しつつ、散布作業を行うのである。
このとき、図６および図７において示される散布作業機１０１の走行経路のうち、実線で示された部分は薬液散布作業を行いつつ走行することを示し、点線で示された部分は薬液散布作業を行わずに走行することを示している。
【００３３】
本発明の散布作業機１０１における散布作業の場合、図６および図８に示すように、水田１２６端部の任意の地点である作業車進入地点１２７までオペレータが散布作業機１０１を運転し、作業車進入地点１２７で停車させて散布作業機１０１から降りる。なお、圃場の最外周の位置（水田１２６の形状）は予め処理部１１０に記憶させている。また、予め水田毎の作業経路データを作成しておき、処理部１１０に記憶しておく。次に、オペレータは携帯している無線操作手段１３３により、散布作業機１０１の自律走行を開始させる（自律走行開始ボタンを押す）。
散布作業機１０１は処理部１１０内に格納されている自律走行プログラム１２１により、水田１２６の形状に関する情報および作業経路データを基に作業車進入地点１２７から作業開始地点１２８まで自律走行し、その後停車することなく薬剤散布作業を開始し、ＧＰＳユニット１０２による位置情報を基に自律走行を続ける。最後に作業終了地点１２９まで到達すると、散布作業機１０１は自動的に自律走行を終了し、停車する。
【００３４】
一方、従来の散布作業機における散布作業の場合、図７に示すように、水田１２６端部の任意の地点である作業車進入地点１３０を経て作業開始地点１３１までオペレータが散布作業機を運転する。オペレータは、散布作業機に搭載され、現在の散布作業機の位置と、予め自動作成された作業経路の作業開始地点が表示されるモニタを見ながら作業開始地点１３１まで誘導・停車させた後、散布作業機１０１から降りる。そして、作物が植わり、ぬかるんだ水田１２６内を歩いて退出する。次に、オペレータは携帯している無線操作手段により、散布作業機の自律走行を開始させる。従来の散布作業機は作業直前に水田１２６の外縁部１２６ａを周回し、ＧＰＳユニットから得られた水田１２６の形状を処理部に記憶し、自律走行プログラムにより、水田１２６の形状に関する情報を基に作業経路を自動作成しておくか、予め水田毎の作業経路データを作成しておき、処理部に記憶しておく。
散布作業機１０１はＧＰＳユニットによる位置情報を基に薬剤散布作業・自律走行を開始する。最後に作業終了地点１３２まで到達すると、従来の散布作業機は自動的に自律走行を終了し、停車する。
【００３５】
以上の如く、本発明の農業作業車である散布作業機１０１は、次のような利点を有する。
【００３６】
第一に、本発明の散布作業機１０１は、圃場である水田１２６の外縁部より自律走行を開始可能に構成されている。すなわち、自律走行を開始する地点（本実施例においては作業車進入地点）と作業開始地点とを異なる場所に設定可能とした。一方、従来の散布作業機は自律走行可能であるものの、自律走行開始地点と作業開始地点が同一であるため、オペレータは圃場（本実施例では水田１２６）内を歩いて退出しなければならなかった。
従って、オペレータは圃場の外縁部まで散布作業機を運転するだけで良く、オペレータが圃場端部から作業幅（１０メートル）程度中に入った位置にある作業開始地点まで散布作業機を乗り入れ、圃場を歩いて退出するという作業を省略することが可能であり、作業性に優れる。
【００３７】
第二に、本発明の散布作業機１０１は、水田１２６の外縁部に位置する自律走行開始地点（本実施例においては作業車進入地点）から作業開始地点までの作業車誘導経路を自動作成し、自律走行開始と同時に作業開始地点まで自律走行する。このとき高精度のＧＰＳユニットにより誘導されるため、作業開始地点到達時の散布作業車の位置精度は非常に高い。
一方、従来の散布作業機では、手動で運転しつつ、モニタを見ながら作業開始地点に正確に停車させるのは容易ではなかった。特に、水田の場合、散布作業機と水田の稲穂との条合わせも合わせて行わねばならず、煩雑な作業であった。
このように、オペレータが圃場内の作業開始地点まで作業機を乗り入れ、作業開始地点に精度良く停車させ、圃場を歩いて退出するという煩雑な作業を省略することが可能であり、作業性に優れる。特に、作業開始時点における散布作業車の位置精度、作業経路への追従性が向上する。
さらに、作業開始地点への進入方向を作業開始時の走行方向に略一致するように作業車誘導経路を作成するべく自律走行プログラムを構成しておくとさらに作業性が良い。
【００３８】
第三に、作業開始地点に到達後、停車せずに続けて作業開始可能であり、作業の迅速化に寄与する。
【００３９】
本発明においては、自律走行時にはＧＰＳユニット１０２により散布作業機１０１の圃場内の位置を測定している。そのため、例えば、散布作業機１０１の車軸に回転数を検知するセンサを設け、該センサによる車軸回転数から予測される散布作業機１０１の走行距離（予想走行距離）と、ＧＰＳユニット１０２より得られる散布作業機１０１の実際の走行距離（実走行距離）とを比較することにより、現在散布作業機１０１が通過する場所における走行スリップ率を計算することが可能である。
走行スリップ率は以下の式で表される。
走行スリップ率（％）＝｛１−（実走行距離）／（予想走行距離）｝×１００
また、該走行スリップ率と、ＧＰＳユニット１０２より得られる散布作業機１０１の位置情報とを組み合わせることにより、当該圃場における軟弱地盤の分布を把握することが可能である。
このように、圃場における軟弱地盤の分布を把握することにより、例えば、軟弱地盤部分を通過するときには実走行速度が遅くなるため散布量を抑えたりして、散布作業の安定化を図ることが可能である。また、圃場における軟弱地盤の分布データを処理部１１０に記憶しておき、圃場整備のためのデータとして活用することも可能である。
例えば図９に示すように、前述した水田１２６の形状データの上に、走行スリップ率の分布を重ね合わせることにより、圃場の軟弱地盤分布情報を容易に得ることが可能である。図９に示すデータは、散布作業機１１０の表示部１１２、基準局ユニット１０４の表示部１１８に表示することが可能である。また該データを外部出力することも可能であり、耕耘作業や植付作業や収穫作業等にも適用できる。
さらに、前記スリップ率が極度に大きい（予想走行距離に比べて実走行距離が極端に小さい）場合は、散布作業機１０１が圃場に車輪をとられて走行不能になったものとみなして、救助信号を発する（散布作業機１０１に取り付けられたブザーやランプが作動する、あるいは無線操作手段１３３に設けられたブザーやバイブレータ、ランプが作動するなど）ことも可能である。
【００４０】
次に、散布作業機１０１が自律走行時に何らかの異常を検出した場合の散布作業機１０１の動作フローについて説明する。
図１０に示すように、エンジン系統のトラブルの場合、直ちに散布作業機１０１のエンジンを停止させ、異常表示または無線通信（散布作業機１０１に取り付けられたブザーやランプが作動する、あるいは無線操作手段１３３に設けられたブザーやバイブレータ、ランプが作動するなど）を行う。
作業機（本実施例においては散布機）系統のトラブルの場合、該作業機を停止させ、異常表示または無線通信（散布作業機１０１に取り付けられたブザーやランプが作動する、あるいは無線操作手段１３３に設けられたブザーやバイブレータ、ランプが作動するなど）を行う。このとき、エンジン系統やステアリング系統にトラブルがなければ、緊急の自動走行経路を作成し、圃場の端部まで自律走行させるように自律走行プログラム１２１を構成しても良い。
このように構成することにより、オペレータは自律走行中における散布作業機１０１の異常を離れた位置からでも容易に検知することが可能である。また、異常が検知された時点で異常箇所を停止させるので、散布作業機１０１の異常箇所を作動させ続けることによる装置の破損などを防止することが可能である。また、エンジントラブルなどやむを得ない場合を除いて、圃場内にオペレータが入らずとも散布作業機１０１を水田１２６の外縁部１２６ａまで誘導可能であり、作業性に優れる。
【００４１】
また、前記異常検出の方法と関連して、散布作業機１０１の薬液タンク２４内にレベルスイッチ（レベルセンサ、液面センサ等）を設け、薬液タンク２４内の薬液残量が少なくなったり、なくなったことを検知することも可能である。
さらに、図１１に示すように、該レベルスイッチが作動した時の散布作業機１０１の位置１３４（以後、散布作業中断地点１３４という）を処理部１１０に記憶させると共に、散布作業中断地点１３４と、圃場端部１３５間の誘導経路を自動作成し、該誘導経路に沿って散布作業機１０１が圃場端部１３５まで自律走行で戻ってきたら薬液タンク２４に薬液を補充し、再び前記誘導経路に沿って散布作業中断地点１３４まで自律走行し、自律的に散布作業を再開する（散布作業中断以前の作業経路に復帰する）ように自律走行プログラム１２１を構成することも可能である。
このように構成することにより、自律走行プログラム１２１により薬液散布が中断された地点が記憶されているため、自律走行により散布作業を行っている途中で薬液が無くなっても、同一地点に複数回散布したり、一度も散布しない地点を残すことなく薬液散布を再開することが可能である、また、前記薬液タンク２４のレベルスイッチを薬液が無くなる時点ではなく、薬液が少量残っている状態で作動するよう構成しても良い。この場合、散布作業機１０１は薬液切れを起こすことなく早めに薬液を補充しながら散布作業を行うことが可能である。
また、圃場端部１３５の位置を、水田１２６端部の任意の位置に設定可能とする、あるいは作業車進入地点１２７と一致させるように自律走行プログラム１２１を構成しても良い。
【００４２】
続いて、自律走行時のステアリング制御について、図１２を用いて説明する。
前述したように、本発明の農業用作業車の一実施例である散布作業機１０１においては、自律走行時には内界センサ１２２、株倣いセンサ１２３、ＧＰＳユニット１０２からの各種検知信号、位置情報等に基づき、処理部１１０が自律操作手段１２４を作動させて、作業経路に沿って走行するとともに、散布作業を行う。
このとき、自律操作手段１２４の内、ステアリングに関するものとしては、ステアリング駆動アクチュエータである油圧モータ１３６、ステアリング駆動電磁弁１３７などが挙げられる。
【００４３】
図１２に示すように、運転ハンドル１２はハンドルシャフト１３８の上端に設けられている。該ハンドルシャフト１３８の下端とシャフト１３９の上端とはユニバーサルジョイント１４０により連結されている。該シャフト１３９下端とシャフト１４１上端との間にはトルクジェネレータ１４２が設けられ、運転ハンドル１２を操作する回動力が小さくてもシャフト１４１を容易に回動可能に構成される。シャフト１４１は図示せぬステアリング機構に連結されており、運転ハンドル１２の左右の回動操作によって散布作業車１０１の操舵を行う。
【００４４】
一方、自律走行時は自律走行プログラム１２１によりステアリング機構を作動させる必要がある。本実施例においてはハンドルシャフト１３８の中途部にスプロケット１４３が設けられ、油圧モータ１３６の出力軸に設けられたスプロケット１４４との間はチェーン１４５が巻回される。油圧モータ１３６には油圧配管１４６・１４７の一端が接続され、油圧配管１４６・１４７の他端はステアリング駆動電磁弁１３７と接続される。そして、油圧配管１４６・１４７の中途部において両油圧配管をバイパスするバイパス配管１４８が設けられ、該バイパス配管１４８の中途部にバルブ１４９が配設される。
ステアリング駆動電磁弁１３７は図示せぬ油圧ポンプから送られてきた作動油を油圧配管１４６、油圧モータ１３６、油圧配管１４７の順に送った後作動油タンクに戻す、油圧配管１４７、油圧モータ１３６、油圧配管１４６の順に送った後作動油タンクに戻す、あるいはステアリング駆動電磁弁１３７側の油圧配管１４６・１４７端部を閉塞する、という三つの油圧回路を自律走行プログラム１２１らの指令により選択可能に構成されており、左右の操舵と、ある操舵角でのステアリング機構の固定が可能である。なお、自律走行時にはバルブ１４９は閉じられており、手動走行時にはバルブ１４９は開けられ運転ハンドル１２を自在に操作できる。
【００４５】
このように構成することは、以下の如き利点を有する。
【００４６】
第一に、ステアリング駆動アクチュエータとして油圧モータ１３６を用いることにより、自律操作手段１２４のうち、ステアリング制御に関わる部位のサイズを小さくし、コンパクトに配置することが可能である。
【００４７】
第二に、ステアリング機構から油圧モータ１３６までの動力伝達経路の間にトルクジェネレータ１４２が配置される構成としたので、油圧モータ１３６にトルクの大きいものを使用する必要がない。
【００４８】
第三に、トルクジェネレータ１４２の入力軸、すなわちシャフト１４０の回転数が追従回転数以下となるように、油圧モータ１３６からの回転駆動力を伝達する必要がある。本実施例では、油圧モータ１３６からシャフト１４０までの動力伝達経路にスプロケット１４３・１４４およびチェーン１４５が介装されており、該スプロケット１４３・１４４を適宜選択すれば、容易にシャフト１４０の回転数が追従回転数以下となるように設定可能である。
【００４９】
第四に、油圧モータ１３６とステアリング駆動電磁弁１３７とを接続する油圧配管１４６・１４７の中途部にバイパス回路（バイパス配管１４８およびバルブ１４９）を設けたので、複雑な機構を用いることなく油圧モータ１３６の油圧回路をオープンにすることが可能である。これにより手動時の駆動アクチュエータに起因する回動抵抗を小さくし、手動で容易に回動可能とするとともに、破損防止にも寄与する。
なお、バルブ１４９は、手動により開閉させる構成としてもよく、あるいは自律走行時にはバルブ１４９が閉じ、手動時にはバルブ１４９が開くように自律走行プログラム１２１により操作するよう構成しても良い。また、本実施例のステアリング駆動電磁弁１３７は油圧モータ１３６の正・逆転および油圧モータ１３６の油圧回路両端の閉塞をおこなうものであるが、該ステアリング駆動電磁弁１３７内に油圧モータ１３６の油圧回路をオープンにする油圧経路を設け、前記バイパス配管１４８およびバルブ１４９を省略する構成としても良い。
但し、電磁バルブや油圧モータを用いる代わりに電動モータを用いて制御することもできる。
【００５０】
次に、ステアリング制御方法について、図１３を用いて説明する。
前述したように、自律走行時のステアリング操舵を油圧モータ１３６で行い、油圧モータ１３６からシャフト１４０までの動力伝達経路にスプロケット１４３・１４４およびチェーン１４５を介装することは、油圧モータ１３６とトルクジェネレータ１４２の回転数の関係を調整する上で有効である。その反面、チェーン１４５とスプロケット１４３・１４４との間でガタが大きく、自律走行中に自律走行プログラム１２１により操舵角を変更する指令が出されてから、実際に操舵角が変化するまでの間にタイムラグが発生するという問題がある。このようなタイムラグが大きいと、自律走行プログラム１２１により自動作成された自律走行経路への追従性に影響をおよぼす可能性がある。
そこで、本発明においては、現在の散布作業機１０１（図１２においては、散布作業機１０１ａで表される）の目標軌道、すなわち自律走行プログラム１２１により作成された走行経路との距離偏差（Δｄ）および方位偏差（Δｄｉｒｅ）を、それぞれＧＰＳユニット１０２および内界センサ１２２の一つである方位センサからの情報を基に求めると共に、前記タイムラグに相当する時間ｔ経過後の散布作業機１０１（図１２においては、散布作業機１０１ｂで表される）の位置、方位を予測し、目標軌道との距離偏差（Δｆｄ）および方位偏差（Δｆｄｉｒｅ）を計算する。
これらΔｄ、Δｄｉｒｅ、Δｆｄ、Δｆｄｉｒｅを用いて、目標制御ステアリング角度（θｔａｒｇｅｔ）を計算により求め、ＰＩＤ制御を行うように自律走行プログラム１２１を構成した。
【００５１】
以下に本実施例の散布作業機１０１におけるステアリング制御方法の例を示す。なお図１３において、角度は反時計回りを正とする。
目標制御ステアリング角度（θｔａｒｇｅｔ）は下記の（式１）で表される。
θｔａｒｇｅｔ＝−Δｄｉｒｅ−Δａｄｄｉｒｅ　（式１）
ここで、Δａｄｄｉｒｅ（以下、追加制御角度とよぶ）は時間ｔ経過後の予想位置における散布作業機１０１のステアリング中心点１５１ｂと目標地点１５２との成す角度である。該Δａｄｄｉｒｅは下記の（式２）で表される。
Δａｄｄｉｒｅ＝Ａｒｃｔａｎ（Δｆｄ／Ｍｄ）　（式２）
ここで、式２中のＭｄ（図１３に図示）は目標復帰長さであり、予め設定しておく既知の値である。Δｆｄは、前述した時間ｔ経過後の散布作業機１０１の位置から計算により求められる目標軌道との距離偏差である。該Δｆｄは下記の（式３）で表される。
Δｆｄ＝Δｄ＋Ｖ×ｔ×ｓｉｎ（Δｆｄｉｒｅ）　（式３）
ここで、Ｖは散布作業機１０１の走行速度であり、内界センサ１２２の一つである車速センサにより計測される。Δｆｄｉｒｅは、前述した時間ｔ経過後の散布作業機１０１の方位と、目標軌道１５０との成す角度を計算により求めた方位偏差である。該Δｆｄｉｒｅは下記の（式４）または（式５）で表される。
Δｆｄｉｒｅ＝Δｄｉｒｅ＋Ｖ×ｔ×ｔａｎ（２×φ）／（Ｌ×ｃｏｓφ）（式４）
Δｆｄｉｒｅ＝Δｄｉｒｅ＋Ｖ×ｔ×ｔａｎφ／Ｌ　　　　　　（式５）
ここで、φは現在の操舵角であり、内界センサ１２２の一つである操舵角センサにより計測される。また、Ｌはホイルベースを表す。
なお、式４は本実施例の散布作業機１０１のように四輪操舵機構を採用している場合に用いられる式であり、式５は例えばトラクタなどのように前輪操舵機構を採用している場合に用いられる式である。
【００５２】
以上の式１から式４を用いて、または式１から式３と式５を用いて、目標制御ステアリング角度（θｔａｒｇｅｔ）が計算される。そして、該θｔａｒｇｅｔを自律走行時のステアリング制御に用いることにより、ステアリング装置全体のガタに起因するタイムラグを加味したステアリング制御を行うこととなり、自律走行時の走行経路に対する追従性が向上する。
【００５３】
次に、手動運転時に用いられる可動部と自律走行時に用いられる駆動アクチュエータとの連結部の構成について図１４を用いて説明する。
【００５４】
前述したように、ステアリング駆動アクチュエータである油圧モータ１３６の場合は油圧モータ１３６の油圧配管１４６・１４７間にバイパス回路を設けることにより、手動時における駆動アクチュエータの破損防止および負荷軽減を行った。しかし、本発明の作業散布機１０１にはこの他にも自律操作手段１２４として種々のアクチュエータが存在する。これらについても、手動時における破損防止および負荷軽減を行う必要がある。
【００５５】
エンジン回転数を制御するアクセルペダル１５２の場合、図１４に示すように手動運転時にはオペレータが足で踏むことにより、回動支点１５３を中心に下方に回動する。また足をアクセルペダル１５２から離すと、図示せぬ付勢手段により、アクセルペダル１５２は上方に回動するよう構成されている。
【００５６】
一方、自律操作手段１２４の一つであり、自律走行時にエンジン回転数を制御するアクセルアクチュエータである油圧シリンダ１５４には、シリンダロッド１５４ａの先端に、長孔１５５が穿設された取り付け部材１５６が配設されている。そして、アクセルペダル１５２より略下方に突設されたステー１５７の下端部から、さらに側方（図１４においては紙面手前側）へ向けて係合部材１５８が突設されている。該係合部材１５８は前記長孔１５５に嵌まっている。
【００５７】
手動時においては、オペレータがアクセルペダル１５２を踏むと、該アクセルペダル１５２は回動支点１５３を中心に下方に回動する。このときステー１５７先端の係合部材１５８は長孔１５５内を移動するものの、その移動軌跡（図１４の斜線部）と長孔１５５の上下の周縁部とは干渉しないように長孔の形状が構成されている。そのため、油圧シリンダ１５４のシリンダロッド１５４ａを無理に押し込んだり、シリンダロッド１５４ａに曲げモーメントが作用したりして変形・破損することがない。
【００５８】
一方、自律走行時においては、油圧シリンダ１５４のシリンダロッド１５４ａが収縮する方向に作動すると、長孔１５５の先端部１５５ａと係合部材１５８とが当接し、係合部材１５８が油圧シリンダ１５４に引き寄せられる方向にステー１５７が回動する。結果として、アクセルペダル１５２が回動支点１５３を中心に下方に回動する。すなわち、手動時においてアクセルペダル１５２をオペレータが踏んだのと同じ挙動となるのである。
また、油圧シリンダ１５４のシリンダロッド１５４ａが伸張する方向に作動すると、アクセルペダル１５２は図示せぬ付勢手段により上方に回動する方向に付勢されているので、長孔１５５の先端部１５５ａに係合部材１５８が当接しつつアクセルペダル１５２は回動支点１５３を中心に上方へ回動する。すなわち、手動時においてアクセルペダル１５２からオペレータが足を離したのと同じ挙動となるのである。
【００５９】
このように構成することにより、簡単な構造で駆動アクチュエータの破損防止を行うことが可能である。また手動時にはアクセルペダル１５２と油圧シリンダ１５４とは干渉しないので、手動時にも余分な負荷がかかることがない。
【００６０】
【発明の効果】
本発明は、以上のように構成したので、以下に示すような効果を奏する。
【００６１】
即ち、請求項１に示す如く、ＧＰＳと、内界センサとを搭載し、自律的に作業を行う農業用作業車であって、
自律走行開始地点と作業開始地点とを異なる場所に設定可能とするので、オペレータは圃場の外縁部まで農業用作業車を運転するだけで良く、圃場外縁部から作業幅程度中に入った位置にある作業開始地点まで農業用作業車を乗り入れ、圃場を歩いて退出するという作業を省略することが可能であり、作業性に優れる。
【００６２】
請求項２に示す如く、自律走行開始地点から作業開始地点までの走行経路を自動的に生成し、該走行経路に沿って自律走行するので、オペレータが圃場内の作業開始地点まで農業用作業車を乗り入れ、作業開始地点に精度良く停車させ、圃場を歩いて退出するという煩雑な作業を省略することが可能であり、作業性に優れる。特に、作業開始時点における農業用作業車の位置精度、作業経路への追従性が向上する。
【００６３】
請求項３に示す如く、前記作業開始地点まで自律走行後、続けて作業を開始するので、作業の迅速化に寄与する。
【図面の簡単な説明】
【図１】本発明の農業用作業車の一実施例である散布作業機の側面図。
【図２】本発明の農業用作業車の一実施例である散布作業機の平面図。
【図３】本発明における自律走行システムの模式図。
【図４】移動局ユニットを示す図。
【図５】基準局ユニットを示す図。
【図６】本発明の農業用作業車による自律走行経路を示す模式図。
【図７】従来の農業用作業車による自律走行経路を示す模式図。
【図８】本発明における自律走行のフローチャート図。
【図９】圃場内のスリップ率分布を示す図。
【図１０】本発明における異常検出のフローチャート図。
【図１１】自律走行途中で薬剤を補充する場合の自律誘導経路を示す模式図。
【図１２】ステアリング制御に係る自律操作手段を示す模式図。
【図１３】ステアリング制御方法の実施例を示す模式図。
【図１４】アクセルアクチュエータの連結方法を示す模式図。
【符号の説明】
１０１　農業用作業機
１０２　ＧＰＳユニット
１０３　移動局ユニット
１０４　基準局ユニット
１０８　ＧＰＳアンテナ
１２１　自律走行プログラム
１２６　圃場（水田）
１２７　作業車進入地点（自律走行開始地点）
１２８　作業開始地点[0001]
TECHNICAL FIELD OF THE INVENTION
The present invention relates to a traveling work of an agricultural work vehicle which is equipped with a GPS (Global Positioning System), an inner field sensor such as an azimuth sensor, a tilt sensor, a vehicle speed sensor, and a stock copy sensor and performs autonomous work. Management techniques.
More specifically, the present invention relates to a technique for measuring a positional relationship between a target field and an agricultural work vehicle by GPS, and starting autonomous traveling from inside the field based on the measurement information.
[0002]
[Prior art]
2. Description of the Related Art Conventionally, an agricultural work vehicle equipped with a GPS and sensors and autonomously traveling and working in a field where crops are already planted has been known. Examples of the agricultural work vehicle include a tractor equipped with a tillage device and a spreader equipped with a spreader. In such an agricultural work vehicle, the operator drives the agricultural work vehicle up to the work start point in the field. After reaching the work start point, the operator gets off the work vehicle and retreats out of the field, and the work vehicle starts autonomous traveling / work.
[0003]
[Problems to be solved by the invention]
For example, when using a spraying machine, which is a form of the agricultural work vehicle described above, in a paddy field, the operator travels on the spreading work vehicle into the paddy field, stops at the work start position, and then the operator starts planting rice. The operator had to walk out of the field by walking in the paddy field and returning to the ridge, which was a burden on the operator.
[0004]
[Means for Solving the Problems]
The problem to be solved by the present invention is as described above. Next, means for solving the problem will be described.
[0005]
That is, in claim 1, an agricultural work vehicle equipped with a GPS and an internal sensor and autonomously working,
The autonomous traveling start point and the work start point can be set to different places.
[0006]
According to the second aspect, a traveling route from the autonomous traveling start point to the work starting point is automatically generated, and the vehicle travels autonomously along the traveling route.
[0007]
In claim 3, after the autonomous traveling to the work start point, the work is continuously started.
[0008]
BEST MODE FOR CARRYING OUT THE INVENTION
Next, an embodiment of the invention will be described.
FIG. 1 is a side view of a spraying work machine which is an embodiment of the agricultural work vehicle of the present invention, FIG. 2 is a plan view of a spraying work machine which is an embodiment of the agricultural work vehicle of the present invention, and FIG. FIG. 4 is a schematic diagram of an autonomous traveling system according to the present invention, FIG. 4 is a diagram showing a mobile station unit, FIG. 5 is a diagram showing a reference station unit, FIG. 6 is a schematic diagram showing an autonomous traveling route by the agricultural work vehicle of the present invention, and FIG. FIG. 8 is a schematic diagram illustrating an autonomous traveling route by a conventional agricultural work vehicle, FIG. 8 is a flowchart illustrating autonomous traveling in the present invention, FIG. 9 is a diagram illustrating a slip ratio distribution in a field, and FIG. FIG. 11, FIG. 11 is a schematic diagram showing an autonomous guidance route when a medicine is replenished during autonomous traveling, FIG. 12 is a schematic diagram showing autonomous operation means related to steering control, and FIG. 13 is a schematic diagram showing an embodiment of a steering control method. FIG. 14 and FIG. It is a schematic diagram showing a connection method of Le actuator.
[0009]
First, a spraying machine 101, which is one embodiment of an agricultural work vehicle according to the present invention, will be described with reference to FIGS. Note that the present invention is not limited to the spraying machine of the present embodiment, but is applicable to an agricultural work vehicle that performs work while scanning the surface of a field.
The spraying machine 101 has a riding type traveling machine body 22, a boom 40 having a plurality of nozzles 23 for spraying a chemical solution, and a boom drive including a mechanism for raising and lowering and deploying the boom 40. A spray pump 4 for pumping the chemical solution in the chemical solution tank 24 to the nozzles 23 by receiving power from the engine 9 and the spray amount control device 3 for controlling the chemical solution discharged from the spray pump 4 And the like. In the present embodiment, the boom drive unit 35 is disposed at the front and side of the traveling body 22 and the pump unit 36 is disposed at the rear.
A pair of left and right body frames 6L and 6R extend horizontally in parallel from the front end of the traveling body 22 toward the rear of the body. Front wheels 7.7 are supported below the front of the body frames 6L and 6R, and rear wheels 8.8 are supported below the rear.
[0010]
A hood 10 that covers the engine 9 is provided on the body frames 6L and 6R in front of the traveling body 22. An operation panel 11 is provided on a cover behind the hood 10, and an operation handle 12 is provided above the operation panel 11. The operation panel 11, the operation handle 12, and the like serve to control the operation unit of the spraying machine 101. Make up. Step 13 is provided on the body frames 6L and 6R from the lower side of the operation panel 11 toward the rear. A chemical solution tank 24 is provided on the rear of the machine body frames 6L and 6R. A driver's seat 14 is formed at the front center of the chemical solution tank 24, and the side and the rear are surrounded by the chemical solution tank 24. It is placed as follows.
In addition, the body frames 6L and 6R and the subframes 52L and 52R, which are the respective components of the frame of the spraying machine 101, are made of hollow square or round pipes or steel materials such as L-shape and H-shape, respectively. It is configured with high rigidity.
[0011]
The boom drive unit 35 includes a boom 40 for spraying a chemical solution, and an elevating link mechanism 37. The boom 40 includes a front boom 41 in front of the traveling body 22, and left and right side booms 42 </ b> L and 42 </ b> R pivotally supported at both ends of the front boom 41 and foldably extending to the side. A plurality of nozzles 23 for spraying a chemical solution are arranged on the boom 40 at regular intervals.
Cylinders 43, 43 are interposed between the front boom 41 and the side booms 42L, 42R, respectively, and the side booms 42L, 42R are horizontally extended by expanding and contracting the cylinders 43, 43. It is rotatable between the working position thus set and the storage position which is positioned upward and rearward in the front-rear direction.
[0012]
The elevating link mechanism 37 connects the front boom 41 and the front portions of the body frames 6L and 6R by parallel links, and interposes cylinders 38 between one of the parallel links and the body frames 6L and 6R. The boom 40 can be moved up and down by expanding and contracting the cylinders 38.
The left and right centers of the front boom 41 are pivotally supported by the elevating link mechanism 37 and supported so as to be tiltable left and right. The cylinder 39 is interposed between the front boom 41 and the elevating link mechanism 37, and the boom 40 is moved. It is configured to perform horizontal control.
[0013]
The pump section 36 is disposed on subframes 52L and 52R extending to the rear of the traveling body 22 via support members such that the crankshaft of the spray pump 4 is positioned in the longitudinal direction of the body. The pump unit 36 mainly includes the spray pump 4 and the spray amount control device 3, and an air chamber, a safety valve, and the like (not shown) are provided in the upper right part of the crankcase 26 of the spray pump 4. The spray amount control device 3 includes a flow control valve (not shown) and a motor for opening and closing the flow control valve.
[0014]
Next, GPS in the agricultural work vehicle of the present invention will be described.
GPS (Global Positioning System) is a system originally developed for navigation support of aircraft, ships, etc., and has 24 GPS satellites orbiting about 20,000 km above (Four at a time), a control station for tracking and controlling GPS satellites, and a user's receiver for positioning.
As a surveying method using GPS, various methods such as a single position, a relative position, a DGPS (differential GPS) position, and an RTK-GPS (real-time kinematic-GPS) position are exemplified.
[0015]
The single side position is a method in which information such as the position and time of a satellite transmitted from a GPS satellite is received by one antenna. Measure the time required from when the radio wave is transmitted from the satellite to when it reaches the receiver, and calculate the distance from the time and the speed of the radio wave
At this time, the position of the observation point is determined by simultaneously determining the distances from four or more satellites to the observation point using a GPS satellite whose position is known as a reference point for movement.
[0016]
Relative position is a method of using two or more receivers and observing four or more same GPS satellites at the same time. Based on the positions of the GPS satellites, the radio signals from the GPS satellites reach the respective receivers Then, the relative positional relationship between the two points (two receivers) is determined by measuring the time difference (phase difference between the radio waves).
Since the radio wave of the same satellite is received at each measurement point and the radio wave emitted from the satellite passes through similar weather conditions, the difference between the observation values between the two points (two receivers) By taking this value, errors such as satellite position errors and tropospheric and ionospheric delays included in the observed values can be eliminated.
[0017]
The DGPS (differential GPS) side and the RTK-GPS (real-time kinematic-GPS) side were simultaneously observed by a reference station whose position is known and an observation point whose position is to be obtained, and were observed by the reference station. This is a method in which data is transmitted to an observation point in real time by a method such as wireless communication, and the position of the observation point is obtained in real time based on the position result of the reference station.
The DGPS (Differential GPS) side position performs a single position at both the reference station and the observation point, obtains the difference between the position result at the reference station and the coordinate value observed, and transmits the difference to the observation point as correction information.
The RTK-GPS (real-time kinematic-GPS) side measures the phase (relative side) at both the reference station and the observation point, and transmits the phase data observed at the reference station to the observation point.
The GPS receiver at the observation point determines the position of the observation point by analyzing the received data and the data transmitted from the reference station in real time.
[0018]
In the present invention, the RTK-GPS side position method having high measurement accuracy is adopted, but other methods described above may be used, and there is no limitation.
[0019]
As shown in FIG. 3, the GPS unit 102 in the present invention mainly includes a mobile station unit 103 mounted on the main body of the spraying machine 101 and a reference station side unit 104 installed near a field such as a paddy field. The reference station unit 104 serves as a reference station fixed on the ground, and the mobile station side unit 103 functions as a mobile station (observation point) that seeks a position.
As shown in FIG. 4, a front view portal type frame 105 is provided upright from the rear of the driver's seat 14 on the upper surface of the spraying machine 101 main body. A storage section 106 is provided in a portion of the frame 105 surrounded by the horizontal section 105a and the upright sections 105b and 105b. The storage section 106 stores members of the mobile station unit 103 except for the GPS antenna 108. The GPS antenna 108 is fixed on the upper surface of the horizontal portion 105a of the frame 105.
[0020]
The mobile station unit 103 includes, in addition to the GPS antenna 108, a GPS receiving unit 109, a processing unit 110 serving as a control unit including a CPU, a RAM, a ROM, and the like, an operation unit 111, a display unit 112, a wireless unit 113, and the like.
The radio signal from the GPS satellite received by the GPS antenna 108 is transmitted to the processing unit 110 via the GPS receiving unit 109 via a cable. The operation unit 111 is an interface for performing setting of autonomous driving described later, initial setting of GPS, and the like, and is connected to the processing unit 110 by a cable. The display unit 112 is connected to the processing unit 110 via a cable, and displays the status of data processing in the processing unit 110 and various settings input by the operation unit 111. The wireless section 113 is for wireless communication between the base station unit 104 and the wireless operation means 133 carried by the operator, and the mobile station unit 103. Further, a receiving unit 107 is provided for receiving a control signal from the wireless operation unit 133 and stopping the autonomous traveling of the spraying machine 101 when the operation confirmation signal from the wireless operation unit 133 is interrupted.
Although the mobile station unit 103 is fixed to the frame 105 in the present embodiment, for example, other members constituting the mobile station unit 103 other than the GPS antenna 108 are housed in the hood 9 and are located in front of the driver's seat 14. The operation unit 111 and the display unit 112 may be incorporated in the operation panel 11 of the control unit located at.
The operation unit 111 is not limited as long as it can be operated by an operator such as a keyboard, a switch, a lever, a push button, and a dial. Furthermore, the operation unit 111 and the display unit 112 may be integrated as a touch panel.
An existing personal computer may be used as the processing unit 110, the operation unit 111, and the display unit 112.
[0021]
The reference station unit 104 has substantially the same configuration as the mobile station unit 103, and includes a GPS antenna 114, a GPS reception unit 115, a processing unit 116, an operation unit 117, a display unit 118, a radio unit 119, and the like.
[0022]
As shown in FIG. 5, the GPS antenna 114 is erected from the ground by a column 114a. Members other than the GPS antenna 114 configuring the reference station unit 104 are configured to be housed in the housing 120.
The reference station unit 104 may be permanently installed near the field where the spraying machine 101 of the present invention is used, or may be configured to be removable after use.
[0023]
Next, an autonomous traveling system in the spraying machine 101 of the present invention will be described with reference to FIG. The autonomous running system includes an autonomous running program 121, an inner field sensor 122 for detecting various information of the spraying machine 101, a stock copying sensor 123, and an autonomous running and work for autonomous running / working, in addition to the above-described GPS unit 102. It comprises an operation means 124 and the like.
[0024]
The radio signal transmitted from the GPS satellite 125 at a certain time is received by the GPS antenna 108 of the mobile station unit 103 provided in the spraying machine 101, and transmitted to the processing unit 110 via the GPS receiving unit 109.
[0025]
On the other hand, the radio signal transmitted at the same time from the GPS satellite 125 is also received by the GPS antenna 114 of the reference station unit 104 installed near the field, and transmitted to the processing unit 116 via the GPS receiving unit 115. Further, it is wirelessly transmitted from the wireless unit 119 to the processing unit 110 via the wireless unit 113.
[0026]
The processing unit 110 compares and compares the radio signal received by the reference station unit 104 with the radio signal received by the mobile station unit 103, and the radio signal transmitted at the same time is output by the GPS antenna 108 and the GPS antenna 114. A relative position between the mobile station unit 103 and the reference station unit 104 is calculated based on a phase difference at the time of reception and radio signal information from a plurality of satellites, and the position of the mobile station unit 103 is calculated. The above calculation is performed by the autonomous traveling program 121 stored in the processing unit 110.
[0027]
With this configuration, the three-dimensional relative position between the spraying machine 101 and the reference station unit 104, that is, the position (including the data in the height direction) of the spraying machine 101 in the field is accurately and in real time. It can be measured.
[0028]
The inner field sensor 122 refers to sensors for detecting information necessary for autonomously running the spraying machine 101, such as speed, attitude, engine speed, and steering angle. More specifically, there are an engine speed sensor, a vehicle speed sensor, a steering angle sensor, a direction sensor, a roll inclination sensor, a pitch inclination sensor, and the like. The detection signals from these internal sensors 122 are transmitted to the processing unit 110. In the present embodiment, among the inner field sensors 122, the azimuth sensor, the roll inclination sensor, the pitch inclination sensor, and the like are disposed in the same storage section 106 as the mobile station unit 103. The arrangement position is not particularly limited.
[0029]
The stock copy sensor 123 is provided on the lower surface of the front of the body of the spraying machine 101. The stock copy sensor 123 is used to detect a crop planted at a predetermined interval in a field so as to prevent the spraying machine 101 from stepping on the crop with wheels, and to control the traveling direction of the spraying machine 101. Can be The detection signal from the stock copy sensor 123 is also transmitted to the processing unit 110.
[0030]
Based on the detection signal from the inner field sensor 122, the stock copy sensor 123, and the position information of the spraying machine 101 by the GPS unit 102, the speed and the posture of the spraying machine 101 by the autonomous traveling program 121 stored in the processing unit 110. A signal for autonomously operating the engine speed, the steering angle of the steering, and the like is transmitted to the autonomous operation means 124. More specifically, the autonomous operation means 124 includes a steering drive actuator and a steering drive solenoid valve (not shown), a boom elevating power cylinder (corresponding to the cylinder 38), and a boom opening / closing power cylinder (corresponding to the cylinder 43). , A boom horizontal control power cylinder (corresponding to the cylinder 39), an accelerator actuator, a main clutch actuator, and the like.
In this embodiment, the position information of the spraying machine 101 obtained from the GPS unit 102 has high accuracy also in the height direction. Therefore, during autonomous operation, it is possible to control the cylinder 38 so that the height from the field to the boom is substantially constant, and to make the spraying state of the medicine constant.
[0031]
The wireless operation means 133 is carried by the operator, and is used for performing various operations from a position away from the spraying work vehicle 101. More specifically, the wireless operation means 133 can start and stop the autonomous traveling of the spraying vehicle 101, stop the engine, open and close the side booms 42L and 42R, and raise and lower the boom 40, which will be described in detail later. Is configured.
[0032]
Next, a method of performing a spraying operation, which is a main part of the present invention, will be described with reference to FIGS.
For example, when the spraying operation is performed in the paddy field 126 which is a field having a rectangular shape in a plan view as shown in FIGS. In order to spray the medicine so as not to generate as much as possible, the spraying machine 101 for spraying extends the lateral booms 42L and 42R to the side of the vehicle body (hereinafter referred to as “working width”). (See FIG. 6 and FIG. 7), leaving the outer edge portion 126a of the paddy field 126 having approximately the same width as that of the paddy field 126 (shaded portion in FIGS. 6 and 7). Start. Finally, the spraying operation is performed while making a round around the outer edge, and the spraying machine 101 retreats from the paddy field 126 from the work end point 129 (or the work end point 132). In other words, the spraying machine 101 performs the spraying operation while traveling along the paths indicated by the solid and dotted lines in FIGS. 6 and 7.
At this time, in the travel path of the spraying machine 101 shown in FIGS. 6 and 7, a portion shown by a solid line indicates that the vehicle runs while performing the chemical spraying operation, and a portion shown by a dotted line indicates the chemical spraying operation. This indicates that the vehicle travels without performing.
[0033]
In the case of the spraying operation in the spraying machine 101 of the present invention, as shown in FIGS. 6 and 8, the operator drives the spraying machine 101 to the work vehicle entrance point 127 which is an arbitrary point at the end of the paddy field 126, and The vehicle is stopped at the vehicle entry point 127 and gets off the spraying machine 101. The position of the outermost periphery of the field (the shape of the paddy field 126) is stored in the processing unit 110 in advance. Further, work route data for each paddy field is created in advance and stored in the processing unit 110. Next, the operator starts the autonomous traveling of the spraying machine 101 (presses the autonomous traveling start button) using the wireless operation means 133 carried by the operator.
The spraying machine 101 autonomously travels from a work vehicle entry point 127 to a work start point 128 based on information on the shape of the paddy field 126 and work route data by an autonomous running program 121 stored in the processing unit 110, and then stops. The medicine spraying operation is started without performing the operation, and the autonomous traveling is continued based on the position information from the GPS unit 102. Finally, when reaching the work end point 129, the spraying machine 101 automatically ends the autonomous traveling and stops.
[0034]
On the other hand, in the case of the spraying operation by the conventional spraying machine, as shown in FIG. 7, the operator drives the spraying machine through the work vehicle entry point 130 which is an arbitrary point at the end of the paddy field 126 to the work start point 131. . The operator is mounted on the spraying machine, guides and stops at the current position of the spraying machine and the work start point 131 while watching the monitor on which the work start point of the work route automatically created is displayed. Get off the spraying machine 101. Then, the crop is planted, and the child walks out of the muddy paddy field 126 and leaves. Next, the operator starts the autonomous running of the spraying machine by using the wireless operation device carried by the operator. The conventional spraying machine goes around the outer edge 126a of the paddy field 126 just before the operation, stores the shape of the paddy field 126 obtained from the GPS unit in the processing unit, and based on the information on the shape of the paddy field 126 by the autonomous traveling program. The work route is automatically created, or work route data for each paddy field is created in advance and stored in the processing unit.
The spraying machine 101 starts the medicine spraying operation / autonomous traveling based on the positional information from the GPS unit. Finally, when reaching the work end point 132, the conventional spraying machine automatically ends the autonomous traveling and stops.
[0035]
As described above, the spraying machine 101 as the agricultural work vehicle of the present invention has the following advantages.
[0036]
First, the spraying machine 101 of the present invention is configured to be able to start autonomous traveling from the outer edge of the paddy field 126 which is a field. In other words, the point at which the autonomous traveling starts (in this embodiment, the work vehicle entry point) and the work start point can be set to different places. On the other hand, although the conventional spraying machine is capable of autonomous traveling, since the autonomous traveling start point and the work start point are the same, the operator has to walk out of the field (the paddy field 126 in this embodiment) to exit. Was.
Therefore, the operator only needs to operate the spraying machine to the outer edge of the field, and the operator gets on the spraying machine from the edge of the field to the work start point located at a position approximately in the working width (10 m). It is possible to omit the operation of walking and exiting, and the workability is excellent.
[0037]
Second, the spraying machine 101 of the present invention automatically creates a work vehicle guidance route from an autonomous traveling start point (work vehicle entry point in this embodiment) located at the outer edge of the paddy field 126 to a work start point. At the same time as the autonomous running starts, the vehicle autonomously runs to the work start point. At this time, since the vehicle is guided by the high-precision GPS unit, the position accuracy of the spraying work vehicle when reaching the work start point is very high.
On the other hand, with the conventional spraying machine, it was not easy to accurately stop at the work start point while watching the monitor while driving manually. In particular, in the case of paddy fields, it is necessary to adjust the condition of the spraying machine and the rice ears of the paddy fields, which is a complicated operation.
In this way, the operator can get into the work machine to the work start point in the field, stop accurately at the work start point, and omit the cumbersome work of walking out of the field and exiting, thus providing excellent workability. . In particular, the position accuracy of the spraying work vehicle at the start of the work and the followability to the work route are improved.
Furthermore, the workability is further improved if an autonomous traveling program is configured to create a work vehicle guidance route so that the approach direction to the work start point substantially matches the traveling direction at the time of work start.
[0038]
Third, after reaching the work start point, the work can be started continuously without stopping, which contributes to speeding up the work.
[0039]
In the present invention, the position of the spraying machine 101 in the field is measured by the GPS unit 102 during autonomous traveling. Therefore, for example, a sensor for detecting the rotation speed is provided on the axle of the spraying work machine 101, and the travel distance (expected travel distance) of the spraying work machine 101 estimated from the axle rotation speed by the sensor is obtained from the GPS unit 102. By comparing the actual traveling distance (actual traveling distance) of the spraying machine 101, it is possible to calculate the travel slip ratio at the place where the spraying machine 101 currently passes.
The running slip ratio is represented by the following equation.
Traveling slip ratio (%) = {1− (actual traveling distance) / (expected traveling distance)} × 100
Further, by combining the traveling slip rate and the position information of the spraying work machine 101 obtained from the GPS unit 102, it is possible to grasp the distribution of the soft ground in the field.
As described above, by grasping the distribution of the soft ground in the field, for example, when passing through the soft ground portion, the actual traveling speed becomes slow, so that the spraying amount can be suppressed, and the spraying work can be stabilized, It is. Further, it is also possible to store the distribution data of the soft ground in the field in the processing unit 110 and use it as data for field maintenance.
For example, as shown in FIG. 9, by superimposing the distribution of the running slip ratio on the shape data of the paddy field 126, it is possible to easily obtain the soft ground distribution information of the field. The data shown in FIG. 9 can be displayed on the display unit 112 of the spraying machine 110 and the display unit 118 of the reference station unit 104. Further, the data can be output to the outside, and can be applied to tillage work, planting work, harvesting work, and the like.
Further, when the slip ratio is extremely large (the actual traveling distance is extremely small as compared with the expected traveling distance), it is considered that the spreading work machine 101 has been wheeled on the field and cannot travel, and the rescue operation is performed. It is also possible to emit a signal (a buzzer or a lamp attached to the spraying machine 101 operates, or a buzzer, vibrator or lamp provided in the wireless operation means 133 operates).
[0040]
Next, an operation flow of the spraying work machine 101 when the spraying work machine 101 detects some abnormality during autonomous traveling will be described.
As shown in FIG. 10, in the case of a trouble in the engine system, the engine of the spraying machine 101 is immediately stopped, and an abnormal display or wireless communication (a buzzer or a lamp attached to the spraying machine 101 is activated, or a wireless operating means) 133, a buzzer, a vibrator, and a lamp are operated.
In the case of a trouble in the work machine (spreader in this embodiment) system, the work machine is stopped, and an abnormal display or wireless communication (a buzzer or a lamp attached to the spray work machine 101 is activated, or the wireless operation means 133) Buzzer, vibrator, lamp, etc. provided in the system). At this time, if there is no trouble in the engine system or the steering system, the autonomous traveling program 121 may be configured to create an emergency automatic traveling route and autonomously travel to the end of the field.
With this configuration, the operator can easily detect an abnormality of the spraying machine 101 during autonomous traveling even from a remote position. In addition, since the abnormal location is stopped when the abnormality is detected, it is possible to prevent the device from being damaged due to the continuous operation of the abnormal location of the spraying machine 101. Also, the spraying machine 101 can be guided to the outer edge 126a of the paddy field 126 without an operator entering the field, unless the engine trouble is unavoidable.
[0041]
Also, in connection with the above-described abnormality detection method, a level switch (level sensor, liquid level sensor, etc.) is provided in the chemical liquid tank 24 of the spraying machine 101 so that the remaining amount of the chemical liquid in the chemical liquid tank 24 decreases or disappears. It is also possible to detect that.
Further, as shown in FIG. 11, the position 134 of the spraying machine 101 when the level switch is actuated (hereinafter referred to as a spraying operation interruption point 134) is stored in the processing unit 110, and the spraying operation interruption point 134 A guide route between the field ends 135 is automatically created, and when the spraying machine 101 returns to the field end 135 by autonomous traveling along the guide route, a chemical solution is replenished to the chemical solution tank 24 and again along the guide route. It is also possible to configure the autonomous traveling program 121 to autonomously travel to the spraying work interruption point 134 and restart the spraying work autonomously (return to the work route before the spraying work was interrupted).
With this configuration, since the point at which the chemical solution spraying is interrupted by the autonomous traveling program 121 is stored, even if the chemical solution is exhausted during the spraying operation by the autonomous traveling, the spraying is performed at the same point a plurality of times. It is possible to restart the spraying of the chemical solution without leaving a point where no chemical solution is sprayed, and to operate the level switch of the chemical solution tank 24 not at the time when the chemical solution runs out, but with a small amount of the chemical solution remaining. It may be configured as follows. In this case, the spraying machine 101 can perform the spraying operation while replenishing the chemical solution quickly without running out of the chemical solution.
Further, the autonomous traveling program 121 may be configured so that the position of the field end 135 can be set to an arbitrary position at the end of the paddy field 126 or coincide with the work vehicle entry point 127.
[0042]
Next, steering control during autonomous traveling will be described with reference to FIG.
As described above, in the spraying work machine 101, which is an embodiment of the agricultural work vehicle of the present invention, at the time of autonomous traveling, the inside sensor 122, the stock copy sensor 123, various detection signals from the GPS unit 102, position information, and the like. , The processing unit 110 activates the autonomous operation means 124 to travel along the work route and perform the spraying operation.
At this time, among the autonomous operation means 124, those relating to the steering include a hydraulic motor 136 as a steering drive actuator, a steering drive solenoid valve 137, and the like.
[0043]
As shown in FIG. 12, the driving handle 12 is provided at the upper end of the handle shaft 138. The lower end of the handle shaft 138 and the upper end of the shaft 139 are connected by a universal joint 140. A torque generator 142 is provided between the lower end of the shaft 139 and the upper end of the shaft 141 so that the shaft 141 can be easily rotated even if the rotational power for operating the operation handle 12 is small. The shaft 141 is connected to a steering mechanism (not shown), and steers the spraying work vehicle 101 by turning the driving handle 12 right and left.
[0044]
On the other hand, during autonomous traveling, it is necessary to operate the steering mechanism by the autonomous traveling program 121. In the present embodiment, a sprocket 143 is provided in the middle of the handle shaft 138, and a chain 145 is wound between the sprocket 144 and the sprocket 144 provided on the output shaft of the hydraulic motor 136. One ends of hydraulic pipes 146 and 147 are connected to the hydraulic motor 136, and the other ends of the hydraulic pipes 146 and 147 are connected to a steering drive solenoid valve 137. A bypass pipe 148 that bypasses both hydraulic pipes is provided at an intermediate part of the hydraulic pipes 146 and 147, and a valve 149 is provided at an intermediate part of the bypass pipe 148.
The steering drive solenoid valve 137 sends the hydraulic oil sent from a hydraulic pump (not shown) in the order of the hydraulic pipe 146, the hydraulic motor 136, the hydraulic pipe 147, and then returns to the hydraulic oil tank. The hydraulic pipe 147, the hydraulic motor 136, the hydraulic pressure The three hydraulic circuits of sending the pipes 146 in order and returning them to the hydraulic oil tank or closing the ends of the hydraulic pipes 146 and 147 on the steering drive solenoid valve 137 side can be selected by an instruction from the autonomous traveling program 121. Thus, the left and right steering and the steering mechanism can be fixed at a certain steering angle. During autonomous traveling, the valve 149 is closed, and during manual traveling, the valve 149 is opened and the operation handle 12 can be freely operated.
[0045]
This configuration has the following advantages.
[0046]
First, by using the hydraulic motor 136 as the steering drive actuator, it is possible to reduce the size of the part of the autonomous operation means 124 related to the steering control and to arrange it compactly.
[0047]
Second, since the torque generator 142 is arranged between the power transmission path from the steering mechanism to the hydraulic motor 136, it is not necessary to use a hydraulic motor 136 having a large torque.
[0048]
Third, it is necessary to transmit the rotational driving force from the hydraulic motor 136 such that the input shaft of the torque generator 142, that is, the rotational speed of the shaft 140 is equal to or less than the following rotational speed. In this embodiment, the sprockets 143 and 144 and the chain 145 are interposed in the power transmission path from the hydraulic motor 136 to the shaft 140. If the sprockets 143 and 144 are appropriately selected, the rotation speed of the shaft 140 can be easily increased. It can be set to be equal to or less than the following rotation speed.
[0049]
Fourth, since a bypass circuit (bypass pipe 148 and valve 149) is provided in the middle of the hydraulic pipes 146 and 147 connecting the hydraulic motor 136 and the steering drive electromagnetic valve 137, the hydraulic motor can be used without using a complicated mechanism. It is possible to open the hydraulic circuit of 136. As a result, the turning resistance caused by the driving actuator during manual operation is reduced, and the device can be easily turned manually.
Note that the valve 149 may be configured to be manually opened and closed, or may be configured to be operated by the autonomous traveling program 121 so that the valve 149 is closed during autonomous traveling and the valve 149 is opened during manual traveling. Further, the steering drive solenoid valve 137 of this embodiment performs forward / reverse rotation of the hydraulic motor 136 and closes both ends of the hydraulic circuit of the hydraulic motor 136. The hydraulic circuit of the hydraulic motor 136 is provided in the steering drive solenoid valve 137. A hydraulic path may be provided to open the valve, and the bypass pipe 148 and the valve 149 may be omitted.
However, the control can be performed using an electric motor instead of using an electromagnetic valve or a hydraulic motor.
[0050]
Next, a steering control method will be described with reference to FIG.
As described above, the steering operation during autonomous traveling is performed by the hydraulic motor 136, and the sprockets 143 and 144 and the chain 145 are interposed in the power transmission path from the hydraulic motor 136 to the shaft 140. This is effective in adjusting the relationship of the rotation speed of the motor 142. On the other hand, the backlash between the chain 145 and the sprockets 143 and 144 is large, and the period from when the command to change the steering angle is issued by the autonomous traveling program 121 during the autonomous traveling to when the steering angle is actually changed is changed. There is a problem that a time lag occurs. If such a time lag is large, there is a possibility that the ability to follow the autonomous traveling route automatically created by the autonomous traveling program 121 may be affected.
Therefore, in the present invention, the distance deviation (Δd) from the current target trajectory of the spraying machine 101 (represented by the spraying machine 101a in FIG. 12), that is, the traveling route created by the autonomous traveling program 121. And the azimuth deviation (Δdir) are obtained based on information from the azimuth sensor which is one of the GPS unit 102 and the inner field sensor 122, respectively, and the spraying machine 101 (FIG. 12) after a lapse of time t corresponding to the time lag. In (2), the position and orientation of the spraying machine 101b are predicted, and the distance deviation (Δfd) and the orientation deviation (Δfdir) from the target trajectory are calculated.
The autonomous traveling program 121 is configured to calculate the target control steering angle (θtarget) using these Δd, Δdir, Δfd, and Δfdir, and to perform PID control.
[0051]
Hereinafter, an example of a steering control method in the spraying machine 101 of the present embodiment will be described. In FIG. 13, the angle is positive in the counterclockwise direction.
The target control steering angle (θ target) is represented by the following (Equation 1).
θtarget = −Δdir−Δaddire (Equation 1)
Here, Δaddire (hereinafter, referred to as an additional control angle) is an angle formed between the steering center 151b of the spraying machine 101 and the target point 152 at the expected position after the time t has elapsed. The Δaddire is represented by the following (Equation 2).
Δaddire = Acttan (Δfd / Md) (Equation 2)
Here, Md (shown in FIG. 13) in Expression 2 is a target return length, which is a known value set in advance. Δfd is a distance deviation from the target trajectory obtained by calculation from the position of the spraying machine 101 after the elapse of the time t described above. The Δfd is represented by the following (Equation 3).
Δfd = Δd + V × t × sin (Δfdir) (Equation 3)
Here, V is the traveling speed of the spraying machine 101, and is measured by a vehicle speed sensor which is one of the internal sensors 122. Δfdir is an azimuth deviation obtained by calculating the angle between the azimuth of the spraying machine 101 after the elapse of the time t and the target trajectory 150. The Δfdir is represented by the following (Equation 4) or (Equation 5).
Δfdir = Δdir + V × t × tan (2 × φ) / (L × cosφ) (Equation 4)
Δfdir = Δdir + V × t × tanφ / L (Equation 5)
Here, φ is the current steering angle, which is measured by a steering angle sensor that is one of the inner field sensors 122. L represents a foil base.
Equation 4 is an equation used when a four-wheel steering mechanism is employed as in the spraying machine 101 of the present embodiment, and Equation 5 employs a front wheel steering mechanism such as a tractor. This is the expression used in the case.
[0052]
The target control steering angle (θ target) is calculated using Equations 1 to 4 or Equations 3 and 5 above. Then, by using the θ target for steering control during autonomous traveling, steering control is performed in consideration of a time lag caused by backlash of the entire steering device, and the ability to follow a traveling route during autonomous traveling is improved.
[0053]
Next, a configuration of a connecting portion between a movable portion used during manual operation and a drive actuator used during autonomous traveling will be described with reference to FIG.
[0054]
As described above, in the case of the hydraulic motor 136 which is a steering drive actuator, by providing a bypass circuit between the hydraulic pipes 146 and 147 of the hydraulic motor 136, the drive actuator is prevented from being damaged and the load is reduced during manual operation. However, the work spreader 101 of the present invention also includes various actuators as the autonomous operation means 124. In these cases as well, it is necessary to prevent breakage and reduce the load during manual operation.
[0055]
In the case of the accelerator pedal 152 for controlling the engine speed, as shown in FIG. 14, during manual operation, the operator steps down with his / her foot and turns around the turning fulcrum 153 as a center. When the foot is released from the accelerator pedal 152, the accelerator pedal 152 is configured to rotate upward by a biasing means (not shown).
[0056]
On the other hand, a hydraulic cylinder 154, which is one of the autonomous operation means 124 and is an accelerator actuator for controlling the engine speed during autonomous traveling, has a mounting member 156 having a long hole 155 drilled at the tip of a cylinder rod 154a. It is arranged. An engaging member 158 is further provided to project laterally (in FIG. 14, toward the front of the drawing) from a lower end of a stay 157 projecting substantially below the accelerator pedal 152. The engagement member 158 is fitted in the elongated hole 155.
[0057]
At the time of manual operation, when the operator steps on the accelerator pedal 152, the accelerator pedal 152 rotates downward around the rotation fulcrum 153. At this time, although the engaging member 158 at the tip of the stay 157 moves in the elongated hole 155, the shape of the elongated hole is adjusted so as not to interfere with the movement locus (hatched portion in FIG. 14) and the upper and lower peripheral edges of the elongated hole 155. It is configured. Therefore, there is no possibility that the cylinder rod 154a of the hydraulic cylinder 154 is forcibly pushed or a bending moment acts on the cylinder rod 154a to cause deformation or breakage.
[0058]
On the other hand, during autonomous traveling, when the cylinder rod 154a of the hydraulic cylinder 154 operates in a contracting direction, the distal end 155a of the elongated hole 155 comes into contact with the engaging member 158, and the engaging member 158 is drawn to the hydraulic cylinder 154. The stay 157 rotates in the direction in which it is moved. As a result, the accelerator pedal 152 rotates downward around the rotation fulcrum 153. That is, the behavior is the same as when the operator steps on the accelerator pedal 152 during manual operation.
When the cylinder rod 154a of the hydraulic cylinder 154 operates in the extending direction, the accelerator pedal 152 is urged in the direction of turning upward by urging means (not shown). The accelerator pedal 152 rotates upward about the rotation fulcrum 153 while the engagement member 158 is in contact. That is, the behavior is the same as when the operator releases the foot from the accelerator pedal 152 during manual operation.
[0059]
With this configuration, it is possible to prevent the breakage of the drive actuator with a simple structure. Since the accelerator pedal 152 and the hydraulic cylinder 154 do not interfere with each other during manual operation, no extra load is applied even during manual operation.
[0060]
【The invention's effect】
The present invention is configured as described above, and has the following effects.
[0061]
That is, an agricultural work vehicle equipped with a GPS and an internal sensor and autonomously performing an operation, as described in claim 1,
Since the autonomous traveling start point and the work start point can be set to different places, the operator only needs to drive the agricultural work vehicle up to the outer edge of the field, and the operator enters the position within the working width from the outer edge of the field. It is possible to omit the work of getting in the agricultural work vehicle to a certain work start point and walking out of the field to leave the work, which is excellent in workability.
[0062]
As described in claim 2, the traveling route from the autonomous traveling start point to the work starting point is automatically generated and the vehicle travels autonomously along the traveling route, so that the operator can use the agricultural work vehicle to reach the work starting point in the field. , It is possible to omit the complicated operation of stopping the vehicle at the work start point with high precision and walking and leaving the field, thereby improving workability. In particular, the position accuracy of the agricultural work vehicle at the start of the work and the followability to the work route are improved.
[0063]
According to a third aspect of the present invention, the work is continuously started after the autonomous traveling to the work start point, which contributes to speeding up the work.
[Brief description of the drawings]
FIG. 1 is a side view of a spraying machine as an embodiment of an agricultural work vehicle according to the present invention.
FIG. 2 is a plan view of a spraying machine which is an embodiment of the agricultural work vehicle according to the present invention.
FIG. 3 is a schematic diagram of an autonomous traveling system according to the present invention.
FIG. 4 is a diagram showing a mobile station unit.
FIG. 5 is a diagram showing a reference station unit.
FIG. 6 is a schematic diagram showing an autonomous traveling route by the agricultural work vehicle of the present invention.
FIG. 7 is a schematic diagram showing an autonomous traveling route by a conventional agricultural work vehicle.
FIG. 8 is a flowchart of autonomous traveling according to the present invention.
FIG. 9 is a diagram showing a slip ratio distribution in a field.
FIG. 10 is a flowchart of abnormality detection according to the present invention.
FIG. 11 is a schematic diagram showing an autonomous guidance route when a medicine is replenished during autonomous traveling.
FIG. 12 is a schematic diagram showing an autonomous operation unit related to steering control.
FIG. 13 is a schematic diagram showing an embodiment of a steering control method.
FIG. 14 is a schematic view showing a method of connecting an accelerator actuator.
[Explanation of symbols]
101 Agricultural work machine
102 GPS unit
103 Mobile station unit
104 Reference station unit
108 GPS antenna
121 Autonomous driving program
126 Field (paddy field)
127 Work vehicle entry point (autonomous driving start point)
128 Work start point

Claims

An agricultural work vehicle equipped with a GPS and an internal sensor and performing autonomous work,
An agricultural work vehicle wherein an autonomous traveling start point and a work start point can be set to different places.

The agricultural work vehicle according to claim 1, wherein a traveling route from the autonomous traveling start point to the work starting point is automatically generated, and the vehicle autonomously travels along the traveling route.

The agricultural work vehicle according to claim 1 or 2, wherein the work is continuously started after the autonomous traveling to the work start point.