trianglefromposquery.h

Go to the documentation of this file.

/*
* Copyright 2016 Autodesk, Inc. All rights reserved.
* Use of this software is subject to the terms of the Autodesk license agreement and any attachments or Appendices thereto provided at the time of installation or download,
* or which otherwise accompanies this software in either electronic or hard copy form, or which is signed by you and accepted by Autodesk.
*/

#pragma once

#include "gwnavruntime/querysystem/iquery.h"
#include "gwnavruntime/navmesh/worldintegerpos.h"
#include "gwnavruntime/navmesh/identifiers/navtriangleptr.h"
#include "gwnavruntime/database/positionspatializationrange.h"

namespace Kaim
{

class ActiveCell;
class NavCell;
class NavFloorBlob;
template <class T> class WorkingMemArray;

enum TriangleFromPosQueryResult
{
    TRIANGLEFROMPOS_NOT_INITIALIZED = QUERY_NOT_INITIALIZED, 
    TRIANGLEFROMPOS_NOT_PROCESSED   = QUERY_NOT_PROCESSED,   

    TRIANGLEFROMPOS_DONE_NO_TRIANGLE_FOUND,                  
    TRIANGLEFROMPOS_DONE_LACK_OF_WORKING_MEMORY,             

    TRIANGLEFROMPOS_DONE_TRIANGLE_FOUND                      
};

enum TriangleFromPosQueryType
{
    NEARESTTRIANGLE_FIND_NEAREST,       
    NEARESTTRIANGLE_FIND_NEAREST_BELOW, 
    NEARESTTRIANGLE_FIND_NEAREST_ABOVE  
};

class TriangleFromPosQuery : public IAtomicQuery
{
public:
    static  QueryType GetStaticType() { return TypeTriangleFromPos; }
    virtual QueryType GetType() const { return TypeTriangleFromPos; }
    virtual void BuildQueryBlob(BaseBlobHandler* blobHandler);
    virtual void InitFromQueryBlob(World* world, void* blob);
    virtual Ptr<BaseBlobHandler> CreateQueryBlobHandler() { return CreateStaticQueryBlobHandler(); }
    static Ptr<BaseBlobHandler> CreateStaticQueryBlobHandler();

    // ------------------------------ Functions -----------------------------

    TriangleFromPosQuery();
    virtual ~TriangleFromPosQuery() {}

    // ---------------------------------- Functions to set up the query ----------------------------------

    void BindToDatabase(Database* database);

    void Initialize(const Vec3f& pos);

    // ---------------------------------- write accessors for query parameters ----------------------------------

    void SetPositionSpatializationRange(const PositionSpatializationRange& positionSpatializationRange);

    void SetQueryType(TriangleFromPosQueryType queryType);


    // ---------------------------------- Query framework functions ----------------------------------

    virtual void Advance(WorkingMemory* workingMemory);

    void PerformQuery(WorkingMemory* workingMemory = nullptr);

    // ---------------------------------- Accessors ----------------------------------

    TriangleFromPosQueryResult GetResult()                          const;
    const Vec3f&               GetInputPos()                        const;
    const NavTrianglePtr&      GetResultTrianglePtr()               const;
    TriangleFromPosQueryType   GetQueryType()                       const;
    KyFloat32                  GetAltitudeOfProjectionInTriangle()  const;

    const PositionSpatializationRange& GetPositionSpatializationRange() const;

public: // internal
    void SetInputIntegerPos(const WorldIntegerPos& integerPos);
    const WorldIntegerPos& GetInputIntegerPos() const;
    void PerformQueryWithInputCoordPos(WorkingMemory* workingMemory);

private:
    void SetResult(TriangleFromPosQueryResult result);
    void GetNearestTrianglePtrFromPos(WorkingMemory* workingMemory);
    KyResult FilterNavFloorsFromAltitudeRange(WorkingMemArray<NavFloor*>& floorIndicesToTest, ActiveCell& activeCell);
    void ProcessFilteredNavFloors(const WorkingMemArray<NavFloor*>& filteredMetaFloorIndices, const Vec3f& pos3fInCell, KyFloat32 multiplicatorValidyForQueryType);
    void FindTriangleInFloor(const Vec3f& posInCell, NavFloor* navFloor, const NavFloorBlob* floorBlob, bool& triangleFound, KyFloat32& minDist,
                             KyFloat32 multiplicatorValidyForQueryType);

private:
    WorldIntegerPos m_inputIntegerPos;

    Vec3f m_inputPos3f; 

    PositionSpatializationRange m_positionSpatializationRange; 

    TriangleFromPosQueryType m_queryType;

    NavTrianglePtr m_resultTrianglePtr;

    KyFloat32 m_altitudeInTriangle;

    TriangleFromPosQueryResult m_result; 
};

}

#include "gwnavruntime/queries/trianglefromposquery.inl"