2086
|
1 /* -*- Mode: C; tab-width: 2; indent-tabs-mode: nil; c-basic-offset: 2 -*- */
|
|
2
|
|
3 /*
|
|
4 * $Id: icqpacket.c 2096 2001-07-31 01:00:39Z warmenhoven $
|
|
5 *
|
|
6 * Copyright (C) 1998-2001, Denis V. Dmitrienko <denis@null.net> and
|
|
7 * Bill Soudan <soudan@kde.org>
|
|
8 *
|
|
9 * This program is free software; you can redistribute it and/or modify
|
|
10 * it under the terms of the GNU General Public License as published by
|
|
11 * the Free Software Foundation; either version 2 of the License, or
|
|
12 * (at your option) any later version.
|
|
13 *
|
|
14 * This program is distributed in the hope that it will be useful,
|
|
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
17 * GNU General Public License for more details.
|
|
18 *
|
|
19 * You should have received a copy of the GNU General Public License
|
|
20 * along with this program; if not, write to the Free Software
|
|
21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
22 *
|
|
23 */
|
|
24
|
|
25 /*
|
|
26 * ICQ packet abstraction
|
|
27 */
|
|
28
|
|
29 #include <stdlib.h>
|
|
30
|
|
31 #ifdef _WIN32
|
|
32 #include <winsock.h>
|
|
33 #else
|
|
34 #include <sys/types.h>
|
|
35 #include <sys/socket.h>
|
|
36 #endif
|
|
37
|
|
38 #include "icqlib.h"
|
|
39 #include "tcp.h"
|
|
40 #include "icqbyteorder.h"
|
|
41
|
|
42 icq_Packet *icq_PacketNew()
|
|
43 {
|
|
44 icq_Packet *p=(icq_Packet*)malloc(sizeof(icq_Packet));
|
|
45
|
|
46 p->length=0;
|
|
47 p->cursor=0;
|
|
48 p->id=0;
|
|
49
|
|
50 return p;
|
|
51 }
|
|
52
|
|
53 void icq_PacketDelete(void *p)
|
|
54 {
|
|
55 free(p);
|
|
56 }
|
|
57
|
|
58 void icq_PacketAppend32(icq_Packet *p, DWORD i)
|
|
59 {
|
|
60 DWORD val=i;
|
|
61
|
|
62 *(unsigned long*)((p->data)+(p->cursor))=htoicql(val);
|
|
63 icq_PacketAdvance(p, sizeof(DWORD));
|
|
64 }
|
|
65
|
|
66 void icq_PacketAppend32n(icq_Packet *p, DWORD i)
|
|
67 {
|
|
68 DWORD val=i;
|
|
69
|
|
70 *(DWORD *)((p->data)+(p->cursor)) = val;
|
|
71 icq_PacketAdvance(p, sizeof(DWORD));
|
|
72 }
|
|
73
|
|
74 DWORD icq_PacketRead32(icq_Packet *p)
|
|
75 {
|
|
76 DWORD val;
|
|
77
|
|
78 val = icqtohl(*(DWORD *)((p->data)+(p->cursor)));
|
|
79 icq_PacketAdvance(p, sizeof(DWORD));
|
|
80
|
|
81 return val;
|
|
82 }
|
|
83
|
|
84 DWORD icq_PacketRead32n(icq_Packet *p)
|
|
85 {
|
|
86 DWORD val;
|
|
87
|
|
88 val = *(DWORD*)((p->data)+(p->cursor));
|
|
89 icq_PacketAdvance(p, sizeof(DWORD));
|
|
90
|
|
91 return val;
|
|
92 }
|
|
93
|
|
94 void icq_PacketAppend16(icq_Packet *p, WORD i)
|
|
95 {
|
|
96 WORD val=i;
|
|
97
|
|
98 *(WORD *)((p->data)+(p->cursor)) = htoicqs(val);
|
|
99 icq_PacketAdvance(p, sizeof(WORD));
|
|
100 }
|
|
101
|
|
102 void icq_PacketAppend16n(icq_Packet *p, WORD i)
|
|
103 {
|
|
104 WORD val=i;
|
|
105
|
|
106 *(WORD *)((p->data)+(p->cursor)) = val;
|
|
107 icq_PacketAdvance(p, sizeof(WORD));
|
|
108 }
|
|
109
|
|
110 WORD icq_PacketRead16(icq_Packet *p)
|
|
111 {
|
|
112 WORD val;
|
|
113
|
|
114 val = icqtohs(*(WORD *)((p->data)+(p->cursor)));
|
|
115 icq_PacketAdvance(p, sizeof(WORD));
|
|
116
|
|
117 return val;
|
|
118 }
|
|
119
|
|
120 WORD icq_PacketRead16n(icq_Packet *p)
|
|
121 {
|
|
122 WORD val;
|
|
123
|
|
124 val = *(WORD*)((p->data)+(p->cursor));
|
|
125 icq_PacketAdvance(p, sizeof(WORD));
|
|
126
|
|
127 return val;
|
|
128 }
|
|
129
|
|
130 void icq_PacketAppend8(icq_Packet *p, BYTE i)
|
|
131 {
|
|
132 BYTE val=i;
|
|
133
|
|
134 memcpy((p->data)+(p->cursor), &val, sizeof(BYTE));
|
|
135 icq_PacketAdvance(p, sizeof(BYTE));
|
|
136 }
|
|
137
|
|
138 BYTE icq_PacketRead8(icq_Packet *p)
|
|
139 {
|
|
140 BYTE val;
|
|
141
|
|
142 memcpy(&val, (p->data)+(p->cursor), sizeof(BYTE));
|
|
143 icq_PacketAdvance(p, sizeof(BYTE));
|
|
144
|
|
145 return val;
|
|
146 }
|
|
147
|
|
148 void icq_PacketAppendString(icq_Packet *p, const char *s)
|
|
149 {
|
|
150 if(s)
|
|
151 {
|
|
152 int length=strlen(s)+1;
|
|
153
|
|
154 icq_PacketAppend16(p, length);
|
|
155 icq_PacketAppend(p, s, length);
|
|
156 }
|
|
157 else
|
|
158 {
|
|
159 icq_PacketAppend16(p, 1);
|
|
160 icq_PacketAppend8(p,0);
|
|
161 }
|
|
162 }
|
|
163
|
|
164 const char *icq_PacketReadString(icq_Packet *p)
|
|
165 {
|
|
166 int length=icq_PacketRead16(p);
|
|
167
|
|
168 return (const char *)icq_PacketRead(p, length);
|
|
169 }
|
|
170
|
|
171 char *icq_PacketReadStringNew(icq_Packet *p)
|
|
172 {
|
|
173 char *ptr;
|
|
174 int length=icq_PacketRead16(p);
|
|
175
|
|
176 ptr = (char*)malloc(length);
|
|
177 if(!ptr)
|
|
178 return 0L;
|
|
179 strncpy(ptr, icq_PacketRead(p, length), length);
|
|
180 return ptr;
|
|
181 }
|
|
182
|
|
183 void icq_PacketAppendStringFE(icq_Packet *p, const char *s)
|
|
184 {
|
|
185 if(s)
|
|
186 {
|
|
187 int length=strlen(s);
|
|
188 icq_PacketAppend(p, s, length);
|
|
189 }
|
|
190 icq_PacketAppend8(p, 0xFE);
|
|
191 }
|
|
192
|
|
193 void icq_PacketAppendString0(icq_Packet *p, const char *s)
|
|
194 {
|
|
195 if(s)
|
|
196 {
|
|
197 int length=strlen(s);
|
|
198 icq_PacketAppend(p, s, length);
|
|
199 }
|
|
200 icq_PacketAppend8(p, 0);
|
|
201 }
|
|
202
|
|
203 WORD icq_PacketReadUDPOutVer(icq_Packet *p)
|
|
204 {
|
|
205 icq_PacketGoto(p, 0);
|
|
206 return icq_PacketRead16(p);
|
|
207 }
|
|
208
|
|
209 WORD icq_PacketReadUDPOutCmd(icq_Packet *p)
|
|
210 {
|
|
211 icq_PacketGoto(p, 14 /*2*/);
|
|
212 return icq_PacketRead16(p);
|
|
213 }
|
|
214
|
|
215 WORD icq_PacketReadUDPOutSeq1(icq_Packet *p)
|
|
216 {
|
|
217 icq_PacketGoto(p, 16);
|
|
218 return icq_PacketRead16(p);
|
|
219 }
|
|
220
|
|
221 WORD icq_PacketReadUDPOutSeq2(icq_Packet *p)
|
|
222 {
|
|
223 icq_PacketGoto(p, 18 /*4*/);
|
|
224 return icq_PacketRead16(p);
|
|
225 }
|
|
226
|
|
227 WORD icq_PacketReadUDPInVer(icq_Packet *p)
|
|
228 {
|
|
229 icq_PacketGoto(p, 0);
|
|
230 return icq_PacketRead16(p);
|
|
231 }
|
|
232
|
|
233 WORD icq_PacketReadUDPInCmd(icq_Packet *p)
|
|
234 {
|
|
235 icq_PacketGoto(p, 7);
|
|
236 return icq_PacketRead16(p);
|
|
237 }
|
|
238
|
|
239 WORD icq_PacketReadUDPInCmdV3(icq_Packet *p)
|
|
240 {
|
|
241 icq_PacketGoto(p, 2);
|
|
242 return icq_PacketRead16(p);
|
|
243 }
|
|
244
|
|
245 WORD icq_PacketReadUDPInSeq1(icq_Packet *p)
|
|
246 {
|
|
247 icq_PacketGoto(p, 9);
|
|
248 return icq_PacketRead16(p);
|
|
249 }
|
|
250
|
|
251 WORD icq_PacketReadUDPInSeq2(icq_Packet *p)
|
|
252 {
|
|
253 icq_PacketGoto(p, 11);
|
|
254 return icq_PacketRead16(p);
|
|
255 }
|
|
256
|
|
257 DWORD icq_PacketReadUDPInUIN(icq_Packet *p)
|
|
258 {
|
|
259 icq_PacketGoto(p, 13);
|
|
260 return icq_PacketRead32(p);
|
|
261 }
|
|
262
|
|
263 void icq_PacketAppend(icq_Packet *p, const void *data, int length)
|
|
264 {
|
|
265 memcpy((p->data)+(p->cursor), data, length);
|
|
266 icq_PacketAdvance(p, length);
|
|
267 }
|
|
268
|
|
269 const void *icq_PacketRead(icq_Packet *p, int length)
|
|
270 {
|
|
271 const void *data=(p->data)+(p->cursor);
|
|
272
|
|
273 icq_PacketAdvance(p, length);
|
|
274
|
|
275 return data;
|
|
276 }
|
|
277
|
|
278 void icq_PacketShortDump(icq_Packet *p)
|
|
279 {
|
|
280 printf("icq_Packet %lx { id=%d, cursor=%x, length=%d }\n",
|
|
281 (long)p, (int)p->id, p->cursor, p->length);
|
|
282 }
|
|
283
|
|
284 void icq_PacketDump(icq_Packet *p)
|
|
285 {
|
|
286 icq_PacketShortDump(p);
|
|
287 hex_dump((char*)&(p->length), p->length+sizeof(WORD));
|
|
288 }
|
|
289
|
|
290 void icq_PacketUDPDump(icq_Packet *p)
|
|
291 {
|
|
292 icq_PacketShortDump(p);
|
|
293 hex_dump((char*)&(p->data), p->length);
|
|
294 }
|
|
295
|
|
296 void icq_PacketBegin(icq_Packet *p)
|
|
297 {
|
|
298 p->cursor=0;
|
|
299 }
|
|
300
|
|
301 void icq_PacketEnd(icq_Packet *p)
|
|
302 {
|
|
303 p->cursor=p->length;
|
|
304 }
|
|
305
|
|
306 void icq_PacketAdvance(icq_Packet *p, int i)
|
|
307 {
|
|
308 p->cursor+=i;
|
|
309
|
|
310 if(p->cursor > p->length)
|
|
311 p->length=p->cursor;
|
|
312
|
|
313 /* Do nothing, because we don't have ICQLINK here */
|
|
314 /* if(p->cursor > ICQ_PACKET_DATA_SIZE) */
|
|
315 /* icq_FmtLog(0L, ICQ_LOG_WARNING, "icq_Packet data overflow\n"); */
|
|
316 }
|
|
317
|
|
318 void icq_PacketGoto(icq_Packet *p, int i)
|
|
319 {
|
|
320 icq_PacketBegin(p);
|
|
321 icq_PacketAdvance(p, i);
|
|
322 }
|
|
323
|
|
324 void icq_PacketGotoUDPOutData(icq_Packet *p, int i)
|
|
325 {
|
|
326 /* Go to data in UDP _client_ packet. */
|
|
327 icq_PacketGoto(p, 24+i);
|
|
328 }
|
|
329
|
|
330 void icq_PacketGotoUDPInData(icq_Packet *p, int i)
|
|
331 {
|
|
332 /* Go to data in UDP _server_ packet. */
|
|
333 icq_PacketGoto(p, 21+i);
|
|
334 }
|
|
335
|
|
336 WORD icq_PacketPos(icq_Packet *p)
|
|
337 {
|
|
338 return p->cursor;
|
|
339 }
|
|
340
|
|
341 int icq_PacketSend(icq_Packet *p, int socket_fd)
|
|
342 {
|
|
343 int result;
|
|
344
|
|
345 result=send(socket_fd, (const char*)&(p->length), p->length+sizeof(WORD), 0);
|
|
346
|
|
347 #ifdef TCP_RAW_TRACE
|
|
348 printf("%d bytes sent on socket %d, result %d\n",
|
|
349 p->length+1, socket, result);
|
|
350 icq_PacketDump(p);
|
|
351 #endif /* TCP_RAW_TRACE */
|
|
352
|
|
353 return result;
|
|
354 }
|