added multitasking to teleop, cleaned up most of the tele-op and autonomous code