6f5ddede5770f8e5e2b9b86916bbab2a3e6a0bca
[fw/altos] / ao-tools / altosui / AltosSiteMapTile.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 AltosSiteMapTile extends JLabel {
35     int zoom;
36     double scale_x, scale_y;
37     Point2D.Double coord_pt;
38     Point2D.Double last_pt;
39
40     Graphics2D g2d;
41
42     int off_x;
43     int off_y;
44
45     int px_size = 512;
46
47     private boolean setLocation(double lat, double lng) {
48         Point2D.Double north_1nm;
49         for (zoom = 3; zoom < 22; zoom++) {
50             coord_pt = pt(lat, lng, new Point2D.Double(0,0), zoom);
51             north_1nm = pt(lat+1/60.0, lng, new Point2D.Double(0,0), zoom);
52             if (coord_pt.y - north_1nm.y > px_size/2)
53                 break;
54         }
55         coord_pt.x = -px_size * Math.floor(coord_pt.x/px_size + off_x);
56         coord_pt.y = -px_size * Math.floor(coord_pt.y/px_size + off_y);
57
58         scale_x = 256/360.0 * Math.pow(2, zoom);
59         scale_y = 256/(2.0*Math.PI) * Math.pow(2, zoom);
60
61         last_pt = null;
62
63         Point2D.Double map_latlng;
64         map_latlng = latlng(new Point2D.Double(px_size/2, px_size/2));
65
66         BufferedImage myPicture;
67         File pngfile = new File(AltosPreferences.logdir(), 
68                                 FileCoord(map_latlng, zoom));
69         try {
70             myPicture = ImageIO.read(pngfile);
71             System.out.printf("# Found file %s\n", pngfile);
72         } catch (Exception e) { 
73             // throw new RuntimeException(e);
74             System.out.printf("# Failed to find file %s\n", pngfile);
75             System.out.printf(" wget -O '%s' 'http://maps.google.com/maps/api/staticmap?center=%.6f,%.6f&zoom=%d&size=%dx%d&sensor=false&maptype=hybrid&format=png32'\n", pngfile, map_latlng.x, map_latlng.y, zoom, px_size, px_size);
76             myPicture = new BufferedImage(px_size, px_size, 
77                     BufferedImage.TYPE_INT_RGB);
78         }
79         setIcon(new ImageIcon( myPicture ));
80         g2d = myPicture.createGraphics();
81         return true;
82     }
83
84     private static double limit(double v, double lo, double hi) {
85         if (v < lo)
86             return lo;
87         if (hi < v)
88             return hi;
89         return v;
90     }
91
92     private static String FileCoord(Point2D.Double latlng, int zoom) {
93         double lat, lng;
94         lat = latlng.x;
95         lng = latlng.y;
96         return FileCoord(lat, lng, zoom);
97     }
98     private static String FileCoord(double lat, double lng, int zoom) {
99         char chlat = lat < 0 ? 'S' : 'N';
100         char chlng = lng < 0 ? 'E' : 'W';
101         if (lat < 0) lat = -lat;
102         if (lng < 0) lng = -lng;
103         return String.format("map-%c%.6f,%c%.6f-%d.png",
104                 chlat, lat, chlng, lng, zoom);
105     }
106
107
108     // based on google js
109     //  http://maps.gstatic.com/intl/en_us/mapfiles/api-3/2/10/main.js
110     // search for fromLatLngToPoint and fromPointToLatLng
111     private Point2D.Double pt(double lat, double lng) {
112         return pt(lat, lng, coord_pt, scale_x, scale_y);
113     }
114
115     private static Point2D.Double pt(double lat, double lng, 
116             Point2D.Double centre, int zoom)
117     {
118         double scale_x = 256/360.0 * Math.pow(2, zoom);
119         double scale_y = 256/(2.0*Math.PI) * Math.pow(2, zoom);
120         return pt(lat, lng, centre, scale_x, scale_y);
121     }
122
123     private static Point2D.Double pt(double lat, double lng, 
124             Point2D.Double centre, double scale_x, double scale_y)
125     {
126         Point2D.Double res = new Point2D.Double();
127         double e;
128
129         res.x = centre.x + lng*scale_x;
130         e = limit(Math.sin(Math.toRadians(lat)),-(1-1.0E-15),1-1.0E-15);
131         res.y = centre.y + 0.5*Math.log((1+e)/(1-e))*-scale_y;
132         return res;
133     }
134
135     private Point2D.Double latlng(Point2D.Double pt) {
136         return latlng(pt, coord_pt);
137     }
138     private Point2D.Double latlng(Point2D.Double pt, Point2D.Double centre) {
139         double lat, lng;
140         double rads;
141
142         lng = (pt.x - centre.x)/scale_x;
143         rads = 2 * Math.atan(Math.exp((pt.y-centre.y)/-scale_y));
144         lat = Math.toDegrees(rads - Math.PI/2);
145                                                                     
146         return new Point2D.Double(lat,lng);
147     }
148
149     static Color stateColors[] = {
150         Color.WHITE,  // startup
151         Color.WHITE,  // idle
152         Color.WHITE,  // pad
153         Color.RED,    // boost
154         Color.PINK,   // fast
155         Color.YELLOW, // coast
156         Color.CYAN,   // drogue
157         Color.BLUE,   // main
158         Color.BLACK   // landed
159     };
160
161     boolean drawn_landed_circle = false;
162     boolean nomaps = false;
163     public void show(AltosState state, int crc_errors) {
164         if (nomaps)
165             return;
166         if (!state.gps_ready && state.pad_lat == 0 && state.pad_lon == 0)
167             return;
168         double plat = (int)(state.pad_lat*200)/200.0;
169         double plon = (int)(state.pad_lon*200)/200.0;
170
171         if (last_pt == null) {
172             if (!setLocation(plat, plon)) {
173                 nomaps = true;
174                 return;
175             }
176         }
177
178         Point2D.Double pt = pt(state.gps.lat, state.gps.lon);
179         if (last_pt != null && pt != last_pt) {
180             if (0 <= state.state && state.state < stateColors.length) {
181                 g2d.setColor(stateColors[state.state]);
182             }
183             g2d.draw(new Line2D.Double(last_pt, pt));
184         }
185
186         if (state.state == 8 && !drawn_landed_circle) {
187             drawn_landed_circle = true;
188             g2d.setColor(Color.RED);
189             g2d.drawOval((int)pt.x-5, (int)pt.y-5, 10, 10);
190             g2d.drawOval((int)pt.x-20, (int)pt.y-20, 40, 40);
191             g2d.drawOval((int)pt.x-35, (int)pt.y-35, 70, 70);
192         }
193
194         last_pt = pt;
195         repaint();
196     }
197    
198     public AltosSiteMapTile(int x_tile_offset, int y_tile_offset) {
199         off_x = x_tile_offset;
200         off_y = y_tile_offset;
201     }
202 }
203