Slightly modified the logic for going into stop/ emergency stop
mode. Now if you are in idle or calibrate, and you press a random
button, you enter stop mode, and if you are in run mode and press a
random button you enter emergency mode.