Better now! Simplified and 'good enough' drive forward/backward routine. Responding to the interrupt.