trianglestatusingrid.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/workingmemcontainers/statusingridbase.h"
#include "gwnavruntime/database/activedata.h"
#include "gwnavruntime/queries/utils/navmeshtraversalcommon.h"
#include "gwnavruntime/navmesh/navmeshtypes.h"

namespace Kaim
{

class TriangleStatusInGrid
{
    // NavCell -> NavFloor -> 1 bit per Triangle
    typedef BitFieldInBuffer FloorBits;
    typedef ArrayInBuffer<FloorBits> CellBits;

public:
    TriangleStatusInGrid(WorkingMemory* workingMemory, const CellBox& cellBox) : m_allocBuffer(workingMemory), m_cellBox(cellBox)
    {
        MakeEmpty();
    }

    void MakeEmpty();

    // CellBits
    CellBits* AllocCellBitsArray(KyUInt32 numberOfNavCell)
    {
        CellBits* ptr = m_allocBuffer.AllocInBuffer<CellBits>(numberOfNavCell, 0xFF);
        m_cellBitsArrayOffset = m_allocBuffer.GetOffset(ptr);
        return ptr;
    }
    CellBits* GetCellBitsArray() const { return m_allocBuffer.GetPtr<CellBits>(m_cellBitsArrayOffset); }
    CellBits* GetCellBits(const CellPos& cellPos) const { return GetCellBitsArray() + m_cellBox.GetRowMajorIndex(cellPos); }

    // CellBits -> FloorBits
    FloorBits* AllocFloorBitsArray(KyUInt32 numberOfFloors) { return m_allocBuffer.AllocInBuffer<FloorBits>(numberOfFloors, 0xFF); }

    TraversalResult OpenNodeIfNew(ActiveData& activeData, const NavTriangleRawPtr& triangleRawPtr, bool& nodeWasNew);

    bool IsTriangleOpen(const NavTriangleRawPtr& triangleRawPtr) const;
    bool IsTriangleOpen_Unsafe(const NavTriangleRawPtr& triangleRawPtr) const;

    bool IsInitialized() const { return m_allocBuffer.IsInitialized(); }

    void ReleaseWorkingMemoryBuffer() { m_allocBuffer.ReleaseWorkingMemoryBuffer(); }

public:
    AllocatorBuffer m_allocBuffer;
    CellBox m_cellBox;
    KyUInt32 m_cellBitsArrayOffset;
};

KY_INLINE bool TriangleStatusInGrid::IsTriangleOpen_Unsafe(const NavTriangleRawPtr& triangleRawPtr) const
{
    KY_DEBUG_ASSERTN(m_cellBox.DoesContain(triangleRawPtr.GetCellPos()), ("Invalid CellBox"));

    NavFloor* navFloor = triangleRawPtr.GetNavFloor();
    const CellPos& cellPos = navFloor->GetCellPos();

    CellBits* cellBits = GetCellBits(cellPos);
    KY_DEBUG_ASSERTN(cellBits->IsValid(), ("Unsafe mode, it should never happen"));

    FloorBits* floorBits = cellBits->Get(navFloor->GetIndexInCollection());
    KY_DEBUG_ASSERTN(floorBits->IsValid(), ("Unsafe mode, it should never happen"));

    return floorBits->IsBitSet(triangleRawPtr.GetTriangleIdx());
}

}