/* * Network device driver for the BMAC ethernet controller on * Apple Powermacs. Assumes it's under a DBDMA controller. * * Copyright (C) 1998 Randy Gobbel. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include "bmac.h" #define trunc_page(x) ((void *)(((unsigned long)(x)) & ~((unsigned long)(PAGE_SIZE - 1)))) #define round_page(x) trunc_page(((unsigned long)(x)) + ((unsigned long)(PAGE_SIZE - 1))) /* * CRC polynomial - used in working out multicast filter bits. */ #define ENET_CRCPOLY 0x04c11db7 /* a bunch of constants for the "Heathrow" interrupt controller. These really should be in an include file somewhere */ #define IoBaseHeathrow ((unsigned *)0xf3000000) #define HeathrowFCR 0x0038 /* FCR offset from Heathrow Base Address */ #define fcrEnetEnabledBits 0x60000000 /* mask to enable Enet Xcvr/Controller */ #define fcrResetEnetCell 0x80000000 /* mask used to reset Enet cell */ #define fcrClearResetEnetCell 0x7fffffff /* mask used to clear reset Enet cell */ #define fcrDisableEnet 0x1fffffff /* mask to disable Enet Xcvr/Controller */ #define N_RX_RING 64 #define N_TX_RING 32 #define MAX_TX_ACTIVE 1 #define ETHERCRC 4 #define ETHERMINPACKET 64 #define ETHERMTU 1500 #define RX_BUFLEN (ETHERMTU + 14 + ETHERCRC + 2) #define TX_TIMEOUT HZ /* 1 second */ /* Bits in transmit DMA status */ #define TX_DMA_ERR 0x80 #define XXDEBUG(args) struct bmac_data { /* volatile struct bmac *bmac; */ struct sk_buff_head *queue; volatile struct dbdma_regs *tx_dma; int tx_dma_intr; volatile struct dbdma_regs *rx_dma; int rx_dma_intr; volatile struct dbdma_cmd *tx_cmds; /* xmit dma command list */ volatile struct dbdma_cmd *rx_cmds; /* recv dma command list */ struct sk_buff *rx_bufs[N_RX_RING]; int rx_fill; int rx_empty; struct sk_buff *tx_bufs[N_TX_RING]; char *tx_double[N_TX_RING]; /* yuck--double buffering */ int tx_fill; int tx_empty; unsigned char tx_fullup; struct net_device_stats stats; struct timer_list tx_timeout; int timeout_active; int reset_and_enabled; int rx_allocated; int tx_allocated; unsigned short hash_use_count[64]; unsigned short hash_table_mask[4]; }; typedef struct bmac_reg_entry { char *name; unsigned short reg_offset; } bmac_reg_entry_t; #define N_REG_ENTRIES 30 bmac_reg_entry_t reg_entries[N_REG_ENTRIES] = { {"MEMADD", MEMADD}, {"MEMDATAHI", MEMDATAHI}, {"MEMDATALO", MEMDATALO}, {"TXPNTR", TXPNTR}, {"RXPNTR", RXPNTR}, {"IPG1", IPG1}, {"IPG2", IPG2}, {"ALIMIT", ALIMIT}, {"SLOT", SLOT}, {"PALEN", PALEN}, {"PAPAT", PAPAT}, {"TXSFD", TXSFD}, {"JAM", JAM}, {"TXMAX", TXMAX}, {"TXMIN", TXMIN}, {"PAREG", PAREG}, {"DCNT", DCNT}, {"NCCNT", NCCNT}, {"NTCNT", NTCNT}, {"EXCNT", EXCNT}, {"LTCNT", LTCNT}, {"TXSM", TXSM}, {"RXCFG", RXCFG}, {"RXMAX", RXMAX}, {"RXMIN", RXMIN}, {"FRCNT", FRCNT}, {"AECNT", AECNT}, {"FECNT", FECNT}, {"RXSM", RXSM}, {"RXCV", RXCV} }; struct device *bmac_devs = NULL; #if 0 /* * If we can't get a skbuff when we need it, we use this area for DMA. */ static unsigned char dummy_buf[RX_BUFLEN]; #endif /* * Number of bytes of private data per BMAC: allow enough for * the rx and tx dma commands plus a branch dma command each, * and another 16 bytes to allow us to align the dma command * buffers on a 16 byte boundary. */ #define PRIV_BYTES (sizeof(struct bmac_data) \ + (N_RX_RING + N_TX_RING + 4) * sizeof(struct dbdma_cmd) \ + sizeof(struct sk_buff_head)) static unsigned char bitrev(unsigned char b); static int bmac_open(struct device *dev); static int bmac_close(struct device *dev); static int bmac_transmit_packet(struct sk_buff *skb, struct device *dev); static struct net_device_stats *bmac_stats(struct device *dev); static void bmac_set_multicast(struct device *dev); static int bmac_reset_and_enable(struct device *dev, int enable); static void bmac_start_chip(struct device *dev); static int bmac_init_chip(struct device *dev); static void bmac_init_registers(struct device *dev); static void bmac_reset_chip(struct device *dev); static int bmac_set_address(struct device *dev, void *addr); static void bmac_misc_intr(int irq, void *dev_id, struct pt_regs *regs); static void bmac_txdma_intr(int irq, void *dev_id, struct pt_regs *regs); static void bmac_rxdma_intr(int irq, void *dev_id, struct pt_regs *regs); static void bmac_set_timeout(struct device *dev); static void bmac_tx_timeout(unsigned long data); static void bmac_reset_chip(struct device *dev); static void bmac_init_registers(struct device *dev); static int bmac_proc_info ( char *buffer, char **start, off_t offset, int length, int dummy); static int bmac_output(struct sk_buff *skb, struct device *dev); static void bmac_start(struct device *dev); #define DBDMA_SET(x) ( ((x) | (x) << 16) ) #define DBDMA_CLEAR(x) ( (x) << 16) static __inline__ void dbdma_st32(volatile unsigned long *a, unsigned long x) { __asm__ volatile( "stwbrx %0,0,%1" : : "r" (x), "r" (a) : "memory"); return; } static __inline__ unsigned long dbdma_ld32(volatile unsigned long *a) { unsigned long swap; __asm__ volatile ("lwbrx %0,0,%1" : "=r" (swap) : "r" (a)); return swap; } void dbdma_stop(volatile struct dbdma_regs *dmap) { dbdma_st32((volatile unsigned long *)&dmap->control, DBDMA_CLEAR(RUN) | DBDMA_SET(FLUSH)); eieio(); while (dbdma_ld32((volatile unsigned long *)&dmap->status) & (ACTIVE|FLUSH)) eieio(); } static void dbdma_continue(volatile struct dbdma_regs *dmap) { dbdma_st32((volatile unsigned long *)&dmap->control, DBDMA_SET(RUN|WAKE) | DBDMA_CLEAR(PAUSE|DEAD)); eieio(); } static void dbdma_reset(volatile struct dbdma_regs *dmap) { dbdma_st32((volatile unsigned long *)&dmap->control, DBDMA_CLEAR(ACTIVE|DEAD|WAKE|FLUSH|PAUSE|RUN)); eieio(); while (dbdma_ld32((volatile unsigned long *)&dmap->status) & RUN) eieio(); } static void dbdma_setcmd(volatile struct dbdma_cmd *cp, unsigned short cmd, unsigned count, unsigned long addr, unsigned long cmd_dep) { out_le16(&cp->command, cmd); out_le16(&cp->req_count, count); out_le32(&cp->phy_addr, addr); out_le32(&cp->cmd_dep, cmd_dep); out_le16(&cp->xfer_status, 0); out_le16(&cp->res_count, 0); } static __inline__ void bmwrite(struct device *dev, unsigned long reg_offset, unsigned data ) { out_le16((void *)dev->base_addr + reg_offset, data); } static __inline__ volatile unsigned short bmread(struct device *dev, unsigned long reg_offset ) { return in_le16((void *)dev->base_addr + reg_offset); } static void bmac_reset_chip(struct device *dev) { struct bmac_data *bp = (struct bmac_data *) dev->priv; volatile struct dbdma_regs *rd = bp->rx_dma; volatile struct dbdma_regs *td = bp->tx_dma; volatile unsigned *heathrowFCR; unsigned int fcrValue; dbdma_reset(rd); dbdma_reset(td); heathrowFCR = (unsigned *)((unsigned char *)IoBaseHeathrow + HeathrowFCR); fcrValue = in_le32(heathrowFCR); fcrValue &= fcrDisableEnet; /* clear out Xvr and Controller Bit */ out_le32(heathrowFCR, fcrValue); udelay(50000); fcrValue |= fcrResetEnetCell; /* set bit to reset them */ out_le32(heathrowFCR, fcrValue); udelay(50000); fcrValue &= fcrDisableEnet; out_le32(heathrowFCR, fcrValue); udelay(50000); fcrValue |= fcrEnetEnabledBits; out_le32(heathrowFCR, fcrValue); udelay(50000); out_le32(heathrowFCR, fcrValue); } static void bmac_init_registers(struct device *dev) { struct bmac_data *bp = (struct bmac_data *) dev->priv; volatile unsigned short regValue; unsigned short *pWord16; int i; /* XXDEBUG(("bmac: enter init_registers\n")); */ bmwrite(dev, TXRST, TxResetBit); do { regValue = bmread(dev, TXRST); /* wait for reset to clear..acknowledge */ } while (regValue & TxResetBit); bmwrite(dev, RXRST, RxResetValue); bmwrite(dev, XCVRIF, ClkBit | SerialMode | COLActiveLow); bmwrite(dev, RSEED, (unsigned short)0x1968); regValue = bmread(dev, XIFC); regValue |= TxOutputEnable; bmwrite(dev, XIFC, regValue); bmread(dev, PAREG); /* set collision counters to 0 */ bmwrite(dev, NCCNT, 0); bmwrite(dev, NTCNT, 0); bmwrite(dev, EXCNT, 0); bmwrite(dev, LTCNT, 0); /* set rx counters to 0 */ bmwrite(dev, FRCNT, 0); bmwrite(dev, LECNT, 0); bmwrite(dev, AECNT, 0); bmwrite(dev, FECNT, 0); bmwrite(dev, RXCV, 0); /* set tx fifo information */ bmwrite(dev, TXTH, 4); /* 4 octets before tx starts */ bmwrite(dev, TXFIFOCSR, 0); /* first disable txFIFO */ bmwrite(dev, TXFIFOCSR, TxFIFOEnable ); /* set rx fifo information */ bmwrite(dev, RXFIFOCSR, 0); /* first disable rxFIFO */ bmwrite(dev, RXFIFOCSR, RxFIFOEnable ); //bmwrite(dev, TXCFG, TxMACEnable); /* TxNeverGiveUp maybe later */ bmread(dev, STATUS); /* read it just to clear it */ bmwrite(dev, INTDISABLE, EnableNormal); /* zero out the chip Hash Filter registers */ for (i=0; i<4; i++) bp->hash_table_mask[i] = 0; bmwrite(dev, BHASH3, bp->hash_table_mask[0]); /* bits 15 - 0 */ bmwrite(dev, BHASH2, bp->hash_table_mask[1]); /* bits 31 - 16 */ bmwrite(dev, BHASH1, bp->hash_table_mask[2]); /* bits 47 - 32 */ bmwrite(dev, BHASH0, bp->hash_table_mask[3]); /* bits 63 - 48 */ pWord16 = (unsigned short *)dev->dev_addr; bmwrite(dev, MADD0, *pWord16++); bmwrite(dev, MADD1, *pWord16++); bmwrite(dev, MADD2, *pWord16); bmwrite(dev, RXCFG, RxCRCNoStrip | RxHashFilterEnable | RxRejectOwnPackets); return; } #if 0 static void bmac_disable_interrupts(struct device *dev) { bmwrite(dev, INTDISABLE, DisableAll); } static void bmac_enable_interrupts(struct device *dev) { bmwrite(dev, INTDISABLE, EnableNormal); } #endif static void bmac_start_chip(struct device *dev) { struct bmac_data *bp = (struct bmac_data *) dev->priv; volatile struct dbdma_regs *rd = bp->rx_dma; unsigned short oldConfig; /* enable rx dma channel */ dbdma_continue(rd); /* turn on rx plus any other bits already on (promiscuous possibly) */ oldConfig = bmread(dev, RXCFG); bmwrite(dev, RXCFG, oldConfig | RxMACEnable ); oldConfig = bmread(dev, TXCFG); bmwrite(dev, TXCFG, oldConfig | TxMACEnable ); } static int bmac_init_chip(struct device *dev) { bmac_init_registers(dev); return 1; } static int bmac_set_address(struct device *dev, void *addr) { unsigned char *p = addr; unsigned short *pWord16; unsigned long flags; int i; XXDEBUG(("bmac: enter set_address\n")); save_flags(flags); cli(); for (i = 0; i < 6; ++i) { dev->dev_addr[i] = p[i]; } /* load up the hardware address */ pWord16 = (unsigned short *)dev->dev_addr; bmwrite(dev, MADD0, *pWord16++); bmwrite(dev, MADD1, *pWord16++); bmwrite(dev, MADD2, *pWord16); restore_flags(flags); XXDEBUG(("bmac: exit set_address\n")); return 0; } static inline void bmac_set_timeout(struct device *dev) { struct bmac_data *bp = (struct bmac_data *) dev->priv; unsigned long flags; save_flags(flags); cli(); if (bp->timeout_active) del_timer(&bp->tx_timeout); bp->tx_timeout.expires = jiffies + TX_TIMEOUT; bp->tx_timeout.function = bmac_tx_timeout; bp->tx_timeout.data = (unsigned long) dev; add_timer(&bp->tx_timeout); bp->timeout_active = 1; restore_flags(flags); } static void bmac_construct_xmt(struct sk_buff *skb, volatile struct dbdma_cmd *cp, char *doubleBuf) { void *vaddr, *page_break; unsigned long baddr; unsigned long len; len = skb->len; vaddr = skb->data; baddr = virt_to_bus(vaddr); page_break = round_page(vaddr); if (trunc_page(vaddr) != trunc_page(vaddr+len) && (unsigned long)round_page(baddr) != virt_to_bus(page_break)) { baddr = virt_to_bus(doubleBuf); XXDEBUG(("bmac: double buffering, double=%#08x, skb->data=%#08x, len=%d\n", doubleBuf, skb->data, len)); } else flush_page_to_ram((unsigned long)vaddr); dbdma_setcmd(cp, (OUTPUT_LAST | INTR_ALWAYS | WAIT_IFCLR), len, baddr, 0); } static void bmac_construct_rxbuff(unsigned char *addr, volatile struct dbdma_cmd *cp) { dbdma_setcmd(cp, (INPUT_LAST | INTR_ALWAYS), RX_BUFLEN, virt_to_bus(addr), 0); } /* Bit-reverse one byte of an ethernet hardware address. */ static unsigned char bitrev(unsigned char b) { int d = 0, i; for (i = 0; i < 8; ++i, b >>= 1) d = (d << 1) | (b & 1); return d; } static int bmac_init_tx_ring(struct bmac_data *bp) { int i; volatile struct dbdma_regs *td = bp->tx_dma; char *addr; if (!bp->tx_allocated) { /* zero out tx cmds, alloc space for double buffering */ addr = (char *)kmalloc(ETHERMTU * N_TX_RING, GFP_DMA); for (i = 0; i < N_TX_RING; i++, addr += ETHERMTU) bp->tx_double[i] = addr; bp->tx_allocated = 1; } memset((char *)bp->tx_cmds, 0, (N_TX_RING+1) * sizeof(struct dbdma_cmd)); bp->tx_empty = 0; bp->tx_fill = 0; bp->tx_fullup = 0; /* put a branch at the end of the tx command list */ dbdma_setcmd(&bp->tx_cmds[N_TX_RING], (DBDMA_NOP | BR_ALWAYS), 0, 0, virt_to_bus(bp->tx_cmds)); /* reset tx dma */ dbdma_reset(td); out_le32(&td->wait_sel, 0x00200020); out_le32(&td->cmdptr, virt_to_bus(bp->tx_cmds)); return 1; } static int bmac_init_rx_ring(struct bmac_data *bp) { volatile struct dbdma_regs *rd = bp->rx_dma; int i; /* initialize list of sk_buffs for receiving and set up recv dma */ if (!bp->rx_allocated) { for (i = 0; i < N_RX_RING; i++) { bp->rx_bufs[i] = dev_alloc_skb(RX_BUFLEN+2); skb_reserve(bp->rx_bufs[i], 2); } bp->rx_allocated = 1; } memset((char *)bp->rx_cmds, 0, (N_RX_RING+1) * sizeof(struct dbdma_cmd)); for (i = 0; i < N_RX_RING; i++) bmac_construct_rxbuff(bp->rx_bufs[i]->data, &bp->rx_cmds[i]); bp->rx_empty = 0; bp->rx_fill = i; /* Put a branch back to the beginning of the receive command list */ dbdma_setcmd(&bp->rx_cmds[N_RX_RING], (DBDMA_NOP | BR_ALWAYS), 0, 0, virt_to_bus(bp->rx_cmds)); /* start rx dma */ dbdma_reset(rd); out_le32(&rd->cmdptr, virt_to_bus(bp->rx_cmds)); return 1; } static int bmac_transmit_packet(struct sk_buff *skb, struct device *dev) { struct bmac_data *bp = (struct bmac_data *) dev->priv; volatile struct dbdma_regs *td = bp->tx_dma; int i; /* see if there's a free slot in the tx ring */ /* XXDEBUG(("bmac_xmit_start: empty=%d fill=%d\n", */ /* bp->tx_empty, bp->tx_fill)); */ i = bp->tx_fill + 1; if (i >= N_TX_RING) i = 0; if (i == bp->tx_empty) { dev->tbusy = 1; bp->tx_fullup = 1; XXDEBUG(("bmac_transmit_packet: tx ring full\n")); return -1; /* can't take it at the moment */ } dbdma_setcmd(&bp->tx_cmds[i], DBDMA_STOP, 0, 0, 0); bmac_construct_xmt(skb, &bp->tx_cmds[bp->tx_fill], bp->tx_double[bp->tx_fill]); bp->tx_bufs[bp->tx_fill] = skb; bp->tx_fill = i; dbdma_continue(td); return 0; } static int rxintcount = 0; static void bmac_rxdma_intr(int irq, void *dev_id, struct pt_regs *regs) { struct device *dev = (struct device *) dev_id; struct bmac_data *bp = (struct bmac_data *) dev->priv; volatile struct dbdma_regs *rd = bp->rx_dma; volatile struct dbdma_cmd *cp; int i, nb, stat; struct sk_buff *skb; unsigned int residual; int last; unsigned long flags; save_flags(flags); cli(); if (++rxintcount < 10) { XXDEBUG(("bmac_rxdma_intr\n")); } last = -1; i = bp->rx_empty; while (1) { cp = &bp->rx_cmds[i]; stat = ld_le16(&cp->xfer_status); residual = ld_le16(&cp->res_count); if ((stat & ACTIVE) == 0) break; nb = RX_BUFLEN - residual - 2; if (nb < (ETHERMINPACKET - ETHERCRC)) { skb = NULL; bp->stats.rx_length_errors++; bp->stats.rx_errors++; } else skb = bp->rx_bufs[i]; if (skb != NULL) { nb -= ETHERCRC; skb_put(skb, nb); skb->dev = dev; skb->protocol = eth_type_trans(skb, dev); netif_rx(skb); bp->rx_bufs[i] = dev_alloc_skb(RX_BUFLEN+2); skb_reserve(bp->rx_bufs[i], 2); bmac_construct_rxbuff(bp->rx_bufs[i]->data, &bp->rx_cmds[i]); ++bp->stats.rx_packets; } else { ++bp->stats.rx_dropped; } st_le16(&cp->res_count, 0); st_le16(&cp->xfer_status, 0); last = i; if (++i >= N_RX_RING) i = 0; } if (last != -1) { bp->rx_fill = last; bp->rx_empty = i; } restore_flags(flags); dbdma_continue(rd); if (rxintcount < 10) { XXDEBUG(("bmac_rxdma_intr done\n")); } } static int txintcount = 0; static void bmac_txdma_intr(int irq, void *dev_id, struct pt_regs *regs) { struct device *dev = (struct device *) dev_id; struct bmac_data *bp = (struct bmac_data *) dev->priv; volatile struct dbdma_cmd *cp; int stat; unsigned long flags; save_flags(flags); cli(); if (txintcount++ < 10) { XXDEBUG(("bmac_txdma_intr\n")); } /* del_timer(&bp->tx_timeout); */ /* bp->timeout_active = 0; */ while (1) { cp = &bp->tx_cmds[bp->tx_empty]; stat = ld_le16(&cp->xfer_status); if (txintcount < 10) { XXDEBUG(("bmac_txdma_xfer_stat=%#0x\n", stat)); } if (!(stat & ACTIVE)) break; if (bp->tx_bufs[bp->tx_empty]) { ++bp->stats.tx_packets; dev_kfree_skb(bp->tx_bufs[bp->tx_empty]); } bp->tx_bufs[bp->tx_empty] = NULL; bp->tx_fullup = 0; dev->tbusy = 0; /* XXDEBUG(("bmac_intr: cleared tbusy, empty=%d fill=%d\n", */ /* i, bp->tx_fill)); */ mark_bh(NET_BH); if (++bp->tx_empty >= N_TX_RING) bp->tx_empty = 0; if (bp->tx_empty == bp->tx_fill) break; } restore_flags(flags); if (txintcount < 10) { XXDEBUG(("bmac_txdma_intr done->bmac_start\n")); } bmac_start(dev); } static struct net_device_stats *bmac_stats(struct device *dev) { struct bmac_data *p = (struct bmac_data *) dev->priv; return &p->stats; } #if 0 /* Real fast bit-reversal algorithm, 6-bit values */ static int reverse6[64] = { 0x0,0x20,0x10,0x30,0x8,0x28,0x18,0x38, 0x4,0x24,0x14,0x34,0xc,0x2c,0x1c,0x3c, 0x2,0x22,0x12,0x32,0xa,0x2a,0x1a,0x3a, 0x6,0x26,0x16,0x36,0xe,0x2e,0x1e,0x3e, 0x1,0x21,0x11,0x31,0x9,0x29,0x19,0x39, 0x5,0x25,0x15,0x35,0xd,0x2d,0x1d,0x3d, 0x3,0x23,0x13,0x33,0xb,0x2b,0x1b,0x3b, 0x7,0x27,0x17,0x37,0xf,0x2f,0x1f,0x3f }; static unsigned int crc416(unsigned int curval, unsigned short nxtval) { register unsigned int counter, cur = curval, next = nxtval; register int high_crc_set, low_data_set; /* Swap bytes */ next = ((next & 0x00FF) << 8) | (next >> 8); /* Compute bit-by-bit */ for (counter = 0; counter < 16; ++counter) { /* is high CRC bit set? */ if ((cur & 0x80000000) == 0) high_crc_set = 0; else high_crc_set = 1; cur = cur << 1; if ((next & 0x0001) == 0) low_data_set = 0; else low_data_set = 1; next = next >> 1; /* do the XOR */ if (high_crc_set ^ low_data_set) cur = cur ^ ENET_CRCPOLY; } return cur; } static unsigned int bmac_crc(unsigned short *address) { unsigned int newcrc; XXDEBUG(("bmac_crc: addr=%#04x, %#04x, %#04x\n", *address, address[1], address[2])); newcrc = crc416(0xffffffff, *address); /* address bits 47 - 32 */ newcrc = crc416(newcrc, address[1]); /* address bits 31 - 16 */ newcrc = crc416(newcrc, address[2]); /* address bits 15 - 0 */ return(newcrc); } /* * Add requested mcast addr to BMac's hash table filter. * */ static void bmac_addhash(struct bmac_data *bp, unsigned char *addr) { unsigned int crc; unsigned short mask; if (!(*addr crc = bmac_crc((unsigned short *)addr) & 0x3f; /* Big-endian alert! */ crc = reverse6[crc]; /* Hyperfast bit-reversing algorithm */ if (bp->hash_use_count[crc]++) return; /* This bit is already set */ mask = crc % 16; mask = (unsigned char)1 << mask; bp->hash_use_count[crc/16] |= mask; } static void bmac_removehash(struct bmac_data *bp, unsigned char *addr) { unsigned int crc; unsigned char mask; /* Now, delete the address from the filter copy, as indicated */ crc = bmac_crc((unsigned short *)addr) & 0x3f; /* Big-endian alert! */ crc = reverse6[crc]; /* Hyperfast bit-reversing algorithm */ if (bp->hash_use_count[crc] == 0) return; /* That bit wasn't in use! */ if (--bp->hash_use_count[crc]) return; /* That bit is still in use */ mask = crc % 16; mask = ((unsigned char)1 << mask) ^ 0xffff; /* To turn off bit */ bp->hash_table_mask[crc/16] &= mask; } /* * Sync the adapter with the software copy of the multicast mask * (logical address filter). */ static void bmac_rx_off(struct device *dev) { unsigned short rx_cfg; rx_cfg = bmread(dev, RXCFG); rx_cfg &= ~RxMACEnable; bmwrite(dev, RXCFG, rx_cfg); do { rx_cfg = bmread(dev, RXCFG); } while (rx_cfg & RxMACEnable); } unsigned short bmac_rx_on(struct device *dev, int hash_enable, int promisc_enable) { unsigned short rx_cfg; rx_cfg = bmread(dev, RXCFG); rx_cfg |= RxMACEnable; if (hash_enable) rx_cfg |= RxHashFilterEnable; else rx_cfg &= ~RxHashFilterEnable; if (promisc_enable) rx_cfg |= RxPromiscEnable; else rx_cfg &= ~RxPromiscEnable; bmwrite(dev, RXRST, RxResetValue); bmwrite(dev, RXFIFOCSR, 0); /* first disable rxFIFO */ bmwrite(dev, RXFIFOCSR, RxFIFOEnable ); bmwrite(dev, RXCFG, rx_cfg ); return rx_cfg; } static void bmac_update_hash_table_mask(struct device *dev, struct bmac_data *bp) { bmwrite(dev, BHASH3, bp->hash_table_mask[0]); /* bits 15 - 0 */ bmwrite(dev, BHASH2, bp->hash_table_mask[1]); /* bits 31 - 16 */ bmwrite(dev, BHASH1, bp->hash_table_mask[2]); /* bits 47 - 32 */ bmwrite(dev, BHASH0, bp->hash_table_mask[3]); /* bits 63 - 48 */ } #if 0 static void bmac_add_multi(struct device *dev, struct bmac_data *bp, unsigned char *addr) { /* XXDEBUG(("bmac: enter bmac_add_multi\n")); */ bmac_addhash(bp, addr); bmac_rx_off(dev); bmac_update_hash_table_mask(dev, bp); bmac_rx_on(dev, 1, (dev->flags & IFF_PROMISC)? 1 : 0); /* XXDEBUG(("bmac: exit bmac_add_multi\n")); */ } static void bmac_remove_multi(struct device *dev, struct bmac_data *bp, unsigned char *addr) { bmac_removehash(bp, addr); bmac_rx_off(dev); bmac_update_hash_table_mask(dev, bp); bmac_rx_on(dev, 1, (dev->flags & IFF_PROMISC)? 1 : 0); } #endif /* Set or clear the multicast filter for this adaptor. num_addrs == -1 Promiscuous mode, receive all packets num_addrs == 0 Normal mode, clear multicast list num_addrs > 0 Multicast mode, receive normal and MC packets, and do best-effort filtering. */ static void bmac_set_multicast(struct device *dev) { struct dev_mc_list *dmi; struct bmac_data *bp = (struct bmac_data *) dev->priv; int num_addrs = dev->mc_count; unsigned short rx_cfg; int i; XXDEBUG(("bmac: enter bmac_set_multicast, n_addrs=%d\n", num_addrs)); if((dev->flags & IFF_ALLMULTI) || (dev->mc_count > 64)) { for (i=0; i<4; i++) bp->hash_table_mask[i] = 0xffff; bmac_update_hash_table_mask(dev, bp); rx_cfg = bmac_rx_on(dev, 1, 0); XXDEBUG(("bmac: all multi, rx_cfg=%#08x\n")); } else if if ((dev->flags & IFF_PROMISC) || (num_addrs < 0)) { rx_cfg = bmread(dev, RXCFG); rx_cfg |= RxPromiscEnable; bmwrite(dev, RXCFG, rx_cfg); rx_cfg = bmac_rx_on(dev, 0, 1); XXDEBUG(("bmac: promisc mode enabled, rx_cfg=%#08x\n", rx_cfg)); } else { for (i=0; i<4; i++) bp->hash_table_mask[i] = 0; for (i=0; i<64; i++) bp->hash_use_count[i] = 0; if (num_addrs == 0) { rx_cfg = bmac_rx_on(dev, 0, 0); XXDEBUG(("bmac: multi disabled, rx_cfg=%#08x\n", rx_cfg)); } else { for (dmi=dev->mc_list; dmi!=NULL; dmi=dmi->next) bmac_addhash(bp, dmi->dmi_addr); bmac_update_hash_table_mask(dev, bp); rx_cfg = bmac_rx_on(dev, 1, 0); XXDEBUG(("bmac: multi enabled, rx_cfg=%#08x\n", rx_cfg)); } } /* XXDEBUG(("bmac: exit bmac_set_multicast\n")); */ } #endif /* The version of set_multicast below was lifted from sunhme.c */ #define CRC_POLYNOMIAL_BE 0x04c11db7UL /* Ethernet CRC, big endian */ #define CRC_POLYNOMIAL_LE 0xedb88320UL /* Ethernet CRC, little endian */ static void bmac_set_multicast(struct device *dev) { struct dev_mc_list *dmi = dev->mc_list; char *addrs; int i, j, bit, byte; unsigned short rx_cfg; u32 crc, poly = CRC_POLYNOMIAL_LE; /* Let the transmits drain. */ /* while(dev->tbusy) schedule(); */ /* Lock out others. */ /* set_bit(0, (void *) &dev->tbusy); */ if((dev->flags & IFF_ALLMULTI) || (dev->mc_count > 64)) { bmwrite(dev, BHASH0, 0xffff); bmwrite(dev, BHASH1, 0xffff); bmwrite(dev, BHASH2, 0xffff); bmwrite(dev, BHASH3, 0xffff); } else if(dev->flags & IFF_PROMISC) { rx_cfg = bmread(dev, RXCFG); rx_cfg |= RxPromiscEnable; bmwrite(dev, RXCFG, rx_cfg); } else { u16 hash_table[4]; for(i = 0; i < 4; i++) hash_table[i] = 0; for(i = 0; i < dev->mc_count; i++) { addrs = dmi->dmi_addr; dmi = dmi->next; if(!(*addrs & 1)) continue; crc = 0xffffffffU; for(byte = 0; byte < 6; byte++) { for(bit = *addrs++, j = 0; j < 8; j++, bit >>= 1) { int test; test = ((bit ^ crc) & 0x01); crc >>= 1; if(test) crc = crc ^ poly; } } crc >>= 26; hash_table[crc >> 4] |= 1 << (crc & 0xf); } bmwrite(dev, BHASH0, hash_table[0]); bmwrite(dev, BHASH1, hash_table[1]); bmwrite(dev, BHASH2, hash_table[2]); bmwrite(dev, BHASH3, hash_table[3]); } /* Let us get going again. */ /* dev->tbusy = 0; */ } static int miscintcount = 0; static void bmac_misc_intr(int irq, void *dev_id, struct pt_regs *regs) { struct device *dev = (struct device *) dev_id; struct bmac_data *bp = (struct bmac_data *)dev->priv; unsigned int status = bmread(dev, STATUS); if (miscintcount++ < 10) { XXDEBUG(("bmac_misc_intr\n")); } /* XXDEBUG(("bmac_misc_intr, status=%#08x\n", status)); */ /* bmac_txdma_intr_inner(irq, dev_id, regs); */ /* if (status & FrameReceived) bp->stats.rx_dropped++; */ if (status & RxErrorMask) bp->stats.rx_errors++; if (status & RxCRCCntExp) bp->stats.rx_crc_errors++; if (status & RxLenCntExp) bp->stats.rx_length_errors++; if (status & RxOverFlow) bp->stats.rx_over_errors++; if (status & RxAlignCntExp) bp->stats.rx_frame_errors++; /* if (status & FrameSent) bp->stats.tx_dropped++; */ if (status & TxErrorMask) bp->stats.tx_errors++; if (status & TxUnderrun) bp->stats.tx_fifo_errors++; if (status & TxNormalCollExp) bp->stats.collisions++; } /* * Procedure for reading EEPROM */ #define SROMAddressLength 5 #define DataInOn 0x0008 #define DataInOff 0x0000 #define Clk 0x0002 #define ChipSelect 0x0001 #define SDIShiftCount 3 #define SD0ShiftCount 2 #define DelayValue 1000 /* number of microseconds */ #define SROMStartOffset 10 /* this is in words */ #define SROMReadCount 3 /* number of words to read from SROM */ #define SROMAddressBits 6 #define EnetAddressOffset 20 static unsigned char bmac_clock_out_bit(struct device *dev) { unsigned short data; unsigned short val; bmwrite(dev, SROMCSR, ChipSelect | Clk); udelay(DelayValue); data = bmread(dev, SROMCSR); udelay(DelayValue); val = (data >> SD0ShiftCount) & 1; bmwrite(dev, SROMCSR, ChipSelect); udelay(DelayValue); return val; } static void bmac_clock_in_bit(struct device *dev, unsigned int val) { unsigned short data; if (val != 0 && val != 1) return; data = (val << SDIShiftCount); bmwrite(dev, SROMCSR, data | ChipSelect ); udelay(DelayValue); bmwrite(dev, SROMCSR, data | ChipSelect | Clk ); udelay(DelayValue); bmwrite(dev, SROMCSR, data | ChipSelect); udelay(DelayValue); } static void reset_and_select_srom(struct device *dev) { /* first reset */ bmwrite(dev, SROMCSR, 0); udelay(DelayValue); /* send it the read command (110) */ bmac_clock_in_bit(dev, 1); bmac_clock_in_bit(dev, 1); bmac_clock_in_bit(dev, 0); } static unsigned short read_srom(struct device *dev, unsigned int addr, unsigned int addr_len) { unsigned short data, val; int i; /* send out the address we want to read from */ for (i = 0; i < addr_len; i++) { val = addr >> (addr_len-i-1); bmac_clock_in_bit(dev, val & 1); } /* Now read in the 16-bit data */ data = 0; for (i = 0; i < 16; i++) { val = bmac_clock_out_bit(dev); data <<= 1; data |= val; } bmwrite(dev, SROMCSR, 0); return data; } /* * It looks like Cogent and SMC use different methods for calculating * checksums. What a pain.. */ static int bmac_verify_checksum(struct device *dev) { unsigned short data, storedCS; reset_and_select_srom(dev); data = read_srom(dev, 3, SROMAddressBits); storedCS = ((data >> 8) & 0x0ff) | ((data << 8) & 0xff00); return 0; } static void bmac_get_station_address(struct device *dev, unsigned char *ea) { int i; unsigned short data; for (i = 0; i < 6; i++) { reset_and_select_srom(dev); data = read_srom(dev, i + EnetAddressOffset/2, SROMAddressBits); ea[2*i] = bitrev(data & 0x0ff); ea[2*i+1] = bitrev((data >> 8) & 0x0ff); } } static int bmac_reset_and_enable(struct device *dev, int enable) { struct bmac_data *bp = dev->priv; unsigned long flags; save_flags(flags); cli(); bp->reset_and_enabled = 0; bmac_reset_chip(dev); if (enable) { if (!bmac_init_tx_ring(bp) || !bmac_init_rx_ring(bp)) return 0; if (!bmac_init_chip(dev)) return 0; bmac_start_chip(dev); bmwrite(dev, INTDISABLE, EnableNormal); bp->reset_and_enabled = 1; /* { */ /* unsigned char random_packet[100]; */ /* unsigned int i; */ /* struct sk_buff *skb = dev_alloc_skb(RX_BUFLEN+2); */ /* unsigned char *data = skb_put(skb, sizeof(random_packet)); */ /* XXDEBUG(("transmitting random packet\n")); */ /* for (i = 0; i < sizeof(random_packet); i++) data[i] = i; */ /* bmac_transmit_packet(skb, dev); */ /* XXDEBUG(("done transmitting random packet\n")); */ /* } */ } restore_flags(flags); return 1; } int bmac_probe(struct device *dev) { int j, rev; struct bmac_data *bp; struct device_node *bmacs; unsigned char *addr; bmacs = find_devices("bmac"); if (bmacs == NULL) return ENODEV; bmac_devs = dev; /* KLUDGE!! */ if (bmacs->n_addrs != 3 || bmacs->n_intrs != 3) { printk(KERN_ERR "can't use BMAC %s: expect 3 addrs and 3 intrs\n", bmacs->full_name); return EINVAL; } if (dev == NULL) { dev = init_etherdev(NULL, PRIV_BYTES); bmac_devs = dev; /*KLUDGE!!*/ } else { /* XXX this doesn't look right (but it's never used :-) */ dev->priv = kmalloc(PRIV_BYTES, GFP_KERNEL); if (dev->priv == 0) return -ENOMEM; } dev->base_addr = bmacs->addrs[0].address; dev->irq = bmacs->intrs[0].line; bmwrite(dev, INTDISABLE, DisableAll); if (request_irq(dev->irq, bmac_misc_intr, 0, "BMAC-misc", dev)) { printk(KERN_ERR "BMAC: can't get irq %d\n", dev->irq); return -EAGAIN; } if (request_irq(bmacs->intrs[1].line, bmac_txdma_intr, 0, "BMAC-txdma", dev)) { printk(KERN_ERR "BMAC: can't get irq %d\n", bmacs->intrs[1].line); return -EAGAIN; } if (request_irq(bmacs->intrs[2].line, bmac_rxdma_intr, 0, "BMAC-rxdma", dev)) { printk(KERN_ERR "BMAC: can't get irq %d\n", bmacs->intrs[2].line); return -EAGAIN; } addr = get_property(bmacs, "mac-address", NULL); if (addr == NULL) { addr = get_property(bmacs, "local-mac-address", NULL); if (addr == NULL) { printk(KERN_ERR "Can't get mac-address for BMAC at %lx\n", dev->base_addr); return -EAGAIN; } } printk(KERN_INFO "%s: BMAC at", dev->name); rev = addr[0] == 0 && addr[1] == 0xA0; for (j = 0; j < 6; ++j) { dev->dev_addr[j] = rev? bitrev(addr[j]): addr[j]; printk("%c%.2x", (j? ':': ' '), dev->dev_addr[j]); } XXDEBUG((", base_addr=%#0lx", dev->base_addr)); printk("\n"); dev->open = bmac_open; dev->stop = bmac_close; dev->hard_start_xmit = bmac_output; dev->get_stats = bmac_stats; dev->set_multicast_list = bmac_set_multicast; dev->set_mac_address = bmac_set_address; bmac_get_station_address(dev, addr); if (bmac_verify_checksum(dev) != 0) return EINVAL; ether_setup(dev); bp = (struct bmac_data *) dev->priv; memset(bp, 0, sizeof(struct bmac_data)); bp->tx_dma = (volatile struct dbdma_regs *) bmacs->addrs[1].address; bp->tx_dma_intr = bmacs->intrs[1].line; bp->rx_dma = (volatile struct dbdma_regs *) bmacs->addrs[2].address; bp->rx_dma_intr = bmacs->intrs[2].line; bp->tx_cmds = (volatile struct dbdma_cmd *) DBDMA_ALIGN(bp + 1); bp->rx_cmds = bp->tx_cmds + N_TX_RING + 1; bp->queue = (struct sk_buff_head *)(bp->rx_cmds + N_RX_RING + 1); skb_queue_head_init(bp->queue); memset(&bp->stats, 0, sizeof(bp->stats)); memset((char *) bp->tx_cmds, 0, (N_TX_RING + N_RX_RING + 2) * sizeof(struct dbdma_cmd)); /* init_timer(&bp->tx_timeout); */ /* bp->timeout_active = 0; */ if (!bmac_reset_and_enable(dev, 0)) return EINVAL; #ifdef CONFIG_PROC_FS proc_net_register(&(struct proc_dir_entry) { PROC_NET_BMAC, 4, "bmac", S_IFREG | S_IRUGO, 1, 0, 0, 0, &proc_net_inode_operations, bmac_proc_info }); #endif return 0; } static int bmac_open(struct device *dev) { /* XXDEBUG(("bmac: enter open\n")); */ /* reset the chip */ bmac_reset_and_enable(dev, 1); dev->flags |= IFF_UP | IFF_RUNNING; return 0; } static int bmac_close(struct device *dev) { struct bmac_data *bp = (struct bmac_data *) dev->priv; volatile struct dbdma_regs *rd = bp->rx_dma; volatile struct dbdma_regs *td = bp->tx_dma; unsigned short config; int i; dev->flags &= ~(IFF_UP | IFF_RUNNING); /* disable rx and tx */ config = bmread(dev, RXCFG); bmwrite(dev, RXCFG, (config & ~RxMACEnable)); config = bmread(dev, TXCFG); bmwrite(dev, TXCFG, (config & ~TxMACEnable)); bmwrite(dev, INTDISABLE, DisableAll); /* disable all intrs */ /* disable rx and tx dma */ st_le32(&rd->control, DBDMA_CLEAR(RUN|PAUSE|FLUSH|WAKE)); /* clear run bit */ st_le32(&td->control, DBDMA_CLEAR(RUN|PAUSE|FLUSH|WAKE)); /* clear run bit */ /* free some skb's */ XXDEBUG(("bmac: free rx bufs\n")); for (i=0; irx_bufs[i] != NULL) { dev_kfree_skb(bp->rx_bufs[i]); bp->rx_bufs[i] = NULL; } } bp->rx_allocated = 0; XXDEBUG(("bmac: free doubles\n"));/*MEMORY LEAK BELOW!!! FIX!!! */ if (bp->tx_double[0] != NULL) kfree(bp->tx_double[0]); XXDEBUG(("bmac: free tx bufs\n")); for (i = 0; itx_bufs[i] != NULL) { dev_kfree_skb(bp->tx_bufs[i]); bp->tx_bufs[i] = NULL; } } bp->tx_allocated = 0; bp->reset_and_enabled = 0; XXDEBUG(("bmac: all bufs freed\n")); return 0; } static void bmac_start(struct device *dev) { struct bmac_data *bp = dev->priv; int i; struct sk_buff *skb; unsigned long flags; save_flags(flags); cli(); while (1) { i = bp->tx_fill + 1; if (i >= N_TX_RING) i = 0; if (i == bp->tx_empty) break; skb = skb_dequeue(bp->queue); if (skb == NULL) break; bmac_transmit_packet(skb, dev); } restore_flags(flags); } static int bmac_output(struct sk_buff *skb, struct device *dev) { struct bmac_data *bp = dev->priv; skb_queue_tail(bp->queue, skb); bmac_start(dev); return 0; } static void bmac_tx_timeout(unsigned long data) { struct device *dev = (struct device *) data; struct bmac_data *bp = (struct bmac_data *) dev->priv; volatile struct dbdma_regs *td = bp->tx_dma; volatile struct dbdma_regs *rd = bp->rx_dma; volatile struct dbdma_cmd *cp; unsigned long flags; unsigned short config, oldConfig; int i; XXDEBUG(("bmac: tx_timeout called\n")); save_flags(flags); cli(); bp->timeout_active = 0; /* update various counters */ /* bmac_handle_misc_intrs(bp, 0); */ cp = &bp->tx_cmds[bp->tx_empty]; /* XXDEBUG((KERN_DEBUG "bmac: tx dmastat=%x %x runt=%d pr=%x fs=%x fc=%x\n", */ /* ld_le32(&td->status), ld_le16(&cp->xfer_status), bp->tx_bad_runt, */ /* mb->pr, mb->xmtfs, mb->fifofc)); */ /* turn off both tx and rx and reset the chip */ config = bmread(dev, RXCFG); bmwrite(dev, RXCFG, (config & ~RxMACEnable)); config = bmread(dev, TXCFG); bmwrite(dev, TXCFG, (config & ~TxMACEnable)); out_le32(&td->control, DBDMA_CLEAR(RUN|PAUSE|FLUSH|WAKE|ACTIVE|DEAD)); printk(KERN_ERR "bmac: transmit timeout - resetting\n"); bmac_reset_chip(dev); /* restart rx dma */ cp = bus_to_virt(ld_le32(&rd->cmdptr)); out_le32(&rd->control, DBDMA_CLEAR(RUN|PAUSE|FLUSH|WAKE|ACTIVE|DEAD)); out_le16(&cp->xfer_status, 0); out_le32(&rd->cmdptr, virt_to_bus(cp)); out_le32(&rd->control, DBDMA_SET(RUN|WAKE)); /* fix up the transmit side */ XXDEBUG((KERN_DEBUG "bmac: tx empty=%d fill=%d fullup=%d\n", bp->tx_empty, bp->tx_fill, bp->tx_fullup)); i = bp->tx_empty; ++bp->stats.tx_errors; if (i != bp->tx_fill) { dev_kfree_skb(bp->tx_bufs[i]); bp->tx_bufs[i] = NULL; if (++i >= N_TX_RING) i = 0; bp->tx_empty = i; } bp->tx_fullup = 0; dev->tbusy = 0; mark_bh(NET_BH); XXDEBUG((KERN_DEBUG "bmac: clearing tbusy\n")); if (i != bp->tx_fill) { cp = &bp->tx_cmds[i]; out_le16(&cp->xfer_status, 0); out_le16(&cp->command, OUTPUT_LAST); out_le32(&td->cmdptr, virt_to_bus(cp)); out_le32(&td->control, DBDMA_SET(RUN)); /* bmac_set_timeout(dev); */ XXDEBUG((KERN_DEBUG "bmac: starting %d\n", i)); } /* turn it back on */ oldConfig = bmread(dev, RXCFG); bmwrite(dev, RXCFG, oldConfig | RxMACEnable ); oldConfig = bmread(dev, TXCFG); bmwrite(dev, TXCFG, oldConfig | TxMACEnable ); restore_flags(flags); } #if 0 static void dump_dbdma(volatile struct dbdma_cmd *cp,int count) { int i,*ip; for (i=0;i< count;i++) { ip = (int*)(cp+i); printk("dbdma req 0x%x addr 0x%x baddr 0x%x xfer/res 0x%x\n", ld_le32(ip+0), ld_le32(ip+1), ld_le32(ip+2), ld_le32(ip+3)); } } #endif static int bmac_proc_info ( char *buffer, char **start, off_t offset, int length, int dummy) { int len = 0; off_t pos = 0; off_t begin = 0; int i; if (bmac_devs == NULL) return (-ENOSYS); len += sprintf(buffer, "BMAC counters & registers\n"); for (i = 0; i offset+length) break; } *start = buffer + (offset - begin); len -= (offset - begin); if (len > length) len = length; return len; }