altosui: keep sitemap more centred on rocket
[fw/altos] / ao-tools / altosui / AltosSiteMap.java
index 2c5420619eda46a36ae29a1b91eda1a7a371c047..8097060508989859c30ba1ee23efdfc76f549bb0 100644 (file)
@@ -36,10 +36,12 @@ public class AltosSiteMap extends JScrollPane implements AltosFlightDisplay {
        // preferred vertical step in a tile in naut. miles
        // will actually choose a step size between x and 2x, where this
        // is 1.5x
-       static final double tile_size_nmi = 1.5;
+       static final double tile_size_nmi = 0.75;
 
        static final int px_size = 512;
 
+       static final int MAX_TILE_DELTA = 100;
+
        private static Point2D.Double translatePoint(Point2D.Double p,
                        Point2D.Double d)
        {
@@ -106,8 +108,18 @@ public class AltosSiteMap extends JScrollPane implements AltosFlightDisplay {
                return latlng(pt, scale_x, scale_y);
        }
 
-       AltosSiteMapTile [] mapTiles = new AltosSiteMapTile[9];
-       Point2D.Double [] tileOffset = new Point2D.Double[9];
+       HashMap<Point,AltosSiteMapTile> mapTiles = new HashMap<Point,AltosSiteMapTile>();
+       Point2D.Double centre;
+
+       private Point2D.Double tileCoordOffset(Point p) {
+               return new Point2D.Double(centre.x - p.x*px_size,
+                                         centre.y - p.y * px_size);
+       }
+
+       private Point tileOffset(Point2D.Double p) {
+               return new Point((int)Math.floor((centre.x+p.x)/px_size),
+                                (int)Math.floor((centre.y+p.y)/px_size));
+       }
 
        private Point2D.Double getBaseLocation(double lat, double lng) {
                Point2D.Double locn, north_step;
@@ -132,15 +144,16 @@ public class AltosSiteMap extends JScrollPane implements AltosFlightDisplay {
                // nothing
        }
 
-       private void bgLoadMap(final int i,
+       private void bgLoadMap(final AltosSiteMapTile tile,
                               final File pngfile, final String pngurl)
        {
+               //System.out.printf("Loading/fetching map %s\n", pngfile);
                Thread thread = new Thread() {
                        public void run() {
                                ImageIcon res;
                                res = AltosSiteMapCache.fetchAndLoadMap(pngfile, pngurl);
                                if (res != null) {
-                                       mapTiles[i].loadMap(res);
+                                       tile.loadMap(res);
                                } else {
                                        System.out.printf("# Failed to fetch file %s\n", pngfile);
                                        System.out.printf(" wget -O '%s' ''\n", pngfile, pngurl);
@@ -154,15 +167,16 @@ public class AltosSiteMap extends JScrollPane implements AltosFlightDisplay {
                AltosPreferences.init(null);
 
                AltosSiteMap asm = new AltosSiteMap(true);
-               Point2D.Double c = asm.getBaseLocation(lat, lng);
+               asm.centre = asm.getBaseLocation(lat, lng);
+
                Point2D.Double p = new Point2D.Double();
                Point2D.Double p2;
                int dx = -w/2, dy = -h/2;
                for (int y = dy; y < h+dy; y++) {
                        for (int x = dx; x < w+dx; x++) {
                                LatLng map_latlng = asm.latlng(
-                                                           -c.x + x*px_size + px_size/2,
-                                                           -c.y + y*px_size + px_size/2);
+                                                           -asm.centre.x + x*px_size + px_size/2,
+                                                           -asm.centre.y + y*px_size + px_size/2);
                                File pngfile = asm.MapFile(map_latlng.lat, map_latlng.lng);
                                String pngurl = asm.MapURL(map_latlng.lat, map_latlng.lng);
                                if (pngfile.exists()) {
@@ -177,22 +191,21 @@ public class AltosSiteMap extends JScrollPane implements AltosFlightDisplay {
                }
        }
 
-       private void initMaps(double lat, double lng) {
-               Point2D.Double c = getBaseLocation(lat, lng);
-               Point2D.Double p = new Point2D.Double();
+       private void initMap(AltosSiteMapTile tile, Point offset) {
+               Point2D.Double coord = tileCoordOffset(offset);
 
-               for (int i = 0; i < 9; i++) {
-                       int x = i%3 - 1, y = i/3 - 1;
+               LatLng map_latlng = latlng(px_size/2-coord.x, px_size/2-coord.y);
 
-                       tileOffset[i] = new Point2D.Double(
-                               c.x - x*px_size, p.y = c.y - y*px_size);
-                       LatLng map_latlng = latlng(
-                                                   -tileOffset[i].x+px_size/2,
-                                                   -tileOffset[i].y+px_size/2);
+               File pngfile = MapFile(map_latlng.lat, map_latlng.lng);
+               String pngurl = MapURL(map_latlng.lat, map_latlng.lng);
+               bgLoadMap(tile, pngfile, pngurl);
+       }
+
+       private void initMaps(double lat, double lng) {
+               centre = getBaseLocation(lat, lng);
 
-                       File pngfile = MapFile(map_latlng.lat, map_latlng.lng);
-                       String pngurl = MapURL(map_latlng.lat, map_latlng.lng);
-                       bgLoadMap(i, pngfile, pngurl);
+               for (Point k : mapTiles.keySet()) {
+                       initMap(mapTiles.get(k), k);
                }
        }
 
@@ -211,13 +224,15 @@ public class AltosSiteMap extends JScrollPane implements AltosFlightDisplay {
        }
 
        boolean initialised = false;
-       public void show(AltosState state, int crc_errors) {
+       Point2D.Double last_pt = null;
+       int last_state = -1;
+       public void show(final AltosState state, final int crc_errors) {
                // if insufficient gps data, nothing to update
                if (state.gps == null)
                        return;
+               if (state.pad_lat == 0 && state.pad_lon == 0)
+                       return;
                if (!state.gps.locked) {
-                       if (state.pad_lat == 0 && state.pad_lon == 0)
-                               return;
                        if (state.gps.nsat < 4)
                                return;
                }
@@ -227,44 +242,145 @@ public class AltosSiteMap extends JScrollPane implements AltosFlightDisplay {
                        initialised = true;
                }
 
-               Point2D.Double pt = pt(state.gps.lat, state.gps.lon);
-               for (int x = 0; x < mapTiles.length; x++) {
-                       mapTiles[x].show(state, crc_errors,
-                                        translatePoint(pt, tileOffset[x]));
+               final Point2D.Double pt = pt(state.gps.lat, state.gps.lon);
+               if (last_pt == pt && last_state == state.state)
+                       return;
+
+               if (last_pt == null) {
+                       last_pt = pt;
+               }
+               boolean in_any = false;
+               for (Point offset : mapTiles.keySet()) {
+                       AltosSiteMapTile tile = mapTiles.get(offset);
+                       Point2D.Double ref, lref;
+                       ref = translatePoint(pt, tileCoordOffset(offset));
+                       lref = translatePoint(last_pt, tileCoordOffset(offset));
+                       tile.show(state, crc_errors, lref, ref);
+                       if (0 <= ref.x && ref.x < px_size)
+                               if (0 <= ref.y && ref.y < px_size)
+                                       in_any = true;
                }
-       }
 
-       private AltosSiteMap(boolean knowWhatYouAreDoing) {
-               if (!knowWhatYouAreDoing) {
-                       throw new RuntimeException("Arggh.");
+               Point offset = tileOffset(pt);
+               if (!in_any) {
+                       Point2D.Double ref, lref;
+                       ref = translatePoint(pt, tileCoordOffset(offset));
+                       lref = translatePoint(last_pt, tileCoordOffset(offset));
+
+                       AltosSiteMapTile tile = createTile(offset);
+                       tile.show(state, crc_errors, lref, ref);
+                       initMap(tile, offset);
+                       finishTileLater(tile, offset);
+               }
+
+               scrollRocketToVisible(pt);
+
+               if (offset != tileOffset(last_pt)) {
+                       ensureTilesAround(offset);
                }
+
+               last_pt = pt;
+               last_state = state.state;
        }
 
-       public AltosSiteMap() {
-               JComponent comp = new JComponent() {
-                       GrabNDrag scroller = new GrabNDrag(this);
-                       {
-                               addMouseMotionListener(scroller);
-                               addMouseListener(scroller);
-                               setAutoscrolls(true);
+       private AltosSiteMapTile createTile(Point offset) {
+               AltosSiteMapTile tile = new AltosSiteMapTile(px_size);
+               mapTiles.put(offset, tile);
+               return tile;
+       }
+       private void finishTileLater(final AltosSiteMapTile tile,
+                                    final Point offset)
+       {
+               SwingUtilities.invokeLater( new Runnable() {
+                       public void run() {
+                               addTileAt(tile, offset);
                        }
-               };
+               } );
+       }
 
-               GridBagLayout layout = new GridBagLayout();
-               comp.setLayout(layout);
+       private void ensureTilesAround(Point base_offset) {
+               for (int x = -1; x <= 1; x++) {
+                       for (int y = -1; y <= 1; y++) {
+                               Point offset = new Point(base_offset.x + x, base_offset.y + y);
+                               if (mapTiles.containsKey(offset))
+                                       continue;
+                               AltosSiteMapTile tile = createTile(offset);
+                               initMap(tile, offset);
+                               finishTileLater(tile, offset);
+                       }
+               }
+       }
 
+       private Point topleft = new Point(0,0);
+       private void scrollRocketToVisible(Point2D.Double pt) {
+               Rectangle r = comp.getVisibleRect();
+               Point2D.Double copt = translatePoint(pt, tileCoordOffset(topleft));
+               int dx = (int)copt.x - r.width/2 - r.x;
+               int dy = (int)copt.y - r.height/2 - r.y;
+               if (Math.abs(dx) > r.width/4 || Math.abs(dy) > r.height/4) {
+                       r.x += dx;
+                       r.y += dy;
+                       comp.scrollRectToVisible(r);
+               }
+       }
+
+       private void addTileAt(AltosSiteMapTile tile, Point offset) {
+               if (Math.abs(offset.x) >= MAX_TILE_DELTA ||
+                               Math.abs(offset.y) >= MAX_TILE_DELTA)
+               {
+                       System.out.printf("Rocket too far away from pad (tile %d,%d)\n",
+                                         offset.x, offset.y);
+                       return;
+               }
+
+               boolean review = false;
+               Rectangle r = comp.getVisibleRect();
+               if (offset.x < topleft.x) {
+                       r.x += (topleft.x - offset.x) * px_size;
+                       topleft.x = offset.x;
+                       review = true;
+               }
+               if (offset.y < topleft.y) {
+                       r.y += (topleft.y - offset.y) * px_size;
+                       topleft.y = offset.y;
+                       review = true;
+               }
                GridBagConstraints c = new GridBagConstraints();
                c.anchor = GridBagConstraints.CENTER;
                c.fill = GridBagConstraints.BOTH;
-
                // put some space between the map tiles, debugging only
                // c.insets = new Insets(5, 5, 5, 5);
-               for (int x = 0; x < 9; x++) {
-                       c.gridx = x % 3;
-                       c.gridy = x / 3;
-                       mapTiles[x] = new AltosSiteMapTile(px_size);
-                       layout.setConstraints(mapTiles[x], c);
-                       comp.add(mapTiles[x]);
+
+               c.gridx = offset.x + MAX_TILE_DELTA;
+               c.gridy = offset.y + MAX_TILE_DELTA;
+               layout.setConstraints(tile, c);
+
+               comp.add(tile);
+               if (review) {
+                       comp.scrollRectToVisible(r);
+               }
+       }
+
+       private AltosSiteMap(boolean knowWhatYouAreDoing) {
+               if (!knowWhatYouAreDoing) {
+                       throw new RuntimeException("Arggh.");
+               }
+       }
+
+       JComponent comp = new JComponent() { };
+       private GridBagLayout layout = new GridBagLayout();
+
+       public AltosSiteMap() {
+               GrabNDrag scroller = new GrabNDrag(comp);
+
+               comp.setLayout(layout);
+
+               for (int x = -1; x <= 1; x++) {
+                       for (int y = -1; y <= 1; y++) {
+                               Point offset = new Point(x, y);
+                               AltosSiteMapTile t = createTile(offset);
+                               addTileAt(t, offset);
+                       }
                }
                setViewportView(comp);
                setPreferredSize(new Dimension(500,200));