Moved function to reproduction behavior because it is not used elsewhere
Added Waypoint class