CCamera::CCamera(){
	pos = new D3DXVECTOR3(0.0f, 0.0f, 0.0f);
	up = new D3DXVECTOR3(0.0f, 1.0f, 0.0f);
	forward = new D3DXVECTOR3(0.0f, 0.0f, 1.0f);
	right = new D3DXVECTOR3(1.0f, 0.0f, 0.0f);
	rotation = new D3DXQUATERNION();
	D3DXQuaternionIdentity(rotation);
	viewFrustum = new CFrustum();
}

CCamera::~CCamera(){
	delete pos;
	delete up;
	delete forward;
	delete right;
	delete rotation;
	delete viewFrustum;
}

void CCamera::SetProjection(LPDIRECT3DDEVICE9 device, bool is3D){
	D3DXMATRIX matProj;
	if(is3D){
		D3DXMatrixPerspectiveFovLH( &matProj, D3DX_PI/4, 1.0f, 0.1f, 1000.0f );
	}
	else{
		D3DXMatrixOrthoLH( &matProj, 1024.0f, 768.0f, 0.0f, 1.0f);
	}
	device->SetTransform( D3DTS_PROJECTION, &matProj );
}

void CCamera::SetPosition(float x, float y, float z){
	*pos = D3DXVECTOR3(x, y, z);
}

void CCamera::PositionCamera(LPDIRECT3DDEVICE9 device, bool is3D){
	if(is3D){
		D3DXMATRIX out;
		D3DXVECTOR3 fwdVec;
		D3DXVECTOR3 upVec = D3DXVECTOR3(0.0f, 1.0f, 0.0f);
		fwdVec = *pos + *forward;
		D3DXMatrixLookAtLH(&out, pos, &fwdVec, &upVec);
		device->SetTransform( D3DTS_VIEW, &out );
	}
}

//TEMP functions for testing

void CCamera::MoveForward(DWORD dt){
	*pos += 30.0f*((float)dt/1000.0f)*(*forward);
}
void CCamera::MoveBackward(DWORD dt){
	*pos -= 30.0f*((float)dt/1000.0f)*(*forward);
}
void CCamera::MoveLeft(DWORD dt){
	*pos -= 30.0f*((float)dt/1000.0f)*(*right);
}
void CCamera::MoveRight(DWORD dt){
	*pos += 30.0f*((float)dt/1000.0f)*(*right);
}
void CCamera::MoveUp(DWORD dt){
	*pos += 30.0f*((float)dt/1000.0f)*(*up);
}
void CCamera::MoveDown(DWORD dt){
	*pos -= 30.0f*((float)dt/1000.0f)*(*up);
}

void CCamera::RotateCamera(float yaw, float pitch, float roll){
	static float oldPitch = 0.0f;
	if(yaw != 0.0f || pitch != 0.0f || roll != 0.0f){ 
		D3DXMATRIX newRotMatrix;
		D3DXQUATERNION quat;

		oldPitch += pitch;
		if(oldPitch > DegToRad(90.0f)){
			oldPitch = DegToRad(90.0f);
		}
		else if(oldPitch < -DegToRad(90.0f)){
			oldPitch = -DegToRad(90.0f);
		}
		else{
			D3DXQuaternionRotationYawPitchRoll(&quat, yaw, pitch, roll);
			D3DXQuaternionMultiply(rotation, rotation, &quat);
			D3DXMatrixRotationQuaternion(&newRotMatrix, &quat);
			D3DXVec3TransformCoord(forward, forward, &newRotMatrix);
			D3DXVec3Normalize(forward, forward);
			D3DXVec3TransformCoord(up, up, &newRotMatrix);
			D3DXVec3Normalize(up, up);
			D3DXVec3Cross(right, up, forward);
			D3DXVec3Normalize(right, right);
		}
	}
}