[go: up one dir, main page]

JP2013099972A - Inverted mobile, control method thereof, and program - Google Patents

Inverted mobile, control method thereof, and program Download PDF

Info

Publication number
JP2013099972A
JP2013099972A JP2011243457A JP2011243457A JP2013099972A JP 2013099972 A JP2013099972 A JP 2013099972A JP 2011243457 A JP2011243457 A JP 2011243457A JP 2011243457 A JP2011243457 A JP 2011243457A JP 2013099972 A JP2013099972 A JP 2013099972A
Authority
JP
Japan
Prior art keywords
inverted
state
torque
riding section
control
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP2011243457A
Other languages
Japanese (ja)
Inventor
Yoshiyuki Senba
快之 仙波
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 JP2011243457A priority Critical patent/JP2013099972A/en
Publication of JP2013099972A publication Critical patent/JP2013099972A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Motorcycle And Bicycle Frame (AREA)

Abstract

【課題】急減速を行った場合でも限られた駆動力でその安全性を維持すること。
【解決手段】倒立型移動体は、倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う。また、倒立型移動体は、搭乗部が後傾斜して減速する傾斜状態を水平な倒立安定状態に戻すための駆動トルクを算出するトルク算出手段と、搭乗部が後傾斜して減速する傾斜状態にあり、かつトルク算出手段により算出された駆動トルクが所定トルク以上である不安定状態にあるか否かを判定する判定手段と、判定手段により不安定状態と判定されたとき、車輪を停止する制御を行う制御手段と、を備えている。
【選択図】図2
Even when sudden deceleration is performed, the safety is maintained with a limited driving force.
An inverted mobile object performs a desired traveling according to the inclination of a riding section on which a passenger rides while maintaining an inverted state. The inverted moving body includes a torque calculating means for calculating a driving torque for returning the inclined state where the riding section is inclined backward and decelerated to a horizontal inverted stable state, and the inclined state where the riding section is inclined backward and decelerated. And determining means for determining whether or not the driving torque calculated by the torque calculating means is in an unstable state where the driving torque is equal to or greater than a predetermined torque, and when the determining means determines that the driving torque is unstable, the wheel is stopped. Control means for performing control.
[Selection] Figure 2

Description

本発明は、倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う倒立型移動体、その制御方法及びプログラムに関するものである。   The present invention relates to an inverted moving body that performs a desired traveling in accordance with the inclination of a riding section on which a passenger rides while maintaining an inverted state, a control method thereof, and a program.

倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて、加減速、停止などの所望の走行を行う倒立型移動体が知られている(例えば、特許文献1参照)。このような倒立型移動体において、例えば、搭乗者の急激な減速動作などを行った場合でも、安全に停止あるいは走行継続することが求められる。   2. Description of the Related Art An inverted moving body is known that performs desired traveling such as acceleration / deceleration and stop according to the inclination of a riding section on which a passenger is boarded while maintaining an inverted state (see, for example, Patent Document 1). In such an inverted mobile body, for example, even when the passenger performs a sudden deceleration operation, it is required to stop or continue traveling safely.

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

ところで、搭乗部を後傾斜して減速後に倒立状態を維持するために必要な駆動トルクは、その減速が大きいほど後傾斜が大きくなるため、大出力トルクの駆動部が必要となる。この駆動部の出力トルクが足りない場合、後傾斜状態から水平な倒立安定状態に戻すことができず倒立制御が不能となり安全性の低下を招くこととなる。また、人が搭乗する倒立型移動体においては、搭乗者の減速動作によってその姿勢が異なる為、減速の大きさを推測することは困難である。そのため、例えば、過剰な出力トルクの駆動部を搭載することとなり、大型化、重量増加、高コスト化を招く要因となっている。   By the way, the driving torque necessary to tilt the riding section backward and maintain the inverted state after deceleration requires a large output torque driving section because the rear inclination increases as the deceleration increases. If the output torque of the drive unit is insufficient, the horizontal tilting stable state cannot be restored from the rear tilt state, and the inversion control becomes impossible, resulting in a decrease in safety. In addition, in an inverted type moving body on which a person rides, since the posture differs depending on the deceleration operation of the passenger, it is difficult to estimate the magnitude of the deceleration. For this reason, for example, a drive unit having an excessive output torque is mounted, which is a factor in increasing the size, weight, and cost.

本発明は、このような問題点を解決するためになされたものであり、急減速を行った場合でも限られた駆動力でその安全性を維持できる倒立型移動体、その制御方法及びプログラムを提供することを主たる目的とする。   The present invention has been made in order to solve such problems, and an inverted moving body capable of maintaining its safety with a limited driving force even when sudden deceleration is performed, and a control method and program thereof are provided. The main purpose is to provide.

上記目的を達成するための本発明の一態様は、倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う倒立型移動体であって、前記搭乗部が後傾斜して減速する傾斜状態を水平な倒立安定状態に戻すための駆動トルクを算出するトルク算出手段と、前記搭乗部が後傾斜して減速する傾斜状態にあり、かつ前記トルク算出手段により算出された駆動トルクが所定トルク以上である不安定状態にあるか否かを判定する判定手段と、前記判定手段により前記不安定状態と判定されたとき、車輪を停止する制御を行う制御手段と、を備える、ことを特徴とする倒立型移動体。
この一態様において、前記判定手段により、前記搭乗部が後傾斜して減速する傾斜状態で移動速度が所定速度以下であり、かつ、前記トルク算出手段により算出された駆動トルクが所定トルク以上である不安定状態と判定されたとき、前記制御手段は前記車輪を停止する制御を行ってもよい。
この一態様において、前記制御手段は、前記トルク算出手段により算出された駆動トルクが所定トルク未満となるとき、前記倒立状態を維持するための倒立制御を継続してもよい。
この一態様において、前記搭乗部の傾斜角速度を検出するジャイロセンサと、前記搭乗部の加速度を検出する加速度センサと、前記車輪の回転情報を検出する回転センサと、を更に備え、前記判定手段は、前記ジャイロセンサにより検出された前記傾斜角速度と、前記加速度センサにより検出された前記加速度と、前記回転センサにより検出された前記回転情報と、に基づいて、前記不安定状態にあるか否かを判定してもよい。
他方、上記目的を達成するための本発明の一態様は、倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う倒立型移動体であって、前記搭乗部の傾斜角度を検出する姿勢検出手段と、前記搭乗部が後傾斜して減速する傾斜状態にあり、かつ前記姿勢検出手段により検出された傾斜角度が所定角度以上である不安定状態にあるか否かを判定する判定手段と、前記判定手段により前記不安定状態と判定されたとき、車輪を停止する制御を行う制御手段と、を備える、ことを特徴とする倒立型移動体であってもよい。
また、上記目的を達成するための本発明の一態様は、倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う倒立型移動体の制御方法であって、前記搭乗部が後傾斜して減速する傾斜状態を水平な倒立安定状態に戻すための駆動トルクを算出するステップと、前記搭乗部が後傾斜して減速する傾斜状態にあり、かつ前記算出された駆動トルクが所定トルク以上である不安定状態にあるか否かを判定するステップと、前記不安定状態と判定されたとき、車輪を停止する制御を行うステップと、を含む、ことを特徴とする倒立型移動体の制御方法であってもよい。
この一態様において、前記搭乗部が後傾斜して減速する傾斜状態で移動速度が所定速度以下であり、かつ、前記算出された駆動トルクが所定トルク以上である前記不安定状態と判定されたとき、前記車輪を停止する制御を行ってもよい。
さらに、上記目的を達成するための本発明の一態様は、倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う倒立型移動体のプログラムであって、前記搭乗部が後傾斜して減速する傾斜状態を水平な倒立安定状態に戻すための駆動トルクを算出する処理と、前記搭乗部が後傾斜して減速する傾斜状態にあり、かつ前記算出された駆動トルクが所定トルク以上である不安定状態にあるか否かを判定する処理と、前記不安定状態と判定されたとき、車輪を停止する制御を行う処理と、をコンピュータに実行させる、ことを特徴とする倒立型移動体のプログラムであってもよい。
One aspect of the present invention for achieving the above object is an inverted moving body that performs a desired traveling according to the inclination of a riding section on which a passenger is boarded while maintaining an inverted state, wherein the riding section is Torque calculating means for calculating a driving torque for returning the inclined state where the vehicle is inclined and decelerated to a horizontal inverted stable state, and the riding part is in an inclined state where the vehicle is inclined backward and decelerated, and is calculated by the torque calculating unit. Determining means for determining whether or not the driven torque is in an unstable state that is equal to or greater than a predetermined torque, and a control means for performing control to stop the wheel when the determining means determines that the unstable state is the unstable state; An inverted mobile body characterized by comprising:
In this one aspect, the moving speed is equal to or lower than a predetermined speed and the driving torque calculated by the torque calculating means is equal to or higher than a predetermined torque in the inclined state where the riding section is inclined backward and decelerated by the determining means. When it is determined that the state is unstable, the control unit may perform control to stop the wheel.
In this aspect, the control means may continue the inversion control for maintaining the inverted state when the drive torque calculated by the torque calculation means is less than a predetermined torque.
In this aspect, the gyro sensor that detects the inclination angular velocity of the riding section, the acceleration sensor that detects the acceleration of the riding section, and the rotation sensor that detects the rotation information of the wheel, the determination unit includes Whether or not the vehicle is in the unstable state based on the tilt angular velocity detected by the gyro sensor, the acceleration detected by the acceleration sensor, and the rotation information detected by the rotation sensor. You may judge.
On the other hand, one aspect of the present invention for achieving the above object is an inverted moving body that performs a desired traveling according to the inclination of the riding section on which the passenger is boarded while maintaining the inverted state. A posture detecting means for detecting the inclination angle of the vehicle part, and an instability state in which the riding part is inclined backward and decelerated, and the inclination angle detected by the posture detection means is a predetermined angle or more. Even if it is an inverted type moving body comprising: a determination unit that determines whether or not; and a control unit that performs control to stop a wheel when the determination unit determines that the state is unstable. Good.
Another aspect of the present invention for achieving the above object is a method for controlling an inverted moving body that performs a desired traveling according to the inclination of a riding section on which a passenger rides while maintaining an inverted state. Calculating a driving torque for returning the inclined state in which the riding section is inclined backward and decelerating to a horizontal inverted stable state; and wherein the riding section is in an inclined state in which the riding section is inclined backward and decelerated. A step of determining whether or not the driving torque is in an unstable state that is equal to or greater than a predetermined torque, and a step of performing control to stop the wheel when the driving torque is determined to be in the unstable state. Alternatively, the inverted moving body control method may be used.
In this one aspect, when it is determined that the instability state in which the riding section is tilted backward and decelerated and the moving speed is equal to or lower than a predetermined speed and the calculated driving torque is equal to or higher than the predetermined torque. Control for stopping the wheel may be performed.
Furthermore, one aspect of the present invention for achieving the above object is an inverted mobile program that performs a desired traveling according to the inclination of a riding section on which a passenger is boarded while maintaining an inverted state. A process for calculating a driving torque for returning the inclined state in which the riding portion is inclined backward and decelerated to a horizontal inverted stable state; and the inclined state in which the riding portion is inclined backward and decelerated, and the calculated Causing the computer to execute a process of determining whether or not the driving torque is in an unstable state that is equal to or greater than a predetermined torque, and a process of performing control to stop the wheel when the driving torque is determined to be in the unstable state. It may be a program of an inverted type moving body.

本発明によれば、急減速時を行った場合でも限られた駆動力でその安全性を維持できる倒立型移動体、その制御方法及びプログラムを提供することができる。   According to the present invention, it is possible to provide an inverted moving body that can maintain its safety with a limited driving force even when sudden deceleration is performed, a control method thereof, and a program.

本発明の実施の形態1に係る倒立型移動体の概略的な構成を示す概略図である。It is the schematic which shows the schematic structure of the inverted moving body which concerns on Embodiment 1 of this invention. 本発明の実施の形態1に係る倒立型移動体の概略的な構成を示すブロック図である。It is a block diagram which shows the schematic structure of the inverted moving body which concerns on Embodiment 1 of this invention. 本発明の実施の形態1に係る倒立型移動体の制御処理フローを示すフローチャートである。It is a flowchart which shows the control processing flow of the inverted type mobile body which concerns on Embodiment 1 of this invention. (a)倒立型移動体の急減速したときの移動速度の変化の一例を示す図である。(b)倒立型移動体の急減速したときの指令トルク値の変化の一例を示す図である。(A) It is a figure which shows an example of the change of the moving speed when the inverted moving body decelerates rapidly. (B) It is a figure which shows an example of the change of the command torque value when the inverted moving body decelerates rapidly. 駆動車輪を停止し搭乗者が降車する状態を示す図である。It is a figure which shows the state which stops a driving wheel and a passenger gets off. 後傾斜状態を水平な倒立安定状態に戻すような倒立制御を示す図である。It is a figure which shows the inversion control which returns a back inclination state to a horizontal inversion stable state. 本発明の実施の形態2に係る倒立型移動体の制御処理フローを示すフローチャートである。It is a flowchart which shows the control processing flow of the inverted mobile body which concerns on Embodiment 2 of this invention.

実施の形態1.
以下、図面を参照して本発明の実施の形態について説明する。図1は、本発明の実施の形態1に係る倒立型移動体の概略的な構成を示す概略図である。本実施の形態1に係る倒立型移動体1は、例えば、倒立状態を維持しつつ、搭乗者が搭乗するステップ(搭乗部)2の傾斜に応じて所望の走行を行う、倒立型二輪車として構成されている。例えば、搭乗者がステップ2を前方へ傾斜させると、その前傾斜に応じて倒立型移動体1は前進する。逆に、搭乗者がステップ2を後方へ傾斜させると、その後傾斜に応じて倒立型移動体1は減速あるいは後進する。また、搭乗者は、ステップ2の傾斜を増加させることで、倒立型移動体1の加減速度の大きさを調整することができる。
Embodiment 1 FIG.
Embodiments of the present invention will be described below with reference to the drawings. FIG. 1 is a schematic diagram showing a schematic configuration of an inverted moving body according to Embodiment 1 of the present invention. The inverted mobile body 1 according to the first embodiment is configured as an inverted two-wheeled vehicle that performs a desired traveling according to the inclination of the step (boarding section) 2 on which the passenger gets on while maintaining the inverted state, for example. Has been. For example, when the passenger tilts Step 2 forward, the inverted moving body 1 moves forward according to the forward tilt. Conversely, when the passenger tilts Step 2 backward, the inverted mobile body 1 decelerates or reverses in accordance with the tilt thereafter. Further, the passenger can adjust the magnitude of the acceleration / deceleration of the inverted moving body 1 by increasing the slope of step 2.

倒立型移動体1は、例えば、移動体本体3と、移動体本体3の上面に設けられ搭乗者が搭乗するステップ2と、移動体本体3の左右側面に回転可能に設けられた一対の駆動車輪4と、移動体本体3に設けられ搭乗者が把持し前後方向や左右方向に操作可能な操作ハンドル5と、を備えている。なお、ステップ2は移動体本体3に一体的に設けられており、ステップ2と移動体本体3とは一体的に動作する。また、上述した倒立型移動体1の構成は一例であり、これに限らず、例えば、操作ハンドル5を有しない構成であってもよい。   The inverted mobile body 1 includes, for example, a mobile body 3, a step 2 that is provided on the upper surface of the mobile body 3, and a pair of drives that are rotatably provided on the left and right side surfaces of the mobile body 3. The vehicle includes a wheel 4 and an operation handle 5 that is provided on the mobile body 3 and is gripped by a passenger and can be operated in the front-rear direction and the left-right direction. Note that step 2 is provided integrally with the movable body main body 3, and the step 2 and the movable body main body 3 operate integrally. In addition, the configuration of the above-described inverted moving body 1 is an example, and the configuration is not limited thereto. For example, a configuration without the operation handle 5 may be used.

図2は、本実施の形態1に係る倒立型移動体の概略的な構成を示すブロック図である。本実施の形態1に係る倒立型移動体1は、ジャイロセンサ11と、加速度センサ12と、回転センサ13と、姿勢演算部14、動作判定処理部15、倒立制御演算部16、車輪停止指令部17、及びモータ制御部18、を含む制御装置6と、一対のモータ19と、を備えている。   FIG. 2 is a block diagram showing a schematic configuration of the inverted moving body according to the first embodiment. The inverted mobile body 1 according to the first embodiment includes a gyro sensor 11, an acceleration sensor 12, a rotation sensor 13, a posture calculation unit 14, an operation determination processing unit 15, an inverted control calculation unit 16, and a wheel stop command unit. 17 and a motor control unit 18, and a pair of motors 19.

制御装置6は、例えば、移動体本体3に内蔵されており、制御処理、演算処理等と行うCPU(Central Processing Unit)、CPUによって実行される制御プログラム、演算プログラム等が記憶されたROM(Read Only Memory)、処理データ等を一時的に記憶するRAM(Random Access Memory)等からなるマイクロコンピュータを中心にして、ハードウェア構成されている。   For example, the control device 6 is built in the mobile body 3 and includes a CPU (Central Processing Unit) that performs control processing, arithmetic processing, and the like, and a ROM (Read ROM) that stores a control program executed by the CPU, an arithmetic program, and the like. Only a microcomputer including a RAM (Random Access Memory) that temporarily stores processing data and the like is configured as hardware.

ジャイロセンサ11は、例えば、移動体本体3又はステップ2に設けられており、ステップ2及び移動体本体3の傾斜角速度を検出する。ジャイロセンサ11には姿勢演算部14に接続されており、ジャイロセンサ11は、検出したステップ2及び移動体本体3の傾斜角速度を姿勢演算部14に対して出力する。   The gyro sensor 11 is provided, for example, in the mobile body 3 or step 2 and detects the angular angular velocity of the step 2 and the mobile body 3. The gyro sensor 11 is connected to the attitude calculation unit 14, and the gyro sensor 11 outputs the detected step 2 and the tilt angular velocity of the moving body 3 to the attitude calculation unit 14.

加速度センサ12は、例えば、移動体本体2又はステップ3に設けられており、ステップ2及び移動体本体3の加速度を検出する。加速度センサ12には姿勢演算部14が接続されており、加速度センサ12は検出したステップ2及び移動体本体3の加速度を姿勢演算部14に対して出力する。   The acceleration sensor 12 is provided, for example, in the mobile body 2 or step 3 and detects the acceleration of the step 2 and the mobile body 3. A posture calculation unit 14 is connected to the acceleration sensor 12, and the acceleration sensor 12 outputs the detected step 2 and the acceleration of the moving body 3 to the posture calculation unit 14.

回転センサ13は、例えば、エンコーダ、レゾルバなどにより構成されており、各駆動車輪4に設けられ、各駆動車輪4の回転角度、回転角速度、回転角加速度などの回転情報を検出する。回転センサ13には動作判定処理部15が接続されており、回転センサ13は検出した回転情報を動作判定処理部15に対して出力する。   The rotation sensor 13 is configured by, for example, an encoder, a resolver, and the like, provided on each drive wheel 4 and detects rotation information such as a rotation angle, a rotation angular velocity, and a rotation angular acceleration of each drive wheel 4. An operation determination processing unit 15 is connected to the rotation sensor 13, and the rotation sensor 13 outputs the detected rotation information to the operation determination processing unit 15.

姿勢演算部14は、姿勢検出手段の一具体例であり、ジャイロセンサ11から出力されたステップ2及び移動体本体3の角速度と加速度センサ12から出力されたステップ2及び移動体本体3の加速度と、に基づいて、ステップ2及び移動体本体3の姿勢角度を算出する。姿勢演算部14には倒立制御演算部16及び動作判定処理部15が接続されており、姿勢演算部14は、算出したステップ2及び移動体本体3の姿勢角度を倒立制御演算部16及び動作判定処理部15に対して出力する。   The posture calculation unit 14 is a specific example of posture detection means. Step 2 and the angular velocity of the moving body main body 3 output from the gyro sensor 11, step 2 and the acceleration of the moving body main body 3 output from the acceleration sensor 12, and , The attitude angle of step 2 and the mobile body 3 is calculated. The posture calculation unit 14 is connected to an inverted control calculation unit 16 and an operation determination processing unit 15, and the posture calculation unit 14 determines the calculated step 2 and the posture angle of the mobile body 3 from the inverted control calculation unit 16 and the operation determination. Output to the processing unit 15.

動作判定処理部15は、判定手段の一具体例であり、倒立型移動体1の動作の判定を行う機能を有している。動作判定処理部15は、例えば、回転センサ13から出力される各駆動車輪4の回転情報と、姿勢演算部14から出力されるステップ2及び移動体本体3の姿勢角度と、に基づいて、ステップ2が傾斜して減速する減速状態にあることを判定する。なお、動作判定処理部15は、回転センサ13から出力される各駆動車輪4の回転情報、及び、姿勢演算部14から出力されるステップ2及び移動体本体3の姿勢角度のうち、いずれか一方のみに基づいて、ステップ2が傾斜して減速する減速状態にあることを判定してもよい。   The operation determination processing unit 15 is a specific example of a determination unit, and has a function of determining the operation of the inverted moving body 1. For example, the motion determination processing unit 15 performs the step based on the rotation information of each driving wheel 4 output from the rotation sensor 13 and the posture angle of the moving body 3 and the step 2 output from the posture calculation unit 14. It is determined that 2 is in a decelerating state where the vehicle is inclined and decelerated. Note that the operation determination processing unit 15 is one of the rotation information of each driving wheel 4 output from the rotation sensor 13 and the step 2 and the attitude angle of the moving body 3 output from the attitude calculation unit 14. It may be determined that the step 2 is in a deceleration state in which the vehicle is inclined and decelerated based only on the basis of the above.

また、動作判定処理部15は、回転センサ13から出力される各駆動車輪4の回転情報と、姿勢演算部14から出力されるステップ2及び移動体本体3の姿勢角度と、に基づいて、ステップ2が傾斜して減速する減速状態であり、かつ、倒立制御演算部16からのトルク指令値が所定トルク以上である不安定状態にあるか否かを判定する。   Further, the motion determination processing unit 15 performs a step based on the rotation information of each driving wheel 4 output from the rotation sensor 13 and the step 2 and the posture angle of the mobile body 3 output from the posture calculation unit 14. 2 is a deceleration state in which the vehicle is inclined and decelerated, and it is determined whether or not the torque command value from the inversion control calculation unit 16 is in an unstable state that is equal to or greater than a predetermined torque.

なお、この所定トルクは、例えば、モータ19が出力可能な最大出力トルクが設定されている。したがって、倒立制御演算部16により算出されたトルク指令値が所定トルク以上となる場合は、その後傾斜状態から水平な倒立安定状態に復帰できないため、倒立制御が不安定状態(不能状態)となる。動作判定処理部15は、倒立型移動体1がこのような不安定状態にあるか否かを判定する。動作判定処理部15には倒立制御演算部16及び車輪停止指令部17が接続されている。   For example, a maximum output torque that can be output by the motor 19 is set as the predetermined torque. Therefore, when the torque command value calculated by the inversion control calculation unit 16 is equal to or greater than the predetermined torque, the inversion control becomes unstable (incapable state) because it cannot subsequently return from the inclined state to the horizontal inversion stable state. The operation determination processing unit 15 determines whether or not the inverted moving body 1 is in such an unstable state. The motion determination processing unit 15 is connected to an inverted control calculation unit 16 and a wheel stop command unit 17.

動作判定処理部15は、倒立型移動体1が上記不安定状態であると判定したとき、倒立制御演算部16に対して停止信号を出力し、車輪停止指令部17に対して動作信号を出力する。   When it is determined that the inverted mobile body 1 is in the unstable state, the motion determination processing unit 15 outputs a stop signal to the inverted control calculation unit 16 and outputs an operation signal to the wheel stop command unit 17. To do.

さらに、動作判定処理部15は、回転センサ13から出力される各駆動車輪4の回転情報と、姿勢演算部14から出力されるステップ2及び移動体本体3の姿勢角度と、に基づいて、ステップ2が傾斜して減速する減速状態で移動速度が所定速度以下であり、かつ、倒立制御演算部16からのトルク指令値が所定トルク以上であるとき、上記不安定状態であると判定するのが好ましい。これにより、後述の如く、移動速度が所定速度以下の低速になったことを確認して、駆動車輪4を減速、停止させ搭乗者は安全に降車を行うことができる。   Further, the motion determination processing unit 15 performs a step based on the rotation information of each driving wheel 4 output from the rotation sensor 13 and the step 2 and the posture angle of the mobile body 3 output from the posture calculation unit 14. When the moving speed is equal to or lower than a predetermined speed in a deceleration state in which 2 is inclined and decelerated, and the torque command value from the inversion control calculation unit 16 is equal to or higher than the predetermined torque, it is determined that the state is unstable. preferable. Thus, as will be described later, it is confirmed that the moving speed has become a low speed equal to or lower than the predetermined speed, and the drive wheel 4 can be decelerated and stopped, and the passenger can safely get off the vehicle.

倒立制御演算部16は、トルク算出手段の一具体例であり、倒立型移動体1が倒立状態を維持しつつ所望の走行を行うような、各モータ19に対するトルク指令値(駆動トルクの一例)を算出する。倒立制御演算部16は、例えば、姿勢演算部14から出力された姿勢角度に基づいた値に所定の制御ゲインを乗算することで、上記倒立状態を維持するためのトルク指令値を算出する。倒立制御演算部16にはモータ制御部18及び動作判定処理部15が接続されており、倒立制御演算部16は算出したトルク指令値をモータ制御部18及び動作判定処理部15に対して出力する。   The inverted control calculation unit 16 is a specific example of torque calculation means, and torque command values (an example of drive torque) for the motors 19 such that the inverted movable body 1 performs desired travel while maintaining the inverted state. Is calculated. The inverted control calculation unit 16 calculates a torque command value for maintaining the inverted state by, for example, multiplying a value based on the posture angle output from the posture calculation unit 14 by a predetermined control gain. A motor control unit 18 and an operation determination processing unit 15 are connected to the inverted control calculation unit 16, and the inverted control calculation unit 16 outputs the calculated torque command value to the motor control unit 18 and the operation determination processing unit 15. .

なお、倒立制御演算部16は、動作判定処理部15から停止信号を受信すると、上記トルク指令値の算出及び出力を停止する。   In addition, when receiving the stop signal from the operation determination processing unit 15, the inverted control calculation unit 16 stops the calculation and output of the torque command value.

車輪停止指令部17は、制御手段の一具体例であり、動作判定処理部15から動作信号を受信すると、各駆動車輪4を停止させるようなトルク指令値(=0)を生成し、モータ制御部18に対して出力する。   The wheel stop command unit 17 is a specific example of the control means. Upon receiving an operation signal from the operation determination processing unit 15, the wheel stop command unit 17 generates a torque command value (= 0) that stops each drive wheel 4 and performs motor control. Output to the unit 18.

モータ制御部18は、倒立制御演算部16又は車輪停止指令部17から出力されるトルク指令値に応じた制御信号を生成し、駆動回路などを介して、各モータ19に対して出力する。このように動作判定処理部15から出力される動作信号及び停止信号に応じて、倒立制御演算部16及び車輪停止指令部17からモータ制御部18へ出力されるトルク指令値が切り換えられる。   The motor control unit 18 generates a control signal corresponding to the torque command value output from the inversion control calculation unit 16 or the wheel stop command unit 17 and outputs the control signal to each motor 19 via a drive circuit or the like. Thus, the torque command value output from the inversion control calculation unit 16 and the wheel stop command unit 17 to the motor control unit 18 is switched in accordance with the operation signal and the stop signal output from the operation determination processing unit 15.

各モータ19は、減速機構などを介して、各駆動車輪4の駆動軸に連結されており、モータ制御部18から出力される制御信号に応じて各駆動車輪4を独立して回転駆動する。これにより、倒立型移動体1は、倒立状態を維持しつつ、前後進、左右旋回、加減速、停止などの所望の走行を行うことができる。   Each motor 19 is connected to the drive shaft of each drive wheel 4 via a speed reduction mechanism or the like, and independently rotates and drives each drive wheel 4 in accordance with a control signal output from the motor control unit 18. Thereby, the inverted mobile body 1 can perform desired traveling such as forward / backward movement, left / right turn, acceleration / deceleration, and stop while maintaining the inverted state.

ところで、例えば、倒立型移動体を大きく後傾させて急停止する場合でも、通常、その後傾状態から元の水平な倒立安定状態に戻すこととなる。しかしながら、従来の倒立型移動体においては、その大きく傾斜した後傾状態から水平な倒立安定状態まで戻すためのモータトルクが足りない場合、倒立制御が不安定状態(不能状態)となり安全性上の問題が生じていた。一方で、そのモータトルク不足を解消するために、倒立型移動体に大出力モータを搭載すれば、その大型化、重量及びコスト増加などの問題が生じる。   By the way, for example, even when the inverted moving body is largely tilted rearward and suddenly stopped, the tilted state is usually returned to the original horizontal inverted stable state. However, in the conventional inverted mobile body, when the motor torque for returning from the greatly inclined rearward tilted state to the horizontal inverted stable state is insufficient, the inverted control becomes unstable (impossible state), which is in terms of safety. There was a problem. On the other hand, if a high-power motor is mounted on an inverted moving body in order to solve the shortage of motor torque, problems such as an increase in size, weight, and cost will arise.

そこで、本実施の形態1に係る倒立型移動体1において、ステップ2が後傾斜して減速する減速状態で移動速度が所定速度以下であり、かつ、その傾斜状態を水平な倒立安定状態に戻すための駆動トルクが所定トルク以上となるとき、各駆動車輪4を停止する制御を行う。   Therefore, in the inverted moving body 1 according to the first embodiment, the moving speed is equal to or lower than the predetermined speed in the decelerating state where the step 2 is inclined backward and decelerated, and the inclined state is returned to the horizontal inverted stable state. When the drive torque for this becomes more than predetermined torque, control which stops each drive wheel 4 is performed.

これにより、搭乗者による急停止動作などで、ステップ2が大きく後傾斜して、かつ、その傾斜状態を水平な倒立安定状態に戻すために必要な駆動トルクが所定トルク以上となり不足する場合でも、不安定な倒立制御を停止させ、駆動車輪4を確実に停止させることで、その後傾斜の状態で、搭乗者は安全かつスムーズに降車することができる。このように、限られた駆動力を効果的に用いて、急減速時においても駆動車輪4を停止し、搭乗者は安全かつスムーズに降車することができる。   Thereby, even if the driving torque necessary for returning the tilted state to the horizontal inverted stable state becomes greater than or equal to the predetermined torque due to a sudden stop operation by the passenger, etc. By stopping the unstable inversion control and stopping the driving wheel 4 reliably, the passenger can get off safely and smoothly in an inclined state thereafter. In this manner, the limited driving force is effectively used to stop the driving wheel 4 even during sudden deceleration, and the passenger can get off safely and smoothly.

次に、本実施の形態1に係る倒立型移動体1の制御方法について、詳細に説明する。図3は、本実施の形態1に係る倒立型移動体の制御処理フローを示すフローチャートである。なお、下記(ステップS102)乃至(ステップS105)の処理は、例えば、所定の時間毎に繰り返し実行される。   Next, the control method of the inverted moving body 1 according to the first embodiment will be described in detail. FIG. 3 is a flowchart showing a control processing flow of the inverted moving body according to the first embodiment. Note that the following processing (step S102) to (step S105) is repeatedly executed at predetermined time intervals, for example.

例えば、搭乗者がステップ2を大きく後傾させて倒立型移動体1を急減速させる(ステップS101)(図4(1))。   For example, the passenger greatly tilts the step 2 backward to decelerate the inverted moving body 1 (step S101) (FIG. 4 (1)).

動作判定処理部15は、回転センサ13から出力される各駆動車輪4の回転情報と、姿勢演算部14から出力されるステップ2及び移動体本体3の姿勢角度と、に基づいて、ステップ2が傾斜して減速する減速状態で|移動速度|が所定速度|α|以下であるか否かを判定する(ステップS102)。   Based on the rotation information of each driving wheel 4 output from the rotation sensor 13 and the posture angle of the moving body 3 and the step 2 output from the posture calculation unit 14, the motion determination processing unit 15 It is determined whether or not | moving speed | is equal to or lower than a predetermined speed | α | in a deceleration state where the vehicle is inclined and decelerated (step S102).

次に、動作判定処理部15は、ステップ2が傾斜して減速する減速状態で|移動速度|が所定速度|α|以下であると判定すると(ステップS102のYES)(図4(2))、倒立制御演算部16からの|トルク指令値|が所定トルク|β|以上であるか否かを判定する(ステップS103)。一方、動作判定処理部15は、ステップ2が傾斜して減速する減速状態で|移動速度|が所定速度|α|以下でないと判定したと(ステップS102のNO)、本制御処理を終了する。   Next, when the motion determination processing unit 15 determines that | movement speed | is equal to or less than the predetermined speed | α | in the deceleration state in which step 2 is inclined and decelerates (YES in step S102) (FIG. 4 (2)) Then, it is determined whether or not | torque command value | from the inversion control calculation unit 16 is equal to or greater than a predetermined torque | β | (step S103). On the other hand, when it is determined that | movement speed | is not equal to or smaller than the predetermined speed | α | in the deceleration state in which step 2 is inclined and decelerated (NO in step S102), the operation determination processing unit 15 ends this control process.

動作判定処理部15は、倒立制御演算部16からの|トルク指令値|が所定トルク|β|以上であると判定したとき(ステップS103のYES)(図4(3))、倒立型移動体1が不安定状態であると判定し、倒立制御演算部16に対して停止信号を出力し、車輪停止指令部17に対して動作信号を出力する。車輪停止指令部17は、動作判定処理部15から動作信号を受信すると、各駆動車輪4を停止させるようなトルク指令値を生成し、モータ制御部18に対して出力する。モータ制御部18は、各モータ19を制御して各駆動車輪4を停止させる(ステップS104)。これにより、不安定な倒立制御を確実に停止させ、搭乗者は安全かつスムーズに降車することができる(図5)。   When the motion determination processing unit 15 determines that the | torque command value | from the inverted control calculation unit 16 is equal to or greater than the predetermined torque | β | (YES in step S103) (FIG. 4 (3)), the inverted moving body. 1 is determined to be in an unstable state, a stop signal is output to the inverted control calculation unit 16, and an operation signal is output to the wheel stop command unit 17. When the wheel stop command unit 17 receives the operation signal from the operation determination processing unit 15, the wheel stop command unit 17 generates a torque command value for stopping each drive wheel 4 and outputs the torque command value to the motor control unit 18. The motor control unit 18 controls each motor 19 to stop each drive wheel 4 (step S104). Thereby, unstable inversion control can be stopped reliably and the passenger can get off safely and smoothly (FIG. 5).

一方、動作判定処理部15は、倒立制御演算部16からの|トルク指令値|が所定トルク|β|以上でないと判定したとき(ステップS103のNO)、倒立制御演算部16は、倒立状態を維持しつつ所望の走行を行うようなトルク指令値を算出し、算出したトルク指令値をモータ制御部18に対して出力する。モータ制御部18は、各モータ19を制御して、後傾斜状態を水平な倒立安定状態に戻すような倒立制御を行う(ステップS105)(図6)。これにより、倒立型移動体1は、安定的に倒立制御を継続することができる。   On the other hand, when the operation determination processing unit 15 determines that the | torque command value | from the inversion control calculation unit 16 is not equal to or greater than the predetermined torque | β | (NO in step S103), the inversion control calculation unit 16 sets the inverted state. A torque command value for performing a desired travel while maintaining the torque is calculated, and the calculated torque command value is output to the motor control unit 18. The motor control unit 18 controls each motor 19 to perform the inversion control so as to return the rear tilt state to the horizontal inversion stable state (step S105) (FIG. 6). Thereby, the inverted mobile body 1 can continue the inversion control stably.

以上、本実施の形態1に係る倒立型移動体1において、ステップ2が後傾斜して減速する減速状態で移動速度が所定速度以下であり、かつ、その傾斜状態を水平な倒立安定状態に戻すための駆動トルクが所定トルク以上となるとき、駆動車輪4を停止する制御を行う。これにより、ステップ2が大きく後傾斜して、かつ、その傾斜状態を水平な倒立安定状態に戻すために必要な駆動トルクが所定トルク以上となり足りない場合でも、不安定な倒立制御を停止させ、その後傾斜状態のまま駆動車輪4を確実に停止させることで、搭乗者は安全かつスムーズに降車することができる。すなわち、急減速時においても限られた駆動力で安全性を維持できる。   As described above, in the inverted moving body 1 according to the first embodiment, the moving speed is equal to or lower than the predetermined speed in the decelerating state where the step 2 is inclined backward and decelerated, and the inclined state is returned to the horizontal inverted stable state. When the driving torque for the driving torque becomes equal to or greater than the predetermined torque, control for stopping the driving wheel 4 is performed. As a result, even when the step 2 is greatly inclined backward and the driving torque necessary for returning the inclined state to the horizontal inverted stable state is not more than the predetermined torque, the unstable inversion control is stopped, Thereafter, the driving wheel 4 is reliably stopped in the inclined state, so that the passenger can get off safely and smoothly. That is, safety can be maintained with a limited driving force even during sudden deceleration.

実施の形態2.
本発明の実施の形態において、動作判定処理部15は、ステップ2が後傾斜して減速する減速状態で移動速度が所定速度α以下であり、かつステップ2の|傾斜角度|が所定角度|γ|以上である不安定状態にあることを判定してもよい。なお、上記所定角度γは、例えば、各モータ19の最大出力によりステップ2及び移動体本体3の傾斜状態を水平な倒立安定状態に戻すのができる最大傾斜角度に設定される。
Embodiment 2. FIG.
In the embodiment of the present invention, the motion determination processing unit 15 is such that the moving speed is equal to or less than the predetermined speed α in the deceleration state where the step 2 is inclined backward and decelerated, and the | tilt angle | | You may determine that you are in an unstable state. The predetermined angle γ is set to, for example, the maximum inclination angle that can return the inclination state of step 2 and the movable body 3 to the horizontal inverted stable state by the maximum output of each motor 19.

動作判定処理部15は、倒立型移動体1が不安定状態であると判定すると、倒立制御演算部16に対して停止信号を出力し、車輪停止指令部17に対して動作信号を出力する。車輪停止指令部17は、動作判定処理部15から動作信号を受信すると、各駆動車輪4を停止させる。   When the motion determination processing unit 15 determines that the inverted moving body 1 is in an unstable state, the motion determination processing unit 15 outputs a stop signal to the inverted control calculation unit 16 and outputs an operation signal to the wheel stop command unit 17. When the wheel stop command unit 17 receives the operation signal from the operation determination processing unit 15, the wheel stop command unit 17 stops each drive wheel 4.

これにより、ステップ2の後傾斜角度が所定角度以上となり大きく後傾斜し、その傾斜状態を水平な倒立安定状態に戻すのが不能となった場合でも、その後傾姿勢のままで、確実に駆動車輪4を停止させることで、搭乗者は安全かつスムーズに降車することができる。   As a result, even when the rear inclination angle of step 2 becomes larger than a predetermined angle and the rear inclination is greatly increased, and it becomes impossible to return the inclination state to the horizontal inverted stable state, the driving wheel is reliably maintained in the inclined posture thereafter. By stopping 4, the passenger can get off safely and smoothly.

図7は、本実施の形態2に係る倒立型移動体の制御処理フローを示すフローチャートである。   FIG. 7 is a flowchart showing a control processing flow of the inverted moving body according to the second embodiment.

例えば、搭乗者がステップ2を大きく後傾させて倒立型移動体1を急減速させる(ステップS201)。   For example, the occupant tilts Step 2 greatly backward to decelerate the inverted moving body 1 rapidly (Step S201).

動作判定処理部15は、回転センサ13から出力される各駆動車輪4の回転情報と、姿勢演算部14から出力されるステップ2及び移動体本体3の姿勢角度と、に基づいて、ステップ2が傾斜して減速する減速状態で|移動速度|が所定速度|α|以下であるか否かを判定する(ステップS202)。   Based on the rotation information of each driving wheel 4 output from the rotation sensor 13 and the posture angle of the moving body 3 and the step 2 output from the posture calculation unit 14, the motion determination processing unit 15 It is determined whether or not | moving speed | is equal to or lower than a predetermined speed | α | in a deceleration state where the vehicle is inclined and decelerated (step S202).

次に、動作判定処理部15は、ステップ2が傾斜して減速する減速状態で|移動速度|が所定速度|α|以下であると判定すると(ステップS202のYES)、ステップ2の|傾斜角度|が所定角度|γ|以上であるか否かを判定する(ステップS203)。   Next, when the motion determination processing unit 15 determines that | movement speed | is equal to or less than the predetermined speed | α | in the deceleration state in which step 2 is inclined and decelerates (YES in step S202), the | tilt angle in step 2 It is determined whether or not | is equal to or greater than a predetermined angle | γ | (step S203).

動作判定処理部15は、ステップ2の|傾斜角度|が所定角度|γ|以上であると判定したとき(ステップS203のYES)、倒立型移動体1が不安定状態であると判定し、倒立制御演算部16に対して停止信号を出力し、車輪停止指令部17に対して動作信号を出力する。車輪停止指令部17は、動作判定処理部15から動作信号を受信すると、各駆動車輪4を停止させるようなトルク指令値を生成し、モータ制御部18に対して出力する。モータ制御部18は、各モータ19を制御して各駆動車輪4を停止させる(ステップS204)。これにより、不安定な倒立制御を確実に停止させ、搭乗者は安全かつスムーズに降車することができる。   When it is determined that the | tilt angle | is greater than or equal to the predetermined angle | γ | in Step 2 (YES in Step S203), the motion determination processing unit 15 determines that the inverted mobile body 1 is in an unstable state, and is inverted. A stop signal is output to the control calculation unit 16 and an operation signal is output to the wheel stop command unit 17. When the wheel stop command unit 17 receives the operation signal from the operation determination processing unit 15, the wheel stop command unit 17 generates a torque command value for stopping each drive wheel 4 and outputs the torque command value to the motor control unit 18. The motor control unit 18 controls each motor 19 to stop each drive wheel 4 (step S204). Thereby, unstable inversion control can be stopped reliably and the passenger can get off safely and smoothly.

一方、動作判定処理部15は、ステップ2の|傾斜角度|が所定角度|γ|以上でないと判定したとき(ステップS203のNO)、倒立制御演算部16は、倒立状態を維持しつつ所望の走行を行うようなトルク指令値を継続して算出し、算出したトルク指令値をモータ制御部18に対して出力する。モータ制御部18は、各モータ19を制御して、傾斜状態を水平な倒立安定状態に戻すような倒立制御を行う(ステップS205)。   On the other hand, when the motion determination processing unit 15 determines that the | tilt angle | of step 2 is not equal to or greater than the predetermined angle | γ | (NO in step S203), the inverted control calculation unit 16 maintains a desired inverted state. The torque command value for running is continuously calculated, and the calculated torque command value is output to the motor control unit 18. The motor control unit 18 controls each motor 19 to perform the inversion control so as to return the inclined state to the horizontal inverted stable state (step S205).

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

なお、本発明は上記実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。また、上述の実施の形態では、本発明をハードウェアの構成として説明したが、本発明は、これに限定されるものではない。本発明は、例えば、上記制御装置6が実行する処理を、CPUにコンピュータプログラムを実行させることにより実現することも可能である。   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. In the above-described embodiments, the present invention has been described as a hardware configuration, but the present invention is not limited to this. In the present invention, for example, the processing executed by the control device 6 can be realized by causing a CPU to execute a computer program.

プログラムは、様々なタイプの非一時的なコンピュータ可読媒体(non-transitory computer readable medium)を用いて格納され、コンピュータに供給することができる。非一時的なコンピュータ可読媒体は、様々なタイプの実体のある記録媒体(tangible storage medium)を含む。非一時的なコンピュータ可読媒体の例は、磁気記録媒体(例えばフレキシブルディスク、磁気テープ、ハードディスクドライブ)、光磁気記録媒体(例えば光磁気ディスク)、CD−ROM、CD−R、CD−R/W、半導体メモリ(例えば、マスクROM、PROM(Programmable ROM)、EPROM(Erasable PROM)、フラッシュROM、RAM)を含む。   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 are magnetic recording media (eg flexible disks, magnetic tapes, hard disk drives), magneto-optical recording media (eg magneto-optical disks), CD-ROM, CD-R, CD-R / W. Semiconductor memory (for example, mask ROM, PROM (Programmable ROM), EPROM (Erasable PROM), flash ROM, RAM).

また、プログラムは、様々なタイプの一時的なコンピュータ可読媒体(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 移動体本体
4 駆動車輪
5 操作ハンドル
6 制御装置
11 ジャイロセンサ
12 加速度センサ
13 回転センサ
14 姿勢演算部
15 動作判定処理部
16 倒立制御演算部
17 車輪停止指令部
18 モータ制御部
19 モータ
DESCRIPTION OF SYMBOLS 1 Inverted type mobile body 2 Step 3 Mobile body main body 4 Drive wheel 5 Operation handle 6 Control apparatus 11 Gyro sensor 12 Acceleration sensor 13 Rotation sensor 14 Attitude calculation part 15 Motion determination process part 16 Inverted control calculation part 17 Wheel stop command part 18 Motor Control unit 19 Motor

Claims (8)

倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う倒立型移動体であって、
前記搭乗部が後傾斜して減速する傾斜状態を水平な倒立安定状態に戻すための駆動トルクを算出するトルク算出手段と、
前記搭乗部が後傾斜して減速する傾斜状態にあり、かつ前記トルク算出手段により算出された駆動トルクが所定トルク以上である不安定状態にあるか否かを判定する判定手段と、
前記判定手段により前記不安定状態と判定されたとき、車輪を停止する制御を行う制御手段と、
を備える、ことを特徴とする倒立型移動体。
An inverted moving body that performs a desired traveling according to the inclination of the riding section on which the passenger is boarded while maintaining the inverted state,
Torque calculating means for calculating a driving torque for returning the inclined state in which the riding section is inclined backward and decelerates to a horizontal inverted stable state;
Determining means for determining whether or not the riding section is in an inclined state where the vehicle is inclined backward and decelerated, and whether or not the driving torque calculated by the torque calculating means is in an unstable state;
Control means for performing control to stop the wheel when the determination means determines that the unstable state;
An inverted mobile body characterized by comprising:
請求項1記載の倒立型移動体であって、
前記判定手段により、前記搭乗部が後傾斜して減速する傾斜状態で移動速度が所定速度以下であり、かつ、前記トルク算出手段により算出された駆動トルクが所定トルク以上である不安定状態と判定されたとき、前記制御手段は前記車輪を停止する制御を行う、
ことを特徴とする倒立型移動体。
The inverted mobile body according to claim 1,
The determination means determines that the riding section is in an unstable state in which the moving speed is equal to or less than a predetermined speed and the driving torque calculated by the torque calculation means is equal to or greater than a predetermined torque in an inclined state where the riding section is inclined backward and decelerated. The control means performs a control to stop the wheel,
An inverted moving body characterized by that.
請求項1又は2記載の倒立型移動体であって、
前記制御手段は、前記トルク算出手段により算出された駆動トルクが所定トルク未満となるとき、前記倒立状態を維持するための倒立制御を継続する、ことを特徴とする倒立型移動体。
The inverted mobile body according to claim 1 or 2,
The inverted moving body characterized in that the control means continues the inversion control for maintaining the inverted state when the drive torque calculated by the torque calculation means is less than a predetermined torque.
請求項1乃至3のうちいずれか1項記載の倒立型移動体であって、
前記搭乗部の傾斜角速度を検出するジャイロセンサと、
前記搭乗部の加速度を検出する加速度センサと、
前記車輪の回転情報を検出する回転センサと、を更に備え、
前記判定手段は、前記ジャイロセンサにより検出された前記傾斜角速度と、前記加速度センサにより検出された前記加速度と、前記回転センサにより検出された前記回転情報と、に基づいて、前記不安定状態にあるか否かを判定する、ことを特徴とする倒立型移動体。
The inverted mobile body according to any one of claims 1 to 3,
A gyro sensor for detecting an inclination angular velocity of the riding section;
An acceleration sensor for detecting acceleration of the riding section;
A rotation sensor for detecting rotation information of the wheel, and
The determination means is in the unstable state based on the tilt angular velocity detected by the gyro sensor, the acceleration detected by the acceleration sensor, and the rotation information detected by the rotation sensor. An inverted moving body characterized by determining whether or not.
倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う倒立型移動体であって、
前記搭乗部の傾斜角度を検出する姿勢検出手段と、
前記搭乗部が後傾斜して減速する傾斜状態にあり、かつ前記姿勢検出手段により検出された傾斜角度が所定角度以上である不安定状態にあるか否かを判定する判定手段と、
前記判定手段により前記不安定状態と判定されたとき、車輪を停止する制御を行う制御手段と、
を備える、ことを特徴とする倒立型移動体。
An inverted moving body that performs a desired traveling according to the inclination of the riding section on which the passenger is boarded while maintaining the inverted state,
Attitude detecting means for detecting an inclination angle of the riding section;
Determining means for determining whether or not the riding section is in an inclined state where the vehicle is inclined backward and decelerated, and whether the inclination angle detected by the posture detecting means is in an unstable state greater than or equal to a predetermined angle;
Control means for performing control to stop the wheel when the determination means determines that the unstable state;
An inverted mobile body characterized by comprising:
倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う倒立型移動体の制御方法であって、
前記搭乗部が後傾斜して減速する傾斜状態を水平な倒立安定状態に戻すための駆動トルクを算出するステップと、
前記搭乗部が後傾斜して減速する傾斜状態にあり、かつ前記算出された駆動トルクが所定トルク以上である不安定状態にあるか否かを判定するステップと、
前記不安定状態と判定されたとき、車輪を停止する制御を行うステップと、
を含む、ことを特徴とする倒立型移動体の制御方法。
A method for controlling an inverted mobile body that performs a desired traveling according to the inclination of a riding section on which a passenger is boarded while maintaining an inverted state,
Calculating a driving torque for returning the inclined state in which the riding section is inclined backward and decelerates to a horizontal inverted stable state;
Determining whether or not the riding section is in an inclined state in which the rear portion is inclined and decelerated, and the calculated driving torque is in an unstable state that is equal to or greater than a predetermined torque;
Performing a control to stop the wheel when it is determined as the unstable state;
A method for controlling an inverted mobile object, comprising:
請求項6記載の倒立型移動体の制御方法であって、
前記搭乗部が後傾斜して減速する傾斜状態で移動速度が所定速度以下であり、かつ、前記算出された駆動トルクが所定トルク以上である前記不安定状態と判定されたとき、前記車輪を停止する制御を行う、
ことを特徴とする倒立型移動体の制御方法。
A method for controlling an inverted mobile object according to claim 6,
The wheel is stopped when it is determined that the traveling speed is equal to or lower than a predetermined speed and the calculated driving torque is equal to or higher than the predetermined torque in the inclined state where the riding section is inclined backward and decelerated. Do control,
A control method for an inverted moving body characterized by the above.
倒立状態を維持しつつ、搭乗者が搭乗する搭乗部の傾斜に応じて所望の走行を行う倒立型移動体のプログラムであって、
前記搭乗部が後傾斜して減速する傾斜状態を水平な倒立安定状態に戻すための駆動トルクを算出する処理と、
前記搭乗部が後傾斜して減速する傾斜状態にあり、かつ前記算出された駆動トルクが所定トルク以上である不安定状態にあるか否かを判定する処理と、
前記不安定状態と判定されたとき、車輪を停止する制御を行う処理と、
をコンピュータに実行させる、ことを特徴とする倒立型移動体のプログラム。
A program of an inverted mobile body that performs a desired traveling according to the inclination of the riding section on which the passenger is boarded while maintaining the inverted state,
A process of calculating a driving torque for returning the inclined state in which the riding section is inclined backward and decelerates to a horizontal inverted stable state;
A process of determining whether or not the riding section is in an inclined state in which the vehicle is inclined backward and decelerated, and the calculated driving torque is in an unstable state that is equal to or greater than a predetermined torque;
When it is determined that the unstable state, processing to stop the wheel,
An inverted mobile program characterized by causing a computer to execute.
JP2011243457A 2011-11-07 2011-11-07 Inverted mobile, control method thereof, and program Pending JP2013099972A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2011243457A JP2013099972A (en) 2011-11-07 2011-11-07 Inverted mobile, control method thereof, and program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011243457A JP2013099972A (en) 2011-11-07 2011-11-07 Inverted mobile, control method thereof, and program

Publications (1)

Publication Number Publication Date
JP2013099972A true JP2013099972A (en) 2013-05-23

Family

ID=48621090

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011243457A Pending JP2013099972A (en) 2011-11-07 2011-11-07 Inverted mobile, control method thereof, and program

Country Status (1)

Country Link
JP (1) JP2013099972A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015051682A (en) * 2013-09-06 2015-03-19 トヨタ自動車株式会社 Inverted moving body

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015051682A (en) * 2013-09-06 2015-03-19 トヨタ自動車株式会社 Inverted moving body

Similar Documents

Publication Publication Date Title
KR101340985B1 (en) Inverted two-wheel apparatus, and control method and control program thereof
US8583353B2 (en) Traveling apparatus and control method therefor
JP5761347B2 (en) Inverted moving body control device, control method thereof, and program
JP6020328B2 (en) MOBILE BODY CONTROL DEVICE, MOBILE BODY CONTROL METHOD, AND CONTROL PROGRAM
JP2010274759A (en) Traveling apparatus, control method thereof, and control program
JP2009101898A (en) Inverted wheel type moving body and control method thereof
JP6048258B2 (en) Inverted motorcycle, turning motion control method and program for inverted motorcycle
JP2013099972A (en) Inverted mobile, control method thereof, and program
JP5181923B2 (en) vehicle
JP4701681B2 (en) Parallel motorcycle and its control method
JP6225869B2 (en) Inverted two-wheeled mobile system
JP5772373B2 (en) Inverted moving body control device and control method thereof
JP5110416B2 (en) vehicle
JP6233265B2 (en) Inverted two-wheeled mobile system
JP6183328B2 (en) Inverted balance training apparatus and inverted balance training method
JP6217582B2 (en) Inverted moving body and control method thereof
JP6614094B2 (en) Traveling device
JP5092683B2 (en) Inverted wheel type moving body and control method thereof
JP2015128928A (en) Inverted movable body
JP5966882B2 (en) MOBILE BODY CONTROL DEVICE, MOBILE BODY CONTROL METHOD, AND PROGRAM
JP2019151300A (en) Method for estimating degree of handle operation of inverted coaxial two-wheel vehicle
JP2017074866A (en) Overturn avoidance method of inverted two-wheel vehicle and inverted two-wheel vehicle
JP6136814B2 (en) Inverted moving body, operation state estimation device, and operation state estimation method
JP6172091B2 (en) Inverted two-wheeled mobile body and control method thereof
JP2016049948A (en) Inverted two-wheeled mobile body and control method thereof