House keeping

Changes to stop button, timer and despawn of robot. Made flow of program
nicer...