oni::driver::DeviceBase* XnOniDriver::deviceOpen(const char* uri, const char* mode)
{
XnOniDevice* pDevice = NULL;
// if device was already opened for this uri, return the previous one
if (m_devices.Get(uri, pDevice) == XN_STATUS_OK)
{
getServices().errorLoggerAppend("Device is already open.");
return NULL;
}
pDevice = XN_NEW(XnOniDevice, uri, getServices(), this);
XnStatus nRetVal = pDevice->Init(mode);
if (nRetVal != XN_STATUS_OK)
{
getServices().errorLoggerAppend("Could not open \"%s\": %s", uri, xnGetStatusString(nRetVal));
return NULL;
}
// Register to error state property changed.
XnCallbackHandle handle;
nRetVal = pDevice->GetSensor()->RegisterToPropertyChange(XN_MODULE_NAME_DEVICE,
XN_MODULE_PROPERTY_ERROR_STATE,
OnDevicePropertyChanged, pDevice, handle);
if (nRetVal != XN_STATUS_OK)
{
XN_DELETE(pDevice);
return NULL;
}
// Add the device and return it.
m_devices[uri] = pDevice;
return pDevice;
}
void XN_CALLBACK_TYPE XnOniDriver::OnDevicePropertyChanged(const XnChar* ModuleName, XnUInt32 nPropertyId, void* pCookie)
{
XnOniDevice* pDevice = (XnOniDevice*)pCookie;
XnOniDriver* pThis = pDevice->GetDriver();
if (nPropertyId == XN_MODULE_PROPERTY_ERROR_STATE)
{
XnSensor* pSensor = (XnSensor*)pDevice->GetSensor();
// Get the property value.
XnUInt64 errorState = 0;
XnStatus nRetVal = pSensor->GetProperty(ModuleName, XN_MODULE_PROPERTY_ERROR_STATE, &errorState);
if (nRetVal == XN_STATUS_OK)
{
if (errorState == XN_STATUS_DEVICE_NOT_CONNECTED)
{
pThis->deviceDisconnected(pDevice->GetInfo());
}
else
{
int errorStateValue = XN_ERROR_STATE_OK;
switch (errorState)
{
case XN_STATUS_OK:
{
errorStateValue = XN_ERROR_STATE_OK;
break;
}
case XN_STATUS_DEVICE_PROJECTOR_FAULT:
{
errorStateValue = XN_ERROR_STATE_DEVICE_PROJECTOR_FAULT;
break;
}
case XN_STATUS_DEVICE_OVERHEAT:
{
errorStateValue = XN_ERROR_STATE_DEVICE_OVERHEAT;
break;
}
default:
{
// Invalid value.
XN_ASSERT(FALSE);
}
}
pThis->deviceStateChanged(pDevice->GetInfo(), errorStateValue);
}
}
}
}