https://123dok.net/document/z1d3e003-guaranteed-nonlinear-estimation-using-constraint-propagation-on-sets.html