Friday week 15

Our group is back on the autonomous build again. We are getting closer and closer with this code and hopefully we can finish it by next week so we can continue working on the tetra challenge.