JP3717411B2 - Sensor zero correction device for work equipment - Google Patents
Sensor zero correction device for work equipment Download PDFInfo
- Publication number
- JP3717411B2 JP3717411B2 JP2001038332A JP2001038332A JP3717411B2 JP 3717411 B2 JP3717411 B2 JP 3717411B2 JP 2001038332 A JP2001038332 A JP 2001038332A JP 2001038332 A JP2001038332 A JP 2001038332A JP 3717411 B2 JP3717411 B2 JP 3717411B2
- Authority
- JP
- Japan
- Prior art keywords
- sensor
- output values
- angular velocity
- sampling output
- traveling
- 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 - Lifetime
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D11/00—Component parts of measuring arrangements not specially adapted for a specific variable
- G01D11/16—Elements for restraining, or preventing the movement of, parts, e.g. for zeroising
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C9/00—Measuring inclination, e.g. by clinometers, by levels
- G01C9/02—Details
- G01C9/06—Electric or photoelectric indication or reading means
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D21/00—Measuring or testing not otherwise provided for
- G01D21/02—Measuring two or more variables by means not covered by a single other subclass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/42—Devices characterised by the use of electric or magnetic means
- G01P3/44—Devices characterised by the use of electric or magnetic means for measuring angular speed
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manufacturing & Machinery (AREA)
- Lifting Devices For Agricultural Implements (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Gyroscopes (AREA)
Description
【0001】
【発明の属する技術分野】
本発明は、トラクタ、田植機、直藩機といった作業機のセンサ零点補正装置に係り、詳しくは、温度やその他の諸条件変化によってドリフトする角速度センサの零点を、作業機の作動中においても正確に求めることができる技術に関するものである。
【0002】
【従来の技術】
トラクタ等の作業機における対地作業装置のローリング制御においては、作業装置もしくは機体の変位検出手段として傾斜センサと角速度センサとの双方のセンサを用いることにより、応答性が良く、誤作動も先ず無い正確で精度の良い制御作動を行えることが知られている。
【0003】
即ち、特開平2−216412号公報にて示されたように、重錘と、この重錘の揺動量を検出するポテンショメータ等から成る傾斜センサ(低速度反応センサ)、及び光式ジャイロ等で成る角速度センサ(高速度反応センサ)の双方のセンサを用いてローリング制御装置を構成したものである。これにより、慣性の影響を受けず、応答性に優れる角速度センサと、検出時点での絶対傾斜角は検出できない角速度センサの欠点を補う傾斜センサとを組み合わせて、ダンパーやフィルターを設けること無く正確迅速にローリング制御が行え、対地作業精度の向上を図ることができる。
【0004】
【発明が解決しようとする課題】
即ち、振動式等のジャイロセンサによる角速度出力dθj/dtを積分することにより、センサ筐体の横揺れの影響を受けない傾斜角度変化θjを得ることができる。但し、ジャイロセンサは角度変化しか検知できないので、絶対角度の検知には傾斜センサが必要である。
【0005】
ところが、上記のように2種のセンサによるローリング制御においても、依然として解決すべき問題があった。それは、角速度センサは温度変化等によって零点(基準電圧等)が容易にドリフトすることであり、そうなると正確なローリング制御が行えなくなる。例えば、ジャイロセンサは角速度を基準電圧からの偏差として出力するが、基準電圧には固体差や温度変化があるため、前述の角速度出力dθj/dtは常に大きな誤差を含んでおり、傾斜角度変化θjを得るための積分処理によって誤差が蓄積し、実際の傾斜角θが時間と共にずれて行くのである(図3参照)。
【0006】
基準電圧を固体差に対応させるには、機体静止時の電圧を平均して基準電圧に置き換える処理を行えば良く、加えてその処理を定期的に行えば温度変化にも対応させることができる。しかしながら、トラクタのような作業機は連続作業が多くて静止時間を確保できないので、前述のような処理が不可能であった。
【0007】
本発明の目的は、トラクタのように常に作動している状態の作業機でも、温度変化等によってドリフトする角速度センサの零点補正を精度良く行えるようにして、角速度センサと傾斜センサとを用いた応答性及び精度の良いローリング制御を実質的に実現できるようにする点にある。
【0008】
【課題を解決するための手段】
〔構成〕
請求項1の構成は、対地作業装置をローリング自在に走行機体に連結し、対地作業装置を走行機体に対してローリング駆動するアクチュエータと、走行機体又は対地作業装置の左右傾斜角度を検出する傾斜センサと、走行機体又は対地作業装置の左右傾斜方向の角速度を検出する角速度センサとを備えるとともに、傾斜センサと角速度センサとの双方の検出値に基づいて、対地作業装置の左右方向姿勢が設定角度に維持されるようにアクチュエータを作動させるローリング制御手段を設けてある作業機のセンサ零点補正装置において、
角速度センサによって検出されるサンプリング出力値の複数を記憶する記憶手段と、記憶された複数のサンプリング出力値に基づいて演算処理された値を零点とする零点制御手段と、走行機体の姿勢安定度の高い低いを判別する姿勢安定度判別手段とを備え、
走行機体の姿勢安定度が高いほど演算処理に用いるサンプリング出力値の数を少なく設定し、走行機体の姿勢安定度が低いほど演算処理に用いるサンプリング出力値の数を多く設定する補正手段を設けてあることを特徴とする。
【0009】
前述したように、トラクタ等の作業機は基本的に不整地を走行するものであるから、静止時のサンプリング出力値を平均化して精度の良い零点を求めることは先ず不可能である。しかしながら、走行機体が常に左右にローリングしているとは言え、一方向に回転(即ち横転)するということは無く、常に水平姿勢に向けて復帰しつつ左右傾斜しているから、作業中であっても、圃場の起伏や凹凸の周期よりも十分に長い時間に亘ってサンプリングして平均すれば、左右のローリングによる出力値が相殺され、ほぼ正確な零点を求めることは可能である、ということが新たに知見された。但し、サンプリング時間を長くし過ぎると、零点変動に対応できなくなるので、徒にサンプリング数を多くすることは得策ではない。
【0010】
以上のような考えに基づいて想起された請求項1の構成によれば、補正手段の機能により、左右傾斜が比較的穏やかでその傾斜角度自体も小さいといった具合に、走行機体の姿勢安定度が高いほど演算処理に用いるサンプリング出力値の数が少なく設定されるから、姿勢変化条件が緩いときには平均化による角速度センサの零点を迅速に求めることが可能になる。そして、左右傾斜が比較的顕著でその傾斜角度自体も大きいといった具合に、走行機体の姿勢安定度が低いほど演算処理に用いるサンプリング出力値の数が多く設定されるから、姿勢変化条件が厳しいときでも正確に零点を求めることができるようになる。
【0011】
請求項2の構成は、請求項1の構成において、姿勢安定度判別手段が、走行機体の走行速度を検出する車速センサであり、補正手段は、走行速度が遅いほど演算処理に用いるサンプリング出力値の数を少なく設定し、走行速度が速いほど演算処理に用いるサンプリング出力値の数を多く設定するものに構成されていることを特徴とするものである。
【0012】
請求項2の構成によれば、走行機体の姿勢安定度の高い低いを判別する姿勢安定度判別手段が車速センサであり、走行速度が遅いほど横揺れ等が小さい又は生じ難いという状態、即ち姿勢安定度が高いから、この場合には演算処理に用いるサンプリング出力値の数を少なくして、平均化による角速度センサの零点を迅速に求めることが可能になる。そして、走行速度が速いほど横揺れ等が大きい又は生じ易いという状態、即ち姿勢安定度が低いから、この場合には演算処理に用いるサンプリング出力値の数を多くして、平均化による角速度センサの零点を正確に求めることが可能になる。
【0013】
請求項3の構成は、請求項1の構成において、姿勢安定度判別手段が角速度センサであり、補正手段は、角速度センサの出力値が小さいほど演算処理に用いるサンプリング出力値の数を少なく設定し、角速度センサの出力値が大きいほど演算処理に用いるサンプリング出力値の数を多く設定するものに構成されていることを特徴とするものである。
【0014】
請求項3の構成によれば、姿勢安定度判別手段が角速度センサ自体であり、角速度センサの出力値が小さいほど横揺れ等が小さい又は生じ難いという状態、即ち姿勢安定度が高いから、この場合には演算処理に用いるサンプリング出力値の数を少なくして、平均化による角速度センサの零点を迅速に求めることが可能になる。そして、角速度センサの出力値が大きいほど横揺れ等が大きい又は生じ易いという状態、即ち姿勢安定度が低いから、この場合には演算処理に用いるサンプリング出力値の数を多くして、平均化による角速度センサの零点を正確に求めることが可能になる。
【0015】
請求項4の構成は、請求項1の構成において、姿勢安定度判別手段が傾斜センサであり、補正手段は、傾斜センサの出力値が小さいほど演算処理に用いるサンプリング出力値の数を少なく設定し、傾斜センサの出力値が大きいほど演算処理に用いるサンプリング出力値の数を多く設定するものに構成されていることを特徴とする。
【0016】
請求項4の構成によれば、姿勢安定度判別手段が傾斜センサであり、傾斜センサの出力値が小さいほど横揺れ等が小さい又は生じ難いという状態、即ち姿勢安定度が高いから、この場合には演算処理に用いるサンプリング出力値の数を少なくして、平均化による角速度センサの零点を迅速に求めることが可能になる。そして、傾斜センサの出力値が大きいほど横揺れ等が大きい又は生じ易いという状態、即ち姿勢安定度が低いから、この場合には演算処理に用いるサンプリング出力値の数を多くして、平均化による角速度センサの零点を正確に求めることが可能になる。
【0017】
請求項5の構成は、請求項1の構成において、姿勢安定度判別手段が、操向輪の切れ角を検出する切れ角センサであり、補正手段は、操向輪の切れ角が小さいほど演算処理に用いるサンプリング出力値の数を少なく設定し、操向輪の切れ角が大きいほど演算処理に用いるサンプリング出力値の数を多く設定するものに構成されていることを特徴とするものである。
【0018】
請求項5の構成によれば、姿勢安定度判別判別手段が、操向輪の切れ角を検出する切れ角センサであり、切れ角センサの出力値が小さいほど横揺れ等が小さい又は生じ難いという状態、即ち姿勢安定度が高いから、この場合には演算処理に用いるサンプリング出力値の数を少なくして、平均化による角速度センサの零点を迅速に求めることが可能になる。そして、切れ角センサの出力値が大きいほど横揺れ等が大きい又は生じ易いという状態、即ち姿勢安定度が低いから、この場合には演算処理に用いるサンプリング出力値の数を多くして、平均化による角速度センサの零点を正確に求めることが可能になる。
【0021】
請求項6の構成は、対地作業装置をローリング自在に走行機体に連結し、対地作業装置を走行機体に対してローリング駆動するアクチュエータと、対地作業装置の左右傾斜角度を検出する傾斜センサと、対地作業装置の左右傾斜方向の角速度を検出する角速度センサとを備えるとともに、傾斜センサと角速度センサとの双方の検出値に基づいて、対地作業装置の左右方向姿勢が設定角度に維持されるようにアクチュエータを作動させるローリング制御手段を設けてある作業機のセンサ零点補正装置であって、
角速度センサによって検出されるサンプリング出力値の複数を記憶する記憶手段と、記憶された複数のサンプリング出力値に基づいて演算処理された平均値を零点とする零点制御手段と、走行機体の状態安定度の高い低いを判別する状態安定度判別手段とを備え、
走行機体の状態安定度が高いほど演算に用いるサンプリング出力値の数を多く設定し、走行機体の状態安定度が低いほど演算に用いるサンプリング出力値の数を少なく設定する補正手段を設けてあることを特徴とする。
【0022】
請求項6の構成によれば、走行機体の状態安定度が高いほど演算に用いるサンプリング出力値の数を多く設定し、走行機体の状態安定度が低いほど演算に用いるサンプリング出力値の数を少なく設定するものであるから、零点ドリフトが安定しているときには、多くのサンプリング出力値によって精度良く零点を求めることができるとともに、零点ドリフト変化が大きいときには、サンプリング出力値を少なくすることで変化に追従できるようになる。
【0023】
請求項7の構成は、請求項6の構成において、状態安定度判別手段が、角速度センサの温度を検出する温度センサであり、角速度センサの温度変化が小さいほど演算に用いるサンプリング出力値の数を多く設定し、角速度センサの温度変化が大きいほど演算に用いるサンプリング出力値の数を少なく設定する補正手段を設けてあることを特徴とするものである。
【0024】
請求項7の構成によれば、角速度センサの温度を検出する温度センサで状態安定度判別手段とするものである。作業機ではエンジン、ミッションケース等の温度変化を伴う部分の横傍等に角速度センサを配置することが多く、連続作業中ではエンジンやミッションケースは一定の温度に維持される安定状態を示し、エンジン始動直後や、作業負荷に軽重があるときには温度が変化する不安定状態を示すから、角速度センサの温度変化の有無を検出する温度センサに基づいて補正手段を実行させることにより、請求項6の構成による前記作用を得ることができる。
【0025】
請求項8の構成は、請求項6の構成において、状態安定度判別手段が、メインスイッチがONされたときからの経過時間を検出する時間計測手段であり、メインスイッチONからの時間が長いほど演算に用いるサンプリング出力値の数を多く設定し、メインスイッチONからの時間が短いほど演算に用いるサンプリング出力値の数を少なく設定する補正手段を設けてあることを特徴とするものである。
【0026】
請求項8の構成によれば、メインスイッチがONされたときからの経過時間を検出する時間計測手段で判別手段とするものである。即ち、エンジン始動直後から暫くの間はエンジン(ミッションケース)温度が上昇し続ける不安定状態であり、或る程度時間が経過すればエンジン温度が所定の値に落ち着く安定状態となるから、メインスイッチONからの時間が長いほど演算に用いるサンプリング出力値の数を多くし、メインスイッチONからの時間が短いほど演算に用いるサンプリング出力値の数を少なくすることにより、請求項6の構成による前記作用を得ることができる。
【0027】
請求項9の構成は、対地作業装置をローリング自在に走行機体に連結し、前記対地作業装置を前記走行機体に対してローリング駆動するアクチュエータと、前記走行機体又は前記対地作業装置の左右傾斜角度を検出する傾斜センサと、前記走行機体又は前記対地作業装置の左右傾斜方向の角速度を検出する角速度センサとを備えるとともに、前記傾斜センサと前記角速度センサとの双方の検出値に基づいて、前記対地作業装置の左右方向姿勢が設定角度に維持されるように前記アクチュエータを作動させるローリング制御手段を設けてある作業機のセンサ零点補正装置であって、 前記角速度センサによって検出されるサンプリング出力値の複数を記憶する記憶手段と、
記憶された複数のサンプリング出力値に基づいて演算処理された平均値を零点とする制御手段と、前記角速度センサによって検出されるサンプリング出力値の複数にローパスフィルタ処理を行って零点とする制御手段とを併備した零点制御手段と、
前記走行機体の姿勢安定度の高い低いを判別する姿勢安定度判別手段とを備え、
前記走行機体の姿勢安定度が高いほど演算処理に用いるサンプリング出力値の数を少なく設定し、前記走行機体の姿勢安定度が低いほど演算処理に用いるサンプリング出力値の数を多く設定する補正手段を設けてある。
【0028】
【発明の実施の形態】
以下、本発明の実施の形態を図面に基づいて説明する。
図1は作業機の一例である農用トラクタの後部を示しており、ミッションケース3に、上下揺動自在なトップリンク1と左右一対のロアリンク2を介して、走行機体21に対してローリング自在にロータリ耕耘装置(対地作業装置の一例)4を連結してある。ミッションケース3の上部に、油圧シリンダ5により上下に揺動駆動される一対のリフトアーム6が備えられ、一対のリフトアーム6とロアリンク2とがリフトロッド7、及び複動型の油圧シリンダ8を介して連結されている。19は左右一対の駆動後輪である。
【0029】
図2に示すように、油圧シリンダ5に対する3位置切換式の制御弁16が制御装置22により操作されて、油圧シリンダ5及びリフトアーム6によりロータリ耕耘装置4が昇降駆動される。油圧シリンダ8に対する3位置切換式の制御弁17が制御装置22により操作されて、油圧シリンダ8の伸縮作動によりロータリ耕耘装置4が、油圧シリンダ8とは反対側のロアリンク2との連結点周りにローリング駆動される。
【0030】
この農用トラクタは、ロータリ耕耘装置4を地面から設定高さに維持し耕耘深さを設定値に維持する昇降制御手段29、走行機体21に対するロータリ耕耘装置4の高さを設定位置に維持するポジション制御手段30、並びに、水平面に対するロータリ耕耘装置4の左右方向の傾斜角度を設定角度に維持するローリング制御機能が、制御装置22に備えられている。
【0031】
図2及び図1に示すように、ロータリ耕耘装置4に上下揺動自在に後部カバー9が備えられ、バネ18により後部カバー9が下方側に付勢されて、ロータリ耕耘装置4に対する後部カバー9の上下揺動角度を検出する耕深センサ10が備えられており、耕深センサ10の検出値が制御装置22に入力されている。これにより昇降制御手段29によって、耕深センサ10の検出値が、走行機体21に設けられたダイヤル操作式でポテンショメータ型式の耕深設定器11の設定耕耘深さとなるように、制御弁16が操作されて、油圧シリンダ5によりロータリ耕耘装置4が自動的に昇降駆動される。
【0032】
図2及び図1に示すように、走行機体21に対するリフトアーム6の上下角度を検出する角度センサ13が、リフトアーム6の基部に備えられており、角度センサ13の検出値が制御装置22に入力されている。これによりポジション制御手段30によって、角度センサ13の検出値が走行機体21に設けられたレバー操作式のポジション設定器12の目標値となるように、制御弁16が操作されて、油圧シリンダ5によりリフトアーム6が上下に揺動駆動される。
【0033】
前述の昇降制御手段29及びポジション制御手段30において、耕深設定器11の設定耕耘深さに対応する角度センサ13の検出値と、ポジション設定器12の目標値とが比較されて、ポジション設定器12の目標値の方が高い場合、昇降制御手段29及び後述するローリング制御機能が停止して(油圧シリンダ8が停止した状態)、ポジション制御手段30が作動する。これにより、ポジション設定器12の目標値に角度センサ13の検出値が一致するように、制御弁16が操作されて、油圧シリンダ5によりロータリ耕耘装置4が昇降駆動される。従って、ポジション設定器12を操作することにより、耕深設定器11の設定耕耘深さに対応する角度センサ13の検出値よりも高い範囲で、ロータリ耕耘装置4を走行機体21に対して任意の高さに昇降駆動し停止させることができる。
【0034】
次にポジション設定器12を下降側に操作して、ポジション設定器12の目標値が、耕深設定器11の設定耕耘深さに対応する角度センサ13の検出値に一致すると(又は低くなると)、ポジション制御手段30が停止し、昇降制御手段29及びローリング制御機能が作動する。これにより、昇降制御手段によって耕深センサ10の検出値が耕深設定器11の設定耕耘深さとなるように、制御弁16が操作されて、油圧シリンダ5によりロータリ耕耘装置4が自動的に昇降駆動される。後述するようにローリング制御機能によって、水平面に対して左右方向に傾斜(又は水平面に平行)した設定角度に、水平面に対するロータリ耕耘装置4の左(右方向の傾斜角度が維持されるように、制御弁17が操作されて、油圧シリンダ8によりロータリ耕耘装置4がローリング駆動される。
【0035】
図1、図2に示すように、この農用トラクタでは、水平面に対して左右方向に傾斜(又は水平面に平行)した設定角度に、水平面に対するロータリ耕耘装置4の左右方向の傾斜角度が維持されるように、ロータリ耕耘装置4をローリング駆動するローリング制御手段24を備えてある。ロータリ耕耘装置4の左右方向の設定角度を設定するダイヤル式の傾斜設定器20を備えてあり、これは水平位置から右下り側及び左下り側に、任意に且つ連続的に設定角度を設定及び変更することができるように構成されている。
【0036】
即ち、走行機体21の左右傾斜角度を検出する重錘式の傾斜センサ15と、走行機体21の左右傾斜方向の角速度を検出する振動ジャイロ式の角速度センサ23と、油圧シリンダ8の作動位置を検出するストロークセンサ14とを備えてあり、ローリングシリンダ8の作動位置によって機体21に対するロータリ耕耘装置4の左右傾斜角度が検出できるので、傾斜センサ15と角速度センサ23との双方の検出値に基づいて、ロータリ耕耘装置4の左右方向姿勢が傾斜設定器20による設定角度に維持されるように油圧シリンダ8を作動させるローリング制御手段24を制御装置22に設けてある。
【0037】
そして、温度等の諸条件によってドリフトする角速度センサ23の基準電圧を時間経過に伴って更新して補正するセンサ零点補正装置Zを設けてある。即ち、角速度センサ23によって検出されるサンプリング出力値の複数を記憶する記憶手段25と、記憶された複数のサンプリング出力値に基づいて演算処理された平均値を基準電圧(零点)とする零点制御手段26と、走行機体21の姿勢安定度の高い低いを判別する姿勢安定度判別手段Hとを備え、走行機体21の姿勢安定度が高いほど演算処理に用いるサンプリング出力値の数を少なく設定し、走行機体21の姿勢安定度が低いほど演算処理に用いるサンプリング出力値の数を多く設定する補正手段28を設けてセンサ零点補正装置Zが構成されている。
【0038】
図2に示すように、後輪19(図1参照)と前輪31への伝動軸32の回転数を検出して、走行機体21の走行速度を検出する車速センサ27を備えてあり、この車速センサ27と、これの検出情報を処理する判別回路41によって姿勢安定度判別手段Hが構成されている。即ち、走行速度が速いほど走行機体21の姿勢安定度が低く、走行速度が遅いほど走行機体21の姿勢安定度が高いと判断されるようになっている。
【0039】
図3に、傾斜センサ15と角速度センサ23を利用した傾斜角度検出系のブロック図が示されている。図3において、第1誤差補償G1は、前記零点制御手段 26を構成するものであり、平均間隔内で発生するノイズを完全に除去するべく一定間隔平均処理と、適応LPF(ローパスフィルタ)処理とを行う。
【0040】
ここで、一定間隔平均処理は、1000Hzでサンプリングした所定時間分の所定個数のデータを足し算し、データ列aとする。そして、単位時間ごとにデータ列aの平均を計算し、データ列bとする。
【0041】
適応LPF(ローパスフィルタ)処理は、上記平均処理の度に以下の処理で基準電圧を更新し、
新基準電圧=(1秒間の平均値×α+旧基準電圧×β)÷(α+β)
十分に平滑化した基準電圧を零点として出力する。但し、α、βは条件によって可変にするものであり、例えば、メインキーON直後や温度上昇時等、基準電圧が変動し易いときはαを大きくして変動への追従性を重視し、変動が安定する条件ではαを小さくして計算の正確さを重視する。又、旋回中や大きな傾斜変化時には処理を中断し、誤った基準電圧を計算しないようにする。
【0042】
第1誤差補償G1で全ての誤差を除去することはできないので、さらにセンサの直線性にも誤差があり、積分処理による誤差の蓄積をなくすことはできない。そこで、一旦蓄積された誤差を取り除くため、傾斜設定器20で設定された目標傾斜角θに傾斜センサ15による検出傾斜角θrとの偏差をフィードバックする第2誤差補償G2を行う。ここで、フィードバック係数K2を十分に小さく設定することができれば、機体停止時にθ=θrとなって傾斜センサ15と同等の絶対精度が確保され、傾斜変化時には横揺れの影響を受けない応答性の良い傾斜角度を出力できる。逆にK2が大きいと、θrの補償が効き過ぎて傾斜センサ15の出力値と変わらなくなってしまう。
【0043】
ここでフィードバック係数K2は蓄積される誤差に応じて設定する必要があるので、精度の良いジャイロセンサを用いるほど、第1誤差補償G1を工夫するほど小さくできる。前述の処理では、0.5%程度で誤差を除去することができ、必要性能を満たすに十分小さい値である。しかし、温度変化の激しい条件や、より廉価なジャイロセンサを用いる場合、さらに大きくする必要があり、それによる性能劣化がどの程度になるか評価する必要がある。
【0044】
又、フィードバック係数K2を可変にすることも望ましい。例えば、停止中や傾斜変化の少ないときはK2を大きくして目標傾斜角θの誤差を速やかに除去し、逆に作業中や傾斜変化の激しいときはフィードバック係数K2を小さくして横揺れの影響を抑えて応答性を上げる。さらに、始動直後や温度変化の大きい等ジャイロセンサの誤差が大きくなる条件ではフィードバック係数K2を大きくして誤差の除去を重視し、温度が安定したときにはフィードバック係数K2を小さくして応答性を重視する。
【0045】
参考として、図10〜図12に、トラクタの傾斜が変化するときの各センサ15,23の検出作動テスト結果を示す。
【0046】
図10によると、走行機体の傾斜変化に対して、角速度センサ23の演算による出力は殆ど時間遅れなく変化しているのに対して、傾斜センサ15は、 0.5 秒ほどの時間遅れを伴って変化しており、かつ、傾斜が正の方向に変化を開始する時、および負の方向に変化を開始するときには慣性によって一時的に逆方向の動きとして検出していることが理解できる。尚、図10〜図11において、vは走行機体21の左右傾斜角、yは角速度センサの演算による出力、zは傾斜センサ出力である。
【0047】
図11は、図10の場合よりも傾斜変化が速い例であり、 0.5 秒間で約2度変化する時の傾斜センサ15と角速度センサ23の演算による出力の変化特性を示したものである。これによると、傾斜センサ15は、下降並びに上昇開始時に約1度逆方向に出力してしまっているとともに、昇降停止時にもオーバーシュートしている。これに対して角速度センサ23の演算による出力は、やはり走行機体の傾斜変化に追従していることが分かる。このように、傾斜センサの出力を基に するよりも角速度センサの出力を基に制御するほうが応答性でも精度でも優れていることは明らかである。
【0048】
〔別実施形態〕
センサ零点補正装置Zは、以下《1》〜《7》に記載した構成のものでも良い。
【0049】
《1》図4に示すように、姿勢安定度判別手段Hが角速度センサ23であり、補正手段28を、角速度センサ23の出力値が小さいほど角速度センサ23によるサンプリング出力値の数を少なく設定し、角速度センサ23の出力値が大きいほどサンプリング出力値の数を多く設定するものに構成する。
【0050】
《2》図5に示すように、姿勢安定度判別手段Hが傾斜センサ15であり、補正手段28は、傾斜センサ15の出力値が小さいほど角速度センサ23によるサンプリング出力値の数を少なく設定し、傾斜センサ15の出力値が大きいほどサンプリング出力値の数を多く設定するものに構成されている。
【0051】
《3》図6に示すように、姿勢安定度判別手段Hが、操向前輪31の切れ角を検出するポテンショメータ式の切れ角センサ33であり、補正手段28は、操向前輪31の切れ角が小さいほど角速度センサ23によるサンプリング出力値の数を少なく設定し、操向前輪31の切れ角が大きいほどサンプリング出力値の数を多く設定するものに構成する。
【0052】
《4》図7に示すように、角速度センサ23によって検出されるサンプリング出力値の複数にローパスフィルタ(LPF)34により上記したローパスフィルタ処理を行って零点とする零点制御手段35と、走行機体21の状態安定度の高い低いを判別する状態安定度判別手段Jとを備え、走行機体21の状態安定度が高いほどローパスフィルタ34のカットオフ周波数を低く設定し、走行機体21の状態安定度が低いほどカットオフ周波数を高く設定する補正手段36を設けてある。
【0053】
《5》図8、図9に示すように、角速度センサ23によって検出されるサンプリング出力値の複数を記憶する記憶手段25と、記憶された複数のサンプリング出力値に基づいて演算処理された平均値を零点とする零点制御手段26と、走行機体21の状態安定度の高い低いを判別する状態安定度判別手段Jとを備え、走行機体21の状態安定度が高いほどサンプリング出力値の数を多く設定し、走行機体21の状態安定度が低いほどサンプリング出力値の数を少なく設定する補正手段37を設けてある。
【0054】
《6》図8に示すように、状態安定度判別手段Jが、角速度センサ23の温度を検出する温度センサ38であり、角速度センサ23の温度変化が小さいほど角速度センサ23によるサンプリング出力値の数を多く設定し、角速度センサ23の温度変化が大きいほどサンプリング出力値の数を少なく設定する補正手段37を設けてある。
【0055】
角速度センサ23はミッションケース3から距離をおいて配置されているが、ミッションケース3の温度変化による雰囲気温度の影響を受ける。ミッションケース3の温度はエンジン温度に左右されるから、エンジン始動直後とエンジンが十分に暖気運転された後とでは、角速度センサ23の温度が明確に異なっており、それによって零点がドリフトする。又、エンジン以外にも、季節、天候、地域、地理等の種々の条件により、角速度センサ23の雰囲気温度(走行機体21の状態安定度の一例)が異なるので、その変化に伴ってサンプリング出力値の数を変更する手段である。
【0056】
《7》図9に示すように、状態安定度判別手段Jが、メインスイッチ39がONされたときからの経過時間を検出するタイマー(時間計測手段の一例)40であり、メインスイッチ39がONされてからの時間が長いほど角速度センサ23によるサンプリング出力値の数を多く設定し、メインスイッチ39がONされてからの時間が短いほどサンプリング出力値の数を少なく設定する補正手段37を設けてある。
【0057】
前述したように、エンジン温度、即ち角速度センサ23の雰囲気温度は、エンジン始動直後と暖気後で全く異なるということは、換言すれば、メインキー39のON操作(即ちエンジン始動時)からの経過時間異に伴って変化するものである。つまり、メインキー39のON操作後の経過時間が短いほど角速度センサ23の雰囲気温度は低く、経過時間が長いほど角速度センサ23の雰囲気温度は高くなるから、前述の《6》の場合と同様に、メインキー39のON操作後の経過時間の長短に伴ってサンプリング出力値の数を変更する手段である。
【0058】
《その他》対地作業装置4又は走行機体21の姿勢安定度の高い低いを判別する姿勢安定度判別手段Hの他の例としては、対地作業装置4又は機体21の前後傾斜を検出するピッチングセンサや、そのピッチングに関する角速度センサ、対地作業装置4又は機体21の上下方向に関する角速度センサ、アクセルレバー又はペダルの操作量、変速段数(位置)の高低等、種々の変更が可能である。
【0059】
対地作業装置4又は走行機体21の状態安定度の高い低いを判別する状態安定度判別手段Jの他の例としては、温度計、湿度計、高度計等、種々の変更が可能である。又、本実施形態において、対地作業装置4側に、傾斜センサ15と角速度センサ23とを配置するようにしても良い。対地作業装置4としては、耕耘装置の他、苗植付装置、直播装置、畦作成装置、整地装置等、種々の変更が可能である。
【0060】
【発明の効果】
請求項1に記載の作業機のセンサ零点補正装置では、走行機体の姿勢安定度が高いほど角速度センサによる演算処理用のサンプリング出力値の数を少なく設定し、走行機体の姿勢安定度が低いほど演算処理用のサンプリング出力値の数を多く設定する補正手段を設ける工夫により、零点の補正が小さくて済む姿勢安定度の高い状況では、零点補正が迅速に行われて追従性に優れるローリング制御が実現でき、零点の補正が大きくなる姿勢安定度の低い状況でも、正確な零点補正が可能であって精度に優れるローリング制御が実現できるようになった。
【0061】
請求項2に記載の作業機のセンサ零点補正装置では、走行速度を検出する車速センサで姿勢安定度の判別を行うことにより、走行速度が遅いときには追従性に優れるローリング制御が実現でき、走行速度が速いときでも精度に優れるローリング制御が実現できるようになった。
【0062】
請求項3に記載の作業機のセンサ零点補正装置では、対地作業装置又は走行機体のローリング角速度を検出する角速度センサで姿勢安定度の判別を行うことにより、補正のための専用のセンサが不要で経済的なものとしながら、ローリング動の遅いときには追従性に優れるローリング制御が実現でき、ローリング動の速いときでも精度に優れるローリング制御が実現できる利点がある。
【0063】
請求項4に記載の作業機のセンサ零点補正装置では、対地作業装置又は走行機体の絶対ローリング角を検出する傾斜センサで姿勢安定度の判別を行うことにより、補正のための専用のセンサが不要で経済的なものとしながら、絶対ローリング量の少ないときには追従性に優れるローリング制御が実現でき、絶対ローリング量の大きいときでも精度に優れるローリング制御が実現できる利点がある。
【0064】
請求項5に記載の作業機のセンサ零点補正装置では、操向輪の切れ角を検出する切れ角センサ姿勢安定度の判別を行うことにより、切れ角が小さいときには追従性に優れるローリング制御が実現でき、切れ角が大きいときでも精度に優れるローリング制御が実現できるようになった。
【0065】
請求項6に記載の作業機のセンサ零点補正装置では、走行機体の状態安定度が高いほどローパスフィルタのカットオフ周波数を低く設定して、角速度センサの零点を迅速に求めることができ、走行機体の状態安定度が低いほどカットオフ周波数を高く設定して、角速度センサの零点を正確に求めることが可能なローリング制御を実現することができた。
【0066】
請求項7に記載の作業機のセンサ零点補正装置では、走行機体の状態安定度が高いほど演算処理用のサンプリング出力値の数を多く設定し、走行機体の状態安定度が低いほど演算処理用のサンプリング出力値の数を少なく設定することにより、零点ドリフトが安定しているときには精度に優れた零点を求めることができ、零点ドリフト変化が大きいときにはそのドリフト変化への追従性良く零点補正が行えるようになった。
【0067】
請求項8に記載の作業機のセンサ零点補正装置では、角速度センサの温度変化の有無を検出する温度センサに基づく補正手段により、請求項7の構成による前記効果を奏することができる利点がある。
【0068】
請求項9に記載の作業機のセンサ零点補正装置では、メインスイッチONからの時間の長短に基づく補正手段により、請求項7の構成による前記効果を奏することができる利点がある。
【図面の簡単な説明】
【図1】農用トラクタ後部の構造を示す斜視図
【図2】ローリング制御の概略構造を示す機能系統図
【図3】補正制御手段の概念を示すブロック図
【図4】角速度センサに基づいて補正するローリング制御の機能系統図
【図5】傾斜センサに基づいて補正するローリング制御の機能系統図
【図6】切れ角センサに基づいて補正するローリング制御の機能系統図
【図7】ローパスフィルタ処理に基づいて補正するローリング制御の機能系統図
【図8】角速度センサの温度に基づいて補正するローリング制御の機能系統図
【図9】メインキーON後の経過時間に基づいて補正するローリング制御の機能系統図
【図10】傾斜センサと角速度センサの出力特性グラフを示す図
【図11】傾斜センサと角速度センサの出力特性グラフを示す図
【符号の説明】
4 対地作業装置
8 アクチュエータ
15 傾斜センサ
21 走行機体
23 角速度センサ
24 ローリング制御手段
25 記憶手段
26 零点制御手段
27 車速センサ
28 補正手段
31 操向輪
33 切れ角センサ
35 制御手段
36 補正手段
37 補正手段
38 温度センサ
39 メインスイッチ
40 時間計測手段
H 姿勢安定度判別手段
J 状態安定度判別手段 [0001]
BACKGROUND OF THE INVENTION
The present invention relates to a sensor zero point correction device for a work machine such as a tractor, a rice transplanter, or a straight-line machine. Specifically, the zero point of an angular velocity sensor that drifts due to changes in temperature and other conditions can be accurately detected even during operation of the work machine. It is related to the technology that can be requested.
[0002]
[Prior art]
In rolling control of ground work equipment on work machines such as tractors, work equipmentOr the aircraftIt is known that by using both an inclination sensor and an angular velocity sensor as the displacement detection means, it is possible to perform an accurate and accurate control operation with good responsiveness and no malfunction.
[0003]
That is, as disclosed in Japanese Patent Laid-Open No. 216164/1990, it is composed of a weight, a tilt sensor (low-speed reaction sensor) composed of a potentiometer for detecting the swing amount of the weight, an optical gyro, and the like. A rolling control device is configured by using both sensors of an angular velocity sensor (high-speed reaction sensor). As a result, an angular velocity sensor that is not affected by inertia and has excellent responsiveness, and an inclination sensor that compensates for the drawbacks of angular velocity sensors that cannot detect the absolute inclination angle at the time of detection, can be accurately and quickly installed without a damper or filter. In addition, the rolling control can be performed, and the ground work accuracy can be improved.
[0004]
[Problems to be solved by the invention]
That is, by integrating the angular velocity output dθj / dt by a vibration type gyro sensor or the like, it is possible to obtain a tilt angle change θj that is not affected by the roll of the sensor housing. However, since the gyro sensor can only detect a change in angle, an inclination sensor is required to detect the absolute angle.
[0005]
However, there is still a problem to be solved in the rolling control by the two types of sensors as described above. That is, the angular velocity sensor easily drifts at a zero point (reference voltage or the like) due to a temperature change or the like, and accurate rolling control cannot be performed. For example, the gyro sensor outputs the angular velocity as a deviation from the reference voltage. However, since the reference voltage includes individual differences and temperature changes, the angular velocity output dθj / dt described above always includes a large error, and the inclination angle change θj. The error is accumulated by the integration processing for obtaining the actual inclination angle, and the actual inclination angle θ shifts with time (see FIG. 3).
[0006]
In order to make the reference voltage correspond to the individual difference, a process of averaging the voltage when the aircraft is stationary and replacing it with the reference voltage may be performed. In addition, if the process is periodically performed, it is possible to cope with a temperature change. However, a work machine such as a tractor has many continuous operations and cannot secure a stationary time, and thus the processing as described above is impossible.
[0007]
The object of the present invention is to make it possible to accurately correct the zero point of an angular velocity sensor that drifts due to a temperature change or the like even in a working machine that is always in operation like a tractor, and to respond using an angular velocity sensor and an inclination sensor. It is in the point which makes it possible to substantially realize rolling control with good performance and accuracy.
[0008]
[Means for Solving the Problems]
〔Constitution〕
According to the first aspect of the present invention, the ground work device is connected to the traveling machine body so as to be able to roll freely, the actuator for rolling the ground work device with respect to the traveling machine body, and the inclination sensor for detecting the right and left inclination angle of the traveling machine body or the ground work device And an angular velocity sensor for detecting the angular velocity in the left-right tilt direction of the traveling machine body or the ground work device, and based on the detection values of both the tilt sensor and the angular speed sensor, the horizontal posture of the ground work device is set to the set angle. In the sensor zero correction device for a working machine provided with rolling control means for operating the actuator to be maintained,
Storage means for storing a plurality of sampling output values detected by the angular velocity sensor, and based on the stored sampling output valuesCalculated valueThe zero point control means with zero as the zero point and the high and low attitude stability of the traveling aircraftPosture stability determination meansAnd
The higher the attitude stability of the aircraftUsed for arithmetic processingSet a smaller number of sampling output values, the lower the attitude stability of the vehicleUsed for arithmetic processingCorrection means for setting a large number of sampling output values is provided.
[0009]
As described above, since work machines such as tractors basically travel on rough terrain, it is first impossible to average the sampling output values when stationary and obtain a precise zero point. However, although the traveling aircraft always rolls to the left and right, it does not rotate in one direction (that is, rolls over), and it always tilts back and forth while returning to a horizontal posture. However, if sampling and averaging over a time sufficiently longer than the field undulations and irregularities cycle, the output values from the left and right rolling are offset, and it is possible to obtain an almost accurate zero Was newly discovered. However, if the sampling time is too long, it becomes impossible to cope with zero point fluctuations, so it is not a good idea to increase the number of samplings.
[0010]
According to the configuration of
[0011]
The structure of
[0012]
According to the configuration of
[0013]
The structure of
[0014]
According to the configuration of
[0015]
The structure of claim 4 is the structure of
[0016]
According to the configuration of claim 4,Posture stability determination meansIs a tilt sensor, and the smaller the tilt sensor output value, the smaller or less likely to roll, that is, the posture stability is higher.Used for arithmetic processingBy reducing the number of sampling output values, the zero point of the angular velocity sensor by averaging can be quickly obtained. And the larger the output value of the tilt sensor, the larger or more likely to roll, that is, the posture stability is low.Used for arithmetic processingBy increasing the number of sampling output values, it is possible to accurately obtain the zero point of the angular velocity sensor by averaging.
[0017]
The structure of
[0018]
According to the configuration of
[0021]
Claim 6The ground work device is connected to the traveling machine body in a freely rolling manner, the actuator for rolling the ground work device with respect to the traveling machine body, the inclination sensor for detecting the right and left inclination angle of the ground work device, and the ground work device An angular velocity sensor that detects an angular velocity in the left-right inclination direction, and operates the actuator based on the detection values of both the inclination sensor and the angular velocity sensor so that the horizontal posture of the ground work device is maintained at the set angle. A sensor zero correction device for a working machine provided with a rolling control means,
Storage means for storing a plurality of sampling output values detected by the angular velocity sensor, zero-point control means for setting an average value calculated based on the plurality of stored sampling output values to zero, and state stability of the traveling machine body A state stability determining means for determining high and low of
A correction means is provided to set a larger number of sampling output values used for the calculation as the state stability of the traveling aircraft is higher, and to set a smaller number of sampling output values used for the operation as the state stability of the traveling aircraft is lower. It is characterized by.
[0022]
Claim 6According to the configuration, the higher the state stability of the traveling aircraft, the larger the number of sampling output values used for the calculation, and the lower the traveling aircraft state stability, the smaller the number of sampling output values used for the operation. Therefore, when the zero point drift is stable, the zero point can be obtained with high accuracy by using many sampling output values, and when the zero point drift change is large, the sampling output value can be decreased to follow the change. Become.
[0023]
Claim 7The configuration ofClaim 6In this configuration, the state stability determination means is a temperature sensor that detects the temperature of the angular velocity sensor, and the smaller the temperature change of the angular velocity sensor, the larger the number of sampling output values used for the calculation, and the temperature change of the angular velocity sensor A correction means for setting a smaller number of sampling output values used for calculation as the value increases is provided.
[0024]
Claim 7According to the configuration, the temperature sensor for detecting the temperature of the angular velocity sensor is used as the state stability determination means. In work machines, angular velocity sensors are often placed beside the parts of the engine, mission case, etc. that are subject to temperature changes. During continuous work, the engine and mission case show a stable state that maintains a constant temperature. Immediately after starting or when the work load is light, it shows an unstable state in which the temperature changes, so by executing the correction means based on the temperature sensor that detects the presence or absence of the temperature change of the angular velocity sensor,Claim 6The said effect | action by the structure of can be acquired.
[0025]
Claim 8The configuration ofClaim 6In this configuration, the state stability determining means is a time measuring means for detecting an elapsed time from when the main switch is turned on, and the longer the time from the main switch being turned on, the larger the number of sampling output values used for calculation. A correction means is provided for setting and setting a smaller number of sampling output values used for calculation as the time from the main switch ON is shorter.
[0026]
Claim 8According to the configuration, the time measuring means for detecting the elapsed time from when the main switch is turned on serves as the discriminating means. That is, the engine (mission case) temperature is in an unstable state that continues to rise for a while immediately after the engine is started, and after a certain amount of time has elapsed, the engine temperature becomes a stable state that settles to a predetermined value. By increasing the number of sampling output values used for calculation as the time from ON becomes longer, and by decreasing the number of sampling output values used for calculation as the time from ON of the main switch becomes shorter,Claim 6The said effect | action by the structure of can be acquired.
[0027]
Claim 9The structure of the present invention comprises a ground work device connected to a traveling machine body so as to be able to roll, an actuator for rolling the ground work device with respect to the traveling machine body, and an inclination for detecting a right and left inclination angle of the traveling machine body or the ground work device. A sensor and an angular velocity sensor that detects an angular velocity in a lateral tilt direction of the traveling machine body or the ground work device, and based on detection values of both the tilt sensor and the angular speed sensor, the left and right sides of the ground work device A working machine sensor zero correction device provided with a rolling control means for operating the actuator so that the direction and orientation are maintained at a set angle, and storing a plurality of sampling output values detected by the angular velocity sensor Means,
Control means for setting an average value calculated based on a plurality of stored sampling output values to zero, and control means for performing low pass filter processing on a plurality of sampling output values detected by the angular velocity sensor to set to zero Zero control means equipped with
Posture stability determining means for determining whether the posture stability of the traveling machine body is high or low,
Correction means for setting a smaller number of sampling output values used for calculation processing as the attitude stability of the traveling aircraft is higher, and setting a larger number of sampling output values used for arithmetic processing as the posture stability of the traveling aircraft is lower. Providedis there.
[0028]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 shows the rear part of an agricultural tractor which is an example of a work machine. The
[0029]
As shown in FIG. 2, the three-position switching
[0030]
This agricultural tractor is a position for maintaining the height of the rotary tiller 4 with respect to the traveling
[0031]
As shown in FIGS. 2 and 1, the rotary tiller 4 is provided with a
[0032]
As shown in FIGS. 2 and 1, an
[0033]
In the above-described lift control means 29 and position control means 30, the detected value of the
[0034]
Next, when the
[0035]
As shown in FIGS. 1 and 2, in this agricultural tractor, the inclination angle of the rotary tiller 4 in the horizontal direction with respect to the horizontal plane is maintained at a set angle that is inclined in the horizontal direction (or parallel to the horizontal plane) with respect to the horizontal plane. As described above, a rolling
[0036]
That is, a weight
[0037]
And the sensor zero point correction apparatus Z which updates and correct | amends the reference voltage of the
[0038]
As shown in FIG. 2, a
[0039]
FIG. 3 shows a block diagram of a tilt angle detection system using the
[0040]
Here, the regular interval averaging process was sampled at 1000 Hz.A predetermined number of data for a predetermined timeIs added to obtain a data string a. AndUnit timeEach time, the average of the data string a is calculated to be the data string b.
[0041]
The adaptive LPF (low pass filter) process updates the reference voltage by the following process every time the above average process is performed:
New reference voltage = (average value for 1 second × α + old reference voltage × β) ÷ (α + β)
Output sufficiently smoothed reference voltage as zeroDo. However, α and β are variable depending on conditions. For example, when the reference voltage is likely to fluctuate, such as immediately after the main key is turned on or when the temperature rises, α is increased so that followability to the fluctuation is emphasized. In the condition where is stable, α is made small and importance is given to the accuracy of calculation. Also, the process is interrupted during turning or when there is a large change in inclination so that an incorrect reference voltage is not calculated.
[0042]
Since all errors cannot be removed by the first error compensation G1, there is also an error in the linearity of the sensor, and accumulation of errors due to integration processing cannot be eliminated. Therefore, in order to remove the accumulated error, the second error compensation G2 is performed to feed back the deviation between the target inclination angle θ set by the
[0043]
hereFeedback factorSince K2 needs to be set according to the accumulated error, the more accurate the gyro sensor is used, the smaller the first error compensation G1 is devised. In the above-described processing, the error can be removed by about 0.5%, and the value is sufficiently small to satisfy the required performance. However, when the temperature changes drastically or when a cheaper gyro sensor is used, it is necessary to further increase the size, and it is necessary to evaluate how much the performance deterioration is caused by it.
[0044]
or,Feedback factorIt is also desirable to make K2 variable. For example, when stopping or when there is little change in inclination, K2 is increased to quickly remove the error in the target inclination angle θ.Feedback factorDecrease K2 to suppress the influence of roll and increase responsiveness. In addition, under conditions where the error of the gyro sensor becomes large, such as immediately after start-up or a large temperature change.Feedback factorWhen K2 is increased, emphasis is placed on removing errors, and when the temperature stabilizesFeedback factorEmphasize responsiveness by reducing K2.
[0045]
As reference,10 to 12 show the detection operation test results of the
[0046]
According to FIG. 10, the output from the calculation of the
[0047]
11 is more than the case of FIG.This is an example of a rapid change in slope. 0.5 The change characteristic of the output by the calculation of the
[0048]
[Another embodiment]
The sensor zero point correcting device Z may be configured as described in << 1 >> to << 7 >> below.
[0049]
<< 1 >> As shown in FIG.Posture stability determination means HIs the
[0050]
<< 2 >> As shown in FIG.Posture stability determination means HIs the
[0051]
<3> As shown in FIG.Posture stability determination means HIs a potentiometer-type
[0052]
<< 4 >> As shown in FIG. 7, a plurality of sampling output values detected by the angular velocity sensor 23The low pass filter (LPF) 34 described aboveIt is determined whether the zero point control means 35 which performs low pass filter processing and sets the zero point and the state stability of the traveling
[0053]
<< 5 >> As shown in FIGS. 8 and 9, storage means 25 for storing a plurality of sampling output values detected by the
[0054]
<< 6 >> As shown in FIG.State stability determination means JIs a
[0055]
The
[0056]
<< 7 >> As shown in FIG.State stability determination means JIs a timer (an example of a time measuring means) 40 that detects an elapsed time from when the
[0057]
As described above, the engine temperature, that is, the atmospheric temperature of the
[0058]
<< Others >> It is determined whether the attitude stability of the ground work device 4 or the traveling
[0059]
It is determined whether the state stability of the ground work device 4 or the traveling
[0060]
【The invention's effect】
In the sensor zero correction device for a working machine according to
[0061]
In the sensor zero correction device for a work machine according to
[0062]
In the sensor zero-point correction device for a work machine according to
[0063]
In the working machine sensor zero point correction device according to claim 4, the posture stability is determined by the inclination sensor that detects the absolute rolling angle of the ground working device or the traveling machine body, so that a dedicated sensor for correction is unnecessary. In addition, the rolling control with excellent followability can be realized when the absolute rolling amount is small, and the rolling control with excellent accuracy can be realized even when the absolute rolling amount is large.
[0064]
In the sensor zero-point correction device for a work machine according to
[0065]
In the sensor zero correction device for a work machine according to
[0066]
In the sensor zero correction device for a working machine according to
[0067]
According to the eighth aspect of the present invention, there is an advantage that the effect of the configuration according to the seventh aspect can be achieved by the correction means based on the temperature sensor that detects the presence or absence of the temperature change of the angular velocity sensor.
[0068]
In the sensor zero-point correcting device for a work machine according to a ninth aspect, there is an advantage that the effect of the configuration according to the seventh aspect can be achieved by the correcting means based on the length of time from the main switch ON.
[Brief description of the drawings]
FIG. 1 is a perspective view showing a structure of a rear portion of an agricultural tractor.
FIG. 2 is a functional system diagram showing a schematic structure of rolling control.
FIG. 3 is a block diagram showing the concept of correction control means.
FIG. 4 is a functional system diagram of rolling control that is corrected based on an angular velocity sensor.
FIG. 5 is a functional system diagram of rolling control that is corrected based on an inclination sensor.
FIG. 6 is a functional system diagram of rolling control that is corrected based on a cutting angle sensor.
FIG. 7 is a functional system diagram of rolling control for correction based on low-pass filter processing.
FIG. 8 is a functional system diagram of rolling control for correcting based on the temperature of the angular velocity sensor.
FIG. 9 is a functional system diagram of rolling control for correcting based on the elapsed time after the main key is turned on.
FIG. 10 is a graph showing output characteristic graphs of an inclination sensor and an angular velocity sensor.
FIG. 11 is a graph showing output characteristic graphs of an inclination sensor and an angular velocity sensor.
[Explanation of symbols]
4 Ground working equipment
8 Actuator
15 Tilt sensor
21 Traveling aircraft
23 Angular velocity sensor
24 Rolling control means
25 Memory means
26 Zero point control means
27 Vehicle speed sensor
28 Correction means
31 Steering wheel
33 Cutting angle sensor
35 Control means
36 Correction means
37 Correction means
38 Temperature sensor
39 Main switch
40 hour measuring means
HPosture stability determination means
JState stability determination means
Claims (9)
前記角速度センサによって検出されるサンプリング出力値の複数を記憶する記憶手段と、記憶された複数のサンプリング出力値に基づいて演算処理された平均値を零点とする零点制御手段と、前記走行機体の姿勢安定度の高い低いを判別する姿勢安定度判別手段とを備え、
前記走行機体の姿勢安定度が高いほど演算処理に用いるサンプリング出力値の数を少なく設定し、前記走行機体の姿勢安定度が低いほど演算処理に用いるサンプリング出力値の数を多く設定する補正手段を設けてある作業機のセンサ零点補正装置。An actuator for connecting the ground work device to a traveling machine body so as to be able to roll freely, the actuator for rolling the ground work device with respect to the traveling machine body, an inclination sensor for detecting a right and left inclination angle of the traveling machine body or the ground work device, An angular velocity sensor that detects an angular velocity in a lateral tilt direction of the traveling machine body or the ground work device, and a lateral orientation of the ground work device is set based on detection values of both the tilt sensor and the angular velocity sensor. A sensor zero correction device for a working machine provided with a rolling control means for operating the actuator so as to be maintained at an angle,
Storage means for storing a plurality of sampling output values detected by the angular velocity sensor, zero point control means for setting an average value calculated based on the stored sampling output values to zero, and the attitude of the traveling machine body Posture stability determining means for determining high and low stability,
Correction means for setting a smaller number of sampling output values used for calculation processing as the attitude stability of the traveling aircraft is higher, and setting a larger number of sampling output values used for arithmetic processing as the posture stability of the traveling aircraft is lower. A sensor zero correction device for a working machine provided.
前記角速度センサによって検出されるサンプリング出力値の複数を記憶する記憶手段と、記憶された複数のサンプリング出力値に基づいて演算処理された平均値を零点とする零点制御手段と、前記走行機体の状態安定度の高い低いを判別する状態安定度判別手段とを備え、
前記走行機体の状態安定度が高いほど演算処理に用いる前記サンプリング出力値の数を多く設定し、前記走行機体の状態安定度が低いほど演算処理に用いる前記サンプリング出力値の数を少なく設定する補正手段を設けてある作業機のセンサ零点補正装置。An actuator for connecting the ground work device to a traveling machine body so as to be able to roll freely, the actuator for rolling the ground work device with respect to the traveling machine body, an inclination sensor for detecting a right and left inclination angle of the traveling machine body or the ground work device, An angular velocity sensor that detects an angular velocity in a lateral tilt direction of the traveling machine body or the ground work device, and a lateral orientation of the ground work device is set based on detection values of both the tilt sensor and the angular velocity sensor. A sensor zero correction device for a working machine provided with a rolling control means for operating the actuator so as to be maintained at an angle,
Storage means for storing a plurality of sampling output values detected by the angular velocity sensor, zero point control means for setting an average value calculated based on the stored sampling output values to zero, and the state of the traveling machine body A state stability determining means for determining high and low stability,
A correction for setting the number of sampling output values used for calculation processing to be higher as the state stability of the traveling aircraft is higher, and setting a smaller number of sampling output values to be used for calculation processing as the state stability of the traveling aircraft is lower. A sensor zero correction device for a working machine provided with means.
記憶された複数のサンプリング出力値に基づいて演算処理された平均値を零点とする制御手段と、前記角速度センサによって検出されるサンプリング出力値の複数にローパスフィルタ処理を行って零点とする制御手段とを併備した零点制御手段と、
前記走行機体の姿勢安定度の高い低いを判別する判別手段とを備え、
前記走行機体の姿勢安定度が高いほど演算処理に用いるサンプリング出力値の数を少なく設定し、前記走行機体の姿勢安定度が低いほど演算処理に用いるサンプリング出力値の数を多く設定する補正手段を設けてある作業機のセンサ零点補正装置。An actuator for connecting the ground work device to a traveling machine body so as to be able to roll freely, the actuator for rolling the ground work device with respect to the traveling machine body, an inclination sensor for detecting a right and left inclination angle of the traveling machine body or the ground work device, An angular velocity sensor that detects an angular velocity in a lateral tilt direction of the traveling machine body or the ground work device, and a lateral orientation of the ground work device is set based on detection values of both the tilt sensor and the angular velocity sensor. A sensor zero correction device for a working machine provided with a rolling control means for operating the actuator so as to be maintained at an angle, and storing means for storing a plurality of sampling output values detected by the angular velocity sensor;
Control means for setting an average value calculated based on a plurality of stored sampling output values to zero, and control means for performing low pass filter processing on a plurality of sampling output values detected by the angular velocity sensor to set to zero Zero control means equipped with
A discriminating means for discriminating whether the attitude stability of the traveling machine body is high or low,
Correction means for setting a smaller number of sampling output values used for calculation processing as the attitude stability of the traveling aircraft is higher, and setting a larger number of sampling output values used for arithmetic processing as the posture stability of the traveling aircraft is lower. A sensor zero correction device for a working machine provided.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001038332A JP3717411B2 (en) | 2001-02-15 | 2001-02-15 | Sensor zero correction device for work equipment |
KR10-2002-0007847A KR100453266B1 (en) | 2001-02-15 | 2002-02-14 | Sensor calibration device for working vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2001038332A JP3717411B2 (en) | 2001-02-15 | 2001-02-15 | Sensor zero correction device for work equipment |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2002243449A JP2002243449A (en) | 2002-08-28 |
JP3717411B2 true JP3717411B2 (en) | 2005-11-16 |
Family
ID=18901325
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2001038332A Expired - Lifetime JP3717411B2 (en) | 2001-02-15 | 2001-02-15 | Sensor zero correction device for work equipment |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP3717411B2 (en) |
KR (1) | KR100453266B1 (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4500644B2 (en) * | 2004-10-01 | 2010-07-14 | 三菱農機株式会社 | Inclination automatic control device for work vehicle |
CN103592093B (en) * | 2013-11-19 | 2015-11-18 | 中联重科股份有限公司 | Fire fighting truck boom tail end vibration measurement device, method and system and fire fighting truck |
CN110132470B (en) * | 2019-05-14 | 2024-06-18 | 安徽农业大学 | Power loss detection device for cultivator and detection method thereof |
CN112325994A (en) * | 2020-11-04 | 2021-02-05 | 合肥科迈捷智能传感技术有限公司 | Automatic correction method for zero offset of differential pressure flowmeter |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2919096B2 (en) * | 1991-01-31 | 1999-07-12 | ヤンマー農機株式会社 | Sensor zero compensation device for attitude control |
JP2806730B2 (en) * | 1993-04-06 | 1998-09-30 | 株式会社クボタ | Correction method for zero error of torque sensor |
JPH10178806A (en) * | 1998-01-27 | 1998-07-07 | Yanmar Agricult Equip Co Ltd | Sensor-for-posture-control zero point compensation controller in farm work machine |
JP2905468B2 (en) * | 1998-01-27 | 1999-06-14 | ヤンマー農機株式会社 | Sensor zero point compensation controller for attitude control in agricultural work machines |
-
2001
- 2001-02-15 JP JP2001038332A patent/JP3717411B2/en not_active Expired - Lifetime
-
2002
- 2002-02-14 KR KR10-2002-0007847A patent/KR100453266B1/en active IP Right Grant
Also Published As
Publication number | Publication date |
---|---|
JP2002243449A (en) | 2002-08-28 |
KR100453266B1 (en) | 2004-10-15 |
KR20020067642A (en) | 2002-08-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3717411B2 (en) | Sensor zero correction device for work equipment | |
JP3797881B2 (en) | Rolling control device for work equipment | |
JP3568597B2 (en) | Mobile farm machine tilt detection device | |
JP3797902B2 (en) | Tractor depth control device | |
JP3688211B2 (en) | Rolling control device for work equipment | |
JP3497481B2 (en) | Work machine rolling control device | |
JP3838319B2 (en) | Horizontal control device | |
JP4624969B2 (en) | Agricultural machine rolling control device | |
JP3949078B2 (en) | Agricultural machine rolling control device | |
JP3838320B2 (en) | Horizontal control device | |
JP3838959B2 (en) | Agricultural machine rolling control device | |
JP3669947B2 (en) | Rolling control device for work equipment | |
JP3763835B2 (en) | Inclination detector for mobile agricultural machines | |
JP4183693B2 (en) | Inclination control device for work equipment | |
JP3870611B2 (en) | Horizontal control device | |
JP3880538B2 (en) | Farm machine control device | |
JP3916555B2 (en) | Agricultural machine rolling control device | |
JPH07274631A (en) | Controlling device for rice planter | |
JP2869309B2 (en) | Rice transplanter | |
JP2984107B2 (en) | Attitude control device for agricultural work machine | |
JP2675210B2 (en) | Rolling control device for ground work machine | |
JP2866558B2 (en) | Elevation control mechanism of rice transplanter | |
JP3721855B2 (en) | Horizontal control device | |
JP2886056B2 (en) | Elevation control mechanism of rice transplanter | |
JP4594922B2 (en) | Agricultural machine rolling control device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20041015 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050203 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050325 |
|
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: 20050818 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050830 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 3717411 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090909 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090909 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100909 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110909 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120909 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120909 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130909 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130909 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140909 Year of fee payment: 9 |
|
EXPY | Cancellation because of completion of term |