JP3932704B2 - Position control device for work vehicle - Google Patents
Position control device for work vehicle Download PDFInfo
- Publication number
- JP3932704B2 JP3932704B2 JP34580398A JP34580398A JP3932704B2 JP 3932704 B2 JP3932704 B2 JP 3932704B2 JP 34580398 A JP34580398 A JP 34580398A JP 34580398 A JP34580398 A JP 34580398A JP 3932704 B2 JP3932704 B2 JP 3932704B2
- Authority
- JP
- Japan
- Prior art keywords
- work
- sensor
- lift
- control
- work implement
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000001514 detection method Methods 0.000 claims description 19
- 230000005856 abnormality Effects 0.000 claims description 12
- 230000000630 rising effect Effects 0.000 claims description 8
- 230000002159 abnormal effect Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 description 6
- 230000005540 biological transmission Effects 0.000 description 4
- 238000000034 method Methods 0.000 description 4
- 210000000078 claw Anatomy 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 239000002689 soil Substances 0.000 description 3
- 230000001174 ascending effect Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 239000010720 hydraulic oil Substances 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 230000009194 climbing Effects 0.000 description 1
- 230000008602 contraction Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000000452 restraining effect Effects 0.000 description 1
- 238000003971 tillage Methods 0.000 description 1
Images
Landscapes
- Lifting Devices For Agricultural Implements (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【0001】
【発明の属する技術分野】
本発明は農業用、建設用、運搬用等の作業車両に於けるポジション制御装置に関するものであり、特に、ポジション制御の牽制を解除するタイミングに関するものである。
【0002】
【従来の技術及び発明が解決しようとする課題】
従来、トラクタをはじめとする作業車両には、車体に対して昇降自在に作業機を連結し、該作業機の昇降位置を検出するセンサと、該作業機の昇降操作を行うポジションレバーの設定値を検出するセンサを設け、前記双方のセンサの計測値が一致するようにアクチュエータを駆動して作業機を昇降させるポジション制御装置を備えたものが知られている。
【0003】
ここで、エンジンの停止後にポジションレバーが誤操作されると、エンジンの始動時に作業機が不慮昇降して危険であるため、車体のエンジン始動スイッチをオンしたときは、前記作業機昇降用のアクチュエータの駆動を禁止する牽制装置を設けた作業車両も知られている。
【0004】
そして、前記牽制装置の作動を解除するには、例えば、エンジン始動時に作業機の昇降位置を検出するセンサの計測値とポジションレバーの設定値を検出するセンサの計測値とが不一致のときは、オペレータが意識的にポジションレバーを操作することによって双方のセンサの計測値が一致したときに、前記牽制装置の作動を解除して作業機昇降用のアクチュエータの駆動を可能にする。或いは、エンジン始動時に双方のセンサの計測値が一致しているときは、ポジションレバーの操作により双方のセンサの計測値が所定値以上相違したときに、前記牽制装置の作動を解除するようにしている。
【0005】
しかし、各センサの分解能が高くなると、車体の振動等でセンサの計測値が小刻みに変動しやすくなり、ポジションレバーを操作しなくても、オペレータの意識に反して牽制装置の作動が解除されることがある。
【0006】
そこで、車体のエンジン始動時に作業機昇降用のアクチュエータの駆動を禁止する牽制装置を設けた作業車両に於いて、牽制装置の作動を解除するタイミングを改善して確実な牽制解除を実行するために解決すべき技術的課題が生じてくるのであり、本発明はこの課題を解決することを目的とする。
【0007】
【課題を解決するための手段】
本発明は上記目的を達成するために提案されたものであり、車体に対して昇降自在に作業機(16)を連結し、該作業機(16)の昇降位置を設定するポジションレバー(31)を設けるとともに、ポジションレバー(31)の設定値を検出するセンサ(40)と、該作業機(16)の昇降位置を検出するセンサ(23)と、前記双方のセンサの計測値が一致するように作業機(16)を昇降させるアクチュエータ(22)とからなるポジション制御装置を備え、更に、車体のエンジン始動スイッチ(34)をオンしたときは、前記作業機昇降用のアクチュエータ(22)の駆動を禁止する牽制装置を設けた作業車両(10)に於いて、
前記双方のセンサの計測値が一致する設定点(A)を中心としてその上方に所定範囲の上部制限領域(+B)を設けるとともに、その下方に上部制限領域と同一幅の下部制限領域(−B)を設け、前記牽制装置が作動して作業機(16)昇降用のアクチュエータ(22)の駆動を禁止しているときに、ポジションレバー(31)の設定値を検出するセンサ(40)の計測値が前記設定点(A)若しくは上部または下部何れか一方の制限領域内にあり、該センサ(40)の計測値が前記設定点(A)から上部または下部何れか一方の制限領域を通過して制限領域の外へでたとき、若しくは上部または下部何れか一方の制限領域内から他方の制限領域を通過して制限領域の外へでたときは、前記牽制装置の作動を解除するように構成し、
前輪(38)の前輪切れ角センサ(39)の検出信号に異常がなければ車体が旋回時に作業機(16)を自動的に上昇させるオートリフト制御を継続し、前輪切れ角センサ(39)の検出信号に異常があったときは、耕深量を検出するデプスセンサ(25)の検出値により作業機(16)後部のリヤカバー(24)の位置を算出しながら作業機(16)を上昇させ、リヤカバー(24)が最下端位置になったときに、前記電磁制御弁(51)への制御信号を停止、即ち、作業機(16)の昇降用リフトシリンダの駆動を停止するとともに、牽制装置の作動並びに作動解除後のルーチンを経て、ポジション制御へ移行し、該牽制装置は前記前輪切れ角センサ(39)の異常発生時の外に、デプスセンサ(25)による耕深制御モードから、プラウ作業機を連結して別のモードに切換える作業機制御モードの変更がある場合にも制御する構成と成し、
前記オートリフト制御で作業機(16)を上昇させる場合、作業機上昇開始初期から一定の高さに至るまでは、作業機の上昇速度の1/2程度にし、作業機(16)が一定の高さ以上に上昇した後は、作業機(16)の上昇速度を通常速度に変更するように構成し、
更に、作業機昇降レバー(36)の操作により手動によって作業機(16)を上昇させる場合は、作業機(16)の上昇開始初期から一定の高さに至るまでの上昇速度を、オートリフト制御の場合に比べて遅く設定する構成と成した作業車両に於けるポジション制御装置を提供するものである。
【0008】
【発明の実施の形態】
以下、本発明の一実施の形態を図面に従って詳述する。図1は作業車両の一例としてトラクタ10を示し、エンジン11の動力はミッションケース12内に収められたギヤ式変速装置13を介して後輪14へ伝達される。車体の後部にはリンク機構15を介してロータリ作業機16が連結されており、エンジン11の動力を前記ギヤ式変速装置13にて分岐し、PTO取出部17からロータリ作業機16へ伝達している。
【0009】
前記リンク機構15はアッパリンク18と左右のロワリンク19,19とからなり、ミッションケース12の後上部に回動可能に設けられた左右のリフトアーム20,20の先端部と左右のロワリンク19,19とが、夫々リフトロッド21,21を介して連結されている。そして、ミッションケース12の上部に作業機を昇降させるアクチュエータであるリフトシリンダ22を内蔵し、該リフトシリンダ22の伸縮により、前記リフトアーム20,20が上下に回動すれば、リフトロッド21,21を介してロワリンク19,19が上下動する。斯くして、該リンク機構15の回動支点であるロワリンク19,19の先端部を回動中心にして、前記ロータリ作業機16が昇降する。
【0010】
リフトアーム20の回動基部には、作業機の昇降位置を検出するセンサとしてリフトアーム角センサ23が設けられ、このリフトアーム角センサ23にてリフトアーム20の回動角を検出し、ロータリ作業機16の昇降高さを演算する。また、ロータリ作業機16のリヤカバー24の回動基部には、耕深量を検出する手段としてデプスセンサ25が設けられ、このデプスセンサ25にてリヤカバー24の角度を検出して耕耘爪26の耕深量を演算する。
【0011】
一方、運転席30の近くには、作業機の昇降位置を設定するポジションレバー31や変速レバー32等の各種操作レバーと、耕深設定器33やエンジン始動スイッチ34等の各種スイッチが配置されている。また、運転席30の前方には車体の操舵操作部であるステアリングハンドル35が設けられ、該ステアリングハンドル35の近傍位置に作業機昇降レバー36を設けてある。
【0012】
前記、ステアリングハンドル35の回転操作は操舵装置37へ伝達され、操舵量に応じて前輪38が回向する。前輪38の操舵量は前輪切れ角センサ39によって検出される。また、前記作業機昇降レバー36を操作することにより、ロータリ作業機16をワンタッチで所定位置まで上昇若しくは下降できるよう形成してある。
【0013】
図2はポジション制御系のブロック図であり、ポテンショメータ等にて構成されたポジションセンサ40により前記ポジションレバー31の設定値を検出し、昇降スイッチ41のオンオフにより前記作業機昇降レバー36の上げ下げを検出する。これらの検出信号はコントローラ50へ入力される。また、エンジン始動スイッチ34のオンオフ信号もコントローラ50へ入力される。
【0014】
一方、コントローラ50では、リフトアーム角センサ23の検出信号にて車体に連結したロータリ作業機16の昇降位置を演算し、デプスセンサ25の検出信号にてロータリ作業機16の耕深量を演算する。また、前輪切れ角センサ39の検出信号にてステアリングハンドル35の操作に伴う前輪38の操舵量を演算し、車体が旋回動作に入ったか否かを判別する。
【0015】
更に、コントローラ50は、前記ポジションセンサ40の設定値に基づいて電磁制御弁51へ制御信号を出力し、リフトシリンダ22を駆動してリフトアーム20の回動角を調整することにより、ポジションレバー31が設定した位置までロータリ作業機16を昇降させる。ロータリ作業機16の昇降位置は前記リフトアーム角センサ23にて計測し、前記ポジションセンサ40の計測値とリフトアーム角センサ23の計測値が一致するまでリフトシリンダ22を駆動する。双方のセンサ23,40の計測値が一致したときは、リフトシリンダ22の駆動を停止する。
【0016】
ここで、図3のフローチャートに示すように、車体のエンジン11が停止している状態からエンジン始動スイッチ34をオンしたときは、先ず各種スイッチやセンサ等の状態をコントローラ50へ読み込み(ステップ1)、作業機昇降用のアクチュエータの駆動を禁止する牽制装置を作動させる(ステップ2)。即ち、エンジン11の始動時に作業機が不慮昇降すると危険であるため、エンジン始動スイッチ34をオンしたときは各種スイッチやセンサ等の状態に拘らず、前記リフトシリンダ22の電磁制御弁51には制御信号を出力しない。
【0017】
そして、次に述べるような牽制解除操作があるまでは牽制を継続し(ステップ3)、牽制解除操作があったときは牽制装置の作動を解除して(ステップ4)、ポジション制御を実行する(ステップ5)。尚、後述するように、オートリフト制御の際に前輪切れ角センサの異常を検出して作業機上昇出力を停止した後には、上記ステップ2へ戻り、牽制装置の作動並びに作動解除のルーチンを経て、ポジション制御へ移行する。
【0018】
図4は牽制解除操作の一例を示し、前記ポジションセンサ40の計測値とリフトアーム角センサ23の計測値が一致する設定点(A)を中心として、その上方に所定範囲の上部制限領域(+B)を設けるとともに、その下方に上部制限領域と同一幅の下部制限領域(−B)を設けておく。この制限領域はセンサが計測した電圧値の変動幅で規定し、例えば2bit(2/1024×5ボルト)程度の変動幅とする。
【0019】
いま、図4(a)に示すように、前記牽制装置が作動してリフトシリンダ22の駆動を禁止しているときに、リフトアーム角センサ23の計測値が設定点(A)にあり、ポジションセンサ40の計測値(C1)が上部制限領域(+B)の外にある場合は、オペレータが意識的にポジションレバー31を操作して、ポジションセンサ40の計測値(C1)が上部制限領域(+B)の外から上部制限領域(+B)を通過して下部制限領域(−B)に入ったときは、牽制解除操作を行ったものとみなす。
【0020】
また、図4(b)に示すように、リフトアーム角センサ23の計測値が設定点(A)にあり、ポジションセンサ40の計測値(C2)が下部制限領域(−B)の外にある場合は、オペレータが意識的にポジションレバー31を操作して、ポジションセンサ40の計測値(C2)が下部制限領域(−B)の外から下部制限領域(−B)を通過して上部制限領域(+B)に入ったときは、牽制解除操作を行ったものとみなす。
【0021】
一方、図4(c)に示すように、リフトアーム角センサ23の計測値が設定点(A)にあり、ポジションセンサ40の計測値(C3)が上部制限領域(+B)にある場合は、オペレータが意識的にポジションレバー31を操作して、ポジションセンサ40の計測値(C3)が上部制限領域(+B)から下部制限領域(−B)を通過して下部制限領域(−B)の外へ出たときは、牽制解除操作を行ったものとみなす。
【0022】
また、図4(d)に示すように、リフトアーム角センサ23の計測値が設定点(A)にあり、ポジションセンサ40の計測値(C4)が下部制限領域(−B)にある場合は、オペレータが意識的にポジションレバー31を操作して、ポジションセンサ40の計測値(C4)が下部制限領域(−B)から上部制限領域(+B)を通過して上部制限領域(+B)の外へ出たときは、牽制解除操作を行ったものとみなす。
【0023】
更に、図4(e)に示すように、リフトアーム角センサ23の計測値が設定点(A)にあり、ポジションセンサ40の計測値(C5)が設定点(A)と一致している場合は、オペレータが意識的にポジションレバー31を操作して、ポジションセンサ40の計測値(C5)が上部制限領域(+B)を通過して上部制限領域(+B)の外へ出たとき、若しくは、ポジションセンサ40の計測値(C5)が下部制限領域(−B)を通過して下部制限領域(−B)の外へ出たときは、牽制解除操作を行ったものとみなす。
【0024】
このように、牽制解除操作の条件を定めたことにより、確実にポジション制御の牽制解除操作を行うことができ、センサの計測値変動等に起因するオペレータの意識に反する牽制解除を防止できる。
【0025】
図5は車体旋回時に作業機を自動的に上昇させるオートリフト制御のフローチャートを示し、前輪切れ角センサ39の検出信号の変化により車体が旋回動作に入ったとコントローラ50が判断したときは、前記電磁制御弁51へ制御信号を出力してリフトシリンダ22を駆動し、ロータリ作業機16を上昇する(ステップ101〜103)。
【0026】
いま、前輪切れ角センサ39の検出信号に異常がなければオートリフト制御を継続し(ステップ104→リターン)、前輪切れ角センサ39の検出信号に異常があったときは、デプスセンサ25の検出値によりリヤカバー24の位置を算出しながらロータリ作業機16を上昇させ(ステップ104〜105)、リヤカバー24が最下端位置になったときに、前記電磁制御弁51への制御信号を停止する(ステップ105〜106)。即ち、ロータリ作業機16が地面から離間したときにリフトシリンダ22の駆動を停止するので、耕耘爪26が土中で回転したまま車体が旋回することはない。従って、前輪切れ角センサ39に異常が発生してオートリフトを中段した場合であっても、ロータリ作業機16を地面から完全に浮上させた状態で旋回するため、機械の破損を防止できる。
【0027】
ステップ104に於ける前輪切れ角センサ39の異常とは、例えば前輪切れ角センサ39の検出信号が通常ではステアリングハンドル35の回転操作に応じて0〜5Vの間で変化する場合に、数msecの僅かな時間で検出信号が0Vまたは5Vになったときをいい、然るときは、ケーブルの断線やセンサ自体の故障とみなして、作業機上昇出力を中断する。
【0028】
而して、ステップ106にて作業機上昇出力を停止した後には、図3に示したフローチャートに於けるステップ2へジャンプし、牽制装置の作動並びに作動解除のルーチンを経て、ポジション制御へ移行する。尚、図3にて説明した牽制装置は、上述した前輪切れ角センサ39の異常発生時の外に、例えば前記デプスセンサ25による耕深制御モードから、プラウ作業機を連結してドラフトセンサによるドラフト制御モードに切換えたとき等、作業機の制御モードの変更があったときにも、改めて牽制装置が作動する構成となっている。
【0029】
また、図6のフローチャートに示すように、車体の旋回時にオートリフト制御にて作業機を上昇させる場合、作業機の高さによって作業機上昇速度を変化させる(ステップ201〜203)。ロータリ作業機16の上昇開始初期から一定の高さに至るまでは(ステップ204〜205)、前記リフトシリンダ22へ供給する作動油の流量を抑えて、ロータリ作業機16の上昇速度を通常の1/2程度にする(ステップ206)。そして、ロータリ作業機16が一定の高さ以上に上昇した後には、リフトシリンダ22へ供給する作動油の流量を増加して、ロータリ作業機16の上昇速度を通常速度に変更する(ステップ207)。
【0030】
このように、上昇初期速度をやや遅くすることにより、リヤカバー24が耕耘爪26後方の土をへこみ部分へ寄せやすくなり、ロータリ作業機16の切り上げ時に於ける仕上げが良好となる。
【0031】
尚、前記作業機昇降レバー36の操作によってロータリ作業機16を上昇する場合は、オートリフト制御のように作業機の引きずりを問題にしないため、ロータリ作業機16の上昇開始初期から一定の高さに至るまでの上昇速度を、更に遅く設定してもよい。
【0032】
尚、本発明は、本発明の精神を逸脱しない限り種々の改変を為すことができ、そして、本発明が該改変されたものに及ぶことは当然である。
【0033】
【発明の効果】
本発明は上記一実施の形態に詳述したように、予めポジションレバーの設定値を検出するセンサの計測値と、作業機の昇降位置を検出するセンサの計測値とが一致する設定点を中心として、その上方に上部制限領域を設けるとともに、その下方に下部制限領域を設けておく。車体のエンジン始動スイッチをオンして牽制装置が作動し、作業機昇降用のアクチュエータの駆動を禁止しているとき、ポジションレバーの設定値を検出するセンサの計測値が前記設定点若しくは上部または下部何れか一方の制限領域内にあり、該センサの計測値が前記設定点から上部または下部何れか一方の制限領域を通過して制限領域の外へでたとき、若しくは上部または下部何れか一方の制限領域内から他方の制限領域を通過して制限領域の外へでたときは、前記牽制装置の作動を解除するように構成したので、確実にポジション制御の牽制解除操作を行うことができ、センサの計測値変動等に起因するオペレータの意識に反する牽制解除を防止できる。
また、上記前輪(38)の前輪切れ角センサ(39)の検出信号に異常がなければオートリフト制御を継続し、前輪切れ角センサ(39)の検出信号に異常があったときは、 耕深量を検出するデプスセンサ(25)の検出値によりリヤカバー(24)の位置を算出しながら作業機(16)を上昇させ、リヤカバー(24)が最下端位置になったときに、前記電磁制御弁(51)への制御信号を停止、即ち、作業機(16)の昇降用リフトシリンダの駆動を停止するので、前輪切れ角センサに異常が発生してオートリフトを中段した場合であっても、ロータリ作業機を地面から完全に浮上させた状態で旋回するため、機械の破損を防止することができる。
そして、上記オートリフト制御で作業機(16)を上昇させる場合、作業機上昇開始初期から一定の高さに至るまでは、作業機の上昇速度の1/2程度にし、作業機16が一定の高さ以上に上昇した後は、作業機16の上昇速度を通常速度に変更するように構成したので、上昇初期速度をやや遅くすることにより、リヤカバーが耕耘爪後方の土をへこみ部分へ寄せやすくなり、ロータリ作業機の切り上げ時に於ける仕上げが良好となる。
更に、上記作業機昇降レバー(36)の操作により手動によって作業機(16)を上昇させる場合は、作業機(16)の上昇開始初期から一定の高さに至るまでの上昇速度を、オートリフト制御の場合に比べて遅く設定する構成と成したので、作業機昇降レバーの手動操作に於いてはオートリフト制御のように作業機の引きずりを問題にしないために、上昇開始初期から一定の高さに至るまでの上昇速度を更に遅く設定してもよいものとなる。
【図面の簡単な説明】
図は本発明の一実施の形態を示すものである。
【図1】トラクタの側面図。
【図2】ポジション制御系のブロック図。
【図3】牽制装置の作動解除の手順を説明するフローチャート。
【図4】(a)乃至(e)は夫々牽制解除操作の一例を示す解説図。
【図5】オートリフト制御にて作業機を上昇させる手順を示すフローチャート。
【図6】作業機を上昇させる際に上昇速度を変化させる手順を示すフローチャート。
【符号の説明】
10 トラクタ
16 ロータリ作業機
22 リフトシリンダ
23 リフトアーム角センサ
31 ポジションレバー
34 エンジン始動スイッチ
40 ポジションスイッチ
50 コントローラ
51 電磁制御弁[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a position control device in a work vehicle for agriculture, construction, transportation, and the like, and particularly relates to a timing for releasing the restraint of position control.
[0002]
[Prior art and problems to be solved by the invention]
Conventionally, a work machine such as a tractor is connected to a work machine so as to be movable up and down with respect to a vehicle body, a sensor for detecting a lift position of the work machine, and a setting value of a position lever for performing the lift operation of the work machine. There is known a sensor provided with a position control device that provides a sensor for detecting the movement and drives the actuator so that the measured values of both the sensors coincide with each other to raise and lower the work implement.
[0003]
Here, if the position lever is mistakenly operated after the engine is stopped, the work implement will inadvertently move up and down at the start of the engine, which is dangerous. When the engine start switch of the vehicle body is turned on, the actuator for raising and lowering the work implement is There is also known a work vehicle provided with a check device for prohibiting driving.
[0004]
And in order to cancel the operation of the check device, for example, when the measured value of the sensor that detects the lift position of the work implement at the time of starting the engine and the measured value of the sensor that detects the set value of the position lever are inconsistent, When the measured values of both the sensors coincide with each other when the operator consciously operates the position lever, the operation of the check device is released to enable the actuator for raising and lowering the work implement to be driven. Alternatively, when the measured values of both sensors coincide when the engine is started, the operation of the check device is canceled when the measured values of both sensors differ by a predetermined value or more due to operation of the position lever. Yes.
[0005]
However, as the resolution of each sensor increases, the measured value of the sensor tends to fluctuate in small increments due to the vibration of the vehicle body, and the operation of the check device is released against the operator's consciousness without operating the position lever. Sometimes.
[0006]
Therefore, in a work vehicle provided with a check device that prohibits driving of the actuator for raising and lowering the work machine when the engine of the vehicle body is started, in order to improve the timing for releasing the operation of the check device and execute reliable check release A technical problem to be solved arises, and the present invention aims to solve this problem.
[0007]
[Means for Solving the Problems]
The present invention has been proposed in order to achieve the above-mentioned object, and a position lever (31) for connecting a work machine (16) so as to be movable up and down with respect to a vehicle body and setting a lift position of the work machine (16). And the sensor (40) for detecting the set value of the position lever (31), the sensor (23) for detecting the raising / lowering position of the working machine (16), and the measured values of both the sensors are matched. Is provided with a position control device comprising an actuator (22) for raising and lowering the work implement (16), and when the engine start switch (34) for the vehicle body is turned on, the actuator for raising and lowering the work implement (22) is driven. In a work vehicle (10) provided with a check device that prohibits
A predetermined upper limit region (+ B) is provided above the set point (A) where the measured values of the two sensors coincide with each other, and a lower limit region (−B) having the same width as the upper limit region is provided below the upper limit region (+ B). ) And the sensor (40) for detecting the set value of the position lever (31) when the check device is activated and the actuator (22) for raising and lowering the work machine (16) is prohibited. The value is within the set point (A) or the upper or lower limit region, and the measured value of the sensor (40) passes from the set point (A) to either the upper or lower limit region. When the vehicle goes out of the restricted area, or passes through the restricted area from either the upper or lower restricted area and goes out of the restricted area, the operation of the check device is released. Configure
If there is no abnormality in the detection signal of the front wheel break angle sensor (39) of the front wheel (38), the auto lift control for automatically raising the work implement (16) when the vehicle body turns is continued, and the front wheel break angle sensor (39) When there is an abnormality in the detection signal, the work implement (16) is raised while calculating the position of the rear cover (24) at the rear of the work implement (16) from the detection value of the depth sensor (25) for detecting the tilling depth, When the rear cover (24) reaches the lowermost position, the control signal to the electromagnetic control valve (51) is stopped, that is, the drive of the lift cylinder for lifting of the work machine (16) is stopped, and the check device After the operation and the routine after the operation is released, the control shifts to position control, and the check device moves from the tilling depth control mode by the depth sensor (25) in addition to when the front wheel break angle sensor (39) is abnormal. By connecting the working machine also forms a structure that controls when there is a change of the work machine control mode for switching to another mode,
When the work machine (16) is raised by the automatic lift control, the work machine (16) is kept at a constant speed until the work machine rises to a certain height from the beginning of the work machine rise. After rising above the height, the work equipment (16) is configured to change the ascent speed to the normal speed,
Further, when the work implement (16) is raised manually by operating the work implement lift lever (36), the lift rate from the initial start of the rise of the work implement (16) to a certain height is controlled by auto lift control. The present invention provides a position control device for a work vehicle that is configured to be set later than in the above case .
[0008]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, an embodiment of the present invention will be described in detail with reference to the drawings. FIG. 1 shows a
[0009]
The
[0010]
A lift
[0011]
On the other hand, near the driver's
[0012]
The rotation operation of the
[0013]
FIG. 2 is a block diagram of the position control system. The position sensor 40 configured by a potentiometer or the like detects the set value of the
[0014]
On the other hand, the controller 50 calculates the lift position of the
[0015]
Further, the controller 50 outputs a control signal to the electromagnetic control valve 51 based on the set value of the position sensor 40 and drives the
[0016]
Here, as shown in the flowchart of FIG. 3, when the
[0017]
Then, the check is continued until the following check release operation is performed (step 3). When the check release operation is performed, the operation of the check device is released (step 4), and the position control is executed (step 4). Step 5). As will be described later, after detecting an abnormality in the front wheel break angle sensor during auto lift control and stopping the output of the work implement ascending, the process returns to the above step 2 and goes through the operation of the check device and the routine for releasing the operation. Move to position control.
[0018]
FIG. 4 shows an example of the restraint release operation, with a set point (A) where the measured value of the position sensor 40 coincides with the measured value of the lift
[0019]
Now, as shown in FIG. 4 (a), when the restraint device operates and prohibits the drive of the
[0020]
Further, as shown in FIG. 4B, the measurement value of the lift
[0021]
On the other hand, as shown in FIG. 4C, when the measured value of the lift
[0022]
As shown in FIG. 4D, when the measured value of the lift
[0023]
Further, as shown in FIG. 4E, the measured value of the lift
[0024]
Thus, by defining the conditions for the check release operation, the check release operation for the position control can be surely performed, and the release of the check against the operator's consciousness due to the sensor measurement value fluctuation or the like can be prevented.
[0025]
FIG. 5 shows a flowchart of auto lift control for automatically raising the work machine when turning the vehicle body. When the controller 50 determines that the vehicle body has entered a turning operation due to a change in the detection signal of the front wheel
[0026]
If there is no abnormality in the detection signal of the front wheel
[0027]
The abnormality of the front wheel turning
[0028]
Thus, after stopping the work machine ascent output in step 106, the routine jumps to step 2 in the flowchart shown in FIG. 3, and shifts to the position control through the operation of the check device and the routine for releasing the operation. . In addition, the check device described in FIG. 3 is connected to a plow working machine, for example, from a plowing depth control mode by the
[0029]
As shown in the flowchart of FIG. 6, when the work implement is raised by autolift control when the vehicle body is turning, the work implement raising speed is changed depending on the height of the work implement (steps 201 to 203). From the beginning of the ascent of the
[0030]
In this way, by slightly lowering the initial rising speed, the
[0031]
When the
[0032]
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 ones.
[0033]
【The invention's effect】
As described in detail in the above embodiment, the present invention focuses on the set point where the measured value of the sensor that detects the set value of the position lever in advance matches the measured value of the sensor that detects the lift position of the work implement. As described above, an upper restricted area is provided above and a lower restricted area is provided below the upper restricted area. When the restraint device is activated by turning on the engine start switch of the vehicle body and driving of the actuator for raising and lowering the work implement is prohibited, the measured value of the sensor that detects the set value of the position lever is the set point or above or below When the measured value of the sensor is within one of the restricted areas, and the measured value of the sensor passes through either the upper or lower restricted area from the set point and goes out of the restricted area, or either the upper or lower part When it has passed through the other restricted area from inside the restricted area and outside the restricted area, it is configured to cancel the operation of the restraining device, so that it is possible to reliably perform the restraint releasing operation of the position control, It is possible to prevent the release of restraint against the operator's consciousness due to sensor measurement value fluctuations and the like.
If there is no abnormality in the detection signal of the front wheel break angle sensor (39) of the front wheel (38), the automatic lift control is continued. If there is an abnormality in the detection signal of the front wheel break angle sensor (39), The work machine (16) is raised while calculating the position of the rear cover (24) based on the detection value of the depth sensor (25) for detecting the amount, and when the rear cover (24) reaches the lowermost position, the electromagnetic control valve ( 51) is stopped, that is, the drive of the lift cylinder for raising and lowering the work machine (16) is stopped. Therefore, even if an abnormality occurs in the front wheel break angle sensor and the autolift is in the middle stage, the rotary Since the work machine is turned in a state where the work machine is completely lifted from the ground, the machine can be prevented from being damaged.
When the work implement (16) is raised by the auto lift control, the work implement 16 is kept at a constant speed until it reaches a certain height from the beginning of raising the work implement. After rising above the height, the
Further, when the work implement (16) is raised manually by operating the work implement lift lever (36), the lifting speed from the beginning of the rise of the work implement (16) to a certain height is set to the auto lift. Since it is configured to be set slower than in the case of control, manual operation of the work implement lift lever does not cause the work implement drag as in the case of auto lift control. The rising speed up to this point may be set slower.
[Brief description of the drawings]
The figure shows an embodiment of the present invention.
FIG. 1 is a side view of a tractor.
FIG. 2 is a block diagram of a position control system.
FIG. 3 is a flowchart for explaining a procedure for releasing the operation of the check device.
FIGS. 4A to 4E are explanatory diagrams illustrating an example of a check release operation. FIG.
FIG. 5 is a flowchart showing a procedure for raising the work implement by autolift control.
FIG. 6 is a flowchart showing a procedure for changing the rising speed when the working machine is raised.
[Explanation of symbols]
DESCRIPTION OF
Claims (1)
前記双方のセンサの計測値が一致する設定点(A)を中心としてその上方に所定範囲の上部制限領域(+B)を設けるとともに、その下方に上部制限領域と同一幅の下部制限領域(−B)を設け、前記牽制装置が作動して作業機(16)昇降用のアクチュエータ(22)の駆動を禁止しているときに、ポジションレバー(31)の設定値を検出するセンサ(40)の計測値が前記設定点(A)若しくは上部または下部何れか一方の制限領域内にあり、該センサ(40)の計測値が前記設定点(A)から上部または下部何れか一方の制限領域を通過して制限領域の外へでたとき、若しくは上部または下部何れか一方の制限領域内から他方の制限領域を通過して制限領域の外へでたときは、前記牽制装置の作動を解除するように構成し、
前輪(38)の前輪切れ角センサ(39)の検出信号に異常がなければ車体が旋回時に作業機(16)を自動的に上昇させるオートリフト制御を継続し、前輪切れ角センサ(39)の検出信号に異常があったときは、耕深量を検出するデプスセンサ(25)の検出値により作業機(16)後部のリヤカバー(24)の位置を算出しながら作業機(16)を上昇させ、リヤカバー(24)が最下端位置になったときに、前記電磁制御弁(51)への制御信号を停止、即ち、作業機(16)の昇降用リフトシリンダの駆動を停止するとともに、牽制装置の作動並びに作動解除後のルーチンを経て、ポジション制御へ移行し、該牽制装置は前記前輪切れ角センサ(39)の異常発生時の外に、デプスセンサ(25)による耕深制御モードから、プラウ作業機を連結して別のモードに切換える作業機制御モードの変更がある場合にも制御する構成と成し、
前記オートリフト制御で作業機(16)を上昇させる場合、作業機上昇開始初期から一定の高さに至るまでは、作業機の上昇速度の1/2程度にし、作業機(16)が一定の高さ以上に上昇した後は、作業機(16)の上昇速度を通常速度に変更するように構成し、
更に、作業機昇降レバー(36)の操作により手動によって作業機(16)を上昇させる場合は、作業機(16)の上昇開始初期から一定の高さに至るまでの上昇速度を、オートリフト制御の場合に比べて遅く設定する構成と成したことを特徴とする作業車両に於けるポジション制御装置。A work machine (16) is connected to the vehicle body so as to be movable up and down, a position lever (31) for setting the lift position of the work machine (16) is provided, and a sensor for detecting a set value of the position lever (31) ( 40), a sensor (23) for detecting the raising / lowering position of the work implement (16), and an actuator (22) for raising and lowering the work implement (16) so that the measured values of both sensors coincide. In a work vehicle (10) provided with a control device, and further provided with a check device for prohibiting driving of the actuator for raising and lowering the work implement when the engine start switch (34) of the vehicle body is turned on.
A predetermined upper limit region (+ B) is provided above the set point (A) where the measured values of the two sensors coincide with each other, and a lower limit region (−B) having the same width as the upper limit region is provided below the upper limit region (+ B). ) And the sensor (40) for detecting the set value of the position lever (31) when the check device is activated and the actuator (22) for raising and lowering the work machine (16) is prohibited. The value is within the set point (A) or the upper or lower limit region, and the measured value of the sensor (40) passes from the set point (A) to either the upper or lower limit region. When the vehicle goes out of the restricted area, or passes through the restricted area from either the upper or lower restricted area and goes out of the restricted area, the operation of the check device is released. Configure
If there is no abnormality in the detection signal of the front wheel break angle sensor (39) of the front wheel (38), the auto lift control for automatically raising the work implement (16) when the vehicle body turns is continued, and the front wheel break angle sensor (39) When there is an abnormality in the detection signal, the work implement (16) is raised while calculating the position of the rear cover (24) at the rear of the work implement (16) from the detection value of the depth sensor (25) for detecting the tilling depth, When the rear cover (24) reaches the lowermost position, the control signal to the electromagnetic control valve (51) is stopped, that is, the drive of the lift cylinder for lifting of the work machine (16) is stopped, and the check device After the operation and the routine after the operation is released, the control shifts to position control, and the check device moves from the tilling depth control mode by the depth sensor (25) in addition to when the front wheel break angle sensor (39) is abnormal. By connecting the working machine also forms a structure that controls when there is a change of the work machine control mode for switching to another mode,
When the work machine (16) is raised by the automatic lift control, the work machine (16) is kept at a constant speed until the work machine rises to a certain height from the beginning of the work machine rise. After rising above the height, the work equipment (16) is configured to change the ascent speed to the normal speed,
Further, when the work implement (16) is raised manually by operating the work implement lift lever (36), the lift rate from the initial start of the rise of the work implement (16) to a certain height is controlled by auto lift control. A position control device in a work vehicle, characterized in that it is configured to be set later than in the case of .
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP34580398A JP3932704B2 (en) | 1998-12-04 | 1998-12-04 | Position control device for work vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP34580398A JP3932704B2 (en) | 1998-12-04 | 1998-12-04 | Position control device for work vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2000166311A JP2000166311A (en) | 2000-06-20 |
JP3932704B2 true JP3932704B2 (en) | 2007-06-20 |
Family
ID=18379097
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP34580398A Expired - Fee Related JP3932704B2 (en) | 1998-12-04 | 1998-12-04 | Position control device for work vehicle |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3932704B2 (en) |
-
1998
- 1998-12-04 JP JP34580398A patent/JP3932704B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2000166311A (en) | 2000-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6076612A (en) | Transition from position to draft mode controlled by hitch position command and feedback | |
JPH0829003B2 (en) | Hitch controller | |
JP3932704B2 (en) | Position control device for work vehicle | |
JP5943852B2 (en) | Work vehicle | |
JP6577382B2 (en) | Work vehicle | |
US6112826A (en) | Agricultural tractor | |
JP3541465B2 (en) | Tractor work equipment lifting control device | |
JP4863347B2 (en) | Attitude control device | |
JP5125260B2 (en) | Tractor | |
JP3850007B2 (en) | Tractor lifting equipment | |
JP4848602B2 (en) | Powered vehicle | |
JP3844007B2 (en) | Tractor liquid crystal display | |
JP4608798B2 (en) | Work vehicle lift control device for work vehicle | |
JP3188103B2 (en) | Tractor engine speed control | |
JPH0723610A (en) | Tractor for agriculture | |
JP2539036Y2 (en) | Elevation control device for working unit in work vehicle | |
JP5002935B2 (en) | Tractor work machine | |
JPH0522023Y2 (en) | ||
JP3687310B2 (en) | Tractor load control device | |
JP3700292B2 (en) | Tractor load control device | |
JP4069515B2 (en) | Agricultural tractor | |
JPH0728570B2 (en) | Agricultural tractor | |
JPH10164907A (en) | Engine controller for tractor or the like | |
JP2708041B2 (en) | Hydraulic control device in tractor | |
JP5609151B2 (en) | Tractor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050118 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20060928 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20061003 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20061115 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20061212 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070201 |
|
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: 20070227 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070312 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |