摘要:
A servo control device includes: a speed control loop including a speed command generating unit, a torque command generating unit, and a speed detecting unit; a sine wave disturbance input unit; a frequency response calculating unit estimating a gain and phase of speed control loop input/output signals; a resonance frequency detecting unit; a resonance mode characteristic estimating unit estimating resonance characteristics from the frequency response at a resonance frequency and frequencies therearound; a rigid-body mode characteristic estimating unit estimating rigid-body characteristics from the frequency response in a low-frequency band; a filter attenuating a component in a particular frequency band in a torque command; and a filter adjusting unit making setting so that the filter has specified characteristics. The filter adjusting unit further includes a filter adjusting part attenuating a component in a frequency band corresponding to a resonance mode estimated by the resonance mode characteristic estimating unit.
摘要:
A force detector provided between a robot arm and a robot hand detects forces Fx, Fy, and Fz. A robot controller performs a filtering process for the forces Fx and Fy by a first low-pass filter of a cutoff frequency Fc1, moves the robot hand so that the forces Fx and Fy become smaller, corrects a trajectory of the robot arm, performs a filtering process for the force Fz by a second low-pass filter of a cutoff frequency Fc2 having a frequency higher than the cutoff frequency Fc1, performs a threshold value determination for the force Fz, and stops the movement of the robot hand when the force Fz exceeds a threshold value during a fitting operation.
摘要:
A digital servo control unit which uses a D/A converter, which suppresses the spike-like pulsation superimposed on a current error signal inside a current control circuit, and which has control performance not lower than that in the background art even when a low-voltage and low-price power supply circuit is used. A first-order low pass filter acts on an analog signal output by the D/A converter, and a stabilizing compensation occurs for a phase delay caused by the first-order low pass filter. The first-order low pass filter is formed as a low pass filter having a cut-off frequency which is lower than a sampling frequency. The first-order low pass filter may be replaced by a notch filter having a cut-off frequency which is equal to a sampling frequency or which is equal to an integer multiple of a Nyquist frequency.
摘要:
There is provided a digital servo control unit which uses a D/A converter, which suppresses the spike-like pulsation superimposed on a current error signal inside a current control circuit, and which has control performance not lower than that in the background art even when a low-voltage and low-price power supply circuit is used. The digital servo control unit has a first-order low pass filter acting on an analog signal output by the D/A converter, and a stabilizing compensation means for compensating a phase delay caused by the first-order low pass filter. An output signal of the first-order low pass filter is input to a current control circuit as a current command signal. The first-order low pass filter is formed as a low pass filter having a cut-off frequency which is lower than a sampling frequency. The first-order low pass filter may be replaced by a notch filter having a cut-off frequency which is equal to a sampling frequency or which is equal to an integer multiple of a Nyquist frequency.
摘要:
An apparatus which allows one to maintain precision placement of a manipulator which undergoes repeated controlled motions or trajectories is provided. The structure of the apparatus is compliant such that the manipulator may be displaced by forces applied to the mechanical structure. This compliance is due to a lack of precision in the fabrication of the component parts of the machine, and to a lack of rigidity due to a lightweight design. This displacement is of a greater magnitude than the precision positioning tolerance of the apparatus. Consequently, the manipulator may then be displaced outside of the positioning tolerance due to applied forces. However, it is a characteristic of the present invention, that despite the compliance of the mechanical structure of the apparatus, the positioning tolerance will be maintained. The controlled motion is accomplished by the generation of control signals by computer software running on a computer control system. The control software enables the system to run at much greater speeds while not exciting unwanted movement or vibration in the compliant mechanical structure.