Added the code to the overall main. Should be able to switch between left and right motor for demonstration now. -MB