1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
|
/*
* Copyright © 2010 Keith Packard <keithp@keithp.com>
*
* 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.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
*/
package org.altusmetrum.altoslib_11;
import java.lang.Math;
import java.io.*;
public class AltosGreatCircle implements Cloneable, AltosHashable {
public double distance;
public double bearing;
public double range;
public double elevation;
double sqr(double a) { return a * a; }
public static final double rad = Math.PI / 180;
public static final double earth_radius = 6371.2 * 1000; /* in meters */
public static final int BEARING_LONG = AltosConvert.BEARING_LONG;
public static final int BEARING_SHORT = AltosConvert.BEARING_SHORT;
public static final int BEARING_VOICE = AltosConvert.BEARING_VOICE;
public String bearing_words(int length) {
return AltosConvert.bearing_to_words(length, bearing);
}
public AltosGreatCircle (double start_lat, double start_lon, double start_alt,
double end_lat, double end_lon, double end_alt) {
double lat1 = rad * start_lat;
double lon1 = rad * -start_lon;
double lat2 = rad * end_lat;
double lon2 = rad * -end_lon;
double d_lon = lon2 - lon1;
/* From http://en.wikipedia.org/wiki/Great-circle_distance */
double vdn = Math.sqrt(sqr(Math.cos(lat2) * Math.sin(d_lon)) +
sqr(Math.cos(lat1) * Math.sin(lat2) -
Math.sin(lat1) * Math.cos(lat2) * Math.cos(d_lon)));
double vdd = Math.sin(lat1) * Math.sin(lat2) + Math.cos(lat1) * Math.cos(lat2) * Math.cos(d_lon);
double d = Math.atan2(vdn,vdd);
double course;
if (Math.cos(lat1) < 1e-20) {
if (lat1 > 0)
course = Math.PI;
else
course = -Math.PI;
} else {
if (d < 1e-10)
course = 0;
else
course = Math.acos((Math.sin(lat2)-Math.sin(lat1)*Math.cos(d)) /
(Math.sin(d)*Math.cos(lat1)));
if (Math.sin(lon2-lon1) > 0)
course = 2 * Math.PI-course;
}
distance = d * earth_radius;
bearing = course * 180/Math.PI;
double height_diff = end_alt - start_alt;
range = Math.sqrt(distance * distance + height_diff * height_diff);
elevation = Math.atan2(height_diff, distance) * 180 / Math.PI;
}
public AltosGreatCircle clone() {
AltosGreatCircle n = new AltosGreatCircle();
n.distance = distance;
n.bearing = bearing;
n.range = range;
n.elevation = elevation;
return n;
}
public AltosGreatCircle (double start_lat, double start_lon,
double end_lat, double end_lon) {
this(start_lat, start_lon, 0, end_lat, end_lon, 0);
}
public AltosGreatCircle(AltosGPS start, AltosGPS end) {
this(start.lat, start.lon, start.alt, end.lat, end.lon, end.alt);
}
public AltosGreatCircle() {
distance = 0;
bearing = 0;
range = 0;
elevation = 0;
}
public AltosHashSet hashSet() {
AltosHashSet h = new AltosHashSet();
h.putDouble("distance", distance);
h.putDouble("bearing", bearing);
h.putDouble("range", range);
h.putDouble("elevation", elevation);
return h;
}
public AltosGreatCircle(AltosHashSet h) {
this();
distance = h.getDouble("distance", distance);
bearing = h.getDouble("bearing", bearing);
range = h.getDouble("range", range);
elevation = h.getDouble("elevation", elevation);
}
public static AltosGreatCircle fromHashSet(AltosHashSet h, AltosGreatCircle def) {
if (h == null)
return def;
return new AltosGreatCircle(h);
}
}
|
