git.gag.com Git - fw/altos/blob - ao-tools/altosui/AltosSiteMap.java

   1 /*
   2  * Copyright © 2010 Anthony Towns <aj@erisian.com.au>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; version 2 of the License.
   7  *
   8  * This program is distributed in the hope that it will be useful, but
   9  * WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  11  * General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License along
  14  * with this program; if not, write to the Free Software Foundation, Inc.,
  15  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  16  */
  17
  18 package altosui;
  19
  20 import java.awt.*;
  21 import java.awt.image.*;
  22 import java.awt.event.*;
  23 import javax.swing.*;
  24 import javax.imageio.ImageIO;
  25 import javax.swing.table.*;
  26 import java.io.*;
  27 import java.util.*;
  28 import java.text.*;
  29 import java.util.prefs.*;
  30 import java.lang.Math;
  31 import java.awt.geom.Point2D;
  32 import java.awt.geom.Line2D;
  33
  34 public class AltosSiteMap extends JComponent implements AltosFlightDisplay {
  35     double lat, lng;
  36     int zoom;
  37     double scale_x, scale_y;
  38     Point2D.Double coord_pt;
  39     Point2D.Double last_pt;
  40
  41     Graphics2D g2d;
  42
  43     private void setLocation(double new_lat, double new_lng) {
  44         int new_zoom = 15;
  45         lat = new_lat;
  46         lng = new_lng;
  47         zoom = new_zoom;
  48         scale_x = 256/360.0 * Math.pow(2, zoom);
  49         scale_y = 256/(2.0*Math.PI) * Math.pow(2, zoom);
  50         coord_pt = pt(lat, lng, new Point2D.Double(0,0));
  51         coord_pt.x = 320-coord_pt.x;
  52         coord_pt.y = 320-coord_pt.y;
  53         last_pt = null;
  54
  55         try {
  56             File pngfile = new File(AltosPreferences.logdir(),
  57                                     FileCoord(lat, lng, zoom));
  58             System.out.printf("Trying file %s\n", pngfile);
  59             BufferedImage myPicture = ImageIO.read(pngfile);
  60             picLabel.setIcon(new ImageIcon( myPicture ));
  61             g2d = myPicture.createGraphics();
  62         } catch (Exception e) {
  63             throw new RuntimeException(e);
  64         };
  65     }
  66
  67     private static double limit(double v, double lo, double hi) {
  68         if (v < lo)
  69             return lo;
  70         if (hi < v)
  71             return hi;
  72         return v;
  73     }
  74
  75     private static String FileCoord(double lat, double lng, int zoom) {
  76         char chlat = lat < 0 ? 'S' : 'N';
  77         char chlng = lng < 0 ? 'E' : 'W';
  78         if (lat < 0) lat = -lat;
  79         if (lng < 0) lng = -lng;
  80         return String.format("map-%c%.3f,%c%.3f-%d.png",
  81                 chlat, lat, chlng, lng, zoom);
  82     }
  83
  84
  85     // based on google js
  86     //  http://maps.gstatic.com/intl/en_us/mapfiles/api-3/2/10/main.js
  87     // search for fromLatLngToPoint and fromPointToLatLng
  88     private Point2D.Double pt(double lat, double lng) {
  89         return pt(lat, lng, coord_pt);
  90     }
  91
  92     private Point2D.Double pt(double lat, double lng, Point2D.Double centre) {
  93         Point2D.Double res = new Point2D.Double();
  94         double e;
  95
  96         res.x = centre.x + lng*scale_x;
  97         e = limit(Math.sin(Math.toRadians(lat)),-(1-1.0E-15),1-1.0E-15);
  98         res.y = centre.y + 0.5*Math.log((1+e)/(1-e))*-scale_y;
  99         return res;
 100     }
 101
 102
 103     public void reset() {
 104         // ?
 105     }
 106
 107     static Color stateColors[] = {
 108         Color.WHITE,  // startup
 109         Color.WHITE,  // idle
 110         Color.WHITE,  // pad
 111         Color.RED,    // boost
 112         Color.PINK,   // fast
 113         Color.YELLOW, // coast
 114         Color.CYAN,   // drogue
 115         Color.BLUE,   // main
 116         Color.BLACK   // landed
 117     };
 118
 119     public void show(AltosState state, int crc_errors) {
 120         if (!state.gps_ready && state.pad_lat == 0 && state.pad_lon == 0)
 121             return;
 122         double plat = (int)(state.pad_lat*200)/200.0;
 123         double plon = (int)(state.pad_lon*200)/200.0;
 124
 125         if (last_pt == null) {
 126             setLocation(plat, plon);
 127         }
 128
 129         Point2D.Double pt = pt(state.gps.lat, state.gps.lon);
 130         if (last_pt != null && pt != last_pt) {
 131             if (0 <= state.state && state.state < stateColors.length) {
 132                 g2d.setColor(stateColors[state.state]);
 133             }
 134             g2d.draw(new Line2D.Double(last_pt, pt));
 135         }
 136         last_pt = pt;
 137         repaint();
 138     }
 139
 140     JLabel picLabel = new JLabel();
 141
 142     public AltosSiteMap() {
 143         GridBagLayout layout = new GridBagLayout();
 144         setLayout(layout);
 145
 146         GridBagConstraints c = new GridBagConstraints();
 147
 148         c.gridx = 0; c.gridy = 0;
 149         c.weightx = 1; c.weighty = 1;
 150         c.anchor = GridBagConstraints.CENTER;
 151         c.fill = GridBagConstraints.BOTH;
 152         picLabel = new JLabel();
 153         JScrollPane scrollPane = new JScrollPane(picLabel);
 154         layout.setConstraints(scrollPane, c);
 155         add(scrollPane);
 156
 157     }
 158 }
 159