mirror of
https://github.com/swift-project/pilotclient.git
synced 2026-03-31 12:55:33 +08:00
316 lines
16 KiB
C++
316 lines
16 KiB
C++
/* 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 "blackmisc/aviation/aircraftsituation.h"
|
|
#include "blackmisc/geo/elevationplane.h"
|
|
#include "blackmisc/pq/physicalquantity.h"
|
|
#include "blackmisc/pq/units.h"
|
|
#include "blackmisc/propertyindex.h"
|
|
#include "blackmisc/comparefunctions.h"
|
|
#include "blackmisc/variant.h"
|
|
#include "blackmisc/verify.h"
|
|
#include "QStringBuilder"
|
|
#include <QtGlobal>
|
|
|
|
using namespace BlackMisc;
|
|
using namespace BlackMisc::PhysicalQuantities;
|
|
using namespace BlackMisc::Geo;
|
|
|
|
namespace BlackMisc
|
|
{
|
|
namespace Aviation
|
|
{
|
|
CAircraftSituation::CAircraftSituation()
|
|
: m_groundElevation({ 0, nullptr }, CAltitude::MeanSeaLevel) {}
|
|
|
|
CAircraftSituation::CAircraftSituation(const CCallsign &correspondingCallsign)
|
|
: m_correspondingCallsign(correspondingCallsign), m_groundElevation({ 0, nullptr }, CAltitude::MeanSeaLevel)
|
|
{}
|
|
|
|
CAircraftSituation::CAircraftSituation(const CCoordinateGeodetic &position, const CHeading &heading, const CAngle &pitch, const CAngle &bank, const CSpeed &gs, const CAltitude &groundElevation)
|
|
: m_position(position), m_heading(heading), m_pitch(pitch),
|
|
m_bank(bank), m_groundSpeed(gs), m_groundElevation(groundElevation)
|
|
{
|
|
m_pressureAltitude = position.geodeticHeight().toPressureAltitude(CPressure(1013.25, CPressureUnit::mbar()));
|
|
}
|
|
|
|
CAircraftSituation::CAircraftSituation(const CCallsign &correspondingCallsign, const CCoordinateGeodetic &position, const CHeading &heading, const CAngle &pitch, const CAngle &bank, const CSpeed &gs, const CAltitude &groundElevation)
|
|
: m_correspondingCallsign(correspondingCallsign),
|
|
m_position(position), m_heading(heading), m_pitch(pitch),
|
|
m_bank(bank), m_groundSpeed(gs), m_groundElevation(groundElevation)
|
|
{
|
|
m_correspondingCallsign.setTypeHint(CCallsign::Aircraft);
|
|
m_pressureAltitude = position.geodeticHeight().toPressureAltitude(CPressure(1013.25, CPressureUnit::mbar()));
|
|
}
|
|
|
|
QString CAircraftSituation::convertToQString(bool i18n) const
|
|
{
|
|
return QStringLiteral("ts: ") % this->getFormattedTimestampAndOffset(true) %
|
|
QStringLiteral(" ") % m_position.toQString(i18n) %
|
|
QStringLiteral(" bank: ") % (m_bank.toQString(i18n)) %
|
|
QStringLiteral(" pitch: ") % (m_pitch.toQString(i18n)) %
|
|
QStringLiteral(" heading: ") % (m_heading.toQString(i18n)) %
|
|
QStringLiteral(" og: ") % this->getOnGroundInfo() %
|
|
QStringLiteral(" gs: ") % m_groundSpeed.valueRoundedWithUnit(CSpeedUnit::kts(), 1, true) %
|
|
QStringLiteral(" ") % m_groundSpeed.valueRoundedWithUnit(CSpeedUnit::m_s(), 1, true) %
|
|
QStringLiteral(" elevation: ") % (m_groundElevation.toQString(i18n));
|
|
}
|
|
|
|
const QString &CAircraftSituation::isOnGroundToString(CAircraftSituation::IsOnGround onGround)
|
|
{
|
|
static const QString notog("not on ground");
|
|
static const QString og("on ground");
|
|
static const QString unknown("unknown");
|
|
|
|
switch (onGround)
|
|
{
|
|
case CAircraftSituation::NotOnGround: return notog;
|
|
case CAircraftSituation::OnGround: return og;
|
|
case CAircraftSituation::OnGroundSituationUnknown:
|
|
default: return unknown;
|
|
}
|
|
}
|
|
|
|
const QString &CAircraftSituation::onGroundDetailsToString(CAircraftSituation::OnGroundDetails reliability)
|
|
{
|
|
static const QString intElv("elevation");
|
|
static const QString intElvCg("elevation/CG");
|
|
static const QString intInter("interpolation");
|
|
static const QString intGuess("guessing");
|
|
static const QString unknown("unknown");
|
|
static const QString outOwnAircraft("own aircraft");
|
|
static const QString inNetwork("from network");
|
|
static const QString inFromParts("from parts");
|
|
static const QString InNoGroundInfo("no gnd.info");
|
|
|
|
switch (reliability)
|
|
{
|
|
case CAircraftSituation::OnGroundByElevation: return intElv;
|
|
case CAircraftSituation::OnGroundByElevationAndCG: return intElvCg;
|
|
case CAircraftSituation::OnGroundByGuessing: return intGuess;
|
|
case CAircraftSituation::OnGroundByInterpolation: return intInter;
|
|
case CAircraftSituation::OutOnGroundOwnAircraft: return outOwnAircraft;
|
|
case CAircraftSituation::InFromNetworkSituation: return inNetwork;
|
|
case CAircraftSituation::InFromParts: return inFromParts;
|
|
case CAircraftSituation::InNoGroundInfo: return InNoGroundInfo;
|
|
case CAircraftSituation::NotSet:
|
|
default:
|
|
return unknown;
|
|
}
|
|
}
|
|
|
|
CVariant CAircraftSituation::propertyByIndex(const BlackMisc::CPropertyIndex &index) const
|
|
{
|
|
if (index.isMyself()) { return CVariant::from(*this); }
|
|
if (ITimestampWithOffsetBased::canHandleIndex(index)) { return ITimestampWithOffsetBased::propertyByIndex(index); }
|
|
if (ICoordinateGeodetic::canHandleIndex(index)) { return ICoordinateGeodetic::propertyByIndex(index); }
|
|
|
|
const ColumnIndex i = index.frontCasted<ColumnIndex>();
|
|
switch (i)
|
|
{
|
|
case IndexPosition: return m_position.propertyByIndex(index.copyFrontRemoved());
|
|
case IndexLatitude: return this->latitude().propertyByIndex(index.copyFrontRemoved());
|
|
case IndexLongitude: return this->longitude().propertyByIndex(index.copyFrontRemoved());
|
|
case IndexAltitude: return this->getAltitude().propertyByIndex(index.copyFrontRemoved());
|
|
case IndexHeading: return m_heading.propertyByIndex(index.copyFrontRemoved());
|
|
case IndexPitch: return m_pitch.propertyByIndex(index.copyFrontRemoved());
|
|
case IndexBank: return m_bank.propertyByIndex(index.copyFrontRemoved());
|
|
case IndexGroundSpeed: return m_groundSpeed.propertyByIndex(index.copyFrontRemoved());
|
|
case IndexGroundElevation: return m_groundElevation.propertyByIndex(index.copyFrontRemoved());
|
|
case IndexCallsign: return m_correspondingCallsign.propertyByIndex(index.copyFrontRemoved());
|
|
case IndexIsOnGround: return CVariant::fromValue(m_isOnGround);
|
|
case IndexIsOnGroundString: return CVariant::fromValue(this->isOnGroundAsString());
|
|
case IndexOnGroundReliability: return CVariant::fromValue(m_onGroundDetails);
|
|
case IndexOnGroundReliabilityString: return CVariant::fromValue(this->getOnDetailsAsString());
|
|
default: return CValueObject::propertyByIndex(index);
|
|
}
|
|
}
|
|
|
|
void CAircraftSituation::setPropertyByIndex(const CPropertyIndex &index, const CVariant &variant)
|
|
{
|
|
if (index.isMyself()) { (*this) = variant.to<CAircraftSituation>(); return; }
|
|
if (ITimestampWithOffsetBased::canHandleIndex(index)) { ITimestampWithOffsetBased::setPropertyByIndex(index, variant); return; }
|
|
|
|
const ColumnIndex i = index.frontCasted<ColumnIndex>();
|
|
switch (i)
|
|
{
|
|
case IndexPosition: m_position.setPropertyByIndex(index.copyFrontRemoved(), variant); break;
|
|
case IndexPitch: m_pitch.setPropertyByIndex(index.copyFrontRemoved(), variant); break;
|
|
case IndexBank: m_bank.setPropertyByIndex(index.copyFrontRemoved(), variant); break;
|
|
case IndexGroundSpeed: m_groundSpeed.setPropertyByIndex(index.copyFrontRemoved(), variant); break;
|
|
case IndexGroundElevation: m_groundElevation.setPropertyByIndex(index.copyFrontRemoved(), variant); break;
|
|
case IndexCallsign: m_correspondingCallsign.setPropertyByIndex(index.copyFrontRemoved(), variant); break;
|
|
case IndexIsOnGround: m_isOnGround = variant.toInt(); break;
|
|
case IndexOnGroundReliability: m_onGroundDetails = variant.toInt(); break;
|
|
default: CValueObject::setPropertyByIndex(index, variant); break;
|
|
}
|
|
}
|
|
|
|
int CAircraftSituation::comparePropertyByIndex(const CPropertyIndex &index, const CAircraftSituation &compareValue) const
|
|
{
|
|
if (ITimestampWithOffsetBased::canHandleIndex(index)) { return ITimestampWithOffsetBased::comparePropertyByIndex(index, compareValue); }
|
|
if (ICoordinateGeodetic::canHandleIndex(index)) { return ICoordinateGeodetic::comparePropertyByIndex(index, compareValue); }
|
|
const ColumnIndex i = index.frontCasted<ColumnIndex>();
|
|
switch (i)
|
|
{
|
|
case IndexPosition: return m_position.comparePropertyByIndex(index.copyFrontRemoved(), compareValue.getPosition());
|
|
case IndexAltitude: return this->getAltitude().comparePropertyByIndex(index.copyFrontRemoved(), compareValue.getAltitude());
|
|
case IndexPitch: return m_pitch.comparePropertyByIndex(index.copyFrontRemoved(), compareValue.getPitch());
|
|
case IndexBank: return m_bank.comparePropertyByIndex(index.copyFrontRemoved(), compareValue.getBank());
|
|
case IndexGroundSpeed: return m_groundSpeed.comparePropertyByIndex(index.copyFrontRemoved(), compareValue.getGroundSpeed());
|
|
case IndexGroundElevation: return m_groundElevation.comparePropertyByIndex(index.copyFrontRemoved(), compareValue.getGroundElevation());
|
|
case IndexCallsign: return m_correspondingCallsign.comparePropertyByIndex(index.copyFrontRemoved(), compareValue.getCallsign());
|
|
case IndexIsOnGround:
|
|
case IndexIsOnGroundString:
|
|
return Compare::compare(m_isOnGround, compareValue.m_isOnGround);
|
|
case IndexOnGroundReliability:
|
|
case IndexOnGroundReliabilityString:
|
|
return Compare::compare(m_onGroundDetails, compareValue.m_onGroundDetails);
|
|
default: break;
|
|
}
|
|
const QString assertMsg("No comparison for index " + index.toQString());
|
|
BLACK_VERIFY_X(false, Q_FUNC_INFO, qUtf8Printable(assertMsg));
|
|
return 0;
|
|
}
|
|
|
|
bool CAircraftSituation::isNull() const
|
|
{
|
|
return this->isPositionNull();
|
|
}
|
|
|
|
void CAircraftSituation::setNull()
|
|
{
|
|
m_position.setNull();
|
|
m_pressureAltitude.setNull();
|
|
m_heading.setNull();
|
|
m_pitch.setNull();
|
|
m_bank.setNull();
|
|
m_groundElevation.setNull();
|
|
m_groundSpeed.setNull();
|
|
m_onGroundDetails = CAircraftSituation::NotSet;
|
|
}
|
|
|
|
const QString &CAircraftSituation::isOnGroundAsString() const
|
|
{
|
|
return CAircraftSituation::isOnGroundToString(this->isOnGround());
|
|
}
|
|
|
|
bool CAircraftSituation::isOnGroundInfoAvailable() const
|
|
{
|
|
return this->isOnGround() != CAircraftSituation::OnGroundSituationUnknown &&
|
|
this->getOnGroundDetails() != CAircraftSituation::NotSet;
|
|
}
|
|
|
|
void CAircraftSituation::setOnGround(CAircraftSituation::IsOnGround onGround, CAircraftSituation::OnGroundDetails reliability)
|
|
{
|
|
this->setOnGround(onGround);
|
|
this->setOnGroundReliabiliy(reliability);
|
|
}
|
|
|
|
const QString &CAircraftSituation::getOnDetailsAsString() const
|
|
{
|
|
return CAircraftSituation::onGroundDetailsToString(this->getOnGroundDetails());
|
|
}
|
|
|
|
QString CAircraftSituation::getOnGroundInfo() const
|
|
{
|
|
return this->isOnGroundAsString() % QLatin1Char(' ') % this->getOnDetailsAsString();
|
|
}
|
|
|
|
bool CAircraftSituation::hasGroundElevation() const
|
|
{
|
|
return !this->getGroundElevation().isNull();
|
|
}
|
|
|
|
bool CAircraftSituation::setGroundElevationChecked(const CAltitude &elevation, bool ignoreNullValues, bool overrideExisting)
|
|
{
|
|
if (ignoreNullValues && elevation.isNull()) { return false; }
|
|
if (!overrideExisting && this->hasGroundElevation()) { return false; }
|
|
m_groundElevation = elevation;
|
|
return true;
|
|
}
|
|
|
|
bool CAircraftSituation::setGroundElevationChecked(const CElevationPlane &elevationPlane, bool ignoreNullValues, bool overrideExisting)
|
|
{
|
|
if (ignoreNullValues && elevationPlane.isNull()) { return false; }
|
|
if (!overrideExisting && this->hasGroundElevation()) { return false; }
|
|
if (!elevationPlane.isWithinRange(*this)) { return false; }
|
|
m_groundElevation = elevationPlane.getAltitude();
|
|
return true;
|
|
}
|
|
|
|
CLength CAircraftSituation::getHeightAboveGround() const
|
|
{
|
|
if (this->getAltitude().isNull()) { return { 0, nullptr }; }
|
|
if (this->getAltitude().getReferenceDatum() == CAltitude::AboveGround)
|
|
{
|
|
// we have a sure value explicitly set
|
|
return this->getAltitude();
|
|
}
|
|
const CLength gh(this->getGroundElevation());
|
|
if (gh.isNull()) { return { 0, nullptr }; }
|
|
return this->getAltitude() - gh;
|
|
}
|
|
|
|
CAltitude CAircraftSituation::getCorrectedAltitude(const CLength ¢erOfGravity, bool *corrected) const
|
|
{
|
|
if (corrected) { *corrected = false; }
|
|
if (this->getGroundElevation().isNull()) { return this->getAltitude(); }
|
|
|
|
// above ground
|
|
if (this->getAltitude().getReferenceDatum() == CAltitude::AboveGround)
|
|
{
|
|
const CAltitude aboveGround = this->getAltitude().withOffset(centerOfGravity);
|
|
const bool c = !aboveGround.isPositiveWithEpsilonConsidered();
|
|
if (corrected) { *corrected = c; }
|
|
return c ?
|
|
CAltitude(0, CAltitude::AboveGround, aboveGround.getUnit()) :
|
|
aboveGround;
|
|
}
|
|
else
|
|
{
|
|
const CAltitude groundPlusCG = this->getGroundElevation().withOffset(centerOfGravity);
|
|
const bool c = (this->getAltitude() < groundPlusCG);
|
|
if (corrected) { *corrected = c; }
|
|
return c ?
|
|
groundPlusCG :
|
|
this->getAltitude();
|
|
}
|
|
}
|
|
|
|
void CAircraftSituation::setPressureAltitude(const CAltitude &altitude)
|
|
{
|
|
Q_ASSERT(altitude.getAltitudeType() == CAltitude::PressureAltitude);
|
|
m_pressureAltitude = altitude;
|
|
}
|
|
|
|
CLength CAircraftSituation::getDistancePerTime(const CTime &time) const
|
|
{
|
|
if (this->getGroundSpeed().isNull()) { return CLength(0, CLengthUnit::nullUnit()); }
|
|
const int ms = time.valueInteger(CTimeUnit::ms());
|
|
return this->getDistancePerTime(ms);
|
|
}
|
|
|
|
CLength CAircraftSituation::getDistancePerTime(int milliseconds) const
|
|
{
|
|
if (this->getGroundSpeed().isNull()) { return CLength(0, CLengthUnit::nullUnit()); }
|
|
const double seconds = milliseconds / 1000;
|
|
const double gsMeterSecond = this->getGroundSpeed().value(CSpeedUnit::m_s());
|
|
const CLength d(seconds * gsMeterSecond, CLengthUnit::m());
|
|
return d;
|
|
}
|
|
|
|
void CAircraftSituation::setCallsign(const CCallsign &callsign)
|
|
{
|
|
m_correspondingCallsign = callsign;
|
|
m_correspondingCallsign.setTypeHint(CCallsign::Aircraft);
|
|
}
|
|
} // namespace
|
|
} // namespace
|