remove code that is now in $FG_ROOT/Nasal/geo.nas
This commit is contained in:
mfranz
parent
80913de2e0
commit
3fe72de020
1 changed files with 9 additions and 267 deletions
|
|
@ -26,165 +26,12 @@ controls.flapsDown = func(x) {
|
|||
|
||||
# library stuff -----------------------------------------------------------------------------------
|
||||
|
||||
var EPSILON = 0.0000000000001;
|
||||
var ERAD = 6378138.12; # Earth radius (m)
|
||||
var D2R = math.pi / 180;
|
||||
var R2D = 180 / math.pi;
|
||||
var FT2M = 0.3048;
|
||||
var M2FT = 3.28083989501312335958;
|
||||
|
||||
|
||||
var normdeg = geo.normdeg;
|
||||
var printf = func(_...) { print(call(sprintf, _)) }
|
||||
var floor = func(v) { v < 0.0 ? -int(-v) - 1 : int(v) }
|
||||
var ceil = func(v) { -floor(-v) }
|
||||
var pow = func(v, w) { v < 0 ? nil : v ? math.exp(math.ln(v) * w) : 0 }
|
||||
var pow2 = func(e) { e ? 2 * pow2(e - 1) : 1 }
|
||||
var sin = math.sin;
|
||||
var cos = math.cos;
|
||||
var atan2 = math.atan2;
|
||||
var sqrt = math.sqrt;
|
||||
var asin = func(v) { math.atan2(v, math.sqrt(1 - v * v)) }
|
||||
var acos = func(v) { math.atan2(math.sqrt(1 - v * v), v) }
|
||||
var mod = func(v, w) {
|
||||
var x = v - w * int(v / w);
|
||||
return x < 0 ? x + abs(w) : x;
|
||||
}
|
||||
|
||||
|
||||
# class that maintains one set of geographical coordinates and provides
|
||||
# simple conversion methods that assume a spherical Earth
|
||||
#
|
||||
var Coord = {
|
||||
new : func(copy = nil) {
|
||||
var m = { parents: [Coord] };
|
||||
m._pdirty = 1; # polar
|
||||
m._cdirty = 1; # cartesian
|
||||
m._lon = nil; # in radian
|
||||
m._lat = nil;
|
||||
m._alt = nil; # ASL
|
||||
m._x = nil; # in m
|
||||
m._y = nil;
|
||||
m._z = nil;
|
||||
if (copy != nil) {
|
||||
m.set(copy);
|
||||
}
|
||||
return m;
|
||||
},
|
||||
_cupdate : func {
|
||||
me._cdirty or return;
|
||||
var rad = ERAD + me._alt;
|
||||
var cosphi = cos(me._lat) * rad;
|
||||
me._x = cosphi * cos(me._lon);
|
||||
me._y = cosphi * sin(me._lon);
|
||||
me._z = sin(me._lat) * rad;
|
||||
me._cdirty = 0;
|
||||
},
|
||||
_pupdate : func {
|
||||
me._pdirty or return;
|
||||
me._lat = atan2(me._z, sqrt(me._x * me._x + me._y * me._y));
|
||||
me._lon = atan2(me._y, me._x);
|
||||
me._alt = sqrt(me._x * me._x + me._y * me._y + me._z * me._z) - ERAD;
|
||||
me._pdirty = 0;
|
||||
},
|
||||
|
||||
x : func { me._cupdate(); me._x },
|
||||
y : func { me._cupdate(); me._y },
|
||||
z : func { me._cupdate(); me._z },
|
||||
xyz : func { me._cupdate(); [me._x, me._y, me._z] },
|
||||
|
||||
lon : func { me._pupdate(); me._lon * R2D }, # return in degree
|
||||
lat : func { me._pupdate(); me._lat * R2D },
|
||||
alt : func { me._pupdate(); me._alt },
|
||||
lonlat : func { me._pupdate(); [me._lon, me._lat, me._alt] },
|
||||
|
||||
set_x : func(x) { me._pupdate(); me._pdirty = 1; me._x = x; me },
|
||||
set_y : func(y) { me._pupdate(); me._pdirty = 1; me._y = y; me },
|
||||
set_z : func(z) { me._pupdate(); me._pdirty = 1; me._z = z; me },
|
||||
|
||||
set_lon : func(lon) { me._cupdate(); me._cdirty = 1; me._lon = lon * D2R; me },
|
||||
set_lat : func(lat) { me._cupdate(); me._cdirty = 1; me._lat = lat * D2R; me },
|
||||
set_alt : func(alt) { me._cupdate(); me._cdirty = 1; me._alt = alt; me },
|
||||
|
||||
set : func(c) {
|
||||
c._pupdate();
|
||||
me._lon = c._lon;
|
||||
me._lat = c._lat;
|
||||
me._alt = c._alt;
|
||||
me._cdirty = 1;
|
||||
me._pdirty = 0;
|
||||
me;
|
||||
},
|
||||
set_lonlat : func(lon, lat, alt = 0) {
|
||||
me._lon = lon * D2R;
|
||||
me._lat = lat * D2R;
|
||||
me._alt = alt;
|
||||
me._cdirty = 1;
|
||||
me._pdirty = 0;
|
||||
me;
|
||||
},
|
||||
set_xyz : func(x, y, z) {
|
||||
me._x = x;
|
||||
me._y = y;
|
||||
me._z = z;
|
||||
me._pdirty = 1;
|
||||
me._cdirty = 0;
|
||||
me;
|
||||
},
|
||||
apply_course_distance : func(course, dist) {
|
||||
me._pupdate();
|
||||
course *= D2R;
|
||||
dist /= ERAD;
|
||||
me._lat = asin(sin(me._lat) * cos(dist) + cos(me._lat) * sin(dist) * cos(course));
|
||||
|
||||
if (cos(me._lat) > EPSILON) {
|
||||
me._lon = math.pi - mod(math.pi - me._lon - asin(sin(course) * sin(dist)
|
||||
/ cos(me._lat)), 2 * math.pi);
|
||||
}
|
||||
me._cdirty = 1;
|
||||
me;
|
||||
},
|
||||
course_to : func(dest) {
|
||||
me._pupdate();
|
||||
dest._pupdate();
|
||||
|
||||
if (me._lon == dest._lon and me._lat == dest._lat) {
|
||||
return 0;
|
||||
}
|
||||
var dlon = dest._lon - me._lon;
|
||||
return mod(atan2(sin(dlon) * cos(dest._lat), cos(me._lat) * sin(dest._lat)
|
||||
- sin(me._lat) * cos(dest._lat) * cos(dlon)), 2 * math.pi) * R2D;
|
||||
},
|
||||
# arc distance on an earth sphere; doesn't consider altitude
|
||||
distance_to : func(dest) {
|
||||
me._pupdate();
|
||||
dest._pupdate();
|
||||
|
||||
if (me._lon == dest._lon and me._lat == dest._lat) {
|
||||
return 0;
|
||||
}
|
||||
var o = sin((me._lon - dest._lon) * 0.5);
|
||||
var a = sin((me._lat - dest._lat) * 0.5);
|
||||
return 2.0 * ERAD * asin(sqrt(a * a + cos(me._lat) * cos(dest._lat) * o * o));
|
||||
},
|
||||
direct_distance_to : func(dest) {
|
||||
me._cupdate();
|
||||
dest._cupdate();
|
||||
var dx = dest._x - me._x;
|
||||
var dy = dest._y - me._y;
|
||||
var dz = dest._z - me._z;
|
||||
return sqrt(dx * dx + dy * dy + dz * dz);
|
||||
},
|
||||
dump : func {
|
||||
if (me._cdirty and me._pdirty) {
|
||||
print("Coord.print(): coord undefined");
|
||||
}
|
||||
me._cupdate();
|
||||
me._pupdate();
|
||||
printf("x=%f y=%f z=%f lon=%f lat=%f alt=%f",
|
||||
me.x(), me.y(), me.z(), me.lon(), me.lat(), me.alt());
|
||||
},
|
||||
};
|
||||
|
||||
|
||||
|
||||
var init_prop = func(prop, value) {
|
||||
|
|
@ -273,96 +120,6 @@ var scan_models = func(base) {
|
|||
}
|
||||
|
||||
|
||||
# normalize degree to 0 <= angle < 360
|
||||
#
|
||||
var normdeg = func(angle) {
|
||||
while (angle < 0) {
|
||||
angle += 360;
|
||||
}
|
||||
while (angle >= 360) {
|
||||
angle -= 360;
|
||||
}
|
||||
return angle;
|
||||
}
|
||||
|
||||
|
||||
var bucket_span = func(lat) {
|
||||
if (lat >= 89.0 ) {
|
||||
360.0;
|
||||
} elsif (lat >= 88.0 ) {
|
||||
8.0;
|
||||
} elsif (lat >= 86.0 ) {
|
||||
4.0;
|
||||
} elsif (lat >= 83.0 ) {
|
||||
2.0;
|
||||
} elsif (lat >= 76.0 ) {
|
||||
1.0;
|
||||
} elsif (lat >= 62.0 ) {
|
||||
0.5;
|
||||
} elsif (lat >= 22.0 ) {
|
||||
0.25;
|
||||
} elsif (lat >= -22.0 ) {
|
||||
0.125;
|
||||
} elsif (lat >= -62.0 ) {
|
||||
0.25;
|
||||
} elsif (lat >= -76.0 ) {
|
||||
0.5;
|
||||
} elsif (lat >= -83.0 ) {
|
||||
1.0;
|
||||
} elsif (lat >= -86.0 ) {
|
||||
2.0;
|
||||
} elsif (lat >= -88.0 ) {
|
||||
4.0;
|
||||
} elsif (lat >= -89.0 ) {
|
||||
8.0;
|
||||
} else {
|
||||
360.0;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
var tile_index = func(lon, lat) {
|
||||
var lon_floor = floor(lon);
|
||||
var lat_floor = floor(lat);
|
||||
var span = bucket_span(lat);
|
||||
var x = 0;
|
||||
|
||||
if (span < 0.0000001) {
|
||||
lon = 0;
|
||||
} elsif (span <= 1.0) {
|
||||
x = int((lon - lon_floor) / span);
|
||||
} else {
|
||||
if (lon >= 0) {
|
||||
lon = int(int(lon / span) * span);
|
||||
} else {
|
||||
lon = int(int((lon + 1) / span) * span - span);
|
||||
if (lon < -180) {
|
||||
lon = -180;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
var y = int((lat - lat_floor) * 8);
|
||||
(lon_floor + 180) * 16384 + (lat_floor + 90) * 64 + y * 8 + x;
|
||||
}
|
||||
|
||||
|
||||
var format = func(lon, lat) {
|
||||
sprintf("%s%03d%s%02d", lon < 0 ? "w" : "e", abs(lon), lat < 0 ? "s" : "n", abs(lat));
|
||||
}
|
||||
|
||||
|
||||
var tile_path = func(lon, lat) {
|
||||
var p = format(floor(lon / 10.0) * 10, floor(lat / 10.0) * 10);
|
||||
p ~= "/" ~ format(floor(lon), floor(lat));
|
||||
p ~= "/" ~ tile_index(lon, lat) ~ ".stg";
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
# -------------------------------------------------------------------------------------------------
|
||||
|
||||
|
|
@ -377,14 +134,6 @@ var clock_loop = func {
|
|||
clock_loop();
|
||||
|
||||
|
||||
var ufo_position = func {
|
||||
var lon = getprop("/position/longitude-deg");
|
||||
var lat = getprop("/position/latitude-deg");
|
||||
var alt = getprop("/position/altitude-ft") * FT2M;
|
||||
Coord.new().set_lonlat(lon, lat, alt);
|
||||
}
|
||||
|
||||
|
||||
# class that maintains one adjustable model property (see src/Model/modelmgr.cxx)
|
||||
#
|
||||
var ModelValue = {
|
||||
|
|
@ -545,7 +294,7 @@ var Model = {
|
|||
|
||||
var elev_m = elev * FT2M;
|
||||
var stg_hdg = normdeg(360 - hdg);
|
||||
var stg_path = tile_path(lon, lat);
|
||||
var stg_path = geo.tile_path(lon, lat);
|
||||
var abs_path = getprop("/sim/fg-root") ~ "/" ~ path;
|
||||
var obj_line = sprintf("%s %s %.8f %.8f %.4f %.1f", type, spec, lon, lat, elev_m, stg_hdg);
|
||||
|
||||
|
|
@ -567,9 +316,9 @@ var ModelMgr = {
|
|||
m.models = [];
|
||||
m.legendN = props.globals.getNode("/sim/gui/dialogs/ufo-status/input", 1);
|
||||
m.legendN.setValue("");
|
||||
m.mouse_coord = ufo_position();
|
||||
m.mouse_coord = geo.aircraft_position();
|
||||
m.import();
|
||||
m.marker = Model.new("Aircraft/ufo/Models/marker.ac", Coord.new().set_xyz(0, 0, 0));
|
||||
m.marker = Model.new("Aircraft/ufo/Models/marker.ac", geo.Coord.new().set_xyz(0, 0, 0));
|
||||
m.marker.hide();
|
||||
m.modelpath = path;
|
||||
|
||||
|
|
@ -617,7 +366,7 @@ var ModelMgr = {
|
|||
select : func() {
|
||||
if (!size(me.models)) {
|
||||
me.active = nil;
|
||||
me.marker.move(Coord.new().set_xyz(0, 0, 0));
|
||||
me.marker.move(geo.Coord.new().set_xyz(0, 0, 0));
|
||||
return;
|
||||
}
|
||||
var min_dist = 10 * ERAD;
|
||||
|
|
@ -746,7 +495,7 @@ var ModelMgr = {
|
|||
var tmp = props.Node.new({ legend:"", "heading-deg":0, "pitch-deg":0, "roll-deg":0 });
|
||||
props.copy(m, tmp);
|
||||
m.getParent().removeChild(m.getName(), m.getIndex());
|
||||
var c = Coord.new().set_lonlat(
|
||||
var c = geo.Coord.new().set_lonlat(
|
||||
tmp.getNode("longitude-deg").getValue(),
|
||||
tmp.getNode("latitude-deg").getValue(),
|
||||
tmp.getNode("elevation-ft").getValue() * FT2M);
|
||||
|
|
@ -758,7 +507,7 @@ var ModelMgr = {
|
|||
if (!size(me.models) or me.active == nil) {
|
||||
return;
|
||||
}
|
||||
var ufo = ufo_position();
|
||||
var ufo = geo.aircraft_position();
|
||||
var dist = scale ? ufo.distance_to(me.active.pos) * 0.05 : 1;
|
||||
if (name == "longitudinal") {
|
||||
var dir = ufo.course_to(me.active.pos);
|
||||
|
|
@ -825,7 +574,7 @@ var print_ufo_data = func {
|
|||
printf("Heading: %.1f deg", normdeg(heading));
|
||||
printf("Ground Elev: %.4f m (%.4f ft)", elev_m, elev_m * M2FT);
|
||||
print();
|
||||
print("# " ~ tile_path(lon, lat));
|
||||
print("# " ~ geo.tile_path(lon, lat));
|
||||
printf("OBJECT_STATIC %.8f %.8f %.4f %.1f", lon, lat, elev_m, normdeg(360 - heading));
|
||||
print();
|
||||
|
||||
|
|
@ -939,18 +688,11 @@ var KbdShift = props.globals.getNode("/devices/status/keyboard/shift");
|
|||
var KbdCtrl = props.globals.getNode("/devices/status/keyboard/ctrl");
|
||||
var KbdAlt = props.globals.getNode("/devices/status/keyboard/alt");
|
||||
|
||||
var click_lon = props.globals.getNode("/sim/input/click/longitude-deg", 1);
|
||||
var click_lat = props.globals.getNode("/sim/input/click/latitude-deg", 1);
|
||||
var click_elev = props.globals.getNode("/sim/input/click/elevation-m", 1);
|
||||
|
||||
var modellist = scan_dirs(getprop("/source"));
|
||||
var modelmgr = ModelMgr.new(getprop("/cursor"));
|
||||
|
||||
setlistener("/sim/signals/click", func {
|
||||
var lon = click_lon.getValue();
|
||||
var lat = click_lat.getValue();
|
||||
var elev = click_elev.getValue();
|
||||
modelmgr.click(Coord.new().set_lonlat(lon, lat, elev));
|
||||
modelmgr.click(geo.Coord.new(geo.click_position())); # assign copy
|
||||
});
|
||||
|
||||
|
||||
|
|
|
|||
Loading…
Add table
Reference in a new issue