/// <summary>
/// Calculates the route from the source to the closest point.
/// </summary>
/// <param name="operation">The operation request.</param>
/// <param name="router">The router.</param>
/// <param name="matcher">Contains an algorithm to match points to the route network.</param>
/// <returns></returns>
private RoutingResponse DoToClosest(
RoutingOperation operation, Router<SimpleWeighedEdge> router, IEdgeMatcher matcher)
{
// create the response.
var response = new RoutingResponse();
// resolve the points and do the routing.
var hooksPerRouterPoints = new Dictionary<RouterPoint, List<RoutingHook>>();
var routerPoints = new List<RouterPoint>();
var unroutableHooks = new List<RoutingHook>(); // save the unroutable hooks.
for (int idx = 0; idx < operation.Hooks.Length; idx++)
{
// routing hook tags.
IDictionary<string, string> tags = operation.Hooks[idx].Tags.ConvertToDictionary();
// resolve the point.
RouterPoint routerPoint = router.Resolve(operation.Vehicle, new GeoCoordinate(
operation.Hooks[idx].Latitude, operation.Hooks[idx].Longitude), matcher, tags);
// check the result.
if (routerPoint == null)
{ // this hook is not routable.
if (idx == 0)
{ // the first point has to be valid!
throw new Exception("Cannot resolve source point of a CalculateToClosest() operation.");
}
unroutableHooks.Add(operation.Hooks[idx]);
}
else
{ // a point to hook on was found!
List<RoutingHook> hooksAtPoint;
if (!hooksPerRouterPoints.TryGetValue(routerPoint, out hooksAtPoint))
{ // the router point does not exist yet.
// check if the router point is routable.
if (router.CheckConnectivity(operation.Vehicle, routerPoint, 200))
{// the point is routable.
// create the hooks list at this point.
hooksAtPoint = new List<RoutingHook>();
hooksPerRouterPoints.Add(routerPoint, hooksAtPoint);
// add the new router point to the list.
routerPoint.Tags.Add(new KeyValuePair<string, string>("id", routerPoints.Count.ToString(
System.Globalization.CultureInfo.InvariantCulture)));
routerPoint.Tags.Add(new KeyValuePair<string, string>("idx", idx.ToString(
System.Globalization.CultureInfo.InvariantCulture)));
routerPoints.Add(routerPoint);
// add the hook.
hooksAtPoint.Add(operation.Hooks[idx]);
}
else
{// this hook is not routable.
if (idx == 0)
{ // the first point has to be valid!
throw new Exception("Cannot resolve source point of a CalculateToClosest() operation.");
}
unroutableHooks.Add(operation.Hooks[idx]);
}
}
else
{
// add the hook.
hooksAtPoint.Add(operation.Hooks[idx]);
}
}
}
// add the unroutable hooks.
response.UnroutableHooks = unroutableHooks.ToArray();
// extract the first point.
RouterPoint first = routerPoints[0];
routerPoints.RemoveAt(0);
// calculate all the weights.
OsmSharpRoute route = router.CalculateToClosest(operation.Vehicle, first, routerPoints.ToArray());
if (route != null)
{
// add the routerpoint tags.
string idxClosestString = route.Entries[route.Entries.Length - 1].Points[0].Tags[1].Value;
int idxClosest = int.Parse(idxClosestString);
// get the closest point.
RoutingHook pointClosest = operation.Hooks[idxClosest];
// get the routerpoint.
RoutePoint routePoint = route.Entries[route.Entries.Length - 1].Points[0];
// add the closest point tags.
routePoint.Latitude = pointClosest.Latitude;
routePoint.Longitude = pointClosest.Longitude;
List<KeyValuePair<string, string>> tags = pointClosest.Tags.ConvertToList();
tags.Add(new KeyValuePair<string, string>("id", pointClosest.Id.ToString())); // add the id-tag.
routePoint.Tags = tags.ConvertFrom();
response.Route = route;
// set the response as successfull.
response.Status = OsmSharpServiceResponseStatusEnum.Success;
}
return response;
}
