/* * fgcom - VoIP-Client for the FlightGear-Radio-Infrastructure * * This program realizes the usage of the VoIP infractructure based * on flight data which is send from FlightGear with an external * protocol to this application. * * Clement de l'Hamaide - Jan 2014 * Re-writting of FGCom standalone * * 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 Street, Fifth Floor, Boston, * MA 02110-1301, USA. * */ #include "config.h" #include #include #include #include #include #include #include #include "fgcom_external.hxx" #include "positions.hxx" // provides _positionsData[]; int _port = 16661; int _callId = -1; int _currentFreqKhz = -1; int _maxRange = 100; int _minRange = 10; int _registrationId = -1; bool _libInitialized = false; bool _running = true; bool _debug = false; bool _connected = false; double _frequency = -1; double _atis = -1; double _silenceThd = -35.0; std::string _app = "FGCOM-"; std::string _host = "127.0.0.1"; std::string _server = "fgcom.jingweiht.com"; std::string _airport = "ZZZZ"; std::string _callsign = "guest"; std::string _username = "guest"; std::string _password = "guest"; SGGeod _airportPos; SGTimeStamp _p; std::multimap _airportsData; const int special_freq[] = { // Define some freq who need to be used with icao = ZZZZ 910000, 911000, 700000, 123450, 122750, 121500, 123500 }; // // Main loop // int main(int argc, char** argv) { signal(SIGINT, quit); signal(SIGTERM, quit); simgear::requestConsole(true); sglog().setLogLevels(SG_ALL, SG_INFO); _app += FGCOM_VERSION; Modes mode = PILOT; std::string num = ""; for(int count = 1; count < argc; count++) { std::string item = argv[count]; std::string option = item.substr(2, item.find("=")-2); std::string value = item.substr(item.find("=")+1, item.size()); if(option == "server") _server = value; if(option == "host") _host = value; if(option == "port") _port = atoi(value.c_str()); if(option == "callsign") _callsign = value; if(option == "frequency") _frequency = atof(value.c_str()); if(option == "atis") _atis = atof(value.c_str()); if(option == "airport") _airport = simgear::strutils::uppercase(value); if(option == "username") _username = value; if(option == "password") _password = value; if(option == "silence-threshold") _silenceThd = atof(value.c_str()); if(option == "debug") sglog().setLogLevels(SG_ALL, SG_DEBUG); if(option == "help") return usage(); if(option == "version") return version(); } if(_frequency == 910.000) mode = TEST; if(_frequency <= 136.975 && _frequency >= 118.000) mode = OBS; if(_atis <= 136.975 && _atis >= 118.000 && _airport != "ZZZZ") mode = ATC; SG_LOG(SG_GENERAL, SG_INFO, "FGCom " << FGCOM_VERSION << " compiled " << __DATE__ << ", at " << __TIME__ ); SG_LOG(SG_GENERAL, SG_INFO, "For help usage, use --help"); SG_LOG(SG_GENERAL, SG_INFO, "Starting FGCom session as " << _username << ":xxxxxxxxx@" << _server); if( !(_libInitialized = lib_init()) ) return EXIT_FAILURE; if (_username != "guest" && _password != "guest") _registrationId = lib_registration(); if(mode == PILOT) { SG_LOG( SG_GENERAL, SG_DEBUG, "Entering main loop in mode PILOT" ); simgear::Socket::initSockets(); simgear::Socket sgSocket; sgSocket.open(false); sgSocket.bind(_host.c_str(), _port); sgSocket.setBlocking(false); lib_setVolume(0.0, 1.0); static char currentPacket[MAXBUFLEN+2], previousPacket[MAXBUFLEN+2]; struct Data currentData, previousData, previousPosData; double currentFreq = -1, previousFreq = -1; std::string currentIcao = ""; ActiveComm activeComm = COM1; _airportsData = getAirportsData(); SG_LOG(SG_GENERAL, SG_INFO, ""); while(_running) { int bytes = sgSocket.recv(currentPacket, sizeof(currentPacket)-1, 0); if (bytes == -1) { SGTimeStamp::sleepForMSec(1); // Prevent full CPU usage (loop) continue; } currentPacket[bytes] = '\0'; if( strcmp(currentPacket, previousPacket) != 0 ) { std::string packet(currentPacket); std::vector properties = simgear::strutils::split(packet, ","); for(size_t i=0; i < properties.size(); i++) { std::vector prop = simgear::strutils::split(properties[i], "="); if(prop[0] == "PTT") currentData.ptt = atoi(prop[1].c_str()); if(prop[0] == "LAT") currentData.lat = atof(prop[1].c_str()); if(prop[0] == "LON") currentData.lon = atof(prop[1].c_str()); if(prop[0] == "ALT") currentData.alt = atof(prop[1].c_str()); if(prop[0] == "COM1_FRQ") currentData.com1 = atof(prop[1].c_str()); if(prop[0] == "COM2_FRQ") currentData.com2 = atof(prop[1].c_str()); if(prop[0] == "OUTPUT_VOL") currentData.outputVol = atof(prop[1].c_str()); if(prop[0] == "SILENCE_THD") currentData.silenceThd = atof(prop[1].c_str()); if(prop[0] == "CALLSIGN") currentData.callsign = prop[1]; } if(currentData.ptt != previousData.ptt) { if(currentData.ptt == 2) { if(activeComm == COM1) { activeComm = COM2; currentFreq = currentData.com2; } else { activeComm = COM1; currentFreq = currentData.com1; } SG_LOG( SG_GENERAL, SG_INFO, "Select radio " << activeComm << " on " << currentFreq << " MHz" ); } else if(currentData.ptt) { SG_LOG( SG_GENERAL, SG_INFO, "[SPEAK] unmute mic, mute speaker" ); lib_setVolume(1.0, 0.0); } else { SG_LOG( SG_GENERAL, SG_INFO, "[LISTEN] mute mic, unmute speaker" ); lib_setVolume(0.0, currentData.outputVol); } } if(currentData.outputVol != previousData.outputVol) lib_setVolume(0.0, currentData.outputVol); if(currentData.silenceThd != previousData.silenceThd) lib_setSilenceThreshold(currentData.silenceThd); if(currentData.callsign != previousData.callsign) lib_setCallerId(currentData.callsign); if(currentData.com1 != previousData.com1 && activeComm == COM1) { currentFreq = currentData.com1; SG_LOG( SG_GENERAL, SG_INFO, "Select frequency " << currentFreq << " MHz on radio " << activeComm ); } if(currentData.com2 != previousData.com2 && activeComm == COM2) { currentFreq = currentData.com2; SG_LOG( SG_GENERAL, SG_INFO, "Select frequency " << currentFreq << " MHz on radio " << activeComm ); } if(previousFreq != currentFreq || currentData.callsign != previousData.callsign) { _currentFreqKhz = 10 * static_cast(currentFreq * 100 + 0.25); currentIcao = getClosestAirportForFreq(currentFreq, currentData.lat, currentData.lon, currentData.alt); if(isInRange(currentIcao, currentData.lat, currentData.lon, currentData.alt)) { _connected = lib_call(currentIcao, currentFreq); SG_LOG( SG_GENERAL, SG_INFO, "New Connecting " << currentIcao << " on " << currentFreq << " MHz" ); } else { if(_connected) { _connected = lib_hangup(); SG_LOG( SG_GENERAL, SG_INFO, "Disconnecting " << currentIcao << " on " << currentFreq << " MHz (out of range)" ); } } } if( currentData.lat <= previousPosData.lat - 0.05 || currentData.lon <= previousPosData.lon - 0.05 || currentData.alt <= previousPosData.alt - 50.0 || currentData.lat >= previousPosData.lat + 0.05 || currentData.lon >= previousPosData.lon + 0.05 || currentData.alt >= previousPosData.alt + 50.0) { currentIcao = getClosestAirportForFreq(currentFreq, currentData.lat, currentData.lon, currentData.alt); if(_connected) { if(!isInRange(currentIcao, currentData.lat, currentData.lon, currentData.alt)) { _connected = lib_hangup(); SG_LOG( SG_GENERAL, SG_INFO, "Disconnecting " << currentIcao << " on " << currentFreq << " MHz (out of range)" ); } } else { if(isInRange(currentIcao, currentData.lat, currentData.lon, currentData.alt)) { _connected = lib_call(currentIcao, currentFreq); SG_LOG( SG_GENERAL, SG_INFO, "Connecting " << currentIcao << " on " << currentFreq << " MHz" ); } } previousPosData = currentData; } previousFreq = currentFreq; previousData = currentData; } strcpy(previousPacket, currentPacket); } // while() sgSocket.close(); } else { // if(mode == PILOT) int sessionDuration = 1000; _p.stamp(); if(mode == OBS) { SG_LOG( SG_GENERAL, SG_INFO, "Entering main loop in mode OBS (max duration: 6 hours)" ); sessionDuration *= 2160; // 6 hours for OBS mode lib_setVolume(0.0, 1.0); lib_setCallerId("::OBS::"); num = computePhoneNumber(_frequency, _airport); } else { lib_setVolume(1.0, 1.0); if(mode == TEST) { sessionDuration *= 65; // 65 seconds for TEST mode SG_LOG( SG_GENERAL, SG_INFO, "Entering main loop in mode TEST (max duration: 65 seconds)" ); _airport = "ZZZZ"; num = computePhoneNumber(_frequency, _airport); } else if(mode == ATC) { sessionDuration *= 45; // 45 seconds for ATC mode SG_LOG( SG_GENERAL, SG_INFO, "Entering main loop in mode ATC (max duration: 45 seconds)" ); num = computePhoneNumber(_atis, _airport, true); } } _connected = lib_directCall(_airport, _frequency, num); while (_p.elapsedMSec() <= sessionDuration && _running){ SGTimeStamp::sleepForMSec(2000); } } if(!lib_shutdown()) return EXIT_FAILURE; return EXIT_SUCCESS; } // function: getAirportsData // action: parse positionsData.hxx then build multimap std::multimap getAirportsData() { std::vector lines; std::multimap aptData; SG_LOG(SG_GENERAL, SG_INFO, "Loading airports information..."); for(size_t i=0; i < sizeof(_positionsData)/sizeof(*_positionsData); i++) { // _positionsData is provided by positions.hxx std::vector entries = simgear::strutils::split(_positionsData[i], ","); if(entries.size() == 6) { // [0]=ICAO, [1]=Frequency, [2]=Latitude, [3]=Longitude, [4]=ID/Type, [5]=Name std::string entryIcao = entries[0]; double entryFreq = atof(entries[1].c_str()); double entryLat = atof(entries[2].c_str()); double entryLon = atof(entries[3].c_str()); std::string entryType = entries[4]; std::string entryName = entries[5]; int aptFreqKhz = 10 * static_cast(entryFreq * 100 + 0.25); Airport apt; apt.icao = entryIcao; apt.frequency = entryFreq; apt.latitude = entryLat; apt.longitude = entryLon; apt.type = entryType; apt.name = entryName; aptData.insert( std::pair(aptFreqKhz, apt) ); } } return aptData; } // function: orderByDistanceNm // action: sort airportsInRange vector by distanceNm ASC in getClosestAirportForFreq() bool orderByDistanceNm(Airport a, Airport b) { return a.distanceNm < b.distanceNm; } // function: gestClosestAircraftForFreq // action: return ICAO of closest airport with given frequency and define his position std::string getClosestAirportForFreq(double freq, double acftLat, double acftLon, double acftAlt) { for(size_t i=0; i(freq * 100 + 0.25); SGGeod acftPos = SGGeod::fromDegFt(acftLon, acftLat, acftAlt); std::vector airportsInRange; std::pair ::iterator, std::multimap::iterator> ret; ret = _airportsData.equal_range(freqKhz); for (std::multimap::iterator it=ret.first; it!=ret.second; ++it) { SGGeod aptPos = SGGeod::fromDeg(it->second.longitude, it->second.latitude); double distNm = SGGeodesy::distanceNm(aptPos, acftPos); if(distNm <= _maxRange){ it->second.distanceNm = distNm; airportsInRange.push_back(it->second); } } if(!airportsInRange.size()) return icao; std::sort(airportsInRange.begin(), airportsInRange.end(), orderByDistanceNm); aptLon = airportsInRange[0].longitude; aptLat = airportsInRange[0].latitude; icao = airportsInRange[0].icao; _airportPos = SGGeod::fromDeg(aptLon, aptLat); SG_LOG(SG_GENERAL, SG_INFO, "Airport " << airportsInRange[0].icao << " " << airportsInRange[0].name << " - " << airportsInRange[0].type << " on " << airportsInRange[0].frequency << " - is in range " << airportsInRange[0].distanceNm << "nm (" << (SG_NM_TO_METER*airportsInRange[0].distanceNm)/1000 <<"km)"); return icao; } // function: isInRange // action: return TRUE if airport/freq is in range, else return FALSE bool isInRange(std::string icao, double acftLat, double acftLon, double acftAlt) { // zhongjin 测试环境，始终返回1 return true; for(size_t i=0; i _maxRange) rangeNm = _maxRange; if (rangeNm < _minRange) rangeNm = _minRange; if( distNm > rangeNm ) return false; return true; } // function: quit // action: set _running flag to false void quit(int state) { SG_LOG( SG_GENERAL, SG_INFO, "Exiting FGCom" ); _running = false; #ifdef _WIN32 lib_shutdown(); SG_LOG(SG_GENERAL, SG_INFO, "You can close the terminal now"); #endif } // function: usage // action: display FGCom usage then quit int usage() { std::cout << "FGCom " << FGCOM_VERSION << " usage:" << std::endl; std::cout << " --server=fgcom.flightgear.org - Server to connect" << std::endl; std::cout << " --host=127.0.0.1 - Host to listen i.e where FG is running" << std::endl; std::cout << " --port=16661 - Port to use" << std::endl; std::cout << " --callsign=guest - Callsign during session e.g F-ELYD" << std::endl; std::cout << " --frequency=xxx.xxx - Frequency e.g 120.500" << std::endl; std::cout << " --airport=YYYY - ICAO of airport e.g KSFO" << std::endl; std::cout << " --username=guest - Username for registration" << std::endl; std::cout << " --password=guest - Password for registration" << std::endl; std::cout << " --silence-threshold=-35 - Silence threshold in dB (-60 < range < 0 )" << std::endl; std::cout << " --debug - Enable debug output" << std::endl; std::cout << " --help - Show this message" << std::endl; std::cout << " --version - Show version" << std::endl; std::cout << "" << std::endl; std::cout << " None of these options are required, you can simply start FGCom without option at all: it works" << std::endl; std::cout << " For further information, please visit: http://wiki.flightgear.org/FGCom_3.0" << std::endl; std::cout << "" << std::endl; std::cout << " About silence-threshold:" << std::endl; std::cout << " This is the limit, in dB, when FGCom consider no voice in your microphone." << std::endl; std::cout << " --silence-threshold=-60 is similar to micro always ON" << std::endl; std::cout << " --silence-threshold=0 is similar to micro always OFF" << std::endl; std::cout << " Default value is -35.0 dB" << std::endl; std::cout << "" << std::endl; std::cout << " In order to make an echo-test, you have to start FGCom like:" << std::endl; std::cout << " fgcom --frequency=910" << std::endl; std::cout << "" << std::endl; std::cout << " In order to listen a frequency, you have to start FGCom like:" << std::endl; std::cout << " fgcom --frequency=xxx.xxx --airport=YYYY" << std::endl; std::cout << " where xxx.xxx is the frequency of the ICAO airport YYYY that you want to listen to" << std::endl; std::cout << "" << std::endl; std::cout << " In order to record an ATIS message, you have to start FGCom like:" << std::endl; std::cout << " fgcom --atis=xxx.xxx --airport=YYYY" << std::endl; std::cout << " where xxx.xxx is the ATIS frequency of the ICAO airport YYYY" << std::endl; std::cout << "" << std::endl; return EXIT_SUCCESS; } // function: version // action: display FGCom version then quit int version() { SG_LOG(SG_GENERAL, SG_INFO, "FGCom " << FGCOM_VERSION << " compiled " << __DATE__ << ", at " << __TIME__ ); std::cout << "" << std::endl; return EXIT_SUCCESS; } // function: computePhoneNumber // action: return phone number std::string computePhoneNumber(double freq, std::string icao, bool atis) { if(icao.empty()) return std::string(); char phoneNumber[256]; char exten[32]; char tmp[5]; int prefix = atis ? 99 : 01; sprintf( tmp, "%4s", icao.c_str() ); sprintf( exten, "%02d%02d%02d%02d%02d%06d", 01, tmp[0], tmp[1], tmp[2], tmp[3], (int) (freq * 1000 + 0.5) ); exten[16] = '\0'; sprintf( exten, "%02d%06d", 01, (int) (freq * 1000 + 0.5) ); exten[8] = '\0'; snprintf( phoneNumber, sizeof(phoneNumber), "%s:%s@%s/%s", _username.c_str(), _password.c_str(), _server.c_str(), exten); SG_LOG(SG_SOUND, SG_ALERT, "FGCom: computePhoneNumber:" << phoneNumber << " icao:" << icao); return phoneNumber; } // function: lib_setVolume // action: set input/output volume void lib_setVolume(double input, double output) { SG_CLAMP_RANGE(input, 0.0, 1.0); SG_CLAMP_RANGE(output, 0.0, 1.0); SG_LOG(SG_GENERAL, SG_ALERT, "Set volume input=" << input << " , output=" << output); iaxc_input_level_set(input); iaxc_output_level_set(output); } // function: lib_setSilenceThreshold // action: set silence threshold void lib_setSilenceThreshold(double thd) { SG_CLAMP_RANGE(thd, -60, 0); SG_LOG(SG_GENERAL, SG_DEBUG, "Set silence threshold=" << thd); iaxc_set_silence_threshold(thd); } // function: lib_setCallerId // action: set caller id for the session void lib_setCallerId(std::string callsign) { SG_LOG(SG_GENERAL, SG_DEBUG, "Set caller ID=" << callsign); iaxc_set_callerid (callsign.c_str(), _app.c_str()); } // function: lib_init // action: init the library bool lib_init() { SG_LOG(SG_GENERAL, SG_DEBUG, "Initializing IAX library"); #ifdef _MSC_VER iaxc_set_networking( (iaxc_sendto_t)sendto, (iaxc_recvfrom_t)recvfrom ); #endif if (iaxc_initialize(4)) { SG_LOG( SG_GENERAL, SG_ALERT, "Error: cannot initialize IAXClient !\nHINT: Have you checked the mic and speakers ?" ); return false; } iaxc_set_callerid( _callsign.c_str(), _app.c_str() ); // iaxc_set_formats(IAXC_FORMAT_SPEEX, IAXC_FORMAT_ULAW|IAXC_FORMAT_SPEEX); iaxc_set_formats(IAXC_FORMAT_GSM, IAXC_FORMAT_ULAW|IAXC_FORMAT_GSM); // iaxc_set_speex_settings(1, 5, 0, 1, 0, 3); // iaxc_set_filters(IAXC_FILTER_AGC | IAXC_FILTER_DENOISE); iaxc_set_event_callback(iaxc_callback); iaxc_start_processing_thread (); // lib_setSilenceThreshold(_silenceThd); return true; } // function: lib_shutdown // action: stop the library bool lib_shutdown() { SG_LOG(SG_GENERAL, SG_DEBUG, "Shutdown IAX library"); lib_hangup(); if(_registrationId != -1) iaxc_unregister(_registrationId); return true; } // function: lib_registration // action: register a user on remote server then return the registration ID int lib_registration() { SG_LOG(SG_GENERAL, SG_DEBUG, "Request registration"); SG_LOG(SG_GENERAL, SG_DEBUG, " username: " << _username); SG_LOG(SG_GENERAL, SG_DEBUG, " password: xxxxxxxx"); SG_LOG(SG_GENERAL, SG_DEBUG, " server: " << _server); int regId = iaxc_register( _username.c_str(), _password.c_str(), _server.c_str()); if(regId == -1) { SG_LOG( SG_GENERAL, SG_ALERT, "Warning: cannot register '" << _username << "' at '" << _server ); } return regId; } // function: lib_call // action: kill current call then do a new call bool lib_call(std::string icao, double freq) { SG_LOG(SG_GENERAL, SG_ALERT, "Request new call"); SG_LOG(SG_GENERAL, SG_ALERT, " icao: " << icao); SG_LOG(SG_GENERAL, SG_ALERT, " freq: " << freq); lib_hangup(); iaxc_millisleep(300); std::string num = computePhoneNumber(freq, icao); if(num.empty()) return false; _callId = iaxc_call(num.c_str()); if(_callId == -1) { SG_LOG( SG_GENERAL, SG_ALERT, "Warning: cannot call: " << num ); return false; } SG_LOG(SG_GENERAL, SG_ALERT, "iaxc_call(" << num << ")"); return true; } bool lib_directCall(std::string icao, double freq, std::string num) { SG_LOG(SG_GENERAL, SG_DEBUG, "Request new call"); SG_LOG(SG_GENERAL, SG_DEBUG, " icao: " << icao); SG_LOG(SG_GENERAL, SG_DEBUG, " freq: " << freq); lib_hangup(); iaxc_millisleep(300); if(num.empty()) return false; _callId = iaxc_call(num.c_str()); if(_callId == -1) { SG_LOG( SG_GENERAL, SG_ALERT, "Warning: cannot call: " << num ); return false; } SG_LOG(SG_GENERAL, SG_DEBUG, "iaxc_call(" << num << ")"); return true; } // function: lib_hangup // action: kill current call bool lib_hangup() { if(!_connected) return false; SG_LOG(SG_GENERAL, SG_DEBUG, "Request hangup"); iaxc_dump_all_calls(); _callId = -1; return false; } // function: iaxc_callback // action: parse IAX event then call event handler int iaxc_callback(iaxc_event e) { switch (e.type) { case IAXC_EVENT_TEXT: if(e.ev.text.type == IAXC_TEXT_TYPE_STATUS || e.ev.text.type == IAXC_TEXT_TYPE_IAX) SG_LOG( SG_GENERAL, SG_INFO, "Message: " << e.ev.text.message ); break; } return 1; } // eof