X-Git-Url: http://git.tdb.fi/?p=libs%2Fvr.git;a=blobdiff_plain;f=source%2Fheadtrackingcamera.cpp;h=9f4dd5c16768471c33e1a926f205021df50a3224;hp=95868e2f12f107a512dda7d39e1dca0dc8fdce14;hb=80785cc981166c5faacfcc41476b3d2ffdb65c4a;hpb=dca13ee66628568631f502dfc79847c7368c7bb1

diff --git a/source/headtrackingcamera.cpp b/source/headtrackingcamera.cpp
index 95868e2..9f4dd5c 100644
--- a/source/headtrackingcamera.cpp
+++ b/source/headtrackingcamera.cpp
@@ -4,12 +4,27 @@ namespace Msp {
 namespace VR {
 
 HeadTrackingCamera::HeadTrackingCamera(const GL::Camera &c):
-	base_camera(c)
+	base_camera(c),
+	elevation_offset(0)
 { }
 
+void HeadTrackingCamera::set_elevation_offset(float o)
+{
+	elevation_offset = o;
+}
+
 void HeadTrackingCamera::update_from_matrix(const GL::Matrix &hmd_matrix)
 {
-	GL::Matrix matrix = base_camera.get_object_matrix()*hmd_matrix;
+	const GL::Vector3 &up = base_camera.get_up_direction();
+	GL::Vector3 right = normalize(cross(base_camera.get_look_direction(), up));
+	GL::Vector4 columns[4];
+	columns[0] = compose(right, 0.0f);
+	columns[1] = compose(up, 0.0f);
+	columns[2] = compose(cross(right, up), 0.0f);
+	columns[3] = compose(base_camera.get_position()+base_camera.get_up_direction()*elevation_offset, 1.0f);
+	base_matrix = GL::Matrix::from_columns(columns);
+
+	GL::Matrix matrix = base_matrix*hmd_matrix;
 
 	set_position(matrix*GL::Vector3());
 	set_look_direction((matrix*GL::Vector4(0, 0, -1, 0)).slice<3>(0));