Autonomous v.1

https://github.com/izzielau/FTC-Team-25/commit/bd0cf3e5b64f2ad626aed639148aa1b9a31121c0