Added Richardson adaptive stepsize control