JP4168536B2

JP4168536B2 - 回転速度検出方法及び装置

Info

Publication number: JP4168536B2
Application number: JP20936399A
Authority: JP
Inventors: 和男石川; 浩之谷口
Original assignee: Toyota Industries Corp
Current assignee: Toyota Industries Corp
Priority date: 1999-07-23
Filing date: 1999-07-23
Publication date: 2008-10-22
Anticipated expiration: 2019-07-23
Also published as: JP2001033473A

Description

【０００１】
【発明の属する技術分野】
本発明は、回転軸の周方向に沿って該回転軸と一体回転可能に一定ピッチで形成された被検出部をセンサで検出し、該被検出部を検出する毎にセンサから出力されるパルス信号の入力に基づく割込み処理により、演算手段で回転速度の演算を行って回転軸の回転速度を検出する回転速度検出方法及び装置に関するものである。
【０００２】
【従来の技術】
一般に、コンピュータの中央処理装置（以下、ＣＰＵという）においては、割込みシステムが採用されていて、割込み要求があるとプログラムを中断し，後からそのプログラムを続行することのできるように構成されている。この割込みは，プログラムカウンターや他のレジスターの内容を待避させたり、それらを保存域に記憶し，新しい命令シーケンスを始めることにより達成され、そして新しいシーケンスの実行後、プログラムカウンターやレジスターを元のプログラムへロードし、復活させ再び割込み可能な状態にする。従って、ＣＰＵは、割込み要求があると、それを受け取って保持しておき、適当なプログラムを呼び出すことによってその要求に応答する割込み処理を実行しなければならない。
【０００３】
例えば、車速を検出し、検出された車速に基づいてコンピュータによる制御下に所定の走行制御を行うような場合、車速は車軸と連動して回転する回転軸の回転速度から演算される。回転軸の回転速度を検出する場合は、回転軸に設けられた歯車状部材に近接して磁気ピックアップからなるセンサを配設し、歯車状部材の歯がセンサの前を通過する毎に該センサが入力インターフェースを介してＣＰＵにパルス信号を送り、ＣＰＵがパルス信号間の時間間隔から回転速度を算出するようになっている。また、一定時間内に発生したパルス数から回転速度を計算することもある。
【０００４】
【発明が解決しようとする課題】
前者の場合、特に低速での検出精度を上げるためには、歯車状部材の歯数を増す必要がある。例えば、フォークリフトの走行制御で極低速から車速を検出したい場合、車速検出用歯車ではタイヤ１回転でパルスが８５０回も発生するようになっている。そして、最高速では１秒間に数千回のパルス信号がＣＰＵに入力されるため、割込み要求が頻繁に入ることになり、それだけＣＰＵの負荷が増し、本来のプログラムの迅速な実行に支障をきたすだけでなく、高速回転では精度が低下することになる。また、一定時間内に発生したパルス数から回転速度を計算する後者の場合には、低回転速度で精度が低下する。
【０００５】
精度低下の理由は、ＣＰＵで使用するクロックに比べてパルス間の時間が短くなることによる。例えば、低回転速度で１パルスを１００００クロックでカウントすれば、精度は０．０１％であり、高回転速度で１パルスを１００クロックでカウントすれば、精度は１％に低下してしまう。
【０００６】
本発明は前記問題点に鑑みてなされたものであってその目的は、高速回転の際にもＣＰＵの負荷を実質的に増すことなく、精度よく回転速度の検出が可能な回転速度検出方法及び装置を提供することである。
【０００７】
【課題を解決するための手段】
前記目的を達成するため、請求項１に記載の発明では、回転軸の周方向に沿って該回転軸と一体回転可能に一定ピッチで形成された被検出部をセンサで検出し、前記被検出部を検出する毎に前記センサから出力されるパルス信号の入力に基づく割込み処理により、演算手段で回転速度の演算を行って前記回転軸の回転速度を検出する回転速度検出方法において、所定周期毎にパルス信号による割込みを許可すると共に、割込み許可の状態において１回目のパルス信号が入力されると次の割込み許可の時期になるまで前記パルス信号による割込みを不許可とし、前記１回目のパルス信号が入力された時から次の割込み許可後の最初のパルス信号が入力されるまでの経過時間を計測し、前記経過時間とその間に入力されたパルス数に基づいて前記回転軸の回転速度を演算し、前記演算手段には、該演算手段とは別に設けられるカウンタを介してパルス信号が入力されるよう構成され、前記カウンタは前記経過時間の間に入力されるパルス数をカウントするよう構成されており、前記パルス信号による割込み不許可の状態では、前記演算手段にてパルス信号を入力しても前記割込み処理は行われず、前記カウンタにて前記パルス数がカウントされ、前記パルス信号による割込み許可の状態では、前記割込み処理により、前記演算手段で前記経過時間と前記カウンタにてカウントされた前記パルス数に基づいて前記回転軸の回転速度が演算される。
【０００８】
また、請求項２に記載の発明では、回転軸の周方向に該回転軸と一体回転可能に一定ピッチで形成された被検出部を検出する毎にパルス信号を出力するセンサと、前記パルス信号の入力に基づく割込み処理により回転速度の演算を行う演算手段と、前記パルス信号の割込みを所定周期で許可すると共に、割込み許可の状態において１回目のパルス信号が入力されると次の割込み許可の時期になるまで前記パルス信号による割込みを不許可とする制御手段と、前記１回目のパルス信号が入力された時から次の割込み許可後の最初のパルス信号が入力されるまでの経過時間を計測する計測手段と、前記経過時間内に前記センサから出力されたパルス数をカウントするカウンタと備え、前記演算手段には、該演算手段とは別に設けられる前記カウンタを介してパルス信号が入力されるよう構成されており、前記パルス信号による割込み不許可の状態では、前記演算手段にてパルス信号を入力しても前記割込み処理は行われず、前記カウンタにて前記パルス数がカウントされ、前記パルス信号による割込み許可の状態では、前記割込み処理により、前記演算手段で前記経過時間と前記カウンタにてカウントされた前記パルス数に基づいて前記回転軸の回転速度が演算される。
【０００９】
請求項３に記載の発明では、請求項２に記載の発明において、前記所定周期は前記演算手段のメインプログラムの実行周期より短く設定されている。
従って、請求項１に記載の発明では、センサが回転軸に一定ピッチで形成された被検出部を検出する毎にパルス信号が出力される。演算手段へのパルス信号による割込みは所定周期毎に許可される。割込み許可の状態において１回目のパルス信号が入力されると次の割込み許可の時期になるまで前記パルス信号による割込みが不許可となる。１回目のパルス信号が入力された時から次の割込み許可後の最初のパルス信号が入力されるまでの経過時間が計測され、前記経過時間とその間に入力されたパルス数に基づいて回転軸の回転速度が演算される。
【００１０】
請求項２に記載の発明では、演算手段において前記センサから出力されるパルス信号の入力に基づく割込み処理により回転速度の演算が行われる。制御手段により前記パルス信号の割込みが所定周期で許可されると共に、割込み許可の状態において１回目のパルス信号が入力されると次の割込み許可の時期になるまで前記パルス信号による割込みが不許可となる。１回目のパルス信号が入力された時から次の割込み許可後の最初のパルス信号が入力されるまでの経過時間が計測手段によって計測される。前記経過時間内に前記センサから出力されたパルス数がカウンタによってカウントされる。
【００１１】
請求項３に記載の発明では、請求項２に記載の発明において、所定周期が演算手段のメインプログラムの実行周期より短く設定されているため、各実行周期に新しいデータの使用が可能になる。
【００１２】
【発明の実施の形態】
次に、添付図面を参照して、産業車両としてのフォークリフトに適用した一実施の形態について説明するが、図中、同一符号は同一又は対応部分を示すものとする。
【００１３】
図１に示すように、エンジン１の出力軸１ａは、トルクコンバータ２を備えた変速装置３の入力軸３ａに連結され、変速装置３の出力軸３ｂは差動装置４を介して駆動輪５ａを有する車軸５に連結されている。車軸５には常用ブレーキ６が設けられている。エンジン１にはスロットルアクチュエータ７が設けられ、このスロットルアクチュエータ７の作動によってスロットル開度が調整されて、エンジン１の回転数、即ちエンジン１の出力軸１ａの回転数が調節される。
【００１４】
変速装置３は、前述したように入力軸３ａ及び出力軸３ｂを備え、入力軸３ａには、トルクコンバータ２に加え前進クラッチ８及び後進クラッチ９が設けられている。前進クラッチ８及び後進クラッチ９と出力軸３ｂとの間には図示しない歯車列がそれぞれ設けられ、各クラッチ８，９及び各歯車列を介して入力軸３ａの回転が出力軸３ｂに伝達される。両クラッチ８，９には油圧式のクラッチ、この実施形態では湿式多板クラッチが使用され、受圧室８ａ，９ａ内の油圧力によって各クラッチディスクの接続力が調整可能に、例えば受圧室８ａ，９ａ内の油圧力を高めると接続力が大きくなるように構成されている。
【００１５】
前進クラッチ８及び後進クラッチ９においては、前進クラッチバルブ１０及び後進クラッチバルブ１１を介して供給される油圧により受圧室８ａ，９ａ内の油圧力がそれぞれ制御されるようになっている。前進クラッチバルブ１０及び後進クラッチバルブ１１は、ソレノイドへの通電量に比例した開度となる圧力制御比例電磁弁で構成されている。
【００１６】
変速装置３内には、駐車ブレーキ１２が出力軸３ｂに接続されて組み込まれている。駐車ブレーキ１２は出力軸３ｂと一体回転するディスク１２ａと、出力軸３ｂに対して回転不能かつスラスト方向に移動可能に設けられたブレーキパッド１２ｂとを備えている。ブレーキパッド１２ｂは図示しないばねのばね力によりディスク１２ａに圧接される方向に付勢されて制動のための係合圧を発生させ、ブレーキ用バルブ１３を介して受圧室１２ｃに供給される油圧により制動状態が解除されるように構成されている。
【００１７】
図１ではトルクコンバータ２、変速装置３及び各バルブ１０，１１，１３が独立して図示されているが、これら各装置は一つのハウジング内に組み込まれて、自動変速機を構成している。そして、自動変速機には図示しない油圧ポンプが組み込まれ、その油圧ポンプの吐出油が図示しない流路及び各バルブ１０，１１，１３を介して各受圧室８ａ，９ａ，１２ｃに供給可能に構成されている。前記油圧ポンプはエンジン１の回転時に変速装置３に伝達される回転力により駆動されるようになっている。
【００１８】
エンジン１の出力軸１ａには被検出部として歯車１４が一体回転可能に設けられ、磁気ピックアップからなるエンジン回転数センサ１５により出力軸１ａの回転数が検出される。エンジン回転数センサ１５は出力軸１ａの回転数に比例したパルス信号を出力する。また、変速装置３の出力軸３ｂには被検出部として歯車１６が一体回転可能に設けられ、磁気ピックアップからなる車速センサ１７により出力軸３ｂの回転数が検出される。車速センサ１７は出力軸３ｂの回転数に比例したパルス信号を出力する。各歯車１４，１６は、その周囲に被検出部を構成する多数の歯１４ａ，１６ａを有し、出力軸１ａ，３ｂの回転に伴い歯１４ａ，１６ａがセンサ１５，１７の前を通過する毎に、センサ１５，１７が上述のパルス信号を出力する。
【００１９】
エンジン１により駆動される荷役用の油圧ポンプ１８の吐出側に、フォーク１９を昇降させるリフトシリンダ２０及びマスト２１を傾動させる図示しないティルトシリンダが、図示しない管路等を介して接続されている。
【００２０】
運転室の床にはアクセルペダル２３と、インチングペダル２４と、ブレーキペダル２５とが設けられている。インチングペダル２４は荷役作業を行いながらフォークリフトの微速走行をマニュアル操作で行う際に、クラッチを半接続状態（半クラッチ状態）にするために使用するものである。そして、ブレーキペダル２５を操作する（踏み込む）ときは、ブレーキペダル２５はインチングペダル２４と独立して作動するが、インチングペダル２４を操作する（踏み込む）ときは、途中からインチングペダル２４とブレーキペダル２５とが連動可能に構成されている。即ち、インチングペダル２４は、インチング位置に達するまで及びインチング位置においてはブレーキペダル２５と独立して移動（操作）されるが、インチング位置を過ぎるとブレーキペダル２５がインチングペダル２４と一体に移動するようになっている。
【００２１】
アクセルペダル２３が操作されたか否かを検出するアクセルセンサ２６は、アクセルペダル２３の操作量に比例した検出信号を出力する。インチングペダル２４がインチング位置にあるか否かはインチングスイッチ２７により検出され、ブレーキペダル２５が操作されたか否かはブレーキスイッチ２８により検出される。
【００２２】
図示しない運転室の前部には、シフトレバー２９が設けられている。シフトレバー２９の位置を検知するシフトスイッチ３０は、シフトレバー２９が前進位置、後進位置及び中立位置のいずれにあるかを検知し、各位置に対応する信号を出力する。また、運転室には、図示しないが、前述したリフトシリンダ２０を操作するための荷役レバーが配置されており、この荷役レバーの操作量は荷役操作量センサにより検知される。
【００２３】
次に、前述したスロットルアクチュエータ７、前進クラッチバルブ１０、後進クラッチバルブ１１及びブレーキ用バルブ１３等を駆動制御したり、エンジン回転数センサ１５や車速センサ１７に基づき回転速度を検出するための電気的構成について説明する。
【００２４】
この駆動制御や回転速度検出のための制御装置３１は、演算手段、制御手段及び計測手段としての中央処理装置（ＣＰＵ）３２、読出し専用メモリ（ＲＯＭ）３３及び読出し及び書替え可能なメモリ（ＲＡＭ）３４に加え、入力インターフェース３５及び出力インターフェース３６を備えている。また、制御装置３１はカウンタとしての計数回路３７，３８を備えている。計数回路３７はエンジン回転数センサ１５から出力されたパルス信号をカウントし、計数回路３８は車速センサ１７から出力されたパルス信号をカウントする。
【００２５】
ＲＯＭ３３には、通常走行時に進行方向側のクラッチを完全係合状態としてアクセルペダル２３の操作量に対応した目標エンジン回転数に制御するプログラム、荷役走行時に荷役レバーの操作量に基づいて設定した目標エンジン回転数に制御し、かつ進行側のクラッチ圧力を調整してアクセルレバー２３の操作量に対応した目標車速となるようにクラッチの係合圧力を制御するプログラム、駐車ブレーキ１２の作動時期設定プログラム、本発明に従って車速もしくは回転速度を演算するのためのプログラム等の所定の制御プログラムに加え、同制御プログラムを実行する際に必要な各種データ等が記憶されている。ＲＡＭ３４にはＣＰＵ３２の演算結果等が一時記憶される。ＣＰＵ３２はＲＯＭ３３に記憶された諸制御プログラムに基づいて作動する。
【００２６】
ＣＰＵ３２は、エンジン回転数センサ１５に接続された計数回路３７、車速センサ１７に接続された計数回路３８、インチングスイッチ２７、ブレーキスイッチ２８及びシフトスイッチ３０の出力信号を入力インターフェース３５を介して入力するように接続されている。アクセルセンサ２６は図示しないＡ／Ｄ変換器及びを介してＣＰＵ３２に接続されている。
【００２７】
また、ＣＰＵ３２は、出力インターフェース３６及び図示しない駆動回路を介してスロットルアクチュエータ７、前進クラッチバルブ１０、後進クラッチバルブ１１及びブレーキ用バルブ１３にそれぞれ接続されていて、ＲＯＭ３３に記憶されている各種制御プログラムに従って動作し、スロットルアクチュエータ７及び各バルブ１０，１１，１３への制御指令信号を出力する。
【００２８】
ＲＯＭ３３には、通常走行時のアクセルペダル２３の操作量に対するスロットル開度の関係を示すマップと、荷役レバーの操作量に対するスロットル開度の関係を示すマップと、荷役走行時におけるアクセルペダル２３の操作量に対する目標車速の関係を示すマップとが記憶されている。また、ＲＯＭ３３には荷役走行時及びインチング走行時に、進行側のクラッチ、即ち前進走行時には前進クラッチ８、後進走行時には後進クラッチ９を半クラッチ接続状態とするための前進クラッチバルブ１０及び後進クラッチ１１の基準開度が記憶されている。
【００２９】
ＣＰＵ３２は、通常走行時には進行側のクラッチを完全係合状態とするようにクラッチバルブを制御し、アクセルペダル２３の操作量に対する目標エンジン回転数になるようにスロットルアクチュエータ７を制御する。
【００３０】
ＣＰＵ３２は、荷役走行時には荷役作業に必要な油圧を確保できるエンジン回転数に対応するスロットル開度となるようにスロットルアクチュエータ７を制御する。また、ＣＰＵ３２はシフトレバー２９が操作された進行方向に対するクラッチを半クラッチ接続状態とすると共に、アクセルペダル２３の操作量に対応した目標車速となるように両クラッチバルブの一方を制御する。
【００３１】
ＣＰＵ３２は車速が停止車速以下か否かを判断し、車速が停止車速以下で、ブレーキスイッチ２８からブレーキペダル２５の操作検出信号を入力した状態が所定時間（例えば０．５秒）継続したとき、駐車ブレーキ１２が制動状態となるようにブレーキ用バルブ１３を制御する。停止車速とは車速センサ１７で零と判断される程度の低速を意味し、例えば秒速数ｃｍ程度である。駐車ブレーキ１２はアクセルペダル２３を踏み込み操作することにより制動状態が解除される。
【００３２】
次に前記のように構成された装置の作用を説明する。
エンジン１はスロットル開度に対応したエンジン回転数で回転される。エンジン１の回転により油圧ポンプ１８が駆動され、リフトシリンダ２０に作動油が供給可能な状態になる。また、同じ駆動源のエンジン１の回転は出力軸１ａ及びトルクコンバータ２を介して変速装置３に伝達される。
【００３３】
シフトレバー２９が中立位置に操作された状態では、両クラッチバルブ１０，１１は受圧室８ａ，９ａに油圧が供給されない状態に保持されるため、両クラッチ８，９は非接続状態に保持され、エンジン１の回転は変速装置３の出力軸３ｂに伝達されない。シフトレバー２９が前進位置に操作された状態では、前進クラッチバルブ１０は受圧室８ａに油圧を供給可能な状態に操作され、前進クラッチ８が接続状態となり、エンジン１の回転が前進クラッチ８を介して出力軸３ｂに伝達される状態となる。シフトレバー２９が後進位置に操作された状態では、後進クラッチバルブ１１は受圧室９ａに油圧を供給可能な状態に操作され、後進クラッチ９が接続状態となり、エンジン１の回転が後進クラッチ９を介して出力軸３ｂに伝達される状態となる。
【００３４】
フォークリフトを停止させるため、運転者がブレーキペダル２５を操作するか、インチングペダル２４をインチング位置より余分に操作すると、ブレーキペダル２５が制動位置に操作され、ブレーキスイッチ２８からブレーキ操作信号が出力される。ＣＰＵ３２は、後述する仕方で車速センサ１７からのパルス信号に基づいて車速を演算し、車速が停止車速以下の状態で、かつブレーキ操作信号を入力した状態が所定時間（例えば０．５秒程度）以上継続したと判断すると、ブレーキ用バルブ１３に制動指令信号を出力する。ブレーキ用バルブ１３に制動指令信号が出力されると、受圧室１２ｃに油圧が供給されない状態になり、ブレーキパッド１２ｂがばね力によってディスク１２ａに圧接される制動位置に配置され、駐車ブレーキ１２が制動状態となる。従って、運転者がフォークリフトを停止させるため、ブレーキペダル２５又はインチングペダル２４を操作すると、フォークリフトが停止した状態で自動的に駐車ブレーキ１２が制動解除状態から制動状態に切り換えられる。
【００３５】
荷役走行時には、ＣＰＵ３２は、ＲＯＭ３３に記憶された制御プログラムを読み出し、荷役レバーの操作量に基づいて設定した目標エンジン回転数となるようにスロットルアクチュエータ７を制御すると共に、進行側のクラッチ圧力を調整してアクセルレバー２３の操作量に対応した目標車速となるようにクラッチの係合圧力を制御する。
【００３６】
エンジン回転数センサ１５及び車速センサ１７からのパルス信号は、車速センサ１７について代表的に示すと、図２のような形態で計数回路３７，３８を介してＣＰＵ３２に次々と入力される。フォークリフトの走行制御の際に、極低速における検出精度を高めるため、車速検出用の歯車１６では、車輪１回転で１秒間に例えば８５０回のパルスが発生するほど多数の歯１６ａが形成されている。従って、比較的に走行速度が遅いフォークリフトでも、最高車速では例えば１秒間に４０００回以上ものパルスがＣＰＵ３２に入力することになる。
【００３７】
そのため、パルス間時間に基づいた従来のような計測では、その時間頻度でＣＰＵ３２に割込み要求が入る。制御周期を仮に５ミリ秒（ｍｓ）とすると、該周期の間に最高速の車速では２０パルス以上がＣＰＵ３２に入ることになる。車速検出のためには１回の計測分のパルスデータがあればよいから、回転速度検出に不要な残りのデータがＣＰＵ３２に入ることは、その都度ＣＰＵ３２に不必要な割込みをかけることになり、コンピュータの処理能力上問題である。
【００３８】
例えば、図２において、時点t₁から時点t₂までの所定周期Ｔ１の間にセンサから出力されるパルスの数と、そのパルスが出力されるに要した時間Ｔとから駆動輪５ａの回転速度Ｎｖを求める場合、時間Ｔの間に出力されたパルス数は６であるため、回転速度Ｎｖ［ｒｐｓ］は、Ｎｖ＝６／（Ｔ×８５０）となる。但し、８５０は駆動輪５ａが１回転する間に車速センサ１７と対向する位置を通過する歯車１６の歯１６ａの数である。この回転速度Ｎｖに２πｒをかければ車速Ｖ［ｍ／ｓ］が得られる。但し、ｒは駆動輪５ａの半径である。
【００３９】
従って、所定周期Ｔ１の開始時点t₁以降において、最初のパルスの立ち上がり、即ち１回目の割込みが入った時点で以降の割込みを不許可とし、割込み再許可の開始時点t₂後の最初のパルスの立ち上がりまでの時間Ｔを計測し、時間Ｔとその間のパルス数とから回転速度を演算すれば、ＣＰＵ３２の負荷を実質的に増すことなく回転速度の検出が可能であることが分かる。時間Ｔにセンサから出力されるパルス数は計数回路３７，３８でカウントされるため、ＣＰＵ３２の負荷とならない。
【００４０】
次に、車速センサ１７による車速の検出方法について、発生パルスの数毎に場合分けした図３の（ａ）〜（ｄ）を参照して更に詳しく説明する。なお、エンジン回転数センサ１５によるエンジン１の回転数も同様に求められるので、車速センサ１７による車速の検出方法について代表的に説明することとする。
【００４１】
制御装置３１で使用される水晶発振器の固有振動周波数を例えば２０ＭＨｚとし、メイン制御プグラムの制御周期を１０ｍｓとし、割込み許可の所定周期Ｔ１を５ｍｓとする。制御装置３１には１０ｍｓ用及び５ｍｓ用のタイマがそれぞれ設けられている。また、制御装置３１にはフリーランニングカウンタ機能が通常のように備えられていて、このカウンタが時間を１ＬＳＢ単位で常時カウントしている。クロック周波数が２０ＭＨｚの場合、１ＬＳＢは0.00005 ｍｓとなり、クロック周波数が２００ｋＨｚの場合、１ＬＳＢは0.005ｍｓとなる。
【００４２】
なお、以下の説明で、to-pulseは、０〜５ｍｓ間の１回目のパルス信号の立ち上がりから割込み不許可の解除以降の１回目パルスの立ち上がりまでの経過時間であり、to-cnt-pulseは、０〜５ｍｓ間の１回目のパルスから割込み不許可の解除以降の１回目パルスまでのパルス数から１を引いた値である。従って、パルス間時間pulsは、puls＝to-pulse／to-cnt-pulseで表される。
【００４３】
図３の（ａ）は、所定周期Ｔ１（５ｍｓ）の間に１パルス以下しか車速センサ１７からパルス信号が入らず、しかもパルス間時間pulsが１０ｍｓ以下の場合で、図の横軸の数字「０」及び「５」は、それぞれ１０ｍｓタイマ及び５ｍｓタイマの動作基準時点を便宜的に表わしている。１０ｍｓタイマ及び５ｍｓタイマが最初の時点「０」でリセットされて１制御周期及び所定周期Ｔ１が始まる。この時、制御装置３１のＣＰＵ３２は割込み可である。ある時点で車速センサ１７からの最初のパルス信号▲１▼が入力インターフェース３５を介してＣＰＵ３２に入ると、ＣＰＵ３２はそれ以降割込み不可となり、この割込み不可状態は５ｍｓタイマが最初の時点「５」でタイムアップするまでの時間Ｔ２の間継続する。
【００４４】
そして、次にパルス信号▲２▼が入るとＣＰＵ３２は割込み要求に応えて割込みルーチンに入り、車速の演算を開始する。前述したフリーランニングカウンタによりそれぞれ計時されているパルス信号▲１▼及び▲２▼が入った各時点のカウンタ値の差から経過時間to-pulseを求める。to-cnt-pulseは２−１＝１であるから、パルス間時間puls＝to-pulse／to-cnt-pulseは容易に求められる。そして、ＣＰＵ３２はＲＯＭ３３に記憶された演算式に従って車速Ｖを演算する。
【００４５】
Ｖ＝Ｎｖ×２πｒ＝｛（ to-cnt-pulse／ to-pulse）／Ｇ｝×２πｒ
但し、Ｇは駆動輪５ａが１回転する間に車速センサ１７と対向する位置を通過する歯車１６の歯１６ａの数である。
【００４６】
図３の（ｂ）は、所定周期Ｔ１（５ｍｓ）間に１パルス以下しか車速センサ１７からパルス信号が入らず、しかもパルス間時間pulsが１０ｍｓ以上かつ６０ｍｓ以下の場合であり、このときも同様にパルス間時間pulsが求められる。なお、パルス間時間が６０ｍｓ以上の時、車速は０とみなす。
【００４７】
図３の（ｃ）及び（ｄ）は、所定周期Ｔ１（５ｍｓ）間に２パルス以上、即ち割込み不可の間に１パルス以上のパルス信号が入る場合である。図３の（ｃ）において、２回目のパルス信号▲２▼は割込み不可状態の間に入力しており、このパルス信号▲２▼の入力によってはＣＰＵ３２は割込みルーチンに入らない。しかし、車速センサ１７から出力されるパルス信号の数は計数回路３８によりカウントされているため、パルス間時間pulsの計算の際にはパルス信号▲２▼も考慮され、車速が適切に検出される。
【００４８】
図３の（ｄ）においては、パルス信号▲１▼によりＣＰＵ３２が割込み不可状態となり、割込み不可状態の間に５つのパルス信号▲２▼〜▲６▼がセンサから出力されるが、これらは計数回路３８によりカウントされるだけで、ＣＰＵ３２に割込みをかけることはない。従って、１制御周期毎に５回もの不要な割込みが回避されることが分かる。
【００４９】
以上説明したこの実施の形態では以下の効果を有する。
（１）所定周期Ｔ１毎にパルス信号による割込みを許可すると共に、割込み許可の状態において１回目のパルス信号が入力されると次の割込み許可の時期になるまでパルス信号による割込みを不許可とし、１回目のパルス信号が入力された時から次の割込み許可後の最初のパルス信号が入力されるまでの経過時間to-pulseを計測し、経過時間to-pulseとその間に入力されたパルス数に基づいて回転軸の回転速度を演算する。従って、低速回転時の検出精度を高めるために歯車１４，１６の歯１４ａ，１６ａの数を増しても、ＣＰＵ３２の負荷が実質的に増すことがなく、低速だけでなく高速での検出精度の向上になる。即ち、歯車１４，１６のピッチの公差、入力軸３ａ及び出力軸３ｂの捩れ等による若干の回転変動が避けられないが、少なくとも所定周期間Ｔ１（５ｍｓ）の各パルス間時間を平均化することにより、パルス間時間が小さな場合でも精度が向上する。
【００５０】
（２）ＣＰＵ３２の負荷が小さくなるため、ＣＰＵ３２として安価なものを使用できる。
（３）従来は割込みを避けて敬遠されていた場所、例えば高速回転部と対向する箇所にセンサを設けることが可能となるので、センサの適用可能範囲が非常に広がり、自由度が増す。
【００５１】
（４）ＣＰＵ３２のメインプログラムの実行周期もしくは制御周期より割込み許可の所定周期Ｔ１が短く設定されているため、各制御周期で常に新しい回転速度検出データを使用できる。
【００５２】
（５）前記の回転速度検出方法により極低速での車速を正確に検出できると共に、高速走行時の車速検出もＣＰＵ３２の負荷を増さずに精度良く検出できる。従って、駐車ブレーキ１２の作動時期の判断や、フォークリフト等の産業車両で荷役走行時に極低速での走行制御を円滑に行うことができる。
【００５３】
実施の形態は前記に限定されるものではなく、例えば次のように具体化してもよい。
○ エンジン回転数センサ１５及び車速センサ１７として磁気ピックアップが用いられているが、ホール素子のような磁気センサを用いてもよい。
【００５４】
○ 制御装置３１の水晶発振器の固有振動周波数を２０ＭＨｚとしたが、様々な値に設計することができる。また、割込み許可の所定周期Ｔ１も制御周期の半分に限らず１／２ｎ（ｎは整数）としてもよい。
【００５５】
○ 割込み許可の所定周期Ｔ１を制御周期より長くしてもよい。
○ 被検出部である歯車１４，１６は出力軸１ａ，３ｂに直結されているが、出力軸１ａ，３ｂと一体に回転しうる部材なら所望の部位に設置しうる。
【００５６】
○ 被検出部としては、センサがパルス信号を発生しうるものなら歯車１４，１６以外の任意の周知手段を使用しうる。例えば、回転板の周方向に沿ってＮ極及びＳ極を交互に着磁したものや、回転板の周方向に沿って反射部と非反射部を交互に設けたものや、回転板に多数のスリットを所定角度をおいて形成したものが使用される。反射部やスリットを設けた回転板の場合は、センサとして光センサが使用される。
【００５７】
○ 回転軸に直接に被検出部を設けずに、センサが回転軸と連動される減速又は増速歯車列の歯車の回転を検出するように構成する。この場合、高速度に対する検出性能が重視される場合には、減速歯車列を用い、逆に低速度に対する検出性能が重視される場合には、増速歯車列を用いるのが好適である。
【００５８】
○ 前記実施形態では、本発明による回転速度検出方法及び装置を産業車両としてのフォークリフトに適用した場合について説明したが、本発明は、産業車両に限定されるものではないことは勿論のこと、一般的な車両に限定されるものでもなく、回転軸を有するものの回転速度を検出する際に広く用いることができる。
【００５９】
前記実施形態から把握できる請求項記載以外の発明（技術思想）について、以下にその効果と共に記載する。
（１）請求項２又は請求項３に記載の発明の回転速度検出装置を車速検出装置として備えている産業車両。この場合、低速走行時及び高速走行時における車速を精度良く検出でき、しかも演算手段に対する割込み負荷を小さくできる。
【００６０】
【発明の効果】
以上詳述したように請求項１〜請求項３の発明によれば、低速度を精度よく測定するために被検出部の数を多くしても、発生されるパルス信号毎に割込みをかけるものではないので、高速回転の際にも演算手段に対する負荷を実質的に増すことなく、精度よく回転速度の検出が可能となる。しかも、従来は割込みを避けて敬遠されていた場所にセンサを設けることが可能となるので、センサの適用可能範囲が非常に広がり、自由度が増す。
【００６１】
また、請求項３に記載の発明によれば、割込みを許可する所定周期は演算手段のメインプログラムの実行周期より短く設定されているので、各実行周期に必要な回転速度データとして新しいデータを使用できる。
【図面の簡単な説明】
【図１】一実施の形態の回転速度検出装置を備えた産業車両の要部構成図。
【図２】本発明による回転速度検出の原理を説明するためのパルス波形図。
【図３】（ａ）〜（ｄ）は種々の場合に分けて車速の求め方を説明するためのパルス信号及び時間の関係図。
【符号の説明】
１ａ…回転軸としての出力軸、３ｂ…回転軸としての出力軸、１４，１６…被検出部としての歯車、１４ａ，１６ａ…同じく歯、１５…エンジン回転数センサ、１７…車速センサ、３２…演算手段、制御手段及び計測手段としての中央処理装置（ＣＰＵ）、３３…制御手段を構成する読出し専用メモリ（ＲＯＭ）、３７，３８…カウンタとしての計数回路。

Claims

回転軸の周方向に沿って該回転軸と一体回転可能に一定ピッチで形成された被検出部をセンサで検出し、前記被検出部を検出する毎に前記センサから出力されるパルス信号の入力に基づく割込み処理により、演算手段で回転速度の演算を行って前記回転軸の回転速度を検出する回転速度検出方法であって、
所定周期毎にパルス信号による割込みを許可すると共に、割込み許可の状態において１回目のパルス信号が入力されると次の割込み許可の時期になるまで前記パルス信号による割込みを不許可とし、前記１回目のパルス信号が入力された時から次の割込み許可後の最初のパルス信号が入力されるまでの経過時間を計測し、前記経過時間とその間に入力されたパルス数に基づいて前記回転軸の回転速度を演算し、
前記演算手段には、該演算手段とは別に設けられるカウンタを介してパルス信号が入力されるよう構成され、前記カウンタは前記経過時間の間に入力されるパルス数をカウントするよう構成されており、
前記パルス信号による割込み不許可の状態では、前記演算手段にてパルス信号を入力しても前記割込み処理は行われず、前記カウンタにて前記パルス数がカウントされ、
前記パルス信号による割込み許可の状態では、前記割込み処理により、前記演算手段で前記経過時間と前記カウンタにてカウントされた前記パルス数に基づいて前記回転軸の回転速度が演算される回転速度検出方法。
回転軸の周方向に該回転軸と一体回転可能に一定ピッチで形成された被検出部を検出する毎にパルス信号を出力するセンサと、
前記パルス信号の入力に基づく割込み処理により回転速度の演算を行う演算手段と、
前記パルス信号の割込みを所定周期で許可すると共に、割込み許可の状態において１回目のパルス信号が入力されると次の割込み許可の時期になるまで前記パルス信号による割込みを不許可とする制御手段と、
前記１回目のパルス信号が入力された時から次の割込み許可後の最初のパルス信号が入力されるまでの経過時間を計測する計測手段と、
前記経過時間内に前記センサから出力されたパルス数をカウントするカウンタと
を備え、
前記演算手段には、該演算手段とは別に設けられる前記カウンタを介してパルス信号が入力されるよう構成されており、
前記パルス信号による割込み不許可の状態では、前記演算手段にてパルス信号を入力しても前記割込み処理は行われず、前記カウンタにて前記パルス数がカウントされ、
前記パルス信号による割込み許可の状態では、前記割込み処理により、前記演算手段で前記経過時間と前記カウンタにてカウントされた前記パルス数に基づいて前記回転軸の回転速度が演算される回転速度検出装置。
前記所定周期は前記演算手段のメインプログラムの実行周期より短く設定されている請求項２に記載の回転速度検出装置。