Waypoint loader working

First working version of waypoint loader is done