nuclear@0: #include "opengl.h"
nuclear@0: #include "camera.h"
nuclear@0: //#include "unistate.h"
nuclear@0: #include "vr.h"
nuclear@0: 
nuclear@0: using namespace goatgfx;
nuclear@0: 
nuclear@0: Camera::Camera()
nuclear@0: {
nuclear@0: 	roll = 0.0;
nuclear@0: 	inval_cache();
nuclear@0: }
nuclear@0: 
nuclear@0: Camera::~Camera()
nuclear@0: {
nuclear@0: }
nuclear@0: 
nuclear@0: void Camera::calc_inv_matrix(Matrix4x4 *mat) const
nuclear@0: {
nuclear@0: 	*mat = matrix().inverse();
nuclear@0: }
nuclear@0: 
nuclear@0: const Matrix4x4 &Camera::matrix() const
nuclear@0: {
nuclear@0: 	if(!mcache.valid) {
nuclear@0: 		calc_matrix(&mcache.mat);
nuclear@0: 		mcache.valid = true;
nuclear@0: 	}
nuclear@0: 	return mcache.mat;
nuclear@0: }
nuclear@0: 
nuclear@0: const Matrix4x4 &Camera::inv_matrix() const
nuclear@0: {
nuclear@0: 	if(!mcache_inv.valid) {
nuclear@0: 		calc_inv_matrix(&mcache_inv.mat);
nuclear@0: 		mcache_inv.valid = true;
nuclear@0: 	}
nuclear@0: 	return mcache_inv.mat;
nuclear@0: }
nuclear@0: 
nuclear@0: void Camera::use() const
nuclear@0: {
nuclear@0: 	//set_view_matrix(matrix());
nuclear@0: 	mult_matrix(matrix());
nuclear@0: }
nuclear@0: 
nuclear@0: void Camera::use_inverse() const
nuclear@0: {
nuclear@0: 	//set_view_matrix(inv_matrix());
nuclear@0: 	mult_matrix(inv_matrix());
nuclear@0: }
nuclear@0: 
nuclear@0: void Camera::input_move(float x, float y, float z)
nuclear@0: {
nuclear@0: }
nuclear@0: 
nuclear@0: void Camera::input_rotate(float x, float y, float z)
nuclear@0: {
nuclear@0: }
nuclear@0: 
nuclear@0: void Camera::input_zoom(float factor)
nuclear@0: {
nuclear@0: }
nuclear@0: 
nuclear@0: 
nuclear@0: // ---- orbit camera ----
nuclear@0: 
nuclear@0: OrbitCamera::OrbitCamera()
nuclear@0: {
nuclear@0: 	theta = 0.0;
nuclear@0: 	phi = 0.0;
nuclear@0: 	rad = 10.0;
nuclear@0: }
nuclear@0: 
nuclear@0: OrbitCamera::~OrbitCamera()
nuclear@0: {
nuclear@0: }
nuclear@0: 
nuclear@0: void OrbitCamera::calc_matrix(Matrix4x4 *mat) const
nuclear@0: {
nuclear@0: 	mat->reset_identity();
nuclear@0: 	mat->translate(Vector3(0, 0, -rad));
nuclear@0: 	mat->rotate(Vector3(phi, 0, 0));
nuclear@0: 	mat->rotate(Vector3(0, theta, 0));
nuclear@0: 	mat->rotate(Vector3(0, 0, roll));
nuclear@0: }
nuclear@0: 
nuclear@0: void OrbitCamera::calc_inv_matrix(Matrix4x4 *mat) const
nuclear@0: {
nuclear@0: 	mat->reset_identity();
nuclear@0: 	mat->rotate(Vector3(0, 0, roll));
nuclear@0: 	mat->rotate(Vector3(0, theta, 0));
nuclear@0: 	mat->rotate(Vector3(phi, 0, 0));
nuclear@0: 	mat->translate(Vector3(0, 0, -rad));
nuclear@0: }
nuclear@0: 
nuclear@0: void OrbitCamera::input_rotate(float x, float y, float z)
nuclear@0: {
nuclear@0: 	theta += y;
nuclear@0: 	phi += x;
nuclear@0: 	roll += z;
nuclear@0: 
nuclear@0: 	if(phi < -M_PI / 2)
nuclear@0: 		phi = -M_PI / 2;
nuclear@0: 	if(phi > M_PI)
nuclear@0: 		phi = M_PI;
nuclear@0: 
nuclear@0: 	inval_cache();
nuclear@0: }
nuclear@0: 
nuclear@0: void OrbitCamera::input_zoom(float factor)
nuclear@0: {
nuclear@0: 	rad += factor;
nuclear@0: 	if(rad < 0.0)
nuclear@0: 		rad = 0.0;
nuclear@0: 
nuclear@0: 	inval_cache();
nuclear@0: }
nuclear@0: 
nuclear@0: void FpsCamera::calc_matrix(Matrix4x4 *mat) const
nuclear@0: {
nuclear@0: 	mat->reset_identity();
nuclear@0: 	mat->translate(Vector3(pos.x, pos.y, pos.z));
nuclear@0: 	mat->rotate(Vector3(0, theta, 0));
nuclear@0: 	mat->rotate(Vector3(phi, 0, 0));
nuclear@0: 	mat->rotate(Vector3(0, 0, roll));
nuclear@0: }
nuclear@0: 
nuclear@0: void FpsCamera::calc_inv_matrix(Matrix4x4 *mat) const
nuclear@0: {
nuclear@0: 	mat->reset_identity();
nuclear@0: 	mat->rotate(Vector3(0, 0, roll));
nuclear@0: 	mat->rotate(Vector3(phi, 0, 0));
nuclear@0: 	mat->rotate(Vector3(0, theta, 0));
nuclear@0: 	mat->translate(Vector3(-pos.x, -pos.y, -pos.z));
nuclear@0: }
nuclear@0: 
nuclear@0: void FpsCamera::input_move(float x, float y, float z)
nuclear@0: {
nuclear@0: 	pos.x += x * cos(theta) - z * sin(theta);
nuclear@0: 	pos.z += x * sin(theta) + z * cos(theta);
nuclear@0: 	pos.y += y;
nuclear@0: 	inval_cache();
nuclear@0: }
nuclear@0: 
nuclear@0: const Vector3 &FpsCamera::get_position() const
nuclear@0: {
nuclear@0: 	return pos;
nuclear@0: }
nuclear@0: 
nuclear@0: 
nuclear@0: FlyCamera::FlyCamera()
nuclear@0: {
nuclear@0: 	pos.z = 10.0f;
nuclear@0: }
nuclear@0: 
nuclear@0: void FlyCamera::calc_matrix(Matrix4x4 *mat) const
nuclear@0: {
nuclear@0: 	Matrix3x3 rmat = rot.get_rotation_matrix().transposed();
nuclear@0: 	Matrix4x4 tmat;
nuclear@0: 	tmat.set_translation(pos);
nuclear@0: 	*mat = tmat * Matrix4x4(rmat);
nuclear@0: }
nuclear@0: 
nuclear@0: /*void FlyCamera::calc_inv_matrix(Matrix4x4 *mat) const
nuclear@0: {
nuclear@0: }*/
nuclear@0: 
nuclear@0: const Vector3 &FlyCamera::get_position() const
nuclear@0: {
nuclear@0: 	return pos;
nuclear@0: }
nuclear@0: 
nuclear@0: const Quaternion &FlyCamera::get_rotation() const
nuclear@0: {
nuclear@0: 	return rot;
nuclear@0: }
nuclear@0: 
nuclear@0: void FlyCamera::input_move(float x, float y, float z)
nuclear@0: {
nuclear@0: 	static const Vector3 vfwd(0, 0, 1), vright(1, 0, 0);
nuclear@0: 
nuclear@0: 	Vector3 k = vfwd.transformed(rot);
nuclear@0: 	Vector3	i = vright.transformed(rot);
nuclear@0: 	Vector3 j = cross_product(k, i);
nuclear@0: 
nuclear@0: 	pos += i * x + j * y + k * z;
nuclear@0: 	inval_cache();
nuclear@0: }
nuclear@0: 
nuclear@0: void FlyCamera::input_rotate(float x, float y, float z)
nuclear@0: {
nuclear@0: 	Vector3 axis(x, y, z);
nuclear@0: 	float axis_len = axis.length();
nuclear@0: 	rot.rotate(axis / axis_len, axis_len);
nuclear@0: 	rot.normalize();
nuclear@0: 
nuclear@0: 	inval_cache();
nuclear@0: }
nuclear@0: 
nuclear@0: 
nuclear@0: // --- VR additions ---
nuclear@0: VRFpsCamera::VRFpsCamera()
nuclear@0: {
nuclear@0: 	neck_eye_dist = 0.14;	// default neck->eye distance 14cm
nuclear@0: }
nuclear@0: 
nuclear@0: void VRFpsCamera::calc_matrix(Matrix4x4 *mat) const
nuclear@0: {
nuclear@0: 	mat->reset_identity();
nuclear@0: 	mat->translate(Vector3(pos.x, pos.y, pos.z));
nuclear@0: 	mat->rotate(Vector3(0, theta, 0));
nuclear@0: 	mat->rotate(Vector3(phi, 0, 0));
nuclear@0: 	mat->rotate(Vector3(0, 0, roll));
nuclear@0: 	mat->translate(Vector3(0, neck_eye_dist, 0));
nuclear@0: }
nuclear@0: 
nuclear@0: void VRFpsCamera::calc_inv_matrix(Matrix4x4 *mat) const
nuclear@0: {
nuclear@0: 	mat->reset_identity();
nuclear@0: 	mat->translate(Vector3(0, -neck_eye_dist, 0));
nuclear@0: 	mat->rotate(Vector3(0, 0, roll));
nuclear@0: 	mat->rotate(Vector3(phi, 0, 0));
nuclear@0: 	mat->rotate(Vector3(0, theta, 0));
nuclear@0: 	mat->translate(Vector3(-pos.x, -pos.y, -pos.z));
nuclear@0: }
nuclear@0: 
nuclear@0: void VRFpsCamera::track_vr()
nuclear@0: {
nuclear@0: 	float euler[3];
nuclear@0: 	vr_get_rotation_euler(euler);
nuclear@0: 
nuclear@0: 	// input_rotate invalidates cache
nuclear@0: 	input_rotate(prev_angles[0] - euler[0], prev_angles[1] - euler[1], prev_angles[2] - euler[2]);
nuclear@0: 
nuclear@0: 	prev_angles[0] = euler[0];
nuclear@0: 	prev_angles[1] = euler[1];
nuclear@0: 	prev_angles[2] = euler[2];
nuclear@0: }
nuclear@0: