private static wptTypeCollection ReadWayPoints( IEnumerable<XElement> elements )
{
elements.RequireArgument<IEnumerable<XElement>>( "elements" ).NotNull<IEnumerable<XElement>>();
wptTypeCollection wpts = new wptTypeCollection();
foreach( XElement element in elements )
{
wpts.Add( ReadWayPoint(element) );
}
return wpts;
}
private void gpx_save_Click(object sender, RoutedEventArgs e)
{
SaveFileDialog saveFileDialog1 = new SaveFileDialog();
saveFileDialog1.Filter = "GPX file|*.gpx";
saveFileDialog1.Title = "Save To GPX File";
saveFileDialog1.ShowDialog();
// If the file name is not an empty string open it for saving.
if (saveFileDialog1.FileName != "")
{
GpxClass track = new GpxClass();
wptTypeCollection trkpt = new wptTypeCollection();
foreach (Location lc in gpx_locations)
{
wptType wpt = new wptType();
wpt.lat = (decimal)lc.Latitude;
wpt.lon = (decimal)lc.Longitude;
wpt.ele = (decimal)lc.Altitude;
wpt.eleSpecified = true;
trkpt.Add(wpt);
}
trksegType trk_seg = new trksegType();
trk_seg.trkpt = trkpt;
trksegTypeCollection trk_seg_cl = new trksegTypeCollection();
trk_seg_cl.Addtrkseg(trk_seg);
trkType trk = new trkType();
trk.name = DateTime.Now.ToString("MM/dd/yyyy h:mm tt");
trk.trkseg = trk_seg_cl;
track.trk = new trkTypeCollection();
track.trk.Add(trk);
track.ToFile(saveFileDialog1.FileName);
System.Windows.Forms.MessageBox.Show("GPX file is saved!");
// back to the teleport mode.
cur_click_mode = e_click_mode.teleport;
gpx_create_button.Content = "Create GPX";
way_points.Text = "";
gpx_locations.Clear();
myMap.Children.Clear();
gpx_save_button.IsEnabled = false;
}
}
public static ESRI.ArcGIS.Client.Geometry.PointCollection LoadTrackSegment( wptTypeCollection trksegs )
{
trksegs.RequireArgument<wptTypeCollection>( "trksegs" ).NotNull<wptTypeCollection>();
ESRI.ArcGIS.Client.Geometry.PointCollection pts = new ESRI.ArcGIS.Client.Geometry.PointCollection();
foreach( var trkseg in trksegs )
{
pts.Add( LoadWayPointGeometry( trkseg ) );
}
return pts;
}
public static GraphicCollection LoadWayPoints( wptTypeCollection wpts )
{
wpts.RequireArgument<wptTypeCollection>( "wpts" ).NotNull<wptTypeCollection>();
GraphicCollection pts = new GraphicCollection();
foreach( var wpt in wpts )
{
Graphic gr = new Graphic();
gr.Geometry = LoadWayPointGeometry( wpt );
LoadWayPointAttributes( wpt, gr.Attributes );
pts.Add( gr );
}
return pts;
}
public static ESRI.ArcGIS.Client.Geometry.Polyline LoadRoute( wptTypeCollection rte )
{
rte.RequireArgument<wptTypeCollection>( "rte" ).NotNull<wptTypeCollection>();
ESRI.ArcGIS.Client.Geometry.PointCollection pts = new ESRI.ArcGIS.Client.Geometry.PointCollection();
foreach( var pt in rte )
{
pts.Add( LoadWayPointGeometry( pt ) );
}
ESRI.ArcGIS.Client.Geometry.Polyline line = new ESRI.ArcGIS.Client.Geometry.Polyline()
{
Paths = new ObservableCollection<ESRI.ArcGIS.Client.Geometry.PointCollection>()
{
pts
}
};
return line;
}
private void LoadWayPoints( wptTypeCollection wpts, GraphicCollection graphics )
{
wpts.RequireArgument<wptTypeCollection>( "wpts" ).NotNull<wptTypeCollection>();
foreach( var wpt in wpts )
{
Graphic gr = new Graphic()
{
Geometry = LoadWayPointGeometry(wpt)
};
LoadWayPointAttributes( wpt, gr.Attributes );
gr.Symbol = Renderer.GetSymbol( gr );
graphics.Add( gr );
}
}
static void Main(string[] args)
{
Logger logger = LogManager.GetCurrentClassLogger();
Parser.Default.ParseArguments <Options>(args)
.WithParsed <Options>(o =>
{
if (!Directory.Exists(o.InputFolder))
{
logger.Error("Input folder does not exist... skipping");
return;
}
if (!Directory.Exists(o.Destination))
{
logger.Info("output folder does not exist, creating");
Directory.CreateDirectory(o.Destination);
}
string[] gpsFiles = Directory.GetFiles(o.InputFolder, "*.gps", SearchOption.AllDirectories);
logger.Info($"found {gpsFiles.Length} files");
DateTime maxSpeedDate = new DateTime();
DateTime currentDate = new DateTime();
DateTime lastDate = new DateTime();
bool dateSet = false;
long maxSpeedKnots = 0;
double longitude = 0;
double latitude = 0;
double alt = 0;
bool latSet = false;
bool longSet = false;
bool altSet = false;
int dayCount = 0;
wptTypeCollection coll = new wptTypeCollection();
string gpxFileLocation = string.Empty;
GpxClass track = new GpxClass();
List <wptType> waypoints = new List <wptType>();
for (int i = 0; i < gpsFiles.Length; i++)
{
string f = gpsFiles[i];
logger.Info($"Parsing {f}");
string[] lines = File.ReadAllLines(f);
logger.Debug($"found {lines.Length} in {f}");
foreach (var readLine in lines)
{
DateTime internalDate = new DateTime();
string message = "";
if (readLine.StartsWith("["))
{
long epoc = Convert.ToInt64(readLine.Split('[', ']')[1]);
message = Regex.Replace(readLine, "\\[.*?\\]", "");
internalDate = UnixEPOCtoDateTime((double)epoc);
if (currentDate.Date != internalDate.Date)
{
logger.Debug($"Date Change. old Date {currentDate} new Date {internalDate}");
currentDate = new DateTime(internalDate.Year, internalDate.Month, internalDate.Day);
}
if (!dateSet)
{
lastDate = currentDate;
dateSet = true;
}
}
if (message.StartsWith("$GPRMC") || message.StartsWith("$GNRMC")) //recomended minimum data for GPS
{
try
{
Rmc rmc = (Rmc)NmeaMessage.Parse(message);
latitude = rmc.Latitude;
longitude = rmc.Longitude;
if ((double)maxSpeedKnots < rmc.Speed)
{
maxSpeedKnots = (long)rmc.Speed;
maxSpeedDate = internalDate;
}
}
catch (Exception ex)
{
logger.Warn($"GPRMC: {ex.Message}");
}
}
else if (message.StartsWith("$GPVTG") || message.StartsWith("$GNVTG")) // vector track and speed over ground
{
try
{
Vtg vtg = (Vtg)NmeaMessage.Parse(message);
if ((double)maxSpeedKnots < vtg.SpeedKnots)
{
maxSpeedKnots = (long)vtg.SpeedKnots;
maxSpeedDate = internalDate;
}
}
catch (Exception ex)
{
logger.Warn($"$GPVTG: {ex.Message}");
}
}
else if (message.StartsWith("$GPGGA") || message.StartsWith("$GNGGA")) // fix information
{
try
{
Gga gga = (Gga)NmeaMessage.Parse(message);
alt = gga.Altitude;
longitude = gga.Longitude;
latitude = gga.Latitude;
latSet = true;
longSet = true;
altSet = true;
}
catch (Exception ex)
{
logger.Warn("GPGGA:" + ex.Message);
}
}
else if (message.StartsWith("$GPGSA") || message.StartsWith("$GNGSA")) //overall satelite data
{
try
{
Gsa gsa = (Gsa)NmeaMessage.Parse(message);
}
catch (Exception ex)
{
logger.Warn("GPGSA:" + ex.Message);
}
}
else if (message.StartsWith("$GPGSV") || message.StartsWith("$GNGSV"))
{
try
{
Gsv gsv = (Gsv)NmeaMessage.Parse(message);
}
catch (Exception ex)
{
logger.Warn("GPGSV:" + ex.Message);
}
}
else if (message.StartsWith("$GPGLL") || message.StartsWith("$GNGLL"))
{
try
{
Gll gll = (Gll)NmeaMessage.Parse(message);
longitude = gll.Longitude;
latitude = gll.Latitude;
latSet = true;
longSet = true;
}
catch (Exception ex)
{
logger.Warn("GPGLL:" + ex.Message);
}
}
if (latSet && longSet && altSet && CheckDouble(longitude) && CheckDouble(latitude) && CheckDouble(alt))
{
waypoints.Add(new wptType(latitude, longitude, alt, internalDate));
latSet = false;
longSet = false;
altSet = false;
if (lastDate.Date != currentDate.Date)
{
coll = new wptTypeCollection();
coll.AddRange(waypoints);
track = new GpxClass();
track.Tracks.Add(new trkType()
{
name = currentDate.ToString(),
trkseg = new trksegTypeCollection().AddItem(
new trksegType()
{
trkpt = coll
})
});
gpxFileLocation = Path.Combine(o.Destination, $"{lastDate.Date.ToString("yyyyMMdd")}.gpx");
track.ToFile(gpxFileLocation);
waypoints = new List <wptType>();
dayCount++;
lastDate = currentDate.Date;
}
}
}
}
coll = new wptTypeCollection();
coll.AddRange(waypoints);
track = new GpxClass();
track.Tracks.Add(new trkType()
{
name = currentDate.ToString(),
trkseg = new trksegTypeCollection().AddItem(
new trksegType()
{
trkpt = coll
})
});
gpxFileLocation = Path.Combine(o.Destination, $"{lastDate.Date.ToString("yyyyMMdd")}.gpx");
track.ToFile(gpxFileLocation);
Console.WriteLine($"Max speed: {maxSpeedKnots * 1.852}KM/h at {maxSpeedDate}");
});
}
