JP4625859B2 - 倒立振子型移動機構 - Google Patents
倒立振子型移動機構 Download PDFInfo
- Publication number
- JP4625859B2 JP4625859B2 JP2008252171A JP2008252171A JP4625859B2 JP 4625859 B2 JP4625859 B2 JP 4625859B2 JP 2008252171 A JP2008252171 A JP 2008252171A JP 2008252171 A JP2008252171 A JP 2008252171A JP 4625859 B2 JP4625859 B2 JP 4625859B2
- Authority
- JP
- Japan
- Prior art keywords
- wheel
- control
- idling
- moving mechanism
- traction
- 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
- 238000001514 detection method Methods 0.000 claims description 41
- 238000000034 method Methods 0.000 description 10
- 230000001133 acceleration Effects 0.000 description 8
- 238000004364 calculation method Methods 0.000 description 8
- 230000014509 gene expression Effects 0.000 description 6
- 230000005484 gravity Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 238000006073 displacement reaction Methods 0.000 description 4
- 239000011159 matrix material Substances 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000011084 recovery Methods 0.000 description 2
- 230000002411 adverse Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J5/00—Manipulators mounted on wheels or on carriages
- B25J5/007—Manipulators mounted on wheels or on carriages mounted on wheels
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J5/00—Manipulators mounted on wheels or on carriages
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Motorcycle And Bicycle Frame (AREA)
- Manipulator (AREA)
Description
しかしながら、安定な走行を維持する上で、転倒は可能な限り防止する必要がある。
一方、片側の車輪のトラクションが抜けた場合、例えば左車輪が空転した場合、空転車輪側から上体への反力がなくなるためヨー軸まわりに回転力が発生し、右モータ駆動トルクτRが正値であるとΔθy_gyroは正値に、τRが負値であるとΔθy_gyroは負値となる。
そこで、本実施形態では、図6のフローチャートに従って、トラクション復帰検出部209がトラクション復帰の検出を行う。
102 移動機構
103 上体
104,105 車輪
106,107 走行モータ
108,109 姿勢方位センサ
110 マニピュレータ
111 頭部
112 制御装置
201 移動目標生成部
202 動作計画部
203 目標モータ駆動トルク演算部
204 左モータ駆動装置
205 右モータ駆動装置
206,207 エンコーダ
208 空転検出部
209 トラクション復帰検出部
210 経路制御部
Claims (4)
- 左右の車輪及びこれらの車輪を回転駆動する走行モータを有する移動機構と、前記移動機構に支持された上体と、前記移動機構を制御する制御装置とを備えた倒立振子型移動機構において、
前記制御装置は、車輪の空転検出部及びトラクション復帰検出部を備え、前記空転検出部で空転が検出されない場合には両輪起立走行制御を行い、前記空転検出部で空転が検出された場合には接地車輪による接地車輪起立制御を行うと共に、
空転車輪に対してトラクション復帰を促す空転車輪制御を行い、前記トラクション復帰検出部でトラクション復帰が検出されない場合には前記接地車輪起立制御へ戻り、前記トラクション復帰検出部でトラクション復帰が検出された場合には前記両輪起立走行制御に復帰することにより、空転対応制御を行い、
前記接地車輪起立制御は、前記移動機構が備えた接地車輪の回転運動を検出可能な角速度センサの情報と、前記上体が備えた前記上体の鉛直方向に対する傾斜角運動を検出可能な第1姿勢方位センサの情報と、前記上体が備えた前記上体のヨー軸周りの旋回角運動を検出可能な第2姿勢方位センサの情報とに基づいて、起立状態制御を行う倒立振子型移動機構。 - 請求項1において、前記角速度センサの情報及び前記第2姿勢方位センサの情報は、前記上体のヨー軸周りの旋回運動成分を除いた前記接地車輪の運動情報となるように演算され、前記起立状態制御に用いられる倒立振子型移動機構。
- 請求項1において、前記空転車輪制御は、前記移動機構が備えた接地車輪の回転運動を検出可能な角速度センサの情報及び前記上体が備えたヨー旋回運動を検出可能な姿勢方位センサの情報から算出される、空転車輪と床との相対速度に車輪の粘性抵抗を乗じた値から、所定の最低復帰トラクション量に車輪半径を乗じた値を引いた値を、空転車輪への駆動トルクとする倒立振子型移動機構。
- 請求項1において、前記トラクション復帰検出部は、空転車輪速度と、空転車輪と床との相対速度との差が一定の閾値以内にある摩擦負荷継続時間が、予め決定された復帰判定時間長を越えた時に、トラクションが復帰したと判定する倒立振子型移動機構。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008252171A JP4625859B2 (ja) | 2008-09-30 | 2008-09-30 | 倒立振子型移動機構 |
KR1020090092262A KR101117040B1 (ko) | 2008-09-30 | 2009-09-29 | 도립 진자형 이동 기구 |
US12/570,081 US20100082204A1 (en) | 2008-09-30 | 2009-09-30 | Inverted pendulum type moving mechanism |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008252171A JP4625859B2 (ja) | 2008-09-30 | 2008-09-30 | 倒立振子型移動機構 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2010082717A JP2010082717A (ja) | 2010-04-15 |
JP4625859B2 true JP4625859B2 (ja) | 2011-02-02 |
Family
ID=42058303
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008252171A Expired - Fee Related JP4625859B2 (ja) | 2008-09-30 | 2008-09-30 | 倒立振子型移動機構 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20100082204A1 (ja) |
JP (1) | JP4625859B2 (ja) |
KR (1) | KR101117040B1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7523656B1 (ja) | 2023-12-27 | 2024-07-26 | 松浦 美和子 | 衿芯 |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5652043B2 (ja) * | 2010-08-06 | 2015-01-14 | トヨタ自動車株式会社 | 倒立型移動体、その制御方法及び制御プログラム |
KR101232584B1 (ko) * | 2011-02-11 | 2013-02-12 | 고려대학교 산학협력단 | 이동 로봇의 제어 장치 및 그 방법 |
WO2014045857A1 (ja) * | 2012-09-18 | 2014-03-27 | 株式会社村田製作所 | 移動体 |
KR102079940B1 (ko) * | 2013-07-09 | 2020-02-21 | 삼성전자주식회사 | 마찰계수 추정 기능을 갖는 이동 로봇 및 마찰계수 추정 방법 |
US9566534B1 (en) * | 2014-01-06 | 2017-02-14 | Wowwee Group Ltd | User interface |
JP6623871B2 (ja) * | 2016-03-18 | 2019-12-25 | トヨタ自動車株式会社 | ロボット |
CN110161848A (zh) * | 2019-03-12 | 2019-08-23 | 广东省智能制造研究所 | 一种基于时间自动机的一阶直线倒立摆控制方法及系统 |
CN111596653A (zh) * | 2020-04-09 | 2020-08-28 | 北京理工大学 | 一种消防机器人及其控制方法、电子设备 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004510637A (ja) * | 2000-10-13 | 2004-04-08 | デカ・プロダクツ・リミテッド・パートナーシップ | 個人用輸送車の制御 |
JP2008189089A (ja) * | 2007-02-02 | 2008-08-21 | Toyota Motor Corp | 移動体及び移動体の制御方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2530652B2 (ja) * | 1987-06-05 | 1996-09-04 | シ−ケ−ディ株式会社 | 同軸二輪車における姿勢制御方法 |
US6288505B1 (en) * | 2000-10-13 | 2001-09-11 | Deka Products Limited Partnership | Motor amplifier and control for a personal transporter |
US6408240B1 (en) * | 2000-10-13 | 2002-06-18 | Deka Products Limited Partnership | Traction control for a personal transporter |
-
2008
- 2008-09-30 JP JP2008252171A patent/JP4625859B2/ja not_active Expired - Fee Related
-
2009
- 2009-09-29 KR KR1020090092262A patent/KR101117040B1/ko active IP Right Grant
- 2009-09-30 US US12/570,081 patent/US20100082204A1/en not_active Abandoned
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004510637A (ja) * | 2000-10-13 | 2004-04-08 | デカ・プロダクツ・リミテッド・パートナーシップ | 個人用輸送車の制御 |
JP2008189089A (ja) * | 2007-02-02 | 2008-08-21 | Toyota Motor Corp | 移動体及び移動体の制御方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7523656B1 (ja) | 2023-12-27 | 2024-07-26 | 松浦 美和子 | 衿芯 |
Also Published As
Publication number | Publication date |
---|---|
KR101117040B1 (ko) | 2012-03-16 |
US20100082204A1 (en) | 2010-04-01 |
KR20100036993A (ko) | 2010-04-08 |
JP2010082717A (ja) | 2010-04-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4625859B2 (ja) | 倒立振子型移動機構 | |
KR101156822B1 (ko) | 이동체 및 이동체의 제어 방법 | |
JP4600539B2 (ja) | 走行装置、走行装置の制御方法 | |
US8155828B2 (en) | Control method of traveling dolly | |
US8014923B2 (en) | Travel device | |
JP4605227B2 (ja) | 転倒防止制御装置 | |
US8447506B2 (en) | Traveling device and its control method | |
US8935050B2 (en) | Moving body control system, moving body control method, and non-transitory computer readable medium storing control program | |
CN102362233A (zh) | 车辆 | |
US9845101B2 (en) | Pushcart | |
WO2022059714A1 (ja) | 二輪車 | |
US10625777B2 (en) | Attitude control system | |
US10052253B2 (en) | Hand-propelled vehicle | |
JP2008241462A (ja) | 車輪半径推定装置 | |
JP4264399B2 (ja) | 無人搬送車 | |
JP5907037B2 (ja) | 移動体 | |
US20210055738A1 (en) | Self-propelled robot | |
WO2016016960A1 (ja) | 移動体 | |
Kojima et al. | Motion control of tracked vehicle based on contact force model | |
JP5125806B2 (ja) | 自立走行装置 | |
JP5369602B2 (ja) | 車両 | |
TW202421491A (zh) | 傾斜車輛 | |
JP5874618B2 (ja) | 移動体装置 | |
Takita et al. | Implementation of SSM to Lateral Guided Steering Vehicle With Body Fixed High-Speed Camera | |
JP2010100137A (ja) | 車両 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100311 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20100805 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100824 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20101001 |
|
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: 20101019 |
|
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: 20101108 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 4625859 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: 20131112 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |