Merge pull request #4 from njfaries/Navagation

Organization
Wrote outline of collection code and put in constants for motor
rotation.
Collection code outline written and constants for motor rotation added.
Updated the Collection Branch

Updated Collection with the current stuff from navigation
Big Commit - Map and Coordinates (scanning process)

Major update to all scanning processes.
Coordinates contains static scan class. Parses data into various Blocks
and adds these Blocks to the Map.
The map also does some waypoint finding (wip)
Small Update

Angle Finding