US 5,744,926 AGranted

Servo motor positioning control and position recording chip device

AssigneeIndustrial Technology Research Institute

InventorsChen-Kuo Lai, Chang-Yu Ho, Jia-Cheng Ke

Life of this patent

Estimating the term…

Loading patent…

Abstract

A chip device for positioning control and position recording of a servo motor. The chip device can be operated in two modes: a first mode, and a second mode. In the first mode, the chip device can perform step command conversion, position loop control, multiple shaft synchronization, and recording of the position of the motor shaft. The step command conversion utilizes a digital-differential analysis (DDA) method to convert the step waveform in the command signal into ramp waveform for smoothed control of the servo motor. The position loop control circuit compute for the error in position and then compensates the error to generate a 12-bit 2's complement output which is subsequently converted to analog signal used to drive the servo motor. The purpose of multiple shaft synchronization is to allow a plurality of servo motor to rotate in synchronization and accurately with the same increments. The recording of the position of the motor shaft is achieved by counting the number of pulses from a position encoder coupled to the servo motor. The chip device is fast in processing speed, small in size, and reliable in operation, and allows synchronization among a plurality of servo motors. Moreover, the chip device can be built with fewer components so that production cost can be reduced.

Claims16

Dependent claims

A servo motor positioning control and position recording chip device which comprising:

a position encoder, coupled to the servo motor, for detecting the position of the shaft of the servo motor and thereby generating a feedback signal;
a filter, coupled to said position encoder, for filtering out noises in the feedback signal;
a multiplication circuit, coupled to said filter, for multiplying the output of the filter by a preselected multiplier selected from 0, 1, 2, and 4;
a DDA circuit, responsive to an input programmed position command signal, for generating a simulated linear output;
a summation circuit, coupled to said DDA circuit and said multiplication circuit, for selectively summing up the negative of the output of said multiplication circuit to the output of said DDA circuit or to an external input position command signal;
a first programmable counter, coupled to said summation circuit, for counting the number of pulses in the output of said summation circuit and thereby generating a serial output;
an up/down counter, coupled to said first programmable counter, for converting the serial output of said first programmable counter into a parallel output;
a saturation adjustment circuit, coupled to said up/down counter, for performing saturation adjustment to the parallel output of said up/down counter;
a digital-to-analog converter, coupled to said saturation adjustment circuit, for converting the output of said saturation adjustment circuit into an analog signal;
a driver, coupled to said digital-to-analog converter, for driving the servo motor to rotate by a specific displacement in responsive to the analog signal;
an overflow detection circuit, coupled to said up/down counter, for detecting whether an overflow occurs to said up/down counter, said overflow detection circuit generating an interrupt signal to a CPU governing the operation of said chip device to handle the overflow condition;
a counter, coupled to said multiplication circuit, for counting the number of pulses from said multiplication circuit during a predetermined period, said counter generating an actuating signal to the CPU to actuate the CPU to generate another input programmed position command signal to said chip device;
and
a second programmable counter, coupled to a clock signal, for generating a base frequency signal to drive said DDA circuit.

11 more elements

A servo motor positioning control and position recording chip device which comprising:

a position encoder, coupled to the servo motor, for detecting the position of the shaft of the servo motor and thereby generating a feedback signal;
a filter, coupled to said position encoder, for filtering out noises in the feedback signal;
a multiplication circuit, coupled to said filter, for multiplying the output of the filter by a preselected multiplier selected from 0, 1, 2, and 4;
a DDA circuit, responsive to an input programmed position command signal, for generating a simulated linear output;
a summation circuit, coupled to said DDA circuit and said multiplication circuit, for selectively summing up the negative of the output of said multiplication circuit to the output of said DDA circuit or to an external input position command signal;
a first programmable counter, coupled to said summation circuit, for counting the number of pulses in the output of said summation circuit and thereby generating a serial output;
an up/down counter, coupled to said first programmable counter, for converting the serial output of said first programmable counter into a parallel output;
a saturation adjustment circuit, coupled to said up/down counter, for performing saturation adjustment to the parallel output of said up/down counter;
a digital-to-analog converter, coupled to said saturation adjustment circuit, for converting the output of said saturation adjustment circuit into an analog signal;
a driver, coupled to said digital-to-analog converter, for driving the servo motor to rotate by a specific displacement in responsive to the analog signal;
an overflow detection circuit, coupled to said up/down counter, for detecting whether an overflow occurs to said up/down counter, said overflow detection circuit generating an interrupt signal to a CPU governing the operation of said chip device to handle the overflow condition;
a counter, coupled to said multiplication circuit, for counting the number of pulses from said multiplication circuit during a predetermined period, said counter generating an actuating signal to the CPU to actuate the CPU to generate another input programmed position command signal to said chip device;
and
a second programmable counter, coupled to a clock signal, for generating a base frequency signal to drive said DDA circuit;
and
when working in a second mode, said chip device comprising:
a position encoder, coupled to the servo motor, for detecting the position of the shaft of the servo motor and thereby generating an A/B phase feedback signal;
a filter, coupled to said position encoder, for filtering out noises in the A/B phase feedback signal;
a multiplication circuit, coupled to said filter, for multiplying the output of the filter by a preselected multiplier selected from 0, 1, 2, and 4;
an up/down counter, coupled to said multiplication circuit, for counting pulses in the output of said multiplication circuit, the count of said up/down counter representing the position of the shaft of the motor;
an index position acquirer, coupled to said up/down counter, for acquiring the index position of said position encoder for the servo motor to reset to a home position;
a control code register, for storing control codes for internal control of said chip device;
a status register for recording current status of said chip device;
a multiplexer, responsive to a selection signal from a CPU governing the operation of said chip device, for selectively outputting the output of said index position acquirer, the output of said control code register, and the output of said status register;
and
a control logic circuit for generating control signals for control of said chip device.

23 more elements

Dependencies are inferred from the claim text.