JP2015066965A - Control method of inverted pendulum type moving body - Google Patents

Control method of inverted pendulum type moving body Download PDF

Info

Publication number
JP2015066965A
JP2015066965A JP2013200035A JP2013200035A JP2015066965A JP 2015066965 A JP2015066965 A JP 2015066965A JP 2013200035 A JP2013200035 A JP 2013200035A JP 2013200035 A JP2013200035 A JP 2013200035A JP 2015066965 A JP2015066965 A JP 2015066965A
Authority
JP
Japan
Prior art keywords
battery
motor
output
current
ecu
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
JP2013200035A
Other languages
Japanese (ja)
Other versions
JP6197533B2 (en
Inventor
平 哲也
Tetsuya Taira
哲也 平
高橋 正浩
Masahiro Takahashi
正浩 高橋
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 JP2013200035A priority Critical patent/JP6197533B2/en
Publication of JP2015066965A publication Critical patent/JP2015066965A/en
Application granted granted Critical
Publication of JP6197533B2 publication Critical patent/JP6197533B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/70Energy storage systems for electromobility, e.g. batteries
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Landscapes

  • Motorcycle And Bicycle Frame (AREA)

Abstract

PROBLEM TO BE SOLVED: To suppress output voltage reduction of a battery and improve continuity of inversion control.SOLUTION: A control method of an inverted pendulum type moving body of the invention is a control method of the inverted pendulum type moving body which moves in a posture as an inverted-pendulum by driving a motor by power supplied from a battery. The method comprises: a step for detecting a motor rotation number and a motor output torque, and at least one of a battery residual amount, a battery temperature, and a battery deterioration degree; and a step for controlling the motor rotation number and the motor output torque so that an operation point is included in an output possible area based on at least one of the battery residual amount, the battery temperature, and the battery deterioration degree, when the operation point based on the motor rotation number and the motor output torque is in a power running area and exceeds an output possible area specified by at least one of the battery residual amount, the battery temperature, and the battery deterioration degree.

Description

本発明は、倒立型移動体の制御方法に関し、特にバッテリの電力を利用してモータを制御する技術に関する。   The present invention relates to an inverted moving body control method, and more particularly to a technique for controlling a motor by using battery power.

特許文献1に開示されるように、人間を運ぶための倒立型移動体が開示されている。このような倒立型移動体は、バッテリを搭載し、バッテリから供給される電力を利用してモータを駆動することで車輪を回転させて移動する。   As disclosed in Patent Document 1, an inverted moving body for carrying a human being is disclosed. Such an inverted moving body is equipped with a battery and moves by rotating a wheel by driving a motor using electric power supplied from the battery.

特開2010−149576JP 2010-149576

本願出願人は、上述したように、バッテリを搭載し、バッテリの電力を利用して移動する倒立型移動体において、以下に説明する課題を見出した。以下、その課題について説明する。なお、以下に説明する内容は、本願出願人が新たに検討した内容であって、従来技術を説明するものではない。   As described above, the applicant of the present application has found a problem described below in an inverted mobile body that is equipped with a battery and moves using the power of the battery. The problem will be described below. In addition, the content demonstrated below is the content which the applicant of this application examined newly, and does not demonstrate a prior art.

本願出願人は、バッテリを搭載し、バッテリの電力を利用してモータを駆動することで移動する倒立型移動体の小型化・軽量化を実現するための手法として、バッテリを小型化(例えばセルの直列数又は並列数を減らす)することを検討した。しかしながら、バッテリを小型化すると、その分だけバッテリの出力性能も低下することになる。   The applicant of the present application has reduced the size of the battery (for example, a cell) as a technique for realizing a reduction in size and weight of an inverted moving body that is mounted with a battery and moves by driving a motor using the power of the battery. To reduce the number of serial or parallel). However, if the battery is downsized, the output performance of the battery will be reduced accordingly.

ここで、バッテリの出力性能は、バッテリの温度、残量、及び劣化度等の利用条件によって低下してしまうという問題がある。これは、大型のバッテリを搭載して電力的に十分な余力を持って制御を行う倒立型移動体では問題とならないが、小型化・軽量化を実現するために、バッテリを小型化して電気的に十分な余力を持っていない倒立型移動体では問題となる。   Here, there is a problem that the output performance of the battery is deteriorated depending on usage conditions such as the temperature, the remaining amount, and the deterioration degree of the battery. This is not a problem for an inverted moving body that has a large battery and controls with sufficient power, but to make it smaller and lighter, the battery can be made smaller and electrically This is a problem for an inverted mobile body that does not have sufficient capacity.

まず、バッテリを小型化した場合には電気的に十分な余力を持っていないため、利用条件の変動によってバッテリの出力性能が低下してしまうと、図8に示すように、モータの出力可能領域も減少してしまう。その理由は、バッテリには内部抵抗が存在し、より大きなモータ出力でモータを駆動しようとしてバッテリから電流をたくさん引けば引くほど、バッテリの出力電圧が低下してしまうという側面があるからである。すなわち、利用条件の変動によってバッテリの出力性能(出力電圧)が低下した状態でモータ出力を大きくしてしまうと、それにより大きい電流が引かれることでバッテリの出力電圧は非常に低いレベルまで低下してしまう。その結果、モータの駆動を制御するECUにその動作に必要な電圧が供給されなくなり、ECUが動作停止(システム停止)してしまうという問題がある。   First, when the battery is reduced in size, it does not have sufficient electrical capacity. Therefore, if the output performance of the battery decreases due to fluctuations in usage conditions, as shown in FIG. Will also decrease. The reason is that the battery has an internal resistance, and the more the current is drawn from the battery to drive the motor with a larger motor output, the lower the output voltage of the battery is. In other words, if the motor output is increased while the output performance (output voltage) of the battery is reduced due to fluctuations in usage conditions, the output voltage of the battery will drop to a very low level by drawing a larger current. End up. As a result, there is a problem that the voltage required for the operation is not supplied to the ECU that controls the driving of the motor, and the ECU stops operating (system stops).

本発明は、上述した知見に基づいてなされたものであって、バッテリの出力電圧低下を抑制して、倒立制御の継続性を向上することができる倒立型移動体の制御方法を提供することを目的とする。   The present invention has been made on the basis of the above-described knowledge, and provides an inverted moving body control method capable of suppressing a decrease in the output voltage of the battery and improving the continuity of the inverted control. Objective.

本発明の第1の態様に係る倒立型移動体の制御方法は、バッテリから供給される電力によってモータを駆動することで倒立移動する倒立型移動体の制御方法であって、前記モータの回転数及び出力トルクと、前記バッテリの残量、温度、及び劣化度の少なくとも1つを検出する工程と、前記モータの回転数及び出力トルクに基づく動作点が、力行領域にあり、且つ、前記バッテリの残量、温度、及び劣化度の少なくとも1つによって特定される出力可能領域を超えている場合、前記バッテリの残量、温度、及び劣化度の少なくとも1つに基づいて、前記動作点が前記出力可能領域に含まれるように前記モータの回転数及び出力トルクを制限する工程と、を有することを特徴とするものである。   A method for controlling an inverted moving body according to a first aspect of the present invention is a method for controlling an inverted moving body that moves in an inverted manner by driving a motor with electric power supplied from a battery. And at least one of the output torque, the remaining amount of the battery, the temperature, and the degree of deterioration, and the operating point based on the rotational speed and the output torque of the motor is in the power running region, and the battery When the output possible range specified by at least one of the remaining amount, the temperature, and the deterioration degree is exceeded, the operating point is determined based on at least one of the remaining amount, the temperature, and the deterioration degree of the battery. And limiting the rotational speed and output torque of the motor so as to be included in the possible region.

上述した本発明の各態様によれば、バッテリの出力電圧低下を抑制して、倒立制御の継続性を向上することができる倒立型移動体の制御方法を提供することができる。   According to each aspect of the present invention described above, it is possible to provide a control method for an inverted moving body that can suppress a decrease in the output voltage of the battery and improve the continuity of the inverted control.

実施の形態に係る倒立型移動体の外部構成を示す図である。It is a figure which shows the external structure of the inverted moving body which concerns on embodiment. 実施の形態に係る倒立型移動体の内部構成を示すブロック図である。It is a block diagram which shows the internal structure of the inverted moving body which concerns on embodiment. バッテリの開放端電圧特性を示す図である。It is a figure which shows the open end voltage characteristic of a battery. バッテリの内部抵抗特性を示す図である。It is a figure which shows the internal resistance characteristic of a battery. バッテリのバッテリモデル及びそれによる供給電圧を示す図である。It is a figure which shows the battery model of a battery, and the supply voltage by it. 実施の形態に係るモータの出力特性を示す図である。It is a figure which shows the output characteristic of the motor which concerns on embodiment. 実施の形態に係る倒立型移動体のモータ出力抑制処理を示すフローチャートである。It is a flowchart which shows the motor output suppression process of the inverted moving body which concerns on embodiment. モータの出力特性を示す図である。It is a figure which shows the output characteristic of a motor.

以下に図面を参照しながら、本発明の好適な実施の形態について説明する。以下の実施の形態に示す具体的な数値等は、発明の理解を容易とするための例示にすぎず、特に断る場合を除き、それに限定されるものではない。また、以下の記載及び図面では、説明の明確化のため、当業者にとって自明な事項等については、適宜、省略及び簡略化がなされている。   Hereinafter, preferred embodiments of the present invention will be described with reference to the drawings. Specific numerical values and the like shown in the following embodiments are merely examples for facilitating understanding of the invention, and are not limited thereto unless otherwise specified. In the following description and drawings, matters obvious to those skilled in the art are omitted or simplified as appropriate for the sake of clarity.

<発明の実施の形態>
図1を参照して、本実施の形態に係る倒立型移動体1の外部構成について説明する。図1は、本実施の形態に係る倒立型移動体1の外部構成を示す図である。
<Embodiment of the Invention>
With reference to FIG. 1, the external structure of the inverted moving body 1 according to the present embodiment will be described. FIG. 1 is a diagram showing an external configuration of an inverted moving body 1 according to the present embodiment.

倒立型移動体1は、ハンドル4を把持してステップカバー3に搭乗した搭乗者が、倒立型移動体1の前後方向に荷重を作用させた際における、前後方向への倒立型移動体1の姿勢角(ピッチ角)をセンサを利用して検出する。そして、倒立型移動体1は、この検出結果に基づいて、倒立型移動体1の倒立状態を維持するように左右の車輪2を回転させるモータを駆動する。すなわち、倒立型移動体1は、ステップカバー3に搭乗した搭乗者が前方に荷重を作用させて倒立型移動体1を前方に傾斜させると、倒立型移動体1の倒立状態を維持するように前方に加速し、搭乗者が後方に荷重を作用させて倒立型移動体1を後方に傾斜させると、倒立型移動体1の倒立状態を維持するように後方に加速するように、左右の車輪2を回転させるモータを駆動する。   The inverted moving body 1 is configured so that the passenger who has gripped the handle 4 and has boarded the step cover 3 applies a load in the front-rear direction of the inverted moving body 1. The attitude angle (pitch angle) is detected using a sensor. Then, based on this detection result, the inverted moving body 1 drives a motor that rotates the left and right wheels 2 so as to maintain the inverted state of the inverted moving body 1. That is, the inverted moving body 1 maintains the inverted state of the inverted moving body 1 when a passenger who has boarded the step cover 3 applies a load forward to tilt the inverted moving body 1 forward. The left and right wheels are accelerated so that when the occupant inclines backward by tilting the inverted mobile body 1 by applying a load backward, the inverted mobile body 1 is accelerated backward so as to maintain the inverted state. The motor which rotates 2 is driven.

続いて、図2を参照して、本実施の形態に係る倒立型移動体1の内部構成について説明する。図2は、本実施の形態に係る倒立型移動体1の内部構成を示すブロック図である。   Then, with reference to FIG. 2, the internal structure of the inverted mobile body 1 which concerns on this Embodiment is demonstrated. FIG. 2 is a block diagram showing an internal configuration of the inverted moving body 1 according to the present embodiment.

倒立型移動体1は、ECU(Electronic Control Unit)11、12、モータ13、14、回転角センサ15〜18、バッテリ19、20、電流センサ21〜24、及びジャイロセンサ25、26を有する。   The inverted moving body 1 includes ECUs (Electronic Control Units) 11 and 12, motors 13 and 14, rotation angle sensors 15 to 18, batteries 19 and 20, current sensors 21 to 24, and gyro sensors 25 and 26.

倒立型移動体1は、倒立型移動体1の制御の安定性を確保するために、その制御系を、0系の制御系と1系の制御系とに二重化(冗長化)させた二重系システムとなっている。すなわち、0系の制御系と1系の制御系は、同一構成となっており、その構成要素における動作も同一となっている。よって、0系のECU11と1系のECU12は、原則、同期して(同一の制御内容で)倒立型移動体1の制御を実施することになる。0系の制御系は、ECU11、回転角センサ15、16、バッテリ19、電流センサ21、22、及びジャイロセンサ25を含む。1系の制御系は、ECU12、回転角センサ17、18、バッテリ20、電流センサ23、24、及びジャイロセンサ26を含む。尚、発明の実施の形態においては二重系システムの場合について説明を行うが、単純一重系システム、三重系以上の多重系システムにおいても適用可能である。   The inverted mobile unit 1 has a duplex (redundant) control system of the control system of the 0 system and the control system of the 1 system in order to ensure the stability of the control of the inverted mobile body 1. System. That is, the 0-system control system and the 1-system control system have the same configuration, and the operation of the components is also the same. Therefore, in principle, the 0-system ECU 11 and the 1-system ECU 12 control the inverted mobile body 1 in synchronization (with the same control content). The 0-system control system includes an ECU 11, rotation angle sensors 15 and 16, a battery 19, current sensors 21 and 22, and a gyro sensor 25. The first control system includes an ECU 12, rotation angle sensors 17 and 18, a battery 20, current sensors 23 and 24, and a gyro sensor 26. In the embodiment of the present invention, the case of a dual system will be described, but the present invention can also be applied to a simple single system or a triple system or more.

ECU11、12のそれぞれは、ジャイロセンサ25、26のそれぞれから出力されるピッチ軸周りの角速度信号に基づいて、上述したように、倒立型移動体1の倒立状態を維持するようにモータ13、14を制御する。ECU11、12のそれぞれは、CPU(Central Processing Unit)及び記憶部を有し、記憶部に格納されたプログラムを実行することによって、本実施の形態におけるECU11、12のそれぞれとしての処理を実行する。すなわち、ECU11、12のそれぞれの記憶部に格納されるプログラムは、本実施の形態におけるECU11、12のそれぞれにおける処理を、CPUに実行させるためのコードを含む。なお、記憶部は、例えば、このプログラムや、CPUにおける処理に利用される各種情報を格納することができる任意の記憶装置を含んで構成される。記憶装置は、例えば、メモリ及びハードディスク等の記憶装置のうち、少なくとも1つ以上の任意のものを利用してよい。   Each of the ECUs 11 and 12 is based on the angular velocity signal around the pitch axis output from each of the gyro sensors 25 and 26, and as described above, the motors 13 and 14 maintain the inverted state of the inverted mobile body 1 as described above. To control. Each of the ECUs 11 and 12 has a CPU (Central Processing Unit) and a storage unit, and executes processing as each of the ECUs 11 and 12 in the present embodiment by executing a program stored in the storage unit. That is, the program stored in each storage part of ECU11, 12 contains the code | cord | chord for making CPU perform the process in each of ECU11,12 in this Embodiment. The storage unit includes, for example, an arbitrary storage device that can store the program and various types of information used for processing in the CPU. As the storage device, for example, at least one or more arbitrary storage devices such as a memory and a hard disk may be used.

ECU11は、モータ13を制御する指令値を算出し、算出した指令値に基づいて、モータ13のPWM(Pulse Width Modulation)制御を行う。具体的には、ECU11は、インバータ(図示せず)を有しており、インバータによって、バッテリ19から供給される電流から、モータ13に対する指令値に基づいた駆動電流を生成してモータ13に供給する。また、ECU11は、モータ14を制御する指令値を算出し、算出した指令値に基づいて、モータ14のPWM制御を行う。具体的には、ECU11は、インバータを有しており、インバータによって、バッテリ19から供給される電流から、モータ14に対する指令値に基づいた駆動電流を生成してモータ14に供給する。   The ECU 11 calculates a command value for controlling the motor 13 and performs PWM (Pulse Width Modulation) control of the motor 13 based on the calculated command value. Specifically, the ECU 11 includes an inverter (not shown). The inverter 11 generates a drive current based on a command value for the motor 13 from the current supplied from the battery 19 and supplies the drive current to the motor 13. To do. Further, the ECU 11 calculates a command value for controlling the motor 14 and performs PWM control of the motor 14 based on the calculated command value. Specifically, the ECU 11 has an inverter. The inverter 11 generates a drive current based on a command value for the motor 14 from the current supplied from the battery 19 and supplies the drive current to the motor 14.

ECU12は、モータ13を制御する指令値を算出し、算出した指令値に基づいて、モータ13のPWM制御を行う。具体的には、ECU12は、インバータ(図示せず)を有しており、インバータによって、バッテリ20から供給される電流から、モータ13に対する指令値に基づいた駆動電流を生成してモータ13に供給する。また、ECU12は、モータ14を制御する指令値を算出し、算出した指令値に基づいて、モータ14のPWM制御を行う。具体的には、ECU12は、インバータを有しており、インバータによって、バッテリ20から供給される電力から、モータ14に対する指令値に基づいた駆動電流を生成してモータ14に供給する。   The ECU 12 calculates a command value for controlling the motor 13, and performs PWM control of the motor 13 based on the calculated command value. Specifically, the ECU 12 has an inverter (not shown). The inverter 12 generates a drive current based on a command value for the motor 13 from the current supplied from the battery 20 and supplies the drive current to the motor 13. To do. Moreover, ECU12 calculates the command value which controls the motor 14, and performs PWM control of the motor 14 based on the calculated command value. Specifically, the ECU 12 includes an inverter. The inverter 12 generates a drive current based on a command value for the motor 14 from the power supplied from the battery 20 and supplies the drive current to the motor 14.

この動作によって、ECU11、12のそれぞれによって、バッテリ19、20のそれぞれから電流が引かれて、駆動電流としてモータ13、14に供給されることになる。   With this operation, current is drawn from each of the batteries 19 and 20 by the ECUs 11 and 12 and supplied to the motors 13 and 14 as drive current.

ここで、ECU11、12のそれぞれは、ジャイロセンサ25、26のそれぞれから出力される角速度信号が示す倒立型移動体1のピッチ軸周りの角速度(ピッチ角速度)を積分することで倒立型移動体1の前後方向の姿勢角(ピッチ角)を算出し、算出した姿勢角に基づいて倒立型移動体1の倒立状態を維持するようにモータ13、14を制御する指令値を生成する。   Here, each of the ECUs 11 and 12 integrates the angular velocity (pitch angular velocity) around the pitch axis of the inverted movable body 1 indicated by the angular velocity signal output from each of the gyro sensors 25 and 26, thereby inverting the movable body 1. Is calculated, and a command value for controlling the motors 13 and 14 is generated so as to maintain the inverted moving body 1 in an inverted state based on the calculated attitude angle.

また、ECU11、12のそれぞれは、回転角センサ15、17のそれぞれから出力される、モータ13の回転角を示す回転角信号に基づいて、モータ13をフィードバック制御するように指令値を生成する。また、ECU11、12のそれぞれは、回転角センサ16、18のそれぞれから出力される、モータ14の回転角を示す回転角信号に基づいて、モータ14をフィードバック制御するように指令値を生成する。   Further, each of the ECUs 11 and 12 generates a command value so as to feedback-control the motor 13 based on a rotation angle signal indicating the rotation angle of the motor 13 output from each of the rotation angle sensors 15 and 17. Further, each of the ECUs 11 and 12 generates a command value so as to feedback-control the motor 14 based on a rotation angle signal indicating the rotation angle of the motor 14 output from each of the rotation angle sensors 16 and 18.

モータ13、14のそれぞれは、二重巻線のモータである。モータ13は、ECU11及びECU12から供給される駆動電流によって駆動される。モータ13を駆動することによって、例えば倒立型移動体1の左側の車輪2が回転する。モータ14は、ECU11及びECU12から供給される駆動電流によって駆動される。モータ14を駆動することによって、例えば倒立型移動体1の右側の車輪2が回転する。   Each of the motors 13 and 14 is a double winding motor. The motor 13 is driven by a drive current supplied from the ECU 11 and the ECU 12. By driving the motor 13, for example, the left wheel 2 of the inverted moving body 1 rotates. The motor 14 is driven by a drive current supplied from the ECU 11 and the ECU 12. By driving the motor 14, for example, the right wheel 2 of the inverted moving body 1 rotates.

回転角センサ15は、モータ13の回転角を検出し、検出した回転角を示す回転角信号を生成してECU11に出力する。回転角センサ16は、モータ14の回転角を検出し、検出した回転角を示す回転角信号を生成してECU11に出力する。回転角センサ17は、モータ13の回転角を検出し、検出した回転角を示す回転角信号を生成してECU12に出力する。回転角センサ18は、モータ14の回転角を検出し、検出した回転角を示す回転角信号を生成してECU12に出力する。なお、回転角センサ15〜18として、例えばエンコーダ及びレゾルバ等のモータ13、14の回転角を検出可能なセンサのうち、任意のセンサを利用するようにしてよい。   The rotation angle sensor 15 detects the rotation angle of the motor 13, generates a rotation angle signal indicating the detected rotation angle, and outputs the rotation angle signal to the ECU 11. The rotation angle sensor 16 detects the rotation angle of the motor 14, generates a rotation angle signal indicating the detected rotation angle, and outputs the rotation angle signal to the ECU 11. The rotation angle sensor 17 detects the rotation angle of the motor 13, generates a rotation angle signal indicating the detected rotation angle, and outputs the rotation angle signal to the ECU 12. The rotation angle sensor 18 detects the rotation angle of the motor 14, generates a rotation angle signal indicating the detected rotation angle, and outputs the rotation angle signal to the ECU 12. As the rotation angle sensors 15 to 18, for example, an arbitrary sensor among sensors capable of detecting the rotation angle of the motors 13 and 14 such as an encoder and a resolver may be used.

ECU11は、回転角センサ15から出力された回転角信号が示す回転角に基づいてモータ13の回転数を算出し、回転角センサ16から出力された回転角信号が示す回転角に基づいてモータ14の回転数を算出する。ECU12は、回転角センサ17から出力された回転角信号が示す回転角に基づいてモータ13の回転数を算出し、回転角センサ18から出力された回転角信号が示す回転角に基づいてモータ14の回転数を算出する。   The ECU 11 calculates the rotation speed of the motor 13 based on the rotation angle indicated by the rotation angle signal output from the rotation angle sensor 15, and the motor 14 based on the rotation angle indicated by the rotation angle signal output from the rotation angle sensor 16. The number of rotations is calculated. The ECU 12 calculates the rotation speed of the motor 13 based on the rotation angle indicated by the rotation angle signal output from the rotation angle sensor 17, and based on the rotation angle indicated by the rotation angle signal output from the rotation angle sensor 18. The number of rotations is calculated.

電流センサ21は、ECU11からモータ13に供給される駆動電流を検出し、検出した駆動電流の電流量を示す電流量信号を生成してECU11に出力する。電流センサ22は、ECU11からモータ14に供給される駆動電流を検出し、検出した駆動電流の電流量を示す電流量信号を生成してECU11に出力する。電流センサ23は、ECU12からモータ13に供給される駆動電流を検出し、検出した駆動電流の電流量を示す電流量信号を生成してECU12に出力する。電流センサ24は、ECU12からモータ14に供給される駆動電流を検出し、検出した駆動電流の電流量を示す電流量信号を生成してECU12に出力する。   The current sensor 21 detects a drive current supplied from the ECU 11 to the motor 13, generates a current amount signal indicating the detected amount of drive current, and outputs the current amount signal to the ECU 11. The current sensor 22 detects a drive current supplied from the ECU 11 to the motor 14, generates a current amount signal indicating the detected amount of drive current, and outputs the current amount signal to the ECU 11. The current sensor 23 detects the drive current supplied from the ECU 12 to the motor 13, generates a current amount signal indicating the detected amount of drive current, and outputs the current amount signal to the ECU 12. The current sensor 24 detects a drive current supplied from the ECU 12 to the motor 14, generates a current amount signal indicating the detected amount of drive current, and outputs the current amount signal to the ECU 12.

一般的にモータの出力トルクは駆動電流に比例する。よって、ECU11は、電流センサ21から出力された電流量信号が示す駆動電流の電流量に基づいてモータ13の出力トルクを算出し、電流センサ22から出力された電流量信号が示す駆動電流の電流量に基づいてモータ14のそれぞれの出力トルクを算出する。また、ECU12は、電流センサ23から出力された電流量信号が示す駆動電流の電流量に基づいてモータ13の出力トルクを算出し、電流センサ24から出力された電流量信号が示す駆動電流の電流量に基づいてモータ14のそれぞれの出力トルクを算出する。   In general, the motor output torque is proportional to the drive current. Therefore, the ECU 11 calculates the output torque of the motor 13 based on the current amount of the drive current indicated by the current amount signal output from the current sensor 21, and the current of the drive current indicated by the current amount signal output from the current sensor 22. Each output torque of the motor 14 is calculated based on the amount. Further, the ECU 12 calculates the output torque of the motor 13 based on the current amount of the drive current indicated by the current amount signal output from the current sensor 23, and the current of the drive current indicated by the current amount signal output from the current sensor 24. Each output torque of the motor 14 is calculated based on the amount.

ここで、モータ13、14の出力トルクの算出方法は、これに限られない。例えば、ECU11、12は、指令値から出力トルクを算出するようにしてもよい。また、モータ13、14のそれぞれのトルクを検出するトルクセンサを、モータ13、14のそれぞれに対して備えるようにして、ECU11、12は、トルクセンサで検出されたモータ13、14のトルクを出力トルクとして認識するようにしてもよい。   Here, the calculation method of the output torque of the motors 13 and 14 is not limited to this. For example, the ECUs 11 and 12 may calculate the output torque from the command value. Further, a torque sensor for detecting the torque of each of the motors 13 and 14 is provided for each of the motors 13 and 14, and the ECUs 11 and 12 output the torques of the motors 13 and 14 detected by the torque sensors. You may make it recognize as a torque.

ジャイロセンサ25、26のそれぞれは、搭乗者がステップカバー3に対して、倒立型移動体1の前後方向に荷重を作用させた際における、倒立型移動体1の前後方向に対する角速度(ピッチ軸周りの角速度、ピッチ角速度)を検出し、検出した角速度を示す角速度信号をECU11、12のそれぞれに出力する。   Each of the gyro sensors 25, 26 is an angular velocity (around the pitch axis) with respect to the front-rear direction of the inverted mobile body 1 when a passenger applies a load to the step cover 3 in the front-rear direction of the inverted mobile body 1. Are detected, and angular velocity signals indicating the detected angular velocities are output to the ECUs 11 and 12, respectively.

バッテリ19は、0系の制御系の各装置に対して、その動作に必要な電力を供給する。すなわち、この電力は、上述したように、ECU11の動作や、ECU11によるモータ13、14を駆動する駆動電流の生成に利用される。また、この電力は、接続関係の図示を省略しているが、回転角センサ15、16及びジャイロセンサ25等のECU11以外のその動作に電力を要する装置にも供給されることになる。   The battery 19 supplies power necessary for the operation to each device of the 0-system control system. That is, as described above, this electric power is used for the operation of the ECU 11 and the generation of a drive current for driving the motors 13 and 14 by the ECU 11. In addition, although illustration of connection relation is omitted, this electric power is also supplied to devices that require electric power other than the ECU 11, such as the rotation angle sensors 15 and 16 and the gyro sensor 25.

また、バッテリ19は、バッテリ19の残量(例えばSOC:State Of Charge)を示す残量信号を生成し、SM(System Management Bus)バスを介してECU11に出力する。また、バッテリ19は、バッテリ19は、温度センサ(図示せず)を有しており、温度センサによって監視したバッテリ19の温度を示す温度信号を生成し、SMバスを介してECU11に出力する。また、バッテリ19は、バッテリ19の劣化度を示す劣化度信号を生成し、SMバスを介してECU11に出力する。   Further, the battery 19 generates a remaining amount signal indicating the remaining amount of the battery 19 (for example, SOC: State Of Charge), and outputs the remaining amount signal to the ECU 11 via an SM (System Management Bus) bus. The battery 19 includes a temperature sensor (not shown), generates a temperature signal indicating the temperature of the battery 19 monitored by the temperature sensor, and outputs the temperature signal to the ECU 11 via the SM bus. Further, the battery 19 generates a deterioration level signal indicating the deterioration level of the battery 19 and outputs it to the ECU 11 via the SM bus.

バッテリ20は、1系の制御系の各装置に対して、その動作に必要な電力を供給する。すなわち、この電力は、上述したように、ECU12の動作や、ECU12によるモータ13、14を駆動する駆動電流の生成に利用される。また、この電力は、接続関係の図示を省略しているが、回転角センサ17、18及びジャイロセンサ26等のECU11以外のその動作に電力を要する装置にも供給されることになる。   The battery 20 supplies power necessary for the operation to each device of the 1-system control system. That is, as described above, this electric power is used for the operation of the ECU 12 and the generation of the drive current for driving the motors 13 and 14 by the ECU 12. In addition, although the illustration of the connection relationship is omitted, this electric power is also supplied to devices that require electric power other than the ECU 11, such as the rotation angle sensors 17 and 18 and the gyro sensor 26.

また、バッテリ20は、バッテリ20の残量(例えばSOC:State Of Charge)を示す残量信号を生成し、SM(System Management Bus)バスを介してECU12に出力する。また、バッテリ20は、バッテリ20は、温度センサ(図示せず)を有しており、温度センサによって監視したバッテリ20の温度を示す温度信号を生成し、SMバスを介してECU12に出力する。また、バッテリ20は、バッテリ20の劣化度を示す劣化度信号を生成し、SMバスを介してECU12に出力する。   Further, the battery 20 generates a remaining amount signal indicating the remaining amount of the battery 20 (for example, SOC: State Of Charge), and outputs the remaining amount signal to the ECU 12 via an SM (System Management Bus) bus. The battery 20 has a temperature sensor (not shown), generates a temperature signal indicating the temperature of the battery 20 monitored by the temperature sensor, and outputs the temperature signal to the ECU 12 via the SM bus. Further, the battery 20 generates a deterioration level signal indicating the deterioration level of the battery 20 and outputs it to the ECU 12 via the SM bus.

ここで、バッテリ19、20は、CPU(図示せず)を有しており、CPUによって残量及び劣化度の算出や、上記のように信号の生成・出力の制御を行う。また、残量及び劣化度の算出方法は、任意の既知の手法によって行えばよい。例えば、バッテリ19、20の残量は、クローン・カウンタ方式で行うようにしてもよい。   Here, the batteries 19 and 20 have a CPU (not shown), and the CPU calculates the remaining amount and the degree of deterioration and controls the generation and output of signals as described above. The remaining amount and the degree of deterioration may be calculated by any known method. For example, the remaining amount of the batteries 19 and 20 may be determined by a clone counter method.

本実施の形態では、以上に説明した構成によって、利用条件(バッテリ19、20の温度、残量、及び劣化度)の変化によってバッテリ19、20の出力性能が低下したとしても、そのバッテリ19、20の出力性能で許容されるようにモータ13、14の出力(出力トルク及び回転数)を制限することで、バッテリの19、20の出力電圧の低下及びそれによるECU11、12の動作停止を抑制する。   In the present embodiment, even if the output performance of the batteries 19 and 20 is reduced due to changes in the usage conditions (temperature, remaining amount and deterioration degree of the batteries 19 and 20), the battery 19 By limiting the output (output torque and rotation speed) of the motors 13 and 14 so as to be permitted by the output performance of 20, the output voltage of the batteries 19 and 20 and the operation stop of the ECUs 11 and 12 due to this are suppressed. To do.

続いて、図3〜図5を参照して、本実施の形態に係る倒立型移動体1による出力抑制制御について説明する。図3は、バッテリ19、20の開放端電圧特性を示す図である。図4は、バッテリ19、20の内部抵抗特性を示す図である。図5は、バッテリ19、20のバッテリモデル及びそれによる供給電圧を示す図である。図6は、モータ13、14の出力特性を示す図である。   Next, output suppression control by the inverted moving body 1 according to the present embodiment will be described with reference to FIGS. FIG. 3 is a diagram illustrating open-circuit voltage characteristics of the batteries 19 and 20. FIG. 4 is a diagram showing the internal resistance characteristics of the batteries 19 and 20. FIG. 5 is a diagram showing the battery models of the batteries 19 and 20 and the supply voltage thereby. FIG. 6 is a diagram illustrating output characteristics of the motors 13 and 14.

図3に示すように、バッテリは、一般的に、バッテリ残量が少なくなるほど、その開放端電圧Vbが低くなり、バッテリの残量が多くなるほど、その開放端電圧Vbが高くなる。また、図4に示すように、バッテリは、一般的に、バッテリの残量が少なくなるほど、その内部抵抗Rbが大きくなり、バッテリ残量が多くなるほど、その内部抵抗Rbが小さくなる。また、図4に示すように、バッテリは、一般的に、バッテリの温度が低くなるほど、その内部抵抗Rbが大きくなり、バッテリの温度が高くなるほど、その内部抵抗Rbが小さくなる。また、バッテリは、一般的に、バッテリの劣化が進むほど、その内部抵抗Rbが大きくなり、バッテリが劣化していないほど、その内部抵抗Rbが小さくなる。   As shown in FIG. 3, the battery generally has a lower open-circuit voltage Vb as the remaining battery level decreases, and the open-circuit voltage Vb increases as the remaining battery level increases. As shown in FIG. 4, the battery generally has an internal resistance Rb that increases as the remaining amount of the battery decreases, and decreases as the battery remaining amount increases. As shown in FIG. 4, the battery generally has an internal resistance Rb that increases as the temperature of the battery decreases, and decreases as the temperature of the battery increases. In general, the battery has a higher internal resistance Rb as the battery deteriorates, and the internal resistance Rb decreases as the battery does not deteriorate.

ここで、バッテリは、図5に示すようにモデル化することができる。よって、このモデルに基づくと、バッテリ19、20のそれぞれから0系の制御系及び1系の制御系のそれぞれに供給される電圧(バッテリ19、20のそれぞれの出力電圧)Vinは、図5にも示すように、次式(1)で算出することができる。   Here, the battery can be modeled as shown in FIG. Therefore, based on this model, the voltages (respective output voltages of the batteries 19 and 20) Vin supplied from the batteries 19 and 20 to the 0-system control system and the 1-system control system, respectively, are shown in FIG. As also shown, it can be calculated by the following equation (1).

供給電圧Vin=バッテリ開放端電圧Vb−バッテリ内部抵抗Rb×供給電流I ・・・ (1)   Supply voltage Vin = battery open end voltage Vb−battery internal resistance Rb × supply current I (1)

すなわち、バッテリ19の内部抵抗Rbと0系の制御系に供給される電流(バッテリ19の出力電流)Iを乗算した値を、バッテリ19の開放端電圧Vbから減算することで、0系の制御系に供給される電圧Vinを算出することができる。また、バッテリ20の内部抵抗Rbと1系の制御系に供給される電流(バッテリ20の出力電流)Iを乗算した値を、バッテリ20の開放端電圧Vbから減算することで、1系の制御系に供給される電圧Vinを算出することができる。   That is, by subtracting the value obtained by multiplying the internal resistance Rb of the battery 19 and the current (output current of the battery 19) I supplied to the 0-system control system from the open-circuit voltage Vb of the battery 19, the 0-system control is performed. The voltage Vin supplied to the system can be calculated. Further, by subtracting a value obtained by multiplying the internal resistance Rb of the battery 20 and the current (output current of the battery 20) I supplied to the control system 1 from the open-circuit voltage Vb of the battery 20, the control of the 1 system The voltage Vin supplied to the system can be calculated.

また、式(1)によれば、バッテリ19、20のそれぞれの開放端電圧Vbが低下するに従って、0系及び1系の制御系のそれぞれに供給される電圧Vinも低下することが分かる。また、式(1)によれば、バッテリ19、20のそれぞれの内部抵抗Rbが大きくなるほど、0系及び1系の制御系のそれぞれに供給される電圧Vinも低下することが分かる。すなわち、図3及び図4に示す特性を考慮して言い換えると、バッテリ19、20のそれぞれの残量が少なくなるほど、0系及び1系の制御系のそれぞれに供給される電圧Vinも低下することになる。また、バッテリ19、20のそれぞれの温度が低下するほど、0系及び1系の制御系のそれぞれに供給される電圧Vinも低下することになる。また、バッテリ19、20のそれぞれの劣化が進むほど、0系及び1系の制御系のそれぞれに供給される電圧Vinも低下することになる。   Further, according to Expression (1), it can be seen that as the open circuit voltage Vb of each of the batteries 19 and 20 decreases, the voltage Vin supplied to each of the 0-system and 1-system control systems also decreases. Further, according to the expression (1), it can be seen that as the internal resistance Rb of each of the batteries 19 and 20 increases, the voltage Vin supplied to each of the 0-system and 1-system control systems also decreases. In other words, in consideration of the characteristics shown in FIGS. 3 and 4, the voltage Vin supplied to each of the 0-system and 1-system control systems decreases as the remaining amount of each of the batteries 19 and 20 decreases. become. Further, as the temperature of each of the batteries 19 and 20 decreases, the voltage Vin supplied to each of the 0-system and 1-system control systems also decreases. Further, as the deterioration of each of the batteries 19 and 20 progresses, the voltage Vin supplied to each of the 0-system and 1-system control systems also decreases.

よって、バッテリ19、20のそれぞれの残量が少なくなるほど、図6に示すように、モータ13、14の出力可能領域は減少することになる。また、バッテリ19、20のそれぞれの温度が低下するほど、図6に示すように、モータ13、14の出力可能領域は減少することになる。また、バッテリ19、20のそれぞれの劣化が進むほど、図6に示すように、モータ13、14の出力可能領域は減少することになる。言い換えると、モータ13、14の出力可能領域は、バッテリ19、20のそれぞれの残量、温度、及び劣化度から推定することができる。ここで、出力可能領域とは、ECU11、12が動作停止してしまうほどのバッテリ19、20の出力低下が発生せずに、モータ13、14の動作点が取り得る範囲となる。なお、モータ13、14の動作点は、一方の軸を出力トルクとし、他方の軸を回転数とした場合に、その座標系にプロットされる点に相当する。よって、モータ13、14の出力可能領域が減少している場合には、それに応じてモータ13、14の動作点が出力可能領域に位置するように、ECU11、12がバッテリ19、20から駆動電流を生成するために引き込む電流量を制限する必要がある。   Therefore, as the remaining amount of each of the batteries 19 and 20 decreases, the output possible area of the motors 13 and 14 decreases as shown in FIG. Further, as the temperature of each of the batteries 19 and 20 decreases, the output possible area of the motors 13 and 14 decreases as shown in FIG. Further, as the deterioration of each of the batteries 19 and 20 progresses, the output possible area of the motors 13 and 14 decreases as shown in FIG. In other words, the output possible area of the motors 13 and 14 can be estimated from the remaining amount, temperature, and deterioration degree of the batteries 19 and 20. Here, the output possible region is a range in which the operating points of the motors 13 and 14 can be obtained without causing a decrease in the output of the batteries 19 and 20 such that the ECUs 11 and 12 stop operating. The operating points of the motors 13 and 14 correspond to points plotted in the coordinate system when one axis is the output torque and the other axis is the rotation speed. Therefore, when the output possible area of the motors 13 and 14 is decreasing, the ECUs 11 and 12 are driven from the batteries 19 and 20 so that the operating points of the motors 13 and 14 are positioned in the output possible area accordingly. It is necessary to limit the amount of current drawn to generate.

そこで、本実施の形態では、ECU11、12のそれぞれは、バッテリ19、20のそれぞれの残量、温度、及び劣化度に基づいて、モータの出力(出力トルク及び回転数)が出力可能領域内となるように、モータ13、14に対する駆動電流を生成するためにバッテリ19、20から引き込む電流量を制限する。以下、図5を参照して、より具体的に、その方法について説明する。   Therefore, in the present embodiment, each of the ECUs 11 and 12 is based on the remaining amount, temperature, and degree of deterioration of each of the batteries 19 and 20, and the output of the motor (output torque and rotation speed) is within an output possible region. Thus, in order to generate a drive current for the motors 13 and 14, the amount of current drawn from the batteries 19 and 20 is limited. Hereinafter, the method will be described more specifically with reference to FIG.

バッテリ19、20の電圧低下によるECU11、12の動作停止を抑制するためには、バッテリ19、20からの供給電圧VinがECU11、12が動作停止する電圧とならないようにすればよい。言い換えると、ECU11、12が動作可能な電圧のうち、最も低い電圧(以下、「制限電圧」とも呼ぶ)未満とならないようにすればよい。この制限電圧は、例えば、ECU11、12の仕様又は事前の測定結果等に従って、予め任意の電圧を定めるようにしてよい。   In order to suppress the operation stop of the ECUs 11 and 12 due to the voltage drop of the batteries 19 and 20, the supply voltage Vin from the batteries 19 and 20 should not be a voltage at which the ECUs 11 and 12 stop operating. In other words, it is only necessary to prevent the ECUs 11 and 12 from becoming lower than the lowest voltage (hereinafter also referred to as “limit voltage”) among the operable voltages. For example, the limit voltage may be determined in advance according to the specifications of the ECUs 11 and 12, the measurement result in advance, or the like.

よって、ECU11、12は、モータ13、14の動作点が出力可能領域を超えている場合(バッテリ19、20からの供給電圧Vinが制限電圧未満となっている場合)に、上述の式(1)に基づいて、バッテリ19、20からの供給電圧Vinが制限電圧未満とならないように、バッテリ19、20から駆動電流を生成するために引き込む電流量を制限する。すなわち、ECU11、12は、バッテリ19、20からの供給電圧Vinが制限電圧となるように、バッテリ19、20から供給される電流Iを制限する。   Therefore, when the operating points of the motors 13 and 14 exceed the output possible region (when the supply voltage Vin from the batteries 19 and 20 is less than the limit voltage), the ECUs 11 and 12 ), The amount of current drawn to generate the drive current from the batteries 19 and 20 is limited so that the supply voltage Vin from the batteries 19 and 20 does not become less than the limit voltage. That is, the ECUs 11 and 12 limit the current I supplied from the batteries 19 and 20 so that the supply voltage Vin from the batteries 19 and 20 becomes the limit voltage.

ここで、出力可能領域は、上述したように、バッテリ19、20の残量、温度、及び劣化度から推定することができる。よって、ECU11、12は、バッテリ19、20の残量、温度、及び劣化度に基づいて出力可能領域を推定し、モータ13、14の動作点が、その出力可能領域を超えているか否かを判定するようにすればよい。すなわち、ECU11、12は、バッテリ19、20の残量、温度、及び劣化度の変化に応じて、適宜、出力可能領域を更新して認識する。上述したように、出力トルクは、電流センサ21〜24から出力される電流量信号が示す駆動電流の電流量から算出され、回転数は、回転角センサ15〜18から出力される回転角信号が示す回転角から算出される。   Here, as described above, the output possible region can be estimated from the remaining amount of the batteries 19 and 20, the temperature, and the degree of deterioration. Therefore, the ECUs 11 and 12 estimate the output possible area based on the remaining amount of the batteries 19 and 20, the temperature, and the degree of deterioration, and determine whether the operating points of the motors 13 and 14 exceed the output possible area. It may be determined. That is, the ECUs 11 and 12 appropriately update and recognize the output possible region according to changes in the remaining amount of the batteries 19 and 20, the temperature, and the degree of deterioration. As described above, the output torque is calculated from the current amount of the drive current indicated by the current amount signals output from the current sensors 21 to 24, and the rotation speed is determined by the rotation angle signals output from the rotation angle sensors 15 to 18. It is calculated from the indicated rotation angle.

なお、モータ13、14の動作点が出力可能領域を超えているか否かを判定は、任意の具体的手法によって実現するようにしてもよい。例えば、ECU11、12のそれぞれの記憶部において、バッテリ19、20の残量、温度、及び劣化度と、モータ13、14の回転数から、その回転数における出力可能領域の出力トルクの最大値を導出することができる情報(テーブルや算出式など)を予め格納しておくようにし、ECU11、12がその情報を利用して出力トルクの最大値を導出し、モータ13、14の出力トルクがその最大値を超えているか否かを判定するようにしてもよい。   The determination as to whether or not the operating point of the motors 13 and 14 exceeds the output possible region may be realized by any specific method. For example, in each storage unit of the ECUs 11 and 12, the maximum value of the output torque in the output possible region at the number of rotations is determined from the remaining amount of the batteries 19 and 20, the temperature and the deterioration degree, and the number of rotations of the motors 13 and 14. Information that can be derived (tables, calculation formulas, etc.) is stored in advance, and the ECUs 11 and 12 derive the maximum value of the output torque using the information, and the output torques of the motors 13 and 14 are It may be determined whether or not the maximum value is exceeded.

ECU11、12は、式(1)において、「供給電圧Vin」に、制限電圧を当てはめ、「開放端電圧Vb」に、バッテリ19、20の残量から推定した現在のバッテリ19、20の開放端電圧Vbを当てはめ、「内部抵抗Rb」に、バッテリ19、20の残量、温度、及び劣化度から推定した現在のバッテリ19、20の内部抵抗Rbを当てはめて電流Iを算出する。この算出した電流Iは、バッテリ19、20からの供給電圧Vinが制限電圧未満とならない(バッテリ19、20からの供給電圧Vinが制限電圧となる)電流量となる。そして、ECU11、12は、バッテリ19、20から供給される電流Iが、算出した電流Iとなるように、バッテリ19、20から駆動電流を生成するために引き込む電流量を制限する。   The ECUs 11 and 12 apply the limit voltage to the “supply voltage Vin” in the equation (1), and set the “open end voltage Vb” to the open end of the current batteries 19 and 20 estimated from the remaining amount of the batteries 19 and 20. The current I is calculated by applying the voltage Vb and applying the current internal resistance Rb of the batteries 19 and 20 estimated from the remaining amount of the batteries 19 and 20, the temperature, and the degree of deterioration to the “internal resistance Rb”. The calculated current I is a current amount in which the supply voltage Vin from the batteries 19 and 20 does not become less than the limit voltage (the supply voltage Vin from the batteries 19 and 20 becomes the limit voltage). Then, the ECUs 11 and 12 limit the amount of current drawn to generate the drive current from the batteries 19 and 20 so that the current I supplied from the batteries 19 and 20 becomes the calculated current I.

例えば、ECU11、12のそれぞれの記憶部において、算出した電流Iから、バッテリ19、20から供給される電流Iが算出した電流Iとなる指令値を導出することができる情報(テーブルや算出式など)を予め格納しておくようにし、ECU11、12がその情報を利用して、算出した電流Iから指令値を導出するようにすればよい。すなわち、この情報は、導出した指令値に基づいてバッテリ19、20から駆動電流を生成するための電流を引き込むことで、バッテリ19、20からの供給電圧Vinが制限電圧未満とならないようにすることができるような指令値が算出される情報とする。また、この情報に対する入力は算出した電流Iのみに限られず、さらにモータ13、14の回転数も加えることで、モータ13、14の回転数に対する逆起電圧も考慮された電流Iとなる指令値が算出されるようにしてもよい。   For example, in each of the storage units of the ECUs 11 and 12, information (tables, calculation formulas, and the like) that can derive a command value that becomes the calculated current I from the current I supplied from the batteries 19 and 20 from the calculated current I. ) In advance, and the ECUs 11 and 12 may use the information to derive the command value from the calculated current I. In other words, this information prevents the supply voltage Vin from the batteries 19 and 20 from being less than the limit voltage by drawing a current for generating a drive current from the batteries 19 and 20 based on the derived command value. It is assumed that the command value that can be used is calculated. Further, the input to this information is not limited to the calculated current I, and further, by adding the rotational speed of the motors 13 and 14, a command value that becomes the current I considering the back electromotive voltage with respect to the rotational speeds of the motors 13 and 14. May be calculated.

なお、バッテリ19、20の残量からの現在のバッテリ19、20の開放端電圧Vbの推定は、ECU11、12のそれぞれの記憶部において、バッテリ19、20から出力された残量信号が示すバッテリ19、20の残量から、そのときのバッテリ19、20の開放端電圧Vbを導出することができる情報(テーブルや算出式など)を予め格納しておくようにし、ECU11、12がその情報を利用して残量から開放端電圧Vbを導出するようにすればよい。   The estimation of the current open-circuit voltage Vb of the batteries 19 and 20 from the remaining amount of the batteries 19 and 20 is the battery indicated by the remaining amount signals output from the batteries 19 and 20 in the storage units of the ECUs 11 and 12, respectively. Information (tables, calculation formulas, etc.) that can derive the open-circuit voltage Vb of the batteries 19 and 20 at that time is stored in advance from the remaining amounts of 19 and 20, and the ECUs 11 and 12 store the information. The open end voltage Vb may be derived from the remaining amount by using it.

また、バッテリ19、20の残量、温度、及び劣化度からの現在のバッテリ19、20の内部抵抗Rbの推定も、ECU11、12のそれぞれの記憶部において、バッテリ19、20から出力された残量信号、温度信号、及び劣化度信号のそれぞれが示すバッテリ19、20の残量、温度、及び劣化度から、そのときのバッテリ19、20の内部抵抗Rbを導出することができる情報(テーブルや算出式など)を予め格納しておくようにし、ECU11、12がその情報を利用して残量、温度、及び劣化度か内部抵抗Rbを導出するようにすればよい。   In addition, the estimation of the current internal resistance Rb of the batteries 19 and 20 from the remaining amount of the batteries 19 and 20, the temperature, and the degree of deterioration is also performed in the storage units of the ECUs 11 and 12. Information that can derive the internal resistance Rb of the batteries 19 and 20 at that time from the remaining amount, temperature, and degree of deterioration of the batteries 19 and 20 indicated by the quantity signal, the temperature signal, and the deterioration level signal (table and The calculation formula etc. may be stored in advance, and the ECUs 11 and 12 may use the information to derive the remaining amount, the temperature, the degree of deterioration, or the internal resistance Rb.

なお、これらの記憶部に格納される情報は、事前にそれらの情報における対応関係を計測する等して作成すればよい。   Note that the information stored in these storage units may be created by measuring the correspondence in the information in advance.

続いて、図7を参照して、本実施の形態に係る倒立型移動体1のモータ出力抑制処理について説明する。図7は、本実施の形態に係る倒立型移動体1のモータ出力抑制処理を示すフローチャートである。なお、以下では、ECU11での処理を例に挙げて説明するが、ECU12においても同様の処理が実施される。ECU12における処理も、同様の処理となることは自明であるため、説明は省略する。例えば、以下の説明において、ECU11、回転角センサ15、16、バッテリ19、電流センサ21、22、及びジャイロセンサ25が、ECU12、回転角センサ17、18、バッテリ20、電流センタ23、24、及びジャイロセンサ26に置き換わることになる。   Then, with reference to FIG. 7, the motor output suppression process of the inverted moving body 1 which concerns on this Embodiment is demonstrated. FIG. 7 is a flowchart showing the motor output suppression process of the inverted moving body 1 according to the present embodiment. In the following, the processing in the ECU 11 will be described as an example, but the same processing is also performed in the ECU 12. Since it is obvious that the process in the ECU 12 is the same process, the description thereof is omitted. For example, in the following description, the ECU 11, the rotation angle sensors 15 and 16, the battery 19, the current sensors 21 and 22, and the gyro sensor 25 are the ECU 12, the rotation angle sensors 17 and 18, the battery 20, the current centers 23 and 24, and The gyro sensor 26 is replaced.

ECU11は、モータ13、14のそれぞれの回転数及び出力トルク、バッテリ19の残量、温度、及び劣化度を監視する(S1)。具体的には、ECU11は、回転角センサ15、16のそれぞれから出力された回転角信号を取得し、取得した回転角信号が示す回転角に基づいて、モータ13、14のそれぞれの回転数を算出する。また、ECU11は、電流センサ21から出力された電流量信号が示す電流量に基づいて、モータ13の出力トルクを算出する。また、ECU11は、電流センサ22から出力された電流量信号が示す電流量に基づいて、モータ14の出力トルクを算出する。また、ECU11は、バッテリ19から出力された残量信号が示す残量を、バッテリ19の残量として認識する。また、ECU11は、バッテリ19から出力された温度信号が示す温度を、バッテリ19の温度として認識する。また、ECU11は、バッテリ19から出力された劣化度信号が示す劣化度を、バッテリ19の劣化度として認識する。   The ECU 11 monitors the rotation speed and output torque of each of the motors 13 and 14, the remaining amount of the battery 19, the temperature, and the degree of deterioration (S1). Specifically, the ECU 11 acquires the rotation angle signal output from each of the rotation angle sensors 15 and 16, and based on the rotation angle indicated by the acquired rotation angle signal, the ECU 11 determines the rotation speed of each of the motors 13 and 14. calculate. Further, the ECU 11 calculates the output torque of the motor 13 based on the current amount indicated by the current amount signal output from the current sensor 21. Further, the ECU 11 calculates the output torque of the motor 14 based on the current amount indicated by the current amount signal output from the current sensor 22. Further, the ECU 11 recognizes the remaining amount indicated by the remaining amount signal output from the battery 19 as the remaining amount of the battery 19. Further, the ECU 11 recognizes the temperature indicated by the temperature signal output from the battery 19 as the temperature of the battery 19. Further, the ECU 11 recognizes the deterioration level indicated by the deterioration level signal output from the battery 19 as the deterioration level of the battery 19.

ECU11は、現在のモータ13、14の動作点が力行領域であるか否かを判定する(S2)。具体的には、ECU11は、算出したモータ13、14の出力トルクと、算出したモータ13、14の回転数との符号が同一であるか否かを判定する。ECU11は、出力トルクと回転数の符号が同一である場合、モータの出力が力行領域であると判定し、出力トルクと回転数の符号が異なる場合、モータの出力が力行領域でない(回生領域である)と判定する。   The ECU 11 determines whether or not the current operating point of the motors 13 and 14 is a power running region (S2). Specifically, the ECU 11 determines whether or not the signs of the calculated output torques of the motors 13 and 14 and the calculated rotation speeds of the motors 13 and 14 are the same. The ECU 11 determines that the output of the motor is in the powering region when the output torque and the number of rotations are the same, and if the output torque and the number of rotations are different, the output of the motor is not in the powering region (in the regeneration region). Is determined).

現在のモータ13、14の動作点が力行領域であると判定した場合(S2:Yes)、ECU11は、現在のモータ出力が出力可能領域であるか否かを判定する(S3)。具体的には、ECU11は、算出したモータ13、14の出力トルクと、算出したモータ13、14の回転数とに基づく動作点が、図6に示すような出力可能領域内に位置するか否かを判定する。   When it is determined that the current operating point of the motors 13 and 14 is the power running region (S2: Yes), the ECU 11 determines whether or not the current motor output is an output possible region (S3). Specifically, the ECU 11 determines whether or not the operating point based on the calculated output torque of the motors 13 and 14 and the calculated rotation speed of the motors 13 and 14 is within the output possible region as shown in FIG. Determine whether.

現在のモータ13、14の動作点が出力可能領域であると判定した場合(S3:Yes)、ECU11は、現在のモータ出力での倒立型移動体1の制御を開始(継続)する(S4)。   When it is determined that the current operating point of the motors 13 and 14 is the output possible region (S3: Yes), the ECU 11 starts (continues) the control of the inverted moving body 1 with the current motor output (S4). .

現在のモータ13、14の動作点が出力可能領域でないと判定した場合(S3:No)、ECU11は、バッテリ19から0系の制御系への供給電圧Vinが制限電圧未満となるように、モータ出力を制限する(S5)。すなわち、ECU11は、上述したように、バッテリ19から駆動電流を生成するために引き込む電流量を制限する。そして、ECU11は、制限したモータ出力での倒立型移動体1の制御を開始(継続)する(S4)。   When it is determined that the current operating point of the motors 13 and 14 is not in the output possible region (S3: No), the ECU 11 causes the motor 19 so that the supply voltage Vin from the battery 19 to the 0-system control system is less than the limit voltage. The output is limited (S5). That is, as described above, the ECU 11 limits the amount of current drawn to generate a drive current from the battery 19. Then, the ECU 11 starts (continues) the control of the inverted moving body 1 with the limited motor output (S4).

現在のモータ13、14の動作点が力行領域でない(回生領域である)と判定した場合(S2:No)、ECU11は、回生動作(回生ブレーキ)が許容されるか否かを判定する(S6)。すなわち、本実施の形態に係る倒立型移動体1では、回生動作を実施するようにしてもよい。回生動作として、回生領域での動作時にモータ13、14で発生する電力をバッテリ19に充電する充電方式としてもよく、倒立型移動体1に回生抵抗を備えるようにして回生領域での動作時にモータで発生する電力を回生抵抗によって熱に変換して放電する放電方式としてもよく、それらの方式を組み合わせた方式としてもよい。例えば、ECU11は、充電方式を実施するときには、バッテリ19の充電量が所定の閾値よりも多くなり、充電限界に達していると判定した場合に、回生が許容されないと判定する。なお、バッテリ19の充電量は、バッテリ19からの残量信号が示す残量に基づいて特定すればよい。また、ECU11は、放電方式を実施するときには、放電熱により倒立型移動体1内の温度が所定の閾値よりも高くなり、これ以上の高温化が好ましくない状態に達していると判定した場合に、回生が許容されないと判定する。倒立型移動体1内の温度として、バッテリ19からの温度信号が示す温度を利用するようにしてもよく、別途、倒立型移動体1内(例えば回生抵抗付近)に温度センサを備えるようにして、その温度センサで検出した温度を利用するようにしてもよい。   When it is determined that the current operating point of the motors 13 and 14 is not the power running region (regeneration region) (S2: No), the ECU 11 determines whether or not the regenerative operation (regenerative brake) is permitted (S6). ). That is, in the inverted moving body 1 according to the present embodiment, a regenerative operation may be performed. The regenerative operation may be a charging method in which the battery 19 is charged with the electric power generated by the motors 13 and 14 during the operation in the regenerative region. The inverted moving body 1 is provided with a regenerative resistor so that the motor is operated during the regenerative region It is good also as the discharge system which converts the electric power which generate | occur | produces into heat with regenerative resistance, and discharges, and it is good also as a system which combined those systems. For example, when implementing the charging method, the ECU 11 determines that regeneration is not permitted when it is determined that the amount of charge of the battery 19 is greater than a predetermined threshold value and has reached the charging limit. The charge amount of the battery 19 may be specified based on the remaining amount indicated by the remaining amount signal from the battery 19. When the ECU 11 determines that the temperature in the inverted moving body 1 is higher than a predetermined threshold due to the discharge heat and that a higher temperature is not preferable when the discharge method is performed. Determine that regeneration is not allowed. The temperature indicated by the temperature signal from the battery 19 may be used as the temperature in the inverted mobile body 1, and a temperature sensor is separately provided in the inverted mobile body 1 (for example, near the regenerative resistor). The temperature detected by the temperature sensor may be used.

回生動作が許容されると判定した場合(S6:Yes)、ECU11は、現在のモータ出力での倒立型移動体1の制御を開始(継続)する(S4)。   If it is determined that the regenerative operation is allowed (S6: Yes), the ECU 11 starts (continues) the control of the inverted moving body 1 with the current motor output (S4).

回生動作が許容されないと判定した場合(S6:No)、ECU11は、充電量又は放電量を制限する(S7)。例えば、ECU11は、モータ13、14からの回生電流の流入先がバッテリ19又は回生抵抗とならないように、回路的にパスを切り替えることで、それ以上に充電又は放電が実施されないようにする。そして、ECU11は、現在のモータ出力での倒立型移動体1の制御を開始(継続)する(S4)。   If it is determined that the regenerative operation is not allowed (S6: No), the ECU 11 limits the charge amount or the discharge amount (S7). For example, the ECU 11 switches the path in a circuit so that the inflow destination of the regenerative current from the motors 13 and 14 does not become the battery 19 or the regenerative resistor, thereby preventing further charging or discharging. Then, the ECU 11 starts (continues) the control of the inverted moving body 1 with the current motor output (S4).

以上に説明したように、本実施の形態では、モータ13、14の回転数及び出力トルクに基づく動作点が、力行領域にあり、且つ、バッテリ19、20の残量、温度、及び劣化度の少なくとも1つによって特定される出力可能領域を超えている場合、バッテリ19、20の残量、温度、及び劣化度の少なくとも1つに基づいて、動作点が出力可能領域に含まれるようにモータ13、14の回転数及び出力トルクを制限するようにしている。   As described above, in the present embodiment, the operating point based on the rotation speed and the output torque of the motors 13 and 14 is in the powering region, and the remaining amount of the batteries 19 and 20, the temperature, and the deterioration degree are determined. When the output possible range specified by at least one is exceeded, the motor 13 is configured so that the operating point is included in the output possible range based on at least one of the remaining amount of the batteries 19 and 20, the temperature, and the deterioration level. , 14 and the output torque are limited.

これによれば、モータ13、14を駆動するためのバッテリ19、20の消費電流を、出力可能領域に対応する許容範囲内までに低減することができる。よって、バッテリ19、20の出力電圧低下を抑制して、倒立制御の継続性を向上することができる。   According to this, current consumption of the batteries 19 and 20 for driving the motors 13 and 14 can be reduced to within an allowable range corresponding to the output possible region. Therefore, the output voltage drop of the batteries 19 and 20 can be suppressed, and the continuity of the inversion control can be improved.

なお、本発明は上記の実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。   Note that the present invention is not limited to the above-described embodiment, and can be modified as appropriate without departing from the spirit of the present invention.

上記の実施の形態では、制御系を0系と1系とに二重化した例について説明したが、これに限られない。制御系は、多重化されていなくてもよく、三重化以上に多重化されていてもよい。   In the above embodiment, the example in which the control system is duplicated into the 0 system and the 1 system has been described, but the present invention is not limited to this. The control system may not be multiplexed and may be multiplexed more than triple.

上記の実施形態では、バッテリ19、20の内部抵抗Rb及びモータ13、14の出力可能領域を、残量、温度、及び劣化度の全てに基づいて推定するようにしているが、残量、温度、及び劣化度の少なくとも1つから推定するようにしてもよい。しかしながら、好ましくは、上記の実施形態のように、残量、温度、及び劣化度の全てを利用して、内部抵抗Rb及び出力可能領域を推定することで、より高い精度でそれらを推定することができる。   In the above embodiment, the internal resistance Rb of the batteries 19 and 20 and the output possible region of the motors 13 and 14 are estimated based on all of the remaining amount, temperature, and degree of deterioration. , And at least one of the degree of deterioration. However, it is preferable to estimate the internal resistance Rb and the output possible region by using all of the remaining amount, the temperature, and the degree of deterioration, as in the above-described embodiment, and thereby estimate them with higher accuracy. Can do.

1 倒立型移動体
2 車輪
3 ステップカバー
4 ハンドル
11、12 ECU
13、14 モータ
15、16、17、18 回転角センサ
19、20 バッテリ
21、22、23、24 電流センサ
25、26 ジャイロセンサ
DESCRIPTION OF SYMBOLS 1 Inverted type mobile body 2 Wheel 3 Step cover 4 Handle 11, 12 ECU
13, 14 Motor 15, 16, 17, 18 Rotation angle sensor 19, 20 Battery 21, 22, 23, 24 Current sensor 25, 26 Gyro sensor

Claims (1)

バッテリから供給される電力によってモータを駆動することで倒立移動する倒立型移動体の制御方法であって、
前記モータの回転数及び出力トルクと、前記バッテリの残量、温度、及び劣化度の少なくとも1つを検出する工程と、
前記モータの回転数及び出力トルクに基づく動作点が、力行領域にあり、且つ、前記バッテリの残量、温度、及び劣化度の少なくとも1つによって特定される出力可能領域を超えている場合、前記バッテリの残量、温度、及び劣化度の少なくとも1つに基づいて、前記動作点が前記出力可能領域に含まれるように前記モータの回転数及び出力トルクを制限する工程と、
を有することを特徴とする倒立型移動体の制御方法。
A method for controlling an inverted moving body that moves in an inverted manner by driving a motor with electric power supplied from a battery,
Detecting at least one of the rotational speed and output torque of the motor, the remaining amount of the battery, the temperature, and the degree of deterioration;
When the operating point based on the rotational speed and output torque of the motor is in the power running region and exceeds the output possible region specified by at least one of the remaining amount, temperature, and deterioration degree of the battery, Limiting the rotational speed and output torque of the motor so that the operating point is included in the output possible region based on at least one of the remaining battery level, temperature, and degree of deterioration;
A method for controlling an inverted moving body comprising:
JP2013200035A 2013-09-26 2013-09-26 Inverted type moving body control method Active JP6197533B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2013200035A JP6197533B2 (en) 2013-09-26 2013-09-26 Inverted type moving body control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2013200035A JP6197533B2 (en) 2013-09-26 2013-09-26 Inverted type moving body control method

Publications (2)

Publication Number Publication Date
JP2015066965A true JP2015066965A (en) 2015-04-13
JP6197533B2 JP6197533B2 (en) 2017-09-20

Family

ID=52834167

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2013200035A Active JP6197533B2 (en) 2013-09-26 2013-09-26 Inverted type moving body control method

Country Status (1)

Country Link
JP (1) JP6197533B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016226116A (en) * 2015-05-28 2016-12-28 トヨタ自動車株式会社 Motor control device
JP2019068686A (en) * 2017-10-04 2019-04-25 株式会社豊田自動織機 Battery-type industrial vehicle

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10248104A (en) * 1997-03-04 1998-09-14 Honda Motor Co Ltd Controller for electric vehicle
US20100207564A1 (en) * 2009-02-18 2010-08-19 Segway Inc. Power Source Estimation Methods and Apparatus
JP2011046287A (en) * 2009-08-27 2011-03-10 Toyota Motor Corp Coaxial motorcycle and method of controlling the same
JP2011079426A (en) * 2009-10-07 2011-04-21 Honda Motor Co Ltd Inverted pendulum type moving body
JP2011223791A (en) * 2010-04-13 2011-11-04 Mitsubishi Electric Corp Control apparatus of rotating electric machine for vehicle
JP2011239629A (en) * 2010-05-13 2011-11-24 Mitsubishi Motors Corp Control device for electric vehicle
US20120175946A1 (en) * 2011-01-10 2012-07-12 Ford Global Technologies, Llc System And Method For Managing A Power Source In A Vehicle
JP2013017361A (en) * 2011-07-06 2013-01-24 Toyota Motor Corp Electric vehicle

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10248104A (en) * 1997-03-04 1998-09-14 Honda Motor Co Ltd Controller for electric vehicle
US20100207564A1 (en) * 2009-02-18 2010-08-19 Segway Inc. Power Source Estimation Methods and Apparatus
JP2011046287A (en) * 2009-08-27 2011-03-10 Toyota Motor Corp Coaxial motorcycle and method of controlling the same
JP2011079426A (en) * 2009-10-07 2011-04-21 Honda Motor Co Ltd Inverted pendulum type moving body
JP2011223791A (en) * 2010-04-13 2011-11-04 Mitsubishi Electric Corp Control apparatus of rotating electric machine for vehicle
JP2011239629A (en) * 2010-05-13 2011-11-24 Mitsubishi Motors Corp Control device for electric vehicle
US20120175946A1 (en) * 2011-01-10 2012-07-12 Ford Global Technologies, Llc System And Method For Managing A Power Source In A Vehicle
JP2013017361A (en) * 2011-07-06 2013-01-24 Toyota Motor Corp Electric vehicle

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016226116A (en) * 2015-05-28 2016-12-28 トヨタ自動車株式会社 Motor control device
JP2019068686A (en) * 2017-10-04 2019-04-25 株式会社豊田自動織機 Battery-type industrial vehicle

Also Published As

Publication number Publication date
JP6197533B2 (en) 2017-09-20

Similar Documents

Publication Publication Date Title
WO2013031558A1 (en) Battery system, charged state estimation device, electric vehicle, movable body, power storage device, and power supply device
JP5670851B2 (en) Motor control device and vehicle control device
US10024945B2 (en) Abnormality diagnosis apparatus that determines an abnormality of a power-supply voltage sensor
JP2019161688A (en) Fuel cell system mounted on vehicle
JP5494979B2 (en) Electric vehicle
JP7184516B2 (en) A system for manipulating an electric motor in an electric motorcycle, etc.
JP2014231988A (en) Battery system, charging state estimation device, electric vehicle, traveling object, power storage device and power supply device
JP5942958B2 (en) Electric vehicle
JP6410757B2 (en) Power system, transport equipment, and power transmission method
US20120187899A1 (en) Power supply system, vehicle provided with same, and control method of power supply system
US10160342B2 (en) Dynamic adjustment of battery current limits based on usage
JP6753332B2 (en) Battery system
JP6197533B2 (en) Inverted type moving body control method
JP6127550B2 (en) Construction machinery
JP5726929B2 (en) Construction machine and method for controlling construction machine
JP6024563B2 (en) Vehicle power supply control device
JP6156019B2 (en) Inverted type moving body control method
JP6652428B2 (en) Power supply system and transport equipment, and control method of power supply system
JP2018074812A (en) Vehicle control device and charge target determination method
WO2012118005A1 (en) Device for detecting condition of battery, power supply device, mobile body, charging device, accumulator pack and detection device
KR101163368B1 (en) Protection Circuit for Battery of Hybrid Motor Control Unit and Method thereof
JP2011223791A (en) Control apparatus of rotating electric machine for vehicle
JP2016119746A (en) Motor control system
JP2015074356A (en) Control method of mobile body, and two-wheeled inverted pendulum mobile body
JP2018201271A (en) Power generation control device for vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20151214

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20161222

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20170110

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20170223

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20170807

R151 Written notification of patent or utility model registration

Ref document number: 6197533

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151