public void RegisterWaypoint(VsnWaypoint vsnWaypoint)
 {
     if (waypoints.Contains(vsnWaypoint) == false)
     {
         waypoints.Add(vsnWaypoint);
     }
 }
    public void GotoWaypoint(string waypointName)
    {
        VsnWaypoint waypoint = GetWaypointFromLabel(waypointName);

        if (waypoint != null)
        {
            currentCommandIndex = waypoint.commandNumber;
        }
        else
        {
            Debug.Log("Invalid waypoint with label: " + waypointName);
        }
    }