JP2019090725A - Torque estimation device, torque estimation method, and torque estimation program - Google Patents
Torque estimation device, torque estimation method, and torque estimation program Download PDFInfo
- Publication number
- JP2019090725A JP2019090725A JP2017220441A JP2017220441A JP2019090725A JP 2019090725 A JP2019090725 A JP 2019090725A JP 2017220441 A JP2017220441 A JP 2017220441A JP 2017220441 A JP2017220441 A JP 2017220441A JP 2019090725 A JP2019090725 A JP 2019090725A
- Authority
- JP
- Japan
- Prior art keywords
- torque
- output shaft
- motor
- stiffness
- transmission system
- 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
Links
Images
Landscapes
- Force Measurement Appropriate To Specific Purposes (AREA)
- Control Of Transmission Device (AREA)
- Control Of Multiple Motors (AREA)
Abstract
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.
ところで、近年、2つのモータにより1つの出力軸を駆動するダブルモータ制御が研究されている。ダブルモータ制御によれば、2つのモータが同一方向に回転するように電圧を印加することにより、出力軸に加えるトルクを大きくしたり、2つのモータが反対方向に回転するように電圧を印加することにより、バックラッシュを低減したりすることができる。 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.
一実施形態に係るトルク推定装置は、第1伝達系の剛性及び第2伝達系の剛性の少なくとも一方を含む剛性情報を記憶する剛性情報記憶部と、前記第1伝達系を介して出力軸を駆動する第1モータの角度と、第2伝達系を介して前記出力軸を駆動する第2モータの角度と、前記剛性情報と、に基づいて、前記出力軸に加わっているトルクを算出するトルク算出部を備える。 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.
以下、本発明の各実施形態について、添付の図面を参照しながら説明する。なお、各実施形態に係る明細書及び図面の記載に関して、実質的に同一の機能構成を有する構成要素については、同一の符号を付することにより重畳した説明を省略する。 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.
<第1実施形態>
第1実施形態に係るトルク推定装置10について、図1〜図9を参照して説明する。本実施形態に係るトルク推定装置10は、ダブルモータ制御により出力軸Sに加えられたトルクToutを推定する装置である。本実施形態では、出力軸Sに、出力軸Sの角度θoutを計測するエンコーダESが設けられている場合について説明する。
First Embodiment
The
まず、ダブルモータ制御について説明する。図1は、ダブルモータ制御により駆動される駆動系Dの一例を示す斜視図である。図2は、図1の駆動系Dの平面図である。図1及び図2の駆動系Dは、モータM1,M2と、出力軸Sと、伝達系G1,G2と、を備える。なお、図1及び図2の例では省略されているが、駆動系Dには、モータM1,M2及び出力軸Sの角度θ1,θ2,θoutを計測するエンコーダE1,E2,ESが含まれる。エンコーダE1,E2は、モータM1,M2に外付けされてもよいし、モータM1,M2に内蔵されてもよい。また、エンコーダESは、出力軸Sに外付けされてもよいし、出力軸Sに内蔵されてもよい。 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.
モータM1(第1モータ)は、ダブルモータ制御により制御される一方のモータである。モータM1は、伝達系G1を介して、出力軸SにトルクT1を加え、出力軸Sを駆動する。モータM2(第2モータ)は、ダブルモータ制御により制御される他方のモータである。モータM2は、伝達系G2を介して、出力軸SにトルクT2を加え、出力軸Sを駆動する。出力軸Sは、ダブルモータ制御により駆動される出力軸である。伝達系G1(第1伝達系)は、モータM1の回転を出力軸Sに伝達する複数のギアの組(減速機)である。伝達系G2(第2伝達系)は、モータM2の回転を出力軸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.
ダブルモータ制御では、モータM1,M2をそれぞれ制御することにより、出力軸Sが駆動される。図3は、モータM1,M2に印加される電圧の一例を示すグラフである。図3の縦軸はモータM1,M2の印加電圧、横軸は電圧指令値、実線はモータM1の印加電圧、点線はモータM2の印加電圧、破線はモータM1,M2の平均印加電圧、一点鎖線はモータM1,M2の合計印加電圧である。図3の例では、モータM1,M2が、正電圧を印加されると出力軸Sに第1方向のトルクT1,T2を加え、負電圧を印加されると出力軸Sに第2方向(第1方向と反対方向)のトルクT1,T2を加える場合を想定している。 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.
図3の領域R1では、モータM1にリミット電圧lim2からオフセット電圧offset1までの電圧が印加され、モータM2にリミット電圧lim2が印加される。モータM1に印加される電圧が小さくなるほど、モータM1により出力軸Sに加えられる第2方向のトルクT1が大きくなる。領域R1では、モータM1,M2により出力軸Sに同一方向(第2方向)のトルクT1,T2を加えられるため、出力軸Sに加えられるトルクToutを大きくすることができる。 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.
領域R2では、モータM1にオフセット電圧offset1が印加され、モータM2にリミット電圧lim2からオフセット電圧offset2までの電圧が印加される。モータM2に印加される電圧が小さくなるほど、モータM2により出力軸Sに加えられる第2方向のトルクT2が大きくなる。モータM2は、出力軸Sを第2方向に駆動する駆動用モータとして機能する。 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.
領域R2では、モータM1,M2が出力軸Sに反対方向のトルクT1,T2を加えているため、出力軸Sに加えられるトルクToutは、モータM1,M2が加えるトルクT1,T2の差となり、領域R1より小さくなる。そのかわり、モータM1が、伝達系G1,G2の各ギアをオフセット電圧offset1に応じた所定のトルクで互いに押し付け合わせるバックラッシュ低減用モータとして機能するため、伝達系G1,G2のバックラッシュが低減する。 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. .
領域R3では、モータM1にリミット電圧lim1が印加され、モータM2にオフセット電圧offset2からリミット電圧lim1までの電圧が印加される。モータM2に印加される電圧が大きくなるほど、モータM2により出力軸Sに加えられる第1方向のトルクT2が大きくなる。領域R3では、モータM1,M2により出力軸Sに同一方向(第1方向)のトルクT1,T2を加えられるため、出力軸Sに加えられるトルクToutを大きくすることができる。 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.
領域R4では、モータM1にオフセット電圧offset1からリミット電圧lim1までの電圧が印加され、モータM2にオフセット電圧offset2が印加される。モータM1に印加される電圧が大きくなるほど、モータM1により出力軸Sに加えられる第1方向のトルクT1が大きくなる。モータM1は、出力軸Sを第1方向に駆動する駆動用モータとして機能する。 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.
領域R4では、モータM1,M2が出力軸Sに反対方向のトルクT1,T2を加えているため、出力軸Sに加えられるトルクToutは、モータM1,M2が加えるトルクT1,T2の差となり、領域R3より小さくなる。そのかわり、モータM2が、伝達系G1,G2の各ギアをオフセット電圧offset1に応じた所定のトルクで互いに押し付け合わせるバックラッシュ低減用モータとして機能するため、伝達系G1,G2のバックラッシュが低減する。 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. .
このように、ダブルモータ制御では、2つのモータM1,M2に印加する電圧を制御することにより、出力軸Sに加えるトルクToutを大きくしたり、バックラッシュを低減したりすることができる。以下、領域R2,R4における制御のように、バックラッシュを低減させる制御を、バックラッシュ制御と称する。 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.
以上のようなダブルモータ制御を実現するためには、モータM1,M2により出力軸SにバランスよくトルクT1,T2を加えることが重要となる。モータM1,M2のトルクバランスが崩れた場合、速度変動や駆動系Dの変形が生じたり、伝達系G1,G2の摩耗が早まったりするおそれがある。 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.
そこで、モータM1,M2の角度θ1,θ2と、モータM1,M2が出力軸Sに加えるトルクT1,T2と、の関係について説明する。以下、モータM1,M2、角度θ1,θ2、及びトルクT1,T2を区別しない場合、それぞれモータM、角度θ、及びトルクTと称する。 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.
モータMが出力軸Sに加えるトルクTは、出力軸Sに対するモータMの相対的な角度θに応じて変化する。図4は、角度θとトルクTとの関係を示すグラフである。図4の角度θは、基準角度θ0からのモータMの移動量に相当する。図4の例では、基準角度θ0(=0°)は、モータMの伝達系Gが噛み合っていない角度である。図4の実線はモータMが出力軸Sに加えるトルクTを示す。図4に示すように、角度θは、バックラッシュ領域と、低剛性領域と、高剛性領域と、異常領域と、に分類できる。 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.
バックラッシュ領域は、伝達系Gが噛み合っていない、すなわち、伝達系Gの各ギアの間にバックラッシュが存在する領域である。バックラッシュ領域では、モータMが回転しても、その回転が出力軸Sに伝達されないため、トルクTは0である。 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.
低剛性領域は、バックラッシュ領域に続く領域である。低剛性領域では、角度θに応じてトルクTが徐々に大きくなる。 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 θ.
高剛性領域は、低剛性領域に続く領域である。高剛性領域では、角度θに応じてトルクTが線形に大きくなる。 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 θ.
異常領域は、高剛性領域に続く領域であり、想定される角度θの上限より、角度θが大きい領域である。角度θが異常領域に存在する場合、駆動系Dに変形などの異常が発生したと考えられる。 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.
ここで、角度θの変化量とトルクTの変化量との比を剛性kと称する。剛性kは、図4の実線の傾きに相当するため、バックラッシュ領域では0となり、低剛性領域では角度θに応じて徐々に大きくなり、高剛性領域では一定となる。剛性kは、角度θの変化に対するトルクTの伝わりやすさを示す値に相当し、モータM及び伝達系Gの軸や出力軸Sのねじれ剛性、伝達系Gのギアの変形、モータM及び伝達系Gの軸や出力軸Sの位置などに依存する。 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.
図1の例のように、伝達系Gに複数の軸やギアが含まれる場合、上記の影響を複数個所で受けるため、図4に示すように剛性kは角度θに応じて過渡的に変化する。具体的には、図4に示すように、モータMの角度θを基準角度θ0から徐々に大きくしていくと、伝達系Gが噛み合うまで剛性kは0となる(バックラッシュ領域)。伝達系Gが噛み合った後、角度θを大きくすると、モータM及び伝達系Gの軸や出力軸Sが軸受部に順次押し付けられていき、各軸の位置が安定する。また、伝達系Gの各ギアが、噛み合わされたギアに押し付けられることにより変形する。この結果、剛性kは、徐々に大きくなる(低剛性領域)。各軸の位置が安定し、各ギアの変形が終了すると、剛性kは一定になる(高剛性領域)。高剛性領域では、ΔT=kΔθが成立する。 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.
次に、駆動系Dを駆動するモータ駆動システム100について説明する。図5は、モータ駆動システム100の機能構成の一例を示す図である。図5のモータ駆動システム100は、モータ制御部1と、PID(Proportional Integral Differential)制御部2と、印加電圧算出部3A,3Bと、PWM(Pulse Width Modulation)生成部4A,4Bと、駆動部5A,5Bと、剛性情報記憶部6と、トルク算出部7と、異常検知部8と、を備える。
Next, the
モータ駆動システム100の各機能構成は、それぞれ異なるIC(Integrated Circuit)により実現されてもよいし、2つ以上の機能構成が1つのICにより実現されてもよい。剛性情報記憶部6、トルク算出部7、及び異常検知部8は、本実施形態におけるトルク推定装置10に相当する。トルク推定装置10は、CPU(Central Processing Unit)と、ROM(Read Only Memory)と、RAM(Random Access Memory)と、を備えたコンピュータにより実現される。CPUがROMに記憶されたプログラムをRAM上で実行することにより、トルク推定装置10の機能が実現される。トルク推定装置10は、例えば、マイコンであるが、これに限られない。トルク推定装置10には、モータ制御部1が含まれてもよい。また、以下では、PID制御部2から駆動部5A,5Bまでの機能構成は、1つのIC(ダブルモータコントローラ9)として実現されるものとする。
Each functional configuration of
モータ制御部1は、モータ駆動システム100の全体の動作を制御する。モータ制御部1は、例えば、CPUと、ROMと、RAMと、を備えたマイコンにより実現される。CPUがROMに記憶されたプログラムをRAM上で実行することにより、モータ制御部1の機能が実現される。
PID制御部2は、出力軸Sの速度及び角度の目標値と、出力軸Sの速度及び角度の検出値と、を入力される。出力軸Sの速度及び角度の目標値は、例えば、モータ制御部1から入力される。また、出力軸Sの速度及び角度の検出値は、出力軸Sに設けられたセンサから直接入力されてもよいし、モータ制御部1から入力されてもよい。PID制御部2は、PID制御により、検出値が目標値に近づくように、電圧指令値(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
印加電圧算出部3A,3Bは、PID制御部2から電圧指令値をそれぞれ入力される。印加電圧算出部3Aは、入力された電圧指令値に基づいて、モータM1の印加電圧(drv_out1)を算出する。また、印加電圧算出部3Bは、入力された電圧指令値に基づいて、モータM2の印加電圧(drv_out2)を算出する。電圧指令値と印加電圧との関係は、図3の例のように、予め設定されている。
The applied
PWM生成部4Aは、印加電圧算出部3Aから印加電圧を入力され、入力された印加電圧に応じたPWM信号を生成する。また、PWM生成部4Bは、印加電圧算出部3Bから印加電圧を入力され、入力された印加電圧に応じたPWM信号を生成する。
The PWM generation unit 4A receives the applied voltage from the applied
駆動部5Aは、PWM生成部4AからPWM信号を入力され、入力されたPWM信号に応じた印加電圧をモータM1に印加する。また、駆動部5Bは、PWM生成部4BからPWM信号を入力され、入力されたPWM信号に応じた印加電圧をモータM2に印加する。これにより、モータM1,M2が駆動され、伝達系G1,G2を介して、出力軸Sが駆動される。
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
剛性情報記憶部6は、予め計測された、伝達系G1及び伝達系G2の少なくとも一方の剛性情報を記憶する。剛性情報には、剛性kや剛性比Kが含まれる。剛性情報については後述する。 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.
トルク算出部7は、エンコーダE1からモータM1の角度θ1を入力され、エンコーダE2からモータM2の角度θ2を入力される。トルク算出部7は、角度θ1,θ2と、剛性情報記憶部6に記憶された剛性情報と、に基づいて、出力軸SのトルクToutを算出する。トルク算出部7が算出したトルクToutは、実際のトルクToutの推定値に相当する。トルクToutの算出方法については後述する。 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.
異常検知部8は、エンコーダE1からモータM1の角度θ1を入力され、エンコーダE2からモータM2の角度θ2を入力される。異常検知部8は、角度θ1,θ2に基づいて、駆動系Dに異常が発生したか判定する。 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.
次に、モータ駆動システム100の動作について説明する。以下、説明を簡単にするために、駆動系Dの模式図を用いて説明する。図6は、駆動系Dの模式図である。図6の例では、伝達系G1,G2は、いずれも2つのギアからなる、減速比Nを有する1段の減速機である。角度θ1及びトルクT1は、図6の出力軸Sの反時計回りが正方向であり、角度θ2,θout及びトルクT2,Toutは、図6の出力軸Sの時計回りが正方向であるものとする。また、伝達系G1,G2の剛性k1,k2に対する影響は、モータM1,M2の角度θ1,θ2に全て反映されるものとする。出力軸Sが停止している場合、以下の式が成り立つ。
Next, the operation of the
T1=Tout+T2・・・(1) T1 = Tout + T2 (1)
図7は、モータ駆動システム100の動作の一例を示すフローチャートである。
FIG. 7 is a flowchart showing an example of the operation of the
まず、モータ制御部1は、ダブルモータコントローラ9を制御し、モータM1,M2に初期化電圧V11,V21を印加する(ステップS101)。初期化電圧V11,V21は、モータM1,M2に反対方向かつ大きさが等しいトルクT1,T2を発生させる電圧である。初期化電圧V11,V21は、モータM1,M2の剛性k1,k2が高剛性領域に含まれるように予め設定される。初期化電圧V11,V21の印加は、バックラッシュ制御に相当する。このとき、T1=T2であるため、Toutは0である。すなわち、出力軸Sは停止している。
First, the
より詳細には、モータ制御部1は、モータM1に予め設定された初期化電圧V11を印加し、モータM2に反対方向の小さい電圧を印加し、当該電圧を徐々に大きくしていく。モータ制御部1は、エンコーダESの値を監視することにより、出力軸Sが基準角度(θout=0)で停止する(T1=T2となる)までモータM2に印加する電圧を大きくする。出力軸Sが基準角度で停止した際のモータM2の電圧が初期化電圧V21に相当する。これにより、モータ制御部1は、モータM1,M2に初期化電圧V11,V21を印加できる。
More specifically, the
次に、トルク算出部7は、初期化電圧V11,V21を印加中のモータM1,M2の角度を、基準角度θ11,θ21としてエンコーダE1,E2から取得する(ステップS102)。ここで取得される基準角度θ11,θ21は、図4の高剛性領域に含まれる角度となる。 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.
その後、モータ制御部1は、ダブルモータコントローラ9を制御し、出力軸Sの駆動を開始する(ステップS103)。
Thereafter, the
出力軸Sの駆動が開始されると、トルク推定装置10は、エンコーダE1,E2から定期的に角度θ1,θ2を取得する(ステップS104)。ここで取得される角度θ1,θ2は、ステップS102で取得した基準角度θ11,θ21に対する移動量に相当する。
When driving of the output shaft S is started, the
そして、トルク算出部7は、取得した角度θ1,θ2と、剛性情報記憶部6に記憶された剛性情報と、に基づいて、トルクToutを算出する(ステップS105)。 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).
また、異常検知部8は、取得した角度θ1,θ2に基づいて、駆動系Dに異常が発生したか判定する。具体的には、異常検知部8は、角度θ1と角度θ2との差|θ1−θ2|が、予め設定された閾値θth以上であるか判定する(ステップS106)。 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).
差|θ1−θ2|が閾値θth以上である場合(ステップS106のYES)、異常検知部8は、駆動系Dに異常が発生したと判定する(ステップS107)。これは、モータM1,M2は、伝達系G1,G2及び出力軸Sを介して連動しているため、駆動系Dが正常の場合、差|θ1−θ2|は閾値θth未満になると考えられるためである。異常検知部8は、異常が発生したと判定した場合、モータ制御部1にその旨を通知する。モータ制御部1は、異常の発生を通知されると、モータM1,M2を停止させる(ステップS108)。
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
一方、差|θ1−θ2|が閾値θth未満である場合(ステップS106のNO)、異常検知部8は、駆動系Dは正常と判定する(ステップS109)。異常検知部8は、正常と判定した場合、モータ制御部1にその旨を通知する。モータ制御部1は、正常である旨を通知されると、モータM1,M2の制御を継続する。
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
トルク推定装置10は、出力軸Sの駆動が終了するまで、ステップS104〜S107,S109の動作を繰り返す。
The
ここで、トルクToutの推定方法について説明する。以下の推定方法は、図7のステップS105の内部処理に相当する。図8は、トルクToutの推定方法を説明する図である。図8の左側はモータM1のトルクT1を示し、図8の右側はモータM2のトルクT2を示す。図8のT0は、初期化電圧V11,V21の印加時のトルクT1,T2であり(T1=T2=T0)、θ12,θ22は、高剛性領域の始点である。また、高剛性領域における剛性k1,k2を、それぞれ剛性k11,k21と称する。 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.
(第1の推定方法)
第1の推定方法は、剛性k11,k21が剛性情報として剛性情報記憶部6に予め記憶されている場合に利用できる。上述の通り、ステップS104で取得される角度θ1,θ2は、高剛性領域に含まれる基準角度θ11,θ21に対する移動量であるため、図8からわかるように、トルクT1,T2について以下の式が成り立つ。
(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)
T1 = T0 + k11 × θ1 (2)
T2 = T0 + k21 × θ2 (3)
式(1)を変形し、式(2),(3)を代入すると、以下のようになる。 Transforming equation (1) and substituting equations (2) and (3) gives the following.
Tout=T1−T2=T0+k11×θ1−(T0+k21×θ2)
=k11×θ1−k21×θ2・・・(4)
Tout = T1-T2 = T0 + k11 × θ1- (T0 + k21 × θ2)
= K11 x θ 1-k 21 x θ 2 (4)
したがって、トルク算出部7は、剛性情報(剛性k11,k21)と、角度θ1,θ2と、に基づいて、式(4)により、トルクToutを算出できる。 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.
(第2の推定方法)
第2の推定方法は、剛性k11又は剛性k21が剛性情報として剛性情報記憶部6に予め記憶されており、剛性k11,k21が等しいことがわかっている場合に利用できる。
(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.
剛性k11,k21が等しい場合、式(4)は、以下のように変形できる。 If the stiffness k11 and k21 are equal, equation (4) can be modified as follows.
Tout=k11(θ1−θ2)=k21(θ1−θ2)・・・(5) Tout = k11 (θ1−θ2) = k21 (θ1−θ2) (5)
したがって、トルク算出部7は、剛性情報(剛性k11又は剛性k21)と、角度θ1,θ2と、に基づいて、式(5)により、トルクToutを算出できる。 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.
(第3の推定方法)
第3の推定方法は、剛性k11又は剛性k21と、剛性比Kと、が剛性情報として剛性情報記憶部6に予め記憶されている場合に利用できる。剛性比Kは、剛性k1と剛性k2との比である(K=k2/k1)。
(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).
第3の推定方法では、トルク算出部7は、剛性比Kと、剛性k11,k21の一方と、に基づいて、剛性k11,k21の他方を算出する。例えば、剛性情報に剛性比K及び剛性k11が含まれる場合、剛性k21は、k11×Kにより求められる。また、剛性情報に剛性比K及び剛性k21が含まれる場合、剛性k11は、k21/Kにより求められる。したがって、トルク算出部7は、剛性情報(剛性k11又は剛性k21と剛性比K)と、角度θ1,θ2と、に基づいて、式(4)により、トルクToutを算出できる。 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.
(第4の推定方法)
第1から第3までの推定方法では、角度θ1,θ2が高剛性領域に含まれる場合、トルクToutを精度よく推定できる。しかしながら、角度θ1,θ2が高剛性領域に含まれない場合、トルクToutの推定精度が低下する。そこで、第4の推定方法では、バックラッシュ領域及び低剛性領域におけるトルクToutを近似した関数を利用して、トルクToutを推定する。なお、第4の方法では、角度θ1,θ2は、それぞれトルクT1,T2が0になる角度θ13,θ23(モータM1,M2に電圧を印加していない時の角度)を、基準角度として計測される。
(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.
第4の推定方法は、剛性k11,k21と、高剛性領域の始点θ12,θ22と、関数T1(θ1),T2(θ2)と、が剛性情報として剛性情報記憶部6に予め記憶されている場合に利用できる。 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.
例えば、バックラッシュ領域及び低剛性領域におけるトルクT1を二次関数で近似する場合、トルクT1は以下の式で表される。 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×θ12・・・(6)
[θ1>θ12]T1(θ1)=k11×(θ1−θ12)+a×θ122・・・(7)
[Θ1 ≦ θ12] T1 (θ1) = a × θ1 2 (6)
[Θ1> θ12] T1 (θ1) = k11 × (θ1−θ12) + a × θ12 2 (7)
式(6),(7)の接合部の傾きを連続させると、式(6),(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) k11 = 2a × θ12 (8)
したがって、式(6)〜(8)より、関数T1(θ1)は、以下のようになる。 Therefore, according to equations (6) to (8), the function T1 (θ1) is as follows.
[θ1≦θ12]T1(θ1)=k11×θ12/2θ12・・・(9)
[θ1>θ12]T1(θ1)=k11×(θ1−θ12/2)・・・(10)
[Θ1 ≦ θ12] T1 (θ1) = k11 × θ1 2 / 2θ12 (9)
[Θ1> θ12] T1 (θ1) = k11 × (θ1−θ12 / 2) (10)
同様に、トルクT2について以下の式が成り立つ。 Similarly, the following equation holds for the torque T2.
[θ2≦θ22]T2(θ2)=k21×θ22/2θ12・・・(11)
[θ2>θ22]T2(θ2)=k21×(θ2−θ22/2)・・・(12)
[Θ2 ≦ θ22] T2 (θ2) = k21 × θ2 2 / 2θ12 (11)
[Θ2> θ22] T2 (θ2) = k21 × (θ2-θ22 / 2) (12)
このとき、トルクToutは以下のように表される。 At this time, the torque Tout is expressed as follows.
Tout=T1(θ1)−T2(θ2)・・・(13) Tout = T1 (θ1) -T2 (θ2) (13)
したがって、トルク算出部7は、剛性情報(剛性k11,k21、高剛性領域の始点θ12,θ22、及び関数T1(θ1),T2(θ2))と、角度θ1,θ2と、に基づいて、式(9)〜(13)により、トルクToutを算出できる。第4の推定方法では、角度θ1,θ2が高剛性領域に含まれない場合であっても、トルクToutを精度よく推定できる。 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.
(第5の推定方法)
第5の推定方法は、剛性k11,k21が剛性情報として剛性情報記憶部6に予め記憶されている場合に利用できる。
(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.
出力軸Sに外部からトルクが加わると、このトルクにより、出力軸Sの角度がずれる(角度θoutが0ではなくなる)。そして、出力軸Sのずれにより、モータM1,M2が出力軸Sに加えるトルクT1,T2が変化する。 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.
ここで、図9は、角度θ1,θ2,θoutの関係を模式的に示す図である。図9の例では、モータM1,M2及び出力軸Sが弾性系として表されている。この場合、剛性k1は、モータM1と出力軸Sとを接続するバネの弾性係数に相当し、剛性k2は、モータM2と出力軸Sとを接続するバネの弾性係数に相当する。また、角度θ1,θ2及びN×θoutは、それぞれモータM1,M2及び出力軸Sの基準位置からの移動量に相当する。出力軸Sが角度θoutだけ移動すると、モータM1,M2がN×θoutだけ移動するためである。角度θ1及びトルクT1は、図9の右方向が正方向であり、角度θ2,θout及びトルクT2,Toutは、図9の左方向が正方向であるものとする。このとき、式(2),(3)は以下のように書き換えられる。 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)
T1 = T0 + k11 × (θ1 + N × θout) (14)
T2 = T0 + k21 × (θ2−N × θout) (15)
式(1)を変形し、式(14),(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×(θ1+N×θout)−k21×(θ2−N×θout)・・・(16)
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)
したがって、トルク算出部7は、剛性情報(剛性k11,k21)と、角度θ1,θ2,θoutと、に基づいて、式(16)により、トルクToutを算出できる。トルク算出部7は、角度θoutをエンコーダESから取得すればよい。 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.
以上説明した通り、本実施形態によれば、ダブルモータ制御により出力軸Sに加えられたトルクToutを、角度θ1,θ2及び剛性情報に基づいて、高精度に推定することができる。また、トルクToutを推定するために、トルクセンサが不要であるため、トルクToutの推定に要するコストを低減すると共に、推定精度を向上させるための伝達系G1,G2の剛性の低下を抑制することができる。 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.
<第2実施形態>
第2実施形態に係るトルク推定装置10について説明する。本実施形態では、出力軸SにエンコーダESが設けられていない場合について説明する。なお、モータ駆動システム100の構成及び動作は、第1実施形態と同様である。また、駆動系Dの構成は、エンコーダESを備えない点を除き、第1実施形態と同様である。
Second Embodiment
The
まず、本実施形態におけるステップS101〜S103について説明する。本実施形態において、まず、モータ制御部1は、ダブルモータコントローラ9を制御し、モータM1,M2に初期化電圧V12,V22を印加する(ステップS101)。初期化電圧V12,V22は、モータM1,M2に反対方向かつ大きさが等しいトルクT1,T2を発生させる電圧である。初期化電圧V12,V22は、モータM1,M2の剛性k1,k2が高剛性領域に含まれるように予め設定される。初期化電圧V12,V22の印加は、バックラッシュ制御に相当する。このとき、T1=T2であるため、Toutは0である。すなわち、出力軸Sは停止している。
First, steps S101 to S103 in the present embodiment will be described. In the present embodiment, first, the
より詳細には、モータM1に予め設定された初期化電圧V12を印加し、モータM2に反対方向の小さい電圧を印加し、当該電圧を徐々に大きくしていく。モータ制御部1は、エンコーダE1,E2の値を監視することにより、出力軸Sが停止する(T1=T2となる)までモータM2に印加する電圧を大きくする。出力軸Sが停止した際のモータM2の電圧が初期化電圧V22に相当する。これにより、モータ制御部1は、モータM1,M2に初期化電圧V12,V22を印加できる。
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
次に、トルク算出部7は、初期化電圧V12,V22を印加中のモータM1,M2の角度を、基準角度θ14,θ24としてエンコーダE1,E2から取得する(ステップS102)。ここで取得される基準角度θ14,θ24は、図4の高剛性領域に含まれる角度となる。 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.
その後、モータ制御部1は、ダブルモータコントローラ9を制御し、出力軸Sの駆動を開始する(ステップS103)。
Thereafter, the
ここで、第1実施形態との相違点について説明する。第1実施形態では、モータ制御部1は、エンコーダESの値を監視し、出力軸Sを基準角度(θout=0)で停止させた。このため、θout=0のときの角度θ1,θ2が基準角度θ11,θ21として取得され、式(2),(3)が成り立った。
Here, differences from the first embodiment will be described. In the first embodiment, the
これに対して、本実施形態では、エンコーダESが利用できないため、初期化電圧V12,V22の印加時に、出力軸Sがどこで停止するかわからない。すなわち、図9の例のように、出力軸Sがずれた角度で停止する可能性がある。このため、θout≠0のときの角度θ1,θ2が基準角度θ14,θ24として取得される。結果として、図9の例と同様に、トルクT1,T2について、式(14),(15)が成立する。以上のことを前提として、以下、本実施形態における推定方法について説明する。 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.
(第6の推定方法)
第6の推定方法は、剛性k11,k21が剛性情報として剛性情報記憶部6に予め記憶されている場合に利用できる。
(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.
第1実施形態と同様に、初期化電圧V12,V22の印加時には、T1=T2となっている。したがって、式(14),(15)より、以下の式が成り立つ。 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) k11 × (θ1 + N × θout) = k21 × (θ2−N × θout) (17)
式(17)をθoutについて整理すると、以下のようになる。 The equation (17) can be arranged as follows for θout.
θout=(k21×θ2−k11×θ1)/{N(k11+k21)}・・・(18) θout = (k21 × θ2-k11 × θ1) / {N (k11 + k21)} (18)
したがって、トルク算出部7は、剛性情報(剛性k11,k21)と、角度θ1,θ2と、に基づいて、式(18)より、出力軸Sの角度θoutを算出することができる。 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.
また、式(18)を式(14),(15)に代入すると、以下のようになる。 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)
T1 = T0 + k11 × {θ1 + (k21 × θ2-k11 × θ1) / (k11 + k21)} (19)
T2 = T0 + k21 × {θ2− (k21 × θ2−k11 × θ1) / (k11 + k21)} (20)
式(1)を変形し、式(19),(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)}]
=k11×θ1−k21×θ2+(k11−k21)×(k21×θ2−k11×θ1)/(k11+k21)・・・(21)
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)
したがって、トルク算出部7は、剛性情報(剛性k11,k21)と、角度θ1,θ2と、に基づいて、式(21)により、トルクToutを算出できる。 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.
(第7の推定方法)
第7の推定方法は、剛性k11,k21及び係数βが剛性情報として剛性情報記憶部6に予め記憶されている場合に利用できる。
(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.
出力軸Sに外力が加えられた場合、第5の推定方法と同様に、式(16)が成り立つ。式(16)をθoutについて整理すると、以下のようになる。 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) θout = (k21 × θ2-k11 × θ1 + Tout) / {N (k11 + k21)} (22)
一方、モータM1,M2の停止時には、以下の式が成り立つ。 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)
T1 = Kt1 × V1 / R1 (23)
T2 = Kt2 × V2 / R2 (24)
式(23)におけるKt1、V1、及びR1は、それぞれモータM1のトルク係数、電圧、コイル抵抗である。また、式(24)におけるKt2、V2、及びR2は、それぞれモータM2のトルク係数、電圧、コイル抵抗である。式(1)を変形し、式(23),(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) Tout = T1-T2 = Kt1 × V1 / R1-Kt2 × V2 / R2 = (V1−α × V2) × β (25)
式(24)の係数αは、Tout=0となる電圧V1,V2の比であるため、初期化電圧V12,V22の比に相当する(α=V22/V12)。また、式(24)の係数βは、Kt1/R1に相当する。ベータは、実験により予め求められる。 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.
したがって、トルク算出部7は、剛性情報(剛性k11,k21及び係数β)と、係数αと、角度θ1,θ2と、電圧V1,V2と、に基づいて、式(25)により、トルクToutを算出できる。また、トルク算出部24は、式(22),(25)より、出力軸Sの角度θoutを算出できる。 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).
以上説明した通り、本実施形態によれば、ダブルモータ制御により出力軸Sに加えられたトルクToutを、角度θ1,θ2及び剛性情報に基づいて、高精度に推定することができる。また、トルクToutを推定するために、トルクセンサ及びエンコーダESが不要であるため、トルクToutの推定に要するコストを低減すると共に、推定精度を向上させるための伝達系G1,G2の剛性の低下を抑制することができる。 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.
<第3実施形態>
第3実施形態に係るトルク推定装置10について説明する。本実施形態では、剛性比Kの算出方法について説明する。なお、モータ駆動システム100の構成及び動作は、第1実施形態と同様である。
Third Embodiment
The
(第1の算出方法)
第1の算出方法は、出力軸SにエンコーダESが設けられている場合に利用できる。第1の算出方法では、モータ制御部1は、モータM1,M2に初期化電圧V11,V21を印加し、基準角度θ11,θ21を取得した後、出力軸Sが基準角度(θout=0)で停止するように、モータM1,M2に初期化電圧V11,V21とは異なる電圧をそれぞれ印加する。そして、トルク算出部7は、出力軸Sの停止時のモータM1,M2の角度θ15,θ25を取得する。このとき、Tout=0であるため、式(4)より、以下の式が成り立つ。
(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
0=k11×θ15−k21×θ25・・・(26) 0 = k11 × θ15−k21 × θ25 (26)
式(26)を変形すると、以下のようになる。 The equation (26) is transformed as follows.
k21/k11=θ15/θ25・・・(27) k21 / k11 = θ15 / θ25 (27)
式(27)より、K=θ15/θ25であることがわかる。このように、トルク算出部7は、出力軸Sが基準角度で停止した際の角度θ15,θ25に基づいて、剛性比Kを算出することができる。 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.
(第2の算出方法)
第2の算出方法は、出力軸SにエンコーダESが設けられていない場合に利用できる。第2の算出方法では、モータ制御部1は、モータM1,M2に初期化電圧V12,V22を印加し、基準角度θ14,θ24を取得した後、電磁ブレーキなどにより、出力軸Sを固定する。出力軸Sの固定は、作業者が手作業で行ってもよい。
(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
出力軸Sの固定後、モータ制御部1は、初期化電圧V12,V22をモータM1,M2に再度印加する。トルク算出部7は、初期化電圧V12,V22の再度の印加時におけるモータM1,M2の角度θ16,θ26を取得する。第1の算出方法と同様に、初期化電圧V12,V22の再度の印加時には、式(27)が成り立つため、トルク算出部7は、角度θ16,θ26に基づいて、エンコーダESを利用することなく、剛性比Kを算出することができる(K=θ16/θ26)。
After fixing the output shaft S, the
以上説明した通り、本実施形態によれば、トルク算出部7は、モータM1,M2に所定の電圧を印加した際の角度θ1,θ2に基づいて、剛性比Kを算出することができる。剛性比Kは、予め算出され、剛性情報記憶部6に保存されていてもよいし、モータM1,M2を駆動する毎に算出されてもよい。後者の場合、初期化電圧の印加後の任意のタイミングで、トルク算出部7は剛性比Kを算出することができる。 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.
<第4実施形態>
第4実施形態に係るトルク推定装置10について、図10を参照して説明する。本実施形態では、4つのモータMにより、1つの出力軸Sを駆動する場合について説明する。なお、モータ駆動システム100の構成及び動作は、第1実施形態と同様である。
Fourth Embodiment
The
図10は、本実施形態における駆動系Dの一例を示す図である。図10の駆動系Dは、モータM1a,M1b,M2a,M2bと、ギアg1,g2と、出力軸Sと、を備える。モータM1a,M1bは、ギアg1を駆動する。モータM2a,M2bは、ギアg2を駆動する。ギアg1,g2は、出力軸Sを駆動する。すなわち、各モータM1a,M1b,M2a,M2bは、2段階の伝達系を介して、出力軸Sを駆動する。 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.
本実施形態では、トルク推定装置10は、モータM1a,M1bの角度θ1a,θ1bに基づいて、ギアg1に加えられたトルクTg1を推定できる。また、トルク推定装置10は、モータM2a,M2bの角度θ2a,θ2bに基づいて、ギアg2に加えられたトルクTg2を推定できる。ギアg1から出力軸Sへの減速比をN1、ギアg2から出力軸Sへの減速比をN2とすると、出力軸Sに加えられるトルクToutは以下の式で表される。
In the present embodiment, the
Tout=Tg1×N1+Tg2×N2・・・(28) Tout = Tg1 × N1 + Tg2 × N2 (28)
したがって、トルク推定装置10は、角度θ1a,θ1b,θ2a,θ2bに基づいて、式(28)より、トルクToutを推定することができる。
Therefore, the
なお、図10の例では、駆動系Dは2段階の伝達系を備えるが、3段階以上の伝達系を備えてもよい。例えば、駆動系Dが3段階の伝達系を備える場合、出力軸Sは、8つのモータMにより駆動される。この場合、トルク推定装置10は、8つのモータMの角度θに基づいて、出力軸Sに加えられたトルクを推定することができる。
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
なお、上記実施形態に挙げた構成等に、その他の要素との組み合わせなど、ここで示した構成に本発明が限定されるものではない。これらの点に関しては、本発明の趣旨を逸脱しない範囲で変更可能であり、その応用形態に応じて適切に定めることができる。 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:モータ制御部
2:PID制御部
3A,3B:印加電圧算出部
4A,4B:PWM生成部
5A,5B:駆動部
6:剛性情報記憶部
7:トルク算出部
8:異常検知部
9:ダブルモータコントローラ
10:トルク推定装置
1: Motor control unit 2:
Claims (7)
前記第1伝達系を介して出力軸を駆動する第1モータの角度と、第2伝達系を介して前記出力軸を駆動する第2モータの角度と、前記剛性情報と、に基づいて、前記出力軸に加わっているトルクを算出するトルク算出部を備える
トルク推定装置。 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.
請求項1に記載のトルク推定装置。 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.
請求項1又は請求項2に記載のトルク推定装置。 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.
請求項3に記載のトルク推定装置。 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.
請求項1から請求項4までのいずれか1項に記載のトルク推定装置。 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.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017220441A JP7000811B2 (en) | 2017-11-15 | 2017-11-15 | Torque estimator, method, and program |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017220441A JP7000811B2 (en) | 2017-11-15 | 2017-11-15 | Torque estimator, method, and program |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2019090725A true JP2019090725A (en) | 2019-06-13 |
JP7000811B2 JP7000811B2 (en) | 2022-01-19 |
Family
ID=66836210
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017220441A Active JP7000811B2 (en) | 2017-11-15 | 2017-11-15 | Torque estimator, method, and program |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7000811B2 (en) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02290187A (en) * | 1989-04-27 | 1990-11-30 | Okuma Mach Works Ltd | Synchronous control and device therefor |
JPH07505226A (en) * | 1992-04-02 | 1995-06-08 | ハイデルベルガー ドルツクマシーネン アクチエンゲゼルシヤフト | Device for measuring torque in gear transmissions for transmitting rotary motion |
JPH11264448A (en) * | 1998-03-18 | 1999-09-28 | Harmonic Drive Syst Ind Co Ltd | Angle transmission error correction method for wave motion gear wheel reduction gear |
JP2003264992A (en) * | 2002-03-07 | 2003-09-19 | Mitsubishi Heavy Ind Ltd | Multi-control redundant motor, multi-control actuator, and redundancy control method therefor |
US20110017004A1 (en) * | 2008-03-12 | 2011-01-27 | Jahnel-Kestermann Getriebewerke Gmbh & Co. Kg | Method for setting the tooth face position of a gear wheel |
JP2012211859A (en) * | 2011-03-31 | 2012-11-01 | Jatco Ltd | Torque detection system |
JP2013150493A (en) * | 2012-01-23 | 2013-08-01 | Canon Inc | Servo device |
WO2014098008A1 (en) * | 2012-12-22 | 2014-06-26 | 株式会社Schaft | Rotational drive device |
JP2017151528A (en) * | 2016-02-22 | 2017-08-31 | 株式会社リコー | Drive control device, motor drive system, image processing device, and conveyance device |
-
2017
- 2017-11-15 JP JP2017220441A patent/JP7000811B2/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02290187A (en) * | 1989-04-27 | 1990-11-30 | Okuma Mach Works Ltd | Synchronous control and device therefor |
JPH07505226A (en) * | 1992-04-02 | 1995-06-08 | ハイデルベルガー ドルツクマシーネン アクチエンゲゼルシヤフト | Device for measuring torque in gear transmissions for transmitting rotary motion |
JPH11264448A (en) * | 1998-03-18 | 1999-09-28 | Harmonic Drive Syst Ind Co Ltd | Angle transmission error correction method for wave motion gear wheel reduction gear |
JP2003264992A (en) * | 2002-03-07 | 2003-09-19 | Mitsubishi Heavy Ind Ltd | Multi-control redundant motor, multi-control actuator, and redundancy control method therefor |
US20110017004A1 (en) * | 2008-03-12 | 2011-01-27 | Jahnel-Kestermann Getriebewerke Gmbh & Co. Kg | Method for setting the tooth face position of a gear wheel |
JP2012211859A (en) * | 2011-03-31 | 2012-11-01 | Jatco Ltd | Torque detection system |
JP2013150493A (en) * | 2012-01-23 | 2013-08-01 | Canon Inc | Servo device |
WO2014098008A1 (en) * | 2012-12-22 | 2014-06-26 | 株式会社Schaft | Rotational drive device |
JP2017151528A (en) * | 2016-02-22 | 2017-08-31 | 株式会社リコー | Drive control device, motor drive system, image processing device, and conveyance device |
Also Published As
Publication number | Publication date |
---|---|
JP7000811B2 (en) | 2022-01-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3023208B1 (en) | Control device for motor drive device, control device for multi-axial motor, and control method for motor drive device | |
JP4962488B2 (en) | Torque measuring device | |
JP4684330B2 (en) | Screw tightening device | |
JP4824080B2 (en) | Synchronous control system | |
JP5656193B2 (en) | Actuator positioning device with wave gear device | |
US10919150B2 (en) | Motor control system, control method for motor control system, and robot system | |
JPWO2007099629A1 (en) | Motor control device and motor control method | |
JP2014013554A (en) | Servo control device including function for correcting expansion and contraction amount of ball screw | |
US11171582B2 (en) | Drive device for correcting angular deviation between shafts | |
US10656616B2 (en) | Control device, control system, and recording medium | |
JPWO2007099628A1 (en) | Screw tightening control system and screw tightening control method | |
JP6844462B2 (en) | Angle detector eccentricity error correction method, robot system | |
EP3626409B1 (en) | Speed reducer angular transmission error identification system and speed reducer angular transmission error identification method | |
WO2014091840A1 (en) | Servo control device | |
EP3277464B1 (en) | Power tool with output torque compensation and method therefore | |
WO2017203987A1 (en) | Parameter identification device, motor control system, parameter identification method, and program | |
TWI516888B (en) | Servo control device | |
JP7000811B2 (en) | Torque estimator, method, and program | |
JP2004234205A (en) | Numerical controller | |
Lee et al. | Friction analysis according to pretension of laparoscopy surgical robot instrument | |
JP2018107878A (en) | Motor control system | |
JP6965668B2 (en) | Input / output circuit characteristic adjustment device and input / output circuit characteristic adjustment method | |
JP6696359B2 (en) | Angular position detector | |
JP2020197951A (en) | Information processing device, machine tool, robot, control method for information processing device and control program for information processing device | |
JP2006119958A (en) | Robot control device and control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200916 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210630 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210706 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210906 |
|
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: 20211124 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20211207 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 7000811 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |