JPH09125822A - 車両用スライドドアの自動開閉制御における坂道判別装置 - Google Patents
車両用スライドドアの自動開閉制御における坂道判別装置Info
- Publication number
- JPH09125822A JPH09125822A JP7340887A JP34088795A JPH09125822A JP H09125822 A JPH09125822 A JP H09125822A JP 7340887 A JP7340887 A JP 7340887A JP 34088795 A JP34088795 A JP 34088795A JP H09125822 A JPH09125822 A JP H09125822A
- Authority
- JP
- Japan
- Prior art keywords
- door
- value
- motor
- opening
- control
- 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.)
- Pending
Links
- 238000001514 detection method Methods 0.000 claims description 26
- 230000002441 reversible effect Effects 0.000 abstract description 33
- 238000005070 sampling Methods 0.000 description 44
- 230000008859 change Effects 0.000 description 26
- 230000006870 function Effects 0.000 description 24
- 238000010586 diagram Methods 0.000 description 15
- 238000000034 method Methods 0.000 description 15
- 230000008569 process Effects 0.000 description 15
- 230000005856 abnormality Effects 0.000 description 10
- 238000012545 processing Methods 0.000 description 10
- 238000012937 correction Methods 0.000 description 9
- 238000006243 chemical reaction Methods 0.000 description 5
- 238000000605 extraction Methods 0.000 description 5
- 230000006978 adaptation Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 230000000630 rising effect Effects 0.000 description 4
- 238000007689 inspection Methods 0.000 description 3
- 238000012935 Averaging Methods 0.000 description 2
- 101000833380 Mus musculus GTPase IMAP family member 3 Proteins 0.000 description 2
- 101000833394 Rattus norvegicus GTPase IMAP family member 5 Proteins 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 2
- 230000003247 decreasing effect Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000001960 triggered effect Effects 0.000 description 2
- 102100024412 GTPase IMAP family member 4 Human genes 0.000 description 1
- 101710190481 GTPase IMAP family member 4 Proteins 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000001934 delay Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Landscapes
- Power-Operated Mechanisms For Wings (AREA)
Abstract
(57)【要約】
【課題】 坂道の傾斜の度合いを検出する。
【解決手段】 車体に設けたガイドトラックに沿って開
閉可能に支持されたスライドドア2を、モータ駆動によ
り開閉移動させるようにした車両用スライドドアの開閉
装置において、正逆転可能なモータ14を有するドア駆
動部10と、該ドア駆動部10のモータ負荷を、モータ
14の駆動電流Iまたは駆動電圧V、もしくはその両方
I、Vの電気値で検出するモータ負荷検出手段47、5
0と、平坦姿勢に車体があるときの、ドア開又はドア閉
時のモータ負荷の電気値を記憶する記憶手段と、該記憶
手段において記憶された平坦姿勢のモータ負荷の電気値
と、通常のドア開もしくはドア閉時に検出されたモータ
負荷の電気値を比較し、このモータ負荷に係る両電気値
の偏差から、ドア開閉時の車体の姿勢を判別する坂道判
別手段59を備えている。
閉可能に支持されたスライドドア2を、モータ駆動によ
り開閉移動させるようにした車両用スライドドアの開閉
装置において、正逆転可能なモータ14を有するドア駆
動部10と、該ドア駆動部10のモータ負荷を、モータ
14の駆動電流Iまたは駆動電圧V、もしくはその両方
I、Vの電気値で検出するモータ負荷検出手段47、5
0と、平坦姿勢に車体があるときの、ドア開又はドア閉
時のモータ負荷の電気値を記憶する記憶手段と、該記憶
手段において記憶された平坦姿勢のモータ負荷の電気値
と、通常のドア開もしくはドア閉時に検出されたモータ
負荷の電気値を比較し、このモータ負荷に係る両電気値
の偏差から、ドア開閉時の車体の姿勢を判別する坂道判
別手段59を備えている。
Description
【0001】
【発明の属する技術分野】本発明は、車両等のスライド
ドアを、モータ駆動により自動的に開閉し得るようにし
た車両用スライドドアの自動開閉制御における坂道判別
装置に関する。
ドアを、モータ駆動により自動的に開閉し得るようにし
た車両用スライドドアの自動開閉制御における坂道判別
装置に関する。
【0002】
【従来の技術】従来、車体にスライド開閉可能に支持さ
れたスライドドアを、自動駆動源により開閉移動させる
ようにした車両用スライドドアの開閉制御装置は、自動
駆動力を用いてドアを開閉するに際して、自動駆動力を
発揮する時期を、運転席やドアハンドル等に設けられた
駆動源を働かせるドア開閉操作手段の意識的操作によ
り、スライドドアを動力駆動しうるようになっている。
れたスライドドアを、自動駆動源により開閉移動させる
ようにした車両用スライドドアの開閉制御装置は、自動
駆動力を用いてドアを開閉するに際して、自動駆動力を
発揮する時期を、運転席やドアハンドル等に設けられた
駆動源を働かせるドア開閉操作手段の意識的操作によ
り、スライドドアを動力駆動しうるようになっている。
【0003】また、ドア開閉操作手段に代わる自動駆動
力を発揮させるトリガー手段として、手動力によってス
ライドドアが予め定めた距離だけ移動したことを検知
し、その手動によるドアの移動を契機として、スライド
ドアを移動させた手動駆動力に代わって、自動駆動力に
切り替えているものもある。
力を発揮させるトリガー手段として、手動力によってス
ライドドアが予め定めた距離だけ移動したことを検知
し、その手動によるドアの移動を契機として、スライド
ドアを移動させた手動駆動力に代わって、自動駆動力に
切り替えているものもある。
【0004】
【発明が解決しようとする課題】従来の車両用スライド
ドアの開閉制御装置においては、スライドドアの自重が
重いため、スライドドアの駆動に係る負荷が、開閉方向
や開閉位置に影響され易すく、特にスライドドアの移動
方向に係る、自動車の前後の傾きによっては、ドアの自
重を吊り上げる程の過大負荷から、同程度の加重に制動
を加える負の負荷を生じるため、安全対策を十分考慮し
てのドアの自動開閉制御に係るドア駆動制御を困難なも
のとしている。すなわち、スライドドアに係る負荷が大
きく、かつ負荷変動幅が大きくなれば、自動駆動手段の
出力パワーは、負荷変動に素早く対処するように、十分
に余裕をもって大きくしなければならないが、逆に小さ
い負荷変動に対して感応力が減少するため、ドアに挟み
込みを生じないような、安全性を考慮した出力パワー制
御を行うのが困難であった。
ドアの開閉制御装置においては、スライドドアの自重が
重いため、スライドドアの駆動に係る負荷が、開閉方向
や開閉位置に影響され易すく、特にスライドドアの移動
方向に係る、自動車の前後の傾きによっては、ドアの自
重を吊り上げる程の過大負荷から、同程度の加重に制動
を加える負の負荷を生じるため、安全対策を十分考慮し
てのドアの自動開閉制御に係るドア駆動制御を困難なも
のとしている。すなわち、スライドドアに係る負荷が大
きく、かつ負荷変動幅が大きくなれば、自動駆動手段の
出力パワーは、負荷変動に素早く対処するように、十分
に余裕をもって大きくしなければならないが、逆に小さ
い負荷変動に対して感応力が減少するため、ドアに挟み
込みを生じないような、安全性を考慮した出力パワー制
御を行うのが困難であった。
【0005】特に、スライドドアの動力駆動の開始時期
を自動制御とした場合、ドアの動力駆動が、ドア周辺の
操作者等に認識されない状態で行われるため、ドアの開
閉方向や開閉位置、及びドアが開閉されるときの自動車
の姿勢など、自動車の使用に際してのあらゆる状況を考
慮して、安全対策を施さなければならない。
を自動制御とした場合、ドアの動力駆動が、ドア周辺の
操作者等に認識されない状態で行われるため、ドアの開
閉方向や開閉位置、及びドアが開閉されるときの自動車
の姿勢など、自動車の使用に際してのあらゆる状況を考
慮して、安全対策を施さなければならない。
【0006】特に、スライドドアにおいては、ドアの移
動方向が直線的で、かつ車体の前後方向と同一方向に移
動しうるようになっているため、坂道でのドアの開閉に
は、ドアの自重が制御に大きく作用する。そのため、自
動車の駐車時姿勢、すなわち駐車した道路に傾斜がある
場合(坂道)の傾斜の度合いを、ドアの開閉に際して知
ることは重要である。
動方向が直線的で、かつ車体の前後方向と同一方向に移
動しうるようになっているため、坂道でのドアの開閉に
は、ドアの自重が制御に大きく作用する。そのため、自
動車の駐車時姿勢、すなわち駐車した道路に傾斜がある
場合(坂道)の傾斜の度合いを、ドアの開閉に際して知
ることは重要である。
【0007】本発明は、上記のような問題点に鑑み、ス
ライドドアの開閉に際して、坂道の傾斜の度合いを検出
する装置を提供することを目的としている。
ライドドアの開閉に際して、坂道の傾斜の度合いを検出
する装置を提供することを目的としている。
【0008】
【課題を解決するための手段】本発明によると、上記課
題は、次のようにして解決される。
題は、次のようにして解決される。
【0009】(1) 車体に設けたガイドトラックに沿っ
て開閉可能に支持されたスライドドアを、モータ駆動に
より開閉移動させるようにした車両用スライドドアの開
閉装置において、正逆転可能なモータを有するドア駆動
部と、該ドア駆動部のモータ負荷を、モータの駆動電流
または駆動電圧、もしくはその両方の電気値で検出する
モータ負荷検出手段と、平坦姿勢に車体があるときの、
ドア開又はドア閉時のモータ負荷の電気値を記憶する記
憶手段と、該記憶手段において記憶された平坦姿勢のモ
ータ負荷の電気値と、通常のドア開もしくはドア閉時に
検出されたモータ負荷の電気値を比較し、このモータ負
荷に係る両電気値の偏差から、ドア開閉時の車体の姿勢
を判別する坂道判別手段を備えている。
て開閉可能に支持されたスライドドアを、モータ駆動に
より開閉移動させるようにした車両用スライドドアの開
閉装置において、正逆転可能なモータを有するドア駆動
部と、該ドア駆動部のモータ負荷を、モータの駆動電流
または駆動電圧、もしくはその両方の電気値で検出する
モータ負荷検出手段と、平坦姿勢に車体があるときの、
ドア開又はドア閉時のモータ負荷の電気値を記憶する記
憶手段と、該記憶手段において記憶された平坦姿勢のモ
ータ負荷の電気値と、通常のドア開もしくはドア閉時に
検出されたモータ負荷の電気値を比較し、このモータ負
荷に係る両電気値の偏差から、ドア開閉時の車体の姿勢
を判別する坂道判別手段を備えている。
【0010】(2) 前記(1)項において、記憶手段が、
ドア開時のモータ負荷電流とモータ駆動電圧をモータ負
荷の電気値として記憶している。
ドア開時のモータ負荷電流とモータ駆動電圧をモータ負
荷の電気値として記憶している。
【0011】(3) 前記(1)項または(2)項において、
記憶手段が、ドア全閉からドアを開く動作の連続した動
作中で、かつガイドトラックの直線部を移動中で、しか
も移動速度の一定した時期のモータ負荷の電気値を、暫
時最新のものにより更新されて記憶している。
記憶手段が、ドア全閉からドアを開く動作の連続した動
作中で、かつガイドトラックの直線部を移動中で、しか
も移動速度の一定した時期のモータ負荷の電気値を、暫
時最新のものにより更新されて記憶している。
【0012】(4) 前記(1)〜(3)項のいずれかにおい
て、モータ負荷に係る両電気値の偏差が、 開作動時に
駆動電圧が、とても低いときは、急な登り坂と、開作動
時に駆動電圧が、低いときは、登り坂と、開作動時に駆
動電圧が低くもなく、電流値も大きくない時は、平坦
と、開作動時に電流値が、大きい時は、下り坂と、開作
動時に電流値が、とても大きいときは、急な下り坂と判
別している。
て、モータ負荷に係る両電気値の偏差が、 開作動時に
駆動電圧が、とても低いときは、急な登り坂と、開作動
時に駆動電圧が、低いときは、登り坂と、開作動時に駆
動電圧が低くもなく、電流値も大きくない時は、平坦
と、開作動時に電流値が、大きい時は、下り坂と、開作
動時に電流値が、とても大きいときは、急な下り坂と判
別している。
【0013】(5) 前記(1)〜(4)項のいずれかにおい
て、モータ負荷に係る電気値が、デユーテイサイクルで
負荷電力を制御しているモータの駆動電圧を、デユーテ
イサイクル100%相当の電圧に換算してなる。
て、モータ負荷に係る電気値が、デユーテイサイクルで
負荷電力を制御しているモータの駆動電圧を、デユーテ
イサイクル100%相当の電圧に換算してなる。
【0014】
【発明の実施の形態】以下、本発明の一実施態様を、図
面に基づいて説明する。図1乃至図6は、本発明が適用
されるスライドドアを備えた車両の一例を示している。
面に基づいて説明する。図1乃至図6は、本発明が適用
されるスライドドアを備えた車両の一例を示している。
【0015】(1)は、車両の車体、(2)は、車体(1)に
開閉可能に装着されたスライドドア(以下、単にドアと
いう)で、そのドア(2)は、車体(1)のドア開口(3)の
上縁に設けたアッパートラック(4)と、下縁に設けたロ
アトラック(5)に、ドア(2)の上下端に固設した摺動連
結具(6)と連係して、前後方向に摺動自在に懸架され、
さらにドア(2)の後端は、後部の車体(1)のウェスト部
付近に適宜固定したガイドトラック(7)とにより案内さ
れ、ドア開口(3)を密閉した全閉位置から、車体(1)の
アウターパネルの外側面より若干外方に突出しながら、
その車体(1)の外装パネル側面と平行して後方に移動さ
せるようにした、ドア開口(3)を全開させた全開位置と
の間を、開閉移動可能になっている。
開閉可能に装着されたスライドドア(以下、単にドアと
いう)で、そのドア(2)は、車体(1)のドア開口(3)の
上縁に設けたアッパートラック(4)と、下縁に設けたロ
アトラック(5)に、ドア(2)の上下端に固設した摺動連
結具(6)と連係して、前後方向に摺動自在に懸架され、
さらにドア(2)の後端は、後部の車体(1)のウェスト部
付近に適宜固定したガイドトラック(7)とにより案内さ
れ、ドア開口(3)を密閉した全閉位置から、車体(1)の
アウターパネルの外側面より若干外方に突出しながら、
その車体(1)の外装パネル側面と平行して後方に移動さ
せるようにした、ドア開口(3)を全開させた全開位置と
の間を、開閉移動可能になっている。
【0016】ドア(2)は、全閉位置にあるとき、図7に
略示するドア(2)の開口端に設けたドアロック(8)が、
車体(1)に固定したストライカ(9)と係合することによ
り、確実な閉鎖状態をもって全閉位置に保持される。
略示するドア(2)の開口端に設けたドアロック(8)が、
車体(1)に固定したストライカ(9)と係合することによ
り、確実な閉鎖状態をもって全閉位置に保持される。
【0017】(10)は、ドア開口(3)の後方の車体(1)に
装着され、図4に示すように、モータ駆動部(11)とガイ
ドトラック(7)とドア駆動ケーブル部材(12)とを備え、
ドア(2)をモータ駆動により自動的に開閉させるドア駆
動装置である。
装着され、図4に示すように、モータ駆動部(11)とガイ
ドトラック(7)とドア駆動ケーブル部材(12)とを備え、
ドア(2)をモータ駆動により自動的に開閉させるドア駆
動装置である。
【0018】モータ駆動部(11)は、車体(1)を外装する
アウターパネルと室内側のインナーパネルとの間に配置
されている。図5に示す如く、ドア駆動ケーブル部材(1
2)は、モータ駆動部(11)から繰り出されて、車体(1)の
後部側に穿設された装着孔を通って車外に排出され、ガ
イドトラック(5)に沿って往復回走して、それぞれの方
向からドア(2)側に連結された閉扉用ケーブル(12a)と
開扉用ケーブル(12b)とを有している。
アウターパネルと室内側のインナーパネルとの間に配置
されている。図5に示す如く、ドア駆動ケーブル部材(1
2)は、モータ駆動部(11)から繰り出されて、車体(1)の
後部側に穿設された装着孔を通って車外に排出され、ガ
イドトラック(5)に沿って往復回走して、それぞれの方
向からドア(2)側に連結された閉扉用ケーブル(12a)と
開扉用ケーブル(12b)とを有している。
【0019】ドア駆動部(11)は、図5に示すように、車
体(1)の室内側にボルト等をもって固定されたベースプ
レート(13)に、正逆転可能なモータ(14)と、モータ(14)
の回転数を減少し、出力トルクを増大して伝達されるド
ライブプーリ(15)、及びモータ(14)の駆動時に、別途適
時に励磁されて、モータ(14)とドライブプーリ(15)との
間を、機械的に接続する電磁クラッチ(16)(図7におい
て電気回路で図示)を内蔵した減速部(17)とを固定した
ものよりなっている。
体(1)の室内側にボルト等をもって固定されたベースプ
レート(13)に、正逆転可能なモータ(14)と、モータ(14)
の回転数を減少し、出力トルクを増大して伝達されるド
ライブプーリ(15)、及びモータ(14)の駆動時に、別途適
時に励磁されて、モータ(14)とドライブプーリ(15)との
間を、機械的に接続する電磁クラッチ(16)(図7におい
て電気回路で図示)を内蔵した減速部(17)とを固定した
ものよりなっている。
【0020】ドライブプーリ(15)の回転軸には、それの
回転角度を高分解能に計測するロータリーエンコーダ(1
8)を連係してあり、ドライブプーリ(15)に巻回されるド
ア駆動ケーブル部材(12)の移動量(後述するドアの移動
量)が計れるようになっている。
回転角度を高分解能に計測するロータリーエンコーダ(1
8)を連係してあり、ドライブプーリ(15)に巻回されるド
ア駆動ケーブル部材(12)の移動量(後述するドアの移動
量)が計れるようになっている。
【0021】ドライブプーリ(15)に巻回されたドア駆動
ケーブル部材(12)は、ガイドトラック(7)の後方に設け
られた、それぞれが独立して回転する1対の案内プーリ
(19)を介して、外向きにコ字型に開口するガイドトラッ
ク(7)の開口部(7a)と、下方の案内部(7b)を、互いに平
行して掛け回されるとともに、ガイドトラック(7)の前
端部に設けられた、反転プーリ(20)に巻回されて、無端
索条を形成している。
ケーブル部材(12)は、ガイドトラック(7)の後方に設け
られた、それぞれが独立して回転する1対の案内プーリ
(19)を介して、外向きにコ字型に開口するガイドトラッ
ク(7)の開口部(7a)と、下方の案内部(7b)を、互いに平
行して掛け回されるとともに、ガイドトラック(7)の前
端部に設けられた、反転プーリ(20)に巻回されて、無端
索条を形成している。
【0022】ドア駆動ケーブル部材(12)における、ガイ
ドトラック(7)の開口部(7a)を走行する部分の適所は、
開口部(7a)を抵抗なく走行する移動部材(21)と移動不能
に連結され、その移動部材(21)の前方は、前記閉扉用ケ
ーブル(12a)を形成し、移動部材(21)の後方は、開扉用
ケーブル(12b)を形成している。
ドトラック(7)の開口部(7a)を走行する部分の適所は、
開口部(7a)を抵抗なく走行する移動部材(21)と移動不能
に連結され、その移動部材(21)の前方は、前記閉扉用ケ
ーブル(12a)を形成し、移動部材(21)の後方は、開扉用
ケーブル(12b)を形成している。
【0023】移動部材(21)は、ヒンジアーム(22)を介し
てドア(2)の後端部内側に連結され、ドア駆動部(11)の
モータ(14)の回転による開扉用ケーブル(12a)又は閉扉
用ケーブル(12b)の引っ張り力により、ガイドトラック
(7)の開口(7a)内を、前方又は後方に移動して、ドア
(2)を閉扉方向又は開扉方向に移動させる。
てドア(2)の後端部内側に連結され、ドア駆動部(11)の
モータ(14)の回転による開扉用ケーブル(12a)又は閉扉
用ケーブル(12b)の引っ張り力により、ガイドトラック
(7)の開口(7a)内を、前方又は後方に移動して、ドア
(2)を閉扉方向又は開扉方向に移動させる。
【0024】ロータリーエンコーダ(18)は、ドライブプ
ーリ(15)に連動して、それの回転角度を1回転当たり多
数のパルスに変換して出力するもので、このロータリー
エンコーダ(18)の出力パルス数を、ドア(2)の全閉位置
を初期値として、それから全開位置まで連続して計数す
ると、その計数値は移動部材(21)の位置、すなわちドア
(2)の位置を計ることができる。
ーリ(15)に連動して、それの回転角度を1回転当たり多
数のパルスに変換して出力するもので、このロータリー
エンコーダ(18)の出力パルス数を、ドア(2)の全閉位置
を初期値として、それから全開位置まで連続して計数す
ると、その計数値は移動部材(21)の位置、すなわちドア
(2)の位置を計ることができる。
【0025】図7は、上述の如く車体(1)に装備された
ドア(2)と、後述する本発明を適用してなるスライドド
ア自動制御装置(23)との関連の概略を示す、ブロック図
である。なお、図中前記説明と同一部材は、同一符号を
付して、詳細な説明を省略する。
ドア(2)と、後述する本発明を適用してなるスライドド
ア自動制御装置(23)との関連の概略を示す、ブロック図
である。なお、図中前記説明と同一部材は、同一符号を
付して、詳細な説明を省略する。
【0026】スライドドア自動制御装置(23)には、バッ
テリー(24)の電圧信号(BV)、イグニッションSW
(以下電気スイッチ部材をSWと略称する)(25)の開閉
信号(IG)、パーキングSW(26)の開閉信号(P
K)、メインSW(27)の開閉信号(MA)、ドア開(ド
アを開扉するときONにする)SW(28)の開閉信号(D
O)、ドア閉(ドアを閉扉するときONにする)SW(2
9)の開閉信号(DC)等が入力するとともに、ワイヤレ
スリモコン(30)を用いた、キーレスシステム(31)のリモ
コンドア開(ドアを開扉するときONにする)の開閉信
号(RO)と、リモコンドア閉(ドアを閉扉するときO
Nにする)の開閉信号(RC)が入力している。
テリー(24)の電圧信号(BV)、イグニッションSW
(以下電気スイッチ部材をSWと略称する)(25)の開閉
信号(IG)、パーキングSW(26)の開閉信号(P
K)、メインSW(27)の開閉信号(MA)、ドア開(ド
アを開扉するときONにする)SW(28)の開閉信号(D
O)、ドア閉(ドアを閉扉するときONにする)SW(2
9)の開閉信号(DC)等が入力するとともに、ワイヤレ
スリモコン(30)を用いた、キーレスシステム(31)のリモ
コンドア開(ドアを開扉するときONにする)の開閉信
号(RO)と、リモコンドア閉(ドアを閉扉するときO
Nにする)の開閉信号(RC)が入力している。
【0027】出力としては、ドア(2)の自動開閉が行わ
れることを、警報するブザー(32)を制御するとともに、
前記モータ駆動部(11)を制御している。また、車体(1)
とドア(2)の間のドア開口(3)部分に設けられた車体側
コネクタ(33)とドア側コネクタ(34)を介して、ドア(2)
全閉状態より若干ドア(2)が開いた状態から、ドア(2)
内蔵の電気回路と接続して、そのドア(2)内蔵の電気回
路を制御する。
れることを、警報するブザー(32)を制御するとともに、
前記モータ駆動部(11)を制御している。また、車体(1)
とドア(2)の間のドア開口(3)部分に設けられた車体側
コネクタ(33)とドア側コネクタ(34)を介して、ドア(2)
全閉状態より若干ドア(2)が開いた状態から、ドア(2)
内蔵の電気回路と接続して、そのドア(2)内蔵の電気回
路を制御する。
【0028】ドア(2)内蔵の電気回路には、ドア(2)を
ハーフラッチ直前から、フルラッチの状態にまで締め込
むためのクロージャーモータ(CM)と、ドアロック
(8)を電動駆動するアクチュエータ(以下ACTRと略
称する)(35)と、ハーフラッチを検出するためのハーフ
ラッチSW(36)の開閉信号(HR)を送る回路、ドアロ
ック(8)と連結しているドアハンドル(37)の操作を検出
するためのドアハンドルSW(37a)の開閉信号(DH)
を送る回路等がある。
ハーフラッチ直前から、フルラッチの状態にまで締め込
むためのクロージャーモータ(CM)と、ドアロック
(8)を電動駆動するアクチュエータ(以下ACTRと略
称する)(35)と、ハーフラッチを検出するためのハーフ
ラッチSW(36)の開閉信号(HR)を送る回路、ドアロ
ック(8)と連結しているドアハンドル(37)の操作を検出
するためのドアハンドルSW(37a)の開閉信号(DH)
を送る回路等がある。
【0029】ドア駆動装置(10)との間には、モータ(14)
に電力を供給する配線、クラッチ(16)を操作する電力を
送る配線、並びにロータリーエンコーダ(15)によって、
ドア(2)の移動速度と移動方向を検出するために、位相
が90度異なる2つの2相パルス信号(φ1)(φ2)を発生
するパルス信号発生部(38)に接続する配線が、施されて
いる。
に電力を供給する配線、クラッチ(16)を操作する電力を
送る配線、並びにロータリーエンコーダ(15)によって、
ドア(2)の移動速度と移動方向を検出するために、位相
が90度異なる2つの2相パルス信号(φ1)(φ2)を発生
するパルス信号発生部(38)に接続する配線が、施されて
いる。
【0030】図8は、スライドドア自動制御装置(23)を
具体的に示すブロック図である。スライドドア自動制御
装置(23)は、マイクロコンピュータによるプログラム制
御によって、ドア駆動装置(10)を前記課題を解決するべ
く制御するものである。なお、すでに説明したものに
は、同一符号を付して、詳細な説明は省略する。
具体的に示すブロック図である。スライドドア自動制御
装置(23)は、マイクロコンピュータによるプログラム制
御によって、ドア駆動装置(10)を前記課題を解決するべ
く制御するものである。なお、すでに説明したものに
は、同一符号を付して、詳細な説明は省略する。
【0031】(39)は、マイクロコンピュータ制御システ
ムにおける入出力ポートを示すもので、SWのオン−オ
フ信号や、リレーやクラッチ等の動作−非動作信号を入
出力するもので、各ポート(39)に1ビットが割り当てら
れている。
ムにおける入出力ポートを示すもので、SWのオン−オ
フ信号や、リレーやクラッチ等の動作−非動作信号を入
出力するもので、各ポート(39)に1ビットが割り当てら
れている。
【0032】(40)は、自動車の走行中に、バッテリー(2
4)を充電する発電機で、(41)は、スライドドア自動制御
装置(23)におけるマイクロコンピュータシステムの安定
化電源である。
4)を充電する発電機で、(41)は、スライドドア自動制御
装置(23)におけるマイクロコンピュータシステムの安定
化電源である。
【0033】ロータリーエンコーダ(18)のパルス発生回
路(38)の出力する2相パルス信号(φ1)(φ2)は、速度選
出部(42)と位置検出部(43)において、速度信号(T)と
位置信号(N)を生成する。なお、以下に〜部として示
される、各信号処理部分や制御部分は、実質的にマイク
ロコンピュータのプログラム処理によるディジタルデー
タ処理部分であって、〜手段と称するすることもある。
路(38)の出力する2相パルス信号(φ1)(φ2)は、速度選
出部(42)と位置検出部(43)において、速度信号(T)と
位置信号(N)を生成する。なお、以下に〜部として示
される、各信号処理部分や制御部分は、実質的にマイク
ロコンピュータのプログラム処理によるディジタルデー
タ処理部分であって、〜手段と称するすることもある。
【0034】ドア(2)を駆動するモータ(14)と、クロー
ジャーモータ(CM)は、両方ともドア(2)を駆動する
モータであって、同時に駆動されることがないため、モ
ータ切り替えSW(44)によって、選択的に駆動電力が供
給されるようになっている。
ジャーモータ(CM)は、両方ともドア(2)を駆動する
モータであって、同時に駆動されることがないため、モ
ータ切り替えSW(44)によって、選択的に駆動電力が供
給されるようになっている。
【0035】クロージャーモータ(CM)には、微妙な
出力制御を施す必要はないが、ドア(2)を駆動するモー
タ(14)は、精密な駆動力制御が行われるため、その電力
供給回路には、駆動方向を自在に変更するための、極性
反転SW回路(45)が介在している。
出力制御を施す必要はないが、ドア(2)を駆動するモー
タ(14)は、精密な駆動力制御が行われるため、その電力
供給回路には、駆動方向を自在に変更するための、極性
反転SW回路(45)が介在している。
【0036】さらに、同モータ(14)の電力供給回路に
は、直流電流を非連続で供給する半導体による電力SW
素子(46)が直列に介在し、この非連続波形のデユーテイ
サイクル(後述のフローチャートにおいてはDUTYとして
示されることもある)が、自在に制御しうるようになっ
ている。
は、直流電流を非連続で供給する半導体による電力SW
素子(46)が直列に介在し、この非連続波形のデユーテイ
サイクル(後述のフローチャートにおいてはDUTYとして
示されることもある)が、自在に制御しうるようになっ
ている。
【0037】この、モータ(14)の電力供給回路には、バ
ッテリー(24)の端子電圧(BV=Vx)をディジタルに
検出する電圧検出部(47)とA/D変換部(48)が設けられ
ている。さらに、同電力供給回路には、シャント抵抗(4
9)を介して、電流値(I=IN)をディジタルに検出する
電流検出部(50)とA/D変換部(51)が設けられている。
ッテリー(24)の端子電圧(BV=Vx)をディジタルに
検出する電圧検出部(47)とA/D変換部(48)が設けられ
ている。さらに、同電力供給回路には、シャント抵抗(4
9)を介して、電流値(I=IN)をディジタルに検出する
電流検出部(50)とA/D変換部(51)が設けられている。
【0038】クラッチ(16)とアクチュエータ(35)の電力
供給回路には、それぞれクラッチ駆動回路(52)とアクチ
ュエータ駆動回路(53)が設けられている。
供給回路には、それぞれクラッチ駆動回路(52)とアクチ
ュエータ駆動回路(53)が設けられている。
【0039】スライドドア自動制御装置(23)は、上記各
入出力周辺機器の状況に応じて、適正な制御モードを選
択する制御モード変換部(54)を含むメイン制御部(55)に
よて、大まかに一定の時間間隔で繰り返し制御を行って
いる。
入出力周辺機器の状況に応じて、適正な制御モードを選
択する制御モード変換部(54)を含むメイン制御部(55)に
よて、大まかに一定の時間間隔で繰り返し制御を行って
いる。
【0040】制御モード変換部(54)は、各入出力周辺機
器の最新の状況に応じて、制御に必要な最適の専業制御
モードを選択する。専業の制御モードには、ドア(2)の
開閉を主として制御するオートスライド制御部(56)、ド
ア(2)の移動速度を主として制御する速度制御部(57)、
及びドア(2)の駆動中に、ドア(2)の移動を抑制するよ
うな、なんらかのものが移動方向に挟み込まれたかを、
主として検出制御する挟み込み制御部(58)を備えてい
る。
器の最新の状況に応じて、制御に必要な最適の専業制御
モードを選択する。専業の制御モードには、ドア(2)の
開閉を主として制御するオートスライド制御部(56)、ド
ア(2)の移動速度を主として制御する速度制御部(57)、
及びドア(2)の駆動中に、ドア(2)の移動を抑制するよ
うな、なんらかのものが移動方向に挟み込まれたかを、
主として検出制御する挟み込み制御部(58)を備えてい
る。
【0041】また、オートスライド制御部(56)には、車
体(1)の姿勢に応じてドア(2)の開閉を制御するため
に、車体(1)の姿勢を検出する本発明の坂道判定部(59)
を備えている。
体(1)の姿勢に応じてドア(2)の開閉を制御するため
に、車体(1)の姿勢を検出する本発明の坂道判定部(59)
を備えている。
【0042】図9は、本発明を適用してなるスライドド
ア自動制御装置(23)のメインフローチャートである。メ
インルーチンをなすステップ(100)の最初のステップ(10
1)は、稼働初期に主なパラメータ等のイニシャライズを
行う初期設定ルーチンである。このメインルーチンは、
通常、ステップ(102)のSW判定以降、ステップ(110)ま
でを、ループ制御している。
ア自動制御装置(23)のメインフローチャートである。メ
インルーチンをなすステップ(100)の最初のステップ(10
1)は、稼働初期に主なパラメータ等のイニシャライズを
行う初期設定ルーチンである。このメインルーチンは、
通常、ステップ(102)のSW判定以降、ステップ(110)ま
でを、ループ制御している。
【0043】ステップ(102)のSW判定は、前記図7に
示すドア開閉SW(28)(29)等、入出力ポート(39)に接続
する各SW(25)(26)(27)の開閉状態を判定して、SWの
開閉状態を示すフラグ等を設定する。
示すドア開閉SW(28)(29)等、入出力ポート(39)に接続
する各SW(25)(26)(27)の開閉状態を判定して、SWの
開閉状態を示すフラグ等を設定する。
【0044】ステップ(103)のA/D入力は、図9のA
/D変換部(48)(51)から、電圧値(Vx)、及び電流値
(IN)を取り込み、下位レベルにステップ(111)の電流
補正とステップ(112)の電圧アドレス変換ルーチンを備
えている。ステップ(103)のモード判定は、ステップ(11
3)のオートスライドモードとステップ(114)のクロージ
ャーモードを、前記各SWの開閉状態等の周囲状況か
ら、いずれかに選択制御する。
/D変換部(48)(51)から、電圧値(Vx)、及び電流値
(IN)を取り込み、下位レベルにステップ(111)の電流
補正とステップ(112)の電圧アドレス変換ルーチンを備
えている。ステップ(103)のモード判定は、ステップ(11
3)のオートスライドモードとステップ(114)のクロージ
ャーモードを、前記各SWの開閉状態等の周囲状況か
ら、いずれかに選択制御する。
【0045】ステップ(105)のACTR(アクチュエー
タ)リレー制御、ステップ(106)クラッチリレー制御、
ステップ(107)のオートスライドリレー制御、及びステ
ップ(108)のクロージャーリレー制御は、前記各制御部
の制御結果が反映されて、クラッチやモータに電力投入
を行う、直接的制御部分なので、特に詳細な説明は、省
略する。
タ)リレー制御、ステップ(106)クラッチリレー制御、
ステップ(107)のオートスライドリレー制御、及びステ
ップ(108)のクロージャーリレー制御は、前記各制御部
の制御結果が反映されて、クラッチやモータに電力投入
を行う、直接的制御部分なので、特に詳細な説明は、省
略する。
【0046】ステップ(109)のスリープモードは、長時
間なんの変化もないときに、電力消費を低減する制御部
である。ステップ(110)のプログラム調整部は、別途ル
ープ外に設けた割り込みプログラムにおけるステップ(1
15)のプログラム調節タイマーにより、メインループの
インターバルを、例えば10mm秒一定に制御する。
間なんの変化もないときに、電力消費を低減する制御部
である。ステップ(110)のプログラム調整部は、別途ル
ープ外に設けた割り込みプログラムにおけるステップ(1
15)のプログラム調節タイマーにより、メインループの
インターバルを、例えば10mm秒一定に制御する。
【0047】このステップ(110)において、プログラム
調節タイマーの割り込みを受けることにより、各ステッ
プにおける制御点が、周囲の状況によって、ネストのよ
り深いレベルに入り込んだり、浅い階層で済んだり等し
て、メインループの入り口に戻るインターバルが変動す
るのを、常に一定に調節している。
調節タイマーの割り込みを受けることにより、各ステッ
プにおける制御点が、周囲の状況によって、ネストのよ
り深いレベルに入り込んだり、浅い階層で済んだり等し
て、メインループの入り口に戻るインターバルが変動す
るのを、常に一定に調節している。
【0048】図10は、本発明が適用されている前記ス
テップ(104)のモード判定ルーチンを詳細に示すフロー
チャートである。ステップ(116)のオートスライドモー
ド判定は、ドア(2)の動きだしを、その時点の色々な状
況によって区分するステップ(117)のスタートモード、
動き出したドア(2)を、その時点の状況に応じて適正に
制御するステップ(118)の挟み込み判定、ステップ(119)
の坂道モード、ステップ(120)の速度制御等を行う。ス
テップ(119)は、本発明に係る坂道判別装置の実施要領
の一例を示している。
テップ(104)のモード判定ルーチンを詳細に示すフロー
チャートである。ステップ(116)のオートスライドモー
ド判定は、ドア(2)の動きだしを、その時点の色々な状
況によって区分するステップ(117)のスタートモード、
動き出したドア(2)を、その時点の状況に応じて適正に
制御するステップ(118)の挟み込み判定、ステップ(119)
の坂道モード、ステップ(120)の速度制御等を行う。ス
テップ(119)は、本発明に係る坂道判別装置の実施要領
の一例を示している。
【0049】同じく、ステップ(121)のスイッチ文の部
分で、周囲の状況に応じた識別子により分岐される、ス
テップ(122)のオート開作動、ステップ(123)のオート閉
作動、ステップ(124)のマニュアル閉作動、ステップ(12
5)の逆転開作動、ステップ(126)の逆転閉作動、いずれ
かの制御を行い、それらの制御の下位レベルには、ステ
ップ(133)の目標位置算出、ステップ(134)の全開検出の
ルーチンがある。
分で、周囲の状況に応じた識別子により分岐される、ス
テップ(122)のオート開作動、ステップ(123)のオート閉
作動、ステップ(124)のマニュアル閉作動、ステップ(12
5)の逆転開作動、ステップ(126)の逆転閉作動、いずれ
かの制御を行い、それらの制御の下位レベルには、ステ
ップ(133)の目標位置算出、ステップ(134)の全開検出の
ルーチンがある。
【0050】さらに、ステップ(117)のスタートモード
等と同じレベルに、ステップ(122)のストップモードの
ルーチンがあり。ステップ(117)のスタートモードは、
それの下位レベルに、ステップ(127)スイッチ文により
多枝分岐されるステップ(128)の通常スタートモード、
ステップ(129)のACTRスタートモード、及びステッ
プ(130)の手動スタートモードのルーチンがある。本発
明に係るステップ(119)の坂道モードは、それの下位レ
ベルに、ステップ(131)の平坦データ入力、ステップ(13
2)の坂道判定等のルーチンを含む。
等と同じレベルに、ステップ(122)のストップモードの
ルーチンがあり。ステップ(117)のスタートモードは、
それの下位レベルに、ステップ(127)スイッチ文により
多枝分岐されるステップ(128)の通常スタートモード、
ステップ(129)のACTRスタートモード、及びステッ
プ(130)の手動スタートモードのルーチンがある。本発
明に係るステップ(119)の坂道モードは、それの下位レ
ベルに、ステップ(131)の平坦データ入力、ステップ(13
2)の坂道判定等のルーチンを含む。
【0051】なお、上述のステップ(121)、ステップ(12
7)のスイッチ文として示される、多分岐フローは、周囲
の状況を示す識別子として、各SWの開閉状態や、所要
の制御の継続中もしくは終了を表す、通常は1ビットの
フラグを利用している。上記ステップ(116)のオートス
ライドモード判定のフローは、前記メインルーチンにし
たがって、制御点を移している。
7)のスイッチ文として示される、多分岐フローは、周囲
の状況を示す識別子として、各SWの開閉状態や、所要
の制御の継続中もしくは終了を表す、通常は1ビットの
フラグを利用している。上記ステップ(116)のオートス
ライドモード判定のフローは、前記メインルーチンにし
たがって、制御点を移している。
【0052】図10において、別途に示すステップ(13
5)のパルスカウントタイマーと、ステップ(136)のパル
ス割り込みの両ルーチンは、図9のメインルーチンと
は、制御点を別にした割り込みプログラムを構成してい
る。
5)のパルスカウントタイマーと、ステップ(136)のパル
ス割り込みの両ルーチンは、図9のメインルーチンと
は、制御点を別にした割り込みプログラムを構成してい
る。
【0053】図11は、図15に示すステップ(135)の
パルスカウントタイマーと、図14に示すステップ(13
6)のパルス割り込みの各ルーチンにおいて所要される、
周期計数値(N)の取得タイムチャートを示すものであ
る。
パルスカウントタイマーと、図14に示すステップ(13
6)のパルス割り込みの各ルーチンにおいて所要される、
周期計数値(N)の取得タイムチャートを示すものであ
る。
【0054】速度信号(Vφ1)(Vφ2)は、前記ロータリ
ーエンコーダ(18)が出力する出力信号で、その出力波形
は矩形波をなし、かつ速度信号(Vφ2)は、速度信号(V
φ1)に対いして90度の位相差をもち、両信号の位相差
から、ロータリーエンコーダ(18)の回転方向、すなわ
ち、ドア(2)の開閉移動方向を検出する。
ーエンコーダ(18)が出力する出力信号で、その出力波形
は矩形波をなし、かつ速度信号(Vφ2)は、速度信号(V
φ1)に対いして90度の位相差をもち、両信号の位相差
から、ロータリーエンコーダ(18)の回転方向、すなわ
ち、ドア(2)の開閉移動方向を検出する。
【0055】速度信号(Vφ1)は、矩形波の立ち上がり
において、割り込みパルス(g1)を生成し、その割り
込みパルス(g1)は、そのパルス周期をもって、その
割り込みパルス(g1)より十分に繰り返し数の高い、
例えば400μs毎にパルスを発生するクロックパルス
(C1)の数を計数して周期計数値(T)を得る。
において、割り込みパルス(g1)を生成し、その割り
込みパルス(g1)は、そのパルス周期をもって、その
割り込みパルス(g1)より十分に繰り返し数の高い、
例えば400μs毎にパルスを発生するクロックパルス
(C1)の数を計数して周期計数値(T)を得る。
【0056】この周期計数値(T)は、ロータリーエン
コーダ(18)の出力する速度信号(Vφ1)の周期をディジ
タルの数に変換しているもので、ロータリーエンコーダ
(18)の出力パルスは、1mm当たり1パルス(1周期)と
すると、周期計数値(T)が250のときには、ドア
(2)の移動速度は、1mm/(400μs×250)=1
0mm/秒の速度となり、周期計数値(T)が100のと
きには、ドア(2)の移動速度は、25mm/秒の速度とな
る。
コーダ(18)の出力する速度信号(Vφ1)の周期をディジ
タルの数に変換しているもので、ロータリーエンコーダ
(18)の出力パルスは、1mm当たり1パルス(1周期)と
すると、周期計数値(T)が250のときには、ドア
(2)の移動速度は、1mm/(400μs×250)=1
0mm/秒の速度となり、周期計数値(T)が100のと
きには、ドア(2)の移動速度は、25mm/秒の速度とな
る。
【0057】図15は、上述の周期計数値(T)を計数
する、ステップ(135)のパルスカウントタイマーのルー
チンを示すものである。ステップ(159)は、上記クロッ
クパルス(C1)の数を、ステップ(110)のメインルーチ
ンとは別途に所要のパルスカウンタにより計数してい
る。
する、ステップ(135)のパルスカウントタイマーのルー
チンを示すものである。ステップ(159)は、上記クロッ
クパルス(C1)の数を、ステップ(110)のメインルーチ
ンとは別途に所要のパルスカウンタにより計数してい
る。
【0058】ステップ(160)は、そのパルスカウンタの
周期計数値(T)が満杯(T=FF)になったかどうか
を調べて、それが満杯ならばステップ(161)で周期計数
値(T)を零にクリアー(T=0)するとともに、ステ
ップ(162)において、モータ(14)が停止していた期間を
計数する所要カウンタの計数値を増計数している。
周期計数値(T)が満杯(T=FF)になったかどうか
を調べて、それが満杯ならばステップ(161)で周期計数
値(T)を零にクリアー(T=0)するとともに、ステ
ップ(162)において、モータ(14)が停止していた期間を
計数する所要カウンタの計数値を増計数している。
【0059】なお、図11に図示の周期計数値(TN)
は、ロータリーエンコーダ(18)が出力する出力信号(φ
1)によって得られる位置計数パルス(実質的には割り込
みパルス(g1))をN個計数した、後述するドア(2)
の位置情報を示す位置計数値(N)を添え字として持つ
もので、その周期計数値(TN)は、そのときに注目す
るN番目の位置に対応した周期計数値(T)を示し、
(TN-1)(TN-2)または(TN+1)(TN+2)は、それぞれ
位置計数値(N)に対して、1または2番前後の位置に
係る周期計数値(T)を示すものである。
は、ロータリーエンコーダ(18)が出力する出力信号(φ
1)によって得られる位置計数パルス(実質的には割り込
みパルス(g1))をN個計数した、後述するドア(2)
の位置情報を示す位置計数値(N)を添え字として持つ
もので、その周期計数値(TN)は、そのときに注目す
るN番目の位置に対応した周期計数値(T)を示し、
(TN-1)(TN-2)または(TN+1)(TN+2)は、それぞれ
位置計数値(N)に対して、1または2番前後の位置に
係る周期計数値(T)を示すものである。
【0060】上記周期計数値(TN)は、後述するが、
シフトレジスタもしくはそれに相当するメモリロケーシ
ョンからなる4つの周期レジスタに、N番の位置を注目
点とし、それがレジスタの先頭出力値となるように、4
回分保留されるようになっている。
シフトレジスタもしくはそれに相当するメモリロケーシ
ョンからなる4つの周期レジスタに、N番の位置を注目
点とし、それがレジスタの先頭出力値となるように、4
回分保留されるようになっている。
【0061】図12は、ロータリーエンコーダ(18)が出
力する出力信(φ1)を位置計数パルスとして、ドア(2)
の位置に係るデータを収得するタイムチャートを示して
いる。
力する出力信(φ1)を位置計数パルスとして、ドア(2)
の位置に係るデータを収得するタイムチャートを示して
いる。
【0062】ドア(2)の位置に係るデータとしては、図
13に示す如く、ドア(2)の閉方向に係るドアの所在エ
リアを、エリア1〜エリア4に分けてあり、またドア
(2)の開方向に係るドアの所在エリアを、エリア5〜エ
リア7に分けてある。なお、図13は、ロアトラック
(5)の平面視を示し、ドア(2)の開閉位置は、移動部材
(21)の位置をもって表してある。
13に示す如く、ドア(2)の閉方向に係るドアの所在エ
リアを、エリア1〜エリア4に分けてあり、またドア
(2)の開方向に係るドアの所在エリアを、エリア5〜エ
リア7に分けてある。なお、図13は、ロアトラック
(5)の平面視を示し、ドア(2)の開閉位置は、移動部材
(21)の位置をもって表してある。
【0063】各エリアは、図14に示すステップ(136)
のパルス割り込みルーチンによって、前記位置計数値
(N)とドアの移動方向(Z)によって、図13及び図
16如く判別される。
のパルス割り込みルーチンによって、前記位置計数値
(N)とドアの移動方向(Z)によって、図13及び図
16如く判別される。
【0064】図16には、上記エリア1〜エリア7の所
に要求される制御の特徴で分けた制御領域(E1)〜
(E6)、及びその制御領域(E1)〜(E6)に対応し
て定められた、その制御領域(E1)〜(E6)に適した
ドア(2)の移動速度、並びにその制御領域(E1)〜
(E6)で所用される、サンプリング領域の分解能
(B)等を示してある。なおサンプリング領域について
は後述する。
に要求される制御の特徴で分けた制御領域(E1)〜
(E6)、及びその制御領域(E1)〜(E6)に対応し
て定められた、その制御領域(E1)〜(E6)に適した
ドア(2)の移動速度、並びにその制御領域(E1)〜
(E6)で所用される、サンプリング領域の分解能
(B)等を示してある。なおサンプリング領域について
は後述する。
【0065】図14に示すステップ(136)のパルス割り
込みルーチンにおいては、各エリアの判定と、各エリア
に適した制御で区別した、各制御領域(E1)〜(E6)
の判別を行う。
込みルーチンにおいては、各エリアの判定と、各エリア
に適した制御で区別した、各制御領域(E1)〜(E6)
の判別を行う。
【0066】ステップ(137)においては、モータ(14)の
停止を調べて、ドア(2)が動いていないことを判別し、
モータ(14)が停止してドア(2)が止まっていれば、ステ
ップ(138)において周期計数値(T)を満杯(T=F
F)にセットし、そうでなければ、ステップ(139)によ
り、そのときまでに計数した周期計数値(T)を、図1
1に示す周期レジスタに格納し、その後ステップ(140)
においてモータ(14)の停止中の状態を解除する。
停止を調べて、ドア(2)が動いていないことを判別し、
モータ(14)が停止してドア(2)が止まっていれば、ステ
ップ(138)において周期計数値(T)を満杯(T=F
F)にセットし、そうでなければ、ステップ(139)によ
り、そのときまでに計数した周期計数値(T)を、図1
1に示す周期レジスタに格納し、その後ステップ(140)
においてモータ(14)の停止中の状態を解除する。
【0067】ステップ(141)において、ドア(2)の移動
方向(Z)を調べて、ドア(2)が開方向に移動していれ
ばステップ(142)に進み、そうでなければ、すなわち閉
じる方に移動していれば、ステップ(150)に進む。ドア
(2)が開く方に移動していれば、ステップ(142)におい
て、位置計数値(N)を増計数する。
方向(Z)を調べて、ドア(2)が開方向に移動していれ
ばステップ(142)に進み、そうでなければ、すなわち閉
じる方に移動していれば、ステップ(150)に進む。ドア
(2)が開く方に移動していれば、ステップ(142)におい
て、位置計数値(N)を増計数する。
【0068】すなわち、位置計数値(N)は、図13図
示の如く、ドア(2)の全閉位置をN=0とし、全開位置
を=850となるように予めセットしてあるので、開く
ときには増計数を、閉じるときには減計数をして、ドア
(2)の現在位置を計測する。ステップ(143)〜ステップ
(149)において、開方向の各エリア5からエリア7を判
別するとともに、そのエリアに応じた制御領域、すなわ
ちリンク制御領域(E5)、通常制御領域(E1)、チェ
ック制御領域(E6)を定める。
示の如く、ドア(2)の全閉位置をN=0とし、全開位置
を=850となるように予めセットしてあるので、開く
ときには増計数を、閉じるときには減計数をして、ドア
(2)の現在位置を計測する。ステップ(143)〜ステップ
(149)において、開方向の各エリア5からエリア7を判
別するとともに、そのエリアに応じた制御領域、すなわ
ちリンク制御領域(E5)、通常制御領域(E1)、チェ
ック制御領域(E6)を定める。
【0069】また、ステップ(151)〜ステップ(158)にお
いては、閉方向のエリア1からエリア4を判別するとと
もに、その各エリアに応じた通常制御領域(E1)、減速
制御領域(E2)、リンク減速制御領域(E3)、締め込
み制御領域(E4)を定める。なお、開方向のエリア6
の通常制御領域(E1)と閉方向のエリア1の通常制御
領域(E1)は、図16に示す如く、ともに制御仕様を
同一にしてある。
いては、閉方向のエリア1からエリア4を判別するとと
もに、その各エリアに応じた通常制御領域(E1)、減速
制御領域(E2)、リンク減速制御領域(E3)、締め込
み制御領域(E4)を定める。なお、開方向のエリア6
の通常制御領域(E1)と閉方向のエリア1の通常制御
領域(E1)は、図16に示す如く、ともに制御仕様を
同一にしてある。
【0070】図10における、ステップ(135)のパルス
カウントタイマーと、ステップ(136)のパルス割り込み
とは、上述のように、メインルーチンとは別途に、それ
ぞれのタイミングで周期計数値(T)と位置計数値
(N)と収得している。
カウントタイマーと、ステップ(136)のパルス割り込み
とは、上述のように、メインルーチンとは別途に、それ
ぞれのタイミングで周期計数値(T)と位置計数値
(N)と収得している。
【0071】図17は、図10におけるステップ(116)
のオートスライドモード判定ルーチンの詳細を示すもの
である。このルーチンの目的は、ステップ(165)によ
り、オートスライド作動中か又は停止中により制御内容
を変更している。
のオートスライドモード判定ルーチンの詳細を示すもの
である。このルーチンの目的は、ステップ(165)によ
り、オートスライド作動中か又は停止中により制御内容
を変更している。
【0072】ステップ(167)以降のオートスライド停止
中は、ステップ(168)、ステップ(169)にて始動判定を行
い、そこで始動判定された時には、ステップ(170)にて
オートスライド作動を判定して、ステップ(172)でスタ
ートモードをセットしてオートスライド作動中処理し、
かつステップ(174)にてスタート中の処理に入ったこと
を知らせる。
中は、ステップ(168)、ステップ(169)にて始動判定を行
い、そこで始動判定された時には、ステップ(170)にて
オートスライド作動を判定して、ステップ(172)でスタ
ートモードをセットしてオートスライド作動中処理し、
かつステップ(174)にてスタート中の処理に入ったこと
を知らせる。
【0073】ステップ(165)にてオートスライド作動中
になると、ステップ(176)のスタートモード、ステップ
(177)以降の通常モード、ステップ(164)のストップモー
ド、いずれかの3つの処理に分かれ、ステップ(177)以
降の通常モードにおいてオートスライド作動中は、ステ
ップ(187)にてオートスライド作動計数(G)を増計数
する。
になると、ステップ(176)のスタートモード、ステップ
(177)以降の通常モード、ステップ(164)のストップモー
ド、いずれかの3つの処理に分かれ、ステップ(177)以
降の通常モードにおいてオートスライド作動中は、ステ
ップ(187)にてオートスライド作動計数(G)を増計数
する。
【0074】ステップ(166)にてスタートモードが終了
したことを検出すると、通常モードに入り、ステップ(1
77)の挟み込み判定、ステップ(178)の速度制御、ステッ
プ(179)の坂道判定をする。
したことを検出すると、通常モードに入り、ステップ(1
77)の挟み込み判定、ステップ(178)の速度制御、ステッ
プ(179)の坂道判定をする。
【0075】ステップステップ(186)にて、オートスラ
イド作動終了を判定すると(後述する反転作動時は入ら
ない)、ステップ(189)でストップモードにセットし、
この状態が、ステップ(163)にてストップモードなった
ことを判別すると、ステップ(164)のストップモードに
移り、このストップモードでオートスライドの停止処理
を行い、ステップ(190)にてストップモードの作動が終
了したことを判別すると、ステップ(193)にてストップ
モードの終了を行うとともに、ステップ(194)にてオー
トスライド作動を終了させる。
イド作動終了を判定すると(後述する反転作動時は入ら
ない)、ステップ(189)でストップモードにセットし、
この状態が、ステップ(163)にてストップモードなった
ことを判別すると、ステップ(164)のストップモードに
移り、このストップモードでオートスライドの停止処理
を行い、ステップ(190)にてストップモードの作動が終
了したことを判別すると、ステップ(193)にてストップ
モードの終了を行うとともに、ステップ(194)にてオー
トスライド作動を終了させる。
【0076】図18は、図17におけるステップ(168)
の手動判定ルーチンの詳細である。この手動判定ルーチ
ンの目的とする機能は、ドア(2)の開閉者による、ドア
(2)を開閉するための手動操作が、確実に行われたか否
かを判定する。
の手動判定ルーチンの詳細である。この手動判定ルーチ
ンの目的とする機能は、ドア(2)の開閉者による、ドア
(2)を開閉するための手動操作が、確実に行われたか否
かを判定する。
【0077】ステップ(195)にて、現在のドア(2)の移
動速度(1/周期計数値(T))が予め定めた一定の手
動認識速度より速く、かつステップ(196)にて、ドア
(2)の移動速度が、急閉速度以下のときには、ステップ
(197)にてドア(2)の開閉方向の判別に基づいて、ステ
ップ(198)のドア開手動状態、もしくは、ステップ(199)
のドア閉手動状態のいずれかにセットする。但し、クラ
ッチ(16)OFF後は、ワイヤーの張力による運動を無視
するため、所要タイムラグ期間中は、ドア開閉いずれか
の状態への移行は、受け付けないようになっている。
動速度(1/周期計数値(T))が予め定めた一定の手
動認識速度より速く、かつステップ(196)にて、ドア
(2)の移動速度が、急閉速度以下のときには、ステップ
(197)にてドア(2)の開閉方向の判別に基づいて、ステ
ップ(198)のドア開手動状態、もしくは、ステップ(199)
のドア閉手動状態のいずれかにセットする。但し、クラ
ッチ(16)OFF後は、ワイヤーの張力による運動を無視
するため、所要タイムラグ期間中は、ドア開閉いずれか
の状態への移行は、受け付けないようになっている。
【0078】なお、 ドア(2)が全閉近くにおいて、ハ
ーフSWがOFF、又はドアハンドルSWの操作信号を
検出すると、開手動検出信号をセットするように、別途
なっている。
ーフSWがOFF、又はドアハンドルSWの操作信号を
検出すると、開手動検出信号をセットするように、別途
なっている。
【0079】ドア(2)が急閉作動しているときには、ド
ア(2)が停止まで急閉モードから抜け出ないようになっ
ている。この手動判定時、ドア速度が急閉速度以上、又
は手動認識速度以下の場合はに、なにもセットしないで
手動判定ルーチンから抜け出る。
ア(2)が停止まで急閉モードから抜け出ないようになっ
ている。この手動判定時、ドア速度が急閉速度以上、又
は手動認識速度以下の場合はに、なにもセットしないで
手動判定ルーチンから抜け出る。
【0080】このステップ(168)の手動判定ルーチンで
は、ドア(2)を制御するためのステップ(110)のメイン
ルーチンとは別途に計測されているドア速度により、ド
ア(2)を動力駆動(以下オート開作動、オート閉作動と
する)する契機を得ている。
は、ドア(2)を制御するためのステップ(110)のメイン
ルーチンとは別途に計測されているドア速度により、ド
ア(2)を動力駆動(以下オート開作動、オート閉作動と
する)する契機を得ている。
【0081】ステップ(195)の手動認識速度は、ドアの
動力駆動を行う契機を作り出す値で、比較的広範囲の任
意の値が設定できる。
動力駆動を行う契機を作り出す値で、比較的広範囲の任
意の値が設定できる。
【0082】ドア(2)の移動速度、すなわち周期計数値
(T)は、上述の如く、ロータリーエンコーダ(18)の1
周期を最小の分解能として、計測可能であることから、
1mm程度のドア(2)の移動によても、ドア(2)を動力駆
動させる契機を作り出すことができる。これにより、オ
ート開閉作動(動力駆動)の反応が高感度となるととも
に、安全性を得る処理に対応させるために、ドアの動き
の変化を、高分解能で高感度に検知することができる。
(T)は、上述の如く、ロータリーエンコーダ(18)の1
周期を最小の分解能として、計測可能であることから、
1mm程度のドア(2)の移動によても、ドア(2)を動力駆
動させる契機を作り出すことができる。これにより、オ
ート開閉作動(動力駆動)の反応が高感度となるととも
に、安全性を得る処理に対応させるために、ドアの動き
の変化を、高分解能で高感度に検知することができる。
【0083】図17における前記ステップ(168)の後の
ステップ(169)の始動モードは、以下のような判定を各
SWの開閉状態に応じて行うもので、下記のように、オ
ートスライドの作動の開始を判定し、ステップ(181)〜
ステップ(185)の各作動に分岐させるための、ステップ
(180)におけるスイッチ文の識別子を設定して作動モー
ドを決定する。
ステップ(169)の始動モードは、以下のような判定を各
SWの開閉状態に応じて行うもので、下記のように、オ
ートスライドの作動の開始を判定し、ステップ(181)〜
ステップ(185)の各作動に分岐させるための、ステップ
(180)におけるスイッチ文の識別子を設定して作動モー
ドを決定する。
【0084】急閉速度以上で、かつ急閉作動中である
か、もしくはSW受け付け可能状態でない時は、オート
開閉作動は開始しない。SW受け付け可能状態でない
時,全てのSWがOFFした場合は、SW受け付け可能
状態とする。リモコンSWをドア開に操作、車内開SW
がONもしくは、手動開状態を確認した時は、オート開
作動モードの識別子をセットに設定する。
か、もしくはSW受け付け可能状態でない時は、オート
開閉作動は開始しない。SW受け付け可能状態でない
時,全てのSWがOFFした場合は、SW受け付け可能
状態とする。リモコンSWをドア開に操作、車内開SW
がONもしくは、手動開状態を確認した時は、オート開
作動モードの識別子をセットに設定する。
【0085】危険領域外でにおいて、リモコンSWをド
ア閉に操作、車内閉SWがONもしくは、手動閉状態を
確認した時は、オート閉作動モードの識別子をセットに
設定する。
ア閉に操作、車内閉SWがONもしくは、手動閉状態を
確認した時は、オート閉作動モードの識別子をセットに
設定する。
【0086】危険領域中で、車内閉SWがONしたこと
を確認した時は、マニュアル閉作動モードの識別子をセ
ットに設定する。作動開始する場合は、SW受け付け可
能状態をリセットする。
を確認した時は、マニュアル閉作動モードの識別子をセ
ットに設定する。作動開始する場合は、SW受け付け可
能状態をリセットする。
【0087】図19は、図10におけるステップ(122)
及び図17におけるステップ(181)で示すオート開作動
ルーチンの詳細を示すものである。このオート開作動ル
ーチンの目的は、ドア(2)を開方向に安全に動力駆動さ
せるための、オート開作動中のドア駆動停止、又は反転
作動の制御をすることにあり、以下のように機能する。
及び図17におけるステップ(181)で示すオート開作動
ルーチンの詳細を示すものである。このオート開作動ル
ーチンの目的は、ドア(2)を開方向に安全に動力駆動さ
せるための、オート開作動中のドア駆動停止、又は反転
作動の制御をすることにあり、以下のように機能する。
【0088】ステップ(212)のメインのON/OFFが
OFFとき、ステップ(213)、ステップ(214)の各ドア開
SW入力のときは、ステップ(223)に抜けて、オート開
作動を解除し、ドア(2)の動力駆動を停止する。
OFFとき、ステップ(213)、ステップ(214)の各ドア開
SW入力のときは、ステップ(223)に抜けて、オート開
作動を解除し、ドア(2)の動力駆動を停止する。
【0089】ステップ(208)においてSW受け付可能で
ないとき、ステップ(210)とステップ(211)でリモコンま
たは車内のドア閉SWが入力している時は、ステップ(2
04)から、ステップ(216)の逆転閉作動許可に至るドア反
転側に制御を渡す。但し、両ドア閉SWは、少し長く押
続けた場合は、ステップ(220)またはステップ(222)によ
りドア停止のみの制御となる。
ないとき、ステップ(210)とステップ(211)でリモコンま
たは車内のドア閉SWが入力している時は、ステップ(2
04)から、ステップ(216)の逆転閉作動許可に至るドア反
転側に制御を渡す。但し、両ドア閉SWは、少し長く押
続けた場合は、ステップ(220)またはステップ(222)によ
りドア停止のみの制御となる。
【0090】ステップ(201)で挟み込み検出時は、ステ
ップ(202)で目標位置を求めて、反転側に制御を移す。
ただし、ステップ(204)により図16に示す危険領域内
では停止のみとなる。ステップ(205)でドア(2)の全開
検出したり、ステップ(207)で異常検出したりすると、
ステップ(223)に移り停止させる。反転作動時は、ステ
ップ(217)でドア開作動解除し、ステップ(218)でドア閉
作動を許可する。
ップ(202)で目標位置を求めて、反転側に制御を移す。
ただし、ステップ(204)により図16に示す危険領域内
では停止のみとなる。ステップ(205)でドア(2)の全開
検出したり、ステップ(207)で異常検出したりすると、
ステップ(223)に移り停止させる。反転作動時は、ステ
ップ(217)でドア開作動解除し、ステップ(218)でドア閉
作動を許可する。
【0091】図20は、図10におけるステップ(123)
及び図17におけるステップ(182)で示すオート閉作動
ルーチンの詳細を示すものである。このオート閉作動ル
ーチンの目的は、ドア(2)を閉方向に安全に動力駆動さ
せるための、オート閉作動中のドア駆動停止、又は反転
作動の制御をすることにあり、以下のように機能する。
及び図17におけるステップ(182)で示すオート閉作動
ルーチンの詳細を示すものである。このオート閉作動ル
ーチンの目的は、ドア(2)を閉方向に安全に動力駆動さ
せるための、オート閉作動中のドア駆動停止、又は反転
作動の制御をすることにあり、以下のように機能する。
【0092】ステップ(233)のメインのON/OFFが
OFFとき、ステップ(234)、ステップ(235)の各ドア閉
SW入力のときは、ステップ(246)に抜けて、オート閉
作動を解除し、ドア(2)の動力駆動を停止する。
OFFとき、ステップ(234)、ステップ(235)の各ドア閉
SW入力のときは、ステップ(246)に抜けて、オート閉
作動を解除し、ドア(2)の動力駆動を停止する。
【0093】ステップ(230)においてSW受け付可能で
ないとき、ステップ(231)とステップ(232)でリモコンま
たは車内のドア開SWが入力している時は、ステップ(2
38)のオート作動解除に移り、ステップ(236)の逆転開作
動許可に至るドア反転側に制御を渡す。但し、両ドア開
SWは、少し長く押続けた場合は、ステップ(243)また
はステップ(244)によりドア停止のみの制御となる。
ないとき、ステップ(231)とステップ(232)でリモコンま
たは車内のドア開SWが入力している時は、ステップ(2
38)のオート作動解除に移り、ステップ(236)の逆転開作
動許可に至るドア反転側に制御を渡す。但し、両ドア開
SWは、少し長く押続けた場合は、ステップ(243)また
はステップ(244)によりドア停止のみの制御となる。
【0094】ステップ(225)で挟み込み検出時は、ステ
ップ(226)で目標位置を求めて、反転側に制御を移す。
ステップ(224)でドア(2)のハーフラッチ領域を検出し
たり、ステップ(229)で異常検出したりするとステップ
(246)に移り停止させる。 反転作 動時は、ステップ(237)でドア閉作動解除し、ステップ
(238)でドア開作動を許可する。さらに、ステップ(239)
にてドア(2)がACTR領域ならば、ステップ(240)に
てACTR作動を許可する。
ップ(226)で目標位置を求めて、反転側に制御を移す。
ステップ(224)でドア(2)のハーフラッチ領域を検出し
たり、ステップ(229)で異常検出したりするとステップ
(246)に移り停止させる。 反転作 動時は、ステップ(237)でドア閉作動解除し、ステップ
(238)でドア開作動を許可する。さらに、ステップ(239)
にてドア(2)がACTR領域ならば、ステップ(240)に
てACTR作動を許可する。
【0095】図21は、図10におけるステップ(124)
及び図17におけるステップ(183)のマニュアル閉作動
ルーチンの詳細を示すものである。このマニュアル閉作
動ルーチンの目的は、ドア開閉操作SWのON/OFF
操作を動力駆動の契機とし、そのドア開閉SWのON/
OFF操作に、自動制御が安全に追従するようにした、
マニュアル閉作動中のドア駆動の停止、又は反転作動の
制御することで、以下のように機能する。
及び図17におけるステップ(183)のマニュアル閉作動
ルーチンの詳細を示すものである。このマニュアル閉作
動ルーチンの目的は、ドア開閉操作SWのON/OFF
操作を動力駆動の契機とし、そのドア開閉SWのON/
OFF操作に、自動制御が安全に追従するようにした、
マニュアル閉作動中のドア駆動の停止、又は反転作動の
制御することで、以下のように機能する。
【0096】ステップ(249)にて各ドア閉SWのいずれ
かがドア開になれば、ステップ(255)でオート閉作動を
解除して、ドアの駆動を停止する。ステップ(247)にて
挟み込み検出有りの時は、ステップ(248)〜ステップ(25
4)に制御を移して、ドア(2)を反転駆動する。
かがドア開になれば、ステップ(255)でオート閉作動を
解除して、ドアの駆動を停止する。ステップ(247)にて
挟み込み検出有りの時は、ステップ(248)〜ステップ(25
4)に制御を移して、ドア(2)を反転駆動する。
【0097】図22は、図10におけるステップ(125)
及び図17におけるステップ(184)の逆転開作動ルーチ
ンの詳細を示すものである。この逆転開作動ルーチンの
目的は、逆転開作動中の停止、又は反転作動を安全に制
御することで、以下のように機能する。
及び図17におけるステップ(184)の逆転開作動ルーチ
ンの詳細を示すものである。この逆転開作動ルーチンの
目的は、逆転開作動中の停止、又は反転作動を安全に制
御することで、以下のように機能する。
【0098】この逆転開作動に至る前に、前記図20の
ステップ(182)のオート閉作動ルーチンにおけるステッ
プ(225)の挟み込み有りの判定を得て、ステップ(226)で
収得した目標値と、現在の位置計数値(N)を、ステッ
プ(257)で比較して、この挟み込み作動中は、指定させ
た目標の反転位置で停止すること。
ステップ(182)のオート閉作動ルーチンにおけるステッ
プ(225)の挟み込み有りの判定を得て、ステップ(226)で
収得した目標値と、現在の位置計数値(N)を、ステッ
プ(257)で比較して、この挟み込み作動中は、指定させ
た目標の反転位置で停止すること。
【0099】ステップ(268)で各操作SWを全てOFF
したあと、両ドア閉SWのいずれかを押すと、ステップ
(267)、ステップ(269)にて、ステップ(258)に至り、ド
ア逆転開動作の許可が解除されて、ドアの逆転開移動は
停止する。
したあと、両ドア閉SWのいずれかを押すと、ステップ
(267)、ステップ(269)にて、ステップ(258)に至り、ド
ア逆転開動作の許可が解除されて、ドアの逆転開移動は
停止する。
【0100】ステップ(259)のメインSWがOFF時、
ステップ(264)の異常検出時、及びステップ(262)の挟み
込み有りの時は、制御がステップ(258)に移り、ドアの
逆転移動は停止する。
ステップ(264)の異常検出時、及びステップ(262)の挟み
込み有りの時は、制御がステップ(258)に移り、ドアの
逆転移動は停止する。
【0101】図23は、図10におけるステップ(126)
及び図17におけるステップ(185)の逆転閉作動ルーチ
ンの詳細を示すものである。この逆転閉作動ルーチンの
目的は、逆転閉作動中の停止、又は反転作動を安全に制
御し、以下のように機能する。
及び図17におけるステップ(185)の逆転閉作動ルーチ
ンの詳細を示すものである。この逆転閉作動ルーチンの
目的は、逆転閉作動中の停止、又は反転作動を安全に制
御し、以下のように機能する。
【0102】この逆転閉作動に至る前に、前記図19の
ステップ(181)のオート開作動ルーチンのステップ(201)
の挟み込み有りの判定を得て、ステップ(202)で収得し
た目標値と、現在の位置計数値(N)を、ステップ(27
1)で比較して、この挟み込み作動中は、指定させた目標
の反転位置で停止すること。
ステップ(181)のオート開作動ルーチンのステップ(201)
の挟み込み有りの判定を得て、ステップ(202)で収得し
た目標値と、現在の位置計数値(N)を、ステップ(27
1)で比較して、この挟み込み作動中は、指定させた目標
の反転位置で停止すること。
【0103】ステップ(281)で各操作SWを全てOFF
したあと、両ドア閉SWのいずれかを押すと、ステップ
(280)、ステップ(283)にて、ステップ(272)に至り、ド
ア逆転閉動作の許可が解除されて、ドアの逆転閉移動は
停止する。ステップ(274)のメインSWがOFF時、ス
テップ(277)の異常検出時、及びステップ(275)の挟み込
み有りの時は、制御がステップ(272)に移り、ドアの逆
転閉移動は停止する。
したあと、両ドア閉SWのいずれかを押すと、ステップ
(280)、ステップ(283)にて、ステップ(272)に至り、ド
ア逆転閉動作の許可が解除されて、ドアの逆転閉移動は
停止する。ステップ(274)のメインSWがOFF時、ス
テップ(277)の異常検出時、及びステップ(275)の挟み込
み有りの時は、制御がステップ(272)に移り、ドアの逆
転閉移動は停止する。
【0104】図24は、図19のオート開作動ルーチン
におけるステップ(202)、図20のオート閉作動ルーチ
ンにおけるステップ(226)、及びず21のマニュアル作
動ルーチンにおけるステップ(254)をなす目標位置算出
ルーチンの詳細を示すものである。この目標位置算出ル
ーチンは、挟み込み検出時に、ドア(2)をそれまでの移
動方向と反転させて、安全な位置にドアを移動させる、
移動目標位置を算出する。ステップ(284)にてドアの移
動方向を判別する。
におけるステップ(202)、図20のオート閉作動ルーチ
ンにおけるステップ(226)、及びず21のマニュアル作
動ルーチンにおけるステップ(254)をなす目標位置算出
ルーチンの詳細を示すものである。この目標位置算出ル
ーチンは、挟み込み検出時に、ドア(2)をそれまでの移
動方向と反転させて、安全な位置にドアを移動させる、
移動目標位置を算出する。ステップ(284)にてドアの移
動方向を判別する。
【0105】挟み込みが検出され、ドア(2)がステップ
(284)にて閉方向に作動中と判別されると、ステップ(28
6)において位置計数値(N)の現在位置の値に対して、
予め指定された移動させる量(移動量)を加算して目標
位置とする。ステップ(287)とステップ(288)は、全開位
置を加算の上限としている。
(284)にて閉方向に作動中と判別されると、ステップ(28
6)において位置計数値(N)の現在位置の値に対して、
予め指定された移動させる量(移動量)を加算して目標
位置とする。ステップ(287)とステップ(288)は、全開位
置を加算の上限としている。
【0106】同じく、挟み込みが検出され、かつドア
(2)が、ステップ(284)にて開方向に作動中と判別され
ると、ステップ(285)において位置計数値(T)の現在
位置の値に対して、予め指定された移動させる量(移動
量)を減算して目標値とする。ステップ(289)とステッ
プ(290)は、その目標位置がエリア3の危険領域の場合
は、危険領域の下限境界値とする。
(2)が、ステップ(284)にて開方向に作動中と判別され
ると、ステップ(285)において位置計数値(T)の現在
位置の値に対して、予め指定された移動させる量(移動
量)を減算して目標値とする。ステップ(289)とステッ
プ(290)は、その目標位置がエリア3の危険領域の場合
は、危険領域の下限境界値とする。
【0107】図25は、図22におけるステップ(256)
の全開位置検出ルーチンで、以下のように機能する。ド
ア(2)の全開位置を判定する。イニシャライズの初期動
作時は、モータ(14)のON時にドアの移動がなく(停止
している)しかも、モータ(14)の負荷拘束時の電流値の
認識で、全開位置であることを検出し、ドア全開状態に
セットする。
の全開位置検出ルーチンで、以下のように機能する。ド
ア(2)の全開位置を判定する。イニシャライズの初期動
作時は、モータ(14)のON時にドアの移動がなく(停止
している)しかも、モータ(14)の負荷拘束時の電流値の
認識で、全開位置であることを検出し、ドア全開状態に
セットする。
【0108】ステップ(296)にて、その時の位置計数値
(N)から全開マージンを差し引き、ステップ(297)に
て、それを全開認識位置として所要のメモリー部に記憶
する。全開マージンは、ドア(2)の開動作移動中、全開
位置と認識して、ドアを停止しても、若干の移動を生じ
るので、その移動量を見込んでマージンをとる。全開位
置認識以降は、位置データが認識位置以上になったら全
開状態にセットする。
(N)から全開マージンを差し引き、ステップ(297)に
て、それを全開認識位置として所要のメモリー部に記憶
する。全開マージンは、ドア(2)の開動作移動中、全開
位置と認識して、ドアを停止しても、若干の移動を生じ
るので、その移動量を見込んでマージンをとる。全開位
置認識以降は、位置データが認識位置以上になったら全
開状態にセットする。
【0109】図26は、図17におけるステップ(176)
のスタートモードルーチンの詳細を示すものである。こ
のスタートモードの目的は、各SWのON・OFFや周
囲状況に応じて、ドア(2)を動力駆動させるオートスラ
イド動作のスタートさせるモードを識別し、以下のよう
に制御をする。 全閉以外時にSW操作でスタート………>通常スタート
モード 全閉時にSW操作でスタート……………>ACTRスタ
ートモード 全閉以外時に手動操作でスタート………>手動通常スタ
ートモード 全閉時に手動操作でスタート……………>手動全閉スタ
ートモード スタート別制御を終了すると、スタートモードを解除し
て、作動計数をクリアー(G=0)する。
のスタートモードルーチンの詳細を示すものである。こ
のスタートモードの目的は、各SWのON・OFFや周
囲状況に応じて、ドア(2)を動力駆動させるオートスラ
イド動作のスタートさせるモードを識別し、以下のよう
に制御をする。 全閉以外時にSW操作でスタート………>通常スタート
モード 全閉時にSW操作でスタート……………>ACTRスタ
ートモード 全閉以外時に手動操作でスタート………>手動通常スタ
ートモード 全閉時に手動操作でスタート……………>手動全閉スタ
ートモード スタート別制御を終了すると、スタートモードを解除し
て、作動計数をクリアー(G=0)する。
【0110】ステップ(299)は、ステップ(301)以下の各
ステップで、スタート別の識別子が付与されるのを待っ
て、ステップ(300)で、ステップ(309)の通常スタートモ
ード、ステップ(310)のACTRスタートモード、ステ
ップ(312)の手動スタートモードに制御が渡る。
ステップで、スタート別の識別子が付与されるのを待っ
て、ステップ(300)で、ステップ(309)の通常スタートモ
ード、ステップ(310)のACTRスタートモード、ステ
ップ(312)の手動スタートモードに制御が渡る。
【0111】ステップ(309)をなす通常スタートモード
は、以下のように機能する。ドア全閉領域外でのスター
ト時の制御をする(クラッチ(16)やモータ(14)のO
N)。最初にクラッチ(16)ONにして、モータ(14)とド
ライブプーリ(15)をつなぐ。クラッチ(16)のONタイム
ラグ後に、オートスライド作動可能にセットしてモータ
(14)をONする。モータ(14)がONした時に、作動別ス
タート識別子をリセットし作動別スタート制御の終了を
他のルーチンに知らせる
は、以下のように機能する。ドア全閉領域外でのスター
ト時の制御をする(クラッチ(16)やモータ(14)のO
N)。最初にクラッチ(16)ONにして、モータ(14)とド
ライブプーリ(15)をつなぐ。クラッチ(16)のONタイム
ラグ後に、オートスライド作動可能にセットしてモータ
(14)をONする。モータ(14)がONした時に、作動別ス
タート識別子をリセットし作動別スタート制御の終了を
他のルーチンに知らせる
【0112】ステップ(310)をなすACTRスタートモ
ードは、以下のように機能する。このスタートモード
は、ACTR(35)を介してドアロックのラッチ(8)とス
トライカ(9)との係合を解除した後、ドア(2)を自動駆
動するスタートモード時の制御をする。ハーフラッチS
W(36)がOFFしているのを一定時間確認後、クラッチ
(16)をONにする。クラッチ(16)のONタイムラグ経過
後、オートスライド作動中にする。その後、モータ(14)
のONの時に、作動別スタート識別子をリセットし作動
別スタート制御の終了を他のルーチンに知らせる
ードは、以下のように機能する。このスタートモード
は、ACTR(35)を介してドアロックのラッチ(8)とス
トライカ(9)との係合を解除した後、ドア(2)を自動駆
動するスタートモード時の制御をする。ハーフラッチS
W(36)がOFFしているのを一定時間確認後、クラッチ
(16)をONにする。クラッチ(16)のONタイムラグ経過
後、オートスライド作動中にする。その後、モータ(14)
のONの時に、作動別スタート識別子をリセットし作動
別スタート制御の終了を他のルーチンに知らせる
【0113】図27は、ステップ(312)をなす手動スタ
ートモードルーチンを示すもので、この手動スタートモ
ードは、以下のように機能する。手動スタート操作時の
制御をする。最初にオートスライド作動可能にして、モ
ータ(14)を空転させる。手動判定をして、手動認識OF
F、急閉認識操作のどちらかに判定された場合は、その
場で異常検出にセット。モータ(14)が安定するまでのタ
イムラグ経過時点でクラッチ(16)をONして終了。クラ
ッチ(16)のON時にスタート別モード識別子をリセット
し、スタート別制御の終了を他のルーチンに知らせる。
ートモードルーチンを示すもので、この手動スタートモ
ードは、以下のように機能する。手動スタート操作時の
制御をする。最初にオートスライド作動可能にして、モ
ータ(14)を空転させる。手動判定をして、手動認識OF
F、急閉認識操作のどちらかに判定された場合は、その
場で異常検出にセット。モータ(14)が安定するまでのタ
イムラグ経過時点でクラッチ(16)をONして終了。クラ
ッチ(16)のON時にスタート別モード識別子をリセット
し、スタート別制御の終了を他のルーチンに知らせる。
【0114】前記手動全閉スタートモードは、ドア全閉
状態からの手動スタートの制御をする。最初にオートス
ライド開動作可にして、モータ(14)を空転させる。ハー
フラッチSW(36)がOFFし続けていることを確認し、
かつモータ(14)が安定する時間を経過したら、クラッチ
(16)をONにする。
状態からの手動スタートの制御をする。最初にオートス
ライド開動作可にして、モータ(14)を空転させる。ハー
フラッチSW(36)がOFFし続けていることを確認し、
かつモータ(14)が安定する時間を経過したら、クラッチ
(16)をONにする。
【0115】図10におけるステップ(122)及び図17
のステップ(164)であるストップモードは、以下のよう
に機能する。このストップモードは、前記各オートスラ
イドにおけるドアの開閉及び逆転制御時に、ドア(2)の
動力駆動を停止させた時の安全制御を目的とする。(ク
ラッチ(16)のOFFとモータ(14)のOFFそれぞれのタ
イミングを制御する)。
のステップ(164)であるストップモードは、以下のよう
に機能する。このストップモードは、前記各オートスラ
イドにおけるドアの開閉及び逆転制御時に、ドア(2)の
動力駆動を停止させた時の安全制御を目的とする。(ク
ラッチ(16)のOFFとモータ(14)のOFFそれぞれのタ
イミングを制御する)。
【0116】ドア(2)が全開位置と全閉位置の中間位置
での停止時には、モータ(14)を先に停止させ停止後に所
要の待ち時間をおきクラッチ(16)をOFFにする。ドア
(2)が全閉検出(ハーフON)時は、直ぐにモータ(1
4)、クラッチ(16)同時にOFFする。ストップモード終
了時は、ストップモード状況を解除して、ストップモー
ド終了を他のルーチンに知らせる。
での停止時には、モータ(14)を先に停止させ停止後に所
要の待ち時間をおきクラッチ(16)をOFFにする。ドア
(2)が全閉検出(ハーフON)時は、直ぐにモータ(1
4)、クラッチ(16)同時にOFFする。ストップモード終
了時は、ストップモード状況を解除して、ストップモー
ド終了を他のルーチンに知らせる。
【0117】ステップ(175)のチェック制御は、以下の
ように機能する。ドアの位置、チェックカーの制御状態
により制御を振り分ける。エリア6でのみチェックカー
機構は、機能するようにする。チェックカー制御の開始
は、オートスライド作動中の場合は、ストップモード
(停止処理)終了後に行う。但し、開作動の停止後は、
バックラッシュが有るのでタイムラグを起きチェックカ
ー制御を開始する。電動作動中でない(手動操作時)時
は、ドアが止まった事を確認してチェックカー制御を行
う。チェック維持中は、チェックカー維持用制御へ、チ
ェックカー作動中は、チェックカー作動中制御へいく。
ように機能する。ドアの位置、チェックカーの制御状態
により制御を振り分ける。エリア6でのみチェックカー
機構は、機能するようにする。チェックカー制御の開始
は、オートスライド作動中の場合は、ストップモード
(停止処理)終了後に行う。但し、開作動の停止後は、
バックラッシュが有るのでタイムラグを起きチェックカ
ー制御を開始する。電動作動中でない(手動操作時)時
は、ドアが止まった事を確認してチェックカー制御を行
う。チェック維持中は、チェックカー維持用制御へ、チ
ェックカー作動中は、チェックカー作動中制御へいく。
【0118】図28は、図10におけるステップ(120)
の速度制御ルーチンを示すフローチャートである。この
ステップ(120)の速度制御ルーチンは、ステップ(331)の
PWM制御ルーチンのなかに、ステップ(332)の目標値
の決定、ステップ(333)の適合計算、ステップ(334)のフ
ィードバック調整を含み、ステップ(333)の適合計算
は、ステップ(335)の差計算を、またステップ(334)のフ
ィードバック調整は、ステップ(336)の調整量の算出を
それぞれ含んでいる。このステップ(331)のPWM制御
の詳細なフローチャートは、図31に示してある。
の速度制御ルーチンを示すフローチャートである。この
ステップ(120)の速度制御ルーチンは、ステップ(331)の
PWM制御ルーチンのなかに、ステップ(332)の目標値
の決定、ステップ(333)の適合計算、ステップ(334)のフ
ィードバック調整を含み、ステップ(333)の適合計算
は、ステップ(335)の差計算を、またステップ(334)のフ
ィードバック調整は、ステップ(336)の調整量の算出を
それぞれ含んでいる。このステップ(331)のPWM制御
の詳細なフローチャートは、図31に示してある。
【0119】図29は、ステップ(332)の目標値の決
定、ステップ(333)の適合計算、ステップ(335)の差計
算、ステップ(336)の調整量算出等の各部分の機能をブ
ロック図で示したものである。
定、ステップ(333)の適合計算、ステップ(335)の差計
算、ステップ(336)の調整量算出等の各部分の機能をブ
ロック図で示したものである。
【0120】速度制御は、前記図16に示すドア(2)の
位置に係る各制御領域(E1)〜(E6)に応じて、適正
な制御目標値が定められ、ドア(2)の速度が制御される
ようになっている。
位置に係る各制御領域(E1)〜(E6)に応じて、適正
な制御目標値が定められ、ドア(2)の速度が制御される
ようになっている。
【0121】ドア位置検出部(60)は、前記図12に示す
位置計数パルス(g1)を計数して、位置計数値(N)
を求めるとともに、その値(N)とドア(2)の移動方向
の信号(Z)から、ドア(2)がそのとき存在するエリア
1〜7を制御領域弁別部(61a)が判別する。
位置計数パルス(g1)を計数して、位置計数値(N)
を求めるとともに、その値(N)とドア(2)の移動方向
の信号(Z)から、ドア(2)がそのとき存在するエリア
1〜7を制御領域弁別部(61a)が判別する。
【0122】制御領域弁別部(61a)は、そのエリア1〜
7に基づいて、図16のテーブルにより、各制御領域
(E1)〜(E6)を判別し、その制御領域(E1)〜(E
6)に、それぞれ所要される、ドア(2)の適正移動速
度、実施例では適正移動速度に対応に対応した周期計数
値(T1)〜(T6)の値を求める。
7に基づいて、図16のテーブルにより、各制御領域
(E1)〜(E6)を判別し、その制御領域(E1)〜(E
6)に、それぞれ所要される、ドア(2)の適正移動速
度、実施例では適正移動速度に対応に対応した周期計数
値(T1)〜(T6)の値を求める。
【0123】制御速度選択部(61b)では、制御領域(E
1)〜(E6)に基づいて、その制御領域(E1)〜(E6)
応じた適正の移動速度対応の周期計数値(T0)が1つ
求められるとともに、そのは制御領域(E1)〜(E6)
における、移動速度の最高速度対応の周期計数値(Tmi
n)と、最低速度対応の周期計数値(Tmax)が同時にも
とめられる。
1)〜(E6)に基づいて、その制御領域(E1)〜(E6)
応じた適正の移動速度対応の周期計数値(T0)が1つ
求められるとともに、そのは制御領域(E1)〜(E6)
における、移動速度の最高速度対応の周期計数値(Tmi
n)と、最低速度対応の周期計数値(Tmax)が同時にも
とめられる。
【0124】なお、ドア(2)の移動速度は、周期計数値
(T)の逆数(1/T)として容易に求められるととも
に、周期計数値(T)そのものの数値であっても、数値
の大小関係は逆にはなるが、速度対応値には変わりがな
いので、以下の説明においては周期計数値(T)をドア
(2)の移動速度を表す値として使用する。
(T)の逆数(1/T)として容易に求められるととも
に、周期計数値(T)そのものの数値であっても、数値
の大小関係は逆にはなるが、速度対応値には変わりがな
いので、以下の説明においては周期計数値(T)をドア
(2)の移動速度を表す値として使用する。
【0125】例えば、制御領域(E1)〜(E6)応じた
適正の移動速度対応の周期計数値(T0)を、適正移動
速度値(T0)、制御領域(E1)〜(E6)における、移
動速度の最高速度対応の周期計数値(Tmin)を、最高
速度値(Tmin)、同じく最低速度対応の周期計数値
(Tmax)を、最低速度値(Tmax)とする。また、適正
移動速度値(T0)であって、各制御領域(E1)〜(E
6)に対応したものを、各領域(E1)〜(E6)の適正移
動速度値(T1)〜(T6)とする。
適正の移動速度対応の周期計数値(T0)を、適正移動
速度値(T0)、制御領域(E1)〜(E6)における、移
動速度の最高速度対応の周期計数値(Tmin)を、最高
速度値(Tmin)、同じく最低速度対応の周期計数値
(Tmax)を、最低速度値(Tmax)とする。また、適正
移動速度値(T0)であって、各制御領域(E1)〜(E
6)に対応したものを、各領域(E1)〜(E6)の適正移
動速度値(T1)〜(T6)とする。
【0126】上記制御領域弁別部(61a)と制御速度選択
部(61b)は、図28のステップ(332)、及び図31のステ
ップ(339)の機能を達成している。
部(61b)は、図28のステップ(332)、及び図31のステ
ップ(339)の機能を達成している。
【0127】制御速度選択部(61b)で求められた各領域
の適正移動速度値(T0=T1〜T6)は、調整量算出部
(62)に送られる。調整量算出部(62)で求められたフード
バックの調整量(R)は、調整量の上限値を設定する最
大調整量制限部(63)に送られる。
の適正移動速度値(T0=T1〜T6)は、調整量算出部
(62)に送られる。調整量算出部(62)で求められたフード
バックの調整量(R)は、調整量の上限値を設定する最
大調整量制限部(63)に送られる。
【0128】上記調整量算出部(62)と最大調整量制限部
(63)は、図28のステップ(336)の調整量の算出、及び
図32におけるステップ(357)、ステップ(368)の調整量
の算出機能を有する部分である。
(63)は、図28のステップ(336)の調整量の算出、及び
図32におけるステップ(357)、ステップ(368)の調整量
の算出機能を有する部分である。
【0129】(64)は、ドア移動速度検出部で、前記図1
0におけるステップ(135)のパルスカウントタイマーに
相当し、割り込みパルス(g1)に基づいて、クロック
パルス(C1)を計数して、その時点の周期計数値(T
x)を求めている。なお、ドア(2)の移動速度に係る周
期係数値(Tx)を表す場合、それを移動速度値(Tx)
とする。
0におけるステップ(135)のパルスカウントタイマーに
相当し、割り込みパルス(g1)に基づいて、クロック
パルス(C1)を計数して、その時点の周期計数値(T
x)を求めている。なお、ドア(2)の移動速度に係る周
期係数値(Tx)を表す場合、それを移動速度値(Tx)
とする。
【0130】この移動速度値(Tx)は、前記図28の
ステップ(333)をなす適合計算ルーチン及び図31のス
テップ(341)の適合度計算ルーチンに相当する速すぎ検
出部(65)と遅すぎ検出部(66)に入力される。
ステップ(333)をなす適合計算ルーチン及び図31のス
テップ(341)の適合度計算ルーチンに相当する速すぎ検
出部(65)と遅すぎ検出部(66)に入力される。
【0131】速すぎ検出部(65)と遅すぎ検出部(66)に
は、前記制御速度選択部(61b)で求められた、ドア(2)
のある制御領域の適正速度値(T0)対応の最高速度値
(Tmin)と最低速度値(Tmax)がそれぞれ入力されて
いる。速すぎ検出部(65)には最高速度値(Tmin)が、
遅すぎ検出部(66)には最低速度値(Tmax)が入力して
いる。
は、前記制御速度選択部(61b)で求められた、ドア(2)
のある制御領域の適正速度値(T0)対応の最高速度値
(Tmin)と最低速度値(Tmax)がそれぞれ入力されて
いる。速すぎ検出部(65)には最高速度値(Tmin)が、
遅すぎ検出部(66)には最低速度値(Tmax)が入力して
いる。
【0132】速すぎ検出部(65)は、現在の移動速度値
(Tx)から最高速度値(Tmin)を、差計算部(65a)に
より減算して、速すぎ量(TH)を求め、それを2段の
シフトレジスタ等による一時保留部(65b)(65c)に送込
む。
(Tx)から最高速度値(Tmin)を、差計算部(65a)に
より減算して、速すぎ量(TH)を求め、それを2段の
シフトレジスタ等による一時保留部(65b)(65c)に送込
む。
【0133】一時保留部(65b)(65c)における前段のもの
には、抽出時期が1つ前の速すぎ量(TH2)を、後段の
ものには現時点、もしくは前段の抽出時期に連続した1
つ後の速すぎ量(TH1)を保留し、その量速すぎ量(T
H1)(TH2)は、修正量演算部(65d)により加算されて
速すぎ適合差(JNH)が出力される。
には、抽出時期が1つ前の速すぎ量(TH2)を、後段の
ものには現時点、もしくは前段の抽出時期に連続した1
つ後の速すぎ量(TH1)を保留し、その量速すぎ量(T
H1)(TH2)は、修正量演算部(65d)により加算されて
速すぎ適合差(JNH)が出力される。
【0134】同様に、遅すぎ検出部(66)は、現在の移動
速度値(Tx)から最低速度値(Tmax)を、差計算部(6
6a)により減算して、遅すぎ量(TL)を求め、それを2
段のシフトレジスタ等による一時保留部(66b)(66c)に送
込む。上記差計算部(65a)(66b)は、図28におけるステ
ップ(335)の差計算ルーチンに相当している。
速度値(Tx)から最低速度値(Tmax)を、差計算部(6
6a)により減算して、遅すぎ量(TL)を求め、それを2
段のシフトレジスタ等による一時保留部(66b)(66c)に送
込む。上記差計算部(65a)(66b)は、図28におけるステ
ップ(335)の差計算ルーチンに相当している。
【0135】一時保留部(66b)(66c)における前段のもの
には、抽出時期が1つ前の遅すぎ量(TL2)を、後段の
ものには現時点、もしくは前段の抽出時期に連続した1
つ後の遅すぎ量(TL1)を保留し、その量遅すぎ量(T
L1)(TL2)は、修正量演算部(66d)により加算されて
遅すぎ適合差(JNL)が出力される。
には、抽出時期が1つ前の遅すぎ量(TL2)を、後段の
ものには現時点、もしくは前段の抽出時期に連続した1
つ後の遅すぎ量(TL1)を保留し、その量遅すぎ量(T
L1)(TL2)は、修正量演算部(66d)により加算されて
遅すぎ適合差(JNL)が出力される。
【0136】速すぎ及び遅すぎの一時保留部(65b)(65c)
及び(66b)(66c)は、差計算部(65a)(66a)において現在の
移動速度値(Tx)が最高速度値(Tmin)もしくは最低
速度(Tmax)に対して、速すぎるのか、又は、遅すぎ
るのか、を判別するようにした速度判別部(65e)(66e)に
より、速すぎもしくは遅すぎないときは、この一時保留
部(65b)(65c)及び(66b)(66c)の保留内容を零にリセット
する。
及び(66b)(66c)は、差計算部(65a)(66a)において現在の
移動速度値(Tx)が最高速度値(Tmin)もしくは最低
速度(Tmax)に対して、速すぎるのか、又は、遅すぎ
るのか、を判別するようにした速度判別部(65e)(66e)に
より、速すぎもしくは遅すぎないときは、この一時保留
部(65b)(65c)及び(66b)(66c)の保留内容を零にリセット
する。
【0137】これにより、修正量演算部(65d)(66d)に速
すぎ量(TH1)(TH2)もしくは遅すぎ量(TL1)(T
L2)が2つ揃って引き渡されるには、速すぎもしくは遅
すぎが2度引き続いて生じなければならない。
すぎ量(TH1)(TH2)もしくは遅すぎ量(TL1)(T
L2)が2つ揃って引き渡されるには、速すぎもしくは遅
すぎが2度引き続いて生じなければならない。
【0138】速すぎ検出部(66)から出力される速すぎ適
合差(JNH)、及び速すぎ検出部(66)から出力される遅
すぎ適合差(JNL)は、フィードバック調整部(67)に送
られるとともに、前記調整量算出部(62)にも送られ、調
整量算出部(62)では、速すぎ及び遅すぎの両適合差(J
NH)(JNL)は、まとめて適合差(JN)として扱われ
る。
合差(JNH)、及び速すぎ検出部(66)から出力される遅
すぎ適合差(JNL)は、フィードバック調整部(67)に送
られるとともに、前記調整量算出部(62)にも送られ、調
整量算出部(62)では、速すぎ及び遅すぎの両適合差(J
NH)(JNL)は、まとめて適合差(JN)として扱われ
る。
【0139】調整量算出部(62)は、制御速度選択部(61
b)で得られた適正移動速度値(T0)を識別子として、
調整量(R)の算出式が選択される。例えば、適正移動
速度(T0)が(Ta)ならば調整量(R)は3倍の適合
差(JN)とする(T0=Ta ならば R=3JN)。 以下同様に、 T0=Tb ならば R=2JN 又
は(R=aJN) T0=Tc ならば R= JN 又は(R=bJN) T0≠Ta,Tb,Tc、 ならば R=3JN 又は(R=
cJN) ただし、Ta,Tb,Tc、は任意の大きさの値でよいが、
実質的は図16に示す注目度の高い領域や危険領域に設
定されている適正移動速度応じているのが好ましい。さ
らに、調整量(R)の算出式の一般式の倍率係数(a、
b、c)は、ドアの移動軌跡の曲線部や直線部等に応じ
て、フィードバック制御に適する所要の値を設定する。
b)で得られた適正移動速度値(T0)を識別子として、
調整量(R)の算出式が選択される。例えば、適正移動
速度(T0)が(Ta)ならば調整量(R)は3倍の適合
差(JN)とする(T0=Ta ならば R=3JN)。 以下同様に、 T0=Tb ならば R=2JN 又
は(R=aJN) T0=Tc ならば R= JN 又は(R=bJN) T0≠Ta,Tb,Tc、 ならば R=3JN 又は(R=
cJN) ただし、Ta,Tb,Tc、は任意の大きさの値でよいが、
実質的は図16に示す注目度の高い領域や危険領域に設
定されている適正移動速度応じているのが好ましい。さ
らに、調整量(R)の算出式の一般式の倍率係数(a、
b、c)は、ドアの移動軌跡の曲線部や直線部等に応じ
て、フィードバック制御に適する所要の値を設定する。
【0140】調整量(R)は、最大調整量制限部(63)に
おいて調整量(R)の上限値が制限されるとともに、調
整量(R)は、後述するデユーテイの値(D)に変換さ
れ、そのデユーテイ値(D)は、フィードバック調整部
(67)に入力される。
おいて調整量(R)の上限値が制限されるとともに、調
整量(R)は、後述するデユーテイの値(D)に変換さ
れ、そのデユーテイ値(D)は、フィードバック調整部
(67)に入力される。
【0141】ドア(2)を駆動するモータ(14)は、出力ト
ルクの調整に、PWM制御と称される制御手段が採用さ
れている。PWM制御は、モータに印加する電圧波形を
矩形波として、その矩形波のデユーテイサイクルを変化
することにより、モータの出力トルクを調整している。
しかし、出力トルクはモータに印加する矩形波の電圧に
よっても変動するため、モータの出力トルクを精密に制
御するには矩形波の電圧変動分をデユーテイサイクルに
考慮して制御する必要がある。
ルクの調整に、PWM制御と称される制御手段が採用さ
れている。PWM制御は、モータに印加する電圧波形を
矩形波として、その矩形波のデユーテイサイクルを変化
することにより、モータの出力トルクを調整している。
しかし、出力トルクはモータに印加する矩形波の電圧に
よっても変動するため、モータの出力トルクを精密に制
御するには矩形波の電圧変動分をデユーテイサイクルに
考慮して制御する必要がある。
【0142】図30は、モータに流れる電流を一定とし
たときの電圧変動とデユーテイサイクル(以下の説明に
おいては、デユーテイと略称するとともに、フローチャ
ートにおてはDUTEと略称する)(D)の関係を示す
グラフである。
たときの電圧変動とデユーテイサイクル(以下の説明に
おいては、デユーテイと略称するとともに、フローチャ
ートにおてはDUTEと略称する)(D)の関係を示す
グラフである。
【0143】車両用のバッテリー(24)は、最大電圧(V
max)を16V、最小電圧(Vmin)を9Vとする、その
間の電圧を自在に変動しているものとすることができ
る。電源電圧検出部(68)は、バッテリー(24)の電圧(V
x)を計測している。この電圧(Vx)のときに、所要電
圧相当(V0)のデユーテイ(D0)を求めるのがデユー
テイ演算部(69)である。
max)を16V、最小電圧(Vmin)を9Vとする、その
間の電圧を自在に変動しているものとすることができ
る。電源電圧検出部(68)は、バッテリー(24)の電圧(V
x)を計測している。この電圧(Vx)のときに、所要電
圧相当(V0)のデユーテイ(D0)を求めるのがデユー
テイ演算部(69)である。
【0144】所要電圧(V0)相当のデユーテイ(D0)
とは、デユーテイ100%(Dmax)の電圧波形、すな
わち所要直流電圧(V0)を印加したときの出力トルク
と、その直流電圧より高い任意の電圧(Vx)を印加し
て、同じ出力トルクを得るためのデユーテイ(D0)の
ことで、次の式で表される(図30参照)。 D0=(V0/Vx)・Dmax ただし、モータに流れる電流値は一定としている。
とは、デユーテイ100%(Dmax)の電圧波形、すな
わち所要直流電圧(V0)を印加したときの出力トルク
と、その直流電圧より高い任意の電圧(Vx)を印加し
て、同じ出力トルクを得るためのデユーテイ(D0)の
ことで、次の式で表される(図30参照)。 D0=(V0/Vx)・Dmax ただし、モータに流れる電流値は一定としている。
【0145】デユーテイ演算部(69)は、バッテリー(24)
の電圧変動を、電源電圧検出部(68)が測定電圧(Vx)
として検出し、その電圧(Vx)と所要電圧(V0)から
上記計算式に基づいて、所要電圧(V0)相当のデユー
テイ(D0)を求める。
の電圧変動を、電源電圧検出部(68)が測定電圧(Vx)
として検出し、その電圧(Vx)と所要電圧(V0)から
上記計算式に基づいて、所要電圧(V0)相当のデユー
テイ(D0)を求める。
【0146】さらに、デユーテイ演算部(69)では、所要
電圧(V0)より、上方または下方に1V(ボルト)変
化したときの、デユーテイの変化量を求めて、これを1
V相当デユーテイ(D1)として、求めている。所要電
圧(V0)相当のデユーテイ(D0)と1V相当デユーテ
イ(D1)は、フィードバック調整部(67)に入力してい
る。
電圧(V0)より、上方または下方に1V(ボルト)変
化したときの、デユーテイの変化量を求めて、これを1
V相当デユーテイ(D1)として、求めている。所要電
圧(V0)相当のデユーテイ(D0)と1V相当デユーテ
イ(D1)は、フィードバック調整部(67)に入力してい
る。
【0147】上記デユーテイ演算部(69)は、電流の変化
分を含まない1次の計算式で求めているが、電流の変化
分やモータの負荷特性を含めて、電源電圧変動に対する
デユーテイ(D)の修正値(D’)を、予めメモリーマ
ップにしておいて、電源電圧(Vx)でアドレスして求
めることもできる。
分を含まない1次の計算式で求めているが、電流の変化
分やモータの負荷特性を含めて、電源電圧変動に対する
デユーテイ(D)の修正値(D’)を、予めメモリーマ
ップにしておいて、電源電圧(Vx)でアドレスして求
めることもできる。
【0148】図31は、図28に示すステップ(331)の
PWM制御の詳細を示すものである。PWM制御ルーチ
ンは、エリア毎に定められた目標速度に一致するよう
に、電圧をPWM制御にてデューテイ(D)を調整す
る。目標速度が求まってない時は、速度制御をクリアし
て、エリアに設定された目標速度とDUTYを求める。
PWM制御の詳細を示すものである。PWM制御ルーチ
ンは、エリア毎に定められた目標速度に一致するよう
に、電圧をPWM制御にてデューテイ(D)を調整す
る。目標速度が求まってない時は、速度制御をクリアし
て、エリアに設定された目標速度とDUTYを求める。
【0149】エリア変化時は、変化したエリアに設定さ
せた目標速度を求める。速度に対するDUTYの調整間
隔(フィードバック)は、機構部の遅れがあるため、エ
リア毎に定められた間隔より短くならないようにする。
せた目標速度を求める。速度に対するDUTYの調整間
隔(フィードバック)は、機構部の遅れがあるため、エ
リア毎に定められた間隔より短くならないようにする。
【0150】図32は、図28に示すステップ(349)の
フィードバック調整ルーチンの詳細を示すものである。
このフィードバック調整ルーチンは、2回以上連続で遅
すぎるか、速すぎたときに目標の速度になるように、P
WMのDUTY調整を行う。低速、高速バッファーの2
個目のバッファーにデータがあるか調べ(2個以上連続
で遅すぎたか、速すぎたか調べる)、有る場合は、バッ
ファーのデータを加算し、アンマッチ量を求める。
フィードバック調整ルーチンの詳細を示すものである。
このフィードバック調整ルーチンは、2回以上連続で遅
すぎるか、速すぎたときに目標の速度になるように、P
WMのDUTY調整を行う。低速、高速バッファーの2
個目のバッファーにデータがあるか調べ(2個以上連続
で遅すぎたか、速すぎたか調べる)、有る場合は、バッ
ファーのデータを加算し、アンマッチ量を求める。
【0151】図33は、図10に示すステップ(118)の
挟み込み判定ルーチンのフローを示すものである。図3
4は、図33に示すステップ(373)の挟み込み判定ルー
チンの詳細を示すものである。
挟み込み判定ルーチンのフローを示すものである。図3
4は、図33に示すステップ(373)の挟み込み判定ルー
チンの詳細を示すものである。
【0152】図35は、図33の挟み込み判定ルーチン
の機能をブロック図で示すもので、このブロック図に基
づいて構成を説明する。
の機能をブロック図で示すもので、このブロック図に基
づいて構成を説明する。
【0153】ドア(2)の位置検出部(60)は、前述の如
く、図12に示す位置計数パルス(φ1)(割り込みパ
ルス(g1)と同じ)を、ドアの全閉位置を基準位置と
して、ドアの移動方向のデータ(Z)に基づいて、開方
向なら順次増計数し、閉方向なら順次減計数して、位置
計数値(N)を求めるものである。
く、図12に示す位置計数パルス(φ1)(割り込みパ
ルス(g1)と同じ)を、ドアの全閉位置を基準位置と
して、ドアの移動方向のデータ(Z)に基づいて、開方
向なら順次増計数し、閉方向なら順次減計数して、位置
計数値(N)を求めるものである。
【0154】サンプリング領域演算部(70)は、図16に
示す如く、位置計数パルス(φ1)を、エリア1〜エリ
ア7に定められた分解能(B)に応じて、間引いて計数
し、その計数値(n)(m)基づき、サンプリング領域
(Q)のアドレスを定めものである。
示す如く、位置計数パルス(φ1)を、エリア1〜エリ
ア7に定められた分解能(B)に応じて、間引いて計数
し、その計数値(n)(m)基づき、サンプリング領域
(Q)のアドレスを定めものである。
【0155】サンプリング領域(Q)は、上記分解能
(B)に応じて、閉方向に間引き計数された計数値
(n)、開方向に間引き計数された計数値(m)により
アドレス指定され、そのアドレスを持つサンプリング領
域は(Qn)(Qm)と表す。上記計数値(n)(m)を
単独で使用する場合は、アドレス番号(n)(m)とす
る。
(B)に応じて、閉方向に間引き計数された計数値
(n)、開方向に間引き計数された計数値(m)により
アドレス指定され、そのアドレスを持つサンプリング領
域は(Qn)(Qm)と表す。上記計数値(n)(m)を
単独で使用する場合は、アドレス番号(n)(m)とす
る。
【0156】アドレス番号(n)(m)と分解能
(B)、および位置計数値(N)の関係は、次のように
表される。 N/B=n+b 又は N/B=m+b n、mは商の整数部、bは商の余り 分解能(B)は、比較的注目度の低い通常制御領域(E
1)のエリア1とエリア6、リンク減速制御領域(E5)
のエリア5は、間引き幅の広い分解能(B=8)に設定
してある。
(B)、および位置計数値(N)の関係は、次のように
表される。 N/B=n+b 又は N/B=m+b n、mは商の整数部、bは商の余り 分解能(B)は、比較的注目度の低い通常制御領域(E
1)のエリア1とエリア6、リンク減速制御領域(E5)
のエリア5は、間引き幅の広い分解能(B=8)に設定
してある。
【0157】減速制御領域(E2)のエリア2は、挟み
込みの発生し易い、注目度は危険領域であるが、まだド
アの開度が十分にあるエリアなので、分解能は(B=
4)に設定してある。リンク減速制御領域(E3)のエ
リア3と、締め込み制御領域(E4)は、ドア(2)が曲
線を描いて移動し、かつ注目度の最も高い危険領域なの
で、分解能は最も細かい(B=2)に設定してある。
込みの発生し易い、注目度は危険領域であるが、まだド
アの開度が十分にあるエリアなので、分解能は(B=
4)に設定してある。リンク減速制御領域(E3)のエ
リア3と、締め込み制御領域(E4)は、ドア(2)が曲
線を描いて移動し、かつ注目度の最も高い危険領域なの
で、分解能は最も細かい(B=2)に設定してある。
【0158】上記分解能(B)に基づいてサンプリング
領域(Qn)(Qm)を、各制御領域(E1)〜(E6)毎
にアドレス指定したのが図12に示してある。
領域(Qn)(Qm)を、各制御領域(E1)〜(E6)毎
にアドレス指定したのが図12に示してある。
【0159】(71)は、負荷サンプルデータメモリで、サ
ンプリング演算部(70)から送られるアドレス番号(n)
(m)により、読み書きのアドレスが指定される。
ンプリング演算部(70)から送られるアドレス番号(n)
(m)により、読み書きのアドレスが指定される。
【0160】(72)は、サンプリング領域(Qn)(Qm)
に対応したドア(2)の負荷データ演算部で、サンプリン
グ領域演算部(70)からは、位置計数値と分解能の商(N
/B)の余り(b)が入力している。
に対応したドア(2)の負荷データ演算部で、サンプリン
グ領域演算部(70)からは、位置計数値と分解能の商(N
/B)の余り(b)が入力している。
【0161】負荷データ演算部(72)においては、メイン
ルーチンのステップ(103)における電流計測部(73)によ
って、一定インターバル毎に計測された加算平均電流値
が、位置計数値(N)を得る毎に計測されたモータ(14)
の電流値(IN)として、分解能(B)と同じ段数のシ
フトレジスタ(74)に順次取り込まれて、図36に示すよ
うに、各サンプリング領域(Qn)毎に、位置計数値
(N)対応電流値(IN)の加算平均値(IAn)を計算
している。
ルーチンのステップ(103)における電流計測部(73)によ
って、一定インターバル毎に計測された加算平均電流値
が、位置計数値(N)を得る毎に計測されたモータ(14)
の電流値(IN)として、分解能(B)と同じ段数のシ
フトレジスタ(74)に順次取り込まれて、図36に示すよ
うに、各サンプリング領域(Qn)毎に、位置計数値
(N)対応電流値(IN)の加算平均値(IAn)を計算
している。
【0162】負荷データ演算部(74)は、記憶用学習デー
タ演算部(75)に、平均電流値(IAn)を送り込んでい
る。
タ演算部(75)に、平均電流値(IAn)を送り込んでい
る。
【0163】負荷サンプルデータメモリ(71)は、書き込
みデータ(DL)を記憶用学習データ演算部(75)から受
け取り、読み出しデータ(DR)を、予測比較値演算部
(76)に渡している。このデータの読み書きのアドレス
は、前記サンプリング領域(Qn)(Qm)のアドレス番
号(n)(m)である。
みデータ(DL)を記憶用学習データ演算部(75)から受
け取り、読み出しデータ(DR)を、予測比較値演算部
(76)に渡している。このデータの読み書きのアドレス
は、前記サンプリング領域(Qn)(Qm)のアドレス番
号(n)(m)である。
【0164】上記予測比較値演算部(76)は、図37のブ
ロック図に詳細に示す如く、予測値レジスタ(77)と、閾
値計算部(78)と比較値計算部(79)と予測比較値遅延レジ
スタ(80)を具備している。
ロック図に詳細に示す如く、予測値レジスタ(77)と、閾
値計算部(78)と比較値計算部(79)と予測比較値遅延レジ
スタ(80)を具備している。
【0165】また、前記記憶用学習データ演算部(75)
は、図38のブロック図に詳細を示す如く、電流増加率
演算部(81)と、直前値データ保留レジスタ(82)と、学習
データ遅延シフトレジスタ(83)と、学習値重み付け更新
演算部(84)を備えている。
は、図38のブロック図に詳細を示す如く、電流増加率
演算部(81)と、直前値データ保留レジスタ(82)と、学習
データ遅延シフトレジスタ(83)と、学習値重み付け更新
演算部(84)を備えている。
【0166】電流計測部(73)が計測した電流値(IN)
は、挟み込み判定部(85)に送られるとともに、前回電流
値メモリ部(86)と、変化量算出部(87)と、電流増加回数
計数部(88)にも送られている。
は、挟み込み判定部(85)に送られるとともに、前回電流
値メモリ部(86)と、変化量算出部(87)と、電流増加回数
計数部(88)にも送られている。
【0167】挟み込み判定部(85)には、変化量検出部(8
7)が出力する電流増加値(ΔI)と、電流増加回数計数
部(88)が出力する増加回数値(K)が送られるととも
に、前記図10におけるステップ(123)、及び後述する
図44の坂道判定ルーチンによる坂道検出部(89)の傾斜
判定データ(θ)が送り込まれている。
7)が出力する電流増加値(ΔI)と、電流増加回数計数
部(88)が出力する増加回数値(K)が送られるととも
に、前記図10におけるステップ(123)、及び後述する
図44の坂道判定ルーチンによる坂道検出部(89)の傾斜
判定データ(θ)が送り込まれている。
【0168】上記図35〜図38に示すブロック図は、
図33及び図34に示す挟み込み判定ルーチンと処理機
能が対応している。なお、図33におけるステップ(38
0)の平均値算出ルーチンは、図35の負荷データ演算部
(72)と電流記憶レジスタ(74)に、処理機能が対応してい
る。
図33及び図34に示す挟み込み判定ルーチンと処理機
能が対応している。なお、図33におけるステップ(38
0)の平均値算出ルーチンは、図35の負荷データ演算部
(72)と電流記憶レジスタ(74)に、処理機能が対応してい
る。
【0169】同じく、ステップ(381)の比較値生成ルー
チンと、ステップ(384)の比較値計算ルーチンは、図3
7の予測値算出部(76)に処理機能が対応している。
チンと、ステップ(384)の比較値計算ルーチンは、図3
7の予測値算出部(76)に処理機能が対応している。
【0170】同じく、ステップ(382)の学習処理のルー
チンと、ステップ(383)の学習遅延処理のルーチンは、
図38の記憶用学習データ演算部(75)に処理機能が対応
している。
チンと、ステップ(383)の学習遅延処理のルーチンは、
図38の記憶用学習データ演算部(75)に処理機能が対応
している。
【0171】同じく、ステップ(375)の継続&変化量ル
ーチンは、図42に詳細なフローチャートとして示され
てもいるが、図35において、前回値メモリ部(86)と変
化量算出部(87)と電流増加回数計数部(88)に処理機能が
対応している。
ーチンは、図42に詳細なフローチャートとして示され
てもいるが、図35において、前回値メモリ部(86)と変
化量算出部(87)と電流増加回数計数部(88)に処理機能が
対応している。
【0172】上記構成の挟み込み判定においては、ドア
(2)の開閉に係る標準の負荷抵抗成分(その変化率を含
む)を、ドア駆動モータ(14)に流れる電流値(IN)に
基づき抽出し、その負荷抵抗成分を、ドアの開閉状況と
ドア位置とに固有するサンプリング領域(Qn)(Qm)
を定めて、そのサンプリング領域(Qn)(Qm)に対応
させて、メモリに記憶させておき、通常のドア(2)の開
閉に際して、同一サンプリング領域(Qn)(Qm)の記
憶された標準の負荷抵抗成分と、現在の負荷抵抗成分と
を比較して、挟み込みの有無を検出するようにしてい
る。
(2)の開閉に係る標準の負荷抵抗成分(その変化率を含
む)を、ドア駆動モータ(14)に流れる電流値(IN)に
基づき抽出し、その負荷抵抗成分を、ドアの開閉状況と
ドア位置とに固有するサンプリング領域(Qn)(Qm)
を定めて、そのサンプリング領域(Qn)(Qm)に対応
させて、メモリに記憶させておき、通常のドア(2)の開
閉に際して、同一サンプリング領域(Qn)(Qm)の記
憶された標準の負荷抵抗成分と、現在の負荷抵抗成分と
を比較して、挟み込みの有無を検出するようにしてい
る。
【0173】サンプリング領域(Qn)(Qm)に応じて
記憶される負荷抵抗成分は、ドア(2)の開閉操作がある
毎に、新たな負荷抵抗成分に基づいて、予め記憶させた
負荷抵抗成分に修正を加えて学習更新される。
記憶される負荷抵抗成分は、ドア(2)の開閉操作がある
毎に、新たな負荷抵抗成分に基づいて、予め記憶させた
負荷抵抗成分に修正を加えて学習更新される。
【0174】図36は、上記サンプリング領域(Qn)
(Qm)に応じて記憶される負荷抵抗成分、実施例にお
いては、負荷抵抗成分の変化率の抽出要領の一例を示す
ものである。なお、以下の説明において、ドア(2)の開
閉状況は、エリア2の減速制御領域(E2)で分解能
(B=4)とし、かつ注目するサンプリング領域(Q
n)と1つ後のサンプリング領域(Qn-1)における、各
位置計数パルス(φ1)毎の(Nに対応している)各電
流値(IN)を示している。
(Qm)に応じて記憶される負荷抵抗成分、実施例にお
いては、負荷抵抗成分の変化率の抽出要領の一例を示す
ものである。なお、以下の説明において、ドア(2)の開
閉状況は、エリア2の減速制御領域(E2)で分解能
(B=4)とし、かつ注目するサンプリング領域(Q
n)と1つ後のサンプリング領域(Qn-1)における、各
位置計数パルス(φ1)毎の(Nに対応している)各電
流値(IN)を示している。
【0175】1つのサンプリング領域(Qn)について
記憶される負荷抵抗成分は、そのサンプリング領域(Q
n)の中に分解能の数(B=4)個だけ含まれる電流値
(IN)の平均値(IAn)による、前後のサンプリング
領域(Qn)(Qn+1)間の電流増加率(ΔIAn=IAn/
IAn+1)で対応している。
記憶される負荷抵抗成分は、そのサンプリング領域(Q
n)の中に分解能の数(B=4)個だけ含まれる電流値
(IN)の平均値(IAn)による、前後のサンプリング
領域(Qn)(Qn+1)間の電流増加率(ΔIAn=IAn/
IAn+1)で対応している。
【0176】サンプル領域演算部(70)は、位置計数値
(N)を分解能(B)で除算した商の整数部をアドレス
番号(n)と、商の余り(b)を生成して、アドレス番
号(n)は、負荷サンプルデータメモリ(71)をアドレス
指定し、余り(b)は、負荷データ演算部(72)におい
て、分解能(B)の数と同じ数のレジスタを備えた電流
値記憶レジスタ(74)のデータシフトを制御している。
(N)を分解能(B)で除算した商の整数部をアドレス
番号(n)と、商の余り(b)を生成して、アドレス番
号(n)は、負荷サンプルデータメモリ(71)をアドレス
指定し、余り(b)は、負荷データ演算部(72)におい
て、分解能(B)の数と同じ数のレジスタを備えた電流
値記憶レジスタ(74)のデータシフトを制御している。
【0177】負荷データ演算部(72)は、余り(b)の順
に、記憶値レジスタ(74)から順次送られてくる電流値
(IN)〜(IN-3)を順次に加算平均して、平均電流
(IAn)を求め、記憶用学習データ演算部(75)に送る。
に、記憶値レジスタ(74)から順次送られてくる電流値
(IN)〜(IN-3)を順次に加算平均して、平均電流
(IAn)を求め、記憶用学習データ演算部(75)に送る。
【0178】図36は、後述する学習効果を考慮しない
状態の、同一サンプリング領域(Qn)(Qn-1)におけ
る前回の記憶した平均電流(I'An)(I'An-1)と今回
求められた現在の平均電流(IAn)(IAn-1)を表して
いる。
状態の、同一サンプリング領域(Qn)(Qn-1)におけ
る前回の記憶した平均電流(I'An)(I'An-1)と今回
求められた現在の平均電流(IAn)(IAn-1)を表して
いる。
【0179】初期状態においては、負荷サンプルデータ
メモリ(71)の記憶内容は、車体(1)を、前後左右に傾き
のない平坦な場所置て、平常姿勢となしておき、この平
常姿勢においてドア(2)を開閉させて、各エリア毎のサ
ンプル領域(Qn)(Qm)の平均電流値(IAn)(IA
m)を、図36の前回動作の状態と同様に求める。
メモリ(71)の記憶内容は、車体(1)を、前後左右に傾き
のない平坦な場所置て、平常姿勢となしておき、この平
常姿勢においてドア(2)を開閉させて、各エリア毎のサ
ンプル領域(Qn)(Qm)の平均電流値(IAn)(IA
m)を、図36の前回動作の状態と同様に求める。
【0180】この初期状態においては、記憶用学習デー
タ演算部(75)を、現在の平均電流値(IAn)又は(IA
m)が直前の平均電流値(IAn+1)又は(IAm-1)より
大なる(IAn>IAn+1)又は(IAm>IAm-1) とき、
現在の平均電流値(IAn)又は(IAm)と直前の平均電
流値(IAn+1)又は(IAm-1)の比からなる、電流増加
率(ΔIAn=IAn/IAn+1)又は(ΔIAm=IAm/IAm
-1)を求め、この電流増加率(ΔIAn)又は(ΔIAm)
は、学習データ遅延シフトレジスタ(83)から学習値重み
付け更新演算部(84)を素通りして、負荷サンプルデータ
メモリ(71)の書き込みデータ(DL)として送り込まれる
とともに、そのデータが記録されるアドレスは、サンプ
リング領域演算部(70)で得られる、その平均電流値(I
An)又は(IAm)を求めたサンプル領域データ(Qn)
又は(Qm)のアドレス番号(n)又は(m)で指定さ
れる。
タ演算部(75)を、現在の平均電流値(IAn)又は(IA
m)が直前の平均電流値(IAn+1)又は(IAm-1)より
大なる(IAn>IAn+1)又は(IAm>IAm-1) とき、
現在の平均電流値(IAn)又は(IAm)と直前の平均電
流値(IAn+1)又は(IAm-1)の比からなる、電流増加
率(ΔIAn=IAn/IAn+1)又は(ΔIAm=IAm/IAm
-1)を求め、この電流増加率(ΔIAn)又は(ΔIAm)
は、学習データ遅延シフトレジスタ(83)から学習値重み
付け更新演算部(84)を素通りして、負荷サンプルデータ
メモリ(71)の書き込みデータ(DL)として送り込まれる
とともに、そのデータが記録されるアドレスは、サンプ
リング領域演算部(70)で得られる、その平均電流値(I
An)又は(IAm)を求めたサンプル領域データ(Qn)
又は(Qm)のアドレス番号(n)又は(m)で指定さ
れる。
【0181】負荷サンプルデータメモリ(71)は、サンプ
リング領域演算部(70)からのアドレス番号(n)又は
(m)で指定されるサンプル領域(Qn)又は(Qm)の
記憶データをなす平均電流値(IAn)(IAm)を予測比
較値演算部(76)へ送り出すとともに、記憶用学習データ
演算部(75)へも送り出している。
リング領域演算部(70)からのアドレス番号(n)又は
(m)で指定されるサンプル領域(Qn)又は(Qm)の
記憶データをなす平均電流値(IAn)(IAm)を予測比
較値演算部(76)へ送り出すとともに、記憶用学習データ
演算部(75)へも送り出している。
【0182】なお、以下の説明において、負荷サンプル
データメモリ(71)からの読み出しデータ、即ち記憶され
たデータを表記するには、本来ストアされている平均電
流値(I'An)をもって表すのではなく、アドレス指定
されたサンプリング領域(Qn)の方で表記し、演算等
は、そのサンプリング領域(Qn)のアドレス番号
(n)で指定されロケーションに記憶された平均電流値
(I'An)のデータ使用するものとする。また、記憶用
学習データ演算部の出力データも、サンプリング領域
(Qn)の形式で表記してある。
データメモリ(71)からの読み出しデータ、即ち記憶され
たデータを表記するには、本来ストアされている平均電
流値(I'An)をもって表すのではなく、アドレス指定
されたサンプリング領域(Qn)の方で表記し、演算等
は、そのサンプリング領域(Qn)のアドレス番号
(n)で指定されロケーションに記憶された平均電流値
(I'An)のデータ使用するものとする。また、記憶用
学習データ演算部の出力データも、サンプリング領域
(Qn)の形式で表記してある。
【0183】負荷データ演算部(72)は、位置計数値
(N)を注目点とし、その点の電流値(IN)は、電流
値記憶レジスタ(74)の先頭にあり、かつ位置計数値
(N)は、アドレス番号(n)+1で、余り(b=1)
にある場合を想定し、図36において、今回の動作の位
置計数値(N)〜(N−3)がレジスタ(74)に保留さ
れ、その時点のレジスタ(74)の全てのデータは、サンプ
リング領域(Qn)のものに相当し、それらを加算平均
(総合計/加算数)したものが、平均電流値(IAn)で
ある。余り(b)は、レジスタ(74)の先頭値をシフトす
る役割をしている。なお、この余り(b)を注目点を移
すように働かせても同じである。
(N)を注目点とし、その点の電流値(IN)は、電流
値記憶レジスタ(74)の先頭にあり、かつ位置計数値
(N)は、アドレス番号(n)+1で、余り(b=1)
にある場合を想定し、図36において、今回の動作の位
置計数値(N)〜(N−3)がレジスタ(74)に保留さ
れ、その時点のレジスタ(74)の全てのデータは、サンプ
リング領域(Qn)のものに相当し、それらを加算平均
(総合計/加算数)したものが、平均電流値(IAn)で
ある。余り(b)は、レジスタ(74)の先頭値をシフトす
る役割をしている。なお、この余り(b)を注目点を移
すように働かせても同じである。
【0184】負荷データ演算部(72)は、上記平均電流値
(IAn)を、図38に示す電流増加率演算部(81)と直前
データ保留レジスタ(82)とに、送り込んでいる。直前値
データ保留レジスタ(82)は、ドア(2)の閉移動方向に順
次現れるサンプリング領域(nは漸減する)における現
在注目するサンプリング領域(Qn)の直前のサンプリ
ング領域(Qn+1)の平均電流値(IAn+1)を、電流増
加率演算部(81)に送り込んでいる。
(IAn)を、図38に示す電流増加率演算部(81)と直前
データ保留レジスタ(82)とに、送り込んでいる。直前値
データ保留レジスタ(82)は、ドア(2)の閉移動方向に順
次現れるサンプリング領域(nは漸減する)における現
在注目するサンプリング領域(Qn)の直前のサンプリ
ング領域(Qn+1)の平均電流値(IAn+1)を、電流増
加率演算部(81)に送り込んでいる。
【0185】電流増加率演算部(81)は、現在の平均電流
値(IAn)が直前の平均電流値(IAn+1)より大なると
き(IAn>IAn+1)、現在の平均電流値(IAn)と直前
の平均電流値(IAn+1)の比からなる、電流増加率(Δ
IAn=IAn/IAn+1)を求め、この電流増加率(ΔIA
n)は、学習データ遅延シフトレジスタ(83)に送られ
る。
値(IAn)が直前の平均電流値(IAn+1)より大なると
き(IAn>IAn+1)、現在の平均電流値(IAn)と直前
の平均電流値(IAn+1)の比からなる、電流増加率(Δ
IAn=IAn/IAn+1)を求め、この電流増加率(ΔIA
n)は、学習データ遅延シフトレジスタ(83)に送られ
る。
【0186】ただし、現在の平均電流値(IAn)が直前
の平均電流値(IAn+1)より小、もしくは等しいとき
(IAn≦IAn+1)は、電流増加率(ΔIAn)を1とす
る。学習データ遅延シフトレジスタ(83)は、学習結果の
更新時期を若干遅らせるもので、遅延シフトレジスタ(8
3)の段数は任意で、実施例では7段として、学習値重み
付け更新演算部(84)に、7個前のサンプリング領域(Q
n+7)に係る電流増加率(ΔIAn+7)が送られる。
の平均電流値(IAn+1)より小、もしくは等しいとき
(IAn≦IAn+1)は、電流増加率(ΔIAn)を1とす
る。学習データ遅延シフトレジスタ(83)は、学習結果の
更新時期を若干遅らせるもので、遅延シフトレジスタ(8
3)の段数は任意で、実施例では7段として、学習値重み
付け更新演算部(84)に、7個前のサンプリング領域(Q
n+7)に係る電流増加率(ΔIAn+7)が送られる。
【0187】上記説明において、アドレス番号(n)
は、ドア(2)が閉じられる方に付設した番号なので、ド
アが閉じるときには減計数するため、ドア(2)の移動中
で1つ前のアドレス番号は、(n+1)となる。また、
アドレス番号(m)は、開く方に付設したので、ドア移
動中のアドレス番号(m)の直前は(m−1)である。
は、ドア(2)が閉じられる方に付設した番号なので、ド
アが閉じるときには減計数するため、ドア(2)の移動中
で1つ前のアドレス番号は、(n+1)となる。また、
アドレス番号(m)は、開く方に付設したので、ドア移
動中のアドレス番号(m)の直前は(m−1)である。
【0188】学習値重み付け更新演算部(84)には、現在
のサンプリング領域(Qn+7)係る電流増加率(ΔIAn+
7)と、それと同じアドレス(n+7)でアドレス指定
される負荷サンプルデータメモリ(71)の読み出しデータ
(Qn+7)とが、アドレスを一致させて入力している
(以下の説明において、一般的なアドレス(n)で説明
する)。
のサンプリング領域(Qn+7)係る電流増加率(ΔIAn+
7)と、それと同じアドレス(n+7)でアドレス指定
される負荷サンプルデータメモリ(71)の読み出しデータ
(Qn+7)とが、アドレスを一致させて入力している
(以下の説明において、一般的なアドレス(n)で説明
する)。
【0189】学習値重み付け更新演算部(84)は、同一サ
ンプリング領域(Qn)について、予め記憶されている
前回ドア駆動時の電流増加率(Q'n)=(ΔI'An)
に、今回得た最新の電流増加率(ΔIAn)を考慮して、
次式に基づいて記憶データを学習更新させる。 Q'n={(3×Q'n)+ΔIAn}÷4
ンプリング領域(Qn)について、予め記憶されている
前回ドア駆動時の電流増加率(Q'n)=(ΔI'An)
に、今回得た最新の電流増加率(ΔIAn)を考慮して、
次式に基づいて記憶データを学習更新させる。 Q'n={(3×Q'n)+ΔIAn}÷4
【0190】上記の式は、25%学習時のもので、新旧
のデータの割合は、適宜変更できる。新たに求められた
上式の記憶データ(電流増加率)(Q'n)は、負荷サン
プルデータメモリ(71)の書き込みデータ(DL)に送ら
れて、記憶データが学習更新される。
のデータの割合は、適宜変更できる。新たに求められた
上式の記憶データ(電流増加率)(Q'n)は、負荷サン
プルデータメモリ(71)の書き込みデータ(DL)に送ら
れて、記憶データが学習更新される。
【0191】図37の予測比較値演算部(76)は、現在の
サンプリング領域(Qn)のアドレス番号(n)に対応
した学習値(Q'n)よりも、ドア(2)の移動方向で4つ
先方のサンプリング領域(Qn-4)の挟み込み判別に所
要される比較値を求める。
サンプリング領域(Qn)のアドレス番号(n)に対応
した学習値(Q'n)よりも、ドア(2)の移動方向で4つ
先方のサンプリング領域(Qn-4)の挟み込み判別に所
要される比較値を求める。
【0192】予測値レジスタ(77)には、現在ドア(2)の
あるサンプリング領域(Qn)内で、最初の電流値(I
N)を計測した時点から、メインルーチンのループイン
ターバルで、現在までの各測定電流値を、電流計測部(7
3)において加算平均した、サンプル領域内平均電流値
(IAn)の最新のものが保留されている。
あるサンプリング領域(Qn)内で、最初の電流値(I
N)を計測した時点から、メインルーチンのループイン
ターバルで、現在までの各測定電流値を、電流計測部(7
3)において加算平均した、サンプル領域内平均電流値
(IAn)の最新のものが保留されている。
【0193】閾値計算部(78)と比較値算出部(79)には、
最新の電流値(IN)を得ているサンプリング領域(Q
n)のアドレス番号(n)よりも、4つ後(n−4)の
サンプリング領域(Qn-4)の記憶データ(電流増加率
(I'An-4))を、負荷サンプルデータメモリ(71)から
読み出して与えられている。
最新の電流値(IN)を得ているサンプリング領域(Q
n)のアドレス番号(n)よりも、4つ後(n−4)の
サンプリング領域(Qn-4)の記憶データ(電流増加率
(I'An-4))を、負荷サンプルデータメモリ(71)から
読み出して与えられている。
【0194】閾値計算部(78)においては、最新の制御領
域内平均電流値(IAn)と、4つ後(n−4)のサンプ
リング領域(Q'n-4)記憶データとから、次式によって
弁別の許容幅を決める閾値(Fn-4)を計算する。 Fn-4=(IAn-4×Q'n-4)×α 一般式で表すと Fn=(IAn×Q'n)×α(ただし
αは補正計数である。)
域内平均電流値(IAn)と、4つ後(n−4)のサンプ
リング領域(Q'n-4)記憶データとから、次式によって
弁別の許容幅を決める閾値(Fn-4)を計算する。 Fn-4=(IAn-4×Q'n-4)×α 一般式で表すと Fn=(IAn×Q'n)×α(ただし
αは補正計数である。)
【0195】比較値算出部(79)においては、これから出
現するサンプリング領域(Qn-4)の平均電流値(IAn-
4)と比較する比較値(Cn-4)が次式によって計算され
る。 Cn-4=(IAn-4×Q'n-4)+Fn-4 一般式で表すと Cn=(IAn×Q'n)+Fn 比較値算出部(79)によて求められた比較値(Cn-4)
は、4段の予測比較値遅延レジスタ(80)を通過すること
により、現在所要されるサンプリング領域(Qn)のア
ドレス番号(n)対応のものと合致する。
現するサンプリング領域(Qn-4)の平均電流値(IAn-
4)と比較する比較値(Cn-4)が次式によって計算され
る。 Cn-4=(IAn-4×Q'n-4)+Fn-4 一般式で表すと Cn=(IAn×Q'n)+Fn 比較値算出部(79)によて求められた比較値(Cn-4)
は、4段の予測比較値遅延レジスタ(80)を通過すること
により、現在所要されるサンプリング領域(Qn)のア
ドレス番号(n)対応のものと合致する。
【0196】上記初速比較値演算部(76)において、最初
の比較値生成時は、その比較値を予測比較値遅延レジス
タ(80)の前段に入れ、それを4回繰り返し、4つ先の比
較値まで求める。4つ後(n−4)のサンプリング領域
(Q'n-4)記憶データが、増加認識最低値以下の場合
は、比較値(4つ先)は0にセットし直す。
の比較値生成時は、その比較値を予測比較値遅延レジス
タ(80)の前段に入れ、それを4回繰り返し、4つ先の比
較値まで求める。4つ後(n−4)のサンプリング領域
(Q'n-4)記憶データが、増加認識最低値以下の場合
は、比較値(4つ先)は0にセットし直す。
【0197】図39は、図33におけるステップ(37
4)、及び図34のステップ(388)の学習判定ルーチンを
詳細に示すものである。この学習判定ルーチンの目的と
する機能は、各エリアの制御領域毎の電流値の積分処理
をし、挟み込み検出は毎回行う。また、制御領域が移り
変わると学習処理を行うようにする。
4)、及び図34のステップ(388)の学習判定ルーチンを
詳細に示すものである。この学習判定ルーチンの目的と
する機能は、各エリアの制御領域毎の電流値の積分処理
をし、挟み込み検出は毎回行う。また、制御領域が移り
変わると学習処理を行うようにする。
【0198】最初の処理は、サンプリング領域のアドレ
ス(n)(m)の算出、分解能(B)計数の算出を行
う。その後制御領域の区切りが良くなると、学習可能状
態になる。学習可能状態の後は、毎回電流値を加算、加
算回数をインクリメントし、制御領域毎の平均値の算出
準備をする。学習挟み込み判定処理は、毎回行う。周期
バッファーカウントに前回からのパルス数が入力させて
いるので、前回までの分解のバッファーと加算し、エリ
ア毎に分解能値以上の場合(領域変化をした事にな
る)、学習処理、比較値の算出を行う
ス(n)(m)の算出、分解能(B)計数の算出を行
う。その後制御領域の区切りが良くなると、学習可能状
態になる。学習可能状態の後は、毎回電流値を加算、加
算回数をインクリメントし、制御領域毎の平均値の算出
準備をする。学習挟み込み判定処理は、毎回行う。周期
バッファーカウントに前回からのパルス数が入力させて
いるので、前回までの分解のバッファーと加算し、エリ
ア毎に分解能値以上の場合(領域変化をした事にな
る)、学習処理、比較値の算出を行う
【0199】図40は、図33におけるステップ(37
8)、及び図39のステップ(397)のエラー判定ルーチン
を詳細に示すものである。ステップ(424)で現在の電流
値(IN)と比較値(Cn)を比較して、電流値(IN)
が大なる回数をステップ(425)でエラー回数として計数
する。ステップ(424)で電流値(IN)が比較値(Cn)
より等しいか小になると、エラー回数をクリアする。す
なわち、連続して電流値(IN)が大なる回数とエラー
回数は計数している。
8)、及び図39のステップ(397)のエラー判定ルーチン
を詳細に示すものである。ステップ(424)で現在の電流
値(IN)と比較値(Cn)を比較して、電流値(IN)
が大なる回数をステップ(425)でエラー回数として計数
する。ステップ(424)で電流値(IN)が比較値(Cn)
より等しいか小になると、エラー回数をクリアする。す
なわち、連続して電流値(IN)が大なる回数とエラー
回数は計数している。
【0200】図41は、図33におけるステップ(379)
の学習重み付けルーチンを詳細に示すものである。この
学習判定重み付けルーチンの目的とす機能は、現在の制
御領域が増加傾向の場合、エリア毎に分解能が違うた
め、異常を示すカウントの重み付けをして、本当に異常
なのかを判断する。異常と判断した場合と現在の制御領
域が増加傾向でない場合は、挟み込み検出を有効にする
ことを許可することにある。
の学習重み付けルーチンを詳細に示すものである。この
学習判定重み付けルーチンの目的とす機能は、現在の制
御領域が増加傾向の場合、エリア毎に分解能が違うた
め、異常を示すカウントの重み付けをして、本当に異常
なのかを判断する。異常と判断した場合と現在の制御領
域が増加傾向でない場合は、挟み込み検出を有効にする
ことを許可することにある。
【0201】現在の制御領域が増加傾向でない場合、挟
み込み検出を許可する。現在の制御領域が増加傾向の場
合、異常を示すカウント値が有りその値がエリア毎(分
解能毎)に設定された値以上の時は、異常と判定し挟み
込み検出を許可する。現在の制御領域が増加傾向で、異
常を示すカウントが設定値より小さい場合は、挟み込み
検出を不許可とし、挟み込み検出を無効にする。
み込み検出を許可する。現在の制御領域が増加傾向の場
合、異常を示すカウント値が有りその値がエリア毎(分
解能毎)に設定された値以上の時は、異常と判定し挟み
込み検出を許可する。現在の制御領域が増加傾向で、異
常を示すカウントが設定値より小さい場合は、挟み込み
検出を不許可とし、挟み込み検出を無効にする。
【0202】図42は、図33におけるステップ(37
5)、及び図34におけるステップ(389)の継続&変化量
ルーチンを詳細に示すものである。この変化&上昇傾向
ルーチンは、電流値(IN)の変化量と上昇継続時間を
測定する。前回電流値(IN-1)≧今回電流値(IN)の
時でないときは、変化前電流値、継続回数は、初期化す
る。前回電流値(IN-1)<今回電流値(IN)の時は、
上昇継続回数を増計数する。前回電流値(IN-1)<今
回電流値(IN)の時は、変化前電流値がない場合、前
回電流値を変化前電流値として格納し、変化前電流値が
有る場合、今回電流値−変化前電流値より変化量を求め
る。
5)、及び図34におけるステップ(389)の継続&変化量
ルーチンを詳細に示すものである。この変化&上昇傾向
ルーチンは、電流値(IN)の変化量と上昇継続時間を
測定する。前回電流値(IN-1)≧今回電流値(IN)の
時でないときは、変化前電流値、継続回数は、初期化す
る。前回電流値(IN-1)<今回電流値(IN)の時は、
上昇継続回数を増計数する。前回電流値(IN-1)<今
回電流値(IN)の時は、変化前電流値がない場合、前
回電流値を変化前電流値として格納し、変化前電流値が
有る場合、今回電流値−変化前電流値より変化量を求め
る。
【0203】図43は図33におけるステップ(376)、
及び図34のステップ(390)における総合判定ルーチン
の詳細を示すものである。この総合判定ルーチンは、学
習での判定、変化量、上昇継続時間の結果を全て加味し
た上で挟み込みの判定を下すことを目的としている。学
習判定で、挟み込み検出可能と判断していること。継続
時間が、設定値以上でかつ変化量も設定値以上の場合。
継続時間が、設定最大値以上の場合。変化量が、設定最
大値以上の場合。
及び図34のステップ(390)における総合判定ルーチン
の詳細を示すものである。この総合判定ルーチンは、学
習での判定、変化量、上昇継続時間の結果を全て加味し
た上で挟み込みの判定を下すことを目的としている。学
習判定で、挟み込み検出可能と判断していること。継続
時間が、設定値以上でかつ変化量も設定値以上の場合。
継続時間が、設定最大値以上の場合。変化量が、設定最
大値以上の場合。
【0204】図44は、本発明の一実施例を示すもの
で、前記図10に示すステップ(119)の坂道モードルー
チンにおけるステップ(132)の坂道判定ルーチンの詳細
を示してある。この坂道判定ルーチンは、坂道判定をす
るための条件を整える。既に坂道判定した場合には、ド
ア(2)が一旦全閉しない限り、2度目は判定しない(ス
テップ(452))。換言すると、ここでは、ドア全閉から
ドアを開く動作の連続した動作中で、かつガイドトラッ
クの直線部を移動中の安定した動作をしており、しかも
移動速度の一定した時期のモータ負荷の電気値を取り込
んで、暫時に最新のものに更新している。エリア1で行
う(ステップ(450))。作動が安定する時間以降で行う
(ステップ(451))。作動が、安定していること(ステ
ップ(453))。初期時は、平坦値の入力をする(ステッ
プ(457))。
で、前記図10に示すステップ(119)の坂道モードルー
チンにおけるステップ(132)の坂道判定ルーチンの詳細
を示してある。この坂道判定ルーチンは、坂道判定をす
るための条件を整える。既に坂道判定した場合には、ド
ア(2)が一旦全閉しない限り、2度目は判定しない(ス
テップ(452))。換言すると、ここでは、ドア全閉から
ドアを開く動作の連続した動作中で、かつガイドトラッ
クの直線部を移動中の安定した動作をしており、しかも
移動速度の一定した時期のモータ負荷の電気値を取り込
んで、暫時に最新のものに更新している。エリア1で行
う(ステップ(450))。作動が安定する時間以降で行う
(ステップ(451))。作動が、安定していること(ステ
ップ(453))。初期時は、平坦値の入力をする(ステッ
プ(457))。
【0205】図45は、図10に示すステップ(131)、
及び図44のステップ(457)の平坦データ入力ルーチン
の詳細を示すものである。この平坦値データ入力ルーチ
ンは、前記ステップ(132)の坂道判定ルーチンに使用す
る、基準値の入力(平坦基準値)ルーチンである。目標
速度に制御されているときに入力する(ステップ(45
8))。現電流値を、平坦電流値として所要の記憶手段に
格納(ステップ(459))。駆動電圧を、平坦駆動電圧と
して所要の記憶手段に格納(ステップ(460))。なお、
現電流値及び駆動電圧は、前述の如く、モータ(14)のモ
ータ負荷に応じた電気値であり、図8の電圧検出部(47)
及び電流検出部(50)と、図9に示すステップ(110)のメ
インルーチンにおけるステップ(103)において取得され
る。
及び図44のステップ(457)の平坦データ入力ルーチン
の詳細を示すものである。この平坦値データ入力ルーチ
ンは、前記ステップ(132)の坂道判定ルーチンに使用す
る、基準値の入力(平坦基準値)ルーチンである。目標
速度に制御されているときに入力する(ステップ(45
8))。現電流値を、平坦電流値として所要の記憶手段に
格納(ステップ(459))。駆動電圧を、平坦駆動電圧と
して所要の記憶手段に格納(ステップ(460))。なお、
現電流値及び駆動電圧は、前述の如く、モータ(14)のモ
ータ負荷に応じた電気値であり、図8の電圧検出部(47)
及び電流検出部(50)と、図9に示すステップ(110)のメ
インルーチンにおけるステップ(103)において取得され
る。
【0206】図46は、図10に示すステップ(132)、
及び図44におけるステップ(456)の坂道検査ルーチン
の詳細を示すものである。この坂道検査ルーチンは、車
体(1)の現在の状況を、以下の5に区別する。 急な登り坂=開作動時に駆動電圧が、とても低いとき 登り坂 =開作動時に駆動電圧が、低いとき。 平坦 =開作動時に駆動電圧が低くもなく、電流値
も大きくない時。 下り坂。 =開作動時に電流値が、大きい時。 急な下り坂=開作動時に電流値が、とても大きいとき。
及び図44におけるステップ(456)の坂道検査ルーチン
の詳細を示すものである。この坂道検査ルーチンは、車
体(1)の現在の状況を、以下の5に区別する。 急な登り坂=開作動時に駆動電圧が、とても低いとき 登り坂 =開作動時に駆動電圧が、低いとき。 平坦 =開作動時に駆動電圧が低くもなく、電流値
も大きくない時。 下り坂。 =開作動時に電流値が、大きい時。 急な下り坂=開作動時に電流値が、とても大きいとき。
【0207】ステップ(463)の駆動電圧算出は、以下の
ように機能する。PWM制御によりデューテイ(DUT
Y)が、100%で無い場合、その時のデューテイ10
0%相当の駆動電圧を算出する。0.5Vを1として
(9V=18)駆動電圧を表す。 電圧アドレスの取り出し 電圧アドレス+18(9V)=バッテリー電圧 DUTY≠100%の場合 DUTY値÷250(100%)=駆動割り合い バッテリー電圧*駆動割合=駆動電圧 DUTY=100%の場合 バッテリー電圧=駆動電圧
ように機能する。PWM制御によりデューテイ(DUT
Y)が、100%で無い場合、その時のデューテイ10
0%相当の駆動電圧を算出する。0.5Vを1として
(9V=18)駆動電圧を表す。 電圧アドレスの取り出し 電圧アドレス+18(9V)=バッテリー電圧 DUTY≠100%の場合 DUTY値÷250(100%)=駆動割り合い バッテリー電圧*駆動割合=駆動電圧 DUTY=100%の場合 バッテリー電圧=駆動電圧
【0208】
【発明の効果】本発明によると、次のような効果を奏す
ることができる。
ることができる。
【0209】(a)坂道の傾斜度合い、即ち車体の傾斜
度合いを、特別な傾斜測定センサーを使用しないで、容
易に検出することができる(請求項1)。
度合いを、特別な傾斜測定センサーを使用しないで、容
易に検出することができる(請求項1)。
【0210】(b)請求項2記載の発明によれば、常に
ドアを開くときの、最初のモータ負荷部分で傾斜度が測
られるので、そのドアを閉じるまで、開く途中のドアか
ら開かれたドアに至るまで、傾斜度に応じた適正な安全
対策を施すことができる。
ドアを開くときの、最初のモータ負荷部分で傾斜度が測
られるので、そのドアを閉じるまで、開く途中のドアか
ら開かれたドアに至るまで、傾斜度に応じた適正な安全
対策を施すことができる。
【0211】(c)請求項3記載の発明によれば、常に
ドアを開く毎に、所要の平坦の条件を満たすものであれ
ば、モータ負荷の電気値を更新記憶するので、機構部分
やその他の経時変化を生じるパラメータに対する修正効
果が得られ、長期間の安全性が保たれる。
ドアを開く毎に、所要の平坦の条件を満たすものであれ
ば、モータ負荷の電気値を更新記憶するので、機構部分
やその他の経時変化を生じるパラメータに対する修正効
果が得られ、長期間の安全性が保たれる。
【0212】(d)請求項4記載の発明によれば、上り
坂と下り坂を、モータ負荷の電気値たる電圧値と電流値
に分けて検出するので、傾斜の方向を確実に判定するこ
とができる。
坂と下り坂を、モータ負荷の電気値たる電圧値と電流値
に分けて検出するので、傾斜の方向を確実に判定するこ
とができる。
【0213】(e)請求項5記載の発明によれば、PW
M制御が行われているモータに対しても、PWM制御の
状態に関わりなく、常にモータ負荷に応じた電気値が得
られる
M制御が行われているモータに対しても、PWM制御の
状態に関わりなく、常にモータ負荷に応じた電気値が得
られる
【図1】本発明を適用した自動車の外観斜視図である。
【図2】スライドドアを取り外した状態の図1の拡大図
である。
である。
【図3】スライドドアのみを示す斜視図である。
【図4】スライドドアの部分を車内側から視た要部の斜
視図である。
視図である。
【図5】ドア駆動装置の一部を切欠いて示す斜視図であ
る。
る。
【図6】ドア駆動装置の斜視図である。
【図7】本発明を適用したスライドドア自動制御装置の
機構を概略示す示すブロック図である。
機構を概略示す示すブロック図である。
【図8】本発明を適用したスライドドア自動制御装置(2
3)を具体的に示すブロック図である。
3)を具体的に示すブロック図である。
【図9】本発明を適用したスライドドア自動制御装置の
メインフローチャートであ。
メインフローチャートであ。
【図10】モード判定と、オートスライドモードを詳細
に示すフローチャートである。
に示すフローチャートである。
【図11】パルス割り込みルーチンによって実行され
る、ドアの移動速度の計数に係るタイムチャートであ
る。
る、ドアの移動速度の計数に係るタイムチャートであ
る。
【図12】位置計数パルス各エリアにおいて分解能に応
じてサンプリングされるサンプリング点のタイムチャー
トである。
じてサンプリングされるサンプリング点のタイムチャー
トである。
【図13】ドアの開閉位置と位置計数値の関係、及びド
アの開度に応じたドアのある各エリアを示すタイムチ
ャートである。
アの開度に応じたドアのある各エリアを示すタイムチ
ャートである。
【図14】パルス割りみルーチンの詳細を示フローチャ
ートである。
ートである。
【図15】パルスカウントタイマールーチンの詳細を示
フローチャートである。
フローチャートである。
【図16】エリア1〜エリア7の所に要求される制御の
特徴で分けた制御領域、及びその制御領域対応して定め
られた、移動速度、並びにその制御領域所用される、サ
ンプリング領域の分解能等を示すメモリーテーブルであ
る。
特徴で分けた制御領域、及びその制御領域対応して定め
られた、移動速度、並びにその制御領域所用される、サ
ンプリング領域の分解能等を示すメモリーテーブルであ
る。
【図17】オートスライドモード判定ルーチンの詳細を
示フローチャートである。
示フローチャートである。
【図18】図17における手動判定ルーチンの詳細を示
フローチャートである。
フローチャートである。
【図19】図10におけるオート開作動ルーチンの詳細
を示すものである。
を示すものである。
【図20】図10におけるオート閉作動ルーチンの詳細
を示すものである。
を示すものである。
【図21】図10におけるマニュアル閉作動ルーチンの
詳細を示すものである。
詳細を示すものである。
【図22】図10におけるの逆転開作動ルーチンの詳細
を示すものである。
を示すものである。
【図23】図10におけるの逆転閉作動ルーチンの詳細
を示すものである。
を示すものである。
【図24】図10における目標位置算出ルーチンの詳細
を示すものである。
を示すものである。
【図25】図10における全開制御ルーチンの詳細を示
すも
すも
【図26】図10におけるスタートモードルーチンの詳
細を示すものである。
細を示すものである。
【図27】図10における手動スタートモードルーチン
の詳細を示すものであ
の詳細を示すものであ
【図28】図10における速度制御部の主要部を示すフ
ローチャートである。
ローチャートである。
【図29】速度制御に係る機能をブロック図で示したも
のである。
のである。
【図30】バッテリー電圧とデューテイに係る計算式を
示すグラフである。
示すグラフである。
【図31】図28に示すPWM制御の詳細を示すもので
ある。
ある。
【図32】図28に示すフィードバック調整ルーチンの
詳細を示すものであ
詳細を示すものであ
【図33】図10に示す挟み込み判定の主たるフローを
示すものである。
示すものである。
【図34】図33に示す挟み込み判定の詳細を示すもの
である。
である。
【図35】挟み込み判定の機能をブロック図で示すもの
である。
である。
【図36】注目するサンプリング領域の各データを示す
グラフである。
グラフである。
【図37】図35の予測判別値演算部の詳細なブロック
図である。
図である。
【図38】図35の記憶用学習演算部の詳細なブロック
ずである。
ずである。
【図39】図33に示す学習判定ルーチンを詳細に示す
ものである。
ものである。
【図40】図33に示すエラー判定ルーチンを詳細に示
すものである。
すものである。
【図41】図33に示す学習重み付けルーチンを詳細に
示すものである。
示すものである。
【図42】図33に示す継続&変化量ルーチンを詳細に
示すものである。
示すものである。
【図43】図33に示す総合判定ルーチンを詳細に示す
ものである。
ものである。
【図44】本発明の実施要領を例を示すもので、図10
における坂道判定ルーチンを詳細に示すものである。
における坂道判定ルーチンを詳細に示すものである。
【図45】同じく、図44に示す平坦データ入力ルーチ
ンを詳細に示すものである。
ンを詳細に示すものである。
【図46】同じく、図44に示す坂道検査ルーチンを詳
細に示すものである。
細に示すものである。
(1)車体 (2)ドア (3)ドア開口 (4)アッパートラック (5)ロアトラック (6)摺動連結具 (7)ガイドトラック (8)ドアロック (9)ストライカ (10)ドア駆動装置 (11)モータ駆動部 (12)ドア駆動ケーブル部材 (12a)閉扉用ケーブル (12b)開扉用ケーブル (13)ベースプレート (14)モータ (15)ドライブプーリ (16)電磁クラッチ (17)減速部 (18)ロータリーエンコーダ (19)案内プーリ (7a)開口部 (7b)案内部 (20)反転プーリ (21)移動部材 (22)ヒンジアーム (23)スライドドア自動制御装置 (24)バッテリー (25)イグニッションSW (26)パーキングSW (27)メインSW (28)ドア開、閉SW (29)リモコンドア開、閉SW (30)ワイヤレスリモコン (31)キーレスシステム (32)ブザー (33)車体側コネクタ (34)ドア側コネクタ (35)アクチュエータ (36)ハーフラッチSW (37)ドアハンドル (37a)ドアハンドルSW (38)パルス信号発生部 (39)出力ポート (40)発電機 (41)安定化電源 (42)速度選出部 (43)位置検出部 (44)モータ切り替えSW (45)極性反転SW回路 (46)電力SW素子 (47)電圧検出部 (48)A/D変換部 (49)シャント抵抗 (50)電流検出部 (51)A/D変換部 (52)クラッチ駆動回路 (53)アクチュエータ駆動回路 (54)制御モード変換部 (55)メイン制御部 (56)オートスライド制御部 (57)速度制御部 (58)挟み込み制御部 (59)坂道判定部 (60)ドア位置検出部 (61)制御領域弁別部 (62)適正補正量選択部 (63)最大補正量制限部 (64)ドア移動速度検出部 (65)速すぎ検出部 (66)遅すぎ検出部 (65a)(66a)差計算部 (65b)(65c)(66b)(66c)一時保留部 (65d)(66d)修正量演算部 (67)フィードバック調整部 (68)電源電圧検出部 (69)デューテイ演算部 (70)サンプリング領域演算部 (71)サンプルデータメモリ (72)負荷データ演算部 (73)電流計測部 (74)シフトレジスタ (75)記憶用学習データ演算部 (76)上記予測比較値演算部 (77)予測値レジスタ (78)閾値計算部 (79)比較値計算部 (80)予測比較値遅延レジスタ (81)電流増加率演算部 (82)直前値データ保留レジスタ (83)学習データ遅延シフトレジスタ (84)更新演算部 (85)判定部 (86)前回電流値メモリ部 (87)変化量算出部 (88)電流増加回数計数部 (89)坂道検出部
Claims (5)
- 【請求項1】 車体に設けたガイドトラックに沿って開
閉可能に支持されたスライドドアを、モータ駆動により
開閉移動させるようにした車両用スライドドアの開閉装
置において、 正逆転可能なモータを有するドア駆動部と、 該ドア駆動部のモータ負荷を、モータの駆動電流または
駆動電圧、もしくはその両方の電気値で検出するモータ
負荷検出手段と、 平坦姿勢に車体があるときの、ドア開又はドア閉時のモ
ータ負荷の電気値を記憶する記憶手段と、 該記憶手段において記憶された平坦姿勢のモータ負荷の
電気値と、通常のドア開もしくはドア閉時に検出された
モータ負荷の電気値を比較し、このモータ負荷に係る両
電気値の偏差から、ドア開閉時の車体の姿勢を判別する
坂道判別手段を備えることを特徴とする車両用スライド
ドアの自動開閉制御おける坂道判別装置。 - 【請求項2】 記憶手段が、ドア開時のモータ負荷電流
とモータ駆動電圧を、モータ負荷の電気値として記憶し
ている請求項1記載の車両用スライドドアの自動開閉制
御おける坂道判別装置。 - 【請求項3】 記憶手段が、ドア全閉からドアを開く動
作の連続した動作中で、かつガイドトラックの直線部を
移動中で、しかも移動速度の一定した時期のモータ負荷
の電気値を暫時更新記憶している請求項1記載の車両用
スライドドアの自動開閉制御おける坂道判別装置。 - 【請求項4】 モータ負荷に係る両電気値の偏差が、 開作動時に駆動電圧が、とても低いときは、急な登り坂
と、 開作動時に駆動電圧が、低いときは、登り坂と、 開作動時に駆動電圧が低くもなく、電流値も大きくない
時は、平坦と、 開作動時に電流値が、大きい時は、下り坂と、 開作動時に電流値が、とても大きいときは、急な下り坂
と判別している、請求項1または2に記載の車両用スラ
イドドアの自動開閉制御おける坂道判別装置。 - 【請求項5】 モータ負荷に係る電気値が、デユーテイ
サイクルで負荷電力を制御しているモータの駆動電圧
を、デユーテイサイクル100%相当の電圧に換算して
なる請求項1〜3いずれかに記載の車両用スライドドア
の自動開閉制御おける坂道判別装置
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP7340887A JPH09125822A (ja) | 1995-12-27 | 1995-12-27 | 車両用スライドドアの自動開閉制御における坂道判別装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP7340887A JPH09125822A (ja) | 1995-12-27 | 1995-12-27 | 車両用スライドドアの自動開閉制御における坂道判別装置 |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP07278583 Division | 1995-10-02 | 1995-10-26 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH09125822A true JPH09125822A (ja) | 1997-05-13 |
Family
ID=18341231
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP7340887A Pending JPH09125822A (ja) | 1995-12-27 | 1995-12-27 | 車両用スライドドアの自動開閉制御における坂道判別装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH09125822A (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7246688B2 (en) * | 1998-12-23 | 2007-07-24 | Otis Elevator Company | Elevator door system |
JP2010150851A (ja) * | 2008-12-26 | 2010-07-08 | Mitsuba Corp | 開閉体制御装置 |
JP2010150850A (ja) * | 2008-12-26 | 2010-07-08 | Mitsuba Corp | 開閉体制御装置 |
CN115142756A (zh) * | 2022-07-30 | 2022-10-04 | 上海驰助汽车零部件有限公司 | 一种车辆侧滑门驱动机构 |
CN115405185A (zh) * | 2022-09-19 | 2022-11-29 | 重庆长安汽车股份有限公司 | 车身姿态自适应的车门控制方法、***、车辆及存储介质 |
-
1995
- 1995-12-27 JP JP7340887A patent/JPH09125822A/ja active Pending
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7246688B2 (en) * | 1998-12-23 | 2007-07-24 | Otis Elevator Company | Elevator door system |
US8448751B2 (en) | 1998-12-23 | 2013-05-28 | Otis Elevator Company | Elevator door system |
JP2010150851A (ja) * | 2008-12-26 | 2010-07-08 | Mitsuba Corp | 開閉体制御装置 |
JP2010150850A (ja) * | 2008-12-26 | 2010-07-08 | Mitsuba Corp | 開閉体制御装置 |
CN115142756A (zh) * | 2022-07-30 | 2022-10-04 | 上海驰助汽车零部件有限公司 | 一种车辆侧滑门驱动机构 |
CN115142756B (zh) * | 2022-07-30 | 2024-04-26 | 上海驰助汽车零部件有限公司 | 一种车辆侧滑门驱动机构 |
CN115405185A (zh) * | 2022-09-19 | 2022-11-29 | 重庆长安汽车股份有限公司 | 车身姿态自适应的车门控制方法、***、车辆及存储介质 |
CN115405185B (zh) * | 2022-09-19 | 2024-05-07 | 重庆长安汽车股份有限公司 | 车身姿态自适应的车门控制方法、***、车辆及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3465735B2 (ja) | 車両用スライドドアの自動開閉制御装置 | |
JP3494540B2 (ja) | 自動駆動式開閉体の仮保持装置 | |
JP3421201B2 (ja) | 車両用スライドドアの開閉制御装置 | |
US6729071B1 (en) | Device for automatically controlling opening and closing of a vehicle slide door | |
JP3656788B2 (ja) | 車輛用スライドドアの開閉制御装置 | |
JP3437039B2 (ja) | 車両用スライドドアの開閉制御装置 | |
US6134837A (en) | Door holding control system for a vehicle slide door | |
US5350986A (en) | Vehicle power door speed control | |
JPH06328941A (ja) | 車両ドア・コントローラ | |
JPH06344773A (ja) | 車両ドア・コントローラ | |
JP2007023585A (ja) | 車両用自動開閉装置 | |
JPH11236783A (ja) | 自動車用スライドドアの開閉制御装置 | |
JPH09125822A (ja) | 車両用スライドドアの自動開閉制御における坂道判別装置 | |
JPH09125820A (ja) | 車両用スライドドアの自動開閉制御におけるドア駆動制御装置 | |
JP3511347B2 (ja) | 車輛用スライドドアの自動開閉制御装置 | |
JPH09125818A (ja) | 車両用開閉体の自動開閉制御における開閉体速度制御装置 | |
JPH09125823A (ja) | 車両用スライドドアの自動開閉制御におけるドアの挟み込み検出装置 | |
JP3753177B2 (ja) | 車両用スライドドアの自動開閉制御装置 | |
JPH09125821A (ja) | 車両用スライドドアの自動開閉制御におけるドア駆動制御装置 | |
JP4482383B2 (ja) | 車両用自動開閉装置 | |
JPH11166358A (ja) | 自動車用スライドドア開閉装置及び車両の停車姿勢判定方法 | |
JP3667739B2 (ja) | 車両用スライドドアの自動開閉制御装置 | |
JP3667740B2 (ja) | 車両用スライドドアの自動開閉制御装置 | |
JP3667738B2 (ja) | 車両用スライドドアの自動開閉制御装置 | |
JP2002364249A (ja) | 車両用開閉体の制御装置 |