JP6354447B2 - Training system, training method and training program - Google Patents

Training system, training method and training program Download PDF

Info

Publication number
JP6354447B2
JP6354447B2 JP2014168788A JP2014168788A JP6354447B2 JP 6354447 B2 JP6354447 B2 JP 6354447B2 JP 2014168788 A JP2014168788 A JP 2014168788A JP 2014168788 A JP2014168788 A JP 2014168788A JP 6354447 B2 JP6354447 B2 JP 6354447B2
Authority
JP
Japan
Prior art keywords
moving body
predetermined
training
control
distance
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2014168788A
Other languages
Japanese (ja)
Other versions
JP2016043781A (en
Inventor
英祐 青木
英祐 青木
周平 真鍋
周平 真鍋
吉紀 稲葉
吉紀 稲葉
景子 佐渡
景子 佐渡
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
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 JP2014168788A priority Critical patent/JP6354447B2/en
Publication of JP2016043781A publication Critical patent/JP2016043781A/en
Application granted granted Critical
Publication of JP6354447B2 publication Critical patent/JP6354447B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、搭乗者が搭乗し倒立状態を維持して走行する移動体を動作させて訓練を行う訓練システム、訓練方法及び訓練プログラムに関するものである。   The present invention relates to a training system, a training method, and a training program for performing training by operating a moving body that a passenger rides and travels while maintaining an inverted state.

搭乗者が搭乗し倒立状態を維持して走行する移動体に所定動作をさせ、その所定動作に応じて搭乗者が重心移動により移動体の走行操作を行うような訓練を実行する訓練システムが知られている(例えば、特許文献1参照)。   A training system is known that performs a training in which a passenger travels in a predetermined manner on a moving body that is traveling while maintaining an inverted state, and the passenger performs a traveling operation of the moving body by moving the center of gravity in accordance with the predetermined motion. (For example, refer to Patent Document 1).

特開2011−140262号公報JP 2011-140262 A

上記訓練システムにおいては、例えば、訓練中に搭乗者がバランスを崩し、移動体が訓練エリアから外れてしまう場合、周囲の障害物等に接触する虞がある。
本発明は、かかる課題を解決するためになされたものであり、移動体が訓練エリアから外れた場合でも、移動体の所定動作を停止させ安全性を確保できる訓練システム、訓練方法及び訓練プログラムを提供することを主たる目的とする。
In the training system described above, for example, when a passenger loses balance during training and the moving body moves out of the training area, there is a risk of contact with surrounding obstacles.
The present invention has been made to solve such a problem, and provides a training system, a training method, and a training program that can ensure the safety by stopping a predetermined operation of the moving body even when the moving body is out of the training area. The main purpose is to provide.

上記目的を達成するための本発明の一態様は、搭乗者が搭乗し倒立状態を維持して走行する移動体に所定動作をさせ、該所定動作に応じて搭乗者が重心移動により前記移動体の走行操作を行うような訓練を実行する訓練システムであって、前記移動体の所定位置からの距離が閾値以上であると判断したとき、前記移動体の所定動作を停止させる制御を行う制御手段を備える、ことを特徴とする訓練システムである。
この一態様において、前記制御手段は、前記移動体の所定位置からの距離が閾値以上であると判断したとき、前記移動体の所定動作を徐々に小さくして停止させてもよい。
この一態様において、前記所定動作させるための前記移動体の目標姿勢角度のオフセット値を設定する設定手段を更に備え、前記制御手段は、前記設定手段により設定された目標姿勢角度のオフセット値に基づいて前記移動体の所定動作を制御しており、前記設定手段は、所定の波形ブロックに従って前記目標姿勢角度のオフセット値を増減させて設定しており、前記制御手段は、前記移動体の所定位置からの距離が閾値以上であると判断したとき、現在の前記所定の波形ブロックに従った目標姿勢角度のオフセット値による制御が終了した後、前記移動体の所定動作を停止させてもよい。
この一態様において、前記所定動作させるための前記移動体の目標姿勢角度のオフセット値を設定する設定手段を更に備え、前記制御手段は、前記移動体の所定位置からの距離が閾値以上であると判断したとき、前記設定手段により設定された目標姿勢角度のオフセット値を徐々に減少させて前記移動体の所定動作を停止させてもよい。
この一態様において、前記制御手段は、前記移動体の所定位置からの距離が閾値以上であると判断し、前記移動体の所定動作を停止させた後、前記移動体の所定位置からの距離が閾値より小さいと判断したとき、所定時間経過後、前記移動体の所定動作を再開させてもよい。
上記目的を達成するための本発明の一態様は、搭乗者が搭乗し倒立状態を維持して走行する移動体に所定動作をさせ、該所定動作に応じて搭乗者が重心移動により前記移動体の走行操作を行うような訓練を実行する訓練方法であって、前記移動体の所定位置からの距離が閾値以上であると判断したとき、前記移動体の所定動作を停止させる制御を行う、ことを特徴とする訓練方法であってもよい。
上記目的を達成するための本発明の一態様は、搭乗者が搭乗し倒立状態を維持して走行する移動体に所定動作をさせ、該所定動作に応じて搭乗者が重心移動により前記移動体の走行操作を行うような訓練を実行する訓練プログラムであって、前記移動体の所定位置からの距離が閾値以上であると判断したとき、前記移動体の所定動作を停止させる制御を行う処理をコンピュータに実行させる、ことを特徴とする訓練プログラムであってもよい。
According to one aspect of the present invention for achieving the above object, a moving body that a passenger rides and travels while maintaining an inverted state performs a predetermined operation, and the passenger moves the center of gravity by moving the center of gravity according to the predetermined operation. A training system for performing training for performing a traveling operation of the vehicle, wherein when it is determined that a distance from the predetermined position of the moving body is equal to or greater than a threshold value, control means for performing control to stop the predetermined operation of the moving body A training system characterized by comprising:
In this aspect, when the control unit determines that the distance from the predetermined position of the moving body is equal to or greater than the threshold value, the control unit may gradually reduce the predetermined operation of the moving body and stop it.
In this aspect, the apparatus further includes setting means for setting an offset value of the target posture angle of the moving body for the predetermined operation, and the control means is based on the offset value of the target posture angle set by the setting means. A predetermined operation of the moving body is controlled, and the setting means is configured to increase or decrease an offset value of the target posture angle according to a predetermined waveform block, and the control means is configured to control the predetermined position of the moving body. When it is determined that the distance from the target is greater than or equal to the threshold value, the predetermined operation of the moving body may be stopped after the control by the offset value of the target posture angle according to the current predetermined waveform block is completed.
In this aspect, it further includes setting means for setting an offset value of the target posture angle of the moving body for the predetermined operation, and the control means has a distance from the predetermined position of the moving body equal to or greater than a threshold value. When the determination is made, the predetermined motion of the movable body may be stopped by gradually decreasing the offset value of the target posture angle set by the setting means.
In this one aspect, the control means determines that the distance from the predetermined position of the moving body is equal to or greater than a threshold value, stops the predetermined operation of the moving body, and then determines the distance from the predetermined position of the moving body. When it is determined that the value is smaller than the threshold value, the predetermined operation of the moving body may be resumed after a predetermined time has elapsed.
According to one aspect of the present invention for achieving the above object, a moving body that a passenger rides and travels while maintaining an inverted state performs a predetermined operation, and the passenger moves the center of gravity by moving the center of gravity according to the predetermined operation. A training method for performing training such as performing a traveling operation of the vehicle, wherein when the distance from the predetermined position of the moving body is determined to be greater than or equal to a threshold value, control for stopping the predetermined operation of the moving body is performed. May be a training method characterized by
According to one aspect of the present invention for achieving the above object, a moving body that a passenger rides and travels while maintaining an inverted state performs a predetermined operation, and the passenger moves the center of gravity by moving the center of gravity according to the predetermined operation. A training program for performing a training for performing a traveling operation of the vehicle, wherein when it is determined that a distance from the predetermined position of the moving body is equal to or greater than a threshold value, a process for performing control to stop the predetermined operation of the moving body is performed. It may be a training program characterized in that it is executed by a computer.

本発明によれば、移動体が訓練エリアから外れた場合でも、移動体の所定動作を停止させ安全性を確保できる訓練システム、訓練方法及び訓練プログラムを提供できる。   ADVANTAGE OF THE INVENTION According to this invention, even when a moving body remove | deviates from a training area, the training system, the training method, and the training program which can stop the predetermined operation | movement of a moving body and ensure safety can be provided.

(a)本発明の実施形態1に係る訓練システムの構成を示す概略図である。(b)本発明の実施形態1に係る訓練システムの構成を示す概略図である。(A) It is the schematic which shows the structure of the training system which concerns on Embodiment 1 of this invention. (B) It is the schematic which shows the structure of the training system which concerns on Embodiment 1 of this invention. 本発明の実施形態1に係る訓練システムの概略的なシステム構成を示すブロック図である。It is a block diagram which shows the schematic system configuration | structure of the training system which concerns on Embodiment 1 of this invention. 本発明の実施形態1に係る倒立型移動体の概略的な構成を示す正面図である。It is a front view which shows the schematic structure of the inverted moving body which concerns on Embodiment 1 of this invention. 並進角速度指令値の算出方法を示すブロック線図である。It is a block diagram which shows the calculation method of a translational angular velocity command value. 旋回角速度指令値の算出方法を示すブロック線図である。It is a block diagram which shows the calculation method of turning angular velocity command value. 目標姿勢角度オフセット値の波形ブロックの一例を示す図である。It is a figure which shows an example of the waveform block of a target attitude angle offset value. 本発明の実施形態1に係る訓練システムによる訓練方法を示すフローチャートである。It is a flowchart which shows the training method by the training system which concerns on Embodiment 1 of this invention. 本発明の実施形態2に係る訓練システムによる訓練方法のフローを示すフローチャートである。It is a flowchart which shows the flow of the training method by the training system which concerns on Embodiment 2 of this invention.

実施の形態1
以下、図面を参照して本発明の実施の形態について説明する。図1(a)及び(b)は、本発明の実施の形態1に係る訓練システムの概略的構成を示す図である。本実施の形態1に係る訓練システム10は、倒立状態を維持しつつ搭乗者の重心移動に応じて走行を行う倒立型移動体1のバランス訓練を行うためのシステムである。このバランス訓練においては、例えば、倒立型移動体1に遠隔的にピッチ方向やロール方向の目標姿勢角度のオフセット値(外乱指示)が設定され、この目標姿勢角度のオフセット値に応じて倒立型移動体1が傾斜し移動(所定動作)する。これに対して、搭乗者が重心移動を行い、倒立型移動体1のバランスをとる、あるいは、元の位置に留めることでそのバランスを訓練する。
Embodiment 1
Embodiments of the present invention will be described below with reference to the drawings. FIGS. 1A and 1B are diagrams showing a schematic configuration of a training system according to Embodiment 1 of the present invention. The training system 10 according to the first embodiment is a system for performing balance training of the inverted moving body 1 that travels according to the movement of the center of gravity of the passenger while maintaining the inverted state. In this balance training, for example, an offset value (disturbance instruction) of a target posture angle in the pitch direction or roll direction is set remotely on the inverted moving body 1, and an inverted type movement is performed according to the offset value of the target posture angle. The body 1 tilts and moves (predetermined operation). On the other hand, the occupant moves the center of gravity and balances the inverted mobile body 1 or trains the balance by keeping it in the original position.

図2は、本実施の形態1に係る訓練システムの概略的なシステム構成を示すブロック図である。図3は、本実施の形態に係る倒立型移動体の概略的な構成を示す正面図である。   FIG. 2 is a block diagram showing a schematic system configuration of the training system according to the first embodiment. FIG. 3 is a front view showing a schematic configuration of the inverted moving body according to the present embodiment.

本実施の形態1に係る訓練システム10は、図3に示すような倒立型移動体1に搭載された、姿勢センサ2、回転センサ3、一対の車輪駆動ユニット4L、4R、及び制御装置5と、設定装置11と、を備えている。   The training system 10 according to the first embodiment includes an attitude sensor 2, a rotation sensor 3, a pair of wheel drive units 4L and 4R, and a control device 5 mounted on an inverted moving body 1 as shown in FIG. And a setting device 11.

倒立型移動体1は、例えば、搭乗者が車両本体6に立った状態で乗車することができる立ち乗り型の同軸二輪車として、構成されているが、これに限らず、倒立状態を維持しつつ、搭乗者の重心移動に応じて走行する任意の倒立型移動体に適用可能である。この倒立型移動体1は、例えば、搭乗者が重心を前後に移動させることで前進後退を行い、搭乗者が重心を左右に移動させることで左右旋回を行うことができるように構成されている。   The inverted mobile body 1 is configured as a standing-type coaxial two-wheeled vehicle that can be ridden while the passenger is standing on the vehicle body 6, for example, but is not limited thereto, while maintaining an inverted state. The present invention is applicable to any inverted moving body that travels according to the movement of the center of gravity of the passenger. The inverted moving body 1 is configured such that, for example, the passenger moves forward and backward by moving the center of gravity back and forth, and the passenger can turn left and right by moving the center of gravity left and right. .

姿勢センサ2は、倒立型移動体1の車両本体6におけるピッチ角度、ヨー角度、ロール角度、ピッチ角速度、ヨー角速度、ロール角速度、ピッチ角加速度、ヨー角加速度、ロール角加速度などの姿勢情報を検出する。姿勢センサ2は、例えば、搭乗者が重心を前後へ移動させることで生じた車両本体6のピッチ角度、ピッチ角速度、又はピッチ角加速度を検出することができる。   The posture sensor 2 detects posture information such as a pitch angle, a yaw angle, a roll angle, a pitch angular velocity, a yaw angular velocity, a roll angular velocity, a pitch angular acceleration, a yaw angular acceleration, and a roll angular acceleration in the vehicle body 6 of the inverted moving body 1. To do. The posture sensor 2 can detect, for example, a pitch angle, a pitch angular velocity, or a pitch angular acceleration of the vehicle main body 6 that is generated when the passenger moves the center of gravity back and forth.

姿勢センサ2は、制御装置5に接続されており、検出した車両本体6の姿勢情報を制御装置5に対して出力する。なお、姿勢センサ2は、例えば、ジャイロセンサや加速度センサなどにより構成されている。ここで、ピッチ軸とは、一対の車輪7L、7Rの車軸に相当する軸である。また、ロール軸とは、車両本体6の中心を通り、倒立型移動体1の走行方向と平行をなす軸である。   The posture sensor 2 is connected to the control device 5, and outputs the detected posture information of the vehicle body 6 to the control device 5. Note that the posture sensor 2 is constituted by, for example, a gyro sensor or an acceleration sensor. Here, the pitch axis is an axis corresponding to the axle of the pair of wheels 7L and 7R. The roll axis is an axis that passes through the center of the vehicle body 6 and is parallel to the traveling direction of the inverted moving body 1.

回転センサ3は、倒立型移動体1に設けられた車輪7L、7Rの回転角度、回転角速度、回転角加速度等の回転情報を検出する。回転センサ3は、制御装置5に接続されており、検出した各車輪7L、7Rの回転情報を制御装置5に対して出力する。また、制御装置5は、回転センサ3により検出された各車輪7L、7Rの回転情報に基づいて、倒立型移動体1の移動加速度、移動速度、移動量等を算出することができる。   The rotation sensor 3 detects rotation information such as rotation angles, rotation angular velocities, and rotation angular accelerations of the wheels 7L and 7R provided on the inverted moving body 1. The rotation sensor 3 is connected to the control device 5 and outputs the detected rotation information of the wheels 7L and 7R to the control device 5. Further, the control device 5 can calculate the moving acceleration, moving speed, moving amount, and the like of the inverted moving body 1 based on the rotation information of the wheels 7L and 7R detected by the rotation sensor 3.

一対の車輪駆動ユニット4L、4Rは、倒立型移動体1に回転可能に設けられた左右一対の車輪7L、7Rを駆動することで、倒立型移動体1を走行させる。各車輪駆動ユニット4L、4Rは、例えば、電動モータと、その電動モータの回転軸に動力伝達可能に連結された減速ギア列等によって構成することができる。各車輪駆動ユニット4L、4Rは、駆動回路8L、8Rを介して制御装置5に接続されており、制御装置5からの制御信号に応じて、各車輪7L、7Rを駆動する。   The pair of wheel drive units 4L, 4R drives the inverted mobile body 1 by driving a pair of left and right wheels 7L, 7R rotatably provided on the inverted mobile body 1. Each wheel drive unit 4L, 4R can be constituted by, for example, an electric motor and a reduction gear train connected to the rotating shaft of the electric motor so as to be able to transmit power. Each wheel drive unit 4L, 4R is connected to the control device 5 via drive circuits 8L, 8R, and drives each wheel 7L, 7R according to a control signal from the control device 5.

制御装置5は、制御手段の一具体例であり、倒立型移動体1が、例えば、倒立状態を維持する倒立制御を行いつつ、所望の走行(前進、後進、加速、減速、停止、左旋回、右旋回等)を行うように、各車輪駆動ユニット4L、4Rを制御して、各車輪7L、7Rの回転を制御する。また、制御装置5は、姿勢センサ2により検出された倒立型移動体1の姿勢情報と、回転センサ3により検出された各車輪7L、7Rの回転情報と、に基づいて、フィードバック制御、ロバスト制御等の周知の制御を行う。   The control device 5 is a specific example of the control means, and the inverted mobile body 1 performs, for example, the desired traveling (forward, reverse, acceleration, deceleration, stop, left turn) while performing the inverted control to maintain the inverted state. The wheel drive units 4L and 4R are controlled to perform rotation of the wheels 7L and 7R. Further, the control device 5 performs feedback control and robust control based on the posture information of the inverted moving body 1 detected by the posture sensor 2 and the rotation information of the wheels 7L and 7R detected by the rotation sensor 3. Well-known control is performed.

例えば、制御装置5は、搭乗者が重心を前後に移動させたときに、姿勢センサ2により検出された車両本体6のピッチ角度に応じて、各車輪駆動ユニット4L、4Rを介して各車輪7L、7Rの回転を制御することで、倒立型移動体1を前進又は後進させる。また、制御装置5は、搭乗者が重心を左右に移動させたときに、姿勢センサ2により検出された車両本体6のロール角度に応じて、各車輪駆動ユニット4L、4Rを制御して左右車輪7L、7R間で回転差を生じさせ、倒立型移動体1を左旋回又は右旋回させる。   For example, the control device 5 controls each wheel 7L via each wheel drive unit 4L, 4R according to the pitch angle of the vehicle body 6 detected by the attitude sensor 2 when the passenger moves the center of gravity back and forth. By controlling the rotation of 7R, the inverted moving body 1 is moved forward or backward. The control device 5 controls the wheel drive units 4L and 4R according to the roll angle of the vehicle body 6 detected by the attitude sensor 2 when the occupant moves the center of gravity to the left and right. A rotation difference is generated between 7L and 7R, and the inverted mobile body 1 is turned left or right.

さらに、制御装置5は、例えば、姿勢センサ2により検出された車両本体6のピッチ角度に所定の制御ゲインを乗算して、各車輪7L、7Rの回転トルクを算出する。そして、制御装置5は、算出した回転トルクが各車輪7L、7Rに生じるように、各車輪駆動ユニット4L、4Rを制御する。   Further, for example, the control device 5 multiplies the pitch angle of the vehicle body 6 detected by the attitude sensor 2 by a predetermined control gain to calculate the rotational torque of each wheel 7L, 7R. And the control apparatus 5 controls each wheel drive unit 4L and 4R so that the calculated rotational torque may arise in each wheel 7L and 7R.

これにより、制御装置5は、車両本体6が傾斜している方向へ各車輪7L、7Rを回動させ、倒立型移動体1の重心位置を各車輪7L、7Rの車軸を通る鉛直線上へ戻すような倒立制御を行う。また、制御装置5は、各車輪7L、7Rに対して適切な回転トルクを夫々付加することで、車両本体6のピッチ角度がある一定値を超えないような倒立状態を維持しつつ、さらに、姿勢センサ2からの姿勢情報に応じて、前進、後進、停止、減速、加速、左旋回、右旋回等の移動体1の移動制御を行うことができる。   Accordingly, the control device 5 rotates the wheels 7L and 7R in the direction in which the vehicle body 6 is inclined, and returns the center of gravity of the inverted moving body 1 to the vertical line passing through the axles of the wheels 7L and 7R. Invert control like this. Further, the control device 5 adds an appropriate rotational torque to each of the wheels 7L and 7R to maintain an inverted state in which the pitch angle of the vehicle body 6 does not exceed a certain value. In accordance with the posture information from the posture sensor 2, movement control of the moving body 1 such as forward, reverse, stop, deceleration, acceleration, left turn, right turn, and the like can be performed.

制御装置5は、回転センサ3により検出された各車輪7L、7Rの回転情報に基づいて、倒立型移動体1の所定位置(例えば、バランス訓練開始の初期位置)からの距離を算出する。制御装置5は、回転センサ3により検出された各車輪7L、7Rの回転情報に基づいて、下記式を用いて所定位置からの距離を算出する。なお、所定位置は、設定装置11などを介して、ユーザが任意に設定変更できるように構成されていてもよい。   Based on the rotation information of the wheels 7L and 7R detected by the rotation sensor 3, the control device 5 calculates the distance from the predetermined position (for example, the initial position for starting the balance training) of the inverted mobile body 1. Based on the rotation information of the wheels 7L and 7R detected by the rotation sensor 3, the control device 5 calculates the distance from the predetermined position using the following equation. The predetermined position may be configured such that the user can arbitrarily change the setting via the setting device 11 or the like.

OdmX(t)=OdmX(t−1)+∫{X(t)cosγ(d)dt}
OdmY(t)=OdmY(t−1)+∫{Y(t)sinγ(d)dt}
但し、上記式において、倒立型移動体1の時刻tにおけるオドメトリX位置をOdmX(t)、時刻tにおけるオドメトリY位置OdmY(t)、時刻tにおける車両本体6の旋回角度γ(t)、及び時刻tにおける車両本体6の中心速度X(t)とする。
OdmX (t) = OdmX (t−1) + ∫ {X (t) cosγ (d) dt}
OdmY (t) = OdmY (t−1) + ∫ {Y (t) sinγ (d) dt}
However, in the above formula, the odometry X position of the inverted mobile body 1 at time t is OdmX (t), the odometry Y position OdmY (t) at time t, the turning angle γ (t) of the vehicle body 6 at time t, and The center speed X (t) of the vehicle body 6 at time t is assumed.

制御装置5は、例えば、制御処理、演算処理等と行うCPU(Central Processing Unit)5a、CPU5aによって実行される制御プログラム、演算プログラム等が記憶されたROM(Read Only Memory)5b、処理データ等を記憶するRAM(Random Access Memory)5c等からなるマイクロコンピュータを中心にして、ハードウェア構成されている。   The control device 5 includes, for example, a CPU (Central Processing Unit) 5a that performs control processing, arithmetic processing, and the like, a ROM (Read Only Memory) 5b that stores a control program executed by the CPU 5a, an arithmetic program, processing data, and the like. The hardware configuration is centered on a microcomputer including a RAM (Random Access Memory) 5c and the like.

上述のような車両制御の構成により、倒立型移動体1は、例えば、搭乗者が重心を前後に移動させ車両本体6を前後に傾斜させることで前進後退を行い、搭乗者が重心を左右に移動させ車両本体6を左右に傾斜させることで、左右旋回を行うことができる。   With the configuration of the vehicle control as described above, the inverted mobile body 1 moves forward and backward, for example, when the occupant moves the center of gravity back and forth and tilts the vehicle body 6 back and forth, and the occupant moves the center of gravity left and right. By moving and tilting the vehicle body 6 left and right, it is possible to turn left and right.

設定装置11は、設定手段の一具体例であり、制御装置5に対して、倒立型移動体1のピッチ方向及びロール方向の目標姿勢角度のオフセット値(以下、目標姿勢角度オフセット値)を設定する。設定装置11は、例えば、PC(Personal Computer)、スマートフォンなどの携帯端末などにより構成されている。設定装置11は、有線あるいは無線で制御装置5に接続されている。設定装置11は、倒立型移動体1の目標姿勢角度オフセット値を制御装置5に送信する。   The setting device 11 is a specific example of setting means, and sets an offset value (hereinafter referred to as a target posture angle offset value) of a target posture angle in the pitch direction and roll direction of the inverted moving body 1 to the control device 5. To do. The setting device 11 is configured by, for example, a mobile terminal such as a PC (Personal Computer) or a smartphone. The setting device 11 is connected to the control device 5 by wire or wireless. The setting device 11 transmits the target posture angle offset value of the inverted moving body 1 to the control device 5.

制御装置5は、設定装置11から送信される目標姿勢角度オフセット値に基づいて、倒立型移動体1の姿勢角度を制御する。制御装置5は、例えば、設定装置11から出力される目標姿勢角度オフセット値と、目標姿勢角度と、姿勢センサ2から出力されるピッチ方向の姿勢角度と、目標姿勢角速度と、姿勢センサ2から出力されるピッチ方向の姿勢角速度と、目標速度抑制量と、に基づいて、倒立型移動体1の並進方向の角速度指令値(以下、並進角速度指令値)を算出する。制御装置5は、算出した並進角速度指令値に応じた制御信号を各車輪駆動ユニット4L、4Rに出力する。   The control device 5 controls the posture angle of the inverted moving body 1 based on the target posture angle offset value transmitted from the setting device 11. For example, the control device 5 outputs the target posture angle offset value output from the setting device 11, the target posture angle, the posture angle in the pitch direction output from the posture sensor 2, the target posture angular velocity, and the posture sensor 2. Based on the posture angular velocity in the pitch direction and the target velocity suppression amount, an angular velocity command value in the translation direction of the inverted mobile body 1 (hereinafter referred to as a translation angular velocity command value) is calculated. The control device 5 outputs a control signal corresponding to the calculated translational angular velocity command value to each wheel drive unit 4L, 4R.

図4は、並進角速度指令値の算出方法を示すブロック線図である。
制御装置5は、例えば、設定装置11から出力される目標姿勢角度オフセット値と、目標姿勢角度と、を加算する。そして、制御装置5は、その加算値と、姿勢センサ2から出力されるピッチ方向の姿勢角度と、の偏差を算出し、算出した偏差にゲインを乗算する。制御装置5は、目標姿勢角速度と、姿勢センサ2から出力されるピッチ方向の姿勢角速度と、の偏差を算出し、算出した偏差にゲインを乗算する。制御装置5は、この乗算値に上記乗算値を加算し、符号を反転させる。制御装置5は、この演算値に、目標速度抑制量にゲインを乗算した乗算値を加算することで、並進角速度指令値を算出する。
FIG. 4 is a block diagram showing a method for calculating a translational angular velocity command value.
For example, the control device 5 adds the target posture angle offset value output from the setting device 11 and the target posture angle. Then, the control device 5 calculates a deviation between the added value and the posture angle in the pitch direction output from the posture sensor 2, and multiplies the calculated deviation by a gain. The control device 5 calculates a deviation between the target posture angular velocity and the posture angular velocity in the pitch direction output from the posture sensor 2, and multiplies the calculated deviation by a gain. The control device 5 adds the multiplication value to the multiplication value and inverts the sign. The control device 5 calculates a translational angular velocity command value by adding a multiplication value obtained by multiplying the target velocity suppression amount by a gain to the calculated value.

また、制御装置5は、例えば、設定装置11から出力される目標姿勢角度オフセット値と、姿勢センサ2から出力されるロール方向の姿勢角度と、に基づいて、倒立型移動体1の旋回方向の角速度指令値(以下、旋回角速度指令値)を算出する。制御装置5は、算出した旋回角速度指令値に応じた制御信号を各車輪駆動ユニット4L、4Rに出力する。   Further, the control device 5, for example, based on the target posture angle offset value output from the setting device 11 and the posture angle in the roll direction output from the posture sensor 2, determines the turning direction of the inverted mobile body 1. An angular velocity command value (hereinafter, turning angular velocity command value) is calculated. The control device 5 outputs a control signal corresponding to the calculated turning angular velocity command value to each wheel drive unit 4L, 4R.

図5は、旋回角速度指令値の算出方法を示すブロック線図である。
制御装置5は、例えば、設定装置11から出力される目標姿勢角度オフセット値にゲインを乗算する。制御装置5は、姿勢センサ2から出力されるロール方向の姿勢角度にゲインを乗算し、この乗算値に上記乗算値を加算することで、旋回角速度指令値を算出する。
FIG. 5 is a block diagram showing a method of calculating the turning angular velocity command value.
For example, the control device 5 multiplies the target posture angle offset value output from the setting device 11 by a gain. The controller 5 multiplies the posture angle in the roll direction output from the posture sensor 2 by a gain, and adds the multiplication value to the multiplied value to calculate the turning angular velocity command value.

設定装置11は、倒立型移動体1の目標姿勢角度オフセット値を設定し、制御装置5に対して出力する。ここで、目標姿勢角度オフセット値の設定方法について説明する。設定装置11は、バランス訓練中における倒立型移動体1の目標姿勢角度オフセット値の変動パターンを設定する。設定装置11は、例えば、図6に示すような所定の波形ブロックを連続的に生成する。設定装置11は、生成した所定の波形ブロックに従って目標姿勢角度オフセット値を増減させて設定し、制御装置5に対して出力する。   The setting device 11 sets a target posture angle offset value of the inverted moving body 1 and outputs it to the control device 5. Here, a method for setting the target posture angle offset value will be described. The setting device 11 sets a variation pattern of the target posture angle offset value of the inverted mobile body 1 during balance training. For example, the setting device 11 continuously generates a predetermined waveform block as shown in FIG. The setting device 11 increases / decreases the target posture angle offset value according to the generated predetermined waveform block, and outputs it to the control device 5.

なお、上記所定の波形ブロックは、周期t4、振動時間t3、外乱a、立ち上がり時間t1、および、立ち下り時間t2に基づいて構成されている。待機時間(波形ブロック間の間隔)は、周期から振動時間を差し引いた値(t4−t3)となっている。なお、波形ブロック毎に振動時間が変動(周期≧振動時間)するため、待機時間が無い場合も想定される。   The predetermined waveform block is configured based on the period t4, the vibration time t3, the disturbance a, the rise time t1, and the fall time t2. The standby time (interval between waveform blocks) is a value obtained by subtracting the vibration time from the period (t4-t3). In addition, since vibration time fluctuates for each waveform block (cycle ≧ vibration time), there may be a case where there is no standby time.

ところで、例えば、訓練中に搭乗者がバランスを崩し、倒立型移動体が訓練エリアから外れてしまう場合、周囲の障害物等に接触する虞がある。これに対し、本実施形態1に係る訓練システム10は、倒立型移動体1の所定位置からの距離が閾値以上であると判断したとき、倒立型移動体1の所定動作を停止させる制御を行う。これにより、倒立型移動体1が訓練エリアから外れた場合でも、倒立型移動体1の所定動作を停止させることで、周囲の障害物等に接触するのを確実に防止でき、安全性を確保できる。   By the way, for example, when an occupant loses balance during training and the inverted moving body moves out of the training area, there is a risk of contact with surrounding obstacles. On the other hand, when the training system 10 according to the first embodiment determines that the distance from the predetermined position of the inverted mobile body 1 is equal to or greater than the threshold value, the training system 10 performs control to stop the predetermined operation of the inverted mobile body 1. . As a result, even when the inverted mobile body 1 is out of the training area, the predetermined motion of the inverted mobile body 1 can be stopped to reliably prevent contact with surrounding obstacles and ensure safety. it can.

制御装置5は、例えば、倒立型移動体1の所定位置からの距離が閾値以上であり、訓練エリアから外れていると判断したとき、設定装置11から出力される目標姿勢角度オフセットを0として倒立型移動体1の所定動作を停止させる制御を行う。なお、上記閾値は、例えば、倒立型移動体1のバランス訓練を行うエリアに応じて上記ROM5bやRAM5cに予め設定されている。   For example, when the control device 5 determines that the distance from the predetermined position of the inverted mobile body 1 is equal to or greater than the threshold value and is out of the training area, the control device 5 is inverted with the target posture angle offset output from the setting device 11 as 0. Control for stopping a predetermined operation of the mold moving body 1 is performed. The threshold value is set in advance in the ROM 5b or RAM 5c according to, for example, an area where balance training of the inverted mobile body 1 is performed.

ここで、制御装置5が、倒立型移動体1の所定位置からの距離が閾値以上となった判断したとき即座に目標姿勢角度オフセットを0にすると、倒立型移動体1の姿勢が急激に変化し不安定となる虞がある。したがって、制御装置5は、現在の所定の波形ブロックに従った目標姿勢角度オフセット値による制御が終了した時点(待機時間)で、目標姿勢角度オフセットを0に維持し、倒立型移動体1の所定動作を停止させるのが好ましい。これにより、目標姿勢角度オフセット値を大きく変化させることなく、倒立型移動体1の姿勢を安定させて倒立型移動体1の所定動作を停止させることができる。   Here, when the control device 5 determines that the distance from the predetermined position of the inverted mobile body 1 is equal to or greater than the threshold value, and immediately sets the target posture angle offset to 0, the posture of the inverted mobile body 1 changes rapidly. There is a risk of becoming unstable. Therefore, the control device 5 maintains the target posture angle offset at 0 when the control by the target posture angle offset value according to the current predetermined waveform block is completed (standby time), and the predetermined position of the inverted mobile body 1 is determined. It is preferable to stop the operation. As a result, it is possible to stabilize the posture of the inverted moving body 1 and stop the predetermined operation of the inverted moving body 1 without greatly changing the target posture angle offset value.

さらに、倒立型移動体1の所定位置からの距離が閾値以上であると判断したとき、倒立型移動体1の所定動作を徐々に小さくし、停止させてもよい。制御装置5が、倒立型移動体1の所定位置からの距離が閾値以上であると判断したとき、フィルタなどを用いて目標姿勢角度オフセット値を徐々に減少(例えば、漸減あるいは段階的減少)させて0にし、倒立型移動体1の所定動作を停止させてもよい。これにより、倒立型移動体1の姿勢が緩やかに変化し停止するため、より安全性が向上する。   Furthermore, when it is determined that the distance from the predetermined position of the inverted moving body 1 is equal to or greater than the threshold value, the predetermined operation of the inverted moving body 1 may be gradually reduced and stopped. When the control device 5 determines that the distance from the predetermined position of the inverted moving body 1 is equal to or greater than the threshold value, the target posture angle offset value is gradually decreased (for example, gradually or stepwise decreased) using a filter or the like. The predetermined operation of the inverted mobile body 1 may be stopped. As a result, the posture of the inverted mobile body 1 is gradually changed and stopped, so that safety is further improved.

図7は、本実施形態1に係る訓練システムによる訓練方法を示すフローチャートである。制御装置5が通常の倒立制御を実行している(ステップS101)。そして、制御装置5は、この状態から、ユーザ指示に応じて、上記バランス訓練を開始するための訓練モードに切替わると(ステップS102)、倒立型移動体1の現在位置を所定位置として設定する(ステップS103)。   FIG. 7 is a flowchart showing a training method by the training system according to the first embodiment. The control device 5 performs normal inversion control (step S101). And the control apparatus 5 will set the present position of the inverted mobile body 1 as a predetermined position, if it switches from this state to the training mode for starting the said balance training according to a user instruction | indication (step S102). (Step S103).

設定装置11は、倒立型移動体1の目標姿勢角度オフセット値を設定し、制御装置5に対して出力する(ステップS104)。制御装置5は、設定装置11から出力される目標姿勢角度オフセット値に従って並進角速度指令値及び/又は旋回角速度指令値を生成することで、倒立型移動体1を所定動作させる(ステップS105)。   The setting device 11 sets a target posture angle offset value of the inverted moving body 1 and outputs it to the control device 5 (step S104). The control device 5 generates the translational angular velocity command value and / or the turning angular velocity command value according to the target posture angle offset value output from the setting device 11, thereby causing the inverted moving body 1 to perform a predetermined operation (step S105).

制御装置5は、倒立型移動体1の所定位置からの距離が閾値以上であるか否かを判断する(ステップS106)。制御装置5が、倒立型移動体1の所定位置からの距離が閾値以上となった判断したとき(ステップS106のYES)、目標姿勢角度オフセットを0に維持し、倒立型移動体1の所定動作を停止させる制御を行う(ステップS107)。これにより、制御装置5は、通常の倒立制御を実行している(ステップS108)。   The control device 5 determines whether or not the distance from the predetermined position of the inverted moving body 1 is greater than or equal to the threshold value (step S106). When the control device 5 determines that the distance from the predetermined position of the inverted mobile body 1 is equal to or greater than the threshold (YES in Step S106), the target posture angle offset is maintained at 0, and the predetermined operation of the inverted mobile body 1 is performed. The control for stopping is performed (step S107). Thereby, the control apparatus 5 is performing normal inversion control (step S108).

以上、本実施形態に係る訓練システム10は、倒立型移動体1の所定位置からの距離が閾値以上であると判断したとき、倒立型移動体1の所定動作を停止させる制御を行う。これにより、倒立型移動体1が訓練エリアから外れた場合でも、倒立型移動体1の所定動作を停止させ安全性を確保できる。   As described above, when the training system 10 according to the present embodiment determines that the distance from the predetermined position of the inverted mobile body 1 is equal to or greater than the threshold value, the training system 10 performs control to stop the predetermined operation of the inverted mobile body 1. Thereby, even when the inverted mobile body 1 is out of the training area, the predetermined operation of the inverted mobile body 1 can be stopped to ensure safety.

実施形態2.
上記実施形態1に係る訓練システム10は、倒立型移動体1が訓練エリアから外れたとき所定動作を停止させる制御を行なっている。一方、本実施形態2に係る訓練システム10は、倒立型移動体1が訓練エリアから一度外れ所定動作を停止した後、再度、訓練エリア内に戻ったときに所定動作を再開させる制御を行なっている。
Embodiment 2. FIG.
The training system 10 which concerns on the said Embodiment 1 is performing control which stops a predetermined operation | movement when the inverted mobile body 1 remove | deviates from a training area. On the other hand, the training system 10 according to the second embodiment performs control for resuming the predetermined operation when the inverted mobile body 1 once deviates from the training area and stops the predetermined operation and then returns to the training area. Yes.

図8は、本実施形態2に係る訓練システムによる訓練方法のフローを示すフローチャートである。制御装置5が通常の倒立制御を実行している(ステップS201)。そして、制御装置5は、この状態から、ユーザ指示に応じて、上記バランス訓練を開始するための訓練モードに切替わると(ステップS202)、倒立型移動体1の現在位置を所定位置として設定する(ステップS203)。   FIG. 8 is a flowchart showing a flow of a training method by the training system according to the second embodiment. The control device 5 performs normal inversion control (step S201). And the control apparatus 5 will set the present position of the inverted mobile body 1 as a predetermined position, if it switches from this state to the training mode for starting the said balance training according to a user instruction | indication (step S202). (Step S203).

設定装置11は、倒立型移動体1の目標姿勢角度オフセット値を設定し、制御装置5に対して出力する(ステップS204)。制御装置5は、設定装置11から出力される目標姿勢角度オフセット値に従って並進角速度指令値及び/又は旋回角速度指令値を生成することで、倒立型移動体1を所定動作させる(ステップS205)。   The setting device 11 sets a target posture angle offset value of the inverted moving body 1 and outputs it to the control device 5 (step S204). The control device 5 generates the translational angular velocity command value and / or the turning angular velocity command value according to the target posture angle offset value output from the setting device 11, thereby causing the inverted moving body 1 to perform a predetermined operation (step S205).

制御装置5は、倒立型移動体1の所定位置からの距離が閾値以上であるか否かを判断する(ステップS206)。制御装置5が、倒立型移動体1の所定位置からの距離が閾値以上となった判断したとき(ステップS206のYES)、目標姿勢角度オフセットを0に維持し、倒立型移動体1の所定動作を停止させる制御を行う(ステップS207)。これにより、制御装置5は、通常の倒立制御を実行する(ステップS208)。   The control device 5 determines whether or not the distance from the predetermined position of the inverted moving body 1 is greater than or equal to the threshold (step S206). When the control device 5 determines that the distance from the predetermined position of the inverted moving body 1 is equal to or greater than the threshold (YES in Step S206), the target posture angle offset is maintained at 0, and the predetermined operation of the inverted moving body 1 is performed. Control to stop is performed (step S207). Thereby, the control apparatus 5 performs normal inversion control (step S208).

ここで、倒立型移動体1が、例えば、介助者などにより訓練エリア内に戻されると(ステップS209)、制御装置5は、倒立型移動体1の所定位置からの距離が閾値より小さくなり、倒立型移動体1が訓練エリア内に戻った判断する(ステップS210のNO)。   Here, when the inverted moving body 1 is returned to the training area by, for example, an assistant (step S209), the control device 5 determines that the distance from the predetermined position of the inverted moving body 1 is smaller than the threshold value. It is determined that the inverted mobile body 1 has returned to the training area (NO in step S210).

制御装置5は、設定装置11から出力される目標姿勢角度オフセット値に従って並進角速度指令値及び/又は旋回角速度指令値を生成することで、倒立型移動体1の所定動作を再開させる(ステップS211)。   The control device 5 generates the translational angular velocity command value and / or the turning angular velocity command value according to the target posture angle offset value output from the setting device 11, thereby resuming the predetermined operation of the inverted moving body 1 (step S211). .

なお、制御装置5は、倒立型移動体1の所定位置からの距離が閾値より小さくなった判断したときに、所定時間経過後に、倒立型移動体1の所定動作を再開させるのが好ましい。これは、倒立型移動体1が訓練エリア内に戻ったときに、即座に所定動作を開始すると、倒立型移動体1がその付近の介助者等に接触する虞があるからである。したがって、倒立型移動体1が訓練エリア内に戻った後、一定時間待つことで、介助者等は訓練エリア内から確実に退避でき、安全性の向上に繋がる。   In addition, when it is determined that the distance from the predetermined position of the inverted mobile body 1 is smaller than the threshold, the control device 5 preferably restarts the predetermined operation of the inverted mobile body 1 after a predetermined time has elapsed. This is because, when the inverted mobile body 1 returns to the training area, if the predetermined motion is immediately started, the inverted mobile body 1 may come into contact with a nearby assistant or the like. Therefore, after the inverted mobile body 1 returns to the training area, by waiting for a certain time, an assistant or the like can surely evacuate from the training area, leading to an improvement in safety.

以上、本実施形態2に係る訓練システム10によれば、倒立型移動体1の所定動作を停止させた後でも、倒立型移動体1が再度訓練エリア内に戻った場合は、倒立型移動体1の所定動作を再開させ、バランス訓練を再開することができる。   As described above, according to the training system 10 according to the second embodiment, when the inverted mobile body 1 returns to the training area again even after the predetermined motion of the inverted mobile body 1 is stopped, the inverted mobile body is returned. 1 predetermined operation can be resumed and balance training can be resumed.

なお、本発明は上記実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。   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.

例えば、上記実施形態において、制御装置5は、バランス訓練時、倒立型移動体1の所定位置からの距離が閾値以上となった判断したとき、倒立型移動体1の所定動作を停止させる制御を行なっているが、これに限らない。制御装置5は、任意のタイミングで、倒立型移動体1の所定位置からの距離が閾値以上となった判断したとき、倒立型移動体1の所定動作を停止させる制御を行なってもよい。   For example, in the above-described embodiment, the control device 5 performs control to stop the predetermined operation of the inverted mobile body 1 when determining that the distance from the predetermined position of the inverted mobile body 1 is equal to or greater than a threshold during balance training. Yes, but not limited to this. When it is determined that the distance from the predetermined position of the inverted mobile body 1 is equal to or greater than the threshold value, the control device 5 may perform control to stop the predetermined operation of the inverted mobile body 1 at an arbitrary timing.

上記実施形態において、制御装置5が回転センサ3により検出された各車輪7L、7Rの回転情報に基づいて、倒立型移動体1の所定位置からの距離を算出し、その距離が閾値以上であるか否かを判断しているが、これに限らない。   In the above embodiment, the control device 5 calculates the distance from the predetermined position of the inverted mobile body 1 based on the rotation information of the wheels 7L and 7R detected by the rotation sensor 3, and the distance is equal to or greater than the threshold value. Whether or not it is determined is not limited to this.

例えば、制御装置5は、環境内に設置されたセンサ(カメラ、超音波センサ、ミリ波センサなどの距離センサ)を用いて、倒立型移動体1の所定位置からの距離を算出し、その距離が閾値以上であるか否かを判断してもよい。さらに、設定装置11などの外部モジュールが、環境内に設置されたセンサや倒立型移動体1のセンサを用いて、倒立型移動体1の所定位置からの距離を算出し、その距離が閾値以上であるか否かを判断してもよい。この場合、外部モジュールは、倒立型移動体1の所定位置からの距離が閾値以上であると判断したとき、制御装置5に対して、倒立型移動体1の所定動作を停止させるための制御信号を送信する。
上記実施形態において、制御装置5は、設定装置11を含む構成であってもよい。
For example, the control device 5 calculates a distance from a predetermined position of the inverted mobile body 1 using a sensor (a distance sensor such as a camera, an ultrasonic sensor, or a millimeter wave sensor) installed in the environment, and the distance It may be determined whether or not is greater than or equal to a threshold value. Furthermore, an external module such as the setting device 11 calculates a distance from the predetermined position of the inverted mobile body 1 using a sensor installed in the environment or a sensor of the inverted mobile body 1, and the distance is equal to or greater than a threshold value. It may be determined whether or not. In this case, when the external module determines that the distance from the predetermined position of the inverted moving body 1 is equal to or greater than the threshold value, the external module causes the control device 5 to stop the predetermined operation of the inverted moving body 1. Send.
In the above embodiment, the control device 5 may include the setting device 11.

また、本発明は、例えば、図7及び図8に示す処理を、CPU5aにコンピュータプログラムを実行させることにより実現することも可能である。   Further, the present invention can be realized by causing the CPU 5a to execute a computer program, for example, the processes shown in FIGS.

プログラムは、様々なタイプの非一時的なコンピュータ可読媒体(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))を含む。   The program may be stored using various types of non-transitory computer readable media and supplied to a computer. Non-transitory computer readable media include various types of tangible storage media. Examples of non-transitory computer-readable media include magnetic recording media (for example, flexible disks, magnetic tapes, hard disk drives), magneto-optical recording media (for example, magneto-optical disks), CD-ROMs (Read Only Memory), CD-Rs, CD-R / W and semiconductor memory (for example, mask ROM, PROM (Programmable ROM), EPROM (Erasable PROM), flash ROM, RAM (random access memory)) are included.

また、プログラムは、様々なタイプの一時的なコンピュータ可読媒体(transitory computer readable medium)によってコンピュータに供給されてもよい。一時的なコンピュータ可読媒体の例は、電気信号、光信号、及び電磁波を含む。一時的なコンピュータ可読媒体は、電線及び光ファイバ等の有線通信路、又は無線通信路を介して、プログラムをコンピュータに供給できる。   The program may also be supplied to the computer by various types of transitory computer readable media. Examples of transitory computer readable media include electrical signals, optical signals, and electromagnetic waves. The temporary computer-readable medium can supply the program to the computer via a wired communication path such as an electric wire and an optical fiber, or a wireless communication path.

1 倒立型移動体、2 姿勢センサ、3 回転センサ、4L、4R 車輪駆動ユニット、5 制御装置、10 訓練システム、11 設定装置   DESCRIPTION OF SYMBOLS 1 Inverted type mobile body, 2 Posture sensor, 3 Rotation sensor, 4L, 4R Wheel drive unit, 5 Control apparatus, 10 Training system, 11 Setting apparatus

Claims (7)

搭乗者が搭乗し倒立状態を維持して走行する移動体に所定動作をさせ、該所定動作に応じて搭乗者が重心移動により前記移動体の走行操作を行うような訓練を実行する訓練システムであって、
前記移動体の所定位置からの距離が閾値以上であると判断したとき、前記走行操作を可能とした状態で、前記移動体の所定動作を停止させる制御を行う制御手段を備える、ことを特徴とする訓練システム。
A training system for performing a training in which a passenger travels in a predetermined manner while riding and maintains an inverted state, and the passenger performs a traveling operation of the movable body by moving the center of gravity according to the predetermined motion. There,
When it is determined that the distance from the predetermined position of the moving body is equal to or greater than a threshold value, control means is provided for performing control to stop the predetermined operation of the moving body in a state where the traveling operation is possible. Training system to do.
請求項1記載の訓練システムであって、
前記制御手段は、前記移動体の所定位置からの距離が閾値以上であると判断したとき、前記移動体の所定動作を徐々に小さくして停止させる、ことを特徴とする訓練システム。
The training system according to claim 1,
When the control means determines that the distance from the predetermined position of the moving body is equal to or greater than a threshold value, the control means gradually stops the predetermined movement of the moving body by decreasing it.
請求項記載の訓練システムであって、
前記所定動作させるための前記移動体の目標姿勢角度のオフセット値を設定する設定手段を更に備え、
前記制御手段は、前記設定手段により設定された目標姿勢角度のオフセット値に基づいて前記移動体の所定動作を制御しており、
前記設定手段は、所定の波形ブロックに従って前記目標姿勢角度のオフセット値を増減させて設定しており、
前記制御手段は、前記移動体の所定位置からの距離が閾値以上であると判断したとき、現在の前記所定の波形ブロックに従った目標姿勢角度のオフセット値による制御が終了した後、前記移動体の所定動作を停止させる、ことを特徴とする訓練システム。
The training system according to claim 1 ,
Further comprising setting means for setting an offset value of a target posture angle of the moving body for the predetermined operation;
The control means controls a predetermined operation of the moving body based on an offset value of the target posture angle set by the setting means,
The setting means is configured to increase or decrease the offset value of the target posture angle according to a predetermined waveform block,
When the control unit determines that the distance from the predetermined position of the moving body is equal to or greater than a threshold value, the control unit finishes the control by the offset value of the target posture angle according to the current predetermined waveform block, and then A training system characterized by stopping a predetermined operation of the training system.
請求項3記載の訓練システムであって、
前記制御手段は、前記移動体の所定位置からの距離が閾値以上であると判断したとき、現在の前記所定の波形ブロックに従った目標姿勢角度のオフセット値による制御が終了した後、前記移動体の所定動作を停止させることに代えて、前記設定手段により設定された目標姿勢角度のオフセット値を徐々に減少させて前記移動体の所定動作を停止させる、ことを特徴とする訓練システム。
The training system according to claim 3,
When the control unit determines that the distance from the predetermined position of the moving body is equal to or greater than a threshold value, the control unit finishes the control by the offset value of the target posture angle according to the current predetermined waveform block, and then Instead of stopping the predetermined movement, the training system is characterized in that the predetermined movement of the movable body is stopped by gradually decreasing the offset value of the target posture angle set by the setting means.
請求項1乃至4のうちいずれか1項記載の訓練システムであって、
前記制御手段は、前記移動体の所定位置からの距離が閾値以上であると判断し、前記移動体の所定動作を停止させた後、前記移動体の所定位置からの距離が閾値より小さいと判断したとき、所定時間経過後、前記移動体の所定動作を再開させる、ことを特徴とする訓練システム。
The training system according to any one of claims 1 to 4,
The control means determines that the distance from the predetermined position of the moving body is greater than or equal to a threshold value, stops the predetermined operation of the moving body, and then determines that the distance from the predetermined position of the moving body is smaller than the threshold value. Then, after a predetermined time has elapsed, the predetermined motion of the moving body is resumed.
搭乗者が搭乗し倒立状態を維持して走行する移動体に所定動作をさせ、該所定動作に応じて搭乗者が重心移動により前記移動体の走行操作を行うような訓練を実行する訓練方法であって、
前記移動体の所定位置からの距離が閾値以上であると判断したとき、前記走行操作を可能とした状態で、前記移動体の所定動作を停止させる制御を行う、ことを特徴とする訓練方法。
A training method for performing a training in which a rider carries out a predetermined operation on a moving body that is traveling while maintaining an inverted state, and the passenger performs a traveling operation of the moving body by moving the center of gravity according to the predetermined operation. There,
When it is determined that the distance from the predetermined position of the moving body is equal to or greater than a threshold value, control is performed to stop the predetermined operation of the moving body in a state where the traveling operation is possible.
搭乗者が搭乗し倒立状態を維持して走行する移動体に所定動作をさせ、該所定動作に応じて搭乗者が重心移動により前記移動体の走行操作を行うような訓練を実行する訓練プログラムであって、
前記移動体の所定位置からの距離が閾値以上であると判断したとき、前記走行操作を可能とした状態で、前記移動体の所定動作を停止させる制御を行う処理をコンピュータに実行させる、ことを特徴とする訓練プログラム。
A training program for performing a training in which a rider makes a predetermined operation on a moving body that travels while maintaining an inverted state, and the passenger performs a traveling operation of the moving body by moving the center of gravity according to the predetermined operation. There,
When it is determined that the distance from the predetermined position of the moving body is equal to or greater than a threshold value, the computer is caused to execute a process for performing a control for stopping the predetermined operation of the moving body in a state where the traveling operation is possible. A characteristic training program.
JP2014168788A 2014-08-21 2014-08-21 Training system, training method and training program Active JP6354447B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2014168788A JP6354447B2 (en) 2014-08-21 2014-08-21 Training system, training method and training program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2014168788A JP6354447B2 (en) 2014-08-21 2014-08-21 Training system, training method and training program

Publications (2)

Publication Number Publication Date
JP2016043781A JP2016043781A (en) 2016-04-04
JP6354447B2 true JP6354447B2 (en) 2018-07-11

Family

ID=55634759

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2014168788A Active JP6354447B2 (en) 2014-08-21 2014-08-21 Training system, training method and training program

Country Status (1)

Country Link
JP (1) JP6354447B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6384436B2 (en) * 2015-09-11 2018-09-05 トヨタ自動車株式会社 Balance training apparatus and control method thereof

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5413027B2 (en) * 2009-07-30 2014-02-12 トヨタ自動車株式会社 Mobile body control system, control method thereof, and control program
JP2011131620A (en) * 2009-12-22 2011-07-07 Toyota Motor Corp Inverted motorcycle, and method and program for controlling the same
JP2014182318A (en) * 2013-03-21 2014-09-29 Toyota Motor Corp Balance training system and control method thereof
JP6032084B2 (en) * 2013-03-25 2016-11-24 トヨタ自動車株式会社 Balance training system and balance training method

Also Published As

Publication number Publication date
JP2016043781A (en) 2016-04-04

Similar Documents

Publication Publication Date Title
KR102430097B1 (en) System and method for avoiding obstacle for autonomous vehicle
US11161507B2 (en) Method and apparatus for controlling vehicle travelling, and vehicle
JP5045707B2 (en) Traveling apparatus, control method thereof, and control program
JP5790677B2 (en) Movement control apparatus, moving body control method, and control program
JP5761347B2 (en) Inverted moving body control device, control method thereof, and program
KR20110120271A (en) Inverted two-wheel apparatus, and control method and control program thereof
US10005465B2 (en) Moving body control device, moving body control method, and control program
JP2015189411A (en) Lane deviation prevention controller for vehicle
JP2009113558A (en) Vehicle control device and vehicle control method
JP2018032215A5 (en)
JP6032084B2 (en) Balance training system and balance training method
JP6354447B2 (en) Training system, training method and training program
JP6225869B2 (en) Inverted two-wheeled mobile system
JP5786633B2 (en) MOBILE BODY CONTROL DEVICE, ITS CONTROL METHOD, AND PROGRAM
JP2013103564A (en) Steering system, and forklift
JP2010280298A (en) Traveling apparatus, and method and program for controlling the same
JP6217582B2 (en) Inverted moving body and control method thereof
JP2017149216A (en) Vehicular control device
JP5652043B2 (en) Inverted type moving body, its control method and control program
JP5316336B2 (en) Inverted type moving body, its control method and control program
JP5861651B2 (en) MOBILE DEVICE, MOBILE DEVICE CONTROL METHOD, AND PROGRAM
JP6183328B2 (en) Inverted balance training apparatus and inverted balance training method
JP2013099972A (en) Inverted mobile, control method thereof, and program
JP2013112108A (en) Inverted moving body, control method thereof and program
JP2016074270A (en) Inverted two-wheel type moving body system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20160916

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20170510

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20170516

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20170905

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20171024

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20180306

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180426

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: 20180515

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20180528

R151 Written notification of patent or utility model registration

Ref document number: 6354447

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151