From 21ae7edca3370e36b9ae9781cfa82f34d20d0177 Mon Sep 17 00:00:00 2001
From: lobroda <lobroda@IUTCLINFC2101>
Date: Mon, 22 Jan 2024 19:01:26 +0100
Subject: [PATCH] ADD : avancement BodyStream

---
 KinectConnection/BodyImageStream.cs      | 19 ++++++++++++-------
 KinectSensorStreams/View/MainWindow.xaml |  2 +-
 2 files changed, 13 insertions(+), 8 deletions(-)

diff --git a/KinectConnection/BodyImageStream.cs b/KinectConnection/BodyImageStream.cs
index 2decc32..8ecfdc3 100644
--- a/KinectConnection/BodyImageStream.cs
+++ b/KinectConnection/BodyImageStream.cs
@@ -4,6 +4,7 @@ using System.Collections.Generic;
 using System.Linq;
 using System.Text;
 using System.Threading.Tasks;
+using System.Windows;
 using System.Windows.Controls;
 using System.Windows.Media;
 using System.Windows.Shapes;
@@ -21,10 +22,13 @@ namespace KinectConnection
             set { SetProperty(ref bodies, value); }
         }
 
+        public Dictionary<JointType, Point> JointPoints { get; private set; }
+
         public BodyImageStream() : base()
         {
             // Initialize the bodies array
             this.bodies = new Body[this.KinectSensor.BodyFrameSource.BodyCount];
+            JointPoints = new Dictionary<JointType, Point>();
         }
 
         public override void Start()
@@ -60,17 +64,18 @@ namespace KinectConnection
             }
 
             // Process the body data
-            foreach (Body body in this.bodies)
+            foreach (var body in bodies)
             {
                 if (body.IsTracked)
                 {
-                    // Get the right hand joint
-                    Joint rightHand = body.Joints[JointType.HandRight];
-
-                    // Check the tracking state of the joint
-                    if (rightHand.TrackingState == TrackingState.Tracked)
+                    foreach (JointType jointType in body.Joints.Keys)
                     {
-                        CameraSpacePoint position = rightHand.Position;
+                        // 3D space point
+                        CameraSpacePoint cameraSpacePoint = body.Joints[jointType].Position;
+                        // 2D space point
+                        ColorSpacePoint colorSpacePoint = this.KinectSensor.CoordinateMapper.MapCameraPointToColorSpace(cameraSpacePoint);
+
+                        JointPoints[jointType] = new Point(colorSpacePoint.X, colorSpacePoint.Y);
                     }
                 }
             }
diff --git a/KinectSensorStreams/View/MainWindow.xaml b/KinectSensorStreams/View/MainWindow.xaml
index 8fca481..b35940a 100644
--- a/KinectSensorStreams/View/MainWindow.xaml
+++ b/KinectSensorStreams/View/MainWindow.xaml
@@ -124,7 +124,7 @@
                                         <DataTemplate>
                                             <Ellipse Width="10" Height="10" Fill="Red">
                                                 <Ellipse.RenderTransform>
-                                                    <TranslateTransform X="{Binding Position.X}" Y="{Binding Position.Y}" />
+                                                    <TranslateTransform X="{Binding JointPoints[HandRight].X}" Y="{Binding JointPoints[HandRight].Y}" />
                                                 </Ellipse.RenderTransform>
                                             </Ellipse>
                                         </DataTemplate>