XnStatus XnPixelStream::SetCropping(const XnCropping* pCropping)
{
XnStatus nRetVal = XN_STATUS_OK;
nRetVal = ValidateCropping(pCropping);
XN_IS_STATUS_OK(nRetVal);
nRetVal = m_Cropping.UnsafeUpdateValue(XN_PACK_GENERAL_BUFFER(*(XnCropping*)pCropping));
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnSensorDepthStream::SetCropping(const XnCropping* pCropping)
{
XnStatus nRetVal = XN_STATUS_OK;
nRetVal = ValidateCropping(pCropping);
XN_IS_STATUS_OK(nRetVal);
xnOSEnterCriticalSection(GetLock());
if (m_Helper.GetFirmwareVersion() > XN_SENSOR_FW_VER_3_0)
{
nRetVal = m_Helper.StartFirmwareTransaction();
if (nRetVal != XN_STATUS_OK)
{
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
if (pCropping->bEnabled)
{
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropSizeX, pCropping->nXSize);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropSizeY, pCropping->nYSize);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropOffsetX, pCropping->nXOffset);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropOffsetY, pCropping->nYOffset);
}
if (nRetVal == XN_STATUS_OK)
{
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropEnabled, (XnUInt16)pCropping->bEnabled);
}
if (nRetVal != XN_STATUS_OK)
{
m_Helper.RollbackFirmwareTransaction();
m_Helper.UpdateFromFirmware(m_FirmwareCropEnabled);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetX);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetY);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeX);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeY);
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
nRetVal = m_Helper.CommitFirmwareTransactionAsBatch();
if (nRetVal != XN_STATUS_OK)
{
m_Helper.UpdateFromFirmware(m_FirmwareCropEnabled);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetX);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetY);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeX);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeY);
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
}
nRetVal = XnDepthStream::SetCropping(pCropping);
xnOSLeaveCriticalSection(GetLock());
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnSensorIRStream::SetCroppingImpl(const OniCropping* pCropping, XnCroppingMode mode)
{
XnStatus nRetVal = XN_STATUS_OK;
XnFirmwareCroppingMode firmwareMode = m_Helper.GetFirmwareCroppingMode(mode, pCropping->enabled);
nRetVal = ValidateCropping(pCropping);
XN_IS_STATUS_OK(nRetVal);
xnOSEnterCriticalSection(GetLock());
if (m_Helper.GetFirmwareVersion() > XN_SENSOR_FW_VER_3_0)
{
nRetVal = m_Helper.StartFirmwareTransaction();
if (nRetVal != XN_STATUS_OK)
{
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
// mirror is done by software (meaning AFTER cropping, which is bad). So we need to flip the cropping area
// to match requested area.
XnUInt16 nXOffset = (XnUInt16) pCropping->originX;
if (IsMirrored())
{
nXOffset = (XnUInt16)(GetXRes() - pCropping->originX - pCropping->width);
}
if (pCropping->enabled)
{
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropSizeX, (XnUInt16) pCropping->width);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropSizeY, (XnUInt16) pCropping->height);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropOffsetX, (XnUInt16) nXOffset);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropOffsetY, (XnUInt16) pCropping->originY);
}
if (nRetVal == XN_STATUS_OK)
{
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropMode, (XnUInt16)firmwareMode);
}
if (nRetVal != XN_STATUS_OK)
{
m_Helper.RollbackFirmwareTransaction();
m_Helper.UpdateFromFirmware(m_FirmwareCropMode);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetX);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetY);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeX);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeY);
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
nRetVal = m_Helper.CommitFirmwareTransactionAsBatch();
if (nRetVal != XN_STATUS_OK)
{
m_Helper.UpdateFromFirmware(m_FirmwareCropMode);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetX);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetY);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeX);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeY);
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
}
nRetVal = m_CroppingMode.UnsafeUpdateValue(mode);
XN_ASSERT(nRetVal == XN_STATUS_OK);
nRetVal = XnIRStream::SetCropping(pCropping);
xnOSLeaveCriticalSection(GetLock());
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnSensorIRStream::SetCropping(const XnCropping* pCropping)
{
XnStatus nRetVal = XN_STATUS_OK;
nRetVal = ValidateCropping(pCropping);
XN_IS_STATUS_OK(nRetVal);
xnOSEnterCriticalSection(GetLock());
if (m_Helper.GetFirmwareVersion() > XN_SENSOR_FW_VER_3_0)
{
nRetVal = m_Helper.StartFirmwareTransaction();
if (nRetVal != XN_STATUS_OK)
{
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
// mirror is done by software (meaning AFTER cropping, which is bad). So we need to flip the cropping area
// to match requested area.
XnUInt16 nXOffset = pCropping->nXOffset;
if (IsMirrored())
{
nXOffset = (XnUInt16)(GetXRes() - pCropping->nXOffset - pCropping->nXSize);
}
if (pCropping->bEnabled)
{
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropSizeX, pCropping->nXSize);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropSizeY, pCropping->nYSize);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropOffsetX, nXOffset);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropOffsetY, pCropping->nYOffset);
}
if (nRetVal == XN_STATUS_OK)
{
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropEnabled, (XnUInt16)pCropping->bEnabled);
}
if (nRetVal != XN_STATUS_OK)
{
m_Helper.RollbackFirmwareTransaction();
m_Helper.UpdateFromFirmware(m_FirmwareCropEnabled);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetX);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetY);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeX);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeY);
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
nRetVal = m_Helper.CommitFirmwareTransactionAsBatch();
if (nRetVal != XN_STATUS_OK)
{
m_Helper.UpdateFromFirmware(m_FirmwareCropEnabled);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetX);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetY);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeX);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeY);
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
}
nRetVal = XnIRStream::SetCropping(pCropping);
xnOSLeaveCriticalSection(GetLock());
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnSensorDepthStream::SetCroppingImpl(const OniCropping* pCropping, XnCroppingMode mode)
{
XnStatus nRetVal = XN_STATUS_OK;
XnFirmwareCroppingMode firmwareMode = m_Helper.GetFirmwareCroppingMode(mode, pCropping->enabled);
nRetVal = ValidateCropping(pCropping);
XN_IS_STATUS_OK(nRetVal);
xnOSEnterCriticalSection(GetLock());
if (m_Helper.GetFirmwareVersion() > XN_SENSOR_FW_VER_3_0)
{
nRetVal = m_Helper.StartFirmwareTransaction();
if (nRetVal != XN_STATUS_OK)
{
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
if (pCropping->enabled)
{
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropSizeX, (XnUInt16) pCropping->width);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropSizeY, (XnUInt16) pCropping->height);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropOffsetX, (XnUInt16) pCropping->originX);
if (nRetVal == XN_STATUS_OK)
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropOffsetY, (XnUInt16) pCropping->originY);
}
if (nRetVal == XN_STATUS_OK)
{
nRetVal = m_Helper.SimpleSetFirmwareParam(m_FirmwareCropMode, (XnUInt16)firmwareMode);
}
if (nRetVal != XN_STATUS_OK)
{
m_Helper.RollbackFirmwareTransaction();
m_Helper.UpdateFromFirmware(m_FirmwareCropMode);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetX);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetY);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeX);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeY);
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
nRetVal = m_Helper.CommitFirmwareTransactionAsBatch();
if (nRetVal != XN_STATUS_OK)
{
m_Helper.UpdateFromFirmware(m_FirmwareCropMode);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetX);
m_Helper.UpdateFromFirmware(m_FirmwareCropOffsetY);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeX);
m_Helper.UpdateFromFirmware(m_FirmwareCropSizeY);
xnOSLeaveCriticalSection(GetLock());
return (nRetVal);
}
}
nRetVal = m_CroppingMode.UnsafeUpdateValue(mode);
XN_ASSERT(nRetVal == XN_STATUS_OK);
nRetVal = XnDepthStream::SetCropping(pCropping);
xnOSLeaveCriticalSection(GetLock());
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}