src/Instrumentation/transponder.cxx

   1 // transponder.cxx -- class to impliment a transponder
   2 //
   3 // Written by Roy Vegard Ovesen, started September 2004.
   4 //
   5 // Copyright (C) 2004  Roy Vegard Ovesen - rvovesen@tiscali.no
   6 //
   7 // This program is free software; you can redistribute it and/or
   8 // modify it under the terms of the GNU General Public License as
   9 // published by the Free Software Foundation; either version 2 of the
  10 // License, or (at your option) any later version.
  11 //
  12 // This program is distributed in the hope that it will be useful, but
  13 // WITHOUT ANY WARRANTY; without even the implied warranty of
  14 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15 // General Public License for more details.
  16 //
  17 // You should have received a copy of the GNU General Public License
  18 // along with this program; if not, write to the Free Software
  19 // Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20
  21 #ifdef HAVE_CONFIG_H
  22 #  include <config.h>
  23 #endif
  24
  25 #include "transponder.hxx"
  26
  27 Transponder::Transponder(SGPropertyNode *node)
  28     :
  29     name("transponder"),
  30     num(0),
  31     encoder("/instrumentation/encoder")
  32 {
  33     int i;
  34     for ( i = 0; i < node->nChildren(); ++i ) {
  35         SGPropertyNode *child = node->getChild(i);
  36         string cname = child->getName();
  37         string cval = child->getStringValue();
  38         if ( cname == "name" ) {
  39             name = cval;
  40         } else if ( cname == "number" ) {
  41             num = child->getIntValue();
  42         } else if ( cname == "encoder" ) {
  43             encoder = cval;
  44         } else {
  45             SG_LOG( SG_INSTR, SG_WARN,
  46                     "Error in transponder config logic" );
  47             if ( name.length() ) {
  48                 SG_LOG( SG_INSTR, SG_WARN, "Section = " << name );
  49             }
  50         }
  51     }
  52 }
  53
  54
  55 Transponder::~Transponder()
  56 {
  57 }
  58
  59
  60 void Transponder::init()
  61 {
  62     string branch;
  63     branch = "/instrumentation/" + name;
  64     encoder += "/mode-c-alt-ft";
  65
  66     SGPropertyNode *node = fgGetNode(branch.c_str(), num, true );
  67     // Inputs
  68     pressureAltitudeNode = fgGetNode(encoder.c_str(), true);
  69     busPowerNode = fgGetNode("/systems/electrical/outputs/transponder", true);
  70     serviceableNode = node->getChild("serviceable", 0, true);
  71     // Outputs
  72     idCodeNode = node->getChild("id-code", 0, true);
  73     flightLevelNode = node->getChild("flight-level", 0, true);
  74 }
  75
  76
  77 void Transponder::update(double dt)
  78 {
  79     if (serviceableNode->getBoolValue())
  80     {
  81         int idCode = idCodeNode->getIntValue();
  82         if (idCode < 0)
  83             idCode = 0;
  84         int firstDigit  = idCode % 10;
  85         int secondDigit = (idCode/10) % 10;
  86         int thirdDigit  = (idCode/100) % 10;
  87         int fourthDigit = (idCode/1000) % 10;
  88
  89         if (firstDigit-7 > 0)
  90             idCode -= firstDigit-7;
  91         if (secondDigit-7 > 0)
  92             idCode -= (secondDigit-7) * 10;
  93         if (thirdDigit-7 > 0)
  94             idCode -= (thirdDigit-7) * 100;
  95         if (fourthDigit-7 > 0)
  96             idCode -= (fourthDigit-7) * 1000;
  97
  98         if (idCode > 7777)
  99             idCode = 7777;
 100         else if (idCode < 0)
 101             idCode = 0;
 102
 103         idCodeNode->setIntValue(idCode);
 104
 105         int pressureAltitude = pressureAltitudeNode->getIntValue();
 106         int flightLevel = pressureAltitude / 100;
 107         flightLevelNode->setIntValue(flightLevel);
 108     }
 109 }