Mercurial > hg > octave-lyh
diff scripts/control/lqe.m @ 76:c69be6819009
[project @ 1993-08-30 15:29:38 by jwe]
Initial revision
author | jwe |
---|---|
date | Mon, 30 Aug 1993 15:29:38 +0000 |
parents | |
children | 16a24e76d6e0 |
line wrap: on
line diff
new file mode 100644 --- /dev/null +++ b/scripts/control/lqe.m @@ -0,0 +1,39 @@ +function [k, p, e] = lqe (a, g, c, sigw, sigv, zz) + +# Usage: [k, p, e] = lqe (A, G, C, SigW, SigV {,Z}) +# +# Linear quadratic estimator (Kalman filter) design for the +# continuous time system +# +# dx/dt = A x + B u + G w +# y = C x + D u + w +# +# where w, v are zero-mean gaussian noise processes with respective +# intensities SigW = cov (w, w) and SigV = cov (v, v). +# +# Z (if specified) is cov(w,v); otherwise cov(w,v) = 0. +# +# Observer structure is dz/dt = A z + B u + k( y - C z - D u). +# +# Returns: +# +# k = observer gain, (A - K C) is stable +# p = solution of algebraic Riccati equation +# e = closed loop poles of (A - K C) + +# Written by A. S. Hodel (scotte@eng.auburn.edu) August, 1993. + + if (nargin != 5 && nargin != 6) + error ("lqe: illegal number of arguments"); + endif + +# The problem is dual to the regulator design, so transform to lqr +# call. + + if (nargin == 5) + [k, p, e] = lqr (a', c', g*sigw*g', sigv); + else + [k, p, e] = lqr (a', c', g*sigw*g', sigv, g*zz); + endif + +endfunction