Autonomous + Updates

Added autonomous code from our first meet, as well as some updates to
control systems and pragmas.