diff options
Diffstat (limited to '')
-rw-r--r-- | cpukit/telnetd/pty.c | 630 |
1 files changed, 315 insertions, 315 deletions
diff --git a/cpukit/telnetd/pty.c b/cpukit/telnetd/pty.c index 9ee05231b7..142a7ce4e4 100644 --- a/cpukit/telnetd/pty.c +++ b/cpukit/telnetd/pty.c @@ -144,22 +144,22 @@ static rtems_device_major_number pty_major; */ char * telnet_get_pty(int socket) { - int ndx; - if (telnet_pty_inited) { - for (ndx=0;ndx<MAX_PTYS;ndx++) { - if (telnet_ptys[ndx].socket<0) { - struct timeval t; - /* set a long polling interval to save CPU time */ - t.tv_sec=2; - t.tv_usec=00000; - setsockopt(socket, SOL_SOCKET, SO_RCVTIMEO, &t, sizeof(t)); - telnet_ptys[ndx].socket=socket; - return telnet_ptys[ndx].devname; - }; - }; - } - close(socket); - return NULL; + int ndx; + if (telnet_pty_inited) { + for (ndx=0;ndx<MAX_PTYS;ndx++) { + if (telnet_ptys[ndx].socket<0) { + struct timeval t; + /* set a long polling interval to save CPU time */ + t.tv_sec=2; + t.tv_usec=00000; + setsockopt(socket, SOL_SOCKET, SO_RCVTIMEO, &t, sizeof(t)); + telnet_ptys[ndx].socket=socket; + return telnet_ptys[ndx].devname; + }; + }; + } + close(socket); + return NULL; } @@ -177,175 +177,175 @@ static const char IAC_IP_RSP []="<*Interrupt*>"; static int send_iac(int minor,unsigned char mode,unsigned char option) { - unsigned char buf[3]; - buf[0]=IAC_ESC; - buf[1]=mode; - buf[2]=option; - return write(telnet_ptys[minor].socket,buf,sizeof(buf)); + unsigned char buf[3]; + buf[0]=IAC_ESC; + buf[1]=mode; + buf[2]=option; + return write(telnet_ptys[minor].socket,buf,sizeof(buf)); } static int handleSB(pty_t *pty) { - switch (pty->sb_buf[0]) { - case 31: /* NAWS */ - pty->width = (pty->sb_buf[1]<<8) + pty->sb_buf[2]; - pty->height = (pty->sb_buf[3]<<8) + pty->sb_buf[4]; + switch (pty->sb_buf[0]) { + case 31: /* NAWS */ + pty->width = (pty->sb_buf[1]<<8) + pty->sb_buf[2]; + pty->height = (pty->sb_buf[3]<<8) + pty->sb_buf[4]; #if DEBUG & DEBUG_WH - fprintf(stderr, - "Setting width/height to %ix%i\n", - pty->width, - pty->height); + fprintf(stderr, + "Setting width/height to %ix%i\n", + pty->width, + pty->height); #endif - break; - default: - break; - } - return 0; + break; + default: + break; + } + return 0; } static int read_pty(int minor) { /* Characters written to the client side*/ - unsigned char value; - unsigned int omod; - int count; - int result; - pty_t *pty=telnet_ptys+minor; - - count=read(pty->socket,&value,sizeof(value)); - if (count<0) - return -1; - - if (count<1) { - /* Unfortunately, there is no way of passing an EOF - * condition through the termios driver. Hence, we - * resort to an ugly hack. Setting cindex>ccount - * causes the termios driver to return a read count - * of '0' which is what we want here. We leave - * 'errno' untouched. - */ - pty->ttyp->cindex=pty->ttyp->ccount+1; - return pty->ttyp->termios.c_cc[VEOF]; - }; - - omod=pty->iac_mode; - pty->iac_mode=0; - switch(omod & 0xff) { - case IAC_ESC: - switch(value) { - case IAC_ESC : - /* in case this is an ESC ESC sequence in SB mode */ - pty->iac_mode = omod>>8; - return IAC_ESC; - case IAC_DONT: - case IAC_DO : - case IAC_WONT: - case IAC_WILL: - pty->iac_mode=value; - return -1; - case IAC_SB : + unsigned char value; + unsigned int omod; + int count; + int result; + pty_t *pty=telnet_ptys+minor; + + count=read(pty->socket,&value,sizeof(value)); + if (count<0) + return -1; + + if (count<1) { + /* Unfortunately, there is no way of passing an EOF + * condition through the termios driver. Hence, we + * resort to an ugly hack. Setting cindex>ccount + * causes the termios driver to return a read count + * of '0' which is what we want here. We leave + * 'errno' untouched. + */ + pty->ttyp->cindex=pty->ttyp->ccount+1; + return pty->ttyp->termios.c_cc[VEOF]; + }; + + omod=pty->iac_mode; + pty->iac_mode=0; + switch(omod & 0xff) { + case IAC_ESC: + switch(value) { + case IAC_ESC : + /* in case this is an ESC ESC sequence in SB mode */ + pty->iac_mode = omod>>8; + return IAC_ESC; + case IAC_DONT: + case IAC_DO : + case IAC_WONT: + case IAC_WILL: + pty->iac_mode=value; + return -1; + case IAC_SB : #if DEBUG & DEBUG_DETAIL - printk("SB\n"); + printk("SB\n"); #endif - pty->iac_mode=value; - pty->sb_ind=0; - return -100; - case IAC_GA : - return -1; - case IAC_EL : - return 0x03; /* Ctrl-C*/ - case IAC_EC : - return '\b'; - case IAC_AYT : - write(pty->socket,IAC_AYT_RSP,strlen(IAC_AYT_RSP)); - return -1; - case IAC_AO : - return -1; - case IAC_IP : - write(pty->socket,IAC_IP_RSP,strlen(IAC_IP_RSP)); - return -1; - case IAC_BRK : - write(pty->socket,IAC_BRK_RSP,strlen(IAC_BRK_RSP)); - return -1; - case IAC_DMARK: - return -2; - case IAC_NOP : - return -1; - case IAC_SE : + pty->iac_mode=value; + pty->sb_ind=0; + return -100; + case IAC_GA : + return -1; + case IAC_EL : + return 0x03; /* Ctrl-C*/ + case IAC_EC : + return '\b'; + case IAC_AYT : + write(pty->socket,IAC_AYT_RSP,strlen(IAC_AYT_RSP)); + return -1; + case IAC_AO : + return -1; + case IAC_IP : + write(pty->socket,IAC_IP_RSP,strlen(IAC_IP_RSP)); + return -1; + case IAC_BRK : + write(pty->socket,IAC_BRK_RSP,strlen(IAC_BRK_RSP)); + return -1; + case IAC_DMARK: + return -2; + case IAC_NOP : + return -1; + case IAC_SE : #if DEBUG & DEBUG_DETAIL - { - int i; - printk("SE"); - for (i=0; i<pty->sb_ind; i++) - printk(" %02x",pty->sb_buf[i]); - printk("\n"); - } + { + int i; + printk("SE"); + for (i=0; i<pty->sb_ind; i++) + printk(" %02x",pty->sb_buf[i]); + printk("\n"); + } #endif - handleSB(pty); - return -101; - case IAC_EOR : - return -102; - default : - return -1; - }; - break; - - case IAC_SB: - pty->iac_mode=omod; - if (IAC_ESC==value) { - pty->iac_mode=(omod<<8)|value; - } else { - if (pty->sb_ind < SB_MAX) - pty->sb_buf[pty->sb_ind++]=value; - } - return -1; - - case IAC_WILL: - if (value==34){ - send_iac(minor,IAC_DONT, 34); /*LINEMODE*/ - send_iac(minor,IAC_DO , 1); /*ECHO */ - } else if (value==31) { - send_iac(minor,IAC_DO , 31); /*NAWS */ + handleSB(pty); + return -101; + case IAC_EOR : + return -102; + default : + return -1; + }; + break; + + case IAC_SB: + pty->iac_mode=omod; + if (IAC_ESC==value) { + pty->iac_mode=(omod<<8)|value; + } else { + if (pty->sb_ind < SB_MAX) + pty->sb_buf[pty->sb_ind++]=value; + } + return -1; + + case IAC_WILL: + if (value==34){ + send_iac(minor,IAC_DONT, 34); /*LINEMODE*/ + send_iac(minor,IAC_DO , 1); /*ECHO */ + } else if (value==31) { + send_iac(minor,IAC_DO , 31); /*NAWS */ #if DEBUG & DEBUG_DETAIL - printk("replied DO NAWS\n"); + printk("replied DO NAWS\n"); #endif - } else { - send_iac(minor,IAC_DONT,value); - } - return -1; - case IAC_DONT: - return -1; - case IAC_DO : - if (value==3) { - send_iac(minor,IAC_WILL, 3); /* GO AHEAD*/ - } else if (value==1) { - /* ECHO */ - } else { - send_iac(minor,IAC_WONT,value); - }; - return -1; - case IAC_WONT: - if (value==1) {send_iac(minor,IAC_WILL, 1);} else /* ECHO */ - {send_iac(minor,IAC_WONT,value);}; - return -1; - default: - if (value==IAC_ESC) { - pty->iac_mode=value; - return -1; - } else { - result=value; - if ( 0 + } else { + send_iac(minor,IAC_DONT,value); + } + return -1; + case IAC_DONT: + return -1; + case IAC_DO : + if (value==3) { + send_iac(minor,IAC_WILL, 3); /* GO AHEAD*/ + } else if (value==1) { + /* ECHO */ + } else { + send_iac(minor,IAC_WONT,value); + }; + return -1; + case IAC_WONT: + if (value==1) {send_iac(minor,IAC_WILL, 1);} else /* ECHO */ + {send_iac(minor,IAC_WONT,value);}; + return -1; + default: + if (value==IAC_ESC) { + pty->iac_mode=value; + return -1; + } else { + result=value; + if ( 0 #if 0 /* pass CRLF through - they should use termios to handle it */ - || ((value=='\n') && (pty->last_cr)) + || ((value=='\n') && (pty->last_cr)) #endif - /* but map telnet CRNUL to CR down here */ - || ((value==0) && pty->last_cr) - ) result=-1; - pty->last_cr=(value=='\r'); - return result; - }; - }; - /* should never get here but keep compiler happy */ - return -1; + /* but map telnet CRNUL to CR down here */ + || ((value==0) && pty->last_cr) + ) result=-1; + pty->last_cr=(value=='\r'); + return result; + }; + }; + /* should never get here but keep compiler happy */ + return -1; } /*-----------------------------------------------------------*/ @@ -360,69 +360,69 @@ static const rtems_termios_callbacks * pty_get_termios_handlers(int polled) ; /*-----------------------------------------------------------*/ static int ptySetAttributes(int minor,const struct termios *t) { - if (minor<MAX_PTYS) { - telnet_ptys[minor].c_cflag=t->c_cflag; - } else { - return -1; - }; - return 0; + if (minor<MAX_PTYS) { + telnet_ptys[minor].c_cflag=t->c_cflag; + } else { + return -1; + }; + return 0; } /*-----------------------------------------------------------*/ static int ptyPollInitialize(int major,int minor,void * arg) { - rtems_libio_open_close_args_t * args = (rtems_libio_open_close_args_t*)arg; - struct termios t; + rtems_libio_open_close_args_t * args = (rtems_libio_open_close_args_t*)arg; + struct termios t; if (minor<MAX_PTYS) { if (telnet_ptys[minor].socket<0) return -1; - telnet_ptys[minor].opened=TRUE; - telnet_ptys[minor].ttyp= (struct rtems_termios_tty *) args->iop->data1; - telnet_ptys[minor].iac_mode=0; - telnet_ptys[minor].sb_ind=0; - telnet_ptys[minor].width=0; - telnet_ptys[minor].height=0; - t.c_cflag=B9600|CS8;/* termios default */ - return ptySetAttributes(minor,&t); - } else { - return -1; - }; + telnet_ptys[minor].opened=TRUE; + telnet_ptys[minor].ttyp= (struct rtems_termios_tty *) args->iop->data1; + telnet_ptys[minor].iac_mode=0; + telnet_ptys[minor].sb_ind=0; + telnet_ptys[minor].width=0; + telnet_ptys[minor].height=0; + t.c_cflag=B9600|CS8;/* termios default */ + return ptySetAttributes(minor,&t); + } else { + return -1; + }; } /*-----------------------------------------------------------*/ static int ptyShutdown(int major,int minor,void * arg) { if (minor<MAX_PTYS) { - telnet_ptys[minor].opened=FALSE; + telnet_ptys[minor].opened=FALSE; if (telnet_ptys[minor].socket>=0) close(telnet_ptys[minor].socket); - telnet_ptys[minor].socket=-1; - chown(telnet_ptys[minor].devname,2,0); - } else { - return -1; - }; - return 0; + telnet_ptys[minor].socket=-1; + chown(telnet_ptys[minor].devname,2,0); + } else { + return -1; + }; + return 0; } /*-----------------------------------------------------------*/ /* Write Characters into pty device */ /*-----------------------------------------------------------*/ static int ptyPollWrite(int minor, const char * buf,int len) { - int count; + int count; if (minor<MAX_PTYS) { if (telnet_ptys[minor].socket<0) return -1; - count=write(telnet_ptys[minor].socket,buf,len); - } else { - count=-1; - }; - return count; + count=write(telnet_ptys[minor].socket,buf,len); + } else { + count=-1; + }; + return count; } /*-----------------------------------------------------------*/ static int ptyPollRead(int minor) { - int result; + int result; if (minor<MAX_PTYS) { if (telnet_ptys[minor].socket<0) return -1; - result=read_pty(minor); - return result; - }; - return -1; + result=read_pty(minor); + return result; + }; + return -1; } /*-----------------------------------------------------------*/ /* pty_initialize @@ -446,36 +446,36 @@ rtems_device_driver my_pty_initialize( int ndx; rtems_status_code status ; - /* - * Set up ptys - */ - - for (ndx=0;ndx<MAX_PTYS;ndx++) { - telnet_ptys[ndx].devname=(char*)malloc(strlen("/dev/ptyXX")+1); - sprintf(telnet_ptys[ndx].devname,"/dev/pty%X",ndx); - telnet_ptys[ndx].ttyp=NULL; - telnet_ptys[ndx].c_cflag=CS8|B9600; - telnet_ptys[ndx].socket=-1; - telnet_ptys[ndx].opened=FALSE; - telnet_ptys[ndx].sb_ind=0; - telnet_ptys[ndx].width=0; - telnet_ptys[ndx].height=0; - - }; - - /* - * Register the devices - */ - for (ndx=0;ndx<MAX_PTYS;ndx++) { - status = rtems_io_register_name(telnet_ptys[ndx].devname, major, ndx); - if (status != RTEMS_SUCCESSFUL) - rtems_fatal_error_occurred(status); - chmod(telnet_ptys[ndx].devname,0660); - chown(telnet_ptys[ndx].devname,2,0); /* tty,root*/ - }; - printk("Device: /dev/pty%X../dev/pty%X (%d)pseudo-terminals registered.\n",0,MAX_PTYS-1,MAX_PTYS); - - return RTEMS_SUCCESSFUL; + /* + * Set up ptys + */ + + for (ndx=0;ndx<MAX_PTYS;ndx++) { + telnet_ptys[ndx].devname=(char*)malloc(strlen("/dev/ptyXX")+1); + sprintf(telnet_ptys[ndx].devname,"/dev/pty%X",ndx); + telnet_ptys[ndx].ttyp=NULL; + telnet_ptys[ndx].c_cflag=CS8|B9600; + telnet_ptys[ndx].socket=-1; + telnet_ptys[ndx].opened=FALSE; + telnet_ptys[ndx].sb_ind=0; + telnet_ptys[ndx].width=0; + telnet_ptys[ndx].height=0; + + }; + + /* + * Register the devices + */ + for (ndx=0;ndx<MAX_PTYS;ndx++) { + status = rtems_io_register_name(telnet_ptys[ndx].devname, major, ndx); + if (status != RTEMS_SUCCESSFUL) + rtems_fatal_error_occurred(status); + chmod(telnet_ptys[ndx].devname,0660); + chown(telnet_ptys[ndx].devname,2,0); /* tty,root*/ + }; + printk("Device: /dev/pty%X../dev/pty%X (%d)pseudo-terminals registered.\n",0,MAX_PTYS-1,MAX_PTYS); + + return RTEMS_SUCCESSFUL; } static int pty_do_finalize() @@ -483,32 +483,32 @@ static int pty_do_finalize() int ndx; rtems_status_code status; - if ( !telnet_pty_inited ) - return 0; - - for (ndx=0;ndx<MAX_PTYS;ndx++) { - if (telnet_ptys[ndx].opened) { - fprintf(stderr,"There are still opened PTY devices, unable to proceed\n"); - return -1; - } - } - if (RTEMS_SUCCESSFUL != rtems_io_unregister_driver(pty_major)) { - fprintf(stderr,"Unable to remove this driver\n"); - return -1; - } - for (ndx=0;ndx<MAX_PTYS;ndx++) { - /* rtems_io_register_name() actually creates a node in the filesystem - * (mknod()) - */ - status = (rtems_status_code)unlink(telnet_ptys[ndx].devname); - if (status != RTEMS_SUCCESSFUL) - perror("removing pty device node from file system"); - else - free(telnet_ptys[ndx].devname); - }; - fprintf(stderr,"PTY driver unloaded successfully\n"); - telnet_pty_inited=FALSE; - return 0; + if ( !telnet_pty_inited ) + return 0; + + for (ndx=0;ndx<MAX_PTYS;ndx++) { + if (telnet_ptys[ndx].opened) { + fprintf(stderr,"There are still opened PTY devices, unable to proceed\n"); + return -1; + } + } + if (RTEMS_SUCCESSFUL != rtems_io_unregister_driver(pty_major)) { + fprintf(stderr,"Unable to remove this driver\n"); + return -1; + } + for (ndx=0;ndx<MAX_PTYS;ndx++) { + /* rtems_io_register_name() actually creates a node in the filesystem + * (mknod()) + */ + status = (rtems_status_code)unlink(telnet_ptys[ndx].devname); + if (status != RTEMS_SUCCESSFUL) + perror("removing pty device node from file system"); + else + free(telnet_ptys[ndx].devname); + }; + fprintf(stderr,"PTY driver unloaded successfully\n"); + telnet_pty_inited=FALSE; + return 0; } /* @@ -584,93 +584,93 @@ rtems_libio_ioctl_args_t *args = (rtems_libio_ioctl_args_t*)arg; struct winsize *wp = (struct winsize*)args->buffer; pty_t *p=&telnet_ptys[minor]; - switch (args->command) { + switch (args->command) { - case TIOCGWINSZ: + case TIOCGWINSZ: - wp->ws_row = p->height; - wp->ws_col = p->width; - args->ioctl_return=0; + wp->ws_row = p->height; + wp->ws_col = p->width; + args->ioctl_return=0; #if DEBUG & DEBUG_WH - fprintf(stderr, - "ioctl(TIOCGWINSZ), returning %ix%i\n", - wp->ws_col, - wp->ws_row); + fprintf(stderr, + "ioctl(TIOCGWINSZ), returning %ix%i\n", + wp->ws_col, + wp->ws_row); #endif - return RTEMS_SUCCESSFUL; + return RTEMS_SUCCESSFUL; - case TIOCSWINSZ: + case TIOCSWINSZ: #if DEBUG & DEBUG_WH - fprintf(stderr, - "ioctl(TIOCGWINSZ), setting %ix%i\n", - wp->ws_col, - wp->ws_row); + fprintf(stderr, + "ioctl(TIOCGWINSZ), setting %ix%i\n", + wp->ws_col, + wp->ws_row); #endif - p->height = wp->ws_row; - p->width = wp->ws_col; - args->ioctl_return=0; + p->height = wp->ws_row; + p->width = wp->ws_col; + args->ioctl_return=0; - return RTEMS_SUCCESSFUL; + return RTEMS_SUCCESSFUL; - default: + default: - break; + break; } return rtems_termios_ioctl(arg); } static rtems_driver_address_table drvPty = { - my_pty_initialize, - my_pty_open, - my_pty_close, - my_pty_read, - my_pty_write, - my_pty_control + my_pty_initialize, + my_pty_open, + my_pty_close, + my_pty_read, + my_pty_write, + my_pty_control }; /*-----------------------------------------------------------*/ static const rtems_termios_callbacks pty_poll_callbacks = { - ptyPollInitialize, /* FirstOpen*/ - ptyShutdown, /* LastClose*/ - ptyPollRead, /* PollRead */ - ptyPollWrite, /* Write */ - ptySetAttributes, /* setAttributes */ - NULL, /* stopRemoteTX */ - NULL, /* StartRemoteTX */ - 0 /* outputUsesInterrupts */ + ptyPollInitialize, /* FirstOpen*/ + ptyShutdown, /* LastClose*/ + ptyPollRead, /* PollRead */ + ptyPollWrite, /* Write */ + ptySetAttributes, /* setAttributes */ + NULL, /* stopRemoteTX */ + NULL, /* StartRemoteTX */ + 0 /* outputUsesInterrupts */ }; /*-----------------------------------------------------------*/ static const rtems_termios_callbacks * pty_get_termios_handlers(int polled) { - return &pty_poll_callbacks; + return &pty_poll_callbacks; } /*-----------------------------------------------------------*/ static int pty_do_initialize() { - if ( !telnet_pty_inited ) { - if (RTEMS_SUCCESSFUL==rtems_io_register_driver(0, &drvPty, &pty_major)) - telnet_pty_inited=TRUE; - else - fprintf(stderr,"WARNING: registering the PTY driver FAILED\n"); - } - return telnet_pty_inited; + if ( !telnet_pty_inited ) { + if (RTEMS_SUCCESSFUL==rtems_io_register_driver(0, &drvPty, &pty_major)) + telnet_pty_inited=TRUE; + else + fprintf(stderr,"WARNING: registering the PTY driver FAILED\n"); + } + return telnet_pty_inited; } #ifdef __cplusplus class TelnetPtyIni { public: - TelnetPtyIni() { if (!nest++) { - pty_do_initialize(); - } - }; - ~TelnetPtyIni(){ if (!--nest) { - pty_do_finalize(); - } - }; + TelnetPtyIni() { if (!nest++) { + pty_do_initialize(); + } + }; + ~TelnetPtyIni(){ if (!--nest) { + pty_do_finalize(); + } + }; private: static int nest; }; @@ -680,22 +680,22 @@ int TelnetPtyIni::nest=0; int telnet_pty_initialize() { - return telnet_pty_inited; + return telnet_pty_inited; } int telnet_pty_finalize() { - return telnet_pty_inited; + return telnet_pty_inited; } }; #else int telnet_pty_initialize() { - return pty_do_initialize(); + return pty_do_initialize(); } int telnet_pty_finalize() { - return pty_do_finalize(); + return pty_do_finalize(); } #endif |