Navigational paths are now simplified to the minimum list of waypoints

Just want to merge in this one change before I switch over to collision stuff.