(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2022-12-26
(45)【発行日】2023-01-10
(54)【発明の名称】作業車両
(51)【国際特許分類】
A01B 69/00 20060101AFI20221227BHJP
【FI】
A01B69/00 303K
A01B69/00 303V
(21)【出願番号】P 2020082046
(22)【出願日】2020-05-07
【審査請求日】2021-11-30
(73)【特許権者】
【識別番号】000000125
【氏名又は名称】井関農機株式会社
(74)【代理人】
【識別番号】100092794
【氏名又は名称】松田 正道
(74)【代理人】
【識別番号】110000899
【氏名又は名称】特許業務法人新大阪国際特許事務所
(72)【発明者】
【氏名】堀田 直岐
(72)【発明者】
【氏名】川上 修平
(72)【発明者】
【氏名】小佐野 光
(72)【発明者】
【氏名】神谷 寿
(72)【発明者】
【氏名】飛田 秀平
(72)【発明者】
【氏名】鈴木 悠太
【審査官】川野 汐音
(56)【参考文献】
【文献】特開平08-051808(JP,A)
【文献】特開平05-127740(JP,A)
【文献】特開2004-057012(JP,A)
【文献】特開2021-108577(JP,A)
【文献】米国特許出願公開第2017/0202131(US,A1)
(58)【調査した分野】(Int.Cl.,DB名)
A01B 69/00-69/08
G05D 1/00- 1/12
(57)【特許請求の範囲】
【請求項1】
操舵部材(52)を駆動する操舵部材駆動装置(44)と、
前記操舵部材駆動装置(44)を制御する制御装置(200)と、
を備え、
前記制御装置(200)が、旋回させられる車体(10)を直進させるときに旋回の前の直進制御を行い、前記直進させられていた車体(10)を旋回させるときに旋回制御を行い、前記旋回させられている車体(10)を再び直進させるときに前記旋回の後の直進制御を行う、作業車両であって、
前記旋回の前の前記直進制御から前記旋回制御への切換えは、手動操作に基づいて行われ、
旋回軌跡の大きさが、後輪回転数および機体方位に基づいて判定され、
前記旋回が大回りになっていると判断された場合には、ステアリング戻しはじめが遅らせられて前記車体(10)が内側に寄せられるように、制御が行われることを特徴とする作業車両。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、田植え機などのような作業車両に関する。
【背景技術】
【0002】
車体へ昇降可能に取付けられた植付け装置と、ステアリングハンドルを駆動するステアリングモーターと、ステアリングモーターにステアリングハンドルを駆動させることにより、車体の直進制御を行う制御装置と、を有する田植え機が、知られている(たとえば、特許文献1および2参照)。
【先行技術文献】
【特許文献】
【0003】
【文献】特開2016-24541号公報
【文献】特開2002-335720号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
しかしながら、上述された従来の田植え機などのような作業車両は、車体の旋回制御を行うことができない。
【0005】
本発明は、上述された従来の課題を考慮し、車体の旋回制御を行うことができる作業車両を提供することを目的とする。
【課題を解決するための手段】
【0006】
第1の本発明は、操舵部材(52)を駆動する操舵部材駆動装置(44)と、
前記操舵部材駆動装置(44)を制御する制御装置(200)と、
を備え、
前記制御装置(200)が、旋回させられる車体(10)を直進させるときに旋回の前の直進制御を行い、前記直進させられていた車体(10)を旋回させるときに旋回制御を行い、前記旋回させられている車体(10)を再び直進させるときに前記旋回の後の直進制御を行う、作業車両であって、
前記旋回の前の前記直進制御から前記旋回制御への切換えは、手動操作に基づいて行われ、
旋回軌跡の大きさが、後輪回転数および機体方位に基づいて判定され、
前記旋回が大回りになっていると判断された場合には、ステアリング戻しはじめが遅らせられて前記車体(10)が内側に寄せられるように、制御が行われることを特徴とする作業車両である。
本発明に関連する第1の発明は、操舵部材(52)を駆動する操舵部材駆動装置(44)と、
前記操舵部材駆動装置(44)を制御する制御装置(200)と、
を備え、
前記制御装置(200)が、旋回させられる車体(10)を直進させるときに旋回の前の直進制御を行い、前記直進させられていた車体(10)を旋回させるときに旋回制御を行い、前記旋回させられている車体(10)を再び直進させるときに前記旋回の後の直進制御を行う、作業車両であって、
前記旋回の前の前記直進制御から前記旋回制御への切換えは、手動操作に基づいて行われることを特徴とする作業車両である。
【0007】
本発明に関連する第2の発明は、前記旋回させられている車体(10)を再び直進させるために操舵切れ角を戻す操舵切れ角戻しタイミングが、前記旋回の後の前記直進制御を開始する直進制御開始タイミングの前のタイミングとして設けられていることを特徴とする本発明に関連する第1の発明の作業車両である。
【0008】
本発明に関連する第3の発明は、前記操舵切れ角戻しタイミングは、前記旋回させられている車体(10)の向きと、前記車体(10)を再び直進させる向きと、の間の差異があらかじめ定められた操舵切れ角戻しレベルを下回るタイミングであることを特徴とする本発明に関連する第2の発明の作業車両である。
【0009】
本発明に関連する第4の発明は、前記操舵切れ角戻しタイミングは、前記あらかじめ定められた操舵切れ角戻しレベルを調節する手動操作に基づいて調節可能であることを特徴とする本発明に関連する第3の発明の作業車両である。
【発明の効果】
【0010】
本発明により、車体の旋回制御を行うことが可能である。
本発明に関連する第1の発明により、車体の旋回制御を行うことが可能である。
【0011】
本発明に関連する第2の発明により、本発明に関連する第1の発明の効果に加えて、精密性の高い制御を実現することが可能である。
【0012】
本発明に関連する第3の発明により、本発明に関連する第2の発明の効果に加えて、利便性の高い制御を実現することが可能である。
【0013】
本発明に関連する第4の発明により、本発明に関連する第3の発明の効果に加えて、融通性の高い制御を実現することが可能である。
【図面の簡単な説明】
【0014】
【
図1】本発明における実施の形態の田植え機の斜視図
【
図2】本発明における実施の形態の田植え機の動力伝達系のブロック図
【
図3】本発明における実施の形態の田植え機の制御系のブロック図
【
図4】本発明における実施の形態の田植え機の旋回制御の説明図(その一)
【
図5】本発明における実施の形態の田植え機の旋回制御の拡大説明図
【
図6】本発明における実施の形態の田植え機のバックターン制御の説明図
【
図7】本発明における実施の形態の田植え機の部分斜視図
【
図8】本発明における実施の形態の田植え機の部分平面図
【
図9】本発明における実施の形態の田植え機の補助車輪近傍の拡大部分平面図
【
図10】本発明における実施の形態の田植え機の旋回制御の説明図(その二)
【
図11】本発明における実施の形態の田植え機の旋回制御の説明図(その三)
【
図12】本発明における実施の形態の田植え機の旋回制御の説明図(その四)
【
図13】本発明における実施の形態の田植え機の旋回制御の説明図(その五)
【
図14】本発明における実施の形態の田植え機の旋回制御の説明図(その六)
【
図15】本発明における実施の形態の田植え機の旋回制御の説明図(その七)
【
図16】本発明における実施の形態の田植え機の旋回制御の説明図(その八)
【
図17】本発明における実施の形態の田植え機の旋回制御の説明図(その九)
【
図18】本発明における実施の形態の田植え機の旋回制御の説明図(その十)
【
図19】本発明における実施の形態の田植え機の旋回制御の説明図(その十一)
【
図20】本発明における実施の形態の田植え機の旋回制御の説明図(その十二)
【
図21】本発明における実施の形態の田植え機の旋回制御の説明図(その十三)
【
図22】本発明における実施の形態の田植え機の旋回制御の説明図(その十四)
【
図23】本発明における実施の形態の田植え機の旋回制御の説明図(その十五)
【
図24】本発明における実施の形態の田植え機の運転ユニット近傍の部分斜視図
【発明を実施するための形態】
【0015】
図面を参照しながら、本発明における実施の形態について詳細に説明する。
【0016】
以下同様であるが、いくつかの構成要素は図面において示されていないこともあるし透視的にまたは省略的に示されていることもある。
【0017】
本実施の形態の田植え機は、本発明または本発明に関連した発明における作業車両の例である。
【0018】
変形例の実施の形態においては、たとえば、本発明または本発明に関連した発明における作業車両は農業用トラクターであってもよい。
【0019】
ステアリングハンドル52は、本発明または本発明に関連した発明における操舵部材の例である。ステアリングモーター44は、本発明または本発明に関連した発明における、ステアリングハンドル52を駆動する操舵部材駆動装置の例である。
【0020】
制御装置200は、本発明または本発明に関連した発明における、ステアリングモーター44を制御する制御装置の例である。
【0021】
車体10は、本発明または本発明に関連した発明における車体の例である。後輪回転数センサー210および測位システム300は、本発明または本発明に関連した発明における、車体10の旋回状態に関する検知を行う検知機構の例である。
【0022】
補助車輪33は、本発明または本発明に関連した発明における、車体10の車体左右方向における内側および外側の内の少なくとも一方の側へ取付けられた単数または複数の補助車輪の例である。
【0023】
旋回内側の後輪32は、本発明または本発明に関連した発明における所定の車輪の例である。
【0024】
はじめに、
図1および2を参照しながら、本実施の形態の田植え機の構成および動作について具体的に説明する。
【0025】
ここに、
図1は本発明における実施の形態の田植え機の斜視図であり、
図2は本発明における実施の形態の田植え機の動力伝達系のブロック図である。
【0026】
本実施の形態の田植え機の動作について説明しながら、本発明に関連した発明の走行制御方法についても説明する。
【0027】
本実施の形態の田植え機は8条植えの乗用マット苗田植え機であり、植付け装置100は4個の植付けユニットを有し、各々の植付けユニットは左右一対の2個の植付け具を有する。
【0028】
田植え機は、8条植えの乗用マット苗田植え機に限らず、たとえば、10条植えの乗用ポット苗田植え機であってもよい。
【0029】
最初に説明されるのは、本実施の形態の田植え機の基本的な構成および動作である。したがって、旋回制御などについては、後に詳細に説明する。
【0030】
運転ユニット50は、エンジン20の上方に設けられた座席51を有する。
【0031】
座席51の前方には、前輪31を操作するためのステアリングハンドル52が設けられている。そして、エンジン20の左右両側には、水平なステップフロアが設けられている。さらに、車体10には、予備苗載せ台101が設けられている。
【0032】
走行装置30は、前輪31および後輪32で車体10を走行させる装置である。
【0033】
整地装置60は、整地ローター機構61および整地フロート機構62で圃場を整地する装置である。
【0034】
つぎの植付け走行経路の目安となる直線のマーキングを圃場へ形成する線引きマーカー80は、車体10へ収納可能に取付けられている。
【0035】
植付け装置100は、植付け装置昇降装置90を介して車体10の後側へ取付けられている。
【0036】
メインフレームへ取付けられたエンジン20の回転動力は、HST(Hydro Static Transmission)機構である主変速機構41などへ伝達される。主変速機構41および副変速機構42において変速された回転動力は、走行装置30などにおいて利用される走行動力と、植付け装置100などにおいて利用される外部取出し動力と、に分離される。
【0037】
走行動力の一部は左右の前輪ファイナルケースへ伝達されて左右一対の前輪31を駆動し、走行動力の残りが左右の後輪ギヤケース43へ伝達されて左右一対の後輪32を駆動する。そして、後輪ギヤケース43へ伝達された走行動力の一部は、整地装置60および施肥装置70へ伝達される。
【0038】
つぎに、
図1から3を主として参照しながら、本実施の形態の田植え機の構成および動作についてより具体的に説明する。
【0039】
ここに、
図3は、本発明における実施の形態の田植え機の制御系のブロック図である。
【0040】
制御装置200は、主変速レバー53、副変速レバー54または直進アシストレバー55によるレバー操作、およびアシストモードスイッチ56によるスイッチ操作のみならず、後輪回転数センサー210または植付け装置昇降センサー220による検出結果なども利用してさまざまな制御を行う装置である。
【0041】
測位システム300は、たとえば、典型的なGNSS(Global Navigation Satellite System)であるGPS(Global Positioning System)を利用する、DGPS(Differential Global Positioning System)技術により測位を行うシステムである。
【0042】
走行制御においては車体10の大きさ、ステアリングモーター44の応答性、および圃場の状態などが総合的に考慮されなければならないので、もしも仮に測位システム300による測位が極めて正確であったとしても、精密な走行制御を実現することは困難であり、さまざまな試みが知られている。
【0043】
直進制御においては、車体10の現在の方位情報を取得する測位システム300を利用して、植付け作業を行う直進走行の開始点に対応するA点、および直進走行の終了点に対応するB点の座標があらかじめ登録される。そして、A点とB点とを結ぶ仮想線に基づいた直進走行が行われるように、ステアリングモーター44を駆動してステアリングを行うことにより、直進制御が実現される。
【0044】
しかしながら、手動ステアリングを必要とする旋回のたびに、直進制御のオンオフ操作が行われなければならないので、作業者の負担が少なくはなく、操作性および作業性が必ずしも十分ではない。
【0045】
したがって、直進制御のみならず、植付け条間距離による条合わせが自動的に行われる旋回制御も実現されることが望ましく、つぎのような基本的な旋回制御が考えられる。
【0046】
もちろん、これから説明される旋回制御の手法がさまざまな旋回制御において利用可能であることは、言うまでもない。具体的には、それらのさまざまな旋回制御の一つは、たとえば、旋回途中直進動作が含まれず、操舵角度が旋回においてほぼ一定に保たれ、車体10の旋回経路が略半円形状の経路である旋回制御である。
【0047】
(A1)つぎに、
図4および5を主として参照しながら、本実施の形態の田植え機の構成および動作についてさらにより具体的に説明する。
【0048】
ここに、
図4は本発明における実施の形態の田植え機の旋回制御の説明図(その一)であり、
図5は本発明における実施の形態の田植え機の旋回制御の拡大説明図である。
【0049】
本実施の形態の田植え機は、制御装置200が、直進させられていた車体10を旋回させるときに旋回制御を行う、田植え機である。
【0050】
制御装置200は、旋回状態判定を検知の結果に基づいて行い、操舵切れ角を旋回状態判定に基づいて制御する。
【0051】
たとえば、田植機の自動旋回制御において、旋回途中直進動作が含まれないように、自動旋回中はステアリング切れ角を一定のα(たとえば、45度)で固定したまま旋回する制御とする。GPSで旋回経路を設定しそれに沿って旋回する制御においては、制御が難しく安定しないことがある。また、旋回中ステアリングを動かすと旋回内側の後輪回転が変化し、いわゆるZターンやその他制御が安定しない。ステアリング切れ角一定とすることで制御が容易で様々な仕様の機体に対して汎用性が大きい。ステアリング切れ角一定の為旋回内側後輪の回転が安定し、内側後輪の回転数が少なければ小回り、多ければ大回りしているといった判断を追加センサー等なく容易に判断することができる。
【0052】
制御装置200は、旋回させられている車体10を再び直進させるために操舵切れ角を戻す操舵切れ角戻しタイミングを旋回状態判定に基づいて変更することにより操舵切れ角を制御する。
【0053】
操舵切れ角戻しタイミングは、旋回させられている車体10の向きと、車体10を再び直進させる向きと、の間の差異があらかじめ定められた操舵切れ角戻しレベルを下回るタイミングである。
【0054】
たとえば、操舵切れ角戻しレベルは、30度である。
【0055】
操舵切れ角戻しタイミングは、あらかじめ定められた操舵切れ角戻しレベルを調節する手動操作に基づいて調節可能である。
【0056】
たとえば、操舵切れ角戻しレベルは、作業者の経験に基づいた閾値調節装置400のダイヤル操作などにより、25度に減らされてもよいし、35度に増やされてもよい。
【0057】
旋回状態判定が行われるタイミングは、機体方位または機体直角方位のような方位、距離、時間、GNSS位置または車速などに基づいて決定される、矢印Aの位置のタイミングである。旋回状態は、方位、距離、時間、GNSS位置または車速などに基づいて判定される。
【0058】
たとえば、旋回させられている車体10の向きと、車体10を再び直進させる向きと、の間の差異である、機体方位が45度である位置のタイミングで、時間的な余裕をもって、旋回軌跡の大きさの判定が行われる。
【0059】
前工程ラインである直進ラインLv0の上の旋回開始位置Psから出発した車体10の旋回軌跡が標準的な大きさの旋回軌跡C0であると判定された場合には、操舵切れ角戻しタイミングの変更なしに、操舵切れ角は標準的な30度の操舵切れ角戻しレベルの位置P0のタイミングで戻される。操舵切れ角戻しタイミングの変更がなくても、植付け開始ラインLhの手前の仮想ラインLh0への到達にともなって、車体10は直進制御引渡しゾーンZへ進入することができるので、直進ラインLvに沿って車体10を再び自動的に直進させるための直進制御へのスムーズな引渡しが行われる。
【0060】
旋回制御から直進制御への引渡しは、たとえば、直進制御引渡しゾーンZへの進入がGNSS位置に基づいて認識されたタイミングで行われる。
【0061】
直進制御へのスムーズな引渡しが行われるためには、次工程ラインである直進ラインLvへの接近にともなって、直進ラインLvへの突入角のみならず操舵切れ角があまり大きくない状態が直進制御引渡しゾーンZの手前で実現されることが望ましい。
【0062】
本発明者は、操舵切れ角を戻す操舵切れ角戻しタイミングを旋回状態判定に基づいて変更することにより、圃場状態などにも影響されて変化しやすい旋回状態にかかわらず、このような直進制御へのスムーズな引渡しを保証する思想へ到達した。
【0063】
具体的には、旋回軌跡の大きさの判定に基づいて、操舵切れ角戻しタイミングがつぎのように変更される。
【0064】
旋回軌跡が小回りの旋回軌跡C1であると判定された場合には、操舵切れ角は、標準的な30度の操舵切れ角戻しレベルの位置P1のタイミングでではなく、たとえば、30度より大きい35度の操舵切れ角戻しレベルの位置Q1のタイミングで戻される。すると、旋回軌跡が小回りの旋回軌跡C1であっても、車体10は直進ラインLvへ近づいて行き直進制御引渡しゾーンZへ進入することができるので、直進制御へのスムーズな引渡しが同様に行われる。
【0065】
旋回軌跡が大回りの旋回軌跡C2であると判定された場合には、操舵切れ角は、標準的な30度の操舵切れ角戻しレベルの位置P2のタイミングでではなく、たとえば、30度より小さい25度の操舵切れ角戻しレベルの位置Q2のタイミングで戻される。すると、旋回軌跡が大回りの旋回軌跡C2であっても、車体10は直進ラインLvから遠ざかって行かず直進制御引渡しゾーンZへ進入することができるので、直進制御へのスムーズな引渡しが同様に行われる。
【0066】
もちろん、操舵切れ角戻しタイミングの変更は、このように方位に基づいて行われてもよいが、直進制御へのスムーズな引渡しのための移動経路の修正が行われるように、距離、時間、GNSS位置または車速などに基づいて行われてもよい。
【0067】
ところで、後輪パルスを用いた旋回アシスト補正制御においては、旋回軌跡の大きさの判定に利用される後輪回転数を知るために、自動旋回制御開始から旋回中の旋回内側後輪パルスを測定する。自動旋回中の後輪内側のパルス数はスリップなどの影響が少なく、旋回動作が正常に行われているか判断することができる。
【0068】
田植機の自動旋回制御において、自動旋回制御開始から、機体方位が所定の方位(θ0)になるまでの旋回内側後輪のパルス数を測定する。θ0については、45度以上とする。機体方位θ0の時点での後輪パルス数によって、自動旋回制御の補正を入れるかどうか判断を行う。θ0が45度以下となると自動旋回制御に補正を追加したとしても制御が間に合わず旋回精度が悪化する恐れがある。
【0069】
この時のパルス数がp1からp2の場合、旋回が正常に行われていると判断し補正制御は行わない制御とする。自動旋回制御中の旋回内側の後輪パルス適正値にp1からp2の幅を設けてやることで、不要な補正制御等が入らず旋回精度を向上させることができる。
【0070】
パルス数pがp≧p2の場合、旋回が大回りになっていると判断し、ステアリング戻しはじめ方位を遅らせ機体を内側に寄せ植えはじめが揃うように制御する。後輪回転数から大回りになっていると判断した場合、機体が内側に来るようにステアリング戻しはじめ方位を制御することで植えはじめをそろえることができ、旋回精度を向上させることができる。
【0071】
パルス数pがp≦p1の場合、旋回が小回りになっていると判断し、ステアリング戻しはじめ方位を遅らせ早め機体を外側に寄せ植えはじめが揃うように制御する。後輪回転数から小回りになっていると判断した場合、機体が外側に来るようにステアリング戻しはじめ方位を制御することで植えはじめをそろえることができ、旋回精度を向上させることができる。
【0072】
旋回軌跡の大きさは、このように、機体方位が所定の角度へ到達した位置のタイミングでの後輪回転数の大きさに基づいて判定されてもよいが、逆に、後輪回転数が所定の回数へ到達した位置のタイミングでの機体方位の大きさに基づいて判定されてもよい。たとえば、後輪回転数が所定の回数へ到達した位置のタイミングでの機体方位の大きさが小さ目である場合には、旋回が大回りになっていると判断し、ステアリング戻しはじめ方位を遅らせ機体を内側に寄せ植えはじめが揃うように制御してもよい。
【0073】
結局のところ、方位、距離、時間、GNSS位置または車速などから選択される単数または複数の物理量に基づいて、旋回状態判定が行われるタイミングが決定され、旋回状態が同様な物理量に基づいて判定されるが、これらの物理量の組合せは任意である。たとえば、旋回状態判定が行われるタイミングは距離およびGNSS位置に基づいて決定され、旋回状態判定は方位および車速に基づいて判定されてもよい。
【0074】
そして、方位、距離、時間、GNSS位置または車速などから選択される単数または複数の物理量に基づいて、操舵切れ角戻しタイミングの変更が行われるが、操舵切れ角戻しタイミングの変更のような、操舵切れ角の制御が基づく物理量は上述された物理量の組合せとは独立的に決定されてもよいし従属的に決定されてもよい。たとえば、旋回状態判定が行われるタイミングは時間に基づいて決定され、旋回状態判定は車速に基づいて判定され、操舵切れ角戻しタイミングの変更が方位およびGNSS位置に基づいて行われてもよい。
【0075】
制御装置200は、操舵切れ角を一定角であるように旋回状態判定を行う旋回状態判定タイミングまで維持した後に、一定角を旋回状態判定に基づいて変更することにより操舵切れ角を制御してもよい。
【0076】
パルス数pがp≧p2の場合、旋回が大回りになっていると判断し、一定角である、ステアリング切れ角αを切り増し小回りとなるように制御する。後輪回転数から大回りになっていると判断した場合、小回りになるようにステアリング制御することで旋回精度を向上させることができる。
【0077】
パルス数pがp≦p1の場合、旋回が小回りになっていると判断し、一定角である、ステアリング切れ角αを切り戻し大回りとなるように制御する。後輪回転数から小回りになっていると判断した場合、大回りになるようにステアリング制御することで旋回精度を向上させることができる。
【0078】
ステアリング切れ角αの切り増しまたは切り戻しのような一定角の変更が旋回状態判定と同時に行われてもよいし、たとえば、旋回状態判定の0.2秒後に行われてもよいことは、言うまでもない。
【0079】
制御装置200は、旋回させられている車体10を再び直進させるために操舵切れ角を戻す操舵切れ角戻しスピードを旋回状態判定に基づいて変更することにより操舵切れ角を制御してもよい。
【0080】
もちろん、操舵切れ角戻しスピードの変更は、移動経路の修正がうまく行われるように、操舵切れ角戻しタイミングの変更の代わりに行われてもよいし、操舵切れ角戻しタイミングの変更と併せて行われてもよい。たとえば、操舵切れ角を戻す機体方位は一定であり、操舵切れ角戻しスピードの変更のみが行われてもよい。
【0081】
操舵切れ角の戻しが旋回状態判定と同時に行われてもよいし、たとえば、旋回状態判定の0.2秒後に行われてもよいことは、言うまでもない。
【0082】
操舵切れ角戻しスピードが調節可能である構成においては、旋回状態判定を行うタイミングが操舵切れ角戻しタイミングにかなり接近していても、操舵切れ角戻しスピードを増やすことにより操舵切れ角を遅れなしに戻すことができる。
【0083】
(A2)つぎに、
図6を主として参照しながら、本実施の形態の田植え機の構成および動作についてさらにより具体的に説明する。
【0084】
ここに、
図6は、本発明における実施の形態の田植え機のバックターン制御の説明図である。
【0085】
本実施の形態の田植え機は、制御装置200が、直進させられていた車体10を停止させて後進させ再び停止させた後に旋回させるときに旋回制御を行う、田植え機である。
【0086】
地点S1から地点S2に至るバック直進の後に、地点S2から地点S3およびR4を経て地点S5に至るターンが、自動的にまたは半自動的に行われる。
【0087】
もちろん、旋回制御でいわゆるピタ植え制御およびピタ寄せ制御などHSTを自動で制御するようなモード中の場合は旋回アシスト制御を開始しない構成も、考えられる。これは、誤ってピタ寄せ入りで旋回アシストを開始するとHSTが意図しない動作が発生することがあるためである。したがって、意図しないHST動作を防止することが望ましい。
【0088】
ここで、直進させられていた車体10を停止させて後進させ再び停止させた後に旋回させる、バックターン制御における第一から第八の後進パターンについて説明する。
【0089】
(第一の後進パターン)
第一の後進パターンは、まっすぐ後進を行う後進パターンである。
【0090】
田植機旋回アシスト制御においてバックターン制御中、後進開始から後進停止(1.1m)までの間はモータ制御によりハンドルを直進にキープする構成が、考えられる。バック時はまっすぐ後進することで、旋回で次の目標線に向かうまでの位置ズレを防止する。
【0091】
(第二の後進パターン)
第二の後進パターンは、手前でハンドル切りを行う後進パターンである。
【0092】
車体10が後進させられるときに、制御装置200は、操舵切れ角をゼロであるようにあらかじめ定められたタイミングまで維持した後に、操舵切れ角をあらかじめ定められた操舵切れ角量で旋回向きへ向かって変更する。
【0093】
すなわち、田植機旋回アシスト制御においてバックターン制御中、後進開始から後進停止(1.1m)手前30cmまでの間はモータ制御によりハンドルを直進にキープする構成が、考えられる。バック時はまっすぐ後進することで、旋回で次の目標線に向かうまでの位置ズレを防止する。
【0094】
そして、田植機旋回アシスト制御においてバックターン制御中、上述の制御後、つまり後進停止(1.1m)手前30cmから後進停止(1.1m)までの間はモータ制御によりハンドルを旋回方向に一定角度切る構成が、考えられる。前進開始からハンドルを切ると車速によって走行軌跡が安定しない。大回りになって畔にぶつかることがある。また、走行しながらハンドルを切らないとモータが圃場の負荷に負けてハンドルが切れないことがある。旋回前にある程度旋回方向でハンドルを切っておくことで、前進して旋回するときの走行軌跡が安定し、大回りを防止できる。したがって、後進走行しながらハンドルを切ることが望ましい。
【0095】
あらかじめ定められた操舵切れ角量は、車体10へ取付けられた旋回内側の後輪32への駆動力の伝達がオフされない操舵切れ角量である。
【0096】
すなわち、ハンドル切れ角は後輪クラッチが切れない程度(ハンドル220度)を狙いとする構成が、考えられる。これは、後輪クラッチが切れるまでハンドルを切ってしまうと、クイックしたように急激に走行軌跡が変わってしまい、後進するので、植付跡をタイヤで荒らしてしまうのみならず、欠株になり、旋回の走行軌跡も安定しなくなるためである。
【0097】
(第三の後進パターン)
第三の後進パターンは、最後の直進方位に合わせてバックを行う後進パターンである。
【0098】
田植機旋回アシスト制御においてバックターン制御中、後進開始から後進停止(1.1m)までの間は最後に直進アシストを行った方位に基づいてハンドル操舵する構成が、考えられる。これは、通常、直進アシスト制御は畔手前3mで強制的に停車してしまうので、最小でも3m分は人が手動で植付を行う必要があり、手動で植えた箇所は直進アシストの経路とずれてしまう可能性があり、旋回アシスト後の経路とその前との経路が条間30cm(機種による)でなくなってしまう恐れがあるためである。特に、変形田だと、人は畔に垂直に入ろうとハンドルをきってしまう癖があるので、弓なりに突入してその状態でバックし、もともとの植え付け経路とは違う方向に向かってバックするために、旋回経路が安定しない弊害を低減することができる。
【0099】
(第四の後進パターン)
第四の後進パターンは、最後の直進経路線に合わせる後進パターンである。
【0100】
田植機旋回アシスト制御においてバックターン制御中、後進開始から後進停止(1.1m)までの間は最後に直進アシストを行った経路に基づいてハンドル操舵する構成が、考えられる。
【0101】
(第五の後進パターン)
第五の後進パターンは、最後の経路から求める理想の後進停止位置座標に合わせる後進パターンである。
【0102】
田植機旋回アシスト制御においてバックターン制御中、後進開始から後進停止(1.1m)までの間は最後の直進経路と現在の機体位置から最後の直進経路を90度回転させた垂線と直交する座標点から最後の直進経路の後進方向へ向かって任意の後進距離(1.1m)移動した座標点を目標点としてハンドル操舵する構成が、考えられる。
【0103】
(第六の後進パターン)
第六の後進パターンは、わざと旋回方向と逆に切る期間を設ける後進パターンである。
【0104】
田植機旋回アシスト制御においてバックターン制御中、後進開始から後進停止(1.1m)までの間にモータ制御によりハンドルを旋回方向とは逆方向に一定角度切る期間を設ける構成が、考えられる。
【0105】
(第七の後進パターン)
第七の後進パターンは、わざと違う方位に切る期間を設ける後進パターンである。
【0106】
田植機旋回アシスト制御においてバックターン制御中、後進開始から後進停止(1.1m)までの間に最後に直進アシストを行った方位から任意の角度をずらした方向にハンドル操舵する期間を設ける構成が、考えられる。
【0107】
(第八の後進パターン)
第八の後進パターンは、わざと違う経路に切る期間を設ける後進パターンである。
【0108】
田植機旋回アシスト制御においてバックターン制御中、後進開始から後進停止(1.1m)までの間に最後に直進アシストを行った経路から任意の方向へずらした経路(走行経路、旋回経路から10cm近づける、遠ざけるなど)にハンドル操舵する構成が、考えられる。
【0109】
バック旋回時における第一から第八の後進パターンのような後進パターンについては、一定距離(1.1m)後進した後に自動で停車する制御となっているが、高速で後進した場合に急停車すると、停車ショックが大きく、作業者に危険を及ぼす可能性がある。また、後進停止(1.1m)手前30cmから後進停止(1.1m)までの間は旋回方向へ向かって後輪クラッチが切れない程度(ハンドル220度狙い)に先行でハンドルを切る制御があるが、高速走行時にハンドルを切ると走行経路が安定せず、ハンドルを切り終わるまでに後進停止(1.1m)位置までに到達してしまい、停車状態でハンドルを切らないといけなくなることがある。特に深い湿田の場合などは、停車状態だとモータが圃場の負荷に負けてハンドルを切れない恐れがある。したがって、バックターン制御においては、安全確保などを考慮して車速も制御することが望ましい。
【0110】
上述されたさまざまな構成で後進が完了した後に前進操作を行った場合、モータ制御によりハンドルを旋回方向に一定角度切る構成が、考えられる。旋回方向にハンドルを切ることで人がハンドル操作することなく自動旋回が可能になる。
【0111】
つまり、旋回開始において、ハンドル切の状態がすでに実現されている。
【0112】
ここで、旋回途中直進動作が含まれる、いわゆるコの字旋回制御の旋回アシストハンドル操舵について説明する。
【0113】
コの字旋回は、上述されたバック直進が行われるか否かにかかわらず、地点S2から地点S3およびR4を経て地点S5に至るターンのような旋回である。
【0114】
旋回開始(1)ハンドル切制御完了ステップについて説明する。直前のステップで旋回開始においてハンドル切の状態がすでに実現されているとき、機体の方位が目標の方位に対してのズレが一定角(75度)以上になった場合、ハンドル切操作を完了する構成が、考えられる。ハンドル切操作終了条件の明確化が実現され、8条コの字旋回の開始条件が与えられる。
【0115】
旋回中(2)ハンドル中央制御ステップについて説明する。直前のステップでハンドル切操作を完了した場合、ステアリングを直進状態にモータで駆動する構成が、考えられる。コの字旋回時は一定距離ハンドルを切って旋回した後に一度ハンドルをまっすぐにする。旋回動作の明確化が実現される。
【0116】
旋回中(2)ハンドル中央制御完了ステップについて説明する。直前のステップで後輪の回転センサーのカウンタが一定値以上になったとき、つまりコの字旋回の直進部分を走行し終わったとき、ハンドル直進操作を完了する構成が、考えられる。ハンドル直進操作終了条件の明確化が実現される。
【0117】
旋回開始(2)ハンドル切制御ステップについて説明する。直前のステップでハンドル直進操作を完了した場合、ハンドルを旋回方向側へ一定角度回す構成が、考えられる(旋回方向へ末切り)。コの字旋回時は一定距離直進走行した後にハンドルを切るので、旋回動作の明確化が実現される。
【0118】
旋回開始(3)ハンドル切制御完了ステップについて説明する。直前のステップで機体が旋回後の進行方向へ走行中、機体の方位が目標の方位に対してのズレが一定角未満(条件による)になった場合、ハンドル切操作を完了する構成が、考えられる。ハンドル切操作終了条件の明確化が実現される。
【0119】
旋回開始(4)ハンドル直進制御ステップについて説明する。直前のステップでハンドル切操作を完了した場合、ハンドルを直進へ一駆動する構成が、考えられる。コの字旋回が終わったらハンドルを直進にする。旋回動作の明確化が実現される。
【0120】
旋回開始(4)ハンドル直進制御完了ステップについて説明する。直前のステップでハンドルが一定の直進範囲内まで戻った際、ハンドル直進動作を完了する構成が、考えられる。旋回アシスト動作終了条件の明確化が実現される。
【0121】
直進アシスト制御開始ステップについて説明する。直前のステップでハンドル直進動作の完了後に直進アシストを開始する構成が、考えられる。旋回開始(4)ハンドル直進制御完了時に機体は旋回後の経路に基づいて旋回完了後に自動で直進アシストを開始することで、HSTレバー操作を行うだけで旋回、植付け作業を継続できる。また、走行経路は旋回後の経路に基づいて走行を行うので、隣接条との条間30cm(機種による)が適切に保たれる。
【0122】
旋回アシスト制御完了ステップについて説明する。直前のステップで旋回動作が1通り終わった場合、旋回アシスト制御完了とする構成が、考えられる。旋回アシスト動作終了条件の明確化が実現される。
【0123】
直進アシスト制御開始ステップで旋回後の直進アシストは機体が目標のラインに乗るまでは通常の直進アシストの操舵パラメータとは異なるパラメータで自動操舵を行う構成が、考えられる。旋回アシスト後、機体が目標の経路に対してずれて入ってしまった場合に、目標経路までハンドル操舵で復帰するのに時間がかかる場合があったが、旋回アシスト後は操舵パラメータを強く(操舵量を大きく)することで、より早く目標経路に復帰でき植付け跡がきれいになる。
【0124】
操舵パラメータはチェッカや、ダイヤル、スイッチ操作等によって変更可能とする構成が、考えられる。圃場条件によって復帰応答を変更することができる。
【0125】
操舵パラメータは目標ライン乗った後は通常の直進アシストの操舵パラメータに戻す構成が、考えられる。目標ラインに乗った後も操舵がキツイままだとハンドルがハンチング(発散)してしまうことがあるが、パラメータ切り替え条件の明確化が実現されるので、操作しなくても目標ラインに乗ったら通常の操舵パラメータ自動操舵が可能になる。
【0126】
旋回中(2)ハンドル中央制御完了ステップで直進範囲の後輪の回転センサーのカウンタ設定は任意に変更可能とする構成が、考えられる。カウンタを0にすることで旋回開始(1)ハンドル切制御完了ステップから旋回開始(2)ハンドル切制御ステップまでの内容をスキップでき、大回りの1点旋回が可能になる。
【0127】
旋回開始(1)ハンドル切制御完了ステップから旋回開始(2)ハンドル切制御ステップまでの内容を省いた構成が、考えられる。コの字旋回をすると圃場条件(スリップ等)により旋回軌跡が安定しないことがあるが、そもそもコに字旋回を省略することで旋回の安定性が増す。また旋回時に車輪跡もきれいになり圃場を荒らさなくなる。
【0128】
旋回開始(3)ハンドル切制御完了ステップで旋回終了角は車速が遅いと角度を小さくする構成が、考えられる。車速が遅いとハンドル切からハンドル中央に戻る間に走行する距離が短くなるので、大回りになってしまうことがあるが、車速が遅い場合は旋回終了角を小さくし、ハンドルを中央に戻るタイミングを遅らせることで目標経路に向かって旋回経路を適切にすることができる。
【0129】
旋回開始(3)ハンドル切制御完了ステップで旋回終了角は車速が速いと角度を大きくする構成が、考えられる。車速が速いとハンドル切からハンドル中央に戻る間に走行する距離が長くなるので、小回りになってしまう。車速が遅い場合は旋回終了角を大きくし、ハンドルを中央に戻るタイミングを早くすることで目標経路に向かって旋回経路を適切にすることができる。
【0130】
旋回開始(3)ハンドル切制御完了ステップで旋回終了角は機体の条数によって変更する構成が、考えられる。条数によって旋回半径、作業幅が異なるので目指す目標経路が異なってくる。条数によって旋回終了角を変更することで目標経路に向かって旋回経路を適切にすることができる。
【0131】
旋回開始(3)ハンドル切制御完了ステップで旋回終了角は7条設定の場合、いわゆる3条またぎと5条またぎで変更する構成が、考えられる。7条はまたぎ条数によって旋回半径、作業幅が異なるので目指す目標経路が異なってくることがあるが、またぎ条数によって旋回終了角を変更することで目標経路に向かって旋回経路を適切にすることができる。
【0132】
旋回開始(3)ハンドル切制御完了ステップで旋回終了角は内付け補助車輪有の場合に補正(-2度)を行う構成が、考えられる。補助車輪を付けると旋回半径が大きくなり大回りになってしまい旋回軌跡が変わってしまうことがあるが、補助車輪設定によって旋回終了角を変更することで目標経路に向かって旋回経路を適切にすることができる
旋回開始(3)ハンドル切制御完了ステップで旋回終了角は外付け補助車輪有の場合に補正(-2度)を行う構成が、考えられる。補助車輪を付けると旋回半径が大きくなり大回りになってしまい旋回軌跡が変わってしまうことがあるが、補助車輪設定によって旋回終了角を変更することで目標経路に向かって旋回経路を適切にすることができる
内付け、外付け補助車輪を両方付けている場合(トリプル構成)、外付け補助車輪設定を優先にして補正を行う外付け優先構成が、考えられる。トリプル構成の場合は外付け車輪の影響が大きいが、内付けと外付けの2重補正が防止される。補助車輪設定によって旋回終了角を変更することで目標経路に向かって旋回経路を適切にすることができる。
【0133】
旋回終了角は内付け、外付け補助車輪を両方付けている場合(トリプル構成)、専用の補正を行うトリプル設定構成が、考えられる。補助車輪設定によって旋回終了角を変更することで目標経路に向かって旋回経路を適切にすることができるので、トリプル構成独自の補正設定が可能になる
補正値はチェッカやモニタ設定で任意の値に変更可能な構成が、考えられる。圃場条件によってユーザに好みでパラメータを変更することができる。
【0134】
このようなコの字旋回制御の旋回アシストハンドル操舵においてのみならず、上述されたバックターン制御における第一から第八の後進パターンにおいても、ハンドルを切り始めるタイミングを条数によって変更する構成が、考えられる。6条の場合は60cm手前からハンドルを切り、7または8条の場合は30cm手前からハンドルを切る。これは、6条の場合は30cm手前からハンドルを切ると、旋回軌跡が合わずに、旋回後に目標経路に適切に突入できないことがあるためである。
【0135】
(B)つぎに、
図7から9を主として参照しながら、本実施の形態の田植え機の構成および動作についてさらにより具体的に説明する。
【0136】
ここに、
図7は本発明における実施の形態の田植え機の部分斜視図であり、
図8は本発明における実施の形態の田植え機の部分平面図であり、
図9は本発明における実施の形態の田植え機の補助車輪33近傍の拡大部分平面図である。
【0137】
本実施の形態の田植え機は、制御装置200が、直進させられていた車体10を旋回させるときに旋回制御を行う、田植え機である。
【0138】
制御装置200は、旋回させられている車体10を再び直進させるために操舵切れ角を戻す操舵切れ角戻しタイミングを補助車輪33の取付け状態に基づいて変更する。
【0139】
標準操舵切れ角戻しタイミングが、補助車輪33が取付けられていない場合の操舵切れ角戻しタイミングとして設けられている。
【0140】
田植機の自動旋回制御において、自動旋回制御開始から、機体方位がθ0になるまでの旋回内側後輪のパルス数pを測定する。この時のパルス数がp1からp2の場合、旋回が正常に行われていると判断し補正制御は行わない制御とする。
【0141】
補助車輪33が、車体左右方向における内側へ取付けられているが、車体左右方向における外側へ取付けられていない場合には、操舵切れ角戻しタイミングが標準操舵切れ角戻しタイミングより遅くなるように、制御装置200は操舵切れ角戻しタイミングを変更する。
【0142】
内付けの補助車輪33を装着した際には、適正p1からp2の値が変化するため、内付けの補助車輪33を装着した際は、標準操舵切れ角戻しタイミングそのものを調節せずに旋回状態判定の基準を調節するコントローラ設定を行い、適正値p1、p2の値を変化させる制御としてもよい。自動旋回制御中の旋回内側の後輪パルス適正値にp1からp2の幅を設けてやることで、不要な補正制御等が入らず旋回精度を向上させることができる。また内付けの補助車輪33を装着した際は、旋回中の後輪抵抗が変化し適切な後輪回転数も変化する。コントローラ設定でp1、p2の値を変更することで内付けの補助車輪33を装着した際でも精度の高い自動旋回制御が可能となる。
【0143】
補助車輪33が、車体左右方向における外側へ取付けられているが、車体左右方向における内側へ取付けられていない場合には、操舵切れ角戻しタイミングが標準操舵切れ角戻しタイミングより早くなるように、制御装置200は操舵切れ角戻しタイミングを変更する。
【0144】
外付けの補助車輪33を装着した際には、適正p1からp2の値が変化するため、外付けの補助車輪33を装着した際は、標準操舵切れ角戻しタイミングそのものを調節せずに旋回状態判定の基準を調節するコントローラ設定を行い、適正値p1、p2の値を変化させる制御としてもよい。自動旋回制御中の旋回内側の後輪パルス適正値にp1からp2の幅を設けてやることで、不要な補正制御等が入らず旋回精度を向上させることができる。また外付けの補助車輪33を装着した際は、旋回中の後輪抵抗が変化し適切な後輪回転数も変化する。コントローラ設定でp1、p2の値を変更することで外付けの補助車輪33を装着した際でも精度の高い自動旋回制御が可能となる。
【0145】
補助車輪33が車体左右方向における内側および外側へ取付けられている場合には、操舵切れ角戻しタイミングが標準操舵切れ角戻しタイミングより早くなるように、制御装置200は操舵切れ角戻しタイミングを変更する。
【0146】
制御装置200は、旋回状態判定を検知の結果に基づいて行い、操舵切れ角戻しタイミングを、補助車輪33の取付け状態に基づいてのみならず、旋回状態判定にも基づいて変更する。
【0147】
(C)つぎに、
図4および6を主として参照しながら、本実施の形態の田植え機の構成および動作についてさらにより具体的に説明する。
【0148】
本実施の形態の田植え機は、制御装置200が、直進させられていた車体10を旋回させるときに旋回制御を行う、田植え機である。
【0149】
制御装置200は、旋回制御において車速を制御する。
【0150】
田植機旋回アシスト制御においてUターン制御中、植付け上げ操作により制御を開始した後、つまり、植付け上げから旋回中は通常前進最高速1.86m/s(型式による)のところを0.9m/sまで規制する構成が、考えられる。これは、前進開始からハンドルを目標位置まで切り終わるまでの走行距離は車速によって変化してしまい、高速で前進しながらハンドルを切ると、当然大回りになってしまい走行軌跡が安定しないためである。車速を規制することで旋回時の走行軌跡を安定させる。
【0151】
Uターン制御中、前進最高速の車速規制は0.9m/s以上になる場合に一律頭打ちでカットするのではなく、HSTレバーが前進最高速位置になった場合に0.9m/sとなるように段階的に規制を行う構成が、考えられる。これは、0.9m/s以上一律頭打ちで車速規制した場合、HSTレバーが途中の位置で0.9m/sの規制上限まで到達してしまい、その場合、微調整が難しく、レバーを操作しているのに車速が変わらないので、操作フィーリングが悪いことがあるためである。車速規制時でも車速微調整が容易化され、操作フィーリングが向上する。
【0152】
制御装置200は、第一の規制速度、および第一の規制速度より小さい第二の規制速度を利用して車速を規制することにより車速を制御する。車速が第二の規制速度を超えないように規制される、旋回制御における第二の車速規制期間は、車速が第一の規制速度を超えないように規制される、旋回制御における第一の車速規制期間の後の期間である。
【0153】
旋回制御を終了する旋回制御終了タイミングの少なくとも近傍で、車速は第二の規制速度を超えないように規制される。
【0154】
Uターン制御中、上述された制御中に旋回が終わり、次の旋回目標ラインとなる方向へ進行中に目標方位との機体の進行方位の差が所定角(50度)以下となった場合、前進最高速規制0.9m/s(第一の規制速度)を0.6m/s(第二の規制速度)まで更に規制する構成が、考えられる。これは、制御の仕様として、機体が目標ラインの向きに近づいてきたら、ハンドルを中央に戻した後、旋回目標ラインに向かって自動操舵を開始するが、ハンドルを切りながら高速で走行しているとその分走行経路が安定せずに目標ラインに対しての突入角が乱れることがあるためである。車速を規制することで旋回時の走行軌跡を安定させる。
【0155】
制御装置200は、旋回させられている車体10を再び直進させるときに旋回の後の直進制御を行う。旋回の後の直進制御を開始する直進制御開始タイミングの少なくとも近傍で、車速は第二の規制速度を超えないように規制される。
【0156】
もちろん、直進制御開始タイミングの後でも、車速は第二の規制速度を超えないように規制される実施例も考えられる。
【0157】
たとえば、Uターン制御中、前進最高速0.6m/sの規制は旋回終了後に自動操舵が入りとなり、目標ラインに向かって軌道修正中も目標ラインに乗るまでは継続する、目標ライン乗るまで車速規制を行う構成が、考えられる。これは、旋回終了後に自動操舵入りとなった後に車速規制を解除した場合、目標ラインに乗るまでの車速が高速となってしまうので、その分植付け跡がまっすぐになるまでの距離が長くなってしまうことがあるためである。旋回終了後も車速を規制することで目標ラインに乗るまでの走行軌跡を安定させる。
【0158】
車体10が旋回の後の直進制御の直進制御目標線の近傍へ到達すると、車速の規制は解除される。
【0159】
もちろん、車体10が旋回の後の直進制御の直進制御目標線の近傍へ到達した後でも、車速の規制は解除されない実施例も考えられる。
【0160】
たとえば、Uターン制御中、前進最高速0.6m/sの規制は旋回終了後に自動操舵が入りとなり、目標ラインに向かって軌道修正中も植付けクラッチが入りになるまでは継続する、植付け入りのままで車速規制を行う構成が、考えられる。これは、旋回終了後に自動操舵入りとなった後に車速規制を解除した場合、目標ラインに乗るまでの車速が高速となってしまうので、その分植付け跡がまっすぐになるまでの距離が長くなってしまうことがあるためである。旋回終了後も車速を規制することで目標ラインに乗るまでの走行軌跡を安定させる。
【0161】
第一の車速規制期間においては、車速が第一の規制速度を上回るように車速を調節する手動操作が行われても、車速の規制が優先される。
【0162】
第二の車速規制期間においては、車速が第二の規制速度を上回るように車速を調節する手動操作が行われても、車速の規制が優先される。
【0163】
Uターン制御中、車速規制解除時のHSTの車速復帰応答速度は、通常のレバー操作時よりもゆっくり復帰させる構成が、考えられる。これは、制御終了後に車速が急激に復帰したら作業者に危険を及ぼす可能性があるが、安全確保が実現されるためである。
【0164】
車速規制で車速規制はHSTレバー位置での車速の理論値に基づいてHSTトラニオン開度を規制する構成が、考えられる。車速規制方法の明確化が実現され、レバー位置によってのみ判断するので簡易に車速規制が可能となる。
【0165】
車速規制中に現在の車速を後輪回転センサーによって検出し目標の車速より遅いと判断した場合はトラニオン開度を上げて車速を上げる、後輪回転センサーで検出を行う構成が、考えられる。圃場条件によっては同じトラニオン開度でも車速がぶれるが、圃場条件に応じて車速が安定して旋回可能となる。
【0166】
車速規制中に現在の車速を後輪回転センサーによって検出し目標の車速より速いと判断した場合はトラニオン開度を下げて車速を下げる、後輪回転センサーで検出を行う構成が、考えられる。圃場条件によっては同じトラニオン開度でも車速がぶれるが、圃場条件に応じて車速が安定して旋回可能となる。
【0167】
車速規制中に現在の車速をGPSによって検出し目標の車速より遅いと判断した場合はトラニオン開度を上げて車速を上げる、GPSで検出を行う構成が、考えられる。圃場条件によっては同じトラニオン開度でも車速がぶれるが、圃場条件に応じて車速が安定して旋回可能となる。
【0168】
車速規制中に現在の車速をGPSによって検出し目標の車速より速いと判断した場合はトラニオン開度を下げて車速を下げる、GPSで検出を行う構成が、考えられる。圃場条件によっては同じトラニオン開度でも車速がぶれるが、圃場条件に応じて車速が安定して旋回可能となる。
【0169】
GPS車速は一定時間(0.5秒、1秒など)の平均値を用いる、GPSで検出を行う構成が、考えられる。GPS車速は安定性が悪いので瞬時値で判断するとブレが生じるが、平均値を用いることで車速検出精度が向上する。
【0170】
一定時間(0.1秒)毎に取得したGPS車速において、平均値を求める際に、最大値と最小値は省いて車速平均を求める、GPSで検出を行う構成が、考えられる。GPS車速は安定性が悪いでの瞬時値で判断するとブレが生じ、特性上瞬間的に異常な値を受信することがあるが、最大、最小値は間引くことで車速検出精度が向上する。
【0171】
現在求めたGPS車速平均値Vnが、1周期前に求めたGPS車速平均値Vn-1よりも大幅に変わった場合(1.0m/s以上など)現在求めたGPS車速平均値Vnは異常と判断し、1周期前に求めたGPS車速平均値Vn-1を正として制御する、GPSで検出を行う構成が、考えられる。GPS車速は安定性が悪いでの瞬時値で判断するとブレが生じ、特性上瞬間的に異常な値を受信することがあるが、異常値は間引くことで車速検出精度が向上する。
【0172】
車速監視(速いか遅いか)は制御のメイン周期(10ms等)でなく一定周期(0.5秒、1秒など)毎に行う構成が、考えられる。これは、監視周期が短すぎると、車速も安定してない上に常時HSTをフィードバック制御している状態となり、ハンチング気味になって居住性が悪くなるためである。
【0173】
車速監視(速いか遅いか)の適正範囲は一定の閾値(±0.1m/sまでは許容するなど)を設ける構成が、考えられる。これは、車速の適正範囲が狭すぎると常時HSTをフィードバック制御している状態となり、ハンチング気味になって居住性が悪くなるためである。
【0174】
車速監視(速いか遅いか)により補正するHSTの開度は一定車速幅狙い(0.1m/s分)とする構成が、考えられる。1度にどれぐらい補正したら良いのかの適正値を定めてやる必要があるので、補正を一気に行わずに、徐々に車速を合わせていくことができる。
【0175】
現在の車速が目標車速と大きく異なる場合は一定周期毎に上述された内容を繰り返す構成が、考えられる。フィードバック制御を繰り返すことで、スムーズな車速補正が可能となる。
【0176】
補正するHSTの開度はコントローラで保持する不揮発等で記憶し、チェッカや、モニタパネルのダイヤル操作等で変更可能な、補正開度を不揮発で変更する構成が、考えられる。状況に応じて、車速補正の応答を早くしたり、ゆっくりしたりすることができる。
【0177】
補正するHSTの開度は外付けのダイヤル操作で変更可能な、補正開度をダイヤルで変更する構成が、考えられる。チェッカ操作や、モニタで深い階層に入っていく操作が煩わしい場合があるが、状況に応じて、車速補正の応答を早くしたり、ゆっくりしたりすることが容易にできる。
【0178】
電動HSTのトラニオン開度だけでなく電動アクセル制御によってエンジン回転数も同時にフィードバック制御する構成が、考えられる。これは、湿田など、深い圃場ではHST開度だけを上げてしまうとエンジンドロップでエンジンが停止する可能性があるためである。
【0179】
旋回アシスト中でなく、通常の走行時もHST、電動アクセルのフィードバック制御を行う構成が、考えられる。通常走行時も圃場状況に関わらず、HSTレバー位置に応じた走行制御が可能となる。
【0180】
フィードバック制御は副変速が移動速の場合は行わない構成が、考えられる。これは、路上走行時に勝手にHST開度を補正する制御が働くと、作業者が意図している走行とは異なる走行になる(自動で加速される)恐れがあり、危険な状態が発生することがあるので、路上走行時は勝手に走行補正を行わないことが望ましいためである。
【0181】
フィードバック制御は植付け部が上昇時は行わない構成が、考えられる。これは、路上走行時に副変速が植付け速だった場合、勝手にHST開度を補正する制御が働くと、作業者が意図している走行とは異なる走行になる(自動で加速される)恐れがあり、危険な状態が発生することがあるので、非作業時は勝手に走行補正を行わないことが望ましいためである。
【0182】
フィードバック制御は植付けクラッチが切の場合は行わない構成が、考えられる。これは、路上走行時に副変速が植付速だった場合、勝手にHST開度を補正する制御が働くと、作業者が意図している走行とは異なる走行になる(自動で加速される)恐れがあり、危険な状態が発生することがあり、障害物を避けるなど、状況に応じて植付け部を一定高さより下げて路上走行する可能性もあるので、非作業時は勝手に走行補正を行わず、植付けクラッチを入れている、すなわち、田植え中でないと制御は効かないことが望ましいためである。
【0183】
フィードバック制御の有無の切り替えをコントローラで保持する不揮発等で記憶し、チェッカや、モニタパネルのダイヤル操作等で変更可能な、設定入切を不揮発で変更する構成が、考えられる。これは、フィーリングが変わるため、車速補正をしたくないユーザも存在し、状況に応じて、車速補正入り切りが可能になることが望ましいためである。
【0184】
フィードバック制御の有無の切り替えをON/OFFのスイッチ操作等で変更可能な、設定入切をスイッチで変更する構成が、考えられる。これは、フィーリングが変わるため、車速補正をしたくないユーザも存在し、状況に応じて、車速補正入り切りが可能になることが望ましいためである。
【0185】
第二の車速規制期間においては、車速が第二の規制速度と一致するように規制される。第一および第二の車速規制期間においては、車速が第二の規制速度を下回るように車速を調節する手動操作が行われると、車体10は停止させられる。
【0186】
Uターン制御中は前進の超低速側はHSTの開度を中立位置に固定し、走行できないようにする構成が、考えられる。これは、超低速で旋回アシストを行うと、GPSの情報のばらつきが大きくなったり、圃場の影響を受けやすくなり旋回性が安定しなかったりすることがあり、旋回終了後に自動操舵をONにするが、その際に一定速以上でないと、低速時のエラーにより自動操舵が切れてしまうことがあるためである。不安定な速度での旋回アシストを規制することで、走行軌跡が安定したスムーズな旋回と、旋回後の自動操舵のエラー発生を防止する。
【0187】
Uターン制御時に畦際警報が開始された時(畦手前8m程度)通常前進最高速1.86m/s(型式による)のところを0.9m/sまで規制する構成が、考えられる。これは、高速で走行した状態でUターン制御が開始されると、上述されたように、前進開始からハンドルを目標位置まで切り終わるまでの走行距離は車速によって変化してしまい、高速で前進しながらハンドルを切ると、当然大回りになってしまい走行軌跡が安定しないためである。Uターン制御開始前にある程度車速を落としてスムーズなUターン制御が可能となる。
【0188】
車速規制は畦との距離に応じて段階的に行う構成が、考えられる。一つの構成例における規制車速は、畔際警報に合わせて2m毎に、8m以上では1.3m/s、6mから8mまでは1.2m/s、4mから6mまでは1.1m/s、2mから4mまでは1.0m/s、2m以下では0.9m/sである。これは、あまり手前から車速規制をしすぎると、目標の畔際位置に到達するまでに必要以上に時間がかかってしまうためである。
【0189】
車速規制開始のHSTの応答速度は、通常のレバー操作時よりもゆっくり復帰させる構成が、考えられる。これは、車速が変化したら作業者に危険を及ぼす可能性があり、安全確保が実現されるためである。
【0190】
畦際の車速規制制御は一度HSTレバーを車速規制位置まで戻すまで継続する構成が、考えられる。これは、基本的に畔際停車制御は3m手前で自動的に停車するようになっているので、実際にUターンしたい位置まで走行できず、一度畔際停車制御が効いた後に走行する場合、畔際で自動操舵を自分で切って走行する場合に車速規制が効かないと意味がないためである。畦際で自動操舵を自分で切った場合、Uターン開始位置までHSTレバー位置がそのままでも、人が任意でレバー操作するまでは車速規制が継続することができ、スムーズなUターン制御が可能となる。
【0191】
畦際の車速規制制御はUターン制御が開始された場合に解除する構成が、考えられる。これは、畦際の車速規制がずっと継続されていると、旋回アシスト時の車速規制と衝突してしまい制御が成り立たなくなるためである。畦際の車速規制解除条件の明確化が実現される。
【0192】
畦際の車速規制制御はUターン制御が切になった場合(UターンスイッチOFF)に解除する構成が、考えられる。これは、畦際の車速規制がずっと継続されていると、旋回アシスト時の車速規制と衝突してしまったり、そもそも旋回アシストを切った場合は規制解除されなければいけないのに規制が継続してしまったりするためである。畦際の車速規制解除条件の明確化が実現される。
【0193】
制御装置200は、直進させられていた車体10を停止させて後進させ再び停止させた後に旋回させるときにも旋回制御を行う。車体10が後進させられるときに、制御装置200は第二の規制速度を超えない第三の規制速度を利用して車速を規制する。
【0194】
もちろん、車体10が後進させられるときに、制御装置200は第一の規制速度を超えない第三の規制速度を利用して車速を規制する実施例も考えられる。
【0195】
たとえば、田植機旋回アシスト制御においてバックターン制御中後進開始から後進停止(1.1m)手前30cmまでの間は通常後進最高速1.2m/sのところを0.9m/sまで規制する構成が、考えられる。これは、バック旋回時、一定距離(1.1m)後進した後に自動で停車する制御では、高速で後進した場合に急停車すると、停車ショックが大きく、作業者に危険を及ぼす可能性があるが、安全確保が実現されるためである。
【0196】
田植機旋回アシスト制御においてバックターン制御中、上述された制御後、つまり後進停止(1.1m)手前30cmから後進停止(1.1m)までの間は後進最高速規制0.9m/sを0.5m/s(第三の規制速度)まで更に規制する構成が、考えられる。これは、後進停止(1.1m)手前30cmから後進停止(1.1m)までの間は旋回方向へ向かって後輪クラッチが切れない程度(ハンドル220度狙い)に先行でハンドルを切る制御があるが、高速走行時にハンドルを切ると走行経路が安定しないことがあり、ハンドルを切り終わるまでに後進停止(1.1m)位置までに到達してしまい、停車状態でハンドルを切らないといけなくなる問題が生じることがあるためである(特に深い湿田の場合などは、停車状態だとモータが圃場の負荷に負けてハンドルを切れない恐れがある)。また、上述された制御によりある程度の距離は車速を抑え過ぎずに走行可能となり、先行である程度車速を規制することで、後進停止(1.1m)手前30cmでの切り替わりの際の変速ショックを抑えつつ、後進停止(1.1m)の停車ショックを抑えることができる。
【0197】
Uターン制御における上述されたさまざまな制御は、Uターン制御においてのみならず、バックターン制御においても利用可能であることは言うまでもない。
【0198】
たとえば、田植機旋回アシスト制御においてバックターン制御中、上述されたバック直進における後進制御の後、つまり、後進停車から旋回中は通常前進最高速1.86m/s(型式による)のところを0.9m/sまで規制する構成が、考えられる。
【0199】
(D)つぎに、
図4および6を主として参照しながら、本実施の形態の田植え機の構成および動作についてさらにより具体的に説明する。
【0200】
本実施の形態の田植え機は、制御装置200が、旋回させられる車体10を直進させるときに旋回の前の直進制御を行い、直進させられていた車体10を旋回させるときに旋回制御を行い、旋回させられている車体10を再び直進させるときに旋回の後の直進制御を行う、田植え機である。
【0201】
旋回の前の直進制御から旋回制御への切換えは、手動操作に基づいて行われる。
【0202】
もちろん、旋回の前の直進制御から旋回制御への切換えが、旋回制御から旋回の後の直進制御への切換えと同様に、自動的に行われる実施例も考えられるし、旋回制御から旋回の後の直進制御への切換えが手動操作に基づいて行われる実施例も考えられる。
【0203】
旋回させられている車体10を再び直進させるために操舵切れ角を戻す操舵切れ角戻しタイミングが、旋回の後の直進制御を開始する直進制御開始タイミングの前のタイミングとして設けられている。
【0204】
操舵切れ角戻しタイミングは、旋回させられている車体10の向きと、車体10を再び直進させる向きと、の間の差異があらかじめ定められた操舵切れ角戻しレベルを下回るタイミングである。
【0205】
上述されたように、たとえば、操舵切れ角戻しレベルは、30度である。
【0206】
操舵切れ角戻しタイミングは、あらかじめ定められた操舵切れ角戻しレベルを調節する手動操作に基づいて調節可能である。
【0207】
上述されたように、たとえば、操舵切れ角戻しレベルは、作業者の経験に基づいた閾値調節装置400のダイヤル操作などにより、25度に減らされてもよいし、35度に増やされてもよい。
【0208】
(E)つぎに、
図10から24を主として参照しながら、本実施の形態の田植え機の構成および動作についてさらにより具体的に説明する。
【0209】
ここに、
図10から23は本発明における実施の形態の田植え機の旋回制御の説明図(その二から十五)であり、
図24は本発明における実施の形態の田植え機の運転ユニット50近傍の部分斜視図である。
【0210】
<Zターンを利用した旋回アシスト補正制御(1)>(
図10参照)
田植機の自動旋回制御において、自動旋回中はステアリング切れ角を一定のαで固定したまま旋回する制御とする。また、Zターンについては、狙いとして135°旋回したところで植付部下げ信号を出す狙いで設計されている。
【0211】
GPSで旋回経路を設定しそれに沿って旋回する制御となっており制御が難しく安定しない問題がある。
【0212】
ステアリング切れ角一定とすることで制御が容易で様々な仕様の機体に対して汎用性が大きい。ステアリング切れ角一定の為旋回内側後輪の回転が一定となり、Zターン制御精度が向上する。
【0213】
<Zターンを利用した旋回アシスト補正制御(2)>(
図10参照)
田植機の自動旋回制御中の機体方位をIMUで測定し、機体がθ1の角度に達した時点で植付部下げ信号が出ていない場合(旋回内側の後輪が設計値より回転していない場合)、小回りしていると判断してステアリング切れ角αを戻し大回りさせる補正制御を行う。
【0214】
Zターンの制御を活用して旋回アシスト制御を補正することで、既存のプログラムとセンサで容易に旋回半径の補正要否を判断することができ旋回精度を向上させることができる。
【0215】
<Zターンを利用した旋回アシスト補正制御(3)>(
図10参照)
田植機の自動旋回制御中の機体方位をIMUで測定し、機体がθ2の角度に達した時点で植付部下げ信号が出ている合(旋回内側の後輪が設計値より回転しすぎている場合)、大回りしていると判断してステアリング切れ角αを切り増し小回りさせる補正制御を行う。
【0216】
Zターンの制御を活用して旋回アシスト制御を補正することで、既存のプログラムとセンサで容易に旋回半径の補正要否を判断することができ旋回精度を向上させることができる。
【0217】
<Zターンを利用した旋回アシスト補正制御(4)>(
図11参照)
田植機の自動旋回制御中の機体方位をIMUで測定し、機体がθ1の角度に達した時点で植付部下げ信号が出ていない場合(旋回内側の後輪が設計値より回転していない場合)、小回りしていると判断して、ステアリング戻し始め方位を早め植え跡がそろうように制御を行う。
【0218】
Zターンの制御を活用して旋回アシスト制御を補正することで、既存のプログラムとセンサで容易に旋回半径の補正要否を判断することができ旋回精度を向上させることができる。
【0219】
<Zターンを利用した旋回アシスト補正制御(5)>(
図12参照)
田植機の自動旋回制御中の機体方位をIMUで測定し、機体がθ2の角度に達した時点で植付部下げ信号が出ている合(旋回内側の後輪が設計値より回転しすぎている場合)、大回りしていると判断して、ステアリング戻し始め方位を遅らせ植え跡がそろうように制御を行う。
【0220】
Zターンの制御を活用して旋回アシスト制御を補正することで、既存のプログラムとセンサで容易に旋回半径の補正要否を判断することができ旋回精度を向上させることができる。
【0221】
<Zターンを利用した旋回アシスト補正制御(6)>(
図13参照)
旋回アシスト補正制御を行うかどうか判断する角度θ1、θ2については、140°以下とする。
【0222】
θ1、θ2を140°以下とすることで、補正制御が働いたとしても、修正が間に合わず旋回精度が悪化することを防ぐことができる。
【0223】
<3点からの旋回アシスト制御(1)>(
図14参照)
田植機の自動旋回制御において、自動旋回中はステアリング切れ角を一定のαで固定したまま旋回する制御とする。
【0224】
GPSで旋回経路を設定しそれに沿って旋回する制御となっており制御が難しく安定しない問題がある。
【0225】
ステアリング切れ角一定とすることで制御が容易で様々な仕様の機体に対して汎用性が大きい。
【0226】
<3点からの旋回アシスト制御(2)>(
図14参照)
田植機の自動旋回制御において、ステアリング一定切れ角で自動旋回中の機体旋回角度、θ1、θ2、θ3における座標をGNSSアンテナ情報から取得する制御とする。
【0227】
座標を得ることで機体が予定通り旋回しているか確認することができる。
【0228】
<3点からの旋回アシスト制御(3)>(
図15参照)
田植機の自動旋回制御において、ステアリング一定切れ角で自動旋回中の機体旋回角度、θ1、θ2、θ3における座標をGNSSアンテナ情報から取得する制御とする。取得した3点の座標から下記式にそれぞれの座標を代入し、連立方程式を解くことで旋回半径R1を求め予定通りの旋回半径で制御できているか監視する(x
2+y
2+lx+my+n=0)。
【0229】
旋回半径を求めることで、機体が予定通りの旋回半径で旋回しているか判断することができる。
【0230】
<3点からの旋回アシスト制御(4)>(
図15参照)
田植機の自動旋回制御において、ステアリング一定切れ角で自動旋回中の機体旋回角度、θ1、θ2、θ3における座標をGNSSアンテナ情報から取得する制御とする。取得した3点の座標から下記式にそれぞれの座標を代入し、連立方程式を解くことで旋回半径R1を求め予定通りの旋回半径で制御できているか監視する(x
2+y
2+lx+my+n=0)。求められた旋回半径R1がRa(適正旋回半径下限)≦R1≦Rb(適正旋回半径上限)の時は正常な旋回が行われていると判断し、補正等はなくそのまま旋回を行う。
【0231】
測定した旋回半径から旋回が正常に行われているかどうか毎旋回ごとに判断することで、旋回の精度を向上させることができる。
【0232】
<3点からの旋回アシスト制御(5)>(
図15参照)
田植機の自動旋回制御において、ステアリング一定切れ角で自動旋回中の機体旋回角度、θ1、θ2、θ3における座標をGNSSアンテナ情報から取得する制御とする。取得した3点の座標から下記式にそれぞれの座標を代入し、連立方程式を解くことで旋回半径R1を求め予定通りの旋回半径で制御できているか監視する(x
2+y
2+lx+my+n=0)。求められた旋回半径R1がRb≦R1の時は大回りになっていると判断し、小回りになるようにステアリング角を切り足すように制御する。
【0233】
測定した旋回半径から旋回が大回りになっていると判断した場合に、小回りになるようにステアリングを制御することで、旋回精度を向上させることができる。
【0234】
<3点からの旋回アシスト制御(6)>(
図15参照)
田植機の自動旋回制御において、ステアリング一定切れ角で自動旋回中の機体旋回角度、θ1、θ2、θ3における座標をGNSSアンテナ情報から取得する制御とする。取得した3点の座標から下記式にそれぞれの座標を代入し、連立方程式を解くことで旋回半径R1を求め予定通りの旋回半径で制御できているか監視する(x
2+y
2+lx+my+n=0)。求められた旋回半径R1がR1≦Raの時は小回りになっていると判断し、大回りになるようにステアリング角を戻すように制御する。
【0235】
測定した旋回半径から旋回が小回りになっていると判断した場合に、大回りになるようにステアリングを制御することで、旋回精度を向上させることができる。
【0236】
<3点からの旋回アシスト制御(7)>(
図16参照)
田植機の自動旋回制御において、ステアリング一定切れ角で自動旋回中の機体旋回角度、θ1、θ2、θ3における座標をGNSSアンテナ情報から取得する制御とする。取得した3点の座標から下記式にそれぞれの座標を代入し、連立方程式を解くことで旋回半径R1を求め予定通りの旋回半径で制御できているか監視する(x
2+y
2+lx+my+n=0)。求められた旋回半径R1がRb≦R1の時は大回りになっていると判断し、植え跡が内側に入るように旋回終了時のステアリング戻し始め方位を遅らせ、耕運跡が揃うように制御する。
【0237】
測定した旋回半径から旋回が大回りになっていると判断した場合に、旋回終了時のステアリング戻し始め方位を遅らせることで耕運開始位置を前工程と揃えることができ旋回アシスト制御の精度が向上する。
【0238】
<3点からの旋回アシスト制御(8)>(
図17参照)
田植機の自動旋回制御において、ステアリング一定切れ角で自動旋回中の機体旋回角度、θ1、θ2、θ3における座標をGNSSアンテナ情報から取得する制御とする。取得した3点の座標から下記式にそれぞれの座標を代入し、連立方程式を解くことで旋回半径R1を求め予定通りの旋回半径で制御できているか監視する(x
2+y
2+lx+my+n=0)。求められた旋回半径R1がR1≦Raの時は小回りになっていると判断し、植え跡が外側になるように旋回終了時のステアリング戻し始め方位を早め、耕運跡が揃うように制御する。
【0239】
測定した旋回半径から旋回が小回りになっていると判断した場合に、旋回終了時のステアリング戻し始め方位を早めることで耕運はじめを前工程と揃えることができ旋回アシスト制御の精度が向上する。
【0240】
<3点からの旋回アシスト制御(9)>(
図18参照)
田植機の自動旋回制御において、ステアリング一定切れ角で自動旋回中の機体旋回角度、θ1、θ2、θ3における座標をGNSSアンテナ情報から取得する制御とする。θ1、θ2、θ3については、30°以上離れた値となるように位置情報を取得する制御とする。
【0241】
小さな角度で3点を取得し、旋回半径を求めると、誤差が大きくなり、正確な旋回半径が求められない恐れが大きい。
【0242】
30°以上離れた位置座標を取得し、旋回半径を求めることで、精度の高い旋回半径を求めることができ、旋回アシスト制御の精度を向上させることができる。
【0243】
<3点からの旋回アシスト制御(10)>(
図19参照)
田植機の自動旋回制御において、ステアリング一定切れ角で自動旋回中の機体旋回角度、θ1、θ2、θ3における座標をGNSSアンテナ情報から取得する制御とする。θ1、θ2、θ3については、30°以上離れた値となるように位置情報を取得する制御とする。また、θ3については120°以下とする。
【0244】
120°以上で取得した旋回半径から、旋回制御を補正しようとしても、制御が間に合わず、旋回精度が落ちる恐れがある。
【0245】
120度旋回するまでに、旋回制御の補正を行うか否か判断することで、補正を入れた場合の効果を十分に発揮することができ旋回アシスト制御の精度が向上する。
【0246】
<直進アシスト制御(1)>
直進アシスト田植機において、ローリング方向の機体の傾きをIMUで検知し一定時間一方向に傾いている状態が継続した場合、車輪がわだちにはまっていると判断し、自動的に操舵量ダイヤルの値を多い側へ変更する制御とする。
【0247】
わだちにはまった状態で操舵量が小さいままでは直進制御時のステアリング制御量が小さく直進精度が悪化する。また、わだちから抜け出せない。
【0248】
自動的に操舵量を大きくすることで、直進精度が向上する。また、早期にわだちから脱出でき直進性が良くなる。
【0249】
<直進アシスト制御(2)>
直進アシスト田植機において、ローリング方向の機体の傾きをIMUで検知し一定時間一方向に傾いている状態が継続した場合、車輪がわだちにはまっていると判断し、自動的に操舵量ダイヤルの値を多い側へ変更する制御とする。また、一定時間機体が水平状態を保っていると判断した場合、元の操舵量へ自動的に戻す制御とする。
【0250】
わだちから脱出したのに操舵量が大きいままだと、ステアリング制御量が大きすぎて蛇行する恐れがある。
【0251】
水平状態に戻った時に自動的に元の操舵量へ戻すことで直進精度が向上する。
【0252】
<旋回アシスト制御の改良(1)>(
図20参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。
【0253】
すえ切りさせて、旋回途中でステアリングを戻し横走りさせて条合わせを行っていたが、横走り距離が圃場条件によって安定せず条合わせが合わないことがある。横走りによる不安定要素を排除する。また、GNSS等で経路を指定して制御する方法よりもステアリング固定で旋回する方がシンプルでGNSS感度に左右されず安定させることができる。
【0254】
それぞれの型式、条数に合わせた旋回時のステアリング切れ角を固定することで、横走りによる不安定要素がなくなり、条合わせを安定させることができるうえに、制御がシンプルで汎用性が高い。また、GNSSに左右されることなく旋回を安定させることができる。
【0255】
コの字旋回からU旋回への変更が、実現される。
【0256】
<旋回アシスト制御の改良(2)>(
図20参照)
旋回アシスト制御において、型式別のステアリング切れ角を設定した際、型式ごとに旋回半径が異なることになるが、その旋回半径に応じたバック旋回時のバック量Lを変更させる制御とする。
【0257】
ステアリング切れ角を変更すると、旋回半径が変化するが、バック旋回時のバック量が一定であると旋回半径が大きくなった時にあぜに乗り上げることや、バックしすぎて苗をつぶしたりする問題がある。
【0258】
ステアリング切れ角を変更すると、旋回半径が変化しそれに応じたバック量を設定することで最適な旋回を行うことができ作業能率が向上する。
【0259】
<旋回アシスト制御の改良(3)>(
図20参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。
【0260】
部品のばらつきにより同じステアリング角度でも旋回半径は、機体ごとに異なるためそれぞれの機体に合わせた切れ角を設定できる構成とすることで旋回アシスト制御の精度を向上させることができる。
【0261】
<旋回アシスト制御の改良(4)>(
図20参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。また、その値をモニタのダイヤルで調整できる構成とする(例:1メモリステアリング5°)。
【0262】
圃場条件に合わせて微調整できる構成とすることで旋回アシストの精度を向上させることができる。
【0263】
<旋回アシスト制御の改良(5)>(
図20参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。また、その値をモニタのダイヤルで調整できる構成とする。また、その調整した切れ角に合わせた適切なバック量を自動的に連動して変化させる構成とする。
【0264】
L´:バック量
L:規定バック量
K:調整係数
α:切れ角
J:ダイヤルでの切れ角調整値
L´=L・K・(α+J)
旋回半径が大きくなるとその分あぜまでの距離を取る必要があり、バックする距離が一定だと旋回半径を大きくしたときに、あぜに乗り上げたりする問題がある。
【0265】
切れ角を変化させることに連動してバック量を変化させることで、旋回中にあぜに乗り上げたり、バックで苗をつぶしたりすることを防止でき旋回アシストを安定させることができる。
【0266】
<旋回アシスト制御の改良(6)>(
図21参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。また、旋回精度を圃場条件に合わせて調整させるため図中の丸付き数字4のステアリングを直進状態に戻し始める機体方位角βをモニタのダイヤルで調整できる構成とする。
【0267】
ステアリングを直進状態にもどしはじめるタイミングを微調整できる構成とすることで、圃場条件に合わせた旋回アシストを行うことができ精度を向上させることができる。
【0268】
<旋回アシスト制御の改良(7)>(
図21参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。また、その値をモニタのダイヤルで調整できる構成とする(例:1メモリステアリング5°)。その調整した切れ角に合わせて、図中の丸付き数字4のステアリングを直進状態に戻し始める機体方位角βを連動して変化させる構成とする。
【0269】
β´:ステアリング戻し始め機体方位角
β:ステアリング戻し始め機体方位規定値
K:調整係数
J:ダイヤルでの切れ角調整値
β´=β・K・(α+J)
ステアリングを直進状態にもどしはじめるタイミングをステリング切れ角に連動して、変化させることで旋回アシスト精度を向上させることができる。
【0270】
<旋回アシスト制御の改良(8)>(
図21参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。また、その値をモニタのダイヤルで調整できる構成とする(例:1メモリステアリング5°)。その調整した切れ角に合わせて、図中の丸付き数字4のステアリングを直進状態に戻し始める機体方位角βを連動して変化させ、バック旋回時のバック量も連動して変化させる構成とする。
【0271】
ステアリングを直進状態にもどしはじめるタイミングとバック量をステリング切れ角に連動して、変化させることで旋回アシスト精度を向上させることができる。
【0272】
<旋回アシスト制御の改良(9)>(
図22参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。また、旋回中の車速を検出し、車速に連動して切れ角αを変化させる構成とする。車速Vが大きいほど、切れ角αを大きくすることで車速による旋回半径の変化を抑えることができる。
【0273】
α´:旋回中切れ角
C:調整係数
V:旋回中車速
α:規定ステアリング切れ角
α´=C・V・α
車速に合わせて切れ角を変化させることで旋回半径を安定させることができる。
【0274】
<旋回アシスト制御の改良(10)>(
図23参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。また、旋回中の角速度γを検出し、角速度に連動して切れ角αを変化させる構成とする。車速Vが大きいほど、切れ角αを大きくすることで車速による旋回半径の変化を抑えることができる。
【0275】
α´:旋回中切れ角
C:調整係数
γ:旋回中角速度
α:規定ステアリング切れ角
α´=C・γ・α
旋回中角速度に合わせて切れ角を変化させることで旋回半径を安定させることができる。
【0276】
<旋回アシスト制御の改良(11)>(
図23参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。また、旋回中のHSTレバー開度を検出し、HSTレバーに連動して切れ角αを変化させる構成とする。HSTレバー開度Rが大きいほど、切れ角αを大きくすることで車速による旋回半径の変化を抑えることができる。
【0277】
α´:旋回中切れ角
C:調整係数
R:HSTレバー開度
α:規定ステアリング切れ角
α´=C・R・α
HSTBレバー開度に合わせて切れ角を変化させることで旋回半径を安定させることができる。
【0278】
<旋回アシスト制御の改良(12)>(
図21参照)
旋回アシスト制御において、型式別の旋回目標距離に応じたステアリング切れ角αを設定し、旋回制御中は固定したステアリング切れ角αで旋回する制御とする。その切れ角αを右旋回、左旋回それぞれで設定できる構成とする。また、その値をモニタのダイヤルで調整できる構成とする。また、その調整した切れ角に合わせた適切なバック量、ハンドル戻し始めタイミングを自動的に連動して変化させる構成とする。
【0279】
L´:バック量
L:規定バック量
K:調整係数
α:切れ角
J:ダイヤルでの切れ角調整値
L´=L・K・(α+J)
β´:ステアリング戻し始め機体方位角
β:ステアリング戻し始め機体方位規定値
K:調整係数
J:ダイヤルでの切れ角調整値
β´=β・K・(α+J)
旋回半径が大きくなるとその分あぜまでの距離を取る必要があり、バックする距離が一定だと旋回半径を大きくしたときに、あぜに乗り上げたりする問題がある。
【0280】
切れ角を変化させることに連動してバック量を変化させることで、旋回中にあぜに乗り上げたり、バックで苗をつぶしたりすることを防止でき旋回アシストを安定させることができる。
【0281】
<旋回アシストZターン補正(1)>
田植機Zターン制御において旋回アシスト中は後輪回転センサの検出によって決まる植付部下げタイミングN1に補正(+20pls)する構成とする。
【0282】
旋回アシスト制御では通常の旋回よりも大回り旋回となるので、Zターンのタイミングが合わない(早すぎる)。Zターンにタイミングを合わせようと思ったら、ユーザが自分でチェッカやモニタ操作を行わないといけない。
【0283】
旋回アシスト時は自動でZターンの補正を入れることでユーザの手間を省ける。
【0284】
<旋回アシストZターン補正(2)>
田植機Zターン制御において旋回アシスト中は後輪回転センサの検出によって決まる植付クラッチ入りタイミングN2に補正(+20pls)する構成とする。
【0285】
旋回アシスト制御では通常の旋回よりも大回り旋回となるので、Zターンのタイミングが合わない(早すぎる)。Zターンにタイミングを合わせようと思ったら、ユーザが自分でチェッカやモニタ操作を行わないといけない。
【0286】
旋回アシスト時は自動でZターンの補正を入れることでユーザの手間を省ける。
【0287】
<旋回アシストZターン補正(3)>
旋回アシストZターン補正(1)の構成でN1補正は機体の条数によって変更する構成とする。
【0288】
条数によって旋回半径、作業幅が異なるので目指す目標経路が異なってくる。
【0289】
条数によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0290】
<旋回アシストZターン補正(4)>
旋回アシストZターン補正(1)の構成でN1補正は7条設定の場合、3条またぎと5条またぎで変更する構成とする。
【0291】
7条はまたぎ条数によって旋回半径、作業幅が異なるので目指す目標経路が異なってくる。
【0292】
またぎ条数によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0293】
<旋回アシストZターン補正(5)>
旋回アシストZターン補正(1)の構成でN1補正は内付け補助車輪有の場合に変更する構成(+30pls)とする。
【0294】
補助車輪によって旋回半径、作業幅が異なるので目指す目標経路が異なってくる。
【0295】
補助車輪によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0296】
<旋回アシストZターン補正(6)>
旋回アシストZターン補正(1)の構成でN1補正は外付け補助車輪有の場合に変更する構成(+30pls)とする。
【0297】
補助車輪によって旋回半径、作業幅が異なるので目指す目標経路が異なってくる。
【0298】
補助車輪によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0299】
<旋回アシストZターン補正(7)>
旋回アシストZターン補正(1)の構成でN1補正は内付け、外付け補助車輪を両方付けている場合(トリプル)外付け補助車輪設定を優先にし補正を行う構成(外付け優先ver)とする。
【0300】
トリプルの場合は外付け車輪の影響が大きい。内付けと外付けの2重補正防止が、実現される。
【0301】
補助車輪によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0302】
<旋回アシストZターン補正(8)>
旋回アシストZターン補正(1)の構成でN1補正は内付け、外付け補助車輪を両方付けている場合(トリプル)の場合に専用の補正を行う構成(トリプル設定ver)とする。
【0303】
補助車輪によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。トリプル独自の補正設定が可能になる。
【0304】
<旋回アシストZターン補正(9)>
旋回アシストZターン補正(2)の構成でN2補正は機体の条数によって変更する構成とする。
【0305】
条数によって旋回半径、作業幅が異なるので目指す目標経路が異なってくる。
【0306】
条数によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0307】
<旋回アシストZターン補正(10)>
旋回アシストZターン補正(2)の構成でN2補正は7条設定の場合、3条またぎと5条またぎで変更する構成とする。
【0308】
7条はまたぎ条数によって旋回半径、作業幅が異なるので目指す目標経路が異なってくる。
【0309】
またぎ条数によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0310】
<旋回アシストZターン補正(11)>
旋回アシストZターン補正(2)の構成でN2補正は内付け補助車輪有の場合に変更する構成(+40pls)とする。
【0311】
補助車輪によって旋回半径、作業幅が異なるので目指す目標経路が異なってくる。
【0312】
補助車輪によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0313】
<旋回アシストZターン補正(12)>
旋回アシストZターン補正(2)の構成でN2補正は外付け補助車輪有の場合に変更する構成(+40pls)とする。
【0314】
補助車輪によって旋回半径、作業幅が異なるので目指す目標経路が異なってくる。
【0315】
補助車輪によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0316】
<旋回アシストZターン補正(13)>
旋回アシストZターン補正(2)の構成でN2補正は内付け、外付け補助車輪を両方付けている場合(トリプル)外付け補助車輪設定を優先にし補正を行う構成(外付け優先ver)とする。
【0317】
トリプルの場合は外付け車輪の影響が大きい。内付けと外付けの2重補正防止が、実現される。
【0318】
補助車輪によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。
【0319】
<旋回アシストZターン補正(14)>
旋回アシストZターン補正(2)の構成でN2補正は内付け、外付け補助車輪を両方付けている場合(トリプル)の場合に専用の補正を行う構成(トリプル設定ver)とする。
【0320】
補助車輪によってZターン補正量を変更することで適切な旋回アシスト、Zターンが可能になる。トリプル独自の補正設定が可能になる。
【0321】
<旋回アシストZターン補正(15)>
旋回アシストZターン補正(1)~(14)の補正値はチェッカやモニタ設定で任意の値に変更可能な構成とする。
【0322】
圃場条件によってユーザに好みでパラメータを変更することができる。
【0323】
<田植機旋回アシストモニタガイダンス表示(1)>(
図24参照)
田植機旋回アシスト制御で旋回アシスト開始~終了まで左旋回時マーカモニタランプは旋回方向の左ランプを周期的(オンタイム500ms周期1秒等)に点滅させる構成とする。
【0324】
オートマーカ時(旋回アシストの条件)にマーカモニタランプは植え付け部上昇時に旋回方向に寄らず今出している方向と逆のランプを点ける。つまり、左旋回する場合マーカは左に出ておりランプは左が付いているが、バックターンをしたときにマーカランプは自動で逆方向に点いてしまう。そうすると、旋回してハンドルを切る方向は左だが、ランプは右が点いているので作業者は違和感がある(実際は旋回方向ランプでなくマーカランプなので動作は合っているが違和感が生じる)。
【0325】
旋回アシスト時はマーカランプを旋回ガイダンスランプとして使える。
【0326】
<田植機旋回アシストモニタガイダンス表示(2)>
田植機旋回アシスト制御で旋回アシスト開始~終了まで右旋回時マーカモニタランプは旋回方向の右ランプを周期的(オンタイム500ms周期1秒等)に点滅させる構成とする。
【0327】
オートマーカ時(旋回アシストの条件)にマーカモニタランプは植え付け部上昇時に旋回方向に寄らず今出している方向と逆のランプを点ける。つまり、左旋回する場合マーカは左に出ておりランプは左が付いているが、バックターンをしたときにマーカランプは自動で逆方向に点いてしまう。そうすると、旋回してハンドルを切る方向は左だが、ランプは右が点いているので作業者は違和感がある(実際は旋回方向ランプでなくマーカランプなので動作は合っているが違和感が生じる)。
【0328】
旋回アシスト時はマーカランプを旋回ガイダンスランプとして使える。
【0329】
<田植機旋回アシストモニタガイダンス表示(3)>
田植機旋回アシスト制御で旋回アシスト開始~終了まで左旋回時「旋回アシスト左旋回中です」を表示させる構成とする。
【0330】
オートマーカ時(旋回アシストの条件)にマーカモニタランプは植え付け部上昇時に旋回方向に寄らず今出している方向と逆のランプを点ける。つまり、左旋回する場合マーカは左に出ておりランプは左が付いているが、バックターンをしたときにマーカランプは自動で逆方向に点いてしまう。そうすると、旋回してハンドルを切る方向は左だが、ランプは右が点いているので作業者は違和感がある(実際は旋回方向ランプでなくマーカランプなので動作は合っているが違和感が生じる)。
【0331】
今の旋回方向がわかる。
【0332】
<田植機旋回アシストモニタガイダンス表示(4)>
田植機旋回アシスト制御で旋回アシスト開始~終了まで右旋回時「旋回アシスト右旋回中です」を表示させる構成とする。
【0333】
オートマーカ時(旋回アシストの条件)にマーカモニタランプは植え付け部上昇時に旋回方向に寄らず今出している方向と逆のランプを点ける。つまり、左旋回する場合マーカは左に出ておりランプは左が付いているが、バックターンをしたときにマーカランプは自動で逆方向に点いてしまう。そうすると、旋回してハンドルを切る方向は左だが、ランプは右が点いているので作業者は違和感がある(実際は旋回方向ランプでなくマーカランプなので動作は合っているが違和感が生じる)。
【0334】
今の旋回方向がわかる。
【0335】
<田植機旋回アシストモニタ表示(1)>
田植機旋回アシスト制御でバックターン制御中バック開始~バック完了までモニタに割り込み表示「主変速レバーを後進側にしてください」を表示する構成とする。
【0336】
最初は旋回アシスト中、どのような操作をしたらよいか、作業者はわかりにくい。
【0337】
操作方法を作業者に知らせる。
【0338】
<田植機旋回アシストモニタ表示(2)>
田植機旋回アシスト制御でバックターン制御中バック完了後、前進操作~旋回アシスト制御完了までモニタに割り込み表示「旋回アシスト中です」を表示する構成とする。
【0339】
今、旋回アシスト制御中で、通常とは異なるHST、ハンドル操作になっていることを作業者に知らせる。
【0340】
<田植機旋回アシストモニタ表示(3)>
田植機旋回アシスト制御でUターン入り設定になっている場合Uターン制御開始条件を満たしている場合(あと植え付け部上げだけの状態)モニタに割り込み表示「前進しながら植付部上げ操作で旋回開始します」を表示する構成とする。
【0341】
最初は旋回アシスト中、どのような操作をしたらよいか、作業者はわかりにくい。特にバックターンとUターン制御で開始条件が異なるので違いが分かりにくい。
【0342】
操作方法を作業者に知らせる。
【0343】
<田植機旋回アシストモニタ表示(4)>
田植機旋回アシスト制御でUターン制御中Uターン開始~旋回アシスト制御完了までモニタに割り込み表示「旋回アシスト中です」を表示する構成とする。
【0344】
今、旋回アシスト制御中で、通常とは異なるHST、ハンドル操作になっていることを作業者に知らせる。
【0345】
<田植機旋回アシストモニタ表示(5)>
田植機旋回アシスト制御でバックターン制御中旋回アシスト制御を中断した場合「旋回アシストをキャンセルしました」を表示する構成とする。
【0346】
旋回アシストがキャンセルになったことを作業者に知らせる。
【0347】
<田植機旋回アシストモニタ表示(6)>
田植機旋回アシスト制御でUターン制御中旋回アシスト制御を中断した場合「旋回アシストをキャンセルしました」を表示する構成とする。
【0348】
旋回アシストがキャンセルになったことを作業者に知らせる。
【0349】
なお、本発明に関連した発明のプログラムは、上述された本発明に関連した発明の走行制御方法の全部または一部のステップ(または工程、動作および作用など)の動作をコンピュータに実行させるためのプログラムであって、コンピュータと協働して動作するプログラムである。
【0350】
また、本発明に関連した発明の記録媒体は、上述された本発明に関連した発明の走行制御方法の全部または一部のステップ(または工程、動作および作用など)の全部または一部の動作をコンピュータに実行させるためのプログラムを記録した記録媒体であり、読取られたプログラムがコンピュータと協働して利用されるコンピュータ読取り可能な記録媒体である。
【0351】
なお、上述された「一部のステップ(または工程、動作および作用など)」は、それらの複数のステップの内の一つまたはいくつかのステップを意味する。
【0352】
また、上述された「ステップ(または工程、動作および作用など)の動作」は、上述されたステップの全部または一部の動作を意味する。
【0353】
また、本発明に関連した発明のプログラムの一利用形態は、インターネット、光、電波または音波などのような伝送媒体の中を伝送され、コンピュータにより読取られ、コンピュータと協働して動作するという形態であってもよい。
【0354】
また、記録媒体としては、ROM(Read Only Memory)などが含まれる。
【0355】
また、コンピュータは、CPU(Central Processing Unit)などのような純然たるハードウェアに限らず、ファームウェア、OS(Operating System)、そしてさらに周辺機器を含んでもよい。
【0356】
なお、上述されたように、本発明の構成は、ソフトウェア的に実現されてもよいし、ハードウェア的に実現されてもよい。
【産業上の利用可能性】
【0357】
本発明における作業車両は、車体の旋回制御を行うことができ、田植え機などのような作業車両に利用する目的に有用である。
【符号の説明】
【0358】
10 車体
20 エンジン
30 走行装置
31 前輪
32 後輪
33 補助車輪
41 主変速機構
42 副変速機構
43 後輪ギヤケース
44 ステアリングモーター
50 運転ユニット
51 座席
52 ステアリングハンドル
53 主変速レバー
54 副変速レバー
55 直進アシストレバー
56 アシストモードスイッチ
60 整地装置
61 整地ローター機構
62 整地フロート機構
70 施肥装置
80 線引きマーカー
90 植付け装置昇降装置
100 植付け装置
101 予備苗載せ台
200 制御装置
210 後輪回転数センサー
220 植付け装置昇降センサー
300 測位システム
400 閾値調節装置