X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=altoslib%2FAltosMapPath.java;h=67f35f6c367ac1a226e4f2bc19e67adb55028469;hp=6f6db4f4149dbbb6e6e6d0689771d725c25e6d0a;hb=HEAD;hpb=21d176f161b90f18f236ef887cef9676d712eee3 diff --git a/altoslib/AltosMapPath.java b/altoslib/AltosMapPath.java index 6f6db4f4..67f35f6c 100644 --- a/altoslib/AltosMapPath.java +++ b/altoslib/AltosMapPath.java @@ -3,7 +3,8 @@ * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; version 2 of the License. + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of @@ -15,7 +16,7 @@ * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. */ -package org.altusmetrum.altoslib_10; +package org.altusmetrum.altoslib_14; import java.io.*; import java.lang.Math; @@ -31,19 +32,44 @@ public abstract class AltosMapPath { public abstract void paint(AltosMapTransform t); - public AltosMapRectangle add(double lat, double lon, int state) { - AltosMapPathPoint point = new AltosMapPathPoint(new AltosLatLon (lat, lon), state); + public AltosMapRectangle add(AltosGPS gps, double time, int state, double gps_height) { + AltosMapPathPoint point = new AltosMapPathPoint(gps, time, state, gps_height); AltosMapRectangle rect = null; if (!point.equals(last_point)) { if (last_point != null) - rect = new AltosMapRectangle(last_point.lat_lon, point.lat_lon); + rect = new AltosMapRectangle(last_point.gps.lat_lon(), point.gps.lat_lon()); points.add (point); last_point = point; } return rect; } + private double dist(AltosLatLon lat_lon, AltosMapPathPoint point) { + return (new AltosGreatCircle(lat_lon.lat, + lat_lon.lon, + point.gps.lat, + point.gps.lon)).distance; + } + + public AltosMapPathPoint nearest(AltosLatLon lat_lon) { + AltosMapPathPoint nearest = null; + double nearest_dist = 0; + for (AltosMapPathPoint point : points) { + if (nearest == null) { + nearest = point; + nearest_dist = dist(lat_lon, point); + } else { + double d = dist(lat_lon, point); + if (d < nearest_dist) { + nearest = point; + nearest_dist = d; + } + } + } + return nearest; + } + public void clear () { points = new LinkedList(); }