Started coding up the autonomous