JP3753177B2 - Automatic opening / closing control device for vehicle sliding door - Google Patents

Automatic opening / closing control device for vehicle sliding door Download PDF

Info

Publication number
JP3753177B2
JP3753177B2 JP2003127857A JP2003127857A JP3753177B2 JP 3753177 B2 JP3753177 B2 JP 3753177B2 JP 2003127857 A JP2003127857 A JP 2003127857A JP 2003127857 A JP2003127857 A JP 2003127857A JP 3753177 B2 JP3753177 B2 JP 3753177B2
Authority
JP
Japan
Prior art keywords
door
value
area
motor
opening
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.)
Expired - Fee Related
Application number
JP2003127857A
Other languages
Japanese (ja)
Other versions
JP2004003327A (en
Inventor
川野辺  修
重松  孝一
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ohi Seisakusho Co Ltd
Original Assignee
Ohi Seisakusho Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Ohi Seisakusho Co Ltd filed Critical Ohi Seisakusho Co Ltd
Priority to JP2003127857A priority Critical patent/JP3753177B2/en
Publication of JP2004003327A publication Critical patent/JP2004003327A/en
Application granted granted Critical
Publication of JP3753177B2 publication Critical patent/JP3753177B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Power-Operated Mechanisms For Wings (AREA)
  • Control Of Electric Motors In General (AREA)

Description

【0001】
【発明の属する技術分野】
本発明は、自動車等の車両の側面に取り付けたスライドドアを、モータ等の駆動源によって自動的に開閉し得るようにした車両用スライドドアの自動開閉制御装置に関する。
【0002】
【従来の技術】
従来から車体の側面に前後方向にスライド可能に支持されたスライドドアを、モータ等の駆動源によって開閉移動するようにした車両用スライドドアの自動開閉制御装置が知られている。この装置では、運転席やドアハンドルの近くに設けた操作手段を使用者が意識的に操作することによって駆動源を起動し、スライドドアを駆動源の駆動力によって自動的に開閉するようになっている。
【0003】
また、操作手段に代わるトリガー手段として、スライドドアが手動力によって所定の距離を移動したことを検知し、それを契機として駆動源を起動し、手動力に代わって駆動源の駆動力に切り替えてスライドドアを自動的に開閉するようにしたものもある。
【0004】
【発明が解決しようとする課題】
従来の車両用スライドドアの自動開閉制御装置においては、スライドドアの自重が重いため、スライドドアの駆動に係る負荷が開閉方向や開閉位置に影響されやすく、とくにスライドドアの移動方向に係る自動車の前後の傾きによっては、ドアの自重を吊り上げるほどの過大加重から、同程度の加重に制動を加える負の負荷を生じるため、安全対策を十分に考慮しての自動開閉制御を困難なものにしていた。
【0005】
つまり、スライドドアに係る負荷が大きく、かつ負荷変動幅が大きくなれば、ドア駆動手段の出力パワーは負荷変動に素早く対処できるように十分な余裕をもって大きくしなければならない。しかし、反対に小さな負荷変動に対しては感応力が減少するため、スライドドアに挟み込みが生じないように安全性を考慮して出力パワーを制御するのは困難であった。
【0006】
とくにスライドドアの動力駆動の開始時期を自動制御とした場合、スライドドアの開閉方向や開閉位置、スライドドアが開閉されるときの車体姿勢など、自動車のあらゆる状況を考慮して安全対策を施さなければならない。
【0007】
例えば、手動力から電動力に切り替える契機をスライドドアの移動距離で得る場合は、手動力でスライドドアが動かされたことを確実に判断するのが難しい。例えば、緩やかな坂道で停車して開いたスライドドアが緩慢に移動したとき、スライドドアは自動駆動に切り替わり、自動駆動を望まない場合でも駆動力が働いてしまう。このような車体の姿勢等によりドアの負荷変動幅が大きくなったり、ドアの負荷自体が大きくなると、確実な手動力から自動力への切り替えが困難になる。
【0008】
とくにスライドドアはドアの移動方向が直線的で、かつ車体の前後方向と同一方向に移動し得るようになっているため、坂道でのドアの開閉にはドアの自重が制御に大きく作用する。このため、自動車の駐車時姿勢、すなわち駐車した道路に傾斜がある場合の傾斜の度合いを、スライドドアの開閉に際して知ることは重要である。
【0009】
(目的)
本発明は、このような従来の課題を解決するためになされたもので、スライドドアの自動駆動に課せられるあらゆる状況を考慮して、自在性と安全性との二律背反する制御を可能とすることを目的とする。そして、本発明は、手動駆動から自動駆動への切替えを確実に行い、スライドドアが所在する位置に応じて制御条件や制御量を的確に変更してスライドドアを安全かつ迅速自在に制御し、スライドドアの挟み込みの有無を速やかに判別して安全対策を施すようにした車両用スライドドアの自動開閉制御装置を提供することを目的とする。
【0010】
【課題を解決するための手段】
本発明の請求項1記載の発明は、車体に設けたガイドトラックに沿って開閉可能に支持されたスライドドアを、モータ駆動により開閉移動させるようにした車両用スライドドアの自動開閉制御装置において、正逆転可能なモータを有するドア駆動部と、前記ドア駆動部のモータ負荷を、モータの駆動電流および駆動電圧電気値で検出するモータ負荷検出手段と、平坦姿勢に車体があるときのドア開またはドア閉時のモータ負荷の電気値を記憶する記憶手段と、記憶手段において記憶された平坦姿勢のモータ負荷の電気値と、通常のドア開またはドア閉時に検出されたモータ負荷の電気値を比較し、このモータ負荷に係る両電気値の偏差から、ドア開閉時の車体の姿勢を判別する坂道判別手段とを備え、該坂道判別手段は、前記モータ負荷に係る両電気値の偏差が開作動時に駆動電圧がとても低いときは急な上り坂と、開作動時に駆動電圧が低いときは上り坂と、開作動時に駆動電圧が低くもなく電流値も大きくないときは平坦と、開作動時に電流値が大きいときは下り坂と、開作動時に電流値がとても大きいときは急な下り坂と、それぞれ判別することを特徴とする。
【0011】
本発明の請求項2に記載の発明は、請求項1に記載の発明において、前記記憶手段が、ドア開時のモータ負荷電流とモータ駆動電圧を、モータ負荷の電気値として記憶していることを特徴とする。
【0012】
本発明の請求項3に記載の発明は、請求項1に記載の発明において、前記記憶手段が、ドア全閉からドアを開く動作の連続した動作中で、かつガイドトラックの直線部を移動中で、しかも移動速度の一定した時期のモータ負荷の電気値を暫時更新記憶していることを特徴とする。
【0014】
本発明の請求項に記載の発明は、請求項1〜3のいずれかに記載の発明において、モータ負荷に係る電気値が、デューティサイクルで負荷電力を制御しているモータの駆動電圧を、デューティサイクル100%相当の電圧に換算してなることを特徴とする。
【0015】
【発明の実施の形態】
図1は、本発明による車両用スライドドアの自動開閉制御装置が適用される自動車の一例を示す外観斜視図で、車体1の側面にスライドドア2が前後方向に開閉可能に装着された状態を示している。また、図2はスライドドア2(鎖線で示す)を取り外した状態を示す車体1の拡大斜視図であり、図3はスライドドア2のみを単独で示す斜視図である。
【0016】
これらの図において、スライドドア2は車体1のドア開口部3の上縁に設けたアッパートラック4と下縁に設けたロアートラック5にドア2の上下端に固設した摺動連結具6と連係して前後方向に摺動自在に懸架されている。
【0017】
また、スライドドア2は内側後端に取り付けたヒンジアーム22が車体1の後部ウェスト部付近に固定したガイドトラック7に摺動自在に係合して案内され、ドア開口部3を密閉した全閉位置から車体1のアウターパネルの外側面より若干外方に突出しながら車体1の外装パネル側面と平行に後方に移動し、ドア開口部3を全開させる全開位置まで移動するように装着されている。
【0018】
さらに、スライドドア2は、全閉位置に位置するときに開口端面に設けたドアロック8が車体1側に固定したストライカと係合することによって、確実な閉鎖状態をもって全閉位置に保持されるように構成されている。また、スライドドア2の外側面には、手動による開閉操作を行うためのドアハンドル37が取り付けられている。なお、ドアロック8はスライドドア2の後端面に設けるようにしてもよい。
【0019】
また、車体1のドア開口部3の後方には、車体1を外装するアウターパネルと室内側のインナーパネルとの間に、図4に示すようなスライドドア駆動装置10が装着されている。このスライドドア駆動装置10は、モータ駆動によってガイドトラック7内に配設されたケーブル部材12を移動させ、それによってケーブル部材12に連結されたスライドドア2を移動させるものである。
【0020】
なお、本実施の形態では車内に設置した開閉スイッチ(図示せず)によってスライドドア2の開閉指示を行うとともに、図1に示すように、車外からワイヤレスリモコン30によっても開閉指示を行うことができるように構成されている。これらの構成の詳細については後述する。
【0021】
図5は、スライドドア駆動装置10の要部を示す斜視図である。スライドドア駆動装置10はモータ駆動部11を有し、このモータ駆動部11は車体1の室内側にボルト等をもって固定されたベースプレート13に、正逆転可能なスライドドア開閉用の開閉モータ14、ケーブル部材12が巻回されるドライブプーリ15、電磁クラッチ16を内蔵する減速部17をそれぞれ固定した構成からなっている。
【0022】
ドライブプーリ15は回転伝達力が減速機構を有して開閉モータ14の回転数を減少し、かつ出力トルクを増大してケーブル部材12に伝達する。また、電磁クラッチ16は開閉モータ14の駆動時に別途適時に励磁されて開閉モータ14とドライブプーリ15とを機械的に連結する。
【0023】
ドライブプーリ15に巻回されたケーブル部材12は、ガイドトラック7の後方に設けられた一対の案内プーリ19,19を介して外向きにコ字型に開口するガイドトラック7の上方の開口部7aと、下方の開口部7bとに互いに平行に掛け回されるとともに、ガイドトラック7の前端部に設けた反転プーリ20に巻回されて無端索条を形成している。
【0024】
また、ケーブル部材12のガイドトラック7の開口部7aを走行する部分の適所には、開口部7a内を抵抗なく走行できる状態で移動部材21が固設されている。ケーブル部材12はこの移動部材21より前方側が閉扉用ケーブル12aとなり、後方側が開扉用ケーブル12bとなっている。
【0025】
移動部材21はヒンジアーム22を介してスライドドア2の内側後端部に連結され、開閉モータ14の回転による開扉用ケーブル12aまたは閉扉用ケーブル12bの引っ張り力によってガイドトラック7の開口部7a内を前方または後方に移動し、それによってスライドドア2を閉扉方向または開扉方向に移動させるようになっている。
【0026】
また、ドライブプーリ15の回転軸には、その回転角度を高分解能に計測するロータリーエンコーダ18が連係されている。ロータリーエンコーダ18はドライブプーリ15の回転角度に応じたパルス数の出力信号を発生し、ドライブプーリ15に巻回されているケーブル部材12の移動量、すなわちスライドドア2の移動量を計測できるようになっている。
【0027】
このため、スライドドア2の全閉位置を初期値としてロータリーエンコーダ18からのパルス数を全開位置まで計数すれば、その計数値Nは移動部材21の位置、すなわちスライドドア2の位置を表すことになる。
【0028】
図6は、スライドドア2の移動状況を示す概略的平面図である。前述したように、スライドドア2は上下端に固設した摺動連結具6がアッパートラック4およびロアートラック5と連係することによって前方部が保持されており、ヒンジアーム22がガイドトラック7と連係することにより後方部が保持されている。
【0029】
(スライドドア自動制御装置)
次に、図7に示すブロック図を参照してスライドドア自動制御装置23と、車体1およびスライドドア2内の各電気的要素との接続関係について説明する。スライドドア自動制御装置23はマイクロコンピュータによるプログラム制御によってスライドドア駆動装置10を制御するもので、例えば車体1内のモータ駆動部11の近傍に配置されている。
【0030】
スライドドア自動制御装置23と車体1内の各電気的要素との接続としては、直流電圧BVを受けるためのバッテリー24との接続、イグニッション信号IGを受けるためのイグニッションスイッチ25との接続、パーキング信号PKを受けるためのパーキングスイッチ26との接続、メインスイッチ信号MAを受けるためのメインスイッチ27との接続がある。
【0031】
さらに、ドア開信号DOを受けるためのドア開スイッチ28との接続、ドア閉信号DCを受けるためのドア閉スイッチ29との接続、ワイヤレスリモコン30からのリモコン開信号ROまたはリモコン閉信号RCを受けるためのキーレスシステム31との接続、スライドドア2が自動開閉されることを警告するために警報音を発生するブザー32との接続がある。
【0032】
なお、ドア開スイッチ28およびドア閉スイッチ29がそれぞれ2つの操作子から構成されているのは、これらのスイッチが例えば車内の運転席と後部座席との2箇所に設置されていることを示している。
【0033】
次に、スライドドア自動制御装置23とスライドドア駆動装置10との接続関係としては、開閉モータ14に電力を供給するための接続、電磁クラッチ16を制御するための接続、ロータリーエンコーダ18からのパルス信号を受けてパルス信号φ1、φ2を出力するパルス信号発生部38との接続などがある。
【0034】
また、スライドドア自動制御装置23とスライドドア2内の各電気的要素との接続としては、スライドドア2が全閉状態より若干開いた状態でドア開口部3に設けた車体側コネクタ33とスライドドア2の開口端に設けたドア側コネクタ34とが接続されることによって可能となる。
【0035】
この接続状態でのスライドドア自動制御装置23とスライドドア2内の各電気的要素との接続としては、スライドドア2をハーフラッチからフルラッチの状態にまで締め込むためにクロージャーモータCMに電力を供給するための接続、ドアロック8を駆動してストライカ9から外すためのアクチュエータ(ACTR)35に電力を供給するための接続、ハーフラッチを検出するハーフラッチスイッチ36からのハーフラッチ信号HRを受けるための接続、ドアロック8と連結しているドアハンドル37の操作を検出するドアハンドルスイッチ37aからのドアハンドル信号DHを受けるための接続などがある。
【0036】
次に、図8に示すブロック図を参照してスライドドア自動制御装置23の構成について説明する。スライドドア自動制御装置23は主制御部55を有し、一定の時間間隔で繰り返し制御を行っている。主制御部55内には各入出力周辺機器の状況に応じて適正な制御モードを選択する制御モード選択部54が含まれている。
【0037】
制御モード選択部54は、各入出力周辺機器の最新の状況に応じて制御に必要な最適の専用制御部を選択する。専用制御部としては、主としてスライドドア2の開閉を制御するオートスライド制御部56、スライドドア2の移動速度を制御する速度制御部57、スライドドア2を駆動中にスライドドア2の移動を抑制する物が移動方向に挟み込まれたか否かを検出する挟み込み制御部58がある。また、オートスライド制御部56は、車体1の姿勢を検出するための坂道判定部59を含んでいる。
【0038】
また、スライドドア自動制御装置23は複数の入出力ポート39を有し、前述した各種のスイッチのオン/オフ信号や、リレーまたはクラッチ等の動作/非動作信号等を入出力するように構成されている。また、速度算出部42および位置検出部43はパルス信号発生部38から出力される2相のパルス信号φ1,φ2を受けて周期計数値Tおよび位置計数値Nを生成する。
【0039】
バッテリー24は自動車の走行中に発電機40によって充電され、その出力電圧は安定化電源回路41によって定電圧化されてスライドドア自動制御装置23に供給される。また、バッテリー24の出力電圧は電圧検出部47によって検出され、その電圧値はA/D変換部48でディジタル信号に変換されてスライドドア自動制御装置23に入力される。
【0040】
さらに、バッテリー24の出力電圧はシャント抵抗49に供給され、抵抗49に流れる電流値Iが電流検出部50で検出される。検出された電流値IはA/D変換部51でディジタル信号に変換され、スライドドア自動制御装置23に入力される。
【0041】
また、バッテリー24の出力電圧はシャント抵抗49を介して電力スイッチ素子46に供給される。この電力スイッチ素子46はスライドドア自動制御装置23によってオン/オフ制御され、直流信号をパルス信号に変換して開閉モータ14またはクロージャーモータCMに供給する。パルス信号のデューティ比は電力スイッチ素子46で自在に制御し得るようになっている。
【0042】
電力スイッチ素子46で得られたパルス信号は、極性反転回路45およびモータ切替回路44を介して開閉モータ14またはクロージャーモータCMに供給される。極性反転回路45は開閉モータ14またはクロージャーモータCMの駆動方向を変更するためのもので、電力スイッチ素子46と共にモータの電力供給回路を構成している。
【0043】
また、モータ切替回路44は主制御部55からの指示によってスライドドア2を開閉駆動する開閉モータ14とクロージャーモータCMとのいずれか一方を選択する。両モータともスライドドア2を駆動するモータであるが、同時に駆動されることがないため、選択的に駆動電力を供給するようにしている。
【0044】
この他に、主制御部55からの指示によって電磁クラッチ16を制御するクラッチ駆動回路52、同じく主制御部55からの指示によってアクチュエータ35を制御するアクチュエータ駆動回路53を備えている。
【0045】
(メインルーチン)
次に、この構成を有する本発明の動作について説明する。図9は、スライドドア自動制御装置23の動作を示すメインルーチンのフローチャートである。初めに初期設定を行い(ステップ101)、稼働初期に主なパラメータ等をイニシャライズする。スイッチ(SW)判定(ステップ102)は、入出力ポート39に接続されている前述した各種のスイッチ25〜29等の開閉状態を判定し、各スイッチの開閉状態を示すフラグ等を設定する。
【0046】
A/D入力(ステップ103)は、A/D変換部48,51から電圧値Vおよび電流値Iを取り込む。このA/D入力は下位レベルに電流値補正(ステップ111)、電圧アドレス変換(ステップ112)を備えている。
【0047】
次いで、前述した各スイッチの開閉状態等の周囲状況からオートスライドモード(ステップ113)かクロージャーモード(ステップ114)かを判定するモード判定(ステップ104)を行い、いずれかに選択制御する。オートスライドモードは開閉モータ14を駆動してスライドドア2を開閉制御するモードであり、クロージャーモードはクロージャーモータCMを駆動してスライドドア2をフルラッチの状態に締め込んだり解放したりするモードである。
【0048】
続くアクチュエータ(ACTR)リレー制御(ステップ105)、クラッチリレー制御(ステップ106)、オートスライドリレー制御(ステップ107)およびクロージャーリレー制御(ステップ108)は、各制御部の制御結果が反映されて、電磁クラッチ16やモータ14,CMに電力投入を行う直接的制御部分なので、特に詳細な説明は省略する。なお、スライドドア2を開閉駆動する開閉モータ14の起動・停止はオートスライドリレー制御(ステップ107)によって行う。
【0049】
次のスリープモード(ステップ109)は、長時間なんの変化もないときに電力消費を低減する制御である。次のプログラム調整(ステップ110)は、別途ループ外に設けた割り込みプログラムにおけるプログラム調節タイマー(ステップ115)により、メインループのインターバルを、例えば10mm秒に一定に制御するものである。
【0050】
このプログラム調整において、プログラム調節タイマーの割り込みを受けることにより、各ステップにおける制御点が周囲の状況によってネストのより深いレベルに入り込んだり、浅い階層で済んだり等して、メインループの入り口に戻るインターバルが変動するのを常に一定に調節している。プログラム調整が終了すると、SW判定(ステップ102)に戻り、それ以降の処理を繰り返すループ制御を行っている。
【0051】
(モード判定ルーチン)
図10は、モード判定(ステップ104)の中のオートスライドモード判定の概要を示すフローチャートである。このオートスライドモード判定では、ドア2の動き出しをその時点の様々な状況によって区分するスタートモード(ステップ117)、動き出したドア2をその時点の状況に応じて適正に制御する挟み込み判定(ステップ118)、坂道モード(ステップ119)、速度制御(ステップ120)等がある。坂道モードは、その下位レベルに平坦値データ入力(ステップ121)、坂道判定(ステップ122)等のルーチンがある。
【0052】
また、オートスライドモード判定(ステップ116)は、スイッチ文(ステップ123)の部分で周囲の状況に応じた識別子によりオート開作動(ステップ124)、オート閉作動(ステップ125)、マニュアル閉作動(ステップ126)、逆転開作動(ステップ127)、逆転閉作動(ステップ128)のいずれかに分岐されて制御を行い、これらの制御の下位レベルには、目標位置算出(ステップ129)、全開検出(ステップ130)の各ルーチンがある。さらに、スタートモード(ステップ117)等と同じレベルにストップモード(ステップ131)のルーチンがある。
【0053】
また、スタートモード(ステップ117)は、その下位レベルにスイッチ文(ステップ132)により多枝分岐される通常スタートモード(ステップ133)、ACTRスタートモード(ステップ134)、手動通常スタートモード(ステップ135)および手動全閉スタートモード(ステップ136)の各ルーチンがある。
【0054】
なお、スイッチ文(ステップ123,132)として示される多分岐フローは周囲の状況を示す識別子として各スイッチの開閉状態や、所要の制御の継続中または終了を表す通常は1ビットのフラグを利用している。
【0055】
このオートスライドモード判定のフローは、メインルーチンにしたがって制御点を移しているが、図10に別途に示すパルスカウントタイマー(ステップ115A)およびパルス割り込み(ステップ115B)の両ルーチンは、メインルーチンとは制御点を別にした割り込みプログラムを構成している。
【0056】
(周期計数値T・位置計数値N)
図11は、割り込みプログラムにおけるパルスカウントタイマー(ステップ115A)とパルス割り込み(ステップ115B)の各ルーチンにおいて所要される周期計数値Tおよび位置計数値Nの取得タイムチャートを示す図である。
【0057】
同図において、2相の速度信号Vφ1,Vφ2はロータリーエンコーダ18から出力される2相のパルス信号φ1,φ2に対応するもので、両信号の位相関係からロータリーエンコーダ18の回転方向、すなわちスライドドア2の移動方向を検出する。具体的には、パルス信号φ1の立ち上がり時にパルス信号φ2がLレベル(図示の状態)であれば、例えば開扉方向と判定し、逆にHレベルであれば閉扉方向と判定する。
【0058】
速度算出部42では、速度信号Vφ1の立ち上がり時に割り込みパルスg1を発生し、この割り込みパルスg1の発生周期の間に割り込みパルスg1より十分小さな周期(例えば、400μsec )を有するクロックパルスC1のパルス数を計数し、その計数値を周期計数値Tとする。従って、この周期計数値Tはロータリーエンコーダ18が出力するパルス信号φ1の周期をディジタル値に変換したものとなる。
【0059】
例えば、ロータリーエンコーダ18の出力パルスが1mm当たり1パルス(1周期)とすると、周期計数値Tが250のときはドア2の移動速度は「1mm/(400μs×250)=10mm/sec 」となり、周期計数値Tが100のときはドア2の移動速度は「25mm/sec 」となる。
【0060】
なお、図11に示す周期計数値TN-3 〜TN+3 は、ロータリーエンコーダ18が出力する出力信号φ1によって得られる位置計数パルス(実質的には割り込みパルスg1)を計数したドア2の位置情報を示す位置計数値Nを添え字として持つもので、周期計数値TN は、そのときに注目するN番目の位置に対応した周期計数値Tを示し、TN-1 、TN-2 またはTN+1 、TN+2 は、それぞれ位置計数値Nに対して1または2番前後の位置に係る周期計数値Tを示すものである。
【0061】
また、この実施の形態では速度信号Vφ1の連続する4周期分の周期計数値からスライドドア2の速度を認識するようにしているので、4周期分の周期計数値を格納するために4つの周期レジスタ1〜4を備えており、4つの周期レジスタにN番の位置を注目点とし、それが周期レジスタ1〜4の先頭出力値となるように4回分保留されるようになっている。
【0062】
こうして、パルスカウントタイマー(ステップ115A)とパルス割り込み(ステップ115B)のルーチンとは、メインルーチンとは別途にそれぞれのタイミングで周期計数値Tと位置計数値Nとを収得している。
【0063】
図12は、ロータリーエンコーダ18が出力する出力信号φ1を位置計数パルスとしてドア2の後述する制御領域E1〜E6における分解能Bに応じてサンプリングされるサンプリング点のタイムチャートを示している。すなわち、制御領域E3,E4では位置計数パルスφ1を2分の一分周した分解能2でサンプリングし、制御領域E2では位置計数パルスφ1を4分の一分周した分解能4でサンプリングし、制御領域E1,E5,E6では位置計数パルスφ1を8分の一分周した分解能8でサンプリングする。
【0064】
(スライドドアの制御領域)
ここで、スライドドア2の制御領域E1〜E6について説明する。図13は、ガイドトラック7の平面視を示している。スライドドア2の開閉位置を移動部材21の位置で表すと、ドア2の閉方向に係るドアの所在エリアはエリア1〜4の4エリアに分けてあり、ドア2の開方向に係るドアの所在エリアはエリア5〜7の3エリアに分けてある。
【0065】
ドア2の全閉位置の位置計数値Nを0、全開位置の位置計数値Nを850とすると、閉方向移動(Z=0)の場合は、N=850〜600がエリア1、N=600〜350がエリア2、N=350〜60がエリア3、N=60〜0がエリア4となっている。エリア4の内の全閉側半分はACTR領域となっている。開方向移動(Z=1)の場合は、N=0〜120がエリア5、N=120〜800がエリア6、N=800〜850がエリア7となっている。
【0066】
そして、エリア1とエリア6が通常制御領域E1、エリア2が減速制御領域E2、エリア3がリンク減速領域E3、エリア4が締め込み制御領域E4、エリア5がリンク減速領域E5、エリア7がチェック制御領域E6となっており、ドア2は各制御領域に適した移動速度等で制御される。
【0067】
(パルス割り込みルーチン)
図14は、パルス割り込みルーチン(ステップ115B)を示すフローチャートである。このルーチンは割り込みパルスg1の発生毎に位置計数値Nおよびドア移動方向Zによってスライドドア2が現在位置するエリア1〜7および制御領域E1〜E6(図13参照)を判別する処理である。なお、エリア1〜7および制御領域E1〜E6の詳細については後述する。
【0068】
まず、開閉モータ14が停止中か否か調べ(ステップ137)、作動中であれば現在の周期計数値Tを周期レジスタに格納し(ステップ138)、モータ停止中を解除する(ステップ139)。開閉モータ14が停止中であれば周期計数値Tに満杯値FF(16進数)をセットする(ステップ140)。
【0069】
次いで、ドア2の移動方向Zを調べ(ステップ141)、ドア2が開方向(Z=1)に移動していれば位置計数値Nを増計数し(ステップ142)、それにより位置計数値Nが120以上で800未満であれば(ステップ143,144)、前は制御領域E1か調べ(ステップ145)、制御領域E1であれば現在も制御領域E1であるので処理を終了し、前が制御領域E1でなければ制御領域E1、エリア6にセットし(ステップ146)、エリア変更指示データを変更有りにセットし(ステップ147)、処理を終了する。
【0070】
位置計数値Nが120未満であれば(ステップ143)、前は制御領域E5か調べ(ステップ148)、制御領域E5であれば現在も制御領域E5であるので処理を終了し、前が制御領域E5でなければ制御領域E5、エリア5にセットし(ステップ149)、エリア変更指示データを変更有りにセットし(ステップ147)、処理を終了する。
【0071】
位置計数値Nが800を超えていれば(ステップ144)、前は制御領域E6か調べ(ステップ150)、制御領域E6であれば現在も制御領域E6であるので処理を終了し、前が制御領域E6でなければ制御領域E6、エリア7にセットし(ステップ151)、エリア変更指示データを変更有りにセットし(ステップ147)、処理を終了する。
【0072】
ドア2が開方向(Z=0)に移動していれば(ステップ141)、位置計数値Nを減計数し(ステップ152)、それによって位置計数値Nが600を超えた値であれば(ステップ153〜155)、前は制御領域E1か調べ(ステップ156)、制御領域E1であれば現在も制御領域E1であるので処理を終了し、前が制御領域E1でなければ制御領域E1、エリア1にセットし(ステップ157)、エリア変更指示データを変更有りにセットして(ステップ147)、処理を終了する。
【0073】
位置計数値Nが60以下であれば(ステップ153)、前は制御領域E4か調べ(ステップ158A)、制御領域E4であれば現在も制御領域E4であるので処理を終了し、前が制御領域E4でなければ制御領域E4、エリア4にセットし(ステップ158B)、エリア変更指示データを変更有りにセットし(ステップ147)、処理を終了する。
【0074】
位置計数値Nが60を超え、350以下であれば(ステップ154)、前は制御領域E3か調べ(ステップ158C)、制御領域E3であれば現在も制御領域E3であるので処理を終了し、前が制御領域E3でなければ制御領域E3、エリア3セットし(ステップ158D)、エリア変更指示データを変更有りにセットし(ステップ147)、処理を終了する。
【0075】
位置計数値Nが350を超え、600以下であれば(ステップ155)、前は制御領域E2か調べ(ステップ158E)、制御領域E2であれば現在も制御領域E2であるので処理を終了し、前が制御領域E2でなければ制御領域E2、エリア2にセットし(ステップ158F)、エリア変更指示データを変更有りにセットし(ステップ147)、処理を終了する。
【0076】
(パルスカウントタイマー)
図15は、パルスカウントタイマー(ステップ115A)を示すフローチャートである。クロックパルスC1の数を所要のパルスカウンタにより計数して周期計数値Tを得(ステップ159)、周期計数値Tが満杯(T=FF)になったか調べ(ステップ160)、満杯でなければリターンし、満杯ならば周期計数値Tを零にクリアー(T=0)し(ステップ161)、所要カウンタの計数値を増計数してキャリーアップし(ステップ162)、その後リターンする。
【0077】
(エリア1〜7における制御)
図16は、前述したエリア1〜7(図13)においてスライドドア2を制御するために要求される各種データを記憶するためのメモリテーブルである。エリア1とエリア6の両エリアは通常制御領域E1と称し、この制御領域E1ではドア2の適性移動速度T1が250mm/s 、基準デューティ値Dが250、サンプリング領域の分解能Bが8で、注目度は小となっている。
【0078】
デューティ値Dは、モータに印加する電圧波形(矩形波)のデューティサイクルを示す値で、本実施の形態では、「D=250」がデューティサイクル100%、すなわちHレベルの直流信号を意味し、「D=0」がデューティサイクル0%、すなわちLレベルの直流信号を意味している。そして、この間の250段階で矩形波のデューティサイクルを変化させることによってモータの出力トルクを調整するようにしている。
【0079】
エリア2は減速制御領域E2と称し、この制御領域E2ではドア2の適性移動速度T2が170mm/s 、デューティ値Dが170、分解能Bが4、注目度は危険領域である。また、エリア3はリンク減速制御領域E3と称し、この制御領域E3ではドア2の適性移動速度T3が100mm/s 、デューティ値Dが100、分解能Bが2、注目度は危険領域である。さらに、エリア4は締め込み制御領域E4と称し、この制御領域E4ではドア2の適性移動速度T4が120mm/s 、デューティ値Dが120、分解能Bが2、注目度は危険領域である。さらに、エリア5はリンク減速制御領域E5と称し、この制御領域E5ではドア2の適性移動速度T5が200mm/s 、デューティ値Dが200、分解能Bが8、注目度は小である。さらに、エリア7はチェック制御領域E6と称し、この制御領域E6ではドア2の適性移動速度T6が250mm/s 、注目度は中である。
【0080】
分解能Bは比較的注目度の低い通常領域E1のエリア1,6、リンク減速制御領域E5のエリア5は間引き幅の広い分解能Bを8に設定してある。また、減速制御領域E2のエリア2は挟み込みの発生しやすい危険領域であるが、ドア2の開度が十分にあるエリアなので分解能Bは4に設定してある。さらに、リンク減速制御領域E3のエリア3と、締め込み制御領域E4は、ドア2が曲線を描いて移動し、かつ注目度の最も高い危険領域なので、分解能Bは最も細かい2に設定してある。これらの分解能Bに基づいて定めたサンプリング領域Qを図12に示している。nは閉方向、mは開方向である。
【0081】
(オートスライドモード判定)
図17は、オートスライドモード判定ルーチン(ステップ116)の詳細を示すフローチャートである。このルーチンはスライドドア2を開閉駆動するためのオートスライドモードか否か判定し、オートスライドモードでなければ始動判定を行う。ドア2の始動を判定したときはオートスライド作動中の処理を行う。オートスライド作動の終了を判定するとオートスライドの停止処理を行い、オートスライド作動を終了させる。
【0082】
まず、オートスライド停止中であればストップモード状態(ステップ163)ではなく、オートスライド作動中(ステップ165)でもないので、メインスイッチのオン/オフ状態を調べ(ステップ167)、メインスイッチがオフであればリターンする。
【0083】
メインスイッチがオンであれば手動および始動判定(ステップ168,169)を行う。手動判定(ステップ168)の詳細は後述する(図18)が、ドア2が所定の速度以上で移動したことを検出すると、手動開または手動閉状態にセットし、オートスライド作動モードに移行するための準備を行う。
【0084】
手動判定が終了すると、始動モード判定を実行する(ステップ169)。始動モード判定は、オートスライド作動モードを決定するための処理で、スイッチ判定(ステップ102)でリモコンスイッチ30のドア開を検出し、またはドア開スイッチ28のオンを検出し、あるいは手動判定(ステップ168)で手動開状態を確認したときは、オート開作動モード(ステップ181)にセットする。また、危険領域外においてリモコンスイッチ30のドア閉を検出し、またはドア閉スイッチ29のオンを検出し、あるいは手動閉状態を確認したときはオート閉作動モード(ステップ182)にセットする。また、危険領域内においてドア閉スイッチ29のオンを検出したときはマニュアル閉作動モード(ステップ183)にセットする。
【0085】
こうして始動モード判定(ステップ169)が終了すると、オートスライド作動モード状態か判定する(ステップ170)。オートスライド作動モードでなければリターンする。オートスライド作動モードであれば、オートスライドが始動したので、動作計数値Gをクリアし(ステップ171)、オートスライド動作中の状態にセットし(ステップ172)、スタート中の状態にセットし(ステップ173)、オートスライド開始にセットする(ステップ174)。こうしてオートスライド作動がセットされる。
【0086】
チェック制御(ステップ175)は、電磁クラッチ16を半クラッチ状態にしてドア2を停止保持する仮保持制御を行う部分で、オートスライド作動中の場合はストップモード終了後に行う。手動操作時はドア2が止まったことを確認してから行う。
【0087】
ステップ168〜174によってオートスライド開始にセットされると、次のオートスライドモード判定ルーチンのときはオートスライド作動中およびスタートモード(ステップ165,166)と判定し、スタートモードの処理を実行する(ステップ176)。
【0088】
このスタートモードは各スイッチのオン/オフ状態や周囲の状況に応じてドア2を動力駆動するためのオートスライド動作をスタートさせるモードを識別し、その識別したモードで制御を行う。この詳細については後述する。スタートモードが終了し、次のオートスライドモード判定ルーチンのときは通常モードに入り、挟み込み判定(ステップ177)、速度制御(ステップ178)、坂道判定(ステップ179)を実行する。なお、これらの詳細については後述する。
【0089】
また、始動モード判定(ステップ169)で行った各スイッチの開閉状態に応じて、スイッチ文180でオート開作動(ステップ181)、オート閉作動(ステップ182)、マニュアル閉作動(ステップ183)に分岐する。また、これらの作動中に挟み込みを検出したときは、逆転開作動(ステップ184)、逆転閉作動(ステップ185)に分岐する。
【0090】
なお、オートスライド作動中(ステップ186)は作動計数値Gを増計数し(ステップ187)、リターンする。オートスライド作動終了を判定すると(ステップ186)、作動計数値Gをクリアし(ステップ188)、ストップモードにセットして(ステップ189)、リターンする。
【0091】
ストップモードがセット(ステップ189)されると、次のオートスライドモード判定ルーチンのときにストップモード状態と判定され(ステップ163)、ストップモード(ステップ164)を実行する。このストップモードはオートスライドモード時におけるドア2の開閉制御時に、ドア2の動力駆動を停止させたときの安全制御を目的として、電磁クラッチ16のオフと開閉モータ14のオフとのそれぞれのタイミングを制御している。
【0092】
すなわち、ドア2が全開位置と全閉位置との中間位置で停止した時は、開閉モータ14を先に停止させ、その後に所要の待ち時間をおいて電磁クラッチ16をオフにする。ドア2が全閉位置のときは直ぐに開閉モータ14、電磁クラッチ16を同時にオフする。ストップモード作動中は作動計数値Gを増計数し(ステップ191)、リターンする。ストップモード終了時は、作動計数値Gをクリアし(ステップ192)、ストップモードを解除し(ステップ193)、オートスライド作動を終了させ(ステップ194)、リターンする。
【0093】
(手動判定ルーチン)
図18は、手動判定ルーチン(ステップ168)の詳細を示すフローチャートである。この手動判定ルーチンは、ドア2を制御するメインルーチンとは別に計測されているドア速度を検出することによって、ドア2が手動力で作動したことを検知し、動力駆動する契機を得るものである。
【0094】
まず、ドア2が全閉状態(ハーフスイッチがオン)か判断する(ステップ195A)。ドア2が全閉状態であれば、ドア全閉状態にセットされているか判断し(ステップ195D)、セットされていなければドア全閉状態にセットする(ステップ195E)。次いで、ドアハンドル37が操作されてハンドルスイッチ37aがオンしたか判断し(ステップ195F)、オンしていなければリターンする。ハンドルスイッチ37aがオンになると(ステップ195F)、ドア全閉状態をクリアし(ステップ195G)、全閉−ドア開手動状態にセットし(ステップ195H)、リターンする。
【0095】
ドア2が全閉状態でなければ(ステップ195A)、ドア全閉状態にセットされているか判断し(ステップ195B)、セットされていればドア全閉状態をクリアし(ステップ195G)、全閉−ドア開手動状態にセットする(ステップ195H)。これは、通常はドアハンドル37を引いてドア2を開けるので、それによってドア全閉状態がクリアされるが(ステップ195F,195G)、ハンドルスイッチ故障時またはハンドルスイッチを省略したシステムの場合は、ハーフスイッチがオフとなったことを検出してドア全閉状態をクリアし(ステップ195A,195B,195G)、全閉−ドア開手動状態セット(ステップ195H)する。
【0096】
ドア全閉状態にセットされていなければ(ステップ195B)、ドア2の移動速度を表す速度データ(a/T:aはロータリーエンコーダの分解能)が所定の手動認識速度より速く(ステップ195C)、しかも急閉速度以下のとき(ステップ196)は、開閉方向に基づき(ステップ197)、ドア開手動状態(ステップ198)またはドア閉手動状態(ステップ199)のいずれかのモードにセットする。ドア速度が手動認識速度以下のとき(ステップ195C)は、ドア2が停止しているとしてリターンし、ドア速度が急閉速度以上(ステップ196)のときは、メカ保護上そのまま手動力による閉作動を継続させるためにリターンする。
【0097】
ただし、電磁クラッチ16がオフ後は、ワイヤーの張力による運動を無視するために所要のタイムラグ期間中はドア開閉いずれかの状態への移行は受け付けないようになっている。
【0098】
なお、手動認識速度はドア2の動力駆動を行う契機を作り出す値で、比較的広範囲の任意の値を設定することができる。ドア2の移動速度、換言すれば周期計数値Tはロータリーエンコーダ18の1周期を最小の分解能として計測可能であることから、1mm程度のドア2の移動によっても、ドア2を動力駆動させる契機を作り出すことができる。これにより、オート開閉作動の反応が高感度になるとともに、安全性を得る処理に対応させるために、ドア2の動きの変化を高分解能で高感度に検知することができる。
【0099】
(オート開作動ルーチン)
図19は、オート開作動ルーチン(ステップ122,181)の詳細を示すフローチャートである。このオート開作動ルーチンは、リモコンスイッチ30をドア開に操作し、またはドア開スイッチ28をオンし、あるいはドア開手動状態を確認したときにスイッチ文180で選択され、ドア2を開方向に安全に動力駆動するために、オート開作動中のドア駆動停止または反転作動の制御を行うものである。
【0100】
まず、全開検出を行う(ステップ200)。この全開検出の詳細については後述するが、ドア2が全開状態か検出するもので、この全開検出が終了すると、挟み込み判定を実行し(ステップ201)、挟み込みがなければ全開検出でドア全開状態を検出したか判断する(ステップ205)。ドア2が全開状態でなく、異常状態でもなく(ステップ207)、スイッチ受付可能であり(ステップ208)、リモコン30の閉スイッチおよびドア閉スイッチ29が共にオフであり(ステップ210,211)、メインスイッチがオンであり(ステップ212)、リモコン30の開スイッチおよびドア開スイッチ28が共にオフであれば(ステップ213,214)、リターンし、オート開作動を継続する。
【0101】
挟み込みを検出すると(ステップ201)、反転方向に制御を移すための目標位置算出を実行し(ステップ202)、挟み込み有りを解除し(ステップ203)、閉危険領域(エリア2〜4)でなければ(ステップ204)、オート開作動を解除し、逆転閉作動を許可し、ドア開作動を解除し、ドア閉作動を許可し(ステップ215〜218)、リターンする。閉危険領域であれば、オート開作動を解除し(ステップ223)、リターンする。
【0102】
ドア2が全開位置に達すれば(ステップ205)、ドア全開検出を解除し(ステップ206)、オート開作動を解除し(ステップ223)、リターンする。また、モータロックなどの異常を検出した場合も(ステップ207)、オート開作動を解除し(ステップ223)、リターンする。オート開作動解除(ステップ223)によって電磁クラッチ16および開閉モータ14を制御し、ドア2を停止させる(ステップ106,107)。
【0103】
また、本実施の形態では、開閉スイッチは全てプッシュ・オン/プッシュ・オフ式となっているので、いずれかのスイッチが押されたままだとスイッチ受付可能状態でないと判断し(ステップ208)、各開閉スイッチのオン/オフ状態を確認する。
【0104】
すなわち、リモコン30の開スイッチまたはドア開スイッチ28の少なくとも一方がオンで(ステップ209,219)、リモコン30の閉スイッチまたはドア閉スイッチ29が共にオフであれば(ステップ220,222)、そのままリターンしオート開作動を継続する。しかし、リモコン30の開スイッチまたはドア開スイッチ28の一方がオンで(ステップ209,219)、リモコン30の閉スイッチまたはドア閉スイッチ29の一方がオンであれば(ステップ220,222)、開スイッチと開スイッチの双方がオンされていることになるので、オート開作動を解除し(ステップ223)、リターンする。また、リモコン30の開スイッチおよびドア開スイッチ28の双方がオフであれば(ステップ209,219)、スイッチ受付可能にセットし(ステップ221)、リターンする。
【0105】
スイッチ受付可能なときに(ステップ208)、すなわち開閉スイッチの全てがオフのときにリモコン30の閉スイッチまたはドア閉スイッチ29の少なくとも一方がオンすれば(ステップ210,211)、ドア閉作動の指示が出されたと判断して前述したステップ204以降の処理に移行する。
【0106】
メインスイッチがオフすると(ステップ212)、オート開作動を解除し(ステップ223)、開閉モータ14を停止してリターンする。また、リモコン30の開スイッチまたはドア開スイッチ28の少なくとも一方がオンすると(ステップ213,214)、プッシュ・オン/プッシュ・オフ式の開スイッチが再度オンされたことになるので、その位置でスライドドア2を停止させるためオート開作動を解除し(ステップ223)、リターンする。
【0107】
(オート閉作動ルーチン)
図20は、オート閉作動ルーチン(ステップ123,182)の詳細を示すフローチャートである。このオート閉作動ルーチンは、危険領域外においてリモコンスイッチ30をドア閉に操作し、またはドア閉スイッチ29をオンし、あるいはドア閉手動状態を確認したときにスイッチ文180で選択され、ドア2を閉方向に安全に動力駆動させるために、オート閉作動中のドア駆動停止または反転作動の制御を行うものである。
【0108】
まず、ドア2がハーフラッチ領域に達すれば(ステップ224)、オート閉作動を解除し(ステップ246)、リターンする。ドア2がハーフラッチ領域以外のときは挟み込み判定を実行する(ステップ225)。挟み込みがなく、異常もなく、スイッチ受付可能であり、リモコン30の開スイッチおよびドア開スイッチ28が共にオフであり、メインスイッチがオンであり、リモコン30の閉スイッチおよびドア閉スイッチ29が共にオフであれば(ステップ229〜235)、オート閉作動中であるのでリターンする。
【0109】
挟み込みを検出すると(ステップ225)、ドア2を反対方向に移動させるために目標位置算出を実行し(ステップ226)、挟み込み有りを解除し(ステップ227)、オート閉作動を解除し(ステップ228)、逆転開作動を許可し、ドア閉作動を解除し、ドア開作動を許可する(ステップ236〜238)。次いで、ドア2がACTR領域でなければリターンし、ACTR領域ならば(ステップ239)、ACTR作動許可して(ステップ240)、リターンする。
【0110】
モータロックなどで異常電流を検出した場合は(ステップ229)、オート開作動を解除し(ステップ246)、リターンする。オート閉作動解除(ステップ246)によって電磁クラッチ16および開閉モータ14を制御し、ドア2を停止させる(ステップ106,107)。
【0111】
また、いずれかの開閉スイッチが押されたままでスイッチ受付可能状態でないと判断した場合は(ステップ230)、各開閉スイッチのオン/オフ状態を確認する。すなわち、リモコン30の閉スイッチまたはドア閉スイッチ29の少なくとも一方がオンで(ステップ241,242)、リモコン30の開スイッチまたはドア開スイッチ28が共にオフであれば(ステップ243,244)、そのままリターンしてオート閉作動を継続する。
【0112】
しかし、リモコン30の開スイッチまたはドア開スイッチ28の少なくとも一方がオンであれば(ステップ243,244)、開スイッチと開スイッチの双方がオンされていることになるので、オート閉作動を解除し(ステップ246)、リターンする。また、リモコン30の閉スイッチおよびドア閉スイッチ29の双方がオフであれば(ステップ241,242)、スイッチ受付可能にセットし(ステップ245)、リターンする。
【0113】
スイッチ受付可能なときに(ステップ230)、リモコン30の開スイッチまたはドア開スイッチ28の少なくとも一方がオンすれば(ステップ231,232)、ドア開作動の指示が出されたと判断して前述したステップ228以降の処理に移行する。
【0114】
メインスイッチがオフすると(ステップ233)、オート閉作動を解除し(ステップ246)、リターンする。また、リモコン30の閉スイッチまたはドア閉スイッチ29の少なくとも一方がオンすると(ステップ234,235)、プッシュ・オン/プッシュ・オフ式の閉スイッチが再度オンされたことになるので、その位置でドア2を停止させるためにオート閉作動を解除し(ステップ246)、リターンする。
【0115】
(マニュアル閉作動ルーチン)
図21は、マニュアル閉作動ルーチン(ステップ126.183)の詳細を示すフローチャートである。このマニュアル閉作動ルーチンは、危険領域中でドア閉スイッチ29がオンしたことを確認すると、スイッチ文180で選択され、閉スイッチ29を操作者が押下中のみ閉作動になり、閉スイッチ29を離すとドア2を停止させるモードである。
【0116】
まず、挟み込み判定を実行する(ステップ247)。挟み込みがなければドア閉スイッチ29がオンされているか判断し(ステップ249)、オンされていればマニュアル閉作動を続行するためにリターンする。閉スイッチ29がオンされていなければマニュアル閉作動を解除し(ステップ255)、リターンする。マニュアル閉作動解除(ステップ255)によって電磁クラッチ16および開閉モータ14を制御し、ドア2を停止させる(ステップ106,107)。
【0117】
挟み込みを検出すると(ステップ247)、挟み込み有りを解除し(ステップ248)、反転方向に制御を移すためにドア閉作動を解除し、ドア開作動を許可し、マニュアル閉作動を解除し、逆転開作動を許可し、目標位置算出を実行して(ステップ250〜254)、リターンする。
【0118】
(逆転開作動ルーチン)
図22は、逆転開作動ルーチン(ステップ127,184)の詳細を示すフローチャートである。この逆転開作動ルーチンは、オート閉作動中(図20)、またはマニュアル閉作動中(図21)に、挟み込み有りの判定を得た場合に、算出した目標位置にドア2を反転移動させて停止させるモードで、ドア2の停止または反転作動を安全に制御するものである。
【0119】
まず、全開検出を行う(ステップ256)。全開検出はドア2の全開状態を判定するもので、この全開検出が終了すると、現在の位置計数値Nからドア2が算出した目標位置か判断する(ステップ257)。ドア2が目標位置でなく、メインスイッチがオンであり(ステップ259)、ドア2が全開位置でなく(ステップ260)、挟み込みもなく(ステップ262)、異常状態でもなく(ステップ264)、スイッチ受付可能状態であり(ステップ266)、リモコン閉スイッチおよびドア閉スイッチが共にオフであれば(ステップ267,269)、逆転開作動中であるのでリターンする。
【0120】
ドア2が目標位置に達したとき(ステップ257)、あるいはメインスイッチがオフのとき(ステップ259)は、逆転開作動を解除し(ステップ258)、リターンする。ドア2が全開位置であればドア全開検出を解除し(ステップ260,261)、挟み込みを検出すれば挟み込み有りを解除し(ステップ262,263)、モータロックなどの異常状態を検出すれば異常状態検出を解除し(ステップ264,265)、それぞれ逆転開作動を解除して(ステップ258)、リターンする。逆転開作動解除(ステップ258)によって電磁クラッチ16および開閉モータ14を制御し、メインルーチンでドア2を停止させる(ステップ106,107)。
【0121】
また、スイッチ受付可能状態(各開閉スイッチがいずれもオフ)のときにリモコン30の閉スイッチまたはドア閉スイッチ29がオンされた場合は(ステップ267,269)、逆転開作動を解除し(ステップ258)、開閉モータ14を停止してリターンする。
【0122】
スイッチ受付可能状態でないときは(ステップ266)、各開閉スイッチのオン/オフ状態を確認し、開閉スイッチが全てオフでなければ(ステップ268)、そのままリターンし、開閉スイッチが全てオフであれば、スイッチ受付可能状態にセットし(ステップ270)、リターンする。これは、例えばマニュアル閉作動中に挟み込みがあって逆転した場合は、ドア閉スイッチ29が押下中の場合があるためで、そのような場合でもこのモードを継続させるためである。
【0123】
(逆転閉作動ルーチン)
図23は、逆転閉作動ルーチン(ステップ128,185)の詳細を示すフローチャートである。この逆転閉作動ルーチンは、オート開作動中(図19)に挟み込み有りの判定を得て算出した目標位置に、ドア2を反転移動させて停止させるモードで、ドア2の停止または反転作動を安全に制御するものである。
【0124】
まず、現在の位置計数値Nからドア2が目標位置か、または危険領域(エリア2〜4)か判断する(ステップ271,273)。ドア2の現在位置がいずれでもなく、メインスイッチがオンであり(ステップ274)、挟み込みもなく(ステップ275)、異常もなく(ステップ277)、スイッチ受付可能状態であり(ステップ279)、リモコン開スイッチおよびドア開スイッチが共にオフであれば(ステップ280,283)、逆転閉作動中であるのでリターンする。
【0125】
ドア2が目標位置または危険領域(ステップ271,273)であり、あるいはメインスイッチがオフであれば(ステップ274)、逆転閉作動を解除し(ステップ272)、リターンする。逆転閉作動解除(ステップ272)によって電磁クラッチ16および開閉モータ14を制御し、メインルーチンでドア2を停止させる(ステップ106,107)。
【0126】
また、挟み込みを検出したときは挟み込み有りを解除し(ステップ275,276)、モータロックなどの異常を検出したときは異常状態検出を解除し(ステップ277,278)、それぞれ逆転閉作動を解除して(ステップ272)、リターンする。
【0127】
また、スイッチ受付可能状態(各開閉スイッチがいずれもオフ)のときにリモコン30の開スイッチまたはドア開スイッチ28がオンされた場合も(ステップ280,283)、逆転開作動を解除し(ステップ272)、リターンする。
【0128】
スイッチ受付可能状態でないときは(ステップ279)、開閉スイッチが全てオフでなければ(ステップ281)、そのままリターンし、開閉スイッチが全てオフであれば、スイッチ受付可能状態にセットし(ステップ282)、リターンする。これは、オート開作動中に挟み込みがあって逆転した場合、ドア開スイッチ28が押下中の場合があるためで、そのような場合でもこのモードを継続させるためである。
【0129】
(目標位置算出ルーチン)
図24は、目標位置算出ルーチン(ステップ202,226,254)の詳細を示すフローチャートである。この目標位置算出ルーチンは、オート開作動(図19)またはオート閉作動(図20)、マニュアル閉作動(図21)において、挟み込み検出時にドア2をそれまでの移動方向から反転させ、安全な位置まで逆転させる際の目標位置を算出するルーチンである。
【0130】
まず、ドア2の移動方向を判別する(ステップ284)。ドア2が開方向に作動中と判別されると、ドア2の現在位置がエリア3,4か判別する(ステップ285A)。ドア2の位置がエリア3,4であれば、ドア2の現在位置を目標位置とする(ステップ285C)。これは開作動中の挟み込み発生時の逆転閉作動においては、再度挟み込みが発生する危険があるので、逆転閉作動はエリア3,4では行わないようにしており、現在位置を目標位置とする。
【0131】
ドア2の位置がエリア3,4以外であれば、位置計数値Nで示される現在位置の値から予め指定された移動量を減算し、目標位置の値とする(ステップ285B)。しかし、目標位置の値がエリア3以下の危険領域であれば(ステップ289)、エリア2とエリア3との境界値(N=350)を目標位置とする(ステップ290)。
【0132】
ドア2が閉方向に作動中と判別されると、位置計数値Nで示される現在位置の値に予め指定された移動量を加算し目標位置の値とする(ステップ286)。この目標位置の値が全開位置の値(N=850)を越えた場合は(ステップ287)、全開位置の値を目標位置とする(ステップ288)。
【0133】
(全開検出ルーチン)
図25は、全開検出ルーチン(ステップ130,200,256)の詳細を示すフローチャートである。この全開検出ルーチンは、初期動作時にはドア2の全開位置の位置計数値Nを認識して記憶し、それ以降はオート開作動時(図19)、または逆転開作動時(図22)において、ドア2が全開状態に達したことを検出するルーチンである。
【0134】
まず、初期動作時にはドア2を全閉位置(N=0)から移動させ、位置計数値Nの値がエリア7内に達すると(ステップ291)、全開位置データが既に認識されているか判断する(ステップ292)。初期動作時には認識されていないのでドア2が全開位置で停止したか判断し(ステップ293)、全開位置で停止していなければリターンし、停止していればそのときの位置計数値Nを取り出す(ステップ295)。
【0135】
次いで、そのときの位置計数値Nから全開マージン(任意値)を差し引き、それを全開認識値として所要のメモリ部に記憶する(ステップ296,297)。全開マージンは、ドア2の開動作中に全開位置と認識してドア2を停止しても若干の移動が生じるので、その移動量を見込んで全開位置の手前になるように設定している。こうして全開認識値が設定されると、ドア全開状態を検出し(ステップ298)、リターンする。
【0136】
全開認識値設定以降は、位置計数値Nがエリア7に達すると(ステップ291)、全開位置データが既に認識されているので(ステップ292)、位置計数値Nが全開認識値に達するとドア全開状態を検出し(ステップ298)、リターンする。
【0137】
(スタートモード)
図26は、スタートモードルーチン(ステップ117,176)の詳細を示すフローチャートである。このスタートモードは各スイッチのオン/オフ状態や周囲の状況等に応じてドア2を起動するためのモードを選択し、スタートさせる処理である。
【0138】
まず、スタート識別子がセットされているか判断する(ステップ299)。当初はセットされていないので、手動モードか判断する(ステップ301A)。手動モードであれば全閉−ドア開手動状態か判断し(ステップ301B)、そうであれば手動全閉スタートモードにセットし(ステップ302A)、そうでなければ手動通常スタートモードにセットし(ステップ302B)、それぞれ手動モードを解除する(ステップ303)。
【0139】
手動モードでなければドア開作動か判断し(ステップ304)、ドア開作動であればACTR制御領域か判断し(ステップ305)、ACTR制御領域であればACTRスタートモードにセットする(ステップ306)。ドア開作動でなく、あるいはドア開作動であってもACTR制御領域でなければ通常スタートモードにセットする(ステップ307)。こうしてスタート別の識別子をセットするとオートスライドモード作動計数値Gをクリアし(ステップ308)、リターンする。各スタートモードの設定条件をまとめると次のようになる。
【0140】
通常スタートモード :全閉以外時にスイッチ操作でスタート
ACTRスタートモード:全閉時にスイッチ操作でスタート
手動通常スタートモード:全閉以外時に手動操作でスタート
手動全閉スタートモード:全閉時に手動操作でスタート
こうしてスタート別の識別子がセットされ、次のルーチンでスタートモードが選択されると、スタート別の識別子がセットされているので(ステップ299)、識別子に応じ(ステップ300)、通常スタートモード(ステップ309)、ACTRスタートモード(ステップ310)、手動通常スタートモード(ステップ312A)、手動全閉スタートモード(ステップ312B)を実行する。
【0141】
通常スタートモードは、ドア全閉領域外でのスタート時の制御をする。最初に電磁クラッチ16オンにし(ステップ106)、開閉モータ14とドライブプーリ15とをつなぐ。電磁クラッチ16のオンタイムラグ後に、オートスライド作動可能にセットし、開閉モータ14をオンする(ステップ107)。その後、開閉モータ14がオンしたときに、作動別スタート識別子をリセットし、作動別スタート制御の終了を他のルーチンに知らせる。
【0142】
ACTRスタートモードは、ACTR35を介してドアロックのラッチ8とストライカ9との係合を解除した後、ドア2を自動駆動するスタートモード時の制御をする。ハーフラッチスイッチ36がオフしているのを一定時間確認後、電磁クラッチ16をオンにする(ステップ106)。電磁クラッチ16のオンタイムラグ経過後、オートスライド作動中にする。その後、開閉モータ14のオンのときに(ステップ107)、作動別スタート識別子をリセットし、作動別スタート制御の終了を他のルーチンに知らせる。
【0143】
手動通常スタートモードおよび手動全閉スタートモードについては後述する。識別子がリセットされ、次のルーチンで再びスタートモードが選択されると、スタートモードを解除し(ステップ313,314)、作動計数値Gをクリアし(ステップ315)、リターンする。
【0144】
(手動通常スタートモード)
図27は、手動通常スタートモード(ステップ312A)を示すフローチャートである。この手動通常スタートモードは、ドア2が全閉状態でないときに手動操作を検知して、ドア2を開方向または閉方向にオートモードで駆動するものである。
【0145】
まず、オートスライド用の開閉モータ14が作動状態か判断する(ステップ316)。最初は作動状態ではないので、後述するPWM制御によって定められるモータ駆動電圧にセットする(ステップ318)。次いで、ドア2の作動方向を判別し(ステップ326)、開作動であればドア開作動可にセットしてモータ14を開方向に駆動するように準備する(ステップ327)。閉作動であればドア閉作動可にセットしてモータ14を閉方向に駆動するように準備する(ステップ328)。また、開方向の場合は(ステップ327)、ACTR領域か判別し(ステップ329)、ACTR領域でなければリターンし、ACTR領域であればACTR作動可にセットする(ステップ330)。
【0146】
開閉モータ14が作動状態であれば(ステップ316)、作動計数Gによって手動タイムラグが過ぎているか判断する(ステップ317)。過ぎていなければリターンし、過ぎていれば手動によるドア2の移動速度がドア急閉速度より速いか判断する(ステップ319)。ドア2の移動速度がドア急閉速度よりも遅ければ、次に手動認識速度より遅いか判断する(ステップ320)。遅くなければクラッチ作動可にセットし(ステップ322)、クラッチ作動後のドア作動時間を計測するために作動計数Gをクリアし(ステップ323)、手動通常スタートモードを解除して(ステップ324)、リターンする。
【0147】
手動によるドア2の移動速度がドア急閉速度より速い場合(ステップ319)は、そのまま手動によるドア急閉作動を優先させるために、ドア急閉作動可にセット(ステップ321)し、異常状態にセットしてモータを停止するようにし(ステップ325)、手動通常スタートモードを解除して(ステップ324)、リターンする。
【0148】
また、ドア2の移動速度が手動認識速度より遅い場合も(ステップ320)、オートモードに移行しないために、異常状態にセットし(ステップ325)、手動通常スタートモードを解除して(ステップ324)、リターンする。異常状態にセットすると、オート開作動やオート閉作動の各ルーチンにおいて異常状態が検出されて作動が解除され、ストップモードとなってモータが停止する。
【0149】
(手動全閉スタートモード)
図28は、手動全閉スタートモード(ステップ312B)を示すフローチャートである。この手動全閉スタートモードは、ドア2が全閉状態のときに手動操作を検知して、ドア2を開方向にオートモードで駆動するものである。
【0150】
まず、ドア2が開方向に移動しているかをパルス信号φ1,φ2の位相関係によって検出する(ステップ330A)。開方向に移動していれば、後述するPWM制御によって定められるモータ駆動電圧にセットし(ステップ330B)、次いでドア開作動可にセットして開方向にモータ14を開方向に駆動するように準備し(ステップ330C)、さらにACTR作動可にセットする(ステップ330D)。
【0151】
次いで、ハーフスイッチのオフを念のために確認し(ステップ330E)、オフであればクラッチ作動可にセットして電磁クラッチ16を駆動するように準備し(ステップ330F)、クラッチ作動後のドア作動時間を計測するために作動計数Gをクリアし(ステップ330G)、手動全閉スタートモードを解除して(ステップ330H)、リターンする。
【0152】
ドア2が開方向に移動していなければ(ステップ330A)、このモードは不要であるので、異常状態にセットしてモータを停止するようにし(ステップ330I)、手動全閉スタートモードを解除して(ステップ330H)、リターンする。ハーフスイッチがオフの場合もドアロックが再嵌合したおそれがあるので、異常状態にセットし(ステップ330I)、手動全閉スタートモードを解除し(ステップ330H)、リターンする。
【0153】
なお、ACTRの作動を最初とするシステムも考えられるが、この場合はドアハンドルスイッチ37aがオンとなると、まずACTRが作動するので、ACTRが解錠するので、小さい力でロックを解錠できる。
【0154】
(速度制御ルーチン)
図29は、速度制御ルーチン(ステップ120,178)の概要図である。この速度制御ルーチンは、スライドドア2の速度が前述した各制御領域E1〜E6毎に定められている適正移動速度になるように現在の移動速度に対する制御目標値を定め、それによってスライドドア2の速度を制御するものである。本実施の形態では、スライドドア2の速度制御は開閉モータ14に印加する矩形波電圧のデューティサイクルを変化させることによって、つまりパルス幅変調(PWM)によって開閉モータ14の出力トルクを調整するようにしているので、以下ではPWM制御として説明する。
【0155】
このPWM制御(ステップ331)には、目標値の決定(ステップ332)、適合計算(ステップ333)、フィードバック調整(ステップ334)があり、適合計算(ステップ333)の下位レベルに差計算(ステップ335)があり、フィードバック調整(ステップ334)の下位レベルに調整量の算出(ステップ336)がある。
【0156】
図30は、目標値の決定(ステップ332)、適合計算(ステップ333)、差計算(ステップ335)、調整量の算出(ステップ336)の各部分の機能をブロック図で示したものである。同図において、ドア位置検出部60はロータリーエンコーダ18からのパルス信号φ1,φ2から位置計数値Nおよび移動方向Zを求める。
【0157】
制御領域弁別部61aは位置計数値Nおよび移動方向Zからドア2がそのとき存在するエリア1〜7を求め、このエリア1〜7によって図16に示すメモリテーブルを参照し、対応する制御領域E1〜E6を判別する。そして、各制御領域E1〜E6にそれぞれ所要されるスライドドア2の適正移動速度に対応した周期計数値T1〜T6を求める。
【0158】
制御速度選択部61bでは、判別した制御領域Ei(i=1〜6)の適正移動速度に対応した適性速度周期計数値To(T1〜T6)を求め、かつその制御領域における最高移動速度に対応する最高速度周期計数値Tmin と、最低移動速度に対応する最低速度周期計数値Tmax とを求める。制御領域弁別部61aおよび制御速度選択部61bによって目標値の決定(ステップ332)の機能を達成している。
【0159】
制御速度選択部61bで求めた制御領域Eiの適正速度周期計数値Toは調整量算出部62に送られ、フィードバックの調整量Rを求めるために使用される。その詳細は後述する。調整量算出部62で求めたフィードバックの調整量Rは、上限値を設定する最大調整量制限部63に送られる。調整量算出部62および最大調整量制限部63によって調整量の算出(ステップ336)の機能を達成している。
【0160】
ドア移動速度検出部64はパルスカウントタイマー(ステップ115A)に相当し、割り込みパルスg1の発生間隔毎のクロックパルスC1を計数し、その時点の計数値を移動速度周期計数値Txとして求めている。この逆数がスライドドア2の現在の移動速度となる。
【0161】
移動速度周期計数値Txは速すぎ検出部65および遅すぎ検出部66に入力される。また、速すぎ検出部65には最高速度周期計数値Tmin が入力され、遅すぎ検出部66には最低速度周期計数値Tmax が入力されている。速すぎ検出部65および遅すぎ検出部66によって適合計算(ステップ333)の機能を達成している。
【0162】
速すぎ検出部65は現在の移動速度を表す周期計数値Txから最高速度周期計数値Tmin を差計算部65aで減算し、速すぎ量THを求める。それを2段のシフトレジスタ等による一時保留部65b,65cに送り込む。そして、前段の一時保留部65cには抽出時期が1つ前の速すぎ量TH2を保留し、後段の一時保留部65bには現時点または前段の抽出時期に連続した1つ後の速すぎ量TH1を保留する。この2つの速すぎ量TH1,TH2は修正量演算部65dで加算され、速すぎ適合差JNHとして出力される。
【0163】
同様に、遅すぎ検出部66は現在の移動速度を表す周期計数値Txから最低速度周期計数値Tmax を差計算部66aで減算し、遅すぎ量TLを求める。それを2段のシフトレジスタ等による一時保留部66b,66cに送り込む。そして、前段の一時保留部66cには抽出時期が1つ前の遅すぎ量TL2を保留し、後段の一時保留部66bには現時点または前段の抽出時期に連続した1つ後の遅すぎ量TL1を保留する。この2つの遅すぎ量TL1,TL2は修正量演算部66dで加算され、遅すぎ適合差JNLとして出力される。差計算部65a,66bによって差計算(ステップ335)の機能を達成している。
【0164】
速すぎ検出部65の速度判別部65eは、現在の周期計数値Txが周期計数値Tmin よりも大きいと判別した場合、すなわち現在の移動速度が最高速度よりも遅いと判別した場合は、一時保留部65b,65cの保留内容を零にリセットする。同様にして遅すぎ検出部66の速度判別部66eは、現在の周期計数値Txが周期計数値Tmax よりも小さいと判別した場合、すなわち現在の移動速度が最低速度よりも速いと判別した場合は、一時保留部65b,65cの保留内容を零にリセットする。
【0165】
こうして、スライドドア2の現在の移動速度が速すぎず、または遅すぎないときは、一時保留部の保留内容を零にリセットする。これにより、修正量演算部65d,66dに速すぎ量TH1,TH2または遅すぎ量TL1,TL2が2つ揃って引き渡されるには、速すぎまたは遅すぎが2度引き続いて生じなければならないことになり、これによって誤検出を防止するようにしている。
【0166】
速すぎ適合差JNHおよび遅すぎ適合差JNLは、フィードバック調整部67および調整量算出部62に送られる。調整量算出部62では、両適合差JNH,JNLをまとめて適合差JN として扱い、制御速度選択部61bで得られた適性速度周期計数値Toを識別子として調整量Rの算出式を選択し、調整量Rを求めている。例えば、周期計数値ToがTaならば調整量Rは3倍の適合差JN 、すなわち、R=3JN 、同様に周期計数値ToがTbならば、R=2JN 、周期計数値ToがTcならば、R=JN 、周期計数値ToがTa,Tb,Tcのいずれでもなければ、R=3JN とする。
【0167】
Ta,Tb,Tc,は任意の大きさの値でよいが、実質的は図16に示す注目度の高い領域や危険領域に設定されている適正移動速度に応じるのが好ましい。また、調整量Rを算出する倍率係数は、ドア2の移動軌跡の曲線部や直線部等に応じてフィードバック制御に適する所要の値を設定する。また、調整量Rは最大調整量制限部63で上限値(D1)が制限されるとともに、後述するデューティの値Dに変換され、そのデューティ値Dはフィードバック調整部67に入力される。
【0168】
電源電圧検出部68はバッテリー24の電圧Vxを計測している。電圧Vxのときに所要電圧相当VoのデューティサイクルDoを求めるのがデューティ演算部69である。所要電圧Vo相当のデューティサイクル(以下、デューティ、という)Doとは、テューティ100%の電圧波形、すなわち直流電圧Voを印加したときの出力トルクと、その直流電圧Voより高い任意の電圧Vxを印加して同じ出力トルクを得るためのデューティDoのことで、次式で表される。
【0169】
Do[%]=(Vo/Vx)・Dmax [%]
ただし、モータに流れる電流値は一定としている。なお、デューティ100%はHレベルの直流電圧波形に相当しDmax と表し、デューティ0%はLレベルの直流電圧波形に相当しDmin と表す。
【0170】
すなわち、デューティ演算部69はバッテリー24の電圧変動を電源電圧検出部68が測定電圧Vxとして検出し、その電圧Vxと所要電圧Voとから前記計算式に基づいて所要電圧Vo相当のデューティDoを求める。さらに、デューティ演算部69は所要電圧Voより上方または下方に1V[ボルト]変化したときのデューティの変化量を求め、これを1V相当デューティD1としている。そして、所要電圧Vo相当のデューティDoと1V相当デューティD1とは、フィードバック調整部67に入力している。
【0171】
なお、デューティ演算部69は電流の変化分を含まない1次の計算式で求めているが、電流の変化分やモータの負荷特性を含めて電源電圧変動に対するデューティDの修正値D’を予めメモリーマップにしておいて、電源電圧Vxでアドレスして求めることもできる。
【0172】
図31に示すグラフは、モータに流れる電流を一定としたときの電圧変動とデューティDの関係を示すもので、横軸に電圧Vx、縦軸にデューティDを取っている。車両用のバッテリー24は最大電圧Vmax を16V、最小電圧Vmin を9Vとしており、その間の電圧変化に対応してデューティを決めている。
【0173】
(PWM制御ルーチン)
図32は、PWM制御ルーチン(ステップ331)の詳細を示すフローチャートである。このPWM制御ルーチンは、スライドドア2が開閉モータ14によって駆動されているときに、エリア毎に定められた目標速度に一致するようにモータ14の駆動電圧のデューティDをPWM制御によって調整する制御で、機構部の遅れ等を考慮してフィードバック調整を行うまでの時間Fをエリア別に調整するようにしている。
【0174】
まず、PWM目標値が有るか判定し(ステップ337)、目標値が求まってないときは目標値の決定を行い(ステップ339)、リターンする。目標値の決定は制御領域弁別部61aおよび制御速度選択部61bで行う。
【0175】
目標値が求まっている場合は、フィードバック計数Fが最大か調べ(ステップ338)、最大でなければ増計数し(ステップ340)、最大であればステップ340をジャンプする。フィードバック計数Fはタイマーとして機能し、後述するようにこの計数Fが一定値に達したときにフィードバック調整を行うようにしている。最大値MAXは、例えば10以上の値である。
【0176】
次いで、速すぎ検出部65および遅すぎ検出部66によって適合度を計算し(ステップ341)、低速差データ、すなわち遅すぎ量TLがあるか検出する(ステップ342)。遅すぎ量TLがあれば低速度数Lを増計数する(ステップ343)。遅すぎ量TLがなければ低速度数Lをクリアする(ステップ344)。
【0177】
次いで、エリア3であれば(ステップ345)、フィードバック計数Fの値が5以上か調べ(ステップ346)、フィードバック計数Fの値が5以上でなければリターンする。エリア4のときもリターンする(ステップ345,347)。エリア3でなくエリア4でもないとき、すなわちエリア1,2,5,6,7のときはフィードバック計数Fの値が10以上か調べ(ステップ348)、フィードバック計数Fの値が10以上でなければリターンする。
【0178】
エリア3でフィードバック計数Fの値が5以上のとき(ステップ346)、あるいはエリア1,2,5〜7でフィードバック計数Fの値が10以上のとき(ステップ348)は、後述するフィードバック調整を行い(ステップ349)、その結果、デューティを調整したのであればフィードバック計数Fをクリアし(ステップ351)、リターンする。デューティを調整しなかったのであればそのままリターンする。
【0179】
この結果、エリア3のような曲線部ではスライドドア2の速度が低下するおそれがあるので、他のエリアよりも調整間隔を狭めてフィードバック調整をするようにしている。具体的には、メインルーチンのループ周期を10msecとすれば、エリア3では50msec間隔、エリア1,2,5〜7では100msec間隔で行うようにしている。
【0180】
(フィードバック調整ルーチン)
図33は、フィードバック調整ルーチン(ステップ334,349)の詳細を示すフローチャートである。このフィードバック調整ルーチンは、2回以上連続して遅すぎ量TL、速すぎ量THが発生したときに、スライドドア2の速度が目標速度になるようにデューティ(DUTY)調整を行うものである。
【0181】
まず、遅すぎ検出部66の一時保留部66b,66cに遅すぎ量TL1,TL2があるか調べ(ステップ352)、無ければ速すぎ検出部65の一時保留部65b,65cに速すぎ量TH1,TH2があるか調べる(ステップ353)。両方なければフィードバック調整は不要なので調整量Rをクリアし(ステップ356)、リターンする。
【0182】
一時保留部65b,65cに速すぎ量TH1,TH2があれば、この2つの速すぎ量TH1,TH2を加算して速すぎ適合差JNHを求め(ステップ355)、調整量算出部62および最大調整量制限部63で調整量Rを算出する(ステップ357)。次いで、前のルーチンで調整量があったか調べ(ステップ358)、それが増速であれば(ステップ359)、今回の調整量Rは半分の値に設定する(ステップ360)。これは、前回は遅すぎて調整量を加算し、今回は速すぎて調整量を減算するので、調整量が大きいと再度遅すぎになる可能性が高いためである。
【0183】
前のルーチンで調整量がない場合、前回は増速でなかった場合、調整量Rを半分の値に設定した場合(ステップ358〜360)は、それぞれ現在のデューティDから調整量R(これもデューティ)を減算して新たなデューティDNEW を求め(ステップ361)、この新たなデューティDNEW を出力し(ステップ362)、リターンする。これによって開閉モータ14はこの新たなデューティDNEW を有する矩形波電圧によって減速駆動される。
【0184】
一時保留部66b,66cに遅すぎ量TL1,TL2がある場合(ステップ352)は、ドア2の現在位置が開方向(エリア5〜7)か閉方向(エリア1〜4)かを調べる(ステップ353)。これは、閉方向は挟み込みの可能性があるため単純にはフィードバック調整によって増速駆動できないためである。
【0185】
すなわち、閉方向であれば、低速カウンタが所定のタイムラグをカウントしたか判断し(ステップ364A)、所定のタイムラグが過ぎていなければリターンする。所定のタイミラグが過ぎていれば、負荷の学習がない初期状態か判断する(ステップ364B)。初期状態でなく、学習値が増加傾向の場合は(ステップ364C)、後述する挟み込み判定でエラーが有れば(ステップ364E)、挟み込みの可能性があるのでリターンする。
【0186】
また、学習値は増加傾向ではないが(ステップ364C)、電流値が上昇傾向であって(ステップ364D)、かつ継続している場合は(ステップ365)、挟み込みの可能性があるのでリターンする。
【0187】
それ以外の場合、すなわち、エラーが無い場合(ステップ364E)、電流値が上昇傾向で無い場合(ステップ364D)、電流値の上昇が継続していない場合は(ステップ365)、挟み込みの可能性はないとして増速駆動のフィードバック調整を行う。もちろん、ドア2が開方向の場合(ステップ353)や初期状態の場合(ステップ)も増速駆動のフィードバック調整を行う。
【0188】
増速駆動のフィードバック調整は、まず、2つの遅すぎ量TL1,TL2を加算して遅すぎ適合差JNLを求めてメモリに格納し(ステップ366,367)、調整量算出部62および最大調整量制限部63で調整量Rを算出する(ステップ368)。次いで、前のルーチンで調整量があったか調べ(ステップ369)、それが減速であれば(ステップ370)、今回の調整量Rを半分の値に設定する(ステップ371)。これは、前回は速すぎて調整量を減算し、今回は遅すぎて調整量を加算するので、調整量が大きいと再度速すぎになる可能性が高いためである。
【0189】
前のルーチンで調整量がない場合、前回は減速でなかった場合、調整量Rを半分の値に設定した場合(ステップ369〜371)は、それぞれ現在のデューティDから調整量R(これもデューティ)を加算して新たなデューティDNEW を求め(ステップ372)、この新たなデューティDNEW を出力し(ステップ362)、リターンする。これによって開閉モータ14はこの新たなデューティDNEW を有する矩形波電圧によって増速駆動される。
【0190】
(挟み込み判定ルーチン)
図34は、挟み込み判定ルーチン(ステップ118,177)の概要を示す図である。この挟み込み判定ルーチンは、スライドドア2の開閉駆動中に異物の挟み込みを検出するものである。この検出結果に基づいて開閉駆動中のドア2を逆転作動させる契機とし、安全性を確保するようにしている。
【0191】
この挟み込み判定ルーチンには、後に詳述する学習判定(ステップ374)、継続&変化量(ステップ375)、総合判定(ステップ376)等のルーチンがある。また、学習判定(ステップ374)の下位レベルには、学習アドレス演算(ステップ377)、エラー判定(ステップ378)、学習重み付け(ステップ379)、平均値算出(ステップ380)、比較値生成(ステップ381)、学習処理(ステップ382)、学習遅延処理(ステップ383)等の各ルーチンがある。さらに比較値生成(ステップ381)の下位レベルには、比較値計算(ステップ384)のルーチンがある。
【0192】
図35は、挟み込み判定ルーチン(ステップ373)を示すフローチャートである。各ルーチンの詳細については後述するが、まず、サンプリング領域毎のモータ負荷の変化率の学習が済んでいるか判定する(ステップ385)。済んでいなければ、その学習処理および学習遅延処理を実行し(ステップ386A,386B)、リターンする。
【0193】
学習処理が済んでいれば、ストップモードか判定し(ステップ387)、ストップモードであればドア2を停止させているのでリターンする。ストップモードでなければ学習判定(ステップ388)を行う。次いで、モータ電流値の変化量と上昇継続時間を検出する継続&変化量処理(ステップ389)を行う。続く総合判定(ステップ390)では、学習判定(ステップ388)で得た判定、および継続&変化量処理(ステップ389)で得たモータ電流値の変化量や上昇継続時間等から挟み込みの有無の判定を下す。
【0194】
(挟み込み判定の機能ブロック図)
図36は、挟み込み判定ルーチンの機能を示すブロック図である。同図において、サンプリング領域演算部70、サンプリング領域の負荷データ演算部72および記憶用学習データ演算部75は、スライドドア2の開閉による標準の負荷抵抗成分(その変化率を含む)を、モータ14に流れる電流値IN に基づき抽出し、ドア2の開閉状況とその位置とに固有のサンプリング領域Qn(またはQm、以下同)に対応させて負荷サンプルデータメモリ71に記憶する。
【0195】
1つのサンプリング領域Qnについて記憶される負荷抵抗成分は、そのサンプリング領域Qnの中の分解能Bの数だけ含まれる電流値IN の平均電流値IAnによる前後のサンプリング領域間の電流増加率ΔIAnとしている。
【0196】
そして、通常のドア2の開閉に際し、同一サンプリング領域Qnごとに記憶された標準の負荷抵抗成分と現在の負荷抵抗成分とを、挟み込み判定部85で比較し、挟み込みの有無を検出している。そして、サンプリング領域Qnに応じてメモリ71に記憶される負荷抵抗成分は、ドア2の開閉操作があるたびに新たな負荷抵抗成分に基づいて修正され、学習更新される。
【0197】
挟み込み判定部85は、そのほかに電流計測部73で計測した電流値IN と、前回電流値メモリ部86に記憶されている前回電流値I'Nおよび今回電流値IN から変化量算出部87で求めた電流増加値ΔIと、電流増加回数計数部88が出力する増加回数値Kと、坂道検出部89からの傾斜判定データθとに基づいて挟み込み判定を行う。判定動作の詳細については後述する。
【0198】
(サンプリング領域演算部70)
サンプリング領域演算部70は、ドア位置検出部60から供給される位置計数値Nおよび移動方向Zから、エリア1〜7(図16)に定められた分解能Bに応じてパルス信号φ1を間引いて計数した計数値n(またはm)に基づいてサンプリング領域Qn (またはQm)のアドレスを定める。
【0199】
計数値nは分解能Bに応じて閉方向に間引きして計数した値であり、計数値mは開方向に間引きして計数した値である。それぞれドア2の位置を示すアドレス番号を表す。アドレス番号nはドア2が閉じられる方向に付設した番号なので、ドア2が閉じるときには減計数する。従って、移動中のドア2の1つ前のアドレス番号はn+1となる。これに対し、アドレス番号mはドア2が開く方向に付設した番号なので、移動中のドア2の1つ前のアドレス番号はm−1となる。
【0200】
アドレス番号n,mと、分解能Bと、位置計数値Nとの関係は、
N/B=n+b
N/B=m+b (n,mは商の整数部、bは商の余り)
と表される。
【0201】
アドレス番号n,mは負荷サンプルデータメモリ71のアドレスとなり、余りbは負荷データ演算部72において分解能Bの数と同じ数のレジスタを備えた電流値記憶レジスタ74のデータをシフトするために作用する。
【0202】
(負荷サンプルデータメモリ71)
負荷サンプルデータメモリ71は、サンプリング領域演算部70からのアドレス番号n,mで指定されるサンプル領域Qn,Qmの記憶データをなす平均電流値IAn,IAmを予測比較値演算部76へ出力するとともに、記憶用学習データ演算部75へも出力している。
【0203】
(負荷データ演算部72)
負荷データ演算部72は、分解能Bと同じ段数を有する電流値記憶レジスタ74に記憶されたモータ14の電流値IN を、各サンプリング領域Qn ,Qm 毎に平均値をとり、平均電流値IAnとして記憶用学習データ演算部75に出力する。電流値記憶レジスタ74には電流計測部73によって一定のインターバル毎(ステップ103)に計測された電流値IN が記憶されている。
【0204】
図37は、学習効果を考慮しない状態でのサンプリング領域Qn ,Qn-1 における前回記憶した平均電流値I'An ,I'A(n-1) と、今回求められた現在の平均電流値IAn,IA(n-1)とを表している。なお、ここではドア2の開閉状況はエリア2の減速制御領域E2(分解能Bが4)とし、かつ注目するサンプリング領域Qnと1つ後のサンプリング領域Qn-1 とにおけるパルス信号φ1毎の位置計数値Nに対応した電流値IN を示している。
【0205】
すなわち、サンプリング領域Qnの位置計数値N〜N-3に相当する今回の動作の電流値IN 〜IN-3 が電流値記憶レジスタ74に保留され、それらを加算平均したものが平均電流値IAnである。
【0206】
(記憶用学習データ演算部75)
記憶用学習データ演算部75は、図38に示すように、電流増加率演算部81、直前データ保留レジスタ82、学習データ遅延レジスタ83、学習値重み付け更新演算部84からなる。
【0207】
直前データ保留レジスタ82は、ドア2の閉移動方向(この例ではエリア2を想定しているため)に順次現れるサンプリング領域Qn(nは漸減する)における現在注目するサンプリング領域Qnの直前のサンプリング領域Qn+1 の平均電流値IA(n+1)を電流増加率演算部81に出力する。
【0208】
電流増加率演算部81は、負荷データ演算部72から送られてくる現在注目するサンプリング領域Qnの平均電流値IAnと、直前データ保留レジスタ82で遅延された直前のサンプリング領域Qn+1 の平均電流値IA(n+1)とを比較し、電流変化率ΔIAn(=IAn/IA(n+1))を求め、学習データ遅延レジスタ83に送っている。
【0209】
学習データ遅延レジスタ83は、学習結果の更新時期を若干遅らせるためのもので、段数は任意であるが、この例では7段とし、学習値重み付け更新演算部84に7個前のサンプリング領域Qn+7 の電流増加率ΔIA(n+7)を出力する。
【0210】
学習値重み付け更新演算部84は、現在のサンプリング領域Qn+7 に係る電流増加率ΔIA(n+7)と、それと同じアドレス番号n+7でアドレス指定される負荷サンプルデータメモリ71からの読み出しデータQn+7 とが、アドレスを一致されて入力される。
【0211】
すなわち、学習値重み付け更新演算部84は同一サンプリング領域について、予めデータメモリ71に記憶されている前回ドア駆動時の電流増加率Qn+7 に、今回得た最新の電流増加率ΔIA(n+7)を考慮して、次式に基づいて記憶データを学習更新させている。
【0212】
Q’n+7 =(3/4)×Q’n+7 +(1/4)×ΔIA(n+7)
一般式で書くと、
Q’n =(3/4)×Q’n +(1/4)×ΔIAn
となる。新旧データの割合は適宜変更できる。
【0213】
こうして新たに求められた記憶データ(電流増加率)Q'nは、負荷サンプルデータメモリ71に書き込みデータDLとして送られ、アドレス番号nをアドレスとして記憶され、記憶データの学習更新が行われる。
【0214】
なお、ここでは、負荷サンプルデータメモリ71からの読み出しデータ、すなわち記憶されたデータを表記するのに、本来ストアされている平均電流値I'An をもって表すのではなく、アドレス指定されたサンプリング領域Qnの方で表記し、演算等はそのサンプリング領域Qnのアドレス番号nで指定されたロケーションに記憶された平均電流値I'An のデータを使用するものとする。また、記憶用学習データ演算部75の出力データも、サンプリング領域Qnの形式で表記してある。
【0215】
(予測比較値演算部76)
予測比較値演算部76は、図39に示すように、予測値レジスタ77、閾値計算部78、比較値計算部79、予測比較値遅延レジスタ80からなり、負荷サンプルデータメモリ71から出力される現在のサンプリング領域Qnのアドレス番号nに対応した学習値Q'nよりも、ドア2の移動方向で4つ先方のサンプリング領域Qn-4 の挟み込み判別に所要される予測比較値Cn,Cmを挟み込み判定部85に出力する。
【0216】
予測値レジスタ77は、ドア2の現在のサンプリング領域Qn内で最初の電流値IN を計測した時点から、メインルーチンのループインターバルで現在までの各測定電流値を加算平均したサンプリング領域内の平均電流値IAnの最新のものが保留されている。
【0217】
閾値計算部78および比較値計算部79には、最新の電流値IN を得ているサンプリング領域Qnのアドレス番号nよりも、4つ後のアドレス番号n−4のサンプリング領域Qn-4 の記憶データ(電流増加率Q'n-4)を、負荷サンプルデータメモリ71から読み出して与えられている。
【0218】
閾値計算部78は、最新の制御領域内平均電流値IAnと、4つ後のアドレス番号n−4のサンプリング領域Q'n-4の記憶データとから、次式によって弁別の許容幅を決める閾値Fn-4 を計算する。
【0219】
Fn-4 =IAn×Q'n-1×Q'n-2×Q'n-3×Q'n-4×α
一般式で表すと、
Fn=IA(n+4)×Q'n+3×Q'n+2×Q'n+1×Q'n×α
となる。ただし、αは補正計数である。
【0220】
比較値計算部79では、これから出現するサンプリング領域Qn-4 の平均電流値IA(n-4)と比較する予測比較値Cn-4 が次式によって計算される。
【0221】
Cn-4 =IAn×Q'n-1×Q'n-2×Q'n-3×Q'n-4+Fn-4
一般式で表すと、
Cn=IA(n+4)×Q'n+3×Q'n+2×Q'n+1×Q'n+Fn
となる。
【0222】
比較値計算部79によって求められた予測比較値Cn-4 は、4段の予測比較値遅延レジスタ80を通過することにより、現在所要されるサンプリン領域Qnのアドレス番号nに対応するものと合致する。
【0223】
予測比較値演算部76において、最初の比較値生成時は、その比較値を予測比較値遅延レジスタ80の前段に入れ、それを4回繰り返し、4つ先の比較値まで求める。すなわち、
1つ先の予測値:Cn-1 =An ×Q'n-1
2つ先の予測値:Cn-2 =Cn-1 ×Q'n-2
3つ先の予測値:Cn-3 =Cn-2 ×Q'n-3
4つ先の予測値:Cn-4 =Cn-3 ×Q'n-4
である。
【0224】
(初期動作)
図36に示す挟み込み判定の各ブロックにおいて、初期状態では、負荷サンプルデータメモリ71の記憶内容は、車体1を前後左右に傾きのない平坦な場所で平常姿勢としておき、この平常姿勢においてドア2を開閉させ、各エリア毎のサンプル領域Qn,Qmの平均電流値IAn,IAmを求める。
【0225】
この初期状態において、記憶用学習データ演算部75で現在および直前の平均電流値の比から電流変化率ΔIAn,ΔIAmを求める。この電流変化率ΔIAn,ΔIAmは学習データ遅延シフトレジスタ83から学習値重み付け更新演算部84を素通りして負荷サンプルデータメモリ71の書き込みデータDLとして出力されるとともに、そのデータが記録されるアドレス番号はサンプリング領域演算部70で得られるその平均電流値IAn,IAmを求めたサンプル領域データQn,Qmのアドレス番号n,mで指定される。
【0226】
ここで、図34に示す挟み込み判定の各ルーチンと、図36に示す挟み込み判定の各ブロックとの関係について説明する。平均値算出ルーチン(ステップ380)は負荷データ演算部72および電流値記憶レジスタ74に対応している。比較値生成ルーチン(ステップ381)および比較値計算ルーチン(ステップ384)は、予測比較値算出部76に対応している。学習処理ルーチン(ステップ382)および学習遅延処理ルーチン(ステップ383)は、記憶用学習データ演算部75に対応している。継続&変化量ルーチン(ステップ375)は、前回電流値メモリ部86、変化量算出部87および電流増加回数計数部88に対応している。
【0227】
(学習判定ルーチン)
図40は、学習判定ルーチン(ステップ374)の詳細を示すフローチャートである。この学習判定ルーチンは、毎回電流値を加算し、エラー判定および学習重み付け(挟み込み認識)を行う。また、ドア2が移動してサンプリング領域が移り変わったときに、その領域の平均電流値の算出、比較値の算出、学習処理、学習遅延処理を行う。
【0228】
サンプリング領域が移り変わったことは、動き出しのサンプリング領域演算時の余り(位置計数値Nを分解能Bで割った余り)にドア2が動いた量のパルス数を加算し、分解能Bの数値8,4,2を越えたことをみて判断する。パルス数は毎回加算した時点でクリアする。また、サンプリング領域が移り変わった時点で分解能Bの数値を引き、再びカウントしていく。ただし、動き始めは、そのサンプリング領域の途中なので平均電流値が出せないため、サンプリング領域が切り替わった時点で電流値の加算を始める。そして、次にサンプリング領域が移り変わった時点で、平均電流値および比較値が出せるため、以後は毎回エラー判定が可能となる。
【0229】
まず、サンプリング領域番号が演算済みか判断する(ステップ392)。ドア2の動き出しでは演算済みでないので、演算する(ステップ394)。次いで、学習可能か判断する(ステップ393)。初回は学習可能状態でないので、次にドア2の位置はエリア1,5,6か判断する。
【0230】
エリア1,5,6であれば、分解能計数(サンプリング領域演算での余り)に周期レジスタ番号(動いたパルス数)を加算し、新たな分解能計数を求める(ステップ400)。次いで、動いたパルス数をカウントするために周期レジシタ番号をクリア(ステップ412)し、さらに分解能計数が8以下の場合(ステップ413)はリターンする。
【0231】
そして、次回以降も同様にして周期レジスタ番号を加算していき、8以上になると(サンプリング領域が移り変わると)、分解能計数から8を引き(ステップ414)、学習可能か判断する(ステップ415)。今の場合は学習可能でないので、学習可能にセットし(ステップ417)、電流値メモリおよび電流値レジスタ番号をクリアし(ステップ421C,422)、リターンする。
【0232】
次回は学習可能なので(ステップ393)、現在の電流値を記憶値に加算し(ステップ395)、電流レジスタ番号をインクリメントして電流値の加算回数をカウントし(ステップ396)、エラー判定可能か判断する(ステップ397A)。今の場合はエラー判定可能ではないので、ステップ399にジャンプする。そして、ステップ400〜415の処理を実行し、今度は学習可能であるので(ステップ415)、平均値算出(ステップ416)、比較値算出(ステップ418)、学習処理(ステップ419)、学習遅延処理(ステップ420)をそれぞれ実行し、エラー判定可能にセットして(ステップ421A,421B)、リターンする。
【0233】
次回からはエラー判定が可能なので(ステップ397A)、後述するエラー判定(ステップ397B)および学習重み付け(ステップ398)を実行する。また、サンプリング領域を越える毎に平均値算出(ステップ416)〜学習遅延処理(ステップ420)を行う。
【0234】
ドア2の位置がエリア1からエリア2に切り替わると(ステップ399,401)、分解能計数が4を越えているか判断する(ステップ402)。これは、エリアが切り替わった初回はその前のエリア1の最後のサンプリング領域の平均値等を算出するためである。分解能計数が4を越えていればステップ400以降の処理に移行する。
【0235】
分解能計数が4を越えていなければ、分解能計数に周期レジスタ番号を加算し、新たな分解能計数を求め(ステップ408)、動いたパルス数をカウントするために周期レジシタ番号をクリアし(ステップ409)、さらに分解能計数が4未満の場合は(ステップ410)リターンし、4以上になると分解能計数から4を引き(ステップ411)、ステップ415以降の処理に移行する。
【0236】
ドア2の位置がエリア2からエリア3に切り替わると(ステップ399,401)、分解能計数が2を越えているか判断する(ステップ403)。これは、エリアが切り替わった初回はその前のエリア2の最後のサンプリング領域の平均値等を算出するためである。分解能計数が2を越えていればステップ402以降の処理に移行する。
【0237】
分解能計数が2を越えていれば、分解能計数に周期レジスタ番号を加算し、新たな分解能計数を求め(ステップ404)、動いたパルス数をカウントするために周期レジシタ番号をクリアし(ステップ405)、さらに分解能計数が2未満の場合は(ステップ406)リターンし、2以上になると分解能計数から2を引き(ステップ407)、ステップ415以降の処理に移行する。
【0238】
(エラー判定ルーチン)
図41は、エラー判定ルーチン(ステップ378,397)の詳細を示すフローチャートである。このエラー判定ルーチンは、現在の電流値IN と予測比較値Cnとを比較し、電流値IN が大なる回数をエラー回数として計数するものである。
【0239】
まず、現在の電流値IN と予測比較値Cnとを比較する(ステップ424)。電流値IN が大きければエラー回数を加算し(ステップ425)、同じか小さければエラー回数をクリアする(ステップ426)。これは、電流値IN が連続して大なるときのみ挟み込み有りとしているためである。
【0240】
(学習重み付けルーチン)
図42は、学習重み付けルーチン(ステップ379,398)の詳細を示すフローチャートである。この学習重み付けルーチンは、エリア1〜7に応じてエラー回数の重み付けを変え、挟み込み検出を有効に行うものである。
【0241】
まず、エラー回数がゼロか判断し(ステップ429)、ゼロであればリターンする。ゼロでなければ各エリアに応じてエラー回数の重み付けを行う。
【0242】
すなわち、エリア1,5〜7では(ステップ430)、エラー回数が3以上か判断し(ステップ431)、エリア2では(ステップ432)、エラー回数が2以上か判断し(ステップ433)、エリア3,4では(ステップ434)、エラー回数が1以上か判断する(ステップ435)。このように、閉方向の開始エリア1や開方向のエリア5〜7にくらべ、閉方向の危険領域のエリア2〜4ほど厳しい設定値としている。
【0243】
これらの判断の結果、現在の制御領域の電流値が増加傾向でない場合(ステップ427)や、増加傾向であってもエラー回数がエリア毎に設定された設定値より大きいときは、異常と判定して挟み込み検出を許可する(ステップ435)。現在の制御領域の電流値が増加傾向であっても、エラー回数が設定値よりも小さい場合はリターンする。
【0244】
(継続&変化量ルーチン)
図43は、継続&変化量ルーチン(ステップ375,389)の詳細を示すフローチャートである。この継続&変化量ルーチンは、電流値IN の変化量と上昇継続時間を測定して挟み込み検出を有効に行うものである。
【0245】
まず、電流値が増加傾向か判断し(ステップ436)、増加傾向であれば継続時間を計数するカウンタを加算し(ステップ437)、変化前電流値のデータが無い場合は(ステップ439)、前電流値を変化前電流値として格納し(ステップ440)、現在の電流値IN から変化前電流値を引いて電流値の変換量を求め(ステップ441)、リターンする。電流値が増加傾向でない場合は(ステップ436)、継続時間を計数するカウンタをクリアし(ステップ438)、変化前電流値もクリアし(ステップ442)、リターンする。
【0246】
(総合判定ルーチン)
図44は、総合判定ルーチン(ステップ376,390)の詳細を示すフローチャートである。この総合判定ルーチンは、学習での判定、電流値の変化量および増加継続時間等の全てを加味したうえで挟み込み判定を行うものである。
【0247】
まず、現在の電流値が異常認識値以上か判断し(ステップ443)、異常認識値以上であれば異常状態にセットし(ステップ444)、リターンする。現在の電流値が異常認識値未満であれば(ステップ443)、学習判定で挟み込み検出が許可されているか判断し(ステップ445)、許可されていなければリターンする。
【0248】
挟み込み検出が許可されていれば(ステップ445)、電流値の増加する継続時間が設定最大値以上のとき(ステップ446A)、電流値の変化量が設定最大値以上のとき(ステップ446B)、継続時間が設定最小値以上であって変化量も設定値(ただし、最大値より小)以上のとき(ステップ447,448)は、それぞれ挟み込みがあったと判断して挟み込み処理済みにセットし(ステップ449)、リターンする。異常状態セット(ステップ444)、または挟み込み処理済みにセット(ステップ449)する。これにより、例えばオート閉作動中であれば、オート閉作動ルーチンによって目標値まで逆転開作動する。
【0249】
(坂道判定ルーチン)
図45は、坂道判定ルーチン(ステップ122)の詳細を示すフローチャートである。この坂道判定ルーチンは、坂道判定をするための条件を整えるためのもので、まず、ドア2の位置がエリア1,6か判断する(ステップ)。これは通常制御領域であるエリア1,6で坂道判定を行うためである。従って、ドア2の位置が他のエリアであればリターンする。
【0250】
ドア2の位置がエリア1,6であれば、ドア2の作動が安定する時間が過ぎたか判断し(ステップ451)、過ぎていれば坂道判定済みか判断する(ステップ452)。作動時間が安定時間に達していないとき、または坂道判定済みであればリターンする。
【0251】
坂道判定済みでなければ、安定度カウントが所定の設定値以上か判断する(ステップ453)。ここで安定度とは、連続する複数(例えば4つ)の周期計数値Tの最大値と最小値との差が一定値以内である状態をいう。その状態が所定の設定値回数以上になっていなければ、リターンする。
【0252】
安定度カウントが所定の設定値以上であれば、平坦地でドア2が安定したと判断し、判定基準値入力済みか判断する(ステップ455)。初期時は入力済みでないので後述する平坦値データ入力を行い(ステップ457)、入力済みであれば後述する坂道検査を行う(ステップ456)。
【0253】
(平坦値データ入力)
図46は、平坦値データ入力ルーチン(ステップ121,457)の詳細を示すフローチャートである。この平坦値データ入力ルーチンは、坂道判定に使用する基準値(平坦基準値)を入力するもので、ドア2のエリア1,6における周期計数値Tが基準周期内にあるか、すなわちドア2の移動速度が設定速度T1(図16)に対して所定の範囲内にあるか判断する(ステップ458)。所定の範囲内になければリターンする。
【0254】
ドア2が目標速度に制御されていれば(ステップ458)、現電流値を平坦電流値として格納し(ステップ459)、かつそのときの駆動電圧を平坦駆動電圧として格納する(ステップ460)。駆動電圧は、
駆動電圧=電源電圧×(DUTY/250)
となる。ここで、(DUTY/250)は前述したようにデューティサイクルを意味する。
【0255】
(坂道検査ルーチン)
図47は、坂道検査ルーチン(ステップ456)の詳細を示すフローチャートである。この坂道検査ルーチンは、先に設定した平坦基準値(平坦電流値および平坦駆動電圧)から車体1が停止している状況が平坦地か坂道かを判断するものである。
【0256】
まず、現在の電流値が平坦電流値よりも大きければ(ステップ461)、平坦電流値に判定マージンとしての坂道電流値を加算し、加算後の値を坂道判定値とする(ステップ462)。そして、現在の電流値が坂道判定値以上の大きさであれば(ステップ464)、平坦電流値に判定マージンとしての急坂値(坂道値よりも大きい)を加算し、加算後の値を急坂判定値とする(ステップ465)。
【0257】
そして、現在の電流値が急坂判定値以上の大きさで(ステップ467)、ドア2の移動方向が開方向であれば(ステップ468)、急下り坂と判定し(ステップ470)、閉方向であれば急上り坂と判定する(ステップ471)。また、現在の電流値が急坂判定値未満の大きさで(ステップ467)、ドア2の移動方向が開方向であれば(ステップ469)、下り坂と判定し(ステップ472)、閉方向であれば上り坂と判定する(ステップ473)。
【0258】
これは、車体1の停止位置が下り坂でドア2の移動方向が開方向、または車体1の停止位置が上り坂でドア2の移動方向が閉方向であれば、ドア2の自重に抗して移動させる必要があるため、モータ負荷が増大し、坂道の傾斜に比例して電流値が増えるため、現在の電流値を平坦電流値と比較することによって坂道判定を行っている。現在の電流値が坂道判定値未満の大きさであれば(ステップ464)、平坦地と判定する(ステップ466)。
【0259】
現在の電流値が平坦電流値以下であれば(ステップ461)、現在の駆動電圧を求め(ステップ463)、先に求めた平坦駆動電圧から判定マージンとしての坂道電圧値を減算し、減算後の値を坂道判定電圧とする(ステップ474)。そして、現在の駆動電圧が坂道判定電圧以下の大きさであれば(ステップ475)、平坦電圧値から判定マージンとしての急坂電圧値(坂道値よりも大きい)を減算し、減算後の値を急坂判定電圧とする(ステップ476)。
【0260】
そして、現在の駆動電圧が急坂判定電圧以下の大きさで(ステップ477)、ドア2の移動方向が開方向であれば(ステップ478)、急上り坂と判定し(ステップ480)、閉方向であれば急下り坂と判定する(ステップ481)。また、現在の駆動電圧が急坂判定電圧より大きく(ステップ477)、ドア2の移動方向が開方向であれば(ステップ479)、上り坂と判定し(ステップ482)、閉方向であれば下り坂と判定する(ステップ483)。
【0261】
これは、車体1の停止位置が上り坂でドア2の移動方向が開方向、または車体1の停止位置が下り坂でドア2の移動方向が閉方向であれば、ドア2が自重で目的の方向に移動するので、そのままだと急開または急閉となり危険であるので、DUTY制御によって駆動電圧を下げ、速度制御を行っているため、現在の駆動電圧を平坦駆動電圧と比較することによって坂道判定を行うことができる。現在の駆動電圧が坂道判定電圧以上の大きさであれば(ステップ475)、平坦地と判定する(ステップ466)。
【0262】
駆動電圧の算出(ステップ463)は次のように行う。PWM制御によりDUTYが100%で無い場合、そのときの駆動電圧は、
DUTY値÷250(100%)=駆動割り合い
バッテリー電圧×駆動割合=駆動電圧
となる。DUTY=100%の場合は、
バッテリー電圧=駆動電圧
となる。本実施の形態では、100%のDUTY値を250としている。
【0263】
【発明の効果】
請求項1記載の発明によれば、坂道の傾斜度合い、すなわち車体の傾斜度合いを特別な傾斜測定センサを使用しないで容易に検出することができる。
【0264】
また、請求項記載の発明によれば、上り坂と下り坂をモータ負荷の電気値たる電圧値と電流値に分けて検出するので、傾斜の方向を確実に判定することができる。
【0265】
また、請求項記載の発明によれば、常にドアを開くときの最初のモータ負荷部分で傾斜角が測れるので、そのドアを閉じるまで、開く途中のドアから開かれたドアに至るまで、傾斜度に応じた適正な安全対策を施すことができる。
【0266】
また、請求項4記載の発明によれば、PWM制御が行われているモータに対しても、PWM制御の状態に関わりなく、常にモータ負荷に応じた電気値が得られる。
【図面の簡単な説明】
【図1】本発明が適用される自動車の一例を示す外観斜視図である。
【図2】スライドドアを取り外した状態を示す車体の拡大斜視図である。
【図3】スライドドアを示す斜視図である。
【図4】車内側から見たスライドドアの取り付け部分を示す斜視図である。
【図5】スライドドア駆動装置の要部を示す斜視図である。
【図6】スライドドアの移動状況を示す概略的平面図である。
【図7】スライドドア自動制御装置と周辺の電気的要素との接続関係を示すブロック図である。
【図8】スライドドア自動制御装置の要部を示すブロック図である。
【図9】本発明によるスライドドア自動制御装置の動作を説明するフローチャートである。
【図10】図9のモード判定ルーチンの概要図である。
【図11】パルス割り込みルーチンによって実行されるドアの移動速度の計数に係るタイムチャートである。
【図12】位置計数パルスが各エリアにおいて分解能に応じてサンプリングされるサンプリング点のタイムチャートである。
【図13】ドアの開閉位置と位置計数値との関係およびドアの開度に応じたエリアを示すロアートラックの平面図である。
【図14】パルス割り込みルーチンの詳細を示すフローチャートである。
【図15】パルスカウントタイマールーチンの詳細を示すフローチャートである。
【図16】エリア毎に要求される制御データ等を示すメモリテーブルである。
【図17】オートスライドモード判定ルーチンの詳細を示すフローチャートである。
【図18】手動判定ルーチンの詳細を示すフローチャートである。
【図19】オート開作動ルーチンの詳細を示すフローチャートである。
【図20】オート閉作動ルーチンの詳細を示すフローチャートである。
【図21】マニュアル閉作動ルーチンの詳細を示すフローチャートである。
【図22】逆転開作動ルーチンの詳細を示すフローチャートである。
【図23】逆転閉作動ルーチンの詳細を示すフローチャートである。
【図24】目標位置算出ルーチンの詳細を示すフローチャートである。
【図25】ドア全開制御ルーチンの詳細を示すフローチャートである。
【図26】スタートモードルーチンの詳細を示すフローチャートである。
【図27】手動通常スタートモードルーチンの詳細を示すフローチャートである。
【図28】手動全閉スタートモードルーチンの詳細を示すフローチャートである。
【図29】速度制御ルーチンの概要図である。
【図30】速度制御に係る機能を示すブロック図である。
【図31】モータに流れる電流を一定としたときの電圧変動とデューティサイクルの関係を示すグラフである。
【図32】PWM制御ルーチンの詳細を示すフローチャートである。
【図33】フィードバック調整ルーチンの詳細を示すフローチャートである。
【図34】挟み込み判定ルーチンの概要図である。
【図35】挟み込み判定ルーチンの詳細を示すフローチャートである。
【図36】挟み込み判定に係る機能を示すブロック図である。
【図37】注目するサンプリング領域の電流値を示すグラフである。
【図38】記憶用学習データ演算部のブロック図である。
【図39】予測比較値演算部のブロック図である。
【図40】学習判定ルーチンの詳細を示すフローチャートである。
【図41】エラー判定ルーチンの詳細を示すフローチャートである。
【図42】学習重み付けルーチンの詳細を示すフローチャートである。
【図43】継続・変化量ルーチンの詳細を示すフローチャートである。
【図44】総合判定ルーチンの詳細を示すフローチャートである。
【図45】坂道判定ルーチンの詳細を示すフローチャートである。
【図46】平坦値データ入力ルーチンの詳細を示すフローチャートである。
【図47】坂道検査ルーチンの詳細を示すフローチャートである。
【符号の説明】
1 車体
2 スライドドア
3 ドア開口部
4 アッパートラック
5 ロアートラック
6 摺動連結具
7 ガイドトラック
8 ドアロック
9 ストライカ
10 ドア駆動装置
11 モータ駆動部
12 ドア駆動ケーブル部材
12a 閉扉用ケーブル
12b 開扉用ケーブル
13 ベースプレート
14 開閉モータ
15 ドライブプーリ
16 電磁クラッチ
17 減速部
18 ロータリーエンコーダ
19 案内プーリ
20 反転プーリ
21 移動部材
22 ヒンジアーム
23 スライドドア自動制御装置
24 バッテリー
25 イグニッションスイッチ
26 パーキングスイッチ
27 メインスイッチ
28 ドア開スイッチ
29 ドア閉スイッチ
30 ワイヤレスリモコン
31 キーレスシステム
32 ブザー
33 車体側コネクタ
34 ドア側コネクタ
35 アクチュエータ
36 ハーフラッチスイッチ
37 ドアハンドル
38 パルス信号発生部
39 出力ポート
40 発電機
41 安定化電源
42 速度検出部
43 位置検出部
44 モータ切り替えスイッチ
45 極性反転スイッチ回路
46 電力スイッチ素子
47 電圧検出部
48 A/D変換部
49 シャント抵抗
50 電流検出部
51 A/D変換部
52 クラッチ駆動回路
53 アクチュエータ駆動回路
54 制御モード選択部
55 主制御部
56 オートスライド制御部
57 速度制御部
58 挟み込み制御部
59 坂道判定部
60 ドア位置検出部
61a 制御領域弁別部
61b 制御速度選択部
62 調整量算出部
63 最大調整量制限部
64 ドア移動速度検出部
65 速すぎ検出部
66 遅すぎ検出部
67 フィードバック調整部
68 電源電圧検出部
69 デューティ演算部
[0001]
BACKGROUND OF THE INVENTION
The present invention relates to an automatic opening / closing control device for a sliding door for a vehicle, which can automatically open and close a sliding door attached to a side surface of a vehicle such as an automobile by a driving source such as a motor.
[0002]
[Prior art]
2. Description of the Related Art Conventionally, an automatic opening / closing control device for a sliding door for a vehicle is known in which a sliding door supported so as to be slidable in the front-rear direction on the side of a vehicle body is opened and closed by a driving source such as a motor. In this device, the user consciously operates the operating means provided near the driver's seat and the door handle to activate the drive source, and automatically opens and closes the sliding door by the driving force of the drive source. ing.
[0003]
In addition, as a trigger means that replaces the operation means, it is detected that the slide door has moved a predetermined distance by manual force, and the drive source is activated when triggered by that, and the drive force is switched to the drive force of the drive source instead of the manual force. Some slide doors automatically open and close.
[0004]
[Problems to be solved by the invention]
In the conventional automatic opening / closing control device for a sliding door for a vehicle, since the weight of the sliding door is heavy, the load related to the driving of the sliding door is easily influenced by the opening / closing direction and the opening / closing position. Depending on the inclination of the front and rear, an excessive load that lifts the weight of the door causes a negative load that applies braking to the same level of load, making automatic opening / closing control with sufficient consideration for safety measures difficult. It was.
[0005]
That is, if the load on the sliding door is large and the load fluctuation range is large, the output power of the door driving means must be increased with a sufficient margin so that the load fluctuation can be quickly dealt with. However, on the other hand, since the stress sensitivity decreases for small load fluctuations, it is difficult to control the output power in consideration of safety so that the sliding door does not get caught.
[0006]
In particular, when the sliding door power drive start timing is set to automatic control, safety measures must be taken in consideration of all conditions of the car, such as the opening and closing direction and position of the sliding door, and the body posture when the sliding door is opened and closed. I must.
[0007]
For example, when obtaining an opportunity to switch from manual force to electric force based on the moving distance of the slide door, it is difficult to reliably determine that the slide door has been moved by the manual force. For example, when a sliding door that is opened by stopping on a gentle slope slowly moves, the sliding door is switched to automatic driving, and the driving force works even when automatic driving is not desired. If the door load fluctuation range increases due to the posture of the vehicle body or the door load itself increases, it is difficult to switch from a reliable manual force to an automatic force.
[0008]
In particular, the sliding door is linear in the moving direction of the door and can move in the same direction as the longitudinal direction of the vehicle body. Therefore, the door's own weight greatly affects the control when the door is opened and closed on a slope. For this reason, it is important to know the degree of inclination when the automobile is parked, that is, the degree of inclination when the parked road is inclined when the slide door is opened and closed.
[0009]
(the purpose)
The present invention has been made to solve such a conventional problem, and allows for a trade-off between flexibility and safety in consideration of all situations imposed on the automatic drive of the sliding door. With the goal. And, the present invention reliably switches from manual drive to automatic drive, and controls the slide door safely and quickly by appropriately changing the control conditions and control amount according to the position where the slide door is located, It is an object of the present invention to provide an automatic opening / closing control device for a sliding door for a vehicle in which the presence or absence of the sliding door is quickly determined and safety measures are taken.
[0010]
[Means for Solving the Problems]
According to a first aspect of the present invention, there is provided an automatic opening / closing control device for a sliding door for a vehicle, wherein a sliding door supported to be opened and closed along a guide track provided on a vehicle body is opened and closed by a motor drive. A door drive unit having a motor capable of forward / reverse rotation, and a motor load of the door drive unit, the motor drive current and Driving voltage of Motor load detection means for detecting by electric value, storage means for storing the electric value of the motor load at the time of door opening or closing when the vehicle body is in a flat attitude, and motor load of the flat attitude stored in the storage means Slope judgment means for comparing the electrical value with the electrical value of the motor load detected when the door is normally opened or closed, and judging the posture of the vehicle body at the time of opening and closing the door from the deviation of both electrical values related to the motor load , With The slope judging means is a steep uphill when the drive voltage is very low when the deviation of both electric values related to the motor load is opened, an uphill when the drive voltage is low during the open operation, and an uphill when the drive voltage is opened. When the drive voltage is not low and the current value is not large, it is discriminated as flat, when the current value is large during opening operation, it is downhill, and when the current value is very large during opening operation, it is distinguished as a steep downhill. It is characterized by that.
[0011]
According to a second aspect of the present invention, in the first aspect of the present invention, the storage means stores a motor load current and a motor driving voltage when the door is opened as an electric value of the motor load. It is characterized by.
[0012]
The invention according to claim 3 of the present invention is the invention according to claim 1, wherein the storage means is in a continuous operation of opening the door from the fully closed door and is moving along the linear portion of the guide track. In addition, the electric value of the motor load at a time when the moving speed is constant is temporarily updated and stored.
[0014]
Claims of the invention 4 According to the invention described in any one of claims 1 to 3, in the invention according to any one of claims 1 to 3, the electric value relating to the motor load is equivalent to a duty cycle of 100% corresponding to the driving voltage of the motor controlling the load power with the duty cycle. It is characterized by being converted to voltage.
[0015]
DETAILED DESCRIPTION OF THE INVENTION
FIG. 1 is an external perspective view showing an example of an automobile to which an automatic opening / closing control device for a sliding door for a vehicle according to the present invention is applied, and shows a state where a sliding door 2 is mounted on a side surface of a vehicle body 1 so as to be opened and closed in the front-rear direction. Show. 2 is an enlarged perspective view of the vehicle body 1 showing a state in which the slide door 2 (shown by a chain line) is removed, and FIG. 3 is a perspective view showing only the slide door 2 alone.
[0016]
In these drawings, the sliding door 2 includes an upper track 4 provided at the upper edge of the door opening 3 of the vehicle body 1 and a sliding connector 6 fixed to the upper and lower ends of the door 2 on a lower track 5 provided at the lower edge. It is linked and suspended so as to be slidable in the front-rear direction.
[0017]
The sliding door 2 is guided by a hinge arm 22 attached to the inner rear end slidably engaged with a guide track 7 fixed in the vicinity of the rear waist portion of the vehicle body 1, and the door opening 3 is closed completely. It is mounted so as to move rearward in parallel with the exterior panel side surface of the vehicle body 1 while projecting slightly outward from the outer surface of the outer panel of the vehicle body 1 from the position to a fully open position where the door opening 3 is fully opened.
[0018]
Furthermore, when the sliding door 2 is located at the fully closed position, the door lock 8 provided on the opening end face engages with the striker fixed to the vehicle body 1 side, so that the sliding door 2 is held in the fully closed position with a certain closed state. It is configured as follows. Further, a door handle 37 for performing a manual opening / closing operation is attached to the outer surface of the slide door 2. The door lock 8 may be provided on the rear end surface of the slide door 2.
[0019]
Further, a slide door driving device 10 as shown in FIG. 4 is mounted behind the door opening 3 of the vehicle body 1 between the outer panel that covers the vehicle body 1 and the inner panel on the indoor side. The slide door drive device 10 moves the cable member 12 disposed in the guide track 7 by driving a motor, and thereby moves the slide door 2 connected to the cable member 12.
[0020]
In the present embodiment, an opening / closing instruction for the sliding door 2 is given by an opening / closing switch (not shown) installed in the vehicle, and an opening / closing instruction can also be given from outside the vehicle by the wireless remote controller 30 as shown in FIG. It is configured as follows. Details of these configurations will be described later.
[0021]
FIG. 5 is a perspective view showing a main part of the sliding door drive device 10. The slide door drive device 10 has a motor drive unit 11. The motor drive unit 11 is mounted on a base plate 13 fixed with a bolt or the like on the indoor side of the vehicle body 1. The drive pulley 15 around which the member 12 is wound and the speed reduction part 17 incorporating the electromagnetic clutch 16 are fixed.
[0022]
The drive pulley 15 has a speed reduction mechanism having a speed reduction mechanism to reduce the number of rotations of the opening / closing motor 14 and increase the output torque to transmit it to the cable member 12. Further, the electromagnetic clutch 16 is separately excited at an appropriate time when the opening / closing motor 14 is driven, and mechanically connects the opening / closing motor 14 and the drive pulley 15.
[0023]
The cable member 12 wound around the drive pulley 15 has an opening 7 a above the guide track 7 that opens outwardly in a U-shape through a pair of guide pulleys 19, 19 provided behind the guide track 7. And the lower opening 7b are wound around in parallel with each other and wound around a reversing pulley 20 provided at the front end of the guide track 7 to form an endless rope.
[0024]
Further, a moving member 21 is fixed at an appropriate portion of the portion of the cable member 12 that travels through the opening 7a of the guide track 7 so that it can travel within the opening 7a without resistance. The cable member 12 has a door closing cable 12a on the front side of the moving member 21 and a door opening cable 12b on the rear side.
[0025]
The moving member 21 is connected to the inner rear end of the slide door 2 via a hinge arm 22 and is moved into the opening 7a of the guide track 7 by the pulling force of the opening cable 12a or the closing cable 12b by the rotation of the opening / closing motor 14. Is moved forward or backward, thereby moving the sliding door 2 in the closing direction or opening direction.
[0026]
A rotary encoder 18 for measuring the rotation angle with high resolution is linked to the rotation shaft of the drive pulley 15. The rotary encoder 18 generates an output signal having a pulse number corresponding to the rotation angle of the drive pulley 15 so that the movement amount of the cable member 12 wound around the drive pulley 15, that is, the movement amount of the slide door 2 can be measured. It has become.
[0027]
Therefore, if the number of pulses from the rotary encoder 18 is counted up to the fully opened position with the fully closed position of the slide door 2 as an initial value, the counted value N represents the position of the moving member 21, that is, the position of the slide door 2. Become.
[0028]
FIG. 6 is a schematic plan view showing a moving state of the slide door 2. As described above, the sliding door 2 is held at the front by the sliding coupling 6 fixed to the upper and lower ends being linked to the upper track 4 and the lower track 5, and the hinge arm 22 is linked to the guide track 7. By doing so, the rear part is held.
[0029]
(Sliding door automatic control device)
Next, a connection relationship between the slide door automatic control device 23 and each electrical element in the vehicle body 1 and the slide door 2 will be described with reference to a block diagram shown in FIG. The slide door automatic control device 23 controls the slide door drive device 10 by program control by a microcomputer, and is arranged, for example, in the vicinity of the motor drive unit 11 in the vehicle body 1.
[0030]
As for the connection between the sliding door automatic control device 23 and each electrical element in the vehicle body 1, the connection with the battery 24 for receiving the DC voltage BV, the connection with the ignition switch 25 for receiving the ignition signal IG, and the parking signal. There is a connection with the parking switch 26 for receiving the PK and a connection with the main switch 27 for receiving the main switch signal MA.
[0031]
Further, connection with the door opening switch 28 for receiving the door opening signal DO, connection with the door closing switch 29 for receiving the door closing signal DC, remote control opening signal RO or remote control closing signal RC from the wireless remote controller 30 is received. There is a connection with a keyless system 31 for this purpose, and a connection with a buzzer 32 that generates an alarm sound to warn that the sliding door 2 is automatically opened and closed.
[0032]
Note that the door opening switch 28 and the door closing switch 29 are each composed of two operators, indicating that these switches are installed at, for example, two locations of the driver's seat and the rear seat in the vehicle. Yes.
[0033]
Next, the connection relationship between the slide door automatic control device 23 and the slide door drive device 10 includes a connection for supplying power to the opening / closing motor 14, a connection for controlling the electromagnetic clutch 16, and a pulse from the rotary encoder 18. There is a connection with a pulse signal generator 38 that receives the signal and outputs pulse signals φ1 and φ2.
[0034]
The slide door automatic control device 23 is connected to each electrical element in the slide door 2 by sliding with the vehicle body side connector 33 provided in the door opening 3 with the slide door 2 slightly opened from the fully closed state. This is possible by connecting a door-side connector 34 provided at the open end of the door 2.
[0035]
In this connection state, the sliding door automatic control device 23 and each electrical element in the sliding door 2 are connected by supplying power to the closure motor CM in order to tighten the sliding door 2 from the half latch to the full latch state. A connection for supplying power to the actuator (ACTR) 35 for driving the door lock 8 to remove it from the striker 9, and for receiving a half latch signal HR from the half latch switch 36 for detecting a half latch And a connection for receiving the door handle signal DH from the door handle switch 37a for detecting the operation of the door handle 37 connected to the door lock 8.
[0036]
Next, the configuration of the slide door automatic control device 23 will be described with reference to the block diagram shown in FIG. The slide door automatic control device 23 has a main control unit 55 and repeatedly performs control at regular time intervals. The main control unit 55 includes a control mode selection unit 54 that selects an appropriate control mode according to the status of each input / output peripheral device.
[0037]
The control mode selection unit 54 selects an optimum dedicated control unit necessary for control according to the latest status of each input / output peripheral device. As the dedicated control unit, an automatic slide control unit 56 that mainly controls the opening and closing of the slide door 2, a speed control unit 57 that controls the moving speed of the slide door 2, and the movement of the slide door 2 while the slide door 2 is driven are suppressed. There is a pinching control unit 58 that detects whether or not an object has been pinched in the moving direction. In addition, the auto slide control unit 56 includes a slope determination unit 59 for detecting the posture of the vehicle body 1.
[0038]
The slide door automatic control device 23 has a plurality of input / output ports 39, and is configured to input / output the above-mentioned various switch on / off signals, relay / clutch operation / non-operation signals, and the like. ing. In addition, the speed calculation unit 42 and the position detection unit 43 receive the two-phase pulse signals φ1 and φ2 output from the pulse signal generation unit 38 and generate a cycle count value T and a position count value N.
[0039]
The battery 24 is charged by the generator 40 while the automobile is running, and its output voltage is made constant by the stabilized power circuit 41 and supplied to the slide door automatic control device 23. The output voltage of the battery 24 is detected by a voltage detection unit 47, and the voltage value is converted into a digital signal by an A / D conversion unit 48 and input to the slide door automatic control device 23.
[0040]
Further, the output voltage of the battery 24 is supplied to the shunt resistor 49, and the current value I flowing through the resistor 49 is detected by the current detector 50. The detected current value I is converted into a digital signal by the A / D converter 51 and input to the slide door automatic control device 23.
[0041]
The output voltage of the battery 24 is supplied to the power switch element 46 via the shunt resistor 49. The power switch element 46 is ON / OFF controlled by the slide door automatic control device 23, converts a DC signal into a pulse signal, and supplies the pulse signal to the opening / closing motor 14 or the closure motor CM. The duty ratio of the pulse signal can be freely controlled by the power switch element 46.
[0042]
The pulse signal obtained by the power switch element 46 is supplied to the opening / closing motor 14 or the closure motor CM via the polarity inverting circuit 45 and the motor switching circuit 44. The polarity inversion circuit 45 is for changing the driving direction of the opening / closing motor 14 or the closure motor CM, and constitutes a power supply circuit of the motor together with the power switch element 46.
[0043]
Further, the motor switching circuit 44 selects one of the opening / closing motor 14 that opens and closes the sliding door 2 and the closure motor CM according to an instruction from the main control unit 55. Although both motors are motors that drive the slide door 2, they are not driven at the same time, and therefore drive power is selectively supplied.
[0044]
In addition, a clutch drive circuit 52 that controls the electromagnetic clutch 16 according to an instruction from the main controller 55 and an actuator drive circuit 53 that controls the actuator 35 according to an instruction from the main controller 55 are also provided.
[0045]
(Main routine)
Next, the operation of the present invention having this configuration will be described. FIG. 9 is a flowchart of a main routine showing the operation of the slide door automatic control device 23. Initial setting is performed first (step 101), and main parameters and the like are initialized at the beginning of operation. The switch (SW) determination (step 102) determines the open / close state of the various switches 25-29 and the like connected to the input / output port 39, and sets a flag or the like indicating the open / close state of each switch.
[0046]
The A / D input (step 103) takes in the voltage value V and the current value I from the A / D converters 48 and 51. This A / D input has a current value correction (step 111) and voltage address conversion (step 112) at a lower level.
[0047]
Next, mode determination (step 104) is performed for determining whether the auto slide mode (step 113) or the closure mode (step 114) from the surrounding conditions such as the open / close state of each switch described above, and selection control is performed for either. The auto slide mode is a mode for controlling the opening / closing of the slide door 2 by driving the opening / closing motor 14, and the closure mode is a mode for driving the closure motor CM to tighten or release the slide door 2 to a full latch state. .
[0048]
Subsequent actuator (ACTR) relay control (step 105), clutch relay control (step 106), auto slide relay control (step 107) and closure relay control (step 108) reflect the control results of the respective control units. Since it is a direct control part for supplying power to the clutch 16, the motor 14, and the CM, a detailed description thereof will be omitted. The opening / closing motor 14 that opens and closes the sliding door 2 is started and stopped by automatic slide relay control (step 107).
[0049]
The next sleep mode (step 109) is control for reducing power consumption when there is no change for a long time. In the next program adjustment (step 110), the interval of the main loop is controlled to be constant, for example, 10 mm seconds by a program adjustment timer (step 115) in an interrupt program separately provided outside the loop.
[0050]
In this program adjustment, when the program adjustment timer is interrupted, the control point in each step returns to the main loop entrance when the control point enters a deeper level of nesting depending on the surrounding situation, or it is completed in a shallow hierarchy etc. Is always adjusted to be constant. When the program adjustment is completed, the loop control is performed to return to the SW determination (step 102) and repeat the subsequent processing.
[0051]
(Mode judgment routine)
FIG. 10 is a flowchart showing an outline of the auto slide mode determination in the mode determination (step 104). In this automatic slide mode determination, a start mode in which the movement of the door 2 starts to be classified according to various situations at that time (step 117), and pinching determination for appropriately controlling the door 2 that has started to move according to the situation at that time (step 118). , Slope mode (step 119), speed control (step 120), and the like. In the slope mode, there are routines such as flat value data input (step 121) and slope judgment (step 122) at the lower level.
[0052]
Further, the automatic slide mode determination (step 116) is performed by an automatic opening operation (step 124), an automatic closing operation (step 125), and a manual closing operation (steps) by an identifier corresponding to the surrounding situation in the switch sentence (step 123). 126), reverse rotation opening operation (step 127), and reverse rotation closing operation (step 128), and control is performed. The lower level of these controls includes target position calculation (step 129), full open detection (step 130). Furthermore, there is a stop mode (step 131) routine at the same level as the start mode (step 117).
[0053]
The start mode (step 117) includes a normal start mode (step 133), an ACTR start mode (step 134), and a manual normal start mode (step 135) that are branched into multiple branches by a switch statement (step 132). And a routine for manual fully closed start mode (step 136).
[0054]
The multi-branch flow shown as a switch statement (steps 123 and 132) uses an open / closed state of each switch as an identifier indicating the surrounding situation, and usually a 1-bit flag indicating whether the required control is continuing or completed. ing.
[0055]
In this flow of auto slide mode determination, the control points are shifted according to the main routine. However, both the pulse count timer (step 115A) and pulse interrupt (step 115B) routines shown separately in FIG. An interrupt program is configured with separate control points.
[0056]
(Cycle count value T / Position count value N)
FIG. 11 is a diagram showing an acquisition time chart of the cycle count value T and the position count value N required in each routine of the pulse count timer (step 115A) and the pulse interrupt (step 115B) in the interrupt program.
[0057]
In the figure, two-phase speed signals Vφ1 and Vφ2 correspond to the two-phase pulse signals φ1 and φ2 output from the rotary encoder 18, and the rotational direction of the rotary encoder 18, that is, the sliding door, is determined from the phase relationship between the two signals. 2 direction of movement is detected. Specifically, if the pulse signal φ2 is at the L level (the state shown in the figure) when the pulse signal φ1 rises, for example, the door opening direction is determined.
[0058]
The speed calculation unit 42 generates an interrupt pulse g1 when the speed signal Vφ1 rises, and sets the number of clock pulses C1 having a period (for example, 400 μsec) sufficiently smaller than the interrupt pulse g1 during the generation period of the interrupt pulse g1. Counting is performed, and the count value is defined as a cycle count value T. Therefore, the cycle count value T is obtained by converting the cycle of the pulse signal φ1 output from the rotary encoder 18 into a digital value.
[0059]
For example, if the output pulse of the rotary encoder 18 is 1 pulse per 1 mm (1 cycle), when the cycle count value T is 250, the moving speed of the door 2 is “1 mm / (400 μs × 250) = 10 mm / sec”. When the cycle count value T is 100, the moving speed of the door 2 is “25 mm / sec”.
[0060]
Note that the cycle count values TN-3 to TN + 3 shown in FIG. 11 are the position information of the door 2 obtained by counting the position count pulse (substantially the interrupt pulse g1) obtained by the output signal φ1 output from the rotary encoder 18. The period count value TN indicates the period count value T corresponding to the Nth position of interest at that time, and TN-1, TN-2 or TN + 1 , TN + 2 indicate the cycle count values T related to the position around 1 or 2 with respect to the position count value N, respectively.
[0061]
Further, in this embodiment, the speed of the slide door 2 is recognized from the cycle count value for four consecutive cycles of the speed signal Vφ1, so that four cycles are stored in order to store the cycle count value for four cycles. The registers 1 to 4 are provided, and the position No. N is set as a point of interest in the four period registers, and is held four times so that it becomes the head output value of the period registers 1 to 4.
[0062]
Thus, the pulse count timer (step 115A) and the pulse interrupt (step 115B) routine acquire the cycle count value T and the position count value N at their respective timings separately from the main routine.
[0063]
FIG. 12 shows a time chart of sampling points sampled according to the resolution B in control areas E1 to E6 (described later) of the door 2 using the output signal φ1 output from the rotary encoder 18 as a position counting pulse. That is, in the control areas E3 and E4, the position count pulse φ1 is sampled with a resolution of 2 divided by one half, and in the control area E2, the position count pulse φ1 is sampled with a resolution of four divided by one quarter. At E1, E5 and E6, the position counting pulse φ1 is sampled with a resolution of 8 divided by one eighth.
[0064]
(Sliding door control area)
Here, the control areas E1 to E6 of the slide door 2 will be described. FIG. 13 shows a plan view of the guide track 7. When the opening / closing position of the sliding door 2 is represented by the position of the moving member 21, the location area of the door in the closing direction of the door 2 is divided into four areas 1 to 4, and the location of the door in the opening direction of the door 2 is divided. The area is divided into three areas 5-7.
[0065]
When the position count value N at the fully closed position of the door 2 is 0 and the position count value N at the fully open position is 850, N = 850 to 600 is area 1, N = 600 in the case of movement in the closing direction (Z = 0). -350 is area 2, N = 350-60 is area 3, and N = 60-0 is area 4. The fully closed half of the area 4 is an ACTR region. In the case of movement in the open direction (Z = 1), N = 0 to 120 is area 5, N = 120 to 800 is area 6, and N = 800 to 850 is area 7.
[0066]
Area 1 and area 6 are the normal control area E1, area 2 is the deceleration control area E2, area 3 is the link deceleration area E3, area 4 is the tightening control area E4, area 5 is the link deceleration area E5, and area 7 is checked. It becomes the control area E6, and the door 2 is controlled at a moving speed or the like suitable for each control area.
[0067]
(Pulse interrupt routine)
FIG. 14 is a flowchart showing the pulse interrupt routine (step 115B). This routine is a process of determining the areas 1 to 7 and the control areas E1 to E6 (see FIG. 13) where the slide door 2 is currently located based on the position count value N and the door movement direction Z every time the interrupt pulse g1 is generated. Details of the areas 1 to 7 and the control areas E1 to E6 will be described later.
[0068]
First, it is checked whether or not the open / close motor 14 is stopped (step 137). If the open / close motor 14 is operating, the current cycle count value T is stored in the cycle register (step 138), and the stop of the motor is released (step 139). If the opening / closing motor 14 is stopped, the full value FF (hexadecimal number) is set to the cycle count value T (step 140).
[0069]
Next, the movement direction Z of the door 2 is checked (step 141). If the door 2 is moving in the opening direction (Z = 1), the position count value N is incremented (step 142), thereby the position count value N If it is 120 or more and less than 800 (steps 143 and 144), the previous control area E1 is checked (step 145), and if it is the control area E1, the process is terminated since the current control area E1. If it is not the area E1, it is set in the control area E1 and area 6 (step 146), the area change instruction data is set as changed (step 147), and the process is terminated.
[0070]
If the position count value N is less than 120 (step 143), the previous control area E5 is checked (step 148). If it is the control area E5, it is still the control area E5 and the process is terminated. If it is not E5, it is set in the control area E5 and area 5 (step 149), the area change instruction data is set as changed (step 147), and the process is terminated.
[0071]
If the position count value N exceeds 800 (step 144), the previous control area E6 is checked (step 150). If the control area E6, the control area E6 is still in the control area E6. If it is not the area E6, the area is set to the control area E6 and the area 7 (step 151), the area change instruction data is set to be changed (step 147), and the process is terminated.
[0072]
If the door 2 is moving in the opening direction (Z = 0) (step 141), the position count value N is decremented (step 152), and if the position count value N exceeds 600 (step 152) Steps 153 to 155), the previous control area E1 is checked (step 156). If it is the control area E1, it is still the control area E1 and the process is terminated. 1 is set (step 157), the area change instruction data is set to be changed (step 147), and the process is terminated.
[0073]
If the position count value N is 60 or less (step 153), the previous control area E4 is checked (step 158A). If it is the control area E4, it is still the control area E4. If it is not E4, it is set in the control area E4 and area 4 (step 158B), the area change instruction data is set as changed (step 147), and the process is terminated.
[0074]
If the position count value N exceeds 60 and is 350 or less (step 154), the previous control area E3 is checked (step 158C). If the control area E3, the control area E3 is still in the control area E3, and the process ends. If the previous area is not the control area E3, the control area E3 and area 3 are set (step 158D), the area change instruction data is set to be changed (step 147), and the process is terminated.
[0075]
If the position count value N exceeds 350 and is 600 or less (step 155), the previous control area E2 is checked (step 158E). If the control area E2, the control area E2 is still in the control area E2, and the process is terminated. If the previous area is not the control area E2, the area is set to the control area E2 and area 2 (step 158F), the area change instruction data is set to be changed (step 147), and the process is terminated.
[0076]
(Pulse count timer)
FIG. 15 is a flowchart showing the pulse count timer (step 115A). The number of clock pulses C1 is counted by a required pulse counter to obtain a cycle count value T (step 159). It is checked whether the cycle count value T is full (T = FF) (step 160). If it is full, the period count value T is cleared to zero (T = 0) (step 161), the count value of the required counter is incremented and carried up (step 162), and then the process returns.
[0077]
(Control in areas 1-7)
FIG. 16 is a memory table for storing various data required for controlling the sliding door 2 in the above-described areas 1 to 7 (FIG. 13). Areas 1 and 6 are both referred to as a normal control area E1. In this control area E1, the appropriate moving speed T1 of the door 2 is 250 mm / s, the reference duty value D is 250, and the resolution B of the sampling area is 8. The degree is small.
[0078]
The duty value D is a value indicating the duty cycle of the voltage waveform (rectangular wave) applied to the motor. In this embodiment, “D = 250” means a DC signal having a duty cycle of 100%, that is, an H level, “D = 0” means a DC signal having a duty cycle of 0%, that is, an L level. Then, the output torque of the motor is adjusted by changing the duty cycle of the rectangular wave in 250 steps during this period.
[0079]
Area 2 is referred to as a deceleration control area E2. In this control area E2, the appropriate moving speed T2 of the door 2 is 170 mm / s, the duty value D is 170, the resolution B is 4, and the attention level is a dangerous area. Area 3 is referred to as a link deceleration control region E3. In this control region E3, the appropriate moving speed T3 of the door 2 is 100 mm / s, the duty value D is 100, the resolution B is 2, and the degree of attention is a dangerous region. Further, the area 4 is referred to as a tightening control area E4. In the control area E4, the appropriate moving speed T4 of the door 2 is 120 mm / s, the duty value D is 120, the resolution B is 2, and the attention level is a dangerous area. Further, the area 5 is referred to as a link deceleration control area E5. In this control area E5, the appropriate moving speed T5 of the door 2 is 200 mm / s, the duty value D is 200, the resolution B is 8, and the degree of attention is small. Further, the area 7 is referred to as a check control area E6. In this control area E6, the appropriate moving speed T6 of the door 2 is 250 mm / s, and the degree of attention is medium.
[0080]
The resolution B is set to 8 in the areas 1 and 6 in the normal area E1 and the area 5 in the link deceleration control area E5, which have a relatively low level of interest. Area 2 of the deceleration control area E2 is a danger area where pinching is likely to occur, but the resolution B is set to 4 because the opening of the door 2 is sufficiently large. Further, since the area 3 of the link deceleration control area E3 and the tightening control area E4 are the dangerous areas where the door 2 moves in a curved line and has the highest degree of attention, the resolution B is set to 2 which is the finest. . A sampling region Q determined based on these resolutions B is shown in FIG. n is the closing direction and m is the opening direction.
[0081]
(Auto slide mode judgment)
FIG. 17 is a flowchart showing details of the auto slide mode determination routine (step 116). In this routine, it is determined whether or not the automatic slide mode for opening and closing the slide door 2 is selected. When it is determined that the door 2 has started, processing during the automatic slide operation is performed. When the end of the auto slide operation is determined, the auto slide stop process is performed and the auto slide operation is ended.
[0082]
First, if the auto-slide is stopped, it is not in the stop mode state (step 163) and not in the auto-slide operation (step 165), so the on / off state of the main switch is checked (step 167), and the main switch is off. If there is, return.
[0083]
If the main switch is on, manual and start determinations (steps 168 and 169) are performed. Details of the manual determination (step 168) will be described later (FIG. 18). However, when it is detected that the door 2 has moved at a predetermined speed or more, it is set to the manual open or manual closed state, and the automatic slide operation mode is entered. Prepare for.
[0084]
When manual determination is completed, start mode determination is executed (step 169). The start mode determination is a process for determining the auto slide operation mode. In the switch determination (step 102), the door opening of the remote control switch 30 is detected, the ON of the door opening switch 28 is detected, or the manual determination (step). When the manual open state is confirmed in 168), the automatic open operation mode (step 181) is set. Further, when the door close of the remote control switch 30 is detected outside the danger area, or when the door close switch 29 is turned on, or when the manual close state is confirmed, the automatic close operation mode (step 182) is set. Further, when it is detected that the door closing switch 29 is turned on in the dangerous area, the manual closing operation mode (step 183) is set.
[0085]
When the start mode determination (step 169) is thus completed, it is determined whether or not the auto slide operation mode is set (step 170). If it is not in auto slide mode, it returns. If it is in the auto slide operation mode, since the auto slide has started, the operation count value G is cleared (step 171), set to the auto slide operation state (step 172), and set to the start state (step 172). 173), set to auto slide start (step 174). Thus, the auto slide operation is set.
[0086]
The check control (step 175) is a portion that performs temporary holding control for stopping and holding the door 2 with the electromagnetic clutch 16 in a half-clutch state. During manual operation, confirm that the door 2 has stopped.
[0087]
When the auto-slide start is set in steps 168 to 174, it is determined that the auto-slide operation is in progress and the start mode (steps 165 and 166) in the next auto-slide mode determination routine, and start mode processing is executed (step 176).
[0088]
This start mode identifies a mode for starting an auto-slide operation for power-driving the door 2 in accordance with the on / off state of each switch and the surrounding conditions, and performs control in the identified mode. Details of this will be described later. When the start mode ends and the next auto slide mode determination routine is entered, the normal mode is entered, and pinching determination (step 177), speed control (step 178), and slope determination (step 179) are executed. Details of these will be described later.
[0089]
Further, according to the open / close state of each switch performed in the start mode determination (step 169), the switch sentence 180 branches to an automatic opening operation (step 181), an automatic closing operation (step 182), and a manual closing operation (step 183). To do. When pinching is detected during these operations, the operation branches to a reverse rotation opening operation (step 184) and a reverse rotation closing operation (step 185).
[0090]
During the automatic slide operation (step 186), the operation count value G is incremented (step 187) and the process returns. When it is determined that the auto-slide operation is finished (step 186), the operation count value G is cleared (step 188), the stop mode is set (step 189), and the process returns.
[0091]
When the stop mode is set (step 189), the stop mode state is determined (step 163) in the next auto slide mode determination routine, and the stop mode (step 164) is executed. In this stop mode, the timing of turning off the electromagnetic clutch 16 and turning off the opening / closing motor 14 is set for the purpose of safety control when the power drive of the door 2 is stopped during the opening / closing control of the door 2 in the auto slide mode. I have control.
[0092]
That is, when the door 2 stops at an intermediate position between the fully open position and the fully closed position, the opening / closing motor 14 is stopped first, and then the electromagnetic clutch 16 is turned off after a predetermined waiting time. When the door 2 is in the fully closed position, the opening / closing motor 14 and the electromagnetic clutch 16 are immediately turned off simultaneously. During the stop mode operation, the operation count value G is incremented (step 191), and the process returns. When the stop mode ends, the operation count value G is cleared (step 192), the stop mode is canceled (step 193), the auto slide operation is ended (step 194), and the process returns.
[0093]
(Manual judgment routine)
FIG. 18 is a flowchart showing details of the manual determination routine (step 168). This manual determination routine detects the door speed measured separately from the main routine for controlling the door 2, thereby detecting that the door 2 has been operated by manual force and obtaining an opportunity to drive the power. .
[0094]
First, it is determined whether the door 2 is fully closed (half switch is on) (step 195A). If the door 2 is in the fully closed state, it is determined whether the door is in the fully closed state (step 195D). If not, the door is set in the fully closed state (step 195E). Next, it is determined whether the door handle 37 is operated and the handle switch 37a is turned on (step 195F). When the handle switch 37a is turned on (step 195F), the door fully closed state is cleared (step 195G), the fully closed-door open manual state is set (step 195H), and the process returns.
[0095]
If the door 2 is not fully closed (step 195A), it is determined whether the door is set to the fully closed state (step 195B). If it is set, the door fully closed state is cleared (step 195G). The door is opened manually (step 195H). Normally, the door 2 is opened by pulling the door handle 37, so that the door fully closed state is cleared (steps 195F and 195G). However, when the handle switch is broken or the system is omitted, It detects that the half switch has been turned off, clears the door fully closed state (steps 195A, 195B, 195G), and sets the fully closed-door open manual state (step 195H).
[0096]
If the door is not set to the fully closed state (step 195B), the speed data (a / T: a is the resolution of the rotary encoder) indicating the moving speed of the door 2 is faster than a predetermined manual recognition speed (step 195C). When the speed is less than the rapid closing speed (step 196), the mode is set to either the door open manual state (step 198) or the door closed manual state (step 199) based on the opening / closing direction (step 197). When the door speed is equal to or lower than the manual recognition speed (step 195C), the process returns by assuming that the door 2 is stopped. When the door speed is equal to or higher than the sudden closing speed (step 196), the closing operation by the manual force as it is for mechanical protection Return to continue.
[0097]
However, after the electromagnetic clutch 16 is turned off, the movement to the door open / close state is not accepted during the required time lag period in order to ignore the movement due to the tension of the wire.
[0098]
The manual recognition speed is a value that creates an opportunity to drive the door 2 and can be set to a relatively wide range of arbitrary values. Since the moving speed of the door 2, in other words, the cycle count value T can be measured with one cycle of the rotary encoder 18 as a minimum resolution, the door 2 is driven by the movement of the door 2 by about 1 mm. Can be produced. As a result, the response of the automatic opening / closing operation becomes highly sensitive, and the change in the movement of the door 2 can be detected with high resolution and high sensitivity in order to correspond to a process for obtaining safety.
[0099]
(Automatic opening operation routine)
FIG. 19 is a flowchart showing details of the automatic opening operation routine (steps 122 and 181). This automatic opening operation routine is selected by the switch statement 180 when the remote control switch 30 is operated to open the door, the door opening switch 28 is turned on, or the door opening manual state is confirmed, and the door 2 is safely opened. In order to drive the power, the door drive stop or reverse operation during the automatic opening operation is controlled.
[0100]
First, full open detection is performed (step 200). Although details of this full open detection will be described later, it is detected whether the door 2 is in a fully open state. When this full open detection is completed, a pinch determination is performed (step 201). It is determined whether it has been detected (step 205). The door 2 is not fully open or in an abnormal state (step 207), the switch can be received (step 208), the close switch of the remote control 30 and the door close switch 29 are both off (steps 210 and 211), and the main If the switch is on (step 212) and both the opening switch of the remote controller 30 and the door opening switch 28 are off (steps 213 and 214), the process returns and continues the auto-opening operation.
[0101]
When pinching is detected (step 201), target position calculation for shifting control in the reverse direction is executed (step 202), pinching is canceled (step 203), and if it is not a closed danger area (areas 2 to 4) (Step 204) The automatic opening operation is canceled, the reverse rotation closing operation is permitted, the door opening operation is canceled, the door closing operation is permitted (steps 215 to 218), and the process returns. If it is a close danger region, the automatic opening operation is canceled (step 223), and the process returns.
[0102]
If the door 2 reaches the fully open position (step 205), the door fully open detection is canceled (step 206), the automatic opening operation is canceled (step 223), and the process returns. Also, when an abnormality such as motor lock is detected (step 207), the automatic opening operation is canceled (step 223), and the process returns. The electromagnetic clutch 16 and the opening / closing motor 14 are controlled by releasing the automatic opening operation (step 223), and the door 2 is stopped (steps 106 and 107).
[0103]
In the present embodiment, all the open / close switches are of the push-on / push-off type. Therefore, it is determined that the switch is not ready to be received if any switch is kept pressed (step 208). Check the on / off status of the open / close switch.
[0104]
That is, if at least one of the open switch or door open switch 28 of the remote controller 30 is on (steps 209 and 219) and both the close switch or door close switch 29 of the remote controller 30 are off (steps 220 and 222), the process returns. Continue to open automatically. However, if one of the open switch or door open switch 28 of the remote controller 30 is on (steps 209 and 219) and one of the close switch or door close switch 29 of the remote controller 30 is on (steps 220 and 222), the open switch Therefore, the automatic opening operation is canceled (step 223), and the process returns. If both the open switch and the door open switch 28 of the remote controller 30 are off (steps 209 and 219), the switch is set so that the switch can be received (step 221), and the process returns.
[0105]
When the switch can be accepted (step 208), that is, when at least one of the close switch of the remote control 30 or the door close switch 29 is turned on when all of the open / close switches are off (steps 210 and 211), an instruction to close the door Is determined to have been issued, and the process proceeds to step 204 and subsequent steps.
[0106]
When the main switch is turned off (step 212), the automatic opening operation is canceled (step 223), the open / close motor 14 is stopped, and the process returns. When at least one of the opening switch of the remote control 30 or the door opening switch 28 is turned on (steps 213 and 214), the push-on / push-off type opening switch is turned on again, so that the slide is performed at that position. The automatic opening operation is canceled to stop the door 2 (step 223), and the process returns.
[0107]
(Automatic closing operation routine)
FIG. 20 is a flowchart showing details of the automatic closing operation routine (steps 123 and 182). This automatic closing operation routine is selected by the switch statement 180 when the remote control switch 30 is operated to close the door outside the danger area, the door closing switch 29 is turned on, or the door closing manual state is confirmed. In order to drive the power safely in the closing direction, control of the door drive stop or reverse operation during the automatic closing operation is performed.
[0108]
First, when the door 2 reaches the half latch area (step 224), the automatic closing operation is canceled (step 246), and the process returns. When the door 2 is outside the half latch area, the pinch determination is executed (step 225). There is no pinching, no abnormality, and switch reception is possible, both the open switch of the remote control 30 and the door open switch 28 are off, the main switch is on, and both the close switch of the remote control 30 and the door close switch 29 are off. If so (steps 229 to 235), since the automatic closing operation is being performed, the process returns.
[0109]
When pinching is detected (step 225), target position calculation is performed to move the door 2 in the opposite direction (step 226), pinching is released (step 227), and the automatic closing operation is released (step 228). The reverse opening operation is permitted, the door closing operation is released, and the door opening operation is permitted (steps 236 to 238). Next, if the door 2 is not in the ACTR area, the process returns. If the door 2 is in the ACTR area (step 239), the ACTR operation is permitted (step 240) and the process returns.
[0110]
If an abnormal current is detected due to motor lock or the like (step 229), the automatic opening operation is canceled (step 246) and the process returns. The electromagnetic clutch 16 and the opening / closing motor 14 are controlled by releasing the automatic closing operation (step 246), and the door 2 is stopped (steps 106 and 107).
[0111]
If it is determined that one of the open / close switches is pressed and the switch is not acceptable (step 230), the on / off state of each open / close switch is confirmed. That is, if at least one of the close switch of the remote control 30 or the door close switch 29 is on (steps 241 and 242) and both the open switch or the door open switch 28 of the remote control 30 are off (steps 243 and 244), the process returns. The auto close operation continues.
[0112]
However, if at least one of the opening switch of the remote control 30 or the door opening switch 28 is on (steps 243 and 244), both the opening switch and the opening switch are turned on, so the automatic closing operation is canceled. (Step 246), the process returns. If both the close switch of the remote control 30 and the door close switch 29 are off (steps 241 and 242), the switch is set so that the switch can be received (step 245), and the process returns.
[0113]
When the switch can be accepted (step 230), if at least one of the open switch of the remote controller 30 or the door open switch 28 is turned on (steps 231 and 232), it is determined that the door opening operation instruction has been issued, and the above-described steps The processing shifts to 228 and later.
[0114]
When the main switch is turned off (step 233), the automatic closing operation is canceled (step 246), and the process returns. When at least one of the close switch of the remote control 30 or the door close switch 29 is turned on (steps 234 and 235), the push-on / push-off type close switch is turned on again. 2 is stopped (step 246) and the process returns.
[0115]
(Manual closing operation routine)
FIG. 21 is a flowchart showing details of the manual closing operation routine (step 126.183). In the manual closing operation routine, when it is confirmed that the door closing switch 29 is turned on in the danger area, the switch sentence 180 is selected, the closing operation is performed only when the operator presses the closing switch 29, and the closing switch 29 is released. And the door 2 is stopped.
[0116]
First, pinch determination is executed (step 247). If there is no pinching, it is determined whether the door closing switch 29 is turned on (step 249), and if it is turned on, the routine returns to continue the manual closing operation. If the close switch 29 is not turned on, the manual close operation is canceled (step 255), and the process returns. The electromagnetic clutch 16 and the opening / closing motor 14 are controlled by releasing the manual closing operation (step 255), and the door 2 is stopped (steps 106 and 107).
[0117]
When pinching is detected (step 247), the presence of pinching is released (step 248), the door closing operation is released to transfer control in the reverse direction, the door opening operation is permitted, the manual closing operation is released, and the reverse opening is performed. The operation is permitted, target position calculation is executed (steps 250 to 254), and the process returns.
[0118]
(Reverse opening operation routine)
FIG. 22 is a flowchart showing details of the reverse rotation opening operation routine (steps 127 and 184). This reverse opening operation routine stops when the door 2 is reversely moved to the calculated target position when it is determined that there is jamming during the automatic closing operation (FIG. 20) or the manual closing operation (FIG. 21). In this mode, the stop or reversing operation of the door 2 is safely controlled.
[0119]
First, full open detection is performed (step 256). The fully open detection is for determining the fully open state of the door 2. When this fully open detection is completed, it is determined whether the door 2 is the target position calculated from the current position count value N (step 257). Door 2 is not at the target position, the main switch is on (step 259), door 2 is not at the fully open position (step 260), is not pinched (step 262), is not in an abnormal state (step 264), and switch acceptance If it is possible (step 266) and both the remote control close switch and the door close switch are off (steps 267 and 269), the process returns because the reverse opening operation is being performed.
[0120]
When the door 2 reaches the target position (step 257) or when the main switch is off (step 259), the reverse opening operation is canceled (step 258) and the process returns. If the door 2 is in the fully open position, the door fully open detection is canceled (steps 260 and 261), if pinching is detected, pinching is released (steps 262 and 263), and if an abnormal state such as motor lock is detected, an abnormal state is detected. The detection is canceled (steps 264 and 265), the reverse rotation opening operation is canceled (step 258), and the process returns. The electromagnetic clutch 16 and the opening / closing motor 14 are controlled by releasing the reverse opening operation (step 258), and the door 2 is stopped in the main routine (steps 106 and 107).
[0121]
Further, when the close switch of the remote controller 30 or the door close switch 29 is turned on when the switch can be received (all open / close switches are off) (steps 267 and 269), the reverse opening operation is canceled (step 258). ) Stops the open / close motor 14 and returns.
[0122]
When the switch is not ready to be accepted (step 266), the on / off state of each open / close switch is confirmed. If the open / close switches are not all off (step 268), the process returns and if the open / close switches are all off, The switch is set in a state where the switch can be accepted (step 270), and the process returns. This is because, for example, when there is a pinch during the manual closing operation and reverse rotation, the door closing switch 29 may be depressed, and even in such a case, this mode is continued.
[0123]
(Reverse closing operation routine)
FIG. 23 is a flowchart showing details of the reverse rotation closing operation routine (steps 128 and 185). This reverse closing operation routine is a mode in which the door 2 is reversely moved and stopped at the target position calculated by obtaining the determination that there is pinching during the automatic opening operation (FIG. 19), and the door 2 is safely stopped or reversed. To control.
[0124]
First, it is determined from the current position count value N whether the door 2 is a target position or a dangerous area (areas 2 to 4) (steps 271 and 273). The current position of the door 2 is neither, the main switch is on (step 274), there is no pinching (step 275), there is no abnormality (step 277), the switch can be accepted (step 279), and the remote control is opened. If both the switch and the door opening switch are off (steps 280 and 283), the process returns because the reverse rotation closing operation is being performed.
[0125]
If the door 2 is at the target position or the dangerous area (steps 271 and 273) or the main switch is off (step 274), the reverse rotation closing operation is canceled (step 272) and the process returns. The electromagnetic clutch 16 and the opening / closing motor 14 are controlled by releasing the reverse rotation closing operation (step 272), and the door 2 is stopped in the main routine (steps 106 and 107).
[0126]
Also, when pinching is detected, pinching is canceled (steps 275 and 276). When an abnormality such as motor lock is detected, abnormal state detection is canceled (steps 277 and 278), and the reverse rotation closing operation is canceled. (Step 272) and return.
[0127]
Also, when the open switch of the remote controller 30 or the door open switch 28 is turned on when the switch is ready to be received (each open / close switch is off) (steps 280 and 283), the reverse rotation opening operation is canceled (step 272). ), Return.
[0128]
When the switch is not ready to be accepted (step 279), if all the open / close switches are not off (step 281), the process returns as it is, and when all the open / close switches are off, the switch is accepted (step 282). Return. This is because the door opening switch 28 may be pressed when there is a pinch during the automatic opening operation and reverse rotation, and this mode is continued even in such a case.
[0129]
(Target position calculation routine)
FIG. 24 is a flowchart showing details of the target position calculation routine (steps 202, 226, 254). This target position calculation routine reverses the door 2 from the moving direction up to that time in the auto-opening operation (FIG. 19), the auto-closing operation (FIG. 20), or the manual closing operation (FIG. 21), so that the safe position is detected. This is a routine for calculating a target position for reverse rotation up to.
[0130]
First, the moving direction of the door 2 is determined (step 284). If it is determined that the door 2 is operating in the opening direction, it is determined whether the current position of the door 2 is area 3 or 4 (step 285A). If the position of the door 2 is areas 3 and 4, the current position of the door 2 is set as the target position (step 285C). This is because there is a danger of pinching again in reverse rotation operation when pinching occurs during opening operation. Therefore, reverse rotation closing operation is not performed in areas 3 and 4, and the current position is set as the target position.
[0131]
If the position of the door 2 is other than the areas 3 and 4, the movement amount designated in advance is subtracted from the value of the current position indicated by the position count value N to obtain the value of the target position (step 285B). However, if the value of the target position is a dangerous area equal to or smaller than area 3 (step 289), the boundary value (N = 350) between area 2 and area 3 is set as the target position (step 290).
[0132]
If it is determined that the door 2 is operating in the closing direction, the movement amount designated in advance is added to the value of the current position indicated by the position count value N to obtain the value of the target position (step 286). When the target position value exceeds the fully open position value (N = 850) (step 287), the fully open position value is set as the target position (step 288).
[0133]
(Fully open detection routine)
FIG. 25 is a flowchart showing details of the fully open detection routine (steps 130, 200, and 256). This fully open detection routine recognizes and stores the position count value N of the fully open position of the door 2 during the initial operation, and thereafter, during the automatic opening operation (FIG. 19) or the reverse opening operation (FIG. 22), 2 is a routine for detecting that the fully opened state is reached.
[0134]
First, in the initial operation, the door 2 is moved from the fully closed position (N = 0), and when the position count value N reaches the area 7 (step 291), it is determined whether or not the fully opened position data has already been recognized (step 291). Step 292). Since it is not recognized at the time of initial operation, it is determined whether or not the door 2 has stopped at the fully open position (step 293). If the door 2 has not stopped at the fully open position, the process returns. If it has stopped, the position count value N at that time is taken out. Step 295).
[0135]
Next, a full open margin (arbitrary value) is subtracted from the position count value N at that time, and the result is stored in the required memory unit as a full open recognition value (steps 296, 297). The fully open margin is set to be in front of the fully open position in consideration of the amount of movement because a slight movement occurs even if the door 2 is stopped while being recognized as the fully open position during the opening operation of the door 2. When the fully open recognition value is set in this way, the door fully open state is detected (step 298), and the process returns.
[0136]
After setting the fully open recognition value, when the position count value N reaches the area 7 (step 291), since the fully open position data has already been recognized (step 292), when the position count value N reaches the fully open recognition value, the door is fully opened. A state is detected (step 298) and the process returns.
[0137]
(Start mode)
FIG. 26 is a flowchart showing details of the start mode routine (steps 117 and 176). This start mode is a process for selecting and starting a mode for starting the door 2 in accordance with the on / off state of each switch, the surrounding conditions, and the like.
[0138]
First, it is determined whether a start identifier is set (step 299). Since it is not initially set, it is determined whether the manual mode is set (step 301A). If it is the manual mode, it is determined whether it is in the fully closed-door open manual state (step 301B). If so, the manual fully closed start mode is set (step 302A). Otherwise, the manual normal start mode is set (step 301). 302B), each cancels the manual mode (step 303).
[0139]
If it is not the manual mode, it is determined whether the door is open (step 304). If the door is open, it is determined that the control is in the ACTR control region (step 305). If it is the ACTR control region, the ACTR start mode is set (step 306). If it is not the door opening operation or the door opening operation is not in the ACTR control region, the normal start mode is set (step 307). When the identifier for each start is set in this way, the auto slide mode operation count value G is cleared (step 308), and the process returns. The setting conditions for each start mode are summarized as follows.
[0140]
Normal start mode: Start by switch operation when not fully closed
ACTR start mode: Start by switch operation when fully closed
Manual normal start mode: Starts manually when not fully closed
Manual fully closed start mode: Starts manually when fully closed
When the start-specific identifier is set in this way and the start mode is selected in the next routine, the start-specific identifier is set (step 299). Accordingly, according to the identifier (step 300), the normal start mode (step 309) is set. ), ACTR start mode (step 310), manual normal start mode (step 312A), and manual fully closed start mode (step 312B).
[0141]
The normal start mode controls when starting outside the door fully closed area. First, the electromagnetic clutch 16 is turned on (step 106), and the opening / closing motor 14 and the drive pulley 15 are connected. After the on-time lag of the electromagnetic clutch 16, the auto-sliding operation is set, and the open / close motor 14 is turned on (step 107). Thereafter, when the open / close motor 14 is turned on, the start identifier for each operation is reset, and the end of the start control for each operation is notified to another routine.
[0142]
The ACTR start mode controls the start mode in which the door 2 is automatically driven after the engagement between the door lock latch 8 and the striker 9 is released via the ACTR 35. After confirming that the half latch switch 36 is off for a certain time, the electromagnetic clutch 16 is turned on (step 106). After the on-time lag of the electromagnetic clutch 16, the auto slide operation is performed. Thereafter, when the opening / closing motor 14 is turned on (step 107), the start identifier for each operation is reset, and the end of the start control for each operation is notified to other routines.
[0143]
The manual normal start mode and the manual fully closed start mode will be described later. When the identifier is reset and the start mode is selected again in the next routine, the start mode is canceled (steps 313 and 314), the operation count value G is cleared (step 315), and the process returns.
[0144]
(Manual normal start mode)
FIG. 27 is a flowchart showing the manual normal start mode (step 312A). In this manual normal start mode, a manual operation is detected when the door 2 is not in a fully closed state, and the door 2 is driven in an auto mode in an opening direction or a closing direction.
[0145]
First, it is determined whether the auto-sliding opening / closing motor 14 is operating (step 316). Since it is not initially in an operating state, it is set to a motor drive voltage determined by PWM control described later (step 318). Next, the operation direction of the door 2 is discriminated (step 326), and if it is an open operation, the door is opened so that the motor 14 is driven in the open direction (step 327). If it is a closing operation, the door is closed and the motor 14 is prepared to be driven in the closing direction (step 328). If the direction is the open direction (step 327), it is determined whether the region is the ACTR region (step 329). If the region is not the ACTR region, the process returns. If the region is the ACTR region, the ACTR operation is enabled (step 330).
[0146]
If the opening / closing motor 14 is in the operating state (step 316), it is determined whether the manual time lag has passed by the operation count G (step 317). If it has not passed, the process returns, and if it has passed, it is determined whether the manually moving speed of the door 2 is faster than the door quick closing speed (step 319). If the moving speed of the door 2 is slower than the door rapid closing speed, it is next determined whether or not it is slower than the manual recognition speed (step 320). If not late, the clutch operation is set to be possible (step 322), the operation count G is cleared to measure the door operation time after the clutch operation (step 323), the manual normal start mode is released (step 324), Return.
[0147]
When the manual door 2 moving speed is higher than the door quick closing speed (step 319), in order to give priority to the manual door quick closing operation, the door quick closing operation is set (step 321), and an abnormal state is entered. The motor is stopped by setting (step 325), the manual normal start mode is canceled (step 324), and the process returns.
[0148]
Also, when the moving speed of the door 2 is slower than the manual recognition speed (step 320), in order not to shift to the auto mode, it is set to an abnormal state (step 325) and the manual normal start mode is canceled (step 324). To return. When set to the abnormal state, the abnormal state is detected in each routine of the automatic opening operation and the automatic closing operation, the operation is canceled, and the motor is stopped in the stop mode.
[0149]
(Manual fully closed start mode)
FIG. 28 is a flowchart showing the manual fully closed start mode (step 312B). In this manual fully closed start mode, a manual operation is detected when the door 2 is in a fully closed state, and the door 2 is driven in an automatic mode in the opening direction.
[0150]
First, it is detected from the phase relationship between the pulse signals φ1 and φ2 whether the door 2 is moving in the opening direction (step 330A). If it is moving in the opening direction, it is set to a motor driving voltage determined by PWM control which will be described later (step 330B), and then set to be able to open the door and prepared to drive the motor 14 in the opening direction. (Step 330C), and further, ACTR operation is set to be possible (step 330D).
[0151]
Next, it is confirmed that the half switch is turned off (step 330E). If it is off, the clutch is set to be operable and the electromagnetic clutch 16 is prepared to be driven (step 330F). In order to measure time, the operation count G is cleared (step 330G), the manual fully closed start mode is canceled (step 330H), and the process returns.
[0152]
If the door 2 is not moving in the opening direction (step 330A), this mode is unnecessary. Therefore, the motor is stopped by setting it to an abnormal state (step 330I), and the manual full-close start mode is canceled. (Step 330H), the process returns. Since the door lock may be re-fitted even when the half switch is off, the door lock is set to an abnormal state (step 330I), the manual fully closed start mode is canceled (step 330H), and the process returns.
[0153]
In addition, although the system which starts operation | movement of ACTR is also considered, since ACTR will operate | move first when the door handle switch 37a is turned on, since ACTR is unlocked, a lock | rock can be unlocked with a small force.
[0154]
(Speed control routine)
FIG. 29 is a schematic diagram of the speed control routine (steps 120 and 178). This speed control routine determines a control target value for the current moving speed so that the speed of the sliding door 2 becomes an appropriate moving speed determined for each of the control areas E1 to E6 described above. It controls the speed. In the present embodiment, the speed control of the sliding door 2 is performed by changing the duty cycle of the rectangular wave voltage applied to the opening / closing motor 14, that is, adjusting the output torque of the opening / closing motor 14 by pulse width modulation (PWM). Therefore, the following description will be given as PWM control.
[0155]
This PWM control (step 331) includes target value determination (step 332), adaptation calculation (step 333), and feedback adjustment (step 334). Difference calculation is performed at a lower level of the adaptation calculation (step 333) (step 335). ) And an adjustment amount calculation (step 336) is provided at a lower level of the feedback adjustment (step 334).
[0156]
FIG. 30 is a block diagram showing the function of each part of target value determination (step 332), adaptation calculation (step 333), difference calculation (step 335), and adjustment amount calculation (step 336). In the figure, a door position detector 60 obtains a position count value N and a moving direction Z from pulse signals φ 1 and φ 2 from the rotary encoder 18.
[0157]
The control area discriminating unit 61a obtains the areas 1 to 7 where the door 2 is present from the position count value N and the moving direction Z, and refers to the memory table shown in FIG. ~ E6 is discriminated. Then, the cycle count values T1 to T6 corresponding to the appropriate moving speeds of the slide door 2 required for the control areas E1 to E6 are obtained.
[0158]
The control speed selection unit 61b obtains an appropriate speed cycle count value To (T1 to T6) corresponding to the determined appropriate movement speed of the control area Ei (i = 1 to 6) and corresponds to the maximum movement speed in the control area. The maximum speed cycle count value Tmin and the minimum speed cycle count value Tmax corresponding to the minimum movement speed are obtained. The function of determining the target value (step 332) is achieved by the control area discriminating unit 61a and the control speed selecting unit 61b.
[0159]
The appropriate speed cycle count value To of the control area Ei obtained by the control speed selection unit 61b is sent to the adjustment amount calculation unit 62 and used for obtaining the feedback adjustment amount R. Details thereof will be described later. The feedback adjustment amount R obtained by the adjustment amount calculation unit 62 is sent to a maximum adjustment amount restriction unit 63 that sets an upper limit value. The adjustment amount calculation unit 62 and the maximum adjustment amount restriction unit 63 achieve the function of calculating the adjustment amount (step 336).
[0160]
The door moving speed detector 64 corresponds to a pulse count timer (step 115A), counts the clock pulse C1 at every generation interval of the interrupt pulse g1, and obtains the count value at that time as the moving speed cycle count value Tx. This reciprocal is the current moving speed of the slide door 2.
[0161]
The moving speed cycle count value Tx is input to the too fast detection unit 65 and the too slow detection unit 66. The maximum speed cycle count value Tmin is input to the too-fast detector 65, and the minimum speed cycle count value Tmax is input to the too-slow detector 66. The function of the adaptation calculation (step 333) is achieved by the too-fast detector 65 and the too-slow detector 66.
[0162]
The too fast detection unit 65 subtracts the maximum speed cycle count value Tmin from the cycle count value Tx representing the current moving speed by the difference calculation unit 65a to obtain the too fast amount TH. It is sent to temporary holding units 65b and 65c using a two-stage shift register or the like. Then, the pre-temporary holding unit 65c holds the excessively fast amount TH2 whose extraction time is one previous time, and the subsequent temporary holding unit 65b holds the excessively fast amount TH1 one time after the current time or the previous extraction time. Hold on. The two too-fast amounts TH1 and TH2 are added by the correction amount calculation unit 65d and output as the too-fast matching difference JNH.
[0163]
Similarly, the too-slow detection unit 66 subtracts the minimum speed cycle count value Tmax from the cycle count value Tx representing the current moving speed by the difference calculation unit 66a to obtain the too-slow amount TL. It is sent to the temporary storage units 66b and 66c using a two-stage shift register or the like. Then, the temporary hold unit 66c at the preceding stage holds the too late amount TL2 with the previous extraction time, and the temporary hold unit 66b at the subsequent stage holds the subsequent too late amount TL1 at the current time or the previous extraction time. Hold on. The two too late amounts TL1 and TL2 are added by the correction amount calculation unit 66d and output as the too late matching difference JNL. The difference calculation unit 65a, 66b achieves the function of difference calculation (step 335).
[0164]
If the speed discriminating unit 65e of the too fast detecting unit 65 discriminates that the current cycle count value Tx is larger than the cycle count value Tmin, that is, if it discriminates that the current moving speed is slower than the maximum speed, it is temporarily suspended. The reserved contents of the parts 65b and 65c are reset to zero. Similarly, when the speed determination unit 66e of the too-slow detection unit 66 determines that the current cycle count value Tx is smaller than the cycle count value Tmax, that is, if the current movement speed is determined to be faster than the minimum speed. Then, the content of the temporary holding units 65b and 65c is reset to zero.
[0165]
Thus, when the current moving speed of the slide door 2 is not too fast or too slow, the contents of the temporary holding unit are reset to zero. As a result, in order for two of the too fast amounts TH1, TH2 or too slow amounts TL1, TL2 to be delivered together to the correction amount calculation units 65d, 66d, too fast or too late must occur twice. Thus, false detection is prevented.
[0166]
The too fast adaptation difference JNH and the too slow adaptation difference JNL are sent to the feedback adjustment unit 67 and the adjustment amount calculation unit 62. In the adjustment amount calculation unit 62, both the adjustment differences JNH and JNL are collectively treated as the adjustment difference JN, and the calculation formula for the adjustment amount R is selected using the appropriate speed cycle count value To obtained by the control speed selection unit 61b as an identifier. The adjustment amount R is obtained. For example, if the period count value To is Ta, the adjustment amount R is 3 times the difference JN, that is, R = 3JN. Similarly, if the period count value To is Tb, then R = 2JN and the period count value To is Tc. , R = JN, and R = 3JN unless the cycle count value To is any of Ta, Tb, and Tc.
[0167]
Although Ta, Tb, and Tc may be values of arbitrary magnitudes, it is substantially preferable to substantially correspond to the appropriate moving speed set in the area of high attention and the dangerous area shown in FIG. The magnification coefficient for calculating the adjustment amount R is set to a required value suitable for feedback control according to the curved portion or straight portion of the movement locus of the door 2. Further, the upper limit value (D 1) of the adjustment amount R is limited by the maximum adjustment amount restriction unit 63 and is converted into a duty value D described later, and the duty value D is input to the feedback adjustment unit 67.
[0168]
The power supply voltage detector 68 measures the voltage Vx of the battery 24. The duty calculator 69 calculates the duty cycle Do of the required voltage equivalent Vo when the voltage is Vx. A duty cycle (hereinafter referred to as duty) Do corresponding to the required voltage Vo is a voltage waveform of 100% duty, that is, an output torque when a DC voltage Vo is applied, and an arbitrary voltage Vx higher than the DC voltage Vo is applied. The duty Do for obtaining the same output torque is expressed by the following equation.
[0169]
Do [%] = (Vo / Vx) · Dmax [%]
However, the current value flowing through the motor is constant. The duty 100% corresponds to the DC voltage waveform at the H level and is expressed as Dmax, and the duty 0% corresponds to the DC voltage waveform at the L level and is expressed as Dmin.
[0170]
That is, the duty calculator 69 detects the voltage fluctuation of the battery 24 as the measured voltage Vx by the power supply voltage detector 68, and obtains the duty Do corresponding to the required voltage Vo from the voltage Vx and the required voltage Vo based on the calculation formula. . Further, the duty calculator 69 obtains the amount of change in duty when the voltage changes 1 V [volt] above or below the required voltage Vo, and this is set as the 1 V equivalent duty D1. The duty Do equivalent to the required voltage Vo and the duty equivalent to 1V D1 are input to the feedback adjustment unit 67.
[0171]
The duty calculation unit 69 obtains the correction value D ′ of the duty D with respect to the power supply voltage fluctuation in advance, including the current change and the motor load characteristics. It is also possible to obtain a memory map by addressing with the power supply voltage Vx.
[0172]
The graph shown in FIG. 31 shows the relationship between voltage fluctuation and duty D when the current flowing through the motor is constant. The horizontal axis represents voltage Vx and the vertical axis represents duty D. The vehicle battery 24 has a maximum voltage Vmax of 16V and a minimum voltage Vmin of 9V, and the duty is determined in accordance with the voltage change therebetween.
[0173]
(PWM control routine)
FIG. 32 is a flowchart showing details of the PWM control routine (step 331). This PWM control routine is a control that adjusts the duty D of the driving voltage of the motor 14 by PWM control so that it matches the target speed determined for each area when the sliding door 2 is driven by the opening / closing motor 14. The time F until the feedback adjustment is performed in consideration of the delay of the mechanism portion is adjusted for each area.
[0174]
First, it is determined whether there is a PWM target value (step 337). If the target value is not found, the target value is determined (step 339) and the process returns. The target value is determined by the control region discriminating unit 61a and the control speed selecting unit 61b.
[0175]
If the target value has been obtained, it is checked whether the feedback count F is maximum (step 338). If it is not maximum, it is incremented (step 340), and if it is maximum, step 340 is jumped. The feedback count F functions as a timer, and feedback adjustment is performed when the count F reaches a certain value as will be described later. The maximum value MAX is a value of 10 or more, for example.
[0176]
Next, the fitness is calculated by the too-fast detector 65 and the too-slow detector 66 (step 341), and it is detected whether there is low-speed difference data, that is, the too-slow amount TL (step 342). If there is an excessively slow amount TL, the low speed number L is incremented (step 343). If the amount TL is not too slow, the low speed number L is cleared (step 344).
[0177]
Next, if it is area 3 (step 345), it is checked whether the value of the feedback count F is 5 or more (step 346). If the value of the feedback count F is not 5 or more, the process returns. Return is also made for area 4 (steps 345 and 347). If the area is neither area 3 nor area 4, that is, areas 1, 2, 5, 6 and 7, whether the value of feedback count F is 10 or more is checked (step 348). Return.
[0178]
When the value of feedback count F is 5 or more in area 3 (step 346), or when the value of feedback count F is 10 or more in areas 1, 2, 5 to 7 (step 348), feedback adjustment described later is performed. (Step 349) As a result, if the duty is adjusted, the feedback count F is cleared (Step 351), and the process returns. If the duty is not adjusted, the process returns as it is.
[0179]
As a result, since the speed of the slide door 2 may decrease at a curved portion such as the area 3, feedback adjustment is performed with a narrower adjustment interval than other areas. Specifically, if the loop period of the main routine is 10 msec, the routine is performed at intervals of 50 msec in area 3 and at intervals of 100 msec in areas 1, 2, 5-7.
[0180]
(Feedback adjustment routine)
FIG. 33 is a flowchart showing details of the feedback adjustment routine (steps 334 and 349). This feedback adjustment routine performs duty (DUTY) adjustment so that the speed of the slide door 2 becomes the target speed when the too slow amount TL and the too fast amount TH are generated continuously twice or more.
[0181]
First, it is checked whether there are too late amounts TL1 and TL2 in the temporary holding units 66b and 66c of the too late detection unit 66 (step 352). It is checked whether there is TH2 (step 353). If both are not present, the feedback adjustment is unnecessary, so the adjustment amount R is cleared (step 356) and the process returns.
[0182]
If the temporary holding units 65b and 65c have the too fast amounts TH1 and TH2, the two too fast amounts TH1 and TH2 are added to obtain the too fast matching difference JNH (step 355), and the adjustment amount calculating unit 62 and the maximum adjustment are obtained. The adjustment amount R is calculated by the amount limiting unit 63 (step 357). Next, it is checked whether there is an adjustment amount in the previous routine (step 358), and if it is an acceleration (step 359), the current adjustment amount R is set to a half value (step 360). This is because the adjustment amount is added because the previous time is too late, and the adjustment amount is subtracted this time because it is too fast, so if the adjustment amount is large, there is a high possibility that it will be too late again.
[0183]
When there is no adjustment amount in the previous routine, when the speed was not increased last time, or when the adjustment amount R is set to a half value (steps 358 to 360), the adjustment amount R (also this Duty) is subtracted to obtain a new duty DNEW (step 361), this new duty DNEW is output (step 362), and the process returns. As a result, the opening / closing motor 14 is driven to decelerate by the rectangular wave voltage having the new duty DNEW.
[0184]
If there are too late amounts TL1, TL2 in the temporary storage units 66b, 66c (step 352), it is checked whether the current position of the door 2 is the opening direction (areas 5-7) or the closing direction (areas 1-4) (step 352). 353). This is because the closing direction may be pinched and cannot simply be driven at an increased speed by feedback adjustment.
[0185]
That is, if the direction is the closing direction, it is determined whether the low speed counter has counted a predetermined time lag (step 364A), and if the predetermined time lag has not passed, the process returns. If the predetermined timing has passed, it is determined whether there is an initial state in which there is no load learning (step 364B). If the learning value is in an increasing tendency instead of the initial state (step 364C), if there is an error in the pinching determination described later (step 364E), there is a possibility of pinching and the process returns.
[0186]
If the learning value is not increasing (step 364C), but the current value is increasing (step 364D) and is continuing (step 365), there is a possibility of pinching and the process returns.
[0187]
In other cases, that is, when there is no error (step 364E), when the current value does not tend to increase (step 364D), when the current value does not continue increasing (step 365), the possibility of pinching is If not, perform feedback adjustment for speed-up drive. Of course, the feedback adjustment of the speed increasing drive is also performed when the door 2 is in the opening direction (step 353) or in the initial state (step).
[0188]
In the feedback adjustment of the acceleration drive, first, the two too slow amounts TL1 and TL2 are added to obtain the too late matching difference JNL and stored in the memory (steps 366 and 367), the adjustment amount calculating unit 62 and the maximum adjustment amount. The restriction unit 63 calculates the adjustment amount R (step 368). Next, it is checked whether there is an adjustment amount in the previous routine (step 369), and if it is a deceleration (step 370), the current adjustment amount R is set to a half value (step 371). This is because the previous time is too fast and the adjustment amount is subtracted, and this time it is too late and the adjustment amount is added, so if the adjustment amount is large, there is a high possibility that it will be too fast again.
[0189]
When there is no adjustment amount in the previous routine, when there was no deceleration in the previous time, or when the adjustment amount R was set to a half value (steps 369 to 371), the adjustment amount R (also duty cycle) ) To obtain a new duty DNEW (step 372), output this new duty DNEW (step 362), and return. As a result, the opening / closing motor 14 is driven at an increased speed by the rectangular wave voltage having the new duty DNEW.
[0190]
(Pinch determination routine)
FIG. 34 is a diagram showing an outline of the pinching determination routine (steps 118 and 177). This pinching determination routine detects the pinching of a foreign object while the sliding door 2 is being opened and closed. Based on this detection result, the door 2 that is being opened and closed is triggered to reversely rotate to ensure safety.
[0191]
This pinching determination routine includes routines such as learning determination (step 374), continuation & change amount (step 375), and comprehensive determination (step 376), which will be described in detail later. The lower level of learning determination (step 374) includes learning address calculation (step 377), error determination (step 378), learning weighting (step 379), average value calculation (step 380), and comparison value generation (step 381). ), Learning processing (step 382), learning delay processing (step 383), and the like. Further, a comparison value calculation (step 384) routine is provided at a lower level of the comparison value generation (step 381).
[0192]
FIG. 35 is a flowchart showing a pinching determination routine (step 373). Although details of each routine will be described later, first, it is determined whether learning of the rate of change of the motor load for each sampling region has been completed (step 385). If not completed, the learning process and the learning delay process are executed (steps 386A and 386B), and the process returns.
[0193]
If the learning process has been completed, it is determined whether the mode is the stop mode (step 387). If the mode is the stop mode, the door 2 is stopped and the process returns. If it is not the stop mode, a learning determination (step 388) is performed. Next, continuation & change amount processing (step 389) for detecting the change amount of the motor current value and the duration of increase is performed. In the subsequent comprehensive determination (step 390), it is determined whether or not there is pinching based on the determination obtained in the learning determination (step 388), the change amount of the motor current value obtained in the continuation & change amount processing (step 389), the increase duration time, and the like. Down.
[0194]
(Function block diagram for pinching determination)
FIG. 36 is a block diagram illustrating functions of the pinching determination routine. In the figure, a sampling area calculation unit 70, a sampling area load data calculation unit 72, and a storage learning data calculation unit 75 convert a standard load resistance component (including its rate of change) due to opening / closing of the slide door 2 to the motor 14. And is stored in the load sample data memory 71 in correspondence with the sampling region Qn (or Qm, hereinafter the same) that is specific to the open / close state and position of the door 2.
[0195]
The load resistance component stored for one sampling region Qn is the current increase rate ΔIAn between the previous and next sampling regions based on the average current value IAn of the current values IN included in the number of resolutions B in the sampling region Qn.
[0196]
When the door 2 is normally opened and closed, the standard load resistance component stored for each sampling region Qn and the current load resistance component are compared by the pinching determination unit 85 to detect the presence or absence of pinching. The load resistance component stored in the memory 71 in accordance with the sampling area Qn is corrected and learned and updated based on a new load resistance component every time the door 2 is opened and closed.
[0197]
In addition, the pinch determination unit 85 obtains the change amount calculation unit 87 from the current value IN measured by the current measurement unit 73, the previous current value I′N stored in the previous current value memory unit 86, and the current current value IN. The sandwiching determination is performed based on the current increase value ΔI, the increase count value K output from the current increase count counting section 88, and the tilt determination data θ from the slope detecting section 89. Details of the determination operation will be described later.
[0198]
(Sampling area calculation unit 70)
The sampling area calculation unit 70 counts out the pulse signal φ1 from the position count value N and the movement direction Z supplied from the door position detection unit 60 according to the resolution B defined in the areas 1 to 7 (FIG. 16). The address of the sampling area Qn (or Qm) is determined based on the counted value n (or m).
[0199]
The count value n is a value obtained by thinning and counting in the closing direction according to the resolution B, and the count value m is a value obtained by thinning and counting in the opening direction. Each represents an address number indicating the position of the door 2. Since the address number n is a number attached in the direction in which the door 2 is closed, the address number n is decremented when the door 2 is closed. Therefore, the address number one before the moving door 2 is n + 1. On the other hand, since the address number m is a number attached in the direction in which the door 2 opens, the address number immediately before the moving door 2 is m-1.
[0200]
The relationship among the address numbers n, m, resolution B, and position count value N is
N / B = n + b
N / B = m + b (n and m are integer parts of the quotient, b is the remainder of the quotient)
It is expressed.
[0201]
The address numbers n and m are addresses of the load sample data memory 71, and the remainder b acts to shift the data in the current value storage register 74 having the same number of registers as the resolution B in the load data calculation unit 72. .
[0202]
(Load sample data memory 71)
The load sample data memory 71 outputs the average current values IAn and IAm constituting the storage data of the sample areas Qn and Qm designated by the address numbers n and m from the sampling area calculation unit 70 to the predicted comparison value calculation unit 76. Also output to the storage learning data calculation unit 75.
[0203]
(Load data calculation unit 72)
The load data calculation unit 72 takes the average value of the current value IN of the motor 14 stored in the current value storage register 74 having the same number of stages as the resolution B for each sampling region Qn and Qm, and stores it as the average current value IAn. To the learning data calculation unit 75. The current value storage register 74 stores a current value IN measured by the current measuring unit 73 at regular intervals (step 103).
[0204]
FIG. 37 shows the average current values I′An and I′A (n−1) stored in the sampling regions Qn and Qn−1 without considering the learning effect and the current average current value IAn obtained this time. , IA (n-1). Here, the opening / closing state of the door 2 is a deceleration control region E2 (resolution B is 4) in the area 2, and a position meter for each pulse signal φ1 in the sampling region Qn of interest and the next sampling region Qn−1. The current value IN corresponding to the numerical value N is shown.
[0205]
That is, the current values IN to IN-3 of the current operation corresponding to the position count values N to N-3 of the sampling region Qn are held in the current value storage register 74, and the average of these is the average current value IAn. is there.
[0206]
(Learning data calculation unit for storage 75)
As shown in FIG. 38, the storage learning data calculation unit 75 includes a current increase rate calculation unit 81, a previous data hold register 82, a learning data delay register 83, and a learning value weighted update calculation unit 84.
[0207]
The immediately preceding data holding register 82 is the sampling region immediately before the sampling region Qn that is currently focused on in the sampling region Qn (n is gradually decreased) that sequentially appears in the closing movement direction of the door 2 (because area 2 is assumed in this example). The average current value IA (n + 1) of Qn + 1 is output to the current increase rate calculation unit 81.
[0208]
The current increase rate calculation unit 81 receives the average current value IAn of the sampling region Qn of interest currently sent from the load data calculation unit 72 and the average current of the previous sampling region Qn + 1 delayed by the previous data holding register 82. The current change rate ΔIAn (= IAn / IA (n + 1)) is obtained by comparing with the value IA (n + 1) and sent to the learning data delay register 83.
[0209]
The learning data delay register 83 is for slightly delaying the update timing of the learning result, and the number of stages is arbitrary, but in this example, it is set to 7 stages, and the learning value weighted update calculation unit 84 is provided with the previous 7 sampling areas Qn +. 7 current increase rate ΔIA (n + 7) is output.
[0210]
The learned value weighting update calculation unit 84 reads the current increase rate ΔIA (n + 7) relating to the current sampling region Qn + 7 and the read data Qn + from the load sample data memory 71 addressed by the same address number n + 7. 7 is entered with matching addresses.
[0211]
That is, the learning value weighted update calculation unit 84 uses the latest current increase rate ΔIA (n + 7) obtained this time to the current increase rate Qn + 7 at the time of the previous door drive stored in the data memory 71 in advance for the same sampling region. ), The stored data is learned and updated based on the following equation.
[0212]
Q′n + 7 = (3/4) × Q′n + 7 + (1/4) × ΔIA (n + 7)
When written in general formula,
Q′n = (3/4) × Q′n + (1/4) × ΔIAn
It becomes. The ratio of old and new data can be changed as appropriate.
[0213]
The newly obtained storage data (current increase rate) Q′n is sent to the load sample data memory 71 as write data DL, stored with the address number n as an address, and learning update of the storage data is performed.
[0214]
Here, the data read out from the load sample data memory 71, that is, the stored data is not represented by the originally stored average current value I′An, but by the addressed sampling region Qn. The calculation and the like use the data of the average current value I′An stored in the location designated by the address number n of the sampling area Qn. The output data of the storage learning data calculation unit 75 is also expressed in the format of the sampling area Qn.
[0215]
(Predicted comparison value calculator 76)
As shown in FIG. 39, the predicted comparison value calculation unit 76 includes a predicted value register 77, a threshold value calculation unit 78, a comparison value calculation unit 79, and a predicted comparison value delay register 80, and is output from the load sample data memory 71. The predicted comparison values Cn and Cm required for the pinching determination of the sampling region Qn-4 four ahead in the moving direction of the door 2 than the learning value Q′n corresponding to the address number n of the sampling region Qn To the unit 85.
[0216]
The predicted value register 77 is an average current in the sampling area obtained by adding and averaging the measured current values up to the present in the loop interval of the main routine from the time when the first current value IN is measured in the current sampling area Qn of the door 2. The latest value IAn is reserved.
[0217]
The threshold value calculation unit 78 and the comparison value calculation unit 79 store the data stored in the sampling region Qn-4 of the address number n-4 four times later than the address number n of the sampling region Qn obtaining the latest current value IN. (Current increase rate Q′n−4) is read from the load sample data memory 71 and given.
[0218]
The threshold value calculation unit 78 determines a permissible threshold value for discrimination according to the following equation from the latest average current value IAn in the control region and the stored data in the sampling region Q′n−4 of the address number n−4 after four. Fn-4 is calculated.
[0219]
Fn-4 = IAn x Q'n-1 x Q'n-2 x Q'n-3 x Q'n-4 x α
In general terms,
Fn = IA (n + 4) × Q′n + 3 × Q′n + 2 × Q′n + 1 × Q′n × α
It becomes. Where α is a correction count.
[0220]
The comparison value calculation unit 79 calculates a predicted comparison value Cn-4 to be compared with the average current value IA (n-4) of the sampling region Qn-4 that will appear from now on.
[0221]
Cn-4 = IAn * Q'n-1 * Q'n-2 * Q'n-3 * Q'n-4 + Fn-4
In general terms,
Cn = IA (n + 4) × Q′n + 3 × Q′n + 2 × Q′n + 1 × Q′n + Fn
It becomes.
[0222]
The predicted comparison value Cn-4 obtained by the comparison value calculation unit 79 passes through the four-stage predicted comparison value delay register 80, thereby matching the one corresponding to the address number n of the currently required sample area Qn. .
[0223]
In the predicted comparison value calculation unit 76, when the first comparison value is generated, the comparison value is put in the preceding stage of the prediction comparison value delay register 80, and this is repeated four times to obtain the fourth comparison value. That is,
Predicted value ahead: Cn-1 = An x Q'n-1
2nd predicted value: Cn-2 = Cn-1 * Q'n-2
Three predicted values: Cn-3 = Cn-2 x Q'n-3
Four predicted values: Cn-4 = Cn-3 x Q'n-4
It is.
[0224]
(Initial operation)
36, in the initial state, the stored contents of the load sample data memory 71 are such that the vehicle body 1 is placed in a normal posture in a flat place without tilting back and forth and left and right, and the door 2 is placed in this normal posture. The average current values IAn and IAm of the sample areas Qn and Qm for each area are obtained.
[0225]
In this initial state, the storage learning data calculation unit 75 obtains the current change rates ΔIAn and ΔIAm from the ratio of the current and previous average current values. The current change rates ΔIAn and ΔIAm are output from the learning data delay shift register 83 as the write data DL of the load sample data memory 71 through the learning value weighting update calculation unit 84, and the address number where the data is recorded is The average current values IAn and IAm obtained by the sampling area calculation unit 70 are designated by the address numbers n and m of the sample area data Qn and Qm.
[0226]
Here, the relationship between the sandwiching determination routine shown in FIG. 34 and the sandwiching determination block shown in FIG. 36 will be described. The average value calculation routine (step 380) corresponds to the load data calculation unit 72 and the current value storage register 74. The comparison value generation routine (step 381) and the comparison value calculation routine (step 384) correspond to the predicted comparison value calculation unit 76. The learning processing routine (step 382) and the learning delay processing routine (step 383) correspond to the learning data calculation unit 75 for storage. The continuation & change amount routine (step 375) corresponds to the previous current value memory unit 86, the change amount calculation unit 87, and the current increase number counting unit 88.
[0227]
(Learning judgment routine)
FIG. 40 is a flowchart showing details of the learning determination routine (step 374). This learning determination routine adds the current value every time, and performs error determination and learning weighting (pinch recognition). When the door 2 moves and the sampling area changes, the average current value, the comparison value, the learning process, and the learning delay process are performed for the area.
[0228]
The change in the sampling area means that the number of pulses of the amount by which the door 2 has moved is added to the remainder (the remainder obtained by dividing the position count value N by the resolution B) at the time of starting the sampling area calculation. , Judgment by seeing that it exceeded 2. The number of pulses is cleared at every addition. Also, when the sampling area changes, the numerical value of resolution B is subtracted and counted again. However, since the average current value cannot be obtained at the beginning of the movement in the middle of the sampling region, the addition of the current value is started when the sampling region is switched. Then, since the average current value and the comparison value can be obtained at the next time when the sampling region is changed, it is possible to determine an error every time thereafter.
[0229]
First, it is determined whether the sampling area number has been calculated (step 392). Since the calculation is not completed when the door 2 starts moving, the calculation is performed (step 394). Next, it is determined whether learning is possible (step 393). Since the learning is not possible at the first time, it is next determined whether the position of the door 2 is area 1, 5, or 6.
[0230]
For areas 1, 5 and 6, the period register number (number of pulses moved) is added to the resolution count (remainder in the sampling area calculation) to obtain a new resolution count (step 400). Next, the cycle register number is cleared to count the number of moved pulses (step 412), and if the resolution count is 8 or less (step 413), the process returns.
[0231]
The period register number is added in the same manner from the next time onward, and when it becomes 8 or more (when the sampling area changes), 8 is subtracted from the resolution count (step 414) to determine whether learning is possible (step 415). In this case, learning is not possible, so learning is set (step 417), the current value memory and the current value register number are cleared (steps 421C and 422), and the process returns.
[0232]
Since next time learning is possible (step 393), the current current value is added to the stored value (step 395), the current register number is incremented and the number of times the current value is added is counted (step 396), and it is determined whether error determination is possible. (Step 397A). In this case, since it is not possible to determine an error, the process jumps to step 399. Then, the processing of steps 400 to 415 is executed, and this time learning is possible (step 415), so the average value calculation (step 416), comparison value calculation (step 418), learning processing (step 419), learning delay processing (Step 420) is executed to set an error determination possible (Steps 421A and 421B), and the process returns.
[0233]
Since error determination is possible from the next time (step 397A), error determination (step 397B) and learning weighting (step 398) described later are executed. Further, every time the sampling area is exceeded, the average value calculation (step 416) to the learning delay process (step 420) are performed.
[0234]
When the position of the door 2 is switched from area 1 to area 2 (steps 399 and 401), it is determined whether or not the resolution count exceeds 4 (step 402). This is because, for the first time when the area is switched, the average value of the last sampling area of area 1 before that is calculated. If the resolution count exceeds 4, the process proceeds to step 400 and subsequent steps.
[0235]
If the resolution count does not exceed 4, the cycle register number is added to the resolution count, a new resolution count is obtained (step 408), and the cycle register number is cleared to count the number of moved pulses (step 409). If the resolution count is less than 4 (step 410), the process returns. If the resolution count is 4 or more, 4 is subtracted from the resolution count (step 411), and the process proceeds to step 415 and subsequent steps.
[0236]
When the position of the door 2 is switched from the area 2 to the area 3 (steps 399 and 401), it is determined whether or not the resolution count exceeds 2 (step 403). This is because, for the first time when the area is switched, the average value of the last sampling area of the area 2 before that is calculated. If the resolution count exceeds 2, the process proceeds to step 402 and subsequent steps.
[0237]
If the resolution count exceeds 2, the period register number is added to the resolution count to obtain a new resolution count (step 404), and the period register number is cleared to count the number of pulses moved (step 405). If the resolution count is less than 2 (step 406), the process returns. If the resolution count is 2 or more, 2 is subtracted from the resolution count (step 407), and the process proceeds to step 415 and subsequent steps.
[0238]
(Error judgment routine)
FIG. 41 is a flowchart showing details of the error determination routine (steps 378 and 397). This error determination routine compares the current value IN with the predicted comparison value Cn, and counts the number of times the current value IN is large as the number of errors.
[0239]
First, the current value IN is compared with the predicted comparison value Cn (step 424). If the current value IN is large, the number of errors is added (step 425), and if it is the same or smaller, the number of errors is cleared (step 426). This is because the pinching is performed only when the current value IN continuously increases.
[0240]
(Learning weighting routine)
FIG. 42 is a flowchart showing details of the learning weighting routine (steps 379 and 398). This learning weighting routine changes the weighting of the number of errors in accordance with the areas 1 to 7 and effectively performs pinching detection.
[0241]
First, it is determined whether the number of errors is zero (step 429). If it is not zero, the error count is weighted according to each area.
[0242]
That is, in areas 1 to 5-7 (step 430), it is determined whether the number of errors is 3 or more (step 431). In area 2 (step 432), it is determined whether the number of errors is 2 or more (step 433). , 4 (step 434), it is determined whether the number of errors is 1 or more (step 435). Thus, compared to the start area 1 in the closing direction and the areas 5 to 7 in the opening direction, the area 2 to 4 in the danger area in the closing direction are set to be stricter.
[0243]
As a result of these determinations, if the current value in the current control region does not tend to increase (step 427) or if the number of errors is larger than the set value set for each area even if it is increasing, it is determined as abnormal. Then, pinch detection is permitted (step 435). Even if the current value of the current control area is increasing, if the number of errors is smaller than the set value, the process returns.
[0244]
(Continuation & change amount routine)
FIG. 43 is a flowchart showing details of the continuation & change amount routine (steps 375 and 389). This continuation & change amount routine measures the amount of change of the current value IN and the duration of the rise and effectively performs the pinching detection.
[0245]
First, it is determined whether the current value is increasing (step 436). If the current value is increasing, a counter for counting the duration is added (step 437). If there is no current value data before change (step 439), The current value is stored as the pre-change current value (step 440), the pre-change current value is subtracted from the current current value IN to determine the conversion amount of the current value (step 441), and the process returns. If the current value does not tend to increase (step 436), the counter for counting the duration time is cleared (step 438), the current value before change is also cleared (step 442), and the process returns.
[0246]
(Comprehensive judgment routine)
FIG. 44 is a flowchart showing details of the comprehensive determination routine (steps 376 and 390). This comprehensive determination routine performs the pinching determination after taking into account all of the determination in learning, the amount of change in the current value, the increase duration, and the like.
[0247]
First, it is determined whether or not the current current value is equal to or greater than the abnormality recognition value (step 443). If the current value is equal to or greater than the abnormality recognition value, an abnormal state is set (step 444) and the process returns. If the current value is less than the abnormality recognition value (step 443), it is determined whether or not pinching detection is permitted in the learning determination (step 445), and if not permitted, the process returns.
[0248]
If pinching detection is permitted (step 445), when the duration of increase of the current value is equal to or greater than the set maximum value (step 446A), when the amount of change in the current value is equal to or greater than the set maximum value (step 446B), continue When the time is equal to or greater than the set minimum value and the amount of change is equal to or greater than the set value (but smaller than the maximum value) (steps 447 and 448), it is determined that there has been pinching, and the pinching processing is completed (step 449). ), Return. The abnormal state is set (step 444) or the pinching process is completed (step 449). As a result, for example, if the automatic closing operation is being performed, the automatic closing operation routine reversely opens to the target value.
[0249]
(Slope judgment routine)
FIG. 45 is a flowchart showing details of the slope judgment routine (step 122). This slope determination routine is for preparing conditions for determining the slope, and first, it is determined whether the position of the door 2 is area 1 or 6 (step). This is because the slope judgment is performed in areas 1 and 6 which are normal control areas. Therefore, if the position of the door 2 is another area, the process returns.
[0250]
If the position of the door 2 is areas 1 and 6, it is determined whether the time for the operation of the door 2 to stabilize has passed (step 451), and if it has passed, it is determined whether the slope has been determined (step 452). If the operating time has not reached the stable time, or if the slope has been judged, the process returns.
[0251]
If the slope has not been determined, it is determined whether the stability count is greater than or equal to a predetermined set value (step 453). Here, the stability refers to a state in which the difference between the maximum value and the minimum value of a plurality of consecutive (for example, four) period count values T is within a certain value. If the state does not exceed the predetermined set number of times, the process returns.
[0252]
If the stability count is equal to or greater than a predetermined set value, it is determined that the door 2 is stable on a flat ground, and it is determined whether a determination reference value has been input (step 455). Since it has not been input at the initial stage, flat value data to be described later is input (step 457), and if it has been input, a slope inspection to be described later is performed (step 456).
[0253]
(Flat value data input)
FIG. 46 is a flowchart showing details of the flat value data input routine (steps 121 and 457). This flat value data input routine is used to input a reference value (flat reference value) used for hill judgment, and whether the cycle count value T in the areas 1 and 6 of the door 2 is within the reference cycle, that is, the door 2 It is determined whether the moving speed is within a predetermined range with respect to the set speed T1 (FIG. 16) (step 458). If it is not within the predetermined range, it returns.
[0254]
If the door 2 is controlled to the target speed (step 458), the current value is stored as a flat current value (step 459), and the drive voltage at that time is stored as a flat drive voltage (step 460). The drive voltage is
Drive voltage = power supply voltage × (DUTY / 250)
It becomes. Here, (DUTY / 250) means a duty cycle as described above.
[0255]
(Slope inspection routine)
FIG. 47 is a flowchart showing details of the slope inspection routine (step 456). This slope inspection routine is to determine whether the state in which the vehicle body 1 is stopped is a flat ground or a slope based on the previously set flat reference values (flat current value and flat drive voltage).
[0256]
First, if the current value is larger than the flat current value (step 461), the slope current value as a judgment margin is added to the flat current value, and the value after the addition is used as the slope judgment value (step 462). If the current value is larger than the slope judgment value (step 464), the steep slope value (greater than the slope value) as a judgment margin is added to the flat current value, and the value after the addition is judged as a steep slope. A value is set (step 465).
[0257]
If the current value is greater than or equal to the steep slope determination value (step 467) and the moving direction of the door 2 is the open direction (step 468), it is determined that the current is a steep down slope (step 470), and the closing direction is If there is, it is determined as a steep uphill (step 471). If the current value is smaller than the steep slope determination value (step 467) and the movement direction of the door 2 is the open direction (step 469), it is determined as a downhill (step 472), and the door 2 is in the closing direction. If so, it is determined as an uphill (step 473).
[0258]
This is against the dead weight of the door 2 when the stop position of the vehicle body 1 is downhill and the moving direction of the door 2 is an open direction, or when the stop position of the vehicle body 1 is uphill and the movement direction of the door 2 is a closing direction. Since the motor load increases and the current value increases in proportion to the slope of the slope, the slope judgment is performed by comparing the current value with the flat current value. If the current value is smaller than the slope judgment value (step 464), it is judged as a flat ground (step 466).
[0259]
If the current value is equal to or less than the flat current value (step 461), the current drive voltage is obtained (step 463), the slope voltage value as the determination margin is subtracted from the previously obtained flat drive voltage, and The value is used as a slope judgment voltage (step 474). If the current drive voltage is equal to or smaller than the slope judgment voltage (step 475), the steep slope voltage value (greater than the slope value) as a judgment margin is subtracted from the flat voltage value, and the value after the subtraction is steep. The determination voltage is set (step 476).
[0260]
If the current drive voltage is equal to or smaller than the steep slope determination voltage (step 477) and the moving direction of the door 2 is the open direction (step 478), it is determined that the road is steeply uphill (step 480), and the door is closed. If there is, it is determined as a steep downhill (step 481). If the current drive voltage is greater than the steep slope determination voltage (step 477), and the door 2 is moved in the open direction (step 479), it is determined as an uphill (step 482). (Step 483).
[0261]
This is because if the stop position of the vehicle body 1 is an uphill and the moving direction of the door 2 is an open direction, or if the stop position of the vehicle body 1 is a downhill and the moving direction of the door 2 is a closing direction, the door 2 has its own weight. Since it moves in the direction, it would be dangerous to open or close suddenly if left as it is, so the drive voltage is lowered by the DUTY control and the speed control is performed. Judgment can be made. If the current drive voltage is greater than or equal to the slope determination voltage (step 475), it is determined that the road is flat (step 466).
[0262]
The drive voltage is calculated (step 463) as follows. When DUTY is not 100% by PWM control, the drive voltage at that time is
DUTY value / 250 (100%) = drive ratio
Battery voltage x drive ratio = drive voltage
It becomes. When DUTY = 100%,
Battery voltage = drive voltage
It becomes. In this embodiment, the 100% DUTY value is 250.
[0263]
【The invention's effect】
According to the first aspect of the present invention, it is possible to easily detect the inclination of the slope, that is, the inclination of the vehicle body without using a special inclination measurement sensor.
[0264]
Claims 1 According to the described invention, Ascending and descending slopes are detected by dividing them into voltage values and current values, which are the electrical values of the motor load, so the direction of the slope can be determined reliably. be able to.
[0265]
Claims 2 According to the described invention, always open the door Since the inclination angle can be measured at the first motor load part, appropriate safety measures can be taken according to the degree of inclination until the door is closed, from the middle door to the opened door. The
[0266]
According to the invention of claim 4, An electric value corresponding to the motor load is always obtained for motors that are PWM controlled, regardless of the state of PWM control. The
[Brief description of the drawings]
FIG. 1 is an external perspective view showing an example of an automobile to which the present invention is applied.
FIG. 2 is an enlarged perspective view of a vehicle body showing a state where a slide door is removed.
FIG. 3 is a perspective view showing a sliding door.
FIG. 4 is a perspective view showing a mounting portion of the slide door as viewed from the inside of the vehicle.
FIG. 5 is a perspective view showing a main part of the sliding door drive device.
FIG. 6 is a schematic plan view showing a moving state of the slide door.
FIG. 7 is a block diagram showing a connection relationship between the sliding door automatic control device and peripheral electrical elements.
FIG. 8 is a block diagram showing a main part of the slide door automatic control device.
FIG. 9 is a flowchart illustrating the operation of the automatic sliding door control device according to the present invention.
10 is a schematic diagram of the mode determination routine of FIG. 9. FIG.
FIG. 11 is a time chart relating to counting of the moving speed of the door executed by the pulse interruption routine.
FIG. 12 is a time chart of sampling points at which position counting pulses are sampled according to resolution in each area.
FIG. 13 is a plan view of a lower track showing an area corresponding to a relationship between a door opening / closing position and a position count value and a door opening degree;
FIG. 14 is a flowchart showing details of a pulse interrupt routine.
FIG. 15 is a flowchart showing details of a pulse count timer routine.
FIG. 16 is a memory table showing control data and the like required for each area.
FIG. 17 is a flowchart showing details of an auto slide mode determination routine.
FIG. 18 is a flowchart showing details of a manual determination routine.
FIG. 19 is a flowchart showing details of an automatic opening operation routine.
FIG. 20 is a flowchart showing details of an automatic closing operation routine.
FIG. 21 is a flowchart showing details of a manual closing operation routine.
FIG. 22 is a flowchart showing details of a reverse opening operation routine.
FIG. 23 is a flowchart showing details of a reverse closing operation routine.
FIG. 24 is a flowchart showing details of a target position calculation routine.
FIG. 25 is a flowchart showing details of a door full-open control routine.
FIG. 26 is a flowchart showing details of a start mode routine.
FIG. 27 is a flowchart showing details of a manual normal start mode routine.
FIG. 28 is a flowchart showing details of a manual fully closed start mode routine.
FIG. 29 is a schematic diagram of a speed control routine.
FIG. 30 is a block diagram illustrating functions related to speed control.
FIG. 31 is a graph showing the relationship between voltage fluctuation and duty cycle when the current flowing through the motor is constant.
FIG. 32 is a flowchart showing details of a PWM control routine.
FIG. 33 is a flowchart showing details of a feedback adjustment routine.
FIG. 34 is a schematic diagram of a pinching determination routine.
FIG. 35 is a flowchart showing details of a pinching determination routine.
FIG. 36 is a block diagram illustrating functions related to pinching determination.
FIG. 37 is a graph showing current values in a sampling region of interest.
FIG. 38 is a block diagram of a learning data calculation unit for storage.
FIG. 39 is a block diagram of a predicted comparison value calculation unit.
FIG. 40 is a flowchart showing details of a learning determination routine.
FIG. 41 is a flowchart showing details of an error determination routine.
FIG. 42 is a flowchart showing details of a learning weighting routine.
FIG. 43 is a flowchart showing details of a continuation / change amount routine.
FIG. 44 is a flowchart showing details of a comprehensive determination routine.
FIG. 45 is a flowchart showing details of a slope judgment routine.
FIG. 46 is a flowchart showing details of a flat value data input routine.
FIG. 47 is a flowchart showing details of a slope inspection routine.
[Explanation of symbols]
1 body
2 Sliding door
3 Door opening
4 Upper truck
5 Lower truck
6 Sliding coupler
7 Guide track
8 Door lock
9 striker
10 Door drive
11 Motor drive unit
12 Door drive cable member
12a Cable for closing door
12b Opening cable
13 Base plate
14 Opening and closing motor
15 Drive pulley
16 Electromagnetic clutch
17 Reducer
18 Rotary encoder
19 Guide pulley
20 Reversing pulley
21 Moving member
22 Hinge arm
23 Automatic sliding door control device
24 battery
25 Ignition switch
26 Parking switch
27 Main switch
28 Door open switch
29 Door close switch
30 wireless remote control
31 Keyless system
32 Buzzer
33 Car body side connector
34 Door side connector
35 Actuator
36 half latch switch
37 Door handle
38 Pulse signal generator
39 Output port
40 generator
41 Stabilized power supply
42 Speed detector
43 Position detector
44 Motor selector switch
45 Polarity reversing switch circuit
46 Power switch element
47 Voltage detector
48 A / D converter
49 Shunt resistor
50 Current detector
51 A / D converter
52 Clutch drive circuit
53 Actuator drive circuit
54 Control mode selector
55 Main controller
56 Auto slide controller
57 Speed controller
58 Pinch control unit
59 Slope judgment part
60 Door position detector
61a Control area discriminator
61b Control speed selector
62 Adjustment amount calculation unit
63 Maximum adjustment limit
64 Door movement speed detector
65 Too fast detector
66 Too late detector
67 Feedback adjustment unit
68 Power supply voltage detector
69 Duty calculation section

Claims (4)

車体に設けたガイドトラックに沿って開閉可能に支持されたスライドドアを、モータ駆動により開閉移動させるようにした車両用スライドドアの自動開閉制御装置において、
正逆転可能なモータを有するドア駆動部と、
前記ドア駆動部のモータ負荷を、モータの駆動電流および駆動電圧電気値で検出するモータ負荷検出手段と、
平坦姿勢に車体があるときのドア開またはドア閉時のモータ負荷の電気値を記憶する記憶手段と、
記憶手段において記憶された平坦姿勢のモータ負荷の電気値と、通常のドア開またはドア閉時に検出されたモータ負荷の電気値を比較し、このモータ負荷に係る両電気値の偏差から、ドア開閉時の車体の姿勢を判別する坂道判別手段と、を備え
該坂道判別手段は、前記モータ負荷に係る両電気値の偏差が開作動時に駆動電圧がとても低いときは急な上り坂と、開作動時に駆動電圧が低いときは上り坂と、開作動時に駆動電圧が低くもなく電流値も大きくないときは平坦と、開作動時に電流値が大きいときは下り坂と、開作動時に電流値がとても大きいときは急な下り坂と、それぞれ判別することを特徴とする車両用スライドドアの自動開閉制御装置。
In an automatic opening / closing control device for a vehicle sliding door, the sliding door supported to be opened / closed along a guide track provided on the vehicle body is opened / closed by driving a motor.
A door drive unit having a motor capable of forward and reverse rotation;
Motor load detection means for detecting the motor load of the door drive unit by the electric value of the drive current and drive voltage of the motor;
Storage means for storing an electric value of a motor load when the door is open or closed when the vehicle body is in a flat posture;
Compare the electrical value of the motor load of the flat posture stored in the storage means with the electrical value of the motor load detected when the door is normally opened or closed, and from the deviation of both electrical values related to the motor load, A slope discriminating means for discriminating the posture of the vehicle body at the time ,
The slope judging means is driven when the drive voltage is very low when the deviation of both electrical values related to the motor load is open, when the drive voltage is very low, when the drive voltage is low when the drive voltage is low, and when the drive voltage is low, the slope is driven. When the voltage is not low and the current value is not large, it is discriminated as flat, when the current value is large at the time of opening operation, downhill, and when the current value is very large at the time of opening operation, it is distinguished as a steep downhill. An automatic opening / closing control device for a vehicle sliding door.
前記記憶手段が、ドア開時のモータ負荷電流とモータ駆動電圧を、モータ負荷の電気値として記憶していることを特徴とする請求項1に記載の車両用スライドドアの自動開閉制御装置。  2. The automatic opening / closing control device for a vehicle sliding door according to claim 1, wherein the storage means stores a motor load current and a motor drive voltage when the door is opened as an electric value of the motor load. 前記記憶手段が、ドア全閉からドアを開く動作の連続した動作中で、かつガイドトラックの直線部を移動中で、しかも移動速度の一定した時期のモータ負荷の電気値を暫時更新記憶していることを特徴とする請求項1に記載の車両用スライドドアの自動開閉制御装置。  The storage means updates and stores the electrical value of the motor load for a while during the continuous operation of opening the door from the fully closed door and moving the linear portion of the guide track, and at a constant movement speed. The automatic opening / closing control device for a sliding door for a vehicle according to claim 1, wherein: モータ負荷に係る電気値が、デューティサイクルで負荷電力を制御しているモータの駆動電圧を、デューティサイクル100%相当の電圧に換算してなることを特徴とする請求項1〜3のいずれかに記載の車両用スライドドアの自動開閉制御装置。 Electrical values of the motor load, the driving voltage of the motor which controls the load power at a duty cycle, claim 1-3, characterized in Rukoto such in terms of the voltage of the corresponding 100% duty cycle The automatic opening / closing control device for a sliding door for a vehicle as described in 1.
JP2003127857A 1995-10-02 2003-05-06 Automatic opening / closing control device for vehicle sliding door Expired - Fee Related JP3753177B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2003127857A JP3753177B2 (en) 1995-10-02 2003-05-06 Automatic opening / closing control device for vehicle sliding door

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP27840595 1995-10-02
JP07278583 1995-10-26
JP2003127857A JP3753177B2 (en) 1995-10-02 2003-05-06 Automatic opening / closing control device for vehicle sliding door

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP27860396A Division JP3465735B2 (en) 1995-10-02 1996-10-01 Automatic opening and closing control of sliding doors for vehicles

Publications (2)

Publication Number Publication Date
JP2004003327A JP2004003327A (en) 2004-01-08
JP3753177B2 true JP3753177B2 (en) 2006-03-08

Family

ID=30448962

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2003127857A Expired - Fee Related JP3753177B2 (en) 1995-10-02 2003-05-06 Automatic opening / closing control device for vehicle sliding door

Country Status (1)

Country Link
JP (1) JP3753177B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11951815B2 (en) 2018-02-14 2024-04-09 Komatsu Ltd. Work vehicle and system including work vehicle

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114407629B (en) * 2022-01-28 2023-12-19 麦格纳汽车系统(苏州)有限公司 Vehicle door control method and system
CN114407813A (en) * 2022-02-22 2022-04-29 威睿电动汽车技术(宁波)有限公司 Vehicle door electric control system and method and vehicle
CN114509935B (en) * 2022-02-25 2024-05-17 重庆长安汽车股份有限公司 Electric driving control method for electric side door opening based on neural network

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11951815B2 (en) 2018-02-14 2024-04-09 Komatsu Ltd. Work vehicle and system including work vehicle

Also Published As

Publication number Publication date
JP2004003327A (en) 2004-01-08

Similar Documents

Publication Publication Date Title
JP3465735B2 (en) Automatic opening and closing control of sliding doors for vehicles
JP3494540B2 (en) Temporary holding device for automatic drive type opening and closing body
US6729071B1 (en) Device for automatically controlling opening and closing of a vehicle slide door
US6134837A (en) Door holding control system for a vehicle slide door
US6208102B1 (en) Method for controlling automotive sliding doors
JP3656788B2 (en) Open / close control device for vehicle sliding door
US5350986A (en) Vehicle power door speed control
US5708338A (en) System and method for controlling vehicle sliding door
JP3437039B2 (en) Opening / closing control device for vehicle sliding door
GB2288036A (en) Drive control device for opening/closing member
JP3753177B2 (en) Automatic opening / closing control device for vehicle sliding door
JP3667740B2 (en) Automatic opening / closing control device for vehicle sliding door
JP3667739B2 (en) Automatic opening / closing control device for vehicle sliding door
JP3667738B2 (en) Automatic opening / closing control device for vehicle sliding door
JP3511347B2 (en) Automatic opening / closing control of sliding doors for vehicles
JPH11236783A (en) Opening/closing controller for sliding door of car
JPH09125822A (en) Discrimination device of slope in automatic opening/ closing control of slide door for vehicle
JPH09125818A (en) Open-close body speed controller in automatic open-close control of open-close body for car
JPH09125820A (en) Door drive controller in automatic opening/closing control of slide door for vehicle
JPH09125823A (en) Catching detector of door in automatic open-close control of sliding door for car
JPH09125821A (en) Door driving controller in automatic open-close control of sliding door for car
JP2000139095A (en) Slide control method of slide door for vehicle
JP2002364249A (en) Control device for opening/closing body for vehicle
KR20110139621A (en) Apparatus for controlling open and close power of sliding door
JP2000127764A (en) Slide control method for vehicle slide door

Legal Events

Date Code Title Description
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20050316

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20050405

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20050523

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20051206

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20051206

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20081222

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20091222

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20091222

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20101222

Year of fee payment: 5

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20101222

Year of fee payment: 5

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20101222

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20111222

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20111222

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20121222

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20131222

Year of fee payment: 8

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees