Implement better control and stop() function

Changed so that you can only press one key at a time and then if nothing is pressed do a full stop(). Specified full 4 pin states in each direction function