Made some changes to fix compilation errors and tighten things up.
Please review changes.
Merge branch 'master' of
https://github.com/Pittsford-Robotics-3181/Programming.git

Conflicts:
	src/Robot_movement.cpp