This commit is contained in:
BlubbFish 2016-11-09 14:18:10 +00:00
parent b5823a1059
commit 680b1ca2bb
5 changed files with 241 additions and 123 deletions

View File

@ -36,9 +36,13 @@
<WarningLevel>4</WarningLevel> <WarningLevel>4</WarningLevel>
</PropertyGroup> </PropertyGroup>
<ItemGroup> <ItemGroup>
<Reference Include="Microsoft.Research.Kinect, Version=1.0.0.45, Culture=neutral, PublicKeyToken=31bf3856ad364e35, processorArchitecture=MSIL" /> <Reference Include="Microsoft.Kinect, Version=1.7.0.0, Culture=neutral, PublicKeyToken=31bf3856ad364e35, processorArchitecture=MSIL">
<SpecificVersion>False</SpecificVersion>
<HintPath>C:\Program Files\Microsoft SDKs\Kinect\v1.7\Assemblies\Microsoft.Kinect.dll</HintPath>
</Reference>
<Reference Include="System" /> <Reference Include="System" />
<Reference Include="System.Data" /> <Reference Include="System.Data" />
<Reference Include="System.Drawing" />
<Reference Include="System.Xml" /> <Reference Include="System.Xml" />
<Reference Include="Microsoft.CSharp" /> <Reference Include="Microsoft.CSharp" />
<Reference Include="System.Core" /> <Reference Include="System.Core" />

View File

@ -1,11 +1,9 @@
using System; using Microsoft.Kinect;
using System.Collections.Generic; using System.Drawing;
using System.Linq;
using System.Text;
namespace KinectWorkshop namespace KinectWorkshop
{ {
public class DepthFrameConverter /*public class DepthFrameConverter
{ {
const int RED_IDX = 2; const int RED_IDX = 2;
const int GREEN_IDX = 1; const int GREEN_IDX = 1;
@ -14,71 +12,94 @@ namespace KinectWorkshop
// Converts a 16-bit grayscale depth frame which includes player indexes into a 32-bit frame // Converts a 16-bit grayscale depth frame which includes player indexes into a 32-bit frame
// that displays different players in different colors // that displays different players in different colors
public byte[] ConvertDepthFrameWithUser(byte[] depthFrame16) public byte[] ConvertDepthFrameWithUser(DepthImagePixel[] depthFrame, int width, int height)
{ {
for (int i16 = 0, i32 = 0; i16 < depthFrame16.Length && i32 < depthFrame32.Length; i16 += 2, i32 += 4) Color c = Color.Empty;
byte[] ret = new byte[width * height * 4];
for (int x = 1; x < width; x++)
{ {
int player = depthFrame16[i16] & 0x07; for (int y = 0; y < height; y++)
//if ((y - 1) * 320 + x * 4 == i16)
//{
// player = 8;
//}
int realDepth = (depthFrame16[i16 + 1] << 5) | (depthFrame16[i16] >> 3);
// transform 13-bit depth information into an 8-bit intensity appropriate
// for display (we disregard information in most significant bit)
byte intensity = (byte)(255 - (255 * realDepth / 0x0fff));
depthFrame32[i32 + RED_IDX] = 0;
depthFrame32[i32 + GREEN_IDX] = 0;
depthFrame32[i32 + BLUE_IDX] = 0;
// choose different display colors based on player
switch (player)
{ {
case 0: int i = ((y * width) + x) * 4;
depthFrame32[i32 + RED_IDX] = (byte)(intensity / 2); short depth = (depthFrame[x + y * width]).Depth;
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity / 2); c = Color.Empty;
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity / 2); if(depth > 0 && depth <= 4000)
break; {
case 1: int depthdist = (int)((depth / 4090f) * 255f);
depthFrame32[i32 + RED_IDX] = intensity; c = System.Drawing.Color.FromArgb((int)(depthdist / 2f), depthdist, (int)(depthdist * 0.7f));
break; }
case 2: ret[i] = c.B;
depthFrame32[i32 + GREEN_IDX] = intensity; ret[i] = c.G;
break; ret[i] = c.R;
case 3: ret[i] = 255;
depthFrame32[i32 + RED_IDX] = (byte)(intensity / 4);
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity);
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity);
break;
case 4:
depthFrame32[i32 + RED_IDX] = (byte)(intensity);
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity);
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity / 4);
break;
case 5:
depthFrame32[i32 + RED_IDX] = (byte)(intensity);
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity / 4);
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity);
break;
case 6:
depthFrame32[i32 + RED_IDX] = (byte)(intensity / 2);
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity / 2);
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity);
break;
case 7:
depthFrame32[i32 + RED_IDX] = (byte)(255 - intensity);
depthFrame32[i32 + GREEN_IDX] = (byte)(255 - intensity);
depthFrame32[i32 + BLUE_IDX] = (byte)(255 - intensity);
break;
case 8:
depthFrame32[i32 + RED_IDX] = 255;
depthFrame32[i32 + GREEN_IDX] = 0;
depthFrame32[i32 + BLUE_IDX] = 0;
break;
} }
} }
return depthFrame32;
/* for (int i16 = 0, i32 = 0; i16 < depthFrame16.Length && i32 < depthFrame32.Length; i16 += 2, i32 += 4)
{
int player = depthFrame16[i16] & 0x07;
//if ((y - 1) * 320 + x * 4 == i16)
//{
// player = 8;
//}
int realDepth = (depthFrame16[i16 + 1] << 5) | (depthFrame16[i16] >> 3);
// transform 13-bit depth information into an 8-bit intensity appropriate
// for display (we disregard information in most significant bit)
byte intensity = (byte)(255 - (255 * realDepth / 0x0fff));
depthFrame32[i32 + RED_IDX] = 0;
depthFrame32[i32 + GREEN_IDX] = 0;
depthFrame32[i32 + BLUE_IDX] = 0;
// choose different display colors based on player
switch (player)
{
case 0:
depthFrame32[i32 + RED_IDX] = (byte)(intensity / 2);
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity / 2);
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity / 2);
break;
case 1:
depthFrame32[i32 + RED_IDX] = intensity;
break;
case 2:
depthFrame32[i32 + GREEN_IDX] = intensity;
break;
case 3:
depthFrame32[i32 + RED_IDX] = (byte)(intensity / 4);
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity);
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity);
break;
case 4:
depthFrame32[i32 + RED_IDX] = (byte)(intensity);
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity);
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity / 4);
break;
case 5:
depthFrame32[i32 + RED_IDX] = (byte)(intensity);
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity / 4);
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity);
break;
case 6:
depthFrame32[i32 + RED_IDX] = (byte)(intensity / 2);
depthFrame32[i32 + GREEN_IDX] = (byte)(intensity / 2);
depthFrame32[i32 + BLUE_IDX] = (byte)(intensity);
break;
case 7:
depthFrame32[i32 + RED_IDX] = (byte)(255 - intensity);
depthFrame32[i32 + GREEN_IDX] = (byte)(255 - intensity);
depthFrame32[i32 + BLUE_IDX] = (byte)(255 - intensity);
break;
case 8:
depthFrame32[i32 + RED_IDX] = 255;
depthFrame32[i32 + GREEN_IDX] = 0;
depthFrame32[i32 + BLUE_IDX] = 0;
break;
}
}
return depthFrame32;*
return ret;
} }
internal byte[] ConvertDepthFrame(byte[] depthFrame16) internal byte[] ConvertDepthFrame(byte[] depthFrame16)
@ -112,5 +133,5 @@ namespace KinectWorkshop
} }
return depthFrame32; return depthFrame32;
} }
} }*/
} }

View File

@ -4,12 +4,11 @@
Title="MainWindow" Height="520" Width="660" Loaded="Window_Loaded" KeyUp="Window_KeyUp"> Title="MainWindow" Height="520" Width="660" Loaded="Window_Loaded" KeyUp="Window_KeyUp">
<Grid> <Grid>
<Image Name="imgDepth" Width="640" Height="480" /> <Image Name="imgDepth" Width="640" Height="480" />
<!--<StackPanel Orientation="Vertical"> <!-- <StackPanel Orientation="Vertical">
<Image Name="imgRgb" Width="320" Height="240" /> <Image Name="imgRgb" Width="320" Height="240" />
<Image Name="imgDepthPlayer" Width="320" Height="240" /> <Image Name="imgDepthPlayer" Width="320" Height="240" />
</StackPanel>--> </StackPanel> -->
<Canvas Name="MainCanvas"> <Canvas Name="MainCanvas"/>
</Canvas>
</Grid> </Grid>
</Window> </Window>

View File

@ -11,7 +11,7 @@ using System.Windows.Media;
using System.Windows.Media.Imaging; using System.Windows.Media.Imaging;
using System.Windows.Navigation; using System.Windows.Navigation;
using System.Windows.Shapes; using System.Windows.Shapes;
using Microsoft.Research.Kinect.Nui; using Microsoft.Kinect;
namespace Demo1 namespace Demo1
{ {
@ -21,7 +21,14 @@ namespace Demo1
public partial class MainWindow : Window public partial class MainWindow : Window
{ {
private KinectWorkshop.DepthFrameConverter cv = new KinectWorkshop.DepthFrameConverter(); private KinectWorkshop.DepthFrameConverter cv = new KinectWorkshop.DepthFrameConverter();
private Camera _cam; private KinectSensor r;
//private DepthImagePixel[] depthPixels;
//private byte[] colorPixels;
//private DepthImageFormat DepthFormat = DepthImageFormat.Resolution320x240Fps30;
//private ColorImageFormat ColorFormat = ColorImageFormat.RgbResolution640x480Fps30;
//private ColorImagePoint[] colorCoordinates;
//private bool init = false;
public MainWindow() public MainWindow()
{ {
InitializeComponent(); InitializeComponent();
@ -29,24 +36,29 @@ namespace Demo1
private void Window_Loaded(object sender, RoutedEventArgs e) private void Window_Loaded(object sender, RoutedEventArgs e)
{ {
if (Runtime.Kinects.Count == 0) if (KinectSensor.KinectSensors.Count == 0)
{ {
MessageBox.Show("Keine Kinect"); MessageBox.Show("Keine Kinect");
return; return;
} }
try try
{ {
Runtime r = Runtime.Kinects[0]; r = KinectSensor.KinectSensors[0];
r.Initialize(RuntimeOptions.UseSkeletalTracking | RuntimeOptions.UseDepthAndPlayerIndex); r.Start();
//r.Initialize(RuntimeOptions.UseSkeletalTracking | RuntimeOptions.UseDepthAndPlayerIndex);
//r.VideoFrameReady += new EventHandler<ImageFrameReadyEventArgs>(r_VideoFrameReady); //r.VideoFrameReady += new EventHandler<ImageFrameReadyEventArgs>(r_VideoFrameReady);
//r.VideoStream.Open(ImageStreamType.Video, 2, ImageResolution.Resolution640x480, ImageType.Color); //r.VideoStream.Open(ImageStreamType.Video, 2, ImageResolution.Resolution640x480, ImageType.Color);
//r.DepthFrameReady += r_DepthFrameReady;
r.DepthFrameReady += new EventHandler<ImageFrameReadyEventArgs>(r_DepthFrameReady); //r.DepthStream.Enable();
r.DepthStream.Open(ImageStreamType.Depth, 2, ImageResolution.Resolution320x240, ImageType.DepthAndPlayerIndex); //r.DepthStream.Open(ImageStreamType.Depth, 2, ImageResolution.Resolution320x240, ImageType.DepthAndPlayerIndex);
r.SkeletonEngine.TransformSmooth = true; //r.SkeletonFrameReady += r_SkeletonFrameReady;
r.SkeletonFrameReady += new EventHandler<SkeletonFrameReadyEventArgs>(r_SkeletonFrameReady); r.SkeletonStream.Enable(new TransformSmoothParameters() { Smoothing = 0.1f });
_cam = r.NuiCamera; //r.SkeletonEngine.TransformSmooth = true;
//r.SkeletonFrameReady += new EventHandler<SkeletonFrameReadyEventArgs>(r_SkeletonFrameReady);
//_cam = r.NuiCamera;
//r.AllFramesReady += R_AllFramesReady;
r.SkeletonFrameReady += this.r_SkeletonFrameReady;
} }
catch (Exception ex) catch (Exception ex)
{ {
@ -54,46 +66,118 @@ namespace Demo1
} }
} }
/*private void R_AllFramesReady(object sender, AllFramesReadyEventArgs e)
{
if(r == null)
{
return;
}
bool depthReceived = false;
bool colorReceived = false;
using (DepthImageFrame depthFrame = e.OpenDepthImageFrame())
{
if (null != depthFrame)
{
// Copy the pixel data from the image to a temporary array
depthFrame.CopyDepthImagePixelDataTo(this.depthPixels);
depthReceived = true;
if(!init) {
this.colorCoordinates = new ColorImagePoint[r.DepthStream.FramePixelDataLength];
init = true;
}
}
}
using (ColorImageFrame colorFrame = e.OpenColorImageFrame())
{
if (null != colorFrame)
{
// Copy the pixel data from the image to a temporary array
colorFrame.CopyPixelDataTo(this.colorPixels);
colorReceived = true;
}
}
if (true == depthReceived)
{
r.CoordinateMapper.MapDepthFrameToColorFrame(
DepthFormat,
this.depthPixels,
ColorFormat,
this.colorCoordinates);
// ...
int depthIndex = x + (y * this.depthWidth);
DepthImagePixel depthPixel = this.depthPixels[depthIndex];
// scale color coordinates to depth resolution
int X = colorImagePoint.X / this.colorToDepthDivisor;
int Y = colorImagePoint.Y / this.colorToDepthDivisor;
// depthPixel is the depth for the (X,Y) pixel in the color frame
}
}*/
void r_SkeletonFrameReady(object sender, SkeletonFrameReadyEventArgs e) void r_SkeletonFrameReady(object sender, SkeletonFrameReadyEventArgs e)
{ {
SkeletonFrame skf = e.OpenSkeletonFrame();
if(skf == null)
{
return;
}
Skeleton[] sks = new Skeleton[skf.SkeletonArrayLength];
skf.CopySkeletonDataTo(sks);
this.MainCanvas.Children.Clear(); this.MainCanvas.Children.Clear();
foreach (SkeletonData sk in e.SkeletonFrame.Skeletons) foreach (Skeleton sk in sks)
{ {
if (sk.TrackingState == SkeletonTrackingState.Tracked) if (sk.TrackingState == SkeletonTrackingState.Tracked)
{ {
this.SetLines(sk); this.drawPlayer(sk);
this.SetPoints(sk);
} }
} }
} }
private void SetLines(SkeletonData sk) private void drawPlayer(Skeleton sk)
{ {
JointID[,] id = { this.SetPoints(sk);
{ JointID.Head, JointID.ShoulderCenter }, this.SetLines(sk);
{ JointID.ShoulderCenter, JointID.ShoulderLeft }, }
{ JointID.ShoulderCenter, JointID.ShoulderRight },
{ JointID.ShoulderLeft, JointID.ElbowLeft }, private void SetLines(Skeleton sk)
{ JointID.ShoulderRight, JointID.ElbowRight }, {
{ JointID.ElbowLeft, JointID.WristLeft }, JointType[,] id = {
{ JointID.ElbowRight, JointID.WristRight }, { JointType.Head, JointType.ShoulderCenter },
{ JointID.WristLeft, JointID.HandLeft }, { JointType.ShoulderCenter, JointType.ShoulderLeft },
{ JointID.WristRight, JointID.HandRight }, { JointType.ShoulderCenter, JointType.ShoulderRight },
{ JointID.ShoulderCenter, JointID.Spine }, { JointType.ShoulderLeft, JointType.ElbowLeft },
{ JointID.Spine, JointID.HipCenter }, { JointType.ShoulderRight, JointType.ElbowRight },
{ JointID.HipCenter, JointID.HipLeft }, { JointType.ElbowLeft, JointType.WristLeft },
{ JointID.HipCenter, JointID.HipRight }, { JointType.ElbowRight, JointType.WristRight },
{ JointID.HipLeft, JointID.KneeLeft }, { JointType.WristLeft, JointType.HandLeft },
{ JointID.HipRight, JointID.KneeRight }, { JointType.WristRight, JointType.HandRight },
{ JointID.KneeLeft, JointID.AnkleLeft }, { JointType.ShoulderCenter, JointType.Spine },
{ JointID.KneeRight, JointID.AnkleRight }, { JointType.Spine, JointType.HipCenter },
{ JointID.AnkleLeft, JointID.FootLeft }, { JointType.HipCenter, JointType.HipLeft },
{ JointID.AnkleRight, JointID.FootRight } { JointType.HipCenter, JointType.HipRight },
{ JointType.HipLeft, JointType.KneeLeft },
{ JointType.HipRight, JointType.KneeRight },
{ JointType.KneeLeft, JointType.AnkleLeft },
{ JointType.KneeRight, JointType.AnkleRight },
{ JointType.AnkleLeft, JointType.FootLeft },
{ JointType.AnkleRight, JointType.FootRight }
}; };
for (int i = 0; i < id.Length / 2; i++) for (int i = 0; i < id.Length / 2; i++)
{ {
Joint r1 = sk.Joints[id[i, 0]].ScaleTo(640, 480); Joint r1 = sk.Joints[id[i, 0]].ScaleTo(640, 480);
Joint r2 = sk.Joints[id[i, 1]].ScaleTo(640, 480); Joint r2 = sk.Joints[id[i, 1]].ScaleTo(640, 480);
/**** */
Line l = new Line(); Line l = new Line();
l.Stroke = Brushes.Blue; l.Stroke = Brushes.Blue;
l.StrokeThickness = 5.0; l.StrokeThickness = 5.0;
@ -101,11 +185,13 @@ namespace Demo1
l.X1 = r1.Position.X; l.X1 = r1.Position.X;
l.Y2 = r2.Position.Y; l.Y2 = r2.Position.Y;
l.X2 = r2.Position.X; l.X2 = r2.Position.X;
/**** */
this.MainCanvas.Children.Add(l); this.MainCanvas.Children.Add(l);
} }
} }
private void SetPoints(SkeletonData sk) private void SetPoints(Skeleton sk)
{ {
foreach (Joint joint in sk.Joints) foreach (Joint joint in sk.Joints)
{ {
@ -121,28 +207,37 @@ namespace Demo1
} }
} }
void r_DepthFrameReady(object sender, ImageFrameReadyEventArgs e) /*void r_DepthFrameReady(object sender, DepthImageFrameReadyEventArgs e)
{ {
PlanarImage img = e.ImageFrame.Image; //PlanarImage img = e.ImageFrame.Image;
byte[] bh = cv.ConvertDepthFrameWithUser(img.Bits); DepthImageFrame img = e.OpenDepthImageFrame();
imgDepth.Source = BitmapSource.Create(img.Width, img.Height, if(img == null)
96, 96, PixelFormats.Bgr32, null, {
bh, img.Width * 4); return;
}
DepthImagePixel[] bs = new DepthImagePixel[img.PixelDataLength];
img.CopyDepthImagePixelDataTo(bs);
byte[] bh = cv.ConvertDepthFrameWithUser(bs, img.Width, img.Height);
imgDepth.Source = BitmapSource.Create(img.Width, img.Height, 96, 96, PixelFormats.Bgr32, null, bh, img.Width * 4);
//bh = cv.ConvertDepthFrameHiddenPlayer(img.Bits); //bh = cv.ConvertDepthFrameHiddenPlayer(img.Bits);
//byte[] bh = cv.ConvertDepthFrame(img.Bits); //byte[] bh = cv.ConvertDepthFrame(img.Bits);
//imgDepthPlayer.Source = BitmapSource.Create(img.Width, img.Height, //imgDepthPlayer.Source = BitmapSource.Create(img.Width, img.Height,
// 96, 96, PixelFormats.Bgr32, null, // 96, 96, PixelFormats.Bgr32, null,
// bh, img.Width * 4); // bh, img.Width * 4);
} }*/
private void Window_KeyUp(object sender, KeyEventArgs e) private void Window_KeyUp(object sender, KeyEventArgs e)
{ {
try try
{ {
if (e.Key == Key.OemPlus) if (e.Key == Key.Up)
_cam.ElevationAngle += 1; {
if (e.Key == Key.OemMinus) int k = r.ElevationAngle;
_cam.ElevationAngle -= 1; k++;
r.ElevationAngle = k;
}
if (e.Key == Key.Down)
r.ElevationAngle -= 1;
} }
catch (ArgumentOutOfRangeException outOfRangeException) catch (ArgumentOutOfRangeException outOfRangeException)
{ {

View File

@ -1,4 +1,5 @@
using Microsoft.Research.Kinect.Nui; using Microsoft.Kinect;
using System.Windows;
namespace Demo1 namespace Demo1
{ {
@ -6,17 +7,15 @@ namespace Demo1
{ {
public static Joint ScaleTo(this Joint joint, int width, int height, float skeletonMaxX, float skeletonMaxY) public static Joint ScaleTo(this Joint joint, int width, int height, float skeletonMaxX, float skeletonMaxY)
{ {
Vector pos = new Vector() SkeletonPoint pos = new SkeletonPoint()
{ {
X = Scale(width, skeletonMaxX, joint.Position.X), X = Scale(width, skeletonMaxX, joint.Position.X),
Y = Scale(height, skeletonMaxY, -joint.Position.Y), Y = Scale(height, skeletonMaxY, -joint.Position.Y),
Z = joint.Position.Z, Z = joint.Position.Z
W = joint.Position.W
}; };
Joint j = new Joint() Joint j = new Joint()
{ {
ID = joint.ID,
TrackingState = joint.TrackingState, TrackingState = joint.TrackingState,
Position = pos Position = pos
}; };