Maps in waypoint
Comments and repaired _get_pos()