Heun's method implemented