JP3838319B2 - Horizontal control device - Google Patents

Horizontal control device Download PDF

Info

Publication number
JP3838319B2
JP3838319B2 JP16932099A JP16932099A JP3838319B2 JP 3838319 B2 JP3838319 B2 JP 3838319B2 JP 16932099 A JP16932099 A JP 16932099A JP 16932099 A JP16932099 A JP 16932099A JP 3838319 B2 JP3838319 B2 JP 3838319B2
Authority
JP
Japan
Prior art keywords
rolling
angular velocity
machine
sensor
horizontal control
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
JP16932099A
Other languages
Japanese (ja)
Other versions
JP2000354402A (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.)
Iseki and Co Ltd
Original Assignee
Iseki and 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 Iseki and Co Ltd filed Critical Iseki and Co Ltd
Priority to JP16932099A priority Critical patent/JP3838319B2/en
Publication of JP2000354402A publication Critical patent/JP2000354402A/en
Application granted granted Critical
Publication of JP3838319B2 publication Critical patent/JP3838319B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Lifting Devices For Agricultural Implements (AREA)

Description

【0001】
【発明の属する技術分野】
本発明は水平制御装置に関するものであり、特に、農業用トラクタや乗用管理機等の水平制御装置に関するものである。
【0002】
【従来の技術及び発明が解決しようとする課題】
農業用トラクタや乗用管理機等の農用作業車両では、機体の後部にリンク機構を介してロータリ等の作業機を連結し、該機体と作業機の間に機体に対する作業機のローリング角を変更するアクチュエータを設けるとともに、該機体に作業機のローリング角を設定する傾き調整ダイヤル等を設け、作業機のローリング角を自動的に調整する水平制御装置を備えたものが知られている。
【0003】
この水平制御装置には、機体と作業機の間に作業機のローリング角を検出するセンサを設けるとともに、該機体に機体のローリング角を検出する傾斜センサを設け、各センサの検出値に基づいて機体のローリング角と作業機のローリング角を演算し、機体の姿勢に拘らず作業機のローリング角を水平に維持すべく前記アクチュエータへ駆動信号を出力したり、或いは、機体のローリング角と作業機のローリング角を平行に維持すべく前記アクチュエータを駆動するように制御している。
【0004】
一般に傾斜センサは、筐体内に常時鉛直方向に向かう振り子を吊り下げておき、該振り子に対して機体に取り付けた筐体の左右傾斜の角度変化を検出するように構成されており、該振り子自体の慣性力のため、例えば機体が右下がり方向に傾斜し始めるときは、該振り子は相対的に左側に取り残される。従って、傾斜センサは機体の傾斜開始直後は逆方向の検出信号を出力し、また、検出信号の出力に時間遅れが生じることで、機体の傾斜を迅速に検出するという応答性が良好ではない。
【0005】
これに対して、機体に機体のローリング角速度を検出するローリング角速度センサを設け、該ローリング角速度センサの検出値から機体のローリング角を演算する方法も考えられる。しかし、機体の走行速度や圃場の硬さ、或いはタイヤのラグパターン等の走行条件や圃場条件により種々のノイズが発生し、ローリング角速度センサの検出信号には連続的に小刻みの変化が表れる。特に、傾斜地で走行している場合は、タイヤのラグパターンの影響により機体の固有振動が大きくなり、ローリング角速度センサの検出信号に基づいて水平制御信号を出力すれば制御誤差が大きくなることがある。これを防止するには、ローリング角速度センサの出力変化に同期して全く応答遅れのない可変スピードの出せるアクチュエータが必要となり、構成が複雑になるとともに極めて高価となる。
【0006】
そこで、機体と作業機の間に設けられたアクチュエータを駆動し、作業機のローリング角を調整して水平制御を行う際に、機体のローリングによる作業機の行き過ぎや応答遅れを防止するとともに、タイヤのラグパターン等の走行条件や圃場条件により発生するローリング角速度センサのノイズに対応して正確な水平制御を行うために解決すべき技術的課題が生じてくるのであり、本発明はこの課題を解決することを目的とする。
【0007】
【課題を解決するための手段】
本発明は上記目的を達成するために提案されたものであり、機体の後部にリンク機構を介して作業機を連結し、該機体と作業機の間に機体に対する作業機のローリング角を変更するアクチュエータと該機体に対する作業機のローリング角を検出する手段とを設け、該機体に機体のローリング角を検出する傾斜センサと、作業機のローリング角を設定する傾き設定手段とを備えた水平制御装置に於いて、該機体に機体がローリングするときのローリング角速度検出手段を設け、ローリング角速度検出手段の検出値と前記傾斜センサの検出値とに基づき、前記傾き設定手段の設定値に応じて作業機のローリング角を調整するとともに、前記傾斜センサが一定値以上のローリング角を検出しているときは、ローリング角速度検出手段の不感帯を広げ、ローリング角速度検出手段の検出値が該不感帯内にあるときは、ローリング角速度検出手段の検出値に基づく水平制御信号を出力しないように構成したことを特徴とする水平制御装置を提供するものである。
【0008】
【発明の実施の形態】
以下、本発明の一実施の形態を図面に従って詳述する。図1及び図2は作業車両の一例として小型のトラクタ10を示し、機体の後部にリンク機構11を介してロータリ作業機12が連結されている。運転席13の近傍には作業機の昇降位置設定手段であるポジションレバー15、作業機の耕深量設定手段である耕深調整ダイヤル16、作業機のローリング角を設定する傾き設定手段である傾き調整ダイヤル17等が設けられている。また、ミッションケース18の上面部には後車軸19の近傍上方位置の略中央部に、機体のローリング角を検出する手段である傾斜センサ41と、機体がピッチングするときの角速度を検出する手段であるピッチング角速度センサ42と、機体がローリングするときの角速度を検出する手段であるローリング角速度センサ43がケース44内に一体的に収納されている。
【0009】
前記リンク機構11はトップリンク20と左右のロワリンク21,21とからなり、左右のリフトアーム22,22の先端とロワリンク21,21をリフトロッド23,23にて連結し、リフトシリンダ24の駆動にてリフトアーム22を回動することにより、リフトロッド23,23を介してロワリンク21,21が上下動する。斯くして、ロワリンク21,21の先端部を回動中心に前記ロータリ作業機12が昇降する。
【0010】
リフトアーム22の回動基部には、作業機の昇降位置を検出する手段としてリフトアーム角センサ25が設けられ、このリフトアーム角センサ25にてリフトアーム22の回動角を検出し、コントローラ50にてロータリ作業機12の昇降高さを演算する。また、ロータリ作業機12のメインカバー26の後端部にリヤカバー27を上下回動自在に取り付け、リヤカバーセンサ28により前記リヤカバー27の回動角を検出して、コントローラ50にてロータリ作業機12の耕深量を演算する。
【0011】
一方、機体に対するロータリ作業機12のローリング角を変更するためのアクチュエータとして、左右どちらかのリフトロッド23の途中にローリングシリンダ30を設け、該ローリングシリンダ30を伸縮させてロワリンク21のリフト量を左右で変えることにより、機体に対するロータリ作業機12の左右方向への傾きを変更できるように形成してある。
【0012】
そして、機体に対するロータリ作業機12のローリング角を検出する手段として、前記ローリングシリンダ30に隣接してストロークセンサ31を設け、該ストロークセンサ31によリローリングシリンダ30の伸縮長さを検出し、機体に対するロータリ作業機12のローリング角をコントローラ50にて演算するとともに、前記傾き調整ダイヤル17の設定値に応じてローリングシリンダ30を駆動し、ロータリ作業機12の水平制御を行えるようにしてある。
【0013】
ここで運転席13の前方には機体の操舵操作部であるステアリングハンドル32が設けられ、該ステアリングハンドル32の近傍位置に前後進切換えレバー33を設けてあり、該前後進切換えレバー33を操作することにより、後輪34へ伝達する駆動力を逆転させて、機体の進行方向を選択できるようにしてある。また、運転席13の前下方部に変速レバー35を設置するとともに、左右独立して踏み込み可能な左右ブレーキペダル36,36が設けられている。前記、ステアリングハンドル32の回転操作は操舵装置37へ伝達され、操舵量に応じて前輪38が回向する。前輪38の操舵量は前輪切れ角センサ39によって検出される。
【0014】
図3は制御系のブロック図であり、耕深調整ダイヤル16によってロータリ作業機12の耕深目標値を設定し、リフトアーム角センサ25の検出信号にてロータリ作業機12の昇降位置を演算するとともに、リヤカバーセンサ28にてリヤカバー27の回動角を検出してロータリ作業機の耕深量を演算する。そして、リヤカバー27の回動角を前記耕深調整ダイヤル16にて設定された耕深目標値に応じた所定角に維持すべく、リフトシリンダ24を駆動する電磁制御弁の上昇ソレノイドまたは下降ソレノイドへコントローラ50から制御信号を出力する。従って、リフトアーム22が上下回動してロータリ作業機12が昇降し、リヤカバー27が回動してリヤカバーセンサ28の検出値が耕深目標値と一致するように制御される。
【0015】
一方、傾き調整ダイヤル17によってオペレータがロータリ作業機12のローリング角を任意に設定できる。地面に対する機体のローリング角は傾斜センサ41にて検出し、機体に対するロータリ作業機12のローリング角はストロークセンサ31にて検出する。従って、双方のセンサの検出値からロータリ作業機12の地面に対するローリング角を演算することができ、前記傾き調整ダイヤル17にて設定された作業機のローリング角を維持すべく、ローリングシリンダ30を駆動する電磁制御弁の右上げソレノイドまたは右下げソレノイドへコントローラ50から制御信号を出力する。従って、ローリングシリンダ30が伸縮してロータリ作業機12のローリング角が変更され、ストロークセンサ31の検出値が水平制御の目標値と一致するように制御される。
【0016】
尚、ピッチング角速度センサ42及びローリング角速度センサ43は夫々振動ジャイロ方式のものを使用しており、構造が簡単で精密且つ安価である。しかし、振動ジャイロ方式以外のセンサであってもよい。之等傾斜センサ41とピッチング角速度センサ42とローリング角速度センサ43は、後車軸19の近傍上方位置の略中央部に設けられており、前輪38側に設置する場合と比較して機体の重心に近くなり、上下方向の振動が少なく外乱を受けにくくなって測定精度が向上する。また、前記3つのセンサがすべてケース44内に一体的に収納されているので、設置スペースがコンパクトになり、電源回路を共用できる等、設置作業も簡単となる。
【0017】
更に、水平切換スイッチ45により、水平モードと機体平行モードと角度設定モードとを選択可能にしてあり、機体と作業機の相対的な傾き及び地面に対する傾きを検出しながら、該水平切換スイッチ45でセットしたモードに応じて水平制御の目標値を定め、前記ローリングシリンダ30を駆動してロータリ作業機12の傾きを調整する。
【0018】
例えば、水平切換スイッチ45が水平モードにセットされているときは、傾斜センサ41の検出値とストロークセンサ31の検出値からロータリ作業機12の地面に対する傾きを算出し、この傾きをゼロにするように水平制御の目標値を定める。そして、ストロークセンサ31の計測値がこの目標値に一致するように、ローリングシリンダ30を駆動する電磁制御弁の右上げソレノイドまたは右下げソレノイドへコントローラ50から制御信号を出力する。従って、機体の姿勢に拘らずロータリ作業機12の左右方向の傾きが水平となるように制御される。
【0019】
一方、水平切換スイッチ45が機体平行モードにセットされているときは、左右のロワリンク21のリフト量を等しくするように水平制御の目標値を定める。そして、ストロークセンサ31の計測値がこの目標値に一致するようにローリングシリンダ30を駆動すべく、コントローラ50から前記右上げソレノイドまたは右下げソレノイドへ制御信号を出力する。従って、ロータリ作業機12の左右方向の傾きが機体の傾きと平行になるように制御される。
【0020】
また、水平切換スイッチ45が角度設定モードにセットされているときは、オペレータが任意に設定した傾き調整ダイヤル17の設定値に応じて水平制御の目標値を定め、ストロークセンサ31の計測値がこの目標値に一致するようにローリングシリンダ30を駆動すべく、コントローラ50から前記右上げソレノイドまたは右下げソレノイドへ制御信号を出力する。従って、ロータリ作業機12が設定した任意の傾きとなるように制御される。
【0021】
ここで、機体の走行速度や圃場の硬さ或いはタイヤのラグパターン等、走行条件や圃場条件によって、前記ローリング角速度センサ43の検出信号には種々の振動に起因するノイズが発生する。例えば、図4に示すように、ローリング角速度センサ43の出力信号が0Vから最大5Vまで変化し、機体が左方向へローリングしたときの角速度の変化がグラフの上方向に表れ、機体が右方向へローリングしたときの角速度の変化が下方向に表れるものとしたとき、機体の振動ノイズによって、ローリング角速度センサ43の検出信号には連続的に小刻みの変化が表れる。
【0022】
従って、ローリング角速度に基づいて水平制御を行う場合は、右方向角速度のピーク値(上端ピーク値)と左方向角速度のピーク値(下端ピーク値)を所定時間継続して測定し、各ピーク値の移動平均値を算出し、右方向角速度ピーク値の移動平均値と左方向角速度ピーク値の移動平均値とからローリング角速度センサ43の中立位置Cを設定する。そして、図4の点線にて示すように、上記中立位置Cに対して予め所定範囲(例えば中立位置を中心として±1V〜1.5V)の不感帯U1を定めておき、ローリング角速度センサ43の検出値が該不感帯U1内にあるときは、機体の固有振動による角速度検出と見做して、前記傾斜センサ41の検出値にて機体のローリング角を算出し、該傾斜センサ41の検出値に基づいてローリングシリンダ30用の電磁制御弁へ「右上げ」または「右下げ」の水平制御信号を出力する。そして、該不感帯U1より大きなローリング角速度を検出したときは、前記ローリング角速度センサ43の検出値に基づいてローリングシリンダ30用の電磁制御弁へ水平制御信号を出力する。
【0023】
図5は水平制御のフローチャートを示し、水平制御が開始されると、先ず各種センサやスイッチ及びダイヤル等の状態をコントローラ50に読み込み(Step100)、続いてローリング角速度センサ43のピーク値を収集する(Step110)。いま、図4に示したような振動ノイズが発生している場合、右方向角速度のピーク値(上端ピーク値)と左方向角速度のピーク値(下端ピーク値)を所定時間継続して測定し、各ピーク値の移動平均値を算出する。そして、右方向角速度ピーク値の移動平均値と左方向角速度ピーク値の移動平均値との間の領域をローリング角速度センサ43の不感帯に設定する(Step120)。
【0024】
上記不感帯を設定した後、ローリング角速度センサ43の検出値がこの不感帯内にあるときは(Step130)、振動に起因するノイズとみなして、前記傾斜センサ41の検出値にて機体のローリング角を算出し、該傾斜センサ41の検出値に基づいてローリングシリンダ30用の電磁制御弁へ「右上げ」または「右下げ」の水平制御信号を出力する(Step140)。これに対して、ローリング角速度センサ43の検出値が前記不感帯から外れて、右方向または左方向に大きな角速度が検出されたときは、該ローリング角速度センサ43の検出値に基づいてローリングシリンダ30用の電磁制御弁へ水平制御信号を出力する(Step150)。
【0025】
ここで、前記傾斜センサ41が所定値以上の傾斜を検出しているときは、Step120に於いて、ローリング角速度センサ43の不感帯の幅を広げる。これは、図6に示すように、タイヤのラグパターンはトレッドの中心から外側に向けて、ラグ60a,60bが交互に傾斜して設けられており、機体が水平状態のときはタイヤの接地面がA部分となり、双方のラグ60a,60bが連続的に地面に接地するので、機体に発生するローリング角速度は少ないが、機体の傾斜が大きくなったときはタイヤの接地面がB部分またはC部分となり、片方のラグ、60aまたは60bが断続的に接地して、機体には断続的にローリング角速度が発生するからである。
【0026】
斯くして、前記傾斜センサ41が所定値以上の傾斜を検出して機体の傾斜が大きいと判断したときは、図4の二点鎖線にて示すように、ローリング角速度センサ43の不感帯U1を広げて新たな不感帯U2とすることにより、安定した水平制御を行うことができる。尚、新たな不感帯U2は機体の傾斜角度に応じて段階的に広げるように設定するか、或いは、機体の傾斜角度に比例して無段階に漸増するように設定してもよい。
【0027】
また、ローリング角速度センサ43の検出値に基づく水平制御出力を停止して、傾斜センサ41に基づく水平制御に移行する場合は、該傾斜センサ41の検出値が一定時間に所定範囲に収まっているときのみ、傾斜センサ41に基づく水平制御出力を開始する。これは、ローリング角速度がなくなった後に機体の傾斜変化が緩やかになってから、傾斜センサ41に基づく水平制御を行うためである。
【0028】
尚、ローリング角速度センサ43にて検出された機体のローリング角速度をω、検出時間をTとすれば、機体のローリング角θは次式で表される。
【0029】
θ=ω×T
上式によって求められた機体のローリング角θとストロークセンサ31の検出値から、ロータリ作業機12のローリング角を演算し、傾き調整ダイヤル17の設定値に応じて前記ローリングシリンダ用の電磁制御弁へ水平制御信号を出力する。斯くして、走行条件や圃場条件等で必然的に発生するノイズに対しては、不感帯として前記ローリング角速度センサ43に基づく水平制御信号を出力しないため、特別に高性能のセンサやアクチュエータを使用せずして不要な出力をなくすことができ、安価な費用にて応答性のよい水平制御を行うことができる。
【0030】
ここで、大きいローリング角速度を検出したときは、これに基づいて水平制御信号を出力しても、ローリングシリンダ30の動作速度の関係から目標の水平姿勢まで修正できないことがある。これを防止するために、水平制御出力の停止にディレーをかける。
【0031】
例えば、図7に示すように、ローリング角速度センサ43の不感帯Uを超えて中立位置Cを中心とする一定値±αVの位置にしきい値を設定しておき、ローリング角速度センサ43の検出値が不感帯Uを超えて機体が右方向へローリングし、「右下げ」の水平制御信号の出力要求があった場合(時点t1)、更に機体が大きく右方向へローリングして、このローリング角速度が前記しきい値(+αV)を超えたときは(時点t2)、一定値+αVを超えている間の時間T1を計測し(時点t2〜t3)、このローリング角速度が前記しきい値(+αV)以下になったときから更に時間T1の間(時点t3〜t4)は、該ローリング角速度が減少して不感帯Uに入ったとしても、「右下げ」の水平制御信号を停止せずローリングシリンダ30の伸長駆動を継続する。
【0032】
同様に、ローリング角速度センサ43の検出値が不感帯Uを超えて「右上げ」の水平制御信号の出力要求があった場合(時点t5)、このローリング角速度がしきい値(−αV)を超えたときは(時点t6)、一定値−αVを超えている間の時間T2を計測し(時点t6〜t7)、このローリング角速度が前記しきい値(−αV)以下になったときから更に時間T2の間(時点t7〜t8)は、該ローリング角速度が減少して不感帯Uに入ったとしても、「右上げ」の水平制御信号を停止せずローリングシリンダ30の収縮駆動を継続する。
【0033】
尚、前記ローリングシリンダ30が片ロッド型の場合は、伸び側と縮み側でピストンの受圧面積が異なるため、動作速度に差が生じて伸び速度より縮み速度が速くなる。本実施の形態で説明する小型のトラクタに使用されるローリングシリンダ30は、縮み速度に対して伸び速度は約2/3程度である。
【0034】
従って、図7の最下段(修正右上げ出力)に示すように、「右上げ」の水平制御信号を出力してローリングシリンダ30を収縮する場合は、出力停止ディレー時間を前述したT2の2/3として、ローリング角速度が前記しきい値(−αV)以下になったときから時間T2×(2/3)の間(時点t7〜t9)は、該ローリング角速度が減少して不感帯Uに入ったとしても、「右上げ」の水平制御信号を停止せずローリングシリンダ30の収縮駆動を継続する。斯くして、ローリングシリンダ30の伸び側と縮み側とでシリンダの動作量を同一にすることができる。
【0035】
一方、図8に示すように、一定値+αVを超えている間の時間T3を計測し(時点t11〜t12)、このローリング角速度が前記しきい値(+αV)以下になって時間T3の間(時点t12〜t13)に出力停止ディレーを行っている場合に、ローリング角速度が逆方向のしきい値(−αV)を超えたとき(時点t14)には、出力停止ディレーの時間を減算して作業機の行き過ぎを防止する必要がある。出力停止ディレーの減算量は、前記時点t13とt14の差T4の1/2とする。これにより、「右下げ」水平制御信号の出力停止ディレーは、時点t12からt15までの時間T5に減算される。
【0036】
尚、ロータリ作業機12の取付幅の大小により、ローリングシリンダ30の伸縮量に対する傾斜の度合いが異なるため、トラクタ10には取付幅切換装置(図示せず)が設けられている。従って、該取付幅切換装置が切り換えられたときは、前述した水平制御信号の出力停止ディレー時間も変更することは当然である。
【0037】
ここで、ローリング角速度センサ43の検出値に基づく水平制御中に、機体が旋回した場合は、コントローラ50からリフトシリンダ用電磁制御弁の上昇ソレノイドに指令信号を出力してロータリ作業機12を所定高さに上昇させる。或いは、機体が直進走行中であっても、作業領域外へ出たときや機体を後退するとき等には、ロータリ作業機12を手動操作にて所定高さに上昇させる。然るとき、前記ローリング角速度センサ43が機体の振動による角速度を検出して水平制御信号を出力すれば、作業機にガタツキが発生して操作感が悪くなるので、作業機を上昇したときはローリング角速度に基づく水平制御信号の出力を禁止し、旋回動作や後退動作が終了してロータリ作業機12を下降したときに、再びローリング角速度に基づく水平制御信号を出力する。
【0038】
例えば、図9に示すように、ローリング角速度センサ43の検出値に基づく水平制御中に、リフトアーム角センサ25の検出値が一定値以上になったときは(Step200)、ロータリ作業機12が上昇操作中若しくは上昇位置で停止している状態であるので、ローリング角速度に基づく水平制御信号の出力を禁止する(Step210)。従って、作業機上昇中に不用な水平制御出力を行わなくなり、作業機のガタツキを解消できる。
【0039】
そして、旋回動作や後退動作が終了してロータリ作業機12を下降したときは、直ちにローリング角速度に基づく水平制御信号を出力するのではなく、所定時間(下降操作から約2秒間)のウエイトをかける(Step230)。この間は、傾斜センサ41の検出値に基づく水平制御に切り換えて制御信号を出力するため(Step240)。作業機接地等でロータリ角速度が発生したとしても、ローリング角速度に基づく水平制御信号を出力しないので、誤制御を防止することができる。所定時間経過後はローリング角速度に基づく水平制御信号の出力を再開する(Step250)。
【0040】
尚、本発明は、本発明の精神を逸脱しない限り種々の改変を為すことができ、そして、本発明が該改変されたものに及ぶことは当然である。
【0041】
【発明の効果】
本発明は上記一実施の形態に詳述したように、機体の傾斜センサの検出値と機体のローリング角速度の検出値とに基づいて作業機の水平制御を行う際に、傾斜センサが一定値以上のローリング角を検出しているときは、ローリング角速度の不感帯を広げたことにより、機体の傾斜によってタイヤのラグパターンによる振動ノイズが多くなったとしても、不感帯としてローリング角速度に基づく水平制御信号を出力せず、従来と同様に傾斜センサの検出値に基づいて水平制御信号を出力するので、特別に高性能のセンサやアクチュエータを使用せずして不要な出力をなくすことができ、安価な費用にて応答性のよい水平制御を行うことができる。一方、不感帯より大きなローリング角速度を検出したときは、ローリング角速度に基づく水平制御を行うため、作業機の行き過ぎや応答遅れを防止して正確な水平制御を行うことができる。
【図面の簡単な説明】
図は本発明の一実施の形態を示すものである。
【図1】トラクタの機体とロータリ作業機の側面図。
【図2】リヤカバーセンサ等の図示を省略した図1の背面図。
【図3】制御系のブロック図。
【図4】ノイズがあるときのローリング角速度センサの検出信号を表したグラフ。
【図5】水平制御装置の制御手順を示すフローチャート。
【図6】タイヤのラグパターンを示す要部斜視図。
【図7】大きなローリング角速度を検出したときの出力停止ディレーを表したグラフ。
【図8】出力停止ディレーを減算したグラフ。
【図9】ローリング角速度での水平制御中に作業機下降操作があった場合の制御手順を示すフローチャート。
【符号の説明】
10 トラクタ
11 リンク機構
12 ロータリ作業機
17 傾き調整ダイヤル
30 ローリングシリンダ
31 ストロークセンサ
41 傾斜センサ
43 ローリング角速度センサ
50 コントローラ
[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a horizontal control device, and more particularly to a horizontal control device such as an agricultural tractor or a riding management machine.
[0002]
[Prior art and problems to be solved by the invention]
In agricultural work vehicles such as agricultural tractors and riding management machines, a work machine such as a rotary is connected to the rear part of the machine via a link mechanism, and the rolling angle of the work machine relative to the machine is changed between the machine and the machine. There is known an actuator provided with a horizontal control device for automatically adjusting the rolling angle of the work implement by providing an inclination adjusting dial or the like for setting the rolling angle of the work implement on the machine body.
[0003]
In this horizontal control device, a sensor for detecting the rolling angle of the work machine is provided between the machine body and the work machine, and a tilt sensor for detecting the rolling angle of the machine body is provided in the machine body, and based on the detection value of each sensor. Calculate the rolling angle of the machine and the rolling angle of the work machine, and output a drive signal to the actuator to keep the rolling angle of the work machine horizontal regardless of the attitude of the machine, or the rolling angle of the machine and the work machine The actuator is controlled so as to be driven in order to maintain the rolling angle in parallel.
[0004]
In general, a tilt sensor is configured to suspend a pendulum that always faces in a vertical direction in a casing and detect a change in the angle of the right and left tilt of the casing attached to the fuselage with respect to the pendulum. For example, when the airframe starts to tilt in the lower right direction, the pendulum is relatively left on the left side. Therefore, the tilt sensor outputs a detection signal in the reverse direction immediately after the start of the tilt of the aircraft, and the response of detecting the tilt of the aircraft quickly is not good due to the time delay in the output of the detection signal.
[0005]
On the other hand, a method of providing a rolling angular velocity sensor for detecting the rolling angular velocity of the aircraft and calculating the rolling angle of the aircraft from the detection value of the rolling angular velocity sensor is also conceivable. However, various noises occur depending on traveling conditions such as the traveling speed of the aircraft, the hardness of the field, or the tire lug pattern, and the field conditions, and the detection signal of the rolling angular velocity sensor continuously changes in small increments. In particular, when running on sloping ground, the natural vibration of the fuselage increases due to the effect of the tire lug pattern, and if the horizontal control signal is output based on the detection signal of the rolling angular velocity sensor, the control error may increase. . In order to prevent this, an actuator capable of providing a variable speed with no response delay at all in synchronism with the output change of the rolling angular velocity sensor is required, which makes the configuration complicated and extremely expensive.
[0006]
Therefore, when the actuator provided between the machine and the work machine is driven and the rolling angle of the work machine is adjusted to perform horizontal control, the work machine is prevented from overshooting and response delay due to the rolling of the machine, and the tire The technical problem to be solved in order to perform accurate horizontal control corresponding to the noise of the rolling angular velocity sensor generated by the traveling conditions such as the lag pattern and the field conditions arises, and the present invention solves this problem. The purpose is to do.
[0007]
[Means for Solving the Problems]
The present invention has been proposed to achieve the above object, and a work machine is connected to the rear part of the machine body via a link mechanism, and the rolling angle of the work machine relative to the machine body is changed between the machine body and the work machine. A horizontal control device comprising an actuator and a means for detecting a rolling angle of the work machine relative to the machine body, a tilt sensor for detecting the rolling angle of the work machine on the machine body, and a tilt setting means for setting the rolling angle of the work machine The rolling machine is provided with rolling angular velocity detection means when the machine rolls, and the work machine according to the set value of the inclination setting means based on the detection value of the rolling angular velocity detection means and the detection value of the inclination sensor. When the tilt sensor detects a rolling angle greater than a certain value, the dead zone of the rolling angular velocity detection means is widened. When the detected value of the rolling angular velocity detection means is within said non sensitive zone is to provide a horizontal control apparatus characterized by being configured so as not to output the horizontal control signal based on the detection value of the rolling angular velocity detection means.
[0008]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, an embodiment of the present invention will be described in detail with reference to the drawings. 1 and 2 show a small tractor 10 as an example of a work vehicle, and a rotary work machine 12 is connected to the rear part of the machine body via a link mechanism 11. In the vicinity of the driver's seat 13, a position lever 15 that is a lifting / lowering position setting means for the work implement, a tilling depth adjustment dial 16 that is a working depth setting means for the work implement, and an inclination that is an inclination setting means for setting the rolling angle of the work implement An adjustment dial 17 and the like are provided. In addition, an inclination sensor 41 that is a means for detecting the rolling angle of the airframe and a means for detecting an angular velocity when the airframe is pitched are provided at the upper surface portion of the mission case 18 at a substantially central portion near the rear axle 19. A pitching angular velocity sensor 42 and a rolling angular velocity sensor 43 that is a means for detecting an angular velocity when the airframe rolls are housed integrally in a case 44.
[0009]
The link mechanism 11 includes a top link 20 and left and right lower links 21, 21, and the ends of the left and right lift arms 22, 22 and the lower links 21, 21 are connected by lift rods 23, 23 to drive the lift cylinder 24. By rotating the lift arm 22, the lower links 21, 21 move up and down via the lift rods 23, 23. Thus, the rotary working machine 12 moves up and down with the tip ends of the lower links 21 and 21 as the center of rotation.
[0010]
A lift arm angle sensor 25 is provided at the rotation base of the lift arm 22 as means for detecting the lift position of the work implement. The lift arm angle sensor 25 detects the rotation angle of the lift arm 22, and the controller 50. To calculate the elevation height of the rotary working machine 12. Further, a rear cover 27 is attached to the rear end portion of the main cover 26 of the rotary work machine 12 so as to be rotatable up and down, and a rotation angle of the rear cover 27 is detected by a rear cover sensor 28, and the controller 50 detects the rotation of the rotary work machine 12. Calculate tillage depth.
[0011]
On the other hand, as an actuator for changing the rolling angle of the rotary working machine 12 with respect to the machine body, a rolling cylinder 30 is provided in the middle of either the left or right lift rod 23, and the rolling cylinder 30 is expanded or contracted to increase or decrease the lift amount of the lower link 21. By changing the angle, the inclination of the rotary working machine 12 with respect to the machine body in the left-right direction can be changed.
[0012]
As a means for detecting the rolling angle of the rotary working machine 12 with respect to the machine body, a stroke sensor 31 is provided adjacent to the rolling cylinder 30, and the expansion / contraction length of the rolling cylinder 30 is detected by the stroke sensor 31. The rolling angle of the rotary working machine 12 is calculated by the controller 50, and the rolling cylinder 30 is driven according to the set value of the tilt adjusting dial 17 so that the horizontal working of the rotary working machine 12 can be performed.
[0013]
Here, a steering handle 32 which is a steering operation portion of the fuselage is provided in front of the driver's seat 13, and a forward / reverse switching lever 33 is provided in the vicinity of the steering handle 32, and the forward / backward switching lever 33 is operated. Thus, the driving force transmitted to the rear wheel 34 is reversed so that the traveling direction of the aircraft can be selected. In addition, a shift lever 35 is provided at the front lower portion of the driver's seat 13 and left and right brake pedals 36 and 36 that can be stepped independently are provided. The rotation operation of the steering handle 32 is transmitted to the steering device 37, and the front wheel 38 turns according to the steering amount. The steering amount of the front wheel 38 is detected by a front wheel break angle sensor 39.
[0014]
FIG. 3 is a block diagram of the control system. The working depth target value of the rotary working machine 12 is set by the working depth adjustment dial 16, and the lift position of the rotary working machine 12 is calculated by the detection signal of the lift arm angle sensor 25. At the same time, the rear cover sensor 28 detects the rotation angle of the rear cover 27 and calculates the working depth of the rotary working machine. Then, in order to maintain the rotation angle of the rear cover 27 at a predetermined angle corresponding to the working depth target value set by the working depth adjustment dial 16, to the raising solenoid or the lowering solenoid of the electromagnetic control valve that drives the lift cylinder 24. A control signal is output from the controller 50. Therefore, the lift arm 22 is turned up and down to move the rotary work machine 12 up and down, and the rear cover 27 is turned and the detection value of the rear cover sensor 28 is controlled to coincide with the tilling target value.
[0015]
On the other hand, the tilt adjustment dial 17 allows the operator to arbitrarily set the rolling angle of the rotary working machine 12. The rolling angle of the machine relative to the ground is detected by the tilt sensor 41, and the rolling angle of the rotary working machine 12 relative to the machine is detected by the stroke sensor 31. Accordingly, the rolling angle of the rotary working machine 12 with respect to the ground can be calculated from the detection values of both sensors, and the rolling cylinder 30 is driven to maintain the rolling angle of the working machine set by the tilt adjustment dial 17. A control signal is output from the controller 50 to the right-up solenoid or right-down solenoid of the electromagnetic control valve. Accordingly, the rolling cylinder 30 is expanded and contracted to change the rolling angle of the rotary working machine 12, and the detection value of the stroke sensor 31 is controlled to coincide with the target value of the horizontal control.
[0016]
Note that the pitching angular velocity sensor 42 and the rolling angular velocity sensor 43 are each of the vibration gyro type, and the structure is simple, precise, and inexpensive. However, a sensor other than the vibration gyro system may be used. The tilt sensor 41, the pitching angular velocity sensor 42, and the rolling angular velocity sensor 43 are provided at a substantially central portion near the rear axle 19 and closer to the center of gravity of the airframe than when installed on the front wheel 38 side. As a result, there is little vibration in the vertical direction and it is difficult to receive disturbances, and the measurement accuracy is improved. In addition, since all the three sensors are integrally stored in the case 44, the installation space becomes compact and the installation work can be simplified, for example, the power supply circuit can be shared.
[0017]
Further, a horizontal mode, a machine parallel mode, and an angle setting mode can be selected by the horizontal switch 45, and the horizontal switch 45 detects the relative inclination of the machine and the work machine and the inclination with respect to the ground. A target value for horizontal control is determined according to the set mode, and the rolling cylinder 30 is driven to adjust the inclination of the rotary working machine 12.
[0018]
For example, when the horizontal selector switch 45 is set to the horizontal mode, the inclination of the rotary work machine 12 with respect to the ground is calculated from the detection value of the inclination sensor 41 and the detection value of the stroke sensor 31, and this inclination is made zero. Set the target value for horizontal control. Then, a control signal is output from the controller 50 to the right-up solenoid or the right-down solenoid of the electromagnetic control valve that drives the rolling cylinder 30 so that the measured value of the stroke sensor 31 matches the target value. Therefore, control is performed so that the horizontal inclination of the rotary working machine 12 is horizontal regardless of the attitude of the machine body.
[0019]
On the other hand, when the horizontal changeover switch 45 is set to the aircraft parallel mode, the target value of the horizontal control is determined so that the lift amounts of the left and right lower links 21 are equal. Then, in order to drive the rolling cylinder 30 so that the measured value of the stroke sensor 31 coincides with this target value, a control signal is output from the controller 50 to the right raising solenoid or the right lowering solenoid. Therefore, the rotary working machine 12 is controlled so that the horizontal tilt is parallel to the tilt of the machine.
[0020]
When the horizontal changeover switch 45 is set to the angle setting mode, a target value for horizontal control is determined according to the set value of the tilt adjustment dial 17 arbitrarily set by the operator, and the measured value of the stroke sensor 31 is set to this value. In order to drive the rolling cylinder 30 so as to match the target value, a control signal is output from the controller 50 to the right-up solenoid or right-down solenoid. Therefore, the rotary working machine 12 is controlled to have an arbitrary inclination set.
[0021]
Here, noise caused by various vibrations is generated in the detection signal of the rolling angular velocity sensor 43 depending on the traveling condition and the field condition such as the traveling speed of the machine body, the hardness of the field, or the lug pattern of the tire. For example, as shown in FIG. 4, when the output signal of the rolling angular velocity sensor 43 changes from 0V to a maximum of 5V, the change in angular velocity when the aircraft rolls to the left appears upward in the graph, and the aircraft moves to the right. Assuming that the change in the angular velocity when rolling appears downward, the detection signal of the rolling angular velocity sensor 43 continuously changes in small increments due to the vibration noise of the airframe.
[0022]
Therefore, when performing horizontal control based on the rolling angular velocity, the peak value (upper peak value) of the right direction angular velocity and the peak value (lower end peak value) of the left direction angular velocity are continuously measured for a predetermined time, and each peak value is The moving average value is calculated, and the neutral position C of the rolling angular velocity sensor 43 is set from the moving average value of the rightward angular velocity peak value and the moving average value of the leftward angular velocity peak value. Then, as shown by the dotted line in FIG. 4, a dead zone U 1 in a predetermined range (for example, ± 1 V to 1.5 V with the neutral position as the center) is determined in advance with respect to the neutral position C, and the rolling angular velocity sensor 43 When the detected value is within the dead zone U 1 , the rolling angle of the airframe is calculated from the detected value of the tilt sensor 41 in consideration of the angular velocity detection due to the natural vibration of the airframe, and the detected value of the tilt sensor 41 is detected. Is output to the electromagnetic control valve for the rolling cylinder 30 based on the “right-up” or “right-down” horizontal control signal. When a rolling angular velocity larger than the dead zone U 1 is detected, a horizontal control signal is output to the electromagnetic control valve for the rolling cylinder 30 based on the detected value of the rolling angular velocity sensor 43.
[0023]
FIG. 5 shows a flowchart of horizontal control. When horizontal control is started, first, the state of various sensors, switches, dials and the like is read into the controller 50 (Step 100), and then the peak value of the rolling angular velocity sensor 43 is collected (Step 100). Step 110). Now, when vibration noise as shown in FIG. 4 is generated, the peak value of the angular velocity in the right direction (upper peak value) and the peak value of the left angular velocity (lower peak value) are continuously measured for a predetermined time, The moving average value of each peak value is calculated. Then, a region between the moving average value of the right-direction angular velocity peak value and the moving average value of the left-direction angular velocity peak value is set as a dead zone of the rolling angular velocity sensor 43 (Step 120).
[0024]
After setting the dead zone, if the detected value of the rolling angular velocity sensor 43 is within the dead zone (Step 130), it is regarded as noise caused by vibration and the rolling angle of the aircraft is calculated from the detected value of the tilt sensor 41. Then, based on the detected value of the tilt sensor 41, a horizontal control signal of “right-up” or “right-down” is output to the electromagnetic control valve for the rolling cylinder 30 (Step 140). On the other hand, when the detected value of the rolling angular velocity sensor 43 deviates from the dead zone and a large angular velocity is detected in the right or left direction, the value for the rolling cylinder 30 is determined based on the detected value of the rolling angular velocity sensor 43. A horizontal control signal is output to the electromagnetic control valve (Step 150).
[0025]
Here, when the tilt sensor 41 detects a tilt of a predetermined value or more, the width of the dead zone of the rolling angular velocity sensor 43 is increased in Step 120. This is because, as shown in FIG. 6, the lug pattern of the tire is provided with the lugs 60a and 60b inclined alternately from the center of the tread to the outside, and when the fuselage is in a horizontal state, the ground contact surface of the tire Becomes part A, and both lugs 60a and 60b are continuously in contact with the ground, so that the rolling angular velocity generated in the aircraft is small, but when the inclination of the aircraft increases, the ground contact surface of the tire is the B or C portion. This is because one of the lugs 60a or 60b is intermittently grounded, and the rolling angular velocity is intermittently generated in the airframe.
[0026]
Thus, when the tilt sensor 41 detects a tilt greater than a predetermined value and determines that the tilt of the airframe is large, the dead zone U 1 of the rolling angular velocity sensor 43 is set as shown by the two-dot chain line in FIG. By expanding to a new dead zone U 2 , stable horizontal control can be performed. The new dead zone U 2 may be set so as to expand stepwise according to the inclination angle of the aircraft, or may be set so as to increase steplessly in proportion to the inclination angle of the aircraft.
[0027]
When the horizontal control output based on the detection value of the rolling angular velocity sensor 43 is stopped and the control is shifted to the horizontal control based on the tilt sensor 41, the detection value of the tilt sensor 41 is within a predetermined range within a predetermined time. Only the horizontal control output based on the tilt sensor 41 is started. This is because the horizontal control based on the tilt sensor 41 is performed after the change in the tilt of the airframe becomes gentle after the rolling angular velocity disappears.
[0028]
If the rolling angular velocity of the aircraft detected by the rolling angular velocity sensor 43 is ω and the detection time is T, the rolling angle θ of the aircraft is expressed by the following equation.
[0029]
θ = ω × T
The rolling angle of the rotary working machine 12 is calculated from the rolling angle θ of the machine body obtained by the above equation and the detected value of the stroke sensor 31, and the electromagnetic control valve for the rolling cylinder is operated according to the set value of the tilt adjustment dial 17. Outputs horizontal control signal. Thus, for noise inevitably generated due to traveling conditions, farm conditions, etc., a horizontal control signal based on the rolling angular velocity sensor 43 is not output as a dead zone. Therefore, unnecessary output can be eliminated, and responsive horizontal control can be performed at low cost.
[0030]
Here, when a large rolling angular velocity is detected, even if a horizontal control signal is output based on this, the target horizontal posture may not be corrected due to the relationship of the operating speed of the rolling cylinder 30. In order to prevent this, a delay is applied to the stop of the horizontal control output.
[0031]
For example, as shown in FIG. 7, a threshold value is set at a position of a constant value ± αV centered on the neutral position C beyond the dead zone U of the rolling angular velocity sensor 43, and the detected value of the rolling angular velocity sensor 43 is the dead zone. When the aircraft rolls to the right beyond U, and there is a request to output a “right-down” horizontal control signal (time point t 1 ), the aircraft rolls further to the right and this rolling angular velocity is When the threshold value (+ αV) is exceeded (time point t 2 ), the time T 1 while the constant value + αV is exceeded is measured (time point t 2 to t 3 ), and this rolling angular velocity is the threshold value (+ αV). ) During the time T 1 (time t 3 to t 4 ) from when it becomes below, even if the rolling angular velocity decreases and enters the dead zone U, the “right-down” horizontal control signal is not stopped. Elongation of rolling cylinder 30 To continue the dynamic.
[0032]
Similarly, when the detection value of the rolling angular velocity sensor 43 exceeds the dead zone U and there is a request to output a “right-up” horizontal control signal (time point t 5 ), the rolling angular velocity exceeds the threshold value (−αV). (Time t 6 ), the time T 2 during which the constant value −αV is exceeded is measured (time t 6 to t 7 ), and the rolling angular velocity becomes equal to or less than the threshold value (−αV). From time to time T 2 (time t 7 to t 8 ), even if the rolling angular velocity decreases and enters the dead zone U, the horizontal control signal “upward to the right” does not stop and the rolling cylinder 30 contracts. Continue driving.
[0033]
When the rolling cylinder 30 is a single rod type, the pressure receiving area of the piston is different between the expansion side and the contraction side, so that a difference occurs in the operation speed, and the contraction speed becomes faster than the expansion speed. The rolling cylinder 30 used in the small tractor described in the present embodiment has an extension speed of about 2/3 with respect to the contraction speed.
[0034]
Therefore, as shown in the lowermost stage of FIG. 7 (corrected right-up output), when the horizontal control signal of “right-up” is output and the rolling cylinder 30 is contracted, the output stop delay time is set to 2/2 of T2 described above. 3, the rolling angular velocity is reduced and the dead zone U is reduced during the time T 2 × (2/3) from the time when the rolling angular velocity becomes equal to or less than the threshold value (−αV) (time point t 7 to t 9 ). Even if entered, the contraction drive of the rolling cylinder 30 is continued without stopping the “right-up” horizontal control signal. Thus, the operation amount of the cylinder can be made the same on the expansion side and the contraction side of the rolling cylinder 30.
[0035]
On the other hand, as shown in FIG. 8, the time T 3 while the constant value + αV is exceeded is measured (time points t 11 to t 12 ), and the rolling angular velocity becomes equal to or less than the threshold value (+ αV). When the output stop delay is performed during 3 (time t 12 to t 13 ) and the rolling angular velocity exceeds the reverse threshold (−αV) (time t 14 ), the output stop delay It is necessary to prevent the work machine from overshooting by subtracting the time. Subtraction of the output stop delay is half of the difference between T4 of the time t 13 and t 14. Thereby, the output stop delay of the “lower right” horizontal control signal is subtracted at time T 5 from time t 12 to time t 15 .
[0036]
Since the degree of inclination with respect to the amount of expansion / contraction of the rolling cylinder 30 varies depending on the size of the mounting width of the rotary work machine 12, the tractor 10 is provided with a mounting width switching device (not shown). Accordingly, when the mounting width switching device is switched, it is natural to change the output stop delay time of the horizontal control signal described above.
[0037]
Here, when the aircraft turns during the horizontal control based on the detection value of the rolling angular velocity sensor 43, a command signal is output from the controller 50 to the lift solenoid of the lift cylinder electromagnetic control valve to raise the rotary work machine 12 to a predetermined height. Raise it. Alternatively, even when the machine is traveling straight ahead, the rotary work machine 12 is raised to a predetermined height by a manual operation when going out of the work area or when moving the machine backward. At this time, if the rolling angular velocity sensor 43 detects the angular velocity due to the vibration of the airframe and outputs a horizontal control signal, the work implement may be rattled and the feeling of operation will be deteriorated. The output of the horizontal control signal based on the angular velocity is prohibited, and when the turning operation or the reverse operation is finished and the rotary work machine 12 is lowered, the horizontal control signal based on the rolling angular velocity is output again.
[0038]
For example, as shown in FIG. 9, when the detection value of the lift arm angle sensor 25 becomes a certain value or more during horizontal control based on the detection value of the rolling angular velocity sensor 43 (Step 200), the rotary work machine 12 rises. Since it is in operation or stopped at the ascending position, the output of the horizontal control signal based on the rolling angular velocity is prohibited (Step 210). Therefore, unnecessary horizontal control output is not performed while the work implement is raised, and the play of the work implement can be eliminated.
[0039]
When the rotary work machine 12 is lowered after the turning operation or the reverse operation is finished, a horizontal control signal based on the rolling angular velocity is not immediately output, but a weight for a predetermined time (about 2 seconds from the lowering operation) is applied. (Step230). During this time, the control signal is output by switching to horizontal control based on the detection value of the tilt sensor 41 (Step 240). Even if a rotary angular velocity occurs due to the work implement grounding or the like, a horizontal control signal based on the rolling angular velocity is not output, so that erroneous control can be prevented. After a predetermined time has elapsed, output of the horizontal control signal based on the rolling angular velocity is resumed (Step 250).
[0040]
It should be noted that the present invention can be variously modified without departing from the spirit of the present invention, and the present invention naturally extends to the modified one.
[0041]
【The invention's effect】
In the present invention, as described in detail in the above embodiment, when performing horizontal control of the work implement based on the detection value of the airframe tilt sensor and the detection value of the rolling angular velocity of the airframe, the tilt sensor is equal to or greater than a certain value. When the rolling angle is detected, a horizontal control signal based on the rolling angular velocity is output as the dead zone even if the rolling angle velocity dead zone is widened and vibration noise due to the tire lug pattern increases due to the inclination of the fuselage. Since the horizontal control signal is output based on the detected value of the tilt sensor, the unnecessary output can be eliminated without using a special high-performance sensor or actuator. And horizontal control with good responsiveness can be performed. On the other hand, when a rolling angular velocity greater than the dead zone is detected, horizontal control based on the rolling angular velocity is performed, so that it is possible to perform accurate horizontal control by preventing overwork of the work implement and response delay.
[Brief description of the drawings]
The figure shows an embodiment of the present invention.
FIG. 1 is a side view of a tractor body and a rotary work machine.
FIG. 2 is a rear view of FIG. 1 in which illustration of a rear cover sensor and the like is omitted.
FIG. 3 is a block diagram of a control system.
FIG. 4 is a graph showing a detection signal of a rolling angular velocity sensor when there is noise.
FIG. 5 is a flowchart showing a control procedure of the horizontal control device.
FIG. 6 is a perspective view of a main part showing a lug pattern of a tire.
FIG. 7 is a graph showing an output stop delay when a large rolling angular velocity is detected.
FIG. 8 is a graph obtained by subtracting an output stop delay.
FIG. 9 is a flowchart showing a control procedure when a work implement lowering operation is performed during horizontal control at a rolling angular velocity.
[Explanation of symbols]
DESCRIPTION OF SYMBOLS 10 Tractor 11 Link mechanism 12 Rotary work machine 17 Inclination adjustment dial 30 Rolling cylinder 31 Stroke sensor 41 Inclination sensor 43 Rolling angular velocity sensor 50 Controller

Claims (1)

機体の後部にリンク機構を介して作業機を連結し、該機体と作業機の間に機体に対する作業機のローリング角を変更するアクチュエータと該機体に対する作業機のローリング角を検出する手段とを設け、該機体に機体のローリング角を検出する傾斜センサと、作業機のローリング角を設定する傾き設定手段とを備えた水平制御装置に於いて、該機体に機体がローリングするときのローリング角速度検出手段を設け、ローリング角速度検出手段の検出値と前記傾斜センサの検出値とに基づき、前記傾き設定手段の設定値に応じて作業機のローリング角を調整するとともに、前記傾斜センサが一定値以上のローリング角を検出しているときは、ローリング角速度検出手段の不感帯を広げ、ローリング角速度検出手段の検出値が該不感帯内にあるときは、ローリング角速度検出手段の検出値に基づく水平制御信号を出力しないように構成したことを特徴とする水平制御装置。A work machine is connected to the rear part of the machine body via a link mechanism, and an actuator for changing the rolling angle of the work machine relative to the machine body and means for detecting the rolling angle of the work machine relative to the machine body are provided between the machine body and the work machine. In a horizontal control device comprising an inclination sensor for detecting the rolling angle of the machine body and an inclination setting means for setting the rolling angle of the work machine, a rolling angular velocity detection means when the machine rolls on the machine body And adjusting the rolling angle of the work implement according to the set value of the tilt setting means based on the detection value of the rolling angular velocity detection means and the detection value of the tilt sensor, and the tilt sensor When the angle is detected, the dead zone of the rolling angular velocity detection means is widened, and the detection value of the rolling angular velocity detection means is within the dead zone. A horizontal control apparatus characterized by being configured so as not to output the horizontal control signal based on the detection value of the rolling angular velocity detection means.
JP16932099A 1999-06-16 1999-06-16 Horizontal control device Expired - Fee Related JP3838319B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP16932099A JP3838319B2 (en) 1999-06-16 1999-06-16 Horizontal control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP16932099A JP3838319B2 (en) 1999-06-16 1999-06-16 Horizontal control device

Publications (2)

Publication Number Publication Date
JP2000354402A JP2000354402A (en) 2000-12-26
JP3838319B2 true JP3838319B2 (en) 2006-10-25

Family

ID=15884369

Family Applications (1)

Application Number Title Priority Date Filing Date
JP16932099A Expired - Fee Related JP3838319B2 (en) 1999-06-16 1999-06-16 Horizontal control device

Country Status (1)

Country Link
JP (1) JP3838319B2 (en)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4908732B2 (en) * 2003-07-04 2012-04-04 株式会社Ihiシバウラ Agricultural work vehicle
JP4500660B2 (en) * 2004-12-13 2010-07-14 三菱農機株式会社 Mobile farm machine
JP2006314209A (en) * 2005-05-10 2006-11-24 Yanmar Co Ltd Apparatus for attitude control of implement
JP2007238057A (en) * 2006-03-13 2007-09-20 Kubota Corp Attitude controller of working vehicle
JP4871002B2 (en) * 2006-03-13 2012-02-08 株式会社クボタ Combine attitude control device
JP4594922B2 (en) * 2006-12-22 2010-12-08 株式会社クボタ Agricultural machine rolling control device
JP5096050B2 (en) * 2007-06-19 2012-12-12 株式会社Ihiシバウラ Agricultural work vehicle
JP5239518B2 (en) * 2008-05-30 2013-07-17 井関農機株式会社 Agricultural machine

Also Published As

Publication number Publication date
JP2000354402A (en) 2000-12-26

Similar Documents

Publication Publication Date Title
JP2000142049A (en) Method for automatically controlling horizontal attitude of tractor and its device
WO2013095906A1 (en) Implement control system for a machine
JP3838319B2 (en) Horizontal control device
JP3797881B2 (en) Rolling control device for work equipment
JP2969808B2 (en) Level control device for powered vehicle
JP3838320B2 (en) Horizontal control device
JP5943852B2 (en) Work vehicle
JP3690187B2 (en) Horizontal control device
JP5138355B2 (en) Work vehicle
JP3721855B2 (en) Horizontal control device
JP3870610B2 (en) Horizontal control device
JP3870611B2 (en) Horizontal control device
JP2000253706A (en) Rolling control apparatus for ground working machine of tractor
JP3717411B2 (en) Sensor zero correction device for work equipment
JP4041255B2 (en) Rice transplanter
JP3783224B2 (en) Horizontal control device for work vehicle
JPH0116121B2 (en)
JP3688211B2 (en) Rolling control device for work equipment
JP3767245B2 (en) Plowing depth control device
JP3916555B2 (en) Agricultural machine rolling control device
JP5851360B2 (en) Work vehicle
JP2969809B2 (en) Level control device for powered vehicle
JP3736258B2 (en) Tractor depth control device
JP2004024135A (en) Rolling-controlling device for working vehicle
JP2000232803A (en) Rolling-controller of working vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20051031

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20060707

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: 20060712

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20060725

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: 20120811

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20120811

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20150811

Year of fee payment: 9

LAPS Cancellation because of no payment of annual fees