Fixed numerous issues with nav.
Merge branch 'felix1' of https://github.com/cerathe/maslab-2014 into felix1

Conflicts:
	Derpbot/src/edu/mit/felixsun/maslab/DriveGoalState.java