linux 2.6.16.38 w/ vs2.0.3-rc1

[linux-2.6.git] / drivers / char / rocket.c

diff --git a/drivers/char/rocket.c b/drivers/char/rocket.c
index 0ac1318..7edc6a4 100644 (file)
--- a/drivers/char/rocket.c
+++ b/drivers/char/rocket.c
@@ -324,15 +324,35 @@ static void rp_do_receive(struct r_port *info,
                          CHANNEL_t * cp, unsigned int ChanStatus)
 {
        unsigned int CharNStat;
-       int ToRecv, wRecv, space;
-       unsigned char *cbuf;
+       int ToRecv, wRecv, space = 0, count;
+       unsigned char *cbuf, *chead;
+       char *fbuf, *fhead;
+       struct tty_ldisc *ld;
+
+       ld = tty_ldisc_ref(tty);
 
        ToRecv = sGetRxCnt(cp);
+       space = tty->receive_room;
+       if (space > 2 * TTY_FLIPBUF_SIZE)
+               space = 2 * TTY_FLIPBUF_SIZE;
+       count = 0;
 #ifdef ROCKET_DEBUG_INTR
-       printk(KERN_INFO "rp_do_receive(%d)...", ToRecv);
+       printk(KERN_INFO "rp_do_receive(%d, %d)...", ToRecv, space);
 #endif
-       if (ToRecv == 0)
-               return;
+
+       /*
+        * determine how many we can actually read in.  If we can't
+        * read any in then we have a software overrun condition.
+        */
+       if (ToRecv > space)
+               ToRecv = space;
+
+       ToRecv = tty_prepare_flip_string_flags(tty, &chead, &fhead, ToRecv);
+       if (ToRecv <= 0)
+               goto done;
+
+       cbuf = chead;
+       fbuf = fhead;
 
        /*
         * if status indicates there are errored characters in the
@@ -360,8 +380,6 @@ static void rp_do_receive(struct r_port *info,
                       info->read_status_mask);
 #endif
                while (ToRecv) {
-                       char flag;
-
                        CharNStat = sInW(sGetTxRxDataIO(cp));
 #ifdef ROCKET_DEBUG_RECEIVE
                        printk(KERN_INFO "%x...", CharNStat);
@@ -374,16 +392,17 @@ static void rp_do_receive(struct r_port *info,
                        }
                        CharNStat &= info->read_status_mask;
                        if (CharNStat & STMBREAKH)
-                               flag = TTY_BREAK;
+                               *fbuf++ = TTY_BREAK;
                        else if (CharNStat & STMPARITYH)
-                               flag = TTY_PARITY;
+                               *fbuf++ = TTY_PARITY;
                        else if (CharNStat & STMFRAMEH)
-                               flag = TTY_FRAME;
+                               *fbuf++ = TTY_FRAME;
                        else if (CharNStat & STMRCVROVRH)
-                               flag = TTY_OVERRUN;
+                               *fbuf++ = TTY_OVERRUN;
                        else
-                               flag = TTY_NORMAL;
-                       tty_insert_flip_char(tty, CharNStat & 0xff, flag);
+                               *fbuf++ = TTY_NORMAL;
+                       *cbuf++ = CharNStat & 0xff;
+                       count++;
                        ToRecv--;
                }
 
@@ -403,23 +422,20 @@ static void rp_do_receive(struct r_port *info,
                 * characters at time by doing repeated word IO
                 * transfer.
                 */
-               space = tty_prepare_flip_string(tty, &cbuf, ToRecv);
-               if (space < ToRecv) {
-#ifdef ROCKET_DEBUG_RECEIVE
-                       printk(KERN_INFO "rp_do_receive:insufficient space ToRecv=%d space=%d\n", ToRecv, space);
-#endif
-                       if (space <= 0)
-                               return;
-                       ToRecv = space;
-               }
                wRecv = ToRecv >> 1;
                if (wRecv)
                        sInStrW(sGetTxRxDataIO(cp), (unsigned short *) cbuf, wRecv);
                if (ToRecv & 1)
                        cbuf[ToRecv - 1] = sInB(sGetTxRxDataIO(cp));
+               memset(fbuf, TTY_NORMAL, ToRecv);
+               cbuf += ToRecv;
+               fbuf += ToRecv;
+               count += ToRecv;
        }
        /*  Push the data up to the tty layer */
-       tty_flip_buffer_push(tty);
+       ld->receive_buf(tty, chead, fhead, count);
+done:
+       tty_ldisc_deref(ld);
 }
 
 /*
@@ -2426,7 +2442,8 @@ static int __init rp_init(void)
         */
 
        rocket_driver->owner = THIS_MODULE;
-       rocket_driver->flags = TTY_DRIVER_DYNAMIC_DEV;
+       rocket_driver->flags = TTY_DRIVER_NO_DEVFS;
+       rocket_driver->devfs_name = "tts/R";
        rocket_driver->name = "ttyR";
        rocket_driver->driver_name = "Comtrol RocketPort";
        rocket_driver->major = TTY_ROCKET_MAJOR;
@@ -2437,7 +2454,7 @@ static int __init rp_init(void)
        rocket_driver->init_termios.c_cflag =
            B9600 | CS8 | CREAD | HUPCL | CLOCAL;
 #ifdef ROCKET_SOFT_FLOW
-       rocket_driver->flags |= TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
+       rocket_driver->flags |= TTY_DRIVER_REAL_RAW | TTY_DRIVER_NO_DEVFS;
 #endif
        tty_set_operations(rocket_driver, &rocket_ops);