public void TestGpgsv_MultiMissing() { var input1 = "$GPGSV,2,1,9,00,30,055,48,00,19,281,00,27,19,275,00,12,16,319,00*4D"; var input2 = "$GPGSV,2,2,8,00,30,055,48,00,19,281,00,27,19,275,00,12,16,319,00*4F"; //Satellite count doesn't match, so append will fail var msg1 = NmeaMessage.Parse(input1); Assert.IsFalse(((IMultiSentenceMessage)msg1).IsComplete); var msg2 = NmeaMessage.Parse(input2, msg1 as IMultiSentenceMessage); Assert.IsFalse(((IMultiSentenceMessage)msg2).IsComplete); Assert.IsInstanceOfType(msg2, typeof(Gsv)); Assert.AreNotSame(msg1, msg2); Gsv gsv1 = (Gsv)msg1; Assert.AreEqual(9, gsv1.SatellitesInView); Assert.IsNotNull(gsv1.SVs); Assert.AreEqual(4, gsv1.SVs.Count); Gsv gsv2 = (Gsv)msg2; Assert.AreEqual(8, gsv2.SatellitesInView); Assert.IsNotNull(gsv2.SVs); Assert.AreEqual(4, gsv2.SVs.Count); }
public void TestGpgsv_Multi() { var input1 = "$GPGSV,3,1,9,00,30,055,48,00,19,281,00,27,19,275,00,12,16,319,00*4C"; var input2 = "$GPGSV,3,2,9,00,30,055,48,00,19,281,00,27,19,275,00,12,16,319,00*4F"; var input3 = "$GPGSV,3,3,9,32,10,037,00,,,,,,,,,,,,*74"; var msg1 = NmeaMessage.Parse(input1); Assert.IsFalse(((IMultiSentenceMessage)msg1).IsComplete); var msg2 = NmeaMessage.Parse(input2, msg1 as IMultiSentenceMessage); Assert.IsFalse(((IMultiSentenceMessage)msg2).IsComplete); var msg3 = NmeaMessage.Parse(input3, msg2 as IMultiSentenceMessage); Assert.IsTrue(((IMultiSentenceMessage)msg3).IsComplete); Assert.IsInstanceOfType(msg1, typeof(Gsv)); Assert.AreSame(msg1, msg2); Assert.AreSame(msg1, msg3); Gsv gsv = (Gsv)msg1; Assert.AreEqual(9, gsv.SatellitesInView); Assert.IsNotNull(gsv.SVs); Assert.AreEqual(9, gsv.SVs.Count); }
public void TestGpgsv_MultiNotMatching() { var input2 = "$GPGSV,3,2,9,00,30,055,48,00,19,281,00,27,19,275,00,12,16,319,00*4F"; var input3 = "$GPGSV,3,3,9,32,10,037,00,,,,,,,,,,,,*74"; var msg2 = NmeaMessage.Parse(input2); Assert.IsFalse(((IMultiSentenceMessage)msg2).IsComplete); var msg3 = NmeaMessage.Parse(input3, msg2 as IMultiSentenceMessage); Assert.IsFalse(((IMultiSentenceMessage)msg3).IsComplete); Assert.IsInstanceOfType(msg2, typeof(Gsv)); Assert.AreNotSame(msg2, msg3); Gsv gsv2 = (Gsv)msg2; Assert.AreEqual(9, gsv2.SatellitesInView); Assert.IsNotNull(gsv2.SVs); Assert.AreEqual(4, gsv2.SVs.Count); Gsv gsv3 = (Gsv)msg3; Assert.AreEqual(9, gsv3.SatellitesInView); Assert.IsNotNull(gsv3.SVs); Assert.AreEqual(1, gsv3.SVs.Count); }
private static GpsData processGpsSentence(string gpsSentence) { if (gpsSentence == null) { return(null); } else { try { var parsedMessage = NmeaMessage.Parse(gpsSentence); if (parsedMessage is Gprmc) { var gprmc = (Gprmc)parsedMessage; var data = new GpsData(); data.speed = gprmc.Speed; data.lat = gprmc.Latitude; data.lon = gprmc.Longitude; data.time = gprmc.FixTime; return(data); } else if (parsedMessage is Gpgga) { return(null); } } catch { return(null); } } return(null); }
public void TestGngns() { string input = "$GNGNS,235719.00,3403.47068778,N,11711.80950154,W,DDNNN,10,1.4,402.411,-32.133,,*26"; var msg = NmeaMessage.Parse(input); Assert.IsInstanceOfType(msg, typeof(Gngns)); Gngns gns = (Gngns)msg; Assert.AreEqual(new TimeSpan(0, 23, 57, 19, 0), gns.FixTime); Assert.AreEqual(34.0578447963333, gns.Latitude, .000000000001); Assert.AreEqual(-117.196825025667, gns.Longitude, .00000000001); Assert.AreEqual(Gns.Mode.Differential, gns.GpsModeIndicator); Assert.AreEqual(Gns.Mode.Differential, gns.GlonassModeIndicator); Assert.AreEqual(3, gns.FutureModeIndicator.Length); Assert.AreEqual(Gns.Mode.NoFix, gns.FutureModeIndicator[0]); Assert.AreEqual(Gns.Mode.NoFix, gns.FutureModeIndicator[1]); Assert.AreEqual(Gns.Mode.NoFix, gns.FutureModeIndicator[2]); Assert.AreEqual(10, gns.NumberOfSatellites); Assert.AreEqual(1.4, gns.Hdop); Assert.AreEqual(402.411, gns.OrhometricHeight); Assert.AreEqual(-32.133, gns.GeoidalSeparation); Assert.AreEqual(TimeSpan.MaxValue, gns.TimeSinceLastDgpsUpdate); Assert.AreEqual(null, gns.DgpsStationId); }
public void TestGngnsModeIndicators() { string input = "$GNGNS,122310.2,3722.425671,N,12258.856215,W,DAAAAA,14,0.9,1005.543,6.5,,,S*0E"; var msg = NmeaMessage.Parse(input); Assert.IsInstanceOfType(msg, typeof(Gns)); Gns gns = (Gns)msg; Assert.AreEqual(Gns.Mode.Differential, gns.GpsModeIndicator); Assert.AreEqual(Gns.Mode.Autonomous, gns.GlonassModeIndicator); Assert.AreEqual(Gns.Mode.Autonomous, gns.GalileoModeIndicator); Assert.AreEqual(Gns.Mode.Autonomous, gns.BDSModeIndicator); Assert.AreEqual(Gns.Mode.Autonomous, gns.QZSSModeIndicator); Assert.AreEqual(Gns.Mode.Autonomous, gns.NavICModeIndicator); Assert.AreEqual(6, gns.ModeIndicators.Length); Assert.AreEqual(Gns.Mode.Differential, gns.ModeIndicators[0]); Assert.AreEqual(Gns.Mode.Autonomous, gns.ModeIndicators[1]); Assert.AreEqual(Gns.Mode.Autonomous, gns.ModeIndicators[2]); Assert.AreEqual(Gns.Mode.Autonomous, gns.ModeIndicators[3]); Assert.AreEqual(Gns.Mode.Autonomous, gns.ModeIndicators[4]); Assert.AreEqual(Gns.Mode.Autonomous, gns.ModeIndicators[5]); Assert.AreEqual(null, gns.DgpsStationId); Assert.AreEqual(Gns.NavigationalStatus.Safe, gns.Status); }
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}"); }); }