| 【発明の名称】 |
トラクタの耕深制御方法 |
| 【発明者】 |
【氏名】坂本 佳三
【氏名】真鍋 秀一
【氏名】塩崎 修司
【氏名】石橋 文雄
|
| 【要約】 |
【課題】トラクタ後部の昇降自在にロータリ耕耘装置を装着し、該ロータリ耕耘装置の耕深を検出する耕深検出手段からのフィードバック量に基づいて耕深制御する構成において、低価格な構成において制御性能を向上することができないものであった。
【解決手段】耕深設定手段１５により設定される耕深設定値とフィードバック量３１との偏差から制御目標量を決定し、ＰＩ制御を行い、耕深制御を行う制御出力を演算し、前記制御目標量の正負の符号と、定常偏差の正負の符号との同異を判断し、異符号の場合には定常偏差を修正するようにした。 |
【特許請求の範囲】
【請求項１】 トラクタ後部の昇降自在にロータリ耕耘装置を装着し、該ロータリ耕耘装置の耕深を検出する耕深検出手段からのフィードバック量に基づいて耕深制御する構成において、耕深設定手段により設定される耕深設定値とフィードバック量との偏差から制御目標量を決定し、ＰＩ制御により、耕深制御を行う制御出力を演算することを特徴とするトラクタの耕深制御方法。
【請求項２】 前記制御目標量の正負の符号と、定常偏差の正負の符号との同異を判断し、異符号の場合には定常偏差を修正したことを特徴とする請求項１記載のトラクタの耕深制御方法。
|
【発明の詳細な説明】【０００１】
【発明の属する技術分野】本発明は現行の耕耘制御システムを低価格なコントローラで構成し、高精度でハンチングを防止し、制御性能を向上する制御方法に関する。
【０００２】
【従来の技術】従来からトラクタ後部の昇降機構にロータリー耕耘装置を装着し、耕耘カバー後部にリアカバーを前後に回動自在に枢支し、耕深に対応してリアカバーが回動され、この回動角度をリアカバーに設置した角度センサー等のリアカバーセンサーで検出し、検出値をフィードバックし、耕深設定ダイアルで設定した設定値に対する偏差を演算し、昇降機構を制御する制御目標量を決定して耕深制御を行っていた。
【０００３】前記リアカバーセンサーにおいては、リアカバーを揺動する程度の微小な変化では昇降動作が行われないように、設定したリアカバーの回動姿勢を基準として不感帯が設定されていた。この不感帯の標準的な範囲は、±２°と設定されていた。この不感帯を外れた時を基点に、１．５秒間に４°以上センサー値が変化すれば、不感帯を±４°に広げてハンチングを抑えるようにし、その後、３秒間内にセンサー値が±４°変化しない時には、ハンチングが抑えられたと見なして標準不感帯である±２°の範囲に戻すように変更可能に構成していた。
【０００４】
【発明が解決しようとする課題】しかし、前記不感帯を±４°に広げると、不感帯が大きいので制御動作がギクシャクし、また、昇降機構を構成する油圧システムの油温や耕耘負荷などの条件変化に対して、耕深制御性能の低下が大きくなっていた。また、ハンチングが一度生じた後に不感帯を±４°に広げて、ハンチングを抑えるようにしており、ハンチングを完全に防止するものではなかった。また、一旦不感帯を±４°に広げるとなかなか標準不感帯に復帰しないため、耕深制御性能が極端に悪化するものであった。
【０００５】
【課題を解決するための手段】本発明はこのような問題点を解消するために、トラクタ後部の昇降自在にロータリ耕耘装置を装着し、該ロータリ耕耘装置の耕深を検出する耕深検出手段からのフィードバック量に基づいて耕深制御する構成において、耕深設定手段により設定される設定値とフィードバック量との偏差から制御目標量を決定し、ＰＩ制御により、耕深制御を行う制御出力を演算するようにしている。また、前記制御目標量の正負の符号と、定常偏差の正負の符号との同異を判断し、異符号の場合には定常偏差を修正したものである。
【０００６】
【発明の実施の形態】本発明が解決しようとする課題及び解決するための手段は以上の如くであり、次に添付の図面に示した実施例の構成を説明する。図１は耕深制御が行われるロータリー耕耘装置を装着したトラクタの側面図、図２は本発明のＰＩ制御方法により耕深制御を行う制御ブロック線図、図３は定常偏差を修正可能なＰＩ制御方法による制御フローチャート図である。
【０００７】図１において、トラクタ後部にアッパーリンクとロアリンクなどより成る昇降リンク機構１が取付けられ、後部のヒッチ装置を用いてロータリ耕耘装置１０が装着される。前記昇降リンク機構１は、昇降シリンダー６によってリフトアーム９が昇降回動され、該リフトアーム９の回動基部には、ポテンショメータ等より成るリフト角センサー１４が配置されてリフトアーム９の角度からロータリ耕耘装置１０の高さが検出され、該リフト角センサー１４が座席１１下方に配置したコントローラ５に接続されている。
【０００８】前記トラクタの座席１１の側方に昇降操作レバー１２が配置され、該昇降操作レバー１２基部には、操作位置を検出するポテンショメータ等より成る図示せぬセンサーが配置されている。該センサーで昇降操作レバー１２の操作位置を検出し、昇降シリンダー６の電磁ソレノイドを駆動し、リフトアーム９を回動してロータリ耕耘装置１０を設定高さとなるようにしている。
【０００９】更に、前記座席１１の側部には、コントロールボックスが配置され、該コントロールボックス内に耕深設定ダイアル１５と自動耕深モードスイッチ１６が配置され、該耕深設定ダイアル１５及び自動耕深モードスイッチ１６をコントローラ５に接続し、自動制御モードにおける耕深を設定するようにしている。
【００１０】また、前記ロータリ耕耘装置１０の耕耘爪の回転軌跡上部には耕耘カバー８が配設され、該耕耘カバー８後部にリアカバー７が枢支されている。該リアカバー７の回動基部には、ポテンショメータ等より成るリアカバーセンサー１８が配置され、該リアカバー７の回動角の変化がリアカバーセンサー１８で検出され、耕深を検出するようにし、該リアカバーセンサー１８はコントローラ５に接続されている。
【００１１】また、図２に示すように、前記コントローラ５には、耕深設定ダイアル１５で設定された耕深設定値が入力される。また、リアカバーセンサー１８で検出したリアカバーセンサー値３１（フィードバック量）がコントローラ５にフィードバックされ、耕深設定値と比較演算して、例えば、実際の耕深が耕深設定値よりも浅い場合、リフトアーム９を下降回動して、耕深設定値とリアカバーセンサー１８からの検出値が一致するまで下降させる。
【００１２】このような構成において、自動耕深モードスイッチ１６が手動の場合には昇降操作レバー１２の回動に応じた高さにリフトアーム９が回動される。自動制御モードに切り替えた場合には、耕深制御が行われる。リアカバー７が不感帯内を回動している間は、油圧シリンダーは駆動されない。そして、リアカバー７が不感帯を越えた場合、設定値とリアカバーセンサー１８からの検出値からその差を演算し、不感帯内に入るように油圧シリンダーを駆動する。
【００１３】そして、本発明の第一形態として、耕深が耕深設定ダイアル１５で設定された耕深設定値となるようにＰＩ制御を行うコントローラ５ａが設けられている。即ち、図２に示すように、前記リアカバーセンサー値３１に基づいて比例制御が行われる。この比例制御にて演算される比例項Ｐは、耕深設定値とリアカバーセンサー値３１（フィードバック量）との差である制御目標量に比例するように演算される。この比例項Ｐによって、耕深設定値に近付けてゆくのであるが、昇降シリンダー６の油温や耕耘負荷などの条件変化の影響を受けて耕深設定値に完全と一致させることが困難となっている。
【００１４】そして、この比例項Ｐによって耕深設定値に完全に一致させることのできなかったズレ（定常偏差）を無くすように積分制御が行われる。該積分制御で演算される積分項Ｉは、偏差の積分値であり、定常偏差がある限り前記比例項Ｐに積分値である積分項Ｉを加算して、定常偏差を無くすようにしている。該定常偏差は、リアカバーセンサー値３１がコントローラ５に入力された際の制御量より判断している。定常偏差がなくなるまで、即ち、設定した耕深となるまで制御が続けられる。よって、このＰＩ制御によって、油温や耕耘負荷などの条件変化に対して、耕深制御を高性能に追随させることができる。
【００１５】次に、前記ＰＩ制御では、耕耘土によるうねり振動などの外乱による高周波域のリアカバー７の振動に対しては、制御出力の応答遅れ（位相遅れ）によりハンチングを発生してしまう。このハンチングを有効に抑制するには、外乱振動の方向（リアカバーセンサー１８のリアカバーセンサー値３１の正負の符号）と制御出力の方向とが同一になることを防止する必要があり、これを防止する方法を、ＰＩ制御用コントローラ５ａ’による制御方法の第二形態としている。
【００１６】この第二形態のＰＩ制御用コントローラ５ａ’では、リアカバーセンサー１８のリアカバーセンサー値３１と耕深設定値との差、すなわち制御目標量の正負の符号が、前記積分項Ｉを演算するための定常偏差の正負の符号とが異なる場合には、積分項Ｉの影響を少なくして、制御出力の位相遅れを防止している。
【００１７】即ち、図３に示すように、先ず、前記リアカバーセンサー１８のリアカバーセンサー値３１である信号をコントローラ５ａ’に入力する。この時、コントローラ５ａ’には耕深設定ダイアル１５により耕深設定値が設定され、その偏差により制御目標量が演算されて第一形態と同様のＰＩ制御を行うようにしている。このＰＩ制御とともに、圃場面の凸凹などによる外乱の影響を無くすために、制御目標量の演算とともに、制御目標量の正負の符号を認識し、この時の定常偏差の正負の符号とが同符号であるか異符号であるかを判断している。そして、同符号である場合には、前述した比例制御に基づき比例項Ｐを演算し、この比例項Ｐに積分項Ｉを加算し、制御出力を演算した通常のＰＩ制御を行うようにしている。
【００１８】これに対して、前記定常偏差の符号と制御目標量の符号とが異符号である場合には、制御出力の方向と逆方向に外乱が生じたとして積分項Ｉによる位相遅れを無くすように、定常偏差の値を減少若しくは零に変換して積分項Ｉを演算し、比例項Ｐに加算して位相遅れを防止する制御出力を演算している。
【００１９】よって、耕耘土によるうねり振動によって、リアカバー７の高周波の振動が生じると、現時点で昇降シリンダー６を耕深制御している方向（制御方向）に対して、同方向と逆方向にリアカバーセンサー値３１が繰り返して入力される。逆方向のリアカバーセンサー値３１が入力された場合には、積分項Ｉを少なくし、この逆方向のリアカバーセンサー値３１に対応して制御出力し、制御出力の位相遅れをなくし、油圧システムである昇降シリンダー６にハンチングを生じることがなくなり、一定の耕深に保たれ、耕深制御の精度が向上される。
【００２０】上記のハンチングを防止する方法は、ＰＩ制御に限定されるものでなく、Ｉ（積分項）を含むすべての制御方向（例えば、ＰＩＤ制御、ＰＩＤ−ＩＤ制御等）に応用できるものである。
【００２１】このように、昇降シリンダー６の油温や耕耘負荷などの条件変化や、耕土のうねり振動や、オペレータ自身の操作による外乱等に対して、市販されているコントローラ５を用いて対応することができ、安価な構成で、耕耘制御の精度を大幅に向上することができる。
【００２２】
【発明の効果】以上のように構成したので、本発明は次のような効果を奏するものである。即ち、請求項１記載のように、トラクタ後部の昇降自在にロータリ耕耘装置を装着し、該ロータリ耕耘装置の耕深を検出する耕深検出手段からのフィードバック量に基づいて耕深制御する構成において、耕深設定手段により設定される設定値とフィードバック量との偏差により制御目標量を求め、該制御目標量と定常偏差とによりＰＩ制御を行い、耕深制御を行う制御出力を演算することによって、制御される油圧システムの油温や耕耘負荷などの条件変化に対して、耕深制御を高性能に追随させることができ、気候の異なる様々な地域における、多様な圃場状態に対応することができる。また、安価なコントローラを用いて精度の高い耕深制御が実現でき、コストを抑えた構成となっている。
【００２３】また、請求項２記載のように、前記制御目標量の正負の符号と、定常偏差の正負の符号との同異を判断し、異符号の場合には定常偏差を修正したことによって、制御している方向に対して逆方向に耕深が変わっていることが伝えられた際に、定常偏差の値を修正して制御量を演算するようにしている。よって、耕耘土によるうねり振動によって、耕深の変化方向が頻繁に変わって、高周波域の周波数としてフィードバックされても、これに対応して制御量が修正されるので、圃場面の耕深の変化に対する位相遅れがなく、耕深制御される油圧システムにハンチングを生じることがなくなり、安価なコントローラを用いて精度の高い耕深制御が実現でき、コストを抑えた構成となっている。
|
| 【出願人】 |
【識別番号】０００００６７８１
【氏名又は名称】ヤンマーディーゼル株式会社
|
| 【出願日】 |
平成１０年（１９９８）２月２０日 |
| 【代理人】 |
【弁理士】
【氏名又は名称】矢野 寿一郎
|
| 【公開番号】 |
特開平１１−２２５５０５ |
| 【公開日】 |
平成１１年（１９９９）８月２４日 |
| 【出願番号】 |
特願平１０−３８９１９ |
|