git.oblomov.eu Git - linux-2.6/blob - drivers/char/rio/rio_linux.c

   1
   2 /* rio_linux.c -- Linux driver for the Specialix RIO series cards.
   3  *
   4  *
   5  *   (C) 1999 R.E.Wolff@BitWizard.nl
   6  *
   7  * Specialix pays for the development and support of this driver.
   8  * Please DO contact support@specialix.co.uk if you require
   9  * support. But please read the documentation (rio.txt) first.
  10  *
  11  *
  12  *
  13  *      This program is free software; you can redistribute it and/or
  14  *      modify it under the terms of the GNU General Public License as
  15  *      published by the Free Software Foundation; either version 2 of
  16  *      the License, or (at your option) any later version.
  17  *
  18  *      This program is distributed in the hope that it will be
  19  *      useful, but WITHOUT ANY WARRANTY; without even the implied
  20  *      warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
  21  *      PURPOSE.  See the GNU General Public License for more details.
  22  *
  23  *      You should have received a copy of the GNU General Public
  24  *      License along with this program; if not, write to the Free
  25  *      Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139,
  26  *      USA.
  27  *
  28  * Revision history:
  29  * $Log: rio.c,v $
  30  * Revision 1.1  1999/07/11 10:13:54  wolff
  31  * Initial revision
  32  *
  33  * */
  34
  35 #include <linux/module.h>
  36 #include <linux/kdev_t.h>
  37 #include <asm/io.h>
  38 #include <linux/kernel.h>
  39 #include <linux/sched.h>
  40 #include <linux/ioport.h>
  41 #include <linux/interrupt.h>
  42 #include <linux/errno.h>
  43 #include <linux/tty.h>
  44 #include <linux/tty_flip.h>
  45 #include <linux/mm.h>
  46 #include <linux/serial.h>
  47 #include <linux/fcntl.h>
  48 #include <linux/major.h>
  49 #include <linux/delay.h>
  50 #include <linux/pci.h>
  51 #include <linux/slab.h>
  52 #include <linux/miscdevice.h>
  53 #include <linux/init.h>
  54
  55 #include <linux/generic_serial.h>
  56 #include <asm/uaccess.h>
  57
  58 #include "linux_compat.h"
  59 #include "pkt.h"
  60 #include "daemon.h"
  61 #include "rio.h"
  62 #include "riospace.h"
  63 #include "cmdpkt.h"
  64 #include "map.h"
  65 #include "rup.h"
  66 #include "port.h"
  67 #include "riodrvr.h"
  68 #include "rioinfo.h"
  69 #include "func.h"
  70 #include "errors.h"
  71 #include "pci.h"
  72
  73 #include "parmmap.h"
  74 #include "unixrup.h"
  75 #include "board.h"
  76 #include "host.h"
  77 #include "phb.h"
  78 #include "link.h"
  79 #include "cmdblk.h"
  80 #include "route.h"
  81 #include "cirrus.h"
  82 #include "rioioctl.h"
  83 #include "param.h"
  84 #include "protsts.h"
  85 #include "rioboard.h"
  86
  87
  88 #include "rio_linux.h"
  89
  90 /* I don't think that this driver can handle more than 512 ports on
  91 one machine.  Specialix specifies max 4 boards in one machine. I don't
  92 know why. If you want to try anyway you'll have to increase the number
  93 of boards in rio.h.  You'll have to allocate more majors if you need
  94 more than 512 ports.... */
  95
  96 #ifndef RIO_NORMAL_MAJOR0
  97 /* This allows overriding on the compiler commandline, or in a "major.h"
  98    include or something like that */
  99 #define RIO_NORMAL_MAJOR0  154
 100 #define RIO_NORMAL_MAJOR1  156
 101 #endif
 102
 103 #ifndef PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8
 104 #define PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8 0x2000
 105 #endif
 106
 107 #ifndef RIO_WINDOW_LEN
 108 #define RIO_WINDOW_LEN 0x10000
 109 #endif
 110
 111
 112 /* Configurable options:
 113    (Don't be too sure that it'll work if you toggle them) */
 114
 115 /* Am I paranoid or not ? ;-) */
 116 #undef RIO_PARANOIA_CHECK
 117
 118
 119 /* 20 -> 2000 per second. The card should rate-limit interrupts at 1000
 120    Hz, but it is user configurable. I don't recommend going above 1000
 121    Hz. The interrupt ratelimit might trigger if the interrupt is
 122    shared with a very active other device.
 123    undef this if you want to disable the check....
 124 */
 125 #define IRQ_RATE_LIMIT 200
 126
 127
 128 /* These constants are derived from SCO Source */
 129 static struct Conf
 130  RIOConf = {
 131         /* locator */ "RIO Config here",
 132                                         /* startuptime */ HZ * 2,
 133                                         /* how long to wait for card to run */
 134                                 /* slowcook */ 0,
 135                                 /* TRUE -> always use line disc. */
 136                                 /* intrpolltime */ 1,
 137                                 /* The frequency of OUR polls */
 138                                 /* breakinterval */ 25,
 139                                 /* x10 mS XXX: units seem to be 1ms not 10! -- REW */
 140                                 /* timer */ 10,
 141                                 /* mS */
 142         /* RtaLoadBase */ 0x7000,
 143         /* HostLoadBase */ 0x7C00,
 144                                 /* XpHz */ 5,
 145                                 /* number of Xprint hits per second */
 146                                 /* XpCps */ 120,
 147                                 /* Xprint characters per second */
 148                                 /* XpOn */ "\033d#",
 149                                 /* start Xprint for a wyse 60 */
 150                                 /* XpOff */ "\024",
 151                                 /* end Xprint for a wyse 60 */
 152                                 /* MaxXpCps */ 2000,
 153                                 /* highest Xprint speed */
 154                                 /* MinXpCps */ 10,
 155                                 /* slowest Xprint speed */
 156                                 /* SpinCmds */ 1,
 157                                 /* non-zero for mega fast boots */
 158                                         /* First Addr */ 0x0A0000,
 159                                         /* First address to look at */
 160                                         /* Last Addr */ 0xFF0000,
 161                                         /* Last address looked at */
 162                                 /* BufferSize */ 1024,
 163                                 /* Bytes per port of buffering */
 164                                 /* LowWater */ 256,
 165                                 /* how much data left before wakeup */
 166                                 /* LineLength */ 80,
 167                                 /* how wide is the console? */
 168                                 /* CmdTimeout */ HZ,
 169                                 /* how long a close command may take */
 170 };
 171
 172
 173
 174
 175 /* Function prototypes */
 176
 177 static void rio_disable_tx_interrupts(void *ptr);
 178 static void rio_enable_tx_interrupts(void *ptr);
 179 static void rio_disable_rx_interrupts(void *ptr);
 180 static void rio_enable_rx_interrupts(void *ptr);
 181 static int rio_get_CD(void *ptr);
 182 static void rio_shutdown_port(void *ptr);
 183 static int rio_set_real_termios(void *ptr);
 184 static void rio_hungup(void *ptr);
 185 static void rio_close(void *ptr);
 186 static int rio_chars_in_buffer(void *ptr);
 187 static int rio_fw_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg);
 188 static int rio_init_drivers(void);
 189
 190 static void my_hd(void *addr, int len);
 191
 192 static struct tty_driver *rio_driver, *rio_driver2;
 193
 194 /* The name "p" is a bit non-descript. But that's what the rio-lynxos
 195 sources use all over the place. */
 196 struct rio_info *p;
 197
 198 int rio_debug;
 199
 200
 201 /* You can have the driver poll your card.
 202     - Set rio_poll to 1 to poll every timer tick (10ms on Intel).
 203       This is used when the card cannot use an interrupt for some reason.
 204 */
 205 static int rio_poll = 1;
 206
 207
 208 /* These are the only open spaces in my computer. Yours may have more
 209    or less.... */
 210 static int rio_probe_addrs[] = { 0xc0000, 0xd0000, 0xe0000 };
 211
 212 #define NR_RIO_ADDRS ARRAY_SIZE(rio_probe_addrs)
 213
 214
 215 /* Set the mask to all-ones. This alas, only supports 32 interrupts.
 216    Some architectures may need more. -- Changed to LONG to
 217    support up to 64 bits on 64bit architectures. -- REW 20/06/99 */
 218 static long rio_irqmask = -1;
 219
 220 MODULE_AUTHOR("Rogier Wolff <R.E.Wolff@bitwizard.nl>, Patrick van de Lageweg <patrick@bitwizard.nl>");
 221 MODULE_DESCRIPTION("RIO driver");
 222 MODULE_LICENSE("GPL");
 223 module_param(rio_poll, int, 0);
 224 module_param(rio_debug, int, 0644);
 225 module_param(rio_irqmask, long, 0);
 226
 227 static struct real_driver rio_real_driver = {
 228         rio_disable_tx_interrupts,
 229         rio_enable_tx_interrupts,
 230         rio_disable_rx_interrupts,
 231         rio_enable_rx_interrupts,
 232         rio_get_CD,
 233         rio_shutdown_port,
 234         rio_set_real_termios,
 235         rio_chars_in_buffer,
 236         rio_close,
 237         rio_hungup,
 238         NULL
 239 };
 240
 241 /*
 242  *  Firmware loader driver specific routines
 243  *
 244  */
 245
 246 static const struct file_operations rio_fw_fops = {
 247         .owner = THIS_MODULE,
 248         .ioctl = rio_fw_ioctl,
 249 };
 250
 251 static struct miscdevice rio_fw_device = {
 252         RIOCTL_MISC_MINOR, "rioctl", &rio_fw_fops
 253 };
 254
 255
 256
 257
 258
 259 #ifdef RIO_PARANOIA_CHECK
 260
 261 /* This doesn't work. Who's paranoid around here? Not me! */
 262
 263 static inline int rio_paranoia_check(struct rio_port const *port, char *name, const char *routine)
 264 {
 265
 266         static const char *badmagic = KERN_ERR "rio: Warning: bad rio port magic number for device %s in %s\n";
 267         static const char *badinfo = KERN_ERR "rio: Warning: null rio port for device %s in %s\n";
 268
 269         if (!port) {
 270                 printk(badinfo, name, routine);
 271                 return 1;
 272         }
 273         if (port->magic != RIO_MAGIC) {
 274                 printk(badmagic, name, routine);
 275                 return 1;
 276         }
 277
 278         return 0;
 279 }
 280 #else
 281 #define rio_paranoia_check(a,b,c) 0
 282 #endif
 283
 284
 285 #ifdef DEBUG
 286 static void my_hd(void *ad, int len)
 287 {
 288         int i, j, ch;
 289         unsigned char *addr = ad;
 290
 291         for (i = 0; i < len; i += 16) {
 292                 rio_dprintk(RIO_DEBUG_PARAM, "%08lx ", (unsigned long) addr + i);
 293                 for (j = 0; j < 16; j++) {
 294                         rio_dprintk(RIO_DEBUG_PARAM, "%02x %s", addr[j + i], (j == 7) ? " " : "");
 295                 }
 296                 for (j = 0; j < 16; j++) {
 297                         ch = addr[j + i];
 298                         rio_dprintk(RIO_DEBUG_PARAM, "%c", (ch < 0x20) ? '.' : ((ch > 0x7f) ? '.' : ch));
 299                 }
 300                 rio_dprintk(RIO_DEBUG_PARAM, "\n");
 301         }
 302 }
 303 #else
 304 #define my_hd(ad,len) do{/* nothing*/ } while (0)
 305 #endif
 306
 307
 308 /* Delay a number of jiffies, allowing a signal to interrupt */
 309 int RIODelay(struct Port *PortP, int njiffies)
 310 {
 311         func_enter();
 312
 313         rio_dprintk(RIO_DEBUG_DELAY, "delaying %d jiffies\n", njiffies);
 314         msleep_interruptible(jiffies_to_msecs(njiffies));
 315         func_exit();
 316
 317         if (signal_pending(current))
 318                 return RIO_FAIL;
 319         else
 320                 return !RIO_FAIL;
 321 }
 322
 323
 324 /* Delay a number of jiffies, disallowing a signal to interrupt */
 325 int RIODelay_ni(struct Port *PortP, int njiffies)
 326 {
 327         func_enter();
 328
 329         rio_dprintk(RIO_DEBUG_DELAY, "delaying %d jiffies (ni)\n", njiffies);
 330         msleep(jiffies_to_msecs(njiffies));
 331         func_exit();
 332         return !RIO_FAIL;
 333 }
 334
 335 void rio_copy_to_card(void *from, void __iomem *to, int len)
 336 {
 337         rio_copy_toio(to, from, len);
 338 }
 339
 340 int rio_minor(struct tty_struct *tty)
 341 {
 342         return tty->index + (tty->driver == rio_driver) ? 0 : 256;
 343 }
 344
 345 static int rio_set_real_termios(void *ptr)
 346 {
 347         return RIOParam((struct Port *) ptr, CONFIG, 1, 1);
 348 }
 349
 350
 351 static void rio_reset_interrupt(struct Host *HostP)
 352 {
 353         func_enter();
 354
 355         switch (HostP->Type) {
 356         case RIO_AT:
 357         case RIO_MCA:
 358         case RIO_PCI:
 359                 writeb(0xFF, &HostP->ResetInt);
 360         }
 361
 362         func_exit();
 363 }
 364
 365
 366 static irqreturn_t rio_interrupt(int irq, void *ptr)
 367 {
 368         struct Host *HostP;
 369         func_enter();
 370
 371         HostP = ptr;                    /* &p->RIOHosts[(long)ptr]; */
 372         rio_dprintk(RIO_DEBUG_IFLOW, "rio: enter rio_interrupt (%d/%d)\n", irq, HostP->Ivec);
 373
 374         /* AAargh! The order in which to do these things is essential and
 375            not trivial.
 376
 377            - hardware twiddling goes before "recursive". Otherwise when we
 378            poll the card, and a recursive interrupt happens, we won't
 379            ack the card, so it might keep on interrupting us. (especially
 380            level sensitive interrupt systems like PCI).
 381
 382            - Rate limit goes before hardware twiddling. Otherwise we won't
 383            catch a card that has gone bonkers.
 384
 385            - The "initialized" test goes after the hardware twiddling. Otherwise
 386            the card will stick us in the interrupt routine again.
 387
 388            - The initialized test goes before recursive.
 389          */
 390
 391         rio_dprintk(RIO_DEBUG_IFLOW, "rio: We've have noticed the interrupt\n");
 392         if (HostP->Ivec == irq) {
 393                 /* Tell the card we've noticed the interrupt. */
 394                 rio_reset_interrupt(HostP);
 395         }
 396
 397         if ((HostP->Flags & RUN_STATE) != RC_RUNNING)
 398                 return IRQ_HANDLED;
 399
 400         if (test_and_set_bit(RIO_BOARD_INTR_LOCK, &HostP->locks)) {
 401                 printk(KERN_ERR "Recursive interrupt! (host %p/irq%d)\n", ptr, HostP->Ivec);
 402                 return IRQ_HANDLED;
 403         }
 404
 405         RIOServiceHost(p, HostP);
 406
 407         rio_dprintk(RIO_DEBUG_IFLOW, "riointr() doing host %p type %d\n", ptr, HostP->Type);
 408
 409         clear_bit(RIO_BOARD_INTR_LOCK, &HostP->locks);
 410         rio_dprintk(RIO_DEBUG_IFLOW, "rio: exit rio_interrupt (%d/%d)\n", irq, HostP->Ivec);
 411         func_exit();
 412         return IRQ_HANDLED;
 413 }
 414
 415
 416 static void rio_pollfunc(unsigned long data)
 417 {
 418         func_enter();
 419
 420         rio_interrupt(0, &p->RIOHosts[data]);
 421         p->RIOHosts[data].timer.expires = jiffies + rio_poll;
 422         add_timer(&p->RIOHosts[data].timer);
 423
 424         func_exit();
 425 }
 426
 427
 428 /* ********************************************************************** *
 429  *                Here are the routines that actually                     *
 430  *              interface with the generic_serial driver                  *
 431  * ********************************************************************** */
 432
 433 /* Ehhm. I don't know how to fiddle with interrupts on the Specialix
 434    cards. ....   Hmm. Ok I figured it out. You don't.  -- REW */
 435
 436 static void rio_disable_tx_interrupts(void *ptr)
 437 {
 438         func_enter();
 439
 440         /*  port->gs.flags &= ~GS_TX_INTEN; */
 441
 442         func_exit();
 443 }
 444
 445
 446 static void rio_enable_tx_interrupts(void *ptr)
 447 {
 448         struct Port *PortP = ptr;
 449         /* int hn; */
 450
 451         func_enter();
 452
 453         /* hn = PortP->HostP - p->RIOHosts;
 454
 455            rio_dprintk (RIO_DEBUG_TTY, "Pushing host %d\n", hn);
 456            rio_interrupt (-1,(void *) hn, NULL); */
 457
 458         RIOTxEnable((char *) PortP);
 459
 460         /*
 461          * In general we cannot count on "tx empty" interrupts, although
 462          * the interrupt routine seems to be able to tell the difference.
 463          */
 464         PortP->gs.flags &= ~GS_TX_INTEN;
 465
 466         func_exit();
 467 }
 468
 469
 470 static void rio_disable_rx_interrupts(void *ptr)
 471 {
 472         func_enter();
 473         func_exit();
 474 }
 475
 476 static void rio_enable_rx_interrupts(void *ptr)
 477 {
 478         /*  struct rio_port *port = ptr; */
 479         func_enter();
 480         func_exit();
 481 }
 482
 483
 484 /* Jeez. Isn't this simple?  */
 485 static int rio_get_CD(void *ptr)
 486 {
 487         struct Port *PortP = ptr;
 488         int rv;
 489
 490         func_enter();
 491         rv = (PortP->ModemState & MSVR1_CD) != 0;
 492
 493         rio_dprintk(RIO_DEBUG_INIT, "Getting CD status: %d\n", rv);
 494
 495         func_exit();
 496         return rv;
 497 }
 498
 499
 500 /* Jeez. Isn't this simple? Actually, we can sync with the actual port
 501    by just pushing stuff into the queue going to the port... */
 502 static int rio_chars_in_buffer(void *ptr)
 503 {
 504         func_enter();
 505
 506         func_exit();
 507         return 0;
 508 }
 509
 510
 511 /* Nothing special here... */
 512 static void rio_shutdown_port(void *ptr)
 513 {
 514         struct Port *PortP;
 515
 516         func_enter();
 517
 518         PortP = (struct Port *) ptr;
 519         PortP->gs.tty = NULL;
 520         func_exit();
 521 }
 522
 523
 524 /* I haven't the foggiest why the decrement use count has to happen
 525    here. The whole linux serial drivers stuff needs to be redesigned.
 526    My guess is that this is a hack to minimize the impact of a bug
 527    elsewhere. Thinking about it some more. (try it sometime) Try
 528    running minicom on a serial port that is driven by a modularized
 529    driver. Have the modem hangup. Then remove the driver module. Then
 530    exit minicom.  I expect an "oops".  -- REW */
 531 static void rio_hungup(void *ptr)
 532 {
 533         struct Port *PortP;
 534
 535         func_enter();
 536
 537         PortP = (struct Port *) ptr;
 538         PortP->gs.tty = NULL;
 539
 540         func_exit();
 541 }
 542
 543
 544 /* The standard serial_close would become shorter if you'd wrap it like
 545    this.
 546    rs_close (...){save_flags;cli;real_close();dec_use_count;restore_flags;}
 547  */
 548 static void rio_close(void *ptr)
 549 {
 550         struct Port *PortP;
 551
 552         func_enter();
 553
 554         PortP = (struct Port *) ptr;
 555
 556         riotclose(ptr);
 557
 558         if (PortP->gs.count) {
 559                 printk(KERN_ERR "WARNING port count:%d\n", PortP->gs.count);
 560                 PortP->gs.count = 0;
 561         }
 562
 563         PortP->gs.tty = NULL;
 564         func_exit();
 565 }
 566
 567
 568
 569 static int rio_fw_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg)
 570 {
 571         int rc = 0;
 572         func_enter();
 573
 574         /* The "dev" argument isn't used. */
 575         rc = riocontrol(p, 0, cmd, arg, capable(CAP_SYS_ADMIN));
 576
 577         func_exit();
 578         return rc;
 579 }
 580
 581 extern int RIOShortCommand(struct rio_info *p, struct Port *PortP, int command, int len, int arg);
 582
 583 static int rio_ioctl(struct tty_struct *tty, struct file *filp, unsigned int cmd, unsigned long arg)
 584 {
 585         void __user *argp = (void __user *)arg;
 586         int rc;
 587         struct Port *PortP;
 588         int ival;
 589
 590         func_enter();
 591
 592         PortP = (struct Port *) tty->driver_data;
 593
 594         rc = 0;
 595         switch (cmd) {
 596         case TIOCSSOFTCAR:
 597                 if ((rc = get_user(ival, (unsigned __user *) argp)) == 0) {
 598                         tty->termios->c_cflag = (tty->termios->c_cflag & ~CLOCAL) | (ival ? CLOCAL : 0);
 599                 }
 600                 break;
 601         case TIOCGSERIAL:
 602                 rc = -EFAULT;
 603                 if (access_ok(VERIFY_WRITE, argp, sizeof(struct serial_struct)))
 604                         rc = gs_getserial(&PortP->gs, argp);
 605                 break;
 606         case TCSBRK:
 607                 if (PortP->State & RIO_DELETED) {
 608                         rio_dprintk(RIO_DEBUG_TTY, "BREAK on deleted RTA\n");
 609                         rc = -EIO;
 610                 } else {
 611                         if (RIOShortCommand(p, PortP, SBREAK, 2, 250) == RIO_FAIL) {
 612                                 rio_dprintk(RIO_DEBUG_INTR, "SBREAK RIOShortCommand failed\n");
 613                                 rc = -EIO;
 614                         }
 615                 }
 616                 break;
 617         case TCSBRKP:
 618                 if (PortP->State & RIO_DELETED) {
 619                         rio_dprintk(RIO_DEBUG_TTY, "BREAK on deleted RTA\n");
 620                         rc = -EIO;
 621                 } else {
 622                         int l;
 623                         l = arg ? arg * 100 : 250;
 624                         if (l > 255)
 625                                 l = 255;
 626                         if (RIOShortCommand(p, PortP, SBREAK, 2, arg ? arg * 100 : 250) == RIO_FAIL) {
 627                                 rio_dprintk(RIO_DEBUG_INTR, "SBREAK RIOShortCommand failed\n");
 628                                 rc = -EIO;
 629                         }
 630                 }
 631                 break;
 632         case TIOCSSERIAL:
 633                 rc = -EFAULT;
 634                 if (access_ok(VERIFY_READ, argp, sizeof(struct serial_struct)))
 635                         rc = gs_setserial(&PortP->gs, argp);
 636                 break;
 637         default:
 638                 rc = -ENOIOCTLCMD;
 639                 break;
 640         }
 641         func_exit();
 642         return rc;
 643 }
 644
 645
 646 /* The throttle/unthrottle scheme for the Specialix card is different
 647  * from other drivers and deserves some explanation.
 648  * The Specialix hardware takes care of XON/XOFF
 649  * and CTS/RTS flow control itself.  This means that all we have to
 650  * do when signalled by the upper tty layer to throttle/unthrottle is
 651  * to make a note of it here.  When we come to read characters from the
 652  * rx buffers on the card (rio_receive_chars()) we look to see if the
 653  * upper layer can accept more (as noted here in rio_rx_throt[]).
 654  * If it can't we simply don't remove chars from the cards buffer.
 655  * When the tty layer can accept chars, we again note that here and when
 656  * rio_receive_chars() is called it will remove them from the cards buffer.
 657  * The card will notice that a ports buffer has drained below some low
 658  * water mark and will unflow control the line itself, using whatever
 659  * flow control scheme is in use for that port. -- Simon Allen
 660  */
 661
 662 static void rio_throttle(struct tty_struct *tty)
 663 {
 664         struct Port *port = (struct Port *) tty->driver_data;
 665
 666         func_enter();
 667         /* If the port is using any type of input flow
 668          * control then throttle the port.
 669          */
 670
 671         if ((tty->termios->c_cflag & CRTSCTS) || (I_IXOFF(tty))) {
 672                 port->State |= RIO_THROTTLE_RX;
 673         }
 674
 675         func_exit();
 676 }
 677
 678
 679 static void rio_unthrottle(struct tty_struct *tty)
 680 {
 681         struct Port *port = (struct Port *) tty->driver_data;
 682
 683         func_enter();
 684         /* Always unthrottle even if flow control is not enabled on
 685          * this port in case we disabled flow control while the port
 686          * was throttled
 687          */
 688
 689         port->State &= ~RIO_THROTTLE_RX;
 690
 691         func_exit();
 692         return;
 693 }
 694
 695
 696
 697
 698
 699 /* ********************************************************************** *
 700  *                    Here are the initialization routines.               *
 701  * ********************************************************************** */
 702
 703
 704 static struct vpd_prom *get_VPD_PROM(struct Host *hp)
 705 {
 706         static struct vpd_prom vpdp;
 707         char *p;
 708         int i;
 709
 710         func_enter();
 711         rio_dprintk(RIO_DEBUG_PROBE, "Going to verify vpd prom at %p.\n", hp->Caddr + RIO_VPD_ROM);
 712
 713         p = (char *) &vpdp;
 714         for (i = 0; i < sizeof(struct vpd_prom); i++)
 715                 *p++ = readb(hp->Caddr + RIO_VPD_ROM + i * 2);
 716         /* read_rio_byte (hp, RIO_VPD_ROM + i*2); */
 717
 718         /* Terminate the identifier string.
 719          *** requires one extra byte in struct vpd_prom *** */
 720         *p++ = 0;
 721
 722         if (rio_debug & RIO_DEBUG_PROBE)
 723                 my_hd((char *) &vpdp, 0x20);
 724
 725         func_exit();
 726
 727         return &vpdp;
 728 }
 729
 730 static const struct tty_operations rio_ops = {
 731         .open = riotopen,
 732         .close = gs_close,
 733         .write = gs_write,
 734         .put_char = gs_put_char,
 735         .flush_chars = gs_flush_chars,
 736         .write_room = gs_write_room,
 737         .chars_in_buffer = gs_chars_in_buffer,
 738         .flush_buffer = gs_flush_buffer,
 739         .ioctl = rio_ioctl,
 740         .throttle = rio_throttle,
 741         .unthrottle = rio_unthrottle,
 742         .set_termios = gs_set_termios,
 743         .stop = gs_stop,
 744         .start = gs_start,
 745         .hangup = gs_hangup,
 746 };
 747
 748 static int rio_init_drivers(void)
 749 {
 750         int error = -ENOMEM;
 751
 752         rio_driver = alloc_tty_driver(256);
 753         if (!rio_driver)
 754                 goto out;
 755         rio_driver2 = alloc_tty_driver(256);
 756         if (!rio_driver2)
 757                 goto out1;
 758
 759         func_enter();
 760
 761         rio_driver->owner = THIS_MODULE;
 762         rio_driver->driver_name = "specialix_rio";
 763         rio_driver->name = "ttySR";
 764         rio_driver->major = RIO_NORMAL_MAJOR0;
 765         rio_driver->type = TTY_DRIVER_TYPE_SERIAL;
 766         rio_driver->subtype = SERIAL_TYPE_NORMAL;
 767         rio_driver->init_termios = tty_std_termios;
 768         rio_driver->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
 769         rio_driver->flags = TTY_DRIVER_REAL_RAW;
 770         tty_set_operations(rio_driver, &rio_ops);
 771
 772         rio_driver2->owner = THIS_MODULE;
 773         rio_driver2->driver_name = "specialix_rio";
 774         rio_driver2->name = "ttySR";
 775         rio_driver2->major = RIO_NORMAL_MAJOR1;
 776         rio_driver2->type = TTY_DRIVER_TYPE_SERIAL;
 777         rio_driver2->subtype = SERIAL_TYPE_NORMAL;
 778         rio_driver2->init_termios = tty_std_termios;
 779         rio_driver2->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
 780         rio_driver2->flags = TTY_DRIVER_REAL_RAW;
 781         tty_set_operations(rio_driver2, &rio_ops);
 782
 783         rio_dprintk(RIO_DEBUG_INIT, "set_termios = %p\n", gs_set_termios);
 784
 785         if ((error = tty_register_driver(rio_driver)))
 786                 goto out2;
 787         if ((error = tty_register_driver(rio_driver2)))
 788                 goto out3;
 789         func_exit();
 790         return 0;
 791       out3:
 792         tty_unregister_driver(rio_driver);
 793       out2:
 794         put_tty_driver(rio_driver2);
 795       out1:
 796         put_tty_driver(rio_driver);
 797       out:
 798         printk(KERN_ERR "rio: Couldn't register a rio driver, error = %d\n", error);
 799         return 1;
 800 }
 801
 802
 803 static void *ckmalloc(int size)
 804 {
 805         void *p;
 806
 807         p = kmalloc(size, GFP_KERNEL);
 808         if (p)
 809                 memset(p, 0, size);
 810         return p;
 811 }
 812
 813
 814
 815 static int rio_init_datastructures(void)
 816 {
 817         int i;
 818         struct Port *port;
 819         func_enter();
 820
 821         /* Many drivers statically allocate the maximum number of ports
 822            There is no reason not to allocate them dynamically. Is there? -- REW */
 823         /* However, the RIO driver allows users to configure their first
 824            RTA as the ports numbered 504-511. We therefore need to allocate
 825            the whole range. :-(   -- REW */
 826
 827 #define RI_SZ   sizeof(struct rio_info)
 828 #define HOST_SZ sizeof(struct Host)
 829 #define PORT_SZ sizeof(struct Port *)
 830 #define TMIO_SZ sizeof(struct termios *)
 831         rio_dprintk(RIO_DEBUG_INIT, "getting : %Zd %Zd %Zd %Zd %Zd bytes\n", RI_SZ, RIO_HOSTS * HOST_SZ, RIO_PORTS * PORT_SZ, RIO_PORTS * TMIO_SZ, RIO_PORTS * TMIO_SZ);
 832
 833         if (!(p = ckmalloc(RI_SZ)))
 834                 goto free0;
 835         if (!(p->RIOHosts = ckmalloc(RIO_HOSTS * HOST_SZ)))
 836                 goto free1;
 837         if (!(p->RIOPortp = ckmalloc(RIO_PORTS * PORT_SZ)))
 838                 goto free2;
 839         p->RIOConf = RIOConf;
 840         rio_dprintk(RIO_DEBUG_INIT, "Got : %p %p %p\n", p, p->RIOHosts, p->RIOPortp);
 841
 842 #if 1
 843         for (i = 0; i < RIO_PORTS; i++) {
 844                 port = p->RIOPortp[i] = ckmalloc(sizeof(struct Port));
 845                 if (!port) {
 846                         goto free6;
 847                 }
 848                 rio_dprintk(RIO_DEBUG_INIT, "initing port %d (%d)\n", i, port->Mapped);
 849                 port->PortNum = i;
 850                 port->gs.magic = RIO_MAGIC;
 851                 port->gs.close_delay = HZ / 2;
 852                 port->gs.closing_wait = 30 * HZ;
 853                 port->gs.rd = &rio_real_driver;
 854                 spin_lock_init(&port->portSem);
 855                 /*
 856                  * Initializing wait queue
 857                  */
 858                 init_waitqueue_head(&port->gs.open_wait);
 859                 init_waitqueue_head(&port->gs.close_wait);
 860         }
 861 #else
 862         /* We could postpone initializing them to when they are configured. */
 863 #endif
 864
 865
 866
 867         if (rio_debug & RIO_DEBUG_INIT) {
 868                 my_hd(&rio_real_driver, sizeof(rio_real_driver));
 869         }
 870
 871
 872         func_exit();
 873         return 0;
 874
 875       free6:for (i--; i >= 0; i--)
 876                 kfree(p->RIOPortp[i]);
 877 /*free5:
 878  free4:
 879  free3:*/ kfree(p->RIOPortp);
 880       free2:kfree(p->RIOHosts);
 881       free1:
 882         rio_dprintk(RIO_DEBUG_INIT, "Not enough memory! %p %p %p\n", p, p->RIOHosts, p->RIOPortp);
 883         kfree(p);
 884       free0:
 885         return -ENOMEM;
 886 }
 887
 888 static void __exit rio_release_drivers(void)
 889 {
 890         func_enter();
 891         tty_unregister_driver(rio_driver2);
 892         tty_unregister_driver(rio_driver);
 893         put_tty_driver(rio_driver2);
 894         put_tty_driver(rio_driver);
 895         func_exit();
 896 }
 897
 898
 899 #ifdef CONFIG_PCI
 900  /* This was written for SX, but applies to RIO too...
 901     (including bugs....)
 902
 903     There is another bit besides Bit 17. Turning that bit off
 904     (on boards shipped with the fix in the eeprom) results in a
 905     hang on the next access to the card.
 906   */
 907
 908  /********************************************************
 909  * Setting bit 17 in the CNTRL register of the PLX 9050  *
 910  * chip forces a retry on writes while a read is pending.*
 911  * This is to prevent the card locking up on Intel Xeon  *
 912  * multiprocessor systems with the NX chipset.    -- NV  *
 913  ********************************************************/
 914
 915 /* Newer cards are produced with this bit set from the configuration
 916    EEprom.  As the bit is read/write for the CPU, we can fix it here,
 917    if we detect that it isn't set correctly. -- REW */
 918
 919 static void fix_rio_pci(struct pci_dev *pdev)
 920 {
 921         unsigned long hwbase;
 922         unsigned char __iomem *rebase;
 923         unsigned int t;
 924
 925 #define CNTRL_REG_OFFSET        0x50
 926 #define CNTRL_REG_GOODVALUE     0x18260000
 927
 928         hwbase = pci_resource_start(pdev, 0);
 929         rebase = ioremap(hwbase, 0x80);
 930         t = readl(rebase + CNTRL_REG_OFFSET);
 931         if (t != CNTRL_REG_GOODVALUE) {
 932                 printk(KERN_DEBUG "rio: performing cntrl reg fix: %08x -> %08x\n", t, CNTRL_REG_GOODVALUE);
 933                 writel(CNTRL_REG_GOODVALUE, rebase + CNTRL_REG_OFFSET);
 934         }
 935         iounmap(rebase);
 936 }
 937 #endif
 938
 939
 940 static int __init rio_init(void)
 941 {
 942         int found = 0;
 943         int i;
 944         struct Host *hp;
 945         int retval;
 946         struct vpd_prom *vpdp;
 947         int okboard;
 948
 949 #ifdef CONFIG_PCI
 950         struct pci_dev *pdev = NULL;
 951         unsigned short tshort;
 952 #endif
 953
 954         func_enter();
 955         rio_dprintk(RIO_DEBUG_INIT, "Initing rio module... (rio_debug=%d)\n", rio_debug);
 956
 957         if (abs((long) (&rio_debug) - rio_debug) < 0x10000) {
 958                 printk(KERN_WARNING "rio: rio_debug is an address, instead of a value. " "Assuming -1. Was %x/%p.\n", rio_debug, &rio_debug);
 959                 rio_debug = -1;
 960         }
 961
 962         if (misc_register(&rio_fw_device) < 0) {
 963                 printk(KERN_ERR "RIO: Unable to register firmware loader driver.\n");
 964                 return -EIO;
 965         }
 966
 967         retval = rio_init_datastructures();
 968         if (retval < 0) {
 969                 misc_deregister(&rio_fw_device);
 970                 return retval;
 971         }
 972 #ifdef CONFIG_PCI
 973         /* First look for the JET devices: */
 974         while ((pdev = pci_get_device(PCI_VENDOR_ID_SPECIALIX, PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8, pdev))) {
 975                 u32 tint;
 976
 977                 if (pci_enable_device(pdev))
 978                         continue;
 979
 980                 /* Specialix has a whole bunch of cards with
 981                    0x2000 as the device ID. They say its because
 982                    the standard requires it. Stupid standard. */
 983                 /* It seems that reading a word doesn't work reliably on 2.0.
 984                    Also, reading a non-aligned dword doesn't work. So we read the
 985                    whole dword at 0x2c and extract the word at 0x2e (SUBSYSTEM_ID)
 986                    ourselves */
 987                 pci_read_config_dword(pdev, 0x2c, &tint);
 988                 tshort = (tint >> 16) & 0xffff;
 989                 rio_dprintk(RIO_DEBUG_PROBE, "Got a specialix card: %x.\n", tint);
 990                 if (tshort != 0x0100) {
 991                         rio_dprintk(RIO_DEBUG_PROBE, "But it's not a RIO card (%d)...\n", tshort);
 992                         continue;
 993                 }
 994                 rio_dprintk(RIO_DEBUG_PROBE, "cp1\n");
 995
 996                 hp = &p->RIOHosts[p->RIONumHosts];
 997                 hp->PaddrP = pci_resource_start(pdev, 2);
 998                 hp->Ivec = pdev->irq;
 999                 if (((1 << hp->Ivec) & rio_irqmask) == 0)
1000                         hp->Ivec = 0;
1001                 hp->Caddr = ioremap(p->RIOHosts[p->RIONumHosts].PaddrP, RIO_WINDOW_LEN);
1002                 hp->CardP = (struct DpRam __iomem *) hp->Caddr;
1003                 hp->Type = RIO_PCI;
1004                 hp->Copy = rio_copy_to_card;
1005                 hp->Mode = RIO_PCI_BOOT_FROM_RAM;
1006                 spin_lock_init(&hp->HostLock);
1007                 rio_reset_interrupt(hp);
1008                 rio_start_card_running(hp);
1009
1010                 rio_dprintk(RIO_DEBUG_PROBE, "Going to test it (%p/%p).\n", (void *) p->RIOHosts[p->RIONumHosts].PaddrP, p->RIOHosts[p->RIONumHosts].Caddr);
1011                 if (RIOBoardTest(p->RIOHosts[p->RIONumHosts].PaddrP, p->RIOHosts[p->RIONumHosts].Caddr, RIO_PCI, 0) == 0) {
1012                         rio_dprintk(RIO_DEBUG_INIT, "Done RIOBoardTest\n");
1013                         writeb(0xFF, &p->RIOHosts[p->RIONumHosts].ResetInt);
1014                         p->RIOHosts[p->RIONumHosts].UniqueNum =
1015                             ((readb(&p->RIOHosts[p->RIONumHosts].Unique[0]) & 0xFF) << 0) |
1016                             ((readb(&p->RIOHosts[p->RIONumHosts].Unique[1]) & 0xFF) << 8) | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[2]) & 0xFF) << 16) | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[3]) & 0xFF) << 24);
1017                         rio_dprintk(RIO_DEBUG_PROBE, "Hmm Tested ok, uniqid = %x.\n", p->RIOHosts[p->RIONumHosts].UniqueNum);
1018
1019                         fix_rio_pci(pdev);
1020
1021                         p->RIOHosts[p->RIONumHosts].pdev = pdev;
1022                         pci_dev_get(pdev);
1023
1024                         p->RIOLastPCISearch = 0;
1025                         p->RIONumHosts++;
1026                         found++;
1027                 } else {
1028                         iounmap(p->RIOHosts[p->RIONumHosts].Caddr);
1029                         p->RIOHosts[p->RIONumHosts].Caddr = NULL;
1030                 }
1031         }
1032
1033         /* Then look for the older PCI card.... : */
1034
1035         /* These older PCI cards have problems (only byte-mode access is
1036            supported), which makes them a bit awkward to support.
1037            They also have problems sharing interrupts. Be careful.
1038            (The driver now refuses to share interrupts for these
1039            cards. This should be sufficient).
1040          */
1041
1042         /* Then look for the older RIO/PCI devices: */
1043         while ((pdev = pci_get_device(PCI_VENDOR_ID_SPECIALIX, PCI_DEVICE_ID_SPECIALIX_RIO, pdev))) {
1044                 if (pci_enable_device(pdev))
1045                         continue;
1046
1047 #ifdef CONFIG_RIO_OLDPCI
1048                 hp = &p->RIOHosts[p->RIONumHosts];
1049                 hp->PaddrP = pci_resource_start(pdev, 0);
1050                 hp->Ivec = pdev->irq;
1051                 if (((1 << hp->Ivec) & rio_irqmask) == 0)
1052                         hp->Ivec = 0;
1053                 hp->Ivec |= 0x8000;     /* Mark as non-sharable */
1054                 hp->Caddr = ioremap(p->RIOHosts[p->RIONumHosts].PaddrP, RIO_WINDOW_LEN);
1055                 hp->CardP = (struct DpRam __iomem *) hp->Caddr;
1056                 hp->Type = RIO_PCI;
1057                 hp->Copy = rio_copy_to_card;
1058                 hp->Mode = RIO_PCI_BOOT_FROM_RAM;
1059                 spin_lock_init(&hp->HostLock);
1060
1061                 rio_dprintk(RIO_DEBUG_PROBE, "Ivec: %x\n", hp->Ivec);
1062                 rio_dprintk(RIO_DEBUG_PROBE, "Mode: %x\n", hp->Mode);
1063
1064                 rio_reset_interrupt(hp);
1065                 rio_start_card_running(hp);
1066                 rio_dprintk(RIO_DEBUG_PROBE, "Going to test it (%p/%p).\n", (void *) p->RIOHosts[p->RIONumHosts].PaddrP, p->RIOHosts[p->RIONumHosts].Caddr);
1067                 if (RIOBoardTest(p->RIOHosts[p->RIONumHosts].PaddrP, p->RIOHosts[p->RIONumHosts].Caddr, RIO_PCI, 0) == 0) {
1068                         writeb(0xFF, &p->RIOHosts[p->RIONumHosts].ResetInt);
1069                         p->RIOHosts[p->RIONumHosts].UniqueNum =
1070                             ((readb(&p->RIOHosts[p->RIONumHosts].Unique[0]) & 0xFF) << 0) |
1071                             ((readb(&p->RIOHosts[p->RIONumHosts].Unique[1]) & 0xFF) << 8) | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[2]) & 0xFF) << 16) | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[3]) & 0xFF) << 24);
1072                         rio_dprintk(RIO_DEBUG_PROBE, "Hmm Tested ok, uniqid = %x.\n", p->RIOHosts[p->RIONumHosts].UniqueNum);
1073
1074                         p->RIOHosts[p->RIONumHosts].pdev = pdev;
1075                         pci_dev_get(pdev);
1076
1077                         p->RIOLastPCISearch = 0;
1078                         p->RIONumHosts++;
1079                         found++;
1080                 } else {
1081                         iounmap(p->RIOHosts[p->RIONumHosts].Caddr);
1082                         p->RIOHosts[p->RIONumHosts].Caddr = NULL;
1083                 }
1084 #else
1085                 printk(KERN_ERR "Found an older RIO PCI card, but the driver is not " "compiled to support it.\n");
1086 #endif
1087         }
1088 #endif                          /* PCI */
1089
1090         /* Now probe for ISA cards... */
1091         for (i = 0; i < NR_RIO_ADDRS; i++) {
1092                 hp = &p->RIOHosts[p->RIONumHosts];
1093                 hp->PaddrP = rio_probe_addrs[i];
1094                 /* There was something about the IRQs of these cards. 'Forget what.--REW */
1095                 hp->Ivec = 0;
1096                 hp->Caddr = ioremap(p->RIOHosts[p->RIONumHosts].PaddrP, RIO_WINDOW_LEN);
1097                 hp->CardP = (struct DpRam __iomem *) hp->Caddr;
1098                 hp->Type = RIO_AT;
1099                 hp->Copy = rio_copy_to_card;    /* AT card PCI???? - PVDL
1100                                          * -- YES! this is now a normal copy. Only the
1101                                          * old PCI card uses the special PCI copy.
1102                                          * Moreover, the ISA card will work with the
1103                                          * special PCI copy anyway. -- REW */
1104                 hp->Mode = 0;
1105                 spin_lock_init(&hp->HostLock);
1106
1107                 vpdp = get_VPD_PROM(hp);
1108                 rio_dprintk(RIO_DEBUG_PROBE, "Got VPD ROM\n");
1109                 okboard = 0;
1110                 if ((strncmp(vpdp->identifier, RIO_ISA_IDENT, 16) == 0) || (strncmp(vpdp->identifier, RIO_ISA2_IDENT, 16) == 0) || (strncmp(vpdp->identifier, RIO_ISA3_IDENT, 16) == 0)) {
1111                         /* Board is present... */
1112                         if (RIOBoardTest(hp->PaddrP, hp->Caddr, RIO_AT, 0) == 0) {
1113                                 /* ... and feeling fine!!!! */
1114                                 rio_dprintk(RIO_DEBUG_PROBE, "Hmm Tested ok, uniqid = %x.\n", p->RIOHosts[p->RIONumHosts].UniqueNum);
1115                                 if (RIOAssignAT(p, hp->PaddrP, hp->Caddr, 0)) {
1116                                         rio_dprintk(RIO_DEBUG_PROBE, "Hmm Tested ok, host%d uniqid = %x.\n", p->RIONumHosts, p->RIOHosts[p->RIONumHosts - 1].UniqueNum);
1117                                         okboard++;
1118                                         found++;
1119                                 }
1120                         }
1121
1122                         if (!okboard) {
1123                                 iounmap(hp->Caddr);
1124                                 hp->Caddr = NULL;
1125                         }
1126                 }
1127         }
1128
1129
1130         for (i = 0; i < p->RIONumHosts; i++) {
1131                 hp = &p->RIOHosts[i];
1132                 if (hp->Ivec) {
1133                         int mode = IRQF_SHARED;
1134                         if (hp->Ivec & 0x8000) {
1135                                 mode = 0;
1136                                 hp->Ivec &= 0x7fff;
1137                         }
1138                         rio_dprintk(RIO_DEBUG_INIT, "Requesting interrupt hp: %p rio_interrupt: %d Mode: %x\n", hp, hp->Ivec, hp->Mode);
1139                         retval = request_irq(hp->Ivec, rio_interrupt, mode, "rio", hp);
1140                         rio_dprintk(RIO_DEBUG_INIT, "Return value from request_irq: %d\n", retval);
1141                         if (retval) {
1142                                 printk(KERN_ERR "rio: Cannot allocate irq %d.\n", hp->Ivec);
1143                                 hp->Ivec = 0;
1144                         }
1145                         rio_dprintk(RIO_DEBUG_INIT, "Got irq %d.\n", hp->Ivec);
1146                         if (hp->Ivec != 0) {
1147                                 rio_dprintk(RIO_DEBUG_INIT, "Enabling interrupts on rio card.\n");
1148                                 hp->Mode |= RIO_PCI_INT_ENABLE;
1149                         } else
1150                                 hp->Mode &= !RIO_PCI_INT_ENABLE;
1151                         rio_dprintk(RIO_DEBUG_INIT, "New Mode: %x\n", hp->Mode);
1152                         rio_start_card_running(hp);
1153                 }
1154                 /* Init the timer "always" to make sure that it can safely be
1155                    deleted when we unload... */
1156
1157                 init_timer(&hp->timer);
1158                 if (!hp->Ivec) {
1159                         rio_dprintk(RIO_DEBUG_INIT, "Starting polling at %dj intervals.\n", rio_poll);
1160                         hp->timer.data = i;
1161                         hp->timer.function = rio_pollfunc;
1162                         hp->timer.expires = jiffies + rio_poll;
1163                         add_timer(&hp->timer);
1164                 }
1165         }
1166
1167         if (found) {
1168                 rio_dprintk(RIO_DEBUG_INIT, "rio: total of %d boards detected.\n", found);
1169                 rio_init_drivers();
1170         } else {
1171                 /* deregister the misc device we created earlier */
1172                 misc_deregister(&rio_fw_device);
1173         }
1174
1175         func_exit();
1176         return found ? 0 : -EIO;
1177 }
1178
1179
1180 static void __exit rio_exit(void)
1181 {
1182         int i;
1183         struct Host *hp;
1184
1185         func_enter();
1186
1187         for (i = 0, hp = p->RIOHosts; i < p->RIONumHosts; i++, hp++) {
1188                 RIOHostReset(hp->Type, hp->CardP, hp->Slot);
1189                 if (hp->Ivec) {
1190                         free_irq(hp->Ivec, hp);
1191                         rio_dprintk(RIO_DEBUG_INIT, "freed irq %d.\n", hp->Ivec);
1192                 }
1193                 /* It is safe/allowed to del_timer a non-active timer */
1194                 del_timer(&hp->timer);
1195                 if (hp->Caddr)
1196                         iounmap(hp->Caddr);
1197                 if (hp->Type == RIO_PCI)
1198                         pci_dev_put(hp->pdev);
1199         }
1200
1201         if (misc_deregister(&rio_fw_device) < 0) {
1202                 printk(KERN_INFO "rio: couldn't deregister control-device\n");
1203         }
1204
1205
1206         rio_dprintk(RIO_DEBUG_CLEANUP, "Cleaning up drivers\n");
1207
1208         rio_release_drivers();
1209
1210         /* Release dynamically allocated memory */
1211         kfree(p->RIOPortp);
1212         kfree(p->RIOHosts);
1213         kfree(p);
1214
1215         func_exit();
1216 }
1217
1218 module_init(rio_init);
1219 module_exit(rio_exit);