Constrained filtering seems to work, but some problem in the
const. smoothing.