JP4944712B2 - Work vehicle attitude change structure for work vehicles - Google Patents
Work vehicle attitude change structure for work vehicles Download PDFInfo
- Publication number
- JP4944712B2 JP4944712B2 JP2007224401A JP2007224401A JP4944712B2 JP 4944712 B2 JP4944712 B2 JP 4944712B2 JP 2007224401 A JP2007224401 A JP 2007224401A JP 2007224401 A JP2007224401 A JP 2007224401A JP 4944712 B2 JP4944712 B2 JP 4944712B2
- Authority
- JP
- Japan
- Prior art keywords
- speed
- posture
- work
- control gain
- changing
- 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.)
- Active
Links
Images
Landscapes
- Transplanting Machines (AREA)
- Lifting Devices For Agricultural Implements (AREA)
Description
本発明は、機体に連結された作業装置の姿勢を変更するアクチュエータを備え、作業装置が目標姿勢に維持されるようにアクチュエータを作動させる姿勢制御手段を備えた作業車の作業装置姿勢変更構造に関する。 The present invention relates to a working device posture changing structure for a work vehicle that includes an actuator that changes the posture of a working device connected to a machine body, and has posture control means that actuates the actuator so that the working device is maintained at a target posture. .
作業車の一例である乗用型田植機では、例えば特許文献1に開示されているように、機体の後部に苗植付装置(作業装置に相当)(特許文献1の図1の4)を昇降自在に連結して、苗植付装置を昇降駆動する油圧シリンダ(アクチュエータに相当)(特許文献1の図1及び図2の2)を備えている。田面(作業地に相当)に接地追従する接地フロート(接地体に相当)(特許文献1の図1及び図2の15)を、苗植付装置に昇降自在に備えており、接地フロート(田面)から苗植付装置までの高さを検出する高さセンサー(姿勢検出手段に相当)(特許文献1の図2の39)を備えている。
In a riding type rice transplanter that is an example of a work vehicle, for example, as disclosed in
これにより、高さセンサーの検出値が目標値から外れるほど、油圧シリンダが高速で作動するのであり、高さセンサーの検出値と目標値との偏差に基づいて、高さセンサーの検出値が目標値となるように、油圧シリンダにより苗植付装置が昇降駆動される。高さセンサーの検出値が目標値となることによって、苗植付装置が田面から設定高さに維持されるのであり、苗植付装置による苗の植付深さが設定深さに維持される(姿勢制御手段に相当)。 As a result, the hydraulic cylinder operates at a higher speed as the detected value of the height sensor deviates from the target value. Based on the deviation between the detected value of the height sensor and the target value, the detected value of the height sensor becomes the target value. The seedling planting device is driven up and down by a hydraulic cylinder so as to be a value. When the detection value of the height sensor becomes the target value, the seedling planting device is maintained at the set height from the rice field, and the seedling planting depth by the seedling planting device is maintained at the set depth. (Equivalent to attitude control means).
特許文献1では、高さセンサーの検出値と目標値の偏差に基づいて、油圧シリンダにより苗植付装置を昇降駆動しているので、高さセンサーの検出値と目標値との偏差が発生した後に、油圧シリンダが作動する(高さセンサーの検出値と目標値との偏差が発生しないと、油圧シリンダは作動しない)。
これにより、例えば機体の車輪が凸部に乗り上げたり凹部に落ち込んだりして、苗植付装置が急速に上昇又は下降した場合(高さセンサーの検出値が目標値から急速に外れた場合)、この後に油圧シリンダが作動することになるので、油圧シリンダが高速で作動したとしても、苗植付装置が急速に上昇又は下降した初期の時点では、苗植付装置が田面から設定高さに維持されていないことがあり、苗植付装置による苗の植付深さが設定深さに維持されていないことがある。
In
Thereby, for example, when the wheel of the aircraft rides on the convex part or falls into the concave part, the seedling planting device rapidly rises or falls (when the detection value of the height sensor deviates rapidly from the target value), Since the hydraulic cylinder will operate after this, even if the hydraulic cylinder operates at a high speed, the seedling planting device is maintained at the set height from the rice field at the initial point when the seedling planting device is rapidly raised or lowered. The seedling planting depth by the seedling planting device may not be maintained at the set depth.
本発明は、機体に連結された作業装置の姿勢を変更するアクチュエータを備え、作業装置が目標姿勢に維持されるようにアクチュエータを作動させる姿勢制御手段を備えた作業車の作業装置姿勢変更構造において、作業装置の姿勢が急速に変化した場合、作業装置が目標姿勢に維持されていない状態を、できるだけ少なく(短く)することを目的としている。 The present invention relates to a work device posture change structure for a work vehicle that includes an actuator that changes a posture of a work device connected to a machine body, and a posture control unit that operates the actuator so that the work device is maintained at a target posture. When the posture of the working device changes rapidly, the object is to reduce (shorten) the state where the working device is not maintained in the target posture as much as possible.
[I]
(構成)
本発明の第1特徴は、作業車の作業装置姿勢変更構造において次のように構成することにある。
機体に連結された作業装置の姿勢を変更するアクチュエータを備える。作業装置の姿勢を検出する姿勢検出手段と、作業装置の姿勢変化の変化速度を検出する変化速度検出手段とを備える。姿勢検出手段の検出値が目標姿勢から外れるほど、アクチュエータを第1制御ゲインに基づいて高速で作動させ、変化速度検出手段の検出値が高速になるほど、アクチュエータを第2制御ゲインに基づいて高速で作動させて、アクチュエータにより作業装置を目標姿勢に維持する姿勢制御手段を備える。第2制御ゲインを変更可能な制御ゲイン変更手段を備える。
[I]
(Constitution)
The first feature of the present invention resides in the following configuration in the working device attitude changing structure of a work vehicle.
An actuator is provided for changing the attitude of the work device connected to the machine body. A posture detecting means for detecting the posture of the working device and a change speed detecting means for detecting a changing speed of the posture change of the working device. The higher the detection value of the posture detection means deviates from the target posture, the faster the actuator is operated based on the first control gain. The higher the detection value of the change speed detection means, the higher the speed of the actuator based on the second control gain. A posture control means is provided that is actuated to maintain the work device in a target posture by an actuator. Control gain changing means capable of changing the second control gain is provided.
(作用)
本発明の第1特徴によると、作業装置の姿勢を検出する姿勢検出手段と、作業装置の姿勢変化の変化速度を検出する変化速度検出手段とを備えている。
例えば作業装置が目標姿勢から急速に外れる場合、姿勢検出手段の検出値と目標姿勢との偏差が発生する前に(一般に目標姿勢に不感帯が設定されることが多いので、姿勢検出手段の検出値が目標姿勢(不感帯)から外れて偏差が発生するまでに、少し時間が掛かる)、変化速度検出手段により作業装置の姿勢変化の変化速度が検出されるので(作業装置の姿勢変化の変化速度が急変するので)、姿勢検出手段の検出値と目標姿勢との偏差が発生する前に、変化速度検出手段の検出値によりアクチュエータが作動を開始する。
(Function)
According to the first aspect of the present invention, the apparatus includes posture detecting means for detecting the posture of the working device and change speed detecting means for detecting the changing speed of the posture change of the working device.
For example, when the work device rapidly deviates from the target posture, before the deviation between the detection value of the posture detection means and the target posture occurs (the dead zone is generally set in the target posture, the detection value of the posture detection means It takes a little time until the deviation occurs from the target posture (dead zone), and the change speed detecting means detects the change speed of the posture change of the work device (the change speed of the change posture of the work device is Because of a sudden change), before the deviation between the detection value of the posture detection means and the target posture occurs, the actuator starts to operate according to the detection value of the change speed detection means.
これにより、本発明の第1特徴によると、姿勢検出手段の検出値と目標姿勢との偏差によってのみアクチュエータを作動させる構成に比べて、アクチュエータが早い時点で作動を開始して作業装置を目標姿勢に戻そうとするので、作業装置が目標姿勢から急速に外れた場合の初期の時点において、作業装置が目標姿勢に維持されていない状態を少なく(短く)することができる。
この場合、変化速度検出手段の検出値が高速になるほど(作業装置の姿勢変化の変化速度が急変するほど)、アクチュエータが高速で作動して作業装置を目標姿勢に戻そうとするので、作業装置が目標姿勢から急速に外れた場合の初期の時点において、作業装置が目標姿勢に維持されていない状態をさらに少なく(短く)することができる。
Thus, according to the first feature of the present invention, the actuator starts operating at an earlier point in time than the configuration in which the actuator is operated only by the deviation between the detected value of the posture detecting means and the target posture, and the work device is moved to the target posture. Therefore, it is possible to reduce (shorten) the state in which the working device is not maintained in the target posture at an initial time when the working device rapidly deviates from the target posture.
In this case, the higher the detection value of the change speed detection means becomes (the more the change speed of the posture change of the working device changes suddenly), the actuator operates at a higher speed and tries to return the working device to the target posture. The state in which the working device is not maintained in the target posture at the initial time point when the head rapidly deviates from the target posture can be further reduced (shortened).
作業装置の姿勢変化の変化速度が検出される毎に(作業装置の姿勢変化の変化速度が変化する毎に)、変化速度検出手段の検出値によりアクチュエータが作動を開始する場合、作業地の状態や作業形態によっては、作業装置の姿勢が頻繁に変更される状態になって、作業装置の姿勢が安定しないような状態になることがある。
本発明の第1特徴によると、第2制御ゲインを変更可能な制御ゲイン変更手段を備えている。これにより、第2制御ゲインを小側に変更すると、前述のように変化速度検出手段の検出値によりアクチュエータが作動を開始する場合、変化速度検出手段の検出値の割りに(作業装置の姿勢変化の変化速度の割りに)、アクチュエータが低速で作動するように設定することができるのであり、アクチュエータが高速で作動することにより作業装置の姿勢が安定しないような状態を避けることができる。
Each time the change rate of the change in posture of the work device is detected (every time the change rate of the change in posture of the work device changes), the state of the work place is determined when the actuator starts to operate according to the detection value of the change speed detection means. Depending on the work mode, the posture of the work device may be frequently changed, and the posture of the work device may be unstable.
According to the first aspect of the present invention, the control gain changing means capable of changing the second control gain is provided. As a result, when the second control gain is changed to the small side, when the actuator starts to operate according to the detection value of the change speed detection means as described above, the change in the attitude of the work device is changed for the detection value of the change speed detection means. Therefore, the actuator can be set to operate at a low speed, and it is possible to avoid a situation in which the posture of the working device is not stabilized due to the actuator operating at a high speed.
逆に作業地の状態や作業形態により、作業装置が目標姿勢から急速に外れた場合の初期の時点において、作業装置が目標姿勢に維持されていない状態をさらに少なく(短く)することが必要な場合、第2制御ゲインを大側に変更することにより、変化速度検出手段の検出値の割りに(作業装置の姿勢変化の変化速度の割りに)、アクチュエータが高速で作動するように設定することができるのであり、作業装置が目標姿勢から急速に外れた場合の初期の時点において、作業装置が目標姿勢に維持されていない状態をさらに少なく(短く)することができる。 Conversely, it is necessary to further reduce (shorten) the state in which the work device is not maintained in the target posture at the initial point when the work device rapidly deviates from the target posture, depending on the state of the work place and the work form. In this case, by setting the second control gain to the large side, the actuator is set to operate at a high speed for the detection value of the change speed detection means (for the change speed of the posture change of the working device). Therefore, the state in which the working device is not maintained in the target posture at the initial time when the working device rapidly deviates from the target posture can be further reduced (shortened).
(発明の効果)
本発明の第1特徴によると、機体に連結された作業装置の姿勢を変更するアクチュエータを備え、作業装置が目標姿勢に維持されるようにアクチュエータを作動させる姿勢制御手段を備えた作業車の作業装置姿勢変更構造において、作業装置の姿勢と作業装置の姿勢変化の変化速度とによりアクチュエータを作動させるように構成することによって、作業装置が目標姿勢に維持されていない状態を少なく(短く)することができるようになり、早期に作業装置が目標姿勢に戻されるようにすることができて、作業装置が目標姿勢に維持されないことによる作業能率の低下を防止することができた。
本発明の第1特徴によると、変化速度検出手段の検出値によりアクチュエータが作動する第2制御ゲインを変更することによって、作業地の状態や作業形態に対応することができるようになり、姿勢制御手段の性能の向上を図ることができた。
(The invention's effect)
According to the first aspect of the present invention, the work of the work vehicle is provided with an actuator that changes the posture of the work device connected to the airframe, and has posture control means that operates the actuator so that the work device is maintained at the target posture. In the device posture change structure, by configuring the actuator to operate according to the posture of the work device and the change speed of the posture change of the work device, the state where the work device is not maintained at the target posture is reduced (shortened). As a result, the work device can be returned to the target posture at an early stage, and a reduction in work efficiency due to the work device not being maintained in the target posture can be prevented.
According to the first feature of the present invention, by changing the second control gain for operating the actuator according to the detection value of the change speed detecting means, it becomes possible to cope with the state of the work place and the work form, and the attitude control. The performance of the means could be improved.
[II]
(構成)
本発明の第2特徴は、本発明の第1特徴の作業車の作業装置姿勢変更構造において次のように構成することにある。
機体の走行速度を検出する走行速度検出手段を備える。機体の走行速度が低速側になると第2制御ゲインが小側に変更されるように、制御ゲイン変更手段を構成する。
[II]
(Constitution)
The second feature of the present invention lies in the following configuration in the work device attitude changing structure for a work vehicle of the first feature of the present invention.
A traveling speed detecting means for detecting the traveling speed of the airframe is provided. The control gain changing means is configured so that the second control gain is changed to a small side when the traveling speed of the airframe is low.
(作用)
本発明の第2特徴によると、本発明の第1特徴と同様に前項[I]に記載の「作用」を備えており、これに加えて以下のような「作用」を備えている。
機体の走行速度が低速側になると、作業装置の姿勢変化が少しゆっくりとしたものになるので(作業装置の姿勢変化の変化速度が小さなものになるので)、変化速度検出手段の検出値によりアクチュエータが作動を開始する場合、アクチュエータを高速で作動させると、アクチュエータの高速の作動により作業装置の姿勢が安定しないような状態になることが考えられる。
(Function)
According to the second feature of the present invention, the “action” described in the preceding item [I] is provided in the same manner as the first feature of the present invention, and in addition to this, the following “action” is provided.
When the traveling speed of the airframe is on the low speed side, the posture change of the work device becomes a little slower (because the change speed of the posture change of the work device becomes small). When the actuator starts operating, if the actuator is operated at a high speed, it is conceivable that the posture of the working device becomes unstable due to the high speed operation of the actuator.
本発明の第2特徴によれば、機体の走行速度が低速になると第2制御ゲインが小側に変更されるので、変化速度検出手段の検出値によりアクチュエータが作動を開始する場合、変化速度検出手段の検出値の割りに(作業装置の姿勢変化の変化速度の割りに)、アクチュエータが低速で作動するように設定することができるのであり、作業装置の姿勢が安定しないような状態を避けることができる。 According to the second feature of the present invention, the second control gain is changed to the smaller side when the traveling speed of the airframe becomes low. Therefore, when the actuator starts to operate according to the detected value of the changing speed detecting means, the changing speed is detected. The actuator can be set to operate at a low speed for the detection value of the means (for the change speed of the posture change of the work device), and avoid the state where the posture of the work device is not stable. Can do.
(発明の効果)
本発明の第2特徴によると、本発明の第1特徴と同様に前項[I]に記載の「発明の効果」を備えており、これに加えて以下のような「発明の効果」を備えている。
本発明の第2特徴によると、機体の走行速度が低速になると第2制御ゲインが小側に変更されるように構成することによって、作業装置の姿勢が安定しないような状態を避けることができるようになり、姿勢制御手段の性能の向上を図ることができた。
(The invention's effect)
According to the second feature of the present invention, the “effect of the invention” described in the preceding item [I] is provided in the same manner as the first feature of the present invention. In addition, the following “effect of the invention” is provided. ing.
According to the second feature of the present invention, the configuration in which the second control gain is changed to the small side when the traveling speed of the airframe becomes low can avoid a state where the posture of the work device is not stable. As a result, the performance of the attitude control means could be improved.
[III]
(構成)
本発明の第3特徴は、本発明の第1又は第2特徴の作業車の作業装置姿勢変更構造において次のように構成することにある。
機体が走行停止状態になると第2制御ゲインが零に変更されるように、制御ゲイン変更手段を構成する。
[III]
(Constitution)
A third feature of the present invention resides in the following configuration in the work device attitude changing structure for a work vehicle according to the first or second feature of the present invention.
The control gain changing means is configured so that the second control gain is changed to zero when the airframe enters the travel stop state.
(作用)
本発明の第3特徴によると、本発明の第1又は第2特徴と同様に前項[I][II]に記載の「作用」を備えており、これに加えて以下のような「作用」を備えている。
機体の走行停止状態において、例えばエンジン等の振動により作業装置の姿勢が僅かに変化することが考えられる。
この場合、姿勢検出手段の検出値と目標姿勢との偏差は発生しないが(一般に目標姿勢に不感帯が設定されることが多いので、姿勢検出手段の検出値が目標姿勢(不感帯)から外れて偏差が発生するまで、作業装置の姿勢が変化することはない)、変化速度検出手段により作業装置の姿勢変化の変化速度が検出されることがある(作業装置の姿勢変化の変化速度が変化することがある)。このような状態になると、機体の走行停止状態において変化速度検出手段の検出値によりアクチュエータが作動し、作業装置の姿勢が変更される状態となる。
(Function)
According to the third feature of the present invention, the “action” described in the preceding item [I] [II] is provided in the same manner as the first or second feature of the present invention. In addition, the following “action” is provided. It has.
It is conceivable that the attitude of the working device slightly changes due to vibrations of the engine or the like when the machine body is stopped.
In this case, there is no deviation between the detection value of the posture detection means and the target posture (in general, the dead zone is often set in the target posture, so the detection value of the posture detection means deviates from the target posture (dead zone). The change rate of the change in the posture of the work device may be detected by the change speed detection means (the change rate of the change in the posture of the work device may change). There). In such a state, the actuator is actuated by the detection value of the change speed detection means in the traveling stop state of the airframe, and the posture of the work device is changed.
本発明の第3特徴によると、機体が走行停止状態になると第2制御ゲインが零に変更されるので、機体の走行停止状態において、変化速度検出手段により作業装置の姿勢変化の変化速度が検出されても(作業装置の姿勢変化の変化速度が変化しても)、変化速度検出手段の検出値によりアクチュエータが作動することがない。 According to the third feature of the present invention, the second control gain is changed to zero when the aircraft is in the travel stop state, so that the change speed detecting means detects the change speed of the posture change of the work device in the travel stop state of the airframe. Even if it is done (even if the change speed of the posture change of the working device changes), the actuator is not operated by the detection value of the change speed detecting means.
(発明の効果)
本発明の第3特徴によると、本発明の第1又は第2特徴と同様に前項[I][II]に記載の「発明の効果」を備えており、これに加えて以下のような「発明の効果」を備えている。
本発明の第3特徴によると、機体の走行停止状態において、変化速度検出手段により作業装置の姿勢変化の変化速度が検出されても(作業装置の姿勢変化の変化速度が変化しても)、変化速度検出手段の検出値によりアクチュエータが作動することがないようにすることにより、機体の走行停止状態での作業装置の姿勢の安定化を図ることができた。
(The invention's effect)
According to the third feature of the present invention, the “effect of the invention” described in the preceding paragraphs [I] and [II] is provided in the same manner as the first or second feature of the present invention. The effect of the invention is provided.
According to the third feature of the present invention, even when the change speed detecting means detects the change speed of the posture change of the work device (even if the change speed of the change posture of the work device is changed) in the traveling stop state of the aircraft, By preventing the actuator from being actuated by the detection value of the change speed detecting means, it was possible to stabilize the posture of the work device when the machine body was stopped.
[IV]
(構成)
本発明の第4特徴は、本発明の第1〜第3特徴の作業車の作業装置姿勢変更構造のうちのいずれか一つにおいて次のように構成することにある。
作業地に接地追従する接地体を作業装置に昇降自在に備える。接地体から作業装置までの高さを作業装置の姿勢として検出するように姿勢検出手段を構成し、接地体の昇降速度を作業装置の姿勢変化の変化速度として検出するように変化速度検出手段を構成する。接地体の作業地への接地追従感度を変更する感度変更手段を備える。感度変更手段が鈍感側に設定されると第2制御ゲインが小側に変更されるように、制御ゲイン変更手段を構成する。
[IV]
(Constitution)
A fourth feature of the present invention resides in the following configuration in any one of the working device attitude changing structures for a work vehicle according to the first to third features of the present invention.
A grounding body for following the ground to the work site is provided on the work device so as to be raised and lowered. The posture detection means is configured to detect the height from the grounding body to the work device as the posture of the work device, and the change speed detection means is configured to detect the ascending / descending speed of the grounding body as the change speed of the posture change of the work device. Constitute. Sensitivity changing means is provided for changing the ground contact tracking sensitivity of the grounding body to the work site. The control gain changing means is configured such that when the sensitivity changing means is set to the insensitive side, the second control gain is changed to the small side.
(作用)
本発明の第4特徴によると、本発明の第1〜第3特徴のうちのいずれか一つと同様に前項[I]〜[III]に記載の「作用」を備えており、これに加えて以下のような「作用」を備えている。
本発明の第4特徴によると、作業地に接地追従する接地体を作業装置に昇降自在に備えて、接地体から作業装置までの高さを作業装置の姿勢として検出するように姿勢検出手段を構成し、接地体の昇降速度を作業装置の姿勢変化の変化速度として検出するように変化速度検出手段を構成しており、接地体の作業地への接地追従感度を変更する感度変更手段を備えている。この場合、一般に作業地が固く凹凸が多い場合には、感度変更手段が鈍感側に変更され、作業地が柔らかく凹凸が少ない場合には、感度変更手段が敏感側に変更される。
(Function)
According to the 4th characteristic of this invention, it is equipped with "action" of previous clause [I]-[III] similarly to any one of the 1st-3rd characteristics of this invention, In addition to this, It has the following “actions”.
According to a fourth aspect of the present invention, the work device is provided with a grounding body that follows the ground and follows the work ground so that the work device can freely move up and down, and the posture detection means is configured to detect the height from the grounding body to the work device as the posture of the work device. And a change speed detecting means is configured to detect the ascending / descending speed of the grounding body as a change speed of the posture change of the working device, and a sensitivity changing means for changing the grounding follow-up sensitivity to the work ground of the grounding body is provided. ing. In this case, in general, when the work place is hard and has a lot of unevenness, the sensitivity changing means is changed to the insensitive side, and when the work place is soft and has little unevenness, the sensitivity changing means is changed to the sensitive side.
作業地が固く凹凸が多い場合、作業装置の姿勢が変化し易く、作業装置の姿勢変化の変化速度も速くなり易いので、感度変更手段を敏感側に変更することにより、作業装置の姿勢の頻繁な変更を抑えて、作業装置の姿勢の安定を図ることがある。
この場合に、本発明の第4特徴によれば、感度変更手段が鈍感側に設定されると、第2制御ゲインが小側に変更されるので、前項[I]に記載のように、変化速度検出手段の検出値によりアクチュエータが作動を開始する場合、変化速度検出手段の検出値の割りに(作業装置の姿勢変化の変化速度の割りに)、アクチュエータが低速で作動するように設定することができるのであり、作業装置の姿勢の安定をさらに図ることができる。
If the work area is hard and there are many irregularities, the posture of the work device is likely to change, and the change speed of the posture change of the work device is likely to increase. In some cases, the posture of the work device is stabilized by suppressing a change.
In this case, according to the fourth feature of the present invention, when the sensitivity changing means is set to the insensitive side, the second control gain is changed to the small side. When the actuator starts to operate according to the detection value of the speed detection means, set the actuator to operate at a low speed for the detection value of the change speed detection means (for the change speed of the posture change of the work equipment) Therefore, the posture of the working device can be further stabilized.
(発明の効果)
本発明の第4特徴によると、本発明の第1〜第3特徴のうちのいずれか一つと同様に前項[I]〜[III]に記載の「発明の効果」を備えており、これに加えて以下のような「発明の効果」を備えている。
本発明の第4特徴によると、接地体の作業地への接地追従感度を変更する感度変更手段を備えた場合、感度変更手段が鈍感側に設定されると、第2制御ゲインが小側に変更されるように構成することにより、作業地が固く凹凸が多い場合での作業装置の姿勢の安定を図ることができて、姿勢制御手段の性能の向上を図ることができた。
(The invention's effect)
According to the fourth feature of the present invention, the “effect of the invention” described in the preceding paragraphs [I] to [III] is provided similarly to any one of the first to third features of the present invention. In addition, the following “effects of the invention” are provided.
According to the fourth feature of the present invention, in the case of including the sensitivity changing means for changing the contact tracking sensitivity of the grounding body to the work site, when the sensitivity changing means is set to the insensitive side, the second control gain is set to the small side. By being configured to be changed, it is possible to stabilize the posture of the working device when the work place is hard and there are many irregularities, and the performance of the posture control means can be improved.
[1]
図1に示すように、右及び左の前輪1、右及び左の後輪2で支持された機体の後部に、リンク機構3が昇降自在に支持されて、リンク機構3を昇降駆動する単動型の油圧シリンダ4(アクチュエータに相当)が備えられており、リンク機構3の後部に苗植付装置5(作業装置に相当)が支持されて、作業車の一例である乗用型田植機が構成されている。
[1]
As shown in FIG. 1, a
図1に示すように、苗植付装置5は、4個の植付伝動ケース6、植付伝動ケース6の後部の左右に回転駆動自在に支持された回転ケース7、回転ケース7の両端に備えられた一対の植付アーム8、複数の接地フロート9、苗のせ台10等を備えて、8条植型式に構成されている。これにより、苗のせ台10が左右に往復横送り駆動されるのに伴って、回転ケース7が回転駆動され、苗のせ台10の下部から植付アーム8が交互に苗を取り出して田面Gに植え付ける。
As shown in FIG. 1, the
図1に示すように、運転座席13の後側に、肥料を貯留するホッパー14及び2条単位の4個の繰り出し部15が備えられて、運転座席13の下側にブロア16が備えられている。接地フロート9に作溝器17が備えられて、繰り出し部15と作溝器17とに亘ってホース18が接続されている。これにより、ホッパー14の肥料が繰り出し部15により所定量ずつ繰り出されホース18を介して搬送され、作溝器17によって田面Gに形成された溝に供給される。
As shown in FIG. 1, a
[2]
次に、苗植付装置5の昇降制御手段(姿勢制御手段に相当)について説明する。
図2に示すように、油圧シリンダ4に作動油を供給する電磁操作式の上昇制御弁24、及び油圧シリンダ4から作動油を排出する電磁操作式の下降制御弁25が備えられて、制御装置23により上昇及び下降制御弁24,25がデューティ制御により操作される。上昇制御弁24により油圧シリンダ4に作動油が供給されると、油圧シリンダ4が収縮作動して苗植付装置5が上昇し、下降制御弁25により油圧シリンダ4から作動油が排出されると、油圧シリンダ4が伸長作動して苗植付装置5が下降する。
[2]
Next, the raising / lowering control means (equivalent to an attitude | position control means) of the
As shown in FIG. 2, an electromagnetically operated up
図2に示すように、苗植付装置5の横軸芯P1周りに中央の接地フロート9(接地体に相当)の後部が上下に揺動自在に支持され、中央の接地フロート9の上方の苗植付装置5の固定部にポテンショメータ22(姿勢検出手段に相当)が固定されており、ポテンショメータ22の検出アーム22aと中央の接地フロート9の前部とに亘ってロッド26が接続され、ポテンショメータ22の検出値B1が制御装置23に入力されている。機体の進行に伴って中央の接地フロート9が田面Gに接地追従するのであり、ポテンショメータ22の検出値B1により、田面G(中央の接地フロート9)からポテンショメータ22までの高さを検出することができ、田面G(中央の接地フロート9)から苗植付装置5までの高さを検出することができる。
As shown in FIG. 2, the rear part of the center grounding float 9 (corresponding to the grounding body) is supported around the horizontal axis P1 of the
図2に示すように、人為的に操作可能な感度ダイヤル27(感度変更手段に相当)が備えられており、感度ダイヤル27の操作位置が制御装置23に入力されている。図2に示す状態は、感度ダイヤル27が中立位置Nに操作された状態であり、中央の接地フロート9の底面が水平となるポテンショメータ22の検出値B1が、植付設定高さA0(設定深さ)に対応する設定検出値A1(目標姿勢に相当)として設定された状態である。
As shown in FIG. 2, a sensitivity dial 27 (corresponding to sensitivity changing means) that can be manually operated is provided, and the operation position of the
図2に示す状態において、中央の接地フロート9が田面Gに接地追従するのに対して、苗植付装置5が上下動すると、これに伴って田面G(中央の接地フロート9)から苗植付装置5までの高さ(苗の植付深さ)が変化しようとする。
後述する[4][5]に記載のように、田面G(中央の接地フロート9)から苗植付装置5までの高さ(苗の植付深さ)がポテンショメータ22により検出されて、ポテンショメータ22の検出値B1が設定検出値A1(植付設定高さA0(設定深さ))となるように、制御装置23により上昇及び下降制御弁24,25が操作され、油圧シリンダ4により苗植付装置5が昇降駆動されて、苗植付装置5が田面Gから植付設定高さA0(設定深さ)に維持されるのであり、苗植付装置5による苗の植付深さが設定深さに維持される(昇降制御手段)。
In the state shown in FIG. 2, the
As described in [4] and [5], which will be described later, the
図2に示すように、感度ダイヤル27を中立位置Nに操作していると、中央の接地フロート9の底面が水平となるポテンショメータ22の検出値B1が、植付設定高さA0(設定深さ)に対応する設定検出値A1として設定された状態となる。
田面Gの泥が柔らかく(田面Gの水が多く)、田面Gの凹凸が少ない場合、一般に感度ダイヤル27を中立位置Nから敏感側に操作する。感度ダイヤル27を中立位置Nから敏感側に操作すると、設定検出値A1が感度ダイヤル27の操作位置に対応して少し低側に変更される。これによって、設定検出値A1での中央の接地フロート9の底面が少し下向きとなり、中央の接地フロート9の田面Gへの接地面積が大きくなって、中央の接地フロート9が田面Gに敏感に追従するようになる(接地体の作業地への接地追従感度が敏感側に変更された状態に相当)。
As shown in FIG. 2, when the
When the mud on the surface G is soft (the water on the surface G is much) and the unevenness on the surface G is small, the
田面Gの泥が固く(田面Gの水が少なく)、田面Gの凹凸が多い場合、一般に感度ダイヤル27を中立位置Nから鈍感側に操作する。感度ダイヤル27を中立位置Nから鈍感側に操作すると、図2に示す設定検出値A1が感度ダイヤル27の操作位置に対応して少し高側に変更される。これによって、設定検出値A1での中央の接地フロート9の底面が少し上向きとなり、中央の接地フロート9の田面Gへの接地面積が小さくなって、中央の接地フロート9が田面Gに鈍感に追従するようになる(接地体の作業地への接地追従感度が鈍感側に変更された状態に相当)。
When the mud on the surface G is hard (the water on the surface G is small) and the surface G is rough, the
[3]
次に、上昇及び下降制御弁24,25のデューティ制御(デューティT1)について説明する。
図2に示すように、上昇制御弁24は作動油の供給位置及び遮断位置の2位置に操作自在で電磁操作式に構成されており、下降制御弁25は作動油の排出位置及び遮断位置の2位置に操作自在で電磁操作式に構成されている。図3に示すように、上昇及び下降制御弁24,25が供給位置(排出位置)及び遮断位置に高速で繰り返して操作されるデューティ制御が行われており、単位時間T3に対する供給位置(排出位置)に操作されている時間T4の比(T4/T3)であるデューティ比T1を変更することによって、上昇制御弁24から供給される作動油の流量(下降制御弁25から排出される作動油の流量)を変更することができる。
[3]
Next, the duty control (duty T1) of the raising and lowering
As shown in FIG. 2, the raising
これにより、制御装置23によりデューティ比T1が設定され、制御装置23の操作信号(デューティ比T1)により、上昇及び下降制御弁24,25が供給位置(排出位置)及び遮断位置に高速で繰り返して操作されて、上昇及び下降制御弁24,25による作動油の流量制御が行われるのであり、油圧シリンダ4の伸縮速度(作動油の流量)を任意に設定及び変更することができる。図2に示すように、リンク機構3の上下角度を検出するポテンショメータ11が備えられ、ポテンショメータ11の検出値が制御装置23に入力されており、ポテンショメータ11の検出値により油圧シリンダ4の停止及び伸縮作動、停止位置の検出を行うのであり、ポテンショメータ11の検出値を微分処理して、油圧シリンダ4の伸縮速度を演算する。
Thereby, the duty ratio T1 is set by the
デューティ制御では、デューティ比T1は0%から100%まで設定が可能である。しかしながら、油圧シリンダ4、上昇及び下降制御弁24,25においては、デューティ比T1を0%から100%まで設定しても、デューティ比T1が0%に近い付近では作動油の流量が少なすぎて、油圧シリンダ4は伸縮作動しない。デューティ比T1が100%に近い付近では、作動油の流量が飽和状態となって、デューティ比T1を変更しても油圧シリンダ4の伸縮速度(作動油の流量)は変化しない。
多数が生産される上昇及び下降制御弁24,25には個体差が存在しており、例えば一つの上昇制御弁24をデューティ比T1で操作した際の油圧シリンダ4の収縮速度(作動油の流量)と、別の上昇制御弁24を同じデューティ比T1で操作した際の油圧シリンダ4の収縮速度(作動油の流量)が異なることがある。
In the duty control, the duty ratio T1 can be set from 0% to 100%. However, in the
There are individual differences in the ascending and descending
前述のような状態に対して、制御装置23に修正モードが設定されており、生産工場の出荷時、上昇及び下降制御弁24,25の交換やメンテナンスを行った場合に、修正モードを作動させる。
図1に示すように、苗のせ台10に標準的な数の苗を載置した状態(例えば苗のせ台10の1つの苗のせ面に1〜2枚の苗を載置した状態)において、修正モードを作動させると、図4に示すように、上昇制御弁24に対する制御装置23の操作信号(デューティ比T1)が0%から少しずつ上昇していき、油圧シリンダ4が停止状態から収縮作動を開始するデューティ比T11が検出される。この場合、一般に油圧シリンダ4は停止状態に近い超低速で収縮作動するのではなく、ある程度の大きさの収縮速度(作動油の流量)V01で、急に収縮作動を開始するような状態になることが多い。
The correction mode is set in the
As shown in FIG. 1, in a state where a standard number of seedlings are placed on the seedling stage 10 (for example, a state where one or two seedlings are placed on one seedling surface of the seedling stage 10), When the correction mode is activated, as shown in FIG. 4, the operation signal (duty ratio T1) of the
図4に示すように、制御装置23の操作信号(デューティ比T1)と作動油の流量(油圧シリンダ4の収縮速度)とが線型関係になると考えられるデューティ比T1の範囲において、下限及び上限と思われるデューティ比T12,T13が事前に設定されている。これにより、制御装置23の操作信号(デューティ比T12)により上昇制御弁24が操作されて、このときの油圧シリンダ4の収縮速度(作動油の流量)V2がポテンショメータ11の検出値に基づいて検出され、次に制御装置23の操作信号(デューティ比T13)により上昇制御弁24が操作されて、このときの油圧シリンダ4の収縮速度(作動油の流量)V3がポテンショメータ11の検出値に基づいて検出される。
As shown in FIG. 4, in the range of the duty ratio T1 in which the operation signal (duty ratio T1) of the
図4に示すように、デューティ比T12,T13及び油圧シリンダ4の収縮速度(作動油の流量)V2,V3に基づいて、一次関数としての関係式Y1が設定される。関係式Y1をデューティ比T11まで延長した場合、関係式Y1によるデューティ比T11の油圧シリンダ4の収縮速度(作動油の流量)V1が得られるとする。
前述のように、デューティ比T11で油圧シリンダ4が停止状態から収縮作動を開始した際の油圧シリンダ4の収縮速度(作動油の流量)V01と、関係式Y1によるデューティ比T11の油圧シリンダ4の収縮速度(作動油の流量)V1とが一致しなくても、油圧シリンダ4の収縮速度(作動油の流量)V01,V1の差は小さいはずなので、関係式Y1によるデューティ比T11の油圧シリンダ4の収縮速度(作動油の流量)V1が、デューティ比T11で油圧シリンダ4が停止状態から収縮作動を開始した際の収縮速度(作動油の流量)として設定される。
As shown in FIG. 4, a relational expression Y1 as a linear function is set based on the duty ratios T12 and T13 and the contraction speeds (flow rates of hydraulic oil) V2 and V3 of the
As described above, the contraction speed (hydraulic oil flow rate) V01 of the
これにより、上昇制御弁24において、デューティ比T11,T13及び油圧シリンダ4の収縮速度(作動油の流量)V1,V3の範囲で、関係式Y1が設定される。下降制御弁25においても前述の上昇制御弁24での操作と同じ操作が行われ、下降制御弁25において、デューティ比T11,T13及び油圧シリンダ4の収縮速度(作動油の流量)V1,V3の範囲で、関係式Y1が設定される。
As a result, in the ascending
[4]
次に、昇降制御手段の作動の前半について、図6に基づいて説明する。
田面G(中央の接地フロート9)から苗植付装置5までの高さ(田面G(中央の接地フロート9)からポテンショメータ22までの高さ)として、ポテンショメータ22の検出値B1が制御装置23に入力され(ステップS1)、ポテンショメータ22の検出値B1と設定検出値A1との差が、偏差B3(B3=A1−B1)(姿勢検出手段の検出値と目標姿勢との偏差に相当)として検出される(ステップS2)。
[4]
Next, the first half of the operation of the lifting control means will be described with reference to FIG.
The detected value B1 of the
この場合、偏差B3が正の値であると、田面G(中央の接地フロート9)から苗植付装置5までの高さ(田面G(中央の接地フロート9)からポテンショメータ22までの高さ)が、植付設定高さA0(設定深さ)よりも上側(高側)に位置していることを意味し、偏差B3が負の値であると、田面G(中央の接地フロート9)から苗植付装置5までの高さ(田面G(中央の接地フロート9)からポテンショメータ22までの高さ)が、植付設定高さA0(設定深さ)よりも下側(低側)に位置していることを意味している。 In this case, if the deviation B3 is a positive value, the height from the field G (center grounding float 9) to the seedling planting device 5 (the height from the field G (center grounding float 9) to the potentiometer 22). Means that it is located on the upper side (higher side) than the planting set height A0 (set depth), and if the deviation B3 is a negative value, from the surface G (center grounding float 9) The height to the seedling planting device 5 (the height from the surface G (center grounding float 9) to the potentiometer 22) is lower (lower side) than the planting set height A0 (set depth). It means that
ポテンショメータ22の検出値B1が微分処理されて、中央の接地フロート9の昇降速度が検出され、これによって苗植付装置5の昇降速度B2(作業装置の姿勢変化の変化速度に相当)が検出される(ステップS3)(変化速度検出手段に相当)。苗植付装置5の昇降速度B2が正の値であると、苗植付装置5が上昇状態であることを意味し、苗植付装置5の昇降速度B2が負の値であると、苗植付装置5が下降状態であることを意味している。
The detection value B1 of the
設定検出値A1に対して、不感帯H1が設定されている。ポテンショメータ22の検出値B1が、設定検出値A1の不感帯H1に入っていると(ステップS4)、第1制御ゲインK1が「0」に設定され(ステップS5)、ポテンショメータ22の検出値B1が、設定検出値A1の不感帯H1から外れていると(ステップS4)、第1制御ゲインK1が事前に記憶されている一定値に設定される(ステップS6)。
この場合、第1制御ゲインK1が事前に記憶されている一定値に設定されるように構成するのではなく、後述する第2制御ゲインK2と同様に、図5の実線Y3及び一点鎖線Y4に示すように、感度ダイヤル27の操作位置に応じて、第1制御ゲインK1が設定されるように構成してもよい。
A dead zone H1 is set for the set detection value A1. When the detected value B1 of the
In this case, the first control gain K1 is not configured to be set to a constant value stored in advance, but the solid line Y3 and the alternate long and short dash line Y4 in FIG. As shown, the first control gain K1 may be set according to the operation position of the
苗植付装置5の昇降速度B2において、「0」(苗植付装置5の昇降が停止した状態)に対して、不感帯H2が設定されている(不感帯H1に比べて、不感帯H2は十分に小さい)。苗植付装置5の昇降速度B2が「0」の不感帯H2に入っていると(ステップS7)、第2制御ゲインK2が「0」に設定される(ステップS8)。苗植付装置5の昇降速度B2が「0」の不感帯H2から外れていると(ステップS7)、この時の感度ダイヤル27の操作位置に応じて、第2制御ゲインK2が設定される(ステップS9)(制御ゲイン変更手段に相当)。
At the lifting speed B2 of the
図5の実線Y3に示すように、感度ダイヤル27が中立位置Nから敏感側に操作されると、第2制御ゲインK2が高い一定の値K22に設定される。感度ダイヤル27が中立位置Nから鈍感側に操作されると、第2制御ゲインK2の値K22及び小さい値K21(「0」ではない)との間において、感度ダイヤル27の操作位置が鈍感側であるほど、第2制御ゲインK2が小側の値に設定される。
この場合、図5の一点鎖線Y4に示すように、感度ダイヤル27が中立位置Nから鈍感側に操作されると、第2制御ゲインK2が低い一定の値K23に設定されるように構成してもよい。図5の実線Y3及び一点鎖線Y4において、感度ダイヤル27が中立位置Nから敏感側に操作されるほど、第2制御ゲインK2が高側の値に設定されるように構成してもよい。
As shown by the solid line Y3 in FIG. 5, when the
In this case, as shown by a one-dot chain line Y4 in FIG. 5, when the
[5]
次に、昇降制御手段の作動の後半について、図6に基づいて説明する。
前項[4]に記載のように、偏差B3(正又は負の値)、苗植付装置5の昇降速度B2(正又は負の値)、第1及び第2制御ゲインK1,K2(正の値)が得られると、偏差B3に第1制御ゲインK1を乗じた値と、苗植付装置5の昇降速度B2に第2制御ゲインK2を乗じた値との和が、油圧シリンダ4の目標伸縮速度(作動油の流量)VKとして求められる(ステップS10)。
[5]
Next, the second half of the operation of the lifting control means will be described with reference to FIG.
As described in the preceding item [4], the deviation B3 (positive or negative value), the raising / lowering speed B2 (positive or negative value) of the
ステップS10において、田面G(中央の接地フロート9)から苗植付装置5までの高さ(田面G(中央の接地フロート9)からポテンショメータ22までの高さ)が、植付設定高さA0(設定深さ)よりも上側(高側)に外れているほど(下側(低側)に外れているほど)、油圧シリンダ4の目標伸縮速度(作動油の流量)VKが大側の正の値(上側(高側))、又は大側の負の値(下側(低側))となる。 In step S10, the height from the field surface G (center grounding float 9) to the seedling planting device 5 (the height from the field surface G (center grounding float 9) to the potentiometer 22) is the planting set height A0 ( The higher the setting depth is, the higher the value is (the higher the value is), the lower the value is (the lower the value is)). Value (upper side (high side)) or negative value on the large side (lower side (low side)).
ステップS10において、田面G(中央の接地フロート9)から苗植付装置5までの高さ(田面G(中央の接地フロート9)からポテンショメータ22までの高さ)が、植付設定高さA0(設定深さ)よりも上側(高側)に外れている状態において、苗植付装置5の昇降速度B2が正の大側の値であるほど(苗植付装置5が高速の上昇状態であるほど)、油圧シリンダ4の目標伸縮速度(作動油の流量)VKがさらに正の大側の値に補正され、苗植付装置5の昇降速度B2が負の大側の値であるほど(苗植付装置5が高速の下降状態であるほど)、油圧シリンダ4の目標伸縮速度(作動油の流量)VKが正の小側の値に補正される。
In step S10, the height from the field surface G (center grounding float 9) to the seedling planting device 5 (the height from the field surface G (center grounding float 9) to the potentiometer 22) is the planting set height A0 ( In a state where it is off the upper side (higher side) than the set depth), the raising / lowering speed B2 of the
ステップS10において、田面G(中央の接地フロート9)から苗植付装置5までの高さ(田面G(中央の接地フロート9)からポテンショメータ22までの高さ)が、植付設定高さA0(設定深さ)よりも下側(低側)に外れている状態において、苗植付装置5の昇降速度B2が負の大側の値であるほど(苗植付装置5が高速の下降状態であるほど)、油圧シリンダ4の目標伸縮速度(作動油の流量)VKがさらに負の大側の値に補正され、苗植付装置5の昇降速度B2が正の大側の値であるほど(苗植付装置5が高速の上昇状態であるほど)、油圧シリンダ4の目標伸縮速度(作動油の流量)VKが負の小側の値に補正される。
In step S10, the height from the field surface G (center grounding float 9) to the seedling planting device 5 (the height from the field surface G (center grounding float 9) to the potentiometer 22) is the planting set height A0 ( In a state where it is below the set depth) (low side), the higher the ascending / descending speed B2 of the
前述のようにして求められた油圧シリンダ4の目標伸縮速度(作動油の流量)VKにより、図4に示す関係式Y1に基づいて、デューティ比T1が求められる(ステップS11)。油圧シリンダ4の目標伸縮速度(作動油の流量)VKが油圧シリンダ4の収縮速度(作動油の流量)V1よりも低側(小側)の値であると、デューティ比T1がT11に設定され、油圧シリンダ4の目標伸縮速度(作動油の流量)VKが油圧シリンダ4の収縮速度(作動油の流量)V3よりも高側(大側)の値であると、デューティ比T1がT13に設定される。
Based on the target expansion / contraction speed (hydraulic oil flow rate) VK of the
偏差B3が正の値である場合、田面G(中央の接地フロート9)から苗植付装置5までの高さ(田面G(中央の接地フロート9)からポテンショメータ22までの高さ)が、植付設定高さA0(設定深さ)よりも上側(高側)に外れているとなって、制御装置23の操作信号(デューティ比T1)により、下降制御弁25が排出位置及び遮断位置に高速で繰り返して操作され、下降制御弁25による作動油の流量制御が行われながら、油圧シリンダ4の目標伸縮速度(作動油の流量)VKで油圧シリンダ4の伸長作動して苗植付装置5が下降する(ステップS12)。
When the deviation B3 is a positive value, the height from the field G (center grounding float 9) to the seedling planting device 5 (height from the field G (center grounding float 9) to the potentiometer 22) is planted. The height of the lowering
偏差B3が負の値である場合、田面G(中央の接地フロート9)から苗植付装置5までの高さ(田面G(中央の接地フロート9)からポテンショメータ22までの高さ)が、植付設定高さA0(設定深さ)よりも下側(低側)に外れているとなって、制御装置23の操作信号(デューティ比T1)により、上昇制御弁24が供給位置及び遮断位置に高速で繰り返して操作され、上昇制御弁25による作動油の流量制御が行われながら、油圧シリンダ4の目標伸縮速度(作動油の流量)VKで油圧シリンダ4の収縮作動して苗植付装置5が上昇する(ステップS12)。
When the deviation B3 is a negative value, the height from the field surface G (center grounding float 9) to the seedling planting device 5 (the height from the field surface G (center grounding float 9) to the potentiometer 22) is planted. The
これにより、ステップS1〜S12が繰り返して行われ、ポテンショメータ22の検出値B1が、設定検出値A1の不感帯H1に入るように、油圧シリンダ4により苗植付装置5が昇降駆動されて、苗植付装置5が田面Gから植付設定高さA0(設定深さ)に維持されるのであり、苗植付装置5による苗の植付深さが設定深さに維持される。
Thereby, steps S1 to S12 are repeated, and the
[発明の実施の第1別形態]
前述の[発明を実施するための最良の形態]の図6に代えて、図7に示すように構成してもよい。
機体の走行速度を検出する走行速度検出手段(図示せず)を備える。この場合、走行用の伝動軸の回転数を検出して機体の走行速度を検出したり、エンジン(図示せず)の回転数を検出して機体の走行速度を検出したりするように、走行速度検出手段が構成されている。図6に示すステップS9が廃止されて、図7に示すようにステップS21,S22が設定されている。
[First Alternative Embodiment of the Invention]
Instead of FIG. 6 in [Best Mode for Carrying Out the Invention], a configuration as shown in FIG. 7 may be used.
A traveling speed detecting means (not shown) for detecting the traveling speed of the airframe is provided. In this case, the vehicle travels so as to detect the traveling speed of the airframe by detecting the rotational speed of the transmission shaft for traveling, or to detect the rotational speed of the airframe by detecting the rotational speed of the engine (not shown). A speed detection means is configured. Step S9 shown in FIG. 6 is abolished, and steps S21 and S22 are set as shown in FIG.
図7に示すように、苗植付装置5の昇降速度B2が「0」の不感帯H2から外れている場合(ステップS7)、機体が走行停止状態又は機体の走行速度が極低速VV1未満の場合、ステップS8に移行して第2制御ゲインK2が「0」に設定される。機体の走行速度が極低速VV1以上の場合、機体の走行速度に応じて、第2制御ゲインK2が設定される(ステップS22)(制御ゲイン変更手段に相当)。
As shown in FIG. 7, when the raising / lowering speed B2 of the
図8の実線Y5に示すように、第2制御ゲインK2の小さい値K21(「0」ではない)と大きい値K22との間において、機体の走行速度が高速であるほど、第2制御ゲインK2が大側の値に設定され、機体の走行速度が低速であるほど、第2制御ゲインK2が小側の値に設定される。
この場合、図8の一点鎖線Y6に示すように、機体の走行速度が極低速VV1と中間速度VV3との間であると、第2制御ゲインK2が小さい一定の値K23に設定され、機体の走行速度が中間速度VV3と最高速度VV2との間であると、第2制御ゲインK2が大きい一定の値K22に設定されるように構成してもよい。
As indicated by the solid line Y5 in FIG. 8, the second control gain K2 increases as the traveling speed of the aircraft increases between a small value K21 (not "0") and a large value K22 of the second control gain K2. Is set to a larger value, and the second control gain K2 is set to a smaller value as the aircraft travels at a lower speed.
In this case, as indicated by the one-dot chain line Y6 in FIG. 8, when the traveling speed of the aircraft is between the extremely low speed VV1 and the intermediate speed VV3, the second control gain K2 is set to a small constant value K23. If the traveling speed is between the intermediate speed VV3 and the maximum speed VV2, the second control gain K2 may be set to a large constant value K22.
[発明の実施の第2別形態]
前述の[発明を実施するための最良の形態][発明の実施の第1別形態]の図4に代えて、図9に示すように構成してもよい。
図9に示すように、苗のせ台10に標準的な数の苗を載置した状態(例えば苗のせ台10の1つの苗のせ面に1〜2枚の苗を載置した状態)において、修正モードを作動させると、上昇制御弁24に対する制御装置23の操作信号(デューティ比T1)が0%から少しずつ上昇していき、油圧シリンダ4が停止状態から収縮作動を開始するデューティ比T11が検出される。
[Second Embodiment of the Invention]
Instead of FIG. 4 of [Best Mode for Carrying Out the Invention] [First Alternative Embodiment of the Invention], a configuration as shown in FIG. 9 may be used.
As shown in FIG. 9, in a state where a standard number of seedlings are placed on the seedling stage 10 (for example, a state where one or two seedlings are placed on one seedling surface of the seedling stage 10), When the correction mode is activated, the operation signal (duty ratio T1) of the
図9に示すように、制御装置23の操作信号(デューティ比T1)と作動油の流量(油圧シリンダ4の収縮速度)とが線型関係になると考えられるデューティ比T1の範囲において、下限及び上限と思われるデューティ比T12,T13が事前に設定されている。これにより、制御装置23の操作信号(デューティ比T12)により上昇制御弁24が操作されて、このときの油圧シリンダ4の収縮速度(作動油の流量)V2がポテンショメータ11の検出値に基づいて検出され、次に制御装置23の操作信号(デューティ比T13)により上昇制御弁24が操作されて、このときの油圧シリンダ4の収縮速度(作動油の流量)V3がポテンショメータ11の検出値に基づいて検出される。
As shown in FIG. 9, in the range of the duty ratio T1 in which the operation signal (duty ratio T1) of the
図9に示すように、デューティ比T12,T13及び油圧シリンダ4の収縮速度(作動油の流量)V2,V3に基づいて、一次関数としての関係式Y1が設定される。油圧シリンダ4が停止状態から収縮作動を開始するデューティ比T11において、油圧シリンダ4の収縮速度(作動油の流量)を「0」とし、デューティ比T11,T12及び油圧シリンダ4の収縮速度(作動油の流量)V2に基づいて、一次関数としての関係式Y2が設定される。
As shown in FIG. 9, a relational expression Y1 as a linear function is set based on the duty ratios T12 and T13 and the contraction speeds (hydraulic oil flow rates) V2 and V3 of the
これにより、上昇制御弁24において、デューティ比T11,T13及び油圧シリンダ4の収縮速度「0」,V3の範囲で、関係式Y1,Y2が設定される。下降制御弁25においても前述の上昇制御弁24での操作と同じ操作が行われ、下降制御弁25において、デューティ比T11,T13及び油圧シリンダ4の収縮速度「0」,V3の範囲で、関係式Y1,Y2が設定される。
Thereby, in the rising
[発明の実施の第3別形態]
前述の[発明を実施するための最良の形態][発明の実施の第1別形態][発明の実施の第2別形態]において、ポテンショメータ22の検出値B1を微分処理して、苗植付装置5の昇降速度B2を検出するのではなく、専用の昇降速度センサー(変化速度検出手段に相当)を備えたり、昇降加速度センサー(変化速度検出手段に相当)を備え、積分処理によって苗植付装置5の昇降速度B2を検出するように構成してもよい。
[Third Another Embodiment of the Invention]
In the above-mentioned [Best Mode for Carrying Out the Invention] [First Alternative Embodiment of the Invention] [Second Alternative Embodiment of the Invention], the detected value B1 of the
[発明の実施の第4別形態]
前述の[発明を実施するための最良の形態][発明の実施の第1別形態]〜[発明の実施の第3別形態]において、感度ダイヤル27の操作位置や機体の走行速度に関係なく、第2制御ゲインK2を人為的に任意に設定及び変更(「0」も含む)できるように構成してもよい。
[Fourth Embodiment of the Invention]
In the above-mentioned [Best Mode for Carrying Out the Invention] [First Alternative Embodiment] to [Third Alternative Embodiment] regardless of the operating position of the
前述の[発明を実施するための最良の形態][発明の実施の第1別形態]〜[発明の実施の第3別形態]において、感度ダイヤル27の操作位置や機体の走行速度に応じて、第1制御ゲインK1も変更されるように構成してもよく、感度ダイヤル27の操作位置や機体の走行速度に関係なく、第1制御ゲインK1を人為的に任意に設定及び変更(「0」も含む)できるように構成してもよい。
本発明は乗用型田植機ばかりではなく、作業装置として直播装置や薬剤散布装置を機体に連結した水田作業機や、農用トラクタやコンバインにも適用でき、作業装置の昇降制御ばかりではなく、作業装置のローリング制御にも適用できる。
In the above-mentioned [Best Mode for Carrying Out the Invention] [First Different Embodiment of the Invention] to [Third Another Embodiment of the Invention], depending on the operating position of the
The present invention can be applied not only to a riding type rice transplanter, but also to a paddy field work machine in which a direct seeding device or a chemical spraying device is connected as a work device, an agricultural tractor, or a combiner. It can also be applied to rolling control.
4 アクチュエータ
5 作業装置
9 接地体
22 姿勢検出手段
27 感度変更手段
A1 目標姿勢
B1 姿勢検出手段の検出値
B2 作業装置の姿勢変化の変化速度、接地体の昇降速度
K1 第1制御ゲイン
K2 第2制御ゲイン
G 作業地
4
Claims (4)
前記作業装置の姿勢を検出する姿勢検出手段と、前記作業装置の姿勢変化の変化速度を検出する変化速度検出手段とを備えて、
前記姿勢検出手段の検出値が目標姿勢から外れるほど、前記アクチュエータを第1制御ゲインに基づいて高速で作動させ、前記変化速度検出手段の検出値が高速になるほど、前記アクチュエータを第2制御ゲインに基づいて高速で作動させて、前記アクチュエータにより作業装置を目標姿勢に維持する姿勢制御手段を備えると共に、
前記第2制御ゲインを変更可能な制御ゲイン変更手段を備えてある作業車の作業装置姿勢変更構造。 An actuator for changing the posture of the work device connected to the airframe;
A posture detecting means for detecting the posture of the working device; and a change speed detecting means for detecting a changing speed of the posture change of the working device.
The actuator is operated at a higher speed based on the first control gain as the detection value of the attitude detection means deviates from the target attitude, and the actuator is set to the second control gain as the detection value of the change speed detection means becomes higher. Based on a posture control means that operates at a high speed based on the actuator and maintains the working device in a target posture by the actuator;
A working device attitude changing structure for a work vehicle, comprising control gain changing means capable of changing the second control gain.
前記接地体から作業装置までの高さを作業装置の姿勢として検出するように姿勢検出手段を構成し、前記接地体の昇降速度を作業装置の姿勢変化の変化速度として検出するように変化速度検出手段を構成して、
前記接地体の作業地への接地追従感度を変更する感度変更手段を備えると共に、
前記感度変更手段が鈍感側に設定されると第2制御ゲインが小側に変更されるように、前記制御ゲイン変更手段を構成してある請求項1〜3のうちのいずれか一つに記載の作業車の作業装置姿勢変更構造。 A grounding body that follows the ground to the work site is provided on the working device so as to be movable up and down.
The posture detection means is configured to detect the height from the grounding body to the work device as the posture of the work device, and the change speed detection is performed so that the ascending / descending speed of the grounding body is detected as the change speed of the posture change of the work device. Constructing means
With sensitivity changing means for changing the ground contact tracking sensitivity to the work site of the grounding body,
The control gain changing means is configured such that the second control gain is changed to a small side when the sensitivity changing means is set to the insensitive side. The working device attitude change structure of the work vehicle.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007224401A JP4944712B2 (en) | 2007-08-30 | 2007-08-30 | Work vehicle attitude change structure for work vehicles |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007224401A JP4944712B2 (en) | 2007-08-30 | 2007-08-30 | Work vehicle attitude change structure for work vehicles |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009055810A JP2009055810A (en) | 2009-03-19 |
JP4944712B2 true JP4944712B2 (en) | 2012-06-06 |
Family
ID=40552146
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007224401A Active JP4944712B2 (en) | 2007-08-30 | 2007-08-30 | Work vehicle attitude change structure for work vehicles |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4944712B2 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5699036B2 (en) * | 2011-05-09 | 2015-04-08 | ヤンマー株式会社 | Rice transplanter |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58193601A (en) * | 1982-05-06 | 1983-11-11 | 株式会社クボタ | Operation structure of cultivating apparatus of cultivator |
JPS6350504A (en) * | 1986-08-18 | 1988-03-03 | 中山 好弘 | Ereasing device of trousers |
JPH0191703A (en) * | 1987-09-30 | 1989-04-11 | Kubota Ltd | Lifting controller for working machine to the ground |
JPH0746927B2 (en) * | 1988-12-28 | 1995-05-24 | 株式会社クボタ | Automatic tillage depth control device for tractors |
JP2539074B2 (en) * | 1990-04-12 | 1996-10-02 | 株式会社クボタ | Combine height control |
JP2635207B2 (en) * | 1990-10-01 | 1997-07-30 | 株式会社クボタ | Rice transplanter |
JP3302598B2 (en) * | 1997-03-10 | 2002-07-15 | 株式会社クボタ | Rice transplanter |
JP3558518B2 (en) * | 1998-03-26 | 2004-08-25 | 株式会社クボタ | Paddy working machine |
JP3189164B2 (en) * | 1999-02-19 | 2001-07-16 | 井関農機株式会社 | Work machine attitude control device for powered vehicle |
-
2007
- 2007-08-30 JP JP2007224401A patent/JP4944712B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2009055810A (en) | 2009-03-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6191556B2 (en) | Work vehicle | |
JP5308075B2 (en) | Paddy field machine | |
CN101261522B (en) | Lifting controller for agricultural working machine | |
KR20120125964A (en) | Rice transplanter | |
JP2017000095A (en) | Working vehicle | |
JP4944712B2 (en) | Work vehicle attitude change structure for work vehicles | |
JP2017099324A (en) | Work vehicle | |
JP2013247873A (en) | Seedling transplanter | |
JP4340808B2 (en) | Agricultural machine | |
JP5505198B2 (en) | Seedling transplanter | |
JPH03292810A (en) | Lifting and lowering controller of paddy field working machine | |
JP6142749B2 (en) | Seedling transplanter | |
JP5699036B2 (en) | Rice transplanter | |
JP4194101B2 (en) | Hydraulic operation structure of agricultural machine | |
JP6765294B2 (en) | Hydraulic robot | |
JP3883337B2 (en) | Paddy field machine | |
JP3302599B2 (en) | Rice transplanter lifting control | |
JP6270677B2 (en) | Paddy field machine | |
JP4625036B2 (en) | Working device operation structure of work vehicle | |
JP7142596B2 (en) | transplanter | |
JP2017195906A (en) | Work vehicle | |
JP3659034B2 (en) | Seedling transplanter | |
JP3669936B2 (en) | Work vehicle attitude control device | |
JP2987261B2 (en) | Paddy working machine | |
JP2005087093A (en) | Sulky type working machine |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20090928 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110930 |
|
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: 20120202 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120302 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4944712 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150309 Year of fee payment: 3 |