JP3310552B2 - Attitude control device - Google Patents
Attitude control deviceInfo
- Publication number
- JP3310552B2 JP3310552B2 JP23493596A JP23493596A JP3310552B2 JP 3310552 B2 JP3310552 B2 JP 3310552B2 JP 23493596 A JP23493596 A JP 23493596A JP 23493596 A JP23493596 A JP 23493596A JP 3310552 B2 JP3310552 B2 JP 3310552B2
- Authority
- JP
- Japan
- Prior art keywords
- attitude
- inclination angle
- detected
- posture
- change
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Landscapes
- Harvester Elements (AREA)
Description
【0001】[0001]
【発明の属する技術分野】本発明は、被検出体の姿勢傾
斜角を検出する傾斜角検出手段と、この傾斜角検出手段
の検出情報に基づいて、被検出体を設定姿勢に制御する
姿勢制御手段とが備えられている姿勢制御装置に関す
る。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an inclination angle detecting means for detecting an inclination angle of an object to be detected, and an attitude control for controlling the object to a set attitude based on information detected by the inclination angle detecting means. And a posture control device provided with the means.
【0002】[0002]
【従来の技術】上記姿勢制御装置において、従来では、
例えば被検出体としての農作業車の左右傾斜角や前後傾
斜角等を傾斜角検出手段にて検出して、車体の姿勢を、
例えば水平姿勢(設定姿勢の一例)に維持させるように
姿勢制御を行うよう構成され、前記傾斜角検出手段とし
ては、例えば図2に示すように構成されたものがあっ
た。つまり、本体としての容器31の内部に、基準体と
してのシリコンオイル等の所定粘度の液体32を入れる
と共に、傾斜していない状態の容器に対して内部の液体
が重力により初期状態即ち液面水平状態に復帰している
ときに、同一形状の平行金属板を同一間隔で立設した検
出電極33が、各平行金属板について同一漬浸状態にな
るように傾斜角検出方向(図面左右方向)に沿って設定
間隔をあけて一対配置され、夫々の検出電極33の静電
容量を計測して、これらの計測値の差を傾斜角情報に変
換する変換回路部34が備えられて構成されていた。2. Description of the Related Art In the above attitude control device, conventionally,
For example, the inclination angle detecting means detects the left-right inclination angle and the front-rear inclination angle of the agricultural work vehicle as the detected object, and the posture of the vehicle body,
For example, it is configured to perform a posture control so as to maintain a horizontal posture (an example of a set posture), and as the inclination angle detecting means, there has been one configured as shown in FIG. 2, for example. In other words, a liquid 32 having a predetermined viscosity such as silicon oil as a reference body is put into a container 31 as a main body, and the liquid in the initial state, that is, the liquid level is horizontal due to gravity in a container not inclined. When returning to the state, the detection electrodes 33 in which parallel metal plates of the same shape are erected at the same intervals are set in the tilt angle detection direction (left and right directions in the drawing) so that the parallel metal plates are in the same immersion state. And a conversion circuit unit 34 configured to measure the capacitance of each detection electrode 33 and convert the difference between these measured values to tilt angle information. .
【0003】又、このような傾斜角検出手段の検出情報
に基づいて、被検出体を設定姿勢に制御する姿勢制御手
段の一例として、例えば、特願平5‐141745号に
示されるように、被検出体としての機体に対して左右の
走行装置(クローラ走行装置)を独立して昇降駆動させ
る一対の駆動手段(油圧シリンダ)を備え、傾斜角検出
手段の検出情報に基づいて、機体を設定姿勢に維持する
ように各駆動手段を作動させるようにしたものがあっ
た。Further, as an example of an attitude control means for controlling an object to be set to a set attitude based on the detection information of such an inclination angle detecting means, for example, as shown in Japanese Patent Application No. 5-141745, A pair of drive units (hydraulic cylinders) are provided to drive the right and left traveling units (crawler traveling units) up and down independently of the body as the object to be detected. In some cases, each driving means is operated so as to maintain the posture.
【0004】[0004]
【発明が解決しようとする課題】上記構成の傾斜角検出
手段においては、検出特性の応答性を向上させる為には
前記液体の粘度を低くして、被検出体の姿勢変化に対し
て応答遅れの少ない状態で敏感に応答するように構成す
ることが好ましいが、そのようにすると、例えば、外乱
に起因した被検出体の振動や、あるいは、急激な姿勢変
化等によって液面が揺れ動いて、誤った傾斜角を検出し
てしまうおそれがあり、その結果、検出角が実際の傾斜
角より大きくなって、姿勢制御手段による姿勢制御操作
が過剰に行われて適正な制御が行えないものになってし
まうおそれがあった。In the tilt angle detecting means having the above structure, the viscosity of the liquid is reduced to improve the response of the detection characteristic, and the response delay with respect to the change in the posture of the object to be detected is delayed. It is preferable to configure the sensor so that it responds sensitively in a state with a small amount of water.However, in such a case, for example, the liquid surface shakes due to vibration of the detection object due to a disturbance or a sudden change in posture, and an erroneous response occurs. The inclination angle may be detected, and as a result, the detected angle becomes larger than the actual inclination angle, so that the posture control operation by the posture control means is excessively performed and proper control cannot be performed. There was a risk.
【0005】そこで、このような不利を回避する為に
は、液体の粘度を高くして、上述したような急激な姿勢
変化に対して敏感に応答しないように構成することが考
えられるが、このようにすると、液面が重力により初期
状態即ち液面水平状態に復帰するまでに時間が掛かり、
被検出体の姿勢変化に対する検出応答性が低下し、その
結果、検出角が実際の傾斜角より小さくなって、姿勢制
御手段による姿勢制御操作が不足して適正な制御が行え
ないものになってしまうおそれがあった。In order to avoid such disadvantages, it is conceivable to increase the viscosity of the liquid so that the liquid does not respond sensitively to the above-mentioned sudden change in posture. Then, it takes time for the liquid surface to return to the initial state, that is, the liquid surface horizontal state due to gravity,
As a result, the detection responsiveness to the change in the posture of the detected object decreases, and as a result, the detection angle becomes smaller than the actual inclination angle, and the posture control operation by the posture control means is insufficient, so that appropriate control cannot be performed. There was a risk.
【0006】又、傾斜角検出手段にて傾斜状態が検出さ
れた後、被検出体の姿勢を設定姿勢に制御するには、例
えば演算の為の処理時間や実際に姿勢を制御するための
物理的な処理時間が必要であり、姿勢制御手段には所定
の応答遅れが生じるのが一般的である。In order to control the posture of the detected object to the set posture after the inclination angle is detected by the inclination angle detecting means, for example, a processing time for calculation or a physical control for actually controlling the posture. In general, the attitude control means requires a predetermined response delay.
【0007】本発明はかかる点に着目してなされたもの
であり、その目的は、被検出体の姿勢変化の検出応答性
を向上させることができるものでありながら、適正な姿
勢制御を行うことが可能となる姿勢制御装置を提供する
点にある。The present invention has been made in view of such a point, and an object of the present invention is to perform appropriate attitude control while improving the response to detection of a change in the attitude of an object to be detected. The object is to provide a posture control device capable of performing the following.
【0008】[0008]
【課題を解決するための手段】請求項1に記載の特徴構
成によれば、前記傾斜角検出手段における検出可能な姿
勢傾斜角の変化速度が、前記姿勢制御手段が被検出体の
姿勢を制御する際における姿勢傾斜角の変化速度の上限
値よりも高くなるように設定されているので、被検出体
の姿勢変化に対する傾斜角検出手段の検出応答性が高い
ものになる。According to the characteristic configuration of the present invention, the rate of change of the attitude inclination angle which can be detected by the inclination angle detecting means, and the attitude control means controls the attitude of the object to be detected. Is set so as to be higher than the upper limit value of the change rate of the posture inclination angle at the time of performing, the detection responsiveness of the inclination angle detecting means to the posture change of the detected object becomes high.
【0009】そして、前記傾斜角検出手段の検出情報
が、検出情報修正手段によって、姿勢制御手段による姿
勢制御動作の応答が可能な情報となるように修正される
のである。つまり、被検出体の姿勢変化に対しては応答
性を向上させるものでありながら、傾斜角検出手段の検
出情報自体を、姿勢制御手段による姿勢制御動作の応答
が可能な情報、即ち、姿勢制御手段によって対応できな
いような急激な変化の情報が極力除去された情報とし
て、姿勢制御手段による被検出体の姿勢制御が実行され
ることになる。Then, the detection information of the inclination angle detecting means is corrected by the detection information correcting means so as to be information which can respond to the attitude control operation by the attitude control means. That is, while improving responsiveness to a change in the posture of the detected object, the detection information itself of the inclination angle detecting means is used as information capable of responding to the posture control operation by the posture control means, that is, the posture control. The attitude control of the object to be detected by the attitude control means is executed as information from which the information of the rapid change which cannot be handled by the means is removed as much as possible.
【0010】その結果、被検出体の姿勢変化に対して
は、検出応答性を高めて極力検出精度を向上させるよう
にしながら、例えば、姿勢制御手段が応答出来ないよう
な被検出体の急激な姿勢変化等に起因して発生した傾斜
角検出手段の検出角と被検出体の実際の傾斜角との誤差
による姿勢制御操作の過不足を、極力少ないものにし
て、被検出体の適正な姿勢制御を行うことが可能となる
姿勢制御装置を提供できるに至った。As a result, with respect to a change in the posture of the object to be detected, the detection response is enhanced to improve the detection accuracy as much as possible. To minimize the excess and deficiency of the attitude control operation due to the error between the detected angle of the tilt angle detecting means and the actual tilt angle of the detected object caused by the change in the posture, etc. An attitude control device capable of performing control can be provided.
【0011】そして、前記検出情報修正手段が、傾斜角
検出手段の検出情報において、前記姿勢制御手段が被検
出体の姿勢を制御する際における姿勢傾斜角の変化速度
の上限値に対応する周波数と同じか又はほぼ同じ値に設
定されている設定周波数を越える周波数成分を除去する
フィルター手段で構成され、傾斜角検出手段の検出情報
をこのフィルター手段を通過させた後に、姿勢制御手段
に与えるように構成されている。[0011] Then, before Symbol detection information correcting means, the detection information of the tilt angle detecting means, said attitude control means test
Rate of change of the posture inclination angle when controlling the posture of the body
Filter means for removing a frequency component exceeding a set frequency which is set to the same or almost the same value as the frequency corresponding to the upper limit value , and after passing the detection information of the inclination angle detecting means through this filter means. , To the attitude control means.
【0012】つまり、傾斜角検出手段の検出情報が前記
フィルター手段を通過することにより、前記設定周波数
を越える周波数成分、即ち、姿勢制御手段にて応答出来
ないような高い周波数が除去された状態で姿勢制御手段
に与えられることになるので、上述したような検出角の
誤差による姿勢制御操作の過不足を、極力少ないものに
して、被検出体の適正な姿勢制御を行うことが可能とな
る。That is, when the detection information of the inclination angle detecting means passes through the filter means, a frequency component exceeding the set frequency, that is, a high frequency which cannot be responded by the attitude control means is removed. Since it is provided to the attitude control means, it is possible to minimize the excess or deficiency of the attitude control operation due to the error in the detection angle as described above and to perform appropriate attitude control of the object to be detected.
【0013】しかも、検出情報がフィルター手段を通過
する構成であるから、例えば、検出情報を修正する為に
特別な演算処理を実行するような構成に較べて、余計な
処理時間が不要で姿勢制御手段の応答特性を低下させる
おそれが少ない。In addition, since the detection information is passed through the filter means, no extra processing time is required and the posture control is performed as compared with a configuration in which a special arithmetic processing is executed to correct the detection information. There is little risk of degrading the response characteristics of the means.
【0014】請求項2に記載の特徴構成によれば、前記
傾斜角検出手段における検出可能な姿勢傾斜角の変化速
度が、前記姿勢制御手段が被検出体の姿勢を制御する際
における姿勢傾斜角の変化速度の上限値よりも高くなる
ように設定されているので、被検出体の姿勢変化に対す
る傾斜角検出手段の検出応答性が高いものになる。そし
て、前記傾斜角検出手段の検出情報が、検出情報修正手
段によって、姿勢制御手段による姿勢制御動作の応答が
可能な情報となるように修正されるのである。 つまり、
被検出体の姿勢変化に対しては応答性を向上させるもの
でありながら、傾斜角検出手段の検出情報自体を、姿勢
制御手段による姿勢制御動作の応答が可能な情報、即
ち、姿勢制御手段によって対応できないような急激な変
化の情報が極力除去された情報として、姿勢制御手段に
よる被検出体の姿勢制御が実行されることになる。 その
結果、被検出体の姿勢変化に対しては、検出応答性を高
めて極力検出精度を向上させるようにしながら、例え
ば、姿勢制御手段が応答出来ないような被検出体の急激
な姿勢変化等に起因して発生した傾斜角検出手段の検出
角と被検出体の実際の傾斜角との誤差による姿勢制御操
作の過不足を、極力少ないものにして、被検出体の適正
な姿勢制御を行うことが可能となる姿勢制御装置を提供
できるに至った。 そして、前記検出情報修正手段は、傾
斜角検出手段の検出情報における姿勢傾斜角の単位時間
当たりの変化量が、前記姿勢制御手段によって被検出体
の姿勢を修正する際における単位時間当たりの姿勢傾斜
角の変化量よりも大きい場合には、傾斜角検出手段の検
出情報における姿勢傾斜角の変化量を、前記姿勢制御手
段によって被検出体の姿勢を修正する際における単位時
間当たりの姿勢傾斜角の変化量に変更させるように構成
されている。According to the feature configuration described in claim 2, wherein
Change rate of attitude tilt angle detectable by tilt angle detecting means
When the attitude control means controls the attitude of the detected object.
Is higher than the upper limit of the rate of change of the attitude inclination angle
Is set so that changes in the posture of the
The detection response of the inclination angle detecting means is high. Soshi
The detection information of the inclination angle detecting means is used as a detection information correction means.
The response of the attitude control operation by the attitude control means depends on the step.
It is modified to provide the information possible. That is,
Improves responsiveness to changes in the posture of the detected object
However, the detection information itself of the inclination angle detecting means is
Information that can respond to the attitude control operation by the control means,
That is, sudden changes that cannot be handled by the attitude control
Information is removed to the attitude control means as much as possible.
Thus, the posture control of the detected object is performed. That
As a result, the detection responsiveness to
While improving the detection accuracy as much as possible,
If the posture control means cannot respond,
Of tilt angle detection means generated due to various posture changes
Posture control operation based on the error between the angle and the actual tilt angle of the detected object
Minimize crop overage and shortage to minimize the
Provides a posture control device that enables precise posture control
I can do it. The detection information correcting means may be configured such that the amount of change per unit time of the posture inclination angle in the detection information of the inclination angle detection means is the posture inclination per unit time when the posture control means corrects the posture of the detection target. If the change amount of the angle is larger than the change amount of the angle, the change amount of the posture inclination angle in the detection information of the inclination angle detection means, the posture inclination angle per unit time when correcting the posture of the detected object by the posture control means It is configured to change the amount of change.
【0015】つまり、傾斜角検出手段における前記変化
量が、前記姿勢制御手段における前記変化量よりも大き
い場合、即ち、被検出体の姿勢変化が姿勢制御手段によ
り応答できないような速い姿勢変化であるときは、傾斜
角検出手段の検出情報における姿勢傾斜角の単位時間当
たりの変化量を、姿勢制御手段により応答が可能な変化
量に変更させることで、傾斜角検出手段の検出角と、実
際の被検出体の傾斜角との誤差を極力少なくさせて、上
述したような検出角の誤差による姿勢制御操作の過不足
を、極力少ないものにして、被検出体の適正な姿勢制御
を行うことが可能となる。That is, when the amount of change in the inclination angle detecting means is larger than the amount of change in the attitude control means, that is, the attitude change of the detected object is a fast attitude change such that the attitude control means cannot respond. At this time, the change amount per unit time of the posture inclination angle in the detection information of the inclination angle detection unit is changed to a change amount capable of responding by the posture control unit, so that the detection angle of the inclination angle detection unit and the actual angle are changed. It is possible to minimize the error with the tilt angle of the object to be detected as much as possible and minimize the excess or deficiency of the attitude control operation due to the error of the detection angle as described above, and perform appropriate attitude control of the object to be detected. It becomes possible.
【0016】請求項3に記載の特徴構成によれば、前記
傾斜角検出手段は、本体に対して重力により初期状態に
復帰付勢された基準体の、前記本体に対する角度を検出
するように構成されている。According to a third aspect of the present invention, the inclination angle detecting means is configured to detect an angle of the reference body urged to return to the initial state by gravity with respect to the main body with respect to the main body. Have been.
【0017】本体が被検出体の姿勢変化に伴って傾斜し
ても、基準体は重力により初期状態に復帰付勢されてい
るので、この基準体の本体に対する角度によって、本
体、即ち、被検出体の傾斜角を検出することができる。
従って、重力を利用して極力簡素な構成で被検出体の傾
斜角を検出することができるのである。Even if the main body is tilted in accordance with the change in the posture of the detected body, the reference body is urged to return to the initial state by gravity. The inclination angle of the body can be detected.
Therefore, the inclination angle of the object to be detected can be detected with a simple configuration using gravity.
【0018】請求項4に記載の特徴構成によれば、前記
被検出体が農作業車の機体で構成され、姿勢制御手段
は、前記機体と、その機体に対して各別に相対昇降可能
に設けられた左右の走行装置各々との相対昇降位置を変
更操作自在な左右一対のアクチュエータと、傾斜角検出
手段の検出情報に基づいて前記各アクチュエータの動作
状態を制御する制御部とを備えて構成されている。According to a fourth aspect of the present invention, the object to be detected is constituted by a body of an agricultural work vehicle, and the attitude control means is provided so as to be able to move up and down relative to the machine and the body separately. A pair of left and right actuators that can be operated to change the relative ascending / descending position with respect to each of the left and right traveling devices, and a control unit that controls the operation state of each of the actuators based on the detection information of the inclination angle detecting means. I have.
【0019】被検出体としての農作業車が、例えば接地
面の凹凸に起因して左右に傾斜したような場合に、傾斜
角検出手段の検出情報に基づいて、例えば、低位置にあ
る走行装置を機体に対して相対的に下降するように、言
い換えると機体を上昇させるようにアクチュエータを操
作するように制御して、機体を例えば水平姿勢等の設定
姿勢に変更させることができる。When the agricultural work vehicle as the object to be detected is tilted left and right due to, for example, unevenness of the ground contact surface, for example, a traveling device located at a low position is determined based on the detection information of the tilt angle detecting means. By controlling the actuator to operate so as to lower relative to the body, in other words, to raise the body, the body can be changed to a set posture such as a horizontal posture.
【0020】このような農作業車等においては、機体の
振動等に起因して、傾斜角検出手段に上述したような検
出誤差が生じやすく、しかも、農作業車の機体等大型の
被検出体の姿勢制御を行う場合には姿勢修正操作が比較
的低速で行われることから、上記検出誤差に起因する姿
勢制御手段による姿勢制御操作の過不足量が大きくなる
おそれが大となるが、このような構成においても、適正
な姿勢制御を行うことが可能となる。In such an agricultural work vehicle or the like, the above-described detection error easily occurs in the tilt angle detecting means due to vibration of the body or the like. When the control is performed, since the attitude correction operation is performed at a relatively low speed, there is a large possibility that the amount of excess or deficiency in the attitude control operation by the attitude control means due to the detection error increases. Also, it is possible to perform appropriate posture control.
【0021】[0021]
【発明の実施の形態】以下、本発明に係る姿勢制御装置
について、農作業車としてのコンバインの姿勢制御を行
う場合を例にとって図面に基づいて説明する。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An attitude control device according to the present invention will be described below with reference to the drawings, taking as an example the case where the attitude of a combine as a farm work vehicle is controlled.
【0022】図4に、圃場等に植付けられた穀稈を刈り
取り、刈り取った穀稈の脱穀処理を行うコンバインが示
されている。このコンバインは、左右一対のクローラ走
行装置1を備えた機体Vに脱穀装置3、及び、脱穀され
た穀粒を貯溜するグレンタンク4が搭載されると共に、
機体の前部には、昇降用油圧シリンダ5の作動によって
横軸芯X周りで昇降揺動自在に刈取前処理部6が設けら
れ、この刈取前処理部6の横一側に搭乗運転部7が設け
られている。前記刈取前処理部6は、倒伏している植立
穀稈を立姿勢に引き起こす引起し装置8、引き起こされ
た穀稈の株元を切断する刈取装置9、刈り取った立姿勢
の穀稈を徐々に横倒れ姿勢になるように姿勢変更しなが
ら後方の脱穀装置3に向けて搬送する搬送装置10等を
備えて構成されている。尚、脱穀装置3の機体後方側に
は、脱穀された後の排ワラを細断して圃場に排出する排
ワラカッター11が設けられている。FIG. 4 shows a combine which cuts a grain stalk planted in a field or the like and performs threshing processing of the cut stalk. In this combine, a threshing device 3 and a Glen tank 4 for storing threshed grains are mounted on an airframe V including a pair of left and right crawler traveling devices 1,
A cutting pre-processing unit 6 is provided at the front of the body so as to be able to move up and down and swing around the horizontal axis X by the operation of the lifting hydraulic cylinder 5, and a boarding operation unit 7 is provided on one side of the cutting pre-processing unit 6. Is provided. The cutting pre-processing unit 6 includes a raising device 8 for raising the standing plant culm in a standing position, a cutting device 9 for cutting off the root of the raised cereal stem, and gradually cutting the culm in the cut and standing position. The transport device 10 is configured to be transported toward the rear threshing device 3 while changing the posture so as to be in the side-down posture. In addition, on the rear side of the machine body of the threshing device 3, a waste straw cutter 11 that shreds the waste straw after threshing and discharges it to the field is provided.
【0023】そして、このコンバインには、例えば、左
右いずれかのクローラ走行装置1,1が走行路面の凹部
等に入り込み車体が左右に傾斜したような場合等におい
て、機体が刈取り用の設定姿勢に維持されるように被検
出体としての機体Vの傾斜姿勢を修正する姿勢制御手段
Hが備えられている。つまり、左右のクローラ走行装置
1,1が各別に機体Vに対して相対昇降自在に設けら
れ、上述したように機体Vが左右傾斜した場合には、い
ずれかのクローラ走行装置1を相対的に昇降させること
で、機体を設定姿勢に修正するように構成されている。In this combine, for example, when the left or right crawler traveling device 1 or 1 enters a recess or the like on a traveling road surface and the vehicle body leans left or right, the body is set to a setting posture for mowing. Attitude control means H for correcting the inclination attitude of the body V as a detection target so as to be maintained is provided. That is, the left and right crawler traveling devices 1 and 1 are separately provided so as to be able to move up and down relative to the machine body V, and when the machine body V is inclined left and right as described above, one of the crawler traveling devices 1 is relatively moved. It is configured so that the aircraft is corrected to the set posture by moving up and down.
【0024】クローラ走行装置1が機体Vに対して相対
昇降するための構成について説明する。尚、左右のクロ
ーラ走行装置1,1は夫々同一構成であるから片側につ
いてのみ説明する。クローラ走行装置1は、図5に示す
ように、機体前部の駆動輪12、後部の緊張輪13、並
びに、それらの中間に位置する複数の接地転輪14の夫
々にわたって無端状のクローラベルト15が巻回される
と共に、エンジンからの駆動力がミッションケース16
を介して駆動輪12に伝えられ、駆動輪12によりクロ
ーラベルト15を回動駆動させて車体を走行させるよう
に構成されている。図5、図6に示すように、機体Vを
構成する機体フレーム17に連結固定されると共に、ク
ローラ走行装置1の機体内方側に位置し、且つ、機体前
後方向に延びる状態で固定側支持フレーム18が設けら
れ、この固定側支持フレーム18の前端側には前記駆動
輪12が回転自在に支持されている。そして、前記各接
地転輪14及び緊張輪13を回転自在に支持する可動側
支持フレーム19が、前記固定側支持フレーム18に対
して平行四連リンク機構によってほぼ平行状態を維持し
ながら相対上下動可能に支持されている。つまり、固定
側支持フレーム18に前後方向に所定間隔をあけて固定
された前後一対の軸受け部20,20に支持される各回
動軸21,21の一端側(車体横幅方向外方側)に一体
回動自在に揺動アーム22が設けられ、前後の各揺動ア
ーム22の他端側が可動側支持フレーム19に枢支連結
されて、平行四連リンク機構が構成され、しかも、前記
各回動軸21,21の他端側(車体横幅方向内方側)に
一体回動自在に設けられた前後の各操作アーム23,2
3同士が連結ロッド24にて連動連結されている。そし
て、後方側の操作アーム23に、基端側が機体フレーム
17に支持された姿勢制御用油圧シリンダCY(アクチ
ュエータの一例)のシリンダロッド25が枢支連結され
ている。A configuration for moving the crawler traveling device 1 up and down relative to the machine body V will be described. Since the left and right crawler traveling devices 1 and 1 have the same configuration, only one side will be described. As shown in FIG. 5, the crawler traveling device 1 includes an endless crawler belt 15 extending over each of a front driving wheel 12, a rear tensioning wheel 13, and a plurality of grounding rollers 14 located therebetween. Is wound, and the driving force from the engine is transmitted to the transmission case 16.
The driving wheel 12 is driven to rotate the crawler belt 15 to drive the vehicle body. As shown in FIGS. 5 and 6, fixedly supported in a state where it is connected to and fixed to the body frame 17 constituting the body V, is located inward of the crawler traveling device 1 in the body, and extends in the longitudinal direction of the body. A frame 18 is provided, and the drive wheel 12 is rotatably supported on the front end side of the fixed-side support frame 18. The movable support frame 19 that rotatably supports the ground rolling wheels 14 and the tension wheels 13 is moved up and down relative to the fixed support frame 18 while maintaining a substantially parallel state with a parallel quadruple link mechanism. Supported as possible. In other words, it is integrated with one end side (outward side in the lateral direction of the vehicle body) of each of the rotating shafts 21 and 21 supported by the pair of front and rear bearing portions 20 and 20 fixed to the fixed side support frame 18 at predetermined intervals in the front and rear direction. A swing arm 22 is provided rotatably, and the other end of each of the front and rear swing arms 22 is pivotally connected to the movable support frame 19 to form a parallel quadruple link mechanism. The front and rear operation arms 23, 2 which are provided at the other end sides (inward in the vehicle width direction) of the front and rear sides 21 and 21 so as to be integrally rotatable.
3 are interlocked and connected by a connecting rod 24. A cylinder rod 25 of a posture control hydraulic cylinder CY (an example of an actuator) whose base end is supported by the body frame 17 is pivotally connected to the rear operation arm 23.
【0025】従って、前記姿勢制御用油圧シリンダCY
を伸縮操作させることで、前後の揺動アーム22,22
が各回動軸21,21の軸芯周りで揺動操作され、可動
側支持フレーム19がほぼ平行状態を維持しながら固体
側支持フレーム18、即ち、機体フレーム17に対して
相対的に昇降操作されるように構成されている。Therefore, the attitude control hydraulic cylinder CY
The front and rear swing arms 22, 22 are extended and retracted.
Is pivoted around the axis of each of the rotating shafts 21 and 21, and the movable support frame 19 is moved up and down relative to the solid support frame 18, that is, the body frame 17 while maintaining a substantially parallel state. It is configured to:
【0026】尚、機体後方側の操作アーム23の近傍に
は、可動側支持フレーム19が上限操作位置及び下限操
作位置にあることを検出する為の上限検出用リミットス
イッチ26、下限検出用リミットスイッチ27が設けら
れている。In the vicinity of the operation arm 23 on the rear side of the fuselage, an upper limit detection limit switch 26 and a lower limit detection limit switch 26 for detecting that the movable support frame 19 is at the upper limit operation position and the lower limit operation position. 27 are provided.
【0027】図1に姿勢制御用の制御ブロック図が示さ
れている。機体の絶対水平姿勢(所定姿勢)に対する左
右傾斜角を検出する重錘式の傾斜角センサS(傾斜角検
出手段の一例)が設けられ、機体Vの実際の傾斜状態を
検出するように構成され、又、機体Vの目標傾斜姿勢
(設定姿勢)を設定するための姿勢設定ボリューム28
が設けられている。そして、これらの検出情報に基づい
て、機体Vの傾斜姿勢が目標傾斜姿勢になるように、前
記各姿勢制御用の油圧シリンダCYに対する電磁操作式
の油圧制御弁29を切り換えて、油圧シリンダCYに対
する作動油の給排状態を制御する制御部としてのマイク
ロコンピュータ利用の制御装置30が設けられている。
従って、制御装置31、各油圧シリンダCY、及び油圧
制御弁29等により姿勢制御手段Hが構成されることに
なる。尚、機体が目標傾斜姿勢にあるときの、左右クロ
ーラ走行装置1,1の相対基準位置としては、左右の上
限検出用リミットスイッチ26,26が共にON状態を
検出する上限位置と、左右の下限検出用リミットスイッ
チ27,27が共にON状態を検出する下限位置のいず
れかに設定することができるが、いずれを基準位置とす
るかは、作業状況に応じて予め設定されるようになって
いる。例えば湿田であってクローラ走行装置1が泥面に
深く沈み込むような場合には、下限位置、即ち、機体V
に対してクローラ走行装置1が相対的に下方側に離間し
ている状態を基準とし、沈み込みが少ない乾田であれ
ば、上限位置、即ち、機体に対してクローラ走行装置1
が相対的に上方側に接近している状態を基準とする等の
使い分けができるようになっている。FIG. 1 shows a control block diagram for attitude control. A weight-type tilt angle sensor S (an example of tilt angle detecting means) for detecting a horizontal tilt angle with respect to the absolute horizontal attitude (predetermined attitude) of the body is provided, and is configured to detect an actual tilt state of the body V. A posture setting volume 28 for setting a target inclination posture (set posture) of the body V
Is provided. Then, based on the detection information, the electromagnetically operated hydraulic control valve 29 for each of the attitude control hydraulic cylinders CY is switched so that the inclination attitude of the machine body V becomes the target inclination attitude, and the hydraulic cylinder CY is controlled. A control device 30 using a microcomputer is provided as a control unit for controlling the supply / discharge state of the hydraulic oil.
Therefore, the attitude control means H is constituted by the control device 31, each hydraulic cylinder CY, the hydraulic control valve 29, and the like. The relative reference positions of the left and right crawler traveling devices 1 and 1 when the aircraft is in the target inclination posture include an upper limit position where both the left and right upper limit detection limit switches 26 and 26 detect an ON state, and a left and right lower limit. Both of the detection limit switches 27, 27 can be set to any of the lower limit positions for detecting the ON state, and which of the lower limit positions is set in advance according to the work situation. . For example, in a wetland where the crawler traveling device 1 sinks deeply into the mud surface, the lower limit position,
On the basis of the state in which the crawler traveling device 1 is relatively separated downward, if the subsidence is a dry field with little sinking, the crawler traveling device 1 is positioned at the upper limit position, that is, the body.
Can be properly used based on a state in which the object is relatively close to the upper side.
【0028】前記傾斜角センサSは、図2に示すよう
に、被検出体としての機体Vに固定状態で取り付けられ
た角形の容器31(本体の一例)の内部にシリコンオイ
ル等の所定粘度の液体32(基準体の一例)が収容され
ると共に、傾斜していない状態(図2に示す状態)の容
器31に対して内部の液体32が重力により初期状態に
復帰しているとき、即ち、液面が水平状態のときに、同
一形状の平行金属板を同一間隔で立設した検出電極33
を、各平行金属板について同一浸漬状態になる状態で傾
斜角検出方向(図の左右方向)に沿って所定間隔をあけ
て一対配置し、更に、夫々の検出電極33の静電容量を
処理して傾斜角検出情報に変換処理する変換回路部34
を備えて構成されている。尚、傾斜角センサSは、その
傾斜角検出方向が車体横幅方向に一致するように配置さ
れている。As shown in FIG. 2, the tilt angle sensor S is provided inside a rectangular container 31 (an example of a main body) fixedly attached to a body V as an object to be detected. When the liquid 32 (an example of a reference body) is contained and the liquid 32 inside the container 31 in a non-inclined state (the state shown in FIG. 2) is returning to the initial state by gravity, that is, When the liquid surface is in a horizontal state, a detection electrode 33 in which parallel metal plates of the same shape are erected at the same interval.
Are arranged at predetermined intervals along the tilt angle detection direction (left-right direction in the drawing) in a state where each parallel metal plate is in the same immersion state, and further, the capacitance of each detection electrode 33 is processed. Conversion circuit unit 34 for converting the data into inclination angle detection information
It is configured with. Note that the inclination angle sensor S is arranged so that the inclination angle detection direction coincides with the vehicle width direction.
【0029】つまり、車体Vが横幅方向に傾斜していな
い状態では、両検出電極33,33の静電容量は同一で
あるが、車体Vが傾斜すると、図3に示すように、重力
により初期状態(液面水平状態)に復帰している液体3
2の液面は、傾斜の上側になる検出電極33については
下がり、傾斜の下側の検出電極33については上がるこ
とになるので、液面差が生じて両電極間の静電容量は同
一では無くなる。この静電容量の差は、機体の傾斜角に
応じて変化することになるので、変換回路部34が、こ
の静電容量の差の情報を制御装置30に入力する為の傾
斜角情報に変換処理するのである。このようにして、機
体Vの傾斜角が検出できるようになっている。尚、前記
液体32の粘度は比較的低い値に設定されており、機体
Vの姿勢変化に対して検出電極33との間の摩擦による
連れ動きが少なく、検出応答性に優れた状態で精度よく
傾斜角を検出できるように構成されている。That is, when the vehicle body V is not inclined in the lateral width direction, the capacitances of the two detection electrodes 33 are the same, but when the vehicle body V is inclined, as shown in FIG. Liquid 3 returning to the state (liquid level state)
Since the liquid level of No. 2 drops with respect to the detection electrode 33 on the upper side of the slope and rises with respect to the detection electrode 33 on the lower side of the slope, a liquid level difference occurs and the capacitance between the two electrodes is the same. Disappears. Since the difference in capacitance changes in accordance with the inclination angle of the body, the conversion circuit unit 34 converts the information on the difference in capacitance into inclination angle information for input to the control device 30. Process it. Thus, the inclination angle of the body V can be detected. In addition, the viscosity of the liquid 32 is set to a relatively low value, and there is little accompanying movement due to friction with the detection electrode 33 with respect to a change in the attitude of the body V, and the detection response is excellent and the precision is high. It is configured so that the inclination angle can be detected.
【0030】そして、前記傾斜角センサSの傾斜角情報
は、フィルター回路35(フィルター手段の一例)を通
して制御装置30に入力されるように構成されている。
このフィルター回路35は、設定周波数以上の高い周波
数成分を除去する(即ち、通過を阻止する)ローパスフ
ィルターを備えて構成されている。前記設定周波数とし
ては、前記姿勢制御手段Hにおける姿勢を制御する際に
おける姿勢傾斜角の変化速度の上限値に対応する周波数
と同じか又はほぼ同じ値に設定されている。つまり、姿
勢修正の応答可能な速度に対応する周波数であり、具体
的な数値で例示すると、約1秒間当たりに機体が約1°
の角度変化を行えるような速度の周波数に相当し、非常
に低い値になる。The tilt angle information of the tilt angle sensor S is configured to be input to the control device 30 through a filter circuit 35 (an example of a filter means).
The filter circuit 35 includes a low-pass filter that removes high-frequency components equal to or higher than a set frequency (that is, blocks a passage). The set frequency is set to the same or almost the same value as the frequency corresponding to the upper limit value of the change rate of the attitude inclination angle when the attitude is controlled by the attitude control means H. In other words, figure
This is the frequency corresponding to the response speed of the force correction. For example, when the specific numerical value is used, the airframe rotates by about 1 ° per second.
This corresponds to a frequency of a speed at which the angle can be changed, and is a very low value.
【0031】その結果、例えば、圃場等の不整地を走行
することによって車体が頻繁に振動して、その振動に起
因して傾斜角センサSにおける液体が速い周波数で揺れ
動いて誤った傾斜角情報を検出するような場合や、車体
が大きく姿勢変化して検出角が車体の傾斜角以上に短時
間のみオーバーシュートするような場合等において、こ
のような速い周波数成分が除去されることになり、この
ように、機体の実際の傾斜角と検出角との間に検出誤差
が生じるような場合であっても、そのことに起因して、
油圧シリンダCYによる姿勢修正操作量に大きく過不足
が生じる等の不都合を未然に回避させることができるも
のとなる。As a result, for example, the vehicle body vibrates frequently due to running on uneven terrain such as a field, and the liquid in the tilt angle sensor S fluctuates at a high frequency due to the vibration, and erroneous tilt angle information is obtained. In the case of detecting, or in the case where the vehicle body largely changes its attitude and the detection angle overshoots only for a short period of time beyond the inclination angle of the vehicle body, such a fast frequency component is removed. As described above, even when a detection error occurs between the actual inclination angle of the aircraft and the detection angle, due to that,
It is possible to prevent inconveniences such as a large or insufficient amount of posture correction operation by the hydraulic cylinder CY from occurring.
【0032】従って、前記フィルター回路35を利用し
て、傾斜角センサSの検出情報を、姿勢制御手段Hによ
る姿勢制御動作の応答が可能な情報となるように修正す
る検出情報修正手段KSが構成されることになる。Therefore, the detection information correction means KS for correcting the detection information of the inclination angle sensor S so as to be information which can respond to the attitude control operation by the attitude control means H using the filter circuit 35 is constituted. Will be done.
【0033】例えば、前記上限位置が基準位置として走
行しており、且つ、目標傾斜姿勢として水平姿勢が設定
されている場合に、図7に示すように、接地面の凹凸等
に起因して車体が左右に傾斜した場合における姿勢制御
動作について説明すると、傾斜角センサSにより水平姿
勢からの傾斜角が検出されて、その検出情報に基づいて
制御装置が傾斜下方側に位置する(図7では左側)油圧
シリンダCYを伸長操作させることによって、対応する
クローラ走行装置1を相対的に下降させることで、図7
の仮想線にて示すように機体Vが水平姿勢に修正される
ことになる。For example, when the vehicle travels with the upper limit position as the reference position and the horizontal posture is set as the target inclination posture, as shown in FIG. The tilt angle from the horizontal attitude is detected by the tilt angle sensor S, and the control device is positioned on the lower side of the tilt based on the detected information. 7) By extending the hydraulic cylinder CY to lower the corresponding crawler traveling device 1 relatively,
The body V is corrected to the horizontal posture as shown by the virtual line.
【0034】そして、車体の走行に伴って地面の細かな
凹凸やエンジンによる車体の細かな振動等に起因して、
傾斜角センサSの検出値が図8(イ)に示すように速い
周波数で細かく変化するような場合や、外乱等によって
局所的に急激に変化するような場合であっても、その検
出情報がフィルター回路35によって上述したように修
正されることによって、図8(ロ)に示すように姿勢制
御が充分応答可能な滑らかな変化情報に修正され、姿勢
制御が適切な操作量で良好に行われるものとなる。Then, due to fine irregularities on the ground and fine vibrations of the vehicle body caused by the engine as the vehicle body travels,
Even when the detection value of the inclination angle sensor S changes finely at a high frequency as shown in FIG. 8A or when the detection value locally changes suddenly due to disturbance or the like, the detection information is obtained. By performing the correction as described above by the filter circuit 35, the posture control is corrected to smooth change information that can sufficiently respond as shown in FIG. 8B, and the posture control is favorably performed with an appropriate operation amount. It will be.
【0035】〔別実施形態〕 (1)上記実施形態では、検出情報修正手段KSとし
て、傾斜角センサS(傾斜角検出手段)の傾斜角情報
を、設定周波数以上の高い周波数成分を除去するフィル
ター回路(フィルター手段の一例)を通して制御装置3
0に入力されるように構成した場合を例示したが、この
ような構成に代えて、次のように構成してもよい。[Another Embodiment] (1) In the above embodiment, the detection information correcting means KS uses the inclination angle information of the inclination angle sensor S (inclination angle detecting means) as a filter for removing high frequency components higher than a set frequency. Control device 3 through a circuit (an example of a filter means)
Although the case where the input is input to 0 has been described as an example, the following configuration may be used instead of the above configuration.
【0036】傾斜角検出手段(傾斜角センサS)の検出
情報における姿勢傾斜角の単位時間当たりの変化量が、
前記姿勢制御手段Hによって機体(被検出体)の姿勢を
修正する際における単位時間当たりの姿勢傾斜角の変化
量よりも大きい場合には、傾斜角検出手段の検出情報に
おける姿勢傾斜角の変化量を、姿勢制御手段によって機
体の姿勢を修正する際における単位時間当たりの姿勢傾
斜角の変化量に変更させるように構成するものでもよ
い。説明を加えると、この検出情報修正手段KSが、制
御装置30に制御プログラム形式で備えられ、制御装置
30は以下のように制御を実行するように構成されてい
る。The amount of change in the posture inclination angle per unit time in the detection information of the inclination angle detecting means (inclination angle sensor S) is as follows:
If the change amount of the attitude inclination angle per unit time when correcting the attitude of the body (detected body) by the attitude control means H is larger than the change amount of the attitude inclination angle in the detection information of the inclination angle detection means. May be changed to the amount of change in the attitude inclination angle per unit time when the attitude of the body is corrected by the attitude control means. In addition, the detection information correcting means KS is provided in the control device 30 in the form of a control program, and the control device 30 is configured to execute control as described below.
【0037】図9に姿勢制御用の傾斜角の出力制御のフ
ローチャートを示している。尚、この制御は設定単位時
間(5ms)毎に繰り返して実行するようになってい
る。先ず、傾斜角センサSの現在検出値Xn を読み込み
(ステップ1)、前回の検出値Xn-1 との差の絶対値、
即ち、傾斜角センサSの検出情報における単位時間当た
りの変化量が、姿勢制御手段Hによって機体(被検出
体)の姿勢を修正する際における単位時間当たりの姿勢
傾斜角の変化量α(油圧シリンダによる機体の姿勢修正
の変化量)よりも大きい場合には(ステップ2)、変化
の正負を判別して、「正」ならば、つまり、検出値が増
大していれば、前回の制御用指令値Pn- 1 に姿勢制御手
段によって機体の姿勢を修正する際における単位時間当
たりの姿勢傾斜角の変化量αを加えた値を現在の制御用
指令値Pn として設定し(ステップ3,4)、「負」な
らば前記変化量αを減算した値を制御用指令値Pn とし
て設定する(ステップ5)。FIG. 9 shows a flowchart of output control of the inclination angle for attitude control. This control is repeatedly executed every set unit time (5 ms). First, the current detection value Xn of the tilt angle sensor S is read (step 1), and the absolute value of the difference from the previous detection value Xn-1 is calculated.
That is, the amount of change per unit time in the detection information of the inclination angle sensor S is the change amount α of the posture inclination angle per unit time when the posture control means H corrects the posture of the body (detected body) (hydraulic cylinder (The amount of change in the attitude correction of the aircraft due to the change), it is determined whether the change is positive or negative (step 2). If the change is "positive", that is, if the detected value is increasing, the previous control command is issued. A value obtained by adding the change amount α of the attitude inclination angle per unit time when the attitude of the body is corrected by the attitude control means to the value P n− 1 is set as the current control command value P n (steps 3 and 4). ), If “negative”, a value obtained by subtracting the change amount α is set as the control command value Pn (step 5).
【0038】又、現在検出値Xn と前回の検出値Xn-1
との差の絶対値が前記変化量αより小さければ、検出値
変化の正負を判別して(ステップ6)、「正」ならば、
前回の制御用指令値Pn-1 に前記変化量αを加えた値A
1 と現在検出値とを比較し、現在検出値Xn が前記値A
1 よりも小さければ、その現在検出値を制御用指令値と
して設定し、現在検出値Xn が前記値A1 よりも大きけ
れば、その値を制御用指令値として設定する(ステップ
7〜10)。ステップ6での判別が「負」ならば、前回
の制御用指令値Pn-1 から前記変化量αを減算した値A
2 と現在検出値Xn とを比較し、現在検出値Xn が前記
値A 2 よりも大きければ、その現在検出値Xn を現在の
制御用指令値Pn として設定し、現在検出値Xn が前記
値A2 よりも小さければ、その値A2 を現在の制御用指
令値Pn として設定する(ステップ11〜13,9)。The current detection value XnAnd the previous detected value Xn-1
If the absolute value of the difference from
It is determined whether the change is positive or negative (step 6).
Previous control command value Pn-1A obtained by adding the change amount α to
1And the current detection value, and the current detection value XnIs the value A
1If the current detection value is smaller than
And set the current detection value XnIs the value A1Larger than
If so, the value is set as the control command value (step
7-10). If the determination in step 6 is "negative",
Command value P for controln-1A obtained by subtracting the change amount α from
TwoAnd the current detection value XnAnd the current detection value XnIs
Value A TwoIf the current detection value X is larger thannThe current
Control command value PnAnd the current detection value XnIs
Value ATwoIf it is less thanTwoThe current control finger
Price Pn(Steps 11 to 13, 9).
【0039】従って、制御用指令値として極力、傾斜角
センサSの検出値に近い値となるようにしながら、制御
用指令値の単位時間当たりの変化量が常に、姿勢制御手
段により対応可能な変化量αよりも大きくなることが無
く、姿勢制御が適切な操作量で良好に行われるものとな
る。Accordingly, while the control command value is as close as possible to the value detected by the inclination angle sensor S, the change amount of the control command value per unit time is always a change that can be handled by the attitude control means. It does not become larger than the amount α, and the posture control is favorably performed with an appropriate operation amount.
【0040】[0040]
【0041】(2)上記実施形態では、被検出体とし
て、コンバインの機体の左右傾斜を検出するようにした
が、例えば、機体の前後傾斜角を検出する構成であって
もよく、又、コンバイン等の農作業車に限らず、その他
の移動車や、定置式の装置の傾斜状態を検出する構成で
あってもよく、被検出体としてはどのようなものであっ
てもよい。( 2 ) In the above embodiment, the object to be detected detects the inclination of the body of the combine as the object to be detected. However, for example, a configuration for detecting the front-back inclination angle of the body may be used. However, the present invention is not limited to such agricultural work vehicles, but may be configured to detect the tilting state of other moving vehicles or stationary devices, and any object may be detected.
【0042】(3)上記実施形態では、油圧シリンダに
て被検出体の姿勢を修正するようにしたが、電気式アク
チュエータや、その他のアクチュエータ等を用いて実施
してもよい。( 3 ) In the above embodiment, the posture of the object to be detected is corrected by the hydraulic cylinder. However, the correction may be performed using an electric actuator or another actuator.
【0043】(4)上記実施形態では、傾斜角検出手段
として、一対の検出電極にて容器に入れられた液体の傾
斜状態を検出するようにしたが、例えば、被検出体に固
定の本体に対して重力により鉛直姿勢に復帰付勢された
振り子の本体に対する角度を検出するように構成する
等、各種の形態で実施してもよい。( 4 ) In the above embodiment, as the tilt angle detecting means, the tilt state of the liquid put in the container is detected by the pair of detection electrodes. On the other hand, the present invention may be embodied in various forms such as detecting the angle of the pendulum with respect to the main body of the pendulum which is urged to return to the vertical posture by gravity.
【図1】制御ブロック図FIG. 1 is a control block diagram
【図2】傾斜角センサを示す図FIG. 2 is a diagram showing an inclination angle sensor;
【図3】傾斜角の検出状態を示す図FIG. 3 is a diagram showing a detection state of an inclination angle;
【図4】コンバインの全体側面図FIG. 4 is an overall side view of the combine.
【図5】クローラ走行装置の側面図FIG. 5 is a side view of the crawler traveling device.
【図6】クローラ走行装置の縦断正面図FIG. 6 is a vertical front view of the crawler traveling device.
【図7】機体の傾斜状態を示す簡略化した正面図FIG. 7 is a simplified front view showing an inclined state of the aircraft.
【図8】傾斜角検出情報を示す図FIG. 8 is a diagram showing tilt angle detection information.
【図9】別実施形態の制御動作を示すフローチャートFIG. 9 is a flowchart illustrating a control operation according to another embodiment.
1,1 走行装置 30 制御部 31 本体 32 基準体 35 フィルター手段 CY アクチュエータ KS 検出情報修正手段 H 姿勢制御手段 S 傾斜角検出手段 V 被検出体 1,1 Traveling device 30 Control unit 31 Main body 32 Reference body 35 Filter means CY actuator KS Detection information correction means H Attitude control means S Inclination angle detection means V Detected body
───────────────────────────────────────────────────── フロントページの続き (58)調査した分野(Int.Cl.7,DB名) A01D 67/00 B62D 55/116 ──────────────────────────────────────────────────続 き Continued on front page (58) Field surveyed (Int.Cl. 7 , DB name) A01D 67/00 B62D 55/116
Claims (4)
検出手段と、この傾斜角検出手段の検出情報に基づい
て、被検出体を設定姿勢に制御する姿勢制御手段とが備
えられている姿勢制御装置であって、 前記傾斜角検出手段における検出可能な姿勢傾斜角の変
化速度が、前記姿勢制御手段が被検出体の姿勢を制御す
る際における姿勢傾斜角の変化速度の上限値よりも高く
なるように設定され、 前記傾斜角検出手段の検出情報を、前記姿勢制御手段に
よる姿勢制御動作の応答が可能な情報となるように、修
正する検出情報修正手段が備えられ、 前記検出情報修正手段が、 前記傾斜角検出手段の検出情報において、前記姿勢制御
手段が被検出体の姿勢を制御する際における姿勢傾斜角
の変化速度の上限値に対応する周波数と同じか又はほぼ
同じ値に設定されている設定周波数を越える周波数成分
を除去するフィルター手段で構成され、 前記傾斜角検出手段の検出情報をこのフィルター手段を
通過させた後に、前記姿勢制御手段に与えるように構成
されている 姿勢制御装置。An inclination angle detecting means for detecting a posture inclination angle of an object to be detected, and an attitude control means for controlling the object to be set to a set attitude based on information detected by the inclination angle detecting means are provided. In the attitude control device, the change rate of the attitude tilt angle that can be detected by the tilt angle detection means is higher than the upper limit value of the change rate of the attitude tilt angle when the attitude control means controls the attitude of the detected object. is set to be higher, the detection information of the tilt angle detecting means, wherein as response posture control operation by the posture control means is capable of information, detection information correcting means comprises al is to be modified, the detection Information correction means for detecting the attitude control based on the detection information of the inclination angle detection means;
Attitude inclination angle when the means controls the attitude of the detected object
The same or almost the frequency corresponding to the upper limit value of
Frequency components exceeding the set frequency set to the same value
Filter means for removing the detection information of the inclination angle detecting means.
After passing, it is given to the attitude control means.
It has been that attitude control system.
検出手段と、この傾斜角検出手段の検出情報に基づい
て、被検出体を設定姿勢に制御する姿勢制御手段とが備
えられている姿勢制御装置であって、 前記傾斜角検出手段における検出可能な姿勢傾斜角の変
化速度が、前記姿勢制御手段が被検出体の姿勢を制御す
る際における姿勢傾斜角の変化速度の上限値よりも高く
なるように設定され、 前記傾斜角検出手段の検出情報を、前記姿勢制御手段に
よる姿勢制御動作の応答が可能な情報となるように、修
正する検出情報修正手段が備えられ、 前記検出情報修正手段は、 前記傾斜角検出手段の検出情報における姿勢傾斜角の単
位時間当たりの変化量が、前記姿勢制御手段によって被
検出体の姿勢を修正する際における単位時間当たりの姿
勢傾斜角の変化量よりも大きい場合には、 前記傾斜角検出手段の検出情報における姿勢傾斜角の変
化量を、前記姿勢制御 手段によって被検出体の姿勢を修
正する際における単位時間当たりの姿勢傾斜角の変化量
に変更させるように構成されている 姿勢制御装置。2. An inclination angle for detecting a posture inclination angle of an object to be detected.
Detecting means, based on information detected by the inclination angle detecting means.
Attitude control means for controlling the detected object to the set attitude.
A posture control device, wherein the inclination angle detection means detects a change in posture inclination angle.
The attitude control means controls the attitude of the object to be detected.
Higher than the upper limit of the rate of change of the attitude inclination angle when
And the detection information of the inclination angle detection means is sent to the attitude control means.
So that the response to the posture control operation
Positive detected information correcting unit provided, the detection information correction means is a single attitude inclination angle in the detection information of the tilt angle detecting means
The amount of change per unit time is affected by the attitude control means.
Appearance per unit time when correcting the attitude of the object
If the change amount is larger than the change amount of the inclination angle, the change of the posture inclination angle in the detection information of the inclination angle detecting means is detected.
The attitude of the object to be detected by the attitude control means.
Amount of change in attitude tilt angle per unit time when correcting
An attitude control device that is configured to change the position.
体の、前記本体に対する角度を検出するように構成され
ている請求項1又は2 記載の姿勢制御装置。3. The reference device according to claim 1, wherein said tilt angle detecting means is biased to return to an initial state by gravity with respect to the main body.
And configured to detect an angle of the body with respect to the body.
The attitude control device according to claim 1 or 2, wherein:
れ、 前記姿勢制御手段は、 前記機体と、その機体に対して各別に相対昇降可能に設
けられた左右の走行装置各々との相対昇降位置を変更操
作自在な左右一対のアクチュエータと、 前記傾斜角検出手段の検出情報に基づいて前記各アクチ
ュエータの動作状態を制御する制御部とを備えて構成さ
れている 請求項1〜3のいずれか1項に記載の姿勢制御
装置。 4. The apparatus according to claim 1, wherein the object to be detected is an agricultural work vehicle.
The attitude control means is provided so as to be able to move up and down relative to the aircraft and the aircraft separately.
Operation to change the relative vertical position of the left and right traveling devices
A pair of operable left and right actuators and each of the actuators based on detection information of the inclination angle detection means.
And a control unit for controlling the operation state of the
Attitude control device according to any one of claims 1-3 being.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP23493596A JP3310552B2 (en) | 1996-09-05 | 1996-09-05 | Attitude control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP23493596A JP3310552B2 (en) | 1996-09-05 | 1996-09-05 | Attitude control device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH1075635A JPH1075635A (en) | 1998-03-24 |
| JP3310552B2 true JP3310552B2 (en) | 2002-08-05 |
Family
ID=16978586
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP23493596A Expired - Fee Related JP3310552B2 (en) | 1996-09-05 | 1996-09-05 | Attitude control device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3310552B2 (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4586225B2 (en) * | 2000-01-21 | 2010-11-24 | 井関農機株式会社 | Combine with tilt control |
-
1996
- 1996-09-05 JP JP23493596A patent/JP3310552B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JPH1075635A (en) | 1998-03-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP2007230387A (en) | Work vehicle attitude detection device and work vehicle attitude control device | |
| JP2004262292A (en) | Combine | |
| JP3310552B2 (en) | Attitude control device | |
| JP4901667B2 (en) | Work vehicle attitude control device | |
| JP3864511B2 (en) | Combine | |
| JPS6394919A (en) | work vehicle | |
| JP2008082882A (en) | Work vehicle attitude detection device and work vehicle attitude control device | |
| JP4758969B2 (en) | Work vehicle attitude control device | |
| JP3717411B2 (en) | Sensor zero correction device for work equipment | |
| JP4586225B2 (en) | Combine with tilt control | |
| JP3780736B2 (en) | Combine body level controller | |
| JP3319047B2 (en) | Combine horizontal control body | |
| JP3688211B2 (en) | Rolling control device for work equipment | |
| JP2000000015A (en) | Combine | |
| JP2841787B2 (en) | Automatic control device for combine traveling equipment | |
| JPH0222Y2 (en) | ||
| JP2000318661A (en) | Body level control device for work vehicles | |
| JP3662196B2 (en) | Work vehicle attitude control device | |
| JP2002204613A (en) | Attitude control device of reaper | |
| JPH0711561Y2 (en) | Attitude control device for combine harvesters | |
| JP3725313B2 (en) | Combine leveling device | |
| JP2001000031A (en) | Apparatus for controlling vehicle height of combine during turning | |
| JP2725370B2 (en) | Rolling equipment such as combine | |
| JP3018405B2 (en) | Left and right horizontal control system such as combine | |
| JP2789728B2 (en) | Combining pitching equipment |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| LAPS | Cancellation because of no payment of annual fees |