JP2016150148A - Balance training system - Google Patents

Balance training system Download PDF

Info

Publication number
JP2016150148A
JP2016150148A JP2015029632A JP2015029632A JP2016150148A JP 2016150148 A JP2016150148 A JP 2016150148A JP 2015029632 A JP2015029632 A JP 2015029632A JP 2015029632 A JP2015029632 A JP 2015029632A JP 2016150148 A JP2016150148 A JP 2016150148A
Authority
JP
Japan
Prior art keywords
moving body
inverted moving
training
area
inverted
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.)
Pending
Application number
JP2015029632A
Other languages
Japanese (ja)
Inventor
祐介 木田
Yusuke Kida
祐介 木田
英祐 青木
Hidesuke Aoki
英祐 青木
浩司 尾藤
Koji Bito
浩司 尾藤
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.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
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 Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2015029632A priority Critical patent/JP2016150148A/en
Publication of JP2016150148A publication Critical patent/JP2016150148A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Motorcycle And Bicycle Frame (AREA)
  • Rehabilitation Tools (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide a balance training system capable of suppressing deviation between an actual orientation of an inverted movable body, and an orientation of the inverted movable body in a training image.SOLUTION: A balance training system 1 uses rotation speed information of a wheel of an inverted movable body 2, for estimating a coordinate position and a first orientation of the inverted movable body 2 in a training area 3, uses vibration information of the inverted movable body 2 when the inverted movable body 2 moves on the training area 3, and information in which, the vibration generated on the inverted movable body 2 when the inverted movable body 2 moves on the area of the training area 3 and an orientation of the inverted movable body 2 in the training area 3 are associated, for estimating a second orientation of the inverted movable body 2 in at least the training area 3, and if an absolute value of difference between the first and second orientations is larger than a preset threshold, creates a training image using the second orientation, and if the absolute value of difference between the first and second orientations is equal to or less than the preset threshold, creates the training image using the first orientation.SELECTED DRAWING: Figure 1

Description

本発明は、バランス訓練システムに関し、例えば、倒立移動体を用いたバランス訓練システムに関する。   The present invention relates to a balance training system, for example, a balance training system using an inverted moving body.

近年、倒立移動体に搭乗した訓練者が当該倒立移動体の移動に連動する訓練画像を見ながら倒立移動体を操作して、バランス訓練を実行するバランス訓練システムがリハビリ現場などで検討されている。   In recent years, a balance training system in which a trainer who has boarded an inverted moving body operates a inverted moving body while observing a training image linked to the movement of the inverted moving body to perform balance training has been studied in a rehabilitation site or the like. .

一般的なリハビリ訓練システムは、倒立移動体の左右の車輪の回転速度に基づいて当該倒立移動体の自己位置(即ち、訓練エリアでの倒立移動体の座標位置及び向き)を推定し、推定した倒立移動体の自己位置に基づいて当該倒立移動体の移動に訓練画像を連動させている。   A general rehabilitation training system estimates and estimates the self-position of the inverted moving body (that is, the coordinate position and orientation of the inverted moving body in the training area) based on the rotational speeds of the left and right wheels of the inverted moving body. Based on the position of the inverted moving body, the training image is linked to the movement of the inverted moving body.

ちなみに、特許文献1のバランス訓練システムは、エリアセンサなどを用いて倒立移動体の自己位置を検出している。   Incidentally, the balance training system of Patent Document 1 detects the self-position of an inverted moving body using an area sensor or the like.

特開2014−182318号公報JP 2014-182318 A

一般的なリハビリ訓練システムは、倒立移動体の左右の車輪の回転速度に基づいて当該倒立移動体の向きを推定するので、例えば車輪がスリップしたり、左右の車輪への訓練者の体重のかけ方によって当該左右の車輪の変形具合に差が生じたり、すると倒立移動体の向きを正確に推定することができず、倒立移動体の実際の向きと訓練画像での倒立移動体の向きとが乖離する可能性がある。   A general rehabilitation training system estimates the direction of the inverted moving body based on the rotation speed of the left and right wheels of the inverted moving body. For example, the wheel slips or the weight of the trainee is applied to the left and right wheels. Depending on how the left and right wheels are deformed, the direction of the inverted moving body cannot be accurately estimated, and the actual direction of the inverted moving body and the direction of the inverted moving body in the training image are different. There is a possibility of divergence.

本発明は、上記を鑑みなされたものであって、倒立移動体の実際の向きと訓練画像での倒立移動体の向きとの乖離を抑制する。   The present invention has been made in view of the above, and suppresses a deviation between the actual direction of the inverted moving body and the direction of the inverted moving body in the training image.

本発明の一態様に係るバランス訓練システムは、
倒立状態を維持するように制御される倒立移動体と、
前記倒立移動体に訓練者が搭乗してバランス訓練を実行する訓練エリアと、
前記訓練エリアでの前記倒立移動体の座標位置及び前記倒立移動体の重心を通り、且つ当該倒立移動体の上下方向に延在する軸を中心とする回転角度である前記倒立移動体の向きを推定し、推定した前記倒立移動体の座標位置及び向きに連動するように訓練画像を生成する画像生成部と、
前記訓練画像を表示する表示部と、
を備えるバランス訓練システムであって、
前記訓練エリアは、予め設定された領域毎に異なる凸部又は配置が異なる凸部を備え、
前記倒立移動体は、当該倒立移動体の車輪の回転速度を検出する速度検出部、及び前記倒立移動体の振動を検出する振動検出部を備え、
前記画像生成部は、
前記倒立移動体の車輪の回転速度情報を取得し、前記回転速度情報を用いて、前記訓練エリアでの前記倒立移動体の座標位置及び第1の向きを推定し、
前記倒立移動体が前記訓練エリアを移動した際の当該倒立移動体の振動情報を取得し、前記振動情報及び前記領域を前記倒立移動体が移動した際に当該倒立移動体に発生する振動と前記訓練エリアでの前記倒立移動体の向きとを関連付けた情報を用いて、少なくとも前記訓練エリアでの前記倒立移動体の第2の向きを推定し、
前記第1の向きと前記第2の向きとの差の絶対値が予め設定された閾値より大きいと、前記第2の向きを用いて前記訓練画像を生成し、
前記第1の向きと前記第2の向きとの差の絶対値が予め設定された閾値以下であると、前記第1の向きを用いて前記訓練画像を生成する。
即ち、倒立移動体が訓練エリアを移動する際の振動の大きさの変化に基づいて、訓練エリアでの倒立移動体の実際の向きである第2の向きを推定し、推定した倒立移動体の第2の向きに対して、推定した倒立移動体の第1の向きの誤差が大きい場合、倒立移動体の第2の向きを用いて訓練画像を生成する。そのため、倒立移動体の実際の向きと訓練画像での倒立移動体の向きとの乖離を抑制することができる。
A balance training system according to an aspect of the present invention includes:
An inverted moving body controlled to maintain an inverted state;
A training area where a trainee boarded the inverted moving body and performs balance training; and
The orientation of the inverted moving body that is a rotation angle about an axis that passes through the coordinate position of the inverted moving body and the center of gravity of the inverted moving body in the training area and extends in the vertical direction of the inverted moving body. An image generation unit for generating a training image to be estimated and linked to the estimated coordinate position and orientation of the inverted moving body;
A display unit for displaying the training image;
A balance training system comprising:
The training area is provided with different convex portions or different convex portions for each preset region,
The inverted moving body includes a speed detection unit that detects a rotation speed of a wheel of the inverted moving body, and a vibration detection unit that detects vibration of the inverted moving body,
The image generation unit
Obtaining the rotational speed information of the wheels of the inverted moving body, using the rotational speed information, estimating the coordinate position and the first direction of the inverted moving body in the training area,
The vibration information of the inverted moving body when the inverted moving body moves in the training area, and the vibration information and the vibration generated in the inverted moving body when the inverted moving body moves in the region and the vibration Using the information associated with the orientation of the inverted moving body in the training area, to estimate at least a second direction of the inverted moving body in the training area;
When the absolute value of the difference between the first orientation and the second orientation is greater than a preset threshold, the training image is generated using the second orientation,
When the absolute value of the difference between the first direction and the second direction is equal to or less than a preset threshold value, the training image is generated using the first direction.
That is, based on the change in the magnitude of vibration when the inverted moving body moves in the training area, the second direction which is the actual direction of the inverted moving body in the training area is estimated, and the estimated inverted moving body If the error in the estimated first direction of the inverted moving body is larger than the second direction, a training image is generated using the second direction of the inverted moving body. Therefore, the deviation between the actual direction of the inverted moving body and the direction of the inverted moving body in the training image can be suppressed.

本発明によれば、倒立移動体の実際の向きと訓練画像での倒立移動体の向きとの乖離を抑制することができる。   According to the present invention, it is possible to suppress a deviation between the actual direction of the inverted moving body and the direction of the inverted moving body in the training image.

実施の形態1のバランス訓練システムを模式的に示す平面図である。It is a top view which shows the balance training system of Embodiment 1 typically. 実施の形態1のバランス訓練システムの制御系のブロック図である。FIG. 3 is a block diagram of a control system of the balance training system according to the first embodiment. 実施の形態1のバランス訓練システムで用いられる倒立移動体を模式的に示す側面図である。It is a side view which shows typically the inverted moving body used with the balance training system of Embodiment 1. FIG. (a)は、実施の形態1のバランス訓練システムの訓練エリアを模式的に示す平面図であり、(b)は、(a)のIV−IV断面図である。(A) is a top view which shows typically the training area of the balance training system of Embodiment 1, (b) is IV-IV sectional drawing of (a). 実施の形態1の画像生成部の訓練画像の生成方法の流れを示すフローチャート図である。6 is a flowchart showing a flow of a training image generation method of an image generation unit according to Embodiment 1. FIG. 倒立移動体の左側の車輪が第1の領域から第8の領域に侵入し、右側の車輪が第5の領域から第4の領域に侵入する際の当該倒立移動体の振動の大きさと時間との関係を示す図である。The magnitude and time of the vibration of the inverted moving body when the left wheel of the inverted moving body enters the eighth area from the first area and the right wheel enters the fourth area from the fifth area. It is a figure which shows the relationship. 実施の形態2のバランス訓練システムの訓練エリアを模式的に示す平面図である。It is a top view which shows typically the training area of the balance training system of Embodiment 2. FIG. 実施の形態2のバランス訓練システムの異なる訓練エリアを模式的に示す平面図である。It is a top view which shows typically the training area from which the balance training system of Embodiment 2 differs. (a)は、実施の形態3のバランス訓練システムの訓練エリアを模式的に示す平面図であり、(b)は、(a)のIX−IX断面図である。(A) is a top view which shows typically the training area of the balance training system of Embodiment 3, (b) is IX-IX sectional drawing of (a). 倒立移動体の左側の車輪が第1の領域から第8の領域に侵入し、右側の車輪が第5の領域から第4の領域に侵入する際の当該倒立移動体のスペクトル強度と周波数との関係を示す図である。The spectral intensity and frequency of the inverted moving body when the left wheel of the inverted moving body enters the eighth area from the first area and the right wheel enters the fourth area from the fifth area. It is a figure which shows a relationship.

以下、本発明を適用した具体的な実施の形態について、図面を参照しながら詳細に説明する。但し、本発明が以下の実施の形態に限定される訳ではない。また、説明を明確にするため、以下の記載及び図面は、適宜、簡略化されている。   Hereinafter, specific embodiments to which the present invention is applied will be described in detail with reference to the drawings. However, the present invention is not limited to the following embodiment. In addition, for clarity of explanation, the following description and drawings are simplified as appropriate.

<実施の形態1>
本実施の形態のバランス訓練システムを説明する。先ず、本実施の形態のバランス訓練システムの基本構成を説明する。図1は、本実施の形態のバランス訓練システムを模式的に示す平面図である。図2は、本実施の形態のバランス訓練システムの制御系のブロック図である。図3は、本実施の形態のバランス訓練システムで用いられる倒立移動体を模式的に示す側面図である。
<Embodiment 1>
A balance training system according to the present embodiment will be described. First, the basic configuration of the balance training system of the present embodiment will be described. FIG. 1 is a plan view schematically showing the balance training system of the present embodiment. FIG. 2 is a block diagram of a control system of the balance training system of the present embodiment. FIG. 3 is a side view schematically showing the inverted moving body used in the balance training system of the present embodiment.

本実施の形態のバランス訓練システム1は、図1及び図2に示すように、倒立移動体2、訓練エリア3、画像生成部4及び表示部5を備えている。倒立移動体2は、図3に示すように、搭乗部21、ハンドル22、左右の駆動輪23、姿勢検出部24、角度検出部25、速度検出部26、振動検出部27及び制御部28を備えている。   The balance training system 1 of this Embodiment is provided with the inverted moving body 2, the training area 3, the image generation part 4, and the display part 5, as shown in FIG.1 and FIG.2. As shown in FIG. 3, the inverted moving body 2 includes a riding unit 21, a handle 22, left and right drive wheels 23, an attitude detection unit 24, an angle detection unit 25, a speed detection unit 26, a vibration detection unit 27, and a control unit 28. I have.

搭乗部21は、訓練者が搭乗する基部であり、例えば訓練者が両脚を載せて立位姿勢で搭乗する。但し、搭乗部21は、訓練者が着座姿勢で搭乗する構成とされていてもよい。   The boarding unit 21 is a base on which a trainee is boarded. For example, the trainer rides in a standing posture with both legs on. However, the boarding unit 21 may be configured such that a trainee rides in a sitting posture.

ハンドル22は、倒立移動体2の左右方向に回転可能に搭乗部21の前部に設けられている。本実施の形態では、訓練者がハンドル22を倒立移動体2の左右方向に回転させることで、倒立移動体2の左右方向への旋回操作を行う。但し、例えば、搭乗部21の左右方向への回転角度に基づいて、倒立移動体2の左右方向への旋回操作を行ってもよい。   The handle 22 is provided at the front portion of the riding section 21 so as to be rotatable in the left-right direction of the inverted moving body 2. In the present embodiment, the trainee rotates the handle 22 in the left-right direction of the inverted moving body 2 to perform the turning operation of the inverted moving body 2 in the left-right direction. However, for example, the turning operation of the inverted moving body 2 in the left-right direction may be performed based on the rotation angle of the riding section 21 in the left-right direction.

左右の駆動輪23は、車輪23a、減速機(図示を省略)、及びモータ23bを備えており、モータ23bの角速度が所望の角速度になるように、制御部28から入力される旋回指令信号及び姿勢指令信号に基づいてモータ23bが動作する。左右の駆動輪23は、搭乗部21に支持されている。   The left and right drive wheels 23 include wheels 23a, a speed reducer (not shown), and a motor 23b, and a turn command signal input from the control unit 28 so that the angular velocity of the motor 23b becomes a desired angular velocity, and The motor 23b operates based on the attitude command signal. The left and right drive wheels 23 are supported by the riding section 21.

姿勢検出部24は、倒立移動体2、ひいては搭乗部21の前後方向への回転角度を検出し、検出信号(操作信号)を制御部28に出力する。姿勢検出部24としては、一般的な姿勢検出装置を用いることができ、例えばジャイロセンサや加速度センサなどを用いることができる。   The posture detection unit 24 detects the rotation angle of the inverted moving body 2 and thus the riding unit 21 in the front-rear direction, and outputs a detection signal (operation signal) to the control unit 28. As the posture detection unit 24, a general posture detection device can be used, and for example, a gyro sensor or an acceleration sensor can be used.

角度検出部25は、ハンドル22における倒立移動体2の左右方向への回転角度を検出し、検出信号(操作信号)を制御部28に出力する。角度検出部25としては、一般的な角度検出装置を用いることができ、例えばエンコーダなどを用いることができる。   The angle detection unit 25 detects the rotation angle of the inverted moving body 2 in the left-right direction at the handle 22 and outputs a detection signal (operation signal) to the control unit 28. As the angle detection unit 25, a general angle detection device can be used, and for example, an encoder or the like can be used.

速度検出部26は、左右の車輪23aの回転速度を検出し、検出信号を制御部28及び画像生成部4に出力する。速度検出部26としては、一般的な速度検出装置を用いることができ、例えばエンコーダなどを用いることができる。   The speed detection unit 26 detects the rotation speed of the left and right wheels 23 a and outputs a detection signal to the control unit 28 and the image generation unit 4. As the speed detection unit 26, a general speed detection device can be used, and for example, an encoder or the like can be used.

振動検出部27は、倒立移動体2が移動した際の当該倒立移動体2の振動を検出し、検出信号を画像生成部4に出力する。振動検出部27としては、一般的な振動検出装置を用いることができ、例えば加速度センサなどを用いることができる。   The vibration detection unit 27 detects the vibration of the inverted moving body 2 when the inverted moving body 2 moves, and outputs a detection signal to the image generation unit 4. As the vibration detection unit 27, a general vibration detection device can be used, and for example, an acceleration sensor can be used.

制御部28は、姿勢検出部24から入力される操作信号に基づいて姿勢指令信号を生成し、生成した姿勢指令信号に基づいて、倒立移動体2の倒立状態を維持しつつ前後進を実現するように、左右の駆動輪23のモータ23bを制御する。   The control unit 28 generates a posture command signal based on the operation signal input from the posture detection unit 24, and based on the generated posture command signal, realizes forward / backward movement while maintaining the inverted state of the inverted moving body 2. Thus, the motor 23b of the left and right drive wheels 23 is controlled.

また、制御部28は、角度検出部25から入力される操作信号に基づいて旋回指令信号を生成し、生成した旋回指令信号に基づいて、倒立移動体2の左右方向への旋回を実現するように、左右の駆動輪23のモータ23bを制御する。   In addition, the control unit 28 generates a turn command signal based on the operation signal input from the angle detection unit 25, and realizes turning of the inverted mobile body 2 in the left-right direction based on the generated turn command signal. In addition, the motors 23b of the left and right drive wheels 23 are controlled.

さらに、制御部28は、倒立移動体2の状態(即ち、倒立制御状態か否か、及び前進、後進、右旋回並びに左旋回の何れの走行状態か)を示す信号を画像生成部4に出力する。   Further, the control unit 28 sends a signal indicating the state of the inverted moving body 2 (that is, whether the vehicle is in the inverted control state and whether the vehicle is traveling forward, backward, right turn, or left turn) to the image generation unit 4. Output.

訓練エリア3は、図1に示すように、訓練者が倒立移動体2に搭乗してバランス訓練を実行するエリアであり、予め設定された領域毎に異なる凸部又は配置が異なる凸部を備えている。ここで、図4(a)は、本実施の形態のバランス訓練システムの訓練エリアを模式的に示す平面図であり、図4(b)は、図4(a)のIV−IV断面図である。   As shown in FIG. 1, the training area 3 is an area where the trainee rides on the inverted moving body 2 to perform balance training, and includes different convex portions or different convex portions for each preset region. ing. Here, Fig.4 (a) is a top view which shows typically the training area of the balance training system of this Embodiment, FIG.4 (b) is IV-IV sectional drawing of Fig.4 (a). is there.

本実施の形態の訓練エリア3は、図4(a)に示すように、所定の半径を有する円形のエリアであって、所定の角度で複数の領域に分割されている。詳細には、訓練エリア3は、8等分に分割されている。つまり、訓練エリア3は、中心角度θが45°の扇形の領域3a、3b、3c、3d、3e、3f、3g及び3hを備えている。なお、領域の個数は、倒立移動体2の向きの推定精度によって適宜、変更することができる。   As shown in FIG. 4A, the training area 3 according to the present embodiment is a circular area having a predetermined radius, and is divided into a plurality of regions at a predetermined angle. Specifically, the training area 3 is divided into eight equal parts. That is, the training area 3 includes fan-shaped regions 3a, 3b, 3c, 3d, 3e, 3f, 3g, and 3h having a central angle θ of 45 °. The number of regions can be changed as appropriate according to the estimation accuracy of the direction of the inverted moving body 2.

そして、所定の領域毎に異なる凸部3iを備えている。詳細には、訓練エリア3における倒立移動体2が移動する移動面の0°≦θ<45°の第1の領域3a及び180°≦θ<225°の第5の領域3eには、第1の形状の凸部3i1が形成されている。訓練エリア3における移動面の45°≦θ<90°の第2の領域3b及び225°≦θ<270°の第6の領域3fには、第2の形状の凸部3i2が形成されている。   And the convex part 3i which differs for every predetermined area | region is provided. Specifically, the first region 3a of 0 ° ≦ θ <45 ° and the fifth region 3e of 180 ° ≦ θ <225 ° of the moving surface on which the inverted moving body 2 moves in the training area 3 include the first The convex part 3i1 of the shape is formed. A convex portion 3i2 having a second shape is formed in the second region 3b of 45 ° ≦ θ <90 ° and the sixth region 3f of 225 ° ≦ θ <270 ° on the moving surface in the training area 3. .

訓練エリア3における移動面の90°≦θ<135°の第3の領域3c及び270°≦θ<315°の第7の領域3gには、第3の形状の凸部3i3が形成されている。訓練エリア3における移動面の135°≦θ<180°の第4の領域3d及び315°≦θ<360°の第8の領域3hには、第4の形状の凸部3i4が形成されている。   A convex portion 3i3 having a third shape is formed in the third region 3c of 90 ° ≦ θ <135 ° and the seventh region 3g of 270 ° ≦ θ <315 ° of the moving surface in the training area 3. . A convex portion 3i4 having a fourth shape is formed in the fourth region 3d of 135 ° ≦ θ <180 ° and the eighth region 3h of 315 ° ≦ θ <360 ° of the moving surface in the training area 3. .

これらの第1の形状の凸部3i1、第2の形状の凸部3i2、第3の形状の凸部3i3及び第4の形状の凸部3i4は、等しく配置されている。また、第1の形状の凸部3i1、第2の形状の凸部3i2、第3の形状の凸部3i3及び第4の形状の凸部3i4は、各々の凸部3i1、3i2、3i3、3i4上を移動した倒立移動体2が異なる振動を発生するように形成されており、本実施の形態では各々の凸部3i1、3i2、3i3、3i4の高さが異なっている。ちなみに、図4(b)では、凸部3i1と凸部3i4との高さ関係を示しており、凸部3i4に比べて凸部3i1の方が高い。   The first shape convex portion 3 i 1, the second shape convex portion 3 i 2, the third shape convex portion 3 i 3, and the fourth shape convex portion 3 i 4 are arranged equally. Further, the first shape convex portion 3i1, the second shape convex portion 3i2, the third shape convex portion 3i3, and the fourth shape convex portion 3i4 are respectively the convex portions 3i1, 3i2, 3i3, 3i4. The inverted moving body 2 that has moved up is formed so as to generate different vibrations, and in the present embodiment, the heights of the convex portions 3i1, 3i2, 3i3, and 3i4 are different. Incidentally, FIG. 4B shows the height relationship between the convex portion 3i1 and the convex portion 3i4, and the convex portion 3i1 is higher than the convex portion 3i4.

画像生成部4は、詳細は後述するが、速度検出部26から入力される検出信号が示す倒立移動体2の車輪23aの回転速度情報、及び振動検出部27から入力される検出信号が示す倒立移動体2が訓練エリア3を移動した際の振動情報(本実施の形態では、振動の大きさ(振幅)と時間との関係を示す情報)を用いて、訓練エリア3での倒立移動体2の座標位置及び向きを推定し、推定した倒立移動体2の座標位置及び向きに連動するように訓練画像を生成して表示部5に出力する。   As will be described in detail later, the image generation unit 4 is the inverted information indicated by the rotation speed information of the wheels 23a of the inverted moving body 2 indicated by the detection signal input from the speed detection unit 26 and the detection signal input from the vibration detection unit 27. Inverted moving body 2 in training area 3 using vibration information when moving body 2 moves in training area 3 (in this embodiment, information indicating the relationship between the magnitude (amplitude) of vibration and time). The coordinate position and orientation are estimated, a training image is generated so as to be interlocked with the estimated coordinate position and orientation of the inverted moving body 2, and is output to the display unit 5.

訓練画像は、訓練者が倒立移動体2を訓練エリア3での移動を指示する画像である。また、倒立移動体2の向きは、倒立移動体2の重心位置を通り、且つ倒立移動体2の上下方向に延在するヨー軸回りの回転角度であり、倒立移動体2の前側を0°とし、反時計回りを+方向とする。   The training image is an image instructed by the trainee to move the inverted moving body 2 in the training area 3. The direction of the inverted moving body 2 is a rotation angle around the yaw axis that passes through the center of gravity of the inverted moving body 2 and extends in the vertical direction of the inverted moving body 2. And counterclockwise is the + direction.

ここで、画像生成部4と速度検出部26との間の通信、画像生成部4と振動検出部27との間の通信、及び画像生成部4と制御部28との間の通信は、有線でも無線でもよい。また、画像生成部4は、制御部28内、または表示部5内に搭載されていてもよく、表示部5とは別に設けられていてもよい。   Here, the communication between the image generation unit 4 and the speed detection unit 26, the communication between the image generation unit 4 and the vibration detection unit 27, and the communication between the image generation unit 4 and the control unit 28 are wired. But it may be wireless. The image generation unit 4 may be mounted in the control unit 28 or the display unit 5, or may be provided separately from the display unit 5.

表示部5は、画像生成部4から入力された訓練画像を表示する。表示部5としては、一般的な液晶ディスプレイなどを用いることができる。このような表示部5は、訓練エリア3の0°方向に(即ち、訓練画像が訓練エリア3の180°方向に表示されるように)配置されている。   The display unit 5 displays the training image input from the image generation unit 4. As the display unit 5, a general liquid crystal display or the like can be used. Such a display unit 5 is arranged in the 0 ° direction of the training area 3 (that is, the training image is displayed in the 180 ° direction of the training area 3).

次に、本実施の形態の画像生成部の訓練画像の生成方法を説明する。図5は、本実施の形態の画像生成部の訓練画像の生成方法の流れを示すフローチャート図である。図6は、倒立移動体の左側の車輪が第1の領域から第8の領域に侵入し、右側の車輪が第5の領域から第4の領域に侵入する際の当該倒立移動体の振動の大きさと時間との関係を示す図である。   Next, a training image generation method of the image generation unit of the present embodiment will be described. FIG. 5 is a flowchart showing a flow of a training image generation method of the image generation unit of the present embodiment. FIG. 6 shows the vibration of the inverted moving body when the left wheel of the inverted moving body enters the eighth area from the first area and the right wheel enters the fourth area from the fifth area. It is a figure which shows the relationship between a magnitude | size and time.

訓練者は、訓練エリア3の中心近傍で倒立移動体2の前側を当該訓練エリア3の0°方向に向けた状態の当該倒立移動体2の搭乗部21に搭乗して訓練を開始する。例えば、訓練者は、表示部5に表示される訓練画像の指示に従って、訓練エリア3の中心近傍で倒立移動体2を前進、後進、右旋回及び左旋回させる。本実施の形態では、訓練エリア3の中心から倒立移動体2を前進又は後進させ、再び、訓練エリア3の中心に倒立移動体2を移動させる。また、訓練エリア3の中心に倒立移動体2のヨー軸が配置された状態を維持するように当該倒立移動体2を右旋回又は左旋回させる。   The trainer gets on the riding part 21 of the inverted moving body 2 with the front side of the inverted moving body 2 facing the 0 ° direction of the training area 3 near the center of the training area 3 and starts training. For example, the trainer causes the inverted moving body 2 to move forward, backward, turn right, and turn left in the vicinity of the center of the training area 3 according to the instruction of the training image displayed on the display unit 5. In the present embodiment, the inverted moving body 2 is moved forward or backward from the center of the training area 3, and the inverted moving body 2 is moved again to the center of the training area 3. Further, the inverted moving body 2 is turned right or left so that the yaw axis of the inverted moving body 2 is arranged at the center of the training area 3.

そして、画像生成部4は、倒立移動体2の制御部28が当該倒立移動体2を倒立制御しているか否かを判定する(S1)。詳細には、画像生成部4は、制御部28から取得した倒立移動体2の状態情報に基づいて、倒立移動体2が倒立制御状態か否かを判定する。   Then, the image generation unit 4 determines whether or not the control unit 28 of the inverted moving body 2 performs the inverted control of the inverted moving body 2 (S1). Specifically, the image generation unit 4 determines whether the inverted moving body 2 is in the inverted control state based on the state information of the inverted moving body 2 acquired from the control unit 28.

このとき、制御部28が倒立移動体2の状態情報を示す信号を逐次、画像生成部4に出力してもよく、バランス訓練システム1が訓練者のバランス訓練を開始する際に画像生成部4が倒立移動体2の制御部28に当該倒立移動体2の状態情報を示す信号を問い合わせてもよい。画像生成部4は、倒立移動体2の制御部28が当該倒立移動体2を倒立制御していないと判定すると(S1のNO)、S1の工程に戻る。   At this time, the control unit 28 may sequentially output a signal indicating the state information of the inverted moving body 2 to the image generation unit 4, and the image generation unit 4 when the balance training system 1 starts the balance training of the trainee. However, the control unit 28 of the inverted moving body 2 may be inquired for a signal indicating the state information of the inverted moving body 2. When the image generating unit 4 determines that the control unit 28 of the inverted moving body 2 has not controlled the inverted moving body 2 (NO in S1), the process returns to the step S1.

次に、画像生成部4は、速度検出部26から倒立移動体2の左右の車輪23aの回転速度情報を取得する(S2)。そして、画像生成部4は、取得した倒立移動体2の左右の車輪23aの回転速度情報を用いて、訓練エリア3での倒立移動体2の第1の向きを推定する(S3)。つまり、画像生成部4は、倒立移動体2の左右の車輪23aの回転角度差に基づいて、訓練エリア3での倒立移動体2の第1の向きを推定する。このとき、画像生成部4は、取得した倒立移動体2の左右の車輪23aの回転速度情報に基づいて、訓練エリア3での倒立移動体2の座標位置を推定する。   Next, the image generation part 4 acquires the rotational speed information of the left and right wheels 23a of the inverted moving body 2 from the speed detection part 26 (S2). And the image generation part 4 estimates the 1st direction of the inverted moving body 2 in the training area 3 using the rotational speed information of the right and left wheels 23a of the acquired inverted moving body 2 (S3). That is, the image generation unit 4 estimates the first direction of the inverted moving body 2 in the training area 3 based on the rotation angle difference between the left and right wheels 23 a of the inverted moving body 2. At this time, the image generation unit 4 estimates the coordinate position of the inverted moving body 2 in the training area 3 based on the acquired rotational speed information of the left and right wheels 23 a of the inverted moving body 2.

一方、画像生成部4は、振動検出部27から倒立移動体2が訓練エリア3を移動した際に発生した当該倒立移動体2の振動情報を取得する(S4)。そして、画像生成部4は、取得した振動情報、及び領域3a、3b、3c、3d、3e、3f、3g及び3hを倒立移動体2が移動した際の振動と訓練エリア3での当該倒立移動体2の向きとを関連付けた情報を用いて、訓練エリア3での倒立移動体2の実際の向き(第2の向き)を推定する(S5)。   On the other hand, the image generation unit 4 acquires vibration information of the inverted moving body 2 generated when the inverted moving body 2 moves in the training area 3 from the vibration detecting unit 27 (S4). The image generation unit 4 then acquires the vibration information and the vibration when the inverted moving body 2 moves in the areas 3a, 3b, 3c, 3d, 3e, 3f, 3g, and 3h and the inverted movement in the training area 3. The actual direction (second direction) of the inverted mobile body 2 in the training area 3 is estimated using the information associated with the direction of the body 2 (S5).

例えば、倒立移動体2が訓練エリア3の中心近傍でヨー軸回りに右旋回する場合、左側の車輪23aは、第2の領域3bから第1の領域3aに侵入する。一方、右側の車輪23aは、第6の領域3fから第5の領域3eに侵入する。   For example, when the inverted moving body 2 turns to the right around the yaw axis in the vicinity of the center of the training area 3, the left wheel 23a enters the first area 3a from the second area 3b. On the other hand, the right wheel 23a enters the fifth region 3e from the sixth region 3f.

このとき、倒立移動体2の左側の車輪23aが第2の領域3bと第1の領域3aとの境界を跨ぎ、右側の車輪23aが第6の領域3fと第5の領域3eとの境界を跨ぐ際に振動が変化するので、画像生成部4は倒立移動体2の前側が訓練エリア3の315°方向を向いた状態であると推定することができる。   At this time, the left wheel 23a of the inverted moving body 2 straddles the boundary between the second region 3b and the first region 3a, and the right wheel 23a crosses the boundary between the sixth region 3f and the fifth region 3e. Since the vibration changes when straddling, the image generation unit 4 can estimate that the front side of the inverted moving body 2 is in a state of facing the 315 ° direction of the training area 3.

同様に、詳細な説明は省略するが、画像生成部4は、倒立移動体2の前側が訓練エリア3の270°方向、225°方向、180°方向、135°方向、90°方向、45°方向及び0°方向に向いた状態であると推定することができる。ちなみに、倒立移動体2の左側の車輪23aが第1の領域3aから第8の領域3hに侵入し、右側の車輪23aが第5の領域3eから第4の領域3dに侵入する際の当該倒立移動体2の振動の大きさと時間との関係は、図6に示すグラフのように表すことができる。   Similarly, although detailed description is omitted, the image generation unit 4 is configured such that the front side of the inverted moving body 2 is 270 ° direction, 225 ° direction, 180 ° direction, 135 ° direction, 90 ° direction, 45 ° of the training area 3. It can be estimated that it is in the direction and the 0 ° direction. Incidentally, when the left wheel 23a of the inverted moving body 2 enters the eighth area 3h from the first area 3a, and the right wheel 23a enters the fourth area 3d from the fifth area 3e. The relationship between the magnitude of vibration of the moving body 2 and time can be expressed as a graph shown in FIG.

このように画像生成部4は、倒立移動体2が領域を移動する際に当該倒立移動体2に発生する振動及び当該領域の境界を倒立移動体2が跨ぐ際の振動の大きさの変化に基づいて、訓練エリア3での倒立移動体2の実際の向きを推定することができる。なお、第1の領域3a及び第5の領域3eに第1の形状の凸部3i1を配置し、第2の領域3b及び第6の領域3fに第2の形状の凸部3i2を配置し、第3の領域3c及び第7の領域3gに第3の形状の凸部3i3を配置し、第4の領域3d及び第8の領域3hに第4の形状の凸部3i4を配置しているが、各々の領域3a、3b、3c、3d、3e、3f、3g及び3hで異なる凸部を配置してもよい。   As described above, the image generation unit 4 changes the magnitude of the vibration generated in the inverted moving body 2 when the inverted moving body 2 moves in the area and the magnitude of the vibration when the inverted moving body 2 straddles the boundary of the area. Based on this, the actual orientation of the inverted moving body 2 in the training area 3 can be estimated. The first shape convex portion 3i1 is disposed in the first region 3a and the fifth region 3e, and the second shape convex portion 3i2 is disposed in the second region 3b and the sixth region 3f. The third shape convex portion 3i3 is disposed in the third region 3c and the seventh region 3g, and the fourth shape convex portion 3i4 is disposed in the fourth region 3d and the eighth region 3h. , Different protrusions may be arranged in each of the regions 3a, 3b, 3c, 3d, 3e, 3f, 3g, and 3h.

ちなみに、領域3a、3b、3c、3d、3e、3f、3g及び3hを倒立移動体2が移動した際に当該倒立移動体2に発生する振動と訓練エリア3での倒立移動体2の向きとを関連付けた情報は、予め実験などによって設定され、図示を省略した記憶部に格納されている。   By the way, when the inverted moving body 2 moves in the areas 3a, 3b, 3c, 3d, 3e, 3f, 3g and 3h, the vibration generated in the inverted moving body 2 and the direction of the inverted moving body 2 in the training area 3 Is previously set by experiments or the like, and is stored in a storage unit (not shown).

次に、画像生成部4は、倒立移動体2の第1の向きと第2の向きとの差の絶対値が予め設定された閾値より大きいか否かを判定する(S6)。つまり、倒立移動体2の第1の向きである左右の車輪23aの回転速度情報を用いて推定した訓練エリア3での倒立移動体2の回転角度と、倒立移動体2の第2の向きである倒立移動体2の振動情報を用いて推定した訓練エリア3での倒立移動体2の回転角度と、の差の絶対値が閾値より大きいか否かを判定する。ここで、本実施の形態の閾値は、領域3a、3b、3c、3d、3e、3f、3g及び3hの中心角度θである45°に設定される。   Next, the image generation unit 4 determines whether or not the absolute value of the difference between the first direction and the second direction of the inverted moving body 2 is greater than a preset threshold value (S6). That is, the rotation angle of the inverted moving body 2 in the training area 3 estimated using the rotation speed information of the left and right wheels 23a which is the first direction of the inverted moving body 2 and the second direction of the inverted moving body 2 It is determined whether or not the absolute value of the difference between the rotation angle of the inverted moving body 2 in the training area 3 estimated using the vibration information of a certain inverted moving body 2 is greater than a threshold value. Here, the threshold value of the present embodiment is set to 45 °, which is the central angle θ of the regions 3a, 3b, 3c, 3d, 3e, 3f, 3g, and 3h.

画像生成部4は、倒立移動体2の第1の向きと第2の向きとの差の絶対値が閾値以下であると(S6のNO)、訓練エリア3での倒立移動体2の座標位置及び第1の向きに連動するように訓練画像を生成する(S7)。   When the absolute value of the difference between the first direction and the second direction of the inverted moving body 2 is equal to or smaller than the threshold (NO in S6), the image generating unit 4 determines the coordinate position of the inverted moving body 2 in the training area 3 And a training image is produced | generated so that it may interlock | cooperate with a 1st direction (S7).

一方、画像生成部4は、倒立移動体2の第1の向きと第2の向きとの差の絶対値が閾値より大きいと(S6のYES)、訓練エリア3での倒立移動体2の座標位置及び第2の向きに連動するように訓練画像を生成する(S8)。   On the other hand, when the absolute value of the difference between the first direction and the second direction of the inverted moving body 2 is larger than the threshold (YES in S6), the image generating unit 4 coordinates the inverted moving body 2 in the training area 3 A training image is generated so as to be linked to the position and the second direction (S8).

このように本実施の形態では、倒立移動体2が訓練エリア3を移動する際に当該倒立移動体2に発生する振動の大きさに基づいて、訓練エリア3での倒立移動体2の実際の向きである第2の向きを推定し、推定した倒立移動体2の第2の向きに対して、推定した倒立移動体2の第1の向きの誤差が大きい場合、倒立移動体2の第2の向きを用いて訓練画像を生成する。そのため、倒立移動体2の実際の向きと訓練画像での倒立移動体2の向きとの乖離を抑制することができる。   As described above, in the present embodiment, when the inverted moving body 2 moves in the training area 3, the actual size of the inverted moving body 2 in the training area 3 is determined based on the magnitude of vibration generated in the inverted moving body 2. The second direction of the inverted moving body 2 is estimated when the second direction which is the direction is estimated and the error of the estimated first direction of the inverted moving body 2 is larger than the estimated second direction of the inverted moving body 2. A training image is generated using the orientation of. Therefore, deviation between the actual direction of the inverted moving body 2 and the direction of the inverted moving body 2 in the training image can be suppressed.

しかも、本実施の形態では、エリアセンサなどの高価な装置を用いなくても、倒立移動体2の振動に基づいて当該倒立移動体2の向きを推定するので、倒立移動体2の向きを安価に推定することができる。   In addition, in the present embodiment, the direction of the inverted moving body 2 is estimated based on the vibration of the inverted moving body 2 without using an expensive device such as an area sensor. Can be estimated.

<実施の形態2>
実施の形態1では訓練エリア3を所定の角度で複数の領域に分割したが、この限りでない。ここで、図7は、本実施の形態のバランス訓練システムの訓練エリアを模式的に示す平面図である。図8は、本実施の形態のバランス訓練システムの異なる訓練エリアを模式的に示す平面図である。
<Embodiment 2>
In the first embodiment, the training area 3 is divided into a plurality of regions at a predetermined angle, but this is not restrictive. Here, FIG. 7 is a plan view schematically showing a training area of the balance training system of the present embodiment. FIG. 8 is a plan view schematically showing different training areas of the balance training system of the present embodiment.

図7に示すように、訓練エリア31の0°、180°方向に所定の間隔で当該訓練エリア31を複数の領域31a、31b、31c、31d及び31eに分割してもよい。ここで、第1の領域31aには、第1の凸部3i1が形成されている。そして、第2の領域31b及び第3の領域31cには、第2の凸部3i2が形成されている。また、第4の領域31d及び第5の領域31eには、第3の凸部3i3が形成されている。これらの第1の凸部3i1、第2の凸部3i2及び第3の凸部3i3は、等しく配置されている。   As shown in FIG. 7, the training area 31 may be divided into a plurality of regions 31a, 31b, 31c, 31d, and 31e at predetermined intervals in the 0 ° and 180 ° directions of the training area 31. Here, the 1st convex part 3i1 is formed in the 1st area | region 31a. And the 2nd convex part 3i2 is formed in the 2nd area | region 31b and the 3rd area | region 31c. In addition, a third protrusion 3i3 is formed in the fourth region 31d and the fifth region 31e. These 1st convex part 3i1, 2nd convex part 3i2, and 3rd convex part 3i3 are arrange | positioned equally.

この場合、例えば、倒立移動体2が前進して第1の領域31aを移動し、その後、倒立移動体2が右旋回して第1の領域31aと第2の領域31bとの境界を跨ぐように移動すると、倒立移動体2の振動の大きさが変化する。そのため、このような振動の大きさの変化及び倒立移動体2の状態情報(即ち、倒立移動体2が右旋回中であるとの情報)に基づいて、画像生成部4は倒立移動体2の前側が訓練エリア31の270°方向に向いた状態であると推定することができる。   In this case, for example, the inverted moving body 2 moves forward and moves in the first area 31a, and then the inverted moving body 2 turns right and crosses the boundary between the first area 31a and the second area 31b. When moving to, the magnitude of vibration of the inverted moving body 2 changes. Therefore, the image generating unit 4 uses the inverted moving body 2 based on the change in the magnitude of the vibration and the state information of the inverted moving body 2 (that is, information that the inverted moving body 2 is turning right). It can be estimated that the front side is oriented in the 270 ° direction of the training area 31.

このように図7の訓練エリア31を用いても、倒立移動体2が訓練エリア3を移動する際の振動の大きさの変化に基づいて、倒立移動体2の第2の向きを推定することができる。しかも、倒立移動体2が領域を跨ぐ際に、領域の境界位置に基づいて倒立移動体2における訓練エリア3での0°、180°方向の座標位置を補正することができる。   As described above, even when the training area 31 of FIG. 7 is used, the second direction of the inverted moving body 2 is estimated based on the change in the magnitude of vibration when the inverted moving body 2 moves in the training area 3. Can do. Moreover, when the inverted moving body 2 straddles the region, the coordinate positions in the 0 ° and 180 ° directions in the training area 3 in the inverted moving body 2 can be corrected based on the boundary position of the region.

また、図8に示すように、訓練エリア32の90°、270°方向に所定の間隔で訓練エリア32を複数の領域32a、32b、32c、32d及び32eに分割してもよい。ここで、第1の領域32aには、第1の凸部3i1が形成されている。そして、第2の領域32b及び第3の領域32cには、第2の凸部3i2が形成されている。また、第4の領域32d及び第5の領域32eには、第3の凸部3i3が形成されている。これらの第1の凸部3i1、第2の凸部3i2及び第3の凸部3i3は、等しく配置されている。   Further, as shown in FIG. 8, the training area 32 may be divided into a plurality of regions 32a, 32b, 32c, 32d, and 32e at predetermined intervals in the 90 ° and 270 ° directions of the training area 32. Here, the 1st convex part 3i1 is formed in the 1st area | region 32a. And the 2nd convex part 3i2 is formed in the 2nd area | region 32b and the 3rd area | region 32c. In addition, a third protrusion 3i3 is formed in the fourth region 32d and the fifth region 32e. These 1st convex part 3i1, 2nd convex part 3i2, and 3rd convex part 3i3 are arrange | positioned equally.

この場合、例えば、倒立移動体2が第1の領域32aと第2の領域32bとを跨ぎながら移動した後に右旋回すると、倒立移動体2が第2の領域32bに侵入して当該倒立移動体2の振動の大きさが変化する。そのため、このような振動の大きさの変化及び倒立移動体2の状態情報に基づいて、画像生成部4は倒立移動体2の前側が訓練エリア3の270°方向に向いた状態であると推定することができる。   In this case, for example, if the inverted moving body 2 moves to the right while turning over the first area 32a and the second area 32b, the inverted moving body 2 enters the second area 32b and the inverted movement is performed. The magnitude of the vibration of the body 2 changes. Therefore, based on the change in the magnitude of the vibration and the state information of the inverted moving body 2, the image generation unit 4 estimates that the front side of the inverted moving body 2 is in the state of 270 ° in the training area 3. can do.

このように図8の訓練エリア32を用いても、倒立移動体2が訓練エリア3を移動する際の振動の大きさの変化に基づいて、倒立移動体2の第2の向きを推定することができる。しかも、倒立移動体2が領域を跨ぐ際に、領域の境界位置に基づいて倒立移動体2における訓練エリア3での90°、270°方向の座標位置を補正することができる。   As described above, even when the training area 32 of FIG. 8 is used, the second direction of the inverted moving body 2 is estimated based on the change in the magnitude of vibration when the inverted moving body 2 moves in the training area 3. Can do. Moreover, when the inverted moving body 2 straddles the region, the coordinate positions in the 90 ° and 270 ° directions in the training area 3 in the inverted moving body 2 can be corrected based on the boundary position of the region.

つまり、図7及び図8に示すように、各々の領域を平行に配置すると、倒立移動体2における訓練エリア3での座標位置を補正することもできる。   That is, as shown in FIGS. 7 and 8, if the respective regions are arranged in parallel, the coordinate position in the training area 3 in the inverted moving body 2 can be corrected.

<実施の形態3>
実施の形態1では所定の領域毎に異なる凸部3iを備えているが、この限りでない。ここで、図9(a)は、本実施の形態のバランス訓練システムの訓練エリアを模式的に示す平面図であり、(b)は、図9(a)のIX−IX断面図である。図10は、倒立移動体の左側の車輪が第1の領域から第8の領域に侵入し、右側の車輪が第5の領域から第4の領域に侵入する際の当該倒立移動体のスペクトル強度と周波数との関係を示す図である。
<Embodiment 3>
In the first embodiment, the different projections 3i are provided for each predetermined region, but this is not restrictive. Here, Fig.9 (a) is a top view which shows typically the training area of the balance training system of this Embodiment, (b) is IX-IX sectional drawing of Fig.9 (a). FIG. 10 shows the spectral intensity of the inverted moving body when the left wheel of the inverted moving body enters the eighth area from the first area and the right wheel enters the fourth area from the fifth area. It is a figure which shows the relationship between and frequency.

訓練エリア3は、予め設定された領域毎に等しい形状の凸部3jを異なる配置で備えていてもよい。例えば、図9(a)及び(b)に示すように、第1の領域3a及び第5の領域3eには、凸部3jが第1の配置で形成されている。第2の領域3b及び第6の領域3fには、凸部3jが第2の配置で形成されている。第3の領域3c及び第7の領域3gには、凸部3jが第3の配置で形成されている。第4の領域3d及び第8の領域3hには、凸部3jが第4の配置で形成されている。   Training area 3 may be provided with convex portions 3j having the same shape for each preset region in different arrangements. For example, as shown in FIGS. 9A and 9B, convex portions 3j are formed in the first arrangement in the first region 3a and the fifth region 3e. Convex portions 3j are formed in the second arrangement in the second region 3b and the sixth region 3f. Convex portions 3j are formed in the third arrangement in the third region 3c and the seventh region 3g. Convex portions 3j are formed in the fourth arrangement in the fourth region 3d and the eighth region 3h.

第1の配置、第2の配置、第3の配置及び第4の配置は、第1の配置で凸部3jが配置された領域3a及び3e、第2の配置で凸部3jが配置された領域3b及び3f、第3の配置で凸部3jが配置された領域3c及び3g、第4の配置で凸部3jが配置された領域3d及び3hを夫々、倒立移動体2が移動した際に当該倒立移動体2が異なる振動を発生するように、凸部3jの配置が異なり、本実施の形態では、凸部3jの配置密度が異なる。   In the first arrangement, the second arrangement, the third arrangement, and the fourth arrangement, the regions 3a and 3e in which the convex portions 3j are arranged in the first arrangement, and the convex portions 3j are arranged in the second arrangement. When the inverted moving body 2 moves in the regions 3b and 3f, the regions 3c and 3g in which the convex portions 3j are arranged in the third arrangement, and the regions 3d and 3h in which the convex portions 3j are arranged in the fourth arrangement, respectively. The arrangement of the projections 3j is different so that the inverted moving body 2 generates different vibrations. In the present embodiment, the arrangement density of the projections 3j is different.

例えば、図9(b)では、第1の領域3aの凸部3jと第8の領域3hの凸部3jとの配置関係を示しており、第1の領域3aに比べて第8の領域3hの方が、凸部3jが点在して配置されている。   For example, FIG. 9B shows an arrangement relationship between the convex portions 3j of the first region 3a and the convex portions 3j of the eighth region 3h, and the eighth region 3h is compared with the first region 3a. In this case, the convex portions 3j are arranged in a dotted manner.

このとき、倒立移動体2の左側の車輪23aが第1の領域3aから第8の領域3hに侵入し、右側の車輪23aが第5の領域3eから第4の領域3dに侵入する際の当該倒立移動体2のスペクトル強度と周波数との関係は、図10に示すグラフのように表すことができる。   At this time, the left wheel 23a of the inverted moving body 2 enters the eighth region 3h from the first region 3a, and the right wheel 23a enters the fourth region 3d from the fifth region 3e. The relationship between the spectrum intensity and the frequency of the inverted moving body 2 can be expressed as a graph shown in FIG.

図10に示すように、倒立移動体2の左側の車輪23aが第1の領域3aを移動し、右側の車輪23aが第5の領域3eを移動する際にスペクトル強度が大きくなる周波数と、倒立移動体2の左側の車輪23aが第8の領域3hを移動し、右側の車輪23aが第4の領域3dを移動する際にスペクトル強度が大きくなる周波数と、は異なる。そのため、スペクトル強度が大きくなる周波数の変化を用いて、画像生成部4は倒立移動体2の前側が訓練エリア3の270°方向に向いた状態であると推定することができる。   As shown in FIG. 10, the left side wheel 23a of the inverted moving body 2 moves in the first region 3a, and the frequency at which the spectral intensity increases when the right side wheel 23a moves in the fifth region 3e is inverted. This is different from the frequency at which the spectral intensity increases when the left wheel 23a of the moving body 2 moves in the eighth region 3h and the right wheel 23a moves in the fourth region 3d. Therefore, the image generation unit 4 can estimate that the front side of the inverted moving body 2 is directed to the 270 ° direction of the training area 3 using the change in frequency at which the spectrum intensity increases.

このように各領域を倒立移動体2が移動した際のスペクトル強度が大きくなる周波数を用いて、倒立移動体2の向きを推定することもできる。   Thus, the direction of the inverted moving body 2 can be estimated using the frequency at which the spectrum intensity when the inverted moving body 2 moves in each region increases.

本発明は上記実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。
例えば、訓練エリアの全域で凸部の配置や凸部の形状を変化させることで、訓練エリアでの倒立移動体の座標位置及び向きを推定することもできる。
例えば、画像生成部4は、倒立移動体2の状態情報に基づいて当該倒立移動体2が大凡左側を向いているのか、又は右側を向いているのか、を推定してもよい。
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 coordinate position and orientation of the inverted moving body in the training area can be estimated by changing the arrangement of the convex portions and the shape of the convex portions throughout the training area.
For example, the image generation unit 4 may estimate whether the inverted moving body 2 is generally facing the left side or the right side based on the state information of the inverted moving body 2.

1 バランス訓練システム
2 倒立移動体
3 訓練エリア、3a 第1の領域、3b 第2の領域、3c 第3の領域、3d 第4の領域、3e 第5領域、3f 第6領域、3g 第7領域、3h 第8領域
3i 凸部、3i1 第1の凸部、3i2 第2の凸部、3i3 第3の凸部、3i4 第4の凸部
3j 凸部
4 画像生成部
5 表示部
21 搭乗部
22 ハンドル
23 駆動輪、23a 車輪、23b モータ
24 姿勢検出部
25 角度検出部
26 速度検出部
27 振動検出部
28 制御部
31 訓練エリア、31a 第1の領域、31b 第2の領域、31c 第3の領域、31d 第4の領域、31e 第5の領域
32 訓練エリア、32a 第1の領域、32b 第2の領域、32c 第3の領域、32d 第4の領域、32e 第5の領域
DESCRIPTION OF SYMBOLS 1 Balance training system 2 Inverted moving body 3 Training area, 3a 1st area | region, 3b 2nd area | region, 3c 3rd area | region, 3d 4th area | region, 3e 5th area | region, 3f 6th area | region, 3g 7th area | region 3h 8th region 3i convex part, 3i1 first convex part, 3i2 second convex part, 3i3 third convex part, 3i4 fourth convex part 3j convex part 4 image generation part 5 display part 21 riding part 22 Handle 23 Drive wheel, 23a wheel, 23b Motor 24 Attitude detection unit 25 Angle detection unit 26 Speed detection unit 27 Vibration detection unit 28 Control unit 31 Training area, 31a First region, 31b Second region, 31c Third region , 31d 4th area, 31e 5th area 32 Training area, 32a 1st area, 32b 2nd area, 32c 3rd area, 32d 4th area, 32e 5th area

Claims (1)

倒立状態を維持するように制御される倒立移動体と、
前記倒立移動体に訓練者が搭乗してバランス訓練を実行する訓練エリアと、
前記訓練エリアでの前記倒立移動体の座標位置及び前記倒立移動体の重心を通り、且つ当該倒立移動体の上下方向に延在する軸を中心とする回転角度である前記倒立移動体の向きを推定し、推定した前記倒立移動体の座標位置及び向きに連動するように訓練画像を生成する画像生成部と、
前記訓練画像を表示する表示部と、
を備えるバランス訓練システムであって、
前記訓練エリアは、予め設定された領域毎に異なる凸部又は配置が異なる凸部を備え、
前記倒立移動体は、当該倒立移動体の車輪の回転速度を検出する速度検出部、及び前記倒立移動体の振動を検出する振動検出部を備え、
前記画像生成部は、
前記倒立移動体の車輪の回転速度情報を取得し、前記回転速度情報を用いて、前記訓練エリアでの前記倒立移動体の座標位置及び第1の向きを推定し、
前記倒立移動体が前記訓練エリアを移動した際の当該倒立移動体の振動情報を取得し、前記振動情報及び前記領域を前記倒立移動体が移動した際に当該倒立移動体に発生する振動と前記訓練エリアでの前記倒立移動体の向きとを関連付けた情報を用いて、少なくとも前記訓練エリアでの前記倒立移動体の第2の向きを推定し、
前記第1の向きと前記第2の向きとの差の絶対値が予め設定された閾値より大きいと、前記第2の向きを用いて前記訓練画像を生成し、
前記第1の向きと前記第2の向きとの差の絶対値が予め設定された閾値以下であると、前記第1の向きを用いて前記訓練画像を生成する、バランス訓練システム。
An inverted moving body controlled to maintain an inverted state;
A training area where a trainee boarded the inverted moving body and performs balance training; and
The orientation of the inverted moving body that is a rotation angle about an axis that passes through the coordinate position of the inverted moving body and the center of gravity of the inverted moving body in the training area and extends in the vertical direction of the inverted moving body. An image generation unit for generating a training image to be estimated and linked to the estimated coordinate position and orientation of the inverted moving body;
A display unit for displaying the training image;
A balance training system comprising:
The training area is provided with different convex portions or different convex portions for each preset region,
The inverted moving body includes a speed detection unit that detects a rotation speed of a wheel of the inverted moving body, and a vibration detection unit that detects vibration of the inverted moving body,
The image generation unit
Obtaining the rotational speed information of the wheels of the inverted moving body, using the rotational speed information, estimating the coordinate position and the first direction of the inverted moving body in the training area,
The vibration information of the inverted moving body when the inverted moving body moves in the training area, and the vibration information and the vibration generated in the inverted moving body when the inverted moving body moves in the region and the vibration Using the information associated with the orientation of the inverted moving body in the training area, to estimate at least a second direction of the inverted moving body in the training area;
When the absolute value of the difference between the first orientation and the second orientation is greater than a preset threshold, the training image is generated using the second orientation,
The balance training system which produces | generates the said training image using the said 1st direction when the absolute value of the difference of the said 1st direction and the said 2nd direction is below a preset threshold value.
JP2015029632A 2015-02-18 2015-02-18 Balance training system Pending JP2016150148A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2015029632A JP2016150148A (en) 2015-02-18 2015-02-18 Balance training system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2015029632A JP2016150148A (en) 2015-02-18 2015-02-18 Balance training system

Publications (1)

Publication Number Publication Date
JP2016150148A true JP2016150148A (en) 2016-08-22

Family

ID=56695694

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2015029632A Pending JP2016150148A (en) 2015-02-18 2015-02-18 Balance training system

Country Status (1)

Country Link
JP (1) JP2016150148A (en)

Similar Documents

Publication Publication Date Title
JP6384436B2 (en) Balance training apparatus and control method thereof
JP6355080B2 (en) Boarding type mobile robot
Park et al. Development and control of a single-wheel robot: Practical Mechatronics approach
US9891624B2 (en) Control unit for inverted pendulum vehicle
JP2007219986A (en) Inversion moving device and its control method
Alexey et al. Stabilization of the motion of a spherical robot using feedbacks
JP2013240849A (en) Operation simulation system of robot system
KR20140016141A (en) Inverted pendulum type vehicle
Loc et al. Sensing and gait planning of quadruped walking and climbing robot for traversing in complex environment
JP4138546B2 (en) Mobile cart and control method of mobile cart
JP2015058492A (en) Control device, robot system, robot, robot operation information generation method, and program
Choi et al. Development of a rapid mobile robot with a multi-degree-of-freedom inverted pendulum using the model-based zero-moment point stabilization method
JP2007319991A (en) Mobile robot
JP2016150148A (en) Balance training system
KR101478599B1 (en) Inverted pendulum type vehicle
JP2015128972A (en) Display control method for inverted movable body
Czarnetzki et al. Applying dynamic walking control for biped robots
Zheng et al. Ball walker: A case study of humanoid robot locomotion in non-stationary environments
JP5336955B2 (en) Inverted pendulum type moving body and control method thereof
JP6245860B2 (en) Mobile cart control apparatus and mobile cart control method
JP2006259363A (en) Drive simulation test apparatus
JP2006205839A (en) Mobile carriage and control method of mobile carriage
Chestnutty et al. Safe adjustment regions for legged locomotion paths
KR20120019893A (en) Footstep planning method for bipedal robot
JP4789061B2 (en) vehicle