XnStatus XnFrameStream::Init()
{
XnStatus nRetVal = XN_STATUS_OK;
// init base
nRetVal = XnDeviceStream::Init();
XN_IS_STATUS_OK(nRetVal);
XN_VALIDATE_ADD_PROPERTIES(this, &m_IsFrameStream, &m_FPS, &m_LastRawFrame);
XnCallbackHandle hDummy;
// be notified when required size changes
nRetVal = RequiredSizeProperty().OnChangeEvent().Register(RequiredSizeChangedCallback, this, &hDummy);
XN_IS_STATUS_OK(nRetVal);
if (m_pBufferPool == NULL)
{
XN_VALIDATE_NEW(m_pBufferPool, XnSimpleBufferPool, 3);
m_bPoolAllocated = TRUE;
}
// allocate buffer manager
XN_VALIDATE_NEW(m_pBufferManager, XnFrameBufferManager, m_pBufferPool);
nRetVal = m_pBufferManager->Init(GetRequiredDataSize());
XN_IS_STATUS_OK(nRetVal);
// register for new data events
nRetVal = m_pBufferManager->OnNewFrameEvent().Register(OnTripleBufferNewData, this, &hDummy);
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnStreamReaderStream::Init()
{
XnStatus nRetVal = XN_STATUS_OK;
nRetVal = XnDeviceStream::Init();
XN_IS_STATUS_OK(nRetVal);
// register for size change (so we can realloc stream data)
nRetVal = RequiredSizeProperty().OnChangeEvent().Register(RequiredSizeChangedCallback, this);
XN_IS_STATUS_OK(nRetVal);
// and create stream data
nRetVal = XnStreamDataCreate(&m_pLastData, GetName(), GetRequiredDataSize());
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnFrameStream::Init()
{
XnStatus nRetVal = XN_STATUS_OK;
// init base
nRetVal = XnDeviceStream::Init();
XN_IS_STATUS_OK(nRetVal);
XN_VALIDATE_ADD_PROPERTIES(this, &m_IsFrameStream, &m_FPS, &m_LastRawFrame, &m_externalBufferPool );
XnCallbackHandle hDummy;
// be notified when required size changes
nRetVal = RequiredSizeProperty().OnChangeEvent().Register(RequiredSizeChangedCallback, this, hDummy);
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnSensorAudioStream::ReallocBuffer()
{
XnStatus nRetVal = XN_STATUS_OK;
if (m_buffer.pAudioBuffer == NULL)
{
// we allocate enough for 5 seconds of audio
XnUInt32 nSampleSize = 2 * 2; // 16-bit per channel (2 bytes) * max number of channels (2)
XnUInt32 nSamples = 48000 * 5; // max sample rate * number of seconds
XnUInt32 nMaxBufferSize = nSamples * nSampleSize;
// find min packet size (so we'll have max packet count)
XnUInt32 nMinPacketSize = XN_MIN(XN_SENSOR_PROTOCOL_AUDIO_PACKET_SIZE_BULK, XN_SENSOR_PROTOCOL_AUDIO_PACKET_SIZE_ISO);
XnUInt32 nMaxPacketCount = nMaxBufferSize / nMinPacketSize - 1;
nRetVal = RequiredSizeProperty().UnsafeUpdateValue(nMaxBufferSize);
XN_IS_STATUS_OK(nRetVal);
m_buffer.pAudioPacketsTimestamps = (XnUInt64*)xnOSMallocAligned(sizeof(XnUInt64) * nMaxPacketCount, XN_DEFAULT_MEM_ALIGN);
m_buffer.pAudioBuffer = (XnUInt8*)xnOSMallocAligned(nMaxBufferSize, XN_DEFAULT_MEM_ALIGN);
m_buffer.nAudioBufferSize = nMaxBufferSize;
}
// calculate current packet size
m_buffer.nAudioPacketSize = m_nOrigAudioPacketSize;
if (m_Helper.GetFirmwareVersion() >= XN_SENSOR_FW_VER_5_2 && GetNumberOfChannels() == 1)
{
m_buffer.nAudioPacketSize /= 2;
}
m_buffer.nAudioBufferNumOfPackets = m_buffer.nAudioBufferSize / m_buffer.nAudioPacketSize;
m_buffer.nAudioBufferSize = m_buffer.nAudioBufferNumOfPackets * m_buffer.nAudioPacketSize;
m_header.nPacketCount = m_buffer.nAudioBufferNumOfPackets;
m_header.nPacketSize = m_buffer.nAudioPacketSize;
// set read and write indices
m_buffer.nAudioReadIndex = 0;
m_buffer.nAudioWriteIndex = 0;
return (XN_STATUS_OK);
}
XnStatus XnSensorAudioStream::ReallocBuffer()
{
XnStatus nRetVal = XN_STATUS_OK;
XnDevicePrivateData* pDevicePrivateData = m_Helper.GetPrivateData();
if (m_hSharedMemory == NULL)
{
// first time, create shared memory
// we allocate enough for 5 seconds of audio
XnUInt32 nSampleSize = 2 * 2; // 16-bit per channel (2 bytes) * max number of channels (2)
XnUInt32 nSamples = 48000 * 5; // max sample rate * number of seconds
XnUInt32 nMaxBufferSize = nSamples * nSampleSize;
// find min packet size (so we'll have max packet count)
XnUInt32 nMinPacketSize = XN_MIN(XN_SENSOR_PROTOCOL_AUDIO_PACKET_SIZE_BULK, XN_SENSOR_PROTOCOL_AUDIO_PACKET_SIZE_ISO);
XnUInt32 nMaxPacketCount = nMaxBufferSize / nMinPacketSize - 1;
XnUInt32 nSharedBufferSize =
sizeof(XnAudioSharedBuffer) + // header
sizeof(XnUInt64) * nMaxPacketCount + // packet timestamps
nMaxBufferSize;
// to make the name unique, we'll add process ID
XN_PROCESS_ID procID;
xnOSGetCurrentProcessID(&procID);
XnChar strSharedName[XN_DEVICE_MAX_STRING_LENGTH];
sprintf(strSharedName, "%u_%s_%s", procID, m_strDeviceName, GetName());
nRetVal = m_SharedBufferName.UnsafeUpdateValue(strSharedName);
XN_IS_STATUS_OK(nRetVal);
nRetVal = RequiredSizeProperty().UnsafeUpdateValue(nMaxBufferSize);
XN_IS_STATUS_OK(nRetVal);
nRetVal = xnOSCreateSharedMemory(strSharedName, nSharedBufferSize, XN_OS_FILE_READ | XN_OS_FILE_WRITE, &m_hSharedMemory);
XN_IS_STATUS_OK(nRetVal);
XnUChar* pAddress;
nRetVal = xnOSSharedMemoryGetAddress(m_hSharedMemory, (void**)&pAddress);
XN_IS_STATUS_OK(nRetVal);
m_pSharedHeader = (XnAudioSharedBuffer*)pAddress;
pDevicePrivateData->pAudioPacketsTimestamps = (XnUInt64*)(pAddress + sizeof(XnAudioSharedBuffer));
pDevicePrivateData->pAudioBuffer = (XN_AUDIO_TYPE*)(pAddress + sizeof(XnAudioSharedBuffer) + sizeof(XnUInt64) * nMaxPacketCount);
pDevicePrivateData->nAudioBufferSize = nMaxBufferSize;
m_pSharedHeader->nTimestampsListOffset = sizeof(XnAudioSharedBuffer);
m_pSharedHeader->nBufferOffset = pDevicePrivateData->pAudioBuffer - pAddress;
}
// calculate current packet size
pDevicePrivateData->nAudioPacketSize = m_nOrigAudioPacketSize;
if (m_Helper.GetFirmwareVersion() >= XN_SENSOR_FW_VER_5_2 && GetNumberOfChannels() == 1)
{
pDevicePrivateData->nAudioPacketSize /= 2;
}
pDevicePrivateData->nAudioBufferNumOfPackets = pDevicePrivateData->nAudioBufferSize / pDevicePrivateData->nAudioPacketSize;
pDevicePrivateData->nAudioBufferSize = pDevicePrivateData->nAudioBufferNumOfPackets * pDevicePrivateData->nAudioPacketSize;
m_pSharedHeader->nPacketCount = pDevicePrivateData->nAudioBufferNumOfPackets;
m_pSharedHeader->nPacketSize = pDevicePrivateData->nAudioPacketSize;
// set read and write indices
pDevicePrivateData->nAudioReadIndex = 0;
pDevicePrivateData->nAudioWriteIndex = 0;
return (XN_STATUS_OK);
}
