JP2016113133A - Inverted bogie, control method of inverted bogie and program - Google Patents

Inverted bogie, control method of inverted bogie and program Download PDF

Info

Publication number
JP2016113133A
JP2016113133A JP2014256109A JP2014256109A JP2016113133A JP 2016113133 A JP2016113133 A JP 2016113133A JP 2014256109 A JP2014256109 A JP 2014256109A JP 2014256109 A JP2014256109 A JP 2014256109A JP 2016113133 A JP2016113133 A JP 2016113133A
Authority
JP
Japan
Prior art keywords
placement
boarding
state
foot
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.)
Granted
Application number
JP2014256109A
Other languages
Japanese (ja)
Other versions
JP6256327B2 (en
Inventor
英祐 青木
Hidesuke Aoki
英祐 青木
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 JP2014256109A priority Critical patent/JP6256327B2/en
Publication of JP2016113133A publication Critical patent/JP2016113133A/en
Application granted granted Critical
Publication of JP6256327B2 publication Critical patent/JP6256327B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

PROBLEM TO BE SOLVED: To perform determination on the boarding of an occupant on an inverted bogie in order to further enhance usability.SOLUTION: An inverted bogie 1 has: a left foot placing part 21a; a right foot placing part 21b; left placement detection sensors 22a, 23a which detect the placement of a left foot to the left foot placing part 21a; right placement detection sensors 22b, 23b which detect the placement of a right foot to the right foot placing part 21b; a boarding determination part 431 which performs the determination of boarding; and a control part 433 which controls the drive of wheels when a boarding state is determined. When the boarding determination part 431 detects the placement of the foot in all detection positions about the placement in at least the left foot placing part 21a, or detects the placement of the foot in all detection positions about the placement in at least the right foot placing part 21b, the boarding determination part determines the boarding state, and after the determination of the boarding state, when the boarding determination part does not detect the placement in all the detection positions of the left foot placing part 21a and the right foot placing part 21b, the boarding determination part changes the determination to a non-boarding state.SELECTED DRAWING: Figure 6

Description

本発明は倒立台車、倒立台車の制御方法及びプログラムに関する。   The present invention relates to an inverted carriage, an inverted carriage control method, and a program.

台車上に搭乗者が乗車した状態で、台車に設けられた駆動車輪を制御することにより倒立状態を維持する制御(倒立制御)を行う装置が知られている。このような装置では、例えば特許文献1に記載されているように、搭乗者が乗車状態か否かを判定し、この判定結果を装置の制御に用いることがある。   There is known a device that performs control (inverted control) to maintain an inverted state by controlling drive wheels provided on the carriage while a passenger is on the carriage. In such a device, for example, as described in Patent Document 1, it is sometimes determined whether or not a passenger is in a boarding state, and the determination result is used for controlling the device.

例えば、特許文献1では、搭乗者が搭乗可能な車体の搭乗部に、搭乗者の各足の載置を個別に検出するステップセンサを設け、搭乗者の一方の足が搭乗部に載置されたことを検出すると倒立制御を開始する技術が開示されている。   For example, in Patent Document 1, a step sensor that individually detects the placement of each foot of the passenger is provided in the riding portion of the vehicle body on which the passenger can ride, and one foot of the passenger is placed on the riding portion. A technique for starting upside-down control when it is detected is disclosed.

特開2014−088054号公報Japanese Patent Application Laid-Open No. 2014-080854

このように搭乗者が乗車状態か非乗車状態であるかに基づいて制御を行う場合、搭乗者の乗車の判定をどのように行うかによって装置の動作が異なるため、乗車判定が利便性に影響を及ぼす。このため、搭乗者の利便性に鑑みて乗車判定を適切に行うことが求められている。   In this way, when the control is performed based on whether the passenger is in the boarding state or the non-boarding state, the operation of the device differs depending on how the passenger's boarding determination is performed, so the boarding determination affects convenience. Effect. For this reason, it is required to appropriately perform boarding determination in view of passenger convenience.

本発明は、上記した事情を背景としてなされたものであり、より利便性が高くなるよう搭乗者の乗車についての判定を行うことができる倒立台車、倒立台車の制御方法及びプログラムを提供することを目的とする。   The present invention has been made in the background of the above-described circumstances, and provides an inverted carriage, an inverted carriage control method, and a program capable of making a determination on the ride of a passenger so as to be more convenient. Objective.

上記目的を達成するための本発明の一態様は、車輪の駆動により倒立状態を維持する倒立台車であって、搭乗者の一方の足を載置可能な第1載置部と、前記一方の足の載置を、前記第1載置部の複数の位置で検出する第1検出手段と、前記搭乗者の他方の足を載置可能な第2載置部と、前記他方の足の載置を、前記第2載置部の複数の位置で検出する第2検出手段と、前記搭乗者の乗車判定を行う乗車判定手段と、前記乗車判定手段により乗車状態と判定されている場合に、前記車輪の駆動を制御する制御手段と、を有し、前記乗車判定手段は、乗車状態と判定していないときに、少なくとも前記第1検出手段が前記一方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出した場合、又は少なくとも前記第2検出手段が前記他方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出した場合、乗車状態と判定し、乗車状態と判定後は、前記第1検出手段が全ての検出位置で載置を検出せず、かつ、前記第2検出手段が全ての検出位置で載置を検出しない場合に非乗車状態へと判定を変更する倒立台車である。
この一態様において、前記制御手段は、前記乗車判定手段により乗車状態と判定されている場合に、倒立状態を維持する制御を行ってもよい。
この一態様において、地面と接することにより前記倒立台車を安定させる接地部と、前記接地部による安定状態であるか否かを判定する安定判定手段とをさらに有し、前記制御手段は、前記乗車判定手段により乗車状態と判定され、かつ、前記安定判定手段により前記接地部による安定状態ではないと判定された場合に、倒立状態を維持する制御を行ってもよい。
この一態様において、前記第1検出手段は、前記一方の足の前方部分の前記第1載置部への載置を検出する第1検出センサと、前記一方の足の後方部分の前記第1載置部への載置を検出する第2検出センサとにより載置を検出し、前記第2検出手段は、前記他方の足の前方部分の前記第2載置部への載置を検出する第3検出センサと、前記他方の足の後方部分の前記第2載置部への載置を検出する第4検出センサとにより載置を検出してもよい。
上記目的を達成するための本発明の一態様は、搭乗者の一方の足を載置可能な第1載置部と、前記搭乗者の他方の足を載置可能な第2載置部とを備え、車輪の駆動により倒立状態を維持する倒立台車の制御方法であって、前記一方の足の載置を、前記第1載置部の複数の位置で検出するステップと、前記他方の足の載置を、前記第2載置部の複数の位置で検出するステップと、前記搭乗者の乗車判定を行うステップと、乗車状態と判定されている場合に、前記車輪の駆動を制御するステップとを有し、前記乗車判定を行うステップは、乗車状態と判定していないときに、少なくとも前記第1載置部の前記一方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出したとき、又は少なくとも前記第2載置部の前記他方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出した場合、乗車状態と判定し、乗車状態と判定後は、前記第1載置部の全ての検出位置で載置を検出せず、かつ、前記第2載置部の全ての検出位置で載置を検出しない場合に非乗車状態へと判定を変更する倒立台車の制御方法であってもよい。
この一態様において、前記車輪の駆動を制御するステップは、前記乗車判定を行うステップで乗車状態と判定されている場合に、倒立状態を維持する制御を行ってもよい。
この一態様において、地面と接することにより前記倒立台車を安定させる接地部による安定状態であるか否かを判定するステップをさらに有し、前記車輪の駆動を制御するステップは、前記乗車判定を行うステップで乗車状態と判定され、かつ、前記安定状態であるか否かを判定するステップで前記接地部による安定状態ではないと判定された場合に、倒立状態を維持する制御を行ってもよい。
この一態様において、前記第1載置部の複数の位置で検出するステップは、前記一方の足の前方部分の前記第1載置部への載置を検出する第1検出センサと、前記一方の足の後方部分の前記第1載置部への載置を検出する第2検出センサとにより載置を検出し、前記第2載置部の複数の位置で検出するステップは、前記他方の足の前方部分の前記第2載置部への載置を検出する第3検出センサと、前記他方の足の後方部分の前記第2載置部への載置を検出する第4検出センサとにより載置を検出してもよい。
上記目的を達成するための本発明の一態様は、搭乗者の一方の足を載置可能な第1載置部と、前記搭乗者の他方の足を載置可能な第2載置部とを備え、車輪の駆動により倒立状態を維持する倒立台車のコンピュータに、前記一方の足の載置を、前記第1載置部の複数の位置で検出するステップと、前記他方の足の載置を、前記第2載置部の複数の位置で検出するステップと、前記搭乗者の乗車判定を行うステップと、乗車状態と判定されている場合に、前記車輪の駆動を制御するステップとを実行させ、前記乗車判定を行うステップは、乗車状態と判定していないときに、少なくとも前記第1載置部の前記一方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出したとき、又は少なくとも前記第2載置部の前記他方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出した場合、乗車状態と判定し、乗車状態と判定後は、前記第1載置部の全ての検出位置で載置を検出せず、かつ、前記第2載置部の全ての検出位置で載置を検出しない場合に非乗車状態へと判定を変更するプログラムであってもよい。
One aspect of the present invention for achieving the above object is an inverted carriage that maintains an inverted state by driving a wheel, and includes a first placement unit capable of placing one leg of a passenger, First detection means for detecting foot placement at a plurality of positions of the first placement portion, a second placement portion capable of placing the other foot of the occupant, and placement of the other foot Second detection means for detecting the position at a plurality of positions of the second placement portion, boarding determination means for performing boarding determination of the passenger, and when the boarding determination means determines that the boarding state, Control means for controlling the driving of the wheels, and when the boarding determination means does not determine the boarding state, at least the first detection means is a region where the one leg is to be placed. Or when at least the second detection means detects the placement at all detection positions included in When mounting is detected at all detection positions included in the region where the other foot is to be mounted, it is determined as a boarding state, and after the determination as a boarding state, the first detection means at all detection positions. An inverted carriage that does not detect placement and changes the determination to a non-boarding state when the second detection means does not detect placement at all detection positions.
In this aspect, the control means may perform control to maintain the inverted state when the boarding determination means determines that the boarding state is present.
In this one aspect, the vehicle further includes a grounding unit that stabilizes the inverted carriage by contacting the ground, and a stability determination unit that determines whether or not the grounding unit is in a stable state. Control may be performed to maintain the inverted state when it is determined by the determination means that the vehicle is in the boarding state and the stability determination means determines that the vehicle is not in a stable state due to the ground contact portion.
In this aspect, the first detection means includes a first detection sensor that detects placement of the front portion of the one foot on the first placement portion, and the first portion of the rear portion of the one foot. A second detection sensor that detects placement on the placement unit detects placement, and the second detection means detects placement of the front portion of the other foot on the second placement unit. The placement may be detected by a third detection sensor and a fourth detection sensor that detects placement of the rear portion of the other foot on the second placement portion.
One aspect of the present invention for achieving the above object includes a first placement unit capable of placing one of the passenger's feet, and a second placement unit capable of placing the other foot of the passenger. A method of controlling an inverted carriage that maintains an inverted state by driving a wheel, the step of detecting placement of the one foot at a plurality of positions of the first placement portion; and the other foot Detecting the mounting of the vehicle at a plurality of positions of the second mounting unit, performing the boarding determination of the occupant, and controlling the driving of the wheels when the boarding state is determined. And the step of determining whether to get on the vehicle includes at least all detection positions included in a region where the one foot of the first mounting portion is about to be mounted when the boarding state is not determined. Or when at least the other foot of the second placement portion is placed. When mounting is detected at all detection positions included in the region to be performed, it is determined that the vehicle is in the boarding state, and after the determination is made as the boarding state, mounting is detected at all the detection positions of the first mounting unit. In addition, an inverted cart control method may be used in which the determination is changed to a non-boarding state when mounting is not detected at all detection positions of the second mounting portion.
In this aspect, the step of controlling the driving of the wheel may perform control for maintaining the inverted state when it is determined that the vehicle is in the boarding state in the step of determining the boarding.
In this one aspect, the method further includes a step of determining whether or not the grounding unit stabilizes the inverted carriage by contacting the ground, and the step of controlling driving of the wheels performs the boarding determination. Control may be performed to maintain the inverted state when it is determined that the vehicle is in the boarding state in step and the step of determining whether or not the vehicle is in the stable state is not the stable state by the ground contact portion.
In this one aspect, the step of detecting at a plurality of positions of the first placement portion includes a first detection sensor for detecting placement of a front portion of the one foot on the first placement portion, and the one Detecting the placement by a second detection sensor for detecting placement of the rear portion of the foot on the first placement portion, and detecting at a plurality of positions of the second placement portion, A third detection sensor for detecting placement of the front portion of the foot on the second placement portion; and a fourth detection sensor for detecting placement of the rear portion of the other foot on the second placement portion; The placement may be detected by.
One aspect of the present invention for achieving the above object includes a first placement unit capable of placing one of the passenger's feet, and a second placement unit capable of placing the other foot of the passenger. A step of detecting the placement of the one foot at a plurality of positions of the first placement portion, and a placement of the other foot in a computer of an inverted cart that maintains an inverted state by driving wheels. Are detected at a plurality of positions of the second mounting portion, a step of determining whether the passenger is on board, and a step of controlling driving of the wheels when it is determined that the vehicle is in a boarding state. The step of determining whether to get on is placed at all detection positions included in an area where at least the one foot of the first placement portion is about to be placed when it is not determined as a boarding state. Or at least the other foot of the second placement portion is When placement is detected at all detection positions included in the region to be placed, it is determined that the vehicle is in the boarding state, and after the boarding state is determined, placement is detected at all the detection positions of the first placement unit. And a program that changes the determination to the non-boarding state when the placement is not detected at all the detection positions of the second placement portion.

本発明によれば、より利便性が高くなるよう搭乗者の乗車についての判定を行うことができる倒立台車、倒立台車の制御方法及びプログラムを提供することができる。   ADVANTAGE OF THE INVENTION According to this invention, the control method and program of an inverted trolley which can perform determination about a passenger | crew's boarding so that it may become more convenient, an inverted trolley | bogie can be provided.

実施の形態1にかかる倒立台車の外観を模式的に示す側面図である。It is a side view which shows typically the external appearance of the inverted trolley | bogie concerning Embodiment 1. FIG. 実施形態1にかかる搭乗台の載置部を模式的に示す平面図である。It is a top view which shows typically the mounting part of the boarding board concerning Embodiment 1. FIG. 実施形態1にかかる倒立台車が接地部による自立により安定状態となっている様子を模式的に示す側面図である。It is a side view which shows typically a mode that the inverted trolley | bogie concerning Embodiment 1 is in the stable state by the independence by a grounding part. 実施の形態1にかかる倒立台車の機能構成の一例を示すブロック図である。It is a block diagram which shows an example of a function structure of the inverted trolley | bogie concerning Embodiment 1. FIG. 乗車判定部の判定条件の一例を示した表である。It is the table | surface which showed an example of the determination conditions of a boarding determination part. 乗車判定部の動作の一例について示すフローチャートである。It is a flowchart shown about an example of operation | movement of a boarding determination part. 実施の形態1にかかる制御部の動作の一例について示すフローチャートである。3 is a flowchart illustrating an example of an operation of a control unit according to the first exemplary embodiment. 実施の形態2にかかる倒立台車の機能構成の一例を示すブロック図である。It is a block diagram which shows an example of a function structure of the inverted trolley | bogie concerning Embodiment 2. FIG. 実施の形態2にかかる制御部の動作の一例について示すフローチャートである。10 is a flowchart illustrating an example of an operation of a control unit according to the second exemplary embodiment.

実施の形態1.
以下、図面を参照して本発明の実施の形態1について説明する。
図1は、実施の形態1にかかる倒立台車1の外観を模式的に示す側面図である。倒立台車1は、同軸の2つの駆動車輪である車輪11が設けられた台車10と、搭乗台20と、接地部30と、本体部40とを備える。倒立台車1は、車輪11の駆動により倒立状態を維持するよう構成されている。倒立台車1は、例えば、搭乗者がバランスをとる練習を行うために用いられるが、用途はこれに限定されない。
Embodiment 1 FIG.
Embodiment 1 of the present invention will be described below with reference to the drawings.
FIG. 1 is a side view schematically showing an appearance of an inverted carriage 1 according to the first embodiment. The inverted carriage 1 includes a carriage 10 provided with wheels 11 that are two coaxial drive wheels, a boarding base 20, a grounding section 30, and a main body section 40. The inverted carriage 1 is configured to maintain an inverted state by driving the wheels 11. The inverted cart 1 is used, for example, for a passenger to practice balancing, but the application is not limited to this.

搭乗台20は、台車10の上面に設けられており、搭乗者2が搭乗する部分である。搭乗台20は、図2に示すように、搭乗者2の左足が載置可能な第1載置部としての左足載置部21aと、搭乗者2の右足が載置可能な第2載置部としての右足載置部21bとを有する。   The boarding board 20 is provided on the upper surface of the carriage 10 and is a part on which the passenger 2 gets on board. As shown in FIG. 2, the boarding platform 20 includes a left foot placement portion 21 a as a first placement portion on which the left foot of the passenger 2 can be placed, and a second placement on which the right foot of the passenger 2 can be placed. And a right foot placement portion 21b as a portion.

左足載置部21aには、左足の載置を検出する左載置検出センサ22a、23aが設けられている。左載置検出センサ22aは、左足の前方部分(すなわち、左足のつま先側の部分)の左足載置部21aへの載置を検出する。左載置検出センサ23aは、左足の後方部分(すなわち、左足のかかと側の部分)の左足載置部21aへの載置を検出する。
このように、左載置検出センサ22a及び左載置検出センサ23aは、第1載置部の複数の位置で一方の足の載置を検出する第1検出手段として機能する。
The left foot placement portion 21a is provided with left placement detection sensors 22a and 23a for detecting placement of the left foot. The left placement detection sensor 22a detects the placement of the front portion of the left foot (that is, the portion on the toe side of the left foot) on the left foot placement portion 21a. The left placement detection sensor 23a detects the placement of the rear portion of the left foot (that is, the heel side portion of the left foot) on the left foot placement portion 21a.
Thus, the left placement detection sensor 22a and the left placement detection sensor 23a function as first detection means for detecting placement of one foot at a plurality of positions of the first placement portion.

右足載置部21bには、右足の載置を検出する右載置検出センサ22b、23bが設けられている。右載置検出センサ22bは、右足の前方部分(すなわち、右足のつま先側の部分)の右足載置部21bへの載置を検出する。右載置検出センサ23bは、右足の後方部分(すなわち、右足のかかと側の部分)の右足載置部21bへの載置を検出する。
このように、右載置検出センサ22b及び右載置検出センサ23bは、第2載置部の複数の位置で他方の足の載置を検出する第2検出手段として機能する。
The right foot placement portion 21b is provided with right placement detection sensors 22b and 23b for detecting the placement of the right foot. The right placement detection sensor 22b detects the placement of the front portion of the right foot (that is, the portion on the toe side of the right foot) on the right foot placement portion 21b. The right placement detection sensor 23b detects the placement of the rear portion of the right foot (that is, the heel side portion of the right foot) on the right foot placement portion 21b.
Thus, the right placement detection sensor 22b and the right placement detection sensor 23b function as second detection means for detecting placement of the other foot at a plurality of positions of the second placement portion.

ここで、左載置検出センサ22a、23a及び右載置検出センサ22b、23bは、光学的、磁気的、電気的等の様々な手法にて構成することが可能であり、その具体的な構成は任意である。例えば、左載置検出センサ22a、23a及び右載置検出センサ22b、23bは、それぞれ、重量センサにより構成されており、重量センサにより搭乗者2の足が乗っているか否かを検出し、足が乗っている場合に足検知信号を制御装置43に対して出力してもよい。   Here, the left placement detection sensors 22a and 23a and the right placement detection sensors 22b and 23b can be configured by various methods such as optical, magnetic, and electrical, and specific configurations thereof. Is optional. For example, the left placement detection sensors 22a and 23a and the right placement detection sensors 22b and 23b are each constituted by a weight sensor, and detects whether or not the foot of the passenger 2 is on the weight sensor. The foot detection signal may be output to the control device 43 when the vehicle is riding.

接地部30は、図3に示されるように、台車10の例えば下面に設けられ、地面3と接することにより倒立台車1を安定させる。このため、接地部30が、地面3と接している場合には、倒立台車1は、倒立制御が停止していても自立することができる。つまり、接地部30による自立時には、接地部30が地面に接し、倒立台車を支持することとなる。ここで、倒立台車1の状態が接地部30による安定状態であるか否かは、後述する姿勢角度センサ41の検出に基づいて判定される。なお、倒立制御がなされている際、接地部30は基本的に地面と接触せず、車輪11だけが地面と接触することとなる。   As shown in FIG. 3, the grounding unit 30 is provided on, for example, the lower surface of the carriage 10, and stabilizes the inverted carriage 1 by contacting the ground 3. For this reason, when the grounding unit 30 is in contact with the ground 3, the inverted cart 1 can be independent even when the inverted control is stopped. That is, when the grounding unit 30 is self-supporting, the grounding unit 30 is in contact with the ground and supports the inverted cart. Here, whether or not the state of the inverted carriage 1 is a stable state by the grounding unit 30 is determined based on detection by an attitude angle sensor 41 described later. When the inversion control is performed, the ground contact portion 30 basically does not contact the ground, and only the wheel 11 contacts the ground.

次に、本体部40について、図4を参照しながら説明する。図4に示されるように、本体部40は、姿勢角度センサ41と、駆動装置42と、制御装置43とを有する。   Next, the main body 40 will be described with reference to FIG. As shown in FIG. 4, the main body 40 includes a posture angle sensor 41, a drive device 42, and a control device 43.

姿勢角度センサ41は、倒立台車1の姿勢角度を検出する。具体的には、姿勢角度センサ41は、少なくとも倒立台車1の前後方向の姿勢の角度(ピッチ角)を検出する。なお、ここで前後方向とは車輪11の回転により移動する方向であり、図1の図面上の左右方向に相当する。姿勢角度センサ41は、倒立台車1の姿勢角度を検出することができればよく、公知の任意の構成により実現される。例えば、姿勢角度センサ41は、例えば、ジャイロセンサや加速度センサにより姿勢角度を検出する。
姿勢角度センサ41による検出結果は、後述する制御装置43に出力される。
The attitude angle sensor 41 detects the attitude angle of the inverted carriage 1. Specifically, the posture angle sensor 41 detects at least the posture angle (pitch angle) of the inverted carriage 1 in the front-rear direction. In addition, the front-back direction here is a direction which moves by rotation of the wheel 11, and is equivalent to the left-right direction on drawing of FIG. The posture angle sensor 41 only needs to be able to detect the posture angle of the inverted carriage 1 and is realized by any known configuration. For example, the posture angle sensor 41 detects the posture angle using, for example, a gyro sensor or an acceleration sensor.
The detection result by the attitude angle sensor 41 is output to the control device 43 described later.

駆動装置42は、モータなどの駆動機構を備え、車輪11を駆動する。駆動装置42は、後述する制御装置43から入力された制御信号に基づいて駆動し、車輪11を回転動作させる。   The drive device 42 includes a drive mechanism such as a motor and drives the wheels 11. The drive device 42 is driven based on a control signal input from the control device 43 described later, and rotates the wheel 11.

制御装置43は、乗車判定部431と、安定判定部432と、制御部433とを有し、倒立台車1を制御する装置である。制御装置43は、例えば、演算処理、制御処理等と行うCPU(Central Processing Unit)、CPUによって実行される演算プログラム、制御プログラム等が記憶されたROM(Read Only Memory)やRAM(Random Access Memory)などからなるメモリ、などを含むマイクロコンピュータを中心にして、ハードウェア構成されている。CPU、及びメモリは、データバスなどを介して相互に接続されている。   The control device 43 includes a boarding determination unit 431, a stability determination unit 432, and a control unit 433, and is a device that controls the inverted carriage 1. The control device 43 includes, for example, a CPU (Central Processing Unit) that performs arithmetic processing, control processing, and the like, a ROM (Read Only Memory) and a RAM (Random Access Memory) that store arithmetic programs executed by the CPU, control programs, and the like. The hardware is configured around a microcomputer including a memory including the above. The CPU and the memory are connected to each other via a data bus or the like.

乗車判定部431は、左足載置部21a及び右足載置部21bにおける足の載置の検出結果に基づいて、搭乗者2の乗車判定を行う。すなわち、乗車判定部431は、左載置検出センサ22a、23a、右載置検出センサ22b、23bの検出結果から、搭乗者2が倒立台車1に乗車した乗車状態であるか、搭乗者2が倒立台車1に乗車していない非乗車状態であるかを判定する。乗車判定部431は、判定結果を制御部433に通知する。   The boarding determination unit 431 performs boarding determination of the occupant 2 based on the detection result of the foot placement in the left foot placement unit 21a and the right foot placement unit 21b. That is, the boarding determination unit 431 determines whether the passenger 2 is in the riding state on the inverted carriage 1 based on the detection results of the left mounting detection sensors 22a and 23a and the right mounting detection sensors 22b and 23b. It is determined whether the vehicle is in a non-riding state where the vehicle is not on the inverted carriage 1. The boarding determination unit 431 notifies the control unit 433 of the determination result.

以下、乗車判定部431による判定の詳細について説明する。
乗車判定部431は、まず、少なくとも左足載置部21aにおける載置についての全ての検出位置(左足が載置されようとする領域に含まれる全ての検出位置)で足の載置を検出した場合、又は少なくとも右足載置部21bにおける載置についての全ての検出位置(右足が載置されようとする領域に含まれる全ての検出位置)で足の載置を検出した場合、乗車状態と判定し、それら以外の場合には非乗車状態と判定する。すなわち、乗車状態と判定されていない場合、乗車判定部431は、次のような判定を行う。なお、乗車状態と判定されていない場合とは、直近の乗車判定部431による判定が非乗車状態である場合のほか、乗車判定部431によりいずれの判定もなされていない状況の場合(すなわち、初期状態の場合)を含む。乗車状態と判定されていない場合、乗車判定部431は、左載置検出センサ22a、左載置検出センサ23a、右載置検出センサ22b、右載置検出センサ23bのうち、少なくとも左載置検出センサ22a及び左載置検出センサ23aが足検知信号を出力すると、乗車状態と判定する。また、乗車状態と判定されていない場合、乗車判定部431は、左載置検出センサ22a、左載置検出センサ23a、右載置検出センサ22b、右載置検出センサ23bのうち、少なくとも右載置検出センサ22b及び右載置検出センサ23bが足検知信号を出力すると、乗車状態と判定する。
Hereinafter, details of the determination by the boarding determination unit 431 will be described.
The boarding determination unit 431 first detects a foot placement at all detection positions (all detection positions included in a region where the left foot is to be placed) at least on the placement in the left foot placement portion 21a. Or at least all detection positions (all detection positions included in the region where the right foot is about to be placed) for placement in the right foot placement portion 21b, it is determined that the boarding state. In other cases, it is determined that the vehicle is not in the boarding state. That is, when it is not determined as a boarding state, the boarding determination part 431 performs the following determinations. In addition, the case where it is not determined as a boarding state is the case where any determination is not made by the boarding determination part 431 other than the case where the determination by the latest boarding determination part 431 is a non-boarding state (namely, initial stage) In case of condition). When the boarding state is not determined, the boarding determination unit 431 detects at least the left mounting detection among the left mounting detection sensor 22a, the left mounting detection sensor 23a, the right mounting detection sensor 22b, and the right mounting detection sensor 23b. When the sensor 22a and the left placement detection sensor 23a output the foot detection signal, the board 22 is determined to be in the boarding state. In addition, when it is not determined that the vehicle is in the boarding state, the boarding determination unit 431 includes at least the right mounting detection sensor 22a, the left mounting detection sensor 23a, the right mounting detection sensor 22b, and the right mounting detection sensor 23b. When the placement detection sensor 22b and the right placement detection sensor 23b output the foot detection signal, it is determined that the vehicle is in the riding state.

また、乗車判定部431は、乗車状態と判定後は、左足載置部21aにおける載置についての全ての検出位置で足の載置を検出せず、かつ、右足載置部21bにおける載置についての全ての検出位置で足の載置を検出しない場合に、非乗車状態へと判定を変更し、それ以外の場合には、乗車状態と判定する。すなわち、乗車判定部431は、直近の乗車判定部431による判定が乗車状態である場合、左載置検出センサ22a、左載置検出センサ23a、右載置検出センサ22b、右載置検出センサ23bの全てにおいて足検知信号が出力されなくなると、乗車判定を乗車状態から非乗車状態へと変更する。   In addition, the boarding determination unit 431 does not detect foot placement at all detection positions for placement in the left foot placement unit 21a and determines placement in the right foot placement unit 21b after determining the boarding state. When the placement of the foot is not detected at all of the detection positions, the determination is changed to the non-riding state, and otherwise, it is determined as the riding state. That is, when the latest determination by the boarding determination unit 431 is the boarding state, the boarding determination unit 431 has the left mounting detection sensor 22a, the left mounting detection sensor 23a, the right mounting detection sensor 22b, and the right mounting detection sensor 23b. When the foot detection signal is not output in all of the above, the boarding determination is changed from the boarding state to the non-boarding state.

図5は、乗車判定部431の上述の判定条件について具体的に示した表である。図5に示されるように、現在の判定、すなわち直近の乗車判定部431の判定において、乗車状態と判定されていない場合と、乗車状態と判定されている場合とで、異なる判定基準を用いて乗車判定が行われる。なお、以下の説明において、乗車状態と判定されていない場合に適用される判定基準(図5の上半分に対応する判定基準)を第1判定基準と言い、乗車状態と判定されている場合に適用される判定基準(図5の下半分に対応する判定基準)を第2判定基準と言うことがある。   FIG. 5 is a table specifically showing the above-described determination conditions of the boarding determination unit 431. As shown in FIG. 5, in the current determination, that is, the determination of the latest boarding determination unit 431, different determination criteria are used depending on whether the boarding state is not determined or the boarding state is determined. Boarding determination is performed. In the following description, a determination criterion (determination criterion corresponding to the upper half of FIG. 5) that is applied when it is not determined to be in the boarding state is referred to as a first determination criterion, and is determined to be in the riding state. The applied criterion (the criterion corresponding to the lower half of FIG. 5) may be referred to as the second criterion.

安定判定部432は、接地部30が地面に接することにより倒立台車1が自立している状態、すなわち静的な安定状態であるか否かを判定する。安定判定部432は、姿勢角度センサ41により検出された倒立台車1の姿勢角度に基づいて、安定状態であるか否かを判定する。具体的には、例えば、安定判定部432は、姿勢角度センサ41により検出された倒立台車1の姿勢角度が、接地部30が地面に接している場合の角度に相当する場合、倒立台車1が接地部30の接地による安定状態であると判定し、接地部30が地面に接している場合の角度に相当しない場合、倒立台車1が接地部30の接地による安定状態ではないと判定する。安定判定部432は、判定結果を制御部433に通知する。   The stability determination unit 432 determines whether or not the inverted cart 1 is in a self-supporting state when the grounding unit 30 is in contact with the ground, that is, a static stable state. The stability determination unit 432 determines whether or not the stable state is based on the posture angle of the inverted carriage 1 detected by the posture angle sensor 41. Specifically, for example, when the posture determination unit 432 detects the posture angle of the inverted carriage 1 detected by the posture angle sensor 41 corresponds to the angle when the grounding unit 30 is in contact with the ground, the stability determination unit 432 When it is determined that the grounding unit 30 is in a stable state due to grounding and does not correspond to the angle when the grounding unit 30 is in contact with the ground, it is determined that the inverted carriage 1 is not in a stable state due to grounding of the grounding unit 30. The stability determination unit 432 notifies the control unit 433 of the determination result.

なお、本実施の形態では、安定判定部432は、姿勢角度センサ41の検出結果に基づいて判定を行っているが、任意の他の方法により判定を行ってもよい。例えば、接地部30が地面に接することにより押下されるスイッチを接地部30に設け、このスイッチを用いて判定を行ってもよい。   In the present embodiment, the stability determination unit 432 performs the determination based on the detection result of the attitude angle sensor 41, but the determination may be performed by any other method. For example, a switch that is pressed when the grounding unit 30 is in contact with the ground may be provided in the grounding unit 30, and the determination may be performed using this switch.

制御部433は、倒立台車1に搭載された各種センサから出力される検出結果に基づいて、車輪11を駆動制御するための制御信号を生成し、駆動装置42に出力する。制御部433は、例えば、姿勢角度センサ41が出力した角度情報、車輪11の回転情報を検出する図示しない回転センサからの出力等に基づいて所定の演算処理を実行し、必要な制御信号を駆動装置42に対して出力する。制御部433は、車輪11の駆動を制御することで、例えば、倒立台車1の倒立状態を維持する制御(倒立制御)を実行する。なお、倒立制御は、制御部433による車輪の駆動制御の一つの態様である。   The control unit 433 generates a control signal for driving and controlling the wheels 11 based on detection results output from various sensors mounted on the inverted carriage 1 and outputs the control signal to the driving device 42. The control unit 433 executes predetermined arithmetic processing based on, for example, angle information output from the attitude angle sensor 41, output from a rotation sensor (not shown) that detects rotation information of the wheels 11, and drives necessary control signals. Output to the device 42. For example, the control unit 433 performs control (inverted control) to maintain the inverted state of the inverted carriage 1 by controlling the driving of the wheels 11. The inversion control is one aspect of wheel drive control by the control unit 433.

ただし、制御部433は、乗車判定部431により乗車状態と判定されている場合に、車輪11の駆動を制御する。すなわち、制御部433は、駆動装置42のサーボ制御をオンにする。また、制御部433は、乗車判定部431により乗車状態と判定され、かつ、安定判定部432により接地部30の接地による安定状態ではないと判定された場合に、倒立状態を維持する制御を行う。   However, the control unit 433 controls the driving of the wheels 11 when the boarding determination unit 431 determines that the vehicle is in the boarding state. That is, the control unit 433 turns on the servo control of the driving device 42. The control unit 433 performs control to maintain the inverted state when the boarding determination unit 431 determines that the vehicle is in the boarding state and the stability determination unit 432 determines that the grounding unit 30 is not in a stable state due to grounding. .

乗車判定部431により乗車状態と判定され、かつ、安定判定部432により接地部30の接地による安定状態であると判定されている場合には、制御部433は、車輪11が静止しつづけるよう駆動制御を行う。具体的には、例えば、制御部433は、車輪11の速度が0となるようサーボ制御を行う。これにより、倒立台車1が安定するので、搭乗者は、容易に倒立台車1への乗車動作を進めることができる。   When the boarding determination unit 431 determines that the vehicle is in the boarding state and the stability determination unit 432 determines that the grounding unit 30 is in a stable state, the control unit 433 drives the wheels 11 to remain stationary. Take control. Specifically, for example, the control unit 433 performs servo control so that the speed of the wheel 11 becomes zero. Thereby, since the inverted cart 1 is stabilized, the passenger can easily proceed with the riding operation on the inverted cart 1.

また、制御部433は、乗車判定部431により非乗車状態と判定された場合には、車輪11の駆動の制御を停止する。すなわち、制御部433は、駆動装置42のサーボ制御をオフにする。このため、制御部433が倒立制御を実行中であるときには、倒立制御が停止されることとなる。また、制御部433は、安定判定部432により接地部30の接地による安定状態であると判定された場合には、倒立制御を停止する。この場合、安定状態であると判定されない限り、倒立制御は停止されるものの車輪の駆動制御は継続する。このため、例えば、制御部433は、倒立制御を停止後、車輪11が静止しつづけるよう駆動制御する。   The control unit 433 stops the driving control of the wheels 11 when the boarding determination unit 431 determines that the vehicle is not in the boarding state. That is, the control unit 433 turns off the servo control of the drive device 42. For this reason, when the control unit 433 is executing the inversion control, the inversion control is stopped. The control unit 433 stops the inversion control when the stability determination unit 432 determines that the ground unit 30 is in a stable state due to the grounding. In this case, unless it is determined that the vehicle is in the stable state, the inversion control is stopped, but the wheel drive control is continued. For this reason, for example, the control unit 433 performs drive control so that the wheel 11 continues to be stationary after the inversion control is stopped.

制御部433は、乗車判定部431及び安定判定部432から、逐次、判定結果を取得して、上述の制御の切替を行う。   The control unit 433 sequentially acquires the determination results from the boarding determination unit 431 and the stability determination unit 432, and performs the above-described control switching.

次に、倒立台車1における動作についてフローチャートに基づいて説明する。まず、乗車判定部431による判定動作について、図6を参照して説明する。   Next, the operation in the inverted carriage 1 will be described based on a flowchart. First, the determination operation by the boarding determination unit 431 will be described with reference to FIG.

ステップ10(S10)において、左載置検出センサ22aが載置の有無を検出し、検出結果が乗車判定部431に入力される。
ステップ11(S11)において、左載置検出センサ23aが載置の有無を検出し、検出結果が乗車判定部431に入力される。
ステップ12(S12)において、右載置検出センサ22bが載置の有無を検出し、検出結果が乗車判定部431に入力される。
ステップ13(S13)において、右載置検出センサ23bが載置の有無を検出し、検出結果が乗車判定部431に入力される。
なお、ステップ10〜13の順序は、上記に限定されず、任意の順序で構わないし、これらが並行して行われてもよいことは言うまでもない。
In step 10 (S10), the left placement detection sensor 22a detects the presence or absence of placement, and the detection result is input to the boarding determination unit 431.
In step 11 (S11), the left placement detection sensor 23a detects the presence or absence of placement, and the detection result is input to the boarding determination unit 431.
In step 12 (S12), the right placement detection sensor 22b detects the presence or absence of placement, and the detection result is input to the boarding determination unit 431.
In step 13 (S13), the right placement detection sensor 23b detects the presence or absence of placement, and the detection result is input to the boarding determination unit 431.
It should be noted that the order of steps 10 to 13 is not limited to the above, and may be any order, and it goes without saying that these may be performed in parallel.

ステップ14(S14)において、乗車判定部431は、直近の乗車判定部431の判定において、乗車状態と判定されているか否かを確認する。乗車状態と判定されていない場合には、処理はステップ15に移行し、乗車状態と判定されている場合には、ステップ16に移行する。   In step 14 (S14), the boarding determination unit 431 checks whether or not the boarding state is determined in the latest boarding determination unit 431. If it is not determined to be in the boarding state, the process proceeds to step 15, and if it is determined to be in the boarding state, the process proceeds to step 16.

ステップ15(S15)において、乗車判定部431は、上述の第1判定基準を適用して、乗車判定を行う。すなわち、乗車判定部431は、少なくとも左足載置部21aにおける載置についての全ての検出位置で足の載置を検出した場合、又は少なくとも右足載置部21bにおける載置についての全ての検出位置で足の載置を検出した場合、乗車状態と判定し、それら以外の場合には、非乗車状態と判定する。
一方、ステップ16(S16)では、乗車判定部431は、上述の第2判定基準を適用して、乗車判定を行う。すなわち、乗車判定部431は、左足載置部21aにおける載置についての全ての検出位置で足の載置を検出せず、かつ、右足載置部21bにおける載置についての全ての検出位置で足の載置を検出しない場合に、非乗車状態へと判定を変更し、それ以外の場合には、乗車状態と判定する。
ステップ15又はステップ16による判定後は、処理が再びステップ10に戻り、判定処理が繰り返される。
In step 15 (S15), the boarding determination unit 431 performs boarding determination by applying the first determination criterion described above. In other words, the boarding determination unit 431 detects the placement of the foot at at least all detection positions for placement in the left foot placement portion 21a, or at least at all the detection positions for placement in the right foot placement portion 21b. When the placement of the foot is detected, it is determined as a boarding state, and otherwise, it is determined as a non-boarding state.
On the other hand, in step 16 (S16), the boarding determination unit 431 performs boarding determination by applying the second determination criterion described above. That is, the boarding determination unit 431 does not detect foot placement at all detection positions for placement in the left foot placement portion 21a, and does not detect foot placement at all detection positions for placement in the right foot placement portion 21b. In the case where no placement is detected, the determination is changed to the non-boarding state, and in other cases, the boarding state is determined.
After the determination in step 15 or step 16, the process returns to step 10 again, and the determination process is repeated.

次に、制御部433による制御について図7を参照して流れを説明する。
ステップ20(S20)において、制御部433は、乗車判定部431による乗車判定結果を取得し、乗車状態と判定されているか否かを確認する。なお、本段階では、まだ制御部433は、車輪11の駆動制御を行っていない。乗車判定部431により乗車状態と判定されている場合、処理はステップ21へ移行し、乗車判定部431により乗車状態と判定されていない場合、処理はステップ20に戻る。なお、このとき、乗車判定部431による判定結果は、第1判定基準にしたがって行われたものである。
Next, the flow of the control by the control unit 433 will be described with reference to FIG.
In step 20 (S20), the control unit 433 acquires the boarding determination result by the boarding determination unit 431, and checks whether the boarding state is determined. At this stage, the control unit 433 has not yet performed drive control of the wheels 11. If the boarding determination unit 431 determines that the boarding state is present, the process proceeds to step 21. If the boarding determination unit 431 does not determine the boarding state, the process returns to step 20. At this time, the determination result by the boarding determination unit 431 is performed in accordance with the first determination criterion.

ステップ21(S21)において、制御部433は、駆動装置42のサーボ制御をオンにし、車輪11の駆動制御を開始する。そして、制御部433は、車輪11が静止しつづけるよう駆動制御を行う。   In step 21 (S21), the control unit 433 turns on the servo control of the drive device 42 and starts the drive control of the wheels 11. And the control part 433 performs drive control so that the wheel 11 may continue still.

ステップ22(S22)において、制御部433は、乗車判定部431による乗車判定結果を取得し、乗車状態と判定されているか否かを確認する。乗車判定部431により乗車状態と判定されていない場合(非乗車状態と判定されいている場合)、処理はステップ23へ移行し、乗車判定部431により乗車状態と判定されている場合、処理はステップ24へ移行する。なお、このとき、乗車判定部431による判定結果は、第2判定基準にしたがって行われたものである。
ステップ23(S23)において、制御部433は、駆動装置42のサーボ制御をオフし、車輪11の駆動制御を停止する。処理はステップ20に戻る。
In step 22 (S22), the control unit 433 acquires the boarding determination result by the boarding determination unit 431, and confirms whether the boarding state is determined. If the boarding determination unit 431 does not determine the boarding state (when the boarding determination unit 431 determines that the boarding state is not), the process proceeds to step 23. If the boarding determination unit 431 determines the boarding state, the process proceeds to step 23. 24. At this time, the determination result by the boarding determination unit 431 is performed according to the second determination criterion.
In step 23 (S23), the control unit 433 turns off the servo control of the drive device 42 and stops the drive control of the wheels 11. The process returns to step 20.

ステップ24(S24)において、制御部433は、安定判定部432による判定結果を取得し、接地部30の接地による安定状態であるか否かを確認する。安定判定部432による判定が接地部30の接地による安定状態ではないという判定である場合、処理はステップ25へ移行する。また、安定判定部432による判定が接地部30の接地による安定状態であるという判定である場合、処理はステップ22へと戻る。   In step 24 (S24), the control unit 433 acquires the determination result by the stability determination unit 432 and confirms whether or not the grounding unit 30 is in a stable state due to the grounding. If the determination by the stability determination unit 432 is a determination that the grounding unit 30 is not in a stable state due to grounding, the process proceeds to step 25. If the determination by the stability determination unit 432 is a determination that the grounding unit 30 is in a stable state due to grounding, the process returns to step 22.

ステップ25(S25)において、制御部433は、倒立状態を維持する制御を開始する。倒立制御を開始後、制御部433は、逐次、乗車判定部431による判定結果及び安定判定部432の判定結果を取得し、制御の切り替えが必要であるかを確認する。具体的には、以下の動作となる。   In step 25 (S25), the control unit 433 starts control for maintaining the inverted state. After starting the inversion control, the control unit 433 sequentially acquires the determination result by the boarding determination unit 431 and the determination result of the stability determination unit 432, and confirms whether or not control switching is necessary. Specifically, the following operation is performed.

ステップ26(S26)において、制御部433は、乗車判定部431による乗車判定結果を取得し、乗車状態と判定されているか否かを確認する。乗車判定部431により乗車状態と判定されている場合、処理はステップ27へ移行する。乗車判定部431により乗車状態と判定されていない場合、処理はステップ23へ移行し、制御部433は、車輪11の駆動制御を停止する。このため、倒立制御も停止する。なお、このとき、乗車判定部431による判定結果は、第2判定基準にしたがって行われたものである。   In step 26 (S26), the control unit 433 acquires the boarding determination result by the boarding determination unit 431, and confirms whether the boarding state is determined. If the boarding determination unit 431 determines that the boarding state is present, the process proceeds to step 27. When the boarding determination part 431 does not determine with the boarding state, a process transfers to step 23 and the control part 433 stops the drive control of the wheel 11. FIG. For this reason, the inversion control is also stopped. At this time, the determination result by the boarding determination unit 431 is performed according to the second determination criterion.

ステップ27(S27)において、制御部433は、安定判定部432による判定結果を取得し、接地部30の接地による安定状態であるか否かを確認する。安定判定部432による判定が接地部30の接地による安定状態ではないという判定である場合、処理はステップ26へ戻る。このため、倒立制御は継続される。これに対し、安定判定部432による判定が接地部30の接地による安定状態であるという判定である場合、処理はステップ28へ移行する。   In step 27 (S27), the control unit 433 acquires the determination result by the stability determination unit 432, and confirms whether or not the grounding unit 30 is in a stable state due to grounding. If the determination by the stability determination unit 432 is a determination that the grounding unit 30 is not in a stable state due to grounding, the process returns to step 26. For this reason, the inversion control is continued. On the other hand, if the determination by the stability determination unit 432 is a determination that the grounding unit 30 is in a stable state due to grounding, the process proceeds to step 28.

ステップ28(S28)において、制御部433は、倒立制御を停止し、処理はステップ22に戻る。なお、このとき、制御部433は、駆動装置42のサーボ制御はオンのままである。   In step 28 (S28), the control unit 433 stops the inversion control, and the process returns to step 22. At this time, the control unit 433 keeps the servo control of the driving device 42 on.

倒立台車の制御に関し、発明者は以下のことを見出した。
搭乗者が乗車する前の段階では、倒立台車の動力が切れた状態が好ましい。なぜならば、搭乗者が乗車する前の段階で、倒立台車が例えば倒立制御を行っていると、倒立台車1の移動が、搭乗者にとって不用意な動きとなりうるからである。このため、搭乗者が乗車する前の段階では、倒立台車1の動力が切れた状態が搭乗者の利便性を向上する。また、片足の一部だけが搭乗台20に載置された状況は、搭乗者がバランスを失った状態であることが想定される。このような状況下で、倒立台車1が搭乗者にとって不用意な動きをした場合、搭乗者は当該動きに対応することが困難である。このため、このような状況下においても、倒立台車1の動力が切れた状態が好ましい。なお、リハビリテーション中の人などのように、意図した場所に足を載置することが難しい場合には、倒立台車に期待される上述の動作はより重要性を増す。
Regarding the control of the inverted cart, the inventor has found the following.
In a stage before the passenger gets on, it is preferable that the power of the inverted carriage is cut off. This is because the movement of the inverted carriage 1 may cause an unintentional movement for the passenger if the inverted carriage performs, for example, an inverted control before the passenger gets on. For this reason, in the stage before a passenger gets in, the state in which the power of the inverted cart 1 was cut off improves the convenience for the passenger. In addition, it is assumed that the situation where only a part of one foot is placed on the boarding base 20 is a state in which the passenger loses balance. Under such circumstances, when the inverted cart 1 makes a careless movement for the passenger, it is difficult for the passenger to respond to the movement. For this reason, even in such a situation, it is preferable that the power of the inverted carriage 1 is cut off. In addition, when it is difficult to place a foot on an intended place such as a person during rehabilitation, the above-described operation expected for an inverted cart becomes more important.

一方、搭乗者が乗車し、倒立台車1の動力がオンになった状況下では、動力をオフにすることが、搭乗者にとって不用意な動きとなりうる。例えば、倒立制御中の倒立台車1に乗車した搭乗者の足の載置が上述のように片足の一部だけとなった場合であっても、その段階で倒立制御を停止するよりも、倒立制御を継続して倒立台車1が動的な安定状態を保ったほうが、搭乗者にとって好ましい。   On the other hand, in a situation where the passenger gets on and the power of the inverted carriage 1 is turned on, turning off the power can be an inadvertent movement for the passenger. For example, even when the foot of the passenger who has boarded the inverted carriage 1 during the inversion control is only part of one leg as described above, the inversion control is stopped rather than stopping the inversion control at that stage. It is preferable for the passenger to continue the control and keep the inverted carriage 1 in a dynamic stable state.

ここで、倒立台車1では、上述の通り、次のような制御を行う。少なくとも一方の足が確実に載置されるまでは、倒立台車1は車輪の駆動制御を行わない。このため、乗車前に、倒立台車1が不用意な動作をすることが低減される。また、少なくとも一方の足が確実に載置された後は、全ての載置検出位置で足の載置が検出できなくなるまで、倒立台車1の駆動制御が継続されることとなる。このため、倒立台車1によれば、利便性が向上する。   Here, as described above, the inverted cart 1 performs the following control. The inverted carriage 1 does not perform wheel drive control until at least one of the legs is securely placed. For this reason, it is possible to reduce the inadvertent operation of the inverted carriage 1 before boarding. In addition, after at least one of the feet is reliably placed, the drive control of the inverted carriage 1 is continued until the placement of the feet cannot be detected at all placement detection positions. For this reason, according to the inverted cart 1, the convenience is improved.

実施の形態2.
次に、実施の形態2にかかる倒立台車1について説明する。実施の形態1では、倒立台車1は、乗車判定部431により乗車状態と判定され、かつ、安定判定部432により接地部30の接地による安定状態ではないと判定された場合に、制御部433は倒立制御を開始した。本実施の形態にかかる制御部433は、接地による安定状態であるか否かにかかわらず、乗車判定部431により乗車状態と判定された時点で、倒立制御を開始する点で、実施の形態1と異なる。
Embodiment 2. FIG.
Next, the inverted carriage 1 according to the second embodiment will be described. In the first embodiment, when the inverted carriage 1 is determined to be in the boarding state by the boarding determination unit 431 and is determined not to be in a stable state due to the grounding of the grounding unit 30 by the stability determination unit 432, the control unit 433 is Inverted control started. The control unit 433 according to the present embodiment is the point that the inversion control is started when the boarding determination unit 431 determines the boarding state regardless of whether or not the stable state is due to the grounding. And different.

図8は、実施の形態2にかかる倒立台車1の機能構成を示すブロック図である。図8に示されるように、本実施の形態にかかる制御装置53は、実施の形態1に比べ、安定判定部432が省略され、制御部433が制御部533に置き換わっている。制御部433は、乗車判定部431及び安定判定部432の判定結果に基づいて制御を切替えていたのに対し、制御部533は、乗車判定部431の判定結果に基づいて制御を切替える点で異なるが、制御部533の他の構成については制御部433と同様である。   FIG. 8 is a block diagram illustrating a functional configuration of the inverted carriage 1 according to the second embodiment. As shown in FIG. 8, in the control device 53 according to the present embodiment, the stability determination unit 432 is omitted and the control unit 433 is replaced with a control unit 533 as compared with the first embodiment. The control unit 433 is different in that control is switched based on the determination result of the boarding determination unit 431, whereas the control unit 433 is switched based on the determination result of the boarding determination unit 431 and the stability determination unit 432. However, other configurations of the control unit 533 are the same as those of the control unit 433.

以下、本実施の形態にかかる制御部533の制御について説明する。図9は、実施の形態2にかかる制御部533の動作の一例を示すフローチャートである。   Hereinafter, control of the control unit 533 according to the present embodiment will be described. FIG. 9 is a flowchart illustrating an example of the operation of the control unit 533 according to the second embodiment.

本実施の形態にかかる制御部533は、図7に示した動作に代えて、例えば、以下のように動作する。
ステップ30(S30)において、制御部533は、乗車判定部431による乗車判定結果を取得し、乗車状態と判定されているか否かを確認する。なお、本段階では、まだ制御部533は、倒立制御を行っていない。乗車判定部431により乗車状態と判定されている場合、処理はステップ31へ移行し、乗車判定部431により乗車状態と判定されていない場合、処理はステップ30に戻る。なお、このとき、乗車判定部431による判定結果は、第1判定基準にしたがって行われたものである。
For example, the control unit 533 according to the present embodiment operates as follows instead of the operation illustrated in FIG.
In step 30 (S30), the control unit 533 acquires the boarding determination result by the boarding determination unit 431, and confirms whether the boarding state is determined. At this stage, the control unit 533 has not yet performed the inversion control. If the boarding determination unit 431 determines that the boarding state is present, the process proceeds to step 31. If the boarding determination unit 431 does not determine the boarding state, the process returns to step 30. At this time, the determination result by the boarding determination unit 431 is performed in accordance with the first determination criterion.

ステップ31(S31)において、制御部533は、倒立制御を開始する。具体的には、制御部533は駆動装置42のサーボ制御をオンにするとともに、倒立制御を開始する。   In step 31 (S31), the control unit 533 starts the inversion control. Specifically, the control unit 533 turns on the servo control of the driving device 42 and starts the inversion control.

ステップ32(S22)において、制御部533は、乗車判定部431による乗車判定結果を取得し、乗車状態と判定されているか否かを確認する。乗車判定部431により乗車状態と判定されていない場合(非乗車状態と判定されいている場合)、処理はステップ33へ移行し、乗車判定部431により乗車状態と判定されている場合、処理はステップ32へ戻る。このように、倒立制御中は、逐次、乗車状態か否かが確認され、乗車状態である限り、倒立制御は継続される。なお、このとき、乗車判定部431による判定結果は、第2判定基準にしたがって行われたものである。   In step 32 (S22), the control unit 533 acquires the boarding determination result by the boarding determination unit 431, and confirms whether or not the boarding state is determined. If the boarding determination unit 431 does not determine the boarding state (when the boarding determination unit 431 determines that the boarding state is not), the process proceeds to step 33. Return to 32. In this way, during the inversion control, it is sequentially confirmed whether or not it is in the boarding state, and the inversion control is continued as long as it is in the boarding state. At this time, the determination result by the boarding determination unit 431 is performed according to the second determination criterion.

ステップ33(S33)において、制御部533は、倒立制御を停止する。具体的には、制御部533は、車輪11の駆動制御を停止するとともに駆動装置42のサーボ制御をオフする。そして、ステップ33の後、処理はステップ30に戻る。   In step 33 (S33), the control unit 533 stops the inversion control. Specifically, the control unit 533 stops the drive control of the wheel 11 and turns off the servo control of the drive device 42. After step 33, the process returns to step 30.

本実施の形態によれば、乗車判定がなされた時点で倒立制御が行われるので、より簡便な手順で倒立制御を開始することができる。また、本実施の形態では、接地部30及び安定判定部432を省略してもよく、実施の形態1に比べ構成を簡単化することができる。   According to the present embodiment, since the inversion control is performed when the boarding determination is made, the inversion control can be started with a simpler procedure. Further, in the present embodiment, the grounding unit 30 and the stability determining unit 432 may be omitted, and the configuration can be simplified as compared with the first embodiment.

以上、本発明の実施の形態について説明したが、本発明は上記実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。例えば、上記の実施形態では、左足の載置を検出するセンサ及び右足の載置を検出するセンサは、それぞれ2つとしが、各足の載置を検出するセンサは複数設けられていればよく、3以上であってもよい。また、左足の載置を検出するセンサの数と、右足の載置を検出するセンサの数が異なっていてもよい。また、センサの検出位置も、足が載置される範囲の任意の位置に設定してもよい。   Although the embodiments of the present invention have been described above, the present invention is not limited to the above-described embodiments, and can be modified as appropriate without departing from the spirit of the present invention. For example, in the above embodiment, the number of sensors for detecting the placement of the left foot and the number of sensors for detecting the placement of the right foot are two, but a plurality of sensors for detecting the placement of each foot may be provided. It may be 3 or more. Further, the number of sensors that detect the placement of the left foot may differ from the number of sensors that detect the placement of the right foot. Also, the detection position of the sensor may be set to any position within the range where the foot is placed.

また、実施の形態1では、接地部が地面に接触していないことを、倒立制御を実施する上での要件としたが、これに限らず、他の条件を要件としてもよい。例えば、倒立制御を指示するためのボタンの押下など、倒立制御開始を指示する操作がユーザインタフェースを介してなされたことを要件としてもよい。   In the first embodiment, the fact that the grounding portion is not in contact with the ground is a requirement for performing the inversion control. However, the present invention is not limited to this, and other conditions may be required. For example, it may be a requirement that an operation for instructing the start of the inverted control, such as pressing a button for instructing the inverted control, is performed via the user interface.

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

プログラムは、様々なタイプの非一時的なコンピュータ可読媒体(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 倒立台車
10 台車
11 車輪
20 搭乗台
21a 左足載置部
21b 右足載置部
22a 左載置検出センサ
22b 右載置検出センサ
23a 左載置検出センサ
23b 右載置検出センサ
30 接地部
41 姿勢角度センサ
42 駆動装置
43、53 制御装置
431 乗車判定部
432 安定判定部
433、533 制御部
DESCRIPTION OF SYMBOLS 1 Inverted bogie 10 Bogie 11 Wheel 20 Boarding board 21a Left foot mounting part 21b Right foot mounting part 22a Left mounting detection sensor 22b Right mounting detection sensor 23a Left mounting detection sensor 23b Right mounting detection sensor 30 Grounding part 41 Attitude angle Sensor 42 Drive device 43, 53 Control device 431 Boarding determination unit 432 Stability determination unit 433, 533 Control unit

Claims (9)

車輪の駆動により倒立状態を維持する倒立台車であって、
搭乗者の一方の足を載置可能な第1載置部と、
前記一方の足の載置を、前記第1載置部の複数の位置で検出する第1検出手段と、
前記搭乗者の他方の足を載置可能な第2載置部と、
前記他方の足の載置を、前記第2載置部の複数の位置で検出する第2検出手段と、
前記搭乗者の乗車判定を行う乗車判定手段と、
前記乗車判定手段により乗車状態と判定されている場合に、前記車輪の駆動を制御する制御手段と、
を有し、
前記乗車判定手段は、乗車状態と判定していないときに、少なくとも前記第1検出手段が前記一方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出した場合、又は少なくとも前記第2検出手段が前記他方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出した場合、乗車状態と判定し、乗車状態と判定後は、前記第1検出手段が全ての検出位置で載置を検出せず、かつ、前記第2検出手段が全ての検出位置で載置を検出しない場合に非乗車状態へと判定を変更する
倒立台車。
An inverted cart that maintains an inverted state by driving wheels,
A first placement section capable of placing one of the passenger's feet;
First detection means for detecting placement of the one foot at a plurality of positions of the first placement unit;
A second placement portion capable of placing the other leg of the passenger;
Second detection means for detecting the placement of the other foot at a plurality of positions of the second placement portion;
Boarding determination means for determining boarding of the passenger;
Control means for controlling driving of the wheels when the boarding determination means determines that the boarding state;
Have
When the boarding determination means does not determine the boarding state, at least when the first detection means detects placement at all detection positions included in the region where the one foot is to be placed, Alternatively, when at least the second detection means detects placement at all detection positions included in the region where the other foot is to be placed, it is determined as a riding state, and after the determination as a riding state, An inverted cart that changes the determination to the non-riding state when the first detection means does not detect placement at all detection positions and the second detection means does not detect placement at all detection positions.
前記制御手段は、前記乗車判定手段により乗車状態と判定されている場合に、倒立状態を維持する制御を行う
請求項1に記載の倒立台車。
The inverted carriage according to claim 1, wherein the control means performs control to maintain an inverted state when the boarding determination means determines that the boarding state is present.
地面と接することにより前記倒立台車を安定させる接地部と、
前記接地部による安定状態であるか否かを判定する安定判定手段と
をさらに有し、
前記制御手段は、前記乗車判定手段により乗車状態と判定され、かつ、前記安定判定手段により前記接地部による安定状態ではないと判定された場合に、倒立状態を維持する制御を行う
請求項2に記載の倒立台車。
A grounding portion that stabilizes the inverted carriage by contacting the ground;
And a stability determination means for determining whether or not the grounding portion is in a stable state,
The control unit performs control to maintain an inverted state when the boarding determination unit determines that the vehicle is in a boarding state and the stability determination unit determines that the boarding state is not a stable state by the grounding unit. The inverted trolley described.
前記第1検出手段は、前記一方の足の前方部分の前記第1載置部への載置を検出する第1検出センサと、前記一方の足の後方部分の前記第1載置部への載置を検出する第2検出センサとにより載置を検出し、
前記第2検出手段は、前記他方の足の前方部分の前記第2載置部への載置を検出する第3検出センサと、前記他方の足の後方部分の前記第2載置部への載置を検出する第4検出センサとにより載置を検出する
請求項1乃至3のいずれか一項に記載の倒立台車。
The first detection means includes: a first detection sensor that detects placement of a front portion of the one foot on the first placement portion; and a rear portion of the one foot on the first placement portion. The placement is detected by the second detection sensor that detects the placement,
The second detection means includes a third detection sensor that detects placement of the front portion of the other foot on the second placement portion, and a second portion of the rear portion of the other foot to the second placement portion. The inverted carriage according to any one of claims 1 to 3, wherein the placement is detected by a fourth detection sensor that detects the placement.
搭乗者の一方の足を載置可能な第1載置部と、前記搭乗者の他方の足を載置可能な第2載置部とを備え、車輪の駆動により倒立状態を維持する倒立台車の制御方法であって、
前記一方の足の載置を、前記第1載置部の複数の位置で検出するステップと、
前記他方の足の載置を、前記第2載置部の複数の位置で検出するステップと、
前記搭乗者の乗車判定を行うステップと、
乗車状態と判定されている場合に、前記車輪の駆動を制御するステップと
を有し、
前記乗車判定を行うステップは、乗車状態と判定していないときに、少なくとも前記第1載置部の前記一方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出したとき、又は少なくとも前記第2載置部の前記他方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出した場合、乗車状態と判定し、乗車状態と判定後は、前記第1載置部の全ての検出位置で載置を検出せず、かつ、前記第2載置部の全ての検出位置で載置を検出しない場合に非乗車状態へと判定を変更する
倒立台車の制御方法。
An inverted trolley comprising a first placement part capable of placing one leg of a passenger and a second placement part capable of placing the other leg of the passenger, and maintaining an inverted state by driving a wheel Control method,
Detecting the placement of the one foot at a plurality of positions of the first placement unit;
Detecting the placement of the other foot at a plurality of positions of the second placement portion;
Performing the ride determination of the passenger;
When it is determined that the vehicle is in a boarding state,
In the step of determining whether to get on the vehicle, when it is not determined that the vehicle is in the boarding state, at least all the detection positions included in the region where the one foot of the first mounting unit is to be mounted are detected. Or when at least all the detection positions included in the region where the other foot of the second placement portion is to be placed are detected, the boarding state is determined, and the boarding state is determined. Changes the determination to the non-riding state when no placement is detected at all detection positions of the first placement section and no placement is detected at all detection positions of the second placement section. Yes How to control an inverted cart.
前記車輪の駆動を制御するステップは、前記乗車判定を行うステップで乗車状態と判定されている場合に、倒立状態を維持する制御を行う
請求項5に記載の倒立台車の制御方法。
The method for controlling an inverted carriage according to claim 5, wherein the step of controlling the driving of the wheels performs a control to maintain the inverted state when it is determined that the vehicle is in the boarding state in the step of determining the boarding.
地面と接することにより前記倒立台車を安定させる接地部による安定状態であるか否かを判定するステップをさらに有し、
前記車輪の駆動を制御するステップは、前記乗車判定を行うステップで乗車状態と判定され、かつ、前記安定状態であるか否かを判定するステップで前記接地部による安定状態ではないと判定された場合に、倒立状態を維持する制御を行う
請求項6に記載の倒立台車の制御方法。
Further comprising the step of determining whether or not it is in a stable state by a grounding unit that stabilizes the inverted carriage by contacting the ground,
The step of controlling the driving of the wheels is determined to be a boarding state in the step of determining the boarding, and is determined not to be a stable state by the grounding unit in the step of determining whether or not the state is the stable state. The control method of the inverted cart according to claim 6, wherein control for maintaining the inverted state is performed.
前記第1載置部の複数の位置で検出するステップは、前記一方の足の前方部分の前記第1載置部への載置を検出する第1検出センサと、前記一方の足の後方部分の前記第1載置部への載置を検出する第2検出センサとにより載置を検出し、
前記第2載置部の複数の位置で検出するステップは、前記他方の足の前方部分の前記第2載置部への載置を検出する第3検出センサと、前記他方の足の後方部分の前記第2載置部への載置を検出する第4検出センサとにより載置を検出する
請求項5乃至7のいずれか一項に記載の倒立台車の制御方法。
The step of detecting at a plurality of positions of the first placement portion includes a first detection sensor for detecting placement of a front portion of the one foot on the first placement portion, and a rear portion of the one foot. Detecting the placement by the second detection sensor for detecting the placement on the first placement portion,
The step of detecting at a plurality of positions of the second placement portion includes a third detection sensor for detecting placement of a front portion of the other foot on the second placement portion, and a rear portion of the other foot. The method for controlling the inverted carriage according to any one of claims 5 to 7, wherein the placement is detected by a fourth detection sensor that detects placement on the second placement portion.
搭乗者の一方の足を載置可能な第1載置部と、前記搭乗者の他方の足を載置可能な第2載置部とを備え、車輪の駆動により倒立状態を維持する倒立台車のコンピュータに、
前記一方の足の載置を、前記第1載置部の複数の位置で検出するステップと、
前記他方の足の載置を、前記第2載置部の複数の位置で検出するステップと、
前記搭乗者の乗車判定を行うステップと、
乗車状態と判定されている場合に、前記車輪の駆動を制御するステップと
を実行させ、
前記乗車判定を行うステップは、乗車状態と判定していないときに、少なくとも前記第1載置部の前記一方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出したとき、又は少なくとも前記第2載置部の前記他方の足が載置されようとする領域に含まれる全ての検出位置で載置を検出した場合、乗車状態と判定し、乗車状態と判定後は、前記第1載置部の全ての検出位置で載置を検出せず、かつ、前記第2載置部の全ての検出位置で載置を検出しない場合に非乗車状態へと判定を変更する
プログラム。
An inverted trolley comprising a first placement part capable of placing one leg of a passenger and a second placement part capable of placing the other leg of the passenger, and maintaining an inverted state by driving a wheel On the computer
Detecting the placement of the one foot at a plurality of positions of the first placement unit;
Detecting the placement of the other foot at a plurality of positions of the second placement portion;
Performing the ride determination of the passenger;
When it is determined that the vehicle is in a boarding state, the step of controlling the driving of the wheels is executed,
In the step of determining whether to get on the vehicle, when it is not determined that the vehicle is in the boarding state, at least all the detection positions included in the region where the one foot of the first mounting unit is to be mounted are detected. Or when at least all the detection positions included in the region where the other foot of the second placement portion is to be placed are detected, the boarding state is determined, and the boarding state is determined. Changes the determination to the non-riding state when no placement is detected at all detection positions of the first placement section and no placement is detected at all detection positions of the second placement section. Program.
JP2014256109A 2014-12-18 2014-12-18 Inverted cart, control method and program for inverted cart Active JP6256327B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2014256109A JP6256327B2 (en) 2014-12-18 2014-12-18 Inverted cart, control method and program for inverted cart

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2014256109A JP6256327B2 (en) 2014-12-18 2014-12-18 Inverted cart, control method and program for inverted cart

Publications (2)

Publication Number Publication Date
JP2016113133A true JP2016113133A (en) 2016-06-23
JP6256327B2 JP6256327B2 (en) 2018-01-10

Family

ID=56139670

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2014256109A Active JP6256327B2 (en) 2014-12-18 2014-12-18 Inverted cart, control method and program for inverted cart

Country Status (1)

Country Link
JP (1) JP6256327B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4346049B2 (en) 1999-01-11 2009-10-14 本田技研工業株式会社 Engine with valve pause function

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009101760A (en) * 2007-10-22 2009-05-14 Toyota Motor Corp Coaxial two wheeled vehicle and its control method
JP2011162192A (en) * 2011-04-21 2011-08-25 Toyota Motor Corp Traveling device and control method thereof
JP2012020735A (en) * 2011-08-31 2012-02-02 Toyota Motor Corp Running device and method for controlling the same
JP2014088054A (en) * 2012-10-29 2014-05-15 Toyota Motor Corp Inverted mobile entity and control method thereof
JP2014213724A (en) * 2013-04-25 2014-11-17 トヨタ自動車株式会社 Movable body, control method for movable body, and control program for movable body

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009101760A (en) * 2007-10-22 2009-05-14 Toyota Motor Corp Coaxial two wheeled vehicle and its control method
JP2011162192A (en) * 2011-04-21 2011-08-25 Toyota Motor Corp Traveling device and control method thereof
JP2012020735A (en) * 2011-08-31 2012-02-02 Toyota Motor Corp Running device and method for controlling the same
JP2014088054A (en) * 2012-10-29 2014-05-15 Toyota Motor Corp Inverted mobile entity and control method thereof
JP2014213724A (en) * 2013-04-25 2014-11-17 トヨタ自動車株式会社 Movable body, control method for movable body, and control program for movable body

Also Published As

Publication number Publication date
JP6256327B2 (en) 2018-01-10

Similar Documents

Publication Publication Date Title
US20180001946A1 (en) Robot and method for use of robot
JP5293900B2 (en) Inverted moving body and method of getting on and off
JP6032119B2 (en) Inverted moving body and control method thereof
JP6256327B2 (en) Inverted cart, control method and program for inverted cart
CN111686420B (en) Balance training device and computer readable medium
US8949010B2 (en) Inverted pendulum type vehicle
CN113244587B (en) Balance training system, control method thereof, and computer-readable storage medium storing control program
JP2017169861A (en) Assist device and assist method
CN114073843B (en) Balance training system, control method thereof, and computer-readable storage medium storing control program
CN113244570B (en) Balance training system, control method thereof, and computer-readable storage medium storing control program
US9701358B2 (en) Inverted moving body
JP5861651B2 (en) MOBILE DEVICE, MOBILE DEVICE CONTROL METHOD, AND PROGRAM
US20140297124A1 (en) Inverted pendulum type vehicle
JP6217256B2 (en) Inverted moving body
JP6237567B2 (en) Inverted moving body
JP6233265B2 (en) Inverted two-wheeled mobile system
JP6179393B2 (en) Walking training system
JP6287807B2 (en) Inverted moving body and control method thereof
JP6090077B2 (en) Inverted moving body
JP3359022B2 (en) Cargo handling vehicle
JP6277964B2 (en) Inverted moving body control system and inverted moving body control method
JP5966882B2 (en) MOBILE BODY CONTROL DEVICE, MOBILE BODY CONTROL METHOD, AND PROGRAM
JP2017047010A (en) Inverted movable body
JP2016078719A (en) Inverted moving body
JP2015128928A (en) Inverted movable body

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20170123

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20170920

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20170926

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20171016

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20171120

R151 Written notification of patent or utility model registration

Ref document number: 6256327

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151