public boolean moveToNext(){
		System.out.println("Increasing waypoint number");
		System.out.println("Total waypoints: " + points.size());
		if(points.size() -1 > nextWaypointNumber){
			nextWaypointNumber++;
			System.out.println("WP number now: " + nextWaypointNumber);
			return true;
		}else{
			//System.out.println("Setting WP number to 0");
			//scp nextWaypointNumber = 0;
			return false;
		}
	}