发明名称 |
Servo control device reducing deflection of front end point of machine |
摘要 |
A servo control device having a position control unit and a speed control unit to control a front end point of a machine of a machine tool, comprising: a position detecting unit for detecting a position of a motor; a first position error calculating unit for calculating a first position error based on a position command to a motor and position feedback from the position detecting unit; a torsion estimating unit for estimating an amount of torsion of the front end point of the machine; a second position error calculating unit for adding the first position error and estimated amount of torsion to calculate a second position error; a coefficient adapting unit for determining a coefficient of feedforward control so as to minimize the second position error; and a higher order feedforward control unit for performing feedforward control by using the determined coefficient and the position command. |
申请公布号 |
US9471055(B2) |
申请公布日期 |
2016.10.18 |
申请号 |
US201514728494 |
申请日期 |
2015.06.02 |
申请人 |
Fanuc Corporation |
发明人 |
Sonoda Naoto |
分类号 |
H02P6/00;G05B19/404;G05B19/19 |
主分类号 |
H02P6/00 |
代理机构 |
RatnerPrestia |
代理人 |
RatnerPrestia |
主权项 |
1. A servo control device which comprises a position control unit and a speed control unit and which controls the position and speed of a motor to control a front end point of a machine of a machine tool, the control device comprising:
a position detecting unit configured to detect a position of a driven member which is driven by the motor or the motor; a first position error calculating unit configured to calculate a first position error on the basis of a position command to a motor and position feedback from said position detecting unit; a torsion estimating unit configured to estimate an amount of torsion of the front end point of the machine; a second position error calculating unit configured to add said first position error and estimated amount of torsion to calculate a second position error; a coefficient adapting unit configured to determine a coefficient of feedforward control so as to minimize said second position error; and a higher order feedforward control unit configured to perform the feedforward control by using said determined coefficient and the position command to the motor. |
地址 |
Yamanashi JP |