JP4872276B2 - 走行体 - Google Patents
走行体 Download PDFInfo
- Publication number
- JP4872276B2 JP4872276B2 JP2005254857A JP2005254857A JP4872276B2 JP 4872276 B2 JP4872276 B2 JP 4872276B2 JP 2005254857 A JP2005254857 A JP 2005254857A JP 2005254857 A JP2005254857 A JP 2005254857A JP 4872276 B2 JP4872276 B2 JP 4872276B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle body
- torque command
- traveling
- command value
- abnormality
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 230000005856 abnormality Effects 0.000 claims description 95
- 238000001514 detection method Methods 0.000 claims description 37
- 230000002159 abnormal effect Effects 0.000 claims description 27
- 230000006641 stabilisation Effects 0.000 description 64
- 238000011105 stabilization Methods 0.000 description 64
- 238000000034 method Methods 0.000 description 26
- 230000001133 acceleration Effects 0.000 description 21
- 230000008569 process Effects 0.000 description 20
- 230000005484 gravity Effects 0.000 description 14
- 230000008859 change Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 3
- 238000005070 sampling Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62K—CYCLES; CYCLE FRAMES; CYCLE STEERING DEVICES; RIDER-OPERATED TERMINAL CONTROLS SPECIALLY ADAPTED FOR CYCLES; CYCLE AXLE SUSPENSIONS; CYCLE SIDE-CARS, FORECARS, OR THE LIKE
- B62K3/00—Bicycles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62K—CYCLES; CYCLE FRAMES; CYCLE STEERING DEVICES; RIDER-OPERATED TERMINAL CONTROLS SPECIALLY ADAPTED FOR CYCLES; CYCLE AXLE SUSPENSIONS; CYCLE SIDE-CARS, FORECARS, OR THE LIKE
- B62K11/00—Motorcycles, engine-assisted cycles or motor scooters with one or two wheels
- B62K11/007—Automatic balancing machines with single main ground engaging wheel or coaxial wheels supporting a rider
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Description
ここで「車体が倒立状態にある」とは、駆動輪にトルクを適切に付与し、車体が鉛直方向に対してなす傾斜角の絶対値がある一定の値を超えて増加しないように保たれている状態にある、ことをいう。
倒立型走行体は、車体をコンパクトに構成することができ、小回りがきくという利点を有する。倒立型走行体は、荷物や人を狭い場所で移動させるのに便利である。
しかしそのような倒立型走行体は、一対の駆動輪で接地している状態が不安定であり、走行体の駆動系に関するなんらかの異常が発生した場合に、車体を倒立状態に維持しておくことが困難になるという不安定要素を持っている。そこで、走行体の駆動系に関するなんらかの異常が発生した場合に対応する技術が望まれている。
特許文献1には、倒立型走行体に故障(異常)が検出された場合に、車体が転倒する前に車体の速度を減速させる技術が開示されている。
しかしながら、例えば駆動源(具体的にはモータ)や、モータに駆動電流を供給するアンプに異常が発生した場合には、意図した異常処理を実施することができない。異常となったモータやアンプで、倒立型走行体を走行させ続ける制御を続行する(減速するとはいえ、減速中も倒立型走行体を走行させ続ける制御を続行する)ために、意図したように走行させ続けられないことが起こる。
例えば駆動源(具体的にはモータ)やモータに駆動電流を供給するアンプ等のように、2系統が用意されている制御系とは別の部分で異常が発生しても、走行速度を徐々に減速する制御を行わずとも転倒を回避することができる倒立型走行体を実現する技術が必要とされている。
ここで例えば駆動源に異常が発生し、駆動源が出力できる駆動力が半減したとする。この状態で走行体の制御部が駆動源に対して第1トルク指令値と第2トルク指令値の両者を出力しても、駆動源では第1トルク指令値と第2トルク指令値が加算されたトルク指令値に相当するトルクを発生できなくなる可能性がある。駆動源に与えられるトルク指令値は、第1トルク指令値と第2トルク指令値の加算値であるため、駆動源が出力するトルクの一部は車体を倒立状態に維持するためでなく、走行体を走行させ続けるために利用される。車体を倒立状態に維持するためのトルク(第1トルク指令値に基づくトルク)だけなら駆動源で発生することができても、さらにその上に走行体を走行させ続けるために必要なトルク(第2トルク指令値に基づくトルク)までは発生できない事態が生じる。あるいは、倒立状態を維持するだけのトルクを発生することが困難であっても、車体の転倒を遅らせるのに有用なトルクを駆動源が発生できる可能性がある。車体が転倒するまでの時間を引き延ばすことができれば、その間に補助輪を出す等の措置を講じて転倒を防止することができる。
第2トルク指令値の出力を停止しても、走行体には慣性が作用するために、急停止することはない。第1制御器は、慣性によって進み続ける車体を倒立状態に維持するための第1トルク指令値を計算する。第2トルク指令値の出力を停止することは、走行体を積極的に進めるためのトルクまでは加えないという意味であり、走行体を急停止させる結果を作り出すものでない。走行体は、慣性によって進み続ける間は、駆動源が出力可能なトルクを車体を倒立状態に維持するために利用する。
なお、車体を倒立状態に維持するための制御を行っている最中には、車体を倒立状態に維持するように駆動輪が回転する。その結果として、このとき、駆動輪の回転角度の制御は特に行う必要はない。従って走行体の位置は許容できる範囲で変化することもある。
一対の駆動輪は、車体に対して回転自在であるとともに、略同一軸上に配置されている。
駆動源は、具体的には各駆動輪に対して夫々トルクを与える機能を備えている。
第1制御部は、具体的には車体を倒立状態に維持するための第1トルク指令値を駆動源へ出力する機能を備えている。
第2制御部は、具体的には走行体を走行させるための第2トルク指令値を駆動源へ出力する機能を備えている。
異常検出部は、具体的には駆動源が駆動輪に与えるトルク状態の異常を検出する機能を備えている。
異常時処理部は、異常検出部によって、前記異常が検出された場合に第2制御部による第2トルク指令値の出力を停止させる機能を備えている。
異常検出部は、例えば車体を倒立状態に維持する制御を実行中であるにも関わらず、あるセンサが一定時間、一定の値を出力し続けている状態を検出し、異常と判断する機能を備えていてもよい。
また、異常検出部が検出する駆動源が駆動輪に与えるトルク状態の異常とは、例えば車輪の回転角を検出するエンコーダの異常を検出するものや駆動源の異常や駆動に関係するギヤの異常を検出するものであってよい。または車体の鉛直上方に対する傾斜角が許容された範囲を超えたことを検出するものであってもよい。さらに車体に鉛直方向の加速度を検出する加速度センサが設けられており、その加速度センサの出力値が所定範囲を超えたことを異常として検出するものであってもよい。上記例のように「駆動源が駆動輪に与えるトルク状態の異常を検出する異常検出部」とは、別言すれば、走行体に設けられおり、車体を倒立状態に維持しながら走行体を走行させる制御を実行するのに必要なセンサの出力値および/または制御部内で計算されるトルク指令値の少なくともひとつが予め設定された許容範囲を超えたことを検出する装置のことである。
ここで支持部材とは補助輪でもよいし、単なる棒状の部材でもよい。
ここで通常の走行時には、支持部材移動部は、支持部材が接地面と接触しないように支持部材を接地面から所定距離だけ上方に移動させている。異常が検出されていない場合における走行停止動作時には、支持部材移動部によって支持部材はゆっくりと下方へ移動させられる。支持部材をゆっくり下方へ移動させることによって車体が揺れることを低減させる作用を生じさせる。しかし異常が検出された場合は車体が転倒する可能性がある。そこで支持部材移動部は、支持部材を通常の走行停止動作時よりも高速に下方に移動させるように指示を出力する。車体の転倒前に支持部材を接地面に対して車体を支持可能な位置に移動させる作用を生じさせることができる。よって車体の転倒を防止することができる。
その際の第3トルク指令値は予め設定された値であってよい。
(第1形態) 夫々の駆動輪にトルクを与える駆動源は、夫々の駆動輪に対して夫々独立にトルクを与える一対の駆動源で構成されていることが好ましい。一対の駆動源で構成されていれば、いずれかの駆動源に異常が発生した場合、正常に動作する駆動源だけで車体が倒立するまでの時間を引き延ばすことができるからである。
補助輪26は、補助輪支持部材30の一方の端部で第2車軸C2の回りに回転可能に支持されている。補助輪支持部材30の他方の端部は、補助輪移動部28を介して車体12に連結されている。補助輪移動部28は、走行体10を第1駆動輪34と第2駆動輪44で接地する倒立状態に制御する場合には補助輪26を図1に2点鎖線で示す位置に移動させる。走行体を駆動輪34と44で接地させた状態を「車体12が倒立状態である」という表現を用いる。また、補助輪26を図1に2点鎖線で示す位置に移動させた状態を「補助輪26が倒立姿勢位置にある」と称することにする。
一方、走行体10を駆動輪34と44と補助輪26で接地させる場合には補助輪26を図1に実線で示す位置に移動させる。補助輪26を図1に実線で示した位置に移動させて、走行体10を第1駆動輪34と第2駆動輪44と補助輪26で接地可能な状態にあるときを「補助輪26が三輪姿勢位置にある」と称することにする。
走行体10には、人が着席可能な搭乗シート22が設けられている。走行体10は、人を乗せて走行することができる。
走行体10は、第1駆動輪34を駆動する第1モータ32と、第2駆動輪44を駆動する第2モータ42と、両モータ32、42に電力を供給するバッテリモジュール40を備えている。走行体10では、各駆動輪34、44のそれぞれに駆動源であるモータ32、42が用意されており、各駆動輪34、44のそれぞれが独立して駆動する構成となっている。また、第1モータ32には第1モータ32が過熱状態となって仕様上の最大トルクが出力できなくなることを検出するための第1温度センサ35が備えられている。同様に第2モータ42にも第2温度センサ45が備えられている。
また、各駆動輪34、44の回転角とは、各駆動輪34、44の車体12に対する相対回転角である。
また加速度センサ39は車体の上下方向の加速度を検出する。加速度センサの出力の変化が許容範囲を超えた場合に走行体10が想定外の悪路(凸凹道)を走行していることを検出するためである。
ここで、図2に示すように傾斜角ηが正の値であると、重力によって重心位置G回りに作用するモーメントにより車体12は何も制御しなければ図2の紙面上で右側へ転倒してしまう。傾斜角ηが負の値の場合でも車体12は何も制御しなければ図2の紙面上で左側へ転倒してしまう。
走行体10の制御モジュール14は、車体12が転倒しないように駆動輪34、44にトルクを与えるモータ32、42を制御する。具体的には車体12が傾斜している方向へ駆動輪34、44を進めるように制御する。そうすると走行体10の運動によって重心位置Gを第1車軸C1の鉛直上方に戻すようにモーメントが作用する。制御モジュール14は、車体12の傾斜角ηがゼロとなるように上記制御を常に行うことによって車体12を倒立状態に維持することができる。
即ち、「車体が倒立状態にある」とは、接地面に対して車体を支持する部材が主として略同軸上に配置されている一対の駆動輪であり、その駆動輪にトルクを適切に付与し、車体が鉛直方向に対してなす傾斜角の絶対値がある一定の値を超えて増加しないように保たれている状態にある、ことをいう。
このときは重心位置Gの接地面への投影点が駆動輪34、44の接地点と補助輪26の接地点で構成される領域内にあるので車体12は転倒することはない。別言すれば、車体は駆動輪34、44の接地点と補助輪26の接地点(これら3つの接地点は一つの直線上には並ばない3点となる)で接地面に対して支持されるので転倒することはない。
制御モジュール14内には、安定化用制御部50と走行用制御部52と異常検出部58と異常時処理部60が備えられている。
安定化用制御部50は、取得した車体の傾斜角速度dηを積分して車体の傾斜角ηを計算する。また駆動輪34、44の回転角θ1、θ2を微分して駆動輪34、44の回転角速度dθ1、dθ2を計算する。
安定化用制御部50は、車体12の傾斜角ηと傾斜角速度dηおよび駆動輪34、44の回転角θ1、θ2と回転角速度dθ1、dθ2から、図2で説明したように車体12を倒立状態に維持するために駆動輪34、44が発生すべきトルクを計算してそのトルク指令値(安定化用トルク指令値と称する)を第1モータ32と第2モータ42へ出力する。ここで安定化用制御部50が第1モータ32へ与える安定化用トルク指令値をτS1と称する。同様に安定化用制御部50が第2モータ42へ与える安定化用トルク指令値をτS2と称する。なお、図4に示した(τE1)と(τE2)の意味については後述する。
安定化用制御部50は、車体12の傾斜角速度dηと駆動輪34、44の回転角θ1、θ2を取得してモータ32、42への安定化用トルク指令値を出力するフィードバック制御系が構成されている。図4に符号56で示す線がフィードバックループを表す。
一方安定化用制御部50は、車体12の傾斜角速度dηと駆動輪34、44の回転角θ1、θ2をフィードバックして車体12の倒立状態を維持するための安定化用トルク指令値τS1、τS2を計算してモータ32、42に出力している。
即ち本実施例の走行体10の安定化用制御部50は、走行用制御部52の出力する走行用トルク指令値τM1、τM2に関わらず、常に車体12の倒立状態を維持するようにフィードバック制御が行われている。このことは別言すれば、安定化用制御部50は、走行用トルク指令値τM1、τM2による車体12の傾斜角ηの変化をいわば外乱による変化と捉えて車体12の倒立状態を維持するように制御を行っている。本実施例では、安定化用制御部50が走行用トルク指令値によって生じる車体12の傾斜角ηの変化を一種の外乱として扱うことで、安定化用制御部50と走行用制御部52を独立した制御系として構築することを可能にしている。
なお、異常検出部58が取得する操作レバー18からの信号の値、走行用制御部52内で計算される走行用トルク指令値τM1、τM2は、図4において走行用制御部52から異常検出部58へ向って伸びている矢印で示される。また、異常検出部58が取得する車体傾斜角速度dη、車体傾斜角η、駆動輪34、44の回転角θ1、θ2、駆動輪34、44の回転角速度dθ1、dθ2および回転角加速度ddθ1、ddθ2、安定化用制御部50内で計算される安定化用トルク指令値τS1、τS2は図4において安定化用制御部50から異常検出部58へ向って伸びている矢印で示される。
また、その他にも、異常検出部58は、第1モータ32の温度を検出する第1温度センサ35や第2モータ42の温度を検出する第2温度センサ45の検出値や車体12に備えられた加速度センサ39の出力も取得する。なお、図4において第1温度センサ35から「丸印内に1」と表現されている記号(以下(1)と記載する)へ伸びている線は、異常検出部58へ矢印が伸びている(1)に対応する。即ち、第1温度センサ35から異常検出部58へ信号線が接続されていることを示している。図4における「丸印内に2」の記号および「丸印内に3」の記号も同様に各信号が異常検出部58へ接続されていることを示している。
異常検出部58が取得した夫々の値には許容範囲が設けられており、異常検出部58は、ある信号の値がその許容範囲を超えた場合に異常であると判断する。また、夫々の値の許容範囲は、他の信号の値に依存して変化するものであってもよい。例えば、加速度センサ39が検出する車体12の上下方向の加速度の値が大きくなるにつれて車体傾斜角ηの許容範囲が小さくなるように設定されていてもよい。車体12の上下方向の加速度が大きくなるにつれて車体12を倒立状態に維持することが難しくなるからである。
なお、走行体10の上下方向の加速度の変動幅が許容範囲を超えた場合とは、走行体が予期しない悪路を走行している状態であると推定される。本実施例では、走行体10の上下方向の加速度の変動幅が許容範囲を超えた場合なども「駆動源が駆動輪に与えるトルク状態の異常」の概念に含まれる。
通常時には制御サンプリング毎にステップS100で走行体10の駆動に関わる状態量を取得する。ここで状態量とは具体的にはジャイロ38が検出する車体12の傾斜角速度dηやエンコーダ36、46が検出する駆動輪34、44の回転角θ1、θ2である。またステップS100では、取得した車体傾斜角速度dηから車体傾斜角ηを求める計算および取得した回転角θ1、θ2から回転角速度dθ1、dθ2や回転角加速度ddθ1、ddθ2を計算する処理も含まれる。計算によって求められた車体傾斜角η、回転角速度dθ1、dθ2も「状態量」に含まれる。また、異常検出部58が取得する温度センサ35、45の検出値や車体12に備えられた加速度センサ39の出力も「状態量」として取得する。ステップS100の処理はジャイロ38、エンコーダ36、46、温度センサ35、45、加速度センサ39および安定化用制御部50によって実行される。
次にステップS102で操作レバー18から出力される操作量を取得する。次にステップS104では、ステップS102で取得した操作量に基づいて走行体10を走行(旋回を含む)させるための走行用トルク指令値τM1、τM2を計算する。ステップS102とステップS104の処理は図4に示す走行用制御部52によって実行される。
次にステップS106ではステップS100で取得した状態量に基づいて車体12を倒立状態に維持するための安定化用トルク指令値τS1、τS2を計算する。ステップS106の処理は図4に示す安定化用制御部50によって実行される。
次にステップS108で各信号の値が異常でないかをチェックする。この処理は図4に示す異常検出部58によって実行される。異常か否か判断する対象となる物理量は、ステップS100で取得した状態量、ステップS102で取得した操作量の他に、ステップS104で計算された走行用トルク指令値τM1、τM2の値およびステップS106で計算された安定化用トルク指令値τS1、τS2の値も含まれる。
異常が検出されなかった場合(ステップS108:NO)には次にステップS110で各モータ32、42に対してトルク指令値が出力される。第1モータ32へのトルク指令値は安定化用トルク指令値τS1と走行用トルク指令値τM1を加算したものであり、第2モータ42へのトルク指令値は安定化用トルク指令値τS2と走行用トルク指令値τM2を加算したものである。夫々のモータ32、42がトルク指令値に追従して動作することによって、走行体10は倒立状態を維持しながら操作レバー18の操作量に応じて走行することができる。以上の処理をサンプリング毎に繰り返す。
一方ステップS108で何らかの異常が検出された場合にはステップS112に移り、車体12の転倒を防止するための退避モード処理が行われる。このとき、図4に示す異常検出部58から異常時処理部60へ異常があったことが通知される。
退避モードではまずステップS200で走行用トルク指令値の出力を停止する。この処理は図4の異常時処理部60から走行用制御部52に走行用トルク指令値の出力を停止するように指示が出力されることによって実行される。
次にステップS202では検出された異常が左右の駆動系が共に異常であるか否かを判断する。これは異常検出部58が検出した異常の種類によって判断される。例えば、第1エンコーダ32が検出する第1駆動輪34の回転角速度dθ1の値が異常、即ち、dθ1の値が予め設定されている許容範囲外であれば、第1駆動輪34側の駆動系のみが異常であると判断できる。一方、駆動輪34、44の回転角速度dθ1、dθ2の値が共に許容範囲外であれば、左右の駆動系ともに異常であると判断できる。
なお、ステップS202において左右の駆動系が共に異常であるか、又は片方の駆動系のみが異常であるか判断できない場合には、より安全な対処を行うべく左右輪の駆動系ともに異常であると判断する。例えば操作レバー18(図4参照)からの出力値が異常であった場合などは左右輪のいずれかが異常であるか判断できないのでその場合にはステップS202は左右輪の駆動系が共に異常であると判断する。なお、上記判断は図4に示す異常時処理部60によって実行される。
また、ステップS208の安定化処理では、図2において駆動輪34、44を除く走行体10の重心位置Gが第1車軸C1を通る鉛直線S上に位置するように安定化用トルク指令値を計算して出力することが好ましい。安定化用制御部50によって、重心位置Gが第1車軸C1を通る鉛直線S上に位置するように駆動輪34、44が制御されれば、走行体10の速度もゼロとなり、車体12を最も転倒の可能性が低い状態にすることができるからである。
ここで予め設定されているトルク指令値(図4に示すτE1、τE2)とは、補助輪26の側へ車体12を傾斜させるトルク指令値である。例えば図2に示す状態においては、予め設定されているトルク指令値(図4に示すτE1、τE2)とは駆動輪34、44を図2の紙面上で左周りに回転させるトルクである。図2において駆動輪34、44を図4の紙面上で左周りに回転させると車体12はより右側、即ち補助輪26の側へ傾斜する。これによって、車体12が補助輪26とは反対側へ傾斜することを防止することができる。ステップS210、212の処理は、フィードバックなしに行うことができるので例えばエンコーダ36、46の出力値が異常であっても可能である。
そしてステップS214で車体12が補助輪26側へ傾斜するまで予め決められたトルク指令値(図4に示すτE1、τE2)を出力し続ける(ステップS214:NO)。そしてステップS214で車体12が補助輪26の側へ傾斜していると判断されれば(ステップS214:YES)、ステップS216で制御を停止して終了する。
ステップS214における「車体12が補助輪26側へ傾斜するまで」とはより厳密には車体12の傾斜角ηが正の値をとるまで、という意味である。図2を参照して説明すると、車体12の傾斜角ηが正の値をとるとは、重心位置Gが第1車軸C1を通り鉛直上方に伸びる線Sよりも補助輪26側に位置することを意味する。ひとたび重心位置Gが第1車軸C1を通り鉛直上方に伸びる線Sよりも補助輪26側に位置すれば、あとは制御を停止しても重力により車体12は補助輪26の側に傾斜し続ける。補助輪26が三輪姿勢位置に移動完了していれば、車体12はやがて三輪接地状態となる。車体12の転倒を防止することができる。
補助輪26の移動が完了するまでの間(ステップS222:NO)は、ステップS224で安定化制御を続行する。ステップS224の安定化制御はステップS208の安定化制御と同じであるので説明を省略する。但しステップS224では、いずれか一方の駆動系は正常であるため、安定化制御を続行することによって正常な駆動系により車体を倒立状態に維持できる可能性は高い。なお、ステップS224における安定化処理では、異常が検出された側の駆動輪をロックしておき(車体12に対する回転角を固定しておき)、正常に動作する側の駆動系だけで安定化制御を行うことも好適である。
補助輪26の移動が完了した場合(ステップS222:YES)、ステップS226で補助輪着地制御を行う。補助輪着地制御とは、車体傾斜角ηを正方向(補助輪26の側)に徐々に大きくしていき、円滑に補助輪26を接地させる制御である。この制御により補助輪26の接地時の衝撃を低減することができる。
ステップS226の補助輪着地制御が終了したらステップS216により制御を停止して処理を終了する。
本実施例では車体の駆動系に冗長制御系を構成することなく、異常検出時に車体の転倒を防止することができる。これは、車体の倒立状態を維持するための安定化用制御部と走行体を走行させるための走行用制御部を独立して構成し、異常検出時には走行用制御部による走行用トルク指令値の出力を停止することによって達成される。
さらに異常検出時には、駆動輪とともに接地面に対して車体を支持する補助輪を通常時よりも早い速度で下方へ移動させることによって、車体が転倒する前に補助輪を三輪姿勢位置に移動させることができる。車体が転倒する前に補助輪を最速で三輪姿勢位置に移動させることによって車体が傾斜しても三輪接地状態とすることができる。
また、異常検出時に補助輪がある側へ車体を傾斜させるように予め設定されたトルク指令値を安定化用制御部が出力することによって、異常発生時に車体を三輪接地状態にすることができる。
また、第1モータ32と第2モータ42が請求項の「駆動源」の一態様に相当する。安定化用制御部50が請求項の「第1制御部」の一態様に相当し、走行用制御部52が請求項の「第2制御部」の一態様に相当する。また、安定化用制御部50が出力する安定化用トルク指令値τS1、τS2が請求項の「第1トルク指令値」の一態様に相当し、走行用制御部52が出力する走行用トルク指令値τM1、τM2が請求項の「第2トルク指令値」の一態様に相当する。
さらに、異常検出時に図6のステップS210で行われる、安定化用制御部50が出力する安定化用トルク指令値(図4に示すτS1、τS2に相当する)を、予め設定されているトルク指令値(図4に示すτE1、τE2に相当する)に変更する際の予め設定されているトルク指令値(図4に示すτE1、τE2)が請求項の「第3トルク指令値」の一態様に相当する。
例えば操作レバー18の代わりに搭乗者の体重移動を検出するセンサを設け、体重の移動量に基づいて走行用制御部52が走行用のトルク指令値を計算してもよい。
また、図4に示した安定化用制御部50と走行用制御部52は独立した別個の制御器として構成してもよいし、一つの制御装置内で安定化用制御系と走行用制御系が独立している構成であってもよい。また、1つの制御用コンピュータが、安定化用制御用プログラムと走行用制御用プログラムを独立して、あるいは経時的に切り替えて実行するものであってもよい。同様に制御モジュール14内の異常検出部58や異常時処理部60も夫々独立した回路として構成してもよいし、安定化用制御用プログラムと走行用制御用プログラムを実行する同じ制御用コンピュータ内のサブルーチンとして構成されてもよい。
12:車体
14:制御モジュール
18:操作レバー
20:操作モジュール
22:搭乗シート
26:補助輪
28:補助輪移動部
32、42:モータ
34、44:駆動輪
35、45:温度センサ
36、46:エンコーダ
38:ジャイロ
39:加速度センサ
40:バッテリモジュール
50:安定化用制御部(第1制御部)
52:走行用制御部(第2制御部)
54a、54b:加算器
58:異常検出部
60:異常時処理部
Claims (4)
- 車体を倒立状態に維持しながら走行することが可能な走行体であり、
車体と、
車体に対して回転自在であるとともに、略同軸上に配置されている一対の駆動輪と、
各駆動輪に対して夫々トルクを与える駆動源と、
車体を倒立状態に維持するための第1トルク指令値を前記駆動源へ出力する第1制御部と、
走行体を走行させるための第2トルク指令値を前記駆動源へ出力する第2制御部と、
前記駆動源が駆動輪に与えるトルク状態の異常を検出する異常検出部と、
異常検出部によって、前記異常が検出された場合に、第1制御部による第1トルク指令値の出力を維持したまま第2制御部による第2トルク指令値の出力を停止させる異常時処理部と、
車体に対して上下に移動可能であり、前記駆動輪が接地する接地面に当接することによって停止した車体を支持する支持部材と、
支持部材を、速度を調整可能に上下に移動させる支持部材移動部と、
を備えていることを特徴とする走行体。 - 異常検出部によって前記異常が検出された場合に、前記支持部材移動部が、車体を支持するために前記支持部材を下方に移動させる速度を、停止した車体を支持するために支持部材を下方に移動させる速度よりも速くすることを特徴とする請求項1に記載の走行体。
- 第1制御部は、支持部材が下方に移動した後に、駆動源へ出力する第1トルク指令値を支持部材が前記接地面に当接する方向に車体を傾斜させるための第3トルク指令値に変更することを特徴とする請求項1又は2に記載の走行体。
- 異常検出部は、駆動輪の回転数に基づく信号、車体の傾斜角に基づく信号、トルク指令値の大きさに基づく信号のうち、少なくとも一つの信号の値が予め定められた許容範囲外である場合に、「駆動源が駆動輪に与えるトルク状態の異常」と判断することを特徴とする請求項1から3のいずれか1項に記載の走行体。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005254857A JP4872276B2 (ja) | 2005-09-02 | 2005-09-02 | 走行体 |
US11/512,093 US7417388B2 (en) | 2005-09-02 | 2006-08-30 | Running machine with wheels |
CNB2006101280700A CN100484823C (zh) | 2005-09-02 | 2006-09-01 | 具有轮子的行走机器 |
DE602006015022T DE602006015022D1 (de) | 2005-09-02 | 2006-09-01 | Laufmaschine mit Rädern |
EP06254567A EP1759972B1 (en) | 2005-09-02 | 2006-09-01 | A running machine with wheels |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005254857A JP4872276B2 (ja) | 2005-09-02 | 2005-09-02 | 走行体 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011214422A Division JP5360178B2 (ja) | 2011-09-29 | 2011-09-29 | 走行体 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007062682A JP2007062682A (ja) | 2007-03-15 |
JP4872276B2 true JP4872276B2 (ja) | 2012-02-08 |
Family
ID=37494241
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005254857A Expired - Fee Related JP4872276B2 (ja) | 2005-09-02 | 2005-09-02 | 走行体 |
Country Status (5)
Country | Link |
---|---|
US (1) | US7417388B2 (ja) |
EP (1) | EP1759972B1 (ja) |
JP (1) | JP4872276B2 (ja) |
CN (1) | CN100484823C (ja) |
DE (1) | DE602006015022D1 (ja) |
Families Citing this family (39)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4760162B2 (ja) * | 2005-06-29 | 2011-08-31 | トヨタ自動車株式会社 | 移動台車の制御方法及び移動台車 |
EP1967409B1 (en) * | 2005-12-28 | 2011-01-12 | Equos Research Co., Ltd. | Traveling vehicle |
JP4868287B2 (ja) * | 2006-04-28 | 2012-02-01 | 株式会社エクォス・リサーチ | 車両 |
JP2008056169A (ja) * | 2006-09-01 | 2008-03-13 | Equos Research Co Ltd | 走行車両 |
JP4858847B2 (ja) * | 2007-03-29 | 2012-01-18 | 株式会社エクォス・リサーチ | 車両 |
JP5024662B2 (ja) * | 2007-03-29 | 2012-09-12 | 株式会社エクォス・リサーチ | 車両 |
JP5004003B2 (ja) * | 2007-03-29 | 2012-08-22 | 株式会社エクォス・リサーチ | 車両 |
WO2008120507A1 (ja) * | 2007-03-29 | 2008-10-09 | Equos Research Co., Ltd. | 車両 |
JP2008263676A (ja) * | 2007-04-10 | 2008-10-30 | Toyota Central R&D Labs Inc | 自走車とその制御装置及び制御方法 |
JP4867823B2 (ja) | 2007-07-09 | 2012-02-01 | トヨタ自動車株式会社 | 倒立車輪型移動体、及びその制御方法 |
CN101568465B (zh) * | 2007-08-28 | 2011-05-11 | 松下电器产业株式会社 | 倒立双轮式搬运车及其控制方法 |
JP4766031B2 (ja) * | 2007-10-23 | 2011-09-07 | トヨタ自動車株式会社 | 倒立型移動体および倒立型移動体の制御方法 |
WO2010035324A1 (ja) * | 2008-09-25 | 2010-04-01 | トヨタ自動車株式会社 | 自走車とその制御装置及び制御方法 |
CN102362233B (zh) * | 2009-01-26 | 2013-11-06 | 爱考斯研究株式会社 | 车辆 |
WO2010116639A1 (ja) * | 2009-03-30 | 2010-10-14 | 株式会社エクォス・リサーチ | 車両 |
JP5003716B2 (ja) | 2009-04-17 | 2012-08-15 | トヨタ自動車株式会社 | 走行装置及びその制御方法 |
JP5045707B2 (ja) | 2009-05-28 | 2012-10-10 | トヨタ自動車株式会社 | 走行装置、その制御方法、及び制御プログラム |
JP5413027B2 (ja) * | 2009-07-30 | 2014-02-12 | トヨタ自動車株式会社 | 移動体制御システム、その制御方法及び制御プログラム |
JP5436117B2 (ja) * | 2009-09-18 | 2014-03-05 | 本田技研工業株式会社 | 移動体 |
JP6022946B2 (ja) * | 2010-02-26 | 2016-11-09 | セグウェイ・インコーポレイテッド | 車両を制御するための装置及び方法 |
JP2012170212A (ja) * | 2011-02-14 | 2012-09-06 | Toyota Motor Corp | 倒立二輪車 |
JP5321637B2 (ja) * | 2011-04-21 | 2013-10-23 | トヨタ自動車株式会社 | 走行装置及びその制御方法 |
WO2013051194A1 (ja) * | 2011-10-06 | 2013-04-11 | ヤマハ発動機株式会社 | 電動車両 |
WO2014013554A1 (ja) * | 2012-07-17 | 2014-01-23 | 三菱電機株式会社 | 制御装置および制御方法 |
EP2891596A4 (en) * | 2012-08-30 | 2015-09-09 | Toyota Motor Co Ltd | SELF-COMPATIBLE MOBILE BODY AND CONTROL PROCEDURE THEREFOR |
JP5716873B2 (ja) * | 2012-09-18 | 2015-05-13 | 株式会社村田製作所 | 移動体 |
JP6157325B2 (ja) * | 2013-11-11 | 2017-07-05 | 本田技研工業株式会社 | 倒立振子制御型移動体 |
CN103792946B (zh) * | 2014-02-14 | 2016-08-24 | 上海创绘机器人科技有限公司 | 运动型倒立摆系统控制的信号处理方法及智能自平衡车信号控制系统 |
CN104865961B (zh) * | 2014-02-24 | 2019-08-27 | 联想(北京)有限公司 | 控制方法、装置及电子设备 |
JP2016049787A (ja) * | 2014-08-28 | 2016-04-11 | トヨタ自動車株式会社 | 倒立型移動体 |
CN106444798B (zh) * | 2015-08-10 | 2020-01-03 | 上海慧流云计算科技有限公司 | 两轮平衡设备浮空跑飞回地方法及两轮平衡设备 |
US10328836B2 (en) * | 2015-09-23 | 2019-06-25 | Amazon Technologies, Inc. | Actively balanced mobile drive unit |
CN105329341A (zh) * | 2015-11-30 | 2016-02-17 | 上海斐讯数据通信技术有限公司 | 自行车防摔系统、方法及装置 |
CN105680736B (zh) * | 2016-03-11 | 2018-04-13 | 南京快轮智能科技有限公司 | 一种基于偏航角的双电机速度同步及平衡控制方法 |
US10821981B1 (en) | 2017-10-18 | 2020-11-03 | Zoox, Inc. | Independent control of vehicle wheels |
US10759416B1 (en) | 2017-10-18 | 2020-09-01 | Zoox, Inc. | Independent control of vehicle wheels |
US10488172B1 (en) | 2017-10-18 | 2019-11-26 | Zoox, Inc. | Independent control of vehicle wheels |
US11136021B1 (en) * | 2017-10-18 | 2021-10-05 | Zoox, Inc. | Independent control of vehicle wheels |
CN108479048B (zh) * | 2018-04-28 | 2020-09-08 | 纳恩博(北京)科技有限公司 | 一种控制方法、轮滑设备及存储介质 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2530652B2 (ja) | 1987-06-05 | 1996-09-04 | シ−ケ−ディ株式会社 | 同軸二輪車における姿勢制御方法 |
US5248007A (en) * | 1989-11-21 | 1993-09-28 | Quest Technologies, Inc. | Electronic control system for stair climbing vehicle |
JP3070015B2 (ja) | 1990-11-30 | 2000-07-24 | 本田技研工業株式会社 | 不安定車両の走行制御装置 |
US5701965A (en) * | 1993-02-24 | 1997-12-30 | Deka Products Limited Partnership | Human transporter |
CA2367501C (en) * | 1999-03-15 | 2008-07-15 | Deka Products Limited Partnership | Control system and method for wheelchair |
US6965206B2 (en) * | 2000-10-13 | 2005-11-15 | Deka Products Limited Partnership | Method and system for fail-safe motor operation |
EP1324911B1 (en) * | 2000-10-13 | 2011-09-21 | Deka Products Limited Partnership | Control of a personal transporter |
US6538411B1 (en) * | 2000-10-13 | 2003-03-25 | Deka Products Limited Partnership | Deceleration control of a personal transporter |
JP2004074814A (ja) * | 2002-08-09 | 2004-03-11 | Matsushita Electric Works Ltd | 人用移動機器 |
JP2004215350A (ja) * | 2002-12-27 | 2004-07-29 | Sony Corp | 駆動制御装置およびその方法と2輪車 |
JP4422415B2 (ja) * | 2003-01-17 | 2010-02-24 | トヨタ自動車株式会社 | 2輪車 |
JP4296852B2 (ja) * | 2003-06-12 | 2009-07-15 | トヨタ自動車株式会社 | 同軸二輪車 |
JP4327566B2 (ja) * | 2003-11-17 | 2009-09-09 | トヨタ自動車株式会社 | 前輪の接地と浮遊が切換え可能な走行体および走行状態切換え方法 |
DE10360728A1 (de) * | 2003-12-23 | 2005-07-21 | Daimlerchrysler Ag | Verfahren und Vorrichtung zur Bestimmung eines Fahrzeugzustandes |
-
2005
- 2005-09-02 JP JP2005254857A patent/JP4872276B2/ja not_active Expired - Fee Related
-
2006
- 2006-08-30 US US11/512,093 patent/US7417388B2/en not_active Expired - Fee Related
- 2006-09-01 EP EP06254567A patent/EP1759972B1/en not_active Expired - Fee Related
- 2006-09-01 CN CNB2006101280700A patent/CN100484823C/zh not_active Expired - Fee Related
- 2006-09-01 DE DE602006015022T patent/DE602006015022D1/de active Active
Also Published As
Publication number | Publication date |
---|---|
US7417388B2 (en) | 2008-08-26 |
JP2007062682A (ja) | 2007-03-15 |
EP1759972A2 (en) | 2007-03-07 |
CN1923600A (zh) | 2007-03-07 |
CN100484823C (zh) | 2009-05-06 |
EP1759972A3 (en) | 2009-03-25 |
EP1759972B1 (en) | 2010-06-23 |
DE602006015022D1 (de) | 2010-08-05 |
US20070052377A1 (en) | 2007-03-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4872276B2 (ja) | 走行体 | |
US8265774B2 (en) | Inverted pendulum type moving body and method of controlling the same | |
JP5062328B2 (ja) | 移動体、及びその制御方法 | |
KR101158372B1 (ko) | 도립 차륜형 이동체 및 그 제어 방법 | |
JP5263387B2 (ja) | 倒立二輪装置、その制御方法及び制御プログラム | |
EP2535247B1 (en) | Coaxial two-wheel vehicle and method for controlling same | |
US20100152987A1 (en) | Traveling vehicle | |
KR101509884B1 (ko) | 도립진자형 차량 | |
JP5273020B2 (ja) | 車両 | |
JP2010125969A (ja) | 移動体 | |
JP5360178B2 (ja) | 走行体 | |
JP2011201386A (ja) | 移動体及び移動体の制御方法 | |
JP5263058B2 (ja) | 搭乗姿勢保持機構及び同軸二輪車 | |
JP2009101484A (ja) | 倒立走行ロボット及びその制御方法 | |
JP6277404B2 (ja) | 自動車 | |
JP2007118807A (ja) | 車両 | |
JP2009101899A (ja) | 倒立車輪型移動体、及びその制御方法 | |
JP2009101898A (ja) | 倒立車輪型移動体、及びその制御方法 | |
JP2009101897A (ja) | 倒立車輪型移動体、及びその制御方法 | |
JP2010030440A (ja) | 同軸二輪車及びその制御方法 | |
JP2009101817A (ja) | 倒立車輪型移動体及びその制御方法 | |
JP4766159B2 (ja) | 倒立振子型移動体、及びその制御方法 | |
JP5062224B2 (ja) | 倒立型移動体及び移動体の倒立制御方法 | |
JP5092683B2 (ja) | 倒立車輪型移動体及びその制御方法 | |
JP2013199215A (ja) | 車両 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080506 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20101130 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110118 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110224 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20110712 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110929 |
|
A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20111006 |
|
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: 20111025 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20111107 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20141202 Year of fee payment: 3 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 4872276 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20141202 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |