JP2019176801A - Field work vehicle - Google Patents
Field work vehicle Download PDFInfo
- Publication number
- JP2019176801A JP2019176801A JP2018068359A JP2018068359A JP2019176801A JP 2019176801 A JP2019176801 A JP 2019176801A JP 2018068359 A JP2018068359 A JP 2018068359A JP 2018068359 A JP2018068359 A JP 2018068359A JP 2019176801 A JP2019176801 A JP 2019176801A
- Authority
- JP
- Japan
- Prior art keywords
- automatic steering
- travel
- steering
- traveling
- automatic
- 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
Links
- 230000007246 mechanism Effects 0.000 claims description 14
- 238000001514 detection method Methods 0.000 claims description 9
- 238000004891 communication Methods 0.000 claims description 6
- 230000002159 abnormal effect Effects 0.000 claims description 4
- 230000007547 defect Effects 0.000 claims description 2
- 230000007257 malfunction Effects 0.000 claims 3
- 241000209094 Oryza Species 0.000 description 21
- 235000007164 Oryza sativa Nutrition 0.000 description 21
- 235000009566 rice Nutrition 0.000 description 21
- 230000007704 transition Effects 0.000 description 21
- 238000005259 measurement Methods 0.000 description 14
- 239000004973 liquid crystal related substance Substances 0.000 description 12
- 238000000034 method Methods 0.000 description 11
- 230000005540 biological transmission Effects 0.000 description 10
- 230000008569 process Effects 0.000 description 10
- 239000003550 marker Substances 0.000 description 8
- 238000012545 processing Methods 0.000 description 6
- 230000008859 change Effects 0.000 description 5
- 238000012937 correction Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000002411 adverse Effects 0.000 description 2
- 230000015556 catabolic process Effects 0.000 description 2
- 238000006731 degradation reaction Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 241000196324 Embryophyta Species 0.000 description 1
- 230000004397 blinking Effects 0.000 description 1
- 230000008602 contraction Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002706 hydrostatic effect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000005012 migration Effects 0.000 description 1
- 238000013508 migration Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 210000003813 thumb Anatomy 0.000 description 1
Images
Landscapes
- Guiding Agricultural Machines (AREA)
Abstract
Description
本発明は、直進走行と、この直進走行から次の直進走行に移行するための旋回走行とを組み合わせて圃場作業を行う圃場作業車に関する。 The present invention relates to a field work vehicle that performs a field work by combining a straight traveling and a turning traveling for shifting from the straight traveling to the next straight traveling.
このようなタイプの圃場作業車において、旋回走行は直進走行に比べて自動操舵が難しいので、直進走行には自動操舵を、旋回走行には手動走行を採用することが多い。その場合でも、手動操舵での旋回走行から自動操舵での直進走行への移行時には、その移行がスムーズとなるような車体姿勢となる車***置や車体方位が確保されていることが重要である。このため、例えば、特許文献1による圃場作業車では、自動操舵走行のために用いられる目標走行経路と、この目標走行経路に対する車体の向きが把握できる車体シンボルとがモニタ画面に表示される。運転者は、このモニタ画面を見ながら、車体を自動操舵への移行がスムーズに行われるような適切な姿勢に手動操舵する。
In this type of field work vehicle, since turning is difficult to turn automatically compared to straight running, automatic steering is often used for straight running and manual running is often used for turning. Even in such a case, it is important that a vehicle body position and a vehicle body orientation are secured so that the vehicle body posture becomes smooth when the transition from the turning traveling by the manual steering to the straight traveling by the automatic steering is performed. For this reason, for example, in a farm work vehicle according to
小さなモニタ画面を見ながらの操舵で、車体を正確に適切な姿勢にするには、運転者の熟練が要求される。特許文献2による圃場作業車では、手動操舵から自動操舵への移行がスムーズに行われる車体方位になったことを測位センサからの信号を通じて制御ユニットが判定し、手動操舵から自動操舵への移行許可を報知する機能が備えられている。
Driver skill is required in order to accurately position the vehicle body by steering while looking at a small monitor screen. In the field work vehicle according to
特許文献2による作業車では、車体が手動操舵から自動操舵への移行に適した車体姿勢となった際に、移行許可の報知がなされるので、特許文献1による作業車に比べて、手動操舵から自動操舵への移行が容易となる。しかしながら、移行許可の判定がなされた直後に、車体の姿勢が手動操舵から自動操舵への移行に不適切な姿勢になる可能性がある。そのような不適切な車体姿勢において、手動操舵から自動操舵に移行すれば、目標走行経路から大きく逸れた走行軌跡となり、質の高い作業走行ができなくなる。このことから、手動操舵から自動操舵への適切な移行が実現できる制御を備えた圃場作業車が要望されている。
In the work vehicle according to
本発明による圃場作業車は、直進走行と、前記直進走行から次の直進走行に移行するための旋回走行とを組み合わせて圃場作業を行う圃場作業車であり、走行車体と、前記直進走行における走行目標となる目標走行経路を設定する経路設定部と、運転者の指示に基づいて前記目標走行経路を自動操舵で走行することを要求する自動操舵要求を出力する自動操舵要求部と、前記目標走行経路の自動操舵走行の可能性を判定し、前記自動操舵走行が可能と判定された場合に前記自動操舵要求を承認し、前記自動操舵走行が不可能と判定された場合に前記自動操舵要求を否認する自動操舵走行判定部と、前記自動操舵走行判定部によって前記自動操舵要求が否認された場合に前記自動操舵走行の不可能理由を報知する報知デバイスとを備える。 A field work vehicle according to the present invention is a field work vehicle that performs a field work by combining a straight traveling and a turning traveling for shifting from the straight traveling to the next straight traveling, and a traveling vehicle body and a traveling in the straight traveling A route setting unit that sets a target travel route to be a target, an automatic steering request unit that outputs an automatic steering request that requests the target travel route to travel by automatic steering based on a driver's instruction, and the target travel The possibility of automatic steering traveling on the route is determined, the automatic steering request is approved when it is determined that the automatic steering traveling is possible, and the automatic steering request is accepted when it is determined that the automatic steering traveling is impossible. An automatic steering travel determination unit that rejects, and a notification device that notifies the reason why the automatic steering travel is impossible when the automatic steering request is rejected by the automatic steering travel determination unit.
この構成によれば、車体が手動操舵での旋回走行から自動操舵への移行に適した車体姿勢となったと運転者が判断し、自動操舵要求が行われた場合、適切な自動操舵走行が可能であるか判定され、自動操舵走行が可能と判定された場合、自動操舵要求が承認され、適切な自動操舵走行が不可能と判定された場合、自動操舵要求が否認される。自動操舵要求が否認された場合、自動操舵走行の不可能理由が運転者に報知されるので、運転者は、不可能理由を考慮して、自動操舵走行への移行がスムーズに行われるように、運転することができる。なお、本願明細書で記載された語句「直進走行」は、必ずしも直線に沿った走行を意味しているわけではなく、曲線に沿った走行も意味している。 According to this configuration, when the driver determines that the vehicle body is in a posture suitable for shifting from turning with manual steering to automatic steering, and when an automatic steering request is made, appropriate automatic steering can be performed. When it is determined that automatic steering travel is possible, the automatic steering request is approved, and when it is determined that appropriate automatic steering travel is impossible, the automatic steering request is denied. When the automatic steering request is denied, the driver is notified of the reason why the automatic steering travel is impossible, so that the driver can smoothly transition to the automatic steering travel in consideration of the impossible reason. Can drive. It should be noted that the phrase “straight traveling” described in the present specification does not necessarily mean traveling along a straight line, but also means traveling along a curve.
手動操舵での旋回走行から自動操舵での直進走行へのスムーズな移行にとって、悪影響を与える要因の1つが、車体と前記目標走行経路との間の方位ずれが大きいことである。大きな方位ずれは、操舵制御において制御ハンチングを引き起こすからである。このことから、本発明の好適な実施形態の1つでは、前記不可能理由が前記走行車体と前記目標走行経路との間の方位ずれである。 One of the factors that adversely affects the smooth transition from turning with manual steering to straight traveling with automatic steering is that the azimuth misalignment between the vehicle body and the target travel route is large. This is because a large misorientation causes control hunting in steering control. From this, in one of the preferred embodiments of the present invention, the reason for the impossibility is an azimuth shift between the traveling vehicle body and the target traveling route.
同様に、手動操舵での旋回走行から自動操舵での直進走行へのスムーズな移行にとって、悪影響を与える要因の1つが、車体と前記目標走行経路との間の位置ずれが大きいことである。したがって、本発明の好適な実施形態の1つでは、前記不可能理由が前記走行車体と前記目標走行経路との間の位置ずれである。 Similarly, one of the factors that have an adverse effect on the smooth transition from turning with manual steering to straight traveling with automatic steering is that the positional deviation between the vehicle body and the target travel route is large. Therefore, in one preferred embodiment of the present invention, the reason for the impossibility is a positional deviation between the traveling vehicle body and the target traveling route.
手動操舵走行から自動操舵走行への移行が不可能とみなされる不可能理由として、作業装置としてフロートを有する苗植付装置が備えられた圃場作業車では、さらに、前記フロートの田面接地が未検出であること、あるいはフロートが圃場の田面に接地した後の走行距離が所定値未満であることが挙げられる。これは、フロートが田面に接地していない状態では、適切な苗植付作業ができないので、そのような状態で、苗植付作業を行う自動操舵走行への移行を回避するためである。 The reason why it is considered impossible to shift from manual steering to automatic steering is that, in a field work vehicle equipped with a seedling planting device having a float as a working device, the float is not grounded. For example, the distance traveled after the float touches the field surface of the field is less than a predetermined value. This is because, in a state where the float is not in contact with the rice field, an appropriate seedling planting operation cannot be performed, and in this state, the shift to the automatic steering traveling in which the seedling planting operation is performed is avoided.
さらに別な実施形態では、操舵車輪の操舵角が所定値を超えていること、車速センサによる走行車体の検出走行速度(車速)がゼロであること、または、前もって設定されている作業用許容車速を超えていることなども、適切な操舵制御や適切な作業走行が困難となる要因となるので、不可能理由として採用される。 In still another embodiment, the steering angle of the steering wheel exceeds a predetermined value, the traveling speed (vehicle speed) detected by the vehicle body by the vehicle speed sensor is zero, or a preset allowable working vehicle speed. Since it also becomes a factor that makes it difficult to perform appropriate steering control and appropriate work travel, it is adopted as an impossible reason.
さらに、本発明の好適な実施形態では、装備されている自動操舵用機器群の不具合を検知するエラー検知部が備えられ、このエラー検知部によってエラーが検知されると、手動操舵走行から自動操舵走行への移行が不可能とみなされる。これにより、自動操舵用機器群にエラーが発生しているにも関わらず、自動操舵を行う不都合が回避される。自動操舵用機器群には、測位ユニットも含まれる。 Furthermore, in a preferred embodiment of the present invention, an error detection unit that detects a failure of the equipped automatic steering device group is provided, and when an error is detected by the error detection unit, automatic steering is started from manual steering traveling. Transition to driving is considered impossible. This avoids the inconvenience of performing automatic steering despite an error occurring in the automatic steering device group. The automatic steering device group includes a positioning unit.
手動操舵走行から自動操舵走行への移行を要求しているにも関わらず、自動操舵走行に移行しない場合、運転者が迅速かつ適切に、不可能理由を解消するための操作ができないことがある。このため、本発明の好適な実施形態の1つでは、前記報知デバイスは、前記不可能理由を解消するための人為操作内容を報知する。報知すべき内容を分かりやすく報知するためには、報知デバイスは、グラフィック表示が可能なパネルディスプレイであることが好ましい。 If a transition from manual steering to automatic steering is requested, but the vehicle does not transition to automatic steering, the driver may not be able to quickly and appropriately perform an operation to eliminate the impossible reason. . For this reason, in one of the preferable embodiments of the present invention, the notification device notifies the contents of the manual operation for solving the impossible reason. In order to notify the contents to be notified in an easy-to-understand manner, the notification device is preferably a panel display capable of graphic display.
不可能理由を解消するためには、判定条件を緩くすることも1つの方策である。このため、本発明の好適な実施形態の1つでは、前記不可能理由を解消するための複数種類の操作が可能なマルチ機能スイッチが備えられている。 In order to eliminate the impossible reason, it is also one measure to loosen the judgment condition. For this reason, in one of the preferred embodiments of the present invention, a multi-function switch capable of a plurality of types of operations for eliminating the reason for the impossibility is provided.
自動操舵走行を行うためには、目標走行経路を設定する必要がある。田植機のような圃場作業車の場合、この目標走行経路は、苗植付条を考慮して、正確な位置に設定する必要があるが、この設定は、運転者の技量により、手動のほうが良い場合と、自動のほうが良い場合がある。このことから発明の好適な実施形態の1つでは、前記経路設定部は、前記自動操舵要求が出力された時点の車***置を基準として前記目標走行経路を設定する人為設定モードと、あらかじめ設定された経路間隔に基づいて自動的に前記目標走行経路を設定する自動設定モードとを有する In order to perform automatic steering travel, it is necessary to set a target travel route. In the case of a farm work vehicle such as a rice transplanter, this target travel route must be set to an accurate position in consideration of the seedling planting conditions, but this setting is more manual depending on the skill of the driver. There are cases where it is better and automatic is better. Accordingly, in one preferred embodiment of the present invention, the route setting unit is preset with a human setting mode for setting the target travel route based on a vehicle body position at the time when the automatic steering request is output. And an automatic setting mode for automatically setting the target travel route based on the determined route interval
本発明の実施の形態を図面に基づいて説明する。ここでは、本発明の圃場作業車の一例として乗用型田植機(以下、単に田植機と略称する)を例に挙げて説明する。なお、図2に示されているように、本実施形態では、矢印Fが走行車体Cの車体前方、矢印Bが走行車体Cの車体後方、矢印Lが走行車体Cの車体左方、矢印Rが走行車体Cの車体右方で指している。 Embodiments of the present invention will be described with reference to the drawings. Here, a riding type rice transplanter (hereinafter simply referred to as a rice transplanter) will be described as an example of the field work vehicle of the present invention. As shown in FIG. 2, in the present embodiment, arrow F is the front of the traveling vehicle body C, arrow B is the rear of the traveling vehicle body C, arrow L is the vehicle body left of the traveling vehicle body C, arrow R Indicates the right side of the traveling vehicle body C.
図1から図3に示されているように、田植機には、左右一対の操舵車輪10と、走行装置としての左右一対の後車輪11とを有する走行車体Cと、圃場に対する苗の植え付けが可能な作業装置としての苗植付装置Wとが備えられている。左右一対の操舵車輪10は、走行車体Cの車体前側に設けられて走行車体Cの向きを変更操作自在なように構成され、左右一対の後車輪11は、走行車体Cの車体後側に設けられている。苗植付装置Wは、昇降用油圧シリンダ20の伸縮作動により昇降作動するリンク機構21を介して、走行車体Cの後端に昇降自在に連結されている。
As shown in FIGS. 1 to 3, the rice transplanter has a traveling vehicle body C having a pair of left and
走行車体Cの前部には、開閉式のボンネット12が備えられている。ボンネット12の先端位置には、マーカ装置33によって圃場に描かれる指標ラインに沿って走行するための目安となる棒状のセンターマスコット14が備えられている。走行車体Cには、前後方向に沿って延びる車体フレーム15が備えられ、車体フレーム15の前部には支持支柱フレーム16が立設されている。
An
ボンネット12内には、エンジン13が備えられている。詳述はしないが、エンジン13の動力が、車体に備えられた不図示のHST(静油圧式無段変速装置)を介して操舵車輪10及び後車輪11に伝達され、変速後の動力が電動モータ駆動式の植付クラッチ(不図示)を介して苗植付装置Wに伝達される。
An
苗植付装置Wは、ロータリ式の植付アームを備えた伝動機構22と、圃場の田面を整地するフロート23と、植え付け用のマット状苗を載置する苗載せ台26と、圃場の田面に指標ライン(不図示)を形成するマーカ装置33とを備えている。植付アームは、苗載せ台26に載せられた植え付け用のマット状苗から取り出した苗を圃場に植え付けていく。なお、この苗植付装置Wは八条植え型式に構成されているが、四条植え型式であったり、六条植え型式であったり、七条植え型式であったり、十条植え型式であったりしても良い。
The seedling planting device W includes a
走行車体Cにおけるボンネット12の左右側部には、複数(例えば四つ)の通常予備苗台28と、予備苗台29とが備えられている。走行車体Cにおけるボンネット12の左右側部には、各通常予備苗台28と予備苗台29とを支持する背高のフレーム部材としての左右一対の予備苗フレーム30が備えられ、左右の予備苗フレーム30の上部同士が連結フレーム31にて連結されている。
On the left and right sides of the
走行車体Cの中央部には、各種の運転操作が行われる運転部40が備えられている。運転部40には、運転座席41と、操舵ハンドル43と、主変速レバー44と、操作レバー45とが備えられている。運転座席41は、走行車体Cの中央部に備えられ、運転者が着座可能なように構成されている。操舵ハンドル43は、人為操作によって操舵車輪10の操舵操作を可能なように構成されている。主変速レバー44は、前後進の切換え操作や走行速度の変更操作が可能なように構成されている。苗植付装置Wの昇降と、左右のマーカ装置33の切換えとが操作レバー45によって行われる。操舵ハンドル43、主変速レバー44、操作レバー45等は、運転座席41の車体前部に位置する操縦塔42の上部に備えられている。運転部40の足元部位には、搭乗ステップ46が設けられている。搭乗ステップ46はボンネット12の左右両側にも延びている。運転座席41よりも下側には、エンジン13の回転によって充電されるバッテリ17が配置されている。
A driving
主変速レバー44を操作すると、HST(不図示)における斜板の角度が変更され、エンジン13の動力が無段階に変速される。図示しないが、HSTの斜板角度は、サーボ油圧制御機器を搭載した油圧ユニットによって制御される。サーボ油圧制御機器に、公知の油圧ポンプや油圧モータ等が用いられる。
When the
操作レバー45を上昇位置に操作すると、植付クラッチ(不図示)が切り操作されて苗植付装置Wに対する伝動が遮断され、昇降用油圧シリンダ20を作動して苗植付装置Wが上昇し、左右のマーカ装置33が格納姿勢に操作される。操作レバー45を下降位置に操作すると、苗植付装置Wが下降して田面に接地して停止した状態となる。この下降状態で操作レバー45を右マーカ位置に操作すると、右のマーカ装置33が格納姿勢から作用姿勢になる。操作レバー45を左マーカ位置に操作すると、左のマーカ装置33が格納姿勢から作用姿勢になる。
When the operating
運転者は、田植え作業を開始するときは、操作レバー45を操作して苗植付装置Wを下降させると共に、苗植付装置Wに対する伝動を開始させて田植え作業を開始する。そして、田植え作業を停止するときは、操作レバー45を操作して苗植付装置Wを上昇させると共に、苗植付装置Wに対する伝動を遮断する。
When starting the rice planting operation, the driver operates the
図2に示すように、運転部40の操縦塔42の上部の操作パネル47に、報知デバイス73(図5参照)の1つとして種々の情報を表示可能なタッチパネル式の液晶ディスプレイ48がグラフィック表示可能なパネルディスプレイとして備えられている。液晶ディスプレイ48の右側には、押し操作式の始点終点設定スイッチ91が備えられ、液晶ディスプレイ48の左側には、押し操作式の目標設定スイッチ92が備えられている。なお、液晶ディスプレイ48の左側に始点終点設定スイッチ91が備えられ、液晶ディスプレイ48の右側に目標設定スイッチ92が備えられる構成であっても良い。
As shown in FIG. 2, a touch panel type liquid crystal display 48 capable of displaying various information as one of the notification devices 73 (see FIG. 5) is displayed on the
主変速レバー44の握り部には、押し操作式の自動操舵スイッチ93が備えられている。自動操舵スイッチ93は、自動復帰型であり、押し操作する毎に自動操舵制御の入り切りの切換えを指令する。自動操舵スイッチ93は、主変速レバー44の握り部を手で握った状態で、例えば、親指で押すことができる位置に配置されている。さらに、複数の制御パラメータ等を調節するマルチ機能スイッチ94が操縦塔42に設けられている。始点終点設定スイッチ91、目標設定スイッチ92、自動操舵スイッチ93、マルチ機能スイッチ94の機能については後述する。
A push-operating type
図4に示されているように、走行車体Cには、左右の操舵車輪10を自動操舵可能な操舵機構Uが備えられている。操舵機構Uには、ステアリング操作軸64と、ピットマンアーム61と、ピットマンアーム61に連動連結される左右の連繋機構62と、操舵モータ66と、ギヤ機構63とが備えられている。ステアリング操作軸64は、クラッチ67を介して操舵ハンドル43と連動連結される。ピットマンアーム61は、ステアリング操作軸64の回動に伴って揺動するように構成されている。ギヤ機構63は、ステアリング操作軸64に操舵モータ66を連動連結している。
As shown in FIG. 4, the traveling vehicle body C is provided with a steering mechanism U that can automatically steer the left and
ステアリング操作軸64は、ピットマンアーム61及び左右の連繋機構62を介して、左右の操舵車輪10に夫々連動連結されている。ステアリング操作軸64の下端部に、ロータリエンコーダからなる操舵角センサ65が備えられ、ステアリング操作軸64の回転量は操舵角センサ65により検出される。
The
操舵機構Uの自動操舵を行う場合には、操舵モータ66を駆動して、操舵モータ66の駆動力によりステアリング操作軸64を回動操作し、操舵車輪10の操舵角度を変更するようになっている。自動操舵を行わない場合には、操舵機構Uは、操舵ハンドル43の人為操作により回動操作することができる。
When performing automatic steering of the steering mechanism U, the
次に、自動操舵制御を行うための構成について説明する。
この田植機では、測位ユニットPSとして、衛星測位モジュール81と、慣性計測モジュール82とを備えている。衛星測位モジュール81は、衛星からの電波を受信して車体の位置を検出する衛星測位用システム(GNSS:Global Navigation Satellite System)の一例として、周知の技術であるGPS(Global Positioning System)を利用して、車体の位置を求める衛星測位機能を有する。本実施形態では、衛星測位として、DGPS(Differential GPS:相対測位方式)が採用されているが、RTK−GPS(Real Time Kinematic GPS:干渉測位方式)などの他の方式を採用することも可能である。慣性計測モジュール82は、3軸ジャイロセンサ及び3軸加速度センサを含んでいる。衛星測位モジュール81は、電源投入時に、衛星の捕捉情報や、基地局からの補正情報を設定する初期処理(ウオームアップ処理)が必要である。同様に、慣性計測モジュール82も、電源投入時に、誤差補正(ドリフト補正など)ための各種補正値を設定する初期処理が必要である。
Next, a configuration for performing automatic steering control will be described.
This rice transplanter includes a
図1に示されているように、衛星測位アンテナを含む衛星測位モジュール81は、板状の支持プレートを介して連結フレーム31に取り付けられている。
As shown in FIG. 1, a
慣性計測モジュール82は、ジャイロセンサや加速度センサを有し、走行車体Cの旋回角度の角速度を検出可能であり、角速度を積分することで車体方位の角度変位を求めることができる。慣性計測モジュール82は、走行車体Cの旋回角度の角速度の他、走行車体Cの左右傾斜角度、走行車体Cの前後傾斜角度の角速度等も計測可能である。慣性計測モジュール82は、運転座席41の後側下方位置であって走行車体Cの横幅方向中央の低い位置に配置されている。慣性計測モジュール82を衛星測位モジュール81と同じ位置に配置してもよい。
The
図5に田植機における制御系の一部が、機能ブロック図の形で示されている。制御装置CUは、入出力インタフェースとして、入出力処理部50を備えている。入出力処理部50は、状態検出器群70や手動操作ユニット90など、種々の機器と接続している。この機能ブロック図では、上述した測位ユニットPSは、車載LANを介して制御装置CUと接続している。エンジン13を駆動するためのエンジン制御機器25は、車載LANを介して制御装置CUと接続しているエンジン制御ユニット71から制御信号を受ける。報知デバイス73は、車載LANを介して制御装置CUと接続している報知ユニット72から報知信号を受ける。
FIG. 5 shows a part of the control system in the rice transplanter in the form of a functional block diagram. The control unit CU includes an input /
種々のセンサやスイッチなどからなる状態検出器群70には、走行機器状態検出器74と作業機器状態検出器75とが含まれている。走行機器状態検出器74には、上述した操舵角センサ65以外に、図示されていないが、車速センサ、エンジン回転数センサ、ブレーキペダル検出センサ、駐車ブレーキ検出センサ、などの走行状態を検出するセンサが含まれている。作業機器状態検出器75には、苗植付装置Wの構成する各種部材の状態を検出するセンサ、苗載せ台26における苗の量を検出するセンサ、フロート23の姿勢位置を検出するフロートセンサ、などが含まれている。
The
スイッチ、ボタン、ボリュームなどからなる手動操作ユニット90は、運転者による手動操作によって制御指令を与えるものであり、その操作指令が制御装置CUに入力され。手動操作ユニット90には、前述した、始点終点設定スイッチ91、目標設定スイッチ92、自動操舵スイッチ93、マルチ機能スイッチ94などが含まれている。
The
制御装置CUには、自車位置算出部80、走行制御部51、作業制御部52、自動操舵制御部53、走行モード管理部54、自動操舵要求部55、自動操舵走行判定部56、エラー検知部57、などが備えられている。
The control unit CU includes a host vehicle
自車位置算出部80は、測位ユニットPSから逐次送られてくる測位データに基づいて、走行車体Cの地図座標(自車位置)及び走行車体Cの向き(方位)を算出する。その際、自車位置として、走行車体Cの特定箇所(例えば車体中心や苗植付装置Wの作業中心)の位置に変換することができる。
The own vehicle
走行制御部51は、操舵信号や車速信号を操舵機構Uやその他の走行機器群に与える。この田植機は、自動走行または手動走行で田植作業を行うことができるので、走行制御部51には、自動走行制御部511と手動走行制御部512とが含まれている。
The traveling
作業制御部52は、走行車体Cの走行に伴って苗植付装置Wの昇降や苗植付装置Wの駆動を制御する。
The
自動運転を行うために、自動走行モードが設定され、手動運転を行うためには手動走行モードが設定される。このような走行モードは、走行モード管理部54によって管理される。自動走行モードが設定されている場合、自動走行制御部511は自動操舵制御部53から自動操舵データ(操舵量)を受け取る。
An automatic travel mode is set to perform automatic operation, and a manual travel mode is set to perform manual operation. Such a travel mode is managed by the travel
自動操舵制御部53は、ティーチング経路算出部531、経路設定部532、ずれ量算出部533、操舵量算出部534を備えている。ティーチング経路算出部531は、ティーチング走行を通じて規定される基準経路のデータを算出する。経路設定部532は基準経路のデータに基づいて自動走行の目標となる目標走行経路(この実施形態では直進自動操舵走行のための経路)を設定する。ずれ量算出部533は、目標走行経路に対する走行車体Cの位置ずれ及び方位ずれを算出する。操舵量算出部534は、位置ずれ及び方位ずれが少なくなるような操舵量を算出する。
The automatic
自動操舵要求部55は、自動操舵スイッチ93を用いた運転者の指示に基づいて、設定された目標走行経路を自動操舵で走行することを要求する自動操舵要求を出力する。自動操舵要求の出力に応答して、自動操舵走行判定部56は、手動操舵での旋回走行から自動操舵での直進走行(目標走行経路に沿った自動操舵走行)への移行(手動操舵から自動操舵へに移行)が適切に行われるかどうかの可能性を、所定の判定条件に基づいて、判定する。判定条件に基づいて、自動操舵走行判定部56が自動操舵走行が可能と判定した場合には、自動操舵要求を承認する。これにより、走行制御は、手動操舵制御(手動走行モード)から自動操舵制御(自動走行モード)に移行する。判定条件に基づいて、自動操舵走行判定部56が自動操舵走行が不可能と判定した場合には、自動操舵要求が否認され、この段階では、自動操舵制御への移行は行われない。
The automatic
自動操舵走行判定部56で用いられる判定条件は、走行車体Cの姿勢、走行車体Cの走行状態、作業装置である苗植付装置Wの動作状態、制御系におけるデータ通信状態、状態検出器群70の動作状態などを用いて作成することができる。好適な判定条件要素の例が以下に列挙される。なお、これらの判定条件要素は、単独で、あるいはこれらの判定条件要素と所定値との比較結果で、自動操舵走行の許可または不許可の判定を導くことができる。
(1)走行車体Cと目標走行経路との間の方位ずれ。
(2)走行車体Cと目標走行経路との間の位置ずれ。
(3)フロート23の圃場の田面への接地が未検出。
(4)旋回走行後における、フロート23が圃場の田面に接地した状態での走行車体Cの走行距離(例えば数m未満では不許可)。
(5)操舵車輪10の操舵角(例えば所定値(±数度から十数度)を超える操舵角では不許可)。
(6)走行車体Cが停止または不適切な車速(苗植付作業に適しない車速)での走行。
(7)図5で示された各機能電子ユニットである自動操舵系電子ユニットにおけるシステム電圧の異常低下。
(8)操舵モータ66の制御不良。
(9)操舵機構Uにおける操舵モータユニットの動作不良(例えば、回転センサ及びモータドライバの断線/ショート/故障など)。
(10)操舵機構Uの機械的動作不良。
(11)測位ユニットPSの動作不良及び通信不良。
(12)車載LANの通信不良。
(13)車速センサなどの自動操舵関連センサの不良(断線/ショート/故障など)。
なお、(7)から(13)での判定条件となっている自動操舵用機器群の不具合は、エラー検知部57によって検知される。
The determination conditions used in the automatic steering traveling
(1) Direction deviation between the traveling vehicle body C and the target traveling route.
(2) Misalignment between the traveling vehicle body C and the target traveling route.
(3) No contact of the
(4) Travel distance of the traveling vehicle body C in a state where the
(5) The steering angle of the steering wheel 10 (for example, a steering angle exceeding a predetermined value (± several degrees to several tens of degrees) is not permitted).
(6) The traveling vehicle body C stops or travels at an inappropriate vehicle speed (vehicle speed not suitable for seedling planting work).
(7) Abnormal drop in system voltage in the automatic steering electronic unit which is each functional electronic unit shown in FIG.
(8) Poor control of the
(9) Operation failure of the steering motor unit in the steering mechanism U (for example, disconnection / short / failure of the rotation sensor and the motor driver).
(10) Mechanical operation failure of the steering mechanism U.
(11) Operation failure and communication failure of the positioning unit PS.
(12) In-vehicle LAN communication failure.
(13) Defects in automatic steering-related sensors such as vehicle speed sensors (disconnection / short / failure, etc.).
Note that a failure in the automatic steering device group that is the determination condition in (7) to (13) is detected by the
自動操舵走行判定部56によって自動操舵要求が否認された場合には、直ちに報知デバイス73としてのランプやブザーを通じて、運転者が認識できる形態で自動操舵に移行しないことが報知される。さらに、その自動操舵要求が許可されないこと、及び要求された自動操舵走行が不可能となった理由が液晶ディスプレイ48に表示される。これにより、運転者は、自動操舵に移行しない理由を把握し、自動操舵に移行するために必要な運転を行うことができる。
When an automatic steering request is denied by the automatic steering traveling
この実施形態では、不可能理由を解消するために、判定条件を緩くするためのマルチ機能スイッチ94が設けられている。マルチ機能スイッチ94を用いて、方位ずれ、位置ずれ、操舵角の許容範囲などを調整することで、苗植付条の精密さをある程度犠牲にしても、操縦に熟練していない運転者が、簡単に手動操舵の旋回走行から自動操作の直進走行(苗植付走行)に移行できるようになる。
In this embodiment, a
この田植機は、図6に示されているように、直線状の経路に沿って苗植付け作業を伴う作業走行と、畦際付近で次の苗植付け作業走行のための直線状の経路に移動するための旋回走行と、を交互に繰り返す。その際、最初の直線状の経路は、手動操舵されるティーチング経路であり、次からの直線状の経路は、経路設定部532によってティーチング経路に沿って並列するようにティーチング経路の情報に基づいて、設定される目標走行経路LM(1)〜LM(6)である。なお、目標走行経路、特に順番を特定しない一般的な表現においては、その図番は省略される。
As shown in FIG. 6, this rice transplanter moves along a straight path to a straight path for seedling planting work and a straight path for the next seedling planting work run near the edge. And turning to repeat. At that time, the first linear path is a manually-steered teaching path, and the next linear path is based on the information on the teaching path so that the
苗植付け作業を開始するにあたって、運転者は、走行車体Cを圃場内の畦際の始点位置Tsに位置させ、始点終点設定スイッチ91を操作する。このとき、制御装置CUは手動操舵モードに設定されている。そして、運転者が手動操縦しながら、始点位置Tsから側部側の畦際の直線形状に沿って走行車体Cを走行させ、反対側の畦際近くの終点位置Tfまで移動させてから始点終点設定スイッチ91を再度操作する。これにより、ティーチング処理が実行される。つまり、衛星測位モジュール81により取得された測位データに基づく始点位置Tsの位置座標と終点位置Tfの位置座標とから、始点位置Tsと終点位置Tfとを結ぶティーチング経路が設定される。このティーチング経路に沿う方向が基準となる目標方位LAとして設定される。なお、終点位置Tfにおける位置座標は、衛星測位モジュール81による測位データのみならず、車速センサ(非図示)に基づく始点位置Tsからの距離と、慣性計測モジュール82に基づく走行車体Cの方位情報と、に基づいて算出される構成であっても良い。また、始点位置Tsと終点位置Tfとに亘る走行車体Cの走行は、田植え作業を伴う作業走行であっても良いし、非作業状態の走行であっても良い。
When starting the seedling planting operation, the driver positions the traveling vehicle body C at the starting point position Ts at the end of the field and operates the starting point / end
ティーチング経路の設定完了後、ティーチング経路に隣接する、最初の目標走行経路LM(1)が設定される始点位置Lsに移行するために、180度の旋回走行が行われる。旋回走行は、運転者が手動で操舵ハンドル43を操作する手動操舵によって行われる。
After completing the setting of the teaching path, a 180-degree turning travel is performed in order to shift to the start position Ls adjacent to the teaching path where the first target travel path LM (1) is set. The turning traveling is performed by manual steering in which the driver manually operates the
この旋回走行が終了し、次の経路に合わせた段階で、目標設定スイッチ92が操作されると、目標走行経路LM(1)が経路設定部532によって設定される。その際、目標設定スイッチ92が操作された地点が次の条(隣接条)と既植付条との間隔(条間)が所望の間隔を作り出す地点であることが重要である。したがって、目標設定スイッチ92の操作によって目標走行経路LM(1)がティーチング経路から離れすぎているかあるいは近づき過ぎており、正常な苗植えが行われない場合、報知デバイス73を通じて警告が報知される。しかしながら、運転者が非熟練者の場合、正確な地点で目標設定スイッチ92を操作できない可能性があるので、目標設定スイッチ92の操作地点が異常な条間を作り出すと判定された場合には、目標設定スイッチ92の操作地点を無視して、経路設定部532があらかじめ設定されている条間となる位置に自動的に、目標走行経路LM(1)を設定する構成を採用してもよい。さらには、経路設定部532は、自動操舵要求が出力された時点の車***置を基準として目標走行経路LM(1)を設定する人為設定モードと、あらかじめ設定された条間に対応する経路間隔に基づいて自動的に目標走行経路LM(1)を設定する自動設定モードとを有するように構成してもよい。
When the
いずれにせよ、経路設定部532によって目標走行経路LM(1)が設定されると、次いで、自動操舵スイッチ93が操作される。これにより、自動操舵要求が出力されるので、自動操舵走行判定部56による、自動操舵への移行が可能かどうかの判定が行われる。自動操縦への移行が可能となると、設定された目標走行経路LM(1)に沿った自動操舵走行が開始される。また、自動操舵スイッチ93が操作された段階での走行車体C位置や方位などが、自動操舵に不適切な場合、自動操舵走行への移行が行われない。なお、目標設定スイッチ92と自動操舵スイッチ93とを共通化して、単一のスイッチとして構成してもよい。
In any case, when the target travel route LM (1) is set by the
自動操舵走行が許可されると、走行モードが手動操舵モードから自動操舵モードに切換えられ、目標走行経路LM(1)に沿う自動操舵が開始される。目標走行経路LM(1)は、ティーチング経路に隣接した状態で、目標方位LAの方位に沿って設定され、ティーチング処理後に走行車体Cが最初に作業走行を行う目標走行経路LMである。 When the automatic steering traveling is permitted, the traveling mode is switched from the manual steering mode to the automatic steering mode, and automatic steering along the target traveling route LM (1) is started. The target travel route LM (1) is a target travel route LM that is set along the direction of the target direction LA in a state adjacent to the teaching route, and the traveling vehicle body C first performs a work travel after the teaching process.
目標走行経路LM(1)における作業走行の完了後、任意のタイミングで目標設定スイッチ92が操作されると、経路設定部532によって次の目標走行経路LM(2)が先の目標走行経路LM(1)の未作業領域側に隣接して設定される。次いで、自動操舵スイッチ93が操作されることで、新しく設定された目標走行経路LM(2)に沿って自動操舵走行が開始され、走行車体Cが自動作業走行する。
When the
走行車体Cが目標走行経路LM(2)の終点位置Lf(2)に到達した後、同様なプロセスで、目標走行経路LM(3),LM(4),LM(5),LM(6)の順番で、旋回走行後の目標走行経路LMの設定と、作業走行とが繰り返される。 After the traveling vehicle body C reaches the end position Lf (2) of the target travel route LM (2), the target travel route LM (3), LM (4), LM (5), LM (6) is processed in the same process. In this order, the setting of the target travel route LM after the turn travel and the work travel are repeated.
自動操舵制御の間、衛星測位モジュール81によって自機位置の情報が経時的に取得される。また、車速が算出されると共に、図7に示されているように、慣性計測モジュール82による相対的な方位変化角ΔNAが経時的に計測される。ずれ量算出部533は、方位変化角ΔNAの積分によって、自動操舵が開始された地点からの自機方位NAを経時的に算出する。そして、ずれ量算出部533は、自機方位NAと目標方位LAとの方位ずれを算定する。操舵量算出部534は、自機方位NAが目標方位LAと合致するように操舵量を算出し、自動走行制御部511に与える。自動走行制御部511は、与えられた操舵量に基づいて操舵モータ66を駆動する。これにより、走行車体Cが、目標走行経路LMに沿って精度良く自動走行する。
During the automatic steering control, the
図8に示されているように、車体の状態が液晶ディスプレイ48の画面に表示される。この画面には、作業情報領域100、位置ずれ情報領域101、車速情報領域102等の複数の表示領域が区分け配置されている。作業情報領域100は、画面上側の左端に作業日時や作業実績などを表示する。位置ずれ情報領域101は、上側の中央に目標走行経路LMに対する走行車体Cの位置ずれ量を表示する。車速情報領域102は、上側の右端に車速を表示する。画面上側以外の大きな領域は位置情報領域104となっており、位置情報領域104は圃場における走行車体Cの位置を示す。位置情報領域104の左端の小さな領域は操舵状態情報領域103となっており、操舵状態情報領域103は制御装置CUで実行されている走行モード、つまり自動走行モード(自動操舵)又は手動走行モード(手動操舵)を表示する。位置情報領域104の右端には、タッチパネル操作式のソフトウエアボタン群120が配置されている。液晶ディスプレイ48の更に右側には、物理ボタン群121が配置されている。
As shown in FIG. 8, the state of the vehicle body is displayed on the screen of the liquid crystal display 48. On this screen, a plurality of display areas such as a
位置情報領域104には、走行車体C周辺の圃場の作業状態及び、目標走行経路LMと、自機位置を示す車体シンボルSYが表示されている。なお、目標走行経路LMのうち、作業走行中の目標走行経路LMは、分かりやすくするために太い実線で描画されている。更に、既に田植えが完了した領域は各植付苗を点描化して表示される。これにより、既作業領域と未作業領域とが視覚的に明確に区別されている。なお、この植付苗跡の表示は、点描以外に線状の植付条を示す線であっても良い。
In the
位置情報領域104の下側には、メッセージ表示領域105が配置されている。メッセージ表示領域105は運転者に報知したい情報を示す文字やコードを表示する領域である。
A
メッセージ表示領域105に、衛星測位モジュール81における精度低下率(DOP)、特に水平精度低下率(HDOP)に基づく衛星測位レベル(GPSレベル)を表示することができる。その際、捕捉衛星数が減少した場合には衛星測位レベルが下げられる。これにより、運転者は、衛星測位データの異常が発生しやすくなっているかどうかを把握することができる。
In the
次に、図9を用いて、この田植機の圃場での走行における、手動操舵での旋回走行から自動操舵での直進走行への移行における制御の流れを説明する。図9の左側には、走行制御ルーチンが示され、図9の右側には、手動操舵から自動操舵への移行可能性を判定する自動操舵走行判定ルーチンが示され、この自動操舵走行判定ルーチンで決定された自動操舵走行許可が走行制御ルーチンに与えられる。 Next, with reference to FIG. 9, a description will be given of the flow of control in the transition from the turning traveling by the manual steering to the straight traveling by the automatic steering in the traveling of the rice transplanter in the field. The left side of FIG. 9 shows a travel control routine, and the right side of FIG. 9 shows an automatic steering travel determination routine for determining the possibility of transition from manual steering to automatic steering. In this automatic steering travel determination routine, The determined automatic steering travel permission is given to the travel control routine.
この走行制御ルーチンにおいて、最初にティーチング走行が実行される(#01)。ティーチング走行において、上述したように、始点位置Tsの位置座標と終点位置Tfの位置座標とから、始点位置Tsと終点位置Tfとを結ぶティーチング経路が設定され、この始点位置Tsと終点位置Tfがメモリに格納される。ティーチング走行が終了すると、手動操舵で畔付近までさらに走行し、そこから手動操舵で旋回走行が実行される(#02)。 In this travel control routine, teaching travel is first executed (# 01). In teaching traveling, as described above, a teaching path connecting the start point position Ts and the end point position Tf is set from the position coordinates of the start point position Ts and the end point position Tf, and the start point position Ts and the end point position Tf are Stored in memory. When the teaching traveling is finished, the vehicle further travels to the vicinity by the manual steering, and the turning traveling is executed from there by manual steering (# 02).
旋回走行が終わり、苗植付位置が隣接条の位置にきたと判断すると、運転者は目標設定スイッチ92を操作する。これにより、目標走行経路LM(1)が経路設定部532によって設定される(#03)。さらに、自動操舵スイッチ93が操作されると、自動操舵要求が出力され(#04)、自動操舵走行判定ルーチンの判定結果として、自動操舵走行が許可されたかどうかのチェックが行われる(#05)。
When it is determined that the turning travel has ended and the seedling planting position has come to the position of the adjacent strip, the driver operates the
自動操舵走行判定ルーチンの判定結果として、自動操舵走行が許可されると(#05Yes分岐)、設定された目標走行経路LM(1)に沿った自動操舵走行が開始される。自動操舵走行では、上述したように、走行車体Cが目標走行経路LM(1)に沿って走行するように自動走行制御が実行される(#51〜#58)。まず、衛星測位モジュール81からの衛星測位データが読み込まれ(#51)、車***置が算出される(#52)。さらに、慣性計測モジュール82からの慣性計測データを読み込まれ(#53)、車体方位が算出される(#54)。設定されている目標走行経路LM(1)のデータがメモリに展開され(#55)、算出されている車***置または車体方位あるいはその両方に基づいて目標走行経路LM(1)に対する走行車体Cの位置ずれ量が算出される(#56)。次いで、位置ずれ量が小さくなるような操舵量が算出され(#57)、算出された操舵量に基づいて、操舵モータ66が駆動される(#58)。なお、経時的に算出された車***置から走行車体Cの方位を算出することができるので、当該方位を用いて、適時に、慣性計測モジュール82の補正が行われる。
If automatic steering travel is permitted (# 05 Yes branch) as a determination result of the automatic steering travel determination routine, automatic steering travel along the set target travel route LM (1) is started. In the automatic steering traveling, as described above, the automatic traveling control is executed so that the traveling vehicle body C travels along the target traveling route LM (1) (# 51 to # 58). First, satellite positioning data from the
このようにして所定距離または所定時間の自動操縦走行が行われるか、あるいは畔際に接近していることが検知されると、設定された目標走行経路LM(1)の走行が終了したかどうかチェックされる(#06)。目標走行経路LM(1)の走行が終了していなければ(#06No分岐)、ステップ#51に戻って、目標走行経路LM(1)に沿った自動操舵走行を続行する。目標走行経路LM(1)の走行が終了しておれば(#06Yes分岐)、自動操舵走行から手動操舵走行に移行し(#07)、圃場全体または計画された領域全体の作業走行が完了したかどうかチェックされる(#08)。全作業走行が完了して、未作業領域がなくなっておれば(#08Yes分岐)、作業の終了である。全作業走行が完了しておらず、未作業領域が残っておれば(#08No分岐)、ステップ#02に戻って旋回走行が行われ、次の目標走行経路LM(2)が設定される。このように、繰り返し、目標走行経路LM(3)・・・が設定され作業走行が進められていく。 In this way, when the autopilot travel for a predetermined distance or a predetermined time is performed, or when it is detected that the vehicle is approaching the bank, whether the travel of the set target travel route LM (1) has ended. It is checked (# 06). If the travel on the target travel route LM (1) has not ended (# 06 No branch), the process returns to step # 51 to continue the automatic steering travel along the target travel route LM (1). If the travel of the target travel route LM (1) has been completed (# 06 Yes branch), the automatic steering travel is shifted to the manual steering travel (# 07), and the work travel of the entire field or the entire planned area is completed. Is checked (# 08). If all the work runs are completed and there is no unworked area (# 08 Yes branch), the work is finished. If the entire work travel is not completed and an unworked area remains (# 08 No branch), the process returns to step # 02 to perform the turn travel, and the next target travel route LM (2) is set. In this way, the target travel route LM (3)... Is set repeatedly and the work travel is advanced.
走行制御ルーチンと連携する自動操舵走行判定ルーチンでは、旋回走行中または旋回走行が終了すると起動し、自動操舵要求が出力されるかどうかがチェックされる(#41)。走行制御ルーチンのステップ#04で自動操舵要求が出力されると(#41Yes分岐)、設定されている目標走行経路のデータがメモリから読み出される(#42)。さらに、上述したような自動操舵走行の判定に用いられる各種データが読み込まれる(#43)。次いで、自動操舵走行判定部56による移行判定処理が行われる(#44)。
In the automatic steering traveling determination routine linked with the traveling control routine, the automatic steering traveling determination routine is activated during turning traveling or when the turning traveling is finished, and it is checked whether or not an automatic steering request is output (# 41). When an automatic steering request is output in
図9で示された自動操舵走行判定ルーチンでは、上述した移行判定条件として、方位ずれ(#44a)、位置ずれ(#44b)、走行機器状態(#44c)、作業機器状態(#44d)、制御機器状態(#44e)、通信状態(#44f)が取り上げられている。ここでは、順番に判定して、移行を不可能とするような判定が下された段階で自動操舵要求が否認され(#46)、その不可能理由が液晶ディスプレイ48の画面、つまりメッセージ表示領域105に表示される(#47)。方位ずれや位置ずれなどは、改善する可能性があるので、ステップ#43に戻り、新たな自動操舵走行の判定に用いられる各種データが読み込まれ、移行判定処理を繰り返す。ここでは図示されていないが、各種機器のトラブルや信号線の断線など、短時間で復活できないようなエラーが生じている場合、移行判定処理は中止され、別なリカバリ処理が実行される。なお、ステップ#44の移行判定処理を構成する各判定条件チェック(#44a〜44f)をすべて行い、すべての判定条件チェックを終えてから、その判定結果を出力してもよい。この場合、判定条件に満たしていなかったすべての非成立項目を不可能理由として表示することができる。
In the automatic steering travel determination routine shown in FIG. 9, the shift determination conditions described above include azimuth shift (# 44a), position shift (# 44b), travel equipment state (# 44c), work equipment state (# 44d), The control device state (# 44e) and the communication state (# 44f) are taken up. In this case, the automatic steering request is denied at the stage where the judgment is made in order and the transition is impossible (# 46), and the reason for the impossibility is the screen of the liquid crystal display 48, that is, the message display area. 105 (# 47). Since there is a possibility that the azimuth deviation, position deviation, and the like may be improved, the process returns to step # 43, and various data used for the new automatic steering traveling determination are read, and the transition determination process is repeated. Although not shown here, when an error that cannot be recovered in a short time, such as a trouble in various devices or a disconnection of a signal line, has occurred, the migration determination process is stopped and another recovery process is executed. It should be noted that all the determination condition checks (# 44a to 44f) constituting the transition determination process in
手動操舵から自動操舵への移行判定処理において、すべての判定条件(判定条件要素)がクリアされると、自動操舵要求が承認され、自動操舵走行許可が出力される(#45)。これにより、走行制御ルーチンにおける自動操舵が実行されていく。 In the transition determination process from manual steering to automatic steering, when all the determination conditions (determination condition elements) are cleared, an automatic steering request is approved and automatic steering travel permission is output (# 45). Thereby, automatic steering in the travel control routine is executed.
〔別実施形態〕
本発明は、上述した実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
[Another embodiment]
The present invention is not limited to the configuration exemplified in the above-described embodiment, and a typical alternative embodiment of the present invention will be exemplified below.
〔1〕上述した実施形態では、自動操舵走行の不可能理由を報知する報知デバイス73として、液晶ディスプレイ48が採用されていたが、その他の表示機器や音声報知機器を採用してもよい。また、不可能理由をコードで報知してもよいし、ランプの色や点滅間隔などによって報知してもよい。
[1] In the above-described embodiment, the liquid crystal display 48 is used as the
〔2〕上述した実施形態では、目標走行経路は、目標設定スイッチ92の操作をトリガーとして、ティーチング走行で得られた基準経路に基づいて設定されたが、自動的に目標走行経路が設定される構成を採用してもよい。
〔3〕上述した実施形態では、最初にティーチング走行を実施し、ティーチング走行で得られた基準経路に基づいて目標走行経路が設定された。これに代えて、ティーチング走行は行わずに、圃場の形状等から自動的にすべての目標走行経路を生成して設定するような構成を採用してもよい。
〔4〕上述した実施形態では、報知デバイス73は、自動操舵走行の不可能理由を報知するように構成されていたが、さらに、不可能理由を解消するための人為操作内容を報知するように構成してもよい。
[2] In the above-described embodiment, the target travel route is set based on the reference route obtained by teaching travel using the operation of the
[3] In the above-described embodiment, the teaching travel is first performed, and the target travel route is set based on the reference route obtained by the teaching travel. Instead of this, a configuration may be adopted in which all the target travel routes are automatically generated and set from the shape of the field or the like without performing the teaching travel.
[4] In the above-described embodiment, the
本発明は、圃場に設定された走行経路に沿って作業走行が行われる圃場作業車に適用可能である。 The present invention can be applied to an agricultural field work vehicle in which work traveling is performed along a traveling route set in the agricultural field.
48 :液晶ディスプレイ
53 :自動操舵制御部
55 :自動操舵要求部
56 :自動操舵走行判定部
57 :エラー検知部
70 :状態検出器群
73 :報知デバイス
74 :走行機器状態検出器
75 :作業機器状態検出器
80 :自車位置算出部
81 :衛星測位モジュール
82 :慣性計測モジュール
90 :手動操作ユニット
91 :始点終点設定スイッチ
92 :目標設定スイッチ
93 :自動操舵スイッチ
94 :マルチ機能スイッチ
105 :メッセージ表示領域
511 :自動走行制御部
512 :手動走行制御部
531 :ティーチング経路算出部
532 :経路設定部
533 :ずれ量算出部
534 :操舵量算出部
CU :制御装置
PS :測位ユニット
48: Liquid crystal display 53: Automatic steering control unit 55: Automatic steering request unit 56: Automatic steering travel determination unit 57: Error detection unit 70: State detector group 73: Notification device 74: Traveling device state detector 75: Work device state Detector 80: Own vehicle position calculation unit 81: Satellite positioning module 82: Inertial measurement module 90: Manual operation unit 91: Start point end point setting switch 92: Target setting switch 93: Automatic steering switch 94: Multi-function switch 105: Message display area 511: Automatic travel control unit 512: Manual travel control unit 531: Teaching route calculation unit 532: Route setting unit 533: Deviation amount calculation unit 534: Steering amount calculation unit CU: Control device PS: Positioning unit
Claims (12)
走行車体と、
前記直進走行における走行目標となる目標走行経路を設定する経路設定部と、
運転者の指示に基づいて前記目標走行経路を自動操舵で走行することを要求する自動操舵要求を出力する自動操舵要求部と、
前記目標走行経路の自動操舵走行の可能性を判定し、前記自動操舵走行が可能と判定された場合に前記自動操舵要求を承認し、前記自動操舵走行が不可能と判定された場合に前記自動操舵要求を否認する自動操舵走行判定部と、
前記自動操舵走行判定部によって前記自動操舵要求が否認された場合に前記自動操舵走行の不可能理由を報知する報知デバイスと、
を備えた圃場作業車。 A field work vehicle that performs a field work by combining a straight traveling and a turning traveling for shifting from the straight traveling to the next straight traveling,
A traveling vehicle body,
A route setting unit for setting a target travel route to be a travel target in the straight traveling;
An automatic steering request unit that outputs an automatic steering request for requesting to drive the target travel route by automatic steering based on a driver's instruction;
The possibility of automatic steering travel of the target travel route is determined, the automatic steering request is approved when it is determined that the automatic steering travel is possible, and the automatic operation is performed when it is determined that the automatic steering travel is impossible. An automatic steering travel determination unit for rejecting a steering request;
A notification device for notifying the reason why the automatic steering travel is impossible when the automatic steering request is denied by the automatic steering travel determination unit;
Field work vehicle equipped with.
自動操舵系電子ユニットのシステム電圧の異常低下、
操舵車輪のための操舵モータユニットの動作不良、
操舵車輪のための操舵機構の動作不良、
自動操舵のための測位ユニットの動作不良、通信不良、
車載LANの通信不良、
車速センサ不良、
が含まれ、前記不具合の少なくとも1つが検知された場合に、前記自動操舵要求が前記自動操舵走行判定部によって否認される請求項1から7のいずれか一項に記載の圃場作業車。 An error detection unit that detects a failure of the equipment group for automatic steering that is equipped is provided.
Abnormal drop in system voltage of automatic steering electronic unit,
Malfunction of the steering motor unit for the steering wheel,
Malfunction of the steering mechanism for the steering wheel,
Positioning unit for automatic steering malfunction, communication failure,
In-vehicle LAN communication failure,
Bad vehicle speed sensor,
The field work vehicle according to any one of claims 1 to 7, wherein the automatic steering request is denied by the automatic steering travel determination unit when at least one of the defects is detected.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018068359A JP2019176801A (en) | 2018-03-30 | 2018-03-30 | Field work vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018068359A JP2019176801A (en) | 2018-03-30 | 2018-03-30 | Field work vehicle |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2019176801A true JP2019176801A (en) | 2019-10-17 |
Family
ID=68277048
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018068359A Pending JP2019176801A (en) | 2018-03-30 | 2018-03-30 | Field work vehicle |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2019176801A (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2021069334A (en) * | 2019-10-31 | 2021-05-06 | 井関農機株式会社 | Transplanter |
WO2021145006A1 (en) * | 2020-01-14 | 2021-07-22 | 株式会社クボタ | Agricultural vehicle, automatic driving control program, recording medium with automatic driving control program recorded thereon, and automatic driving control method |
KR20210091652A (en) | 2020-01-14 | 2021-07-22 | 가부시끼 가이샤 구보다 | Agricultural work machine and transplanting machine |
JP2021108600A (en) * | 2020-01-14 | 2021-08-02 | 株式会社クボタ | Farm work vehicle |
KR20220116164A (en) | 2019-12-25 | 2022-08-22 | 가부시끼 가이샤 구보다 | working machine |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1178941A (en) * | 1997-09-08 | 1999-03-23 | Iseki & Co Ltd | Steering control device of working vehicle |
JP2000066725A (en) * | 1998-08-18 | 2000-03-03 | Bio Oriented Technol Res Advancement Inst | Work vehicle and abnormality detecting/coping method for work vehicle |
JP2002042196A (en) * | 2000-07-31 | 2002-02-08 | Iseki & Co Ltd | Management system of working vehicle |
JP2014182453A (en) * | 2013-03-18 | 2014-09-29 | Yanmar Co Ltd | Travel vehicle |
JP2016024541A (en) * | 2014-07-17 | 2016-02-08 | 株式会社クボタ | Traveling work machine and automatic steering system used therein |
JP2016021891A (en) * | 2014-07-17 | 2016-02-08 | 株式会社クボタ | Travelling work machine and automatic steering system used for the same |
US20160037707A1 (en) * | 2014-08-08 | 2016-02-11 | Deere & Company | Multi-mode steering control for a vehicle |
JP2016099895A (en) * | 2014-11-25 | 2016-05-30 | シャープ株式会社 | Moving work vehicle and control device of the same |
JP2017123803A (en) * | 2016-01-13 | 2017-07-20 | 株式会社クボタ | Agricultural implement |
JP2017136015A (en) * | 2016-02-03 | 2017-08-10 | 株式会社クボタ | Work vehicle |
JP2017176096A (en) * | 2016-03-31 | 2017-10-05 | 株式会社クボタ | Work vehicle |
JP2018014045A (en) * | 2016-07-22 | 2018-01-25 | 株式会社クボタ | Work vehicle |
JP2018045710A (en) * | 2014-02-06 | 2018-03-22 | ヤンマー株式会社 | Accompanying travel work system |
-
2018
- 2018-03-30 JP JP2018068359A patent/JP2019176801A/en active Pending
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1178941A (en) * | 1997-09-08 | 1999-03-23 | Iseki & Co Ltd | Steering control device of working vehicle |
JP2000066725A (en) * | 1998-08-18 | 2000-03-03 | Bio Oriented Technol Res Advancement Inst | Work vehicle and abnormality detecting/coping method for work vehicle |
JP2002042196A (en) * | 2000-07-31 | 2002-02-08 | Iseki & Co Ltd | Management system of working vehicle |
JP2014182453A (en) * | 2013-03-18 | 2014-09-29 | Yanmar Co Ltd | Travel vehicle |
JP2018045710A (en) * | 2014-02-06 | 2018-03-22 | ヤンマー株式会社 | Accompanying travel work system |
JP2016024541A (en) * | 2014-07-17 | 2016-02-08 | 株式会社クボタ | Traveling work machine and automatic steering system used therein |
JP2016021891A (en) * | 2014-07-17 | 2016-02-08 | 株式会社クボタ | Travelling work machine and automatic steering system used for the same |
US20160037707A1 (en) * | 2014-08-08 | 2016-02-11 | Deere & Company | Multi-mode steering control for a vehicle |
JP2016099895A (en) * | 2014-11-25 | 2016-05-30 | シャープ株式会社 | Moving work vehicle and control device of the same |
JP2017123803A (en) * | 2016-01-13 | 2017-07-20 | 株式会社クボタ | Agricultural implement |
JP2017136015A (en) * | 2016-02-03 | 2017-08-10 | 株式会社クボタ | Work vehicle |
JP2017176096A (en) * | 2016-03-31 | 2017-10-05 | 株式会社クボタ | Work vehicle |
JP2018014045A (en) * | 2016-07-22 | 2018-01-25 | 株式会社クボタ | Work vehicle |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2021069334A (en) * | 2019-10-31 | 2021-05-06 | 井関農機株式会社 | Transplanter |
JP7268578B2 (en) | 2019-10-31 | 2023-05-08 | 井関農機株式会社 | transplanter |
KR20220116164A (en) | 2019-12-25 | 2022-08-22 | 가부시끼 가이샤 구보다 | working machine |
WO2021145006A1 (en) * | 2020-01-14 | 2021-07-22 | 株式会社クボタ | Agricultural vehicle, automatic driving control program, recording medium with automatic driving control program recorded thereon, and automatic driving control method |
KR20210091652A (en) | 2020-01-14 | 2021-07-22 | 가부시끼 가이샤 구보다 | Agricultural work machine and transplanting machine |
JP2021108595A (en) * | 2020-01-14 | 2021-08-02 | 株式会社クボタ | Farm work machine |
JP2021108600A (en) * | 2020-01-14 | 2021-08-02 | 株式会社クボタ | Farm work vehicle |
JP7388929B2 (en) | 2020-01-14 | 2023-11-29 | 株式会社クボタ | agricultural vehicle |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2019176801A (en) | Field work vehicle | |
JP6552420B2 (en) | Work vehicle | |
JP6860387B2 (en) | Work platform | |
JP7433352B2 (en) | work vehicle | |
JP6974148B2 (en) | Traveling work machine | |
JP7080101B2 (en) | Work vehicle | |
JP2018004307A (en) | Work vehicle | |
JP7139492B2 (en) | field work machine | |
CN109863852B (en) | Traveling working machine, rice transplanter, paddy field direct seeder, and spray working machine | |
JP7229303B2 (en) | traveling work machine | |
JP2022173259A5 (en) | ||
JP6991050B2 (en) | Traveling work machine | |
JP7195381B2 (en) | traveling work machine | |
JP7117886B2 (en) | work vehicle | |
JP7026585B2 (en) | Traveling work machine | |
JP6991090B2 (en) | Work platform | |
JP7034032B2 (en) | Traveling work machine | |
JP7192077B2 (en) | traveling work machine | |
JP2023029354A (en) | Travel working machine | |
JP2023029354A5 (en) | ||
JP2023178667A (en) | work vehicle | |
JP2021108579A (en) | Work vehicle | |
JP2021108578A (en) | Work vehicle and rice transplanter | |
JPH05333929A (en) | Automatic straight device controller for mobile working machine |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200624 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210421 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210511 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210708 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20220104 |