US4725942A — Controller for multidegree of freedom nonlinear m…

Claim 1

Independent Claim 271 words

A controller for a multidegree of freedom nonlinear mechanical system which carries out adaptive model following control for a nonlinear mechanical system with multiple degrees of freedom that can be described by a q-th degree differential equation and with driving sources for each of its degree of freedom, comprising: (a) a model section having a built-in reference model that has predetermined response characteristics; (b) a first synthesizing means for obtaining the difference of the internal states between the mechanical system and the reference model; (c) means for detecting signals for the position and i-th derivative (1≦i≦q) of the mechanical system; (d) an adaptor for determining the time-varying parameters of the mechanical system, in accordance with the difference in the internal states between the mechanical system and the reference model obtained from said synthesizing means, an input applied to a control system, the signals for the position and i-th derivative (1≦i≦q) of the mechanical system, and a nonlinear structure of the mechanical system; (e) computing means for computing a compensating input to cancel the nonlinear forces in the mechanical system and the interferential forces between the degrees of freedom of the mechanical system, in accordance with the determined parameter signals obtained from said adaptor, the signals for the position and i-th derivative (1≦i≦q) of the mechanical system, and the nonlinear structure of the mechanical system; and (f) a second synthesizing means for synthesizing the compensating input from said computing means and the input that is applied to the control system in order that the output of the mechanical system corresponds to the output of the reference model in the course of time.

Claim 2

Dependent Claim 271 words

A controller for a multidegree of freedom nonlinear mechanical system which carries out adaptive model following control for a nonlinear mechanical system with multiple degrees of freedom that can be described by a q-th degree differential equation and with driving sources for each of its degree of freedom, comprising: (a) a model section having a built-in reference model that has predetermined response characteristics; (b) a first synthesizing means for obtaining the difference of the internal states between the mechanical system and the reference model; (c) means for detecting signals for the position and i-th derivative (1≦i≦q) of the mechanical system; (d) an adaptor for determining the time-varying parameters of the mechanical system, in accordance with the difference in the internal states between the mechanical system and the reference model obtained from said synthesizing means, an input applied to a control system, the signals for the position and i-th derivative (1≦i≦q) of the mechanical system, and a nonlinear structure of the mechanical system; (e) computing means for computing a compensating input to cancel the nonlinear forces in the mechanical system and the interferential forces between the degrees of freedom of the mechanical system, in accordance with the determined parameter signals obtained from said adaptor, the signals for the position and i-th derivative (1≦i≦q) of the mechanical system, and the nonlinear structure of the mechanical system; and (f) a second synthesizing means for synthesizing the compensating input from said computing means and the input that is applied to the control system in order that the output of the mechanical system corresponds to the output of the reference model in the course of time.

Claim 3

Dependent Claim 173 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 1, in which said computing means comprises: a nonlinear force computation section for computing a compensating input to cancel nonlinear forces other than the inertial force in the mechanical system, in accordance with the determined parameter signals from said adaptor, the signals for the position and i-th derivative (1≦i≦q) of the mechanical system, and the nonlinearity of the mechanical system; a noninterference computation section for computing a compensating input to cancel interferential forces between the degrees of freedom of the mechanical system that are contained in the inertial term, in accordance with the determined parameter signals from said adaptor, the signals for the position and i-th derivative (1≦i≦q), and the nonlinearity of the mechanical system; and an inertial term gain computation section for computing nonlinear compensating gain for the inertial term, in accordance with the determined parameter signals from said adaptor, signals for the position and i-th derivative (1≦i≦q) of the mechanical system, and the nonlinearity of the mechanical system.

Claim 4

Dependent Claim 67 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 2, in which said first synthesizing means comprises a first subtractor which outputs a position deviation signal and a velocity deviation signal for each degree of freedom, by subtractively synthesizing a position signal and a velocity signal of a real mechanical system and a position signal and a velocity signal of said reference model.

Claim 5

Dependent Claim 76 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 3, in which said second synthesizing means comprises a second subtractor for subtractively synthesizing the output from said nonlinear force computation section and the output from said noninterference computation section, and a first adder for additively synthesizing the output from the second subtractor and the output from said inertial term gain computation section for outputting the result to the nonlinear real mechanical system.

Claim 6

Dependent Claim 59 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 4, further comprising: a stabilizer for computing a stabilizing input u Si from the position and i-th derivative (1≦i≦q) of the mechanical system, an output u Si of said stabilizer is added to the input U to the control system by means of a second adder.

Claim 7

Dependent Claim 176 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 5, in which the real mechanical system is described by the following equation of motion, ##EQU21## where x T =(x 1 T , x 2 T )=(x 11 , . . . , x 1n , x 21 , . . . , x 2n ), x 1 : position of the system, x 2 : velocity of the system, ##EQU22## a o ij , . . . , a m .sbsb.ij ij ; b 1 i , . . . , b p .sbsb.i i , (1≦i, j≦n): unknown parameters or time-varying parameters, J o ij (x), . . . , J m .sbsb.ij ij (x); F 1 i (x), . . . , F P .sbsb.i i (x), (1≦i, j≦n): nonlinear bounded known functions that do not contain unknown parameters, u: nx1 input vector applied to the nonlinear real mechanical system, O: nxn zero matrix, I: nxn unit matrix, a o ii J o ii (x)≠0, and a o ii >0.

Claim 8

Dependent Claim 101 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 6, in which said reference model section includes a reference model which is represented by the following equation: ##EQU23## where x M T =(x M1 T x M2 T )=(x M11 , . . . , x M1n , x M21 , . . . , x M2n ), U: new vector input after construction of the control system, K 1 : diag [k 11 , . . . , k 1n ], and K 2 : diag [k 21 , . . . , k 2n ].

Claim 9

Dependent Claim 200 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 7, in which said adaptor computes the following quantities by using the position signal x 1 , the velocity signal x 2 , and the acceleration signal x 2 for each degree of freedom of the real mechanical system detected by the position sensor, the velocity sensor, and the acceleration sensor, respectively, the position deviation signal, the velocity deviation signal between the reference model and the real mechanical system detected by the subtractor, the nonlinear functions Jo ij (x), . . . , J m .sbsb.ij ij (x); F l i (x), . . . , F P .sbsb.i i (x), (1≦i, J≦n), the vectors x 1 and x 2 , and the input U, ##EQU24## where V 1 =d i T (x M1i -X 1i , x M2i -X 2i ) T , (1≦i≦n), a o ii (0), a ii ii (0), b k i (0): arbitrary d i : 2×1 vector that is chosen to make the transfer function W i (s)=d i T (sI-A Mi ) -1 b i to be strictly positive real, ##EQU25## C k ii >0 and C k i >0.

Claim 10

Dependent Claim 83 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 8, in which the noninterference compentation section computes an output u Di given below by using the position signal x 1 , the velocity signal x 2 , and the acceleration signal x 2 that are detected by the sensors, the nonlinear functions J k ij (x) (excluding J o ii (x)) and the parameters a k ij (excluding a o ii ) that are determined by the adaptor, ##EQU26##

Claim 11

Dependent Claim 71 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 9, in which the nonlinear force computation section computes a part u Ci of the compensating input given below by using the position signal x 1 and the velocity signal x 2 that are detected by the sensors, the nonlinear functions F k i (x), and the parameters b k i that are determined by the adaptor, ##EQU27##

Claim 12

Dependent Claim 70 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 10, in which the inertial term gain computation section computes a gain G i given below by using the position signal x 1 and the velocity signal x 2 that are detected by the sensors, the nonlinear functions Jo ii (x), and the parameters a ii that are determined by the adaptor, G.sub.i =a.sub.o.sup.ii J.sub.o.sup.ii (x), (1≦i≦n).

Claim 13

Dependent Claim 59 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 11, in which said stabilizer computes an input u Si given below by using the position signal x 1 and the velocity signal x 2 that are detected by the sensors, and the constants k 1 and k 2 , u.sub.Si =k.sub.1i x.sub.1i +k.sub.2i x.sub.2i, (1≦i≦n).

Claim 14

Dependent Claim 44 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 2, in which said detecting means comprises a position sensor, a velocity sensor, and an acceleration sensor for detecting the position, the velocity, and the acceleration, respectively, of the mechanical system.

Claim 15

Dependent Claim 153 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 1, in which said computing means comprises: a nonlinear force computing section for computing a compensating input to cancel nonlinear forces other than the inertial force in the mechanical system, in accordance with the determined parameter signals from said adaptor, the values of the position and i-th derivative (1≦i≦q) of the mechanical system, and the nonlinear structure of the mechanical system; and a noninterference computation section for computing a compensating input to cancel the interferential forces between the degrees of freedom of the mechanical system that are contained in the inertial force, as well as to compensating for the variations in the value of the inertial term due to nonlinearity, in accordance with the signals from said adaptor, the values of the position and the i-th derivative (1≦i≦q) of the mechanical system, and the nonlinear structure of the mechanical system.

Claim 16

Dependent Claim 67 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 14, in which said first synthesizing means comprises a first subtractor for outputting a position deviation signal and a velocity deviation signal for each degree of freedom by subtractively synthesizing a position signal and a velocity signal of the real mechanical system and a position signal and a velocity signal from said reference model.

Claim 17

Dependent Claim 73 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 15, in which said second synthesizing means comprises a second subtractor for subtractively synthesizing the output from said nonlinear force computation section and the output from said noninterference computation section, and a first adder for additively synthesizing the output from the second subtractor and the input to the control system to output the result to the nonlinear real mechanical system.

Claim 18

Dependent Claim 62 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 16, further comprising: a stabilizer for computing a stabilizing input u Si from the velues of the position and its i-th derivative (1≦i≦q) of the mechanical system, the output u Si of the stabilizer is added to the output from the second subtractor by means of a second adder.

Claim 19

Dependent Claim 74 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 17, in which the real mechanical system is described by the following equation of motion: ##EQU28## where X T =(X 1 T , X 2 T )=(X 11 , . . . , X 1n , X 21 , . . . , X 2n ), X 1 : position of the system, X 2 : velocity of the system, ##EQU29##

Claim 20

Dependent Claim 72 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 18, in which said reference model section includes a reference model that is represented by the following equation: ##EQU30## where x M T =(x M1 T x M2 T )=(x M11 , . . . x M1n , x M21 , . . . , x M2n ), and U: new vector input after construction of the control system.

Claim 21

Dependent Claim 164 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 19, in which said adaptor carries out the following computation by using the position signal x 1 , the velocity signal x 2 , and the acceleration signal x 2 for each degree of freedom of the real mechanical system that are detected by the position sensor, the velocity sensor, and the acceleration sensor, respectively, the position deviation signal and the velocity deviation signal for each degree of freedom between the reference model and the real mechanical system that are detected by the subtractors, and the nonlinear functions: ##EQU31## where -Z=[(J.sub.1 (x)x.sub.2 -F.sub.1 (x))/λ - - - (J.sub.m (x)x.sub.2 -F.sub.m (x))/λ -F.sub.m+1 (x)/λ - - - -F.sub.P (x)/λ], V=De, ##EQU32## e=x.sub.M -x, the matrix P being the positive definite symmetric solution of Lyapunov equation, PA.sub.M +A.sub.M.sup.T P=-Q, with ##EQU33## and D=B.sup.T P where D is chosen to make the transfer function W(s)=D(sI-A M ) -1 B to be strictly positive real.

Claim 22

Dependent Claim 71 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 20, in which said noninterference computation section computes an output u D given below by using the position signal x 1 , the velocity signal x 2 , and the acceleration signal x 2 that are detected by said sensors, said nonlinear functions J k (x), and the parameters a k that are determined by the adaptor, ##EQU34##

Claim 23

Dependent Claim 69 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 21, in which said nonlinear force computation section computes a part u C of the compensating input given below by using the position signal x 1 and the velocity signal x 2 that are detected by said sensors, said nonlinear functions F k (x), and the parameters a k that are determined by the adaptor, ##EQU35##

Claim 24

Dependent Claim 65 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 22, in which said stabilizer computes an input u S given below by using the position signal x 1 and the velocity signal x 2 and the acceleration signal x 2 that are detected by said sensors and the constants k 1 and k 2 , U.sub.S =-x.sub.2 +k.sub.1 x.sub.1 +k.sub.2 x.sub.2.

Claim 25

Dependent Claim 44 words

A controller for multidegree of freedom nonlinear mechanical system as claimed in claim 14, in which said detecting means comprises a position sensor, a velocity sensor, and an acceleration sensor for detecting the position, the velocity, and the acceleration, respectively, of the mechanical system.

Annuity Stage	Window Opens	Payment Deadline	Surcharge Period Until	Estimated Fee	Status
3.5 Years (Year 4)	1991-02-15	1991-08-17	1992-02-16	$2000.00	Window Closed / Lapsed
7.5 Years (Year 8)	1995-02-15	1995-08-17	1996-02-16	$3760.00	Window Closed / Lapsed
11.5 Years (Year 12)	1999-02-15	1999-08-17	2000-02-16	$7700.00	Window Closed / Lapsed

Controller for multidegree of freedom nonlinear mechanical system

Abstract

Inventors

Bibliographic Details

Claims Analysis

References Cited (Backward Citations)

USPTO Annuity & Maintenance Windows

Assigned Categories & Tags

Assign Category Tag