1 | |
|
|
2 | /* |
1 | /* |
3 | * static char *rcsid_sockets_c = |
2 | * This file is part of Crossfire TRT, the Multiplayer Online Role Playing Game. |
4 | * "$Id: lowlevel.C,v 1.5 2006/09/10 13:43:33 root Exp $"; |
3 | * |
|
|
4 | * Copyright (©) 2005,2006,2007 Marc Alexander Lehmann / Robin Redeker / the Crossfire TRT team |
|
|
5 | * Copyright (©) 1992,2007 Frank Tore Johansen |
|
|
6 | * |
|
|
7 | * Crossfire TRT is free software; you can redistribute it and/or modify it |
|
|
8 | * under the terms of the GNU General Public License as published by the Free |
|
|
9 | * Software Foundation; either version 2 of the License, or (at your option) |
|
|
10 | * any later version. |
|
|
11 | * |
|
|
12 | * This program is distributed in the hope that it will be useful, but |
|
|
13 | * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY |
|
|
14 | * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License |
|
|
15 | * for more details. |
|
|
16 | * |
|
|
17 | * You should have received a copy of the GNU General Public License along |
|
|
18 | * with Crossfire TRT; if not, write to the Free Software Foundation, Inc. 51 |
|
|
19 | * Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
|
|
20 | * |
|
|
21 | * The authors can be reached via e-mail to <crossfire@schmorp.de> |
5 | */ |
22 | */ |
6 | |
23 | |
7 | /* |
|
|
8 | CrossFire, A Multiplayer game for X-windows |
|
|
9 | |
|
|
10 | Copyright (C) 1992 Frank Tore Johansen |
|
|
11 | |
|
|
12 | This program is free software; you can redistribute it and/or modify |
|
|
13 | it under the terms of the GNU General Public License as published by |
|
|
14 | the Free Software Foundation; either version 2 of the License, or |
|
|
15 | (at your option) any later version. |
|
|
16 | |
|
|
17 | This program is distributed in the hope that it will be useful, |
|
|
18 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
|
19 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
|
20 | GNU General Public License for more details. |
|
|
21 | |
|
|
22 | You should have received a copy of the GNU General Public License |
|
|
23 | along with this program; if not, write to the Free Software |
|
|
24 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
|
|
25 | |
|
|
26 | The author can be reached via e-mail to mark@pyramid.com |
|
|
27 | */ |
|
|
28 | |
|
|
29 | /** |
|
|
30 | * \file |
|
|
31 | * Low-level socket-related functions. |
|
|
32 | * |
|
|
33 | * \date 2003-12-02 |
|
|
34 | * |
|
|
35 | * Contains some base functions that both the client and server |
|
|
36 | * can use. As such, depending what we are being compiled for will |
|
|
37 | * determine what we can include. the client is designed have |
|
|
38 | * CFCLIENT defined as part of its compile flags. |
|
|
39 | */ |
|
|
40 | |
|
|
41 | using namespace std; |
24 | using namespace std; |
42 | |
25 | |
43 | #include <global.h> |
26 | #include <global.h> |
44 | #include <newclient.h> |
|
|
45 | #include <sproto.h> |
27 | #include <sproto.h> |
|
|
28 | #include <cstdarg> |
46 | |
29 | |
47 | #ifdef __linux__ |
30 | #if HAVE_TCP_INFO |
48 | # include <sys/types.h> |
31 | # include <sys/types.h> |
49 | # include <sys/socket.h> |
32 | # include <sys/socket.h> |
50 | # include <netinet/in.h> |
33 | # include <netinet/in.h> |
51 | # define TCP_HZ 1000 // sorry... |
|
|
52 | # include <netinet/tcp.h> |
34 | # include <netinet/tcp.h> |
53 | #endif |
35 | #endif |
54 | |
36 | |
55 | // use a really low timeout, as it doesn't cost any bandwidth, and you can |
37 | // disconnect a socket after this many seconds without an ack |
56 | // easily die in 20 seconds... |
|
|
57 | #define SOCKET_TIMEOUT1 10 |
38 | #define SOCKET_TIMEOUT 8. |
58 | #define SOCKET_TIMEOUT2 20 |
|
|
59 | |
39 | |
|
|
40 | // force a packet when idle for more than this many seconds, |
|
|
41 | // forcing an ack regularly. |
|
|
42 | #define IDLE_PING 2. |
|
|
43 | |
60 | void |
44 | void |
61 | Socket_Flush (NewSocket * ns) |
45 | client::flush () |
62 | { |
46 | { |
63 | #ifdef __linux__ |
47 | if (destroyed ()) |
|
|
48 | return; |
|
|
49 | |
|
|
50 | #if HAVE_TCP_INFO |
|
|
51 | // check about once per second, spread evenly over all clients |
|
|
52 | if (!((pticks + fd) & 7)) |
|
|
53 | { |
64 | // check time of last ack, and, if too old, kill connection |
54 | // check time of last ack, and, if too old, kill connection |
65 | struct tcp_info tcpi; |
55 | struct tcp_info tcpi; |
66 | socklen_t len = sizeof (tcpi); |
56 | socklen_t len = sizeof (tcpi); |
67 | |
57 | |
68 | if (!getsockopt (ns->fd, IPPROTO_TCP, TCP_INFO, &tcpi, &len) && len == sizeof (tcpi)) |
58 | if (!getsockopt (fd, IPPROTO_TCP, TCP_INFO, &tcpi, &len) && len == sizeof (tcpi)) |
69 | { |
59 | { |
70 | unsigned int diff = tcpi.tcpi_last_ack_recv - tcpi.tcpi_last_data_sent; |
60 | rtt = tcpi.tcpi_rtt; |
|
|
61 | rttvar = tcpi.tcpi_rttvar; |
71 | |
62 | |
72 | if (tcpi.tcpi_unacked && SOCKET_TIMEOUT1 * TCP_HZ < diff && diff < 0x80000000UL // ack delayed for 20s |
63 | if (tcpi.tcpi_last_ack_recv > int (SOCKET_TIMEOUT * 1000)) |
73 | && SOCKET_TIMEOUT2 * TCP_HZ < tcpi.tcpi_last_data_sent) // no data sent for 10s |
|
|
74 | { |
64 | { |
|
|
65 | send_msg (NDI_RED, "connection-timeout", "safety disconnect due to tcp/ip timeout (no packets received)"); |
|
|
66 | write_outputbuffer (); |
|
|
67 | |
75 | LOG (llevDebug, "Connection on fd %d closed due to ack timeout (%u/%u/%u)\n", ns->fd, |
68 | LOG (llevDebug, "connection on fd %d closed due to ack timeout (%u/%u/%u)\n", fd, |
76 | (unsigned) tcpi.tcpi_last_ack_recv, (unsigned) tcpi.tcpi_last_data_sent, (unsigned) tcpi.tcpi_unacked); |
69 | (unsigned)tcpi.tcpi_last_ack_recv, (unsigned)tcpi.tcpi_last_data_sent, (unsigned)tcpi.tcpi_unacked); |
77 | ns->status = Ns_Dead; |
70 | destroy (); |
78 | } |
71 | } |
|
|
72 | } |
79 | } |
73 | } |
80 | |
|
|
81 | int val; |
|
|
82 | |
|
|
83 | val = 0; |
|
|
84 | setsockopt (ns->fd, IPPROTO_TCP, TCP_CORK, &val, sizeof (val)); |
|
|
85 | val = 1; |
|
|
86 | setsockopt (ns->fd, IPPROTO_TCP, TCP_CORK, &val, sizeof (val)); |
|
|
87 | #endif |
74 | #endif |
88 | } |
|
|
89 | |
75 | |
90 | /*********************************************************************** |
76 | /** |
91 | * |
77 | * Writes data to socket. |
92 | * SockList functions/utilities |
78 | * |
93 | * |
79 | * When the socket is clear to write, and we have backlogged data, this |
94 | **********************************************************************/ |
80 | * is called to write it out. |
95 | |
|
|
96 | void |
|
|
97 | SockList_Init (SockList * sl) |
|
|
98 | { |
|
|
99 | sl->len = 0; |
|
|
100 | sl->buf = NULL; |
|
|
101 | } |
|
|
102 | |
|
|
103 | void |
|
|
104 | SockList_AddInt (SockList * sl, uint32 data) |
|
|
105 | { |
|
|
106 | sl->buf[sl->len++] = (data >> 24) & 0xff; |
|
|
107 | sl->buf[sl->len++] = (data >> 16) & 0xff; |
|
|
108 | sl->buf[sl->len++] = (data >> 8) & 0xff; |
|
|
109 | sl->buf[sl->len++] = data & 0xff; |
|
|
110 | } |
|
|
111 | |
|
|
112 | void |
|
|
113 | SockList_AddInt64 (SockList * sl, uint64 data) |
|
|
114 | { |
|
|
115 | sl->buf[sl->len++] = (char) ((data >> 56) & 0xff); |
|
|
116 | sl->buf[sl->len++] = (char) ((data >> 48) & 0xff); |
|
|
117 | sl->buf[sl->len++] = (char) ((data >> 40) & 0xff); |
|
|
118 | sl->buf[sl->len++] = (char) ((data >> 32) & 0xff); |
|
|
119 | |
|
|
120 | sl->buf[sl->len++] = (char) ((data >> 24) & 0xff); |
|
|
121 | sl->buf[sl->len++] = (char) ((data >> 16) & 0xff); |
|
|
122 | sl->buf[sl->len++] = (char) ((data >> 8) & 0xff); |
|
|
123 | sl->buf[sl->len++] = (char) (data & 0xff); |
|
|
124 | } |
|
|
125 | |
|
|
126 | /* Basically does the reverse of SockList_AddInt, but on |
|
|
127 | * strings instead. Same for the GetShort, but for 16 bits. |
|
|
128 | */ |
81 | */ |
129 | int |
|
|
130 | GetInt_String (unsigned char *data) |
|
|
131 | { |
|
|
132 | return ((data[0] << 24) + (data[1] << 16) + (data[2] << 8) + data[3]); |
|
|
133 | } |
|
|
134 | |
82 | |
135 | short |
83 | // write a nop to the socket at least every IDLE_NOP seconds. |
136 | GetShort_String (unsigned char *data) |
84 | if (!outputbuffer.len) |
|
|
85 | { |
|
|
86 | if (last_send + IDLE_PING <= NOW) |
|
|
87 | { |
|
|
88 | // this is a bit ugly, but map1/map1a seem to be the only |
|
|
89 | // nop'able commands and they are quite small. |
|
|
90 | packet sl (mapmode == Map1Cmd ? "map1" : "map1a"); |
|
|
91 | send_packet (sl); |
|
|
92 | } |
|
|
93 | else |
|
|
94 | return; |
|
|
95 | } |
|
|
96 | |
|
|
97 | if (socket_ev.poll () & PE_W) |
|
|
98 | return; |
|
|
99 | |
|
|
100 | last_send = NOW; |
|
|
101 | write_outputbuffer (); |
|
|
102 | } |
|
|
103 | |
|
|
104 | void |
|
|
105 | client::write_outputbuffer () |
137 | { |
106 | { |
138 | return ((data[0] << 8) + data[1]); |
107 | while (outputbuffer.len) |
|
|
108 | { |
|
|
109 | int res = write (fd, outputbuffer.data + outputbuffer.start, |
|
|
110 | min (outputbuffer.len, SOCKETBUFSIZE - outputbuffer.start)); |
|
|
111 | |
|
|
112 | if (res > 0) |
|
|
113 | { |
|
|
114 | outputbuffer.start += res; |
|
|
115 | /* wrap back to start of buffer */ |
|
|
116 | if (outputbuffer.start == SOCKETBUFSIZE) |
|
|
117 | outputbuffer.start = 0; |
|
|
118 | |
|
|
119 | outputbuffer.len -= res; |
|
|
120 | } |
|
|
121 | else if (res == 0) |
|
|
122 | { |
|
|
123 | LOG (llevError, "socket write failed, connection closed.\n"); |
|
|
124 | destroy (); |
|
|
125 | return; |
|
|
126 | } |
|
|
127 | else if (errno == EINTR) |
|
|
128 | { |
|
|
129 | // just retry |
|
|
130 | } |
|
|
131 | else if (errno == EAGAIN) |
|
|
132 | { |
|
|
133 | // delay till ready |
|
|
134 | socket_ev.poll (socket_ev.poll () | PE_W); |
|
|
135 | socket_ev.start (); |
|
|
136 | return; |
|
|
137 | } |
|
|
138 | else |
|
|
139 | { |
|
|
140 | LOG (llevError, "socket write failed: %s\n", strerror (errno)); |
|
|
141 | destroy (); |
|
|
142 | return; |
|
|
143 | } |
|
|
144 | } |
|
|
145 | |
|
|
146 | socket_ev.poll (socket_ev.poll () & ~PE_W); |
139 | } |
147 | } |
140 | |
148 | |
141 | /****************************************************************************** |
149 | /****************************************************************************** |
142 | * |
150 | * |
143 | * Start of read routines. |
151 | * Start of read routines. |
144 | * |
152 | * |
145 | ******************************************************************************/ |
153 | ******************************************************************************/ |
146 | |
154 | |
|
|
155 | int |
|
|
156 | client::next_packet () |
|
|
157 | { |
|
|
158 | if (inbuf_len >= 2) |
|
|
159 | { |
|
|
160 | int pkt_len = (inbuf [0] << 8) | inbuf [1]; |
|
|
161 | |
|
|
162 | if (inbuf_len >= 2 + pkt_len) |
|
|
163 | return 2 + pkt_len; |
|
|
164 | |
|
|
165 | if (inbuf_len == sizeof (inbuf)) |
|
|
166 | { |
|
|
167 | send_packet_printf ("drawinfo %d input buffer overflow - closing connection.", NDI_RED); |
|
|
168 | destroy (); |
|
|
169 | return -1; |
|
|
170 | } |
|
|
171 | } |
|
|
172 | |
|
|
173 | return 0; |
|
|
174 | } |
|
|
175 | |
|
|
176 | void |
|
|
177 | client::skip_packet (int len) |
|
|
178 | { |
|
|
179 | inbuf_len -= len; |
|
|
180 | memmove (inbuf, inbuf + len, inbuf_len); |
|
|
181 | } |
|
|
182 | |
|
|
183 | /***************************************************************************** |
|
|
184 | * Start of command dispatch area. |
|
|
185 | * The commands here are protocol commands. |
|
|
186 | ****************************************************************************/ |
|
|
187 | |
|
|
188 | // SocketCommand, PlayingCommand, should not exist with those ugly casts |
|
|
189 | #define SC(cb) (void *)static_cast<void (*)(char *, int, client *)>(cb), |
|
|
190 | #define PC(cb) (void *)static_cast<void (*)(char *, int, player *)>(cb), PF_PLAYER | |
|
|
191 | |
147 | /** |
192 | /** |
148 | * This reads from fd and puts the data in sl. We return true if we think |
193 | * Dispatch table for the server. |
149 | * we have a full packet, 0 if we have a partial packet. The only processing |
|
|
150 | * we do is remove the intial size value. len (As passed) is the size of the |
|
|
151 | * buffer allocated in the socklist. We make the assumption the buffer is |
|
|
152 | * at least 2 bytes long. |
|
|
153 | */ |
194 | */ |
|
|
195 | static struct packet_type packets[] = { |
|
|
196 | {"ncom", PC(NewPlayerCmd) PF_PLAYING | PF_COMMAND6 }, |
|
|
197 | {"command", PC(PlayerCmd) PF_PLAYING | PF_COMMAND0 }, |
154 | |
198 | |
155 | int |
199 | {"examine", PC(ExamineCmd) PF_PLAYING }, |
156 | SockList_ReadPacket (int fd, SockList * sl, int len) |
200 | {"ex", PC(ExCmd) PF_PLAYING }, |
157 | { |
201 | {"apply", PC(ApplyCmd) PF_PLAYING }, |
158 | int stat, toread; |
202 | {"lookat", PC(LookAt) PF_PLAYING }, |
|
|
203 | {"lock", PC(LockItem) PF_PLAYING }, |
|
|
204 | {"mark", PC(MarkItem) PF_PLAYING }, |
|
|
205 | {"move", PC(MoveCmd) PF_PLAYING }, |
|
|
206 | {"ext", PC(ExtCmd) 0 }, // CF+ |
|
|
207 | {"mapredraw", PC(MapRedrawCmd) 0 }, |
|
|
208 | {"mapinfo", PC(MapInfoCmd) 0 }, // CF+ |
159 | |
209 | |
160 | /* Sanity check - shouldn't happen */ |
210 | {"reply", SC(ReplyCmd) 0 }, |
161 | if (sl->len < 0) |
211 | {"exti", SC(ExtiCmd) 0 }, // CF+ |
162 | { |
212 | {"addme", SC(AddMeCmd) 0 }, |
163 | abort (); |
213 | {"askface", SC(AskFaceCmd) 0 }, |
|
|
214 | {"requestinfo", SC(RequestInfo) 0 }, |
|
|
215 | {"setfacemode", SC(SetFaceMode) 0 }, |
|
|
216 | {"setsound", SC(SetSound) 0 }, |
|
|
217 | {"setup", SC(SetUp) 0 }, |
|
|
218 | {"version", SC(VersionCmd) 0 }, |
|
|
219 | {"toggleextendedinfos", SC(ToggleExtendedInfos) 0 }, /*Added: tchize */ |
|
|
220 | {"toggleextendedtext", SC(ToggleExtendedText) 0 }, /*Added: tchize */ |
|
|
221 | {"asksmooth", SC(AskSmooth) 0 }, /*Added: tchize (smoothing technologies) */ |
|
|
222 | }; |
|
|
223 | |
|
|
224 | bool |
|
|
225 | client::may_execute (const packet_type *pkt) const |
|
|
226 | { |
|
|
227 | return (!(pkt->flags & PF_PLAYER) || pl) |
|
|
228 | && (!(pkt->flags & PF_PLAYING) || state == ST_PLAYING); |
|
|
229 | } |
|
|
230 | |
|
|
231 | // HACK: some commands currently should be executed |
|
|
232 | // even when the player is frozen. this hack detects |
|
|
233 | // those commands. it should be folded into may_execute, |
|
|
234 | // but kept seperate to emphasise the hack aspect, i.e. |
|
|
235 | // do it better, then remove. |
|
|
236 | static bool |
|
|
237 | always_immediate (const client *ns, const packet_type *pkt, const char *data, int len) |
|
|
238 | { |
|
|
239 | if (!(pkt->flags & (PF_COMMAND0 | PF_COMMAND6))) |
|
|
240 | return false; |
|
|
241 | |
|
|
242 | if (!ns->pl || !ns->pl->ob || !ns->pl->ob->map) |
|
|
243 | return false; |
|
|
244 | |
|
|
245 | if (pkt->flags & PF_COMMAND6) |
164 | } |
246 | { |
165 | /* We already have a partial packet */ |
247 | data += 6; |
166 | if (sl->len < 2) |
248 | len -= 6; |
167 | { |
249 | } |
168 | #ifdef WIN32 /* ***WIN32 SockList_ReadPacket: change read() to recv() */ |
|
|
169 | |
250 | |
170 | stat = recv (fd, sl->buf + sl->len, 2 - sl->len, 0); |
251 | if (len > 4 && !strncmp (data, "say " , 4)) |
|
|
252 | return true; |
|
|
253 | if (len > 5 && !strncmp (data, "chat ", 5)) |
|
|
254 | return true; |
171 | |
255 | |
172 | #else |
256 | return false; |
173 | do |
257 | } |
|
|
258 | |
|
|
259 | void |
|
|
260 | client::execute (const packet_type *pkt, char *data, int datalen) |
|
|
261 | { |
|
|
262 | if (may_execute (pkt) || always_immediate (this, pkt, data, datalen)) |
|
|
263 | { |
|
|
264 | //TODO: only one format |
|
|
265 | if (pkt->flags & PF_PLAYER) |
|
|
266 | ((void (*)(char *, int, player *))pkt->cb)((char *)data, datalen, pl); |
|
|
267 | else |
|
|
268 | ((void (*)(char *, int, client *))pkt->cb)((char *)data, datalen, this); |
|
|
269 | } |
|
|
270 | else |
|
|
271 | send_packet_printf ("drawinfo %d ERROR: you cannot execute '%s' now.", NDI_RED, pkt->name); |
|
|
272 | } |
|
|
273 | |
|
|
274 | bool |
|
|
275 | client::handle_packet () |
|
|
276 | { |
|
|
277 | int pkt_len = next_packet (); |
|
|
278 | |
|
|
279 | if (!pkt_len) |
|
|
280 | return false; |
|
|
281 | else if (pkt_len < 0) |
|
|
282 | { |
|
|
283 | LOG (llevError, "read error on player %s\n", |
|
|
284 | pl && pl->ob ? &pl->ob->name : "[anonymous]"); |
|
|
285 | destroy (); |
|
|
286 | return false; |
|
|
287 | } |
|
|
288 | |
|
|
289 | inbuf [pkt_len] = 0; /* Terminate buffer - useful for string data */ |
|
|
290 | |
|
|
291 | /* First, break out beginning word. There are at least |
|
|
292 | * a few commands that do not have any paremeters. If |
|
|
293 | * we get such a command, don't worry about trying |
|
|
294 | * to break it up. |
|
|
295 | */ |
|
|
296 | int datalen; |
|
|
297 | char *data = strchr ((char *)inbuf + 2, ' '); |
|
|
298 | |
|
|
299 | if (data) |
|
|
300 | { |
|
|
301 | *data++ = 0; |
|
|
302 | datalen = pkt_len - (data - (char *)inbuf); |
|
|
303 | } |
|
|
304 | else |
|
|
305 | { |
|
|
306 | data = (char *)inbuf + 2; // better read garbage than segfault |
|
|
307 | datalen = 0; |
|
|
308 | } |
|
|
309 | |
|
|
310 | for (packet_type *pkt = packets; pkt < packets + (sizeof (packets) / sizeof (packets[0])); ++pkt) |
|
|
311 | if (!strcmp ((char *)inbuf + 2, pkt->name)) |
174 | { |
312 | { |
175 | stat = read (fd, sl->buf + sl->len, 2 - sl->len); |
313 | if (pkt->flags & PF_PLAYER && !always_immediate (this, pkt, data, datalen)) |
|
|
314 | queue_command (pkt, data, datalen); |
|
|
315 | else |
|
|
316 | execute (pkt, data, datalen); |
|
|
317 | |
|
|
318 | goto next_packet; |
|
|
319 | } |
|
|
320 | |
|
|
321 | // If we get here, we didn't find a valid command. |
|
|
322 | send_packet_printf ("drawinfo %d ERROR: command '%s' not supported.", NDI_RED, (char *)inbuf + 2); |
|
|
323 | next_packet: |
|
|
324 | skip_packet (pkt_len); |
|
|
325 | |
|
|
326 | // input buffer has space again |
|
|
327 | socket_ev.poll (socket_ev.poll () | PE_R); |
|
|
328 | |
|
|
329 | return true; |
|
|
330 | } |
|
|
331 | |
|
|
332 | // callback called when socket is either readable or writable |
|
|
333 | void |
|
|
334 | client::socket_cb (iow &w, int got) |
|
|
335 | { |
|
|
336 | //TODO remove when we have better socket cleanup logic |
|
|
337 | if (destroyed ()) |
|
|
338 | { |
|
|
339 | socket_ev.poll (0); |
|
|
340 | return; |
|
|
341 | } |
|
|
342 | |
|
|
343 | if (got & PE_W) |
|
|
344 | { |
|
|
345 | write_outputbuffer (); |
|
|
346 | |
|
|
347 | if (!outputbuffer.len) |
|
|
348 | socket_ev.poll (socket_ev.poll () & ~PE_W); |
|
|
349 | } |
|
|
350 | |
|
|
351 | if (got & PE_R) |
|
|
352 | { |
|
|
353 | //TODO: rate-limit tcp connection in better ways, important |
|
|
354 | |
|
|
355 | int amount = sizeof (inbuf) - inbuf_len; |
|
|
356 | |
|
|
357 | if (!amount) |
176 | } |
358 | { |
177 | while ((stat == -1) && (errno == EINTR)); |
359 | // input buffer full |
178 | #endif |
360 | socket_ev.poll (socket_ev.poll () & ~PE_R); |
179 | if (stat < 0) |
361 | return; |
180 | { |
362 | } |
181 | /* In non blocking mode, EAGAIN is set when there is no |
363 | |
182 | * data available. |
364 | amount = read (fd, inbuf + inbuf_len, amount); |
183 | */ |
365 | |
184 | #ifdef WIN32 /* ***WIN32 SockList_ReadPacket: error handling for win32 */ |
366 | if (!amount) |
185 | if ((stat == -1) && WSAGetLastError () != WSAEWOULDBLOCK) |
367 | { |
|
|
368 | destroy (); |
|
|
369 | return; |
|
|
370 | } |
|
|
371 | else if (amount < 0) |
|
|
372 | { |
|
|
373 | if (errno != EAGAIN && errno != EINTR) |
186 | { |
374 | { |
187 | if (WSAGetLastError () == WSAECONNRESET) |
375 | LOG (llevError, "read error: %s\n", strerror (errno)); |
188 | LOG (llevDebug, "Connection closed by client\n"); |
376 | destroy (); |
189 | else |
377 | return; |
190 | { |
|
|
191 | LOG (llevDebug, "ReadPacket got error %d, returning 0\n", WSAGetLastError ()); |
|
|
192 | } |
|
|
193 | return -1; /* kick this user! */ |
|
|
194 | } |
378 | } |
195 | #else |
|
|
196 | if (errno != EAGAIN && errno != EWOULDBLOCK) |
|
|
197 | { |
|
|
198 | LOG (llevDebug, "ReadPacket got error %s, returning 0\n", strerror (errno)); |
|
|
199 | } |
|
|
200 | #endif |
|
|
201 | return 0; /*Error */ |
|
|
202 | } |
|
|
203 | if (stat == 0) |
|
|
204 | return -1; |
|
|
205 | sl->len += stat; |
|
|
206 | #ifdef CS_LOGSTATS |
|
|
207 | cst_tot.ibytes += stat; |
|
|
208 | cst_lst.ibytes += stat; |
|
|
209 | #endif |
|
|
210 | if (stat < 2) |
|
|
211 | return 0; /* Still don't have a full packet */ |
|
|
212 | } |
|
|
213 | /* Figure out how much more data we need to read. Add 2 from the |
|
|
214 | * end of this - size header information is not included. |
|
|
215 | */ |
|
|
216 | toread = 2 + (sl->buf[0] << 8) + sl->buf[1] - sl->len; |
|
|
217 | if ((toread + sl->len) >= len) |
|
|
218 | { |
|
|
219 | LOG (llevError, "SockList_ReadPacket: Want to read more bytes than will fit in buffer (%d>=%d).\n", toread + sl->len, len); |
|
|
220 | /* Quick hack in case for 'oldsocketmode' input. If we are |
|
|
221 | * closing the socket anyways, then reading this extra 100 bytes |
|
|
222 | * shouldn't hurt. |
|
|
223 | */ |
|
|
224 | #ifdef WIN32 /* ***win32 SockList_ReadPacket: change read() to recv() */ |
|
|
225 | recv (fd, sl->buf + 2, 100, 0); |
|
|
226 | #else |
|
|
227 | read (fd, sl->buf + 2, 100); |
|
|
228 | #endif /* end win32 */ |
|
|
229 | |
379 | |
230 | /* return error so the socket is closed */ |
380 | // should not be here, normally |
231 | return -1; |
|
|
232 | } |
|
|
233 | do |
|
|
234 | { |
|
|
235 | #ifdef WIN32 /* ***win32 SockList_ReadPacket: change read() to recv() */ |
|
|
236 | stat = recv (fd, sl->buf + sl->len, toread, 0); |
|
|
237 | #else |
|
|
238 | do |
|
|
239 | { |
381 | } |
240 | stat = read (fd, sl->buf + sl->len, toread); |
382 | else |
241 | } |
383 | { |
242 | while ((stat < 0) && (errno == EINTR)); |
384 | inbuf_len += amount; |
243 | #endif |
385 | |
244 | if (stat < 0) |
386 | cmd_ev.start (); |
245 | { |
387 | } |
246 | |
|
|
247 | #ifdef WIN32 /* ***win32 SockList_ReadPacket: change error handling for win32 */ |
|
|
248 | if ((stat == -1) && WSAGetLastError () != WSAEWOULDBLOCK) |
|
|
249 | { |
|
|
250 | if (WSAGetLastError () == WSAECONNRESET) |
|
|
251 | LOG (llevDebug, "Connection closed by client\n"); |
|
|
252 | else |
|
|
253 | { |
|
|
254 | LOG (llevDebug, "ReadPacket got error %d, returning 0\n", WSAGetLastError ()); |
|
|
255 | } |
|
|
256 | return -1; /* kick this user! */ |
|
|
257 | } |
|
|
258 | #else |
|
|
259 | if (errno != EAGAIN && errno != EWOULDBLOCK) |
|
|
260 | { |
|
|
261 | LOG (llevDebug, "ReadPacket got error %s, returning 0\n", strerror (errno)); |
|
|
262 | } |
|
|
263 | #endif |
|
|
264 | return 0; /*Error */ |
|
|
265 | } |
|
|
266 | if (stat == 0) |
|
|
267 | return -1; |
|
|
268 | sl->len += stat; |
|
|
269 | #ifdef CS_LOGSTATS |
|
|
270 | cst_tot.ibytes += stat; |
|
|
271 | cst_lst.ibytes += stat; |
|
|
272 | #endif |
|
|
273 | toread -= stat; |
|
|
274 | if (toread == 0) |
|
|
275 | return 1; |
|
|
276 | if (toread < 0) |
|
|
277 | { |
|
|
278 | LOG (llevError, "SockList_ReadPacket: Read more bytes than desired.\n"); |
|
|
279 | return 1; |
|
|
280 | } |
|
|
281 | } |
388 | } |
282 | while (toread > 0); |
389 | } |
283 | return 0; |
390 | |
|
|
391 | // called whenever we have additional commands to process |
|
|
392 | void |
|
|
393 | client::cmd_cb (iw &w) |
|
|
394 | { |
|
|
395 | if (handle_packet ()) |
|
|
396 | w.start (); |
|
|
397 | else |
|
|
398 | flush (); |
284 | } |
399 | } |
285 | |
400 | |
286 | /******************************************************************************* |
401 | /******************************************************************************* |
287 | * |
402 | * |
288 | * Start of write related routines. |
403 | * Start of write related routines. |
… | |
… | |
293 | * Adds data to a socket buffer for whatever reason. |
408 | * Adds data to a socket buffer for whatever reason. |
294 | * |
409 | * |
295 | * ns is the socket we are adding the data to, buf is the start of the |
410 | * ns is the socket we are adding the data to, buf is the start of the |
296 | * data, and len is the number of bytes to add. |
411 | * data, and len is the number of bytes to add. |
297 | */ |
412 | */ |
298 | |
413 | void |
299 | static void |
414 | client::send (void *buf_, int len) |
300 | add_to_buffer (NewSocket * ns, char *buf, int len) |
|
|
301 | { |
415 | { |
|
|
416 | char *buf = (char *)buf_; |
|
|
417 | |
|
|
418 | if (destroyed () || !buf) |
|
|
419 | return; |
|
|
420 | |
|
|
421 | if (len + outputbuffer.len > SOCKETBUFSIZE) |
|
|
422 | { |
|
|
423 | LOG (llevDebug, "socket on fd %d has overrun internal buffer - marking as dead\n", fd); |
|
|
424 | // shutdown the socket, this is safer than destroying it immediately |
|
|
425 | // as lots of code in the callchain might still access the map etc. |
|
|
426 | shutdown (fd, SHUT_RDWR); |
|
|
427 | return; |
|
|
428 | } |
|
|
429 | |
302 | int avail, end; |
430 | int avail, end; |
303 | |
|
|
304 | if ((len + ns->outputbuffer.len) > SOCKETBUFSIZE) |
|
|
305 | { |
|
|
306 | LOG (llevDebug, "Socket on fd %d has overrun internal buffer - marking as dead\n", ns->fd); |
|
|
307 | ns->status = Ns_Dead; |
|
|
308 | return; |
|
|
309 | } |
|
|
310 | |
431 | |
311 | /* data + end is where we start putting the new data. The last byte |
432 | /* data + end is where we start putting the new data. The last byte |
312 | * currently in use is actually data + end -1 |
433 | * currently in use is actually data + end -1 |
313 | */ |
434 | */ |
314 | |
|
|
315 | end = ns->outputbuffer.start + ns->outputbuffer.len; |
435 | end = outputbuffer.start + outputbuffer.len; |
316 | /* The buffer is already in a wrapped state, so adjust end */ |
436 | /* The buffer is already in a wrapped state, so adjust end */ |
317 | if (end >= SOCKETBUFSIZE) |
437 | if (end >= SOCKETBUFSIZE) |
318 | end -= SOCKETBUFSIZE; |
438 | end -= SOCKETBUFSIZE; |
|
|
439 | |
319 | avail = SOCKETBUFSIZE - end; |
440 | avail = SOCKETBUFSIZE - end; |
320 | |
441 | |
321 | /* We can all fit it behind the current data without wrapping */ |
442 | /* We can all fit it behind the current data without wrapping */ |
322 | if (avail >= len) |
443 | if (avail >= len) |
323 | { |
|
|
324 | memcpy (ns->outputbuffer.data + end, buf, len); |
444 | memcpy (outputbuffer.data + end, buf, len); |
325 | } |
|
|
326 | else |
445 | else |
327 | { |
446 | { |
328 | memcpy (ns->outputbuffer.data + end, buf, avail); |
447 | memcpy (outputbuffer.data + end, buf, avail); |
329 | memcpy (ns->outputbuffer.data, buf + avail, len - avail); |
448 | memcpy (outputbuffer.data, buf + avail, len - avail); |
330 | } |
449 | } |
|
|
450 | |
331 | ns->outputbuffer.len += len; |
451 | outputbuffer.len += len; |
332 | #if 0 |
|
|
333 | LOG (llevDebug, "Added %d to output buffer, total length now %d, start=%d\n", len, ns->outputbuffer.len, ns->outputbuffer.start); |
|
|
334 | #endif |
|
|
335 | } |
452 | } |
336 | |
|
|
337 | /** |
|
|
338 | * Writes data to socket. |
|
|
339 | * |
|
|
340 | * When the socket is clear to write, and we have backlogged data, this |
|
|
341 | * is called to write it out. |
|
|
342 | */ |
|
|
343 | void |
|
|
344 | write_socket_buffer (NewSocket * ns) |
|
|
345 | { |
|
|
346 | int amt, max; |
|
|
347 | |
|
|
348 | if (ns->outputbuffer.len == 0) |
|
|
349 | { |
|
|
350 | LOG (llevDebug, "write_socket_buffer called when there is no data, fd=%d\n", ns->fd); |
|
|
351 | return; |
|
|
352 | } |
|
|
353 | |
|
|
354 | do |
|
|
355 | { |
|
|
356 | max = SOCKETBUFSIZE - ns->outputbuffer.start; |
|
|
357 | if (ns->outputbuffer.len < max) |
|
|
358 | max = ns->outputbuffer.len; |
|
|
359 | |
|
|
360 | #ifdef WIN32 /* ***win32 write_socket_buffer: change write() to send() */ |
|
|
361 | amt = send (ns->fd, ns->outputbuffer.data + ns->outputbuffer.start, max, 0); |
|
|
362 | #else |
|
|
363 | do |
|
|
364 | { |
|
|
365 | amt = write (ns->fd, ns->outputbuffer.data + ns->outputbuffer.start, max); |
|
|
366 | } |
|
|
367 | while ((amt < 0) && (errno == EINTR)); |
|
|
368 | #endif |
|
|
369 | |
|
|
370 | if (amt < 0) |
|
|
371 | { /* We got an error */ |
|
|
372 | |
|
|
373 | #ifdef WIN32 /* ***win32 write_socket_buffer: change error handling */ |
|
|
374 | if (amt == -1 && WSAGetLastError () != WSAEWOULDBLOCK) |
|
|
375 | { |
|
|
376 | LOG (llevError, "New socket write failed (wsb) (%d).\n", WSAGetLastError ()); |
|
|
377 | #else |
|
|
378 | if (errno != EWOULDBLOCK) |
|
|
379 | { |
|
|
380 | LOG (llevError, "New socket write failed (wsb) (%d: %s).\n", errno, strerror (errno)); |
|
|
381 | #endif |
|
|
382 | ns->status = Ns_Dead; |
|
|
383 | return; |
|
|
384 | } |
|
|
385 | else |
|
|
386 | { /* EWOULDBLOCK */ |
|
|
387 | /* can't write it, so store it away. */ |
|
|
388 | ns->can_write = 0; |
|
|
389 | return; |
|
|
390 | } |
|
|
391 | } |
|
|
392 | ns->outputbuffer.start += amt; |
|
|
393 | /* wrap back to start of buffer */ |
|
|
394 | if (ns->outputbuffer.start == SOCKETBUFSIZE) |
|
|
395 | ns->outputbuffer.start = 0; |
|
|
396 | ns->outputbuffer.len -= amt; |
|
|
397 | #ifdef CS_LOGSTATS |
|
|
398 | cst_tot.obytes += amt; |
|
|
399 | cst_lst.obytes += amt; |
|
|
400 | #endif |
|
|
401 | } |
|
|
402 | while (ns->outputbuffer.len > 0); |
|
|
403 | } |
|
|
404 | |
|
|
405 | /** |
|
|
406 | * This writes data to the socket. - It is very low level - |
|
|
407 | * all we try and do is write out the data to the socket |
|
|
408 | * provided (ns). buf is the data to write, len is the number |
|
|
409 | * of bytes to write. IT doesn't return anything - rather, it |
|
|
410 | * updates the ns structure if we get an error. |
|
|
411 | */ |
|
|
412 | void |
|
|
413 | Write_To_Socket (NewSocket * ns, char *buf, int len) |
|
|
414 | { |
|
|
415 | int amt = 0; |
|
|
416 | char *pos = buf; |
|
|
417 | |
|
|
418 | if (ns->status == Ns_Dead || !buf) |
|
|
419 | { |
|
|
420 | LOG (llevDebug, "Write_To_Socket called with dead socket\n"); |
|
|
421 | return; |
|
|
422 | } |
|
|
423 | |
|
|
424 | #ifndef __GNU__ /* This caused problems on Hurd */ |
|
|
425 | if (!ns->can_write) |
|
|
426 | { |
|
|
427 | add_to_buffer (ns, buf, len); |
|
|
428 | return; |
|
|
429 | } |
|
|
430 | #endif |
|
|
431 | /* If we manage to write more than we wanted, take it as a bonus */ |
|
|
432 | while (len > 0) |
|
|
433 | { |
|
|
434 | |
|
|
435 | #ifdef WIN32 /* ***win32 Write_To_Socket: change write() to send() */ |
|
|
436 | amt = send (ns->fd, pos, len, 0); |
|
|
437 | #else |
|
|
438 | do |
|
|
439 | { |
|
|
440 | amt = write (ns->fd, pos, len); |
|
|
441 | } |
|
|
442 | while ((amt < 0) && (errno == EINTR)); |
|
|
443 | #endif |
|
|
444 | |
|
|
445 | if (amt < 0) |
|
|
446 | { /* We got an error */ |
|
|
447 | #ifdef WIN32 /* ***win32 Write_To_Socket: change error handling */ |
|
|
448 | if (amt == -1 && WSAGetLastError () != WSAEWOULDBLOCK) |
|
|
449 | { |
|
|
450 | LOG (llevError, "New socket write failed WTS (%d).\n", WSAGetLastError ()); |
|
|
451 | #else |
|
|
452 | if (errno != EWOULDBLOCK) |
|
|
453 | { |
|
|
454 | LOG (llevError, "New socket write failed WTS (%d: %s).\n", /* ---WIN32 */ |
|
|
455 | errno, strerror (errno)); |
|
|
456 | #endif |
|
|
457 | ns->status = Ns_Dead; |
|
|
458 | return; |
|
|
459 | } |
|
|
460 | else |
|
|
461 | { /* EWOULDBLOCK */ |
|
|
462 | /* can't write it, so store it away. */ |
|
|
463 | add_to_buffer (ns, pos, len); |
|
|
464 | ns->can_write = 0; |
|
|
465 | return; |
|
|
466 | } |
|
|
467 | } |
|
|
468 | /* amt gets set to 0 above in blocking code, so we do this as |
|
|
469 | * an else if to make sure we don't reprocess it. |
|
|
470 | */ |
|
|
471 | else if (amt == 0) |
|
|
472 | { |
|
|
473 | LOG (llevError, "Write_To_Socket: No data written out.\n"); |
|
|
474 | } |
|
|
475 | len -= amt; |
|
|
476 | pos += amt; |
|
|
477 | #ifdef CS_LOGSTATS |
|
|
478 | cst_tot.obytes += amt; |
|
|
479 | cst_lst.obytes += amt; |
|
|
480 | #endif |
|
|
481 | } |
|
|
482 | } |
|
|
483 | |
|
|
484 | |
453 | |
485 | /** |
454 | /** |
486 | * Takes a string of data, and writes it out to the socket. A very handy |
455 | * Takes a string of data, and writes it out to the socket. A very handy |
487 | * shortcut function. |
456 | * shortcut function. |
488 | */ |
457 | */ |
489 | void |
458 | void |
490 | cs_write_string (NewSocket * ns, const char *buf, int len) |
459 | client::send_packet (packet &sl) |
491 | { |
460 | { |
492 | SockList sl; |
461 | if (destroyed ()) |
493 | |
|
|
494 | sl.len = len; |
|
|
495 | sl.buf = (unsigned char *) buf; |
|
|
496 | Send_With_Handling (ns, &sl); |
|
|
497 | } |
|
|
498 | |
|
|
499 | |
|
|
500 | /** |
|
|
501 | * Calls Write_To_Socket to send data to the client. |
|
|
502 | * |
|
|
503 | * The only difference in this function is that we take a SockList |
|
|
504 | *, and we prepend the length information. |
|
|
505 | */ |
|
|
506 | void |
|
|
507 | Send_With_Handling (NewSocket * ns, SockList * msg) |
|
|
508 | { |
|
|
509 | unsigned char sbuf[4]; |
|
|
510 | |
|
|
511 | if (ns->status == Ns_Dead || !msg) |
|
|
512 | return; |
462 | return; |
513 | |
463 | |
514 | if (msg->len >= MAXSOCKBUF) |
464 | if (sl.length () >= MAXSOCKBUF) |
515 | { |
465 | { |
516 | LOG (llevError, "Trying to send a buffer beyond properly size, len =%d\n", msg->len); |
466 | LOG (llevError, "Trying to send a buffer beyond properly size, len =%d\n", sl.length ()); |
517 | /* Almost certainly we've overflowed a buffer, so quite now to make |
467 | /* Almost certainly we've overflowed a buffer, so quit now to make |
518 | * it easier to debug. |
468 | * it easier to debug. |
519 | */ |
469 | */ |
520 | abort (); |
470 | abort (); |
521 | } |
471 | } |
522 | sbuf[0] = ((uint32) (msg->len) >> 8) & 0xFF; |
|
|
523 | sbuf[1] = ((uint32) (msg->len)) & 0xFF; |
|
|
524 | if (ns->status != Ns_Old) |
|
|
525 | Write_To_Socket (ns, (char *) sbuf, 2); |
|
|
526 | Write_To_Socket (ns, (char *) msg->buf, msg->len); |
|
|
527 | } |
|
|
528 | |
472 | |
529 | /** |
473 | if (!sl.length ()) |
530 | * Takes a string of data, and writes it out to the socket. A very handy |
474 | return; |
531 | * shortcut function. |
|
|
532 | */ |
|
|
533 | void |
|
|
534 | Write_String_To_Socket (NewSocket * ns, char *buf, int len) |
|
|
535 | { |
|
|
536 | SockList sl; |
|
|
537 | |
475 | |
538 | sl.len = len; |
476 | assert (sl.hdrlen == 2); |
539 | sl.buf = (unsigned char *) buf; |
|
|
540 | Send_With_Handling (ns, &sl); |
|
|
541 | } |
|
|
542 | |
477 | |
|
|
478 | sl.buf_ [0] = sl.length () >> 8; |
|
|
479 | sl.buf_ [1] = sl.length () ; |
543 | |
480 | |
|
|
481 | send (sl.buf_, sl.length () + sl.hdrlen); |
|
|
482 | } |
|
|
483 | |
|
|
484 | void |
|
|
485 | client::send_packet (const char *buf, int len) |
|
|
486 | { |
|
|
487 | packet sl; |
|
|
488 | |
|
|
489 | sl << data (buf, len); |
|
|
490 | send_packet (sl); |
|
|
491 | } |
|
|
492 | |
|
|
493 | void |
|
|
494 | client::send_packet (const char *buf) |
|
|
495 | { |
|
|
496 | send_packet (buf, strlen (buf)); |
|
|
497 | } |
|
|
498 | |
|
|
499 | void |
|
|
500 | client::send_packet_printf (const char *format, ...) |
|
|
501 | { |
|
|
502 | packet sl; |
|
|
503 | |
|
|
504 | va_list ap; |
|
|
505 | va_start (ap, format); |
|
|
506 | sl.vprintf (format, ap); |
|
|
507 | va_end (ap); |
|
|
508 | |
|
|
509 | send_packet (sl); |
|
|
510 | } |
|
|
511 | |
|
|
512 | void |
|
|
513 | client::send_drawinfo (const char *msg, int flags) |
|
|
514 | { |
|
|
515 | send_packet_printf ("drawinfo %d %s", flags, msg); |
|
|
516 | } |
|
|
517 | |
|
|
518 | void |
|
|
519 | client::send_msg (int color, const char *type, const char *msg) |
|
|
520 | { |
|
|
521 | if (can_msg) |
|
|
522 | send_packet_printf ("msg %d %s %s", color, type, msg); |
|
|
523 | else if (color < 0) |
|
|
524 | return; // client cannot handle this |
|
|
525 | else if (strchr (msg, '<') || strchr (msg, '&')) |
|
|
526 | { |
|
|
527 | //TODO: should escape/modify to old syntax |
|
|
528 | send_packet_printf ("drawinfo %d %s", color, msg); |
|
|
529 | } |
|
|
530 | else |
|
|
531 | send_packet_printf ("drawinfo %d %s", color, msg); |
|
|
532 | } |
|
|
533 | |
544 | /****************************************************************************** |
534 | /*********************************************************************** |
545 | * |
535 | * |
546 | * statistics logging functions. |
536 | * packet functions/utilities |
547 | * |
537 | * |
548 | ******************************************************************************/ |
538 | **********************************************************************/ |
549 | |
539 | |
550 | #ifdef CS_LOGSTATS |
540 | packet::packet (const char *name) |
551 | |
|
|
552 | /* cst_tot is for the life of the server, cst_last is for the last series of |
|
|
553 | * stats |
|
|
554 | */ |
|
|
555 | CS_Stats cst_tot, cst_lst; |
|
|
556 | |
|
|
557 | /** |
|
|
558 | * Writes out the gathered stats. We clear cst_lst. |
|
|
559 | */ |
|
|
560 | void |
|
|
561 | write_cs_stats (void) |
|
|
562 | { |
541 | { |
563 | time_t now = time (NULL); |
542 | reset (); |
564 | |
543 | |
565 | /* If no connections recently, don't both to log anything */ |
544 | int len = strlen (name); |
566 | if (cst_lst.ibytes == 0 && cst_lst.obytes == 0) |
545 | memcpy (cur, name, len); cur += len; |
567 | return; |
546 | *cur++ = ' '; |
568 | |
|
|
569 | /* CSSTAT is put in so scripts can easily find the line */ |
|
|
570 | LOG (llevInfo, "CSSTAT: %.16s tot %d %d %d %d inc %d %d %d %d\n", |
|
|
571 | ctime (&now), cst_tot.ibytes, cst_tot.obytes, cst_tot.max_conn, |
|
|
572 | now - cst_tot.time_start, cst_lst.ibytes, cst_lst.obytes, cst_lst.max_conn, now - cst_lst.time_start); |
|
|
573 | cst_lst.ibytes = 0; |
|
|
574 | cst_lst.obytes = 0; |
|
|
575 | cst_lst.max_conn = socket_info.nconns; |
|
|
576 | cst_lst.time_start = now; |
|
|
577 | } |
547 | } |
578 | #endif |
548 | |
|
|
549 | packet &packet::operator <<(const ber32 v) |
|
|
550 | { |
|
|
551 | enum { maxlen = 32 / 7 + 1}; |
|
|
552 | uint8 buf[maxlen]; |
|
|
553 | uint8 *p = buf + maxlen; |
|
|
554 | uint32 val = v.val; |
|
|
555 | |
|
|
556 | *--p = val & 0x7F; |
|
|
557 | |
|
|
558 | while (val > 0x7F) |
|
|
559 | { |
|
|
560 | val >>= 7; |
|
|
561 | *--p = (val & 0x7F) | 0x80; |
|
|
562 | } |
|
|
563 | |
|
|
564 | return *this << data (p, buf + maxlen - p); |
|
|
565 | } |
|
|
566 | |
|
|
567 | packet &packet::operator <<(const data &v) |
|
|
568 | { |
|
|
569 | if (room () < v.len) |
|
|
570 | reset (); |
|
|
571 | else |
|
|
572 | { |
|
|
573 | if (v.len) |
|
|
574 | { |
|
|
575 | memcpy (cur, v.ptr, v.len); |
|
|
576 | cur += v.len; |
|
|
577 | } |
|
|
578 | } |
|
|
579 | |
|
|
580 | return *this; |
|
|
581 | } |
|
|
582 | |
|
|
583 | packet &packet::operator <<(const data8 &v) |
|
|
584 | { |
|
|
585 | unsigned int len = min (v.len, 0x00FF); |
|
|
586 | return *this << uint8 (len) << data (v.ptr, len); |
|
|
587 | } |
|
|
588 | |
|
|
589 | packet &packet::operator <<(const data16 &v) |
|
|
590 | { |
|
|
591 | unsigned int len = min (v.len, 0xFFFF); |
|
|
592 | return *this << uint16 (len) << data (v.ptr, len); |
|
|
593 | } |
|
|
594 | |
|
|
595 | packet &packet::operator <<(const char *v) |
|
|
596 | { |
|
|
597 | return *this << data (v, strlen (v ? v : 0)); |
|
|
598 | } |
|
|
599 | |
|
|
600 | void |
|
|
601 | packet::vprintf (const char *format, va_list ap) |
|
|
602 | { |
|
|
603 | int size = room (); |
|
|
604 | |
|
|
605 | int len = vsnprintf ((char *)cur, size, format, ap); |
|
|
606 | |
|
|
607 | if (len >= size) |
|
|
608 | return reset (); |
|
|
609 | |
|
|
610 | cur += len; |
|
|
611 | } |
|
|
612 | |