JP7321428B2 - work vehicle - Google Patents
work vehicle Download PDFInfo
- Publication number
- JP7321428B2 JP7321428B2 JP2021172172A JP2021172172A JP7321428B2 JP 7321428 B2 JP7321428 B2 JP 7321428B2 JP 2021172172 A JP2021172172 A JP 2021172172A JP 2021172172 A JP2021172172 A JP 2021172172A JP 7321428 B2 JP7321428 B2 JP 7321428B2
- Authority
- JP
- Japan
- Prior art keywords
- turning
- steering angle
- steering wheel
- steering
- control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000012937 correction Methods 0.000 claims description 42
- 230000007935 neutral effect Effects 0.000 claims description 31
- 238000001514 detection method Methods 0.000 claims description 23
- 230000035558 fertility Effects 0.000 claims description 17
- 230000004720 fertilization Effects 0.000 claims description 11
- 241000196324 Embryophyta Species 0.000 claims description 9
- 230000006870 function Effects 0.000 claims description 9
- 239000003337 fertilizer Substances 0.000 claims description 8
- 239000002689 soil Substances 0.000 claims description 7
- 239000003550 marker Substances 0.000 description 22
- 230000005540 biological transmission Effects 0.000 description 20
- 238000000034 method Methods 0.000 description 20
- 241000209094 Oryza Species 0.000 description 13
- 235000007164 Oryza sativa Nutrition 0.000 description 13
- 235000009566 rice Nutrition 0.000 description 13
- 230000002093 peripheral effect Effects 0.000 description 12
- 230000008569 process Effects 0.000 description 12
- 230000007246 mechanism Effects 0.000 description 9
- 238000010899 nucleation Methods 0.000 description 8
- 230000001105 regulatory effect Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 6
- 230000008859 change Effects 0.000 description 5
- 230000003028 elevating effect Effects 0.000 description 5
- 238000012545 processing Methods 0.000 description 5
- 238000005070 sampling Methods 0.000 description 5
- 230000033228 biological regulation Effects 0.000 description 4
- 230000002706 hydrostatic effect Effects 0.000 description 4
- 238000003384 imaging method Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 230000003247 decreasing effect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000001965 increasing effect Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 241001655903 Phortica omega Species 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Landscapes
- Guiding Agricultural Machines (AREA)
- Non-Deflectable Wheels, Steering Of Trailers, Or Other Steering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Description
本発明は、田植機、トラクターなどの農業用の作業車両に関するものである。 TECHNICAL FIELD The present invention relates to agricultural working vehicles such as rice transplanters and tractors.
従来、圃場において、ステアリングホイールを自動的に駆動(自動操舵)して、圃場上を自動走行する作業車両(以下、単に「車両」ともいう。)が知られている。 2. Description of the Related Art Conventionally, a work vehicle (hereinafter also simply referred to as a "vehicle") that automatically drives (automatically steers) a steering wheel in a field to automatically travel on the field is known.
たとえば、特許文献1には、圃場上を直進走行しながら農作業を行う際に、GNSS(Global Navigation Satellite System)受信機により取得した車両の位置情報を用いて、車両が走行経路に沿うように、制御部(制御装置200)の制御のもとにステアリングホイールを自動的に駆動することにより、車両を真っ直ぐに走行させるのを補助することが可能な作業車両(田植機)が開示されている。 For example, in Patent Document 1, when performing agricultural work while traveling straight on a field, using the position information of the vehicle acquired by a GNSS (Global Navigation Satellite System) receiver, so that the vehicle follows the traveling route, A work vehicle (rice transplanter) is disclosed that can assist the vehicle to run straight by automatically driving the steering wheel under the control of a control unit (control device 200).
特許文献1に記載された作業車両においては、圃場上を旋回する際においても、制御部の制御によりステアリングホイールを自動的に駆動することができる。 In the work vehicle described in Patent Literature 1, the steering wheel can be automatically driven by the control of the control unit even when turning on a field.
具体的には、特許文献1の図4に示されるように、旋回する際に、ステアリングホイールを自動的に所定の角度まで切りながら走行することで車両の向きを目標方位角度θ1とした後に、ステアリングホイールを中立位置(直進する位置)まで自動的に切り戻しつつ所定の距離だけ直進する。その後に、ステアリングホイールを再び所定の角度まで切りながら機体の向きが目標方位角度θ2となるまで走行し、最後にステアリングホイールを中立位置まで自動的に切り戻すことにより、作業車両が次に直進走行しつつ、苗を植え付ける行程の位置へ旋回することができる。以下、作業車両が直進走行しつつ、苗を植え付ける各行程を「植付行程」という。 Specifically, as shown in FIG. 4 of Patent Document 1, when the vehicle turns, the steering wheel is automatically turned to a predetermined angle while the vehicle travels so that the direction of the vehicle is set to the target azimuth angle θ1. The steering wheel is automatically turned back to the neutral position (position to go straight) and the vehicle goes straight for a predetermined distance. After that, while turning the steering wheel again to a predetermined angle, the machine travels until the direction of the aircraft reaches the target azimuth angle θ2. While doing so, it can be turned to the position of the process of planting seedlings. Hereinafter, each process of planting seedlings while the work vehicle is running straight is referred to as a "planting process".
このように、GNSS受信機により取得される位置情報と走行経路の情報によらずに、ステアリングホイールの操舵角度と走行距離に基づき、次の植付行程の位置へ旋回できるから、旋回時にカクカクした動きにならず、スムーズかつ安定した挙動で旋回することができる。以下、ステアリングホイールを自動的に駆動して作業車両を直進走行させる制御を「直進制御」といい、ステアリングホイールを自動的に駆動して作業車両を旋回させる制御を「旋回制御」という。 In this way, it is possible to turn to the position of the next planting stroke based on the steering angle of the steering wheel and the traveling distance without depending on the position information and the traveling route information acquired by the GNSS receiver, so it was jerky when turning. It can turn with smooth and stable behavior without moving. Hereinafter, control for automatically driving the steering wheel to drive the work vehicle straight ahead will be referred to as "straight control", and control for automatically driving the steering wheel to turn the work vehicle will be referred to as "turning control".
しかしながら、作業車両が旋回する際に、圃場の状態によっては走行車輪のスリップ量が多く、駆動力が弱まり、前方へほとんど移動せずに、その場で旋回してしまう(換言すれば、その場で過度に小回りに旋回してしまう)ことがあり、旋回制御により、旋回後に作業車両が本来位置すべき位置、すなわち、次の植付行程の位置に安定的に車両を運べないという問題があった。 However, when the work vehicle turns, depending on the condition of the field, the running wheels slip a lot, the driving force weakens, and the work vehicle turns on the spot without moving forward (in other words, on the spot). There is a problem that the work vehicle cannot be stably transported to the position where the work vehicle should originally be after turning, that is, the position for the next planting process due to the turning control. rice field.
したがって、本発明は、旋回制御によって次の植付行程の位置へ安定的に旋回することができる作業車両を提供することを目的とするものである。 SUMMARY OF THE INVENTION Accordingly, an object of the present invention is to provide a working vehicle that can be stably turned to the position of the next planting stroke by turning control.
本発明のかかる目的は、
走行車体と、
前記走行車体に取り付けられ、農作業を行う作業機と、
前記走行車体の位置情報を取得する位置情報取得手段と、
前記走行車体のヨー方向の角速度を検出するヨー方向角速度検出手段とを備えた作業車両であって、
前記走行車体は、走行車輪と、前記走行車輪を操舵するステアリングホイールと、前記ステアリングホイールを回動させるモータと、前記モータを駆動して作業車両を旋回させる旋回制御を行う制御手段とを有し、
前記制御手段は、旋回制御による旋回を開始する際に、標準的な条件の圃場で旋回目標位置に旋回可能な所定の舵角まで前記ステアリングホイールを回動させた後に、前記所定の舵角から目標舵角へ前記ステアリングホイールの舵角補正を行うように構成され、
前記目標舵角は、前記所定の舵角を有する項と、旋回時の前記走行車輪のスリップ量の度合いを表す相関値を含む項とを含む式により算出され、
前記相関値は、旋回制御が行われている間の実際の前記走行車体のヨー方向の角速度から、旋回目標位置へ旋回するための前記走行車体のヨー方向の理想角速度を減ずることにより算出され、
前記相関値を含む項が、前記ステアリングホイールの舵角を、前記所定の舵角から中立位置側に補正するように機能することを特徴とする作業車両によって達成される。
Such objects of the present invention are
a running vehicle;
a working machine that is attached to the traveling vehicle body and performs agricultural work;
a positional information acquiring means for acquiring positional information of the running vehicle body;
A work vehicle comprising yaw direction angular velocity detection means for detecting the angular velocity of the traveling vehicle body in the yaw direction,
The traveling vehicle body includes traveling wheels, a steering wheel that steers the traveling wheels, a motor that rotates the steering wheel, and control means that controls turning of the work vehicle by driving the motor. ,
When starting turning by turning control, the control means rotates the steering wheel to a predetermined steering angle that enables turning to a turning target position in a field under standard conditions, and then rotates the steering wheel from the predetermined steering angle. configured to correct the steering angle of the steering wheel to the target steering angle,
The target rudder angle is calculated by a formula including a term having the predetermined rudder angle and a term including a correlation value representing the degree of slip amount of the running wheels during turning,
The correlation value is calculated by subtracting the ideal angular velocity in the yaw direction of the traveling vehicle body for turning to the turning target position from the actual angular velocity in the yaw direction of the traveling vehicle body during turning control,
This is achieved by the work vehicle, wherein the term including the correlation value functions to correct the steering angle of the steering wheel from the predetermined steering angle toward the neutral position.
本発明によれば、旋回制御において、標準的な条件の圃場で旋回目標位置に旋回可能な所定の舵角から、目標舵角へステアリングホイールの舵角補正が行われるように構成され、この目標舵角を算出する式において、走行車輪のスリップ量の度合いを表す相関値を含む項が、所定の舵角から中立位置側に補正するように機能する項であるから、スリップ量に応じてステアリングホイールの舵角を中立位置側に補正することができる。 According to the present invention, in turning control, steering angle correction of the steering wheel is performed from a predetermined steering angle that enables turning to a turning target position in a field under standard conditions to a target steering angle. In the equation for calculating the steering angle, the term containing the correlation value representing the degree of the slip amount of the running wheels is a term that functions to correct the steering angle from a predetermined steering angle toward the neutral position. The steering angle of the wheel can be corrected toward the neutral position.
したがって、スリップ量が多い場合でも、過度に小回りに旋回してしまうことを防止でき、走行車輪のスリップ量を加味した舵角で、一定の旋回半径で旋回目標位置である次の植付行程の位置へ作業車両を安定的に旋回させることができる。 Therefore, even if the amount of slip is large, it is possible to prevent the vehicle from turning in an excessively small turn. The work vehicle can be stably turned to the position.
本発明の好ましい実施態様においては、
前記目標舵角を算出する式は、作業者により設定される舵角補正の制御値が代入される変数を含む項であって、ステアリングホイールの舵角を前記所定の舵角から末切り位置側に補正するように機能する項を含む。
In a preferred embodiment of the invention,
The expression for calculating the target steering angle is a term including a variable into which a steering angle correction control value set by the operator is substituted, and the steering angle of the steering wheel is shifted from the predetermined steering angle toward the end-turn position. contains a term that functions to correct for
本発明のこの好ましい実施態様によれば、目標舵角を算出する式に、作業者により設定される舵角補正の制御値が代入される変数を含む項が含まれているから、作業者により設定される制御値を加味した舵角で、旋回目標位置である次の植付行程の位置へ作業車両を精度よく旋回させることができる。加えて、この項が、ステアリングホイールの舵角を所定の舵角から末切り位置側に補正するように機能する項であるから、浅い圃場などのスリップ量の少ない状況において、過度に大回りしてしまう事態を防止することができる。 According to this preferred embodiment of the present invention, the formula for calculating the target steering angle includes a term including a variable into which the steering angle correction control value set by the operator is substituted. The work vehicle can be accurately turned to the position of the next planting stroke, which is the turning target position, at the steering angle that takes into account the set control value. In addition, since this term functions to correct the rudder angle of the steering wheel from a predetermined rudder angle toward the end-turning position, in situations where the amount of slippage is small, such as in shallow fields, the steering wheel may turn excessively. It is possible to prevent an accidental situation.
本発明のさらに好ましい実施態様においては、
前記相関値が0未満である場合には、前記相関値が0として前記目標舵角が算出される。
In a further preferred embodiment of the invention,
When the correlation value is less than 0, the correlation value is assumed to be 0 and the target steering angle is calculated.
本発明のこの好ましい実施態様によれば、旋回時の走行車輪のスリップ量の度合いを表す相関値が0未満である場合には、かかる相関値が0として目標舵角を算出するように構成されているから、不適切な舵角の補正を防止することができる。 According to this preferred embodiment of the present invention, when the correlation value representing the degree of slip of the running wheels during turning is less than 0, the correlation value is assumed to be 0 to calculate the target steering angle. Therefore, inappropriate steering angle correction can be prevented.
本発明の好ましい実施態様においては、
前記走行車体は、車速を変更する主変速レバーをさらに備え、
前記制御手段は、旋回制御により作業車両が旋回している間に、車速が低いほど前記ステアリングホイールの回動速度が低くなるように、前記主変速レバーの操作位置に応じて前記ステアリングホイールの回動速度の上限値を変更することを特徴とする作業車両によって達成される。
In a preferred embodiment of the invention,
The traveling vehicle body further includes a main shift lever that changes the vehicle speed,
The control means rotates the steering wheel in accordance with the operation position of the main gear shift lever so that the lower the vehicle speed, the lower the rotation speed of the steering wheel while the work vehicle is turning by turning control. A work vehicle characterized by changing the upper limit of dynamic speed.
本発明のこの好ましい実施態様によれば、旋回制御により作業車両が旋回している間に、ステアリングホイールを回動させるモータを駆動する制御手段が、車速が低いほどステアリングホイールの回動速度が低くなるように、主変速レバーの操作位置に応じてステアリングホイールの回動速度の上限値を変更するよう構成されているから、旋回制御における旋回半径をより一層安定させることができ、作業車両を次の植付行程の位置へ安定的に旋回させることができる。 According to this preferred embodiment of the present invention, while the work vehicle is turning by turning control, the control means for driving the motor for turning the steering wheel is controlled so that the lower the vehicle speed, the lower the turning speed of the steering wheel. Since the upper limit value of the turning speed of the steering wheel is changed according to the operating position of the main transmission lever, the turning radius in turning control can be further stabilized, and the work vehicle can be operated as follows. can be swiveled stably to the position of the planting stroke.
本発明の好ましい実施態様においては、
旋回制御が行われている間に前記ステアリングホイールの回動方向が切り換えられるとき、前記制御手段は、回動方向が切り換わる前に、徐々に前記モータの回転速度を減速させ、回動方向が切り換わった後に、前記モータの回転速度を徐々に加速させるように構成されている。
In a preferred embodiment of the invention,
When the rotation direction of the steering wheel is switched while turning control is being performed, the control means gradually decelerates the rotation speed of the motor before the rotation direction is switched so that the rotation direction is changed. After switching, the rotational speed of the motor is gradually accelerated.
本発明のこの好ましい実施態様によれば、ステアリングホイールの回動方向が切り換わる前後に、ステアリングホイールを回動させるモータの回転速度を低く抑えるように構成されているから、ステアリングホイールの回動方向が切り換わる際の衝撃を低減し、ステアリングホイールからステアリングモータまでの間でギア鳴りが発生してしまうことを防止することができる。 According to this preferred embodiment of the present invention, the rotational speed of the motor for turning the steering wheel is kept low before and after the turning direction of the steering wheel is switched. It is possible to reduce the impact at the time of switching, and prevent gear noise from occurring between the steering wheel and the steering motor.
本発明のさらに好ましい実施態様においては、
さらに、圃場に肥料を供給する施肥装置を備えるとともに、前記作業機が、圃場に苗を植える苗植付部により構成され、
前記施肥装置が、圃場の場所ごとに施肥量を調節する可変施肥を実行可能に構成され、
前記施肥装置による肥料の供給に先立って行われるティーチングの際に、土壌の肥沃度のデータ取得が行われる距離間隔が、圃場に苗を植え付ける条間の距離に等しい。
In a further preferred embodiment of the invention,
Furthermore, a fertilizing device that supplies fertilizer to the field is provided, and the work machine is configured by a seedling planting unit that plants seedlings in the field,
The fertilizing device is configured to be able to perform variable fertilization that adjusts the amount of fertilization for each location in the field,
The distance interval at which soil fertility data is obtained during the teaching performed prior to the supply of fertilizer by the fertilizing device is equal to the distance between rows at which seedlings are planted in the field.
本発明のこの好ましい実施態様によれば、土壌の肥沃度のデータを取得する距離間隔が、圃場に苗を植え付ける条間の距離に等しく構成されているから、安定してサンプリングを行えることに加え、斜めや横方向に走行しつつティーチングを行うときでも、およそ隣接する条(苗の列)ごとにデータを取得することができる。 According to this preferred embodiment of the present invention, the distance interval for acquiring soil fertility data is set equal to the distance between rows at which seedlings are planted in the field. , data can be obtained for each adjacent row (row of seedlings) even when teaching is performed while running diagonally or laterally.
本発明によれば、旋回制御によって次の植付行程の位置へ安定的に旋回することができる作業車両を提供することが可能になる。 ADVANTAGE OF THE INVENTION According to this invention, it becomes possible to provide the working vehicle which can turn stably to the position of the next planting process by turning control.
以下、添付図面に基づいて、本発明の好ましい実施態様につき、詳細に説明を加える。 Hereinafter, preferred embodiments of the present invention will be described in detail based on the accompanying drawings.
図1は、本発明の好ましい実施態様にかかる作業車両1の略左側面図であり、図2は、図1に示された作業車両1の略平面図である。 FIG. 1 is a schematic left side view of a work vehicle 1 according to a preferred embodiment of the present invention, and FIG. 2 is a schematic plan view of the work vehicle 1 shown in FIG.
本明細書においては、図1または図2に矢印で示されるように、作業車両1の進行方向となる側を前方とし、特に断りがない限り、作業車両1の進行方向に向かって左側を「左」といい、その反対側を「右」という。 In this specification, as indicated by an arrow in FIG. 1 or 2, the side in which the work vehicle 1 travels is defined as the front side, and unless otherwise specified, the left side in the direction of movement of the work vehicle 1 is defined as " The left side is called the left side, and the opposite side is called the right side.
本実施態様にかかる作業車両1は、圃場に稲の苗を植え付ける田植機であり、図1および図2に示されるように、走行車体2(以下、単に「機体」ともいう。)と、走行車体2の後部に取り付けられた苗植付部63(本発明にかかる作業機の一例)と、圃場に肥料を供給する施肥装置26と、苗を植え付けながら走行する際の走行位置の目安となるラインを圃場上に形成する左右一対の線引きマーカー40と、走行車体2の前部に設けられたGNSS受信機130と、走行車体2が向いている方位を検出する方位センサ80と、走行車体2の前部に設けられ、苗植付部63に供給される苗を収容する補助苗枠74とを備えている。 A working vehicle 1 according to this embodiment is a rice transplanter for planting rice seedlings in a field. As shown in FIGS. A seedling planting unit 63 (an example of the working machine according to the present invention) attached to the rear part of the vehicle body 2, a fertilizing device 26 for supplying fertilizer to the field, and a guideline for the traveling position when traveling while planting the seedlings. A pair of left and right drawing markers 40 for forming a line on the field, a GNSS receiver 130 provided in the front part of the traveling vehicle body 2, an orientation sensor 80 for detecting the direction in which the traveling vehicle body 2 is facing, and the traveling vehicle body 2. and an auxiliary seedling frame 74 that accommodates the seedlings supplied to the seedling planting unit 63 .
図1に示されるように、走行車体2は、フロントカバー47に覆われた制御部87(本発明にかかる「制御手段」に相当)と、走行車体2の略中央に配置されたメインフレーム3と、メインフレーム3の後端部に取り付けられ、作業車両1の幅方向に延びる後部フレーム6と、メインフレーム3の上方に配置されたフロアステップ60と、フロアステップ60の上方に設けられた操縦席48と、操縦部49と、操縦席48の下方に設けられたエンジン7と、走行車輪としての左右一対の前輪8(操舵輪)および左右一対の後輪9と、エンジン7の動力を左右一対の前輪8および後輪9に伝達するミッションケース30などの伝達機構とを備えている。 As shown in FIG. 1, the traveling vehicle body 2 includes a control section 87 (corresponding to the "control means" according to the present invention) covered with a front cover 47, and a main frame 3 disposed substantially in the center of the traveling vehicle body 2. a rear frame 6 attached to the rear end of the main frame 3 and extending in the width direction of the work vehicle 1; a floor step 60 arranged above the main frame 3; A seat 48, an operating section 49, an engine 7 provided below the operator's seat 48, a pair of left and right front wheels 8 (steering wheels) and a pair of left and right rear wheels 9 as running wheels, and the power of the engine 7 A transmission mechanism such as a transmission case 30 for transmitting power to a pair of front wheels 8 and rear wheels 9 is provided.
操縦部49は、図2に示されるように、走行車体2の前後進と車速を変更する主変速レバー35と、左右一対の前輪8を操舵するステアリングホイール56を含む操舵機構43と、ステアリングホイール56の左側近傍に設けられた直進アシストレバー79と、操作スイッチを有するモニタ61(図8参照)と、作業車両1を操作するための種々の操作スイッチが設けられた操作部54を備えている。本実施態様においては、制御部87の出力信号に基づき、ステアリングホイールを自動的に駆動して作業車両を直進走行させる直進制御((いわゆる直進アシスト)と、ステアリングホイールを自動的に駆動して作業車両を旋回させる旋回制御を実行可能に構成されている。 As shown in FIG. 2, the steering unit 49 includes a main transmission lever 35 for changing the traveling vehicle body 2 forward and backward and the vehicle speed, a steering mechanism 43 including a steering wheel 56 for steering the pair of left and right front wheels 8, and a steering wheel. 56, a monitor 61 (see FIG. 8) having operation switches, and an operation unit 54 having various operation switches for operating the work vehicle 1. . In this embodiment, based on the output signal of the control unit 87, the steering wheel is automatically driven to drive the work vehicle straight ahead (so-called straight-ahead assist), and the steering wheel is automatically driven to perform work. It is configured to be able to execute turning control for turning the vehicle.
直進アシストレバー79は、走行車体2の位置情報を取得する際と、直進制御を開始または停止させる際に揺動操作される。 The straight-travel assist lever 79 is swung when acquiring the position information of the traveling vehicle body 2 and when starting or stopping the straight-travel control.
操舵機構43は、ステアリングホイール56の他、ステアリングシャフト83、ピットマンアームおよびタイロッド(図示せず)を備えている。 The steering mechanism 43 includes a steering wheel 56, a steering shaft 83, a pitman arm and tie rods (not shown).
一方、エンジン7から出力された駆動力は、図1に示されるように、フロアステップ60の下方に設けられたベルト式動力伝達機構4および静油圧式無段変速機(HST)25を介してミッションケース30に伝動される。 On the other hand, the driving force output from the engine 7 is transmitted through a belt-type power transmission mechanism 4 and a hydrostatic continuously variable transmission (HST) 25 provided below the floor step 60, as shown in FIG. It is transmitted to the mission case 30.
静油圧式無段変速機25は、トラニオン軸(図示せず)を備え、主変速レバー35が操作されると、トラニオン軸の開度がHSTサーボモータ150(図3参照)の駆動によって調整されて、ミッションケース30への出力が変更され、車速が調整されるように構成されており、前進する場合、すなわち、図4(b)に示される前進領域に主変速レバー35が位置する場合に、主変速レバー35がより前方の位置に操作されるほど、車速が高く調整される。本実施態様においては、前進領域内で、主変速レバー35の操作位置を前後方向に区分け(領域分け)して検出し、前進領域内の主変速レバー35が位置する区分(前進領域内の各領域)に対応した車速に段階的に変更するよう構成されているが、無段変速が可能な変速機であるため、無段階に車速を変更するように構成してもよい。 The hydrostatic continuously variable transmission 25 has a trunnion shaft (not shown), and when the main shift lever 35 is operated, the opening of the trunnion shaft is adjusted by driving the HST servomotor 150 (see FIG. 3). 4B, the output to the transmission case 30 is changed to adjust the vehicle speed. , the further forward the main shift lever 35 is operated, the higher the vehicle speed is adjusted. In this embodiment, the operating position of the main gearshift lever 35 is divided in the front-rear direction (regions) in the forward travel region and detected. However, since the transmission is capable of stepless speed change, the vehicle speed may be changed steplessly.
ミッションケース30に伝達された動力は、その内部で変速されて、左右一対の前輪8および左右一対の後輪9への走行用の動力と、苗植付部63を駆動するための動力(駆動用の動力)とに分けて伝動される。 The power transmitted to the transmission case 30 is changed in its interior, and the power for traveling to the pair of left and right front wheels 8 and the pair of left and right rear wheels 9 and the power for driving the seedling planting part 63 (driving power) power) is transmitted separately.
走行用の動力は、前輪ファイナルケース13および前輪車軸31(図1参照)を介して、左右一対の前輪8に伝達される他、図1および図2に示される左右一対の後輪伝動軸14、左右一対の後輪ギアケース51および車軸82(図1参照)を介して、左右一対の後輪9に伝達される。 Driving power is transmitted to the pair of left and right front wheels 8 via the front wheel final case 13 and the front wheel axle 31 (see FIG. 1), and also to the pair of left and right rear wheel transmission shafts 14 shown in FIGS. , to the pair of left and right rear wheels 9 via a pair of left and right rear wheel gear cases 51 and axles 82 (see FIG. 1).
一方、駆動用の動力は、走行車体2の後部に設けられた植付クラッチ(図示せず)まで伝達され、植付クラッチが入れられた際に、さらに苗植付部63へ伝達される。 On the other hand, the driving power is transmitted to a planting clutch (not shown) provided at the rear portion of the traveling vehicle body 2, and further transmitted to the seedling planting section 63 when the planting clutch is engaged.
苗植付部63は、図1に示されるように、昇降リンク装置5を介して、走行車体2に取り付けられている。昇降リンク装置5は、上部リンクアーム85および左右一対の下部リンクアーム86を備え、苗植付部63を昇降可能に構成されている。 The seedling planting part 63 is attached to the traveling vehicle body 2 via the lifting link device 5, as shown in FIG. The lifting link device 5 includes an upper link arm 85 and a pair of left and right lower link arms 86, and is configured to move the seedling planting section 63 up and down.
上部リンクアーム85および下部リンクアーム86の前側の端部は、後部フレーム6に固定されたリンクベースフレーム10に取り付けられ、他端は苗植付部63の下部に位置する上下リンクアーム11に取り付けられている。 The front ends of the upper link arm 85 and the lower link arm 86 are attached to the link base frame 10 fixed to the rear frame 6, and the other ends are attached to the upper and lower link arms 11 positioned below the seedling planting section 63. It is
ここで、制御部87によって電子油圧バルブ88(図3参照)が制御されて、図1に示される昇降油圧シリンダ12が油圧で縮められると、上部リンクアーム85が後ろ上がりに回動され、苗植付部63が非作業位置まで上昇されるように構成されている。苗植付部63が非作業位置にあるときには、その下端部がメインフレーム3の底部と略同一の高さに位置する。 Here, when the electrohydraulic valve 88 (see FIG. 3) is controlled by the control unit 87 to hydraulically compress the elevating hydraulic cylinder 12 shown in FIG. The planting part 63 is configured to be raised to the non-working position. When the seedling planting section 63 is in the non-working position, its lower end is located at substantially the same height as the bottom of the main frame 3 .
これに対して、昇降油圧シリンダ12が油圧で伸ばされると、上部リンクアーム85が後ろ下がりに回動され、苗植付部63が、苗の植付け作業が可能な作業位置(図1に示された位置)まで下降される。 On the other hand, when the elevating hydraulic cylinder 12 is hydraulically extended, the upper link arm 85 is rotated downward, and the seedling planting section 63 is moved to the working position (shown in FIG. 1) where the seedling planting work can be performed. position).
図1および図2に示されるように、苗植付部63は、土付きのマット状の苗(以下、「苗マット」という。)を立て掛ける台65と、台65の後方かつ下方に設けられた4つの植付装置64(図2参照)と、苗植付部63の下部に設けられたセンターフロート38と、センターフロート38の左右に配置された4つのサイドフロート39を備えている。 As shown in FIGS. 1 and 2, the seedling planting unit 63 includes a table 65 on which a mat-shaped seedling with soil (hereinafter referred to as a "seedling mat") is leaned, and is provided behind and below the table 65. 2), a center float 38 provided at the bottom of the seedling planting section 63, and four side floats 39 arranged on the left and right sides of the center float 38.
図2に示されるように、4つの植付装置64は作業車両1の幅方向に並べて設けられ、各植付装置64は、前後方向に並ぶ左右二対の植付具69を備えている。植付クラッチが入れられて、図1に示される駆動軸67が回転されると、図1および図2に示される前側の植付具69と後ろ側の植付具69とが、駆動軸67まわりに回転しつつ、交互に台65の下端部に位置する苗を取出し、圃場に植え付けるように構成されている。図2に示されるように、本実施態様においては、計列の植付具69が左右方向に並べて設けられているため、作業車両1が圃場に苗を植え付けつつ、直進走行すると、8条(8列)の苗列が形成される。 As shown in FIG. 2, the four planting devices 64 are arranged side by side in the width direction of the work vehicle 1, and each planting device 64 has two pairs of left and right planting tools 69 arranged in the front-rear direction. When the planting clutch is engaged and the drive shaft 67 shown in FIG. 1 is rotated, the front planter 69 and the rear planter 69 shown in FIGS. While rotating around, it is configured to alternately take out the seedlings positioned at the lower end of the platform 65 and plant them in the field. As shown in FIG. 2, in the present embodiment, since the planting tools 69 are arranged in a row in the left-right direction, when the work vehicle 1 travels straight while planting seedlings in the field, eight rows ( 8 rows) of seedlings are formed.
センターフロート38および4つのサイドフロート39はそれぞれ、作業車両1が走行するのに伴って、圃場上を滑走し、整地するように構成され、各フロート38,39によって整地された圃場に、各植付装置64によって苗が植え付けられる。センターフロート38および4つのサイドフロート39はそれぞれ、圃場の凹凸に合わせて揺動される。 The center float 38 and the four side floats 39 are configured to slide and level the field as the working vehicle 1 travels, and the field leveled by the floats 38 and 39 is lined with each plant. Seedlings are planted by the attachment device 64 . The center float 38 and the four side floats 39 are respectively swung according to unevenness of the field.
施肥装置26は、圃場内の場所ごとに施肥量を調節する可変施肥を実行可能に構成されている。具体的には、施肥装置26にボールネジを回動させる施肥量調節モータ66(図3参照)が設けられており、施肥量調節モータ66の駆動により、繰出回動アームの揺動量を増減させ、一定時間に繰り出される施肥量を調節することができる。この可変施肥の詳しい機構は、たとえば、特開2019-106896号公報等を参照されたい。 The fertilizing device 26 is configured to be able to perform variable fertilization that adjusts the amount of fertilization for each location in the field. Specifically, the fertilizing device 26 is provided with a fertilization amount adjusting motor 66 (see FIG. 3) that rotates a ball screw. You can adjust the amount of fertilizer applied in a given period of time. For the detailed mechanism of this variable fertilization, see, for example, Japanese Unexamined Patent Application Publication No. 2019-106896.
ここで、従来の田植機においては、可変施肥に先立って行われるティーチングの間に、0.2秒ごとに、土壌の肥沃度のデータ、すなわち、圃場の電気伝導度、圃場の深度および温度のデータを取得し、圃場の基準値(平均値、標準偏差)を算出するように構成されていた。 Here, in the conventional rice transplanter, soil fertility data, that is, field electrical conductivity, field depth and temperature, are collected every 0.2 seconds during teaching performed prior to variable fertilization. It was configured to acquire data and calculate field reference values (average, standard deviation).
しかしながら、所定の時間ごとにデータを取得する構成では、車速に応じてデータ取得(サンプリング)が行われる距離間隔が定まらないという問題もあった。 However, in the configuration that acquires data at predetermined time intervals, there is also the problem that the distance interval at which data acquisition (sampling) is performed is not determined according to the vehicle speed.
このような状況に鑑みて、本実施態様においては、後輪9の回転数を検出する後輪回転センサ29により走行距離を検知し、車両が1条間の距離の目安である30cm走行するごとに圃場の肥沃度のデータを取得するように構成されている。このように構成することにより、安定してサンプリングが行えることに加え、斜めや横方向に走行しつつティーチングを行うときでも、およそ隣接する条(苗の列)ごとにデータを取得することができる。なお、データ取得の距離間隔は、たとえば5cmないし100cmの間でモニタ上で任意に変更できるように構成してもよく、この場合には、合筆圃場等、圃場内で肥沃度のデータのバラつきが大きいときに、より高頻度にサンプリングすることが可能になる。 In view of this situation, in this embodiment, the rear wheel rotation sensor 29 that detects the number of revolutions of the rear wheels 9 detects the traveled distance, It is configured to obtain field fertility data at By configuring in this way, in addition to being able to stably perform sampling, data can be obtained for each adjacent row (row of seedlings) even when teaching is performed while traveling diagonally or laterally. . The data acquisition distance interval may be configured to be arbitrarily changed on the monitor, for example, between 5 cm and 100 cm. When is large, it becomes possible to sample more frequently.
また、本実施態様においては、後輪回転センサ29が故障している場合には、GNSS受信機130により取得される位置情報により車両の走行距離を検知するように構成されているが、GNSS受信機130の車速情報により車速を検知し、車速を時間で積分することにより、走行距離を算出するように構成してもよい。これらの構成により、後輪回転センサ29とGNSS受信機130のうちのいずれか一方が故障している場合であっても、他方のセンサにより走行距離の情報を取得することができる。 Further, in this embodiment, when the rear wheel rotation sensor 29 is out of order, the travel distance of the vehicle is detected based on the position information acquired by the GNSS receiver 130. The vehicle speed may be detected from the vehicle speed information of the machine 130, and the traveled distance may be calculated by integrating the vehicle speed over time. With these configurations, even if one of the rear wheel rotation sensor 29 and the GNSS receiver 130 is out of order, the other sensor can acquire information on the traveling distance.
さらに、本実施態様においては、後輪回転センサ29とGNSS受信機130がいずれも故障し、車両の走行距離を検知できない場合に、設定されたサンプリング周期で肥沃度のデータを取得してティーチングを行うように構成されている。 Furthermore, in the present embodiment, when both the rear wheel rotation sensor 29 and the GNSS receiver 130 are out of order and the mileage of the vehicle cannot be detected, fertility data is acquired at the set sampling period and teaching is performed. configured to do so.
具体的には、ティーチング時に0.2秒の倍数秒ごとの設定された周期(間隔)で肥沃度のデータを取得するように構成されており、たとえば0.2秒、0.4秒、0.8秒または1.6秒ごとに肥沃度のデータを取得するようモニタ61上で周期を設定することができる。 Specifically, it is configured to acquire fertility data at a cycle (interval) that is a multiple of 0.2 seconds during teaching. A period can be set on the monitor 61 to acquire fertility data every 0.8 seconds or 1.6 seconds.
このように、本実施態様においては、後輪回転センサ29とGNSS受信機130がいずれも故障し、車両の走行距離を検知できない場合でも、設定されたサンプリング周期で肥沃度のデータを取得するよう構成されているため、ティーチングを問題なく行うことができる。 Thus, in this embodiment, even if both the rear wheel rotation sensor 29 and the GNSS receiver 130 are out of order and the travel distance of the vehicle cannot be detected, the fertility data is acquired at the set sampling period. Since it is configured, teaching can be performed without problems.
一方、左右一対の線引きマーカー40はそれぞれ、走行車体2が走行する際に、圃場上を転動して線を形成する線引き体41と、線引き体41と走行車体2とを結ぶ略L字状のマーカーロッド42(図9も参照)を備え、線引き体41が圃場に接触する作用姿勢と、線引き体41が圃場に接触しない非作用姿勢との間で切り換え可能に構成されている。 On the other hand, a pair of left and right drawing markers 40 each have a drawing body 41 that rolls on the field to form a line when the traveling vehicle body 2 travels, and a substantially L-shaped drawing that connects the drawing body 41 and the traveling vehicle body 2 . The marker rod 42 (see also FIG. 9) is configured to be switchable between an action posture in which the drawing body 41 contacts the field and a non-action posture in which the drawing body 41 does not contact the field.
作業車両1が圃場上を直進走行しつつ、苗を植え付けるときに、左右一対の線引きマーカー40のうち、次に苗を植付けする(旋回後の)列の方の線引きマーカー40が作用姿勢にある状態で直進走行することによって、旋回後に直進走行する際の走行位置の目安となるラインが圃場上に形成される。なお、図1および図2には、作用姿勢にある左側の線引きマーカー40と、非作用姿勢にある右側の線引きマーカー40が示されている。 When planting seedlings while the work vehicle 1 is traveling straight on the field, the line-drawing marker 40 of the pair of left and right line-drawing markers 40 for planting the seedlings next (after turning) is in the working posture. By running straight in this state, a line is formed on the field as a guideline for the running position when running straight after turning. 1 and 2 show the left delineating marker 40 in the active position and the right delineating marker 40 in the non-active position.
図1および図2に示されるように、走行車体2の前部かつ幅方向中央部には、センターマスコット18が設けられており、作業車両1が圃場上を旋回し、次の列上を直進走行するときに、線引きマーカー40によって形成されたライン上を、センターマスコット18が通過するように、ステアリングホイール56を操作しつつ、直進走行することによって、適切な位置に苗を植え付けることができる。すなわち、作業車両1が旋回する前に植え付けられた8列(8条)の苗に対して、(旋回後に)適切な間隔で、8列の苗を植え付けることができる。 As shown in FIGS. 1 and 2, a center mascot 18 is provided at the front and widthwise central portion of the traveling vehicle body 2, and the work vehicle 1 turns over the field and advances straight on the next row. Seedlings can be planted at an appropriate position by traveling straight while operating a steering wheel 56 so that the center mascot 18 passes on the line formed by the drawing marker 40 when traveling. That is, eight rows of seedlings (after turning) can be planted at appropriate intervals with respect to eight rows (eight rows) of seedlings planted before the work vehicle 1 turns.
補助苗枠74は、台65に補充する苗マットを収容するため、図1および図2に示されるように、補助苗枠74を支持するフレーム77を介して、走行車体2の前部に取り付けられている。 The auxiliary seedling frame 74 is attached to the front part of the traveling vehicle body 2 through a frame 77 that supports the auxiliary seedling frame 74, as shown in FIGS. It is
図3は、図1に示された作業車両1の制御系、検出系、入力系および駆動系のブロックダイアグラムである。また、図4(a)は、図1に示された主変速レバー35の拡大図であり、図4(b)は、主変速レバー35の操作範囲を示す模式図である。 FIG. 3 is a block diagram of the control system, detection system, input system and drive system of work vehicle 1 shown in FIG. 4(a) is an enlarged view of the main shift lever 35 shown in FIG. 1, and FIG. 4(b) is a schematic diagram showing the operating range of the main shift lever 35. As shown in FIG.
図3に示されるように、作業車両1の制御系は、作業車両1全体の動作を制御する制御部87と、時間を計測するタイマー105を備えている。 As shown in FIG. 3, the control system of the work vehicle 1 includes a control section 87 that controls the overall operation of the work vehicle 1 and a timer 105 that measures time.
制御部87は、CPU(Central Processing Unit)を有する処理部89と、ROM(Read Only Memory)およびRAM(Random Access Memory)を有する記憶部93を備え、記憶部93には、作業車両1を制御する種々のプログラムおよびデータが格納されている。 The control unit 87 includes a processing unit 89 having a CPU (Central Processing Unit) and a storage unit 93 having a ROM (Read Only Memory) and a RAM (Random Access Memory). Various programs and data to be used are stored.
図3に示されるように、作業車両1の検出系は、ステアリングホイール56の舵角を検出するピットマンセンサ58と、ステアリングモータ57に設けられ、ステアリングモータ57の回転位置と回転速度を検出するステアリングセンサ45と、エンジン7の回転数を検出するエンジン回転センサ96と、リンクベースフレーム10に対する上部リンクアーム85の相対角度を検出するリンクセンサ90と、人工衛星からの電波を受信するGNSS受信機130と、左右一対の後輪9に連結された左右の各車軸82の回転数をカウントする後輪回転センサ29と、センターフロート38前部の上下位置を検出するフロートセンサ33と、方位センサ80と、走行車体2のロール方向の傾きを検出する傾斜検知センサ37と、可変施肥に用いられる肥沃度のデータを取得する電気伝導度センサ98、深度センサ99並びに温度センサ100を備えている。 As shown in FIG. 3 , the detection system of the work vehicle 1 includes a pitman sensor 58 that detects the steering angle of the steering wheel 56 and a steering sensor 58 that is provided in the steering motor 57 and detects the rotational position and rotational speed of the steering motor 57 . A sensor 45, an engine rotation sensor 96 that detects the rotation speed of the engine 7, a link sensor 90 that detects the relative angle of the upper link arm 85 with respect to the link base frame 10, and a GNSS receiver 130 that receives radio waves from satellites. , a rear wheel rotation sensor 29 that counts the number of revolutions of left and right axles 82 connected to the pair of left and right rear wheels 9; a float sensor 33 that detects the vertical position of the front part of the center float 38; , an inclination detection sensor 37 for detecting the inclination of the traveling vehicle body 2 in the roll direction, an electric conductivity sensor 98 for acquiring fertility data used for variable fertilization, a depth sensor 99 and a temperature sensor 100 .
GNSS受信機130は、本発明の「位置情報取得手段」の一例である。 The GNSS receiver 130 is an example of the "position information acquisition means" of the present invention.
ピットマンセンサ58は、本実施態様においてはピットマンアームに取り付けられているが、ステアリングシャフト83等に設けられてもよい。 The pitman sensor 58 is attached to the pitman arm in this embodiment, but may be provided to the steering shaft 83 or the like.
フロートセンサ33は、センターフロート38の前部が圃場の凹凸に合わせて揺動される際に、センターフロート38前部の上下位置を検出し、制御部87に出力するように構成されている。 The float sensor 33 is configured to detect the vertical position of the front portion of the center float 38 when the front portion of the center float 38 is swung according to the unevenness of the field, and output the detected vertical position to the control portion 87 .
深度センサ99は、超音波センサにより構成されており、圃場表面までの距離、すなわち、圃場の深さを検出する。 The depth sensor 99 is composed of an ultrasonic sensor and detects the distance to the field surface, that is, the depth of the field.
図3に示されるように、作業車両1の入力系は、作業車両1の前後進および車速を変更する主変速レバー35(図1、図2および図4参照)の操作位置を検出する主変速レバーセンサ36と、走行車体2の位置情報を取得する際、および直進制御を開始し、あるいは停止する際に、上下一方に揺動操作される直進アシストレバー79(図1および図2参照)の操作を検知する直進アシストレバーセンサ81と、苗植付部63の昇降を行うフィンガーレバー23の揺動操作を検知するフィンガーレバーセンサ16と、苗の植付作業の入切の切り換え操作を行う植付入切スイッチ19と、図8に示されるモニタ61と、左右の各線引きマーカー40の姿勢の切り換え操作を行うマーカースイッチ28と、旋回制御を設定する旋回制御スイッチ17を備えている。マーカースイッチ28および旋回制御スイッチ17は操作部54に設けられている。 As shown in FIG. 3, the input system of the work vehicle 1 includes a main shift lever 35 (see FIGS. 1, 2, and 4) that detects the operating position of a main shift lever 35 (see FIGS. 1, 2, and 4) that changes the forward and backward movement of the work vehicle 1 and changes the vehicle speed. A lever sensor 36 and a straight travel assist lever 79 (see FIGS. 1 and 2) which is pivoted in one direction when acquiring position information of the traveling vehicle body 2 and when straight travel control is started or stopped. A straight advance assist lever sensor 81 that detects the operation, a finger lever sensor 16 that detects the swinging operation of the finger lever 23 that raises and lowers the seedling planting part 63, and a planting sensor that switches on and off the seedling planting work. It is provided with an on/off switch 19, a monitor 61 shown in FIG. 8, a marker switch 28 for switching the orientation of each of the left and right line drawing markers 40, and a turning control switch 17 for setting turning control. The marker switch 28 and the turning control switch 17 are provided on the operating portion 54 .
本実施態様においては、直進アシストレバー79は上方および下方に揺動操作が可能であり、上下いずれかの方向に揺動操作された後には、スプリングによって自動的に元の上下位置に戻るように構成されている。 In this embodiment, the straight advance assist lever 79 can be swung upward and downward, and after being swung in either direction, it is automatically returned to its original vertical position by a spring. It is configured.
フィンガーレバー23と植付入切スイッチ19は、図4に示されるように、主変速レバー35に設けられている。 The finger lever 23 and the planted on/off switch 19 are provided on the main shift lever 35 as shown in FIG.
また、本実施態様においては、旋回制御を設定する旋回制御スイッチ17の操作により、通常の旋回である「Uターン旋回」と、畔際で苗の補給を行うのに最適な「バック旋回(バックターン)」の計2つの形式のうちのいずれか一方の形式での旋回制御を選択できるように構成されている。 In addition, in this embodiment, by operating the turning control switch 17 for setting the turning control, the normal turning "U-turn turning" and the optimal "back turning" for replenishing the seedlings at the bank. Turn)” is configured to allow selection of turning control in either one of two formats.
図3に示されるように、作業車両1の駆動系は、操縦席48の下方に設けられたエンジン7の吸気量を調節するスロットルモータ97と、苗植付部35が昇降される際に、昇降油圧シリンダ12を伸縮させる電子油圧バルブ88と、静油圧式無段変速機25内のトラニオン軸の開度を調整し、作業車両1の前後進および車速を変更するHSTサーボモータ150と、ステアリングシャフト83およびステアリングホイール56を回動させるステアリングモータ57と、後輪9のサイドクラッチを入切する電磁バルブ103と、パワーステアリング108と、植付クラッチを作動させる植付クラッチモータ27と、左右一対の各線引きマーカー40を揺動させるマーカーモータ34と、施肥装置26による圃場への施肥量を調節する施肥量調節モータ66を備えている。 As shown in FIG. 3, the drive system of the work vehicle 1 includes a throttle motor 97 that adjusts the amount of air intake of the engine 7 provided below the operator's seat 48, and when the seedling planting section 35 is raised and lowered, An electro-hydraulic valve 88 for expanding and contracting the lifting hydraulic cylinder 12, an HST servomotor 150 for adjusting the opening of the trunnion shaft in the hydrostatic continuously variable transmission 25 to change the forward and backward movement of the work vehicle 1 and the vehicle speed, and steering. A left and right pair of a steering motor 57 that rotates the shaft 83 and the steering wheel 56, an electromagnetic valve 103 that turns on and off the side clutch of the rear wheel 9, a power steering 108, and a planted clutch motor 27 that operates the planted clutch. and a fertilizing amount adjusting motor 66 for adjusting the fertilizing amount applied to the field by the fertilizing device 26 .
本実施態様においては、走行車体2が走行している間に、ステアリングホイール56の舵角が閾値以上となった場合(平たく言えば、ステアリングホイール56が左右一方に大きく切られた場合)には、走行車体2が旋回していると認められるので、制御部87は、電磁バルブ103を制御し、旋回内側の後輪9に動力が伝達されない状態に切り換えるように構成されている。このように構成することによって、圃場の枕地部分をスムーズに旋回することができる。 In this embodiment, when the rudder angle of the steering wheel 56 becomes equal to or greater than the threshold value while the traveling vehicle body 2 is traveling (in other words, when the steering wheel 56 is largely turned left or right), Since it is recognized that the vehicle body 2 is turning, the control unit 87 is configured to control the electromagnetic valve 103 and switch to a state in which power is not transmitted to the rear wheel 9 on the inner side of the turn. By configuring in this way, it is possible to smoothly turn the headland portion of the field.
ステアリングモータ57は、直進制御および旋回制御において自動的にステアリングホイール56を回転させることを目的として制御部87により駆動され、直進制御および旋回制御が行われている間に、ステアリングセンサ45によりステアリングモータ57の回転位置と回転速度が検出される。本実施態様においては、ステアリングモータ57にはステアリングセンサ45により検出される実際の回転速度を基に回転速度をフィードバック制御可能なスピードコントロールモータが用いられている。 The steering motor 57 is driven by the controller 87 for the purpose of automatically rotating the steering wheel 56 during straight-ahead control and turning control. The rotational position and rotational speed of 57 are detected. In this embodiment, the steering motor 57 is a speed control motor capable of feedback control of the rotation speed based on the actual rotation speed detected by the steering sensor 45 .
また、制御部87は、リンクセンサ90からの出力信号に基づいて苗植付部35の現在の高さ(上下位置)を算出可能に構成されている。 Further, the control section 87 is configured to be able to calculate the current height (vertical position) of the seedling planting section 35 based on the output signal from the link sensor 90 .
加えて、作業車両1が苗を植え付けつつ、圃場上を走行しているときには、制御部87は、フロートセンサ33からの検出信号に基づき、電子油圧バルブ88を制御して、図1に示された昇降油圧シリンダ12を伸縮させ、図1に示された苗植付部63を昇降させることにより、圃場への苗の植付深さを一定に維持することができる。 In addition, when the work vehicle 1 is planting seedlings and traveling on the field, the control unit 87 controls the electro-hydraulic valve 88 based on the detection signal from the float sensor 33 to perform the operation shown in FIG. By extending and retracting the lifting hydraulic cylinder 12 to raise and lower the seedling planting section 63 shown in FIG. 1, the planting depth of the seedlings in the field can be kept constant.
図5は、図1に示された作業車両1が、圃場内において、苗を植え付けつつ、走行する経路を示す模式的平面図である。 FIG. 5 is a schematic plan view showing a route along which the working vehicle 1 shown in FIG. 1 travels while planting seedlings in a field.
図5に示されるように、作業車両1が苗を植え付ける圃場200は、平面視において略矩形をなし、南北方向に延びる2つの辺201および203と、東西方向に延びる2つの辺202および204と、各辺201ないし204に沿うように延びる4つの周縁領域211ないし214と、4つの周縁領域211ないし214に囲まれた中央領域210を備えた平坦な水田である。2つの周縁領域211および213はいわゆる枕地であり、周縁領域211および213のそれぞれの南北方向の幅と、周縁領域212および214のそれぞれの東西方向の幅は、作業車両1の苗植付部63による作業幅(苗8条分の幅)以上の幅である。 As shown in FIG. 5, a farm field 200 in which the work vehicle 1 plants seedlings has a substantially rectangular shape in plan view, with two sides 201 and 203 extending in the north-south direction and two sides 202 and 204 extending in the east-west direction. , four peripheral areas 211-214 extending along each side 201-204, and a central area 210 surrounded by the four peripheral areas 211-214. The two peripheral regions 211 and 213 are so-called headlands, and the width of each of the peripheral regions 211 and 213 in the north-south direction and the width of each of the peripheral regions 212 and 214 in the east-west direction are equal to the seedling planting portion of the work vehicle 1. It is wider than the working width (width for 8 seedlings) by 63.
以下に、この圃場200を例に、作業車両1の直進制御および旋回制御について詳細に説明を加える。なお、圃場200は便宜上、上述のような形状、大きさおよび向き(方角)としているが、直進制御および旋回制御が行われる圃場はとくに限定されない。 In the following, a detailed description will be given of straight-ahead control and turning control of the work vehicle 1, taking this farm field 200 as an example. For the sake of convenience, the farm field 200 has the shape, size, and orientation (direction) as described above, but the farm field on which straight-ahead control and turning control are performed is not particularly limited.
圃場200に苗を植え付ける際には、制御部87による直進制御と旋回制御とを交互に行い、つづら折り状に圃場200を走行しつつ、中央領域210に苗を植え付けた後に、図5に矢印付きのグレー色の太い線で示されるように、4つの周縁領域211ないし214に、順次に苗を植え付ける。なお、本実施態様においては、制御部87による旋回制御が行われるためには、予め、旋回制御スイッチ17が操作され、旋回制御が行われる状態に設定されている必要がある。 When seedlings are planted in the field 200, the controller 87 alternately performs straight-ahead control and turning control, and travels the field 200 in a zigzag pattern. Seedlings are planted sequentially in the four peripheral regions 211 to 214, as indicated by the thick gray lines in . In this embodiment, in order for the control unit 87 to perform swing control, the swing control switch 17 must be operated in advance to set the state in which swing control is performed.
中央領域210に苗を植え付ける際には、まず、いわゆるティーチングにより、直進制御に用いる基準線の始点と終点の位置情報が取得される。直進制御においては、作業車両1が始点と終点を結ぶ仮想の基準線と平行に直進走行するように(より具体的には、作業車両1が、後に詳述する、基準線に平行な仮想の目標線に沿うようにステアリングモータ57が駆動され、ステアリングホイール56の舵角が調整される。 When seedlings are planted in the central region 210, first, positional information of the start point and end point of the reference line used for straight control is obtained by so-called teaching. In the straight-ahead control, the work vehicle 1 runs straight parallel to a virtual reference line connecting the start point and the end point (more specifically, the work vehicle 1 moves along a virtual reference line parallel to the reference line, which will be described in detail later). The steering motor 57 is driven along the target line, and the steering angle of the steering wheel 56 is adjusted.
基準線の始点の位置情報を取得するにあたっては、作業者の操縦(主変速レバー35およびステアリングホイール56の操作)に基づき、作業車両1が、図5に示される圃場200の周縁領域212内の北側の位置に移動され、直進アシストレバー79が下方に揺動操作されることによって、GNSS受信機130を用いて、基準線の始点218の位置情報が取得される。 In acquiring the positional information of the starting point of the reference line, the work vehicle 1 moves within the peripheral area 212 of the farm field 200 shown in FIG. By moving to the north position and swinging the straight assist lever 79 downward, the GNSS receiver 130 is used to acquire the position information of the starting point 218 of the reference line.
次いで、マーカースイッチ28が操作され、東側の線引きマーカー40(旋回する側であり、この場合には左側の線引きマーカー40)が作用姿勢に切り換えられた状態で、作業者の操縦に基づき、矢印付きの破線208で示されるように、作業車両1が周縁領域212内の南側の場所まで移動され、直進アシストレバー79が下方に揺動操作される。その結果、GNSS受信機130を用いて、基準線の終点219の位置情報が取得される。以上のようにして取得された基準線の始点と終点の位置情報は、記憶部93に格納される。なお、本実施態様においては、始点と終点を結ぶ仮想の基準線は、便宜上、正確に南北方向に延びる線として説明を進める。 Next, the marker switch 28 is operated, and with the east side drawing marker 40 (turning side, in this case, the left side drawing marker 40) switched to the active posture, based on the operator's operation, the arrow is drawn. 2, the work vehicle 1 is moved to a location on the south side within the peripheral area 212, and the straight advance assist lever 79 is operated to swing downward. As a result, the GNSS receiver 130 is used to obtain the position information of the endpoint 219 of the baseline. The positional information of the start point and end point of the reference line acquired as described above is stored in the storage unit 93 . In this embodiment, for the sake of convenience, the virtual reference line connecting the starting point and the ending point will be described as a line extending precisely in the north-south direction.
また、本実施態様においては、マーカースイッチ28が操作され、線引きマーカー40が作用姿勢に切り換えられると、以後、作業車両1が旋回する度に、ピットマンセンサ58の出力信号に基づき、作業車両1の旋回が検出され、自動的に作用姿勢にある一方の線引きマーカー40が非作用姿勢に切り換えられ、さらに、作業車両1が旋回した後に、自動的に他方の線引きマーカー40が作用姿勢に切り換えられるように構成されている。 Further, in the present embodiment, when the marker switch 28 is operated and the line drawing marker 40 is switched to the active posture, the work vehicle 1 is driven based on the output signal of the pitman sensor 58 every time the work vehicle 1 turns thereafter. When turning is detected, one of the drawing markers 40 in the active posture is automatically switched to the non-working posture, and after the work vehicle 1 turns, the other drawing marker 40 is automatically switched to the active posture. is configured to
また、本実施態様においては、作業者によってステアリングホイール56が回動される場合と、制御部87の出力信号に基づき、ステアリングホイール56が回動される場合(直進制御、旋回制御)のいずれにおいても、車速は主変速レバー35の操作位置に基づき設定されるが、旋回制御が行われている間においては、車速が随時、所定の速度以下に規制される。 Further, in this embodiment, when the steering wheel 56 is turned by the operator or when the steering wheel 56 is turned based on the output signal of the control unit 87 (straight ahead control, turn control) Although the vehicle speed is set based on the operating position of the main shift lever 35, the vehicle speed is regulated to a predetermined speed or less at any time while turning control is being performed.
基準線の始点と終点の位置情報が取得されると、作業者の操縦に基づき、作業車両1が東側へ旋回されて、中央領域210における1列目(1つ目の植付行程)の植付開始位置207(×印)へ移動され、図5に「1列目」として示される植付行程において、苗の植付けを伴う直進走行が開始される。 When the position information of the start point and the end point of the reference line is obtained, the work vehicle 1 is turned to the east side based on the operation of the operator, and the first row (the first planting process) in the central area 210 is planted. It is moved to the planting start position 207 (marked with x), and in the planting process shown as "first row" in FIG.
具体的には、図4に示されるフィンガーレバー23が下方に揺動操作されて苗植付部63が作業位置に切り換えられた後に、植付入切スイッチ19が押圧操作されることによって、各植付装置64が駆動され、8列の植付具69(図2参照)による苗の植え付けが開始される。このとき、図5に示されるように、右側の線引きマーカー40は自動的に作用姿勢に切換えられており、線引き体41が圃場上を転動されることにより、図5の「2列目」の位置に走行位置の目安となるラインが形成される。 Specifically, after the finger lever 23 shown in FIG. 4 is pivoted downward to switch the seedling planting section 63 to the working position, the planting ON/OFF switch 19 is pressed to activate each plant. The planting device 64 is driven, and planting of seedlings by eight rows of planting tools 69 (see FIG. 2) is started. At this time, as shown in FIG. 5, the right drawing marker 40 is automatically switched to the working posture, and the drawing body 41 rolls on the field to move the "second row" of FIG. A line that serves as a guideline for the running position is formed at the position of .
次いで、作業者によって直進アシストレバー79が上方に揺動操作されて、制御部87による直進制御が開始される。直進制御が開始される条件は、各列を直進走行する際の目標線(走行すべき位置を指す仮想の線であり、基準線に平行な線)と、走行車体2の向き(機体2の方位)との角度差が30°未満である状態で、直進アシストレバー79が上方に揺動操作されることである。 Next, the straight advance assist lever 79 is swung upward by the operator, and straight advance control by the control section 87 is started. The conditions for starting straight-ahead control are the target line (a virtual line pointing to the position to be traveled, a line parallel to the reference line) when traveling straight on each row, and the direction of the traveling vehicle body 2 (the direction of the vehicle body 2). direction) is less than 30°, the straight assist lever 79 is operated to swing upward.
直進制御においては、制御部87は、作業車両1が、図5に矢印付きの破線で示された基準線208であって、直進アシストレバー79の揺動操作により位置情報が取得された始点と終点とを結ぶ基準線208に対して平行に直進走行するように、GNSS受信機130および方位センサ80から出力された検出信号に基づいて、ステアリングモータ57を駆動し、操舵輪としての左右一対の前輪8を操舵するように構成されている。その結果、作業車両1は、「1列目」として示される列を、真っ直ぐに北へ走行する。 In straight-ahead control, the control unit 87 sets the work vehicle 1 to the reference line 208 indicated by the dashed line with an arrow in FIG. Based on the detection signals output from the GNSS receiver 130 and the direction sensor 80, the steering motor 57 is driven so that the vehicle travels straight parallel to the reference line 208 connecting the end point, and the pair of left and right wheels serving as steering wheels is driven. It is configured to steer the front wheels 8 . As a result, work vehicle 1 travels straight north in the row indicated as "first row".
なお、本実施態様にかかる直進制御においては、制御部87は、中央領域210の「1列目」を走行するときに、基準線208よりも次の作業条の方(東側)へ240cm(条間30cm×苗8条分)だけズレた位置を基準線208に対して平行に延びる仮想の目標線を設定した後に、目標線に沿うようにステアリングモータ57を駆動するように構成されている。また、「n列目」(nは2以上の整数)を走行するときには、制御部87は、n-1列目のラインから次の作業条の方(東側)へ240cmだけズレた位置を基準線208に対して平行に延びる目標線を設定した後に、目標線に沿うようにステアリングモータ57を駆動するように構成されている。 In the straight-ahead control according to this embodiment, the controller 87 moves 240 cm (toward the east side) toward the next work row from the reference line 208 (row 240 cm) when traveling in the “first row” of the central region 210 . After a virtual target line extending parallel to the reference line 208 is set at a position shifted by 30 cm between the seedlings by 8 seedlings, the steering motor 57 is driven along the target line. Also, when traveling in the “nth row” (n is an integer equal to or greater than 2), the control unit 87 sets the position shifted by 240 cm toward the next working row (east side) from the n−1th row line as a reference. After setting a target line extending parallel to the line 208, the steering motor 57 is driven along the target line.
しかしながら、このように、直進制御において、生成された目標線に沿って機体2が走行するようにステアリングモータ57を駆動させることは必ずしも必要でなく、直進制御において、単に、基準線が延びる方位を目標方位として、1ないしn列目の各列で直進アシストレバー79が上方に揺動操作された地点から、機体2の方位と目標方位との方位偏差が小さくなるようにステアリングモータ57が駆動されるように構成してもよい。 However, in straight control, it is not always necessary to drive the steering motor 57 so that the machine body 2 runs along the generated target line. The steering motor 57 is driven so that the azimuth deviation between the azimuth of the airframe 2 and the target azimuth becomes small from the point where the straight advance assist lever 79 is swung upward in each of the 1st to nth rows as the target azimuth. It may be configured as
作業車両1が周縁領域213(北側の枕地)に近づくと、作業者によって直進アシストレバー79が上方に揺動操作されて、制御部87による直進制御が終了される。 When the work vehicle 1 approaches the peripheral area 213 (northern headland), the operator swings the straight advance assist lever 79 upward, and the straight advance control by the control unit 87 is terminated.
こうして、直進制御が終了すると、作業者によって、図4に示されたフィンガーレバー23が上方に揺動操作され、苗植付部63が上昇される。 When the straight-ahead control is finished in this manner, the operator swings upward the finger lever 23 shown in FIG. 4 to raise the seedling planting portion 63 .
本実施態様にかかる作業車両1においては、旋回制御スイッチ17の操作によって旋回制御が行われる状態に設定された状態で、主変速レバー35が前進位置(車両が前進する位置)にあり、かつ、フィンガーレバー23が上方に揺動操作されると、制御部87による旋回制御が開始されるように構成されている。以下に、まず、「Uターン旋回」での旋回制御について詳細に説明を加える。 In the work vehicle 1 according to this embodiment, the main transmission lever 35 is in the forward position (the position at which the vehicle moves forward) in a state where the turning control switch 17 is operated to perform turning control, and When the finger lever 23 is operated to swing upward, the turning control by the control section 87 is started. First, a detailed description will be given below of turning control in the "U-turn turning".
図6は、図1に示された作業車両1の制御部87による旋回制御の手順を示すフローチャートであり、図7は、図6に示された複数のステップと、走行車体2の向き(方位)との関係を示す模式的平面図である。なお、図7においては、矢印付きの一点鎖線(直進走行時)と矢印付きの二点鎖線(旋回走行時)は、作業車両1の幅方向(左右方向)中央部が移動する軌跡を表している。また、図7において、図6に示されるステップs10にかかる部分については、便宜上、グレー色で示されている。 FIG. 6 is a flow chart showing the procedure of turning control by the control unit 87 of the work vehicle 1 shown in FIG. ) is a schematic plan view showing the relationship between . In FIG. 7, the one-dot chain line with an arrow (during straight running) and the two-dot chain line with an arrow (during turning) represent the trajectory along which the central portion of the work vehicle 1 moves in the width direction (horizontal direction). there is Also, in FIG. 7, the portion related to step s10 shown in FIG. 6 is shown in gray for convenience.
旋回制御において、まず、制御部87は、記憶部93より、旋回目標位置までの距離のデータを取得する(ステップs1)。 In turning control, first, the control unit 87 acquires data on the distance to the turning target position from the storage unit 93 (step s1).
ここで、旋回制御の目標は、作業車両1を、旋回後に直進走行する東西方向の位置(線引きマーカー40によってラインが形成された東西方向の位置)に旋回することであり、「1列目」から「2列目」へ旋回する場合の旋回目標位置(旋回後に作業車両1が位置すべき位置であり、次の植付行程の位置)は、図5に示される「2列目」の位置(東西方向の位置)である。すなわち、旋回目標位置までの距離とは、平たく言えば、図5に示される「1列目」と「2列目」との間の(圃場200においては東西方向の)距離であり、本実施態様においては、苗植付部63が左右方向に並ぶ8列の植付具69を有する8条植えの田植機として構成されているため、240cm(条間30cm×8条分)という値のデータが格納されている。なお、図5に示される「1列目」から「n列目」はそれぞれ、作業車両1が直進走行しつつ、苗を植え付ける「植付行程」である。 Here, the target of the turning control is to turn the work vehicle 1 to a position in the east-west direction where the work vehicle 1 travels straight after turning (the position in the east-west direction where the line is formed by the delineation marker 40). The turning target position (the position at which the work vehicle 1 should be positioned after turning and the position of the next planting process) when turning from to the “second row” is the “second row” position shown in FIG. (position in the east-west direction). That is, the distance to the turning target position is, in layman's terms, the distance (in the east-west direction in the field 200) between the "first row" and the "second row" shown in FIG. In this embodiment, since the seedling planting unit 63 is configured as an eight-row rice transplanter having eight rows of planting tools 69 arranged in the left-right direction, data of a value of 240 cm (row spacing 30 cm x eight rows) is stored. The "first row" to "nth row" shown in FIG. 5 are "planting steps" in which seedlings are planted while the work vehicle 1 is traveling straight.
こうして、旋回目標位置までの距離のデータを取得すると、制御部87は、HSTサーボモータ150を駆動し、車速を0.75[m/s]に規制するとともに、ステアリングモータ57を駆動し、所定の舵角θd[deg]となるように、ステアリングホイール56の次の作業条の方向(「2列目」への旋回時は右側)への回動を開始する(ステップs2)。なお、本明細書においては、[]内には単位が示されている。 Thus, when the data of the distance to the turning target position is acquired, the control unit 87 drives the HST servo motor 150 to regulate the vehicle speed to 0.75 [m/s], and drives the steering motor 57 to (step s2) so that the steering angle .theta.d [deg] is equal to .theta.d [deg]. In this specification, units are shown in [ ].
ここで、本実施態様において旋回制御時に用いられる所定の舵角θd[deg]とは、8条植えの作業車両1が、標準的な条件の圃場で、ステアリングホイール56を自動的に所定の舵角θdに保持した状態で旋回し、機体2の方位が、旋回する前の向き(方位)からヨー方向に180°変わる間際(具体的には後に詳述するθst以下となる時点)に、ステアリングホイール56の舵角を中立位置に戻すことによって、旋回目標位置に旋回可能な舵角である。 Here, the predetermined steering angle θd [deg] used during turning control in this embodiment means that the steering wheel 56 is automatically turned to the predetermined steering angle θd [deg] when the working vehicle 1 with eight rows of plants is in a field under standard conditions. When the fuselage 2 turns while maintaining the angle θd, and the azimuth of the fuselage 2 is about to change 180° in the yaw direction from the direction (azimuth) before turning (specifically, when it becomes less than θst, which will be described in detail later), the steering It is a steering angle that allows turning to the turning target position by returning the steering angle of the wheel 56 to the neutral position.
標準的な条件の圃場とは、具体的には、直進走行時に走行車輪8,9のスリップ率(GNSS受信機130等により検出される実際の走行距離を、後輪9の車軸82の回転数等から推定される作業車両1の走行距離で割って算出された値を、さらに1から引くことにより算出されるスリップの割合)が10%程度で、圃場の深さが20cm程度の圃場である。このような圃場上で何度も作業車両1の旋回試験が行われた結果、旋回目標位置に旋回可能なステアリングホイール56の舵角がθd[deg]である。 Specifically, the field under standard conditions means that the slip ratio of the running wheels 8 and 9 (the actual travel distance detected by the GNSS receiver 130 or the like when traveling straight ahead, the rotation speed of the axle 82 of the rear wheel 9, etc. The ratio of slip calculated by subtracting the value calculated by dividing by the traveling distance of the work vehicle 1 estimated from the above from 1 is about 10%, and the depth of the field is about 20 cm. . As a result of repeated turning tests of the work vehicle 1 on such an agricultural field, the steering angle of the steering wheel 56 capable of turning to the turning target position is θd [deg].
ステアリングホイール56の舵角θd[deg]は、走行車輪のトレッド幅やホイールベース、次の植付行程の位置等により異なるが、本実施態様にかかる8条植えの作業車両1においては、末切り位置(ロック位置であり、左右一方に限界まで回した位置)よりも20°(後に詳述する舵角補正値の上限)以上手前の角度であり、中立位置からの角度が100°を上回る角度である。すなわち、ステアリングホイール56の舵角θd[deg]は、末切り位置から20°以上中立位置側に戻された角度である。本実施態様においては、ステアリングホイール56が舵角θdへ切られる際には、制御部87は、ピットマンセンサ58(図3参照)の検出信号によりステアリングホイール56の舵角が舵角θd[deg]となったことが検知されたときにステアリングモータ57の駆動を停止し、以後、ステアリングセンサ45の検出信号に基づき、ステアリングモータ57を駆動するように構成されているが、このように構成することは必ずしも必要でない。さらに、ステアリングホイール56の舵角をθd[deg]とする際に、3bit程度の不感帯を設け、舵角がθd±3bitの範囲となった際に、ステアリングモータ57の駆動を停止するように構成してもよい。なお、旋回時の補正前の目標舵角である所定の舵角θdと、後に詳述する現在の舵角であるθa[deg]と、補正後の目標舵角であるθdi[deg]はそれぞれ、ステアリングホイール56の中立位置からの舵角である。 The steering angle θd [deg] of the steering wheel 56 varies depending on the tread width of the running wheels, the wheel base, the position of the next planting process, etc. An angle that is 20° or more (upper limit of the steering angle correction value, which will be described in detail later) or more before the position (the locked position, which is the position that is turned to the left or right to the limit), and is an angle that exceeds 100° from the neutral position. is. In other words, the steering angle θd [deg] of the steering wheel 56 is an angle returned from the end-turned position to the neutral position side by 20° or more. In this embodiment, when the steering wheel 56 is turned to the steering angle θd, the control unit 87 controls the steering angle of the steering wheel 56 to be the steering angle θd [deg] based on the detection signal of the pitman sensor 58 (see FIG. 3). The driving of the steering motor 57 is stopped when it is detected that the state of is not necessary. Furthermore, when the steering angle of the steering wheel 56 is set to θd [deg], a dead zone of about 3 bits is provided, and the driving of the steering motor 57 is stopped when the steering angle falls within the range of θd±3 bits. You may A predetermined steering angle θd that is a target steering angle before correction during turning, θa [deg] that is a current steering angle to be described in detail later, and θdi [deg] that is a target steering angle after correction are respectively , the steering angle from the neutral position of the steering wheel 56 .
上述のように、標準的な条件の圃場で、ステアリングホイール56を自動的に所定の舵角θd[deg]に保持した状態で旋回することにより、旋回目標位置に旋回することができる。 As described above, it is possible to turn to the turning target position by turning with the steering wheel 56 automatically held at the predetermined steering angle θd [deg] in the field under standard conditions.
しかしながら、標準的な条件でない圃場上で旋回制御が行われる場合、走行車輪8,9のスリップによって、駆動力が弱まり、走行車体2が前方へほとんど移動せずに、その場で回ってしまうときに、走行車体2の向きがヨー方向に180°回転される間際までステアリングホイール56を所定の舵角θdに保持した状態で旋回すると、図5に矢印付きのグレー色の細い線で示されるように、過度に小回りになりすぎてしまい、旋回目標位置よりも手前側(図5においては西側)にズレた位置に車両1が位置してしまうことがあった。 However, when turning control is performed on a field that is not under standard conditions, slipping of the traveling wheels 8 and 9 weakens the driving force, and the traveling vehicle body 2 turns on the spot without moving forward. 5, when the steering wheel 56 is held at a predetermined steering angle .theta.d until the traveling vehicle body 2 is rotated 180.degree. In addition, the turning radius becomes too small, and the vehicle 1 may be positioned at a position shifted to the front side (the west side in FIG. 5) of the turn target position.
また、圃場が過度に浅い場合など、圃場の状態によっては、標準的な条件の圃場上に比して走行車輪8,9のスリップが少なく、過度に大回りになりすぎてしまい、旋回目標位置よりも奥側(図5においては東側)にズレた位置に車両1が位置してしまうことがあった。 In addition, depending on the condition of the field, such as when the field is too shallow, the running wheels 8 and 9 may slip less than on the field under standard conditions, and the turning may be excessively large. In some cases, the vehicle 1 is positioned at a position shifted further to the far side (the east side in FIG. 5).
このような状況に鑑みて、本実施態様においては、制御部87は、ステアリングホイール56の所定の舵角θdまでの回動を開始させた後に、以下に述べるように、走行車体2の角速度から走行車輪8,9のスリップ量を算出し、さらに、走行車体2の方位と、「1列目」の目標線(基準線に平行な線であって、基準線より240cmだけ東側に位置する線)との角度差が30°以上となった時点で、ステアリングホイール56を、スリップ量を加味した舵角θdiまで自動的に切り戻し、又は切り足すことによって、過度に小回り又は大回りな旋回にならずに、旋回目標位置の位置(「1列目」を直進走行後の旋回においては「2列目」の位置)に作業車両1を移動させることができる。以下の説明において、旋回制御が行われている間に、走行車輪8,9のスリップ量を加味した舵角θdiまでステアリングホイール56を自動的に切り戻し、又は切り足す制御のことを「舵角補正制御」という。 In view of such a situation, in this embodiment, after starting the rotation of the steering wheel 56 up to a predetermined steering angle θd, the control unit 87 controls the angular velocity of the traveling vehicle body 2 as described below. The slip amount of the traveling wheels 8 and 9 is calculated, and the direction of the traveling vehicle body 2 and the target line of the "first row" (a line parallel to the reference line and located 240 cm east of the reference line) ) becomes 30° or more, the steering wheel 56 is automatically turned back to the steering angle θdi with the amount of slip taken into account, or is further cut to prevent excessively small or large turns. The work vehicle 1 can be moved to the turning target position (the position of the "second row" when turning after traveling straight on the "first row"). In the following description, the control of automatically turning back or cutting the steering wheel 56 to the steering angle θdi that takes into consideration the slip amount of the running wheels 8 and 9 during turning control is referred to as the "steering angle Correction control".
さらに、従来の作業車両の旋回制御においては、車速に拘わらず、ステアリングホイールを、ステアリングモータを用いて一律に最高速で回動させていたため、車速が高い場合にはステアリングホイールの回動(操舵)が完了するまでの走行距離が長く、その結果、過度に大回りに旋回してしまい、反対に、車速が低い場合にはステアリングホイールの回動が完了するまでの走行距離が短く、その結果、過度に小回りになってしまうという問題があった。 Furthermore, in conventional turning control of a work vehicle, the steering wheel is uniformly turned at the highest speed using a steering motor regardless of the vehicle speed. ) is long, resulting in an excessively large turn. There was a problem that it turned too tight.
このような状況に鑑みて、本実施態様においては、旋回制御中に、ステアリングホイール56が自動的に回動される際(具体的にはステアリングホイール56が舵角θd[deg]や、後に詳述する舵角θdi[deg]まで回動される際など)には、ステアリングホイール56の回動速度が車速に応じて変更(調整)されるように構成されている。 In view of this situation, in the present embodiment, when the steering wheel 56 is automatically rotated during turning control (specifically, when the steering wheel 56 is rotated at the steering angle θd [deg] or When the steering wheel 56 is rotated up to the steering angle θdi [deg] described above), the rotation speed of the steering wheel 56 is changed (adjusted) according to the vehicle speed.
具体的には、主変速レバー35の操作範囲の一部である前進領域(図4(b)参照)内で前後方向に区分けされた複数の区分のうちのいずれに主変速レバー35が操作されているかによって、ステアリングホイール56の回動時の角速度が、以下の速度を上限値として規制される。なお、前進領域内において、最も後方に位置する区分(前進時に車速が最も遅い区分)が1区分目であり、より前方に位置する区分ほど、何区分目の「何」の部分の数が大きくなる。
1区分目 : 50[deg/s]
2区分目 : 70[deg/s]
3区分目 : 90[deg/s]
4区分目 : 110[deg/s]
5区分目 : 130[deg/s]
6区分目 : 150[deg/s]
7区分目移行:170[deg/s]
Specifically, the main shift lever 35 is operated to which of a plurality of sections divided in the front-rear direction within the forward movement region (see FIG. 4(b)), which is a part of the operation range of the main shift lever 35. Depending on whether the steering wheel 56 is turned, the angular velocity of the steering wheel 56 is regulated with the following upper limit values. In the forward movement region, the most rearmost segment (the segment in which the vehicle speed is slowest when moving forward) is the first segment, and the further forward the segment is, the larger the number of "what" parts in which segment. Become.
First division: 50 [deg/s]
Second division: 70 [deg/s]
Third division: 90 [deg/s]
4th division: 110 [deg/s]
5th division: 130 [deg/s]
6th division: 150 [deg/s]
Transition to 7th segment: 170 [deg/s]
したがって、たとえば、作業者により主変速レバー35が前進領域内の最も後方に位置する1区分目に操作されているときには、ステアリングホイール56の回動速度が50[deg/s]に規制され、1区分目のすぐ前方の2区分目に操作されている場合には、ステアリングホイール56の回動速度が50[deg/s]に規制される。本実施態様においては前進領域が10つの区分に区分けされており、仮に角速度の規制がない場合には、主変速レバー35がいずれの区分に操作された場合でも170[deg/s]を上回る角速度でステアリングホイール56が回動される。 Therefore, for example, when the operator operates the main gearshift lever 35 to the rearmost first segment in the forward movement region, the rotation speed of the steering wheel 56 is regulated to 50 [deg/s]. When the steering wheel 56 is operated to the second segment immediately ahead of the segment, the rotation speed of the steering wheel 56 is restricted to 50 [deg/s]. In this embodiment, the forward movement region is divided into 10 divisions, and if there is no regulation of the angular velocity, the angular velocity exceeding 170 [deg/s] will occur even if the main shift lever 35 is operated to any division. , the steering wheel 56 is rotated.
このように、本実施態様においては、車速が高いほど、すなわち、主変速レバー35がより前方に位置するほど、旋回制御中の規制の範囲内で車速が高くなるとともに、スピードコントロールモータにより構成されたステアリングモータ57の駆動によるステアリングホイール56の回動速度が速くなり、主変速レバー35がより後方に位置するほど、車速が低くなるとともに、ステアリングモータ57の駆動によるステアリングホイール56の回動速度がより低く規制されるため、車速の違いにより車体2が過度に小回り又は大回りに旋回してしまうことを防止し、旋回半径を毎度一定の大きさとすることができる。なお、本実施態様においては、ステアリングモータ57への印加電圧を増減することにより、ステアリングホイールの回動速度の上限値を変更するように構成されているが、上限値の変更方法はとくにこれに限定されない。 Thus, in this embodiment, the higher the vehicle speed, that is, the further forward the main shift lever 35 is positioned, the higher the vehicle speed within the range of regulation during turning control. The rotational speed of the steering wheel 56 driven by the steering motor 57 increases, and the further the main shift lever 35 is positioned to the rear, the vehicle speed decreases and the rotational speed of the steering wheel 56 driven by the steering motor 57 increases. Since the vehicle body 2 is regulated to be lower, it is possible to prevent the vehicle body 2 from making an excessively small turn or a large turn due to the difference in vehicle speed, and to keep the turning radius constant each time. In this embodiment, the upper limit of the rotation speed of the steering wheel is changed by increasing or decreasing the voltage applied to the steering motor 57. Not limited.
また、従来の作業車両においては、旋回制御が行われている間に、ステアリングホイールの回動方向が、左回りから右回りへ、又は右回りから左回りへ切り換えられたときに、急制動となり、ステアリングホイールからステアリングモータまでの間でギア鳴りが発生してしまうことがあった。 Further, in a conventional work vehicle, sudden braking occurs when the rotation direction of the steering wheel is switched from left to right or from right to left while turning control is being performed. , gear noise may occur between the steering wheel and the steering motor.
これに対し、本実施態様においては、ステアリングホイール56の回動方向を切り換える際(たとえば略中立位置からθdまで切られてからθdiへ切り戻す際)に、制御部87が、ステアリングモータ57の回転速度(すなわちステアリングホイール56の回動速度)を、上述の上限までの範囲での最高速から徐々に減速させ、逆転後にステアリングモータ57の回転速度(すなわちステアリングホイール56の回動速度)を上限までの範囲で徐々に加速させるように制御するよう構成されている。このように構成することにより、逆転時の衝撃を低減できるため、ギア鳴りを防止することができる。 On the other hand, in this embodiment, when switching the rotation direction of the steering wheel 56 (for example, when turning from the substantially neutral position to θd and then turning back to θdi), the controller 87 controls the rotation of the steering motor 57. The speed (that is, the rotational speed of the steering wheel 56) is gradually reduced from the maximum speed in the range up to the upper limit, and after the reverse rotation, the rotational speed of the steering motor 57 (that is, the rotational speed of the steering wheel 56) is reduced to the upper limit. is configured to control so as to gradually accelerate in the range of By configuring in this way, it is possible to reduce the impact at the time of reverse rotation, so that gear noise can be prevented.
一方、ステアリングホイール56を所定の舵角θdまで回動させ始めると、制御部87は、走行車輪8,9のスリップがない場合に、次の旋回目標位置である「2列目」の位置へ車両1が旋回するための理想角速度ωiを、以下の式(1)によって算出する(ステップs3)。
ωi=0.071vθa[deg/sec] ...(1)
On the other hand, when the steering wheel 56 starts to rotate up to a predetermined steering angle θd, the controller 87 moves the steering wheel 56 to the next turning target position of the "second row" if the running wheels 8 and 9 do not slip. An ideal angular velocity ωi for turning the vehicle 1 is calculated by the following equation (1) (step s3).
ωi=0.071vθa[deg/sec]. . . (1)
式(1)において、vはGNSS受信機130によって取得された走行車体2の実際の車速[m/s]であり、θaはピットマンセンサ58によって取得されたステアリングホイール56の舵角である。また、「0.071」は本実施態様にかかる作業車両1の理想角速度を求めるためのパラメータであり、走行車輪のトレッド幅やホイールベース(前輪車軸31と後輪車軸82との間の前後方向の距離)によって旋回中の理想角速度は異なるため、トレッド幅やホイールベースを異にする作業車両ごとに、異なる値のパラメータを掛けることによって調節される。 In equation (1), v is the actual vehicle speed [m/s] of the traveling vehicle body 2 obtained by the GNSS receiver 130 , and θa is the steering angle of the steering wheel 56 obtained by the pitman sensor 58 . Further, "0.071" is a parameter for obtaining the ideal angular velocity of the work vehicle 1 according to this embodiment, and is the tread width of the running wheels and the wheel base (the longitudinal direction between the front wheel axle 31 and the rear wheel axle 82). Since the ideal angular velocity during a turn differs depending on the distance of ), it is adjusted by multiplying parameters with different values for each work vehicle having a different tread width and wheel base.
なお、本実施態様においては、車速vが0.1[m/s]以下である場合には、制御部87は、作業車両1が停車中と判定し、ωi=0とするように構成されている。また、ωiの値は、舵角補正制御が終了するまで、データ周期0.1秒、0.5秒移動平均で算出され、ωiの値が時々刻々と更新され続ける。 In this embodiment, when the vehicle speed v is 0.1 [m/s] or less, the control unit 87 determines that the work vehicle 1 is stopped and sets ωi=0. ing. In addition, the value of ωi is calculated with a data cycle of 0.1 second and a moving average of 0.5 seconds, and the value of ωi continues to be updated moment by moment until the steering angle correction control ends.
次いで、制御部87は、方位センサ80から出力されたその時点での走行車体2の方位(機体2の向き)θpの検出信号から、実際の走行車体2のヨー方向の角速度ωpを以下の式(2)によって算出する(ステップs4)。なお、以下において、「・」は乗算記号である。
ωp=10・{θp-θ(p-1)}[deg/sec] ...(2)
Next, the control unit 87 calculates the actual angular velocity ωp of the traveling vehicle body 2 in the yaw direction from the detection signal of the direction of the traveling vehicle body 2 (orientation of the vehicle body 2) θp at that time output from the direction sensor 80 by the following equation. (2) is calculated (step s4). In the following description, "·" is a multiplication symbol.
ωp=10·{θp−θ(p−1)}[deg/sec] . . . (2)
本実施態様においては、方位センサ80の検出信号の出力頻度は0.1秒ごと(データ周期が0.1秒)であり、方位センサ80から取得したその時点での走行車体2の方位θpから、その1データ前の走行車体2の方位であるθ(p-1)を減じて得た値に10を乗ずることにより、1秒ごとの実際の走行車体2のヨー方向の角速度ωpを算出することができる。なお、本実施態様においては、式(2)につき、0.5秒移動平均で算出する。また、ωpの値は、その後も時々刻々と更新され続ける。 In this embodiment, the output frequency of the detection signal of the direction sensor 80 is every 0.1 seconds (the data period is 0.1 second), and the direction θp of the traveling vehicle body 2 obtained from the direction sensor 80 , and multiplying the value obtained by subtracting θ(p−1), which is the orientation of the traveling vehicle body 2 one data before, by 10 to calculate the actual angular velocity ωp of the traveling vehicle body 2 in the yaw direction every second. be able to. In addition, in this embodiment, the formula (2) is calculated using a 0.5-second moving average. Also, the value of ωp continues to be updated from time to time thereafter.
こうして、理想角速度ωiと、実際の走行車体2のヨー方向の角速度ωpを算出すると、制御部87は、ステアリングセンサ45の検出信号に基づき、ステアリングホイール56の舵角がすでに所定の角度θd[deg]であるか否かを判定する(ステップs5)。なお、上述のように、所定の角度θd[deg]に不感帯が設けられた場合には、ステアリングホイール56の舵角が所定の角度θd又はその前後の不感帯の範囲にあるか否かを判定する。 When the ideal angular velocity ωi and the actual angular velocity ωp of the traveling vehicle body 2 in the yaw direction are calculated in this way, the control unit 87 detects that the steering angle of the steering wheel 56 has already reached the predetermined angle θd [deg] based on the detection signal of the steering sensor 45 . ] (step s5). As described above, when a dead band is provided at the predetermined angle θd [deg], it is determined whether or not the steering angle of the steering wheel 56 is within the predetermined angle θd or within the range of the dead band around the predetermined angle θd. .
ステアリングホイール56の舵角が所定の角度θdであるか否かの判定の結果、ステアリングホイール56の舵角が所定の角度θdに満たない場合には、ステアリングホイール56が所定の角度θdまで切られるまで、ステアリングセンサ45の検出信号の取得と判定とが繰り返される。 As a result of determining whether or not the steering angle of the steering wheel 56 is at the predetermined angle θd, if the steering angle of the steering wheel 56 is less than the predetermined angle θd, the steering wheel 56 is turned to the predetermined angle θd. Until then, acquisition and determination of the detection signal of the steering sensor 45 are repeated.
これに対して、判定の結果、ステアリングホイール56の舵角が所定の角度θdである場合には、制御部87は、ステアリングモータ57を駆動し、ステアリングホイール56の舵角が、以下の式(4)により算出された補正後の舵角θdi[deg]となるようにステアリングホイール56を切り戻し、又は切り足す(ステップs6、図6および図7参照)。
θdi=θd-(1.5・(ωp-ωi))・sinθp・cos(θp/2)・(10+x)+1.5・(10-x)[deg] ...式(4)
On the other hand, if the steering angle of the steering wheel 56 is the predetermined angle θd as a result of the determination, the control unit 87 drives the steering motor 57 so that the steering angle of the steering wheel 56 is determined by the following equation ( 4) The steering wheel 56 is turned back or cut so that the corrected steering angle θdi [deg] is obtained (step s6, see FIGS. 6 and 7).
.theta.di=.theta.d-(1.5.(.omega.p-.omega.i)).sin .theta.p.cos(.theta.p/2).(10+x)+1.5.(10-x)[deg] . . . Formula (4)
ただし、θdiは、θd-100≦θdi≦θd+20[deg]の範囲とし、舵角θdより切り戻し方向(中立位置へ向かう方向)へ100°、切り足し方向(末切り位置=ロック位置へ向かう方向)へ20°を限度とした範囲で舵角が補正される。すなわち、舵角補正値の下限は-100°であり、舵角補正値の上限は20°である。なお、ステアリングホイール56を舵角θdiに補正する(変更する)際についても、不感帯を前後3bit程度設けてもよい。 However, θdi is in the range of θd−100≦θdi≦θd+20 [deg], and is 100° in the steering return direction (toward the neutral position) from the steering angle θd, ), the steering angle is corrected within a range of 20°. That is, the lower limit of the steering angle correction value is -100°, and the upper limit of the steering angle correction value is 20°. Also when correcting (changing) the steering wheel 56 to the steering angle θdi, a dead band of about 3 bits may be provided.
式(4)において、θd[deg]は上述のように、標準的な条件の圃場で、旋回制御により、ステアリングホイール56の舵角をθd[deg]に保持した状態で旋回目標位置に旋回可能な角度である。したがって、式(4)を平たく言えば、「(1.5・(ωp-ωi))・sinθp・cos(θp/2)・(10+x)+1.5・(10-x)」[deg]の分だけ、ステアリングホイール56が、舵角θdから切り戻され、又は切り足される。 In the formula (4), θd [deg] is, as described above, a field under standard conditions, and the steering wheel 56 can be turned to the target turning position while the rudder angle of the steering wheel 56 is held at θd [deg] by turning control. angle. Therefore, to put equation (4) plainly, "(1.5·(ωp−ωi))·sinθp·cos(θp/2)·(10+x)+1.5·(10−x)" [deg] The steering wheel 56 is turned back or cut off from the steering angle θd by the amount.
式(4)内には、所定の舵角θdを有する項「θd」と、機体角速度検知による舵角補正を目的とした「-(1.5・(ωp-ωi))・sinθp・cos(θp/2)・(10+x)」の項と、スリップ量の多少によらずに(スリップ量に拘わらず)、実際の旋回の状況に応じて作業者が舵角を任意に補正可能とすることを目的とした「1.5・(10-x)」の項が含まれている。 Formula (4) contains a term “θd” having a predetermined steering angle θd and “−(1.5·(ωp−ωi))·sinθp·cos( θp/2)·(10+x)” and regardless of the slip amount (regardless of the slip amount), the operator can arbitrarily correct the steering angle according to the actual turning situation. The term "1.5 · (10-x)" is included for the purpose of
-「(1.5・(ωp-ωi))・sinθp・cos(θp/2)・(10+x)」の項は、0の値をとる場合を除き負の数をとるため、この項により、所定の舵角θd[deg]から大回り側(中立位置側)にのみ舵角補正を行い、「1.5・(10-x)」の項は、0の値をとる場合を除き正の数をとるため、この項により、所定の舵角θd[deg]から小回り側(末切り位置側)にも補正が可能に構成されている。換言すれば、「-(1.5・(ωp-ωi))・sinθp・cos(θp/2)・(10+x)」の項は、ステアリングホイール56の舵角を所定の舵角θd[deg]から中立位置側に補正するように機能する項であり、「1.5・(10-x)」の項は、ステアリングホイール56の舵角を所定の舵角θd[deg]から末切り位置側へ補正するように機能する項である。なお、xは後に詳述する制御値が代入される変数であり、「1.5」という数値は、本実施態様にかかる作業車両1を旋回目標位置へ旋回させるべく、圃場での走行試験の結果に基づき導き出された値である。 - The term "(1.5 · (ωp-ωi)) · sin θp · cos (θp / 2) · (10+x)" takes a negative number except when it takes a value of 0, so this term Steering angle correction is performed only on the large turning side (neutral position side) from a predetermined steering angle θd [deg], and the term “1.5·(10−x)” is a positive number except when it takes a value of 0. Therefore, this term enables correction from the predetermined steering angle .theta.d [deg] to the small turning side (the end-turning position side). In other words, the term "-(1.5·(ωp−ωi))·sin θp·cos(θp/2)·(10+x)" is used to set the steering angle of the steering wheel 56 to the predetermined steering angle θd [deg]. is a term that functions to correct the steering angle of the steering wheel 56 from the predetermined steering angle θd [deg] to the neutral position side. is a term that functions to correct to Note that x is a variable into which a control value, which will be described in detail later, is substituted, and the numerical value of "1.5" is used in a running test in a field in order to turn the work vehicle 1 according to the present embodiment to the turning target position. It is a value derived based on the results.
θpは、上述のように、その時点での走行車体2の方位(機体2の向き)を指し、「sinθp・cos(θp/2)」は0ないしおよそ0.77の値をとる。機体2(走行車体2)の方位によって、ステアリングモータ57の制御量を変更したいため、「sinθp・cos(θp/2)」が乗算される。 As described above, θp indicates the azimuth of the traveling vehicle body 2 (orientation of the body 2) at that time, and "sin θp·cos (θp/2)" takes a value of 0 to approximately 0.77. Since it is desired to change the control amount of the steering motor 57 depending on the orientation of the machine body 2 (running vehicle body 2), "sin θp·cos (θp/2)" is multiplied.
一方、「ωp-ωi」([deg/sec])によって算出される値は、走行車輪8,9のスリップ量(スリップの度合い)を表す相関値である。 On the other hand, the value calculated by "ωp-ωi" ([deg/sec]) is a correlation value representing the slip amount (degree of slip) of the running wheels 8,9.
ここで、作業車両1(走行車体2)が旋回する際に、圃場の状態により、走行車輪8,9がスリップし、走行車体2が前方へほとんど移動せずに、その場で回ってしまうような場合には、スリップが少なく正常に旋回する場合に比して、実際の走行車体2のヨー方向の角速度ωpが高くなり、ωp-ωiによって算出される値も大きくなる。すなわち、走行車輪8,9のスリップ量と、ωp-ωiによって算出される値とは相関関係にある。したがって、実際の走行車体2のヨー方向の角速度ωpから、理想角速度ωiを減ずることによって、スリップ量(スリップの度合い)を表す相関値を算出することができる。 Here, when the work vehicle 1 (the traveling vehicle body 2) turns, the traveling wheels 8 and 9 may slip depending on the state of the field, and the traveling vehicle body 2 may turn on the spot without moving forward. In this case, the actual angular velocity ωp of the traveling vehicle body 2 in the yaw direction becomes higher and the value calculated by ωp−ωi also becomes larger than when the vehicle turns normally with little slip. That is, there is a correlation between the slip amount of the running wheels 8 and 9 and the value calculated by ωp-ωi. Therefore, by subtracting the ideal angular velocity ωi from the actual angular velocity ωp of the traveling vehicle body 2 in the yaw direction, it is possible to calculate the correlation value representing the slip amount (degree of slip).
このため、たとえば、ωp-ωiの値が、所定の値以上である場合には、走行車輪8,9がスリップしていると判定するように構成することも可能である。なお、実際の圃場においては、ωp-ωiは、およそ0ないし5の値を取り、最大で10程度である。 Therefore, for example, it is possible to determine that the running wheels 8 and 9 are slipping when the value of ωp-ωi is equal to or greater than a predetermined value. In an actual farm field, ωp−ωi takes a value of approximately 0 to 5, and is about 10 at maximum.
このように、本実施態様においては、ωp-ωiにより算出されたスリップ量を加味した舵角θdiまでステアリングホイール56が切り戻され、又は切り足される(すなわち、舵角補正制御が行われる)ように構成されているから、走行車輪8,9のスリップの多少により、過度に小回り又は大回りに旋回してしまうことを防止することができる。 Thus, in this embodiment, the steering wheel 56 is turned back or cut to the steering angle θdi that takes into account the slip amount calculated by ωp-ωi (that is, the steering angle correction control is performed). Since it is constructed in this way, it is possible to prevent the vehicle from making excessively small turns or large turns due to the degree of slip of the running wheels 8 and 9 .
なお、ωp-ωi<0の場合には、スリップがないものと仮定して、(ωp-ωi)=0としてθdiを算出するように構成されている。低車速で角速度検出が安定しないときに局所的にωp-ωiが0未満となることがあるが、ωp-ωiが負の数をとる状態で式(4)によりθdiを算出すると、θdiがプラス側(小回り側)に補正されてしまい、旋回が安定しなかった。 When ωp−ωi<0, θdi is calculated with (ωp−ωi)=0 on the assumption that there is no slip. ωp-ωi may become less than 0 locally when angular velocity detection is unstable at low vehicle speeds. It was corrected to the side (small turning side), and the turning was not stable.
これに対し、本実施態様においては、ωp-ωi<0の場合に(ωp-ωi)=0としてθdiを算出するため、不適切な舵角の補正を防止することができる。 On the other hand, in this embodiment, when ωp−ωi<0, θdi is calculated as (ωp−ωi)=0, so that inappropriate steering angle correction can be prevented.
さらに、本実施態様においては、作業者は、式(4)内の変数xに代入される制御値を、予め、モニタ61上で任意に設定することによって、舵角補正制御においてステアリングホイール56を舵角θdから切り戻し、又は切り足す量(角度、回動量)を調節することができる。 Furthermore, in this embodiment, the operator can arbitrarily set the control value to be substituted for the variable x in the equation (4) on the monitor 61 in advance, thereby adjusting the steering wheel 56 in the steering angle correction control. It is possible to adjust the amount (angle, rotation amount) to be turned back or added from the steering angle θd.
図8は、舵角補正制御におけるモニタ61に表示される制御値の設定画面を示す図面であり、図8(a)は、左側へ旋回する場合の舵角補正制御における制御値の設定画面を示す図面であり、図8(b)は、右側へ旋回する場合の舵角補正制御における制御値の設定画面を示す図面である。 FIG. 8 is a drawing showing a control value setting screen displayed on the monitor 61 in the steering angle correction control, and FIG. 8(a) shows a control value setting screen in the steering angle correction control when turning to the left. FIG. 8B is a drawing showing a control value setting screen in the steering angle correction control when turning to the right.
モニタ61は、現在設定されている制御値を表示するディスプレイ32と、制御値を設定する操作スイッチ62を備えている。 The monitor 61 includes a display 32 for displaying currently set control values and an operation switch 62 for setting the control values.
本実施態様においては、0を含む-10ないし10の計21個の整数の数値の中から、任意の数値を、式(4)の変数xに代入される制御値の数値として、操作スイッチ62を用いて設定可能に構成されており、設定された数値は、記憶部93に格納され、図6に示されるステップs6の時点で記憶部93から読み出され、舵角θdi[deg]が算出される。 In this embodiment, an arbitrary numerical value from a total of 21 integer numerical values from -10 to 10 including 0 is used as the numerical value of the control value to be substituted for the variable x in the equation (4), and the operation switch 62 The set numerical value is stored in the storage unit 93, read out from the storage unit 93 at step s6 shown in FIG. 6, and the steering angle θdi [deg] is calculated. be done.
-10ないし10の範囲内で設定された制御値の数値が大きいほど、舵角θdから減算される角度「(1.5・(ωp-ωi))・sinθp・cos(θp/2)・(10+x)」[deg]の値が大きくなり、作業車両1の旋回が大回りになる。その結果、旋回後に、より奥側(図5において、より東側)の位置に作業車両1が位置することとなる。 The larger the numerical value of the control value set within the range of −10 to 10, the angle “(1.5·(ωp−ωi))·sinθp·cos(θp/2)·( 10+x)” [deg] increases, and the turning of the work vehicle 1 becomes large. As a result, after turning, the work vehicle 1 will be positioned further to the rear side (further east side in FIG. 5).
したがって、作業者は、旋回制御による旋回後の作業車両1の東西方向の位置と、線引きマーカー40によって形成された次に直進走行すべき列の東西方向の位置とを比較し、旋回後の作業車両1が、次に直進走行すべき列の位置よりも西側(手前側)に位置している場合には、モニタ61の操作スイッチ62を用いて、制御値をより大きく設定することによって、旋回後の作業車両1の位置を、より東側にずらし、次に直進走行すべき列と東西方向の位置を合わせることができる。 Therefore, the operator compares the east-west position of the work vehicle 1 after turning by the turning control with the east-west position of the next straight traveling line formed by the delineation marker 40, and performs the work after turning. When the vehicle 1 is located on the west side (front side) of the position of the next row in which the vehicle 1 should travel straight ahead, the operating switch 62 of the monitor 61 is used to set the control value to a larger value so that the vehicle 1 turns. The position of the subsequent work vehicle 1 can be shifted further to the east side, and the position in the east-west direction can be aligned with the line to travel straight next.
また、-10ないし10の範囲内で設定された制御値が小さいほど、式(4)において舵角θdから減算される角度「(ωp-ωi)・sinθp・cos(θp/2)・(10+x)」[deg]の値が小さくなり、かつ、舵角θdに加算される「1.5・(10-x)」[deg]の値が大きくなるから、作業車両1の旋回が小回りになる。その結果、より手前側(図5においては、より西側)の位置に作業車両1が位置することとなる。 Further, the smaller the control value set within the range of -10 to 10, the angle "(ωp−ωi)·sin θp·cos(θp/2)·(10+x )” [deg] becomes smaller and the value of “1.5·(10−x)” [deg] added to the steering angle θd becomes larger, so that the turning of the work vehicle 1 becomes smaller. . As a result, the work vehicle 1 is positioned further forward (westward in FIG. 5).
したがって、作業者は、旋回制御による旋回後の作業車両1の東西方向の位置と、線引きマーカー40によって形成された次に直進走行すべき列の東西方向の位置とを比較し、旋回後の作業車両1が、次に直進走行すべき列の位置よりも東側(奥側)に位置している場合には、モニタ61の操作スイッチ62を用いて、制御値をより小さく設定することによって、旋回後の作業車両1の位置を、より西側にずらし、次に直進走行すべき列と東西方向の位置を合わせることができる。 Therefore, the operator compares the east-west position of the work vehicle 1 after turning by the turning control with the east-west position of the next straight traveling line formed by the delineation marker 40, and performs the work after turning. When the vehicle 1 is located on the east side (rear side) of the position of the next row to travel straight ahead, the operation switch 62 of the monitor 61 is used to set the control value to a smaller value. The position of the subsequent work vehicle 1 can be shifted further to the west, and the position in the east-west direction can be aligned with the line that should travel straight next.
なお、本実施態様においては、図8(a)および図8(b)に示されるように、左側へ旋回するときに行われる舵角補正制御における目標舵角θdiを算出するのに用いられる変数xに代入される制御値と、右側へ旋回するときに行われる舵角補正制御における目標舵角θdiを算出するのに用いられる変数xに代入される制御値とを、互いに独立して設定可能に構成されている。換言すれば、旋回制御により左側へ旋回する場合と、旋回制御により右側へ旋回する場合とで、目標舵角θdiを算出するのに用いられる変数xに代入される制御値を別々の値に設定することができる。 In this embodiment, as shown in FIGS. 8(a) and 8(b), the variable used to calculate the target steering angle θdi in the steering angle correction control performed when turning to the left The control value substituted for x and the control value substituted for the variable x used to calculate the target steering angle θdi in the steering angle correction control performed when turning to the right can be set independently of each other. is configured to In other words, the control value to be substituted for the variable x used to calculate the target steering angle θdi is set to a different value depending on whether the vehicle is turning to the left under turning control or turning to the right under turning control. can do.
したがって、図5に示される圃場200および走行経路において、右側へ旋回する枕地である北側の枕地と、左側へ旋回する枕地である南側の枕地との間で、圃場の状態が異なる場合にも、それぞれの枕地に適した制御値を設定することによって、北側の枕地、南側の枕地のいずれにおいても、次に直進走行する列の東西方向の位置と、旋回後の作業車両1(走行車体2)の東西方向の位置とを一致させることができるから、旋回後にスムーズに直進制御に移行することができる。 Therefore, in the field 200 and the travel route shown in FIG. 5, the state of the field is different between the headland on the north side, which is the headland turning to the right, and the headland on the south side, which is the headland turning to the left. In both cases, by setting control values suitable for each headland, it is possible to determine the east-west position of the next line traveling straight ahead and the work after turning at both the north headland and the south headland. Since the position in the east-west direction of the vehicle 1 (running vehicle body 2) can be matched, it is possible to smoothly shift to straight-ahead control after turning.
制御値が標準的な数値である「0」に設定された場合、舵角θdi[deg]は最大でθd-77[deg]程度である。 When the control value is set to "0", which is a standard numerical value, the maximum steering angle θdi [deg] is about θd−77 [deg].
また、式(4)から見て取れるように、スリップがない場合(ωp-ωi=0の場合)で、制御値が標準的な数値である「0」に設定された場合には、舵角が12°だけθdから末切り側へ切り足され、スリップがない場合で、制御値が「+10」に設定された場合には、舵角が0°だけθdから末切り側へ切り足され(切り戻されも切り足されもしない)、スリップがない場合で、制御値が「-10」に設定された場合には、舵角が20°(補正上限値)だけθdから末切り側へ切り足される。このように、切り足し側に補正することも可能としたことにより、浅い圃場や路上等(スリップが少ない状況)に対応することができる。 Further, as can be seen from the equation (4), when there is no slip (when ωp−ωi=0) and the control value is set to the standard numerical value “0”, the steering angle is 12 ° is cut off from θd to the end steering side, and when there is no slip and the control value is set to "+10", the steering angle is cut off by 0° from θd to the end steering side (steering back When there is no slip and the control value is set to "-10", the steering angle is cut by 20° (correction upper limit value) from θd to the end steering side. be. In this way, by making it possible to correct to the cutting side, it is possible to cope with shallow fields, on roads, etc. (situations with little slippage).
一方、図6および図7に示されるように、ステアリングホイール56をθdiの舵角まで回動させると、制御部87は、方位センサ80から出力された検出信号によって判断される機体2の方位と、次の直進走行における目標線との角度差が、60°以下であるか否かを判定する(ステップs7)。 On the other hand, as shown in FIGS. 6 and 7, when the steering wheel 56 is rotated to the steering angle θdi, the controller 87 controls the direction of the airframe 2 determined by the detection signal output from the direction sensor 80. , the angle difference from the target line in the next straight run is determined whether or not it is 60° or less (step s7).
判定の結果、機体2の方位と目標線との角度差が60°を超えている場合には、制御部87は、角度差が60°以下となるまで、ステアリングホイール56の舵角をθdiに保持する。 As a result of the determination, if the angle difference between the azimuth of the airframe 2 and the target line exceeds 60°, the control unit 87 adjusts the steering angle of the steering wheel 56 to θdi until the angle difference becomes 60° or less. Hold.
これに対して、判定の結果、機体2の方位と仮想の目標線との角度差が60°以下である場合には、制御部87は、舵角補正制御を終了し、ステアリングモータ57を駆動して、ステアリングホイール56の舵角をθdに変更する(ステップs8、図6および図7参照)とともに、ピットマンセンサ58による角度の検出に基づくステアリングホイール56の制御に戻す。 On the other hand, if the angle difference between the azimuth of the airframe 2 and the virtual target line is 60° or less as a result of the determination, the control unit 87 terminates the steering angle correction control and drives the steering motor 57. Then, the steering angle of the steering wheel 56 is changed to .theta.d (step s8, see FIGS. 6 and 7), and control of the steering wheel 56 based on angle detection by the pitman sensor 58 is resumed.
なお、舵角補正制御が行われている間、ステアリングホイール56の舵角は、上述のように、θdi[deg]に保持されるが、旋回中に、実際の車速、ステアリングホイール56の舵角、機体2の方位および角速度は時々刻々と変化するため、式(4)内のωp(機体の実際の角速度)、ωi(理想角速度)およびθp(機体の方位)の各値も時々刻々と更新される。したがって、舵角補正制御の間のステアリングホイール56の舵角θdi[deg]も、機体2の方位と仮想の目標線との角度差が60°以下となる(ステップs8)まで、変更(更新)され続ける。このように、本実施態様においては、機体2の方位と目標線との角度差が60°以下となるまでの間、走行車輪8,9のスリップ量と、モニタ61上で設定される舵角補正の制御値とを加味した舵角へ補正された状態が維持される。 While the steering angle correction control is being performed, the steering angle of the steering wheel 56 is held at θdi [deg] as described above. , the azimuth and angular velocity of the aircraft 2 change from moment to moment, so the values of ωp (actual angular velocity of the aircraft), ωi (ideal angular velocity), and θp (azimuth of the aircraft) in Equation (4) are also updated from moment to moment. be done. Therefore, the steering angle θdi [deg] of the steering wheel 56 during the steering angle correction control is also changed (updated) until the angle difference between the azimuth of the airframe 2 and the virtual target line becomes 60° or less (step s8). continue to be Thus, in this embodiment, the slip amount of the running wheels 8 and 9 and the rudder angle set on the monitor 61 are maintained until the angle difference between the azimuth of the machine body 2 and the target line becomes 60° or less. A state in which the steering angle is corrected to the steering angle that takes into account the correction control value is maintained.
こうして、ステアリングホイール56の舵角をθdに変更すると、制御部87は、方位センサ80から出力された検出信号によって判断される機体2の方位と、次の直進走行における仮想の目標線との角度差が、50°以下であるか否かを判定する(ステップs9)。 When the rudder angle of the steering wheel 56 is changed to θd in this way, the controller 87 controls the angle between the azimuth of the airframe 2 determined by the detection signal output from the azimuth sensor 80 and the virtual target line for the next straight travel. It is determined whether or not the difference is 50° or less (step s9).
判定の結果、機体2の方位と次の植付行程(たとえば「2列目」)における仮想の目標線との角度差が50°を超えている場合には、角度差が50°以下となるまで判定が繰り返される。 As a result of the determination, if the angle difference between the azimuth of the aircraft 2 and the virtual target line in the next planting process (for example, "second row") exceeds 50°, the angle difference is 50° or less. Judgment is repeated until
これに対して、判定の結果、機体2の方位と次の直進走行における仮想の目標線との角度差が50°以下である場合には、制御部87は、HSTサーボモータ150を駆動し、車速を0.5m/sに規制する(ステップs10、図6および図7参照)。 On the other hand, if the angle difference between the azimuth of the machine body 2 and the imaginary target line for the next straight traveling is 50° or less as a result of the determination, the control unit 87 drives the HST servo motor 150, The vehicle speed is regulated to 0.5 m/s (step s10, see FIGS. 6 and 7).
作業車両1の車速を0.5m/sに規制すると、制御部87は、次の式(5)によって、ステアリングホイール56を中立位置へ戻し始める機体2の方位を算出する(ステップs11)。
θst=1.32・ωp[deg] ...式(5)
When the vehicle speed of the work vehicle 1 is regulated to 0.5 m/s, the controller 87 calculates the azimuth of the machine body 2 at which the steering wheel 56 starts to return to the neutral position according to the following equation (5) (step s11).
θst=1.32·ωp[deg] . . . Formula (5)
次いで、制御部87は、方位センサ80から出力された検出信号から判断される機体2の方位と、次の直進走行における仮想の目標線との角度差が、算出した角度θst以下であるか否かを判定する(ステップs12)。 Next, the control unit 87 determines whether or not the angular difference between the bearing of the aircraft body 2 determined from the detection signal output from the bearing sensor 80 and the virtual target line for the next straight run is equal to or less than the calculated angle θst. (step s12).
判定の結果、機体2の方位と次の直進走行における目標線との角度差がθst[deg]を超えている場合には、ステアリングホイール56の舵角をθdに保持した状態で、角度差がθst[deg]以下となるまで判定が繰り返される。 As a result of the determination, if the angle difference between the azimuth of the machine body 2 and the target line for the next straight running exceeds θst [deg], the angle difference is The determination is repeated until θst [deg] or less.
これに対して、判定の結果、機体2の方位と次の直進走行における目標線との角度差がθst[deg]以下である場合には、制御部87は、ステアリングモータ57を駆動し、ステアリングホイール56を中立位置に戻す(ステップs13)。その結果、旋回後において、機体2の方位は一定(図5に示される圃場200および走行経路の場合には南向き又は北向き)となる。 On the other hand, if the angle difference between the azimuth of the machine body 2 and the target line for the next straight travel is θst [deg] or less as a result of the determination, the control unit 87 drives the steering motor 57 to perform steering. The wheel 56 is returned to the neutral position (step s13). As a result, after turning, the azimuth of the machine body 2 is constant (towards south or north in the case of the agricultural field 200 and travel route shown in FIG. 5).
なお、本実施態様においては、機体2の方位と次の直進走行における目標線との角度差が、式(5)により算出した角度以下となった時点でステアリングホイール56を中立位置に戻すように構成されているが、θst=180-1.32・ωp[deg]だけ、旋回前の方位からヨー方向に変化した時点で、ステアリングホイール56を中立位置に戻すように構成してもよい。いずれの場合にも、同様の作用を奏することとなる。 In this embodiment, the steering wheel 56 is returned to the neutral position when the angle difference between the azimuth of the airframe 2 and the target line for the next straight run becomes equal to or less than the angle calculated by the formula (5). However, the steering wheel 56 may be returned to the neutral position when the yaw direction is changed by θst=180−1.32·ωp[deg] from the pre-turning orientation. In either case, the same effects are obtained.
このように、本実施態様にかかる旋回制御においては、途中で、ωp-ωiにより算出されたスリップ量と、モニタ61上で設定された舵角補正の制御値とを加味した舵角θdiまでステアリングホイール56が切り戻され、又は切り足される舵角補正制御が行われるように構成されているから、走行車輪8,9のスリップの多少によって過度に小回り又は大回りに旋回してしまうことを防止することができる。 As described above, in the turning control according to the present embodiment, during the course of the turning control, the steering wheel is turned up to the steering angle θdi, which is obtained by adding the slip amount calculated by ωp-ωi and the steering angle correction control value set on the monitor 61 . Since the steering angle correction control is performed by turning back the wheel 56 or cutting it further, it is possible to prevent excessively small or large turns due to the amount of slip of the running wheels 8 and 9. can do.
さらに、旋回制御スイッチ17の操作により実行される旋回制御の結果、万一、作業車両1が、次に直進走行する東西方向の位置(線引きマーカー40によって形成された線の位置であり、仮想の目標線の位置でもある)と異なる位置に旋回してしまう場合(過度に小回り又は大回り)には、作業者は、図8に示される操作スイッチ62を操作し、式(4)中の変数xに代入される制御値を変更することによって、旋回後の作業車両1(走行車体2)の東西方向の位置を調節することができる。 Furthermore, as a result of turning control executed by operating the turning control switch 17, if the work vehicle 1 moves straight ahead next, the position in the east-west direction (the position of the line formed by the line drawing marker 40, which is a virtual (also the position of the target line), the operator operates the operation switch 62 shown in FIG. By changing the control value substituted for , the east-west position of the work vehicle 1 (traveling vehicle body 2) after turning can be adjusted.
こうして、旋回制御が終了すると、制御部87は、車速の規制を解除し、HSTサーボモータ150を駆動して、主変速レバー35の操作位置に応じた車速に変更する。さらに、制御部87は、自動的に苗植付部63を作業位置へ下降させ、苗の植付けを開始するとともに、直進制御を開始する直進アシストレバー79が操作されることなしに、自動的に直進制御に移行する(直進制御を開始する)ように構成されている。 When the turning control is finished in this manner, the control unit 87 releases the vehicle speed regulation, drives the HST servomotor 150, and changes the vehicle speed according to the operating position of the main shift lever 35. FIG. Furthermore, the control unit 87 automatically lowers the seedling planting unit 63 to the working position to start planting seedlings, and automatically without operating the straight advance assist lever 79 for starting straight advance control. It is configured to shift to straight-ahead control (start straight-ahead control).
その結果、作業車両1は、図5に「2列目」として示された位置を、南へ走行しつつ、「1列目」の位置を北へ走行した際に植付けられた苗に対して適切な間隔で、その東側に苗を植え付けることができる。 As a result, the work vehicle 1 traveled southward at the position shown as "second row" in FIG. At appropriate intervals, seedlings can be planted on its east side.
直進制御のもとに、作業車両1が周縁領域211に近づくと、作業者によって直進アシストレバー79が上方に揺動操作されて、制御部87による直進制御が終了される。 When the work vehicle 1 approaches the peripheral area 211 under the straight-ahead control, the operator swings the straight-ahead assist lever 79 upward, and the straight-ahead control by the control unit 87 is terminated.
次いで、作業者によって図4に示されたフィンガーレバー23が上方に揺動操作されて、苗植付部63が上昇されるとともに、「1列目」から「2列目」へ旋回する場合と同様にして、旋回制御による「2列目」から「3列目」への旋回が行われる。 Next, the operator swings upward the finger lever 23 shown in FIG. 4 to raise the seedling planting portion 63 and turn it from the "first row" to the "second row." Similarly, turning from the “second row” to the “third row” is performed by turning control.
以下、同様にして、作業車両1は、苗の植付けを伴う直進走行(図5に一点鎖線で図示)と、旋回制御による旋回(図5に二点鎖線で図示)とを繰り返しながら、「n列目」の位置まで走行する。 Thereafter, in the same way, the work vehicle 1 repeats straight traveling accompanied by planting seedlings (indicated by the dashed line in FIG. 5) and turning by turning control (indicated by the dashed line in FIG. 5) while repeating "n Run to the position of "row".
こうして、中央領域210全体に苗を植え付けた後に、作業車両1は、作業者による操縦に基づき、周縁領域211ないし214を順に走行しつつ、苗を植え付ける。その結果、圃場200全体に苗が植え付けられる。 After planting the seedlings in the entire central area 210 in this way, the work vehicle 1 plants the seedlings while traveling through the peripheral areas 211 to 214 in order under the control of the operator. As a result, seedlings are planted all over the field 200 .
以上、直進制御と「Uターン旋回」の形式による旋回制御とを交互に行いつつ、圃場に苗を植え付ける方法について、詳細に説明を加えたが、旋回制御スイッチ17の操作により「バック旋回」に設定された場合には、以下のようにして旋回制御が行われる。 A method for planting seedlings in a field while alternately performing straight-ahead control and turning control in the form of "U-turn turning" has been described above in detail. When set, turning control is performed as follows.
図9は、「バック旋回」の形式による旋回制御の手順を示すフローチャートである。 FIG. 9 is a flow chart showing the procedure of turning control in the form of "back turning".
図9に示されるように、「バック旋回」の形式による旋回制御に先立って、図5に示される「1列目」等の各直進走行の列にて、直進アシストレバー79が上方に揺動操作されて、制御部87による直進制御が終了した後に、作業者の操縦により作業車両1が走行し、枕地である周縁領域211または213の畔際の位置で停車する。苗が不足している場合には、このタイミングで作業者又は畔にいる補助者により苗の補給が行われる。 As shown in FIG. 9, the straight-travel assist lever 79 swings upward in each straight-travel row such as the "first row" shown in FIG. After the control unit 87 completes straight-ahead control, the work vehicle 1 travels under the control of the operator and stops at the edge of the peripheral edge region 211 or 213, which is a headland. If there is a shortage of seedlings, seedlings are replenished by the worker or an assistant at the bank at this timing.
次いで、主変速レバー35が後進領域(図4(b)参照)に操作されると、「バック旋回」の形式による旋回制御が開始される。 Next, when the main transmission lever 35 is operated to the reverse region (see FIG. 4(b)), turning control in the form of "back turning" is started.
作業車両1の後進により旋回制御が開始されると、まず、制御部87は、記憶部93より、旋回目標位置までの距離のデータを取得する(ステップss1)。旋回目標位置の定義は、「Uターン旋回」の場合と同様である。 When the turning control is started by the work vehicle 1 moving backward, first, the control unit 87 acquires the data of the distance to the turning target position from the storage unit 93 (step ss1). The definition of the turning target position is the same as in the case of "U-turn turning".
次いで、制御部87は、ステアリングホイール56を中立位置に戻すとともに、機体2を所定の距離だけ更新させ、停車させる。本実施態様においては、後輪回転センサ29の検出信号に基づき、106cmだけ機体を後進させるように構成されている。 Next, the control unit 87 returns the steering wheel 56 to the neutral position, updates the airframe 2 by a predetermined distance, and stops the vehicle. In this embodiment, based on the detection signal of the rear wheel rotation sensor 29, the aircraft is configured to move backward by 106 cm.
こうして、機体2が停車すると、制御部87は、車速を0.75[m/s]に規制しつつ、機体を前進させるとともに、ステアリングモータ57を駆動し、所定の舵角θd[deg]となるように、ステアリングホイール56を次の作業条の方向(「2列目」への旋回時は右側)への回動を開始する(ステップss2)。 Thus, when the machine body 2 stops, the controller 87 advances the machine body while restricting the vehicle speed to 0.75 [m/s], drives the steering motor 57, and controls the steering angle θd [deg]. Then, the steering wheel 56 is started to rotate in the direction of the next work row (to the right when turning to the "second row") (step ss2).
以下、「Uターン旋回」の場合のステップs3ないしs13(図6参照)と同様の制御が行われる。 Thereafter, control similar to that of steps s3 to s13 (see FIG. 6) in the case of "U-turn turning" is performed.
図1ないし図9に示された本実施態様によれば、旋回制御において、標準的な条件の圃場で旋回目標位置に旋回可能な所定の舵角であるθd[deg]から、目標舵角θdi[deg]へステアリングホイール56の舵角補正が行われるように構成され、この目標舵角θdi[deg]を算出する式(4)において、走行車輪8,9のスリップ量の度合いを表す相関値「(ωp-ωi)」を含む項「-(1.5・(ωp-ωi))・sinθp・cos(θp/2)・(10+x)」が、所定の舵角θd[deg]からステアリングホイール56の中立位置側に舵角を補正するように機能する項であるから、スリップ量に応じてステアリングホイール56の舵角を中立位置側に補正することができる。 According to the present embodiment shown in FIGS. 1 to 9, in the turning control, the target steering angle θdi In the equation (4) for calculating the target steering angle θdi [deg], the correlation value representing the degree of the slip amount of the running wheels 8, 9 The term “-(1.5.(ωp-ωi)).sinθp.cos(θp/2).(10+x)” including “(ωp-ωi)” is the steering wheel Since this term functions to correct the steering angle of the steering wheel 56 toward the neutral position side, the steering angle of the steering wheel 56 can be corrected toward the neutral position side in accordance with the slip amount.
したがって、スリップ量が多い場合でも、過度に小回りに旋回してしまうことを防止でき、走行車輪8,9のスリップ量を加味した舵角で、一定の旋回半径で旋回目標位置である次の植付行程の位置へ作業車両1を安定的に旋回させることができる。 Therefore, even when the amount of slip is large, it is possible to prevent the vehicle from turning in an excessively small turn. The work vehicle 1 can be stably turned to the position of the additional stroke.
加えて、このように、走行車輪8,9のスリップを加味した舵角で旋回を行うことができるから、旋回時に別途走行経路を設定し、その走行経路に沿うようにステアリングホイール56を度々回動させる必要がなく、したがって、旋回目標位置である次の植付行程の位置へ作業車両1を安定的に旋回させつつも、機体2のカクつきを防止し、挙動を安定させることができる。 In addition, since it is possible to turn at a steering angle that takes into consideration the slip of the running wheels 8 and 9, a separate travel route is set during turning, and the steering wheel 56 is frequently rotated along the travel route. Therefore, while stably turning the working vehicle 1 to the position of the next planting stroke, which is the turning target position, jerking of the body 2 can be prevented and the behavior can be stabilized.
また、本実施態様によれば、旋回時の走行車輪8,9のスリップ量の度合いを表す相関値「(ωp-ωi)」が0未満である場合には、かかる相関値を0として目標舵角θdiを算出するように構成されているから、不適切な舵角の補正を防止することができる。 Further, according to the present embodiment, when the correlation value "(ωp-ωi)" representing the degree of slip of the running wheels 8, 9 during turning is less than 0, the correlation value is set to 0 and the target steering angle is calculated. Since the angle θdi is calculated, inappropriate correction of the steering angle can be prevented.
さらに、本実施態様によれば、目標舵角θdiを算出する式(4)に、作業者により設定される舵角補正の制御値(図8(a)及び図8(b)参照)が代入される変数xを含む項「1.5・(10-x)」が含まれているから、作業者により設定される制御値を加味した舵角で、旋回目標位置である次の植付行程の位置へ作業車両1を精度よく旋回させることができる。加えて、この項「1.5・(10-x)」が、ステアリングホイール56の舵角を所定の舵角θd[deg]から末切り位置側に補正するように機能する項であるから、浅い圃場などのスリップ量の少ない状況において、過度に大回りしてしまう事態を防止することができる。 Furthermore, according to this embodiment, the steering angle correction control value (see FIGS. 8A and 8B) set by the operator is substituted into the equation (4) for calculating the target steering angle θdi. Since the term "1.5 (10-x)" including the variable x that is set by the operator is included, the steering angle that takes into account the control value set by the operator is the turning target position, which is the next planting stroke The work vehicle 1 can be accurately turned to the position of . In addition, since this term "1.5·(10−x)" is a term that functions to correct the steering angle of the steering wheel 56 from the predetermined steering angle θd [deg] toward the end-cut position, It is possible to prevent the situation of excessively turning in a situation where the amount of slip is small, such as in a shallow field.
また、本実施態様によれば、ステアリングホイール56の舵角をθd、θdi、θd、中立位置へと順次に変更することにより、作業車両1を精確な位置へ旋回させることができるから、旋回時に走行経路を別途設定し、その走行経路に沿うようにステアリングホイールを度々回動させる必要がないため、制御を簡潔にできる。 Further, according to this embodiment, by sequentially changing the steering angle of the steering wheel 56 to .theta.d, .theta.di, .theta.d, and to the neutral position, the work vehicle 1 can be turned to an accurate position. Since there is no need to separately set a travel route and frequently turn the steering wheel along the travel route, control can be simplified.
また、本実施態様によれば、旋回制御により作業車両1が旋回している間に、ステアリングホイール56を回動させるステアリングモータ57を駆動する制御手段である制御部87が、走行車体2の車速が低いほどステアリングホイール56の回動速度が低くなるように、主変速レバー35の操作位置に応じて印加電圧を変更し、ステアリングホイール56の回動速度の上限値を変更するよう構成されているから、旋回制御における旋回半径をより一層安定させることができ、作業車両1を次の植付行程の位置へ安定的に旋回させることができる。 Further, according to this embodiment, while the work vehicle 1 is turning by turning control, the control unit 87, which is the control means for driving the steering motor 57 that rotates the steering wheel 56, controls the vehicle speed of the traveling vehicle body 2. The upper limit value of the rotation speed of the steering wheel 56 is changed by changing the applied voltage according to the operating position of the main shift lever 35 so that the rotation speed of the steering wheel 56 decreases as the value of . Therefore, the turning radius in turning control can be further stabilized, and the work vehicle 1 can be stably turned to the position of the next planting stroke.
さらに、本実施態様によれば、旋回制御において、ステアリングホイール56の回動方向が切り換わる前後に、ステアリングホイール56を回動させるステアリングモータ57の回転速度を低く抑えるように構成されているから、ステアリングホイール56の回動方向が切り換わる際の衝撃を低減し、ステアリングホイール56からステアリングモータ57までの間でギア鳴りが発生してしまうことを防止することができる。 Furthermore, according to this embodiment, in turning control, before and after the rotation direction of the steering wheel 56 is switched, the rotation speed of the steering motor 57 for rotating the steering wheel 56 is kept low. It is possible to reduce the impact when the rotation direction of the steering wheel 56 is switched, and prevent gear noise from occurring between the steering wheel 56 and the steering motor 57 .
さらに、本実施態様によれば、土壌の肥沃度のデータを取得する距離間隔が、圃場に苗を植え付ける条間の距離(30cm)に等しく構成されているから、安定してサンプリングを行えることに加え、斜めや横方向に走行しつつティーチングを行うときでも、およそ隣接する条(苗の列)ごとにデータを取得することができる。 Furthermore, according to this embodiment, the distance interval for acquiring soil fertility data is equal to the distance between rows (30 cm) for planting seedlings in a field, so that sampling can be performed stably. In addition, even when teaching is performed while running diagonally or laterally, data can be obtained for each adjacent row (row of seedlings).
さらに、本実施態様によれば、旋回制御において、走行車輪8,9のスリップの度合いを表す相関値に応じてステアリングホイール56が切り戻され、又は切り足される際の回動量(回動角度)「-(1.5・(ωp-ωi))・sinθp・cos(θp/2)・(10+x)+1.5・(10-x)」[deg]を、図8に示されるように、モニタ61上で制御値を変更することにより増減させることができるから、旋回後の作業車両1の位置を、モニタ61上で容易に調節することができる。 Furthermore, according to this embodiment, in turning control, the amount of rotation (rotation angle ) “-(1.5.(ωp-ωi)).sinθp.cos(θp/2).(10+x)+1.5.(10-x)” [deg] as shown in FIG. Since it can be increased or decreased by changing the control value on the monitor 61 , the position of the work vehicle 1 after turning can be easily adjusted on the monitor 61 .
また、本実施態様によれば、左側へ旋回する場合と、右側へ旋回する場合とで、別々の制御値をモニタ61上で設定することができるから、圃場上の一方の枕地(北側の枕地)と、他方の枕地(南側の枕地)との間で圃場条件が異なる場合に、各枕地で、旋回後の作業車両1の位置を適切に調節することができる。 Further, according to this embodiment, different control values can be set on the monitor 61 for turning to the left and for turning to the right. headland) and the other headland (southern headland), the position of the work vehicle 1 after turning can be appropriately adjusted at each headland.
図10は、本発明の他の好ましい実施態様にかかる作業車両1の制御部87による旋回制御の手順を示すフローチャートである。 FIG. 10 is a flow chart showing the procedure of turning control by the control unit 87 of the work vehicle 1 according to another preferred embodiment of the present invention.
本実施態様にかかる作業車両1は、7条植えの苗植付部63(作業機の一例)を備えた田植機として構成されており旋回目標位置までの距離(たとえば「1列目」と「2列目」との間の距離)が210cm(条間30cm×苗7条分)であるため、図1ないし図9に示された前記実施態様にかかる作業車両1の場合よりも30cmだけ短く設定されている。 The working vehicle 1 according to the present embodiment is configured as a rice transplanter having a seedling planting section 63 (an example of a working machine) for planting seven rows, and the distance to the turning target position (for example, "first row" and " 2nd row") is 210 cm (30 cm between rows × 7 rows of seedlings), so it is 30 cm shorter than the work vehicle 1 according to the embodiment shown in FIGS. is set.
そのため、旋回制御において、制御部87は、標準的な条件の圃場で、旋回目標位置に旋回可能な所定の舵角θd[deg]が、前記実施態様の場合の所定の舵角θd[deg]よりも末切り位置側に位置しており(中立位置からの舵角θd[deg]が前記実施態様の場合よりも大きい)、ステアリングホイール56をほぼ末切り位置まで切った状態で旋回がスタートする。 Therefore, in the turning control, the control unit 87 determines that the predetermined steering angle θd [deg] that enables turning to the turning target position in the farm field under standard conditions is equal to the predetermined steering angle θd [deg] in the case of the above-described embodiment. (the steering angle θd [deg] from the neutral position is larger than in the above embodiment), and turning starts with the steering wheel 56 turned almost to the end-turn position. .
ここで、上述のように、補正後の目標舵角θdiの範囲は、θd-100≦θdi≦θd+20[deg]であり、所定の舵角θd[deg]からの補正幅は、-100°ないし+20°に構成されており、末切り位置側への補正値(舵角θdからの切り足し方向の補正)の上限(最大値)は+20°である。 Here, as described above, the range of the target steering angle θdi after correction is θd−100≦θdi≦θd+20 [deg], and the range of correction from the predetermined steering angle θd [deg] is from −100° to +20°, and the upper limit (maximum value) of the correction value toward the end-steering position side (correction in the direction of additional cutting from the steering angle θd) is +20°.
しかしながら、7条植えの苗植付部63を有する作業車両1においては、舵角θdがほぼ末切り位置であり、補正前の舵角θd[deg]が、末切り位置より補正上限角度(+20°)以上中立位置側に位置していない。換言すれば、所定の舵角θd[deg]に、補正上限角度を足すと、末切り位置を上回る角度となる。したがって、切り足し側への充分な舵角補正を行うことができないため、本実施態様においては、中立位置へ切り戻すタイミング(図6におけるステップs11で算出される機体2の方位)を補正することにより、旋回目標位置へ旋回できるように構成されており、以下に、「Uターン旋回」の形式による旋回制御における中立位置へ切り戻すタイミングの補正について説明を加える。 However, in the work vehicle 1 having the seedling planting portion 63 with 7 rows, the steering angle θd is almost at the end-cutting position, and the steering angle θd [deg] before correction is the corrected upper limit angle (+20 degrees) from the end-cutting position. °) is not located on the neutral position side. In other words, when the correction upper limit angle is added to the predetermined steering angle θd [deg], the angle exceeds the end steering position. Therefore, since it is not possible to sufficiently correct the steering angle toward the cutting side, in this embodiment, it is necessary to correct the timing of steering back to the neutral position (the azimuth of the airframe 2 calculated in step s11 in FIG. 6). In the following, the correction of the timing of turning back to the neutral position in the turning control in the form of "U-turn turning" will be explained.
本実施態様においては、旋回目標位置までの距離のデータを取得した(ステップsss1)後に、制御部87は、車速を0.75[m/s]に規制するとともに、ステアリングモータ57を駆動し、所定の舵角θd[deg]となるように、ステアリングホイール56を、次の植付行程の側へ回動させる(ステップsss2)。 In this embodiment, after obtaining data on the distance to the turning target position (step sss1), the control unit 87 regulates the vehicle speed to 0.75 [m/s], drives the steering motor 57, The steering wheel 56 is rotated toward the next planting stroke so that the steering angle θd [deg] is set to a predetermined value (step sss2).
次いで、制御部87は、機体の方位センサ80から出力された検出信号によって判断される機体2の方位と、次の直進走行における仮想の目標線との角度差が、50°以下であるか否かを判定する(ステップsss3)。 Next, the control unit 87 determines whether the angle difference between the direction of the aircraft 2 determined by the detection signal output from the direction sensor 80 of the aircraft and the virtual target line for the next straight run is 50° or less. (step sss3).
判定の結果、機体2の方位と次の植付行程(たとえば「2列目」)における仮想の目標線との角度差が50°を超えている場合には、角度差が50°以下となるまで判定が繰り返される。 As a result of the determination, if the angle difference between the azimuth of the aircraft 2 and the virtual target line in the next planting process (for example, "second row") exceeds 50°, the angle difference is 50° or less. Judgment is repeated until
これに対して、判定の結果、機体2の方位と次の植付行程における仮想の目標線との角度差が50°以下である場合には、制御部87は、HSTサーボモータ150を駆動し、車速を0.5m/sに規制する(ステップsss4)。 On the other hand, as a result of determination, when the angle difference between the azimuth of the machine body 2 and the virtual target line in the next planting process is 50° or less, the control unit 87 drives the HST servomotor 150. , the vehicle speed is regulated to 0.5 m/s (step sss4).
作業車両1の車速を0.5m/sに規制すると、制御部87は、次の式(6)によって、ステアリングホイール56を中立位置へ戻し始める機体2の方位を算出する(ステップsss5)。
θst=1.38・ωp+x[deg] ...式(6)
When the vehicle speed of the work vehicle 1 is regulated to 0.5 m/s, the controller 87 calculates the azimuth of the machine body 2 at which the steering wheel 56 starts to return to the neutral position according to the following equation (6) (step sss5).
.theta.st=1.38..omega.p+x[deg]. . . Formula (6)
ωpは、前記実施態様の場合と同様に、ωp=10・{θp-θ(p-1)}[deg/sec]により算出される値であり、xは、前記実施態様の場合と同様に、モニタ61上で設定された制御値である。 ωp is a value calculated by ωp=10·{θp−θ(p−1)}[deg/sec] as in the above embodiment, and x is the same as in the above embodiment. , are control values set on the monitor 61 .
次いで、制御部87は、方位センサ80から出力された検出信号から判断される機体2の方位と、次の直進走行における仮想の目標線との角度差が、式(6)により算出した角度θst以下であるか否かを判定する(ステップsss6)。 Next, the control unit 87 determines that the angle difference between the bearing of the airframe 2 determined from the detection signal output from the bearing sensor 80 and the virtual target line for the next straight travel is the angle θst calculated by the equation (6). It is determined whether or not (step sss6).
判定の結果、機体2の方位と次の植付行程(直進走行)における目標線との角度差がθst[deg]を超えている場合には、ステアリングホイール56の舵角をθdに保持した状態で、角度差がθst[deg]以下となるまで判定が繰り返される。 As a result of the determination, if the angle difference between the azimuth of the machine body 2 and the target line in the next planting stroke (straight running) exceeds θst [deg], the steering angle of the steering wheel 56 is held at θd. , the determination is repeated until the angular difference becomes equal to or less than θst [deg].
これに対して、判定の結果、機体2の方位と次の直進走行における目標線との角度差がθst[deg]以下である場合には、制御部87は、ステアリングモータ57を駆動し、ステアリングホイール56を中立位置に戻す(ステップsss7)。 On the other hand, if the angle difference between the azimuth of the machine body 2 and the target line for the next straight travel is θst [deg] or less as a result of the determination, the control unit 87 drives the steering motor 57 to perform steering. The wheel 56 is returned to the neutral position (step sss7).
このように、本実施態様においては、モニタ61上で設定された制御値も加味した機体方位(タイミング)でステアリングホイール56を中立位置に切り戻すように構成されているから、旋回目標位置へ精度よく旋回することができる。 As described above, in this embodiment, the steering wheel 56 is turned back to the neutral position at the machine direction (timing) in consideration of the control value set on the monitor 61. Can turn well.
なお、本実施態様においては、機体2の方位と次の直進走行における目標線との角度差が、式(5)により算出した角度以下となった時点でステアリングホイール56を中立位置に戻すように構成されているが、θst=180-1.38・ωp[deg]だけ、旋回前の方位からヨー方向に機体の向きが変化した時点で、ステアリングホイール56を中立位置に戻すように構成してもよい。いずれの場合にも、同様の作用を奏することとなる。 In this embodiment, the steering wheel 56 is returned to the neutral position when the angle difference between the azimuth of the airframe 2 and the target line for the next straight run becomes equal to or less than the angle calculated by the formula (5). However, the steering wheel 56 is returned to the neutral position when the orientation of the airframe changes from the orientation before turning to the yaw direction by θst=180−1.38·ωp [deg]. good too. In either case, the same effects are obtained.
こうして、旋回制御を終えると、制御部87は、車速の規制を解除し、HSTサーボモータ150を駆動して、主変速レバー35の操作位置に応じた車速に変更する。 When turning control is finished in this manner, the control unit 87 releases the vehicle speed regulation, drives the HST servomotor 150 , and changes the vehicle speed according to the operating position of the main shift lever 35 .
なお、本実施態様にかかる作業車両1は、苗の植付条数が7条である点および上述した旋回制御の違いを除き、前記実施態様の作業車両1と同様に構成されている。 The working vehicle 1 according to the present embodiment is configured in the same manner as the working vehicle 1 of the above-described embodiment except that the number of seedling planting rows is seven and the above-described difference in turning control is different.
図11は、図10に示された実施態様にかかるモニタ61に表示される苗取量を設定する画面を示す図面であり、図11(a)は、苗取量を設定する画面において、標準的な苗取量に設定された状態を示す図面であり、図11(b)、図11(c)および図11(d)は、苗取量を設定する画面において、密播用の苗取量に設定された状態を示す図面である。 FIG. 11 is a drawing showing a screen for setting the seeding amount displayed on the monitor 61 according to the embodiment shown in FIG. Fig. 11(b), Fig. 11(c) and Fig. 11(d) are drawings showing a state in which a seeding amount is set to a reasonable seeding amount, and Figs. It is drawing which shows the state set to quantity.
図11に示されるように、苗取量を設定する画面には、11つの目盛りからなるインジケータが設けられており、インジケータ上にて右側を選択するほど苗取量が多く設定される。 As shown in FIG. 11, the screen for setting the amount of seedling collection is provided with an indicator consisting of 11 scales, and the more the right side is selected on the indicator, the larger the amount of seedling collection is set.
ここで、インジケータの左側3つの目盛り(数値でいう「-1」ないし「-3」)の下方には、密播に適した範囲を示す表示101が設けられており、作業者は、苗箱から取り出された苗から植付具69により一度に掻き取られる苗の量である苗取量について、密播に適した量の範囲を直感的かつ容易に把握できる。したがって、密播用に装着されるオプションの部品の装着の有無を検出するセンサ等の部品を別途設けた上で、オプションの部品の装着時に、設定可能な苗取量の範囲を自動的に限定する等の構成を設ける必要がなく、このように苗取量を設定する画面に、密播に適した範囲を表示するだけで、センサ等にかかるコストを容易に削減することができる。 Here, below the three scales on the left side of the indicator ("-1" to "-3" in terms of numerical values), a display 101 indicating a range suitable for dense seeding is provided. With respect to the amount of seedlings that are scraped at one time by the planting tool 69 from the seedlings taken out from the seedlings, the range of the amount suitable for dense seeding can be intuitively and easily grasped. Therefore, after installing a separate part such as a sensor that detects the presence or absence of the optional part installed for dense seeding, the range of seedling volume that can be set is automatically limited when the optional part is installed. There is no need to provide a configuration such as to set the amount of seedlings, and simply displaying the range suitable for dense seeding on the screen for setting the amount of seedlings can easily reduce the cost of sensors and the like.
一方、図12(a)は、さらに他の実施態様にかかる作業車両の前部に設けられたカメラとその撮像範囲を示す模式的側面図であり、図12(b)は、カメラにより撮像された棚田の畔と圃場とを2値化した状態を示す模式図である。 On the other hand, FIG. 12(a) is a schematic side view showing a camera provided in the front part of a work vehicle according to still another embodiment and its imaging range, and FIG. FIG. 10 is a schematic diagram showing a binarized state of the edge of the terraced rice field and the field.
図12(a)に示されるカメラ78は、2条式の小型ロボット田植機として構成された作業車両の前部に設けられており、車両の前下方を撮像可能に構成されている。 A camera 78 shown in FIG. 12(a) is provided at the front of a working vehicle configured as a two-row small robot rice transplanter, and is configured to be able to image the front and lower sides of the vehicle.
制御部は、記憶部に格納されている簡易的なプログラムを読み出し、実行することにより、カメラ78により撮像された画像を、図12(b)の吹き出し内に示されるように2値化し、撮像された範囲を、苗が植え付けられる圃場と畔とに区別するように構成されている。このように、GNSS等の位置情報なしに、簡易的な手法で、苗を植え付けるエリアを決定できるため、形状がいびつで面積が狭い棚田においても、作業車両を用いて効率的に苗を植えつけることができ、労力を大幅に削減することが可能になる。また、GNSS受信機を車両に設けた場合には、取得された位置情報に基づき、エリア内に正確な植付け走行を行うことができる。 The control unit reads out and executes a simple program stored in the storage unit to binarize the image captured by the camera 78 as shown in the balloon in FIG. The area is divided into a field where seedlings are planted and a ridge. In this way, since the area for planting seedlings can be determined by a simple method without positional information such as GNSS, even in terraced rice fields with irregular shapes and small areas, seedlings can be efficiently planted using work vehicles. can be done and the labor can be greatly reduced. Moreover, when a GNSS receiver is provided in a vehicle, it is possible to perform accurate planting travel within the area based on the acquired position information.
また、図12(b)に破線で示されるように、カメラ78による撮像範囲は帯状であってもよく、この場合には、カメラ78から一定距離だけ前側に位置する撮像範囲に向かって直進するようにステアリングホイールを操舵するように構成することにより、畔際に沿って圃場1周を植付けすることができる。 12(b), the imaging range of the camera 78 may be band-shaped, and in this case, the camera 78 moves straight toward the imaging range located a certain distance forward from the camera 78. By configuring so as to steer the steering wheel in this way, it is possible to plant one round of the field along the bank.
本発明は、以上の実施態様に限定されることなく、特許請求の範囲に記載された発明の範囲内で種々の変更が可能であり、それらも本発明の範囲内に包含されるものであることはいうまでもない。 The present invention is not limited to the above embodiments, and various modifications are possible within the scope of the invention described in the claims, and these are also included in the scope of the present invention. Needless to say.
例えば、図1ないし図10に示された各実施態様においては、作業車両1は、田植え機として構成されているが、トラクターやコンバインなどの他の作業車両として構成してもよい。 For example, in each embodiment shown in FIGS. 1 to 10, the work vehicle 1 is configured as a rice planter, but may be configured as other work vehicles such as a tractor and a combine.
また、図1ないし図10に示された各実施態様においては、「ヨー方向角速度検出手段」として、方位センサが用いられているが、IMUなどのジャイロセンサを用いて、走行車体のヨー方向の角速度を検出するように構成してもよい。 In each of the embodiments shown in FIGS. 1 to 10, a direction sensor is used as the "yaw direction angular velocity detection means". It may be configured to detect angular velocity.
さらに、図1ないし図10に示された各実施態様においては、「Uターン旋回」の形式で、フィンガーレバー23が上方に回動されたことを旋回制御の開始条件として構成されているが、旋回制御の開始条件はこれに限られない。 Further, in each of the embodiments shown in FIGS. 1 to 10, turning control is started when the finger lever 23 is rotated upward in the form of "U-turn turning". The turning control start condition is not limited to this.
さらに、図1ないし図9に示された実施態様においては、スリップ量(スリップの度合いを表す相関値)、すなわち、理想角速度と実際の角速度との差分に基づいて、ステアリングホイール56を切り戻す量を調節するように構成されているが、スリップ量である理想角速度と実際の角速度との差分の値が所定の値以上である場合に、走行車輪をデフロックするように構成してもよい。このように構成することによって、走行車輪のスリップが発生し、作業車両がほとんど移動せずに、その場で回ってしまうような場合に、過度に小回りに旋回してしまう事態を防止することができ、また、走行駆動力を向上させ、走行車輪のスリップを解消することができる。 Further, in the embodiments shown in FIGS. 1 to 9, the steering wheel 56 is turned back based on the slip amount (correlation value representing the degree of slip), that is, the difference between the ideal angular velocity and the actual angular velocity. However, if the difference between the ideal angular velocity, which is the amount of slip, and the actual angular velocity is greater than or equal to a predetermined value, the running wheels may be differentially locked. By constructing in this way, in the case where a slip of the traveling wheels occurs and the work vehicle turns on the spot without moving, it is possible to prevent the situation in which the work vehicle makes an excessively small turn. In addition, it is possible to improve the running driving force and eliminate the slip of the running wheels.
さらに、図1ないし図9に示された実施態様においては、制御部87は、トレッド幅やホイールベースに基づき設定された「0.071」という値のパラメータを用いて、理想角速度ωiを算出するように構成されているが、走行車体2に補助車輪が別途取り付けられた場合に、たとえば、モニタ61上で、補助車輪が取り付けられた旨を作業者が設定すると、制御部87がパラメータの値を適切な値に変更して、理想角速度ωiを算出するように構成してもよい。このように構成することによって、走行車体2に補助車輪が取り付けられて走行車体2が大回りする傾向にある場合においても、旋回時の理想角速度ωiを正確に算出し、走行車輪のスリップを的確に加味した舵角補正制御を行うことができる。 Furthermore, in the embodiments shown in FIGS. 1 to 9, the control unit 87 calculates the ideal angular velocity ωi using a parameter with a value of "0.071" set based on the tread width and wheelbase. However, when auxiliary wheels are separately attached to the traveling vehicle body 2, for example, when the operator sets that the auxiliary wheels are attached on the monitor 61, the control unit 87 changes the parameter value may be changed to an appropriate value to calculate the ideal angular velocity ωi. With this configuration, even when the traveling vehicle body 2 tends to make a large turn because the auxiliary wheels are attached to the traveling vehicle body 2, the ideal angular velocity ωi during turning can be accurately calculated, and the slip of the traveling wheels can be accurately controlled. Steering angle correction control with consideration can be performed.
また、図1ないし図10に示された各実施態様においては、可変施肥に先立って行われるティーチング時に、1条間の距離である30cmごとに肥沃度のデータ、すなわち、圃場の電気伝導度、圃場の深度および温度のデータを取得し、走行距離の取得手段である後輪回転センサ29とGNSS受信機130のいずれもが故障している場合に限り、0.2秒の倍数秒ごとの設定された間隔で肥沃度のデータを取得するよう構成されているが、走行距離の取得手段を用いずに、常時、0.2秒の倍数秒ごとの設定された間隔で肥沃度のデータを取得するよう構成してもよい。 In addition, in each of the embodiments shown in FIGS. 1 to 10, during teaching performed prior to variable fertilization, fertility data, that is, field electrical conductivity, Only when both the rear wheel rotation sensor 29 and the GNSS receiver 130, which are the means for obtaining the distance traveled and the depth and temperature data of the field are out of order, are set every multiple seconds of 0.2 seconds. The fertility data is acquired at a set interval, but the fertility data is always acquired at a set interval of every multiple of 0.2 seconds without using the means for acquiring the mileage. may be configured to
ここで、従来の田植機において上述のように0.2秒ごとに土壌の肥沃度のデータを取得する場合で、圃場が広い場合には、ティーチングが完了するまでに0.2秒×250回(個)を上回るデータが取得され、データの平均値、標準偏差を算出するのに浮動小数点、平方根の計算等のCPUの負荷の高い処理が行われるため、データ数の上限を250回(個)に制限することにより、CPUが処理落ちしてしまうことの防止が図られていた。そのため、圃場の端から端までの肥沃度のデータが取得できていないことがあった。 Here, when the conventional rice transplanter acquires soil fertility data every 0.2 seconds as described above, if the field is wide, it takes 0.2 seconds × 250 times to complete teaching. Since more than (number) of data is acquired, high CPU load processing such as floating point and square root calculations is performed to calculate the average value and standard deviation of the data, so the upper limit of the number of data is set to 250 (number) ) to prevent the CPU from failing in processing. As a result, data on fertility from end to end of the field could not be obtained.
これに対し、0.2秒の倍数秒ごとの設定された間隔で肥沃度のデータを取得可能に構成した場合には、0.2秒に設定されたときを除き、従来に比して取得可能な時間を延ばすことができるため、圃場内でデータを取得できなかった場所が生じることを抑制することが可能になる。 On the other hand, when the fertility data is configured to be acquired at intervals set in multiples of 0.2 seconds, except when set to 0.2 seconds, acquisition Since the possible time can be extended, it is possible to suppress the occurrence of places in the field where data could not be obtained.
さらに、図1ないし図9に示された実施態様においては、目標舵角θdiを算出する式(4)が、所定の舵角を有する項と、旋回時の走行車輪のスリップ量の度合いを表す相関値を含む項と、作業者により設定される舵角補正の制御値が代入される変数を含む項とを含んでいるが、作業者により設定される舵角補正の制御値が代入される変数を含む項を含むことは必ずしも必要でない。 Further, in the embodiments shown in FIGS. 1 to 9, the formula (4) for calculating the target steering angle θdi expresses a term having a predetermined steering angle and the degree of slip of the running wheels during turning. A term containing a correlation value and a term containing a variable into which a control value for steering angle correction set by the operator is substituted, but the control value for steering angle correction set by the operator is substituted. It is not necessary to include terms containing variables.
したがって、たとえば、θdi=θd-(1.5・(ωp-ωi))・sinθp・cos(θp/2)・(10+x)[deg]の式により制御部87がθdiを算出するように構成してもよく、また、θdi=θd-(ωp-ωi)・sinθp・cos(θp/2)・(10+x)[deg]の式により制御部87がθdiを算出するように構成してもよい。これらの式によれば、走行車輪のスリップ量に応じた量だけ所定の舵角θd[deg]から切り戻し方向(中立位置側)のみにステアリングホイールの舵角補正が行われる。また、所定の舵角θdを有する項が「θd」であることは必ずしも必要でなく、たとえば、「1.1θd」等、数値とθdの両方を含む項であってもよく、「yθd」等、変数とθdの両方を含む項であってもよい。 Therefore, for example, the controller 87 is configured to calculate θdi by the formula θdi=θd−(1.5·(ωp−ωi))·sin θp·cos(θp/2)·(10+x) [deg]. Alternatively, the controller 87 may be configured to calculate θdi by the formula θdi=θd−(ωp−ωi)·sin θp·cos(θp/2)·(10+x) [deg]. According to these formulas, the steering angle of the steering wheel is corrected only in the steering-back direction (neutral position side) from the predetermined steering angle θd [deg] by an amount corresponding to the slip amount of the running wheels. Also, the term having the predetermined steering angle θd does not necessarily have to be "θd". , may be a term that includes both variables and θd.
1 作業車両
2 走行車体
3 メインフレーム
4 ベルト式動力伝達機構
5 昇降リンク装置
6 後部フレーム
7 エンジン
8 前輪
9 後輪
10 リンクベースフレーム
11 上下リンクアーム
12 昇降油圧シリンダ
13 前輪ファイナルケース
14 後輪伝動軸
15 動力伝達機構
16 フィンガーレバーセンサ
17 旋回制御スイッチ
18 センターマスコット
19 植付入切スイッチ
20 副変速機構
21 前輪回転センサ
23 フィンガーレバー
24 副変速レバー
25 静油圧式無段変速機
26 施肥装置
27 植付クラッチモータ
28 マーカースイッチ
29 後輪回転センサ
30 ミッションケース
31 前輪車軸
32 ディスプレイ
33 フロートセンサ
34 マーカーモータ
35 主変速レバー
36 主変速レバーセンサ
37 傾斜検知センサ
38 センターフロート
39 サイドフロート
40 線引きマーカー
41 線引き体
42 マーカーロッド
43 操舵機構
45 ステアリングセンサ
47 フロントカバー
48 操縦席
49 操縦部
50 レール
51 後輪ギアケース
54 操作部
55 モータユニット
56 ステアリングホイール
57 ステアリングモータ
58 ピットマンセンサ
60 フロアステップ
61 モニタ
62 操作スイッチ
63 苗植付部
64 植付装置
65 台
66 施肥量調節モータ
67 駆動軸
69 植付具
71 モータ
74 補助苗枠
77 フレーム
78 カメラ
79 直進アシストレバー
80 方位センサ
81 直進アシストレバーセンサ
82 後輪車軸
83 ステアリングシャフト
84 上下動モータユニット
85 上部リンクアーム
86 下部リンクアーム
87 制御部
88 電子油圧バルブ
89 処理部
90 リンクセンサ
93 記憶部
96 エンジン回転センサ
97 スロットルモータ
98 電気伝導度センサ
99 深度センサ
100 温度センサ
101 密播の範囲を示す表示
102 インジケータ
103 電磁バルブ
105 タイマー
108 パワーステアリング
111 トルクセンサ
130 GNSS受信機
150 HSTサーボモータ
1 work vehicle 2 traveling vehicle body 3 main frame 4 belt type power transmission mechanism 5 elevating link device 6 rear frame 7 engine 8 front wheel 9 rear wheel 10 link base frame 11 elevating link arm 12 elevating hydraulic cylinder 13 front wheel final case 14 rear wheel transmission shaft 15 Power transmission mechanism 16 Finger lever sensor 17 Turn control switch 18 Center mascot 19 Planting on/off switch 20 Auxiliary transmission mechanism 21 Front wheel rotation sensor 23 Finger lever 24 Auxiliary transmission lever 25 Hydrostatic continuously variable transmission 26 Fertilizer 27 Planting Clutch motor 28 Marker switch 29 Rear wheel rotation sensor 30 Mission case 31 Front wheel axle 32 Display 33 Float sensor 34 Marker motor 35 Main gear shift lever 36 Main gear shift lever sensor 37 Tilt detection sensor 38 Center float 39 Side float 40 Line marker 41 Line drawing body 42 Marker rod 43 Steering mechanism 45 Steering sensor 47 Front cover 48 Cockpit seat 49 Control section
50 Rail 51 Rear wheel gear case 54 Operation part 55 Motor unit 56 Steering wheel 57 Steering motor 58 Pitman sensor 60 Floor step 61 Monitor 62 Operation switch 63 Seedling planting part 64 Planting device 65 Base 66 Fertilizer amount adjustment motor 67 Drive shaft 69 Planting tool 71 Motor 74 Auxiliary seedling frame 77 Frame 78 Camera 79 Straight assist lever 80 Orientation sensor 81 Straight assist lever sensor 82 Rear wheel axle 83 Steering shaft 84 Vertical movement motor unit 85 Upper link arm 86 Lower link arm 87 Control unit 88 Electronics Hydraulic valve 89 Processing unit 90 Link sensor 93 Storage unit 96 Engine rotation sensor 97 Throttle motor 98 Electric conductivity sensor 99 Depth sensor 100 Temperature sensor 101 Display indicating the range of dense seeding 102 Indicator 103 Electromagnetic valve 105 Timer 108 Power steering 111 Torque sensor 130 GNSS receiver 150 HST servo motor
Claims (6)
前記走行車体に取り付けられ、農作業を行う作業機と、
前記走行車体の位置情報を取得する位置情報取得手段と、
前記走行車体のヨー方向の角速度を検出するヨー方向角速度検出手段とを備えた作業車両であって、
前記走行車体は、走行車輪と、前記走行車輪を操舵するステアリングホイールと、前記ステアリングホイールを回動させるモータと、前記モータを駆動して作業車両を旋回させる旋回制御を行う制御手段とを有し、
前記制御手段は、旋回制御による旋回を開始する際に、標準的な条件の圃場で旋回目標位置に旋回可能な所定の舵角まで前記ステアリングホイールを回動させた後に、前記所定の舵角から目標舵角へ前記ステアリングホイールの舵角補正を行うように構成され、
前記目標舵角は、前記所定の舵角を有する項と、旋回時の前記走行車輪のスリップ量の度合いを表す相関値を含む項とを含む式により算出され、
前記相関値は、旋回制御が行われている間の実際の前記走行車体のヨー方向の角速度から、旋回目標位置へ旋回するための前記走行車体のヨー方向の理想角速度を減ずることにより算出され、
前記相関値を含む項が、前記ステアリングホイールの舵角を、前記所定の舵角から中立位置側に補正するように機能することを特徴とする作業車両。 a running vehicle;
a working machine that is attached to the traveling vehicle body and performs agricultural work;
a positional information acquiring means for acquiring positional information of the running vehicle body;
A work vehicle comprising yaw direction angular velocity detection means for detecting the angular velocity of the traveling vehicle body in the yaw direction,
The traveling vehicle body includes traveling wheels, a steering wheel that steers the traveling wheels, a motor that rotates the steering wheel, and control means that controls turning of the work vehicle by driving the motor. ,
When starting turning by turning control, the control means rotates the steering wheel to a predetermined steering angle that enables turning to a turning target position in a field under standard conditions, and then rotates the steering wheel from the predetermined steering angle. configured to correct the steering angle of the steering wheel to the target steering angle,
The target rudder angle is calculated by a formula including a term having the predetermined rudder angle and a term including a correlation value representing the degree of slip amount of the running wheels during turning,
The correlation value is calculated by subtracting the ideal angular velocity in the yaw direction of the traveling vehicle body for turning to the turning target position from the actual angular velocity in the yaw direction of the traveling vehicle body during turning control,
The work vehicle, wherein the term including the correlation value functions to correct the steering angle of the steering wheel from the predetermined steering angle toward a neutral position.
前記制御手段は、旋回制御により作業車両が旋回している間に、車速が低いほど前記ステアリングホイールの回動速度が低くなるように、前記主変速レバーの操作位置に応じて前記ステアリングホイールの回動速度の上限値を変更することを特徴とする請求項1ないし3のいずれか1項に記載の作業車両。 The traveling vehicle body further includes a main shift lever that changes the vehicle speed,
The control means rotates the steering wheel in accordance with the operation position of the main gear shift lever so that the lower the vehicle speed, the lower the rotation speed of the steering wheel while the work vehicle is turning by turning control. 4. The work vehicle according to any one of claims 1 to 3, wherein an upper limit value of dynamic speed is changed.
前記施肥装置が、圃場の場所ごとに施肥量を調節する可変施肥を実行可能に構成され、
前記施肥装置による肥料の供給に先立って行われるティーチングの際に、土壌の肥沃度のデータ取得が行われる距離間隔が、圃場に苗を植え付ける条間の距離に等しいことを特徴とする請求項1ないし5のいずれかに記載の作業車両。 Furthermore, a fertilizing device that supplies fertilizer to the field is provided, and the work machine is configured by a seedling planting unit that plants seedlings in the field,
The fertilizing device is configured to be able to perform variable fertilization that adjusts the amount of fertilization for each location in the field,
2. The distance interval at which soil fertility data is acquired during teaching performed prior to the supply of fertilizer by the fertilizing device is equal to the distance between rows at which the seedlings are planted in the field. 6. The working vehicle according to any one of 1 to 5.
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021172172A JP7321428B2 (en) | 2021-10-21 | 2021-10-21 | work vehicle |
KR1020220134060A KR20230057278A (en) | 2021-10-21 | 2022-10-18 | Working vehicle |
TW111139778A TW202316951A (en) | 2021-10-21 | 2022-10-20 | Work vehicle capable of accommodating small items and articles and improving convenience |
CN202211284095.5A CN115997511A (en) | 2021-10-21 | 2022-10-20 | Work vehicle |
JP2023117682A JP2023130514A (en) | 2021-10-21 | 2023-07-19 | work vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021172172A JP7321428B2 (en) | 2021-10-21 | 2021-10-21 | work vehicle |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2023117682A Division JP2023130514A (en) | 2021-10-21 | 2023-07-19 | work vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2023062290A JP2023062290A (en) | 2023-05-08 |
JP7321428B2 true JP7321428B2 (en) | 2023-08-07 |
Family
ID=86269941
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021172172A Active JP7321428B2 (en) | 2021-10-21 | 2021-10-21 | work vehicle |
JP2023117682A Pending JP2023130514A (en) | 2021-10-21 | 2023-07-19 | work vehicle |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2023117682A Pending JP2023130514A (en) | 2021-10-21 | 2023-07-19 | work vehicle |
Country Status (1)
Country | Link |
---|---|
JP (2) | JP7321428B2 (en) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20170144701A1 (en) | 2015-11-19 | 2017-05-25 | Agjunction Llc | Single-mode implement steering |
JP2019166981A (en) | 2018-03-23 | 2019-10-03 | ヤンマー株式会社 | Autonomous steering device |
WO2021100373A1 (en) | 2019-11-20 | 2021-05-27 | ヤンマーパワーテクノロジー株式会社 | Automatic travel system for work vehicle |
JP2021154954A (en) | 2020-03-30 | 2021-10-07 | 日立造船株式会社 | Agricultural vehicle |
JP2021185064A (en) | 2020-05-25 | 2021-12-09 | 井関農機株式会社 | Work vehicle |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3656332B2 (en) * | 1996-08-28 | 2005-06-08 | 独立行政法人農業・生物系特定産業技術研究機構 | Unmanned work method by unmanned working vehicle |
JP2013082319A (en) * | 2011-10-11 | 2013-05-09 | Toyota Motor Corp | Travel controller for vehicle |
JP2019038535A (en) * | 2018-10-10 | 2019-03-14 | 株式会社クボタ | Automatic travel field work vehicle |
JP7162570B2 (en) * | 2019-06-24 | 2022-10-28 | 株式会社クボタ | work vehicle |
-
2021
- 2021-10-21 JP JP2021172172A patent/JP7321428B2/en active Active
-
2023
- 2023-07-19 JP JP2023117682A patent/JP2023130514A/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20170144701A1 (en) | 2015-11-19 | 2017-05-25 | Agjunction Llc | Single-mode implement steering |
JP2019166981A (en) | 2018-03-23 | 2019-10-03 | ヤンマー株式会社 | Autonomous steering device |
WO2021100373A1 (en) | 2019-11-20 | 2021-05-27 | ヤンマーパワーテクノロジー株式会社 | Automatic travel system for work vehicle |
JP2021154954A (en) | 2020-03-30 | 2021-10-07 | 日立造船株式会社 | Agricultural vehicle |
JP2021185064A (en) | 2020-05-25 | 2021-12-09 | 井関農機株式会社 | Work vehicle |
Also Published As
Publication number | Publication date |
---|---|
JP2023062290A (en) | 2023-05-08 |
JP2023130514A (en) | 2023-09-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6371137B2 (en) | Planting field work machine | |
JP6860387B2 (en) | Work platform | |
JP6281436B2 (en) | Work vehicle | |
JP2017153438A (en) | Field work vehicle | |
JP2019154394A (en) | Work vehicle | |
JP6921935B2 (en) | Field work vehicle | |
JP7229303B2 (en) | traveling work machine | |
US20170357261A1 (en) | Autoscaling rows of travel for an off-road vehicle | |
JP2017000095A (en) | Working vehicle | |
JP6991050B2 (en) | Traveling work machine | |
JP2017099324A (en) | Work vehicle | |
JP2019004793A (en) | Work vehicle | |
JP7321428B2 (en) | work vehicle | |
JP6977402B2 (en) | Work vehicle | |
JP2023001180A (en) | Farm field work vehicle | |
JP7333004B2 (en) | work vehicle | |
JP2018171073A (en) | Field work machine | |
TWI810418B (en) | Operating vehicle | |
KR20230057278A (en) | Working vehicle | |
JP7331984B1 (en) | work vehicle | |
JP7368794B2 (en) | Seedling transplanting system | |
JP7302684B2 (en) | work vehicle | |
JP7150593B2 (en) | work vehicle | |
JP2017153410A (en) | Work vehicle | |
JP2020162518A (en) | Farm field work vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220830 |
|
A871 | Explanation of circumstances concerning accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A871 Effective date: 20230530 |
|
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: 20230626 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230709 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7321428 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |