waypoints = new ArrayList<>();
+ protected String pTime;
+ protected String pDate;
+ protected WayPoint pWp;
+
+ protected int success; // number of successfully parsed sentences
+ protected int malformed;
+ protected int checksumErrors;
+ protected int noChecksum;
+ protected int unknown;
+ protected int zeroCoord;
+ }
+
+ /**
+ * Determines if the given address denotes the given NMEA sentence formatter of a known talker.
+ * @param address first tag of an NMEA sentence
+ * @param formatter sentence formatter mnemonic code
+ * @return {@code true} if the {@code address} denotes the given NMEA sentence formatter of a known talker
+ */
+ static boolean isSentence(String address, Sentence formatter) {
+ for (TalkerId talker : TalkerId.values()) {
+ if (address.equals('$' + talker.name() + formatter.name())) {
+ return true;
+ }
+ }
+ return false;
+ }
+
+ // Parses split up sentences into WayPoints which are stored
+ // in the collection in the NMEAParserState object.
+ // Returns true if the input made sense, false otherwise.
+ private boolean parseNMEASentence(String s, NMEAParserState ps) throws IllegalDataException {
+ try {
+ if (s.isEmpty()) {
+ throw new IllegalArgumentException("s is empty");
+ }
+
+ // checksum check:
+ // the bytes between the $ and the * are xored
+ // if there is no * or other meanities it will throw
+ // and result in a malformed packet.
+ String[] chkstrings = s.split("\\*");
+ if (chkstrings.length > 1) {
+ byte[] chb = chkstrings[0].getBytes(StandardCharsets.UTF_8);
+ int chk = 0;
+ for (int i = 1; i < chb.length; i++) {
+ chk ^= chb[i];
+ }
+ if (Integer.parseInt(chkstrings[1].substring(0, 2), 16) != chk) {
+ ps.checksumErrors++;
+ ps.pWp = null;
+ return false;
+ }
+ } else {
+ ps.noChecksum++;
+ }
+ // now for the content
+ String[] e = chkstrings[0].split(",");
+ String accu;
+
+ WayPoint currentwp = ps.pWp;
+ String currentDate = ps.pDate;
+
+ // handle the packet content
+ if (isSentence(e[0], Sentence.GGA)) {
+ // Position
+ LatLon latLon = parseLatLon(
+ e[GGA.LATITUDE_NAME.position],
+ e[GGA.LONGITUDE_NAME.position],
+ e[GGA.LATITUDE.position],
+ e[GGA.LONGITUDE.position]
+ );
+ if (latLon == null) {
+ throw new IllegalDataException("Malformed lat/lon");
+ }
+
+ if (LatLon.ZERO.equals(latLon)) {
+ ps.zeroCoord++;
+ return false;
+ }
+
+ // time
+ accu = e[GGA.TIME.position];
+ Date d = readTime(currentDate+accu);
+
+ if ((ps.pTime == null) || (currentwp == null) || !ps.pTime.equals(accu)) {
+ // this node is newer than the previous, create a new waypoint.
+ // no matter if previous WayPoint was null, we got something better now.
+ ps.pTime = accu;
+ currentwp = new WayPoint(latLon);
+ }
+ if (!currentwp.attr.containsKey("time")) {
+ // As this sentence has no complete time only use it
+ // if there is no time so far
+ currentwp.setTime(d);
+ }
+ // elevation
+ accu = e[GGA.HEIGHT_UNTIS.position];
+ if ("M".equals(accu)) {
+ // Ignore heights that are not in meters for now
+ accu = e[GGA.HEIGHT.position];
+ if (!accu.isEmpty()) {
+ Double.parseDouble(accu);
+ // if it throws it's malformed; this should only happen if the
+ // device sends nonstandard data.
+ if (!accu.isEmpty()) { // FIX ? same check
+ currentwp.put(GpxConstants.PT_ELE, accu);
+ }
+ }
+ }
+ // number of satellites
+ accu = e[GGA.SATELLITE_COUNT.position];
+ int sat = 0;
+ if (!accu.isEmpty()) {
+ sat = Integer.parseInt(accu);
+ currentwp.put(GpxConstants.PT_SAT, accu);
+ }
+ // h-dilution
+ accu = e[GGA.HDOP.position];
+ if (!accu.isEmpty()) {
+ currentwp.put(GpxConstants.PT_HDOP, Float.valueOf(accu));
+ }
+ // fix
+ accu = e[GGA.QUALITY.position];
+ if (!accu.isEmpty()) {
+ int fixtype = Integer.parseInt(accu);
+ switch(fixtype) {
+ case 0:
+ currentwp.put(GpxConstants.PT_FIX, "none");
+ break;
+ case 1:
+ if (sat < 4) {
+ currentwp.put(GpxConstants.PT_FIX, "2d");
+ } else {
+ currentwp.put(GpxConstants.PT_FIX, "3d");
+ }
+ break;
+ case 2:
+ currentwp.put(GpxConstants.PT_FIX, "dgps");
+ break;
+ default:
+ break;
+ }
+ }
+ } else if (isSentence(e[0], Sentence.VTG)) {
+ // COURSE
+ accu = e[VTG.COURSE_REF.position];
+ if ("T".equals(accu)) {
+ // other values than (T)rue are ignored
+ accu = e[VTG.COURSE.position];
+ if (!accu.isEmpty()) {
+ Double.parseDouble(accu);
+ currentwp.put("course", accu);
+ }
+ }
+ // SPEED
+ accu = e[VTG.SPEED_KMH_UNIT.position];
+ if (accu.startsWith("K")) {
+ accu = e[VTG.SPEED_KMH.position];
+ if (!accu.isEmpty()) {
+ double speed = Double.parseDouble(accu);
+ speed /= 3.6; // speed in m/s
+ currentwp.put("speed", Double.toString(speed));
+ }
+ }
+ } else if (isSentence(e[0], Sentence.GSA)) {
+ // vdop
+ accu = e[GSA.VDOP.position];
+ if (!accu.isEmpty() && currentwp != null) {
+ currentwp.put(GpxConstants.PT_VDOP, Float.valueOf(accu));
+ }
+ // hdop
+ accu = e[GSA.HDOP.position];
+ if (!accu.isEmpty() && currentwp != null) {
+ currentwp.put(GpxConstants.PT_HDOP, Float.valueOf(accu));
+ }
+ // pdop
+ accu = e[GSA.PDOP.position];
+ if (!accu.isEmpty() && currentwp != null) {
+ currentwp.put(GpxConstants.PT_PDOP, Float.valueOf(accu));
+ }
+ } else if (isSentence(e[0], Sentence.RMC)) {
+ // coordinates
+ LatLon latLon = parseLatLon(
+ e[RMC.WIDTH_NORTH_NAME.position],
+ e[RMC.LENGTH_EAST_NAME.position],
+ e[RMC.WIDTH_NORTH.position],
+ e[RMC.LENGTH_EAST.position]
+ );
+ if (LatLon.ZERO.equals(latLon)) {
+ ps.zeroCoord++;
+ return false;
+ }
+ // time
+ currentDate = e[RMC.DATE.position];
+ String time = e[RMC.TIME.position];
+
+ Date d = readTime(currentDate+time);
+
+ if (ps.pTime == null || currentwp == null || !ps.pTime.equals(time)) {
+ // this node is newer than the previous, create a new waypoint.
+ ps.pTime = time;
+ currentwp = new WayPoint(latLon);
+ }
+ // time: this sentence has complete time so always use it.
+ currentwp.setTime(d);
+ // speed
+ accu = e[RMC.SPEED.position];
+ if (!accu.isEmpty() && !currentwp.attr.containsKey("speed")) {
+ double speed = Double.parseDouble(accu);
+ speed *= 0.514444444; // to m/s
+ currentwp.put("speed", Double.toString(speed));
+ }
+ // course
+ accu = e[RMC.COURSE.position];
+ if (!accu.isEmpty() && !currentwp.attr.containsKey("course")) {
+ Double.parseDouble(accu);
+ currentwp.put("course", accu);
+ }
+
+ // TODO fix?
+ // * Mode (A = autonom; D = differential; E = estimated; N = not valid; S
+ // * = simulated)
+ // *
+ // * @since NMEA 2.3
+ //
+ //MODE(12);
+ } else {
+ ps.unknown++;
+ return false;
+ }
+ ps.pDate = currentDate;
+ if (ps.pWp != currentwp) {
+ if (ps.pWp != null) {
+ ps.pWp.setTime();
+ }
+ ps.pWp = currentwp;
+ ps.waypoints.add(currentwp);
+ ps.success++;
+ return true;
+ }
+ return true;
+
+ } catch (IllegalArgumentException | IndexOutOfBoundsException | IllegalDataException ex) {
+ // out of bounds and such
+ Main.debug(ex);
+ ps.malformed++;
+ ps.pWp = null;
+ return false;
+ }
+ }
+
+ private static LatLon parseLatLon(String ns, String ew, String dlat, String dlon) {
+ String widthNorth = dlat.trim();
+ String lengthEast = dlon.trim();
+
+ // return a zero latlon instead of null so it is logged as zero coordinate
+ // instead of malformed sentence
+ if (widthNorth.isEmpty() && lengthEast.isEmpty()) return LatLon.ZERO;
+
+ // The format is xxDDLL.LLLL
+ // xx optional whitespace
+ // DD (int) degres
+ // LL.LLLL (double) latidude
+ int latdegsep = widthNorth.indexOf('.') - 2;
+ if (latdegsep < 0) return null;
+
+ int latdeg = Integer.parseInt(widthNorth.substring(0, latdegsep));
+ double latmin = Double.parseDouble(widthNorth.substring(latdegsep));
+ if (latdeg < 0) {
+ latmin *= -1.0;
+ }
+ double lat = latdeg + latmin / 60;
+ if ("S".equals(ns)) {
+ lat = -lat;
+ }
+
+ int londegsep = lengthEast.indexOf('.') - 2;
+ if (londegsep < 0) return null;
+
+ int londeg = Integer.parseInt(lengthEast.substring(0, londegsep));
+ double lonmin = Double.parseDouble(lengthEast.substring(londegsep));
+ if (londeg < 0) {
+ lonmin *= -1.0;
+ }
+ double lon = londeg + lonmin / 60;
+ if ("W".equals(ew)) {
+ lon = -lon;
+ }
+ return new LatLon(lat, lon);
+ }
+}
Index: trunk/src/org/openstreetmap/josm/io/nmea/Sentence.java
===================================================================
--- trunk/src/org/openstreetmap/josm/io/nmea/Sentence.java (revision 12421)
+++ trunk/src/org/openstreetmap/josm/io/nmea/Sentence.java (revision 12421)
@@ -0,0 +1,219 @@
+// License: GPL. For details, see LICENSE file.
+package org.openstreetmap.josm.io.nmea;
+
+/**
+ * An NMEA sentence consists of a start delimiter, followed by a comma-separated sequence of fields,
+ * followed by the character * (ASCII 42), the checksum and an end-of-line marker.
+ * The start delimiter is normally $ (ASCII 36).
+ * Most GPS sensors emit only RMC, GGA, GSA, GSV, GLL, VTG, and (rarely) ZDA.
+ * Newer ones conforming to NMEA 3.x may emit GBS as well.
+ * Other NMEA sentences are usually only emitted by high-end maritime navigation systems.
+ * See NMEA Encoding Conventions
+ * @since 12421
+ */
+public enum Sentence {
+
+ /**
+ * GBS - GPS Satellite Fault Detection
+ *
+ * 1 2 3 4 5 6 7 8 9
+ * | | | | | | | | |
+ * $--GBS,hhmmss.ss,x.x,x.x,x.x,x.x,x.x,x.x,x.x*hh
+ *
+ * Field Number:
+ * - UTC time of the GGA or GNS fix associated with this sentence
+ * - Expected error in latitude (meters)
+ * - Expected error in longitude (meters)
+ * - Expected error in altitude (meters)
+ * - PRN of most likely failed satellite
+ * - Probability of missed detection for most likely failed satellite
+ * - Estimate of bias in meters on most likely failed satellite
+ * - Standard deviation of bias estimate
+ * - Checksum
+ *
+ * See GBS
+ */
+ GBS,
+
+ /**
+ * GGA - Global Positioning System Fix Data
+ *
+ * 11
+ * 1 2 3 4 5 6 7 8 9 10 | 12 13 14 15
+ * | | | | | | | | | | | | | | |
+ * $--GGA,hhmmss.ss,llll.ll,a,yyyyy.yy,a,x,xx,x.x,x.x,M,x.x,M,x.x,xxxx*hh
+ *
+ * Field Number:
+ * - Universal Time Coordinated (UTC)
+ * - Latitude
+ * - N or S (North or South)
+ * - Longitude
+ * - E or W (East or West)
+ * - GPS Quality Indicator,
+ * - 0 - fix not available,
+ * - 1 - GPS fix,
+ * - 2 - Differential GPS fix (values above 2 are 2.3 features)
+ * - 3 = PPS fix
+ * - 4 = Real Time Kinematic
+ * - 5 = Float RTK
+ * - 6 = estimated (dead reckoning)
+ * - 7 = Manual input mode
+ * - 8 = Simulation mode
+ *
+ * - Number of satellites in view, 00 - 12
+ * - Horizontal Dilution of precision (meters)
+ * - Antenna Altitude above/below mean-sea-level (geoid) (in meters)
+ * - Units of antenna altitude, meters
+ * - Geoidal separation, the difference between the WGS-84 earth ellipsoid and mean-sea-level (geoid),
+ * "-" means mean-sea-level below ellipsoid
+ * - Units of geoidal separation, meters
+ * - Age of differential GPS data, time in seconds since last SC104 type 1 or 9 update, null field when DGPS is not used
+ * - Differential reference station ID, 0000-1023
+ * - Checksum
+ *
+ * See GGA
+ */
+ GGA,
+
+ /**
+ * GSA - GPS DOP and active satellites
+ *
+ * 1 2 3 14 15 16 17 18
+ * | | | | | | | |
+ * $--GSA,a,a,x,x,x,x,x,x,x,x,x,x,x,x,x,x,x.x,x.x,x.x*hh
+ *
+ * Field Number:
+ * - Selection mode: M=Manual, forced to operate in 2D or 3D, A=Automatic, 3D/2D
+ * - Mode (1 = no fix, 2 = 2D fix, 3 = 3D fix)
+ * - ID of 1st satellite used for fix
+ * - ID of 2nd satellite used for fix
+ * - ID of 3rd satellite used for fix
+ * - ID of 4th satellite used for fix
+ * - ID of 5th satellite used for fix
+ * - ID of 6th satellite used for fix
+ * - ID of 7th satellite used for fix
+ * - ID of 8th satellite used for fix
+ * - ID of 9th satellite used for fix
+ * - ID of 10th satellite used for fix
+ * - ID of 11th satellite used for fix
+ * - ID of 12th satellite used for fix
+ * - PDOP
+ * - HDOP
+ * - VDOP
+ * - Checksum
+ *
+ * See GSA
+ */
+ GSA,
+
+ /**
+ * GSV - Satellites in view
+ *
+ * 1 2 3 4 5 6 7 n
+ * | | | | | | | |
+ * $--GSV,x,x,x,x,x,x,x,...*hh
+ *
+ * Field Number:
+ * - total number of GSV messages to be transmitted in this group
+ * - 1-origin number of this GSV message within current group
+ * - total number of satellites in view (leading zeros sent)
+ * - satellite PRN number (leading zeros sent)
+ * - elevation in degrees (00-90) (leading zeros sent)
+ * - azimuth in degrees to true north (000-359) (leading zeros sent)
+ * - SNR in dB (00-99) (leading zeros sent) more satellite info quadruples like 4-7 n) checksum
+ *
+ * See GSV
+ */
+ GSV,
+
+ /**
+ * GLL - Geographic Position - Latitude/Longitude
+ *
+ * 1 2 3 4 5 6 7 8
+ * | | | | | | | |
+ * $--GLL,llll.ll,a,yyyyy.yy,a,hhmmss.ss,a,m,*hh
+ *
+ * Field Number:
+ * - Latitude
+ * - N or S (North or South)
+ * - Longitude
+ * - E or W (East or West)
+ * - Universal Time Coordinated (UTC)
+ * - Status A - Data Valid, V - Data Invalid
+ * - FAA mode indicator (NMEA 2.3 and later)
+ * - Checksum
+ *
+ * See GLL
+ */
+ GLL,
+
+ /**
+ * RMC - Recommended Minimum Navigation Information
+ *
+ * 12
+ * 1 2 3 4 5 6 7 8 9 10 11| 13
+ * | | | | | | | | | | | | |
+ * $--RMC,hhmmss.ss,A,llll.ll,a,yyyyy.yy,a,x.x,x.x,xxxx,x.x,a,m,*hh
+ *
+ * Field Number:
+ * - UTC Time
+ * - Status, V=Navigation receiver warning A=Valid
+ * - Latitude
+ * - N or S
+ * - Longitude
+ * - E or W
+ * - Speed over ground, knots
+ * - Track made good, degrees true
+ * - Date, ddmmyy
+ * - Magnetic Variation, degrees
+ * - E or W
+ * - FAA mode indicator (NMEA 2.3 and later)
+ * - Checksum
+ *
+ * See RMC
+ */
+ RMC,
+
+ /**
+ * VTG - Track made good and Ground speed
+ *
+ * 1 2 3 4 5 6 7 8 9 10
+ * | | | | | | | | | |
+ * $--VTG,x.x,T,x.x,M,x.x,N,x.x,K,m,*hh
+ *
+ * Field Number:
+ * - Track Degrees
+ * - T = True
+ * - Track Degrees
+ * - M = Magnetic
+ * - Speed Knots
+ * - N = Knots
+ * - Speed Kilometers Per Hour
+ * - K = Kilometers Per Hour
+ * - FAA mode indicator (NMEA 2.3 and later)
+ * - Checksum
+ *
+ * See VTG
+ */
+ VTG,
+
+ /**
+ * ZDA - Time & Date - UTC, day, month, year and local time zone
+ *
+ * 1 2 3 4 5 6 7
+ * | | | | | | |
+ * $--ZDA,hhmmss.ss,xx,xx,xxxx,xx,xx*hh
+ *
+ * Field Number:
+ * - UTC time (hours, minutes, seconds, may have fractional subsecond)
+ * - Day, 01 to 31
+ * - Month, 01 to 12
+ * - Year (4 digits)
+ * - Local zone description, 00 to +- 13 hours
+ * - Local zone minutes description, apply same sign as local hours
+ * - Checksum
+ *
+ * See ZDA
+ */
+ ZDA
+}
Index: trunk/src/org/openstreetmap/josm/io/nmea/TalkerId.java
===================================================================
--- trunk/src/org/openstreetmap/josm/io/nmea/TalkerId.java (revision 12421)
+++ trunk/src/org/openstreetmap/josm/io/nmea/TalkerId.java (revision 12421)
@@ -0,0 +1,23 @@
+// License: GPL. For details, see LICENSE file.
+package org.openstreetmap.josm.io.nmea;
+
+/**
+ * Talker identifiers mnemonics are the first two characters at the beginning of each sentence.
+ * This enum lists the common ones (navigation systems).
+ * See Talker IDs
+ * @since 12421
+ */
+public enum TalkerId {
+ /** BeiDou (China) */
+ BD,
+ /** Galileo (Europe) */
+ GA,
+ /** BeiDou (China) */
+ GB,
+ /** GLONASS (GLObalnaya NAvigatsionnaya Sputnikovaya Sistema, Russia) */
+ GL,
+ /** GNSS (Global Navigation Satellite System). Generic form when multiple sources are combined. */
+ GN,
+ /** GPS (Global Positioning System) */
+ GP
+}
Index: trunk/src/org/openstreetmap/josm/io/nmea/package-info.java
===================================================================
--- trunk/src/org/openstreetmap/josm/io/nmea/package-info.java (revision 12421)
+++ trunk/src/org/openstreetmap/josm/io/nmea/package-info.java (revision 12421)
@@ -0,0 +1,9 @@
+// License: GPL. For details, see LICENSE file.
+
+/**
+ * Provides the classes for reading NMEA-0183 files.
+ *
+ * See NMEA Revealed.
+ * @since 12421
+ */
+package org.openstreetmap.josm.io.nmea;