JP2019090725A

JP2019090725A - Torque estimation device, torque estimation method, and torque estimation program

Info

Publication number: JP2019090725A
Application number: JP2017220441A
Authority: JP
Inventors: 小池　孝尚; Takanao Koike; 孝尚小池
Original assignee: Ricoh Co Ltd
Current assignee: Ricoh Co Ltd
Priority date: 2017-11-15
Filing date: 2017-11-15
Publication date: 2019-06-13
Anticipated expiration: 2037-11-15
Also published as: JP7000811B2

Abstract

To provide a torque estimation device, a torque estimation method, and a torque estimation program, capable of estimating a torque applied to an output shaft by double motor control at low cost and with high accuracy.SOLUTION: A torque estimation device according to one embodiment includes: a stiffness information storage part for storing stiffness information including at least one of the stiffness of a first transmission system and the stiffness of a second transmission system; and a torque calculation part for calculating the torque applied to an output shaft, based on an angle of a first motor driving an output shaft via a first transmission system, an angle of a second motor driving the output shaft through a second transmission system, and the stiffness information.SELECTED DRAWING: Figure 5

Description

本発明は、トルク推定装置、方法、及びプログラムに関する。 The present invention relates to a torque estimation device, method, and program.

従来、モータの回転により出力軸に加わったトルクを推定するトルク推定方法として、トルクセンサを利用する方法と、モータの指令値から算出する方法と、が知られている。トルクセンサを利用する方法では、出力軸の両端にトルクセンサを設置する必要があるため、コストが増大するという問題があった。また、この方法で推定精度を向上させるためには、出力軸のねじれ剛性を低下させる必要があるため、伝達特性が低下するという問題もあった。一方、モータの指令値から算出する方法では、指令値とトルクとの関係が、電源電圧やモータのコイル抵抗値、回転数、及びトルク定数などの、複数のパラメータに影響されるため、トルクを精度よく推定できないという問題があった。 Conventionally, as a torque estimation method for estimating torque applied to an output shaft by rotation of a motor, a method using a torque sensor and a method of calculating from a command value of the motor are known. In the method of using a torque sensor, since it is necessary to install a torque sensor in the both ends of an output shaft, there existed a problem that cost increased. Further, in order to improve the estimation accuracy by this method, it is necessary to reduce the torsional rigidity of the output shaft, which causes a problem that the transfer characteristic is reduced. On the other hand, in the method of calculating from the command value of the motor, the relationship between the command value and the torque is influenced by a plurality of parameters such as the power supply voltage, coil resistance value of the motor, rotation speed, and torque constant There is a problem that it can not estimate accurately.

また、他のトルク推定方法として、モータ（モータ軸）と出力軸との角度差に基づいて、トルクを推定する方法が提案されている。この方法では、モータから出力軸までの伝達系の剛性が一定であることを前提として、トルクが推定される。しかしながら、実際には、伝達系の剛性は、モータと出力軸との角度差に応じて変化するため、この方法ではトルクを精度よく推定することができなかった。 Further, as another torque estimation method, there has been proposed a method of estimating torque based on an angle difference between a motor (motor shaft) and an output shaft. In this method, torque is estimated on the premise that the rigidity of the transmission system from the motor to the output shaft is constant. However, in practice, since the stiffness of the transmission system changes in accordance with the angular difference between the motor and the output shaft, this method can not accurately estimate the torque.

ところで、近年、２つのモータにより１つの出力軸を駆動するダブルモータ制御が研究されている。ダブルモータ制御によれば、２つのモータが同一方向に回転するように電圧を印加することにより、出力軸に加えるトルクを大きくしたり、２つのモータが反対方向に回転するように電圧を印加することにより、バックラッシュを低減したりすることができる。 By the way, in recent years, double motor control in which one output shaft is driven by two motors has been studied. According to the double motor control, by applying a voltage so that the two motors rotate in the same direction, the torque applied to the output shaft is increased, or a voltage is applied so that the two motors rotate in the opposite direction Thus, backlash can be reduced.

ダブルモータ制御により出力軸に加えられたトルクは、上記従来のトルク推定方法により推定することができる。しかしながら、上述の通り、上記従来のトルク推定方法には、コストの増大、伝達系の剛性の低下、低い推定精度などの問題があった。 The torque applied to the output shaft by double motor control can be estimated by the above-described conventional torque estimation method. However, as described above, the above-described conventional torque estimation method has problems such as an increase in cost, a decrease in the rigidity of the transmission system, and a low estimation accuracy.

本発明は、上記の課題に鑑みてなされたものであり、ダブルモータ制御により出力軸に加えられたトルクを、低コストかつ高精度に推定できるトルク推定装置、方法、及びプログラムを提供することを目的とする。 The present invention has been made in view of the above problems, and it is an object of the present invention to provide a torque estimation apparatus, method and program capable of estimating torque applied to an output shaft by double motor control at low cost and with high accuracy. To aim.

一実施形態に係るトルク推定装置は、第１伝達系の剛性及び第２伝達系の剛性の少なくとも一方を含む剛性情報を記憶する剛性情報記憶部と、前記第１伝達系を介して出力軸を駆動する第１モータの角度と、第２伝達系を介して前記出力軸を駆動する第２モータの角度と、前記剛性情報と、に基づいて、前記出力軸に加わっているトルクを算出するトルク算出部を備える。 The torque estimation apparatus according to one embodiment includes a stiffness information storage unit that stores stiffness information including at least one of the stiffness of the first transmission system and the stiffness of the second transmission system, and an output shaft via the first transmission system. Torque for calculating the torque applied to the output shaft based on the angle of the first motor to be driven, the angle of the second motor to drive the output shaft via the second transmission system, and the rigidity information A calculation unit is provided.

本発明の各実施形態によれば、ダブルモータ制御により出力軸に加えられたトルクを、低コストかつ高精度に推定できるトルク推定装置、方法、及びプログラムを実現できる。 According to each embodiment of the present invention, it is possible to realize a torque estimation device, method, and program capable of estimating torque applied to an output shaft by double motor control at low cost and with high accuracy.

ダブルモータ制御により駆動される駆動系Ｄの一例を示す斜視図。The perspective view which shows an example of the drive system D driven by double motor control. 図１の駆動系Ｄの平面図。FIG. 2 is a plan view of a drive system D of FIG. 1. モータＭ１，Ｍ２に印加される電圧の一例を示すグラフ。The graph which shows an example of the voltage applied to motor M1, M2. 角度θとトルクＴとの関係を示すグラフ。The graph which shows the relation between angle theta and torque T. モータ駆動システム１００の機能構成の一例を示す図。FIG. 1 shows an example of a functional configuration of a motor drive system 100. 駆動系Ｄの模式図。The schematic diagram of drive system D. FIG. モータ駆動システム１００の動作の一例を示すフローチャート。5 is a flowchart showing an example of the operation of the motor drive system 100. トルクＴｏｕｔの推定方法を説明する図。The figure explaining the estimation method of torque Tout. 角度θ１，θ２，θｏｕｔの関係を模式的に示す図。The figure which shows typically the relationship of angle (theta) 1, (theta) 2, and (theta) out. 駆動系Ｄの一例を示す図。The figure which shows an example of the drive system D. FIG.

以下、本発明の各実施形態について、添付の図面を参照しながら説明する。なお、各実施形態に係る明細書及び図面の記載に関して、実質的に同一の機能構成を有する構成要素については、同一の符号を付することにより重畳した説明を省略する。 Hereinafter, embodiments of the present invention will be described with reference to the attached drawings. In addition, regarding the description of the specification and drawings according to each embodiment, the same reference numerals are given to components having substantially the same functional configuration, and the overlapping description will be omitted.

＜第１実施形態＞
第１実施形態に係るトルク推定装置１０について、図１〜図９を参照して説明する。本実施形態に係るトルク推定装置１０は、ダブルモータ制御により出力軸Ｓに加えられたトルクＴｏｕｔを推定する装置である。本実施形態では、出力軸Ｓに、出力軸Ｓの角度θｏｕｔを計測するエンコーダＥＳが設けられている場合について説明する。 First Embodiment
The torque estimation device 10 according to the first embodiment will be described with reference to FIGS. 1 to 9. The torque estimation device 10 according to the present embodiment is a device that estimates the torque Tout applied to the output shaft S by double motor control. In the present embodiment, a case where the output shaft S is provided with an encoder ES that measures an angle θout of the output shaft S will be described.

まず、ダブルモータ制御について説明する。図１は、ダブルモータ制御により駆動される駆動系Ｄの一例を示す斜視図である。図２は、図１の駆動系Ｄの平面図である。図１及び図２の駆動系Ｄは、モータＭ１，Ｍ２と、出力軸Ｓと、伝達系Ｇ１，Ｇ２と、を備える。なお、図１及び図２の例では省略されているが、駆動系Ｄには、モータＭ１，Ｍ２及び出力軸Ｓの角度θ１，θ２，θｏｕｔを計測するエンコーダＥ１，Ｅ２，ＥＳが含まれる。エンコーダＥ１，Ｅ２は、モータＭ１，Ｍ２に外付けされてもよいし、モータＭ１，Ｍ２に内蔵されてもよい。また、エンコーダＥＳは、出力軸Ｓに外付けされてもよいし、出力軸Ｓに内蔵されてもよい。 First, double motor control will be described. FIG. 1 is a perspective view showing an example of a drive system D driven by double motor control. FIG. 2 is a plan view of the drive system D of FIG. Drive system D of FIG. 1 and FIG. 2 includes motors M1 and M2, an output shaft S, and transmission systems G1 and G2. Although omitted in the examples of FIGS. 1 and 2, the drive system D includes the motors M1, M2 and encoders E1, E2, ES for measuring the angles θ1, θ2, θout of the output shaft S. The encoders E1 and E2 may be externally attached to the motors M1 and M2 or may be incorporated in the motors M1 and M2. The encoder ES may be externally attached to the output shaft S or may be incorporated in the output shaft S.

モータＭ１（第１モータ）は、ダブルモータ制御により制御される一方のモータである。モータＭ１は、伝達系Ｇ１を介して、出力軸ＳにトルクＴ１を加え、出力軸Ｓを駆動する。モータＭ２（第２モータ）は、ダブルモータ制御により制御される他方のモータである。モータＭ２は、伝達系Ｇ２を介して、出力軸ＳにトルクＴ２を加え、出力軸Ｓを駆動する。出力軸Ｓは、ダブルモータ制御により駆動される出力軸である。伝達系Ｇ１（第１伝達系）は、モータＭ１の回転を出力軸Ｓに伝達する複数のギアの組（減速機）である。伝達系Ｇ２（第２伝達系）は、モータＭ２の回転を出力軸Ｓに伝達する複数のギアの組（減速機）である。 The motor M1 (first motor) is one of the motors controlled by double motor control. The motor M1 applies a torque T1 to the output shaft S via the transmission system G1 to drive the output shaft S. The motor M2 (second motor) is the other motor controlled by double motor control. The motor M2 applies a torque T2 to the output shaft S via the transmission system G2 to drive the output shaft S. The output shaft S is an output shaft driven by double motor control. The transmission system G1 (first transmission system) is a set (gear) of a plurality of gears that transmits the rotation of the motor M1 to the output shaft S. The transmission system G2 (second transmission system) is a set (gear) of a plurality of gears that transmits the rotation of the motor M2 to the output shaft S.

ダブルモータ制御では、モータＭ１，Ｍ２をそれぞれ制御することにより、出力軸Ｓが駆動される。図３は、モータＭ１，Ｍ２に印加される電圧の一例を示すグラフである。図３の縦軸はモータＭ１，Ｍ２の印加電圧、横軸は電圧指令値、実線はモータＭ１の印加電圧、点線はモータＭ２の印加電圧、破線はモータＭ１，Ｍ２の平均印加電圧、一点鎖線はモータＭ１，Ｍ２の合計印加電圧である。図３の例では、モータＭ１，Ｍ２が、正電圧を印加されると出力軸Ｓに第１方向のトルクＴ１，Ｔ２を加え、負電圧を印加されると出力軸Ｓに第２方向（第１方向と反対方向）のトルクＴ１，Ｔ２を加える場合を想定している。 In the double motor control, the output shaft S is driven by controlling the motors M1 and M2, respectively. FIG. 3 is a graph showing an example of voltages applied to the motors M1 and M2. The vertical axis of FIG. 3 represents the applied voltage of the motors M1 and M2, the horizontal axis represents the voltage command value, the solid line represents the applied voltage of the motor M1, the dotted line represents the applied voltage of the motor M2, the broken line represents the average applied voltage of the motors M1 and M2, and a dashed line Is the total applied voltage of the motors M1 and M2. In the example of FIG. 3, the motors M1 and M2 apply torque T1 and T2 in the first direction to the output shaft S when a positive voltage is applied, and a second direction (output It is assumed that torques T1 and T2 in one direction and the opposite direction are applied.

図３の領域Ｒ１では、モータＭ１にリミット電圧ｌｉｍ２からオフセット電圧ｏｆｆｓｅｔ１までの電圧が印加され、モータＭ２にリミット電圧ｌｉｍ２が印加される。モータＭ１に印加される電圧が小さくなるほど、モータＭ１により出力軸Ｓに加えられる第２方向のトルクＴ１が大きくなる。領域Ｒ１では、モータＭ１，Ｍ２により出力軸Ｓに同一方向（第２方向）のトルクＴ１，Ｔ２を加えられるため、出力軸Ｓに加えられるトルクＴｏｕｔを大きくすることができる。 In the region R1 of FIG. 3, a voltage from the limit voltage lim2 to the offset voltage offset1 is applied to the motor M1, and the limit voltage lim2 is applied to the motor M2. As the voltage applied to the motor M1 decreases, the torque T1 in the second direction applied to the output shaft S by the motor M1 increases. In the region R1, since the torques T1 and T2 in the same direction (second direction) are applied to the output shaft S by the motors M1 and M2, the torque Tout applied to the output shaft S can be increased.

領域Ｒ２では、モータＭ１にオフセット電圧ｏｆｆｓｅｔ１が印加され、モータＭ２にリミット電圧ｌｉｍ２からオフセット電圧ｏｆｆｓｅｔ２までの電圧が印加される。モータＭ２に印加される電圧が小さくなるほど、モータＭ２により出力軸Ｓに加えられる第２方向のトルクＴ２が大きくなる。モータＭ２は、出力軸Ｓを第２方向に駆動する駆動用モータとして機能する。 In the region R2, the offset voltage offset1 is applied to the motor M1, and a voltage from the limit voltage lim2 to the offset voltage offset2 is applied to the motor M2. As the voltage applied to the motor M2 decreases, the torque T2 in the second direction applied to the output shaft S by the motor M2 increases. The motor M2 functions as a drive motor that drives the output shaft S in the second direction.

領域Ｒ２では、モータＭ１，Ｍ２が出力軸Ｓに反対方向のトルクＴ１，Ｔ２を加えているため、出力軸Ｓに加えられるトルクＴｏｕｔは、モータＭ１，Ｍ２が加えるトルクＴ１，Ｔ２の差となり、領域Ｒ１より小さくなる。そのかわり、モータＭ１が、伝達系Ｇ１，Ｇ２の各ギアをオフセット電圧ｏｆｆｓｅｔ１に応じた所定のトルクで互いに押し付け合わせるバックラッシュ低減用モータとして機能するため、伝達系Ｇ１，Ｇ２のバックラッシュが低減する。 In the region R2, since the motors M1 and M2 apply torque T1 and T2 in the opposite direction to the output shaft S, the torque Tout applied to the output shaft S is the difference between the torques T1 and T2 applied by the motors M1 and M2, It becomes smaller than field R1. Instead, the motor M1 functions as a backlash reduction motor that presses the gears of the transmission systems G1 and G2 with each other at a predetermined torque according to the offset voltage offset1 so that the backlash of the transmission systems G1 and G2 is reduced. .

領域Ｒ３では、モータＭ１にリミット電圧ｌｉｍ１が印加され、モータＭ２にオフセット電圧ｏｆｆｓｅｔ２からリミット電圧ｌｉｍ１までの電圧が印加される。モータＭ２に印加される電圧が大きくなるほど、モータＭ２により出力軸Ｓに加えられる第１方向のトルクＴ２が大きくなる。領域Ｒ３では、モータＭ１，Ｍ２により出力軸Ｓに同一方向（第１方向）のトルクＴ１，Ｔ２を加えられるため、出力軸Ｓに加えられるトルクＴｏｕｔを大きくすることができる。 In the region R3, the limit voltage lim1 is applied to the motor M1, and a voltage from the offset voltage offset2 to the limit voltage lim1 is applied to the motor M2. As the voltage applied to the motor M2 increases, the torque T2 in the first direction applied to the output shaft S by the motor M2 increases. In the region R3, since the torques T1 and T2 in the same direction (first direction) are applied to the output shaft S by the motors M1 and M2, the torque Tout applied to the output shaft S can be increased.

領域Ｒ４では、モータＭ１にオフセット電圧ｏｆｆｓｅｔ１からリミット電圧ｌｉｍ１までの電圧が印加され、モータＭ２にオフセット電圧ｏｆｆｓｅｔ２が印加される。モータＭ１に印加される電圧が大きくなるほど、モータＭ１により出力軸Ｓに加えられる第１方向のトルクＴ１が大きくなる。モータＭ１は、出力軸Ｓを第１方向に駆動する駆動用モータとして機能する。 In the region R4, a voltage from the offset voltage offset1 to the limit voltage lim1 is applied to the motor M1, and an offset voltage offset2 is applied to the motor M2. As the voltage applied to the motor M1 increases, the torque T1 in the first direction applied to the output shaft S by the motor M1 increases. The motor M1 functions as a drive motor that drives the output shaft S in the first direction.

領域Ｒ４では、モータＭ１，Ｍ２が出力軸Ｓに反対方向のトルクＴ１，Ｔ２を加えているため、出力軸Ｓに加えられるトルクＴｏｕｔは、モータＭ１，Ｍ２が加えるトルクＴ１，Ｔ２の差となり、領域Ｒ３より小さくなる。そのかわり、モータＭ２が、伝達系Ｇ１，Ｇ２の各ギアをオフセット電圧ｏｆｆｓｅｔ１に応じた所定のトルクで互いに押し付け合わせるバックラッシュ低減用モータとして機能するため、伝達系Ｇ１，Ｇ２のバックラッシュが低減する。 In the region R4, since the motors M1 and M2 apply the torque T1 and T2 in the opposite direction to the output shaft S, the torque Tout applied to the output shaft S is the difference between the torques T1 and T2 applied by the motors M1 and M2, It becomes smaller than field R3. Instead, the motor M2 functions as a backlash reduction motor that presses the gears of the transmission systems G1 and G2 with each other at a predetermined torque according to the offset voltage offset1 so that the backlash of the transmission systems G1 and G2 is reduced. .

このように、ダブルモータ制御では、２つのモータＭ１，Ｍ２に印加する電圧を制御することにより、出力軸Ｓに加えるトルクＴｏｕｔを大きくしたり、バックラッシュを低減したりすることができる。以下、領域Ｒ２，Ｒ４における制御のように、バックラッシュを低減させる制御を、バックラッシュ制御と称する。 As described above, in the double motor control, the torque Tout applied to the output shaft S can be increased or the backlash can be reduced by controlling the voltages applied to the two motors M1 and M2. Hereinafter, control to reduce backlash, such as control in the regions R2 and R4, is referred to as backlash control.

以上のようなダブルモータ制御を実現するためには、モータＭ１，Ｍ２により出力軸ＳにバランスよくトルクＴ１，Ｔ２を加えることが重要となる。モータＭ１，Ｍ２のトルクバランスが崩れた場合、速度変動や駆動系Ｄの変形が生じたり、伝達系Ｇ１，Ｇ２の摩耗が早まったりするおそれがある。 In order to realize double motor control as described above, it is important to apply torques T1 and T2 to the output shaft S in a well-balanced manner by the motors M1 and M2. When the torque balance of the motors M1 and M2 is lost, speed variation and deformation of the drive system D may occur, and wear of the transmission systems G1 and G2 may be accelerated.

そこで、モータＭ１，Ｍ２の角度θ１，θ２と、モータＭ１，Ｍ２が出力軸Ｓに加えるトルクＴ１，Ｔ２と、の関係について説明する。以下、モータＭ１，Ｍ２、角度θ１，θ２、及びトルクＴ１，Ｔ２を区別しない場合、それぞれモータＭ、角度θ、及びトルクＴと称する。 Thus, the relationship between the angles θ1 and θ2 of the motors M1 and M2 and the torques T1 and T2 applied to the output shaft S by the motors M1 and M2 will be described. Hereinafter, when the motors M1 and M2, the angles θ1 and θ2, and the torques T1 and T2 are not distinguished from one another, they are referred to as a motor M, an angle θ, and a torque T, respectively.

モータＭが出力軸Ｓに加えるトルクＴは、出力軸Ｓに対するモータＭの相対的な角度θに応じて変化する。図４は、角度θとトルクＴとの関係を示すグラフである。図４の角度θは、基準角度θ０からのモータＭの移動量に相当する。図４の例では、基準角度θ０（＝０°）は、モータＭの伝達系Ｇが噛み合っていない角度である。図４の実線はモータＭが出力軸Ｓに加えるトルクＴを示す。図４に示すように、角度θは、バックラッシュ領域と、低剛性領域と、高剛性領域と、異常領域と、に分類できる。 The torque T applied to the output shaft S by the motor M changes in accordance with the relative angle θ of the motor M to the output shaft S. FIG. 4 is a graph showing the relationship between the angle θ and the torque T. The angle θ in FIG. 4 corresponds to the amount of movement of the motor M from the reference angle θ0. In the example of FIG. 4, the reference angle θ0 (= 0 °) is an angle at which the transmission system G of the motor M is not engaged. The solid line in FIG. 4 indicates the torque T that the motor M applies to the output shaft S. As shown in FIG. 4, the angle θ can be classified into a backlash region, a low rigidity region, a high rigidity region, and an abnormal region.

バックラッシュ領域は、伝達系Ｇが噛み合っていない、すなわち、伝達系Ｇの各ギアの間にバックラッシュが存在する領域である。バックラッシュ領域では、モータＭが回転しても、その回転が出力軸Ｓに伝達されないため、トルクＴは０である。 The backlash region is a region where the transmission system G is not meshed, that is, there is a backlash between the gears of the transmission system G. In the backlash region, even if the motor M rotates, the rotation is not transmitted to the output shaft S, so the torque T is zero.

低剛性領域は、バックラッシュ領域に続く領域である。低剛性領域では、角度θに応じてトルクＴが徐々に大きくなる。 The low stiffness region is the region following the backlash region. In the low rigidity region, the torque T gradually increases in accordance with the angle θ.

高剛性領域は、低剛性領域に続く領域である。高剛性領域では、角度θに応じてトルクＴが線形に大きくなる。 The high stiffness region is a region following the low stiffness region. In the high rigidity region, the torque T linearly increases according to the angle θ.

異常領域は、高剛性領域に続く領域であり、想定される角度θの上限より、角度θが大きい領域である。角度θが異常領域に存在する場合、駆動系Ｄに変形などの異常が発生したと考えられる。 The abnormal area is an area following the high rigidity area, and is an area where the angle θ is larger than the upper limit of the assumed angle θ. When the angle θ is in the abnormal area, it is considered that an abnormality such as deformation has occurred in the drive system D.

ここで、角度θの変化量とトルクＴの変化量との比を剛性ｋと称する。剛性ｋは、図４の実線の傾きに相当するため、バックラッシュ領域では０となり、低剛性領域では角度θに応じて徐々に大きくなり、高剛性領域では一定となる。剛性ｋは、角度θの変化に対するトルクＴの伝わりやすさを示す値に相当し、モータＭ及び伝達系Ｇの軸や出力軸Ｓのねじれ剛性、伝達系Ｇのギアの変形、モータＭ及び伝達系Ｇの軸や出力軸Ｓの位置などに依存する。 Here, the ratio of the change amount of the angle θ to the change amount of the torque T is referred to as a rigidity k. Since the stiffness k corresponds to the inclination of the solid line in FIG. 4, it becomes 0 in the backlash region, gradually increases in accordance with the angle θ in the low stiffness region, and becomes constant in the high stiffness region. The rigidity k corresponds to a value indicating the ease of transmission of the torque T with respect to the change of the angle θ, and the torsional rigidity of the shafts of the motor M and the transmission system G and the output shaft S, the gear deformation of the transmission system G, the motor M and the transmission It depends on the axis of the system G, the position of the output axis S, and the like.

図１の例のように、伝達系Ｇに複数の軸やギアが含まれる場合、上記の影響を複数個所で受けるため、図４に示すように剛性ｋは角度θに応じて過渡的に変化する。具体的には、図４に示すように、モータＭの角度θを基準角度θ０から徐々に大きくしていくと、伝達系Ｇが噛み合うまで剛性ｋは０となる（バックラッシュ領域）。伝達系Ｇが噛み合った後、角度θを大きくすると、モータＭ及び伝達系Ｇの軸や出力軸Ｓが軸受部に順次押し付けられていき、各軸の位置が安定する。また、伝達系Ｇの各ギアが、噛み合わされたギアに押し付けられることにより変形する。この結果、剛性ｋは、徐々に大きくなる（低剛性領域）。各軸の位置が安定し、各ギアの変形が終了すると、剛性ｋは一定になる（高剛性領域）。高剛性領域では、ΔＴ＝ｋΔθが成立する。 As shown in the example of FIG. 1, when the transmission system G includes a plurality of shafts and gears, the rigidity k changes transiently in accordance with the angle θ as shown in FIG. Do. Specifically, as shown in FIG. 4, when the angle θ of the motor M is gradually increased from the reference angle θ0, the rigidity k becomes 0 until the transmission system G meshes (backlash region). After the transmission system G is engaged, when the angle θ is increased, the shafts of the motor M and the transmission system G and the output shaft S are sequentially pressed against the bearing portion, and the positions of the respective axes become stable. Further, each gear of the transmission system G is deformed by being pressed against the meshed gear. As a result, the stiffness k gradually increases (a low stiffness region). When the position of each axis is stabilized and the deformation of each gear is finished, the rigidity k becomes constant (high rigidity region). In the high rigidity region, ΔT = kΔθ holds.

次に、駆動系Ｄを駆動するモータ駆動システム１００について説明する。図５は、モータ駆動システム１００の機能構成の一例を示す図である。図５のモータ駆動システム１００は、モータ制御部１と、ＰＩＤ（Proportional Integral Differential）制御部２と、印加電圧算出部３Ａ，３Ｂと、ＰＷＭ（Pulse Width Modulation）生成部４Ａ，４Ｂと、駆動部５Ａ，５Ｂと、剛性情報記憶部６と、トルク算出部７と、異常検知部８と、を備える。 Next, the motor drive system 100 for driving the drive system D will be described. FIG. 5 is a diagram showing an example of a functional configuration of the motor drive system 100. As shown in FIG. The motor drive system 100 of FIG. 5 includes a motor control unit 1, a PID (Proportional Integral Differential) control unit 2, applied voltage calculation units 3A and 3B, PWM (Pulse Width Modulation) generation units 4A and 4B, and a drive unit. 5A, 5B, a stiffness information storage unit 6, a torque calculation unit 7, and an abnormality detection unit 8.

モータ駆動システム１００の各機能構成は、それぞれ異なるＩＣ（Integrated Circuit）により実現されてもよいし、２つ以上の機能構成が１つのＩＣにより実現されてもよい。剛性情報記憶部６、トルク算出部７、及び異常検知部８は、本実施形態におけるトルク推定装置１０に相当する。トルク推定装置１０は、ＣＰＵ（Central Processing Unit）と、ＲＯＭ（Read Only Memory）と、ＲＡＭ（Random Access Memory）と、を備えたコンピュータにより実現される。ＣＰＵがＲＯＭに記憶されたプログラムをＲＡＭ上で実行することにより、トルク推定装置１０の機能が実現される。トルク推定装置１０は、例えば、マイコンであるが、これに限られない。トルク推定装置１０には、モータ制御部１が含まれてもよい。また、以下では、ＰＩＤ制御部２から駆動部５Ａ，５Ｂまでの機能構成は、１つのＩＣ（ダブルモータコントローラ９）として実現されるものとする。 Each functional configuration of motor drive system 100 may be realized by different ICs (Integrated Circuits), or two or more functional configurations may be realized by one IC. The stiffness information storage unit 6, the torque calculation unit 7, and the abnormality detection unit 8 correspond to the torque estimation device 10 in the present embodiment. The torque estimation device 10 is realized by a computer including a central processing unit (CPU), a read only memory (ROM), and a random access memory (RAM). The function of the torque estimation device 10 is realized by the CPU executing a program stored in the ROM on the RAM. The torque estimation device 10 is, for example, a microcomputer, but is not limited to this. The torque estimation device 10 may include the motor control unit 1. Moreover, below, the functional configuration from the PID control unit 2 to the drive units 5A and 5B is realized as one IC (double motor controller 9).

モータ制御部１は、モータ駆動システム１００の全体の動作を制御する。モータ制御部１は、例えば、ＣＰＵと、ＲＯＭと、ＲＡＭと、を備えたマイコンにより実現される。ＣＰＵがＲＯＭに記憶されたプログラムをＲＡＭ上で実行することにより、モータ制御部１の機能が実現される。 Motor control unit 1 controls the overall operation of motor drive system 100. The motor control unit 1 is realized by, for example, a microcomputer including a CPU, a ROM, and a RAM. The function of the motor control unit 1 is realized by the CPU executing a program stored in the ROM on the RAM.

ＰＩＤ制御部２は、出力軸Ｓの速度及び角度の目標値と、出力軸Ｓの速度及び角度の検出値と、を入力される。出力軸Ｓの速度及び角度の目標値は、例えば、モータ制御部１から入力される。また、出力軸Ｓの速度及び角度の検出値は、出力軸Ｓに設けられたセンサから直接入力されてもよいし、モータ制御部１から入力されてもよい。ＰＩＤ制御部２は、ＰＩＤ制御により、検出値が目標値に近づくように、電圧指令値（drv_in）を算出する。 The PID control unit 2 receives the target values of the speed and angle of the output shaft S and the detected values of the speed and angle of the output shaft S. The target values of the speed and angle of the output shaft S are input from, for example, the motor control unit 1. The detected values of the speed and angle of the output shaft S may be directly input from a sensor provided on the output shaft S or may be input from the motor control unit 1. The PID control unit 2 calculates a voltage command value (drv_in) by PID control so that the detected value approaches the target value.

印加電圧算出部３Ａ，３Ｂは、ＰＩＤ制御部２から電圧指令値をそれぞれ入力される。印加電圧算出部３Ａは、入力された電圧指令値に基づいて、モータＭ１の印加電圧（drv_out1）を算出する。また、印加電圧算出部３Ｂは、入力された電圧指令値に基づいて、モータＭ２の印加電圧（drv_out2）を算出する。電圧指令値と印加電圧との関係は、図３の例のように、予め設定されている。 The applied voltage calculation units 3A and 3B receive voltage command values from the PID control unit 2, respectively. The applied voltage calculation unit 3A calculates an applied voltage (drv_out1) of the motor M1 based on the input voltage command value. Further, the applied voltage calculation unit 3B calculates the applied voltage (drv_out2) of the motor M2 based on the input voltage command value. The relationship between the voltage command value and the applied voltage is preset as in the example of FIG.

ＰＷＭ生成部４Ａは、印加電圧算出部３Ａから印加電圧を入力され、入力された印加電圧に応じたＰＷＭ信号を生成する。また、ＰＷＭ生成部４Ｂは、印加電圧算出部３Ｂから印加電圧を入力され、入力された印加電圧に応じたＰＷＭ信号を生成する。 The PWM generation unit 4A receives the applied voltage from the applied voltage calculation unit 3A, and generates a PWM signal according to the input applied voltage. Further, the PWM generation unit 4B receives the applied voltage from the applied voltage calculation unit 3B, and generates a PWM signal according to the inputted applied voltage.

駆動部５Ａは、ＰＷＭ生成部４ＡからＰＷＭ信号を入力され、入力されたＰＷＭ信号に応じた印加電圧をモータＭ１に印加する。また、駆動部５Ｂは、ＰＷＭ生成部４ＢからＰＷＭ信号を入力され、入力されたＰＷＭ信号に応じた印加電圧をモータＭ２に印加する。これにより、モータＭ１，Ｍ２が駆動され、伝達系Ｇ１，Ｇ２を介して、出力軸Ｓが駆動される。 The drive unit 5A receives a PWM signal from the PWM generation unit 4A, and applies an applied voltage corresponding to the input PWM signal to the motor M1. In addition, the drive unit 5B receives the PWM signal from the PWM generation unit 4B, and applies an applied voltage corresponding to the input PWM signal to the motor M2. Thus, the motors M1 and M2 are driven, and the output shaft S is driven via the transmission systems G1 and G2.

剛性情報記憶部６は、予め計測された、伝達系Ｇ１及び伝達系Ｇ２の少なくとも一方の剛性情報を記憶する。剛性情報には、剛性ｋや剛性比Ｋが含まれる。剛性情報については後述する。 The stiffness information storage unit 6 stores, in advance, stiffness information of at least one of the transmission system G1 and the transmission system G2. The stiffness information includes the stiffness k and the stiffness ratio K. The stiffness information will be described later.

トルク算出部７は、エンコーダＥ１からモータＭ１の角度θ１を入力され、エンコーダＥ２からモータＭ２の角度θ２を入力される。トルク算出部７は、角度θ１，θ２と、剛性情報記憶部６に記憶された剛性情報と、に基づいて、出力軸ＳのトルクＴｏｕｔを算出する。トルク算出部７が算出したトルクＴｏｕｔは、実際のトルクＴｏｕｔの推定値に相当する。トルクＴｏｕｔの算出方法については後述する。 The torque calculation unit 7 receives the angle θ1 of the motor M1 from the encoder E1 and receives the angle θ2 of the motor M2 from the encoder E2. The torque calculation unit 7 calculates the torque Tout of the output shaft S based on the angles θ1 and θ2 and the stiffness information stored in the stiffness information storage unit 6. The torque Tout calculated by the torque calculation unit 7 corresponds to an estimated value of the actual torque Tout. The method of calculating the torque Tout will be described later.

異常検知部８は、エンコーダＥ１からモータＭ１の角度θ１を入力され、エンコーダＥ２からモータＭ２の角度θ２を入力される。異常検知部８は、角度θ１，θ２に基づいて、駆動系Ｄに異常が発生したか判定する。 The abnormality detection unit 8 receives the angle θ1 of the motor M1 from the encoder E1 and receives the angle θ2 of the motor M2 from the encoder E2. The abnormality detection unit 8 determines whether an abnormality has occurred in the drive system D based on the angles θ1 and θ2.

次に、モータ駆動システム１００の動作について説明する。以下、説明を簡単にするために、駆動系Ｄの模式図を用いて説明する。図６は、駆動系Ｄの模式図である。図６の例では、伝達系Ｇ１，Ｇ２は、いずれも２つのギアからなる、減速比Ｎを有する１段の減速機である。角度θ１及びトルクＴ１は、図６の出力軸Ｓの反時計回りが正方向であり、角度θ２，θｏｕｔ及びトルクＴ２，Ｔｏｕｔは、図６の出力軸Ｓの時計回りが正方向であるものとする。また、伝達系Ｇ１，Ｇ２の剛性ｋ１，ｋ２に対する影響は、モータＭ１，Ｍ２の角度θ１，θ２に全て反映されるものとする。出力軸Ｓが停止している場合、以下の式が成り立つ。 Next, the operation of the motor drive system 100 will be described. Hereinafter, in order to simplify the description, the description will be made using a schematic diagram of the drive system D. FIG. 6 is a schematic view of the drive system D. As shown in FIG. In the example of FIG. 6, the transmission systems G1 and G2 are one-stage speed reducers each having a reduction ratio N, each of which is composed of two gears. The angle θ1 and the torque T1 are positive in the counterclockwise direction of the output shaft S in FIG. 6, and the angles θ2 and θout and the torques T2 and Tout are positive in the clockwise direction of the output shaft S in FIG. Do. The influence of the transmission systems G1 and G2 on the stiffness k1 and k2 is all reflected in the angles θ1 and θ2 of the motors M1 and M2. When the output shaft S is stopped, the following equation is established.

Ｔ１＝Ｔｏｕｔ＋Ｔ２・・・（１） T1 = Tout + T2 (1)

図７は、モータ駆動システム１００の動作の一例を示すフローチャートである。 FIG. 7 is a flowchart showing an example of the operation of the motor drive system 100.

まず、モータ制御部１は、ダブルモータコントローラ９を制御し、モータＭ１，Ｍ２に初期化電圧Ｖ１１，Ｖ２１を印加する（ステップＳ１０１）。初期化電圧Ｖ１１，Ｖ２１は、モータＭ１，Ｍ２に反対方向かつ大きさが等しいトルクＴ１，Ｔ２を発生させる電圧である。初期化電圧Ｖ１１，Ｖ２１は、モータＭ１，Ｍ２の剛性ｋ１，ｋ２が高剛性領域に含まれるように予め設定される。初期化電圧Ｖ１１，Ｖ２１の印加は、バックラッシュ制御に相当する。このとき、Ｔ１＝Ｔ２であるため、Ｔｏｕｔは０である。すなわち、出力軸Ｓは停止している。 First, the motor control unit 1 controls the double motor controller 9 to apply the initialization voltages V11 and V21 to the motors M1 and M2 (step S101). The initialization voltages V11 and V21 are voltages that generate torques T1 and T2 in the opposite directions and equal in magnitude to the motors M1 and M2, respectively. The initialization voltages V11 and V21 are preset so that the rigidity k1 and k2 of the motors M1 and M2 are included in the high rigidity region. The application of the initialization voltages V11 and V21 corresponds to backlash control. At this time, since T1 = T2, Tout is zero. That is, the output shaft S is at rest.

より詳細には、モータ制御部１は、モータＭ１に予め設定された初期化電圧Ｖ１１を印加し、モータＭ２に反対方向の小さい電圧を印加し、当該電圧を徐々に大きくしていく。モータ制御部１は、エンコーダＥＳの値を監視することにより、出力軸Ｓが基準角度（θｏｕｔ＝０）で停止する（Ｔ１＝Ｔ２となる）までモータＭ２に印加する電圧を大きくする。出力軸Ｓが基準角度で停止した際のモータＭ２の電圧が初期化電圧Ｖ２１に相当する。これにより、モータ制御部１は、モータＭ１，Ｍ２に初期化電圧Ｖ１１，Ｖ２１を印加できる。 More specifically, the motor control unit 1 applies a preset initialization voltage V11 to the motor M1, applies a small voltage in the opposite direction to the motor M2, and gradually increases the voltage. By monitoring the value of the encoder ES, the motor control unit 1 increases the voltage applied to the motor M2 until the output shaft S stops at the reference angle (θout = 0) (T1 = T2). The voltage of the motor M2 when the output shaft S stops at the reference angle corresponds to the initialization voltage V21. Thus, the motor control unit 1 can apply the initialization voltages V11 and V21 to the motors M1 and M2.

次に、トルク算出部７は、初期化電圧Ｖ１１，Ｖ２１を印加中のモータＭ１，Ｍ２の角度を、基準角度θ１１，θ２１としてエンコーダＥ１，Ｅ２から取得する（ステップＳ１０２）。ここで取得される基準角度θ１１，θ２１は、図４の高剛性領域に含まれる角度となる。 Next, the torque calculation unit 7 acquires the angles of the motors M1 and M2 during application of the initialization voltages V11 and V21 from the encoders E1 and E2 as reference angles θ11 and θ21 (step S102). The reference angles θ11 and θ21 acquired here are angles included in the high rigidity region of FIG. 4.

その後、モータ制御部１は、ダブルモータコントローラ９を制御し、出力軸Ｓの駆動を開始する（ステップＳ１０３）。 Thereafter, the motor control unit 1 controls the double motor controller 9 to start driving of the output shaft S (step S103).

出力軸Ｓの駆動が開始されると、トルク推定装置１０は、エンコーダＥ１，Ｅ２から定期的に角度θ１，θ２を取得する（ステップＳ１０４）。ここで取得される角度θ１，θ２は、ステップＳ１０２で取得した基準角度θ１１，θ２１に対する移動量に相当する。 When driving of the output shaft S is started, the torque estimation device 10 periodically acquires the angles θ1 and θ2 from the encoders E1 and E2 (step S104). The angles θ1 and θ2 acquired here correspond to movement amounts with respect to the reference angles θ11 and θ21 acquired in step S102.

そして、トルク算出部７は、取得した角度θ１，θ２と、剛性情報記憶部６に記憶された剛性情報と、に基づいて、トルクＴｏｕｔを算出する（ステップＳ１０５）。 Then, the torque calculation unit 7 calculates the torque Tout based on the acquired angles θ1 and θ2 and the stiffness information stored in the stiffness information storage unit 6 (step S105).

また、異常検知部８は、取得した角度θ１，θ２に基づいて、駆動系Ｄに異常が発生したか判定する。具体的には、異常検知部８は、角度θ１と角度θ２との差｜θ１−θ２｜が、予め設定された閾値θｔｈ以上であるか判定する（ステップＳ１０６）。 Further, the abnormality detection unit 8 determines whether an abnormality has occurred in the drive system D based on the acquired angles θ1 and θ2. Specifically, the abnormality detection unit 8 determines whether the difference | θ1−θ2 | between the angle θ1 and the angle θ2 is equal to or greater than a preset threshold θth (step S106).

差｜θ１−θ２｜が閾値θｔｈ以上である場合（ステップＳ１０６のＹＥＳ）、異常検知部８は、駆動系Ｄに異常が発生したと判定する（ステップＳ１０７）。これは、モータＭ１，Ｍ２は、伝達系Ｇ１，Ｇ２及び出力軸Ｓを介して連動しているため、駆動系Ｄが正常の場合、差｜θ１−θ２｜は閾値θｔｈ未満になると考えられるためである。異常検知部８は、異常が発生したと判定した場合、モータ制御部１にその旨を通知する。モータ制御部１は、異常の発生を通知されると、モータＭ１，Ｍ２を停止させる（ステップＳ１０８）。 If the difference | θ1−θ2 | is greater than or equal to the threshold θth (YES in step S106), the abnormality detection unit 8 determines that an abnormality has occurred in the drive system D (step S107). This is because the motors M1 and M2 are interlocked via the transmission systems G1 and G2 and the output shaft S, and therefore, it is considered that the difference | θ1−θ2 | becomes smaller than the threshold θth when the drive system D is normal. It is. If the abnormality detection unit 8 determines that an abnormality has occurred, the abnormality detection unit 8 notifies the motor control unit 1 to that effect. When notified of the occurrence of the abnormality, the motor control unit 1 stops the motors M1 and M2 (step S108).

一方、差｜θ１−θ２｜が閾値θｔｈ未満である場合（ステップＳ１０６のＮＯ）、異常検知部８は、駆動系Ｄは正常と判定する（ステップＳ１０９）。異常検知部８は、正常と判定した場合、モータ制御部１にその旨を通知する。モータ制御部１は、正常である旨を通知されると、モータＭ１，Ｍ２の制御を継続する。 On the other hand, if the difference | θ1−θ2 | is less than the threshold θth (NO in step S106), the abnormality detection unit 8 determines that the drive system D is normal (step S109). When the abnormality detection unit 8 determines that the operation is normal, the abnormality detection unit 8 notifies the motor control unit 1 of that. When notified that the motor control unit 1 is normal, the motor control unit 1 continues control of the motors M1 and M2.

トルク推定装置１０は、出力軸Ｓの駆動が終了するまで、ステップＳ１０４〜Ｓ１０７，Ｓ１０９の動作を繰り返す。 The torque estimation device 10 repeats the operations of steps S104 to S107 and S109 until the driving of the output shaft S is completed.

ここで、トルクＴｏｕｔの推定方法について説明する。以下の推定方法は、図７のステップＳ１０５の内部処理に相当する。図８は、トルクＴｏｕｔの推定方法を説明する図である。図８の左側はモータＭ１のトルクＴ１を示し、図８の右側はモータＭ２のトルクＴ２を示す。図８のＴ０は、初期化電圧Ｖ１１，Ｖ２１の印加時のトルクＴ１，Ｔ２であり（Ｔ１＝Ｔ２＝Ｔ０）、θ１２，θ２２は、高剛性領域の始点である。また、高剛性領域における剛性ｋ１，ｋ２を、それぞれ剛性ｋ１１，ｋ２１と称する。 Here, a method of estimating the torque Tout will be described. The following estimation method corresponds to the internal processing of step S105 in FIG. FIG. 8 is a diagram for explaining a method of estimating the torque Tout. The left side of FIG. 8 shows the torque T1 of the motor M1, and the right side of FIG. 8 shows the torque T2 of the motor M2. T0 in FIG. 8 is torques T1 and T2 at the time of application of the initialization voltages V11 and V21 (T1 = T2 = T0), and θ12 and θ22 are starting points of the high rigidity region. Further, the stiffness k1 and k2 in the high stiffness region are respectively referred to as stiffness k11 and k21.

（第１の推定方法）
第１の推定方法は、剛性ｋ１１，ｋ２１が剛性情報として剛性情報記憶部６に予め記憶されている場合に利用できる。上述の通り、ステップＳ１０４で取得される角度θ１，θ２は、高剛性領域に含まれる基準角度θ１１，θ２１に対する移動量であるため、図８からわかるように、トルクＴ１，Ｔ２について以下の式が成り立つ。 (First estimation method)
The first estimation method can be used when the stiffness k11 and k21 are stored in advance in the stiffness information storage unit 6 as stiffness information. As described above, since the angles θ1 and θ2 acquired in step S104 are movement amounts relative to the reference angles θ11 and θ21 included in the high rigidity region, as can be seen from FIG. It holds.

Ｔ１＝Ｔ０＋ｋ１１×θ１・・・（２）
Ｔ２＝Ｔ０＋ｋ２１×θ２・・・（３） T1 = T0 + k11 × θ1 (2)
T2 = T0 + k21 × θ2 (3)

式（１）を変形し、式（２），（３）を代入すると、以下のようになる。 Transforming equation (1) and substituting equations (2) and (3) gives the following.

Ｔｏｕｔ＝Ｔ１−Ｔ２＝Ｔ０＋ｋ１１×θ１−（Ｔ０＋ｋ２１×θ２）
＝ｋ１１×θ１−ｋ２１×θ２・・・（４） Tout = T1-T2 = T0 + k11 × θ1- (T0 + k21 × θ2)
= K11 x θ 1-k 21 x θ 2 (4)

したがって、トルク算出部７は、剛性情報（剛性ｋ１１，ｋ２１）と、角度θ１，θ２と、に基づいて、式（４）により、トルクＴｏｕｔを算出できる。 Therefore, the torque calculation unit 7 can calculate the torque Tout by the equation (4) based on the rigidity information (rigidity k11, k21) and the angles θ1 and θ2.

（第２の推定方法）
第２の推定方法は、剛性ｋ１１又は剛性ｋ２１が剛性情報として剛性情報記憶部６に予め記憶されており、剛性ｋ１１，ｋ２１が等しいことがわかっている場合に利用できる。 (Second estimation method)
The second estimation method can be used when the stiffness k11 or the stiffness k21 is stored in advance in the stiffness information storage unit 6 as stiffness information, and it is known that the stiffness k11 and k21 are equal.

剛性ｋ１１，ｋ２１が等しい場合、式（４）は、以下のように変形できる。 If the stiffness k11 and k21 are equal, equation (4) can be modified as follows.

Ｔｏｕｔ＝ｋ１１（θ１−θ２）＝ｋ２１（θ１−θ２）・・・（５） Tout = k11 (θ1−θ2) = k21 (θ1−θ2) (5)

したがって、トルク算出部７は、剛性情報（剛性ｋ１１又は剛性ｋ２１）と、角度θ１，θ２と、に基づいて、式（５）により、トルクＴｏｕｔを算出できる。 Therefore, the torque calculation unit 7 can calculate the torque Tout by the equation (5) based on the rigidity information (rigidity k11 or rigidity k21) and the angles θ1 and θ2.

（第３の推定方法）
第３の推定方法は、剛性ｋ１１又は剛性ｋ２１と、剛性比Ｋと、が剛性情報として剛性情報記憶部６に予め記憶されている場合に利用できる。剛性比Ｋは、剛性ｋ１と剛性ｋ２との比である（Ｋ＝ｋ２／ｋ１）。 (Third estimation method)
The third estimation method can be used when the rigidity k11 or k21 and the rigidity ratio K are stored in the rigidity information storage unit 6 in advance as rigidity information. The stiffness ratio K is the ratio of the stiffness k1 to the stiffness k2 (K = k2 / k1).

第３の推定方法では、トルク算出部７は、剛性比Ｋと、剛性ｋ１１，ｋ２１の一方と、に基づいて、剛性ｋ１１，ｋ２１の他方を算出する。例えば、剛性情報に剛性比Ｋ及び剛性ｋ１１が含まれる場合、剛性ｋ２１は、ｋ１１×Ｋにより求められる。また、剛性情報に剛性比Ｋ及び剛性ｋ２１が含まれる場合、剛性ｋ１１は、ｋ２１／Ｋにより求められる。したがって、トルク算出部７は、剛性情報（剛性ｋ１１又は剛性ｋ２１と剛性比Ｋ）と、角度θ１，θ２と、に基づいて、式（４）により、トルクＴｏｕｔを算出できる。 In the third estimation method, the torque calculation unit 7 calculates the other of the stiffness k11 and k21 based on the stiffness ratio K and one of the stiffness k11 and k21. For example, when the stiffness information includes the stiffness ratio K and the stiffness k11, the stiffness k21 is obtained by k11 × K. When the stiffness information includes the stiffness ratio K and the stiffness k21, the stiffness k11 is determined by k21 / K. Therefore, the torque calculation unit 7 can calculate the torque Tout by the equation (4) based on the rigidity information (the rigidity k11 or the rigidity k21 and the rigidity ratio K) and the angles θ1 and θ2.

（第４の推定方法）
第１から第３までの推定方法では、角度θ１，θ２が高剛性領域に含まれる場合、トルクＴｏｕｔを精度よく推定できる。しかしながら、角度θ１，θ２が高剛性領域に含まれない場合、トルクＴｏｕｔの推定精度が低下する。そこで、第４の推定方法では、バックラッシュ領域及び低剛性領域におけるトルクＴｏｕｔを近似した関数を利用して、トルクＴｏｕｔを推定する。なお、第４の方法では、角度θ１，θ２は、それぞれトルクＴ１，Ｔ２が０になる角度θ１３，θ２３（モータＭ１，Ｍ２に電圧を印加していない時の角度）を、基準角度として計測される。 (The fourth estimation method)
In the first to third estimation methods, when the angles θ1 and θ2 are included in the high rigidity region, the torque Tout can be accurately estimated. However, when the angles θ1 and θ2 are not included in the high rigidity region, the estimation accuracy of the torque Tout decreases. Therefore, in the fourth estimation method, the torque Tout is estimated using a function that approximates the torque Tout in the backlash region and the low rigidity region. In the fourth method, the angles θ1 and θ2 are measured using the angles θ13 and θ23 (the angle when no voltage is applied to the motors M1 and M2) at which the torques T1 and T2 become 0, respectively, as a reference angle. Ru.

第４の推定方法は、剛性ｋ１１，ｋ２１と、高剛性領域の始点θ１２，θ２２と、関数Ｔ１（θ１），Ｔ２（θ２）と、が剛性情報として剛性情報記憶部６に予め記憶されている場合に利用できる。 In the fourth estimation method, the stiffness k11 and k21, the start points θ12 and θ22 of the high stiffness region, and the functions T1 (θ1) and T2 (θ2) are stored in advance in the stiffness information storage unit 6 as stiffness information. If available.

例えば、バックラッシュ領域及び低剛性領域におけるトルクＴ１を二次関数で近似する場合、トルクＴ１は以下の式で表される。 For example, when the torque T1 in the backlash region and the low rigidity region is approximated by a quadratic function, the torque T1 is expressed by the following equation.

［θ１≦θ１２］Ｔ１（θ１）＝ａ×θ１^２・・・（６）
［θ１＞θ１２］Ｔ１（θ１）＝ｋ１１×（θ１−θ１２）＋ａ×θ１２^２・・・（７） [Θ1 ≦ θ12] T1 (θ1) = a × θ1 ² (6)
[Θ1> θ12] T1 (θ1) = k11 × (θ1−θ12) + a × θ12 ² (7)

式（６），（７）の接合部の傾きを連続させると、式（６），（７）より以下の式が成り立つ。 When the inclinations of the junctions of the equations (6) and (7) are made continuous, the following equation is established from the equations (6) and (7).

ｋ１１＝２ａ×θ１２・・・（８） k11 = 2a × θ12 (8)

したがって、式（６）〜（８）より、関数Ｔ１（θ１）は、以下のようになる。 Therefore, according to equations (6) to (8), the function T1 (θ1) is as follows.

［θ１≦θ１２］Ｔ１（θ１）＝ｋ１１×θ１^２／２θ１２・・・（９）
［θ１＞θ１２］Ｔ１（θ１）＝ｋ１１×（θ１−θ１２／２）・・・（１０） [Θ1 ≦ θ12] T1 (θ1) = k11 × θ1 ² / 2θ12 (9)
[Θ1> θ12] T1 (θ1) = k11 × (θ1−θ12 / 2) (10)

同様に、トルクＴ２について以下の式が成り立つ。 Similarly, the following equation holds for the torque T2.

［θ２≦θ２２］Ｔ２（θ２）＝ｋ２１×θ２^２／２θ１２・・・（１１）
［θ２＞θ２２］Ｔ２（θ２）＝ｋ２１×（θ２−θ２２／２）・・・（１２） [Θ2 ≦ θ22] T2 (θ2) = k21 × θ2 ² / 2θ12 (11)
[Θ2> θ22] T2 (θ2) = k21 × (θ2-θ22 / 2) (12)

このとき、トルクＴｏｕｔは以下のように表される。 At this time, the torque Tout is expressed as follows.

Ｔｏｕｔ＝Ｔ１（θ１）−Ｔ２（θ２）・・・（１３） Tout = T1 (θ1) -T2 (θ2) (13)

したがって、トルク算出部７は、剛性情報（剛性ｋ１１，ｋ２１、高剛性領域の始点θ１２，θ２２、及び関数Ｔ１（θ１），Ｔ２（θ２））と、角度θ１，θ２と、に基づいて、式（９）〜（１３）により、トルクＴｏｕｔを算出できる。第４の推定方法では、角度θ１，θ２が高剛性領域に含まれない場合であっても、トルクＴｏｕｔを精度よく推定できる。 Therefore, the torque calculation unit 7 performs an expression based on the stiffness information (stiffness k11, k21, starting points .theta.12, .theta.22 of the high stiffness region, and functions T1 (.theta.1), T2 (.theta.2)) and the angles .theta.1, .theta.2. The torque Tout can be calculated by (9) to (13). In the fourth estimation method, the torque Tout can be accurately estimated even when the angles θ1 and θ2 are not included in the high rigidity region.

（第５の推定方法）
第５の推定方法は、剛性ｋ１１，ｋ２１が剛性情報として剛性情報記憶部６に予め記憶されている場合に利用できる。 (Fifth estimation method)
The fifth estimation method can be used when the stiffness k11 and k21 are stored in advance in the stiffness information storage unit 6 as stiffness information.

出力軸Ｓに外部からトルクが加わると、このトルクにより、出力軸Ｓの角度がずれる（角度θｏｕｔが０ではなくなる）。そして、出力軸Ｓのずれにより、モータＭ１，Ｍ２が出力軸Ｓに加えるトルクＴ１，Ｔ２が変化する。 When torque is externally applied to the output shaft S, the angle of the output shaft S is shifted by this torque (the angle θout is not zero). Then, due to the deviation of the output shaft S, the torques T1 and T2 applied to the output shaft S by the motors M1 and M2 change.

ここで、図９は、角度θ１，θ２，θｏｕｔの関係を模式的に示す図である。図９の例では、モータＭ１，Ｍ２及び出力軸Ｓが弾性系として表されている。この場合、剛性ｋ１は、モータＭ１と出力軸Ｓとを接続するバネの弾性係数に相当し、剛性ｋ２は、モータＭ２と出力軸Ｓとを接続するバネの弾性係数に相当する。また、角度θ１，θ２及びＮ×θｏｕｔは、それぞれモータＭ１，Ｍ２及び出力軸Ｓの基準位置からの移動量に相当する。出力軸Ｓが角度θｏｕｔだけ移動すると、モータＭ１，Ｍ２がＮ×θｏｕｔだけ移動するためである。角度θ１及びトルクＴ１は、図９の右方向が正方向であり、角度θ２，θｏｕｔ及びトルクＴ２，Ｔｏｕｔは、図９の左方向が正方向であるものとする。このとき、式（２），（３）は以下のように書き換えられる。 Here, FIG. 9 is a view schematically showing the relationship between the angles θ1, θ2, and θout. In the example of FIG. 9, the motors M1 and M2 and the output shaft S are represented as an elastic system. In this case, the rigidity k1 corresponds to the elastic coefficient of the spring connecting the motor M1 and the output shaft S, and the rigidity k2 corresponds to the elastic coefficient of the spring connecting the motor M2 and the output shaft S. Further, the angles θ1, θ2 and N × θ out correspond to the amounts of movement of the motors M1, M2 and the output shaft S from the reference positions, respectively. When the output shaft S moves by the angle θout, the motors M1 and M2 move by N × θout. The angle θ1 and the torque T1 are positive in the right direction in FIG. 9, and the angles θ2 and θout and the torques T2 and Tout are positive in the left direction in FIG. At this time, the equations (2) and (3) are rewritten as follows.

Ｔ１＝Ｔ０＋ｋ１１×（θ１＋Ｎ×θｏｕｔ）・・・（１４）
Ｔ２＝Ｔ０＋ｋ２１×（θ２−Ｎ×θｏｕｔ）・・・（１５） T1 = T0 + k11 × (θ1 + N × θout) (14)
T2 = T0 + k21 × (θ2−N × θout) (15)

式（１）を変形し、式（１４），（１５）を代入すると、以下のようになる。 Transforming equation (1) and substituting equations (14) and (15) gives the following.

Ｔｏｕｔ＝Ｔ１−Ｔ２＝Ｔ０＋ｋ１１×（θ１＋Ｎ×θｏｕｔ）−｛Ｔ０＋ｋ２１×（θ２−Ｎ×θｏｕｔ）｝
＝ｋ１１×（θ１＋Ｎ×θｏｕｔ）−ｋ２１×（θ２−Ｎ×θｏｕｔ）・・・（１６） Tout = T1−T2 = T0 + k11 × (θ1 + N × θout) − {T0 + k21 × (θ2−N × θout)}
= K11 x (? 1 + N x? Out)-k21 x (? 2-N x? Out) (16)

したがって、トルク算出部７は、剛性情報（剛性ｋ１１，ｋ２１）と、角度θ１，θ２，θｏｕｔと、に基づいて、式（１６）により、トルクＴｏｕｔを算出できる。トルク算出部７は、角度θｏｕｔをエンコーダＥＳから取得すればよい。 Therefore, the torque calculation unit 7 can calculate the torque Tout according to equation (16) based on the rigidity information (rigidity k11, k21) and the angles θ1, θ2, θout. The torque calculation unit 7 may obtain the angle θout from the encoder ES.

以上説明した通り、本実施形態によれば、ダブルモータ制御により出力軸Ｓに加えられたトルクＴｏｕｔを、角度θ１，θ２及び剛性情報に基づいて、高精度に推定することができる。また、トルクＴｏｕｔを推定するために、トルクセンサが不要であるため、トルクＴｏｕｔの推定に要するコストを低減すると共に、推定精度を向上させるための伝達系Ｇ１，Ｇ２の剛性の低下を抑制することができる。 As described above, according to the present embodiment, the torque Tout applied to the output shaft S by double motor control can be estimated with high accuracy based on the angles θ1 and θ2 and the rigidity information. In addition, since a torque sensor is not necessary to estimate the torque Tout, the cost required to estimate the torque Tout can be reduced, and a reduction in the rigidity of the transmission systems G1 and G2 for improving the estimation accuracy can be suppressed. Can.

＜第２実施形態＞
第２実施形態に係るトルク推定装置１０について説明する。本実施形態では、出力軸ＳにエンコーダＥＳが設けられていない場合について説明する。なお、モータ駆動システム１００の構成及び動作は、第１実施形態と同様である。また、駆動系Ｄの構成は、エンコーダＥＳを備えない点を除き、第１実施形態と同様である。 Second Embodiment
The torque estimation device 10 according to the second embodiment will be described. In the present embodiment, the case where the encoder ES is not provided on the output shaft S will be described. The configuration and operation of the motor drive system 100 are the same as in the first embodiment. Further, the configuration of the drive system D is the same as that of the first embodiment except that the encoder ES is not provided.

まず、本実施形態におけるステップＳ１０１〜Ｓ１０３について説明する。本実施形態において、まず、モータ制御部１は、ダブルモータコントローラ９を制御し、モータＭ１，Ｍ２に初期化電圧Ｖ１２，Ｖ２２を印加する（ステップＳ１０１）。初期化電圧Ｖ１２，Ｖ２２は、モータＭ１，Ｍ２に反対方向かつ大きさが等しいトルクＴ１，Ｔ２を発生させる電圧である。初期化電圧Ｖ１２，Ｖ２２は、モータＭ１，Ｍ２の剛性ｋ１，ｋ２が高剛性領域に含まれるように予め設定される。初期化電圧Ｖ１２，Ｖ２２の印加は、バックラッシュ制御に相当する。このとき、Ｔ１＝Ｔ２であるため、Ｔｏｕｔは０である。すなわち、出力軸Ｓは停止している。 First, steps S101 to S103 in the present embodiment will be described. In the present embodiment, first, the motor control unit 1 controls the double motor controller 9 to apply the initialization voltages V12 and V22 to the motors M1 and M2 (step S101). The initialization voltages V12 and V22 are voltages that generate torques T1 and T2 in the opposite directions and equal in magnitude to the motors M1 and M2, respectively. The initialization voltages V12 and V22 are preset so that the rigidity k1 and k2 of the motors M1 and M2 are included in the high rigidity region. The application of the initialization voltages V12 and V22 corresponds to backlash control. At this time, since T1 = T2, Tout is zero. That is, the output shaft S is at rest.

より詳細には、モータＭ１に予め設定された初期化電圧Ｖ１２を印加し、モータＭ２に反対方向の小さい電圧を印加し、当該電圧を徐々に大きくしていく。モータ制御部１は、エンコーダＥ１，Ｅ２の値を監視することにより、出力軸Ｓが停止する（Ｔ１＝Ｔ２となる）までモータＭ２に印加する電圧を大きくする。出力軸Ｓが停止した際のモータＭ２の電圧が初期化電圧Ｖ２２に相当する。これにより、モータ制御部１は、モータＭ１，Ｍ２に初期化電圧Ｖ１２，Ｖ２２を印加できる。 More specifically, a preset initialization voltage V12 is applied to the motor M1, a small voltage in the opposite direction is applied to the motor M2, and the voltage is gradually increased. The motor control unit 1 increases the voltage applied to the motor M2 until the output shaft S stops (T1 = T2) by monitoring the values of the encoders E1 and E2. The voltage of the motor M2 when the output shaft S stops corresponds to the initialization voltage V22. Thus, the motor control unit 1 can apply the initialization voltages V12 and V22 to the motors M1 and M2.

次に、トルク算出部７は、初期化電圧Ｖ１２，Ｖ２２を印加中のモータＭ１，Ｍ２の角度を、基準角度θ１４，θ２４としてエンコーダＥ１，Ｅ２から取得する（ステップＳ１０２）。ここで取得される基準角度θ１４，θ２４は、図４の高剛性領域に含まれる角度となる。 Next, the torque calculation unit 7 acquires the angles of the motors M1 and M2 during application of the initialization voltages V12 and V22 from the encoders E1 and E2 as reference angles θ14 and θ24 (step S102). The reference angles θ14 and θ24 acquired here are angles included in the high rigidity region of FIG. 4.

ここで、第１実施形態との相違点について説明する。第１実施形態では、モータ制御部１は、エンコーダＥＳの値を監視し、出力軸Ｓを基準角度（θｏｕｔ＝０）で停止させた。このため、θｏｕｔ＝０のときの角度θ１，θ２が基準角度θ１１，θ２１として取得され、式（２），（３）が成り立った。 Here, differences from the first embodiment will be described. In the first embodiment, the motor control unit 1 monitors the value of the encoder ES and stops the output shaft S at the reference angle (θout = 0). Therefore, the angles θ1 and θ2 at θout = 0 are acquired as the reference angles θ11 and θ21, and the equations (2) and (3) hold.

これに対して、本実施形態では、エンコーダＥＳが利用できないため、初期化電圧Ｖ１２，Ｖ２２の印加時に、出力軸Ｓがどこで停止するかわからない。すなわち、図９の例のように、出力軸Ｓがずれた角度で停止する可能性がある。このため、θｏｕｔ≠０のときの角度θ１，θ２が基準角度θ１４，θ２４として取得される。結果として、図９の例と同様に、トルクＴ１，Ｔ２について、式（１４），（１５）が成立する。以上のことを前提として、以下、本実施形態における推定方法について説明する。 On the other hand, in the present embodiment, since the encoder ES can not be used, it is not clear where the output shaft S stops when the initialization voltages V12 and V22 are applied. That is, as in the example of FIG. 9, there is a possibility that the output shaft S may stop at an angle that is shifted. Therefore, the angles θ1 and θ2 when θoutθ0 are acquired as the reference angles θ14 and θ24. As a result, the equations (14) and (15) are established for the torques T1 and T2 as in the example of FIG. Based on the above, the estimation method in the present embodiment will be described below.

（第６の推定方法）
第６の推定方法は、剛性ｋ１１，ｋ２１が剛性情報として剛性情報記憶部６に予め記憶されている場合に利用できる。 (Sixth estimation method)
The sixth estimation method can be used when the stiffness k11 and k21 are stored in advance in the stiffness information storage unit 6 as stiffness information.

第１実施形態と同様に、初期化電圧Ｖ１２，Ｖ２２の印加時には、Ｔ１＝Ｔ２となっている。したがって、式（１４），（１５）より、以下の式が成り立つ。 As in the first embodiment, at the time of application of the initializing voltages V12 and V22, T1 = T2. Therefore, the following equation holds from the equations (14) and (15).

ｋ１１×（θ１＋Ｎ×θｏｕｔ）＝ｋ２１×（θ２−Ｎ×θｏｕｔ）・・・（１７） k11 × (θ1 + N × θout) = k21 × (θ2−N × θout) (17)

式（１７）をθｏｕｔについて整理すると、以下のようになる。 The equation (17) can be arranged as follows for θout.

θｏｕｔ＝（ｋ２１×θ２−ｋ１１×θ１）／｛Ｎ（ｋ１１＋ｋ２１）｝・・・（１８） θout = (k21 × θ2-k11 × θ1) / {N (k11 + k21)} (18)

したがって、トルク算出部７は、剛性情報（剛性ｋ１１，ｋ２１）と、角度θ１，θ２と、に基づいて、式（１８）より、出力軸Ｓの角度θｏｕｔを算出することができる。 Therefore, the torque calculation unit 7 can calculate the angle θout of the output shaft S from Expression (18) based on the rigidity information (rigidities k11 and k21) and the angles θ1 and θ2.

また、式（１８）を式（１４），（１５）に代入すると、以下のようになる。 Further, when equation (18) is substituted into equations (14) and (15), the following is obtained.

Ｔ１＝Ｔ０＋ｋ１１×｛θ１＋（ｋ２１×θ２−ｋ１１×θ１）／（ｋ１１＋ｋ２１）｝・・・（１９）
Ｔ２＝Ｔ０＋ｋ２１×｛θ２−（ｋ２１×θ２−ｋ１１×θ１）／（ｋ１１＋ｋ２１）｝・・・（２０） T1 = T0 + k11 × {θ1 + (k21 × θ2-k11 × θ1) / (k11 + k21)} (19)
T2 = T0 + k21 × {θ2− (k21 × θ2−k11 × θ1) / (k11 + k21)} (20)

式（１）を変形し、式（１９），（２０）を代入すると、以下のようになる。 When equation (1) is transformed and equations (19) and (20) are substituted, the following is obtained.

Ｔｏｕｔ＝Ｔ１−Ｔ２＝Ｔ０＋ｋ１１×｛θ１＋（ｋ２１×θ２−ｋ１１×θ１）／（ｋ１１＋ｋ２１）｝−［Ｔ０＋ｋ２１×｛θ２−（ｋ２１×θ２−ｋ１１×θ１）／（ｋ１１＋ｋ２１）｝］
＝ｋ１１×θ１−ｋ２１×θ２＋（ｋ１１−ｋ２１）×（ｋ２１×θ２−ｋ１１×θ１）／（ｋ１１＋ｋ２１）・・・（２１） Tout = T1−T2 = T0 + k11 × {θ1 + (k21 × θ2−k11 × θ1) / (k11 + k21)} − [T0 + k21 × {θ2− (k21 × θ2−k11 × θ1) / (k11 + k21)}]
= K 11 x θ 1-k 21 x θ 2 + (k 11-k 21) x (k 21 x θ 2-k 11 x θ 1) / (k 11 + k 21) (21)

したがって、トルク算出部７は、剛性情報（剛性ｋ１１，ｋ２１）と、角度θ１，θ２と、に基づいて、式（２１）により、トルクＴｏｕｔを算出できる。 Therefore, the torque calculation unit 7 can calculate the torque Tout by the equation (21) based on the stiffness information (rigidity k11, k21) and the angles θ1 and θ2.

（第７の推定方法）
第７の推定方法は、剛性ｋ１１，ｋ２１及び係数βが剛性情報として剛性情報記憶部６に予め記憶されている場合に利用できる。 (Seventh estimation method)
The seventh estimation method can be used when the stiffness k11 and k21 and the coefficient β are stored in advance in the stiffness information storage unit 6 as stiffness information.

出力軸Ｓに外力が加えられた場合、第５の推定方法と同様に、式（１６）が成り立つ。式（１６）をθｏｕｔについて整理すると、以下のようになる。 When an external force is applied to the output shaft S, equation (16) holds, as in the fifth estimation method. The equation (16) is summarized as follows with respect to θout.

θｏｕｔ＝（ｋ２１×θ２−ｋ１１×θ１＋Ｔｏｕｔ）／｛Ｎ（ｋ１１＋ｋ２１）｝・・・（２２） θout = (k21 × θ2-k11 × θ1 + Tout) / {N (k11 + k21)} (22)

一方、モータＭ１，Ｍ２の停止時には、以下の式が成り立つ。 On the other hand, when the motors M1 and M2 stop, the following equation is established.

Ｔ１＝Ｋｔ１×Ｖ１／Ｒ１・・・（２３）
Ｔ２＝Ｋｔ２×Ｖ２／Ｒ２・・・（２４） T1 = Kt1 × V1 / R1 (23)
T2 = Kt2 × V2 / R2 (24)

式（２３）におけるＫｔ１、Ｖ１、及びＲ１は、それぞれモータＭ１のトルク係数、電圧、コイル抵抗である。また、式（２４）におけるＫｔ２、Ｖ２、及びＲ２は、それぞれモータＭ２のトルク係数、電圧、コイル抵抗である。式（１）を変形し、式（２３），（２４）を代入すると、以下のようになる。 Kt1, V1 and R1 in the equation (23) are respectively the torque coefficient, voltage and coil resistance of the motor M1. Further, Kt2, V2 and R2 in the equation (24) are respectively the torque coefficient, voltage and coil resistance of the motor M2. When equation (1) is transformed and equations (23) and (24) are substituted, the following is obtained.

Ｔｏｕｔ＝Ｔ１−Ｔ２＝Ｋｔ１×Ｖ１／Ｒ１−Ｋｔ２×Ｖ２／Ｒ２＝（Ｖ１−α×Ｖ２）×β・・・（２５） Tout = T1-T2 = Kt1 × V1 / R1-Kt2 × V2 / R2 = (V1−α × V2) × β (25)

式（２４）の係数αは、Ｔｏｕｔ＝０となる電圧Ｖ１，Ｖ２の比であるため、初期化電圧Ｖ１２，Ｖ２２の比に相当する（α＝Ｖ２２／Ｖ１２）。また、式（２４）の係数βは、Ｋｔ１／Ｒ１に相当する。ベータは、実験により予め求められる。 The coefficient α in equation (24) is the ratio of the voltages V1 and V2 such that Tout = 0, and thus corresponds to the ratio of the initialization voltages V12 and V22 (α = V22 / V12). Further, the coefficient β in equation (24) corresponds to Kt1 / R1. Beta is determined in advance by experiment.

したがって、トルク算出部７は、剛性情報（剛性ｋ１１，ｋ２１及び係数β）と、係数αと、角度θ１，θ２と、電圧Ｖ１，Ｖ２と、に基づいて、式（２５）により、トルクＴｏｕｔを算出できる。また、トルク算出部２４は、式（２２），（２５）より、出力軸Ｓの角度θｏｕｔを算出できる。 Therefore, based on the rigidity information (stiffness k11 and k21 and coefficient β), the coefficient α, the angles θ1 and θ2, and the voltages V1 and V2, the torque calculation unit 7 calculates the torque Tout by equation (25). It can be calculated. Further, the torque calculation unit 24 can calculate the angle θout of the output shaft S from the equations (22) and (25).

以上説明した通り、本実施形態によれば、ダブルモータ制御により出力軸Ｓに加えられたトルクＴｏｕｔを、角度θ１，θ２及び剛性情報に基づいて、高精度に推定することができる。また、トルクＴｏｕｔを推定するために、トルクセンサ及びエンコーダＥＳが不要であるため、トルクＴｏｕｔの推定に要するコストを低減すると共に、推定精度を向上させるための伝達系Ｇ１，Ｇ２の剛性の低下を抑制することができる。 As described above, according to the present embodiment, the torque Tout applied to the output shaft S by double motor control can be estimated with high accuracy based on the angles θ1 and θ2 and the rigidity information. In addition, since the torque sensor and the encoder ES are unnecessary to estimate the torque Tout, the cost required to estimate the torque Tout can be reduced, and the rigidity of the transmission systems G1 and G2 for improving the estimation accuracy can be reduced. It can be suppressed.

＜第３実施形態＞
第３実施形態に係るトルク推定装置１０について説明する。本実施形態では、剛性比Ｋの算出方法について説明する。なお、モータ駆動システム１００の構成及び動作は、第１実施形態と同様である。 Third Embodiment
The torque estimation device 10 according to the third embodiment will be described. In the present embodiment, a method of calculating the rigidity ratio K will be described. The configuration and operation of the motor drive system 100 are the same as in the first embodiment.

（第１の算出方法）
第１の算出方法は、出力軸ＳにエンコーダＥＳが設けられている場合に利用できる。第１の算出方法では、モータ制御部１は、モータＭ１，Ｍ２に初期化電圧Ｖ１１，Ｖ２１を印加し、基準角度θ１１，θ２１を取得した後、出力軸Ｓが基準角度（θｏｕｔ＝０）で停止するように、モータＭ１，Ｍ２に初期化電圧Ｖ１１，Ｖ２１とは異なる電圧をそれぞれ印加する。そして、トルク算出部７は、出力軸Ｓの停止時のモータＭ１，Ｍ２の角度θ１５，θ２５を取得する。このとき、Ｔｏｕｔ＝０であるため、式（４）より、以下の式が成り立つ。 (First calculation method)
The first calculation method can be used when the output shaft S is provided with the encoder ES. In the first calculation method, the motor control unit 1 applies the initialization voltages V11 and V21 to the motors M1 and M2, obtains the reference angles θ11 and θ21, and then sets the output shaft S to the reference angle (θout = 0). Voltages different from the initialization voltages V11 and V21 are respectively applied to the motors M1 and M2 so as to stop. Then, the torque calculation unit 7 obtains the angles θ15 and θ25 of the motors M1 and M2 when the output shaft S is stopped. At this time, since Tout = 0, the following equation holds from equation (4).

０＝ｋ１１×θ１５−ｋ２１×θ２５・・・（２６） 0 = k11 × θ15−k21 × θ25 (26)

式（２６）を変形すると、以下のようになる。 The equation (26) is transformed as follows.

ｋ２１／ｋ１１＝θ１５／θ２５・・・（２７） k21 / k11 = θ15 / θ25 (27)

式（２７）より、Ｋ＝θ１５／θ２５であることがわかる。このように、トルク算出部７は、出力軸Ｓが基準角度で停止した際の角度θ１５，θ２５に基づいて、剛性比Ｋを算出することができる。 From Expression (27), it can be seen that K = θ15 / θ25. Thus, the torque calculator 7 can calculate the rigidity ratio K based on the angles θ15 and θ25 when the output shaft S stops at the reference angle.

（第２の算出方法）
第２の算出方法は、出力軸ＳにエンコーダＥＳが設けられていない場合に利用できる。第２の算出方法では、モータ制御部１は、モータＭ１，Ｍ２に初期化電圧Ｖ１２，Ｖ２２を印加し、基準角度θ１４，θ２４を取得した後、電磁ブレーキなどにより、出力軸Ｓを固定する。出力軸Ｓの固定は、作業者が手作業で行ってもよい。 (Second calculation method)
The second calculation method can be used when the output shaft S is not provided with the encoder ES. In the second calculation method, the motor control unit 1 applies the initialization voltages V12 and V22 to the motors M1 and M2, obtains the reference angles θ14 and θ24, and then fixes the output shaft S by an electromagnetic brake or the like. The operator may manually fix the output shaft S.

出力軸Ｓの固定後、モータ制御部１は、初期化電圧Ｖ１２，Ｖ２２をモータＭ１，Ｍ２に再度印加する。トルク算出部７は、初期化電圧Ｖ１２，Ｖ２２の再度の印加時におけるモータＭ１，Ｍ２の角度θ１６，θ２６を取得する。第１の算出方法と同様に、初期化電圧Ｖ１２，Ｖ２２の再度の印加時には、式（２７）が成り立つため、トルク算出部７は、角度θ１６，θ２６に基づいて、エンコーダＥＳを利用することなく、剛性比Ｋを算出することができる（Ｋ＝θ１６／θ２６）。 After fixing the output shaft S, the motor control unit 1 applies the initialization voltages V12 and V22 to the motors M1 and M2 again. The torque calculation unit 7 obtains the angles θ16 and θ26 of the motors M1 and M2 when the initialization voltages V12 and V22 are applied again. As in the first calculation method, when the initialization voltages V12 and V22 are applied again, the equation (27) holds, and thus the torque calculation unit 7 does not use the encoder ES based on the angles θ16 and θ26. The stiffness ratio K can be calculated (K = θ16 / θ26).

以上説明した通り、本実施形態によれば、トルク算出部７は、モータＭ１，Ｍ２に所定の電圧を印加した際の角度θ１，θ２に基づいて、剛性比Ｋを算出することができる。剛性比Ｋは、予め算出され、剛性情報記憶部６に保存されていてもよいし、モータＭ１，Ｍ２を駆動する毎に算出されてもよい。後者の場合、初期化電圧の印加後の任意のタイミングで、トルク算出部７は剛性比Ｋを算出することができる。 As described above, according to the present embodiment, the torque calculation unit 7 can calculate the rigidity ratio K based on the angles θ1 and θ2 when a predetermined voltage is applied to the motors M1 and M2. The rigidity ratio K may be calculated in advance and stored in the rigidity information storage unit 6, or may be calculated each time the motors M1 and M2 are driven. In the latter case, the torque calculation unit 7 can calculate the rigidity ratio K at an arbitrary timing after the application of the initialization voltage.

＜第４実施形態＞
第４実施形態に係るトルク推定装置１０について、図１０を参照して説明する。本実施形態では、４つのモータＭにより、１つの出力軸Ｓを駆動する場合について説明する。なお、モータ駆動システム１００の構成及び動作は、第１実施形態と同様である。 Fourth Embodiment
The torque estimation device 10 according to the fourth embodiment will be described with reference to FIG. In the present embodiment, a case where one output shaft S is driven by four motors M will be described. The configuration and operation of the motor drive system 100 are the same as in the first embodiment.

図１０は、本実施形態における駆動系Ｄの一例を示す図である。図１０の駆動系Ｄは、モータＭ１ａ，Ｍ１ｂ，Ｍ２ａ，Ｍ２ｂと、ギアｇ１，ｇ２と、出力軸Ｓと、を備える。モータＭ１ａ，Ｍ１ｂは、ギアｇ１を駆動する。モータＭ２ａ，Ｍ２ｂは、ギアｇ２を駆動する。ギアｇ１，ｇ２は、出力軸Ｓを駆動する。すなわち、各モータＭ１ａ，Ｍ１ｂ，Ｍ２ａ，Ｍ２ｂは、２段階の伝達系を介して、出力軸Ｓを駆動する。 FIG. 10 is a diagram showing an example of a drive system D in the present embodiment. The drive system D of FIG. 10 includes motors M1a, M1b, M2a, and M2b, gears g1 and g2, and an output shaft S. The motors M1a and M1b drive the gear g1. The motors M2a and M2b drive the gear g2. The gears g1 and g2 drive the output shaft S. That is, the motors M1a, M1b, M2a, and M2b drive the output shaft S via a two-step transmission system.

本実施形態では、トルク推定装置１０は、モータＭ１ａ，Ｍ１ｂの角度θ１ａ，θ１ｂに基づいて、ギアｇ１に加えられたトルクＴｇ１を推定できる。また、トルク推定装置１０は、モータＭ２ａ，Ｍ２ｂの角度θ２ａ，θ２ｂに基づいて、ギアｇ２に加えられたトルクＴｇ２を推定できる。ギアｇ１から出力軸Ｓへの減速比をＮ１、ギアｇ２から出力軸Ｓへの減速比をＮ２とすると、出力軸Ｓに加えられるトルクＴｏｕｔは以下の式で表される。 In the present embodiment, the torque estimation device 10 can estimate the torque Tg1 applied to the gear g1 based on the angles θ1a and θ1b of the motors M1a and M1b. Further, the torque estimation device 10 can estimate the torque Tg2 applied to the gear g2 based on the angles θ2a and θ2b of the motors M2a and M2b. Assuming that the reduction ratio from the gear g1 to the output shaft S is N1 and the reduction ratio from the gear g2 to the output shaft S is N2, the torque Tout applied to the output shaft S is expressed by the following equation.

Ｔｏｕｔ＝Ｔｇ１×Ｎ１＋Ｔｇ２×Ｎ２・・・（２８） Tout = Tg1 × N1 + Tg2 × N2 (28)

したがって、トルク推定装置１０は、角度θ１ａ，θ１ｂ，θ２ａ，θ２ｂに基づいて、式（２８）より、トルクＴｏｕｔを推定することができる。 Therefore, the torque estimation device 10 can estimate the torque Tout from the equation (28) based on the angles θ1a, θ1b, θ2a, θ2b.

なお、図１０の例では、駆動系Ｄは２段階の伝達系を備えるが、３段階以上の伝達系を備えてもよい。例えば、駆動系Ｄが３段階の伝達系を備える場合、出力軸Ｓは、８つのモータＭにより駆動される。この場合、トルク推定装置１０は、８つのモータＭの角度θに基づいて、出力軸Ｓに加えられたトルクを推定することができる。 In the example of FIG. 10, the drive system D includes a two-stage transmission system, but may have three or more stages of transmission systems. For example, when the drive system D includes a three-step transmission system, the output shaft S is driven by eight motors M. In this case, the torque estimation device 10 can estimate the torque applied to the output shaft S based on the angles θ of the eight motors M.

なお、上記実施形態に挙げた構成等に、その他の要素との組み合わせなど、ここで示した構成に本発明が限定されるものではない。これらの点に関しては、本発明の趣旨を逸脱しない範囲で変更可能であり、その応用形態に応じて適切に定めることができる。 Note that the present invention is not limited to the configurations shown here, such as combinations with other elements in the configurations and the like described in the above embodiments. These points can be changed without departing from the spirit of the present invention, and can be appropriately determined according to the application form.

１：モータ制御部
２：ＰＩＤ制御部
３Ａ，３Ｂ：印加電圧算出部
４Ａ，４Ｂ：ＰＷＭ生成部
５Ａ，５Ｂ：駆動部
６：剛性情報記憶部
７：トルク算出部
８：異常検知部
９：ダブルモータコントローラ
１０：トルク推定装置 1: Motor control unit 2: PID control unit 3A, 3B: Applied voltage calculation unit 4A, 4B: PWM generation unit 5A, 5B: Drive unit 6: Stiffness information storage unit 7: Torque calculation unit 8: Abnormality detection unit 9: Double Motor controller 10: Torque estimation device

国際公開第２０１４／０９８００８号International Publication No. 2014/098008

Claims

第１伝達系の剛性及び第２伝達系の剛性の少なくとも一方を含む剛性情報を記憶する剛性情報記憶部と、
前記第１伝達系を介して出力軸を駆動する第１モータの角度と、第２伝達系を介して前記出力軸を駆動する第２モータの角度と、前記剛性情報と、に基づいて、前記出力軸に加わっているトルクを算出するトルク算出部を備える
トルク推定装置。 A stiffness information storage unit that stores stiffness information including at least one of the stiffness of the first transmission system and the stiffness of the second transmission system;
Based on the angle of the first motor driving the output shaft through the first transmission system, the angle of the second motor driving the output shaft through the second transmission system, and the rigidity information. A torque estimation device comprising a torque calculation unit that calculates a torque applied to an output shaft.

前記剛性は、前記角度の変化量と前記トルクの変化量との比である
請求項１に記載のトルク推定装置。 The torque estimation device according to claim 1, wherein the rigidity is a ratio of the change amount of the angle to the change amount of the torque.

前記剛性情報は、前記第１伝達系の剛性と前記第２伝達系の剛性との比である剛性比を含む
請求項１又は請求項２に記載のトルク推定装置。 The torque estimation device according to claim 1, wherein the stiffness information includes a stiffness ratio that is a ratio of the stiffness of the first transmission system to the stiffness of the second transmission system.

前記トルク算出部は、前記出力軸が停止した際の前記第１モータの角度及び前記第２モータの角度に基づいて、前記剛性比を算出する
請求項３に記載のトルク推定装置。 The torque estimation device according to claim 3, wherein the torque calculation unit calculates the rigidity ratio based on an angle of the first motor and an angle of the second motor when the output shaft is stopped.

前記第１モータの角度と前記第２モータの角度との差に基づいて、異常を検知する異常検知部を更に備える
請求項１から請求項４までのいずれか１項に記載のトルク推定装置。 The torque estimation device according to any one of claims 1 to 4, further comprising an abnormality detection unit that detects an abnormality based on a difference between an angle of the first motor and an angle of the second motor.

第１伝達系の剛性及び第２伝達系の剛性の少なくとも一方を含む剛性情報と、前記第１伝達系を介して出力軸を駆動する第１モータの角度と、第２伝達系を介して前記出力軸を駆動する第２モータの角度と、に基づいて、前記出力軸に加わっているトルクを算出する工程を含む
トルク推定方法。 Stiffness information including at least one of the stiffness of the first transmission system and the stiffness of the second transmission system, the angle of the first motor for driving the output shaft through the first transmission system, and the second transmission system via the second transmission system A torque estimation method comprising: calculating a torque applied to the output shaft based on an angle of a second motor that drives the output shaft.

第１伝達系の剛性及び第２伝達系の剛性の少なくとも一方を含む剛性情報と、前記第１伝達系を介して出力軸を駆動する第１モータの角度と、第２伝達系を介して前記出力軸を駆動する第２モータの角度と、に基づいて、前記出力軸に加わっているトルクを算出する工程を含むトルク推定方法をコンピュータに実行させるプログラム。 Stiffness information including at least one of the stiffness of the first transmission system and the stiffness of the second transmission system, the angle of the first motor for driving the output shaft through the first transmission system, and the second transmission system via the second transmission system A program for causing a computer to execute a torque estimation method including the step of calculating a torque applied to an output shaft based on an angle of a second motor that drives the output shaft.