USRE36929E - Robot control system - Google Patents

Robot control system Download PDF

Info

Publication number
USRE36929E
USRE36929E US08/912,240 US91224097A USRE36929E US RE36929 E USRE36929 E US RE36929E US 91224097 A US91224097 A US 91224097A US RE36929 E USRE36929 E US RE36929E
Authority
US
United States
Prior art keywords
end effector
denotes
selection function
controller
acting device
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Lifetime
Application number
US08/912,240
Inventor
Kuniharu Takayama
Hiroyuki Kano
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fujitsu Ltd
Original Assignee
Fujitsu Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fujitsu Ltd filed Critical Fujitsu Ltd
Priority to US08/912,240 priority Critical patent/USRE36929E/en
Application granted granted Critical
Publication of USRE36929E publication Critical patent/USRE36929E/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/36—Nc in input of data, input key till input tape
    • G05B2219/36521—Select by combination of detected force, acceleration, speed, work rate

Definitions

  • the present invention relates to a robot control system and more particularly, it relates to a robot control system which selects a suitable set of functions in accordance with a force, an acceleration, a velocity and a work rate.
  • the robot control system according to the present invention can control an end effector and a manipulator of a robot for a suitable operation based on a control signal from a control means which is provided in correspondence with a selection function device.
  • the work rate is given by a product of speed and force.
  • a robot is formed of an end effector (or, hand) provided at the end of an arm (a manipulator) to grasp/push an object, a plurality of sensors mounted at the end effector for detecting a force, a position, and an orientation of the end effector, and a control unit for controlling the operation of the manipulator.
  • a force control method a position control method
  • a stiffness/dumping control method in accordance with the relationship between the end effector and the object. That is, these methods are distinguished in accordance with the following states, i.e., first, a contacting state (or, non-contacting state) between the end effector and the object, second, characteristics of the object (i.e., rigid or non-rigid body), and third, the state of the object (i.e., fixed or not fixed).
  • the force control method is used for a contacting state between the end effector and a fixed and rigid object.
  • the position control method is used for a non-contacting state between the end effector and an object.
  • the stiffness/damping control method is used for a contacting state between the end effector and a not fixed or non-rigid object.
  • the force control method and the position control method can be combined with each other, and this combination is called a hybrid position/force control method.
  • the position control method and the stiffness/dumping control method can be combined with each other, and this combination is called an impedance control method.
  • the hybrid control method is only used for contacting or non-contacting state between the end effector and the fixed and rigid object
  • the impedance control method is only used for contacting or non-contacting state between the end effector and the not fixed or non-rigid object.
  • the object of the present invention is to provide a robot control system which is able to adapt to control of all states of an end effector and a manipulator including contacting/non-contacting states, rigid/non-rigid states and fixed/not fixed states.
  • a robot control system including: an end effector for acting on an object to be worked; a manipulator mechanically supporting the end to apply predetermined movements to the end effector; a plurality of sensors mounted on the end effector to detect a position (x) of the end effector and a force (f) between the end effector and the object and to obtain an acceleration (x"), a velocity (x') and a work rate (-x'f) of the end effector; a pre-controller for controlling movement of the end effector and the manipulator; a plurality of selection function units connected in parallel to the pre-controller and at least one of the selection function units being selected in accordance with the acceleration (x"), the velocity (x') and the work rate (-x'f); and a plurality of control units each connected to a corresponding selection function unit for inputting a target trajectory (x d ) of the end effector and for respectively outputting corresponding control signals which in the composite comprise a total control signal (u)
  • each of the selection function unit s is selected or selectively enabled thereby to select the respectively corresponding control unit in accordance with a varying combination of the respective values of the acceleration, the velocity and the work rate being zero, or not zero; and the control signal from the respective control unit corresponding to the enabled selection function unit is input to the pre-controller, to control movement of the end effector and the manipulator, through the thus enabled selection function unit.
  • the selection function unit utilizes a Kronecker delta function.
  • the movement of the manipulator is defined by the following formula for one direction component,
  • FIG. 1 is a basic block diagram of a robot control system according to the present invention
  • FIG. 2 is a block diagram of a robot control system according to an embodiment of the present invention.
  • FIG. 3 shows the case of a contacting state between an end effector and a fixed and rigid object
  • FIG. 4 shows the case of a non-contacting state between the end effector and the object
  • FIG. 5 shows the case of a contacting state between the end effector and a not fixed or non-rigid object.
  • FIG. 1 is a basic block diagram of a robot control system according to the present invention.
  • This new control method according to the present invention is called a "selective control method".
  • A denotes an object to be acted upon
  • E denotes an end effector to act on the object
  • S denotes sensors for detecting various forces from the object and a position of the end effector
  • M denotes a manipulator for mechanically supporting the end effector
  • P denotes a pre-controller for controlling operation of the manipulator
  • 1a to In denote selection function devices
  • 11a to 11n denote control units.
  • acceleration is expressed by x
  • velocity is expressed by x'
  • a work rate is expressed by -x'f.
  • Each selection function devices 1a to 1n is selected by each value of the acceleration x" the velocity x', and the work rate -x'f as explained in detail below.
  • the control units 11a to 11n are provided for the respective selection function devices 1a to 1n.
  • a target trajectory "x d " for the position of the end effector E is input in parallel to each control unit, and the control units generate a control signal "u" through the selection function devices 1a to 1n.
  • any one of the selection function devices is selected in accordance with a value of either "0" or “other than 0” (indicated by "?” in the drawings) of the acceleration x", the velocity x' and the work rate -x'f.
  • the control signal "u" is input from the corresponding control unit and the respective selection function device to the pre-controller P to control the manipulator M.
  • a so-called Kronecker delta function or an enlarged Kronecker delta function is used as the selection function devices.
  • the end effector E is mounted at the end of the manipulator M, and executes various operations by contacting the object A.
  • the pre-controller P is provided at the manipulator M to control the operation thereof.
  • the outputs of all of the selection function devices 1a to 1n are input to the pre-controller P, and each selection function device receives the information of the acceleration x" the velocity x' and the work rate -x'f which are detected by the sensors S.
  • An individual one of the selection function devices is selected in accordance with the acceleration speed x" the speed x' and the work rate -x'f.
  • the control signal "u" of the corresponding control unit connected to the selected one of the selection function devices is output to the pre-controller P thereby to control the manipulator M.
  • x c is a constant scalar value
  • the force f of the end effector is given as zero:
  • m e , b e , and k e denotes constant scalars indicating impedance of the object A.
  • FIG. 2 is a block diagram of a robot control system according to an embodiment of the present invention.
  • the same reference letters as used in FIG. 1 are attached to the same components in this drawings.
  • eight selection function devices 1 to 8 are provided in this embodiment.
  • eight controllers 11 to 18 are provided for the respective, corresponding selection function devices 1 to 8.
  • Each of the selection function devices 1 to 8 is defined based on three kinds of values which are input from sensors S, i.e., the acceleration x" of the end effector, the velocity x' of the end effector, and the work rate -x'f indicating the work from the end effector E to the object A. That is, when these three values are given by a value of either "0" or "other than 0", the selection function value becomes "1" or "0” so that following eight sets of selection function devices can be obtained.
  • ⁇ denotes the Kronecker delta function
  • * denotes an inverted value of the function ⁇ .
  • the function of the first row denotes a product of * ⁇ 1 , * ⁇ 2 , and ⁇ 3 .
  • the above eight selection functions correspond to the selection function devices 1 to 8 of FIG. 2, respectively.
  • the formula (12) shows an ideal form mathematically to simplify the explanation. In actuality, the following formula is defined as an enlarged Kronecker delta function instead of the formula (12).
  • each of the controllers 11 to 18 in FIG. 2 is explained below.
  • the suitable controller is selected in accordance with contacting/not-contacting, rigid/non-rigid, and fixed/not fixed states between the end effector and the object.
  • the total control signal "u" is defined as follows. ##EQU1## wherein, "x d " denotes a target trajectory of the position x of the end effector.
  • the successive rows of the above formulas correspond to the respective control means 11 to 18 of FIG. 2.
  • the first row corresponds to the impedance control method
  • the second row corresponds to the position control method
  • the eighth row corresponds to the force control method.
  • FIG. 3 shows the Case (1) of a contacting state between the end effector and a fixed and rigid object.
  • the selection function devices 1 to 7 become “0", and only the selection function devices 8 is selected.
  • the control signal "u” is given by “kx d " and this signal is input to the precontroller P.
  • the force "-f" which the end effector applies to the object, can be controlled by using the target trajectory x d .
  • FIG. 4 shows the Case (2) of a non-contacting state between the end effector and the object.
  • FIG. 5 shows the Case (3) of a contacting state between the end effector and a not fixed or non-rigid object.

Abstract

A robot control system includes: an end effector for acting upon an object to be worked; a manipulator mechanically supporting the end effector to apply predetermined movements to the end effector; a plurality of sensors mounted on the end effector to detect a position (x) of the end effector and a force (f) between the end effector and the object and to obtain an acceleration speed (x"), a speed (x') and a work rate (-x'f) of the end effector; a pre-controller for controlling movement of the end effector and the manipulator; a plurality of selection function units connected in parallel to the pre-controller and at least one of the selection function units being selected in accordance with the acceleration speed (x"), the speed (x') and the work rate (-x'f); and a plurality of control units each connected to a corresponding selecting function unit for inputting a target trajectory (xd) of the end effector and for outputting a control signal (u) to the pre-controller to control movement of the end effector and the manipulator; wherein, the selection function unit is selected in accordance with a value of either "0" or "other than 0" of the acceleration speed, the speed and the work rate; and the control signal from the control unit corresponding to the selection function unit is input to the pre-controller to control movement of the end effector and the manipulator through the selection function unit.

Description

BACKGROUND OF THE INVENTION
1. Field of the Invention
The present invention relates to a robot control system and more particularly, it relates to a robot control system which selects a suitable set of functions in accordance with a force, an acceleration, a velocity and a work rate. The robot control system according to the present invention can control an end effector and a manipulator of a robot for a suitable operation based on a control signal from a control means which is provided in correspondence with a selection function device. The work rate is given by a product of speed and force.
2. Description of the Related Art
In general, a robot is formed of an end effector (or, hand) provided at the end of an arm (a manipulator) to grasp/push an object, a plurality of sensors mounted at the end effector for detecting a force, a position, and an orientation of the end effector, and a control unit for controlling the operation of the manipulator.
There are three different control methods well-known in the conventional art, i.e., a force control method, a position control method, and a stiffness/dumping control method, in accordance with the relationship between the end effector and the object. That is, these methods are distinguished in accordance with the following states, i.e., first, a contacting state (or, non-contacting state) between the end effector and the object, second, characteristics of the object (i.e., rigid or non-rigid body), and third, the state of the object (i.e., fixed or not fixed).
Concretely, the force control method is used for a contacting state between the end effector and a fixed and rigid object. The position control method is used for a non-contacting state between the end effector and an object. The stiffness/damping control method is used for a contacting state between the end effector and a not fixed or non-rigid object.
Furthermore, the force control method and the position control method can be combined with each other, and this combination is called a hybrid position/force control method. Also, the position control method and the stiffness/dumping control method can be combined with each other, and this combination is called an impedance control method.
As is obvious from the above, the hybrid control method is only used for contacting or non-contacting state between the end effector and the fixed and rigid object, and the impedance control method is only used for contacting or non-contacting state between the end effector and the not fixed or non-rigid object.
However, there is no general method which is able to cover both of these two methods in the conventional art.
SUMMARY OF THE INVENTION
The object of the present invention is to provide a robot control system which is able to adapt to control of all states of an end effector and a manipulator including contacting/non-contacting states, rigid/non-rigid states and fixed/not fixed states.
In accordance with the present invention, there is provided a robot control system including: an end effector for acting on an object to be worked; a manipulator mechanically supporting the end to apply predetermined movements to the end effector; a plurality of sensors mounted on the end effector to detect a position (x) of the end effector and a force (f) between the end effector and the object and to obtain an acceleration (x"), a velocity (x') and a work rate (-x'f) of the end effector; a pre-controller for controlling movement of the end effector and the manipulator; a plurality of selection function units connected in parallel to the pre-controller and at least one of the selection function units being selected in accordance with the acceleration (x"), the velocity (x') and the work rate (-x'f); and a plurality of control units each connected to a corresponding selection function unit for inputting a target trajectory (xd) of the end effector and for respectively outputting corresponding control signals which in the composite comprise a total control signal (u) to the pre-controller to control movement of the end effector and the manipulator;
wherein, each of the selection function unit s is selected or selectively enabled thereby to select the respectively corresponding control unit in accordance with a varying combination of the respective values of the acceleration, the velocity and the work rate being zero, or not zero; and the control signal from the respective control unit corresponding to the enabled selection function unit is input to the pre-controller, to control movement of the end effector and the manipulator, through the thus enabled selection function unit.
As a preferred embodiment, the selection function unit utilizes a Kronecker delta function.
As another preferred embodiment, the movement of the manipulator is defined by the following formula for one direction component,
mx"+bx'+kx=u+f
where, "x" denotes the position of the end effector, "x'" denotes the velocity of the end effector, "x"" denotes the acceleration of the end effector, "f" denotes the force applied from the object to the end effector, "u" denotes the control signal generated by the control unit, "m" denotes a weight, "b" denotes a viscosity, and "k" denotes an elasticity. Further, each of these values is defined by a "scalar".
As still another preferred embodiment, eight kinds of Kronecker delta functions are given as the selection function means.
BRIEF DESCRIPTION OF THE DRAWING
In the drawings:
FIG. 1 is a basic block diagram of a robot control system according to the present invention;
FIG. 2 is a block diagram of a robot control system according to an embodiment of the present invention;
FIG. 3 shows the case of a contacting state between an end effector and a fixed and rigid object;
FIG. 4 shows the case of a non-contacting state between the end effector and the object; and
FIG. 5 shows the case of a contacting state between the end effector and a not fixed or non-rigid object.
DESCRIPTION OF THE PREFERRED EMBODIMENTS
FIG. 1 is a basic block diagram of a robot control system according to the present invention. This new control method according to the present invention is called a "selective control method". In FIG. 1, "A" denotes an object to be acted upon, "E" denotes an end effector to act on the object, "S" denotes sensors for detecting various forces from the object and a position of the end effector, "M" denotes a manipulator for mechanically supporting the end effector, "P" denotes a pre-controller for controlling operation of the manipulator, 1a to In denote selection function devices, and 11a to 11n denote control units.
Where acceleration is expressed by x", velocity is expressed by x', and a work rate is expressed by -x'f.
Each selection function devices 1a to 1n is selected by each value of the acceleration x" the velocity x', and the work rate -x'f as explained in detail below.
The control units 11a to 11n are provided for the respective selection function devices 1a to 1n. A target trajectory "xd " for the position of the end effector E is input in parallel to each control unit, and the control units generate a control signal "u" through the selection function devices 1a to 1n.
As explained in detail below, any one of the selection function devices is selected in accordance with a value of either "0" or "other than 0" (indicated by "?" in the drawings) of the acceleration x", the velocity x' and the work rate -x'f.
When a given one of the selection function devices is selected, the control signal "u" is input from the corresponding control unit and the respective selection function device to the pre-controller P to control the manipulator M. In this embodiment, a so-called Kronecker delta function or an enlarged Kronecker delta function is used as the selection function devices.
Further operation of the manipulator is defined by the following formula.
mx"+bx'+kx=u+f
where, "x" denotes the position of the end effector, "x'" denotes the velocity of the end effector which is obtained from the differential of the position "x", and "x"" denotes the acceleration which is obtained from the differential of the velocity "x'", "f" denotes a force applied from the object to the end effector, "u" denotes the control signal, "m" denotes a weight, "b" denotes a viscosity, and "k" denotes an elasticity. In this embodiment, all these values are given by scalar values.
The end effector E is mounted at the end of the manipulator M, and executes various operations by contacting the object A. The pre-controller P is provided at the manipulator M to control the operation thereof. The outputs of all of the selection function devices 1a to 1n are input to the pre-controller P, and each selection function device receives the information of the acceleration x" the velocity x' and the work rate -x'f which are detected by the sensors S.
An individual one of the selection function devices is selected in accordance with the acceleration speed x" the speed x' and the work rate -x'f. The control signal "u" of the corresponding control unit connected to the selected one of the selection function devices, is output to the pre-controller P thereby to control the manipulator M.
Before explaining preferred embodiments, the basic theory of the present invention will be explained in detail below.
First, an explanation will be given for the case where the end effector E contacts or does not contact the object A. The following explanation is given for a unidirectional component of the manipulator M, thereby to simplify the explanation.
A basic formula is explained as follows.
The formula indicating a component of one optional direction of the manipulator is given as follows:
mx"+bx'+kx=u+f                                             (1)
wherein, "x" denotes the position of the end effector, "x'" denotes the velocity of the end effector which is obtained from the differential of the position "x", and "x"" denotes the acceleration which is obtained from the differential of the velocity "x'", "f" denotes the force applied from the object to the end effector, "u" denotes the control signal, "m" denotes the weight, "b" denotes the viscosity, and "k" denotes the elasticity. In this case, all these values are given by scalar values.
Case (1) When the end effector contacts a fixed and rigid object, the formula is explained as follows.
When the end effector contacts a fixed and rigid object, the end effector enters a static state. Accordingly, the speed x' of the end effector is given as zero:
x'=0                                                       (2)
When the position x is "xc ", from the formula (2):
x=x.sub.c                                                  (3)
wherein, xc is a constant scalar value.
From formulas (1) and (3):
f=k x.sub.c -u                                             (4)
Case (2) When the end effector does not contact the object, the formula is explained as follows.
When the end effector does not contact the object, it does not take a force from the object A. Accordingly, the force f of the end effector is given as zero:
f=0                                                        (5)
From formulas (1) and (5):
mx"+bx'+kx=u                                               (6)
Case (3) When the end effector contacts a not fixed or non-rigid object, the formula is expressed approximately as follows:
-f≈-(m.sub.e x"+b.sub.e x'+k.sub.e x)              (7)
wherein, me, be, and ke denotes constant scalars indicating impedance of the object A.
From formulas (1) and (7):
(m+m.sub.e)x"+(b+b.sub.e)x'+(k+k.sub.e)x=u                 (8)
FIG. 2 is a block diagram of a robot control system according to an embodiment of the present invention. The same reference letters as used in FIG. 1 are attached to the same components in this drawings. As shown in the drawing, eight selection function devices 1 to 8 are provided in this embodiment. Accordingly, eight controllers 11 to 18 are provided for the respective, corresponding selection function devices 1 to 8. Each of the selection function devices 1 to 8 is defined based on three kinds of values which are input from sensors S, i.e., the acceleration x" of the end effector, the velocity x' of the end effector, and the work rate -x'f indicating the work from the end effector E to the object A. That is, when these three values are given by a value of either "0" or "other than 0", the selection function value becomes "1" or "0" so that following eight sets of selection function devices can be obtained.
(*δ.sub.1 *δ.sub.2 *δ.sub.3)
(*δ.sub.1 *δ.sub.2 δ.sub.3)
(*δ.sub.1 δ.sub.2 *δ.sub.3)
(*δ.sub.1 δ.sub.2 δ.sub.3)               (9)
(δ.sub.1 *δ.sub.2 *δ.sub.3)
(δ.sub.1 *δ.sub.2 δ.sub.3)
(δ.sub.1 δ.sub.2 *δ.sub.3)
(δ.sub.1 δ.sub.2 δ.sub.3)
Where, δ denotes the Kronecker delta function, "*" denotes an inverted value of the function δ. Further, for example, the function of the first row (*δ1 *δ2 δ3) denotes a product of *δ1, *δ2, and δ3. As is obvious, the above eight selection functions correspond to the selection function devices 1 to 8 of FIG. 2, respectively.
Further, the function δi (i=1, 2 3) is defined as follows:
δ.sub.1 =δ(x", 0)
δ.sub.2 =δ(x',0)                               (10)
δ.sub.3 =δ(-x'f, 0)
*δ.sub.i =1-δ.sub.i (i=1, 2, 3)                (11)
Still further, the function δ(a, b) is defined as follows:
δ(a, b)=1 (when a=b) or 0 (when a≠b)           (12)
The formula (12) shows an ideal form mathematically to simplify the explanation. In actuality, the following formula is defined as an enlarged Kronecker delta function instead of the formula (12).
δ.sub.e (a, b)=1(|a-b|≦e) or =0(|a-b|>e)                             (13)
wherein, "e" denotes a small positive constant scalar.
The operation of each of the controllers 11 to 18 in FIG. 2 is explained below. As explained above, in the present invention, the suitable controller is selected in accordance with contacting/not-contacting, rigid/non-rigid, and fixed/not fixed states between the end effector and the object. By using the set of selection functions in the formula (9), the total control signal "u" is defined as follows. ##EQU1## wherein, "xd " denotes a target trajectory of the position x of the end effector. The successive rows of the above formulas correspond to the respective control means 11 to 18 of FIG. 2. In the above formula (14), the first row corresponds to the impedance control method, the second row corresponds to the position control method, and the eighth row corresponds to the force control method.
The formula (14) can be simplified as follows: ##EQU2##
The formula (16) shows an ideal form mathematically to simplify the explanation. In actuality, the function δ is substituted by the functions δe1, δe2 and δe3 in formula (16) as follows. ##EQU3##
FIG. 3 shows the Case (1) of a contacting state between the end effector and a fixed and rigid object. As is obvious, since the end effector E contacts the object A, the position x is constant so that the velocity x' also becomes zero (i.e., x'=0). In this case, the force applied to the object is unknown (i.e., f=?).
In the formula (10), when x'=0, δ2 is given by δ(0, 0). Further, in the formula (12), when a=b, δ(a, b) is given by "1" so that δ2 becomes "1". Still further, when x'=0, the acceleration x" becomes "0" and the work force -x'f also becomes "0". Accordingly, from the formula (12) and since a=b, δ1, δ2, and δ3 become "1" (i.e., δ1 =δ2 =δ3 =1). In the formula (11), when δ1 =δ2 =δ3 =1, *δ1, *δ2 and *δ3 become "0" (i.e., *δ1 =*δ2 =*δ3 =0).
Accordingly, the selection function devices 1 to 7 become "0", and only the selection function devices 8 is selected. In this case, the control signal "u" is given by "kxd " and this signal is input to the precontroller P.
Since x"=x'=x'f=0, from the formulas (4) and (16), the following formulas are obtained.
f=k x.sub.c -u
u=k x.sub.d                                                (18)
From these formulae, the following formula is obtained.
f=k(x.sub.c -x.sub.d)                                      (19)
Accordingly, and as is obvious from the above formula (19), the force "-f", which the end effector applies to the object, can be controlled by using the target trajectory xd.
FIG. 4 shows the Case (2) of a non-contacting state between the end effector and the object. In this case, since the end effector E does not contact the object A, the speed is unknown (i.e., x'=?) and the force is given by "0" (i.e., f=0).
When f=0, the work rate -x'f is given by "0" so that δ3 becomes "1" (i.e., δ3 =1) from the formula (10) and (12). Further, when δ3 =1, *δ3 becomes "0" (i.e., *δ3 =0) from the formula (11).
Accordingly, since δ3 =1 and *δ3 =0, the selection function devices 2, 4, 6 and 8 are selected and the selection function device 1, 3, 5 and 7 are not selected.
Since f=0, from the formulas (6) and (16), the following formulas are given.
mx"+bx'+kx=u
u=mx.sub.d "+bx.sub.d '+kx.sub.d                           (20)
From the formula (20),
mx"+bx'+kx=mx.sub.d "+bx.sub.d '+kx.sub.d                  (21)
From the formula (21),
x=x.sub.d +λ                                        (22)
wherein, lim λ=0 (λ: a homogeneous solution of the formula (21)) when m, b, and k<0. That is, the position x of the end effector E can follow the target trajectory xd.
FIG. 5 shows the Case (3) of a contacting state between the end effector and a not fixed or non-rigid object.
In this case, the velocity x' is unknown, and the force f is given approximately by (-me x"-be x'-ke x). In the formula (12), when a≠b, δ3 =0 and *δ3 =1 from the formula (11).
Accordingly, the selection function devices 1, 3, 5, and 7 are selected because of *δ3 =1, and the selection function devices 2, 4, 6 and 8 are not selected because of δ3 =0.
From formulas (8) and (16),
(m+m.sub.e)x"+(b+b.sub.e)x'+(k+k.sub.e)x=u
u=(m+m.sub.e)x.sub.d "+(b+b.sub.e)x.sub.d '+(k+k.sub.e)x.sub.d (23)
From the formula (23),
(m+m.sub.e)x"+(b+b.sub.e)x'+(k+k.sub.e)x=(m+m.sub.e)x.sub.d "+(b+b.sub.e)x.sub.d '+(k+k.sub.e)x.sub.d                 (24)
From the formula (24),
x=x.sub.d +u                                               (25)
wherein, lim μ=0 (μ: a homogenous solution of the formula (24)) when (m+me), (b+be), and (k+ke)>0. That is, the position x of the end effector E can follow to the target trajectory xd.

Claims (7)

We claim:
1. A robot control system, comprising:
an end effector for acting upon an object to be worked;
a manipulator which mechanically supports the end effector and thereby is operative to move the end effector;
a plurality of sensors mounted on the end effector and operative to detect, and to produce corresponding outputs representative of, a position (x) of the end effector, a force (f) between the end effector and the object and an acceleration (x"), a speed (x') and a work rate (-x'f) of the end effector;
a pre-controller which controls movement of the end effector by the manipulator;
a plurality of selection function means having respective outputs connected in parallel to the pre-controller and at least one of the selection function means being selected in accordance with the sensor outputs representative of the acceleration (x"), the speed (x') and the work rate (-x'f);
a plurality of control means respectively connected to the plurality of selection function means and individually operative, for receiving and inputting, in common, a target trajectory (xd) of the end effector and for outputting respective control signals (u) to the pre-controller to control movement of the end effector and the manipulator; and
each said selected one of the selection function means being selected in accordance with respective values, each value being one of "0" and "other than 0", of the acceleration, the speed and the work rate sensor outputs; and the respective control signal (u), from each control means corresponding to a selected one of the selection function means, is input to the pre-controller thereby to control movement of the end effector .[.by.]. .Iadd.and .Iaddend.the manipulator.
2. A robot control system as claimed in claim 1, wherein each of the plurality of selection function means utilizes one of a Kronecher delta function and an enlarged Kronecher delta function.
3. A robot control system as claimed in claim 1, wherein movement of the manipulator is defined by the following formula for one direction component;
mx"+b.[.x".]..Iadd.x'.Iaddend.+kx=u+f
wherein, "x" denotes the position of the end effector, "x'" denotes the speed of the end effector, "x"" denotes the acceleration of the end effector, "f" denotes the force applied from the object to the end effector, "u" denotes the control signal generated by the control means, "m" denotes a weight, "b" denotes a viscosity, and "k" denotes an elasticity and, further, each of these values is a .[."scaler".]. .Iadd."scalar" .Iaddend.value.
4. A robot control system as claimed in claim 1, wherein the plurality of selection function means comprise respective ones of eight kinds of Kronecher delta functions. .Iadd.5. A robot control system, comprising:
an acting device for acting upon an object to be worked;
a plurality of sensors mounted on the acting device and operative to detect, and to produce corresponding outputs representative of, a position (x) of the acting device, a force (f) between the acting device and the object and an acceleration (x"), a speed (x') and a work rate (-x'f) of the acting device;
a pre-controller which controls movement of the acting device;
a plurality of selection function devices having respective outputs connected in parallel to the pre-controller and at least one of the selection function devices being selected in accordance with the sensor outputs representative of the acceleration (x"), the speed (x') and the work rate (-x'f);
a plurality of control devices respectively connected to the plurality of selection function devices and individually operative for receiving and inputting, in common, a target trajectory (xd) of the acting device and for outputting respective control signals (u) to the pre-controller to control movement of the acting device; and
each said selected one of the selection function devices being selected in accordance with the respective values, each value being one of "0" and "other than 0", of the acceleration, the speed and the work rate sensor outputs; and the respective control signal (u), from each controller corresponding to a selected one of the selection function devices, is input to the pre-controller thereby to control movement of the acting
device. .Iaddend..Iadd.6. A system as claimed in claim 5, wherein each of the plurality of selection function devices utilizes one of a Kronecher delta function and an enlarged Kronecher delta function. .Iaddend..Iadd.7. A system as claimed in claim 5, wherein movement of the acting device is defined by the following formula for one direction component;
mx"+bx'+kx=u+f
wherein, "x" denotes the position of the acting device, "x'" denotes the speed of the acting device, "x"" denotes the acceleration of the acting device, "f" denotes the force applied from the object to the acting device, "u" denotes the control signal generated by the controller, "m" denotes a weight, "b" denotes a viscosity, and "k" denotes an elasticity and, further, each of these values is a "scalar" value. .Iaddend..Iadd.8. A system as claimed in claim 5, wherein the plurality of selection function devices comprise respective ones of eight kinds of Kronecher
delta functions. .Iaddend..Iadd.9. A controller controlling an acting device for acting upon an object to be worked, comprising:
a receiving unit receiving an output from a plurality of sensors mounted on the acting device and operative to detect, and to produce corresponding outputs representative of information concerning the acting device and the object;
a pre-controller which controls movement of the acting device;
a plurality of selection function devices having respective outputs connected in parallel to the pre-controller and at least one of the selection function devices being selected in accordance with the sensor outputs representative of the information concerning the acting device and the object;
a plurality of control devices respectively connected to the plurality of selection function devices and individually operative for receiving and inputting, in common, a target trajectory (xd) of the acting device and for outputting respective control signals (u) to the pre-controller to control movement of the acting device; and
each said selected one of the selection function devices being selected in accordance with respective values of the information concerning the acting device and each said selected one of the selection function devices being selected in accordance with respective values of the information concerning the acting device and the object, which information from said sensors; and the respective control signal (u), from each control means corresponding to a selected one of the selection function means, is input to the pre-controller thereby to control movement of the acting device. .Iaddend..Iadd.10. A controller as claimed in claim 9, wherein each of the plurality of selection function devices utilizes one of a Kronecher delta
function and an enlarged Kronecher delta function. .Iaddend..Iadd.11. A controller as claimed in claim 9, wherein movement of the acting device is defined by the following formula for one direction component;
mx"+bx'+kx=u+f
wherein, "x" denotes the position of the acting device, "x'" denotes the speed of the acting device, "x"" denotes the acceleration of the acting device, "f" denotes the force applied from the object to the acting device, "u" denotes the control signal generated by the controller, "m" denotes a weight, "b" denotes a viscosity, and "k" denotes an elasticity and, further, each of these values is a "scalar" value. .Iaddend..Iadd.12. A controller as claimed in claim 9, wherein the plurality of selection function devices implement respective ones of eight kinds of Kronecher delta functions. .Iaddend..Iadd.13. A controller apparatus, comprising:
a pre-controller controlling a dynamic relationship of an element to an object in response to an element control signal;
plural sensors producing respective, plural sensor outputs, each sensor output having differing values representing differing sensed relationships of the element to the object;
plural function selector devices, one or more thereof being selected in accordance with combinations of the sensor outputs;
plural controllers respectively associated with the plural selection function units, each controller processing a desired target trajectory of the element relative to the object and outputting a respective component element control signal to the respectively associated selection function device; and
the selected, selection function devices outputting the respective component element control signals received thereby, a composite thereof comprising the element control signal. .Iaddend..Iadd.14. The controller recited in claim 13, wherein the plural controllers receive a common, desired target trajectory and output the respective component element control signals in parallel to the respectively associated selection function devices. .Iaddend..Iadd.15. A method of controlling an element relative to an object, comprising:
controlling a dynamic relationship of an element to an object in response to an element control signal;
producing plural sensor outputs, each sensor output having differing values representing differing sensed relationships of the element to the object;
processing a desired target trajectory of an element relative to the object in accordance with plural different functions and outputting, in parallel, respective component element control signals; and
selecting and outputting one or more of the parallel component element control signals, responsive to sensed relationships of the element to the object, a composite thereof comprising the element control signal. .Iaddend.
US08/912,240 1993-03-12 1997-08-15 Robot control system Expired - Lifetime USRE36929E (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
US08/912,240 USRE36929E (en) 1993-03-12 1997-08-15 Robot control system

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
JP5-052233 1993-03-12
JP05052233A JP3115147B2 (en) 1993-03-12 1993-03-12 Robot controller and controller
US08/118,747 US5442269A (en) 1993-03-12 1993-09-10 Robot control system
US08/912,240 USRE36929E (en) 1993-03-12 1997-08-15 Robot control system

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
US08/118,747 Reissue US5442269A (en) 1993-03-12 1993-09-10 Robot control system

Publications (1)

Publication Number Publication Date
USRE36929E true USRE36929E (en) 2000-10-31

Family

ID=12909015

Family Applications (2)

Application Number Title Priority Date Filing Date
US08/118,747 Ceased US5442269A (en) 1993-03-12 1993-09-10 Robot control system
US08/912,240 Expired - Lifetime USRE36929E (en) 1993-03-12 1997-08-15 Robot control system

Family Applications Before (1)

Application Number Title Priority Date Filing Date
US08/118,747 Ceased US5442269A (en) 1993-03-12 1993-09-10 Robot control system

Country Status (2)

Country Link
US (2) US5442269A (en)
JP (1) JP3115147B2 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6242879B1 (en) * 2000-03-13 2001-06-05 Berkeley Process Control, Inc. Touch calibration system for wafer transfer robot
US6640458B2 (en) 2002-03-25 2003-11-04 Btm Corporation End arm effector set-up
US20060108960A1 (en) * 2002-07-18 2006-05-25 Michiharu Tanaka Robot controller and robot system
US20090105880A1 (en) * 2006-01-13 2009-04-23 Yasunao Okazaki Device and method for controlling robot arm, robot and program
US20100152896A1 (en) * 2008-02-06 2010-06-17 Mayumi Komatsu Robot, controlling device and controlling method for robot, and controlling program for robot-controlling device

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2738808B1 (en) * 1995-09-14 1997-10-24 Cim Manutique Sa BALANCING AND / OR POSITIONING OF ANY VARIABLE OR NON-VARIABLE WEIGHT LOAD, IN NON-UNIFORM MOVEMENT
US6313595B2 (en) 1999-12-10 2001-11-06 Fanuc Robotics North America, Inc. Method of controlling an intelligent assist device in a plurality of distinct workspaces
US6204620B1 (en) * 1999-12-10 2001-03-20 Fanuc Robotics North America Method of controlling an intelligent assist device
US6456901B1 (en) 2001-04-20 2002-09-24 Univ Michigan Hybrid robot motion task level control system
JP2006110702A (en) * 2004-10-18 2006-04-27 Fanuc Ltd Robot having learning control function, and method for controlling robot
US10002781B2 (en) 2014-11-10 2018-06-19 Brooks Automation, Inc. Tool auto-teach method and apparatus
CN107650121B (en) * 2016-07-26 2022-07-01 深圳力合精密装备科技有限公司 Control method for robot
DE102017118985B4 (en) * 2017-04-23 2019-10-02 Franka Emika Gmbh screwing

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4156835A (en) * 1974-05-29 1979-05-29 Massachusetts Institute Of Technology Servo-controlled mobility device
US4549276A (en) * 1981-08-04 1985-10-22 Fanuc Ltd. Industrial robot control method
US4685067A (en) * 1986-02-20 1987-08-04 Cincinnati Milacron Inc. Control system for program controlled manipulator having multiple triggered functions between programmed points
US4937568A (en) * 1987-09-14 1990-06-26 Kuroda Precision Industries, Ltd. Signal serial/parallel conversion system
US5159249A (en) * 1989-05-16 1992-10-27 Dalila Megherbi Method and apparatus for controlling robot motion at and near singularities and for robot mechanical design
US5194792A (en) * 1989-03-31 1993-03-16 Fanuc Ltd. Tool center point setting method in a robot
US5272430A (en) * 1991-03-18 1993-12-21 Sgs-Thomson Microelectronics S.A. System for controlling an inverter through pulse width modulation
US5276390A (en) * 1991-10-04 1994-01-04 Hewlett-Packard Company System for hybrid position and force control
US5283508A (en) * 1991-05-27 1994-02-01 Okuma Corporation Positional control apparatus
US5291137A (en) * 1992-11-02 1994-03-01 Schlumberger Technology Corporation Processing method and apparatus for processing spin echo in-phase and quadrature amplitudes from a pulsed nuclear magnetism tool and producing new output data to be recorded on an output record
US5389963A (en) * 1992-02-05 1995-02-14 Dynacom, Inc. System for selectively interconnecting audio-video sources and receivers

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4156835A (en) * 1974-05-29 1979-05-29 Massachusetts Institute Of Technology Servo-controlled mobility device
US4549276A (en) * 1981-08-04 1985-10-22 Fanuc Ltd. Industrial robot control method
US4685067A (en) * 1986-02-20 1987-08-04 Cincinnati Milacron Inc. Control system for program controlled manipulator having multiple triggered functions between programmed points
US4937568A (en) * 1987-09-14 1990-06-26 Kuroda Precision Industries, Ltd. Signal serial/parallel conversion system
US5194792A (en) * 1989-03-31 1993-03-16 Fanuc Ltd. Tool center point setting method in a robot
US5159249A (en) * 1989-05-16 1992-10-27 Dalila Megherbi Method and apparatus for controlling robot motion at and near singularities and for robot mechanical design
US5272430A (en) * 1991-03-18 1993-12-21 Sgs-Thomson Microelectronics S.A. System for controlling an inverter through pulse width modulation
US5283508A (en) * 1991-05-27 1994-02-01 Okuma Corporation Positional control apparatus
US5276390A (en) * 1991-10-04 1994-01-04 Hewlett-Packard Company System for hybrid position and force control
US5389963A (en) * 1992-02-05 1995-02-14 Dynacom, Inc. System for selectively interconnecting audio-video sources and receivers
US5291137A (en) * 1992-11-02 1994-03-01 Schlumberger Technology Corporation Processing method and apparatus for processing spin echo in-phase and quadrature amplitudes from a pulsed nuclear magnetism tool and producing new output data to be recorded on an output record

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6242879B1 (en) * 2000-03-13 2001-06-05 Berkeley Process Control, Inc. Touch calibration system for wafer transfer robot
WO2001069336A1 (en) * 2000-03-13 2001-09-20 Berkeley Process Control, Inc. Touch calibration system for wafer transfer robot
US6640458B2 (en) 2002-03-25 2003-11-04 Btm Corporation End arm effector set-up
US20060108960A1 (en) * 2002-07-18 2006-05-25 Michiharu Tanaka Robot controller and robot system
US7391178B2 (en) * 2002-07-18 2008-06-24 Kabushiki Kaisha Yaskawa Denki Robot controller and robot system
US20090105880A1 (en) * 2006-01-13 2009-04-23 Yasunao Okazaki Device and method for controlling robot arm, robot and program
US7558647B2 (en) * 2006-01-13 2009-07-07 Panasonic Corporation Device and method for controlling robot arm, robot and program based on object-dependent impedance
US20100152896A1 (en) * 2008-02-06 2010-06-17 Mayumi Komatsu Robot, controlling device and controlling method for robot, and controlling program for robot-controlling device
US8024071B2 (en) * 2008-02-06 2011-09-20 Panasonic Corporation Robot, controlling device and controlling method for robot, and controlling program for robot-controlling device

Also Published As

Publication number Publication date
JP3115147B2 (en) 2000-12-04
US5442269A (en) 1995-08-15
JPH06262569A (en) 1994-09-20

Similar Documents

Publication Publication Date Title
USRE36929E (en) Robot control system
US4661032A (en) Bilateral master-slave manipulator control device
CA1330363C (en) Robot system
CN103101053A (en) Robot control system, robot system, and sensor information processing apparatus
US5357424A (en) Dynamic model parameter identification system
EP0177919A2 (en) Method for calibrating transformation matrix of a force sensor
JP3946843B2 (en) Method for controlling coordinate measuring apparatus and coordinate measuring apparatus
ES8609758A1 (en) Drive system for a movable apparatus.
CN106584489A (en) Robot system having function to calculate position and orientation of sensor
EP0875341B1 (en) Position and/or force controlling apparatus using sliding mode decoupling control
KR20220020242A (en) Method for Determining the Weight and Center of Gravity of a Robot Manipulator Cargo
NO781839L (en) CONTROL EQUIPMENT FOR AUTOMATIC MACHINE
EP0464649B1 (en) Control device for robot in inertial coordinate system
Friedrich et al. Spatial force measurement using a rigid hexapod-based end-effector with structure-integrated force sensors in a hexapod machine tool
CN107000209A (en) Control drive component makes the method and apparatus of the movement of tool of special robot guiding
US5510996A (en) Method for determining auxiliary position-control parameters
KR920004281B1 (en) Computer system for fuzzy reasoning
Jacobsen et al. Tactile sensing system design issues in machine manipulation
JP3424849B2 (en) Manipulator compliance controller
Loffler et al. Model based control of a biped robot
EP0596241B1 (en) High precision trajectory tracking control circuit using multi-axial coordination
KR102591945B1 (en) A processing apparatus for implementing a posture maintaining the rigidity of the robot, and a processing method for implementing the posture maintaining the rigidity of the robot using the same
RU2715400C1 (en) Tensoplatform for robot-surgical complex
Dehoff et al. Design of an auto change mechanism and intelligent gripper for the space station
US4884014A (en) Position control method

Legal Events

Date Code Title Description
FEPP Fee payment procedure

Free format text: PAYER NUMBER DE-ASSIGNED (ORIGINAL EVENT CODE: RMPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

Free format text: PAYOR NUMBER ASSIGNED (ORIGINAL EVENT CODE: ASPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

FPAY Fee payment

Year of fee payment: 8

FEPP Fee payment procedure

Free format text: PAYER NUMBER DE-ASSIGNED (ORIGINAL EVENT CODE: RMPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

Free format text: PAYOR NUMBER ASSIGNED (ORIGINAL EVENT CODE: ASPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

FPAY Fee payment

Year of fee payment: 12