src/Network/lfsglass.cxx

   1 // LFSGlass.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. Glass 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 #ifdef HAVE_CONFIG_H
  31 #include <config.h>
  32 #endif
  33
  34 #ifdef HAVE_WINDOWS_H
  35 #include <windows.h>
  36 #endif
  37
  38 #include <simgear/debug/logstream.hxx>
  39 #include <simgear/io/iochannel.hxx>
  40
  41 #include <vector>
  42
  43 #include "lfsglass.hxx"
  44 #include <FDM/flight.hxx>
  45 #include <Main/globals.hxx>
  46 #include <Main/fg_props.hxx>
  47
  48 SG_USING_STD(vector);
  49
  50 FGLFSGlass::FGLFSGlass() :
  51         press_node(fgGetNode("/environment/pressure-inhg[0]", true)),
  52         temp_node(fgGetNode("/environment/temperature-degc[0]", true)),
  53         wind_dir_node(fgGetNode("/environment/wind-from-heading-deg[0]", true)),
  54         wind_speed_node(fgGetNode("/environment/wind-speed-kt[0]", true)),
  55         magvar_node(fgGetNode("/environment/magnetic-variation-deg[0]", true)),
  56         p_latitude(fgGetNode("/position/latitude-deg", true)),
  57         p_longitude(fgGetNode("/position/longitude-deg", true)),
  58         p_elev_node(fgGetNode("/position/altitude-ft", true)),
  59         p_altitude_agl(fgGetNode("/position/altitude-agl-ft", true)),
  60         p_pitch(fgGetNode("/orientation/pitch-deg[0]", true)),
  61         p_bank(fgGetNode("/orientation/roll-deg[0]", true)),
  62         p_heading(fgGetNode("/orientation/heading-magnetic-deg[0]", true)),
  63         p_yaw(fgGetNode("/fdm/jsbsim/aero/beta-rad[0]", true)),
  64         p_yaw_rate(fgGetNode("/fdm/jsbsim/aero/betadot-rad_sec[0]", true)),
  65         vel_kcas(fgGetNode("/velocities/airspeed-kt[0]", true)),
  66         p_vvi(fgGetNode("/velocities/vertical-speed-fps[0]", true )),
  67         p_mach(fgGetNode("/velocities/mach[0]", true )),
  68         p_left_aileron(fgGetNode("surface-positions/left-aileron-pos-norm", true)),
  69         p_right_aileron(fgGetNode("surface-positions/right-aileron-pos-norm", true)),
  70         p_elevator(fgGetNode("surface-positions/elevator-pos-norm", true)),
  71         p_elevator_trim(fgGetNode("surface-positions/elevator_trim-pos-norm", true)),
  72         p_rudder(fgGetNode("surface-positions/rudder-pos-norm", true)),
  73         p_flaps(fgGetNode("surface-positions/flap-pos-norm", true)),
  74         p_flaps_cmd(fgGetNode("/controls/flight/flaps", true)),
  75         p_park_brake(fgGetNode("/controls/gear/brake-parking", true)),
  76         egt0_node(fgGetNode("/engines/engine/EGT_degC[0]", true)),
  77         egt1_node(fgGetNode("/engines/engine[1]/EGT_degC[0]", true)),
  78         egt2_node(fgGetNode("/engines/engine[2]/EGT_degC[0]", true)),
  79         egt3_node(fgGetNode("/engines/engine[3]/EGT_degC[0]", true)),
  80         epr0_node(fgGetNode("/engines/engine/EPR[0]", true)),
  81         epr1_node(fgGetNode("/engines/engine[1]/EPR[0]", true)),
  82         epr2_node(fgGetNode("/engines/engine[2]/EPR[0]", true)),
  83         epr3_node(fgGetNode("/engines/engine[3]/EPR[0]", true)),
  84         n10_node(fgGetNode("/engines/engine/N1[0]", true)),
  85         n11_node(fgGetNode("/engines/engine[1]/N1[0]", true)),
  86         n12_node(fgGetNode("/engines/engine[2]/N1[0]", true)),
  87         n13_node(fgGetNode("/engines/engine[3]/N1[0]", true)),
  88         n20_node(fgGetNode("/engines/engine/N2[0]", true)),
  89         n21_node(fgGetNode("/engines/engine[1]/N2[0]", true)),
  90         n22_node(fgGetNode("/engines/engine[2]/N2[0]", true)),
  91         n23_node(fgGetNode("/engines/engine[3]/N2[0]", true)),
  92         oil_temp0(fgGetNode("engines/engine/oil-temp-degF[0]", true)),
  93         oil_temp1(fgGetNode("engines/engine[1]/oil-temp-degF[0]", true)),
  94         oil_temp2(fgGetNode("engines/engine[2]/oil-temp-degF[0]", true)),
  95         oil_temp3(fgGetNode("engines/engine[3]/oil-temp-degF[0]", true)),
  96         tank0_node(fgGetNode("/consumables/fuel/tank/level-lb[0]", true)),
  97         tank1_node(fgGetNode("/consumables/fuel/tank[1]/level-lb[0]", true)),
  98         tank2_node(fgGetNode("/consumables/fuel/tank[2]/level-lb[0]", true)),
  99         tank3_node(fgGetNode("/consumables/fuel/tank[3]/level-lb[0]", true)),
 100         tank4_node(fgGetNode("/consumables/fuel/tank[4]/level-lb[0]", true)),
 101         tank5_node(fgGetNode("/consumables/fuel/tank[5]/level-lb[0]", true)),
 102         tank6_node(fgGetNode("/consumables/fuel/tank[6]/level-lb[0]", true)),
 103         tank7_node(fgGetNode("/consumables/fuel/tank[7]/level-lb[0]", true)),
 104         p_alphadot(fgGetNode("/fdm/jsbsim/aero/alphadot-rad_sec[0]", true)),
 105         p_betadot(fgGetNode("/fdm/jsbsim/aero/betadot-rad_sec[0]", true))
 106
 107 {
 108 }
 109
 110 FGLFSGlass::~FGLFSGlass() {
 111 }
 112
 113 // open hailing frequencies
 114 bool FGLFSGlass::open() {
 115     if ( is_enabled() ) {
 116         SG_LOG( SG_IO, SG_ALERT, "This shouldn't happen, but the channel "
 117                 << "is already in use, ignoring" );
 118         return false;
 119     }
 120
 121     SGIOChannel *io = get_io_channel();
 122
 123     if ( ! io->open( get_direction() ) ) {
 124         SG_LOG( SG_IO, SG_ALERT, "Error opening channel communication layer." );
 125         return false;
 126     }
 127
 128     set_enabled( true );
 129
 130     return true;
 131 }
 132
 133 //static void collect_data( const FGInterface *fdm, ogcFGData *data ) {
 134 void FGLFSGlass::collect_data( const FGInterface *fdm, FGLFSGlassData *data ) {
 135     data->version_id = OGC_VERSION;
 136
 137     data->longitude = p_longitude->getDoubleValue();
 138     data->latitude = p_latitude->getDoubleValue();
 139     data->elevation = p_elev_node->getDoubleValue();
 140     data->magvar = magvar_node->getDoubleValue();
 141
 142     data->pitch = p_pitch->getDoubleValue();
 143     data->bank = p_bank->getDoubleValue();
 144     data->heading = p_heading->getDoubleValue();
 145     //data->altitude = p_altitude->getDoubleValue();
 146     data->altitude_agl = p_altitude_agl->getDoubleValue();
 147
 148     data->vvi = p_vvi->getDoubleValue();
 149     data->mach = p_mach->getDoubleValue();
 150     data->groundspeed = cur_fdm_state->get_V_ground_speed();
 151     data->v_keas = cur_fdm_state->get_V_equiv_kts();
 152     data->v_kcas = vel_kcas->getDoubleValue();
 153
 154
 155     data->phi_dot = cur_fdm_state->get_Phi_dot();
 156     data->theta_dot = cur_fdm_state->get_Theta_dot();
 157     data->psi_dot = cur_fdm_state->get_Psi_dot();
 158
 159     data->alpha = cur_fdm_state->get_Alpha();
 160     data->beta = p_yaw->getDoubleValue();
 161     data->alpha_dot = p_alphadot->getDoubleValue();
 162     data->beta_dot = p_yaw_rate->getDoubleValue();
 163
 164   //data->rudder_trim = p_Controls->get_rudder_trim();
 165     data->parking_brake = p_park_brake->getDoubleValue();
 166
 167     data->left_aileron = p_left_aileron->getDoubleValue();
 168     data->right_aileron = p_right_aileron->getDoubleValue();
 169     data->elevator = p_elevator->getDoubleValue();
 170     data->elevator_trim = p_elevator_trim->getDoubleValue();
 171     data->rudder = p_rudder->getDoubleValue();
 172     data->flaps = p_flaps->getDoubleValue();
 173     data->flaps_cmd = p_flaps_cmd->getDoubleValue();
 174
 175     data->gear_nose = fgGetDouble("gear/gear[0]/position-norm[0]");
 176     data->gear_left = fgGetDouble("gear/gear[1]/position-norm[0]");
 177     data->gear_right = fgGetDouble("gear/gear[2]/position-norm[0]");
 178           data->gear_left_rear = fgGetDouble("gear/gear[3]/position-norm[0]");
 179           data->gear_right_rear = fgGetDouble("gear/gear[4]/position-norm[0]");
 180           data->parking_brake = p_park_brake->getDoubleValue();
 181           data->wow_main = fgGetBool("gear/gear[1]/wow[0]") && fgGetBool("gear/gear[2]/wow[0]");
 182           data->wow_nose = fgGetBool("gear/gear[0]/wow[0]");
 183           //cout << "Nose " << data->wow_nose << " Main " << wow_main << endl;
 184
 185     //data->rpm[0] = fgGetDouble("/engines/engine[0]/rpm");
 186     //data->rpm[1] = fgGetDouble("/engines/engine[1]/rpm");
 187
 188     data->epr[0] = epr0_node->getDoubleValue();
 189     data->epr[1] = epr1_node->getDoubleValue();
 190     data->epr[2] = epr2_node->getDoubleValue();
 191     data->epr[3] = epr3_node->getDoubleValue();
 192
 193     data->egt[0] = egt0_node->getDoubleValue();
 194     data->egt[1] = egt1_node->getDoubleValue();
 195     data->egt[2] = egt2_node->getDoubleValue();
 196     data->egt[3] = egt3_node->getDoubleValue();
 197
 198     data->n2_turbine[0] = n20_node->getDoubleValue();
 199     data->n2_turbine[1] = n21_node->getDoubleValue();
 200     data->n2_turbine[2] = n22_node->getDoubleValue();
 201     data->n2_turbine[3] = n23_node->getDoubleValue();
 202
 203     data->n1_turbine[0] = n10_node->getDoubleValue();
 204     data->n1_turbine[1] = n11_node->getDoubleValue();
 205     data->n1_turbine[2] = n12_node->getDoubleValue();
 206     data->n1_turbine[3] = n13_node->getDoubleValue();
 207
 208 // This is really lbs/hr (pph), converted in FGSimTurbine
 209     data->fuel_flow[0] = fgGetDouble("/engines/engine[0]/fuel-flow-gph");
 210     data->fuel_flow[1] = fgGetDouble("/engines/engine[1]/fuel-flow-gph");
 211     data->fuel_flow[2] = fgGetDouble("/engines/engine[2]/fuel-flow-gph");
 212     data->fuel_flow[3] = fgGetDouble("/engines/engine[3]/fuel-flow-gph");
 213
 214     data->oil_pressure[0] = fgGetDouble("/engines/engine[0]/oil-pressure-psi");
 215     data->oil_pressure[1] = fgGetDouble("/engines/engine[1]/oil-pressure-psi");
 216     data->oil_pressure[2] = fgGetDouble("/engines/engine[2]/oil-pressure-psi");
 217     data->oil_pressure[3] = fgGetDouble("/engines/engine[3]/oil-pressure-psi");
 218
 219     //data->oil_temp[0] = fgGetDouble("/engines/engine[0]/oil-temperature-degf");
 220     //data->oil_temp[1] = fgGetDouble("/engines/engine[1]/oil-temperature-degf");
 221     //data->oil_temp[2] = fgGetDouble("/engines/engine[2]/oil-temperature-degf");
 222     //data->oil_temp[3] = fgGetDouble("/engines/engine[3]/oil-temperature-degf");
 223
 224     data->oil_temp[0] = oil_temp0->getDoubleValue();
 225     data->oil_temp[1] = oil_temp1->getDoubleValue();
 226     data->oil_temp[2] = oil_temp2->getDoubleValue();
 227     data->oil_temp[3] = oil_temp3->getDoubleValue();
 228
 229                 data->hyd_pressure[0] = fgGetDouble("/engines/engine[0]/hyd-pressure-psi");
 230                 data->hyd_pressure[1] = fgGetDouble("/engines/engine[1]/hyd-pressure-psi");
 231                 data->hyd_pressure[2] = fgGetDouble("/engines/engine[2]/hyd-pressure-psi");
 232                 data->hyd_pressure[3] = fgGetDouble("/engines/engine[3]/hyd-pressure-psi");
 233                 // just a temp thing until htdraulic model built
 234 //              data->hyd_pressure[0] = 2750.0;
 235 //              data->hyd_pressure[1] = 2755.0;
 236 //              data->hyd_pressure[2] = 2747.0;
 237 //              data->hyd_pressure[3] = 2851.0;
 238
 239
 240     //data->man_pressure[0] = fgGetDouble("/engines/engine[0]/mp-osi");
 241     //data->man_pressure[1] = fgGetDouble("/engines/engine[1]/mp-osi");
 242
 243     data->fuel_tank[0] = tank0_node->getDoubleValue() * 0.001;
 244     data->fuel_tank[1] = tank1_node->getDoubleValue() * 0.001;
 245     data->fuel_tank[2] = tank2_node->getDoubleValue() * 0.001;
 246     data->fuel_tank[3] = tank3_node->getDoubleValue() * 0.001;
 247     data->fuel_tank[4] = tank4_node->getDoubleValue() * 0.001;
 248     data->fuel_tank[5] = tank5_node->getDoubleValue() * 0.001; // 747 stab tank
 249     data->fuel_tank[6] = tank6_node->getDoubleValue() * 0.001; // 747 res2 tank
 250     data->fuel_tank[7] = tank7_node->getDoubleValue() * 0.001; // 747 res3 tank
 251     double total_fuel = 0.0;
 252     for ( int t= 0; t<8; t++ ) total_fuel += data->fuel_tank[t];
 253     data->fuel_tank[8] = total_fuel;
 254     //data->fuel_tank[8] = 386000.0; // total fuel load
 255                 //cout << endl << "Send " << data->fuel_tank[0] << endl;
 256 /*********
 257                 data->boost_pumps[0] = boost1_node->getBoolValue();
 258                 data->boost_pumps[1] = boost2_node->getBoolValue();
 259                 data->boost_pumps[2] = boost3_node->getBoolValue();
 260                 data->boost_pumps[3] = boost4_node->getBoolValue();
 261                 data->boost_pumps[4] = boost5_node->getBoolValue();
 262                 data->boost_pumps[5] = boost6_node->getBoolValue();
 263                 data->boost_pumps[6] = boost7_node->getBoolValue();
 264                 data->boost_pumps[7] = boost8_node->getBoolValue();
 265
 266                 data->over_ride_pumps[0] = ovride0_node->getBoolValue();
 267                 data->over_ride_pumps[1] = ovride1_node->getBoolValue();
 268                 data->over_ride_pumps[2] = ovride2_node->getBoolValue();
 269                 data->over_ride_pumps[3] = ovride3_node->getBoolValue();
 270                 data->over_ride_pumps[4] = ovride4_node->getBoolValue();
 271                 data->over_ride_pumps[5] = ovride5_node->getBoolValue();
 272
 273                 data->x_feed_valve[0] = x_feed0_node->getBoolValue();
 274                 data->x_feed_valve[1] = x_feed1_node->getBoolValue();
 275                 data->x_feed_valve[2] = x_feed2_node->getBoolValue();
 276                 data->x_feed_valve[3] = x_feed3_node->getBoolValue();
 277                 **********/
 278     data->total_temperature = cur_fdm_state->get_Total_temperature();
 279     data->total_pressure = cur_fdm_state->get_Total_pressure();
 280     data->dynamic_pressure = cur_fdm_state->get_Dynamic_pressure();
 281
 282     data->static_pressure = press_node->getDoubleValue();
 283     data->static_temperature = temp_node->getDoubleValue();
 284     data->wind = wind_speed_node->getDoubleValue();
 285     data->wind_dir =  wind_dir_node->getDoubleValue();
 286     data->sea_level_pressure = fgGetDouble("/environment/sea-level-pressure-inhg");
 287 }
 288
 289 static void distribute_data( const FGLFSGlassData *data, FGInterface *chunk ) {
 290     // just a place holder until the CDU is developed
 291
 292 }
 293
 294 // process work for this port
 295 bool FGLFSGlass::process() {
 296     SGIOChannel *io = get_io_channel();
 297     int length = sizeof(buf);
 298
 299     if ( get_direction() == SG_IO_OUT ) {
 300         collect_data( cur_fdm_state, &buf );
 301         //collect_data( &buf );
 302         if ( ! io->write( (char *)(& buf), length ) ) {
 303             SG_LOG( SG_IO, SG_ALERT, "Error writing data." );
 304             return false;
 305         }
 306     } else if ( get_direction() == SG_IO_IN ) {
 307         if ( io->get_type() == sgFileType ) {
 308             if ( io->read( (char *)(& buf), length ) == length ) {
 309                 SG_LOG( SG_IO, SG_DEBUG, "Success reading data." );
 310                 distribute_data( &buf, cur_fdm_state );
 311             }
 312         } else {
 313             while ( io->read( (char *)(& buf), length ) == length ) {
 314                 SG_LOG( SG_IO, SG_DEBUG, "Success reading data." );
 315                 distribute_data( &buf, cur_fdm_state );
 316             }
 317         }
 318     }
 319
 320     return true;
 321 }
 322
 323
 324 // close the channel
 325 bool FGLFSGlass::close() {
 326     SGIOChannel *io = get_io_channel();
 327
 328     set_enabled( false );
 329
 330     if ( ! io->close() ) {
 331         return false;
 332     }
 333
 334     return true;
 335 }
 336