1 files changed, 45 insertions, 10 deletions
diff --git a/ftnoir_tracker_pt/ftnoir_tracker_pt.cpp b/ftnoir_tracker_pt/ftnoir_tracker_pt.cpp
index e10cfea0..9cfd31eb 100644
--- a/ftnoir_tracker_pt/ftnoir_tracker_pt.cpp
+++ b/ftnoir_tracker_pt/ftnoir_tracker_pt.cpp
@@ -50,14 +50,27 @@ void Tracker_PT::reset_command(Command command)
 
 bool Tracker_PT::get_focal_length(float& ret)
 {
+    static constexpr float pi = 3.1415926;
+    float fov_;
+    switch (s.fov)
+    {
+    default:
+    case 0:
+        fov_ = 56;
+        break;
+    case 1:
+        fov_ = 75;
+        break;
+    }
+
+    const float diag_fov = static_cast<int>(fov_) * pi / 180.f;
     QMutexLocker l(&camera_mtx);
     CamInfo info;
     const bool res = camera.get_info(info);
     if (res)
     {
-        static constexpr double pi = 3.14159265359;
         const int w = info.res_x, h = info.res_y;
-        const double diag = sqrt(w * w + h * h)/w, diag_fov = static_cast<int>(s.fov) * pi / 180.;
+        const double diag = sqrt(w * w + h * h)/w;
         const double fov = 2.*atan(tan(diag_fov/2.0)/sqrt(1. + diag*diag));
         ret = .5 / tan(.5 * fov);
         return true;
@@ -149,10 +162,36 @@ void Tracker_PT::apply_settings()
 {
     qDebug()<<"Tracker:: Applying settings";
     QMutexLocker l(&camera_mtx);
-    camera.stop();
-    camera.set_device_index(camera_name_to_index(s.camera_name));
-    camera.set_res(s.cam_res_x, s.cam_res_y);
-    camera.set_fps(s.cam_fps);
+    camera.set_device_index(camera_name_to_index("PS3Eye Camera"));
+    int res_x, res_y, cam_fps;
+    switch (s.camera_mode)
+    {
+    default:
+    case 0:
+        res_x = 640;
+        res_y = 480;
+        cam_fps = 75;
+        break;
+    case 1:
+        res_x = 640;
+        res_y = 480;
+        cam_fps = 60;
+        break;
+    case 2:
+        res_x = 320;
+        res_y = 240;
+        cam_fps = 189;
+        break;
+    case 3:
+        res_x = 320;
+        res_y = 240;
+        cam_fps = 120;
+        break;
+    }
+
+    camera.set_res(res_x, res_y);
+    camera.set_fps(cam_fps);
+    qDebug() << "camera start";
     camera.start();
     qDebug()<<"Tracker::apply ends";
 }
@@ -206,7 +245,3 @@ void Tracker_PT::data(double *data)
         data[TZ] = t[2] / 10.0;
     }
 }
-
-#include "ftnoir_tracker_pt_dialog.h"
-OPENTRACK_DECLARE_TRACKER(Tracker_PT, TrackerDialog_PT, TrackerDll)
-