1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
|
/*****************************************************************************
* *
* OpenNI 2.x Alpha *
* Copyright (C) 2012 PrimeSense Ltd. *
* *
* This file is part of OpenNI. *
* *
* Licensed under the Apache License, Version 2.0 (the "License"); *
* you may not use this file except in compliance with the License. *
* You may obtain a copy of the License at *
* *
* http://www.apache.org/licenses/LICENSE-2.0 *
* *
* Unless required by applicable law or agreed to in writing, software *
* distributed under the License is distributed on an "AS IS" BASIS, *
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. *
* See the License for the specific language governing permissions and *
* limitations under the License. *
* *
*****************************************************************************/
//---------------------------------------------------------------------------
// Includes
//---------------------------------------------------------------------------
#include "XnDepthStream.h"
#include <XnLog.h>
//---------------------------------------------------------------------------
// Defines
//---------------------------------------------------------------------------
#define XN_DEPTH_STREAM_MAX_DEPTH_VALUE XN_MAX_UINT16
#define XN_DEPTH_STREAM_DEFAULT_PIXEL_SIZE_FACTOR 1
//---------------------------------------------------------------------------
// Code
//---------------------------------------------------------------------------
XnDepthStream::XnDepthStream(const XnChar* csName, XnBool bAllowCustomResolutions, OniDepthPixel nDeviceMaxDepth, XnUInt16 nDeviceMaxShift) :
XnPixelStream(XN_STREAM_TYPE_DEPTH, csName, bAllowCustomResolutions),
m_MinDepth(XN_STREAM_PROPERTY_MIN_DEPTH, "MinDepth"),
m_MaxDepth(XN_STREAM_PROPERTY_MAX_DEPTH, "MaxDepth", nDeviceMaxDepth),
m_ConstShift(XN_STREAM_PROPERTY_CONST_SHIFT, "ConstShift"),
m_PixelSizeFactor(XN_STREAM_PROPERTY_PIXEL_SIZE_FACTOR, "PixelSizeFactor", 1),
m_MaxShift(XN_STREAM_PROPERTY_MAX_SHIFT, "MaxShift", nDeviceMaxShift),
m_DeviceMaxDepth(XN_STREAM_PROPERTY_DEVICE_MAX_DEPTH, "DeviceMaxDepth", nDeviceMaxDepth),
m_ParamCoefficient(XN_STREAM_PROPERTY_PARAM_COEFF, "ParamCoeff"),
m_ShiftScale(XN_STREAM_PROPERTY_SHIFT_SCALE, "ShiftScale"),
m_ZeroPlaneDistance(XN_STREAM_PROPERTY_ZERO_PLANE_DISTANCE, "ZPD"),
m_ZeroPlanePixelSize(XN_STREAM_PROPERTY_ZERO_PLANE_PIXEL_SIZE, "ZPPS"),
m_EmitterDCmosDistance(XN_STREAM_PROPERTY_EMITTER_DCMOS_DISTANCE, "LDDIS"),
m_GetDCmosRCmosDistance(XN_STREAM_PROPERTY_DCMOS_RCMOS_DISTANCE, "DCRCDIS")
{
m_MinDepth.UpdateSetCallback(SetMinDepthCallback, this);
m_MaxDepth.UpdateSetCallback(SetMaxDepthCallback, this);
}
XnStatus XnDepthStream::Init()
{
XnStatus nRetVal = XN_STATUS_OK;
// init base
nRetVal = XnPixelStream::Init();
XN_IS_STATUS_OK(nRetVal);
// add properties
XN_VALIDATE_ADD_PROPERTIES(this, &m_MinDepth, &m_MaxDepth, &m_ConstShift, &m_PixelSizeFactor,
&m_MaxShift, &m_ParamCoefficient, &m_ShiftScale, &m_ZeroPlaneDistance, &m_ZeroPlanePixelSize,
&m_EmitterDCmosDistance, &m_GetDCmosRCmosDistance, &m_DeviceMaxDepth);
nRetVal = OutputFormatProperty().UnsafeUpdateValue(ONI_PIXEL_FORMAT_DEPTH_1_MM);
XN_IS_STATUS_OK(nRetVal);
nRetVal = m_S2DHelper.Init(this);
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnDepthStream::Free()
{
XnPixelStream::Free();
return (XN_STATUS_OK);
}
XnStatus XnDepthStream::SetMinDepth(OniDepthPixel nMinDepth)
{
XnStatus nRetVal = XN_STATUS_OK;
if (nMinDepth > GetDeviceMaxDepth())
{
return XN_STATUS_DEVICE_BAD_PARAM;
}
nRetVal = m_MinDepth.UnsafeUpdateValue(nMinDepth);
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnDepthStream::SetMaxDepth(OniDepthPixel nMaxDepth)
{
XnStatus nRetVal = XN_STATUS_OK;
if (nMaxDepth > GetDeviceMaxDepth())
{
return XN_STATUS_DEVICE_BAD_PARAM;
}
nRetVal = m_MaxDepth.UnsafeUpdateValue(nMaxDepth);
XN_IS_STATUS_OK(nRetVal);
return (XN_STATUS_OK);
}
XnStatus XnDepthStream::ValidateDepthValue(OniDepthPixel nDepth)
{
if (nDepth > GetDeviceMaxDepth())
{
return XN_STATUS_DEVICE_BAD_PARAM;
}
return (XN_STATUS_OK);
}
XnStatus XN_CALLBACK_TYPE XnDepthStream::SetMinDepthCallback(XnActualIntProperty* /*pSender*/, XnUInt64 nValue, void* pCookie)
{
XnDepthStream* pStream = (XnDepthStream*)pCookie;
return pStream->SetMinDepth((OniDepthPixel)nValue);
}
XnStatus XN_CALLBACK_TYPE XnDepthStream::SetMaxDepthCallback(XnActualIntProperty* /*pSender*/, XnUInt64 nValue, void* pCookie)
{
XnDepthStream* pStream = (XnDepthStream*)pCookie;
return pStream->SetMaxDepth((OniDepthPixel)nValue);
}
|
