AGV + Waypoint basis

Basis van simulator AGV en waypoint.