JPH10313608A - Machine for work - Google Patents
Machine for workInfo
- Publication number
- JPH10313608A JPH10313608A JP13932397A JP13932397A JPH10313608A JP H10313608 A JPH10313608 A JP H10313608A JP 13932397 A JP13932397 A JP 13932397A JP 13932397 A JP13932397 A JP 13932397A JP H10313608 A JPH10313608 A JP H10313608A
- Authority
- JP
- Japan
- Prior art keywords
- range
- data
- duty
- deviation
- cycle
- 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.)
- Granted
Links
Landscapes
- Lifting Devices For Agricultural Implements (AREA)
- Servomotors (AREA)
- Feedback Control In General (AREA)
Abstract
Description
【0001】[0001]
【発明の属する技術分野】本発明は、トラクタ等の作業
用機械の技術分野に属するものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention belongs to the technical field of work machines such as tractors.
【0002】[0002]
【従来の技術】一般に、この種作業用機械のなかには、
電磁切換バルブを間欠作動させるインチング信号のデュ
ーティ値を、油圧アクチュエータの目標位置と検出位置
との偏差に基づいて決定するにあたり、前記デューティ
値を所定の減少率で減少させる減速偏差範囲を設定した
ものがある。つまり、作動中の油圧アクチュエータを急
激に停止させると、慣性に基づいて大きな衝撃が発生す
るため、目標位置の近傍から作動速度を徐々に減速して
衝撃の少ない作動停止を行うようになっている。2. Description of the Related Art Generally, this kind of working machine includes:
In determining a duty value of an inching signal for intermittently operating an electromagnetic switching valve based on a deviation between a target position and a detection position of a hydraulic actuator, a deceleration deviation range in which the duty value is reduced at a predetermined reduction rate is set. There is. That is, when the operating hydraulic actuator is suddenly stopped, a large impact is generated based on the inertia. Therefore, the operation speed is gradually reduced from near the target position to stop the operation with less impact. .
【0003】[0003]
【発明が解決しようとする課題】ところで従来では、イ
ンチング信号の周期を一定とし、デューティ値の変化に
基づいて油圧アクチュエータの作動速度を制御している
が、周波数特性が低い電磁切換バルブを採用したもので
は、減速偏差範囲の後半で電磁切換バルブの応答性が低
下し、油圧アクチュエータが目標位置の手前で停止する
等の不都合が生じる可能性があった。そのため従来で
は、インチング信号の周期を大きくしたり、不感帯を広
くすることで上記不都合を回避しているが、周期を大き
くした場合には、電磁切換バルブのON−OFF切換え
が明確になるため、インチング時や停止時に機体に大き
なショックが伝わる不都合があり、また、不感帯を広く
した場合には、位置制御の精度や応答性が低下する不都
合があった。Conventionally, the cycle of the inching signal is fixed and the operating speed of the hydraulic actuator is controlled based on the change in the duty value. However, an electromagnetic switching valve having a low frequency characteristic is employed. In such a case, the responsiveness of the electromagnetic switching valve is reduced in the latter half of the deceleration deviation range, and there is a possibility that the hydraulic actuator may stop before the target position. Therefore, in the related art, the above-described disadvantage is avoided by increasing the cycle of the inching signal or widening the dead zone. However, when the cycle is increased, the ON / OFF switching of the electromagnetic switching valve becomes clear. There is a disadvantage that a large shock is transmitted to the aircraft at the time of inching or stopping, and when the dead zone is widened, there is a disadvantage that accuracy and responsiveness of position control are reduced.
【0004】[0004]
【課題を解決するための手段】本発明は、上記の如き実
情に鑑みこれらの課題を解決することを目的として創作
されたものであって、油圧アクチュエータの作動を切換
える電磁切換バルブを、所定周期のインチング信号で間
欠作動させると共に、前記インチング信号のデューティ
値を、油圧アクチュエータの目標位置と検出位置との偏
差に基づいて決定する作業用機械であって、該作業用機
械に、油圧アクチュエータの作動速度を減速させる減速
偏差範囲を設定するにあたり、インチング信号の周期を
一定とし、デューティ値を所定の減少率で減少させる第
一減速偏差範囲と、インチング信号のデューティ値を一
定とし、周期を所定の減少率で減少させる第二減速偏差
範囲とを設定したものである。つまり、一定周期でデュ
ーティ値を減少させた後、デューティ値を一定とし、周
期の減少に基づいて油圧アクチュエータの作動速度を減
速させることができるため、最終減速段階まで単にデュ
ーティ値を減少させる場合に比して、電磁切換バルブの
応答性を向上させることができる。従って、予めインチ
ング信号の周期を大きく設定したり、不感帯を広く設定
することが不要となり、その結果、インチング時や停止
時に機体に大きなショックが伝わる不都合を解消するこ
とができる許りでなく、位置制御の精度や応答性を向上
させることができる。また、前記油圧アクチュエータの
作動量もしくは作動速度をフィードバックすると共に、
フィードバックされた作動量もしくは作動速度に基づい
てインチング信号の周期またはデューティ値を補正する
フィードバック補正手段を設けたものである。つまり、
最終減速段階における油圧アクチュエータの作動速度
は、作業機重量、作動油温度、エンジン回転数、油圧機
器のバラツキ等に基づいて不安定になる可能性がある
が、フィードバックされた作動量もしくは作動速度に基
づいてインチング信号の周期またはデューティ値を補正
するため、油圧アクチュエータを目標位置にスムーズに
停止させることができる。SUMMARY OF THE INVENTION In view of the above circumstances, the present invention has been made to solve these problems, and an electromagnetic switching valve for switching the operation of a hydraulic actuator is provided at a predetermined period. A working machine that intermittently operates with the inching signal of the above and determines the duty value of the inching signal based on the deviation between the target position and the detected position of the hydraulic actuator. In setting the deceleration deviation range for decelerating the speed, the period of the inching signal is fixed, the first deceleration deviation range in which the duty value is reduced at a predetermined reduction rate, and the duty value of the inching signal is fixed, and the period is set to a predetermined value. A second deceleration deviation range to be reduced at the reduction rate is set. In other words, after reducing the duty value at a constant cycle, the duty value is kept constant, and the operating speed of the hydraulic actuator can be reduced based on the reduction of the cycle. In comparison, the response of the electromagnetic switching valve can be improved. Therefore, it is not necessary to set a large cycle of the inching signal in advance or set a wide dead zone, and as a result, it is not possible to eliminate a disadvantage that a large shock is transmitted to the body at the time of inching or stopping, Control accuracy and responsiveness can be improved. Also, while feeding back the operation amount or operation speed of the hydraulic actuator,
There is provided feedback correction means for correcting the period or duty value of the inching signal based on the fed back operation amount or operation speed. That is,
The operating speed of the hydraulic actuator in the final deceleration stage may become unstable based on the weight of the work equipment, the operating oil temperature, the engine speed, the variation of the hydraulic equipment, etc. Since the cycle or duty value of the inching signal is corrected based on the inching signal, the hydraulic actuator can be smoothly stopped at the target position.
【0005】[0005]
【発明の実施の形態】次に、本発明の実施の形態の一つ
を図面に基づいて説明する。図面において、1はトラク
タの走行機体であって、該走行機体1の後部には、昇降
リンク機構2を介してロータリ等の作業機3が昇降自在
に連結されている。そして、前記作業機3は、リフトロ
ッド4を介して昇降リンク機構2を吊持するリフトアー
ム5の上下揺動に伴って昇降作動する一方、左右何れか
のリフトロッド4に介設されるリフトロッドシリンダ6
の伸縮に伴って左右傾斜するが、これらの基本構成は何
れも従来通りである。Next, one embodiment of the present invention will be described with reference to the drawings. In the drawings, reference numeral 1 denotes a traveling body of a tractor, and a working machine 3 such as a rotary is connected to a rear portion of the traveling body 1 via a lifting link mechanism 2 so as to be able to move up and down. The work machine 3 moves up and down with the vertical swing of a lift arm 5 that suspends the lifting link mechanism 2 via the lift rod 4, while a lift provided on one of the left and right lift rods 4. Rod cylinder 6
Are tilted left and right with the expansion and contraction of.
【0006】前記リフトロッドシリンダ6は、リフトロ
ッド用電磁切換バルブ7を介して油圧ポンプPに接続さ
れているが、リフトロッド用電磁切換バルブ7を切換え
る伸長用ソレノイド7aおよび縮小用ソレノイド7b
は、インチングパルスに基づく間欠駆動が可能であるた
め、インチングパルスのデューティ設定(ON時間/周
期)に基づいてリフトロッドシリンダ6の作動速度を制
御することができるようになっている。尚、8はリフト
アーム5を油圧作動させるリフトシリンダ、9はリフト
アーム用電磁切換バルブである。The lift rod cylinder 6 is connected to the hydraulic pump P via an electromagnetic switching valve 7 for lift rod, and an extension solenoid 7a and a reduction solenoid 7b for switching the electromagnetic switching valve 7 for lift rod.
Since intermittent driving based on the inching pulse is possible, the operating speed of the lift rod cylinder 6 can be controlled based on the duty setting (ON time / cycle) of the inching pulse. Reference numeral 8 denotes a lift cylinder for hydraulically operating the lift arm 5, and reference numeral 9 denotes an electromagnetic switching valve for the lift arm.
【0007】10はマイクロコンピュータを用いて構成
される制御部であって、該制御部10の入力側には、リ
フトロッドシリンダ6のシリンダ長を検出するリフトロ
ッドセンサ11、走行機体1の左右傾斜角を検出する傾
斜センサ12、傾斜自動制御をON−OFFする傾斜自
動スイッチ13、傾斜自動制御の目標傾斜を設定する傾
斜設定ボリューム14等が入力インタフェース回路を介
して接続される一方、出力側には、リフトロッド用電磁
切換バルブ7の伸長用および縮小用ソレノイド7a、7
b等が出力インタフェース回路を介して接続されてい
る。Reference numeral 10 denotes a control unit constituted by using a microcomputer. On the input side of the control unit 10, a lift rod sensor 11 for detecting the length of the lift rod cylinder 6 is provided, A tilt sensor 12 for detecting an angle, a tilt automatic switch 13 for turning on / off the tilt automatic control, a tilt setting potentiometer 14 for setting a target tilt for the tilt automatic control, and the like are connected via an input interface circuit, while being connected to an output side. Are solenoids 7a and 7 for extending and reducing the electromagnetic switching valve 7 for the lift rod.
b and the like are connected via an output interface circuit.
【0008】前記制御部10は、傾斜センサ12の検出
信号に基づいて作業機3を自動的に傾斜制御する傾斜自
動制御機能を備えている。そして、傾斜自動制御は、セ
ンサ信号等を入力する「データ入力」、傾斜センサ値お
よび傾斜設定ボリューム値に基づいてリフトロッド目標
値を演算する「データセット」、リフトロッド目標値と
リフトロッドセンサ値とを比較してリフトロッドシリン
ダ6の作動方向を決定する「データ比較」、リフトロッ
ド目標値とリフトロッドセンサ値との偏差に基づいて伸
縮ソレノイド7a、7bに対する出力データ(インチン
グパルスの周期およびデューティ)を演算する「リフト
ロッド出力データセット」、リフトロッドセンサ値に基
づいて出力データ補正(オフセット処理)をする「フィ
ードバック」、出力データに応じたインチングパルスを
伸縮ソレノイド7a、7bに出力する「リフトロッドバ
ルブ出力」等のサブルーチンで構成されており、以下、
これらのサブルーチンのうち、傾斜自動制御の要部であ
る「リフトロッド出力データセット」および「フィード
バック」をフローチャートに基づいて説明する。尚、伸
長作動時と縮小作動時の制御概念は略同一であるため、
縮小作動時の説明(フローチャート)は省略する。The control section 10 has an automatic tilt control function for automatically controlling the tilt of the work machine 3 based on a detection signal of the tilt sensor 12. Automatic tilt control includes “data input” for inputting a sensor signal and the like, “data set” for calculating a lift rod target value based on a tilt sensor value and a tilt setting volume value, a lift rod target value and a lift rod sensor value. "Data comparison" which determines the operation direction of the lift rod cylinder 6 by comparing the output data (cycle and duty of the inching pulse) to the telescopic solenoids 7a and 7b based on the deviation between the lift rod target value and the lift rod sensor value. ), “Feedback” for correcting output data based on the lift rod sensor value (offset processing), and “lift” for outputting an inching pulse corresponding to the output data to the telescopic solenoids 7a and 7b. It consists of subroutines such as , Below,
Of these subroutines, “lift rod output data set” and “feedback”, which are the main parts of the automatic tilt control, will be described with reference to flowcharts. In addition, since the control concept at the time of the extension operation and the reduction operation is substantially the same,
The description (flowchart) at the time of the reduction operation is omitted.
【0009】「リフトロッド出力データセット」では、
まず、リフトロッドシリンダ6の作動方向を判断し、該
判断結果が伸長もしくは縮小である場合には、偏差デー
タ(偏差データ=|目標値ーリフトロッドセンサ値|+
偏差オフセットデータ)と範囲データとの比較に基づい
て偏差データが何れの設定偏差範囲{A範囲、B範囲
(第二減速偏差範囲)、C範囲(第一減速偏差範囲)お
よび全流量範囲}に位置するかを判断するようになって
いる。そして、全流量範囲(偏差データ≧A範囲データ
+B範囲データ+C範囲データ−範囲オフセットデー
タ)であると判断した場合には、全流量範囲フラグをセ
ットすると共に、周期データおよびデューティデータに
最大値(予め設定される最大周期および最大デューテ
ィ)をセットするようになっている。つまり、目標値と
リフトロッドセンサ値との偏差がC範囲最大偏差c(減
速開始偏差)を越える場合には、最大デューティ(本実
施形態では100%)を用いてリフトロッドシリンダ6
を一定速度で伸縮作動させるようになっている。In the “lift rod output data set”,
First, the operation direction of the lift rod cylinder 6 is determined, and if the determination result is expansion or contraction, deviation data (deviation data = | target value−lift rod sensor value | +)
Based on a comparison between the deviation offset data) and the range data, the deviation data is set in any of the set deviation ranges {A range, B range (second deceleration deviation range), C range (first deceleration deviation range), and total flow range}. It is determined whether or not it is located. When it is determined that the flow rate is in the entire flow rate range (deviation data ≧ A range data + B range data + C range data−range offset data), the entire flow rate range flag is set, and the maximum value is set in the cycle data and the duty data. A preset maximum cycle and maximum duty) are set. In other words, when the deviation between the target value and the lift rod sensor value exceeds the C range maximum deviation c (deceleration start deviation), the maximum duty (100% in this embodiment) is used for the lift rod cylinder 6.
Is operated to expand and contract at a constant speed.
【0010】また、偏差データがC範囲(A範囲データ
+B範囲データ+C範囲データ−範囲オフセットデータ
>偏差データ≧A範囲データ+B範囲データ−範囲オフ
セットデータ)であると判断した場合には、C範囲フラ
グをセットすると共に、周期データに最大周期をセット
するが、デューティデータは、下記の演算式を用いて演
算するようになっている。但し、Dはデューティデー
タ、Hは偏差データ、AはA範囲データ、BはB範囲デ
ータ、CはC範囲データ、Oは範囲オフセットデータ、
Dmaxは最大デューティ、Dminは最小デューティ
である。 D=[{H−B−(A−O)}/C](Dmax−Dm
in)+Dmin つまり、目標値とリフトロッドセンサ値との偏差がC範
囲最大偏差cよりも小さく、かつB範囲最大偏差b以上
である場合には、周期を一定(最大周期)とし、デュー
ティを徐々に減少させてリフトロッドシリンダ6の伸縮
作動を減速するようになっている。If it is determined that the deviation data is in the C range (A range data + B range data + C range data-range offset data> deviation data ≧ A range data + B range data-range offset data), the C range The flag is set, and the maximum cycle is set in the cycle data. The duty data is calculated using the following equation. Where D is duty data, H is deviation data, A is A range data, B is B range data, C is C range data, O is range offset data,
Dmax is the maximum duty, and Dmin is the minimum duty. D = [{H−B− (A−O)} / C] (Dmax−Dm
in) + Dmin That is, when the deviation between the target value and the lift rod sensor value is smaller than the maximum deviation c in the C range and equal to or larger than the maximum deviation b in the B range, the cycle is set to a constant (maximum cycle) and the duty is gradually increased. To reduce the expansion / contraction operation of the lift rod cylinder 6.
【0011】また、偏差データがB範囲(A範囲データ
+B範囲データ−範囲オフセットデータ>偏差データ≧
A範囲データ)であると判断した場合には、B範囲フラ
グをセットすると共に、デューティデータに最小デュー
ティをセットし、さらに、下記の演算式を用いて周期デ
ータを演算するようになっている。但し、Tは周期デー
タ、Tmaxは最大周期、Tminは最小周期である。 T=[{H−(A−O)}/B](Tmax−Tmi
n)+Tmin つまり、目標値とリフトロッドセンサ値との偏差がB範
囲最大偏差bよりも小さく、かつA範囲最大偏差a以上
である場合には、デューティを一定(最小デューティ)
とし、周期を徐々に減少させるが、この範囲において
は、リフトロッド用電磁切換バルブ7の応答性が低下す
るため、デューティが一定であっても、周期の減少に伴
ってリフトロッドシリンダ6の伸縮作動速度が比較的安
定した状態で減速されるようになっている。The deviation data is in the range B (A range data + B range data-range offset data> deviation data ≧
If it is determined that the data is (A range data), the B range flag is set, the minimum duty is set in the duty data, and the cycle data is calculated using the following formula. Here, T is cycle data, Tmax is a maximum cycle, and Tmin is a minimum cycle. T = [{H− (A−O)} / B] (Tmax−Tmi
n) + Tmin In other words, when the deviation between the target value and the lift rod sensor value is smaller than the B range maximum deviation b and equal to or more than the A range maximum deviation a, the duty is fixed (minimum duty).
In this range, the responsiveness of the electromagnetic switching valve 7 for the lift rod is reduced. Therefore, even if the duty is constant, the expansion and contraction of the lift rod cylinder 6 with the decrease in the cycle is performed. The operation speed is reduced in a relatively stable state.
【0012】また、偏差データがA範囲(偏差データ<
A範囲データ)であると判断した場合には、A範囲フラ
グをセットすると共に、偏差データにA範囲データをセ
ットするようになっている。そして、偏差データにA範
囲データをセットした場合には、B範囲判断がYESに
なるため、デューティデータに最小デューティがセット
されると共に、周期データには、下記の演算データがセ
ットされるようになっている。 T=(O/B)(Tmax−Tmin)+Tmin つまり、目標値とリフトロッドセンサ値との偏差がA範
囲最大偏差aよりも小さい場合には、一定周期(最小周
期)および一定デューティ(最小デューティ)でリフト
ロッドシリンダ6を目標位置まで伸縮作動させるように
なっている。Also, the deviation data is in the range A (deviation data <
If it is determined that the data is (A range data), the A range flag is set and the A range data is set as the deviation data. When the A range data is set as the deviation data, the B range determination becomes YES, so that the minimum duty is set as the duty data, and the following calculation data is set as the cycle data. Has become. T = (O / B) (Tmax−Tmin) + Tmin In other words, when the deviation between the target value and the lift rod sensor value is smaller than the maximum deviation a in the A range, the constant cycle (minimum cycle) and the constant duty (minimum duty) ), The lift rod cylinder 6 is extended and retracted to the target position.
【0013】一方、「フィードバック」では、まず、リ
フトロッドシリンダ6の作動方向を判断し、該判断結果
が伸長もしくは縮小である場合には、停止時および非オ
フセット処理時にセットされるフィードバックタイマの
終了判断を行い、さらに、この判断がYESである場合
には、フィードバック偏差(作動量)を目標L(最小作
動量)および目標H(最大作動量)と比較するようにな
っている。そして、フィードバック偏差が目標L以上
で、かつ目標Hよりも小さい場合には、フィードバック
データおよびフィードバックタイマをセットしてメイン
ルーチンに復帰するが、フィードバック偏差が目標Lよ
りも小さい場合には、加速オフセット処理を実行する一
方、フィードバック偏差が目標H以上である場合には、
減速オフセット処理を実行するようになっている。On the other hand, in the "feedback", first, the operation direction of the lift rod cylinder 6 is judged, and if the judgment result is extension or contraction, the feedback timer set at the time of stopping and at the time of non-offset processing ends. A determination is made, and if the determination is YES, the feedback deviation (operation amount) is compared with a target L (minimum operation amount) and a target H (maximum operation amount). If the feedback deviation is equal to or larger than the target L and smaller than the target H, the feedback data and the feedback timer are set and the process returns to the main routine. If the feedback deviation is smaller than the target L, the acceleration offset is set. While executing the processing, if the feedback deviation is equal to or greater than the target H,
A deceleration offset process is executed.
【0014】前記加速オフセット処理では、まず、B範
囲データ(固定値)と範囲オフセットデータとの一致判
断を行い、該判断がNOである場合には、範囲加速オフ
セット処理を実行する一方、YESと判断した場合に
は、デューティ加速オフセット処理を実行するようにな
っている。そして、範囲加速オフセット処理では、範囲
オフセットデータを加算(上限値=B範囲データ)した
後、A範囲データに、A範囲初期データ(固定値)と範
囲オフセットデータとの和をセットすると共に、C範囲
データに、C範囲初期データ(固定値)と範囲オフセッ
トデータとの和をセットするようになっている。即ち、
フィードバックされる作動量が少ない場合には、偏差デ
ータ、A範囲データ(A範囲最大偏差a)およびC範囲
データ(C範囲最大偏差c)を増加方向にオフセットす
るため、C範囲ではデューティデータの増加に基づいて
伸縮作動速度が増速される一方、B範囲およびA範囲で
は周期データの増加に基づいて伸縮作動速度が増速され
るようになっている。尚、本実施形態の範囲増加オフセ
ット処理では、上記の如く偏差データ、A範囲データお
よびC範囲データを増加方向にオフセットさせている
が、B範囲データ(B範囲最大偏差b)のみを減少側に
オフセットしても同等の作用を得ることが可能である。In the acceleration offset processing, first, it is determined whether or not the B range data (fixed value) matches the range offset data. If the determination is NO, the range acceleration offset processing is executed. When it is determined, the duty acceleration offset processing is executed. In the range acceleration offset process, after adding the range offset data (upper limit value = B range data), the sum of the A range initial data (fixed value) and the range offset data is set in the A range data, and The sum of the C range initial data (fixed value) and the range offset data is set in the range data. That is,
When the operation amount fed back is small, the deviation data, the A range data (A range maximum deviation a) and the C range data (C range maximum deviation c) are offset in the increasing direction, so that the duty data increases in the C range. , The telescopic operation speed is increased based on the increase of the period data in the range B and the range A. In the range increase offset process of the present embodiment, the deviation data, the A range data, and the C range data are offset in the increasing direction as described above, but only the B range data (B range maximum deviation b) is reduced. The same operation can be obtained even if the offset is performed.
【0015】一方、デューティ加速オフセット処理で
は、デューティオフセットデータを加算(上限値=最大
デューティ−最小デューティ)した後、最小デューティ
データに、最小デューティ(固定値)とデューティオフ
セットデータとの和をセットするようになっている。つ
まり、範囲オフセットデータを上限値まで増加させても
目標作動速度が出ない場合には、最小デューティを増加
方向にオフセットするため、A範囲、B範囲およびC範
囲において、デューティデータの増加に基づいて伸縮作
動速度が増速されるようになっている。On the other hand, in the duty acceleration offset processing, after adding the duty offset data (upper limit = maximum duty−minimum duty), the sum of the minimum duty (fixed value) and the duty offset data is set in the minimum duty data. It has become. In other words, if the target operating speed does not come out even when the range offset data is increased to the upper limit value, the minimum duty is offset in the increasing direction. The expansion / contraction operation speed is increased.
【0016】また、前記減速オフセット処理では、ま
ず、最小デューティデータが最小デューティ(固定値)
よりも大きいか否かを判断し、該判断がYESである場
合には、デューティ減速オフセット処理を実行する一
方、NOと判断した場合には、範囲減速オフセット処理
を実行するようになっている。そして、デューティ減速
オフセット処理では、デューティオフセットデータを減
算(下限値=0)した後、最小デューティデータに、最
小デューティ(固定値)とデューティオフセットデータ
との和をセットするようになっている。つまり、前記デ
ューティ加速オフセット処理で増加された最小デューテ
ィデータを減少方向にオフセットするため、A範囲、B
範囲およびC範囲において、デューティデータの減少に
基づいて伸縮作動速度が減速されるようになっている。In the deceleration offset processing, first, the minimum duty data is set to a minimum duty (fixed value).
It is determined whether or not it is larger than the threshold value. If the determination is YES, the duty deceleration offset processing is executed, while if the determination is NO, the range deceleration offset processing is executed. In the duty deceleration offset processing, after the duty offset data is subtracted (lower limit value = 0), the sum of the minimum duty (fixed value) and the duty offset data is set in the minimum duty data. That is, since the minimum duty data increased by the duty acceleration offset processing is offset in the decreasing direction, the range A, the range B
In the range and the C range, the expansion / contraction operation speed is reduced based on the decrease in the duty data.
【0017】一方、範囲減速オフセット処理では、範囲
オフセットデータを減算(下限値=0)した後、A範囲
データに、A範囲初期データ(固定値)と範囲オフセッ
トデータとの和をセットすると共に、C範囲データに、
C範囲初期データ(固定値)と範囲オフセットデータと
の和をセットするようになっている。即ち、前記範囲加
速オフセット処理で増加方向にオフセットされた偏差デ
ータ、A範囲データおよびC範囲データを減少方向にオ
フセットするため、C範囲ではデューティデータの減少
に基づいて伸縮作動速度が減速される一方、B範囲およ
びA範囲では周期データの減少に基づいて伸縮作動速度
が減速されるようになっている。尚、上記の説明では、
便宜上、範囲オフセットデータおよびデューティオフセ
ットデータが0の場合を基準としているが、この状態で
は、減速オフセット処理が有効に機能しないため、実装
状態では、オフセット処理範囲の中間点が初期位置とな
るように各データが設定されている。On the other hand, in the range deceleration offset processing, after the range offset data is subtracted (lower limit value = 0), the sum of the A range initial data (fixed value) and the range offset data is set in the A range data. For C range data,
The sum of the C range initial data (fixed value) and the range offset data is set. That is, since the deviation data, the A range data and the C range data offset in the increasing direction in the range acceleration offset processing are offset in the decreasing direction, the expansion / contraction operation speed is reduced in the C range based on the decrease in the duty data. , B range and A range, the expansion / contraction operation speed is reduced based on the decrease of the cycle data. In the above description,
For convenience, the case where the range offset data and the duty offset data are 0 is a reference, but in this state, the deceleration offset processing does not function effectively, so that in the mounting state, the middle point of the offset processing range is set to the initial position. Each data is set.
【0018】叙述の如く構成されたものにおいて、目標
値とリフトロッドセンサ値との偏差が所定の設定偏差範
囲に入った段階からリフトロッドシリンダ6の伸縮作動
速度を徐々に減速させるにあたり、まず、インチング信
号の周期を一定とし、デューティの減算に基づいて伸縮
作動速度を減速させた後、デューティを一定とし、周期
の減算に基づいて伸縮作動速度を減速させるため、最終
減速段階まで単にデューティを減算した場合の様に、減
速偏差範囲の後半でリフトロッドシリンダ6の伸縮作動
が不安定になる不都合を解消することができる。つま
り、減速偏差範囲の後半で用電磁切換バルブ7の周波数
特性が低下することを利用し、デューティを変えること
なく周期の減算に基づいて伸縮作動速度を減速させるた
め、リフトロッドシリンダ6の伸縮作動を安定させるこ
とができ、従って、予めインチング信号の周期を大きく
設定したり、不感帯を広く設定することが不要となり、
その結果、インチング時や停止時に機体に大きなショッ
クが伝わる不都合を解消することができる許りでなく、
傾斜自動制御の精度や応答性を向上させることができ
る。In the apparatus configured as described above, when gradually decreasing the expansion / contraction operation speed of the lift rod cylinder 6 from the stage when the deviation between the target value and the lift rod sensor value falls within a predetermined set deviation range, first, After decelerating the expansion / contraction operation speed based on the subtraction of the duty while keeping the cycle of the inching signal constant, simply subtract the duty until the final deceleration stage in order to decelerate the expansion / contraction operation speed based on the duty reduction and the period subtraction. In this case, it is possible to eliminate the disadvantage that the expansion and contraction operation of the lift rod cylinder 6 becomes unstable in the latter half of the deceleration deviation range. In other words, utilizing the fact that the frequency characteristic of the electromagnetic switching valve 7 decreases in the latter half of the deceleration deviation range, the telescopic operation speed is reduced based on the subtraction of the period without changing the duty. Therefore, it is not necessary to set a large period of the inching signal in advance or set a wide dead zone in advance.
As a result, it is not possible to eliminate the inconvenience of transmitting a large shock to the aircraft at the time of inching or stopping,
The accuracy and responsiveness of the automatic tilt control can be improved.
【0019】また、前記リフトロッドシリンダ6の作動
量をフィードバックすると共に、フィードバックされた
作動量に応じてインチング信号の周期またはデューティ
を補正するため、仮に、作業機重量、作動油温度、エン
ジン回転数、油圧機器のバラツキ等に基づいてリフトロ
ッドシリンダ6の伸縮作動が不安定になる不都合を解消
することができ、その結果、傾斜自動制御の安定性およ
び制御精度を向上させることができる。Further, in order to feed back the operation amount of the lift rod cylinder 6 and to correct the cycle or duty of the inching signal in accordance with the fed back operation amount, it is assumed that the working machine weight, the operating oil temperature, the engine speed, etc. In addition, it is possible to solve the problem that the expansion / contraction operation of the lift rod cylinder 6 becomes unstable based on the variation of the hydraulic equipment, and as a result, it is possible to improve the stability and control accuracy of the automatic tilt control.
【0020】尚、本発明は、前記実施形態に限定されな
いものであることは勿論であって、リフトロッドシリン
ダ以外の油圧アクチュエータ作動を切換える電磁切換バ
ルブを対象として本発明を実施できることは言うまでも
ない。また、前記実施形態では、応答性能の低い電磁切
換バルブを対象としているが、応答性能の高い電磁切換
バルブを対象として本発明(「フィードバック」を含
む)を実施してもよく、この場合には、電磁切換バルブ
のインチング音やショックの発生を抑制できる許りでな
く、制御精度の向上を計ることができる。The present invention is, of course, not limited to the above embodiment, and it goes without saying that the present invention can be applied to an electromagnetic switching valve for switching the operation of a hydraulic actuator other than the lift rod cylinder. Further, in the above embodiment, the electromagnetic switching valve having low response performance is targeted. However, the present invention (including “feedback”) may be implemented with respect to the electromagnetic switching valve having high response performance. In addition, it is not possible to suppress the generation of the inching sound and the shock of the electromagnetic switching valve, and it is possible to improve the control accuracy.
【図1】トラクタの側面図である。FIG. 1 is a side view of a tractor.
【図2】リフトロッドシリンダの作動回路を示す油圧回
路図である。FIG. 2 is a hydraulic circuit diagram showing an operation circuit of a lift rod cylinder.
【図3】制御部の入出力を示すブロック図である。FIG. 3 is a block diagram showing input and output of a control unit.
【図4】傾斜自動制御のメインルーチンを示すフローチ
ャートである。FIG. 4 is a flowchart showing a main routine of automatic tilt control.
【図5】「リフトロッド出力データセット」を示すフロ
ーチャートである。FIG. 5 is a flowchart showing a “lift rod output data set”;
【図6】「リフトロッド出力データセット」の伸長時デ
ータセット部分を示すフローチャートである。FIG. 6 is a flowchart showing a data set portion at the time of extension of “lift rod output data set”.
【図7】「リフトロッド出力データセット」の作用を示
すタイミングチャートである。FIG. 7 is a timing chart showing the operation of the “lift rod output data set”.
【図8】「リフトロッド出力データセット」の作用を示
すグラフである。FIG. 8 is a graph showing the operation of the “lift rod output data set”.
【図9】「フィードバック」を示すフローチャートであ
る。FIG. 9 is a flowchart showing “feedback”.
【図10】「フィードバック」の伸長時フィードバック
部分(減速オフセット処理部分を含む)を示すフローチ
ャートである。FIG. 10 is a flowchart showing a feedback part (including a deceleration offset processing part) at the time of decompression of “feedback”.
【図11】「フィードバック」の伸長時フィードバック
部分(加速オフセット処理部分)を示すフローチャート
である。FIG. 11 is a flowchart showing a feedback part (acceleration offset processing part) at the time of expansion of “feedback”.
【図12】「フィードバック」のオフセット処理(偏
差、A範囲最大偏差aおよびC範囲最大偏差c)を示す
グラフである。FIG. 12 is a graph showing a “feedback” offset process (deviation, A range maximum deviation a and C range maximum deviation c).
【図13】「フィードバック」の作用を示すグラフであ
る。FIG. 13 is a graph showing an operation of “feedback”.
1 走行機体 3 作業機 6 リフトロッドシリンダ 7 リフトロッド用電磁切換バルブ 10 制御部 11 リフトロッドセンサ DESCRIPTION OF SYMBOLS 1 Traveling body 3 Work implement 6 Lift rod cylinder 7 Electromagnetic switching valve for lift rod 10 Control part 11 Lift rod sensor
フロントページの続き (72)発明者 木村 重治 島根県八束郡東出雲町大字揖屋町667番地 1 三菱農機株式会社内 (72)発明者 田村 智志 島根県八束郡東出雲町大字揖屋町667番地 1 三菱農機株式会社内Continued on the front page (72) Inventor Shigeharu Kimura 667 Iida-cho, Oji-zu, Higashi-Izumo-cho, Yatsuka-gun, Shimane Prefecture Within Mitsubishi Agricultural Machinery Co., Ltd. (72) Satoshi Tamura 667 Iya-cho, Oji-zu, Higashi-Izumo-cho, Yatsuka-gun, Shimane 1 Mitsubishi Agricultural Machinery Co., Ltd.
Claims (2)
磁切換バルブを、所定周期のインチング信号で間欠作動
させると共に、前記インチング信号のデューティ値を、
油圧アクチュエータの目標位置と検出位置との偏差に基
づいて決定する作業用機械であって、該作業用機械に、
油圧アクチュエータの作動速度を減速させる減速偏差範
囲を設定するにあたり、インチング信号の周期を一定と
し、デューティ値を所定の減少率で減少させる第一減速
偏差範囲と、インチング信号のデューティ値を一定と
し、周期を所定の減少率で減少させる第二減速偏差範囲
とを設定した作業用機械。An electromagnetic switching valve for switching the operation of a hydraulic actuator is intermittently operated with an inching signal of a predetermined cycle, and a duty value of the inching signal is set to
A working machine determined based on a deviation between a target position and a detected position of the hydraulic actuator, wherein the working machine includes:
In setting the deceleration deviation range for decelerating the operating speed of the hydraulic actuator, the period of the inching signal is made constant, the first deceleration deviation range in which the duty value is reduced at a predetermined reduction rate, and the duty value of the inching signal is made constant, A work machine in which a second deceleration deviation range for reducing the cycle at a predetermined reduction rate is set.
の作動量もしくは作動速度をフィードバックすると共
に、フィードバックされた作動量もしくは作動速度に基
づいてインチング信号の周期またはデューティ値を補正
するフィードバック補正手段を設けた作業用機械。2. The apparatus according to claim 1, further comprising feedback correction means for feeding back the operation amount or operation speed of the hydraulic actuator and correcting the cycle or duty value of the inching signal based on the operation amount or operation speed fed back. Working machine.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13932397A JP3755963B2 (en) | 1997-05-14 | 1997-05-14 | Work machine |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13932397A JP3755963B2 (en) | 1997-05-14 | 1997-05-14 | Work machine |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH10313608A true JPH10313608A (en) | 1998-12-02 |
JP3755963B2 JP3755963B2 (en) | 2006-03-15 |
Family
ID=15242645
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP13932397A Expired - Fee Related JP3755963B2 (en) | 1997-05-14 | 1997-05-14 | Work machine |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3755963B2 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114483724A (en) * | 2021-12-28 | 2022-05-13 | 南京航空航天大学 | PWM control method and system for prolonging service life of array high-speed switch valve |
-
1997
- 1997-05-14 JP JP13932397A patent/JP3755963B2/en not_active Expired - Fee Related
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114483724A (en) * | 2021-12-28 | 2022-05-13 | 南京航空航天大学 | PWM control method and system for prolonging service life of array high-speed switch valve |
CN114483724B (en) * | 2021-12-28 | 2022-12-23 | 南京航空航天大学 | PWM control method and system for prolonging service life of array high-speed switch valve |
Also Published As
Publication number | Publication date |
---|---|
JP3755963B2 (en) | 2006-03-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPH10313608A (en) | Machine for work | |
JP5943852B2 (en) | Work vehicle | |
JPH08302753A (en) | Hydraulic construction equipment | |
US10662618B2 (en) | Construction machine | |
JP3782586B2 (en) | Working vehicle | |
JP3556809B2 (en) | Tractor | |
JPH11289808A (en) | Tractor | |
JPH10286004A (en) | Working machine | |
JP6422419B2 (en) | Tractor | |
JPH1098911A (en) | Traveling work wagon | |
JPH0713444Y2 (en) | Working depth control device for ground work vehicle | |
JPH11289810A (en) | Tractor | |
JPH11275911A (en) | Tractor | |
JPH0711526Y2 (en) | Draft control device for agricultural tractors | |
JP5986850B2 (en) | Lift control device for work vehicle | |
JP6422418B2 (en) | Tractor | |
JPH1132504A (en) | Tractor | |
JPH0231183Y2 (en) | ||
JP2651076B2 (en) | Hydraulic actuator control device for earth moving machine | |
JPH03139411A (en) | Working vehicle | |
JPH0257102A (en) | Control device of tilling depth in ground working vehicle | |
JPH0728803Y2 (en) | Work implement control device for mobile agricultural machinery | |
JP3203042B2 (en) | Backhoe hydraulic cylinder controller | |
JPH0475507A (en) | Lift-controlling apparatus | |
JP2572165Y2 (en) | Actuator control device for mobile agricultural machine |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040430 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20050415 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050421 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050608 |
|
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: 20051215 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20051220 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100106 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110106 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120106 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130106 Year of fee payment: 7 |
|
LAPS | Cancellation because of no payment of annual fees |