src/Network/opengc.cxx

   1 // opengc.cxx - Network interface program to send data to display processor over LAN
   2 //
   3 // Created by:  J. Wojnaroski  -- castle@mminternet.com
   4 // Date:                21 Nov 2001
   5 //
   6 // Extended from original network code developed by C. Olson
   7 //
   8 //  Modified 12/02/01 - Update engine structure for multi-engine models
   9 //                        - Added data preamble to id msg types
  10 //
  11 //  Modified 01/23/02 - Converted portions of the Engine and Gear accesssors to properties
  12 //                          - Removed data from navigation functions. OpenGC provides own nav functions
  13 //
  14 //  Modified 03/05/03 - Modified to reduce need to search property tree for each node per frame
  15 //
  16 // This program is free software; you can redistribute it and/or
  17 // modify it under the terms of the GNU General Public License as
  18 // published by the Free Software Foundation; either version 2 of the
  19 // License, or (at your option) any later version.
  20 //
  21 // This program is distributed in the hope that it will be useful, but
  22 // WITHOUT ANY WARRANTY; without even the implied warranty of
  23 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  24 // General Public License for more details.
  25 //
  26 // You should have received a copy of the GNU General Public License
  27 // along with this program; if not, write to the Free Software
  28 // Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  29 //
  30
  31 #include <simgear/debug/logstream.hxx>
  32 #include <simgear/io/iochannel.hxx>
  33
  34 #include <vector>
  35
  36 #include "opengc.hxx"
  37 #include <FDM/flight.hxx>
  38 #include <Main/globals.hxx>
  39 #include <Cockpit/radiostack.hxx>
  40 #include <Controls/controls.hxx>
  41 #include <Main/fg_props.hxx>
  42
  43 SG_USING_STD(vector);
  44
  45 FGOpenGC::FGOpenGC() :
  46         press_node(fgGetNode("/environment/pressure-inhg", true)),
  47         temp_node(fgGetNode("/environment/temperature-degc", true)),
  48         wind_dir_node(fgGetNode("/environment/wind-from-heading-deg", true)),
  49         wind_speed_node(fgGetNode("/environment/wind-speed-kt", true)),
  50         mag_var_node(fgGetNode("/environment/magnetic-variation-deg", true)),
  51         p_left_aileron(fgGetNode("surface-positions/left-aileron-pos-norm", true)),
  52         p_right_aileron(fgGetNode("surface-positions/right-aileron-pos-norm", true)),
  53         p_elevator(fgGetNode("surface-positions/elevator-pos-norm", true)),
  54         p_elevator_trim(fgGetNode("surface-positions/elevator_trim-pos-norm", true)),
  55         p_rudder(fgGetNode("surface-positions/rudder-pos-norm", true)),
  56         p_flaps(fgGetNode("surface-positions/flap-pos-norm", true)),
  57         p_flaps_cmd(fgGetNode("/controls/flaps", true)),
  58         p_alphadot(fgGetNode("/fdm/jsbsim/aero/alphadot-radsec", true)),
  59         p_betadot(fgGetNode("/fdm/jsbsim/aero/betadot-radsec", true)),
  60         p_latitude(fgGetNode("/position/latitude-deg", true)),
  61         p_longitude(fgGetNode("/position/longitude-deg", true)),
  62         p_alt_node(fgGetNode("/position/altitude-ft", true)),
  63         p_altitude(fgGetNode("/steam/altitude-ft", true)),
  64         p_altitude_agl(fgGetNode("/position/altitude-agl-ft", true)),
  65         egt0_node(fgGetNode("/engines/engine/egt-degf", true)),
  66         egt1_node(fgGetNode("/engines/engine[1]/egt-degf", true)),
  67         egt2_node(fgGetNode("/engines/engine[2]/egt-degf", true)),
  68         egt3_node(fgGetNode("/engines/engine[3]/egt-degf", true))
  69
  70 {
  71 }
  72
  73 FGOpenGC::~FGOpenGC() {
  74 }
  75
  76 // open hailing frequencies
  77 bool FGOpenGC::open() {
  78     if ( is_enabled() ) {
  79         SG_LOG( SG_IO, SG_ALERT, "This shouldn't happen, but the channel "
  80                 << "is already in use, ignoring" );
  81         return false;
  82     }
  83
  84     SGIOChannel *io = get_io_channel();
  85
  86     if ( ! io->open( get_direction() ) ) {
  87         SG_LOG( SG_IO, SG_ALERT, "Error opening channel communication layer." );
  88         return false;
  89     }
  90
  91     set_enabled( true );
  92
  93     return true;
  94 }
  95
  96 //static void collect_data( const FGInterface *fdm, ogcFGData *data ) {
  97 void FGOpenGC::collect_data( const FGInterface *fdm, ogcFGData *data ) {
  98
  99     data->version_id = OGC_VERSION;
 100
 101     data->longitude = p_longitude->getDoubleValue();
 102     data->latitude = p_latitude->getDoubleValue();
 103     data->elevation = p_alt_node->getDoubleValue();
 104     data->magvar = mag_var_node->getDoubleValue();
 105
 106     //cout << "ID: " << OGC_VERSION  << " Lon: " << data->longitude << " Lat: " << data->latitude << endl;
 107
 108     data->pitch = cur_fdm_state->get_Theta_deg();
 109     data->bank = cur_fdm_state->get_Phi_deg();
 110     data->heading = cur_fdm_state->get_Psi_deg();
 111     data->altitude = p_altitude->getDoubleValue();
 112     data->altitude_agl = p_altitude_agl->getDoubleValue();
 113     data->v_kcas = cur_fdm_state->get_V_calibrated_kts();
 114     data->vvi = cur_fdm_state->get_Climb_Rate();
 115     data->mach = cur_fdm_state->get_Mach_number();
 116     data->groundspeed = cur_fdm_state->get_V_ground_speed();
 117     data->v_keas = cur_fdm_state->get_V_equiv_kts();
 118
 119     data->phi_dot = cur_fdm_state->get_Phi_dot();
 120     data->theta_dot = cur_fdm_state->get_Theta_dot();
 121     data->psi_dot = cur_fdm_state->get_Psi_dot();
 122
 123     data->alpha = cur_fdm_state->get_Alpha();
 124     data->beta = cur_fdm_state->get_Beta();
 125     data->alpha_dot = p_alphadot->getDoubleValue();
 126     data->beta_dot = p_betadot->getDoubleValue();
 127
 128     //data->rudder_trim = p_Controls->get_rudder_trim();
 129
 130     data->left_aileron = p_left_aileron->getDoubleValue();
 131     data->right_aileron = p_right_aileron->getDoubleValue();
 132     data->elevator = p_elevator->getDoubleValue();
 133     data->elevator_trim = p_elevator_trim->getDoubleValue();
 134     data->rudder = p_rudder->getDoubleValue();
 135     data->flaps = p_flaps->getDoubleValue();
 136     data->flaps_cmd = p_flaps_cmd->getDoubleValue();
 137
 138     data->gear_nose = fgGetDouble("gear/gear[0]/position-norm");
 139     data->gear_left = fgGetDouble("gear/gear[1]/position-norm");
 140     data->gear_right = fgGetDouble("gear/gear[2]/position-norm");
 141           data->gear_left_rear = fgGetDouble("gear/gear[3]/position-norm");
 142           data->gear_right_rear = fgGetDouble("gear/gear[4]/position-norm");
 143
 144     data->rpm[0] = fgGetDouble("/engines/engine[0]/rpm");
 145     data->rpm[1] = fgGetDouble("/engines/engine[1]/rpm");
 146
 147     data->epr[0] = fgGetDouble("/engines/engine[0]/epr");
 148     data->epr[1] = fgGetDouble("/engines/engine[1]/epr");
 149     data->epr[2] = fgGetDouble("/engines/engine[2]/epr");
 150     data->epr[3] = fgGetDouble("/engines/engine[3]/epr");
 151
 152     data->egt[0] = (egt0_node->getDoubleValue() - 32.0) * 0.555;
 153     data->egt[1] = (egt1_node->getDoubleValue() - 32.0) * 0.555;
 154     data->egt[2] = (egt2_node->getDoubleValue() - 32.0) * 0.555;
 155     data->egt[3] = (egt3_node->getDoubleValue() - 32.0) * 0.555;
 156
 157     data->n2_turbine[0] = fgGetDouble("/engines/engine[0]/n2");
 158     data->n2_turbine[1] = fgGetDouble("/engines/engine[1]/n2");
 159     data->n2_turbine[2] = fgGetDouble("/engines/engine[2]/n2");
 160     data->n2_turbine[3] = fgGetDouble("/engines/engine[3]/n2");
 161
 162     data->n1_turbine[0] = fgGetDouble("/engines/engine[0]/n1");
 163     data->n1_turbine[1] = fgGetDouble("/engines/engine[1]/n1");
 164     data->n1_turbine[2] = fgGetDouble("/engines/engine[2]/n1");
 165     data->n1_turbine[3] = fgGetDouble("/engines/engine[3]/n1");
 166 // the units for turbine engines is lbs/hr divide by 6.5 to convert to gph if piston type
 167     data->fuel_flow[0] = fgGetDouble("/engines/engine[0]/fuel-flow-gph");
 168     data->fuel_flow[1] = fgGetDouble("/engines/engine[1]/fuel-flow-gph");
 169     data->fuel_flow[2] = fgGetDouble("/engines/engine[2]/fuel-flow-gph");
 170     data->fuel_flow[3] = fgGetDouble("/engines/engine[3]/fuel-flow-gph");
 171
 172     data->oil_pressure[0] = fgGetDouble("/engines/engine[0]/oil-pressure-psi");
 173     data->oil_pressure[1] = fgGetDouble("/engines/engine[1]/oil-pressure-psi");
 174     data->oil_pressure[2] = fgGetDouble("/engines/engine[2]/oil-pressure-psi");
 175     data->oil_pressure[3] = fgGetDouble("/engines/engine[3]/oil-pressure-psi");
 176
 177     data->oil_temp[0] = fgGetDouble("/engines/engine[0]/OilTemp_degK");
 178     data->oil_temp[1] = fgGetDouble("/engines/engine[1]/OilTemp_degK");
 179     data->oil_temp[2] = fgGetDouble("/engines/engine[2]/OilTemp_degK");
 180     data->oil_temp[3] = fgGetDouble("/engines/engine[3]/OilTemp_degK");
 181     //  dummy value to fill data packet
 182     data->oil_quantity[0] = fgGetDouble("/engines/engine[0]/oil-quantity");
 183     data->oil_quantity[1] = fgGetDouble("/engines/engine[1]/oil-quantity");
 184     data->oil_quantity[2] = fgGetDouble("/engines/engine[2]/oil-quantity");
 185     data->oil_quantity[3] = fgGetDouble("/engines/engine[3]/oil-quantity");
 186     data->oil_quantity[0] = 40.3; data->oil_quantity[1] = 44.6;
 187
 188     data->hyd_pressure[0] = fgGetDouble("/engines/engine[0]/hyd-pressure-psi");
 189     data->hyd_pressure[1] = fgGetDouble("/engines/engine[1]/hyd-pressure-psi");
 190     data->hyd_pressure[2] = fgGetDouble("/engines/engine[2]/hyd-pressure-psi");
 191     data->hyd_pressure[3] = fgGetDouble("/engines/engine[3]/hyd-pressure-psi");
 192     data->hyd_pressure[0] = 3215.0; data->hyd_pressure[1] = 3756.0;
 193
 194     data->man_pressure[0] = fgGetDouble("/engines/engine[0]/mp-osi");
 195     data->man_pressure[1] = fgGetDouble("/engines/engine[1]/mp-osi");
 196
 197     data->tank[0] = fgGetDouble("/consumables/fuel/tank[2]/level-gal_us") * 6.6;
 198     data->tank[1] = fgGetDouble("/consumables/fuel/tank/level-gal_us") * 6.6;
 199     data->tank[2] = fgGetDouble("/consumables/fuel/tank[1]/level-gal_us") * 6.6;
 200     //data->tank[0] = 3000.0;
 201     //data->tank[1] = 9800.0;
 202     //data->tank[2] = 9800.0;
 203
 204     data->total_temperature = cur_fdm_state->get_Total_temperature();
 205     data->total_pressure = cur_fdm_state->get_Total_pressure();
 206     data->dynamic_pressure = cur_fdm_state->get_Dynamic_pressure();
 207
 208     data->static_pressure = press_node->getDoubleValue();
 209     data->static_temperature = temp_node->getDoubleValue();
 210     data->wind = wind_speed_node->getDoubleValue();
 211     data->wind_dir =  wind_dir_node->getDoubleValue();
 212 }
 213
 214 static void distribute_data( const ogcFGData *data, FGInterface *chunk ) {
 215     // just a place holder until the CDU is developed
 216
 217 }
 218
 219 // process work for this port
 220 bool FGOpenGC::process() {
 221     SGIOChannel *io = get_io_channel();
 222     int length = sizeof(buf);
 223
 224     if ( get_direction() == SG_IO_OUT ) {
 225         collect_data( cur_fdm_state, &buf );
 226         //collect_data( &buf );
 227         if ( ! io->write( (char *)(& buf), length ) ) {
 228             SG_LOG( SG_IO, SG_WARN, "Error writing data." );
 229             return false;
 230         }
 231     } else if ( get_direction() == SG_IO_IN ) {
 232         if ( io->get_type() == sgFileType ) {
 233             if ( io->read( (char *)(& buf), length ) == length ) {
 234                 SG_LOG( SG_IO, SG_DEBUG, "Success reading data." );
 235                 distribute_data( &buf, cur_fdm_state );
 236             }
 237         } else {
 238             while ( io->read( (char *)(& buf), length ) == length ) {
 239                 SG_LOG( SG_IO, SG_DEBUG, "Success reading data." );
 240                 distribute_data( &buf, cur_fdm_state );
 241             }
 242         }
 243     }
 244
 245     return true;
 246 }
 247
 248
 249 // close the channel
 250 bool FGOpenGC::close() {
 251     SGIOChannel *io = get_io_channel();
 252
 253     set_enabled( false );
 254
 255     if ( ! io->close() ) {
 256         return false;
 257     }
 258
 259     return true;
 260 }
 261