#include "testApp.h"
//texture binding with normalised coords
void bindTexture(ofBaseHasTexture &t) {
    ofTexture &tex = t.getTextureReference();
    tex.bind();

    glMatrixMode(GL_TEXTURE);
    glPushMatrix();
    glLoadIdentity();

    ofTextureData texData = tex.getTextureData();
    if(texData.textureTarget == GL_TEXTURE_RECTANGLE_ARB) {
        glScalef(tex.getWidth(), tex.getHeight(), 1.0f);
    } else {
        glScalef(tex.getWidth() / texData.tex_w, tex.getHeight() / texData.tex_h, 1.0f);
    }

    glMatrixMode(GL_MODELVIEW);
}
void unbindTexture(ofBaseHasTexture &t) {
    t.getTextureReference().unbind();

    glMatrixMode(GL_TEXTURE);
    glPopMatrix();
    glMatrixMode(GL_MODELVIEW);
}
void bindTex(ofTexture &tex) {
    tex.bind();

    glMatrixMode(GL_TEXTURE);
    glPushMatrix();
    glLoadIdentity();

    ofTextureData texData = tex.getTextureData();
    if(texData.textureTarget == GL_TEXTURE_RECTANGLE_ARB) {
        glScalef(tex.getWidth(), tex.getHeight(), 1.0f);
    } else {
        glScalef(tex.getWidth() / texData.tex_w, tex.getHeight() / texData.tex_h, 1.0f);
    }

    glMatrixMode(GL_MODELVIEW);
}
void unbindTex(ofTexture &tex) {
    tex.unbind();

    glMatrixMode(GL_TEXTURE);
    glPopMatrix();
    glMatrixMode(GL_MODELVIEW);
}
//--------------------------------------------------------------
void testApp::setup(){
	recordContext.setup();
	recordDepth.setup(&recordContext);
	recordImage.setup(&recordContext);
	recordUser.setup(&recordContext);
	recordUser.setUseCloudPoints(true);
	recordContext.toggleRegisterViewport();

	guiWin=new guiWindow();
	ofxFenster* win=ofxFensterManager::get()->createFenster(0, 0,  200, 400, OF_WINDOW);
	win->setWindowTitle("config");
	win->addListener(guiWin);
	guiWin->setup();
}

//--------------------------------------------------------------
void testApp::update(){
	recordContext.update();
	recordDepth.update();
	recordImage.update();
	recordUser.update();
}

//--------------------------------------------------------------
void testApp::draw(){
	//cam.begin();
	//bind texture recordImage
	//get point data from recordDepth
	//draw textured polys and allow manipulation
	float cloudWidth=1024.0f;
	float cloudHeight=768.0f;

	ofPushMatrix();
		ofTranslate((1024/2)-(640/2),(768/2)-(480/2),-500);
		//ofRotate(0,0,1,180);
		bindTex(recordImage.getTexture());
		int step = 1;
		
		if (guiWin->drawPoints) {
			// http://stackoverflow.com/questions/1513811/getting-smooth-big-points-in-opengl
			glEnable( GL_POINT_SMOOTH );
		    glEnable( GL_BLEND );
		    glBlendFunc( GL_SRC_ALPHA, GL_ONE_MINUS_SRC_ALPHA );
		    glPointSize( 6.0 );

			glBegin(GL_POINTS);
			glColor3f( 1.0f, 1.0f, 1.0f );

			for(int y = step; y < 480; y += step) {

				for(int x = step; x < 640; x += step) {
					ofPoint pos1 = recordUser.getWorldCoordinateAt(x-step, y-step, 0); //userID);
					ofPoint pos2 = recordUser.getWorldCoordinateAt(x, y-step, 0); //userID);
					ofPoint pos3 = recordUser.getWorldCoordinateAt(x-step, y, 0); //userID);
					ofPoint pos4 = recordUser.getWorldCoordinateAt(x, y, 0); //userID);
					
					if ((guiWin->distMin<pos1.z&&pos1.z<guiWin->distMax)&&
						(guiWin->distMin<pos2.z&&pos2.z<guiWin->distMax)&&
						(guiWin->distMin<pos3.z&&pos3.z<guiWin->distMax)&&
						(guiWin->distMin<pos4.z&&pos4.z<guiWin->distMax)) {
					
						glVertex3f(pos4.x, pos4.y,pos4.z);
					}
				}
				glEnd();
			}
		}
		else {
			for(int y = step; y < 480; y += step) {
				glBegin(GL_QUADS);
				for(int x = step; x < 640; x += step) {
					ofPoint pos1 = recordUser.getWorldCoordinateAt(x-step, y-step, 0); //userID);
					ofPoint pos2 = recordUser.getWorldCoordinateAt(x, y-step, 0); //userID);
					ofPoint pos3 = recordUser.getWorldCoordinateAt(x-step, y, 0); //userID);
					ofPoint pos4 = recordUser.getWorldCoordinateAt(x, y, 0); //userID);
					
					if ((guiWin->distMin<pos1.z&&pos1.z<guiWin->distMax)&&
						(guiWin->distMin<pos2.z&&pos2.z<guiWin->distMax)&&
						(guiWin->distMin<pos3.z&&pos3.z<guiWin->distMax)&&
						(guiWin->distMin<pos4.z&&pos4.z<guiWin->distMax)) {
					
						glTexCoord2f(((float)x-step)/640.0f,((float)y-step)/480.0f);
						glVertex3f(pos1.x, pos1.y,pos1.z);
						glTexCoord2f(((float)x)/640.0f,((float)y-step)/480.0f);
						glVertex3f(pos2.x, pos2.y,pos2.z);
						glTexCoord2f(((float)x)/640.0f,((float)y)/480.0f);
						glVertex3f(pos4.x, pos4.y,pos4.z);
						glTexCoord2f(((float)x-step)/640.0f,((float)y)/480.0f);
						glVertex3f(pos3.x, pos3.y,pos3.z);
					}
				}
				glEnd();
			}

			
		}
	ofPopMatrix();
	
	unbindTex(recordImage.getTexture());
	
	//recordImage.draw(0, 0, ofGetWidth(),ofGetHeight());
	
	//cam.end();
	
	
}

//--------------------------------------------------------------
void testApp::keyPressed(int key){

}

//--------------------------------------------------------------
void testApp::keyReleased(int key){

}

//--------------------------------------------------------------
void testApp::mouseMoved(int x, int y ){

}

//--------------------------------------------------------------
void testApp::mouseDragged(int x, int y, int button){

}

//--------------------------------------------------------------
void testApp::mousePressed(int x, int y, int button){

}

//--------------------------------------------------------------
void testApp::mouseReleased(int x, int y, int button){

}

//--------------------------------------------------------------
void testApp::windowResized(int w, int h){

}

//--------------------------------------------------------------
void testApp::gotMessage(ofMessage msg){

}

//--------------------------------------------------------------
void testApp::dragEvent(ofDragInfo dragInfo){

}