JP4895260B2 - Attitude control device - Google Patents

Attitude control device Download PDF

Info

Publication number
JP4895260B2
JP4895260B2 JP2005317882A JP2005317882A JP4895260B2 JP 4895260 B2 JP4895260 B2 JP 4895260B2 JP 2005317882 A JP2005317882 A JP 2005317882A JP 2005317882 A JP2005317882 A JP 2005317882A JP 4895260 B2 JP4895260 B2 JP 4895260B2
Authority
JP
Japan
Prior art keywords
control
automatic
tiller
tilling
vehicle speed
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
Application number
JP2005317882A
Other languages
Japanese (ja)
Other versions
JP2007124905A (en
Inventor
敏之 三輪
隆一 武山
秀和 丹生
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yanmar Co Ltd
Original Assignee
Yanmar Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Yanmar Co Ltd filed Critical Yanmar Co Ltd
Priority to JP2005317882A priority Critical patent/JP4895260B2/en
Publication of JP2007124905A publication Critical patent/JP2007124905A/en
Application granted granted Critical
Publication of JP4895260B2 publication Critical patent/JP4895260B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の自動高さ制御、自動耕深制御及び自動傾き制御を行う姿勢制御装置に関する。   The present invention relates to a posture control device that performs automatic height control, automatic tilling control, and automatic tilt control of a tiller that is connected to a vehicle main body so as to be movable up and down and tiltable to the left and right.

トラクタ等の車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の姿勢制御を行うための姿勢制御装置として、例えば、前記耕耘機を該車輌本体に対して昇降させる昇降用アクチュエータと、前記耕耘機を前記車輌本体に対して傾動させる傾動用アクチュエータと、前記耕耘機の上下高さを設定する上下位置操作手段と、前記耕耘機の耕深深さを設定する耕深深さ設定手段と、前記耕耘機の前記車輌本体に対する傾斜状態を設定する傾斜設定手段と、前記耕耘機の上下位置を検出する上下位置検出手段と、前記耕耘機の耕耘位置を検出する耕耘位置検出手段と、前記耕耘機の傾斜状態を検出する傾斜状態検出手段と、前記昇降用アクチュエータ及び前記傾動用アクチュエータを作動させる制御手段とを備え、前記耕耘機の検出上下位置を前記上下位置操作手段による設定高さ位置に追従させる自動高さ制御と、前記耕耘機の検出耕耘位置を前記耕耘深さ設定手段による設定耕深位置に追従させる自動耕深制御と、前記耕耘機の前記車輌本体に対する検出傾斜状態を前記傾斜設定手段による設定傾斜状態に追従させる自動傾き制御とを行えるように構成された姿勢制御装置が知られている(例えば、下記特許文献1参照)。   As an attitude control device for controlling the attitude of a tiller that is movable up and down and tiltable to the left and right with respect to a vehicle body such as a tractor, for example, an elevator actuator for raising and lowering the tiller with respect to the vehicle body A tilting actuator for tilting the cultivator with respect to the vehicle main body, a vertical position operating means for setting the vertical height of the cultivator, and a cultivating depth for setting the cultivating depth of the cultivator Setting means; inclination setting means for setting an inclination state of the tiller with respect to the vehicle body; vertical position detecting means for detecting the vertical position of the tiller; and tillage position detecting means for detecting the position of the tiller. And a tilting state detecting means for detecting the tilting state of the tiller, and a control means for operating the lifting actuator and the tilting actuator. Automatic height control that causes the lower position to follow the set height position by the vertical position operating means, and automatic tillage control that causes the detected tillage position of the tiller to follow the set tillage position by the tillage depth setting means, There is known an attitude control device configured to be able to perform automatic tilt control that causes a detected tilt state of the tiller with respect to the vehicle body to follow a tilt state set by the tilt setting means (for example, see Patent Document 1 below). ).

斯かる姿勢制御装置においては、非耕耘作業状態から前記上下位置操作手段を下降操作すると、前記自動高さ制御によって前記耕耘機が下降制御される。そして、該耕耘機が接地すると若しくは該耕耘機が前記耕深深さ設定手段によって設定された設定耕深位置に達すると前記自動高さ制御から前記自動耕耘制御に切り替わるようになっている。
一方、前記自動傾き制御は、前記自動高さ制御又は前記自動耕深制御の何れの制御モードが作動しているかに拘わらず、作動するようになっている。
In such a posture control device, when the vertical position operating means is lowered from the non-plowing work state, the tiller is controlled to be lowered by the automatic height control. Then, when the cultivator comes in contact with the ground or when the cultivator reaches a set tilling depth position set by the tilling depth setting means, the automatic height control is switched to the automatic tillage control.
On the other hand, the automatic tilt control is activated regardless of which control mode of the automatic height control or the automatic tilling depth control is activated.

ところで、前記自動傾き制御は、耕耘作業状態の際には応答性良く作動することが望まれるが、非耕耘作業状態の際に作動すると前記耕耘機が意に反して傾いたり、場合によっては該耕耘機が地面と接触する等の不都合が生じる。
斯かる観点から、前記車輌本体が所定の閾値車速を超えた高速走行時には、前記自動傾き制御の制御精度を緩和させることが提案されている。
このような自動傾き制御の規制は、前記車輌本体の速度が前記閾値車速よりも高速の場合には非耕耘作業状態にあると擬制して、前記自動傾き制御の制御性を悪化させるものであり、車輌本体が高速走行時において、前記耕耘機が意に反して左右方向へ傾動することを有効に防止できる点で有用である。
By the way, it is desirable that the automatic tilt control operates with good responsiveness during the plowing work state, but when operated during the non-plowing work state, the cultivator tilts unexpectedly, and in some cases, the There are inconveniences such as the tiller coming into contact with the ground.
From this point of view, it has been proposed that the control accuracy of the automatic tilt control is relaxed when the vehicle body travels at a high speed exceeding a predetermined threshold vehicle speed.
Such regulation of the automatic tilt control is to pretend that the vehicle body is in a non-plowing work state when the speed of the vehicle body is higher than the threshold vehicle speed, and deteriorates the controllability of the automatic tilt control. This is useful in that the tiller can be effectively prevented from tilting in the left-right direction when the vehicle body is traveling at high speed.

しかしながら、前述のような、意に反した前記耕耘機の左右方向への傾動制御は、車輌本体が前記閾値車速よりも低速走行する際にも生じ得る。
即ち、例えば、圃場内の一方側から他方側へ向けて車輌本体を略直進させつつ連続的な耕耘作業を行った後に該圃場の他方側端部の方向転換場所(枕地)にて前記車輌本体を方向転換させる際や、前記連続的な耕耘作業の終了後にその圃場における前記枕地に対して耕耘作業を行うべく該車輌本体を移動させる際には、作業者は、前記耕耘機の上昇時間や下降時間の節約を図る為に、通常、前記耕耘機を前記自動傾き制御が解除される最上昇位置まで上昇させることなく、前記上下位置操作手段によって前記耕耘機を耕耘地面から若干上昇させた状態で、車輌本体の走行を行う。
このような圃場内の走行時には、通常、前記車輌本体は前記閾値車速よりも低速走行される。
従って、前記従来の自動傾き制御の規制方法では、前記耕耘機を地面よりは上方で且つ最上昇位置よりも下方に位置させた状態で、圃場内を走行する際に、前記耕耘機が作業者の意に反して大きく左右に傾動されることが起こり得る。
However, the unintentional tilting control of the tiller in the left-right direction as described above may also occur when the vehicle body travels at a speed lower than the threshold vehicle speed.
That is, for example, after performing continuous tillage work while moving the vehicle body substantially straight from one side to the other side in the field, the vehicle at the direction change place (headland) at the other side end of the field. When changing the direction of the main body, or when moving the vehicle main body to perform the tilling work on the headland in the field after the end of the continuous tilling work, the operator raises the tiller. In order to save time and descent time, normally, the tiller is lifted slightly from the tillage ground by the vertical position operating means without raising the tiller to the highest position where the automatic tilt control is released. In this state, run the vehicle body.
When traveling in such a field, the vehicle body normally travels at a speed lower than the threshold vehicle speed.
Therefore, in the conventional method of controlling automatic tilt control, when the field cultivator travels in the field with the field cultivator positioned above the ground and below the highest position, the field cultivator Contrary to the intention, it can be tilted to the left or right.

又、前記耕耘機を地面よりは上方で且つ最上昇位置よりも下方に位置させた状態での車輌走行は、一の圃場における耕耘作業の終了後に、他の圃場への耕耘作業を行う際にも行われる。
このような他の圃場への移動の際に、前記自動傾き制御によって前記耕耘機が意に反して大きく左右に傾動すると、車輌本体のバランスが崩れ、場合によっては該耕耘機が路上に接触して、該耕耘機の破損を招く虞もある。
特開平8−205609号公報
In addition, the vehicle traveling in a state where the tiller is located above the ground and below the highest position is performed when the tilling work to another field is performed after the end of the tilling work in one field. Is also done.
When the cultivator tilts to the left or right unexpectedly by the automatic tilt control during the movement to another field, the balance of the vehicle body is lost, and in some cases, the cultivator comes into contact with the road. In addition, there is a risk of damaging the cultivator.
JP-A-8-205609

本発明は、斯かる従来技術に鑑みなされたものであり、車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機に対して自動高さ制御、自動耕深制御及び自動傾き制御を行う姿勢制御装置であって、前記耕耘機を最上昇位置よりは下方で且つ地面よりは上方に位置させた非耕耘作業状態での車輌本体の走行時に、前記自動傾き制御によって前記耕耘機が意に反して大きく傾動されることを防止し得る構造簡単な姿勢制御装置の提供を、目的とする。   The present invention has been made in view of such a conventional technique, and has an automatic height control, an automatic tilling depth control, and an automatic inclination control with respect to a cultivator coupled so as to be movable up and down with respect to the vehicle body and tiltable to the left and right. An attitude control device that performs the automatic tilt control when the vehicle main body travels in a non-plowing work state in which the tiller is positioned below the highest position and above the ground. It is an object of the present invention to provide a posture control device having a simple structure that can prevent a large tilt against the intention.

本発明は、前記課題を解決するために、次の第1態様の姿勢制御装置を提供する。
(1)第1の姿勢制御装置
車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の検出上下位置を該耕耘機に対して設定された設定高さ位置に追従させる自動高さ制御と、前記耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御と、前記耕耘機の前記車輌本体に対する検出傾斜状態を設定傾斜状態に追従させる自動傾き制御とを行うように構成された姿勢制御装置であって、前記車輌本体の車速が所定の閾値車速より高速の場合には、前記自動傾き制御の制御精度を緩和させると共に、前記設定高さ位置が前記耕耘機の接地位置より高い場合には、該設定高さ位置が高くなるに従って前記閾値車速を低速とするように構成したことを特徴とする姿勢制御装置。
In order to solve the above-described problems, the present invention provides a posture control apparatus according to a first aspect described below.
(1) 1st attitude control device Automatic height which makes the detection vertical position of the cultivator connected to the vehicle main body so that it can be moved up and down and tilted to the left and right follow the set height position set for the cultivator. Control control, automatic tilling control for causing the tilling position of the tiller to follow the set tilling position, and automatic tilting control for causing the detected tilting state of the tiller to follow the set tilting state. When the vehicle speed of the vehicle body is higher than a predetermined threshold vehicle speed, the control accuracy of the automatic tilt control is eased and the set height position is the tiller. An attitude control device configured to lower the threshold vehicle speed as the set height position increases when the contact height is higher than the contact position .

また、前記自動傾き制御の制御精度を緩和させる具体的態様として、前記自動傾き制御を、フィルタを介して入力された、前記車輌本体に対する前記耕耘機の相対的な傾斜角度に基づいて実行し、前記自動傾き制御の実行時、前記自動傾き制御の制御ゲインの低減化、前記自動傾き制御の不感帯幅の拡大又は前記フィルタのフィルタリング条件の変更の少なくとも何れか一の手段によって、前記自動傾き制御の制御精度を緩和させるように構成されている態様を例示できる。
前記自動傾き制御の制御精度の緩和の程度は、前記閾値車速に応じて変更されるように構成されていることが好ましい。斯かる具体的態様として、前記車輌本体の車速が前記閾値車速より高速の場合には、該車速が大きくなるに従って前記自動傾き制御の制御精度の緩和の程度を大きくする態様を例示できる。
Further, as a specific mode for relaxing the control accuracy of the automatic tilt control, the automatic tilt control is executed based on a relative tilt angle of the cultivator with respect to the vehicle body, which is input through a filter, When executing the automatic tilt control, the automatic tilt control is performed by at least one of the following means: reduction of the control gain of the automatic tilt control , expansion of the dead zone width of the automatic tilt control, or change of the filtering condition of the filter . The aspect comprised so that control accuracy may be eased can be illustrated.
The degree of relaxation of the control accuracy of the automatic tilt control is preferably configured to be changed according to the threshold vehicle speed. As such a specific aspect, when the vehicle speed of the vehicle main body is higher than the threshold vehicle speed, an aspect of increasing the degree of relaxation of the control accuracy of the automatic tilt control as the vehicle speed increases can be exemplified.

本発明はまた、次の第2態様の姿勢制御装置を提供する。
(2)第2の姿勢制御装置
車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の検出上下位置を該耕耘機に対して設定された設定高さ位置に追従させる自動高さ制御と、前記耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御と、前記耕耘機の前記車輌本体に対する検出傾斜状態を設定傾斜状態に追従させる自動傾き制御とを行うように構成された姿勢制御装置であって、前記車輌本体の車速が所定の閾値車速より高速の場合には、前記自動傾き制御を停止するように構成したことを特徴とする姿勢制御装置。
The present invention also provides an attitude control device according to a second aspect described below.
(2) Second attitude control device Automatic height that causes the detected vertical position of a cultivator coupled so as to be able to move up and down and tilt to the left and right with respect to the vehicle body to follow the set height position set for the cultivator. Control control, automatic tilling control for causing the tilling position of the tiller to follow the set tilling position, and automatic tilting control for causing the detected tilting state of the tiller to follow the set tilting state. An attitude control apparatus configured as described above, wherein the automatic tilt control is stopped when a vehicle speed of the vehicle body is higher than a predetermined threshold vehicle speed.

前記第2態様の姿勢制御装置では、前記閾値車速を前記設定高さ位置に応じて変更するように構成することが好ましい。この場合、前記閾値車速を前記設定高さ位置に応じて変更する具体的態様として、前記設定高さ位置が接地位置より高い場合には、該設定高さ位置が高くなるに従って前記閾値車速を低速とする態様を例示できる。   The attitude control device according to the second aspect is preferably configured to change the threshold vehicle speed in accordance with the set height position. In this case, as a specific mode in which the threshold vehicle speed is changed according to the set height position, when the set height position is higher than the ground contact position, the threshold vehicle speed is decreased as the set height position increases. The aspect which is made can be illustrated.

ところで、前記自動高さ制御の際には、非耕耘作業状態とみなすことができるという観点から、本発明は、次の第3態様及び第4態様の姿勢制御装置を提供する。   By the way, from the viewpoint that the automatic height control can be regarded as a non-plowing work state, the present invention provides posture control apparatuses of the following third and fourth modes.

(3)第3の姿勢制御装置
車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の検出上下位置を該耕耘機に対して設定された設定高さ位置に追従させる自動高さ制御と、前記耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御と、前記耕耘機の前記車輌本体に対する検出傾斜状態を設定傾斜状態に追従させる自動傾き制御とを行うように構成された姿勢制御装置であって、前記自動高さ制御の際には、前記自動傾き制御の制御精度を緩和させるように構成したことを特徴とする姿勢制御装置。
前記第3態様の姿勢制御装置では、前記自動傾き制御の制御精度を緩和させる具体的態様として、前記自動傾き制御を、フィルタを介して入力された、前記車輌本体に対する前記耕耘機の相対的な傾斜角度に基づいて実行し、前記自動傾き制御の実行時、前記自動傾き制御の制御ゲインの低減化、前記自動傾き制御の不感帯幅の拡大又は前記フィルタのフィルタリング条件の変更の少なくとも何れか一の手段によって、前記自動傾き制御の制御精度を緩和させるように構成されている態様を例示できる。
前記自動傾き制御の制御精度の緩和の程度は、前記設定高さ位置に応じて変更されるように構成されていることが好ましい。斯かる具体的態様として、前記設定高さ位置が接地位置より高い場合には、該設定高さ位置が高くなるに従って前記自動傾き制御の制御精度の緩和の程度を大きくする態様を例示できる。
(3) Third attitude control device Automatic height that causes the detected vertical position of a tiller coupled to be able to move up and down and tilt to the left and right with respect to the vehicle body to follow the set height position set for the tiller. Control control, automatic tilling control for causing the tilling position of the tiller to follow the set tilling position, and automatic tilting control for causing the detected tilting state of the tiller to follow the set tilting state. A posture control device configured as described above, wherein the control accuracy of the automatic tilt control is relaxed during the automatic height control.
In the attitude control device of the third aspect, as a specific aspect for relaxing the control accuracy of the automatic tilt control, the automatic tilt control is input to the vehicle main body relative to the vehicle body, which is input through a filter. It is executed based on an inclination angle, and at the time of execution of the automatic inclination control , at least one of the reduction of the control gain of the automatic inclination control, the expansion of the dead band width of the automatic inclination control or the change of the filtering condition of the filter The aspect comprised so that the control precision of the said automatic inclination control may be eased with a means can be illustrated.
The degree of relaxation of the control accuracy of the automatic tilt control is preferably configured to be changed according to the set height position. As such a specific mode, when the set height position is higher than the ground contact position, a mode of increasing the degree of relaxation of the control accuracy of the automatic tilt control as the set height position becomes higher can be exemplified.

(4)第4の姿勢制御装置
車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の検出上下位置を設定高さ位置に追従させる自動高さ制御と、前記耕耘機の検出耕深位置を該耕耘機に対して設定された設定耕深位置に追従させる自動耕深制御と、前記耕耘機の前記車輌本体に対する検出傾斜状態を設定傾斜状態に追従させる自動傾き制御とを行うように構成された姿勢制御装置であって、前記自動高さ制御の際には、前記自動傾き制御を停止するように構成したことを特徴とする姿勢制御装置。
(4) Fourth attitude control device Automatic height control for detecting the vertical position of the tiller connected so as to be able to move up and down with respect to the vehicle body and tiltable to the left and right, and detection of the tiller performing an automatic tilling depth control to follow the tilling depth position to the set set tilling depth position relative to the tiller, and the automatic tilt control to follow the detected tilt state to set the inclined state relative to the vehicle body of said tiller An attitude control apparatus configured as described above, wherein the automatic inclination control is stopped during the automatic height control.

本発明の第1態様に係る姿勢制御装置によれば、自動傾き制御の制御精度を緩和させる際の判断基準となる閾値車速を、上下位置操作手段による設定高さ位置に応じて変更するように構成したので、前記耕耘機を最上昇位置よりは下方で且つ地面よりは上方に位置させた非耕耘作業状態での車輌本体の走行時に、前記自動傾き制御によって前記耕耘機が意に反して大きく傾動することを有効に防止できる。
従って、車輌本体の走行バランスを良好に維持できると共に、前記耕耘機が地面等に接触する等の不都合を防止できる。
According to the attitude control device according to the first aspect of the present invention, the threshold vehicle speed, which is a criterion for reducing the control accuracy of the automatic tilt control, is changed according to the height position set by the vertical position operating means. Since the structure of the cultivator is undesirably large due to the automatic tilt control when the vehicle body is traveling in a non-cultivated work state in which the cultivator is positioned below the highest position and above the ground. It is possible to effectively prevent tilting.
Accordingly, the running balance of the vehicle body can be maintained well, and inconveniences such as contact of the tiller with the ground or the like can be prevented.

斯かる構成において、前記設定高さ位置が接地位置より高い場合には、該設定高さ位置が高くなるに従って前記閾値車速を低速とすれば、従来においては自動傾き制御が実行されていたような低速走行時においても、該自動傾き制御による前記耕耘機の傾動量を抑えることができる。
従って、前記耕耘機を最上昇位置よりは下方で且つ地面よりは上方に位置させた非耕耘作業状態での圃場内又は路上での走行時に、車輌本体の走行バランスを良好に維持できると共に、前記耕耘機が地面等に接触するという不都合を防止できる。
In such a configuration, when the set height position is higher than the ground contact position, if the threshold vehicle speed is decreased as the set height position is increased, automatic tilt control is conventionally performed. Even during low-speed traveling, the amount of tilting of the cultivator by the automatic tilt control can be suppressed.
Therefore, when traveling on the field or on the road in a non-plowing work state in which the cultivator is positioned below the highest position and above the ground, the vehicle body can maintain a good traveling balance, The inconvenience that the cultivator comes into contact with the ground or the like can be prevented.

また、前記自動傾き制御の制御精度の緩和の程度が、前記車輌本体の車速に応じて変更されるように構成すれば、高速走行時における車輌本体の走行バランスをより良好に維持できる。   Further, if the degree of relaxation of the control accuracy of the automatic tilt control is changed according to the vehicle speed of the vehicle body, the running balance of the vehicle body during high-speed running can be maintained better.

本発明の第2態様に係る姿勢制御装置によれば、前記車輌本体の車速が所定の閾値車速より高速の場合には、前記自動傾き制御を停止するように構成したので、前記車輌本体の車速が前記閾値車速より高速の場合に、前記自動傾き制御を停止する。
従って、前記自動傾き制御の意に反する作動を確実に防止することができる。
According to the attitude control device of the second aspect of the present invention, the automatic tilt control is stopped when the vehicle speed of the vehicle main body is higher than a predetermined threshold vehicle speed. When the speed is higher than the threshold vehicle speed, the automatic tilt control is stopped.
Therefore, the operation contrary to the meaning of the automatic tilt control can be reliably prevented.

斯かる構成において、前記閾値車速を前記設定高さ位置に応じて変更するように構成すれば、前記耕耘機を最上昇位置よりは下方で且つ地面よりは上方に位置させた非耕耘作業状態での車輌本体の走行時に、前記自動傾き制御によって前記耕耘機が意に反して傾動することを確実に防止できる。
従って、車輌本体の走行バランスを良好に維持できると共に、前記耕耘機が地面等に接触する等の不都合を防止できる。
In such a configuration, if the threshold vehicle speed is configured to change according to the set height position, the tiller is positioned in a non-plowing work state in which the tiller is positioned below the highest position and above the ground. When the vehicle body is traveling, the automatic tilt control can reliably prevent the tiller from tilting against the intention.
Accordingly, the running balance of the vehicle body can be maintained well, and inconveniences such as contact of the tiller with the ground or the like can be prevented.

また、前記設定高さ位置が接地位置より高い場合には、該設定高さ位置が高くなるに従って前記閾値車速を低速とすると、従来においては自動傾き制御が実行されていたような低速走行時においても、該自動傾き制御による前記耕耘機の傾動を防止できる。
従って、前記耕耘機を最上昇位置よりは下方で且つ地面よりは上方に位置させた非耕耘作業状態での圃場内又は路上での走行時に、車輌本体の走行バランスを良好に維持できると共に、前記耕耘機が地面等に接触するという不都合を防止できる。
Further, when the set height position is higher than the ground contact position, the threshold vehicle speed is reduced as the set height position is increased. In addition, the tiller can be prevented from tilting by the automatic tilt control.
Therefore, when traveling on the field or on the road in a non-plowing work state in which the cultivator is positioned below the highest position and above the ground, the vehicle body can maintain a good traveling balance, The inconvenience that the cultivator comes into contact with the ground or the like can be prevented.

本発明の第3態様に係る姿勢制御装置によれば、前記自動高さ制御の際には、非耕耘作業状態とみなし、前記自動傾き制御の制御精度を緩和させるように構成したので、前記耕耘機を最上昇位置よりは下方で且つ地面よりは上方に位置させた非耕耘作業状態での車輌本体の走行時に、前記自動傾き制御によって前記耕耘機が意に反して大きく傾動することを有効に防止できる。
従って、車輌本体の走行バランスを良好に維持できると共に、前記耕耘機が地面等に接触する等の不都合を防止できる。
According to the attitude control device of the third aspect of the present invention, the automatic height control is regarded as a non-plowing work state and is configured to relax the control accuracy of the automatic tilt control. When the vehicle body is running in a non-plowing work state where the machine is positioned below the highest position and above the ground, the automatic tilt control effectively enables the tiller to tilt unexpectedly greatly. Can be prevented.
Accordingly, the running balance of the vehicle body can be maintained well, and inconveniences such as contact of the tiller with the ground or the like can be prevented.

斯かる構成において、前記自動傾き制御の制御精度の緩和の程度が、前記設定高さ位置に応じて変更されるように構成すれば、従来においては自動傾き制御が実行されていたような低速走行時においても、該自動傾き制御による前記耕耘機の傾動量を抑えることができる。
従って、前記耕耘機を最上昇位置よりは下方で且つ地面よりは上方に位置させた非耕耘作業状態での圃場内又は路上での走行時に、車輌本体の走行バランスを良好に維持できると共に、前記耕耘機が地面等に接触するという不都合を防止できる。
In such a configuration, if the degree of relaxation of the control accuracy of the automatic tilt control is changed in accordance with the set height position, low-speed traveling that has been conventionally performed by the automatic tilt control is performed. Even at times, the amount of tilting of the tiller by the automatic tilt control can be suppressed.
Therefore, when traveling on the field or on the road in a non-plowing work state in which the cultivator is positioned below the highest position and above the ground, the vehicle body can maintain a good traveling balance, The inconvenience that the cultivator comes into contact with the ground or the like can be prevented.

本発明の第4態様に係る姿勢制御装置によれば、前記自動高さ制御の際には、非耕耘作業状態とみなし、前記自動傾き制御を停止するように構成したので、前記耕耘機を最上昇位置よりは下方で且つ地面よりは上方に位置させた非耕耘作業状態での車輌本体の走行時に、前記自動傾き制御によって前記耕耘機が意に反して大きく傾動することを有効に防止できる。
従って、車輌本体の走行バランスを良好に維持できると共に、前記耕耘機が地面等に接触する等の不都合を防止できる。
According to the posture control apparatus of the fourth aspect of the present invention, the automatic height control is regarded as a non-plowing work state and the automatic tilt control is stopped. When the vehicle body is traveling in a non-plowing work state positioned below the raised position and above the ground, the automatic tilt control can effectively prevent the tiller from tilting unexpectedly.
Accordingly, the running balance of the vehicle body can be maintained well, and inconveniences such as contact of the tiller with the ground or the like can be prevented.

以下、本発明の実施の形態について図面を参照しながら説明する。
図1は本実施の形態に係る姿勢制御装置が適用される作業車輌の一例である農作業用トラクタの概略側面図である。図2は図1に示すトラクタの概略平面図である。図3は図1に示すトラクタにおける耕耘機用昇降機構の概略側面図である。図4は図3に示す耕耘機用昇降機構の概略平面図である。図5はロータリ耕耘機の図2におけるV−V線に沿った概略断面図である。図6は該ロータリ耕耘機の概略背面図である。図7は該トラクタの油圧回路図である。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 is a schematic side view of a farm tractor that is an example of a working vehicle to which the attitude control device according to the present embodiment is applied. FIG. 2 is a schematic plan view of the tractor shown in FIG. FIG. 3 is a schematic side view of the tiller lifting mechanism in the tractor shown in FIG. 4 is a schematic plan view of the tiller lifting mechanism shown in FIG. FIG. 5 is a schematic cross-sectional view of the rotary tiller along line VV in FIG. FIG. 6 is a schematic rear view of the rotary tiller. FIG. 7 is a hydraulic circuit diagram of the tractor.

図1乃至図4に示す如く、作業車輌としてのトラクタ100は、車輌本体50と、該車輌本体50の後部に連結されたロータリ耕耘機400とを備えている。
前記車輌本体50は、走行機体1と、該走行機体1を支持する左右一対の前車輪2及び左右一対の後車輪3と、該走行機体1の前部に搭載されたエンジン4とを備えており、前記エンジン4からの動力によって前記後車輪3及び前記前車輪2を作動的に駆動することにより、前後進走行するように構成されている。なお、図中の符号5は前記エンジン4を覆うボンネット5である。
さらに、前記トラクタ100は、前記走行機体1の上面に設けられたキャビン6を有している。該キャビン6の内部には、操縦座席7と、かじ取りすることによって前記前車輪2の操向方向を左右に動かすように構成された操縦ハンドル(丸ハンドル)8とが設置されている。前記キャビン6の外側部には、作業者が乗降するステップ9が設けられ、該ステップ9より内側で且つ該キャビン6の底部より下側には、前記エンジン4に燃料を供給する燃料タンク10が設けられている。
As shown in FIGS. 1 to 4, a tractor 100 as a working vehicle includes a vehicle main body 50 and a rotary cultivator 400 connected to a rear portion of the vehicle main body 50.
The vehicle body 50 includes a traveling machine body 1, a pair of left and right front wheels 2 and a pair of left and right rear wheels 3 that support the traveling machine body 1, and an engine 4 mounted on the front portion of the traveling machine body 1. In addition, the rear wheel 3 and the front wheel 2 are operatively driven by the power from the engine 4 so as to travel forward and backward. Reference numeral 5 in the figure denotes a bonnet 5 that covers the engine 4.
Further, the tractor 100 has a cabin 6 provided on the upper surface of the traveling machine body 1. Inside the cabin 6 are installed a control seat 7 and a control handle (round handle) 8 configured to move the steering direction of the front wheel 2 to the left and right by steering. A step 9 where an operator gets on and off is provided on the outer side of the cabin 6, and a fuel tank 10 for supplying fuel to the engine 4 is provided on the inner side of the step 9 and below the bottom of the cabin 6. Is provided.

図1乃至図4に示すように、前記走行機体1は、前バンパ11及び前車軸ケース12を有するエンジンフレーム13と、該エンジンフレーム13の後部にボルトにて着脱自在に固定される左右の機体フレーム15とを有している。
前記機体フレーム15の後部には、前記エンジン4の回転を適宜変速してそれぞれ後輪軸3a及び前輪軸2aを介して前記後車輪3及び前記前車輪2に伝達するためのミッションケース16が連結されている。前記後車輪3は、前記ミッションケース16の外側面から外向きに突出するように装着された後車軸ケース17を介して取付けられている。
なお、前記ミッションケース16の後端面には、前記ロータリ耕耘機400の駆動力を出力する為のPTO軸18が後向きに突出するように設けられている。
As shown in FIGS. 1 to 4, the traveling aircraft body 1 includes an engine frame 13 having a front bumper 11 and a front axle case 12, and left and right aircraft bodies that are detachably fixed to the rear portion of the engine frame 13 with bolts. Frame 15.
A transmission case 16 is connected to the rear part of the body frame 15 for appropriately shifting the rotation of the engine 4 and transmitting it to the rear wheel 3 and the front wheel 2 via the rear wheel shaft 3a and the front wheel shaft 2a, respectively. ing. The rear wheel 3 is attached via a rear axle case 17 mounted so as to protrude outward from the outer surface of the mission case 16.
A PTO shaft 18 for outputting the driving force of the rotary tiller 400 is provided on the rear end surface of the transmission case 16 so as to protrude rearward.

前記ロータリ耕耘機400は、前記ミッションケース16の後部に、一対の左右ロワーリンク311,312及びトップリンク320からなる3点リンク機構300を介して連結される。
図1及び図3に示すように、前記左右ロワーリンク311,312は、前端側が前記ミッションケース16後部の左右側面のそれぞれにロワーリンクピン313を介して回動可能に連結され、且つ、後端側が前記ロータリ耕耘機400における下リンクフレーム440の前端部に下ヒッチピン314を介して連結されている。
前記トップリンク320は、前端側が下記作業機用昇降機構200の後部のトップリンクヒッチ210にトップリンクピン211を介して連結され、且つ、後端側が下記上リンクフレーム410の前端側に上ヒッチピン321を介して連結されている。
The rotary tiller 400 is connected to the rear portion of the mission case 16 via a three-point link mechanism 300 including a pair of left and right lower links 311 and 312 and a top link 320.
As shown in FIGS. 1 and 3, the left and right lower links 311, 312 are connected to the left and right side surfaces of the rear portion of the transmission case 16 so as to be rotatable via lower link pins 313, and the rear ends The side is connected to the front end portion of the lower link frame 440 in the rotary tiller 400 via a lower hitch pin 314.
The top link 320 has a front end connected to a top link hitch 210 at a rear portion of the working machine lifting mechanism 200 described below via a top link pin 211, and a rear end connected to a front end of the upper link frame 410 below an upper hitch pin 321. It is connected through.

図3及び図4に示すように、前記ミッションケース16の後部上面には、前記ロータリ耕耘機400を昇降動する為の油圧式作業機用昇降機構200が着脱可能に取付けられている。
図3及び図4及び図7に示すように、油圧式の作業機用昇降機構200は、昇降用アクチュエータとして作用する単動形の昇降制御油圧シリンダ220と、該油圧シリンダ220におけるピストンによって作動的に回動される左右一対のリフトアーム221,222とを有している。
As shown in FIGS. 3 and 4, a hydraulic working machine elevating mechanism 200 for elevating and lowering the rotary tiller 400 is detachably attached to the rear upper surface of the transmission case 16.
As shown in FIGS. 3, 4, and 7, the hydraulic working machine lifting mechanism 200 is operated by a single-acting lifting control hydraulic cylinder 220 that acts as a lifting actuator and a piston in the hydraulic cylinder 220. And a pair of left and right lift arms 221 and 222 that are pivoted to each other.

進行方向に向かって左側の前記リフトアーム221は、左リフトロッド231を介して対応する左側の前記ロワーリンク311に連結されている。
進行方向に向かって右側の前記リフトアーム222は、右リフトロッド232を介して対応する右側の前記ロワーリンク312に連結されている。
つまり、前記昇降制御油圧シリンダ220によって前記左右一対のリフトアーム221,222が車輌左右方向に沿った前記回動軸回りに揺動することで、前記ロータリ耕耘機400は、前記トップリンク320及び前記一対のロワーリンク311,312の前端部回りに昇降するようになっている。
The left lift arm 221 in the traveling direction is connected to the corresponding left lower link 311 via a left lift rod 231.
The lift arm 222 on the right side in the traveling direction is connected to the corresponding lower link 312 on the right side via a right lift rod 232.
That is, the lift control hydraulic cylinder 220 causes the pair of left and right lift arms 221 and 222 to swing about the rotation axis along the vehicle left-right direction, so that the rotary tiller 400 has the top link 320 and the The pair of lower links 311 and 312 are moved up and down around the front end portions.

前記右リフトロッド232には、前記ロータリ耕耘機400を前記車輌本体50に対して傾動させる傾動用アクチュエータとして作用する複動形の傾斜制御油圧シリンダ240が介挿されている。
つまり、前記傾斜制御油圧シリンダ240のピストンロッド241が進退することによって、前記ロータリ耕耘機440は、前記左右一対のリフトロッド231,232の他方(ここでは、左リフトロッド231)と該他方のリフトロッド231に対応したロワーリンク311との連結点(即ち、前記ロータリ耕耘機400の左右方向中心位置Dから一方側へ変位された位置)を支点Q(図2参照)として、傾動するようになっている。
A double-acting tilt control hydraulic cylinder 240 that functions as a tilting actuator that tilts the rotary tiller 400 with respect to the vehicle body 50 is interposed in the right lift rod 232.
That is, as the piston rod 241 of the tilt control hydraulic cylinder 240 advances and retreats, the rotary tiller 440 causes the other of the pair of left and right lift rods 231 and 232 (here, the left lift rod 231) and the other lift. The connecting point with the lower link 311 corresponding to the rod 231 (that is, the position displaced to the one side from the center D in the horizontal direction of the rotary tiller 400) is used as a fulcrum Q (see FIG. 2) to tilt. ing.

図1、図2、図5及び図6に示すように、前記ロータリ耕耘機400は、横長筒状のメインビーム420と、前記メインビーム420の左右側端部にそれぞれ上端側が連結されたチェーンケース431及び軸受板432と、前記チェーンケース431及び前記軸受板432の下端側に左右両端部が回転自在に軸支された耕耘爪軸433と、前記耕耘爪軸433に放射状にて着脱可能に取り付けられた複数の耕耘爪434と、前記耕耘爪434の回転軌跡の上方を覆うように配置された耕耘上面カバー435と、前記耕耘爪434の回転軌跡の左右側方を覆うように配置された左右耕耘サイドカバー436と、前記耕耘爪434の回転軌跡の後方を覆うように配置された耕耘リヤカバー437と、前記メインビーム420に前端側が取付けられて後方に長く伸びる耕深調節フレーム438と、前記メインビーム420に回動可能に連結された前記上リンクフレーム410と、前記メインビーム420に一体的に連結された前記下リンクフレーム440と、前記上リンクフレーム410の後端側と前記耕深調節フレーム438の前後方向の中間部とをつなぐ伸縮調節可能な耕深調節軸439とを備えている。   As shown in FIGS. 1, 2, 5, and 6, the rotary tiller 400 includes a horizontally long main beam 420 and a chain case having upper ends connected to left and right ends of the main beam 420. 431 and the bearing plate 432, a tilling claw shaft 433 rotatably supported at both left and right ends on the lower ends of the chain case 431 and the bearing plate 432, and a radial detachable attachment to the tilling claw shaft 433. A plurality of tilling claws 434, a tilling upper surface cover 435 disposed so as to cover the rotation trajectory of the tilling claws 434, and left and right disposed so as to cover the left and right sides of the rotation trajectory of the tilling claws 434. A tilling side cover 436, a tilling rear cover 437 arranged to cover the rear of the rotation trajectory of the tilling claw 434, and a front end side are attached to the main beam 420. A tilling depth adjusting frame 438 extending long rearwardly, the upper link frame 410 rotatably connected to the main beam 420, the lower link frame 440 integrally connected to the main beam 420, and the upper A tilling depth adjusting shaft 439 that can be extended and contracted is provided to connect the rear end side of the link frame 410 and the middle portion in the front-rear direction of the tilling depth adjusting frame 438.

詳しくは、前記トップリンク320は、ターンバックル320aの回転にて伸縮されて、該トップリンク320の長さを変更調節可能となるように構成されている(図3及び図4参照)。前記上リンクフレーム410は、前後方向の中間部において、耕深調節支点軸411を介して前記メインビーム420に回動可能に連結されている(図1参照)。そして、前記耕深調節フレーム438は、前端側が前記メインビーム420に一体的に連結されている。
斯かる構成を備えることにより、耕深調節ハンドル439a(図1参照)を回転操作して前記耕深調節軸439を伸縮させると、前記左右一対のロワーリンク311,312及びトップリンク320にて支持される前記ロータリ耕耘機400は、前傾又は後傾姿勢に変化するようになっており、これにより、前記耕耘爪434による耕深位置hD(耕耘深さ)が手動で変更できるように構成されている。
Specifically, the top link 320 is configured to be expanded and contracted by the rotation of the turnbuckle 320a so that the length of the top link 320 can be changed and adjusted (see FIGS. 3 and 4). The upper link frame 410 is rotatably connected to the main beam 420 via a tilling depth adjustment fulcrum shaft 411 at an intermediate portion in the front-rear direction (see FIG. 1). The tilling depth adjusting frame 438 is integrally connected to the main beam 420 at the front end side.
By providing such a configuration, when the tilling depth adjusting shaft 439 is expanded and contracted by rotating the tilling depth adjusting handle 439a (see FIG. 1), it is supported by the pair of left and right lower links 311 and 312 and the top link 320. The rotary cultivator 400 is configured to change to a forward or backward inclined posture, and thereby, a cultivating depth position hD (cultivating depth) by the cultivating claws 434 can be manually changed. ing.

図1、図5及び図6に示すように、前記メインビーム420の左右中央部には、前記PTO軸18からの駆動力を入力するためのギヤケース450が配置されている。前記PTO軸18と前記ギヤケース450前面側のPTO入力軸451とは、両端に自在継手が備えられた伸縮自在な伝動軸452を介して連結されている。
前記PTO軸18からの動力は、前記ギヤケース450に内蔵されたベベルギヤ(図示せず)、前記メインビーム420に内蔵された回転軸(図示せず)、前記チェーンケース431に内蔵されたスプロケット及びチェーン(図示せず)等を介して前記耕耘爪軸433に伝達される。これにより、前記耕耘爪434が図1及び図5において反時計方向に回転される。
As shown in FIGS. 1, 5, and 6, a gear case 450 for inputting a driving force from the PTO shaft 18 is disposed at the left and right central portion of the main beam 420. The PTO shaft 18 and the PTO input shaft 451 on the front side of the gear case 450 are connected to each other via a telescopic transmission shaft 452 having universal joints at both ends.
The power from the PTO shaft 18 includes a bevel gear (not shown) built in the gear case 450, a rotating shaft (not shown) built in the main beam 420, a sprocket and a chain built in the chain case 431. (Not shown) or the like is transmitted to the tilling claw shaft 433. Thereby, the tilling claw 434 is rotated counterclockwise in FIGS. 1 and 5.

図5及び図6に示すように、前記耕耘上面カバー435の後端側には、車輌左右方向に沿った枢着軸437aを介して前記耕耘リヤカバー437が回動可能に連結されている。
さらに、前記耕耘上面カバー435の上面後部には、後方且つ上方へ延びる左右一対のハンガーフレーム441が立設されている。
そして、前記耕耘リヤカバー437の上面後端側と前記左右ハンガーフレーム441の後端側との間には左右一対のハンガー機構460が設けられており、前記耕耘リヤカバー437は、該ハンガー機構460によって、前記枢着軸437a回りに上下動し得るようになっている。
As shown in FIGS. 5 and 6, the tilling rear cover 437 is rotatably connected to the rear end side of the tilling upper surface cover 435 via a pivot shaft 437a along the left-right direction of the vehicle.
Further, a pair of left and right hanger frames 441 extending rearward and upward are provided upright on the rear upper surface of the tilling upper surface cover 435.
A pair of left and right hanger mechanisms 460 are provided between the rear end side of the top surface of the tilling rear cover 437 and the rear end side of the left and right hanger frame 441, and the tilling rear cover 437 is moved by the hanger mechanism 460. It can move up and down around the pivot shaft 437a.

詳しくは、前記各ハンガーフレーム441の後端部には、車輌左右方向に沿った軸線回り回動自在とされた受圧軸体442が配置されている。該受圧軸体442には、軸線と直交する方向に貫通孔が設けられている。
前記各ハンガー機構460は、前記受圧軸体442の前記貫通孔に摺動可能に挿通された細長い丸棒形のハンガーロッド461を有している。
前記ハンガーロッド461は、下端部が、車輌左右方向に沿った支軸461aを介して、前記耕耘リヤカバー437の後部上面に設けられたブラケット462に回動自在に連結されている(図5参照)。
前記ハンガーロッド461には、前記受圧軸体442より上方側において固設された下降規制ピン461bと、前記下降規制ピン461bと前記受圧軸体442との間に位置するように該ハンガーロッド461に軸線方向摺動可能に外挿された下降規制板463と、該ハンガーロッド461の下方側で且つ前記支軸461aより上方側において固設された上昇規制ピン461cと、前記上昇規制ピン461cによって下方への移動が規制された状態で該ハンガーロッド461に軸線方向摺動可能に外挿された下座板465と、前記下座板465及び前記受圧軸体442の間に位置するように該ハンガーロッド461に外挿された鎮圧用圧縮バネ466と、該鎮圧用圧縮バネ466の上端部と係合する上座板464とが設けられている。
Specifically, a pressure receiving shaft body 442 that is rotatable about an axis along the left-right direction of the vehicle is disposed at the rear end of each hanger frame 441. The pressure receiving shaft body 442 is provided with a through hole in a direction orthogonal to the axis.
Each hanger mechanism 460 includes an elongated round bar-shaped hanger rod 461 that is slidably inserted into the through hole of the pressure receiving shaft body 442.
The hanger rod 461 has a lower end portion rotatably connected to a bracket 462 provided on the upper surface of the rear portion of the tilling rear cover 437 via a support shaft 461a extending in the vehicle lateral direction (see FIG. 5). .
The hanger rod 461 has a lowering restriction pin 461b fixed above the pressure receiving shaft body 442, and the hanger rod 461 so as to be positioned between the lowering restriction pin 461b and the pressure receiving shaft body 442. A lowering restriction plate 463 externally inserted so as to be slidable in the axial direction, a rising restriction pin 461c fixed below the hanger rod 461 and above the support shaft 461a, and lowered by the rising restriction pin 461c. The hanger rod 461 is slidably inserted on the hanger rod 461 in an axially slidable manner, and the hanger is positioned between the lower seat plate 465 and the pressure receiving shaft body 442. A pressure-reducing compression spring 466 extrapolated to the rod 461 and a top plate 464 that engages with the upper end of the pressure-reducing compression spring 466 are provided.

斯かるハンガー機構460を備えた前記ロータリ耕耘機400は以下のように作動する。
即ち、前記昇降用アクチュエータによって前記ロータリ耕耘機400が地面Gから離れるように持上げられると、前記耕耘リヤカバー437の後端側が前記枢着軸437a回りに下方側に回動する。
この際、前記ハンガーロッド461は前記受圧軸体442に案内された状態で下方側へ移動するが、前記下降規制ピン461bが前記下降規制板463に当接し且つ該下降規制板463が前記受圧軸体442に当接することで、該ハンガーロッド461の下方側への移動が停止される。従って、前記耕耘リヤカバー437はその後端側を最下降させた姿勢に維持される。
The rotary tiller 400 provided with such a hanger mechanism 460 operates as follows.
That is, when the rotary tiller 400 is lifted away from the ground G by the lifting actuator, the rear end side of the tilling rear cover 437 rotates downward about the pivot shaft 437a.
At this time, the hanger rod 461 moves downward while being guided by the pressure receiving shaft body 442, but the lowering restriction pin 461b abuts on the lowering restriction plate 463 and the lowering restriction plate 463 is the pressure receiving shaft. By contacting the body 442, the downward movement of the hanger rod 461 is stopped. Therefore, the tilling rear cover 437 is maintained in a posture in which the rear end side is lowered to the lowest.

一方、前記ロータリ耕耘機400が耕地上面に降ろされて前記耕耘爪434が着地しているときや耕耘作業中においては、前記耕耘リヤカバー437の後端側が、耕耘された耕土との接地圧にて前記枢着軸437a回りに上方に回動することになる。
この際、前記ハンガーロッド461は前記受圧軸体442に案内された状態で上方側へ移動する。斯かるハンガーロッド461の上方側への移動によって、前記上昇規制ピン461c及び前記下座板465を介して前記鎮圧用圧縮バネ466が圧縮される。
即ち、前記耕耘リヤカバー437が前記枢着軸437a回りに上方側へ回動する際には、該耕耘リヤカバー437は前記鎮圧用圧縮バネ466の付勢力に抗して動作することになり、従って、前記耕耘リヤカバー437の後方への土の飛散を有効に防止しつつ、該耕耘リヤカバーによる均平作用を有効に維持することができる。
On the other hand, when the rotary cultivator 400 is lowered to the upper surface of the cultivated land and the cultivating claws 434 are landed or during the cultivating work, the rear end side of the cultivating rear cover 437 is at a contact pressure with the cultivated soil. It will pivot upward about the pivot shaft 437a.
At this time, the hanger rod 461 moves upward while being guided by the pressure receiving shaft body 442. By the upward movement of the hanger rod 461, the compression spring 466 for pressure reduction is compressed through the rising restriction pin 461 c and the lower seat plate 465.
That is, when the tilling rear cover 437 rotates upward about the pivot shaft 437a, the tilling rear cover 437 operates against the urging force of the compression spring 466 for pressure reduction. It is possible to effectively maintain the leveling action by the tilling rear cover while effectively preventing the scattering of soil to the rear of the tilling rear cover 437.

前記トラクタ100は、さらに、昇降用アクチュエータとして作用する前記昇降制御油圧シリンダ220及び傾動用アクチュエータとして前記昇降制御油圧シリンダ220への作動油給排を行う油圧回路500を備えている。
図7に示すように、前記油圧回路500は、前記エンジン4によって作動的に回転駆動される作業機用油圧ポンプ501と、該油圧ポンプ501の吐出側に流体接続された分流弁505と、該分流弁505によって分岐された一方側油路及び他方側油路にそれぞれ配置された昇降制御用バルブ及び傾斜制御用バルブとを備えている。
本実施の形態においては、前記昇降制御用バルブは、上昇制御電磁弁502及び下降制御電磁弁503を有している。また、前記傾斜制御用バルブは、傾斜制御電磁弁504を有している。
なお、前記油圧回路500は、図7に示すように、リリーフ弁や流量調整弁、チェック弁、オイルクーラ、オイルフィルタ等も備えている。
The tractor 100 further includes a lift control hydraulic cylinder 220 that functions as a lift actuator and a hydraulic circuit 500 that supplies and discharges hydraulic fluid to and from the lift control hydraulic cylinder 220 as a tilting actuator.
As shown in FIG. 7, the hydraulic circuit 500 includes a working machine hydraulic pump 501 rotatively driven by the engine 4, a shunt valve 505 fluidly connected to the discharge side of the hydraulic pump 501, There are provided an elevation control valve and an inclination control valve respectively disposed in the one side oil passage and the other side oil passage branched by the diversion valve 505.
In the present embodiment, the lift control valve has a lift control solenoid valve 502 and a lift control solenoid valve 503. The tilt control valve has a tilt control electromagnetic valve 504.
As shown in FIG. 7, the hydraulic circuit 500 includes a relief valve, a flow rate adjustment valve, a check valve, an oil cooler, an oil filter, and the like.

次に、前記キャビン6内に配置された各種操作手段の構成について説明する。
図1及び図2に示すように、前記操縦ハンドル8は、前記操縦座席7の前方に位置する操縦コラム19上に設けられている。
前記キャビン6内には、前記操縦座席7,前記操縦ハンドル8及び前記操縦コラム19に加えて、前記エンジン4の回転数(出力)を調節するためのスロットルレバー617と、前記走行機体1を制動操作するための左右ブレーキペダル20と、前記エンジンから前記前車輪2及び前記後車輪3への動力伝達の係脱操作を行う為のクラッチペダル21と、車輌本体50の走行速度を変速操作する為の走行変速レバー24と、前記エンジン4から前記後車輪3への動力伝達経路に介挿されるディファレンシャル機構をロック操作する為のデフロックペダル25と、前記PTO軸18からの出力回転数を変速操作する為のPTO変速レバー23とが配置されている。
Next, the structure of the various operation means arrange | positioned in the said cabin 6 is demonstrated.
As shown in FIGS. 1 and 2, the steering handle 8 is provided on a steering column 19 located in front of the steering seat 7.
In the cabin 6, in addition to the control seat 7, the control handle 8 and the control column 19, a throttle lever 617 for adjusting the rotational speed (output) of the engine 4 and the traveling machine body 1 are braked. Left / right brake pedal 20 for operating, clutch pedal 21 for engaging / disengaging power transmission from the engine to the front wheel 2 and the rear wheel 3, and for shifting the traveling speed of the vehicle body 50 The transmission shift lever 24, the differential lock pedal 25 for locking the differential mechanism inserted in the power transmission path from the engine 4 to the rear wheel 3, and the output rotational speed from the PTO shaft 18 are shifted. A PTO speed change lever 23 is provided.

さらに、前記キャビン6内には、作業機昇降レバー22,傾斜設定器623及び耕深設定器626が配置されている。
図8に、前記ロータリ耕耘機400の模式側面図を示す。なお、図8(a)は自動耕深制御時のロータリ耕耘機400の昇降状態を示しており、図8(b)は自動高さ制御時のロータリ耕耘機400の昇降状態を示している。
前記作業機昇降レバー22は、前記ロータリ耕耘機400の設定高さ位置(目標高さ位置)hS(図8(b)参照)を手動で変更操作するための上下位置操作手段として作用する。
前記上下位置操作手段は、前記設定高さ位置として、前記リフトアーム221,222の設定リフト角度(目標リフト角度)θS(図8(b)参照)を設定し得るように構成される。
図9に、前記ロータリ耕耘機400の模式背面図を示す。
前記傾斜設定器623は、前記ロータリ耕耘機400の傾斜状態tSを設定する傾斜設定手段として作用する。具体的には、図9に示すように、前記車輌本体50に対する前記ロータリ耕耘機400の左右方向に関する相対的な設定左右傾斜角度(目標左右傾斜角度)φsを予め設定する為のものであり、例えば、可変抵抗器を含み得る。
前記耕深設定器626は、前記ロータリ耕耘機400における耕耘爪434の設定耕深位置(目標耕深位置)hR(図8(a)参照)を設定する耕深深さ設定手段として作用する。
詳細は後述するが、前記ロータリ耕耘機400の耕深位置は、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動角度に基づいて制御されるようになっている。従って、前記耕深深さ設定手段は、前記設定耕深位置として、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の設定回動角度(目標回動角度)θR(図8(a)参照)を設定し得るように構成され、例えば、可変抵抗器を含み得る。なお、前記設定回動角度θRは、例えば、鉛直Vを基準にした回動角度とすることができる。
Further, a work implement elevating lever 22, an inclination setting device 623, and a tilling depth setting device 626 are arranged in the cabin 6.
FIG. 8 shows a schematic side view of the rotary tiller 400. FIG. 8A shows the lifted state of the rotary tiller 400 during automatic tillage control, and FIG. 8B shows the lifted state of the rotary tiller 400 during automatic height control.
The work implement lifting lever 22 acts as a vertical position operating means for manually changing the set height position (target height position) hS (see FIG. 8B) of the rotary tiller 400.
The vertical position operating means is configured to set a set lift angle (target lift angle) θS (see FIG. 8B) of the lift arms 221 and 222 as the set height position.
FIG. 9 shows a schematic rear view of the rotary tiller 400.
The inclination setter 623 acts as an inclination setting means for setting the inclination state tS of the rotary tiller 400. Specifically, as shown in FIG. 9, a relative set left / right tilt angle (target left / right tilt angle) φs in relation to the left / right direction of the rotary tiller 400 with respect to the vehicle body 50 is set in advance. For example, a variable resistor can be included.
The plowing depth setting device 626 functions as a plowing depth setting means for setting a set plowing depth position (target plowing depth position) hR (see FIG. 8A) of the plowing claw 434 in the rotary tiller 400.
Although the details will be described later, the tilling position of the rotary tiller 400 is controlled based on the rotation angle of the tilling rear cover 437 with respect to the tilling upper surface cover 435. Therefore, the plowing depth setting means sets a set turning angle (target turning angle) θR (see FIG. 8A) of the tilling rear cover 437 with respect to the tilling top cover 435 as the set plowing depth position. For example, a variable resistor may be included. The set rotation angle θR can be a rotation angle based on the vertical V, for example.

(第1実施形態)
次に、本発明に係る姿勢制御装置の第1実施形態について説明する。
図10は、第1実施形態に係る姿勢制御装置のブロック図である。
該姿勢制御装置は、前記車輌本体50に対して昇降可能且つ左右に傾動可能に連結された前記ロータリ耕耘機400の自動高さ制御、自動耕深制御及び自動傾き制御を行うように構成されている。
(First embodiment)
Next, a first embodiment of the attitude control device according to the present invention will be described.
FIG. 10 is a block diagram of the attitude control device according to the first embodiment.
The posture control device is configured to perform automatic height control, automatic tilling control, and automatic tilt control of the rotary tiller 400 that is connected to the vehicle body 50 so as to be movable up and down and tiltable to the left and right. Yes.

具体的には、図10に示すように、該姿勢制御装置は、前記昇降用アクチュエータとして作用する前記昇降制御油圧シリンダ220と、前記傾動用アクチュエータとして作用する前記傾斜制御油圧シリンダ240と、前記上下位置操作手段として作用する前記作業機昇降レバー22と、前記耕深深さ設定手段として作用する前記耕深設定器626と、前記傾斜設定手段として作用する前記傾斜設定器623と、前記ロータリ耕耘機400の前記車輌本体に対する上下位置を検出する上下位置検出手段と、前記ロータリ耕耘機400の耕深位置を検出する耕深位置検出手段として作用するリヤカバーセンサ624と、前記ロータリ耕耘機400の傾斜状態を検出する傾斜状態検出手段として作用する作業機ポジションセンサ622と、車速センサ628と、前記自動高さ制御、前記自動耕深制御及び前記自動傾き制御を司る制御手段として作用する姿勢制御コントローラ600とを備えている。   Specifically, as shown in FIG. 10, the attitude control device includes the lift control hydraulic cylinder 220 that acts as the lift actuator, the tilt control hydraulic cylinder 240 that acts as the tilt actuator, The working machine elevating lever 22 acting as position operating means, the tilling depth setting device 626 acting as the tilling depth setting means, the inclination setting device 623 acting as the inclination setting means, and the rotary tiller 400, a vertical position detecting means for detecting the vertical position of the vehicle main body, a rear cover sensor 624 acting as a tilling position detecting means for detecting a tilling position of the rotary tiller 400, and an inclined state of the rotary tiller 400 A work machine position sensor 622 acting as an inclination state detecting means for detecting And 628, the automatic height control, and a posture controller 600 which acts as a control unit which controls the automatic plowing depth control and the automatic tilt control.

前述の通り、前記リヤカバーセンサ624は、前記ロータリ耕耘機400の耕深位置hDを検出する耕深位置検出手段として作用する。
即ち、前記ロータリ耕耘機400の耕深位置hD(図8(a)参照)に応じて、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動位置が変化する。従って、前記リヤカバーセンサ624によって、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動位置を検出することによって、前記ロータリ耕耘機400の耕深位置hDを検出することができる。
詳しくは、前記リヤカバーセンサ624は、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動位置として、前記耕耘上面カバー435に対する前記耕耘リヤカバー437の回動角度θD(図8(a)参照)を検出し得るように構成され、この検出回動角度θDは、例えば、鉛直Vを基準にした回動角度とすることができる。
本実施の形態においては、該リヤカバーセンサ624は、前記耕耘上面カバー435の後部上面に配置されたポテンショメータ型とされている(図2、図5、図6及び図8参照)。
なお、前記リヤカバーセンサ624と前記耕耘リヤカバー437とは、センサアーム437b及びセンサリンク437c等を介して連結されている(図2参照)。
As described above, the rear cover sensor 624 functions as a tilling position detecting unit that detects the tilling position hD of the rotary tiller 400.
That is, the rotation position of the tilling rear cover 437 relative to the tilling upper surface cover 435 changes according to the tilling position hD (see FIG. 8A) of the rotary tiller 400. Accordingly, by detecting the rotation position of the tilling rear cover 437 relative to the tilling upper surface cover 435 by the rear cover sensor 624, the tilling position hD of the rotary tiller 400 can be detected.
Specifically, the rear cover sensor 624 detects a rotation angle θD of the tilling rear cover 437 relative to the tilling top cover 435 as a turning position of the tilling rear cover 437 relative to the tilling top cover 435 (see FIG. 8A). The detected rotation angle θD can be set to a rotation angle based on the vertical V, for example.
In the present embodiment, the rear cover sensor 624 is a potentiometer type disposed on the rear upper surface of the tilling upper surface cover 435 (see FIGS. 2, 5, 6 and 8).
The rear cover sensor 624 and the tillable rear cover 437 are connected via a sensor arm 437b, a sensor link 437c, and the like (see FIG. 2).

本実施の形態においては、前記上下位置検出手段としてリフト角センサ627が備えられている。
該リフト角センサ627は、前記ロータリ耕耘機400の対機体高さ(前記車輌本体50に対する前記ロータリ耕耘機400の相対高さ)hL(図8(b)参照)を検出し得るように構成されている。
具体的には、該リフト角センサ627は、前記リフトアーム221,222のリフト角度θL(図8(b)参照)を検出するように構成されており、例えば、ポテンショメータ型のものが使用され得る。
該リフト角センサ627は、前記作業機用昇降機構200と前記左リフトアーム221との連結箇所に配置されている(図3及び図4参照)。
In the present embodiment, a lift angle sensor 627 is provided as the vertical position detecting means.
The lift angle sensor 627 is configured to detect the height of the rotary tiller 400 relative to the body (the relative height of the rotary tiller 400 with respect to the vehicle body 50) hL (see FIG. 8B). ing.
Specifically, the lift angle sensor 627 is configured to detect the lift angle θL (see FIG. 8B) of the lift arms 221 and 222. For example, a potentiometer type sensor can be used. .
The lift angle sensor 627 is disposed at a connection point between the work implement lifting mechanism 200 and the left lift arm 221 (see FIGS. 3 and 4).

前記車速センサ628は、前後四輪2,3の回転速度(前記車両本体50の車速v)を検出するためのものである。   The vehicle speed sensor 628 is for detecting the rotational speeds of the front and rear four wheels 2 and 3 (the vehicle speed v of the vehicle body 50).

前記作業機ポジションセンサ622は、前記車輌本体50に対する前記ロータリ耕耘機400の左右方向に関する相対的な傾斜角度φ(図9参照)を検出するように構成されており、例えば、ポテンショメータ型のものが使用され得る。
該作業機ポジションセンサ622は、詳細は図示していないが、例えば、前記耕耘上面カバー435の上方に位置する前記メインビーム420の左右中央箇所に配置され得る。
なお、前記作業機ポジションセンサ622は、該作業機ポジションセンサ622の出力の中から限定された帯域の信号出力を取り出すためのフィルタ部625を介して、前記姿勢制御コントローラ600に電気的に接続されている。
斯かるフィルタ部625を設けることにより、前記作業機ポジションセンサ622の検出感度変化の影響を抑制することができる。これについては後ほど詳述する。
The work machine position sensor 622 is configured to detect a relative inclination angle φ (see FIG. 9) in the left-right direction of the rotary tiller 400 with respect to the vehicle body 50. For example, a potentiometer type sensor is used. Can be used.
The work machine position sensor 622 is not shown in detail, but may be disposed at, for example, the center of the main beam 420 located above the tilling top cover 435.
The work implement position sensor 622 is electrically connected to the attitude control controller 600 via a filter unit 625 for extracting a signal output in a limited band from the output of the work implement position sensor 622. ing.
By providing such a filter unit 625, it is possible to suppress the influence of a change in detection sensitivity of the work implement position sensor 622. This will be described in detail later.

前記姿勢制御コントローラ600は、前記種々の設定手段及びセンサからの信号を入力して、前記昇降用アクチュエータ及び前記傾動用アクチュエータへ制御信号を出力するように構成されている。
即ち、該姿勢制御コントローラ600は、図10に示すように、入力系が前記傾斜設定器623,前記耕深設定器626,前記機体ローリングセンサ621,前記作業機ポジションセンサ622,前記リフト角センサ627、前記リヤカバーセンサ624、前記作業機昇降レバー22及び前記リフト角センサ627等が電気的に接続されると共に、出力系が前記上昇制御電磁弁502,前記下降制御電磁弁503及び前記傾斜制御電磁弁504に電気的に接続されている。
The posture control controller 600 is configured to input signals from the various setting means and sensors and to output control signals to the lifting actuator and the tilting actuator.
That is, as shown in FIG. 10, the attitude controller 600 has an input system with the tilt setting device 623, the tilling depth setting device 626, the machine body rolling sensor 621, the work machine position sensor 622, and the lift angle sensor 627. The rear cover sensor 624, the work implement lifting lever 22, the lift angle sensor 627, and the like are electrically connected, and the output system is the ascending control solenoid valve 502, the descending control solenoid valve 503, and the tilt controlling solenoid valve. 504 is electrically connected.

詳しくは、該姿勢制御コントローラ600は、図10に示すように、前記各種センサ等から入力される信号に基づいて演算処理を実行する制御演算手段を含む中央処理装置601(以下CPUという)と、制御プログラムP1等を格納したり、後述する各種関係式又は制御マップに関する所定のデータ等を記憶するROM602と、前記CPU601の演算中に生成されるデータを一時的に保持するRAM603とを備えている。
斯かる姿勢制御コントローラ600は電源印加用キースイッチ611を介してバッテリ612に接続されている。なお、前記キースイッチ611は、前記エンジン4を始動するためのスタータ613に接続される。
Specifically, as shown in FIG. 10, the attitude control controller 600 includes a central processing unit 601 (hereinafter referred to as a CPU) including a control calculation unit that executes calculation processing based on signals input from the various sensors. A ROM 602 that stores a control program P1 and the like, stores predetermined data related to various relational expressions or control maps described later, and a RAM 603 that temporarily holds data generated during the calculation of the CPU 601 is provided. .
Such an attitude controller 600 is connected to the battery 612 via the power application key switch 611. The key switch 611 is connected to a starter 613 for starting the engine 4.

本実施の形態においては、前記姿勢制御コントローラ600には、図10に示すように、前記エンジン4の回転を制御する電子ガバナコントローラ614が接続されている。
該電子ガバナコントローラ614には、前記エンジン4の燃料を調節するガバナ615と、前記エンジン4の回転数を検出するエンジン回転センサ616とが接続されている。
In the present embodiment, as shown in FIG. 10, an electronic governor controller 614 that controls the rotation of the engine 4 is connected to the attitude controller 600.
The electronic governor controller 614 is connected to a governor 615 that adjusts the fuel of the engine 4 and an engine rotation sensor 616 that detects the rotational speed of the engine 4.

前記電子ガバナコントローラ614は、作業者にて前記スロットルレバー617が手動操作されると、該スロットルレバー617の回動位置を検出するスロットルポテンショメータ618の検出情報に基づいて、該スロットルレバー617の設定回転数と前記エンジン4の回転数とが一致するように、スロットルソレノイド619にて燃料調節ラック(図示省略)の位置を自動的に調節する制御を実行する。これにより、前記エンジン4の回転は、負荷の変動に拘わらず、前記スロットルレバー617の位置に応じた所定回転数に維持され得る。   When the throttle lever 617 is manually operated by an operator, the electronic governor controller 614 sets the rotation of the throttle lever 617 based on the detection information of the throttle potentiometer 618 that detects the rotation position of the throttle lever 617. The throttle solenoid 619 performs control to automatically adjust the position of a fuel adjustment rack (not shown) so that the number matches the number of revolutions of the engine 4. As a result, the rotation of the engine 4 can be maintained at a predetermined number of rotations according to the position of the throttle lever 617, regardless of load fluctuations.

さらに、本実施の形態に係る姿勢制御装置には、機体ローリングセンサ621が備えられている。
該機体ローリングセンサ621は、前記車輌本体50の左右方向に関する傾斜角度を検出する為のものであり、例えば、振子式のものが使用され得る。
本実施の形態においては、該機体ローリングセンサ621は、前記作業機用昇降機構200の上面で且つ前記操縦座席7の後方の箇所に配置されている(図1〜図4参照)。
Further, the attitude control device according to the present embodiment is provided with a body rolling sensor 621.
The airframe rolling sensor 621 is for detecting an inclination angle of the vehicle main body 50 with respect to the left-right direction. For example, a pendulum type sensor can be used.
In the present embodiment, the airframe rolling sensor 621 is disposed on the upper surface of the working machine lifting mechanism 200 and at a position behind the control seat 7 (see FIGS. 1 to 4).

このように構成された姿勢制御コントローラ600は、前記ロータリ耕耘機400の検出上下位置hLを前記上下位置操作手段による設定高さ位置hSに追従させる自動高さ制御と、前記ロータリ耕耘機400の検出耕耘位置hDを前記耕深設定器626による設定耕深位置hRに追従させる自動耕深制御と、前記ロータリ耕耘機400の前記車輌本体50に対する検出傾斜状態t(図9参照)を前記傾斜設定器623による設定傾斜状態tSに追従させる自動傾き制御とを実行し得るように構成されている。   The posture control controller 600 configured in this way includes automatic height control for causing the detected vertical position hL of the rotary tiller 400 to follow the set height position hS by the vertical position operating means, and detection of the rotary tiller 400. Automatic tilling control for causing the tilling position hD to follow the set tilling position hR by the tilling depth setting device 626 and the detected inclination state t (see FIG. 9) of the rotary tiller 400 with respect to the vehicle body 50 are the inclination setting device. It is configured to be able to execute automatic tilt control to follow the set tilt state tS by 623.

前記自動高さ制御は、該姿勢制御装置による前記ロータリ耕耘機400の姿勢制御中であって、前記自動耕深制御の非作動時に実行される。
即ち、前記ロータリ耕耘機400が最上昇位置に位置している状態から前記作業機昇降レバー22を下降操作した際や、前記ロータリ耕耘機400の耕耘作業状態から前記作業機昇降レバー22を上昇操作した際に、該自動高さ制御が実行される。
該自動高さ制御の実行時には、前記姿勢制御コントローラ600は、前記リフト角センサ627の検出リフト角度θLに基づく検出高さ位置hLが前記作業機昇降レバー22にて設定された設定高さ位置hSとなるように前記昇降制御油圧シリンダ220の自動高さ制御量を算出し、該算出された自動高さ制御量を用いて前記昇降制御油圧シリンダ220を駆動させる。
The automatic height control is executed during the posture control of the rotary tiller 400 by the posture control device, and when the automatic tillage depth control is not in operation.
That is, when the work implement elevating lever 22 is lowered from the state where the rotary tiller 400 is located at the highest position, or when the work implement elevating lever 22 is raised from the plowing operation state of the rotary tiller 400. When this happens, the automatic height control is executed.
At the time of execution of the automatic height control, the posture controller 600 determines that the detected height position hL based on the detected lift angle θL of the lift angle sensor 627 is set by the work implement lifting lever 22. Then, an automatic height control amount of the lift control hydraulic cylinder 220 is calculated so that the lift control hydraulic cylinder 220 is driven using the calculated automatic height control amount.

前記自動耕深制御は、前記ロータリ耕耘機400の耕深作業時に実行される。
例えば、前記ロータリ耕耘機400が最上昇位置に位置している状態から前記作業機昇降レバー22を下降操作することにより、前記自動高さ制御にて下降する該ロータリ耕耘機400が接地すると、若しくは、前記耕深設定器626によって設定された設定耕深位置hRに到達すると、前記自動高さ制御から該自動耕深制御に移行される。
該自動耕深制御の実行時には、前記姿勢制御コントローラ600は、前記リヤカバーセンサ624の検出回動角度θDに基づく検出耕深位置hDが前記耕深設定器626にて設定された設定耕深位置hRとなるように前記昇降制御油圧シリンダ220の自動耕深制御量を算出し、該算出された自動耕深制御量を用いて前記昇降制御油圧シリンダ220を駆動させる。
The automatic tilling control is executed at the time of tilling work of the rotary tiller 400.
For example, when the rotary tiller 400 that is lowered by the automatic height control is grounded by lowering the work implement lifting lever 22 from a state where the rotary tiller 400 is located at the highest position, or When the set working depth position hR set by the working depth setting device 626 is reached, the automatic height control is shifted to the automatic working depth control.
At the time of execution of the automatic tilling depth control, the posture control controller 600 sets the set tilling depth position hR in which the detected tilling position hD based on the detected rotation angle θD of the rear cover sensor 624 is set by the tilling depth setting device 626. Then, the automatic tilling control amount of the lifting control hydraulic cylinder 220 is calculated so that the lifting control hydraulic cylinder 220 is driven using the calculated automatic tilling control amount.

前記自動傾き制御は、該姿勢制御装置による前記ロータリ耕耘機400の姿勢制御中においては常時作動するようになっている。
即ち、前記自動高さ制御又は前記自動耕深制御の何れが実行されているかに拘わらず、該自動傾き制御は実行される。
該自動傾き制御の実行時には、前記姿勢制御コントローラ600は、前記作業機ポジションセンサ622の検出傾斜角度φに基づく検出傾斜位置tが前記傾斜設定器623にて設定された設定傾斜状態tSとなるように前記傾斜制御油圧シリンダ240の自動傾き制御量を算出し、該算出された自動傾き制御量を用いて前記傾斜制御油圧シリンダ240を駆動させる。
The automatic tilt control is always operated during the posture control of the rotary tiller 400 by the posture control device.
That is, the automatic tilt control is executed regardless of whether the automatic height control or the automatic tilling depth control is executed.
At the time of execution of the automatic tilt control, the posture controller 600 causes the detected tilt position t based on the detected tilt angle φ of the work implement position sensor 622 to be the set tilt state tS set by the tilt setter 623. Then, an automatic tilt control amount of the tilt control hydraulic cylinder 240 is calculated, and the tilt control hydraulic cylinder 240 is driven using the calculated automatic tilt control amount.

さらに、該姿勢制御コントローラ600は、前記車輌本体50の車速vが所定の閾値車速vSより高速の場合には、前記自動傾き制御の制御精度を緩和させるように構成されている。
即ち、前記車輌本体50の車速vが所定の閾値車速vSより高速の場合には非耕耘状態にあると擬制して、前記自動傾き制御の制御精度を緩和させる。これにより、前記自動傾き制御の制御性を悪化させ、前記車輌本体50が高速走行時において、前記ロータリ耕耘機400が意に反して左右方向へ傾動するという不都合を防止し得るようになっている。
なお、前記自動傾き制御の制御精度の緩和は、自動傾き制御ゲインGaを低減化する「制御ゲインの低減化」、前記自動傾斜制御を行う際の不感帯幅δを拡大する「不感帯幅の拡大」、又は前記フィルタ部625のフィルタリング条件を変更する「フィルタリング条件の変更」のうち、少なくとも何れか一の手段を行うことによって実行される。
Further, the attitude controller 600 is configured to relax the control accuracy of the automatic tilt control when the vehicle speed v of the vehicle body 50 is higher than a predetermined threshold vehicle speed vS.
That is, when the vehicle speed v of the vehicle body 50 is higher than a predetermined threshold vehicle speed vS, it is assumed that the vehicle is in a non-plowing state, and the control accuracy of the automatic tilt control is relaxed. As a result, the controllability of the automatic tilt control is deteriorated, and it is possible to prevent the inconvenience that the rotary tiller 400 tilts in the left-right direction when the vehicle body 50 is traveling at a high speed. .
The control accuracy of the automatic tilt control is reduced by reducing the automatic tilt control gain Ga by “reducing the control gain” or by increasing the dead zone width δ when performing the automatic tilt control. Alternatively, it is executed by performing at least one of “filtering condition change” for changing the filtering condition of the filter unit 625.

さらに、該姿勢制御コントローラ600は、前記自動傾き制御の制御精度を緩和させるか否かの基準となる前記閾値車速vSを、前記自動高さ制御での設定高さ位置hSに応じて変更するように構成されている。
即ち、本実施の形態においては、前記作業機昇降レバー22の設定高さ位置hSに応じて、前記閾値車速vSを変更するようになっており、これにより、前記ロータリ耕耘機400を最上昇位置よりは下方で且つ地面Gよりは上方に位置させた非耕耘作業状態での前記車輌本体50の走行時に、前記自動傾き制御によって前記ロータリ耕耘機400が意に反して大きく傾動することを有効に防止できる。
従って、前記車輌本体50の走行バランスを良好に維持できると共に、前記ロータリ耕耘機400が地面G等に接触する等の不都合を防止できる。
Further, the attitude controller 600 changes the threshold vehicle speed vS, which is a criterion for whether or not to reduce the control accuracy of the automatic tilt control, according to the set height position hS in the automatic height control. It is configured.
That is, in the present embodiment, the threshold vehicle speed vS is changed in accordance with the set height position hS of the work implement lifting lever 22, whereby the rotary tiller 400 is moved to the highest position. When the vehicle main body 50 is traveling in a non-plowing work state that is positioned below and above the ground G, it is effective that the rotary tiller 400 tilts unexpectedly by the automatic tilt control. Can be prevented.
Accordingly, it is possible to maintain a good traveling balance of the vehicle body 50 and to prevent inconvenience such as the rotary tiller 400 coming into contact with the ground G or the like.

本実施の形態においては、前記設定高さ位置hSが接地位置hEより高い場合には、該設定高さ位置hSが高くなるに従って前記閾値車速vSを低速とするように構成されている。
斯かる構成によれば、従来の自動傾き制御が実行されていたような低速走行時においても、該自動傾き制御による前記ロータリ耕耘機400の傾動量を抑えることができる。
従って、前記ロータリ耕耘機400を最上昇位置よりは下方で且つ地面Gよりは上方に位置させた非耕耘作業状態での圃場内又は路上での走行時に、前記車輌本体50の走行バランスを良好に維持できると共に、前記ロータリ耕耘機400が地面等に接触するという不都合を防止できる。
In the present embodiment, when the set height position hS is higher than the ground contact position hE, the threshold vehicle speed vS is decreased as the set height position hS increases.
According to such a configuration, it is possible to suppress the amount of tilting of the rotary tiller 400 by the automatic tilt control even during low-speed traveling where conventional automatic tilt control has been performed.
Accordingly, when the rotary tiller 400 is positioned below the highest position and above the ground G, the vehicle main body 50 is well balanced when traveling in the field or on the road in a non-plowing work state. While being able to maintain, the trouble that the said rotary tiller 400 contacts the ground etc. can be prevented.

図11に、閾値車速vSと設定高さ位置hSとの関係を示す制御マップの図を示す。
具体的には、前記ROM602には、前記閾値車速vSと、前記作業機昇降レバー22の設定高さ位置hSとの関係を示す第1関係式又は制御マップが予め記憶されている。
この場合の前記第1関係式としては、例えば、基準となる閾値車速(基準閾値車速)をvS’とすると、設定高さ位置hSが接地位置hEと同一又は接地位置hEより低い場合には、vS=vS’とし、且つ、設定高さ位置hSが前記接地位置hEより高い場合には、vS=A1×hS+B1(但しhS>hE)となるような関係式を挙げることができる。ここで、A1は比例定数、B1は定数である。
なお、図11は、この第1関係式を制御マップとした場合のグラフである。図11では、前記作業機昇降レバー22の設定高さ位置hSを横軸に採り、前記閾値車速vSを縦軸に採っている。
FIG. 11 is a control map showing the relationship between the threshold vehicle speed vS and the set height position hS.
Specifically, the ROM 602 stores in advance a first relational expression or control map indicating the relationship between the threshold vehicle speed vS and the set height position hS of the work implement lifting lever 22.
As the first relational expression in this case, for example, if the reference threshold vehicle speed (reference threshold vehicle speed) is vS ′, when the set height position hS is equal to or lower than the ground contact position hE, When vS = vS ′ and the set height position hS is higher than the ground contact position hE, a relational expression such that vS = A1 × hS + B1 (where hS> hE) can be given. Here, A1 is a proportionality constant, and B1 is a constant.
FIG. 11 is a graph when the first relational expression is a control map. In FIG. 11, the set height position hS of the work implement lifting lever 22 is taken on the horizontal axis, and the threshold vehicle speed vS is taken on the vertical axis.

斯かる構成により、前記姿勢制御コントローラ600は、作業機昇降レバー22の設定高さ位置hSが接地位置hEと同位置又は接地位置hEより低い場合には、閾値車速vSを前記基準閾値車速vS’に設定し、且つ、前記設定高さ位置hSが接地位置hEより高い場合には、前記設定高さ位置hSが「低い」→「高い」になるに連れて閾値車速Sを低くする。
なお、前記作業機昇降レバー22の設定高さ位置hSとこれに対応する前記閾値車速vSとが関連づけられたデータを、テーブルマップとして前記ROM602に予め記憶させるようにしてもよい。
With such a configuration, the attitude controller 600 sets the threshold vehicle speed vS to the reference threshold vehicle speed vS ′ when the set height position hS of the work implement lifting lever 22 is the same position as the ground contact position hE or lower than the ground contact position hE. When the set height position hS is higher than the ground contact position hE, the threshold vehicle speed S is lowered as the set height position hS changes from “low” to “high”.
Note that data in which the set height position hS of the work implement elevating lever 22 and the corresponding threshold vehicle speed vS are associated with each other may be stored in advance in the ROM 602 as a table map.

好ましくは、前記自動傾き制御の制御精度の緩和の程度が、前記車輌本体50の車速vに応じて変更されるように構成することができる。
即ち、前記車輌本体50の車速vが前記閾値車速vSより高速の場合には、該車速vが大きくなるに従って前記自動傾き制御の制御精度の緩和の程度を大きくするように構成することができる。
Preferably, the degree of relaxation of the control accuracy of the automatic tilt control may be changed according to the vehicle speed v of the vehicle main body 50.
That is, when the vehicle speed v of the vehicle body 50 is higher than the threshold vehicle speed vS, the degree of relaxation of the control accuracy of the automatic tilt control can be increased as the vehicle speed v increases.

図12に、自動傾き制御ゲインGaと前記車輌本体50の車速vとの関係を示す制御マップを示す。
例えば、前記「制御ゲインの低減化」によって前記自動傾き制御の制御精度の緩和を行う場合には、前記ROM602には、自動傾き制御ゲインGaと、前記車輌本体50の車速vとの関係を示す第2関係式又は制御マップが予め記憶されている。
この場合の前記第2関係式としては、例えば、基準となる自動傾き制御ゲイン(基準自動傾き制御ゲイン)をGa’とすると、前記車輌本体50の車速vが閾値車速vSと同速又は前記車速vSより低速の場合には、Ga=Ga’とし、且つ、前記車輌本体50の車速vが前記閾値車速vSより高速の場合には、Ga=A2×v+B2(但しv>vS)となるような関係式を挙げることができる。ここで、A2は比例定数、B2は定数である。
この第2関係式を制御マップとした場合を、図12に示している。図12では、前記車輌本体50の車速vを横軸に採り、前記自動傾き制御ゲインGaを縦軸に採っている。
FIG. 12 shows a control map showing the relationship between the automatic tilt control gain Ga and the vehicle speed v of the vehicle body 50.
For example, when the control accuracy of the automatic tilt control is reduced by the “reduction of control gain”, the ROM 602 shows the relationship between the automatic tilt control gain Ga and the vehicle speed v of the vehicle body 50. A second relational expression or a control map is stored in advance.
As the second relational expression in this case, for example, when the reference automatic inclination control gain (reference automatic inclination control gain) is Ga ′, the vehicle speed v of the vehicle body 50 is equal to the threshold vehicle speed vS or the vehicle speed. When the vehicle speed is lower than vS, Ga = Ga ′, and when the vehicle speed v of the vehicle body 50 is higher than the threshold vehicle speed vS, Ga = A2 × v + B2 (where v> vS). Relational expressions can be mentioned. Here, A2 is a proportionality constant, and B2 is a constant.
FIG. 12 shows a case where this second relational expression is a control map. In FIG. 12, the vehicle speed 50 of the vehicle body 50 is taken on the horizontal axis, and the automatic tilt control gain Ga is taken on the vertical axis.

斯かる構成を備えることにより、前記姿勢制御コントローラ600は、前記車輌本体50の車速vが閾値車速vSと同速又は閾値車速vSより低速の場合には、自動傾き制御ゲインGaを前記基準自動傾き制御ゲインGa’に設定し、且つ、前記車輌本体50の車速vが閾値車速vSより高速の場合には、前記車輌本体50の車速vが「低速」→「高速」になるに連れて自動傾き制御ゲインGaを低減する。
なお、前記車輌本体50の車速vとこれに対応する自動傾き制御ゲインGaとが関連づけられたデータを、テーブルマップとして前記ROM602に予め記憶させるようにしてもよい。
By providing such a configuration, the attitude control controller 600 sets the automatic inclination control gain Ga to the reference automatic inclination when the vehicle speed v of the vehicle body 50 is the same speed as the threshold vehicle speed vS or lower than the threshold vehicle speed vS. When the control gain Ga ′ is set and the vehicle speed v of the vehicle body 50 is higher than the threshold vehicle speed vS, the vehicle body 50 is automatically tilted as the vehicle speed v changes from “low speed” to “high speed”. The control gain Ga is reduced.
Note that data in which the vehicle speed v of the vehicle main body 50 and the corresponding automatic inclination control gain Ga are associated may be stored in advance in the ROM 602 as a table map.

図13に、不感帯の幅δと前記車輌本体50の車速vとの関係を示す関係を示す制御マップの図を示す。
前記「制御ゲインの低減化」に代えて、若しくは、加えて、前記「不感帯幅の拡大」によって前記自動傾き制御の制御精度の緩和を行う場合には、前記ROM602には、前記自動傾き制御の際に用いる不感帯の幅δと、前記車輌本体50の車速vとの関係を示す第3関係式又は制御マップが予め記憶される。
この場合の前記第3関係式としては、例えば、基準となる不感帯の幅(基準不感帯幅)をδ’とすると、前記車輌本体50の車速vが閾値車速vSと同速又は前記車速vSより低速の場合には、δ=δ’とし、且つ、前記車輌本体50の車速vが前記閾値車速vSより高速の場合には、δ=A3×v+B3(但しv>vS)となるような関係式を挙げることができる。ここで、A3は比例定数、B3は定数である。
この第3関係式を制御マップとした場合を、図13に示している。図13では、前記車輌本体50の車速vを横軸に採り、前記不感帯の幅δを縦軸に採っている。
FIG. 13 is a control map showing the relationship between the dead zone width δ and the vehicle speed v of the vehicle body 50.
In place of or in addition to the “reduction of control gain”, when the control accuracy of the automatic tilt control is relaxed by “increasing the dead zone width”, the ROM 602 stores the automatic tilt control. A third relational expression or a control map indicating the relationship between the dead zone width δ used at the time and the vehicle speed v of the vehicle body 50 is stored in advance.
As the third relational expression in this case, for example, if the width of the reference dead zone (reference dead zone width) is δ ′, the vehicle speed v of the vehicle main body 50 is the same speed as the threshold vehicle speed vS or lower than the vehicle speed vS. In this case, when δ = δ ′ and when the vehicle speed v of the vehicle body 50 is higher than the threshold vehicle speed vS, a relational expression such that δ = A3 × v + B3 (where v> vS) is established. Can be mentioned. Here, A3 is a proportionality constant, and B3 is a constant.
FIG. 13 shows a case where this third relational expression is used as a control map. In FIG. 13, the vehicle speed 50 of the vehicle body 50 is taken on the horizontal axis, and the dead zone width δ is taken on the vertical axis.

斯かる構成を備えることにより、前記姿勢制御コントローラ600は、前記車輌本体50の車速vが閾値車速vSと同速又は閾値車速vSより低速の場合には、不感帯の幅δを前記基準不感帯幅δ’に設定し、且つ、前記車輌本体50の車速vが閾値車速vSより高速の場合には、前記車輌本体50の車速vが「低速」→「高速」になるに連れて不感帯の幅δを広くする。
なお、前記車輌本体50の車速vとこれに対応する不感帯の幅δとが関連づけられたデータを、テーブルマップとして前記ROM602に予め記憶させるようにしてもよい。
ここで、不感帯とは、前記ロータリ耕耘機400の検出傾斜位置tが前記傾斜設定器623による設定傾斜位置tsを中心とする所定の上下幅範囲内にあれば、傾斜制御油圧シリンダ240を非駆動とし、検出傾斜位置tが前記上下幅範囲から外れていれば、傾斜制御油圧シリンダ240を昇降動させて前記ロータリ耕耘機400の傾斜状態を設定傾斜状態tSに近付ける動作隙間のことをいう。
By providing such a configuration, the attitude control controller 600 sets the dead zone width δ to the reference dead zone width δ when the vehicle speed v of the vehicle body 50 is the same speed as the threshold vehicle speed vS or lower than the threshold vehicle speed vS. When the vehicle speed v of the vehicle body 50 is higher than the threshold vehicle speed vS, the dead zone width δ is increased as the vehicle speed v of the vehicle body 50 changes from “low speed” to “high speed”. Make it wide.
Note that data in which the vehicle speed v of the vehicle main body 50 and the dead zone width δ corresponding thereto are associated may be stored in advance in the ROM 602 as a table map.
Here, the dead zone means that the tilt control hydraulic cylinder 240 is not driven if the detected tilt position t of the rotary tiller 400 is within a predetermined vertical range centered on the tilt position ts set by the tilt setter 623. If the detected tilt position t is outside the range of the vertical width, the tilt control hydraulic cylinder 240 is moved up and down to indicate an operation gap that brings the tilted state of the rotary tiller 400 closer to the set tilt state tS.

図14に、遮断周波数fcと前記車輌本体50の車速vとの関係を示す制御マップの図を示す。
前記「制御ゲインの低減化」及び/又は前記「不感帯幅の拡大」に代えて、若しくは、加えて、前記「フィルタリング条件の変更」によって前記自動傾き制御の制御精度の緩和を行う場合には、前記ROM602には、前記フィルタ部625の遮断周波数fcと、前記車輌本体50の車速vとの関係を示す第4関係式又は制御マップが予め記憶されている。
この場合の前記第4関係式としては、例えば、基準となる遮断周波数(基準遮断周波数)をfc’とすると、前記車輌本体50の車速vが閾値車速vSと同速又は前記車速vSより低速の場合には、fc=fc’とし、且つ、前記車輌本体50の車速vが前記閾値車速vSより高速の場合には、fc=A4×v+B4(但しv>vS)となるような関係式を挙げることができる。ここで、A4は比例定数、B4は定数である。
この第4関係式を制御マップとした場合を、図14に示している。図14では、前記車輌本体50の車速vを横軸に採り、前記遮断周波数fcを縦軸に採っている。
斯かる構成を備えることにより、前記姿勢制御コントローラ600は、前記車輌本体50の車速vが閾値車速vSと同速又は閾値車速vSより低速の場合には、遮断周波数fcを前記基準遮断周波数fc’に設定し、且つ、前記車輌本体50の車速vが閾値車速vSより高速の場合には、前記車輌本体50の車速vが「低速」→「高速」になるに連れて遮断周波数fcを低くする。
なお、前記車輌本体50の車速vSとこれに対応する遮断周波数fcとが関連づけられたデータを、テーブルマップとして前記ROM602に予め記憶させるようにしてもよい。
つまり、前記フィルタ部625の遮断周波数fcは、前記車輌本体50の車速vに対応する制御情報に応じて可変となっている。即ち、前記車輌本体50の車速vの制御情報に基づき遮断周波数fcを演算し、この演算結果の制御情報を前記フィルム部625に伝送することにより、遮断周波数をfcとするフィルタ部125が形成される。
FIG. 14 is a control map showing the relationship between the cut-off frequency fc and the vehicle speed v of the vehicle body 50.
In place of or in addition to the “reduction of the control gain” and / or the “expansion of the dead zone width”, in addition, when the control accuracy of the automatic tilt control is relaxed by the “change of the filtering condition”, The ROM 602 stores in advance a fourth relational expression or control map indicating the relationship between the cutoff frequency fc of the filter unit 625 and the vehicle speed v of the vehicle body 50.
As the fourth relational expression in this case, for example, if the reference cutoff frequency (reference cutoff frequency) is fc ′, the vehicle speed v of the vehicle body 50 is the same speed as the threshold vehicle speed vS or lower than the vehicle speed vS. In this case, when fc = fc ′ and the vehicle speed v of the vehicle main body 50 is higher than the threshold vehicle speed vS, a relational expression such that fc = A4 × v + B4 (where v> vS) is given. be able to. Here, A4 is a proportionality constant, and B4 is a constant.
FIG. 14 shows a case where this fourth relational expression is used as a control map. In FIG. 14, the vehicle speed 50 of the vehicle body 50 is taken on the horizontal axis, and the cutoff frequency fc is taken on the vertical axis.
By providing such a configuration, the attitude control controller 600 sets the cutoff frequency fc to the reference cutoff frequency fc ′ when the vehicle speed v of the vehicle body 50 is the same speed as the threshold vehicle speed vS or lower than the threshold vehicle speed vS. When the vehicle speed v of the vehicle body 50 is higher than the threshold vehicle speed vS, the cutoff frequency fc is lowered as the vehicle speed v of the vehicle body 50 is changed from “low speed” to “high speed”. .
Note that data in which the vehicle speed vS of the vehicle main body 50 and the corresponding cutoff frequency fc are associated with each other may be stored in advance in the ROM 602 as a table map.
That is, the cut-off frequency fc of the filter unit 625 is variable according to control information corresponding to the vehicle speed v of the vehicle body 50. That is, the cutoff frequency fc is calculated based on the control information of the vehicle speed 50 of the vehicle body 50, and the control information of the calculation result is transmitted to the film unit 625, thereby forming the filter unit 125 having the cutoff frequency fc. The

前記フィルタ部625としては、低域フィルタ(ローパスフィルタ、LPF)、高域フィルタ(ハイパスフィルタ、HPF)、帯域フィルタ(バンドパスフィルタ、BPF)、又は帯域消去フィルタ(バンドエリミネ−ションフィルタ、BEF)を採用することができる。本実施の形態では、前記フィルタ部625として低域フィルタが採用されている。周知の通り、低域フィルタは、その遮断周波数fcより高い周波数域の信号をほぼ0(零)とし、遮断周波数fc以下の周波数域の信号をそのまま通過させるように構成されている。遮断周波数fcは周波数の通過域と減衰域との境界値のことである。
本実施の形態では、前記フィルタ部625で採用される遮断周波数fcは可変となっている。この可変の構成としては、例えば、LCフィルタ(コイルとコンデンサとからなるフィルタ)の場合は、可変コンデンサを使用することで実現できる。また、RCフィルタ(抵抗とコンデンサとからなるフィルタ)の場合は、可変抵抗と可変コンデンサとの組合せで実現できる。
As the filter unit 625, a low-pass filter (low-pass filter, LPF), a high-pass filter (high-pass filter, HPF), a band filter (band-pass filter, BPF), or a band elimination filter (band elimination filter, BEF). Can be adopted. In the present embodiment, a low-pass filter is employed as the filter unit 625. As is well known, the low-pass filter is configured such that a signal in a frequency range higher than the cutoff frequency fc is substantially 0 (zero), and a signal in a frequency range equal to or lower than the cutoff frequency fc is passed as it is. The cut-off frequency fc is a boundary value between the frequency pass band and the attenuation band.
In the present embodiment, the cutoff frequency fc employed by the filter unit 625 is variable. For example, in the case of an LC filter (a filter composed of a coil and a capacitor), this variable configuration can be realized by using a variable capacitor. In the case of an RC filter (a filter composed of a resistor and a capacitor), it can be realized by a combination of a variable resistor and a variable capacitor.

次に、前記姿勢制御コントローラ600による前記ロータリ耕耘機400の姿勢制御動作の一例を以下に詳述する。
この姿勢制御装置では、前記作業機昇降レバー22が前記ロータリ耕耘機400が最上昇位置よりも下方位置に位置するように操作したとき、或いは、図示しない自動制御スイッチをON操作したときに姿勢制御動作を開始する。
Next, an example of the attitude control operation of the rotary tiller 400 by the attitude controller 600 will be described in detail below.
In this attitude control device, the attitude control is performed when the work implement elevating lever 22 is operated so that the rotary tiller 400 is positioned below the highest position, or when an automatic control switch (not shown) is turned ON. Start operation.

図15に、第1実施形態に係る姿勢制御装置による制御フローを示すフローチャートを示す。
先ず、前記ロータリ耕耘機400の検出高さ位置hLが設定高さ位置hSより高いか否かを判断する(ステップS1)。
具体的には、前記リフト角センサ627で読み込まれた検出リフト角度θLに基づく検出高さ位置hLが前記作業機昇降レバー22の設定リフト角度θSに基づく設定高さ位置hSより高いと判断した場合には、ステップS2に移行する一方、前記検出高さ位置hLが前記設定高さ位置hS以下であると判断した場合には、ステップS6に移行する。
FIG. 15 is a flowchart showing a control flow by the attitude control device according to the first embodiment.
First, it is determined whether or not the detected height position hL of the rotary tiller 400 is higher than the set height position hS (step S1).
Specifically, when it is determined that the detected height position hL based on the detected lift angle θL read by the lift angle sensor 627 is higher than the set height position hS based on the set lift angle θS of the work implement lifting lever 22 On the other hand, the process proceeds to step S2, whereas if it is determined that the detected height position hL is equal to or less than the set height position hS, the process proceeds to step S6.

前記ステップS1で前記ロータリ耕耘機400の検出高さ位置hLが前記設定高さ位置hSより高いと判断した場合、前記自動耕深制御中か否かを判断する(ステップS2)。
具体的には、前記自動耕深制御中でないと判断した場合には、ステップS3に移行する一方、前記自動耕深制御中であると判断した場合には、ステップS4に移行する。
If it is determined in step S1 that the detected height position hL of the rotary tiller 400 is higher than the set height position hS, it is determined whether or not the automatic tilling control is being performed (step S2).
Specifically, when it is determined that the automatic plowing depth control is not being performed, the process proceeds to step S3. On the other hand, when it is determined that the automatic plowing depth control is being performed, the process proceeds to step S4.

前記ステップS2で前記自動耕深制御中でないと判断した場合、前記ロータリ耕耘機400の耕深位置hDが前記耕深設定器626の設定耕深位置hRより深いか否かを判断する(ステップS3)。
具体的には、前記リヤカバーセンサ624で読み込まれた検出上下回動角度θDに基づく検出耕深位置hDが前記耕深設定器626の設定回動角度θRに基づく設定耕深位置hRより深いと判断した場合には、ステップS4に移行する一方、前記検出耕深位置hDが前記設定耕深位置hRと同じか前記設定耕深位置hRより浅いと判断した場合には、ステップS6に移行する。
When it is determined in step S2 that the automatic tilling depth control is not being performed, it is determined whether or not the tilling position hD of the rotary tiller 400 is deeper than the setting tilling position hR of the tilling depth setting device 626 (step S3). ).
Specifically, it is determined that the detected tilling position hD based on the detected vertical turning angle θD read by the rear cover sensor 624 is deeper than the set working depth position hR based on the set turning angle θR of the working depth setting device 626. If it is determined that the plowing depth position hD is equal to or shallower than the set plowing depth position hR, the process proceeds to step S6.

前記ステップS2で前記自動耕深制御中であると判断した場合、及び前記ステップS3で前記検出耕深位置hDが前記設定耕深位置hRより深いと判断した場合、前記ロータリ耕耘機400の耕深位置hDを前記耕深設定器626の設定耕深位置hRに追従させる自動耕深制御を行う(ステップS4)。
具体的には、前記リヤカバーセンサ624で読み込まれた検出上下回動角度θDに基づく検出耕深位置hDが前記耕深設定器626の設定回動角度θRに基づく設定耕深位置hRと等しくなるように、前記上昇制御電磁弁502又は前記下降制御電磁弁503を作動させ、前記昇降制御油圧シリンダ220による前記ロータリ耕耘機400の下降又は上昇の動作を実行し、ステップS5に移行する。
If it is determined in step S2 that the automatic tilling depth control is being performed, and if it is determined in step S3 that the detected tilling position hD is deeper than the set tilling position hR, the tilling depth of the rotary tiller 400 is Automatic plowing depth control is performed for causing the position hD to follow the set plowing depth position hR of the plowing depth setting device 626 (step S4).
Specifically, the detected tilling position hD based on the detected vertical turning angle θD read by the rear cover sensor 624 is equal to the set tilling position hR based on the set turning angle θR of the tilling depth setting device 626. Then, the raising control electromagnetic valve 502 or the lowering control electromagnetic valve 503 is operated to perform the lowering or raising operation of the rotary tiller 400 by the raising / lowering control hydraulic cylinder 220, and the process proceeds to step S5.

次に、前記自動傾き制御を基準の制御精度で行う(ステップS5)。
具体的には、前記基準自動傾き制御ゲインGa’、前記基準不感帯幅δ’及び前記基準遮断周波数fc’を前記ROM602から読み出し、該読み出された基準遮断周波数fc’とする前記フィルタ部625を形成する。次に、該形成されたフィルタ部625を介して、前記基準自動傾き制御ゲインGa’と、前記作業機ポジションセンサ622による検出傾斜角度φに基づく検出傾斜位置tとにより該検出傾斜位置tが前記傾斜設定器623にて設定された設定傾斜位置tSとなるように前記傾斜制御油圧シリンダ240の自動傾き制御量を算出する。そして、前記ロータリ耕耘機400の検出傾斜位置tと前記傾斜設定器623による設定傾斜位置tsとの差量が該基準不感帯幅δ’内にあれば、傾斜制御油圧シリンダ240を非駆動とし、該差量が該基準不感帯幅δ’から外れていれば、該算出された自動傾き制御量を用いて前記傾斜制御油圧シリンダ240を駆動させ、ステップS11に移行する。
Next, the automatic tilt control is performed with reference control accuracy (step S5).
Specifically, the filter unit 625 reads the reference automatic inclination control gain Ga ′, the reference dead band width δ ′, and the reference cutoff frequency fc ′ from the ROM 602, and sets the read reference cutoff frequency fc ′ as the read reference cutoff frequency fc ′. Form. Next, the detected tilt position t is determined by the reference automatic tilt control gain Ga ′ and the detected tilt position t based on the detected tilt angle φ by the work implement position sensor 622 through the formed filter unit 625. The automatic tilt control amount of the tilt control hydraulic cylinder 240 is calculated so that the set tilt position tS set by the tilt setter 623 is reached. If the difference between the detected tilt position t of the rotary tiller 400 and the set tilt position ts set by the tilt setter 623 is within the reference dead band width δ ′, the tilt control hydraulic cylinder 240 is not driven, If the difference amount deviates from the reference dead zone width δ ′, the tilt control hydraulic cylinder 240 is driven using the calculated automatic tilt control amount, and the process proceeds to step S11.

一方、前記ステップS1で前記ロータリ耕耘機400の検出高さ位置hLが前記設定高さ位置hS以下であると判断した場合、前記ロータリ耕耘機400の高さ位置hLを前記作業機昇降レバー22の設定高さ位置hSに追従させる自動高さ制御を行う(ステップS6)。
具体的には、前記リフト角センサ627で読み込まれた検出リフト角度θLに基づく検出高さ位置hLが前記作業機昇降レバー22の設定リフト角度θSに基づく設定高さ位置hSと等しくなるように、前記上昇制御電磁弁502又は前記下降制御電磁弁503を作動させ、前記昇降制御油圧シリンダ220による前記ロータリ耕耘機400の下降又は上昇の動作を実行し、ステップS7に移行する。
On the other hand, if it is determined in step S1 that the detected height position hL of the rotary tiller 400 is equal to or less than the set height position hS, the height position hL of the rotary tiller 400 is Automatic height control is performed to follow the set height position hS (step S6).
Specifically, the detected height position hL based on the detected lift angle θL read by the lift angle sensor 627 is equal to the set height position hS based on the set lift angle θS of the work implement lifting lever 22. The raising control electromagnetic valve 502 or the lowering control electromagnetic valve 503 is operated to perform the lowering or raising operation of the rotary tiller 400 by the elevation control hydraulic cylinder 220, and the process proceeds to step S7.

次に、前記閾値車速vSを前記自動高さ制御での設定高さ位置hSに応じて変更する(ステップS7)。
具体的には、前記第1関係式又は制御マップを前記ROM602から読み出し、該読み出された第1関係式又は制御マップを用いて、前記作業機昇降レバー22による設定高さ位置hSに対応した前記閾値車速vSを算出する。この場合の前記閾値車速vSは、前記作業機昇降レバー22の設定高さ位置hSが接地位置hEと同位置又は接地位置hEより低い場合には、前記基準閾値車速vS’となり、前記設定高さ位置hSが接地位置hEより高い場合には、前記設定高さ位置hSが「低い」→「高い」になるに連れて低速とされた値になる(図11参照)。
Next, the threshold vehicle speed vS is changed according to the set height position hS in the automatic height control (step S7).
Specifically, the first relational expression or control map is read from the ROM 602, and the set height position hS by the work implement lifting lever 22 is handled using the read first relational expression or control map. The threshold vehicle speed vS is calculated. In this case, the threshold vehicle speed vS becomes the reference threshold vehicle speed vS ′ when the set height position hS of the work implement lifting lever 22 is the same position as the ground contact position hE or lower than the ground contact position hE, and the set height When the position hS is higher than the ground contact position hE, the set height position hS becomes a value that is decreased as the setting height position hS changes from “low” to “high” (see FIG. 11).

次に、前記車輌本体50の車速vが前記閾値車速vSより高速か否かを判断する(ステップS8)。
具体的には、前記車速センサ628にて検出された前記車輌本体50の検出車速vが前記ステップS7で算出された閾値車速vSより高速であると判断した場合には、ステップS9に移行する一方、前記検出車速vが前記閾値車速vSと同速又は該閾値車速vSより低速であると判断した場合には、ステップS10に移行する。
Next, it is determined whether or not the vehicle speed v of the vehicle body 50 is higher than the threshold vehicle speed vS (step S8).
Specifically, when it is determined that the detected vehicle speed v of the vehicle body 50 detected by the vehicle speed sensor 628 is higher than the threshold vehicle speed vS calculated in step S7, the process proceeds to step S9. If it is determined that the detected vehicle speed v is the same speed as the threshold vehicle speed vS or lower than the threshold vehicle speed vS, the process proceeds to step S10.

前記ステップS8で前記車輌本体50の車速vが前記閾値車速vSより高速であると判断した場合、前記「制御ゲインの低減化」、前記「不感帯幅の拡大」又は前記「フィルタリング条件の変更」のうち、少なくとも何れか一の手段によって、前記自動傾き制御の制御精度を緩和させて該自動傾き制御を行う(ステップS9)。   When it is determined in step S8 that the vehicle speed v of the vehicle main body 50 is higher than the threshold vehicle speed vS, the “control gain reduction”, the “dead zone width increase”, or the “filtering condition change” Among these, the automatic inclination control is performed by relaxing the control accuracy of the automatic inclination control by at least one of the means (step S9).

具体的には、前記「制御ゲインの低減化」による前記自動傾き制御の制御精度の緩和を行う場合、前記車輌本体50の車速vと、前記ROM602に予め記憶された第2関係式又は制御マップとに基づき、前記自動傾き制御ゲインGaを求める。この場合の前記自動傾き制御ゲインGaは、前記車輌本体50の車速vが「低速」→「高速」になるに連れて低減された値になる(図12参照)。次に、該求められた自動傾き制御ゲインGaと、前記作業機ポジションセンサ622による検出傾斜角度φに基づく検出傾斜位置tとにより前記傾斜制御油圧シリンダ240の自動傾き制御量を算出する。こうして算出された自動傾き制御量を用いて前記傾斜制御油圧シリンダ240を駆動させ、ステップS11に移行する。   Specifically, when the control accuracy of the automatic tilt control is reduced by “reducing the control gain”, the vehicle speed v of the vehicle main body 50 and the second relational expression or control map stored in advance in the ROM 602 are used. Based on the above, the automatic inclination control gain Ga is obtained. In this case, the automatic inclination control gain Ga becomes a value that decreases as the vehicle speed v of the vehicle body 50 changes from “low speed” to “high speed” (see FIG. 12). Next, an automatic tilt control amount of the tilt control hydraulic cylinder 240 is calculated based on the obtained automatic tilt control gain Ga and the detected tilt position t based on the tilt angle φ detected by the work machine position sensor 622. The tilt control hydraulic cylinder 240 is driven using the automatic tilt control amount thus calculated, and the process proceeds to step S11.

また、前記「不感帯幅の拡大」による前記自動傾き制御の制御精度の緩和を行う場合、前記車輌本体50の車速vと、前記ROM602に予め記憶された第3関係式又は制御マップとに基づき、前記不感帯の幅δを求める。この場合の前記不感帯の幅δは、前記車輌本体50の車速vが「低速」→「高速」になるに連れて広くされた値になる(図13参照)。次に、前記作業機ポジションセンサ622による検出傾斜位置tが前記傾斜設定器623にて設定された設定傾斜位置tSとなるように前記傾斜制御油圧シリンダ240の自動傾き制御量を算出する。そして、前記ロータリ耕耘機400の検出傾斜位置tと前記傾斜設定器623による設定傾斜位置tsとの差量が該求められた不感帯の幅δ内にあれば、傾斜制御油圧シリンダ240を非駆動とし、該差量が該求められた不感帯の幅δから外れていれば、該算出された自動傾き制御量を用いて前記傾斜制御油圧シリンダ240を駆動させ、ステップS11に移行する。   Further, when the control accuracy of the automatic tilt control is reduced by the “expansion of the dead zone width”, based on the vehicle speed v of the vehicle body 50 and the third relational expression or control map stored in advance in the ROM 602, A width δ of the dead zone is obtained. In this case, the width δ of the dead zone becomes a value that becomes wider as the vehicle speed v of the vehicle body 50 changes from “low speed” to “high speed” (see FIG. 13). Next, the automatic tilt control amount of the tilt control hydraulic cylinder 240 is calculated so that the detected tilt position t by the work implement position sensor 622 becomes the set tilt position tS set by the tilt setter 623. If the difference between the detected tilt position t of the rotary tiller 400 and the set tilt position ts set by the tilt setter 623 is within the obtained dead zone width δ, the tilt control hydraulic cylinder 240 is not driven. If the difference amount deviates from the obtained dead zone width δ, the tilt control hydraulic cylinder 240 is driven using the calculated automatic tilt control amount, and the process proceeds to step S11.

また、前記「フィルタリング条件の拡大」による前記自動傾き制御の制御精度の緩和を行う場合、前記作業車輌50の車速vと、前記ROM602に予め記憶された第4関係式又は制御マップに基づき、前記フィルタ部625の遮断周波数fcを算出する。この場合の遮断周波数fcは、前記車輌本体50の車速vが「低速」→「高速」になるに連れて低くされた値になる(図14参照)。次に、該算出された遮断周波数fcとする前記フィルタ部625を形成し、該フィルタ部625を介して前記作業機ポジションセンサ622で検出傾斜位置tを検出し、この検出傾斜位置tが前記傾斜設定器623にて設定された設定傾斜位置tSとなるように前記傾斜制御油圧シリンダ240の自動傾き制御量を算出する。こうして算出された自動傾き制御量を用いて前記傾斜制御油圧シリンダ240を駆動させ、ステップS11に移行する。   Further, when the control accuracy of the automatic tilt control by the “expansion of filtering conditions” is relaxed, based on the vehicle speed v of the working vehicle 50 and the fourth relational expression or control map stored in advance in the ROM 602, The cutoff frequency fc of the filter unit 625 is calculated. The cut-off frequency fc in this case becomes a value that is lowered as the vehicle speed v of the vehicle body 50 is changed from “low speed” to “high speed” (see FIG. 14). Next, the filter unit 625 having the calculated cut-off frequency fc is formed, and the detected tilt position t is detected by the work machine position sensor 622 via the filter unit 625, and the detected tilt position t is the tilt angle. The automatic tilt control amount of the tilt control hydraulic cylinder 240 is calculated so that the set tilt position tS set by the setter 623 is reached. The tilt control hydraulic cylinder 240 is driven using the automatic tilt control amount thus calculated, and the process proceeds to step S11.

一方、前記ステップS8で前記車輌本体50の車速vが前記閾値車速vSと同速又は前記閾値車速vSより低速であると判断した場合、前記自動傾き制御を基準の制御精度で行う(ステップS10)。
具体的には、前記基準自動傾き制御ゲインGa’、前記基準不感帯幅δ’及び前記基準遮断周波数fc’を前記ROM602から読み出し、該読み出された基準遮断周波数fc’とする前記フィルタ部625を形成する。次に、該形成されたフィルタ部625を介して、前記基準自動傾き制御ゲインGa’と、前記作業機ポジションセンサ622による検出傾斜角度φに基づく検出傾斜位置tとにより該検出傾斜位置tが前記傾斜設定器623にて設定された設定傾斜位置tSとなるように前記傾斜制御油圧シリンダ240の自動傾き制御量を算出する。そして、前記ロータリ耕耘機400の検出傾斜位置tと前記傾斜設定器623による設定傾斜位置tsとの差量が該基準不感帯幅δ’内にあれば、傾斜制御油圧シリンダ240を非駆動とし、該差量が該基準不感帯幅δ’から外れていれば、該算出された自動傾き制御量を用いて前記傾斜制御油圧シリンダ240を駆動させ、ステップS11に移行する。
On the other hand, when it is determined in step S8 that the vehicle speed v of the vehicle body 50 is the same speed as the threshold vehicle speed vS or lower than the threshold vehicle speed vS, the automatic tilt control is performed with reference control accuracy (step S10). .
Specifically, the filter unit 625 reads the reference automatic inclination control gain Ga ′, the reference dead band width δ ′, and the reference cutoff frequency fc ′ from the ROM 602, and sets the read reference cutoff frequency fc ′ as the read reference cutoff frequency fc ′. Form. Next, the detected tilt position t is determined by the reference automatic tilt control gain Ga ′ and the detected tilt position t based on the detected tilt angle φ by the work implement position sensor 622 through the formed filter unit 625. The automatic tilt control amount of the tilt control hydraulic cylinder 240 is calculated so that the set tilt position tS set by the tilt setter 623 is reached. If the difference between the detected tilt position t of the rotary tiller 400 and the set tilt position ts set by the tilt setter 623 is within the reference dead band width δ ′, the tilt control hydraulic cylinder 240 is not driven, If the difference amount deviates from the reference dead zone width δ ′, the tilt control hydraulic cylinder 240 is driven using the calculated automatic tilt control amount, and the process proceeds to step S11.

ステップS11では、姿勢制御作動中か否かを判断し、姿勢制御作動中と判断したときは、ステップS1〜ステップS10までの動作を順次繰り返す一方、姿勢制御作動が終了したと判断したときには、前記姿勢制御を終了する。   In step S11, it is determined whether or not the posture control operation is being performed. When it is determined that the posture control operation is being performed, the operations from step S1 to step S10 are sequentially repeated, whereas when it is determined that the posture control operation has been completed, End attitude control.

(第2実施形態)
以下、本発明に係る姿勢制御装置の第2実施形態について説明する。
この第2実施形態に係る姿勢制御装置は、図10に示す姿勢制御装置とは姿勢制御コントローラ600が異なる以外は実質的に同じものである。従って、第2実施形態に係る姿勢制御装置のブロック図を図10に示すブロック図に代用させ、その詳細な説明を省略する。
(Second Embodiment)
Hereinafter, a second embodiment of the attitude control device according to the present invention will be described.
The posture control device according to the second embodiment is substantially the same as the posture control device shown in FIG. 10 except that the posture control controller 600 is different. Therefore, the block diagram of the attitude control device according to the second embodiment is substituted for the block diagram shown in FIG. 10, and the detailed description thereof is omitted.

第2実施形態に係る姿勢制御装置の姿勢制御コントローラ600aは、前記第1実施形態に係る姿勢制御装置の姿勢制御コントローラ600において前記ROM602の代わりにROM602aを備えている。なお、姿勢制御コントローラ600a及びROM602aの参照符号は図10に示す姿勢制御コントローラ600及びROM602の後の括弧内に付してある。後述する第3実施形態についても同様である。   An attitude control controller 600a of the attitude control apparatus according to the second embodiment includes a ROM 602a instead of the ROM 602 in the attitude control controller 600 of the attitude control apparatus according to the first embodiment. Note that reference numerals of the attitude control controller 600a and the ROM 602a are given in parentheses after the attitude control controller 600 and the ROM 602 shown in FIG. The same applies to a third embodiment to be described later.

該姿勢制御装置は、第1実施形態の姿勢制御装置において、前記車輌本体50の車速vが所定の閾値車速vSより高速の場合には、前記自動傾き制御の制御精度を緩和させる構成に代えて、前記車輌本体50の車速vが前記閾値車速vSより高速の場合には、前記自動傾き制御を停止するように構成されている。
即ち、前記車輌本体50の車速vが所定の閾値車速vSより高速の場合には非耕耘状態にあると擬制して、前記自動傾き制御を停止する。これにより、前記自動傾き制御の意に反する作動を確実に防止することができる。
The posture control device is the posture control device according to the first embodiment, instead of a configuration that relaxes the control accuracy of the automatic tilt control when the vehicle speed v of the vehicle body 50 is higher than a predetermined threshold vehicle speed vS. When the vehicle speed v of the vehicle body 50 is higher than the threshold vehicle speed vS, the automatic tilt control is stopped.
That is, when the vehicle speed v of the vehicle body 50 is higher than a predetermined threshold vehicle speed vS, the automatic tilt control is stopped by assuming that the vehicle body 50 is in a non-plowing state. Thereby, the operation | movement contrary to the meaning of the said automatic inclination control can be prevented reliably.

さらに、該姿勢制御コントローラ600aは、前記閾値車速vSを前記自動高さ制御での設定高さ位置hSに応じて変更するように構成されている。
即ち、本実施の形態においては、前記作業機昇降レバー22の設定高さ位置hSに応じて、前記閾値車速vSを変更するようになっており、これにより、前記ロータリ耕耘機400を最上昇位置よりは下方で且つ地面Gよりは上方に位置させた非耕耘作業状態での前記車輌本体50の走行時に、前記自動傾き制御によって前記ロータリ耕耘機400が意に反して傾動することを確実に防止できる。
従って、前記車輌本体50の走行バランスを良好に維持できると共に、前記ロータリ耕耘機400が地面G等に接触する等の不都合を防止できる。
Further, the attitude controller 600a is configured to change the threshold vehicle speed vS according to the set height position hS in the automatic height control.
That is, in the present embodiment, the threshold vehicle speed vS is changed in accordance with the set height position hS of the work implement lifting lever 22, whereby the rotary tiller 400 is moved to the highest position. When the vehicle body 50 is traveling in a non-plowing work state positioned below and above the ground G, the automatic tiller reliably prevents the rotary tiller 400 from tilting unexpectedly. it can.
Accordingly, it is possible to maintain a good traveling balance of the vehicle body 50 and to prevent inconvenience such as the rotary tiller 400 coming into contact with the ground G or the like.

さらに、該姿勢制御コントローラ600aは、前記自動高さ制御での設定高さ位置hSが接地位置hEより高い場合には、該設定高さhSが高くなるに従って前記閾値車速vSを低速とするように構成されている。これにより、従来においては自動傾き制御が実行されていたような低速走行時においても、該自動傾き制御による前記ロータリ耕耘機400の傾動を防止できる。
従って、前記ロータリ耕耘機400を最上昇位置よりは下方で且つ地面Gよりは上方に位置させた非耕耘作業状態での圃場内又は路上での走行時に、車輌本体50の走行バランスを良好に維持できると共に、前記ロータリ耕耘機400が地面等に接触するという不都合を防止できる。
Further, when the set height position hS in the automatic height control is higher than the ground contact position hE, the attitude controller 600a decreases the threshold vehicle speed vS as the set height hS increases. It is configured. Accordingly, even when the vehicle is traveling at a low speed where automatic tilt control has been performed in the past, the rotary tiller 400 can be prevented from tilting due to the automatic tilt control.
Therefore, the traveling balance of the vehicle main body 50 is well maintained when traveling on the field or on the road in a non-cultivated working state in which the rotary tiller 400 is positioned below the highest position and above the ground G. In addition, the inconvenience that the rotary tiller 400 contacts the ground or the like can be prevented.

前記ROM602aは、制御プログラムP2等を格納したり、前記第1実施形態で用いた第1関係式又は制御マップ並びに基準閾値車速vS’、基準自動傾き制御ゲインGa’、基準不感帯幅δ’及び基準遮断周波数fc’に関する所定のデータ等を記憶するものである。
次に、図16を参照しながら第2実施形態に係る姿勢制御装置による前記ロータリ耕耘機400の姿勢制御動作の一例を以下に説明する。
The ROM 602a stores the control program P2 and the like, and the first relational expression or control map used in the first embodiment, the reference threshold vehicle speed vS ′, the reference automatic inclination control gain Ga ′, the reference dead band width δ ′, and the reference It stores predetermined data relating to the cutoff frequency fc ′.
Next, an example of the attitude control operation of the rotary tiller 400 by the attitude control device according to the second embodiment will be described below with reference to FIG.

図16に、第2実施形態に係る姿勢制御装置による制御フローを示すフローチャートを示す。
図16に示す制御プログラムP2の処理フローは、図15に示す制御プログラムP1の処理フローにおいて、前記ステップS9の代わりにステップS9aを設けている。図16の処理フローは、ステップS9a以外は図15の処理フローと実質的に同じものである。従って、ここではステップS9aを中心に説明する。
FIG. 16 is a flowchart showing a control flow by the attitude control device according to the second embodiment.
The processing flow of the control program P2 shown in FIG. 16 is provided with step S9a instead of step S9 in the processing flow of the control program P1 shown in FIG. The processing flow in FIG. 16 is substantially the same as the processing flow in FIG. 15 except for step S9a. Therefore, step S9a will be mainly described here.

前記ステップS8で前記車輌本体50の車速vが前記閾値車速vSより高速であると判断した場合、前記自動傾き制御を停止し、前記ステップS11に移行する(ステップS9a)。   When it is determined in step S8 that the vehicle speed v of the vehicle body 50 is higher than the threshold vehicle speed vS, the automatic tilt control is stopped and the process proceeds to step S11 (step S9a).

一方、前記ステップS8で前記車輌本体50の車速vが前記閾値車速vSと同速又は前記閾値車速vSより低速であると判断した場合、前記自動傾き制御を基準の制御精度で行い、前記ステップS11に移行する(ステップS10)。   On the other hand, when it is determined in step S8 that the vehicle speed v of the vehicle body 50 is the same speed as the threshold vehicle speed vS or lower than the threshold vehicle speed vS, the automatic inclination control is performed with reference control accuracy, and the step S11 (Step S10).

(第3実施形態)
以下、本発明に係る姿勢制御装置の第3実施形態について説明する。
第3実施形態に係る姿勢制御装置の姿勢制御コントローラ600bは、前記第1実施形態に係る姿勢制御装置の姿勢制御コントローラ600において前記ROM602の代わりにROM602bを備えている。
(Third embodiment)
Hereinafter, a third embodiment of the attitude control device according to the present invention will be described.
The attitude control controller 600b of the attitude control apparatus according to the third embodiment includes a ROM 602b instead of the ROM 602 in the attitude control controller 600 of the attitude control apparatus according to the first embodiment.

該姿勢制御装置は、第1実施形態の姿勢制御装置において、前記車輌本体50の車速vが所定の閾値車速vSより高速の場合には、前記自動傾き制御の制御精度を緩和させる構成に代えて、前記自動高さ制御の際には、前記自動傾き制御の制御精度を緩和させるように構成されている。
即ち、該姿勢制御コントローラ600bは、前記自動高さ制御の際には、非耕耘状態にあると擬制して、前記自動傾き制御の制御精度を緩和させる。これにより、前記ロータリ耕耘機400を最上昇位置よりは下方で且つ地面Gよりは上方に位置させた非耕耘作業状態での前記車輌本体50の走行時に、前記自動傾き制御によって前記ロータリ耕耘機400が意に反して大きく傾動することを有効に防止できる。
従って、前記車輌本体50の走行バランスを良好に維持できると共に、前記ロータリ耕耘機400が地面等に接触する等の不都合を防止できる。
The posture control device is the posture control device according to the first embodiment, instead of a configuration that relaxes the control accuracy of the automatic tilt control when the vehicle speed v of the vehicle body 50 is higher than a predetermined threshold vehicle speed vS. In the automatic height control, the control accuracy of the automatic inclination control is relaxed.
In other words, the posture controller 600b presumes that it is in a non-plowing state during the automatic height control, and relaxes the control accuracy of the automatic tilt control. Thus, when the vehicle main body 50 is traveling in a non-plowing work state in which the rotary tiller 400 is positioned below the highest position and above the ground G, the rotary tiller 400 is controlled by the automatic tilt control. Can be effectively prevented from tilting unexpectedly.
Accordingly, it is possible to maintain a good running balance of the vehicle body 50 and to prevent inconvenience such as the rotary tiller 400 coming into contact with the ground or the like.

好ましくは、前記自動傾き制御の制御精度の緩和の程度が、前記自動高さ制御での設定高さ位置hSに応じて変更されるように構成することができる。これにより、従来においては自動傾き制御が実行されていたような低速走行時においても、該自動傾き制御による前記ロータリ耕耘機400の傾動量を抑えることができる。
従って、前記ロータリ耕耘機400を最上昇位置よりは下方で且つ地面Gよりは上方に位置させた非耕耘作業状態での圃場内又は路上での走行時に、前記車輌本体50の走行バランスを良好に維持できると共に、前記ロータリ耕耘機400が地面等に接触するという不都合を防止できる。
本実施形態においては、該姿勢制御コントローラ600bは、前記自動高さ制御での設定高さ位置hSが前記接地位置hEより高い場合には、該設定高さ位置hSが高くなるに従って前記自動傾き制御の制御精度の緩和の程度を大きくするように構成されている。
Preferably, the degree of relaxation of the control accuracy of the automatic tilt control can be changed according to the set height position hS in the automatic height control. As a result, the amount of tilting of the rotary tiller 400 due to the automatic tilt control can be suppressed even during low-speed traveling where automatic tilt control is conventionally performed.
Accordingly, when the rotary tiller 400 is positioned below the highest position and above the ground G, the vehicle main body 50 is well balanced when traveling in the field or on the road in a non-plowing work state. While being able to maintain, the trouble that the said rotary tiller 400 contacts the ground etc. can be prevented.
In the present embodiment, when the set height position hS in the automatic height control is higher than the ground contact position hE, the attitude controller 600b controls the automatic tilt control as the set height position hS increases. The degree of relaxation of the control accuracy is increased.

前記ROM602bは、制御プログラムP3等を格納したり、後述する各種関係式又は制御マップに関する所定のデータ等を記憶するものである。   The ROM 602b stores a control program P3 and the like, and stores various data related to various relational expressions or control maps described later.

図17に、自動傾き制御ゲインGaと前記作業機昇降レバー22の設定高さ位置hSとの関係を示す制御マップの図を示す。
例えば、前記「制御ゲインの低減化」によって前記自動傾き制御の制御精度の緩和を行う場合には、前記ROM602bには、自動傾き制御ゲインGaと、前記作業機昇降レバー22の設定高さ位置hSとの関係を示す第5関係式又は制御マップが予め記憶されている。
この場合の前記第5関係式としては、例えば、基準となる自動傾き制御ゲイン(基準自動傾き制御ゲイン)をGa’とすると、前記作業機昇降レバー22の設定高さ位置hSが接地位置hEと同位置又は接地位置hEより低い場合には、Ga=Ga’とし、且つ、前記設定高さ位置hSが接地位置hEより高い場合には、Ga=A5×hS+B5(但しhS>hE)となるような関係式を挙げることができる。ここで、A5は比例定数、B5は定数である。
この第5関係式を制御マップとした場合を、図17に示している。図17では、前記作業機昇降レバー22の設定高さ位置hSを横軸に採り、前記自動傾き制御ゲインGaを縦軸に採っている。
FIG. 17 is a control map showing the relationship between the automatic tilt control gain Ga and the set height position hS of the work implement lifting lever 22.
For example, when the control accuracy of the automatic tilt control is reduced by the “reduction of the control gain”, the ROM 602b stores the automatic tilt control gain Ga and the set height position hS of the work implement lifting lever 22. Is stored in advance as a fifth relational expression or control map.
As the fifth relational expression in this case, for example, when the reference automatic tilt control gain (reference automatic tilt control gain) is Ga ′, the set height position hS of the work implement lifting lever 22 is the ground contact position hE. When the position is lower than the ground position hE, Ga = Ga ′, and when the set height position hS is higher than the ground position hE, Ga = A5 × hS + B5 (where hS> hE). Can be mentioned. Here, A5 is a proportionality constant, and B5 is a constant.
FIG. 17 shows a case where this fifth relational expression is used as a control map. In FIG. 17, the set height position hS of the work implement lifting lever 22 is taken on the horizontal axis, and the automatic tilt control gain Ga is taken on the vertical axis.

斯かる構成を備えることにより、前記姿勢制御コントローラ600bは、前記作業機昇降レバー22の設定高さ位置hSが接地位置hEと同位置又は接地位置hEより低い場合には、自動傾き制御ゲインGaを前記基準自動傾き制御ゲインGa’に設定し、且つ、前記設定高さ位置hSが接地位置hEより高い場合には、前記設定高さ位置hSが「低い」→「高い」になるに連れて自動傾き制御ゲインGaを低減する。
なお、前記作業機昇降レバー22の設定高さ位置hSとこれに対応する自動傾き制御ゲインGaとが関連づけられたデータを、テーブルマップとして前記ROM602bに予め記憶させるようにしてもよい。
By providing such a configuration, the posture control controller 600b sets the automatic inclination control gain Ga when the set height position hS of the work implement lifting lever 22 is the same position as the ground position hE or lower than the ground position hE. When the reference automatic inclination control gain Ga ′ is set and the set height position hS is higher than the ground contact position hE, the set height position hS is automatically changed from “low” to “high”. The inclination control gain Ga is reduced.
Data associated with the set height position hS of the work implement lifting lever 22 and the automatic tilt control gain Ga corresponding thereto may be stored in advance in the ROM 602b as a table map.

図18に、不感帯の幅δと前記作業機昇降レバー22の設定高さ位置hSとの関係を示す関係を示す制御マップの図を示す。
前記「制御ゲインの低減化」に代えて、若しくは、加えて、前記「不感帯幅の拡大」によって前記自動傾き制御の制御精度の緩和を行う場合には、前記ROM602bには、前記自動傾き制御の際に用いる不感帯の幅δと、前記作業機昇降レバー22の設定高さ位置hSとの関係を示す第6関係式又は制御マップが予め記憶されている。
この場合の前記第6関係式としては、例えば、基準となる不感帯の幅(基準不感帯幅)をδ’とすると、前記作業機昇降レバー22の設定高さ位置hSが接地位置hEと同位置又は接地位置hEより低い場合には、δ=δ’とし、且つ、前記設定高さ位置hSが接地位置hEより高い場合には、δ=A6×hS+B6(但しhS>hE)となるような関係式を挙げることができる。ここで、A6は比例定数、B6は定数である。
この第6関係式を制御マップとした場合を、図18に示している。図18では、前記作業機昇降レバー22の設定高さ位置hSを横軸に採り、前記不感帯の幅δを縦軸に採っている。
斯かる構成を備えることにより、前記姿勢制御コントローラ600bは、前記作業機昇降レバー22の設定高さ位置hSが接地位置hEと同位置又は接地位置hEより低い場合には、不感帯の幅δを前記基準不感帯幅δ’に設定し、且つ、前記設定高さ位置hSが接地位置hEより高い場合には、前記設定高さ位置hSが「低い」→「高い」になるに連れて不感帯の幅δを広くする。
なお、前記作業機昇降レバー22の設定高さ位置hSとこれに対応する不感帯の幅δとが関連づけられたデータを、テーブルマップとして前記ROM602bに予め記憶させるようにしてもよい。
FIG. 18 is a control map showing a relationship indicating the relationship between the dead zone width δ and the set height position hS of the work implement lifting lever 22.
In place of or in addition to the “reduction of control gain”, when the control accuracy of the automatic tilt control is relaxed by “increasing the dead zone width”, the ROM 602b includes the automatic tilt control. A sixth relational expression or control map indicating the relationship between the dead zone width δ used at this time and the set height position hS of the work implement lifting lever 22 is stored in advance.
As the sixth relational expression in this case, for example, if the reference deadband width (reference deadband width) is δ ′, the set height position hS of the work implement lifting lever 22 is the same position as the ground contact position hE or When lower than the ground contact position hE, δ = δ ′, and when the set height position hS is higher than the ground contact position hE, a relational expression such that δ = A6 × hS + B6 (where hS> hE). Can be mentioned. Here, A6 is a proportionality constant, and B6 is a constant.
The case where this sixth relational expression is used as a control map is shown in FIG. In FIG. 18, the set height position hS of the work implement lifting lever 22 is taken on the horizontal axis, and the dead zone width δ is taken on the vertical axis.
By providing such a configuration, the posture controller 600b allows the dead zone width δ to be set when the set height position hS of the work implement lifting lever 22 is the same position as the ground position hE or lower than the ground position hE. When the reference dead zone width δ ′ is set and the set height position hS is higher than the ground contact position hE, the dead zone width δ increases as the set height position hS changes from “low” to “high”. To widen.
Note that data in which the set height position hS of the work implement lifting lever 22 and the width δ of the dead zone corresponding thereto are associated may be stored in advance in the ROM 602b as a table map.

図19に、遮断周波数fcと前記作業機昇降レバー22の設定高さ位置hSとの関係を示す制御マップの図を示す。
前記「制御ゲインの低減化」及び/又は前記「不感帯幅の拡大」に代えて、若しくは、加えて、前記「フィルタリング条件の変更」によって前記自動傾き制御の制御精度の緩和を行う場合には、前記ROM602bには、前記フィルタ部625の遮断周波数fcと、前記作業機昇降レバー22の設定高さ位置hSとの関係を示す第7関係式又は制御マップが予め記憶されている。
この場合の前記第7関係式としては、例えば、基準となる遮断周波数(基準遮断周波数)をfc’とすると、前記作業機昇降レバー22の設定高さ位置hSが接地位置hEと同位置又は接地位置hEより低い場合には、fc=fc’とし、且つ、前記設定高さ位置hSが接地位置hEより高い場合には、fc=A7×v+B7(但しhS>hE)となるような関係式を挙げることができる。ここで、A7は比例定数、B7は定数である。
この第7関係式を制御マップとした場合を、図19に示している。図19では、前記作業機昇降レバー22の設定高さ位置hSを横軸に採り、前記遮断周波数fcを縦軸に採っている。
斯かる構成を備えることにより、前記姿勢制御コントローラ600bは、前記作業機昇降レバー22の設定高さ位置hSが接地位置hEと同位置又は接地位置hEより低い場合には、遮断周波数fcを基準遮断周波数fc’に設定し、且つ、前記設定高さ位置hSが接地位置hEより高い場合には、前記設定高さ位置hSが「低い」→「高い」になるに連れて遮断周波数fcを低くする。
なお、前記作業機昇降レバー22の設定高さ位置hSとこれに対応する遮断周波数fcとが関連づけられたデータを、テーブルマップとして前記ROM602bに予め記憶させるようにしてもよい。
FIG. 19 shows a control map showing the relationship between the cutoff frequency fc and the set height position hS of the work implement lifting lever 22.
In place of or in addition to the “reduction of the control gain” and / or the “expansion of the dead zone width”, in addition, when the control accuracy of the automatic tilt control is relaxed by the “change of the filtering condition”, In the ROM 602b, a seventh relational expression or a control map indicating the relationship between the cutoff frequency fc of the filter unit 625 and the set height position hS of the work implement lifting lever 22 is stored in advance.
As the seventh relational expression in this case, for example, when the reference cutoff frequency (reference cutoff frequency) is fc ′, the set height position hS of the work implement lifting lever 22 is the same as the grounding position hE or grounding When lower than the position hE, fc = fc ′, and when the set height position hS is higher than the ground contact position hE, a relational expression such that fc = A7 × v + B7 (hS> hE) is established. Can be mentioned. Here, A7 is a proportionality constant, and B7 is a constant.
FIG. 19 shows a case where this seventh relational expression is used as a control map. In FIG. 19, the set height position hS of the work implement lifting lever 22 is taken on the horizontal axis, and the cut-off frequency fc is taken on the vertical axis.
By providing such a configuration, the attitude controller 600b allows the cutoff frequency fc to be a reference cutoff when the set height position hS of the work implement lifting lever 22 is the same position as the ground position hE or lower than the ground position hE. When the frequency fc ′ is set and the set height position hS is higher than the ground contact position hE, the cut-off frequency fc is lowered as the set height position hS changes from “low” to “high”. .
Note that data in which the set height position hS of the work implement lifting lever 22 and the cutoff frequency fc corresponding thereto are associated may be stored in advance in the ROM 602b as a table map.

次に、図20を参照しながら第3実施形態に係る姿勢制御装置による前記ロータリ耕耘機400の姿勢制御動作の一例を以下に詳述する。   Next, an example of the posture control operation of the rotary tiller 400 by the posture control device according to the third embodiment will be described in detail below with reference to FIG.

図20に、第3実施形態に係る姿勢制御装置による制御フローを示すフローチャートを示す。   FIG. 20 is a flowchart showing a control flow by the attitude control device according to the third embodiment.

図20に示す制御プログラムP3の処理フローは、図15に示す制御プログラムP1の処理フローにおいて、前記ステップS7〜前記ステップS10の代わりにステップS9bを設けている。図20の処理フローは、ステップS9b以外は図15の前記ステップS7〜前記ステップS10を除いた処理フローと実質的に同じものである。従って、ここではステップS9bを中心に説明する。   The processing flow of the control program P3 shown in FIG. 20 is provided with step S9b instead of the steps S7 to S10 in the processing flow of the control program P1 shown in FIG. The processing flow in FIG. 20 is substantially the same as the processing flow except for step S7 to step S10 in FIG. 15 except for step S9b. Therefore, step S9b will be mainly described here.

前記ロータリ耕耘機400の高さ位置hLを前記作業機昇降レバー22の設定高さ位置hSに追従させる自動高さ制御を行う前記ステップS6の次に、前記「制御ゲインの低減化」、前記「不感帯幅の拡大」又は前記「フィルタリング条件の変更」のうち、少なくとも何れか一の手段によって、前記自動傾き制御の制御精度を緩和させて該自動傾き制御を行う(ステップS9b)。   After the step S6 for performing automatic height control for causing the height position hL of the rotary tiller 400 to follow the set height position hS of the work implement lifting lever 22, the "reduction of control gain", the " The automatic inclination control is performed by relaxing the control accuracy of the automatic inclination control by at least any one of “expanding dead band width” or “changing the filtering condition” (step S9b).

具体的には、前記「制御ゲインの低減化」による前記自動傾き制御の制御精度の緩和を行う場合、前記作業機昇降レバー22の設定高さ位置hSと、前記ROM602bに予め記憶された第5関係式又は制御マップとに基づき、前記自動傾き制御ゲインGaを求める。この場合の前記自動傾き制御ゲインGaは、前記作業機昇降レバー22の設定高さ位置hSが「低い」→「高い」になるに連れて低減された値になる(図17参照)。次に、該求められた自動傾き制御ゲインGaと、前記作業機ポジションセンサ622による検出傾斜角度φに基づく検出傾斜位置tとにより前記傾斜制御油圧シリンダ240の自動傾き制御量を算出する。こうして算出された自動傾き制御量を用いて前記傾斜制御油圧シリンダ240を駆動させ、ステップS11に移行する。   Specifically, when the control accuracy of the automatic tilt control is reduced by the “reduction of control gain”, the set height position hS of the work implement lifting lever 22 and the fifth pre-stored in the ROM 602b. The automatic inclination control gain Ga is obtained based on the relational expression or the control map. In this case, the automatic inclination control gain Ga becomes a value that decreases as the set height position hS of the work implement lifting lever 22 changes from “low” to “high” (see FIG. 17). Next, an automatic tilt control amount of the tilt control hydraulic cylinder 240 is calculated based on the obtained automatic tilt control gain Ga and the detected tilt position t based on the tilt angle φ detected by the work machine position sensor 622. The tilt control hydraulic cylinder 240 is driven using the automatic tilt control amount thus calculated, and the process proceeds to step S11.

また、前記「不感帯幅の拡大」による前記自動傾き制御の制御精度の緩和を行う場合、前記作業機昇降レバー22の設定高さ位置hSと、前記ROM602bに予め記憶された第6関係式又は制御マップとに基づき、前記不感帯の幅δを求める。この場合の前記不感帯の幅δは、前記作業機昇降レバー22の設定高さ位置hSが「低い」→「高い」になるに連れて広くされた値になる(図18参照)。次に、前記作業機ポジションセンサ622による検出傾斜位置tが前記傾斜設定器623にて設定された設定傾斜位置tSとなるように前記傾斜制御油圧シリンダ240の自動傾き制御量を算出する。そして、前記ロータリ耕耘機400の検出傾斜位置tと前記傾斜設定器623による設定傾斜位置tsとの差量が該求められた不感帯の幅δ内にあれば、傾斜制御油圧シリンダ240を非駆動とし、該差量が該求められた不感帯の幅δから外れていれば、該算出された自動傾き制御量を用いて前記傾斜制御油圧シリンダ240を駆動させ、ステップS11に移行する。   When the control accuracy of the automatic tilt control is reduced by the “expansion of the dead zone width”, the set height position hS of the work implement lifting lever 22 and the sixth relational expression or control stored in advance in the ROM 602b Based on the map, the dead zone width δ is obtained. The width δ of the dead zone in this case becomes a value that is increased as the set height position hS of the work implement lifting lever 22 is changed from “low” to “high” (see FIG. 18). Next, the automatic tilt control amount of the tilt control hydraulic cylinder 240 is calculated so that the detected tilt position t by the work implement position sensor 622 becomes the set tilt position tS set by the tilt setter 623. If the difference between the detected tilt position t of the rotary tiller 400 and the set tilt position ts set by the tilt setter 623 is within the obtained dead zone width δ, the tilt control hydraulic cylinder 240 is not driven. If the difference amount deviates from the obtained dead zone width δ, the tilt control hydraulic cylinder 240 is driven using the calculated automatic tilt control amount, and the process proceeds to step S11.

また、前記「フィルタリング条件の拡大」による前記自動傾き制御の制御精度の緩和を行う場合、前記作業機昇降レバー22の設定高さ位置hSと、前記ROM602bに予め記憶された第7関係式又は制御マップに基づき、前記フィルタ部625の遮断周波数fcを算出する。この場合の遮断周波数fcは、前記作業機昇降レバー22の設定高さ位置hSが「低い」→「高い」になるに連れて低くされた値になる(図19参照)。次に、該算出された遮断周波数fcとする前記フィルタ部625を形成し、該フィルタ部625を介して前記作業機ポジションセンサ622で検出傾斜位置tを検出し、この検出傾斜位置tが前記傾斜設定器623にて設定された設定傾斜位置tSとなるように前記傾斜制御油圧シリンダ240の自動傾き制御量を算出する。こうして算出された自動傾き制御量を用いて前記傾斜制御油圧シリンダ240を駆動させ、ステップS11に移行する。   Further, when the control accuracy of the automatic tilt control is reduced by the “filtering condition expansion”, the set height position hS of the work implement lifting lever 22 and the seventh relational expression or control stored in advance in the ROM 602b Based on the map, the cutoff frequency fc of the filter unit 625 is calculated. The cut-off frequency fc in this case becomes a value that is lowered as the set height position hS of the work implement lifting lever 22 is changed from “low” to “high” (see FIG. 19). Next, the filter unit 625 having the calculated cut-off frequency fc is formed, and the detected tilt position t is detected by the work machine position sensor 622 via the filter unit 625, and the detected tilt position t is the tilt angle. The automatic tilt control amount of the tilt control hydraulic cylinder 240 is calculated so that the set tilt position tS set by the setter 623 is reached. The tilt control hydraulic cylinder 240 is driven using the automatic tilt control amount thus calculated, and the process proceeds to step S11.

(第4実施形態)
以下、本発明に係る姿勢制御装置の第4実施形態について説明する。
第4実施形態に係る姿勢制御装置の姿勢制御コントローラ600cは、前記第3実施形態に係る姿勢制御装置の姿勢制御コントローラ600bにおいて前記ROM602bの代わりにROM602cを備えている。
(Fourth embodiment)
Hereinafter, a fourth embodiment of the attitude control device according to the present invention will be described.
The posture control controller 600c of the posture control device according to the fourth embodiment includes a ROM 602c instead of the ROM 602b in the posture control controller 600b of the posture control device according to the third embodiment.

該姿勢制御装置は、第3実施形態の姿勢制御装置において、前記自動高さ制御の際には、前記自動傾き制御の制御精度を緩和させる構成に代えて、前記自動高さ制御の際には、前記自動傾き制御を停止するように構成されている。これにより、前記ロータリ耕耘機400を最上昇位置よりは下方で且つ地面Gよりは上方に位置させた非耕耘作業状態での前記車輌本体の走行時に、前記自動傾き制御によって前記ロータリ耕耘機400が意に反して大きく傾動することを有効に防止できる。
従って、前記車輌本体50の走行バランスを良好に維持できると共に、前記ロータリ耕耘機400が地面G等に接触する等の不都合を防止できる。
In the attitude control apparatus according to the third embodiment, the attitude control apparatus is configured to reduce the control accuracy of the automatic tilt control during the automatic height control. The automatic tilt control is configured to stop. Accordingly, when the vehicle main body is traveling in the non-plowing work state in which the rotary tiller 400 is positioned below the highest position and above the ground G, the rotary tiller 400 is controlled by the automatic tilt control. It is possible to effectively prevent a large tilt against the intention.
Accordingly, it is possible to maintain a good traveling balance of the vehicle body 50 and to prevent inconvenience such as the rotary tiller 400 coming into contact with the ground G or the like.

前記ROM602cは、制御プログラムP4等を格納したり、前記第3実施形態で用いた基準閾値車速vS’、基準自動傾き制御ゲインGa’、基準不感帯幅δ’及び基準遮断周波数fc’に関する所定のデータ等を記憶するものである。   The ROM 602c stores the control program P4 and the like, and predetermined data regarding the reference threshold vehicle speed vS ′, the reference automatic inclination control gain Ga ′, the reference dead band width δ ′, and the reference cutoff frequency fc ′ used in the third embodiment. Etc. are memorized.

次に、図21を参照しながら第4実施形態に係る姿勢制御装置による前記ロータリ耕耘機400の姿勢制御動作の一例を以下に説明する。   Next, an example of the attitude control operation of the rotary tiller 400 by the attitude control device according to the fourth embodiment will be described below with reference to FIG.

図21に、第4実施形態に係る姿勢制御装置による制御フローを示すフローチャートを示す。
図21に示す制御プログラムP4の処理フローは、図20に示す制御プログラムP3の処理フローにおいて、前記ステップS9bの代わりにステップS9cを設けている。図21の処理フローは、ステップS9c以外は図20の処理フローと実質的に同じものである。従って、ここではステップS9cのみについて説明する。
FIG. 21 is a flowchart showing a control flow by the attitude control device according to the fourth embodiment.
The processing flow of the control program P4 shown in FIG. 21 is provided with step S9c instead of step S9b in the processing flow of the control program P3 shown in FIG. The processing flow in FIG. 21 is substantially the same as the processing flow in FIG. 20 except for step S9c. Accordingly, only step S9c will be described here.

前記ロータリ耕耘機400の高さ位置hLを前記作業機昇降レバー22の設定高さ位置hSに追従させる自動高さ制御を行う前記ステップS6の次に、前記自動傾き制御を停止し、前記ステップS11に移行する(ステップS9c)。   Following the step S6 for performing automatic height control for causing the height position hL of the rotary tiller 400 to follow the set height position hS of the work implement lifting lever 22, the automatic tilt control is stopped, and the step S11 is performed. (Step S9c).

図1は、本実施の形態に係る姿勢制御装置が適用される作業車輌の一例である農作業用トラクタの概略側面図である。FIG. 1 is a schematic side view of a farm tractor as an example of a work vehicle to which the attitude control device according to the present embodiment is applied. 図2は、図1に示すトラクタの概略平面図である。FIG. 2 is a schematic plan view of the tractor shown in FIG. 図3は、図1に示すトラクタにおける耕耘機用昇降機構の概略側面図である。FIG. 3 is a schematic side view of a tiller lifting mechanism in the tractor shown in FIG. 図4は、図3に示す耕耘機用昇降機構の概略平面図である。FIG. 4 is a schematic plan view of the tiller lifting mechanism shown in FIG. 図5は、ロータリ耕耘機の図2におけるV−V線に沿った概略断面図である。5 is a schematic cross-sectional view of the rotary tiller along the line VV in FIG. 図6は、ロータリ耕耘機の概略背面図である。FIG. 6 is a schematic rear view of the rotary tiller. 図7は、トラクタの油圧回路図である。FIG. 7 is a hydraulic circuit diagram of the tractor. 図8は、第1実施形態に係る姿勢制御装置のブロック図である。FIG. 8 is a block diagram of the attitude control device according to the first embodiment. 図9は、ロータリ耕耘機の模式背面図である。FIG. 9 is a schematic rear view of the rotary tiller. 図10は、ロータリ耕耘機の模式側面図である。FIG. 10 is a schematic side view of a rotary tiller. 図11は、閾値車速vSと設定高さ位置hSとの関係を示す制御マップの図である。FIG. 11 is a control map showing the relationship between the threshold vehicle speed vS and the set height position hS. 図12は、自動傾き制御ゲインGaと車輌本体の車速vとの関係を示す制御マップの図である。FIG. 12 is a control map showing the relationship between the automatic tilt control gain Ga and the vehicle speed v of the vehicle body. 図13は、不感帯δの幅と車輌本体の車速vとの関係を示す関係を示す制御マップの図である。FIG. 13 is a control map showing the relationship between the width of the dead zone δ and the vehicle speed v of the vehicle body. 図14は、遮断周波数fcと車輌本体の車速vとの関係を示す制御マップの図である。FIG. 14 is a control map showing the relationship between the cutoff frequency fc and the vehicle speed v of the vehicle body. 図15は、第1実施形態に係る姿勢制御装置による制御フローを示すフローチャートである。FIG. 15 is a flowchart illustrating a control flow by the attitude control device according to the first embodiment. 図16は、第2実施形態に係る姿勢制御装置による制御フローを示すフローチャートである。FIG. 16 is a flowchart illustrating a control flow by the attitude control device according to the second embodiment. 図17は、自動傾き制御ゲインGaと設定高さ位置hSとの関係を示す制御マップの図である。FIG. 17 is a control map showing the relationship between the automatic tilt control gain Ga and the set height position hS. 図18は、不感帯δの幅と設定高さ位置hSとの関係を示す関係を示す制御マップの図である。FIG. 18 is a control map showing a relationship indicating the relationship between the width of the dead zone δ and the set height position hS. 図19は、遮断周波数fcと設定高さ位置hSとの関係を示す制御マップの図である。FIG. 19 is a control map showing the relationship between the cutoff frequency fc and the set height position hS. 図20は、第3実施形態に係る姿勢制御装置による制御フローを示すフローチャートである。FIG. 20 is a flowchart illustrating a control flow by the attitude control device according to the third embodiment. 図21は、第4実施形態に係る姿勢制御装置による制御フローを示すフローチャートである。FIG. 21 is a flowchart illustrating a control flow by the attitude control device according to the fourth embodiment.

50…車輌本体 220…昇降用アクチュエータ 240…傾動用アクチュエータ
400…耕耘機 600…制御手段 622…傾斜状態検出手段
623…傾斜設定手段 624…耕耘位置検出手段 626…耕深深さ設定手段
hD…検出耕深位置 hL…検出上下位置 hS…設定高さ位置 t…検出傾斜状態
tS…設定傾斜状態 v…車速 vS…閾値車速
DESCRIPTION OF SYMBOLS 50 ... Vehicle main body 220 ... Elevating actuator 240 ... Tilt actuator 400 ... Tiller 600 ... Control means 622 ... Inclination state detection means 623 ... Inclination setting means 624 ... Tillage position detection means 626 ... Plowing depth setting means hD ... Detection Plowing depth position hL ... Detected vertical position hS ... Set height position t ... Detected tilt state tS ... Set tilt state v ... Vehicle speed vS ... Threshold vehicle speed

Claims (9)

車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の検出上下位置を該耕耘機に対して設定された設定高さ位置に追従させる自動高さ制御と、前記耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御と、前記耕耘機の前記車輌本体に対する検出傾斜状態を設定傾斜状態に追従させる自動傾き制御とを行うように構成された姿勢制御装置であって、
前記車輌本体の車速が所定の閾値車速より高速の場合には、前記自動傾き制御の制御精度を緩和させると共に、前記設定高さ位置が前記耕耘機の接地位置より高い場合には、該設定高さ位置が高くなるに従って前記閾値車速を低速とするように構成したことを特徴とする姿勢制御装置。
Automatic height control that allows the vertical position of the tiller connected to the vehicle body to be movable up and down and tiltable right and left to follow the set height position set for the tiller, and detection of the tiller An attitude control device configured to perform automatic tilling control for causing the tilling position to follow the set tilling position, and automatic inclination control for causing the detected inclination state of the tiller to follow the set inclination state. There,
When the vehicle speed of the vehicle body is higher than a predetermined threshold vehicle speed, the control accuracy of the automatic tilt control is relaxed, and when the set height position is higher than the ground contact position of the tiller, the set height An attitude control device configured to reduce the threshold vehicle speed as the position increases.
前記自動傾き制御を、フィルタを介して入力された、前記車輌本体に対する前記耕耘機の相対的な傾斜角度に基づいて実行し、
前記自動傾き制御の実行時、前記自動傾き制御の制御ゲインの低減化、前記自動傾き制御の不感帯幅の拡大又は前記フィルタのフィルタリング条件の変更の少なくとも何れか一の手段によって、前記自動傾き制御の制御精度を緩和させるように構成されていることを特徴とする請求項1に記載の姿勢制御装置。
The automatic tilt control is executed based on a relative tilt angle of the cultivator with respect to the vehicle body, which is input through a filter,
When executing the automatic tilt control, the automatic tilt control is performed by at least one of the following means: reduction of the control gain of the automatic tilt control, expansion of the dead zone width of the automatic tilt control, or change of the filtering condition of the filter. The attitude control apparatus according to claim 1, wherein the attitude control apparatus is configured to relax control accuracy.
前記自動傾き制御の制御精度の緩和の程度が、前記作業車輌の車速に応じて変更されるように構成されていることを特徴とする請求項1又は2に記載の姿勢制御装置。   The attitude control device according to claim 1 or 2, wherein a degree of relaxation of the control accuracy of the automatic tilt control is changed according to a vehicle speed of the work vehicle. 車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の検出上下位置を該耕耘機に対して設定された設定高さ位置に追従させる自動高さ制御と、前記耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御と、前記耕耘機の前記車輌本体に対する検出傾斜状態を設定傾斜状態に追従させる自動傾き制御とを行うように構成された姿勢制御装置であって、
前記車輌本体の車速が所定の閾値車速より高速の場合には、前記自動傾き制御を停止するように構成したことを特徴とする姿勢制御装置。
Automatic height control that allows the vertical position of the tiller connected to the vehicle body to be movable up and down and tiltable right and left to follow the set height position set for the tiller, and detection of the tiller An attitude control device configured to perform automatic tilling control for causing the tilling position to follow the set tilling position, and automatic inclination control for causing the detected inclination state of the tiller to follow the set inclination state. There,
An attitude control device configured to stop the automatic tilt control when a vehicle speed of the vehicle body is higher than a predetermined threshold vehicle speed.
前設定高さ位置が前記耕耘機の接地位置より高い場合には、該設定高さ位置が高くなるに従って前記閾値車速を低速とするように構成したことを特徴とする請求項4に記載の姿勢制御装置。   5. The posture according to claim 4, wherein when the pre-set height position is higher than the ground contact position of the tiller, the threshold vehicle speed is made lower as the set height position becomes higher. Control device. 車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の検出上下位置を該耕耘機に対して設定された設定高さ位置に追従させる自動高さ制御と、前記耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御と、前記耕耘機の前記車輌本体に対する検出傾斜状態を設定傾斜状態に追従させる自動傾き制御とを行うように構成された姿勢制御装置であって、
前記自動高さ制御の際には、前記自動傾き制御の制御精度を緩和させるように構成したことを特徴とする姿勢制御装置。
Automatic height control that allows the vertical position of the tiller connected to the vehicle body to be movable up and down and tiltable right and left to follow the set height position set for the tiller, and detection of the tiller An attitude control device configured to perform automatic tilling control for causing the tilling position to follow the set tilling position, and automatic inclination control for causing the detected inclination state of the tiller to follow the set inclination state. There,
At the time of the automatic height control, the posture control device is configured to relax the control accuracy of the automatic tilt control.
前記自動傾き制御を、フィルタを介して入力された、前記車輌本体に対する前記耕耘機の相対的な傾斜角度に基づいて実行し、
前記自動傾き制御の実行時、前記自動傾き制御の制御ゲインの低減化、前記自動傾き制御の不感帯幅の拡大又は前記フィルタのフィルタリング条件の変更の少なくとも何れか一の手段によって、前記自動傾き制御の制御精度を緩和させるように構成されていることを特徴とする請求項に記載の姿勢制御装置。
The automatic tilt control is executed based on a relative tilt angle of the cultivator with respect to the vehicle body, which is input through a filter,
When executing the automatic tilt control, the automatic tilt control is performed by at least one of the following means: reduction of the control gain of the automatic tilt control, expansion of the dead zone width of the automatic tilt control, or change of the filtering condition of the filter. The attitude control apparatus according to claim 6 , wherein the attitude control apparatus is configured to relax control accuracy.
前記自動傾き制御の制御精度の緩和の程度が、前記設定高さ位置に応じて変更されるように構成されていることを特徴とする請求項6又は7に記載の姿勢制御装置。   The attitude control device according to claim 6 or 7, wherein a degree of relaxation of the control accuracy of the automatic tilt control is configured to be changed according to the set height position. 車輌本体に対して昇降可能且つ左右に傾動可能に連結された耕耘機の検出上下位置を該耕耘機に対して設定された設定高さ位置に追従させる自動高さ制御と、前記耕耘機の検出耕深位置を設定耕深位置に追従させる自動耕深制御と、前記耕耘機の前記車輌本体に対する検出傾斜状態を設定傾斜状態に追従させる自動傾き制御とを行うように構成された姿勢制御装置であって、
前記自動高さ制御の際には、前記自動傾き制御を停止するように構成したことを特徴とする姿勢制御装置。
Automatic height control that allows the vertical position of the tiller connected to the vehicle body to be movable up and down and tiltable right and left to follow the set height position set for the tiller, and detection of the tiller An attitude control device configured to perform automatic tilling control for causing the tilling position to follow the set tilling position, and automatic inclination control for causing the detected inclination state of the tiller to follow the set inclination state. There,
An attitude control device configured to stop the automatic tilt control during the automatic height control.
JP2005317882A 2005-11-01 2005-11-01 Attitude control device Expired - Fee Related JP4895260B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005317882A JP4895260B2 (en) 2005-11-01 2005-11-01 Attitude control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005317882A JP4895260B2 (en) 2005-11-01 2005-11-01 Attitude control device

Publications (2)

Publication Number Publication Date
JP2007124905A JP2007124905A (en) 2007-05-24
JP4895260B2 true JP4895260B2 (en) 2012-03-14

Family

ID=38148111

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005317882A Expired - Fee Related JP4895260B2 (en) 2005-11-01 2005-11-01 Attitude control device

Country Status (1)

Country Link
JP (1) JP4895260B2 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6794115B2 (en) * 2016-02-03 2020-12-02 小橋工業株式会社 Work machine and work system
JP2018166485A (en) * 2017-03-30 2018-11-01 ヤンマー株式会社 Paddy field working vehicle
CN109699219A (en) * 2019-02-27 2019-05-03 北京农业智能装备技术研究中心 Pendent eT and its leveling system and control method after tractor
JP7268899B2 (en) * 2020-11-11 2023-05-08 小橋工業株式会社 Work machine and work system

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3583010B2 (en) * 1999-03-17 2004-10-27 株式会社クボタ Agricultural tractor
JP3690187B2 (en) * 1999-05-27 2005-08-31 井関農機株式会社 Horizontal control device

Also Published As

Publication number Publication date
JP2007124905A (en) 2007-05-24

Similar Documents

Publication Publication Date Title
WO2015019942A1 (en) Work-apparatus orientation control device
JP4895260B2 (en) Attitude control device
JP2007129918A (en) Plowing depth-regulating device
JP4863347B2 (en) Attitude control device
JP4587392B2 (en) Tillage control device
JP5943852B2 (en) Work vehicle
JP4863349B2 (en) Lift control device
JP4863348B2 (en) Plowing depth control device
JP4605652B2 (en) Farming machine tillage control device
JP4107592B2 (en) Rolling control device for work equipment
JP2017175970A (en) Transplanter
JP4107589B2 (en) Rolling control device for work equipment
JP4416437B2 (en) Plowing control device for rotary tiller mounted on tractor
JP4733422B2 (en) Attitude control device for work equipment
JP4589175B2 (en) Rotary tillage device
JP2009165408A (en) Agricultural implement
JP3659034B2 (en) Seedling transplanter
JP2007135531A (en) Compaction mechanism
JP5524753B2 (en) Work vehicle
JP6325210B2 (en) Attitude control device for work equipment
JP4693521B2 (en) Agricultural machinery
JP3838111B2 (en) Paddy field machine
JP4107590B2 (en) Rolling control device for work equipment
JP2006340621A (en) Tilling control system for farming implement
JP2006314209A (en) Apparatus for attitude control of implement

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080724

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100802

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110617

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20110801

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20111104

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20111128

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: 20111216

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: 20111216

R150 Certificate of patent or registration of utility model

Ref document number: 4895260

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: 20150106

Year of fee payment: 3

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

LAPS Cancellation because of no payment of annual fees