JP2004113028A - Rolling controller of farm working machine - Google Patents
Rolling controller of farm working machine Download PDFInfo
- Publication number
- JP2004113028A JP2004113028A JP2002277730A JP2002277730A JP2004113028A JP 2004113028 A JP2004113028 A JP 2004113028A JP 2002277730 A JP2002277730 A JP 2002277730A JP 2002277730 A JP2002277730 A JP 2002277730A JP 2004113028 A JP2004113028 A JP 2004113028A
- Authority
- JP
- Japan
- Prior art keywords
- rolling
- angular velocity
- sensor
- inclination
- ground
- 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
Links
Images
Landscapes
- Lifting Devices For Agricultural Implements (AREA)
Abstract
Description
【0001】
【発明の属する技術分野】
本発明は、農用トラクタなどの農作業機に利用するローリング制御装置に関する。
【0002】
【従来の技術】
上記ローリング制御装置としては、対地作業装置を駆動ローリング自在に連結した走行機体に、走行機体の左右傾斜傾斜角度を検出する傾斜センサと、走行機体の左右傾斜方向の角速度を検出する角速度センサとを備え、両センサからの検出値に基づいて、対地作業装置の左右方向での対地傾斜姿勢が設定角度に維持されるように対地作業装置を駆動ローリングさせるよう構成したものがある特許文献1参照。)。
【0003】
【特許文献1】
特開2002−243449号公報
【0004】
【発明が解決しようとする課題】
上記のように傾斜センサと角速度センサとを利用したローリング制御装置は、傾斜センサのみを利用したローリング制御装置に比較して、応答性および精度の高いローリング制御を行うことができるのであるが、角速度センサの他軸感度の影響で、機体旋回作動時に制御精度が低下することがあった。
【0005】
つまり、角速度センサは、その検出作動軸心がローリング軸心(機体前後方向に向かう軸心)と平行となるように取り付ける必要があるが、角速度センサ自体の取り付け誤差、走行機体の前後輪の沈下量の差、タイヤのへこみ具合の差、などが存在するために、角速度センサの検出作動軸心を完全にローリング軸心と平行に取り付けることは実際上は不可能であり、また、センサケースを正確に所定の姿勢に取り付けることができたとしても、ケース内部の素子の取付け誤差や加工誤差などがあると、走行機体のヨーイング作動やピッチング作動に対しても角速度センサが出力してしまうことになる。
【0006】
このようにセンサ取付け軸心(この場合はローリング軸心)と直交する他の軸心(この場合はヨーイング軸心とピッチング軸心)周りの回転に感応してしまう現象、いわゆる他軸感度が顕著になると、例えば、圃場での往復作業において畦際で機体をUターン旋回させる場合や、変形圃場において走行機体を圃場形状に合わせて向き変更しながら走行するような場合のように、走行機体を急激あるいは比較的急激に旋回作動したような場合に、走行機体のヨーイング作動に対応した前記他軸感度によって不要な出力が角速度センサから出力されてしまい、制御精度が悪化してしまうことになる。また、角速度センサを用いた制御においては、温度ドリフトなどの影響を回避するために角速度センサからの出力を平均する零点演算処理を行うが、上記のように他軸感度によって不要な出力がでると、取得した零点も誤ったものとなり、機体旋回の後に不要な出力による影響が無くなって正しい零点が再び取得されるようになるまでの間は精度の低いローリング制御しか実行できなくなるものであった。
【0007】
本発明は、このような点に着目してなされたものであって、走行機体が旋回作動した際にもローリング制御を精度良く行うことができるようにすることを目的としている。また、旋回作動後も直ちに適正な零点補正のもとでの制度の高いローリング制御を行えるようにすることを他の目的とする。
【0008】
【課題を解決するための手段】
〔請求項1に係る発明の構成、作用、および効果〕
【0009】
請求項1に係る発明は、対地作業装置を駆動ローリング自在に連結した走行機体に、走行機体の左右傾斜傾斜角度を検出する傾斜センサと、走行機体の左右傾斜方向の角速度を検出する角速度センサとを備え、両センサからの検出値に基づいて、対地作業装置の左右方向での対地傾斜姿勢が設定角度に維持されるように対地作業装置を駆動ローリングさせるローリング制御手段を設けてある農作業機のローリング制御装置であって、
走行機体が所定の旋回作動状態にあることが検知されると、傾斜センサのみの検出値に基づくローリング制御を実行するよう構成してあることを特徴とする。
【0010】
上記構成によると、圃場内の作業走行のほとんどが直線走行であり、この時は、傾斜センサと角速度センサの両者からの検出値に基づいてローリング制御が行われ、走行機体が畦際などで方向転換のために旋回作動された際には、他軸感度によって角速度センサから不要な出力が出ても、この旋回作動中は角速度センサからの検出値は制御に利用されることはなく、傾斜センサのみの検出値に基づくローリング制御が行われる。
【0011】
従って、請求項1の発明によると、旋回作動中も角速度センサの他軸感度による悪影響を受けない精度の高いローリング制御を行うことが可能となった。
【0012】
〔請求項2に係る発明の構成、作用、および効果〕
【0013】
請求項2に係る発明は、対地作業装置を駆動ローリング自在に連結した走行機体に、走行機体の左右傾斜傾斜角度を検出する傾斜センサと、走行機体の左右傾斜方向の角速度を検出する角速度センサとを備え、両センサからの検出値に基づいて、対地作業装置の左右方向での対地傾斜姿勢が設定角度に維持されるように対地作業装置を駆動ローリングさせるローリング制御手段を設けてある農作業機のローリング制御装置であって、
前記角速度センサの出力を平均して零点演算を行うよう構成するとともに、走行機体が所定の旋回作動状態にあることが検知されると、前記角速度センサの零点補正演算処理を休止するよう構成してあることを特徴とする。
【0014】
上記構成によると、圃場内の作業走行のほとんどが直線走行であり、この時は、角速度センサの零点演算処理がなされて、温度ドリフトによる影響をなくした状態で、傾斜センサと角速度センサの両者からの検出値に基づいてローリング制御が行われる。そして、走行機体が畦際などで方向転換のために旋回作動された際には、角速度センサの零点補正演算処理が休止され、誤った零点の取得が止められる。そして、旋回作動が終了すると、零点補正演算処理が再開されるが、この際、不要な出力に基づく誤った零点は取得されていないので、直ちに精度の高い零点が取得されて制御に利用される。なお、旋回作動中のローリング制御の精度は低下することになるが、旋回作動は一般に短時間であるので実作業に大きい支障をきたすことはない。
【0015】
従って、請求項2の発明によると、旋回作動中の零点補正演算処理を休止して、その間の誤った零点の取得を回避するようにしたので、旋回作動直後から適正な零点補償のもとでの精度の高いローリング制御を行うことができる。
【0016】
【発明の実施の形態】
以下、本発明の実施の形態を図面に基づいて説明する。
図1は農作業機の一例である農用トラクタの全体を、また、図2はその後部を示しており、走行機体としてのトラクタ本機1は、操向輪としての前輪2と主推進車輪としての後輪3とで走行する4輪駆動型に構成され、機体後部に配備されたミッションケース4に、トップリンク5aと左右一対のロアーリンク5bからなる3点リンク機構5を介して、対地作業装置の一例であるロータリ耕耘装置6が連結されている。ミッションケース4の上部には、単動型の油圧シリンダからなるリフトシリンダ7により上下に揺動駆動される左右一対のリフトアーム8が備えられ、これら左右のリフトアーム8と左右のロアーリンク5bとが、リフトロッド9、及び複動型の油圧シリンダからなるローリングシリンダ10を介してそれぞれ連結されている。また、詳細な構造の説明は省略するが、前記前輪2の伝動系には、前輪2が直進状態から設定角度(例えば30°)以上に大きく操向されたことが検知されると、前輪駆動速度を約2倍に増速して小回り旋回状態をもたらす油圧操作制御式の前輪変速機構14が装備されている。
【0017】
図2に示すように、リフトシリンダ7に接続された電磁制御弁11が制御装置12により操作されて、リフトシリンダ7及びリフトアーム8によりロータリ耕耘装置6が昇降駆動される。また、ローリングシリンダ10に接続された電磁制御弁13が制御装置12により操作されて、ローリングシリンダ10が伸縮作動されることでロータリ耕耘装置6がローリング駆動されて、その左右傾斜角度が変更されるようになっている。
【0018】
この農用トラクタは、ロータリ耕耘装置6の耕深を設定値に維持する昇降制御、トラクタ本機1に対するロータリ耕耘装置6の高さを任意に調節するポジション制御、および、水平面に対するロータリ耕耘装置6の左右方向の傾斜角度を設定角度に維持するローリング制御が可能となっている。
【0019】
ロータリ耕耘装置6の後部には、耕耘跡を鎮圧整地する後カバー15が上下揺動自在かつ下方付勢状態に備えられ、この後カバー15の上下揺動角度を検出する耕深センサ16が備えられて、その検出信号が前記制御装置12に入力されている。他方、制御装置12には、ダイヤル操作式のポテンショメータからなる耕耘設定器17と自動耕深制御を入り切りするオンオフスイッチ18が接続されており、このオンオフスイッチ18を「入り」にしておくと、耕深センサ16の検出値が耕深設定器17の設定値と均衡するように電磁制御弁11が操作されて、リフトシリンダ7によりロータリ耕耘装置6が自動的に昇降駆動されることで、実耕深が耕深設定器17の設定値に対応した深さに安定維持されるようになっている。
【0020】
また、制御装置12には、リフトアーム8の上下角度を検出する角度センサ19と、ポジションレバー20によって操作されるポジション設定器21が接続されており、前記オンオフスイッチ18を「切り」にして自動耕深制御を停止した状態では、ポジション制御のみが実行され、角度センサ19の検出値がポジション設定器21の設定値と均衡するまで電磁制御弁11が操作されて、リフトシリンダ7がその位置に保持される。
【0021】
なお、オンオフスイッチ18を「入り」にしての自動耕深制御中にポジションレバー20を大きく上昇方向に操作すると、耕深設定器17の設定耕深に対応する角度センサ19の検出値と、ポジション設定器21の目標値とが比較されて、ポジション設定器21の目標値の方が高い場合、ポジション制御が優先作動するようになっている。従って、自動耕深制御による耕耘作業において、畦際における機体方向転換時には、ポジションレバー20を上限にまで操作することにより、ロータリ耕耘装置6を地上に持上げることができ、また、機体方向転換後にポジションレバー20を下限まで操作することで、耕深設定器17で設定されている耕深での自動耕深制御を再開することができる。
【0022】
この農用トラクタでは、ロータリ耕耘装置6の水平面に対する左右方向の傾斜角度を設定角度に維持するようにローリング駆動するローリング制御手段が備えられており、制御装置12に接続したダイヤル操作式のポテンショメータからなる傾斜設定器25を調節操作することで、ロータリ耕耘装置6の左右方向の設定角度を任意に変更することができるようになっている。
【0023】
このローリング制御には、前記傾斜設定器25の他に、トラクタ本機(走行機体)1の左右傾斜角度を検出する傾斜センサ26と、トラクタ本機1の左右傾斜方向の角速度を検出する振動ジャイロ型の角速度センサ27と、ローリングシリンダ9の作動長さを検出するストロークセンサ28とが利用される。つまり、図4のブロック図に示すように、傾斜センサ26と角速度センサ27からの情報に基づいてトラクタ本機1の左右方向での傾斜角度θが演算され、トラクタ本機1がこの傾斜角度θにある時にロータリ耕耘装置5を傾斜設定器25による設定角度にするために必要なローリングシリンダ9の目標シリンダ長さL0 が割り出され、ローリングシリンダ9の長さLをこの目標シリンダ長さL0 に近づけるようにフィードバック制御がなされて、電磁制御弁13が作動されるのである。
【0024】
図5に、傾斜センサ26と角速度センサ27からの情報に基づいてトラクタ本機1の左右傾斜角度θを演算する制御ブロック図が示されている。図から判るように、ここでは、角速度センサ27からの信号を積分することで傾斜角度を演算するとともに、その誤差を傾斜センサ26からの信号で補正する形態が採用されている。
【0025】
つまり、温度等の諸条件によってドリフトする角速度センサ27の零点を時間経過に伴って更新して補正するセンサ零点補正処理がなされる。即ち、角速度センサ27によって検出されるサンプリング出力値の複数が記憶され、記憶された所定複数のサンプリングデータが平均処理されるとともに、ローパスフィルタ(LPF)を用いて平滑化処理されて零点が割り出され、この零点と実検出値との差をゲインK1 で積分分処理することで傾斜角度θが演算されるのである。また、このようにして算出された演算傾斜角度θと傾斜センサ26から得られる検出傾斜角度θrとの偏差にゲインK2 を乗じた値をフィードバックすることで、積分処理による誤差の集積を消去している。
【0026】
また、前記角速度センサ27が機体旋回作動時に他軸感度(ヨーイング軸心回りの回動への感応)による不要な出力を出して、ローリング制御に悪影響を及ぼすのを抑制するために以下のような手段が備えられている。
【0027】
〔第1例〕
【0028】
図3に示すように、前記制御装置12には、走行機体1における前輪2の操向角を検出するポテンショメータなどの角度センサ31、後輪3の回転速度を検出する回転センサ23、および、前輪2を自動増速する前輪変速機構の作動をオン・オフする前輪増速スイッチ33とが接続されており、これら角度センサ31,回転センサ32,前輪増速スイッチ33からの情報に基づいて操向機体1の旋回作動状況が認識されるようになっている。
【0029】
そして、実際に圃場に乗り入れての作業においては、図6のフローチャートに示すような制御がなされる。
【0030】
すなわち、角度センサ31によって前輪2の操向角が検出されるとともに、回転センサ32によって走行機体1の走行速度が検出され、かつ、前輪増速スイッチ33から前輪変速機構14が作動可能な状態か否かが認識され、これらの検出結果から現在の旋回作動状況が割り出される。
【0031】
割り出された旋回作動状況が、角速度センサ27から他軸感度に基づいて出される不要な出力が無視できない値になる所定の条件を満たしていれば、角速度センサ27の出力利用した上記ローリング制御を休止して、傾斜センサ26の出力を機体傾斜角度θとしてのローリング制御が実行される。また、旋回作動状況が、角速度センサ27からの不要な出力が無視できる条件に戻れば、傾斜センサ26と角速度センサ27からの出力を利用した元のローリング制御に復帰する。
【0032】
また、エンジン始動から設定時間内では角速度センサ27の零点演算の精度が安定しないので、この条件下においても、傾斜センサ26の出力を機体傾斜角度θとしてのローリング制御が実行され、その後は、傾斜センサ26と角速度センサ27からの出力を利用したローリング制御が行われる。
【0033】
〔第2例〕
【0034】
図7のフローチャートに示されるように、角度センサ31によって前輪2の操向角が検出されるとともに、回転センサ32によって走行機体1の走行速度が検出され、かつ、前輪増速スイッチ33から前輪変速機構14が作動可能な状態か否かが認識され、これらの検出結果から現在の旋回作動状況が割り出される。
【0035】
割り出された旋回作動状況が、角速度センサ27から他軸感度に基づいて出される不要な出力が無視できない値になる所定の条件を満たしていれば、角速度センサ27による零点の演算処理を休止して機体傾斜角度θが割出され、この機体傾斜角度θに基づいてローリング制御が実行される。また、旋回作動状況が、角速度センサ27からの不要な出力が無視できる条件になれば、角速度センサ27による零点の演算処理が再開されて元のローリング制御に復帰する。
【0036】
また、エンジン始動から設定時間内では角速度センサ27の零点演算の精度が安定しないので、この条件下においても、角速度センサ27による零点の演算処理が休止され、その後は角速度センサ27による零点の演算処理が行われての傾斜角演算がなされる。
【0037】
本発明は、以下のような形態で実施することも可能である。
【0038】
(1)割り出された旋回作動状況が、角速度センサ27から他軸感度に基づいて出される不要な出力が無視できない値になる所定の条件を満たしていることが判別されると、その時点より旋回の開始時点を推測し、角速度センサ27の零点演算および傾斜角θの演算をそれ以前の状態に戻すことで、他軸感度の影響をほぼ完全に排除してローリング制御することもできる。なお、旋回の開始時点を推測することの代用として、角速度センサ27から他軸感度に基づいて出される不要な出力が無視できない値になる所定の条件を満たしていることが判別された時点から設定時間だけ零点演算および傾斜角θの演算をさかのぼるようにしても、他軸感度の影響を相当排除することができるものである。
【0039】
(2)走行機体1の旋回作動状況を検出する手段としては、作動軸心を縦向きにしたヨー軸角速度センサを別途備えて、直接的に走行機体1の旋回状況を検出することもできる。
【0040】
(3)前輪操向に連動して前輪2を増速する前輪変速機構14を備えるとともに、前輪増速が行われる際に旋回内側となる後輪3に制動をかけるオートブレーキ機能を備えた形態で実施することもできる。
【0041】
(4)本発明は、対地作業装置6に傾斜センサ26と角速度センサ27を取り付けた形態のものに適用することも可能である。
【図面の簡単な説明】
【図1】農用トラクタ全体の斜視図
【図2】農用トラクタの後部を示す斜視図
【図3】制御装置の概略構成を示すブロック図
【図4】ローリング制御装置のブロック図
【図5】傾斜角演算用の制御ブロック図
【図6】傾斜角演算用のフローチャート
【図7】別実施形態における傾斜角演算用のフローチャート
【符号の説明】
1 走行機体
2 前輪
3 後輪
6 対地作業装置
26 傾斜センサ
27 角速度センサ[0001]
TECHNICAL FIELD OF THE INVENTION
The present invention relates to a rolling control device used for an agricultural work machine such as an agricultural tractor.
[0002]
[Prior art]
As the rolling control device, an inclination sensor for detecting a left-right inclination angle of the traveling aircraft and an angular velocity sensor for detecting an angular velocity of the traveling aircraft in the left-right inclination direction are provided on a traveling aircraft connected to a ground working device so as to be able to drive and roll. Japanese Patent Application Laid-Open No. H10-163,087 discloses a configuration in which a ground working device is driven and rolled based on detection values from both sensors such that a horizontal inclination posture of the ground working device in a left-right direction is maintained at a set angle. ).
[0003]
[Patent Document 1]
JP-A-2002-243449
[Problems to be solved by the invention]
As described above, a rolling control device using a tilt sensor and an angular velocity sensor can perform highly responsive and accurate rolling control as compared with a rolling control device using only a tilt sensor. Due to the influence of the other axis sensitivity of the sensor, the control accuracy may be reduced during the turning operation of the fuselage.
[0005]
In other words, the angular velocity sensor needs to be mounted so that its detection operation axis is parallel to the rolling axis (the axis going in the longitudinal direction of the machine), but there is an error in the mounting of the angular velocity sensor itself, and the sinking of the front and rear wheels of the traveling machine. Due to the differences in the amount and the degree of depression of the tire, it is practically impossible to mount the detection axis of the angular velocity sensor completely parallel to the rolling axis. Even if it can be mounted correctly in a predetermined position, if there is a mounting error or processing error of the element inside the case, the angular velocity sensor will output even for yawing operation and pitching operation of the traveling aircraft. Become.
[0006]
In this way, the phenomenon of responding to rotation about another axis (in this case, the yawing axis and the pitching axis) orthogonal to the sensor mounting axis (in this case, the rolling axis), that is, the so-called other axis sensitivity is remarkable. When, for example, during the reciprocating work in the field, when the body is turned U-turn around the ridge, or when traveling while changing the direction of the traveling body in the deformed field according to the field shape, When the turning operation is performed suddenly or relatively rapidly, an unnecessary output is output from the angular velocity sensor due to the other axis sensitivity corresponding to the yawing operation of the traveling body, and the control accuracy is deteriorated. In addition, in the control using the angular velocity sensor, a zero point calculation process of averaging the output from the angular velocity sensor is performed in order to avoid the influence of a temperature drift or the like. In addition, the acquired zero point is also erroneous, and only a low-accuracy rolling control can be executed until the correct zero point is acquired again after the turning of the airframe until the influence of unnecessary output is eliminated.
[0007]
The present invention has been made in view of such a point, and an object of the present invention is to enable the rolling control to be accurately performed even when the traveling body turns. It is another object of the present invention to enable high-precision rolling control under appropriate zero correction immediately after the turning operation.
[0008]
[Means for Solving the Problems]
[Configuration, operation, and effect of the invention according to claim 1]
[0009]
The invention according to
When the traveling body is detected to be in a predetermined turning operation state, rolling control based on a detection value of only the inclination sensor is executed.
[0010]
According to the above configuration, most of the work traveling in the field is straight traveling. At this time, the rolling control is performed based on the detection values from both the inclination sensor and the angular velocity sensor, and the traveling aircraft moves in the direction of a ridge or the like. When the turning operation is performed for conversion, even if an unnecessary output is output from the angular velocity sensor due to the sensitivity of the other axis, the detected value from the angular velocity sensor is not used for control during the turning operation, and the inclination sensor is not used. Rolling control based on only the detected values is performed.
[0011]
Therefore, according to the first aspect of the present invention, it is possible to perform high-accuracy rolling control which is not adversely affected by the other axis sensitivity of the angular velocity sensor even during the turning operation.
[0012]
[Structure, operation, and effect of the invention according to claim 2]
[0013]
The invention according to
A zero point calculation is performed by averaging the outputs of the angular velocity sensors, and a zero point correction calculation process of the angular velocity sensors is paused when it is detected that the traveling body is in a predetermined turning operation state. There is a feature.
[0014]
According to the above configuration, most of the work traveling in the field is straight traveling, and at this time, the zero point calculation processing of the angular velocity sensor is performed, and the influence of the temperature drift is eliminated, and both of the inclination sensor and the angular velocity sensor are used. Rolling control is performed based on the detected value of. Then, when the traveling body is turned for a change of direction at a ridge or the like, the zero-point correction calculation processing of the angular velocity sensor is suspended, and acquisition of an erroneous zero is stopped. When the turning operation is completed, the zero point correction calculation process is restarted. At this time, since an erroneous zero point based on an unnecessary output has not been obtained, a highly accurate zero point is immediately obtained and used for control. . In addition, although the accuracy of the rolling control during the turning operation is reduced, the turning operation is generally performed in a short time, so that there is no great trouble in actual work.
[0015]
Therefore, according to the second aspect of the present invention, the zero point correction calculation process during the turning operation is suspended, and the acquisition of an erroneous zero during the turning operation is avoided, so that immediately after the turning operation, under appropriate zero point compensation. High-precision rolling control can be performed.
[0016]
BEST MODE FOR CARRYING OUT THE INVENTION
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 shows an entire agricultural tractor as an example of an agricultural work machine, and FIG. 2 shows a rear part thereof. A tractor
[0017]
As shown in FIG. 2, the
[0018]
This agricultural tractor includes elevation control for maintaining the tillage depth of the
[0019]
At the rear of the
[0020]
An
[0021]
When the
[0022]
This agricultural tractor is provided with a rolling control means for performing a rolling drive so as to maintain the horizontal tilt angle of the
[0023]
In this rolling control, in addition to the
[0024]
FIG. 5 shows a control block diagram for calculating the left-right inclination angle θ of the tractor
[0025]
That is, a sensor zero point correction process of updating and correcting the zero point of the
[0026]
In order to prevent the
[0027]
[First example]
[0028]
As shown in FIG. 3, the
[0029]
Then, in the operation of actually getting into the field, the control as shown in the flowchart of FIG. 6 is performed.
[0030]
That is, the steering angle of the
[0031]
If the determined turning operation condition satisfies a predetermined condition that an unnecessary output output from the
[0032]
Also, since the accuracy of the zero point calculation of the
[0033]
[Second example]
[0034]
As shown in the flowchart of FIG. 7, the steering angle of the
[0035]
If the determined turning operation condition satisfies a predetermined condition that an unnecessary output output from the
[0036]
Further, since the accuracy of the calculation of the zero point of the
[0037]
The present invention can be implemented in the following forms.
[0038]
(1) When it is determined that the determined turning operation condition satisfies a predetermined condition that an unnecessary output output from the
[0039]
(2) As means for detecting the turning operation state of the traveling
[0040]
(3) A mode in which a front
[0041]
(4) The present invention can also be applied to a configuration in which the
[Brief description of the drawings]
FIG. 1 is a perspective view of an entire agricultural tractor. FIG. 2 is a perspective view showing a rear portion of the agricultural tractor. FIG. 3 is a block diagram showing a schematic configuration of a control device. FIG. 4 is a block diagram of a rolling control device. FIG. 6 is a control block diagram for angle calculation. FIG. 6 is a flowchart for tilt angle calculation. FIG. 7 is a flowchart for tilt angle calculation in another embodiment.
DESCRIPTION OF
Claims (2)
走行機体が所定の旋回作動状態にあることが検知されると、傾斜センサのみの検出値に基づくローリング制御を実行するよう構成してあることを特徴とする農作業機のローリング制御装置。A traveling aircraft having a ground-moving device connected in a freely rolling manner is provided with an inclination sensor for detecting the inclination angle of the traveling aircraft in the left-right direction and an angular velocity sensor for detecting the angular velocity in the left-right inclination direction of the traveling aircraft. Based on the value, a rolling control device of an agricultural work machine provided with rolling control means for driving and rolling the ground work device so that the ground inclination posture in the left-right direction of the ground work device is maintained at the set angle,
A rolling control device for an agricultural work machine, wherein when a traveling body is detected to be in a predetermined turning operation state, a rolling control is performed based on a detection value of only an inclination sensor.
前記角速度センサの出力を平均して零点演算を行うよう構成するとともに、走行機体が所定の旋回作動状態にあることが検知されると、前記角速度センサの零点補正演算処理を休止するよう構成してあることを特徴とする農作業機のローリング制御装置。A traveling aircraft having a ground-moving device connected in a freely rolling manner is provided with an inclination sensor for detecting the inclination angle of the traveling aircraft in the left-right direction and an angular velocity sensor for detecting the angular velocity in the left-right inclination direction of the traveling aircraft. Based on the value, a rolling control device of an agricultural work machine provided with rolling control means for driving and rolling the ground work device so that the ground inclination posture in the left-right direction of the ground work device is maintained at the set angle,
A zero point calculation is performed by averaging the outputs of the angular velocity sensors, and a zero point correction calculation process of the angular velocity sensors is paused when it is detected that the traveling body is in a predetermined turning operation state. A rolling control device for an agricultural work machine.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002277730A JP2004113028A (en) | 2002-09-24 | 2002-09-24 | Rolling controller of farm working machine |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002277730A JP2004113028A (en) | 2002-09-24 | 2002-09-24 | Rolling controller of farm working machine |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2004113028A true JP2004113028A (en) | 2004-04-15 |
Family
ID=32273250
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002277730A Pending JP2004113028A (en) | 2002-09-24 | 2002-09-24 | Rolling controller of farm working machine |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2004113028A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014023496A (en) * | 2012-07-27 | 2014-02-06 | Kubota Corp | Working vehicle |
-
2002
- 2002-09-24 JP JP2002277730A patent/JP2004113028A/en active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014023496A (en) * | 2012-07-27 | 2014-02-06 | Kubota Corp | Working vehicle |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6420173B2 (en) | Automated traveling field work vehicle | |
EP3467606B1 (en) | Autonomous work vehicle | |
JP6525902B2 (en) | Field work vehicle | |
JP6552420B2 (en) | Work vehicle | |
CN114981149A (en) | Drift stabilization system and method for vehicle and trailer reverse assist system during straight-line trailer reverse | |
JP2019038535A (en) | Automatic travel field work vehicle | |
JP7269255B2 (en) | Error correction device | |
CN113060143B (en) | System and method for determining road adhesion coefficient | |
JP3949078B2 (en) | Agricultural machine rolling control device | |
CN111412886B (en) | Detection method and detection system | |
JP3797902B2 (en) | Tractor depth control device | |
JP3838959B2 (en) | Agricultural machine rolling control device | |
JP2004113028A (en) | Rolling controller of farm working machine | |
JP3236414B2 (en) | Steering control device for riding type paddy field work vehicle | |
JP3669947B2 (en) | Rolling control device for work equipment | |
JP3916555B2 (en) | Agricultural machine rolling control device | |
JP2009148230A (en) | Working vehicle | |
JP2004113029A (en) | Rolling controller of farm working machine | |
JP3880538B2 (en) | Farm machine control device | |
JP5353301B2 (en) | Work vehicle | |
JP4594922B2 (en) | Agricultural machine rolling control device | |
JP2870893B2 (en) | Moving agricultural machine | |
JPS6332406B2 (en) | ||
CN115244486A (en) | Error correction device | |
JP2001269019A (en) | Agricultural working vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Effective date: 20040916 Free format text: JAPANESE INTERMEDIATE CODE: A621 |
|
A977 | Report on retrieval |
Effective date: 20050520 Free format text: JAPANESE INTERMEDIATE CODE: A971007 |
|
A131 | Notification of reasons for refusal |
Effective date: 20050526 Free format text: JAPANESE INTERMEDIATE CODE: A131 |
|
A02 | Decision of refusal |
Effective date: 20050929 Free format text: JAPANESE INTERMEDIATE CODE: A02 |