Version 19.1, August 2018

[GpsPrune.git] / tim / prune / data / SpeedCalculator.java

diff --git a/tim/prune/data/SpeedCalculator.java b/tim/prune/data/SpeedCalculator.java
index f6f429c7d477bc13cb29a5a9bb3212e467e99fcf..6f81d5a32187d60b43d0a686deb6e8a3e59571ba 100644 (file)
--- a/tim/prune/data/SpeedCalculator.java
+++ b/tim/prune/data/SpeedCalculator.java
@@ -16,11 +16,15 @@ public abstract class SpeedCalculator
         */
        public static void calculateSpeed(Track inTrack, int inIndex, SpeedValue inValue)
        {
-               if (inTrack == null || inIndex < 0 || inValue == null) {
+               if (inValue != null)
+               {
+                       inValue.setInvalid();
+               }
+               if (inTrack == null || inIndex < 0 || inValue == null)
+               {
                        System.err.println("Cannot calculate speed for index " + inIndex);
                        return;
                }
-               inValue.setInvalid();
 
                DataPoint point = inTrack.getPoint(inIndex);
                if (point == null) {return;}
@@ -49,14 +53,14 @@ public abstract class SpeedCalculator
                                do
                                {
                                        p = inTrack.getPoint(index);
-                                       boolean timeOk = p != null && p.hasTimestamp() && !p.getTimestamp().isAfter(point.getTimestamp());
+                                       boolean timeOk = p != null && p.hasTimestamp() && p.getTimestamp().isBefore(point.getTimestamp());
                                        boolean pValid = timeOk && !p.isWaypoint();
                                        if (pValid) {
                                                totalRadians += DataPoint.calculateRadiansBetween(p, q);
                                                earlyStamp = p.getTimestamp();
                                        }
-                                       stop = (p == null) || (p.hasTimestamp() && !p.getTimestamp().isEqual(point.getTimestamp())
-                                               || p.getSegmentStart());
+
+                                       stop = (p == null) || p.getSegmentStart() || hasSufficientTimeDifference(p, point);
                                        index--;
                                        if (p != null && !p.isWaypoint()) {
                                                q = p;
@@ -77,8 +81,8 @@ public abstract class SpeedCalculator
                                        totalRadians += DataPoint.calculateRadiansBetween(p, q);
                                        lateStamp = p.getTimestamp();
                                }
-                               stop = (p == null) || (p.hasTimestamp() && !p.getTimestamp().isEqual(point.getTimestamp())
-                                       || p.getSegmentStart());
+
+                               stop = (p == null) || p.getSegmentStart() || hasSufficientTimeDifference(point, p);
                                index++;
                                if (p != null && !p.isWaypoint()) {
                                        q = p;
@@ -145,14 +149,14 @@ public abstract class SpeedCalculator
                                do
                                {
                                        p = inTrack.getPoint(index);
-                                       boolean timeOk = p != null && p.hasTimestamp() && !p.getTimestamp().isAfter(point.getTimestamp());
+                                       boolean timeOk = p != null && p.hasTimestamp() && p.getTimestamp().isBefore(point.getTimestamp());
                                        boolean pValid = timeOk && !p.isWaypoint();
                                        if (pValid) {
                                                earlyStamp = p.getTimestamp();
                                                if (p.hasAltitude()) firstAlt = p.getAltitude();
                                        }
-                                       stop = (p == null) || (p.hasTimestamp() && !p.getTimestamp().isEqual(point.getTimestamp())
-                                               || p.getSegmentStart());
+
+                                       stop = (p == null) || p.getSegmentStart() || hasSufficientTimeDifference(p, point);
                                        index--;
                                }
                                while (!stop);
@@ -171,8 +175,8 @@ public abstract class SpeedCalculator
                                        lateStamp = p.getTimestamp();
                                        if (p.hasAltitude()) lastAlt = p.getAltitude();
                                }
-                               stop = (p == null) || (p.hasTimestamp() && !p.getTimestamp().isEqual(point.getTimestamp())
-                                       || p.getSegmentStart());
+
+                               stop = (p == null) || p.getSegmentStart() || hasSufficientTimeDifference(point, p);
                                index++;
                        }
                        while (!stop);
@@ -193,4 +197,20 @@ public abstract class SpeedCalculator
                        inValue.setValue(speedValue);
                }
        }
+
+       /**
+        * Check whether the time difference between P1 and P2 is sufficiently large
+        * @param inP1 earlier point
+        * @param inP2 later point
+        * @return true if we can stop looking now, found a point early/late enough
+        */
+       private static boolean hasSufficientTimeDifference(DataPoint inP1, DataPoint inP2)
+       {
+               if (inP1 == null || inP2 == null)
+                       return true; // we have to give up now
+               if (!inP1.hasTimestamp() || !inP2.hasTimestamp())
+                       return false; // keep looking
+               final long MIN_TIME_DIFFERENCE_MS = 1000L;
+               return inP2.getTimestamp().getMillisecondsSince(inP1.getTimestamp()) >= MIN_TIME_DIFFERENCE_MS;
+       }
 }