FDR.cpp

Go to the documentation of this file.

#include "Module.h"
#include <sys/stat.h>
#include <fcntl.h>
#include <io.h>

Fdr::Fdr(Bus* prmBus, Logger* prmLogger) : Module(prmBus)
{
        logger = prmLogger;
        bus = prmBus;

        SYSTEMTIME st;
        GetLocalTime(&st);
        char fileName[99];
        sprintf_s(fileName, 99, "%i-%02i-%02i.fdr", st.wYear, st.wMonth, st.wDay);
        _sopen_s(&fdrfile, fileName, _O_RDWR | _O_CREAT | _O_TEXT | _O_APPEND | _O_SEQUENTIAL, SH_DENYWR, S_IWRITE);
        if (fdrfile == -1)
        {
                DXUT_ERR_MSGBOX(L"Could not open fdrfile for writing!", errno);
                DXUTShutdown(errno);
        }
        char msg[99];
        sprintf_s(msg, 99, "FDR::ctor Opened fdrfile \"%s\"", fileName);
        logger->Log(msg);
}

void Fdr::FrameMove(float fElapsedTime)
{
        if (bus->FlightFreeze) return;

        secSinceLast += fElapsedTime;
        if (secSinceLast < 1.0f)
                return;

        secSinceLast = 0.0f;

        char timemsg[999];

        SYSTEMTIME st = bus->Time;
        sprintf_s(timemsg, 999, "%02i:%02i:%02i-%6s,", st.wHour, st.wMinute, st.wSecond, bus->receiptNumber.c_str()); // 1
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%6.3f,", bus->PressureAltitude); // 2
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%3.0f,", bus->IndicatedAirspeed*1943.84449f); // 3
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%03.0f/%03.0f,", D3DXToDegree(bus->HeadingTrue), D3DXToDegree(bus->HeadingTrack)); // 4
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+5.3f,", bus->NormalAcceleration.x); // 5
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+3.0f,", D3DXToDegree(bus->PitchAttitude)); // 6
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+4.0f,", D3DXToDegree(bus->RollAttitude)); // 7
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        timemsg[0] = 0; // 8
        for (unsigned i = 0; i < bus->Transmitting.size(); i++)
        {
                if (i>0) strcat_s(timemsg, 999, "/");
                if (bus->Transmitting.at(i))
                        strcat_s(timemsg, 999, "1");
                else
                        strcat_s(timemsg, 999, "0");
        }
        strcat_s(timemsg, 999, ",");
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        timemsg[0] = 0; // 9
        for (int i = 0; i < enginesC; i++)
        {
                if (i>0) strcat_s(timemsg, 999, "/");
                char engine[999];
                sprintf_s(engine, 999, "%5.0f", bus->EngineThrustOutput[i]);
                strcat_s(timemsg, 999, engine);
        }
        strcat_s(timemsg, 999, ",");
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%i,", bus->AFCS.AutopilotEngaged); // 10
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+5.3f,", bus->NormalAcceleration.y); // 11
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+6.3f,", bus->PitchControl); // 12
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+6.3f,", bus->RollControl); // 13
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+6.3f,", bus->YawControl); // 14
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        timemsg[0] = 0; // 15
        for (int i = 0; i < 4; i++)
        {
                if (i>0) strcat_s(timemsg, 999, "/");
                char discreet[999];
                sprintf_s(discreet, 999, "%+5.2f", bus->DiscreetSurfacePostion[i]);
                strcat_s(timemsg, 999, discreet);
        }
        strcat_s(timemsg, 999, ",");
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+6.3f,", bus->RollControlSurfacePosition); // 16
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+6.3f,", bus->YawControlSurfacePosition); // 17
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+5.3f,", bus->NormalAcceleration.z); // 18
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+6.3f,", bus->PitchTrimSurfacePosition); // 19
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+6.3f,", bus->TrailingEdgeFlapsPosition); // 20
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));

        sprintf_s(timemsg, 999, "%+6.3f,", bus->LeadingEdgeFlapsPosition); // 21
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));


        strcpy_s(timemsg, 999, "\n");
        _write(fdrfile, timemsg, static_cast<unsigned int>(strlen(timemsg)));
}

Fdr::~Fdr()
{
        logger->Log("FDR::dtor Closing fdrfile...");
        _close(fdrfile);
        fdrfile = -1;
}