Method for controlling force application with servo motor and appartus therewith
AssigneeFanuc Corporation
InventorsTetsuaki Kato, Koichi Okanda
Life of this patent
Estimating the term…
Abstract
An applied force Td is estimated by an observer. A gain A is multiplied by a value obtained by subtracting the estimated applied force Td from commanded force Fe. From this multiplied value, a product of a speed feedback amount and a gain Kv is subtracted to obtain a torque command. With this torque command Tc, a servo motor is driven. Since a feedback control of the applied force is performed, response is fast, and an applied force between welding tips and an object to be welded can be accurately controlled. Feedback control of an applied force, whose vibration is prevented, can be performed by adjusting the gains A and Kv.
Claims14
A method for controlling force application with a servo motor, by controlling an applied force of welding tips of a welding gun, driven by the servo motor, to an object to be welded, comprising:
- forming a force control loop with an applied force commanded to the servo motor, a torque command outputted to the servo motor, and an applied force estimated by an observer unit;
- performing feedback control of the applied force;
- and
- controlling vibration of the welding tips by adjusting a gain of the feedback control.
An apparatus for controlling force application with a servo motor, that controls an applied force of welding tips of a welding gun, driven by the servo motor, to an object to be welded, comprising:
- an observer unit estimating the applied force;
- and
- a force control loop processing execution means for performing force feedback control with an applied force commanded to the servo motor, a torque command outputted to the servo motor, and the applied force estimated by the observer unit, and for adjusting a gain of the force feedback control to control vibration of the welding tips.
An apparatus for controlling force application with a servo motor, comprising:
- a controller outputting a force control command of an applied force of welding tips of a welding gun, driven by a servo motor, to an object to be welded;
- applied-force estimation means for estimating an applied force produced when a movable object is driven by the servo motor and pressed to another object in accordance with a force application control command from the controller;
- speed detection means for detecting an actual speed of the servo motor;
- and
- torque command means for calculating a torque command Tc outputted to the servo motor with using the following equation:
- Tc=A*(Fc−Td)−Kv*v
- and outputting the torque command to the servo motor, where A and Kv are coefficients, Fc is the force application control command outputted from the controller, Td is the applied force estimated in the applied-force estimation means, and v is the speed of the servo motor detected by the speed detection means.
A method for controlling force application with a servo motor, by controlling an applied force of welding tips of a welding gun, driven by the servo motor, to an object to be welded, comprising:
- forming a force control loop with an applied force commanded to the servo motor, a torque command outputted to the servo motor, and an applied force estimated by an observer unit;
- performing feedback control of the applied force;
- and
- adjusting a gain of amplification of a deviation between a force application command in the force control loop and the estimated applied-force to control vibration of the welding tips.
An apparatus to control an applied force of welding tips of a welding gun, driven by a servo motor, to an object to be welded, comprising:
- an observer unit to estimate the applied force;
- a force feedback control loop based on an applied force commanded to a servo motor, a torque command outputted to the servo motor, and the applied force estimated by the observer unit;
- and
- a speed feedback control loop based on a difference between a speed of a movable object and a difference between the applied force commanded and the applied force estimated, wherein a gain of the speed feedback control is adjusted to control vibration of the welding tips.
An apparatus for controlling force application with a servo motor, that controls an applied force of welding tips of a welding gun, driven by the servo motor, to an object to be welded, comprising:
- an observer unit estimating the applied force;
- and
- a force control loop processing execution means for performing force feedback control with an applied force commanded to the servo motor, a torque command outputted to the servo motor, and the applied force estimated by the observer unit, and for adjusting a gain of amplification of a deviation between a force application command in the force control loop and the estimated applied-force to control vibration of the welding tips.
An apparatus to control an applied force of welding tips of a welding gun, driven by a servo motor, to an object to be welded, comprising:
- an observer unit to estimate the applied force;
- a force feedback control loop based on an applied force commanded to a servo motor, a torque command outputted to the servo motor, and the applied force estimated by the observer unit;
- and
- a speed feedback control loop based on a difference between a speed of a movable object and a difference between the applied force commanded and the applied force estimated, wherein a gain of amplification of a deviation between a force application command in the force feedback control loop and the estimated applied-force is adjusted to control vibration of the welding tips.
Dependencies are inferred from the claim text.