Created a test function to see if the motors are correctly wired and programmed