forked from avin2/SensorKinect
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathXnIONetworkStream.cpp
108 lines (88 loc) · 3.82 KB
/
XnIONetworkStream.cpp
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
/*****************************************************************************
* *
* PrimeSense Sensor 5.0 Alpha *
* Copyright (C) 2010 PrimeSense Ltd. *
* *
* This file is part of PrimeSense Common. *
* *
* PrimeSense Sensor is free software: you can redistribute it and/or modify *
* it under the terms of the GNU Lesser General Public License as published *
* by the Free Software Foundation, either version 3 of the License, or *
* (at your option) any later version. *
* *
* PrimeSense Sensor is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU Lesser General Public License for more details. *
* *
* You should have received a copy of the GNU Lesser General Public License *
* along with PrimeSense Sensor. If not, see <http://www.gnu.org/licenses/>. *
* *
*****************************************************************************/
//---------------------------------------------------------------------------
// Includes
//---------------------------------------------------------------------------
#include "XnIONetworkStream.h"
#include <XnLog.h>
#define XN_MASK_IO_NET_STREAM "IoNetStream"
//---------------------------------------------------------------------------
// Code
//---------------------------------------------------------------------------
XnIONetworkStream::XnIONetworkStream(XN_SOCKET_HANDLE hSocket) :
m_hSocket(hSocket),
m_bIsConnected(TRUE),
m_nReadTimeout(XN_WAIT_INFINITE)
{
}
XnStatus XnIONetworkStream::Init()
{
return (XN_STATUS_OK);
}
XnStatus XnIONetworkStream::Free()
{
m_bIsConnected = FALSE;
//We don't close the socket here because we don't own it - whoever opened it should be the one to close it.
return XN_STATUS_OK;
}
XnStatus XnIONetworkStream::WriteData(const XnUChar *pData, XnUInt32 nDataSize)
{
XnStatus nRetVal = XN_STATUS_OK;
nRetVal = xnOSSendNetworkBuffer(m_hSocket, (const XnChar*)pData, nDataSize);
if (nRetVal != XN_STATUS_OK)
{
m_bIsConnected = FALSE;
return (nRetVal);
}
return (XN_STATUS_OK);
}
XnStatus XnIONetworkStream::ReadData(XnUChar *pData, XnUInt32 nDataSize)
{
XnStatus nRetVal = XN_STATUS_OK;
XnUInt32 nTotalRead = 0;
// read until we get all the data we want
while (nTotalRead < nDataSize)
{
XnUInt32 nReadSize = nDataSize - nTotalRead;
nRetVal = xnOSReceiveNetworkBuffer(m_hSocket, (XnChar*)(pData + nTotalRead), &nReadSize, m_nReadTimeout);
if (nRetVal != XN_STATUS_OK)
{
if (nRetVal == XN_STATUS_OS_NETWORK_CONNECTION_CLOSED)
{
xnLogVerbose(XN_MASK_IO_NET_STREAM, "Network connection was closed gracefully");
m_bIsConnected = FALSE;
}
else if (nRetVal != XN_STATUS_OS_NETWORK_TIMEOUT)
{
xnLogError(XN_MASK_IO_NET_STREAM, "Got an error while reading network buffer: %s", xnGetStatusString(nRetVal));
m_bIsConnected = FALSE;
}
return (nRetVal);
}
nTotalRead += nReadSize;
}
return (XN_STATUS_OK);
}
void XnIONetworkStream::SetReadTimeout(XnUInt32 nMicrosecondsReadTimeout)
{
m_nReadTimeout = nMicrosecondsReadTimeout;
}