A Constrained Total Extended Kalman Filter for Integrated Navigation. (26th February 2018)