/[rdesktop]/sourceforge.net/trunk/rdesktop/rdpdr.c
This is repository of my old source code which isn't updated any more. Go to git.rot13.org for current projects!
ViewVC logotype

Contents of /sourceforge.net/trunk/rdesktop/rdpdr.c

Parent Directory Parent Directory | Revision Log Revision Log


Revision 1309 - (show annotations)
Wed Nov 1 20:52:01 2006 UTC (17 years, 7 months ago) by stargo
File MIME type: text/plain
File size: 27370 byte(s)
Smartcard support by Alexi Volkov <alexi@pravex.kiev.ua> and additional
patches for smartcard-support by Jennings Jared <jared.jennings.ctr@eglin.af.mil>

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 = &parallel_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 }

  ViewVC Help
Powered by ViewVC 1.1.26