Abstract:Modern autonomous systems are purposed for many challenging scenarios, where agents will face unexpected events and complicated tasks. The presence of disturbance noise with control command and unknown inputs can negatively impact robot performance. Previous research of joint input and state estimation separately studied the continuous and discrete cases without any prior information. This paper combines the continuous and discrete input cases into a unified theory based on the Expectation-Maximum (EM) algorithm. By introducing prior knowledge of events as the constraint, inequality optimization problems are formulated to determine a gain matrix or dynamic weights to realize an optimal input estimation with lower variance and more accurate decision-making. Finally, statistical results from experiments show that our algorithm owns 81\% improvement of the variance than KF and 47\% improvement than RKF in continuous space; a remarkable improvement of right decision-making probability of our input estimator in discrete space, identification ability is also analyzed by experiments.
What problem does this paper attempt to address?
This paper attempts to solve the problem of joint estimation of states and inputs in dynamic systems in the presence of prior knowledge. Specifically, the traditional Kalman Filter (KF) usually assumes that the specific values of inputs are known or completely unknown when dealing with unknown inputs. However, in practical applications, inputs are often uncontrolled behaviors, which can be regarded as unexpected disturbances to the system, resulting in a large estimation variance. By introducing prior knowledge as a constraint, this paper proposes a Recursive Kalman Filter (RKF) based on the Expectation - Maximization (EM) algorithm to achieve more accurate input estimation, thereby reducing the estimation variance and improving the accuracy of decision - making.
### Main Contributions
1. **Introduction of Prior Knowledge**: The paper uses prior knowledge as an additional constraint to limit the range of inputs, thus reducing the estimation variance.
2. **Unification of Continuous and Discrete Inputs**: The paper combines the cases of continuous and discrete inputs and proposes a unified theoretical framework applicable to different types of inputs.
3. **Optimization of Input Estimation**: By solving the inequality optimization problem, the optimal gain matrix is found to achieve input estimation with minimum variance.
4. **Experimental Verification**: The effectiveness of the proposed method is verified by experimental results. In particular, in the continuous space, compared with the traditional KF and RKF, the variance of this method is improved by 81% and 47% respectively; in the discrete space, the correct decision - making probability of the input estimator is significantly improved.
### Method Overview
- **System Model**:
\[
x_{k + 1}=A_k x_k+G_k d_k+w_k
\]
\[
y_{k + 1}=C_{k + 1}x_{k + 1}+v_{k + 1}
\]
where \(x\) is the state, \(d\) is the input, \(y\) is the measurement value, and \(w\) and \(v\) are the process noise and measurement noise respectively, which are assumed to be uncorrelated zero - mean white Gaussian noise.
- **Objective Function**:
\[
\arg\max P(x_k|y_{k + 1}) = P(d_k|y_{k + 1})P(x_k|d_k,y_{k + 1})
\]
- **EM Algorithm**:
- **E - step**: Given the observation \(y_{k + 1}\) and the state estimate \(x_k\) from the previous step, determine the distribution of the parameter \(d_k\).
\[
Q(d_k)=E_z[P(z_k,d_k|y_{k + 1})]
\]
- **M - step**: Find the maximum a posteriori (MAP) estimate of \(Q(d_k)\).
\[
\arg\max_d Q(d_k)
\]
- **Input Estimation**:
\[
\hat{x}_{k|k - 1}=A_{k - 1}\hat{x}_{k - 1|k - 1}
\]
\[
\hat{d}_{k - 1}=M_k(y_k - C_k\hat{x}_{k|k - 1})
\]
where \(M_k\) is the input estimation gain matrix.
- **State Estimation**:
\[
\hat{x}^\star_{k|k}=\hat{x}_{k|k - 1}+G_{k - 1}\hat{d}_{k - 1}
\]
\[
\hat{x}_{k|k}=\hat{x}^\star_{k|k}+K_k(y_k - C_k\hat{x}^\star_{k|k})
\]
where \(K_k\) is the state estimation gain matrix.
### Experimental Results
- **Continuous Space**: In the wind speed estimation experiment, AL - RKF significantly reduces the variance of the estimation error compared with KF and RKF.
- **Discrete Space**: In the multi - UAV collision detection experiment, AMM