JP2014076718A - 移動体の制御装置 - Google Patents

Abstract

【課題】この発明は、転倒防止のための警告に適切な傾斜角度に移動体が傾斜した時に警告を発することができる移動体の制御装置を提供することを目的とする。
【解決手段】この発明は、車輪と、この車輪を駆動する駆動源と、運転者が着座する座席とを備えた移動体の制御装置であって、移動体の傾斜角度を算出する傾斜角度演算手段と、移動体の傾斜方向を算出する傾斜方向演算手段と、運転者に警告する警告手段と、傾斜方向演算手段により算出された傾斜方向に基づいて警告角度を設定し、傾斜角度演算手段により算出された傾斜角度が警告角度よりも大きくなった時に警告手段により警告する制御手段とを備えることを特徴とする。
【選択図】図１

Description

この発明は移動体の制御装置に係り、特に、移動体の転倒防止のための警告を、移動体が警告に適切な傾斜角度に傾斜した時に発することができる移動体の制御装置に関する。

地上を走行するシニアカーや電動車椅子などの移動体は、路面状況や走行状況によって傾斜する。移動体が傾斜したことを警告する装置には、時間による移動体の傾斜角度変化率を求め、盗難防止のための警告を行う盗難防止装置がある。（特許第４６３５９０６号公報）
また、出願人は、移動体が傾斜したことを警告する装置として、移動体の傾斜角度が判定値を越えた場合に、転倒防止のための警告を発する移動体の傾斜角検出装置を既に出願している。（２０１２年５月１４日出願、特願２０１２−１１０４８４）

特許第４６３５９０６号公報 特願２０１２−１１０４８４

ところで、移動体の転倒防止のために警告する場合において、移動体が警告に適切な傾斜角度に傾斜した時に警告を発することが望ましい。
警告を発する時期が遅過ぎると、運転者の対応が間に合わず、意味のない警告になってしまう。一方、警告を発する時期が早過ぎると、運転者の対応が必要ではない状況で警告を発することになり、運転者にとって煩わしいことになる。

この発明は、転倒防止のための警告に適切な傾斜角度に移動体が傾斜した時に警告を発することができる移動体の制御装置を提供することを目的とする。

この発明は、車輪と、この車輪を駆動する駆動源と、運転者が着座する座席とを備えた移動体の制御装置であって、前記移動体の傾斜角度を算出する傾斜角度演算手段と、前記移動体の傾斜方向を算出する傾斜方向演算手段と、運転者に警告する警告手段と、前記傾斜方向演算手段により算出された傾斜方向に基づいて警告角度を設定し、前記傾斜角度演算手段により算出された傾斜角度が前記警告角度よりも大きくなった時に前記警告手段により警告する制御手段とを備えることを特徴とする。

この発明は、移動体の傾斜角度が移動体の傾斜方向に基づいて設定した警告角度よりも大きくなった時に警告するので、移動体の転倒防止のために警告を行う場合、移動体が警告に適切な傾斜角度に傾斜した時に警告を発することができる。

図１は移動体の制御装置のブロック構成図である。（実施例１） 図２（Ａ）は移動体の左右軸、前後軸を示す平面図、図２（Ｂ）は移動体の左右軸、垂直軸を示す正面図、図２（Ｃ）は傾斜する平面における移動体の傾斜角度、傾斜方向の関係を示す平面図である。（実施例１） 図３は移動体の加速度、加速度方向、車両加速度、車両加速度方向、重力加速度の関係を示す図である。（実施例１） 図４は移動体の制御装置の警告動作を説明するブロック図である。（実施例１） 図５は加速度の検出軸が２軸の場合の、傾斜方向により設定する警告角度のマップである。（実施例１） 図６は加速度の検出軸が１軸で前後方向の場合の、傾斜方向により設定する警告角度のマップである。（実施例１） 図７は傾斜方向により警告角度を設定した場合の警告判定のフローチャートである。（実施例１） 図８は移動体の第１の例としての電動車椅子の側面図である（実施例１）。 図９は移動体の第２の例としてのシニアカーの側面図である（実施例１）。 図１０は加速度の検出軸が２軸の場合の、加速度と加速度方向とについて閾値により設定する警告角度のマップである。（実施例２） 図１１は加速度の検出軸が１軸で前後方向の場合の、加速度と加速度方向とについて閾値により設定する警告角度のマップである。（実施例２） 図１２は加速度方向により警告角度を設定した場合の警告判定のフローチャートである。（実施例２） 図１３は傾斜方向と加速度方向とにより警告角度を設定した場合の警告判定のフローチャートである。（実施例３） 図１４は加速度と加速度方向とについて２つの閾値により設定する警告角度のマップである。（変形例１） 図１５は加速度と加速度方向とについて２つの閾値により警告角度を設定した場合の警告判定のフローチャートである。（変形例１） 図１６は傾斜方向と加速度と加速度方向とを変数として警告角度を設定した場合の警告判定のフローチャートである。（変形例２）

以下、図面に基づいて、この発明の実施例を説明する。

図１〜図９は、この発明の実施例１を示すものである。この発明は、移動体１が警告に適切な傾斜角度に傾斜した時に警告を発するものである。図８、図９に示すように、移動体１としては、例えば、電動車椅子１Ａやシニアカー１Ｂがある。
前記電動車椅子１Ａは、図８に示すように、フレーム２に、操舵用の前車輪３と走行用の後車輪４と運転者が着座する座席５と足置き部６と肘掛け部７と後車輪４を駆動する駆動源の電動モータ８とを組み付けて構成され、肘掛け部７に走行指示装置（アクセルレバー）９を備えている。
前記シニアカー１Ｂは、図９に示すように、車体１０に、操舵用の前車輪１１と走行用の後車輪１２と運転者が着座する座席１３と足置き部１４と操作部１５と後車輪１２を駆動する駆動源の電動モータ１６とを組み付けて構成され、操作部１５に走行指示装置（アクセルレバー）１７を備えている。なお、移動体１の駆動源は、電動モータに限るものではない。

前記移動体１としての車椅子１Ａ及びシニアカー１Ｂには、図１に示すように、転倒防止のために警告を行う制御装置１８が設けられている。
制御装置１８は、加速度センサ１９と、車輪回転速度センサ２０と、角速度センサ２１とを備えている。
前記加速度センサ１９は、１軸を検出軸として持つ加速度センサ、あるいは、異なる方向の２軸を検出軸として持つ加速度センサ、もしくは異なる方向の２軸を含む平面と同一平面ではない１軸を含んだ３軸を検出軸として持つ加速度センサからなる。加速度センサ１９は、移動体１に取り付けられて移動体１の加速度を検出する。また、この加速度センサ１９は、移動体１に加速度が作用している限り、その加速度に応じた反応を維持する構造であって、動的な加速度だけでなく、地球の重力加速度等の静的な加速度にも反応し、傾斜角度を検出可能なものである。
前記車輪回転速度センサ２０、前記角速度センサ２１は、重力加速度以外の移動体１に作用する加速度を算出するために必要な、移動体１の速度、移動体１の重心回りの角速度を検出する。
前記制御装置１８は、移動体１の傾斜角度を算出する傾斜角度演算手段２２と、移動体１の傾斜方向を算出する傾斜方向演算手段２３と、移動体１の加速度方向及び加速度の大きさを算出する加速度演算手段２４と、移動体１に作用する動的な加速度（車両加速度）を算出する車両加速度演算手段２５と、移動体１の転倒防止のために警告を行う制御手段２６とを備えている。
制御装置１８は、運転者に画像、音声等により警告する警告手段２７を備えている。制御手段２６は、傾斜角度演算手段２２と、傾斜方向演算手段２３と、加速度演算手段２４と、車両加速度演算手段２５と、の演算結果に基づいて警告判定を行い、警告を行う場合に警告手段２７により警告する。

ここで、前記移動体１の制御装置１８の用語について、以下のように定義する。
・傾斜角度
鉛直線に対して移動体１の垂直軸のなす角度を表す。
・傾斜方向
移動体１の垂直軸を重力方向に向かって投影した方向のことである。（重力方向と一致）
移動体１は、移動体１の各軸の重力加速度が分かれば演算で求めることができる。１軸の検出軸を持つ加速度センサ１９の場合は、前後方向もしくは左右方向等の２方向に限られ、２軸以上の検出軸を持つ加速度センサ１９の場合は、任意の２軸で構成される平面全方向になる。

図２（Ａ）、図２（Ｂ）に示すように、移動体１の重心Ｇを通る互いに直交した３軸を、左右軸（ｘ軸）、前後軸（ｙ軸）、垂直軸（ｚ軸）とし、重心Ｇから右側のｘ軸を基準位置として反時計回りで角度を表し、図２（Ｃ）に示すように、重力方向に延びる軸を鉛直線ｖとし、鉛直線ｖと直交する平面を水平面Ｐとした場合、前記傾斜角度は、水平面Ｐに対して傾斜したＸ−Ｙ平面における移動体１の垂直軸（ｚ軸）が鉛直線ｖに対してなす角度θｚであり、前記傾斜方向は、傾斜したＸ−Ｙ平面に投影された移動体１の垂直軸（ｚ軸）の投影線ｓの伸びる方向である。傾斜方向は、左右軸（ｘ軸）に対して角度θａをなしている。

・加速度方向
加速度方向は、加速度センサ１９によって検出される各軸の加速度の和の方向を表す。
・加速度
加速度センサ１９によって検出される移動体１の各軸の加速度の和の大きさを表す。
・車両加速度
移動体１が走行することにより生じる加速度、つまり、慣性力の加速度のことである。
・車両加速度方向
移動体１が走行することにより生じる加速度、つまり、慣性力の加速度の方向のことである。

図３に示すように、角度θｚで傾斜する平面における移動体１の旋回方向が矢印方向の場合、重力加速度と車両加速度とを合わせた加速度の方向が左右軸に対してなす角度を加速度方向θｂとし、左右軸方向の車両加速度が左右軸に対してなす角度を車両加速度方向θｃとする。

・傾斜角度、傾斜方向の算出
移動体１の静止時：
加速度センサ１９から各軸方向の重力加速度が出力される。その値から傾斜角度演算手段２２で傾斜角度を算出し、傾斜方向演算手段２３で傾斜方向を算出する。
移動体１の走行時：
車輪回転速度センサ２０が検出する移動体１の車輪回転速度、角速度センサ２１が検出する移動体１の角速度の値から、車両加速度を車両加速度演算手段２５で算出し、算出した車両加速度を加速度センサ１９から出力される各軸方向の加速度から引き、傾斜角度、傾斜方向を算出する。
・警告角度
制御手段２６が警告判定を行う時の閾値となる傾斜角度を表す。
・警告判定
算出された傾斜角度が閾値の警告角度よりも大きいかどうかの判定を表す。また、警告角度は、加速度や車両加速度、傾斜方向等から算出する。
・警告実施、警告未実施
警告判定で警告実施と判断された場合に警告手段２７で警告を行うことを表す。警告判定で警告実施と判断されなかった場合は、警告未実施となる。

図４に示すように、移動体１の制御装置１８は、前記定義した車両加速度、傾斜方向、傾斜角度、加速度方向及び加速度の大きさを用いて警告角度を設定し、警告判定により警告実施か警告未実施かを判断する。
制御装置１８は、加速度センサ１９が検出する移動体１の各軸ｘ、ｙ、ｚの加速度を入力し、車輪回転速度センサ２０が検出する移動体１の車輪回転速度を入力し、角速度センサ２１が検出する移動体１の角速度を入力する。
制御装置１８は、車両加速度演算手段２５により移動体１の速度、角速度から車両加速度（図３）を算出し、傾斜角度演算手段２２、傾斜方向演算手段２３により移動体１の静止時には移動体１の各軸ｘ、ｙ、ｚの重力加速度から傾斜角度、傾斜方向を算出するとともに移動体１の走行時には車両加速度と移動体１の各軸ｘ、ｙ、ｚの加速度とから傾斜角度、傾斜方向（図２）を算出し、加速度演算手段２４により移動体１の各軸ｘ、ｙ、ｚの加速度から移動体１の加速度方向及び加速度の大きさ（図３）を算出する。
制御装置１８は、制御手段２６によって、算出された傾斜方向、傾斜角度、加速度方向及び加速度の大きさの少なくとも一つに基づいて警告角度を設定し、算出された傾斜角度と設定された警告角度とを比較して警告実施か警告未実施かを判断し、算出された傾斜角度が警告角度よりも大きくなった時に警告手段２７により警告する。

前記移動体１の制御装置１８は、実施例１において、傾斜方向により警告角度を設定し、警告判定を行う。
すなわち、制御装置１８は、制御手段２６によって、傾斜方向演算手段２３により算出された傾斜方向に基づいて警告角度を設定し、傾斜角度演算手段２２により算出された傾斜角度が前記設定した警告角度よりも大きくなった時に、警告手段２７により警告する。
警告角度の設定は、移動体１の倒れやすい方向を小さくし、倒れにくい方向を大きくすることが望ましい。一般的に、移動体１は左右方向の方が倒れやすく、前後方向が倒れにくい構造であるため、図５に示すように、移動体１の左右方向（傾斜方向がｘ軸方向の角度０°、１８０°、３６０°）の警告角度を小さくし、前後方向（傾斜方向がｙ軸方向の角度９０°、２７０°）の警告角度を大きく設定する。
移動体１の倒れやすい方向は、構造によって異なることから、図５に示すような設定に限られるものではない。移動体１の構造によって、傾斜方向が角度９０°の場合と角度２７０°の場合とでは警告角度の設定を異ならせてもよい。
加速度センサ１９が１軸の検出軸を有する場合は、傾斜方向は軸方向しか分からない。よって、前後方向に検出軸がある１軸の加速度センサ１９の場合は、図６に示すように、傾斜方向が前後方向の９０°と２７０°との１点ずつに警告角度を設定するようになる。加速度センサ１９が１軸の場合でも、効果はある。加速度センサ１９が１軸の検出軸を有する場合であっても、移動体１の構造によって、傾斜方向が角度９０°の場合と角度２７０°の場合とでは警告角度の設定を異ならせてもよい。

次に、実施例１の作用を説明する。
移動体１の制御装置１８は、前記図４に示すように、加速度センサ１９が検出する移動体１の各軸ｘ、ｙ、ｚの加速度を入力し、車輪回転速度センサ２０が検出する移動体１の車輪回転速度を入力し、角速度センサ２１が検出する移動体１の角速度を入力する。
そして、制御装置１８は、車両加速度演算手段２５により車両加速度（図３）を算出し、傾斜角度演算手段２２、傾斜方向演算手段２３により移動体１の静止時、走行時における傾斜角度、傾斜方向（図２）を算出し、加速度演算手段２４により移動体１の加速度方向及び加速度の大きさ（図３）を算出する。
実施例１において、移動体１の制御装置１８は、図７に示すように、傾斜角度演算手段２２、傾斜方向算出手段２３により算出した傾斜角度、傾斜方向（図２）を制御手段２６に取り込み（１０１）、制御手段２６により傾斜方向から警告角度を設定（図５、又は図６）し（１０２）、算出された傾斜角度が設定された警告角度よりも大きくなったかを判断する（１０３）。
この判断（１０３）がＹＥＳの場合は、警告手段２７により運転者に画像、音声等による警告を実施する（１０４）。この判断（１０３）がＮＯの場合は、警告を未実施とする（１０５）。

このように、移動体１の制御装置１８は、移動体１の傾斜角度が移動体１の傾斜方向に基づいて設定した警告角度よりも大きくなった時に警告するので、移動体１の転倒防止のために警告を行う場合、移動体１が警告に適切な傾斜角度に傾斜した時に警告を発することができる。
このため、この移動体１の制御装置１８は、警告を発する時期が遅過ぎて、運転者の対応が間に合わず、意味のない警告になってしまうことがなく、一方、警告を発する時期が早過ぎて、運転者の対応が必要ではない状況で警告を発することがなく、運転者を煩わせることもない。

図１０〜図１２は、実施例２を示すものである。移動体１の制御装置１８は、実施例２において、加速度方向及び加速度の大きさにより警告角度を設定し、警告判定を行う。
すなわち、制御装置１８は、制御手段２６によって、加速度演算手段２４により算出された加速度方向及び加速度の大きさに基づいて警告角度を設定し、傾斜方向演算手段２３により算出された傾斜角度が前記設定した警告角度よりも大きくなった時に、警告手段２７により警告する。
移動体１が一定の傾斜角度にある場合、移動体１が受ける加速度方向及び加速度の大きさによって転倒しやすさが変わることから、加速度方向及び加速度の大きさが閾値以上の場合に警告角度を変更する。閾値は、加速度方向及び加速度から算出する。警告角度は、図１０に示すように、加速度方向から設定された加速度の閾値よりも加速度が大きい場合の値がａの領域と、加速度方向から設定された加速度の閾値よりも加速度が小さい場合の値がｂの領域と、に設定する（ｂ＞ａ）。
警告角度の設定は、移動体１の倒れやすい方向を小さくし、倒れにくい方向を大きくすることが望ましい。一般的に、移動体１は左右方向の方が倒れやすく、前後方向が倒れにくい構造であるため、図１０のような関係になる。加速度方向による移動体１の転倒のしやすさは構造によって異なることから、図１０のような設定に限られるものではない。移動体１の構造によって、傾斜方向が９０°の場合と２７０°の場合とでは警告角度を変更する閾値を異ならせてもよい。
加速度センサ１９が１軸の検出軸を有する場合は、傾斜方向は軸方向しか分からない。よって、前後方向に検出軸がある１軸の加速度センサ１９の場合は、図１１に示すように、傾斜方向が前後方向の９０°と２７０°との１点ずつに警告角度を設定するようになる。図１１においては、加速度方向から設定された加速度の閾値の点よりも加速度が大きい場合の警告角度がａの領域と、加速度方向から設定された加速度の閾値の点よりも加速度が小さい場合の警告角度がｂの領域と、に設定する（ｂ＞ａ）。加速度センサ１９が１軸の場合でも、効果はある。閾値を算出するための加速度方向及び加速度は、車両加速度方向及び車両加速度とすることもできる。加速度センサ１９が１軸の検出軸を有する場合であっても、移動体１の構造によって、傾斜方向が９０°の場合と２７０°の場合とでは警告角度を変更する閾値を異ならせてもよい。

次に、実施例２の作用を説明する。
移動体１の制御装置１８は、前記図４に示すように、加速度センサ１９が検出する移動体１の各軸ｘ、ｙ、ｚの加速度を入力し、車輪回転速度センサ２０が検出する移動体１の車輪回転速度を入力し、角速度センサ２１が検出する移動体１の角速度を入力する。
そして、制御装置１８は、車両加速度演算手段２５により車両加速度（図３）を算出し、傾斜角度演算手段２２、傾斜方向演算手段２３により移動体１の静止時、走行時における傾斜角度、傾斜方向（図２）を算出し、加速度演算手段２４により移動体１の加速度方向及び加速度の大きさ（図３）を算出する。
実施例２において、移動体１の制御装置１８は、図１２に示すように、傾斜角度演算手段２２、傾斜方向算出手段２３により算出した傾斜角度、傾斜方向（図２）と、加速度演算手段２４により算出した加速度方向及び加速度の大きさ（図３）とを制御手段２６に取り込み（２０１）、制御手段２６により加速度方向から加速度の閾値（図１０、又は図１１）を設定し（２０２）、加速度が閾値よりも大きいかを判断する（２０３）。
この判断（２０３）がＹＥＳの場合は、警告角度をａに設定し（２０４）、算出された傾斜角度が設定された警告角度（ａ）よりも大きくなったかを判断する（２０５）。この判断（２０３）がＮＯの場合は、警告角度をｂに設定し（２０６）、算出された傾斜角度が設定された警告角度（ｂ）よりも大きくなったかを判断する（２０５）。
前記判断（２０５）がＹＥＳの場合は、警告手段２７により運転者に画像、音声等による警告を実施する（２０７）。この判断（２０５）がＮＯの場合は、警告を未実施とする（２０８）。

このように、移動体１の制御装置１８は、移動体１の傾斜角度が移動体１の加速度方向及び加速度の大きさに基づいて設定した警告角度よりも大きくなった時に警告するので、移動体１の転倒防止のために警告を行う場合、移動体１が警告に適切な傾斜角度に傾斜した時に警告を発することができる。
このため、この移動体１の制御装置１８は、警告を発する時期が遅過ぎて、運転者の対応が間に合わず、意味のない警告になってしまうことがなく、一方、警告を発する時期が早過ぎて、運転者の対応が必要ではない状況で警告を発することがなく、運転者を煩わせることもない。

図１３は、実施例３を示すものである。移動体１の制御装置１８は、実施例３において、傾斜方向と加速度方向と加速度とにより警告角度を設定し、警告判定を行う。
移動体１の制御装置１８は、前記図４に示すように、加速度センサ１９が検出する移動体１の各軸ｘ、ｙ、ｚの加速度を入力し、車輪回転速度センサ２０が検出する移動体１の車輪回転速度を入力し、角速度センサ２１が検出する移動体１の角速度を入力する。
そして、制御装置１８は、車両加速度演算手段２５により車両加速度（図３）を算出し、傾斜角度演算手段２２、傾斜方向演算手段２３により移動体１の静止時、若しくは走行時における傾斜角度、傾斜方向（図２）を算出し、加速度演算手段２４により移動体１の加速度方向及び加速度の大きさ（図３）を算出する。
実施例３において、移動体１の制御装置１８は、図１３に示すように、加速度演算手段２４により算出した加速度方向及び加速度の大きさ（図３）と、傾斜角度演算手段２２、傾斜方向算出手段２３により算出した傾斜角度、傾斜方向（図２）とを制御手段２６に取り込み（３０１）、制御手段２６により傾斜方向から警告角度をＡに設定（図５、又は図６）し、加速度方向から加速度の閾値（図１０、又は図１１）を設定し（３０２）、加速度が閾値よりも大きいかを判断する（３０３）。
この判断（３０３）がＹＥＳの場合は、警告角度をＡから設定値αを引いた値に設定し（３０４）、算出された傾斜角度が設定された警告角度（Ａ−α）よりも大きくなったかを判断する（３０５）。この判断（３０３）がＮＯの場合は、警告角度をＡに設定し（３０６）、算出された傾斜角度が設定された警告角度（Ａ）よりも大きくなったかを判断する（３０５）。
前記判断（３０５）がＹＥＳの場合は、警告手段２７により運転者に画像、音声等による警告を実施する（３０７）。この判断（３０５）がＮＯの場合は、警告を未実施とする（３０８）。

このように、制御装置１８は、傾斜方向を用いて図５、又は図６に示すマップから警告角度をＡに設定し、加速度と加速度方向を用いて図１０、又は図１１に示すマップから加速度の閾値を設定し、加速度が閾値よりも大きい場合は警告角度をＡから設定値αだけ低くした値にし、加速度が閾値よりも小さい場合は警告角度をＡのままの値にする。
制御装置１８は、閾値により設定された警告角度と移動体１の傾斜角度とを比較して警告判定し、警告の実施、未実施を判定する。閾値を出すための加速度、加速度方向は、車両加速度、車両加速度方向とすることもできる。
これにより、移動体１の制御装置１８は、移動体１の傾斜角度が移動体１の傾斜方向と加速度方向と加速度とに基づいて設定した警告角度よりも大きくなった時に警告するので、移動体１の転倒防止のために警告を行う場合、移動体１が警告に適切な傾斜角度に傾斜した時に警告を発することができる。
このため、この移動体１の制御装置１８は、警告を発する時期が遅過ぎて、運転者の対応が間に合わず、意味のない警告になってしまうことがなく、一方、警告を発する時期が早過ぎて、運転者の対応が必要ではない状況で警告を発することがなく、運転者を煩わせることもない。

なお、この発明は上述実施例に限定されるものではなく、種々応用改変が可能である。
例えば、前述実施例２では、図１０に示すように、１つの閾値により警告角度の値をａ、ｂの２つの領域に設定したが、図１４、図１５に示す変形例１のように、２つの閾値により３つの領域の警告角度を設定することもできる。
図１４に示すように、変形例１において、警告角度は、加速度の閾値を大小二つ第１閾値、第２閾値に設定し、第１閾値よりも加速度が大きく且つ第２閾値よりも加速度が小さい場合の値がａの領域と、第１閾値よりも加速度が小さい場合の値がｂの領域と、第２閾値よりも加速度が大きい場合の値がｃの領域と、に設定する（ｂ＞ａ＞ｃ）。
移動体１の制御装置１８は、前記図４に示すように、加速度センサ１９が検出する移動体１の各軸ｘ、ｙ、ｚの加速度を入力し、車輪回転速度センサ２０が検出する移動体１の車輪回転速度を入力し、角速度センサ２１が検出する移動体１の角速度を入力する。
そして、制御装置１８は、車両加速度演算手段２５により車両加速度（図３）を算出し、傾斜角度演算手段２２、傾斜方向演算手段２３により移動体１の静止時、走行時における傾斜角度、傾斜方向（図２）を算出し、加速度演算手段２４により移動体１の加速度方向及び加速度の大きさ（図３）を算出する。

変形例１において、移動体１の制御装置１８は、図１５に示すように、傾斜角度演算手段２２、傾斜方向算出手段２３により算出した傾斜角度、傾斜方向（図２）と、加速度演算手段２４により算出した加速度方向及び加速度の大きさ（図３）とを制御手段２６に取り込み（４０１）、制御手段２６により加速度が第１閾値（図１４）よりも大きいかを判断する（４０２）。
この判断（４０２）がＹＥＳの場合は、警告角度をａに設定し（４０３）、加速度が第２閾値（図１４）よりも大きいかを判断する（４０４）。この判断（４０４）がＹＥＳの場合は、警告角度をｃに設定し（４０５）、算出された傾斜角度が設定された警告角度（ｃ）よりも大きくなったかを判断する（４０６）。
一方、前記判断（４０２）がＮＯの場合は、警告角度をｂに設定し（４０７）、算出された傾斜角度が設定された警告角度（ｂ）よりも大きくなったかを判断する（４０６）。また、前記判断（４０４）がＮＯの場合は、警告角度をａに設定し（４０８）、算出された傾斜角度が設定された警告角度（ａ）よりも大きくなったかを判断する（４０６）。
前記判断（４０６）がＹＥＳの場合は、警告手段２７により運転者に画像、音声等による警告を実施する（４０９）。この判断（４０６）がＮＯの場合は、警告を未実施とする（４１０）。

このように、移動体１の制御装置１８は、移動体１の加速度方向及び加速度の大きさに基づいて２つの閾値による３つの領域から警告角度を設定し、移動体１の傾斜角度が設定された警告角度よりも大きくなった時に警告するので、移動体１の転倒防止のために警告を行う場合、移動体１が警告に適切な傾斜角度に傾斜した時に警告を発することができ、さらに、警告角度をより細かく設定することができるので、より適切な傾斜角度に傾斜した時に警告を発することができる。
このため、この移動体１の制御装置１８は、警告を発する時期が遅過ぎて、運転者の対応が間に合わず、意味のない警告になってしまうことがなく、一方、警告を発する時期が早過ぎて、運転者の対応が必要ではない状況で警告を発することがなく、運転者を煩わせることもない。

また、前述実施例２では警告角度の値をａ、ｂの２つの領域に設定し、また、前述変形例１では警告角度の値をａ、ｂ、ｃの３つの領域に設定したが、図１６に示すように、警告角度を傾斜方向、加速度方向、加速度という変数によって決まる変数として設定することもできる。
図１６に示すように、変形例２において、警告角度は、加速度ｎ、傾斜方向θａ、加速度方向θｂの変数により決まる変数Ａとして設定する。閾値を出すための加速度、加速度方向は、車両加速度、車両加速度方向とすることもできる。
移動体１の制御装置１８は、前記図４に示すように、加速度センサ１９が検出する移動体１の各軸ｘ、ｙ、ｚの加速度を入力し、車輪回転速度センサ２０が検出する移動体１の車輪回転速度を入力し、角速度センサ２１が検出する移動体１の角速度を入力する。
そして、制御装置１８は、車両加速度演算手段２５により車両加速度（図３）を算出し、傾斜角度演算手段２２、傾斜方向演算手段２３により移動体１の静止時、走行時における傾斜角度、傾斜方向（図２）を算出し、加速度演算手段２４により移動体１の加速度方向及び加速度の大きさ（図３）を算出する。

変形例２において、移動体１の制御装置１８は、図１６に示すように、傾斜角度演算手段２２、傾斜方向算出手段２３により算出した傾斜角度、傾斜方向（θａ）（図２）と、加速度演算手段２４により算出した加速度方向（θｂ）及び加速度（ｎ）の大きさ（図３）とを制御手段２６に取り込み（５０１）、制御手段２６により加速度（ｎ）、傾斜方向（θａ）、加速度方向（θｂ）の変数により決まる変数として警告角度Ａ（ｎ、θａ、θｂ）を設定する（５０２）。
そして、算出された傾斜角度が設定された警告角度Ａ（ｎ、θａ、θｂ）よりも大きくなったかを判断する（５０３）。
この判断（５０３）がＹＥＳの場合は、警告手段２７により運転者に画像、音声等による警告を実施する（５０４）。この判断（５０３）がＮＯの場合は、警告を未実施とする（５０５）。なお、加速度方向及び加速度を車両加速度方向及び車両加速度としてもよい。

このように、移動体１の制御装置１８は、移動体１の挙動を現す加速度、傾斜方向、加速度方向の変数により決まる変数として警告角度を設定し、移動体１の傾斜角度が設定された警告角度よりも大きくなった時に警告するので、移動体１の転倒防止のために警告を行う場合、移動体１が警告に適切な傾斜角度に傾斜した時に警告を発することができ、さらに、警告角度を移動体１の挙動に対応させて設定することができるので、より適切な傾斜角度に傾斜した時に警告を発することができる。
このため、この移動体１の制御装置１８は、警告を発する時期が遅過ぎて、運転者の対応が間に合わず、意味のない警告になってしまうことがなく、一方、警告を発する時期が早過ぎて、運転者の対応が必要ではない状況で警告を発することがなく、運転者を煩わせることもない。

この発明は、転倒防止のための警告に適切な傾斜角度に移動体が傾斜した時に警告を発することができるものであり、駆動源により車輪を駆動して乗車した運転者が走行させる移動体であれば、電動車椅子やシニアカーに限らず適用が可能である。

１ 移動体
１８ 制御装置
１９ 加速度センサ
２０ 車輪回転速度センサ
２１ 角速度センサ
２２ 傾斜角度演算手段
２３ 傾斜方向演算手段
２４ 加速度演算手段
２５ 車両加速度演算手段
２６ 制御手段
２７ 警告手段

Claims (3)

1. 車輪と、この車輪を駆動する駆動源と、運転者が着座する座席とを備えた移動体の制御装置であって、前記移動体の傾斜角度を算出する傾斜角度演算手段と、前記移動体の傾斜方向を算出する傾斜方向演算手段と、運転者に警告する警告手段と、前記傾斜方向演算手段により算出された傾斜方向に基づいて警告角度を設定し、前記傾斜角度演算手段により算出された傾斜角度が前記警告角度よりも大きくなった時に前記警告手段により警告する制御手段とを備えることを特徴とする移動体の制御装置。
2. 車輪と、この車輪を駆動する駆動源と、運転者が着座する座席とを備えた移動体の制御装置であって、前記移動体の傾斜角度を算出する傾斜角度演算手段と、前記移動体の加速度方向及び加速度の大きさを算出する加速度演算手段と、運転者に警告する警告手段と、前記加速度演算手段により算出された加速度方向及び加速度の大きさに基づいて警告角度を設定し、前記傾斜角度演算手段により算出された傾斜角度が前記警告角度よりも大きくなった時に前記警告手段により警告する制御手段とを備えることを特徴とする移動体の制御装置。
3. 移動体の加速度方向及び加速度の大きさを算出する加速度演算手段を備え、前記制御手段は、前記傾斜方向演算手段により算出された傾斜方向と、前記加速度演算手段により算出された加速度方向及び加速度の大きさとに基づいて警告角度を設定し、前記傾斜角度演算手段により算出された傾斜角度が前記警告角度よりも大きくなった時に前記警告手段により警告することを特徴とする請求項１に記載の移動体の制御装置。

Images