JP2023046508A - work vehicle - Google Patents

work vehicle Download PDF

Info

Publication number
JP2023046508A
JP2023046508A JP2021155133A JP2021155133A JP2023046508A JP 2023046508 A JP2023046508 A JP 2023046508A JP 2021155133 A JP2021155133 A JP 2021155133A JP 2021155133 A JP2021155133 A JP 2021155133A JP 2023046508 A JP2023046508 A JP 2023046508A
Authority
JP
Japan
Prior art keywords
angle
steering
steering angle
turning
front wheels
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.)
Pending
Application number
JP2021155133A
Other languages
Japanese (ja)
Inventor
淳一 林田
Junichi Hayashida
周一 足立
Shuichi Adachi
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Mahindra Agricultural Machinery Co Ltd
Original Assignee
Mitsubishi Mahindra Agricultural Machinery Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Mahindra Agricultural Machinery Co Ltd filed Critical Mitsubishi Mahindra Agricultural Machinery Co Ltd
Priority to JP2021155133A priority Critical patent/JP2023046508A/en
Publication of JP2023046508A publication Critical patent/JP2023046508A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Guiding Agricultural Machines (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

To provide a work vehicle capable of preventing a turning radius from swelling large and of appropriately progressing to the next step.SOLUTION: A riding type rice transplanter P is configured to perform automatic steering control controlling a steering device 9 on the basis of location information on a traveling machine body 1 acquired by a location information acquisition system 41. When the automatic steering control is on and an indicated steering angle for the steering device 9 is over a prescribed turning determined angle from a detection angle of the steering angle sensor 21 or a control part 50, front wheels 10 are steered up to a mechanical limit angle, and a detected angle of the steering angle sensor 21 when the limit angle is reached is set as an indicated steering angle for turning.SELECTED DRAWING: Figure 9

Description

本発明は、自動操舵制御を実行可能な作業車両に関する。 The present invention relates to a work vehicle capable of executing automatic steering control.

位置情報取得システムが取得した走行機体の位置情報に基づいて、操舵装置を制御する自動操舵制御を実行可能な作業車両が知られている(例えば、特許文献1参照)。この種の作業車両は、前輪の操舵角を検出する操舵角センサを備えており、目標操舵角(制御部の指示操舵角)と操舵角センサの検出角度が一致するように自動操舵制御が実行される。 2. Description of the Related Art There is known a work vehicle capable of executing automatic steering control for controlling a steering device based on position information of a traveling machine body acquired by a position information acquisition system (see Patent Document 1, for example). This type of work vehicle is equipped with a steering angle sensor that detects the steering angle of the front wheels, and automatic steering control is executed so that the target steering angle (steering angle indicated by the control unit) matches the angle detected by the steering angle sensor. be done.

特開2020-195285号公報JP 2020-195285 A

しかしながら、この種の作業車両では、操舵角センサの特性やその周辺の機械的な構成に起因し、操舵角センサの検出角度と前輪の実際の操舵角との間にヒステリシスなどの誤差が生じ、自動操舵制御の精度が低下する虞がある。特に、機体旋回時には、誤差の影響が大きくなるため、旋回半径が大きく膨らんで次行程に適切に進入できなくなる可能性がある。 However, in this type of work vehicle, an error such as hysteresis occurs between the angle detected by the steering angle sensor and the actual steering angle of the front wheels due to the characteristics of the steering angle sensor and the mechanical configuration around it. There is a risk that the accuracy of the automatic steering control will decrease. In particular, when the aircraft is turning, the influence of the error becomes large, so there is a possibility that the turning radius will be greatly expanded and it will not be possible to properly enter the next stroke.

本発明は、上記の如き実情に鑑みこれらの課題を解決することを目的として創作されたものであって、請求項1の発明は、前輪及び後輪を有する走行機体と、前記走行機体の位置情報を取得する位置情報取得システムと、アクチュエータの駆動により前記前輪を操舵する操舵装置と、前記前輪の操舵角を検出する操舵角センサと、前記位置情報取得システムが取得した前記走行機体の位置情報に基づいて、前記操舵装置を制御する自動操舵制御を実行可能に構成される制御部と、を備える作業車両であって、前記制御部は、前記自動操舵制御がオン状態で、且つ前記操舵角センサの検出角度又は前記制御部から前記操舵装置に対する指示操舵角が所定の旋回判定角度を超えたとき、前記前輪を機械的な限界角度まで操舵させるとともに、前記限界角度に到達した時点における前記操舵角センサの検出角度を旋回用指示操舵角として設定する旋回用指示操舵角設定手段を備えることを特徴とする。
また、請求項2の発明は、請求項1に記載の作業車両であって、前記旋回用指示操舵角設定手段は、前記自動操舵制御がオン状態で、且つ前記操舵角センサの検出角度又は前記指示操舵角が前記所定の旋回判定角度を超えたとき、前記前輪を機械的な限界角度まで操舵させた後、所定の戻し角度分だけ前記前輪を逆方向に操舵させ、その時点における前記操舵角センサの検出角度を前記旋回用指示操舵角として設定することを特徴とする。
また、請求項3の発明は、請求項1に記載の作業車両であって、前記旋回用指示操舵角設定手段は、前記自動操舵制御がオン状態で、且つ前記操舵角センサの検出角度又は前記指示操舵角が前記所定の旋回判定角度を超えたとき、前記前輪を機械的な限界角度まで操舵させるとともに、前記限界角度に到達した時点おける前記操舵角センサの検出角度から所定の戻し角度分だけ減算した角度を前記旋回用指示操舵角として設定することを特徴とする。
また、請求項4の発明は、請求項1~3のいずれか1項に記載の作業車両であって、前記制御部は、前記自動操舵制御がオフ状態、又は、前記操舵角センサの検出角度又は前記指示操舵角が前記所定の旋回判定角度以下となったとき、前記旋回用指示操舵角をリセットして初期値に戻すことを特徴とする。
The present invention has been created with the aim of solving these problems in view of the actual situation as described above. A position information acquisition system that acquires information, a steering device that steers the front wheels by driving an actuator, a steering angle sensor that detects the steering angle of the front wheels, and the position information of the traveling body acquired by the position information acquisition system. and a control unit configured to be able to execute automatic steering control for controlling the steering device based on When the angle detected by the sensor or the steering angle instructed from the control unit to the steering device exceeds a predetermined turning determination angle, the front wheels are steered to a mechanical limit angle, and the steering at the time when the limit angle is reached. It is characterized by comprising turning instruction steering angle setting means for setting the angle detected by the angle sensor as the turning instruction steering angle.
Further, the invention of claim 2 is the work vehicle according to claim 1, wherein the command steering angle setting means for turning is in an on state of the automatic steering control and the angle detected by the steering angle sensor or the angle detected by the steering angle sensor. When the instructed steering angle exceeds the predetermined turn determination angle, the front wheels are steered to the mechanical limit angle, and then the front wheels are steered in the reverse direction by a predetermined return angle, and the steering angle at that time is determined. The angle detected by the sensor is set as the instructed steering angle for turning.
Further, the invention of claim 3 is the work vehicle according to claim 1, wherein the command steering angle setting means for turning is in the on state of the automatic steering control and the angle detected by the steering angle sensor or the angle detected by the steering angle sensor When the instructed steering angle exceeds the predetermined turn determination angle, the front wheels are steered to a mechanical limit angle, and the angle detected by the steering angle sensor at the time when the limit angle is reached is returned by a predetermined return angle. The subtracted angle is set as the instruction steering angle for turning.
Further, the invention of claim 4 is the work vehicle according to any one of claims 1 to 3, wherein the control unit controls the state in which the automatic steering control is turned off, or the angle detected by the steering angle sensor Alternatively, when the instructed steering angle becomes equal to or less than the predetermined turning determination angle, the instructed steering angle for turning is reset to an initial value.

請求項1の発明によれば、機体旋回時には、前輪を機械的な限界角度まで操舵させるので、旋回半径が大きく膨らむことを防止し、次行程に適切に進入させることができる。また、限界角度に到達した時点における操舵角センサの検出角度を旋回用指示操舵角として設定するので、機体旋回中において前輪を機械的な限界角度に維持することができる。
また、請求項2の発明によれば、前輪を機械的な限界角度まで操舵させた後、所定の戻し角度分だけ前輪を逆方向に操舵させ、その時点における操舵角センサの検出角度を旋回用指示操舵角として設定するので、限界角度で生じるリリーフ弁の動作を抑制して油圧機器への負荷を軽減できる。
また、請求項3の発明によれば、限界角度に到達した時点おける操舵角センサの検出角度から所定の戻し角度分だけ減算した角度を旋回用指示操舵角として設定するので、前輪が限界角度に到達した後、減算された旋回用指示操舵角に基づいて所定の戻し角度分だけ前輪を逆方向に操舵させることができる。
また、請求項4の発明によれば、制御部は、自動操舵制御がオフ状態、又は、操舵角センサの検出角度又は指示操舵角が所定の旋回判定角度以下となったとき、旋回用指示操舵角をリセットして初期値に戻すので、機体旋回時以外の自動操舵制御に対する影響を抑制でき、また、機体旋回毎に新たな旋回用指示操舵角を再設定することで、作業中における操舵角センサの誤差変動にも適切に対応できる。
According to the first aspect of the invention, when the aircraft is turning, the front wheels are steered to the mechanical limit angle, so that the turning radius can be prevented from increasing greatly, and the next stroke can be appropriately entered. In addition, since the angle detected by the steering angle sensor when the limit angle is reached is set as the command steering angle for turning, the front wheels can be mechanically maintained at the limit angle during turning of the aircraft.
According to the invention of claim 2, after the front wheels are steered to the mechanical limit angle, the front wheels are steered in the reverse direction by a predetermined return angle, and the angle detected by the steering angle sensor at that time is used for turning. Since it is set as the instructed steering angle, it is possible to reduce the load on the hydraulic equipment by suppressing the operation of the relief valve that occurs at the limit angle.
Further, according to the third aspect of the present invention, an angle obtained by subtracting a predetermined return angle from the angle detected by the steering angle sensor when the limit angle is reached is set as the instructed steering angle for turning. After reaching the turning point, the front wheels can be steered in the opposite direction by a predetermined return angle based on the decremented turning instruction steering angle.
Further, according to the fourth aspect of the invention, the controller controls the command steering for turning when the automatic steering control is turned off or when the angle detected by the steering angle sensor or the command steering angle becomes equal to or less than a predetermined turning determination angle. Since the angle is reset and returned to the initial value, it is possible to suppress the influence on the automatic steering control when the aircraft is not turning. Sensor error fluctuations can also be handled appropriately.

本発明の実施形態に係る乗用田植機の左側面図である。It is a left view of the riding rice transplanter which concerns on embodiment of this invention. 乗用田植機の平面図である。It is a top view of a riding rice transplanter. 乗用田植機の斜視図である。It is a perspective view of a riding rice transplanter. 操舵装置の左側面図である。It is a left side view of a steering device. 操舵装置の右側面図である。It is a right side view of a steering device. 操舵装置を右前方から視た斜視図である。It is the perspective view which looked the steering apparatus from the right front. 操舵角の説明図であり、(a)は操舵装置の平面図、(b)は機械的な操舵角と操舵角センサの検出操舵角との関係を示す図である。FIG. 2 is an explanatory diagram of a steering angle, in which (a) is a plan view of a steering device, and (b) is a diagram showing the relationship between a mechanical steering angle and a steering angle detected by a steering angle sensor; 自動操舵ユニットを示す図であり、(a)は自動操舵ユニットの斜視図、(b)は自動操舵ユニットの操作パネルを示す正面図、(c)は操作パネルの他例を示す正面図である。FIG. 10 is a diagram showing an automatic steering unit, (a) is a perspective view of the automatic steering unit, (b) is a front view showing an operation panel of the automatic steering unit, and (c) is a front view showing another example of the operation panel. . 乗用田植機の制御構成を示すブロック図である。It is a block diagram which shows the control structure of a riding rice transplanter. 乗用田植機の作業走行経路を示す説明図である。It is explanatory drawing which shows the work driving|running|working path|route of a riding rice transplanter. 乗用田植機の旋回経路を示す説明図である。It is explanatory drawing which shows the turning path|route of a riding rice transplanter. 限界角強制操舵制御のメインルーチンを示すフローチャートである。4 is a flow chart showing a main routine of limit angle forced steering control; 限界角強制操舵制御のサブルーチンであるフラグ制御を示すフローチャートである。4 is a flowchart showing flag control, which is a subroutine of limit angle forced steering control. 限界角強制操舵制御のサブルーチンである実行・停止制御を示すフローチャートである。4 is a flowchart showing execution/stop control, which is a subroutine of limit angle forced steering control.

以下、本発明の実施の形態について、図面に基づいて説明する。図1~図3において、1は乗用田植機P(作業車両)の走行機体であって、該走行機体1の後部には、昇降リンク機構2を介して植付作業機3が昇降可能に連結されている。 BEST MODE FOR CARRYING OUT THE INVENTION Embodiments of the present invention will be described below with reference to the drawings. In FIGS. 1 to 3, reference numeral 1 denotes a traveling body of a riding rice transplanter P (working vehicle), and to the rear of the traveling body 1, a planting work machine 3 is connected via an elevating link mechanism 2 so as to be able to ascend and descend. It is

植付作業機3は、マット苗が載置される苗載台4と、苗載台4の下端部から苗を掻き取って圃場に植え付ける植付機構5とを備える。本実施形態の植付作業機3は、同時に6条分の苗を植え付け可能な6条植え仕様であり、6つの植付機構5が車幅方向に所定間隔を存して並設されている。 The planting machine 3 includes a seedling table 4 on which matted seedlings are placed, and a planting mechanism 5 for scraping the seedlings from the lower end of the seedling table 4 and planting them in a field. The planting machine 3 of the present embodiment has a six-row planting specification capable of planting six seedlings at the same time, and six planting mechanisms 5 are arranged side by side at predetermined intervals in the vehicle width direction. .

走行機体1は、エンジン(図示せず)が搭載されるエンジン搭載部6と、エンジン動力を無段変速するHST7(図4参照)と、HST7から入力される動力をさらに変速して走行動力及び作業動力として出力するミッションケース8(図4及び図5参照)と、ミッションケース8が出力する走行動力で駆動され、かつ、後述する操舵装置9で操舵される前輪10と、ミッションケース8が出力する走行動力で駆動される後輪11と、作業者が乗車する操縦部12とを備える。 The traveling machine body 1 includes an engine mounting section 6 on which an engine (not shown) is mounted, an HST 7 (see FIG. 4) that continuously changes the engine power, and further changes the power input from the HST 7 to change the traveling power and A transmission case 8 (see FIGS. 4 and 5) output as working power, a front wheel 10 driven by the traveling power output by the mission case 8 and steered by a steering device 9 described later, and the transmission case 8 output It has a rear wheel 11 driven by running power and a control section 12 on which a worker rides.

操縦部12には、前輪10を操舵するステアリングハンドル13、HST7を変速操作する主変速レバー14、植付作業機3の昇降操作具及び植付クラッチ操作具を兼ねる作業機昇降レバー(図示せず)などの操作具が配置されている。 The control unit 12 includes a steering handle 13 for steering the front wheels 10, a main gear shift lever 14 for shifting the HST 7, a work machine lifting lever (not shown) which also serves as a lifting operation tool for the planting work machine 3 and a planting clutch operation tool. ) are arranged.

操舵装置9は、ステアリングハンドル13の手動操作、又は後述する自動操舵ユニット15(図8参照)の動作に応じて前輪10を操舵する装置であって、図4~図7に示すように、左右一対の前輪10を操舵可能に支持する左右一対のフロントアクスル16と、ステアリングハンドル13の手動操作、又は後述する自動操舵ユニット15の動作に応じてピットマンアーム17を左右に揺動させるトルクジェネレータ18と、ピットマンアーム17を左右のフロントアクスル16に連結させる左右一対の操舵ロッド19とを備える。 The steering device 9 is a device that steers the front wheels 10 according to manual operation of the steering handle 13 or operation of an automatic steering unit 15 (see FIG. 8), which will be described later. A pair of left and right front axles 16 that steerably support a pair of front wheels 10, and a torque generator 18 that swings a pitman arm 17 left and right according to manual operation of a steering handle 13 or operation of an automatic steering unit 15, which will be described later. , a pair of left and right steering rods 19 connecting the pitman arms 17 to the left and right front axles 16 .

図4~図7に示すように、操舵装置9には、センサ連動機構20を介して前輪10の操舵角を検出する操舵角センサ21が設けられている。操舵角センサ21は、例えば、ポテンショメータであり、センサブラケット22に取り付けられている。 As shown in FIGS. 4 to 7, the steering device 9 is provided with a steering angle sensor 21 for detecting the steering angle of the front wheels 10 via a sensor interlocking mechanism 20. FIG. The steering angle sensor 21 is, for example, a potentiometer and attached to the sensor bracket 22 .

センサ連動機構20は、第1支軸23を支点として一体的に回動する第1連動アーム24及び第2連動アーム25と、センサブラケット22に設けられる第2支軸26を支点として回動する第3連動アーム27と、第1連動アーム24とピットマンアーム17を連結させる第1連動ロッド28と、第2連動アーム25と第3連動アーム27を連結させる第2連動ロッド29とを備える。 The sensor interlocking mechanism 20 rotates around a first interlocking arm 24 and a second interlocking arm 25 integrally rotated around a first support shaft 23 and around a second support shaft 26 provided on the sensor bracket 22 . A third interlocking arm 27 , a first interlocking rod 28 connecting the first interlocking arm 24 and the pitman arm 17 , and a second interlocking rod 29 connecting the second interlocking arm 25 and the third interlocking arm 27 are provided.

前輪10が操舵されると、ピットマンアーム17、第1連動ロッド28、第1連動アーム24、第2連動アーム25及び第2連動ロッド29を介して第3連動アーム27が回動する。第3連動アーム27は、操舵角センサ21のセンサアーム21aに係合するピン27aを有しており、前輪10の操舵角に応じた回動角を操舵角センサ21に入力する。 When the front wheel 10 is steered, the third interlocking arm 27 rotates via the pitman arm 17 , first interlocking rod 28 , first interlocking arm 24 , second interlocking arm 25 and second interlocking rod 29 . The third interlocking arm 27 has a pin 27 a that engages with the sensor arm 21 a of the steering angle sensor 21 , and inputs a rotation angle corresponding to the steering angle of the front wheels 10 to the steering angle sensor 21 .

図7の(a)に示すように、操舵装置9は、前輪10を機械的な限界角度±α2まで操舵可能であり、操舵角センサ21の検出範囲には、前輪10の機械的な限界角度範囲-α2~+α2が含まれる。ただし、図7の(b)に示すように、操舵角センサ21の検出角度と前輪10の実際の操舵角との間には、操舵角センサ21の特性やその周辺の機械的な構成に起因し、ヒステリシス、オフセットなどの誤差が生じる可能性がある。 As shown in FIG. 7A, the steering device 9 can steer the front wheels 10 up to a mechanical limit angle ±α2, and the detection range of the steering angle sensor 21 includes the mechanical limit angle of the front wheels 10 The range -α2 to +α2 is included. However, as shown in FIG. 7B, there is a difference between the angle detected by the steering angle sensor 21 and the actual steering angle of the front wheels 10 due to the characteristics of the steering angle sensor 21 and the surrounding mechanical configuration. However, errors such as hysteresis and offset may occur.

図8の(a)に示すように、ステアリングハンドル13には、自動操舵ユニット15が連結されている。自動操舵ユニット15は、ステアリングハンドル13の手動操作に代えて、ステアリングハンドル13をモータ動力で回転操作するステアリングモータ30(図9参照)と、後述する自動操舵制御関連の操作具及びモニタランプが配置される操作パネル31とを備える。また、自動操舵ユニット15は、ステアリングモータ30に流れる電流値を検出する電流値センサ32(図9参照)を備えており、電流値センサ32の検出値に基づいてステアリングハンドル13の手動操作を検出し、ステアリングモータ30の駆動を自動的に停止させる手動操作優先機能を有する。 As shown in (a) of FIG. 8 , an automatic steering unit 15 is connected to the steering handle 13 . The automatic steering unit 15 includes a steering motor 30 (see FIG. 9) that rotates the steering handle 13 by motor power in place of the manual operation of the steering handle 13, an operation tool related to automatic steering control and a monitor lamp, which will be described later. and an operation panel 31 to be used. The automatic steering unit 15 also includes a current value sensor 32 (see FIG. 9) that detects the value of current flowing through the steering motor 30. Manual operation of the steering wheel 13 is detected based on the value detected by the current value sensor 32. and has a manual operation priority function for automatically stopping the drive of the steering motor 30 .

図8の(b)に示すように、操作パネル31には、電源スイッチ33と、自動操舵制御を自動操舵を行わない自動操舵オフ状態から自動操舵を行う自動操舵オン状態への切換操作や自動操舵オン状態から自動操舵オフ状態への切換操作が可能な自動操舵スイッチ34と、後述する始点A点を登録する始点A点登録スイッチ35と、後述する終点B点を登録する終点B点登録スイッチ36と、自動操舵スイッチ34の近傍に配置されたリセットスイッチ37と、ランプ表示による報知を行う報知表示部38とを備える。なお、図8の(c)は、カメラ画像に基づいて自動操舵を行う場合に使用される操作パネル31Bを示している。 As shown in FIG. 8B, the operation panel 31 includes a power switch 33 and an automatic steering control operation for switching from an automatic steering OFF state in which automatic steering is not performed to an automatic steering ON state in which automatic steering is performed. An automatic steering switch 34 capable of switching from a steering ON state to an automatic steering OFF state, a starting point A point registration switch 35 for registering a starting point A, which will be described later, and an end point B point registration switch for registering an end point B, which will be described later. 36, a reset switch 37 arranged near the automatic steering switch 34, and a notification display unit 38 that performs notification by lamp display. In addition, FIG. 8(c) shows the operation panel 31B used when performing automatic steering based on the camera image.

また、操縦部12には、図1~図3に示すように、正面視冂字状の測位用フレーム40が立設されている。測位用フレーム40は、上方に延在する左右一対の縦フレーム部40aと、左右の縦フレーム部40aの上端部同士を連結する横フレーム部40bとを有する。横フレーム部40bには、後述する位置情報取得システム41の構成要素である2つのGNSSアンテナ42、43などが取付けられ、左右いずれか一方の縦フレーム40aには、ナビゲーション表示などを行うタブレット44が取付けられている。 As shown in FIGS. 1 to 3, the control unit 12 is provided with a positioning frame 40 shaped like a letter when viewed from the front. The positioning frame 40 has a pair of left and right vertical frame portions 40a extending upward, and a horizontal frame portion 40b connecting upper ends of the left and right vertical frame portions 40a. Two GNSS antennas 42, 43, etc., which are components of a position information acquisition system 41, which will be described later, are attached to the horizontal frame portion 40b, and a tablet 44 that performs navigation display etc. is attached to one of the left and right vertical frames 40a. installed.

図9に示すように、走行機体1は、自動操舵制御を行うための制御構成として、位置情報取得システム41及び制御部50を備える。位置情報取得システム41としては、例えば、数cmの誤差で高精度な測位が可能なRTK-GNSS測位システムが採用される。RTK-GNSS測位システムは、固定設置された基地局と、移動する移動局とのそれぞれで、GPSなどのGNSS測位を行い、基地局から移動局に送信される補正信号でリアルタイムに測位データを補正することで、誤差数cmの高精度な測位を実現するものである。また、移動局に所定の間隔をあけて2つのGNSSアンテナを設置すれば、移動局の絶対位置だけでなく、2つの測位結果に基づいて、移動局の進行方向(方位)も高精度に検出することが可能になる。 As shown in FIG. 9, the traveling body 1 includes a position information acquisition system 41 and a control unit 50 as control components for performing automatic steering control. As the position information acquisition system 41, for example, an RTK-GNSS positioning system capable of highly accurate positioning with an error of several cm is adopted. The RTK-GNSS positioning system performs GNSS positioning such as GPS using a fixed base station and a moving mobile station, and corrects the positioning data in real time using correction signals sent from the base station to the mobile station. By doing so, highly accurate positioning with an error of several centimeters is realized. In addition, if two GNSS antennas are installed on the mobile station with a predetermined interval, not only the absolute position of the mobile station but also the traveling direction (azimuth) of the mobile station can be detected with high accuracy based on the two positioning results. it becomes possible to

具体的に説明すると、本実施形態の位置情報取得システム41は、図9に示すように、RTK-GNSS測位を実行する制御ユニットであるGNSSユニット45と、測位用フレーム40の横フレーム部40bに車幅方向に所定の間隔をあけて取付けられる基準用GNSSアンテナ42及び方位用GNSSアンテナ43と、固定設置されるRTK基地局46から補正信号を受信する補正信号受信装置47とを備える。GNSSユニット45は、RTK-GNSS測位による測位データ(絶対位置データ及び進行方向データ)を、CANなどの有線通信手段を介して制御部50に送信するとともに、Bluetooth(登録商標)などの無線通信手段を介してタブレット44に送信する。 Specifically, as shown in FIG. 9, the position information acquisition system 41 of the present embodiment includes a GNSS unit 45, which is a control unit that performs RTK-GNSS positioning, and a horizontal frame portion 40b of the positioning frame 40. It is equipped with a reference GNSS antenna 42 and an azimuth GNSS antenna 43 mounted at a predetermined interval in the vehicle width direction, and a correction signal receiver 47 for receiving a correction signal from a fixedly installed RTK base station 46 . The GNSS unit 45 transmits positioning data (absolute position data and traveling direction data) by RTK-GNSS positioning to the control unit 50 via wired communication means such as CAN, and wireless communication means such as Bluetooth (registered trademark). to the tablet 44 via.

制御部50は、自動操舵制御を実行する制御ユニット(CPU、記憶部、タイマなどを含む)であり、図9に示すように、制御部50の入力側には、前述した操舵角センサ21、電流値センサ32、自動操舵スイッチ34、始点A点登録スイッチ35、終点B点登録スイッチ36及びリセットスイッチ37が接続され、制御部50の出力側には、前述したステアリングモータ30及び報知表示部38に加え、報知音を出力する報知ブザー39が接続されている。 The control unit 50 is a control unit (including a CPU, a storage unit, a timer, etc.) that executes automatic steering control. As shown in FIG. A current value sensor 32, an automatic steering switch 34, a start point A point registration switch 35, an end point B point registration switch 36, and a reset switch 37 are connected. In addition, a notification buzzer 39 for outputting a notification sound is connected.

自動操舵制御は、位置情報取得システム41が取得した走行機体1の位置情報に基づいて、走行機体1が仮想目標走行ライン(L1、L2、…Ln)に沿って自動的に直進し、かつ仮想目標走行ラインの終端に到達すると、自動的に旋回して次行程の仮想目標走行ラインに移行するように前輪10を自動的に操舵する自動制御機能である。 In the automatic steering control, based on the position information of the traveling machine body 1 acquired by the position information acquisition system 41, the traveling machine body 1 automatically travels straight along the virtual target traveling line (L1, L2, . . . Ln), and the virtual This is an automatic control function that automatically steers the front wheels 10 so that when the end of the target travel line is reached, the vehicle automatically turns and shifts to the virtual target travel line of the next stroke.

なお、6条植え仕様による通常の田植作業では、走行機体1の旋回スペースとなる枕地を残して植付走行を行う第1作業行程(図10で丸付き数字1で示す行程)と、枕地の外周側で植付走行を行う第2作業行程(図10で丸付き数字2で示す行程)と、枕地の内周側で植付走行を行う第3作業行程(図10で丸付き数字3で示す行程)とが行われる。本実施形態の自動操舵制御には、第1作業行程における自動直進制御と自動旋回制御が含まれるが、第2作業行程及び第3作業行程でも自動操舵制御を実行するようにしてもよい。 In addition, in the normal rice planting work according to the 6-row planting specification, the first work process (process indicated by circled number 1 in FIG. The second work process for planting on the outer circumference side of the ground (the process indicated by the circled number 2 in FIG. 10) and the third work process for planting on the inner circumference side of the headland (circled in FIG. 10 Step indicated by number 3) is performed. The automatic steering control of the present embodiment includes automatic straight-ahead control and automatic turning control in the first work stroke, but automatic steering control may also be executed in the second and third work strokes.

図10に示すように、作業開始時には、最初の植付作業行程である基準走行ライン(L0)の始点位置で始点A点登録スイッチ35を操作して始点A点の測位データを登録するとともに、基準走行ライン(L0)の終点位置で終点B点登録スイッチ36を操作して終点B点の測位データを登録する。これにより、基準走行ライン(L0)に基づいて、以降の仮想目標走行ライン(L1、L2、…Ln)が自動的に演算される。 As shown in FIG. 10, at the start of work, the starting point A point registration switch 35 is operated at the starting point position of the reference traveling line (L0) which is the first planting work process, and the positioning data of the starting point A is registered. At the end point position of the reference travel line (L0), the end point B point registration switch 36 is operated to register the positioning data of the end point B point. As a result, subsequent virtual target travel lines (L1, L2, . . . Ln) are automatically calculated based on the reference travel line (L0).

また、図11に示すように、自動操舵制御では、走行機体1(植付作業機3の植付位置)が仮想目標走行ラインの終端(走行機体1の後端がT0位置)に到達したら、植付作業機3を自動的に上昇させるとともに、前輪10を旋回用指示操舵角まで自動的に操舵させ、走行機体1を枕地において旋回させる。また、自動操舵制御では、走行機体1の後端が旋回終了位置T1まで到達したら、前輪10を直進方向に戻して走行機体1を次行程の仮想目標走行ラインに進入させる。さらに、自動操舵制御では、走行機体1(植付作業機3の植付位置)が次行程の仮想目標走行ラインの始端(走行機体1の後端がT2位置)に到達したら、植付作業機3を自動的に下降させ、次行程の植付走行を開始させる。 Further, as shown in FIG. 11, in the automatic steering control, when the traveling machine body 1 (the planting position of the planting machine 3) reaches the end of the virtual target traveling line (the rear end of the traveling machine body 1 is at the T0 position), The planting work machine 3 is automatically raised, and the front wheels 10 are automatically steered to an instructed steering angle for turning to turn the traveling body 1 on the headland. Further, in the automatic steering control, when the rear end of the traveling body 1 reaches the turning end position T1, the front wheels 10 are returned to the straight traveling direction to cause the traveling body 1 to enter the virtual target travel line of the next stroke. Furthermore, in the automatic steering control, when the traveling machine body 1 (the planting position of the planting machine 3) reaches the start end of the virtual target traveling line of the next stroke (the rear end of the traveling machine body 1 is at the T2 position), the planting machine 3 is automatically lowered to start planting travel in the next stroke.

しかしながら、前述のように、操舵角センサ21の検出角度と前輪10の実際の操舵角との間に、ヒステリシス、オフセットなどの誤差が存在する場合、機体旋回時には、誤差の影響が大きくなるため、旋回半径が大きく膨らんで次行程に適切に進入できなくなる可能性がある。 However, as described above, if there is an error such as hysteresis or offset between the angle detected by the steering angle sensor 21 and the actual steering angle of the front wheels 10, the effect of the error increases when the aircraft turns. There is a possibility that the turning radius will be greatly expanded and it will not be possible to properly enter the next stroke.

そこで、本実施形態の制御部50は、上記のような課題を解決可能な限界角強制操舵制御手段(旋回用指示操舵角設定手段)を備える。限界角強制操舵制御手段は、自動操舵制御がオン状態で、且つ操舵角センサ21の検出角度又は制御部50から自動操舵ユニット15に対する指示操舵角が所定の旋回判定角度を超えたとき、前輪10を機械的な限界角度まで操舵させるとともに、限界角度に到達した時点における操舵角センサ21の検出角度を旋回用指示操舵角として設定する。なお、前輪10の機械的な限界角度への到達は、前述した電流値センサ32の検出値が所定の閾値を超え、且つその継続時間(以降、ハンドル負荷カウンタと称する場合がある)が所定時間を超えたか否かに基づいて判定することができる。 Therefore, the control unit 50 of the present embodiment includes limit angle forced steering control means (turning instruction steering angle setting means) capable of solving the above problems. When the automatic steering control is on and the angle detected by the steering angle sensor 21 or the steering angle instructed by the control section 50 to the automatic steering unit 15 exceeds a predetermined turning determination angle, the limit angle forced steering control means is configured to rotate the front wheels 10. is steered to a mechanical limit angle, and the angle detected by the steering angle sensor 21 when the limit angle is reached is set as the command steering angle for turning. In addition, when the front wheel 10 reaches the mechanical limit angle, the detected value of the current value sensor 32 exceeds a predetermined threshold, and the duration (hereinafter sometimes referred to as a steering wheel load counter) exceeds a predetermined time. can be determined based on whether or not the

このような限界角強制操舵制御手段によれば、機体旋回時には、前輪10を機械的な限界角度まで操舵させるので、旋回半径が大きく膨らむことを防止し、次行程に適切に進入させることができる。また、限界角度に到達した時点における操舵角センサ21の検出角度を旋回用指示操舵角として設定するので、機体旋回中において前輪10を機械的な限界角度に維持することができる。 According to such limit angle forced steering control means, when the machine body turns, the front wheels 10 are steered to the mechanical limit angle. . In addition, since the angle detected by the steering angle sensor 21 when the limit angle is reached is set as the command steering angle for turning, the front wheels 10 can be mechanically maintained at the limit angle during turning of the aircraft.

また、本実施形態の限界角強制操舵制御手段は、自動操舵制御がオン状態で、且つ操舵角センサ21の検出角度又は指示操舵角が所定の旋回判定角度を超えたとき、前輪10を機械的な限界角度まで操舵させるとともに、限界角度に到達した時点おける操舵角センサ21の検出角度から所定の戻し角度分だけ減算した角度を旋回用指示操舵角として設定する。これにより、前輪10が限界角度に到達した後、減算された旋回用指示操舵角に基づいて所定の戻し角度分だけ前輪10を逆方向に操舵させることができる。その結果、機械的な限界角度で生じるリリーフ弁の動作を抑制して油圧機器への負荷を軽減できる。 Further, the limit angle forced steering control means of the present embodiment mechanically rotates the front wheels 10 when the automatic steering control is on and the angle detected by the steering angle sensor 21 or the instructed steering angle exceeds a predetermined turning determination angle. At the same time, an angle obtained by subtracting a predetermined return angle from the angle detected by the steering angle sensor 21 when the limit angle is reached is set as the command steering angle for turning. As a result, after the front wheels 10 reach the limit angle, the front wheels 10 can be steered in the reverse direction by a predetermined return angle based on the subtracted turning instruction steering angle. As a result, it is possible to reduce the load on the hydraulic equipment by suppressing the operation of the relief valve that occurs at the mechanical limit angle.

また、本実施形態では、自動操舵制御がオフ状態、又は、操舵角センサ21の検出角度又は指示操舵角が所定の旋回判定角度以下となったとき、旋回用指示操舵角をリセットして初期値に戻す。このようにすると、機体旋回時以外の自動操舵制御に対する影響を抑制でき、また、機体旋回毎に新たな旋回用指示操舵角を再設定することで、作業中における操舵角センサ21の誤差変動にも適切に対応できる。 Further, in this embodiment, when the automatic steering control is turned off, or when the angle detected by the steering angle sensor 21 or the instructed steering angle becomes equal to or less than a predetermined turning determination angle, the instructed steering angle for turning is reset to the initial value. back to In this way, it is possible to suppress the influence on the automatic steering control at times other than when the aircraft is turning. can also be handled appropriately.

つぎに、上記のような制御機能を実現する限界角強制操舵制御の処理手順について、図12~図14を参照して説明する。 Next, a processing procedure of limit angle forced steering control for realizing the control function as described above will be described with reference to FIGS. 12 to 14. FIG.

図12に示すように、限界角強制操舵制御には、サブルーチンであるフラグ制御(S1)及び実行・停止制御(S2)が含まれる。図13に示すように、制御部50は、フラグ制御において、自動操舵制御がオン状態で、且つ操舵角センサ21の検出角度及び指示操舵角が所定の閾値(旋回判定角度)を超えたか否かを判断し(S101)、この判断結果がYESの場合は、限界角強制操舵制御フラグをセットし(S102)、判断結果がNOの場合は、限界角強制操舵制御フラグをリセットする(S103)。なお、本実施形態では、限界角強制操舵制御フラグをリセットする際、旋回用指示操舵角もリセットする。 As shown in FIG. 12, the limit angle forced steering control includes flag control (S1) and execution/stop control (S2), which are subroutines. As shown in FIG. 13, in the flag control, the control unit 50 determines whether or not the automatic steering control is ON and the angle detected by the steering angle sensor 21 and the instructed steering angle have exceeded a predetermined threshold value (turning determination angle). is determined (S101), and if the determination result is YES, the limit angle forced steering control flag is set (S102), and if the determination result is NO, the limit angle forced steering control flag is reset (S103). In this embodiment, when the limit angle forced steering control flag is reset, the command steering angle for turning is also reset.

図14に示すように、制御部50は、実行・停止制御において、ハンドル負荷カウンタを平滑化した後(S201)、限界角強制操舵制御フラグの状態を判断し(S202)、限界角強制操舵制御フラグがリセット状態であると判断した場合は、限界角到達フラグ及び前輪角戻しフラグをリセットした後(S203、S204)、上位ルーチンに復帰する。 As shown in FIG. 14, in the execution/stop control, the control unit 50 smoothes the steering wheel load counter (S201), determines the state of the limit angle forced steering control flag (S202), and determines the limit angle forced steering control. When it is determined that the flag is in the reset state, after resetting the limit angle arrival flag and the front wheel angle return flag (S203, S204), the process returns to the upper routine.

制御部50は、限界角強制操舵制御フラグがセット状態であると判断した場合は、操舵角センサ値を指示操舵角と比較し、且つハンドル負荷カウンタ値を所定の閾値(限界角到達判定値)と比較する(S205~S208)。ここで制御部50は、操舵角センサ値が指示操舵角未満で、且つハンドル負荷カウンタ値が所定の閾値未満の場合は、前輪10が機械的な限界角度まで到達していないと判断し(S205のYES)、また、操舵角センサ値が指示操舵角未満で、且つハンドル負荷カウンタ値が所定の閾値以上の場合は、操舵角センサ値が指示操舵角未満でも、前輪10が機械的な限界角度まで到達したと判断し(S206のYES)、また、操舵角センサ値が指示操舵角以上で、且つハンドル負荷カウンタ値が所定の閾値未満の場合は、操舵角センサ値が指示操舵角以上であっても、前輪10が機械的な限界角度まで到達していないと判断し(S207のYES)、また、操舵角センサ値が指示操舵角以上で、且つハンドル負荷カウンタ値が所定の閾値以上の場合は、前輪10が機械的な限界角度まで到達したと判断する(S208のYES)。 When the controller 50 determines that the limit angle forced steering control flag is set, the controller 50 compares the steering angle sensor value with the instructed steering angle, and sets the steering wheel load counter value to a predetermined threshold value (limit angle arrival determination value). (S205-S208). Here, if the steering angle sensor value is less than the instructed steering angle and the steering wheel load counter value is less than a predetermined threshold value, the control unit 50 determines that the front wheels 10 have not reached the mechanical limit angle (S205). YES), and if the steering angle sensor value is less than the instructed steering angle and the steering wheel load counter value is equal to or greater than a predetermined threshold value, the front wheels 10 reach the mechanical limit angle even if the steering angle sensor value is less than the instructed steering angle. (YES in S206), and if the steering angle sensor value is equal to or greater than the instructed steering angle and the steering wheel load counter value is less than the predetermined threshold value, the steering angle sensor value is equal to or greater than the instructed steering angle. However, if it is determined that the front wheels 10 have not reached the mechanical limit angle (YES in S207), and if the steering angle sensor value is equal to or greater than the instructed steering angle and the steering wheel load counter value is equal to or greater than a predetermined threshold value determines that the front wheel 10 has reached the mechanical limit angle (YES in S208).

制御部50は、ステップS205の判断結果がYESの場合は、そのまま前輪10の限界角方向への操舵を継続させ、ステップS207の判断結果がYESの場合は、指示操舵角の値に追加角度を徐々に加算することで(S209)、前輪10の限界角方向への操舵を継続させる。 If the determination result in step S205 is YES, the control unit 50 continues the steering of the front wheels 10 in the direction of the limit angle. By gradually adding (S209), the steering of the front wheels 10 in the limit angle direction is continued.

一方、制御部50は、ステップS206又はステップS208の判断結果がYESの場合は、指示操舵角(旋回用指示操舵角)の値に操舵角センサ値を代入した後(S210、S212)、限界角到達フラグをセットする(S211、S213)。その後、制御部50は、限界角到達フラグのセット判断(S214)に応じて、指示操舵角を所定の戻し角度分だけ減算する(S215)。これにより、前輪10が限界角度に到達した後、減算された指示操舵角に基づいて所定の戻し角度分だけ前輪10を逆方向に操舵させることができる。なお、ステップS215の減算処理は、限界角到達フラグのセット後に1回のみ実行され、減算処理実行後は、前輪角戻しフラグのセットに基づき(S216)、ステップS215をスキップするスキップ処理が実行される(S217)。 On the other hand, if the determination result in step S206 or step S208 is YES, the controller 50 substitutes the steering angle sensor value for the instructed steering angle (instructed steering angle for turning) (S210, S212). An arrival flag is set (S211, S213). After that, the control unit 50 subtracts a predetermined return angle from the instructed steering angle (S215) in accordance with whether the limit angle arrival flag is set (S214). As a result, after the front wheels 10 reach the limit angle, the front wheels 10 can be steered in the reverse direction by a predetermined return angle based on the subtracted command steering angle. Note that the subtraction process in step S215 is executed only once after the limit angle arrival flag is set, and after the subtraction process is executed, based on the front wheel angle return flag being set (S216), a skip process for skipping step S215 is executed. (S217).

叙述の如く構成された本実施形態によれば、前輪10及び後輪11を有する走行機体1と、走行機体1の位置情報を取得する位置情報取得システム41と、アクチュエータの駆動により前輪10を操舵する操舵装置9(自動操舵ユニット15)と、前輪10の操舵角を検出する操舵角センサ21と、位置情報取得システム41が取得した走行機体1の位置情報に基づいて、操舵装置9を制御する自動操舵制御を実行可能に構成される制御部50と、を備える乗用田植機Pであって、制御部50は、自動操舵制御がオン状態で、且つ操舵角センサ21の検出角度又は制御部50から操舵装置9に対する指示操舵角が所定の旋回判定角度を超えたとき、前輪10を機械的な限界角度まで操舵させるとともに、限界角度に到達した時点における操舵角センサ21の検出角度を旋回用指示操舵角として設定する限界角強制操舵制御手段を備えるので、機体旋回時には、前輪10を機械的な限界角度まで操舵させることができ、その結果、旋回半径が大きく膨らむことを防止し、次行程に適切に進入させることができる。また、限界角度に到達した時点における操舵角センサ21の検出角度を旋回用指示操舵角として設定するので、機体旋回中において前輪10を機械的な限界角度に維持することができる。 According to the present embodiment configured as described above, the traveling machine body 1 having the front wheels 10 and the rear wheels 11, the position information acquisition system 41 for acquiring the position information of the traveling machine body 1, and the front wheels 10 are steered by driving the actuators. The steering device 9 (automatic steering unit 15), the steering angle sensor 21 for detecting the steering angle of the front wheels 10, and the position information of the traveling machine body 1 acquired by the position information acquisition system 41 are used to control the steering device 9. and a control unit 50 configured to be capable of executing automatic steering control, wherein the control unit 50 controls the detection angle of the steering angle sensor 21 when the automatic steering control is on and the control unit 50 When the commanded steering angle to the steering device 9 exceeds a predetermined turning determination angle, the front wheels 10 are steered to a mechanical limit angle, and the angle detected by the steering angle sensor 21 at the time when the limit angle is reached is used as an instruction for turning. Since a limit angle forced steering control means for setting the steering angle is provided, the front wheels 10 can be steered to the mechanical limit angle when the aircraft is turning. can enter properly. In addition, since the angle detected by the steering angle sensor 21 when the limit angle is reached is set as the command steering angle for turning, the front wheels 10 can be mechanically maintained at the limit angle during turning of the aircraft.

また、限界角強制操舵制御手段は、自動操舵制御がオン状態で、且つ操舵角センサ21の検出角度又は指示操舵角が所定の旋回判定角度を超えたとき、前輪10を機械的な限界角度まで操舵させるとともに、限界角度に到達した時点おける前記操舵角センサ21の検出角度から所定の戻し角度分だけ減算した角度を旋回用指示操舵角として設定するので、前輪10が限界角度に到達した後、減算された旋回用指示操舵角に基づいて所定の戻し角度分だけ前輪10を逆方向に操舵させ、油圧機器のリリーフ動作を抑制することができる。 In addition, the limit angle forced steering control means rotates the front wheels 10 up to the mechanical limit angle when the automatic steering control is on and the angle detected by the steering angle sensor 21 or the instructed steering angle exceeds a predetermined turn determination angle. As the vehicle is steered, an angle obtained by subtracting a predetermined return angle from the angle detected by the steering angle sensor 21 at the time when the front wheel 10 reaches the limit angle is set as the instruction steering angle for turning. The front wheels 10 can be steered in the reverse direction by a predetermined return angle based on the subtracted command steering angle for turning, and the relief operation of the hydraulic equipment can be suppressed.

また、制御部50は、自動操舵制御がオフ状態、又は、操舵角センサ21の検出角度又は指示操舵角が所定の旋回判定角度以下となったとき、旋回用指示操舵角をリセットして初期値に戻すので、機体旋回時以外の自動操舵制御に対する影響を抑制でき、また、機体旋回毎に新たな旋回用指示操舵角を再設定することで、作業中における操舵角センサ21の誤差変動にも適切に対応できる。 Further, when the automatic steering control is turned off, or when the angle detected by the steering angle sensor 21 or the commanded steering angle becomes equal to or less than a predetermined turn determination angle, the control unit 50 resets the commanded steering angle for turning to the initial value. In addition, by resetting a new instruction steering angle for turning each time the aircraft turns, it is possible to reduce the error fluctuation of the steering angle sensor 21 during work. can respond appropriately.

なお、本発明は前記実施形態に限定されるものではなく、特許請求の範囲に記載された本発明の要旨の範囲内において、種々の変形、変更が可能である。例えば、限界角強制操舵制御手段は、自動操舵制御がオン状態で、且つ操舵角センサ21の検出角度又は指示操舵角が所定の旋回判定角度を超えたとき、前輪10を機械的な限界角度まで操舵させた後、所定の戻し角度分だけ前輪10を逆方向に操舵させ、その時点における操舵角センサ21の検出角度を旋回用指示操舵角として設定するようにしてもよい。 The present invention is not limited to the above embodiments, and various modifications and changes are possible within the scope of the gist of the present invention described in the claims. For example, when the automatic steering control is ON and the angle detected by the steering angle sensor 21 or the instructed steering angle exceeds a predetermined turn determination angle, the limit angle forced steering control means moves the front wheels 10 up to the mechanical limit angle. After steering, the front wheels 10 may be steered in the reverse direction by a predetermined return angle, and the angle detected by the steering angle sensor 21 at that time may be set as the command steering angle for turning.

1 走行機体
2 昇降リンク機構
3 植付作業機
4 苗載台
5 植付機構
6 エンジン搭載部
7 HST
8 ミッションケース
9 操舵装置
10 前輪
11 後輪
12 操縦部
13 ステアリングハンドル
14 主変速レバー
15 自動操舵ユニット
16 フロントアクスル
17 ピットマンアーム
18 トルクジェネレータ
19 操舵ロッド
20 センサ連動機構
21 操舵角センサ
21a センサアーム
22 センサブラケット
23 第1支軸
24 第1連動アーム
25 第2連動アーム
26 第2支軸
27 第3連動アーム
27a ピン
28 第1連動ロッド
29 第2連動ロッド
30 ステアリングモータ
31、31B 操作パネル
32 電流値センサ
33 電源スイッチ
34 自動操舵スイッチ
35 始点A点登録スイッチ
36 終点B点登録スイッチ
37 リセットスイッチ
38 報知表示部
39 報知ブザー
40 測位用フレーム
40a 縦フレーム部
40b 横フレーム部
41 位置情報取得システム
42 基準用GNSSアンテナ
43 方位用GNSSアンテナ
44 タブレット
45 GNSSユニット
46 RTK基地局
47 補正信号受信装置
50 制御部
1 Traveling body 2 Lifting link mechanism 3 Planting work machine 4 Seedling platform 5 Planting mechanism 6 Engine mounting part 7 HST
8 Transmission case 9 Steering device 10 Front wheel 11 Rear wheel 12 Control unit 13 Steering handle 14 Main transmission lever 15 Automatic steering unit 16 Front axle 17 Pitman arm 18 Torque generator 19 Steering rod 20 Sensor interlocking mechanism 21 Steering angle sensor 21a Sensor arm 22 Sensor Bracket 23 First support shaft 24 First interlocking arm 25 Second interlocking arm 26 Second support shaft 27 Third interlocking arm 27a Pin 28 First interlocking rod 29 Second interlocking rod 30 Steering motors 31, 31B Operation panel 32 Current value sensor 33 power switch 34 automatic steering switch 35 start point A point registration switch 36 end point B point registration switch 37 reset switch 38 notification display section 39 notification buzzer 40 positioning frame 40a vertical frame section 40b horizontal frame section 41 position information acquisition system 42 reference GNSS Antenna 43 Directional GNSS antenna 44 Tablet 45 GNSS unit 46 RTK base station 47 Correction signal receiver 50 Control unit

Claims (4)

前輪及び後輪を有する走行機体と、
前記走行機体の位置情報を取得する位置情報取得システムと、
アクチュエータの駆動により前記前輪を操舵する操舵装置と、
前記前輪の操舵角を検出する操舵角センサと、
前記位置情報取得システムが取得した前記走行機体の位置情報に基づいて、前記操舵装置を制御する自動操舵制御を実行可能に構成される制御部と、を備える作業車両であって、
前記制御部は、前記自動操舵制御がオン状態で、且つ前記操舵角センサの検出角度又は前記制御部から前記操舵装置に対する指示操舵角が所定の旋回判定角度を超えたとき、前記前輪を機械的な限界角度まで操舵させるとともに、前記限界角度に到達した時点における前記操舵角センサの検出角度を旋回用指示操舵角として設定する旋回用指示操舵角設定手段を備えることを特徴とする作業車両。
A running body having front wheels and rear wheels;
a position information acquisition system for acquiring position information of the traveling machine;
a steering device that steers the front wheels by driving an actuator;
a steering angle sensor that detects the steering angle of the front wheels;
a control unit configured to be capable of executing automatic steering control for controlling the steering device based on the position information of the traveling machine body acquired by the position information acquisition system, wherein
When the automatic steering control is on and the angle detected by the steering angle sensor or the steering angle instructed by the control unit to the steering device exceeds a predetermined turning determination angle, the control unit mechanically rotates the front wheels. a command steering angle setting means for steering the work vehicle up to a limit angle and setting an angle detected by the steering angle sensor at the time when the limit angle is reached as a command steering angle for turning.
前記旋回用指示操舵角設定手段は、前記自動操舵制御がオン状態で、且つ前記操舵角センサの検出角度又は前記指示操舵角が前記所定の旋回判定角度を超えたとき、前記前輪を機械的な限界角度まで操舵させた後、所定の戻し角度分だけ前記前輪を逆方向に操舵させ、その時点における前記操舵角センサの検出角度を前記旋回用指示操舵角として設定することを特徴とする請求項1に記載の作業車両。 The instructed steering angle setting means for turning mechanically moves the front wheels when the automatic steering control is on and the angle detected by the steering angle sensor or the instructed steering angle exceeds the predetermined turning determination angle. After the vehicle is steered to the limit angle, the front wheels are steered in the opposite direction by a predetermined return angle, and the angle detected by the steering angle sensor at that time is set as the instruction steering angle for turning. 1. The work vehicle according to 1. 前記旋回用指示操舵角設定手段は、前記自動操舵制御がオン状態で、且つ前記操舵角センサの検出角度又は前記指示操舵角が前記所定の旋回判定角度を超えたとき、前記前輪を機械的な限界角度まで操舵させるとともに、前記限界角度に到達した時点おける前記操舵角センサの検出角度から所定の戻し角度分だけ減算した角度を前記旋回用指示操舵角として設定することを特徴とする請求項1に記載の作業車両。 The instructed steering angle setting means for turning mechanically moves the front wheels when the automatic steering control is on and the angle detected by the steering angle sensor or the instructed steering angle exceeds the predetermined turning determination angle. The vehicle is steered to a limit angle, and an angle obtained by subtracting a predetermined return angle from the angle detected by the steering angle sensor when the limit angle is reached is set as the command steering angle for turning. Work vehicle described in . 前記制御部は、前記自動操舵制御がオフ状態、又は、前記操舵角センサの検出角度又は前記指示操舵角が前記所定の旋回判定角度以下となったとき、前記旋回用指示操舵角をリセットして初期値に戻すことを特徴とする請求項1~3のいずれか1項に記載の作業車両。 The controller resets the command steering angle for turning when the automatic steering control is turned off or when the angle detected by the steering angle sensor or the command steering angle becomes equal to or less than the predetermined turning determination angle. The work vehicle according to any one of claims 1 to 3, wherein the work vehicle is reset to an initial value.
JP2021155133A 2021-09-24 2021-09-24 work vehicle Pending JP2023046508A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2021155133A JP2023046508A (en) 2021-09-24 2021-09-24 work vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2021155133A JP2023046508A (en) 2021-09-24 2021-09-24 work vehicle

Publications (1)

Publication Number Publication Date
JP2023046508A true JP2023046508A (en) 2023-04-05

Family

ID=85778095

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021155133A Pending JP2023046508A (en) 2021-09-24 2021-09-24 work vehicle

Country Status (1)

Country Link
JP (1) JP2023046508A (en)

Similar Documents

Publication Publication Date Title
US11317557B2 (en) Automatic steering system and automatic steering method
KR102553109B1 (en) Working vehicle
JP6552420B2 (en) Work vehicle
JP2017211734A (en) Autonomous travel route generation system
JP2017161987A (en) Travel area form registration system of work vehicle
JP7155328B2 (en) work vehicle
JP6499605B2 (en) Traveling area identification device
JP2022125058A (en) work vehicle
JP2015222503A (en) Autonomous travel working vehicle
KR20200109295A (en) Work vehicle
KR20210023809A (en) Work vehicle
JP2018148858A (en) Work vehicle
JP2023046508A (en) work vehicle
JP2022167991A (en) Autonomous traveling system
KR20210022534A (en) Work vehicle
JP7398328B2 (en) work vehicle
JP2023050913A (en) work vehicle
JP7398329B2 (en) work vehicle
JP7236791B2 (en) riding rice transplanter
JP7059123B2 (en) Work vehicle
JP7236792B2 (en) riding rice transplanter
WO2020012931A1 (en) Work vehicle
JP2021040543A (en) Sulky rice transplanter
JP7344453B2 (en) work vehicle
JP2021040542A (en) Sulky rice transplanter