Constrained state estimation