Commit | Line | Data |
---|---|---|
24048d57 LOK |
1 | #pragma once |
2 | /* | |
3 | * This file is part of the libCEC(R) library. | |
4 | * | |
b492c10e | 5 | * libCEC(R) is Copyright (C) 2011-2012 Pulse-Eight Limited. All rights reserved. |
24048d57 LOK |
6 | * libCEC(R) is an original work, containing original code. |
7 | * | |
8 | * libCEC(R) is a trademark of Pulse-Eight Limited. | |
9 | * | |
10 | * This program is dual-licensed; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License as published by | |
12 | * the Free Software Foundation; either version 2 of the License, or | |
13 | * (at your option) any later version. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, write to the Free Software | |
22 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
23 | * | |
24 | * | |
25 | * Alternatively, you can license this library under a commercial license, | |
26 | * please contact Pulse-Eight Licensing for more information. | |
27 | * | |
28 | * For more information contact: | |
29 | * Pulse-Eight Licensing <license@pulse-eight.com> | |
30 | * http://www.pulse-eight.com/ | |
31 | * http://www.pulse-eight.net/ | |
32 | */ | |
33 | ||
34 | #include "../os.h" | |
35 | #include "../util/timeutils.h" | |
36 | ||
1d9111bd LOK |
37 | #include <ws2spi.h> |
38 | #include <ws2ipdef.h> | |
39 | #include <ws2tcpip.h> | |
40 | ||
41 | #define SHUT_RDWR SD_BOTH | |
42 | ||
43 | #ifndef ETIMEDOUT | |
44 | #define ETIMEDOUT 138 | |
45 | #endif | |
46 | ||
24048d57 LOK |
47 | namespace PLATFORM |
48 | { | |
1d9111bd LOK |
49 | #ifndef MSG_WAITALL |
50 | #define MSG_WAITALL 0x8 | |
51 | #endif | |
52 | ||
53 | inline int GetSocketError(void) | |
54 | { | |
55 | int error = WSAGetLastError(); | |
56 | switch(error) | |
57 | { | |
58 | case WSAEINPROGRESS: return EINPROGRESS; | |
59 | case WSAECONNRESET : return ECONNRESET; | |
60 | case WSAETIMEDOUT : return ETIMEDOUT; | |
61 | case WSAEWOULDBLOCK: return EAGAIN; | |
62 | default : return error; | |
63 | } | |
64 | } | |
65 | ||
99666519 LOK |
66 | // Serial port |
67 | //@{ | |
68 | inline void SerialSocketClose(serial_socket_t socket) | |
24048d57 | 69 | { |
99666519 LOK |
70 | if (socket != INVALID_HANDLE_VALUE) |
71 | CloseHandle(socket); | |
24048d57 LOK |
72 | } |
73 | ||
99666519 | 74 | inline ssize_t SerialSocketWrite(serial_socket_t socket, int *iError, void* data, size_t len) |
24048d57 | 75 | { |
642daae3 LOK |
76 | if (len != (DWORD)len) |
77 | { | |
78 | *iError = EINVAL; | |
79 | return -1; | |
80 | } | |
81 | ||
99666519 LOK |
82 | DWORD iBytesWritten(0); |
83 | if (socket != INVALID_HANDLE_VALUE) | |
84 | { | |
642daae3 | 85 | if (!WriteFile(socket, data, (DWORD)len, &iBytesWritten, NULL)) |
99666519 LOK |
86 | { |
87 | *iError = GetLastError(); | |
88 | return -1; | |
89 | } | |
90 | return (ssize_t)iBytesWritten; | |
91 | } | |
92 | ||
93 | return -1; | |
24048d57 LOK |
94 | } |
95 | ||
99666519 | 96 | inline ssize_t SerialSocketRead(serial_socket_t socket, int *iError, void* data, size_t len, uint64_t iTimeoutMs /*= 0*/) |
24048d57 | 97 | { |
642daae3 LOK |
98 | if (len != (DWORD)len) |
99 | { | |
100 | *iError = EINVAL; | |
101 | return -1; | |
102 | } | |
103 | ||
99666519 LOK |
104 | DWORD iBytesRead(0); |
105 | if (socket != INVALID_HANDLE_VALUE) | |
1d9111bd | 106 | { |
642daae3 | 107 | if(!ReadFile(socket, data, (DWORD)len, &iBytesRead, NULL) != 0) |
99666519 LOK |
108 | { |
109 | *iError = GetLastError(); | |
110 | return -1; | |
111 | } | |
112 | return (ssize_t)iBytesRead; | |
1d9111bd | 113 | } |
99666519 | 114 | return -1; |
24048d57 | 115 | } |
99666519 | 116 | //@} |
24048d57 | 117 | |
99666519 LOK |
118 | // TCP |
119 | //@{ | |
120 | inline void TcpSocketSetBlocking(tcp_socket_t socket, bool bSetTo) | |
24048d57 | 121 | { |
99666519 LOK |
122 | u_long iSetTo = bSetTo ? 0 : 1; |
123 | ioctlsocket(socket, FIONBIO, &iSetTo); | |
124 | } | |
1d9111bd | 125 | |
99666519 LOK |
126 | inline void TcpSocketClose(tcp_socket_t socket) |
127 | { | |
128 | closesocket(socket); | |
129 | } | |
1d9111bd | 130 | |
99666519 LOK |
131 | inline void TcpSocketShutdown(tcp_socket_t socket) |
132 | { | |
133 | if (socket != INVALID_SOCKET && | |
134 | socket != SOCKET_ERROR) | |
135 | shutdown(socket, SHUT_RDWR); | |
136 | } | |
137 | ||
138 | inline ssize_t TcpSocketWrite(tcp_socket_t socket, int *iError, void* data, size_t len) | |
139 | { | |
140 | if (socket == INVALID_SOCKET || | |
642daae3 LOK |
141 | socket == SOCKET_ERROR || |
142 | len != (int)len) | |
1d9111bd | 143 | { |
99666519 LOK |
144 | *iError = EINVAL; |
145 | return -1; | |
1d9111bd | 146 | } |
99666519 | 147 | |
642daae3 | 148 | ssize_t iReturn = send(socket, (char*)data, (int)len, 0); |
99666519 LOK |
149 | if (iReturn < (ssize_t)len) |
150 | *iError = errno; | |
151 | return iReturn; | |
1d9111bd LOK |
152 | } |
153 | ||
99666519 | 154 | inline ssize_t TcpSocketRead(tcp_socket_t socket, int *iError, void* data, size_t len, uint64_t iTimeoutMs /*= 0*/) |
1d9111bd | 155 | { |
99666519 LOK |
156 | int64_t iNow(0), iTarget(0); |
157 | ssize_t iBytesRead(0); | |
158 | *iError = 0; | |
1d9111bd | 159 | |
99666519 | 160 | if (socket == INVALID_SOCKET || |
642daae3 LOK |
161 | socket == SOCKET_ERROR || |
162 | len != (int)len) | |
99666519 LOK |
163 | { |
164 | *iError = EINVAL; | |
165 | return -1; | |
166 | } | |
1d9111bd | 167 | |
99666519 LOK |
168 | if (iTimeoutMs > 0) |
169 | { | |
170 | iNow = GetTimeMs(); | |
171 | iTarget = iNow + (int64_t) iTimeoutMs; | |
172 | } | |
1d9111bd | 173 | |
1d9111bd LOK |
174 | fd_set fd_read; |
175 | struct timeval tv; | |
99666519 LOK |
176 | while (iBytesRead >= 0 && iBytesRead < (ssize_t)len && (iTimeoutMs == 0 || iTarget > iNow)) |
177 | { | |
178 | if (iTimeoutMs > 0) | |
179 | { | |
180 | tv.tv_sec = (long)(iTimeoutMs / 1000); | |
181 | tv.tv_usec = 1000 * (long)(iTimeoutMs % 1000); | |
1d9111bd | 182 | |
99666519 LOK |
183 | FD_ZERO(&fd_read); |
184 | FD_SET(socket, &fd_read); | |
1d9111bd | 185 | |
642daae3 | 186 | if (select((int)socket + 1, &fd_read, NULL, NULL, &tv) == 0) |
99666519 LOK |
187 | return ETIMEDOUT; |
188 | TcpSocketSetBlocking(socket, false); | |
189 | } | |
71194cf4 | 190 | |
99666519 | 191 | ssize_t iReadResult = (iTimeoutMs > 0) ? |
642daae3 LOK |
192 | recv(socket, (char*)data + iBytesRead, (int)(len - iBytesRead), MSG_WAITALL) : |
193 | recv(socket, (char*)data, (int)len, MSG_WAITALL); | |
99666519 LOK |
194 | *iError = GetSocketError(); |
195 | if (iReadResult < 0) | |
196 | { | |
197 | if (errno == EAGAIN && iTimeoutMs > 0) | |
198 | continue; | |
199 | *iError = errno; | |
200 | return -1; | |
201 | } | |
202 | else if (iReadResult == 0 || (iReadResult != (ssize_t)len && iTimeoutMs == 0)) | |
203 | { | |
204 | *iError = ECONNRESET; | |
205 | return -1; | |
206 | } | |
1d9111bd | 207 | |
99666519 | 208 | iBytesRead += iReadResult; |
1d9111bd | 209 | |
99666519 LOK |
210 | if (iTimeoutMs > 0) |
211 | { | |
212 | TcpSocketSetBlocking(socket, true); | |
213 | iNow = GetTimeMs(); | |
214 | } | |
215 | } | |
216 | return 0; | |
217 | } | |
1d9111bd | 218 | |
99666519 LOK |
219 | inline bool TcpResolveAddress(const char *strHost, uint16_t iPort, int *iError, struct addrinfo **info) |
220 | { | |
221 | struct addrinfo hints; | |
222 | char service[33]; | |
223 | memset(&hints, 0, sizeof(hints)); | |
224 | hints.ai_family = AF_UNSPEC; | |
225 | hints.ai_socktype = SOCK_STREAM; | |
226 | hints.ai_protocol = IPPROTO_TCP; | |
227 | sprintf(service, "%d", iPort); | |
1d9111bd | 228 | |
99666519 LOK |
229 | *iError = getaddrinfo(strHost, service, &hints, info); |
230 | return !(*iError); | |
231 | } | |
1d9111bd | 232 | |
99666519 LOK |
233 | inline int TcpGetSocketError(tcp_socket_t socket) |
234 | { | |
235 | int iReturn(0); | |
236 | socklen_t optLen = sizeof(tcp_socket_t); | |
237 | getsockopt(socket, SOL_SOCKET, SO_ERROR, (char *)&iReturn, &optLen); | |
238 | return iReturn; | |
239 | } | |
1d9111bd | 240 | |
99666519 LOK |
241 | inline bool TcpSetNoDelay(tcp_socket_t socket) |
242 | { | |
243 | int iSetTo(1); | |
244 | setsockopt(socket, IPPROTO_TCP, TCP_NODELAY, (const char*)&iSetTo, sizeof(iSetTo)); | |
245 | return true; | |
246 | } | |
247 | ||
248 | inline bool TcpConnectSocket(tcp_socket_t socket, struct addrinfo* addr, int *iError, uint64_t iTimeout = 0) | |
249 | { | |
250 | TcpSocketSetBlocking(socket, false); | |
251 | ||
252 | *iError = 0; | |
642daae3 | 253 | int iConnectResult = connect(socket, addr->ai_addr, (int)addr->ai_addrlen); |
99666519 LOK |
254 | if (iConnectResult == -1) |
255 | { | |
256 | if (GetSocketError() == EINPROGRESS || | |
257 | GetSocketError() == EAGAIN) | |
1d9111bd | 258 | { |
99666519 LOK |
259 | fd_set fd_write, fd_except; |
260 | struct timeval tv; | |
261 | tv.tv_sec = (long)(iTimeout / 1000); | |
262 | tv.tv_usec = 1000 * (long)(iTimeout % 1000); | |
1d9111bd | 263 | |
99666519 LOK |
264 | FD_ZERO(&fd_write); |
265 | FD_ZERO(&fd_except); | |
266 | FD_SET(socket, &fd_write); | |
267 | FD_SET(socket, &fd_except); | |
268 | ||
269 | int iPollResult = select(sizeof(socket)*8, NULL, &fd_write, &fd_except, &tv); | |
270 | if (iPollResult == 0) | |
271 | *iError = ETIMEDOUT; | |
272 | else if (iPollResult == -1) | |
273 | *iError = GetSocketError(); | |
274 | else | |
275 | { | |
276 | socklen_t errlen = sizeof(int); | |
277 | getsockopt(socket, SOL_SOCKET, SO_ERROR, (char *)iError, &errlen); | |
278 | } | |
279 | } | |
280 | else | |
281 | { | |
282 | *iError = errno; | |
283 | } | |
1d9111bd | 284 | } |
71194cf4 | 285 | |
99666519 LOK |
286 | TcpSocketSetBlocking(socket, true); |
287 | ||
288 | return *iError == 0; | |
24048d57 LOK |
289 | } |
290 | } |