diskexpansionquerydisplaylistbuilder.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/diskexpansionqueryblob.h"
#include "gwnavruntime/queries/diskexpansionquery.h"
#include "gwnavruntime/queries/blobs/querydynamicoutputdisplaylistbuilder.h"

namespace Kaim
{

class DiskExpansionQueryDisplayListBuilder : public IDisplayListBuilder
{
private:
    virtual void DoBuild(DisplayList* displayList, char* blob)
    {
        const DiskExpansionQueryBlob* queryBlob = (DiskExpansionQueryBlob*) blob;
        KyFloat32 triangleZOffset = 0.1f;

        DiskExpansionQueryOutputBlob* queryOutputBlob = queryBlob->m_queryOutput.Ptr();
        if (queryOutputBlob == nullptr)
            return;

        Vec3f offsetVector = Vec3f::UnitZ();

        switch ((DiskExpansionQueryResult)queryOutputBlob->m_result)
        {
            case DISKEXPANSION_NOT_INITIALIZED: break;
            case DISKEXPANSION_NOT_PROCESSED:
                {
                    displayList->PushDisk(queryBlob->m_centerPos3f, queryBlob->m_radiusMax, Color::Orange);
                }
                break;
            case DISKEXPANSION_DONE_CENTER_OUTSIDE:
                {
                    displayList->PushText(queryBlob->m_centerPos3f + offsetVector, Color::Red, "Center outside!");
                    displayList->PushDisk(queryBlob->m_centerPos3f, queryBlob->m_radiusMax, Color::Red);
                }
                break;
            case DISKEXPANSION_DONE_CENTER_NAVTAG_FORBIDDEN:
                {
                    Triangle3f triangle = queryOutputBlob->m_centerTriangle.m_triangle;

                    triangle.A.z += triangleZOffset;
                    triangle.B.z += triangleZOffset;
                    triangle.C.z += triangleZOffset;
                    displayList->PushTriangle(triangle, Color::Red);

                    displayList->PushDisk(queryBlob->m_centerPos3f, queryBlob->m_radiusMax, Color::Red);
                    displayList->PushText(queryBlob->m_centerPos3f + offsetVector, Color::Red, "Center NavTag forbidden!");
                }
                break;
            case DISKEXPANSION_DONE_CANNOT_EXPAND:
                {
                    Triangle3f triangle = queryOutputBlob->m_centerTriangle.m_triangle;

                    triangle.A.z += triangleZOffset;
                    triangle.B.z += triangleZOffset;
                    triangle.C.z += triangleZOffset;
                    displayList->PushTriangle(triangle, Color::Green);

                    displayList->PushDisk(queryBlob->m_centerPos3f, queryBlob->m_radiusMax, Color::Red);
                    displayList->PushText(queryBlob->m_centerPos3f + offsetVector, Color::Red, "Cannot expand!");

                }
                break;
            case DISKEXPANSION_DONE_LACK_OF_WORKING_MEMORY:
                {
                    Triangle3f triangle = queryOutputBlob->m_centerTriangle.m_triangle;

                    triangle.A.z += triangleZOffset;
                    triangle.B.z += triangleZOffset;
                    triangle.C.z += triangleZOffset;
                    displayList->PushTriangle(triangle, Color::Green);


                    displayList->PushDisk(queryBlob->m_centerPos3f, queryBlob->m_radiusMax, Color::Red);
                    displayList->PushText(queryBlob->m_centerPos3f + offsetVector, Color::Red, "Lack of working memory!");

                }
                break;
            case DISKEXPANSION_DONE_UNKNOWN_ERROR:
                {

                    displayList->PushText(queryBlob->m_centerPos3f + offsetVector, Color::Red, "Unknown error!");
                    displayList->PushDisk(queryBlob->m_centerPos3f, queryBlob->m_radiusMax, Color::Red);
                }
                break;
            case DISKEXPANSION_DONE_DISK_FIT:
                {
                    Triangle3f triangle = queryOutputBlob->m_centerTriangle.m_triangle;
                    triangle.A.z += triangleZOffset;
                    triangle.B.z += triangleZOffset;
                    triangle.C.z += triangleZOffset;
                    displayList->PushTriangle(triangle, Color::Green);
                    displayList->PushDisk(queryBlob->m_centerPos3f, queryOutputBlob->m_resultRadius, Color::Green);
                }
                break;
            case DISKEXPANSION_DONE_COLLISION_FOUND:
                {
                    Triangle3f triangle = queryOutputBlob->m_centerTriangle.m_triangle;

                    triangle.A.z += triangleZOffset;
                    triangle.B.z += triangleZOffset;
                    triangle.C.z += triangleZOffset;
                    displayList->PushTriangle(triangle, Color::Green);

                    displayList->PushDisk(queryBlob->m_centerPos3f, queryOutputBlob->m_resultRadius, Color::Orange);
                    displayList->PushLine(queryOutputBlob->m_collisionPos3f, queryOutputBlob->m_collisionPos3f + offsetVector, Color::Orange);
                    displayList->PushText(queryOutputBlob->m_collisionPos3f + offsetVector, Color::Orange, "Collision point");
                }
                break;
        }

        QueryDynamicOutputBlob* queryDynamicOutputBlob = queryOutputBlob->m_queryDynamicOutputBlobRef.Ptr();
        if (queryDynamicOutputBlob != NULL)
        {
            QueryDynamicOutputDisplayListBuilder dynamicOutputDLBuilder;
            dynamicOutputDLBuilder.Build(displayList, (char*)queryDynamicOutputBlob, 0);
        }
    }
};

}