Cleaned RobotTemplate.java