FGFS-4.1/flightgear
3
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

first commit

Browse Source
This commit is contained in:
Your Name
2022-10-20 20:29:11 +08:00
commit 4d531f8044
3238 changed files with 1387862 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/Network/igc.cxx
+236
View File
@@ -0,0 +1,236 @@
// igc.cxx -- International Glider Commission (IGC) protocol class
//
// Written by Thorsten Brehm, started October 2013.
//
// Copyright (C) 2013 Thorsten Brehm - brehmt (at) gmail com
//
// 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., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA.
//
///////////////////////////////////////////////////////////////////////////////
/* Usage:
* "fgfs --igc=file,out,1,OutputFile.igc"
*/
#include "config.h"
#include <stdio.h> // sprintf
#include <simgear/debug/logstream.hxx>
#include <simgear/math/sg_geodesy.hxx>
#include <simgear/io/iochannel.hxx>
#include <simgear/timing/sg_time.hxx>
#include <Main/fg_props.hxx>
#include <Main/globals.hxx>
#include "igc.hxx"
IGCProtocol::IGCProtocol() :
length(0)
{
}
IGCProtocol::~IGCProtocol()
{
}
// generate IGC header records
bool IGCProtocol::gen_Hrecords()
{
const std::string AircraftType = fgGetString("/sim/aircraft", "unknown");
const std::string Callsign = fgGetString("/sim/multiplay/callsign", "");
SGTime *t = globals->get_time_params();
int Day = t->getGmt()->tm_mday;
int Month = t->getGmt()->tm_mon+1;
int Year = t->getGmt()->tm_year % 100;
#ifdef FLIGHTGEAR_VERSION
const char* Version = FLIGHTGEAR_VERSION;
#else
const char* Version = "unknown version";
#endif
length = snprintf(buf, FG_MAX_MSG_SIZE,
"AXYYZZZFlightGear\r\n" // Manufacturer code
"HFDTE%02d%02d%02d\r\n" // date: DDMMYY
"HFFXA001\r\n" // fix accuracy (1 meter)
"HFGTYGliderType:%s\r\n" // aircraft type
"HFGIDGliderID:%s\r\n" // callsign
"HFDTM100GPSDatum:WGS84\r\n" // GPS datum type
"HFRFWFirmwareVersion:FlightGear %s\r\n" // "firmware" version
"HFRHWHardwareVersion:FlightGear Flight Simulator\r\n" // "hardware" version
"HFFTYFRType:Flight Simulator\r\n", // logger type
Day, Month, Year,
AircraftType.c_str(),
Callsign.c_str(),
Version);
SGIOChannel *io = get_io_channel();
io->write(buf, length);
return true;
}
// generate igc B record message
bool IGCProtocol::gen_message()
{
/* IGC B-record spec:
* B H H M M S S D D M MM MM N D D D M MM MM E V P P P P P G G G G G CR LF
*
* Description Size Element Remarks
* ------------------------------------------------------------------------------------------------------------------------------------------------
* Time UTC 6 bytes HHMMSS Valid characters 0-9. When a valid GNSS fix is received, the UTC time
* in a B-record line must be obtained directly from the same GNSS data
* package that was the source of the Lat/long and GNSS altitude that is
* recorded in the same B-record line. Other sources for the time in a
* B-record line (such as the Real-Time Clock in the recorder) must only
* be used to provide time-continuity where GNSS fixes are not available.
* Latitude 8 bytes DDMMmmmN/S Valid characters N, S, 0-9. Obtained directly from the same GPS data
* package that was the source of the UTC time that is recorded in the
* same B-record line. If no latitude is obtained from satellite data,
* pressure altitude fixing must continue, using times from the RTC.
* In this case, in B record lines must repeat the last latitude that was
* obtained from satellite data, until GPS fixing is regained.
* Longitude 9 bytes DDDMMmmmE/W Valid characters E,W, 0-9. Obtained directly from the same GPS data
* package that was the source of UTC time that is recorded in the same
* B-record line. If no longitude is obtained from satellite data,
* pressure altitude fixing must continue, using times from the RTC.
* In this case, in B record lines must repeat the last longitude
* that was obtained from satellite data, until GPS fixing is regained.
* Fix validity 1 byte. A or V Use A for a 3D fix and V for a 2D fix (no GPS altitude) or for no
* GPS data (pressure altitude data must continue to be recorded using
* times from the RTC).
* Press Alt. 5 bytes PPPPP Altitude to the ICAO ISA above the 1013.25 hPa sea level datum, valid
* characters 0-9 and negative sign "-". Negative values to have negative
* sign instead of leading zero.
* GNSS Alt. 5 bytes GGGGG Altitude above the WGS84 ellipsoid, valid characters 0-9.
*/
char lonDir = 'E', latDir = 'N';
int lonDeg, latDeg, lonMin, latMin;
SGTime *t = globals->get_time_params();
double deg = fdm.get_Latitude() * SGD_RADIANS_TO_DEGREES;
if (deg < 0.0)
{
deg = -deg;
latDir = 'S';
}
latDeg = (int)(deg);
latMin = (int)((deg - (double)latDeg) * 60.0 * 1000.0);
deg = fdm.get_Longitude() * SGD_RADIANS_TO_DEGREES;
if (deg < 0.0)
{
deg = -deg;
lonDir = 'W';
}
lonDeg = (int)(deg);
lonMin = (int)((deg - (double)lonDeg) * 60.0 * 1000.0);
int Altitude = fdm.get_Altitude() * SG_FEET_TO_METER;
if (Altitude < 0)
Altitude = 0;
int h = t->getGmt()->tm_hour;
int m = t->getGmt()->tm_min;
int s = t->getGmt()->tm_sec;
// write the B record
length = snprintf(buf,FG_MAX_MSG_SIZE,
"B"
"%02d%02d%02d" // UTC time: HHMMSS
"%02d%05d%c" // Latitude: DDMMmmmN (or ..S)
"%03d%05d%c" // Longitude: DDDMMmmmE (or ..W)
"A" // Fix validity: A for a 3D fix, V for 2D fix
"%05d" // Pressure Altitude: PPPPP (above 1013.2 hPa)
"%05d" // GNSS Altitude: AAAAA
"\r\n", // Line feed: CR LF
h, m, s,
latDeg, latMin, latDir,
lonDeg, lonMin, lonDir,
Altitude, // This should be standard pressure altitude instead. Hm, well :).
Altitude // GPS altitude
);
return (length > 0);
}
// reading IGC files is not supported
bool IGCProtocol::parse_message()
{
return false;
}
// write header data
bool IGCProtocol::open()
{
if ( is_enabled() )
{
SG_LOG( SG_IO, SG_ALERT, "This shouldn't happen, but the channel "
<< "is already in use, ignoring" );
return false;
}
SGIOChannel *io = get_io_channel();
if (!io->open( get_direction() ))
{
SG_LOG( SG_IO, SG_ALERT, "Error opening channel communication layer." );
return false;
}
set_enabled( true );
gen_Hrecords();
return true;
}
// process work
bool IGCProtocol::process()
{
SGIOChannel *io = get_io_channel();
if ( get_direction() == SG_IO_OUT )
{
gen_message();
if (!io->write( buf, length ))
{
SG_LOG( SG_IO, SG_WARN, "Error writing data." );
return false;
}
} else
if ( get_direction() == SG_IO_IN )
{
SG_LOG( SG_IO, SG_ALERT, "Error: IGC input is not supported.");
return false;
}
return true;
}
// close the channel
bool IGCProtocol::close()
{
SGIOChannel *io = get_io_channel();
set_enabled(false);
return io->close();
}