/[rdesktop]/sourceforge.net/trunk/rdesktop/serial.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 /sourceforge.net/trunk/rdesktop/serial.c

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

revision 432 by matthewc, Tue Jul 1 09:31:25 2003 UTC revision 809 by stargo, Mon Jan 10 21:54:47 2005 UTC
# Line 1  Line 1 
1  #include <unistd.h>  #include <unistd.h>
2  #include <fcntl.h>  #include <fcntl.h>
3  #include <termios.h>  #include <termios.h>
4    #include <strings.h>
5    #include <sys/ioctl.h>
6    
7    #ifdef HAVE_SYS_MODEM_H
8    #include <sys/modem.h>
9    #endif
10    #ifdef HAVE_SYS_FILIO_H
11    #include <sys/filio.h>
12    #endif
13    #ifdef HAVE_SYS_STRTIO_H
14    #include <sys/strtio.h>
15    #endif
16    
17  #include "rdesktop.h"  #include "rdesktop.h"
18    
19    #ifdef WITH_DEBUG_SERIAL
20    #define DEBUG_SERIAL(args) printf args;
21    #else
22    #define DEBUG_SERIAL(args)
23    #endif
24    
25  #define FILE_DEVICE_SERIAL_PORT         0x1b  #define FILE_DEVICE_SERIAL_PORT         0x1b
26    
27  #define SERIAL_SET_BAUD_RATE            1  #define SERIAL_SET_BAUD_RATE            1
# Line 52  Line 71 
71  #define ODD_PARITY                      1  #define ODD_PARITY                      1
72  #define EVEN_PARITY                     2  #define EVEN_PARITY                     2
73    
74  int serial_fd;  #define SERIAL_PURGE_TXABORT 0x00000001
75  struct termios termios;  #define SERIAL_PURGE_RXABORT 0x00000002
76    #define SERIAL_PURGE_TXCLEAR 0x00000004
77    #define SERIAL_PURGE_RXCLEAR 0x00000008
78    
79    /* SERIAL_WAIT_ON_MASK */
80    #define SERIAL_EV_RXCHAR           0x0001       // Any Character received
81    #define SERIAL_EV_RXFLAG           0x0002       // Received certain character
82    #define SERIAL_EV_TXEMPTY          0x0004       // Transmitt Queue Empty
83    #define SERIAL_EV_CTS              0x0008       // CTS changed state
84    #define SERIAL_EV_DSR              0x0010       // DSR changed state
85    #define SERIAL_EV_RLSD             0x0020       // RLSD changed state
86    #define SERIAL_EV_BREAK            0x0040       // BREAK received
87    #define SERIAL_EV_ERR              0x0080       // Line status error occurred
88    #define SERIAL_EV_RING             0x0100       // Ring signal detected
89    #define SERIAL_EV_PERR             0x0200       // Printer error occured
90    #define SERIAL_EV_RX80FULL         0x0400       // Receive buffer is 80 percent full
91    #define SERIAL_EV_EVENT1           0x0800       // Provider specific event 1
92    #define SERIAL_EV_EVENT2           0x1000       // Provider specific event 2
93    
94    /* Modem Status */
95    #define SERIAL_MS_DTR 0x01
96    #define SERIAL_MS_RTS 0x02
97    #define SERIAL_MS_CTS 0x10
98    #define SERIAL_MS_DSR 0x20
99    #define SERIAL_MS_RNG 0x40
100    #define SERIAL_MS_CAR 0x80
101    
102    /* Handflow */
103    #define SERIAL_DTR_CONTROL      0x01
104    #define SERIAL_CTS_HANDSHAKE    0x08
105    #define SERIAL_ERROR_ABORT      0x80000000
106    
107    #define SERIAL_XON_HANDSHAKE    0x01
108    #define SERIAL_XOFF_HANDSHAKE   0x02
109    #define SERIAL_DSR_SENSITIVITY  0x40
110    
111    #define SERIAL_CHAR_EOF         0
112    #define SERIAL_CHAR_ERROR       1
113    #define SERIAL_CHAR_BREAK       2
114    #define SERIAL_CHAR_EVENT       3
115    #define SERIAL_CHAR_XON         4
116    #define SERIAL_CHAR_XOFF        5
117    
118    #ifndef CRTSCTS
119    #define CRTSCTS 0
120    #endif
121    
122    /* FIONREAD should really do the same thing as TIOCINQ, where it is
123     * not available */
124    #ifndef TIOCINQ
125    #define TIOCINQ FIONREAD
126    #endif
127    #ifndef TIOCOUTQ
128    #define TIOCOUTQ FIONWRITE
129    #endif
130    
131  int dtr;  extern RDPDR_DEVICE g_rdpdr_device[];
132  uint32 baud_rate;  
133  uint32 queue_in_size, queue_out_size;  static SERIAL_DEVICE *
134  uint32 wait_mask;  get_serial_info(NTHANDLE handle)
135  uint8 stop_bits, parity, word_length;  {
136            int index;
137    
138            for (index = 0; index < RDPDR_MAX_DEVICES; index++)
139            {
140                    if (handle == g_rdpdr_device[index].handle)
141                            return (SERIAL_DEVICE *) g_rdpdr_device[index].pdevice_data;
142            }
143            return NULL;
144    }
145    
146  static BOOL  static BOOL
147  get_termios(void)  get_termios(SERIAL_DEVICE * pser_inf, NTHANDLE serial_fd)
148  {  {
149          speed_t speed;          speed_t speed;
150            struct termios *ptermios;
151    
152          if (tcgetattr(serial_fd, &termios) == -1)          ptermios = pser_inf->ptermios;
153    
154            if (tcgetattr(serial_fd, ptermios) == -1)
155                  return False;                  return False;
156    
157          speed = cfgetispeed(&termios);          speed = cfgetispeed(ptermios);
158          switch (speed)          switch (speed)
159          {          {
160                  case B75:       baud_rate = 75; break;  #ifdef B75
161                  case B110:      baud_rate = 110; break;                  case B75:
162                  case B134:      baud_rate = 134; break;                          pser_inf->baud_rate = 75;
163                  case B150:      baud_rate = 150; break;                          break;
164                  case B300:      baud_rate = 300; break;  #endif
165                  case B600:      baud_rate = 600; break;  #ifdef B110
166                  case B1200:     baud_rate = 1200; break;                  case B110:
167                  case B1800:     baud_rate = 1800; break;                          pser_inf->baud_rate = 110;
168                  case B2400:     baud_rate = 2400; break;                          break;
169                  case B4800:     baud_rate = 4800; break;  #endif
170                  case B9600:     baud_rate = 9600; break;  #ifdef B134
171                  case B19200:    baud_rate = 19200; break;                  case B134:
172                  case B38400:    baud_rate = 38400; break;                          pser_inf->baud_rate = 134;
173                  case B57600:    baud_rate = 57600; break;                          break;
174                  case B115200:   baud_rate = 115200; break;  #endif
175                  default:        baud_rate = 0; break;  #ifdef B150
176          }                  case B150:
177                            pser_inf->baud_rate = 150;
178          speed = cfgetospeed(&termios);                          break;
179          dtr = (speed == B0) ? 0 : 1;  #endif
180    #ifdef B300
181          stop_bits = (termios.c_cflag & CSTOPB) ? STOP_BITS_2 : STOP_BITS_1;                  case B300:
182          parity = (termios.c_cflag & PARENB) ? ((termios.c_cflag & PARODD) ? ODD_PARITY : EVEN_PARITY) : NO_PARITY;                          pser_inf->baud_rate = 300;
183          switch (termios.c_cflag & CSIZE)                          break;
184          {  #endif
185                  case CS5: word_length = 5; break;  #ifdef B600
186                  case CS6: word_length = 6; break;                  case B600:
187                  case CS7: word_length = 7; break;                          pser_inf->baud_rate = 600;
188                  default:  word_length = 8; break;                          break;
189    #endif
190    #ifdef B1200
191                    case B1200:
192                            pser_inf->baud_rate = 1200;
193                            break;
194    #endif
195    #ifdef B1800
196                    case B1800:
197                            pser_inf->baud_rate = 1800;
198                            break;
199    #endif
200    #ifdef B2400
201                    case B2400:
202                            pser_inf->baud_rate = 2400;
203                            break;
204    #endif
205    #ifdef B4800
206                    case B4800:
207                            pser_inf->baud_rate = 4800;
208                            break;
209    #endif
210    #ifdef B9600
211                    case B9600:
212                            pser_inf->baud_rate = 9600;
213                            break;
214    #endif
215    #ifdef B19200
216                    case B19200:
217                            pser_inf->baud_rate = 19200;
218                            break;
219    #endif
220    #ifdef B38400
221                    case B38400:
222                            pser_inf->baud_rate = 38400;
223                            break;
224    #endif
225    #ifdef B57600
226                    case B57600:
227                            pser_inf->baud_rate = 57600;
228                            break;
229    #endif
230    #ifdef B115200
231                    case B115200:
232                            pser_inf->baud_rate = 115200;
233                            break;
234    #endif
235    #ifdef B230400
236                    case B230400:
237                            pser_inf->baud_rate = 230400;
238                            break;
239    #endif
240    #ifdef B460800
241                    case B460800:
242                            pser_inf->baud_rate = 460800;
243                            break;
244    #endif
245                    default:
246                            pser_inf->baud_rate = 9600;
247                            break;
248          }          }
249    
250            speed = cfgetospeed(ptermios);
251            pser_inf->dtr = (speed == B0) ? 0 : 1;
252    
253            pser_inf->stop_bits = (ptermios->c_cflag & CSTOPB) ? STOP_BITS_2 : STOP_BITS_1;
254            pser_inf->parity =
255                    (ptermios->
256                     c_cflag & PARENB) ? ((ptermios->
257                                           c_cflag & PARODD) ? ODD_PARITY : EVEN_PARITY) : NO_PARITY;
258            switch (ptermios->c_cflag & CSIZE)
259            {
260                    case CS5:
261                            pser_inf->word_length = 5;
262                            break;
263                    case CS6:
264                            pser_inf->word_length = 6;
265                            break;
266                    case CS7:
267                            pser_inf->word_length = 7;
268                            break;
269                    default:
270                            pser_inf->word_length = 8;
271                            break;
272            }
273    
274            if (ptermios->c_cflag & CRTSCTS)
275            {
276                    pser_inf->control = SERIAL_DTR_CONTROL | SERIAL_CTS_HANDSHAKE | SERIAL_ERROR_ABORT;
277            }
278            else
279            {
280                    pser_inf->control = SERIAL_DTR_CONTROL | SERIAL_ERROR_ABORT;
281            }
282    
283            pser_inf->xonoff = SERIAL_DSR_SENSITIVITY;
284            if (ptermios->c_iflag & IXON)
285                    pser_inf->xonoff |= SERIAL_XON_HANDSHAKE;
286    
287            if (ptermios->c_iflag & IXOFF)
288                    pser_inf->xonoff |= SERIAL_XOFF_HANDSHAKE;
289    
290            pser_inf->chars[SERIAL_CHAR_XON] = ptermios->c_cc[VSTART];
291            pser_inf->chars[SERIAL_CHAR_XOFF] = ptermios->c_cc[VSTOP];
292            pser_inf->chars[SERIAL_CHAR_EOF] = ptermios->c_cc[VEOF];
293            pser_inf->chars[SERIAL_CHAR_BREAK] = ptermios->c_cc[VINTR];
294            pser_inf->chars[SERIAL_CHAR_ERROR] = ptermios->c_cc[VKILL];
295    
296          return True;          return True;
297  }  }
298    
299  static void  static void
300  set_termios(void)  set_termios(SERIAL_DEVICE * pser_inf, NTHANDLE serial_fd)
301  {  {
302          speed_t speed;          speed_t speed;
303    
304          switch (baud_rate)          struct termios *ptermios;
305    
306            ptermios = pser_inf->ptermios;
307    
308    
309            switch (pser_inf->baud_rate)
310          {          {
311                  case 75:        speed = B75; break;  #ifdef B75
312                  case 110:       speed = B110; break;                  case 75:
313                  case 134:       speed = B134; break;                          speed = B75;
314                  case 150:       speed = B150; break;                          break;
315                  case 300:       speed = B300; break;  #endif
316                  case 600:       speed = B600; break;  #ifdef B110
317                  case 1200:      speed = B1200; break;                  case 110:
318                  case 1800:      speed = B1800; break;                          speed = B110;
319                  case 2400:      speed = B2400; break;                          break;
320                  case 4800:      speed = B4800; break;  #endif
321                  case 9600:      speed = B9600; break;  #ifdef B134
322                  case 19200:     speed = B19200; break;                  case 134:
323                  case 38400:     speed = B38400; break;                          speed = B134;
324                  case 57600:     speed = B57600; break;                          break;
325                  case 115200:    speed = B115200; break;  #endif
326                  default:        speed = B0; break;  #ifdef B150
327                    case 150:
328                            speed = B150;
329                            break;
330    #endif
331    #ifdef B300
332                    case 300:
333                            speed = B300;
334                            break;
335    #endif
336    #ifdef B600
337                    case 600:
338                            speed = B600;
339                            break;
340    #endif
341    #ifdef B1200
342                    case 1200:
343                            speed = B1200;
344                            break;
345    #endif
346    #ifdef B1800
347                    case 1800:
348                            speed = B1800;
349                            break;
350    #endif
351    #ifdef B2400
352                    case 2400:
353                            speed = B2400;
354                            break;
355    #endif
356    #ifdef B4800
357                    case 4800:
358                            speed = B4800;
359                            break;
360    #endif
361    #ifdef B9600
362                    case 9600:
363                            speed = B9600;
364                            break;
365    #endif
366    #ifdef B19200
367                    case 19200:
368                            speed = B19200;
369                            break;
370    #endif
371    #ifdef B38400
372                    case 38400:
373                            speed = B38400;
374                            break;
375    #endif
376    #ifdef B57600
377                    case 57600:
378                            speed = B57600;
379                            break;
380    #endif
381    #ifdef B115200
382                    case 115200:
383                            speed = B115200;
384                            break;
385    #endif
386    #ifdef B230400
387                    case 230400:
388                            speed = B115200;
389                            break;
390    #endif
391    #ifdef B460800
392                    case 460800:
393                            speed = B115200;
394                            break;
395    #endif
396                    default:
397                            speed = B9600;
398                            break;
399          }          }
400    
401    #ifdef CBAUD
402            ptermios->c_cflag &= ~CBAUD;
403            ptermios->c_cflag |= speed;
404    #else
405          /* on systems with separate ispeed and ospeed, we can remember the speed          /* on systems with separate ispeed and ospeed, we can remember the speed
406             in ispeed while changing DTR with ospeed */             in ispeed while changing DTR with ospeed */
407          cfsetispeed(&termios, speed);          cfsetispeed(pser_inf->ptermios, speed);
408          cfsetospeed(&termios, dtr ? speed : 0);          cfsetospeed(pser_inf->ptermios, pser_inf->dtr ? speed : 0);
409    #endif
410    
411          termios.c_cflag &= ~(CSTOPB|PARENB|PARODD|CSIZE);          ptermios->c_cflag &= ~(CSTOPB | PARENB | PARODD | CSIZE | CRTSCTS);
412          switch (stop_bits)          switch (pser_inf->stop_bits)
413          {          {
414                  case STOP_BITS_2:                  case STOP_BITS_2:
415                          termios.c_cflag |= CSTOPB;                          ptermios->c_cflag |= CSTOPB;
416                            break;
417                    default:
418                            ptermios->c_cflag &= ~CSTOPB;
419                          break;                          break;
420          }          }
421          switch (parity)  
422            switch (pser_inf->parity)
423          {          {
424                  case EVEN_PARITY:                  case EVEN_PARITY:
425                          termios.c_cflag |= PARENB;                          ptermios->c_cflag |= PARENB;
426                          break;                          break;
427                  case ODD_PARITY:                  case ODD_PARITY:
428                          termios.c_cflag |= PARENB|PARODD;                          ptermios->c_cflag |= PARENB | PARODD;
429                            break;
430                    case NO_PARITY:
431                            ptermios->c_cflag &= ~(PARENB | PARODD);
432                          break;                          break;
433          }          }
434          switch (word_length)  
435            switch (pser_inf->word_length)
436          {          {
437                  case 5:  termios.c_cflag |= CS5; break;                  case 5:
438                  case 6:  termios.c_cflag |= CS6; break;                          ptermios->c_cflag |= CS5;
439                  case 7:  termios.c_cflag |= CS7; break;                          break;
440                  default: termios.c_cflag |= CS8; break;                  case 6:
441                            ptermios->c_cflag |= CS6;
442                            break;
443                    case 7:
444                            ptermios->c_cflag |= CS7;
445                            break;
446                    default:
447                            ptermios->c_cflag |= CS8;
448                            break;
449          }          }
450    
451          tcsetattr(serial_fd, TCSANOW, &termios);  #if 0
452            if (pser_inf->rts)
453                    ptermios->c_cflag |= CRTSCTS;
454            else
455                    ptermios->c_cflag &= ~CRTSCTS;
456    #endif
457    
458            if (pser_inf->control & SERIAL_CTS_HANDSHAKE)
459            {
460                    ptermios->c_cflag |= CRTSCTS;
461            }
462            else
463            {
464                    ptermios->c_cflag &= ~CRTSCTS;
465            }
466    
467    
468            if (pser_inf->xonoff & SERIAL_XON_HANDSHAKE)
469            {
470                    ptermios->c_iflag |= IXON | IMAXBEL;
471            }
472            if (pser_inf->xonoff & SERIAL_XOFF_HANDSHAKE)
473            {
474                    ptermios->c_iflag |= IXOFF | IMAXBEL;
475            }
476    
477            if ((pser_inf->xonoff & (SERIAL_XOFF_HANDSHAKE | SERIAL_XON_HANDSHAKE)) == 0)
478            {
479                    ptermios->c_iflag &= ~IXON;
480                    ptermios->c_iflag &= ~IXOFF;
481            }
482    
483            ptermios->c_cc[VSTART] = pser_inf->chars[SERIAL_CHAR_XON];
484            ptermios->c_cc[VSTOP] = pser_inf->chars[SERIAL_CHAR_XOFF];
485            ptermios->c_cc[VEOF] = pser_inf->chars[SERIAL_CHAR_EOF];
486            ptermios->c_cc[VINTR] = pser_inf->chars[SERIAL_CHAR_BREAK];
487            ptermios->c_cc[VKILL] = pser_inf->chars[SERIAL_CHAR_ERROR];
488    
489            tcsetattr(serial_fd, TCSANOW, ptermios);
490    }
491    
492    /* Enumeration of devices from rdesktop.c        */
493    /* returns numer of units found and initialized. */
494    /* optarg looks like ':com1=/dev/ttyS0'           */
495    /* when it arrives to this function.              */
496    /* :com1=/dev/ttyS0,com2=/dev/ttyS1 */
497    int
498    serial_enum_devices(uint32 * id, char *optarg)
499    {
500            SERIAL_DEVICE *pser_inf;
501    
502            char *pos = optarg;
503            char *pos2;
504            int count = 0;
505    
506            // skip the first colon
507            optarg++;
508            while ((pos = next_arg(optarg, ',')) && *id < RDPDR_MAX_DEVICES)
509            {
510                    // Init data structures for device
511                    pser_inf = (SERIAL_DEVICE *) xmalloc(sizeof(SERIAL_DEVICE));
512                    pser_inf->ptermios = (struct termios *) xmalloc(sizeof(struct termios));
513                    memset(pser_inf->ptermios, 0, sizeof(struct termios));
514                    pser_inf->pold_termios = (struct termios *) xmalloc(sizeof(struct termios));
515                    memset(pser_inf->pold_termios, 0, sizeof(struct termios));
516    
517                    pos2 = next_arg(optarg, '=');
518                    strcpy(g_rdpdr_device[*id].name, optarg);
519    
520                    toupper_str(g_rdpdr_device[*id].name);
521    
522                    g_rdpdr_device[*id].local_path = xmalloc(strlen(pos2) + 1);
523                    strcpy(g_rdpdr_device[*id].local_path, pos2);
524                    printf("SERIAL %s to %s\n", g_rdpdr_device[*id].name,
525                           g_rdpdr_device[*id].local_path);
526                    // set device type
527                    g_rdpdr_device[*id].device_type = DEVICE_TYPE_SERIAL;
528                    g_rdpdr_device[*id].pdevice_data = (void *) pser_inf;
529                    count++;
530                    (*id)++;
531    
532                    optarg = pos;
533            }
534            return count;
535  }  }
536    
537  static NTSTATUS  static NTSTATUS
538  serial_create(HANDLE *handle)  serial_create(uint32 device_id, uint32 access, uint32 share_mode, uint32 disposition,
539                  uint32 flags_and_attributes, char *filename, NTHANDLE * handle)
540  {  {
541          /* XXX do we have to handle concurrent open attempts? */          NTHANDLE serial_fd;
542          serial_fd = open("/dev/ttyS0", O_RDWR);          SERIAL_DEVICE *pser_inf;
543            struct termios *ptermios;
544    
545            pser_inf = (SERIAL_DEVICE *) g_rdpdr_device[device_id].pdevice_data;
546            ptermios = pser_inf->ptermios;
547            serial_fd = open(g_rdpdr_device[device_id].local_path, O_RDWR | O_NOCTTY | O_NONBLOCK);
548    
549          if (serial_fd == -1)          if (serial_fd == -1)
550            {
551                    perror("open");
552                  return STATUS_ACCESS_DENIED;                  return STATUS_ACCESS_DENIED;
553            }
554    
555          if (!get_termios())          if (!get_termios(pser_inf, serial_fd))
556            {
557                    printf("INFO: SERIAL %s access denied\n", g_rdpdr_device[device_id].name);
558                    fflush(stdout);
559                  return STATUS_ACCESS_DENIED;                  return STATUS_ACCESS_DENIED;
560            }
561    
562            // Store handle for later use
563            g_rdpdr_device[device_id].handle = serial_fd;
564    
565            /* some sane information */
566            DEBUG_SERIAL(("INFO: SERIAL %s to %s\nINFO: speed %u baud, stop bits %u, parity %u, word length %u bits, dtr %u, rts %u\n", g_rdpdr_device[device_id].name, g_rdpdr_device[device_id].local_path, pser_inf->baud_rate, pser_inf->stop_bits, pser_inf->parity, pser_inf->word_length, pser_inf->dtr, pser_inf->rts));
567    
568            pser_inf->ptermios->c_iflag &=
569                    ~(IGNBRK | BRKINT | PARMRK | ISTRIP | INLCR | IGNCR | ICRNL | IXON);
570            pser_inf->ptermios->c_oflag &= ~OPOST;
571            pser_inf->ptermios->c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
572            pser_inf->ptermios->c_cflag &= ~(CSIZE | PARENB);
573            pser_inf->ptermios->c_cflag |= CS8;
574    
575            tcsetattr(serial_fd, TCSANOW, pser_inf->ptermios);
576    
577            pser_inf->event_txempty = 0;
578            pser_inf->event_cts = 0;
579            pser_inf->event_dsr = 0;
580            pser_inf->event_rlsd = 0;
581            pser_inf->event_pending = 0;
582    
583            *handle = serial_fd;
584    
585            /* all read and writes should be non blocking */
586            if (fcntl(*handle, F_SETFL, O_NONBLOCK) == -1)
587                    perror("fcntl");
588    
589            pser_inf->read_total_timeout_constant = 5;
590    
         *handle = 0;  
591          return STATUS_SUCCESS;          return STATUS_SUCCESS;
592  }  }
593    
594  static NTSTATUS  static NTSTATUS
595  serial_close(HANDLE handle)  serial_close(NTHANDLE handle)
596  {  {
597          close(serial_fd);          int i = get_device_index(handle);
598            if (i >= 0)
599                    g_rdpdr_device[i].handle = 0;
600    
601            rdpdr_abort_io(handle, 0, STATUS_TIMEOUT);
602            close(handle);
603          return STATUS_SUCCESS;          return STATUS_SUCCESS;
604  }  }
605    
606  static NTSTATUS  static NTSTATUS
607  serial_read(HANDLE handle, uint8 *data, uint32 length, uint32 *result)  serial_read(NTHANDLE handle, uint8 * data, uint32 length, uint32 offset, uint32 * result)
608  {  {
609          *result = read(serial_fd, data, length);          long timeout;
610            SERIAL_DEVICE *pser_inf;
611            struct termios *ptermios;
612    #ifdef WITH_DEBUG_SERIAL
613            int bytes_inqueue;
614    #endif
615    
616    
617            timeout = 90;
618            pser_inf = get_serial_info(handle);
619            ptermios = pser_inf->ptermios;
620    
621            // Set timeouts kind of like the windows serial timeout parameters. Multiply timeout
622            // with requested read size
623            if (pser_inf->read_total_timeout_multiplier | pser_inf->read_total_timeout_constant)
624            {
625                    timeout =
626                            (pser_inf->read_total_timeout_multiplier * length +
627                             pser_inf->read_total_timeout_constant + 99) / 100;
628            }
629            else if (pser_inf->read_interval_timeout)
630            {
631                    timeout = (pser_inf->read_interval_timeout * length + 99) / 100;
632            }
633    
634            // If a timeout is set, do a blocking read, which times out after some time.
635            // It will make rdesktop less responsive, but it will improve serial performance, by not
636            // reading one character at a time.
637            if (timeout == 0)
638            {
639                    ptermios->c_cc[VTIME] = 0;
640                    ptermios->c_cc[VMIN] = 0;
641            }
642            else
643            {
644                    ptermios->c_cc[VTIME] = timeout;
645                    ptermios->c_cc[VMIN] = 1;
646            }
647            tcsetattr(handle, TCSANOW, ptermios);
648    
649    #ifdef WITH_DEBUG_SERIAL
650            ioctl(handle, TIOCINQ, &bytes_inqueue);
651            DEBUG_SERIAL(("serial_read inqueue: %d expected %d\n", bytes_inqueue, length));
652    #endif
653    
654            *result = read(handle, data, length);
655    
656    #ifdef WITH_DEBUG_SERIAL
657            DEBUG_SERIAL(("serial_read Bytes %d\n", *result));
658            if (*result > 0)
659                    hexdump(data, *result);
660    #endif
661    
662          return STATUS_SUCCESS;          return STATUS_SUCCESS;
663  }  }
664    
665  static NTSTATUS  static NTSTATUS
666  serial_write(HANDLE handle, uint8 *data, uint32 length, uint32 *result)  serial_write(NTHANDLE handle, uint8 * data, uint32 length, uint32 offset, uint32 * result)
667  {  {
668          *result = write(serial_fd, data, length);          SERIAL_DEVICE *pser_inf;
669    
670            pser_inf = get_serial_info(handle);
671    
672            *result = write(handle, data, length);
673    
674            if (*result > 0)
675                    pser_inf->event_txempty = *result;
676    
677            DEBUG_SERIAL(("serial_write length %d, offset %d result %d\n", length, offset, *result));
678    
679          return STATUS_SUCCESS;          return STATUS_SUCCESS;
680  }  }
681    
682  static NTSTATUS  static NTSTATUS
683  serial_device_control(HANDLE handle, uint32 request, STREAM in, STREAM out)  serial_device_control(NTHANDLE handle, uint32 request, STREAM in, STREAM out)
684  {  {
685          uint32 result;          int flush_mask, purge_mask;
686            uint32 result, modemstate;
687          uint8 immediate;          uint8 immediate;
688            SERIAL_DEVICE *pser_inf;
689            struct termios *ptermios;
690    
691          if ((request >> 16) != FILE_DEVICE_SERIAL_PORT)          if ((request >> 16) != FILE_DEVICE_SERIAL_PORT)
692                  return STATUS_INVALID_PARAMETER;                  return STATUS_INVALID_PARAMETER;
693    
694            pser_inf = get_serial_info(handle);
695            ptermios = pser_inf->ptermios;
696    
697          /* extract operation */          /* extract operation */
698          request >>= 2;          request >>= 2;
699          request &= 0xfff;          request &= 0xfff;
700    
         printf("SERIAL IOCTL %d\n", request);  
   
701          switch (request)          switch (request)
702          {          {
703                  case SERIAL_SET_BAUD_RATE:                  case SERIAL_SET_BAUD_RATE:
704                          in_uint32_le(in, baud_rate);                          in_uint32_le(in, pser_inf->baud_rate);
705                          set_termios();                          set_termios(pser_inf, handle);
706                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_BAUD_RATE %d\n",
707                                          pser_inf->baud_rate));
708                          break;                          break;
709                  case SERIAL_GET_BAUD_RATE:                  case SERIAL_GET_BAUD_RATE:
710                          out_uint32_le(out, baud_rate);                          out_uint32_le(out, pser_inf->baud_rate);
711                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_GET_BAUD_RATE %d\n",
712                                          pser_inf->baud_rate));
713                          break;                          break;
714                  case SERIAL_SET_QUEUE_SIZE:                  case SERIAL_SET_QUEUE_SIZE:
715                          in_uint32_le(in, queue_in_size);                          in_uint32_le(in, pser_inf->queue_in_size);
716                          in_uint32_le(in, queue_out_size);                          in_uint32_le(in, pser_inf->queue_out_size);
717                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_QUEUE_SIZE in %d out %d\n",
718                                          pser_inf->queue_in_size, pser_inf->queue_out_size));
719                          break;                          break;
720                  case SERIAL_SET_LINE_CONTROL:                  case SERIAL_SET_LINE_CONTROL:
721                          in_uint8(in, stop_bits);                          in_uint8(in, pser_inf->stop_bits);
722                          in_uint8(in, parity);                          in_uint8(in, pser_inf->parity);
723                          in_uint8(in, word_length);                          in_uint8(in, pser_inf->word_length);
724                          set_termios();                          set_termios(pser_inf, handle);
725                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_LINE_CONTROL stop %d parity %d word %d\n", pser_inf->stop_bits, pser_inf->parity, pser_inf->word_length));
726                          break;                          break;
727                  case SERIAL_GET_LINE_CONTROL:                  case SERIAL_GET_LINE_CONTROL:
728                          out_uint8(out, stop_bits);                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_GET_LINE_CONTROL\n"));
729                          out_uint8(out, parity);                          out_uint8(out, pser_inf->stop_bits);
730                          out_uint8(out, word_length);                          out_uint8(out, pser_inf->parity);
731                            out_uint8(out, pser_inf->word_length);
732                          break;                          break;
733                  case SERIAL_IMMEDIATE_CHAR:                  case SERIAL_IMMEDIATE_CHAR:
734                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_IMMEDIATE_CHAR\n"));
735                          in_uint8(in, immediate);                          in_uint8(in, immediate);
736                          serial_write(handle, &immediate, 1, &result);                          serial_write(handle, &immediate, 1, 0, &result);
737                          break;                          break;
738                  case SERIAL_CONFIG_SIZE:                  case SERIAL_CONFIG_SIZE:
739                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_CONFIG_SIZE\n"));
740                          out_uint32_le(out, 0);                          out_uint32_le(out, 0);
741                          break;                          break;
742                  case SERIAL_GET_CHARS:                  case SERIAL_GET_CHARS:
743                          out_uint8s(out, 6);                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_GET_CHARS\n"));
744                            out_uint8a(out, pser_inf->chars, 6);
745                          break;                          break;
746                  case SERIAL_SET_CHARS:                  case SERIAL_SET_CHARS:
747                          in_uint8s(in, 6);                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_CHARS\n"));
748                            in_uint8a(in, pser_inf->chars, 6);
749    #ifdef WITH_DEBUG_SERIAL
750                            hexdump(pser_inf->chars, 6);
751    #endif
752                            set_termios(pser_inf, handle);
753                          break;                          break;
754                  case SERIAL_GET_HANDFLOW:                  case SERIAL_GET_HANDFLOW:
755                          out_uint32_le(out, 0);                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_GET_HANDFLOW\n"));
756                          out_uint32_le(out, 3); /* Xon/Xoff */                          get_termios(pser_inf, handle);
757                          out_uint32_le(out, 0);                          out_uint32_le(out, pser_inf->control);
758                          out_uint32_le(out, 0);                          out_uint32_le(out, pser_inf->xonoff);   /* Xon/Xoff */
759                            out_uint32_le(out, pser_inf->onlimit);
760                            out_uint32_le(out, pser_inf->offlimit);
761                          break;                          break;
762                  case SERIAL_SET_HANDFLOW:                  case SERIAL_SET_HANDFLOW:
763                          in_uint8s(in, 16);                          in_uint32_le(in, pser_inf->control);
764                            in_uint32_le(in, pser_inf->xonoff);
765                            in_uint32_le(in, pser_inf->onlimit);
766                            in_uint32_le(in, pser_inf->offlimit);
767                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_HANDFLOW %x %x %x %x\n",
768                                          pser_inf->control, pser_inf->xonoff, pser_inf->onlimit,
769                                          pser_inf->onlimit));
770                            set_termios(pser_inf, handle);
771                          break;                          break;
772                  case SERIAL_SET_TIMEOUTS:                  case SERIAL_SET_TIMEOUTS:
773                          in_uint8s(in, 20);                          in_uint32(in, pser_inf->read_interval_timeout);
774                            in_uint32(in, pser_inf->read_total_timeout_multiplier);
775                            in_uint32(in, pser_inf->read_total_timeout_constant);
776                            in_uint32(in, pser_inf->write_total_timeout_multiplier);
777                            in_uint32(in, pser_inf->write_total_timeout_constant);
778                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_TIMEOUTS read timeout %d %d %d\n",
779                                          pser_inf->read_interval_timeout,
780                                          pser_inf->read_total_timeout_multiplier,
781                                          pser_inf->read_total_timeout_constant));
782                          break;                          break;
783                  case SERIAL_GET_TIMEOUTS:                  case SERIAL_GET_TIMEOUTS:
784                          out_uint8s(out, 20);                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_GET_TIMEOUTS read timeout %d %d %d\n",
785                                          pser_inf->read_interval_timeout,
786                                          pser_inf->read_total_timeout_multiplier,
787                                          pser_inf->read_total_timeout_constant));
788    
789                            out_uint32(out, pser_inf->read_interval_timeout);
790                            out_uint32(out, pser_inf->read_total_timeout_multiplier);
791                            out_uint32(out, pser_inf->read_total_timeout_constant);
792                            out_uint32(out, pser_inf->write_total_timeout_multiplier);
793                            out_uint32(out, pser_inf->write_total_timeout_constant);
794                          break;                          break;
795                  case SERIAL_GET_WAIT_MASK:                  case SERIAL_GET_WAIT_MASK:
796                          out_uint32(out, wait_mask);                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_GET_WAIT_MASK %X\n",
797                                          pser_inf->wait_mask); out_uint32(out, pser_inf->wait_mask));
798                          break;                          break;
799                  case SERIAL_SET_WAIT_MASK:                  case SERIAL_SET_WAIT_MASK:
800                          in_uint32(in, wait_mask);                          in_uint32(in, pser_inf->wait_mask);
801                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_WAIT_MASK %X\n",
802                                          pser_inf->wait_mask));
803                          break;                          break;
804                  case SERIAL_SET_DTR:                  case SERIAL_SET_DTR:
805                          dtr = 1;                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_DTR\n"));
806                          set_termios();                          ioctl(handle, TIOCMGET, &result);
807                            result |= TIOCM_DTR;
808                            ioctl(handle, TIOCMSET, &result);
809                            pser_inf->dtr = 1;
810                          break;                          break;
811                  case SERIAL_CLR_DTR:                  case SERIAL_CLR_DTR:
812                          dtr = 0;                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_CLR_DTR\n"));
813                          set_termios();                          ioctl(handle, TIOCMGET, &result);
814                            result &= ~TIOCM_DTR;
815                            ioctl(handle, TIOCMSET, &result);
816                            pser_inf->dtr = 0;
817                          break;                          break;
818  #if 0                  case SERIAL_SET_RTS:
819                  case SERIAL_WAIT_ON_MASK:                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_RTS\n"));
820                          /* XXX implement me */                          ioctl(handle, TIOCMGET, &result);
821                            result |= TIOCM_RTS;
822                            ioctl(handle, TIOCMSET, &result);
823                            pser_inf->rts = 1;
824                          break;                          break;
825                  case SERIAL_SET_BREAK_ON:                  case SERIAL_CLR_RTS:
826                          tcsendbreak(serial_fd, 0);                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_CLR_RTS\n"));
827                            ioctl(handle, TIOCMGET, &result);
828                            result &= ~TIOCM_RTS;
829                            ioctl(handle, TIOCMSET, &result);
830                            pser_inf->rts = 0;
831                            break;
832                    case SERIAL_GET_MODEMSTATUS:
833                            modemstate = 0;
834    #ifdef TIOCMGET
835                            ioctl(handle, TIOCMGET, &result);
836                            if (result & TIOCM_CTS)
837                                    modemstate |= SERIAL_MS_CTS;
838                            if (result & TIOCM_DSR)
839                                    modemstate |= SERIAL_MS_DSR;
840                            if (result & TIOCM_RNG)
841                                    modemstate |= SERIAL_MS_RNG;
842                            if (result & TIOCM_CAR)
843                                    modemstate |= SERIAL_MS_CAR;
844                            if (result & TIOCM_DTR)
845                                    modemstate |= SERIAL_MS_DTR;
846                            if (result & TIOCM_RTS)
847                                    modemstate |= SERIAL_MS_RTS;
848    #endif
849                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_GET_MODEMSTATUS %X\n", modemstate));
850                            out_uint32_le(out, modemstate);
851                            break;
852                    case SERIAL_GET_COMMSTATUS:
853                            out_uint32_le(out, 0);  /* Errors */
854                            out_uint32_le(out, 0);  /* Hold reasons */
855    
856                            result = 0;
857                            ioctl(handle, TIOCINQ, &result);
858                            out_uint32_le(out, result);     /* Amount in in queue */
859                            if (result)
860                                    DEBUG_SERIAL(("serial_ioctl -> SERIAL_GET_COMMSTATUS in queue %d\n",
861                                                  result));
862    
863                            result = 0;
864                            ioctl(handle, TIOCOUTQ, &result);
865                            out_uint32_le(out, result);     /* Amount in out queue */
866                            if (result)
867                                    DEBUG_SERIAL(("serial_ioctl -> SERIAL_GET_COMMSTATUS out queue %d\n", result));
868    
869                            out_uint8(out, 0);      /* EofReceived */
870                            out_uint8(out, 0);      /* WaitForImmediate */
871                          break;                          break;
872                  case SERIAL_PURGE:                  case SERIAL_PURGE:
873                          in_uint32(purge_mask);                          in_uint32(in, purge_mask);
874                          /* tcflush */                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_PURGE purge_mask %X\n", purge_mask));
875                            flush_mask = 0;
876                            if (purge_mask & SERIAL_PURGE_TXCLEAR)
877                                    flush_mask |= TCOFLUSH;
878                            if (purge_mask & SERIAL_PURGE_RXCLEAR)
879                                    flush_mask |= TCIFLUSH;
880                            if (flush_mask != 0)
881                                    tcflush(handle, flush_mask);
882                            if (purge_mask & SERIAL_PURGE_TXABORT)
883                                    rdpdr_abort_io(handle, 4, STATUS_CANCELLED);
884                            if (purge_mask & SERIAL_PURGE_RXABORT)
885                                    rdpdr_abort_io(handle, 3, STATUS_CANCELLED);
886                            break;
887                    case SERIAL_WAIT_ON_MASK:
888                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_WAIT_ON_MASK %X\n",
889                                          pser_inf->wait_mask));
890                            pser_inf->event_pending = 1;
891                            if (serial_get_event(handle, &result))
892                            {
893                                    DEBUG_SERIAL(("WAIT end  event = %x\n", result));
894                                    out_uint32_le(out, result);
895                                    break;
896                            }
897                            return STATUS_PENDING;
898                            break;
899                    case SERIAL_SET_BREAK_ON:
900                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_BREAK_ON\n"));
901                            tcsendbreak(handle, 0);
902                          break;                          break;
903                  case SERIAL_RESET_DEVICE:                  case SERIAL_RESET_DEVICE:
904                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_RESET_DEVICE\n"));
905                            break;
906                  case SERIAL_SET_BREAK_OFF:                  case SERIAL_SET_BREAK_OFF:
907                  case SERIAL_SET_RTS:                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_BREAK_OFF\n"));
908                  case SERIAL_CLR_RTS:                          break;
909                  case SERIAL_SET_XOFF:                  case SERIAL_SET_XOFF:
910                            DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_XOFF\n"));
911                            break;
912                  case SERIAL_SET_XON:                  case SERIAL_SET_XON:
913                          /* ignore */                          DEBUG_SERIAL(("serial_ioctl -> SERIAL_SET_XON\n"));
914                            tcflow(handle, TCION);
915                          break;                          break;
 #endif  
   
916                  default:                  default:
917                          unimpl("SERIAL IOCTL %d\n", request);                          unimpl("SERIAL IOCTL %d\n", request);
918                          return STATUS_INVALID_PARAMETER;                          return STATUS_INVALID_PARAMETER;
# Line 309  serial_device_control(HANDLE handle, uin Line 921  serial_device_control(HANDLE handle, uin
921          return STATUS_SUCCESS;          return STATUS_SUCCESS;
922  }  }
923    
924  DEVICE_FNS serial_fns =  BOOL
925    serial_get_event(NTHANDLE handle, uint32 * result)
926    {
927            int index;
928            SERIAL_DEVICE *pser_inf;
929            int bytes;
930            BOOL ret = False;
931    
932            *result = 0;
933            index = get_device_index(handle);
934            if (index < 0)
935                    return False;
936    
937            pser_inf = (SERIAL_DEVICE *) g_rdpdr_device[index].pdevice_data;
938    
939    
940            ioctl(handle, TIOCINQ, &bytes);
941    
942            if (bytes > 0)
943            {
944                    DEBUG_SERIAL(("serial_get_event Bytes %d\n", bytes));
945                    if (bytes > pser_inf->event_rlsd)
946                    {
947                            pser_inf->event_rlsd = bytes;
948                            if (pser_inf->wait_mask & SERIAL_EV_RLSD)
949                            {
950                                    DEBUG_SERIAL(("Event -> SERIAL_EV_RLSD \n"));
951                                    *result |= SERIAL_EV_RLSD;
952                                    ret = True;
953                            }
954    
955                    }
956    
957                    if ((bytes > 1) && (pser_inf->wait_mask & SERIAL_EV_RXFLAG))
958                    {
959                            DEBUG_SERIAL(("Event -> SERIAL_EV_RXFLAG Bytes %d\n", bytes));
960                            *result |= SERIAL_EV_RXFLAG;
961                            ret = True;
962                    }
963                    if ((pser_inf->wait_mask & SERIAL_EV_RXCHAR))
964                    {
965                            DEBUG_SERIAL(("Event -> SERIAL_EV_RXCHAR Bytes %d\n", bytes));
966                            *result |= SERIAL_EV_RXCHAR;
967                            ret = True;
968                    }
969    
970            }
971            else
972            {
973                    pser_inf->event_rlsd = 0;
974            }
975    
976    
977            ioctl(handle, TIOCOUTQ, &bytes);
978            if ((bytes == 0)
979                && (pser_inf->event_txempty > 0) && (pser_inf->wait_mask & SERIAL_EV_TXEMPTY))
980            {
981    
982                    DEBUG_SERIAL(("Event -> SERIAL_EV_TXEMPTY\n"));
983                    *result |= SERIAL_EV_TXEMPTY;
984                    ret = True;
985            }
986            pser_inf->event_txempty = bytes;
987    
988    
989            ioctl(handle, TIOCMGET, &bytes);
990            if ((bytes & TIOCM_DSR) != pser_inf->event_dsr)
991            {
992                    pser_inf->event_dsr = bytes & TIOCM_DSR;
993                    if (pser_inf->wait_mask & SERIAL_EV_DSR)
994                    {
995                            DEBUG_SERIAL(("event -> SERIAL_EV_DSR %s\n",
996                                          (bytes & TIOCM_DSR) ? "ON" : "OFF"));
997                            *result |= SERIAL_EV_DSR;
998                            ret = True;
999                    }
1000            }
1001    
1002            if ((bytes & TIOCM_CTS) != pser_inf->event_cts)
1003            {
1004                    pser_inf->event_cts = bytes & TIOCM_CTS;
1005                    if (pser_inf->wait_mask & SERIAL_EV_CTS)
1006                    {
1007                            DEBUG_SERIAL((" EVENT-> SERIAL_EV_CTS %s\n",
1008                                          (bytes & TIOCM_CTS) ? "ON" : "OFF"));
1009                            *result |= SERIAL_EV_CTS;
1010                            ret = True;
1011                    }
1012            }
1013    
1014            if (ret)
1015                    pser_inf->event_pending = 0;
1016    
1017            return ret;
1018    }
1019    
1020    /* Read timeout for a given file descripter (device) when adding fd's to select() */
1021    BOOL
1022    serial_get_timeout(NTHANDLE handle, uint32 length, uint32 * timeout, uint32 * itv_timeout)
1023  {  {
1024            int index;
1025            SERIAL_DEVICE *pser_inf;
1026    
1027            index = get_device_index(handle);
1028            if (index < 0)
1029                    return True;
1030    
1031            if (g_rdpdr_device[index].device_type != DEVICE_TYPE_SERIAL)
1032            {
1033                    return False;
1034            }
1035    
1036            pser_inf = (SERIAL_DEVICE *) g_rdpdr_device[index].pdevice_data;
1037    
1038            *timeout =
1039                    pser_inf->read_total_timeout_multiplier * length +
1040                    pser_inf->read_total_timeout_constant;
1041            *itv_timeout = pser_inf->read_interval_timeout;
1042            return True;
1043    }
1044    
1045    DEVICE_FNS serial_fns = {
1046          serial_create,          serial_create,
1047          serial_close,          serial_close,
1048          serial_read,          serial_read,
1049          serial_write,          serial_write,
1050          serial_device_control          serial_device_control
1051  };  };
   
Legend:
Removed from v.432  
changed lines
  Added in v.809
  ViewVC Help
Powered by ViewVC 1.1.26