flightgear/src/Systems/electrical.cxx

// electrical.cxx - a flexible, generic electrical system model.
//
// Written by Curtis Olson, started September 2002.
//
// Copyright (C) 2002  Curtis L. Olson  - curt@flightgear.org
//
// 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., 675 Mass Ave, Cambridge, MA 02139, USA.
//
// $Id$


#include <simgear/misc/exception.hxx>
#include <simgear/misc/sg_path.hxx>

#include <Main/fg_props.hxx>
#include <Main/globals.hxx>

#include "electrical.hxx"


FGElectricalComponent::FGElectricalComponent() :
    kind(-1),
    name(""),
    prop(""),
    value(0.0)
{
}


FGElectricalSupplier::FGElectricalSupplier ( string _name, string _prop,
                                             string _model,
                                             double _volts, double _amps )
{
    kind = FG_SUPPLIER;

    name = _name;
    prop = _prop;
    // cout << "_model = " << _model << endl;
    if ( _model == "battery" ) {
        model = FG_BATTERY;
    } else if ( _model == "alternator" ) {
        model = FG_ALTERNATOR;
    } else if ( _model == "external" ) {
        model = FG_EXTERNAL;
    } else {
        model = FG_UNKNOWN;
    }
    volts = _volts;
    amps = _amps;

    fgSetDouble( prop.c_str(), amps );

    _rpm_node = fgGetNode("/engines/engine[0]/rpm", true);
}  


double FGElectricalSupplier::get_output() {
    if ( model == FG_BATTERY ) {
        // cout << "battery amps = " << amps << endl;
        return amps;
    } else if ( model == FG_ALTERNATOR ) {
        // scale alternator output for rpms < 600.  For rpms >= 600
        // give full output.  This is just a WAG, but I'm keeping
        // things simple to start.
        double rpm = _rpm_node->getDoubleValue();
        double factor = rpm / 600.0;
        if ( factor > 1.0 ) {
            factor = 1.0;
        }
        // cout << "alternator amps = " << amps * factor << endl;
        return amps * factor;
    } else if ( model == FG_EXTERNAL ) {
        // cout << "external amps = " << 0.0 << endl;
        return 0.0;
    } else {
        cout << "unknown supplier type" << endl;
    }

    return 0.0;
}


FGElectricalBus::FGElectricalBus ( string _name, string _prop )
{
    kind = FG_BUS;

    name = _name;
    prop = _prop;
}  


FGElectricalOutput::FGElectricalOutput ( string _name, string _prop )
{
    kind = FG_OUTPUT;

    name = _name;
    prop = _prop;
}  


FGElectricalConnector::FGElectricalConnector ()
{
    kind = FG_CONNECTOR;
    name = "connector";
}  


// return true if all switches are true, false otherwise.  A connector
// could have multiple switches, but they all need to be true(closed)
// for current to get through.
bool FGElectricalConnector::get_state() {
    unsigned int i;
    for ( i = 0; i < switches.size(); ++i ) {
        if ( ! switches[i]->getBoolValue() ) {
            return false;
        }
    }

    return true;
}


FGElectricalSystem::FGElectricalSystem () :
    enabled(false)
{
}


FGElectricalSystem::~FGElectricalSystem () {
}


void FGElectricalSystem::init () {
    config_props = new SGPropertyNode;

    SGPath config( globals->get_fg_root() );
    config.append( fgGetString("/systems/electrical/path") );

    SG_LOG( SG_ALL, SG_ALERT, "Reading electrical system model from "
            << config.str() );
    try {
        readProperties( config.str(), config_props );

        if ( build() ) {
            enabled = true;
        } else {
            SG_LOG( SG_ALL, SG_ALERT,
                    "Detected an internal inconsistancy in the electrical" );
            SG_LOG( SG_ALL, SG_ALERT,
                    " system specification file.  See earlier errors for" );
            SG_LOG( SG_ALL, SG_ALERT,
                    " details.");
            exit(-1);
        }        
    } catch (const sg_exception& exc) {
        SG_LOG( SG_ALL, SG_ALERT, "Failed to load electrical system model: "
                << config.str() );
    }

    delete config_props;
}


void FGElectricalSystem::bind () {
}


void FGElectricalSystem::unbind () {
}


void FGElectricalSystem::update (double dt) {
    if ( !enabled ) {
        return;
    }

    // cout << "Updating electrical system" << endl;

    unsigned int i;

    // zero everything out before we start
    for ( i = 0; i < suppliers.size(); ++i ) {
        suppliers[i]->set_value( 0.0 );
    }
    for ( i = 0; i < buses.size(); ++i ) {
        buses[i]->set_value( 0.0 );
    }
    for ( i = 0; i < outputs.size(); ++i ) {
        outputs[i]->set_value( 0.0 );
    }
    for ( i = 0; i < connectors.size(); ++i ) {
        connectors[i]->set_value( 0.0 );
    }

    // for each supplier, propogate the electrical current
    for ( i = 0; i < suppliers.size(); ++i ) {
        // cout << " Updating: " << suppliers[i]->get_name() << endl;
        propogate( suppliers[i], 0.0, " " );
    }

}


bool FGElectricalSystem::build () {
    SGPropertyNode *node;
    int i, j;

    int count = config_props->nChildren();
    for ( i = 0; i < count; ++i ) {
        node = config_props->getChild(i);
        string name = node->getName();
        // cout << name << endl;
        if ( name == "supplier" ) {
            FGElectricalSupplier *s =
                new FGElectricalSupplier( node->getStringValue("name"),
                                          node->getStringValue("prop"),
                                          node->getStringValue("kind"),
                                          node->getDoubleValue("volts"),
                                          node->getDoubleValue("amps") );
            suppliers.push_back( s );
        } else if ( name == "bus" ) {
            FGElectricalBus *b =
                new FGElectricalBus( node->getStringValue("name"),
                                     node->getStringValue("prop") );
            buses.push_back( b );
        } else if ( name == "output" ) {
            FGElectricalOutput *o =
                new FGElectricalOutput( node->getStringValue("name"),
                                        node->getStringValue("prop") );
            outputs.push_back( o );
        } else if ( name == "connector" ) {
            FGElectricalConnector *c =
                new FGElectricalConnector();
            connectors.push_back( c );
            SGPropertyNode *child;
            int ccount = node->nChildren();
            for ( j = 0; j < ccount; ++j ) {
                child = node->getChild(j);
                string cname = child->getName();
                string cval = child->getStringValue();
                // cout << "  " << cname << " = " << cval << endl;
                if ( cname == "input" ) {
                    FGElectricalComponent *s = find( child->getStringValue() );
                    if ( s != NULL ) {
                        c->add_input( s );
                        if ( s->get_kind() == FG_SUPPLIER ) {
                            s->add_output( c );
                        } else if ( s->get_kind() == FG_BUS ) {
                            s->add_output( c );
                        } else {
                            SG_LOG( SG_ALL, SG_ALERT,
                                    "Attempt to connect to something that can't provide an output: " 
                                    << child->getStringValue() );
                            return false;
                        }
                    } else {
                        SG_LOG( SG_ALL, SG_ALERT,
                                "Can't find named source: " 
                                << child->getStringValue() );
                        return false;
                    }
                } else if ( cname == "output" ) {
                    FGElectricalComponent *s = find( child->getStringValue() );
                    if ( s != NULL ) {
                        c->add_output( s );
                        if ( s->get_kind() == FG_BUS ) {
                            s->add_input( c );
                        } else if ( s->get_kind() == FG_OUTPUT ) {
                            s->add_input( c );
                        } else {
                            SG_LOG( SG_ALL, SG_ALERT,
                                    "Attempt to connect to something that can't provide an input: " 
                                    << child->getStringValue() );
                            return false;
                        }
                    } else {
                        SG_LOG( SG_ALL, SG_ALERT,
                                "Can't find named source: " 
                                << child->getStringValue() );
                        return false;
                    }
                } else if ( cname == "switch" ) {
                    // set default value of switch to true
                    // cout << "Switch = " << child->getStringValue() << endl;
                    fgSetBool( child->getStringValue(), true );
                    c->add_switch( fgGetNode( child->getStringValue(), true ) );
                }
            }
        } else {
            SG_LOG( SG_ALL, SG_ALERT, "Unknown component type specified: " 
                    << name );
            return false;
        }
    }

    return true;
}


// propogate the electrical current through the network
void FGElectricalSystem::propogate( FGElectricalComponent *node, double val,
                                    string s ) {
    s += " ";

    // determine the current to carry forward
    double current = 0.0;
    if ( node->get_kind() == FG_SUPPLIER ) {
        // cout << s << " is a supplier" << endl;
        current = ((FGElectricalSupplier *)node)->get_output();
    } else if ( node->get_kind() == FG_BUS ) {
        // cout << s << " is a bus" << endl;
        current = val;
    } else if ( node->get_kind() == FG_OUTPUT ) {
        // cout << s << " is an output" << endl;
        current = val;
    } else if ( node->get_kind() == FG_CONNECTOR ) {
        // cout << s << " is a connector" << endl;
        if ( ((FGElectricalConnector *)node)->get_state() ) {
            current = val;
        } else {
            current = 0.0;
        }
        // cout << s << "  val = " << current << endl;
    } else {
        cout << "unkown node type" << endl;
    }

    if ( current > node->get_value() ) {
        node->set_value( current );
    }

    if ( ! node->get_prop().empty() ) {
        fgSetDouble( node->get_prop().c_str(), node->get_value() );
    }
    // cout << s << node->get_name() << " -> " << node->get_value() << endl;

    // propogate to all children
    int i;
    for ( i = 0; i < node->get_num_outputs(); ++i ) {
        propogate( node->get_output(i), current, s );
    }
}


// search for the named component and return a pointer to it, NULL otherwise
FGElectricalComponent *FGElectricalSystem::find ( const string &name ) {
    unsigned int i;
    string s;

    // search suppliers
    for ( i = 0; i < suppliers.size(); ++i ) {
        s = suppliers[i]->get_name();
        // cout <<  "    " << s << endl;
        if ( s == name ) {
            return suppliers[i];
        }
    }

    // then search buses
    for ( i = 0; i < buses.size(); ++i ) {
        s = buses[i]->get_name();
        // cout <<  "    " << s << endl;
        if ( s == name ) {
            return buses[i];
        }
    }

    // then search outputs
    for ( i = 0; i < outputs.size(); ++i ) {
        s = outputs[i]->get_name();
        // cout <<  "    " << s << endl;
        if ( s == name ) {
            return outputs[i];
        }
    }

    // nothing found
    return NULL;
}