JP6079661B2 - 倒立型移動体 - Google Patents
倒立型移動体 Download PDFInfo
- Publication number
- JP6079661B2 JP6079661B2 JP2014026470A JP2014026470A JP6079661B2 JP 6079661 B2 JP6079661 B2 JP 6079661B2 JP 2014026470 A JP2014026470 A JP 2014026470A JP 2014026470 A JP2014026470 A JP 2014026470A JP 6079661 B2 JP6079661 B2 JP 6079661B2
- Authority
- JP
- Japan
- Prior art keywords
- sensor
- value
- sensors
- inverted
- average
- 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
- 238000004364 calculation method Methods 0.000 claims description 18
- 230000001174 ascending effect Effects 0.000 claims description 16
- 238000001514 detection method Methods 0.000 claims description 11
- 238000000034 method Methods 0.000 description 12
- 230000008569 process Effects 0.000 description 10
- 230000002159 abnormal effect Effects 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000009977 dual effect Effects 0.000 description 3
- 239000000284 extract Substances 0.000 description 3
- 230000004913 activation Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000005856 abnormality Effects 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Gyroscopes (AREA)
- Motorcycle And Bicycle Frame (AREA)
Description
本発明は、このような問題点に鑑みてなされたものであり、各センサのセンサ値間の誤差を低減し安定的な倒立制御が継続できる倒立型移動体を提供することを主たる目的とする。
以下、図面を参照して本発明の実施の形態について説明する。
図1は、本発明の実施の形態1に係る倒立型移動体の概略的構成を示す斜視図である。 本発明の実施の形態1に係る倒立型移動体1は、搭乗者が搭乗する車両本体2と、車両本体2に回転可能に連結された左右一対の車輪3と、車両本体2に操作可能に設けられた操作ハンドル4と、を備えている。倒立型移動体1は、例えば、倒立状態を維持しつつ搭乗者の重心移動に応じて、前後進、左右旋回、加減速などの走行を行うことができる倒立二輪車として構成されている。
また、常時正常となる中央に位置する中央センサ値に基づいて誤差補正を行うことで、より信頼性の高い誤差補正を行うことができる。さらに、一般に、センサのセンサ値の誤差は温度に依存している。一方で、倒立型移動体1は、一回の充電で走行できる範囲は限られているため、その周辺の温度環境は大きく変化しない。したがって、起動時又は停止状態における中央センサ値を用いて各センサ6のセンサ値を安定的に補正することができる。
倒立制御部71は、補正部74により補正された各センサ6のセンサ値を降順又は昇順に並べた際に中央に位置する、又は各センサ6のセンサ値の平均値である、センサ中央値に基づいて倒立制御を行う。
センサ判定部72は、第1乃至第3ジャイロセンサ6から出力される第1乃至第3角速度V1〜V3の絶対値が閾値以下であるとき、正常信号を平均算出部73に出力する。
センサ判定部72は、倒立型移動体1の起動時において各センサ6から出力されるセンサ値の絶対値が閾値以下であるか否かを判定する(ステップS103)。
倒立制御部71は、補正部74により補正された各センサ6のセンサ値を降順又は昇順に並べた際に中央に位置するセンサ中央値に基づいて倒立制御を行う(ステップS107)。
上記実施の形態1に係る倒立型移動体1は、1重系の制御システムとして構成されているが、本実施の形態2に係る倒立型移動体1は、2重系の制御システムとして構成されている点を特徴とする。図4は、本実施の形態2に係る倒立移動体の制御システム構成を示すブロック図である。本実施の形態2に係る倒立型移動体1は、信頼性向上を目的として2重系システムとして構成されており、第1及び第2システム10、20を備えている。これにより、センサ情報及び制御信号を伝達する通信、制御、及び電源を各システムで分離できるため、一方のシステムに異常が生じても他方の正常なシステムで制御を継続できる。
各車輪駆動ユニット5は、第1及び第2制御装置7から出力された制御信号を合成し、合成した制御信号に応じて各車輪3を駆動する。
Claims (1)
- 同一検出対象の検出信号を出力する3つ以上のセンサと、
前記各センサから出力される各センサ値を降順又は昇順に並べた際に中央に位置するセンサ値に基づいて、倒立制御を行う制御手段と、を備える倒立型移動体であって、
当該倒立型移動体の起動時又は停止状態において前記各センサから出力される各センサ値の絶対値が閾値以下であるか否かを判定する判定手段と、
前記判定手段により前記各センサのセンサ値の絶対値が閾値以下であると判定されたとき、前記起動時又は停止状態におけるセンサ中央値と前記各センサのセンサ値との差分の平均値を算出する平均算出手段と、
前記各センサのセンサ値から、前記平均算出手段により算出された差分の平均値を減算又は加算することで、前記各センサのセンサ値を補正する補正手段と、を備える、ことを特徴とする倒立型移動体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014026470A JP6079661B2 (ja) | 2014-02-14 | 2014-02-14 | 倒立型移動体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014026470A JP6079661B2 (ja) | 2014-02-14 | 2014-02-14 | 倒立型移動体 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2015151003A JP2015151003A (ja) | 2015-08-24 |
JP6079661B2 true JP6079661B2 (ja) | 2017-02-15 |
Family
ID=53893718
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2014026470A Active JP6079661B2 (ja) | 2014-02-14 | 2014-02-14 | 倒立型移動体 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6079661B2 (ja) |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63153607A (ja) * | 1986-12-17 | 1988-06-27 | Toshiba Corp | 無人走行車 |
JPH06167350A (ja) * | 1992-11-30 | 1994-06-14 | Nec Home Electron Ltd | センサ出力処理装置 |
JP2004215350A (ja) * | 2002-12-27 | 2004-07-29 | Sony Corp | 駆動制御装置およびその方法と2輪車 |
-
2014
- 2014-02-14 JP JP2014026470A patent/JP6079661B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2015151003A (ja) | 2015-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10679507B2 (en) | Parking support system, parking support method and program | |
JP5868780B2 (ja) | 車両制御装置、車両制御方法、及びプログラム | |
CN104850119B (zh) | 自主车辆及其故障确定方法 | |
JP6777761B2 (ja) | 車両制御装置 | |
WO2015079300A1 (en) | Autonomous moving object | |
EP3647148B1 (en) | Vehicular control device | |
US9128488B2 (en) | Movement direction control apparatus and computer program | |
JP6123710B2 (ja) | 移動体 | |
JP2015162228A (ja) | 車両用制御装置 | |
US9650069B2 (en) | Method for controling rear wheel steering | |
JP5994607B2 (ja) | 同軸二輪移動体及びその制御方法 | |
JP5664531B2 (ja) | 追従制御装置 | |
JP7169059B2 (ja) | 車両制御装置 | |
JP6079661B2 (ja) | 倒立型移動体 | |
JP6164098B2 (ja) | 倒立型移動体及びその制御方法 | |
JP2019038475A (ja) | 制駆動力制御装置および自動操舵システム | |
US9367066B2 (en) | Inverted pendulum type vehicle | |
JP6627353B2 (ja) | 制御装置及びロボット | |
JP6354447B2 (ja) | 訓練システム、訓練方法及び訓練プログラム | |
CN111149073B (zh) | 移动体 | |
JP6197784B2 (ja) | 倒立移動体 | |
JP6940359B2 (ja) | 異常検出装置および異常検出方法 | |
JP2023172498A (ja) | 移動体、移動体システム、移動体の制御方法およびプログラム | |
JP2006345626A (ja) | 駆動輪速度補正方法及び装置 | |
KR20150146177A (ko) | 전동식 파워 스티어링 시스템 및 이를 사용한 차량 쏠림 보상 방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20160215 |
|
TRDD | Decision of grant or rejection written | ||
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20161215 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20161220 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170102 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6079661 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |