1 |
/* -*- c-basic-offset: 8 -*- |
2 |
rdesktop: A Remote Desktop Protocol client. |
3 |
Copyright (C) Matthew Chapman 1999-2005 |
4 |
|
5 |
This program is free software; you can redistribute it and/or modify |
6 |
it under the terms of the GNU General Public License as published by |
7 |
the Free Software Foundation; either version 2 of the License, or |
8 |
(at your option) any later version. |
9 |
|
10 |
This program is distributed in the hope that it will be useful, |
11 |
but WITHOUT ANY WARRANTY; without even the implied warranty of |
12 |
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
13 |
GNU General Public License for more details. |
14 |
|
15 |
You should have received a copy of the GNU General Public License |
16 |
along with this program; if not, write to the Free Software |
17 |
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
18 |
*/ |
19 |
|
20 |
/* |
21 |
Here are some resources, for your IRP hacking pleasure: |
22 |
|
23 |
http://cvs.sourceforge.net/viewcvs.py/mingw/w32api/include/ddk/winddk.h?view=markup |
24 |
|
25 |
http://win32.mvps.org/ntfs/streams.cpp |
26 |
|
27 |
http://www.acc.umu.se/~bosse/ntifs.h |
28 |
|
29 |
http://undocumented.ntinternals.net/UserMode/Undocumented%20Functions/NT%20Objects/File/ |
30 |
|
31 |
http://us1.samba.org/samba/ftp/specs/smb-nt01.txt |
32 |
|
33 |
http://www.osronline.com/ |
34 |
*/ |
35 |
|
36 |
#include <unistd.h> |
37 |
#include <sys/types.h> |
38 |
#include <sys/time.h> |
39 |
#include <dirent.h> /* opendir, closedir, readdir */ |
40 |
#include <time.h> |
41 |
#include <errno.h> |
42 |
#include "rdesktop.h" |
43 |
|
44 |
#define IRP_MJ_CREATE 0x00 |
45 |
#define IRP_MJ_CLOSE 0x02 |
46 |
#define IRP_MJ_READ 0x03 |
47 |
#define IRP_MJ_WRITE 0x04 |
48 |
#define IRP_MJ_QUERY_INFORMATION 0x05 |
49 |
#define IRP_MJ_SET_INFORMATION 0x06 |
50 |
#define IRP_MJ_QUERY_VOLUME_INFORMATION 0x0a |
51 |
#define IRP_MJ_DIRECTORY_CONTROL 0x0c |
52 |
#define IRP_MJ_DEVICE_CONTROL 0x0e |
53 |
#define IRP_MJ_LOCK_CONTROL 0x11 |
54 |
|
55 |
#define IRP_MN_QUERY_DIRECTORY 0x01 |
56 |
#define IRP_MN_NOTIFY_CHANGE_DIRECTORY 0x02 |
57 |
|
58 |
extern char g_hostname[16]; |
59 |
extern DEVICE_FNS serial_fns; |
60 |
extern DEVICE_FNS printer_fns; |
61 |
extern DEVICE_FNS parallel_fns; |
62 |
extern DEVICE_FNS disk_fns; |
63 |
#ifdef WITH_SCARD |
64 |
extern DEVICE_FNS scard_fns; |
65 |
#endif |
66 |
extern FILEINFO g_fileinfo[]; |
67 |
extern BOOL g_notify_stamp; |
68 |
|
69 |
static VCHANNEL *rdpdr_channel; |
70 |
|
71 |
/* If select() times out, the request for the device with handle g_min_timeout_fd is aborted */ |
72 |
NTHANDLE g_min_timeout_fd; |
73 |
uint32 g_num_devices; |
74 |
|
75 |
/* Table with information about rdpdr devices */ |
76 |
RDPDR_DEVICE g_rdpdr_device[RDPDR_MAX_DEVICES]; |
77 |
char *g_rdpdr_clientname = NULL; |
78 |
|
79 |
/* Used to store incoming io request, until they are ready to be completed */ |
80 |
/* using a linked list ensures that they are processed in the right order, */ |
81 |
/* if multiple ios are being done on the same fd */ |
82 |
struct async_iorequest |
83 |
{ |
84 |
uint32 fd, major, minor, offset, device, id, length, partial_len; |
85 |
long timeout, /* Total timeout */ |
86 |
itv_timeout; /* Interval timeout (between serial characters) */ |
87 |
uint8 *buffer; |
88 |
DEVICE_FNS *fns; |
89 |
|
90 |
struct async_iorequest *next; /* next element in list */ |
91 |
}; |
92 |
|
93 |
struct async_iorequest *g_iorequest; |
94 |
|
95 |
/* Return device_id for a given handle */ |
96 |
int |
97 |
get_device_index(NTHANDLE handle) |
98 |
{ |
99 |
int i; |
100 |
for (i = 0; i < RDPDR_MAX_DEVICES; i++) |
101 |
{ |
102 |
if (g_rdpdr_device[i].handle == handle) |
103 |
return i; |
104 |
} |
105 |
return -1; |
106 |
} |
107 |
|
108 |
/* Converts a windows path to a unix path */ |
109 |
void |
110 |
convert_to_unix_filename(char *filename) |
111 |
{ |
112 |
char *p; |
113 |
|
114 |
while ((p = strchr(filename, '\\'))) |
115 |
{ |
116 |
*p = '/'; |
117 |
} |
118 |
} |
119 |
|
120 |
static BOOL |
121 |
rdpdr_handle_ok(int device, int handle) |
122 |
{ |
123 |
switch (g_rdpdr_device[device].device_type) |
124 |
{ |
125 |
case DEVICE_TYPE_PARALLEL: |
126 |
case DEVICE_TYPE_SERIAL: |
127 |
case DEVICE_TYPE_PRINTER: |
128 |
case DEVICE_TYPE_SCARD: |
129 |
if (g_rdpdr_device[device].handle != handle) |
130 |
return False; |
131 |
break; |
132 |
case DEVICE_TYPE_DISK: |
133 |
if (g_fileinfo[handle].device_id != device) |
134 |
return False; |
135 |
break; |
136 |
} |
137 |
return True; |
138 |
} |
139 |
|
140 |
/* Add a new io request to the table containing pending io requests so it won't block rdesktop */ |
141 |
static BOOL |
142 |
add_async_iorequest(uint32 device, uint32 file, uint32 id, uint32 major, uint32 length, |
143 |
DEVICE_FNS * fns, uint32 total_timeout, uint32 interval_timeout, uint8 * buffer, |
144 |
uint32 offset) |
145 |
{ |
146 |
struct async_iorequest *iorq; |
147 |
|
148 |
if (g_iorequest == NULL) |
149 |
{ |
150 |
g_iorequest = (struct async_iorequest *) xmalloc(sizeof(struct async_iorequest)); |
151 |
if (!g_iorequest) |
152 |
return False; |
153 |
g_iorequest->fd = 0; |
154 |
g_iorequest->next = NULL; |
155 |
} |
156 |
|
157 |
iorq = g_iorequest; |
158 |
|
159 |
while (iorq->fd != 0) |
160 |
{ |
161 |
/* create new element if needed */ |
162 |
if (iorq->next == NULL) |
163 |
{ |
164 |
iorq->next = |
165 |
(struct async_iorequest *) xmalloc(sizeof(struct async_iorequest)); |
166 |
if (!iorq->next) |
167 |
return False; |
168 |
iorq->next->fd = 0; |
169 |
iorq->next->next = NULL; |
170 |
} |
171 |
iorq = iorq->next; |
172 |
} |
173 |
iorq->device = device; |
174 |
iorq->fd = file; |
175 |
iorq->id = id; |
176 |
iorq->major = major; |
177 |
iorq->length = length; |
178 |
iorq->partial_len = 0; |
179 |
iorq->fns = fns; |
180 |
iorq->timeout = total_timeout; |
181 |
iorq->itv_timeout = interval_timeout; |
182 |
iorq->buffer = buffer; |
183 |
iorq->offset = offset; |
184 |
return True; |
185 |
} |
186 |
|
187 |
static void |
188 |
rdpdr_send_connect(void) |
189 |
{ |
190 |
uint8 magic[4] = "rDCC"; |
191 |
STREAM s; |
192 |
|
193 |
s = channel_init(rdpdr_channel, 12); |
194 |
out_uint8a(s, magic, 4); |
195 |
out_uint16_le(s, 1); /* unknown */ |
196 |
out_uint16_le(s, 5); |
197 |
out_uint32_be(s, 0x815ed39d); /* IP address (use 127.0.0.1) 0x815ed39d */ |
198 |
s_mark_end(s); |
199 |
channel_send(s, rdpdr_channel); |
200 |
} |
201 |
|
202 |
|
203 |
static void |
204 |
rdpdr_send_name(void) |
205 |
{ |
206 |
uint8 magic[4] = "rDNC"; |
207 |
STREAM s; |
208 |
uint32 hostlen; |
209 |
|
210 |
if (NULL == g_rdpdr_clientname) |
211 |
{ |
212 |
g_rdpdr_clientname = g_hostname; |
213 |
} |
214 |
hostlen = (strlen(g_rdpdr_clientname) + 1) * 2; |
215 |
|
216 |
s = channel_init(rdpdr_channel, 16 + hostlen); |
217 |
out_uint8a(s, magic, 4); |
218 |
out_uint16_le(s, 0x63); /* unknown */ |
219 |
out_uint16_le(s, 0x72); |
220 |
out_uint32(s, 0); |
221 |
out_uint32_le(s, hostlen); |
222 |
rdp_out_unistr(s, g_rdpdr_clientname, hostlen - 2); |
223 |
s_mark_end(s); |
224 |
channel_send(s, rdpdr_channel); |
225 |
} |
226 |
|
227 |
/* Returns the size of the payload of the announce packet */ |
228 |
static int |
229 |
announcedata_size() |
230 |
{ |
231 |
int size, i; |
232 |
PRINTER *printerinfo; |
233 |
|
234 |
size = 8; /* static announce size */ |
235 |
size += g_num_devices * 0x14; |
236 |
|
237 |
for (i = 0; i < g_num_devices; i++) |
238 |
{ |
239 |
if (g_rdpdr_device[i].device_type == DEVICE_TYPE_PRINTER) |
240 |
{ |
241 |
printerinfo = (PRINTER *) g_rdpdr_device[i].pdevice_data; |
242 |
printerinfo->bloblen = |
243 |
printercache_load_blob(printerinfo->printer, &(printerinfo->blob)); |
244 |
|
245 |
size += 0x18; |
246 |
size += 2 * strlen(printerinfo->driver) + 2; |
247 |
size += 2 * strlen(printerinfo->printer) + 2; |
248 |
size += printerinfo->bloblen; |
249 |
} |
250 |
} |
251 |
|
252 |
return size; |
253 |
} |
254 |
|
255 |
static void |
256 |
rdpdr_send_available(void) |
257 |
{ |
258 |
|
259 |
uint8 magic[4] = "rDAD"; |
260 |
uint32 driverlen, printerlen, bloblen; |
261 |
int i; |
262 |
STREAM s; |
263 |
PRINTER *printerinfo; |
264 |
|
265 |
s = channel_init(rdpdr_channel, announcedata_size()); |
266 |
out_uint8a(s, magic, 4); |
267 |
out_uint32_le(s, g_num_devices); |
268 |
|
269 |
for (i = 0; i < g_num_devices; i++) |
270 |
{ |
271 |
out_uint32_le(s, g_rdpdr_device[i].device_type); |
272 |
out_uint32_le(s, i); /* RDP Device ID */ |
273 |
/* Is it possible to use share names longer than 8 chars? |
274 |
/astrand */ |
275 |
out_uint8p(s, g_rdpdr_device[i].name, 8); |
276 |
|
277 |
switch (g_rdpdr_device[i].device_type) |
278 |
{ |
279 |
case DEVICE_TYPE_PRINTER: |
280 |
printerinfo = (PRINTER *) g_rdpdr_device[i].pdevice_data; |
281 |
|
282 |
driverlen = 2 * strlen(printerinfo->driver) + 2; |
283 |
printerlen = 2 * strlen(printerinfo->printer) + 2; |
284 |
bloblen = printerinfo->bloblen; |
285 |
|
286 |
out_uint32_le(s, 24 + driverlen + printerlen + bloblen); /* length of extra info */ |
287 |
out_uint32_le(s, printerinfo->default_printer ? 2 : 0); |
288 |
out_uint8s(s, 8); /* unknown */ |
289 |
out_uint32_le(s, driverlen); |
290 |
out_uint32_le(s, printerlen); |
291 |
out_uint32_le(s, bloblen); |
292 |
rdp_out_unistr(s, printerinfo->driver, driverlen - 2); |
293 |
rdp_out_unistr(s, printerinfo->printer, printerlen - 2); |
294 |
out_uint8a(s, printerinfo->blob, bloblen); |
295 |
|
296 |
if (printerinfo->blob) |
297 |
xfree(printerinfo->blob); /* Blob is sent twice if reconnecting */ |
298 |
break; |
299 |
default: |
300 |
out_uint32(s, 0); |
301 |
} |
302 |
} |
303 |
#if 0 |
304 |
out_uint32_le(s, 0x20); /* Device type 0x20 - smart card */ |
305 |
out_uint32_le(s, 0); |
306 |
out_uint8p(s, "SCARD", 5); |
307 |
out_uint8s(s, 3); |
308 |
out_uint32(s, 0); |
309 |
#endif |
310 |
|
311 |
s_mark_end(s); |
312 |
channel_send(s, rdpdr_channel); |
313 |
} |
314 |
|
315 |
void |
316 |
rdpdr_send_completion(uint32 device, uint32 id, uint32 status, uint32 result, uint8 * buffer, |
317 |
uint32 length) |
318 |
{ |
319 |
uint8 magic[4] = "rDCI"; |
320 |
STREAM s; |
321 |
|
322 |
s = channel_init(rdpdr_channel, 20 + length); |
323 |
out_uint8a(s, magic, 4); |
324 |
out_uint32_le(s, device); |
325 |
out_uint32_le(s, id); |
326 |
out_uint32_le(s, status); |
327 |
out_uint32_le(s, result); |
328 |
out_uint8p(s, buffer, length); |
329 |
s_mark_end(s); |
330 |
/* JIF */ |
331 |
#ifdef WITH_DEBUG_RDP5 |
332 |
printf("--> rdpdr_send_completion\n"); |
333 |
/* hexdump(s->channel_hdr + 8, s->end - s->channel_hdr - 8); */ |
334 |
#endif |
335 |
channel_send(s, rdpdr_channel); |
336 |
} |
337 |
|
338 |
static void |
339 |
rdpdr_process_irp(STREAM s) |
340 |
{ |
341 |
uint32 result = 0, |
342 |
length = 0, |
343 |
desired_access = 0, |
344 |
request, |
345 |
file, |
346 |
info_level, |
347 |
buffer_len, |
348 |
id, |
349 |
major, |
350 |
minor, |
351 |
device, |
352 |
offset, |
353 |
bytes_in, |
354 |
bytes_out, |
355 |
error_mode, |
356 |
share_mode, disposition, total_timeout, interval_timeout, flags_and_attributes = 0; |
357 |
|
358 |
char filename[PATH_MAX]; |
359 |
uint8 *buffer, *pst_buf; |
360 |
struct stream out; |
361 |
DEVICE_FNS *fns; |
362 |
BOOL rw_blocking = True; |
363 |
NTSTATUS status = STATUS_INVALID_DEVICE_REQUEST; |
364 |
|
365 |
in_uint32_le(s, device); |
366 |
in_uint32_le(s, file); |
367 |
in_uint32_le(s, id); |
368 |
in_uint32_le(s, major); |
369 |
in_uint32_le(s, minor); |
370 |
|
371 |
buffer_len = 0; |
372 |
buffer = (uint8 *) xmalloc(1024); |
373 |
buffer[0] = 0; |
374 |
|
375 |
switch (g_rdpdr_device[device].device_type) |
376 |
{ |
377 |
case DEVICE_TYPE_SERIAL: |
378 |
|
379 |
fns = &serial_fns; |
380 |
rw_blocking = False; |
381 |
break; |
382 |
|
383 |
case DEVICE_TYPE_PARALLEL: |
384 |
|
385 |
fns = ¶llel_fns; |
386 |
rw_blocking = False; |
387 |
break; |
388 |
|
389 |
case DEVICE_TYPE_PRINTER: |
390 |
|
391 |
fns = &printer_fns; |
392 |
break; |
393 |
|
394 |
case DEVICE_TYPE_DISK: |
395 |
|
396 |
fns = &disk_fns; |
397 |
rw_blocking = False; |
398 |
break; |
399 |
|
400 |
case DEVICE_TYPE_SCARD: |
401 |
#ifdef WITH_SCARD |
402 |
fns = &scard_fns; |
403 |
rw_blocking = False; |
404 |
break; |
405 |
#endif |
406 |
default: |
407 |
|
408 |
error("IRP for bad device %ld\n", device); |
409 |
return; |
410 |
} |
411 |
|
412 |
switch (major) |
413 |
{ |
414 |
case IRP_MJ_CREATE: |
415 |
|
416 |
in_uint32_be(s, desired_access); |
417 |
in_uint8s(s, 0x08); /* unknown */ |
418 |
in_uint32_le(s, error_mode); |
419 |
in_uint32_le(s, share_mode); |
420 |
in_uint32_le(s, disposition); |
421 |
in_uint32_le(s, flags_and_attributes); |
422 |
in_uint32_le(s, length); |
423 |
|
424 |
if (length && (length / 2) < 256) |
425 |
{ |
426 |
rdp_in_unistr(s, filename, length); |
427 |
convert_to_unix_filename(filename); |
428 |
} |
429 |
else |
430 |
{ |
431 |
filename[0] = 0; |
432 |
} |
433 |
|
434 |
if (!fns->create) |
435 |
{ |
436 |
status = STATUS_NOT_SUPPORTED; |
437 |
break; |
438 |
} |
439 |
|
440 |
status = fns->create(device, desired_access, share_mode, disposition, |
441 |
flags_and_attributes, filename, &result); |
442 |
buffer_len = 1; |
443 |
break; |
444 |
|
445 |
case IRP_MJ_CLOSE: |
446 |
if (!fns->close) |
447 |
{ |
448 |
status = STATUS_NOT_SUPPORTED; |
449 |
break; |
450 |
} |
451 |
|
452 |
status = fns->close(file); |
453 |
break; |
454 |
|
455 |
case IRP_MJ_READ: |
456 |
|
457 |
if (!fns->read) |
458 |
{ |
459 |
status = STATUS_NOT_SUPPORTED; |
460 |
break; |
461 |
} |
462 |
|
463 |
in_uint32_le(s, length); |
464 |
in_uint32_le(s, offset); |
465 |
#if WITH_DEBUG_RDP5 |
466 |
DEBUG(("RDPDR IRP Read (length: %d, offset: %d)\n", length, offset)); |
467 |
#endif |
468 |
if (!rdpdr_handle_ok(device, file)) |
469 |
{ |
470 |
status = STATUS_INVALID_HANDLE; |
471 |
break; |
472 |
} |
473 |
|
474 |
if (rw_blocking) /* Complete read immediately */ |
475 |
{ |
476 |
buffer = (uint8 *) xrealloc((void *) buffer, length); |
477 |
if (!buffer) |
478 |
{ |
479 |
status = STATUS_CANCELLED; |
480 |
break; |
481 |
} |
482 |
status = fns->read(file, buffer, length, offset, &result); |
483 |
buffer_len = result; |
484 |
break; |
485 |
} |
486 |
|
487 |
/* Add request to table */ |
488 |
pst_buf = (uint8 *) xmalloc(length); |
489 |
if (!pst_buf) |
490 |
{ |
491 |
status = STATUS_CANCELLED; |
492 |
break; |
493 |
} |
494 |
serial_get_timeout(file, length, &total_timeout, &interval_timeout); |
495 |
if (add_async_iorequest |
496 |
(device, file, id, major, length, fns, total_timeout, interval_timeout, |
497 |
pst_buf, offset)) |
498 |
{ |
499 |
status = STATUS_PENDING; |
500 |
break; |
501 |
} |
502 |
|
503 |
status = STATUS_CANCELLED; |
504 |
break; |
505 |
case IRP_MJ_WRITE: |
506 |
|
507 |
buffer_len = 1; |
508 |
|
509 |
if (!fns->write) |
510 |
{ |
511 |
status = STATUS_NOT_SUPPORTED; |
512 |
break; |
513 |
} |
514 |
|
515 |
in_uint32_le(s, length); |
516 |
in_uint32_le(s, offset); |
517 |
in_uint8s(s, 0x18); |
518 |
#if WITH_DEBUG_RDP5 |
519 |
DEBUG(("RDPDR IRP Write (length: %d)\n", result)); |
520 |
#endif |
521 |
if (!rdpdr_handle_ok(device, file)) |
522 |
{ |
523 |
status = STATUS_INVALID_HANDLE; |
524 |
break; |
525 |
} |
526 |
|
527 |
if (rw_blocking) /* Complete immediately */ |
528 |
{ |
529 |
status = fns->write(file, s->p, length, offset, &result); |
530 |
break; |
531 |
} |
532 |
|
533 |
/* Add to table */ |
534 |
pst_buf = (uint8 *) xmalloc(length); |
535 |
if (!pst_buf) |
536 |
{ |
537 |
status = STATUS_CANCELLED; |
538 |
break; |
539 |
} |
540 |
|
541 |
in_uint8a(s, pst_buf, length); |
542 |
|
543 |
if (add_async_iorequest |
544 |
(device, file, id, major, length, fns, 0, 0, pst_buf, offset)) |
545 |
{ |
546 |
status = STATUS_PENDING; |
547 |
break; |
548 |
} |
549 |
|
550 |
status = STATUS_CANCELLED; |
551 |
break; |
552 |
|
553 |
case IRP_MJ_QUERY_INFORMATION: |
554 |
|
555 |
if (g_rdpdr_device[device].device_type != DEVICE_TYPE_DISK) |
556 |
{ |
557 |
status = STATUS_INVALID_HANDLE; |
558 |
break; |
559 |
} |
560 |
in_uint32_le(s, info_level); |
561 |
|
562 |
out.data = out.p = buffer; |
563 |
out.size = sizeof(buffer); |
564 |
status = disk_query_information(file, info_level, &out); |
565 |
result = buffer_len = out.p - out.data; |
566 |
|
567 |
break; |
568 |
|
569 |
case IRP_MJ_SET_INFORMATION: |
570 |
|
571 |
if (g_rdpdr_device[device].device_type != DEVICE_TYPE_DISK) |
572 |
{ |
573 |
status = STATUS_INVALID_HANDLE; |
574 |
break; |
575 |
} |
576 |
|
577 |
in_uint32_le(s, info_level); |
578 |
|
579 |
out.data = out.p = buffer; |
580 |
out.size = sizeof(buffer); |
581 |
status = disk_set_information(file, info_level, s, &out); |
582 |
result = buffer_len = out.p - out.data; |
583 |
break; |
584 |
|
585 |
case IRP_MJ_QUERY_VOLUME_INFORMATION: |
586 |
|
587 |
if (g_rdpdr_device[device].device_type != DEVICE_TYPE_DISK) |
588 |
{ |
589 |
status = STATUS_INVALID_HANDLE; |
590 |
break; |
591 |
} |
592 |
|
593 |
in_uint32_le(s, info_level); |
594 |
|
595 |
out.data = out.p = buffer; |
596 |
out.size = sizeof(buffer); |
597 |
status = disk_query_volume_information(file, info_level, &out); |
598 |
result = buffer_len = out.p - out.data; |
599 |
break; |
600 |
|
601 |
case IRP_MJ_DIRECTORY_CONTROL: |
602 |
|
603 |
if (g_rdpdr_device[device].device_type != DEVICE_TYPE_DISK) |
604 |
{ |
605 |
status = STATUS_INVALID_HANDLE; |
606 |
break; |
607 |
} |
608 |
|
609 |
switch (minor) |
610 |
{ |
611 |
case IRP_MN_QUERY_DIRECTORY: |
612 |
|
613 |
in_uint32_le(s, info_level); |
614 |
in_uint8s(s, 1); |
615 |
in_uint32_le(s, length); |
616 |
in_uint8s(s, 0x17); |
617 |
if (length && length < 2 * 255) |
618 |
{ |
619 |
rdp_in_unistr(s, filename, length); |
620 |
convert_to_unix_filename(filename); |
621 |
} |
622 |
else |
623 |
{ |
624 |
filename[0] = 0; |
625 |
} |
626 |
out.data = out.p = buffer; |
627 |
out.size = sizeof(buffer); |
628 |
status = disk_query_directory(file, info_level, filename, |
629 |
&out); |
630 |
result = buffer_len = out.p - out.data; |
631 |
if (!buffer_len) |
632 |
buffer_len++; |
633 |
break; |
634 |
|
635 |
case IRP_MN_NOTIFY_CHANGE_DIRECTORY: |
636 |
|
637 |
/* JIF |
638 |
unimpl("IRP major=0x%x minor=0x%x: IRP_MN_NOTIFY_CHANGE_DIRECTORY\n", major, minor); */ |
639 |
|
640 |
in_uint32_le(s, info_level); /* notify mask */ |
641 |
|
642 |
g_notify_stamp = True; |
643 |
|
644 |
status = disk_create_notify(file, info_level); |
645 |
result = 0; |
646 |
|
647 |
if (status == STATUS_PENDING) |
648 |
add_async_iorequest(device, file, id, major, length, |
649 |
fns, 0, 0, NULL, 0); |
650 |
break; |
651 |
|
652 |
default: |
653 |
|
654 |
status = STATUS_INVALID_PARAMETER; |
655 |
/* JIF */ |
656 |
unimpl("IRP major=0x%x minor=0x%x\n", major, minor); |
657 |
} |
658 |
break; |
659 |
|
660 |
case IRP_MJ_DEVICE_CONTROL: |
661 |
|
662 |
if (!fns->device_control) |
663 |
{ |
664 |
status = STATUS_NOT_SUPPORTED; |
665 |
break; |
666 |
} |
667 |
|
668 |
in_uint32_le(s, bytes_out); |
669 |
in_uint32_le(s, bytes_in); |
670 |
in_uint32_le(s, request); |
671 |
in_uint8s(s, 0x14); |
672 |
|
673 |
buffer = (uint8 *) xrealloc((void *) buffer, bytes_out + 0x14); |
674 |
if (!buffer) |
675 |
{ |
676 |
status = STATUS_CANCELLED; |
677 |
break; |
678 |
} |
679 |
|
680 |
out.data = out.p = buffer; |
681 |
out.size = sizeof(buffer); |
682 |
#ifdef WITH_SCARD_DEBUG |
683 |
printf("[SMART-CARD TRACE]\n"); |
684 |
printf("device 0x%.8x\n", device); |
685 |
printf("file 0x%.8x\n", file); |
686 |
printf("id 0x%.8x\n", id); |
687 |
#endif |
688 |
#ifdef WITH_SCARD |
689 |
scardSetInfo(device, id, bytes_out + 0x14); |
690 |
#endif |
691 |
status = fns->device_control(file, request, s, &out); |
692 |
result = buffer_len = out.p - out.data; |
693 |
#ifdef WITH_SCARD_DEBUG |
694 |
printf("[SMART-CARD TRACE] OUT 0x%.8x\n", status); |
695 |
#endif |
696 |
/* Serial SERIAL_WAIT_ON_MASK */ |
697 |
if (status == STATUS_PENDING) |
698 |
{ |
699 |
if (add_async_iorequest |
700 |
(device, file, id, major, length, fns, 0, 0, NULL, 0)) |
701 |
{ |
702 |
status = STATUS_PENDING; |
703 |
break; |
704 |
} |
705 |
} |
706 |
#ifdef WITH_SCARD |
707 |
else if (status == (STATUS_PENDING | 0xC0000000)) |
708 |
status = STATUS_PENDING; |
709 |
#endif |
710 |
break; |
711 |
|
712 |
|
713 |
case IRP_MJ_LOCK_CONTROL: |
714 |
|
715 |
if (g_rdpdr_device[device].device_type != DEVICE_TYPE_DISK) |
716 |
{ |
717 |
status = STATUS_INVALID_HANDLE; |
718 |
break; |
719 |
} |
720 |
|
721 |
in_uint32_le(s, info_level); |
722 |
|
723 |
out.data = out.p = buffer; |
724 |
out.size = sizeof(buffer); |
725 |
/* FIXME: Perhaps consider actually *do* |
726 |
something here :-) */ |
727 |
status = STATUS_SUCCESS; |
728 |
result = buffer_len = out.p - out.data; |
729 |
break; |
730 |
|
731 |
default: |
732 |
unimpl("IRP major=0x%x minor=0x%x\n", major, minor); |
733 |
break; |
734 |
} |
735 |
|
736 |
if (status != STATUS_PENDING) |
737 |
{ |
738 |
rdpdr_send_completion(device, id, status, result, buffer, buffer_len); |
739 |
} |
740 |
if (buffer) |
741 |
xfree(buffer); |
742 |
buffer = NULL; |
743 |
} |
744 |
|
745 |
static void |
746 |
rdpdr_send_clientcapabilty(void) |
747 |
{ |
748 |
uint8 magic[4] = "rDPC"; |
749 |
STREAM s; |
750 |
|
751 |
s = channel_init(rdpdr_channel, 0x50); |
752 |
out_uint8a(s, magic, 4); |
753 |
out_uint32_le(s, 5); /* count */ |
754 |
out_uint16_le(s, 1); /* first */ |
755 |
out_uint16_le(s, 0x28); /* length */ |
756 |
out_uint32_le(s, 1); |
757 |
out_uint32_le(s, 2); |
758 |
out_uint16_le(s, 2); |
759 |
out_uint16_le(s, 5); |
760 |
out_uint16_le(s, 1); |
761 |
out_uint16_le(s, 5); |
762 |
out_uint16_le(s, 0xFFFF); |
763 |
out_uint16_le(s, 0); |
764 |
out_uint32_le(s, 0); |
765 |
out_uint32_le(s, 3); |
766 |
out_uint32_le(s, 0); |
767 |
out_uint32_le(s, 0); |
768 |
out_uint16_le(s, 2); /* second */ |
769 |
out_uint16_le(s, 8); /* length */ |
770 |
out_uint32_le(s, 1); |
771 |
out_uint16_le(s, 3); /* third */ |
772 |
out_uint16_le(s, 8); /* length */ |
773 |
out_uint32_le(s, 1); |
774 |
out_uint16_le(s, 4); /* fourth */ |
775 |
out_uint16_le(s, 8); /* length */ |
776 |
out_uint32_le(s, 1); |
777 |
out_uint16_le(s, 5); /* fifth */ |
778 |
out_uint16_le(s, 8); /* length */ |
779 |
out_uint32_le(s, 1); |
780 |
|
781 |
s_mark_end(s); |
782 |
channel_send(s, rdpdr_channel); |
783 |
} |
784 |
|
785 |
static void |
786 |
rdpdr_process(STREAM s) |
787 |
{ |
788 |
uint32 handle; |
789 |
uint8 *magic; |
790 |
|
791 |
#if WITH_DEBUG_RDP5 |
792 |
printf("--- rdpdr_process ---\n"); |
793 |
hexdump(s->p, s->end - s->p); |
794 |
#endif |
795 |
in_uint8p(s, magic, 4); |
796 |
|
797 |
if ((magic[0] == 'r') && (magic[1] == 'D')) |
798 |
{ |
799 |
if ((magic[2] == 'R') && (magic[3] == 'I')) |
800 |
{ |
801 |
rdpdr_process_irp(s); |
802 |
return; |
803 |
} |
804 |
if ((magic[2] == 'n') && (magic[3] == 'I')) |
805 |
{ |
806 |
rdpdr_send_connect(); |
807 |
rdpdr_send_name(); |
808 |
return; |
809 |
} |
810 |
if ((magic[2] == 'C') && (magic[3] == 'C')) |
811 |
{ |
812 |
/* connect from server */ |
813 |
rdpdr_send_clientcapabilty(); |
814 |
rdpdr_send_available(); |
815 |
return; |
816 |
} |
817 |
if ((magic[2] == 'r') && (magic[3] == 'd')) |
818 |
{ |
819 |
/* connect to a specific resource */ |
820 |
in_uint32(s, handle); |
821 |
#if WITH_DEBUG_RDP5 |
822 |
DEBUG(("RDPDR: Server connected to resource %d\n", handle)); |
823 |
#endif |
824 |
return; |
825 |
} |
826 |
if ((magic[2] == 'P') && (magic[3] == 'S')) |
827 |
{ |
828 |
/* server capability */ |
829 |
return; |
830 |
} |
831 |
} |
832 |
if ((magic[0] == 'R') && (magic[1] == 'P')) |
833 |
{ |
834 |
if ((magic[2] == 'C') && (magic[3] == 'P')) |
835 |
{ |
836 |
printercache_process(s); |
837 |
return; |
838 |
} |
839 |
} |
840 |
unimpl("RDPDR packet type %c%c%c%c\n", magic[0], magic[1], magic[2], magic[3]); |
841 |
} |
842 |
|
843 |
BOOL |
844 |
rdpdr_init() |
845 |
{ |
846 |
if (g_num_devices > 0) |
847 |
{ |
848 |
rdpdr_channel = |
849 |
channel_register("rdpdr", |
850 |
CHANNEL_OPTION_INITIALIZED | CHANNEL_OPTION_COMPRESS_RDP, |
851 |
rdpdr_process); |
852 |
} |
853 |
|
854 |
return (rdpdr_channel != NULL); |
855 |
} |
856 |
|
857 |
/* Add file descriptors of pending io request to select() */ |
858 |
void |
859 |
rdpdr_add_fds(int *n, fd_set * rfds, fd_set * wfds, struct timeval *tv, BOOL * timeout) |
860 |
{ |
861 |
uint32 select_timeout = 0; /* Timeout value to be used for select() (in millisecons). */ |
862 |
struct async_iorequest *iorq; |
863 |
char c; |
864 |
|
865 |
iorq = g_iorequest; |
866 |
while (iorq != NULL) |
867 |
{ |
868 |
if (iorq->fd != 0) |
869 |
{ |
870 |
switch (iorq->major) |
871 |
{ |
872 |
case IRP_MJ_READ: |
873 |
/* Is this FD valid? FDs will |
874 |
be invalid when |
875 |
reconnecting. FIXME: Real |
876 |
support for reconnects. */ |
877 |
|
878 |
FD_SET(iorq->fd, rfds); |
879 |
*n = MAX(*n, iorq->fd); |
880 |
|
881 |
/* Check if io request timeout is smaller than current (but not 0). */ |
882 |
if (iorq->timeout |
883 |
&& (select_timeout == 0 |
884 |
|| iorq->timeout < select_timeout)) |
885 |
{ |
886 |
/* Set new timeout */ |
887 |
select_timeout = iorq->timeout; |
888 |
g_min_timeout_fd = iorq->fd; /* Remember fd */ |
889 |
tv->tv_sec = select_timeout / 1000; |
890 |
tv->tv_usec = (select_timeout % 1000) * 1000; |
891 |
*timeout = True; |
892 |
break; |
893 |
} |
894 |
if (iorq->itv_timeout && iorq->partial_len > 0 |
895 |
&& (select_timeout == 0 |
896 |
|| iorq->itv_timeout < select_timeout)) |
897 |
{ |
898 |
/* Set new timeout */ |
899 |
select_timeout = iorq->itv_timeout; |
900 |
g_min_timeout_fd = iorq->fd; /* Remember fd */ |
901 |
tv->tv_sec = select_timeout / 1000; |
902 |
tv->tv_usec = (select_timeout % 1000) * 1000; |
903 |
*timeout = True; |
904 |
break; |
905 |
} |
906 |
break; |
907 |
|
908 |
case IRP_MJ_WRITE: |
909 |
/* FD still valid? See above. */ |
910 |
if ((write(iorq->fd, &c, 0) != 0) && (errno == EBADF)) |
911 |
break; |
912 |
|
913 |
FD_SET(iorq->fd, wfds); |
914 |
*n = MAX(*n, iorq->fd); |
915 |
break; |
916 |
|
917 |
case IRP_MJ_DEVICE_CONTROL: |
918 |
if (select_timeout > 5) |
919 |
select_timeout = 5; /* serial event queue */ |
920 |
break; |
921 |
|
922 |
} |
923 |
|
924 |
} |
925 |
|
926 |
iorq = iorq->next; |
927 |
} |
928 |
} |
929 |
|
930 |
struct async_iorequest * |
931 |
rdpdr_remove_iorequest(struct async_iorequest *prev, struct async_iorequest *iorq) |
932 |
{ |
933 |
if (!iorq) |
934 |
return NULL; |
935 |
|
936 |
if (iorq->buffer) |
937 |
xfree(iorq->buffer); |
938 |
if (prev) |
939 |
{ |
940 |
prev->next = iorq->next; |
941 |
xfree(iorq); |
942 |
iorq = prev->next; |
943 |
} |
944 |
else |
945 |
{ |
946 |
/* Even if NULL */ |
947 |
g_iorequest = iorq->next; |
948 |
xfree(iorq); |
949 |
iorq = NULL; |
950 |
} |
951 |
return iorq; |
952 |
} |
953 |
|
954 |
/* Check if select() returned with one of the rdpdr file descriptors, and complete io if it did */ |
955 |
static void |
956 |
_rdpdr_check_fds(fd_set * rfds, fd_set * wfds, BOOL timed_out) |
957 |
{ |
958 |
NTSTATUS status; |
959 |
uint32 result = 0; |
960 |
DEVICE_FNS *fns; |
961 |
struct async_iorequest *iorq; |
962 |
struct async_iorequest *prev; |
963 |
uint32 req_size = 0; |
964 |
uint32 buffer_len; |
965 |
struct stream out; |
966 |
uint8 *buffer = NULL; |
967 |
|
968 |
|
969 |
if (timed_out) |
970 |
{ |
971 |
/* check serial iv_timeout */ |
972 |
|
973 |
iorq = g_iorequest; |
974 |
prev = NULL; |
975 |
while (iorq != NULL) |
976 |
{ |
977 |
if (iorq->fd == g_min_timeout_fd) |
978 |
{ |
979 |
if ((iorq->partial_len > 0) && |
980 |
(g_rdpdr_device[iorq->device].device_type == |
981 |
DEVICE_TYPE_SERIAL)) |
982 |
{ |
983 |
|
984 |
/* iv_timeout between 2 chars, send partial_len */ |
985 |
/*printf("RDPDR: IVT total %u bytes read of %u\n", iorq->partial_len, iorq->length); */ |
986 |
rdpdr_send_completion(iorq->device, |
987 |
iorq->id, STATUS_SUCCESS, |
988 |
iorq->partial_len, |
989 |
iorq->buffer, iorq->partial_len); |
990 |
iorq = rdpdr_remove_iorequest(prev, iorq); |
991 |
return; |
992 |
} |
993 |
else |
994 |
{ |
995 |
break; |
996 |
} |
997 |
|
998 |
} |
999 |
else |
1000 |
{ |
1001 |
break; |
1002 |
} |
1003 |
|
1004 |
|
1005 |
prev = iorq; |
1006 |
if (iorq) |
1007 |
iorq = iorq->next; |
1008 |
|
1009 |
} |
1010 |
|
1011 |
rdpdr_abort_io(g_min_timeout_fd, 0, STATUS_TIMEOUT); |
1012 |
return; |
1013 |
} |
1014 |
|
1015 |
iorq = g_iorequest; |
1016 |
prev = NULL; |
1017 |
while (iorq != NULL) |
1018 |
{ |
1019 |
if (iorq->fd != 0) |
1020 |
{ |
1021 |
switch (iorq->major) |
1022 |
{ |
1023 |
case IRP_MJ_READ: |
1024 |
if (FD_ISSET(iorq->fd, rfds)) |
1025 |
{ |
1026 |
/* Read the data */ |
1027 |
fns = iorq->fns; |
1028 |
|
1029 |
req_size = |
1030 |
(iorq->length - iorq->partial_len) > |
1031 |
8192 ? 8192 : (iorq->length - |
1032 |
iorq->partial_len); |
1033 |
/* never read larger chunks than 8k - chances are that it will block */ |
1034 |
status = fns->read(iorq->fd, |
1035 |
iorq->buffer + iorq->partial_len, |
1036 |
req_size, iorq->offset, &result); |
1037 |
|
1038 |
if ((long) result > 0) |
1039 |
{ |
1040 |
iorq->partial_len += result; |
1041 |
iorq->offset += result; |
1042 |
} |
1043 |
#if WITH_DEBUG_RDP5 |
1044 |
DEBUG(("RDPDR: %d bytes of data read\n", result)); |
1045 |
#endif |
1046 |
/* only delete link if all data has been transfered */ |
1047 |
/* or if result was 0 and status success - EOF */ |
1048 |
if ((iorq->partial_len == iorq->length) || |
1049 |
(result == 0)) |
1050 |
{ |
1051 |
#if WITH_DEBUG_RDP5 |
1052 |
DEBUG(("RDPDR: AIO total %u bytes read of %u\n", iorq->partial_len, iorq->length)); |
1053 |
#endif |
1054 |
rdpdr_send_completion(iorq->device, |
1055 |
iorq->id, status, |
1056 |
iorq->partial_len, |
1057 |
iorq->buffer, |
1058 |
iorq->partial_len); |
1059 |
iorq = rdpdr_remove_iorequest(prev, iorq); |
1060 |
} |
1061 |
} |
1062 |
break; |
1063 |
case IRP_MJ_WRITE: |
1064 |
if (FD_ISSET(iorq->fd, wfds)) |
1065 |
{ |
1066 |
/* Write data. */ |
1067 |
fns = iorq->fns; |
1068 |
|
1069 |
req_size = |
1070 |
(iorq->length - iorq->partial_len) > |
1071 |
8192 ? 8192 : (iorq->length - |
1072 |
iorq->partial_len); |
1073 |
|
1074 |
/* never write larger chunks than 8k - chances are that it will block */ |
1075 |
status = fns->write(iorq->fd, |
1076 |
iorq->buffer + |
1077 |
iorq->partial_len, req_size, |
1078 |
iorq->offset, &result); |
1079 |
|
1080 |
if ((long) result > 0) |
1081 |
{ |
1082 |
iorq->partial_len += result; |
1083 |
iorq->offset += result; |
1084 |
} |
1085 |
|
1086 |
#if WITH_DEBUG_RDP5 |
1087 |
DEBUG(("RDPDR: %d bytes of data written\n", |
1088 |
result)); |
1089 |
#endif |
1090 |
/* only delete link if all data has been transfered */ |
1091 |
/* or we couldn't write */ |
1092 |
if ((iorq->partial_len == iorq->length) |
1093 |
|| (result == 0)) |
1094 |
{ |
1095 |
#if WITH_DEBUG_RDP5 |
1096 |
DEBUG(("RDPDR: AIO total %u bytes written of %u\n", iorq->partial_len, iorq->length)); |
1097 |
#endif |
1098 |
rdpdr_send_completion(iorq->device, |
1099 |
iorq->id, status, |
1100 |
iorq->partial_len, |
1101 |
(uint8 *) "", 1); |
1102 |
|
1103 |
iorq = rdpdr_remove_iorequest(prev, iorq); |
1104 |
} |
1105 |
} |
1106 |
break; |
1107 |
case IRP_MJ_DEVICE_CONTROL: |
1108 |
if (serial_get_event(iorq->fd, &result)) |
1109 |
{ |
1110 |
buffer = (uint8 *) xrealloc((void *) buffer, 0x14); |
1111 |
out.data = out.p = buffer; |
1112 |
out.size = sizeof(buffer); |
1113 |
out_uint32_le(&out, result); |
1114 |
result = buffer_len = out.p - out.data; |
1115 |
status = STATUS_SUCCESS; |
1116 |
rdpdr_send_completion(iorq->device, iorq->id, |
1117 |
status, result, buffer, |
1118 |
buffer_len); |
1119 |
xfree(buffer); |
1120 |
iorq = rdpdr_remove_iorequest(prev, iorq); |
1121 |
} |
1122 |
|
1123 |
break; |
1124 |
} |
1125 |
|
1126 |
} |
1127 |
prev = iorq; |
1128 |
if (iorq) |
1129 |
iorq = iorq->next; |
1130 |
} |
1131 |
|
1132 |
/* Check notify */ |
1133 |
iorq = g_iorequest; |
1134 |
prev = NULL; |
1135 |
while (iorq != NULL) |
1136 |
{ |
1137 |
if (iorq->fd != 0) |
1138 |
{ |
1139 |
switch (iorq->major) |
1140 |
{ |
1141 |
|
1142 |
case IRP_MJ_DIRECTORY_CONTROL: |
1143 |
if (g_rdpdr_device[iorq->device].device_type == |
1144 |
DEVICE_TYPE_DISK) |
1145 |
{ |
1146 |
|
1147 |
if (g_notify_stamp) |
1148 |
{ |
1149 |
g_notify_stamp = False; |
1150 |
status = disk_check_notify(iorq->fd); |
1151 |
if (status != STATUS_PENDING) |
1152 |
{ |
1153 |
rdpdr_send_completion(iorq->device, |
1154 |
iorq->id, |
1155 |
status, 0, |
1156 |
NULL, 0); |
1157 |
iorq = rdpdr_remove_iorequest(prev, |
1158 |
iorq); |
1159 |
} |
1160 |
} |
1161 |
} |
1162 |
break; |
1163 |
|
1164 |
|
1165 |
|
1166 |
} |
1167 |
} |
1168 |
|
1169 |
prev = iorq; |
1170 |
if (iorq) |
1171 |
iorq = iorq->next; |
1172 |
} |
1173 |
|
1174 |
} |
1175 |
|
1176 |
void |
1177 |
rdpdr_check_fds(fd_set * rfds, fd_set * wfds, BOOL timed_out) |
1178 |
{ |
1179 |
fd_set dummy; |
1180 |
|
1181 |
|
1182 |
FD_ZERO(&dummy); |
1183 |
|
1184 |
|
1185 |
/* fist check event queue only, |
1186 |
any serial wait event must be done before read block will be sent |
1187 |
*/ |
1188 |
|
1189 |
_rdpdr_check_fds(&dummy, &dummy, False); |
1190 |
_rdpdr_check_fds(rfds, wfds, timed_out); |
1191 |
} |
1192 |
|
1193 |
|
1194 |
/* Abort a pending io request for a given handle and major */ |
1195 |
BOOL |
1196 |
rdpdr_abort_io(uint32 fd, uint32 major, NTSTATUS status) |
1197 |
{ |
1198 |
uint32 result; |
1199 |
struct async_iorequest *iorq; |
1200 |
struct async_iorequest *prev; |
1201 |
|
1202 |
iorq = g_iorequest; |
1203 |
prev = NULL; |
1204 |
while (iorq != NULL) |
1205 |
{ |
1206 |
/* Only remove from table when major is not set, or when correct major is supplied. |
1207 |
Abort read should not abort a write io request. */ |
1208 |
if ((iorq->fd == fd) && (major == 0 || iorq->major == major)) |
1209 |
{ |
1210 |
result = 0; |
1211 |
rdpdr_send_completion(iorq->device, iorq->id, status, result, (uint8 *) "", |
1212 |
1); |
1213 |
|
1214 |
iorq = rdpdr_remove_iorequest(prev, iorq); |
1215 |
return True; |
1216 |
} |
1217 |
|
1218 |
prev = iorq; |
1219 |
iorq = iorq->next; |
1220 |
} |
1221 |
|
1222 |
return False; |
1223 |
} |