X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FScripting%2FNasalPositioned.cxx;h=25d28bb40c1c549c1e168eefddfc0c383d14b9ad;hb=ce09c320d32728dd9c5eb0d6b4ab9f4683242cbc;hp=78e1bc8d7316dd126cd09be4a9ea6497d2981a59;hpb=fb66aeade146502e14ee8deee4cd597e27f87bde;p=flightgear.git diff --git a/src/Scripting/NasalPositioned.cxx b/src/Scripting/NasalPositioned.cxx index 78e1bc8d7..25d28bb40 100644 --- a/src/Scripting/NasalPositioned.cxx +++ b/src/Scripting/NasalPositioned.cxx @@ -27,29 +27,88 @@ #include "NasalPositioned.hxx" #include +#include +#include // for boost::tie +#include #include #include #include #include #include -#include +#include #include #include +#include #include #include #include
#include
#include #include -#include +#include +#include +#include #include +#include #include +#include +#include -static void sgrefGhostDestroy(void* g); -naGhostType PositionedGhostType = { sgrefGhostDestroy, "positioned" }; -naGhostType WayptGhostType = { sgrefGhostDestroy, "waypoint" }; +using namespace flightgear; + +static void positionedGhostDestroy(void* g); +static void wayptGhostDestroy(void* g); +static void legGhostDestroy(void* g); +static void routeBaseGhostDestroy(void* g); + +naGhostType PositionedGhostType = { positionedGhostDestroy, "positioned" }; + +static const char* airportGhostGetMember(naContext c, void* g, naRef field, naRef* out); +naGhostType AirportGhostType = { positionedGhostDestroy, "airport", airportGhostGetMember, 0 }; + +static const char* navaidGhostGetMember(naContext c, void* g, naRef field, naRef* out); +naGhostType NavaidGhostType = { positionedGhostDestroy, "navaid", navaidGhostGetMember, 0 }; + +static const char* runwayGhostGetMember(naContext c, void* g, naRef field, naRef* out); +naGhostType RunwayGhostType = { positionedGhostDestroy, "runway", runwayGhostGetMember, 0 }; +naGhostType HelipadGhostType = { positionedGhostDestroy, "helipad", runwayGhostGetMember, 0 }; +naGhostType TaxiwayGhostType = { positionedGhostDestroy, "taxiway", runwayGhostGetMember, 0 }; + +static const char* fixGhostGetMember(naContext c, void* g, naRef field, naRef* out); +naGhostType FixGhostType = { positionedGhostDestroy, "fix", fixGhostGetMember, 0 }; + +static const char* wayptGhostGetMember(naContext c, void* g, naRef field, naRef* out); +static void waypointGhostSetMember(naContext c, void* g, naRef field, naRef value); + +naGhostType WayptGhostType = { wayptGhostDestroy, + "waypoint", + wayptGhostGetMember, + waypointGhostSetMember}; + +static const char* legGhostGetMember(naContext c, void* g, naRef field, naRef* out); +static void legGhostSetMember(naContext c, void* g, naRef field, naRef value); + +naGhostType FPLegGhostType = { legGhostDestroy, + "flightplan-leg", + legGhostGetMember, + legGhostSetMember}; + +static const char* flightplanGhostGetMember(naContext c, void* g, naRef field, naRef* out); +static void flightplanGhostSetMember(naContext c, void* g, naRef field, naRef value); + +naGhostType FlightPlanGhostType = { routeBaseGhostDestroy, + "flightplan", + flightplanGhostGetMember, + flightplanGhostSetMember +}; + +static const char* procedureGhostGetMember(naContext c, void* g, naRef field, naRef* out); +naGhostType ProcedureGhostType = { routeBaseGhostDestroy, + "procedure", + procedureGhostGetMember, + 0}; static void hashset(naContext c, naRef hash, const char* key, naRef val) { @@ -65,894 +124,2139 @@ static naRef stringToNasal(naContext c, const std::string& s) s.length()); } +static WayptFlag wayptFlagFromString(const char* s) +{ + if (!strcmp(s, "sid")) return WPT_DEPARTURE; + if (!strcmp(s, "star")) return WPT_ARRIVAL; + if (!strcmp(s, "approach")) return WPT_APPROACH; + if (!strcmp(s, "missed")) return WPT_MISS; + if (!strcmp(s, "pseudo")) return WPT_PSEUDO; + + return (WayptFlag) 0; +} + +static naRef wayptFlagToNasal(naContext c, unsigned int flags) +{ + if (flags & WPT_PSEUDO) return stringToNasal(c, "pseudo"); + if (flags & WPT_DEPARTURE) return stringToNasal(c, "sid"); + if (flags & WPT_ARRIVAL) return stringToNasal(c, "star"); + if (flags & WPT_MISS) return stringToNasal(c, "missed"); + if (flags & WPT_APPROACH) return stringToNasal(c, "approach"); + return naNil(); +} + static FGPositioned* positionedGhost(naRef r) { - if (naGhost_type(r) == &PositionedGhostType) + if ((naGhost_type(r) == &AirportGhostType) || + (naGhost_type(r) == &NavaidGhostType) || + (naGhost_type(r) == &RunwayGhostType) || + (naGhost_type(r) == &FixGhostType)) + { return (FGPositioned*) naGhost_ptr(r); + } + return 0; } -static flightgear::Waypt* wayptGhost(naRef r) +static FGAirport* airportGhost(naRef r) { - if (naGhost_type(r) == &WayptGhostType) - return (flightgear::Waypt*) naGhost_ptr(r); + if (naGhost_type(r) == &AirportGhostType) + return (FGAirport*) naGhost_ptr(r); return 0; } -static void sgrefGhostDestroy(void* g) +static FGNavRecord* navaidGhost(naRef r) { - SGReferenced* ref = (SGReferenced*)g; - SGReferenced::put(ref); // unref + if (naGhost_type(r) == &NavaidGhostType) + return (FGNavRecord*) naGhost_ptr(r); + return 0; } -static naRef airportPrototype; -static naRef routePrototype; -static naRef waypointPrototype; - -naRef ghostForPositioned(naContext c, const FGPositioned* pos) +static FGRunway* runwayGhost(naRef r) { - if (!pos) { - return naNil(); - } - - SGReferenced::get(pos); // take a ref - return naNewGhost(c, &PositionedGhostType, (void*) pos); + if (naGhost_type(r) == &RunwayGhostType) + return (FGRunway*) naGhost_ptr(r); + return 0; } -naRef ghostForWaypt(naContext c, const flightgear::Waypt* wpt) +static FGTaxiway* taxiwayGhost(naRef r) { - if (!wpt) { - return naNil(); - } - - SGReferenced::get(wpt); // take a ref - return naNewGhost(c, &WayptGhostType, (void*) wpt); + if (naGhost_type(r) == &TaxiwayGhostType) + return (FGTaxiway*) naGhost_ptr(r); + return 0; } -naRef hashForAirport(naContext c, const FGAirport* apt) +static FGFix* fixGhost(naRef r) { - std::string id = apt->ident(); - std::string name = apt->name(); - - // build runways hash - naRef rwys = naNewHash(c); - for(unsigned int r=0; rnumRunways(); ++r) { - FGRunway* rwy(apt->getRunwayByIndex(r)); - naRef rwyid = stringToNasal(c, rwy->ident()); - naRef rwydata = hashForRunway(c, rwy); - naHash_set(rwys, rwyid, rwydata); - } - - naRef aptdata = naNewHash(c); - hashset(c, aptdata, "id", stringToNasal(c, id)); - hashset(c, aptdata, "name", stringToNasal(c, name)); - hashset(c, aptdata, "lat", naNum(apt->getLatitude())); - hashset(c, aptdata, "lon", naNum(apt->getLongitude())); - hashset(c, aptdata, "elevation", naNum(apt->getElevation() * SG_FEET_TO_METER)); - hashset(c, aptdata, "has_metar", naNum(apt->getMetar())); - hashset(c, aptdata, "runways", rwys); - hashset(c, aptdata, "_positioned", ghostForPositioned(c, apt)); - naRef parents = naNewVector(c); - naVec_append(parents, airportPrototype); - hashset(c, aptdata, "parents", parents); - - return aptdata; + if (naGhost_type(r) == &FixGhostType) + return (FGFix*) naGhost_ptr(r); + return 0; } -naRef hashForWaypoint(naContext c, flightgear::Waypt* wpt, flightgear::Waypt* next) + +static void positionedGhostDestroy(void* g) { - SGGeod pos = wpt->position(); - naRef h = naNewHash(c); - - flightgear::Procedure* proc = dynamic_cast(wpt->owner()); - if (proc) { - hashset(c, h, "wp_parent_name", stringToNasal(c, proc->ident())); - // set 'wp_parent' route object to query the SID / STAR / airway? - // TODO - needs some extensions to flightgear::Route - } + FGPositioned* pos = (FGPositioned*)g; + if (!FGPositioned::put(pos)) // unref + delete pos; +} - if (wpt->type() == "hold") { - hashset(c, h, "fly_type", stringToNasal(c, "Hold")); - } else if (wpt->flag(flightgear::WPT_OVERFLIGHT)) { - hashset(c, h, "fly_type", stringToNasal(c, "flyOver")); - } else { - hashset(c, h, "fly_type", stringToNasal(c, "flyBy")); - } - - hashset(c, h, "wp_type", stringToNasal(c, wpt->type())); - hashset(c, h, "wp_name", stringToNasal(c, wpt->ident())); - hashset(c, h, "wp_lat", naNum(pos.getLatitudeDeg())); - hashset(c, h, "wp_lon", naNum(pos.getLongitudeDeg())); - hashset(c, h, "alt_cstr", naNum(wpt->altitudeFt())); - - if (wpt->speedRestriction() == flightgear::SPEED_RESTRICT_MACH) { - hashset(c, h, "spd_cstr", naNum(wpt->speedMach())); - } else { - hashset(c, h, "spd_cstr", naNum(wpt->speedKts())); - } +static Waypt* wayptGhost(naRef r) +{ + if (naGhost_type(r) == &WayptGhostType) + return (Waypt*) naGhost_ptr(r); - if (next) { - std::pair crsDist = - next->courseAndDistanceFrom(pos); - hashset(c, h, "leg_distance", naNum(crsDist.second * SG_METER_TO_NM)); - hashset(c, h, "leg_bearing", naNum(crsDist.first)); - hashset(c, h, "hdg_radial", naNum(wpt->headingRadialDeg())); + if (naGhost_type(r) == &FPLegGhostType) { + FlightPlan::Leg* leg = (FlightPlan::Leg*) naGhost_ptr(r); + return leg->waypoint(); } -// leg bearing, distance, etc - - -// parents and ghost of the C++ object - hashset(c, h, "_waypt", ghostForWaypt(c, wpt)); - naRef parents = naNewVector(c); - naVec_append(parents, waypointPrototype); - hashset(c, h, "parents", parents); - - return h; - + return 0; } -naRef hashForRunway(naContext c, FGRunway* rwy) +static void wayptGhostDestroy(void* g) { - naRef rwyid = stringToNasal(c, rwy->ident()); - naRef rwydata = naNewHash(c); -#define HASHSET(s,l,n) naHash_set(rwydata, naStr_fromdata(naNewString(c),s,l),n) - HASHSET("id", 2, rwyid); - HASHSET("lat", 3, naNum(rwy->latitude())); - HASHSET("lon", 3, naNum(rwy->longitude())); - HASHSET("heading", 7, naNum(rwy->headingDeg())); - HASHSET("length", 6, naNum(rwy->lengthM())); - HASHSET("width", 5, naNum(rwy->widthM())); - HASHSET("threshold", 9, naNum(rwy->displacedThresholdM())); - HASHSET("stopway", 7, naNum(rwy->stopwayM())); - - if (rwy->ILS()) { - HASHSET("ils_frequency_mhz", 17, naNum(rwy->ILS()->get_freq() / 100.0)); - HASHSET("ils", 3, hashForNavRecord(c, rwy->ILS(), SGGeod())); - } - - HASHSET("_positioned", 11, ghostForPositioned(c, rwy)); -#undef HASHSET - return rwydata; + Waypt* wpt = (Waypt*)g; + if (!Waypt::put(wpt)) // unref + delete wpt; } -naRef hashForNavRecord(naContext c, const FGNavRecord* nav, const SGGeod& rel) +static void legGhostDestroy(void* g) { - naRef navdata = naNewHash(c); -#define HASHSET(s,l,n) naHash_set(navdata, naStr_fromdata(naNewString(c),s,l),n) - HASHSET("id", 2, stringToNasal(c, nav->ident())); - HASHSET("name", 4, stringToNasal(c, nav->name())); - HASHSET("frequency", 9, naNum(nav->get_freq())); - HASHSET("lat", 3, naNum(nav->get_lat())); - HASHSET("lon", 3, naNum(nav->get_lon())); - HASHSET("elevation", 9, naNum(nav->get_elev_ft() * SG_FEET_TO_METER)); - HASHSET("type", 4, stringToNasal(c, nav->nameForType(nav->type()))); - -// FIXME - get rid of these, people should use courseAndDistance instead - HASHSET("distance", 8, naNum(SGGeodesy::distanceNm( rel, nav->geod() ) * SG_NM_TO_METER ) ); - HASHSET("bearing", 7, naNum(SGGeodesy::courseDeg( rel, nav->geod() ) ) ); - - // record the real object as a ghost for further operations - HASHSET("_positioned",11, ghostForPositioned(c, nav)); -#undef HASHSET - - return navdata; + // nothing for now } -bool geodFromHash(naRef ref, SGGeod& result) + +static FlightPlan::Leg* fpLegGhost(naRef r) { - if (!naIsHash(ref)) { - return false; - } - -// first, see if the hash contains a FGPositioned ghost - in which case -// we can read off its position directly - naRef posGhost = naHash_cget(ref, (char*) "_positioned"); - if (!naIsNil(posGhost)) { - FGPositioned* pos = positionedGhost(posGhost); - result = pos->geod(); - return true; - } - - naRef ghost = naHash_cget(ref, (char*) "_waypt"); - if (!naIsNil(ghost)) { - flightgear::Waypt* w = wayptGhost(ghost); - result = w->position(); - return true; - } - -// then check for manual latitude / longitude names - naRef lat = naHash_cget(ref, (char*) "lat"); - naRef lon = naHash_cget(ref, (char*) "lon"); - if (naIsNum(lat) && naIsNum(lon)) { - result = SGGeod::fromDeg(naNumValue(lat).num, naNumValue(lon).num); - return true; - } - -// check for geo.Coord type - -// check for any synonyms? - // latitude + longitude? - - return false; + if (naGhost_type(r) == &FPLegGhostType) + return (FlightPlan::Leg*) naGhost_ptr(r); + return 0; } -static int geodFromArgs(naRef* args, int offset, int argc, SGGeod& result) +static Procedure* procedureGhost(naRef r) { - if (offset >= argc) { - return 0; - } - - if (geodFromHash(args[offset], result)) { - return 1; - } - - if (((argc - offset) >= 2) && naIsNum(args[offset]) && naIsNum(args[offset + 1])) { - double lat = naNumValue(args[0]).num, - lon = naNumValue(args[1]).num; - result = SGGeod::fromDeg(lon, lat); - return 2; - } - + if (naGhost_type(r) == &ProcedureGhostType) + return (Procedure*) naGhost_ptr(r); return 0; } -// Convert a cartesian point to a geodetic lat/lon/altitude. -static naRef f_carttogeod(naContext c, naRef me, int argc, naRef* args) +static FlightPlan* flightplanGhost(naRef r) { - double lat, lon, alt, xyz[3]; - if(argc != 3) naRuntimeError(c, "carttogeod() expects 3 arguments"); - for(int i=0; i<3; i++) - xyz[i] = naNumValue(args[i]).num; - sgCartToGeod(xyz, &lat, &lon, &alt); - lat *= SG_RADIANS_TO_DEGREES; - lon *= SG_RADIANS_TO_DEGREES; - naRef vec = naNewVector(c); - naVec_append(vec, naNum(lat)); - naVec_append(vec, naNum(lon)); - naVec_append(vec, naNum(alt)); - return vec; + if (naGhost_type(r) == &FlightPlanGhostType) + return (FlightPlan*) naGhost_ptr(r); + return 0; } -// Convert a geodetic lat/lon/altitude to a cartesian point. -static naRef f_geodtocart(naContext c, naRef me, int argc, naRef* args) +static void routeBaseGhostDestroy(void* g) { - if(argc != 3) naRuntimeError(c, "geodtocart() expects 3 arguments"); - double lat = naNumValue(args[0]).num * SG_DEGREES_TO_RADIANS; - double lon = naNumValue(args[1]).num * SG_DEGREES_TO_RADIANS; - double alt = naNumValue(args[2]).num; - double xyz[3]; - sgGeodToCart(lat, lon, alt, xyz); - naRef vec = naNewVector(c); - naVec_append(vec, naNum(xyz[0])); - naVec_append(vec, naNum(xyz[1])); - naVec_append(vec, naNum(xyz[2])); - return vec; + // nothing for now } -// For given geodetic point return array with elevation, and a material data -// hash, or nil if there's no information available (tile not loaded). If -// information about the material isn't available, then nil is returned instead -// of the hash. -static naRef f_geodinfo(naContext c, naRef me, int argc, naRef* args) +static naRef airportPrototype; +static naRef flightplanPrototype; +static naRef waypointPrototype; +static naRef geoCoordClass; +static naRef fpLegPrototype; +static naRef procedurePrototype; + +naRef ghostForAirport(naContext c, const FGAirport* apt) { -#define HASHSET(s,l,n) naHash_set(matdata, naStr_fromdata(naNewString(c),s,l),n) - if(argc < 2 || argc > 3) - naRuntimeError(c, "geodinfo() expects 2 or 3 arguments: lat, lon [, maxalt]"); - double lat = naNumValue(args[0]).num; - double lon = naNumValue(args[1]).num; - double elev = argc == 3 ? naNumValue(args[2]).num : 10000; - const SGMaterial *mat; - SGGeod geod = SGGeod::fromDegM(lon, lat, elev); - if(!globals->get_scenery()->get_elevation_m(geod, elev, &mat)) + if (!apt) { return naNil(); - naRef vec = naNewVector(c); - naVec_append(vec, naNum(elev)); - naRef matdata = naNil(); - if(mat) { - matdata = naNewHash(c); - naRef names = naNewVector(c); - BOOST_FOREACH(const std::string& n, mat->get_names()) - naVec_append(names, stringToNasal(c, n)); - - HASHSET("names", 5, names); - HASHSET("solid", 5, naNum(mat->get_solid())); - HASHSET("friction_factor", 15, naNum(mat->get_friction_factor())); - HASHSET("rolling_friction", 16, naNum(mat->get_rolling_friction())); - HASHSET("load_resistance", 15, naNum(mat->get_load_resistance())); - HASHSET("bumpiness", 9, naNum(mat->get_bumpiness())); - HASHSET("light_coverage", 14, naNum(mat->get_light_coverage())); } - naVec_append(vec, matdata); - return vec; -#undef HASHSET + + FGPositioned::get(apt); // take a ref + return naNewGhost2(c, &AirportGhostType, (void*) apt); } - -class AirportInfoFilter : public FGAirport::AirportFilter +naRef ghostForNavaid(naContext c, const FGNavRecord* n) { -public: - AirportInfoFilter() : type(FGPositioned::AIRPORT) { + if (!n) { + return naNil(); } - bool fromArg(naRef arg) - { - const char *s = naStr_data(arg); - if(!strcmp(s, "airport")) type = FGPositioned::AIRPORT; - else if(!strcmp(s, "seaport")) type = FGPositioned::SEAPORT; - else if(!strcmp(s, "heliport")) type = FGPositioned::HELIPORT; - else - return false; - - return true; + FGPositioned::get(n); // take a ref + return naNewGhost2(c, &NavaidGhostType, (void*) n); +} + +naRef ghostForRunway(naContext c, const FGRunway* r) +{ + if (!r) { + return naNil(); } - virtual FGPositioned::Type minType() const { - return type; + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &RunwayGhostType, (void*) r); +} + +naRef ghostForHelipad(naContext c, const FGHelipad* r) +{ + if (!r) { + return naNil(); } - - virtual FGPositioned::Type maxType() const { - return type; + + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &HelipadGhostType, (void*) r); +} + +naRef ghostForTaxiway(naContext c, const FGTaxiway* r) +{ + if (!r) { + return naNil(); } - FGPositioned::Type type; -}; + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &TaxiwayGhostType, (void*) r); +} -// Returns data hash for particular or nearest airport of a , or nil -// on error. -// -// airportinfo(); e.g. "KSFO" -// airportinfo(); type := ("airport"|"seaport"|"heliport") -// airportinfo() same as airportinfo("airport") -// airportinfo(, [, ]); -static naRef f_airportinfo(naContext c, naRef me, int argc, naRef* args) +naRef ghostForFix(naContext c, const FGFix* r) { - SGGeod pos = globals->get_aircraft_position(); - FGAirport* apt = NULL; - - if(argc >= 2 && naIsNum(args[0]) && naIsNum(args[1])) { - pos = SGGeod::fromDeg(args[1].num, args[0].num); - args += 2; - argc -= 2; + if (!r) { + return naNil(); } - double maxRange = 10000.0; // expose this? or pick a smaller value? - - AirportInfoFilter filter; // defaults to airports only - - if(argc == 0) { - // fall through and use AIRPORT - } else if(argc == 1 && naIsString(args[0])) { - if (filter.fromArg(args[0])) { - // done! - } else { - // user provided an , hopefully - apt = FGAirport::findByIdent(naStr_data(args[0])); - if (!apt) { - // return nil here, but don't raise a runtime error; this is a - // legitamate way to validate an ICAO code, for example in a - // dialog box or similar. - return naNil(); - } - } - } else { - naRuntimeError(c, "airportinfo() with invalid function arguments"); + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &FixGhostType, (void*) r); +} + + +naRef ghostForWaypt(naContext c, const Waypt* wpt) +{ + if (!wpt) { return naNil(); } - - if(!apt) { - apt = FGAirport::findClosest(pos, maxRange, &filter); - if(!apt) return naNil(); + + Waypt::get(wpt); // take a ref + return naNewGhost2(c, &WayptGhostType, (void*) wpt); +} + +naRef ghostForLeg(naContext c, const FlightPlan::Leg* leg) +{ + if (!leg) { + return naNil(); } - return hashForAirport(c, apt); + return naNewGhost2(c, &FPLegGhostType, (void*) leg); } -static naRef f_findAirportsWithinRange(naContext c, naRef me, int argc, naRef* args) +naRef ghostForFlightPlan(naContext c, const FlightPlan* fp) { - int argOffset = 0; - SGGeod pos = globals->get_aircraft_position(); - argOffset += geodFromArgs(args, 0, argc, pos); + if (!fp) { + return naNil(); + } - if (!naIsNum(args[argOffset])) { - naRuntimeError(c, "findAirportsWithinRange expected range (in nm) as arg %d", argOffset); + return naNewGhost2(c, &FlightPlanGhostType, (void*) fp); +} + +naRef ghostForProcedure(naContext c, const Procedure* proc) +{ + if (!proc) { + return naNil(); } - AirportInfoFilter filter; // defaults to airports only + return naNewGhost2(c, &ProcedureGhostType, (void*) proc); +} + +static const char* airportGhostGetMember(naContext c, void* g, naRef field, naRef* out) +{ + const char* fieldName = naStr_data(field); + FGAirport* apt = (FGAirport*) g; + + if (!strcmp(fieldName, "parents")) { + *out = naNewVector(c); + naVec_append(*out, airportPrototype); + } else if (!strcmp(fieldName, "id")) *out = stringToNasal(c, apt->ident()); + else if (!strcmp(fieldName, "name")) *out = stringToNasal(c, apt->name()); + else if (!strcmp(fieldName, "lat")) *out = naNum(apt->getLatitude()); + else if (!strcmp(fieldName, "lon")) *out = naNum(apt->getLongitude()); + else if (!strcmp(fieldName, "elevation")) { + *out = naNum(apt->getElevation() * SG_FEET_TO_METER); + } else if (!strcmp(fieldName, "has_metar")) { + *out = naNum(apt->getMetar()); + } else if (!strcmp(fieldName, "runways")) { + *out = naNewHash(c); + double minLengthFt = fgGetDouble("/sim/navdb/min-runway-length-ft"); + for(unsigned int r=0; rnumRunways(); ++r) { + FGRunway* rwy(apt->getRunwayByIndex(r)); + // ignore unusably short runways + if (rwy->lengthFt() < minLengthFt) { + continue; + } + naRef rwyid = stringToNasal(c, rwy->ident()); + naRef rwydata = ghostForRunway(c, rwy); + naHash_set(*out, rwyid, rwydata); + } + } else if (!strcmp(fieldName, "helipads")) { + *out = naNewHash(c); + + for(unsigned int r=0; rnumHelipads(); ++r) { + FGHelipad* hp(apt->getHelipadByIndex(r)); + + naRef rwyid = stringToNasal(c, hp->ident()); + naRef rwydata = ghostForHelipad(c, hp); + naHash_set(*out, rwyid, rwydata); + } + + } else if (!strcmp(fieldName, "taxiways")) { + *out = naNewVector(c); + for(unsigned int r=0; rnumTaxiways(); ++r) { + FGTaxiway* taxi(apt->getTaxiwayByIndex(r)); + naRef taxidata = ghostForTaxiway(c, taxi); + naVec_append(*out, taxidata); + } + + } else { + return 0; + } + + return ""; +} + +static const char* waypointCommonGetMember(naContext c, Waypt* wpt, const char* fieldName, naRef* out) +{ + if (!strcmp(fieldName, "wp_name") || !strcmp(fieldName, "id")) *out = stringToNasal(c, wpt->ident()); + else if (!strcmp(fieldName, "wp_type")) *out = stringToNasal(c, wpt->type()); + else if (!strcmp(fieldName, "wp_role")) *out = wayptFlagToNasal(c, wpt->flags()); + else if (!strcmp(fieldName, "wp_lat") || !strcmp(fieldName, "lat")) *out = naNum(wpt->position().getLatitudeDeg()); + else if (!strcmp(fieldName, "wp_lon") || !strcmp(fieldName, "lon")) *out = naNum(wpt->position().getLongitudeDeg()); + else if (!strcmp(fieldName, "wp_parent_name")) { + Procedure* proc = dynamic_cast(wpt->owner()); + *out = proc ? stringToNasal(c, proc->ident()) : naNil(); + } else if (!strcmp(fieldName, "wp_parent")) { + Procedure* proc = dynamic_cast(wpt->owner()); + *out = ghostForProcedure(c, proc); + } else if (!strcmp(fieldName, "fly_type")) { + if (wpt->type() == "hold") { + *out = stringToNasal(c, "Hold"); + } else { + *out = stringToNasal(c, wpt->flag(WPT_OVERFLIGHT) ? "flyOver" : "flyBy"); + } + } else { + return NULL; // member not found + } + + return ""; +} + +static void waypointCommonSetMember(naContext c, Waypt* wpt, const char* fieldName, naRef value) +{ + if (!strcmp(fieldName, "wp_role")) { + if (!naIsString(value)) naRuntimeError(c, "wp_role must be a string"); + if (wpt->owner() != NULL) naRuntimeError(c, "cannot override wp_role on waypoint with parent"); + WayptFlag f = wayptFlagFromString(naStr_data(value)); + if (f == 0) { + naRuntimeError(c, "unrecognized wp_role value %s", naStr_data(value)); + } + + wpt->setFlag(f, true); + } +} + +static const char* wayptGhostGetMember(naContext c, void* g, naRef field, naRef* out) +{ + const char* fieldName = naStr_data(field); + Waypt* wpt = (flightgear::Waypt*) g; + return waypointCommonGetMember(c, wpt, fieldName, out); +} + +static RouteRestriction routeRestrictionFromString(const char* s) +{ + std::string u(s); + boost::to_lower(u); + if (u == "computed") return RESTRICT_COMPUTED; + if (u == "at") return RESTRICT_AT; + if (u == "mach") return SPEED_RESTRICT_MACH; + if (u == "computed-mach") return SPEED_COMPUTED_MACH; + if (u == "delete") return RESTRICT_DELETE; + return RESTRICT_NONE; +}; + +naRef routeRestrictionToNasal(naContext c, RouteRestriction rr) +{ + switch (rr) { + case RESTRICT_NONE: return naNil(); + case RESTRICT_AT: return stringToNasal(c, "at"); + case RESTRICT_ABOVE: return stringToNasal(c, "above"); + case RESTRICT_BELOW: return stringToNasal(c, "below"); + case SPEED_RESTRICT_MACH: return stringToNasal(c, "mach"); + case RESTRICT_COMPUTED: return stringToNasal(c, "computed"); + case SPEED_COMPUTED_MACH: return stringToNasal(c, "computed-mach"); + case RESTRICT_DELETE: return stringToNasal(c, "delete"); + } + + return naNil(); +} + +static const char* legGhostGetMember(naContext c, void* g, naRef field, naRef* out) +{ + const char* fieldName = naStr_data(field); + FlightPlan::Leg* leg = (FlightPlan::Leg*) g; + Waypt* wpt = leg->waypoint(); + + if (!strcmp(fieldName, "parents")) { + *out = naNewVector(c); + naVec_append(*out, fpLegPrototype); + naVec_append(*out, waypointPrototype); + } else if (!strcmp(fieldName, "index")) { + *out = naNum(leg->index()); + } else if (!strcmp(fieldName, "alt_cstr")) { + *out = naNum(leg->altitudeFt()); + } else if (!strcmp(fieldName, "alt_cstr_type")) { + *out = routeRestrictionToNasal(c, leg->altitudeRestriction()); + } else if (!strcmp(fieldName, "speed_cstr")) { + double s = isMachRestrict(leg->speedRestriction()) ? leg->speedMach() : leg->speedKts(); + *out = naNum(s); + } else if (!strcmp(fieldName, "speed_cstr_type")) { + *out = routeRestrictionToNasal(c, leg->speedRestriction()); + } else if (!strcmp(fieldName, "leg_distance")) { + *out = naNum(leg->distanceNm()); + } else if (!strcmp(fieldName, "leg_bearing")) { + *out = naNum(leg->courseDeg()); + } else if (!strcmp(fieldName, "distance_along_route")) { + *out = naNum(leg->distanceAlongRoute()); + } else { // check for fields defined on the underlying waypoint + return waypointCommonGetMember(c, wpt, fieldName, out); + } + + return ""; // success +} + +static void waypointGhostSetMember(naContext c, void* g, naRef field, naRef value) +{ + const char* fieldName = naStr_data(field); + Waypt* wpt = (Waypt*) g; + waypointCommonSetMember(c, wpt, fieldName, value); +} + +static void legGhostSetMember(naContext c, void* g, naRef field, naRef value) +{ + const char* fieldName = naStr_data(field); + FlightPlan::Leg* leg = (FlightPlan::Leg*) g; + + waypointCommonSetMember(c, leg->waypoint(), fieldName, value); +} + +static const char* flightplanGhostGetMember(naContext c, void* g, naRef field, naRef* out) +{ + const char* fieldName = naStr_data(field); + FlightPlan* fp = (FlightPlan*) g; + + if (!strcmp(fieldName, "parents")) { + *out = naNewVector(c); + naVec_append(*out, flightplanPrototype); + } else if (!strcmp(fieldName, "id")) *out = stringToNasal(c, fp->ident()); + else if (!strcmp(fieldName, "departure")) *out = ghostForAirport(c, fp->departureAirport()); + else if (!strcmp(fieldName, "destination")) *out = ghostForAirport(c, fp->destinationAirport()); + else if (!strcmp(fieldName, "departure_runway")) *out = ghostForRunway(c, fp->departureRunway()); + else if (!strcmp(fieldName, "destination_runway")) *out = ghostForRunway(c, fp->destinationRunway()); + else if (!strcmp(fieldName, "sid")) *out = ghostForProcedure(c, fp->sid()); + else if (!strcmp(fieldName, "sid_trans")) *out = ghostForProcedure(c, fp->sidTransition()); + else if (!strcmp(fieldName, "star")) *out = ghostForProcedure(c, fp->star()); + else if (!strcmp(fieldName, "star_trans")) *out = ghostForProcedure(c, fp->starTransition()); + else if (!strcmp(fieldName, "approach")) *out = ghostForProcedure(c, fp->approach()); + else if (!strcmp(fieldName, "current")) *out = naNum(fp->currentIndex()); + else { + return 0; + } + + return ""; +} + +static void flightplanGhostSetMember(naContext c, void* g, naRef field, naRef value) +{ + const char* fieldName = naStr_data(field); + FlightPlan* fp = (FlightPlan*) g; + + if (!strcmp(fieldName, "id")) { + if (!naIsString(value)) naRuntimeError(c, "flightplan.id must be a string"); + fp->setIdent(naStr_data(value)); + } else if (!strcmp(fieldName, "current")) { + int index = value.num; + if ((index < 0) || (index >= fp->numLegs())) { + return; + } + fp->setCurrentIndex(index); + } else if (!strcmp(fieldName, "departure")) { + FGAirport* apt = airportGhost(value); + if (apt) { + fp->setDeparture(apt); + return; + } + + FGRunway* rwy = runwayGhost(value); + if (rwy){ + fp->setDeparture(rwy); + return; + } + + if (naIsNil(value)) { + fp->setDeparture(static_cast(NULL)); + return; + } + + naRuntimeError(c, "bad argument type setting departure"); + } else if (!strcmp(fieldName, "destination")) { + FGAirport* apt = airportGhost(value); + if (apt) { + fp->setDestination(apt); + return; + } + + FGRunway* rwy = runwayGhost(value); + if (rwy){ + fp->setDestination(rwy); + return; + } + + naRuntimeError(c, "bad argument type setting destination"); + } else if (!strcmp(fieldName, "departure_runway")) { + FGRunway* rwy = runwayGhost(value); + if (rwy){ + fp->setDeparture(rwy); + return; + } + + naRuntimeError(c, "bad argument type setting departure runway"); + } else if (!strcmp(fieldName, "destination_runway")) { + FGRunway* rwy = runwayGhost(value); + if (rwy){ + fp->setDestination(rwy); + return; + } + + naRuntimeError(c, "bad argument type setting destination runway"); + } else if (!strcmp(fieldName, "sid")) { + Procedure* proc = procedureGhost(value); + if (proc && (proc->type() == PROCEDURE_SID)) { + fp->setSID((flightgear::SID*) proc); + return; + } + // allow a SID transition to be set, implicitly include the SID itself + if (proc && (proc->type() == PROCEDURE_TRANSITION)) { + fp->setSID((Transition*) proc); + return; + } + + if (naIsString(value)) { + FGAirport* apt = fp->departureAirport(); + fp->setSID(apt->findSIDWithIdent(naStr_data(value))); + return; + } + + naRuntimeError(c, "bad argument type setting SID"); + } else if (!strcmp(fieldName, "star")) { + Procedure* proc = procedureGhost(value); + if (proc && (proc->type() == PROCEDURE_STAR)) { + fp->setSTAR((STAR*) proc); + return; + } + + if (proc && (proc->type() == PROCEDURE_TRANSITION)) { + fp->setSTAR((Transition*) proc); + return; + } + + if (naIsString(value)) { + FGAirport* apt = fp->destinationAirport(); + fp->setSTAR(apt->findSTARWithIdent(naStr_data(value))); + return; + } + + naRuntimeError(c, "bad argument type setting STAR"); + } else if (!strcmp(fieldName, "approach")) { + Procedure* proc = procedureGhost(value); + if (proc && Approach::isApproach(proc->type())) { + fp->setApproach((Approach*) proc); + return; + } + + if (naIsString(value)) { + FGAirport* apt = fp->destinationAirport(); + fp->setApproach(apt->findApproachWithIdent(naStr_data(value))); + return; + } + + naRuntimeError(c, "bad argument type setting approach"); + } +} + + +static naRef procedureTpType(naContext c, ProcedureType ty) +{ + switch (ty) { + case PROCEDURE_SID: return stringToNasal(c, "sid"); + case PROCEDURE_STAR: return stringToNasal(c, "star"); + case PROCEDURE_APPROACH_VOR: + case PROCEDURE_APPROACH_ILS: + case PROCEDURE_APPROACH_RNAV: + case PROCEDURE_APPROACH_NDB: + return stringToNasal(c, "IAP"); + default: + return naNil(); + } +} + +static naRef procedureRadioType(naContext c, ProcedureType ty) +{ + switch (ty) { + case PROCEDURE_APPROACH_VOR: return stringToNasal(c, "VOR"); + case PROCEDURE_APPROACH_ILS: return stringToNasal(c, "ILS"); + case PROCEDURE_APPROACH_RNAV: return stringToNasal(c, "RNAV"); + case PROCEDURE_APPROACH_NDB: return stringToNasal(c, "NDB"); + default: + return naNil(); + } +} + +static const char* procedureGhostGetMember(naContext c, void* g, naRef field, naRef* out) +{ + const char* fieldName = naStr_data(field); + Procedure* proc = (Procedure*) g; + + if (!strcmp(fieldName, "parents")) { + *out = naNewVector(c); + naVec_append(*out, procedurePrototype); + } else if (!strcmp(fieldName, "id")) *out = stringToNasal(c, proc->ident()); + else if (!strcmp(fieldName, "airport")) *out = ghostForAirport(c, proc->airport()); + else if (!strcmp(fieldName, "tp_type")) *out = procedureTpType(c, proc->type()); + else if (!strcmp(fieldName, "radio")) *out = procedureRadioType(c, proc->type()); + else if (!strcmp(fieldName, "runways")) { + *out = naNewVector(c); + BOOST_FOREACH(FGRunwayRef rwy, proc->runways()) { + naVec_append(*out, stringToNasal(c, rwy->ident())); + } + } else if (!strcmp(fieldName, "transitions")) { + if ((proc->type() != PROCEDURE_SID) && (proc->type() != PROCEDURE_STAR)) { + *out = naNil(); + return ""; + } + + ArrivalDeparture* ad = static_cast(proc); + *out = naNewVector(c); + BOOST_FOREACH(std::string id, ad->transitionIdents()) { + naVec_append(*out, stringToNasal(c, id)); + } + } else { + return 0; + } + + return ""; +} + +static const char* runwayGhostGetMember(naContext c, void* g, naRef field, naRef* out) +{ + const char* fieldName = naStr_data(field); + FGRunwayBase* base = (FGRunwayBase*) g; + + if (!strcmp(fieldName, "id")) *out = stringToNasal(c, base->ident()); + else if (!strcmp(fieldName, "lat")) *out = naNum(base->latitude()); + else if (!strcmp(fieldName, "lon")) *out = naNum(base->longitude()); + else if (!strcmp(fieldName, "heading")) *out = naNum(base->headingDeg()); + else if (!strcmp(fieldName, "length")) *out = naNum(base->lengthM()); + else if (!strcmp(fieldName, "width")) *out = naNum(base->widthM()); + else if (!strcmp(fieldName, "surface")) *out = naNum(base->surface()); + else if (base->type() == FGRunwayBase::RUNWAY) { + FGRunway* rwy = (FGRunway*) g; + if (!strcmp(fieldName, "threshold")) *out = naNum(rwy->displacedThresholdM()); + else if (!strcmp(fieldName, "stopway")) *out = naNum(rwy->stopwayM()); + else if (!strcmp(fieldName, "reciprocal")) { + *out = ghostForRunway(c, rwy->reciprocalRunway()); + } else if (!strcmp(fieldName, "ils_frequency_mhz")) { + *out = rwy->ILS() ? naNum(rwy->ILS()->get_freq() / 100.0) : naNil(); + } else if (!strcmp(fieldName, "ils")) { + *out = ghostForNavaid(c, rwy->ILS()); + } else { + return 0; + } + } else { + return 0; + } + + return ""; +} + +static const char* navaidGhostGetMember(naContext c, void* g, naRef field, naRef* out) +{ + const char* fieldName = naStr_data(field); + FGNavRecord* nav = (FGNavRecord*) g; + + if (!strcmp(fieldName, "id")) *out = stringToNasal(c, nav->ident()); + else if (!strcmp(fieldName, "name")) *out = stringToNasal(c, nav->name()); + else if (!strcmp(fieldName, "lat")) *out = naNum(nav->get_lat()); + else if (!strcmp(fieldName, "lon")) *out = naNum(nav->get_lon()); + else if (!strcmp(fieldName, "elevation")) { + *out = naNum(nav->get_elev_ft() * SG_FEET_TO_METER); + } else if (!strcmp(fieldName, "type")) { + *out = stringToNasal(c, nav->nameForType(nav->type())); + } else if (!strcmp(fieldName, "frequency")) { + *out = naNum(nav->get_freq()); + } else if (!strcmp(fieldName, "range_nm")) { + *out = naNum(nav->get_range()); + } else if (!strcmp(fieldName, "course")) { + if ((nav->type() == FGPositioned::ILS) || (nav->type() == FGPositioned::LOC)) { + double radial = nav->get_multiuse(); + SG_NORMALIZE_RANGE(radial, 0.0, 360.0); + *out = naNum(radial); + } else { + *out = naNil(); + } + } else { + return 0; + } + + return ""; +} + +static const char* fixGhostGetMember(naContext c, void* g, naRef field, naRef* out) +{ + const char* fieldName = naStr_data(field); + FGFix* fix = (FGFix*) g; + + if (!strcmp(fieldName, "id")) *out = stringToNasal(c, fix->ident()); + else if (!strcmp(fieldName, "lat")) *out = naNum(fix->get_lat()); + else if (!strcmp(fieldName, "lon")) *out = naNum(fix->get_lon()); + else { + return 0; + } + + return ""; +} + +static bool hashIsCoord(naRef h) +{ + naRef parents = naHash_cget(h, (char*) "parents"); + if (!naIsVector(parents)) { + return false; + } + + return naEqual(naVec_get(parents, 0), geoCoordClass) != 0; +} + +bool geodFromHash(naRef ref, SGGeod& result) +{ + if (!naIsHash(ref)) { + return false; + } + + +// check for manual latitude / longitude names + naRef lat = naHash_cget(ref, (char*) "lat"); + naRef lon = naHash_cget(ref, (char*) "lon"); + if (naIsNum(lat) && naIsNum(lon)) { + result = SGGeod::fromDeg(naNumValue(lon).num, naNumValue(lat).num); + return true; + } + + if (hashIsCoord(ref)) { + naRef lat = naHash_cget(ref, (char*) "_lat"); + naRef lon = naHash_cget(ref, (char*) "_lon"); + if (naIsNum(lat) && naIsNum(lon)) { + result = SGGeod::fromRad(naNumValue(lon).num, naNumValue(lat).num); + return true; + } + } + +// check for any synonyms? + // latitude + longitude? + + return false; +} + +static int geodFromArgs(naRef* args, int offset, int argc, SGGeod& result) +{ + if (offset >= argc) { + return 0; + } + + if (naIsGhost(args[offset])) { + naGhostType* gt = naGhost_type(args[offset]); + if (gt == &AirportGhostType) { + result = airportGhost(args[offset])->geod(); + return 1; + } + + if (gt == &NavaidGhostType) { + result = navaidGhost(args[offset])->geod(); + return 1; + } + + if (gt == &RunwayGhostType) { + result = runwayGhost(args[offset])->geod(); + return 1; + } + + if (gt == &TaxiwayGhostType) { + result = taxiwayGhost(args[offset])->geod(); + return 1; + } + + if (gt == &FixGhostType) { + result = fixGhost(args[offset])->geod(); + return 1; + } + + if (gt == &WayptGhostType) { + result = wayptGhost(args[offset])->position(); + return 1; + } + } + + if (geodFromHash(args[offset], result)) { + return 1; + } + + if (((argc - offset) >= 2) && naIsNum(args[offset]) && naIsNum(args[offset + 1])) { + double lat = naNumValue(args[0]).num, + lon = naNumValue(args[1]).num; + result = SGGeod::fromDeg(lon, lat); + return 2; + } + + return 0; +} + +// Convert a cartesian point to a geodetic lat/lon/altitude. +static naRef f_carttogeod(naContext c, naRef me, int argc, naRef* args) +{ + double lat, lon, alt, xyz[3]; + if(argc != 3) naRuntimeError(c, "carttogeod() expects 3 arguments"); + for(int i=0; i<3; i++) + xyz[i] = naNumValue(args[i]).num; + sgCartToGeod(xyz, &lat, &lon, &alt); + lat *= SG_RADIANS_TO_DEGREES; + lon *= SG_RADIANS_TO_DEGREES; + naRef vec = naNewVector(c); + naVec_append(vec, naNum(lat)); + naVec_append(vec, naNum(lon)); + naVec_append(vec, naNum(alt)); + return vec; +} + +// Convert a geodetic lat/lon/altitude to a cartesian point. +static naRef f_geodtocart(naContext c, naRef me, int argc, naRef* args) +{ + if(argc != 3) naRuntimeError(c, "geodtocart() expects 3 arguments"); + double lat = naNumValue(args[0]).num * SG_DEGREES_TO_RADIANS; + double lon = naNumValue(args[1]).num * SG_DEGREES_TO_RADIANS; + double alt = naNumValue(args[2]).num; + double xyz[3]; + sgGeodToCart(lat, lon, alt, xyz); + naRef vec = naNewVector(c); + naVec_append(vec, naNum(xyz[0])); + naVec_append(vec, naNum(xyz[1])); + naVec_append(vec, naNum(xyz[2])); + return vec; +} + +// For given geodetic point return array with elevation, and a material data +// hash, or nil if there's no information available (tile not loaded). If +// information about the material isn't available, then nil is returned instead +// of the hash. +static naRef f_geodinfo(naContext c, naRef me, int argc, naRef* args) +{ +#define HASHSET(s,l,n) naHash_set(matdata, naStr_fromdata(naNewString(c),s,l),n) + if(argc < 2 || argc > 3) + naRuntimeError(c, "geodinfo() expects 2 or 3 arguments: lat, lon [, maxalt]"); + double lat = naNumValue(args[0]).num; + double lon = naNumValue(args[1]).num; + double elev = argc == 3 ? naNumValue(args[2]).num : 10000; + const simgear::BVHMaterial *material; + SGGeod geod = SGGeod::fromDegM(lon, lat, elev); + if(!globals->get_scenery()->get_elevation_m(geod, elev, &material)) + return naNil(); + const SGMaterial *mat = dynamic_cast(material); + naRef vec = naNewVector(c); + naVec_append(vec, naNum(elev)); + naRef matdata = naNil(); + if(mat) { + matdata = naNewHash(c); + naRef names = naNewVector(c); + BOOST_FOREACH(const std::string& n, mat->get_names()) + naVec_append(names, stringToNasal(c, n)); + + HASHSET("names", 5, names); + HASHSET("solid", 5, naNum(mat->get_solid())); + HASHSET("friction_factor", 15, naNum(mat->get_friction_factor())); + HASHSET("rolling_friction", 16, naNum(mat->get_rolling_friction())); + HASHSET("load_resistance", 15, naNum(mat->get_load_resistance())); + HASHSET("bumpiness", 9, naNum(mat->get_bumpiness())); + HASHSET("light_coverage", 14, naNum(mat->get_light_coverage())); + } + naVec_append(vec, matdata); + return vec; +#undef HASHSET +} + + +// Returns data hash for particular or nearest airport of a , or nil +// on error. +// +// airportinfo(); e.g. "KSFO" +// airportinfo(); type := ("airport"|"seaport"|"heliport") +// airportinfo() same as airportinfo("airport") +// airportinfo(, [, ]); +static naRef f_airportinfo(naContext c, naRef me, int argc, naRef* args) +{ + SGGeod pos = globals->get_aircraft_position(); + FGAirport* apt = NULL; + + if(argc >= 2 && naIsNum(args[0]) && naIsNum(args[1])) { + pos = SGGeod::fromDeg(args[1].num, args[0].num); + args += 2; + argc -= 2; + } + + double maxRange = 10000.0; // expose this? or pick a smaller value? + + FGAirport::TypeRunwayFilter filter; // defaults to airports only + + if(argc == 0) { + // fall through and use AIRPORT + } else if(argc == 1 && naIsString(args[0])) { + if (filter.fromTypeString(naStr_data(args[0]))) { + // done! + } else { + // user provided an , hopefully + apt = FGAirport::findByIdent(naStr_data(args[0])); + if (!apt) { + // return nil here, but don't raise a runtime error; this is a + // legitamate way to validate an ICAO code, for example in a + // dialog box or similar. + return naNil(); + } + } + } else { + naRuntimeError(c, "airportinfo() with invalid function arguments"); + return naNil(); + } + + if(!apt) { + apt = FGAirport::findClosest(pos, maxRange, &filter); + if(!apt) return naNil(); + } + + return ghostForAirport(c, apt); +} + +static naRef f_findAirportsWithinRange(naContext c, naRef me, int argc, naRef* args) +{ + int argOffset = 0; + SGGeod pos = globals->get_aircraft_position(); + argOffset += geodFromArgs(args, 0, argc, pos); + + if (!naIsNum(args[argOffset])) { + naRuntimeError(c, "findAirportsWithinRange expected range (in nm) as arg %d", argOffset); + } + + FGAirport::TypeRunwayFilter filter; // defaults to airports only + double rangeNm = args[argOffset++].num; + if (argOffset < argc) { + filter.fromTypeString(naStr_data(args[argOffset++])); + } + + naRef r = naNewVector(c); + + FGPositionedList apts = FGPositioned::findWithinRange(pos, rangeNm, &filter); + FGPositioned::sortByRange(apts, pos); + + BOOST_FOREACH(FGPositionedRef a, apts) { + FGAirport* apt = (FGAirport*) a.get(); + naVec_append(r, ghostForAirport(c, apt)); + } + + return r; +} + +static naRef f_findAirportsByICAO(naContext c, naRef me, int argc, naRef* args) +{ + if (!naIsString(args[0])) { + naRuntimeError(c, "findAirportsByICAO expects string as arg 0"); + } + + int argOffset = 0; + std::string prefix(naStr_data(args[argOffset++])); + FGAirport::TypeRunwayFilter filter; // defaults to airports only + if (argOffset < argc) { + filter.fromTypeString(naStr_data(args[argOffset++])); + } + + naRef r = naNewVector(c); + + FGPositionedList apts = FGPositioned::findAllWithIdent(prefix, &filter, false); + + BOOST_FOREACH(FGPositionedRef a, apts) { + FGAirport* apt = (FGAirport*) a.get(); + naVec_append(r, ghostForAirport(c, apt)); + } + + return r; +} + +static naRef f_airport_tower(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.tower called on non-airport object"); + } + + // build a hash for the tower position + SGGeod towerLoc = apt->getTowerLocation(); + naRef tower = naNewHash(c); + hashset(c, tower, "lat", naNum(towerLoc.getLatitudeDeg())); + hashset(c, tower, "lon", naNum(towerLoc.getLongitudeDeg())); + hashset(c, tower, "elevation", naNum(towerLoc.getElevationM())); + return tower; +} + +static naRef f_airport_comms(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.comms called on non-airport object"); + } + naRef comms = naNewVector(c); + +// if we have an explicit type, return a simple vector of frequencies + if (argc > 0 && !naIsString(args[0])) { + naRuntimeError(c, "airport.comms argument must be a frequency type name"); + } + + if (argc > 0) { + std::string commName = naStr_data(args[0]); + FGPositioned::Type commType = FGPositioned::typeFromName(commName); + + BOOST_FOREACH(flightgear::CommStation* comm, apt->commStationsOfType(commType)) { + naVec_append(comms, naNum(comm->freqMHz())); + } + } else { +// otherwise return a vector of hashes, one for each comm station. + BOOST_FOREACH(flightgear::CommStation* comm, apt->commStations()) { + naRef commHash = naNewHash(c); + hashset(c, commHash, "frequency", naNum(comm->freqMHz())); + hashset(c, commHash, "ident", stringToNasal(c, comm->ident())); + naVec_append(comms, commHash); + } + } + + return comms; +} + +static naRef f_airport_runway(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.runway called on non-airport object"); + } + + if ((argc < 1) || !naIsString(args[0])) { + naRuntimeError(c, "airport.runway expects a runway ident argument"); + } + + std::string ident(naStr_data(args[0])); + boost::to_upper(ident); + + if (apt->hasRunwayWithIdent(ident)) { + return ghostForRunway(c, apt->getRunwayByIdent(ident)); + } else if (apt->hasHelipadWithIdent(ident)) { + return ghostForHelipad(c, apt->getHelipadByIdent(ident)); + } + return naNil(); +} + +static naRef f_airport_runwaysWithoutReciprocals(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.runwaysWithoutReciprocals called on non-airport object"); + } + + FGRunwayList rwylist(apt->getRunwaysWithoutReciprocals()); + naRef runways = naNewVector(c); + for (unsigned int r=0; rgetRunwayByIdent(rwy->ident()))); + } + return runways; +} + +static naRef f_airport_sids(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.sids called on non-airport object"); + } + + naRef sids = naNewVector(c); + + FGRunway* rwy = NULL; + if (argc > 0 && naIsString(args[0])) { + if (!apt->hasRunwayWithIdent(naStr_data(args[0]))) { + return naNil(); + } + + rwy = apt->getRunwayByIdent(naStr_data(args[0])); + } else if (argc > 0) { + rwy = runwayGhost(args[0]); + } + + if (rwy) { + BOOST_FOREACH(flightgear::SID* sid, rwy->getSIDs()) { + naRef procId = stringToNasal(c, sid->ident()); + naVec_append(sids, procId); + } + } else { + for (unsigned int s=0; snumSIDs(); ++s) { + flightgear::SID* sid = apt->getSIDByIndex(s); + naRef procId = stringToNasal(c, sid->ident()); + naVec_append(sids, procId); + } + } + + return sids; +} + +static naRef f_airport_stars(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.stars called on non-airport object"); + } + + naRef stars = naNewVector(c); + + FGRunway* rwy = NULL; + if (argc > 0 && naIsString(args[0])) { + if (!apt->hasRunwayWithIdent(naStr_data(args[0]))) { + return naNil(); + } + + rwy = apt->getRunwayByIdent(naStr_data(args[0])); + } else if (argc > 0) { + rwy = runwayGhost(args[0]); + } + + if (rwy) { + BOOST_FOREACH(flightgear::STAR* s, rwy->getSTARs()) { + naRef procId = stringToNasal(c, s->ident()); + naVec_append(stars, procId); + } + } else { + for (unsigned int s=0; snumSTARs(); ++s) { + flightgear::STAR* star = apt->getSTARByIndex(s); + naRef procId = stringToNasal(c, star->ident()); + naVec_append(stars, procId); + } + } + + return stars; +} + +static naRef f_airport_approaches(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.getApproachList called on non-airport object"); + } + + naRef approaches = naNewVector(c); + + ProcedureType ty = PROCEDURE_INVALID; + if ((argc > 1) && naIsString(args[1])) { + std::string u(naStr_data(args[1])); + boost::to_upper(u); + if (u == "NDB") ty = PROCEDURE_APPROACH_NDB; + if (u == "VOR") ty = PROCEDURE_APPROACH_VOR; + if (u == "ILS") ty = PROCEDURE_APPROACH_ILS; + if (u == "RNAV") ty = PROCEDURE_APPROACH_RNAV; + } + + FGRunway* rwy = NULL; + if (argc > 0 && (rwy = runwayGhost(args[0]))) { + // ok + } else if (argc > 0 && naIsString(args[0])) { + if (!apt->hasRunwayWithIdent(naStr_data(args[0]))) { + return naNil(); + } + + rwy = apt->getRunwayByIdent(naStr_data(args[0])); + } + + if (rwy) { + BOOST_FOREACH(Approach* s, rwy->getApproaches()) { + if ((ty != PROCEDURE_INVALID) && (s->type() != ty)) { + continue; + } + + naRef procId = stringToNasal(c, s->ident()); + naVec_append(approaches, procId); + } + } else { + // no runway specified, report them all + for (unsigned int s=0; snumApproaches(); ++s) { + Approach* app = apt->getApproachByIndex(s); + if ((ty != PROCEDURE_INVALID) && (app->type() != ty)) { + continue; + } + + naRef procId = stringToNasal(c, app->ident()); + naVec_append(approaches, procId); + } + } + + return approaches; +} + +static naRef f_airport_parking(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.parking called on non-airport object"); + } + + naRef r = naNewVector(c); + std::string type; + bool onlyAvailable = false; + + if (argc > 0 && naIsString(args[0])) { + type = naStr_data(args[0]); + } + + if ((argc > 1) && naIsNum(args[1])) { + onlyAvailable = (args[1].num != 0.0); + } + + FGAirportDynamics* dynamics = apt->getDynamics(); + PositionedIDVec parkings = flightgear::NavDataCache::instance()->airportItemsOfType(apt->guid(), + FGPositioned::PARKING); + + BOOST_FOREACH(PositionedID parking, parkings) { + // filter out based on availability and type + if (onlyAvailable && !dynamics->isParkingAvailable(parking)) { + continue; + } + + FGParking* park = dynamics->getParking(parking); + if (!type.empty() && (park->getType() != type)) { + continue; + } + + const SGGeod& parkLoc = park->geod(); + naRef ph = naNewHash(c); + hashset(c, ph, "name", stringToNasal(c, park->getName())); + hashset(c, ph, "lat", naNum(parkLoc.getLatitudeDeg())); + hashset(c, ph, "lon", naNum(parkLoc.getLongitudeDeg())); + hashset(c, ph, "elevation", naNum(parkLoc.getElevationM())); + naVec_append(r, ph); + } + + return r; +} + +static naRef f_airport_getSid(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.getSid called on non-airport object"); + } + + if ((argc != 1) || !naIsString(args[0])) { + naRuntimeError(c, "airport.getSid passed invalid argument"); + } + + std::string ident = naStr_data(args[0]); + return ghostForProcedure(c, apt->findSIDWithIdent(ident)); +} + +static naRef f_airport_getStar(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.getStar called on non-airport object"); + } + + if ((argc != 1) || !naIsString(args[0])) { + naRuntimeError(c, "airport.getStar passed invalid argument"); + } + + std::string ident = naStr_data(args[0]); + return ghostForProcedure(c, apt->findSTARWithIdent(ident)); +} + +static naRef f_airport_getApproach(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.getIAP called on non-airport object"); + } + + if ((argc != 1) || !naIsString(args[0])) { + naRuntimeError(c, "airport.getIAP passed invalid argument"); + } + + std::string ident = naStr_data(args[0]); + return ghostForProcedure(c, apt->findApproachWithIdent(ident)); +} + +static naRef f_airport_findBestRunway(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "findBestRunway called on non-airport object"); + } + + SGGeod pos; + if (!geodFromArgs(args, 0, argc, pos)) { + naRuntimeError(c, "findBestRunway must be passed a position"); + } + + return ghostForRunway(c, apt->findBestRunwayForPos(pos)); +} + +static naRef f_airport_toString(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.tostring called on non-airport object"); + } + + return stringToNasal(c, "an airport " + apt->ident()); +} + +// Returns vector of data hash for navaid of a , nil on error +// navaids sorted by ascending distance +// navinfo([,],[],[]) +// lat/lon (numeric): use latitude/longitude instead of ac position +// type: ("fix"|"vor"|"ndb"|"ils"|"dme"|"tacan"|"any") +// id: (partial) id of the fix +// examples: +// navinfo("vor") returns all vors +// navinfo("HAM") return all navaids who's name start with "HAM" +// navinfo("vor", "HAM") return all vor who's name start with "HAM" +//navinfo(34,48,"vor","HAM") return all vor who's name start with "HAM" +// sorted by distance relative to lat=34, lon=48 +static naRef f_navinfo(naContext c, naRef me, int argc, naRef* args) +{ + SGGeod pos; + + if(argc >= 2 && naIsNum(args[0]) && naIsNum(args[1])) { + pos = SGGeod::fromDeg(args[1].num, args[0].num); + args += 2; + argc -= 2; + } else { + pos = globals->get_aircraft_position(); + } + + FGPositioned::Type type = FGPositioned::INVALID; + nav_list_type navlist; + const char * id = ""; + + if(argc > 0 && naIsString(args[0])) { + const char *s = naStr_data(args[0]); + if(!strcmp(s, "any")) type = FGPositioned::INVALID; + else if(!strcmp(s, "fix")) type = FGPositioned::FIX; + else if(!strcmp(s, "vor")) type = FGPositioned::VOR; + else if(!strcmp(s, "ndb")) type = FGPositioned::NDB; + else if(!strcmp(s, "ils")) type = FGPositioned::ILS; + else if(!strcmp(s, "dme")) type = FGPositioned::DME; + else if(!strcmp(s, "tacan")) type = FGPositioned::TACAN; + else id = s; // this is an id + ++args; + --argc; + } + + if(argc > 0 && naIsString(args[0])) { + if( *id != 0 ) { + naRuntimeError(c, "navinfo() called with navaid id"); + return naNil(); + } + id = naStr_data(args[0]); + ++args; + --argc; + } + + if( argc > 0 ) { + naRuntimeError(c, "navinfo() called with too many arguments"); + return naNil(); + } + + FGNavList::TypeFilter filter(type); + navlist = FGNavList::findByIdentAndFreq( pos, id, 0.0, &filter ); + + naRef reply = naNewVector(c); + for( nav_list_type::const_iterator it = navlist.begin(); it != navlist.end(); ++it ) { + naVec_append( reply, ghostForNavaid(c, *it) ); + } + return reply; +} + +static naRef f_findNavaidsWithinRange(naContext c, naRef me, int argc, naRef* args) +{ + int argOffset = 0; + SGGeod pos = globals->get_aircraft_position(); + argOffset += geodFromArgs(args, 0, argc, pos); + + if (!naIsNum(args[argOffset])) { + naRuntimeError(c, "findNavaidsWithinRange expected range (in nm) as arg %d", argOffset); + } + + FGPositioned::Type type = FGPositioned::INVALID; double rangeNm = args[argOffset++].num; if (argOffset < argc) { - filter.fromArg(args[argOffset++]); + type = FGPositioned::typeFromName(naStr_data(args[argOffset])); + } + + naRef r = naNewVector(c); + FGNavList::TypeFilter filter(type); + FGPositionedList navs = FGPositioned::findWithinRange(pos, rangeNm, &filter); + FGPositioned::sortByRange(navs, pos); + + BOOST_FOREACH(FGPositionedRef a, navs) { + FGNavRecord* nav = (FGNavRecord*) a.get(); + naVec_append(r, ghostForNavaid(c, nav)); + } + + return r; +} + +static naRef f_findNavaidByFrequency(naContext c, naRef me, int argc, naRef* args) +{ + int argOffset = 0; + SGGeod pos = globals->get_aircraft_position(); + argOffset += geodFromArgs(args, 0, argc, pos); + + if (!naIsNum(args[argOffset])) { + naRuntimeError(c, "findNavaidByFrequency expectes frequency (in Mhz) as arg %d", argOffset); + } + + FGPositioned::Type type = FGPositioned::INVALID; + double freqMhz = args[argOffset++].num; + if (argOffset < argc) { + type = FGPositioned::typeFromName(naStr_data(args[argOffset])); + } + + FGNavList::TypeFilter filter(type); + nav_list_type navs = FGNavList::findAllByFreq(freqMhz, pos, &filter); + if (navs.empty()) { + return naNil(); + } + + return ghostForNavaid(c, navs.front().ptr()); +} + +static naRef f_findNavaidsByFrequency(naContext c, naRef me, int argc, naRef* args) +{ + int argOffset = 0; + SGGeod pos = globals->get_aircraft_position(); + argOffset += geodFromArgs(args, 0, argc, pos); + + if (!naIsNum(args[argOffset])) { + naRuntimeError(c, "findNavaidsByFrequency expectes frequency (in Mhz) as arg %d", argOffset); + } + + FGPositioned::Type type = FGPositioned::INVALID; + double freqMhz = args[argOffset++].num; + if (argOffset < argc) { + type = FGPositioned::typeFromName(naStr_data(args[argOffset])); } naRef r = naNewVector(c); - FGPositioned::List apts = FGPositioned::findWithinRange(pos, rangeNm, &filter); - FGPositioned::sortByRange(apts, pos); + FGNavList::TypeFilter filter(type); + nav_list_type navs = FGNavList::findAllByFreq(freqMhz, pos, &filter); - BOOST_FOREACH(FGPositionedRef a, apts) { - FGAirport* apt = (FGAirport*) a.get(); - naVec_append(r, hashForAirport(c, apt)); + BOOST_FOREACH(nav_rec_ptr a, navs) { + naVec_append(r, ghostForNavaid(c, a.ptr())); } return r; } -static naRef f_findAirportsByICAO(naContext c, naRef me, int argc, naRef* args) +static naRef f_findNavaidsByIdent(naContext c, naRef me, int argc, naRef* args) { - if (!naIsString(args[0])) { - naRuntimeError(c, "findAirportsByICAO expects string as arg 0"); + int argOffset = 0; + SGGeod pos = globals->get_aircraft_position(); + argOffset += geodFromArgs(args, 0, argc, pos); + + if (!naIsString(args[argOffset])) { + naRuntimeError(c, "findNavaidsByIdent expectes ident string as arg %d", argOffset); } - int argOffset = 0; - string prefix(naStr_data(args[argOffset++])); - AirportInfoFilter filter; // defaults to airports only + FGPositioned::Type type = FGPositioned::INVALID; + std::string ident = naStr_data(args[argOffset++]); if (argOffset < argc) { - filter.fromArg(args[argOffset++]); + type = FGPositioned::typeFromName(naStr_data(args[argOffset])); } + FGNavList::TypeFilter filter(type); naRef r = naNewVector(c); + nav_list_type navs = FGNavList::findByIdentAndFreq(pos, ident, 0.0, &filter); - FGPositioned::List apts = FGPositioned::findAllWithIdent(prefix, &filter, false); - - BOOST_FOREACH(FGPositionedRef a, apts) { - FGAirport* apt = (FGAirport*) a.get(); - naVec_append(r, hashForAirport(c, apt)); + BOOST_FOREACH(nav_rec_ptr a, navs) { + naVec_append(r, ghostForNavaid(c, a.ptr())); } return r; } -static FGAirport* airportFromMe(naRef me) -{ - naRef ghost = naHash_cget(me, (char*) "_positioned"); - if (naIsNil(ghost)) { - return NULL; - } +static naRef f_findFixesByIdent(naContext c, naRef me, int argc, naRef* args) +{ + int argOffset = 0; + SGGeod pos = globals->get_aircraft_position(); + argOffset += geodFromArgs(args, 0, argc, pos); - FGPositioned* pos = positionedGhost(ghost); - if (pos && FGAirport::isAirportType(pos)) { - return (FGAirport*) pos; - } - - return NULL; + if (!naIsString(args[argOffset])) { + naRuntimeError(c, "findFixesByIdent expectes ident string as arg %d", argOffset); + } + + std::string ident(naStr_data(args[argOffset])); + naRef r = naNewVector(c); + + FGPositioned::TypeFilter filter(FGPositioned::FIX); + FGPositionedList fixes = FGPositioned::findAllWithIdent(ident, &filter); + FGPositioned::sortByRange(fixes, pos); + + BOOST_FOREACH(FGPositionedRef f, fixes) { + naVec_append(r, ghostForFix(c, (FGFix*) f.ptr())); + } + + return r; } -static naRef f_airport_tower(naContext c, naRef me, int argc, naRef* args) +// Convert a cartesian point to a geodetic lat/lon/altitude. +static naRef f_magvar(naContext c, naRef me, int argc, naRef* args) { - FGAirport* apt = airportFromMe(me); - if (!apt) { - naRuntimeError(c, "airport.tower called on non-airport object"); - } + SGGeod pos = globals->get_aircraft_position(); + if (argc == 0) { + // fine, use aircraft position + } else if (geodFromArgs(args, 0, argc, pos)) { + // okay + } else { + naRuntimeError(c, "magvar() expects no arguments, a positioned hash or lat,lon pair"); + } - // build a hash for the tower position - SGGeod towerLoc = apt->getTowerLocation(); - naRef tower = naNewHash(c); - hashset(c, tower, "lat", naNum(towerLoc.getLatitudeDeg())); - hashset(c, tower, "lon", naNum(towerLoc.getLongitudeDeg())); - hashset(c, tower, "elevation", naNum(towerLoc.getElevationM())); - return tower; + double jd = globals->get_time_params()->getJD(); + double magvarDeg = sgGetMagVar(pos, jd) * SG_RADIANS_TO_DEGREES; + return naNum(magvarDeg); } -static naRef f_airport_comms(naContext c, naRef me, int argc, naRef* args) +static naRef f_courseAndDistance(naContext c, naRef me, int argc, naRef* args) { - FGAirport* apt = airportFromMe(me); - if (!apt) { - naRuntimeError(c, "airport.comms called on non-airport object"); - } - naRef comms = naNewVector(c); - -// if we have an explicit type, return a simple vector of frequencies - if (argc > 0 && naIsScalar(args[0])) { - std::string commName = naStr_data(args[0]); - FGPositioned::Type commType = FGPositioned::typeFromName(commName); - - BOOST_FOREACH(flightgear::CommStation* comm, apt->commStationsOfType(commType)) { - naVec_append(comms, naNum(comm->freqMHz())); - } + SGGeod from = globals->get_aircraft_position(), to, p; + int argOffset = geodFromArgs(args, 0, argc, p); + if (geodFromArgs(args, argOffset, argc, to)) { + from = p; // we parsed both FROM and TO args, so first was from } else { -// otherwise return a vector of hashes, one for each comm station. - BOOST_FOREACH(flightgear::CommStation* comm, apt->commStations()) { - naRef commHash = naNewHash(c); - hashset(c, commHash, "frequency", naNum(comm->freqMHz())); - hashset(c, commHash, "ident", stringToNasal(c, comm->ident())); - naVec_append(comms, commHash); - } + to = p; // only parsed one arg, so FROM is current + } + + if (argOffset == 0) { + naRuntimeError(c, "invalid arguments to courseAndDistance"); } - return comms; + double course, course2, d; + SGGeodesy::inverse(from, to, course, course2, d); + + naRef result = naNewVector(c); + naVec_append(result, naNum(course)); + naVec_append(result, naNum(d * SG_METER_TO_NM)); + return result; } -static naRef f_airport_sids(naContext c, naRef me, int argc, naRef* args) +static naRef f_greatCircleMove(naContext c, naRef me, int argc, naRef* args) { - FGAirport* apt = airportFromMe(me); - if (!apt) { - naRuntimeError(c, "airport.sids called on non-airport object"); + SGGeod from = globals->get_aircraft_position(), to; + int argOffset = 0; + + // complication - don't inerpret two doubles (as the only args) + // as a lat,lon pair - only do so if we have at least three args. + if (argc > 2) { + argOffset = geodFromArgs(args, 0, argc, from); } - naRef sids = naNewVector(c); + if ((argOffset + 1) >= argc) { + naRuntimeError(c, "isufficent arguments to greatCircleMove"); + } - // if we have an explicit type, return a simple vector of frequencies - if (argc > 0 && naIsString(args[0])) { - if (!apt->hasRunwayWithIdent(naStr_data(args[0]))) { - return naNil(); - } - - FGRunway* rwy = apt->getRunwayByIdent(naStr_data(args[0])); - BOOST_FOREACH(flightgear::SID* sid, rwy->getSIDs()) { - naRef procId = stringToNasal(c, sid->ident()); - naVec_append(sids, procId); - } - } else { - for (unsigned int s=0; snumSIDs(); ++s) { - flightgear::SID* sid = apt->getSIDByIndex(s); - naRef procId = stringToNasal(c, sid->ident()); - naVec_append(sids, procId); - } + if (!naIsNum(args[argOffset]) || !naIsNum(args[argOffset+1])) { + naRuntimeError(c, "invalid arguments %d and %d to greatCircleMove", + argOffset, argOffset + 1); } - return sids; + double course = args[argOffset].num, course2; + double distanceNm = args[argOffset + 1].num; + SGGeodesy::direct(from, course, distanceNm * SG_NM_TO_METER, to, course2); + + // return geo.Coord + naRef coord = naNewHash(c); + hashset(c, coord, "lat", naNum(to.getLatitudeDeg())); + hashset(c, coord, "lon", naNum(to.getLongitudeDeg())); + return coord; } -static naRef f_airport_stars(naContext c, naRef me, int argc, naRef* args) +static naRef f_tilePath(naContext c, naRef me, int argc, naRef* args) { - FGAirport* apt = airportFromMe(me); - if (!apt) { - naRuntimeError(c, "airport.stars called on non-airport object"); + SGGeod pos = globals->get_aircraft_position(); + geodFromArgs(args, 0, argc, pos); + SGBucket b(pos); + return stringToNasal(c, b.gen_base_path()); +} + +static naRef f_tileIndex(naContext c, naRef me, int argc, naRef* args) +{ + SGGeod pos = globals->get_aircraft_position(); + geodFromArgs(args, 0, argc, pos); + SGBucket b(pos); + return naNum(b.gen_index()); +} + +static naRef f_route(naContext c, naRef me, int argc, naRef* args) +{ + if (argc == 0) { + FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); + return ghostForFlightPlan(c, rm->flightPlan()); } - naRef stars = naNewVector(c); - - // if we have an explicit type, return a simple vector of frequencies - if (argc > 0 && naIsString(args[0])) { - if (!apt->hasRunwayWithIdent(naStr_data(args[0]))) { - return naNil(); - } - - FGRunway* rwy = apt->getRunwayByIdent(naStr_data(args[0])); - BOOST_FOREACH(flightgear::STAR* s, rwy->getSTARs()) { - naRef procId = stringToNasal(c, s->ident()); - naVec_append(stars, procId); + if ((argc > 0) && naIsString(args[0])) { + flightgear::FlightPlan* fp = new flightgear::FlightPlan; + SGPath path(naStr_data(args[0])); + if (!path.exists()) { + naRuntimeError(c, "flightplan, no file at path %s", path.c_str()); } - } else { - for (unsigned int s=0; snumSTARs(); ++s) { - flightgear::STAR* star = apt->getSTARByIndex(s); - naRef procId = stringToNasal(c, star->ident()); - naVec_append(stars, procId); + + if (!fp->load(path)) { + SG_LOG(SG_NASAL, SG_WARN, "failed to load flight-plan from " << path); + delete fp; + return naNil(); } + + return ghostForFlightPlan(c, fp); } - return stars; + naRuntimeError(c, "bad arguments to flightplan()"); + return naNil(); } -static naRef f_airport_parking(naContext c, naRef me, int argc, naRef* args) +class NasalFPDelegate : public FlightPlan::Delegate { - FGAirport* apt = airportFromMe(me); - if (!apt) { - naRuntimeError(c, "airport.parking called on non-airport object"); +public: + NasalFPDelegate(FlightPlan* fp, FGNasalSys* sys, naRef ins) : + _nasal(sys), + _plan(fp), + _instance(ins) + { + _gcSaveKey = _nasal->gcSave(ins); } - naRef r = naNewVector(c); - std::string type; - bool onlyAvailable = false; + virtual ~NasalFPDelegate() + { + _nasal->gcRelease(_gcSaveKey); + } - if (argc > 0 && naIsString(args[0])) { - type = naStr_data(args[0]); + virtual void departureChanged() + { + callDelegateMethod("departureChanged"); } - if ((argc > 1) && naIsNum(args[1])) { - onlyAvailable = (args[1].num != 0.0); + virtual void arrivalChanged() + { + callDelegateMethod("arrivalChanged"); } - FGAirportDynamics* dynamics = apt->getDynamics(); - for (int i=0; igetNrOfParkings(); ++i) { - FGParking* park = dynamics->getParking(i); - // filter out based on availability and type - if (onlyAvailable && !park->isAvailable()) { - continue; - } + virtual void waypointsChanged() + { + callDelegateMethod("waypointsChanged"); + } + + virtual void currentWaypointChanged() + { + callDelegateMethod("currentWaypointChanged"); + } - if (!type.empty() && (park->getType() != type)) { - continue; + virtual void cleared() + { + callDelegateMethod("cleared"); + } + + virtual void endOfFlightPlan() + { + callDelegateMethod("endOfFlightPlan"); + } +private: + + void callDelegateMethod(const char* method) + { + naRef f; + if (naMember_cget(_nasal->context(), _instance, method, &f) == 0) { + return; // no method on the delegate } - naRef nm = stringToNasal(c, park->getName()); - naVec_append(r, nm); + naRef arg[1]; + arg[0] = ghostForFlightPlan(_nasal->context(), _plan); + _nasal->callMethod(f, _instance, 1, arg, naNil()); } - return r; -} + FGNasalSys* _nasal; + FlightPlan* _plan; + naRef _instance; + int _gcSaveKey; +}; -// Returns vector of data hash for navaid of a , nil on error -// navaids sorted by ascending distance -// navinfo([,],[],[]) -// lat/lon (numeric): use latitude/longitude instead of ac position -// type: ("fix"|"vor"|"ndb"|"ils"|"dme"|"tacan"|"any") -// id: (partial) id of the fix -// examples: -// navinfo("vor") returns all vors -// navinfo("HAM") return all navaids who's name start with "HAM" -// navinfo("vor", "HAM") return all vor who's name start with "HAM" -//navinfo(34,48,"vor","HAM") return all vor who's name start with "HAM" -// sorted by distance relative to lat=34, lon=48 -static naRef f_navinfo(naContext c, naRef me, int argc, naRef* args) +class NasalFPDelegateFactory : public FlightPlan::DelegateFactory { - SGGeod pos; - - if(argc >= 2 && naIsNum(args[0]) && naIsNum(args[1])) { - pos = SGGeod::fromDeg(args[1].num, args[0].num); - args += 2; - argc -= 2; - } else { - pos = globals->get_aircraft_position(); +public: + NasalFPDelegateFactory(naRef code) + { + _nasal = (FGNasalSys*) globals->get_subsystem("nasal"); + _func = code; + _gcSaveKey = _nasal->gcSave(_func); } - FGPositioned::Type type = FGPositioned::INVALID; - nav_list_type navlist; - const char * id = ""; - - if(argc > 0 && naIsString(args[0])) { - const char *s = naStr_data(args[0]); - if(!strcmp(s, "any")) type = FGPositioned::INVALID; - else if(!strcmp(s, "fix")) type = FGPositioned::FIX; - else if(!strcmp(s, "vor")) type = FGPositioned::VOR; - else if(!strcmp(s, "ndb")) type = FGPositioned::NDB; - else if(!strcmp(s, "ils")) type = FGPositioned::ILS; - else if(!strcmp(s, "dme")) type = FGPositioned::DME; - else if(!strcmp(s, "tacan")) type = FGPositioned::TACAN; - else id = s; // this is an id - ++args; - --argc; - } + ~NasalFPDelegateFactory() + { + _nasal->gcRelease(_gcSaveKey); + } - if(argc > 0 && naIsString(args[0])) { - if( *id != 0 ) { - naRuntimeError(c, "navinfo() called with navaid id"); - return naNil(); + virtual FlightPlan::Delegate* createFlightPlanDelegate(FlightPlan* fp) + { + naRef args[1]; + args[0] = ghostForFlightPlan(_nasal->context(), fp); + naRef instance = _nasal->call(_func, 1, args, naNil()); + if (naIsNil(instance)) { + return NULL; } - id = naStr_data(args[0]); - ++args; - --argc; + + return new NasalFPDelegate(fp, _nasal, instance); } - - if( argc > 0 ) { - naRuntimeError(c, "navinfo() called with too many arguments"); - return naNil(); +private: + FGNasalSys* _nasal; + naRef _func; + int _gcSaveKey; +}; + +static naRef f_registerFPDelegate(naContext c, naRef me, int argc, naRef* args) +{ + if ((argc < 1) || !naIsFunc(args[0])) { + naRuntimeError(c, "non-function argument to registerFlightPlanDelegate"); } - navlist = globals->get_navlist()->findByIdentAndFreq( pos, id, 0.0, type ); + NasalFPDelegateFactory* factory = new NasalFPDelegateFactory(args[0]); + FlightPlan::registerDelegateFactory(factory); - naRef reply = naNewVector(c); - for( nav_list_type::const_iterator it = navlist.begin(); it != navlist.end(); ++it ) { - naVec_append( reply, hashForNavRecord(c, *it, pos) ); - } - return reply; + return naNil(); } -static naRef f_findNavaidsWithinRange(naContext c, naRef me, int argc, naRef* args) +static WayptRef wayptFromArg(naRef arg) { - int argOffset = 0; - SGGeod pos = globals->get_aircraft_position(); - argOffset += geodFromArgs(args, 0, argc, pos); - - if (!naIsNum(args[argOffset])) { - naRuntimeError(c, "findNavaidsWithinRange expected range (in nm) as arg %d", argOffset); + WayptRef r = wayptGhost(arg); + if (r.valid()) { + return r; } - FGPositioned::Type type = FGPositioned::INVALID; - double rangeNm = args[argOffset++].num; - if (argOffset < argc) { - type = FGPositioned::typeFromName(naStr_data(args[argOffset])); + FGPositioned* pos = positionedGhost(arg); + if (!pos) { + // let's check if the arg is hash, coudl extra a geod and hence build + // a simple waypoint + + return WayptRef(); } - naRef r = naNewVector(c); - FGNavList::TypeFilter filter(type); - FGPositioned::List navs = FGPositioned::findWithinRange(pos, rangeNm, &filter); - FGPositioned::sortByRange(navs, pos); - - BOOST_FOREACH(FGPositionedRef a, navs) { - FGNavRecord* nav = (FGNavRecord*) a.get(); - naVec_append(r, hashForNavRecord(c, nav, pos)); +// special-case for runways + if (pos->type() == FGPositioned::RUNWAY) { + return new RunwayWaypt((FGRunway*) pos, NULL); } - return r; + return new NavaidWaypoint(pos, NULL); } -static naRef f_findNavaidByFrequency(naContext c, naRef me, int argc, naRef* args) +static naRef convertWayptVecToNasal(naContext c, const WayptVec& wps) { - int argOffset = 0; - SGGeod pos = globals->get_aircraft_position(); - argOffset += geodFromArgs(args, 0, argc, pos); + naRef result = naNewVector(c); + BOOST_FOREACH(WayptRef wpt, wps) { + naVec_append(result, ghostForWaypt(c, wpt.get())); + } + return result; +} + +static naRef f_airwaySearch(naContext c, naRef me, int argc, naRef* args) +{ + if (argc < 2) { + naRuntimeError(c, "airwaysSearch needs at least two arguments"); + } - if (!naIsNum(args[argOffset])) { - naRuntimeError(c, "findNavaidByFrequency expectes frequency (in Mhz) as arg %d", argOffset); + WayptRef start = wayptFromArg(args[0]), + end = wayptFromArg(args[1]); + + if (!start || !end) { + SG_LOG(SG_NASAL, SG_WARN, "airwaysSearch: start or end points are invalid"); + return naNil(); } - FGPositioned::Type type = FGPositioned::INVALID; - double freqMhz = args[argOffset++].num; - if (argOffset < argc) { - type = FGPositioned::typeFromName(naStr_data(args[argOffset])); + bool highLevel = true; + if ((argc > 2) && naIsString(args[2])) { + if (!strcmp(naStr_data(args[2]), "lowlevel")) { + highLevel = false; + } } - nav_list_type navs = globals->get_navlist()->findAllByFreq(freqMhz, pos, type); - if (navs.empty()) { - return naNil(); + WayptVec route; + if (highLevel) { + Airway::highLevel()->route(start, end, route); + } else { + Airway::lowLevel()->route(start, end, route); } - return hashForNavRecord(c, navs.front().ptr(), pos); + return convertWayptVecToNasal(c, route); } -static naRef f_findNavaidsByFrequency(naContext c, naRef me, int argc, naRef* args) +static naRef f_createWP(naContext c, naRef me, int argc, naRef* args) { - int argOffset = 0; - SGGeod pos = globals->get_aircraft_position(); - argOffset += geodFromArgs(args, 0, argc, pos); + SGGeod pos; + int argOffset = geodFromArgs(args, 0, argc, pos); - if (!naIsNum(args[argOffset])) { - naRuntimeError(c, "findNavaidsByFrequency expectes frequency (in Mhz) as arg %d", argOffset); + if (((argc - argOffset) < 1) || !naIsString(args[argOffset])) { + naRuntimeError(c, "createWP: no identifier supplied"); + } + + std::string ident = naStr_data(args[argOffset++]); + WayptRef wpt = new BasicWaypt(pos, ident, NULL); + +// set waypt flags - approach, departure, pseudo, etc + if (argc > argOffset) { + WayptFlag f = wayptFlagFromString(naStr_data(args[argOffset++])); + if (f == 0) { + naRuntimeError(c, "createWP: bad waypoint role"); + } + + wpt->setFlag(f); } - FGPositioned::Type type = FGPositioned::INVALID; - double freqMhz = args[argOffset++].num; - if (argOffset < argc) { - type = FGPositioned::typeFromName(naStr_data(args[argOffset])); + return ghostForWaypt(c, wpt); +} + +static naRef f_createWPFrom(naContext c, naRef me, int argc, naRef* args) +{ + if (argc < 1) { + naRuntimeError(c, "createWPFrom: need at least one argument"); } - naRef r = naNewVector(c); - nav_list_type navs = globals->get_navlist()->findAllByFreq(freqMhz, pos, type); + FGPositioned* positioned = positionedGhost(args[0]); + if (!positioned) { + naRuntimeError(c, "createWPFrom: couldn;t convert arg[0] to FGPositioned"); + } - BOOST_FOREACH(nav_rec_ptr a, navs) { - naVec_append(r, hashForNavRecord(c, a.ptr(), pos)); + WayptRef wpt; + if (positioned->type() == FGPositioned::RUNWAY) { + wpt = new RunwayWaypt((FGRunway*) positioned, NULL); + } else { + wpt = new NavaidWaypoint(positioned, NULL); + } + + // set waypt flags - approach, departure, pseudo, etc + if (argc > 1) { + WayptFlag f = wayptFlagFromString(naStr_data(args[1])); + if (f == 0) { + naRuntimeError(c, "createWPFrom: bad waypoint role"); + } + wpt->setFlag(f); } - return r; + return ghostForWaypt(c, wpt); } -static naRef f_findNavaidsByIdent(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_getWP(naContext c, naRef me, int argc, naRef* args) { - int argOffset = 0; - SGGeod pos = globals->get_aircraft_position(); - argOffset += geodFromArgs(args, 0, argc, pos); - - if (!naIsString(args[argOffset])) { - naRuntimeError(c, "findNavaidsByIdent expectes ident string as arg %d", argOffset); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.getWP called on non-flightplan object"); } - - FGPositioned::Type type = FGPositioned::INVALID; - string ident = naStr_data(args[argOffset++]); - if (argOffset < argc) { - type = FGPositioned::typeFromName(naStr_data(args[argOffset])); + + int index; + if (argc == 0) { + index = fp->currentIndex(); + } else { + index = (int) naNumValue(args[0]).num; } - naRef r = naNewVector(c); - nav_list_type navs = globals->get_navlist()->findByIdentAndFreq(pos, ident, 0.0, type); - - BOOST_FOREACH(nav_rec_ptr a, navs) { - naVec_append(r, hashForNavRecord(c, a.ptr(), pos)); + if ((index < 0) || (index >= fp->numLegs())) { + return naNil(); } - return r; + return ghostForLeg(c, fp->legAtIndex(index)); +} + +static naRef f_flightplan_currentWP(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.currentWP called on non-flightplan object"); + } + return ghostForLeg(c, fp->currentLeg()); } +static naRef f_flightplan_nextWP(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.nextWP called on non-flightplan object"); + } + return ghostForLeg(c, fp->nextLeg()); +} -// Convert a cartesian point to a geodetic lat/lon/altitude. -static naRef f_magvar(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_numWaypoints(naContext c, naRef me, int argc, naRef* args) { - SGGeod pos = globals->get_aircraft_position(); - if (argc == 0) { - // fine, use aircraft position - } else if (geodFromArgs(args, 0, argc, pos)) { - // okay - } else { - naRuntimeError(c, "magvar() expects no arguments, a positioned hash or lat,lon pair"); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.numWaypoints called on non-flightplan object"); + } + return naNum(fp->numLegs()); +} + +static naRef f_flightplan_appendWP(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.appendWP called on non-flightplan object"); } - double jd = globals->get_time_params()->getJD(); - double magvarDeg = sgGetMagVar(pos, jd) * SG_RADIANS_TO_DEGREES; - return naNum(magvarDeg); + WayptRef wp = wayptGhost(args[0]); + int index = fp->numLegs(); + fp->insertWayptAtIndex(wp.get(), index); + return naNum(index); } -static naRef f_courseAndDistance(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_insertWP(naContext c, naRef me, int argc, naRef* args) { - SGGeod from = globals->get_aircraft_position(), to, p; - int argOffset = geodFromArgs(args, 0, argc, p); - if (geodFromArgs(args, argOffset, argc, to)) { - from = p; // we parsed both FROM and TO args, so first was from - } else { - to = p; // only parsed one arg, so FROM is current - } + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.insertWP called on non-flightplan object"); + } - if (argOffset == 0) { - naRuntimeError(c, "invalid arguments to courseAndDistance"); - } - - double course, course2, d; - SGGeodesy::inverse(from, to, course, course2, d); - - naRef result = naNewVector(c); - naVec_append(result, naNum(course)); - naVec_append(result, naNum(d * SG_METER_TO_NM)); - return result; + WayptRef wp = wayptGhost(args[0]); + int index = -1; // append + if ((argc > 1) && naIsNum(args[1])) { + index = (int) args[1].num; + } + + fp->insertWayptAtIndex(wp.get(), index); + return naNil(); } -static naRef f_tilePath(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_insertWPAfter(naContext c, naRef me, int argc, naRef* args) { - SGGeod pos = globals->get_aircraft_position(); - geodFromArgs(args, 0, argc, pos); - SGBucket b(pos); - return stringToNasal(c, b.gen_base_path()); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.insertWPAfter called on non-flightplan object"); + } + + WayptRef wp = wayptGhost(args[0]); + int index = -1; // append + if ((argc > 1) && naIsNum(args[1])) { + index = (int) args[1].num; + } + + fp->insertWayptAtIndex(wp.get(), index + 1); + return naNil(); } -static naRef f_route(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_insertWaypoints(naContext c, naRef me, int argc, naRef* args) { - naRef route = naNewHash(c); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.insertWaypoints called on non-flightplan object"); + } + + WayptVec wps; + if (!naIsVector(args[0])) { + naRuntimeError(c, "flightplan.insertWaypoints expects vector as first arg"); + } + + int count = naVec_size(args[0]); + for (int i=0; i 1) && naIsNum(args[1])) { + index = (int) args[1].num; + } + + fp->insertWayptsAtIndex(wps, index); + return naNil(); +} + +static naRef f_flightplan_deleteWP(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.deleteWP called on non-flightplan object"); + } - naRef parents = naNewVector(c); - naVec_append(parents, routePrototype); - hashset(c, route, "parents", parents); + if ((argc < 1) || !naIsNum(args[0])) { + naRuntimeError(c, "bad argument to flightplan.deleteWP"); + } - return route; + int index = (int) args[0].num; + fp->deleteIndex(index); + return naNil(); } -static naRef f_route_getWP(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_clearPlan(naContext c, naRef me, int argc, naRef* args) { - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.clearPlan called on non-flightplan object"); + } - int index; - if (argc == 0) { - index = rm->currentIndex(); - } else { - index = (int) naNumValue(args[0]).num; + fp->clear(); + return naNil(); +} + +static naRef f_flightplan_clearWPType(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.clearWPType called on non-flightplan object"); } - if ((index < 0) || (index >= rm->numWaypts())) { - return naNil(); + if (argc < 1) { + naRuntimeError(c, "insufficent args to flightplan.clearWPType"); } - flightgear::Waypt* next = NULL; - if (index < (rm->numWaypts() - 1)) { - next = rm->wayptAtIndex(index + 1); + WayptFlag flag = wayptFlagFromString(naStr_data(args[0])); + if (flag == 0) { + naRuntimeError(c, "clearWPType: bad waypoint role"); + } + + fp->clearWayptsWithFlag(flag); + return naNil(); +} + +static naRef f_flightplan_clone(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.clone called on non-flightplan object"); } - return hashForWaypoint(c, rm->wayptAtIndex(index), next); + + return ghostForFlightPlan(c, fp->clone()); } -static naRef f_route_currentWP(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_pathGeod(naContext c, naRef me, int argc, naRef* args) { - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); - flightgear::Waypt* next = NULL; - if (rm->currentIndex() < (rm->numWaypts() - 1)) { - next = rm->wayptAtIndex(rm->currentIndex() + 1); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.clone called on non-flightplan object"); + } + + if ((argc < 1) || !naIsNum(args[0])) { + naRuntimeError(c, "bad argument to flightplan.pathGeod"); + } + + if ((argc > 1) && !naIsNum(args[1])) { + naRuntimeError(c, "bad argument to flightplan.pathGeod"); } - return hashForWaypoint(c, rm->currentWaypt(), next); + + int index = (int) args[0].num; + double offset = (argc > 1) ? args[1].num : 0.0; + naRef result = naNewHash(c); + SGGeod g = fp->pointAlongRoute(index, offset); + hashset(c, result, "lat", naNum(g.getLatitudeDeg())); + hashset(c, result, "lon", naNum(g.getLongitudeDeg())); + return result; +} + +static naRef f_flightplan_finish(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.finish called on non-flightplan object"); + } + + fp->finish(); + return naNil(); } -static naRef f_route_currentIndex(naContext c, naRef me, int argc, naRef* args) +static naRef f_leg_setSpeed(naContext c, naRef me, int argc, naRef* args) { - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); - return naNum(rm->currentIndex()); + FlightPlan::Leg* leg = fpLegGhost(me); + if (!leg) { + naRuntimeError(c, "leg.setSpeed called on non-flightplan-leg object"); + } + + if (argc < 2) { + naRuntimeError(c, "bad arguments to leg.setSpeed"); + } + + RouteRestriction rr = routeRestrictionFromString(naStr_data(args[1])); + leg->setSpeed(rr, args[0].num); + return naNil(); } -static naRef f_route_numWaypoints(naContext c, naRef me, int argc, naRef* args) +static naRef f_leg_setAltitude(naContext c, naRef me, int argc, naRef* args) { - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); - return naNum(rm->numWaypts()); + FlightPlan::Leg* leg = fpLegGhost(me); + if (!leg) { + naRuntimeError(c, "leg.setAltitude called on non-flightplan-leg object"); + } + + if (argc < 2) { + naRuntimeError(c, "bad arguments to leg.setAltitude"); + } + + RouteRestriction rr = routeRestrictionFromString(naStr_data(args[1])); + leg->setAltitude(rr, args[0].num); + return naNil(); } -static flightgear::Waypt* wayptFromMe(naRef me) -{ - naRef ghost = naHash_cget(me, (char*) "_waypt"); - if (naIsNil(ghost)) { - return NULL; +static naRef f_leg_path(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan::Leg* leg = fpLegGhost(me); + if (!leg) { + naRuntimeError(c, "leg.setAltitude called on non-flightplan-leg object"); } - return wayptGhost(ghost); + RoutePath path(leg->owner()); + SGGeodVec gv(path.pathForIndex(leg->index())); + + naRef result = naNewVector(c); + BOOST_FOREACH(SGGeod p, gv) { + // construct a geo.Coord! + naRef coord = naNewHash(c); + hashset(c, coord, "lat", naNum(p.getLatitudeDeg())); + hashset(c, coord, "lon", naNum(p.getLongitudeDeg())); + naVec_append(result, coord); + } + + return result; +} + +static naRef f_leg_courseAndDistanceFrom(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan::Leg* leg = fpLegGhost(me); + if (!leg) { + naRuntimeError(c, "leg.courseAndDistanceFrom called on non-flightplan-leg object"); + } + + SGGeod pos; + geodFromArgs(args, 0, argc, pos); + + double courseDeg; + double distanceM; + boost::tie(courseDeg, distanceM) = leg->waypoint()->courseAndDistanceFrom(pos); + + naRef result = naNewVector(c); + naVec_append(result, naNum(courseDeg)); + naVec_append(result, naNum(distanceM * SG_METER_TO_NM)); + return result; } static naRef f_waypoint_navaid(naContext c, naRef me, int argc, naRef* args) { - flightgear::Waypt* w = wayptFromMe(me); + flightgear::Waypt* w = wayptGhost(me); if (!w) { naRuntimeError(c, "waypoint.navaid called on non-waypoint object"); } @@ -971,7 +2275,7 @@ static naRef f_waypoint_navaid(naContext c, naRef me, int argc, naRef* args) case FGPositioned::DME: case FGPositioned::TACAN: { FGNavRecord* nav = (FGNavRecord*) pos; - return hashForNavRecord(c, nav, globals->get_aircraft_position()); + return ghostForNavaid(c, nav); } default: @@ -981,7 +2285,7 @@ static naRef f_waypoint_navaid(naContext c, naRef me, int argc, naRef* args) static naRef f_waypoint_airport(naContext c, naRef me, int argc, naRef* args) { - flightgear::Waypt* w = wayptFromMe(me); + flightgear::Waypt* w = wayptGhost(me); if (!w) { naRuntimeError(c, "waypoint.navaid called on non-waypoint object"); } @@ -991,12 +2295,12 @@ static naRef f_waypoint_airport(naContext c, naRef me, int argc, naRef* args) return naNil(); } - return hashForAirport(c, (FGAirport*) pos); + return ghostForAirport(c, (FGAirport*) pos); } static naRef f_waypoint_runway(naContext c, naRef me, int argc, naRef* args) { - flightgear::Waypt* w = wayptFromMe(me); + flightgear::Waypt* w = wayptGhost(me); if (!w) { naRuntimeError(c, "waypoint.navaid called on non-waypoint object"); } @@ -1006,9 +2310,75 @@ static naRef f_waypoint_runway(naContext c, naRef me, int argc, naRef* args) return naNil(); } - return hashForRunway(c, (FGRunway*) pos); + return ghostForRunway(c, (FGRunway*) pos); +} + +static naRef f_procedure_transition(naContext c, naRef me, int argc, naRef* args) +{ + Procedure* proc = procedureGhost(me); + if (!proc) { + naRuntimeError(c, "procedure.transition called on non-procedure object"); + } + + if ((proc->type() != PROCEDURE_SID) && (proc->type() != PROCEDURE_STAR)) { + naRuntimeError(c, "procedure.transition called on non-SID or -STAR"); + } + + ArrivalDeparture* ad = (ArrivalDeparture*) proc; + Transition* trans = ad->findTransitionByName(naStr_data(args[0])); + + return ghostForProcedure(c, trans); +} + +static naRef f_procedure_route(naContext c, naRef me, int argc, naRef* args) +{ + Procedure* proc = procedureGhost(me); + if (!proc) { + naRuntimeError(c, "procedure.route called on non-procedure object"); + } + +// wrapping up tow different routines here - approach routing from the IAF +// to the associated runway, and SID/STAR routing via an enroute transition +// and possibly a runway transition or not. + if (Approach::isApproach(proc->type())) { + WayptRef iaf; + if (argc > 0) { + iaf = wayptFromArg(args[0]); + } + + WayptVec r; + Approach* app = (Approach*) proc; + if (!app->route(iaf, r)) { + SG_LOG(SG_NASAL, SG_WARN, "procedure.route failed for Approach somehow"); + return naNil(); + } + + return convertWayptVecToNasal(c, r); + } else if ((proc->type() != PROCEDURE_SID) && (proc->type() != PROCEDURE_STAR)) { + naRuntimeError(c, "procedure.route called on unsuitable procedure type"); + } + + int argOffset = 0; + FGRunway* rwy = runwayGhost(args[0]); + if (rwy) ++argOffset; + + ArrivalDeparture* ad = (ArrivalDeparture*) proc; + Transition* trans = NULL; + if (argOffset < argc) { + trans = (Transition*) procedureGhost(args[argOffset]); + } + + // note either runway or trans may be NULL - that's ok + WayptVec r; + if (!ad->route(rwy, trans, r)) { + SG_LOG(SG_NASAL, SG_WARN, "prcoedure.route failed for ArrvialDeparture somehow"); + return naNil(); + } + + return convertWayptVecToNasal(c, r); } + // Table of extension functions. Terminate with zeros. static struct { const char* name; naCFunction func; } funcs[] = { { "carttogeod", f_carttogeod }, @@ -1022,45 +2392,95 @@ static struct { const char* name; naCFunction func; } funcs[] = { { "findNavaidByFrequency", f_findNavaidByFrequency }, { "findNavaidsByFrequency", f_findNavaidsByFrequency }, { "findNavaidsByID", f_findNavaidsByIdent }, - { "route", f_route }, + { "findFixesByID", f_findFixesByIdent }, + { "flightplan", f_route }, + { "registerFlightPlanDelegate", f_registerFPDelegate }, + { "createWP", f_createWP }, + { "createWPFrom", f_createWPFrom }, + { "airwaysRoute", f_airwaySearch }, { "magvar", f_magvar }, { "courseAndDistance", f_courseAndDistance }, - { "bucketPath", f_tilePath }, + { "greatCircleMove", f_greatCircleMove }, + { "tileIndex", f_tileIndex }, + { "tilePath", f_tilePath }, { 0, 0 } }; -naRef initNasalPositioned(naRef globals, naContext c, naRef gcSave) +naRef initNasalPositioned(naRef globals, naContext c) { airportPrototype = naNewHash(c); - hashset(c, gcSave, "airportProto", airportPrototype); + naSave(c, airportPrototype); + hashset(c, airportPrototype, "runway", naNewFunc(c, naNewCCode(c, f_airport_runway))); + hashset(c, airportPrototype, "runwaysWithoutReciprocals", naNewFunc(c, naNewCCode(c, f_airport_runwaysWithoutReciprocals))); + hashset(c, airportPrototype, "helipad", naNewFunc(c, naNewCCode(c, f_airport_runway))); hashset(c, airportPrototype, "tower", naNewFunc(c, naNewCCode(c, f_airport_tower))); hashset(c, airportPrototype, "comms", naNewFunc(c, naNewCCode(c, f_airport_comms))); hashset(c, airportPrototype, "sids", naNewFunc(c, naNewCCode(c, f_airport_sids))); hashset(c, airportPrototype, "stars", naNewFunc(c, naNewCCode(c, f_airport_stars))); + hashset(c, airportPrototype, "getApproachList", naNewFunc(c, naNewCCode(c, f_airport_approaches))); hashset(c, airportPrototype, "parking", naNewFunc(c, naNewCCode(c, f_airport_parking))); - - routePrototype = naNewHash(c); - hashset(c, gcSave, "routeProto", routePrototype); + hashset(c, airportPrototype, "getSid", naNewFunc(c, naNewCCode(c, f_airport_getSid))); + hashset(c, airportPrototype, "getStar", naNewFunc(c, naNewCCode(c, f_airport_getStar))); + hashset(c, airportPrototype, "getIAP", naNewFunc(c, naNewCCode(c, f_airport_getApproach))); + hashset(c, airportPrototype, "findBestRunwayForPos", naNewFunc(c, naNewCCode(c, f_airport_findBestRunway))); + hashset(c, airportPrototype, "tostring", naNewFunc(c, naNewCCode(c, f_airport_toString))); + + flightplanPrototype = naNewHash(c); + naSave(c, flightplanPrototype); - hashset(c, routePrototype, "getWP", naNewFunc(c, naNewCCode(c, f_route_getWP))); - hashset(c, routePrototype, "currentWP", naNewFunc(c, naNewCCode(c, f_route_currentWP))); - hashset(c, routePrototype, "currentIndex", naNewFunc(c, naNewCCode(c, f_route_currentIndex))); - hashset(c, routePrototype, "getPlanSize", naNewFunc(c, naNewCCode(c, f_route_numWaypoints))); + hashset(c, flightplanPrototype, "getWP", naNewFunc(c, naNewCCode(c, f_flightplan_getWP))); + hashset(c, flightplanPrototype, "currentWP", naNewFunc(c, naNewCCode(c, f_flightplan_currentWP))); + hashset(c, flightplanPrototype, "nextWP", naNewFunc(c, naNewCCode(c, f_flightplan_nextWP))); + hashset(c, flightplanPrototype, "getPlanSize", naNewFunc(c, naNewCCode(c, f_flightplan_numWaypoints))); + hashset(c, flightplanPrototype, "appendWP", naNewFunc(c, naNewCCode(c, f_flightplan_appendWP))); + hashset(c, flightplanPrototype, "insertWP", naNewFunc(c, naNewCCode(c, f_flightplan_insertWP))); + hashset(c, flightplanPrototype, "deleteWP", naNewFunc(c, naNewCCode(c, f_flightplan_deleteWP))); + hashset(c, flightplanPrototype, "insertWPAfter", naNewFunc(c, naNewCCode(c, f_flightplan_insertWPAfter))); + hashset(c, flightplanPrototype, "insertWaypoints", naNewFunc(c, naNewCCode(c, f_flightplan_insertWaypoints))); + hashset(c, flightplanPrototype, "cleanPlan", naNewFunc(c, naNewCCode(c, f_flightplan_clearPlan))); + hashset(c, flightplanPrototype, "clearWPType", naNewFunc(c, naNewCCode(c, f_flightplan_clearWPType))); + hashset(c, flightplanPrototype, "clone", naNewFunc(c, naNewCCode(c, f_flightplan_clone))); + hashset(c, flightplanPrototype, "pathGeod", naNewFunc(c, naNewCCode(c, f_flightplan_pathGeod))); + hashset(c, flightplanPrototype, "finish", naNewFunc(c, naNewCCode(c, f_flightplan_finish))); waypointPrototype = naNewHash(c); - hashset(c, gcSave, "wayptProto", waypointPrototype); + naSave(c, waypointPrototype); hashset(c, waypointPrototype, "navaid", naNewFunc(c, naNewCCode(c, f_waypoint_navaid))); hashset(c, waypointPrototype, "runway", naNewFunc(c, naNewCCode(c, f_waypoint_runway))); hashset(c, waypointPrototype, "airport", naNewFunc(c, naNewCCode(c, f_waypoint_airport))); + procedurePrototype = naNewHash(c); + naSave(c, procedurePrototype); + hashset(c, procedurePrototype, "transition", naNewFunc(c, naNewCCode(c, f_procedure_transition))); + hashset(c, procedurePrototype, "route", naNewFunc(c, naNewCCode(c, f_procedure_route))); + + fpLegPrototype = naNewHash(c); + naSave(c, fpLegPrototype); + hashset(c, fpLegPrototype, "setSpeed", naNewFunc(c, naNewCCode(c, f_leg_setSpeed))); + hashset(c, fpLegPrototype, "setAltitude", naNewFunc(c, naNewCCode(c, f_leg_setAltitude))); + hashset(c, fpLegPrototype, "path", naNewFunc(c, naNewCCode(c, f_leg_path))); + hashset(c, fpLegPrototype, "courseAndDistanceFrom", naNewFunc(c, naNewCCode(c, f_leg_courseAndDistanceFrom))); + for(int i=0; funcs[i].name; i++) { hashset(c, globals, funcs[i].name, - naNewFunc(c, naNewCCode(c, funcs[i].func))); + naNewFunc(c, naNewCCode(c, funcs[i].func))); } return naNil(); } +void postinitNasalPositioned(naRef globals, naContext c) +{ + naRef geoModule = naHash_cget(globals, (char*) "geo"); + if (naIsNil(geoModule)) { + SG_LOG(SG_GENERAL, SG_WARN, "postinitNasalPositioned: geo.nas not loaded"); + return; + } + + geoCoordClass = naHash_cget(geoModule, (char*) "Coord"); +} + +