Update RobotTemplate.java

Fixed printing problem and should now print every 1000 milliseconds. Lots of comments.