glax/AStar
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Optional Logger

Browse Source
This commit is contained in:
C9Glax 2022-05-06 00:43:52 +02:00
parent d29ab7e01e
commit 1384abfaf2
3 changed files with 20 additions and 22 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
Executable/Program.cs
View File

@ -1,3 +1,3 @@
Logging.Logger logger = new Logging.Logger(Logging.LogType.Console, Logging.loglevel.DEBUG);
Dictionary<UInt64, Graph.Node> nodes = OpenStreetMap_Importer.Importer.Import(ref logger);
new astar.Astar(nodes, ref logger);
Dictionary<UInt64, Graph.Node> nodes = OpenStreetMap_Importer.Importer.Import(logger);
new astar.Astar(nodes, logger);

20
OpenStreetMap Importer/Importer.cs
View File

@ -7,7 +7,7 @@ namespace OpenStreetMap_Importer
public class Importer
{
public static Dictionary<ulong, Node> Import(ref Logger logger)
public static Dictionary<ulong, Node> Import(Logger ?logger = null)
{
List<Way> ways = new List<Way>();
Dictionary<ulong, Node> nodes = new Dictionary<ulong, Node>();
@ -30,7 +30,7 @@ namespace OpenStreetMap_Importer
{
if (reader.Name == "way" && reader.IsStartElement())
{
logger.Log(loglevel.VERBOSE, "WAY {0} nodes {1}", currentWay.highway.ToString(), currentWay.nodeIds.Count);
logger?.Log(loglevel.VERBOSE, "WAY {0} nodes {1}", currentWay.highway.ToString(), currentWay.nodeIds.Count);
if (currentWay.highway != Way.highwayType.NONE)
{
ways.Add(currentWay);
@ -46,9 +46,8 @@ namespace OpenStreetMap_Importer
#pragma warning disable CS8604
string value = reader.GetAttribute("v");
string key = reader.GetAttribute("k");
logger.Log(loglevel.VERBOSE, "TAG {0} {1}", key, value);
logger?.Log(loglevel.VERBOSE, "TAG {0} {1}", key, value);
#pragma warning restore CS8600
#pragma warning restore CS8604
switch (key)
{
case "highway":
@ -73,6 +72,7 @@ namespace OpenStreetMap_Importer
break;*/
}
#pragma warning restore CS8604
}
else if(reader.Name == "nd" && wayTag)
{
@ -85,7 +85,7 @@ namespace OpenStreetMap_Importer
}
}
logger.Log(loglevel.DEBUG, "Ways: {0} Nodes: {1}", ways.Count, nodes.Count);
logger?.Log(loglevel.DEBUG, "Ways: {0} Nodes: {1}", ways.Count, nodes.Count);
reader.Close();
reader = XmlReader.Create(new MemoryStream(OSM_Data.map), readerSettings);
@ -107,12 +107,12 @@ namespace OpenStreetMap_Importer
float lon = Convert.ToSingle(reader.GetAttribute("lon").Replace('.', ','));
#pragma warning restore CS8602
nodes[id] = new Node(lat, lon);
logger.Log(loglevel.VERBOSE, "NODE {0} {1} {2}", id, lat, lon);
logger?.Log(loglevel.VERBOSE, "NODE {0} {1} {2}", id, lat, lon);
}
}
}
logger.Log(loglevel.INFO, "Import finished. Calculating distances.");
logger?.Log(loglevel.INFO, "Import finished. Calculating distances.");
/*
* Add connections between nodes based on ways and calculate distance
@ -128,7 +128,7 @@ namespace OpenStreetMap_Importer
Node neighborNode = nodes[way.nodeIds[index + 1]];
double weight = Utils.DistanceBetweenNodes(currentNode, neighborNode);
currentNode.edges.Add(new Edge(neighborNode, weight));
logger.Log(loglevel.VERBOSE, "EDGE {0} -- {1} --> {2}", way.nodeIds[index], weight, way.nodeIds[index + 1]);
logger?.Log(loglevel.VERBOSE, "EDGE {0} -- {1} --> {2}", way.nodeIds[index], weight, way.nodeIds[index + 1]);
edges++;
if (!way.oneway)
{
@ -145,7 +145,7 @@ namespace OpenStreetMap_Importer
Node neighborNode = nodes[way.nodeIds[index - 1]];
double weight = Utils.DistanceBetweenNodes(currentNode, neighborNode);
currentNode.edges.Add(new Edge(neighborNode, weight));
logger.Log(loglevel.VERBOSE, "EDGE {0} -- {1} --> {2}", way.nodeIds[index], weight, way.nodeIds[index - 1]);
logger?.Log(loglevel.VERBOSE, "EDGE {0} -- {1} --> {2}", way.nodeIds[index], weight, way.nodeIds[index - 1]);
edges++;
if (!way.oneway)
{
@ -157,7 +157,7 @@ namespace OpenStreetMap_Importer
}
reader.Close();
logger.Log(loglevel.DEBUG, "Edges: {0}", edges);
logger?.Log(loglevel.DEBUG, "Edges: {0}", edges);
return nodes;
}

18
astar/Astar.cs
View File

@ -5,27 +5,25 @@ namespace astar
{
public class Astar
{
private Logger logger;
/*
* Loads the graph, chooses two nodes at random and calls a*
*/
public Astar(Dictionary<UInt64, Node> nodes, ref Logger logger)
public Astar(Dictionary<UInt64, Node> nodes, Logger ?logger = null)
{
this.logger = logger;
Random r = new Random();
List<Node> path = new List<Node>();
while(path.Count < 1)
{
Node n1 = nodes[nodes.Keys.ElementAt(r.Next(0, nodes.Count - 1))];
Node n2 = nodes[nodes.Keys.ElementAt(r.Next(0, nodes.Count - 1))];
logger.Log(loglevel.INFO, "From {0} - {1} to {2} - {3}", n1.lat, n1.lon, n2.lat, n2.lon);
path = FindPath(ref nodes, n1, n2, ref this.logger);
logger?.Log(loglevel.INFO, "From {0} - {1} to {2} - {3}", n1.lat, n1.lon, n2.lat, n2.lon);
path = FindPath(ref nodes, n1, n2, ref logger);
}
logger.Log(loglevel.INFO, "Path found");
logger?.Log(loglevel.INFO, "Path found");
foreach (Node n in path)
logger.Log(loglevel.INFO, "lat {0:000.00000} lon {1:000.00000} traveled {2:0000.00} / {3:0000.00} beeline {4:0000.00}", n.lat, n.lon, n.pathLength, path.ElementAt(path.Count-1).pathLength, n.goalDistance);
logger?.Log(loglevel.INFO, "lat {0:000.00000} lon {1:000.00000} traveled {2:0000.00} / {3:0000.00} beeline {4:0000.00}", n.lat, n.lon, n.pathLength, path.ElementAt(path.Count-1).pathLength, n.goalDistance);
}
/*
@ -43,7 +41,7 @@ namespace astar
/*
*
*/
private static List<Node> FindPath(ref Dictionary<ulong, Node> nodes, Node start, Node goal, ref Logger logger)
private static List<Node> FindPath(ref Dictionary<ulong, Node> nodes, Node start, Node goal, ref Logger ?logger)
{
Reset(ref nodes);
List<Node> toVisit = new List<Node>();
@ -54,7 +52,7 @@ namespace astar
while(currentNode != goal && toVisit.Count > 0)
{
currentNode = toVisit.First();
logger.Log(loglevel.VERBOSE, "toVisit-length: {0} path: {1} goal: {2}", toVisit.Count, currentNode.pathLength, currentNode.goalDistance);
logger?.Log(loglevel.VERBOSE, "toVisit-length: {0} path: {1} goal: {2}", toVisit.Count, currentNode.pathLength, currentNode.goalDistance);
//Check all neighbors of current node
foreach (Edge e in currentNode.edges)
{
@ -75,7 +73,7 @@ namespace astar
if (currentNode != goal)
{
logger.Log(loglevel.INFO, "No path between {0} - {1} and {2} - {3}", start.lat, start.lon, goal.lat, goal.lon);
logger?.Log(loglevel.INFO, "No path between {0} - {1} and {2} - {3}", start.lat, start.lon, goal.lat, goal.lon);
return path;
}