350 lines
15 KiB
C#
350 lines
15 KiB
C#
#pragma warning disable CS8600
|
|
#pragma warning disable CS8602
|
|
#pragma warning disable CS8604
|
|
using Logging;
|
|
using System.Xml;
|
|
using Graph;
|
|
using Graph.Utils;
|
|
|
|
namespace OpenStreetMap_Importer
|
|
{
|
|
public class Importer
|
|
{
|
|
|
|
private static XmlReaderSettings readerSettings = new()
|
|
{
|
|
IgnoreWhitespace = true,
|
|
IgnoreComments = true
|
|
};
|
|
|
|
public static Graph.Graph Import(string filePath = "", bool onlyJunctions = true, Logger? logger = null)
|
|
{
|
|
/*
|
|
* Count Node occurances when tag is "highway"
|
|
*/
|
|
logger?.Log(LogLevel.DEBUG, "Opening File...");
|
|
Stream mapData = File.Exists(filePath) ? new FileStream(filePath, FileMode.Open, FileAccess.Read) : new MemoryStream(OSM_Data.map);
|
|
logger?.Log(LogLevel.INFO, "Counting Node-Occurances...");
|
|
Dictionary<ulong, ushort> occuranceCount = CountNodeOccurances(mapData, logger);
|
|
logger?.Log(LogLevel.DEBUG, "Way Nodes: {0}", occuranceCount.Count);
|
|
|
|
/*
|
|
* Import Nodes and Edges
|
|
*/
|
|
mapData.Position = 0;
|
|
logger?.Log(LogLevel.INFO, "Importing Graph...");
|
|
Graph.Graph _graph = CreateGraph(mapData, occuranceCount, onlyJunctions, logger);
|
|
logger?.Log(LogLevel.DEBUG, "Loaded Nodes: {0}", _graph.GetNodeCount());
|
|
|
|
mapData.Close();
|
|
occuranceCount.Clear();
|
|
GC.Collect();
|
|
|
|
return _graph;
|
|
}
|
|
|
|
private static Dictionary<ulong, ushort> CountNodeOccurances(Stream mapData, Logger? logger = null)
|
|
{
|
|
Dictionary<ulong, ushort> _occurances = new();
|
|
|
|
XmlReader _reader = XmlReader.Create(mapData, readerSettings);
|
|
XmlReader _wayReader;
|
|
_reader.MoveToContent();
|
|
|
|
bool _isHighway;
|
|
List<ulong> _currentIds = new();
|
|
|
|
while (_reader.ReadToFollowing("way"))
|
|
{
|
|
_isHighway = false;
|
|
_currentIds.Clear();
|
|
_wayReader = _reader.ReadSubtree();
|
|
logger?.Log(LogLevel.VERBOSE, "WAY: {0}", _reader.GetAttribute("id"));
|
|
while (_wayReader.Read())
|
|
{
|
|
if (_reader.Name == "tag" && _reader.GetAttribute("k").Equals("highway"))
|
|
{
|
|
try
|
|
{
|
|
if (!Enum.Parse(typeof(Way.type), _reader.GetAttribute("v"), true).Equals(Way.type.NONE))
|
|
_isHighway = true;
|
|
logger?.Log(LogLevel.VERBOSE, "Highway: {0}", _reader.GetAttribute("v"));
|
|
}
|
|
catch (ArgumentException) { };
|
|
}
|
|
else if(_reader.Name == "nd")
|
|
{
|
|
try
|
|
{
|
|
_currentIds.Add(Convert.ToUInt64(_reader.GetAttribute("ref")));
|
|
logger?.Log(LogLevel.VERBOSE, "node-ref: {0}", _reader.GetAttribute("ref"));
|
|
}
|
|
catch (FormatException) { };
|
|
}
|
|
}
|
|
if (_isHighway)
|
|
{
|
|
foreach(ulong _id in _currentIds)
|
|
{
|
|
if (!_occurances.TryAdd(_id, 1))
|
|
_occurances[_id]++;
|
|
}
|
|
}
|
|
_wayReader.Close();
|
|
}
|
|
_reader.Close();
|
|
GC.Collect();
|
|
|
|
return _occurances;
|
|
}
|
|
|
|
private static Graph.Graph CreateGraph(Stream mapData, Dictionary<ulong, ushort> occuranceCount, bool onlyJunctions, Logger? logger = null)
|
|
{
|
|
Graph.Graph _graph = new();
|
|
Way _currentWay;
|
|
Node _n1, _n2, _currentNode;
|
|
float _time, _distance = 0;
|
|
|
|
XmlReader _reader = XmlReader.Create(mapData, readerSettings);
|
|
XmlReader _wayReader;
|
|
_reader.MoveToContent();
|
|
|
|
while (_reader.Read())
|
|
{
|
|
if(_reader.Name == "node")
|
|
{
|
|
ulong id = Convert.ToUInt64(_reader.GetAttribute("id"));
|
|
if (occuranceCount.ContainsKey(id))
|
|
{
|
|
float lat = Convert.ToSingle(_reader.GetAttribute("lat").Replace('.', ','));
|
|
float lon = Convert.ToSingle(_reader.GetAttribute("lon").Replace('.', ','));
|
|
_graph.AddNode(id, new Node(lat, lon));
|
|
logger?.Log(LogLevel.VERBOSE, "NODE {0} {1} {2} {3}", id, lat, lon, occuranceCount[id]);
|
|
}
|
|
}
|
|
else if(_reader.Name == "way")
|
|
{
|
|
_wayReader = _reader.ReadSubtree();
|
|
_currentWay = new();
|
|
logger?.Log(LogLevel.VERBOSE, "WAY: {0}", _reader.GetAttribute("id"));
|
|
while (_wayReader.Read())
|
|
{
|
|
_wayReader = _reader.ReadSubtree();
|
|
_currentWay.AddTag("id", _reader.GetAttribute("id"));
|
|
while (_wayReader.Read())
|
|
{
|
|
if (_reader.Name == "tag")
|
|
{
|
|
string _value = _reader.GetAttribute("v");
|
|
string _key = _reader.GetAttribute("k");
|
|
logger?.Log(LogLevel.VERBOSE, "TAG {0} {1}", _key, _value);
|
|
_currentWay.AddTag(_key, _value);
|
|
}
|
|
else if (_reader.Name == "nd")
|
|
{
|
|
ulong _id = Convert.ToUInt64(_reader.GetAttribute("ref"));
|
|
_currentWay.nodeIds.Add(_id);
|
|
logger?.Log(LogLevel.VERBOSE, "node-ref: {0}", _id);
|
|
}
|
|
}
|
|
}
|
|
_wayReader.Close();
|
|
|
|
if (!_currentWay.GetHighwayType().Equals(Way.type.NONE))
|
|
{
|
|
logger?.Log(LogLevel.VERBOSE, "WAY Nodes-count: {0} Type: {1}", _currentWay.nodeIds.Count, _currentWay.GetHighwayType());
|
|
if (!onlyJunctions)
|
|
{
|
|
for (int _nodeIdIndex = 0; _nodeIdIndex < _currentWay.nodeIds.Count - 1; _nodeIdIndex++)
|
|
{
|
|
_n1 = _graph.GetNode(_currentWay.nodeIds[_nodeIdIndex]);
|
|
_n2 = _graph.GetNode(_currentWay.nodeIds[_nodeIdIndex + 1]);
|
|
|
|
_distance = Convert.ToSingle(Utils.DistanceBetweenNodes(_n1, _n2));
|
|
_time = _distance / _currentWay.GetMaxSpeed();
|
|
if (!_currentWay.IsOneWay())
|
|
{
|
|
_n1.edges.Add(new Edge(_n2, _time, _distance, _currentWay.GetId()));
|
|
_n2.edges.Add(new Edge(_n1, _time, _distance, _currentWay.GetId()));
|
|
}
|
|
else if (_currentWay.IsForward())
|
|
{
|
|
_n1.edges.Add(new Edge(_n2, _time, _distance, _currentWay.GetId()));
|
|
}
|
|
else
|
|
{
|
|
_n2.edges.Add(new Edge(_n1, _time, _distance, _currentWay.GetId()));
|
|
}
|
|
logger?.Log(LogLevel.VERBOSE, "Add Edge: {0} & {1} Weight: {2}", _currentWay.nodeIds[_nodeIdIndex], _currentWay.nodeIds[_nodeIdIndex + 1], _time);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
_n1 = _graph.GetNode(_currentWay.nodeIds[0]);
|
|
_currentNode = _n1;
|
|
for(int _nodeIdIndex = 0; _nodeIdIndex < _currentWay.nodeIds.Count - 1; _nodeIdIndex++)
|
|
{
|
|
_n2 = _graph.GetNode(_currentWay.nodeIds[_nodeIdIndex + 1]);
|
|
_distance += Convert.ToSingle(Utils.DistanceBetweenNodes(_currentNode, _n2));
|
|
if (occuranceCount[_currentWay.nodeIds[_nodeIdIndex]] > 1 || _nodeIdIndex == _currentWay.nodeIds.Count - 2) //junction found
|
|
{
|
|
_time = _distance / _currentWay.GetMaxSpeed();
|
|
if (!_currentWay.IsOneWay())
|
|
{
|
|
_n1.edges.Add(new Edge(_n2, _time, _distance, _currentWay.GetId()));
|
|
_n2.edges.Add(new Edge(_n1, _time, _distance, _currentWay.GetId()));
|
|
}
|
|
else if (_currentWay.IsForward())
|
|
{
|
|
_n1.edges.Add(new Edge(_n2, _time, _distance, _currentWay.GetId()));
|
|
}
|
|
else
|
|
{
|
|
_n2.edges.Add(new Edge(_n1, _time, _distance, _currentWay.GetId()));
|
|
}
|
|
_distance = 0;
|
|
logger?.Log(LogLevel.VERBOSE, "Add Edge: {0} & {1} Weight: {2}", _currentWay.nodeIds[_nodeIdIndex], _currentWay.nodeIds[_nodeIdIndex + 1], _time);
|
|
}
|
|
else
|
|
{
|
|
_graph.RemoveNode(_currentWay.nodeIds[_nodeIdIndex]); //Not a junction
|
|
}
|
|
_currentNode = _n2;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
_reader.Close();
|
|
GC.Collect();
|
|
return _graph;
|
|
}
|
|
|
|
internal struct Way
|
|
{
|
|
public List<ulong> nodeIds;
|
|
private Dictionary<string, object> tags;
|
|
|
|
|
|
public Dictionary<type, int> speed = new() {
|
|
{ type.NONE, 1 },
|
|
{ type.motorway, 130 },
|
|
{ type.trunk, 125 },
|
|
{ type.primary, 110 },
|
|
{ type.secondary, 100 },
|
|
{ type.tertiary, 90 },
|
|
{ type.unclassified, 40 },
|
|
{ type.residential, 20 },
|
|
{ type.motorway_link, 50 },
|
|
{ type.trunk_link, 50 },
|
|
{ type.primary_link, 30 },
|
|
{ type.secondary_link, 25 },
|
|
{ type.tertiary_link, 25 },
|
|
{ type.living_street, 20 },
|
|
{ type.service, 10 },
|
|
{ type.pedestrian, 10 },
|
|
{ type.track, 1 },
|
|
{ type.bus_guideway, 5 },
|
|
{ type.escape, 1 },
|
|
{ type.raceway, 1 },
|
|
{ type.road, 25 },
|
|
{ type.busway, 5 },
|
|
{ type.footway, 1 },
|
|
{ type.bridleway, 1 },
|
|
{ type.steps, 1 },
|
|
{ type.corridor, 1 },
|
|
{ type.path, 10 },
|
|
{ type.cycleway, 5 },
|
|
{ type.construction, 1 }
|
|
};
|
|
public enum type { NONE, motorway, trunk, primary, secondary, tertiary, unclassified, residential, motorway_link, trunk_link, primary_link, secondary_link, tertiary_link, living_street, service, pedestrian, track, bus_guideway, escape, raceway, road, busway, footway, bridleway, steps, corridor, path, cycleway, construction }
|
|
|
|
|
|
public Way()
|
|
{
|
|
this.nodeIds = new List<ulong>();
|
|
this.tags = new();
|
|
}
|
|
public void AddTag(string key, string value, Logger? logger = null)
|
|
{
|
|
switch (key)
|
|
{
|
|
case "highway":
|
|
try
|
|
{
|
|
this.tags.Add(key, (type)Enum.Parse(typeof(type), value, true));
|
|
if (this.GetMaxSpeed().Equals((int)type.NONE))
|
|
{
|
|
this.tags["maxspeed"] = (int)this.GetHighwayType();
|
|
}
|
|
}
|
|
catch (ArgumentException)
|
|
{
|
|
this.tags.Add(key, type.NONE);
|
|
}
|
|
break;
|
|
case "maxspeed":
|
|
try
|
|
{
|
|
if (this.tags.ContainsKey("maxspeed"))
|
|
this.tags["maxspeed"] = Convert.ToInt32(value);
|
|
else
|
|
this.tags.Add(key, Convert.ToInt32(value));
|
|
}
|
|
catch (FormatException)
|
|
{
|
|
this.tags.Add(key, (int)this.GetHighwayType());
|
|
}
|
|
break;
|
|
case "oneway":
|
|
switch (value)
|
|
{
|
|
case "yes":
|
|
this.tags.Add(key, true);
|
|
break;
|
|
case "-1":
|
|
this.tags.Add("forward", false);
|
|
break;
|
|
case "no":
|
|
this.tags.Add(key, false);
|
|
break;
|
|
}
|
|
break;
|
|
case "id":
|
|
this.tags.Add(key, Convert.ToUInt64(value));
|
|
break;
|
|
default:
|
|
logger?.Log(LogLevel.VERBOSE, "Tag {0} - {1} was not added.", key, value);
|
|
break;
|
|
}
|
|
}
|
|
|
|
public ulong GetId()
|
|
{
|
|
return this.tags.ContainsKey("id") ? (ulong)this.tags["id"] : 0;
|
|
}
|
|
|
|
public type GetHighwayType()
|
|
{
|
|
return this.tags.ContainsKey("highway") ? (type)this.tags["highway"] : type.NONE;
|
|
}
|
|
|
|
public bool IsOneWay()
|
|
{
|
|
return this.tags.ContainsKey("oneway") ? (bool)this.tags["oneway"] : false;
|
|
}
|
|
|
|
public int GetMaxSpeed()
|
|
{
|
|
return this.tags.ContainsKey("maxspeed") ? (int)this.tags["maxspeed"] : (int)this.GetHighwayType();
|
|
|
|
}
|
|
|
|
public bool IsForward()
|
|
{
|
|
return this.tags.ContainsKey("forward") ? (bool)this.tags["forward"] : true;
|
|
}
|
|
}
|
|
}
|
|
}
|