public boolean goToWaypoint(int wpNumber){
		System.out.println("Changing waypoint number");
		if(wpNumber >= 0 && wpNumber < points.size()){
			nextWaypointNumber = wpNumber;
			System.out.println("WP number now: " + wpNumber);
			return true;
		}else{
			return false;
		}
	}