Moving head pose trials to the new interface

.gitignore

@@ -87,3 +87,4 @@ matlab_runners/Demos/processed_features/
 exe/releases/OpenFace_0.3.0_win_x64/
 exe/releases/OpenFace_0.3.0_win_x86/
 lib/3rdParty/CameraEnumerator/x64/
+lib/local/Utilities/Debug/

gui/HeadPose-live/MainWindow.xaml.cs

@@ -36,20 +36,12 @@ using System;
 using System.Collections.Generic;
 using System.Diagnostics;
 using System.Drawing.Imaging;
-using System.Linq;
 using System.Text;
 using System.Threading;
 using System.Threading.Tasks;
 using System.Windows;
 using System.Windows.Controls;
-using System.Windows.Data;
-using System.Windows.Documents;
-using System.Windows.Input;
-using System.Windows.Media;
 using System.Windows.Media.Imaging;
-using System.Windows.Navigation;
-using System.Windows.Shapes;
-using Microsoft.Win32;
 
 using OpenCVWrappers;
 using CppInterop;
@@ -103,11 +95,9 @@ namespace HeadPoseLive
         OpenFaceOffline.OverlayImage webcam_img;
 
         // Some members for displaying the results
-        private CameraInterop.Capture capture;
         private WriteableBitmap latest_img;
 
         // For tracking
-        double fx = 500, fy = 500, cx = 0, cy = 0;
         bool reset = false;
 
         // For recording
@@ -230,7 +220,7 @@ namespace HeadPoseLive
             logoLabel.Source = src;
 
             // First make the user chooose a webcam
-            OpenFaceDemo.CameraSelection cam_select = new OpenFaceDemo.CameraSelection();
+            OpenFaceOffline.CameraSelection cam_select = new OpenFaceOffline.CameraSelection();
             cam_select.Icon = BitmapFrame.Create(iconUri);
 
             if (!cam_select.no_cameras_found)
@@ -246,19 +236,9 @@ namespace HeadPoseLive
                 img_width = cam_select.selected_camera.Item2;
                 img_height = cam_select.selected_camera.Item3;
 
-                capture = new CameraInterop.Capture(cam_id, img_width, img_height);
+                UtilitiesOF.SequenceReader reader = new UtilitiesOF.SequenceReader(cam_id, img_width, img_height);
                 
-                // Set appropriate fx and cx values
+                if (reader.IsOpened())
-                fx = fx * (img_width / 640.0);
-                fy = fy * (img_height / 480.0);
-
-                fx = (fx + fy) / 2.0;
-                fy = fx;
-
-                cx = img_width / 2.0;
-                cy = img_height / 2.0;
-
-                if (capture.isOpened())
                 {
 
                     // Create the ZeroMQ context for broadcasting the results
@@ -268,8 +248,8 @@ namespace HeadPoseLive
                     // Bind on localhost port 5000
                     zero_mq_socket.Bind("tcp://127.0.0.1:5000");
 
-                    // Start the tracking now
+                    processing_thread = new Thread(() => VideoLoop(reader));
-                    processing_thread = new Thread(VideoLoop);
+                    processing_thread.Name = "Webcam processing";
                     processing_thread.Start();
                 }
                 else
@@ -385,7 +365,7 @@ namespace HeadPoseLive
         }
 
         // Capturing and processing the video frame by frame
-        private void VideoLoop()
+        private void VideoLoop(UtilitiesOF.SequenceReader reader)
         {
             Thread.CurrentThread.IsBackground = true;
 
@@ -406,24 +386,17 @@ namespace HeadPoseLive
                 //////////////////////////////////////////////
 
                 RawImage frame = null;
-                try
+                frame = reader.GetNextImage();
-                {
-                    frame = capture.GetNextFrame(mirror_image);
-                }
-                catch (CameraInterop.CaptureFailedException)
-                {
-                    break;
-                }
 
                 lastFrameTime = CurrentTime;
                 processing_fps.AddFrame();
 
-                var grayFrame = capture.GetCurrentFrameGray();
+                var grayFrame = reader.GetCurrentFrameGray();
 
                 if (grayFrame == null)
                     continue;
 
-                bool detectionSucceeding = ProcessFrame(face_model, gaze_analyser, model_params, frame, grayFrame, fx, fy, cx, cy);
+                bool detectionSucceeding = ProcessFrame(face_model, gaze_analyser, model_params, frame, grayFrame, reader.GetFx(), reader.GetFy(), reader.GetCx(), reader.GetCy());
 
                 lock (recording_lock)
                 {
@@ -432,7 +405,7 @@ namespace HeadPoseLive
                     {
                         // Add objects to recording queues
                         List<double> pose = new List<double>();
-                        face_model.GetPose(pose, fx, fy, cx, cy);
+                        face_model.GetPose(pose, reader.GetFx(), reader.GetFy(), reader.GetCx(), reader.GetCy());
                         RawImage image = new RawImage(frame);
                         recording_objects.Enqueue(new Tuple<RawImage, bool, List<double>>(image, detectionSucceeding, pose));
 
@@ -457,10 +430,10 @@ namespace HeadPoseLive
 
                     scale = face_model.GetRigidParams()[0];
 
-                    gaze_lines = gaze_analyser.CalculateGazeLines(scale, (float)fx, (float)fy, (float)cx, (float)cy);
+                    gaze_lines = gaze_analyser.CalculateGazeLines(scale, reader.GetFx(), reader.GetFy(), reader.GetCx(), reader.GetCy());
                     gaze_angle = gaze_analyser.GetGazeAngle();
 
-                    lines = face_model.CalculateBox((float)fx, (float)fy, (float)cx, (float)cy);
+                    lines = face_model.CalculateBox(reader.GetFx(), reader.GetFy(), reader.GetCx(), reader.GetCy());
                 }
 
                 if (reset)
@@ -478,7 +451,7 @@ namespace HeadPoseLive
                             latest_img = frame.CreateWriteableBitmap();
 
                         List<double> pose = new List<double>();
-                        face_model.GetPose(pose, fx, fy, cx, cy);
+                        face_model.GetPose(pose, reader.GetFx(), reader.GetFy(), reader.GetCx(), reader.GetCy());
 
                         int yaw = (int)(pose[4] * 180 / Math.PI + 0.5);
                         int yaw_abs = Math.Abs(yaw);
@@ -537,7 +510,7 @@ namespace HeadPoseLive
                         else
                             PitchLabelGazeDir.Content = "Straight";
 
-                        double confidence = (-face_model.GetConfidence() + 1) / 2.0;
+                        double confidence = face_model.GetConfidence();
 
                         if (confidence < 0)
                             confidence = 0;
@@ -597,6 +570,7 @@ namespace HeadPoseLive
                     break;
                 }
             }
+            reader.Close();
             System.Console.Out.WriteLine("Thread finished");
         }
 
@@ -724,9 +698,6 @@ namespace HeadPoseLive
                 processing_thread.Join();
             }
             
-            if (capture != null)
-                capture.Dispose();
-
         }
 
         private void MorrorButton_Click(object sender, RoutedEventArgs e)

lib/local/CppInerop/OpenCVWrappers.h

@@ -75,11 +75,11 @@ namespace OpenCVWrappers {
 		{
 			if (fmt == PixelFormats::Gray8)
 				return CV_8UC1;
-			else if(fmt == PixelFormats::Bgr24)
+			else if (fmt == PixelFormats::Bgr24)
 				return CV_8UC3;
-			else if(fmt == PixelFormats::Bgra32)
+			else if (fmt == PixelFormats::Bgra32)
 				return CV_8UC4;
-			else if(fmt == PixelFormats::Gray32Float)
+			else if (fmt == PixelFormats::Gray32Float)
 				return CV_32FC1;
 			else
 				throw gcnew System::Exception("Unsupported pixel format");
@@ -227,4 +227,55 @@ namespace OpenCVWrappers {
 
 	};
 
+	public ref class VideoWriter
+	{
+	private:
+		// OpenCV based video capture for reading from files
+		cv::VideoWriter* vc;
+
+	public:
+
+		VideoWriter(System::String^ location, int width, int height, double fps, bool colour)
+		{
+
+			msclr::interop::marshal_context context;
+			std::string location_std_string = context.marshal_as<std::string>(location);
+
+			vc = new cv::VideoWriter(location_std_string, CV_FOURCC('D', 'I', 'V', 'X'), fps, cv::Size(width, height), colour);
+
+		}
+
+		// Return success
+		bool Write(RawImage^ img)
+		{
+			if (vc != nullptr && vc->isOpened())
+			{
+				vc->write(img->Mat);
+				return true;
+			}
+			else
+			{
+				return false;
+			}
+		}
+
+		// Finalizer. Definitely called before Garbage Collection,
+		// but not automatically called on explicit Dispose().
+		// May be called multiple times.
+		!VideoWriter()
+		{
+			if (vc != nullptr)
+			{
+				vc->~VideoWriter();
+			}
+		}
+
+		// Destructor. Called on explicit Dispose() only.
+		~VideoWriter()
+		{
+			this->!VideoWriter();
+		}
+
+	};
+
 }