JP3577737B2 - ローリング制御装置 - Google Patents
ローリング制御装置 Download PDFInfo
- Publication number
- JP3577737B2 JP3577737B2 JP10192094A JP10192094A JP3577737B2 JP 3577737 B2 JP3577737 B2 JP 3577737B2 JP 10192094 A JP10192094 A JP 10192094A JP 10192094 A JP10192094 A JP 10192094A JP 3577737 B2 JP3577737 B2 JP 3577737B2
- Authority
- JP
- Japan
- Prior art keywords
- ground
- inclination
- rolling
- value
- output
- 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
Links
Images
Landscapes
- Lifting Devices For Agricultural Implements (AREA)
Description
【産業上の利用分野】
本発明は、トラクタにローリング自在に装着された作業機の対地左右傾斜をほぼ一定に維持するように制御するローリング制御装置に関するものである。
【0002】
【従来の技術】
トラクタに装着された作業機の対地左右傾斜をほぼ一定に維持するように制御するローリング制御は、作業機の対地左右傾斜の現在値と目標値を比較し、その偏差が所定の許容範囲(不感帯)内に収まるように作業機をトラクタに対してローリングさせる仕組みとなっている。作業機をローリングさせるためのアクチュエータとしては一般的に油圧シリンダが用いられている。この油圧シリンダの制御バルブは比例ソレノイドバルブであり、出力信号のONタイムに比例して油圧シリンダが動作する。
【0003】
上記ローリング制御を行うに際し、表土面の凹凸が大きい荒れた圃場では、作業機の対地左右傾斜を迅速に修正するために、素早い応答が要求される。これに対し、表土面が平坦なよく整地された圃場では、作業機の対地左右傾斜が極めて小さいので、あまり素早い応答は必要なく、むしろ、以下の理由により、応答性を抑えておくのが好ましくない。すなわち、平坦な圃場では本来ならば作業機がほとんど左右に傾斜しないはずであるが、実際には車輪のラグによる振動の影響を受け、作業機が小刻みに左右傾斜する。このような小さな動きに反応していちいちローリング制御出力していると、小刻みな周期にローリング制御動作が追随できないため、ハンチングが生じる原因となるのである。
【0004】
そこで、現状では、ローリング制御の感度を調節する感度調節具を設け、この感度調節具を用いてオペレータが圃場状態に応じてローリング制御の感度を切り替えている。しかしながら、圃場状態の判断はオペレータの勘に基づくものであるから、必ずしも適切な感度でローリング制御が行われるとは限らなかった。また、オペレータは常に圃場状態を監視し続け、圃場状態が変化したならばそれに応じてローリング制御の感度を切り替えなければならないので、オペレータの負担が大きかった。
【0005】
【発明が解決しようとする課題】
本発明は、上記事情に鑑みなされたものであり、車輪のラグによる振動や表土面の微小な凹凸変化に起因する作業機の対地左右傾斜に対してはローリング制御の応答速度を遅くし、大きな対地左右傾斜に対しては素早い対応でローリング制御を行わせ、制御の精度を高めるとともに、制御の安定化を図ることを課題とするものである。
【0006】
【課題を解決するための手段】
上記課題を解決するために、本発明は次のような構成とした。すなわち、本発明にかかるローリング制御装置は、トラクタにローリング自在に装着された作業機の対地左右傾斜をほぼ一定に維持するように制御するローリング制御装置であって、作業機の対地左右傾斜の現在値を検出する現在値検出手段と、作業機の対地左右傾斜の目標値を設定する目標値設定手段と、前記現在値が前記目標値に近づくように作業機をローリングさせるローリング手段と、対地左右傾斜が一方向から反対方向へ移行する際に、前回の対地左右傾斜における最大値と目標値との偏差である偏差ピーク値、および前回の対地左右傾斜に対する前記ローリング手段への出力要求発生時間を入力変数とし、かつ、次回の対地左右傾斜における前記ローリング手段への出力開始を遅らせるONディレー時間を出力変数としてファジィ推論を行うONディレー時間決定手段とを具備することを特徴としている。
【0007】
【作用】
前回の対地左右傾斜における対地左右傾斜の現在値と目標値との偏差、および前回の対地左右傾斜に対するローリング手段への出力要求時間を入力変数とし、かつ、次回の対地左右傾斜におけるローリング手段への出力開始を遅らせるONディレー時間を出力変数としてONディレー時間を出力変数としてファジィ推論を行う。このようにして決定された反対出力のONディレー時間を次回の対地左右傾斜に対して適用し、作業機の対地左右傾斜が一方向から反対方向へ移行する際に、出力要求よりも遅らせてローリング手段に出力する。
【0008】
具体的には、ファジィ推論を行うに当たり、前回の対地左右傾斜に対するローリング手段への出力要求時間が大きいほどONディレー時間を短くし、かつ、該出力要求時間が小さいほどONディレー時間を長くするとともに、前回の対地左右傾斜における対地左右傾斜の現在値と目標値の偏差が大きいほどONディレー時間をやや長くし、かつ、該偏差が小さいほどONディレー時間をやや短くすることにより、短い周期の対地左右傾斜に対してはローリング制御の応答速度を遅くし、大きな周期に対しては素早い対応でローリング制御を行わせることができる。
【0009】
【実施例】
以下、本発明の実施例として、ロータリ耕耘機を装着したトラクタのローリング制御装置について説明する。
【0010】
図1はその使用状態を表す図であり、トラクタ1の作業機連結装置2に作業機であるロータリ耕耘機(以下、作業機とする)3が装着されている。図示例の作業機連結装置2は3Pヒッチであり、図中の5は左右一対のロワリンク、6は左右中央に1本のトップリンクで、これらリンク5,5,6の後端部にロータリ耕耘機3が取り付けられる。また、7はピッチングシリンダ8で駆動するリフトアームで、該リフトアームの後端部にリフトロッド9,9を介してロワリンク5,5が吊られており、リフトアーム7,7を上下に回動させることにより、作業機3が昇降するようになっている。また、左右一方(図示例では右側)のリフトロッド9にはローリングシリンダ10(ローリング手段)が介装されており、該シリンダを伸縮させてリフトロッド9の長さを変えることにより、トラクタ1に対する作業機3の左右傾斜を調整するようになっている。ピッチングシリンダ8は上昇用および下降用のピッチングバルブ12,13で制御され、ローリングシリンダ10はローリングバルブ14で制御される。
【0011】
ローリング制御装置15は図2に示す構成となっている。すなわち、トラクタの左右傾斜を検出するスロープセンサ16(現在値検出手段)の検出値と、トラクタに対する作業機の左右傾斜を検出するストロークセンサ17(現在値検出手段)の検出値と、目標とする作業機の対地左右傾斜を設定する傾き調整ダイヤル18(目標値設定手段)の設定値とが入力インターフェイス20を介してCPU21に入力され、CPU21(ONディレー時間決定手段)でこれらのデータに基づいて後述する処理を行い、出力インターフェイス22を介してローリング制御バルブ14の伸用および縮用ソレノイド14a,14bにバルブ開閉信号を出力する。
【0012】
CPU21におけるデータ処理は以下の順序で行われる。
【0013】
まず、スロープセンサ16の検出値とストロークセンサ17の検出値より作業機の対地左右傾斜の現在値xn を求める。ところで、作業機が傾斜する瞬間には、センサに加速度が加わり、実際の作業機の傾斜度よりも大きくセンサに検出されることがある。そこで、下記の計算式により補正現在値yn を算出する。
yn =(xn +yn−1 +…+yn−5 )/6
この補正現在値yn は、センサ値より計算される現在値xn と過去数回(例えば5回)の補正値yn−1 ,…,yn−5 の平均をとった数値である。
【0014】
なお、傾斜開始時以外には、補正現在値yn の値は実際の作業機の傾斜よりも若干遅れぎみとなるので、作業機が水平に戻ったならば補正現在値yn をリセットし、次回の傾斜に対する制御に影響しないようにしている。
【0015】
次いで、上記補正現在値yn と傾き調整ダイヤル18で設定される対地左右傾斜の目標値Yn とを比較し、両者の偏差を算出する。偏差が不感帯H内にある場合はローリング制御バルブ14の出力を停止し、偏差が不感帯Hを超えている場合はローリング制御バルブ14に伸用もしくは縮用の出力要求をする。この出力要求に基づいてローリング制御バルブ14のソレノイド14aもしくは14bにバルブ開閉信号が出力されるのであるが、ハンチングの原因となるような無駄を制御動作を抑制するために、偏差の方向が切り替った直後は、次回の反対方向への出力を保留する場合がある。この反対方向ONディレー時間tm は次のようにして決定する(図3参照)。
【0016】
出力要求が同一方向に出され続けている間、その出力要求発生時間tをカウントするとともに、センサ値より計算される作業機の対地左右傾斜値xを絶対値が大きい数値に随時更新し、その最大値xp を記憶しておく。そして、出力要求時間tn 、および前記最大値xp と目標値Yn との偏差である偏差ピーク値を入力変数とし、かつ、反対出力ONディレー時間tm を出力変数としてファジィ推論を行う。偏差ピーク値として、補正現在値yn と目標値Yn との偏差を用いるのではなく、実際の現在値xn と目標値Yn との偏差を用いることにより、傾斜の大きさをより正確に把握することができる。
【0017】
ファジィ推論を行うに際しては、図4のルールマップに示すファジィルールを適用し、各変数のメンバーシップ関数は図5に示すように分類する。ルールマップは、横に出力要求発生時間のメンバーシップ関数、縦に偏差ピーク値のメンバーシップ関数をそれぞれにとり、両者の交差点を反対出力ONディレー時間のメンバーシップ関数としている。ここで、PBは非常に大きい、PMは大きい、PSはやや大きい、ZOはゼロもしくはゼロに限りなく近いを意味する。
【0018】
例えば、1行1列については、「もし出力要求が発生しておらず(ZO)、かつ偏差が無いならば(ZO)ならば、反対出力ONディレー時間を長く設定せよ(PM)。」ということである。
【0019】
全体的には、出力要求発生時間が長い時は反対出力ONディレー時間を小さく、かつ、出力要求発生時間が短い時は反対出力ONディレー時間を長くするとともに、偏差ピーク値が大きいほど反対出力ONディレー時間をやや長く、かつ、偏差ピーク値が小さいほど反対出力ONディレー時間をやや短くすると言える。
【0020】
仮に、出力要求発生時間が330mmsec 、偏差ピーク値が10BIT であると想定して、その時の反対出力ONディレー時間を求めることにする(図6参照)。この時の出力要求発生時間のメンバーシップ値は、ZOより与えられる「7」とPSより与えられる「2」である。一方、偏差ピーク値のメンバーシップ値は、PSより与えられる「4」とPMより与えられる「10」である。ファジィルールに従って、出力変数PMの「4」、出力変数PBの「7」を抽出し、メンバーシップ領域U1 ,U2 を求める。そして、これら領域の重心Gの横軸方向の値を反対出力ONディレー時間として決定する。
【0021】
次に、図7に示す制御の具体例について説明する。
【0022】
前半部は圃場表土面が平坦であると考えられ、車輪のラグによる振動か、あるいは表土面の微小な凹凸変化に起因する作業機のわずかな対地左右傾斜しか生じていないので、出力要求発生時間tが短い。よって、反対出力ONディレー時間tm が長く設定されており、ローリング出力が全く出されないか、あるいは短時間出されるだけにとどまっている。ローリング制御動作が追随できないような小刻みな周期での出力を抑制することにより、ハンチングの発生が防止されている。
【0023】
一方、後半部は圃場表土面が荒れているらしく、出力要求発生時間tが長い。1回目の大きな偏差ピークを迎える傾斜については、前回制御の影響を受けるため、ONディレー時間が比較的長めに設定されているが、2回目以後は反対出力ONディレー時間が短くなるため、作業機が傾斜を始めると直ちにローリング出力が出されている。このため、作業機の傾斜に制御が迅速に対応することができる。
【0024】
【発明の効果】
以上に説明した如く、本発明にかかるローリング制御装置は、出力要求が発生している時間とその時の傾斜の大きさから次回くるであろう傾斜の大きさを類推することにより、ファジィ推論によって反対出力ONディレー時間を決定し、その反対出力ONディレー時間に基づいて次回の対地左右傾斜におけるローリング制御出力の開始を遅らせることにより、車輪のラグによる振動や表土面の短い周期に起因する作業機の対地左右傾斜に対してはローリング制御の応答速度を遅くし、大きな周期に対しては素早い対応でローリング制御を行わせることが可能となり、ローリング制御の精度が向上するとともに、制御の安定化するようになった。
【図面の簡単な説明】
【図1】トラクタの使用状態を示す側面図である。
【図2】ローリング制御装置のブロック図である。
【図3】ローリング制御のフローチャートである。
【図4】ファジィ推論のルールマップである。
【図5】(a)出力要求発生時間のメンバーシップ関数、(b)偏差ピーク値のメンバーシップ関数、(c)反対出力ONディレー時間のメンバーシップ関数を示す図である。
【図6】ファジィ推論の手順を説明する図である。
【図7】ローリング制御の具体例を示すタイムチャートである。
【符号の説明】
1 トラクタ
3 作業機
9 油圧シリンダ(ローリング手段)
15 ローリング制御装置
16 スロープセンサ(検出手段)
17 ストロークセンサ(検出手段)
18 傾き調整ダイヤル(設定手段)
21 CPU(ONディレー時間手段)
Claims (1)
- トラクタにローリング自在に装着された作業機の対地左右傾斜をほぼ一定に維持するように制御するローリング制御装置であって、作業機の対地左右傾斜の現在値を検出する現在値検出手段と、作業機の対地左右傾斜の目標値を設定する目標値設定手段と、前記現在値が前記目標値に近づくように作業機をローリングさせるローリング手段と、対地左右傾斜が一方向から反対方向へ移行する際に、前回の対地左右傾斜における最大値と目標値との偏差である偏差ピーク値、および前回の対地左右傾斜に対する前記ローリング手段への出力要求発生時間を入力変数とし、かつ、次回の対地左右傾斜における前記ローリング手段への出力開始を遅らせるONディレー時間を出力変数としてファジィ推論を行うONディレー時間決定手段とを具備することを特徴とするローリング制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10192094A JP3577737B2 (ja) | 1994-04-14 | 1994-04-14 | ローリング制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10192094A JP3577737B2 (ja) | 1994-04-14 | 1994-04-14 | ローリング制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH07274614A JPH07274614A (ja) | 1995-10-24 |
JP3577737B2 true JP3577737B2 (ja) | 2004-10-13 |
Family
ID=14313353
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP10192094A Expired - Fee Related JP3577737B2 (ja) | 1994-04-14 | 1994-04-14 | ローリング制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3577737B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108021022B (zh) * | 2018-01-31 | 2024-02-20 | 吉林省农业机械研究院 | 一种拖拉机后置式三点悬挂装置及其控制方法 |
-
1994
- 1994-04-14 JP JP10192094A patent/JP3577737B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH07274614A (ja) | 1995-10-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3577737B2 (ja) | ローリング制御装置 | |
JPH03198701A (ja) | 対地作業機のローリング制御装置 | |
JP5943852B2 (ja) | 作業車 | |
JP3838319B2 (ja) | 水平制御装置 | |
JP3797881B2 (ja) | 作業機のローリング制御装置 | |
JPH0531505U (ja) | トラクタの姿勢制御装置 | |
JP3079722B2 (ja) | 作業機ローリング制御装置 | |
JP3310534B2 (ja) | 農用トラクタ | |
JP3916555B2 (ja) | 農作業機のローリング制御装置 | |
JP3310533B2 (ja) | 農用トラクタ | |
JP3880538B2 (ja) | 農作業機の制御装置 | |
JP3690187B2 (ja) | 水平制御装置 | |
JP3310594B2 (ja) | 農用トラクタ | |
JP2610720B2 (ja) | 作業機のローリング制御装置 | |
JP3646323B2 (ja) | トラクターの旋回制御装置 | |
JP4594922B2 (ja) | 農作業機のローリング制御装置 | |
JPH0711526Y2 (ja) | 農用トラクタのドラフト制御装置 | |
JP3310595B2 (ja) | 農用トラクタ | |
JP3113402B2 (ja) | 作業車の作業装置ローリング制御構造 | |
JP3310598B2 (ja) | 農用トラクタ | |
JP2559714B2 (ja) | トラクタ | |
JP2775073B2 (ja) | 作業用走行機体における作業部の傾斜制御装置 | |
JP4596466B2 (ja) | 農作業機の耕耘制御装置 | |
JPH0626089Y2 (ja) | 対地作業車における作業深さ制御装置 | |
JP4837976B2 (ja) | 農用作業車の姿勢制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20040127 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20040329 |
|
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: 20040622 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20040705 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20070723 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100723 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100723 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120723 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130723 Year of fee payment: 9 |
|
LAPS | Cancellation because of no payment of annual fees |