Added and calibrated autonomous code. Needs a little work.