TCAS.cpp

Go to the documentation of this file.

#include "Module.h"

TCAS::TCAS(Bus* prmBus, Logger* prmLogger, D3DXMATRIX* prmMatrixView) : Module(prmBus)
{
        logger = prmLogger;
        matrixView = prmMatrixView;
        for (int i = 0; i < MAX_SCAN; i++)
                olddistance[i] = -1.0f;
}

void TCAS::FrameMove(float fElapsed)
{
        if (ourcockpit.gndvehicle ||
                ourcockpit.texturelib == Apartment || ourcockpit.texturelib == SimBay || ourcockpit.texturelib == ControlTower ||
                ourcockpit.power < 0.5f)
        {
                secsincelast = 0.0f;
                coctime = 0.0f;
                tcasmode = Bus::TcasEnum::Clear_Of_Conflict;
                for (int i = 0; i < MAX_SCAN; i++)
                        olddistance[i] = -1.0f;
                return;
        }

        if (advanceframe < 1.0f)
        {
                advanceframe += fElapsed;
                return;
        }
        advanceframe = 0.0f;

        float tcastime = 999.0f; // reset
        //bus->TCASTargetOrdinal = -1; // reset
        for (int t = 1; t < MAX_SCAN; t++)
        {
                if (playerships[t].active && playerships[t].visible)
                {
                        // this is used in TCAS but easiest to do it here because we have distance and elapsed time
                        const float traversed = olddistance[t] - playerships[t].distance; // was 18 now 5
                        if (traversed > 0.0f && olddistance[t] != -1.0f) // 13 (only if positive)
                                playerships[t].closurerate = traversed; // 13km in 0.5 sec is 26km/s
                        else
                                playerships[t].closurerate = 0.0f;
                        olddistance[t] = playerships[t].distance;

                        const float oldMsl = playerships[t].msl;
                        playerships[t].msl = D3DXVec3Length(&playerships[t].position) - radiusC;
                        playerships[t].vsi = (playerships[t].msl - oldMsl);// fElapsedTime;

                        if (playerships[0].logolight && // our power has to be on
                                !playerships[0].docked && // we are not docked
                                !playerships[0].groundvehicle && // don't run for if we are in gv
                                playerships[0].reference != REF_ONGROUND && // don't run if we are on ground
                                playerships[0].reference != REF_INANOTHER && // don't run if we are in another
                                playerships[t].logolight &&
                                !playerships[t].docked &&
                                !playerships[t].groundvehicle &&
                                playerships[t].reference != REF_ONGROUND &&
                                playerships[t].reference != REF_INANOTHER &&
                                playerships[t].distance < ourcockpit.scanrange &&
                                playerships[t].type != VehicleType::FloatingMan &&
                                playerships[t].type != VehicleType::BeishtKione &&
                                playerships[t].closurerate > 0.0f)
                        {
                                const float timetoimpact = playerships[t].distance / playerships[t].closurerate; // seconds
                                if (timetoimpact < tcastime) // 0.19 seconds
                                {
                                        tcastime = timetoimpact;
                                        bus->TCASTargetOrdinal = t;
                                }
                        }
                }
        }

        secsincelast++;
        if (secsincelast >= 3.0f) // last spoke
        {
                const Bus::TcasEnum oldtcasmode = tcasmode;

                if (tcastime < 40.0f && tcasmode == Bus::TcasEnum::Clear_Of_Conflict) // new advisory
                {
                        tcasmode = Bus::TcasEnum::Traffic_Advisory;
                        coctime = 0.0f;
                }
                else if (tcastime < 25.0f) // RA
                {
                        D3DXVECTOR3 result1;
                        D3DXVec3Subtract(&result1, &playerships[0].position, &playerships[bus->TCASTargetOrdinal].position);
                        D3DXVec3TransformCoord(&result1, &result1, matrixView);

                        if (result1.z != 0.0f)
                        {
                                const float bear1 = D3DXToDegree(atanf(result1.x / result1.z));
                                float mark1 = D3DXToDegree(atanf(result1.y / result1.z));
                                float f_temp = sqrtf(mark1 * mark1 + bear1 * bear1);
                                if (f_temp > 180.0f)
                                {
                                        f_temp = 180.0f / f_temp;
                                        mark1 *= f_temp;
                                }
                                if (result1.z > 0.0f) // Behind us
                                {
                                        mark1 = -mark1;
                                }
                                if (mark1 < 0.0f)
                                {
                                        if (tcasmode != Bus::TcasEnum::RA_Monitor_Climb)
                                                tcasmode = Bus::TcasEnum::RA_Climb;
                                }
                                else
                                {
                                        if (tcasmode != Bus::TcasEnum::RA_Monitor_Descent)
                                                tcasmode = Bus::TcasEnum::RA_Descend;
                                }
                        }

                        coctime = 0.0f;
                }
                else if (tcastime >= 40.0f && tcasmode != Bus::TcasEnum::Clear_Of_Conflict)
                {
                        coctime += fElapsed;
                        if (coctime > 10.0f || tcastime == 999.0f)
                                tcasmode = Bus::TcasEnum::Clear_Of_Conflict;
                }

                if (tcasmode != oldtcasmode || tcasmode >= Bus::TcasEnum::RA_Monitor_Climb)
                {
                        Command command;
                        switch (tcasmode)
                        {
                        case Bus::TcasEnum::Clear_Of_Conflict: command.name = "TCASClear"; break;
                        case Bus::TcasEnum::Traffic_Advisory: command.name = "TCASTraffic"; break;
                        case Bus::TcasEnum::RA_Climb: command.name = "TCASClimb"; break;
                        case Bus::TcasEnum::RA_Descend: command.name = "TCASDescend"; break;
                        default: command.name = "TCASMonitor"; break;
                        }
                        bus->commandStream.emplace_back(command);

                        char msg[999];
                        sprintf_s(msg, 999, "TCAS traffic ordinal %i tti %.1f mode %i",
                                bus->TCASTargetOrdinal, tcastime, tcasmode);
                        logger->Log(msg);

                        secsincelast = 0.0f;

                        if (tcasmode == Bus::TcasEnum::RA_Climb)
                                tcasmode = Bus::TcasEnum::RA_Monitor_Climb;
                        else if (tcasmode == Bus::TcasEnum::RA_Descend)
                                tcasmode = Bus::TcasEnum::RA_Monitor_Descent;

                        bus->TCAS = tcasmode;
                }
        }
}