public void TestGpgsa() { string input = "$GPGSA,M,2,19,28,14,18,27,22,31,39,40,42,43,44,1.7,1.0,1.3*3C"; var msg = NmeaMessage.Parse(input); Assert.IsInstanceOfType(msg, typeof(Gsa)); Gsa gsa = (Gsa)msg; Assert.AreEqual(Gsa.ModeSelection.Manual, gsa.GpsMode); Assert.AreEqual(Gsa.Mode.Fix2D, gsa.FixMode); Assert.AreEqual(12, gsa.SVs.Count); Assert.AreEqual(19, gsa.SVs[0]); Assert.AreEqual(28, gsa.SVs[1]); Assert.AreEqual(14, gsa.SVs[2]); Assert.AreEqual(18, gsa.SVs[3]); Assert.AreEqual(27, gsa.SVs[4]); Assert.AreEqual(22, gsa.SVs[5]); Assert.AreEqual(31, gsa.SVs[6]); Assert.AreEqual(39, gsa.SVs[7]); Assert.AreEqual(40, gsa.SVs[8]); Assert.AreEqual(42, gsa.SVs[9]); Assert.AreEqual(43, gsa.SVs[10]); Assert.AreEqual(44, gsa.SVs[11]); Assert.AreEqual(1.7, gsa.Pdop); Assert.AreEqual(1.0, gsa.Hdop); Assert.AreEqual(1.3, gsa.Vdop); }
public void TestGpgsa_Empty() { string input = "$GPGSA,A,3,,,,,,16,18,,22,24,,,,,*14"; var msg = NmeaMessage.Parse(input); Assert.IsInstanceOfType(msg, typeof(Gsa)); Gsa gsa = (Gsa)msg; Assert.AreEqual(Gsa.ModeSelection.Auto, gsa.GpsMode); Assert.AreEqual(Gsa.Mode.Fix3D, gsa.FixMode); Assert.AreEqual(4, gsa.SVs.Count); Assert.AreEqual(16, gsa.SVs[0]); Assert.AreEqual(18, gsa.SVs[1]); Assert.AreEqual(22, gsa.SVs[2]); Assert.AreEqual(24, gsa.SVs[3]); Assert.AreEqual(double.NaN, gsa.Pdop); Assert.AreEqual(double.NaN, gsa.Hdop); Assert.AreEqual(double.NaN, gsa.Vdop); }
public void TestGngsa() { string input = "$GNGSA,A,3,3,7,16,23,9,26,,,,,,,3.5,1.4,3.2*11"; var msg = NmeaMessage.Parse(input); Assert.IsInstanceOfType(msg, typeof(Gsa)); Assert.AreEqual("GNGSA", msg.MessageType); Gsa gsa = (Gsa)msg; Assert.AreEqual(Gsa.ModeSelection.Auto, gsa.GpsMode); Assert.AreEqual(Gsa.Mode.Fix3D, gsa.FixMode); Assert.AreEqual(6, gsa.SVs.Count); Assert.AreEqual(3, gsa.SVs[0]); Assert.AreEqual(7, gsa.SVs[1]); Assert.AreEqual(16, gsa.SVs[2]); Assert.AreEqual(23, gsa.SVs[3]); Assert.AreEqual(9, gsa.SVs[4]); Assert.AreEqual(26, gsa.SVs[5]); Assert.AreEqual(3.5, gsa.Pdop); Assert.AreEqual(1.4, gsa.Hdop); Assert.AreEqual(3.2, gsa.Vdop); }
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}"); }); }