Updated Autonomous

Added required files for autonomous section, fixed problems with ir.
Also updated and commented code.