Added documentation, removed a redundancy and tweaked some constants
- Added javadoc and line by line documentation for autonomous
- Increased robot autonomous acceleration rate
- Increased WaitForVisionCommand timeout
- Removed redundant setTimeout() in WaitForVisionCommand