nearestborderhalfedgefromposquerydisplaylistbuilder.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/visualsystem/displaylist.h"
#include "gwnavruntime/queries/blobs/nearestborderhalfedgefromposqueryblob.h"
#include "gwnavruntime/queries/nearestborderhalfedgefromposquery.h"
#include "gwnavruntime/queries/blobs/querydynamicoutputdisplaylistbuilder.h"

namespace Kaim
{

class NearestBorderHalfEdgeFromPosQueryDisplayListBuilder : public IDisplayListBuilder
{
private:
    void DrawSearchBox(const NearestBorderHalfEdgeFromPosQueryBlob* queryBlob, const Color& color, DisplayList* displayList)
    {
        Vec3f boxMax(queryBlob->m_inputPos3f);
        Vec3f boxMin(queryBlob->m_inputPos3f);
        boxMin.x -= queryBlob->m_horizontalTolerance;
        boxMin.y -= queryBlob->m_horizontalTolerance;
        boxMin.z -= queryBlob->m_positionSpatializationRange.m_rangeBelowPosition;

        boxMax.x += queryBlob->m_horizontalTolerance;
        boxMax.y += queryBlob->m_horizontalTolerance;
        boxMax.z += queryBlob->m_positionSpatializationRange.m_rangeAbovePosition;

        ShapeColor shapeColor;
        shapeColor.m_lineColor = color;
        displayList->PushBox(Box3f(boxMin, boxMax), shapeColor);
    }

    virtual void DoBuild(DisplayList* displayList, char* blob)
    {
        const NearestBorderHalfEdgeFromPosQueryBlob* query = (NearestBorderHalfEdgeFromPosQueryBlob*) blob;
        NearestBorderHalfEdgeFromPosQueryOutputBlob* output = query->m_queryOutput.Ptr();
        if (output == nullptr)
            return;

        const KyFloat32 flagRadius = 0.3f;

        switch ((NearestBorderHalfEdgeFromPosQueryResult)output->m_result)
        {
        case NEARESTHALFEDGE_NOT_INITIALIZED: break;
        case NEARESTHALFEDGE_NOT_PROCESSED:
        {
            displayList->PushPoint(query->m_inputPos3f, flagRadius, Color::Orange);
            DrawSearchBox(query, Color::Orange, displayList);
        }
        break;
        case NEARESTHALFEDGE_HALFEDGE_NOT_FOUND:
        {
            DrawSearchBox(query, Color::Red, displayList);
        }
        break;
        case NEARESTHALFEDGE_DONE_LACK_OF_WORKING_MEMORY:
        {
            displayList->PushText(query->m_inputPos3f.OffsetZ(1.0f), Color::Red, "Lack of memory");
            DrawSearchBox(query, Color::Red, displayList);
        }
        break;
        case NEARESTHALFEDGE_HALFEDGE_FOUND:
        {
            DrawSearchBox(query, Color::LightGreen, displayList);

            Color nearest_color = Color::Green;
            Color side_color = Color::Orange;

            const Vec3f& start       = output->m_nearestHalfEdgeOnBorder.m_startPos3f;
            const Vec3f& end         = output->m_nearestHalfEdgeOnBorder.m_endPos3f;

            const Vec3f& prev_start  = output->m_prevHalfEdgeOnBorder.m_startPos3f;
            const Vec3f& prev_end    = output->m_prevHalfEdgeOnBorder.m_endPos3f;
            const Vec3f& prev_middle = (prev_start + prev_end) * 0.5f;

            const Vec3f& next_start  = output->m_nextHalfEdgeOnBorder.m_startPos3f;
            const Vec3f& next_end    = output->m_nextHalfEdgeOnBorder.m_endPos3f;
            const Vec3f& next_middle = (next_start + next_end) * 0.5f;

            // nearest
            displayList->PushPoint(output->m_nearestPosOnHalfEdge, flagRadius, nearest_color);

            displayList->PushArrow2d5(query->m_inputPos3f, output->m_nearestPosOnHalfEdge, nearest_color);
            displayList->PushText(output->m_nearestPosOnHalfEdge.OffsetZ(1.0f), nearest_color, "Nearest half edge");
            displayList->PushLine(start, end, nearest_color);

            // side
            displayList->PushLine(prev_start, prev_end, side_color);
            displayList->PushArrow2d5(query->m_inputPos3f, prev_middle, side_color);
            displayList->PushText(prev_middle.OffsetZ(1.0f), side_color, "Prev");

            displayList->PushLine(next_start, next_end, side_color);
            displayList->PushArrow2d5(query->m_inputPos3f, next_middle, side_color);
            displayList->PushText(next_middle.OffsetZ(1.0f), side_color, "Next");
        }
        break;
        }
    }
};

}