Estimation with applications to tracking and navigation - Bar-Shalom, Yaakov (Wiley, 2001)