XN_C_API XnStatus xnOSStartHighResTimer(XnOSTimer* pTimer)
{
// start a normal timer
XnStatus nRetVal = xnOSStartTimer(pTimer);
XN_IS_STATUS_OK(nRetVal);
// now make it high-res
pTimer->bHighRes = true;
return XN_STATUS_OK;
}
XN_C_API XnStatus xnOSStartHighResTimer(XnOSTimer* pTimer)
{
// Local function variables
XnStatus nRetVal = XN_STATUS_OK;
nRetVal = xnOSStartTimer(pTimer);
XN_IS_STATUS_OK(nRetVal);
// Convert from microseconds to milliseconds
pTimer->dTicksPerTimeUnit /= 1000.0;
// All is good...
return (XN_STATUS_OK);
}
XN_C_API XnStatus xnOSStartHighResTimer(XnOSTimer* pTimer)
{
return xnOSStartTimer(pTimer);
}
OniStatus Context::waitForStreams(OniStreamHandle* pStreams, int streamCount, int* pStreamIndex, int timeout)
{
static const int MAX_WAITED_STREAMS = 50;
Device* deviceList[MAX_WAITED_STREAMS];
VideoStream* streamsList[MAX_WAITED_STREAMS];
unsigned long long oldestTimestamp = XN_MAX_UINT64;
int oldestIndex = -1;
if (streamCount > MAX_WAITED_STREAMS)
{
m_errorLogger.Append("Cannot wait on more than %d streams", MAX_WAITED_STREAMS);
return ONI_STATUS_NOT_SUPPORTED;
}
int numDevices = 0;
for (int i = 0; i < streamCount; ++i)
{
if (pStreams[i] == NULL)
{
continue;
}
streamsList[i] = ((_OniStream*)pStreams[i])->pStream;
Device* pDevice = &streamsList[i]->getDevice();
// Check if device already exists.
bool found = false;
for (int j = 0; j < numDevices; ++j)
{
if (deviceList[j] == pDevice)
{
found = true;
break;
}
}
// Add new device to list.
if (!found)
{
deviceList[numDevices] = pDevice;
++numDevices;
}
}
XN_EVENT_HANDLE hEvent = getThreadEvent();
XnUInt64 passedTime;
XnOSTimer workTimer;
XnUInt32 timeToWait = timeout;
xnOSStartTimer(&workTimer);
do
{
for (int i = 0; i < streamCount; ++i)
{
if (pStreams[i] == NULL)
continue;
VideoStream* pStream = ((_OniStream*)pStreams[i])->pStream;
pStream->lockFrame();
OniFrame* pFrame = pStream->peekFrame();
if (pFrame != NULL && pFrame->timestamp < oldestTimestamp)
{
oldestTimestamp = pFrame->timestamp;
oldestIndex = i;
}
pStream->unlockFrame();
}
if (oldestIndex != -1)
{
*pStreamIndex = oldestIndex;
break;
}
// 'Poke' the driver to attempt to receive more frames.
for (int j = 0; j < numDevices; ++j)
{
deviceList[j]->tryManualTrigger();
}
if(timeout != ONI_TIMEOUT_FOREVER)
{
xnOSQueryTimer(workTimer, &passedTime);
if((int)passedTime < timeout)
timeToWait = timeout - (int)passedTime;
else
timeToWait = 0;
}
} while (XN_STATUS_OK == xnOSWaitEvent(hEvent, timeToWait));
xnOSStopTimer(&workTimer);
if (oldestIndex != -1)
{
return ONI_STATUS_OK;
}
m_errorLogger.Append("waitForStreams: timeout reached");
return ONI_STATUS_TIME_OUT;
}
