JP2009148229A - Working vehicle - Google Patents

Working vehicle Download PDF

Info

Publication number
JP2009148229A
JP2009148229A JP2007330810A JP2007330810A JP2009148229A JP 2009148229 A JP2009148229 A JP 2009148229A JP 2007330810 A JP2007330810 A JP 2007330810A JP 2007330810 A JP2007330810 A JP 2007330810A JP 2009148229 A JP2009148229 A JP 2009148229A
Authority
JP
Japan
Prior art keywords
threshold value
angular velocity
work vehicle
obtaining
machine body
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2007330810A
Other languages
Japanese (ja)
Other versions
JP5138354B2 (en
Inventor
Toshiyuki Miwa
敏之 三輪
Akishi Kuroda
晃史 黒田
Hiroyuki Kitagawa
浩之 北川
Katsunori Kato
勝則 加藤
Akihiro Niikuma
章浩 新熊
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 JP2007330810A priority Critical patent/JP5138354B2/en
Publication of JP2009148229A publication Critical patent/JP2009148229A/en
Application granted granted Critical
Publication of JP5138354B2 publication Critical patent/JP5138354B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Lifting Devices For Agricultural Implements (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a working vehicle capable of adequately controlling the posture of an implement connected to a traveling machine body according to the conditions of a field, and carrying out tillage of smooth soil without unevenness. <P>SOLUTION: The working vehicle comprises selecting an automatic mode (step S1: YES); when a detected value indicating a rolling angular velocity ω is input from a rolling gyroscope sensor (step S2: YES), obtaining a detected value indicating the car speed v from a car speed sensor (step S3); obtaining a threshold value f(v) corresponding to the car speed v (step S4); then determining whether or not the detected value indicating the rolling angular velocity ω is not lower than the threshold value f(v) (step S5); when the detected value indicating the rolling angular velocity ω is not lower than the threshold value f(v) (step S5: YES), controlling the posture of a rotary power tiller in a horizontal mode (step S6); and when the detected value indicating the rolling angular velocity ω is lower than the threshold value f(v) (step S5: NO), controlling the posture of the rotary power tiller in a parallel mode (step 7). <P>COPYRIGHT: (C)2009,JPO&INPIT

Description

本発明は走行機体に連結された作業機の姿勢を制御する作業車両に関する。   The present invention relates to a work vehicle that controls the attitude of a work machine connected to a traveling machine body.

従来の作業車両、例えば農作業機は、走行機体と、該走行機体に連結してある作業機とを備えており、前記走行機体が左右方向に傾斜したときに、前記作業機の姿勢を前記走行機体に対し平行に制御する手段(以下、前記作業機の姿勢を前記走行機体に対し平行に制御することを平行モードという。)と、前記走行機体が左右方向に傾斜したときに、前記作業機の姿勢を前記走行機体の姿勢に拘わらず、地面に対して一定の角度、例えば水平に制御する手段(以下、前記作業機の姿勢を水平に制御することを水平モードという。)とを備え、また前記平行モード又は水平モードを選択する選択ダイヤルを備えていた。   A conventional work vehicle, for example, a farm work machine includes a traveling machine body and a work machine connected to the traveling machine body, and when the traveling machine body is inclined in the left-right direction, the posture of the working machine is changed to the traveling machine body. Means for controlling in parallel with the machine body (hereinafter, controlling the posture of the working machine in parallel with the traveling machine body is referred to as a parallel mode), and the working machine when the traveling machine body is tilted in the left-right direction. Means for controlling the attitude of the traveling machine horizontally at a constant angle, for example, horizontally with respect to the ground (hereinafter, controlling the attitude of the working machine horizontally is referred to as a horizontal mode). Further, a selection dial for selecting the parallel mode or the horizontal mode was provided.

一般に圃場での作業は、圃場の中央部分にあたる隣接地及び圃場の周縁部分にあたる枕地での作業に大別される。前記隣接地で作業を行うときには、農作業機の操作者は前記選択ダイヤルを使用して前記平行モードを選択し、圃場の傾斜に対応させて前記作業機の姿勢を制御し、土壌をなだらかに耕耘していた。また多数の凹凸がある枕地で作業を行うときには、前記選択ダイヤルを使用して前記水平モードを選択し、前記作業機の姿勢を水平に制御し、土壌をムラなく耕耘していた(特許文献1参照)。   In general, work on a farm field is roughly divided into work on an adjacent land corresponding to a central portion of the farm field and a headland corresponding to a peripheral portion of the farm field. When working on the adjacent land, the operator of the agricultural machine selects the parallel mode using the selection dial, controls the attitude of the operating machine according to the inclination of the field, and gently plows the soil. Was. Also, when working on a headland with a large number of irregularities, the horizontal mode is selected using the selection dial, the posture of the working machine is controlled horizontally, and the soil is tilled evenly (Patent Document) 1).

また前記選択ダイヤルに替えて、前記走行機体の左右方向の傾斜角速度(以下ローリング角速度という。)を求める手段を設け、該手段により求めたローリング角速度を所定の閾値と比較し、比較結果に基づいて、前記平行に制御する手段又は水平に制御する手段の作動を選択する手段を設けて、作業機の姿勢を自動制御する作業車両も提案されている。
特許第3173988号公報
Further, instead of the selection dial, there is provided means for obtaining a lateral inclination angular velocity (hereinafter referred to as rolling angular velocity) of the traveling machine body, the rolling angular velocity obtained by the means is compared with a predetermined threshold value, and based on the comparison result. There has also been proposed a work vehicle that automatically controls the posture of the work implement by providing means for selecting the operation of the means for controlling in parallel or the means for controlling horizontally.
Japanese Patent No. 3173388

特許文献1に記載の作業車両にあっては、操作者が前記選択ダイヤルの操作を失念し、平行モードを選択した状態で枕地での作業を行い、また水平モードを選択した状態で隣接地での作業を行う場合があり、なだらかでムラのない土壌の耕耘を実現できない場合があった。   In the work vehicle described in Patent Document 1, the operator forgets to operate the selection dial, performs the work on the headland in the state where the parallel mode is selected, and the adjacent land in the state where the horizontal mode is selected. In some cases, it was not possible to achieve a gentle and uneven soil cultivation.

一方作業機の姿勢を自動制御する作業車両にあっては、操作者が前記選択ダイヤルの操作を失念した場合でも、前記平行モード又は水平モードの選択は行われる。高低差の大きな凹凸がある場所では、ローリング角速度が大きくなる傾向にあり、所定の大きさのローリング角速度に対応した所定の閾値を設定し、求めたローリング角速度が該閾値を超過したときに、枕地での作業を行っているとみなして、前記平行モードから水平モードへの切替を行っていた。また求めたローリング角速度が前記閾値よりも小さいときに、隣接地での作業を行っているとみなして、前記水平モードから平行モードへの切替を行っていた。
しかし前記走行機体が低速で移動している場合は、高速で移動している場合に比べてローリング角速度は小さいため、枕地で作業をしているにも拘わらず、求めたローリング角速度が前記閾値を超過せずに隣接地での作業を行っているとみなされ、前記平行モードから水平モードへの切替が行われないという問題点があった。
On the other hand, in the work vehicle that automatically controls the attitude of the work implement, the parallel mode or the horizontal mode is selected even when the operator forgets to operate the selection dial. Where there is a large unevenness in height difference, the rolling angular velocity tends to increase, and when a predetermined threshold value corresponding to the rolling angular velocity of a predetermined size is set and the calculated rolling angular velocity exceeds the threshold value, the pillow Assuming that work is performed on the ground, the parallel mode is switched to the horizontal mode. Further, when the calculated rolling angular velocity is smaller than the threshold value, it is considered that the work is performed in the adjacent land, and the switching from the horizontal mode to the parallel mode is performed.
However, when the traveling vehicle is moving at a low speed, the rolling angular velocity is smaller than that when moving at a high speed. Therefore, it is considered that the work is performed in the adjacent land without exceeding, and there is a problem that the switching from the parallel mode to the horizontal mode is not performed.

本発明は斯かる事情に鑑みてなされたものであり、走行機体の走行速度を求める手段と、該手段により求めた走行速度に応じて、閾値を設定する手段とを設けることにより、前記走行機体のローリング角速度を求める手段により求めたローリング角速度を前記閾値と比較し、該比較結果に基づいて、前記走行機体に連結された作業機の姿勢を制御して、操作者の操作によることなく前記作業機の姿勢を制御し、また前記走行機体が低速で移動している場合であって、枕地で作業が行われているときに、前記平行モードから水平モードに切替えて、なだらかでムラのない土壌の耕耘を行うことができる作業車両を提供することを目的とする。   The present invention has been made in view of such circumstances, and by providing means for obtaining the traveling speed of the traveling machine body and means for setting a threshold according to the traveling speed obtained by the means, the traveling machine body is provided. The rolling angular velocity obtained by the means for obtaining the rolling angular velocity of the vehicle is compared with the threshold value, and based on the comparison result, the posture of the work machine connected to the traveling machine body is controlled, and the work can be performed without the operator's operation. Control the attitude of the machine, and when the traveling machine is moving at low speed, and when working on the headland, switch from the parallel mode to the horizontal mode, smooth and uneven An object is to provide a work vehicle capable of plowing soil.

また前記走行機体に搭載してある駆動源の回転数を求める手段と、該手段により求めた回転数に応じて前記閾値を調整する手段とを設けることにより、前記駆動源の振動が前記走行機体に伝播し、ローリング角速度を求める手段が前記閾値に近い値を求めたときに、前記平行モードと前記水平モードとの切替えが行われるので、求めた値と、前記閾値との比較結果に振動による誤差が波及しないように前記閾値を調整して、振動の影響を除去した閾値を設定し、前記平行モードと前記水平モードとの不要な切替えを防止して、なだらかでムラのない土壌の耕耘を行うことができる作業車両を提供することを目的とする。   Further, by providing means for obtaining the rotational speed of the drive source mounted on the traveling machine body and means for adjusting the threshold according to the rotational speed obtained by the means, vibration of the drive source causes the traveling machine body to vibrate. When the means for obtaining the rolling angular velocity obtains a value close to the threshold value, switching between the parallel mode and the horizontal mode is performed, so the comparison result between the obtained value and the threshold value depends on vibration. Adjusting the threshold value so as not to spread an error, setting a threshold value that eliminates the influence of vibration, preventing unnecessary switching between the parallel mode and the horizontal mode, and cultivating soil that is gentle and uneven An object is to provide a work vehicle that can be used.

また前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降距離を求める手段と、該手段により求めた昇降距離に応じて、前記閾値を調整する手段とを設けることにより、前記昇降距離が大きくなるにつれて、高低差の大きい凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記昇降距離に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる作業車両を提供することを目的とする。   In addition, by providing means for raising and lowering the working machine, means for obtaining the raising and lowering distance of the working machine raised and lowered by the means, and means for adjusting the threshold according to the raising and lowering distance obtained by the means, It is considered that the probability of working on a headland with unevenness with a large height difference increases as the ascent distance increases, so the threshold is adjusted according to the ascent distance, and the parallel mode and the horizontal mode It is an object of the present invention to provide a work vehicle capable of instantaneously switching the soil and cultivating the soil without any unevenness.

また前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降回数を求める手段と、該手段により求めた昇降回数に基づいて所定時間あたりの昇降回数を算出する手段と、算出した該昇降回数に応じて前記閾値を調整する手段とを設けることにより、前記昇降回数の増加に従って、多数の凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記昇降回数に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる作業車両を提供することを目的とする。   Further, a means for raising and lowering the work implement, a means for obtaining the number of times the work implement has been raised and lowered by the means, a means for calculating the number of elevations per predetermined time based on the number of elevations obtained by the means, By providing the means for adjusting the threshold according to the number of times of raising and lowering, it is considered that the probability of working on a headland with a large number of irregularities increases as the number of times of raising and lowering, so the threshold value is It is an object of the present invention to provide a work vehicle that can be adjusted according to the number of times of ascent / descent, instantly switch between the parallel mode and the horizontal mode, and can cultivate the soil smoothly and without unevenness.

また前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降位置を時系列的に複数求める手段と、該手段により求めた前記作業機の複数の昇降位置に基づいて昇降位置の偏差を算出する手段と、算出された偏差に応じて前記閾値を調整する手段とを設けることにより、前記偏差が大きくなるにつれて枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記偏差に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる作業車両を提供することを目的とする。   Further, a means for raising and lowering the work implement, a means for obtaining a plurality of raising and lowering positions of the work implement raised and lowered by the means in time series, and a position of the raising and lowering position based on the plurality of raising and lowering positions of the work implement obtained by the means. By providing the means for calculating the deviation and the means for adjusting the threshold according to the calculated deviation, it is considered that the probability of working on the headland increases as the deviation increases. It is an object of the present invention to provide a work vehicle capable of adjusting soil according to the deviation, instantaneously switching between the parallel mode and the horizontal mode, and capable of tilling the soil without any unevenness.

また前記走行機体の前後方向の傾斜角速度を求める手段と、該手段により求めた傾斜角速度に応じて、前記閾値を調整する手段とを設けることにより、前記走行機体の前後方向の傾斜角速度(以下ピッチング角速度という。)が大きくなるにつれて枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記ピッチング角速度に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる作業車両を提供することを目的とする。   In addition, by providing means for determining the longitudinal angular velocity of the traveling aircraft body and means for adjusting the threshold according to the inclination angular velocity obtained by the means, the longitudinal angular velocity (hereinafter referred to as pitching) of the traveling aircraft body is provided. It is considered that the probability of working on a headland increases as the angular velocity increases), so the threshold value is adjusted according to the pitching angular velocity, and the switching between the parallel mode and the horizontal mode is performed instantaneously. An object of the present invention is to provide a work vehicle that can cultivate soil that is gentle and has no unevenness.

また前記走行機体の前後方向の傾斜角度を時系列的に複数求める手段と、該手段により求めた複数の傾斜角度に基づいて、所定時間あたりの前記傾斜角度の変化量を算出する手段と、算出された前記変化量に応じて前記閾値を調整する手段を設けることにより、前記走行機体の前後方向の傾斜角度(以下ピッチング角度という。)の変化量が大きくなるにつれて枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記ピッチング角度の変化量に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる作業車両を提供することを目的とする。   Further, a means for obtaining a plurality of time-sequential inclination angles of the traveling machine body, a means for calculating a change amount of the inclination angle per predetermined time based on the plurality of inclination angles obtained by the means, and a calculation By providing means for adjusting the threshold value in accordance with the amount of change made, work is performed on the headland as the amount of change in the front-rear direction tilt angle (hereinafter referred to as pitching angle) of the traveling body increases. Since the probability is considered to be high, the threshold value is adjusted according to the amount of change in the pitching angle, the switching between the parallel mode and the horizontal mode is performed instantaneously, and the soil is gently and unevenly cultivated. An object of the present invention is to provide a work vehicle that can be used.

また前記閾値にヒステリシスを設定する手段を設けることにより、前記走行機体の振動がローリング角速度を求める手段に伝播して、ローリング角速度を求める手段が前記閾値に近い値を求めたときに、前記平行モードと前記水平モードとの切替えが行われるので、求めた値と前記閾値との比較結果に振動による誤差が波及しないように前記閾値にヒステリシスを設け、前記平行モードと前記水平モードとの不要な切替えを防止して、なだらかでムラのない土壌の耕耘を行うことができる作業車両を提供することを目的とする。   Further, by providing means for setting hysteresis to the threshold, the vibration of the traveling body propagates to the means for obtaining the rolling angular velocity, and when the means for obtaining the rolling angular velocity obtains a value close to the threshold, the parallel mode Since the switching between the horizontal mode and the horizontal mode is performed, hysteresis is provided in the threshold value so that an error due to vibration does not affect the comparison result between the obtained value and the threshold value, and unnecessary switching between the parallel mode and the horizontal mode is performed. An object of the present invention is to provide a work vehicle capable of preventing soil and cultivating soil that is gentle and uneven.

第1発明に係る作業車両は、走行速度を求める手段を有する走行機体と、該走行機体に連結された作業機を、各別の姿勢に制御する複数の姿勢制御手段と、前記走行機体の左右方向の傾斜角速度を求める手段と、該手段により求めた傾斜角速度を所定の閾値と比較する手段と、該手段の比較結果に基づいて、いずれかの姿勢制御手段を作動させる手段とを備える作業車両において、走行速度を求める前記手段により求めた走行速度に応じて、前記閾値を設定する手段を備えることを特徴とする。   A work vehicle according to a first aspect of the present invention includes a traveling machine body having means for obtaining a traveling speed, a plurality of posture control means for controlling the working machine connected to the traveling machine body to different postures, and left and right sides of the traveling machine body A work vehicle comprising: means for obtaining a tilt angular velocity in a direction; means for comparing the tilt angular speed obtained by the means with a predetermined threshold; and means for operating one of the attitude control means based on a comparison result of the means And a means for setting the threshold value in accordance with the traveling speed obtained by the means for obtaining the traveling speed.

本発明においては、走行機体の走行速度を求める手段と、該手段により求めた走行速度に応じて、閾値を設定する手段とを設けることにより、前記走行機体のローリング角速度を求める手段により求めたローリング角速度を前記閾値と比較し、該比較結果に基づいて、前記走行機体に連結された作業機の姿勢を制御して、操作者の操作によることなく前記作業機の姿勢を制御し、また前記走行機体が低速で移動している場合であって、枕地で作業が行われているときに、前記平行モードから水平モードに切替える。   In the present invention, the rolling speed obtained by the means for obtaining the rolling angular speed of the traveling airframe is provided by means for obtaining the traveling speed of the traveling airframe and means for setting a threshold according to the traveling speed obtained by the means. The angular velocity is compared with the threshold value, and based on the comparison result, the posture of the working machine connected to the traveling machine body is controlled, and the posture of the working machine is controlled without being operated by an operator. When the airframe is moving at a low speed and the work is being performed on the headland, the parallel mode is switched to the horizontal mode.

第2発明に係る作業車両は、前記走行機体に搭載してある駆動源の回転数を求める手段と、該手段により求めた回転数に応じて、前記閾値を調整する手段とを備えることを特徴とする。   A work vehicle according to a second aspect of the present invention includes means for obtaining a rotational speed of a drive source mounted on the traveling machine body, and means for adjusting the threshold according to the rotational speed obtained by the means. And

本発明においては前記走行機体に搭載してある駆動源の回転数を求める手段と、該手段により求めた回転数に応じて前記閾値を調整する手段とを設けることにより、前記駆動源の振動が前記走行機体に伝播し、ローリング角速度を求める手段が前記閾値に近い値を求めたときに、前記平行モードと前記水平モードとの切替えが行われるので、求めた値と、前記閾値との比較結果に振動による誤差が波及しないように前記閾値を調整して、振動の影響を除去した閾値を設定する。   In the present invention, by providing means for obtaining the rotational speed of the drive source mounted on the traveling machine body and means for adjusting the threshold value according to the rotational speed obtained by the means, vibration of the drive source is provided. When the means for obtaining the rolling angular velocity, which is propagated to the traveling machine body, obtains a value close to the threshold value, switching between the parallel mode and the horizontal mode is performed, so that the obtained value is compared with the threshold value. The threshold value is adjusted so that an error due to vibration does not spread to the threshold value, and a threshold value that eliminates the influence of vibration is set.

第3発明に係る作業車両は、前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降距離を求める手段と、該手段により求めた昇降距離に応じて、前記閾値を調整する手段とを備えることを特徴とする。   A work vehicle according to a third aspect of the invention adjusts the threshold according to means for raising and lowering the work implement, means for obtaining a lift distance of the work implement lifted by the means, and a lift distance obtained by the means. Means.

本発明においては、前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降距離を求める手段と、該手段により求めた昇降距離に応じて、前記閾値を調整する手段とを設けることにより、前記昇降距離が大きくなるにつれて、高低差の大きい凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記昇降距離に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行う。   In the present invention, there are provided means for raising and lowering the work implement, means for obtaining a lift distance of the work implement lifted by the means, and means for adjusting the threshold according to the lift distance obtained by the means. Therefore, it is considered that the probability of working on a headland with a large unevenness with a large height difference increases as the lifting distance increases, so the threshold value is adjusted according to the lifting distance, and the parallel mode and Switching to the horizontal mode is performed instantaneously.

第4発明に係る作業車両は、前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降回数を求める手段と、該手段により求めた昇降回数に基づいて、所定時間あたりの昇降回数を算出する手段と、該手段により算出された所定時間あたりの昇降回数に応じて、前記閾値を調整する手段とを備えることを特徴とする。   According to a fourth aspect of the present invention, there is provided a work vehicle according to a fourth aspect of the invention, a means for raising and lowering the work implement, a means for obtaining the number of times the work implement has been raised and lowered by the means, and raising and lowering per predetermined time based on the number of elevations obtained by the means It is characterized by comprising means for calculating the number of times, and means for adjusting the threshold according to the number of times of ascending / descending per predetermined time calculated by the means.

本発明においては、前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降回数を求める手段と、該手段により求めた昇降回数に基づいて所定時間あたりの昇降回数を算出する手段と、算出した該昇降回数に応じて前記閾値を調整する手段とを設けることにより、前記昇降回数の増加に従って、多数の凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記昇降回数に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行う。   In the present invention, means for raising and lowering the work implement, means for obtaining the number of times the work implement has been raised and lowered by the means, and means for calculating the number of elevations per predetermined time based on the number of elevations obtained by the means And by providing the means for adjusting the threshold according to the calculated number of times of raising and lowering, it is considered that the probability of working on a headland with a large number of unevenness increases as the number of times of raising and lowering increases. The threshold value is adjusted according to the number of times of raising and lowering, and switching between the parallel mode and the horizontal mode is performed instantaneously.

第5発明に係る作業車両は、前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降位置を時系列的に複数求める手段と、該手段により求めた前記作業機の複数の昇降位置に基づいて、昇降位置の偏差を算出する手段と、該手段により算出された偏差に応じて、前記閾値を調整する手段とを備えることを特徴とする。   A work vehicle according to a fifth aspect of the present invention is a work vehicle for raising and lowering the work implement, means for obtaining a plurality of lift positions of the work implement raised and lowered by the means in time series, and a plurality of work implements obtained by the means. The apparatus includes: means for calculating a deviation of the lift position based on the lift position; and means for adjusting the threshold according to the deviation calculated by the means.

本発明においては、前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降位置を時系列的に複数求める手段と、該手段により求めた前記作業機の複数の昇降位置に基づいて昇降位置の偏差を算出する手段と、算出された偏差に応じて前記閾値を調整する手段とを設けることにより、前記偏差が大きくなるにつれて枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記偏差に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行う。   In the present invention, based on the means for raising and lowering the work implement, the means for obtaining a plurality of elevating positions of the work implement raised and lowered by the means in time series, and the plurality of elevating positions of the work implement obtained by the means. By providing the means for calculating the deviation of the lift position and the means for adjusting the threshold according to the calculated deviation, it is considered that the probability of working on the headland increases as the deviation increases. Therefore, the threshold value is adjusted according to the deviation, and switching between the parallel mode and the horizontal mode is performed instantaneously.

第6発明に係る作業車両は、前記走行機体の前後方向の傾斜角速度を求める手段と、該手段により求めた傾斜角速度に応じて、前記閾値を調整する手段とを備えることを特徴とする。   A work vehicle according to a sixth aspect of the invention is characterized by comprising means for obtaining a longitudinal angular velocity of the traveling machine body and means for adjusting the threshold according to the inclination angular velocity obtained by the means.

本発明においては、前記走行機体の前後方向の傾斜角速度を求める手段と、該手段により求めた傾斜角速度に応じて、前記閾値を調整する手段とを設けることにより、前記走行機体の前後方向の傾斜角速度(以下ピッチング角速度という。)が大きくなるにつれて枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記ピッチング角速度に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行う。   In the present invention, by providing means for determining the inclination angular velocity in the front-rear direction of the traveling aircraft and means for adjusting the threshold according to the inclination angular velocity obtained by the means, the inclination in the front-rear direction of the traveling aircraft is provided. As the angular velocity (hereinafter referred to as pitching angular velocity) increases, the probability of working on the headland increases. Therefore, the threshold value is adjusted according to the pitching angular velocity to switch between the parallel mode and the horizontal mode. Is done instantly.

第7発明に係る作業車両は、前記走行機体の前後方向の傾斜角度を時系列的に複数求める手段と、該手段により求めた複数の前記傾斜角度に基づいて、所定時間あたりの前記傾斜角度の変化量を算出する手段と、該手段により算出された前記変化量に応じて、前記閾値を調整する手段とを備えることを特徴とする。   According to a seventh aspect of the present invention, there is provided a work vehicle according to the present invention, wherein a plurality of time-series inclination angles of the traveling machine body are obtained in a time series, and the inclination angle per predetermined time is determined based on the plurality of inclination angles obtained by the means. Means for calculating a change amount, and means for adjusting the threshold according to the change amount calculated by the means.

本発明においては、前記走行機体の前後方向の傾斜角度を時系列的に複数求める手段と、該手段により求めた複数の傾斜角度に基づいて、所定時間あたりの前記傾斜角度の変化量を算出する手段と、算出された前記変化量に応じて前記閾値を調整する手段を設けることにより、前記走行機体の前後方向の傾斜角度(以下ピッチング角度という。)の変化量が大きくなるにつれて枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記ピッチング角度の変化量に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行う。   In the present invention, a plurality of time-sequentially determining inclination angles in the front-rear direction of the traveling vehicle body and a change amount of the inclination angle per predetermined time are calculated based on the plurality of inclination angles obtained by the means. And a means for adjusting the threshold according to the calculated amount of change, and working on the headland as the amount of change in the front-rear direction tilt angle (hereinafter referred to as pitching angle) increases. Therefore, the threshold value is adjusted according to the change amount of the pitching angle, and the parallel mode and the horizontal mode are switched instantaneously.

第8発明に係る作業車両は、前記閾値にヒステリシスを設定する手段を備えることを特徴とする。   The work vehicle according to an eighth aspect is characterized by comprising means for setting a hysteresis in the threshold value.

本発明においては、前記閾値にヒステリシスを設定する手段を設けることにより、前記走行機体の振動がローリング角速度を求める手段に伝播して、ローリング角速度を求める手段が前記閾値に近い値を求めたときに、前記平行モードと前記水平モードとの切替えが行われるので、求めた値と前記閾値との比較結果に振動による誤差が波及しないように前記閾値にヒステリシスを設け、前記平行モードと前記水平モードとの不要な切替えを防止する。   In the present invention, by providing means for setting a hysteresis in the threshold value, when the vibration of the traveling body propagates to the means for obtaining the rolling angular velocity, the means for obtaining the rolling angular velocity obtains a value close to the threshold value. Since the switching between the parallel mode and the horizontal mode is performed, a hysteresis is provided in the threshold value so that an error due to vibration does not affect the comparison result between the obtained value and the threshold value, and the parallel mode and the horizontal mode Prevent unnecessary switching.

第1発明に係る作業車両にあっては、走行機体の走行速度を求める手段と、該手段により求めた走行速度に応じて、閾値を設定する手段とを設けることにより、前記走行機体のローリング角速度を求める手段により求めたローリング角速度を前記閾値と比較し、該比較結果に基づいて、前記走行機体に連結された作業機の姿勢を制御して、操作者の操作によることなく前記作業機の姿勢を制御し、また前記走行機体が低速で移動している場合であって、枕地で作業が行われているときに、前記平行モードから水平モードに切替えて、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the first aspect of the present invention, by providing means for determining the traveling speed of the traveling machine body and means for setting a threshold according to the traveling speed determined by the means, the rolling angular speed of the traveling machine body is provided. Comparing the rolling angular velocity obtained by the means for obtaining the threshold value and controlling the posture of the working machine connected to the traveling machine based on the comparison result, so that the posture of the working machine can be determined without an operator's operation. And when the traveling body is moving at a low speed and when working on a headland, the parallel mode is switched to the horizontal mode, and the soil is gently cultivated without unevenness. It can be performed.

第2発明に係る作業車両にあっては、前記走行機体に搭載してある駆動源の回転数を求める手段と、該手段により求めた回転数に応じて前記閾値を調整する手段とを設けることにより、前記駆動源の振動が前記走行機体に伝播し、ローリング角速度を求める手段が前記閾値に近い値を求めたときに、前記平行モードと前記水平モードとの切替えが行われるので、求めた値と前記閾値との比較結果に振動による誤差が波及しないように前記閾値を調整して、振動の影響を除去した閾値を設定し、前記平行モードと前記水平モードとの不要な切替えを防止して、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the second aspect of the present invention, there are provided means for obtaining the rotational speed of the drive source mounted on the traveling machine body and means for adjusting the threshold according to the rotational speed obtained by the means. Thus, when the vibration of the drive source is propagated to the traveling machine body and the means for obtaining the rolling angular velocity obtains a value close to the threshold value, the parallel mode and the horizontal mode are switched. The threshold value is adjusted so that an error due to vibration does not affect the comparison result between the threshold value and the threshold value, and a threshold value that eliminates the influence of vibration is set to prevent unnecessary switching between the parallel mode and the horizontal mode. The soil can be cultivated gently and evenly.

第3発明に係る作業車両にあっては、前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降距離を求める手段と、該手段により求めた昇降距離に応じて、前記閾値を調整する手段とを設けることにより、前記昇降距離が大きくなるにつれて、高低差の大きい凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記昇降距離に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the third aspect of the present invention, means for raising and lowering the work implement, means for obtaining a lift distance of the work implement lifted by the means, and the threshold value according to the lift distance obtained by the means It is considered that the probability of working on a headland with unevenness with a large difference in height increases as the lifting distance increases, so that the threshold is set according to the lifting distance. It is possible to instantaneously switch between the parallel mode and the horizontal mode by adjusting and cultivate the soil without any unevenness.

第4発明に係る作業車両にあっては、前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降回数を求める手段と、該手段により求めた昇降回数に基づいて所定時間あたりの昇降回数を算出する手段と、算出した該昇降回数に応じて前記閾値を調整する手段とを設けることにより、前記昇降回数の増加に従って、多数の凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記昇降回数に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the fourth aspect of the present invention, means for raising and lowering the work implement, means for obtaining the number of times the work implement has been raised and lowered by the means, and a predetermined time based on the number of elevations obtained by the means. Providing means for calculating the number of times of raising and lowering, and means for adjusting the threshold according to the calculated number of times of raising and lowering, the probability of working on a headland with a large number of irregularities as the number of times of raising and lowering Therefore, the threshold value is adjusted according to the number of times of raising and lowering, and switching between the parallel mode and the horizontal mode is performed instantaneously, so that the soil can be cultivated gently and evenly.

第5発明に係る作業車両にあっては、前記作業機を昇降させる手段と、該手段により昇降した前記作業機の昇降位置を時系列的に複数求める手段と、該手段により求めた前記作業機の複数の昇降位置に基づいて昇降位置の偏差を算出する手段と、算出された偏差に応じて前記閾値を調整する手段とを設けることにより、前記偏差が大きくなるにつれて枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記偏差に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the fifth aspect of the present invention, means for raising and lowering the work implement, means for obtaining a plurality of time-up positions of the work implement raised and lowered by the means, and the work implement obtained by the means By providing means for calculating the deviation of the lift position based on the plurality of lift positions, and means for adjusting the threshold according to the calculated deviation, work is performed on the headland as the deviation increases. Therefore, the threshold value is adjusted in accordance with the deviation, and the switching between the parallel mode and the horizontal mode is performed instantaneously, so that the soil can be cultivated gently and evenly.

第6発明に係る作業車両にあっては、前記走行機体の前後方向の傾斜角速度を求める手段と、該手段により求めた傾斜角速度に応じて、前記閾値を調整する手段とを設けることにより、前記走行機体の前後方向の傾斜角速度(以下ピッチング角速度という。)が大きくなるにつれて枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記ピッチング角速度に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the sixth aspect of the present invention, by providing means for obtaining the inclination angular velocity in the front-rear direction of the traveling machine body, and means for adjusting the threshold according to the inclination angular velocity obtained by the means, Since it is considered that the probability of working on the headland increases as the angular velocity of the traveling body in the front-rear direction (hereinafter referred to as pitching angular velocity) increases, the threshold is adjusted according to the pitching angular velocity, and the parallel mode It is possible to instantly switch between the horizontal mode and the tillage of the soil without any unevenness.

第7発明に係る作業車両にあっては、前記走行機体の前後方向の傾斜角度を時系列的に複数求める手段と、該手段により求めた複数の傾斜角度に基づいて、所定時間あたりの前記傾斜角度の変化量を算出する手段と、算出された前記変化量に応じて前記閾値を調整する手段を設けることにより、前記走行機体の前後方向の傾斜角度(以下ピッチング角度という。)の変化量が大きくなるにつれて枕地で作業を行っている確率が高くなると考えられるので、前記閾値を前記ピッチング角度の変化量に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the seventh aspect of the present invention, means for obtaining a plurality of inclination angles in the front-rear direction of the traveling machine body in time series, and the inclination per predetermined time based on the plurality of inclination angles obtained by the means. By providing means for calculating the amount of change in angle and means for adjusting the threshold according to the calculated amount of change, the amount of change in the inclination angle (hereinafter referred to as pitching angle) of the traveling aircraft body in the front-rear direction is provided. Since it is considered that the probability of working on a headland increases as it increases, the threshold is adjusted according to the amount of change in the pitching angle, and the switching between the parallel mode and the horizontal mode is performed instantaneously. It is possible to cultivate soil with no unevenness.

第8発明に係る作業車両にあっては、前記閾値にヒステリシスを設定する手段を設けることにより、前記走行機体の振動がローリング角速度を求める手段に伝播して、ローリング角速度を求める手段が前記閾値に近い値を求めたときに、前記平行モードと前記水平モードとの切替えが行われるので、求めた値と前記閾値との比較結果に振動による誤差が波及しないように前記閾値にヒステリシスを設け、前記平行モードと前記水平モードとの不要な切替えを防止して、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the eighth aspect of the present invention, by providing means for setting hysteresis to the threshold value, the vibration of the traveling machine body propagates to the means for obtaining the rolling angular velocity, and the means for obtaining the rolling angular velocity is set to the threshold value. Since switching between the parallel mode and the horizontal mode is performed when a close value is obtained, a hysteresis is provided in the threshold value so that an error due to vibration does not affect the comparison result between the obtained value and the threshold value. Unnecessary switching between the parallel mode and the horizontal mode can be prevented, and the soil can be cultivated gently and evenly.

(実施の形態1)
以下本発明を実施の形態1を示す図面に基づいて詳述する。図1は実施の形態1に係る作業車両の略示側面図、図2はキャビンの屋根を省略した作業車両の略示平面図である。
(Embodiment 1)
Hereinafter, the present invention will be described in detail with reference to the drawings showing the first embodiment. FIG. 1 is a schematic side view of a work vehicle according to Embodiment 1, and FIG. 2 is a schematic plan view of the work vehicle with a cabin roof omitted.

図において1は農作業機の走行機体であり、該走行機体1は、ディーゼル式のエンジン5を搭載してあるエンジンフレーム14を有しており、前記エンジン5の近傍にエンジン5のクランクの角度を検出して、エンジン5の回転数を検出するクランク角センサ5aを設けてある。   In the figure, 1 is a traveling machine body of an agricultural machine, and the traveling machine body 1 has an engine frame 14 on which a diesel engine 5 is mounted, and the crank angle of the engine 5 is set in the vicinity of the engine 5. A crank angle sensor 5a that detects and detects the rotational speed of the engine 5 is provided.

前記エンジンフレーム14の前側に前バンパ12を設けてあり、前記エンジンフレーム14の左右両側に二つの前車軸ケース13、13を設けてある。該前車軸ケース13、13を介して左右一対の前車輪3、3が設けてある。前記エンジンフレーム14の後部に、機体フレーム16がボルトにて着脱自在に固定してあり、該機体フレーム16の両側に左右一対の後車輪4、4が設けてある。前記エンジン5にて前記後車輪4、4及び前車輪3、3を駆動することにより、走行機体1は前後進走行するように構成してある。前記エンジン5はボンネット6にて覆われており、また前記機体フレーム16の上面にはキャビン7が設置してある。該キャビン7の内部には、操縦座席8と、舵取りすることによって前車輪3の操向方向を左右に動かすステアリングホイール9とが設置されている。   A front bumper 12 is provided on the front side of the engine frame 14, and two front axle cases 13, 13 are provided on the left and right sides of the engine frame 14. A pair of left and right front wheels 3, 3 are provided via the front axle cases 13, 13. A body frame 16 is detachably fixed to the rear portion of the engine frame 14 with bolts, and a pair of left and right rear wheels 4 and 4 are provided on both sides of the body frame 16. By driving the rear wheels 4, 4 and the front wheels 3, 3 with the engine 5, the traveling machine body 1 is configured to travel forward and backward. The engine 5 is covered with a hood 6, and a cabin 7 is installed on the upper surface of the body frame 16. Inside the cabin 7, a steering seat 8 and a steering wheel 9 for moving the steering direction of the front wheel 3 to the left and right by steering are installed.

前記操縦座席8の後側には、走行機体1の左右方向の傾斜角度を検出する振り子式のローリング角センサ120と、走行機体1の左右方向の傾斜角速度を検出するガスレート式のローリングジャイロセンサ121と、走行機体1の前後方向の傾斜角度を検出する振り子式のピッチング角センサ130と、走行機体1の前後方向の傾斜角速度を検出するガスレート式のピッチングジャイロセンサ131とを設けてある。   On the rear side of the control seat 8, a pendulum type rolling angle sensor 120 that detects a tilt angle in the left-right direction of the traveling machine body 1 and a gas rate type rolling gyro sensor that detects a tilt angle speed in the left-right direction of the traveling machine body 1. 121, a pendulum-type pitching angle sensor 130 for detecting a tilt angle in the front-rear direction of the traveling machine body 1, and a gas-rate-type pitching gyro sensor 131 for detecting a tilt angular velocity in the front-rear direction of the traveling machine body 1 are provided.

前記キャビン7の外側部には、操作者が乗降するステップ10を設けてあり、該ステップ10より内側で且つ前記キャビン7の底部より下側には、前記エンジン5に燃料を供給する燃料タンク11を設けてある。   A step 10 in which an operator gets on and off is provided on the outer side of the cabin 7, and a fuel tank 11 that supplies fuel to the engine 5 on the inner side of the step 10 and below the bottom of the cabin 7. Is provided.

前記機体フレーム16の後部には、エンジン5からの回転動力を適宜変速して前車輪3、3及び後車輪4、4に伝達するための走行変速機構を有するミッションケース17が搭載されている。後車輪4は、ミッションケース17の外側面から外向きに突出するように装着された図示しない後車軸ケースを介して取り付けてある。   A transmission case 17 having a traveling speed change mechanism for appropriately changing the rotational power from the engine 5 and transmitting it to the front wheels 3, 3 and the rear wheels 4, 4 is mounted on the rear part of the body frame 16. The rear wheel 4 is attached via a rear axle case (not shown) mounted so as to protrude outward from the outer surface of the mission case 17.

ミッションケース17には、エンジン5からの回転動力の一部を後述するPTO軸23に伝達するための図示しないPTO変速機構が内蔵されている。該PTO変速機構により、後述するロータリ耕耘機24の回転伝動系への入口において、回転動力の大きさを無段階又は段階的に調節する。また走行機体1の前後進を切替える主クラッチ(図示せず)が内蔵されており、主クラッチ付近にホールICを備える車速センサ17aを設けてある。該車速センサ17aにより、前記主クラッチに連結してある図示しないシャフトの回転数に基づいて、走行機体1の車速を検出する構成にしてある。   The transmission case 17 incorporates a PTO transmission mechanism (not shown) for transmitting a part of the rotational power from the engine 5 to a PTO shaft 23 described later. By the PTO speed change mechanism, the magnitude of the rotational power is adjusted steplessly or stepwise at the entrance to the rotary transmission system of the rotary cultivator 24 described later. A main clutch (not shown) for switching the forward and backward travel of the traveling machine body 1 is built in, and a vehicle speed sensor 17a having a Hall IC is provided in the vicinity of the main clutch. The vehicle speed sensor 17a detects the vehicle speed of the traveling machine body 1 based on the rotation speed of a shaft (not shown) connected to the main clutch.

ミッションケース17の後部上面には、作業機としてのロータリ耕耘機24を昇降動する油圧式の作業機用昇降機構20が着脱可能に取り付けられている。ロータリ耕耘機24は、ミッションケース17の後部に、一対の左右ロワーリンク21、21及びトップリンク22からなる3点リンク機構を介して連結してある。左右ロワーリンク21、21の前端側は、ミッションケース17の後部の左右側面にロワーリンクピン25、25を介して回動可能に連結されている。前記トップリンク22の前端側は、前記作業機用昇降機構20後部のトップリンクヒッチ26にトップリンクピンを介して連結されている。さらに、ミッションケース17の後側面には、前記ロータリ耕耘機24にPTO駆動力を伝達するためのPTO軸23が後向きに突出するように設けられている。   On the rear upper surface of the mission case 17, a hydraulic working machine lifting mechanism 20 that moves up and down a rotary tiller 24 as a working machine is detachably attached. The rotary cultivator 24 is connected to the rear part of the mission case 17 via a three-point link mechanism including a pair of left and right lower links 21 and 21 and a top link 22. The front end sides of the left and right lower links 21, 21 are connected to the left and right side surfaces of the rear part of the mission case 17 via lower link pins 25, 25 so as to be rotatable. A front end side of the top link 22 is connected to a top link hitch 26 at the rear of the working machine lifting mechanism 20 via a top link pin. Further, a PTO shaft 23 for transmitting a PTO driving force to the rotary tiller 24 is provided on the rear side surface of the mission case 17 so as to protrude rearward.

油圧式の前記作業機用昇降機構20は、単動形の昇降制御油圧シリンダ28(後述する図3参照)と、該昇降制御油圧シリンダ28により回動される一対の左右リフトアーム29、29とを備えており、該リフトアーム29の近傍にリフトアーム29の回動角度を検出するポテンショメータ型のリフト角センサ29aを設けてある。進行方向に向かって左側の前記リフトアーム29と前記ロワーリンク21とは、左リフトロッド30を介して連結されている。進行方向に向かって右側の前記リフトアーム29と前記ロワーリンク21とは、右リフトロッド31、及び該右リフトロッド31の一部を形成する複動形の傾斜制御油圧シリンダ32、及び該傾斜制御油圧シリンダ32のピストンロッド33とを介して連結されている。   The hydraulic lifting mechanism 20 for work implement includes a single-acting lift control hydraulic cylinder 28 (see FIG. 3 described later), and a pair of left and right lift arms 29 and 29 rotated by the lift control hydraulic cylinder 28. A potentiometer type lift angle sensor 29 a for detecting the rotation angle of the lift arm 29 is provided in the vicinity of the lift arm 29. The lift arm 29 on the left side in the traveling direction and the lower link 21 are connected via a left lift rod 30. The lift arm 29 and the lower link 21 on the right side in the traveling direction include a right lift rod 31, a double-acting tilt control hydraulic cylinder 32 that forms a part of the right lift rod 31, and the tilt control. It is connected via a piston rod 33 of the hydraulic cylinder 32.

前記トップリンク22及び前記ロワーリンク21、21の後側に、前記ロータリ耕耘機24を配置してある。前記ロータリ耕耘機24は、前記ロワーリンク21、21に連結される下リンクフレーム35と、前記トップリンクに連結される上リンクフレーム34とを備え、前記下リンクフレーム35の下側に耕耘爪40を有するロータリ部41を配置してあり、該ロータリ部41にPTO入力軸46aが連結してある。   The rotary cultivator 24 is disposed behind the top link 22 and the lower links 21, 21. The rotary tiller 24 includes a lower link frame 35 connected to the lower links 21, 21 and an upper link frame 34 connected to the top link. A rotary part 41 having a PTO input shaft 46 a is connected to the rotary part 41.

前記ロワーリンク21の後端部と、前記下リンクフレーム35の前端部とが、下ヒッチピン35aを介して連結されており、前記トップリンク22の後端部と、前記上リンクフレーム34の前端部とが、上ヒッチピン34aを介して連結されている。前記PTO入力軸46aと前記PTO軸23とは、両端に自在継手が備えられた伸縮自在な伝動軸46bを介して連結されている。前記PTO軸23から出力された動力は、前記PTO入力軸46a及び伝動軸46bを介して前記ロータリ部41に伝達され、前記耕耘爪40を反時計方向に回転させる。   A rear end portion of the lower link 21 and a front end portion of the lower link frame 35 are connected via a lower hitch pin 35a, and a rear end portion of the top link 22 and a front end portion of the upper link frame 34 are connected. Are connected via an upper hitch pin 34a. The PTO input shaft 46a and the PTO shaft 23 are connected via a telescopic transmission shaft 46b having universal joints at both ends. The power output from the PTO shaft 23 is transmitted to the rotary portion 41 via the PTO input shaft 46a and the transmission shaft 46b, and rotates the tillage claw 40 counterclockwise.

図3は作業車両の作業機系油圧回路図である。作業機系油圧回路100は、エンジン5の回転力により作動する作業機用油圧ポンプ101を備える。該作業機用油圧ポンプ101は、分流弁105を介して、前記傾斜制御油圧シリンダ32に作動油を供給制御するための傾斜制御電磁弁104に接続してある。また前記作業機用油圧ポンプ101は、前記分流弁105を介して、前記昇降制御油圧シリンダ28に作動油を供給制御するための上昇制御電磁弁102及び下降制御電磁弁103に接続してある。
前記傾斜制御電磁弁104を開閉し、前記ピストンロッド33を上下させて、前記ロータリ耕耘機24を傾斜させ、また前記上昇制御電磁弁102及び下降制御電磁弁103を開閉し、前記リフトアーム29、29及びロワーリンク21、21を上下させて、前記ロータリ耕耘機24を上昇させるか又は下降させるようにしてある。
FIG. 3 is a work machine system hydraulic circuit diagram of the work vehicle. The work machine system hydraulic circuit 100 includes a work machine hydraulic pump 101 that is operated by the rotational force of the engine 5. The work machine hydraulic pump 101 is connected to a tilt control electromagnetic valve 104 for controlling supply of hydraulic oil to the tilt control hydraulic cylinder 32 via a diversion valve 105. Further, the working machine hydraulic pump 101 is connected to an ascending control solenoid valve 102 and a descending control solenoid valve 103 for controlling supply of hydraulic oil to the elevation control hydraulic cylinder 28 via the diversion valve 105.
The tilt control electromagnetic valve 104 is opened and closed, the piston rod 33 is moved up and down to tilt the rotary tiller 24, and the lift control solenoid valve 102 and the lower control solenoid valve 103 are opened and closed, and the lift arm 29, 29 and the lower links 21 and 21 are moved up and down to raise or lower the rotary tiller 24.

図4は作業機設定ボックスの略示拡大図である。操縦座席8の右側にコラム60が設けてあり、該コラム60上にロータリ耕耘機24の設定を行うための複数のスイッチを有する作業機設定ボックス61を配置してある(図2参照)。該作業機設定ボックス61には、前記ロータリ耕耘機24の姿勢制御として、平行モードと、水平モードと、該平行モード及び水平モードの切替を自動で行う自動モードとを選択するための姿勢制御選択スイッチ61a、並びに前記水平モードで前記ロータリ耕耘機24の姿勢制御を行っている場合に、前記ロータリ耕耘機24の目標とする対地ローリング角度を調整するローリング角度調整ダイヤル61bを設けてある。   FIG. 4 is a schematic enlarged view of the work machine setting box. A column 60 is provided on the right side of the control seat 8, and a work machine setting box 61 having a plurality of switches for setting the rotary tiller 24 is disposed on the column 60 (see FIG. 2). In the work machine setting box 61, as the attitude control of the rotary tiller 24, attitude control selection for selecting a parallel mode, a horizontal mode, and an automatic mode for automatically switching between the parallel mode and the horizontal mode. A switch 61a and a rolling angle adjustment dial 61b for adjusting a target ground rolling angle of the rotary tiller 24 when the posture control of the rotary tiller 24 is performed in the horizontal mode are provided.

次に作業車両の姿勢制御処理について説明する。作業車両の姿勢制御処理とは、前記姿勢制御選択スイッチ61aにより、自動モードを選択した場合に行うロータリ耕耘機24の姿勢を制御する処理をいう。図5はUFO制御装置付近の要部構成を示すブロック図である。   Next, the attitude control process of the work vehicle will be described. The work vehicle attitude control process refers to a process of controlling the attitude of the rotary tiller 24 performed when the automatic mode is selected by the attitude control selection switch 61a. FIG. 5 is a block diagram showing a main part configuration in the vicinity of the UFO control device.

前記走行機体1にロータリ耕耘機24の姿勢を制御するUFO制御装置70を設けてある。該UFO制御装置70は、ロータリ耕耘機24の姿勢制御プログラムと、走行機体1の車速に対応しており、平行モード及び水平モードの切替の基準となる閾値とを記憶してあるROM、前記姿勢制御プログラムに基づいてロータリ耕耘機24の姿勢制御を行うCPU、種々の情報を一時的に記憶するRAM等(いずれも図示せず)を備えている。前記UFO制御装置70には、前記車速センサ17a、ローリング角センサ120、ローリングジャイロセンサ121、ピッチング角センサ130、ピッチングジャイロセンサ131、リフト角センサ29a、前記ロータリ耕耘機24の前記走行機体1に対するローリング角度を検出するポテンショメータ型の作業機ポジションセンサ71、前記傾斜制御油圧シリンダ32の長さを検出する磁歪式のシリンダセンサ32a、作業機設定ボックス61、及びクランク角センサ5aを接続してあり、また前記上昇制御電磁弁102、下降制御電磁弁103及び傾斜制御電磁弁104を接続してある。   The traveling machine body 1 is provided with a UFO control device 70 that controls the attitude of the rotary tiller 24. The UFO control device 70 corresponds to the attitude control program of the rotary tiller 24, the ROM corresponding to the vehicle speed of the traveling machine body 1, and stores a threshold value serving as a reference for switching between the parallel mode and the horizontal mode. A CPU for controlling the attitude of the rotary tiller 24 based on the control program, a RAM for temporarily storing various information, etc. (none of which are shown) are provided. The UFO control device 70 includes the vehicle speed sensor 17a, the rolling angle sensor 120, the rolling gyro sensor 121, the pitching angle sensor 130, the pitching gyro sensor 131, the lift angle sensor 29a, and the rolling of the rotary tiller 24 with respect to the traveling machine body 1. A potentiometer type work machine position sensor 71 for detecting an angle, a magnetostrictive cylinder sensor 32a for detecting the length of the tilt control hydraulic cylinder 32, a work machine setting box 61, and a crank angle sensor 5a are connected. The ascending control solenoid valve 102, the descending control solenoid valve 103, and the tilt control solenoid valve 104 are connected.

図6は作業車両の姿勢制御処理を示すフローチャート、図7は平行モード及び水平モードの切替と閾値との関係を説明する説明図である。
UFO制御装置70は、前記姿勢制御選択スイッチ61aにより、自動モードが選択されていることを示す信号が入力されているか否か判断する(ステップS1)。自動モードが選択されていることを示す信号が入力されていないときは(ステップS1:NO)、水平モード又は平行モードが選択されており、水平モード及び平行モードの自動切替を行わないので姿勢制御処理を終了する。自動モードが選択されていることを示す信号が入力されているときは(ステップS1:YES)、ローリングジャイロセンサ121からローリング角速度ωを示す検出値が入力されているか否か判断する(ステップS2)。ローリング角速度ωを示す検出値が入力されていないときは(ステップS2:NO)、ロータリ耕耘機24の姿勢は大きく変化しておらず、ステップS2に戻る。ローリング角速度ωを示す検出値が入力されているときは(ステップS2:YES)、ロータリ耕耘機24の姿勢は大きく変化し、ロータリ耕耘機24の姿勢を制御する必要があると考えられるので、車速センサ17aから車速vを示す検出値を取得する(ステップS3)。
FIG. 6 is a flowchart showing the work vehicle attitude control process, and FIG. 7 is an explanatory diagram for explaining the relationship between the switching between the parallel mode and the horizontal mode and the threshold value.
The UFO control device 70 determines whether or not a signal indicating that the automatic mode is selected is input by the attitude control selection switch 61a (step S1). When the signal indicating that the automatic mode is selected is not input (step S1: NO), the horizontal mode or the parallel mode is selected, and automatic switching between the horizontal mode and the parallel mode is not performed, so that attitude control is performed. The process ends. When a signal indicating that the automatic mode is selected is input (step S1: YES), it is determined whether or not a detection value indicating the rolling angular velocity ω is input from the rolling gyro sensor 121 (step S2). . When the detection value indicating the rolling angular velocity ω is not input (step S2: NO), the attitude of the rotary tiller 24 is not significantly changed, and the process returns to step S2. When the detection value indicating the rolling angular speed ω is input (step S2: YES), the attitude of the rotary tiller 24 changes greatly, and it is considered necessary to control the attitude of the rotary tiller 24. A detection value indicating the vehicle speed v is acquired from the sensor 17a (step S3).

次にUFO制御装置70は、車速vに対応する閾値f(v)をROMから取得する(ステップS4)。車速vが大きくなるにつれてローリング角速度ωが大きくなるため、車速vが小さいときにはローリング角速度ωが小さくても平行モードから水平モードに切り替わるように、閾値f(v)は車速vの減少に従って小さくなるように設定してある。そしてローリング角速度ωを示す検出値が閾値f(v)以上であるか否か判断する(ステップS5)。ローリング角速度ωを示す検出値が閾値f(v)以上であるときは(ステップS5:YES)、前記ロータリ耕耘機24は、高低差の大きい凹凸がある枕地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、図7に示す如く、水平モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS6)。
ローリング角速度ωを示す検出値が閾値f(v)未満であるときは(ステップS5:NO)、前記ロータリ耕耘機24は、高低差の大きい凹凸がない隣接地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、図7に示す如く、平行モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS7)。
Next, the UFO control device 70 acquires a threshold value f (v) corresponding to the vehicle speed v from the ROM (step S4). Since the rolling angular velocity ω increases as the vehicle speed v increases, the threshold value f (v) decreases as the vehicle speed v decreases so that when the vehicle speed v is low, the parallel mode is switched to the horizontal mode even if the rolling angular velocity ω is small. It is set to. Then, it is determined whether or not the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f (v) (step S5). When the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f (v) (step S5: YES), the rotary cultivator 24 considers that it is plowing on a headland having unevenness with a large height difference. Therefore, as shown in FIG. 7, the UFO control device 70 controls the posture of the rotary tiller 24 in the horizontal mode (step S6).
When the detected value indicating the rolling angular velocity ω is less than the threshold value f (v) (step S5: NO), it is considered that the rotary cultivator 24 is plowing in an adjacent land where there is no unevenness with a large height difference. Therefore, as shown in FIG. 7, the UFO control device 70 controls the attitude of the rotary tiller 24 in the parallel mode (step S7).

次に水平モードについて詳述する。図8は水平モードでのロータリ耕耘機24の姿勢制御を示すフローチャートである。
UFO制御装置70は、まず前記作業機ポジションセンサ71から、前記ロータリ耕耘機24の前記走行機体1に対するローリング角度を示す検出値を取得する(ステップS61)。次にローリング角センサ120から、走行機体1のローリング角度を示す検出値を取得する(ステップS62)。そして前記ローリング角度調整ダイヤル61bから、目標とする対地ローリング角度を示す値を取得する(ステップS63)。次にUFO制御装置70は、前記ロータリ耕耘機24の前記走行機体1に対するローリング角度を示す検出値、走行機体1のローリング角度を示す検出値、及び目標とする前記ロータリ耕耘機24の対地ローリング角度を示す値に基づいて、目標とする前記傾斜制御油圧シリンダ32の長さXp を算出する(ステップS64)。そして前記シリンダセンサ32aから傾斜制御油圧シリンダ32の現在の長さXn を取得する(ステップS65)。
Next, the horizontal mode will be described in detail. FIG. 8 is a flowchart showing the attitude control of the rotary tiller 24 in the horizontal mode.
The UFO control device 70 first acquires a detection value indicating a rolling angle of the rotary tiller 24 with respect to the traveling machine body 1 from the work machine position sensor 71 (step S61). Next, a detection value indicating the rolling angle of the traveling machine body 1 is acquired from the rolling angle sensor 120 (step S62). And the value which shows the target earth rolling angle is acquired from the said rolling angle adjustment dial 61b (step S63). Next, the UFO control device 70 detects the rolling angle of the rotary tiller 24 with respect to the traveling machine body 1, the detected value indicating the rolling angle of the traveling machine body 1, and the target rolling angle of the rotary tiller 24 with respect to the ground. based on the value indicating the calculated length X p of the slope control hydraulic cylinder 32 to the target (step S64). Then, the current length Xn of the tilt control hydraulic cylinder 32 is acquired from the cylinder sensor 32a (step S65).

次にUFO制御装置70は偏差Xd =Xp ―Xn を算出する(ステップS66)。そして偏差Xd が零であるか否か判断する(ステップS67)。偏差Xd が零であるときには、前記ロータリ耕耘機24は所望の姿勢になっており(ステップS67:YES)、水平モードでの姿勢制御を終了する。偏差Xd が零でないときには(ステップS67:NO)、前記ロータリ耕耘機24は所望の姿勢になっておらず、UFO制御装置70は傾斜制御油圧シリンダ32を駆動させる方向を偏差Xd に基づいて算出する(ステップS68)。また傾斜制御油圧シリンダ32の駆動量を偏差Xd に基づいて算出する(ステップS69)。そして前記傾斜制御電磁弁104に、傾斜制御油圧シリンダ32を算出方向に算出駆動量分移動させる信号を出力する(ステップS70)。そしてステップS61に戻る。 Next, the UFO controller 70 determines the deviation X d = X p -X n is calculated (step S66). Then, it is determined whether or not the deviation Xd is zero (step S67). When the deviation Xd is zero, the rotary tiller 24 is in a desired posture (step S67: YES), and the posture control in the horizontal mode is finished. When the deviation Xd is not zero (step S67: NO), the rotary tiller 24 is not in a desired posture, and the UFO controller 70 determines the direction in which the tilt control hydraulic cylinder 32 is driven based on the deviation Xd. Calculate (step S68). Further, the drive amount of the tilt control hydraulic cylinder 32 is calculated based on the deviation Xd (step S69). Then, a signal for moving the tilt control hydraulic cylinder 32 in the calculation direction by the calculated drive amount is output to the tilt control electromagnetic valve 104 (step S70). Then, the process returns to step S61.

次に平行モードについて詳述する。図9は平行モードでのロータリ耕耘機24の姿勢制御を示すフローチャートである。
UFO制御装置70は、ローリングジャイロセンサ121から入力されたローリング角速度ωの検出値に基づいて、走行機体1が左右方向に傾斜した方向を算出し、前記ロータリ耕耘機24を走行機体1に対し平行にするための傾斜制御油圧シリンダ32の駆動方向を算出する(ステップS71)。次にローリング角速度ωの検出値に基づいて、走行機体1が左右方向に傾斜した角度を算出し、前記ロータリ耕耘機24を走行機体1に対し平行にするための傾斜制御油圧シリンダ32の駆動量を算出する(ステップS72)。そして前記傾斜制御電磁弁104に、傾斜制御油圧シリンダ32を算出方向に算出駆動量分移動させる信号を出力する(ステップS73)。
Next, the parallel mode will be described in detail. FIG. 9 is a flowchart showing the attitude control of the rotary tiller 24 in the parallel mode.
The UFO control device 70 calculates the direction in which the traveling machine body 1 is inclined in the left-right direction based on the detected value of the rolling angular velocity ω input from the rolling gyro sensor 121, and the rotary tiller 24 is parallel to the traveling machine body 1. The drive direction of the tilt control hydraulic cylinder 32 for the purpose is calculated (step S71). Next, based on the detected value of the rolling angular velocity ω, the angle at which the traveling machine body 1 tilts in the left-right direction is calculated, and the drive amount of the tilt control hydraulic cylinder 32 for making the rotary tiller 24 parallel to the traveling machine body 1. Is calculated (step S72). Then, a signal for moving the tilt control hydraulic cylinder 32 in the calculation direction by the calculated drive amount is output to the tilt control electromagnetic valve 104 (step S73).

実施の形態1に係る作業車両にあっては、車速センサ17aと、該車速センサ17aにより検出された車速vに対応する閾値f(v)を設定するUFO制御装置70とを設けることにより、前記ローリングジャイロセンサ121により検出されたローリング角速度ωを前記閾値f(v)と比較し、該比較結果に基づいて、操作者の操作によることなく、前記平行モード又は水平モードで前記ロータリ耕耘機24の姿勢を制御し、また前記走行機体1が低速で移動している場合であって、枕地で作業が行われているときに、前記平行モードから水平モードに切替えて、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the first embodiment, the vehicle speed sensor 17a and the UFO control device 70 that sets the threshold value f (v) corresponding to the vehicle speed v detected by the vehicle speed sensor 17a are provided. The rolling angular velocity ω detected by the rolling gyro sensor 121 is compared with the threshold value f (v), and based on the comparison result, the rotary cultivator 24 is operated in the parallel mode or the horizontal mode without being operated by the operator. When the posture is controlled and the traveling machine body 1 is moving at a low speed and the work is being performed on the headland, the parallel mode is switched to the horizontal mode, and the soil is smooth and has no unevenness. Can be plowed.

なお前記車速センサ17a、ローリング角センサ120,ローリングジャイロセンサ121及びシリンダセンサ32aを設けずに、前記UFO制御装置70により走行機体1の車速、ローリング角度、ローリング角速度、及び前記長さXn を算出する構成にしても良い。またローリング角速度、ローリング角度、及びダイヤル設定値を、ローリングジャイロセンサ121、ローリング角センサ120、及びローリング角度調整ダイヤル61bの温度特性の影響を除去するために平均処理してもよい。また車速vに反比例するように閾値f(v)を設定し、ローリング角速度ωが閾値f(v)未満であるときに平行モードから水平モードに切替わるように構成しても良い。 The vehicle speed, the rolling angle, the rolling angular velocity, and the length Xn of the traveling machine body 1 are calculated by the UFO control device 70 without providing the vehicle speed sensor 17a, the rolling angle sensor 120, the rolling gyro sensor 121, and the cylinder sensor 32a. You may make it the structure to carry out. Further, the rolling angular velocity, the rolling angle, and the dial set value may be averaged to remove the influence of the temperature characteristics of the rolling gyro sensor 121, the rolling angle sensor 120, and the rolling angle adjustment dial 61b. Further, the threshold value f (v) may be set so as to be inversely proportional to the vehicle speed v, and the parallel mode may be switched to the horizontal mode when the rolling angular velocity ω is less than the threshold value f (v).

(実施の形態2)
以下本発明を実施の形態2を示す図面に基づいて詳述する。図10は実施の形態2に係る作業車両の姿勢制御処理を示すフローチャート、図11は平行モード及び水平モードの切替と閾値との関係を説明する説明図である。
ステップS11乃至ステップS14では、前記ステップS1乃至ステップS4と同様の処理を行っており、その詳細な説明は省略し、ステップS15から説明する。ステップS14にて、車速vに対応する閾値f(v)をROMから取得したUFO制御装置70は、前記クランク角センサ5aからエンジン5の回転数を示す検出値を取得する(ステップS15)。次にエンジン5の回転数を示す検出値に基づいて、閾値f(v)を変更し、閾値f1 (v)を算出する(ステップS16)。そしてローリング角速度ωを示す検出値が閾値f1 (v)以上であるか否か判断する(ステップS17、図11参照)。ローリング角速度ωを示す検出値が閾値f1 (v)以上であるときは(ステップS17:YES)、前記ロータリ耕耘機24は、高低差の大きい凹凸がある枕地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、水平モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS18)。
ローリング角速度ωを示す検出値が閾値f1 (v)未満であるときは(ステップS17:NO)、前記ロータリ耕耘機24は、高低差の大きい凹凸がない隣接地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、平行モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS19)。
(Embodiment 2)
Hereinafter, the present invention will be described in detail with reference to the drawings showing a second embodiment. FIG. 10 is a flowchart showing the attitude control process of the work vehicle according to the second embodiment, and FIG. 11 is an explanatory diagram for explaining the relationship between the switching between the parallel mode and the horizontal mode and the threshold value.
In steps S11 to S14, the same processing as in steps S1 to S4 is performed, and detailed description thereof will be omitted, and description will be made from step S15. In step S14, the UFO control device 70 that has acquired the threshold value f (v) corresponding to the vehicle speed v from the ROM acquires a detection value indicating the rotational speed of the engine 5 from the crank angle sensor 5a (step S15). Next, based on the detected value indicating the rotational speed of the engine 5, the threshold value f (v) is changed to calculate the threshold value f 1 (v) (step S16). Then, it is determined whether or not the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 1 (v) (see step S17, FIG. 11). When the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 1 (v) (step S17: YES), the rotary cultivator 24 performs the tilling work on the headland having unevenness with a large height difference. The UFO control device 70 controls the attitude of the rotary tiller 24 in the horizontal mode (step S18).
When the detected value indicating the rolling angular velocity ω is less than the threshold value f 1 (v) (step S17: NO), the rotary cultivator 24 performs the tilling work on the adjacent land where there is no large unevenness in height difference. Since it is considered, the UFO control device 70 controls the attitude of the rotary tiller 24 in the parallel mode (step S19).

ここでエンジン回転数に基づく閾値f(v)の調整の必要性について説明する。前記エンジン5の回転振動、特に低回転での振動が前記走行機体1に伝播し、ローリングジャイロセンサ121が閾値f(v)に近い値を計測したときに、平行モード及び水平モードの切替が行われる。そのため計測した値と前記閾値f(v)との比較結果に対し、振動による誤差が波及しないように、エンジン回転数が低回転になるにつれて、例えば閾値f(v)を大きくして閾値f1 (v)にする必要がある(図11参照)。 Here, the necessity of adjusting the threshold value f (v) based on the engine speed will be described. When the rotational vibration of the engine 5, particularly vibration at low rotation propagates to the traveling machine body 1 and the rolling gyro sensor 121 measures a value close to the threshold value f (v), the parallel mode and the horizontal mode are switched. Is called. Therefore, for example, as the engine speed decreases, the threshold value f (v) is increased to reduce the threshold value f 1 so that an error due to vibration does not affect the comparison result between the measured value and the threshold value f (v). It is necessary to make (v) (see FIG. 11).

実施の形態2に係る作業車両にあっては、エンジン5の回転数を計測するクランク角センサ5aと、該クランク角センサ5aにより計測された回転数に応じて前記閾値f(v)を調整するUFO制御装置70とを設けることにより、前記エンジン5の振動が前記走行機体1に伝播して、ローリング角速度ωを検出するローリングジャイロセンサ121が前記閾値f(v)に近い値をローリング角速度ωとして計測したときに、前記平行モードと前記水平モードとの切替えが行われるので、検出した値と閾値との比較結果に振動による誤差が波及しないように、閾値f(v)を調整して閾値f1 (v)にし、前記平行モードと前記水平モードとの不要な切替えを防止して、なだらかでムラのない土壌の耕耘を行うことができる。 In the work vehicle according to the second embodiment, the crank angle sensor 5a that measures the rotation speed of the engine 5 and the threshold value f (v) is adjusted according to the rotation speed measured by the crank angle sensor 5a. By providing the UFO control device 70, the vibration of the engine 5 propagates to the traveling machine body 1, and the rolling gyro sensor 121 that detects the rolling angular velocity ω sets a value close to the threshold value f (v) as the rolling angular velocity ω. Since switching between the parallel mode and the horizontal mode is performed when measurement is performed, the threshold value f (v) is adjusted to prevent the error due to vibration from affecting the comparison result between the detected value and the threshold value. 1 (v), unnecessary switching between the parallel mode and the horizontal mode can be prevented, and the soil can be cultivated gently and evenly.

なおクランク角センサ5aを設けずに、前記UFO制御装置70によりエンジン回転数を算出する構成にしても良い。   The engine speed may be calculated by the UFO control device 70 without providing the crank angle sensor 5a.

実施の形態2に係る作業車両の構成の内、実施の形態1と同様な構成については、同じ符号を付しその詳細な説明を省略する。   Of the configuration of the work vehicle according to the second embodiment, the same reference numerals are given to the same configurations as those in the first embodiment, and the detailed description thereof is omitted.

(実施の形態3)
以下本発明を実施の形態3を示す図面に基づいて詳述する。図12は実施の形態3に係る作業車両の姿勢制御処理を示すフローチャート、図13は平行モード及び水平モードの切替と閾値との関係を説明する説明図である。
(Embodiment 3)
Hereinafter, the present invention will be described in detail with reference to the drawings showing a third embodiment. FIG. 12 is a flowchart showing the attitude control process of the work vehicle according to the third embodiment, and FIG. 13 is an explanatory diagram for explaining the relationship between the switching between the parallel mode and the horizontal mode and the threshold value.

ステップS21乃至ステップS24では、前記ステップS1乃至ステップS4と同様の処理を行っており、その詳細な説明は省略し、ステップS25から説明する。ステップS24にて、車速vに対応する閾値f(v)をROMから取得したUFO制御装置70は、前記リフト角センサ29aからリフトアーム29の回動角度を示す検出値を取得し、取得した回動角度を示す検出値に基づいて前記ロータリ耕耘機24の昇降距離を算出する(ステップS25)。昇降距離が大きくなるにつれて、高低差の大きな凹凸がある枕地で作業をしている確率が高くなるので、昇降距離が大きい場合にはローリング角速度ωが小さくても平行モードから水平モードに切り替わるように、UFO制御装置70は、例えば昇降距離が大きくなるにつれて閾値f(v)を小さくして、閾値f2 (v)を算出する(ステップS26)。次にローリング角速度ωを示す検出値が閾値f2 (v)以上であるか否か判断する(ステップS27、図13参照)。ローリング角速度ωを示す検出値が閾値f2 (v)以上であるときは(ステップS27:YES)、前記ロータリ耕耘機24は、高低差の大きい凹凸がある枕地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、水平モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS28)。
ローリング角速度ωを示す検出値が閾値f2 (v)未満であるときは(ステップS27:NO)、前記ロータリ耕耘機24は、高低差の大きい凹凸がない隣接地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、平行モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS29)。
In steps S21 to S24, the same processing as in steps S1 to S4 is performed, and detailed description thereof will be omitted, and description will be made from step S25. In step S24, the UFO control device 70 that has acquired the threshold value f (v) corresponding to the vehicle speed v from the ROM acquires a detection value indicating the rotation angle of the lift arm 29 from the lift angle sensor 29a, and acquires the detected value. The lift distance of the rotary tiller 24 is calculated based on the detected value indicating the moving angle (step S25). As the lift distance increases, the probability of working on a headland with large unevenness in height difference increases. Therefore, when the lift distance is large, the parallel mode is switched to the horizontal mode even if the rolling angular velocity ω is small. In addition, the UFO control device 70 calculates the threshold value f 2 (v) by decreasing the threshold value f (v), for example, as the ascending / descending distance increases (step S26). Next, it is determined whether or not the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 2 (v) (see step S27, FIG. 13). When the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 2 (v) (step S27: YES), the rotary cultivator 24 is plowing on a headland having unevenness with a large height difference. The UFO control device 70 controls the attitude of the rotary tiller 24 in the horizontal mode (step S28).
When the detected value indicating the rolling angular velocity ω is less than the threshold value f 2 (v) (step S27: NO), the rotary cultivator 24 is plowing in an adjacent land where there is no unevenness with a large height difference. Since it is considered, the UFO control device 70 controls the attitude of the rotary tiller 24 in the parallel mode (step S29).

実施の形態3に係る作業車両にあっては、前記ロータリ耕耘機24の昇降を制御し、昇降した前記ロータリ耕耘機24の昇降距離を算出し、算出された昇降距離に応じて、前記閾値f(v)を調整するUFO制御装置70を設けることにより、前記昇降距離が大きくなるにつれて高低差の大きい凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値f(v)を前記昇降距離に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the third embodiment, the raising and lowering of the rotary tiller 24 is controlled, the raising and lowering distance of the rotary tiller 24 that has been raised and lowered is calculated, and the threshold f is determined according to the calculated raising and lowering distance. By providing the UFO control device 70 for adjusting (v), it is considered that the probability of working on a headland with unevenness with a large difference in height increases as the ascending / descending distance increases, so the threshold f (v ) Is adjusted according to the ascending / descending distance, and switching between the parallel mode and the horizontal mode is performed instantaneously, so that the soil can be cultivated gently and evenly.

なお前記リフト角センサ29aを設けずに、前記UFO制御装置70によりリフトアーム29の回動角度を算出する構成にしても良い。   In addition, you may make it the structure which calculates the rotation angle of the lift arm 29 by the said UFO control apparatus 70, without providing the said lift angle sensor 29a.

実施の形態3に係る作業車両の構成の内、実施の形態1又は2と同様な構成については、同じ符号を付しその詳細な説明を省略する。   Of the configurations of the work vehicle according to the third embodiment, configurations similar to those of the first or second embodiment are denoted by the same reference numerals, and detailed description thereof is omitted.

(実施の形態4)
以下本発明を実施の形態4を示す図面に基づいて詳述する。図14は実施の形態4に係る作業車両の姿勢制御処理を示すフローチャートである。
ステップS31乃至ステップS34では、前記ステップS1乃至ステップS4と同様の処理を行っており、その詳細な説明は省略し、ステップS35から説明する。ステップS34にて、車速vに対応する閾値f(v)をROMから取得したUFO制御装置70は、前記リフト角センサ29aからリフトアーム29の回動角度を示す検出値を時系列的に複数記憶し、記憶した複数の回動角度を示す検出値に基づいて前記ロータリ耕耘機24の所定時間あたりの昇降回数(以下、昇降頻度という。)を算出する(ステップS35)。前記昇降頻度が大きくなるにつれて、多数の凹凸がある枕地で作業をしている確率が高くなるので、昇降頻度が大きい場合にはローリング角速度ωが小さくても平行モードから水平モードに切り替わるように、UFO制御装置70は、例えば昇降頻度が大きくなるにつれて閾値f(v)を小さくして、閾値f3 (v)を算出する(ステップS36)。そしてローリング角速度ωを示す検出値が閾値f3 (v)以上であるか否か判断する(ステップS37、図13にてf2 (v)をf3 (v)に読み替えて参照)。ローリング角速度ωを示す検出値が閾値f3 (v)以上であるときは(ステップS37:YES)、前記ロータリ耕耘機24は、多数の凹凸がある枕地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、水平モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS38)。
ローリング角速度ωを示す検出値が閾値f3 (v)未満であるときは(ステップS37:NO)、前記ロータリ耕耘機24は、多数の凹凸がない隣接地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、平行モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS39)。
(Embodiment 4)
Hereinafter, the present invention will be described in detail with reference to the drawings showing a fourth embodiment. FIG. 14 is a flowchart showing the attitude control process of the work vehicle according to the fourth embodiment.
In steps S31 to S34, the same processing as in steps S1 to S4 is performed, and detailed description thereof will be omitted, and description will be made from step S35. In step S34, the UFO control device 70 that has acquired the threshold value f (v) corresponding to the vehicle speed v from the ROM stores a plurality of detection values indicating the rotation angle of the lift arm 29 from the lift angle sensor 29a in time series. Then, based on the detected values indicating the plurality of rotation angles stored, the number of times the rotary tiller 24 moves up and down (hereinafter referred to as the lifting frequency) is calculated (step S35). As the raising / lowering frequency increases, the probability of working on a headland with a large number of irregularities increases, so that when the raising / lowering frequency is large, the mode is switched from the parallel mode to the horizontal mode even if the rolling angular velocity ω is small. The UFO control device 70 calculates the threshold value f 3 (v) by decreasing the threshold value f (v), for example, as the ascending / descending frequency increases (step S36). Then, it is determined whether or not the detection value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 3 (v) (refer to step S37, replacing f 2 (v) with f 3 (v) in FIG. 13). When the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 3 (v) (step S37: YES), the rotary cultivator 24 is considered to perform the tilling work on the headland having a large number of irregularities. Therefore, the UFO control device 70 controls the attitude of the rotary tiller 24 in the horizontal mode (step S38).
When the detected value indicating the rolling angular velocity ω is less than the threshold value f 3 (v) (step S37: NO), it is considered that the rotary tiller 24 is plowing on an adjacent land without many irregularities. Therefore, the UFO control device 70 controls the attitude of the rotary tiller 24 in the parallel mode (step S39).

実施の形態4に係る作業車両にあっては、前記ロータリ耕耘機24の昇降を制御し、前記ロータリ耕耘機24の昇降頻度を算出し、算出した昇降頻度に応じて、前記閾値f(v)を調整するUFO制御装置70を設けることにより、前記昇降回数の増加に従って、多数の凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値f(v)を前記昇降回数に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the fourth embodiment, the raising and lowering of the rotary tiller 24 is controlled, the raising and lowering frequency of the rotary tiller 24 is calculated, and the threshold value f (v) is determined according to the calculated raising and lowering frequency. By providing the UFO control device 70 that adjusts the number of times of raising / lowering, it is considered that the probability of working on a headland with a large number of unevenness increases as the number of times of raising / lowering increases. In accordance with the above, it is possible to instantaneously switch between the parallel mode and the horizontal mode, so that the soil can be cultivated gently and evenly.

実施の形態4に係る作業車両の構成の内、実施の形態1乃至3と同様な構成については、同じ符号を付しその詳細な説明を省略する。   Among the configurations of the work vehicle according to the fourth embodiment, configurations similar to those of the first to third embodiments are denoted by the same reference numerals, and detailed description thereof is omitted.

(実施の形態5)
以下本発明を実施の形態5を示す図面に基づいて詳述する。図15は実施の形態5に係る作業車両の姿勢制御処理を示すフローチャートである。
ステップS41乃至ステップS44では、前記ステップS1乃至ステップS4と同様の処理を行っており、その詳細な説明は省略し、ステップS45から説明する。ステップS44にて、車速vに対応する閾値f(v)をROMから取得したUFO制御装置70は、前記リフト角センサ29aからリフトアーム29の回動角度を示す検出値を時系列的に複数記憶し、記憶した複数の回動角度を示す検出値に基づいて前記ロータリ耕耘機24の昇降位置の偏差を算出する(ステップS45)。昇降位置の偏差が大きくなるにつれて、高低差の大きな凹凸がある枕地で作業をしている確率が高くなるので、昇降位置の偏差が大きい場合にはローリング角速度ωが小さくても平行モードから水平モードに切り替わるように、UFO制御装置70は、例えば昇降位置の偏差が大きくなるにつれて閾値f(v)を小さくする補正をし、閾値f4 (v)を算出する(ステップS46)。そしてローリング角速度ωを示す検出値が閾値f4 (v)以上であるか否か判断する(ステップS47、図13にてf2 (v)をf4 (v)に読み替えて参照)。ローリング角速度ωを示す検出値が閾値f4 (v)以上であるときは(ステップS47:YES)、前記ロータリ耕耘機24は、高低差の大きな凹凸がある枕地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、水平モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS48)。
ローリング角速度ωを示す検出値が閾値f4 (v)未満であるときは(ステップS47:NO)、前記ロータリ耕耘機24は、高低差の大きな凹凸がない隣接地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、平行モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS49)。
(Embodiment 5)
Hereinafter, the present invention will be described in detail with reference to the drawings showing a fifth embodiment. FIG. 15 is a flowchart showing the attitude control process of the work vehicle according to the fifth embodiment.
In steps S41 to S44, the same processing as in steps S1 to S4 is performed, and detailed description thereof will be omitted, and description will be made from step S45. In step S44, the UFO control device 70 having acquired the threshold value f (v) corresponding to the vehicle speed v from the ROM stores a plurality of detection values indicating the rotation angle of the lift arm 29 from the lift angle sensor 29a in time series. And the deviation of the raising / lowering position of the rotary cultivator 24 is calculated based on the stored detection values indicating the plurality of rotation angles (step S45). As the elevation position deviation increases, the probability of working on a headland with large unevenness in elevation is increased. Therefore, if the elevation position deviation is large, the horizontal mode is not changed even if the rolling angular velocity ω is small. In order to switch to the mode, the UFO control device 70 performs correction to reduce the threshold value f (v), for example, as the elevation position deviation increases, and calculates the threshold value f 4 (v) (step S46). Then, it is determined whether or not the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 4 (v) (refer to step S47, replacing f 2 (v) with f 4 (v) in FIG. 13). When the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 4 (v) (step S47: YES), the rotary cultivator 24 is plowing on a headland with large unevenness in height difference. The UFO control device 70 controls the attitude of the rotary tiller 24 in the horizontal mode (step S48).
When the detected value indicating the rolling angular velocity ω is less than the threshold value f 4 (v) (step S47: NO), the rotary cultivator 24 is plowing in an adjacent land where there is no large unevenness in height difference. The UFO control device 70 controls the attitude of the rotary tiller 24 in the parallel mode (step S49).

実施の形態5に係る作業車両にあっては、前記ロータリ耕耘機24の昇降を制御し、昇降した前記ロータリ耕耘機24の昇降位置を時系列的に複数記憶し、記憶してある複数の昇降位置の偏差を算出し、算出された偏差に応じて、前記閾値f(v)を調整するUFO制御装置70を設けることにより、前記偏差が大きくなるにつれて、高低差の大きい凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値f(v)を前記偏差に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the fifth embodiment, the raising and lowering of the rotary tiller 24 is controlled, and a plurality of raising and lowering positions of the raised and lowered rotary tiller 24 are stored in time series, and the plurality of stored raising and lowering positions are stored. By providing the UFO control device 70 that calculates the position deviation and adjusts the threshold value f (v) according to the calculated deviation, as the deviation increases, the height of the height difference in the uneven headland Since it is considered that the probability of working is increased, the threshold value f (v) is adjusted according to the deviation, and the switching between the parallel mode and the horizontal mode is performed instantaneously. Can be cultivated.

実施の形態5に係る作業車両の構成の内、実施の形態1乃至4と同様な構成については、同じ符号を付しその詳細な説明を省略する。   Of the configuration of the work vehicle according to the fifth embodiment, configurations similar to those of the first to fourth embodiments are denoted by the same reference numerals, and detailed description thereof is omitted.

(実施の形態6)
以下本発明を実施の形態6を示す図面に基づいて詳述する。図16は実施の形態6に係る作業車両の姿勢制御処理を示すフローチャートである。
ステップS51乃至ステップS54では、前記ステップS1乃至ステップS4と同様の処理を行っており、その詳細な説明は省略し、ステップS55から説明する。ステップS54にて、車速vに対応する閾値f(v)をROMから取得したUFO制御装置70は、前記ピッチングジャイロセンサ131からピッチング角速度を示す検出値を取得する(ステップS55)。ピッチング角速度が大きくなるにつれて、高低差の大きな凹凸がある枕地で作業をしている確率が高くなるので、ピッチング角速度が大きい場合にはローリング角速度ωが小さくても平行モードから水平モードに切り替わるように、UFO制御装置70は、例えばピッチング角速度が大きくなるにつれて閾値f(v)を小さくして、閾値f5 (v)を算出する(ステップS56)。そしてローリング角速度ωを示す検出値が閾値f5 (v)以上であるか否か判断する(ステップS57、図13にてf2 (v)をf5 (v)に読み替えて参照)。ローリング角速度ωを示す検出値が閾値f5 (v)以上であるときは(ステップS57:YES)、前記ロータリ耕耘機24は、高低差の大きな凹凸がある枕地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、水平モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS58)。
ローリング角速度ωを示す検出値が閾値f5 (v)未満であるときは(ステップS57:NO)、前記ロータリ耕耘機24は、高低差の大きな凹凸がない隣接地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、平行モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS59)。
(Embodiment 6)
Hereinafter, the present invention will be described in detail with reference to the drawings showing a sixth embodiment. FIG. 16 is a flowchart showing the attitude control process of the work vehicle according to the sixth embodiment.
In steps S51 to S54, processing similar to that in steps S1 to S4 is performed, and detailed description thereof will be omitted, and description will be made from step S55. In step S54, the UFO control device 70 having acquired the threshold value f (v) corresponding to the vehicle speed v from the ROM acquires a detection value indicating the pitching angular velocity from the pitching gyro sensor 131 (step S55). As the pitching angular velocity increases, the probability of working on a headland with large unevenness in height difference increases. Therefore, when the pitching angular velocity is large, the mode switches from the parallel mode to the horizontal mode even if the rolling angular velocity ω is small. In addition, the UFO control device 70 decreases the threshold f (v), for example, as the pitching angular velocity increases, and calculates the threshold f 5 (v) (step S56). Then, it is determined whether or not the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 5 (v) (refer to step S57, replacing f 2 (v) with f 5 (v) in FIG. 13). When the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 5 (v) (step S57: YES), the rotary cultivator 24 is plowing on a headland with large unevenness in height difference. The UFO control device 70 controls the attitude of the rotary tiller 24 in the horizontal mode (step S58).
When the detected value indicating the rolling angular velocity ω is less than the threshold value f 5 (v) (step S57: NO), the rotary cultivator 24 is plowing in an adjacent land where there is no large unevenness in height difference. The UFO control device 70 controls the attitude of the rotary tiller 24 in the parallel mode (step S59).

実施の形態6に係る作業車両にあっては、前記走行機体1のピッチング角速度を検出するピッチングジャイロセンサ131と、該ピッチングジャイロセンサ131により検出されたピッチング角速度に応じて、前記閾値f(v)を調整するUFO制御装置70とを設けることにより、ピッチング角速度が大きくなるにつれて、高低差の大きい凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値f(v)を前記ピッチング角速度に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the sixth embodiment, the pitching gyro sensor 131 that detects the pitching angular velocity of the traveling body 1 and the threshold value f (v) according to the pitching angular velocity detected by the pitching gyro sensor 131. By providing the UFO control device 70 for adjusting the pitch, it is considered that as the pitching angular velocity increases, the probability of working on the headland with unevenness with a large height difference increases, so the threshold value f (v) is set. By adjusting according to the pitching angular velocity, the switching between the parallel mode and the horizontal mode can be performed instantaneously, and the soil can be cultivated gently and evenly.

なおピッチングジャイロセンサ131を設けずに、前記UFO制御装置70によりピッチング角速度を算出する構成にしても良い。   The pitching angular velocity may be calculated by the UFO control device 70 without providing the pitching gyro sensor 131.

実施の形態6に係る作業車両の構成の内、実施の形態1乃至5と同様な構成については、同じ符号を付しその詳細な説明を省略する。   Of the configuration of the work vehicle according to the sixth embodiment, configurations similar to those of the first to fifth embodiments are denoted by the same reference numerals, and detailed description thereof is omitted.

(実施の形態7)
以下本発明を実施の形態7を示す図面に基づいて詳述する。図17は実施の形態7に係る作業車両の姿勢制御処理を示すフローチャートである。
ステップS81乃至ステップS84では、前記ステップS1乃至ステップS4と同様の処理を行っており、その詳細な説明は省略し、ステップS85から説明する。ステップS84にて、車速vに対応する閾値f(v)をROMから取得したUFO制御装置70は、前記ピッチング角センサ130からピッチング角度を示す検出値を時系列的に複数記憶し、記憶してある複数のピッチング角度の所定時間あたりの変化量を算出する。(ステップS85)。前記変化量が大きくなるにつれて、高低差の大きな凹凸がある枕地で作業をしている確率が高くなるので、前記変化量が大きい場合にはローリング角速度ωが小さくても平行モードから水平モードに切り替わるように、UFO制御装置70は、例えば前記変化量が大きくなるにつれて閾値f(v)を小さくして、閾値f6 (v)を算出する(ステップS86)。そしてローリング角速度ωを示す検出値が閾値f6 (v)以上であるか否か判断する(ステップS87、図13にてf2 (v)をf6 (v)に読み替えて参照)。ローリング角速度ωを示す検出値が閾値f6 (v)以上であるときは(ステップS87:YES)、前記ロータリ耕耘機24は、高低差の大きな凹凸がある枕地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、水平モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS88)。
ローリング角速度ωを示す検出値が閾値f6 (v)未満であるときは(ステップS87:NO)、前記ロータリ耕耘機24は、高低差の大きな凹凸がない隣接地で耕耘作業を行っていると考えられるので、前記UFO制御装置70は、平行モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS89)。
(Embodiment 7)
Hereinafter, the present invention will be described in detail with reference to the drawings showing a seventh embodiment. FIG. 17 is a flowchart showing the attitude control process of the work vehicle according to the seventh embodiment.
In steps S81 to S84, the same processing as in steps S1 to S4 is performed, and detailed description thereof will be omitted, and description will be made from step S85. In step S84, the UFO control device 70 that has acquired the threshold value f (v) corresponding to the vehicle speed v from the ROM stores a plurality of detection values indicating the pitching angle from the pitching angle sensor 130 in time series, and stores them. A change amount per predetermined time of a plurality of pitching angles is calculated. (Step S85). As the amount of change increases, the probability of working on a headland with large unevenness in height difference increases. Therefore, when the amount of change is large, the parallel mode is changed to the horizontal mode even if the rolling angular velocity ω is small. For example, the UFO controller 70 calculates the threshold value f 6 (v) by decreasing the threshold value f (v) as the amount of change increases, for example (step S86). Then, it is determined whether or not the detected value indicating the rolling angular velocity ω is equal to or greater than a threshold value f 6 (v) (refer to step S87, replacing f 2 (v) with f 6 (v) in FIG. 13). When the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 6 (v) (step S87: YES), the rotary cultivator 24 performs the tilling work on the headland having large unevenness in height difference. The UFO control device 70 controls the attitude of the rotary tiller 24 in the horizontal mode (step S88).
When the detected value indicating the rolling angular velocity ω is less than the threshold value f 6 (v) (step S87: NO), the rotary cultivator 24 is plowing in an adjacent land where there is no large unevenness in height difference. The UFO control device 70 controls the attitude of the rotary tiller 24 in the parallel mode (step S89).

実施の形態7に係る作業車両にあっては、前記ピッチング角度を検出するピッチング角センサ130と、該ピッチング角センサ130により検出された複数の傾斜角度を時系列的に記憶し、記憶してある複数の傾斜角度から所定時間あたりの変化量を算出し、算出された偏差に応じて前記閾値f(v)を調整するUFO制御装置70を設けることにより、前記変化量が大きくなるにつれて、高低差の大きい凹凸のある枕地で作業を行っている確率が高くなると考えられるので、前記閾値f(v)を前記変化量に応じて調整し、前記平行モードと前記水平モードとの切替えを瞬時に行い、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the seventh embodiment, the pitching angle sensor 130 that detects the pitching angle and a plurality of inclination angles detected by the pitching angle sensor 130 are stored in time series. By providing the UFO control device 70 that calculates a change amount per predetermined time from a plurality of inclination angles and adjusts the threshold value f (v) according to the calculated deviation, the difference in height increases as the change amount increases. Therefore, the threshold f (v) is adjusted according to the amount of change, and the switching between the parallel mode and the horizontal mode is instantaneously performed. It is possible to cultivate soil that is gentle and smooth.

なお前記ピッチング角センサ130を設けずに、前記UFO制御装置70によりピッチング角度を算出する構成にしても良い。   The pitching angle may be calculated by the UFO control device 70 without providing the pitching angle sensor 130.

実施の形態7に係る作業車両の構成の内、実施の形態1乃至6と同様な構成については、同じ符号を付しその詳細な説明を省略する。   Of the configuration of the work vehicle according to the seventh embodiment, configurations similar to those of the first to sixth embodiments are denoted by the same reference numerals, and detailed description thereof is omitted.

(実施の形態8)
以下本発明を実施の形態8を示す図面に基づいて詳述する。図18は実施の形態8に係る作業車両の姿勢制御処理を示すフローチャート、図19は平行モード及び水平モードの切替と閾値との関係を説明する説明図である。
なお前記UFO制御装置70のROMには、平行モード及び水平モードの切替の基準となる閾値に関し、平行モード、水平モード、及び車速vに対応するヒステリシスb(m、v)を記憶してあり、平行モードに対応するヒステリシスはb(1、v)と表記し、水平モードに対応するヒステリシスはb(2、v)と表記する。
(Embodiment 8)
Hereinafter, the present invention will be described in detail with reference to the drawings showing the eighth embodiment. FIG. 18 is a flowchart illustrating the attitude control process of the work vehicle according to the eighth embodiment, and FIG. 19 is an explanatory diagram illustrating the relationship between the switching between the parallel mode and the horizontal mode and the threshold value.
The ROM of the UFO control device 70 stores hysteresis b (m, v) corresponding to the parallel mode, the horizontal mode, and the vehicle speed v with respect to a threshold value serving as a reference for switching between the parallel mode and the horizontal mode. The hysteresis corresponding to the parallel mode is expressed as b (1, v), and the hysteresis corresponding to the horizontal mode is expressed as b (2, v).

ステップS91乃至ステップS94では、前記ステップS1乃至ステップS4と同様の処理を行っており、その詳細な説明は省略し、ステップS95から説明する。ステップS94にて車速vに対応する閾値f(v)をROMから取得したUFO制御装置70は、RAMを参照してロータリ耕耘機24の姿勢を制御しているモードの情報を取得し、平行モードでロータリ耕耘機24の姿勢を制御しているか否か判断する(ステップS95)。平行モードでロータリ耕耘機24の姿勢を制御しているときは(ステップS95:YES)、平行モード及び車速vに対応するヒステリシスb(1、v)をROMから取得する(ステップS96)。次にUFO制御装置70は、閾値f(v)にヒステリシスb(1、v)を加算して、閾値f7 (v)を算出する(ステップS97)。そしてローリング角速度ωを示す検出値が閾値f7 (v)以上であるか否か判断する(ステップS98)。ローリング角速度ωを示す検出値が閾値f7 (v)以上であるときは(ステップS98:YES)、前記ロータリ耕耘機24は、高低差の大きな凹凸がある枕地で耕耘作業を行っていると考えられるので、図19に示す如く、前記UFO制御装置70は、水平モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS99)。
ローリング角速度ωを示す検出値が閾値f7 (v)未満であるときは(ステップS98:NO)、前記ロータリ耕耘機24は、高低差の大きな凹凸がない隣接地で耕耘作業を行っていると考えられるので、図19に示す如く、前記UFO制御装置70は、平行モードで前記ロータリ耕耘機24の姿勢を制御する(ステップS100)。
In steps S91 to S94, the same processing as in steps S1 to S4 is performed, and detailed description thereof will be omitted, and description will be made from step S95. The UFO control device 70 that has acquired the threshold value f (v) corresponding to the vehicle speed v from the ROM in step S94 acquires information on the mode in which the attitude of the rotary tiller 24 is controlled with reference to the RAM, and the parallel mode. Whether or not the attitude of the rotary tiller 24 is controlled is determined (step S95). When the attitude of the rotary tiller 24 is controlled in the parallel mode (step S95: YES), the hysteresis b (1, v) corresponding to the parallel mode and the vehicle speed v is acquired from the ROM (step S96). Next, the UFO control device 70 adds the hysteresis b (1, v) to the threshold f (v) to calculate the threshold f 7 (v) (step S97). Then, it is determined whether or not the detected value indicating the rolling angular velocity ω is greater than or equal to a threshold value f 7 (v) (step S98). When the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f 7 (v) (step S98: YES), the rotary cultivator 24 is plowing on the headland with large unevenness in height difference. Therefore, as shown in FIG. 19, the UFO control device 70 controls the attitude of the rotary tiller 24 in the horizontal mode (step S99).
When the detected value indicating the rolling angular velocity ω is less than the threshold value f 7 (v) (step S98: NO), the rotary cultivator 24 is plowing in an adjacent land where there is no large unevenness in height difference. Therefore, as shown in FIG. 19, the UFO control device 70 controls the attitude of the rotary tiller 24 in the parallel mode (step S100).

水平モードでロータリ耕耘機24の姿勢制御を行っているときには(ステップS95:NO)、ヒステリシスb(2、v)をROMから取得する(ステップS101)。そして閾値f(v)に取得したヒステリシスb(2、v)を加算して、閾値f′7 (v)を算出する(ステップS102)。次にローリング角速度ωを示す検出値が閾値f′7 (v)未満である否か判断する(ステップS103)。ローリング角速度ωを示す検出値が閾値f′7 (v)未満であるときには(ステップS103:YES)、図19に示す如く、平行モードでロータリ耕耘機24の姿勢制御を行う(ステップS100)。ローリング角速度ωを示す検出値が閾値f′7 (v)以上であるときには(ステップS103:NO)、図19に示す如く、水平モードでロータリ耕耘機24の姿勢制御を行う(ステップS99)。 When posture control of the rotary tiller 24 is performed in the horizontal mode (step S95: NO), the hysteresis b (2, v) is acquired from the ROM (step S101). Then, the acquired hysteresis b (2, v) is added to the threshold f (v) to calculate the threshold f ' 7 (v) (step S102). Next, it is determined whether or not the detected value indicating the rolling angular velocity ω is less than the threshold value f ′ 7 (v) (step S103). When the detected value indicating the rolling angular velocity ω is less than the threshold value f ′ 7 (v) (step S103: YES), the posture control of the rotary tiller 24 is performed in the parallel mode as shown in FIG. 19 (step S100). When the detected value indicating the rolling angular velocity ω is equal to or greater than the threshold value f ′ 7 (v) (step S103: NO), the posture control of the rotary tiller 24 is performed in the horizontal mode as shown in FIG. 19 (step S99).

実施の形態8に係る作業車両にあっては、前記閾値f(v)にヒステリシスb(m、v)を設定するUFO制御装置70を設けることにより、走行機体1の振動が前記走行機体1のローリングジャイロセンサ121に伝播して、該ローリングジャイロセンサ121が前記走行機体1のローリング角速度を検出したときに、前記平行モードと前記水平モードとの切替えが行われるので、計測した値と前記閾値f(v)との比較結果に振動による誤差が波及しないように前記閾値f(v)にヒステリシスb(m、v)を設け、前記平行モードと前記水平モードとの不要な切替えを防止して、なだらかでムラのない土壌の耕耘を行うことができる。   In the work vehicle according to the eighth embodiment, by providing the UFO control device 70 that sets the hysteresis b (m, v) to the threshold f (v), the vibration of the traveling machine body 1 causes the vibration of the traveling machine body 1. When propagating to the rolling gyro sensor 121 and the rolling gyro sensor 121 detects the rolling angular velocity of the traveling machine body 1, switching between the parallel mode and the horizontal mode is performed, so the measured value and the threshold value f Hysteresis b (m, v) is provided in the threshold value f (v) so that an error due to vibration does not affect the comparison result with (v), and unnecessary switching between the parallel mode and the horizontal mode is prevented, The soil can be cultivated gently and evenly.

なおヒステリシスb(m、v)は、エンジン回転数、前記昇降距離、前記昇降頻度、ピッチング角速度、前記変化量その他の物理量に応じて、その幅を変更しても良い。   The width of the hysteresis b (m, v) may be changed according to the engine speed, the lift distance, the lift frequency, the pitching angular velocity, the change amount, and other physical quantities.

実施の形態8に係る作業車両の構成の内、実施の形態1乃至7と同様な構成については、同じ符号を付しその詳細な説明を省略する。   Of the configurations of the work vehicle according to the eighth embodiment, configurations similar to those of the first to seventh embodiments are denoted by the same reference numerals, and detailed description thereof is omitted.

実施の形態1に係る作業車両の略示側面図である。1 is a schematic side view of a work vehicle according to a first embodiment. 実施の形態1に係る作業車両のキャビンの屋根を省略した略示平面図である。FIG. 3 is a schematic plan view in which the roof of the cabin of the work vehicle according to Embodiment 1 is omitted. 実施の形態1に係る作業車両の作業機系油圧回路図である。1 is a working machine hydraulic circuit diagram of a work vehicle according to a first embodiment. 実施の形態1に係る作業車両の作業機設定ボックスの略示拡大図である。3 is a schematic enlarged view of a work implement setting box for a work vehicle according to Embodiment 1. FIG. 実施の形態1に係る作業車両のUFO制御装置付近の要部構成を示すブロック図である。FIG. 3 is a block diagram showing a configuration of a main part near a UFO control device for a work vehicle according to Embodiment 1. 実施の形態1に係る作業車両の姿勢制御処理を示すフローチャートである。4 is a flowchart showing a posture control process of the work vehicle according to the first embodiment. 実施の形態1に係る作業車両の平行モード及び水平モードの切替と閾値との関係を説明する説明図である。It is explanatory drawing explaining the relationship between the switching of the parallel mode of the work vehicle which concerns on Embodiment 1, and horizontal mode, and a threshold value. 実施の形態1に係る作業車両の水平モードでのロータリ耕耘機の姿勢制御を示すフローチャートである。3 is a flowchart showing attitude control of the rotary tiller in the horizontal mode of the work vehicle according to the first embodiment. 実施の形態1に係る作業車両の平行モードでのロータリ耕耘機の姿勢制御を示すフローチャートである。4 is a flowchart showing attitude control of the rotary tiller in the parallel mode of the work vehicle according to the first embodiment. 実施の形態2に係る作業車両の姿勢制御処理を示すフローチャートである。5 is a flowchart showing a work vehicle attitude control process according to Embodiment 2; 実施の形態2に係る作業車両の平行モード及び水平モードの切替と閾値との関係を説明する説明図である。It is explanatory drawing explaining the relationship between the switching of the parallel mode of the work vehicle which concerns on Embodiment 2, and horizontal mode, and a threshold value. 実施の形態3に係る作業車両の姿勢制御処理を示すフローチャートである。10 is a flowchart showing a posture control process for a work vehicle according to a third embodiment. 実施の形態3に係る作業車両の平行モード及び水平モードの切替と閾値との関係を説明する説明図である。It is explanatory drawing explaining the relationship between the switching of the parallel mode of the work vehicle which concerns on Embodiment 3, and horizontal mode, and a threshold value. 実施の形態4に係る作業車両の姿勢制御処理を示すフローチャートである。6 is a flowchart showing a posture control process of a work vehicle according to a fourth embodiment. 実施の形態5に係る作業車両の姿勢制御処理を示すフローチャートである。12 is a flowchart showing a posture control process for a work vehicle according to a fifth embodiment. 実施の形態6に係る作業車両の姿勢制御処理を示すフローチャートである。14 is a flowchart showing a posture control process for a work vehicle according to a sixth embodiment. 実施の形態7に係る作業車両の姿勢制御処理を示すフローチャートである。18 is a flowchart illustrating a posture control process for a work vehicle according to a seventh embodiment. 実施の形態8に係る作業車両の姿勢制御処理を示すフローチャートである。19 is a flowchart showing a work vehicle attitude control process according to the eighth embodiment. 実施の形態8に係る作業車両の平行モード及び水平モードの切替と閾値との関係を説明する説明図である。FIG. 20 is an explanatory diagram for explaining a relationship between switching between a parallel mode and a horizontal mode of a work vehicle according to an eighth embodiment and a threshold value.

符号の説明Explanation of symbols

1 走行機体
5a クランク角センサ
17a 車速センサ(速度計測手段)
24 ロータリ耕耘機(作業機)
29a リフト角センサ
32a シリンダセンサ
61 作業機設定ボックス
61b ローリング角度調整ダイヤル
70 UFO制御装置
71 作業機ポジションセンサ
102 上昇制御電磁弁
103 下降制御電磁弁
104 傾斜制御電磁弁
120 ローリング角センサ
121 ローリングジャイロセンサ
130 ピッチング角センサ
131 ピッチングジャイロセンサ
DESCRIPTION OF SYMBOLS 1 Traveling machine body 5a Crank angle sensor 17a Vehicle speed sensor (speed measurement means)
24 Rotary tiller (work machine)
29a Lift angle sensor 32a Cylinder sensor 61 Work implement setting box 61b Rolling angle adjustment dial 70 UFO control device 71 Work implement position sensor 102 Lift control solenoid valve 103 Lower control solenoid valve 104 Tilt control solenoid valve 120 Rolling angle sensor 121 Rolling gyro sensor 130 Pitching angle sensor 131 Pitching gyro sensor

Claims (8)

走行速度を求める手段を有する走行機体と、該走行機体に連結された作業機を、各別の姿勢に制御する複数の姿勢制御手段と、前記走行機体の左右方向の傾斜角速度を求める手段と、該手段により求めた傾斜角速度を所定の閾値と比較する手段と、該手段の比較結果に基づいて、いずれかの姿勢制御手段を作動させる手段とを備える作業車両において、
走行速度を求める前記手段により求めた走行速度に応じて、前記閾値を設定する手段を備えることを特徴とする作業車両。
A traveling machine body having means for obtaining a traveling speed, a plurality of posture control means for controlling the work machines connected to the traveling machine body to different postures, and a means for obtaining a lateral angular velocity of the traveling machine body; In a work vehicle comprising: means for comparing the tilt angular velocity obtained by the means with a predetermined threshold; and means for operating one of the attitude control means based on a comparison result of the means.
A work vehicle comprising: means for setting the threshold value in accordance with a traveling speed obtained by the means for obtaining a traveling speed.
前記走行機体に搭載してある駆動源の回転数を求める手段と、
該手段により求めた回転数に応じて、前記閾値を調整する手段とを備えることを特徴とする請求項1に記載の作業車両。
Means for determining the rotational speed of a drive source mounted on the traveling machine body;
The work vehicle according to claim 1, further comprising means for adjusting the threshold value in accordance with the number of revolutions obtained by the means.
前記作業機を昇降させる手段と、
該手段により昇降した前記作業機の昇降距離を求める手段と、
該手段により求めた昇降距離に応じて、前記閾値を調整する手段とを備えることを特徴とする請求項1に記載の作業車両。
Means for raising and lowering the working machine;
Means for obtaining a lifting distance of the working machine lifted and lowered by the means;
The work vehicle according to claim 1, further comprising a unit that adjusts the threshold value according to a lifting distance obtained by the unit.
前記作業機を昇降させる手段と、
該手段により昇降した前記作業機の昇降回数を求める手段と、
該手段により求めた昇降回数に基づいて、所定時間あたりの昇降回数を算出する手段と、
該手段により算出された所定時間あたりの昇降回数に応じて、前記閾値を調整する手段とを備えることを特徴とする請求項1に記載の作業車両。
Means for raising and lowering the working machine;
Means for determining the number of times of lifting and lowering of the working machine raised and lowered by the means;
Means for calculating the number of elevations per predetermined time based on the number of elevations obtained by the means;
The work vehicle according to claim 1, further comprising means for adjusting the threshold according to the number of times of raising / lowering per predetermined time calculated by the means.
前記作業機を昇降させる手段と、
該手段により昇降した前記作業機の昇降位置を時系列的に複数求める手段と、
該手段により求めた前記作業機の複数の昇降位置に基づいて、昇降位置の偏差を算出する手段と、
該手段により算出された偏差に応じて、前記閾値を調整する手段とを備えることを特徴とする請求項1に記載の作業車両。
Means for raising and lowering the working machine;
Means for obtaining a plurality of ascending / descending positions of the work implement that has been raised and lowered by the means in time series;
Means for calculating a deviation of the lift position based on a plurality of lift positions of the working machine determined by the means;
The work vehicle according to claim 1, further comprising means for adjusting the threshold value in accordance with the deviation calculated by the means.
前記走行機体の前後方向の傾斜角速度を求める手段と、
該手段により求めた傾斜角速度に応じて、前記閾値を調整する手段とを備えることを特徴とする請求項1に記載の作業車両。
Means for obtaining a tilt angular velocity in the front-rear direction of the traveling machine body;
The work vehicle according to claim 1, further comprising a unit that adjusts the threshold value according to an inclination angular velocity obtained by the unit.
前記走行機体の前後方向の傾斜角度を時系列的に複数求める手段と、
該手段により求めた複数の前記傾斜角度に基づいて、所定時間あたりの前記傾斜角度の変化量を算出する手段と、
該手段により算出された前記変化量に応じて、前記閾値を調整する手段とを備えることを特徴とする請求項1に記載の作業車両。
Means for obtaining a plurality of time-sequential inclination angles in the front-rear direction of the traveling machine body;
Means for calculating a change amount of the tilt angle per predetermined time based on the plurality of tilt angles obtained by the means;
2. The work vehicle according to claim 1, further comprising means for adjusting the threshold according to the amount of change calculated by the means.
前記閾値にヒステリシスを設定する手段を備えることを特徴とする請求項1乃至7のいずれか一つに記載の作業車両。


The work vehicle according to any one of claims 1 to 7, further comprising means for setting a hysteresis in the threshold value.


JP2007330810A 2007-12-21 2007-12-21 Work vehicle Expired - Fee Related JP5138354B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2007330810A JP5138354B2 (en) 2007-12-21 2007-12-21 Work vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2007330810A JP5138354B2 (en) 2007-12-21 2007-12-21 Work vehicle

Publications (2)

Publication Number Publication Date
JP2009148229A true JP2009148229A (en) 2009-07-09
JP5138354B2 JP5138354B2 (en) 2013-02-06

Family

ID=40918176

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2007330810A Expired - Fee Related JP5138354B2 (en) 2007-12-21 2007-12-21 Work vehicle

Country Status (1)

Country Link
JP (1) JP5138354B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4223091A1 (en) * 2022-02-02 2023-08-09 Deere & Company Raising and lowering of implement for farming machine technical field
RU2803461C1 (en) * 2023-02-20 2023-09-13 Федеральное государственное бюджетное образовательное учреждение высшего образования "Национальный исследовательский Мордовский государственный университет им. Н.П. Огарёва" Adaptive tillage cutter

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0670616A (en) * 1992-08-26 1994-03-15 Kubota Corp Paddy field working machine
JP2001095339A (en) * 1999-09-29 2001-04-10 Kubota Corp Controller for lifting and lowering of working vehicle
JP2001218503A (en) * 2000-02-09 2001-08-14 Iseki & Co Ltd Device for controlling depth of plowing of tractor
JP2005021139A (en) * 2003-07-04 2005-01-27 Ishikawajima Shibaura Mach Co Ltd Agricultural work vehicle
JP2007325574A (en) * 2006-06-09 2007-12-20 Ihi Shibaura Machinery Corp Working implement lift control system for working vehicle

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0670616A (en) * 1992-08-26 1994-03-15 Kubota Corp Paddy field working machine
JP2001095339A (en) * 1999-09-29 2001-04-10 Kubota Corp Controller for lifting and lowering of working vehicle
JP2001218503A (en) * 2000-02-09 2001-08-14 Iseki & Co Ltd Device for controlling depth of plowing of tractor
JP2005021139A (en) * 2003-07-04 2005-01-27 Ishikawajima Shibaura Mach Co Ltd Agricultural work vehicle
JP2007325574A (en) * 2006-06-09 2007-12-20 Ihi Shibaura Machinery Corp Working implement lift control system for working vehicle

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4223091A1 (en) * 2022-02-02 2023-08-09 Deere & Company Raising and lowering of implement for farming machine technical field
RU2803461C1 (en) * 2023-02-20 2023-09-13 Федеральное государственное бюджетное образовательное учреждение высшего образования "Национальный исследовательский Мордовский государственный университет им. Н.П. Огарёва" Adaptive tillage cutter

Also Published As

Publication number Publication date
JP5138354B2 (en) 2013-02-06

Similar Documents

Publication Publication Date Title
EP3646689B1 (en) Working vehicle
JP4179935B2 (en) Signal discrimination method for display device
JP5138354B2 (en) Work vehicle
JP2007129918A (en) Plowing depth-regulating device
JP2712445B2 (en) Working depth control device for tractor working machine
JP4587392B2 (en) Tillage control device
JP2007124905A (en) Position control apparatus
JP4863349B2 (en) Lift control device
JP2006340619A (en) Tilling control system for farming implement
JP4733422B2 (en) Attitude control device for work equipment
JP3880538B2 (en) Farm machine control device
JP2712444B2 (en) Tillage depth control device for tractor tilling equipment
JP4589175B2 (en) Rotary tillage device
JP4753287B2 (en) Agricultural machinery
JP3838111B2 (en) Paddy field machine
JP4863348B2 (en) Plowing depth control device
JP5096050B2 (en) Agricultural work vehicle
JP5524753B2 (en) Work vehicle
JP5561070B2 (en) Control device for tractor work machine
JP2006340621A (en) Tilling control system for farming implement
JP3916555B2 (en) Agricultural machine rolling control device
JP2007020491A (en) Farm working machine
JP4693521B2 (en) Agricultural machinery
JP2001218503A (en) Device for controlling depth of plowing of tractor
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: 20100702

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20120131

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20120214

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120416

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

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

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20151122

Year of fee payment: 3

LAPS Cancellation because of no payment of annual fees