GeoMove.java

package org.mmocore.gameserver.geodata;

import java.util.ArrayList;
import java.util.Collections;
import java.util.List;

import org.mmocore.gameserver.model.Creature;
import org.mmocore.gameserver.model.Player;
import org.mmocore.gameserver.network.l2.s2c.ExShowTrace;
import org.mmocore.gameserver.utils.Location;


/**
 * @Author: Diamond
 * @Date: 27/04/2009
 */
public class GeoMove
{
	public static List<List<Location>> findMovePath(int x, int y, int z, int destX, int destY, int destZ, Creature c, int geoIndex)
	{
		List<Location> path = PathFind.findPath(x, y, z, destX, destY, destZ, c != null && c.isPlayable(), geoIndex);
		if(path == null)
			return Collections.emptyList();
		//admin_geo_trace
		/*if(c != null && c.isPlayable())
		{
			for(Location p : path)
			{
				System.out.println("///////////////////////////////////////");
				System.out.println(p.x+",:"+p.y);
				System.out.println("///////////////////////////////////////");
			}
		}*/

		if(c != null && c.isPlayer() && ((Player) c).getVarB("trace"))
		{
			Player player = (Player) c;
			ExShowTrace trace = new ExShowTrace();
			int i = 0;
			for(Location loc : path)
			{
				i++;
				if(i == 1 || i == path.size())
					continue;
				trace.addTrace(loc.x, loc.y, loc.z + 15, 30000);
			}
			player.sendPacket(trace);
		}
		
		return getNodePath(path, geoIndex);
	}

	private static List<List<Location>> getNodePath(List<Location> path, int geoIndex)
	{
		int size = path.size();
		if(size <= 1)
			return Collections.emptyList();
		List<List<Location>> result = new ArrayList<List<Location>>(size);
		for(int i = 1; i < size; i++)
		{
			Location p2 = path.get(i);
			Location p1 = path.get(i - 1);
			List<Location> moveList = GeoEngine.MoveList(p1.x, p1.y, p1.z, p2.x, p2.y, geoIndex, true); // onlyFullPath = true - проверяем весь путь до конца
			if(moveList == null) // если хотя-бы через один из участков нельзя пройти, забраковываем весь путь
				return Collections.emptyList();
			if(!moveList.isEmpty()) // это может случиться только если 2 одинаковых точки подряд
				result.add(moveList);
		}
		return result;
	}

	public static List<Location> constructMoveList(Location begin, Location end)
	{
		begin.world2geo();
		end.world2geo();

		int diff_x = end.x - begin.x, diff_y = end.y - begin.y, diff_z = end.z - begin.z;
		int dx = Math.abs(diff_x), dy = Math.abs(diff_y), dz = Math.abs(diff_z);
		float steps = Math.max(Math.max(dx, dy), dz);
		if(steps == 0) // Никуда не идем
			return Collections.emptyList();

		float step_x = diff_x / steps, step_y = diff_y / steps, step_z = diff_z / steps;
		float next_x = begin.x, next_y = begin.y, next_z = begin.z;

		List<Location> result = new ArrayList<Location>((int) steps + 1);
		result.add(new Location(begin.x, begin.y, begin.z)); // Первая точка

		for(int i = 0; i < steps; i++)
		{
			next_x += step_x;
			next_y += step_y;
			next_z += step_z;

			result.add(new Location((int) (next_x + 0.5f), (int) (next_y + 0.5f), (int) (next_z + 0.5f)));
		}

		return result;
	}
}