406 lines
12 KiB
Text
406 lines
12 KiB
Text
# Copyright 2018 Stuart Buchanan
|
|
# This file is part of FlightGear.
|
|
#
|
|
# Foobar is free software: you can redistribute it and/or modify
|
|
# it under the terms of the GNU General Public License as published by
|
|
# the Free Software Foundation, either version 2 of the License, or
|
|
# (at your option) any later version.
|
|
#
|
|
# FlightGear is distributed in the hope that it will be useful,
|
|
# but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
# GNU General Public License for more details.
|
|
#
|
|
# You should have received a copy of the GNU General Public License
|
|
# along with FlightGear. If not, see <http://www.gnu.org/licenses/>.
|
|
#
|
|
#
|
|
# Emesary interface to access nav data such as airport information, fixes etc.
|
|
#
|
|
|
|
var NavDataInterface = {
|
|
|
|
# Valid FMS Modes
|
|
|
|
FMS_MODES : {
|
|
direct : 1,
|
|
leg : 1,
|
|
obs : 1,
|
|
},
|
|
|
|
new : func ()
|
|
{
|
|
var obj = { parents : [ NavDataInterface ] };
|
|
|
|
# Emesary
|
|
obj._recipient = nil;
|
|
obj._transmitter = emesary.GlobalTransmitter;
|
|
obj._registered = 0;
|
|
obj._defaultDTO = "";
|
|
|
|
# List of recently use waypoints
|
|
obj._recentWaypoints = std.Vector.new();
|
|
|
|
return obj;
|
|
},
|
|
|
|
# Find the airports within 200nm and return them.
|
|
getNearestAirports : func()
|
|
{
|
|
# To make this more efficient for areas with a high density of airports, we'll try
|
|
# a small radius first and expand until we have reached 200nm or have 25 airports.
|
|
var radius = 0;
|
|
var apts = [];
|
|
|
|
while ((radius <= 200) and (size(apts) < 25)) {
|
|
radius = radius + 50;
|
|
apts = findAirportsWithinRange(radius);
|
|
}
|
|
|
|
if (size(apts) > 25) {
|
|
apts = subvec(apts, 0, 25);
|
|
}
|
|
|
|
return apts;
|
|
},
|
|
|
|
# Find the nearest nav aids of a given type within 200nm, to a maximum of 25.
|
|
getNavDataWithinRange: func(type)
|
|
{
|
|
# To make this more efficient for areas with a high density of fixes, we'll try
|
|
# a small radius first and expand until we have reached 200nm or have 25 nav aids.
|
|
var radius = 0;
|
|
var navdata = [];
|
|
|
|
while ((radius <= 200) and (size(navdata) < 25)) {
|
|
radius = radius + 50;
|
|
navdata = findNavaidsWithinRange(radius, type);
|
|
}
|
|
|
|
if (size(navdata) > 25) {
|
|
navdata = subvec(navdata, 0, 25);
|
|
}
|
|
|
|
return navdata;
|
|
},
|
|
|
|
# Find a specific airport by ID. Return an array of airport objects
|
|
getAirportById : func(id)
|
|
{
|
|
var apt = findAirportsByICAO(id, "airport");
|
|
|
|
if ((apt != nil) and (! me._recentWaypoints.contains(id))) {
|
|
me._recentWaypoints.insert(0, id);
|
|
}
|
|
|
|
return apt;
|
|
},
|
|
|
|
# Find an arbritrary piece of nav data by ID. This searches based on the
|
|
# current location and returns an array of objects that match the id.
|
|
getNavDataById : func (id)
|
|
{
|
|
# Check for airport first
|
|
var navdata = findAirportsByICAO(id, "airport");
|
|
|
|
# Check for Navaids.
|
|
if (size(navdata) == 0) navdata = findNavaidsByID(id);
|
|
|
|
# Check for fix.
|
|
if (size(navdata) == 0) navdata = findFixesByID(id);
|
|
|
|
# Check for a pseudo-fix in the flightplan
|
|
if (size(navdata) == 0) {
|
|
var fp = flightplan();
|
|
if (fp != nil) {
|
|
for (var i = 0; i < fp.getPlanSize(); i = i +1) {
|
|
var wp = fp.getWP(i);
|
|
if (wp.wp_name == id) {
|
|
append(navdata, wp);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if ((size(navdata) > 0) and (! me._recentWaypoints.contains(id))) {
|
|
me._recentWaypoints.insert(0, id);
|
|
}
|
|
|
|
return navdata;
|
|
},
|
|
|
|
# Find a Nav Aid by ID. This searches based on the
|
|
# current location and returns an array of objects that match the id.
|
|
getNavAidById : func (params)
|
|
{
|
|
var id = params.id;
|
|
var type = "all";
|
|
if (params.type != nil) type = params.type;
|
|
|
|
var navdata = findNavaidsByID(id, type);
|
|
if ((size(navdata) > 0) and (! me._recentWaypoints.contains(id))) {
|
|
me._recentWaypoints.insert(0, id);
|
|
}
|
|
return navdata;
|
|
},
|
|
|
|
# Retrieve the current flightplan and return it
|
|
getFlightplan : func ()
|
|
{
|
|
return flightplan();
|
|
},
|
|
|
|
# Retrieve the checklists for this aircraft.
|
|
getChecklists : func()
|
|
{
|
|
return props.globals.getNode("/sim/checklists");
|
|
},
|
|
|
|
insertWaypoint : func (data)
|
|
{
|
|
assert(data["index"] != nil, "InsertWaypoint message with no index parameter");
|
|
assert(data["wp"] != nil, "InsertWaypoint message with no wp parameter");
|
|
|
|
var wp = data["wp"];
|
|
var idx = int(data["index"]);
|
|
|
|
# Simple data verification that we have the parameters we need
|
|
assert(idx != nil, "InsertWaypoint index parameter does not contain an integer index");
|
|
assert(wp.id != nil, "InsertWaypoint wp parameter does not contain an id");
|
|
assert(wp.lat != nil, "InsertWaypoint wp parameter does not contain a lat");
|
|
assert(wp.lon != nil, "InsertWaypoint wp parameter does not contain an lon");
|
|
|
|
var newwp = createWP(wp.lat, wp.lon, wp.id);
|
|
|
|
var fp = flightplan();
|
|
fp.insertWP(newwp, idx);
|
|
|
|
# Set a suitable name.
|
|
if ((fp.id == nil) or (fp.id == "default-flightplan")) {
|
|
var from = "????";
|
|
var dest = "????";
|
|
|
|
if ((fp.getWP(0) != nil) and (fp.getWP(0).wp_name != nil)) {
|
|
from = fp.getWP(0).wp_name;
|
|
}
|
|
|
|
if ((fp.getWP(fp.getPlanSize() -1) != nil) and (fp.getWP(fp.getPlanSize() -1).wp_name != nil)) {
|
|
dest = fp.getWP(fp.getPlanSize() -1).wp_name;
|
|
}
|
|
|
|
if (fp.departure != nil) from = fp.departure.id;
|
|
if (fp.destination != nil) dest = fp.destination.id;
|
|
fp.id == from ~ " / " ~ dest;
|
|
}
|
|
|
|
# Activate flightplan
|
|
if (fp.getPlanSize() == 2) fgcommand("activate-flightplan", props.Node.new({"activate": 1}));
|
|
},
|
|
|
|
# Retrieve the Airway waypoints on the current leg.
|
|
getAirwayWaypoints : func() {
|
|
var fp = flightplan();
|
|
if (fp != nil) {
|
|
var current_wp = fp.currentWP();
|
|
if ((current_wp != nil) and (fp.indexOfWP(current_wp) > 0)) {
|
|
var last_wp = fp.getWP(fp.indexOfWP(current_wp) -1);
|
|
return airwaysRoute(last_wp, current_wp);
|
|
}
|
|
}
|
|
return nil;
|
|
},
|
|
|
|
# Return the recently seen waypoints, collected from previous calls to
|
|
# other nav data functions
|
|
getRecentWaypoints : func()
|
|
{
|
|
return me._recentWaypoints.vector;
|
|
},
|
|
|
|
# Add an ID to the list of recent waypoints
|
|
addRecentWaypoint : func(id)
|
|
{
|
|
if ((id != nil) and (! me._recentWaypoints.contains(id))) {
|
|
me._recentWaypoints.insert(0, id);
|
|
}
|
|
},
|
|
|
|
# Return the array of user waypoints. TODO
|
|
getUserWaypoints : func()
|
|
{
|
|
return [];
|
|
},
|
|
|
|
# Set up a DirectTo a given ID, with optional VNAV altitude offset.
|
|
setDirectTo : func(param)
|
|
{
|
|
var id = param.id;
|
|
var alt_ft = param.alt_ft;
|
|
var offset_nm = param.offset_nm;
|
|
|
|
var fp = flightplan();
|
|
var wp_idx = -1;
|
|
|
|
if (fp != nil) {
|
|
# We've already got a flightplan, so see if this WP already exists.
|
|
|
|
for (var i = 0; i < fp.getPlanSize(); i = i + 1) {
|
|
var wp = fp.getWP(i);
|
|
if ((wp.wp_name != nil) and (wp.wp_name == id)) {
|
|
# OK, we're assuming that if the names actually match, then
|
|
# they refer to the same ID. So direct to that index.
|
|
wp_idx = i;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (wp_idx != -1) {
|
|
# Found the waypoint in the plan, so use that as the DTO.
|
|
var wp = fp.getWP(wp_idx);
|
|
setprop("/instrumentation/gps/scratch/ident", wp.wp_name);
|
|
setprop("/instrumentation/gps/scratch/altitude-ft", 0);
|
|
setprop("/instrumentation/gps/scratch/latitude-deg", wp.lat);
|
|
setprop("/instrumentation/gps/scratch/longitude-deg", wp.lon);
|
|
} else {
|
|
# No flightplan, or waypoint not found, so use the GPS DTO function.
|
|
# Hokey property-based interface.
|
|
setprop("/instrumentation/gps/scratch/ident", id);
|
|
setprop("/instrumentation/gps/scratch/altitude-ft", 0);
|
|
setprop("/instrumentation/gps/scratch/latitude-deg", 0);
|
|
setprop("/instrumentation/gps/scratch/longitude-deg", 0);
|
|
}
|
|
|
|
# Switch the GPS to DTO mode.
|
|
setprop("/instrumentation/gps/command", "direct");
|
|
},
|
|
|
|
setFMSMode : func(mode) {
|
|
if (NavDataInterface.FMS_MODES[mode] != nil) {
|
|
# mode is valid, so simply set it as the GPS command
|
|
setprop("/instrumentation/gps/command", mode);
|
|
} else {
|
|
die("Invalid FMS Mode " ~ mode);
|
|
}
|
|
},
|
|
|
|
# Return the current DTO location to use
|
|
getCurrentDTO : func()
|
|
{
|
|
return me._defaultDTO;
|
|
},
|
|
|
|
# Set the current DTO location to use
|
|
setDefaultDTO : func(id)
|
|
{
|
|
me._defaultDTO = id;
|
|
},
|
|
|
|
RegisterWithEmesary : func()
|
|
{
|
|
if (me._recipient == nil){
|
|
me._recipient = emesary.Recipient.new("DataInterface");
|
|
var controller = me;
|
|
|
|
# Note that unlike the various keys, this data isn't specific to a particular
|
|
# Device - it's shared by all. Hence we don't check for the notificaiton
|
|
# Device_Id.
|
|
me._recipient.Receive = func(notification)
|
|
{
|
|
if (notification.NotificationType == notifications.PFDEventNotification.DefaultType and
|
|
notification.Event_Id == notifications.PFDEventNotification.NavData and
|
|
notification.EventParameter != nil)
|
|
{
|
|
var id = notification.EventParameter.Id;
|
|
|
|
if (id == "NearestAirports") {
|
|
notification.EventParameter.Value = controller.getNearestAirports();
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "AirportByID") {
|
|
notification.EventParameter.Value = controller.getAirportById(notification.EventParameter.Value);
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "NavDataByID") {
|
|
notification.EventParameter.Value = controller.getNavDataById(notification.EventParameter.Value);
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "NavAidByID") {
|
|
notification.EventParameter.Value = controller.getNavAidById(notification.EventParameter.Value);
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "NavDataWithinRange") {
|
|
notification.EventParameter.Value = controller.getNavDataWithinRange(notification.EventParameter.Value);
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "Flightplan") {
|
|
notification.EventParameter.Value = controller.getFlightplan();
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "RecentWaypoints") {
|
|
notification.EventParameter.Value = controller.getRecentWaypoints();
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "AddRecentWaypoint") {
|
|
controller.addRecentWaypoint(notification.EventParameter.Value);
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "AirwayWaypoints") {
|
|
notification.EventParameter.Value = controller.getAirwayWaypoints();
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "UserWaypoints") {
|
|
notification.EventParameter.Value = controller.getUserWaypoints();
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "CurrentDTO") {
|
|
notification.EventParameter.Value = controller.getCurrentDTO();
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "SetDirectTo") {
|
|
controller.setDirectTo(notification.EventParameter.Value);
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "SetDefaultDTO") {
|
|
controller.setDefaultDTO(notification.EventParameter.Value);
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "SetFMSMode") {
|
|
controller.setFMSMode(notification.EventParameter.Value);
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "InsertWaypoint") {
|
|
controller.insertWaypoint(notification.EventParameter.Value);
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
if (id == "getChecklists") {
|
|
notification.EventParameter.Value = controller.getChecklists();
|
|
return emesary.Transmitter.ReceiptStatus_Finished;
|
|
}
|
|
}
|
|
return emesary.Transmitter.ReceiptStatus_NotProcessed;
|
|
};
|
|
}
|
|
|
|
me._transmitter.Register(me._recipient);
|
|
me._registered = 1;
|
|
},
|
|
|
|
DeRegisterWithEmesary : func()
|
|
{
|
|
# remove registration from transmitter; but keep the recipient once it is created.
|
|
if (me._registered == 1) me._transmitter.DeRegister(me._recipient);
|
|
me._registered = 0;
|
|
},
|
|
|
|
|
|
start : func() {
|
|
me.RegisterWithEmesary();
|
|
},
|
|
stop : func() {
|
|
me.DeRegisterWithEmesary();
|
|
},
|
|
|
|
|
|
|
|
};
|