forked from upstream-mirrors/OpenTracks
@@ -33,6 +33,7 @@ import java.util.Optional;
|
||||
* Time is created using the {@link de.dennisguse.opentracks.services.handlers.MonotonicClock}, because system time jump backwards.
|
||||
* GPS time is ignored as for non-GPS events, we could not create timestamps.
|
||||
*/
|
||||
//TODO Should be a record (with final properties)
|
||||
public class TrackPoint {
|
||||
|
||||
private static final Duration MAX_LOCATION_AGE = Duration.ofMinutes(1);
|
||||
|
||||
+16
-40
@@ -2,15 +2,15 @@ package de.dennisguse.opentracks.services.handlers;
|
||||
|
||||
import android.content.Context;
|
||||
import android.location.Location;
|
||||
import android.location.altitude.AltitudeConverter;
|
||||
import android.os.Build;
|
||||
import android.util.Log;
|
||||
|
||||
import androidx.core.location.LocationCompat;
|
||||
import androidx.core.location.altitude.AltitudeConverterCompat;
|
||||
|
||||
import java.io.IOException;
|
||||
|
||||
import de.dennisguse.opentracks.data.models.Altitude;
|
||||
import de.dennisguse.opentracks.data.models.TrackPoint;
|
||||
import de.dennisguse.opentracks.util.EGM2008Utils;
|
||||
|
||||
/**
|
||||
* More infos regarding Android 34's <a href="https://issuetracker.google.com/issues/195660815#comment1">AltitudeConverter</a>.
|
||||
@@ -19,52 +19,28 @@ public class AltitudeCorrectionManager {
|
||||
|
||||
private static final String TAG = AltitudeCorrectionManager.class.getSimpleName();
|
||||
|
||||
private AltitudeConverter altitudeConverter;
|
||||
|
||||
private final EGM2008Internal altitudeConverterFallback;
|
||||
|
||||
public AltitudeCorrectionManager() {
|
||||
this.altitudeConverterFallback = new EGM2008Internal();
|
||||
this.altitudeConverter = Build.VERSION.SDK_INT >= Build.VERSION_CODES.UPSIDE_DOWN_CAKE ? new AltitudeConverter() : null;
|
||||
}
|
||||
|
||||
public void correctAltitude(Context context, TrackPoint trackPoint) {
|
||||
if (!trackPoint.hasLocation() || !trackPoint.hasAltitude()) {
|
||||
return;
|
||||
}
|
||||
if (Build.VERSION.SDK_INT >= Build.VERSION_CODES.UPSIDE_DOWN_CAKE && altitudeConverter != null) {
|
||||
|
||||
// TODO The following is doing IO and should not be done in main thread.
|
||||
// AltitudeConverterCompat uses internally a RoomDatabase that cannot be access from main thread and thus fails on version <= 34.
|
||||
Thread t = new Thread(() -> {
|
||||
try {
|
||||
Location loc = trackPoint.getLocation();
|
||||
altitudeConverter.addMslAltitudeToLocation(context, loc);
|
||||
trackPoint.setAltitude(Altitude.EGM2008.of(loc.getMslAltitudeMeters()));
|
||||
return;
|
||||
AltitudeConverterCompat.addMslAltitudeToLocation(context, loc);
|
||||
trackPoint.setAltitude(Altitude.EGM2008.of(LocationCompat.getMslAltitudeMeters(loc)));
|
||||
} catch (IOException e) {
|
||||
Log.w(TAG, "Android's AltitudeConverter crashed; falling back to internal.");
|
||||
altitudeConverter = null;
|
||||
// Should we fallback
|
||||
Log.w(TAG, "Android's AltitudeConverterCompat failed with " + e.getMessage());
|
||||
}
|
||||
}
|
||||
});
|
||||
t.start();
|
||||
|
||||
altitudeConverterFallback.correctAltitude(context, trackPoint);
|
||||
}
|
||||
|
||||
private static class EGM2008Internal {
|
||||
|
||||
private static final String TAG = EGM2008Internal.class.getSimpleName();
|
||||
|
||||
private EGM2008Utils.EGM2008Correction egm2008Correction;
|
||||
|
||||
public void correctAltitude(Context context, TrackPoint trackPoint) {
|
||||
if (egm2008Correction == null || !egm2008Correction.canCorrect(trackPoint.getLocation())) {
|
||||
try {
|
||||
egm2008Correction = EGM2008Utils.createCorrection(context, trackPoint.getLocation());
|
||||
} catch (IOException e) {
|
||||
Log.e(TAG, "Could not load altitude correction for " + trackPoint, e);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
trackPoint.setAltitude(egm2008Correction.correctAltitude(trackPoint.getLocation()));
|
||||
try {
|
||||
t.join(); // wait for thread to finish
|
||||
} catch (InterruptedException e) {
|
||||
Log.w(TAG, "Android's AltitudeConverterCompat failed with " + e.getMessage());
|
||||
}
|
||||
}
|
||||
}
|
||||
@@ -1,156 +0,0 @@
|
||||
package de.dennisguse.opentracks.util;
|
||||
|
||||
import android.content.Context;
|
||||
import android.location.Location;
|
||||
|
||||
import androidx.annotation.NonNull;
|
||||
import androidx.annotation.VisibleForTesting;
|
||||
|
||||
import java.io.DataInputStream;
|
||||
import java.io.IOException;
|
||||
|
||||
import de.dennisguse.opentracks.R;
|
||||
import de.dennisguse.opentracks.data.models.Altitude;
|
||||
|
||||
/**
|
||||
* Converts WGS84 altitude to EGM2008 (should be close to height above sea level).
|
||||
* <p>
|
||||
* Uses <a href="https://geographiclib.sourceforge.io/">GeographicLib</a>] EGM2008 5minute undulation data.
|
||||
* <a href="https://geographiclib.sourceforge.io/html/geoid.html">...</a>
|
||||
* <p>
|
||||
* File starts at 90N, 0E (North pole) and is encoded in parallel bands as unsigned shorts.
|
||||
*/
|
||||
public class EGM2008Utils {
|
||||
|
||||
static final int EGM2008_5_DATA = R.raw.egm2008_5;
|
||||
|
||||
private static final int HEADER_LENGTH = 404;
|
||||
|
||||
private static final int RESOLUTION_IN_MINUTES = 60 / 5;
|
||||
|
||||
private static final int LATITUDE_CORRECTION = 360 * RESOLUTION_IN_MINUTES;
|
||||
|
||||
private EGM2008Utils() {
|
||||
}
|
||||
|
||||
public static EGM2008Correction createCorrection(Context context, Location location) throws IOException {
|
||||
Indices indices = getIndices(location);
|
||||
|
||||
try (DataInputStream dataInputStream = new DataInputStream(context.getResources().openRawResource(EGM2008_5_DATA))) {
|
||||
return new EGM2008Correction(indices, dataInputStream);
|
||||
}
|
||||
}
|
||||
|
||||
@VisibleForTesting
|
||||
static int getUndulationRaw(DataInputStream dataInputStream, Indices indices) throws IOException {
|
||||
dataInputStream.reset();
|
||||
int absoluteIndex = indices.getAbsoluteIndex();
|
||||
return getUndulationRaw(dataInputStream, absoluteIndex);
|
||||
}
|
||||
|
||||
private static int getUndulationRaw(DataInputStream dataInputStream, int undulationIndex) throws IOException {
|
||||
dataInputStream.reset();
|
||||
int index = HEADER_LENGTH + undulationIndex * 2; //byte size is 2
|
||||
long ignored = dataInputStream.skip(index);
|
||||
|
||||
return dataInputStream.readUnsignedShort();
|
||||
}
|
||||
|
||||
@VisibleForTesting
|
||||
static Indices getIndices(Location location) {
|
||||
double latitude = -location.getLatitude() + 90;
|
||||
int latitudeIndex = (int) (latitude * RESOLUTION_IN_MINUTES);
|
||||
|
||||
double longitude;
|
||||
if (location.getLongitude() >= 0) {
|
||||
longitude = location.getLongitude();
|
||||
} else {
|
||||
longitude = 360 + location.getLongitude();
|
||||
}
|
||||
int longitudeIndex = (int) (longitude * RESOLUTION_IN_MINUTES);
|
||||
|
||||
if (longitudeIndex >= 360 * RESOLUTION_IN_MINUTES) {
|
||||
longitudeIndex = 0;
|
||||
}
|
||||
return new Indices(latitudeIndex, longitudeIndex);
|
||||
}
|
||||
|
||||
public static class EGM2008Correction {
|
||||
|
||||
protected final Indices indices;
|
||||
|
||||
protected final int v00;
|
||||
protected final int v10;
|
||||
protected final int v01;
|
||||
protected final int v11;
|
||||
|
||||
private EGM2008Correction(Indices indices, DataInputStream dataInputStream) throws IOException {
|
||||
this.indices = indices;
|
||||
|
||||
v00 = getUndulationRaw(dataInputStream, indices);
|
||||
if (!isSouthPole()) {
|
||||
v10 = getUndulationRaw(dataInputStream, indices.offset(0, 1));
|
||||
v01 = getUndulationRaw(dataInputStream, indices.offset(1, 0));
|
||||
v11 = getUndulationRaw(dataInputStream, indices.offset(1, 1));
|
||||
} else {
|
||||
v10 = 0;
|
||||
v01 = 0;
|
||||
v11 = 0;
|
||||
}
|
||||
}
|
||||
|
||||
public boolean canCorrect(@NonNull Location location) {
|
||||
return indices.getAbsoluteIndex() == getIndices(location).getAbsoluteIndex();
|
||||
}
|
||||
|
||||
public Altitude.EGM2008 correctAltitude(@NonNull Location location) {
|
||||
if (!canCorrect(location))
|
||||
throw new RuntimeException("Undulation data not loaded for this location.");
|
||||
if (!location.hasAltitude())
|
||||
throw new RuntimeException("Location has no altitude");
|
||||
|
||||
double undulationRaw;
|
||||
if (isSouthPole()) {
|
||||
// No bilinear interpolation on South Pole (not worth the time)
|
||||
undulationRaw = v00;
|
||||
} else {
|
||||
double fLongitude = location.getLongitude() * RESOLUTION_IN_MINUTES -
|
||||
(int) (location.getLongitude() * RESOLUTION_IN_MINUTES);
|
||||
|
||||
double fLatitude = (-location.getLatitude() + 90) * RESOLUTION_IN_MINUTES
|
||||
- (int) ((-location.getLatitude() + 90) * RESOLUTION_IN_MINUTES);
|
||||
|
||||
// Bilinear interpolation (optimized; taken from GeopgrahicLib/Geoid.cpp)
|
||||
double
|
||||
a = (1 - fLongitude) * v00 + fLongitude * v01,
|
||||
b = (1 - fLongitude) * v10 + fLongitude * v11;
|
||||
undulationRaw = (1 - fLatitude) * a + fLatitude * b;
|
||||
}
|
||||
// Bilinear interpolation (not optimized)
|
||||
//undulationRaw = v00 * (1 - fLongitude) * (1 - fLatitude)
|
||||
// + v10 * fLongitude * (1 - fLatitude)
|
||||
// + v01 * (1 - fLongitude) * fLatitude
|
||||
// + v11 * fLongitude * fLatitude;
|
||||
|
||||
double h = 0.003 * undulationRaw - 108;
|
||||
|
||||
return Altitude.EGM2008.of(location.getAltitude() - h);
|
||||
}
|
||||
|
||||
private boolean isSouthPole() {
|
||||
return indices.latitudeIndex == 2160;
|
||||
}
|
||||
}
|
||||
|
||||
@VisibleForTesting
|
||||
record Indices(int latitudeIndex, int longitudeIndex) {
|
||||
|
||||
Indices offset(int latitudeOffset, int longitudeOffset) {
|
||||
return new Indices(latitudeIndex + latitudeOffset, longitudeIndex + longitudeOffset);
|
||||
}
|
||||
|
||||
int getAbsoluteIndex() {
|
||||
return latitudeIndex * LATITUDE_CORRECTION + longitudeIndex;
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user