Method of detecting an abnormal load on a servomotor and controlling the same in such an abnormal condition
First Claim
1. A method of detecting an abnormal load on a servomotor driving a machine and controlling the servomotor in such an abnormal condition, comprising the steps of:
- (a) rotating a servomotor in a first direction to drive a machine tool;
(b) detecting an abnormal load acting on the servomotor during a driver operation and due to a large torque developed by the rotation of said servomotor in said first direction when an obstacle collides with said machine tool causing an elastic deformation on said machine tool;
(c) executing a position loop processing using an error register for storing a positional deviation value;
(d) setting a predetermined positional deviation having a direction opposite to said first direction in said error register when said abnormal load is detected; and
(e) rotating the servomotor in the direction opposite to the first direction by a predetermined rotational amount corresponding to said predetermined positional deviation and then stopping the servomotor, to release said elastic deformation of said machine tool.
0 Assignments
0 Petitions
Accused Products
Abstract
A method of detecting an abnormal load and controlling a servomotor in such an abnormal condition. The servomotor is controlled so that a load will not continuously act on a machine after the abnormal load is detected. When a load torque, detected by an observer, exceeds a reference value, a flag F1 is set to "1". In the next processing cycle, the flag F1 is "1" and a flag F2 is "0", so that a positional deviation A, having a direction opposite to the driving direction, is set in the error register, and the flag F2 is set to "1". In the succeeding processing cycles, a position feedback amount θ is subtracted from the error register to obtain a positional deviation, and the obtained positional deviation is used to execute a position and speed loop processing. The servomotor rotates in the opposite direction until the positional deviation A is reduced to "0" before it stops.
20 Citations
3 Claims
-
1. A method of detecting an abnormal load on a servomotor driving a machine and controlling the servomotor in such an abnormal condition, comprising the steps of:
-
(a) rotating a servomotor in a first direction to drive a machine tool; (b) detecting an abnormal load acting on the servomotor during a driver operation and due to a large torque developed by the rotation of said servomotor in said first direction when an obstacle collides with said machine tool causing an elastic deformation on said machine tool; (c) executing a position loop processing using an error register for storing a positional deviation value; (d) setting a predetermined positional deviation having a direction opposite to said first direction in said error register when said abnormal load is detected; and (e) rotating the servomotor in the direction opposite to the first direction by a predetermined rotational amount corresponding to said predetermined positional deviation and then stopping the servomotor, to release said elastic deformation of said machine tool. - View Dependent Claims (2)
-
-
3. A method of detecting an abnormal load on a servomotor driving a machine and controlling the servomotor in such an abnormal condition, comprising the steps of:
-
(a) executing a position loop processing; (b) storing a positional deviation value based on the position loop processing in an error register; (c) driving and controlling a servomotor to rotate in a first direction based on the stored positional deviation, to drive a machine tool; (d) estimating a disturbance torque applied to the servomotor using an observer during the driving and controlling of the servomotor driving the machine tool; (e) determining an existence of the abnormal load when the disturbance torque estimated in step (d) exceeds a reference value due to a large torque developed bv the rotation of said servomotor in said first direction when an obstacle collides with said machine tool causing an elastic deformation on said machine tool; (f) setting a predetermined positional deviation having a direction opposite to the first direction in said error register, when the abnormal load is determined in said step (e); and (g) rotating the servomotor in the opposite direction by a rotational amount corresponding to said predetermined positional deviation and then stopping the servomotor, to release said elastic deformation of the machine tool.
-
Specification