fly/fgdata
1
0
Fork 0
Code Activity

Roy Vegard OVESEN:

Browse source 
- Automatic pitch trim (use autopilot/KAP140/settings/auto-pitch-trim to turn
  on/off)
- Aural altitude alerter. Uses the same sound file as the stall warning.
- Replace custom flasher routines with nasal aircraft.light objects.
- Cleanup.
This commit is contained in:
mfranz 2007-04-26 18:04:51 +00:00
parent dec26c8b12
commit 47ddb39e0f
5 changed files with 162 additions and 197 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

305
Aircraft/Generic/kap140.nas
View file

@ -18,6 +18,7 @@ annunciators = "/autopilot/KAP140/annunciators";
internal = "/autopilot/internal"; internal = "/autopilot/internal";
power="/systems/electrical/outputs/autopilot"; power="/systems/electrical/outputs/autopilot";
encoder = "/instrumentation/encoder"; encoder = "/instrumentation/encoder";
flightControls = "/controls/flight";
# locks # locks
propLocks = props.globals.getNode(locks, 1); propLocks = props.globals.getNode(locks, 1);
@ -51,6 +52,7 @@ settingTargetTurnRate = propSettings.getNode("target-turn-rate", 1);
settingTargetAltFt = propSettings.getNode("target-alt-ft", 1); settingTargetAltFt = propSettings.getNode("target-alt-ft", 1);
settingBaroSettingInhg = propSettings.getNode("baro-setting-inhg", 1); settingBaroSettingInhg = propSettings.getNode("baro-setting-inhg", 1);
settingBaroSettingHpa = propSettings.getNode("baro-setting-hpa", 1); settingBaroSettingHpa = propSettings.getNode("baro-setting-hpa", 1);
settingAutoPitchTrim = propSettings.getNode("auto-pitch-trim", 1);
#annunciators #annunciators
propAnnunciators = props.globals.getNode(annunciators, 1); propAnnunciators = props.globals.getNode(annunciators, 1);
@ -80,14 +82,21 @@ annunciatorBsInhgNumber = propAnnunciators.getNode("bs-inhg-number", 1);
annunciatorAp = propAnnunciators.getNode("ap", 1); annunciatorAp = propAnnunciators.getNode("ap", 1);
annunciatorBeep = propAnnunciators.getNode("beep", 1); annunciatorBeep = propAnnunciators.getNode("beep", 1);
navRadio = "/instrumentation/nav"; #flashers
staticPort = "/systems/static"; altAlertBeeper = aircraft.light.new(annunciatorBeep, [0.5, 0.25]).switch(0);
altAlertFlasher = aircraft.light.new(annunciatorAltAlert, [0.5, 0.25]).switch(0);
hdgFlasher = aircraft.light.new(annunciatorHdg, [0.5, 0.25]).switch(0);
apFlasher = aircraft.light.new(annunciatorAp, [1.0, 0.5]).switch(0);
annunciator = annunciatorAp; #Flight controls
annunciatorState = 0; propFlightControls = props.globals.getNode(flightControls, 0);
flashInterval = 0.0;
flashCount = 0.0; elevatorControl = propFlightControls.getNode("elevator", 0);
flashTimer = -1.0; elevatorTrimControl = propFlightControls.getNode("elevator-trim", 0);
headingNeedleDeflection = "/instrumentation/nav/heading-needle-deflection";
gsNeedleDeflection = "/instrumentation/nav/gs-needle-deflection";
staticPressure = "systems/static/pressure-inhg";
pressureUnits = { "inHg" : 0, "hPa" : 1 }; pressureUnits = { "inHg" : 0, "hPa" : 1 };
baroSettingUnit = pressureUnits["inHg"]; baroSettingUnit = pressureUnits["inHg"];
@ -102,6 +111,7 @@ altButtonTimerRunning = 0;
altButtonTimerIgnore = 0; altButtonTimerIgnore = 0;
altAlertOn = 0; altAlertOn = 0;
altCaptured = 0; altCaptured = 0;
altDifference = 0.0;
valueTest = 0; valueTest = 0;
lastValue = 0; lastValue = 0;
@ -110,55 +120,6 @@ baroOffset = 0.0;
baroChange = 1; baroChange = 1;
minVoltageLimit = 8.0; minVoltageLimit = 8.0;
flasher = func {
flashTimer = -1.0;
annunciator = arg[0];
flashInterval = arg[1];
flashCount = arg[2] + 1;
annunciatorState = arg[3];
flashTimer = 0.0;
flashAnnunciator();
}
flashAnnunciator = func {
#print(annunciator.getName());
#print("FI:", flashInterval);
#print("FC:", flashCount);
#print("FT:", flashTimer);
##
# If flashTimer is set to -1 then flashing is aborted
if (flashTimer < -0.5)
{
##print ("flash abort ", annunciator);
annunciator.setBoolValue(0);
return;
}
if (flashTimer < flashCount)
{
#flashTimer = flashTimer + 1.0;
if (annunciator.getValue() == 1)
{
annunciator.setBoolValue(0);
settimer(flashAnnunciator, flashInterval / 2.0);
}
else
{
flashTimer = flashTimer + 1.0;
annunciator.setBoolValue(1);
settimer(flashAnnunciator, flashInterval);
}
}
else
{
flashTimer = -1.0;
annunciator.setBoolValue(annunciatorState);
}
}
ptCheck = func { ptCheck = func {
##print("pitch trim check"); ##print("pitch trim check");
@ -172,11 +133,9 @@ ptCheck = func {
else else
{ {
elevatorControl = getprop("/controls/flight/elevator"); autoPitchTrim = settingAutoPitchTrim.getValue();
##print(elevatorControl);
# Flash the pitch trim up annunciator # Flash the pitch trim up annunciator
if (elevatorControl < -0.01) if (elevatorControl.getValue() < -0.01)
{ {
if (annunciatorPtUp.getValue() == 0) if (annunciatorPtUp.getValue() == 0)
{ {
@ -186,9 +145,16 @@ ptCheck = func {
{ {
annunciatorPtUp.setBoolValue(0); annunciatorPtUp.setBoolValue(0);
} }
annunciatorPtDn.setBoolValue(0);
# Automatic pitch trim
if (autoPitchTrim == 1)
{
elevatorTrimControl.setDoubleValue(
elevatorTrimControl.getValue() - 0.001);
}
} }
# Flash the pitch trim down annunciator # Flash the pitch trim down annunciator
elsif (elevatorControl > 0.01) elsif (elevatorControl.getValue() > 0.01)
{ {
if (annunciatorPtDn.getValue() == 0) if (annunciatorPtDn.getValue() == 0)
{ {
@ -198,6 +164,13 @@ ptCheck = func {
{ {
annunciatorPtDn.setBoolValue(0); annunciatorPtDn.setBoolValue(0);
} }
annunciatorPtUp.setBoolValue(0);
# Automatic pitch trim
if (autoPitchTrim == 1)
{
elevatorTrimControl.setDoubleValue(
elevatorTrimControl.getValue() + 0.001);
}
} }
else else
@ -233,8 +206,7 @@ apInit = func {
# Reset the memory for power down or power up # Reset the memory for power down or power up
altPreselect = 0; altPreselect = 0;
baroSettingInhg = 29.92; baroSettingInhg = 29.92;
settingBaroSettingInhg.setDoubleValue(baroSettingInhg); adjustBaroSettingInhg(0.0);
settingBaroSettingHpa.setDoubleValue(baroSettingInhg * 0.03386389);
settingTargetAltFt.setDoubleValue(altPreselect); settingTargetAltFt.setDoubleValue(altPreselect);
settingTargetAltPressure.setDoubleValue(0.0); settingTargetAltPressure.setDoubleValue(0.0);
settingTargetInterceptAngle.setDoubleValue(0.0); settingTargetInterceptAngle.setDoubleValue(0.0);
@ -242,7 +214,7 @@ apInit = func {
settingTargetTurnRate.setDoubleValue(0.0); settingTargetTurnRate.setDoubleValue(0.0);
annunciatorRol.setBoolValue(0); annunciatorRol.setBoolValue(0);
annunciatorHdg.setBoolValue(0); annunciatorHdg.getNode("state").setBoolValue(0);
annunciatorNav.setBoolValue(0); annunciatorNav.setBoolValue(0);
annunciatorNavArm.setBoolValue(0); annunciatorNavArm.setBoolValue(0);
annunciatorApr.setBoolValue(0); annunciatorApr.setBoolValue(0);
@ -261,7 +233,7 @@ apInit = func {
annunciatorPtDn.setBoolValue(0); annunciatorPtDn.setBoolValue(0);
annunciatorBsHpaNumber.setBoolValue(0); annunciatorBsHpaNumber.setBoolValue(0);
annunciatorBsInhgNumber.setBoolValue(0); annunciatorBsInhgNumber.setBoolValue(0);
annunciatorAp.setBoolValue(0); annunciatorAp.getNode("state").setBoolValue(0);
annunciatorBeep.setBoolValue(0); annunciatorBeep.setBoolValue(0);
# settimer(altAlert, 5.0); # settimer(altAlert, 5.0);
@ -289,7 +261,8 @@ apPower = func {
# autopilot just lost power # autopilot just lost power
print("power lost"); print("power lost");
apInit(); apInit();
annunciatorAltAlert.setBoolValue(0); annunciatorAltAlert.getNode("state").setBoolValue(0);
annunciatorBeep.getNode("state").setBoolValue(0);
# note: all button and knobs disabled in functions below # note: all button and knobs disabled in functions below
} }
lastValue = newValue; lastValue = newValue;
@ -308,7 +281,6 @@ apButton = func {
if (lockRollMode.getValue() == rollModes["OFF"] and if (lockRollMode.getValue() == rollModes["OFF"] and
lockPitchMode.getValue() == pitchModes["OFF"]) lockPitchMode.getValue() == pitchModes["OFF"])
{ {
flashTimer = -1.0;
lockAltHold.setBoolValue(0); lockAltHold.setBoolValue(0);
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
@ -361,7 +333,6 @@ apButton = func {
elsif (lockRollMode.getValue() != rollModes["OFF"] and elsif (lockRollMode.getValue() != rollModes["OFF"] and
lockPitchMode.getValue() != pitchModes["OFF"]) lockPitchMode.getValue() != pitchModes["OFF"])
{ {
flashTimer = -1.0;
lockAltHold.setBoolValue(0); lockAltHold.setBoolValue(0);
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
@ -382,7 +353,7 @@ apButton = func {
settingTargetTurnRate.setDoubleValue(0.0); settingTargetTurnRate.setDoubleValue(0.0);
annunciatorRol.setBoolValue(0); annunciatorRol.setBoolValue(0);
annunciatorHdg.setBoolValue(0); annunciatorHdg.getNode("state").setBoolValue(0);
annunciatorNav.setBoolValue(0); annunciatorNav.setBoolValue(0);
annunciatorNavArm.setBoolValue(0); annunciatorNavArm.setBoolValue(0);
annunciatorApr.setBoolValue(0); annunciatorApr.setBoolValue(0);
@ -400,7 +371,7 @@ apButton = func {
annunciatorPtUp.setBoolValue(0); annunciatorPtUp.setBoolValue(0);
annunciatorPtDn.setBoolValue(0); annunciatorPtDn.setBoolValue(0);
flasher(annunciatorAp, 1.0, 5, 0); apFlasher.blink(5).switch(0).switch(1);
} }
} }
@ -418,8 +389,6 @@ hdgButton = func {
if (lockRollMode.getValue() == rollModes["OFF"] and if (lockRollMode.getValue() == rollModes["OFF"] and
lockPitchMode.getValue() == pitchModes["OFF"]) lockPitchMode.getValue() == pitchModes["OFF"])
{ {
flashTimer = -1.0;
lockAltHold.setBoolValue(0); lockAltHold.setBoolValue(0);
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
lockRevHold.setBoolValue(0); lockRevHold.setBoolValue(0);
@ -433,7 +402,7 @@ hdgButton = func {
lockRollArm.setIntValue(rollArmModes["OFF"]); lockRollArm.setIntValue(rollArmModes["OFF"]);
lockPitchArm.setIntValue(pitchArmModes["OFF"]); lockPitchArm.setIntValue(pitchArmModes["OFF"]);
annunciatorHdg.setBoolValue(1); annunciatorHdg.getNode("state").setBoolValue(1);
annunciatorAlt.setBoolValue(0); annunciatorAlt.setBoolValue(0);
annunciatorApr.setBoolValue(0); annunciatorApr.setBoolValue(0);
annunciatorGs.setBoolValue(0); annunciatorGs.setBoolValue(0);
@ -484,7 +453,7 @@ hdgButton = func {
annunciatorApr.setBoolValue(0); annunciatorApr.setBoolValue(0);
annunciatorGs.setBoolValue(0); annunciatorGs.setBoolValue(0);
annunciatorHdg.setBoolValue(1); annunciatorHdg.getNode("state").setBoolValue(1);
annunciatorNav.setBoolValue(0); annunciatorNav.setBoolValue(0);
annunciatorRol.setBoolValue(0); annunciatorRol.setBoolValue(0);
annunciatorRev.setBoolValue(0); annunciatorRev.setBoolValue(0);
@ -498,7 +467,7 @@ hdgButton = func {
lockRollArm.getValue() == rollArmModes["NAV"] or lockRollArm.getValue() == rollArmModes["NAV"] or
lockRollMode.getValue() == rollModes["REV"] or lockRollMode.getValue() == rollModes["REV"] or
lockRollArm.getValue() == rollArmModes["REV"]) and lockRollArm.getValue() == rollArmModes["REV"]) and
flashTimer < -0.5) !hdgFlasher.count)
{ {
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
lockRevHold.setBoolValue(0); lockRevHold.setBoolValue(0);
@ -511,7 +480,7 @@ hdgButton = func {
annunciatorApr.setBoolValue(0); annunciatorApr.setBoolValue(0);
annunciatorGs.setBoolValue(0); annunciatorGs.setBoolValue(0);
annunciatorHdg.setBoolValue(1); annunciatorHdg.getNode("state").setBoolValue(1);
annunciatorNav.setBoolValue(0); annunciatorNav.setBoolValue(0);
annunciatorRol.setBoolValue(0); annunciatorRol.setBoolValue(0);
annunciatorRev.setBoolValue(0); annunciatorRev.setBoolValue(0);
@ -535,7 +504,7 @@ hdgButton = func {
annunciatorApr.setBoolValue(0); annunciatorApr.setBoolValue(0);
annunciatorGs.setBoolValue(0); annunciatorGs.setBoolValue(0);
annunciatorHdg.setBoolValue(0); annunciatorHdg.getNode("state").setBoolValue(0);
annunciatorNav.setBoolValue(0); annunciatorNav.setBoolValue(0);
annunciatorRol.setBoolValue(1); annunciatorRol.setBoolValue(1);
@ -549,7 +518,7 @@ hdgButton = func {
lockRollArm.getValue() == rollArmModes["APR"] or lockRollArm.getValue() == rollArmModes["APR"] or
lockPitchMode.getValue() == pitchModes["GS"] or lockPitchMode.getValue() == pitchModes["GS"] or
lockPitchArm.getValue() == pitchArmModes["GS"]) and lockPitchArm.getValue() == pitchArmModes["GS"]) and
flashTimer < -0.5) !hdgFlasher.count)
{ {
lockAltHold.setBoolValue(0); lockAltHold.setBoolValue(0);
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
@ -565,7 +534,7 @@ hdgButton = func {
annunciatorAlt.setBoolValue(0); annunciatorAlt.setBoolValue(0);
annunciatorAltArm.setBoolValue(0); annunciatorAltArm.setBoolValue(0);
annunciatorHdg.setBoolValue(1); annunciatorHdg.getNode("state").setBoolValue(1);
annunciatorRol.setBoolValue(0); annunciatorRol.setBoolValue(0);
annunciatorNav.setBoolValue(0); annunciatorNav.setBoolValue(0);
annunciatorApr.setBoolValue(0); annunciatorApr.setBoolValue(0);
@ -614,7 +583,7 @@ navButton = func {
## ##
if (lockRollMode.getValue() == rollModes["HDG"]) if (lockRollMode.getValue() == rollModes["HDG"])
{ {
flasher(annunciatorHdg, 0.5, 8, 0); hdgFlasher.blink(8, 1).switch(0).switch(1);
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
lockGsHold.setBoolValue(0); lockGsHold.setBoolValue(0);
@ -634,7 +603,7 @@ navButton = func {
## ##
elsif (lockRollMode.getValue() == rollModes["ROL"]) elsif (lockRollMode.getValue() == rollModes["ROL"])
{ {
flasher(annunciatorHdg, 0.5, 8, 0); hdgFlasher.blink(8).switch(0).switch(1);
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
lockGsHold.setBoolValue(0); lockGsHold.setBoolValue(0);
@ -672,7 +641,7 @@ navArmFromHdg = func
## ##
# Wait for the HDG annunciator flashing to finish. # Wait for the HDG annunciator flashing to finish.
## ##
if (flashTimer > -0.5) if (hdgFlasher.count)
{ {
#print("flashing..."); #print("flashing...");
settimer(navArmFromHdg, 2.5); settimer(navArmFromHdg, 2.5);
@ -682,7 +651,7 @@ navArmFromHdg = func
# Activate the nav-hold controller and check the needle deviation. # Activate the nav-hold controller and check the needle deviation.
## ##
lockNavHold.setBoolValue(1); lockNavHold.setBoolValue(1);
deviation = getprop(navRadio, "heading-needle-deflection"); deviation = getprop(headingNeedleDeflection);
## ##
# If the deflection is more than 3 degrees wait 5 seconds and check again. # If the deflection is more than 3 degrees wait 5 seconds and check again.
## ##
@ -701,6 +670,7 @@ navArmFromHdg = func
#print("capture"); #print("capture");
lockRollArm.setIntValue(rollArmModes["OFF"]); lockRollArm.setIntValue(rollArmModes["OFF"]);
annunciatorNavArm.setBoolValue(0); annunciatorNavArm.setBoolValue(0);
annunciatorHdg.getNode("state").setBoolValue(0);
annunciatorNav.setBoolValue(1); annunciatorNav.setBoolValue(1);
} }
} }
@ -720,7 +690,7 @@ navArmFromRol = func
# Wait for the HDG annunciator flashing to finish. # Wait for the HDG annunciator flashing to finish.
## ##
#annunciatorNavArm.setBoolValue(1); #annunciatorNavArm.setBoolValue(1);
if (flashTimer > -0.5) if (hdgFlasher.count)
{ {
#print("flashing..."); #print("flashing...");
annunciatorRol.setBoolValue(0); annunciatorRol.setBoolValue(0);
@ -733,7 +703,7 @@ navArmFromRol = func
annunciatorRol.setBoolValue(1); annunciatorRol.setBoolValue(1);
lockRollAxis.setBoolValue(1); lockRollAxis.setBoolValue(1);
settingTargetTurnRate.setDoubleValue(0.0); settingTargetTurnRate.setDoubleValue(0.0);
deviation = getprop(navRadio, "heading-needle-deflection"); deviation = getprop(headingNeedleDeflection);
## ##
# If the deflection is more than 3 degrees wait 5 seconds and check again. # If the deflection is more than 3 degrees wait 5 seconds and check again.
## ##
@ -775,7 +745,7 @@ aprButton = func {
## ##
if (lockRollMode.getValue() == rollModes["HDG"]) if (lockRollMode.getValue() == rollModes["HDG"])
{ {
flasher(annunciatorHdg, 0.5, 8, 0); hdgFlasher.blink(8, 1).switch(0).switch(1);
lockAprHold.setBoolValue(1); lockAprHold.setBoolValue(1);
lockGsHold.setBoolValue(0); lockGsHold.setBoolValue(0);
@ -792,7 +762,7 @@ aprButton = func {
} }
elsif (lockRollMode.getValue() == rollModes["ROL"]) elsif (lockRollMode.getValue() == rollModes["ROL"])
{ {
flasher(annunciatorHdg, 0.5, 8, 0); hdgFlasher.blink(8).switch(0).switch(1);
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
lockGsHold.setBoolValue(0); lockGsHold.setBoolValue(0);
@ -825,7 +795,7 @@ aprArmFromHdg = func
## ##
# Wait for the HDG annunciator flashing to finish. # Wait for the HDG annunciator flashing to finish.
## ##
if (flashTimer > -0.5) if (hdgFlasher.count)
{ {
#print("flashing..."); #print("flashing...");
settimer(aprArmFromHdg, 2.5); settimer(aprArmFromHdg, 2.5);
@ -835,7 +805,7 @@ aprArmFromHdg = func
# Activate the apr-hold controller and check the needle deviation. # Activate the apr-hold controller and check the needle deviation.
## ##
lockAprHold.setBoolValue(1); lockAprHold.setBoolValue(1);
deviation = getprop(navRadio, "heading-needle-deflection"); deviation = getprop(headingNeedleDeflection);
## ##
# If the deflection is more than 3 degrees wait 5 seconds and check again. # If the deflection is more than 3 degrees wait 5 seconds and check again.
## ##
@ -854,6 +824,7 @@ aprArmFromHdg = func
{ {
#print("capture"); #print("capture");
annunciatorAprArm.setBoolValue(0); annunciatorAprArm.setBoolValue(0);
annunciatorHdg.getNode("state").setBoolValue(0);
annunciatorApr.setBoolValue(1); annunciatorApr.setBoolValue(1);
lockPitchArm.setIntValue(pitchArmModes["GS"]); lockPitchArm.setIntValue(pitchArmModes["GS"]);
@ -877,7 +848,7 @@ aprArmFromRol = func
## ##
# Wait for the HDG annunciator flashing to finish. # Wait for the HDG annunciator flashing to finish.
## ##
if (flashTimer > -0.5) if (hdgFlasher.count)
{ {
#print("flashing..."); #print("flashing...");
annunciatorRol.setBoolValue(0); annunciatorRol.setBoolValue(0);
@ -890,7 +861,7 @@ aprArmFromRol = func
annunciatorRol.setBoolValue(1); annunciatorRol.setBoolValue(1);
lockRollAxis.setBoolValue(1); lockRollAxis.setBoolValue(1);
settingTargetTurnRate.setDoubleValue(0.0); settingTargetTurnRate.setDoubleValue(0.0);
deviation = getprop(navRadio, "heading-needle-deflection"); deviation = getprop(headingNeedleDeflection);
## ##
# If the deflection is more than 3 degrees wait 5 seconds and check again. # If the deflection is more than 3 degrees wait 5 seconds and check again.
## ##
@ -939,7 +910,7 @@ gsArm = func {
annunciatorGsArm.setBoolValue(1); annunciatorGsArm.setBoolValue(1);
deviation = getprop(navRadio, "gs-needle-deflection"); deviation = getprop(gsNeedleDeflection);
## ##
# If the deflection is more than 1 degrees wait 5 seconds and check again. # If the deflection is more than 1 degrees wait 5 seconds and check again.
## ##
@ -981,7 +952,7 @@ revButton = func {
## ##
if (lockRollMode.getValue() == rollModes["HDG"]) if (lockRollMode.getValue() == rollModes["HDG"])
{ {
flasher(annunciatorHdg, 0.5, 8, 0); hdgFlasher.blink(8, 1).switch(0).switch(1);
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
lockGsHold.setBoolValue(0); lockGsHold.setBoolValue(0);
@ -997,7 +968,7 @@ revButton = func {
} }
elsif (lockRollMode.getValue() == rollModes["ROL"]) elsif (lockRollMode.getValue() == rollModes["ROL"])
{ {
flasher(annunciatorHdg, 0.5, 8, 0); hdgFlasher.blink(8).switch(0).switch(1);
lockAprHold.setBoolValue(0); lockAprHold.setBoolValue(0);
lockGsHold.setBoolValue(0); lockGsHold.setBoolValue(0);
@ -1030,7 +1001,7 @@ revArmFromHdg = func
## ##
# Wait for the HDG annunciator flashing to finish. # Wait for the HDG annunciator flashing to finish.
## ##
if (flashTimer > -0.5) if (hdgFlasher.count)
{ {
#print("flashing..."); #print("flashing...");
settimer(revArmFromHdg, 2.5); settimer(revArmFromHdg, 2.5);
@ -1040,7 +1011,7 @@ revArmFromHdg = func
# Activate the rev-hold controller and check the needle deviation. # Activate the rev-hold controller and check the needle deviation.
## ##
lockRevHold.setBoolValue(1); lockRevHold.setBoolValue(1);
deviation = getprop(navRadio, "heading-needle-deflection"); deviation = getprop(headingNeedleDeflection);
## ##
# If the deflection is more than 3 degrees wait 5 seconds and check again. # If the deflection is more than 3 degrees wait 5 seconds and check again.
## ##
@ -1058,6 +1029,7 @@ revArmFromHdg = func
{ {
#print("capture"); #print("capture");
annunciatorRevArm.setBoolValue(0); annunciatorRevArm.setBoolValue(0);
annunciatorHdg.getNode("state").setBoolValue(0);
annunciatorRev.setBoolValue(1); annunciatorRev.setBoolValue(1);
lockRollArm.setIntValue(rollArmModes["OFF"]); lockRollArm.setIntValue(rollArmModes["OFF"]);
annunciatorRol.setBoolValue(0); annunciatorRol.setBoolValue(0);
@ -1092,7 +1064,7 @@ revArmFromRol = func
## ##
# Wait for the HDG annunciator flashing to finish. # Wait for the HDG annunciator flashing to finish.
## ##
if (flashTimer > -0.5) if (hdgFlasher.count)
{ {
#print("flashing..."); #print("flashing...");
annunciatorRol.setBoolValue(0); annunciatorRol.setBoolValue(0);
@ -1105,7 +1077,7 @@ revArmFromRol = func
annunciatorRol.setBoolValue(1); annunciatorRol.setBoolValue(1);
lockRollAxis.setBoolValue(1); lockRollAxis.setBoolValue(1);
settingTargetTurnRate.setDoubleValue(0.0); settingTargetTurnRate.setDoubleValue(0.0);
deviation = getprop(navRadio, "heading-needle-deflection"); deviation = getprop(headingNeedleDeflection);
## ##
# If the deflection is more than 3 degrees wait 5 seconds and check again. # If the deflection is more than 3 degrees wait 5 seconds and check again.
## ##
@ -1207,21 +1179,8 @@ altButton = func {
annunciatorVsNumber.setBoolValue(0); annunciatorVsNumber.setBoolValue(0);
annunciatorAltNumber.setBoolValue(1); annunciatorAltNumber.setBoolValue(1);
altPressure = getprop(staticPort, "pressure-inhg"); altPressure = getprop(staticPressure);
altFt = (baroSettingInhg - altPressure) / 0.00103;
if (altFt > 0.0)
{
altFt = int(altFt/20 + 0.5) * 20;
}
else
{
altFt = int(altFt/20 - 0.5) * 20;
}
#print(altFt);
altPressure = baroSettingInhg - altFt * 0.00103;
settingTargetAltPressure.setDoubleValue(altPressure); settingTargetAltPressure.setDoubleValue(altPressure);
} }
} }
@ -1356,17 +1315,11 @@ baroButtonPress = func {
if (baroSettingUnit == pressureUnits["inHg"]) if (baroSettingUnit == pressureUnits["inHg"])
{ {
settingBaroSettingInhg.setDoubleValue(baroSettingInhg);
baroChange = 1;
annunciatorBsInhgNumber.setBoolValue(1); annunciatorBsInhgNumber.setBoolValue(1);
annunciatorBsHpaNumber.setBoolValue(0); annunciatorBsHpaNumber.setBoolValue(0);
} }
elsif (baroSettingUnit == pressureUnits["hPa"]) elsif (baroSettingUnit == pressureUnits["hPa"])
{ {
settingBaroSettingHpa.setDoubleValue(
baroSettingInhg * 0.03386389);
annunciatorBsHpaNumber.setBoolValue(1); annunciatorBsHpaNumber.setBoolValue(1);
annunciatorBsInhgNumber.setBoolValue(0); annunciatorBsInhgNumber.setBoolValue(0);
} }
@ -1383,19 +1336,19 @@ baroButtonRelease = func {
} }
pow = func { pow = func(base, exponent) {
#print(arg[0],arg[1]); #print(base,exponent);
return math.exp(arg[1]*math.ln(arg[0])); return math.exp(exponent*math.ln(base));
} }
pressureToHeight = func { pressureToHeight = func(p, p0) {
# #
# kollsman shift due to baroSettingInhg = # kollsman shift due to baroSettingInhg =
# baroOffset = pressureToHeight(baroSettingInhg, 29.921260) # baroOffset = pressureToHeight(baroSettingInhg, 29.921260)
# #
p0 = arg[1]; # [Pa] or (p0 and p need to have the same units) #p0 = p0; # [Pa] or (p0 and p need to have the same units)
p = arg[0]; # [Pa] or (p0 and p need to have the same units) #p = p; # [Pa] or (p0 and p need to have the same units)
t0 = 288.15; # [K] same as in atmosphere.?xx t0 = 288.15; # [K] same as in atmosphere.?xx
LR = -0.0065; # [K/m] same as in atmosphere.?xx LR = -0.0065; # [K/m] same as in atmosphere.?xx
g = -9.80665; # [m/s²] same as in atmosphere.?xx g = -9.80665; # [m/s²] same as in atmosphere.?xx
@ -1411,9 +1364,9 @@ pressureToHeight = func {
} }
heightToPressure = func { heightToPressure = func(z, p0) {
p0 = arg[1]; # [Pa] #p0 = p0; # [Pa]
z = arg[0]; # [m] #z = z; # [m]
t0 = 288.15; # [K] t0 = 288.15; # [K]
LR = -0.0065; # [K/m] LR = -0.0065; # [K/m]
g = -9.80665; # [m/s²] g = -9.80665; # [m/s²]
@ -1436,21 +1389,30 @@ altAlert = func {
} }
altFt = pressureAltitude - baroOffset; altFt = pressureAltitude - baroOffset;
prevAltDifference = altDifference;
altDifference = abs(altPreselect - altFt); altDifference = abs(altPreselect - altFt);
if (altDifference > 1000) if (altDifference > 1000)
{ {
annunciatorAltAlert.setBoolValue(0); annunciatorAltAlert.getNode("state").setBoolValue(0);
} }
elsif (altDifference < 1000 and elsif (altDifference < 1000 and
altCaptured == 0) altCaptured == 0)
{ {
if (flashTimer < -0.5) { if (!altAlertFlasher.count)
annunciatorAltAlert.setBoolValue(1); } {
annunciatorAltAlert.getNode("state").setBoolValue(1);
}
if (!altAlertBeeper.count and prevAltDifference > 1000)
{
altAlertBeeper.blink(5).switch(0).switch(1);
}
if (altDifference < 200) if (altDifference < 200)
{ {
if (flashTimer < -0.5) { if (!altAlertFlasher.count)
annunciatorAltAlert.setBoolValue(0); } {
annunciatorAltAlert.getNode("state").setBoolValue(0);
}
if (altDifference < 20) if (altDifference < 20)
{ {
#print("altCapture()"); #print("altCapture()");
@ -1469,14 +1431,11 @@ altAlert = func {
annunciatorVsNumber.setBoolValue(0); annunciatorVsNumber.setBoolValue(0);
annunciatorAltNumber.setBoolValue(1); annunciatorAltNumber.setBoolValue(1);
#altPressure = baroSettingInhg - altPreselect * 0.00103; altPressure = getprop(staticPressure);
#altPressure = heightToPressure(altPreselect*0.3048006,
# baroSettingInhg*3386.389)/3386.389;
altPressure = getprop(staticPort, "pressure-inhg");
settingTargetAltPressure.setDoubleValue(altPressure); settingTargetAltPressure.setDoubleValue(altPressure);
} }
flasher(annunciatorAltAlert, 1.0, 0, 0); altAlertFlasher.blink(1).switch(0).switch(1);
} }
} }
} }
@ -1485,13 +1444,35 @@ altAlert = func {
{ {
if (altDifference > 200) if (altDifference > 200)
{ {
flasher(annunciatorAltAlert, 1.0, 5, 1); altAlertFlasher.blink(5, 1).switch(0).switch(1);
altAlertBeeper.blink(5).switch(0).switch(1);
altCaptured = 0; altCaptured = 0;
} }
} }
settimer(altAlert, 2.0); settimer(altAlert, 2.0);
} }
adjustBaroSettingInhg = func(amount) {
# Adjust baro setting inHg by amount,
# and sync baro setting hPa.
baroSettingInhg = baroSettingInhg + amount;
baroSettingHpa = baroSettingInhg * 0.03386389;
settingBaroSettingHpa.setDoubleValue(baroSettingHpa);
settingBaroSettingInhg.setDoubleValue(baroSettingInhg);
baroChange = 1;
}
adjustbaroSettingHpa = func(amount) {
# Adjust baro setting hPa by amount,
# and sync baro setting inHg.
baroSettingHpa = baroSettingHpa + amount;
baroSettingInhg = baroSettingHpa / 0.03386389;
settingBaroSettingHpa.setDoubleValue(baroSettingHpa);
settingBaroSettingInhg.setDoubleValue(baroSettingInhg);
baroChange = 1;
}
knobSmallUp = func { knobSmallUp = func {
#print("knob small up"); #print("knob small up");
@ -1503,19 +1484,11 @@ knobSmallUp = func {
baroSettingAdjusting = 1; baroSettingAdjusting = 1;
if (baroSettingUnit == pressureUnits["inHg"]) if (baroSettingUnit == pressureUnits["inHg"])
{ {
baroSettingInhg = baroSettingInhg + 0.01; adjustBaroSettingInhg(0.01);
baroSettingHpa = baroSettingInhg * 0.03386389;
settingBaroSettingInhg.setDoubleValue(baroSettingInhg);
baroChange = 1;
} }
elsif (baroSettingUnit == pressureUnits["hPa"]) elsif (baroSettingUnit == pressureUnits["hPa"])
{ {
baroSettingHpa = baroSettingInhg * 0.03386389; adjustbaroSettingHpa(0.001);
baroSettingHpa = baroSettingHpa + 0.001;
baroSettingInhg = baroSettingHpa / 0.03386389;
settingBaroSettingHpa.setDoubleValue(baroSettingHpa);
} }
} }
elsif (baroTimerRunning == 0 and elsif (baroTimerRunning == 0 and
@ -1553,19 +1526,11 @@ knobLargeUp = func {
baroSettingAdjusting = 1; baroSettingAdjusting = 1;
if (baroSettingUnit == pressureUnits["inHg"]) if (baroSettingUnit == pressureUnits["inHg"])
{ {
baroSettingInhg = baroSettingInhg + 1.0; adjustBaroSettingInhg(1.0);
baroSettingHpa = baroSettingInhg * 0.03386389;
settingBaroSettingInhg.setDoubleValue(baroSettingInhg);
baroChange = 1;
} }
elsif (baroSettingUnit == pressureUnits["hPa"]) elsif (baroSettingUnit == pressureUnits["hPa"])
{ {
baroSettingHpa = baroSettingInhg * 0.03386389; adjustbaroSettingHpa(0.1);
baroSettingHpa = baroSettingHpa + 0.1;
baroSettingInhg = baroSettingHpa / 0.03386389;
settingBaroSettingHpa.setDoubleValue(baroSettingHpa);
} }
} }
elsif (baroTimerRunning == 0 and elsif (baroTimerRunning == 0 and
@ -1603,19 +1568,11 @@ knobSmallDown = func {
baroSettingAdjusting = 1; baroSettingAdjusting = 1;
if (baroSettingUnit == pressureUnits["inHg"]) if (baroSettingUnit == pressureUnits["inHg"])
{ {
baroSettingInhg = baroSettingInhg - 0.01; adjustBaroSettingInhg(-0.01);
baroSettingHpa = baroSettingInhg * 0.03386389;
settingBaroSettingInhg.setDoubleValue(baroSettingInhg);
baroChange = 1;
} }
elsif (baroSettingUnit == pressureUnits["hPa"]) elsif (baroSettingUnit == pressureUnits["hPa"])
{ {
baroSettingHpa = baroSettingInhg * 0.03386389; adjustbaroSettingHpa(-0.001);
baroSettingHpa = baroSettingHpa - 0.001;
baroSettingInhg = baroSettingHpa / 0.03386389;
settingBaroSettingHpa.setDoubleValue(baroSettingHpa);
} }
} }
elsif (baroTimerRunning == 0 and elsif (baroTimerRunning == 0 and
@ -1653,19 +1610,11 @@ knobLargeDown = func {
baroSettingAdjusting = 1; baroSettingAdjusting = 1;
if (baroSettingUnit == pressureUnits["inHg"]) if (baroSettingUnit == pressureUnits["inHg"])
{ {
baroSettingInhg = baroSettingInhg - 1.0; adjustBaroSettingInhg(-1.0);
baroSettingHpa = baroSettingInhg * 0.03386389;
settingBaroSettingInhg.setDoubleValue(baroSettingInhg);
baroChange = 1;
} }
elsif (baroSettingUnit == pressureUnits["hPa"]) elsif (baroSettingUnit == pressureUnits["hPa"])
{ {
baroSettingHpa = baroSettingInhg * 0.03386389; adjustbaroSettingHpa(-0.1);
baroSettingHpa = baroSettingHpa - 0.1;
baroSettingInhg = baroSettingHpa / 0.03386389;
settingBaroSettingHpa.setDoubleValue(baroSettingHpa);
} }
} }
elsif (baroTimerRunning == 0 and elsif (baroTimerRunning == 0 and

4
Aircraft/Instruments/KAP140TwoAxis.xml
View file

@ -50,7 +50,7 @@ properties' values.
<name>AP Anunciator</name> <name>AP Anunciator</name>
<condition> <condition>
<equals> <equals>
<property>/autopilot/KAP140/annunciators/ap</property> <property>/autopilot/KAP140/annunciators/ap/state</property>
<value type="bool">true</value> <value type="bool">true</value>
</equals> </equals>
</condition> </condition>
@ -108,7 +108,7 @@ properties' values.
<name>HDG Anunciator</name> <name>HDG Anunciator</name>
<condition> <condition>
<equals> <equals>
<property>/autopilot/KAP140/annunciators/hdg</property> <property>/autopilot/KAP140/annunciators/hdg/state</property>
<value type="bool">true</value> <value type="bool">true</value>
</equals> </equals>
</condition> </condition>

6
Aircraft/Instruments/KAP140TwoAxisAlt.xml
View file

@ -48,7 +48,7 @@ properties' values.
<name>AP Anunciator</name> <name>AP Anunciator</name>
<condition> <condition>
<equals> <equals>
<property>/autopilot/KAP140/annunciators/ap</property> <property>/autopilot/KAP140/annunciators/ap/state</property>
<value type="bool">true</value> <value type="bool">true</value>
</equals> </equals>
</condition> </condition>
@ -106,7 +106,7 @@ properties' values.
<name>HDG Anunciator</name> <name>HDG Anunciator</name>
<condition> <condition>
<equals> <equals>
<property>/autopilot/KAP140/annunciators/hdg</property> <property>/autopilot/KAP140/annunciators/hdg/state</property>
<value type="bool">true</value> <value type="bool">true</value>
</equals> </equals>
</condition> </condition>
@ -526,7 +526,7 @@ properties' values.
<name>ALERT Anunciator</name> <name>ALERT Anunciator</name>
<condition> <condition>
<equals> <equals>
<property>/autopilot/KAP140/annunciators/alt-alert</property> <property>/autopilot/KAP140/annunciators/alt-alert/state</property>
<value type="bool">true</value> <value type="bool">true</value>
</equals> </equals>
</condition> </condition>

12
Aircraft/c172p/c172-sound.xml
View file

@ -234,6 +234,18 @@
</click> </click>
--> -->
<kap140beep>
<name>KAP140Beep</name>
<mode>looped</mode>
<path>Sounds/stall.wav</path>
<condition>
<property>/autopilot/KAP140/annunciators/beep/state</property>
</condition>
<volume>
<offset>0.5</offset>
</volume>
</kap140beep>
</fx> </fx>
</PropertyList> </PropertyList>

32
Aircraft/c172p/c172p-set.xml
View file

@ -73,7 +73,7 @@ Started October 23 2001 by John Check, fgpanels@rockfish.net
<tutorials include="c172-tutorial.xml"/> <tutorials include="c172-tutorial.xml"/>
</sim> </sim>
<!-- trim for level cruise --> <!-- trim for level cruise -->
<controls> <controls>
@ -89,16 +89,11 @@ Started October 23 2001 by John Check, fgpanels@rockfish.net
</controls> </controls>
<autopilot> <autopilot>
<config> <KAP140>
<min-climb-speed-kt type="float">70.0</min-climb-speed-kt> <settings>
<best-climb-speed-kt type="float">75.0</best-climb-speed-kt> <auto-pitch-trim type="bool">true</auto-pitch-trim>
<target-climb-rate-fpm type="float">500.0</target-climb-rate-fpm> </settings>
<target-descent-rate-fpm type="float">1000.0</target-descent-rate-fpm> </KAP140>
<elevator-adj-factor type="float">4000.0</elevator-adj-factor>
<integral-contribution type="float">0.01</integral-contribution>
<zero-pitch-throttle type="float">0.45</zero-pitch-throttle>
<zero-pitch-trim-full-throttle type="float">0.14</zero-pitch-trim-full-throttle>
</config>
</autopilot> </autopilot>
<consumables> <consumables>
@ -122,20 +117,29 @@ Started October 23 2001 by John Check, fgpanels@rockfish.net
<serviceable type="bool">true</serviceable> <serviceable type="bool">true</serviceable>
</encoder> </encoder>
</instrumentation> </instrumentation>
<engines> <engines>
<engine> <engine>
<rpm type="double">700</rpm> <rpm type="double">700</rpm>
</engine> </engine>
</engines> </engines>
<nasal> <nasal>
<electrical> <electrical>
<file>Aircraft/c172/c172-electrical.nas</file> <file>Aircraft/c172/c172-electrical.nas</file>
</electrical> </electrical>
<kap140> <kap140>
<file>Aircraft/Generic/kap140.nas</file> <file>Aircraft/Generic/kap140.nas</file>
<!-- We can set some variables that might be
aircraft specific. We must do it after the file
to override the ones that are in the .nas file.-->
<script><![CDATA[
headingNeedleDeflection = "/instrumentation/nav/heading-needle-deflection";
gsNeedleDeflection = "/instrumentation/nav/gs-needle-deflection";
staticPressure = "systems/static/pressure-inhg";
]]>
</script>
</kap140> </kap140>
</nasal> </nasal>
</PropertyList> </PropertyList>