(57)【要約】【課題】検出された機体傾斜角度に基づいて、対地作業装置の左右方向での対地傾斜姿勢が設定傾斜角度に維持されるように、対地作業装置を駆動ローリングさせるローリング制御装置において、機体傾斜の挙動に応じた制御を行うことで、速やかに作業装置のローリング姿勢の安定化を図る。【解決手段】現在の走行機体の傾斜変化状態が、ローリングアクチュエータの最大速度で対地作業装置をローリング駆動することで追随可能な状態にあるかどうかを判断する判断手段を備え、追随可能であると判断された場合には、前記設定傾斜角度と検出傾斜角度との偏差のみに基づいてローリングアクチュエータの目標速度を演算し、追随不能であると判断された場合には、前記偏差と傾斜変化速度に基づいてローリングアクチュエータの目標速度を演算する。【選択図】        図６
2004187638.tif 000002
【特許請求の範囲】
【請求項１】
走行機体の左右傾斜角度を検出する傾斜検出手段を備え、検出された機体傾斜角度に基づいて、走行機体にローリング自在に連結した対地作業装置の左右方向での対地傾斜姿勢が設定傾斜角度に維持されるように、対地作業装置をローリングアクチュエータによって駆動ローリングさせるローリング制御手段を設けてある農作業機のローリング制御装置であって、
現在の走行機体の傾斜変化状態が、ローリングアクチュエータの最大速度で対地作業装置をローリング駆動することで追随可能な状態にあるかどうかを判断する判断手段を備え、
追随可能であることが判断された場合には、前記設定傾斜角度と検出傾斜角度との偏差のみに基づいてローリングアクチュエータの目標速度を演算し、追随不能であることが判断された場合には、前記偏差と傾斜変化速度に基づいてローリングアクチュエータの目標速度を演算する目標速度演算手段を備えてあることを特徴とする農作業機のローリング制御装置。
【請求項２】
走行機体の左右傾斜傾斜角度を検出する傾斜検出手段を備え、検出された機体傾斜角度に基づいて、走行機体にローリング自在に連結した対地作業装置の左右方向での対地傾斜姿勢が設定傾斜角度に維持されるように、対地作業装置をローリングアクチュエータによって駆動ローリングさせるローリング制御手段を設けてある農作業機のローリング制御装置であって、
現在の走行機体の傾斜変化状態が、ローリングアクチュエータの最大速度で対地作業装置をローリング駆動することで追随可能な状態にあるかどうかを判断する判断手段を備え、
追随可能であることが判断された場合には、目標傾斜方向へローリングアクチュエータを作動させ、追随不能であることが判断された場合には、機体傾斜方向と反対方向へローリングアクチュエータを作動させるよう構成してあることを特徴とする農作業機のローリング制御装置。
【請求項３】
前記判断手段が、機体の傾斜変化速度と、ローリングアクチュエータを最大速度で駆動したときの対地作業装置の傾斜変化速度とを比較して行われるものである請求項１または２に記載の作業機のローリング制御装置。
【請求項４】
前記判断手段が、ローリングアクチュエータの目標長さとローリングアクチュエータの検出長さとの差を設定値に比較して行われるものである請求項１または２に記載の農作業機のローリング制御装置。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、農用トラクタなどの農作業機に利用するローリング制御装置に係り、特には、走行機体の左右傾斜傾斜角度を検出する傾斜検出手段を備え、検出された気体傾斜角度に基づいて、走行機体に駆動ローリング自在に連結した対地作業装置の左右方向での対地傾斜姿勢が設定角度に維持されるように対地作業装置を油圧シリンダなどのローリングアクチュエータによって駆動ローリングさせるローリング制御手段を設けてある農作業機のローリング制御装置に関する。
【０００２】
【従来の技術】
上記ローリング制御装置としては、目標値と検出値との偏差が小さいうちは偏差に応じた速度でローリングシリンダを作動させ、目標値との偏差が大きくなると傾斜状態の変化速度に応じた速度でローリングシリンダを作動させるものが提案されている（特許文献１参照。）。
【０００３】
【特許文献１】
特許第３１８６１１２号公報（第３頁、段落番号「００１４」〜「００１５」、図４）
【０００４】
【発明が解決しようとする課題】
従来の上記ローリング制御装置によると、変化速度が遅い時にはローリングシリンダの作動速度が緩やかに制御され、急激な傾斜地などで傾斜変化速度が速いときにはローリングシリンダの作動速度が速く変更されるものであるが、ローリングシリンダの作動速度には限度があり、好適に機体傾斜に追随させてローリング制御することが困難になることがあった。
【０００５】
本発明は、このような点に着目してなされたものであって、機体傾斜の挙動に応じたローリング制御を行うようにすることで、作業装置のローリング姿勢の安定化を図ることを目的とする。
【０００６】
【課題を解決するための手段】
請求項１に係る発明は、走行機体の左右傾斜角度を検出する傾斜検出手段を備え、検出された機体傾斜角度に基づいて、走行機体にローリング自在に連結した対地作業装置の左右方向での対地傾斜姿勢が設定傾斜角度に維持されるように、対地作業装置をローリングアクチュエータによって駆動ローリングさせるローリング制御手段を設けてある農作業機のローリング制御装置であって、
現在の走行機体の傾斜変化状態が、ローリングアクチュエータの最大速度で対地作業装置をローリング駆動することで追随可能な状態にあるかどうかを判断する判断手段を備え、
追随可能であることが判断された場合には、前記設定傾斜角度と検出傾斜角度との偏差のみに基づいてローリングアクチュエータの目標速度を演算し、追随不能であることが判断された場合には、前記偏差と傾斜変化速度に基づいてローリングアクチュエータの目標速度を演算する目標速度演算手段を備えてあることを特徴とする。
【０００７】
上記構成によると、現在の走行機体の傾斜変化状態が、ローリングアクチュエータの最大速度で対地作業装置をローリング駆動することで追随可能な状態にあるかどうかが判断され、追随可能であることが判断された場合には、設定傾斜角度と検出傾斜角度との偏差のみに基づいてローリングアクチュエータの目標速度が演算されて、その演算された速度でローリングアクチュエータが駆動制御される。また、追随不能であることが判断された場合には、偏差と傾斜変化速度に基づいてローリングアクチュエータの目標速度が演算されて、その演算された速度でローリングアクチュエータが駆動制御される。
【０００８】
請求項２に係る発明は、走行機体の左右傾斜傾斜角度を検出する傾斜検出手段を備え、検出された機体傾斜角度に基づいて、走行機体にローリング自在に連結した対地作業装置の左右方向での対地傾斜姿勢が設定傾斜角度に維持されるように、対地作業装置をローリングアクチュエータによって駆動ローリングさせるローリング制御手段を設けてある農作業機のローリング制御装置であって、
現在の走行機体の傾斜変化状態が、ローリングアクチュエータの最大速度で対地作業装置をローリング駆動することで追随可能な状態にあるかどうかを判断する判断手段を備え、
追随可能であることが判断された場合には、目標傾斜方向へローリングアクチュエータを作動させ、追随不能であることが判断された場合には、機体傾斜方向と反対方向へローリングアクチュエータを作動させるよう構成してあることを特徴とする。
【０００９】
上記構成によると、現在の走行機体の傾斜変化状態が、ローリングアクチュエータの最大速度で対地作業装置をローリング駆動することで追随可能な状態にあるかどうかが判断され、追随可能であることが判断された場合には、目標傾斜方向へローリングアクチュエータが作動制御され、追随不能であることが判断された場合には、機体傾斜方向と反対方向へローリングアクチュエータが作動制御される。
【００１０】
請求項３に係る発明は、請求項１または２の発明において、前記判断手段が、機体の傾斜変化速度と、ローリングアクチュエータを最大速度で駆動したときの対地作業装置の傾斜変化速度とを比較して行われるものである。
【００１１】
上記構成によると、機体の傾斜変化速度とローリングアクチュエータを最大速度で駆動したときの対地作業装置の傾斜変化速度とが比較され、機体の傾斜変化速度のほうが対地作業装を最大速度でローリングさせた場合の傾斜変化速度より大きい場合には、現在の走行機体の傾斜変化状態が対地作業装置を最大速度でローリング駆動しても追随不能であると判断され、また、機体の傾斜変化速度のほうが対地作業装を最大速度でローリングさせた場合の傾斜変化速度以下の場合には、現在の走行機体の傾斜変化状態が対地作業装置を最大速度でローリング駆動して可能であると判断される。
【００１２】
請求項４に係る発明は、請求項１または２の発明において、前記判断手段が、ローリングアクチュエータの目標長さとローリングアクチュエータの検出長さとの差を設定値に比較して行われるものである。
【００１３】
上記構成によると、ローリングアクチュエータの目標長さとローリングアクチュエータの検出長さとの差が予め設定されている設定値に対して比較され、その差が設定値より大きいと、現在の走行機体の傾斜変化状態が対地作業装置を最大速度でローリング駆動しても追随不能であると判断され、また、その差が設定値以下であると、現在の走行機体の傾斜変化状態が対地作業装置を最大速度でローリング駆動して可能であると判断される。
【００１４】
【発明の実施の形態】
以下、本発明の実施の形態を図面に基づいて説明する。
図１は農作業機の一例である農用トラクタの全体を、また、図２はその後部を示しており、走行機体としてのトラクタ本機１は、操向輪としての前輪２と主推進車輪としての後輪３とで走行する４輪駆動型に構成され、機体後部に配備されたミッションケース４に、トップリンク５ａと左右一対のロアーリンク５ｂからなる３点リンク機構５を介して、対地作業装置の一例であるロータリ耕耘装置６が連結されている。ミッションケース４の上部には、単動型の油圧シリンダからなるリフトシリンダ７により上下に揺動駆動される左右一対のリフトアーム８が備えられ、これら左右のリフトアーム８と左右のロアーリンク５ｂとが、リフトロッド９、及び複動型の油圧シリンダからなるローリングアクチュエータ１０を介してそれぞれ連結されている。
【００１５】
図２に示すように、リフトシリンダ７に接続された電磁制御弁１１が制御装置１２により操作されて、リフトシリンダ７及びリフトアーム８によりロータリ耕耘装置６が昇降駆動される。また、ローリングアクチュエータ１０に接続された電磁制御弁１３が制御装置１２により操作されて、ローリングアクチュエータ１０が伸縮作動されることでロータリ耕耘装置６がローリング駆動されて、その左右傾斜角度が変更されるようになっている。
【００１６】
この農用トラクタは、ロータリ耕耘装置６の耕深を設定値に維持する昇降制御、トラクタ本機１に対するロータリ耕耘装置６の高さを任意に調節するポジション制御、および、水平面に対するロータリ耕耘装置６の左右方向の傾斜角度を設定角度に維持するローリング制御が可能となっている。
【００１７】
ロータリ耕耘装置６の後部には、耕耘跡を鎮圧整地する後カバー１５が上下揺動自在かつ下方付勢状態に備えられ、この後カバー１５の上下揺動角度を検出する耕深センサ１６が備えられて、その検出信号が前記制御装置１２に入力されている。他方、制御装置１２には、ダイヤル操作式のポテンショメータからなる耕耘設定器１７と自動耕深制御を入り切りするオンオフスイッチ１８が接続されており、このオンオフスイッチ１８を「入り」にしておくと、耕深センサ１６の検出値が耕深設定器１７の設定値と均衡するように電磁制御弁１１が操作されて、リフトシリンダ７によりロータリ耕耘装置６が自動的に昇降駆動されることで、実耕深が耕深設定器１７の設定値に対応した深さに安定維持されるようになっている。
【００１８】
また、制御装置１２には、リフトアーム８の上下角度を検出する角度センサ１９と、ポジションレバー２０によって操作されるポジション設定器２１が接続されており、前記オンオフスイッチ１８を「切り」にして自動耕深制御を停止した状態では、ポジション制御のみが実行され、角度センサ１９の検出値がポジション設定器２１の設定値と均衡するまで電磁制御弁１１が操作されて、リフトシリンダ７がその位置に保持される。
【００１９】
なお、オンオフスイッチ１８を「入り」にしての自動耕深制御中にポジションレバー２０を大きく上昇方向に操作すると、耕深設定器１７の設定耕深に対応する角度センサ１９の検出値と、ポジション設定器２１の目標値とが比較されて、ポジション設定器２１の目標値の方が高い場合、ポジション制御が優先作動するようになっている。従って、自動耕深制御による耕耘作業において、畦際における機体方向転換時には、ポジションレバー２０を上限にまで操作することにより、ロータリ耕耘装置６を地上に持上げることができ、また、機体方向転換後にポジションレバー２０を下限まで操作することで、耕深設定器１７で設定されている耕深での自動耕深制御を再開することができる。
【００２０】
この農用トラクタでは、ロータリ耕耘装置６の水平面に対する左右方向の傾斜角度を設定角度に維持するようにローリング駆動するローリング制御手段が備えられており、制御装置１２に接続したダイヤル操作式のポテンショメータからなる傾斜設定器２５を調節操作することで、ロータリ耕耘装置６の左右方向の設定角度を任意に変更することができるようになっている。
【００２１】
このローリング制御には、前記傾斜設定器２５の他に、トラクタ本機（走行機体）１の左右傾斜角度を検出する傾斜センサ２６と、トラクタ本機１の左右傾斜方向の角速度を検出する振動ジャイロ型の角速度センサ２７と、ローリングシリンダ９の作動長さを検出するストロークセンサ２８とが利用される。つまり、図４のブロック図に示すように、傾斜センサ２６と角速度センサ２７からの情報に基づいてトラクタ本機１の左右方向での傾斜角度θが演算され、トラクタ本機１がこの傾斜角度θにある時にロータリ耕耘装置５を傾斜設定器２５による設定角度にするために必要なローリングシリンダ９の目標シリンダ長さＬ0 が割り出され、この目標シリンダ長さＬ0 と、ストロークセンサ２８で検出された検出シリンダ長さＬとの偏差に基づいて目標速度が算出され、この目標速度でローリングシリンダ９を作動させるように電磁制御弁１３が制御されるのである。
【００２２】
図５に、傾斜センサ２６と角速度センサ２７からの情報に基づいてトラクタ本機１の左右傾斜角度θを演算する制御ブロック図が示されている。図から判るように、ここでは、角速度センサ２７からの信号を積分することで傾斜角度を演算するとともに、その誤差を傾斜センサ２６からの信号で補正する形態が採用されている。
【００２３】
つまり、温度等の諸条件によってドリフトする角速度センサ２７の零点を時間経過に伴って更新して補正するセンサ零点補正処理がなされる。即ち、角速度センサ２７によって検出されるサンプリング出力値の複数が記憶され、記憶された所定複数のサンプリングデータが平均処理されるとともに、ローパスフィルタ（ＬＰＦ）を用いて平滑化処理されて零点が割り出され、この零点と実検出値との差をゲインＫ1 で積分分処理することで傾斜角度θが演算されるのである。また、このようにして算出された演算傾斜角度θと傾斜センサ２６から得られる検出傾斜角度θｒとの偏差にゲインＫ2 を乗じた値をフィードバックすることで、積分処理による誤差の集積を消去している。
【００２４】
上記した基本的なローリング制御において、対地作業装置６の傾斜姿勢の安定化を図るために、以下のような制御が付加される。
【００２５】
[第１例]
【００２６】
ローリングシリンダ９の目標速度の演算形態を機体傾斜状況によって選択変更することで対地作業装置６の傾斜姿勢の安定化を図ることができる。
【００２７】
図６のフローチャートに示すように、先ず、角速度センサ２７で検出された角速度dθj/dt（傾斜変化速度）が、予め入力され記憶されているローリングアクチュエータ１０が最大速度でローリング駆動された時のロータリ耕耘装置６の角速度と比較され、機体の傾斜変化速度に対して最大速度でローリング駆動して追随可能であるか否かが判断される。
【００２８】
追随可能であることが判断されると、ローリングアクチュエータ１０の目標シリンダ長さＬ0 と検出長さＬとの偏差ΔＬに基づいて目標速度が算出され、追随不能であることが判断されると、前記偏差ΔＬと角速度センサ２７で検出された角速度 dθj/dtに基づいて目標速度が算出される。
【００２９】
[第２例]
【００３０】
機体の傾斜変化速度に対して最大速度でローリング駆動して追随可能であるか否かの判断に基づいて、ローリング作動方向を選択する制御を行うことで対地作業装置６の傾斜姿勢の安定化を図ることもできる。
【００３１】
つまり、図７のフローチャートに示すように、先ず、角速度センサ２７で検出された角速度dθj/dt（傾斜変化速度）が、予め入力され記憶されているローリングアクチュエータ１０が最大速度でローリング駆動された時のロータリ耕耘装置６の角速度と比較され、機体の傾斜変化速度に対して最大速度でローリング駆動して追随可能であるか否かが判断される。
【００３２】
次に、追随可能であることが判断されると、ローリングアクチュエータ１０を目標傾斜方向へ作動させ、追随不能であることが判断されると、機体傾斜方向と反対の方向へ作動させる。なお、この場合のローリングアクチュエータ１０の目標速度はローリングアクチュエータ１０の目標シリンダ長さＬ0 と検出長さＬとの偏差ΔＬに基づいて算出する。
【００３３】
つまり、圃場では同一方向へ傾斜が長く続くことは少なく、左右傾斜が繰り返されることが多いので、傾斜が大きくて追随が困難な場合には逆作動させることで、次に現れる逆方向の傾斜に事前に対応し、むしろ、対地作業装置のローリング姿勢を安定させることができ、結果的に仕上がりの良い作業を行うことができる。
【００３４】
この場合、上記のように、追随可能であるか否かの判断に基づいて作動方向を一義的に切換え選択するのではなく、ファジイ制御を用いて重み付けによって徐々に切換える形態で制御すれば、対地作業装置の傾斜変化をより少なく抑えて作業の仕上がりを向上することも可能となる。
【００３５】
本発明は、以下のような形態で実施することも可能である。
【００３６】
（１）機体斜角度を傾斜センサ２６でのみ検出する使用のものでは、検出した傾斜角の微分、あるいは、微少時間前後の検出傾斜角の差分によって傾斜変化速度を得ることができる。
【００３７】
（２）ローリングアクチュエータ１０の最大速度は、最大速度駆動時における実速度を検出して取り込むこともできる。
【００３８】
（４）走行機体１の傾斜変化状態が、ローリングアクチュエータ１０の最大速度で対地作業装置６をローリング駆動することで追随可能な状態にあるかどうかを判断する形態としては、ローリングアクチュエータ１０の目標長さＬ0と検出長さＬとの差が、予め入力してある設定範囲内であれば追随可能とし、前記設定範囲を越えると追随不能とみなす形態で実施することもできる。
【００３９】
【発明の効果】
以上の説明から明らかなように、本発明によれば、機体傾斜の挙動に応じたローリング制御を行うようにすることで、作業装置のローリング姿勢の安定化を図ることが可能となった。
【図面の簡単な説明】
【図１】農用トラクタ全体の側面図
【図２】農用トラクタの後部を示す斜視図
【図３】制御装置の概略構成を示すブロック図
【図４】ローリング制御装置のブロック図
【図５】傾斜角演算用の制御ブロック図
【図６】ローリング制御のフロー図
【図７】ローリング制御の他の例のフロー図
【符号の説明】
１                走行機体
６                対地作業装置
１０              ローリングアクチュエータ
２６              傾斜センサ
２７              角速度センサ
【図１】
2004187638.tif 000003
【図２】
2004187638.tif 000004
【図３】
2004187638.tif 000005
【図４】
2004187638.tif 000006
【図５】
2004187638.tif 000007
【図６】
2004187638.tif 000008
【図７】
2004187638.tif 000009