Added Basic Autonomous

Added basic code to run in AutonomousPeriodic(). It will drive forward,
and raise and lower the arms.