Reset function and bugfix

Introducing reset function and fixing ”finished” bug when changing back
to step 0. However, position 0 and 1 are still not flawless.