Controller and filter used therein

A controller comprising:

• an interpolation calculator operable to divide move data of a robot arm tip position into each sampled period, the data supplied from a position teaching section;
• a distance calculator operable to calculate a straight line distance between a motor and the robot arm tip, and a horizontal component of the distance;
• and
• an acceleration and deceleration (A & D) time calculator operable to calculate load inertia as a function of the straight line distance between the motor and the robot arm tip as well as gravity torque as a function of a horizontal component of the straight line distance, thereby calculating an optimum A & D time.

A controller comprising:

• an acceleration and deceleration (A & D) processor operable to vary an A & D time through varying a cut-off frequency of a filter;
• a move command generator;
• a coefficient calculator operable to calculate a coefficient that accelerates and decelerates a motor, a total of the coefficients is "1" (one);
• and
• a controller operable to control a motor based on an output from an adder;
• wherein said A & D processor comprises the following elements:
• an FIR (finite impulse response) filter having N steps (N=natural number including 2 and over), wherein said FIR filter comprises the following elements:
• N-1 pieces of shift registers coupled in series and operable to shift a move command tapped off from said move command generator;
• N pieces of multipliers operable to multiply an input move command value and move command values stored in each shift register by the coefficients calculated by said coefficient calculator respectively;
• and
• N-1 pieces of said adders operable to add outputs from said multipliers.

A controller comprising:

• an acceleration and deceleration (A & D) processor operable to vary an A & D time through varying a cut-off frequency of a filter;
• a move command generator operable to generate a move command that drives the motor;
• a coefficient calculator operable to calculate a coefficient that performs accelerates and decelerates the motor;
• an A & D processor comprising the following elements:
• N pieces of multipliers operable to multiply the move command by coefficients, the coefficients sum up to "1" (one);
• N pieces of FIR (finite impulse response) filters;
• and
• N pieces of adders operable to add outputs from said FIR filters;
• and
• a controller operable to control the motor based on outputs from said adders.

A controller comprising:

• an acceleration and deceleration (A & D) processor operable to vary an A & D time through varying a cut-off frequency of a filter;
• move command generator operable to generate a move command that drives the motor;
• a coefficient calculator operable to calculate a coefficient that accelerates and decelerates a motor, a total of the coefficients is "1" (one);
• an A & D processor comprising N steps of FIR (finite impulse response) filter (N=natural numbers including 2 and over), wherein said FIR filter comprises the following elements:
• N-1 pieces of shift registers coupled in series operable to shift move commands tapped off from said move command generator;
• N pieces of multipliers operable to multiply input move command values from said move command generator and move command values stored in each shift register respectively by coefficients calculated in said filter coefficients calculator;
• N-1 pieces of adders operable to add outputs from said multipliers;
• and
• a coefficients shift register operable to shift a coefficient from said filter coefficient calculator in synchronizing with a shift of said shift register, thereby rewriting a coefficient of said multipliers;
• and
• a controller operable to control the motor based on outputs from said adders.

A controller comprising:

• an acceleration and deceleration (A & D) processor operable to vary an A & D time through varying a cut-off frequency of a filter;
• a command value judge section operable to judge whether a move command generated by a move command generator exceeds a prescribed value;
• and
• a command value modifier operable to multiply the move command value by 1/2n (n=natural numbers including 1 and over) when the move command value exceeds the prescribed value, and feeding the resulting multiplied value into said A & D processor.

A controller comprising:

• an acceleration and deceleration (A & D) processor operable to vary an A & D time through varying a cut-off frequency of a filter;
• a differential value judge section operable to judge a difference between adjacent sample periods when the move command values generated from the move command generator vary in adjacent sample periods;
• a zero command generator operable to generate a zero command;
• and
• a command switch section operable to switch the move command to the zero command and outputs the zero command into said A & D processor when the difference exceeds a prescribed value, said command switch section successively outputs the zero commands for N sample periods when said FIR filter of said A & D processor has N steps.

A method of control comprising:

• interpolation calculating for dividing move data of a robot arm tip position into each sample period, the data fed from a position teaching section;
• calculating load inertia;
• calculating gravity torque;
• calculating an optimum acceleration and deceleration (A & D) time by using the load inertia and the gravity torque;
• providing an A & D process to move data of each sample time calculated in said interpolation calculating based on the A & D time;
• and
• controlling each motor based on the move data processed by said A & D processing.

A method of control comprising:

• an interpolation calculating for dividing move data of a robot arm tip position into each sample period, the data fed from a position teaching section;
• calculating a straight line distance between the motor and the robot arm tip, and a horizontal component of the distance;
• and
• calculating load inertia as a function of a straight line distance between a motor and the robot arm tip as well as gravity torque as a function of a horizontal component of the straight line distance, thereby calculating an optimum acceleration and deceleration time.

A method of control comprising:

• an acceleration and deceleration (A & D) processing for varying an A & D time through varying a cut-off frequency of a filter;
• generating a move command;
• calculating a coefficient that accelerates and decelerates a motor, a total of the coefficients is "1" (one);
• wherein said A & D processing is performed by using N (N=natural number including 2 and over) steps of FIR filter, and said A & D processing comprises:
• shifting a move command tapped off from a move command generator by N-1 pieces of shift registers coupled in series;
• multiplying an input move command value and move command values stored in each shift register respectively by the coefficients calculated in a coefficient calculator, said multiplication is performed in N pieces of multipliers;
• and
• adding the resulting multiplied move command values in said multiplying by N-1 pieces of adders;
• and
• controlling the motor based on an output from the adders.

A method of control comprising:

• an acceleration and deceleration (A & D) processing for varying an A & D time through varying a cut-off frequency of a filter;
• generating a move command that drives the motor;
• calculating coefficients that performs A & D to the motor;
• an A & D processing with a plurality of FIR (finite impulse response) filters, wherein said A & D processing comprises:
• multiplying the move command by coefficients that are calculated in said coefficient calculating and sum up to "1" (one) in N pieces of multipliers;
• providing the A & D process to the move command multiplied by the coefficients that sum up to "1" (one) through the N pieces of FIR filters;
• and
• adding outputs from the N pieces of FIR filters through N pieces of adders;
• and
• controlling a motor based on outputs from the adders.

A method of control comprising:

• an acceleration and deceleration (A & D) processing for varying an A & D time through varying a cut-off frequency of a filter;
• generating a move command;
• calculating a filter coefficient that accelerates and decelerates a motor, a total of the coefficients is "1" (one);
• wherein said A & D processing is performed by using N (N=natural number including 2 and over) steps of FIR (finite impulse response) filter, and said A & D processing comprises:
• shifting a move command tapped off at said move command generating by N-1 pieces of shift registers coupled in series;
• multiplying an input move command value and move command values stored in each shift register respectively by the coefficients calculated in said coefficient calculating, said multiplying is performed in N pieces of multipliers;
• adding outputs from the multipliers through N-1 pieces of adders;
• and
• shifting a coefficient from said filter coefficient calculating in synchronizing with a shift of the shift register, thereby rewriting a coefficient of the multipliers;
• and
• controlling the motor based on outputs from the adders.

A method of control comprising:

• an acceleration and deceleration (A & D) processing for varying an A & D time through varying a cut-off frequency of a filter;
• judging whether a move command generated at said move command generating exceeds a prescribed value;
• and
• multiplying the move command value by 1/2n (n=natural numbers including 1 and over) when the move command value exceeds the prescribed value, and feeding the resulting multiplied value into an A & D processor successively for 2n sample periods.

A method of control comprising:

• an acceleration and deceleration (A & D) processing for varying an A & D time through varying a cut-off frequency of a filter;
• judging a difference between adjacent sample periods when the move command values generated at said move command generating vary in adjacent sample periods;
• generating a zero command;
• and
• switching the move command to the zero command and outputs the zero command into an A & D processor when the difference exceeds a prescribed value, outputting the zero commands successively for N sample periods when the FIR (finite impulse response) filter of the A & D processor has N steps.

A method of control comprising:

• an acceleration and deceleration (A & D) processing for varying an A & D time through varying a cut-off frequency of a filter;
• outputting a time span of each sample period together with a move command value per sample period in a move command generator;
• providing a filtering process to the move command in a FIR (finite impulse response) filter;
• and
• providing a filtering process to the time span of the sample period in another FIR filter through synchronizing with said move command filtering process.