#ifndef NAVMESHRENDERER_H
#define NAVMESHRENDERER_H



#include <unordered_set>
#include <Indoor/navMesh/NavMesh.h>
#include <Indoor/navMesh/NavMeshTriangle.h>
#include <Indoor/navMesh/NavMeshType.h>

#include <QPainter>
#include <QGLWidget>

//enum class GridRendererColorMode {
//	SHOW_NODE_TYPE,
//	SHOW_NODE_IMPORTANCE,
//};

class NavMeshRenderer {

private:

	// settings
	//GridRendererColorMode colorMode = GridRendererColorMode::SHOW_NODE_IMPORTANCE;
	bool showEdges = false;

	struct Color {
		float r,g,b;
		Color() : r(1), g(0), b(0) {;}
		Color(float r, float g, float b) : r(r), g(g), b(b) {;}
	};

	/** node color depending on the node's type. see ctor */
	Color colors[200];

public:

	/** ctor */
	NavMeshRenderer()  {

		colors[GridNode::TYPE_FLOOR] = Color(0.4, 0.4, 0.4);
		colors[GridNode::TYPE_STAIR] = Color(0,0,1);
		colors[GridNode::TYPE_ELEVATOR] = Color(0,0,1);
		colors[GridNode::TYPE_DOOR] = Color(0.0, 0.0, 0.0);

		colors[GridNode::TYPE_OUTDOOR] = Color(0.0, 0.5, 0.0);

	}


//	void setNodeColorMode(const GridRendererColorMode mode) {this->colorMode = mode;}
	void setShowEdges(const bool show) {this->showEdges = show;}


	/** render the given grid using GL commands */
	void paintGL(NM::NavMesh<NM::NavMeshTriangle>* navMesh, QGLWidget* dst) {

		if (navMesh == nullptr) {return;}

//		QPainter qp;
//		qp.begin(dst);

		glDisable(GL_LIGHTING);

		const float s = 2;



		glBegin(GL_TRIANGLES);
			for (const NM::NavMeshTriangle* tria : *navMesh) {

//				// get the color to use
//				switch(colorMode) {
//				case GridRendererColorMode::SHOW_NODE_TYPE: {
//					const Color c = colors[n.getType()];
//					glColor3f(c.r, c.g, c.b);
//					break;
//				}

//				case GridRendererColorMode::SHOW_NODE_IMPORTANCE: {
//					const float xx = n.navImportance - 0.6;
//					glColor3f(xx, xx, xx);
//					break;
//				}

//				}

				switch (tria->getType()) {
					case (int) NM::NavMeshType::FLOOR_INDOOR:	glColor3f(0.8, 0.8, 0.8); break;
					case (int) NM::NavMeshType::FLOOR_OUTDOOR:	glColor3f(0.1, 0.8, 0.1); break;
					case (int) NM::NavMeshType::DOOR:			glColor3f(0.7, 0.7, 0.8); break;
					case (int) NM::NavMeshType::STAIR_LEVELED:	glColor3f(0.5, 0.5, 0.5); break;
					case (int) NM::NavMeshType::STAIR_SKEWED:	glColor3f(0.6, 0.6, 0.6); break;
				}

				glVertex3f(tria->getP1().x, tria->getP1().z, tria->getP1().y);
				glVertex3f(tria->getP2().x, tria->getP2().z, tria->getP2().y);
				glVertex3f(tria->getP3().x, tria->getP3().z, tria->getP3().y);

			}
		glEnd();


		glEnable(GL_MULTISAMPLE);
		//glEnable(GL_LINE_SMOOTH);

		glBegin(GL_LINES);
			//glColor3f(0.2,0.2,0.2);
			for (const NM::NavMeshTriangle* tria : *navMesh) {

				switch (tria->getType()) {
					case (int) NM::NavMeshType::FLOOR_INDOOR:	glColor3f(0.6, 0.6, 0.6); break;
					case (int) NM::NavMeshType::FLOOR_OUTDOOR:	glColor3f(0.0, 0.6, 0.0); break;
					case (int) NM::NavMeshType::DOOR:			glColor3f(0.5, 0.5, 0.6); break;
					case (int) NM::NavMeshType::STAIR_LEVELED:	glColor3f(0.4, 0.4, 0.4); break;
					case (int) NM::NavMeshType::STAIR_SKEWED:	glColor3f(0.4, 0.4, 0.4); break;
				}

				glVertex3f(tria->getP1().x, tria->getP1().z+0.01, tria->getP1().y);
				glVertex3f(tria->getP2().x, tria->getP2().z+0.01, tria->getP2().y);

				glVertex3f(tria->getP2().x, tria->getP2().z+0.01, tria->getP2().y);
				glVertex3f(tria->getP3().x, tria->getP3().z+0.01, tria->getP3().y);

				glVertex3f(tria->getP3().x, tria->getP3().z+0.01, tria->getP3().y);
				glVertex3f(tria->getP1().x, tria->getP1().z+0.01, tria->getP1().y);

//				glBegin(GL_LINE_LOOP);
//				glVertex3f(tria->getP1().x, tria->getP1().z+0.01, tria->getP1().y);
//				glVertex3f(tria->getP2().x, tria->getP2().z+0.01, tria->getP2().y);
//				glVertex3f(tria->getP3().x, tria->getP3().z+0.01, tria->getP3().y);
//				glEnd();
			}

		glEnd();

		glEnable(GL_LIGHTING);


//		qp.drawText(20,20, "sdfsdkflsdfjasfklsdklfsdklfsdf");
//		qp.drawText(20,-20, "sdfsdkflsdfjasfklsdklfsdklfsdf");
//		qp.drawText(0.5,0.5, "sdfsdkflsdfjasfklsdklfsdklfsdf");
//		qp.end();

//		renderText(1,1,1, "123");

		const QString str1 = "Triangles: " + QString::number(navMesh->getNumTriangles());
		const QString str2 = "Size:      ~" + QString::number(navMesh->getNumTriangles() * sizeof(NM::NavMeshTriangle) / 1024) + " kB";

		glColor3f(0.0, 0.0, 0.0);
		dst->renderText(20,20, str1);
		dst->renderText(20,35, str2);

	//	dst->renderText(0,0, "2342342342342423423423423423423432");
	//	dst->renderText(0.1, 0.1, 0.1, "lsdfsdfsdfsdfsdfsdfsdfol");
	}

//	std::vector<MyNode> lint() {
//		std::vector<MyNode> vec;
//		lintStair(vec);
//		return vec;
//	}

//	void lintStair(std::vector<MyNode>& vec) {
//		for (MyNode& n1 : *grid) {
//			if (n1.getNumNeighbors() <= 5) { vec.push_back(n1);}
//		}
//	}

};

#endif // NAVMESHRENDERER_H