[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JP2007129918A - 耕深制御装置 - Google Patents

耕深制御装置 Download PDF

Info

Publication number
JP2007129918A
JP2007129918A JP2005323851A JP2005323851A JP2007129918A JP 2007129918 A JP2007129918 A JP 2007129918A JP 2005323851 A JP2005323851 A JP 2005323851A JP 2005323851 A JP2005323851 A JP 2005323851A JP 2007129918 A JP2007129918 A JP 2007129918A
Authority
JP
Japan
Prior art keywords
deviation
tilling
δθw
control
δθl
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.)
Pending
Application number
JP2005323851A
Other languages
English (en)
Inventor
Toshiyuki Miwa
敏之 三輪
Ryuichi Takeyama
隆一 武山
Hidekazu Nibu
秀和 丹生
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.)
Yanmar Co Ltd
Original Assignee
Yanmar 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 Yanmar Co Ltd filed Critical Yanmar Co Ltd
Priority to JP2005323851A priority Critical patent/JP2007129918A/ja
Publication of JP2007129918A publication Critical patent/JP2007129918A/ja
Pending legal-status Critical Current

Links

Images

Landscapes

  • Lifting Devices For Agricultural Implements (AREA)

Abstract

【課題】車輌本体の姿勢に拘わらず、耕耘機の自動耕深制御の安定化を図り得る構造簡単な耕深制御装置を提供する。
【解決手段】リヤカバー624の回動角度に基づき、車輌本体50に対して昇降可能に連結された耕耘機400の検出耕深位置hDを設定耕深位置hRに追従させる自動耕深制御を行うように構成された耕深制御装置は、車輌本体50の検出傾斜角θW又はθLと閾値傾斜角θW’又はθL’との傾斜偏差ΔθW又はΔθLの大きさに基づき自動耕深制御における制御ゲインKpを変更するように構成されている。
【選択図】図11

Description

本発明は、トラクタ等の車輌本体に対して昇降可能に連結された耕耘機の耕深深さを制御するための耕深制御装置に関する。
トラクタ等の車輌本体に対して昇降可能に連結された耕耘機の自動耕深制御を行う耕深制御装置として、例えば、前記耕耘機を前記車輌本体に対して昇降させる昇降用アクチュエータと、前記耕耘機の耕深深さを設定する耕深深さ設定手段と、前記耕耘機の耕耘位置を検出する耕耘位置検出手段と、前記昇降用アクチュエータを作動させる制御手段とを備えた耕深制御装置が知られている(例えば、下記特許文献1参照)。
詳しくは、前記耕耘機は、耕耘爪軸と、該耕耘爪軸に設けられた耕耘爪と、該耕耘爪の回転軌跡の上方を覆う耕耘上面カバーと、該耕耘上面カバーの後端部に揺動可能に連結された耕耘リヤカバーとを有している。
前記耕深深さ設定手段は、設定耕深位置(目標耕深位置)として、前記耕耘上面カバーに対する前記耕耘リヤカバーの回動角度を設定し、一方、前記耕深位置検出手段は、実耕深位置(検出耕深位置)として、前記耕耘上面カバーに対する前記耕耘リヤカバーの回動角度を検出している。
そして、前記制御手段は、前記検出耕深位置と前記設定耕深位置との耕深偏差に基づいて、前記昇降用アクチュエータの制御条件を算出し、該制御条件に基づき前記検出耕深位置が前記設定耕深位置と一致するように前記昇降用アクチュエータを作動させることで、自動耕深制御を行っている。
なお、前記制御条件には、例えば、前記耕耘機の昇降動に伴う前記耕耘位置検出手段の検出感度変化による悪影響を補償する為のもの、例えば、前記耕深偏差に基づく制御信号に乗算される制御ゲインや前記耕深偏差に対する不感帯幅、又は、前記検出耕深位置の入力経路及び/又は前記昇降用アクチュエータへの出力経路に介挿されるフィルタの遮断周波数範囲が含まれる。
しかしながら、従来の耕深制御装置においては、前記制御ゲイン、前記不感帯幅及び前記フィルタによって遮断される周波数の範囲を含む前記制御条件が、前記車輌本体の姿勢に拘わらず、一定とされていた為、該車輌本体の姿勢によっては、該自動耕深制御が不安定となり、場合によっては、ハンチング現象が発生するという問題があった。
即ち、前述の通り、前記自動耕深制御は、前記リヤカバーの回動角度に基づいて行われるが、斯かるリヤカバーの回動角度は、前記車輌本体の姿勢によって変動する。
例えば、前記車輌本体が左右方向に傾斜したり、若しくは、前傾又は後傾となると、これに応じて、前記リヤカバーの回動角度が変動し、前記自動耕深制御の制御性が悪化する。
特に、前輪が坂にさしかかった際や凹凸の多い場所を耕耘する際のように持続的な外乱の入力がある場合には、斯かる問題が生じ易い。
特開2000−41415号公報
本発明は、前記従来技術に鑑みなされたものであり、車輌本体の姿勢に拘わらず、耕耘機の自動耕深制御の安定化を図り得る構造簡単な耕深制御装置の提供を、一の目的とする。
本発明は、前記課題を解決するために、次の第1から第3態様の耕深制御装置を提供する。
(1)第1態様の耕深制御装置
リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさに基づき自動耕深制御における制御ゲインを変更するように構成したことを特徴とする耕深制御装置。
(2)第2態様の耕深制御装置
リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさに基づき自動耕深制御における不感帯幅を変更するように構成したことを特徴とする耕深制御装置。
(3)第3態様の耕深制御装置
リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさに基づき自動耕深制御におけるフィルタリング条件を変更するように構成したことを特徴とする耕深制御装置。
本発明に係る第1から第3態様の耕深制御装置において、前記傾斜偏差の大きさとしては、代表的には、所定時間内(又は所定サンプリング数)における平均値を例示できる。ここで、前記平均値は、単純平均値、重みつき平均値、単純移動平均値、重みつき移動平均値等を含む概念である。また、前記平均値の概念と同様の観点から、前記偏差の大きさは、所定時間内(又は所定サンプリング数)における積分値であってもよい。
本発明に係る第1から第3態様の耕深制御装置において、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさは、例えば、次のように求めることができる。即ち、
(a)前記車輌本体の前後方向に関する傾斜角を検出する車輌傾斜角検出手段による検出値と前記閾値傾斜角とに基づいて求める場合、
(b)前記耕耘機の前記車輌本体に対する上下方向に関するリフト角を検出するリフト角検出手段による検出値と前記閾値傾斜角とに基づいて求める場合である。
本発明はまた、前記課題を解決するために、次の第4から第6態様の耕深制御装置も提供する。
(4)第4態様の耕深制御装置
リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさに基づき自動耕深制御における制御ゲインを変更するように構成したことを特徴とする耕深制御装置。
(5)第5態様の耕深制御装置
リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさに基づき自動耕深制御における不感帯幅を変更するように構成したことを特徴とする耕深制御装置。
(6)第6態様の耕深制御装置
リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさに基づき自動耕深制御におけるフィルタリング条件を変更するように構成したことを特徴とする耕深制御装置。
前記第4から第6態様の耕深制御装置において、前記傾斜偏差の変化割合の大きさとしては、代表的には、所定時間内(又は所定サンプリング数)における平均値を例示できる。ここで、前記平均値は、単純平均値、重みつき平均値、単純移動平均値、重みつき移動平均値等を含む概念である。また、前記平均値の概念と同様の観点から、前記偏差の大きさは、所定時間内(又は所定サンプリング数)における積分値であってもよい。
本発明に係る第4から第6態様の耕深制御装置において、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさは、例えば、次のように求めることができる。即ち、
(a)前記車輌本体の前後方向に関する傾斜角速度を検出する車輌傾斜角速度検出手段による検出値と閾値傾斜角速度とに基づいて求める場合、
(b)前記車輌本体の前後方向に関する傾斜角を検出する車輌傾斜角検出手段による検出値と前記閾値傾斜角との傾斜偏差の時間微分値に基づいて求める場合、
(c)前記耕耘機の前記車輌本体に対する上下方向に関するリフト角速度を検出するリフト角速度検出手段による検出値と閾値傾斜角速度とに基づいて求める場合、
(d)前記耕耘機の前記車輌本体に対する上下方向に関するリフト角を検出するリフト角検出手段による検出値と前記閾値傾斜角との傾斜偏差の時間微分値に基づいて求める場合である。
また、本発明に係る第3及び第6態様の耕深制御装置において、前記フィルタリング条件としては、代表的には、前記検出耕深位置の入力経路及び/又は前記耕耘機を前記車輌本体に対して昇降させる昇降用アクチュエータへの出力経路に介挿されるフィルタの遮断周波数の範囲を例示できる。
本発明の第1態様に係る耕深制御装置によれば、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさに基づき自動耕深制御における制御ゲインを変更するように構成したので、前記車輌本体の姿勢に拘わらず、前記耕耘機の自動耕深制御の安定化を図ることができる。
例えば、前記傾斜偏差の大きさが大きくなるに従って前記制御ゲインを小さくすることができる。
これに代えて、前記傾斜偏差の大きさが所定の閾値以内の場合には前記制御ゲインを所定の制御ゲインと等しいか又は前記所定制御ゲインより大きくし、且つ、前記傾斜偏差の大きさが所定の閾値よりも大きい場合には前記制御ゲインを前記所定制御ゲインより小さくすることもできる。
これらの構成によれば、前記傾斜偏差が大きい場合における前記リヤカバーの回動角度の変動を有効に防止しつつ、可及的速やかに耕深位置を設定耕深位置に追従させることができ、これにより、自動耕深制御の安定化を図ることができる。
本発明の第2態様に係る耕深制御装置によれば、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさに基づき自動耕深制御における不感帯幅を変更するように構成したので、前記車輌本体の姿勢に拘わらず、前記耕耘機の自動耕深制御の安定化を図ることができる。
例えば、前記傾斜偏差の大きさが大きくなるに従って前記不感帯幅を大きくすることができる。
これに代えて、前記傾斜偏差の大きさが所定の閾値以内の場合には前記不感帯幅を所定の不感帯幅と等しいか又は前記所定不感帯幅より小さくし、且つ、前記傾斜偏差の大きさが所定の閾値よりも大きい場合には前記不感帯幅を前記所定不感帯幅より大きくすることもできる。
これらの構成によれば、前記傾斜偏差が大きい場合における前記リヤカバーの回動角度の変動を有効に防止しつつ、可及的速やかに耕深位置を設定耕深位置に追従させることができ、これにより、自動耕深制御の安定化を図ることができる。
本発明の第3態様に係る耕深制御装置によれば、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさに基づき自動耕深制御におけるフィルタリング条件を変更するように構成したので、前記車輌本体の姿勢に拘わらず、前記耕耘機の自動耕深制御の安定化を図ることができる。
即ち、制御手段への検出耕深位置の入力経路及び/又は制御手段から昇降用アクチュエータへの出力経路に介挿されるフィルタによって遮断される周波数範囲(遮断周波数範囲)を、前記傾斜偏差の大きさに基づいて変更することで、前記車輌本体の姿勢に拘わらず自動耕深制御の安定化を図ることができる。
例えば、前記傾斜偏差の大きさが所定の閾値以内の場合には前記遮断周波数範囲を所定の遮断周波数範囲と等しいか又は前記所定遮断周波数範囲より大きくし、且つ、前記傾斜偏差の大きさが所定の閾値よりも大きい場合には前記遮断周波数範囲を前記所定遮断周波数範囲より小さくすれば、前記傾斜偏差が小さい場合におけるオーバーシュート現象を防止しつつ、前記偏差が大きい場合における振動的動作を可及的速やかに収束させることができる。
これに代えて、前記傾斜偏差が大きくなるに従って前記遮断周波数範囲を小さくしてもよい。この場合においても、前記傾斜偏差が小さい場合におけるオーバーシュート現象を防止しつつ、前記傾斜偏差が大きい場合における振動的動作を可及的速やかに収束させることができる。
また、本発明の第1から第3態様に係る耕深制御装置において、前記傾斜偏差の大きさが、所定時間内における平均値又は積分値である場合には、持続的な外乱の入力があった場合であっても、耕耘機の昇降制御の安定化を図ることができる。
本発明の第4態様に係る耕深制御装置によれば、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさに基づき自動耕深制御における制御ゲインを変更するように構成したので、前記車輌本体の姿勢に拘わらず、前記耕耘機の自動耕深制御の安定化を図ることができる。
例えば、前記傾斜偏差の変化割合の大きさが大きくなるに従って前記制御ゲインを小さくすることができる。
これに代えて、前記傾斜偏差の変化割合の大きさが所定の閾値以内の場合には前記制御ゲインを所定の制御ゲインと等しいか又は前記所定制御ゲインより大きくし、且つ、前記傾斜偏差の変化割合の大きさが所定の閾値よりも大きい場合には前記制御ゲインを前記所定制御ゲインより小さくすることもできる。
これらの構成によれば、前記傾斜偏差が大きい場合における前記リヤカバーの回動角度の変動を有効に防止しつつ、可及的速やかに耕深位置を設定耕深位置に追従させることができ、これにより、自動耕深制御の安定化を図ることができる。
本発明の第5態様に係る耕深制御装置によれば、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさに基づき自動耕深制御における不感帯幅を変更するように構成したので、前記車輌本体の姿勢に拘わらず、前記耕耘機の自動耕深制御の安定化を図ることができる。
例えば、前記傾斜偏差の変化割合の大きさが大きくなるに従って前記不感帯幅を大きくすることができる。
これに代えて、前記傾斜偏差の変化割合の大きさが所定の閾値以内の場合には前記不感帯幅を所定の不感帯幅と等しいか又は前記所定不感帯幅より小さくし、且つ、前記傾斜偏差の変化割合の大きさが所定の閾値よりも大きい場合には前記不感帯幅を前記所定不感帯幅より大きくすることもできる。
これらの構成によれば、前記傾斜偏差が大きい場合における前記リヤカバーの回動角度の変動を有効に防止しつつ、可及的速やかに耕深位置を設定耕深位置に追従させることができ、これにより、自動耕深制御の安定化を図ることができる。
本発明の第6態様に係る耕深制御装置によれば、前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさに基づき自動耕深制御におけるフィルタリング条件を変更するように構成したので、前記車輌本体の姿勢に拘わらず、前記耕耘機の自動耕深制御の安定化を図ることができる。
即ち、制御手段への検出耕深位置の入力経路及び/又は制御手段から昇降用アクチュエータへの出力経路に介挿されるフィルタによって遮断される周波数範囲(遮断周波数範囲)を、前記傾斜偏差の変化割合の大きさに基づいて変更することで、前記車輌本体の姿勢に拘わらず自動耕深制御の安定化を図ることができる。
例えば、前記傾斜偏差の変化割合の大きさが所定の閾値以内の場合には前記遮断周波数範囲を所定の遮断周波数範囲と等しいか又は前記所定遮断周波数範囲より大きくし、且つ、前記傾斜偏差の変化割合の大きさが所定の閾値よりも大きい場合には前記遮断周波数範囲を前記所定遮断周波数範囲より小さくすれば、前記傾斜偏差が小さい場合におけるオーバーシュート現象を防止しつつ、前記偏差が大きい場合における振動的動作を可及的速やかに収束させることができる。
これに代えて、前記傾斜偏差の変化割合が大きくなるに従って前記遮断周波数範囲を小さくしてもよい。この場合においても、前記傾斜偏差が小さい場合におけるオーバーシュート現象を防止しつつ、前記傾斜偏差が大きい場合における振動的動作を可及的速やかに収束させることができる。
また、本発明の第4から第6態様に係る耕深制御装置において、前記傾斜偏差の変化割合の大きさが、所定時間内における平均値又は積分値である場合には、持続的な外乱の入力があった場合であっても、耕耘機の昇降制御の安定化を図ることができる。
以下、本発明の実施の形態について図面を参照しながら説明する。
図1は本実施の形態に係る耕深制御装置が適用される作業車輌の一例である農作業用トラクタの概略側面図である。図2は図1に示すトラクタの概略平面図である。図3は図1に示すトラクタにおける耕耘機用昇降機構の概略側面図である。図4は図3に示す耕耘機用昇降機構の概略平面図である。図5はロータリー耕耘機の図2におけるV−V線に沿った概略断面図である。図6は該ロータリー耕耘機の概略背面図である。図7は該トラクタの油圧回路図である。
図1乃至図4に示す如く、作業車輌としてのトラクタ100は、車輌本体50と、該車輌本体50の後部に連結されたロータリー耕耘機400とを備えている。
前記車輌本体50は、走行機体1と、該走行機体1を支持する左右一対の前車輪2及び左右一対の後車輪3と、該走行機体1の前部に搭載されたエンジン4とを備えており、前記エンジン4からの動力によって前記後車輪3及び前記前車輪2を作動的に駆動することにより、前後進走行するように構成されている。なお、図中の符号5は前記エンジン4を覆うボンネット5である。
さらに、前記トラクタ100は、前記走行機体1の上面に設けられたキャビン6を有している。該キャビン6の内部には、操縦座席7と、かじ取りすることによって前記前車輪2の操向方向を左右に動かすように構成された操縦ハンドル(丸ハンドル)8とが設置されている。前記キャビン6の外側部には、作業者が乗降するステップ9が設けられ、該ステップ9より内側で且つ該キャビン6の底部より下側には、前記エンジン4に燃料を供給する燃料タンク10が設けられている。
図1乃至図4に示すように、前記走行機体1は、前バンパ11及び前車軸ケース12を有するエンジンフレーム13と、該エンジンフレーム13の後部にボルトにて着脱自在に固定される左右の機体フレーム15とを有している。
前記機体フレーム15の後部には、前記エンジン4の回転を適宜変速してそれぞれ後輪軸3a及び前輪軸2aを介して前記後車輪3及び前記前車輪2に伝達するためのミッションケース16が連結されている。前記後車輪3は、前記ミッションケース16の外側面から外向きに突出するように装着された後車軸ケース17を介して取付けられている。
なお、前記ミッションケース16の後端面には、前記ロータリー耕耘機400の駆動力を出力する為のPTO軸18が後向きに突出するように設けられている。
前記ロータリー耕耘機400は、前記ミッションケース16の後部に、一対の左右ロワーリンク311,312及びトップリンク320からなる3点リンク機構300を介して連結される。
図1及び図3に示すように、前記左右ロワーリンク311,312は、前端側が前記ミッションケース16後部の左右側面のそれぞれにロワーリンクピン313を介して回動可能に連結され、且つ、後端側が前記ロータリー耕耘機400における下リンクフレーム440の前端部に下ヒッチピン314を介して連結されている。
前記トップリンク320は、前端側が下記作業機用昇降機構200の後部のトップリンクヒッチ210にトップリンクピン211を介して連結され、且つ、後端側が下記上リンクフレーム410の前端側に上ヒッチピン321を介して連結されている。
図3及び図4に示すように、前記ミッションケース16の後部上面には、前記ロータリー耕耘機400を昇降動する為の油圧式作業機用昇降機構200が着脱可能に取付けられている。
図3及び図4及び図7に示すように、油圧式の作業機用昇降機構200は、昇降用アクチュエータとして作用する単動形の昇降制御油圧シリンダ220と、該油圧シリンダ220におけるピストンによって作動的に回動される左右一対のリフトアーム221,222とを有している。
進行方向に向かって左側の前記リフトアーム221は、左リフトロッド231を介して対応する左側の前記ロワーリンク311に連結されている。
進行方向に向かって右側の前記リフトアーム222は、右リフトロッド232を介して対応する右側の前記ロワーリンク312に連結されている。
つまり、前記昇降制御油圧シリンダ220によって前記左右一対のリフトアーム221,222が車輌左右方向に沿った前記回動軸回りに揺動することで、前記ロータリー耕耘機400は、前記トップリンク320及び前記一対のロワーリンク311,312の前端部回りに昇降するようになっている。
前記右リフトロッド232には、前記ロータリー耕耘機400を前記車輌本体50に対して傾動させる傾動用アクチュエータとして作用する複動形の傾斜制御油圧シリンダ240が介挿されている。
つまり、前記傾斜制御油圧シリンダ240のピストンロッド241が進退することによって、前記ロータリー耕耘機440は、前記左右一対のリフトロッド231,232の他方(ここでは、左リフトロッド231)と該他方のリフトロッド231に対応したロワーリンク311との連結点(即ち、前記ロータリー耕耘機400の左右方向中心位置Dから一方側へ変位された位置)を支点Q(図2参照)として、傾動するようになっている。
図1、図2、図5及び図6に示すように、前記ロータリー耕耘機400は、横長筒状のメインビーム420と、前記メインビーム420の左右側端部にそれぞれ上端側が連結されたチェーンケース431及び軸受板432と、前記チェーンケース431及び前記軸受板432の下端側に左右両端部が回転自在に軸支された耕耘爪軸433と、前記耕耘爪軸433に放射状にて着脱可能に取り付けられた複数の耕耘爪434と、前記耕耘爪434の回転軌跡の上方を覆うように配置された耕耘上面カバー435と、前記耕耘爪434の回転軌跡の左右側方を覆うように配置された左右耕耘サイドカバー436と、前記耕耘爪434の回転軌跡の後方を覆うように配置された耕耘リヤカバー437と、前記メインビーム420に前端側が取付けられて後方に長く伸びる耕深調節フレーム438と、前記メインビーム420に回動可能に連結された前記上リンクフレーム410と、前記メインビーム420に一体的に連結された前記下リンクフレーム440と、前記上リンクフレーム410の後端側と前記耕深調節フレーム438の前後方向の中間部とをつなぐ伸縮調節可能な耕深調節軸439とを備えている。
詳しくは、前記トップリンク320は、ターンバックル320aの回転にて伸縮されて、該トップリンク320の長さを変更調節可能となるように構成されている(図3及び図4参照)。前記上リンクフレーム410は、前後方向の中間部において、耕深調節支点軸411を介して前記メインビーム420に回動可能に連結されている(図1参照)。そして、前記耕深調節フレーム438は、前端側が前記メインビーム420に一体的に連結されている。
斯かる構成を備えることにより、耕深調節ハンドル439a(図1参照)を回転操作して前記耕深調節軸439を伸縮させると、前記左右一対のロワーリンク311,312及びトップリンク320にて支持される前記ロータリー耕耘機400は、前傾又は後傾姿勢に変化するようになっており、これにより、前記耕耘爪434による耕深位置hD(耕耘深さ)が手動で変更できるように構成されている。
図1、図5及び図6に示すように、前記メインビーム420の左右中央部には、前記PTO軸18からの駆動力を入力するためのギヤケース450が配置されている。前記PTO軸18と前記ギヤケース450前面側のPTO入力軸451とは、両端に自在継手が備えられた伸縮自在な伝動軸452を介して連結されている。
前記PTO軸18からの動力は、前記ギヤケース450に内蔵されたベベルギヤ(図示せず)、前記メインビーム420に内蔵された回転軸(図示せず)、前記チェーンケース431に内蔵されたスプロケット及びチェーン(図示せず)等を介して前記耕耘爪軸433に伝達される。これにより、前記耕耘爪434が図1及び図5において反時計方向に回転される。
図5及び図6に示すように、前記耕耘上面カバー435の後端側には、車輌左右方向に沿った枢着軸437aを介して前記耕耘リヤカバー437が回動可能に連結されている。
さらに、前記耕耘上面カバー435の上面後部には、後方且つ上方へ延びる左右一対のハンガーフレーム441が立設されている。
そして、前記耕耘リヤカバー437の上面後端側と前記左右ハンガーフレーム441の後端側との間には左右一対のハンガー機構460が設けられており、前記耕耘リヤカバー437は、該ハンガー機構460によって、前記枢着軸437a回りに上下動し得るようになっている。
詳しくは、前記各ハンガーフレーム441の後端部には、車輌左右方向に沿った軸線回り回動自在とされた受圧軸体442が配置されている。該受圧軸体442には、軸線と直交する方向に貫通孔が設けられている。
前記各ハンガー機構460は、前記受圧軸体442の前記貫通孔に摺動可能に挿通された細長い丸棒形のハンガーロッド461を有している。
前記ハンガーロッド461は、下端部が、車輌左右方向に沿った支軸461aを介して、前記耕耘リヤカバー437の後部上面に設けられたブラケット462に回動自在に連結されている(図5参照)。
前記ハンガーロッド461には、前記受圧軸体442より上方側において固設された下降規制ピン461bと、前記下降規制ピン461bと前記受圧軸体442との間に位置するように該ハンガーロッド461に軸線方向摺動可能に外挿された下降規制板463と、該ハンガーロッド461の下方側で且つ前記支軸461aより上方側において固設された上昇規制ピン461cと、前記上昇規制ピン461cによって下方への移動が規制された状態で該ハンガーロッド461に軸線方向摺動可能に外挿された下座板465と、前記下座板465及び前記受圧軸体442の間に位置するように該ハンガーロッド461に外挿された鎮圧用圧縮バネ466と、該鎮圧用圧縮バネ466の上端部と係合する上座板464とが設けられている。
斯かるハンガー機構460を備えた前記ロータリー耕耘機400は以下のように作動する。
即ち、前記昇降用アクチュエータによって前記ロータリー耕耘機400が地面Gから離れるように持上げられると、前記耕耘リヤカバー437の後端側が前記枢着軸437a回りに下方側に回動する。
この際、前記ハンガーロッド461は前記受圧軸体442に案内された状態で下方側へ移動するが、前記下降規制ピン461bが前記下降規制板463に当接し且つ該下降規制板463が前記受圧軸体442に当接することで、該ハンガーロッド461の下方側への移動が停止される。従って、前記耕耘リヤカバー437はその後端側を最下降させた姿勢に維持される。
一方、前記ロータリー耕耘機400が耕地上面に降ろされて前記耕耘爪434が着地しているときや耕耘作業中においては、前記耕耘リヤカバー437の後端側が、耕耘された耕土との接地圧にて前記枢着軸437a回りに上方に回動することになる。
この際、前記ハンガーロッド461は前記受圧軸体442に案内された状態で上方側へ移動する。斯かるハンガーロッド461の上方側への移動によって、前記上昇規制ピン461c及び前記下座板465を介して前記鎮圧用圧縮バネ466が圧縮される。
即ち、前記耕耘リヤカバー437が前記枢着軸437a回りに上方側へ回動する際には、該耕耘リヤカバー437は前記鎮圧用圧縮バネ466の付勢力に抗して動作することになり、従って、前記耕耘リヤカバー437の後方への土の飛散を有効に防止しつつ、該耕耘リヤカバーによる均平作用を有効に維持することができる。
前記トラクタ100は、さらに、昇降用アクチュエータとして作用する前記昇降制御油圧シリンダ220及び傾動用アクチュエータとして前記昇降制御油圧シリンダ220への作動油給排を行う油圧回路500を備えている。
図7に示すように、前記油圧回路500は、前記エンジン4によって作動的に回転駆動される作業機用油圧ポンプ501と、該油圧ポンプ501の吐出側に流体接続された分流弁505と、該分流弁505によって分岐された一方側油路及び他方側油路にそれぞれ配置された昇降制御用バルブ及び傾斜制御用バルブとを備えている。
本実施の形態においては、前記昇降制御用バルブは、上昇制御電磁弁502及び下降制御電磁弁503を有している。また、前記傾斜制御用バルブは、傾斜制御電磁弁504を有している。
なお、前記油圧回路500は、図7に示すように、リリーフ弁や流量調整弁、チェック弁、オイルクーラ、オイルフィルタ等も備えている。
次に、前記キャビン6内に配置された各種操作手段の構成について説明する。
図1及び図2に示すように、前記操縦ハンドル8は、前記操縦座席7の前方に位置する操縦コラム19上に設けられている。
前記キャビン6内には、前記操縦座席7,前記操縦ハンドル8及び前記操縦コラム19に加えて、前記エンジン4の回転数(出力)を調節するためのスロットルレバー617と、前記走行機体1を制動操作するための左右ブレーキペダル20と、前記エンジンから前記前車輪2及び前記後車輪3への動力伝達の係脱操作を行う為のクラッチペダル21と、車輌本体50の走行速度を変速操作する為の走行変速レバー24と、前記エンジン4から前記後車輪3への動力伝達経路に介挿されるディファレンシャル機構をロック操作する為のデフロックペダル25と、前記PTO軸18からの出力回転数を変速操作する為のPTO変速レバー23とが配置されている。
さらに、前記キャビン6内には、作業機昇降レバー22,傾斜設定器623及び耕深設定器626が配置されている。
図8に、前記ロータリー耕耘機400の模式側面図を示す。なお、図8(a)は自動耕深制御時のロータリー耕耘機400の昇降状態を示しており、図8(b)は自動高さ制御時のロータリー耕耘機400の昇降状態を示している。
前記作業機昇降レバー22は、前記ロータリー耕耘機400の設定高さ位置(目標高さ位置)を手動で変更操作するための上下位置操作手段として作用する。
前記上下位置操作手段は、前記設定高さ位置として、前記リフトアーム221,222の設定リフト角度(目標リフト角度)を設定し得るように構成される。
図9に、前記ロータリー耕耘機400の模式背面図を示す。
前記傾斜設定器623は、前記ロータリー耕耘機400の傾斜状態tSを設定する傾斜設定手段として作用する。具体的には、図9に示すように、前記車輌本体50に対する前記ロータリー耕耘機400の左右方向に関する相対的な設定左右傾斜角度(目標左右傾斜角度)φsを予め設定する為のものであり、例えば、可変抵抗器を含み得る。
前記耕深設定器626は、前記ロータリー耕耘機400における耕耘爪434の設定耕深位置(目標耕深位置)hR(図8(a)参照)を設定する耕深深さ設定手段として作用する。
詳細は後述するが、前記ロータリー耕耘機400の耕深位置は、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動角度に基づいて制御されるようになっている。従って、前記耕深深さ設定手段は、前記設定耕深位置として、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の設定回動角度(目標回動角度)θR(図8(a)参照)を設定し得るように構成され、例えば、可変抵抗器を含み得る。なお、前記設定回動角度θRは、例えば、鉛直Vを基準にした回動角度とすることができる。
(第1実施形態)
次に、本発明に係る耕深制御装置の第1実施形態について説明する。
図10は、第1実施形態に係る耕深制御装置のブロック図である。
該耕深制御装置は、前記耕耘リアカバー437の回動角度に基づき、前記車輌本体50に対して昇降可能に連結された前記ロータリー耕耘機400の検出耕深位置hDを前記耕深設定器626による設定耕深位置hRに追従させる自動耕深制御を行うように構成されている。
具体的には、図10に示すように、該耕深制御装置は、前記昇降用アクチュエータとして作用する前記昇降制御油圧シリンダ220と、前記耕深深さ設定手段として作用する前記耕深設定器626と、前記ロータリー耕耘機400の耕深位置を検出する耕深位置検出手段として作用するリヤカバーセンサ624と、前記車輌本体の前後方向に関する傾斜角を検出する車輌傾斜角検出手段として作用するピッチング角センサ629と、前記耕耘機の前記車輌本体に対する上下方向に関するリフト角を検出するリフト角検出手段として作用するリフト角センサ627と、前記自動耕深制御を司る制御手段として作用する耕深制御コントローラ600とを備えている。なお、耕深制御装置は、本実施の形態では、前記ピッチング角センサ629及び前記リフト角センサ627の双方を備えているが、これらのうち何れか一方を備えていてもよい。また、前記リフト角センサ627は、後述するように、自動高さ制御において、前記ロータリー耕耘機400の前記車輌本体に対する上下位置を検出する上下位置検出手段としても作用する。
前述の通り、前記リヤカバーセンサ624は、前記ロータリー耕耘機400の耕深位置hDを検出する耕深位置検出手段として作用する。
即ち、前記ロータリー耕耘機400の耕深位置hD(図8(a)参照)に応じて、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動位置が変化する。従って、前記リヤカバーセンサ624によって、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動位置を検出することによって、前記ロータリー耕耘機400の耕深位置hDを検出することができる。
詳しくは、前記リヤカバーセンサ624は、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動位置として、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動角度θD(図8(a)参照)を検出し得るように構成され、この検出回動角度θDは、例えば、鉛直Vを基準にした回動角度とすることができる。
本実施の形態においては、該リヤカバーセンサ624は、前記耕耘上面カバー435の後部上面に配置されたポテンショメータ型とされている(図2、図5、図6及び図8参照)。
なお、前記リヤカバーセンサ624と前記耕耘リヤカバー437とは、センサアーム437b及びセンサリンク437c等を介して連結されている(図2参照)。
該ピッチング角センサ629は、前記車輌本体50の前後方向に関する傾斜角度θW(図8(a)参照)を検出する為のものであり、例えば、振子式のものが使用され得る。なお、前記傾斜角度θWは、例えば、水平Hを基準にした傾斜角度とすることができる。
該リフト角センサ627は、前記ロータリ耕耘機400の対機体高さ(前記車輌本体50に対する前記ロータリ耕耘機400の相対高さ)hLを検出し得るように構成されている。
具体的には、該リフト角センサ627は、前記リフトアーム221,222のリフト角度θL(図8(b)参照)を検出するように構成されており、例えば、ポテンショメータ型のものが使用され得る。なお、前記リフト角度θLは、例えば、水平Hを基準にしたリフト角度とすることができる。
該リフト角センサ627は、前記作業機用昇降機構200と前記左リフトアーム221との連結箇所に配置されている(図3及び図4参照)。
前記耕深制御コントローラ600は、前記種々の設定手段及びセンサからの信号を入力して、前記昇降用アクチュエータ及び前記傾動用アクチュエータへ制御信号を出力するように構成されている。
即ち、該耕深制御コントローラ600は、図10に示すように、入力系が前記耕深設定器626、前記リヤカバーセンサ624、前記ピッチング角センサ629及び前記リフト角センサ627に電気的に接続されると共に、出力系が前記上昇制御電磁弁502及び前記下降制御電磁弁503に電気的に接続されている。
詳しくは、該耕深制御コントローラ600は、図10に示すように、前記各種センサ等から入力される信号に基づいて演算処理を実行する制御演算手段を含む中央処理装置601(以下CPUという)と、制御プログラム等を格納したり、後述する各種関係式又は制御マップに関する所定のデータ等を記憶するROM602と、前記CPU601の演算中に生成されるデータを一時的に保持するRAM603とを備えている。また、前記CPU601は時計用のタイマを内蔵している。
斯かる耕深制御コントローラ600は電源印加用キースイッチ611を介してバッテリ612に接続されている。なお、前記キースイッチ611は、前記エンジン4を始動するためのスタータ613に接続される。
なお、前記リアカバーセンサ624は、前記耕深制御コントローラ600に電気的に接続されている。前記耕深制御コントローラ600は、該リアカバーセンサ624の出力の中から限定された帯域の信号出力を取り出すためのフィルタ部625を有している。
斯かるフィルタ部625を設けることにより、前記リアカバーセンサ624の検出感度変化の影響を抑制することができる。これについては後ほど詳述する。
本実施の形態においては、前記耕深制御コントローラ600には、図10に示すように、前記エンジン4の回転を制御する電子ガバナコントローラ614が接続されている。
該電子ガバナコントローラ614には、前記エンジン4の燃料を調節するガバナ615と、前記エンジン4の回転数を検出するエンジン回転センサ616とが接続されている。
前記電子ガバナコントローラ614は、作業者にて前記スロットルレバー617が手動操作されると、該スロットルレバー617の回動位置を検出するスロットルポテンショメータ618の検出情報に基づいて、該スロットルレバー617の設定回転数と前記エンジン4の回転数とが一致するように、スロットルソレノイド619にて燃料調節ラック(図示省略)の位置を自動的に調節する制御を実行する。これにより、前記エンジン4の回転は、負荷の変動に拘わらず、前記スロットルレバー617の位置に応じた所定回転数に維持され得る。
さらに、本実施の形態に係る前記耕深制御装置は、前記ロータリ耕耘機400の検出上下高さ位置hLを、上下位置設定手段による設定高さ位置に追従させる自動高さ制御を行えるように構成されている。
具体的には、図10に示すように、該耕深制御装置は、前記構成に加えて、前記上下位置設定手段として作用する前記作業機昇降レバー22と、前記ロータリー耕耘機400の前記車輌本体に対する上下位置を検出する上下位置検出手段とを備えている。
本実施の形態においては、前記上下位置検出手段として前記リフト角センサ627が備えられている。
そして、前記耕深制御コントローラ600は、前記自動耕深制御に加えて、前記自動高さ制御を司るように構成されている。
具体的には、該耕深制御コントローラ600は、前記上下位置設定手段及び前記上下位置検出手段からの信号を入力して、前記昇降用アクチュエータへ制御信号を出力するように構成されている。
即ち、該耕深制御コントローラ600は、図10に示すように、入力系が前記作業機昇降レバー22及び前記リフト角センサ627にも電気的に接続されている。
さらに、本実施の形態に係る前記耕深制御装置は、前記ロータリ耕耘機400の前記車輌本体50に対する検出傾斜状態t(図9参照)を前記傾斜設定器623による設定傾斜状態tSに追従させる自動傾き制御を行えるように構成されている。
具体的には、図10に示すように、該耕深制御装置は、前記構成に加えて、前記傾動用アクチュエータとして作用する前記傾斜制御油圧シリンダ240と、前記傾斜設定手段として作用する前記傾斜設定器623と、前記ロータリー耕耘機400の傾斜状態を検出する作業機傾斜状態検出手段として作用する作業機ポジションセンサ622とを備えている。
前記作業機ポジションセンサ622は、前記車輌本体50に対する前記ロータリー耕耘機400の左右方向に関する相対的な傾斜角度を検出するように構成されており、例えば、ポテンショメータ型のものが使用され得る。
該作業機ポジションセンサ622は、詳細は図示していないが、例えば、前記耕耘上面カバー435の上方に位置する前記メインビーム420の左右中央箇所に配置され得る。
そして、前記耕深制御コントローラ600は、前記自動耕深制御及び前記自動高さ制御に加えて、前記自動傾き制御を司るように構成されている。
具体的には、該耕深制御コントローラ600は、前記傾斜設定手段623及び前記作業機傾斜状態検出手段622からの信号を入力して、前記傾動用アクチュエータ240へ制御信号を出力するように構成されている。
即ち、該耕深制御コントローラ600は、図10に示すように、入力系が前記傾斜設定器623及び前記作業機ポジションセンサ622にも電気的に接続されると共に、出力系が前記傾斜制御電磁弁504に電気的に接続されている。
さらに、本実施の形態に係る耕深制御装置には、機体ローリングセンサ621及び車速センサ628が備えられている。
該機体ローリングセンサ621は、前記車輌本体50の左右方向に関する傾斜角度を検出する為のものであり、例えば、振子式のものが使用され得る。
本実施の形態においては、該機体ローリングセンサ621は、前記作業機用昇降機構200の上面で且つ前記操縦座席7の後方の箇所に配置されている(図1〜図4参照)。
また該車速センサ628は、前後四輪2,3の回転速度(走行速度)を検出するためのものである。
図11は第1実施形態の耕深制御装置にてロータリー耕耘機400を耕深制御する際の制御ブロック線図である。なお、後述する傾斜偏差ΔθW又はΔθLは、図11では単にΔθと略して示している。後述する図16及び図21についても同様である。
該耕深制御コントローラ600は、さらに、前記ピッチング角センサ629の検出傾斜角θWと閾値傾斜角θW’との傾斜偏差ΔθW又は前記リフト角センサ627の検出傾斜角θLと閾値傾斜角θL’との傾斜偏差ΔθLの大きさに基づき前記自動耕深制御における制御ゲインKp、Ki,Kdを変更するように構成されている。即ち、前記傾斜偏差ΔθW又はΔθLの大きさによって制御ゲインを選択するように構成されている(図11(a)参照)。
前記「傾斜偏差ΔθW又はΔθLの大きさによる制御ゲインの選択」に代えて、若しくは、加えて、該耕深制御コントローラ600は、前記タイマにて前記傾斜偏差ΔθW又はΔθLの大きさの所定時間内における積分値に基づき前記自動耕深制御における制御ゲインKp、Ki,Kdを変更するように構成されている。即ち、前記傾斜偏差ΔθW又はΔθLの積分値の大きさによって制御ゲインを選択するように構成されている(図11(b)参照)。
前記「傾斜偏差ΔθW又はΔθLの大きさによる制御ゲインの選択」及び/又は前記「傾斜偏差ΔθW又はΔθLの積分値の大きさによる制御ゲインの選択」に代えて、若しくは、加えて、該耕深制御コントローラ600は、前記傾斜偏差ΔθW又はΔθLの変化割合の大きさに基づき前記自動耕深制御における制御ゲインKp、Ki,Kdを変更するように構成されている。即ち、前記傾斜偏差ΔθW又はΔθLの微分値の大きさによって制御ゲインを選択するように構成されている(図11(c)参照)。
ここで、Kは制御ゲインであり、添字pのゲインは比例ゲイン、添字iのゲインは積分ゲイン、添字dのゲインは微分ゲインを示す。
なお、前記閾値傾斜角θW’又はθL’は、前記ROM602に予め記憶されている。
前記車輌本体50の検出傾斜角θW,θLと閾値傾斜角θW’,θL’との傾斜偏差の変化割合の大きさは、本実施の形態では、前記ピッチング角センサ629の検出値θWと閾値傾斜角θW’との傾斜偏差ΔθWの時間微分値又は前記リフト角センサ627の検出値θLと閾値傾斜角θW’との傾斜偏差ΔθWの時間微分値に基づいて求める。但し、それに限定されるものではなく、前記ピッチング角センサ629に代えて前記車輌本体50の前後方向に関する傾斜角速度を検出する車輌傾斜角速度検出手段を設け、該車輌傾斜角速度検出手段による検出値と閾値傾斜角速度とに基づいて求めてもよいし、前記リフト角センサ627に代えて前記ロータリ耕耘機400の前記車輌本体50に対する上下方向に関するリフト角速度を検出するリフト角速度検出手段を設け、該リフト角速度検出手段による検出値と前記閾値傾斜角とに基づいて求めてもよい。
斯かる構成を備えることにより、前記傾斜偏差ΔθW又はΔθL、前記傾斜偏差ΔθW又はΔθLの積分値及び前記傾斜偏差ΔθW又はΔθLの微分値の大きさのうち少なくとも一つに応じて前記制御ゲインKp、Ki,Kdを変更することができる。
本実施の形態においては、前記傾斜偏差ΔθW又はΔθL或いは/さらに前記傾斜偏差ΔθW又はΔθLの微分値の大きさが大きくなるに従って前記制御ゲインKp、Ki,Kdを小さくするようになっている。これにより、前記車輌本体50の姿勢に拘わらず、前記ロータリ耕耘機400の自動耕深制御の安定化を図ることができる。
また、前記傾斜偏差ΔθW又はΔθLの積分値の大きさが所定の閾値以内の場合には前記制御ゲインKp、Ki,Kdを所定の制御ゲインと等しいか又は前記所定制御ゲインより大きくし、且つ、前記傾斜偏差ΔθW又はΔθLの積分値の大きさが前記所定閾値よりも大きい場合には前記制御ゲインKp、Ki,Kdを前記所定制御ゲインより小さくすることで、前記傾斜偏差ΔθW又はΔθLが大きい場合における前記耕耘リヤカバー437の回動角度の変動を有効に防止しつつ、可及的速やかに耕深位置hDを設定耕深位置hRに追従させることができるようにもなっている。これにより、自動耕深制御の安定化を図ることができる。また、この場合、持続的な外乱の入力があった場合であっても、前記ロータリ耕耘機400の昇降制御の安定化を図ることができる。
なお、前記フィルタ部625の遮断周波数Fcの範囲は、本実施の形態では、基準となる固定の基準遮断周波数範囲としている。また、本実施の形態では、前記傾斜偏差ΔθW又はΔθLの大きさについて、所定時間内における積分値を求めるが、前記積分値に代えて、平均値を求めてもよい。この場合の平均値は、単純平均値、重みつき平均値、単純移動平均値、重みつき移動平均値のうち何れであってもよい。また、前記所定時間内における前記積分値や前記平均値を求めるようにしてもよいが、所定サンプリング数における前記積分値や前記平均値を求めるようにしてもよい。
図12に、前記制御ゲインKpと前記傾斜偏差ΔθW又はΔθLの大きさとの関係の一例を示す制御ゲインマップを示す。なお、図中Hは基準となる水平位置を示している。
前記ROM602には、例えば、前記制御ゲインKpと前記傾斜偏差ΔθW又はΔθLの大きさとの関係を示す制御ゲイン演算用関係式又は制御ゲインマップが予め記憶されている。
この場合の前記制御ゲイン演算用関係式としては、例えば、基準となる制御ゲイン(基準制御ゲイン)をK’とし、前記閾値傾斜角θW’又はθL’より大きい所定の上限傾斜角をθW”又はθL”とし、該上限傾斜角をθW”又はθL”における制御ゲインをK”(K”<K’)とすると、前記ピッチング角センサ629又は前記リフト角センサ627の検出傾斜角θW又はθLが前記閾値傾斜角θW’又はθL’以下の場合には、Kp=K’とし、前記検出傾斜角θW又はθLが前記閾値傾斜角θW’又はθL’より大きく、且つ、前記上限傾斜角θW”又はθL”より小さい場合には、傾斜偏差ΔθW又はΔθLが大きくなるに従って制御ゲインKpが小さくなるような比例関係とし、さらに、前記検出傾斜角θW又はθLが前記上限傾斜角θW”又はθL”以上の場合には、Kp=K”となるような関係式を挙げることができる。
この制御ゲイン演算用関係式を制御ゲインマップとした場合を図12に示している。図12では、前記検出傾斜角θW又はθLを横軸に採り、制御ゲインKpを縦軸に採っている。
斯かる構成を備えることにより、前記耕深制御コントローラ600は、前記傾斜偏差ΔθW又はΔθLの大きさが大きくなるに従って前記制御ゲインKpを小さくする。
なお、前記傾斜偏差ΔθW又はΔθLの大きさとこれに対応する制御ゲインKpとが関連づけられたデータを、テーブルマップとして前記ROM602に予め記憶させるようにしてもよい。
また、前記制御ゲインKp,Ki,Kdと前記傾斜偏差ΔθW又はΔθLの所定時間内(又は所定サンプリング数)における積分値(若しくは平均値)の大きさとの関係を得るための手段は、例えば、前記傾斜偏差ΔθW又はΔθLの所定時間内(又は所定サンプリング数)における積分値(若しくは平均値)の大きさとこれに対応する制御ゲインKp,Ki,Kdとが関連づけられた関係式又は制御ゲインマップ或いはテーブルマップであってもよい。
前記制御ゲインKp,Ki,Kdと前記傾斜偏差ΔθW又はΔθLの変化割合(微分値)の大きさとの関係を得るための手段は、例えば、前記傾斜偏差ΔθW又はΔθLの変化割合(微分値)の大きさとこれに対応する制御ゲインKp,Ki,Kdとが関連づけられた関係式又は制御ゲインマップ或いはテーブルマップであってもよい。
これらの関係は各制御ゲインKp,Ki,Kd共通でも独立でもかまわない。本実施形態では、各制御ゲインKp,Ki,Kd共通としている。なお、各制御ゲインKp,Ki,Kdのうち何れかのゲインを0「ゼロ」として不使用することができる。
前記制御ゲインKp,Ki,Kdと前記傾斜偏差ΔθW又はΔθLの微分値の大きさとの関係を得るための手段は、本実施の形態では、前記制御ゲインKp,Ki,Kdと前記傾斜偏差ΔθW又はΔθLの微分値の大きさとの関係を示す制御ゲイン演算用関係式又は制御ゲインマップ或いはテーブルマップであって、図12に示す関係と同様の関係を示すものを用いている。例えば、前記ROM602には、前記制御ゲインKp,Ki,Kdと前記傾斜偏差ΔθW又はΔθLの微分値の大きさとの関係を示す制御ゲイン演算用関係式又は制御ゲインマップも予め記憶されている。
斯かる構成を備えることにより、前記耕深制御コントローラ600は、前記傾斜偏差ΔθW又はΔθLの微分値の大きさが大きくなるに従って前記制御ゲインKp,Ki,Kdを小さくする。
また、前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた前記制御ゲインKp,Ki,Kdは、本実施の形態では、次にようにして求めている。即ち、前記タイマによる所定時間内において、前記傾斜偏差ΔθW又はΔθLが予め決められた閾値偏差ΔθWt又はΔθLtを上回ったとき、カウンタCを加算していき、該カウンタCの値が予め決められた閾値カウンタCtを超えたときに、前記制御ゲインKpに係数α(但し0<α<1)を掛ける一方、前記傾斜偏差ΔθW又はΔθLが予め決められた目標範囲ΔθWd又はΔθLd以内にある場合は、該カウンタCをリセットし、前記制御ゲインKpを元の値に戻す。そして所定時間経過後に得られた制御ゲインkpを各制御ゲインKp,Ki,Kdとし、こうして各制御ゲインKp,Ki,Kdを得るようにしている。これについては後述する図14のフローチャートで詳述する。
斯かる構成を備えることにより、前記耕深制御コントローラ600は、前記傾斜偏差ΔθW又はΔθLの積分値の大きさが前記閾値偏差ΔθWt又はΔθLt以内の場合には前記制御ゲインKp,Ki,Kdを元の制御ゲインと等しいか又は大きく(ここでは等しく)し、且つ、前記積分値の大きさが前記閾値偏差ΔθWt又はΔθLtより大きい場合には前記制御ゲインKp,Ki,Kdを元の制御ゲインより小さくする。
なお、前記閾値偏差ΔθWt又はΔθLt、前記閾値カウンタCt及び前記目標範囲ΔθWd又はΔθLdは、前記ROM602に予め記憶されている。
次に、図11乃至図15を参照しながら前記耕深制御コントローラ600による前記ロータリー耕耘機400の耕深制御動作の一例を以下に詳述する。
(傾斜偏差ΔθW又はΔθLの大きさによる制御ゲインの選択)
先ず、第1実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの大きさによって前記制御ゲインKp,Ki,Kdを選択する場合について説明する。
図13に、第1実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの大きさによって前記制御ゲインKp,Ki,Kdを選択するためのフローチャートを示す。
図13に示す耕深制御では、ステップS1からの処理に先立ち、後述するステップS5の処理で用いる偏差の累積値Δhi及び変数Δh1に、初期値として「0(ゼロ)」が代入される。なお、変数Δh1はステップS8において前回の偏差Δhの値を格納しておく為のものである。
図13に示す耕深制御では、先ず、前記リヤカバーセンサ624による検出上下回動角度θDを読み込み、さらに前記ピッチング角センサ629による検出傾斜角θW又は前記リフト角センサ627による検出傾斜角θLを読み込むと共に、前記ROM602に予め記憶された前記閾値傾斜角θW’又はθL’を該ROM602から読み出す(ステップS1)。該読み込まれた検出上下回動角度θDに基づく前記ロータリー耕耘機400の検出耕深位置hDと前記耕深設定器626による設定耕深位置hRとの偏差Δhを算出すると共に、該読み込まれた検出傾斜角θW又はθLと該読み出された閾値傾斜角θW’又はθL’との傾斜偏差ΔθW又はΔθLを算出する(ステップS2)。
次に、前記ROM602に予め記憶された、制御ゲインと傾斜偏差の大きさとの関係を示す制御ゲイン演算用関係式又は制御ゲインマップを該ROM602から読み出す(ステップS3)。該読み出された制御ゲイン演算用関係式又は制御ゲインマップと、前記ステップS2で算出された傾斜偏差ΔθW又はΔθLとに基づき、前記傾斜偏差ΔθW又はΔθLの大きさに応じた制御ゲインKp,Ki,Kdを求める(ステップS4)。この場合の前記制御ゲインKp,Ki,Kdは、前記傾斜偏差ΔθW又はΔθLの大きさが大きくなるに従って小さい値になる(図12参照)。
次に、前記偏差Δhの積分・微分を計算する(ステップS5)。
具体的には、次の式(1)に示すように、偏差の累積値Δhiに前記偏差Δhを加算するとともに、次の式(2)に示すように、前記偏差Δhから前回の偏差Δh1(但し初期値は「0」)を差し引いた前回偏差との差Δhdを算出する。
Δhi=Δhi+Δh・・・式(1)
Δhd=Δh−Δh1・・・式(2)
次に、出力値Yを計算する(ステップS6)。
具体的には、前記ステップS2で得られた偏差Δhと、前記ステップS4で得られた制御ゲインKp,Ki,Kdと、前記ステップS5で得られた偏差の累積値Δhi及び前回偏差との差Δhdとを次の式(3)に代入して、出力値Yを算出する。
Y=KpΔh+KiΔhi+KdΔhd・・・式(3)
そして、出力値Yを出力する(ステップS7)。
これにより、耕深制御の際には、前記ステップS6で得られた出力値Yと、前記リヤカバーセンサ624で読み込まれた検出上下回動角度θDに基づく検出耕深位置hDとにより、該検出耕深位置hDが前記耕深設定器626の設定回動角度θRに基づく設定耕深位置hRとなるように前記昇降制御油圧シリンダ220の自動昇降制御量が算出される。こうして算出された自動昇降制御量にて前記上昇制御電磁弁502又は前記下降制御電磁弁503が作動され、前記昇降制御油圧シリンダ220による前記ロータリー耕耘機400の下降又は上昇の動作が実行される。
次に、前記変数Δh1に前記ステップS2で算出された偏差Δhの値を代入し(ステップS8)、ステップS9に移行する。
ステップS9では、前記自動耕深制御動作終了か否かを判断し、自動耕深制御動作中と判断したときは、ステップS1〜ステップS8までの動作を順次繰り返す一方、自動耕深制御動作が終了したと判断したときには、前記自動耕深制御を終了する。
(傾斜偏差ΔθW又はΔθLの積分値の大きさによる制御ゲインの選択)
次に、第1実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの積分値の大きさによって前記制御ゲインKp,Ki,Kdを選択する場合について説明する。
図14に、第1実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの積分値の大きさによって前記制御ゲインKp,Ki,Kdを選択するためのフローチャートを示す。
図14に示すフローチャートは、図13に示すフローチャートにおいて、前記ステップS1〜S4の代わりに前記傾斜偏差ΔθW又はΔθLの積分値を求めるステップS101〜S114及び前記偏差Δhを算出するステップS115及びS116を設けている。図14に示すフローチャートは、ステップS101〜S116以外は図13のフローチャートと実質的に同じものである。従って、ここでは、これらのステップを中心に説明する。
図14に示す耕深制御では、先ず、初期値としてカウンタCに「0」を代入する(ステップS101)。前記ROM602に予め記憶された前記閾値偏差ΔθWt又はΔθLt、閾値カウンタCt及び目標範囲ΔθWd又はθLdを該ROM602から読み出す(ステップS102)。
次に、前記制御ゲインKpの値を変数Kp’に代入する(ステップS103)。
前記ピッチング角センサ629による検出傾斜角θW又は前記リフト角センサ627による検出傾斜角θLを読み込むと共に、前記ROM602に予め記憶された前記閾値傾斜角θW’又はθL’を該ROM602から読み出す(ステップS104)。該読み込まれた検出傾斜角θW又はθLと該読み出された閾値傾斜角θW’又はθL’との傾斜偏差ΔθW又はΔθLを算出する(ステップS105)。
次に、前記ステップS105で算出された傾斜偏差ΔθW又はΔθLが前記ROM602から読み出された閾値偏差ΔθWt又はΔθLtより大きいか否かを判断する(ステップS106)。
具体的には、前記傾斜偏差ΔθW又はΔθLが前記閾値偏差ΔθWt又はΔθLtより大きいと判断した場合には、ステップS107に移行する一方、前記傾斜偏差ΔθW又はΔθLが前記閾値偏差ΔθWt又はΔθLtと等しいか又は前記閾値偏差ΔθWt又はΔθLtより小さいと判断した場合には、ステップS108に移行する。
前記ステップS106で前記傾斜偏差ΔθW又はΔθLが前記閾値偏差ΔθWt又はΔθLtより大きいと判断した場合、前記カウンタCに1を加算する(ステップS107)。
次に、前記カウンタCが前記ROM602から読み出された閾値カウンタCtより大きいか否かを判断する(ステップS108)。
具体的には、前記カウンタCが前記閾値カウンタCtより大きいと判断した場合には、ステップS109に移行する一方、前記カウンタCが前記閾値カウンタCtと等しいか又は前記閾値カウンタCtより小さいと判断した場合には、ステップS110に移行する。
前記ステップS108で前記カウンタCが前記閾値カウンタCtより大きいと判断した場合、前記制御ゲインKpに係数α(但し0<α<1、例えば、α=0.5)を掛ける(ステップS109)。
前記ステップS105で算出された傾斜偏差ΔθW又はΔθLが前記ROM602から読み出された目標範囲ΔθWd又はΔθLd内にあるか否かを判断する(ステップS110)。
具体的には、前記傾斜偏差ΔθW又はΔθLが前記目標範囲ΔθWd又はΔθLd内にあると判断した場合には、ステップS111に移行する一方、前記傾斜偏差ΔθW又はΔθLが前記目標範囲ΔθWd又はΔθLd内にないと判断した場合には、ステップS113に移行する。
前記ステップS110で前記傾斜偏差ΔθW又はΔθLが前記目標範囲ΔθWd又はΔθLd内にあると判断した場合、前記カウンタCを「0」にリセットする(ステップS111)。前記制御ゲインKpに前記変数Kp’の値を代入して該制御ゲインKpを元に戻し(ステップS112)、ステップS113に移行する。
次に、前記タイマによって所定時間経過したか否かを判断する(ステップS113)。
具体的には、所定時間経過していないと判断した場合には、ステップS104に戻る一方、所定時間経過したと判断した場合には、ステップS114に移行する。
ステップS114では、所定時間経過後に得られた、前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた制御ゲインkpの値を前記制御ゲインKi,Kdに代入し、ステップS115に移行する。
ステップS115では、前記リヤカバーセンサ624による検出上下回動角度θDを読み込み、ステップS116では、該読み込まれた検出上下回動角度θDに基づく前記ロータリー耕耘機400の検出耕深位置hDと前記耕深設定器626による設定耕深位置hRとの偏差Δhを算出する。
そして、前記ステップS6において、前記ステップS116で得られた偏差Δhと、前記ステップS101〜S114で得られた制御ゲインKp,Ki,Kdと、前記ステップS5で得られた偏差の累積値Δhi及び前回偏差との差Δhdとを前記式(3)に代入して、出力値Yを算出する。
(傾斜偏差ΔθW又はΔθLの微分値の大きさによる制御ゲインの選択)
次に、第1実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの微分値の大きさによって前記制御ゲインKp,Ki,Kdを選択する場合について説明する。
図15に、第1実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの微分値の大きさによって前記制御ゲインKp,Ki,Kdを選択するためのフローチャートを示す。
図15に示すフローチャートは、図13に示すフローチャートにおいて、前記ステップS3及びS4の代わりにそれぞれステップS30及びS40を設け、ステップS2とS30との間にステップS21を、またステップS40とS5との間にステップS41を追加している。図14に示すフローチャートは、ステップS30,S40,S21及びS41以外は図13のフローチャートと実質的に同じものである。従って、ここでは、これらのステップを中心に説明する。
図15に示す耕深制御では、ステップS1からの処理に先立ち、後述するステップS21の処理で用いる変数ΔθW2又はΔθL2に、初期値として「0(ゼロ)」が代入される。この変数ΔθW2又はΔθL2はステップS41において一回前に処理された傾斜偏差ΔθW又はΔθLの値を格納する為のものである。
ステップS21では、前記ステップS2で算出された傾斜偏差ΔθW又はΔθLの微分値を求める為に、次の式(4a)又は式(4b)に示すように、該傾斜偏差ΔθW又はΔθLと一回前に処理された傾斜偏差ΔθW又はΔθLの値を格納する変数ΔθW2又はΔθL2(但し初期値は「0」)との差を求め、該差を変数ΔθWj又はΔθLjに代入する。
ΔθWj=|ΔθW−ΔθW2|・・・式(4a)又は
ΔθLj=|ΔθL−ΔθL2|・・・式(4b)
ステップS30では、前記ROM602に予め記憶された、制御ゲインと傾斜偏差の微分値の大きさとの関係を示す制御ゲイン演算用関係式又は制御ゲインマップを該ROM602から読み出す。ステップS40では、該読み出された制御ゲイン演算用関係式又は制御ゲインマップと、前記ステップS21で算出された変数ΔθWj又はΔθLjとに基づき、前記傾斜偏差ΔθW又はΔθLの微分値ΔθWj又はΔθLj(変化割合)の大きさに応じた制御ゲインKp,Ki,Kdを求め、ステップS41に移行する。この場合の前記制御ゲインKp,Ki,Kdは、前記傾斜偏差ΔθW又はΔθLの微分値ΔθWj又はΔθLjの大きさが大きくなるに従って小さい値になる。
ステップS41では、前記変数ΔθW2又はΔθL2に前記ステップS2で算出された傾斜偏差ΔθW又はΔθLの値を代入する。
そして、前記ステップS6において、前記ステップS2で得られた偏差Δhと、前記ステップS40で得られた制御ゲインKp,Ki,Kdと、前記ステップS5で得られた偏差の累積値Δhi及び前回偏差との差Δhdとを前記式(3)に代入して、出力値Yを算出する。
なお、前記制御ゲインKp,Ki,Kdの変更に代えて、若しくは、加えて、前記自動耕深制御を行う際の不感帯幅δを変更することも可能である。
これについて、次の第2の実施形態を参照しながら説明する。
(第2実施形態)
以下、本発明に係る耕深制御装置の第2実施形態について説明する。
この第2実施形態に係る耕深制御装置は、図10に示す耕深制御装置とは耕深制御コントローラ600が異なる以外は実質的に同じものである。従って、第2実施形態に係る耕深制御装置のブロック図を図10に示すブロック図に代用させ、その詳細な説明を省略する。なお、耕深制御コントローラ600aの参照符号は図10に示す耕深制御コントローラ600の後の括弧内に付してある。後述する第3実施形態についても同様である。
第2実施形態に係る耕深制御装置の耕深制御コントローラ600aは、前記第1実施形態に係る耕深制御装置の耕深制御コントローラ600において前記ROM602の代わりにROM602aを備えている。なお、ROM602aの参照符号は図10に示すROM602の後の括弧内に付してある。後述する第3実施形態についても同様である。
図16は第2実施形態の耕深制御装置にてロータリー耕耘機400を耕深制御する際の制御ブロック線図である。
該耕深制御装置は、第1実施形態の耕深制御装置において、前記制御ゲインKp,Ki,Kdを変更する構成に代えて、前記ピッチング角センサ629の検出傾斜角θWと閾値傾斜角θW’との傾斜偏差ΔθW又は前記リフト角センサ627の検出傾斜角θLと閾値傾斜角θL’との傾斜偏差ΔθLの大きさに基づき前記自動耕深制御における不感帯幅δを変更するように構成されている。即ち、前記傾斜偏差ΔθW又はΔθLの大きさによって不感帯幅を選択するように構成されている(図16(a)参照)。
前記「傾斜偏差ΔθW又はΔθLの大きさによる不感帯幅の選択」に代えて、若しくは、加えて、該耕深制御コントローラ600aは、前記タイマにて前記傾斜偏差ΔθW又はΔθLの所定時間内における積分値の大きさに基づき前記自動耕深制御における不感帯幅δを変更するように構成されている。即ち、前記傾斜偏差ΔθW又はΔθLの積分値の大きさによって不感帯幅を選択するように構成されている(図16(b)参照)。
前記「傾斜偏差ΔθW又はΔθLの大きさによる不感帯幅の選択」及び/又は前記「傾斜偏差ΔθW又はΔθLの積分値の大きさによる不感帯幅の選択」に代えて、若しくは、加えて、該耕深制御コントローラ600aは、前記傾斜偏差ΔθW又はΔθLの変化割合の大きさに基づき前記自動耕深制御における不感帯幅δを変更するように構成されている。即ち、前記傾斜偏差ΔθW又はΔθLの微分値の大きさによって不感帯幅を選択するように構成されている(図16(c)参照)。
斯かる構成を備えることにより、前記傾斜偏差ΔθW又はΔθL、前記傾斜偏差ΔθW又はΔθLの積分値及び前記傾斜偏差ΔθW又はΔθLの微分値の大きさのうち少なくとも一つに応じて前記不感帯幅δを変更することができる。
本実施の形態においては、前記傾斜偏差ΔθW又はΔθL或いは/さらに前記傾斜偏差ΔθW又はΔθLの微分値の大きさが大きくなるに従って前記不感帯幅δを大きくするようになっている。これにより、前記車輌本体50の姿勢に拘わらず、前記ロータリ耕耘機400の自動耕深制御の安定化を図ることができる。
また、前記傾斜偏差ΔθW又はΔθLの積分値の大きさが所定の閾値以内の場合には前記不感帯幅δを所定の不感帯幅と等しいか又は前記所定不感帯幅より小さくし、且つ、前記傾斜偏差ΔθW又はΔθLの積分値の大きさが前記所定閾値よりも大きい場合には前記不感帯幅δを前記所定不感帯幅より大きくすることで、前記傾斜偏差ΔθW又はΔθLが大きい場合における前記耕耘リヤカバー437の回動角度の変動を有効に防止しつつ、可及的速やかに耕深位置hDを設定耕深位置hRに追従させることができるようにもなっている。これにより、自動耕深制御の安定化を図ることができる。また、この場合、持続的な外乱の入力があった場合であっても、前記ロータリ耕耘機400の昇降制御の安定化を図ることができる。
なお、前記フィルタ部625の遮断周波数Fcの範囲は、前記第1実施形態と同様、基準となる固定の基準遮断周波数範囲としている。また、本実施の形態では、前記第1実施形態と同様、前記傾斜偏差ΔθW又はΔθLの大きさについて、所定時間内における積分値を求めるが、前記積分値に代えて、平均値を求めてもよい。この場合の平均値は、単純平均値、重みつき平均値、単純移動平均値、重みつき移動平均値のうち何れであってもよい。また、前記所定時間内における前記積分値や前記平均値を求めるようにしてもよいが、所定サンプリング数における前記積分値や前記平均値を求めるようにしてもよい。
図17に、前記不感帯幅δと前記傾斜偏差ΔθW又はΔθLの大きさとの関係の一例を示す不感帯マップを示す。なお、図中Hは基準となる水平位置を示している。
前記ROM602aには、例えば、前記不感帯幅δと前記傾斜偏差ΔθW又はΔθLの大きさとの関係を示す不感帯幅演算用関係式又は不感帯マップが予め記憶されている。
この場合の前記不感帯幅演算用関係式としては、例えば、基準となる不感帯幅(基準不感帯幅)をδ’とし、前記閾値傾斜角θW’又はθL’より大きい所定の上限傾斜角をθW”又はθL”とし、該上限傾斜角をθW”又はθL”における不感帯幅をδ”(δ”>δ’)とすると、前記ピッチング角センサ629又は前記リフト角センサ627の検出傾斜角θW又はθLが前記閾値傾斜角θW’又はθL’以下の場合には、δp=δ’とし、前記検出傾斜角θW又はθLが前記閾値傾斜角θW’又はθL’より大きく、且つ、前記上限傾斜角θW”又はθL”より小さい場合には、傾斜偏差ΔθW又はΔθLが大きくなるに従って不感帯幅δpが大きくなるような比例関係とし、さらに、前記検出傾斜角θW又はθLが前記上限傾斜角θW”又はθL”以上の場合には、δp=δ”となるような関係式を挙げることができる。
この不感帯幅演算用関係式関係式を不感帯マップとした場合を図17に示している。図17では、前記傾斜偏差ΔθW又はΔθLの大きさを横軸に採り、前記不感帯幅δを縦軸に採っている。
斯かる構成を備えることにより、前記耕深制御コントローラ600aは、前記傾斜偏差ΔθW又はΔθLの大きさが大きくなるに従って前記不感帯幅δを大きくする。
なお、前記傾斜偏差ΔθW又はΔθLの大きさとこれに対応する不感帯幅δとが関連づけられたデータを、テーブルマップとして前記ROM602aに予め記憶させるようにしてもよい。
ここで、不感帯とは、前記ロータリー耕耘機400の検出耕深位置hDが前記耕深設定器626による設定耕深位置hRを中心とする所定の上下幅範囲内にあれば、前記昇降制御油圧シリンダ220を非駆動とし、検出耕深位置hDが前記上下幅範囲から外れていれば、前記昇降制御油圧シリンダ220を昇降動させて前記ロータリ耕耘機400の耕深位置を設定耕深位置hRに近付ける動作隙間のことをいう。
また、前記不感帯幅δと前記傾斜偏差ΔθW又はΔθLの所定時間内(又は所定サンプリング数)における積分値(若しくは平均値)の大きさとの関係を得るための手段は、例えば、前記傾斜偏差ΔθW又はΔθLの所定時間内(又は所定サンプリング数)における積分値(若しくは平均値)の大きさとこれに対応する不感帯幅δとが関連づけられた関係式又は不感帯マップ或いはテーブルマップであってもよい。
前記不感帯幅δと前記傾斜偏差ΔθW又はΔθLの変化割合(微分値)の大きさとの関係を得るための手段は、例えば、前記傾斜偏差ΔθW又はΔθLの変化割合(微分値)の大きさとこれに対応する不感帯幅δとが関連づけられた関係式又は不感帯マップ或いはテーブルマップであってもよい。
前記不感帯幅δと前記傾斜偏差ΔθW又はΔθLの微分値の大きさとの関係を得るための手段は、本実施の形態では、前記不感帯幅δと前記傾斜偏差ΔθW又はΔθLの微分値の大きさとの関係を示す不感帯幅演算用関係式又は不感帯マップ或いはテーブルマップであって、図17に示す関係と同様の関係を示すものを用いている。例えば、前記ROM602aには、前記不感帯幅δと前記傾斜偏差ΔθW又はΔθLの微分値の大きさとの関係を示す不感帯幅演算用関係式又は不感帯マップも予め記憶されている。
斯かる構成を備えることにより、前記耕深制御コントローラ600aは、前記傾斜偏差ΔθW又はΔθLの微分値の大きさが大きくなるに従って前記不感帯幅δを大きくする。
また、前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた前記不感帯幅δは、係数αを除き前記第1実施形態と同様にして求めている。これについては後述する図19のフローチャートで説明する。
斯かる構成を備えることにより、前記耕深制御コントローラ600aは、前記傾斜偏差ΔθW又はΔθLの積分値の大きさが閾値偏差ΔθWt’又はΔθLt’以内の場合には前記不感帯幅δを元の不感帯幅と等しいか又は大きく(ここでは等しく)し、且つ、前記積分値の大きさが前記閾値偏差ΔθWt’又はΔθLt’より大きい場合には前記不感帯幅δを元の不感帯幅より大きくする。
なお、図19のフローチャートで用いる閾値偏差ΔθWt’又はΔθLt’、閾値カウンタCt’及び目標範囲ΔθWd’又はΔθLd’は、前記ROM602aに予め記憶されている。
次に、図16乃至図20を参照しながら前記耕深制御コントローラ600aによる前記ロータリー耕耘機400の耕深制御動作の一例を以下に詳述する。
(傾斜偏差ΔθW又はΔθLの大きさによる不感帯幅の選択)
先ず、第2実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの大きさによって前記不感帯幅δを選択する場合について説明する。
図18に、第2実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの大きさによって前記不感帯幅δを選択するためのフローチャートを示す。
図18に示すフローチャートは、図13に示すフローチャートにおいて、前記ステップS3及びS4の代わりにそれぞれステップS3’及びS4’を設けている。図18のフローチャートは、S3’及びS4’以外は図13のフローチャートと実質的に同じものである。従って、ここでは、これらのステップを中心に説明する。
ステップS3’では、前記ROM602aに予め記憶された、不感帯幅と傾斜偏差の大きさとの関係を示す不感帯幅演算用関係式又は不感帯マップを該ROM602aから読み出す。
ステップS4’では、前記傾斜偏差ΔθW又はΔθLの大きさに応じた不感帯幅δによる不感帯処理を行う。
具体的には、該読み出された不感帯幅演算用関係式又は不感帯マップと、前記ステップS2で算出された前記傾斜偏差ΔθW又はΔθLとに基づき、前記傾斜偏差ΔθW又はΔθLの大きさに応じた不感帯幅δを求める。この場合の前記不感帯幅δは、前記傾斜偏差ΔθW又はΔθLの大きさが大きくなるに従って大きい値になる(図17参照)。
これにより、耕深制御の際には、前記検出耕深位置hDと前記設定耕深位置hRとの差量が前記傾斜偏差ΔθW又はΔθLの大きさに応じた不感帯幅δ内にあれば、前記昇降制御油圧シリンダ220が非駆動とされ、該差量が該不感帯幅δから外れていれば、前記自動傾き制御量にて前記昇降制御油圧シリンダ220が駆動される。
(傾斜偏差ΔθW又はΔθLの積分値の大きさによる不感帯幅の選択)
次に、第2実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの積分値の大きさによって前記不感帯幅δを選択する場合について説明する。
図19に、第2実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの積分値の大きさによって前記不感帯幅δを選択するためのフローチャートを示す。
図19に示すフローチャートは、図14に示すフローチャートにおいて、前記ステップS102、S103,S106,S108〜S110,S112及びS114の代わりにそれぞれステップS102’、S103’,S106’,S108’〜S110’,S112’及びS114’を設けている。図19に示すフローチャートは、ステップS102’、S103’,S106’,S108’〜S110’,S112’及びS114’以外は図14に示すフローチャートと実質的に同じものである。従って、ここでは、これらのステップを中心に説明する。
ステップS102’では、前記ROM602aに予め記憶された前記閾値偏差ΔθWt’又はΔθLt’、閾値カウンタCt’及び目標範囲ΔθWd’又はΔθLd’を該ROM602aから読み出す。
ステップS103’では、前記不感帯幅δの値を変数δ’に代入する。
ステップS106’では、前記ステップS105で算出された傾斜偏差ΔθW又はΔθLが前記ROM602aから読み出された閾値偏差ΔθWt’又はΔθLt’より大きいか否かを判断する。
具体的には、前記傾斜偏差ΔθW又はΔθLが前記閾値偏差ΔθWt’又はΔθLt’より大きいと判断した場合には、ステップS107に移行する一方、前記傾斜偏差ΔθW又はΔθLが前記閾値偏差ΔθWt’又はΔθLt’と等しいか又は前記閾値偏差ΔθWt’又はΔθLt’より小さいと判断した場合には、ステップS108’に移行する。
ステップS108’では、前記カウンタCが前記ROM602aから読み出された閾値カウンタCt’より大きいか否かを判断する。
具体的には、前記カウンタCが前記閾値カウンタCt’より大きいと判断した場合には、ステップS109’に移行する一方、前記カウンタCが前記閾値カウンタCt’と等しいか又は前記閾値カウンタCt’より小さいと判断した場合には、ステップS110’に移行する。
ステップS109’では、前記不感帯幅δに係数β1(但しβ1>1、例えば、β1=2)を掛ける。
ステップS110’では、前記ステップS105で算出された傾斜偏差ΔθW又はΔθLが前記ROM602aから読み出された目標範囲ΔθWd’又はΔθLd’内にあるか否かを判断する。
具体的には、前記傾斜偏差ΔθW又はΔθLが前記目標範囲ΔθWd’又はΔθLd’内にあると判断した場合には、ステップS111に移行する一方、前記傾斜偏差ΔθW又はΔθLが前記目標範囲ΔθWd’又はΔθLd’内にないと判断した場合には、ステップS113に移行する。
ステップS112’では、前記不感帯幅δに前記変数δ’の値を代入して該不感帯幅δを元に戻し、ステップS113に移行する。
ステップS114’では、前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた不感帯幅δによる不感帯処理を行う。
具体的には、所定時間経過後の前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた不感帯幅δを得る。
これにより、耕深制御の際には、前記検出耕深位置hDと前記設定耕深位置hRとの差量が前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた不感帯幅δ内にあれば、前記昇降制御油圧シリンダ220が非駆動とされ、該差量が該不感帯幅δから外れていれば、前記自動傾き制御量にて前記昇降制御油圧シリンダ220が駆動される。
(傾斜偏差ΔθW又はΔθLの微分値の大きさによる不感帯幅の選択)
次に、第2実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの微分値の大きさによって前記不感帯幅δを選択する場合について説明する。
図20に、第2実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの微分値の大きさによって前記不感帯幅δを選択するためのフローチャートを示す。
図20に示すフローチャートは、図15に示すフローチャートにおいて、前記ステップS30及びS40の代わりにそれぞれステップS30’及びS40’を設けている。図20に示すフローチャートは、ステップS30’及びS40’以外は図15に示すフローチャートと実質的に同じものである。従って、ここでは、これらのステップを中心に説明する。
ステップS30’では、前記ROM602aに予め記憶された、不感帯幅と傾斜偏差の微分値の大きさとの関係を示す不感帯幅演算用関係式又は不感帯マップを該ROM602aから読み出す。
ステップS40’では、前記傾斜偏差ΔθW又はΔθLの微分値の大きさに応じた不感帯幅δによる不感帯処理を行う。
具体的には、該読み出された不感帯幅演算用関係式又は不感帯マップと、前記ステップS21で算出された変数ΔθWj又はΔθLjとに基づき、前記傾斜偏差ΔθW又はΔθLの微分値ΔθWj又はΔθLj(変化割合)の大きさに応じた不感帯幅δを求める。この場合の前記不感帯幅δは、前記傾斜偏差ΔθW又はΔθLの微分値の大きさが大きくなるに従って大きい値になる。
これにより、耕深制御の際には、前記検出耕深位置hDと前記設定耕深位置hRとの差量が前記傾斜偏差ΔθW又はΔθLの微分値の大きさに応じた不感帯幅δ内にあれば、前記昇降制御油圧シリンダ220が非駆動とされ、該差量が該不感帯幅δから外れていれば、前記自動傾き制御量にて前記昇降制御油圧シリンダ220が駆動される。
なお、前記制御ゲインKp,Ki,Kd及び/又は前記不感帯幅δの変更に代えて、若しくは、加えて、前記自動耕深制御を行う際の後述するフィルタ部625bの遮断周波数Fcの範囲を変更することも可能である。
これについて、次の第3の実施形態を参照しながら説明する。
(第3実施形態)
以下、本発明に係る耕深制御装置の第3実施形態について説明する。
この第3実施形態に係る耕深制御装置は、図10に示す耕深制御装置とは耕深制御コントローラ600が異なる以外は実質的に同じものである。
第3実施形態に係る耕深制御装置の耕深制御コントローラ600bは、前記第1実施形態に係る耕深制御装置の耕深制御コントローラ600において前記ROM602及び前記フィルタ部625の代わりにROM602b及びフィルタ部625bを備えている。前記フィルタ部625bは、遮断周波数Fcの範囲が可変されるように構成されている。なお、前記フィルタ部625bの参照符号は図10に示すフィルタ部625の後の括弧内に付してある。
図21は第3実施形態の耕深制御装置にてロータリー耕耘機400を耕深制御する際の制御ブロック線図である。
該耕深制御装置は、第1実施形態の耕深制御装置において、前記制御ゲインKp,Ki,Kdを変更する構成に代えて、前記ピッチング角センサ629の検出傾斜角θWと閾値傾斜角θW’との傾斜偏差ΔθW又は前記リフト角センサ627の検出傾斜角θLと閾値傾斜角θL’との傾斜偏差ΔθLの大きさに基づき前記自動耕深制御における遮断周波数Fcの範囲を変更するように構成されている。即ち、前記傾斜偏差ΔθW又はΔθLの大きさによって遮断周波数範囲を選択するように構成されている(図21(a)参照)。
前記「傾斜偏差ΔθW又はΔθLの大きさによる遮断周波数範囲の選択」に代えて、若しくは、加えて、該耕深制御コントローラ600bは、前記タイマにて前記傾斜偏差ΔθW又はΔθLの所定時間内における積分値の大きさに基づき前記自動耕深制御における遮断周波数Fcの範囲を変更するように構成されている。即ち、前記傾斜偏差ΔθW又はΔθLの積分値の大きさによって遮断周波数範囲を選択するように構成されている(図21(b)参照)。
前記「傾斜偏差ΔθW又はΔθLの大きさによる遮断周波数範囲の選択」及び/又は前記「傾斜偏差ΔθW又はΔθLの積分値の大きさによる遮断周波数範囲の選択」に代えて、若しくは、加えて、該耕深制御コントローラ600bは、前記傾斜偏差ΔθW又はΔθLの変化割合の大きさに基づき前記自動耕深制御における遮断周波数の範囲を変更するように構成されている。即ち、前記傾斜偏差ΔθW又はΔθLの微分値の大きさによって遮断周波数範囲を選択するように構成されている(図21(c)参照)。
斯かる構成を備えることにより、前記傾斜偏差ΔθW又はΔθL、前記傾斜偏差ΔθW又はΔθLの積分値及び前記傾斜偏差ΔθW又はΔθLの微分値の大きさのうち少なくとも一つに応じて前記遮断周波数Fcの範囲を変更することができる。
本実施の形態においては、前記傾斜偏差ΔθW又はΔθL或いは/さらに前記傾斜偏差ΔθW又はΔθLの微分値の大きさが大きくなるに従って前記遮断周波数Fcの範囲を小さくするようになっている。これにより、前記車輌本体50の姿勢に拘わらず、前記ロータリ耕耘機400の自動耕深制御の安定化を図ることができる。
また、前記傾斜偏差ΔθW又はΔθLの積分値の大きさが所定の閾値以内の場合には前記遮断周波数Fcの範囲を所定の遮断周波数範囲と等しいか又は前記所定遮断周波数範囲より大きくし、且つ、前記傾斜偏差ΔθW又はΔθLの積分値の大きさが前記所定閾値よりも大きい場合には前記遮断周波数Fcの範囲を前記所定遮断周波数範囲より小さくすることで、前記傾斜偏差ΔθW又はΔθLが大きい場合における前記耕耘リヤカバー437の回動角度の変動を有効に防止しつつ、可及的速やかに耕深位置hDを設定耕深位置hRに追従させることができるようにもなっている。これにより、自動耕深制御の安定化を図ることができる。また、この場合、持続的な外乱の入力があった場合であっても、前記ロータリ耕耘機400の昇降制御の安定化を図ることができる。
なお、本実施の形態では、前記第1実施形態と同様、前記傾斜偏差ΔθW又はΔθLの大きさについて、所定時間内における積分値を求めるが、前記積分値に代えて、平均値を求めてもよい。この場合の平均値は、単純平均値、重みつき平均値、単純移動平均値、重みつき移動平均値のうち何れであってもよい。また、前記所定時間内における前記積分値や前記平均値を求めるようにしてもよいが、所定サンプリング数における前記積分値や前記平均値を求めるようにしてもよい。
前記フィルタ部625bとしては、低域フィルタ(ローパスフィルタ、LPF)、高域フィルタ(ハイパスフィルタ、HPF)、帯域フィルタ(バンドパスフィルタ、BPF)、又は帯域消去フィルタ(バンドエリミネ−ションフィルタ、BEF)を採用することができる。本実施の形態では、前記フィルタ部625bとして低域フィルタが採用されている。周知の通り、低域フィルタは、その遮断周波数Fcより高い周波数域の信号をほぼ0(ゼロ)とし、遮断周波数Fc以下の周波数域の信号をそのまま通過させるように構成されている。遮断周波数Fcは周波数の通過域と減衰域との境界値のことである。
本実施の形態では、既述のとおり、前記フィルタ部625bで採用される遮断周波数Fcは可変となっているが、この可変の構成としては、例えば、LCフィルタ(コイルとコンデンサとからなるフィルタ)の場合は、可変コンデンサを使用することで実現できる。また、RCフィルタ(抵抗とコンデンサとからなるフィルタ)の場合は、可変抵抗と可変コンデンサとを組み合わせることで実現できる。
図22に、前記遮断周波数Fcと前記傾斜偏差ΔθW又はΔθLの大きさとの関係の一例を示す遮断周波数範囲マップを示す。なお、図中Hは基準となる水平位置を示している。
前記ROM602bには、例えば、前記遮断周波数Fcと前記傾斜偏差ΔθW又はΔθLの大きさとの関係を示す遮断周波数範囲演算用関係式又は遮断周波数範囲マップが予め記憶されている。
この場合の前記遮断周波数範囲演算用関係式としては、例えば、基準となる遮断周波数(基準遮断周波数)をFc’とし、前記閾値傾斜角θW’又はθL’より大きい所定の上限傾斜角をθW”又はθL”とし、該上限傾斜角をθW”又はθL”における遮断周波数をFc”(Fc”>Fc’)とすると、前記ピッチング角センサ629又は前記リフト角センサ627の検出傾斜角θW又はθLが前記閾値傾斜角θW’又はθL’以下の場合には、Fc=Fc’とし、前記検出傾斜角θW又はθLが前記閾値傾斜角θW’又はθL’より大きく、且つ、前記上限傾斜角θW”又はθL”より小さい場合には、傾斜偏差ΔθW又はΔθLが大きくなるに従って遮断周波数Fcが高くなるような比例関係とし、さらに、前記検出傾斜角θW又はθLが前記上限傾斜角θW”又はθL”以上の場合には、Fc=Fc”となるような関係式を挙げることができる。
この遮断周波数範囲演算用関係式を遮断周波数範囲マップとした場合を図22に示している。図22では、前記検出傾斜角θW又はθLを横軸に採り、前記遮断周波数Fcを縦軸に採っている。
斯かる構成を備えることにより、前記耕深制御コントローラ600bは、前記傾斜偏差ΔθW又はΔθLの大きさが大きくなるに従って前記遮断周波数Fcの範囲を小さく(本実施の形態では前記フィルタ部625bは低域フィルタであるので遮断周波数Fcを高く)する。
なお、前記傾斜偏差ΔθW又はΔθLの大きさとこれに対応する遮断周波数Fcとが関連づけられたデータを、テーブルマップとして前記ROM602bに予め記憶させるようにしてもよい。
また、前記遮断周波数Fcと前記傾斜偏差ΔθW又はΔθLの所定時間内(又は所定サンプリング数)における積分値(若しくは平均値)の大きさとの関係を得るための手段は、例えば、前記傾斜偏差ΔθW又はΔθLの所定時間内(又は所定サンプリング数)における積分値(若しくは平均値)の大きさとこれに対応する遮断周波数Fcとが関連づけられた関係式又は遮断周波数範囲マップ或いはテーブルマップであってもよい。
前記遮断周波数Fcと前記傾斜偏差ΔθW又はΔθLの変化割合(微分値)の大きさとの関係を得るための手段は、例えば、前記傾斜偏差ΔθW又はΔθLの変化割合(微分値)の大きさとこれに対応する遮断周波数Fcとが関連づけられた関係式又は遮断周波数範囲マップ或いはテーブルマップであってもよい。
前記遮断周波数Fcと前記傾斜偏差ΔθW又はΔθLの微分値の大きさとの関係を得るための手段は、本実施の形態では、前記遮断周波数Fcと前記傾斜偏差ΔθW又はΔθLの微分値の大きさとの関係を示す遮断周波数範囲演算用関係式又は遮断周波数範囲マップ或いはテーブルマップであって、図22に示す関係と同様の関係を示すものを用いている。例えば、前記ROM602bには、前記遮断周波数Fcと前記傾斜偏差ΔθW又はΔθLの微分値の大きさとの関係を示す遮断周波数範囲演算用関係式又は遮断周波数範囲マップも予め記憶されている。
斯かる構成を備えることにより、前記耕深制御コントローラ600bは、前記傾斜偏差ΔθW又はΔθLの微分値の大きさが大きくなるに従って前記遮断周波数Fcの範囲を小さく(本実施の形態では遮断周波数Fcを高く)する。
また、前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた前記遮断周波数Fcは、係数αを除き前記第1実施形態と同様にして求めている。これについては後述する図24のフローチャートで説明する。
斯かる構成を備えることにより、前記耕深制御コントローラ600bは、前記傾斜偏差ΔθW又はΔθLの積分値の大きさが閾値偏差ΔθWt”又はΔθLt”以内の場合には前記遮断周波数Fcの範囲を元の遮断周波数の範囲と等しいか又は大きく(本実施の形態では遮断周波数Fcを等しく)し、且つ、前記積分値の大きさが前記閾値偏差ΔθWt’又はΔθLt”より大きい場合には前記遮断周波数Fcの範囲を元の遮断周波数の範囲より小さくする(本実施の形態では遮断周波数Fcを高くする)。
なお、図24のフローチャートで用いる閾値偏差ΔθWt”又はΔθLt”、閾値カウンタCt”及び目標範囲ΔθWd”又はΔθLd”は、前記ROM602bに予め記憶されている。
なお、前記フィルタ部625bは、前記遮断周波数Fcが伝送されることにより、遮断周波数をFcとするフィルタが形成される。
次に、図21乃至図25を参照しながら前記耕深制御コントローラ600bによる前記ロータリー耕耘機400の耕深制御動作の一例を以下に詳述する。
(傾斜偏差ΔθW又はΔθLの大きさによる遮断周波数範囲の選択)
先ず、第3実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの大きさによって前記遮断周波数Fcの範囲を選択する場合について説明する。
図23に、第3実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの大きさによって前記遮断周波数Fcの範囲を選択するためのフローチャートを示す。
図23に示すフローチャートは、図13に示すフローチャートにおいて、前記ステップS3及びS4の代わりにそれぞれステップS3”及びS4”を設けている。図23のフローチャートは、S3”及びS4”以外は図13のフローチャートと実質的に同じものである。従って、ここでは、これらのステップを中心に説明する。
ステップS3”では、前記ROM602bに予め記憶された、遮断周波数と傾斜偏差の大きさとの関係を示す遮断周波数範囲演算用関係式又は遮断周波数範囲マップを該ROM602bから読み出す。
ステップS4”では、前記傾斜偏差ΔθW又はΔθLの大きさに応じた遮断周波数Fcによるフィルタ処理を行う。
具体的には、該読み出された遮断周波数範囲演算用関係式又は遮断周波数範囲マップと、前記ステップS2で算出された傾斜偏差ΔθW又はΔθLとに基づき、前記傾斜偏差ΔθW又はΔθLの大きさに応じた遮断周波数Fcを求める。この場合の前記遮断周波数Fcは、前記傾斜偏差ΔθW又はΔθLの大きさが大きくなるに従って高い値に(換言すれば遮断周波数Fcの範囲は小さく)なる(図22のハッチング部参照)。
これにより、耕深制御の際には、前記フィルタ部625bにおいて、前記傾斜偏差ΔθW又はΔθLの大きさに応じた遮断周波数Fcとするフィルタが形成され、該フィルタ部625bを介して前記リヤカバーセンサ624で検出上下回動角度θDに基づく検出耕深位置hDが検出され、この検出耕深位置hDが記耕深設定器626にて設定された設定耕深位置hRとなるように前記昇降制御油圧シリンダ220の自動昇降制御量が算出される。こうして算出された自動昇降制御量にて前記昇降制御油圧シリンダ220が駆動される。
(傾斜偏差ΔθW又はΔθLの積分値の大きさによる遮断周波数範囲の選択)
次に、第3実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの積分値の大きさによって前記遮断周波数Fcの範囲を選択する場合について説明する。
図24に、第3実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの積分値の大きさによって前記遮断周波数Fcの範囲を選択するためのフローチャートを示す。
図24に示すフローチャートは、図14に示すフローチャートにおいて、前記ステップS102、S103,S106,S108〜S110,S112及びS114の代わりにそれぞれステップS102”、S103”,S106”,S108”〜S110”,S112”及びS114”を設けている。図24に示すフローチャートは、ステップS102”、S103”,S106”,S108”〜S110”,S112”及びS114”以外は図14に示すフローチャートと実質的に同じものである。従って、ここでは、これらのステップを中心に説明する。
ステップS102”では、前記ROM602bに予め記憶された前記閾値偏差ΔθWt”又はΔθLt”、閾値カウンタCt”及び目標範囲ΔθWd”又はΔθLd”を該ROM602bから読み出す。
ステップS103”では、前記遮前記遮断周波数Fcの値を変数Fc’に代入する。
ステップS106”では、前記ステップS105で算出された傾斜偏差ΔθW又はΔθLが前記ROM602bから読み出された閾値偏差ΔθWt”又はΔθLt”より大きいか否かを判断する。
具体的には、前記傾斜偏差ΔθW又はΔθLが前記閾値偏差ΔθWt”又はΔθLt”より大きいと判断した場合には、ステップS107に移行する一方、前記傾斜偏差ΔθW又はΔθLが前記閾値偏差ΔθWt”又はΔθLt”と等しいか又は前記閾値偏差ΔθWt”又はΔθLt”より小さいと判断した場合には、ステップS108”に移行する。
ステップS108”では、前記カウンタCが前記ROM602bから読み出された閾値カウンタCt”より大きいか否かを判断する。
具体的には、前記カウンタCが前記閾値カウンタCt”より大きいと判断した場合には、ステップS109”に移行する一方、前記カウンタCが前記閾値カウンタCt”と等しいか又は前記閾値カウンタCt”より小さいと判断した場合には、ステップS110”に移行する。
ステップS109”では、前記遮断周波数Fcに係数β2(但しβ2>1、例えば、β2=2)を掛ける。
ステップS110”では、前記ステップS105で算出された傾斜偏差ΔθW又はΔθLが前記ROM602bから読み出された目標範囲ΔθWd”又はΔθLd”内にあるか否かを判断する。
具体的には、前記傾斜偏差ΔθW又はΔθLが前記目標範囲ΔθWd”又はΔθLd”内にあると判断した場合には、ステップS111に移行する一方、前記傾斜偏差ΔθW又はΔθLが前記目標範囲ΔθWd”又はΔθLd”内にないと判断した場合には、ステップS113に移行する。
ステップS112”では、前記遮断周波数Fcに前記変数Fc’の値を代入して該遮断周波数Fcを元に戻し、ステップS113に移行する。
ステップS114”では、前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた遮断周波数Fcによるフィルタ処理を行う。
具体的には、所定時間経過後の前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた遮断周波数Fcを得る。
これにより、耕深制御の際には、前記フィルタ部625bにおいて、前記傾斜偏差ΔθW又はΔθLの積分値の大きさに応じた遮断周波数Fcとするフィルタが形成され、該フィルタ部625bを介して前記リヤカバーセンサ624で検出上下回動角度θDに基づく検出耕深位置hDが検出され、この検出耕深位置hDが記耕深設定器626にて設定された設定耕深位置hRとなるように前記昇降制御油圧シリンダ220の自動昇降制御量が算出される。こうして算出された自動昇降制御量にて前記昇降制御油圧シリンダ220が駆動される。
(傾斜偏差ΔθW又はΔθLの微分値の大きさによる遮断周波数範囲の選択)
次に、第3実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの微分値の大きさによって前記遮断周波数Fcの範囲を選択する場合について説明する。
図25に、第3実施形態に係る自動耕深制御において前記傾斜偏差ΔθW又はΔθLの微分値の大きさによって前記遮断周波数Fcの範囲を選択するためのフローチャートを示す。
図25に示すフローチャートは、図15に示すフローチャートにおいて、前記ステップS30及びS40の代わりにそれぞれステップS30”及びS40”を設けている。図25に示すフローチャートは、ステップS30”及びS40”以外は図15に示すフローチャートと実質的に同じものである。従って、ここでは、これらのステップを中心に説明する。
ステップS30”では、前記ROM602bに予め記憶された、遮断周波数範囲と傾斜偏差の微分値の大きさとの関係を示す遮断周波数範囲演算用関係式又は遮断周波数範囲マップを該ROM602bから読み出す。
ステップS40”では、前記傾斜偏差ΔθW又はΔθLの微分値の大きさに応じた遮断周波数Fcによるフィルタ処理を行う。
具体的には、該読み出された遮断周波数範囲演算用関係式又は遮断周波数範囲マップと、前記ステップS21で算出された変数ΔθWj又はΔθLjとに基づき、前記傾斜偏差ΔθW又はΔθLの微分値ΔθWj又はΔθLj(変化割合)の大きさに応じた前記遮断周波数Fcを求める。この場合の前記遮断周波数Fcは、前記傾斜偏差ΔθW又はΔθLの微分値の大きさが大きくなるに従って高い値に(換言すれば遮断周波数Fcの範囲は小さく)なる。
これにより、耕深制御の際には、前記フィルタ部625bにおいて、前記傾斜偏差ΔθW又はΔθLの微分値の大きさに応じた遮断周波数Fcとするフィルタが形成され、該フィルタ部625bを介して前記リヤカバーセンサ624で検出上下回動角度θDに基づく検出耕深位置hDが検出され、この検出耕深位置hDが記耕深設定器626にて設定された設定耕深位置hRとなるように前記昇降制御油圧シリンダ220の自動昇降制御量が算出される。こうして算出された自動昇降制御量にて前記昇降制御油圧シリンダ220が駆動される。
なお、前記フィルタ部625bは、本実施の形態では、図21に示すように、検出耕深位置の入力経路に介挿されているが、これに代えて、若しくは、加えて、前記昇降制御油圧シリンダ220への出力経路に介挿されてもよい。
図1は、本実施の形態に係る耕深制御装置が適用される作業車輌の一例である農作業用トラクタの概略側面図である。 図2は、図1に示すトラクタの概略平面図である。 図3は、図1に示すトラクタにおける耕耘機用昇降機構の概略側面図である。 図4は、図3に示す耕耘機用昇降機構の概略平面図である。 図5は、ロータリー耕耘機の図2におけるV−V線に沿った概略断面図である。 図6は、ロータリー耕耘機の概略背面図である。 図7は、トラクタの油圧回路図である。 図8は、ロータリー耕耘機の模式側面図である。 図9は、ロータリー耕耘機の模式背面図である。 図10は、第1から第3実施形態に係る耕深制御装置のブロック図である。 図11は、第1実施形態の耕深制御装置にてロータリー耕耘機を耕深制御する際の制御ブロック線図である。図11(a)に、検出耕深位置と設定耕深位置との傾斜偏差ΔθW又はΔθLの大きさによって制御ゲインを選択する構成を示し、図11(b)に、傾斜偏差ΔθW又はΔθLの積分値の大きさによって制御ゲインを選択する構成を示し、図11(c)に、傾斜偏差ΔθW又はΔθLの微分値の大きさによって制御ゲインを選択する構成を示す。 図12は、制御ゲインKpと傾斜偏差ΔθW又はΔθLの大きさとの関係の一例を示す制御ゲインマップである。 図13は、第1実施形態に係る自動耕深制御において傾斜偏差ΔθW又はΔθLの大きさによって制御ゲインKp,Ki,Kdを選択するためのフローチャートである。 図14は、第1実施形態に係る自動耕深制御において傾斜偏差ΔθW又はΔθLの積分値の大きさによって制御ゲインKp,Ki,Kdを選択するためのフローチャートである。 図15は、第1実施形態に係る自動耕深制御において傾斜偏差ΔθW又はΔθLの微分値の大きさによって制御ゲインKp,Ki,Kdを選択するためのフローチャートである。 図16は、第2実施形態の耕深制御装置にてロータリー耕耘機を耕深制御する際の制御ブロック線図である。図16(a)に、検出耕深位置と設定耕深位置との傾斜偏差ΔθW又はΔθLの大きさによって不感帯幅を選択する構成を示し、図16(b)に、傾斜偏差ΔθW又はΔθLの積分値の大きさによって不感帯幅を選択する構成を示し、図16(c)に、傾斜偏差ΔθW又はΔθLの微分値の大きさによって不感帯幅を選択する構成を示す。 図17は、不感帯幅δと傾斜偏差ΔθW又はΔθLの大きさとの関係の一例を示す不感帯マップである。 図18は、第2実施形態に係る自動耕深制御において傾斜偏差ΔθW又はΔθLの大きさによって不感帯幅δを選択するためのフローチャートである。 図19は、第2実施形態に係る自動耕深制御において傾斜偏差ΔθW又はΔθLの積分値の大きさによって不感帯幅δを選択するためのフローチャートである。 図20は、第2実施形態に係る自動耕深制御において傾斜偏差ΔθW又はΔθLの微分値の大きさによって不感帯幅δを選択するためのフローチャートである。 図21は、第3実施形態の耕深制御装置にてロータリー耕耘機を耕深制御する際の制御ブロック線図である。図21(a)に、検出耕深位置と設定耕深位置との傾斜偏差ΔθW又はΔθLの大きさによって遮断周波数範囲を選択する構成を示し、図21(b)に、傾斜偏差ΔθW又はΔθLの積分値の大きさによって遮断周波数範囲を選択する構成を示し、図21(c)に、傾斜偏差ΔθW又はΔθLの微分値の大きさによって遮断周波数範囲を選択する構成を示す。 図22は、遮断周波数Fcと傾斜偏差ΔθW又はΔθLの大きさとの関係の一例を示す遮断周波数範囲マップである。 図23は、第3実施形態に係る自動耕深制御において傾斜偏差ΔθW又はΔθLの大きさによって遮断周波数Fcの範囲を選択するためのフローチャートである。 図24は、第3実施形態に係る自動耕深制御において傾斜偏差ΔθW又はΔθLの積分値の大きさによって遮断周波数Fcの範囲を選択するためのフローチャートである。 図25は、第3実施形態に係る自動耕深制御において傾斜偏差ΔθW又はΔθLの微分値の大きさによって遮断周波数Fcの範囲を選択するためのフローチャートである。
符号の説明
50…車輌本体 220…昇降用アクチュエータ 400…耕耘機 600…制御手段
624…リヤカバー 626…耕深深さ設定手段 hD…検出耕深位置
hR…設定耕深位置

Claims (8)

  1. リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、
    前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさに基づき自動耕深制御における制御ゲインを変更するように構成したことを特徴とする耕深制御装置。
  2. リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、
    前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさに基づき自動耕深制御における不感帯幅を変更するように構成したことを特徴とする耕深制御装置。
  3. リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、
    前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の大きさに基づき自動耕深制御におけるフィルタリング条件を変更するように構成したことを特徴とする耕深制御装置。
  4. 前記傾斜偏差の大きさは、所定時間内における平均値又は積分値であることを特徴とする請求項1から3の何れかに記載の耕深制御装置。
  5. リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、
    前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさに基づき自動耕深制御における制御ゲインを変更するように構成したことを特徴とする耕深制御装置。
  6. リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、
    前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさに基づき自動耕深制御における不感帯幅を変更するように構成したことを特徴とする耕深制御装置。
  7. リヤカバーの回動角度に基づき、車輌本体に対して昇降可能に連結された耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御を行うように構成された耕深制御装置であって、
    前記車輌本体の検出傾斜角と閾値傾斜角との傾斜偏差の変化割合の大きさに基づき自動耕深制御におけるフィルタリング条件を変更するように構成したことを特徴とする耕深制御装置。
  8. 前記傾斜偏差の変化割合の大きさは、所定時間内における平均値又は積分値であることを特徴とする請求項5から7の何れかに記載の耕深制御装置。
JP2005323851A 2005-11-08 2005-11-08 耕深制御装置 Pending JP2007129918A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005323851A JP2007129918A (ja) 2005-11-08 2005-11-08 耕深制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005323851A JP2007129918A (ja) 2005-11-08 2005-11-08 耕深制御装置

Publications (1)

Publication Number Publication Date
JP2007129918A true JP2007129918A (ja) 2007-05-31

Family

ID=38152103

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005323851A Pending JP2007129918A (ja) 2005-11-08 2005-11-08 耕深制御装置

Country Status (1)

Country Link
JP (1) JP2007129918A (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010161976A (ja) * 2009-01-16 2010-07-29 Mitsubishi Agricult Mach Co Ltd トラクタの耕深自動制御装置
RU2478270C1 (ru) * 2011-10-13 2013-04-10 Федеральное государственное бюджетное образовательное учреждение высшего профессионального образования "Воронежский государственный аграрный университет имени императора Петра I" (ФГБОУ ВПО Воронежский ГАУ) Навесной вибрирующий плуг
CN106797715A (zh) * 2017-02-08 2017-06-06 贵州大学 一种小型立式深耕方法及装置
WO2018180919A1 (ja) * 2017-03-30 2018-10-04 ヤンマー株式会社 水田作業車両
EP3971349A1 (en) * 2020-09-18 2022-03-23 Deere & Company Automated ground leveling using artificial neural network

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH03198701A (ja) * 1989-12-27 1991-08-29 Iseki & Co Ltd 対地作業機のローリング制御装置
JPH0928113A (ja) * 1995-07-18 1997-02-04 Iseki & Co Ltd 耕深制御装置
JPH09238506A (ja) * 1996-03-07 1997-09-16 Kubota Corp 農用トラクタ
JP2000041415A (ja) * 1998-07-28 2000-02-15 Iseki & Co Ltd トラクタの制御装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH03198701A (ja) * 1989-12-27 1991-08-29 Iseki & Co Ltd 対地作業機のローリング制御装置
JPH0928113A (ja) * 1995-07-18 1997-02-04 Iseki & Co Ltd 耕深制御装置
JPH09238506A (ja) * 1996-03-07 1997-09-16 Kubota Corp 農用トラクタ
JP2000041415A (ja) * 1998-07-28 2000-02-15 Iseki & Co Ltd トラクタの制御装置

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010161976A (ja) * 2009-01-16 2010-07-29 Mitsubishi Agricult Mach Co Ltd トラクタの耕深自動制御装置
RU2478270C1 (ru) * 2011-10-13 2013-04-10 Федеральное государственное бюджетное образовательное учреждение высшего профессионального образования "Воронежский государственный аграрный университет имени императора Петра I" (ФГБОУ ВПО Воронежский ГАУ) Навесной вибрирующий плуг
CN106797715A (zh) * 2017-02-08 2017-06-06 贵州大学 一种小型立式深耕方法及装置
WO2018180919A1 (ja) * 2017-03-30 2018-10-04 ヤンマー株式会社 水田作業車両
EP3971349A1 (en) * 2020-09-18 2022-03-23 Deere & Company Automated ground leveling using artificial neural network

Similar Documents

Publication Publication Date Title
WO2015019942A1 (ja) 作業機の姿勢制御装置
JP2007129918A (ja) 耕深制御装置
JP4895260B2 (ja) 姿勢制御装置
JP4863348B2 (ja) 耕深制御装置
JP4863347B2 (ja) 姿勢制御装置
US20230150330A1 (en) Work vehicle and controller for work vehicle
JP4863349B2 (ja) 昇降制御装置
JP4587392B2 (ja) 耕耘制御装置
JP4416437B2 (ja) トラクタに装着したロータリ耕耘機の耕深制御装置
JP4605652B2 (ja) 農作業機の耕耘制御装置
JP4589175B2 (ja) ロータリ耕耘装置
JP4733422B2 (ja) 作業機の姿勢制御装置
JP5524753B2 (ja) 作業車両
JP4753287B2 (ja) 農作業機械
JP2007135531A (ja) 鎮圧機構
JP3880538B2 (ja) 農作業機の制御装置
JP6325210B2 (ja) 作業機の姿勢制御装置
JP4693521B2 (ja) 農作業機械
JP3838111B2 (ja) 水田作業機
JP2006340621A (ja) 農作業機の耕耘制御装置
JP2007000088A (ja) 農作業機械
JP2006340619A (ja) 農作業機の耕耘制御装置
JP2006314209A (ja) 作業機の姿勢制御装置
JP2006325413A (ja) 作業機の姿勢制御装置
JP2007097493A (ja) 姿勢制御装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080724

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100930

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110617

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20111104