Waypoints

Waypoints now work. Radar is implemented. Images need to be changed.