/* Copyright (C) 2013 * swift project Community / Contributors * * This file is part of swift project. It is subject to the license terms in the LICENSE file found in the top-level * directory of this distribution and at http://www.swift-project.org/license.html. No part of swift project, * including this file, may be copied, modified, propagated, or distributed except according to the terms * contained in the LICENSE file. */ #include "simulatorxplane.h" #include "blackcore/aircraftmatcher.h" #include "blackmisc/aviation/aircraftengine.h" #include "blackmisc/aviation/aircraftenginelist.h" #include "blackmisc/aviation/aircrafticaocode.h" #include "blackmisc/aviation/aircraftparts.h" #include "blackmisc/aviation/aircraftsituation.h" #include "blackmisc/aviation/airlineicaocode.h" #include "blackmisc/aviation/altitude.h" #include "blackmisc/aviation/callsign.h" #include "blackmisc/aviation/comsystem.h" #include "blackmisc/aviation/heading.h" #include "blackmisc/aviation/livery.h" #include "blackmisc/aviation/transponder.h" #include "blackmisc/compare.h" #include "blackmisc/dbusserver.h" #include "blackmisc/geo/coordinategeodetic.h" #include "blackmisc/geo/latitude.h" #include "blackmisc/geo/longitude.h" #include "blackmisc/iterator.h" #include "blackmisc/logmessage.h" #include "blackmisc/network/textmessage.h" #include "blackmisc/pq/angle.h" #include "blackmisc/pq/frequency.h" #include "blackmisc/pq/length.h" #include "blackmisc/pq/pressure.h" #include "blackmisc/pq/speed.h" #include "blackmisc/pq/temperature.h" #include "blackmisc/simulation/aircraftmodel.h" #include "blackmisc/simulation/simulatedaircraft.h" #include "blackmisc/simulation/simulatedaircraftlist.h" #include "blackmisc/weather/cloudlayer.h" #include "blackmisc/weather/cloudlayerlist.h" #include "blackmisc/weather/gridpoint.h" #include "blackmisc/weather/temperaturelayer.h" #include "blackmisc/weather/temperaturelayerlist.h" #include "blackmisc/weather/visibilitylayer.h" #include "blackmisc/weather/visibilitylayerlist.h" #include "blackmisc/weather/windlayer.h" #include "blackmisc/weather/windlayerlist.h" #include "qcompilerdetection.h" #include "xswiftbusserviceproxy.h" #include "xswiftbustrafficproxy.h" #include "xswiftbusweatherproxy.h" #include #include #include #include #include using namespace BlackMisc; using namespace BlackMisc::Aviation; using namespace BlackMisc::Network; using namespace BlackMisc::PhysicalQuantities; using namespace BlackMisc::Simulation; using namespace BlackMisc::Geo; using namespace BlackMisc::Simulation; using namespace BlackMisc::Weather; namespace { inline QString xswiftbusServiceName() { return QStringLiteral("org.swift-project.xswiftbus"); } } namespace BlackSimPlugin { namespace XPlane { CSimulatorXPlane::CSimulatorXPlane(const BlackMisc::Simulation::CSimulatorPluginInfo &info, IOwnAircraftProvider *ownAircraftProvider, IRemoteAircraftProvider *remoteAircraftProvider, IWeatherGridProvider *weatherGridProvider, QObject *parent) : CSimulatorCommon(info, ownAircraftProvider, remoteAircraftProvider, weatherGridProvider, parent) { m_watcher = new QDBusServiceWatcher(this); m_watcher->setWatchMode(QDBusServiceWatcher::WatchForUnregistration); m_watcher->addWatchedService(xswiftbusServiceName()); m_watcher->setObjectName("QDBusServiceWatcher"); connect(m_watcher, &QDBusServiceWatcher::serviceUnregistered, this, &CSimulatorXPlane::ps_serviceUnregistered); m_fastTimer = new QTimer(this); m_slowTimer = new QTimer(this); m_fastTimer->setObjectName(this->objectName().append(":m_fastTimer")); m_slowTimer->setObjectName(this->objectName().append(":m_slowTimer")); connect(m_fastTimer, &QTimer::timeout, this, &CSimulatorXPlane::ps_fastTimerTimeout); connect(m_slowTimer, &QTimer::timeout, this, &CSimulatorXPlane::ps_slowTimerTimeout); m_fastTimer->start(100); m_slowTimer->start(1000); m_defaultModel = { "Jets A320_a A320_a_Austrian_Airlines A320_a_Austrian_Airlines", CAircraftModel::TypeModelMatchingDefaultModel, "A320 AUA", CAircraftIcaoCode("A320", "L2J") }; resetData(); } void CSimulatorXPlane::unload() { CSimulatorCommon::unload(); delete m_watcher; m_watcher = nullptr; } // convert xplane squawk mode to swift squawk mode BlackMisc::Aviation::CTransponder::TransponderMode xpdrMode(int xplaneMode, bool ident) { if (ident) { return BlackMisc::Aviation::CTransponder::StateIdent; } if (xplaneMode == 0 || xplaneMode == 1) { return BlackMisc::Aviation::CTransponder::StateStandby; } return BlackMisc::Aviation::CTransponder::ModeC; } // convert swift squawk mode to xplane squawk mode int xpdrMode(BlackMisc::Aviation::CTransponder::TransponderMode mode) { return mode == BlackMisc::Aviation::CTransponder::StateStandby ? 1 : 2; } void CSimulatorXPlane::ps_fastTimerTimeout() { if (isConnected()) { m_service->getLatitudeAsync(&m_xplaneData.latitude); m_service->getLongitudeAsync(&m_xplaneData.longitude); m_service->getAltitudeMSLAsync(&m_xplaneData.altitude); m_service->getGroundSpeedAsync(&m_xplaneData.groundspeed); m_service->getPitchAsync(&m_xplaneData.pitch); m_service->getRollAsync(&m_xplaneData.roll); m_service->getTrueHeadingAsync(&m_xplaneData.trueHeading); m_service->getCom1ActiveAsync(&m_xplaneData.com1Active); m_service->getCom1StandbyAsync(&m_xplaneData.com1Standby); m_service->getCom2ActiveAsync(&m_xplaneData.com2Active); m_service->getCom2StandbyAsync(&m_xplaneData.com2Standby); m_service->getTransponderCodeAsync(&m_xplaneData.xpdrCode); m_service->getTransponderModeAsync(&m_xplaneData.xpdrMode); m_service->getTransponderIdentAsync(&m_xplaneData.xpdrIdent); m_service->getAllWheelsOnGroundAsync(&m_xplaneData.onGroundAll); m_service->getQNHAsync(&m_xplaneData.seaLeveLPressure); CAircraftSituation situation; situation.setPosition({ m_xplaneData.latitude, m_xplaneData.longitude, 0 }); CAltitude altitude { m_xplaneData.altitude, CAltitude::MeanSeaLevel, CLengthUnit::m() }; situation.setAltitude({ m_xplaneData.altitude, CAltitude::MeanSeaLevel, CLengthUnit::m() }); CPressure seaLevelPressure({ m_xplaneData.seaLeveLPressure, CPressureUnit::inHg() }); CAltitude pressureAltitude(altitude.toPressureAltitude(seaLevelPressure)); situation.setPressureAltitude(pressureAltitude); situation.setHeading({ m_xplaneData.trueHeading, CHeading::True, CAngleUnit::deg() }); situation.setPitch({ m_xplaneData.pitch, CAngleUnit::deg() }); situation.setBank({ m_xplaneData.roll, CAngleUnit::deg() }); situation.setGroundSpeed({ m_xplaneData.groundspeed, CSpeedUnit::m_s() }); // updates updateOwnIcaoCodes(m_xplaneData.aircraftIcaoCode, CAirlineIcaoCode()); updateOwnSituation(situation); updateCockpit( CComSystem::getCom1System({ m_xplaneData.com1Active, CFrequencyUnit::kHz() }, { m_xplaneData.com1Standby, CFrequencyUnit::kHz() }), CComSystem::getCom2System({ m_xplaneData.com2Active, CFrequencyUnit::kHz() }, { m_xplaneData.com2Standby, CFrequencyUnit::kHz() }), CTransponder::getStandardTransponder(m_xplaneData.xpdrCode, xpdrMode(m_xplaneData.xpdrMode, m_xplaneData.xpdrIdent)), identifier() ); if (m_isWeatherActivated) { const auto currentPosition = CCoordinateGeodetic { situation.latitude(), situation.longitude(), {0} }; if (CWeatherScenario::isRealWeatherScenario(m_weatherScenarioSettings.get()) && calculateGreatCircleDistance(m_lastWeatherPosition, currentPosition).value(CLengthUnit::mi()) > 20) { m_lastWeatherPosition = currentPosition; const auto weatherGrid = CWeatherGrid { { "", currentPosition } }; requestWeatherGrid(weatherGrid, { this, &CSimulatorXPlane::injectWeatherGrid }); } } } } void CSimulatorXPlane::ps_slowTimerTimeout() { if (isConnected()) { m_service->getAircraftModelPathAsync(&m_xplaneData.aircraftModelPath); m_service->getAircraftIcaoCodeAsync(&m_xplaneData.aircraftIcaoCode); m_service->getBeaconLightsOnAsync(&m_xplaneData.beaconLightsOn); m_service->getLandingLightsOnAsync(&m_xplaneData.landingLightsOn); m_service->getNavLightsOnAsync(&m_xplaneData.navLightsOn); m_service->getStrobeLightsOnAsync(&m_xplaneData.strobeLightsOn); m_service->getTaxiLightsOnAsync(&m_xplaneData.taxiLightsOn); m_service->getFlapsDeployRatioAsync(&m_xplaneData.flapsReployRatio); m_service->getGearDeployRatioAsync(&m_xplaneData.gearReployRatio); m_service->getEngineN1PercentageAsync(&m_xplaneData.enginesN1Percentage); m_service->getSpeedBrakeRatioAsync(&m_xplaneData.speedBrakeRatio); CAircraftEngineList engines; for (int engineNumber = 0; engineNumber < m_xplaneData.enginesN1Percentage.size(); ++engineNumber) { // Engine number start counting at 1 // We consider the engine running when N1 is bigger than 5 % CAircraftEngine engine {engineNumber + 1, m_xplaneData.enginesN1Percentage.at(engineNumber) > 5.0}; engines.push_back(engine); } CAircraftParts parts { { m_xplaneData.strobeLightsOn, m_xplaneData.landingLightsOn, m_xplaneData.taxiLightsOn, m_xplaneData.beaconLightsOn, m_xplaneData.navLightsOn, false }, m_xplaneData.gearReployRatio > 0, static_cast(m_xplaneData.flapsReployRatio * 100) , m_xplaneData.speedBrakeRatio > 0.5, engines, m_xplaneData.onGroundAll }; updateOwnParts(parts); } } bool CSimulatorXPlane::isConnected() const { return m_service && m_traffic && m_weather; } bool CSimulatorXPlane::connectTo() { if (isConnected()) { return true; } m_conn = QDBusConnection::sessionBus(); // TODO make this configurable m_service = new CXSwiftBusServiceProxy(m_conn, this); m_traffic = new CXSwiftBusTrafficProxy(m_conn, this); m_weather = new CXSwiftBusWeatherProxy(m_conn, this); if (m_service->isValid() && m_traffic->isValid() && m_weather->isValid() && m_traffic->initialize()) { ps_emitOwnAircraftModelChanged(m_service->getAircraftModelPath(), m_service->getAircraftModelFilename(), m_service->getAircraftLivery(), m_service->getAircraftIcaoCode(), m_service->getAircraftModelString(), m_service->getAircraftName(), m_service->getAircraftDescription()); connect(m_service, &CXSwiftBusServiceProxy::aircraftModelChanged, this, &CSimulatorXPlane::ps_emitOwnAircraftModelChanged); connect(m_service, &CXSwiftBusServiceProxy::airportsInRangeUpdated, this, &CSimulatorXPlane::ps_setAirportsInRange); m_service->updateAirportsInRange(); connect(m_traffic, &CXSwiftBusTrafficProxy::simFrame, this, &CSimulatorXPlane::updateRemoteAircraft); if (m_watcher) { m_watcher->setConnection(m_conn); } loadCslPackages(); emitSimulatorCombinedStatus(); return true; } else { disconnectFrom(); return false; } } bool CSimulatorXPlane::disconnectFrom() { if (!this->isConnected()) { return true; } // avoid emit if already disconnected if (m_traffic) { m_traffic->cleanup(); } m_conn = QDBusConnection { "default" }; if (m_watcher) { m_watcher->setConnection(m_conn); } delete m_service; delete m_traffic; delete m_weather; m_service = nullptr; m_traffic = nullptr; m_weather = nullptr; emitSimulatorCombinedStatus(); return true; } void CSimulatorXPlane::ps_serviceUnregistered() { m_conn = QDBusConnection { "default" }; if (m_watcher) { m_watcher->setConnection(m_conn); } delete m_service; delete m_traffic; delete m_weather; m_service = nullptr; m_traffic = nullptr; m_weather = nullptr; emitSimulatorCombinedStatus(); } void CSimulatorXPlane::ps_emitOwnAircraftModelChanged(const QString &path, const QString &filename, const QString &livery, const QString &icao, const QString &modelString, const QString &name, const QString &description) { CAircraftModel model(modelString, CAircraftModel::TypeOwnSimulatorModel, CSimulatorInfo::XPLANE, name, description, icao); if (!livery.isEmpty()) { model.setModelString(model.getModelString() + " " + livery); } model.setFileName(path + "/" + filename); this->reverseLookupAndUpdateOwnAircraftModel(model); } void CSimulatorXPlane::displayStatusMessage(const BlackMisc::CStatusMessage &message) const { // No assert here as status message may come because of network problems if (!isConnected()) { return; } // avoid infinite recursion in case this function is called due to a message caused by this very function static bool isInFunction = false; if (isInFunction) { return; } isInFunction = true; QColor color; switch (message.getSeverity()) { case CStatusMessage::SeverityDebug: color = "teal"; break; case CStatusMessage::SeverityInfo: color = "cyan"; break; case CStatusMessage::SeverityWarning: color = "orange"; break; case CStatusMessage::SeverityError: color = "red"; break; } m_service->addTextMessage("swift: " + message.getMessage(), color.redF(), color.greenF(), color.blueF()); isInFunction = false; } void CSimulatorXPlane::displayTextMessage(const BlackMisc::Network::CTextMessage &message) const { Q_ASSERT(isConnected()); QColor color; if (message.isServerMessage()) { color = "orchid"; } else if (message.isSupervisorMessage()) { color = "yellow"; } else if (message.isPrivateMessage()) { color = "magenta"; } else { color = "lime"; } m_service->addTextMessage(message.getSenderCallsign().toQString() + ": " + message.getMessage(), color.redF(), color.greenF(), color.blueF()); } void CSimulatorXPlane::ps_setAirportsInRange(const QStringList &icaos, const QStringList &names, const BlackMisc::CSequence &lats, const BlackMisc::CSequence &lons, const BlackMisc::CSequence &alts) { //! \todo restrict to maxAirportsInRange() m_airportsInRange.clear(); auto icaoIt = icaos.begin(); auto nameIt = names.begin(); auto latIt = lats.begin(); auto lonIt = lons.begin(); auto altIt = alts.begin(); for (; icaoIt != icaos.end() && nameIt != names.end() && latIt != lats.end() && lonIt != lons.end() && altIt != alts.end(); ++icaoIt, ++nameIt, ++latIt, ++lonIt, ++altIt) { using namespace BlackMisc::PhysicalQuantities; using namespace BlackMisc::Geo; m_airportsInRange.push_back({ *icaoIt, { CLatitude(*latIt, CAngleUnit::deg()), CLongitude(*lonIt, CAngleUnit::deg()), CAltitude(*altIt, CLengthUnit::m()) }, *nameIt }); } } BlackMisc::Aviation::CAirportList CSimulatorXPlane::getAirportsInRange() const { return m_airportsInRange; } bool CSimulatorXPlane::setTimeSynchronization(bool enable, const BlackMisc::PhysicalQuantities::CTime &offset) { Q_UNUSED(offset); if (enable) { CLogMessage(this).info("X-Plane provides real time synchronization, use this one"); } return false; } bool CSimulatorXPlane::setInterpolatorMode(CInterpolatorMulti::Mode mode, const CCallsign &callsign) { if (!isConnected()) { return false; } if(c_driverInterpolation) { if (mode == CInterpolatorMulti::ModeUnknown) { return false; } if (callsign.isEmpty()) { const int c = m_xplaneAircrafts.setInterpolatorModes(mode); return c > 0; } else { if (!m_xplaneAircrafts.contains(callsign)) { return false; } return m_xplaneAircrafts[callsign].setInterpolatorMode(mode); } } else { m_traffic->setInterpolatorMode(callsign.asString(), mode == CInterpolatorMulti::ModeSpline); return true; } } QDBusConnection CSimulatorXPlane::connectionFromString(const QString &str) { if (str == BlackMisc::CDBusServer::sessionBusAddress()) { return QDBusConnection::sessionBus(); } else if (str == BlackMisc::CDBusServer::systemBusAddress()) { return QDBusConnection::systemBus(); } else { Q_UNREACHABLE(); return QDBusConnection("NO CONNECTION"); } } bool CSimulatorXPlane::isPhysicallyRenderedAircraft(const CCallsign &callsign) const { if (c_driverInterpolation) { return m_xplaneAircrafts.contains(callsign); } else { //! \todo XP implement isRenderedAircraft correctly. This is a workaround, but not telling me if a callsign is really(!) visible in simulator return getAircraftInRangeForCallsign(callsign).isRendered(); } } bool CSimulatorXPlane::updateOwnSimulatorCockpit(const BlackMisc::Simulation::CSimulatedAircraft &aircraft, const CIdentifier &originator) { Q_ASSERT(isConnected()); if (originator == this->identifier()) { return false; } auto com1 = CComSystem::getCom1System({ m_xplaneData.com1Active, CFrequencyUnit::kHz() }, { m_xplaneData.com1Standby, CFrequencyUnit::kHz() }); auto com2 = CComSystem::getCom2System({ m_xplaneData.com2Active, CFrequencyUnit::kHz() }, { m_xplaneData.com2Standby, CFrequencyUnit::kHz() }); auto xpdr = CTransponder::getStandardTransponder(m_xplaneData.xpdrCode, xpdrMode(m_xplaneData.xpdrMode, m_xplaneData.xpdrIdent)); if (aircraft.hasChangedCockpitData(com1, com2, xpdr)) { m_xplaneData.com1Active = aircraft.getCom1System().getFrequencyActive().valueRounded(CFrequencyUnit::kHz(), 0); m_xplaneData.com1Standby = aircraft.getCom1System().getFrequencyStandby().valueRounded(CFrequencyUnit::kHz(), 0); m_xplaneData.com2Active = aircraft.getCom2System().getFrequencyActive().valueRounded(CFrequencyUnit::kHz(), 0); m_xplaneData.com2Standby = aircraft.getCom2System().getFrequencyStandby().valueRounded(CFrequencyUnit::kHz(), 0); m_xplaneData.xpdrCode = aircraft.getTransponderCode(); m_xplaneData.xpdrMode = xpdrMode(aircraft.getTransponderMode()); m_service->setCom1Active(m_xplaneData.com1Active); m_service->setCom1Standby(m_xplaneData.com1Standby); m_service->setCom2Active(m_xplaneData.com2Active); m_service->setCom2Standby(m_xplaneData.com2Standby); m_service->setTransponderCode(m_xplaneData.xpdrCode); m_service->setTransponderMode(m_xplaneData.xpdrMode); m_service->cancelAllPendingAsyncCalls(); // in case there is already a reply with some old data incoming return true; } return false; } bool CSimulatorXPlane::updateOwnSimulatorSelcal(const CSelcal &selcal, const CIdentifier &originator) { Q_ASSERT(isConnected()); if (originator == this->identifier()) { return false; } Q_UNUSED(selcal); //! \fixme KB 8/2017 use SELCAL?? return false; } void CSimulatorXPlane::loadCslPackages() { struct Prefix { QString s; }; struct PrefixComparator { bool operator()(const Prefix &a, const QString &b) const { return QStringRef(&a.s) < b.leftRef(a.s.size()); } bool operator()(const QString &a, const Prefix &b) const { return a.leftRef(b.s.size()) < QStringRef(&b.s); } }; QList packages; Q_ASSERT(isConnected()); for (const auto &model : m_modelSet.getThreadLocal()) { const QString &modelFile = model.getFileName(); if (modelFile.isEmpty() || ! QFile::exists(modelFile)) { continue; } auto it = std::lower_bound(packages.begin(), packages.end(), modelFile, PrefixComparator()); if (it != packages.end() && modelFile.startsWith(it->s)) { continue; } QString package = findCslPackage(modelFile); if (package.isEmpty()) { continue; } packages.insert(it, { package.append('/') }); } for (auto &package : packages) { Q_ASSERT(package.s.endsWith('/')); package.s.chop(1); m_traffic->loadPlanesPackage(package.s); } } QString CSimulatorXPlane::findCslPackage(const QString &modelFile) { const QFileInfo info(modelFile); QDir dir = info.isDir() ? QDir(modelFile) : info.dir(); do { if (dir.exists(QStringLiteral("xsb_aircraft.txt"))) { if (dir.cdUp()) { return dir.path(); } } } while(dir.cdUp()); CLogMessage(this).warning("Failed to find CSL package for %1") << modelFile; return {}; } bool CSimulatorXPlane::physicallyAddRemoteAircraft(const CSimulatedAircraft &newRemoteAircraft) { Q_ASSERT(isConnected()); if (c_driverInterpolation) { // entry checks Q_ASSERT_X(CThreadUtils::isCurrentThreadObjectThread(this), Q_FUNC_INFO, "thread"); Q_ASSERT_X(!newRemoteAircraft.getCallsign().isEmpty(), Q_FUNC_INFO, "empty callsign"); Q_ASSERT_X(newRemoteAircraft.hasModelString(), Q_FUNC_INFO, "missing model string"); m_xplaneAircrafts.insert(newRemoteAircraft.getCallsign(), CXPlaneMPAircraft(newRemoteAircraft, &m_interpolationLogger)); CAircraftModel aircraftModel = newRemoteAircraft.getModel(); QString livery = aircraftModel.getLivery().getCombinedCode(); //! \todo livery resolution for XP m_traffic->addPlane(newRemoteAircraft.getCallsign().asString(), aircraftModel.getModelString(), newRemoteAircraft.getAircraftIcaoCode().getDesignator(), newRemoteAircraft.getAirlineIcaoCode().getDesignator(), livery); CLogMessage(this).info("XP: Added aircraft %1") << newRemoteAircraft.getCallsign().toQString(); bool rendered = true; updateAircraftRendered(newRemoteAircraft.getCallsign(), rendered); CSimulatedAircraft remoteAircraftCopy(newRemoteAircraft); remoteAircraftCopy.setRendered(rendered); emit aircraftRenderingChanged(remoteAircraftCopy); return true; } else { CAircraftModel aircraftModel = newRemoteAircraft.getModel(); QString livery = aircraftModel.getLivery().getCombinedCode(); //! \todo livery resolution for XP m_traffic->addPlane(newRemoteAircraft.getCallsign().asString(), aircraftModel.getModelString(), newRemoteAircraft.getAircraftIcaoCode().getDesignator(), newRemoteAircraft.getAirlineIcaoCode().getDesignator(), livery); CLogMessage(this).info("XP: Added aircraft %1") << newRemoteAircraft.getCallsign().toQString(); bool rendered = true; updateAircraftRendered(newRemoteAircraft.getCallsign(), rendered); CSimulatedAircraft remoteAircraftCopy(newRemoteAircraft); remoteAircraftCopy.setRendered(rendered); emit aircraftRenderingChanged(remoteAircraftCopy); return true; } } void CSimulatorXPlane::onRemoteProviderAddedAircraftSituation(const BlackMisc::Aviation::CAircraftSituation &situation) { Q_ASSERT(isConnected()); if (c_driverInterpolation) { if (m_xplaneAircrafts.contains(situation.getCallsign())) { m_xplaneAircrafts[situation.getCallsign()].addAircraftSituation(situation); } } else { using namespace BlackMisc::PhysicalQuantities; m_traffic->addPlanePosition(situation.getCallsign().asString(), situation.latitude().value(CAngleUnit::deg()), situation.longitude().value(CAngleUnit::deg()), situation.getAltitude().value(CLengthUnit::ft()), situation.getPitch().value(CAngleUnit::deg()), situation.getBank().value(CAngleUnit::deg()), situation.getHeading().value(CAngleUnit::deg()), situation.getMSecsSinceEpoch() - QDateTime::currentMSecsSinceEpoch(), situation.getTimeOffsetMs()); if (! isRemoteAircraftSupportingParts(situation.getCallsign())) { // if aircraft not supporting parts then guess the basics (onGround, gear, lights) //! \todo not working for vtol BlackMisc::Aviation::CAircraftParts parts; parts.setMSecsSinceEpoch(situation.getMSecsSinceEpoch()); parts.setTimeOffsetMs(situation.getTimeOffsetMs()); if (situation.getGroundSpeed() < CSpeed(50, CSpeedUnit::kts())) { const auto nearestAirport = std::min_element(m_airportsInRange.cbegin(), m_airportsInRange.cend(), [&situation](auto &&a, auto &&b) { return calculateEuclideanDistanceSquared(situation, a) < calculateEuclideanDistanceSquared(situation, b); }); if (nearestAirport != m_airportsInRange.cend() && situation.getAltitude() - nearestAirport->getElevation() < CLength(50, CLengthUnit::ft())) { parts.setOnGround(true); parts.setGearDown(true); } } if (situation.getAltitude() < CAltitude(10000, CLengthUnit::ft())) { parts.setLights({ true, true, true, true, true, true, true, true }); } else { parts.setLights({ true, false, false, true, true, true, true, true }); } onRemoteProviderAddedAircraftParts(situation.getCallsign(), parts); } } } void CSimulatorXPlane::onRemoteProviderAddedAircraftParts(const BlackMisc::Aviation::CCallsign &callsign, const BlackMisc::Aviation::CAircraftParts &parts) { Q_ASSERT(isConnected()); if (c_driverInterpolation) { if (m_xplaneAircrafts.contains(callsign)) { m_xplaneAircrafts[callsign].addAircraftParts(parts); } } else { m_traffic->addPlaneSurfaces(callsign.asString(), parts.isGearDown() ? 1 : 0, parts.getFlapsPercent() / 100.0, parts.isSpoilersOut() ? 1 : 0, parts.isSpoilersOut() ? 1 : 0, parts.getFlapsPercent() / 100.0, 0, parts.isAnyEngineOn() ? 0 : 0.75, 0, 0, 0, parts.getLights().isLandingOn(), parts.getLights().isBeaconOn(), parts.getLights().isStrobeOn(), parts.getLights().isNavOn(), 0, parts.isOnGround(), parts.getMSecsSinceEpoch() - QDateTime::currentMSecsSinceEpoch(), parts.getTimeOffsetMs()); m_traffic->setPlaneTransponder(callsign.asString(), 2000, true, false); } } bool CSimulatorXPlane::physicallyRemoveRemoteAircraft(const BlackMisc::Aviation::CCallsign &callsign) { Q_ASSERT(isConnected()); if (c_driverInterpolation) { // only remove from sim Q_ASSERT_X(CThreadUtils::isCurrentThreadObjectThread(this), Q_FUNC_INFO, "wrong thread"); if (callsign.isEmpty()) { return false; } // can happen if an object is not an aircraft // clean up anyway m_hints.remove(callsign); // really remove from simulator if (!m_xplaneAircrafts.contains(callsign)) { return false; } // already fully removed or not yet added CXPlaneMPAircraft &xplaneAircraft = m_xplaneAircrafts[callsign]; // avoid further data from simulator // this->stopRequestingDataForSimObject(simObject); m_traffic->removePlane(callsign.asString()); m_xplaneAircrafts.remove(callsign); // mark in provider const bool updated = this->updateAircraftRendered(callsign, false); if (updated) { CSimulatedAircraft aircraft(xplaneAircraft.getAircraft()); aircraft.setRendered(false); emit this->aircraftRenderingChanged(aircraft); } // bye return true; } else { m_traffic->removePlane(callsign.asString()); updateAircraftRendered(callsign, false); CLogMessage(this).info("XP: Removed aircraft %1") << callsign.toQString(); return true; } } int CSimulatorXPlane::physicallyRemoveAllRemoteAircraft() { Q_ASSERT(isConnected()); //! \todo XP driver obtain number of removed aircraft resetHighlighting(); if (c_driverInterpolation) { // remove one by one int r = 0; const CCallsignSet callsigns = m_xplaneAircrafts.getAllCallsigns(); for (const CCallsign &cs : callsigns) { if (this->physicallyRemoveRemoteAircraft(cs)) { r++; } } return r; } else { int r = getAircraftInRangeCount(); m_traffic->removeAllPlanes(); updateMarkAllAsNotRendered(); CLogMessage(this).info("XP: Removed all aircraft"); return r; } } CCallsignSet CSimulatorXPlane::physicallyRenderedAircraft() const { //! \todo XP driver, return list of callsigns really present in the simulator return getAircraftInRange().findByRendered(true).getCallsigns(); // just a poor workaround } bool CSimulatorXPlane::changeRemoteAircraftModel(const CSimulatedAircraft &aircraft) { // remove upfront, and then enable / disable again auto callsign = aircraft.getCallsign(); if (!isPhysicallyRenderedAircraft(callsign)) { return false; } this->physicallyRemoveRemoteAircraft(callsign); return this->changeRemoteAircraftEnabled(aircraft); } bool CSimulatorXPlane::changeRemoteAircraftEnabled(const CSimulatedAircraft &aircraft) { if (aircraft.isEnabled()) { this->physicallyAddRemoteAircraft(aircraft); } else { this->physicallyRemoveRemoteAircraft(aircraft.getCallsign()); } return true; } void CSimulatorXPlane::injectWeatherGrid(const BlackMisc::Weather::CWeatherGrid &weatherGrid) { Q_ASSERT(isConnected()); m_weather->setUseRealWeather(false); // todo: find the closest CGridPoint gridPoint = weatherGrid.front(); // todo: find the closest auto visibilityLayers = gridPoint.getVisibilityLayers(); visibilityLayers.sortBy(&CVisibilityLayer::getBase); const CVisibilityLayer visibilityLayer = visibilityLayers.frontOrDefault(); m_weather->setVisibility(visibilityLayer.getVisibility().value(CLengthUnit::m())); CTemperatureLayerList temperatureLayers = gridPoint.getTemperatureLayers(); temperatureLayers.sortBy(&CTemperatureLayer::getLevel); const CTemperatureLayer temperatureLayer = temperatureLayers.frontOrDefault(); m_weather->setTemperature(temperatureLayer.getTemperature().value(CTemperatureUnit::C())); m_weather->setDewPoint(temperatureLayer.getDewPoint().value(CTemperatureUnit::C())); m_weather->setQNH(gridPoint.getSurfacePressure().value(CPressureUnit::inHg())); int layerNumber = 0; CCloudLayerList cloudLayers = gridPoint.getCloudLayers(); auto numberOfLayers = cloudLayers.size(); // Fill cloud layers if less then 3 while (numberOfLayers < 3) { cloudLayers.push_back(CCloudLayer()); numberOfLayers++; } cloudLayers.sortBy(&CCloudLayer::getBase); // todo: Instead of truncate, find the 3 vertical closest cloud layers cloudLayers.truncate(3); for (const auto &cloudLayer : cloudLayers) { int base = cloudLayer.getBase().value(CLengthUnit::m()); int top = cloudLayer.getTop().value(CLengthUnit::m()); int coverage = 0; switch (cloudLayer.getCoverage()) { case CCloudLayer::None: coverage = 0; break; case CCloudLayer::Few: coverage = 2; break; case CCloudLayer::Scattered: coverage = 3; break; case CCloudLayer::Broken: coverage = 4; break; case CCloudLayer::Overcast: coverage = 6; break; default: coverage = 0; } // Clear = 0, High Cirrus = 1, Scattered = 2, Broken = 3, Overcast = 4, Stratus = 5 int type = 0; switch (cloudLayer.getClouds()) { case CCloudLayer::NoClouds: type = 0; break; case CCloudLayer::Cirrus: type = 1; break; case CCloudLayer::Stratus: type = 5; break; default: type = 0; } m_weather->setCloudLayer(layerNumber, base, top, type, coverage); layerNumber++; } layerNumber = 0; CWindLayerList windLayers = gridPoint.getWindLayers(); numberOfLayers = windLayers.size(); // Fill cloud layers if less then 3 while (numberOfLayers < 3) { windLayers.push_back(CWindLayer()); numberOfLayers++; } windLayers.sortBy(&CWindLayer::getLevel); // todo: Instead of truncate, find the 3 vertical closest cloud layers windLayers.truncate(3); for (const auto &windLayer : windLayers) { int altitudeMeter = windLayer.getLevel().value(CLengthUnit::m()); double directionDeg = windLayer.getDirection().value(CAngleUnit::deg()); int speedKts = windLayer.getSpeed().value(CSpeedUnit::kts()); m_weather->setWindLayer(layerNumber, altitudeMeter, directionDeg, speedKts, 0, 0, 0); layerNumber++; } m_weather->setPrecipitationRatio(cloudLayers.frontOrDefault().getPrecipitationRate()); m_weather->setThunderstormRatio(0.0); } void CSimulatorXPlane::updateRemoteAircraft() { Q_ASSERT_X(CThreadUtils::isCurrentThreadObjectThread(this), Q_FUNC_INFO, "thread"); const int remoteAircraftNo = this->getAircraftInRangeCount(); if (remoteAircraftNo < 1) { m_interpolationRequest = 0; return; } // interpolate and send to simulator m_interpolationRequest++; const bool enableAircraftParts = m_interpolationRenderingSetup.isAircraftPartsEnabled(); const CCallsignSet aircraftWithParts = enableAircraftParts ? this->remoteAircraftSupportingParts() : CCallsignSet(); // optimization, fetch all parts supporting aircraft in one step (one lock) // values used for position and parts const qint64 currentTimestamp = QDateTime::currentMSecsSinceEpoch(); const CCallsignSet callsignsToLog(m_interpolationRenderingSetup.getLogCallsigns()); // interpolation for all remote aircraft const QList xplaneAircrafts(m_xplaneAircrafts.values()); for (const CXPlaneMPAircraft &xplaneAircraft : xplaneAircrafts) { const CCallsign callsign(xplaneAircraft.getCallsign()); Q_ASSERT_X(!callsign.isEmpty(), Q_FUNC_INFO, "missing callsign"); // fetch parts, as they are needed for ground interpolation const bool useAircraftParts = enableAircraftParts && aircraftWithParts.contains(callsign); const bool logInterpolationAndParts = callsignsToLog.contains(callsign); const CInterpolationAndRenderingSetup setup(this->getInterpolationAndRenderingSetup()); CPartsStatus partsStatus(useAircraftParts); const CAircraftParts parts = useAircraftParts ? xplaneAircraft.getInterpolatedParts(currentTimestamp, setup, partsStatus, logInterpolationAndParts) : CAircraftParts(); // get interpolated situation CInterpolationStatus interpolatorStatus; CInterpolationHints hints(m_hints[callsign]); hints.setAircraftParts(useAircraftParts ? parts : CAircraftParts(), useAircraftParts); hints.setLoggingInterpolation(logInterpolationAndParts); const CAircraftSituation interpolatedSituation = xplaneAircraft.getInterpolatedSituation(currentTimestamp, setup, hints, interpolatorStatus); if (interpolatorStatus.hasValidSituation()) { // update situation if (!xplaneAircraft.isSameAsSent(interpolatedSituation)) { m_xplaneAircrafts[xplaneAircraft.getCallsign()].setPositionAsSent(interpolatedSituation); m_traffic->setPlanePosition(interpolatedSituation.getCallsign().asString(), interpolatedSituation.latitude().value(CAngleUnit::deg()), interpolatedSituation.longitude().value(CAngleUnit::deg()), interpolatedSituation.getAltitude().value(CLengthUnit::ft()), interpolatedSituation.getPitch().value(CAngleUnit::deg()), interpolatedSituation.getBank().value(CAngleUnit::deg()), interpolatedSituation.getHeading().value(CAngleUnit::deg())); } } else { CLogMessage(this).warning("Invalid situation for callsign: '%1' info: '%2'") << callsign << interpolatorStatus.toQString(); } if (useAircraftParts) { this->updateRemoteAircraftParts(xplaneAircraft, parts, partsStatus); } else { // guess on position, but not every frame if (m_interpolationRequest % GuessRemoteAircraftPartsCycle == 0) { this->guessAndUpdateRemoteAircraftParts(xplaneAircraft, interpolatedSituation, interpolatorStatus); } } } // all callsigns const qint64 dt = QDateTime::currentMSecsSinceEpoch() - currentTimestamp; m_statsUpdateAircraftTimeTotalMs += dt; m_statsUpdateAircraftCountMs++; m_statsUpdateAircraftTimeAvgMs = m_statsUpdateAircraftTimeTotalMs / m_statsUpdateAircraftCountMs; } bool CSimulatorXPlane::updateRemoteAircraftParts(const CXPlaneMPAircraft &xplaneAircraft, const CAircraftParts &parts, const CPartsStatus &partsStatus) { if (!partsStatus.isSupportingParts()) { return false; } return this->sendRemoteAircraftPartsToSimulator(xplaneAircraft, parts); } bool CSimulatorXPlane::guessAndUpdateRemoteAircraftParts(const CXPlaneMPAircraft &xplaneAircraft, const CAircraftSituation &interpolatedSituation, const CInterpolationStatus &interpolationStatus) { if (!interpolationStatus.isInterpolated()) { return false; } CAircraftLights lights; CAircraftParts parts; // init members const bool isOnGround = interpolatedSituation.isOnGround() == CAircraftSituation::OnGround; const double gsKts = interpolatedSituation.getGroundSpeed().value(CSpeedUnit::kts()); parts.setEngines({ true, true, true, true }); lights.setCabinOn(true); lights.setRecognitionOn(true); // when first detected moving, lights on if (isOnGround) { parts.setGearDown(true); lights.setTaxiOn(true); lights.setBeaconOn(true); lights.setNavOn(true); if (gsKts > 5) { // mode taxi lights.setTaxiOn(true); lights.setLandingOn(false); } else if (gsKts > 30) { // mode accelaration for takeoff lights.setTaxiOn(false); lights.setLandingOn(true); } else { // slow movements or parking lights.setTaxiOn(false); lights.setLandingOn(false); parts.setEngines({ false, false, false, false }); } } else { // not on ground parts.setGearDown(false); lights.setTaxiOn(false); lights.setBeaconOn(true); lights.setNavOn(true); // landing lights for < 10000ft (normally MSL, here ignored) lights.setLandingOn(interpolatedSituation.getAltitude().value(CLengthUnit::ft()) < 10000); if (!xplaneAircraft.isVtol() && interpolatedSituation.hasGroundElevation()) { if (interpolatedSituation.getHeightAboveGround().value(CLengthUnit::ft()) < 1000) { parts.setGearDown(true); parts.setFlapsPercent(25); } else if (interpolatedSituation.getHeightAboveGround().value(CLengthUnit::ft()) < 2000) { parts.setGearDown(true); parts.setFlapsPercent(10); } } } parts.setLights(lights); return this->sendRemoteAircraftPartsToSimulator(xplaneAircraft, parts); } bool CSimulatorXPlane::sendRemoteAircraftPartsToSimulator(const CXPlaneMPAircraft &xplaneAircraft, const CAircraftParts &parts) { // same as in simulator or same as already send to simulator? if (xplaneAircraft.getPartsAsSent() == parts) { return true; } m_traffic->setPlaneSurfaces(xplaneAircraft.getCallsign().asString(), parts.isGearDown() ? 1 : 0, parts.getFlapsPercent() / 100.0, parts.isSpoilersOut() ? 1 : 0, parts.isSpoilersOut() ? 1 : 0, parts.getFlapsPercent() / 100.0, 0, parts.isAnyEngineOn() ? 0 : 0.75, 0, 0, 0, parts.getLights().isLandingOn(), parts.getLights().isBeaconOn(), parts.getLights().isStrobeOn(), parts.getLights().isNavOn(), 0, parts.isOnGround()); CAircraftLights lights = parts.getLights(); lights.setRecognitionOn(parts.isAnyEngineOn()); lights.setCabinOn(parts.isAnyEngineOn()); return true; } BlackCore::ISimulator *CSimulatorXPlaneFactory::create(const CSimulatorPluginInfo &info, IOwnAircraftProvider *ownAircraftProvider, IRemoteAircraftProvider *remoteAircraftProvider, IWeatherGridProvider *weatherGridProvider) { return new CSimulatorXPlane(info, ownAircraftProvider, remoteAircraftProvider, weatherGridProvider, this); } CSimulatorXPlaneListener::CSimulatorXPlaneListener(const CSimulatorPluginInfo &info): ISimulatorListener(info) { } void CSimulatorXPlaneListener::startImpl() { if (m_watcher) { return; } // already started if (isXSwiftBusRunning()) { emit simulatorStarted(getPluginInfo()); } else { CLogMessage(this).debug() << "Watching XSwiftBus on" << m_xswiftbusServerSetting.getThreadLocal(); m_conn = CSimulatorXPlane::connectionFromString(m_xswiftbusServerSetting.getThreadLocal()); m_watcher = new QDBusServiceWatcher(xswiftbusServiceName(), m_conn, QDBusServiceWatcher::WatchForRegistration, this); connect(m_watcher, &QDBusServiceWatcher::serviceRegistered, this, &CSimulatorXPlaneListener::ps_serviceRegistered); } } void CSimulatorXPlaneListener::stopImpl() { if (m_watcher) { delete m_watcher; m_watcher = nullptr; } } bool CSimulatorXPlaneListener::isXSwiftBusRunning() const { QDBusConnection conn = CSimulatorXPlane::connectionFromString(m_xswiftbusServerSetting.getThreadLocal()); CXSwiftBusServiceProxy *service = new CXSwiftBusServiceProxy(conn); CXSwiftBusTrafficProxy *traffic = new CXSwiftBusTrafficProxy(conn); bool result = service->isValid() && traffic->isValid(); service->deleteLater(); traffic->deleteLater(); return result; } void CSimulatorXPlaneListener::ps_serviceRegistered(const QString &serviceName) { if (serviceName == xswiftbusServiceName()) { emit simulatorStarted(getPluginInfo()); } } void CSimulatorXPlaneListener::ps_xswiftbusServerSettingChanged() { // user changed settings, restart the listener if (m_watcher) { stop(); start(); } } } // namespace } // namespace