linux/drivers/sn/ioc3.c
<<
>>
Prefs
   1/*
   2 * SGI IOC3 master driver and IRQ demuxer
   3 *
   4 * Copyright (c) 2005 Stanislaw Skowronek <skylark@linux-mips.org>
   5 * Heavily based on similar work by:
   6 *   Brent Casavant <bcasavan@sgi.com> - IOC4 master driver
   7 *   Pat Gefre <pfg@sgi.com> - IOC3 serial port IRQ demuxer
   8 */
   9
  10#include <linux/errno.h>
  11#include <linux/module.h>
  12#include <linux/pci.h>
  13#include <linux/dma-mapping.h>
  14#include <linux/interrupt.h>
  15#include <linux/spinlock.h>
  16#include <linux/delay.h>
  17#include <linux/ioc3.h>
  18#include <linux/rwsem.h>
  19#include <linux/slab.h>
  20
  21#define IOC3_PCI_SIZE 0x100000
  22
  23static LIST_HEAD(ioc3_devices);
  24static int ioc3_counter;
  25static DECLARE_RWSEM(ioc3_devices_rwsem);
  26
  27static struct ioc3_submodule *ioc3_submodules[IOC3_MAX_SUBMODULES];
  28static struct ioc3_submodule *ioc3_ethernet;
  29static DEFINE_RWLOCK(ioc3_submodules_lock);
  30
  31/* NIC probing code */
  32
  33#define GPCR_MLAN_EN    0x00200000      /* enable MCR to pin 8 */
  34
  35static inline unsigned mcr_pack(unsigned pulse, unsigned sample)
  36{
  37        return (pulse << 10) | (sample << 2);
  38}
  39
  40static int nic_wait(struct ioc3_driver_data *idd)
  41{
  42        unsigned mcr;
  43
  44        do {
  45                mcr = readl(&idd->vma->mcr);
  46        } while (!(mcr & 2));
  47
  48        return mcr & 1;
  49}
  50
  51static int nic_reset(struct ioc3_driver_data *idd)
  52{
  53        int presence;
  54        unsigned long flags;
  55
  56        local_irq_save(flags);
  57        writel(mcr_pack(500, 65), &idd->vma->mcr);
  58        presence = nic_wait(idd);
  59        local_irq_restore(flags);
  60
  61        udelay(500);
  62
  63        return presence;
  64}
  65
  66static int nic_read_bit(struct ioc3_driver_data *idd)
  67{
  68        int result;
  69        unsigned long flags;
  70
  71        local_irq_save(flags);
  72        writel(mcr_pack(6, 13), &idd->vma->mcr);
  73        result = nic_wait(idd);
  74        local_irq_restore(flags);
  75
  76        udelay(500);
  77
  78        return result;
  79}
  80
  81static void nic_write_bit(struct ioc3_driver_data *idd, int bit)
  82{
  83        if (bit)
  84                writel(mcr_pack(6, 110), &idd->vma->mcr);
  85        else
  86                writel(mcr_pack(80, 30), &idd->vma->mcr);
  87
  88        nic_wait(idd);
  89}
  90
  91static unsigned nic_read_byte(struct ioc3_driver_data *idd)
  92{
  93        unsigned result = 0;
  94        int i;
  95
  96        for (i = 0; i < 8; i++)
  97                result = (result >> 1) | (nic_read_bit(idd) << 7);
  98
  99        return result;
 100}
 101
 102static void nic_write_byte(struct ioc3_driver_data *idd, int byte)
 103{
 104        int i, bit;
 105
 106        for (i = 8; i; i--) {
 107                bit = byte & 1;
 108                byte >>= 1;
 109
 110                nic_write_bit(idd, bit);
 111        }
 112}
 113
 114static unsigned long
 115nic_find(struct ioc3_driver_data *idd, int *last, unsigned long addr)
 116{
 117        int a, b, index, disc;
 118
 119        nic_reset(idd);
 120
 121        /* Search ROM.  */
 122        nic_write_byte(idd, 0xF0);
 123
 124        /* Algorithm from ``Book of iButton Standards''.  */
 125        for (index = 0, disc = 0; index < 64; index++) {
 126                a = nic_read_bit(idd);
 127                b = nic_read_bit(idd);
 128
 129                if (a && b) {
 130                        printk(KERN_WARNING "IOC3 NIC search failed.\n");
 131                        *last = 0;
 132                        return 0;
 133                }
 134
 135                if (!a && !b) {
 136                        if (index == *last) {
 137                                addr |= 1UL << index;
 138                        } else if (index > *last) {
 139                                addr &= ~(1UL << index);
 140                                disc = index;
 141                        } else if ((addr & (1UL << index)) == 0)
 142                                disc = index;
 143                        nic_write_bit(idd, (addr>>index)&1);
 144                        continue;
 145                } else {
 146                        if (a)
 147                                addr |= 1UL << index;
 148                        else
 149                                addr &= ~(1UL << index);
 150                        nic_write_bit(idd, a);
 151                        continue;
 152                }
 153        }
 154        *last = disc;
 155        return addr;
 156}
 157
 158static void nic_addr(struct ioc3_driver_data *idd, unsigned long addr)
 159{
 160        int index;
 161
 162        nic_reset(idd);
 163        nic_write_byte(idd, 0xF0);
 164        for (index = 0; index < 64; index++) {
 165                nic_read_bit(idd);
 166                nic_read_bit(idd);
 167                nic_write_bit(idd, (addr>>index)&1);
 168        }
 169}
 170
 171static void crc16_byte(unsigned int *crc, unsigned char db)
 172{
 173        int i;
 174
 175        for(i=0;i<8;i++) {
 176                *crc <<= 1;
 177                if((db^(*crc>>16)) & 1)
 178                        *crc ^= 0x8005;
 179                db >>= 1;
 180        }
 181        *crc &= 0xFFFF;
 182}
 183
 184static unsigned int crc16_area(unsigned char *dbs, int size, unsigned int crc)
 185{
 186        while(size--)
 187                crc16_byte(&crc, *(dbs++));
 188        return crc;
 189}
 190
 191static void crc8_byte(unsigned int *crc, unsigned char db)
 192{
 193        int i,f;
 194
 195        for(i=0;i<8;i++) {
 196                f = (*crc ^ db) & 1;
 197                *crc >>= 1;
 198                db >>= 1;
 199                if(f)
 200                        *crc ^= 0x8c;
 201        }
 202        *crc &= 0xff;
 203}
 204
 205static unsigned int crc8_addr(unsigned long addr)
 206{
 207        int i;
 208        unsigned int crc = 0x00;
 209
 210        for(i=0;i<8;i++)
 211                crc8_byte(&crc, addr>>(i<<3));
 212        return crc;
 213}
 214
 215static void
 216read_redir_page(struct ioc3_driver_data *idd, unsigned long addr, int page,
 217                        unsigned char *redir, unsigned char *data)
 218{
 219        int loops = 16, i;
 220
 221        while(redir[page] != 0xFF) {
 222                page = redir[page]^0xFF;
 223                loops--;
 224                if(loops<0) {
 225                        printk(KERN_ERR "IOC3: NIC circular redirection\n");
 226                        return;
 227                }
 228        }
 229        loops = 3;
 230        while(loops>0) {
 231                nic_addr(idd, addr);
 232                nic_write_byte(idd, 0xF0);
 233                nic_write_byte(idd, (page << 5) & 0xE0);
 234                nic_write_byte(idd, (page >> 3) & 0x1F);
 235                for(i=0;i<0x20;i++)
 236                        data[i] = nic_read_byte(idd);
 237                if(crc16_area(data, 0x20, 0x0000) == 0x800d)
 238                        return;
 239                loops--;
 240        }
 241        printk(KERN_ERR "IOC3: CRC error in data page\n");
 242        for(i=0;i<0x20;i++)
 243                data[i] = 0x00;
 244}
 245
 246static void
 247read_redir_map(struct ioc3_driver_data *idd, unsigned long addr,
 248                                         unsigned char *redir)
 249{
 250        int i,j,loops = 3,crc_ok;
 251        unsigned int crc;
 252
 253        while(loops>0) {
 254                crc_ok = 1;
 255                nic_addr(idd, addr);
 256                nic_write_byte(idd, 0xAA);
 257                nic_write_byte(idd, 0x00);
 258                nic_write_byte(idd, 0x01);
 259                for(i=0;i<64;i+=8) {
 260                        for(j=0;j<8;j++)
 261                                redir[i+j] = nic_read_byte(idd);
 262                        crc = crc16_area(redir+i, 8, (i==0)?0x8707:0x0000);
 263                        crc16_byte(&crc, nic_read_byte(idd));
 264                        crc16_byte(&crc, nic_read_byte(idd));
 265                        if(crc != 0x800d)
 266                                crc_ok = 0;
 267                }
 268                if(crc_ok)
 269                        return;
 270                loops--;
 271        }
 272        printk(KERN_ERR "IOC3: CRC error in redirection page\n");
 273        for(i=0;i<64;i++)
 274                redir[i] = 0xFF;
 275}
 276
 277static void read_nic(struct ioc3_driver_data *idd, unsigned long addr)
 278{
 279        unsigned char redir[64];
 280        unsigned char data[64],part[32];
 281        int i,j;
 282
 283        /* read redirections */
 284        read_redir_map(idd, addr, redir);
 285        /* read data pages */
 286        read_redir_page(idd, addr, 0, redir, data);
 287        read_redir_page(idd, addr, 1, redir, data+32);
 288        /* assemble the part # */
 289        j=0;
 290        for(i=0;i<19;i++)
 291                if(data[i+11] != ' ')
 292                        part[j++] = data[i+11];
 293        for(i=0;i<6;i++)
 294                if(data[i+32] != ' ')
 295                        part[j++] = data[i+32];
 296        part[j] = 0;
 297        /* skip Octane power supplies */
 298        if(!strncmp(part, "060-0035-", 9))
 299                return;
 300        if(!strncmp(part, "060-0038-", 9))
 301                return;
 302        strcpy(idd->nic_part, part);
 303        /* assemble the serial # */
 304        j=0;
 305        for(i=0;i<10;i++)
 306                if(data[i+1] != ' ')
 307                        idd->nic_serial[j++] = data[i+1];
 308        idd->nic_serial[j] = 0;
 309}
 310
 311static void read_mac(struct ioc3_driver_data *idd, unsigned long addr)
 312{
 313        int i, loops = 3;
 314        unsigned char data[13];
 315
 316        while(loops>0) {
 317                nic_addr(idd, addr);
 318                nic_write_byte(idd, 0xF0);
 319                nic_write_byte(idd, 0x00);
 320                nic_write_byte(idd, 0x00);
 321                nic_read_byte(idd);
 322                for(i=0;i<13;i++)
 323                        data[i] = nic_read_byte(idd);
 324                if(crc16_area(data, 13, 0x0000) == 0x800d) {
 325                        for(i=10;i>4;i--)
 326                                idd->nic_mac[10-i] = data[i];
 327                        return;
 328                }
 329                loops--;
 330        }
 331        printk(KERN_ERR "IOC3: CRC error in MAC address\n");
 332        for(i=0;i<6;i++)
 333                idd->nic_mac[i] = 0x00;
 334}
 335
 336static void probe_nic(struct ioc3_driver_data *idd)
 337{
 338        int save = 0, loops = 3;
 339        unsigned long first, addr;
 340
 341        writel(GPCR_MLAN_EN, &idd->vma->gpcr_s);
 342
 343        while(loops>0) {
 344                idd->nic_part[0] = 0;
 345                idd->nic_serial[0] = 0;
 346                addr = first = nic_find(idd, &save, 0);
 347                if(!first)
 348                        return;
 349                while(1) {
 350                        if(crc8_addr(addr))
 351                                break;
 352                        else {
 353                                switch(addr & 0xFF) {
 354                                case 0x0B:
 355                                        read_nic(idd, addr);
 356                                        break;
 357                                case 0x09:
 358                                case 0x89:
 359                                case 0x91:
 360                                        read_mac(idd, addr);
 361                                        break;
 362                                }
 363                        }
 364                        addr = nic_find(idd, &save, addr);
 365                        if(addr == first)
 366                                return;
 367                }
 368                loops--;
 369        }
 370        printk(KERN_ERR "IOC3: CRC error in NIC address\n");
 371}
 372
 373/* Interrupts */
 374
 375static void write_ireg(struct ioc3_driver_data *idd, uint32_t val, int which)
 376{
 377        unsigned long flags;
 378
 379        spin_lock_irqsave(&idd->ir_lock, flags);
 380        switch (which) {
 381        case IOC3_W_IES:
 382                writel(val, &idd->vma->sio_ies);
 383                break;
 384        case IOC3_W_IEC:
 385                writel(val, &idd->vma->sio_iec);
 386                break;
 387        }
 388        spin_unlock_irqrestore(&idd->ir_lock, flags);
 389}
 390static inline uint32_t get_pending_intrs(struct ioc3_driver_data *idd)
 391{
 392        unsigned long flag;
 393        uint32_t intrs = 0;
 394
 395        spin_lock_irqsave(&idd->ir_lock, flag);
 396        intrs = readl(&idd->vma->sio_ir);
 397        intrs &= readl(&idd->vma->sio_ies);
 398        spin_unlock_irqrestore(&idd->ir_lock, flag);
 399        return intrs;
 400}
 401
 402static irqreturn_t ioc3_intr_io(int irq, void *arg)
 403{
 404        unsigned long flags;
 405        struct ioc3_driver_data *idd = arg;
 406        int handled = 1, id;
 407        unsigned int pending;
 408
 409        read_lock_irqsave(&ioc3_submodules_lock, flags);
 410
 411        if(idd->dual_irq && readb(&idd->vma->eisr)) {
 412                /* send Ethernet IRQ to the driver */
 413                if(ioc3_ethernet && idd->active[ioc3_ethernet->id] &&
 414                                                ioc3_ethernet->intr) {
 415                        handled = handled && !ioc3_ethernet->intr(ioc3_ethernet,
 416                                                        idd, 0);
 417                }
 418        }
 419        pending = get_pending_intrs(idd);       /* look at the IO IRQs */
 420
 421        for(id=0;id<IOC3_MAX_SUBMODULES;id++) {
 422                if(idd->active[id] && ioc3_submodules[id]
 423                                && (pending & ioc3_submodules[id]->irq_mask)
 424                                && ioc3_submodules[id]->intr) {
 425                        write_ireg(idd, ioc3_submodules[id]->irq_mask,
 426                                                        IOC3_W_IEC);
 427                        if(!ioc3_submodules[id]->intr(ioc3_submodules[id],
 428                                   idd, pending & ioc3_submodules[id]->irq_mask))
 429                                pending &= ~ioc3_submodules[id]->irq_mask;
 430                        if (ioc3_submodules[id]->reset_mask)
 431                                write_ireg(idd, ioc3_submodules[id]->irq_mask,
 432                                                        IOC3_W_IES);
 433                }
 434        }
 435        read_unlock_irqrestore(&ioc3_submodules_lock, flags);
 436        if(pending) {
 437                printk(KERN_WARNING
 438                  "IOC3: Pending IRQs 0x%08x discarded and disabled\n",pending);
 439                write_ireg(idd, pending, IOC3_W_IEC);
 440                handled = 1;
 441        }
 442        return handled?IRQ_HANDLED:IRQ_NONE;
 443}
 444
 445static irqreturn_t ioc3_intr_eth(int irq, void *arg)
 446{
 447        unsigned long flags;
 448        struct ioc3_driver_data *idd = (struct ioc3_driver_data *)arg;
 449        int handled = 1;
 450
 451        if(!idd->dual_irq)
 452                return IRQ_NONE;
 453        read_lock_irqsave(&ioc3_submodules_lock, flags);
 454        if(ioc3_ethernet && idd->active[ioc3_ethernet->id]
 455                                && ioc3_ethernet->intr)
 456                handled = handled && !ioc3_ethernet->intr(ioc3_ethernet, idd, 0);
 457        read_unlock_irqrestore(&ioc3_submodules_lock, flags);
 458        return handled?IRQ_HANDLED:IRQ_NONE;
 459}
 460
 461void ioc3_enable(struct ioc3_submodule *is,
 462                                struct ioc3_driver_data *idd, unsigned int irqs)
 463{
 464        write_ireg(idd, irqs & is->irq_mask, IOC3_W_IES);
 465}
 466
 467void ioc3_ack(struct ioc3_submodule *is, struct ioc3_driver_data *idd,
 468                                unsigned int irqs)
 469{
 470        writel(irqs & is->irq_mask, &idd->vma->sio_ir);
 471}
 472
 473void ioc3_disable(struct ioc3_submodule *is,
 474                                struct ioc3_driver_data *idd, unsigned int irqs)
 475{
 476        write_ireg(idd, irqs & is->irq_mask, IOC3_W_IEC);
 477}
 478
 479void ioc3_gpcr_set(struct ioc3_driver_data *idd, unsigned int val)
 480{
 481        unsigned long flags;
 482        spin_lock_irqsave(&idd->gpio_lock, flags);
 483        writel(val, &idd->vma->gpcr_s);
 484        spin_unlock_irqrestore(&idd->gpio_lock, flags);
 485}
 486
 487/* Keep it simple, stupid! */
 488static int find_slot(void **tab, int max)
 489{
 490        int i;
 491        for(i=0;i<max;i++)
 492                if(!(tab[i]))
 493                        return i;
 494        return -1;
 495}
 496
 497/* Register an IOC3 submodule */
 498int ioc3_register_submodule(struct ioc3_submodule *is)
 499{
 500        struct ioc3_driver_data *idd;
 501        int alloc_id;
 502        unsigned long flags;
 503
 504        write_lock_irqsave(&ioc3_submodules_lock, flags);
 505        alloc_id = find_slot((void **)ioc3_submodules, IOC3_MAX_SUBMODULES);
 506        if(alloc_id != -1) {
 507                ioc3_submodules[alloc_id] = is;
 508                if(is->ethernet) {
 509                        if(ioc3_ethernet==NULL)
 510                                ioc3_ethernet=is;
 511                        else
 512                                printk(KERN_WARNING
 513                                  "IOC3 Ethernet module already registered!\n");
 514                }
 515        }
 516        write_unlock_irqrestore(&ioc3_submodules_lock, flags);
 517
 518        if(alloc_id == -1) {
 519                printk(KERN_WARNING "Increase IOC3_MAX_SUBMODULES!\n");
 520                return -ENOMEM;
 521        }
 522
 523        is->id=alloc_id;
 524
 525        /* Initialize submodule for each IOC3 */
 526        if (!is->probe)
 527                return 0;
 528
 529        down_read(&ioc3_devices_rwsem);
 530        list_for_each_entry(idd, &ioc3_devices, list) {
 531                /* set to 1 for IRQs in probe */
 532                idd->active[alloc_id] = 1;
 533                idd->active[alloc_id] = !is->probe(is, idd);
 534        }
 535        up_read(&ioc3_devices_rwsem);
 536
 537        return 0;
 538}
 539
 540/* Unregister an IOC3 submodule */
 541void ioc3_unregister_submodule(struct ioc3_submodule *is)
 542{
 543        struct ioc3_driver_data *idd;
 544        unsigned long flags;
 545
 546        write_lock_irqsave(&ioc3_submodules_lock, flags);
 547        if(ioc3_submodules[is->id]==is)
 548                ioc3_submodules[is->id]=NULL;
 549        else
 550                printk(KERN_WARNING
 551                        "IOC3 submodule %s has wrong ID.\n",is->name);
 552        if(ioc3_ethernet==is)
 553                ioc3_ethernet = NULL;
 554        write_unlock_irqrestore(&ioc3_submodules_lock, flags);
 555
 556        /* Remove submodule for each IOC3 */
 557        down_read(&ioc3_devices_rwsem);
 558        list_for_each_entry(idd, &ioc3_devices, list)
 559                if(idd->active[is->id]) {
 560                        if(is->remove)
 561                                if(is->remove(is, idd))
 562                                        printk(KERN_WARNING
 563                                               "%s: IOC3 submodule %s remove failed "
 564                                               "for pci_dev %s.\n",
 565                                               __func__, module_name(is->owner),
 566                                               pci_name(idd->pdev));
 567                        idd->active[is->id] = 0;
 568                        if(is->irq_mask)
 569                                write_ireg(idd, is->irq_mask, IOC3_W_IEC);
 570                }
 571        up_read(&ioc3_devices_rwsem);
 572}
 573
 574/*********************
 575 * Device management *
 576 *********************/
 577
 578static char *ioc3_class_names[] = { "unknown", "IP27 BaseIO", "IP30 system",
 579                        "MENET 1/2/3", "MENET 4", "CADduo", "Altix Serial" };
 580
 581static int ioc3_class(struct ioc3_driver_data *idd)
 582{
 583        int res = IOC3_CLASS_NONE;
 584        /* NIC-based logic */
 585        if(!strncmp(idd->nic_part, "030-0891-", 9))
 586                res = IOC3_CLASS_BASE_IP30;
 587        if(!strncmp(idd->nic_part, "030-1155-", 9))
 588                res = IOC3_CLASS_CADDUO;
 589        if(!strncmp(idd->nic_part, "030-1657-", 9))
 590                res = IOC3_CLASS_SERIAL;
 591        if(!strncmp(idd->nic_part, "030-1664-", 9))
 592                res = IOC3_CLASS_SERIAL;
 593        /* total random heuristics */
 594#ifdef CONFIG_SGI_IP27
 595        if(!idd->nic_part[0])
 596                res = IOC3_CLASS_BASE_IP27;
 597#endif
 598        /* print educational message */
 599        printk(KERN_INFO "IOC3 part: [%s], serial: [%s] => class %s\n",
 600                        idd->nic_part, idd->nic_serial, ioc3_class_names[res]);
 601        return res;
 602}
 603/* Adds a new instance of an IOC3 card */
 604static int ioc3_probe(struct pci_dev *pdev, const struct pci_device_id *pci_id)
 605{
 606        struct ioc3_driver_data *idd;
 607        uint32_t pcmd;
 608        int ret, id;
 609
 610        /* Enable IOC3 and take ownership of it */
 611        if ((ret = pci_enable_device(pdev))) {
 612                printk(KERN_WARNING
 613                       "%s: Failed to enable IOC3 device for pci_dev %s.\n",
 614                       __func__, pci_name(pdev));
 615                goto out;
 616        }
 617        pci_set_master(pdev);
 618
 619#ifdef USE_64BIT_DMA
 620        ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
 621        if (!ret) {
 622                ret = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64));
 623                if (ret < 0) {
 624                        printk(KERN_WARNING "%s: Unable to obtain 64 bit DMA "
 625                               "for consistent allocations\n",
 626                                __func__);
 627                }
 628        }
 629#endif
 630
 631        /* Set up per-IOC3 data */
 632        idd = kzalloc(sizeof(struct ioc3_driver_data), GFP_KERNEL);
 633        if (!idd) {
 634                printk(KERN_WARNING
 635                       "%s: Failed to allocate IOC3 data for pci_dev %s.\n",
 636                       __func__, pci_name(pdev));
 637                ret = -ENODEV;
 638                goto out_idd;
 639        }
 640        spin_lock_init(&idd->ir_lock);
 641        spin_lock_init(&idd->gpio_lock);
 642        idd->pdev = pdev;
 643
 644        /* Map all IOC3 registers.  These are shared between subdevices
 645         * so the main IOC3 module manages them.
 646         */
 647        idd->pma = pci_resource_start(pdev, 0);
 648        if (!idd->pma) {
 649                printk(KERN_WARNING
 650                       "%s: Unable to find IOC3 resource "
 651                       "for pci_dev %s.\n",
 652                       __func__, pci_name(pdev));
 653                ret = -ENODEV;
 654                goto out_pci;
 655        }
 656        if (!request_mem_region(idd->pma, IOC3_PCI_SIZE, "ioc3")) {
 657                printk(KERN_WARNING
 658                       "%s: Unable to request IOC3 region "
 659                       "for pci_dev %s.\n",
 660                       __func__, pci_name(pdev));
 661                ret = -ENODEV;
 662                goto out_pci;
 663        }
 664        idd->vma = ioremap(idd->pma, IOC3_PCI_SIZE);
 665        if (!idd->vma) {
 666                printk(KERN_WARNING
 667                       "%s: Unable to remap IOC3 region "
 668                       "for pci_dev %s.\n",
 669                       __func__, pci_name(pdev));
 670                ret = -ENODEV;
 671                goto out_misc_region;
 672        }
 673
 674        /* Track PCI-device specific data */
 675        pci_set_drvdata(pdev, idd);
 676        down_write(&ioc3_devices_rwsem);
 677        list_add_tail(&idd->list, &ioc3_devices);
 678        idd->id = ioc3_counter++;
 679        up_write(&ioc3_devices_rwsem);
 680
 681        idd->gpdr_shadow = readl(&idd->vma->gpdr);
 682
 683        /* Read IOC3 NIC contents */
 684        probe_nic(idd);
 685
 686        /* Detect IOC3 class */
 687        idd->class = ioc3_class(idd);
 688
 689        /* Initialize IOC3 */
 690       pci_read_config_dword(pdev, PCI_COMMAND, &pcmd);
 691       pci_write_config_dword(pdev, PCI_COMMAND,
 692                               pcmd | PCI_COMMAND_MEMORY |
 693                               PCI_COMMAND_PARITY | PCI_COMMAND_SERR |
 694                               PCI_SCR_DROP_MODE_EN);
 695
 696        write_ireg(idd, ~0, IOC3_W_IEC);
 697        writel(~0, &idd->vma->sio_ir);
 698
 699        /* Set up IRQs */
 700        if(idd->class == IOC3_CLASS_BASE_IP30
 701                                || idd->class == IOC3_CLASS_BASE_IP27) {
 702                writel(0, &idd->vma->eier);
 703                writel(~0, &idd->vma->eisr);
 704
 705                idd->dual_irq = 1;
 706                if (!request_irq(pdev->irq, ioc3_intr_eth, IRQF_SHARED,
 707                                 "ioc3-eth", (void *)idd)) {
 708                        idd->irq_eth = pdev->irq;
 709                } else {
 710                        printk(KERN_WARNING
 711                               "%s : request_irq fails for IRQ 0x%x\n ",
 712                               __func__, pdev->irq);
 713                }
 714                if (!request_irq(pdev->irq+2, ioc3_intr_io, IRQF_SHARED,
 715                                 "ioc3-io", (void *)idd)) {
 716                        idd->irq_io = pdev->irq+2;
 717                } else {
 718                        printk(KERN_WARNING
 719                               "%s : request_irq fails for IRQ 0x%x\n ",
 720                               __func__, pdev->irq+2);
 721                }
 722        } else {
 723                if (!request_irq(pdev->irq, ioc3_intr_io, IRQF_SHARED,
 724                                 "ioc3", (void *)idd)) {
 725                        idd->irq_io = pdev->irq;
 726                } else {
 727                        printk(KERN_WARNING
 728                               "%s : request_irq fails for IRQ 0x%x\n ",
 729                               __func__, pdev->irq);
 730                }
 731        }
 732
 733        /* Add this IOC3 to all submodules */
 734        for(id=0;id<IOC3_MAX_SUBMODULES;id++)
 735                if(ioc3_submodules[id] && ioc3_submodules[id]->probe) {
 736                        idd->active[id] = 1;
 737                        idd->active[id] = !ioc3_submodules[id]->probe
 738                                                (ioc3_submodules[id], idd);
 739                }
 740
 741        printk(KERN_INFO "IOC3 Master Driver loaded for %s\n", pci_name(pdev));
 742
 743        return 0;
 744
 745out_misc_region:
 746        release_mem_region(idd->pma, IOC3_PCI_SIZE);
 747out_pci:
 748        kfree(idd);
 749out_idd:
 750        pci_disable_device(pdev);
 751out:
 752        return ret;
 753}
 754
 755/* Removes a particular instance of an IOC3 card. */
 756static void ioc3_remove(struct pci_dev *pdev)
 757{
 758        int id;
 759        struct ioc3_driver_data *idd;
 760
 761        idd = pci_get_drvdata(pdev);
 762
 763        /* Remove this IOC3 from all submodules */
 764        for(id=0;id<IOC3_MAX_SUBMODULES;id++)
 765                if(idd->active[id]) {
 766                        if(ioc3_submodules[id] && ioc3_submodules[id]->remove)
 767                                if(ioc3_submodules[id]->remove(ioc3_submodules[id],
 768                                                                idd))
 769                                        printk(KERN_WARNING
 770                                               "%s: IOC3 submodule 0x%s remove failed "
 771                                               "for pci_dev %s.\n",
 772                                                __func__,
 773                                                module_name(ioc3_submodules[id]->owner),
 774                                                pci_name(pdev));
 775                        idd->active[id] = 0;
 776                }
 777
 778        /* Clear and disable all IRQs */
 779        write_ireg(idd, ~0, IOC3_W_IEC);
 780        writel(~0, &idd->vma->sio_ir);
 781
 782        /* Release resources */
 783        free_irq(idd->irq_io, (void *)idd);
 784        if(idd->dual_irq)
 785                free_irq(idd->irq_eth, (void *)idd);
 786        iounmap(idd->vma);
 787        release_mem_region(idd->pma, IOC3_PCI_SIZE);
 788
 789        /* Disable IOC3 and relinquish */
 790        pci_disable_device(pdev);
 791
 792        /* Remove and free driver data */
 793        down_write(&ioc3_devices_rwsem);
 794        list_del(&idd->list);
 795        up_write(&ioc3_devices_rwsem);
 796        kfree(idd);
 797}
 798
 799static struct pci_device_id ioc3_id_table[] = {
 800        {PCI_VENDOR_ID_SGI, PCI_DEVICE_ID_SGI_IOC3, PCI_ANY_ID, PCI_ANY_ID},
 801        {0}
 802};
 803
 804static struct pci_driver ioc3_driver = {
 805        .name = "IOC3",
 806        .id_table = ioc3_id_table,
 807        .probe = ioc3_probe,
 808        .remove = ioc3_remove,
 809};
 810
 811MODULE_DEVICE_TABLE(pci, ioc3_id_table);
 812
 813/*********************
 814 * Module management *
 815 *********************/
 816
 817/* Module load */
 818static int __init ioc3_init(void)
 819{
 820        if (ia64_platform_is("sn2"))
 821                return pci_register_driver(&ioc3_driver);
 822        return -ENODEV;
 823}
 824
 825/* Module unload */
 826static void __exit ioc3_exit(void)
 827{
 828        pci_unregister_driver(&ioc3_driver);
 829}
 830
 831module_init(ioc3_init);
 832module_exit(ioc3_exit);
 833
 834MODULE_AUTHOR("Stanislaw Skowronek <skylark@linux-mips.org>");
 835MODULE_DESCRIPTION("PCI driver for SGI IOC3");
 836MODULE_LICENSE("GPL");
 837
 838EXPORT_SYMBOL_GPL(ioc3_register_submodule);
 839EXPORT_SYMBOL_GPL(ioc3_unregister_submodule);
 840EXPORT_SYMBOL_GPL(ioc3_ack);
 841EXPORT_SYMBOL_GPL(ioc3_gpcr_set);
 842EXPORT_SYMBOL_GPL(ioc3_disable);
 843EXPORT_SYMBOL_GPL(ioc3_enable);
 844