Started autonomous

Latest version in FirstRobot repo
noted outdated code