WO2007063665A1

WO2007063665A1 - 転倒防止制御装置

Info

Publication number: WO2007063665A1
Application number: PCT/JP2006/321616
Authority: WO
Inventors: Atsuhiko Hirata
Original assignee: Murata Manufacturing Co., Ltd.
Priority date: 2005-12-01
Filing date: 2006-10-30
Publication date: 2007-06-07
Also published as: JPWO2007063665A1; US20080228357A1; JP4605227B2; KR20080059293A; US7643933B2; EP1955936B1; EP1955936A1; EP1955936A4; KR100958531B1; CN101296838A; CN101296838B

Description

明細書

転倒防止制御装置

技術分野

[0001] 本発明は、例えば二輪車や二足歩行ロボットのように左右に傾き自在な本体を転倒しないようにバランス制御する転倒防止制御装置に関するものである。

背景技術

[0002] 特許文献 1には、操舵部と、操舵部によって操舵可能な前輪と、後輪と、前輪 (ハンドル)の向きに応じて揺動するフライホイールと、フライホイールを駆動させる第 1駆動部と、後輪を駆動させる第 2駆動部とを備えた二輪車走行玩具が提案されている。この二輪車では、前輪の向きに応じてフライホイールの向きを変えることによって、フラィホイールによるジャイロ効果によって、走行中に転倒し難くしたものである。

[0003] しかしながら、前記二輪車走行玩具の場合、前輪の向きに応じてフライホイールの向きを変えるに過ぎないので、通常走行中であればノヽンドル操作によって転倒は防止できても、停止時ゃ微速進行時には、ハンドル操作だけでバランスを取ることは困難であり、転倒を有効に防止できな、と、う問題がある。

[0004] 特許文献 2では、傾き検出センサで検出した傾きを制御回路に入力し、制御回路にてモータを駆動し、モータで慣性の大きな回転体を回転させて傾きを補正すべき方向と逆方向に回転体の回転数を上げて反作用偶力を発生させることにより、転倒を防止する倒立制御玩具が提供されている。この倒立制御玩具では、回転体の回転を制御することでバランスを取るため、停止時ゃ微速進行時でも転倒を防止することが可能である。

[0005] 前記倒立制御玩具では、玩具の傾きを検出する傾き検出センサとして、発光素子から送出されて床面で反射された光を受光素子で受光することにより、傾きを検出する光センサを用いている。し力しながら、実際には傾きを正確に測定することは容易ではない。すなわち、発光素子と受光素子とを用いた傾きセンサの場合、光を反射すべき床面が平坦であれば問題はないが、床面に凹凸があったり、両側部に床面が存在しない場合 (幅狭な橋の上を渡る場合など）には、傾きを正確に検出できない。 [0006] さらに、前記倒立制御玩具では、真っ直ぐに立った状態の受光量を標準値として差分を取ることで傾きを検出しているが、真っ直ぐに立った状態 (鉛直方向）がバランスの取れた状態とは限らない。例えば、玩具の重心位置が中心位置より左右にずれている場合や、横風を受けている場合には、鉛直方向に対してやや傾いた状態がバランスの取れた状態であり、そのノ《ランスの取れた状態 (角度)を標準位置とすべきであるのに拘わらず、上記の方法では鉛直方向を標準位置としているため、バランスを保つことができず、転倒してしまう可能性がある。

[0007] ところで、本体の傾きを検出する方法として、角速度センサを用いて角速度を検出し、その検出値を積分することで、傾きを推定することも可能である。しかしながら、角速度出力を積分する方法では、ノイズやオフセットが累積し、傾斜角推定と転倒防止制御とを継続できなくなるという問題が発生する。さらに、他の傾き検出装置としてゥェイトを用いた傾きセンサもある力この場合もバランス状態に対する傾きは検出できず、し力も応答性が悪ぐ瞬時に傾きを検出できないという欠点がある。

特許文献 1 :特開 2003— 190654号公報

特許文献 2：特開平 11—47454号公報

発明の開示

発明が解決しょうとする課題

[0008] そこで、本発明の目的は、ノランスの取れた状態力もの傾斜角を正確に推定でき、かつノイズやオフセットが累積せず、傾斜角推定と転倒防止制御とを継続できる転倒防止制御装置を提供することにある。

課題を解決するための手段

[0009] 上記目的を達成するため、本発明は、左右に傾き自在な本体と、前記本体に略前後方向に検出軸を向けて取り付けた角速度センサと、前記本体に略前後方向に回転軸を向けて取り付けたモータと、前記モータの回転位置または回転速度を検出する回転センサと、前記モータの回転軸に連結された慣性ロータとを備え、前記モータで慣性ロータを回転させ、前記慣性ロータの回転に伴う反動トルクを利用して前記本体の傾きを補正する転倒防止制御装置であって、前記角速度センサの角速度出力 ω

1 と前記モータに与えるトルク指令 τ とから、釣合い状態に対する前記本体の傾斜角を推定する傾斜角推定手段を備え、前記傾斜角推定手段により推定された傾斜角推定値を用いて前記本体の傾きを補正することを特徴とするものである。

[0010] 本発明に係る転倒防止制御装置の作動原理は、特許文献 2と同様に、モータで慣性ロータを回転させ、前記慣性ロータの回転に伴う反動トルクを利用して前記本体の傾きを補正するものであるが、補正に際して傾斜角を精度よく検出する必要がある。本発明では、傾斜角をセンサで直接検出するのではなぐまた角速度センサの角速度出力を積分して求めるものでもない。すなわち、角速度センサの角速度出力 ω とモ

1 ータに与えるトルク指令 τ とから傾斜角を推定する。ここで、傾斜角とは、重力によ

0

るトルク、およびカーブ走行による遠心力や、横風などによる外乱トルクの合計がゼロになる釣合い状態における本体の姿勢力の偏差角度である。傾斜角推定値を用いて慣性ロータの回転を制御し、傾斜角力^に収束するようにモータトルク制御を繰り返す。例えば、本体のバランス軸に対して、傾斜角が本体正面からみて左方向の場合は、バランス姿勢を維持するためには、本体正面からみて左回転方向に慣性ロータを加速する。逆に、傾斜角が本体正面力もみて右方向の場合は、バランス姿勢を維持するためには、本体正面からみて右回転方向に慣性ロータを加速する。

[0011] 本発明では、本体の傾斜角を検出するために、傾き検出センサを用いないので、床面に凹凸がある場合や、平均台のように両側部に床面が存在しない場合でも、正確に傾きを推定できる。また、角速度センサの角速度出力を積分する必要がないため、角速度センサの出力にノイズやオフセットが含まれる場合でも、傾斜角推定を継続でき、転倒防止制御を継続できる。さらに、従来のウェイトを用いた傾きセンサに比べて遙に応答性がよぐ傾きを精度よく推定できる。このように本発明では、バランス軸からの本体の傾斜角を高精度にかつ応答よく推定できるので、この傾斜角に応じてモータにカ卩えるトルクを高精度に制御できる。モータによって慣性ロータにカ卩えられるトルクの反動トルクにより、本体の転倒を防ぐ方向に本体の傾斜角を精度よく制御することができる。その結果、停止状態ゃ微速進行状態でも倒れない不倒体を作ることができる。

[0012] 好ましい実施の形態によれば、目標傾斜角力前記傾斜角推定値を減じた傾斜角偏差信号を用いて、傾斜角速度指令 ω を生成する傾斜角速度指令生成手段と、前記傾斜角速度指令 ω から前記角速度センサの角速度出力 ω を減じた傾斜角

2 1

速度偏差信号 ω — ω を用いて、前記モータに与えるトルク指令 τ を生成するト

2 1 0

ルク指令生成手段と、を備えるのが望ましい。本発明では、まず目標傾斜角を設定し、この目標傾斜角から傾斜角推定値を差し引いて傾斜角偏差信号を求め、この偏差信号から本体に対する傾斜角速度指令 ω を生成する。次に、傾斜角速度指令 ω

2 2 から角速度センサの角速度出力 ω を減じた傾斜角速度偏差信号 ω — ω を用い

1 2 1 て、モータに与えるトルク指令 τ を生成することができる。

0

[0013] 好ましい実施の形態によれば、傾斜角推定値力も本体を倒そうとする外部トルクを推定する外部トルク推定手段と、外部トルク推定値 τ を用いてトルク指令 τ を外部ト

3 0 ルクが相殺される方向に補正するトルク補正手段と、を備えるのがよい。外部トルクとは、本体がバランス軸から傾くことによって本体に加わる重力、および外乱による傾き方向のトルクのことである。外部トルクをフィードフォワード制御で補償することにより、傾斜角ループと、傾斜角速度ループの応答周波数が低い場合でも、転倒防止制御を継続することができるため、安定な制御が可能となる。

[0014] 好ましい実施の形態によれば、目標傾斜角を、モータの回転速度を用いて、かつ回転速度が減少する方向に生成する目標傾斜角生成手段を備えるのがよい。重力トルクを利用して慣性ロータのもつ角運動量を放出できるため、モータの回転速度が飽和することがなぐ制御を継続できる。

[0015] 本発明に係る転倒防止制御装置を、自立走行二輪車に適用することができる。この二輪車は、操舵部と、操舵部によって操舵可能な前輪と、後輪と、後輪を駆動させる後輪駆動部と、前輪および後輪を回転自在に支持するフレームとを持ち、この二輪車の転倒防止制御に本発明を適用することで、走行中は勿論、停止時ゃ微速進行時でも倒れない二輪車を提供できる。なお、本発明の転倒防止制御を停止時ゃ微速進行時のみ使用し、走行中は慣性ロータを回転させずに、操舵部を操作すること〖こよりバランスを取ることが可能である。

発明の効果

[0016] 以上のように、本発明によれば、角速度センサの角速度出力とモータトルク指令とから釣合い状態に対する傾斜角を推定するようにしたので、従来の傾き検出センサを用いた場合と異なり、床面に凹凸があったり、平均台のように周囲に床面が存在しなくても、あるいは床面が若干傾斜していたとしても、正確に釣り合い状態に対する傾斜角を推定できる。また、角速度センサの角速度出力を積分する必要がないため、角速度センサの出力にノイズやオフセットが含まれる場合でも、傾斜角推定を継続でき、転倒防止制御を継続できる。さらに、従来のウェイトを用いた傾きセンサに比べて遙に応答性がよぐ傾きを精度よく推定できる。したがって、モータトルクに加えるトルクを高精度に制御でき、停止状態ゃ微速進行状態でも倒れな!ヽ転倒防止制御装置を実現できる。

発明を実施するための最良の形態

[0017] 以下に、本発明の好ましい実施の形態を図面を参照して説明する。

[0018] (第 1実施形態）

図 1〜図 3は本発明にかかる転倒防止制御装置を自転車ロボットに適用した第 1実施形態を示す。

[0019] この自転車ロボット Aは、操舵用ハンドル 1と、操舵用ハンドル 1によって操舵可能な前輪 2と、後輪 3と、後輪 3を駆動させる後輪駆動モータ 4と、前輪 2および後輪 3を回転自在に支持するフレーム 5と、フレーム 5上に搭載された人形 6を備えている。フレーム 5には、傾斜角速度を測定するジャイロセンサ (角速度センサ） 7がその検出軸を自転車 Aの略前後方向に向けて取り付けられて、る。人形 6の胸部には慣性ロータ 8 と、慣性ロータ 8を駆動するバランス用モータ 9と、ノ《ランス用モータ 9の回転角度を測定するエンコーダ 10とが取り付けられている。慣性ロータ 8およびモータ 9の回転軸も自転車 Aの略前後方向に向けて取り付けられている。ここで、略前後方向とは、厳密な前後方向に対して上下に若干角度ずれていてもよい。人形 6の背中には、バランス用モータ 9を制御する制御基板 11および電池 12が装備されて、る。制御基板 11には、モータ 9を駆動するドライノく、 A/Dコンバータ、 D/Aコンバータ、カウンタ、コントローラなどが搭載されて、る。

[0020] 通常の走行中は、ハンドル 1を操舵することでバランスをとり、転倒を防止する。一方、停止状態ゃ微速進行状態では、ハンドル 1の操舵だけでバランスをとることは困難であるため、慣性ロータ 8を駆動するときの反動を利用してバランスをとるように制御している。

[0021] 自転車ロボット Aは図 3に示す制御ブロックによって制御される。この制御ブロックは制御基板 11に格納されたブロックの一例である。まず、カウンタ部 20では、ェンコ一ダ 10の出力パルスが計数される。モータ速度計算部 21では、カウンタ部 20の出力を回転角度に変換したあと、微分してバランス用モータ 9の回転速度を求める。ノイズ除去のための LPF (ローパスフィルタ）を装備してもよ、。

[0022] 目標傾斜角生成部 22は、バランス用モータ 9の回転速度が自転車正面力も見て左回転の場合は目標傾斜角を自転車正面から見て右方向に、バランス用モータ 9の回転速度が自転車正面から見て右回転の場合は目標傾斜角を自転車正面から見て左方向になるように、バランス用モータ 9の回転速度に比例係数をかけて求める。なお、積分器を追加して、慣性ロータ 8に定常回転が残留しな!、ようにするのがよ!/、。

[0023] 一方、 AZD部 23では、ジャイロセンサ 7の角速度出力を測定する。傾斜角速度計算部 24では、角速度出力に変換係数をかけて、傾斜角速度 ω を計算する。

1

[0024] 傾斜角推定部 25では、傾斜角速度 ω とモータトルク指令 τ とから、自転車本体（

1 2

慣性ロータ以外の部分)と慣性ロータ 8を含んだ系の傾斜角方向の運動方程式に基づき導出された、後述の (式 18)で表される傾斜角を計算し、さらに適切な推定速度を持たせてループを安定ィ匕させるための一次遅れ要素を直列に加えることで、傾斜角推定値を算出している。具体的には、（式 18)を用いた計算値に、一次遅れ要素として例えば 1Z (0. 1S + 1)を直列にカ卩えることになる力これに限られるものではなぐ適切な推定速度となるような任意の遅れ要素を加えることができる。ここで、傾斜角とは、重力によるトルク、およびカーブ走行による遠心力や横風などによる外乱トルクの合計がゼロになる釣合い状態における本体の姿勢力の偏差角度である。

[0025] 補正トルク指令生成部 26では、傾斜角推定値に変換係数をかけて、自転車に働いている外部トルク推定値を算出し、補正トルク（=外部トルク推定値） τ を生成する。

3

[0026] 目標傾斜角速度生成部 27では、目標傾斜角と傾斜角推定値の偏差に比例ゲインをかけて、目標傾斜角速度 ω を生成する。

2

[0027] トルク指令生成部 28では、目標傾斜角速度 ω と傾斜角速度 ω の偏差に対して、

2 1

例えば ΡΙ制御によりトルク指令 τ を生成する。モータトルク指令電圧計算部 29では、トルク指令 τ と補正トルク τ とを加えたモータトルク指令 τ に対して、変換係数

0 3 2

をかけて、指令電圧を生成する。最後に、 DZA部 30ではドライバに指令電圧を出力し、ノ一一一¾ ¾ひひァ Γ_ .21ランス用モータ 9の回転を制御する。

[0028] ここで、（式 18)で表わされる推定傾斜角の計算式の導出方法について、以下に説明する。

[0029] 図 4は、慣性ロータ 8を含む自転車ロボット Αを前方から見たモデルを示す。まずラグランジュ方程式により、運動方程式を導出する。自転車本体 (慣性ロータ以外の部分 )と慣性ロータ 8を合わせた、全体の運動エネルギー Tと位置エネルギー Uは以下のようになる。

[数 1]

(式 1 )

U = \m_xl_G + m₂l )gcose_{ (式 2 )

[0030] 一般化座標と一般ィ匕速度による微分量は、以下のようになる。

[数 2] …… (式 3 )

(式 4 )

= 0 (式 5 ) = 0 (式 6 )

= -{m_xl_G + m₂l)gsme (式 7 )

= 0 (式 8 ) ラグランジュ方程式 (式 9)、（式 10)に (式 3)〜 (式 8)を代入する。

[数 3]

(式 9 ) (式 1 0 )

この結果、運動方程式として、次の（式 11)、（式 12)を得る。

[数 4]

IA + 1₂ (θ_] + θ )+ m₂l²0_i - («i,/_G + w₂/)gsin = Γ,

1₂(θ +θ₂)=τ₂

(式 12)を変形すると、（式 13)となる。

[数 5]

これを（式 11)に代入し、 sin0 を Θ で近似すると、

1 1

[数 6]

(/, + m₂l² )θ - ん + m₂l)_ge_i =r, -τ₂ を得る。（式 14)より、本体の運動は、慣性ロータ 8の角度と角速度には無関係となる

[0031] 一本体傾斜角の推定

本体傾斜角は、ジャイロセンサ 7の出力の積分で求めることも可能であるが、偏差が累積して不正確になるため、別の方法で求める必要がある。そこで、モデルの運動方程式を用いて、ジャイロセンサ 7が出力する本体傾斜角速度測定値と、モータトルクから、現在の傾斜角を推定する。運動方程式 (式 14)を変形すると、

[数 7] ...... (式 _{1 5 )}

となる。

[0032] 一方、ジャイロセンサ 7が出力する本体傾斜角速度測定値を ω とすると、

1

[数 8] θ ≡ώ …… （式 1 6 ) であり、また外乱トルク τ があるときの、見かけの釣り合い傾斜角度は、

1

[数 9]

(式 1 7 )

(m _G ^+m2^l)g である。従って、見かけの釣り合い傾斜角度に対する現在傾斜角度の偏差は、（式 1 5)より、

[数 10]

(式 1 8 )

で推定することが出来る。ただし、適切な推定速度を持たせてループを安定化させるために、一次遅れ要素を直列に加えておくのがよい。

[0033] 一外部トルクフィードフォワード

(式 18)で推定された偏差角度によって、外部トルクを補償する。

[数 11] (m a ⁺ⁿ !)gA (式 1 9 ) として、トルクにカ卩えておく _c

[数 12]

T₂ =t₂+ τ₂ (式 2 0 ) とすれば、運動方程式 (式 14)は、

[数 13]

[Ι,+ηι₂1²)θ =-τ₂ …… （式 2 1 ) となるから、外部トルクを補償できる。

[0034] 目標傾斜角度生成運動方程式第 2式（式 1 3 ) を積分した形で、慣性ロータ 8の回転速度が累積されていく。モータの回転速度にリミットがあるため、蓄積された回転速度を重力トルクを利用して放出するように、位置制御による補償を行う必要がある。そこで、目標傾斜角を以下のように決定した。

[0035] 重力トルクにより回転速度を放出している間、仮に、傾斜角が一定であったとすると、 [数 14]

=0 …… （式 2 2 ) であるから、運動方程式 (式 14)、（式 13)は、それぞれ (式 23)、（式 24)となる。

[数 15] τ₂ = r, + +m₂l)g0_l = {m_ll_G+m₁l)ge_i (式 2 3 )

^ ^_h_₌ (m_ll_{G +}m₂l)_ge_i …… （式 ₂ ）

[0036] 蓄積された回転速度を時間 τ_Αで放出しょうとする場合、必要な角加速度は、 [数 16] θ^-^- …… （式 2 5 )

Τ_Α であるから、（式 24)と (式 25)を比較して、

[数 17]

~=— _ _ …… （式 ₂ 6 )

+m₂l)g であることが求められる。したがって、位置ループの目標値（目標傾斜角）として、（式 27)を設定すればよい。

[数 18] e_r= -~ _Γ ~ …… （式 2 7 )

mん +^mi^l)g 放出時間 T は、例えば T =lsecなどとすればよい。 [0037] 傾斜角度推定部 25は、原理的に定常偏差が残らないので、目標傾斜角度の生成には積分要素は必要ないが、実際には、慣性ロータ 8に低速の定常回転が残る場合がある。これは、 DZAのオフセットが原因と考えられる。そのままでも問題ないが、目標傾斜角度の生成部分に時定数 10秒程度の積分器を追加すれば、低速の定常回転を解消できる。

[0038] 上記の原理に基づ!/、た慣性ロータを含む自転車ロボットの安定性につ!、て測定した結果を図 5〜図 7に示す。図 5〜図 7は、外乱が印加されていない状態にある自転車ロボットに、指で本体を横向きに押して外乱が印加されたときの応答を示し、図 5はジャイロセンサによる本体角速度、図 6はモータトルク指令（定格トルク Z3V)、図 7は本体傾斜角推定値を示す。なお、サンプリング時間は lmsである。

[0039] 図 7より明らかなように、外乱が印加されるまでの傾斜角推定値は ±0. 05deg以内に安定して維持されており、安定したバランス状態が維持できていることがわかる。さらに、外乱を与えた場合でも、速やかに安定位置に収束していることがわかる。この実験結果から、本実施形態に力かる自転車ロボットは、不倒停止が可能で、外乱 (定常的なステップ状外乱を含む）に対しても対応できることが確認された。

[0040] 以下に、本発明の効果を列記する。

(1)ジャイロセンサ 7の角速度出力を積分せずに、モデルベースで傾斜角を推定するため、ジャイロセンサ 7の出力にノイズやオフセットが含まれる場合でも、傾斜角推定を継続でき、自転車の転倒防止制御を継続できる。従って、停止状態ゃ微速進行状態でも倒れな！/ヽ自転車を作ることが出来る。

(2)ジャイロセンサ 7の出力に基づいて傾斜角を推定し、ノランス用モータで慣性口ータ 8へ加えるトルクの反動を利用して、自転車の傾斜角を制御することができる。従つて、停止状態ゃ微速進行状態でも倒れな！/ヽ自転車を作ることが出来る。

(3)傾斜角推定は、釣り合い位置力の傾斜角を求めるので、重力トルクに加えて、カーブ走行中の遠心力などの外乱トルクがある場合でも、常に釣り合い位置からの傾斜角度によって生じる外部トルクを推定できるので、これを相殺するような補正トルクを算出することができ、外乱トルクがある場合でも本体のバランスを保つことができる。 (4)外部トルクをフィードフォワード制御で補償することにより、傾斜角ループと、傾斜角速度ループの応答周波数が低い場合でも、転倒防止制御を継続することができるため、安定な制御が可能となる。

(5)慣性ロータの回転速度の飽和を防止するように目標傾斜角度を生成するようにしたので、モータ回転速度が飽和する前に傾斜角を変化させ、重力トルクを利用して慣性ロータ 8のもつ角運動量を放出できる。このため、停止状態ゃ微速進行状態でも、転倒防止制御を継続可能な制御装置を製作することが出来る。

[0041] さらに詳しく述べると、以下の通りである。

傾斜角が自転車正面力も見て左方向の場合は、その姿勢を維持するためには、自転車正面から見て左回転方向に慣性ロータ 8を加速する必要がある。傾斜角が自転車正面から見て右方向の場合は、その姿勢を維持するためには、自転車正面から見て右回転方向に慣性ロータ 8を加速する必要がある。このことを利用し、モータ回転速度が大きくなつたときには、積極的に姿勢を傾斜させて、重力トルクを利用して慣性ロータ 8のもつ角運動量を放出し、モータ回転速度を落とすことができる。慣性ロータ 8を回転軸に取り付けたことで、モータ回転速度が飽和するまでの時間に余裕があるため、このような制御が可能となる。

[0042] 目標傾斜角生成は、モータ回転速度が自転車正面力見て左回転の場合は目標傾斜角を自転車正面から見て右方向に、モータ回転速度が自転車正面から見て右回転の場合は目標傾斜角を自転車正面から見て左方向になるように、モータ回転速度に比例係数をかけて求める。また、更に積分器を追加しているため、 DZAコンパ一タのオフセットなどが原因で、定常回転が残留することがな!、。

[0043] 上記実施形態では、自転車ロボットの転倒防止制御について説明したが、本発明はこれのみに限定されるものではなぐ例えば特許文献 2に示されるような倒立玩具や、二足歩行ロボットなどの転倒防止制御にも適用できる。すなわち、二足歩行ロボットの場合、バランス軸からの傾斜角を推定することで、常に安定した歩行を実現できる。さらに、本発明はバイクなどの二輪車のー且停止時における転倒防止制御にも適用できる。また、（18)式で傾斜角偏差を推定する計算式を示したが、これは一例を示すに過ぎず、対象モデルによって傾斜角偏差の推定式は（18)式と異なることがあり得る。

図面の簡単な説明

[図 1]本発明にかかる転倒防止制御装置を適用した自転車ロボットの一実施形態の斜視図である。

[図 2]自転車ロボットの側面図である。

[図 3]自転車ロボットの制御ブロック図である。

[図 4]自転車ロボットの正面からみたモデル図である。

[図 5]外乱印加時のジャイロセンサによる本体角速度測定値である。

[図 6]外乱印加時のモータトルク指令である。

[図 7]外乱印加時の本体傾斜角度推定値である。

符号の説明

A 自転車ロボット (本体）

1 操舵用ハンドル (操舵部）

2 前輪

3 後輪

4 後輪駆動モータ (後輪駆動部)

5 フレーム

6 人形

7 ジャイロセンサ (角速度センサ)

8 慣性ロータ

9 バランス用モータ

10 エンコーダ（回転センサ）

11 制御基板

12 電池

20 カウンタ咅

21 モータ速度計算部

22 目標傾斜角生成部

23 AZD部 24 傾斜角速度計算部

25 傾斜角推定部

26 補正トノレク指令生成部

27 目標傾斜角速度生成部

28 トルク指令生成部

29 モータトルク指令電圧計算部

30 DZA部

O 接地点

o 慣性ロータ中心

m 本体質量

m 慣性ロータ質量

I 〇まわりの本体の慣性モーメント

I 〇まわりの慣性ロータの慣性モーメント

Θ 垂直軸に対する本体の傾斜角度

Θ 本体に対する慣性ロータの回転角度 τ 本体に働く Οまわりの外乱トルクて慣性ロータに働くモータ卜ノレク

1 Οから本体重心位置までの距離

1 οから οまでの距離

g 重力加速度

羞ぇ用紙（規則 26)

Claims

請求の範囲

[1] 左右に傾き自在な本体と、前記本体に略前後方向に検出軸を向けて取り付けた角速度センサと、前記本体に略前後方向に回転軸を向けて取り付けたモータと、前記モータの回転位置または回転速度を検出する回転センサと、前記モータの回転軸に連結された慣性ロータとを備え、前記モータで慣性ロータを回転させ、前記慣性ロータの回転に伴う反動トルクを利用して前記本体の傾きを補正する転倒防止制御装置であって、

前記角速度センサの角速度出力 ω と前記モータに与えるトルク指令 τ とから、釣

1 0 合い状態に対する前記本体の傾斜角を推定する傾斜角推定手段を備え、前記傾斜角推定手段により推定された傾斜角推定値を用いて前記本体の傾きを補正することを特徴とする転倒防止制御装置。

[2] 目標傾斜角から前記傾斜角推定値を減じた傾斜角偏差信号を用ヽて、傾斜角速度指令 ω を生成する傾斜角速度指令生成手段と、前記傾斜角速度指令 ω から前記

2 2 角速度センサの角速度出力 ω を減じた傾斜角速度偏差信号 ω — ω を用いて、

1 2 1 前記モータに与えるトルク指令 τ を生成するトルク指令生成手段と、を備えたことを

0

特徴とする、請求項 1に記載の転倒防止制御装置。

[3] 前記傾斜角推定値力前記本体を倒そうとする外部トルクを推定する外部トルク推定手段と、外部トルク推定値 τ を用いて前記トルク指令 τ を前記外部トルクが相殺さ

3 0

れる方向に補正するトルク補正手段と、を備えたことを特徴とする、請求項 2に記載の転倒防止制御装置。

[4] 前記目標傾斜角を、前記モータの回転速度を用いて、かつ前記回転速度が減少する方向に生成する目標傾斜角生成手段を備えたことを特徴とする、請求項 2または 3 に記載の転倒防止制御装置。

[5] 前記本体は、操舵部と、前記操舵部によって操舵可能な前輪と、後輪と、前記後輪を駆動させる後輪駆動部と、前記前輪および後輪を回転自在に支持するフレームとを持つ二輪車であることを特徴とする請求項 1な、し 4の、ずれか 1項に記載の転倒防止制御装置。