JP2008212059A - 農作業機の昇降制御装置 - Google Patents

Abstract

【課題】 走行機体に昇降自在に連結した作業装置の昇降駆動機構を、検出された対地高さ情報に基づいて作動制御して、作業装置の対地高さを設定高さに維持するように構成した農作業機の昇降制御装置において、作業装置の急激な高さ変動に対しても好適に応答して昇降作動を行わせることができるようにする。
【解決手段】 作業装置の対地高さを検出する高さ検出手段からの検出値θと、この検出値θを微分して得られる変化速度ωとを、昇降駆動機構５を作動制御する対地高さ情報としてある。
【選択図】 図２

Description

本発明は、乗用型田植機、農用トラクタ、コンバイン、などの農作業機に用いる昇降制御装置に関する。

乗用型田植機の昇降制御装置としては、走行機体の後部に駆動昇降自在に連結した苗植付け装置（作業装置）に接地追従可能に接地体を備え、この接地体の揺動角度から苗植付け装置の田面に対する対地高さを割り出し、接地体の揺動角度と予め設定された目標角度の偏差が不感帯から外れると、その外れを是正する方向に苗植付け装置を上記偏差に正比例した速度で昇降させるように昇降駆動手段を比例制御することで、走行機体の浮沈や前後傾斜にかかわらず、苗植付け装置の対地高さを設定高さに維持して植付け深さを安定させるようにしている（例えば、特許文献１参照）。
特開２００６−１８０８２３号公報

従来の昇降制御装置においては、耕盤の凹凸などによって走行機体が浮沈したり、前後傾斜して苗植付け装置が突発的に上下動したような場合、昇降制御がこれに速やかに追従することが難しく、苗植付け装置の対地高さが設定高さから大きく外れたり、設定高さから外れる時間が長くなってしまうことがあった。

このような不具合を減少するために、苗植付け装置の対地高さの微分要素（速度要素）を付加して設定高さからの偏差値を修正して比例制御を行うことで応答性を高めることも試みられているが、修正された偏差値が不感帯を越える大きさになるまでは昇降作動が行われることはなく、突発的な高さ変化への対応が未だ不充分なものであった。

本発明は、このような点に着目してなされたものであって、作業装置の急激な高さ変動に対しても素早く応答して昇降作動を行わせることができる農作業機の昇降制御装置を提供することを目的としている。

第１の発明は、走行機体に昇降自在に連結した作業装置の昇降駆動機構を、検出された対地高さ情報に基づいて作動制御して、前記作業装置の対地高さを設定高さに維持するように構成した農作業機の昇降制御装置であって、
前記作業装置の対地高さを検出する高さ検出手段からの検出値と、この検出値を微分して得られる変化速度とを、前記昇降駆動機構を作動制御する前記対地高さ情報としてあることを特徴とする。

上記構成によると、作業装置の対地高さを微分して得られる変化速度が設定範囲を越えると、作業装置の対地高さに基づく基本的な昇降制御に優先した制御を行うことができ、基本的な昇降制御における作業装置の対地高さと設定高さとの偏差が不感帯を上まわる前から、昇降制御作動を開始することが可能となる。

従って、第１の発明によると、昇降制御作動の開始タイミングを早めて、作業装置の突発的な高さ変動に対しても素早く応答して作業装置を昇降させることができ、作業装置の対地高さが設定高さから大きく外れたり、設定高さから外れる時間が長くなってしまうことを抑制するのに有効となる。

第２の発明は、上記第１の発明において、
演算された前記変化速度が設定範囲を越える上昇方向への速度変化であると、下降指令が優先して出力されるよう構成してあるものである。

上記構成によると、作業装置が地面から急速に上方に離れかけた際に早いタイミングで下降制御を行って、作業装置の浮き上がりを素早く抑制することができる。例えば作業装置が苗植付け装置の場合には、浮き苗や植付け苗の姿勢悪化を防止するのに有効であり、作業装置が播種装置の場合には、種子の埋め込み深さの不足を効果的に防止することができる。

第３の発明は、上記第１または２の発明において、
前記高さ検出手段を、前記作業装置に接地追従可能に支持された接地体の揺動角度を検出する角度センサで構成してあるものである。

上記構成によると、接地体は地面の細かい凹凸を均らしながら接地追従して移動するので、超音波センサ等により非接触で作業装置の対地高さを直接に検出する場合に比べて、外乱の少ない安定した作業装置の対地高さの検出を行うことができる。

第４の発明は、走行機体に昇降自在に連結した作業装置の昇降駆動機構を、検出された対地高さ情報に基づいて作動制御して、前記作業装置の対地高さを設定高さに維持するように構成した農作業機の昇降制御装置であって、
前記作業装置に接地追従可能に支持された接地体の揺動角度を検出する角度センサと、前記接地体の揺動速度を検出する角速度センサとを備え、これら角度センサの検出情報と角速度センサの検出情報とを、前記昇降駆動機構を作動制御する前記対地高さ情報としてあることを特徴とする。

上記構成によると、接地体の揺動速度が設定範囲以内であると、接地体の揺動角度の検出値に基づく基本的な昇降制御を実行し、接地体の揺動速度が設定範囲を越えると、基本的な昇降制御に優先した昇降制御を行うことができ、接地体の揺動角度が基本的な昇降制御における不感帯より大きくなる前に昇降作動を開始することが可能となる。

従って、第４の発明によると、作業装置の突発的な高さ変動に対しても速いタイミングで昇降制御作動を行わせて、作業装置の対地高さの設定高さからの外れ量を小さくするとともに、設定高さからの外れ時間を短くすることができる。

第５の発明は、上記第４の発明において、
前記角速度センサで検出された角速度が設定範囲を越える上昇方向作動であると、下降指令が優先して出力されるよう構成してあるものである。

上記構成によると、作業装置が地面から急速に上方に離れかけた際に早いタイミングで下降制御を行って、作業装置の浮き上がりを素早く抑制することができる。例えば作業装置が苗植付け装置の場合には、浮き苗や植付け苗の姿勢悪化を防止するのに有効であり、作業装置が播種装置の場合には、種子の埋め込み深さの不足を効果的に防止することができる。

第６の発明は、走行機体に昇降自在に連結した作業装置の昇降駆動機構を、検出された対地高さ情報に基づいて作動制御して、前記作業装置の対地高さを設定高さに維持するように構成した農作業機の昇降制御装置であって、
前記作業装置に接地追従可能に支持された接地体の揺動角度を検出する角度センサを備えるとともに、前記作業装置の昇降速度を検出する昇降速度検知手段を備え、これら角度センサの検出情報と前記昇降速度検知手段の検出情報とを、前記昇降駆動機構を作動制御する対地高さ情報としてあることを特徴とする。

上記構成によると、昇降速度検知手段で検出された昇降速度が設定範囲を越えると、角度センサの検出情報に基づく基本的な昇降制御に優先した昇降制御を早いタイミングで行うことが可能となる。

従って、第６の発明によると、昇降制御作動の開始タイミングを早めて、作業装置の突発的な高さ変動に対しても素早く応答して作業装置を昇降させることができ、作業装置の対地高さが設定高さから大きく外れたり、設定高さから外れる時間が長くなってしまうことを抑制するのに有効となる。

第７の発明は、上記第６の発明において、
昇降速度検知手段で検出された上昇方向の昇降速度が設定範囲を越えると、下降指令が優先して出力されるよう構成してあるものである。

上記構成によると、作業装置が地面から急速に上方に離れかけた際に早いタイミングで下降制御を行って、作業装置の浮き上がりを素早く抑制することができる。例えば作業装置が苗植付け装置の場合には、浮き苗や植付け苗の姿勢悪化を防止するのに有効であり、作業装置が播種装置の場合には、種子の埋め込み深さの不足を効果的に防止することができる。

図１に、本発明に係る農作業機の一例として施肥装置付きの乗用型田植機が示されている。この乗用型田植機は、操向自在な左右一対の前輪１と操向不能な左右一対の後輪２とを備えた四輪駆動型の走行機体３の後部に、６条植え仕様に構成された苗植付け装置（作業装置）４が、昇降駆動機構としての油圧シリンダ５によって駆動される平行四連リンク構造のリンク機構６を介して昇降自在に連結された基本構造を備え、走行機体３の後部に施肥装置７が装備されるとともに、走行機体３の前部左右に予備苗のせ台８が立設配備された構造となっている。苗植付け装置４は、リンク機構６の後端部に前後方向支点Ｘ周りにローリング自在に連結されるとともに、リンク機構６の後端上部に備えた電動モータ利用のローリング駆動機構９によってローリング制御されるようになっている。

前記苗植付け装置４は、横長角筒状の植付けフレーム１１、走行機体３から取り出された作業用動力を受けるフィードケース１２、一定ストロークで左右に往復横移動する苗のせ台１３、回転式の植付け機構１４、後部左右に２条分づつの植付け機構１４を備えた３個の植付けケース１５、田面の植付け箇所を均平整地する３個の整地フロート１６、田面Ｔに次回の走行基準線を引っ掻き形成する左右一対のマーカ１７、等を備えている。

並列配備された整地フロート１６はそれぞれ後部支点ｐ（図２参照）を中心に上下揺動自在に支持されており、中央の整地フロート１６は、田面Ｔに対する苗植付け装置４の対地高さを検知する接地体ＳＦとして利用されている。この接地体ＳＦの前部と苗植付け装置４の適所に位置固定に配備された回転式ポテンショメータからなる角度センサ２１とがリンク連係され、接地体ＳＦの後部支点ｐ周りの揺動角度が角度センサ２１の検出値θとして電気的に検出されるようになっている。

接地体ＳＦの上下への揺動角度変化に基づいて苗植付け装置４を昇降制御して植付け深さを安定維持する自動昇降制御の実施例のいくつかを以下に説明する。

〔第１例〕
図２の制御ブロック図に示すように、走行機体３に装備されたマイコン利用の制御装置２２には、前記角度センサ２１、前記油圧シリンダ５の作動を司る電磁制御弁２３、ポテンショメータからなる制御感度調節器２４、植付けレバー２５の操作位置を検知するポテンショメータ２６、十字操作式の優先操作レバー２７の操作を検知するスイッチ機構２８、走行機体３に装備された植付けクラッチ２９を入り切り操作する電動モータ３０、各マーカ１７のロックを解除する電磁ソレノイド３１、苗植付け装置４が所定の上限位置まで上昇されたことを検知する上限スイッチ３２、等が接続されている。

前記角度センサ２１は、接地体ＳＦが上方に揺動するほど検出値θが増大するように設定されている。制御感度調節器２４は、昇降制御の中立状態をもたらす接地体ＳＦの目標姿勢を７段階の目標値θ0として変更調節するものであり、中間調節位置(4）では接地体ＳＦの目標姿勢が略前後水平に設定され、それより段数が小さくなるほど（3〜1）、目標値θ0が減少変更されて、接地体ＳＦの目標姿勢が前下がり方向に変更され、段数が大きくなるほど（5〜7）、目標値θ0が増大変更されて、接地体ＳＦの目標姿勢が前上り方向に変更されるようになっている。

接地体ＳＦの目標姿勢が前下がり（目標値θ0が小さく）に設定されるほど、接地体ＳＦの接地面前端が後部支点ｐから離れることで接地反力を受けやすくなるとともに、接地体ＳＦを下方に接地付勢するセンサバネ３６のバネ荷重が小さくなり、苗植付け装置４の浮沈に伴って接地体ＳＦが敏感に揺動変位する状態となる。逆に、接地体ＳＦの目標姿勢が前上がり（目標値θ0が大きく）に設定されるほど、接地体ＳＦの接地面前端が後部支点ｐに近づくことで接地反力を受けにくくなるとともに、センサバネ３６のバネ荷重が大きくなり、苗植付け装置４の浮沈に伴う接地体ＳＦの揺動が鈍感な状態となる。

植付けレバー２５は運転座席１８の右横脇に前後揺動可能に配備されており、前方から後方に亘って「植付け」位置，「下降」位置，「中立」位置、および、「上昇」位置が設定されるとともに、更に、「自動」位置が設定されている。

植付けレバー２５を「植付け」位置に操作すると、苗植付け装置４を角度センサ２１からの検知情報に基づいて電磁制御弁２３を制御して、田面Ｔに対する苗植付け装置４の高さを安定維持する自動昇降制御が実行されるとともに、電動モータ３０によって植付けクラッチ２９が「入り」操作され、植付け深さを安定維持しながらの植付け作業が行われる。

植付けレバー２５を「下降」位置に操作すると、上記自動昇降制御が実行されるとともに植付けクラッチ２９が「切り」操作される。この操作状態では、植付け作動を行うことなく苗植付け装置４を接地追従させることができ、田面Ｔを整地フロート１６で均平整地する場合、などに利用することができる。

植付けレバー２５を「中立」位置に操作すると、植付けクラッチ２９が「切り」操作された状態で電磁制御弁２３が中立に保持され、駆動停止されている苗植付け装置４を任意の高さに保持しておくことができる。

植付けレバー２５を「上昇」位置に操作すると、植付けクラッチ２９が「切り」操作された状態で電磁制御弁２３が「上昇」に切換えられ、油圧シリンダ５が短縮駆動されて苗植付け装置４が上昇される。苗植付け装置４が上限位置まで上昇して上限スイッチ３２が作動すると電磁制御弁２３が「中立」に復帰されて上昇が自動的に停止する。

植付けレバー２５を「自動」位置に操作すると、前記「植付け」位置に操作した場合と同じ自動昇降制御モードが設定されるとともに、前記優先操作レバー２７による苗植付け装置４の上げ下げ操作が可能なモードとなる。

優先操作レバー２７はステアリングハンドル１９の右横側に上下および前後に十字揺動操作可能、かつ、中立付勢して配備されており、植付けレバー２５が「自動」位置に操作された状態では、優先操作レバー２７を１回「上昇」位置に操作すると、植付けクラッチ２９が切り操作されるとともに苗植付け装置４が上限まで上昇され、優先操作レバー２７を１回「下降」位置に操作すると、植付けクラッチ２９が切り状態のままで自動昇降制御モードとなって苗植付け装置４は接地するまで自動下降され、優先操作レバー２７を２回目に「下降」位置に操作すると植付けクラッチ２９が入り操作されるようになっている。

前記マーカ１７は倒伏した線引き作用姿勢に揺動付勢されるとともに、前記リンク機構６にワイヤ連係されており、苗植付け装置４が上昇されるとマーカ１７が強制的に振り上げ起立されて、格納ロック機構３５によって自動的に起立格納姿勢に係止保持されるようになっている。格納ロック機構３５は前記電磁ソレノイド３１への通電によってロック解除操作されるようになっており、前記優先操作レバー２７を前方に操作すると左側のマーカ１７に対するロック解除用の電磁ソレノイド３１が通電され、優先操作レバー２７を後方に操作すると右側のマーカ１７に対するロック解除用の電磁ソレノイド３１が通電される。

次に、前記角度センサ２１の検知情報に基づく自動昇降制御の作動を図３のフロー図に基づいて説明する。

自動昇降制御モードに入ると、先ず、苗植付け装置４の対地高さを検出する情報として、角度センサ２１からの検出値θが取り込まれるとともに、この検出値θが微分処理されて接地体ＳＦの角速度（変化速度）ωが演算される（♯101，♯102）。演算された角速度ωは予め入力設定されている基準値ω0と比較され（♯103）、苗植付け装置４が急激に田面Ｔに対して上昇して、接地体ＳＦが下方揺動する方向への角速度ωが基準値ω0を越えると、検出値θが基本的な昇降制御における目標値θ0の不感帯内にあっても、角速度ωに正比例した速度で優先的に下降制御が実行される（♯104）。苗植付け装置４が急激に田面Ｔに対して下降して、接地体ＳＦが上方揺動する方向への角速度ωが基準値ω0を越えると、検出値θが目標値θ0の不感帯内にあっても、角速度ωに比例した速度で優先的に上昇制御が実行される（♯105）。

角速度ωが基準値ω0以内であると基本的な昇降制御が実行される。つまり、角度センサ２１からの検出値θが目標値θ0と比較され（♯106，♯107）、苗植付け装置４の浮上によって接地体ＳＦが目標姿勢より下方揺動して、検出値θが目標値θ0を不感帯εより下まわっていると、目標値θ0と検出値θとの偏差（θ0-θ）に正比例した速度での下降制御が実行される（♯108）。苗植付け装置４の沈下によって接地体ＳＦが目標姿勢より上方揺動して、検出値θが目標値θ0を不感帯εより上まわっていると、目標値θ0と検出値θとの偏差（θ0-θ）に正比例した速度で上昇制御が実行される（♯109）。苗植付け装置４の対地高さが設定高さにあって、検出値θが不感帯ε以内で目標値θ0に近い状態にあると、制御中立状態が維持される（♯110）。このように、接地体ＳＦが目標姿勢に維持されることで田面Ｔに対する苗植付け装置４の対地高さの安定化が図られる。

〔第２例〕
図４に、自動昇降制御の第２例のブロック図が、図５に、その制御フロー図がそれぞれ示されている。この例においては、接地体ＳＦが上下揺動する際の前記角速度（変化速度）ωを、接地体ＳＦに取り付けた振動型ジャイロセンサなどの角速度センサ３３で直接に検出するよう構成されている。

この構成によると、図５示すように、先ず、苗植付け装置４の対地高さを検出する情報として、角度センサ２１からの検出値θと、角速度センサ３３からの角速度ωが取り込まれる（♯201，♯202）。次に、検出された角速度ωが予め入力設定された基準値ω0と比較され（♯203）、苗植付け装置４が急激に田面Ｔに対して上昇して、接地体ＳＦが下方揺動する方向への角速度ωが基準値ω0を越えると、検出値θが基本的な昇降制御における目標値θ0の不感帯内にあっても角速度ωに正比例した速度で優先的に下降制御が実行される（♯204）。苗植付け装置４が急激に田面Ｔに対して下降して、接地体ＳＦが上方揺動する方向への角速度ωが基準値ω0を越えると、検出値θが目標値θ0の不感帯内にあっても角速度ωに正比例した速度で優先的に上昇制御が実行される（♯205）。

角速度ωが基準値ω0以内であると基本的な昇降制御が実行される。つまり、角度センサ２１からの検出値θが目標値θ0と比較され（♯206，♯207）、苗植付け装置４の浮上によって接地体ＳＦが目標姿勢より下方揺動し、検出値θが目標値θ0を不感帯εより下まわっていると、目標値θ0と検出値θとの偏差（θ0-θ）に正比例した速度での下降制御が実行される（♯208）。苗植付け装置４の沈下によって接地体ＳＦが目標姿勢より上方揺動し、検出値θが目標値θ0を不感帯εより上まわっていると、目標値θ0と検出値θとの偏差（θ0-θ）に正比例した速度で上昇制御が実行される（♯209）。苗植付け装置４の対地高さが設定高さにあって、検出値θが不感帯ε以内で目標値θ0に近い状態にあると、制御中立状態が維持される（♯210）。このように、接地体ＳＦが目標姿勢に維持されることで田面Ｔに対する苗植付け装置４の対地高さの安定化が図られる。

〔第３例〕
図６に、自動昇降制御の第３例のブロック図が、図７に、その制御フロー図がそれぞれ示されている。この例においては、苗植付装置４の適所に加速度センサ３４が装備されて、その検出値ｇを積分して苗植付装置４の昇降速度ｖを演算するよう構成されている。

この構成によると、図７示すように、先ず、苗植付け装置４の対地高さを検出する情報として、角度センサ２１からの検出値θと、加速度センサ３４からの加速度ｇが取り込まれ（♯201，♯202）、加速度ｇを積分して昇降速度（変化速度）ｖが演算される（♯303）。次に、演算された昇降速度ｖが予め入力設定された基準値ｖ0と比較され（♯304）、苗植付け装置４が急激に田面Ｔに対して上昇して、接地体ＳＦが下方揺動する方向への昇降速度ｖが基準ｖ0を越えると、検出値θが基本的な昇降制御における目標値θ0の不感帯内にあっても昇降速度ｖに正比例した速度で優先的に下降制御が実行される（♯305）。苗植付け装置４が急激に田面Ｔに対して下降して、接地体ＳＦが上方揺動する方向への昇降速度ｖが基準値ｖ0を越えると、検出値θが目標値θ0の不感帯内にあっても昇降速度ｖに正比例した速度で優先的に上昇制御が実行される（♯306）。

昇降速度ｖが基準値ｖ0以内であると基本的な昇降制御が実行される。つまり、角度センサ２１からの検出値θが目標値θ0と比較され（♯307，♯308）、苗植付け装置４の浮上によって接地体ＳＦが目標姿勢より下方揺動して、検出値θが目標値θ0を不感帯εより下まわっていると、目標値θ0と検出値θとの偏差（θ0-θ）に正比例した速度での下降制御が実行される（♯309）。苗植付け装置４の沈下によって接地体ＳＦが目標姿勢より上方揺動し、検出値θが目標値θ0を不感帯εより上まわっていると、目標値θ0と検出値θとの偏差（θ0-θ）に正比例した速度で上昇制御が実行される（♯310）。苗植付け装置４の対地高さが設定高さにあって、検出値θが不感帯ε以内で目標値θ0に近い状態にあると、制御中立状態が維持される（♯311）。このように、接地体ＳＦが目標姿勢に維持されることで田面Ｔに対する苗植付け装置４の対地高さの安定化が図られる。

〔第４例〕
図８に、自動昇降制御の第４例のブロック図が、図９に、その制御フロー図がそれぞれ示されている。この例においては、接地体ＳＦが上下揺動する際の前記角速度（変化速度）ωを検出する角速度センサ３３だけが装備されており、苗植付け装置４が上限まで上昇されて接地体ＳＦが前下がり揺動限界になった姿勢からの振り上げ揺動角度が、角速度センサ３３で検出された角速度ωを積分して演算取得され、その演算値が接地体ＳＦの揺動角度を示す検出値θとされる。

この構成によると、図９示すように、先ず、苗植付け装置４の対地高さを検出する情報として、角速度センサ３３からの角速度ωが取り込まれれるとともに（♯401）、この検出された角速度ωが積分処理されて苗植け装置４の昇降速度ｖが演算される（♯402）。次に、角速度センサ３３で検出された角速度ωが予め入力設定された基準値ω0と比較され（♯403）、苗植付け装置４が急激に田面Ｔに対して上昇して、接地体ＳＦが下方揺動する方向への角速度ωが基準値ω0を越えると、検出値θが基本的な昇降制御における目標値θ0の不感帯内にあっても角速度ωに正比例した速度で優先的に下降制御が実行される（♯404）。苗植付け装置４が急激に田面Ｔに対して下降して、接地体ＳＦが上方揺動する方向への角速度ωが基準値ω0を越えると、検出値θが目標値θ0の不感帯内にあっても角速度ωに正比例した速度で優先的に上昇制御が実行される（♯405）。

角速度ωが基準値ω以内であると基本的な昇降制御が実行される。つまり、角速度ωを積分して得られた検出値θが目標値θ0と比較され（♯406，♯407）、接地体ＳＦが目標姿勢より下方揺動して検出値θが目標値θ0を不感帯εより下まわると、目標値θ0と検出値θとの偏差（θ0-θ）に正比例した速度での下降制御が実行される（♯408）。接地体ＳＦが目標姿勢より上方揺動して検出値θが目標値θ0を不感帯εより上まわると、目標値θ0と検出値θとの偏差（θ0-θ）に正比例した速度で上昇制御が実行される（♯409）。苗植付け装置４の対地高さが設定高さにあって、検出値θが不感帯ε以内で目標値θ0に近い状態にあると、制御中立状態が維持される（♯410）。このように、接地体ＳＦが目標姿勢に維持されることで田面Ｔに対する苗植付け装置４の対地高さの安定化が図られる。

〔他の実施例〕
（１）上記のように、作業装置が苗植付け装置４の場合、苗植付け装置４の浮上に伴う浮き苗や植付け苗の倒れの発生が問題となるが、苗植付け装置４の沈下に伴う深植えは致命的な問題とはならないので、苗植付け装置４が上昇方向へ変化する速度が基準値を越える時だけ優先的な下降制御が実行され、苗植付け装置４が下降方向へ変化する速度が基準値を越えても優先的な上昇制御を行わない簡易な形態で実施することもできる。

（２）地面に対する作業装置の対地高さを超音波センサなどで非接触式に検出するとともに、その検出値を微分処理して作業装置の対地高さが変化する速度を演算する形態で実施することもできる。

（３）本発明は、走行機体３の後部に作業装置としてのロータリ耕耘装置を昇降自在に連結して、ロータリ耕耘装置を圃場面に対して設定高さに安定維持する農用トラクタの昇降制御（自動耕深制御）や、走行機体３の前部に作業装置としての刈取り部を昇降自在に連して、刈取り部を圃場面に対して設定高さに維持するコンバインの昇降制御（自動刈高さ制御）に適用することもできる。

乗用型田植機の全体側面図 自動昇降制御の第１例を示すブロック図 自動昇降制御の第１例における作動を示すフロー図 自動昇降制御の第２例を示すブロック図 自動昇降制御の第２例における作動を示すフロー図 自動昇降制御の第３例を示すブロック図 自動昇降制御の第３例における作動を示すフロー図 自動昇降制御の第４例を示すブロック図 自動昇降制御の第４例における作動を示すフロー図

符号の説明

３ 走行機体
４ 作業装置
５ 昇降駆動機構
２１ 角度センサ
３３ 角速度センサ
θ 検出値
ω 角速度（変化速度）
ｖ 昇降速度（変化速度）

Claims (7)

1. 走行機体に昇降自在に連結した作業装置の昇降駆動機構、検出された対地高さ情報に基づいて作動制御して、前記作業装置の対地高さを設定高さに維持するように構成した農作業機の昇降制御装置であって、
   前記作業装置の対地高さを検出する高さ検出手段からの検出値と、この検出値を微分して得られる変化速度とを、前記昇降駆動機構を作動制御する前記対地高さ情報としてあることを特徴とする農作業機の昇降制御装置。
2. 演算された前記変化速度が設定範囲を越える作業装置上昇方向への変化であると、下降指令が優先して出力されるよう構成してある請求項１記載の農作業機の昇降制御装置。
3. 前記高さ検出手段を、前記作業装置に接地追従可能に支持された接地体の揺動角度を前記検出値として検出する角度センサで構成してある請求項１または２記載の農作業機の昇降制御装置。
4. 走行機体に昇降自在に連結した作業装置の昇降駆動機構を、検出された対地高さ情報に基づいて作動制御して、前記作業装置の対地高さを設定高さに維持するように構成した農作業機の昇降制御装置であって、
   前記作業装置に接地追従可能に支持された接地体の揺動角度を検出する角度センサと、前記接地体の揺動速度を検出する角速度センサとを備え、これら角度センサの検出情報と角速度センサの検出情報とを、前記昇降駆動機構を作動制御する前記対地高さ情報としてあることを特徴とする農作業機の昇降制御装置。
5. 前記角速度センサで検出された角速度が設定範囲を越える上昇方向作動であると、下降指令が優先して出力されるよう構成してある請求項４記載の農作業機の昇降制御装置。
6. 走行機体に昇降自在に連結した作業装置の昇降駆動機構を、検出された対地高さ情報に基づいて作動制御して、前記作業装置の対地高さを設定高さに維持するように構成した農作業機の昇降制御装置であって、
   前記作業装置に接地追従可能に支持された接地体の揺動角度を検出する角度センサを備えるとともに、前記作業装置の昇降速度を検出する昇降速度検知手段を備え、これら角度センサの検出情報と前記昇降速度検知手段の検出情報とを、前記昇降駆動機構を作動制御する対地高さ情報としてあることを特徴とする農作業機の昇降制御装置。
7. 前記昇降速度検知手段で検出された上昇方向の昇降速度が設定範囲を越えると、下降指令が優先して出力されるよう構成してある請求項６記載の農作業機の昇降制御装置。

Images