US 6,266,578 B1 · Computer based control system

Abstract

A control system for operating any mechanical system, such as a non-linear robotic system, obtains and applies exact control forces so that the non-linear mechanical system satisfies desired trajectory requirements. The system enables a user to set trajectory requirements and allocate weighting factors to the control forces, the weighting factors being set at any values deemed appropriate to optimize the control forces. The trajectory requirements have a functional dependence on a physical measurement vector and time, a velocity of the physical measurement vector and time; or a combination of the two functional dependencies, the physical measurement vector being related to the displacement of one or more locations within the mechanical system. A microprocessor control computer of the system, being programmed with computational techniques that stabilize and speed the determination of the exact control forces, stores and processes the trajectory requirements and weighting factors with the measurements and plant characteristics, the computer sending a signal to the mechanical system to effect the control forces for exactly generating the desired trajectory while minimizing plant operating costs at every instant of time. In one embodiment, measurement of the displacement of an end-effector of a robot arm determines the control forces. Also disclosed is a method for operating the system.

Claims19

Dependent claims

A control system for operating a physical plant having interrelated mechanical elements and a response characteristic described by M(x,t){umlaut over (x)}=F(x,{dot over (x)},t) in generalized coordinates x(t) to follow predetermined desired trajectory requirements, wherein forces that can act on the elements include inertial forces, externally applied forces and control forces, F being exclusive of control forces, the system comprising:

(a) a control computer;
(b) means for storing in the computer values corresponding to M and F of the response characteristic;
(c) means for measuring a p-vector y(t) related to x(t);
(d) means for specifying the trajectory requirements as hi(y,{dot over (y)},t)=0,i=1,2, . . . , s and/or gi(y,t)=0,i=1,2, . . . , (m−s);
(e) means for transforming and storing in the computer the trajectory requirements as {dot over (h)}=−ƒ(1)(h,t) and/or {umlaut over (g)}=−ƒ(2)(g,{dot over (g)},t), wherein a fixed point h=0=g={dot over (g)} is asymptotically stable within a domain of attraction that includes deviations from the trajectory requirements;
(f) means for determining control forces as F c = G * ⁢ ( [ D ⁡ ( h ) - f ( 1 ) ⁡ ( h , t ) D ~ ⁡ ( g ) - f ( 2 ) ⁡ ( g , g . , t ) ] - [ ∂ h ∂ y . ∂ g ∂ y ] ⁡ [ 0 D ~ ⁡ ( ϕ ) ] ⁢ ( [ ∂ h ∂ y . ∂ g ∂ y ] ⁡ [ C ∂ ϕ ∂ x ] ) ⁢ M - 1 ⁢ F ) ,
(g) means for driving the plant by the control forces, thereby to generate the desired trajectory therein.

4 more elements

A method for controlling a plant having interrelated mechanical elements and a response characteristic described by M(x,t){umlaut over (x)}=F(x,{dot over (x)},t) in generalized coordinates x(t) to follow predetermined desired trajectory requirements, wherein forces that can act on the elements include inertial forces, externally applied forces and control forces, wherein F is exclusive of control forces, the method comprising the steps of:

(a) providing a control computer;
(b) determining and storing in the computer a response characteristic of the plant as a matrix of force elements being related to a matrix of mass elements and acceleration in a vector of generalized coordinates x(t);
(c) specifying a measurement p-vector y(t) related to x(t);
(d) specifying the trajectory requirements as hi(y,{dot over (y)},t)=0,i=1,2, . . . , s and/or gi(y,t)=0, i=1,2, . . . , (m−s);
(e) transforming and storing in the computer the trajectory requirements as {dot over (h)}=−ƒ(1)(h,t) and/or {umlaut over (g)}=−ƒ(2)(g,{dot over (g)},t), wherein a fixed point h=0=g={dot over (g)} is asymptotically stable within a domain of attraction that includes deviations from the trajectory requirements;
(f) determining and storing in the computer measurements of the p-vector;
(g) determining control forces as F c = G * ⁢ ( [ D ⁡ ( h ) - f ( 1 ) ⁡ ( h , t ) D ~ ⁡ ( g ) - f ( 2 ) ⁡ ( g , g . , t ) ] - [ ∂ h ∂ y . ∂ g ∂ y ] ⁡ [ 0 D ~ ⁡ ( ϕ ) ] - ( [ ∂ h ∂ y . ∂ g ∂ y ] ⁡ [ C ∂ ϕ ∂ x ] ) ⁢ M - 1 ⁢ F ) ,
G* being any {1,4} inverse of BM−1;
(h) applying the control forces;
and
(i) repeating steps (f-h) for generating a control trajectory of the plant corresponding to the desired trajectory.

8 more elements

Dependencies are inferred from the claim text.

Computer based control system

Life of this patent

Computer based control system

Life of this patent

Abstract

Claims19