X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FScripting%2FNasalPositioned.cxx;h=25d28bb40c1c549c1e168eefddfc0c383d14b9ad;hb=ce09c320d32728dd9c5eb0d6b4ab9f4683242cbc;hp=6064b8894af9591b9676f984cbb179befd716053;hpb=de975699fe2001325db3310fab8c48663ee7dcc6;p=flightgear.git diff --git a/src/Scripting/NasalPositioned.cxx b/src/Scripting/NasalPositioned.cxx index 6064b8894..25d28bb40 100644 --- a/src/Scripting/NasalPositioned.cxx +++ b/src/Scripting/NasalPositioned.cxx @@ -27,30 +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 + +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" }; -naGhostType WayptGhostType = { wayptGhostDestroy, "waypoint" }; + +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) { @@ -66,13 +124,76 @@ 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 FGAirport* airportGhost(naRef r) +{ + if (naGhost_type(r) == &AirportGhostType) + return (FGAirport*) naGhost_ptr(r); + return 0; +} + +static FGNavRecord* navaidGhost(naRef r) +{ + if (naGhost_type(r) == &NavaidGhostType) + return (FGNavRecord*) naGhost_ptr(r); + return 0; +} + +static FGRunway* runwayGhost(naRef r) +{ + if (naGhost_type(r) == &RunwayGhostType) + return (FGRunway*) naGhost_ptr(r); + return 0; +} + +static FGTaxiway* taxiwayGhost(naRef r) +{ + if (naGhost_type(r) == &TaxiwayGhostType) + return (FGTaxiway*) naGhost_ptr(r); + return 0; +} + +static FGFix* fixGhost(naRef r) +{ + if (naGhost_type(r) == &FixGhostType) + return (FGFix*) naGhost_ptr(r); + return 0; +} + + static void positionedGhostDestroy(void* g) { FGPositioned* pos = (FGPositioned*)g; @@ -80,173 +201,626 @@ static void positionedGhostDestroy(void* g) delete pos; } -static flightgear::Waypt* wayptGhost(naRef r) +static Waypt* wayptGhost(naRef r) { if (naGhost_type(r) == &WayptGhostType) - return (flightgear::Waypt*) naGhost_ptr(r); + return (Waypt*) naGhost_ptr(r); + + if (naGhost_type(r) == &FPLegGhostType) { + FlightPlan::Leg* leg = (FlightPlan::Leg*) naGhost_ptr(r); + return leg->waypoint(); + } + return 0; } static void wayptGhostDestroy(void* g) { - flightgear::Waypt* wpt = (flightgear::Waypt*)g; - if (!flightgear::Waypt::put(wpt)) // unref + Waypt* wpt = (Waypt*)g; + if (!Waypt::put(wpt)) // unref delete wpt; } +static void legGhostDestroy(void* g) +{ + // nothing for now +} + + +static FlightPlan::Leg* fpLegGhost(naRef r) +{ + if (naGhost_type(r) == &FPLegGhostType) + return (FlightPlan::Leg*) naGhost_ptr(r); + return 0; +} + +static Procedure* procedureGhost(naRef r) +{ + if (naGhost_type(r) == &ProcedureGhostType) + return (Procedure*) naGhost_ptr(r); + return 0; +} + +static FlightPlan* flightplanGhost(naRef r) +{ + if (naGhost_type(r) == &FlightPlanGhostType) + return (FlightPlan*) naGhost_ptr(r); + return 0; +} + +static void routeBaseGhostDestroy(void* g) +{ + // nothing for now +} + static naRef airportPrototype; -static naRef routePrototype; +static naRef flightplanPrototype; static naRef waypointPrototype; static naRef geoCoordClass; +static naRef fpLegPrototype; +static naRef procedurePrototype; -naRef ghostForPositioned(naContext c, const FGPositioned* pos) +naRef ghostForAirport(naContext c, const FGAirport* apt) { - if (!pos) { - return naNil(); - } - - FGPositioned::get(pos); // take a ref - return naNewGhost(c, &PositionedGhostType, (void*) pos); + if (!apt) { + return naNil(); + } + + FGPositioned::get(apt); // take a ref + return naNewGhost2(c, &AirportGhostType, (void*) apt); } -naRef ghostForWaypt(naContext c, const flightgear::Waypt* wpt) +naRef ghostForNavaid(naContext c, const FGNavRecord* n) { - if (!wpt) { + if (!n) { return naNil(); } - flightgear::Waypt::get(wpt); // take a ref - return naNewGhost(c, &WayptGhostType, (void*) wpt); + FGPositioned::get(n); // take a ref + return naNewGhost2(c, &NavaidGhostType, (void*) n); } -naRef hashForAirport(naContext c, const FGAirport* apt) +naRef ghostForRunway(naContext c, const FGRunway* 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 (!r) { + return naNil(); + } + + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &RunwayGhostType, (void*) r); } -naRef hashForWaypoint(naContext c, flightgear::Waypt* wpt, flightgear::Waypt* next) +naRef ghostForHelipad(naContext c, const FGHelipad* r) { - 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 + if (!r) { + return naNil(); } - 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")); + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &HelipadGhostType, (void*) r); +} + +naRef ghostForTaxiway(naContext c, const FGTaxiway* r) +{ + if (!r) { + return naNil(); } - 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())); + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &TaxiwayGhostType, (void*) r); +} + +naRef ghostForFix(naContext c, const FGFix* r) +{ + if (!r) { + return naNil(); } - 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())); + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &FixGhostType, (void*) r); +} + + +naRef ghostForWaypt(naContext c, const Waypt* wpt) +{ + if (!wpt) { + 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(); } -// leg bearing, distance, etc + return naNewGhost2(c, &FPLegGhostType, (void*) leg); +} + +naRef ghostForFlightPlan(naContext c, const FlightPlan* fp) +{ + if (!fp) { + return naNil(); + } + return naNewGhost2(c, &FlightPlanGhostType, (void*) fp); +} + +naRef ghostForProcedure(naContext c, const Procedure* proc) +{ + if (!proc) { + return naNil(); + } -// 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 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 h; + 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 ""; } -naRef hashForRunway(naContext c, FGRunway* rwy) +static void waypointCommonSetMember(naContext c, Waypt* wpt, const char* fieldName, naRef value) { - 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())); + 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)); } - HASHSET("_positioned", 11, ghostForPositioned(c, rwy)); -#undef HASHSET - return rwydata; + 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 } -naRef hashForNavRecord(naContext c, const FGNavRecord* nav, const SGGeod& rel) +static void waypointGhostSetMember(naContext c, void* g, naRef field, naRef value) { - 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()))); + 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; -// 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() ) ) ); + 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; + } - // record the real object as a ghost for further operations - HASHSET("_positioned",11, ghostForPositioned(c, nav)); -#undef HASHSET + 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; + } - return navdata; + 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) @@ -256,7 +830,7 @@ static bool hashIsCoord(naRef h) return false; } - return naEqual(naVec_get(parents, 0), geoCoordClass); + return naEqual(naVec_get(parents, 0), geoCoordClass) != 0; } bool geodFromHash(naRef ref, SGGeod& result) @@ -264,24 +838,9 @@ bool geodFromHash(naRef ref, SGGeod& result) 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 +// 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)) { @@ -310,7 +869,40 @@ static int geodFromArgs(naRef* args, int offset, int argc, SGGeod& result) return 0; } - if (geodFromHash(args[offset], result)) { + 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; } @@ -369,10 +961,11 @@ static naRef f_geodinfo(naContext c, naRef me, int argc, naRef* args) double lat = naNumValue(args[0]).num; double lon = naNumValue(args[1]).num; double elev = argc == 3 ? naNumValue(args[2]).num : 10000; - const SGMaterial *mat; + const simgear::BVHMaterial *material; SGGeod geod = SGGeod::fromDegM(lon, lat, elev); - if(!globals->get_scenery()->get_elevation_m(geod, elev, &mat)) + 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(); @@ -396,35 +989,6 @@ static naRef f_geodinfo(naContext c, naRef me, int argc, naRef* args) } -class AirportInfoFilter : public FGAirport::AirportFilter -{ -public: - AirportInfoFilter() : type(FGPositioned::AIRPORT) { - } - - 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; - } - - virtual FGPositioned::Type minType() const { - return type; - } - - virtual FGPositioned::Type maxType() const { - return type; - } - - FGPositioned::Type type; -}; - // Returns data hash for particular or nearest airport of a , or nil // on error. // @@ -445,12 +1009,12 @@ static naRef f_airportinfo(naContext c, naRef me, int argc, naRef* args) double maxRange = 10000.0; // expose this? or pick a smaller value? - AirportInfoFilter filter; // defaults to airports only + FGAirport::TypeRunwayFilter 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])) { + if (filter.fromTypeString(naStr_data(args[0]))) { // done! } else { // user provided an , hopefully @@ -472,7 +1036,7 @@ static naRef f_airportinfo(naContext c, naRef me, int argc, naRef* args) if(!apt) return naNil(); } - return hashForAirport(c, apt); + return ghostForAirport(c, apt); } static naRef f_findAirportsWithinRange(naContext c, naRef me, int argc, naRef* args) @@ -485,20 +1049,20 @@ static naRef f_findAirportsWithinRange(naContext c, naRef me, int argc, naRef* a naRuntimeError(c, "findAirportsWithinRange expected range (in nm) as arg %d", argOffset); } - AirportInfoFilter filter; // defaults to airports only + FGAirport::TypeRunwayFilter filter; // defaults to airports only double rangeNm = args[argOffset++].num; if (argOffset < argc) { - filter.fromArg(args[argOffset++]); + filter.fromTypeString(naStr_data(args[argOffset++])); } naRef r = naNewVector(c); - FGPositioned::List apts = FGPositioned::findWithinRange(pos, rangeNm, &filter); + FGPositionedList apts = FGPositioned::findWithinRange(pos, rangeNm, &filter); FGPositioned::sortByRange(apts, pos); BOOST_FOREACH(FGPositionedRef a, apts) { FGAirport* apt = (FGAirport*) a.get(); - naVec_append(r, hashForAirport(c, apt)); + naVec_append(r, ghostForAirport(c, apt)); } return r; @@ -511,42 +1075,27 @@ static naRef f_findAirportsByICAO(naContext c, naRef me, int argc, naRef* args) } int argOffset = 0; - string prefix(naStr_data(args[argOffset++])); - AirportInfoFilter filter; // defaults to airports only + std::string prefix(naStr_data(args[argOffset++])); + FGAirport::TypeRunwayFilter filter; // defaults to airports only if (argOffset < argc) { - filter.fromArg(args[argOffset++]); + filter.fromTypeString(naStr_data(args[argOffset++])); } naRef r = naNewVector(c); - FGPositioned::List apts = FGPositioned::findAllWithIdent(prefix, &filter, false); + FGPositionedList apts = FGPositioned::findAllWithIdent(prefix, &filter, false); BOOST_FOREACH(FGPositionedRef a, apts) { FGAirport* apt = (FGAirport*) a.get(); - naVec_append(r, hashForAirport(c, apt)); + naVec_append(r, ghostForAirport(c, apt)); } return r; } -static FGAirport* airportFromMe(naRef me) -{ - naRef ghost = naHash_cget(me, (char*) "_positioned"); - if (naIsNil(ghost)) { - return NULL; - } - - FGPositioned* pos = positionedGhost(ghost); - if (pos && FGAirport::isAirportType(pos)) { - return (FGAirport*) pos; - } - - return NULL; -} - static naRef f_airport_tower(naContext c, naRef me, int argc, naRef* args) { - FGAirport* apt = airportFromMe(me); + FGAirport* apt = airportGhost(me); if (!apt) { naRuntimeError(c, "airport.tower called on non-airport object"); } @@ -562,14 +1111,18 @@ static naRef f_airport_tower(naContext c, naRef me, int argc, naRef* args) static naRef f_airport_comms(naContext c, naRef me, int argc, naRef* args) { - FGAirport* apt = airportFromMe(me); + 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 && naIsScalar(args[0])) { + 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); @@ -591,38 +1144,63 @@ static naRef f_airport_comms(naContext c, naRef me, int argc, naRef* args) static naRef f_airport_runway(naContext c, naRef me, int argc, naRef* args) { - FGAirport* apt = airportFromMe(me); + 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])); - if (!apt->hasRunwayWithIdent(ident)) { - return naNil(); + 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 hashForRunway(c, apt->getRunwayByIdent(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 = airportFromMe(me); + 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(); } - FGRunway* rwy = apt->getRunwayByIdent(naStr_data(args[0])); + 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); @@ -640,19 +1218,25 @@ static naRef f_airport_sids(naContext c, naRef me, int argc, naRef* args) static naRef f_airport_stars(naContext c, naRef me, int argc, naRef* args) { - FGAirport* apt = airportFromMe(me); + 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(); } - FGRunway* rwy = apt->getRunwayByIdent(naStr_data(args[0])); + 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); @@ -668,9 +1252,64 @@ static naRef f_airport_stars(naContext c, naRef me, int argc, naRef* args) 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 = airportFromMe(me); + FGAirport* apt = airportGhost(me); if (!apt) { naRuntimeError(c, "airport.parking called on non-airport object"); } @@ -688,24 +1327,102 @@ static naRef f_airport_parking(naContext c, naRef me, int argc, naRef* args) } 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()) { + 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; } - naRef nm = stringToNasal(c, park->getName()); - naVec_append(r, nm); + 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([,],[],[]) @@ -758,284 +1475,788 @@ static naRef f_navinfo(naContext c, naRef me, int argc, naRef* args) --argc; } - if( argc > 0 ) { - naRuntimeError(c, "navinfo() called with too many arguments"); + 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) { + 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); + + FGNavList::TypeFilter filter(type); + nav_list_type navs = FGNavList::findAllByFreq(freqMhz, pos, &filter); + + BOOST_FOREACH(nav_rec_ptr a, navs) { + naVec_append(r, ghostForNavaid(c, a.ptr())); + } + + return r; +} + +static naRef f_findNavaidsByIdent(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); + } + + FGPositioned::Type type = FGPositioned::INVALID; + std::string ident = naStr_data(args[argOffset++]); + if (argOffset < argc) { + 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); + + BOOST_FOREACH(nav_rec_ptr a, navs) { + naVec_append(r, ghostForNavaid(c, a.ptr())); + } + + return r; +} + +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); + + 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; +} + +// Convert a cartesian point to a geodetic lat/lon/altitude. +static naRef f_magvar(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"); + } + + double jd = globals->get_time_params()->getJD(); + double magvarDeg = sgGetMagVar(pos, jd) * SG_RADIANS_TO_DEGREES; + return naNum(magvarDeg); +} + +static naRef f_courseAndDistance(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 + } + + 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; +} + +static naRef f_greatCircleMove(naContext c, naRef me, int argc, naRef* args) +{ + 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); + } + + if ((argOffset + 1) >= argc) { + naRuntimeError(c, "isufficent arguments to greatCircleMove"); + } + + if (!naIsNum(args[argOffset]) || !naIsNum(args[argOffset+1])) { + naRuntimeError(c, "invalid arguments %d and %d to greatCircleMove", + argOffset, argOffset + 1); + } + + 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_tilePath(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()); +} + +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()); + } + + 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()); + } + + 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); + } + + naRuntimeError(c, "bad arguments to flightplan()"); + return naNil(); +} + +class NasalFPDelegate : public FlightPlan::Delegate +{ +public: + NasalFPDelegate(FlightPlan* fp, FGNasalSys* sys, naRef ins) : + _nasal(sys), + _plan(fp), + _instance(ins) + { + _gcSaveKey = _nasal->gcSave(ins); + } + + virtual ~NasalFPDelegate() + { + _nasal->gcRelease(_gcSaveKey); + } + + virtual void departureChanged() + { + callDelegateMethod("departureChanged"); + } + + virtual void arrivalChanged() + { + callDelegateMethod("arrivalChanged"); + } + + virtual void waypointsChanged() + { + callDelegateMethod("waypointsChanged"); + } + + virtual void currentWaypointChanged() + { + callDelegateMethod("currentWaypointChanged"); + } + + 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 arg[1]; + arg[0] = ghostForFlightPlan(_nasal->context(), _plan); + _nasal->callMethod(f, _instance, 1, arg, naNil()); + } + + FGNasalSys* _nasal; + FlightPlan* _plan; + naRef _instance; + int _gcSaveKey; +}; + +class NasalFPDelegateFactory : public FlightPlan::DelegateFactory +{ +public: + NasalFPDelegateFactory(naRef code) + { + _nasal = (FGNasalSys*) globals->get_subsystem("nasal"); + _func = code; + _gcSaveKey = _nasal->gcSave(_func); + } + + ~NasalFPDelegateFactory() + { + _nasal->gcRelease(_gcSaveKey); + } + + 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; + } + + return new NasalFPDelegate(fp, _nasal, instance); + } +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"); + } + + NasalFPDelegateFactory* factory = new NasalFPDelegateFactory(args[0]); + FlightPlan::registerDelegateFactory(factory); + + return naNil(); +} + +static WayptRef wayptFromArg(naRef arg) +{ + WayptRef r = wayptGhost(arg); + if (r.valid()) { + return r; + } + + 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(); + } + +// special-case for runways + if (pos->type() == FGPositioned::RUNWAY) { + return new RunwayWaypt((FGRunway*) pos, NULL); + } + + return new NavaidWaypoint(pos, NULL); +} + +static naRef convertWayptVecToNasal(naContext c, const WayptVec& wps) +{ + 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"); + } + + 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(); } - navlist = globals->get_navlist()->findByIdentAndFreq( pos, id, 0.0, type ); + bool highLevel = true; + if ((argc > 2) && naIsString(args[2])) { + if (!strcmp(naStr_data(args[2]), "lowlevel")) { + highLevel = false; + } + } - naRef reply = naNewVector(c); - for( nav_list_type::const_iterator it = navlist.begin(); it != navlist.end(); ++it ) { - naVec_append( reply, hashForNavRecord(c, *it, pos) ); + WayptVec route; + if (highLevel) { + Airway::highLevel()->route(start, end, route); + } else { + Airway::lowLevel()->route(start, end, route); } - return reply; + + return convertWayptVecToNasal(c, route); } -static naRef f_findNavaidsWithinRange(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, "findNavaidsWithinRange expected range (in nm) 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 rangeNm = 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); - FGNavList::TypeFilter filter(type); - FGPositioned::List navs = FGPositioned::findWithinRange(pos, rangeNm, &filter); - FGPositioned::sortByRange(navs, pos); + FGPositioned* positioned = positionedGhost(args[0]); + if (!positioned) { + naRuntimeError(c, "createWPFrom: couldn;t convert arg[0] to FGPositioned"); + } - BOOST_FOREACH(FGPositionedRef a, navs) { - FGNavRecord* nav = (FGNavRecord*) a.get(); - naVec_append(r, hashForNavRecord(c, nav, 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_findNavaidByFrequency(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 (!naIsNum(args[argOffset])) { - naRuntimeError(c, "findNavaidByFrequency expectes frequency (in Mhz) as arg %d", argOffset); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.getWP called on non-flightplan object"); } - - FGPositioned::Type type = FGPositioned::INVALID; - double freqMhz = args[argOffset++].num; - 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; } - nav_list_type navs = globals->get_navlist()->findAllByFreq(freqMhz, pos, type); - if (navs.empty()) { + if ((index < 0) || (index >= fp->numLegs())) { return naNil(); } - return hashForNavRecord(c, navs.front().ptr(), pos); + return ghostForLeg(c, fp->legAtIndex(index)); } -static naRef f_findNavaidsByFrequency(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_currentWP(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); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.currentWP called on non-flightplan object"); } - - FGPositioned::Type type = FGPositioned::INVALID; - double freqMhz = args[argOffset++].num; - if (argOffset < argc) { - type = FGPositioned::typeFromName(naStr_data(args[argOffset])); + 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()); +} + +static naRef f_flightplan_numWaypoints(naContext c, naRef me, int argc, naRef* args) +{ + 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"); } - naRef r = naNewVector(c); - nav_list_type navs = globals->get_navlist()->findAllByFreq(freqMhz, pos, type); + WayptRef wp = wayptGhost(args[0]); + int index = fp->numLegs(); + fp->insertWayptAtIndex(wp.get(), index); + return naNum(index); +} + +static naRef f_flightplan_insertWP(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.insertWP called on non-flightplan object"); + } - BOOST_FOREACH(nav_rec_ptr a, navs) { - naVec_append(r, hashForNavRecord(c, a.ptr(), pos)); + WayptRef wp = wayptGhost(args[0]); + int index = -1; // append + if ((argc > 1) && naIsNum(args[1])) { + index = (int) args[1].num; } - return r; + fp->insertWayptAtIndex(wp.get(), index); + return naNil(); } -static naRef f_findNavaidsByIdent(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_insertWPAfter(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.insertWPAfter 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])); + WayptRef wp = wayptGhost(args[0]); + int index = -1; // append + if ((argc > 1) && naIsNum(args[1])) { + index = (int) args[1].num; } - naRef r = naNewVector(c); - nav_list_type navs = globals->get_navlist()->findByIdentAndFreq(pos, ident, 0.0, type); + fp->insertWayptAtIndex(wp.get(), index + 1); + return naNil(); +} + +static naRef f_flightplan_insertWaypoints(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.insertWaypoints called on non-flightplan object"); + } - BOOST_FOREACH(nav_rec_ptr a, navs) { - naVec_append(r, hashForNavRecord(c, a.ptr(), pos)); + 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(); +} -// 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_deleteWP(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.deleteWP called on non-flightplan object"); } - double jd = globals->get_time_params()->getJD(); - double magvarDeg = sgGetMagVar(pos, jd) * SG_RADIANS_TO_DEGREES; - return naNum(magvarDeg); + if ((argc < 1) || !naIsNum(args[0])) { + naRuntimeError(c, "bad argument to flightplan.deleteWP"); + } + + int index = (int) args[0].num; + fp->deleteIndex(index); + return naNil(); } -static naRef f_courseAndDistance(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_clearPlan(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.clearPlan 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; + fp->clear(); + return naNil(); } -static naRef f_greatCircleMove(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_clearWPType(naContext c, naRef me, int argc, naRef* args) { - 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); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.clearWPType called on non-flightplan object"); } - if ((argOffset + 1) >= argc) { - naRuntimeError(c, "isufficent arguments to greatCircleMove"); + if (argc < 1) { + naRuntimeError(c, "insufficent args to flightplan.clearWPType"); } - if (!naIsNum(args[argOffset]) || !naIsNum(args[argOffset+1])) { - naRuntimeError(c, "invalid arguments %d and %d to greatCircleMove", - argOffset, argOffset + 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"); } - 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; + return ghostForFlightPlan(c, fp->clone()); } -static naRef f_tilePath(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_pathGeod(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.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"); + } + + 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_tileIndex(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_finish(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()); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.finish called on non-flightplan object"); + } + + fp->finish(); + return naNil(); } -static naRef f_route(naContext c, naRef me, int argc, naRef* args) +static naRef f_leg_setSpeed(naContext c, naRef me, int argc, naRef* args) { - naRef route = naNewHash(c); - - // return active route hash by default, - // other routes in the future + FlightPlan::Leg* leg = fpLegGhost(me); + if (!leg) { + naRuntimeError(c, "leg.setSpeed called on non-flightplan-leg object"); + } - naRef parents = naNewVector(c); - naVec_append(parents, routePrototype); - hashset(c, route, "parents", parents); + if (argc < 2) { + naRuntimeError(c, "bad arguments to leg.setSpeed"); + } - return route; + RouteRestriction rr = routeRestrictionFromString(naStr_data(args[1])); + leg->setSpeed(rr, args[0].num); + return naNil(); } -static naRef f_route_getWP(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")); - - int index; - if (argc == 0) { - index = rm->currentIndex(); - } else { - index = (int) naNumValue(args[0]).num; + FlightPlan::Leg* leg = fpLegGhost(me); + if (!leg) { + naRuntimeError(c, "leg.setAltitude called on non-flightplan-leg object"); } - if ((index < 0) || (index >= rm->numWaypts())) { - return naNil(); + if (argc < 2) { + naRuntimeError(c, "bad arguments to leg.setAltitude"); } - flightgear::Waypt* next = NULL; - if (index < (rm->numWaypts() - 1)) { - next = rm->wayptAtIndex(index + 1); - } - return hashForWaypoint(c, rm->wayptAtIndex(index), next); + RouteRestriction rr = routeRestrictionFromString(naStr_data(args[1])); + leg->setAltitude(rr, args[0].num); + return naNil(); } -static naRef f_route_currentWP(naContext c, naRef me, int argc, naRef* args) +static naRef f_leg_path(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::Leg* leg = fpLegGhost(me); + if (!leg) { + naRuntimeError(c, "leg.setAltitude called on non-flightplan-leg object"); } - return hashForWaypoint(c, rm->currentWaypt(), next); -} + + RoutePath path(leg->owner()); + SGGeodVec gv(path.pathForIndex(leg->index())); -static naRef f_route_currentIndex(naContext c, naRef me, int argc, naRef* args) -{ - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); - return naNum(rm->currentIndex()); -} + 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); + } -static naRef f_route_numWaypoints(naContext c, naRef me, int argc, naRef* args) -{ - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); - return naNum(rm->numWaypts()); + return result; } -static flightgear::Waypt* wayptFromMe(naRef me) -{ - naRef ghost = naHash_cget(me, (char*) "_waypt"); - if (naIsNil(ghost)) { - return NULL; - } - - return wayptGhost(ghost); +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"); } @@ -1054,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: @@ -1064,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"); } @@ -1074,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"); } @@ -1089,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 }, @@ -1105,7 +2392,12 @@ 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 }, { "greatCircleMove", f_greatCircleMove }, @@ -1115,33 +2407,63 @@ static struct { const char* name; naCFunction func; } funcs[] = { }; -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)));