Sigma Point Belief Propagation
A New Extension of the Kalman Filter to Nonlinear Systems