Added the test method stuff

In pits, the test method will put the robot into the correct auton
position