Remove old commented autonomous code and debug println