add waypoint functionality
  fix style, add to documentation
Merge pull request #4 from feighter09/waypoints

Waypoints