started waypoint functionality
Merge pull request #7 from will-mcauliff-IV/master

started waypoint functionality