Curvature nonlinearity measure and filter divergence detector for nonlinear tracking problems.