static int __init dio_find_slow(int deviceid) { /* Called to find a DIO device before the full bus scan has run. Basically * only used by the console driver. * We don't do the primary+secondary ID encoding thing here. Maybe we should. * (that would break the topcat detection, though. I need to think about * the whole primary/secondary ID thing.) */ int scode; u_char prid; for (scode = 0; scode < DIO_SCMAX; scode++) { void *va; if (DIO_SCINHOLE(scode)) continue; va = dio_scodetoviraddr(scode); if (!va || !hwreg_present(va + DIO_IDOFF)) continue; /* no board present at that select code */ /* We aren't very likely to want to use this to get at the IHPIB, * but maybe it's returning the same ID as the card we do want... */ if (!DIO_ISIHPIB(scode)) prid = DIO_ID(va); else prid = DIO_ID_IHPIB; if (prid == deviceid) return scode; } return 0; }
/* This is the function that scans the DIO space and works out what * hardware is actually present. */ static int __init dio_init(void) { int scode; struct dioboard *b, *bprev = NULL; printk("Scanning for DIO devices...\n"); for (scode = 0; scode < DIO_SCMAX; ++scode) { u_char prid, secid = 0; /* primary, secondary ID bytes */ u_char *va; if (DIO_SCINHOLE(scode)) continue; va = dio_scodetoviraddr(scode); if (!va || !hwreg_present(va + DIO_IDOFF)) continue; /* no board present at that select code */ /* Found a board, allocate it an entry in the list */ b = kmalloc(sizeof(struct dioboard), GFP_KERNEL); /* read the ID byte(s) and encode if necessary. Note workaround * for broken internal HPIB devices... */ if (!DIO_ISIHPIB(scode)) prid = DIO_ID(va); else prid = DIO_ID_IHPIB; if (DIO_NEEDSSECID(prid)) { secid = DIO_SECID(va); b->id = DIO_ENCODE_ID(prid, secid); } else b->id = prid; b->configured = 0; b->scode = scode; b->ipl = DIO_IPL(va); b->name = dio_getname(b->id); printk("select code %3d: ipl %d: ID %02X", scode, b->ipl, prid); if (DIO_NEEDSSECID(b->id)) printk(":%02X", secid); printk(": %s\n", b->name); b->next = NULL; if (bprev) bprev->next = b; else blist = b; bprev = b; } return 0; }
/* Initialise a single lance board at the given select code */ static int __init hplance_init(struct net_device *dev, int scode) { /* const char *name = dio_scodetoname(scode); */ static const char name[] = "HP LANCE"; void *va = dio_scodetoviraddr(scode); struct hplance_private *lp; int i; #ifdef MODULE dev = init_etherdev(0, sizeof(struct hplance_private)); if (!dev) return -ENOMEM; #else dev->priv = kmalloc(sizeof(struct hplance_private), GFP_KERNEL); if (dev->priv == NULL) return -ENOMEM; memset(dev->priv, 0, sizeof(struct hplance_private)); #endif SET_MODULE_OWNER(dev); printk("%s: HP LANCE; select code %d, addr", dev->name, scode); /* reset the board */ writeb(0xff,va+DIO_IDOFF); udelay(100); /* ariba! ariba! udelay! udelay! */ /* Fill the dev fields */ dev->base_addr = (unsigned long)va; dev->open = &hplance_open; dev->stop = &hplance_close; dev->hard_start_xmit = &lance_start_xmit; dev->get_stats = &lance_get_stats; dev->set_multicast_list = &lance_set_multicast; dev->dma = 0; for (i=0; i<6; i++) { /* The NVRAM holds our ethernet address, one nibble per byte, * at bytes NVRAMOFF+1,3,5,7,9... */ dev->dev_addr[i] = ((readb(va + HPLANCE_NVRAMOFF + i*4 + 1) & 0xF) << 4) | (readb(va + HPLANCE_NVRAMOFF + i*4 + 3) & 0xF); printk("%c%2.2x", i == 0 ? ' ' : ':', dev->dev_addr[i]); } lp = (struct hplance_private *)dev->priv; lp->lance.name = (char*)name; /* discards const, shut up gcc */ lp->lance.ll = (struct lance_regs *)(va + HPLANCE_REGOFF); lp->lance.init_block = (struct lance_init_block *)(va + HPLANCE_MEMOFF); /* CPU addr */ lp->lance.lance_init_block = 0; /* LANCE addr of same RAM */ lp->lance.busmaster_regval = LE_C3_BSWP; /* we're bigendian */ lp->lance.irq = dio_scodetoipl(scode); lp->lance.writerap = hplance_writerap; lp->lance.writerdp = hplance_writerdp; lp->lance.readrdp = hplance_readrdp; lp->lance.lance_log_rx_bufs = LANCE_LOG_RX_BUFFERS; lp->lance.lance_log_tx_bufs = LANCE_LOG_TX_BUFFERS; lp->lance.rx_ring_mod_mask = RX_RING_MOD_MASK; lp->lance.tx_ring_mod_mask = TX_RING_MOD_MASK; lp->scode = scode; lp->base = va; ether_setup(dev); printk(", irq %d\n", lp->lance.irq); #ifdef MODULE dev->ifindex = dev_new_index(); lp->next_module = root_hplance_dev; root_hplance_dev = lp; #endif /* MODULE */ dio_config_board(scode); /* tell bus scanning code this one's taken */ return 0; }