Add integrators tests
Fix Heun method implementation
Widen the plotting region in SM test