Changed some functionality of autonomous mode, must be tested. Changed each autonomous command from starting its respective command for teleop to RobotTemplate starting the command for each subsystem in teleopInit.