JP2017047010A - Inverted movable body - Google Patents
Inverted movable body Download PDFInfo
- Publication number
- JP2017047010A JP2017047010A JP2015173866A JP2015173866A JP2017047010A JP 2017047010 A JP2017047010 A JP 2017047010A JP 2015173866 A JP2015173866 A JP 2015173866A JP 2015173866 A JP2015173866 A JP 2015173866A JP 2017047010 A JP2017047010 A JP 2017047010A
- Authority
- JP
- Japan
- Prior art keywords
- control gain
- training
- inverted
- moving body
- peak value
- 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.)
- Granted
Links
Images
Abstract
Description
本発明は、倒立型移動体に関するものである。 The present invention relates to an inverted moving body.
倒立型移動体に搭乗してバランス訓練を行い、搭乗者の訓練改善度に応じて、倒立制御の制御ゲインを変更する訓練装置が知られている(例えば、特許文献1参照)。 2. Description of the Related Art A training apparatus is known that performs balance training by boarding an inverted moving body, and changes the control gain of the inverted control in accordance with the degree of training improvement of the passenger (see, for example, Patent Document 1).
ところで、例えば、前側のバランスが弱い患者等の前後不均等なバランスの搭乗者は、バランスが弱い方向に重心が偏る傾向がある。したがって、前後不均等なバランスの搭乗者が倒立型移動体に搭乗した場合、訓練改善度に応じて全体的に制御ゲインを変更しただけでは調整が不十分であるという問題があった。 By the way, for example, a passenger with an uneven front and rear balance, such as a patient with a weak front balance, tends to have a biased center of gravity in a direction where the balance is weak. Therefore, when a passenger with an unbalanced front and rear boarded the inverted mobile body, there was a problem that the adjustment was insufficient only by changing the control gain as a whole according to the degree of training improvement.
また、訓練エリアの中央部において訓練している場合、多少意図しない方向に倒立型移動体が移動しても問題はない。逆に、訓練エリアの端部近傍において訓練している場合、訓練エリア外に出る方向に倒立型移動体が移動することは避けたい。 Further, when training is performed in the center of the training area, there is no problem even if the inverted moving body moves in a somewhat unintended direction. Conversely, when training is performed in the vicinity of the end of the training area, it is desirable to avoid the inverted moving body moving in the direction of going out of the training area.
本発明は、このような問題点を解決するためになされたものであり、倒立型移動体が訓練エリアの端部近傍にいる場合に移動しにくくし、且つ搭乗者の身体的特徴を考慮した制御ゲインとすることができる倒立型移動体を提供することを目的とする。 The present invention has been made to solve such problems, and it is difficult to move when the inverted moving body is near the end of the training area, and the physical characteristics of the passenger are taken into consideration. It is an object of the present invention to provide an inverted moving body that can have a control gain.
上記目的を達成するための本発明の態様は、搭乗者の重心移動に応じて動作する倒立型移動体であって、訓練エリアの中央からの前記倒立型移動体の前後方向へのずれ量のピーク値をモニタリングするモニタリング部と、前記ずれ量のピーク値と閾値とを比較する比較部と、前記重心移動に対する前記倒立型移動体の移動しやすさを決める制御ゲインを設定する制御ゲイン設定部と、前記モニタリング、前記比較、及び前記制御ゲインの設定を所定回数繰り返し行わせる繰り返し部と、を備え、前記制御ゲイン設定部は、前記ずれ量のピーク値が前記閾値より大きい場合、前記訓練エリアのずれ方向の端部近傍における前記制御ゲインを一定量下げるように設定する倒立型移動体である。この態様によれば、倒立型移動体が訓練エリアの端部近傍にいる場合に移動しにくくし、且つ搭乗者の身体的特徴を考慮した制御ゲインとすることができる倒立型移動体を提供することができる。 An aspect of the present invention for achieving the above object is an inverted moving body that operates in accordance with the movement of the center of gravity of the occupant, the amount of deviation of the inverted moving body from the center of the training area in the front-rear direction. A monitoring unit that monitors a peak value, a comparison unit that compares the peak value of the deviation amount with a threshold value, and a control gain setting unit that sets a control gain that determines the ease of movement of the inverted moving body with respect to the movement of the center of gravity And a repeating unit that repeatedly performs the monitoring, the comparison, and the setting of the control gain a predetermined number of times, and the control gain setting unit has the training area when the peak value of the deviation amount is greater than the threshold value. This is an inverted moving body that is set so that the control gain in the vicinity of the end in the shift direction is lowered by a certain amount. According to this aspect, there is provided an inverted moving body that is less likely to move when the inverted moving body is in the vicinity of the end of the training area and that can have a control gain that takes into account the physical characteristics of the passenger. be able to.
本発明によれば、倒立型移動体が訓練エリアの端部近傍にいる場合に移動しにくくし、且つ搭乗者の身体的特徴を考慮した制御ゲインとすることができる倒立型移動体を提供することができる。 According to the present invention, there is provided an inverted moving body that is less likely to move when the inverted moving body is in the vicinity of the end of the training area and can have a control gain that takes into account the physical characteristics of the passenger. be able to.
実施の形態
以下、図面を参照して本発明の実施の形態について説明する。まず、図1を用いて本発明の実施の形態にかかる倒立型移動体100を有するバランストレーニングシステム1000の構成について説明する。
Embodiment Hereinafter, an embodiment of the present invention will be described with reference to the drawings. First, the configuration of a
バランストレーニングシステム1000は、倒立型移動体100と、ディスプレイ200と、訓練エリア300とを備えている。倒立型移動体100は、例えば、搭乗者が立った状態で乗車することができる立ち乗り型の同軸二輪車として構成される。また、倒立型移動体100は、例えば、搭乗者が重心を前後に移動させることで前進後退を行い、搭乗者が重心を左右に移動させることで左右旋回を行うことができるように構成されている。
The
倒立型移動体100の具体的な構成について説明する。倒立型移動体100は、搭乗者が操作する操作ハンドル110と、操作ハンドル110に連結され搭乗者が乗る台車部120と、台車部120の両側に回転可能に設けられた左右一対の駆動車輪130と、図示しない制御装置140とを備えている。倒立型移動体100は、搭乗者の重心移動による操作ハンドル110及び台車部120の傾斜に応じて、各駆動車輪130を回転させて、前後進、左右旋回、加減速、停止等の所望の走行を行うことができる。台車部120は、例えば、搭乗者が左右方向の重心移動を行うと、その重心移動に応じて左右方向に傾斜するように構成されている。
A specific configuration of the inverted moving body 100 will be described. The inverted moving body 100 includes an
例えば、搭乗者はその重心を前後方向に移動させ、操作ハンドル110及び台車部120を前後傾させることで、倒立型移動体100を前後進させることができる。また、搭乗者はその重心を左右方向に移動させ、操作ハンドル110及び台車部120を左右方向に傾斜させることで倒立型移動体100を左右旋回させることができる。
For example, the occupant can move the center of gravity in the front-rear direction and tilt the
制御装置140は、搭乗者の重心移動により倒立型移動体100を前後進又は左右旋回させると、倒立型移動体100の前後進又は左右旋回に応じた制御信号を、ディスプレイ200に対して送信する機能を備える。なお、制御装置140の他の機能については、後に図4を用いて詳述する。
When the inverted mobile body 100 moves forward and backward or turns left and right due to the movement of the center of gravity of the passenger, the
ディスプレイ200は、バランス訓練用の訓練メニューに応じた表示を行うものである。ここで、訓練メニューとは、例えば、スキーゲームやロデオゲーム等であり、ディスプレイ200は、ゲーム内での搭乗者を示すプレイヤー等の表示を行う。
The
ディスプレイ200は、倒立型移動体100の前後進又は左右旋回に応じた制御信号を、制御装置140から受信する。そして、ディスプレイ200は、受信した制御信号に応じて、プレイヤーを前後進又は左右旋回させて表示する。これにより、倒立型移動体100の動作とディスプレイ200のプレイヤーの動作は連動する。
The
訓練エリア300は、倒立型移動体100が当該エリア内でバランス訓練を行うよう定められているエリアである。
The
搭乗者は、倒立型移動体100に搭乗した状態で、ディスプレイ200に表示された画面を見ながら、左右バランス訓練を行う。
The passenger performs left-right balance training while viewing the screen displayed on the
続いて、左右バランス訓練の訓練メニューについて、スキーゲームとロデオゲームを例に具体的に説明する。なお、スキーゲームは、能動的な左右バランス訓練であり、ロデオゲームは、受動的な前後左右バランス訓練である。 Next, the training menu for left / right balance training will be described in detail by taking a ski game and a rodeo game as examples. The ski game is active left / right balance training, and the rodeo game is passive front / rear left / right balance training.
まず、図2を用いてスキーゲームについて説明する。図2は、スキーゲームの際にディスプレイ200に表示される画面表示を示す図である。図2に示すように、ディスプレイ200には、ゲーム内での搭乗者を示すプレイヤー及びゲートが表示される。
First, the ski game will be described with reference to FIG. FIG. 2 is a diagram showing a screen display displayed on the
搭乗者は、ディスプレイ200を見て、プレイヤーがゲートを通過するように、重心移動により倒立型移動体100を左右に旋回させる。プレイヤーがゲートを通過する位置が、ゲートの中央に近いほど得点が高くなる。なお、スキーゲームでは、搭乗者は倒立型移動体100を左右に旋回させることのみ求められ、前後に移動させることは求められない。つまり、搭乗者は、倒立型移動体100を前後に移動させないように前後のバランスを維持しながら、倒立型移動体100を左右に旋回させる必要がある。
The passenger looks at the
次に、図3を用いてロデオゲームについて説明する。図3は、ロデオゲームの際にディスプレイ200に表示される画面表示を示す図である。図3に示すように、ディスプレイ200には、ゲーム内での搭乗者を示すプレイヤー、プレイヤーを乗せる馬、及び円が表示される。
Next, the rodeo game will be described with reference to FIG. FIG. 3 is a diagram showing a screen display displayed on the
倒立型移動体100は、ランダムに前後に移動、左右に旋回しようとする(以下、外乱とも呼ぶ)。また、ディスプレイ200に表示される馬の動作は、倒立型移動体100の動作と連動している。搭乗者は、ディスプレイ200を見て、馬が円の中央に居続けるように、重心移動によりバランスを取る。すなわち、馬が後に動こうとしている場合、搭乗者は前方向に重心移動を行い、倒立型移動体100が後に移動しようとするのを止める。また、馬が前に動こうとしている場合、搭乗者は後方向に重心移動を行い、倒立型移動体100が前に移動しようとするのを止める。また、馬が左に旋回しようとしている場合、搭乗者は右方向に重心移動を行い、倒立型移動体100が左に旋回しようとするのを止める。また、馬が右に旋回しようとしている場合、搭乗者は左方向に重心移動を行い、倒立型移動体100が右に旋回しようとするのを止める。馬が円の内側に居続けると得点が加算され、円の中心に近いほど得点が高くなる。
The inverted moving body 100 randomly moves back and forth and tries to turn left and right (hereinafter also referred to as disturbance). Further, the operation of the horse displayed on the
上述の左右バランス訓練において、倒立型移動体100が前後方向に移動した場合には、訓練エリア300の中央に対する倒立型移動体100の前後方向へのベクトルの大きさは、訓練エリア300の中央からの倒立型移動体100の前後方向へのずれ量とされる。
In the left-right balance training described above, when the inverted moving body 100 moves in the front-rear direction, the magnitude of the vector in the front-rear direction of the inverted moving body 100 relative to the center of the
続いて、図4を用いて本発明の実施の形態にかかる倒立型移動体100の制御装置140の構成について説明する。制御装置140は、モニタリング部141と、比較部142と、制御ゲイン設定部143と、繰り返し部144とを備えている。
Then, the structure of the
モニタリング部141は、訓練エリア300の中央からの倒立型移動体100の前後方向へのずれ量のピーク値をモニタリングする機能部である。モニタリング部141は、訓練課題が出されると、訓練エリア300の中央からの倒立型移動体100の前後方向へのずれ量のピーク値をモニタリングする。ここで、訓練課題とは、例えば、訓練メニューがスキーゲームである場合、ゲートを1個通過するという課題であり、訓練メニューがロデオゲームである場合、外乱1動作に対して中央にとどまるようにバランスを取るという課題である。1回の左右バランス訓練、すなわち訓練メニューの1ゲームにおいて、例えば数十回の訓練課題が出される。
The
モニタリング部141は、例えば、倒立型移動体100のモータ回転数を用いて、訓練エリア300の中央からの倒立型移動体100の前後方向へのずれ量のピーク値を算出する。なお、モニタリングの手法は、倒立型移動体100のモータ回転数から算出する手法に限らない。例えば、倒立型移動体100の外部にカメラを設置し、当該カメラにより撮影された画像について、モニタリング部141が画像認識技術によって倒立型移動体100の位置を求め、当該位置から前後方向へのベクトルを算出することにより行ってもよい。そして、モニタリング部141は、前後方向へのずれ量のピーク値を比較部142へ出力する。
For example, the
比較部142は、前後方向へのずれ量のピーク値をモニタリング部141から受け取る。また、比較部142は、前後方向へのずれ量のピーク値と閾値とを比較する。なお、閾値は、前方向及び後方向のそれぞれについて設定されているものとする。例えば、前方向及び後方向のそれぞれについて、第1閾値と、第1閾値より絶対値の大きい第2閾値が設定される。この場合、比較部142は、前後方向へのずれ量のピーク値と、第1閾値及び第2閾値とを比較する。そして、前後いずれの方向のずれであるかを示すずれ方向情報を含む比較結果を、制御ゲイン設定部143へ出力する。
The
制御ゲイン設定部143は、搭乗者の重心移動に対する倒立型移動体100の移動しやすさを決める制御ゲインを設定する機能部である。制御ゲイン設定部143は、比較結果を比較部142から受け取る。また、制御ゲイン設定部143は、訓練エリア300のずれ方向の端部近傍における制御ゲインを、比較結果に応じた値に設定する。
The control
すなわち、制御ゲイン設定部143は、前方向へのずれ量のピーク値が、第2閾値より大きい場合、訓練エリア300の前方向の端部近傍における制御ゲインを一定量下げる。また、制御ゲイン設定部143は、前方向へのずれ量のピーク値が、第1閾値より小さい場合、訓練エリア300の前方向の端部近傍における制御ゲインを一定量上げる。また、制御ゲイン設定部143は、後方向へのずれ量のピーク値が、第2閾値より大きい場合、訓練エリア300の後方向の端部近傍における制御ゲインを一定量下げる。さらに、制御ゲイン設定部143は、後方向へのずれ量のピーク値が、第1閾値より小さい場合、訓練エリア300の後方向の端部近傍における制御ゲインを一定量上げる。
That is, the control
また、制御ゲイン設定部143は、前後方向へのずれ量のピーク値が、第1閾値以上、且つ第2閾値以下の場合、制御ゲインの変更を行わない。また、制御ゲイン設定部143は、制御ゲインが上限値である場合には、前後方向へのずれ量のピーク値が第1閾値より小さくても制御ゲインを上げない。
Further, the control
そして、制御ゲイン設定部143は、制御ゲインを変更した場合、及び制御ゲインを変更しなかった場合のいずれであっても、1訓練課題における制御ゲインの設定処理が終了したことを示す終了通知を繰り返し部144へ出力する。なお、制御ゲイン設定部143は、倒立型移動体100の制御ゲインの初期値として、訓練エリア300全体における制御ゲインを上限値に設定する機能も備えている。
Then, the control
繰り返し部144は、終了通知を制御ゲイン設定部143から受け取る。また、繰り返し部144は、終了通知を受け取ると、訓練課題が所定回数終了したか否かを判定する。また、繰り返し部144は、訓練課題が所定回数終了していない場合には、次の訓練課題に進むと判定する。そして、繰り返し部144は、次の訓練課題に進むと判定した場合、モニタリング部141、比較部142、及び制御ゲイン設定部143に対して、それぞれの処理を再実行させるための通知を出力する。なお、繰り返し部144は、モニタリング部141、比較部142、及び制御ゲイン設定部143のすべてに対して再実行させるための通知を出力してもよいし、出力する対象はすべてでなくてもよい。例えば、繰り返し部144は、次の訓練課題に進むと判定した場合、再実行させるための通知をモニタリング部141のみに出力してもよい。この場合、比較部142は、前後方向へのずれ量のピーク値をモニタリング部141から受け取った場合に、比較処理を再実行する。また、制御ゲイン設定部143は、比較結果を比較部142から受け取った場合に、制御ゲイン設定処理を再実行する。
The
続いて、図5のフローチャートを用いて、本発明の実施の形態にかかる倒立型移動体100の制御ゲインを逐次変更する処理フローについて説明する。まず、制御ゲイン設定部143は、倒立型移動体100の制御ゲインの初期値として、訓練エリア300全体における制御ゲインを上限値に設定する(S101)。倒立型移動体100の制御ゲインの初期値を示すグラフを図6に示す。なお、制御ゲインは、初期値として設定される上限値より上げることはできないものとする。
Next, a processing flow for sequentially changing the control gain of the inverted moving body 100 according to the embodiment of the present invention will be described using the flowchart of FIG. First, the control
次に、左右バランス訓練を開始する(S102)。ここで、左右バランス訓練の開始とは、訓練メニューのゲームを開始することである。次に、左右バランス訓練における訓練課題が出される(S103)。 Next, left / right balance training is started (S102). Here, the start of the left / right balance training is to start a training menu game. Next, a training task in left / right balance training is issued (S103).
次に、モニタリング部141は、訓練エリア300の中央からの倒立型移動体100の前後方向へのずれ量のピーク値をモニタリングする(S104)。次に、比較部142は、S104でモニタリングされたピーク値の絶対値が、第2閾値の絶対値より大きいか否かを判定する(S105)。
Next, the
S105により、ピーク値の絶対値が、第2閾値の絶対値より大きいと判定された場合、制御ゲイン設定部143は、訓練エリア300のずれ方向の端部近傍における制御ゲインを、一定量下げる(S106)。また、S105により、ピーク値の絶対値が、第2閾値の絶対値以下と判定された場合、比較部142は、S104でモニタリングされたピーク値の絶対値が、第1閾値の絶対値より小さいか否かを判定する(S107)。
When it is determined by S105 that the absolute value of the peak value is larger than the absolute value of the second threshold value, the control
S107により、ピーク値の絶対値が、第1閾値の絶対値より小さいと判定された場合、制御ゲイン設定部143は、訓練エリア300のずれ方向の端部近傍における制御ゲインを、一定量上げる(S108)。また、S107により、ピーク値の絶対値が、第1閾値の絶対値以上と判定された場合、制御ゲイン設定部143は、倒立型移動体100の制御ゲインを変更せずに、前後方向へのずれ量のピーク値のモニタリングを終了する(S109)。また、S106の実行後、及びS108の実行後についても、前後方向へのずれ量のピーク値のモニタリングを終了する(S109)。
When it is determined in S107 that the absolute value of the peak value is smaller than the absolute value of the first threshold, the control
次に、繰り返し部144は、1回の左右バランス訓練分の繰り返しが完了したか否かを判定する(S110)。S110により、1回の左右バランス訓練分の繰り返しが完了していないと判定された場合、S103に戻り、次の訓練課題に移る。また、S110により、1回の左右バランス訓練分の繰り返しが完了したと判定された場合、今回の左右バランス訓練を終了する(S111)。ここで、今回の左右バランス訓練の終了とは、訓練メニューの1ゲームの終了のことである。
Next, the repeating
次に、繰り返し部144は、次の左右バランス訓練、すなわち訓練メニューの次のゲームを開始するか否かを判定する(S112)。S112により、次の左右バランス訓練を開始すると判定された場合、S102に戻り、次の左右バランス訓練を開始させる。また、S112により、次の左右バランス訓練を開始しないと判定された場合、倒立型移動体100の制御ゲインを逐次変更する処理は終了する。
Next, the repeating
続いて、図7及び図8を用いて、倒立型移動体100の前後方向へのずれ量及び閾値に対する制御ゲインの設定例について説明する。図7は、中央からの倒立型移動体100の前後方向へのずれ量のピーク値と閾値との関係の一例を示す図である。また、図8は、図7の例における倒立型移動体100の制御ゲインの設定の推移を示す図である。 Next, an example of setting the control gain for the amount of deviation and the threshold value of the inverted moving body 100 in the front-rear direction will be described with reference to FIGS. 7 and 8. FIG. 7 is a diagram illustrating an example of a relationship between a peak value of a deviation amount in the front-rear direction of the inverted moving body 100 from the center and a threshold value. FIG. 8 is a diagram showing the transition of the control gain setting of the inverted moving body 100 in the example of FIG.
まず、倒立型移動体100は、訓練開始前の初期状態において、図8(a)に示すように、制御ゲインの初期値として、訓練エリア300全体における制御ゲインを上限値に設定される。次に、図7中の(1)に示すように、訓練エリア300の中央からの倒立型移動体100の前方向へのずれ量のピーク値が、第2閾値より大きい場合、図8(b)に示すように、訓練エリア300の前方向の端部近傍における制御ゲインが、一定量下げられる。
First, as shown in FIG. 8A, the inverted mobile object 100 is set to the upper limit value of the control gain in the
次に、図7中の(2)に示すように、訓練エリア300の中央からの倒立型移動体100の後方向へのずれ量のピーク値が、第2閾値より大きい場合、図8(c)に示すように、訓練エリア300の後方向の端部近傍における制御ゲインが、一定量下げられる。
Next, as shown in (2) in FIG. 7, when the peak value of the backward displacement amount from the center of the
次に、図7中の(3)に示すように、訓練エリア300の中央からの倒立型移動体100の前方向へのずれ量のピーク値が、第1閾値より小さい場合、図8(d)に示すように、訓練エリア300の前方向の端部近傍における制御ゲインが、一定量上げられる。
Next, as shown in (3) in FIG. 7, when the peak value of the forward shift amount of the inverted mobile body 100 from the center of the
次に、図7中の(4)に示すように、訓練エリア300の中央からの倒立型移動体100の後方向へのずれ量のピーク値が、第1閾値以上、且つ第2閾値以下の場合、図8(e)に示すように、訓練エリア300の後方向の端部近傍における制御ゲインは、変更されない。
Next, as shown in (4) in FIG. 7, the peak value of the backward shift amount from the center of the
図8に示すように、制御ゲインの設定を繰り返すことにより、倒立型移動体100の制御ゲインは、搭乗者の身体的特徴に適合したものとすることができる。なお、搭乗者の身体的特徴とは、搭乗者が前後に均等にふらつくこと、前後いずれかのバランスが特に弱いこと、又は前後のバランス能力がほぼ回復したことを示す。 As shown in FIG. 8, by repeating the setting of the control gain, the control gain of the inverted mobile body 100 can be adapted to the physical characteristics of the passenger. The physical characteristics of the occupant indicate that the occupant fluctuates evenly back and forth, that the balance between the front and back is particularly weak, or that the front and back balance ability has almost recovered.
続いて、制御ゲインの設定を繰り返した後の制御ゲインが、搭乗者の身体的特徴に応じたものとなることについて、図6、図9及び図10を用いて説明する。 Next, it will be described with reference to FIGS. 6, 9, and 10 that the control gain after the setting of the control gain is in accordance with the physical characteristics of the passenger.
まず、前後に均等にふらつく搭乗者が乗車した際の制御ゲインについて、図9を用いて説明する。図9は、前後に均等にふらつく搭乗者が乗車した際に、制御ゲインの設定を繰り返した後の制御ゲインのグラフである。前後に均等にふらつく搭乗者が乗車した場合、前方向へのずれ量と後方向へのずれ量とは同等になる。したがって、前方向へのずれ量のピーク値が第2閾値より大きかった回数から、前方向へのずれ量のピーク値が第1閾値より小さかった回数を差し引いた値(以下、前方向差分値と呼ぶ)と、後方向へのずれ量のピーク値が第2閾値より大きかった回数から、後方向へのずれ量のピーク値が第1閾値より小さかった回数を差し引いた値(以下、後方向差分値と呼ぶ)とが、略同一となる。 First, the control gain when a passenger who fluctuates evenly in front and rear gets on will be described with reference to FIG. FIG. 9 is a graph of the control gain after repeating the setting of the control gain when a passenger who fluctuates evenly in front and back gets on. When a passenger who fluctuates evenly in front and back gets on, the amount of deviation in the forward direction and the amount of deviation in the backward direction are equal. Therefore, a value obtained by subtracting the number of times when the peak value of the deviation amount in the forward direction is smaller than the first threshold value from the number of times that the peak value of the deviation amount in the forward direction is larger than the second threshold value (hereinafter referred to as the forward difference value). And the value obtained by subtracting the number of times the peak value of the backward shift amount is smaller than the first threshold from the number of times the peak value of the backward shift amount is greater than the second threshold (hereinafter referred to as the backward difference). Is called “value”).
ここで、前方向差分値及び後方向差分値と、訓練エリア300の前側端部近傍及び後側端部近傍の制御ゲインとの関係について説明する。前方向差分値が大きいほど訓練エリア300の前側端部近傍の制御ゲインは低くなり、後方向差分値が大きいほど訓練エリア300の後側端部近傍の制御ゲインは低くなる。これは、前方向差分値及び後方向差分値が大きいほど、図5のS106の実行により制御ゲインを一定量下げる回数が、S108の実行により制御ゲインを一定量上げる回数より多くなるためである。
Here, the relationship between the forward difference value and the backward difference value and the control gains near the front end and the rear end of the
このため、前後に均等にふらつく搭乗者が乗車した場合、図9に示すように、訓練エリア300の前側端部近傍と後側端部近傍の制御ゲインは、同程度で且つ、訓練エリア300の中央近傍における制御ゲインより低くなる。これにより、前後に均等にふらつく搭乗者に対して、前方向及び後方向のずれを均等にサポートする制御ゲインとすることができる。 For this reason, when the passenger who fluctuates equally back and forth gets on the board, as shown in FIG. It becomes lower than the control gain near the center. Thereby, it can be set as the control gain which supports the deviation | shift in a front direction and a back direction equally with respect to the passenger who fluctuates equally back and forth.
次に、前側のバランスが特に弱い搭乗者が乗車した際の制御ゲインについて、図10を用いて説明する。図10は、前側のバランスが特に弱い搭乗者が乗車した際に、制御ゲインの設定を繰り返した後の制御ゲインのグラフである。前側のバランスが特に弱い搭乗者が乗車した場合、前方向へのずれ量は、後方向へのずれ量より大きくなる。したがって、前方向差分値が、後方向差分値より大きくなる。このため、前側のバランスが特に弱い搭乗者が乗車した場合、図10に示すように、訓練エリア300の前側端部近傍の制御ゲインは、後側端部近傍の制御ゲインよりさらに低くなる。これにより、前側のバランスが特に弱い搭乗者に対して、前方向のずれを重点的にサポートする制御ゲインとすることができる。なお、図10のグラフは、前側端部近傍の制御ゲインを直線的に変化させるようにしているが、前側端部近傍の制御ゲインを非線形に変化させてもよい。
Next, the control gain when a passenger with a particularly weak front balance gets on will be described with reference to FIG. FIG. 10 is a graph of the control gain after repeating the setting of the control gain when a passenger with a particularly weak front balance gets on. When a passenger with a particularly weak balance on the front side gets on, the amount of deviation in the forward direction is larger than the amount of deviation in the backward direction. Accordingly, the forward difference value is larger than the backward difference value. For this reason, when a passenger with a particularly weak balance on the front side gets on, the control gain in the vicinity of the front end of the
次に、前後のバランス能力がほぼ回復した搭乗者が乗車した際の制御ゲインについて、図6を用いて説明する。前後のバランス能力がほぼ回復した搭乗者が乗車した場合、前後方向へのずれ量のピーク値の絶対値は、第2閾値の絶対値より大きくならない。もしくは、第2閾値の絶対値より大きくなることがあっても、搭乗者が自力で訓練エリア300の中央に戻ろうとし、前後のバランス能力がほぼ回復した搭乗者であれば自力で訓練エリア300の中央に戻ることができる。よって、前後方向へのずれ量のピーク値の絶対値は、第2閾値の絶対値より大きい状態は長続きせず、第1閾値の絶対値より小さくなる。したがって、前方向差分値及び後方向差分値は共に負の値となる。このため、前後のバランス能力がほぼ回復した搭乗者が乗車した場合、訓練エリア300全体の制御ゲインは、図6に示す制御ゲインの初期値と同じ、上限値になる。これにより、前後のバランス能力がほぼ回復した搭乗者に対して、余計なサポートはせず自立した訓練を行わせることができる。
Next, the control gain when a passenger who has almost recovered the front and rear balance ability gets on will be described with reference to FIG. When a passenger who has substantially recovered the front-rear balance ability gets on, the absolute value of the peak value of the deviation amount in the front-rear direction does not become larger than the absolute value of the second threshold value. Alternatively, even if the absolute value of the second threshold value may be exceeded, if the passenger tries to return to the center of the
以上に説明したように、本実施の形態では、訓練エリア300の中央からの倒立型移動体100の前後方向へのずれ量のピーク値をモニタリングし、前後方向へのずれ量のピーク値と閾値とを比較し、ずれ量のピーク値が閾値より大きい場合、訓練エリア300のずれ方向の端部近傍における制御ゲインを一定量下げるように設定するようにしている。このようにすることで、倒立型移動体100が訓練エリア300の端部近傍にいる場合に移動しにくくすることができる。また、本実施の形態では、ずれ方向を考慮して、モニタリング、比較、制御ゲイン設定を繰り返し行うようにしている。このようにすることで、倒立型移動体100の搭乗者の身体的特徴を考慮した制御ゲインとすることができる。よって、倒立型移動体が訓練エリアの端部近傍にいる場合に移動しにくくし、且つ搭乗者の身体的特徴を考慮した制御ゲインとすることができる倒立型移動体を提供することができる。
As described above, in this embodiment, the peak value of the deviation amount in the front-rear direction of the inverted mobile body 100 from the center of the
なお、本発明は上記実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。例えば、訓練エリア300の中央からの倒立型移動体100の前後方向へのずれ量のピーク値の大きさに応じて、制御ゲインの変化量を変化させてもよい。これは、例えば、第2閾値より絶対値が大きい第3閾値を設け、前後方向へのずれ量のピーク値の絶対値が、第3閾値の絶対器より大きい場合、訓練エリア300のずれ方向の端部近傍における重心移動に対する制御ゲインを急激に減少させることにより実現することができる。
Note that the present invention is not limited to the above-described embodiment, and can be changed as appropriate without departing from the spirit of the present invention. For example, the amount of change in the control gain may be changed according to the peak value of the amount of deviation of the inverted mobile body 100 from the center of the
また、例えば、モニタリング部141、比較部142、制御ゲイン設定部143、及び繰り返し部144の処理を、CPUにコンピュータプログラムを実行させることにより実現することも可能である。そして、上記の、コンピュータプログラムは、様々なタイプの非一時的なコンピュータ可読媒体(non-transitory computer readable medium)を用いて格納され、コンピュータに供給することができる。非一時的なコンピュータ可読媒体は、様々なタイプの実体のある記録媒体(tangible storage medium)を含む。非一時的なコンピュータ可読媒体の例は、磁気記録媒体(例えばフレキシブルディスク、磁気テープ、ハードディスクドライブ)、光磁気記録媒体(例えば光磁気ディスク)、CD−ROM(Read Only Memory)、CD−R、CD−R/W、半導体メモリ(例えば、マスクROM、PROM(Programmable ROM)、EPROM(Erasable PROM)、フラッシュROM、RAM(Random Access Memory))を含む。また、プログラムは、様々なタイプの一時的なコンピュータ可読媒体(transitory computer readable medium)によってコンピュータに供給されてもよい。一時的なコンピュータ可読媒体の例は、電気信号、光信号、及び電磁波を含む。一時的なコンピュータ可読媒体は、電線及び光ファイバ等の有線通信路、又は無線通信路を介して、プログラムをコンピュータに供給できる。
Further, for example, the processing of the
100 倒立型移動体
141 モニタリング部
142 比較部
143 制御ゲイン設定部
144 繰り返し部
300 訓練エリア
100 Inverted
Claims (1)
訓練エリアの中央からの前記倒立型移動体の前後方向へのずれ量のピーク値をモニタリングするモニタリング部と、
前記ずれ量のピーク値と閾値とを比較する比較部と、
前記重心移動に対する前記倒立型移動体の移動しやすさを決める制御ゲインを設定する制御ゲイン設定部と、
前記モニタリング、前記比較、及び前記制御ゲインの設定を所定回数繰り返し行わせる繰り返し部と、を備え、
前記制御ゲイン設定部は、前記ずれ量のピーク値が前記閾値より大きい場合、前記訓練エリアのずれ方向の端部近傍における前記制御ゲインを一定量下げるように設定する
倒立型移動体。 An inverted moving body that operates according to the movement of the center of gravity of the passenger,
A monitoring unit for monitoring the peak value of the amount of deviation in the front-rear direction of the inverted moving body from the center of the training area;
A comparison unit for comparing the peak value of the deviation amount and a threshold;
A control gain setting unit for setting a control gain for determining the ease of movement of the inverted moving body with respect to the movement of the center of gravity;
A repeating unit that repeats the monitoring, the comparison, and the setting of the control gain a predetermined number of times,
When the peak value of the deviation amount is larger than the threshold value, the control gain setting unit sets the control gain in the vicinity of the end portion in the deviation direction of the training area to be lowered by a certain amount.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015173866A JP6493103B2 (en) | 2015-09-03 | 2015-09-03 | Inverted moving body |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015173866A JP6493103B2 (en) | 2015-09-03 | 2015-09-03 | Inverted moving body |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017047010A true JP2017047010A (en) | 2017-03-09 |
JP6493103B2 JP6493103B2 (en) | 2019-04-03 |
Family
ID=58280798
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015173866A Active JP6493103B2 (en) | 2015-09-03 | 2015-09-03 | Inverted moving body |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6493103B2 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019127213A (en) * | 2018-01-26 | 2019-08-01 | トヨタ自動車株式会社 | Inverted two-wheeled vehicle type balance training device |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008189017A (en) * | 2007-01-31 | 2008-08-21 | Equos Research Co Ltd | Vehicle |
JP2010247723A (en) * | 2009-04-17 | 2010-11-04 | Toyota Motor Corp | Traveling device and its control method |
JP2014182318A (en) * | 2013-03-21 | 2014-09-29 | Toyota Motor Corp | Balance training system and control method thereof |
JP2015106127A (en) * | 2013-12-02 | 2015-06-08 | トヨタ自動車株式会社 | Training system and training method |
JP2015123219A (en) * | 2013-12-26 | 2015-07-06 | トヨタ自動車株式会社 | Gait training system |
-
2015
- 2015-09-03 JP JP2015173866A patent/JP6493103B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008189017A (en) * | 2007-01-31 | 2008-08-21 | Equos Research Co Ltd | Vehicle |
JP2010247723A (en) * | 2009-04-17 | 2010-11-04 | Toyota Motor Corp | Traveling device and its control method |
JP2014182318A (en) * | 2013-03-21 | 2014-09-29 | Toyota Motor Corp | Balance training system and control method thereof |
JP2015106127A (en) * | 2013-12-02 | 2015-06-08 | トヨタ自動車株式会社 | Training system and training method |
JP2015123219A (en) * | 2013-12-26 | 2015-07-06 | トヨタ自動車株式会社 | Gait training system |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019127213A (en) * | 2018-01-26 | 2019-08-01 | トヨタ自動車株式会社 | Inverted two-wheeled vehicle type balance training device |
Also Published As
Publication number | Publication date |
---|---|
JP6493103B2 (en) | 2019-04-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6384436B2 (en) | Balance training apparatus and control method thereof | |
JP6564128B2 (en) | Notification control device and notification control method | |
JP5338726B2 (en) | Training system, training method and training program | |
US10857909B2 (en) | Electrical assembly | |
JP5293900B2 (en) | Inverted moving body and method of getting on and off | |
JP6493103B2 (en) | Inverted moving body | |
US8949010B2 (en) | Inverted pendulum type vehicle | |
WO2022060769A1 (en) | Apparatus, system and method for the self-loading of a car in a carwash | |
US20140297076A1 (en) | Inverted pendulum type vehicle | |
JP2016084087A (en) | Inverted moving body, its control method and control program | |
JP2012006669A (en) | Man conveyor | |
CN113244587B (en) | Balance training system, control method thereof, and computer-readable storage medium storing control program | |
JP6350421B2 (en) | Training system | |
JP5772373B2 (en) | Inverted moving body control device and control method thereof | |
JP6361525B2 (en) | Balance training equipment | |
JP5861651B2 (en) | MOBILE DEVICE, MOBILE DEVICE CONTROL METHOD, AND PROGRAM | |
JP6233265B2 (en) | Inverted two-wheeled mobile system | |
JP6256327B2 (en) | Inverted cart, control method and program for inverted cart | |
JP6354447B2 (en) | Training system, training method and training program | |
US20230095638A1 (en) | Imaging system, guidance control method, and storage medium | |
CN114906020B (en) | Seat adjusting method and device, vehicle and storage medium | |
JP6287807B2 (en) | Inverted moving body and control method thereof | |
JP6485277B2 (en) | Control method for balance training system | |
JP6614094B2 (en) | Traveling device | |
JP2018082755A (en) | Walking aid vehicle and walking aid system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20170920 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20180904 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20180831 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20181024 |
|
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: 20190205 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190218 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6493103 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |