Integrated circuit for multiple-axis position control
AssigneeIndustrial Technology Research Institute
InventorsChen-Kuo Lai, Wen-Chuan Chen, Ying-Min Chen, Chang-Yu Ho
Life of this patent
Estimating the term…
Abstract
The present invention is an integral-type IC for multiple-axis position control to provide highly integrated and modular design for the positioning control of automatic system. The inventive IC comprises a plurality of digital differential analyzers (DDA) with output pulse circuit which convert the position command to pulse form, a plurality of servo motor position closed loop control positioning circuit, and a plurality of counters that works with motor encoder to precisely control the rotation speed and motion position of the motor. Thus the invention the position control function in a single IC.
Claims20
An IC for multiple-axis positioning control of a motor that includes an encoder, the IC comprising:
- a plurality of A/D interface circuits that receive analog input signals, and transform the analog input signals to corresponding digital signals;
- a plurality of positioning control loops (PCL);
- a plurality of D/A interface circuits that are coupled to outputs of the PCLs;
- a plurality of digital differential analyzers (DDA) that receive commands from an ISA bus, convert the commands to pulse waveform, and send the pulse waveform to the plurality of PCLs;
- a plurality of encoder counters that receive encoder signals from the encoder of the motor for recording the position of the motor, and which provide counting results to the PCLs;
- wherein the PCLs receive counting results from the encoder counters and receive the pulse waveform from the DDAs, and output a result to the D/A interface circuits;
- and
- wherein the DDAs are coupled to a control circuit that includes:
- a controller that controls the operation of the DDAs;
- a DDA counter that counts the operation times of the DDA;
- and
- a DDA clock frequency divider that provides a divided timing clock to the DDA.
An IC for multiple-axis positioning control of a motor that includes an encoder, the IC comprising:
- a plurality of A/D interface circuits that receive analog input signals, and transform the analog input signals to corresponding digital signals;
- a plurality of positioning control loops (PCL);
- a plurality of D/A interface circuits that are coupled to outputs of the PCLs;
- a plurality of digital differential analyzers (DDA) that receive commands from an ISA bus, convert the commands to pulse waveform, and send the pulse waveform to the plurality of PCLs, the DDAs comprising:
- a FIFO stacker provided in the DDA of one axis including a stacker with a plurality of bytes for storing the commands;
- a DDA engine which converts the commands to the pulse waveform;
- and
- a pulse output reshaper coupled to the DDA engine to reshape the pulse waveform;
- and
- a plurality of encoder counters that receive encoder signals from the encoder of the motor for recording the position of the motor, and which provide counting results to the PCLs;
- wherein the PCLs receive counting results from the encoder counters and receive the pulse waveform from the DDAs, and output a result to the D/A interface circuits.
An IC for multiple-axis positioning control of a motor that includes an encoder, the IC comprising:
- a plurality of A/D interface circuits that receive analog input signals, and transform the analog input signals to corresponding digital signals;
- a plurality of positioning control Loops (PCL);
- a plurality of D/A interface circuits that are coupled to outputs of the PCLs;
- a plurality of digital differential analyzers (DDA) that receive commands from an ISA bus, convert the commands to pulse waveform, and send the pulse waveform to the plurality of PCLs;
- and
- a plurality of encoder counters that receive encoder signals from the encoder of the motor for recording the position of the motor, and which provide counting results to the PCLs, the encoder counters including:
- an input decoder;
- an up/down counter coupled to the input decoder;
- a plurality of filters coupled to the motor and the input decoder for filtering the encoder signals from the motor and providing the filtered encoder signals to the input decoder which then forwards the filtered encoder signals to the input decoder;
- a first latch coupled to the up/down counter to latch the up/down counter;
- and
- a second latch coupled to the up/down counter and one of the filters to latch the up/down counter;
- wherein the PCLs receive counting results from the encoder counters and receive the pulse waveform from the DDAs, and output a result to the D/A interface circuits.
An IC for multiple-axis positioning control of a motor that includes an encoder, the IC comprising:
- a plurality of A/D interface circuits that receive analog input signals, and transform the analog input signals to corresponding digital signals;
- a plurality of positioning control Loops (PCL);
- a plurality of D/A interface circuits that are coupled to outputs of the PCLs, the D/A interface circuits comprising:
- a latch circuit operating as an input;
- and
- a serial DAC interface circuit coupled to the latch circuit for performing interface data conversion and operating as an output;
- a plurality of digital differential analyzers (DDA) that receive commands from an ISA bus, convert the commands to pulse waveform, and send the pulse waveform to the plurality of PCLs;
- and
- a plurality of encoder counters that receive encoder signals from the encoder of the motor for recording the position of the motor, and which provide counting results to the PCLs;
- wherein the PCLs receive counting results from the encoder counters and receive the pulse waveform from the DDAs, and output a result to the D/A interface circuits.
An IC for multiple-axis positioning control of a motor that includes an encoder, the IC comprising:
- a plurality of A/D interface circuits that receive analog input signals, and transform the analog input signals to corresponding digital signals, the A/D interface circuits having:
- a serial ADC interface circuit operating as an input and receiving data from an external A/D converter for interfacing;
- and
- a latch circuit coupled to the serial ADC interface circuit and operating as an output to latch converted data;
- a plurality of positioning control loops (PCL);
- a plurality of D/A interface circuits that are coupled to outputs of the PCLs;
- a plurality of digital differential analyzers (DDA) that receive commands from an ISA bus, convert the commands to pulse waveform, and send the pulse waveform to the plurality of PCLs;
- and
- a plurality of encoder counters that receive encoder signals from the encoder of the motor for recording the position of the motor, and which provide counting results to the PCLs;
- wherein the PCLs receive counting results from the encoder counters and receive the pulse waveform from the DDAs, and output a result to the D/A interface circuits.
An IC for multiple-axis positioning control of a motor that includes an encoder, the IC comprising:
- a plurality of A/D interface circuits that receive analog input signals, and transform the analog input signals to corresponding digital signals;
- a plurality of positioning control loops (PCL);
- a plurality of D/A interface circuits that are coupled to outputs of the PCLs;
- a plurality of digital differential analyzers (DDA) that receive commands from an ISA bus, convert the commands to pulse waveform, and send the pulse waveform to the plurality of PCLs;
- a plurality of encoder counters that receive encoder signals from the encoder of the motor for recording the position of the motor, and which provide counting results to the PCLs;
- wherein the PCLs receive counting results from the encoder counters and receive the pulse waveform from the DDAs, and output a result to the D/A interface circuits, and wherein the PCLs include:
- a control circuit;
- a plurality of ratio registers to record the position loop gain of each axis to be controlled and functioning as an input end of the PCLS;
- a plurality of error counters to calculate the error between the command pulse waveform and a feedback pulse coupled to the PCL;
- a multiplier coupled to the ratio registers and the error counters to calculate the product of the ratio registers and the error counters;
- and
- a plurality of output registers coupled to the multiplier to record the error compensation value of the control axis in each direction.
Dependencies are inferred from the claim text.