public double RouteDistance(Point p1_prj, Vertex v1, Point p2_prj, Vertex v2, Graph g, bool flag)
{
double routeDis = 0;
double dis1 = p1_prj.DistanceFrom(v1.toPoint());
double dis2 = p2_prj.DistanceFrom(v2.toPoint());
if (flag)
{
return(p1_prj.DistanceFrom(p2_prj));
}
else
{
for (int i = 1; i < path_edges.Count - 1; i++)
{
routeDis += path_edges[i].Length;
}
routeDis += dis1;
routeDis += dis2;
return(routeDis);
}
}
/// <summary>
/// calculate route distance by search the shortest route between the from vertex of the two edges
/// this method may be not accurate.
/// <returns></returns>
private Edgespp RouteDistance(Point p1, Edge e1, Point p2, Edge e2, Graph g)
{
double routeDis = 0;
Point p1_prj = e1.projectFrom(p1);
Vertex e1_to = e1.To;
double dis1 = p1_prj.DistanceFrom(e1_to.toPoint());
Point p2_prj = e2.projectFrom(p2);
Vertex e2_from = e2.From;
double dis2 = p2_prj.DistanceFrom(e2_from.toPoint());
if (e1 == e2)
{
return(new Edgespp(p1_prj.DistanceFrom(p2_prj), new List <Edge>()
{
e1
}));
}
else if (e1_to.ID == e2_from.ID)
{
routeDis = dis1 + dis2;
return(new Edgespp(routeDis, new List <Edge>()
{
e1, e2
}));
}
else
{
Dijkstra dij = new Dijkstra(g);
LinkedList <Vertex> shortestPath_vertices = dij.ShortestPath_ScoreValue(e1_to, e2_from, _distance_limit);
//Route rs = getminRoute(F, e1.ID, e2.ID, p1, p2);
if (shortestPath_vertices == null)
{
return(null);
}
List <Edge> shortestPath_edges = dij.MakeShortestPath_EdgeList();
//List<Edge> shortestPath_edges = rs.getPath_EdgeList(m_graph);
for (int i = 0; i < shortestPath_edges.Count; i++)
{
routeDis += shortestPath_edges[i].Length;
}
if (shortestPath_edges.Contains(e1))
{
routeDis -= dis1;
shortestPath_edges.Remove(e1);
}
else
{
routeDis += dis1;
}
if (shortestPath_edges.Contains(e2))
{
routeDis -= dis2;
shortestPath_edges.Remove(e2);
}
else
{
routeDis += dis2;
}
return(new Edgespp(routeDis, shortestPath_edges));
}
}