Added Features and fixed bugs

E-stop added, pauses if program is running, stops if just simple move is
going,