JP3993883B2 - 倒立二輪走行型ロボット及びその制御方法 - Google Patents

倒立二輪走行型ロボット及びその制御方法 Download PDF

Info

Publication number
JP3993883B2
JP3993883B2 JP2006526472A JP2006526472A JP3993883B2 JP 3993883 B2 JP3993883 B2 JP 3993883B2 JP 2006526472 A JP2006526472 A JP 2006526472A JP 2006526472 A JP2006526472 A JP 2006526472A JP 3993883 B2 JP3993883 B2 JP 3993883B2
Authority
JP
Japan
Prior art keywords
vehicle body
inverted
control
state
traveling
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
Application number
JP2006526472A
Other languages
English (en)
Other versions
JPWO2007013282A1 (ja
Inventor
勇治 足達
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Panasonic Corp
Panasonic Holdings Corp
Original Assignee
Panasonic Corp
Matsushita Electric Industrial Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Panasonic Corp, Matsushita Electric Industrial Co Ltd filed Critical Panasonic Corp
Application granted granted Critical
Publication of JP3993883B2 publication Critical patent/JP3993883B2/ja
Publication of JPWO2007013282A1 publication Critical patent/JPWO2007013282A1/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D61/00—Motor vehicles or trailers, characterised by the arrangement or number of wheels, not otherwise provided for, e.g. four wheels in diamond pattern
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D37/00—Stabilising vehicle bodies without controlling suspension arrangements
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D51/00—Motor vehicles characterised by the driver not being seated
    • B62D51/02—Motor vehicles characterised by the driver not being seated the driver standing in the vehicle
    • 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
    • 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
    • B62K17/00—Cycles not otherwise provided for
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2200/00—Type of vehicles
    • B60L2200/16—Single-axle vehicles
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2220/00—Electrical machine types; Structures or applications thereof
    • B60L2220/40—Electrical machine applications
    • B60L2220/46—Wheel motors, i.e. motor connected to only one wheel
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00—Control parameters of input or output; Target parameters
    • B60L2240/10—Vehicle control parameters
    • B60L2240/12—Speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00—Control parameters of input or output; Target parameters
    • B60L2240/10—Vehicle control parameters
    • B60L2240/14—Acceleration
    • B60L2240/20—Acceleration angular
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00—Control parameters of input or output; Target parameters
    • B60L2240/10—Vehicle control parameters
    • B60L2240/26—Vehicle weight
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00—Control parameters of input or output; Target parameters
    • B60L2240/40—Drive Train control parameters
    • B60L2240/42—Drive Train control parameters related to electric machines
    • B60L2240/423—Torque
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2260/00—Operating Modes
    • B60L2260/20—Drive modes; Transition between modes
    • B60L2260/34—Stabilising upright position of vehicles, e.g. of single axle vehicles
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2260/00—Operating Modes
    • B60L2260/40—Control modes
    • B60L2260/42—Control modes by adaptive correction
    • 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/64—Electric machine technologies in electromobility
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Power Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Motorcycle And Bicycle Frame (AREA)

Description

本発明は、荷物運搬作業を行うロボットのうち、同軸二輪車を用いた倒立二輪走行型ロボット及びその制御方法に関するものであり、詳しくは、ロボット姿勢拘束時の倒立二輪走行型ロボット及びその制御方法に関するものである。
荷物運搬作業を行うロボットしては、三輪型や四輪型など３点以上で必ず接触して安定を保つものが一般的である。しかしながら、三輪型、四輪型などは、面積を有すること、小回りが難しいことから倒立振子モデルに基づいて動作する同軸二輪車型のロボットが研究されてきている。
同軸二輪車型の移動ロボットとしては、例えば特許文献１、特許文献２に記載のものが知られている。
図１３は、上記特許文献１に記載された従来の同軸二輪車型の移動ロボットを示すものである。
特許文献１に記載された同軸二輪車型移動ロボットは、両端に一対の車輪１０２，１０３を備えた車軸１０１上の回動可能に支持された車体１０４と、車体１０４に装着された車輪駆動用モータ１０５と、車輪駆動用モータ１０５に作動指令を送る制御コンピュータ１０６と、車体１０４の傾きを検出する角度検出手段１０７を備えている。そして、角度検出手段１０７により検出される車体１０４の傾斜角度を短時間間隔にてサンプリングし、車体１０４の傾斜角度を状態変数入力値、フィードバックゲインＫを係数として、制御コンピュータ１０６内に予め入力設定された制御入力算出式に基づき、車輪駆動用モータ１０５の制御トルクを算出する状態フィードバック制御である。この算出された制御トルク相当の作動を制御コンピュータ１０６から、車輪駆動用モータ１０５に指令することにより、倒立の姿勢制御が維持される。
図１４は、上記特許文献２に記載された人乗り型の同軸二輪車型移動ロボットを示すものである。
特許文献２に記載された人乗り型の同軸二輪車型移動ロボットは、プラットホーム２０１上に同軸に配された左右の駆動輪２０２を姿勢感知センサーの出力に応じて制御駆動することで前後方向のバランスの保持のための姿勢制御と走行制御とを行う。そして、駆動輪２０２の前方側又は及び後方側で接地する補助輪２０３と、補助輪２０３を出没させる補助輪駆動部２０４とを備えている。そして、障害物検知センサー２０５と走行速度及び姿勢の制御の状態に応じて補助輪駆動部２０４を駆動して補助輪２０３を出没させる制御回路を備えているため、転倒を招く原因となりやすい障害物があった時、補助輪２０３が出て安定性を高められるために、転倒の危険性を少なくすることができる。
特許２５３０６５２号 特開２００４−７４８１４
上述の特許文献１に示された技術においては、状態フィードバック制御を常に行っている。
そして、同軸二輪車の車体１０４と車輪１０２，１０３が共に拘束無く相対的に回転できる場合には、車輪駆動用モータ１０５で発生したトルクは、車輪１０２，１０３の回転に寄与すると同時に、反作用のトルクが車体１０４に働いて、全体として倒立姿勢制御を維持できる。
しかしながら、車体１０４の一部が壁や地面に接触し、それ以上回転できなくなるような拘束力を外部から受けると車体１０４が回転しないだけでなく、拘束力によるトルクが車輪１０２，１０３に伝達される。よって、拘束力がない場合に比べて、車輪１０２，１０３に対して過大なトルクがかかり、車輪回転が増し、走行速度が急上昇するという課題を有していた。
上述の特許文献２に示された技術においては、障害物検知センサー２０５で障害物を検知した場合、補助輪駆動部２０４を駆動して補助輪２０３を出没させる機構を有しているため、補助輪２０３が出没した場合には、左右の駆動輪２０２と補助輪２０３の３点接地になり、転倒の危険性を少なくできる。
しかし、本技術では障害物を認識して補助輪２０３を出すだけで、速度や姿勢は人の操縦に依存している構成となっている。本構成においても、人がバランスを崩してプラットホーム２０１を含めた本体部が地面に接触した場合や、プラットホーム２０１を含めた本体部が壁等に接触して回転できなくなるような拘束力を受けた場合、特許文献１の場合と同様に駆動輪２０２に過大なトルクがかかり、走行速度が急上昇するという課題を有していた。この場合は、人の操縦により停止指令を送るなどの、危険を回避することになるが、操作が人に依存するという点でユーザに負担をかけるという課題を有していた。
本発明の目的は、上記従来の課題を解決するもので、倒立制御を行いながら移動する同軸二輪車の車体の一部が地面や壁などに接触して拘束力を受けた場合に、姿勢制御や走行状態を維持可能でかつユーザに負担をかけない安全な倒立二輪走行型ロボット及びその制御方法を提供する。
上記目的を達成するために、本発明は以下のように構成する。
本発明の第１態様によれば、車体と、
上記車体に同軸に配置された２つの車輪と、
上記車輪を各々駆動する駆動装置と、
上記車体の傾斜角度及び傾斜角速度の少なくとも１つを検出する第１状態検出手段と、
上記車輪の回転角度及び回転角速度の少なくとも１つを検出する第２状態検出手段と、
上記第１状態検出手段又は上記第２状態検出手段で検出された情報を入力として、上記車体の傾斜方向への回転が拘束されているかどうかを検出する車体拘束認識手段と、
上記駆動装置への指令値を決定し、決定した指令値により複数の走行制御方法を切り替えて上記駆動装置が駆動され上記車体の走行制御が行われる制御手段とを備え、
上記車体に対する接触力を検出する少なくとも一つの接触センサを上記車体に有するとともに、上記車体拘束認識手段は、上記接触センサで検出された接触情報を入力として、車体拘束状態を認識し、
上記車体拘束認識手段の検出結果に基づいて、上記制御手段が、上記複数の走行制御方法を切替える上記駆動装置への指令値を決定し、決定された上記指令値により上記駆動装置が駆動されて、上記車体の走行制御が行われて走行状態を維持する、倒立二輪走行型ロボットを提供する。
本発明の第２態様によれば、車体と、
上記車体に同軸に配置された２つの車輪と、
上記車輪を各々駆動する駆動装置と、
上記車体の傾斜角度及び傾斜角速度の少なくとも１つを検出する第１状態検出手段と、
上記車輪の回転角度及び回転角速度の少なくとも１つを検出する第２状態検出手段と、
上記第１状態検出手段又は上記第２状態検出手段で検出された情報を入力として、上記車体の傾斜方向への回転が拘束されているかどうかを検出する車体拘束認識手段と、
上記駆動装置への指令値を決定し、決定した指令値により複数の走行制御方法を切り替えて上記駆動装置が駆動され上記車体の走行制御が行われる制御手段とを備え、
上記車体拘束認識手段の検出結果に基づいて、上記制御手段が、上記複数の走行制御方法を切替える上記駆動装置への指令値を決定し、決定された上記指令値により上記駆動装置が駆動されて、上記車体の走行制御が行われて走行状態を維持する一方、車体拘束時には、上記車輪を回転駆動させるトルクに、上記車体への拘束力による発生するトルク分を加算する制御方法に切り替える倒立二輪走行型ロボットを提供する。
本発明の第３態様によれば、車体と、
上記車体に同軸に配置された２つの車輪と、
上記車輪を各々駆動する駆動装置と、
上記車体の傾斜角度及び傾斜角速度の少なくとも１つを検出する第１状態検出手段と、
上記車輪の回転角度及び回転角速度の少なくとも１つを検出する第２状態検出手段と、
上記第１状態検出手段又は上記第２状態検出手段で検出された情報を入力として、上記車体の傾斜方向への回転が拘束されているかどうかを検出する車体拘束認識手段と、
上記駆動装置への指令値を決定し、決定した指令値により複数の走行制御方法を切り替えて上記駆動装置が駆動され上記車体の走行制御が行われる制御手段とを備え、
上記車体に対する接触力を検出する少なくとも一つの接触センサを上記車体に有するとともに、上記車体拘束認識手段は、上記接触センサで検出された接触情報を入力として、車体拘束状態を認識し、
上記車体拘束認識手段の検出結果に基づいて、上記制御手段が、上記複数の走行制御方法を切替える上記駆動装置への指令値を決定し、決定された上記指令値により上記駆動装置が駆動されて、上記車体の走行制御が行われて走行状態を維持する一方、車体拘束時には、上記車輪を回転駆動させるトルクに、上記車体への拘束力による発生するトルク分を加算する制御方法に切り替える倒立二輪走行型ロボットを提供する。
本発明の構成によれば、倒立して姿勢制御を行いながら走行する倒立二輪走行型ロボットの車体の一部が、地面や壁などに接触して回転を拘束された場合に、車体拘束認識手段又は車体拘束認識動作によって車体の回転方向の拘束が認識される。そして、認識された拘束状態に応じて、例えば車体回転に寄与するトルクの割合を変化させることで過大なトルクが車輪にかかって姿勢制御を維持できず走行速度が急上昇するという課題を回避することができる。
よって、本発明の構成によれば、倒立制御を行いながら移動する同軸二輪車型の倒立二輪走行型ロボットにおいて、車体の一部が地面や壁などに接触して回転を拘束された場合でも、姿勢制御や走行状態を維持でき、ユーザに負担をかけずに、安全に移動することができる。
本発明の記述を続ける前に、添付図面において同じ部品については同じ参照符号を付している。
以下に、本発明にかかる実施の形態を説明する前に、本発明の種々の態様について説明する。
本発明の第１態様によれば、車体と、
上記車体に同軸に配置された２つの車輪と、
上記車輪を各々駆動する駆動装置と、
上記車体の傾斜角度及び傾斜角速度の少なくとも１つを検出する第１状態検出手段と、
上記車輪の回転角度及び回転角速度の少なくとも１つを検出する第２状態検出手段と、
上記第１状態検出手段又は上記第２状態検出手段で検出された情報を入力として、上記車体の傾斜方向への回転が拘束されているかどうかを検出する車体拘束認識手段と、
上記駆動装置への指令値を決定し、決定した指令値により複数の走行制御方法を切り替えて上記駆動装置が駆動され上記車体の走行制御が行われる制御手段とを備え、
上記車体に対する接触力を検出する少なくとも一つの接触センサを上記車体に有するとともに、上記車体拘束認識手段は、上記接触センサで検出された接触情報を入力として、車体拘束状態を認識し、
上記車体拘束認識手段の検出結果に基づいて、上記制御手段が、上記複数の走行制御方法を切替える上記駆動装置への指令値を決定し、決定された上記指令値により上記駆動装置が駆動されて、上記車体の走行制御が行われて走行状態を維持する、倒立二輪走行型ロボットを提供する。
本発明の第２態様によれば、車体と、
上記車体に同軸に配置された２つの車輪と、
上記車輪を各々駆動する駆動装置と、
上記車体の傾斜角度及び傾斜角速度の少なくとも１つを検出する第１状態検出手段と、
上記車輪の回転角度及び回転角速度の少なくとも１つを検出する第２状態検出手段と、
上記第１状態検出手段又は上記第２状態検出手段で検出された情報を入力として、上記車体の傾斜方向への回転が拘束されているかどうかを検出する車体拘束認識手段と、
上記駆動装置への指令値を決定し、決定した指令値により複数の走行制御方法を切り替えて上記駆動装置が駆動され上記車体の走行制御が行われる制御手段とを備え、
上記車体拘束認識手段の検出結果に基づいて、上記制御手段が、上記複数の走行制御方法を切替える上記駆動装置への指令値を決定し、決定された上記指令値により上記駆動装置が駆動されて、上記車体の走行制御が行われて走行状態を維持する一方、車体拘束時には、上記車輪を回転駆動させるトルクに、上記車体への拘束力による発生するトルク分を加算する制御方法に切り替える倒立二輪走行型ロボットを提供する。
本発明の第３態様によれば、車体と、
上記車体に同軸に配置された２つの車輪と、
上記車輪を各々駆動する駆動装置と、
上記車体の傾斜角度及び傾斜角速度の少なくとも１つを検出する第１状態検出手段と、
上記車輪の回転角度及び回転角速度の少なくとも１つを検出する第２状態検出手段と、
上記第１状態検出手段又は上記第２状態検出手段で検出された情報を入力として、上記車体の傾斜方向への回転が拘束されているかどうかを検出する車体拘束認識手段と、
上記駆動装置への指令値を決定し、決定した指令値により複数の走行制御方法を切り替えて上記駆動装置が駆動され上記車体の走行制御が行われる制御手段とを備え、
上記車体に対する接触力を検出する少なくとも一つの接触センサを上記車体に有するとともに、上記車体拘束認識手段は、上記接触センサで検出された接触情報を入力として、車体拘束状態を認識し、
上記車体拘束認識手段の検出結果に基づいて、上記制御手段が、上記複数の走行制御方法を切替える上記駆動装置への指令値を決定し、決定された上記指令値により上記駆動装置が駆動されて、上記車体の走行制御が行われて走行状態を維持する一方、車体拘束時には、上記車輪を回転駆動させるトルクに、上記車体への拘束力による発生するトルク分を加算する制御方法に切り替える倒立二輪走行型ロボットを提供する。
本発明の第４態様によれば、車体拘束時には上記車輪の回転角速度の誤差の積分値をリセットする第１の態様に記載の倒立二輪走行型ロボットを提供する。
本発明の第５態様によれば、車体拘束時には上記車輪の回転角速度の誤差の積分値をリセットする第２又は３の態様に記載の倒立二輪走行型ロボットを提供する。
本発明の第６態様によれば、車体拘束時には上記車体の傾斜角度及び傾斜角速度に対するフィードバックを停止させる制御に切り替えるとともに、上記車輪の回転角速度の誤差の積分値をリセットする第１又は２又は３の態様に記載の倒立二輪走行型ロボットを提供する。
本発明の第７態様によれば、車体拘束時には上記車体の傾斜角度及び傾斜角速度に対するフィードバックを停止させ、かつ、上記車体の走行のみを継続する制御に切り替えるとともに、上記車輪の回転角速度の誤差の積分値をリセットする第１又は２又は３の態様に記載の倒立二輪走行型ロボットを提供する。
以下に、本発明にかかる実施の形態を図面に基づいて詳細に説明する。
（第１実施形態）
以下、本発明の第１実施形態における倒立二輪走行型ロボット及びその制御方法について、図面を参照しながら説明する。
本発明の第１実施形態における倒立二輪走行型ロボットの傾いた状態での側面図を図１Ａ、傾いた状態での正面図を図２に示す。ロボットの車体１に対し、概して同一軸上に２つの車輪２ａ，２ｂが配置される。ここで、車体１の図中矢印Ａで示した進行方向に対して左車輪２ａ、右車輪２ｂとする。なお、車体１の進行方向から見た正面図が図２である。車輪２ａ，２ｂと車体１との間に独立してそれぞれ駆動力を発生させる駆動装置の一例として機能するアクチュエータ３ａ，３ｂは車体１の車輪２ａ，２ｂの近傍に取付けられ、各車輪２ａ，２ｂに連結されている。なお、説明のためアクチュエータ３ａ，３ｂは一例としてモータであるとする。なお、モータ３ａ，３ｂには、減速機４ａ，４ｂが取り付けられて、上記駆動装置の一例を構成するようにしてもよい。また、モータ３ａ，３ｂには、上記車輪２ａ，２ｂの回転角度及び回転角速度の少なくとも１つを第２状態検出情報として検出する第２状態検出手段の一例として機能するエンコーダ５ａ，５ｂが取り付けられており、車体１と車輪２ａ，２ｂの回転角度を計測できる。回転角度を一定サンプリング時間（例えば、１ｍｓｅｃおき）に計測し、その差分をサンプリング時間で除算することで、回転角速度が求まり、これを第２状態検出情報として扱うことができる。
また、車体１の車軸方向を法線とする鉛直平面内における姿勢を検出する姿勢センサ６の一例である２つのセンサ、すなわち、車体１の傾斜角度及び傾斜角速度の少なくとも１つを第１状態検出情報として検出する第１状態検出手段の一例として機能する１軸ジャイロ６ａと２軸加速度センサ６ｂが車体１の上部に取り付けられている。１軸ジャイロ６ａは、車軸方向を法線とする鉛直平面に、車軸方向の傾斜角速度を第１状態検出情報として検出できるように車体１に取り付けられ、車体１の車軸方向を法線とする鉛直平面内における傾斜角速度（円弧６ａ１で図示）を検出することができる。また、２軸加速度センサ６ｂは、車軸方向を法線とする鉛直平面の所定の２方向（６ｂ１，６ｂ２）に対する加速度を検出できるように取り付けられ、重力方向（６ｂ３）を検出することを可能としている。第１状態検出情報としての車体１の姿勢角度（傾斜角度）は、１軸ジャイロ６ａの積分値と２軸加速度センサ６ｂからの値をそれぞれ、制御コンピュータ部９でハイパスフィルター、ローパスフィルターにかけ、それらを制御コンピュータ部９で合成して求める。
また、車体１の前後の下部には接触センサ１０ａ，１０ｂが設けられ、車体１の当該車体１の前後の下部に対する他の物体などからの接触力を、接触情報としてそれぞれ測定することができる。
車体１の内部には、モータ３ａ，３ｂを駆動するためのモータドライバ７ａ，７ｂ及びバッテリ８、制御手段及び車体拘束認識手段の一例して機能する制御コンピュータ部９が搭載されている。図１Ｂに示すように、制御コンピュータ部９は、Ａ／Ｄ変換器９ａとＤ／Ａ変換器９ｂとエンコーダカウンタ部９ｃと演算部９ｄとから構成され、エンコーダ５ａ，５ｂの値はエンコーダカウンタ部９ｃを通じて演算部９ｄに入力される。また、１軸ジャイロ６ａと２軸加速度センサ６ｂ、接触センサ１０ａ，１０ｂの値はＡ／Ｄ変換器９ａを通じて演算部９ｄに入力される。演算部９ｄでは、入力された接触センサ１０ａ，１０ｂからの値に基づき、上記車体１の傾斜方向への回転が拘束されているかどうかを検出して、車体拘束認識情報を作成することができる。この作成された車体拘束認識情報は、例えば、接触センサ１０ａ，１０ｂの入力により判断される車体１に対する拘束力の情報（第１実施形態参照）、接触センサ１０ａ，１０ｂの入力により判断される接触の有無の情報（第２実施形態参照）、車体１の傾斜角度情報（第３実施形態参照）などであって、後述するように、制御方法を切替えるときに使用することができる。制御コンピュータ部９の演算部９ｄは、演算部９ｄに入力された値より、姿勢制御及び走行制御の必要トルクを計算し、Ｄ／Ａ変換器９ｂより、トルク指令値をモータドライバ７ａ，７ｂに指令する。モータドライバ７ａ，７ｂは、指令値に基づいてモータ３ａ，３ｂを駆動する。なお、入力値から出力値への計算方法は、後述する。
次に、本構成での倒立二輪走行型ロボットの制御方法について図３で説明する。図３はロボットを鉛直上方から見た図である。本機構においては、車軸方向を法線とする鉛直平面（Ｂ−Ｂ’面）内での姿勢及びその鉛直平面内の水平方向速度に関する並進制御１１（姿勢制御＋前後移動制御）と旋回方向の動作に関する旋回制御１２の２つの制御に分けて考える。前者は、並進方向の
Figure 0003993883
 に追従するように、姿勢制御と走行制御を行って走行状態を維持するものである。後者は、旋回方向の
Figure 0003993883
 に追従するように制御するものである。後述するように、この２つの制御を合わせることで、移動制御（走行制御）を行って走行状態を維持することができる。
次に、この移動制御について、順に、説明を行う。
まず、並進制御１１について、機構パラメータを示す図４を用いて説明する。なお、車軸方向を法線とする鉛直平面内での動作であるので、２次元モデルとして扱う。図４のように、パラメータを以下のように設定する。車輪２ａ，２ｂ、モータ３ａ，３ｂ、減速機４ａ，４ｂ、エンコーダ５ａ，５ｂ、はそれぞれ１つとみなして、車輪２、モータ３、減速機４、エンコーダ５とする。また、車体１の重心を車体重心１３、車輪２の車軸を車軸１４、車輪２の重心を車輪重心１５とする。
Ｍｂ：ロボットの車体１の質量［ｋｇ］
Ｍｗ：車輪２の質量（２つの車輪の合計）［ｋｇ］、
Ｉｂ：ロボットの車体１の車体重心１３周りの慣性モーメント［ｋｇｍ２］
Ｉｗ：車輪２の車輪重心１５周りの慣性モーメント（２つの車輪の合計）［ｋｇｍ２］
Ｉｍ：モータ３の慣性モーメント［ｋｇｍ２］
ｒ：車輪２の半径［ｍ］
Ｌｇ：車軸１４からロボットの車体重心１３までの距離［ｍ］
Figure 0003993883
 ：モータ３と減速機４と車軸２との間の粘性摩擦係数［Ｎｍ／（ｒａｄ／ｓ）］
Figure 0003993883
 ：車輪２と地面８００との間の粘性摩擦係数［Ｎｍ／（ｒａｄ／ｓ）］
Figure 0003993883
 ：モータ３のトルク定数［Ｎｍ／Ａ］
Figure 0003993883
 ：減速機４のギア部減速比
ｇ：重力加速度
Figure 0003993883
 ：ロボットの車体１の傾き［ｒａｄ］
Figure 0003993883
 ：車輪２の地面８００に対する回転角［ｒａｄ］
ｕ：モータ３に入力する電流［Ａ］
また、記号を次のように定義する。
Ｔ：運動エネルギー、Ｕ：位置エネルギー，Ｄ：摩擦損失
ｚ１：車体重心高さ，ｚ２：車輪重心高さ，ｓ１：車体重心並進位置，
ｓ２：車軸並進位置，
ここで、倒立２輪走行型ロボットの運動方程式を、ラグランジェ法を用いて導出する。
ラグランジェの運動方程式は
Figure 0003993883
Figure 0003993883
 各値とその微分値は次のように表される。
Figure 0003993883
Figure 0003993883
Figure 0003993883
Figure 0003993883
Figure 0003993883
Figure 0003993883
Figure 0003993883
Figure 0003993883
 各エネルギーは
Figure 0003993883
Figure 0003993883
Figure 0003993883
 簡単なモデルとして、車体１にかかる外力が０とした場合、
Figure 0003993883
Figure 0003993883
 よって、運動エネルギーＴは
Figure 0003993883
 となる。
ロボットの車体１の傾きφについて、ラグランジェ法により運動方程式を導出する。
Figure 0003993883
車輪２の地面８００に対する回転角θについて、ラグランジェ法により運動方程式を導出する。
Figure 0003993883
 （式１７）と（式１８）を足し合わせると、
Figure 0003993883
 となる。
よって、２つの式（式１７）と（式１９）を
Figure 0003993883
 の周りで近似して
Figure 0003993883
Figure 0003993883
 となる。
ここで変数を
Figure 0003993883
Figure 0003993883
 とおいて、
Figure 0003993883
Figure 0003993883
 の状態方程式の形に帰着できる。なお、
Figure 0003993883
 は、状態ベクトルである。
以上のモデル化は、状態ベクトルの各値が０での近似モデルであるので、前後方向の位置（速度指令）に関する追従性を考慮するために、このモデルに対してステップ状の目標入力に追従するモデルの制御系を構成する。なお、目標入力を一定速度目標値であるとする。
Figure 0003993883
 は、可観測であるとし、
Figure 0003993883
 と表せる。
Figure 0003993883
 をステップ状の
Figure 0003993883
 に定常偏差なく追従させるために、積分器を用いた制御系とする。なお、そのときの制御ブロックを図５に示す。ここで、
Figure 0003993883
 の閉ループシステムを安定にするためのフィードバックベクトルである。
この構成において、
Figure 0003993883
 より
Figure 0003993883
 制御入力は、
Figure 0003993883
 と表せる。ここで、Ｉｎは３行３列の単位行列、Ｉｍ＝１として
Figure 0003993883
 （式２６）と（式３０）より
Figure 0003993883
Figure 0003993883
 ここで、定常値は、
Figure 0003993883
Figure 0003993883
 なお、
Figure 0003993883
 となり、定常偏差がないことがわかる。
次に、定常値からの誤差システムを考える。
Figure 0003993883
 として式変形を行うと
Figure 0003993883
 となる。
Figure 0003993883
Figure 0003993883
 として、
Figure 0003993883
 となり、出力をｅとして
Figure 0003993883
 となる。（式３９）、（式４０）にｗの状態フィードバックをしたレギュレータとみなせる。よって、この誤差システムのフィードバックゲインＨを、最適レギュレータ法や極配置法、その他の種々の設計法によって導出する。このゲインを用いれば、
Figure 0003993883
 の過渡応答誤差の少ない最適なサーボシステムが設計できる。なお、（式３７）より
Figure 0003993883
 となる。したがって、
Figure 0003993883
 を用いて、モータ３へ出力される
Figure 0003993883
 を、
Figure 0003993883
 とすれば、倒立の姿勢制御と速度制御が同時に実現できる。
ただし、
Figure 0003993883
Figure 0003993883
 である。なお、
Figure 0003993883
 である。本構成では、車輪２は２つであるので、
Figure 0003993883
 の０．５倍を各車輪２（２ａ，２ｂ）に出力すれば、並進方向の姿勢制御と速度制御を行える。そのときの、各車輪２ａ，２ｂの
Figure 0003993883
 として、
Figure 0003993883
 となる。
次に、旋回制御１２について旋回制御模式図である図６を用いて説明する。
ロボットの車体１を上面から見て、ロボットの車体１の車輪２間の長さを
Figure 0003993883
 とし、水平面上でのロボットの車体１の移動速度を
Figure 0003993883
 とし、左車輪２ａの回転速度を
Figure 0003993883
 とし、右車輪２ｂの回転速度を
Figure 0003993883
 とし、旋回半径をＲ、旋回速度を
Figure 0003993883
 とする。また、左車輪２ａの回転角速度を
Figure 0003993883
 、右車輪２ｂの回転角速度を
Figure 0003993883
 とすると、
Figure 0003993883
 となる。
Figure 0003993883
 として、
Figure 0003993883
 との差に対してフィードバック（ＰＤ制御等）を行い、
Figure 0003993883
 を決定する。
Figure 0003993883
 は、左右の車輪２ａ，２ｂに発生するトルク差であるとみなせる。左右の車輪２ａ，２ｂに、それぞれ、その旋回方向のトルクの０．５倍を、旋回方向の目標トルクを算出できる両車輪２ａ，２ｂに、それぞれ加算、減算してやることで、旋回方向の制御が実現できる。
並進制御１１、旋回制御１２の統合された制御ブロック図を図７に示す。
そして、左輪２ａ、右輪２ｂに指令するトルク指令値を
Figure 0003993883
 とすると
Figure 0003993883
以上のように、トルクを決定することにより、上記ロボットは、倒立姿勢を維持しながら旋回及び直線走行をすることができる。
図１Ａのように、車体１が地面８００から離れている場合には、これまで述べたような制御則に基づけば、倒立姿勢を維持しながらの走行を行うことができる。
次に、第１実施形態では、図８のように車体１の一部が回転方向に拘束を受けた場合の一例として、車体１が傾いて車体下部が地面８００に接触した場合を示す。仮定として、車体１と地面８００との摩擦力は０で
Figure 0003993883
 だけが、車軸１４から水平移動した
Figure 0003993883
 の接触点において拘束力として発生するとする。接触センサ１０ｂ（接触センサ１０ａも同様であるため、代表的に接触センサ１０ｂで説明する。）は、車体１に対する他の物体や地面８００や壁などからの接触力を計測できるセンサとし、接触力センサ１０ｂによって
Figure 0003993883
 が検出され、幾何学的な条件より
Figure 0003993883
 も既知である。このとき、車体１には拘束力による
Figure 0003993883
 が発生する。また、位置ずれ量が
Figure 0003993883
 の状態のときに、図８のような
Figure 0003993883
 接触が発生した場合を考える。このとき、（式４２）に基づくモータ３のトルク指令値は、車輪２を正転させる方向（ロボットの車体１が図８において右方向に移動し、車体１が車軸１４周りに左回転する方向）を正として、
Figure 0003993883
 となる。
Figure 0003993883
 であるので、傾斜方向の回転が拘束され、
Figure 0003993883
 となる。
このとき
Figure 0003993883
 となる。
Figure 0003993883
 は、モータ３からのトルクの
Figure 0003993883
 と、
Figure 0003993883
 の和になるため、
Figure 0003993883
 となる。この
Figure 0003993883
 の値によっては、
Figure 0003993883
 のいずれにもなりうる。
（式５１）において
Figure 0003993883
 である場合には、車体１には、右回転させるようにするトルクが働くため、車軸１４周りに右回転し、接触は解消され倒立状態に戻る事ができる。しかしながら、
Figure 0003993883
 である場合には、車体１には、左回転のトルクがかかり、車輪２には、反力として右へ移動する回転トルクが発生する。この時、車体１が
Figure 0003993883
 で拘束されているので、車輪２には、
Figure 0003993883
 によって発生した
Figure 0003993883
 も、車輪２への回転トルクとして伝達される。そのため、車輪２に余分のトルクがかかり、車輪２の過度の回転現象を生じ、暴走現象に陥ってしまう。
そこで、本発明の上記第１実施形態にかかるロボットの制御方法では、接触力センサ１０ｂより接触情報を検知し、検知した接触力方向と
Figure 0003993883
 とを比較し、その回転方向が反対の場合には、モータ３への
Figure 0003993883
 を、接触力により発生する
Figure 0003993883
 を加算した
Figure 0003993883
 とする。
したがって、本発明による上記第１実施形態にかかるロボットの制御方法によれば、（式５２）に基づきモータ３のトルクを算出することにより、地面８００からの接触力による影響を除去でき、ユーザに負担をかけずに、安全な倒立二輪走行型ロボットを実現できる。
また、本構成において車体１と地面８００との間に
Figure 0003993883
 が発生する場合、図９のように、その
Figure 0003993883
 によって発生する回転の反対方向のトルクを補償して走行することとすれば同様の効果を得られる
Figure 0003993883
 また、外乱オブザーバを用いて、接触センサ無しに外乱力を推定してその推定された接触力を用いて（式５２）、（式５３）と同様の制御を行ってもよい。
ここで、上記した第１実施形態での切替制御を用いた走行動作フローチャートを図１２で説明する。
初期状態（ステップＳ１）では、ロボットの車体１は傾斜して停止している。初期設定として、
Figure 0003993883
 （＝ステップＳ２）とする。次に、（式５０）で示す倒立停止
Figure 0003993883
 制御（ステップＳ３）を行って起き上がる。倒立停止制御（ステップＳ３）の安定時間（例えば５秒程度）後（ステップＳ４）、車体１の地面８００などに対する接触の有無を判別する（ステップＳ５）。
ステップＳ５で接触が無い場合には、
Figure 0003993883
 設定を行った（ステップＳ８）後、（式４９）で示す倒立走行制御（ステップＳ９）を行って走行状態を維持した後、ステップＳ５に戻る。
ステップＳ５で接触がある場合には、
Figure 0003993883
 設定を行った（ステップＳ６）後、（式５２又は式５３）で示す倒立走行制御（ステップＳ７）を行って走行状態を維持した後、ステップＳ５に戻る。
なお、ステップＳ６とステップＳ８において、接地しているときも、接地していないときも、その差分トルクを補正するので、どちらの場合も、同様の走行が行える。
以上のように、上記第１実施形態によれば、制御コンピュータ部９の制御の下で、以下のような動作制御を行うことができる。
すなわち、初期の車体１が移動停止して地面８００に接地している状態から、まず、倒立停止制御（式（４９）、ステップＳ２〜Ｓ３）を行うことにより、車体１を倒立位置まで起き上がらせて、倒立状態（ただし、走行は停止している状態。）を維持する。次いで、所定時間（安定時間）経過して倒立状態が安定した（ステップＳ４）のち、接触センサ１０ａ，１０ｂによる接触の有無の検出を開始する（ステップＳ５）。ステップＳ５で接触（言い換えれば、車体拘束）が無ければ、倒立停止制御から倒立走行制御（式（４９）、ステップＳ８〜Ｓ９）に移って走行状態を維持したのち、接触センサ１０ａ，１０ｂによる接触の有無の検出を再度行う（ステップＳ５）。ステップＳ５で接触（言い換えれば、車体拘束）が検出された場合には、倒立停止制御から倒立走行制御（式（５２）又は式（５３）、ステップＳ６〜Ｓ７）に移って走行状態を維持したのち、接触センサ１０ａ，１０ｂによる接触の有無の検出を再度行う（ステップＳ５）。
このように、倒立停止制御（ステップＳ３）、倒立走行制御（ステップＳ９）、倒立走行制御（ステップＳ７）とを適宜切替ながら、倒立二輪走行することによって、車体１に接触が発生しても、接触状態（すなわち車体拘束状態）に応じて、車体回転に寄与するトルクの割合を変化させることで、過大なトルクが車輪２にかかって姿勢制御を維持できず走行速度が急上昇するといった暴走を防止することができ、ユーザに負担をかけずに、安全に走行を継続することができる。
（第２実施形態）
本発明の第２実施形態を第１実施形態と同じ、図８で説明する。第１実施形態においては、接触センサを設けて接触力を検知していたが、第２実施形態では、接触センサ１０ｂが、接触の有無を検知のみで力測定ができないセンサの場合や、力計測できるセンサであっても接触の有無のみを利用する場合とし、その制御方法を述べる。
車体１の一部が地面８００などに接触している場合、車体１は回転できず、車体１は２つの車輪２ａ，２ｂと、少なくとも１点との３点以上で地面８００に接していることとなる。従来からあるような独立二輪駆動で、補助輪等で接地している台車の移動制御においては、車輪２の回転速度に対して、ＰＩＤ制御等によって走行制御がなされて走行状態を維持している。そのため、この第２実施形態においても、接地時には同様の構成とみなすことができるので、接地した場合には、
Figure 0003993883
 に示すような、回転速度に対する略ＰＩ制御の速度制御の構成とする。したがって、接触がある場合には、（式５４）、接触がない場合には（式５０）の制御を切り替えて制御を行う。
第２実施形態での切替制御を用いた走行動作フローチャートを図１０で説明する。
初期状態（ステップＳ１１）では、ロボットの車体１は傾斜して停止している。初期設定として、
Figure 0003993883
 （＝ステップＳ１２）とする。次に、（式５０）で示す倒立停止
Figure 0003993883
 制御（ステップＳ１３）を行って起き上がる。倒立停止制御（ステップＳ１３）の安定時間（例えば５秒程度）後（ステップＳ１４）、接触の有無を判別する（ステップＳ１５）。もし接触（ステップＳ１５）のない場合は、
Figure 0003993883
 設定を行った（ステップＳ２０）後、（式４９）で示す倒立走行制御（ステップＳ２１）を行って走行状態を維持している。（式４９）に基づく倒立走行制御（ステップＳ２１）から、接触時の（式５４）に基づく速度制御（ステップＳ１８）へと制御方法が移る条件として、積分項リセット履歴ビットｂｔ１を設ける。積分項とは、速度差の
Figure 0003993883
 （車体１の現在位置に対して車体１のバランスが崩れたりなどして位置ずれが生じるときの位置ずれ量）である。そして、倒立走行制御（ステップＳ２１）中に、接触の有無を判断する（ステップＳ２２）。
ステップＳ２２で車体１が地面８００などに接触していない場合には、積分項リセット履歴ビットｂｔ１をリセット（ｂｔ１＝０）した（ステップＳ２６）後（すなわち、積分項のリセットは行わずに）、ステップＳ２０に戻る。
ステップＳ２２で車体１が地面８００などに接触している場合には、積分項リセット履歴がＯＮか否か、すなわち、積分項リセット履歴ビットｂｔ１＝１か否かを判断する（ステップＳ２３）。積分項リセット履歴ビットｂｔ１＝０のとき（接触後に積分項のリセットを行っていなかったとき）のみ、
Figure 0003993883
 を
Figure 0003993883
 した（ステップＳ２７）後（積分項をリセットし、かつ、積分項をリセットしたことを示す履歴情報を残した後）、ステップＳ２０に戻る。積分項をリセットするのは、接触する前に発生している位置ずれ（速度差の
Figure 0003993883
 ）を、一度、０にして、接触時からのＰＩ制御にするためである。このように、積分項をリセットすることによって、接触前の位置ずれ量を削除できて、接触後の車体１の位置ずれ量のみにより、動作制御が行われるため、車体１の暴走現象を防止することができる。
ステップＳ２３で積分項リセット履歴ビットｂｔ１＝１であるとき、接触の有無を判別する（ステップＳ２４）。
ステップＳ２４で車体１が地面８００などに接触していない場合は、積分項リセット履歴ビットｂｔ１をリセット（ｂｔ１＝０）した（ステップＳ２８）後（すなわち、積分項のリセットは行わずに）、ステップＳ２０に戻る。
ステップＳ２４で、そのまま、車体１が地面８００などに接触が続いている場合（ｂｔ１＝１）は、安定時間（例えば１秒）（ステップＳ２５）以内であれば、ステップＳ２０に戻り、倒立走行（ステップＳ２１）を継続する。
一方、安定時間（例えば１秒）が経過していれば、倒立走行（ステップＳ２１）から速度制御（ステップＳ３０〜Ｓ３２）に移る。
ステップＳ１５で車体１が地面８００などに接触している場合又はステップＳ２５で安定時間経過時には、
Figure 0003993883
 設定を行った（ステップＳ３０）後、
Figure 0003993883
 か否かを判断する（ステップＳ３１）。ＹＥＳの場合には、起き上がれないと判断して終了する（ステップＳ１９）。ステップＳ３１で、ＮＯ、すなわち、
Figure 0003993883
 の場合には、（式５４）で示す速度制御（ステップＳ３２）で走行したのち、ステップＳ１４に戻り、速度制御（ステップＳ３２）の安定時間（例えば５秒程度）が経過したか否かを判断する（ステップＳ１４）。
以上のように、上記第２実施形態によれば、制御コンピュータ部９の制御の下で、以下のような動作制御を行うことができる。
すなわち、初期の車体１が移動停止して地面８００に接地している状態から、まず、倒立停止制御（式（４９）、ステップＳ１２〜Ｓ１３）を行うことにより、車体１を倒立位置まで起き上がらせて、倒立状態（ただし、走行は停止している状態。）を維持する。次いで、所定時間（安定時間）経過して倒立状態が安定した（ステップＳ１４）のち、接触センサ１０ａ，１０ｂによる接触の有無の検出を開始する（ステップＳ１５）。ステップＳ１５で接触（言い換えれば、車体拘束）が無ければ、倒立停止制御から倒立走行制御（式（４９）、ステップＳ２０〜Ｓ２１）に移って走行状態を維持する。ステップＳ１５で接触（言い換えれば、車体拘束）が検出された場合には、倒立停止制御から速度制御（ステップＳ３０〜Ｓ３２）に移る。次いで、所定時間（安定時間）経過して安定して速度制御が行われた（ステップＳ１４）のち、接触センサ１０ａ，１０ｂによる接触の有無の検出を再度行い（ステップＳ１５）、ステップＳ１５で接触がなければ（起き上がりが成功したならば）、倒立走行制御（式（４９）、ステップＳ２０〜Ｓ２１）に移って走行状態を維持する。ステップＳ１５で接触があれば（起き上がりが不成功ならば）、そのまま、速度制御（ステップＳ３０〜Ｓ３２）を継続する。速度制御（ステップＳ３０〜Ｓ３２）を行うとき、速度及び角速度が０の場合には、車体１が物体又は地面８００などに接触している場合など、車体１が起き上がれない場合であると判断して、車体１の起き上がり駆動を停止し、接地状態とする。
また、倒立走行制御（式（４９）、ステップＳ２０〜Ｓ２１）中に接触があった場合（ステップＳ２２）には、接触時までの位置ずれ量をリセットして０にしたのち、接触時からの位置ずれ量のみにより、動作制御が行われるため、車体１の暴走現象を防止することができる。さらに、倒立走行制御時に、接触時までの位置ずれ量をリセットして０にしたのち、接触が安定時間経過しても続いている場合には、車体１の倒立状態が崩れていると判断して、倒立走行制御から速度制御に切り替えて、倒立状態に復帰させるように動作制御することができる。
このように、倒立停止制御（ステップＳ１３）、倒立走行制御（ステップＳ２１）、速度制御（ステップＳ３２）とを適宜切替ながら、倒立二輪走行することによって、車体１に接触が発生しても、接触状態（すなわち車体拘束状態）に応じて、車体回転に寄与するトルクの割合を変化させることで、過大なトルクが車輪２にかかって姿勢制御を維持できず走行速度が急上昇するといった暴走を防止することができ、ユーザに負担をかけずに、安全に走行を継続することができる。
（第３実施形態）
第２実施形態においては、実際の接触センサ１０ａ，１０ｂの入力によって接触の有無を検知して制御方法を切り替えたが、本発明の第３実施形態では、走行する地面８００が、平坦な面であるということがわかっている場合として、接触センサ無しで、車体１の傾斜角度により制御方法の切替を行うものであって、車体１の傾斜角度が所定角度以上傾いたときには切替制御を行うものである。すなわち、図１１のように、車体１が傾いて地面８００に必ず接触する場合の車体１の傾斜角が、
Figure 0003993883
 として、車体１が傾いて地面８００に接触しないとき、すなわち、
Figure 0003993883
 のときには、（式４９）で示す倒立走行制御を行って走行状態を維持する一方、車体１が傾いて地面８００に接触するとき、すなわち、
Figure 0003993883
 の時には、（式５４）に基づく制御を行う。
ここで、一例として、図１１のように、倒立停止又は走行状態（一点鎖線で示すＩ）に対して、傾斜位置（点線で示すＩＩ又はＩＩＩ）のように１０°傾斜すると、車体１が地面８００に接触していると仮定するときには、０．５°の許容値を考慮して、９．５°以上傾くと、車体１が地面８００に接触していると判断するようにすればよい。すなわち、
Figure 0003993883
 又は、
Figure 0003993883
 のときは、車体１が地面８００に接触していると判断するようにすればよい。よって、車体１が傾いて地面８００に接触しないとき、すなわち、
Figure 0003993883
 のときには、（式４９）で示す倒立走行制御を行って走行状態を維持する一方、車体１が傾いて地面８００に接触するとき、すなわち、
Figure 0003993883
 の時には、（式５４）に基づく速度制御を行う。
以上のように、車体１の傾斜角度に応じて制御方法を切り替えながら走行することによって、平坦な面において接触が発生しても、暴走することなく安全にかつユーザに負担をかけずに走行を継続できる。
なお、上記様々な実施形態のうちの任意の実施形態を適宜組み合わせることにより、それぞれの有する効果を奏するようにすることができる。
本発明にかかる倒立二輪走行型ロボット及びその制御方法では、地面や壁などに接触して回転を拘束された場合でも、姿勢制御や走行状態を維持でき、かつユーザに負担をかけずに、安全に移動することができる倒立二輪走行型ロボット及びその制御方法を提供できる。
本発明は、添付図面を参照しながら好ましい実施形態に関連して充分に記載されているが、この技術の熟練した人々にとっては種々の変形や修正は明白である。そのような変形や修正は、添付した請求の範囲による本発明の範囲から外れない限りにおいて、その中に含まれると理解されるべきである。
本発明のこれらと他の目的と特徴は、添付された図面についての好ましい実施形態に関連した次の記述から明らかになる。
図１Ａは、本発明の第１実施形態における倒立二輪走行型ロボットの傾いた状態での側面図である。 図１Ｂは、本発明の第１実施形態における倒立二輪走行型ロボットの制御部などのブロック図である。 図２は、本発明の第１実施形態における倒立二輪走行型ロボットの傾いた状態での正面図である。 図３は、本発明の第１実施形態における倒立二輪走行型ロボットの移動構成の説明図である。 図４は、本発明の第１実施形態における倒立二輪走行型ロボットの機構パラメータ図である。 図５は、本発明の第１実施形態における倒立二輪走行型ロボットの制御ブロック図である。 図６は、本発明の第１実施形態における倒立二輪走行型ロボットの旋回制御模式図である。 図７は、本発明の第１実施形態における走行制御全体図である。 図８は、本発明の第２実施形態における倒立二輪走行型ロボットのフローチャートである。 図９は、本発明の第１実施形態における倒立二輪走行型ロボットの接触状態図である。 図１０は、本発明の第２実施形態における倒立二輪走行型ロボットのフローチャートである。 図１１は、本発明の第３実施形態における倒立二輪走行型ロボットの車体が傾いて地面に必ず接触する場合の説明図である。 図１２は、本発明の第１実施形態における倒立二輪走行型ロボットのフローチャートである。 図１３は、従来の特許文献１に記載の同軸二輪車型の移動ロボットの図である。 図１４は、従来の特許文献２に記載の人乗り型の同軸二輪車型移動ロボットの図である。

Claims (4)

  1. 車体と、
    上記車体に同軸に配置された２つの車輪と、
    上記車輪を各々駆動する駆動装置と、
    上記車体の傾斜角度及び傾斜角速度の少なくとも１つを検出する第１状態検出手段と、
    上記車輪の回転角度及び回転角速度の少なくとも１つを検出する第２状態検出手段と、
    上記車体に有しかつ上記車体が地面に接触するか否かの接触有無を検出する少なくとも一つの接触センサと、
    上記接触センサで検出された上記車体に対して接触していることが接触情報として入力されると、上記入力された接触情報により上記車体の傾斜方向への回転が拘束されている車体拘束状態を認識する車体拘束認識手段と、
    上記駆動装置への指令値を決定し、決定した指令値により、上記車体が移動停止して上記地面に接触している状態から、上記駆動装置を駆動して上記車体を倒立位置まで起き上がらせて上記車体を走行停止状態で倒立状態を維持させる倒立停止制御を行なう走行制御方法と、上記車体に対する接触を考慮することなく上記車体の上記倒立状態を維持しながら上記車体を走行させる第１倒立走行制御を行なう走行制御方法と、上記車体に対する接触を考慮して上記車体の上記倒立状態を維持しながら上記車体を走行させる第２倒立走行制御を行なう走行制御方法とを切り替えて上記駆動装置が駆動され上記車体の走行制御が行われる制御手段とを備え、
    上記車体拘束認識手段の検出結果に基づいて、上記制御手段が、上記複数の走行制御方法を切替える上記駆動装置への指令値を決定し、決定された上記指令値により上記駆動装置が駆動されて、上記車体の走行制御が行われて走行状態を維持する倒立二輪走行型ロボット。
  2. 車体と、
    上記車体に同軸に配置された２つの車輪と、
    上記車輪を各々駆動する駆動装置と、
    上記車体の傾斜角度及び傾斜角速度の少なくとも１つを検出する第１状態検出手段と、
    上記車輪の回転角度及び回転角速度の少なくとも１つを検出する第２状態検出手段と、
    上記第１状態検出手段により検出された上記車体の傾斜角度が所定角度以上傾いたとき、上記車体の傾斜方向への回転が拘束されている車体拘束状態を認識する車体拘束認識手段と、
    上記駆動装置への指令値を決定し、決定した指令値により、上記車体が移動停止して上記車体拘束状態から、上記駆動装置を駆動して上記車体を倒立位置まで起き上がらせて上記車体を走行停止状態で倒立状態を維持させる倒立停止制御を行なう走行制御方法と、上記車体拘束状態を考慮することなく上記車体の上記倒立状態を維持しながら上記車体を走行させる第１倒立走行制御を行なう走行制御方法と、上記車体拘束状態を考慮して上記車体の上記倒立状態を維持しながら上記車体を走行させる第２倒立走行制御を行なう走行制御方法とを切り替えて上記駆動装置が駆動され上記車体の走行制御が行われる制御手段とを備え、
    上記車体拘束認識手段の検出結果に基づいて、上記制御手段が、上記複数の走行制御方法を切替える上記駆動装置への指令値を決定し、決定された上記指令値により上記駆動装置が駆動されて、上記車体の走行制御が行われて走行状態を維持する一方、車体拘束時には、上記車輪を回転駆動させるトルクに、上記車体への拘束力による発生するトルク分を加算する制御方法に切り替える倒立二輪走行型ロボット。
  3. 車体と、
    上記車体に同軸に配置された２つの車輪と、
    上記車輪を各々駆動する駆動装置と、
    上記車体の傾斜角度及び傾斜角速度の少なくとも１つを検出する第１状態検出手段と、
    上記車輪の回転角度及び回転角速度の少なくとも１つを検出する第２状態検出手段と、
    上記車体に有しかつ上記車体が地面に接触することにより上記車体が受ける接触力を検 出する少なくとも一つの接触センサと、
    上記接触センサで検出された上記車体に対する接触力が接触情報として入力されると、上記入力された接触情報により上記車体の傾斜方向への回転が拘束されている車体拘束状態を認識する車体拘束認識手段と、
    上記駆動装置への指令値を決定し、決定した指令値により、上記車体が移動停止して上記地面に接触している状態から、上記駆動装置を駆動して上記車体を倒立位置まで起き上がらせて上記車体を走行停止状態で倒立状態を維持させる倒立停止制御を行なう走行制御方法と、上記車体に対する接触を考慮することなく上記車体の上記倒立状態を維持しながら上記車体を走行させる第１倒立走行制御を行なう走行制御方法と、上記車体に対する接触力を考慮して上記車体の上記倒立状態を維持しながら上記車体を走行させる第２倒立走行制御を行なう走行制御方法とを切り替えて上記駆動装置が駆動され上記車体の走行制御が行われる制御手段とを備え、
    上記制御手段は、上記車体が移動停止して上記地面に接触している状態から、上記駆動装置を駆動して上記車体を倒立位置まで起き上がらせて上記倒立停止制御を行い、上記倒立状態が安定したのち、上記接触センサによる接触情報の有無の検出を上記車体拘束認識手段で開始し、上記接触センサによる接触情報が無く上記車体拘束認識手段で上記車体拘束状態を認識しないとき、上記倒立停止制御から上記第１倒立走行制御に切替えて走行状態を維持させるとともに、上記接触センサによる接触情報が有り上記車体拘束認識手段で上記車体拘束状態を認識したとき、上記倒立停止制御又は上記第１倒立走行制御から上記第２倒立走行制御に切替えて、上記接触力の方向と上記駆動装置へのトルク指令値（τ 1 ）とを比較し、その回転方向が反対の場合には、上記駆動装置へのトルク指令値に上記接触力により発生するトルク（τａ）を加算した値を新たなトルク指令値として、その新たなトルク指令値により上記駆動装置が駆動される倒立二輪走行型ロボット。
  4. 上記車体拘束認識手段で上記車体拘束状態を認識して上記制御手段により上記第２倒立走行制御を行なうとき、上記車体拘束状態を考慮して上記車体の上記倒立状態を維持しながら上記車体の回転速度に対するＰＩＤ制御の速度制御により上記車体を走行させるとともに、上記車体の回転速度に対する上記ＰＩＤ制御の速度制御において、上記車輪の回転角速度の誤差の積分値をリセットすることにより、上記車体の上記地面に対する接触する前に発生している上記車体の位置ずれである速度差の積分値を一度ゼロにして接触時からのＰＩＤ制御にする請求項１に記載の倒立二輪走行型ロボット。
JP2006526472A 2005-07-26 2006-07-07 倒立二輪走行型ロボット及びその制御方法 Active JP3993883B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2005215789 2005-07-26
JP2005215789 2005-07-26
PCT/JP2006/313579 WO2007013282A1 (ja) 2005-07-26 2006-07-07 倒立二輪走行型ロボット及びその制御方法

Publications (2)

Publication Number Publication Date
JP3993883B2 true JP3993883B2 (ja) 2007-10-17
JPWO2007013282A1 JPWO2007013282A1 (ja) 2009-02-05

Family

ID=37683183

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006526472A Active JP3993883B2 (ja) 2005-07-26 2006-07-07 倒立二輪走行型ロボット及びその制御方法

Country Status (4)

Country Link
US (1) US7635041B2 (ja)
JP (1) JP3993883B2 (ja)
CN (1) CN100557539C (ja)
WO (1) WO2007013282A1 (ja)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10173738B2 (en) 2016-10-18 2019-01-08 Piaggio Fast Forward, Inc. Vehicle having stabilization system
US10293676B2 (en) 2016-10-18 2019-05-21 Piaggio Fast Forward, Inc. Vehicle having non-axial drive
USD890024S1 (en) 2016-12-06 2020-07-14 Piaggio Fast Forward, Inc. Vehicle
USD911405S1 (en) 2018-10-22 2021-02-23 Piaggio Fast Forward, Inc. Mobile carrier
US11112807B1 (en) 2018-05-01 2021-09-07 Piaggio Fast Forward, Inc. Method for determining self-driving vehicle behavior models, a self-driving vehicle, and a method of navigating a self-driving vehicle
US11370497B2 (en) 2016-10-18 2022-06-28 Piaggio Fast Forward, Inc. Vehicle having non-axial drive and stabilization system
US11408498B2 (en) 2018-10-22 2022-08-09 Piaggio Fast Forward, Inc. Shifting assembly and mobile carrier comprising same
US11613325B2 (en) 2017-10-11 2023-03-28 Piaggio Fast Forward Inc. Two-wheeled vehicle having linear stabilization system

Families Citing this family (38)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006136962A (ja) * 2004-11-11 2006-06-01 Hitachi Ltd 移動ロボット
JP4760162B2 (ja) * 2005-06-29 2011-08-31 トヨタ自動車株式会社 移動台車の制御方法及び移動台車
WO2007129505A1 (ja) * 2006-05-09 2007-11-15 Equos Research Co., Ltd. 車両、特性量推定装置及び搭載物判定装置
JP4434186B2 (ja) * 2006-09-04 2010-03-17 トヨタ自動車株式会社 移動体及び移動体の制御方法
JPWO2008065853A1 (ja) * 2006-11-30 2010-03-04 株式会社エクォス・リサーチ 車両
JP4779982B2 (ja) * 2007-02-02 2011-09-28 トヨタ自動車株式会社 移動体及び移動体の制御方法
JP4363455B2 (ja) * 2007-04-19 2009-11-11 トヨタ自動車株式会社 走行装置
JP5089260B2 (ja) * 2007-06-14 2012-12-05 キヤノン株式会社 画像読取装置と画像形成装置
JP4867823B2 (ja) * 2007-07-09 2012-02-01 トヨタ自動車株式会社 倒立車輪型移動体、及びその制御方法
WO2009022584A1 (ja) * 2007-08-10 2009-02-19 Equos Research Co., Ltd. 車両
CN101568465B (zh) * 2007-08-28 2011-05-11 松下电器产业株式会社 倒立双轮式搬运车及其控制方法
JP2009073261A (ja) * 2007-09-19 2009-04-09 Equos Research Co Ltd 車両
JP5186853B2 (ja) * 2007-09-19 2013-04-24 株式会社エクォス・リサーチ 車両
KR101017924B1 (ko) * 2008-08-01 2011-03-04 호야로봇 (주) 지형극복을 위한 보조 바퀴가 내장된 소형 모바일로봇
US8041456B1 (en) * 2008-10-22 2011-10-18 Anybots, Inc. Self-balancing robot including an ultracapacitor power source
US8160747B1 (en) 2008-10-24 2012-04-17 Anybots, Inc. Remotely controlled self-balancing robot including kinematic image stabilization
US8442661B1 (en) * 2008-11-25 2013-05-14 Anybots 2.0, Inc. Remotely controlled self-balancing robot including a stabilized laser pointer
WO2010068704A2 (en) 2008-12-09 2010-06-17 Reconrobotics, Inc. Two-wheeled robot with enhanced climbing features
JP5003716B2 (ja) * 2009-04-17 2012-08-15 トヨタ自動車株式会社 走行装置及びその制御方法
CH702282A1 (de) 2009-11-27 2011-05-31 Alstom Technology Ltd Fahrzeug zur selbständigen Inspektion von schwer zugänglichen Innenräumen.
CN101791800B (zh) * 2010-01-21 2011-05-25 西北工业大学 一种双轮差动式机器人运动控制方法
US8788096B1 (en) 2010-05-17 2014-07-22 Anybots 2.0, Inc. Self-balancing robot having a shaft-mounted head
JP5560234B2 (ja) * 2011-05-31 2014-07-23 トヨタテクニカルディベロップメント株式会社 重心角推定方法及び同方法によって制御される倒立車輪型走行体
JP5397791B2 (ja) * 2012-01-10 2014-01-22 株式会社エクォス・リサーチ 車両
JP5561289B2 (ja) * 2012-02-06 2014-07-30 株式会社エクォス・リサーチ 車両
EP2906170B1 (en) * 2013-09-13 2016-11-02 Dynamic Controls Method for producing or calibrating a control profile for a wheelchair
US9829882B2 (en) 2013-12-20 2017-11-28 Sphero, Inc. Self-propelled device with center of mass drive system
CN103832384B (zh) * 2014-03-19 2017-06-27 大连理工大学 防侧倾装置
WO2017073055A1 (ja) * 2015-10-27 2017-05-04 パナソニックＩｐマネジメント株式会社 搬送装置
CN105539658B (zh) * 2015-12-24 2018-03-30 鲍炜 一种安全的两轮自平衡车
WO2017124120A1 (en) * 2016-01-17 2017-07-20 Chen, Shane Self-balancing load bearing vehicle
CN105799828B (zh) * 2016-03-17 2019-02-22 杭州骑客智能科技有限公司 一种人机交互运动车的运动控制方法以及运动控制系统
US10772774B2 (en) * 2016-08-10 2020-09-15 Max Mobility, Llc Self-balancing wheelchair
CN108536165A (zh) * 2018-04-02 2018-09-14 深圳小趴智能科技有限公司 一种姿态感应遥控装置控制机器人运动方法
CN108582074B (zh) * 2018-05-09 2021-11-30 算丰科技（北京）有限公司 机器人、机器人控制方法及装置
CN112644984B (zh) * 2019-10-10 2024-09-24 松下知识产权经营株式会社 控制方法、控制系统、输送装置及部件安装系统
CN111923061B (zh) * 2020-08-11 2023-12-01 行星算力(深圳)科技有限公司 轮式运输机器人
CN111874125B (zh) * 2020-08-11 2023-08-18 行星算力(深圳)科技有限公司 具有驻车功能的轮式机器人

Family Cites Families (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2530652B2 (ja) * 1987-06-05 1996-09-04 シ−ケ−ディ株式会社 同軸二輪車における姿勢制御方法
US5971091A (en) * 1993-02-24 1999-10-26 Deka Products Limited Partnership Transportation vehicles and methods
US6561294B1 (en) * 1995-02-03 2003-05-13 Deka Products Limited Partnership Balancing vehicle with passive pivotable support
IL127778A (en) * 1996-07-17 2004-09-27 Deka Products Lp Anti-tipping mechanism
WO2000054719A1 (en) * 1999-03-15 2000-09-21 Deka Products Limited Partnership Control system and method for wheelchair
US6799649B2 (en) * 1999-03-15 2004-10-05 Deka Products Limited Partnership Control of a balancing personal vehicle
US6302230B1 (en) * 1999-06-04 2001-10-16 Deka Products Limited Partnership Personal mobility vehicles and methods
JP2003330537A (ja) * 2002-05-15 2003-11-21 Matsushita Electric Ind Co Ltd 自走式機器およびそのプログラム
US20050252700A1 (en) * 2002-06-04 2005-11-17 Chin Kitauchi Powered manual propelling vehicle
JP5099971B2 (ja) * 2002-07-12 2012-12-19 デカ・プロダクツ・リミテッド・パートナーシップ 運搬装置のための運動制御
US7210544B2 (en) * 2002-07-12 2007-05-01 Deka Products Limited Partnership Control of a transporter based on attitude
JP2004074814A (ja) 2002-08-09 2004-03-11 Matsushita Electric Works Ltd 人用移動機器
CN100361862C (zh) * 2002-11-20 2008-01-16 中国科学技术大学 自平衡两轮电动车
JP2004215350A (ja) * 2002-12-27 2004-07-29 Sony Corp 駆動制御装置およびその方法と２輪車
JP4138546B2 (ja) 2003-03-26 2008-08-27 トヨタ自動車株式会社 移動台車及び移動台車の制御方法
JP4411867B2 (ja) * 2003-06-04 2010-02-10 トヨタ自動車株式会社 重心移動により操舵可能な車両
WO2004110854A1 (ja) * 2003-06-12 2004-12-23 Sony Corporation 同軸二輪車
JP2005094858A (ja) * 2003-09-12 2005-04-07 Sony Corp 走行装置及びその制御方法
EP1529556B1 (en) * 2003-11-04 2013-02-20 Toyota Jidosha Kabushiki Kaisha Travelling apparatus and method for controlling thereof
JP4327566B2 (ja) * 2003-11-17 2009-09-09 トヨタ自動車株式会社 前輪の接地と浮遊が切換え可能な走行体および走行状態切換え方法
JP4760162B2 (ja) * 2005-06-29 2011-08-31 トヨタ自動車株式会社 移動台車の制御方法及び移動台車

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10173738B2 (en) 2016-10-18 2019-01-08 Piaggio Fast Forward, Inc. Vehicle having stabilization system
US10293676B2 (en) 2016-10-18 2019-05-21 Piaggio Fast Forward, Inc. Vehicle having non-axial drive
US11370497B2 (en) 2016-10-18 2022-06-28 Piaggio Fast Forward, Inc. Vehicle having non-axial drive and stabilization system
USD890024S1 (en) 2016-12-06 2020-07-14 Piaggio Fast Forward, Inc. Vehicle
US11613325B2 (en) 2017-10-11 2023-03-28 Piaggio Fast Forward Inc. Two-wheeled vehicle having linear stabilization system
US11112807B1 (en) 2018-05-01 2021-09-07 Piaggio Fast Forward, Inc. Method for determining self-driving vehicle behavior models, a self-driving vehicle, and a method of navigating a self-driving vehicle
US11675373B2 (en) 2018-05-01 2023-06-13 Piaggio Fast Forward Inc. Method for determining self-driving vehicle behavior models, a self-driving vehicle, and a method of navigating a self-driving vehicle
USD911405S1 (en) 2018-10-22 2021-02-23 Piaggio Fast Forward, Inc. Mobile carrier
USD913351S1 (en) 2018-10-22 2021-03-16 Piaggio Fast Forward, Inc. Mobile carrier
US11408498B2 (en) 2018-10-22 2022-08-09 Piaggio Fast Forward, Inc. Shifting assembly and mobile carrier comprising same

Also Published As

Publication number Publication date
CN101052929A (zh) 2007-10-10
WO2007013282A1 (ja) 2007-02-01
US7635041B2 (en) 2009-12-22
JPWO2007013282A1 (ja) 2009-02-05
CN100557539C (zh) 2009-11-04
US20080173493A1 (en) 2008-07-24

Similar Documents

Publication Publication Date Title
JP3993883B2 (ja) 倒立二輪走行型ロボット及びその制御方法
KR100950952B1 (ko) 이동돌리의 제어방법 및 이동돌리
US7649331B2 (en) Mobile robot
JP4816058B2 (ja) 走行装置及びその制御方法
US8068976B2 (en) Coaxial two-wheel vehicle and method for controlling the same
JP4956962B2 (ja) 走行装置及びその制御方法
JP4434186B2 (ja) 移動体及び移動体の制御方法
US8014923B2 (en) Travel device
JP4600539B2 (ja) 走行装置、走行装置の制御方法
EP2093100B1 (en) Travel gear and its controlling method
EP2783959B1 (en) Inverted pendulum type vehicle
US20100030442A1 (en) Movable body, travel device, and movable body control method
US20140067177A1 (en) Inverted pendulum type vehicle, and control method of inverted pendulum type vehicle
JP2010225139A (ja) 移動機器
US20210197918A1 (en) Control device for mobile body
JP2007168602A (ja) 二輪移動台車
WO2018074117A1 (ja) 移動装置、および、移動装置管理システム
JP2009101484A (ja) 倒立走行ロボット及びその制御方法
JP2007168603A (ja) 同軸二輪移動台車
JP2009101899A (ja) 倒立車輪型移動体、及びその制御方法
JP2009101898A (ja) 倒立車輪型移動体、及びその制御方法
WO2010125727A1 (ja) 倒立型移動体の制御装置
EP2664532B1 (en) Inverted pendulum type vehicle
JP2009101897A (ja) 倒立車輪型移動体、及びその制御方法
JP2009101817A (ja) 倒立車輪型移動体及びその制御方法

Legal Events

Date Code Title Description
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: 20070703

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20070727

R150 Certificate of patent or registration of utility model

Ref document number: 3993883

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100803

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110803

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110803

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120803

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130803

Year of fee payment: 6

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20061108

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20060912

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20060912

A871 Explanation of circumstances concerning accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A871

Effective date: 20060912

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20060912