Orbit.cpp

Go to the documentation of this file.

#include "Instrument.h"
#include "../Bus.h"

Orbit::Orbit(int prmX, int prmY, float prmXScale, float prmYScale, Bus* prmBus, Logger* prmLogger, DeviceObject* prmDevice, std::vector<Font*> prmFonts) :
        Instrument(prmX, prmY, prmXScale, prmYScale, prmBus, prmLogger, prmDevice, prmFonts)
{
        logger->AddToCallStack("Orbit::ctor");
        defaultFont = 1;
}

void Orbit::Render()
{
        if (f_MSL < 100.0f) // K�rm�n line
                return;

        WCHAR str[99];

        if (ec < 1.0f) // apoapsis is infinite if the orbit is parabolic/hyperbolic
        {
                // period is infinite if the orbit is parabolic/hyperbolic
                swprintf_s(str, 99, L"TP: %5.2f s", tp);
                DrawTextW(str, 0, 0, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 128, 128, 255));
        }

        swprintf_s(str, 99, L" e: %0.6f", ec);
        if (ec >= 1.0f)
                DrawTextW(str, 0, 22, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 255, 0, 0));
        else if (ec >= 0.75f)
                DrawTextW(str, 0, 22, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 128, 0, 0));
        else
                DrawTextW(str, 0, 22, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 0, 128, 0));

        if (ec > 1.0f)
        {
                if (flasher)
                        DrawTextW(L"aa: HYPERBOLIC", 0, 12, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 255, 0, 0));
        }
        else
        {
                swprintf_s(str, 99, L"aa: %4.3f km", aa);
                if (ec >= 0.75f)
                        DrawTextW(str, 0, 12, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 128, 0, 0));
                else
                        DrawTextW(str, 0, 12, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 0, 128, 0));
        }

        swprintf_s(str, 99, L"ap: %4.3f km", ap);
        if (ap <= 0.0f)
        {
                if (flasher)
                        DrawTextW(L"ap: SURFACE", 0, 32, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 255, 0, 0));
        }
        else if (ap < 73.49f)
                DrawTextW(str, 0, 32, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 255, 0, 0));
        else if (ap < 146.98f)
                DrawTextW(str, 0, 32, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 128, 0, 0));
        else
                DrawTextW(str, 0, 32, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 0, 128, 0));

        swprintf_s(str, 99, L"vo: %3.1f", D3DXToDegree(vo));
        DrawTextW(str, 0, 42, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 128, 128, 128));

        swprintf_s(str, 99, L" i: %1.6f", D3DXToDegree(ix));
        DrawTextW(str, 0, 52, 0, DT_NOCLIP, D3DCOLOR_ARGB(255, 128, 128, 128));


        // Reverse engineer
        //      f_temp=p/(1.0f+D3DXVec3Length( &ex )*cosf(vo));
        //      rx.x=f_temp*cosf(vo); rx.y=f_temp*sinf(vo); rx.z=0.0f;
        //      f_temp=sqrtf(mu/p);
        //      vx.x=f_temp*-sinf(vo); vx.y=f_temp*(D3DXVec3Length( &ex )+cosf(vo)); vx.z=0.0f;
        //
        //      D3DXMatrixIdentity( &matrixWorld );
        //      D3DXMatrixRotationZ( &matrixTemp, -ox );
        //      D3DXMatrixMultiply( &matrixWorld, &matrixWorld, &matrixTemp );
        //      D3DXMatrixRotationX( &matrixTemp, ix );
        //      D3DXMatrixMultiply( &matrixWorld, &matrixWorld, &matrixTemp );
        //      D3DXMatrixRotationZ( &matrixTemp, wx );
        //      D3DXMatrixMultiply( &matrixWorld, &matrixWorld, &matrixTemp );
        //      D3DXMatrixInverse( &matrixWorld, NULL, &matrixWorld );

        //      D3DXVec3TransformCoord( &rx, &rx, &matrixWorld );
        //      D3DXVec3TransformCoord( &vx, &vx, &matrixWorld );

        //      sprintf_s( msg, sizeof(msg), "i: %1.3f  j: %1.3f  k: %1.3f", vx.x, vx.y, vx.z );
        //      m_pFont->DrawText( 2, 220, D3DCOLOR_ARGB(255,128,128,128), msg );
        //      sprintf_s( msg, sizeof(msg), "x: %1.3f  y: %1.3f  z: %1.3f", rx.x, rx.y, rx.z );
        //      m_pFont->DrawText( 2, 240, D3DCOLOR_ARGB(255,128,128,128), msg );
        // Orbital elements -------------------------------------------------------------------------
}

void Orbit::FrameMove(float fElapsed)
{
        if (f_MSL < 100.0f) // K�rm�n line
                return;

        halfsec += fElapsed;
        if (halfsec > 0.5f)
                halfsec -= 0.5f;
        else
                return;

        vx = oldvelocity;
        rx = oldposition;

        D3DXVec3Cross(&hx, &rx, &vx);
        D3DXVec3Cross(&nx, &northpoleC, &hx);

        const float param = powf(D3DXVec3Length(&hx), 2.0f) / mu;

        D3DXVec3Scale(&ex, &rx, (powf(D3DXVec3Length(&vx), 2.0f) - mu / D3DXVec3Length(&rx)) / mu);
        D3DXVec3Scale(&tv, &vx, D3DXVec3Dot(&rx, &vx) / mu);
        D3DXVec3Subtract(&ex, &ex, &tv); // eccentricity vector
        ec = D3DXVec3Length(&ex); // eccentricity magnitude

        const float rp = param / (1.0f + ec); // radius sub periapsis
        ap = rp - radiusC;

        const float a = param / (1.0f - powf(ec, 2.0f)); // semi-major axis

        if (ec <= 1.0f)
        {
                //float ra = prm / (1.0f - ec); // radius sub apoapsis old way is slower because of division
                const float ra = 2.0f * a - rp; // radius sub apoapsis
                aa = ra - radiusC; // altitude at apoapsis
                tp = D3DX_TAU * sqrtf(powf(a, 3.0f) / mu);
        }
        else
        {
                aa = -1.0f;
                tp = 0.0f;
        }

        const float f_temp = D3DXVec3Dot(&ex, &rx) / (ec * D3DXVec3Length(&rx));
        if (f_temp >= 1.0f)
                vo = 0.0f;
        else if (f_temp <= -1.0f)
                vo = D3DX_HALFPI;
        else
                vo = acosf(f_temp);
        if (D3DXVec3Dot(&rx, &vx) < 0.0f)
                vo = D3DX_TAU - vo;

        ix = acosf(hx.z / D3DXVec3Length(&hx));


        //      float uo=acosf( D3DXVec3Dot( &nx, &rx )/(D3DXVec3Length( &nx )*D3DXVec3Length( &rx )) ); // argument of latitude
        //      if (rx.z<0.0f)
        //              uo=D3DX_TAU-uo;

        //f_temp = nx.x / D3DXVec3Length(&nx);
        //float ox; // longitude of ascending node
        //if (f_temp >= 1.0f)
        //      ox = 0.0f;
        //else if (f_temp <= -1.0f)
        //      ox = D3DX_HALFPI;
        //else
        //      ox = acosf(f_temp);
        //if (nx.y < 0.0f)
        //      ox = D3DX_TAU - ox;

        //f_temp = D3DXVec3Dot(&nx, &ex) / (D3DXVec3Length(&nx) * ec);
        //float wx; // Argument of periapsis?
        //if (f_temp >= 1.0f)
        //      wx = 0.0f;
        //else if (f_temp <= -1.0f)
        //      wx = D3DX_HALFPI;
        //else
        //      wx = acosf(f_temp);
        //if (ex.z < 0.0f)
        //      wx = D3DX_TAU - wx;

        //      float M=sqrtf(mu/powf(a, 3.0f));
        //      sprintf_s( msg, sizeof(msg), "dv: %0.6f", dv );
        //      m_pFont->DrawText( 907-130.0f, rtHeight-160.0f, D3DCOLOR_ARGB(255,128,128,255), msg );

        //      float dv=M+2.0f*D3DXVec3Length(&ex)*sinf(M)+5.0f/4.0f*powf(D3DXVec3Length(&ex), 2.0f)*sinf(2.0f*M);
        //      sprintf_s( msg, sizeof(msg), "M: %0.6f", M );
        //      m_pFont->DrawText( 907-120.0f, rtHeight-140.0f, D3DCOLOR_ARGB(255,128,128,255), msg );

        oldvelocity = playerships[0].velocity;
        oldposition = playerships[0].position;
}