Rewrote the motor control to work on an H-Bridge driver L293D. Counter clockwise and clockwise directions are now possible