IPC분류정보
국가/구분 |
United States(US) Patent
등록
|
국제특허분류(IPC7판) |
|
출원번호 |
US-0204630
(2005-08-16)
|
등록번호 |
US-7375679
(2008-05-20)
|
발명자
/ 주소 |
- Mookerjee,Purusottam
- Reifler,Frank J.
|
출원인 / 주소 |
- Lockheed Martin Corporation
|
대리인 / 주소 |
|
인용정보 |
피인용 횟수 :
9 인용 특허 :
5 |
초록
▼
This invention relates to state estimation after processing time-delayed measurements with unknown biases that may vary arbitrarily in time within known physical bounds. These biased measurements are obtained from systems characterized by state variables and by multidimensional parameters, for which
This invention relates to state estimation after processing time-delayed measurements with unknown biases that may vary arbitrarily in time within known physical bounds. These biased measurements are obtained from systems characterized by state variables and by multidimensional parameters, for which the latter are also unknown and may vary arbitrarily in time within known physical bounds. If a measurement is time-late, apply the measurements to an out-of-sequence filter using a mean square optimization criterion that accounts for all sources of uncertainty and delay time, to produce estimates of the true states of the system. If the measurement is not time-late, apply the measurements to an in-sequence filter using a mean square optimization criterion that accounts for all sources of uncertainty to produce estimates of the true states of the system. The estimates are applied to one of (a) making a decision, (b) operating a control system, and (c) controlling a process.
대표청구항
▼
What is claimed is: 1. A method for recursively estimating the state of a system having multidimensional parameters λ in addition to state variables x(k) at time tk for k=0, 1, 2, . . . , which parameters λ are unknown, arbitrarily time-varying, but bounded, and driven by the input functi
What is claimed is: 1. A method for recursively estimating the state of a system having multidimensional parameters λ in addition to state variables x(k) at time tk for k=0, 1, 2, . . . , which parameters λ are unknown, arbitrarily time-varying, but bounded, and driven by the input function u(x(k), λ), which may be nonlinear, and expressed by the state equation description="In-line Formulae" end="lead"x(k+1)=Φx(k)+Γu( x(k),λ) (73)description="In-line Formulae" end="tail" where Φ, Γ are system matrices dependent on the discrete time interval T=tk+1-tk, said method comprising the following steps: measuring aspects of the state of the system to produce initial measurements expressed by the measurement equation description="In-line Formulae" end="lead"z(k)=Hx(k)+Jb+n(k) (74)description="In-line Formulae" end="tail" for 1≦k≦k0, where, if no measurements are used in the initialization of the filter, k0=0, where b is an unknown arbitrarily time-varying, but bounded, measurement bias vector with covariance B, whose components correspond to the different sensors, and where the sensor selector matrix J selects the appropriate components of sensor bias, and where n(k) is the measurement noise with covariance N and measurement matrix H at time tk; initializing state estimates {circumflex over (x)}(k0|k0) and the matrices M(k0|k0), D(k0|k0), E(k0|k0) using a priori information and the initial measurements (D(k0|k0)=0 if the initial state estimates do not depend on the parameters λ; E(k0|k0)=0 if there are no initial measurements), where vector {circumflex over (x)}(t|k) is defined as the estimate of the state of the system at time t after processing k measurements z(i) for 1≦i≦k; vector {circumflex over (x)}(tj|k) is denoted as {circumflex over (x)}(j|k) when the time t=tj is the time of the jth measurement for j=1, 2, 3, . . . ; matrix M(t|k) is defined as the covariance of the state estimation errors at time t due only to the random errors in the k measurements z(i) for 1≦i≦k and a priori initial information that is independent of the parameter uncertainty and measurement bias uncertainty; matrix M(tj|k) is denoted as M(j|k), when the time t=tj is the time of the jth measurement for j=1, 2, 3, . . . ; matrix D(t|k) is defined as the matrix of bias coefficients, which linearly relates state estimation errors to the parameter errors, at time t after processing k measurements z(i) for 1≦i≦k; matrix D(tj|k) is denoted as D(j|k), when the time t=tj is the time of the jth measurement for j=1, 2, 3, . . . ; matrix E(t|k) is defined as the matrix of bias coefficients, which linearly relates state estimation errors to the sensor measurement bias, at time t after processing k measurements z(i) for 1≦i≦k; matrix E(tj|k) is denoted as E(j|k), when the time t=tj is the time of the jth measurement for j=1, 2, 3, . . . ; determining the time tk+1 of a new measurement and the time t when the filter was last updated; determining the system transition matrices Φand Γ using the update interval T=tk+1-t; determining the mean value λ of unknown but bounded parameters λ, and the input vector u({circumflex over (x)}(t|k), λ); measuring aspects of the state of the system expressed by the measurement equation description="In-line Formulae" end="lead"z(k)=Hx(k)+Jb+n(k) (75)description="In-line Formulae" end="tail" where b is an unknown arbitrarily time-varying, but bounded, measurement bias vector with covariance B, whose components correspond to the different sensors, and where the sensor selector matrix J selects the appropriate components of sensor bias, and where n(k) is the measurement noise with covariance N and measurement matrix H at time tk for k=1, 2, 3, . . . ; determining if the measurement is time-late by testing Tx)}(k+1|k)=Φ{circumflex over (x)}(t|k)+Γu({circumflex over (x)}(t|k), λ) (78)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"M(k+1|k)=FM(t|k)F' (79)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"D(k+1|k)=FD(t|k)+G (80)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"E(k+1|k)=FE(t|k) (81)description="In-line Formulae" end="tail" and calculating P(k+1|k) as in description="In-line Formulae" end="lead"P(k+1|k)=M(k+1|k)+ D(k+1|k)ΛD(k+1|k)' (82)description="In-line Formulae" end="tail" determining covariance of the residual Q as in description="In-line Formulae" end="lead"V=HE(k+1|k)+J (83)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"Q=HP(k+1|k)H'+VBV'+N (84)description="In-line Formulae" end="tail" determining the filter gain matrix K as in description="In-line Formulae" end="lead"A=M(t|k)F'H'+D(t|k)ΛD (k+1|k)H'+E(t|k)BV' (85)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"K=AQ-1 (86)description="In-line Formulae" end="tail" determining the matrix L as in description="In-line Formulae" end="lead"L=I-KHF (87)description="In-line Formulae" end="tail" where I is the identity matrix; updating the state estimate {circumflex over (x)}(t|k) as description="In-line Formulae" end="lead"{circumflex over (x)}(t|k+1)={circumflex over (x)}(t|k)+K[z(k+1)-H{circumflex over (x)}(k+1|k)] (88)description="In-line Formulae" end="tail" updating the matrices M(t|k), D(t|k), E(t|k) to yield M(t|k+1), D(t|k+1), and E(t|k+1) as in description="In-line Formulae" end="lead"M(t|k+1)=LM(t|k)L'+KNK' (89)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"D(t|k+1)=D(t|k)-KHD(k+ 1|k) (90)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"E(t|k+1)=E(t|k)-KV (91)description="In-line Formulae" end="tail" respectively, and generating the total mean square error S(t|k+1) as in description="In-line Formulae" end="lead"S(t|k+1)=M(t|k+1)+D(t|k+ 1)ΛD(t|k+1)'+E(t|k+1)BE( t|k+1) (92)description="In-line Formulae" end="tail" (b) and if the measurement is not time-late determining F,G using generating a parameter matrix Λ, representing physical bounds on those parameters that are not state variables of the system; extrapolating said state estimates {circumflex over (x)}(k|k) and matrices M(k|k), D(k|k), and E(k|k), to {circumflex over (x)}(k+1|k), M(k+1|k), D(k+1|k), and E(k+1|k) as description="In-line Formulae" end="lead"{circumflex over (x)}(k+1|k)=Φ{circumflex over (x)}(k|k)+Γu({circumflex over (x)}(k|k), λ) (95)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"M(k+1|k)=FM(k|k)F' (96)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"D(k+1|k)=FD(k|k)+G (97)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"E(k+1|k)=FE(k|k) (98)description="In-line Formulae" end="tail" determining covariance of the residual Q as description="In-line Formulae" end="lead"P(k+1|k)=M(k+1|k)+ D(k+1|k)ΛD(k+1|k)' (99)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"V=HE(k+1|k)+J (100)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"Q=HP(k+1|k)H'+VBV'+N (101)description="In-line Formulae" end="tail" determining the filter gain matrix K as description="In-line Formulae" end="lead"A=P(k+1|k)H'+E(k+1|k )BV' (102)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"K=AQ-1 (103)description="In-line Formulae" end="tail" determining the matrix L as description="In-line Formulae" end="lead"L=I-KH (104)description="In-line Formulae" end="tail" where I is the identity matrix; updating the state estimate {circumflex over (x)}(k+1|k) as description="In-line Formulae" end="lead"{circumflex over (x)}(k+1|k+1)={circumflex over (x)}(k+1|k)+K[z(k+1)-H{circumflex over (x)}(k+1|k)] (105)description="In-line Formulae" end="tail" updating the matrices M(k+1|k), D(k+1|k), E(k+1|k) as description="In-line Formulae" end="lead"M(k+1|k+1)=LM(k+1|k) L'+KNK' (106)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"D(k+1|k+1)=LD(k+1|k) (107)description="In-line Formulae" end="tail" description="In-line Formulae" end="lead"E(k+1|k+1)=LE(k+1|k)-KJ (108)description="In-line Formulae" end="tail" respectively, and generating the total mean square error S(k+1|k+1) as description="In-line Formulae" end="lead"S(k+1|k+1)=M(k+1|k+ 1)+D(k+1|k+1)ΛD(k+1|k+1) '+E(k+1|k+1)BE(k+1|k+1)' (109)description="In-line Formulae" end="tail" 2. A method according to claim 1, wherein said step of measuring aspects of the state of the system includes measuring any aspect of the state using a measuring device, where the measuring device can be, but is not limited to radar, sonar, optical sensors, rate gyros, accelerometers, thermometers. 3. A method according to claim 1, wherein said step of measuring aspects of the state of the system includes at least one of the steps of measuring position, a range, or an angle of a target. 4. A method for estimating the state of a system, said method comprising the steps of: observing a system having state variables and also having unknown, multidimensional, arbitrarily time-varying parameters, but which are subject to known bounded values; measuring certain aspects of the state of the system in the presence of sensor measurement biases and random errors to produce initial measurements; initializing state estimates and matrices using a priori information and the initial measurements; using the update interval in determining the system transition matrices and the mean value of unknown but bounded parameters and the input vector; determining if the measurement is time-late by testing the sign of the update interval; if the measurement is time-late applying the measurements to an out-of-sequence estimating filter that explicitly uses a mean square optimization criterion that separately accounts for measurement biases and errors and said bounding values, as well as the delay time, to produce estimates of the true state of the system; if the measurement is not time-late applying the measurements to an in-sequence estimating filter that explicitly uses a mean square optimization criterion that separately accounts for measurement biases and errors and said bounding values, to produce estimates of the true state of the system; applying said estimates to one of (a) make a decision, (b) operate a control system, and (c) control a process. 5. A method for state estimation by processing time-delayed measurements with unknown biases that may vary arbitrarily in time within known physical bounds, said method comprising the steps of: obtaining measurements from systems characterized by state variables and by multidimensional parameters, which multidimensional parameters are also unknown and may vary arbitrarily in time within known physical bounds; if a measurement is time-late, the measurements are applied to an out-of-sequence filter using a mean square optimization criterion that nominally accounts for all sources of uncertainty and delay time, to produce estimates of the true states of the system; if the measurement is not time-late, the measurements are applied to an in-sequence filter using a mean square optimization criterion that nominally accounts for all sources of uncertainty to produce estimates of the true states of the system. 6. A method according to claim 5, further comprising the step of applying the estimates to one of (a) making a decision, (b) operating a control system, and (c) controlling a process.
※ AI-Helper는 부적절한 답변을 할 수 있습니다.