X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FMain%2Ffg_io.cxx;h=cd66cf0c6447a7b689067f5446cc57a286c4f13e;hb=33425c671d20fc7a7fbb87c2db28aef455b5b5dd;hp=9760f83e6ae925ef2fa1ac9bb00fa4915ca71728;hpb=c2e6992b5e970f392eb287c4bca11bbecb577065;p=flightgear.git diff --git a/src/Main/fg_io.cxx b/src/Main/fg_io.cxx index 9760f83e6..cd66cf0c6 100644 --- a/src/Main/fg_io.cxx +++ b/src/Main/fg_io.cxx @@ -2,7 +2,7 @@ // // Written by Curtis Olson, started November 1999. // -// Copyright (C) 1999 Curtis L. Olson - curt@flightgear.org +// Copyright (C) 1999 Curtis L. Olson - http://www.flightgear.org/~curt // // This program is free software; you can redistribute it and/or // modify it under the terms of the GNU General Public License as @@ -16,195 +16,327 @@ // // 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. +// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. // // $Id$ +#ifdef HAVE_CONFIG_H +# include "config.h" +#endif #include -#include // atoi() +#include // atoi() -#include STL_STRING +#include +#include #include #include #include #include #include +#include #include #include +#include #include +#include #include +#include +#include +#include #include #include +#ifdef FG_JPEG_SERVER +# include +#endif #include +#include #include #include +#include +#include +#include #include #include #include #include #include +#include + +#ifdef FG_HAVE_HLA +#include +#endif #include "globals.hxx" +#include "fg_io.hxx" -SG_USING_STD(string); +using std::atoi; +using std::string; -// define the global I/O channel list -io_container global_io_list; +FGIO::FGIO() +{ +} -// configure a port based on the config string -static FGProtocol *parse_port_config( const string& config ) +FGIO::~FGIO() { - bool short_circuit = false; - string::size_type begin, end; +} - begin = 0; +// configure a port based on the config string +FGProtocol* +FGIO::parse_port_config( const string& config ) +{ SG_LOG( SG_IO, SG_INFO, "Parse I/O channel request: " << config ); - // determine protocol - end = config.find(",", begin); - if ( end == string::npos ) { - return NULL; // dummy + string_list tokens = simgear::strutils::split( config, "," ); + if (tokens.empty()) + { + SG_LOG( SG_IO, SG_ALERT, + "Port configuration error: empty config string" ); + return NULL; } - - string protocol = config.substr(begin, end - begin); - begin = end + 1; + + string protocol = tokens[0]; SG_LOG( SG_IO, SG_INFO, " protocol = " << protocol ); - FGProtocol *io; - if ( protocol == "atlas" ) { - FGAtlas *atlas = new FGAtlas; - io = atlas; - } else if ( protocol == "garmin" ) { - FGGarmin *garmin = new FGGarmin; - io = garmin; - } else if ( protocol == "httpd" ) { - // determine port - string port = config.substr(begin); - FGHttpd *httpd = new FGHttpd( atoi(port.c_str()) ); - io = httpd; - short_circuit = true; - } else if ( protocol == "joyclient" ) { - FGJoyClient *joyclient = new FGJoyClient; - io = joyclient; - } else if ( protocol == "native" ) { - FGNative *native = new FGNative; - io = native; - } else if ( protocol == "native_ctrls" ) { - FGNativeCtrls *native_ctrls = new FGNativeCtrls; - io = native_ctrls; - } else if ( protocol == "nmea" ) { - FGNMEA *nmea = new FGNMEA; - io = nmea; - } else if ( protocol == "props" ) { - FGProps *props = new FGProps; - io = props; - } else if ( protocol == "pve" ) { - FGPVE *pve = new FGPVE; - io = pve; - } else if ( protocol == "ray" ) { - FGRAY *ray = new FGRAY; - io = ray; - } else if ( protocol == "rul" ) { - FGRUL *rul = new FGRUL; - io = rul; - } else { - return NULL; - } + FGProtocol *io = NULL; + + try + { + if ( protocol == "atcsim" ) { + FGATCMain *atcsim = new FGATCMain; + atcsim->set_hz( 30 ); + if ( tokens.size() != 6 ) { + SG_LOG( SG_IO, SG_ALERT, "Usage: --atcsim=[no-]pedals," + << "input0_config,input1_config," + << "output0_config,output1_config,file.nas" ); + delete atcsim; + return NULL; + } + if ( tokens[1] == "no-pedals" ) { + fgSetBool( "/input/atcsim/ignore-pedal-controls", true ); + } else { + fgSetBool( "/input/atcsim/ignore-pedal-controls", false ); + } + atcsim->set_path_names(tokens[2], tokens[3], tokens[4], tokens[5]); + return atcsim; + } else if ( protocol == "atlas" ) { + FGAtlas *atlas = new FGAtlas; + io = atlas; + } else if ( protocol == "opengc" ) { + FGOpenGC *opengc = new FGOpenGC; + io = opengc; + } else if ( protocol == "AV400" ) { + FGAV400 *av400 = new FGAV400; + io = av400; + } else if ( protocol == "AV400Sim" ) { + FGAV400Sim *av400sim = new FGAV400Sim; + io = av400sim; + } else if ( protocol == "AV400WSimA" ) { + FGAV400WSimA *av400wsima = new FGAV400WSimA; + io = av400wsima; + } else if ( protocol == "AV400WSimB" ) { + FGAV400WSimB *av400wsimb = new FGAV400WSimB; + io = av400wsimb; + } else if ( protocol == "garmin" ) { + FGGarmin *garmin = new FGGarmin; + io = garmin; + } else if ( protocol == "httpd" ) { + // determine port + string port = tokens[1]; + return new FGHttpd( atoi(port.c_str()) ); +#ifdef FG_JPEG_SERVER + } else if ( protocol == "jpg-httpd" ) { + // determine port + string port = tokens[1]; + return new FGJpegHttpd( atoi(port.c_str()) ); +#endif + } else if ( protocol == "joyclient" ) { + FGJoyClient *joyclient = new FGJoyClient; + io = joyclient; + } else if ( protocol == "jsclient" ) { + FGJsClient *jsclient = new FGJsClient; + io = jsclient; + } else if ( protocol == "native" ) { + FGNative *native = new FGNative; + io = native; + } else if ( protocol == "native-ctrls" ) { + FGNativeCtrls *native_ctrls = new FGNativeCtrls; + io = native_ctrls; + } else if ( protocol == "native-fdm" ) { + FGNativeFDM *native_fdm = new FGNativeFDM; + io = native_fdm; + } else if ( protocol == "native-gui" ) { + FGNativeGUI *net_gui = new FGNativeGUI; + io = net_gui; + } else if ( protocol == "nmea" ) { + FGNMEA *nmea = new FGNMEA; + io = nmea; + } else if ( protocol == "props" || protocol == "telnet" ) { + io = new FGProps( tokens ); + return io; + } else if ( protocol == "pve" ) { + FGPVE *pve = new FGPVE; + io = pve; + } else if ( protocol == "ray" ) { + FGRAY *ray = new FGRAY; + io = ray; + } else if ( protocol == "rul" ) { + FGRUL *rul = new FGRUL; + io = rul; + } else if ( protocol == "generic" ) { + FGGeneric *generic = new FGGeneric( tokens ); + if (!generic->getInitOk()) + { + // failed to initialize (i.e. invalid configuration) + delete generic; + return NULL; + } + io = generic; + } else if ( protocol == "multiplay" ) { + if ( tokens.size() != 5 ) { + SG_LOG( SG_IO, SG_ALERT, "Ignoring invalid --multiplay option " + "(4 arguments expected: --multiplay=dir,hz,hostname,port)" ); + return NULL; + } + string dir = tokens[1]; + int rate = atoi(tokens[2].c_str()); + string host = tokens[3]; + + short port = atoi(tokens[4].c_str()); + + // multiplay used to be handled by an FGProtocol, but no longer. This code + // retains compatibility with existing command-line syntax + fgSetInt("/sim/multiplay/tx-rate-hz", rate); + if (dir == "in") { + fgSetInt("/sim/multiplay/rxport", port); + fgSetString("/sim/multiplay/rxhost", host.c_str()); + } else if (dir == "out") { + fgSetInt("/sim/multiplay/txport", port); + fgSetString("/sim/multiplay/txhost", host.c_str()); + } - if ( ! short_circuit ) { - // determine medium - end = config.find(",", begin); - if ( end == string::npos ) { - return NULL; // dummy + return NULL; } - - string medium = config.substr(begin, end - begin); - begin = end + 1; - SG_LOG( SG_IO, SG_INFO, " medium = " << medium ); - - // determine direction - end = config.find(",", begin); - if ( end == string::npos ) { - return NULL; // dummy +#ifdef FG_HAVE_HLA + else if ( protocol == "hla" ) { + return new FGHLA(tokens); } - - string direction = config.substr(begin, end - begin); - begin = end + 1; - io->set_direction( direction ); - SG_LOG( SG_IO, SG_INFO, " direction = " << direction ); - - // determine hertz - end = config.find(",", begin); - if ( end == string::npos ) { - return NULL; // dummy - } - - string hertz_str = config.substr(begin, end - begin); - begin = end + 1; - double hertz = atof( hertz_str.c_str() ); - io->set_hz( hertz ); - SG_LOG( SG_IO, SG_INFO, " hertz = " << hertz ); - - if ( medium == "serial" ) { - // device name - end = config.find(",", begin); - if ( end == string::npos ) { + else if ( protocol == "hla-local" ) { + // This is just about to bring up some defaults + if (tokens.size() != 2) { + SG_LOG( SG_IO, SG_ALERT, "Ignoring invalid --hla-local option " + "(one argument expected: --hla-local=" ); return NULL; } - - string device = config.substr(begin, end - begin); - begin = end + 1; - SG_LOG( SG_IO, SG_INFO, " device = " << device ); - - // baud - string baud = config.substr(begin); - SG_LOG( SG_IO, SG_INFO, " baud = " << baud ); - - SGSerial *ch = new SGSerial( device, baud ); - io->set_io_channel( ch ); - } else if ( medium == "file" ) { - // file name - string file = config.substr(begin); - SG_LOG( SG_IO, SG_INFO, " file name = " << file ); - - SGFile *ch = new SGFile( file ); - io->set_io_channel( ch ); - } else if ( medium == "socket" ) { - // hostname - end = config.find(",", begin); - if ( end == string::npos ) { + tokens.insert(tokens.begin(), ""); + tokens.insert(tokens.begin(), "60"); + tokens.insert(tokens.begin(), "bi"); + tokens.push_back("fg-local.xml"); + return new FGHLA(tokens); + } +#endif + else { + return NULL; + } + } + catch (FGProtocolConfigError& err) + { + SG_LOG( SG_IO, SG_ALERT, "Port configuration error: " << err.what() ); + delete io; + return NULL; + } + + if (tokens.size() < 3) { + SG_LOG( SG_IO, SG_ALERT, "Incompatible number of network arguments."); + delete io; + return NULL; + } + string medium = tokens[1]; + SG_LOG( SG_IO, SG_INFO, " medium = " << medium ); + + string direction = tokens[2]; + io->set_direction( direction ); + SG_LOG( SG_IO, SG_INFO, " direction = " << direction ); + + string hertz_str = tokens[3]; + double hertz = atof( hertz_str.c_str() ); + io->set_hz( hertz ); + SG_LOG( SG_IO, SG_INFO, " hertz = " << hertz ); + + if ( medium == "serial" ) { + if ( tokens.size() < 5) { + SG_LOG( SG_IO, SG_ALERT, "Incompatible number of arguments for serial communications."); + delete io; + return NULL; + } + // device name + string device = tokens[4]; + SG_LOG( SG_IO, SG_INFO, " device = " << device ); + + // baud + string baud = tokens[5]; + SG_LOG( SG_IO, SG_INFO, " baud = " << baud ); + + + SGSerial *ch = new SGSerial( device, baud ); + io->set_io_channel( ch ); + + if ( protocol == "AV400WSimB" ) { + if ( tokens.size() < 7 ) { + SG_LOG( SG_IO, SG_ALERT, "Missing second hz for AV400WSimB."); + delete io; return NULL; } - - string hostname = config.substr(begin, end - begin); - begin = end + 1; - SG_LOG( SG_IO, SG_INFO, " hostname = " << hostname ); - - // port string - end = config.find(",", begin); - if ( end == string::npos ) { - return NULL; + FGAV400WSimB *fgavb = static_cast(io); + string hz2_str = tokens[6]; + double hz2 = atof(hz2_str.c_str()); + fgavb->set_hz2(hz2); + } + } else if ( medium == "file" ) { + // file name + if ( tokens.size() < 4) { + SG_LOG( SG_IO, SG_ALERT, "Incompatible number of arguments for file I/O."); + delete io; + return NULL; + } + + string file = tokens[4]; + SG_LOG( SG_IO, SG_INFO, " file name = " << file ); + int repeat = 1; + if (tokens.size() >= 7 && tokens[6] == "repeat") { + if (tokens.size() >= 8) { + repeat = atoi(tokens[7].c_str()); + FGGeneric* generic = dynamic_cast(io); + if (generic) + generic->setExitOnError(true); + } else { + repeat = -1; } - - string port = config.substr(begin, end - begin); - begin = end + 1; - SG_LOG( SG_IO, SG_INFO, " port string = " << port ); - - // socket style - string style_str = config.substr(begin); - SG_LOG( SG_IO, SG_INFO, " style string = " << style_str ); - - SGSocket *ch = new SGSocket( hostname, port, style_str ); - io->set_io_channel( ch ); } + SGFile *ch = new SGFile( file, repeat ); + io->set_io_channel( ch ); + } else if ( medium == "socket" ) { + if ( tokens.size() < 6) { + SG_LOG( SG_IO, SG_ALERT, "Incompatible number of arguments for socket communications."); + delete io; + return NULL; + } + string hostname = tokens[4]; + string port = tokens[5]; + string style = tokens[6]; + + SG_LOG( SG_IO, SG_INFO, " hostname = " << hostname ); + SG_LOG( SG_IO, SG_INFO, " port = " << port ); + SG_LOG( SG_IO, SG_INFO, " style = " << style ); + + io->set_io_channel( new SGSocket( hostname, port, style ) ); } return io; @@ -213,83 +345,104 @@ static FGProtocol *parse_port_config( const string& config ) // step through the port config streams (from fgOPTIONS) and setup // serial port channels for each -void fgIOInit() { - // SG_LOG( SG_IO, SG_INFO, "I/O Channel initialization, " << +void +FGIO::init() +{ + // SG_LOG( SG_IO, SG_INFO, "I/O Channel initialization, " << // globals->get_channel_options_list()->size() << " requests." ); - FGProtocol *p; - string_list *channel_options_list = globals->get_channel_options_list(); + _realDeltaTime = fgGetNode("/sim/time/delta-realtime-sec"); // we could almost do this in a single step except pushing a valid // port onto the port list copies the structure and destroys the // original, which closes the port and frees up the fd ... doh!!! - // parse the configuration strings and store the results in the - // appropriate FGIOChannel structures - for ( int i = 0; i < (int)channel_options_list->size(); ++i ) { - p = parse_port_config( (*channel_options_list)[i] ); - if ( p != NULL ) { - p->open(); - global_io_list.push_back( p ); - if ( !p->is_enabled() ) { - SG_LOG( SG_IO, SG_ALERT, "I/O Channel config failed." ); - exit(-1); - } - } else { - SG_LOG( SG_IO, SG_INFO, "I/O Channel parse failed." ); - } - } + string_list::iterator i = globals->get_channel_options_list()->begin(); + string_list::iterator end = globals->get_channel_options_list()->end(); + for (; i != end; ++i ) { + add_channel( *i ); + } // of channel options iteration } +// add another I/O channel +void FGIO::add_channel(const string& config) +{ + // parse the configuration string and store the results in the + // appropriate FGIOChannel structure + FGProtocol *p = parse_port_config( config ); + if (!p) + { + return; + } -// process any serial port work -void fgIOProcess() { - FGProtocol *p; + p->open(); + if ( !p->is_enabled() ) { + SG_LOG( SG_IO, SG_ALERT, "I/O Channel config failed." ); + delete p; + return; + } - // cout << "processing I/O channels" << endl; + io_channels.push_back( p ); +} - static int inited = 0; - int interval; - static SGTimeStamp last; - SGTimeStamp current; +void +FGIO::reinit() +{ +} - if ( ! inited ) { - inited = 1; - last.stamp(); - interval = 0; - } else { - current.stamp(); - interval = current - last; - last = current; - } +// process any IO channel work +void +FGIO::update( double /* delta_time_sec */ ) +{ + // use wall-clock, not simulation, delta time, so that network + // protocols update when the simulation is paused + // see http://code.google.com/p/flightgear-bugs/issues/detail?id=125 + double delta_time_sec = _realDeltaTime->getDoubleValue(); + + ProtocolVec::iterator i = io_channels.begin(); + ProtocolVec::iterator end = io_channels.end(); + for (; i != end; ++i ) { + FGProtocol* p = *i; + if (!p->is_enabled()) { + continue; + } - for ( int i = 0; i < (int)global_io_list.size(); ++i ) { - // cout << " channel = " << i << endl; - p = global_io_list[i]; - - if ( p->is_enabled() ) { - p->dec_count_down( interval ); - while ( p->get_count_down() < 0 ) { - p->process(); - p->dec_count_down( -1000000.0 / p->get_hz() ); - } - } - } + p->dec_count_down( delta_time_sec ); + double dt = 1 / p->get_hz(); + if ( p->get_count_down() < 0.33 * dt ) { + p->process(); + p->inc_count(); + while ( p->get_count_down() < 0.33 * dt ) { + p->inc_count_down( dt ); + } + } // of channel processing + } // of io_channels iteration } +void +FGIO::shutdown() +{ + ProtocolVec::iterator i = io_channels.begin(); + ProtocolVec::iterator end = io_channels.end(); + for (; i != end; ++i ) + { + FGProtocol *p = *i; + if ( p->is_enabled() ) { + p->close(); + } -// shutdown all I/O connections -void fgIOShutdownAll() { - FGProtocol *p; + delete p; + } - // cout << "processing I/O channels" << endl; + io_channels.clear(); +} - for ( int i = 0; i < (int)global_io_list.size(); ++i ) { - // cout << " channel = " << i << endl; - p = global_io_list[i]; +void +FGIO::bind() +{ +} - if ( p->is_enabled() ) { - p->close(); - } - } +void +FGIO::unbind() +{ }