X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FScripting%2FNasalPositioned.cxx;h=1f10e5baf73bd213c5a1740d1a1189b863cfd838;hb=ee1c8a8d662a0398711ee17c53dd64d249d2e030;hp=9127e149cbc87974ce3e7f2a348973d3cdf7b2af;hpb=78afdb3c2227e75fc1542b3992dcea26181d98cf;p=flightgear.git diff --git a/src/Scripting/NasalPositioned.cxx b/src/Scripting/NasalPositioned.cxx index 9127e149c..1f10e5baf 100644 --- a/src/Scripting/NasalPositioned.cxx +++ b/src/Scripting/NasalPositioned.cxx @@ -27,6 +27,8 @@ #include "NasalPositioned.hxx" #include +#include +#include // for boost::tie #include #include @@ -35,21 +37,32 @@ #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" }; static const char* airportGhostGetMember(naContext c, void* g, naRef field, naRef* out); @@ -60,12 +73,41 @@ naGhostType NavaidGhostType = { positionedGhostDestroy, "navaid", navaidGhostGet 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) @@ -82,10 +124,37 @@ 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; } @@ -110,6 +179,21 @@ static FGRunway* runwayGhost(naRef 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; @@ -117,35 +201,65 @@ 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 naRef airportPrototype; -static naRef routePrototype; -static naRef waypointPrototype; -static naRef geoCoordClass; +static void legGhostDestroy(void* g) +{ + // nothing for now +} -naRef ghostForPositioned(naContext c, const FGPositioned* pos) + +static FlightPlan::Leg* fpLegGhost(naRef r) { - if (!pos) { - return naNil(); - } - - FGPositioned::get(pos); // take a ref - return naNewGhost(c, &PositionedGhostType, (void*) pos); + 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 flightplanPrototype; +static naRef waypointPrototype; +static naRef geoCoordClass; +static naRef fpLegPrototype; +static naRef procedurePrototype; + naRef ghostForAirport(naContext c, const FGAirport* apt) { if (!apt) { @@ -176,16 +290,74 @@ naRef ghostForRunway(naContext c, const FGRunway* r) return naNewGhost2(c, &RunwayGhostType, (void*) r); } -naRef ghostForWaypt(naContext c, const flightgear::Waypt* wpt) +naRef ghostForHelipad(naContext c, const FGHelipad* r) { - if (!wpt) { + if (!r) { + return naNil(); + } + + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &HelipadGhostType, (void*) r); +} + +naRef ghostForTaxiway(naContext c, const FGTaxiway* r) +{ + if (!r) { + return naNil(); + } + + FGPositioned::get(r); // take a ref + return naNewGhost2(c, &TaxiwayGhostType, (void*) r); +} + +naRef ghostForFix(naContext c, const FGFix* r) +{ + if (!r) { return naNil(); } - flightgear::Waypt::get(wpt); // take a ref + 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(); + } + + 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(); + } + + return naNewGhost2(c, &ProcedureGhostType, (void*) proc); +} + static const char* airportGhostGetMember(naContext c, void* g, naRef field, naRef* out) { const char* fieldName = naStr_data(field); @@ -204,12 +376,35 @@ static const char* airportGhostGetMember(naContext c, void* g, naRef field, naRe *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; @@ -218,60 +413,324 @@ static const char* airportGhostGetMember(naContext c, void* g, naRef field, naRe return ""; } -static const char* wayptGhostGetMember(naContext c, void* g, naRef field, naRef* out) +static const char* waypointCommonGetMember(naContext c, Waypt* wpt, const char* fieldName, naRef* out) { - const char* fieldName = naStr_data(field); - flightgear::Waypt* wpt = (flightgear::Waypt*) g; - - if (!strcmp(fieldName, "parents")) { - *out = naNewVector(c); - naVec_append(*out, waypointPrototype); - } else if (!strcmp(fieldName, "wp_name")) *out =stringToNasal(c, wpt->ident()); + if (!strcmp(fieldName, "wp_name")) *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")) *out = naNum(wpt->position().getLatitudeDeg()); else if (!strcmp(fieldName, "wp_lon")) *out = naNum(wpt->position().getLongitudeDeg()); else if (!strcmp(fieldName, "wp_parent_name")) { - flightgear::Procedure* proc = dynamic_cast(wpt->owner()); + 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(flightgear::WPT_OVERFLIGHT) ? "flyOver" : "flyBy"); + *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)); } - } else if (!strcmp(fieldName, "alt_cstr")) *out = naNum(wpt->altitudeFt()); - else if (!strcmp(fieldName, "speed_cstr")) { - double s = (wpt->speedRestriction() == flightgear::SPEED_RESTRICT_MACH) - ? wpt->speedMach() : wpt->speedKts(); + + 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) +{ + 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); + } 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")) { - return "please implement me"; + *out = naNum(leg->distanceNm()); } else if (!strcmp(fieldName, "leg_bearing")) { - return "please implement me"; - } else { - return NULL; // member not found + *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 const char* runwayGhostGetMember(naContext c, void* g, naRef field, naRef* out) +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; + } + + 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"); + } else if (!strcmp(fieldName, "destination_runway")) { + FGRunway* rwy = runwayGhost(value); + if (rwy){ + fp->setDestination(rwy); + return; + } + + naRuntimeError(c, "bad argument type setting departure"); + } 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); - FGRunway* rwy = (FGRunway*) g; - - if (!strcmp(fieldName, "id")) *out = stringToNasal(c, rwy->ident()); - else if (!strcmp(fieldName, "lat")) *out = naNum(rwy->latitude()); - else if (!strcmp(fieldName, "lon")) *out = naNum(rwy->longitude()); - else if (!strcmp(fieldName, "heading")) *out = naNum(rwy->headingDeg()); - else if (!strcmp(fieldName, "length")) *out = naNum(rwy->lengthM()); - else if (!strcmp(fieldName, "width")) *out = naNum(rwy->widthM()); - else if (!strcmp(fieldName, "threshold")) *out = naNum(rwy->displacedThresholdM()); - else if (!strcmp(fieldName, "stopway")) *out = naNum(rwy->stopwayM()); - 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()); + 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(string id, ad->transitionIdents()) { + naVec_append(*out, stringToNasal(c, id)); + } } else { return 0; } @@ -279,6 +738,38 @@ static const char* runwayGhostGetMember(naContext c, void* g, naRef field, naRef 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); @@ -294,6 +785,8 @@ static const char* navaidGhostGetMember(naContext c, void* g, naRef field, naRef *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(); @@ -309,6 +802,21 @@ static const char* navaidGhostGetMember(naContext c, void* g, naRef field, naRef 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"); @@ -316,7 +824,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) @@ -324,17 +832,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; - } - -// 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)) { @@ -380,6 +880,16 @@ static int geodFromArgs(naRef* args, int offset, int argc, SGGeod& result) 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; @@ -445,10 +955,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(); @@ -476,6 +987,7 @@ class AirportInfoFilter : public FGAirport::AirportFilter { public: AirportInfoFilter() : type(FGPositioned::AIRPORT) { + minRunwayLengthFt = fgGetDouble("/sim/navdb/min-runway-length-ft", 0.0); } bool fromArg(naRef arg) @@ -497,8 +1009,21 @@ public: virtual FGPositioned::Type maxType() const { return type; } - - FGPositioned::Type type; + + virtual bool pass(FGPositioned* aPos) const + { + FGAirport* apt = (FGAirport*) aPos; + if ((apt->type() == FGPositioned::AIRPORT) && + !apt->hasHardRunwayOfLengthFt(minRunwayLengthFt)) + { + return false; + } + + return true; + } + + FGPositioned::Type type; + double minRunwayLengthFt; }; // Returns data hash for particular or nearest airport of a , or nil @@ -656,17 +1181,56 @@ static naRef f_airport_runway(naContext c, naRef me, int argc, naRef* args) 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 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_taxiway(naContext c, naRef me, int argc, naRef* args) +{ + FGAirport* apt = airportGhost(me); + if (!apt) { + naRuntimeError(c, "airport.taxiway called on non-airport object"); + } + + if ((argc < 1) || !naIsString(args[0])) { + naRuntimeError(c, "airport.taxiway expects a taxiway ident argument"); + } + + naRef taxiways = naNewVector(c); + + for (unsigned int i = 0; i < apt->numTaxiways(); i++) { + naVec_append(taxiways, ghostForTaxiway(c, apt->getTaxiwayByIndex(i))); } - return ghostForRunway(c, apt->getRunwayByIdent(ident)); + return taxiways; } static naRef f_airport_sids(naContext c, naRef me, int argc, naRef* args) @@ -678,12 +1242,18 @@ static naRef f_airport_sids(naContext c, naRef me, int argc, naRef* args) 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); @@ -708,12 +1278,18 @@ static naRef f_airport_stars(naContext c, naRef me, int argc, naRef* args) 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); @@ -729,6 +1305,61 @@ 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 = airportGhost(me); @@ -749,24 +1380,87 @@ 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"); + } + + 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"); + } + + 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"); + } + + string ident = naStr_data(args[0]); + return ghostForProcedure(c, apt->findApproachWithIdent(ident)); +} + +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([,],[],[]) @@ -824,7 +1518,8 @@ static naRef f_navinfo(naContext c, naRef me, int argc, naRef* args) return naNil(); } - navlist = globals->get_navlist()->findByIdentAndFreq( pos, id, 0.0, type ); + 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 ) { @@ -878,7 +1573,8 @@ static naRef f_findNavaidByFrequency(naContext c, naRef me, int argc, naRef* arg type = FGPositioned::typeFromName(naStr_data(args[argOffset])); } - nav_list_type navs = globals->get_navlist()->findAllByFreq(freqMhz, pos, type); + FGNavList::TypeFilter filter(type); + nav_list_type navs = FGNavList::findAllByFreq(freqMhz, pos, &filter); if (navs.empty()) { return naNil(); } @@ -903,7 +1599,9 @@ static naRef f_findNavaidsByFrequency(naContext c, naRef me, int argc, naRef* ar } naRef r = naNewVector(c); - nav_list_type navs = globals->get_navlist()->findAllByFreq(freqMhz, pos, type); + + 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())); @@ -928,8 +1626,9 @@ static naRef f_findNavaidsByIdent(naContext c, naRef me, int argc, naRef* args) type = FGPositioned::typeFromName(naStr_data(args[argOffset])); } + FGNavList::TypeFilter filter(type); naRef r = naNewVector(c); - nav_list_type navs = globals->get_navlist()->findByIdentAndFreq(pos, ident, 0.0, type); + 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())); @@ -938,6 +1637,29 @@ static naRef f_findNavaidsByIdent(naContext c, naRef me, int argc, naRef* args) 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); + } + + string ident(naStr_data(args[argOffset])); + naRef r = naNewVector(c); + + FGPositioned::TypeFilter filter(FGPositioned::FIX); + FGPositioned::List 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) @@ -1028,62 +1750,523 @@ static naRef f_tileIndex(naContext c, naRef me, int argc, naRef* args) static naRef f_route(naContext c, naRef me, int argc, naRef* args) { - naRef route = naNewHash(c); + 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) + { + SG_LOG(SG_NASAL, SG_INFO, "created Nasal delegate for " << fp); + _gcSaveKey = _nasal->gcSave(ins); + } + + virtual ~NasalFPDelegate() + { + SG_LOG(SG_NASAL, SG_INFO, "destroying Nasal delegate for " << _plan); + _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"); + } +private: + + void callDelegateMethod(const char* method) + { + naRef f; + naMember_cget(_nasal->context(), _instance, method, &f); + if (naIsNil(f)) { + 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; + } - // return active route hash by default, - // other routes in the future + 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 parents = naNewVector(c); - naVec_append(parents, routePrototype); - hashset(c, route, "parents", parents); +// special-case for runways + if (pos->type() == FGPositioned::RUNWAY) { + return new RunwayWaypt((FGRunway*) pos, NULL); + } - return route; + return new NavaidWaypoint(pos, NULL); } -static naRef f_route_getWP(naContext c, naRef me, int argc, naRef* args) +static naRef convertWayptVecToNasal(naContext c, const WayptVec& wps) { - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); + 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(); + } + + bool highLevel = true; + if ((argc > 2) && naIsString(args[2])) { + if (!strcmp(naStr_data(args[2]), "lowlevel")) { + highLevel = false; + } + } + + WayptVec route; + if (highLevel) { + Airway::highLevel()->route(start, end, route); + } else { + Airway::lowLevel()->route(start, end, route); + } + + return convertWayptVecToNasal(c, route); +} + +static naRef f_createWP(naContext c, naRef me, int argc, naRef* args) +{ + SGGeod pos; + int argOffset = geodFromArgs(args, 0, argc, pos); + + if (((argc - argOffset) < 1) || !naIsString(args[argOffset])) { + naRuntimeError(c, "createWP: no identifier supplied"); + } + + 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++])); + wpt->setFlag(f); + } + + 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"); + } + + FGPositioned* positioned = positionedGhost(args[0]); + if (!positioned) { + naRuntimeError(c, "createWPFrom: couldn;t convert arg[0] to FGPositioned"); + } + + 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])); + wpt->setFlag(f); + } + + return ghostForWaypt(c, wpt); +} + +static naRef f_flightplan_getWP(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.getWP called on non-flightplan object"); + } + int index; if (argc == 0) { - index = rm->currentIndex(); + index = fp->currentIndex(); } else { index = (int) naNumValue(args[0]).num; } - if ((index < 0) || (index >= rm->numWaypts())) { + if ((index < 0) || (index >= fp->numLegs())) { return naNil(); } - return ghostForWaypt(c, rm->wayptAtIndex(index)); + return ghostForLeg(c, fp->legAtIndex(index)); } -static naRef f_route_currentWP(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_currentWP(naContext c, naRef me, int argc, naRef* args) { - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); - return ghostForWaypt(c, rm->currentWaypt()); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.currentWP called on non-flightplan object"); + } + return ghostForLeg(c, fp->currentLeg()); } -static naRef f_route_nextWP(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_nextWP(naContext c, naRef me, int argc, naRef* args) { - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); - flightgear::WayptRef wp = rm->nextWaypt(); - if (!wp) { - return naNil(); + 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 ghostForWaypt(c, wp); + return naNum(fp->numLegs()); } -static naRef f_route_currentIndex(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_appendWP(naContext c, naRef me, int argc, naRef* args) { - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); - return naNum(rm->currentIndex()); + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.appendWP called on non-flightplan object"); + } + + 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"); + } + + 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_flightplan_insertWPAfter(naContext c, naRef me, int argc, naRef* args) +{ + 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_numWaypoints(naContext c, naRef me, int argc, naRef* args) +static naRef f_flightplan_insertWaypoints(naContext c, naRef me, int argc, naRef* args) { - FGRouteMgr* rm = static_cast(globals->get_subsystem("route-manager")); - return naNum(rm->numWaypts()); + 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"); + } + + 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_flightplan_clearPlan(naContext c, naRef me, int argc, naRef* args) +{ + FlightPlan* fp = flightplanGhost(me); + if (!fp) { + naRuntimeError(c, "flightplan.clearPlan called on non-flightplan object"); + } + + 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 (argc < 1) { + naRuntimeError(c, "insufficent args to flightplan.clearWPType"); + } + + WayptFlag flag = wayptFlagFromString(naStr_data(args[0])); + 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 ghostForFlightPlan(c, fp->clone()); +} + +static naRef f_flightplan_pathGeod(naContext c, naRef me, int argc, naRef* args) +{ + 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_leg_setSpeed(naContext c, naRef me, int argc, naRef* args) +{ + 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_leg_setAltitude(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"); + } + + 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 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"); + } + + 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) @@ -1145,6 +2328,72 @@ static naRef f_waypoint_runway(naContext c, naRef me, int argc, naRef* args) 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 }, @@ -1158,7 +2407,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 }, @@ -1174,20 +2428,36 @@ naRef initNasalPositioned(naRef globals, naContext c, naRef gcSave) hashset(c, gcSave, "airportProto", 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, "taxiway", naNewFunc(c, naNewCCode(c, f_airport_taxiway))); 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))); + 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, "tostring", naNewFunc(c, naNewCCode(c, f_airport_toString))); - routePrototype = naNewHash(c); - hashset(c, gcSave, "routeProto", routePrototype); + flightplanPrototype = naNewHash(c); + hashset(c, gcSave, "flightplanProto", 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, "nextWP", naNewFunc(c, naNewCCode(c, f_route_nextWP))); - 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))); waypointPrototype = naNewHash(c); hashset(c, gcSave, "wayptProto", waypointPrototype); @@ -1196,6 +2466,18 @@ naRef initNasalPositioned(naRef globals, naContext c, naRef gcSave) 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); + hashset(c, gcSave, "procedureProto", 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); + hashset(c, gcSave, "fpLegProto", 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)));