void Nui_GotDepthAlert( )
{
const NUI_IMAGE_FRAME * pImageFrame = NULL;
HRESULT hr = m_pNuiInstance->NuiImageStreamGetNextFrame(
m_pDepthStreamHandle,
0,
&pImageFrame );
if( FAILED( hr ) )
{
return;
}
INuiFrameTexture * pTexture = pImageFrame->pFrameTexture;
NUI_LOCKED_RECT LockedRect;
pTexture->LockRect( 0, &LockedRect, NULL, 0 );
if( LockedRect.Pitch != 0 )
{
BYTE * pBuffer = (BYTE*) LockedRect.pBits;
BYTE * rgbrun = (BYTE*)kinect_depth_image->imageData;
// draw the bits to the bitmap
USHORT * pBufferRun = (USHORT*) pBuffer;
for( int y = 0 ; y < 240 ; y++ )
{
for( int x = 0 ; x < 320 ; x++ )
{
RGBQUAD quad = Nui_ShortToQuad_Depth( *pBufferRun );
pBufferRun++;
*rgbrun = quad.rgbBlue;
rgbrun++;
*rgbrun = quad.rgbGreen;
rgbrun++;
*rgbrun = quad.rgbRed;
rgbrun++;
}
}
}
else
{
OutputDebugString( L"Buffer length of received texture is bogus\r\n" );
}
m_pNuiInstance->NuiImageStreamReleaseFrame( m_pDepthStreamHandle, pImageFrame );
cvShowImage("Kinect depth image",kinect_depth_image);
cvWaitKey(10);
}
void CSkeletalViewerApp::Nui_GotDepthAlert( )
{
const NUI_IMAGE_FRAME * pImageFrame = NULL;
HRESULT hr = m_pNuiInstance->NuiImageStreamGetNextFrame(
m_pDepthStreamHandle,
0,
&pImageFrame );
if( FAILED( hr ) )
{
return;
}
INuiFrameTexture * pTexture = pImageFrame->pFrameTexture;
NUI_LOCKED_RECT LockedRect;
pTexture->LockRect( 0, &LockedRect, NULL, 0 );
if( LockedRect.Pitch != 0 )
{
BYTE * pBuffer = (BYTE*) LockedRect.pBits;
// draw the bits to the bitmap
RGBQUAD * rgbrun = m_rgbWk;
USHORT * pBufferRun = (USHORT*) pBuffer;
for( int y = 0 ; y < 240 ; y++ )
{
for( int x = 0 ; x < 320 ; x++ )
{
RGBQUAD quad = Nui_ShortToQuad_Depth( *pBufferRun );
pBufferRun++;
*rgbrun = quad;
rgbrun++;
}
}
m_DrawDepth.DrawFrame( (BYTE*) m_rgbWk );
}
else
{
OutputDebugString( L"Buffer length of received texture is bogus\r\n" );
}
m_pNuiInstance->NuiImageStreamReleaseFrame( m_pDepthStreamHandle, pImageFrame );
}
int
KinectImpl::getDepthImage()
{
if( readyImageCapture(h_DepthImageEvent) > 0){
imageCapture(h_CaptureDepthImage, (char *)imageDepthRawBuffer, depth_img_size * 2);
int i=0;
for(int y=0; y<240; y++){
for(int x=0;x<320;x++){
RGBQUAD quad = Nui_ShortToQuad_Depth( imageDepthRawBuffer[i] );
imageDepthBuffer[i*3] = quad.rgbRed;
imageDepthBuffer[i*3+1] = quad.rgbGreen;
imageDepthBuffer[i*3+2] = quad.rgbBlue;
i++;
}
}
return 1;
}
return 0;
}
void CSkeletalViewerApp::Nui_GotDepthAlert( )
{
const NUI_IMAGE_FRAME * pImageFrame = NULL;
HRESULT hr = NuiImageStreamGetNextFrame(
m_pDepthStreamHandle,
0,
&pImageFrame );
if( FAILED( hr ) )
{
return;
}
NuiImageBuffer * pTexture = pImageFrame->pFrameTexture;
KINECT_LOCKED_RECT LockedRect;
pTexture->LockRect( 0, &LockedRect, NULL, 0 );
if( LockedRect.Pitch != 0 )
{
BYTE * pBuffer = (BYTE*) LockedRect.pBits;
USHORT * pPlayerRun = m_playerMap;
for( int y = 0 ; y < 480 ; y++ )
{
for( int x = 0 ; x < 640 ; x++ )
{
*pPlayerRun = 0;
*pPlayerRun++;
}
}
// draw the bits to the bitmap
RGBQUAD * rgbrun = m_rgbWk;
USHORT * pBufferRun = (USHORT*) pBuffer;
USHORT player, depth;
long colorX = 0, colorY = 0;
for( int y = 0 ; y < 240 ; y++ )
{
for( int x = 0 ; x < 320 ; x++ )
{
depth = *pBufferRun & 0xfff8;
if (FrameCount == 0)
{
initialdepth[x + y*320] = depth;
}
//TODO if first frame, save depth values as background
player = *pBufferRun & 7;
NuiImageGetColorPixelCoordinatesFromDepthPixel(
NUI_IMAGE_RESOLUTION_640x480,
0, x, y, depth, &colorX, &colorY);
USHORT writeover = 0;
//HACK player id based:
writeover = player;
//HACK background subtraction
if (depth < initialdepth[x + y*320] - 10)
{
//HACK writeover = 10;
}
m_playerMap[colorY * 640 + colorX] = writeover;
m_playerMap[colorY * 640 + colorX + 1] = writeover;
m_playerMap[(colorY + 1)* 640 + colorX] = writeover;
m_playerMap[(colorY + 1)* 640 + colorX + 1] = writeover;
RGBQUAD quad = Nui_ShortToQuad_Depth( *pBufferRun );
pBufferRun++;
*rgbrun = quad;
rgbrun++;
}
}
UINT bgColor = 0x00ffeedd;
UINT * pVideoRun = m_videoCache;
pPlayerRun = m_playerMap;
for( int y = 0 ; y < 480 ; y++ )
{
for( int x = 0 ; x < 640; x++ )
{
if (*pPlayerRun == 0)
{
*pVideoRun = bgColor;
}
pVideoRun++;
pPlayerRun++;
}
}
m_DrawVideo.DrawFrame( (BYTE*) m_videoCache );
m_DrawDepth.DrawFrame( (BYTE*) m_rgbWk );
ULONGLONG diff = (ULONGLONG) ((1.0 / m_FramesTotal - 1.0 / 20) * 1000);
//diff = 0;
m_videoDelay = GetTickCount64() + diff;
}
else
{
OutputDebugString( L"Buffer length of received texture is bogus\r\n" );
}
FrameCount++;
NuiImageStreamReleaseFrame( m_pDepthStreamHandle, pImageFrame );
}
