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
134
|
#include "XnLinkOutputStreamsMgr.h"
#include "ILinkOutputStream.h"
#include "XnLinkOutputStream.h"
#include <XnLog.h>
namespace xn
{
const XnUInt16 LinkOutputStreamsMgr::INITIAL_PACKET_ID = 1;
LinkOutputStreamsMgr::LinkOutputStreamsMgr()
{
}
LinkOutputStreamsMgr::~LinkOutputStreamsMgr()
{
}
XnStatus LinkOutputStreamsMgr::Init()
{
return XN_STATUS_OK;
}
void LinkOutputStreamsMgr::Shutdown()
{
for (XnUInt16 nStreamID = 0; nStreamID < m_outputStreams.GetSize(); nStreamID++)
{
ShutdownOutputStream(nStreamID);
}
m_outputStreams.Clear();
}
XnStatus LinkOutputStreamsMgr::InitOutputStream(XnUInt16 nStreamID,
XnUInt32 nMaxMsgSize,
XnUInt16 nMaxPacketSize,
XnLinkCompressionType compression,
XnStreamFragLevel streamFragLevel,
LinkOutputDataEndpoint* pOutputDataEndpoint)
{
XnStatus nRetVal = XN_STATUS_OK;
ILinkOutputStream* pLinkOutputStream = NULL;
if (nStreamID < m_outputStreams.GetSize())
{
XN_DELETE(m_outputStreams[nStreamID]);
m_outputStreams[nStreamID] = NULL;
}
switch (streamFragLevel)
{
case XN_LINK_STREAM_FRAG_LEVEL_FRAMES:
pLinkOutputStream = XN_NEW(LinkOutputStream);
break;
default:
xnLogError(XN_MASK_LINK, "Bad stream fragmentation level %u", streamFragLevel);
XN_ASSERT(FALSE);
return XN_STATUS_ERROR;
}
XN_VALIDATE_ALLOC_PTR(pLinkOutputStream);
nRetVal = pLinkOutputStream->Init(nStreamID,
nMaxMsgSize,
nMaxPacketSize,
compression,
INITIAL_PACKET_ID,
pOutputDataEndpoint);
if (nRetVal != XN_STATUS_OK)
{
XN_DELETE(pLinkOutputStream);
xnLogError(XN_MASK_LINK, "Failed to initialize link output stream %u: %s", nStreamID, xnGetStatusString(nRetVal));
XN_ASSERT(FALSE);
return nRetVal;
}
nRetVal = m_outputStreams.Set(nStreamID, pLinkOutputStream, NULL);
if (nRetVal != XN_STATUS_OK)
{
XN_DELETE(pLinkOutputStream);
xnLogError(XN_MASK_LINK, "Failed to add to output streams array: %s", xnGetStatusString(nRetVal));
XN_ASSERT(FALSE);
return nRetVal;
}
return XN_STATUS_OK;
}
void LinkOutputStreamsMgr::ShutdownOutputStream(XnUInt16 nStreamID)
{
if (nStreamID > m_outputStreams.GetSize())
{
xnLogWarning(XN_MASK_LINK, "Stream ID %u is not in array", nStreamID);
XN_ASSERT(FALSE);
return;
}
if (m_outputStreams[nStreamID] != NULL)
{
m_outputStreams[nStreamID]->Shutdown();
XN_DELETE(m_outputStreams[nStreamID]);
m_outputStreams[nStreamID] = NULL;
}
}
XnStatus LinkOutputStreamsMgr::SendData(XnUInt16 nStreamID,
XnUInt16 nMsgType,
XnUInt16 nCID,
XnLinkFragmentation fragmentation,
const void* pData,
XnUInt32 nDataSize)
{
XnStatus nRetVal = XN_STATUS_OK;
if ((nStreamID >= m_outputStreams.GetSize()) || (m_outputStreams[nStreamID] == NULL) ||
!m_outputStreams[nStreamID]->IsInitialized())
{
xnLogError(XN_MASK_LINK, "Stream %u is not initialized", nStreamID);
XN_ASSERT(FALSE);
return XN_STATUS_NOT_INIT;
}
nRetVal = m_outputStreams[nStreamID]->SendData(nMsgType, nCID, fragmentation, pData, nDataSize);
XN_IS_STATUS_OK_LOG_ERROR("Send data on output stream", nRetVal);
return XN_STATUS_OK;
}
XnBool LinkOutputStreamsMgr::IsStreamInitialized( XnUInt16 nStreamID ) const
{
return (
nStreamID < m_outputStreams.GetSize() &&
m_outputStreams[nStreamID] != NULL &&
m_outputStreams[nStreamID]->IsInitialized());
}
}
|
