Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP3556808B2 - Tractor - Google Patents
[go: Go Back, main page]

JP3556808B2 - Tractor - Google Patents

Tractor Download PDF

Info

Publication number
JP3556808B2
JP3556808B2 JP20733097A JP20733097A JP3556808B2 JP 3556808 B2 JP3556808 B2 JP 3556808B2 JP 20733097 A JP20733097 A JP 20733097A JP 20733097 A JP20733097 A JP 20733097A JP 3556808 B2 JP3556808 B2 JP 3556808B2
Authority
JP
Japan
Prior art keywords
delay
deviation
dead zone
delay processing
processing range
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP20733097A
Other languages
Japanese (ja)
Other versions
JPH1132504A (en
Inventor
武二 田中
辰彦 野島
重治 木村
智志 田村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Agricultural Machinery Co Ltd
Original Assignee
Mitsubishi Agricultural Machinery Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Agricultural Machinery Co Ltd filed Critical Mitsubishi Agricultural Machinery Co Ltd
Priority to JP20733097A priority Critical patent/JP3556808B2/en
Publication of JPH1132504A publication Critical patent/JPH1132504A/en
Application granted granted Critical
Publication of JP3556808B2 publication Critical patent/JP3556808B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Soil Working Implements (AREA)
  • Lifting Devices For Agricultural Implements (AREA)

Description

【0001】
【発明の属する技術分野】
本発明は、リフトロッドシリンダを備えるトラクタの技術分野に属するものである。
【0002】
【従来の技術】
一般に、この種トラクタにおいては、作業機の傾斜姿勢を強制的に変化させるリフトロッドシリンダを備えると共に、作業機が設定傾斜を維持するようにリフトロッドシリンダを自動制御するものが知られているが、この様なものでは、目標位置に対する検出位置の偏差が不感帯設定値を越えるまでシリンダ作動を停止させる所謂不感帯を設定し、制御の安定性を確保することが要求される。
【0003】
【発明が解決しようとする課題】
しかるに、前記不感帯を設定するにあたり、不感帯設定値が大きすぎる場合には制御精度が低下する一方、小さすぎる場合には頻繁な作動を阻止できないことになるため、曖昧な中間設定値を設定せざるを得ないのが実状であった。そこで、シリンダ作動状態では、小さな不感帯設定値を用いて良好な制御精度を確保する一方、シリンダ停止状態では、大きな不感帯設定値を用いて頻繁な作動を阻止することが提案されているが、このものでは、偏差が小不感帯設定値と大不感帯設定値との間に位置する状態で長時間停止することが許されるため、制御誤差を長時間に亘って容認し、作業精度を低下させる可能性があった。
【0004】
【課題を解決するための手段】
本発明は、上記の如き実情に鑑みこれらの課題を解決することを目的として創作されたものであって、請求項1の発明は、作業機の傾斜姿勢を強制的に変化させるリフトロッドシリンダと、該リフトロッドシリンダを自動制御する自動制御部とを備え、さらに自動制御部には、目標位置と検出位置との偏差を演算する偏差演算手段と、偏差が不感帯設定値を越える場合にシリンダ作動指令を出力する作動指令出力手段とを設けてなるトラクタにおいて、前記自動制御部に、作動停止状態の偏差が不感帯設定値を越え、かつ遅延処理範囲設定値以内のとき、所定のタイマ時間が経過するまでシリンダ作動指令の出力制限をする遅延処理手段を設けるにあたり、前記複数の遅延処理範囲を多段状に設定すると共に、不感帯に近い遅延処理範囲ほど遅延タイマ時間を長くして、作動停止状態の偏差が不感帯設定値を越えたとき、全遅延タイマのカウントを開始することを特徴とするトラクタである。このようにすることにより、作動停止時には、偏差が不感帯設定値を越えても、遅延処理範囲設定値を越えなければ、リフトロッドシリンダを停止状態に維持するため、頻繁な作動を阻止して良好な安定性を確保することができ、しかも、この状態が所定時間続いた場合には、リフトロッドシリンダを不感帯に向けて作動させるため、不感帯から外れた状態を長時間に亘って容認するものに比して制御精度を向上させることができる。また、偏差が小さい場合には、長く遅延して安定性を重視する一方、偏差が大きい場合には、短く遅延して制御精度を重視するため、安定性を確保しつつ制御精度の向上を計ることができる。さらに、偏差が不感帯から外れたときを基準にして各遅延処理範囲の遅延処理を解除するため、不感帯を中心とする絶対的な遅延処理を行うことができ、その結果、偏差の小さなふらつき(ノイズ等)を許容して安定した制御を行うことができる許りでなく、偏差が大きくふらついた場合には、遅延処理を迅速に解除して良好な制御精度を確保することができる。
請求項2の発明は、作業機の傾斜姿勢を強制的に変化させるリフトロッドシリンダと、該リフトロッドシリンダを自動制御する自動制御部とを備え、さらに自動制御部には、目標位置と検出位置との偏差を演算する偏差演算手段と、偏差が不感帯設定値を越える場合にシリンダ作動指令を出力する作動指令出力手段とを設けてなるトラクタにおいて、前記自動制御部に、作動停止状態の偏差が不感帯設定値を越え、かつ遅延処理範囲設定値以内のとき、所定のタイマ時間が経過するまでシリンダ作動指令の出力制限をする遅延処理手段を設けるにあたり、前記複数の遅延処理範囲を多段状に設定すると共に、不感帯に近い遅延処理範囲ほど遅延タイマ時間を長くして、作動停止状態の偏差が各遅延処理範囲に入ったとき、対応する遅延タイマのカウントを開始するようにし、現在位置する遅延処理範囲よりも不感帯に近い遅延処理範囲の遅延タイマ時間が経過したとき、少なくとも現在位置する遅延処理範囲を解除することを特徴とするトラクタである。このようにすることにより、作動停止時には、偏差が不感帯設定値を越えても、遅延処理範囲設定値を越えなければ、リフトロッドシリンダを停止状態に維持するため、頻繁な作動を阻止して良好な安定性を確保することができ、しかも、この状態が所定時間続いた場合には、リフトロッドシリンダを不感帯に向けて作動させるため、不感帯から外れた状態を長時間に亘って容認するものに比して制御精度を向上させることができる。また、偏差が小さい場合には、長く遅延して安定性を重視する一方、偏差が大きい場合には、短く遅延して制御精度を重視するため、安定性を確保しつつ制御精度の向上を計ることができる。さらに、偏差が各遅延処理範囲に入ったときを基準にして各遅延処理範囲の遅延処理を解除するため、各遅延処理範囲で相対的な遅延処理を行うことができ、その結果、偏差のふらつきを可及的に許容して安定性を重視した制御を行うことができる。そのうえ、偏差が各遅延処理範囲に入ったときを基準にして各遅延処理範囲の遅延処理を解除するにあたり、遅延時間が必要以上に長くなることを回避して制御精度の向上を計ることができる。
請求項3の発明は、作業機の傾斜姿勢を強制的に変化させるリフトロッドシリンダと、該リフトロッドシリンダを自動制御する自動制御部とを備え、さらに自動制御部には、目標位置と検出位置との偏差を演算する偏差演算手段と、偏差が不感帯設定値を越える場合 にシリンダ作動指令を出力する作動指令出力手段とを設けてなるトラクタにおいて、前記自動制御部に、作動停止状態の偏差が不感帯設定値を越え、かつ遅延処理範囲設定値以内のとき、所定のタイマ時間が経過するまでシリンダ作動指令の出力制限をする遅延処理手段を設けるにあたり、前記複数の遅延処理範囲を多段状に設定すると共に、不感帯に近い遅延処理範囲ほど遅延タイマ時間を長くして、現在位置する遅延処理範囲よりも不感帯に近い遅延処理範囲を解除することを特徴とするトラクタである。このようにすることにより、作動停止時には、偏差が不感帯設定値を越えても、遅延処理範囲設定値を越えなければ、リフトロッドシリンダを停止状態に維持するため、頻繁な作動を阻止して良好な安定性を確保することができ、しかも、この状態が所定時間続いた場合には、リフトロッドシリンダを不感帯に向けて作動させるため、不感帯から外れた状態を長時間に亘って容認するものに比して制御精度を向上させることができる。また、偏差が小さい場合には、長く遅延して安定性を重視する一方、偏差が大きい場合には、短く遅延して制御精度を重視するため、安定性を確保しつつ制御精度の向上を計ることができる。さらに、偏差が不感帯側の遅延処理範囲に戻ろうとしたとき、直ちにリフトロッドシリンダを作動させるため、遅延時間が必要以上に長くなることを回避して制御精度の向上を計ることができる。
請求項4の発明は、作業機の傾斜姿勢を強制的に変化させるリフトロッドシリンダと、該リフトロッドシリンダを自動制御する自動制御部とを備え、さらに自動制御部には、目標位置と検出位置との偏差を演算する偏差演算手段と、偏差が不感帯設定値を越える場合にシリンダ作動指令を出力する作動指令出力手段とを設けてなるトラクタにおいて、前記自動制御部に、作動停止状態の偏差が不感帯設定値を越え、かつ遅延処理範囲設定値以内のとき、所定のタイマ時間が経過するまでシリンダ作動指令の出力制限をする遅延処理手段を設けるにあたり、前記複数の遅延処理範囲を多段状に設定すると共に、不感帯に近い遅延処理範囲ほど遅延タイマ時間を長くして、各遅延処理範囲で遅延タイマ時間が経過したとき、それぞれ作動速度が異なるシリンダ作動指令を出力すると共に、不感帯に近い遅延処理範囲のシリンダ作動指令ほど作動速度を遅くし、現在位置する遅延処理範囲の遅延タイマ時間が経過するまで、不感帯に近い隣接遅延処理範囲のシリンダ作動指令を出力することを特徴とするトラクタである。このようにすることにより、作動停止時には、偏差が不感帯設定値を越えても、遅延処理範囲設定値を越えなければ、リフトロッドシリンダを停止状態に維持するため、頻繁な作動を阻止して良好な安定性を確保することができ、しかも、この状態が所定時間続いた場合には、リフトロッドシリンダを不感帯に向けて作動させるため、不感帯から外れた状態を長時間に亘って容認するものに比して制御精度を向上させることができる。また、偏差が小さい場合には、長く遅延して安定性を重視する一方、偏差が大きい場合には、短く遅延して制御精度を重視するため、安定性を確保しつつ制御精度の向上を計ることができる。さらに、不感帯から遠い遅延処理範囲では、リフトロッドシリンダを速く作動させて制御精度を向上させる一方、不感帯に近い遅延処理範囲では、リフトロッドシリンダをゆっくりと作動させて所謂ハンチング現象を防止することができる。そのうえ、遅延処理中でも一段階遅い速度でリフトロッドシリンダを作動させるため、安定性を確保しつつ制御精度の向上を計ることができる。
【0005】
【発明の実施の形態】
次に、本発明の実施の形態の一つを図面に基づいて説明する。図面において、1はトラクタの走行機体であって、該走行機体1の後部には、昇降リンク機構2を介してロータリ等の作業機3が昇降自在に連結されている。そして、前記作業機3は、リフトロッド4を介して昇降リンク機構2を吊持するリフトアーム5の上下揺動に伴って昇降作動する一方、左右何れかのリフトロッド4に介設されるリフトロッドシリンダ6の伸縮に伴って左右傾斜するが、これらの基本構成は何れも従来通りである。
【0006】
7は前記リフトロッドシリンダ6を伸縮作動させるリフトロッド用電磁切換バルブであって、該リフトロッド用電磁切換バルブ7を切換える伸長用ソレノイド8および縮小用ソレノイド9は、インチングパルスに基づく間欠駆動が可能であるため、インチングパルスのデューティ設定(ON時間/周期)に基づいてリフトロッドシリンダ6の作動速度を制御することができるようになっている。
【0007】
10はマイクロコンピュータを用いて構成される制御部であって、該制御部10の入力側には、リフトロッドシリンダ6のシリンダ長を検出するリフトロッドセンサ11、走行機体1の左右傾斜角を検出する傾斜センサ12、傾斜自動制御をON−OFFする傾斜自動スイッチ13、傾斜自動制御の目標傾斜を設定する傾斜設定ボリューム14、傾斜自動制御の感度を作業機の種類等に応じて設定する傾斜感度設定スイッチ15、リフトロッドシリンダ6を手動操作する傾斜手動スイッチ16等が入力インタフェース回路を介して接続される一方、出力側には、リフトロッド用電磁切換バルブ7の伸長用および縮小用ソレノイド8、9等が出力インタフェース回路を介して接続されている。
【0008】
そして、前記制御部10のメインルーチンにおいては、後述する伸縮遅延タイマのセット、伸縮遅延タイマ経過フラグのリセット、伸縮遅延範囲通過フラグのリセット等を行う「初期設定」を実行した後、傾斜感度設定スイッチ15の切換位置に応じて伸縮遅延タイマの設定時間、伸縮遅延範囲の幅、傾斜比較出力制御モード等を切換える「感度セット」、傾斜自動目標値、傾斜手動目標値、平行復帰目標値もしくは現在位置停止目標値をリフトロッド目標値にセットする「傾斜制御」、傾斜設定ボリューム14の操作をチェックする「傾斜設定ボリュームチェック」、リフトロッドセンサ値とリフトロッド目標値との偏差に応じてリフトロッド伸縮指令を出力する「傾斜比較出力制御」等のサブルーチンを繰り返し実行するようになっており、以下、これらのサブルーチンのうち、「傾斜制御」、「傾斜設定ボリュームチェック」および「傾斜比較出力制御」(モード1〜4)をフローチャートに基づいて説明する。尚、伸長作動時と縮小作動時の制御概念は略同一であるため、伸長作動時の説明(フローチャート)は省略する。
【0009】
「傾斜制御」では、まず、平行復帰(作業機上昇時に作業機傾斜を自動的に平行復帰させる機能)であるか否か、または傾斜自動(設定傾斜を目標として作業機傾斜を自動制御する機能)であるか否かを判断する。そして、傾斜自動状態であると判断(平行復帰判断が優先)した場合には、傾斜センサ12の検出値に基づいて演算した傾斜自動目標値をリフトロッド目標値にセットする一方、平行復帰状態であると判断した場合には、予め設定される平行復帰目標値(もしくは現在位置停止目標値)をリフトロッド目標値にセットし、また、何れの状態でもない場合には、傾斜手動スイッチ16の操作信号に基づいて演算した傾斜手動目標値をリフトロッド目標値にセットするが、平行復帰目標値もしくは傾斜手動目標値をセットする場合には、伸縮遅延タイマ経過フラグをセットするようになっている。つまり、傾斜手動スイッチ16の操作時や平行復帰時には、後述する伸縮遅延処理を解除して直ちにリフトロッドシリンダ6を作動させるため、傾斜手動操作において良好な応答性を確保することができる許りでなく、迅速な平行復帰を行うことができるようになっている。
【0010】
「傾斜設定ボリュームチェック」では、現在の傾斜設定ボリュームデータと、所定時間毎に傾斜設定ボリュームデータが格納される傾斜設定記憶データとの差を演算すると共に、その演算結果がボロー(負)であるか否かを判断し、該判断がYESの場合には演算結果を2の補数に変換する。そして、前記演算結果を操作確認データと比較し、その結果、操作確認データよりも演算結果が大きいと判断した場合には、伸縮遅延タイマ経過フラグをセットするようになっている。つまり、傾斜設定ボリューム14が操作された場合には、後述する伸縮遅延処理を解除して直ちにリフトロッドシリンダ6を作動させるため、傾斜設定時において良好な応答性、操作性および設定精度を確保することができるようになっている。
【0011】
「傾斜比較出力制御(モード1)」では、まず、リフトロッドセンサ値とリフトロッド目標値との偏差に基づいてシリンダ作動方向を判断すると共に、偏差が不感帯から外れているか否かを判断する。そして、偏差が不感帯内である場合には、伸縮遅延タイマ、伸縮遅延タイマ経過フラグおよび伸縮遅延範囲通過フラグをリセット(もしくはクリア)した後、伸縮停止指令を出力するが、作動方向が縮側で、かつ偏差が不感帯外である場合には、伸遅延タイマ、伸遅延タイマ経過フラグおよび伸遅延範囲通過フラグをリセットした後、縮小側処理を実行する一方、作動方向が伸側で、かつ偏差が不感帯外である場合には、縮遅延タイマ、縮遅延タイマ経過フラグおよび縮遅延範囲通過フラグをリセットした後、伸長側処理を実行するようになっている。
【0012】
前記縮小側処理では、まず、偏差が遅延範囲(1〜3)であるのか、もしくは遅延範囲外であるのかを判断する。つまり、不感帯に隣接する偏差範囲に遅延範囲を設定し、該遅延範囲では、所定の遅延タイマ時間が経過するまで伸縮作動処理(シリンダ縮小指令出力)を制限する一方、遅延範囲外では、直ちに伸縮作動処理を実行するため、作動停止時の偏差が不感帯から外れても、遅延範囲内であればリフトロッドシリンダ6を停止状態に維持して頻繁な作動を阻止することができ、また、この状態が所定のタイマ時間継続すると、リフトロッドシリンダ6を不感帯に向けて作動させるため、不感帯から外れた状態を長時間に亘って容認する不都合を解消することができるようになっている。
【0013】
前記遅延範囲は、範囲上限偏差H1〜H3(H1<H2<H3)が段階的に相違する複数の遅延範囲1〜3に分割されると共に、不感帯に近い遅延範囲ほど遅延タイマ時間が長く設定されている。即ち、不感帯から外れても、偏差が比較的小さい場合には、伸縮作動処理を長く遅延して頻繁な作動を阻止する一方、偏差が大きい場合には、比較的早い段階で遅延処理を解除して制御精度を確保するようになっている。
【0014】
ところで、「傾斜比較出力制御(モード1)」では、偏差が不感帯内のとき、各遅延範囲1〜3の遅延タイマをクリア(セット)し、偏差が不感帯から外れた状態では、遅延タイマのクリアを実行しないようになっている。つまり、偏差が不感帯から外れたとき全遅延タイマのカウントを開始するため、偏差が不感帯から外れたときを基準にして各遅延範囲1〜3の遅延処理を解除することになる。従って、不感帯を中心とする絶対的な遅延処理を行うため、偏差の小さなふらつきを許容して頻繁な作動を阻止することができる一方、偏差が大きくふらついた場合には、遅延処理を迅速に解除して良好な制御精度を確保することができ、その結果、モード1では、制御精度を重視する作業に適した傾斜自動制御を実行することができるようになっている。
【0015】
また、前記各遅延範囲1〜3では、対応する遅延タイマの経過を判断して遅延タイマ経過フラグをセットし、以降は遅延タイマ経過フラグの内容を参照して遅延解除状態を維持するが、さらに、各遅延範囲1〜3および遅延範囲外では、通過した遅延範囲1〜3を確認するための遅延範囲通過フラグをセットするようになっている。そして、遅延範囲1では、縮遅延タイマ1が経過した場合と、縮遅延範囲3の通過フラグがセットされている場合と、縮遅延範囲2の通過フラグがセットされ、かつ縮遅延タイマ2もしくは3の経過フラグがセットされている場合と、縮遅延範囲1の通過フラグがセットされ、かつ縮遅延タイマ2の経過フラグがセットされている場合とに縮遅延タイマ1経過フラグをセットし、また、遅延範囲2では、縮遅延タイマ2が経過した場合と、縮遅延タイマ1の経過フラグがセットされている場合と、縮遅延範囲3の通過フラグがセットされている場合と、縮遅延範囲2の通過フラグがセットされ、かつ縮遅延タイマ2の経過フラグがセットされている場合とに縮遅延タイマ2経過フラグをセットし、またさらに、遅延範囲3では、縮遅延タイマ3が経過した場合と、縮遅延タイマ2の経過フラグがセットされている場合と、縮遅延タイマ1の経過フラグがセットされている場合と、縮遅延範囲3の通過フラグがセットされている場合とに縮遅延タイマ2経過フラグをセットするようになっている。つまり、偏差が遅延範囲外に達した場合や、遅延タイマの経過に基づいて何れかの遅延範囲が解除された場合には、全ての遅延範囲1〜3を解除するため、不感帯に向けてリフトロッドシリンダ6を一旦作動させた後は、偏差のふらつき等に拘わらず、偏差が不感帯に入るまでシリンダ作動を継続することができるようになっている。
【0016】
また、前記各遅延範囲1〜3では、遅延タイマが経過した場合に、遅延範囲毎に設定される伸縮作動処理を実行するが、各伸縮作動処理1〜3には、それぞれ異なる駆動デューティ(作動速度)が設定され、不感帯に近い遅延範囲ほど低い駆動デューティ(低速作動信号)を出力するようになっている。つまり、不感帯から遠い遅延範囲では、リフトロッドシリンダ6を速く作動させて制御精度を向上させる一方、不感帯に近い遅延範囲では、リフトロッドシリンダ6をゆっくりと作動させて所謂ハンチング現象を防止するようになっている。
【0017】
次に、「傾斜比較出力制御(モード1)」と「傾斜比較出力制御(モード2)」との相違点を説明する。前記「傾斜比較出力制御(モード1)」では、前述した様に、偏差が不感帯から外れたときに全ての遅延タイマ1〜3のカウントを開始するが、「傾斜比較出力制御(モード2)」では、偏差が各遅延範囲1〜3に入るとき、対応する遅延タイマ1〜3のカウントを開始するようになっている。つまり、偏差が各遅延範囲1〜3に入ったときを基準にして各遅延範囲1〜3の遅延処理を解除するため、各遅延範囲1〜3で相対的な遅延処理を行って偏差のふらつきを可及的に許容することができ、その結果、モード2では、安定性を重視する作業に適した傾斜自動制御を実行することができるようになっている。
【0018】
次に、「傾斜比較出力制御(モード2)」と「傾斜比較出力制御(モード3)」との相違点を説明する。前記「傾斜比較出力制御(モード2)」では、「傾斜比較出力制御(モード1)」と同様の遅延解除条件を採用しているが、「傾斜比較出力制御(モード3)」では、現遅延範囲よりも不感帯に近い遅延範囲の遅延タイマが経過したとき、現遅延範囲を解除するという遅延解除条件が追加されている。つまり、偏差が各遅延範囲に入ったときを基準にして各遅延範囲を解除するにあたり、遅延時間が必要以上に長くなることを回避することができるため、モード3では、モード2に比して制御精度を重視する作業に適した傾斜自動制御を実行することができるようになっている。
【0019】
次に、「傾斜比較出力制御(モード2)」と「傾斜比較出力制御(モード4)」との相違点を説明する。前記「傾斜比較出力制御(モード2)」では、「傾斜比較出力制御(モード1)」と同様、遅延タイマが経過するまでリフトロッドシリンダ6を停止状態に維持するが、「傾斜比較出力制御(モード4)」では、遅延タイマが経過するまでのあいだ、不感帯に近い隣接遅延範囲の伸縮作動処理を実行するようになっている。つまり、遅延処理中でも一段階遅い速度でリフトロッドシリンダ6を作動させるため、モード4では、モード2に比して制御精度を重視する作業に適した傾斜自動制御を実行することができるようになっている。尚、「傾斜比較出力制御」の各モード1〜4では、感度(制御精度と安定性とのバランス)が相違する傾斜自動制御を実行することになるが、各モード1〜4において、不感帯幅、遅延範囲数、遅延範囲幅、遅延タイマ時間、遅延範囲出力デューティ等を調節すれば、作業機、作業条件等に応じて極めて細やかな感度調節を行うことができるようになっている。
【0020】
叙述の如く構成されたものにおいて、作業機3を傾斜させるリフトロッドシリンダ6を、リフトロッド目標値とリフトロッド検出値との偏差に基づいて自動的に伸縮制御するものであるが、作動停止状態の偏差が不感帯から外れても、遅延範囲内である場合には、所定のタイマ時間が経過するまでシリンダ作動を制限するため、頻繁な作動を阻止して良好な安定性を確保することができ、しかも、タイマ時間が経過した場合には、リフトロッドシリンダ6を不感帯に向けて作動させるため、不感帯から外れた状態を長時間に亘って容認するものに比して制御精度を向上させることができる。
【0021】
また、複数の遅延範囲1〜3を多段状に設定し、不感帯に近い遅延範囲ほど遅延タイマ時間を長くしたため、偏差が小さい場合には、長く遅延して頻繁なシリンダ作動を阻止することができる一方、偏差が大きい場合には、短く遅延して良好な制御精度を確保することができる。
【0022】
また、モード1においては、作動停止状態の偏差が不感帯から外れたときに全遅延タイマ1〜3のカウントを開始するため、不感帯を中心とする絶対的な遅延処理を行うことができ、その結果、偏差の小さなふらつきを許容して安定した制御を行うことができる許りでなく、偏差が大きくふらついた場合には、遅延処理を迅速に解除して良好な制御精度を確保することができる。
【0023】
また、モード2〜4においては、作動停止状態の偏差が各遅延範囲1〜3に入るときに対応する遅延タイマ1〜3のカウントを開始するため、各遅延範囲1〜3で相対的な遅延処理を行うことができ、その結果、偏差のふらつきを可及的に許容して安定性を重視した制御を行うことができる。
【0024】
また、モード3においては、現遅延範囲2、3よりも不感帯に近い遅延範囲1、2の遅延タイマ1、2が経過したときに現遅延範囲を解除するため、偏差が各遅延範囲1〜3に入ったときを基準にして各遅延範囲1〜3の遅延処理を解除するものでありながら、遅延時間が必要以上に長くなることを回避して制御精度の向上を計ることができる。
【0025】
また、モード1〜4においては、遅延タイマ1〜3が経過した場合に、不感帯に近い遅延範囲1〜3ほど低い駆動デューティを出力するため、不感帯から遠い遅延範囲3では、リフトロッドシリンダ6を速く作動させて制御精度を向上させる一方、不感帯に近い遅延範囲1では、リフトロッドシリンダ6をゆっくりと作動させて所謂ハンチング現象を防止することができる。
【0026】
また、モード4においては、現遅延範囲1〜3の遅延タイマ1〜3が経過するまで、不感帯に近い隣接遅延範囲1、2の駆動デューティを出力するため、遅延処理中でも一段階遅い速度でリフトロッドシリンダ6を作動させることができ、その結果、安定性を確保しつつ制御精度の向上を計ることができる。
【0027】
また、作業機3の種類に応じて各遅延範囲幅や各遅延時間を切換えることが可能であるため、作業機3毎に偏差のふらつき具合が相違したとしても、予め適正な遅延範囲幅や遅延時間を設定しておけば、作業機3の種類に拘わらず、良好な安定性および制御精度を兼ね備えた制御を行うことができる。
【0028】
また、傾斜設定ボリューム14が操作されたとき、全ての遅延範囲1〜3を解除するため、傾斜設定操作時の応答性、操作性および設定精度を向上させることができる。
【0029】
尚、本発明は、前記実施形態に限定されないものであることは勿論であって、例えば現遅延範囲よりも不感帯に近い遅延範囲(通過した遅延範囲)を解除するようにしてもよい。そしてこの場合には、偏差が不感帯側の遅延範囲に戻ろうとしたとき、直ちにリフトロッドシリンダを作動させることができるため、遅延時間が必要以上に長くなることを回避して制御精度の向上を計ることができる。
【図面の簡単な説明】
【図1】トラクタの側面図である。
【図2】制御部の入出力を示すブロック図である。
【図3】メインルーチンを示すフローチャートである。
【図4】「傾斜制御」を示すフローチャートである。
【図5】「傾斜設定ボリュームチェック」を示すフローチャートである。
【図6】「傾斜比較出力制御(モード1)」を示すフローチャートである。
【図7】「傾斜比較出力制御(モード1)」の作用を示すタイミングチャートである。
【図8】「傾斜比較出力制御(モード2)」を示すフローチャートである。
【図9】「傾斜比較出力制御(モード2)」の作用を示すタイミングチャートである。
【図10】「傾斜比較出力制御(モード3)」を示すフローチャートである。
【図11】「傾斜比較出力制御(モード3)」の作用を示すタイミングチャートである。
【図12】「傾斜比較出力制御(モード4)」を示すフローチャートである。
【符号の説明】
1 走行機体
3 作業機
6 リフトロッドシリンダ
7 リフトロッド用電磁切換バルブ
10 制御部
11 リフトロッドセンサ
12 傾斜センサ
[0001]
TECHNICAL FIELD OF THE INVENTION
The present invention belongs to the technical field of a tractor having a lift rod cylinder.
[0002]
[Prior art]
In general, a tractor of this type includes a lift rod cylinder for forcibly changing the inclination posture of a work machine and automatically controls the lift rod cylinder so that the work machine maintains a set inclination. In such a case, it is required to set a so-called dead zone in which the cylinder operation is stopped until the deviation of the detected position from the target position exceeds the dead zone set value, and to ensure control stability.
[0003]
[Problems to be solved by the invention]
However, in setting the dead zone, if the dead zone setting value is too large, the control accuracy is reduced.If the dead zone setting value is too small, frequent operations cannot be prevented. Therefore, an ambiguous intermediate setting value must be set. In fact, it was not possible to obtain. Therefore, it has been proposed that in a cylinder operating state, good control accuracy is secured by using a small dead band setting value, while in a cylinder stopped state, frequent operation is prevented by using a large dead band setting value. In such a case, it is permissible to stop for a long time in a state where the deviation is located between the small dead zone set value and the large dead zone set value, so that a control error may be tolerated for a long time and the work accuracy may be reduced. was there.
[0004]
[Means for Solving the Problems]
The present invention has been created with the object of solving these problems in view of the above-described circumstances,The invention of claim 1 isA lift rod cylinder for forcibly changing the inclination posture of the work machine; and an automatic control unit for automatically controlling the lift rod cylinder. The automatic control unit further includes a deviation for calculating a deviation between a target position and a detected position. In a tractor provided with arithmetic means and operation command output means for outputting a cylinder operation command when the deviation exceeds a dead zone set value, the automatic control unit includes a deviation in the operation stop state exceeding the dead zone set value, and Provide a delay processing means for limiting the output of the cylinder operation command until a predetermined timer time elapses when the delay processing range is within the set value.In the meantime, the plurality of delay processing ranges are set in multiple stages, and the delay processing time is set longer for the delay processing range closer to the dead zone, and when the deviation of the operation stop state exceeds the dead zone setting value, the count of all the delay timers is counted. Characterized by startingTractorIt is. By doing thisWhen the operation is stopped, even if the deviation exceeds the dead zone set value, if the deviation does not exceed the delay processing range set value, the lift rod cylinder is maintained in a stopped state, so that frequent operation is prevented and good stability is secured. In addition, if this state continues for a predetermined time, the lift rod cylinder is operated toward the dead zone, so that the control accuracy is higher than that in which the state deviating from the dead zone is allowed for a long time. Can be improved.When the deviation is small, the delay is long and the stability is emphasized. On the other hand, when the deviation is large, the delay is short and the control accuracy is emphasized. Therefore, the control accuracy is improved while ensuring the stability. be able to. Furthermore, since the delay processing in each delay processing range is canceled based on the time when the deviation deviates from the dead band, absolute delay processing centering on the dead band can be performed. As a result, small fluctuations in the deviation (noise , Etc.), and stable control can be performed. If the deviation greatly fluctuates, the delay processing can be quickly canceled to secure good control accuracy.
The invention according to claim 2 includes a lift rod cylinder for forcibly changing the inclination posture of the work machine, and an automatic control unit for automatically controlling the lift rod cylinder, and further includes a target position and a detection position. In the tractor provided with a deviation calculating means for calculating a deviation of the operation control means and an operation command output means for outputting a cylinder operation command when the deviation exceeds a dead zone set value, the deviation of the operation stop state is provided to the automatic control unit. When the value exceeds the dead zone setting value and is within the delay processing range setting value, in providing the delay processing means for limiting the output of the cylinder operation command until a predetermined timer time elapses, the plurality of delay processing ranges are set in multiple stages. In addition, the delay processing time is set longer for the delay processing range closer to the dead zone, and when the deviation of the operation stop state enters each delay processing range, the corresponding delay timer is set. So as to start counting, when the delay timer time of the delay processing range close to the dead zone has elapsed than the delay processing range of current position, a tractor, characterized in that to release the delay processing range at least the current position. In this way, when the operation is stopped, the lift rod cylinder is maintained in the stopped state unless the deviation exceeds the dead zone set value but does not exceed the delay processing range set value. If this condition continues for a predetermined period of time, the lift rod cylinder is operated toward the dead zone, so that the state deviating from the dead zone can be tolerated for a long time. As a result, the control accuracy can be improved. When the deviation is small, the delay is long and the stability is emphasized. On the other hand, when the deviation is large, the delay is short and the control accuracy is emphasized. Therefore, the control accuracy is improved while ensuring the stability. be able to. Furthermore, since the delay processing of each delay processing range is canceled based on the time when the deviation enters each delay processing range, relative delay processing can be performed in each delay processing range, and as a result, deviation fluctuations Can be performed as much as possible, and control with an emphasis on stability can be performed. In addition, in canceling the delay processing of each delay processing range based on the time when the deviation enters each delay processing range, it is possible to prevent the delay time from becoming unnecessarily long and to improve control accuracy. .
The invention of claim 3 isA lift rod cylinder for forcibly changing the inclination posture of the work machine; and an automatic control unit for automatically controlling the lift rod cylinder. The automatic control unit further includes a deviation for calculating a deviation between a target position and a detected position. Calculation means and when the deviation exceeds the dead band setting value A tractor provided with an operation command output means for outputting a cylinder operation command to the automatic control unit, when the deviation of the operation stop state exceeds the dead band set value and is within the delay processing range set value, a predetermined timer In providing the delay processing means for limiting the output of the cylinder operation command until the time elapses, the plurality of delay processing ranges are set in multiple stages, and the delay processing time is set longer for the delay processing range closer to the dead zone. The tractor is characterized by canceling a delay processing range closer to a dead zone than a located delay processing range. In this way, when the operation is stopped, the lift rod cylinder is maintained in the stopped state unless the deviation exceeds the dead zone set value but does not exceed the delay processing range set value. If this condition continues for a predetermined period of time, the lift rod cylinder is operated toward the dead zone, so that the state deviating from the dead zone can be tolerated for a long time. As a result, the control accuracy can be improved. When the deviation is small, the delay is long and the stability is emphasized. On the other hand, when the deviation is large, the delay is short and the control accuracy is emphasized. Therefore, the control accuracy is improved while ensuring the stability. be able to. Further, when the deviation is to return to the delay processing range on the dead zone side, the lift rod cylinder is operated immediately, so that the delay time is prevented from becoming unnecessarily long and control accuracy can be improved.
The invention according to claim 4 includes a lift rod cylinder for forcibly changing the tilt posture of the work machine, and an automatic control unit for automatically controlling the lift rod cylinder, and further includes a target position and a detection position. In the tractor provided with a deviation calculating means for calculating a deviation of the operation control means and an operation command output means for outputting a cylinder operation command when the deviation exceeds a dead zone set value, the deviation of the operation stop state is provided to the automatic control unit. When the value exceeds the dead zone setting value and is within the delay processing range setting value, in providing the delay processing means for limiting the output of the cylinder operation command until a predetermined timer time elapses, the plurality of delay processing ranges are set in multiple stages. In addition, the delay timer time is set longer in the delay processing range closer to the dead zone, and when the delay timer time elapses in each delay processing range, the operation speed differs. The cylinder operation command is output at the same time as the cylinder operation command in the delay processing range closer to the dead zone. A tractor that outputs an operation command. In this way, when the operation is stopped, the lift rod cylinder is maintained in the stopped state unless the deviation exceeds the dead zone set value but does not exceed the delay processing range set value. If this condition continues for a predetermined period of time, the lift rod cylinder is operated toward the dead zone, so that the state deviating from the dead zone can be tolerated for a long time. As a result, the control accuracy can be improved. When the deviation is small, the delay is long and the stability is emphasized. On the other hand, when the deviation is large, the delay is short and the control accuracy is emphasized. Therefore, the control accuracy is improved while ensuring the stability. be able to. Furthermore, in the delay processing range far from the dead zone, the lift rod cylinder is operated quickly to improve the control accuracy, while in the delay processing range near the dead zone, the lift rod cylinder is operated slowly to prevent the so-called hunting phenomenon. it can. In addition, since the lift rod cylinder is operated at a speed one step slower even during the delay processing, it is possible to improve control accuracy while ensuring stability.
[0005]
BEST MODE FOR CARRYING OUT THE INVENTION
Next, one embodiment of the present invention will be described with reference to the drawings. In the drawings, reference numeral 1 denotes a traveling body of a tractor. A working machine 3 such as a rotary is connected to a rear portion of the traveling body 1 via a lifting link mechanism 2 so as to be able to move up and down. The working machine 3 moves up and down with the vertical swing of a lift arm 5 that suspends the lifting link mechanism 2 via the lift rod 4, while a lift provided on one of the left and right lift rods 4. The rod cylinder 6 inclines left and right as the rod cylinder 6 expands and contracts, but all of these basic configurations are the same as in the past.
[0006]
Numeral 7 denotes an electromagnetic switching valve for a lift rod for extending and retracting the lift rod cylinder 6. An extension solenoid 8 and a reduction solenoid 9 for switching the electromagnetic switching valve 7 for the lift rod can be intermittently driven based on an inching pulse. Therefore, the operation speed of the lift rod cylinder 6 can be controlled based on the duty setting (ON time / cycle) of the inching pulse.
[0007]
Reference numeral 10 denotes a control unit constituted by using a microcomputer. On the input side of the control unit 10, a lift rod sensor 11 for detecting the cylinder length of the lift rod cylinder 6 and a right and left inclination angle of the traveling body 1 are detected. Tilt sensor 12, automatic tilt switch 13 for turning on / off the automatic tilt control, tilt setting volume 14 for setting the target tilt of the automatic tilt control, tilt sensitivity for setting the sensitivity of the automatic tilt control in accordance with the type of work equipment and the like. A setting switch 15, a tilt manual switch 16 for manually operating the lift rod cylinder 6, and the like are connected via an input interface circuit. On the output side, an extension and reduction solenoid 8 of the lift rod electromagnetic switching valve 7, 9 are connected via an output interface circuit.
[0008]
In the main routine of the control unit 10, after performing "initial setting" for setting a telescopic delay timer described later, resetting a telescopic delay timer elapsed flag, resetting a telescopic delay range passage flag, and the like, the tilt sensitivity setting is performed. "Sensitivity set" for switching the setting time of the expansion / contraction delay timer, the width of the expansion / contraction delay range, the inclination comparison output control mode, etc., the inclination automatic target value, the inclination manual target value, the parallel return target value or the current value according to the switching position of the switch 15. "Tilt control" for setting the target position stop value to the lift rod target value, "Tilt setting volume check" for checking the operation of the tilt setting volume 14, and lift rod according to the deviation between the lift rod sensor value and the lift rod target value. A subroutine such as “tilt comparison output control” that outputs an expansion / contraction command is repeatedly executed. , The following, among these subroutines will be described on the basis of "tilt control", "tilt setting volume check" and "slope comparison output control" (the Mode 1-4) to flow. Note that the control concept at the time of the extension operation and the control operation at the time of the contraction operation are substantially the same, so that the description (flow chart) at the time of the extension operation is omitted.
[0009]
In the "tilt control", first, whether the parallel return (the function of automatically returning the work equipment inclination to parallel when the work equipment is lifted) or not, or the automatic inclination (the function of automatically controlling the work equipment inclination with the target of the set inclination) ) Is determined. Then, when it is determined that the vehicle is in the automatic tilt state (parallel return determination has priority), the automatic tilt target value calculated based on the detection value of the tilt sensor 12 is set to the lift rod target value, while in the parallel return state. If it is determined that there is, the preset parallel return target value (or the current position stop target value) is set to the lift rod target value. The tilt manual target value calculated based on the signal is set as the lift rod target value. When the parallel return target value or the tilt manual target value is set, the expansion / contraction delay timer elapsed flag is set. That is, at the time of operating the tilt manual switch 16 or returning to the parallel state, since the expansion / delay delay process described later is canceled and the lift rod cylinder 6 is operated immediately, it is possible to ensure good responsiveness in the tilt manual operation. And a quick parallel return can be performed.
[0010]
In the “tilt setting volume check”, the difference between the current tilt setting volume data and the tilt setting storage data in which the tilt setting volume data is stored at predetermined time intervals is calculated, and the calculation result is borrow (negative). Is determined, and if the determination is YES, the calculation result is converted to a 2's complement number. Then, the calculation result is compared with the operation confirmation data, and as a result, when it is determined that the calculation result is larger than the operation confirmation data, an expansion / contraction delay timer elapse flag is set. That is, when the inclination setting volume 14 is operated, the lift rod cylinder 6 is actuated immediately after the expansion / contraction delay processing described later is canceled, so that good responsiveness, operability, and setting accuracy are ensured when setting the inclination. You can do it.
[0011]
In the “inclination comparison output control (mode 1)”, first, the cylinder operation direction is determined based on the deviation between the lift rod sensor value and the lift rod target value, and it is determined whether the deviation is out of the dead zone. If the deviation is within the dead zone, the telescopic stop timer is output after resetting (or clearing) the telescopic delay timer, the telescopic delay timer elapsed flag, and the telescopic delay range passage flag. If the deviation is out of the dead zone, the expansion delay timer, the expansion delay timer elapsed flag, and the expansion delay range passage flag are reset, and then the reduction side processing is executed, while the operation direction is on the expansion side and the deviation is smaller. If it is outside the dead zone, the decompression side timer is executed after the compression delay timer, the compression delay timer elapsed flag, and the compression delay range passage flag are reset.
[0012]
In the reduction processing, first, it is determined whether the deviation is within the delay range (1 to 3) or outside the delay range. In other words, a delay range is set in a deviation range adjacent to the dead zone, and in this delay range, the expansion / contraction operation process (cylinder reduction command output) is restricted until a predetermined delay timer expires, while the expansion / contraction is performed immediately outside the delay range. Since the operation process is executed, even if the deviation at the time of the operation stoppage is out of the dead zone, if the deviation is within the delay range, the lift rod cylinder 6 can be kept stopped to prevent frequent operation. When a predetermined time has elapsed, the lift rod cylinder 6 is operated toward the dead zone, so that the inconvenience of accepting a state deviating from the dead zone for a long time can be eliminated.
[0013]
The delay range is divided into a plurality of delay ranges 1 to 3 in which range upper limit deviations H1 to H3 (H1 <H2 <H3) differ stepwise, and the delay timer time is set longer as the delay range is closer to the dead zone. ing. That is, if the deviation is relatively small even if it deviates from the dead zone, the expansion / contraction operation processing is delayed for a long time to prevent frequent operations, while if the deviation is large, the delay processing is canceled at a relatively early stage. Control accuracy is ensured.
[0014]
By the way, in the "inclination comparison output control (mode 1)", when the deviation is within the dead zone, the delay timers of the respective delay ranges 1 to 3 are cleared (set), and when the deviation is out of the dead zone, the delay timer is cleared. Not to run. That is, when the deviation deviates from the dead zone, the counting of all delay timers is started, so that the delay processing of each of the delay ranges 1 to 3 is canceled based on the deviation deviating from the dead zone. Therefore, since the absolute delay processing centered on the dead zone is performed, frequent operation can be prevented by allowing a small fluctuation of the deviation, while the delay processing is quickly canceled when the deviation largely fluctuates. As a result, good control accuracy can be ensured, and as a result, in mode 1, it is possible to execute automatic tilt control suitable for work that emphasizes control accuracy.
[0015]
In each of the delay ranges 1 to 3, the elapse of the corresponding delay timer is determined, the delay timer elapse flag is set, and thereafter the delay release state is maintained by referring to the content of the delay timer elapse flag. In each of the delay ranges 1 to 3 and outside the delay range, a delay range passage flag for confirming the passed delay ranges 1 to 3 is set. Then, in the delay range 1, the case where the reduced delay timer 1 has elapsed, the case where the passing flag of the reduced delay range 3 is set, the case where the passing flag of the reduced delay range 2 is set, and the reduced delay timer 2 or 3 Are set, and when the passage flag of the reduced delay range 1 is set and the elapsed flag of the reduced delay timer 2 is set, the reduced delay timer 1 elapsed flag is set. In the delay range 2, when the compressed delay timer 2 has elapsed, when the elapsed flag of the compressed delay timer 1 is set, when the passage flag of the compressed delay range 3 is set, When the passage flag is set and the elapse flag of the reduced delay timer 2 is set, the elapse flag of the reduced delay timer 2 is set. Has elapsed, the elapsed flag of the reduced delay timer 2 has been set, the elapsed flag of the reduced delay timer 1 has been set, and the passage flag of the reduced delay range 3 has been set. Is set to the elapse flag of the contraction delay timer 2. In other words, when the deviation reaches out of the delay range, or when any of the delay ranges is released based on the elapse of the delay timer, all the delay ranges 1 to 3 are released. After the rod cylinder 6 is once operated, the cylinder operation can be continued until the deviation enters the dead zone regardless of the fluctuation of the deviation.
[0016]
In each of the delay ranges 1 to 3, when the delay timer elapses, the expansion / contraction operation process set for each delay range is executed. Speed) is set, and a lower drive duty (low-speed operation signal) is output in a delay range closer to the dead zone. That is, in the delay range far from the dead zone, the lift rod cylinder 6 is operated quickly to improve the control accuracy, while in the delay range near the dead zone, the lift rod cylinder 6 is operated slowly to prevent the so-called hunting phenomenon. Has become.
[0017]
Next, differences between the “inclination comparison output control (mode 1)” and the “inclination comparison output control (mode 2)” will be described. In the "inclination comparison output control (mode 1)", as described above, all the delay timers 1 to 3 start counting when the deviation deviates from the dead zone. When the deviation enters each of the delay ranges 1 to 3, the corresponding delay timers 1 to 3 start counting. In other words, the relative delay processing is performed in each of the delay ranges 1 to 3 to cancel the delay processing in each of the delay ranges 1 to 3 based on when the deviation enters each of the delay ranges 1 to 3. As a result, in the mode 2, it is possible to execute the automatic tilt control suitable for the work in which stability is emphasized.
[0018]
Next, differences between the “inclination comparison output control (mode 2)” and the “inclination comparison output control (mode 3)” will be described. In the “inclination comparison output control (mode 2)”, the same delay release condition as that in the “inclination comparison output control (mode 1)” is adopted. A delay cancellation condition is added to cancel the current delay range when the delay timer of the delay range closer to the dead zone than the range has elapsed. That is, in releasing each delay range based on the time when the deviation enters each delay range, it is possible to prevent the delay time from becoming unnecessarily long. It is possible to execute automatic tilt control suitable for a task that emphasizes control accuracy.
[0019]
Next, differences between the “inclination comparison output control (mode 2)” and the “inclination comparison output control (mode 4)” will be described. In the “inclination comparison output control (mode 2)”, similarly to the “inclination comparison output control (mode 1)”, the lift rod cylinder 6 is kept stopped until the delay timer elapses. In the mode 4), the expansion / contraction operation of the adjacent delay range close to the dead zone is executed until the delay timer elapses. That is, since the lift rod cylinder 6 is operated at a one-step slower speed even during the delay processing, in the mode 4, it is possible to execute the automatic tilt control suitable for the work in which the control accuracy is more important than in the mode 2. ing. In each of the modes 1 to 4 of the “inclination comparison output control”, an automatic tilt control having a different sensitivity (balance between control accuracy and stability) is executed. By adjusting the number of delay ranges, delay range width, delay timer time, delay range output duty, and the like, extremely fine sensitivity adjustment can be performed according to the working machine, work conditions, and the like.
[0020]
In the apparatus configured as described above, the lift rod cylinder 6 that inclines the work machine 3 is automatically controlled to expand and contract based on the deviation between the lift rod target value and the lift rod detection value. Even if the deviation is out of the dead zone, if it is within the delay range, cylinder operation is limited until a predetermined timer time has elapsed, so that frequent operation can be prevented and good stability can be secured. In addition, when the timer time has elapsed, the lift rod cylinder 6 is operated toward the dead zone, so that the control accuracy can be improved as compared with the case where the state deviating from the dead zone is allowed for a long time. it can.
[0021]
Further, since the plurality of delay ranges 1 to 3 are set in multiple stages, and the delay timer time is set longer for the delay range closer to the dead zone, when the deviation is small, the delay is long and the frequent cylinder operation can be prevented. On the other hand, when the deviation is large, it is possible to secure a good control accuracy with a short delay.
[0022]
Further, in mode 1, when the deviation of the operation stop state deviates from the dead zone, the counting of all the delay timers 1 to 3 is started, so that an absolute delay processing centering on the dead zone can be performed. However, when it is not possible to perform stable control while allowing a small fluctuation of the deviation, and when the deviation largely fluctuates, the delay processing can be quickly canceled to secure a good control accuracy.
[0023]
In modes 2 to 4, when the deviation of the operation stop state enters each of the delay ranges 1 to 3, the corresponding delay timers 1 to 3 start counting. Processing can be performed, and as a result, control can be performed with an emphasis on stability while allowing deviation fluctuation as much as possible.
[0024]
In the mode 3, since the current delay range is canceled when the delay timers 1 and 2 of the delay ranges 1 and 2 which are closer to the dead zone than the current delay ranges 2 and 3, the deviation is reduced to each of the delay ranges 1 to 3. While the delay processing of each of the delay ranges 1 to 3 is canceled on the basis of the time of entering, the control accuracy can be improved by preventing the delay time from becoming unnecessarily long.
[0025]
In the modes 1 to 4, when the delay timers 1 to 3 have elapsed, the drive duty is output as low as the delay ranges 1 to 3 closer to the dead zone. Therefore, in the delay range 3 far from the dead zone, the lift rod cylinder 6 is moved. In the delay range 1 close to the dead zone, the lift rod cylinder 6 is operated slowly to prevent the so-called hunting phenomenon, while the control is performed quickly to improve the control accuracy.
[0026]
In the mode 4, the drive duty of the adjacent delay ranges 1 and 2 close to the dead zone is output until the delay timers 1 to 3 of the current delay ranges 1 to 3 elapse. The rod cylinder 6 can be operated, and as a result, control stability can be improved while ensuring stability.
[0027]
Further, since each delay range width and each delay time can be switched according to the type of the work machine 3, even if the degree of deviation of the deviation differs for each work machine 3, an appropriate delay range width and delay If the time is set, control having both good stability and control accuracy can be performed regardless of the type of the work machine 3.
[0028]
Further, when the tilt setting volume 14 is operated, all the delay ranges 1 to 3 are released, so that the responsiveness, operability and setting accuracy at the time of the tilt setting operation can be improved.
[0029]
Note that the present invention is not limited to the above-described embodiment, and for example, a delay range (a passed delay range) closer to the dead zone than the current delay range may be canceled. In this case, when the deviation tries to return to the delay range on the dead zone side, the lift rod cylinder can be operated immediately, so that the delay time is prevented from becoming unnecessarily long and control accuracy is improved. be able to.
[Brief description of the drawings]
FIG. 1 is a side view of a tractor.
FIG. 2 is a block diagram showing input and output of a control unit.
FIG. 3 is a flowchart showing a main routine.
FIG. 4 is a flowchart showing “tilt control”.
FIG. 5 is a flowchart showing “tilt setting volume check”.
FIG. 6 is a flowchart illustrating “inclination comparison output control (mode 1)”;
FIG. 7 is a timing chart showing an operation of “inclination comparison output control (mode 1)”.
FIG. 8 is a flowchart illustrating “inclination comparison output control (mode 2)”.
FIG. 9 is a timing chart showing the operation of “inclination comparison output control (mode 2)”.
FIG. 10 is a flowchart showing “inclination comparison output control (mode 3)”.
FIG. 11 is a timing chart showing the operation of “inclination comparison output control (mode 3)”.
FIG. 12 is a flowchart illustrating “inclination comparison output control (mode 4)”.
[Explanation of symbols]
1 traveling aircraft
3 Working machine
6 Lift rod cylinder
7 Electromagnetic switching valve for lift rod
10 control unit
11 Lift rod sensor
12 Tilt sensor

Claims (4)

作業機の傾斜姿勢を強制的に変化させるリフトロッドシリンダと、該リフトロッドシリンダを自動制御する自動制御部とを備え、さらに自動制御部には、目標位置と検出位置との偏差を演算する偏差演算手段と、偏差が不感帯設定値を越える場合にシリンダ作動指令を出力する作動指令出力手段とを設けてなるトラクタにおいて、前記自動制御部に、作動停止状態の偏差が不感帯設定値を越え、かつ遅延処理範囲設定値以内のとき、所定のタイマ時間が経過するまでシリンダ作動指令の出力制限をする遅延処理手段を設けるにあたり、前記複数の遅延処理範囲を多段状に設定すると共に、不感帯に近い遅延処理範囲ほど遅延タイマ時間を長くして、作動停止状態の偏差が不感帯設定値を越えたとき、全遅延タイマのカウントを開始することを特徴とするトラクタ。A lift rod cylinder for forcibly changing the inclination posture of the work machine; and an automatic control unit for automatically controlling the lift rod cylinder. The automatic control unit further includes a deviation for calculating a deviation between a target position and a detected position. In a tractor provided with arithmetic means and operation command output means for outputting a cylinder operation command when the deviation exceeds a dead zone set value, the automatic control unit includes a deviation in the operation stop state exceeding the dead zone set value, and When providing the delay processing means for limiting the output of the cylinder operation command until the predetermined timer time has elapsed when the delay processing range is within the set value , the plurality of delay processing ranges are set in multiple stages and the delay close to the dead zone is set. When the deviation of the operation stop state exceeds the dead band set value, the delay timer time is set longer for the processing range. Tractor and butterflies. 作業機の傾斜姿勢を強制的に変化させるリフトロッドシリンダと、該リフトロッドシリンダを自動制御する自動制御部とを備え、さらに自動制御部には、目標位置と検出位置との偏差を演算する偏差演算手段と、偏差が不感帯設定値を越える場合にシリンダ作動指令を出力する作動指令出力手段とを設けてなるトラクタにおいて、前記自動制御部に、作動停止状態の偏差が不感帯設定値を越え、かつ遅延処理範囲設定値以内のとき、所定のタイマ時間が経過するまでシリンダ作動指令の出力制限をする遅延処理手段を設けるにあたり、前記複数の遅延処理範囲を多段状に設定すると共に、不感帯に近い遅延処理範囲ほど遅延タイマ時間を長くして、作動停止状態の偏差が各遅延処理範囲に入ったとき、対応する遅延タイマのカウントを開始するようにし、現在位置する遅延処理範囲よりも不感帯に近い遅延処理範囲の遅延タイマ時間が経過したとき、少なくとも現在位置する遅延処理範囲を解除することを特徴とするトラクタ。 A lift rod cylinder for forcibly changing the inclination posture of the work machine; and an automatic control unit for automatically controlling the lift rod cylinder. The automatic control unit further includes a deviation for calculating a deviation between a target position and a detected position. In a tractor provided with arithmetic means and operation command output means for outputting a cylinder operation command when the deviation exceeds a dead zone set value, the automatic control unit includes a deviation in the operation stop state exceeding the dead zone set value, and When providing the delay processing means for limiting the output of the cylinder operation command until the predetermined timer time has elapsed when the delay processing range is within the set value, the plurality of delay processing ranges are set in multiple stages and the delay close to the dead zone is set. The delay timer time is set longer for the processing range, and when the deviation of the operation stop state enters each delay processing range, the corresponding delay timer starts counting. And so, when the delay timer time of the delay processing range close to the dead zone has elapsed than the delay processing range of current position, tractor and cancels the delay processing range at least the current position. 作業機の傾斜姿勢を強制的に変化させるリフトロッドシリンダと、該リフトロッドシリンダを自動制御する自動制御部とを備え、さらに自動制御部には、目標位置と検出位置との偏差を演算する偏差演算手段と、偏差が不感帯設定値を越える場合にシリンダ作動指令を出力する作動指令出力手段とを設けてなるトラクタにおいて、前記自動制御部に、作動停止状態の偏差が不感帯設定値を越え、かつ遅延処理範囲設定値以内のとき、所定のタイマ時間が経過するまでシリンダ作動指令の出力制限をする遅延処理手段を設けるにあたり、前記複数の遅延処理範囲を多段状に設定すると共に、不感帯に近い遅延処理範囲ほど遅延タイマ時間を長くして、現在位置する遅延処理範囲よりも不感帯に近い遅延処理範囲を解除することを特徴とするトラクタ。 A lift rod cylinder for forcibly changing the inclination posture of the work machine; and an automatic control unit for automatically controlling the lift rod cylinder. The automatic control unit further includes a deviation for calculating a deviation between a target position and a detected position. In a tractor provided with arithmetic means and operation command output means for outputting a cylinder operation command when the deviation exceeds a dead zone set value, the automatic control unit includes a deviation in the operation stop state exceeding the dead zone set value, and When providing the delay processing means for limiting the output of the cylinder operation command until the predetermined timer time has elapsed when the delay processing range is within the set value, the plurality of delay processing ranges are set in multiple stages and the delay close to the dead zone is set. more processing range by increasing the delay timer time, and cancels the delay processing range close to the dead band than the delay processing range of the current location tiger Data. 作業機の傾斜姿勢を強制的に変化させるリフトロッドシリンダと、該リフトロッドシリンダを自動制御する自動制御部とを備え、さらに自動制御部には、目標位置と検出位置との偏差を演算する偏差演算手段と、偏差が不感帯設定値を越える場合にシリンダ作動指令を出力する作動指令出力手段とを設けてなるトラクタにおいて、前記自動制御部に、作動停止状態の偏差が不感帯設定値を越え、かつ遅延処理範囲設定値以内のとき、所定のタイマ時間が経過するまでシリンダ作動指令の出力制限をする遅延処理手段を設けるにあたり、前記複数の遅延処理範囲を多段状に設定すると共に、不感帯に近い遅延処理範囲ほど遅延タイマ時間を長くして、各遅延処理範囲で遅延タイマ時間が経過したとき、それぞれ作動速度が異なるシリンダ作動指令を出力すると共に、不感帯に近い遅延処理範囲のシリンダ作動指令ほど作動速度を遅くし、現在位置する遅延処理範囲の遅延タイマ時間が経過するまで、不感帯に近い隣接遅延処理範囲のシリンダ作動指令を出力することを特徴とするトラクタ。 A lift rod cylinder for forcibly changing the inclination posture of the work machine; and an automatic control unit for automatically controlling the lift rod cylinder. The automatic control unit further includes a deviation for calculating a deviation between a target position and a detected position. In a tractor provided with arithmetic means and operation command output means for outputting a cylinder operation command when the deviation exceeds a dead zone set value, the automatic control unit includes a deviation in the operation stop state exceeding the dead zone set value, and When providing the delay processing means for limiting the output of the cylinder operation command until the predetermined timer time has elapsed when the delay processing range is within the set value, the plurality of delay processing ranges are set in multiple stages and the delay close to the dead zone is set. When the delay timer time elapses in each delay processing range, the cylinder operation fingers with different operation speeds are set. And outputs the cylinder operation command of the adjacent delay processing range close to the dead zone until the delay timer time of the delay processing range currently located elapses. A tractor characterized by:
JP20733097A 1997-07-16 1997-07-16 Tractor Expired - Fee Related JP3556808B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP20733097A JP3556808B2 (en) 1997-07-16 1997-07-16 Tractor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP20733097A JP3556808B2 (en) 1997-07-16 1997-07-16 Tractor

Publications (2)

Publication Number Publication Date
JPH1132504A JPH1132504A (en) 1999-02-09
JP3556808B2 true JP3556808B2 (en) 2004-08-25

Family

ID=16537972

Family Applications (1)

Application Number Title Priority Date Filing Date
JP20733097A Expired - Fee Related JP3556808B2 (en) 1997-07-16 1997-07-16 Tractor

Country Status (1)

Country Link
JP (1) JP3556808B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5758271B2 (en) * 2011-11-01 2015-08-05 ヤンマー株式会社 Horizontal control device

Also Published As

Publication number Publication date
JPH1132504A (en) 1999-02-09

Similar Documents

Publication Publication Date Title
KR100216994B1 (en) Bucket Angle Control Method of Hydraulic Shovel
CN113924398B (en) Load handling machine and method of controlling load handling machine
JP3556808B2 (en) Tractor
JP3556809B2 (en) Tractor
JPH06297366A (en) Industrial robot
JP3019361B2 (en) Hydraulic control device
JP3755963B2 (en) Work machine
JPS611838A (en) Auto-desel apparatus
EP3584376B1 (en) Work vehicle and work vehicle control method
JP3173447B2 (en) Solenoid valve control device for hydraulic circuit in industrial vehicles
KR102922411B1 (en) Combine
JP3782586B2 (en) Working vehicle
JP2861224B2 (en) Hydraulic cylinder control device
JP2001303610A (en) Backhoe hydraulic cylinder controller
JPH0699371A (en) Control method utilizing acceleration change of industrial robot
JP3240321B2 (en) Combine
JPH0638875Y2 (en) Unmanned forklift fork controller
JP2875065B2 (en) Hydraulic excavator swing control device
JPH081629Y2 (en) Horizontal control device for agricultural machinery
JP2508811Y2 (en) Automatic control device for work vehicle
JP3203042B2 (en) Backhoe hydraulic cylinder controller
JPH0521523B2 (en)
JPH088562Y2 (en) Raising control device for working unit in ground work vehicle
JPH1098911A (en) Traveling work wagon
JPH0711525Y2 (en) Lifting control device for working unit in field working machine

Legal Events

Date Code Title Description
A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20040209

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20040422

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20040513

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080521

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090521

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100521

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110521

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120521

Year of fee payment: 8

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130521

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130521

Year of fee payment: 9

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

LAPS Cancellation because of no payment of annual fees