Added Motor Functionality

Motors can now spin in either direction if functions are called