JPH0215171B2 - - Google Patents

Description

【発明の詳細な説明】 ＜発明の関連する技術分野＞ この発明はコンバインにおける刈取り部の高さ
を超音波センサ等の非接触距離センサを用いて測
定し、その測定高さに基づいて刈高さを自動的に
制御する刈高さ制御方法に関する。

＜従来技術とその欠点＞ 刈高さ自動制御を行うために使用する距離セン
サとしては、通常、大地と接触するアクチユエー
タを用いた接触型距離センサ、または超音波発振
器および受信器を用いた超音波距離センサ等の非
接触距離センサが使用される。しかし接触型の距
離センサは、機体の傾斜が急に大きくなつたとき
等にアクチユエータを破損する恐れがあり、さら
に湿田ではアクチユエータが埋没して使えなくな
ることがあるために、信頼性、安定性等の見地か
ら超音波センサ等の非接触距離センサが使用され
るようになつてきている。

このような非接触距離センサを用いた従来の刈
高さ制御方法は、予め設定した基準高さと一定周
期毎に測定した高さデータとを比較し、その差に
応じて一定の速度で刈取り部を上下動させるよう
にしていた。

しかし、例えば大地上の柔らかい藁に対して超
音波が発射されたり、或いは切株の中にデバイダ
が割つて株間に超音波が発射されたりすると受信
信号が大きく低下するために、センサが正常であ
るにもかかわらず正確な測定が出来なくなつて、
その結果刈取り部の無駄な上下動作を行わせる欠
点があつた。

＜発明の目的＞ この発明の目的は、測定高さデータが異常であ
る場合には刈取り部が動作しないようにする一
方、測定高さデータの異常状態がセンサ異常に基
づく可能性が高いときにはセンサ異常報知を行
う、非接触距離センサを用いた刈高さ制御方法を
提供することにある。

＜発明の構成および効果＞ この発明は、要約すれば、複数の測定高さデー
タから測定平均高さデータを求め、この測定平均
高さデータと目標高さデータとの偏差に基づいて
刈高さ制御を行う制御方法であつて、 測定高さデータが一定値以上であるとき、その
データを無効データとして捨てるとともに、無効
データ連続発生回数を計数する無効データ計数器
の内容をカウントアツプし、その計数内容が所定
の大きさに達したとき非接触距離センサの異常を
報知するようにしたものである。

この発明によれば、大地上の藁や切株等によつ
て測定データが異常になればそのデータを無効に
するために刈取り部の異常動作を防止することが
出来る。また無効データ連続発生回数を計数する
無効データ計数器の内容が所定値に達したとき、
すなわち異常データが一定回数連続したときにだ
けセンサ異常の報知を行うようにしているため、
ほぼ確実にセンサの異常があると考えられるとき
にだけ異常報知を行うことになり、センサの動作
管理に対する確実性を高めることが出来る。

＜実施例の説明＞ 第１図はこの発明の方法を実施する刈高さ制御
装置のブロツク図である。

同図において、超音波センサ（以下U.S.S.とい
う）制御回路１は、60ミリ秒毎に送信器２を駆動
し、バースト信号を発射する。受信器３は反射波
を受信して、U.S.S.制御回路１に受信信号を送
る。このときの受信信号は負論理のパルスであつ
て、パルス幅は送信後に受信する迄の時間、すな
わち刈取り部の高さに対応している。受信信号が
送信後所定時間経過しても無い場合には、U.S.S.
制御回路１は強制的にパルスを立ち上がらせる。
この時間は14ミリ秒に設定されている。受信信号
は波形整形後受信パルスとして他方の入力端子が
接地されたイクスクルーシブオアゲート４に導か
れる。このイクスクルーシブオアゲート４の出力
から、イクスククルーシブオアゲート５とＲ１，
Ｃ１とで構成される微分回路によつて微分パルス
が形成され、さらにイクスクルーシブオアゲート
６を介してマイクロコンピユータ７の割り込みポ
ートIRQに導かれる。また、前記イクスクルーシ
ブオアゲート４の出力はマイクロコンピユータ７
の入力ポートＲ１１に導かれる。この入力ポート
Ｒ１１は、ポートIRQに入力した割り込みパルス
がU.S.S.制御回路１に基づくものであるかどうか
を判定するための信号として使用される。イクス
クルーシブオアゲート６の入力端子には、前記イ
クスクルーシブオアゲート５の出力端子とともに
ダイナモからの信号を波形整形する波形整形回路
８の出力端子が接続されている。マイクロコンピ
ユータ７はこの波形整形回路８からの割り込み信
号によつて、エンジンの回転数を測定する。

マイクロコンピユータ７のポートＲ１０には、
刈高さ微調整器VRの出力端子が接続されてい
る。マイクロコンピユータ７は、Ａ／Ｄ変換器を
内蔵し、ポートＲ１０を介して上記刈高さ微調整
器から得られたアナログデータをデジタル量に変
換して刈高さ制御のためのデータを得るようにし
ている。

マイクロコンピユータ７は、刈高さ制御プログ
ラムを記憶するROM、および予め設定したデー
タ類を記憶し、さらにフラグ類や各種ワークエリ
アを有するRAMを内蔵している。第２図に
RAMの構成図を示す。領域A1は４種類のフラグ
領域を含んでいる。フラグＦ０は刈取り部上昇フ
ラグ、フラグＦ１は刈取り部下降フラグ、フラグ
Ｆ２はエンジン回転数計測処理時にポートＲ１０
の入力パルスが立ち上がり、または立ち下がつた
場合、今回の測定データを無効にするためのデー
タ無効フラグ、フラグＦ３は高さデータ更新フラ
グである。領域A2は測定平均高さを記憶する。
すなわち過去の測定した高さデータの平均高さデ
ータを記憶する。平均の対象となるデータは、前
回に平均して得られた高さデータと過去７回のそ
れぞれの測定データとの合計８個のデータ、また
は前回に平均して得られた高さデータと過去１回
の測定データとの合計２個のデータである。この
区別は後述のように今回の測定データが一定以上
の高さであるか否かで決定される。領域A3は、
前回に測定した高さデータを記憶する。領域A4
は前前回に測定した高さデータを記憶する。同様
に、領域A5〜A9は、前前回以前の測定高さデー
タを新しい順に５個記憶する。領域A10は刈高さ
微調整器VRによつて設定された微調整高さデー
タを記憶する。領域A11は予め設定された目標高
さデータを記憶する。領域A12は領域A2の平均
高さデータと、領域A11の目標高さデータに領域
A10の微調整高さデータを加えた値との差、すな
わち偏差を記憶する。領域A13は、領域A2にス
トアする平均高さデータを算出するのに８個のデ
ータを用いるか、２個のデータを用いるかを決め
る基準高さを記憶する。後述するように、測定し
たデータがこの高さより小さければ、領域A2〜
A9の８個のデータから平均高さデータを求める
一方、測定データがH0以上である場合には領域
A2とA3とに記憶されている２個のデータのみか
ら平均高さデータを求めるようにする。この基準
高さH0は522ミリメータである。領域A14は、算
出した平均高さデータに基づき、刈取り部上下移
動用電磁弁に対して間欠駆動パルスを与えるか、
連続駆動パルスを与えるかの基準高さを記憶す
る。算出した平均高さデータHaがこの基準高さ
H1以上であれば、連続パルスを与える。反対に
平均高さデータHaがこの基準高さデータH1より
小さければ間欠パルスを与える。領域A15は、領
域A12の偏差に対応する駆動パルスのオンタイム
時間を予め決めてある領域A19のテーブルに基づ
き、今回の電磁弁のオン、オフのデユーテイ比を
記憶する。第３図に示すように、偏差が260ミリ
メータ以下であるときには偏差の大きさに応じて
オンタイムが長くなる間欠パルスが与えられる。
なおオフタイムは150ミリ秒の固定値に設定され
ている。したがつて、例えば、偏差が21ミリであ
ればデユーテイ比は16分の１である。領域A16は
後述するセンシングエラーカウンタを構成する。
このカウンタはセンサが正常であるにかかわらず
送信後所定時間（６ミリ秒）経過しても受信出来
ないときにインクリメントされ、所定時間（６ミ
リ秒）経過内に受信した場合にデクリメントされ
る16進のアツプダウンカウンタである。領域A17
は、ダイナモからの割り込みによつて計算された
エンジン回転数を記憶する。領域A18は刈高さ制
御の基準サイクルである10ミリ秒を記憶する。領
域A19は、前述のように偏差と駆動パルスのオン
タイムの関係を表すテーブルを記憶する（第３図
参照）。

次に以上の構成からなる刈高さ制御装置の動作
を第４図Ａ〜Ｄのフローチヤートを参照して説明
する。

第４図Ａは刈高さ制御を行うためのメインルー
チンのフローチヤートである。

ステツプn1（以下ステツプniを単にniという）
は、各種レジスタ、フラグ類の初期設定を行う。
n2はフラグＦ３のセツト状態をチエツクする。
このフラグＦ３がセツトされるのは、後述のよう
にU.S.S.制御回路１からの受信パルスによつて割
り込みがあつたときである。フラグＦ３がセツト
されていれば、n3へ進んでフラグＦ３をリセツ
トし、さらにn4へ進んで高さデータ更新サブル
ーチンへ進む。この高さデータ更新サブルーチン
において、領域A2の平均高さデータHaが求めら
れるとともに、領域A3〜A9のデータおよびA16
のセンシングエラーカウンタがアツプデートされ
る。続いてn5へ進み、刈高さ制御サブルーチン
を実行する。この刈高さ制御サブルーチンでは、
n4の高さデータ更新サブルーチンで求めた平均
高さデータに基づいて、電磁弁の駆動パルスのデ
ユーテイ比を決定し、刈取り部の上下駆動制御を
行う。n6はセンシングエラーカウンタのカウン
タ値の判定ステツプである。もし、このカウンタ
値がオーバーフローしていれば、すなわち測定し
た高さデータが一定の大きさ以上である場合が16
回連続したときには、n7においてU.S.S.不良のア
ラームを駆動する。センシングエラーカウンタが
オーバーフロー状態でなければ、n6→n8へと進
む。n8において基準サイクルがタイムアツプす
れば、n2へ戻つて再度フラグＦ３の状態を判定
する。以上のようにして高さデータ更新、刈高さ
制御、およびセンシングエラーカウンタのチエツ
クを基準サイクル毎に実行していく。

前記メインルーチンにおいて、n2→n3へと進
む場合は、前述のようにU.S.S.制御回路１から割
り込みがあつたときである。割り込みにはこの
U.S.S.制御回路１からの割り込みと、さらに時計
割り込みおよびダイナモからの割り込みの３種類
がある。第４図Ｂに割り込みがあつたときに実行
される割り込みルーチンを示す。

U.S.S.制御回路１、ダイナモまたは内部時計の
割り込みがあつたときは最初にn10において各種
レジスタの内容を退避する。割り込みが時計割り
込みである場合はn11→n12へ進み、そうでない
場合はn11→n13へと進む。n13においては、マイ
クロコンピユータ７のポートＲ１１の信号状態を
チエツクする。そしてU.S.S.制御回路出力の立ち
下がりであればその割り込みは受信パルスの初め
にあつてものであるから、高さデータを測定する
内部タイマデータを初期化し（n14）、さらにn15
において同タイマを起動する。一方、割り込みが
U.S.S.制御回路出力の立ち上がりのときに行われ
たものであれば、n13→n17→n18へと進み、n15
において起動した内部タイマを停止させ、さらに
n19においてフラグＦ３をセツトする。そして
n20でレジスタの内容を復帰させてメインルーチ
ンへと戻る。以上の動作により、内部タイマは刈
取り部の高さに比例する受信パルスのパルス幅を
記憶することになる。すなわち、内部タイマデー
タは、通常の場合測定高さに対応することにな
る。所定時間（６ミリ秒）内に受信信号が来なか
つた場合には、この内部タイマデータはオーバー
フローしている。このオーバーフロー状態は後述
の高さデータ更新サブルーチンでチエツクされ、
オーバーフローしているときにはそのデータは無
効データとして捨てられる。なお、割り込みがエ
ンジンのダイナモから行われたものであれば、
n17→n21へと進み、ここでエンジン回転数の計
測処理を行う。さらにこの場合には、エンジン回
転数計測処理を行つたときにポートＲ１１にU.S.
S.制御回路出力の立ち下がりまたは立ち上がりタ
イミングが来るときであるので、この場合には次
回の測定高さデータに誤差が生じることにあるか
ら、n24においてデータ無効フラグＦ２をセツト
する。したがつて今回の測定高さデータは、フラ
グＦ２がセツトされているために後述するように
無効データとして捨てられる。

上記のようにn19においてフラグＦ３がセツト
されると、メインルーチンにおいてn2→n3→n4
へと進んで、高さデータ更新サブルーチンが実行
される。

第４図Ｃはこの高さデータ更新サブルーチンの
フローチヤートである。

まずn30において、センサ無効フラグＦ２の状
態を判定する。前述のようにエンジン回転数計測
処理を行つたときにU.S.S.制御回路出力の立ち上
がりまたは立ち下がりのタイミングが一致すれ
ば、n24においてデータ無効フラグＦ２がセツト
される。このため、次にこの高さデータ更新サブ
ルーチンが実行されると、n30→n38へと進み、
このサブルーチンが実行されずにメインルーチン
にリターンする。すなわち高さデータは更新され
なくなる。データ無効フラグＦ２がセツトされて
いないときは、次にn31へ進み、内部タイマがオ
ーバーフローしているかどうかを判定する。内部
タイマは８ビツトで構成され、最大スケールで
1044ミリメータまで計測可能となるようにクロツ
クのパルス幅が決定されている。したがつて内部
タイマがオーバーフローするのは、測定データが
1044ミリメータ以上になつたときである。この状
態は実際には上述しやように、送信後６ミリ秒以
内に受信信号が無かつたときに対応する。この場
合はn39へと進み、領域A16のセンシングエラー
カウンタをインクリメントしてメインルーチンへ
リターンする。内部タイマがオーバーフローをし
ていない場合は、n32へ進み、内部タイマデー
タ、すなわち測定高さデータを領域A3のHnにス
トアする。続いてそのストアされた測定高さデー
タを領域A13の所定の基準高さデータH0とを比
較する。データHnがデータH0より大きい場合に
はn34を実行する。またそうでない場合には、
n35を実行する。n34においては、前回に算出し
た領域A2の平均高さデータHaと前回に測定した
測定高さデータHnとの２個のデータの平均値を
今回の平均高さデータHaとして算出する。n35に
おいては、前回算出した平均高さデータHaとデ
ータHnからデータHn−６までの過去７回の測定
データとの平均値を今回の平均高さデータHaと
する。すなわち、今回の測定データが基準高さデ
ータH0以上である場合には２個のデータの平均
を取り、データHnがデータH0より小さい場合に
は８個のデータの平均を取るようにしている。刈
取り部の高さが非常に高い状態から適当な間隔で
サンプリングしながら測定データを得る場合、平
均高さデータを求めるために使用するデータが多
くなると古いデータの重みが大きくなつて実際の
高さと平均高さデータの差が大きくなる。このた
めにオーバシユートが生じやすくなる。一方、刈
取り部の高さが比較的高くない状態から目標高さ
に接近する場合においては、平均高さデータを求
めるのに多くの測定データを用いても、古いデー
タの重みが大きくならず、むしろ平均高さデータ
の変動がなくなつて安定性を増す。したがつて、
このように今回の測定データが一定の基準高さデ
ータ以上である場合にはn34において２個のデー
タのみの平均を取り、同測定高さデータが同基準
高さデータよりも小さい場合に８個のデータの平
均を取るようにすることによつて、オーバーシユ
ートの防止と目標高さ付近での刈取り部の安定性
を実現することが出来る。以上のn34またはn35
において平均高さデータHaを領域A2にストアす
ると、続いてn36において領域A4〜A9のデータ
を一つずつ古いデータに更新する。さらにn31に
おいて測定データが一定の高さ以下であつたか
ら、センシングエラーカウンタをデクリメント
し、メインルーチンへ戻る。こうして高さデータ
更新サブルーチンでは、次に刈高さ制御を行うた
めの参照データとなる平均高さデータHaを求め
る動作をする。

メインルーチンのn4において高さデータ更新
サブルーチンを実行すると、次に刈高さ制御サブ
ルーチンを実行する。第４図Ｄはこの刈高さ制御
サブルーチンのフローチヤートである。

まずn40において、刈高さ微調整器VRの設定
位置のデータを領域A10のΔHにストアする。領
域A11に予め設定されている目標高さデータにこ
のΔHのデータを加算し、その加算結果を上記刈
高さデータ更新サブルーチンで求めた平均高さデ
ータから差し引く。そしてその減算結果を偏差と
して領域A12にストアする。その偏差が正である
場合、刈取り部下降フラグＦ１をセツトし、負で
ある場合刈取り部上昇フラグＦ０をセツトする
（n43、n44）。続いてn41で求めた偏差に基づき、
第３図に示すテーブルから電磁弁駆動パルスのオ
ンタイム時間、すなわちデユーテイ比を決定する
（n45）。n46では偏差が不感帯幅、すなわち０〜
20.4ミリメータ以内にあるかどうかを判定する。
もし、その不感帯幅内にある場合には、n56へ移
つて電磁弁をオフして終了する。偏差が不感帯幅
を越える場合にはn47でその偏差が領域A14に記
憶する基準高さデータH1より大きいか小さいか
を判定する。この基準高さデータH1は、261ミリ
メータに設定されている。第３図のテーブルに示
すように、偏差が261ミリメータ以上である場合
にはオンタイムは連続となり、それより小さい場
合には電磁弁の駆動パルスが間欠パルスとなる。
したがつてn44で偏差が基準高さデータH1より大
きい場合には、n48、n49においてフラグＲ０，
Ｆ１をチエツクし、フラグＦ０がセツト状態であ
れば刈取り部を連続上昇させ、フラグＦ１がセツ
ト状態であれば刈取り部を連続下降させる。ま
た、偏差が基準高さデータH1より小さければ、
n52、n53でフラグＦ０，Ｆ１の状態をチエツク
し、フラグＦ０がセツト状態にあれば刈取り部を
間欠上昇させ（n54）、フラグＦ１がセツト状態
であれば刈取り部を間欠下降させる（n55）。こ
の場合の刈取り部の間欠駆動に対する駆動パルス
のデユーテイ比は第３図のテーブルに示すよう
に、偏差に対応するオンタイムの時間長さによつ
て決定される。こうして偏差が基準高さデータ
H1よりも大きい場合には、刈取り部を連続上昇、
または連続下降させ、次のサンプル時において基
準高さデータH1より小さくなればその偏差の大
きさに応じて間欠下降または間欠上昇させ、以下
サンプル毎に得られる偏差の大きさに応じて適正
なデユーテイ比の駆動パルスによつて刈取り部を
目標高さに接近させることが出来る。なお、n24
においてフラグＦ２がセツトされた場合、または
n18で内部タイマが停止したときそのタイマがオ
ーバーフローしているときは高さデータ更新サブ
ルーチンが実行されないために、刈取り部の上下
動作もないことになる。

以上の動作によつて、測定高さデータの大きさ
が1044ミリメータを越える場合、すなわち内部タ
イマがオーバーフローした場合にはそのデータを
無効にするとともに、無効データ計数器であるセ
ンシングエラーカウンタをカウントアツプし、ま
たデータが1044ミリメータ以下のときはそのデー
タを有効としてセンシングエラーカウンタをカウ
ントダウンするとともに、そのカウント値が16に
なつたときにだけ、すなわち異常データが16回連
続したときにだけセンサ異常を報知することが出
来る。

【図面の簡単な説明】

第１図はこの発明を実施する刈高さ制御装置の
ブロツク図である。第２図は同制御装置のマイク
ロコンピユータに含まれるRAMの構成図であ
る。第３図は同RAMに記憶されるテーブルの内
容を示す図である。第４図Ａ〜Ｄは同制御装置の
動作を示すフローチヤートである。 １……超音波センサ制御回路、２……送信器、
３……受信器、７……マイクロコンピユータ。

Claims (1)

1. 【特許請求の範囲】 １ 一定周期で駆動される非接触距離センサの出
   力に基づく測定高さデータを前記非接触距離セン
   サの駆動毎に測定順に一定個数記憶して測定平均
   高さを求め、この測定平均高さと予め設定された
   目標高さデータとを比較して偏差を求めるととも
   に、その偏差の大きさに応じて刈高さを制御する
   刈高さ制御方法であつて、 前記測定高さデータが一定値以上であるとき、
   そのデータを無効データとして捨てるとともに無
   効データ連続発生回数を計数する無効データ計数
   器の内容をカウントアツプし、前記無効データ計
   数器の計数内容が所定の計数値に達したとき非接
   触距離センサの異常報知を行うことを特徴とす
   る、非接触距離センサを用いた刈高さ制御方法。