flightgear/src/AIModel/AISwiftAircraft.cpp

// AISwiftAircraft.cpp - Derived AIBase class for swift aircraft
//
// Copyright (C) 2020 - swift Project Community / Contributors (http://swift-project.org/)
// Written by Lars Toenning <dev@ltoenning.de> started on April 2020.
//
// 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 "AISwiftAircraft.h"
#include <src/Main/globals.hxx>


FGAISwiftAircraft::FGAISwiftAircraft(const std::string& callsign, const std::string& modelString) : FGAIBase(otStatic, false)
{
    std::size_t  pos = modelString.find("/Aircraft/"); // Only supporting AI models from FGDATA/AI/Aircraft for now
    if(pos != std::string::npos)
        model_path.append(modelString.substr(pos));
    else
        model_path.append("INVALID_PATH");

    setCallSign(callsign);
    _searchOrder = PREFER_AI;
}

void FGAISwiftAircraft::updatePosition(SGGeod& position, SGVec3<double>& orientation, double groundspeed, bool initPos)
{
    m_initPos = initPos;
    _setLatitude(position.getLatitudeDeg());
    _setLongitude(position.getLongitudeDeg());
    _setAltitude(position.getElevationFt());
    setPitch(orientation.x());
    setBank(orientation.y());
    setHeading(orientation.z());
    setSpeed(groundspeed);

}

void FGAISwiftAircraft::update(double dt)
{
    FGAIBase::update(dt);
    Transform();
}

double FGAISwiftAircraft::getGroundElevation(const SGGeod& pos) const
{
    if(!m_initPos) { return std::numeric_limits<double>::quiet_NaN(); }
    double alt = 0;
    SGGeod posReq;
    posReq.setElevationFt(30000);
    posReq.setLatitudeDeg(pos.getLatitudeDeg());
    posReq.setLongitudeDeg(pos.getLongitudeDeg());
    if(this->getGroundElevationM(posReq, alt, nullptr))
        return alt;
    return std::numeric_limits<double>::quiet_NaN();
}

void FGAISwiftAircraft::setPlaneSurface(double gear, double flaps, double spoilers, double speedBrake, double slats,
                     double wingSweeps, double thrust, double elevator, double rudder, double aileron,
                     bool landingLight, bool taxiLight, bool beaconLight, bool strobeLight, bool navLight,
                     int lightPattern)
{
    m_gearNode->setDoubleValue(gear);
    m_flapsIdentNode->setDoubleValue(flaps);
    m_spoilerNode->setDoubleValue(spoilers);
    m_speedBrakeNode->setDoubleValue(speedBrake);
    m_landLightNode->setBoolValue(landingLight);
    m_taxiLightNode->setBoolValue(taxiLight);
    m_beaconLightNode->setBoolValue(beaconLight);
    m_strobeLightNode->setBoolValue(strobeLight);
    m_navLightNode->setBoolValue(navLight);
}

void FGAISwiftAircraft::setPlaneTransponder(int code, bool modeC, bool ident)
{
    m_transponderCodeNode->setIntValue(code);
    m_transponderCModeNode->setBoolValue(modeC);
    m_transponderIdentNode->setBoolValue(ident);
}

void FGAISwiftAircraft::initProps()
{
    // Setup node properties
    m_transponderCodeNode = _getProps()->getNode("swift/transponder/code", true);
    m_transponderCModeNode = _getProps()->getNode("swift/transponder/c-mode", true);
    m_transponderIdentNode = _getProps()->getNode("swift/transponder/ident", true);

    m_gearNode = _getProps()->getNode("controls/gear/gear-down", true);
    m_flapsIdentNode = _getProps()->getNode("controls/flight/flaps", true);
    m_spoilerNode = _getProps()->getNode("controls/flight/spoilers", true);
    m_speedBrakeNode = _getProps()->getNode("controls/flight/speedbrake", true);
    m_landLightNode = _getProps()->getNode("controls/lighting/landing-lights", true);

    // Untie NavLight property for explicit control (tied within FGAIBase)
    m_navLightNode = _getProps()->getNode("controls/lighting/nav-lights", true);
    if(m_navLightNode)
    {
        m_navLightNode->untie();
    }

    m_taxiLightNode = _getProps()->getNode("controls/lighting/taxi-light", true);
    m_beaconLightNode = _getProps()->getNode("controls/lighting/beacon", true);
    m_strobeLightNode = _getProps()->getNode("controls/lighting/strobe", true);
}

FGAISwiftAircraft::~FGAISwiftAircraft() = default;