/[rdesktop]/jpeg/rdesktop/trunk/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

Diff of /jpeg/rdesktop/trunk/rdpdr.c

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 590 by n-ki, Thu Jan 29 12:27:21 2004 UTC revision 948 by astrand, Tue Aug 2 09:45:11 2005 UTC
# Line 1  Line 1 
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>  #include <unistd.h>
37  #include <sys/types.h>  #include <sys/types.h>
38    #include <sys/time.h>
39    #include <dirent.h>             /* opendir, closedir, readdir */
40  #include <time.h>  #include <time.h>
41    #include <errno.h>
42  #include "rdesktop.h"  #include "rdesktop.h"
43    
 #define IRP_MJ_CREATE           0x00  
 #define IRP_MJ_CLOSE            0x02  
 #define IRP_MJ_READ             0x03  
 #define IRP_MJ_WRITE            0x04  
 #define IRP_MJ_DEVICE_CONTROL   0x0e  
   
44  #define IRP_MJ_CREATE                   0x00  #define IRP_MJ_CREATE                   0x00
45  #define IRP_MJ_CLOSE                    0x02  #define IRP_MJ_CLOSE                    0x02
46  #define IRP_MJ_READ                     0x03  #define IRP_MJ_READ                     0x03
# Line 18  Line 50 
50  #define IRP_MJ_QUERY_VOLUME_INFORMATION 0x0a  #define IRP_MJ_QUERY_VOLUME_INFORMATION 0x0a
51  #define IRP_MJ_DIRECTORY_CONTROL        0x0c  #define IRP_MJ_DIRECTORY_CONTROL        0x0c
52  #define IRP_MJ_DEVICE_CONTROL           0x0e  #define IRP_MJ_DEVICE_CONTROL           0x0e
53    #define IRP_MJ_LOCK_CONTROL             0x11
54    
55  #define IRP_MN_QUERY_DIRECTORY          0x01  #define IRP_MN_QUERY_DIRECTORY          0x01
56  #define IRP_MN_NOTIFY_CHANGE_DIRECTORY  0x02  #define IRP_MN_NOTIFY_CHANGE_DIRECTORY  0x02
57    
58  //#define MAX_ASYNC_IO_REQUESTS   10  extern char g_hostname[16];
   
 extern char hostname[16];  
59  extern DEVICE_FNS serial_fns;  extern DEVICE_FNS serial_fns;
60  extern DEVICE_FNS printer_fns;  extern DEVICE_FNS printer_fns;
61  extern DEVICE_FNS parallel_fns;  extern DEVICE_FNS parallel_fns;
62  extern DEVICE_FNS disk_fns;  extern DEVICE_FNS disk_fns;
63    extern FILEINFO g_fileinfo[];
64    extern BOOL g_notify_stamp;
65    
66  static VCHANNEL *rdpdr_channel;  static VCHANNEL *rdpdr_channel;
67    
68  /* If select() times out, the request for the device with handle g_min_timeout_fd is aborted */  /* If select() times out, the request for the device with handle g_min_timeout_fd is aborted */
69  HANDLE g_min_timeout_fd;  NTHANDLE g_min_timeout_fd;
70  uint32 g_num_devices;  uint32 g_num_devices;
71    
72  /* Table with information about rdpdr devices */  /* Table with information about rdpdr devices */
73  RDPDR_DEVICE g_rdpdr_device[RDPDR_MAX_DEVICES];  RDPDR_DEVICE g_rdpdr_device[RDPDR_MAX_DEVICES];
74    char *g_rdpdr_clientname = NULL;
75    
 #if 0  
76  /* Used to store incoming io request, until they are ready to be completed */  /* Used to store incoming io request, until they are ready to be completed */
77    /* using a linked list ensures that they are processed in the right order, */
78    /* if multiple ios are being done on the same fd */
79  struct async_iorequest  struct async_iorequest
80  {  {
81          uint32 fd, major, minor, offset, device, id, length;          uint32 fd, major, minor, offset, device, id, length, partial_len;
82          long timeout,           /* Total timeout */          long timeout,           /* Total timeout */
83            itv_timeout;          /* Interval timeout (between serial characters) */            itv_timeout;          /* Interval timeout (between serial characters) */
84          uint8 *buffer;          uint8 *buffer;
85          DEVICE_FNS *fns;          DEVICE_FNS *fns;
86  } g_iorequest[MAX_ASYNC_IO_REQUESTS];  
87  #endif          struct async_iorequest *next;   /* next element in list */
88    };
89    
90    struct async_iorequest *g_iorequest;
91    
92  /* Return device_id for a given handle */  /* Return device_id for a given handle */
93  int  int
94  get_device_index(HANDLE handle)  get_device_index(NTHANDLE handle)
95  {  {
96          int i;          int i;
97          for (i = 0; i < RDPDR_MAX_DEVICES; i++)          for (i = 0; i < RDPDR_MAX_DEVICES; i++)
# Line 77  convert_to_unix_filename(char *filename) Line 114  convert_to_unix_filename(char *filename)
114          }          }
115  }  }
116    
117  #if 0  static BOOL
118    rdpdr_handle_ok(int device, int handle)
119    {
120            switch (g_rdpdr_device[device].device_type)
121            {
122                    case DEVICE_TYPE_PARALLEL:
123                    case DEVICE_TYPE_SERIAL:
124                    case DEVICE_TYPE_PRINTER:
125                    case DEVICE_TYPE_SCARD:
126                            if (g_rdpdr_device[device].handle != handle)
127                                    return False;
128                            break;
129                    case DEVICE_TYPE_DISK:
130                            if (g_fileinfo[handle].device_id != device)
131                                    return False;
132                            break;
133            }
134            return True;
135    }
136    
137  /* Add a new io request to the table containing pending io requests so it won't block rdesktop */  /* Add a new io request to the table containing pending io requests so it won't block rdesktop */
138  BOOL  static BOOL
139  add_async_iorequest(uint32 device, uint32 file, uint32 id, uint32 major, uint32 length,  add_async_iorequest(uint32 device, uint32 file, uint32 id, uint32 major, uint32 length,
140                      DEVICE_FNS * fns, long total_timeout, long interval_timeout, uint8 * buffer)                      DEVICE_FNS * fns, uint32 total_timeout, uint32 interval_timeout, uint8 * buffer,
141                        uint32 offset)
142  {  {
         int i;  
143          struct async_iorequest *iorq;          struct async_iorequest *iorq;
144    
145          for (i = 0; i < MAX_ASYNC_IO_REQUESTS; i++)          if (g_iorequest == NULL)
146          {          {
147                  iorq = &g_iorequest[i];                  g_iorequest = (struct async_iorequest *) xmalloc(sizeof(struct async_iorequest));
148                    if (!g_iorequest)
149                            return False;
150                    g_iorequest->fd = 0;
151                    g_iorequest->next = NULL;
152            }
153    
154            iorq = g_iorequest;
155    
156                  if (iorq->fd == 0)          while (iorq->fd != 0)
157            {
158                    /* create new element if needed */
159                    if (iorq->next == NULL)
160                  {                  {
161                          iorq->device = device;                          iorq->next =
162                          iorq->fd = file;                                  (struct async_iorequest *) xmalloc(sizeof(struct async_iorequest));
163                          iorq->id = id;                          if (!iorq->next)
164                          iorq->major = major;                                  return False;
165                          iorq->length = length;                          iorq->next->fd = 0;
166                          iorq->fns = fns;                          iorq->next->next = NULL;
                         iorq->timeout = total_timeout;  
                         iorq->itv_timeout = interval_timeout;  
                         iorq->buffer = buffer;  
                         return True;  
167                  }                  }
168                    iorq = iorq->next;
169          }          }
170          error("IO request table full. Increase MAX_ASYNC_IO_REQUESTS in rdpdr.c!\n");          iorq->device = device;
171          return False;          iorq->fd = file;
172            iorq->id = id;
173            iorq->major = major;
174            iorq->length = length;
175            iorq->partial_len = 0;
176            iorq->fns = fns;
177            iorq->timeout = total_timeout;
178            iorq->itv_timeout = interval_timeout;
179            iorq->buffer = buffer;
180            iorq->offset = offset;
181            return True;
182  }  }
 #endif  
183    
184  void  static void
185  rdpdr_send_connect(void)  rdpdr_send_connect(void)
186  {  {
187          uint8 magic[4] = "rDCC";          uint8 magic[4] = "rDCC";
# Line 125  rdpdr_send_connect(void) Line 197  rdpdr_send_connect(void)
197  }  }
198    
199    
200  void  static void
201  rdpdr_send_name(void)  rdpdr_send_name(void)
202  {  {
203          uint8 magic[4] = "rDNC";          uint8 magic[4] = "rDNC";
         uint32 hostlen = (strlen(hostname) + 1) * 2;  
204          STREAM s;          STREAM s;
205            uint32 hostlen;
206    
207            if (NULL == g_rdpdr_clientname)
208            {
209                    g_rdpdr_clientname = g_hostname;
210            }
211            hostlen = (strlen(g_rdpdr_clientname) + 1) * 2;
212    
213          s = channel_init(rdpdr_channel, 16 + hostlen);          s = channel_init(rdpdr_channel, 16 + hostlen);
214          out_uint8a(s, magic, 4);          out_uint8a(s, magic, 4);
# Line 138  rdpdr_send_name(void) Line 216  rdpdr_send_name(void)
216          out_uint16_le(s, 0x72);          out_uint16_le(s, 0x72);
217          out_uint32(s, 0);          out_uint32(s, 0);
218          out_uint32_le(s, hostlen);          out_uint32_le(s, hostlen);
219          rdp_out_unistr(s, hostname, hostlen - 2);          rdp_out_unistr(s, g_rdpdr_clientname, hostlen - 2);
220          s_mark_end(s);          s_mark_end(s);
221          channel_send(s, rdpdr_channel);          channel_send(s, rdpdr_channel);
222  }  }
223    
224  /* Returns the size of the payload of the announce packet */  /* Returns the size of the payload of the announce packet */
225  int  static int
226  announcedata_size()  announcedata_size()
227  {  {
228          int size, i;          int size, i;
229          PRINTER *printerinfo;          PRINTER *printerinfo;
230    
231          size = 8;               //static announce size          size = 8;               /* static announce size */
232          size += g_num_devices * 0x14;          size += g_num_devices * 0x14;
233    
234          for (i = 0; i < g_num_devices; i++)          for (i = 0; i < g_num_devices; i++)
# Line 171  announcedata_size() Line 249  announcedata_size()
249          return size;          return size;
250  }  }
251    
252  void  static void
253  rdpdr_send_available(void)  rdpdr_send_available(void)
254  {  {
255    
# Line 189  rdpdr_send_available(void) Line 267  rdpdr_send_available(void)
267          {          {
268                  out_uint32_le(s, g_rdpdr_device[i].device_type);                  out_uint32_le(s, g_rdpdr_device[i].device_type);
269                  out_uint32_le(s, i);    /* RDP Device ID */                  out_uint32_le(s, i);    /* RDP Device ID */
270                    /* Is it possible to use share names longer than 8 chars?
271                       /astrand */
272                  out_uint8p(s, g_rdpdr_device[i].name, 8);                  out_uint8p(s, g_rdpdr_device[i].name, 8);
273    
274                  switch (g_rdpdr_device[i].device_type)                  switch (g_rdpdr_device[i].device_type)
# Line 210  rdpdr_send_available(void) Line 290  rdpdr_send_available(void)
290                                  rdp_out_unistr(s, printerinfo->printer, printerlen - 2);                                  rdp_out_unistr(s, printerinfo->printer, printerlen - 2);
291                                  out_uint8a(s, printerinfo->blob, bloblen);                                  out_uint8a(s, printerinfo->blob, bloblen);
292    
293                                  xfree(printerinfo->blob);       /* Blob is sent twice if reconnecting */                                  if (printerinfo->blob)
294                                            xfree(printerinfo->blob);       /* Blob is sent twice if reconnecting */
295                                  break;                                  break;
296                          default:                          default:
297                                  out_uint32(s, 0);                                  out_uint32(s, 0);
# Line 228  rdpdr_send_available(void) Line 309  rdpdr_send_available(void)
309          channel_send(s, rdpdr_channel);          channel_send(s, rdpdr_channel);
310  }  }
311    
312  void  static void
313  rdpdr_send_completion(uint32 device, uint32 id, uint32 status, uint32 result, uint8 * buffer,  rdpdr_send_completion(uint32 device, uint32 id, uint32 status, uint32 result, uint8 * buffer,
314                        uint32 length)                        uint32 length)
315  {  {
# Line 243  rdpdr_send_completion(uint32 device, uin Line 324  rdpdr_send_completion(uint32 device, uin
324          out_uint32_le(s, result);          out_uint32_le(s, result);
325          out_uint8p(s, buffer, length);          out_uint8p(s, buffer, length);
326          s_mark_end(s);          s_mark_end(s);
327          /* JIF          /* JIF */
328             hexdump(s->channel_hdr + 8, s->end - s->channel_hdr - 8); */  #ifdef WITH_DEBUG_RDP5
329            printf("--> rdpdr_send_completion\n");
330            /* hexdump(s->channel_hdr + 8, s->end - s->channel_hdr - 8); */
331    #endif
332          channel_send(s, rdpdr_channel);          channel_send(s, rdpdr_channel);
333  }  }
334    
# Line 290  rdpdr_process_irp(STREAM s) Line 374  rdpdr_process_irp(STREAM s)
374                  case DEVICE_TYPE_SERIAL:                  case DEVICE_TYPE_SERIAL:
375    
376                          fns = &serial_fns;                          fns = &serial_fns;
377                          /* should be async when aio is finished */                          rw_blocking = False;
                         /*rw_blocking = False; */  
378                          break;                          break;
379    
380                  case DEVICE_TYPE_PARALLEL:                  case DEVICE_TYPE_PARALLEL:
381    
382                          fns = &parallel_fns;                          fns = &parallel_fns;
383                          /* should be async when aio is finished */                          rw_blocking = False;
                         /*rw_blocking = False;*/  
384                          break;                          break;
385    
386                  case DEVICE_TYPE_PRINTER:                  case DEVICE_TYPE_PRINTER:
# Line 309  rdpdr_process_irp(STREAM s) Line 391  rdpdr_process_irp(STREAM s)
391                  case DEVICE_TYPE_DISK:                  case DEVICE_TYPE_DISK:
392    
393                          fns = &disk_fns;                          fns = &disk_fns;
394                            rw_blocking = False;
395                          break;                          break;
396    
397                  case DEVICE_TYPE_SCARD:                  case DEVICE_TYPE_SCARD:
# Line 323  rdpdr_process_irp(STREAM s) Line 406  rdpdr_process_irp(STREAM s)
406                  case IRP_MJ_CREATE:                  case IRP_MJ_CREATE:
407    
408                          in_uint32_be(s, desired_access);                          in_uint32_be(s, desired_access);
409                          in_uint8s(s, 0x08);     // unknown                          in_uint8s(s, 0x08);     /* unknown */
410                          in_uint32_le(s, error_mode);                          in_uint32_le(s, error_mode);
411                          in_uint32_le(s, share_mode);                          in_uint32_le(s, share_mode);
412                          in_uint32_le(s, disposition);                          in_uint32_le(s, disposition);
# Line 374  rdpdr_process_irp(STREAM s) Line 457  rdpdr_process_irp(STREAM s)
457  #if WITH_DEBUG_RDP5  #if WITH_DEBUG_RDP5
458                          DEBUG(("RDPDR IRP Read (length: %d, offset: %d)\n", length, offset));                          DEBUG(("RDPDR IRP Read (length: %d, offset: %d)\n", length, offset));
459  #endif  #endif
460  //                      if (rw_blocking)        // Complete read immediately                          if (!rdpdr_handle_ok(device, file))
461  //                      {                          {
462                                    status = STATUS_INVALID_HANDLE;
463                                    break;
464                            }
465    
466                            if (rw_blocking)        /* Complete read immediately */
467                            {
468                                  buffer = (uint8 *) xrealloc((void *) buffer, length);                                  buffer = (uint8 *) xrealloc((void *) buffer, length);
469                                    if (!buffer)
470                                    {
471                                            status = STATUS_CANCELLED;
472                                            break;
473                                    }
474                                  status = fns->read(file, buffer, length, offset, &result);                                  status = fns->read(file, buffer, length, offset, &result);
475                                  buffer_len = result;                                  buffer_len = result;
476                                  break;                                  break;
477  //                      }                          }
478    
479  #if 0                          /* Add request to table */
                         // Add request to table  
480                          pst_buf = (uint8 *) xmalloc(length);                          pst_buf = (uint8 *) xmalloc(length);
481                            if (!pst_buf)
482                            {
483                                    status = STATUS_CANCELLED;
484                                    break;
485                            }
486                          serial_get_timeout(file, length, &total_timeout, &interval_timeout);                          serial_get_timeout(file, length, &total_timeout, &interval_timeout);
487                          if (add_async_iorequest                          if (add_async_iorequest
488                              (device, file, id, major, length, fns, total_timeout, interval_timeout,                              (device, file, id, major, length, fns, total_timeout, interval_timeout,
489                               pst_buf))                               pst_buf, offset))
490                          {                          {
491                                  status = STATUS_PENDING;                                  status = STATUS_PENDING;
492                                  break;                                  break;
# Line 396  rdpdr_process_irp(STREAM s) Line 494  rdpdr_process_irp(STREAM s)
494    
495                          status = STATUS_CANCELLED;                          status = STATUS_CANCELLED;
496                          break;                          break;
 #endif  
497                  case IRP_MJ_WRITE:                  case IRP_MJ_WRITE:
498    
499                          buffer_len = 1;                          buffer_len = 1;
# Line 413  rdpdr_process_irp(STREAM s) Line 510  rdpdr_process_irp(STREAM s)
510  #if WITH_DEBUG_RDP5  #if WITH_DEBUG_RDP5
511                          DEBUG(("RDPDR IRP Write (length: %d)\n", result));                          DEBUG(("RDPDR IRP Write (length: %d)\n", result));
512  #endif  #endif
513  //                      if (rw_blocking)        // Complete immediately                          if (!rdpdr_handle_ok(device, file))
514  //                      {                          {
515                                    status = STATUS_INVALID_HANDLE;
516                                    break;
517                            }
518    
519                            if (rw_blocking)        /* Complete immediately */
520                            {
521                                  status = fns->write(file, s->p, length, offset, &result);                                  status = fns->write(file, s->p, length, offset, &result);
522                                  break;                                  break;
523  //                      }                          }
524  #if 0  
525                          // Add to table                          /* Add to table */
526                          pst_buf = (uint8 *) xmalloc(length);                          pst_buf = (uint8 *) xmalloc(length);
527                            if (!pst_buf)
528                            {
529                                    status = STATUS_CANCELLED;
530                                    break;
531                            }
532    
533                          in_uint8a(s, pst_buf, length);                          in_uint8a(s, pst_buf, length);
534    
535                          if (add_async_iorequest                          if (add_async_iorequest
536                              (device, file, id, major, length, fns, 0, 0, pst_buf))                              (device, file, id, major, length, fns, 0, 0, pst_buf, offset))
537                          {                          {
538                                  status = STATUS_PENDING;                                  status = STATUS_PENDING;
539                                  break;                                  break;
# Line 432  rdpdr_process_irp(STREAM s) Line 541  rdpdr_process_irp(STREAM s)
541    
542                          status = STATUS_CANCELLED;                          status = STATUS_CANCELLED;
543                          break;                          break;
 #endif  
544    
545                  case IRP_MJ_QUERY_INFORMATION:                  case IRP_MJ_QUERY_INFORMATION:
546    
# Line 519  rdpdr_process_irp(STREAM s) Line 627  rdpdr_process_irp(STREAM s)
627                                  case IRP_MN_NOTIFY_CHANGE_DIRECTORY:                                  case IRP_MN_NOTIFY_CHANGE_DIRECTORY:
628    
629                                          /* JIF                                          /* JIF
630                                             unimpl("IRP major=0x%x minor=0x%x: IRP_MN_NOTIFY_CHANGE_DIRECTORY\n", major, minor); */                                             unimpl("IRP major=0x%x minor=0x%x: IRP_MN_NOTIFY_CHANGE_DIRECTORY\n", major, minor);  */
631                                          status = STATUS_PENDING;        // Don't send completion packet  
632                                            in_uint32_le(s, info_level);    /* notify mask */
633    
634                                            g_notify_stamp = True;
635    
636                                            status = disk_create_notify(file, info_level);
637                                            result = 0;
638    
639                                            if (status == STATUS_PENDING)
640                                                    add_async_iorequest(device, file, id, major, length,
641                                                                        fns, 0, 0, NULL, 0);
642                                          break;                                          break;
643    
644                                  default:                                  default:
645    
646                                          status = STATUS_INVALID_PARAMETER;                                          status = STATUS_INVALID_PARAMETER;
647                                          /* JIF                                          /* JIF */
648                                             unimpl("IRP major=0x%x minor=0x%x\n", major, minor); */                                          unimpl("IRP major=0x%x minor=0x%x\n", major, minor);
649                          }                          }
650                          break;                          break;
651    
# Line 545  rdpdr_process_irp(STREAM s) Line 663  rdpdr_process_irp(STREAM s)
663                          in_uint8s(s, 0x14);                          in_uint8s(s, 0x14);
664    
665                          buffer = (uint8 *) xrealloc((void *) buffer, bytes_out + 0x14);                          buffer = (uint8 *) xrealloc((void *) buffer, bytes_out + 0x14);
666                            if (!buffer)
667                            {
668                                    status = STATUS_CANCELLED;
669                                    break;
670                            }
671    
672                          out.data = out.p = buffer;                          out.data = out.p = buffer;
673                          out.size = sizeof(buffer);                          out.size = sizeof(buffer);
674                          status = fns->device_control(file, request, s, &out);                          status = fns->device_control(file, request, s, &out);
675                          result = buffer_len = out.p - out.data;                          result = buffer_len = out.p - out.data;
676    
677                            /* Serial SERIAL_WAIT_ON_MASK */
678                            if (status == STATUS_PENDING)
679                            {
680                                    if (add_async_iorequest
681                                        (device, file, id, major, length, fns, 0, 0, NULL, 0))
682                                    {
683                                            status = STATUS_PENDING;
684                                            break;
685                                    }
686                            }
687                            break;
688    
689    
690                    case IRP_MJ_LOCK_CONTROL:
691    
692                            if (g_rdpdr_device[device].device_type != DEVICE_TYPE_DISK)
693                            {
694                                    status = STATUS_INVALID_HANDLE;
695                                    break;
696                            }
697    
698                            in_uint32_le(s, info_level);
699    
700                            out.data = out.p = buffer;
701                            out.size = sizeof(buffer);
702                            /* FIXME: Perhaps consider actually *do*
703                               something here :-) */
704                            status = STATUS_SUCCESS;
705                            result = buffer_len = out.p - out.data;
706                          break;                          break;
707    
708                  default:                  default:
# Line 560  rdpdr_process_irp(STREAM s) Line 714  rdpdr_process_irp(STREAM s)
714          {          {
715                  rdpdr_send_completion(device, id, status, result, buffer, buffer_len);                  rdpdr_send_completion(device, id, status, result, buffer, buffer_len);
716          }          }
717          xfree(buffer);          if (buffer)
718                    xfree(buffer);
719            buffer = NULL;
720  }  }
721    
722  void  static void
723  rdpdr_send_clientcapabilty(void)  rdpdr_send_clientcapabilty(void)
724  {  {
725          uint8 magic[4] = "rDPC";          uint8 magic[4] = "rDPC";
# Line 676  rdpdr_init() Line 831  rdpdr_init()
831          return (rdpdr_channel != NULL);          return (rdpdr_channel != NULL);
832  }  }
833    
 #if 0  
834  /* Add file descriptors of pending io request to select() */  /* Add file descriptors of pending io request to select() */
835  void  void
836  rdpdr_add_fds(int *n, fd_set * rfds, fd_set * wfds, struct timeval *tv, BOOL * timeout)  rdpdr_add_fds(int *n, fd_set * rfds, fd_set * wfds, struct timeval *tv, BOOL * timeout)
837  {  {
838          int i;          uint32 select_timeout = 0;      /* Timeout value to be used for select() (in millisecons). */
         long select_timeout = 0;        // Timeout value to be used for select() (in millisecons).  
839          struct async_iorequest *iorq;          struct async_iorequest *iorq;
840            char c;
841    
842          for (i = 0; i < MAX_ASYNC_IO_REQUESTS; i++)          iorq = g_iorequest;
843            while (iorq != NULL)
844          {          {
845                  iorq = &g_iorequest[i];                  if (iorq->fd != 0)
   
                 if (iorq->fd != 0)      // Found a pending io request  
846                  {                  {
847                          switch (iorq->major)                          switch (iorq->major)
848                          {                          {
849                                  case IRP_MJ_READ:                                  case IRP_MJ_READ:
850                                            /* Is this FD valid? FDs will
851                                               be invalid when
852                                               reconnecting. FIXME: Real
853                                               support for reconnects. */
854    
855                                          FD_SET(iorq->fd, rfds);                                          FD_SET(iorq->fd, rfds);
856                                            *n = MAX(*n, iorq->fd);
857    
858                                          // Check if io request timeout is smaller than current (but not 0).                                          /* Check if io request timeout is smaller than current (but not 0). */
859                                          if (iorq->timeout                                          if (iorq->timeout
860                                              && (select_timeout == 0                                              && (select_timeout == 0
861                                                  || iorq->timeout < select_timeout))                                                  || iorq->timeout < select_timeout))
862                                          {                                          {
863                                                  // Set new timeout                                                  /* Set new timeout */
864                                                  select_timeout = iorq->timeout;                                                  select_timeout = iorq->timeout;
865                                                  g_min_timeout_fd = iorq->fd;    /* Remember fd */                                                  g_min_timeout_fd = iorq->fd;    /* Remember fd */
866                                                  tv->tv_sec = select_timeout / 1000;                                                  tv->tv_sec = select_timeout / 1000;
867                                                  tv->tv_usec = (select_timeout % 1000) * 1000;                                                  tv->tv_usec = (select_timeout % 1000) * 1000;
868                                                  *timeout = True;                                                  *timeout = True;
869                                                    break;
870                                            }
871                                            if (iorq->itv_timeout && iorq->partial_len > 0
872                                                && (select_timeout == 0
873                                                    || iorq->itv_timeout < select_timeout))
874                                            {
875                                                    /* Set new timeout */
876                                                    select_timeout = iorq->itv_timeout;
877                                                    g_min_timeout_fd = iorq->fd;    /* Remember fd */
878                                                    tv->tv_sec = select_timeout / 1000;
879                                                    tv->tv_usec = (select_timeout % 1000) * 1000;
880                                                    *timeout = True;
881                                                    break;
882                                          }                                          }
883                                          break;                                          break;
884    
885                                  case IRP_MJ_WRITE:                                  case IRP_MJ_WRITE:
886                                            /* FD still valid? See above. */
887                                            if ((write(iorq->fd, &c, 0) != 0) && (errno == EBADF))
888                                                    break;
889    
890                                          FD_SET(iorq->fd, wfds);                                          FD_SET(iorq->fd, wfds);
891                                            *n = MAX(*n, iorq->fd);
892                                            break;
893    
894                                    case IRP_MJ_DEVICE_CONTROL:
895                                            if (select_timeout > 5)
896                                                    select_timeout = 5;     /* serial event queue */
897                                          break;                                          break;
898    
899                          }                          }
900                          *n = MAX(*n, iorq->fd);  
901                  }                  }
902    
903                    iorq = iorq->next;
904          }          }
905  }  }
906    
907    struct async_iorequest *
908    rdpdr_remove_iorequest(struct async_iorequest *prev, struct async_iorequest *iorq)
909    {
910            if (!iorq)
911                    return NULL;
912    
913            if (iorq->buffer)
914                    xfree(iorq->buffer);
915            if (prev)
916            {
917                    prev->next = iorq->next;
918                    xfree(iorq);
919                    iorq = prev->next;
920            }
921            else
922            {
923                    /* Even if NULL */
924                    g_iorequest = iorq->next;
925                    xfree(iorq);
926                    iorq = NULL;
927            }
928            return iorq;
929    }
930    
931  /* Check if select() returned with one of the rdpdr file descriptors, and complete io if it did */  /* Check if select() returned with one of the rdpdr file descriptors, and complete io if it did */
932  void  static void
933  rdpdr_check_fds(fd_set * rfds, fd_set * wfds, BOOL timed_out)  _rdpdr_check_fds(fd_set * rfds, fd_set * wfds, BOOL timed_out)
934  {  {
         int i;  
935          NTSTATUS status;          NTSTATUS status;
936          uint32 result = 0, buffer_len = 0;          uint32 result = 0;
937          DEVICE_FNS *fns;          DEVICE_FNS *fns;
938          struct async_iorequest *iorq;          struct async_iorequest *iorq;
939            struct async_iorequest *prev;
940            uint32 req_size = 0;
941            uint32 buffer_len;
942            struct stream out;
943            uint8 *buffer = NULL;
944    
945    
946          if (timed_out)          if (timed_out)
947          {          {
948                    /* check serial iv_timeout */
949    
950                    iorq = g_iorequest;
951                    prev = NULL;
952                    while (iorq != NULL)
953                    {
954                            if (iorq->fd == g_min_timeout_fd)
955                            {
956                                    if ((iorq->partial_len > 0) &&
957                                        (g_rdpdr_device[iorq->device].device_type ==
958                                         DEVICE_TYPE_SERIAL))
959                                    {
960    
961                                            /* iv_timeout between 2 chars, send partial_len */
962                                            /*printf("RDPDR: IVT total %u bytes read of %u\n", iorq->partial_len, iorq->length); */
963                                            rdpdr_send_completion(iorq->device,
964                                                                  iorq->id, STATUS_SUCCESS,
965                                                                  iorq->partial_len,
966                                                                  iorq->buffer, iorq->partial_len);
967                                            iorq = rdpdr_remove_iorequest(prev, iorq);
968                                            return;
969                                    }
970                                    else
971                                    {
972                                            break;
973                                    }
974    
975                            }
976                            else
977                            {
978                                    break;
979                            }
980    
981    
982                            prev = iorq;
983                            if (iorq)
984                                    iorq = iorq->next;
985    
986                    }
987    
988                  rdpdr_abort_io(g_min_timeout_fd, 0, STATUS_TIMEOUT);                  rdpdr_abort_io(g_min_timeout_fd, 0, STATUS_TIMEOUT);
989                  return;                  return;
990          }          }
991    
992          // Walk through array of pending io_rq's          iorq = g_iorequest;
993          for (i = 0; i < MAX_ASYNC_IO_REQUESTS; i++)          prev = NULL;
994            while (iorq != NULL)
995          {          {
                 iorq = &g_iorequest[i];  
   
996                  if (iorq->fd != 0)                  if (iorq->fd != 0)
997                  {                  {
998                          switch (iorq->major)                          switch (iorq->major)
999                          {                          {
   
1000                                  case IRP_MJ_READ:                                  case IRP_MJ_READ:
   
1001                                          if (FD_ISSET(iorq->fd, rfds))                                          if (FD_ISSET(iorq->fd, rfds))
1002                                          {                                          {
1003                                                  // Read, and send data.                                                  /* Read the data */
1004                                                  fns = iorq->fns;                                                  fns = iorq->fns;
                                                 status = fns->read(iorq->fd, iorq->buffer,  
                                                                    iorq->length, 0, &result);  
                                                 buffer_len = result;  
1005    
1006                                                  rdpdr_send_completion(iorq->device, iorq->id,                                                  req_size =
1007                                                                        status, result, iorq->buffer,                                                          (iorq->length - iorq->partial_len) >
1008                                                                        buffer_len);                                                          8192 ? 8192 : (iorq->length -
1009                                                                           iorq->partial_len);
1010                                                    /* never read larger chunks than 8k - chances are that it will block */
1011                                                    status = fns->read(iorq->fd,
1012                                                                       iorq->buffer + iorq->partial_len,
1013                                                                       req_size, iorq->offset, &result);
1014    
1015                                                    if ((long) result > 0)
1016                                                    {
1017                                                            iorq->partial_len += result;
1018                                                            iorq->offset += result;
1019                                                    }
1020  #if WITH_DEBUG_RDP5  #if WITH_DEBUG_RDP5
1021                                                  DEBUG(("RDPDR: %d bytes of data read\n", result));                                                  DEBUG(("RDPDR: %d bytes of data read\n", result));
1022  #endif  #endif
1023                                                  xfree(iorq->buffer);                                                  /* only delete link if all data has been transfered */
1024                                                  iorq->fd = 0;                                                  /* or if result was 0 and status success - EOF      */
1025                                                    if ((iorq->partial_len == iorq->length) ||
1026                                                        (result == 0))
1027                                                    {
1028    #if WITH_DEBUG_RDP5
1029                                                            DEBUG(("RDPDR: AIO total %u bytes read of %u\n", iorq->partial_len, iorq->length));
1030    #endif
1031                                                            rdpdr_send_completion(iorq->device,
1032                                                                                  iorq->id, status,
1033                                                                                  iorq->partial_len,
1034                                                                                  iorq->buffer,
1035                                                                                  iorq->partial_len);
1036                                                            iorq = rdpdr_remove_iorequest(prev, iorq);
1037                                                    }
1038                                          }                                          }
1039                                          break;                                          break;
   
1040                                  case IRP_MJ_WRITE:                                  case IRP_MJ_WRITE:
   
1041                                          if (FD_ISSET(iorq->fd, wfds))                                          if (FD_ISSET(iorq->fd, wfds))
1042                                          {                                          {
1043                                                  // Write data and send completion.                                                  /* Write data. */
1044                                                  fns = iorq->fns;                                                  fns = iorq->fns;
1045                                                  status = fns->write(iorq->fd, iorq->buffer,  
1046                                                                      iorq->length, 0, &result);                                                  req_size =
1047                                                            (iorq->length - iorq->partial_len) >
1048                                                            8192 ? 8192 : (iorq->length -
1049                                                                           iorq->partial_len);
1050    
1051                                                    /* never write larger chunks than 8k - chances are that it will block */
1052                                                    status = fns->write(iorq->fd,
1053                                                                        iorq->buffer +
1054                                                                        iorq->partial_len, req_size,
1055                                                                        iorq->offset, &result);
1056    
1057                                                    if ((long) result > 0)
1058                                                    {
1059                                                            iorq->partial_len += result;
1060                                                            iorq->offset += result;
1061                                                    }
1062    
1063    #if WITH_DEBUG_RDP5
1064                                                    DEBUG(("RDPDR: %d bytes of data written\n",
1065                                                           result));
1066    #endif
1067                                                    /* only delete link if all data has been transfered */
1068                                                    /* or we couldn't write */
1069                                                    if ((iorq->partial_len == iorq->length)
1070                                                        || (result == 0))
1071                                                    {
1072    #if WITH_DEBUG_RDP5
1073                                                            DEBUG(("RDPDR: AIO total %u bytes written of %u\n", iorq->partial_len, iorq->length));
1074    #endif
1075                                                            rdpdr_send_completion(iorq->device,
1076                                                                                  iorq->id, status,
1077                                                                                  iorq->partial_len,
1078                                                                                  (uint8 *) "", 1);
1079    
1080                                                            iorq = rdpdr_remove_iorequest(prev, iorq);
1081                                                    }
1082                                            }
1083                                            break;
1084                                    case IRP_MJ_DEVICE_CONTROL:
1085                                            if (serial_get_event(iorq->fd, &result))
1086                                            {
1087                                                    buffer = (uint8 *) xrealloc((void *) buffer, 0x14);
1088                                                    out.data = out.p = buffer;
1089                                                    out.size = sizeof(buffer);
1090                                                    out_uint32_le(&out, result);
1091                                                    result = buffer_len = out.p - out.data;
1092                                                    status = STATUS_SUCCESS;
1093                                                  rdpdr_send_completion(iorq->device, iorq->id,                                                  rdpdr_send_completion(iorq->device, iorq->id,
1094                                                                        status, result, "", 1);                                                                        status, result, buffer,
1095                                                                          buffer_len);
1096                                                    xfree(buffer);
1097                                                    iorq = rdpdr_remove_iorequest(prev, iorq);
1098                                            }
1099    
1100                                            break;
1101                            }
1102    
1103                    }
1104                    prev = iorq;
1105                    if (iorq)
1106                            iorq = iorq->next;
1107            }
1108    
1109            /* Check notify */
1110            iorq = g_iorequest;
1111            prev = NULL;
1112            while (iorq != NULL)
1113            {
1114                    if (iorq->fd != 0)
1115                    {
1116                            switch (iorq->major)
1117                            {
1118    
1119                                    case IRP_MJ_DIRECTORY_CONTROL:
1120                                            if (g_rdpdr_device[iorq->device].device_type ==
1121                                                DEVICE_TYPE_DISK)
1122                                            {
1123    
1124                                                  xfree(iorq->buffer);                                                  if (g_notify_stamp)
1125                                                  iorq->fd = 0;                                                  {
1126                                                            g_notify_stamp = False;
1127                                                            status = disk_check_notify(iorq->fd);
1128                                                            if (status != STATUS_PENDING)
1129                                                            {
1130                                                                    rdpdr_send_completion(iorq->device,
1131                                                                                          iorq->id,
1132                                                                                          status, 0,
1133                                                                                          NULL, 0);
1134                                                                    iorq = rdpdr_remove_iorequest(prev,
1135                                                                                                  iorq);
1136                                                            }
1137                                                    }
1138                                          }                                          }
1139                                          break;                                          break;
1140    
1141    
1142    
1143                          }                          }
1144                  }                  }
1145    
1146                    prev = iorq;
1147                    if (iorq)
1148                            iorq = iorq->next;
1149          }          }
1150    
1151    }
1152    
1153    void
1154    rdpdr_check_fds(fd_set * rfds, fd_set * wfds, BOOL timed_out)
1155    {
1156            fd_set dummy;
1157    
1158    
1159            FD_ZERO(&dummy);
1160    
1161    
1162            /* fist check event queue only,
1163               any serial wait event must be done before read block will be sent
1164             */
1165    
1166            _rdpdr_check_fds(&dummy, &dummy, False);
1167            _rdpdr_check_fds(rfds, wfds, timed_out);
1168  }  }
1169    
1170    
1171  /* Abort a pending io request for a given handle and major */  /* Abort a pending io request for a given handle and major */
1172  BOOL  BOOL
1173  rdpdr_abort_io(uint32 fd, uint32 major, NTSTATUS status)  rdpdr_abort_io(uint32 fd, uint32 major, NTSTATUS status)
1174  {  {
1175          uint32 result;          uint32 result;
         int i;  
1176          struct async_iorequest *iorq;          struct async_iorequest *iorq;
1177            struct async_iorequest *prev;
1178    
1179          for (i = 0; i < MAX_ASYNC_IO_REQUESTS; i++)          iorq = g_iorequest;
1180            prev = NULL;
1181            while (iorq != NULL)
1182          {          {
1183                  iorq = &g_iorequest[i];                  /* Only remove from table when major is not set, or when correct major is supplied.
1184                       Abort read should not abort a write io request. */
                 // Only remove from table when major is not set, or when correct major is supplied.  
                 // Abort read should not abort a write io request.  
1185                  if ((iorq->fd == fd) && (major == 0 || iorq->major == major))                  if ((iorq->fd == fd) && (major == 0 || iorq->major == major))
1186                  {                  {
1187                          result = 0;                          result = 0;
1188                          rdpdr_send_completion(iorq->device, iorq->id, status, result, "", 1);                          rdpdr_send_completion(iorq->device, iorq->id, status, result, (uint8 *) "",
1189                          xfree(iorq->buffer);                                                1);
1190                          iorq->fd = 0;  
1191                            iorq = rdpdr_remove_iorequest(prev, iorq);
1192                          return True;                          return True;
1193                  }                  }
1194    
1195                    prev = iorq;
1196                    iorq = iorq->next;
1197          }          }
1198    
1199          return False;          return False;
1200  }  }
 #endif  
Legend:
Removed from v.590  
changed lines
  Added in v.948
  ViewVC Help
Powered by ViewVC 1.1.26