JP3561335B2

JP3561335B2 - Work vehicle left / right tilt control method

Info

Publication number: JP3561335B2
Application number: JP18959295A
Authority: JP
Inventors: 俊樹平野
Original assignee: Yanma Agricultural Equipment Co Ltd
Current assignee: Yanma Agricultural Equipment Co Ltd
Priority date: 1995-07-25
Filing date: 1995-07-25
Publication date: 2004-09-02
Anticipated expiration: 2015-07-25
Also published as: JPH0939853A

Description

【０００１】
【産業上の利用分野】
本発明は、作業車の左右傾斜制御方法に関する。
【０００２】
【従来の技術】
従来、コンバイン等の作業機では、刈取部で刈り取り、脱穀部で脱穀した穀粒を、選別部に設けた各種シーブで選別して精穀を得るようにしているが、機体が左右傾斜していると、選別中の穀粒が上記シーブの左右側のいずれか一方に偏して選別精度と能率を低下させることがあり、これを防止するために、機体に傾斜角センサを取り付け、同傾斜角センサの出力及び同出力の時間に関する変化率とに基づき比例・微分制御を行い、左右走行装置を機体に対して個別に上下変位させることにより、機体を左右水平に保持する左右水平制御が行われている。
【０００３】
一方、機体を地表から一定の高さに保持する必要があるため、機体の本体と左右走行装置との間に、左右走行装置の本体に対する上下変位量を検出する左右車高センサを取り付けて、各センサ検出値の平均値を車高検出値としてフィードバック制御を行っている。
【０００４】
【発明が解決しようとする課題】
ところが、上述した従来の左右水平制御及び地上高制御では、左右走行装置が本体に対する変位の上下限に達すると、車高制御が作動して左右傾斜制御が阻害されることがある。
【０００５】
また、左右傾斜制御によって、上下限に達していない側の走行装置が上下変位して、車高が次第に目標値から離れて行くという問題がある。
【０００６】
【課題を解決するための手段】
本発明では、左右油圧シリンダの伸縮作動によって走行機体に対して個別に上下変位可能とした左右走行装置と、走行機体の左右傾斜を検出する傾斜角センサと、左右走行装置の上下変位量をそれぞれ検出する左右車高センサと、制御装置とを具備して、制御装置により左右車高センサの検出値から左油圧シリンダに連通した左電磁弁の昇降ソレノイド、または右油圧シリンダに連通した右電磁弁の昇降ソレノイドを制御することにより、走行機体の左右傾斜と車高とを自動的に制御すべく構成した作業車において、制御装置では、傾斜角センサの検出値を逐次読込んで、連続した５個の検出値から移動平均を傾斜角検出値として算出し、この傾斜角検出値と傾斜角目標値との差である傾斜角偏差を算出し、最近算出した傾斜角偏差から前回算出した傾斜角偏差を差引いた値である傾斜角変化率を算出し、この傾斜角変化率の数値と前記傾斜角偏差の数値から制御装置のメモリに記憶した第１ファジーテーブルを用いて傾斜ファジー出力の数値を求める一方、左右車高センサの検出値を演算部に逐次読込んで左右平均値をとり、連続５個の左右平均値の移動平均から車高検出値を算出し、この車高検出値と車高目標値との差を車高偏差として算出し、この車高偏差の数値と前記傾斜ファジー出力の数値から制御装置のメモリに記憶した第２ファジーテーブルを用いて制御信号の数値を求め、この制御信号の数値の絶対値に所定の係数を乗じた後に最小開弁時間を加算した値をパルス周期で除して得られた値をデューティ比としたパルスを制御装置の制御出力部で生成し、制御信号の数値が「０」のときは、制御出力部で生成したパルスの右 ( 左 ) 昇降ソレノイドへの出力を行行わない一方で、制御信号の数値が正の場合は、制御出力部で生成したパルスを右（左）上昇ソレノイドに出力し、制御信号の数値が負のときは、制御出力部で生成したパルスを右（左）下降ソレノイドに出力し、さらに、左右いずれかの車高センサの検出値が予め設定した上限リミット値を逸脱した場合には、逸脱した側の上昇ソレノイドへの出力を禁止するとともに、反対側の昇降ソレノイドへの出力を決定する際の車高偏差の数値を「０」とし、左右いずれかの車高センサの検出値が予め設定した下限リミット値を逸脱した場合には、逸脱した側の下降ソレノイドへの出力を禁止するとともに、反対側の昇降ソレノイドへの出力を決定する際の車高偏差の数値を「０」とすることを特徴とする作業車の左右傾斜制御方法を提供せんとするものである。
【０００７】
【実施例】
本発明の実施例を図面を参照して説明する。
【０００８】
図１及び図２は、本発明に係る車高と左右傾斜との統一制御方法を実施した作業車としてのコンバインＡを示しており、同コンバインＡは、走行機体１の下方に同走行機体１に対し、個別に上下変位可能の左右一対のクローラ式の走行装置２Ｌ，２Ｒを配設しており、走行機体１の機体フレーム３の前端部には、機枠４を介して刈取部５を昇降調節自在に装着しており、同刈取部５には刈取前処理装置として、分草体６と、穀稈引起し装置８と、刈取機構７とが配設されている。
【０００９】
なお、刈取部５には刈取部高さセンサ（図示せず）が装着されており、前記車高と左右傾斜との統一制御方法とは別途の制御装置で、同センサの出力に基づき刈取部５が一定の対地高さを保持するように制御されている。
【００１０】
機体フレーム３の上面には、走行機体１の前方に向かって右側に、前記刈取部５から刈取穀稈を搬入するためのフイードチエン１０を具備した脱穀部１１を配設し、その下方に脱穀された穀粒を選別して精穀にする選別部９を配設し、機体フレーム３の上面左側には、脱穀・選別済みの穀粒を収納する穀粒タンク１２を配設しており、穀粒タンク１２の前方に運転部１３を設けている。
【００１１】
また、前記走行機体１には、エンジン（図示せず）からの動力をミッションケース１４を介して前記刈取部５、脱穀部１１及び選別部９に伝達すると共に、ミッションケース１４の左右側に回動自在に軸支した駆動スプロケット１６を介して左右履帯１７，１７を駆動するようにしている。
【００１２】
左右走行装置２Ｌ，２Ｒは、図３〜図６で示すように、それぞれ前後長手の左右トラックフレーム１８，１８の後端に設けた付勢手段１９によって後方に付勢された緊張スプロケット２０，２０と、左右トラックフレーム１８，１８の下面に適宜間隔を設けて軸支した転輪２２と、前記駆動スプロケット１６とを囲繞した左右履帯１７，１７とで構成されている。
【００１３】
図中、２３はイコライザ支持軸、２４はイコライザ、２５はイコライザ転輪、２６，２７はそれぞれ第１、第２転輪である。
【００１４】
かかる左右走行装置２Ｌ，２Ｒは、機体フレーム３に対して個別に上下変位可能に構成されている。左右走行装置２Ｌ，２Ｒは対称的に構成されているので、左走行装置２Ｌについて説明する。左走行装置２Ｌは、機体フレーム３の下部に前後長手のシャシ３０を設け、同シャシ３０の前後部下面にそれぞれ垂設した前後枢支部３１，３１をそれぞれ挿通する前後支軸３３，３３を介して前後ベルクランク３２，３２の屈折部をそれぞれ回動自在に枢着し、前後ベルクランク３２，３２の下端部３２ａをトラックフレーム１８の内側面に突設した前後枢軸３９，３９に回動自在に枢着して、、上記シャシ３０、前後ベルクランク３２，３２及びとラックフレーム１８で平行リンク機構を形成し、後ベルクランク３２の上端部３２ｂと機体フレーム３に突設した油圧シリンダ支持体３５，３５との間に左油圧シリンダ３６Ｌを介装して、左油圧シリンダ３６Ｌの伸縮作動により、トラックフレーム１８を機体フレーム３に対して上下変位可能としている。図中、３６Ｒは右油圧シリンダ、３４は連結ロッドである。
【００１５】
上記構成により、図６で示すように、左右油圧シリンダ３６Ｌ，３６Ｒを個別に伸縮作動させることにより、左右走行装置２Ｌ，２Ｒを機体に対して個別に上下変位できることになる。
【００１６】
かかるコンバインＡに、本発明要旨の車高と左右傾斜との統一制御方法を実施しており、まず、同制御方法を実施するための制御装置５０について説明する。
【００１７】
制御装置５０は、図７で示すように、検出部５１と、演算部５２と、メモリ５３と、制御出力部５４と、操作部５５とで構成されている。
【００１８】
検出部５１は、機体に取付けられ所定のサンプリング周期で機体の左右傾斜を電圧として検出し、この傾斜検出値（本実施例では−７．５ °〜＋７．５ °の傾斜に対し２．２５Ｖ〜４．２５Ｖ）を演算部５２に対して出力する傾斜角センサ５６と、前記左右油圧シリンダ３６Ｌ，３６Ｒのシリンダ部とピストンロッドとの間に介設されて、所定のサンプリング周期で各油圧シリンダ３６Ｌ，３６Ｒ伸縮のストローク検出（本実施例ではフルストロークに対して１．５Ｖ〜３．５Ｖ）を介して左右走行装置２Ｌ，２Ｒの機体に対する上下変位量を検出する左右車高センサ５７Ｌ，５７Ｒと、各センサ５６，５７Ｌ，５７Ｒと演算部５２との間にそれぞれ介設した１０ビットの分解能を有するＡ／Ｄ変換器５８，５８，５８と、脱穀部１１に設けた脱穀クラッチと連動した脱穀スイッチ６０と、運転部１３に設けた手動左傾スイッチ６１Ｌと、手動右傾スイッチ６１Ｒと、自動スイッチ６３と、オートセットスイッチ６４とで構成されており、各センサ５６，５７Ｌ，５７Ｒ及び各スイッチ６０，６１Ｌ，６１Ｒ，６３，６４の出力を演算部５２に入力するようにしている。
【００１９】
演算部５２は、マイクロプロセッサＭＰＵで構成されており、後述する制御プログラムと、傾斜角の偏差と上記傾斜角の変化率から傾斜ファジー出力を導出可能の第１ファジーテーブルと、上記傾斜ファジー出力と車高の偏差とから制御出力値を導出可能の第２ファジーテーブルとを記憶したメモリ５３を接続しており、検出部５１から入力した検出値に基づき後述する制御プログラムに従い演算を行って、その結果を制御信号として制御出力部５４に出力するようにしている。
【００２０】
制御出力部５４では、演算部５２からの制御信号を電力増幅して、次に述べる左右電磁弁６５Ｌ，６５Ｒの左右昇降ソレノイドＳＬＵ，ＳＬＤ，ＳＲＵ，ＳＲＤを駆動するためのＰＷＭ制御出力を操作部５５に入力するようにしている。
【００２１】
操作部５５は、前記左右油圧シリンダ３６Ｌ，３６Ｒにそれぞれ連通した左右電磁弁６５Ｌ，６５Ｒと、左電磁弁６５Ｌの昇降ソレノイドＳＬＵ，ＳＬＤと、右電磁弁６５Ｒの昇降ソレノイドＳＲＵ，ＳＲＤとで構成されており、制御出力部５４からの制御信号によって、各油圧シリンダ３６Ｌ，３６Ｒに送給される圧油の方向と、ＰＷＭ制御出力のデューティ比によって流量を制御することにより、機体左右側の昇降とこれらの速度を制御するようにしている。
【００２２】
かかる構成の制御装置５０の演算部５２において、検出部５１から入力する検出値を処理して制御信号を生成するのに、本発明要旨の車高と左右傾斜との統一制御方法を実施しており、まず、制御モードの切換について説明する。
【００２３】
制御モードは、自動モード、手動モード、初期設定モードと自動ＯＦＦモードとがあり、各スイッチ操作と各モードとの関係を説明する。
【００２４】
パワーオン又はオートセットスイッチ６４によって、自動モードによる制御のための目標値を予め設定した（例えば、工場出荷時）デフォルト値に設定する。
【００２５】
脱穀スイッチ６０と自動スイッチ６３とが両方ともＯＮのとき自動モードになり、その他の場合は手動モードとなる。
【００２６】
なお、傾斜角センサ５６と左右車高センサ５７Ｌ，５７Ｒとは、手動モード中であってもセンシングと検出値の処理を継続しており、手動モードが終了すると、各目標値を手動操作終了時点から所定時間経過後の連続した５個の検出値の移動平均値（以下、移動平均値という）に更新して自動モードに復帰する。
【００２７】
各目標値の設定には、手動左傾スイッチ６１Ｌと手動右傾スイッチ６１Ｒとによって行われる。
【００２８】
手動左傾スイッチ６１Ｌと手動右傾スイッチ６１Ｒのいずれか一方がＯＮした場合、自動モードから手動モードに切換わり、傾斜角の目標値を、上記スイッチがＯＦＦしてから所定時間（本実施例では１ｓｅｃ）後の傾斜角センサ５６の検出値の移動平均値に更新して自動モードに切換わる。
【００２９】
手動左傾スイッチ６１Ｌと手動右傾スイッチ６１Ｒとが同時にＯＮすると、自動モードから手動モードに切換わり、手動操作が終了すると、車高の目標値を、手動操作終了時点から所定時間（本実施例では１ｓｅｃ）経過後の左右車高センサ５７Ｌ，５７Ｒの検出値の平均値の移動平均値に更新して自動モードに切換わる。
【００３０】
脱穀スイッチ６０がＯＦＦ、自動スイッチ６３がＯＮ，オートセットスイッチ６４が所定時間（本実施例では１０ｓｅｃ）以上ＯＮであると、初期設定モードになり、自己診断出力が連続してランプが点灯してこの旨を表示する。ただし、他の制御が手動モードでない場合は、初期設定モードにならず自動ＯＦＦモードになる。
【００３１】
初期設定モードでは、手動左傾スイッチ６１Ｌと手動右傾スイッチ６１Ｒとが同時に所定時間（本実施例では１０ｓｅｃ）以上ＯＮし、左右車高センサ５７Ｌ，５７Ｒの検出値が両方とも所定の電圧範囲（本実施例では０．８Ｖ〜１．２Ｖ）内であれば、後述する上限リミット値を上記検出値に所定の値を加えた値に設定し、左右車高センサ５７Ｌ，５７Ｒの検出値が両方とも所定の電圧範囲（本実施例では３．８Ｖ〜４．２Ｖ）内であれば、後述する下限リミット値を上記検出値から所定の値を差引いた値に設定して、自動モードに切換わる。
【００３２】
また、自動ＯＦＦモードでは、すべてのソレノイドの駆動を停止する。そして、自動スイッチ６３がＯＮで、脱穀スイッチ６０がＯＮからＯＦＦに切換わると、車高の目標値を再下限にした制御を、車高及び傾斜角センサからの出力が、不感帯に入るまで続行する。その後、傾斜角センサの出力が不感帯を越えると左右車高センサ５７Ｌ，５７Ｒの検出値が下限リミット値になるまで左右のソレノイドを駆動し、その後、自動モードに切換わる。また、上記正動作の途中で手動右傾スイッチ６１Ｒ又は手動左傾スイッチ６１ＬのいずれかがＯＮするか、脱穀スイッチ６０がＯＮすると、上記制御動作を停止する。また、自動ＯＦＦモードの間、左右車高センサ５７Ｌ，５７Ｒの検出値の移動平均値を車高の目標値として記憶する。
【００３３】
なお、オートセットスイッチ６４がＯＮした場合と、自動ＯＦＦモードから自動モードに移行した場合は、傾斜角の目標値を水平状態にリセットする。
【００３４】
次ぎに、自動モードでの制御動作について説明する。本実施例では、ビット数やクロック周波数が小さいマイクロプロセッサやメモリで構成されて、演算速度が遅い制御装置でも処理時間を短縮できるように、ファジーテーブルを二段階にアクセスして制御出力を得るようにしており、図８を参照して説明する。
【００３５】
自動モードでの制御が開始すると、傾斜角センサ５６の検出値と、左右車高センサ５７Ｌ，５７Ｒの検出値を演算部５２に逐次読込んで、連続した５個の検出値の移動平均を算出して傾斜角検出値とし、この値と傾斜角目標値との差を傾斜角偏差とし、この傾斜角偏差から第１ファジーテーブルをアクセスするときの一方の値を求める。この一方の値は、傾斜角偏差を８で除した商が、±７の範囲にあればその値、この商が７より大のときは７、−７より小のときは−７とする。
【００３６】
更に、最近算出した傾斜角偏差から前回算出した傾斜角偏差を差引いた値を傾斜角変化率とし、この傾斜角変化率値から第１ファジーテーブルをアクセスするときの他方の値を求める。この他方の値は、傾斜角変化率を８で除した商が、±７の範囲にあればその値、この商が７より大のときは７、−７より小のときは−７とする。
【００３７】
表１は、表２で示すファジールールに従って設定した第１ファジーテーブルを示しており、縦軸に傾斜角偏差、横軸に傾斜角変化率をとって、上記二つの値がクロスする交点の数値を第２ファジーテーブルをアクセスするときの傾斜ファジー出力とする。
【００３８】
また、左右車高センサ５７Ｌ，５７Ｒから逐次入力する検出値の左右平均値をとり、連続５個の左右平均値の移動平均を算出して車高検出値とし、この値と車高目標値との差を車高偏差とし、この車高偏差から第２ファジーテーブルをアクセスするときの一方の値を求める。この一方の値は、車高偏差を１６で除した商が、±７の範囲にあればその値、この商が７より大のときは７、−７より小のときは−７とする。
【００３９】
【表１】

【００４０】
【表２】

【００４１】
表３は、表４で示すファジールールに従って設定した第２ファジーテーブルを示しており、縦軸に前記傾斜ファジー出力を取り、横軸に車高偏差をとって、上記二つの値がクロスする点の数値を制御出力部５４へファジー出力、すなわち、制御信号として出力する。
【００４２】
【表３】

【００４３】
【表４】

【００４４】
制御出力部54では、上記ファジー出力の制御信号に基づいて、左右電磁弁65L,65Rの昇降ソレノイドSLU,SLD,SRU,SRDを駆動するためのＰＷＭ制御出力を発生する。このＰＷＭ制御出力は、所定の最小開弁時間（本実施例では60msec）にファジー出力の制御信号数値の絶対値に所定係数（本実施例では３msec）を乗じて得た時間を加え、これをパルス周期（本実施例では200msec）で除した値をデューティ比としたパルスである。
【００４５】
右（左）電磁弁６５Ｒ（６５Ｌ）の右（左）昇降ソレノイドＳＲＵ，ＳＲＤ（ＳＬＵ，ＳＬＤ）へのＰＷＭ制御出力は次の通りである。
【００４６】
上記ファジー出力の制御信号が正のときは右（左）上昇ソレノイドSRU(SLU)に出力し、右（左）下降ソレノイドSRD(SLD)には出力しない。

【００４７】
制御出力が０のときは、右（左）昇降ソレノイドＳＲＵ，ＳＲＤ（ＳＬＵ，ＳＬＤ）に出力しない。
【００４８】
制御出力が負のときは、右（左）上昇ソレノイドＳＲＵ（ＳＬＵ）には出力せず、右（左）下降ソレノイドＳＲＤ（ＳＬＤ）に出力する。
【００４９】
また、左右車高センサ５７Ｌ，５７Ｒの検出値に対する上限及び下限リミット値を設定しており、左右いずれかの車高センサの検出値が上限リミット値を逸脱した場合には、逸脱した側の上昇ソレノイドへの出力を禁止すると共に、反対側の昇降ソレノイドへの出力を決定する際の車高偏差に０とし、左右いずれかの車高センサの検出値が下限リミット値を逸脱した場合には、逸脱した側の下降ソレノイドへの出力を禁止すると共に、反対側の昇降ソレノイドへの出力を決定する際の車高偏差に０とする。
【００５０】
図９は、本実施例における制御動作の一例を示しており、車高が目標値よりもやや高く、かつ左右傾斜している場合の機体の姿勢及びこれに対する制御動作の各諸元を示している。
【００５１】
上記のように、傾斜角センサで機体の左右傾斜の偏差と傾斜変化率を検出して、第１ファジーテーブルによって第２ファジーテーブルをアクセスするための傾斜ファジー出力を求め、次いで、上記傾斜ファジー出力と左右車高センサ出力の平均値とで、第２ファジーテーブルをアクセスして最終的なファジー出力を生成するので、ファジー出力に、すべてのセンサの検出値が合理的に加味されることになり、機体の左右傾斜と車高とを統一的に制御することができる。
【００５２】
また、各検出値の移動平均を検出値とすることによって、偶発的な検出値の乱れを抑制して、正確な車高及び左右傾斜の制御を行うことができる。
【００５３】
また、手動モードでの最終状態を検出し、これを車高及び傾斜角の目標値として設定するので、別途目標値設定のための装置と面倒な手続きとを要せず、しかも、状況に即して感覚的に目標値の設定を行うことができる。
【００５４】
更に、手動モード終了から所定時間経過後、各検出値の移動平均を検出値とすることによって、機体の姿勢が安定した状態で、しかも、偶発的な検出値の乱れが抑制された検出値を得ることができる。
【００５５】
なお、本実施例では、ビット数やクロック周波数が小さく演算速度が遅いマイクロプロセッサやメモリで構成された制御装置でも、高速処理ができるようにファジーテーブルを用いたが、ファジーテーブルを用いることなく、ファジー演算アルゴリズムにしたがって制御出力を算出することが可能である。
【００５６】
なお、前記左右電磁弁６５Ｌ，６５Ｒを駆動する油圧ポンプ７０を、刈取部昇降油圧シリンダ等の他の油圧機器７２と共用している場合には、図７で示すように、左右電磁弁６５Ｌ，６５Ｒと油圧ポンプ７０との間に電磁切換弁７１を介設して、左右昇降ソレノイドＳＬＵ，ＳＬＤ，ＳＲＵ，ＳＲＤに出力がある時は、必ず電磁切換弁７１に出力して、油圧ポンプ７０からの圧油の送給先を左右油圧シリンダ３６Ｌ，３６Ｒ側に切換えるようにすればよい。
【００５７】
【発明の効果】
本発明では、機体に対して個別に上下変位可能とした左右走行装置と、機体の左右傾斜を検出する傾斜角センサと、左右走行装置の上下変位量をそれぞれ検出する左右車高センサと、制御装置とを具備して、機体の左右傾斜と車高とを自動的に制御すべく構成した作業車において、制御装置によって、傾斜角の偏差と上記傾斜角の変化率と車高の偏差とから、左右走行装置を上下変位させるための制御信号を生成することによって、制御信号に全てのセンサの検出値が合理的に加味されることになり、機体の左右傾斜と車高とを統一的に制御することができる。
【００５８】
特に、左右走行装置上下変位量が、制御装置に予め設定した上下限リミットを逸脱した場合は、上記リミットを逸脱した側の走行装置の上下変位を停止させ、逸脱していない側の走行装置に、車高の偏差を０として算出した制御信号を出力することによって、車高の変動を防止しながら機体の傾斜角を目標値に近接させることができる。
【図面の簡単な説明】
【図１】本発明に係る車高と左右傾斜との統一制御方法を実施した作業車の側面図。
【図２】同正面図。
【図３】走行装置の側面図。
【図４】走行装置の側面図。
【図５】走行装置の平面図。
【図６】走行装置の正面図。
【図７】制御装置の構成を示す説明図。
【図８】制御動作を示すフローチャート。
【図９】制御動作の一例を示す説明図。
【符号の説明】
Ａ作業車（コンバイン）
２Ｌ左走行装置
２Ｒ右走行装置
５０制御装置
５６傾斜角センサ
５７Ｌ左車高センサ
５７Ｒ右車高センサ[0001]
[Industrial applications]
The present invention relates to a method for controlling the left and right inclination of a work vehicle.
[0002]
[Prior art]
Conventionally, in a working machine such as a combine machine, the husks harvested in the reaping unit and threshed in the threshing unit are sorted by various sheaves provided in the sorting unit to obtain refined grain. In this case, the grain being sorted may be biased to one of the left and right sides of the sieve, reducing the sorting accuracy and efficiency.To prevent this, attach an inclination angle sensor to the machine and Proportional / differential control is performed based on the output of the angle sensor and the rate of change of the output with respect to time, and the left and right horizontal control for holding the aircraft horizontally is performed by vertically displacing the left and right traveling devices individually with respect to the aircraft. Has been done.
[0003]
On the other hand, since it is necessary to hold the aircraft at a certain height from the ground surface, between the main body of the aircraft and the left and right traveling device, a left and right vehicle height sensor that detects the amount of vertical displacement with respect to the main body of the left and right traveling device is attached, Feedback control is performed using the average value of the sensor detection values as the vehicle height detection value.
[0004]
[Problems to be solved by the invention]
However, in the above-described conventional left / right horizontal control and ground height control, when the left / right traveling device reaches the upper and lower limits of the displacement with respect to the main body, the vehicle height control is activated and the left / right inclination control may be hindered.
[0005]
In addition, there is a problem that the traveling device on the side not reaching the upper and lower limits is displaced up and down by the left-right inclination control, and the vehicle height gradually departs from the target value.
[0006]
[Means for Solving the Problems]
According to the present invention, a left and right traveling device that can be individually vertically displaced with respect to the traveling body by the expansion and contraction operation of the left and right hydraulic cylinders, an inclination angle sensor for detecting the left and right inclination of the traveling aircraft, and Equipped with a left and right vehicle height sensor to detect and a control device, the control device controls the elevation solenoid of the left solenoid valve connected to the left hydraulic cylinder from the detection value of the left and right vehicle height sensor, or the right solenoid valve connected to the right hydraulic cylinder In a work vehicle configured to automatically control the left-right inclination and the vehicle height of the traveling vehicle body by controlling the lifting / lowering solenoid of the vehicle, the control device sequentially reads the detection values of the inclination angle sensor, and reads five consecutive values. The moving average is calculated as the tilt angle detection value from the detected value of the tilt angle, the tilt angle deviation, which is the difference between the tilt angle detection value and the tilt angle target value, is calculated. An inclination angle change rate, which is a value obtained by subtracting the output inclination angle deviation, is calculated, and the inclination fuzzy is calculated from the numerical value of the inclination angle change rate and the numerical value of the inclination angle deviation by using a first fuzzy table stored in a memory of the control device. While the output value is obtained, the detection values of the left and right vehicle height sensors are sequentially read into an arithmetic unit, the left and right average values are obtained, and the vehicle height detection value is calculated from a moving average of five consecutive left and right average values. The difference between the vehicle height deviation value and the vehicle height target value is calculated as a vehicle height deviation, and the numerical value of the control signal is calculated from the numerical value of the vehicle height deviation and the numerical value of the inclination fuzzy output using the second fuzzy table stored in the memory of the control device. A pulse having a duty ratio obtained by dividing the value obtained by multiplying the absolute value of the numerical value of the control signal by a predetermined coefficient and then adding the minimum valve opening time by the pulse cycle is used as the duty ratio of the control output of the control device. Generated by the control signal Value when is "0", the output of the pulse of the right (left) lifting solenoid generated by the control output unit while not performing row pulse value of the control signal is in the case of positive, generated by the control output unit Is output to the right (left) ascending solenoid, and when the value of the control signal is negative, the pulse generated by the control output section is output to the right (left) descending solenoid, and the left or right vehicle height sensor is detected. If the value deviates from a preset upper limit value, output to the ascending solenoid on the deviating side is prohibited, and the value of the vehicle height deviation when determining output to the ascending / descending solenoid on the opposite side is set to "0". If the detected value of either the left or right vehicle height sensor deviates from the preset lower limit, output to the deviating descending solenoid is prohibited, and output to the opposite lifting / lowering solenoid is prohibited. Car when making a decision The numerical value of the deviation is intended to provide cents to the lateral inclination control method for a work vehicle, characterized by a "0".
[0007]
【Example】
Embodiments of the present invention will be described with reference to the drawings.
[0008]
FIG. 1 and FIG. 2 show a combine A as a working vehicle in which a unified control method of a vehicle height and a left-right inclination according to the present invention is carried out. On the other hand, a pair of left and right crawler-

type traveling devices

2L and 2R that can be individually displaced up and down are provided, and a mowing unit 5 is provided at the front end of the body frame 3 of the traveling body 1 via the machine frame 4. The harvester 5 is provided with a weeding body 6, a grain stem raising device 8, and a cutting mechanism 7 as a pre-cutting device.
[0009]
A cutting unit height sensor (not shown) is mounted on the cutting unit 5, and is a control device separate from the unified control method of the vehicle height and the left and right inclination. 5 is controlled to maintain a constant ground height.
[0010]
On the upper surface of the machine body frame 3, a threshing unit 11 provided with a feed chain 10 for carrying a harvested grain culm from the cutting unit 5 is disposed on the right side in front of the traveling machine body 1, and threshing is performed below the threshing unit. A sorting unit 9 for sorting the crushed kernels to produce cereal grains is provided, and a grain tank 12 for storing threshed and sorted grains is provided on the upper left side of the body frame 3. An operation unit 13 is provided in front of the grain tank 12.
[0011]
In addition, the traveling body 1 transmits power from an engine (not shown) to the cutting unit 5, threshing unit 11, and sorting unit 9 via a transmission case 14, and rotates the power to the left and right sides of the transmission case 14. The left and

right crawler belts

17, 17 are driven via a drive sprocket 16 which is movably supported.
[0012]
As shown in FIGS. 3 to 6, the right and left

traveling devices

2L and 2R are tensioned

sprockets

20, 20 urged rearward by urging means 19 provided at the rear ends of the left and

right track frames

18, 18, respectively. And rolling wheels 22 which are pivotally supported on the lower surfaces of the left and

right track frames

18, 18 at appropriate intervals, and left and

right crawler belts

17, 17 surrounding the driving sprocket 16.
[0013]
In the figure, 23 is an equalizer support shaft, 24 is an equalizer, 25 is an equalizer wheel, and 26 and 27 are first and second wheels, respectively.
[0014]
The left and right

traveling devices

2L, 2R are configured to be individually vertically displaceable with respect to the body frame 3. Since the left and right

traveling devices

2L and 2R are configured symmetrically, the left traveling device 2L will be described. The left traveling device 2L is provided with a longitudinally extending chassis 30 at a lower portion of the body frame 3 and through longitudinally pivoting

shafts

33, 33, which respectively penetrate longitudinally pivoting portions 31, 31 which are respectively vertically mounted on the lower surfaces of the chassis 30 at the longitudinally lower portions. The bending portions of the front and

rear bell cranks

32, 32 are pivotably connected to each other, and the lower end portions 32a of the front and

rear bell cranks

32, 32 are freely rotatable on front and

rear pivots

39, 39 projecting from the inner surface of the track frame 18. To form a parallel link mechanism with the chassis 30, the front and

rear bell cranks

32, 32 and the rack frame 18, and a hydraulic cylinder support member protruding from the upper end 32b of the rear bell crank 32 and the body frame 3. A left hydraulic cylinder 36L is interposed between 35 and 35, and the track frame 18 is moved relative to the body frame 3 by the expansion and contraction operation of the left hydraulic cylinder 36L. It is made possible under displacement. In the figure, 36R is a right hydraulic cylinder, and 34 is a connecting rod.
[0015]
According to the above configuration, as shown in FIG. 6, the left and right

hydraulic cylinders

36L, 36R are individually extended and retracted, so that the left and right

traveling devices

2L, 2R can be individually vertically displaced relative to the body.
[0016]
For such a combine A, the unified control method of the vehicle height and the left-right inclination according to the gist of the present invention is implemented. First, a control device 50 for implementing the control method will be described.
[0017]
As shown in FIG. 7, the control device 50 includes a detection unit 51, a calculation unit 52, a memory 53, a control output unit 54, and an operation unit 55.
[0018]
The detection unit 51 is mounted on the body and detects the left-right inclination of the body as a voltage at a predetermined sampling cycle, and detects this inclination detection value (2.25 V for the inclination of -7.5 ° to + 7.5 ° in the present embodiment). .About.4.25V) to the calculation unit 52, and is interposed between the cylinder units of the left and right

hydraulic cylinders

36L and 36R and the piston rod, and each hydraulic cylinder is provided at a predetermined sampling cycle. 36L, 36R Left and right

vehicle height sensors

57L, 57R for detecting the amount of vertical displacement of the left and right traveling

devices

2L, 2R with respect to the body via stroke detection of expansion and contraction (1.5 V to 3.5 V for a full stroke in this embodiment). A /

D converters

58, 58, 58 having a 10-bit resolution provided between the

sensors

56, 57L, 57R and the arithmetic unit 52, respectively, and the threshing unit 11 It comprises a threshing switch 60 interlocked with the provided threshing clutch, a manual left tilt switch 61L, a manual right tilt switch 61R, an automatic switch 63, and an auto set switch 64 provided in the operation unit 13, and each sensor 56, The outputs of the

switches

57L, 57R and the

switches

60, 61L, 61R, 63, 64 are input to the arithmetic unit 52.
[0019]
The arithmetic unit 52 is constituted by a microprocessor MPU, a control program described later, a first fuzzy table capable of deriving a tilt fuzzy output from the deviation of the tilt angle and the rate of change of the tilt angle, A memory 53 storing a second fuzzy table capable of deriving a control output value from the deviation of the vehicle height is connected, and a calculation is performed according to a control program described later based on the detection value input from the detection unit 51. The result is output to the control output unit 54 as a control signal.
[0020]
The control output unit 54 power-amplifies the control signal from the arithmetic unit 52 and outputs a PWM control output for driving the left and right solenoids SLU, SLD, SRU, SRD of the left and right solenoid valves 65L, 65R to be described below. 55.
[0021]
The operation unit 55 includes left and right solenoid valves 65L and 65R communicating with the left and right

hydraulic cylinders

36L and 36R, lifting solenoids SLU and SLD of the left solenoid valve 65L, and lifting solenoids SRU and SRD of the right solenoid valve 65R. The control signal from the control output unit 54 controls the direction of the pressure oil supplied to each of the

hydraulic cylinders

36L and 36R and the flow rate according to the duty ratio of the PWM control output, so that the right and left sides of the machine can be raised and lowered. These speeds are controlled.
[0022]
In the arithmetic unit 52 of the control device 50 having such a configuration, in order to process the detection value input from the detection unit 51 and generate a control signal, the unified control method of the vehicle height and the left and right inclination according to the gist of the present invention is implemented. First, switching of the control mode will be described.
[0023]
The control modes include an automatic mode, a manual mode, an initial setting mode, and an automatic OFF mode. The relationship between each switch operation and each mode will be described.
[0024]
The power-on or auto-set switch 64 sets a target value for control in the automatic mode to a preset default value (for example, at the time of factory shipment).
[0025]
The automatic mode is set when both the threshing switch 60 and the automatic switch 63 are ON, and the manual mode is set otherwise.
[0026]
Note that the inclination angle sensor 56 and the left and right

vehicle height sensors

57L and 57R continue sensing and processing of the detected values even during the manual mode. , The moving average value of five consecutive detection values after a predetermined time has elapsed (hereinafter, referred to as a moving average value), and the mode returns to the automatic mode.
[0027]
The setting of each target value is performed by a manual left tilt switch 61L and a manual right tilt switch 61R.
[0028]
When one of the manual left tilt switch 61L and the manual right switch 61R is turned on, the mode is switched from the automatic mode to the manual mode, and the target value of the tilt angle is set for a predetermined time (1 second in this embodiment) after the switch is turned off. The mode is updated to the moving average value of the detected value of the later-described tilt angle sensor 56, and the mode is switched to the automatic mode.
[0029]
When the manual left tilt switch 61L and the manual right tilt switch 61R are simultaneously turned on, the mode is switched from the automatic mode to the manual mode. When the manual operation is completed, the target value of the vehicle height is set to a predetermined time (1 second in this embodiment) from the end of the manual operation. ) After the elapse, the average value of the detected values of the left and right

vehicle height sensors

57L and 57R is updated to the moving average value, and the mode is switched to the automatic mode.
[0030]
If the threshing switch 60 is OFF, the automatic switch 63 is ON, and the automatic set switch 64 is ON for a predetermined time (10 sec in this embodiment), the mode is the initial setting mode, and the self-diagnosis output is continuously turned on to turn on the lamp. This is indicated. However, when the other control is not in the manual mode, the mode is not the initial setting mode but is the automatic OFF mode.
[0031]
In the initial setting mode, the manual left tilt switch 61L and the manual right switch 61R are simultaneously turned on for a predetermined time (10 sec in this embodiment) and the detected values of the left and right

vehicle height sensors

57L and 57R are both within a predetermined voltage range (this embodiment). If it is within 0.8V to 1.2V in the example, the upper limit value described later is set to a value obtained by adding a predetermined value to the above detection value, and the detection values of both the left and right

vehicle height sensors

57L and 57R are both predetermined. If it is within the voltage range (3.8 V to 4.2 V in this embodiment), a lower limit value to be described later is set to a value obtained by subtracting a predetermined value from the detected value, and the mode is switched to the automatic mode.
[0032]
In the automatic OFF mode, driving of all solenoids is stopped. Then, when the automatic switch 63 is ON and the threshing switch 60 is switched from ON to OFF, the control with the target value of the vehicle height set to the lower limit is continued until the output from the vehicle height and inclination angle sensor enters the dead zone. I do. Thereafter, when the output of the inclination angle sensor exceeds the dead zone, the left and right solenoids are driven until the detection values of the left and right

vehicle height sensors

57L and 57R reach the lower limit value, and thereafter, the mode is switched to the automatic mode. When either the manual right tilt switch 61R or the manual left tilt switch 61L is turned on or the threshing switch 60 is turned on during the normal operation, the control operation is stopped. Further, during the automatic OFF mode, the moving average value of the detection values of the left and right

vehicle height sensors

57L and 57R is stored as a target value of the vehicle height.
[0033]
When the auto set switch 64 is turned on and when the mode is shifted from the automatic OFF mode to the automatic mode, the target value of the tilt angle is reset to the horizontal state.
[0034]
Next, the control operation in the automatic mode will be described. In the present embodiment, the control output is obtained by accessing the fuzzy table in two steps so that the processing time can be shortened even with a control device having a small number of bits and a small clock frequency and configured with a microprocessor having a low operation speed. And will be described with reference to FIG.
[0035]
When the control in the automatic mode is started, the detection value of the inclination angle sensor 56 and the detection values of the left and right

vehicle height sensors

57L and 57R are sequentially read into the calculation unit 52, and a moving average of five consecutive detection values is calculated. Then, a difference between this value and the target inclination angle value is defined as an inclination angle deviation, and one value for accessing the first fuzzy table is obtained from the inclination angle deviation. This one value is set to a value obtained by dividing the inclination angle deviation by 8 when the quotient is in the range of ± 7, 7 when the quotient is larger than 7, and -7 when the quotient is smaller than -7.
[0036]
Further, a value obtained by subtracting the previously calculated tilt angle deviation from the recently calculated tilt angle deviation is defined as the tilt angle change rate, and the other value when accessing the first fuzzy table is obtained from the tilt angle change rate value. If the quotient obtained by dividing the inclination angle change rate by 8 is in the range of ± 7, the other value is 7; if the quotient is larger than 7, it is 7; if it is smaller than -7, -7. .
[0037]
Table 1 shows a first fuzzy table set in accordance with the fuzzy rules shown in Table 2, where the vertical axis represents the inclination angle deviation and the horizontal axis represents the inclination angle change rate, and the numerical value of the intersection point where the above two values cross each other Is the slope fuzzy output when accessing the second fuzzy table.
[0038]
Further, the left and right

vehicle height sensors

57L and 57R take the left and right average values of the sequentially inputted detection values, calculate the moving average of the five consecutive left and right average values to obtain the vehicle height detection value, and calculate this value and the vehicle height target value. Is used as the vehicle height deviation, and one value when accessing the second fuzzy table is obtained from the vehicle height deviation. One of the values is a value obtained by dividing the vehicle height deviation by 16 within a range of ± 7, 7 when the quotient is larger than 7, and -7 when the quotient is smaller than -7.
[0039]
[Table 1]

[0040]
[Table 2]

[0041]
Table 3 shows a second fuzzy table set in accordance with the fuzzy rules shown in Table 4, where the ordinate represents the tilted fuzzy output, the abscissa represents the vehicle height deviation, and the point at which the two values intersect. Is output as a fuzzy output to the control output unit 54, that is, as a control signal.
[0042]
[Table 3]

[0043]
[Table 4]

[0044]
The control output unit 54 generates a PWM control output for driving the elevation solenoids SLU, SLD, SRU, SRD of the left and right solenoid valves 65L, 65R based on the fuzzy output control signal . The PWM control output is obtained by adding a time obtained by multiplying the absolute value of the control signal value of the fuzzy output by a predetermined coefficient (3 msec in this embodiment) to a predetermined minimum valve opening time (60 msec in this embodiment), and adding the obtained result. This is a pulse whose duty ratio is a value divided by the pulse period (200 msec in this embodiment).
[0045]
The PWM control output of the right (left) solenoid valve 65R (65L) to the right (left) lifting solenoid SRU, SRD (SLU, SLD) is as follows.
[0046]
When the fuzzy output control signal is positive, the control signal is output to the right (left) ascending solenoid SRU (SLU) and not output to the right (left) ascending solenoid SRD (SLD).

[0047]
When the control output is 0, it is not output to the right (left) lifting solenoids SRU, SRD (SLU, SLD).
[0048]
When the control output is negative, it is not output to the right (left) ascending solenoid SRU (SLU) but is output to the right (left) descending solenoid SRD (SLD).
[0049]
Also, upper and lower limit values for the detected values of the left and right

vehicle height sensors

57L and 57R are set, and if the detected value of any of the left and right vehicle height sensors deviates from the upper limit value, the deviation of the deviated side is increased. When the output to the solenoid is prohibited, the vehicle height deviation when determining the output to the lifting solenoid on the opposite side is set to 0, and if the detection value of either the left or right vehicle height sensor deviates from the lower limit value, The output to the departure side descending solenoid is prohibited, and the vehicle height deviation when determining the output to the opposite side elevating solenoid is set to zero.
[0050]
FIG. 9 illustrates an example of a control operation according to the present embodiment, and illustrates a body attitude when the vehicle height is slightly higher than a target value and the vehicle is tilted left and right, and various specifications of the control operation corresponding thereto. I have.
[0051]
As described above, the inclination angle sensor detects the deviation of the left-right inclination and the inclination change rate of the body, obtains an inclination fuzzy output for accessing the second fuzzy table by the first fuzzy table, and then outputs the inclination fuzzy output. The final fuzzy output is generated by accessing the second fuzzy table with the average value of the left and right vehicle height sensor outputs, so that the detection values of all sensors are reasonably added to the fuzzy output. In addition, the right and left inclination of the body and the vehicle height can be uniformly controlled.
[0052]
In addition, by using the moving average of each detection value as the detection value, accidental disturbance of the detection value can be suppressed, and accurate control of the vehicle height and the left-right inclination can be performed.
[0053]
Further, since the final state in the manual mode is detected and set as the target values of the vehicle height and the inclination angle, a separate device for setting the target values and a cumbersome procedure are not required. The user can intuitively set the target value.
[0054]
Further, after a lapse of a predetermined time from the end of the manual mode, the moving average of the respective detection values is used as the detection value, so that the detection value in which the attitude of the aircraft is stable and accidental disturbance of the detection value is suppressed can be obtained. Obtainable.
[0055]
In this embodiment, a fuzzy table is used so that high-speed processing can be performed even with a control device including a microprocessor or a memory having a small number of bits or a clock frequency and a low operation speed, but without using a fuzzy table. It is possible to calculate the control output according to a fuzzy operation algorithm.
[0056]
When the hydraulic pump 70 for driving the left and right solenoid valves 65L and 65R is shared with another hydraulic device 72 such as a mowing unit elevating hydraulic cylinder, as shown in FIG. An electromagnetic switching valve 71 is provided between the hydraulic pump 70 and the hydraulic pump 70. When an output is provided to the left and right solenoids SLU, SLD, SRU, and SRD, the output is always output to the electromagnetic switching valve 71 and the hydraulic pump 70 The pressure oil supply destination may be switched to the left and right

hydraulic cylinders

36L, 36R.
[0057]
【The invention's effect】
In the present invention, a left and right traveling device capable of vertically displacing with respect to the aircraft, an inclination angle sensor for detecting the lateral inclination of the aircraft, a left and right vehicle height sensor for respectively detecting the vertical displacement of the left and right traveling device, A work vehicle configured to automatically control the left-right inclination and the vehicle height of the fuselage with a control device, the control device determines the inclination angle deviation, the change rate of the inclination angle, and the vehicle height deviation. By generating a control signal for vertically displacing the left-right traveling device, the detection values of all sensors are reasonably added to the control signal, and the left-right inclination of the aircraft and the vehicle height are unified. Can be controlled.
[0058]
In particular, if the amount of vertical displacement of the left and right traveling device deviates from the upper and lower limit set in advance in the control device, the vertical displacement of the traveling device on the side deviating from the limit is stopped, and the traveling device on the side that has not deviated is stopped. By outputting the control signal calculated with the deviation of the vehicle height being 0, the inclination angle of the body can be made close to the target value while preventing the fluctuation of the vehicle height.
[Brief description of the drawings]
FIG. 1 is a side view of a working vehicle in which a unified control method of a vehicle height and a lateral inclination according to the present invention is implemented.
FIG. 2 is a front view of the same.
FIG. 3 is a side view of the traveling device.
FIG. 4 is a side view of the traveling device.
FIG. 5 is a plan view of the traveling device.
FIG. 6 is a front view of the traveling device.
FIG. 7 is an explanatory diagram showing a configuration of a control device.
FIG. 8 is a flowchart showing a control operation.
FIG. 9 is an explanatory diagram showing an example of a control operation.
[Explanation of symbols]
A Work vehicle (combine)
2L Left traveling device 2R Right traveling device 50 Control device 56 Tilt angle sensor 57L Left vehicle height sensor 57R Right vehicle height sensor

Claims

左右油圧シリンダ (36L,36R) の伸縮作動によって走行機体(1)に対して個別に上下変位可能とした左右走行装置(2L,2R)と、走行機体(1)の左右傾斜を検出する傾斜角センサ(56)と、左右走行装置(2L,2R)の上下変位量をそれぞれ検出する左右車高センサ(57L,57R)と、制御装置(50)とを具備して、
制御装置 (50) により左右車高センサ (57L,57R) の検出値から左油圧シリンダ (36L) に連通した左電磁弁 (65L) の昇降ソレノイド (SLU,SLD) 、または右油圧シリンダ (36R) に連通した右電磁弁 (65R) の昇降ソレノイド (SRU,SRD) を制御することにより、走行機体(1)の左右傾斜と車高とを自動的に制御すべく構成した作業車において、
制御装置(50) では、
傾斜角センサ (56) の検出値を逐次読込んで、連続した５個の検出値から移動平均を傾斜角検出値として算出し、
この傾斜角検出値と傾斜角目標値との差である傾斜角偏差を算出し、
最近算出した傾斜角偏差から前回算出した傾斜角偏差を差引いた値である傾斜角変化率を算出し、
この傾斜角変化率の数値と前記傾斜角偏差の数値から制御装置 (50) のメモリ (53) に記憶した第１ファジーテーブルを用いて傾斜ファジー出力の数値を求める一方、
左右車高センサ (57L,57R) の検出値を演算部 (52) に逐次読込んで左右平均値をとり、連続５個の左右平均値の移動平均から車高検出値を算出し、
この車高検出値と車高目標値との差を車高偏差として算出し、
この車高偏差の数値と前記傾斜ファジー出力の数値から制御装置 (50) のメモリ (53) に記憶した第２ファジーテーブルを用いて制御信号の数値を求め、
この制御信号の数値の絶対値に所定の係数を乗じた後に最小開弁時間を加算した値をパルス周期で除して得られた値をデューティ比としたパルスを制御装置 (50) の制御出力部 (54) で生成し、
制御信号の数値が「０」のときは、制御出力部 (54) で生成したパルスの右 ( 左 ) 昇降ソレノイド (SRU,SRD(SLU,SLD)) への出力を行行わない一方で、
制御信号の数値が正の場合は、制御出力部 (54) で生成したパルスを右（左）上昇ソレノイド SRU(SLU) に出力し、
制御信号の数値が負のときは、制御出力部 (54) で生成したパルスを右（左）下降ソレノイド SRD(SLD) に出力し、
さらに、左右いずれかの車高センサ (57L,57R) の検出値が予め設定した上限リミット値を逸脱した場合には、逸脱した側の上昇ソレノイドへの出力を禁止するとともに、反対側の昇降ソレノイドへの出力を決定する際の車高偏差の数値を「０」とし、
左右いずれかの車高センサ (57L,57R) の検出値が予め設定した下限リミット値を逸脱した場合には、逸脱した側の下降ソレノイドへの出力を禁止するとともに、反対側の昇降ソレノイドへの出力を決定する際の車高偏差の数値を「０」とする
ことを特徴とする作業車の左右傾斜制御方法。 Left and right traveling devices (2L, 2R) that can be individually displaced up and down with respect to the traveling machine (1) by the expansion and contraction operation of the left and right hydraulic cylinders (36L, 36R) , and an inclination angle that detects the left and right inclination of the traveling machine (1) A sensor (56) , a left and right vehicle height sensor (57L, 57R) for detecting the amount of vertical displacement of the left and right traveling devices (2L, 2R) , and a control device (50) ,
Controller (50) left and right sides of the vehicle height sensor by (57L, 57R) left electromagnetic valve which communicates with the left hydraulic cylinder (36L) from the detected value of the (65L) of the lift solenoid (SLU, SLD), or the right hydraulic cylinder (36R) By controlling the lifting solenoid (SRU, SRD) of the right solenoid valve (65R) connected to the right solenoid valve (65R) , the work vehicle configured to automatically control the lateral inclination and the vehicle height of the traveling machine (1) ,
In the control device (50) ,
The detection values of the inclination angle sensor (56) are sequentially read, and a moving average is calculated as the inclination angle detection value from five consecutive detection values,
The inclination angle deviation, which is the difference between the inclination angle detection value and the inclination angle target value, is calculated,
Calculate the inclination angle change rate, which is a value obtained by subtracting the previously calculated inclination angle deviation from the recently calculated inclination angle deviation,
From the numerical value of the inclination angle change rate and the numerical value of the inclination angle deviation, a numerical value of the inclination fuzzy output is obtained using the first fuzzy table stored in the memory (53) of the control device (50) .
The detection values of the left and right vehicle height sensors (57L, 57R) are sequentially read into the calculation unit (52) , the left and right average values are obtained, and the vehicle height detection value is calculated from the moving average of five consecutive left and right average values,
The difference between the detected vehicle height value and the target vehicle height value is calculated as a vehicle height deviation,
From the numerical value of the vehicle height deviation and the numerical value of the inclination fuzzy output, a numerical value of a control signal is obtained using a second fuzzy table stored in a memory (53) of the control device (50) ,
Control device pulses the duty ratio value obtained by dividing the pulse period value obtained by adding the minimum valve opening time after multiplied by a predetermined coefficient absolute value of the number of the control signal the control output (50) Generated in part (54) ,
When the value of the control signal is “0”, the pulse generated by the control output unit (54) is not output to the right ( left ) lifting solenoid (SRU, SRD (SLU, SLD)) ,
When the value of the control signal is positive, the pulse generated by the control output unit (54) is output to the right (left) ascending solenoid SRU (SLU) ,
When the value of the control signal is negative, the pulse generated by the control output unit (54) is output to the right (left) descending solenoid SRD (SLD) ,
Further, if the detected value of either the left or right vehicle height sensor (57L, 57R) deviates from the preset upper limit value, the output to the deviating side ascending solenoid is prohibited, and the opposite side elevating solenoid is The value of the vehicle height deviation when determining the output to
If the detected value of either the left or right vehicle height sensor (57L, 57R) deviates from the preset lower limit, output to the deviating descending solenoid is prohibited, and A method for controlling the left and right inclination of a work vehicle, wherein a numerical value of the vehicle height deviation when determining the output is set to “0” .