The Recursive Estimator

WARNING: Under SEVERE construction...


In order to estimate the arm pose at each time step, we use a particular form of a recursive estimator, an Extended Kalman Filter. Such an estimator can be used based on the assumptions that:

  • The dynamics of the system whose state is to be estimated can be modeled
  • Measurements of the system's outputs with direct or indirect information on the system's state can be made
  • Given a prediction of the system's state a prediction of the system's outputs can be made.
  • In our particular case, the system whose state we want to estimate is a human arm, coupled with the camera system (the measurement device). Furthermore:

  • We have an (albeit simple) dynamical model of the system, and the state of the system consists of the four (4) spherical coordinates and their associated angular velocities.
  • The appearance of the arm in the camera image is the output of the system, and these measurements provide information on the state of the system
  • Given knowledge of the shoulder position in 3-D, the 3-D model of the arm, and the camera calibration parameters, it is possible to predict what the measurements will be for any given system state.
  • The original Kalman Filter theory assumes the system is linear, and that inaccuracies in the dynamical model and measurement noise can be modeled as gaussian processes. Since our system is highly nonlinear, an Extended Kalman Filter is used, where at each time step a linearization of the system about the current state prediction is computed. Furthermore, in order to speed up the estimator to run at real-time rates, a sequential measurement update scheme is used.

    ADD:
  • Some details of estimator: use of measurements, arm models,
  • sequential measurement update