JP6846798B2 - 倒立振子型車両 - Google Patents
倒立振子型車両 Download PDFInfo
- Publication number
- JP6846798B2 JP6846798B2 JP2017020468A JP2017020468A JP6846798B2 JP 6846798 B2 JP6846798 B2 JP 6846798B2 JP 2017020468 A JP2017020468 A JP 2017020468A JP 2017020468 A JP2017020468 A JP 2017020468A JP 6846798 B2 JP6846798 B2 JP 6846798B2
- Authority
- JP
- Japan
- Prior art keywords
- movable plate
- housing
- inverted pendulum
- type vehicle
- pendulum type
- 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.)
- Active
Links
- 238000006073 displacement reaction Methods 0.000 claims description 39
- 230000008859 change Effects 0.000 description 24
- 230000033001 locomotion Effects 0.000 description 23
- 238000004088 simulation Methods 0.000 description 17
- 238000010586 diagram Methods 0.000 description 14
- 230000000052 comparative effect Effects 0.000 description 10
- 230000001133 acceleration Effects 0.000 description 9
- 230000005484 gravity Effects 0.000 description 9
- 238000001514 detection method Methods 0.000 description 5
- 230000000087 stabilizing effect Effects 0.000 description 4
- 125000002066 L-histidyl group Chemical group [H]N1C([H])=NC(C([H])([H])[C@](C(=O)[*])([H])N([H])[H])=C1[H] 0.000 description 3
- 238000000034 method Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000012827 research and development Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000012141 concentrate Substances 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000000116 mitigating effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Landscapes
- Automatic Cycles, And Cycles In General (AREA)
- Motorcycle And Bicycle Frame (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
また、PMVは、足腰の衰えから長距離の歩行を負担に感じる高齢者用の移動手段としても期待されている。
しかしながら、2輪型の倒立振子型車両に機械式のブレーキを設けた場合、車両に急ブレーキをかけて車輪の回転を止めると、姿勢安定化のためのフィードバック制御が行えなくなるため、搭乗者の姿勢が不安定になって前後に転倒してしまうおそれがある。
(i)この発明の倒立振子型車両は、筐体と、前記筐体に設けられた車輪と、前記車輪の少なくとも一部の車輪を駆動輪として回転駆動する走行駆動部と、前記車輪を制動する制動部と、搭乗者を支持し、前後方向に傾斜可能かつ前記筐体に対して前後方向に相対変位可能に前記筐体上に設けられた可動板と、前記可動板を駆動する可動板駆動部と、前記可動板の水平方向からの傾斜角および傾斜角速度を計測する可動板傾斜センサと、前記走行駆動部および前記可動板駆動部を制御する制御部とを備え、前記制御部は、前記筐体の走行中に前記制動部が動作していないとき、前記筐体に対して前記可動板を相対変位させず、前記可動板傾斜センサによって計測された前記可動板の傾斜角および傾斜角速度に基づき、倒立振子の原理によって搭乗者が安定した姿勢を保持するように前記走行駆動部をフィードバック制御し、一方、前記筐体の走行中に前記制動部が動作したとき、前記筐体に対して前記可動板を前後方向に相対変位させ、前記可動板傾斜センサによって計測された前記可動板の傾斜角および傾斜角速度に基づき、倒立振子の原理によって搭乗者が安定した姿勢を保持するように前記可動板駆動部をフィードバック制御することを特徴とする。
fv=k1v(θ−θa)+k2v(dθ/dt)
fp=k1pθ+k2p(dθ/dt)
であってもよい。
fv=k1v(θ−θa)+k2v(dθ/dt)
fp=k1pθ+k2p(dθ/dt)+k3py+k4p(dy/dt)
であってもよい。
<倒立振子型車両1の構成>
以下、図1および図2に基づき、この発明の実施形態1に係る倒立振子型車両1の概略構成を説明する。
図2は、図1に示す倒立振子型車両1の電気的な構成を示すブロック図である。
以下、実施形態1の倒立振子型車両1の各構成要素を説明する。
図2に示すように、左後輪12Lおよび右後輪12Rは、モータドライバ120によって駆動される左側駆動モータ121Lおよび右側駆動モータ121Rによって、適当なトルクでそれぞれ回転させられる。
具体的には、可動板13は、前後方向に傾斜する傾斜部13Aおよび筐体10に対して前後方向に相対変位する変位部13Bの2つの部分から構成される。
搭乗者は、身体を前後に傾けて重心を移動させることにより、可動板13の角度θを自由に調節する。そして、可動板13を前方に傾斜させたとき、筐体10が加速し、可動板13を後方に傾斜させたとき、筐体10が減速するようにフィードバック入力fvが与えられる。フィードバック入力fvの詳細については後述する。
図2に示すように、傾斜角検出部14によって検出された可動板13の傾斜角は、制御部100に入力され、制御部100は、当該傾斜角に基づき、適切なトルクを駆動輪に与えるべく、モータドライバ120に制御信号を送る。
搭乗者は、ハンドル15に設けられたブレーキレバー16を動作させることにより、駆動輪にブレーキ160をかける。
ブレーキ160の動作方式はどのようなものであってもよい。摩擦によって車輪を制動するブレーキであってもよいし、無励磁ブレーキなどの電磁ブレーキであってもよい。
次に、図3に基づき、この発明の実施形態1に係る倒立振子型車両1の走行動作について説明する。
その後、制御部100は、ステップS6の判定を行う(ステップS6)。
なお、ブレーキ160が動作していないとき、可動板13は、筐体10に対して前後方向に相対変位しないよう、筐体10上に固定されるものとする。
その後、制御部100は、ステップS6の判定を行う(ステップS6)。
筐体10が停止した場合(ステップS6の判定がYesの場合)、制御部100は、倒立振子型車両1の走行動作処理を終了させる。
一方、筐体10が停止していない場合(ステップS6の判定がNoの場合)、制御部100は、ステップS1の判定を繰り返す(ステップS1)。
次に、図4に基づき、この発明の実施形態1の倒立振子型車両1のモデルについて説明する。
なお、変位xおよびフィードバック入力fvの符号は、筐体10の前進方向(図4の右方向)をプラス、後退方向(図4の左方向)をマイナスとする。その他のパラメータについても同様である。
しかし、ここでは簡単のため、筐体10に対して前後方向に相対変位する部分のみを可動板13とする。
また、可動板13に与えるフィードバック入力fpの右辺4項のうち、可動板13の相対変位yおよびその時間微分に関する2つの項は、筐体10の停止後、可動板13を相対変位の開始前の位置に戻すための入力である。
次に、実施例1として、図5および図6に基づき、この発明の実施形態1に係る倒立振子型車両1のモデルの数値シミュレーションの結果について説明する。
図6は、図4に示す倒立振子型車両1のモデルの数値シミュレーションの結果を示すグラフである。図6(A)は、筐体10の速度(m/秒)の時間変化を表し、図6(B)は、可動板13の筐体10に対する相対速度(m/秒)を表し、図6(C)は、棒状体17の垂直方向に対する角速度(度/秒)を表す。
しかしながら、フィードバック入力fpを受けた可動板13はその後、急速に減速し、2.5秒付近で筐体10に対し、後方に相対運動し、相対運動開始前の位置に戻されることがわかる。
次に、比較例1として、図7および図8に基づき、従来の人間式ブレーキの倒立振子型車両1Aのモデルの数値シミュレーションの結果について説明する。
図8は、図7に示す倒立振子型車両1Aのモデルの数値シミュレーションの結果を示すグラフである。図8(A)は、筐体10の変位(m)の時間変化を表し、図8(B)は、棒状体17の垂直方向に対する角度(度)の時間変化を表し、図8(C)は、筐体10の速度(m/秒)の時間変化を表し、図8(D)は、棒状体17の垂直方向に対する角速度(度/秒)の時間変化を表す。
図7(A)に示すように、棒状体17を前方に角度θ1傾斜させて筐体10を加速させ、図7(B)に示すように、棒状体17を後方に角度θ2傾斜させて筐体10を減速させるものとする。
次に、比較例2として、図9および図10に基づき、従来の機械式ブレーキの倒立振子型車両1Bのモデルの数値シミュレーションの結果について説明する。
なお、ここでは、比較例1の搭乗者の重心移動によって筐体10を減速させる「人間式ブレーキ」に対し、摩擦等によって機械的に車輪を制動するブレーキを「機械式ブレーキ」として区別することにする。
図10は、図9に示す倒立振子型車両1Bのモデルの数値シミュレーションの結果を示すグラフである。図10(A)は、筐体10の変位(m)の時間変化を表し、図10(B)は、棒状体17の垂直方向に対する角度(度)の時間変化を表し、図10(C)は、筐体10の速度(m/秒)の時間変化を表し、図10(D)は、棒状体17の垂直方向に対する角速度(度/秒)の時間変化を表す。
図9に示すように、棒状体17を前方に角度θ傾斜させて筐体10を加速させ、その後、機械式のブレーキ160により、筐体10を急停止させるものとする。
このように、ブレーキ160の動作により、加速状態から筐体10を急停止させたとき、その反動で、棒状体17が前方に転倒してしまうため、安全性に問題がある。
このような可動板13を筐体10上に設けることにより、ブレーキ160によって急停止した際も、搭乗者の姿勢の安定化を図ることのできる倒立振子型車両1が実現される。
前述した実施形態の他にも、この発明について種々の変形例があり得る。それらの変形例は、この発明の範囲に属さないと解されるべきものではない。この発明には、請求の範囲と均等の意味及び前記範囲内でのすべての変形とが含まれるべきである。
Claims (4)
- 筐体と、前記筐体に設けられた3輪以上の車輪と、前記車輪の少なくとも一部の車輪を駆動輪として回転駆動する走行駆動部と、前記車輪を制動する制動部と、搭乗者を支持し、前後方向に傾斜可能かつ前記筐体に対して前後方向に相対変位可能に前記筐体上に設けられた可動板と、前記可動板を駆動する可動板駆動部と、前記可動板の水平方向からの傾斜角および傾斜角速度を計測する可動板傾斜センサと、前記走行駆動部および前記可動板駆動部を制御する制御部とを備え、
前記制御部は、前記筐体の走行中に前記制動部が動作していないとき、前記筐体に対して前記可動板を相対変位させず、前記可動板傾斜センサによって計測された前記可動板の傾斜角および傾斜角速度に基づき、倒立振子の原理によって搭乗者が安定した姿勢を保持するように前記走行駆動部をフィードバック制御し、
一方、前記筐体の走行中に前記制動部が動作したとき、前記筐体に対して前記可動板を前方に相対変位させた後、後方に相対変位させ、前記可動板傾斜センサによって計測された前記可動板の傾斜角および傾斜角速度に基づき、倒立振子の原理によって搭乗者が安定した姿勢を保持するように前記可動板駆動部をフィードバック制御することを特徴とする倒立振子型車両。 - 前記筐体に対する前記可動板の相対変位および相対速度を計測する可動板変位センサをさらに備え、
前記制御部は、前記筐体の走行中に前記制動部が動作したとき、前記可動板の傾斜角および傾斜角速度と、前記可動板の相対変位および相対速度とに基づき、倒立振子の原理によって搭乗者が安定した姿勢を保持し、かつ、前記筐体に対する前記可動板の相対変位が前記制動部の動作開始時の相対変位に最終的に戻るように前記走行駆動部および前記可動板駆動部をフィードバック制御する請求項1に記載の倒立振子型車両。 - 前記可動板の水平方向からの傾斜角をθ、前記可動板の傾斜角速度をdθ/dt、前記
可動板の目標角度をθa、フィードバックゲインをkv1、kv2、k1pおよびk2pとしたと
き、前記走行駆動部および前記可動板駆動部へのフィードバック入力値fvおよびfpが、
fv=k1v(θ−θa)+k2v(dθ/dt)
fp=k1pθ+k2p(dθ/dt)
で与えられる請求項1に記載の倒立振子型車両。 - 前記可動板の水平方向からの傾斜角をθ、前記可動板の傾斜角速度をdθ/dt、前記
可動板の目標角度をθa、前記筐体に対する前記可動板の前後方向の相対変位および相対
速度をそれぞれyおよびdy/dt、フィードバックゲインをkv1、kv2、k1p、k2p、k3pおよびk4pとしたとき、前記走行駆動部および前記可動板駆動部へのフィードバック入力値fvおよびfpが、
fv=k1v(θ−θa)+k2v(dθ/dt)
fp=k1pθ+k2p(dθ/dt)+k3py+k4p(dy/dt)
で与えられる請求項2に記載の倒立振子型車両。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017020468A JP6846798B2 (ja) | 2017-02-07 | 2017-02-07 | 倒立振子型車両 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017020468A JP6846798B2 (ja) | 2017-02-07 | 2017-02-07 | 倒立振子型車両 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018127050A JP2018127050A (ja) | 2018-08-16 |
JP6846798B2 true JP6846798B2 (ja) | 2021-03-24 |
Family
ID=63172000
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017020468A Active JP6846798B2 (ja) | 2017-02-07 | 2017-02-07 | 倒立振子型車両 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6846798B2 (ja) |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4078889B2 (ja) * | 2002-06-12 | 2008-04-23 | 株式会社ジェイテクト | 電動車椅子 |
JP4291822B2 (ja) * | 2006-02-03 | 2009-07-08 | トヨタ自動車株式会社 | 倒立車輪型の走行体 |
JP4831490B2 (ja) * | 2007-08-10 | 2011-12-07 | 株式会社エクォス・リサーチ | 車両 |
JP2012076471A (ja) * | 2010-09-30 | 2012-04-19 | Toyota Motor Corp | 移動体 |
US9682732B2 (en) * | 2013-09-06 | 2017-06-20 | Jason Thomas Strack | Fully self-balanced hands-free portable vehicle |
-
2017
- 2017-02-07 JP JP2017020468A patent/JP6846798B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2018127050A (ja) | 2018-08-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5414454B2 (ja) | 車両運動制御装置 | |
JP2004276727A (ja) | 人用移動機器とその制動方法 | |
US20100268446A1 (en) | Traveling device and its control method | |
WO2008016074A1 (fr) | Dispositif de déplacement et procédé de commande de freinage pour le dispositif de déplacement | |
JP2008253565A (ja) | 走行装置 | |
JP2005022631A5 (ja) | ||
JP2006281798A (ja) | ペダル装置及びそれを備えた自動車 | |
JP2005022631A (ja) | 電動スク−タの駆動制御装置 | |
JPWO2008065853A1 (ja) | 車両 | |
JP2008055951A (ja) | 走行車両 | |
JP5960304B1 (ja) | 歩行補助車 | |
WO2016158558A1 (ja) | 歩行補助車および歩行補助車を制御するためのプログラム | |
US9139224B2 (en) | Inverted pendulum type vehicle | |
JP4078889B2 (ja) | 電動車椅子 | |
JP6846798B2 (ja) | 倒立振子型車両 | |
WO2016092773A1 (ja) | 自動運転制御装置、運転情報出力装置、フットレスト、自動運転制御方法、および運転情報出力方法 | |
JP2009142127A (ja) | 車輌制御装置 | |
JP4259016B2 (ja) | 車両操作装置 | |
JP6161023B2 (ja) | 乗用二輪車 | |
JP2011218847A (ja) | 移動体 | |
JP2010030523A (ja) | 二輪自動車 | |
JP2011162161A (ja) | 移動体及びその制御方法 | |
JP2007168603A (ja) | 同軸二輪移動台車 | |
JP2009136057A (ja) | 車輌制御装置 | |
JP4701681B2 (ja) | 平行2輪車及びその制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A712 Effective date: 20190920 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200120 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20201022 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20201027 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20201222 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20210216 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20210222 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6846798 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |