Merge These Changes Into master!

Rename RobotTemplate to RobotMain.
Add JavaDoc to Sub Systems, and Changed a few methods in TakePicture.