Sigma point kalman filters for integrated navigation