TurnByTurn.h

Go to the documentation of this file.

#pragma once

#include "d3d9.h"
#include "../Bus.h"
#include "../Networking.h"

class TurnByTurn
{
        // Change constants under this line to play around with instructions
        // max distance the waypoint needs to be from the vehicle to count as "reached"
        const float cReachedWaypointThreshold = 0.005f; // 10 meters
        // distance traveled between voice cues
        const float cDistanceBetweenCues = 0.02f; // 40 meters
        // distance to check ahead for direction changes
        const float cDistanceToCheckAhead = 0.8f; 
        // trigger a voice cue if direction change is bigger then this (degrees)
        const float cDirectionChangeThreshold = 30.0f; 
        // distance to to wait after the start of the heading change before we start looking forward again
        const float cWaitDistanceAfterHeadingChangeForNextCheck = -0.006f; // 20 meters after 0
        // Change constants above this line to play around with instructions

        const float sectorSize = 682.666666667f;
        const float mapStartTcpU = 519.0f;
        const float mapStartTcpV = 1101.0f;     

        Bus* bus = nullptr;
        Logger* logger = nullptr;       
        Networking* networking = nullptr;
        LPDIRECT3DVERTEXBUFFER9 m_avRouteMap = nullptr; // For turn-by-turn navigation
        D3DXVECTOR2 vehiclePos;
        D3DXVECTOR2 lastVehiclePos { 0.0f , 0.0f };
        float distanceTraveled = 0.0f;
        float mapMagnifier = 0.0f;
        float elapsedCounter = 0.0f;
        float distanceTraveledAtLastCue = 0.0f;
        float distanceUntilFirstHeadingChange = 0.0f;
        float distanceUntilAfterFirstHeadingChange = 0.0f;
        float firstHeadingChangeDegrees = 0.0f;
        size_t firstHeadingChangeDirection = 0;
        int edgeIdAfterFirstHeadingChange = 0;
        bool nextNodeUpdateSent = false;
        float approachingNodeLastDistanceSent = 0.0f;
        int headingChangeStartWaypointIndex = -1;
        int headingChangeEndWaypointIndex = -1;
        int headingState = 0;

        size_t closestWaypointIndex = 0;
        size_t activeWaypointIndex = 0;
        size_t nextWaypointIndex = 0;
        size_t lineCount = 0;
        
        enum UpdateType
        {
                TYPE_APPROACHING_NEXT_NODE = 0, // so 1 km before at 120, 500 meters before at 60
                TYPE_NEXT_NODE = 1,
                TYPE_CONTINUE_TO_NEXT_NODE = 2,
                TYPE_RECALCULATING = 4,
                TYPE_NAVIGATION_COMPLETED = 5
        };

        enum Direction
        {
                // direction enumeration (like 0 is straight, 1 is bear left, 2 is turn left, 3 is bear right, 4 is turn right, 5 is u-turn) ...
                STRAIGHT = 0,
                BEAR_LEFT = 1,
                TURN_LEFT = 2,
                BEAR_RIGHT = 3,
                TURN_RIGHT = 4,
                U_TURN = 5
        };

        enum State
        {
                APPROACHING_HEADING_CHANGE = 1,
                IN_HEADING_CHANGE = 2,
                COMPLETED_HEADING_CHANGE = 3,
        };

        D3DXVECTOR2 convertWorldPositionToMapPosition(const D3DXVECTOR2 &pos);
        void sendUpdateToServer(int pEdgeId, float pDistance, size_t pDirection, size_t pType);
        float angleBetweenPositionsDeg(const D3DXVECTOR2& vectorA, const D3DXVECTOR2& vectorB);
        float distanceBetweenPositions(const D3DXVECTOR2& vectorA, const D3DXVECTOR2& vectorB);
        float convertDistanceToMeters(float dist);
        float vectorToDegrees(const D3DXVECTOR2& vec);
        float getHeadingChange(float targetHeading, float currentHeading);
        float customModulo(float a, float n);
        void checkForCue();
        void updateHeadingState();
public:
        TurnByTurn(Bus* pBus, Logger* pLoggger, Networking* pNetworking);
        ~TurnByTurn();
        void Update(bool pIsGrndVehicle, float pElasedTime);
        void Draw(IDirect3DDevice9* pd3dDevice);
        void UpdateVB(IDirect3DDevice9* pd3dDevice);
        void CreateVB(IDirect3DDevice9* pd3dDevice);
        void LookAhead();
        void ReleaseResources();
};