US 5,988,850 A · Curve interpolation method for performing velocity control during connecting motion of a robot

Abstract

An interpolation method for enabling a robot to make a smooth connecting motion accompanied by velocity control even in the case where the connecting motion involves a nonzero-acceleration motion. During motion path planning for the robot, in order to perform an interpolation so that a point a.sup.(0) on a first motion path G and a point b.sup.(0) on a second motion path H may be smoothly connected by a connecting curve S, the connecting curve S being determined using a parameter including time instant t. First, a function p(T, t) satisfying boundary conditions (continuity of position, velocity, acceleration, etc.) corresponding to required smoothness C.sup.k is derived as a polynomial equation or the like including an unknown parameter T, and by optimizing a suitable evaluation function .epsilon.(T), T.sub.0 for keeping the velocity constant is obtained. Interpolation is performed using q(t)=p(T.sub.0, t), whereupon a connecting motion, in which the velocity is controlled to a constant value, can be attained. Where a composite function (q.smallcircle.f)(t) including an adjustment function f(t) corresponding to a desired velocity transition pattern is used for the interpolation, the velocity can be varied in a desired manner during the connecting motion.

Claims16

Dependent claims

A curve interpolation method for controlling velocity of a robot during a connecting motion which connects a first motion and a second motion by a path movement of a robot in creating a motion path plan in accordance with a robot control device, said curve interpolation method including the steps of:

(a) determining an equation representing a connecting curve smoothly connecting a first connection point specified on a path of the first motion and a second connection point specified on a path of the second motion by means of a parameter representation q(t) including time instant t;
(b) periodically creating an interpolation point in three-dimensional space using said parameter representation q(t),
wherein, a function p(T, t) satisfying a boundary condition in accordance with class-C.sup.k (where k is a positive integer) of smoothness required for the connecting motion is prepared as an equation including an unknown parameter T corresponding to a connection time period, and a calculation process is performed to obtain a value of T=T.sub.0 with which the velocity is kept approximately constant through the connecting motion by optimizing an evaluation function .epsilon.(T) for evaluating a deviation of a partial differential of said function p(T, t) with respect to time from a reference value in said step (a),
q(t)=p(T.sub.0, t) is used as said parameter representation q(t) in said step (b), whereby the velocity is controlled to a constant value during the connecting motion;
and
(c) controlling the velocity of the robot during the connecting motion based upon steps (a) and (b).

3 more elements

(a) determining an equation representing a connecting curve smoothly connecting a first connection point specified on a path of the first motion and a second connection point specified on a path of the second motion by means of a parameter representation q(t) including time instant t;
(b) periodically creating an interpolation point in three-dimensional space using said parameter representation q(t),
wherein, a function p(T, t) satisfying a boundary condition in accordance with class-C.sup.k (where k is a positive integer) of smoothness required for the connecting motion is prepared as a polynomial with respect to t including an unknown parameter T corresponding to a connection time period, and a calculation process is performed to obtain a value of T=T.sub.0 with which the velocity is kept approximately constant through the connecting motion by optimizing an evaluation function .epsilon.(T) for evaluating a deviation of a partial differential of the function p(T, t) with respect to time from a reference value in said step (a),
q(t)=p(T.sub.0, t) includes said parameter representation q(t) in said step (b), whereby the velocity is controlled to a constant value during the connecting motion;
and
(c) controlling the velocity of the robot during the connecting motion based upon steps (a) and (b).

3 more elements

(a) determining an equation representing a connecting curve smoothly connecting a first connection point specified on a path of the first motion and a second connection point specified on a path of the second motion by means of a parameter representation s(t) including time instant t;
(b) periodically creating an interpolation point in three-dimensional space using said parameter representation s(t),
wherein, a function p(T, t) satisfying a boundary condition in accordance with class-C.sup.k (where k is a positive integer) of smoothness required for the connecting motion is prepared as an equation including an unknown parameter T corresponding to a connection time period, and a calculation process is performed to obtain a value of T=T.sub.0 with which the velocity is kept approximately constant through the connecting motion by optimizing an evaluation function .epsilon.(T) for evaluating a deviation of a partial differential of said function p(T, t) with respect to time from a reference value in said step (a),
s(t)=(q.smallcircle.f)(t), which is a composite function of q(t)=p(T.sub.0, t) and an adjustment function f(t), is used as said parameter representation s(t) in said step (b), and
said adjustment function f(t) has the class-C.sup.k smoothness and is determined in advance so that the velocity undergoes a desired transition during the connecting motion;
and
(c) controlling the velocity of the robot during the connecting motion based upon steps (a) and (b).

4 more elements

(a) determining an equation representing a connecting curve smoothly connecting a first connection point specified on a path of the first motion and a second connection point specified on a path of the second motion by means of a parameter representation s(t) including time instant t;
(b) periodically creating an interpolation point in three-dimensional space using said parameter representation s(t),
wherein, a function p(T, t) satisfying a boundary condition in accordance with class-C.sup.k (where k is a positive integer) of smoothness required for the connecting motion is prepared as a polynomial with respect to t including an unknown parameter T corresponding to a connection time period, and a calculation process is performed to obtain a value of T=T.sub.0, with which the velocity is kept approximately constant through the connecting motion by optimizing an evaluation function .epsilon.(T) for evaluating a deviation of a partial differential of the function p(T, t) with respect to time from a reference value in said step (a),
s(t)=(q.smallcircle.f)(t), which is a composite function of q(t)=p(T.sub.0, t) and an adjustment function f(t), is used as said parameter representation s(t) in said step (b), and
said adjustment function f(t) has the class-C.sup.k smoothness and is determined in advance so that the velocity undergoes a desired transition during the connecting motion;
and
(c) controlling the velocity of the robot during the connecting motion based upon steps (a) and (b).

4 more elements

Dependencies are inferred from the claim text.

Curve interpolation method for performing velocity control during connecting motion of a robot

Life of this patent

Curve interpolation method for performing velocity control during connecting motion of a robot

Life of this patent

Abstract

Claims16