public static int CalculateWaypointCost(Database.Models.MapModel from, Database.Models.MapModel to) { return (int)(10 * (Math.Abs(to.X - from.X)) + Math.Abs(to.Y - from.Y)); }