Merge commit 'refs/merge-requests/265' of https://gitorious.org/fg/fgdata into merge-requests/265
This commit is contained in:
commit
53dfd54beb
3 changed files with 200 additions and 84 deletions
|
@ -1,6 +1,20 @@
|
||||||
# Glider Instrumentation Toolkit
|
# Glider Instrumentation Toolkit
|
||||||
# Author: Anton Gomez Alvedro (galvedro)
|
#
|
||||||
# Licensed under GNU GPL
|
# Copyright (C) 2013-2014 Anton Gomez Alvedro
|
||||||
|
#
|
||||||
|
# This program 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.
|
||||||
|
#
|
||||||
|
# This program 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 this program; if not, write to the Free Software
|
||||||
|
# Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
||||||
#
|
#
|
||||||
# Features:
|
# Features:
|
||||||
# + Total energy compensated variometer
|
# + Total energy compensated variometer
|
||||||
|
@ -14,24 +28,35 @@
|
||||||
# - add wind correction to speed-to-fly
|
# - add wind correction to speed-to-fly
|
||||||
# - final glide computer
|
# - final glide computer
|
||||||
|
|
||||||
|
io.include("updateloop.nas");
|
||||||
|
|
||||||
var MPS2KPH = 3.6;
|
var MPS2KPH = 3.6;
|
||||||
var sqr = func(x) {x * x}
|
var sqr = func(x) {x * x}
|
||||||
|
|
||||||
|
|
||||||
var InstrumentComponent = {
|
var InstrumentComponent = {
|
||||||
|
parents: [Updatable],
|
||||||
output: 0,
|
output: 0,
|
||||||
init: func { me.output = 0 },
|
reset: func { me.output = 0 },
|
||||||
update: func(dt) { },
|
|
||||||
};
|
};
|
||||||
|
|
||||||
# update_prop(property)
|
# This alias is for keeping backwards compatibility.
|
||||||
# Helper generator for updating the given property on every element update
|
# TODO: Refactor aircrafts that use it and remove this.
|
||||||
|
var Instrument = UpdateLoop;
|
||||||
|
|
||||||
|
##
|
||||||
|
# Helper generator for updating a property on every element update
|
||||||
#
|
#
|
||||||
# Example:
|
# Example:
|
||||||
|
#
|
||||||
# var needle = Dampener.new(
|
# var needle = Dampener.new(
|
||||||
# input: probe,
|
# input: probe,
|
||||||
# dampening: 2.8,
|
# dampening: 2.8,
|
||||||
# on_update: update_prop("/instrumentation/variometer/te-reading-mps"));
|
# on_update: update_prop("/instrumentation/variometer/te-reading-mps"));
|
||||||
|
#
|
||||||
|
# See Aircraft/Instruments-3d/glider/vario/ilec-sc7.nas and
|
||||||
|
# Aircraft/Generic/soaring-instrumentation-sdk.nas for usage examples.
|
||||||
|
# You can also refer to the soaring sdk wiki page.
|
||||||
|
|
||||||
var update_prop = func(property) {
|
var update_prop = func(property) {
|
||||||
func(value) { setprop(property, value) }
|
func(value) { setprop(property, value) }
|
||||||
|
@ -141,7 +166,7 @@ var TotalEnergyProbe = {
|
||||||
};
|
};
|
||||||
},
|
},
|
||||||
|
|
||||||
init: func {
|
reset: func {
|
||||||
me.airspeed = getprop("/velocities/airspeed-kt") * KT2MPS;
|
me.airspeed = getprop("/velocities/airspeed-kt") * KT2MPS;
|
||||||
me.altitude = getprop("/position/altitude-ft") * FT2M;
|
me.altitude = getprop("/position/altitude-ft") * FT2M;
|
||||||
me.output = 0;
|
me.output = 0;
|
||||||
|
@ -215,11 +240,11 @@ var Averager = {
|
||||||
m.sum = m.wp = 0;
|
m.sum = m.wp = 0;
|
||||||
|
|
||||||
m.buffer = setsize([], buffer_size);
|
m.buffer = setsize([], buffer_size);
|
||||||
m.init();
|
m.reset();
|
||||||
return m;
|
return m;
|
||||||
},
|
},
|
||||||
|
|
||||||
init: func {
|
reset: func {
|
||||||
me.sum = me.wp = me.output = 0;
|
me.sum = me.wp = me.output = 0;
|
||||||
forindex (var i; me.buffer)
|
forindex (var i; me.buffer)
|
||||||
me.buffer[i] = 0;
|
me.buffer[i] = 0;
|
||||||
|
@ -384,76 +409,3 @@ var SpeedCmdVario = {
|
||||||
if (me.on_update != nil) me.on_update(me.output);
|
if (me.on_update != nil) me.on_update(me.output);
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
# Instrument
|
|
||||||
# Wraps a set of components and updates them periodically.
|
|
||||||
# Takes care of critical sim signals (reinit, fdm-initialized, speed-up).
|
|
||||||
#
|
|
||||||
# var instrument = Instrument.new(
|
|
||||||
# components: List of components to update in the fast loop.
|
|
||||||
# update_period: (optional) Time in seconds between updates (fast components).
|
|
||||||
# enable: (optional) Enable instrument after creation.
|
|
||||||
|
|
||||||
var Instrument = {
|
|
||||||
|
|
||||||
new: func(components, update_period = 0, enable = 1) {
|
|
||||||
|
|
||||||
var m = { parents: [me] };
|
|
||||||
m.initialized = 0;
|
|
||||||
m.enabled = enable;
|
|
||||||
m.update_period = update_period;
|
|
||||||
m.time_last = 0;
|
|
||||||
m.sim_speed = 1;
|
|
||||||
m.components = (components != nil)? components : [];
|
|
||||||
|
|
||||||
m.timer = maketimer(update_period,
|
|
||||||
func { call(me.update, [], m) });
|
|
||||||
|
|
||||||
setlistener("/sim/speed-up",
|
|
||||||
func(n) { m.sim_speed = n.getValue() }, 1, 0);
|
|
||||||
|
|
||||||
setlistener("sim/signals/reinit", func {
|
|
||||||
m.timer.stop();
|
|
||||||
m.initialized = 0;
|
|
||||||
});
|
|
||||||
|
|
||||||
setlistener("sim/signals/fdm-initialized", func {
|
|
||||||
if (m.timer.isRunning) m.timer.stop();
|
|
||||||
call(me.init, [], m);
|
|
||||||
if (m.enabled) m.timer.start();
|
|
||||||
});
|
|
||||||
|
|
||||||
return m;
|
|
||||||
},
|
|
||||||
|
|
||||||
init: func {
|
|
||||||
me.time_last = getprop("/sim/time/elapsed-sec");
|
|
||||||
|
|
||||||
foreach (var component; me.components)
|
|
||||||
component.init();
|
|
||||||
|
|
||||||
me.initialized = 1;
|
|
||||||
},
|
|
||||||
|
|
||||||
update: func {
|
|
||||||
var time_now = getprop("/sim/time/elapsed-sec");
|
|
||||||
var dt = (time_now - me.time_last) * me.sim_speed;
|
|
||||||
if (dt == 0) return;
|
|
||||||
|
|
||||||
me.time_last = time_now;
|
|
||||||
|
|
||||||
foreach (var component; me.components)
|
|
||||||
component.update(dt);
|
|
||||||
},
|
|
||||||
|
|
||||||
enable: func {
|
|
||||||
if (me.initialized) me.timer.start();
|
|
||||||
me.enabled = 1;
|
|
||||||
},
|
|
||||||
|
|
||||||
disable: func {
|
|
||||||
me.timer.stop();
|
|
||||||
me.enabled = 0;
|
|
||||||
}
|
|
||||||
};
|
|
||||||
|
|
||||||
|
|
164
Aircraft/Generic/updateloop.nas
Normal file
164
Aircraft/Generic/updateloop.nas
Normal file
|
@ -0,0 +1,164 @@
|
||||||
|
# updateloop.nas - Generic Nasal update loop for implementing sytems,
|
||||||
|
# instruments or physics simulation.
|
||||||
|
#
|
||||||
|
# Copyright (C) 2014 Anton Gomez Alvedro
|
||||||
|
#
|
||||||
|
# This program 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.
|
||||||
|
#
|
||||||
|
# This program 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 this program; if not, write to the Free Software
|
||||||
|
# Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
||||||
|
|
||||||
|
|
||||||
|
##
|
||||||
|
# The UpdateLoop accepts a vector of Updatable components that it will call
|
||||||
|
# at regular intervals. In order to define custom objects to be controlled by
|
||||||
|
# the loop, the Updatable interface must be implemented:
|
||||||
|
#
|
||||||
|
# var MyComponent = {
|
||||||
|
# parents: [Updatable],
|
||||||
|
#
|
||||||
|
# reset: func {
|
||||||
|
# ...
|
||||||
|
# },
|
||||||
|
# update: func(dt) {
|
||||||
|
# ...
|
||||||
|
# },
|
||||||
|
# ...
|
||||||
|
# };
|
||||||
|
|
||||||
|
var Updatable = {
|
||||||
|
|
||||||
|
##
|
||||||
|
# When reset() is called, the component shall clean all internal state and
|
||||||
|
# reinitialize itself as if starting from scratch.
|
||||||
|
#
|
||||||
|
# Reset will be called automatically after a teleport, and then on demand
|
||||||
|
# when UpdateLoop.reset() is explicitly called.
|
||||||
|
|
||||||
|
reset: func { },
|
||||||
|
|
||||||
|
##
|
||||||
|
# Called at regular intervals from the UdateLoop.
|
||||||
|
# dt: Elapsed time in seconds since the last call.
|
||||||
|
|
||||||
|
update: func(dt) { },
|
||||||
|
};
|
||||||
|
|
||||||
|
##
|
||||||
|
# Wraps a set of user provided Updatable objects and calls them periodically.
|
||||||
|
# Takes care of critical sim signals (reinit, fdm-initialized, speed-up).
|
||||||
|
|
||||||
|
var UpdateLoop = {
|
||||||
|
|
||||||
|
# UpdateLoop.new(components, [update_period], [enable])
|
||||||
|
#
|
||||||
|
# components: Vector of components to update on every iteration.
|
||||||
|
# update_period: Time in seconds between updates.
|
||||||
|
# enable: Enable the loop immediately after creation.
|
||||||
|
# ignore_fdm: Do not wait for the fdm to be ready for starting the loop.
|
||||||
|
|
||||||
|
new: func(components, update_period = 0, enable = 1, ignore_fdm = 0) {
|
||||||
|
|
||||||
|
var m = { parents: [UpdateLoop] };
|
||||||
|
m.initialized = 0;
|
||||||
|
m.enabled = enable;
|
||||||
|
m.ignore_fdm = ignore_fdm;
|
||||||
|
m.update_period = update_period;
|
||||||
|
m.time_last = 0;
|
||||||
|
m.sim_speed = 1;
|
||||||
|
m.components = (components != nil)? components : [];
|
||||||
|
|
||||||
|
m.timer = maketimer(update_period,
|
||||||
|
func { call(me._update, [], m) });
|
||||||
|
|
||||||
|
m.lst = [];
|
||||||
|
|
||||||
|
append(m.lst, setlistener("/sim/speed-up",
|
||||||
|
func(n) { m.sim_speed = n.getValue() }, 1, 0));
|
||||||
|
|
||||||
|
append(m.lst, setlistener("sim/signals/reinit",
|
||||||
|
func(n) { m._on_teleport(n) }));
|
||||||
|
|
||||||
|
if (ignore_fdm or getprop("sim/signals/fdm-initialized")) {
|
||||||
|
m.reset();
|
||||||
|
enable and m.timer.start();
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!ignore_fdm) {
|
||||||
|
append(m.lst, setlistener("sim/signals/fdm-initialized",
|
||||||
|
func(n) { m._on_teleport(n) }));
|
||||||
|
}
|
||||||
|
|
||||||
|
return m;
|
||||||
|
},
|
||||||
|
|
||||||
|
del: func {
|
||||||
|
me.disable();
|
||||||
|
foreach (var l; me.lst) removelistener(l);
|
||||||
|
},
|
||||||
|
|
||||||
|
##
|
||||||
|
# Resets internal state for all components controlled by the loop.
|
||||||
|
# It is of course responsibility of every component to clean their internal
|
||||||
|
# state appropriately.
|
||||||
|
|
||||||
|
reset: func {
|
||||||
|
me.time_last = getprop("/sim/time/elapsed-sec");
|
||||||
|
|
||||||
|
foreach (var component; me.components)
|
||||||
|
component.reset();
|
||||||
|
|
||||||
|
me.initialized = 1;
|
||||||
|
},
|
||||||
|
|
||||||
|
##
|
||||||
|
# The loop will start updating the components under its control.
|
||||||
|
|
||||||
|
enable: func {
|
||||||
|
if (me.initialized) me.timer.start();
|
||||||
|
me.enabled = 1;
|
||||||
|
},
|
||||||
|
|
||||||
|
##
|
||||||
|
# The loop will freeze and its components will not get updates until
|
||||||
|
# enabled again.
|
||||||
|
|
||||||
|
disable: func {
|
||||||
|
me.timer.stop();
|
||||||
|
me.enabled = 0;
|
||||||
|
},
|
||||||
|
|
||||||
|
_update: func {
|
||||||
|
var time_now = getprop("/sim/time/elapsed-sec");
|
||||||
|
var dt = (time_now - me.time_last) * me.sim_speed;
|
||||||
|
if (dt == 0) return;
|
||||||
|
|
||||||
|
me.time_last = time_now;
|
||||||
|
|
||||||
|
foreach (var component; me.components)
|
||||||
|
component.update(dt);
|
||||||
|
},
|
||||||
|
|
||||||
|
_on_teleport: func(n) {
|
||||||
|
var signal = n.getName();
|
||||||
|
|
||||||
|
if (signal == "reinit" and n.getValue()) {
|
||||||
|
me.timer.stop();
|
||||||
|
me.initialized = 0;
|
||||||
|
}
|
||||||
|
elsif (me.ignore_fdm or signal == "fdm-initialized") {
|
||||||
|
me.timer.isRunning and me.timer.stop();
|
||||||
|
me.reset();
|
||||||
|
me.enabled and me.timer.start();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
};
|
|
@ -62,12 +62,12 @@ setlistener("instrumentation/ilec-sc7/sensitivity",
|
||||||
func(n) { sc7_needle.dampening = n.getValue() }, 0, 0);
|
func(n) { sc7_needle.dampening = n.getValue() }, 0, 0);
|
||||||
|
|
||||||
# Wrap everything together into an instrument
|
# Wrap everything together into an instrument
|
||||||
var fast_instruments = Instrument.new(
|
var fast_instruments = UpdateLoop.new(
|
||||||
update_period: 0,
|
update_period: 0,
|
||||||
components: [probe, sc7_needle, extra_needle],
|
components: [probe, sc7_needle, extra_needle],
|
||||||
enable: 1);
|
enable: 1);
|
||||||
|
|
||||||
var slow_instruments = Instrument.new(
|
var slow_instruments = UpdateLoop.new(
|
||||||
update_period: 1,
|
update_period: 1,
|
||||||
components: [averager, temperature, lcd_controller],
|
components: [averager, temperature, lcd_controller],
|
||||||
enable: 1);
|
enable: 1);
|
||||||
|
|
Loading…
Add table
Reference in a new issue