/* * Linux device driver for * Broadcom BCM47XX 10/100 Mbps Ethernet Controller * * Copyright 2007, Broadcom Corporation * All Rights Reserved. * * This is UNPUBLISHED PROPRIETARY SOURCE CODE of Broadcom Corporation; * the contents of this file may not be disclosed to third parties, copied * or duplicated in any form, in whole or in part, without the prior * written permission of Broadcom Corporation. * * $Id: et_linux.c,v 1.1.1.1 2008/07/21 09:14:16 james26_jang Exp $ */ #define __UNDEF_NO_VERSION__ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #ifdef SIOCETHTOOL #include #endif /* SIOCETHTOOL */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include typedef struct et_info { etc_info_t *etc; /* pointer to common os-independent data */ struct net_device *dev; /* backpoint to device */ struct pci_dev *pdev; /* backpoint to pci_dev */ void *osh; /* pointer to os handle */ spinlock_t lock; /* per-device perimeter lock */ struct sk_buff_head txq; /* send queue */ void *regsva; /* opaque chip registers virtual address */ struct timer_list timer; /* one second watchdog timer */ struct net_device_stats stats; /* stat counter reporting structure */ int events; /* bit channel between isr and dpc */ struct tasklet_struct tasklet; /* dpc tasklet */ struct et_info *next; /* pointer to next et_info_t in chain */ bool resched; /* dpc was rescheduled */ } et_info_t; static int et_found = 0; static et_info_t *et_list = NULL; /* defines */ #define DATAHIWAT 50 /* data msg txq hiwat mark */ #define ET_INFO(dev) (et_info_t*)((dev)->priv) #define ET_LOCK(et) spin_lock_bh(&(et)->lock) #define ET_UNLOCK(et) spin_unlock_bh(&(et)->lock) #define INT_LOCK(flags) local_irq_save(flags) #define INT_UNLOCK(flags) local_irq_restore(flags) #if LINUX_VERSION_CODE <= KERNEL_VERSION(2, 4, 5) #error Linux version must be newer than 2.4.5 #endif /* LINUX_VERSION_CODE <= KERNEL_VERSION(2, 4, 5) */ /* prototypes called by etc.c */ void et_init(et_info_t *et); void et_reset(et_info_t *et); void et_link_up(et_info_t *et); void et_link_down(et_info_t *et); void et_up(et_info_t *et); void et_down(et_info_t *et, int reset); void et_dump(et_info_t *et, struct bcmstrbuf *b); unsigned int etc_arl_dump(etc_info_t *etc, char *buffer, int maxno); /* local prototypes */ static void et_free(et_info_t *et); static int et_open(struct net_device *dev); static int et_close(struct net_device *dev); static int et_start(struct sk_buff *skb, struct net_device *dev); static void et_sendnext(et_info_t *et); static struct net_device_stats *et_get_stats(struct net_device *dev); static int et_set_mac_address(struct net_device *dev, void *addr); static void et_set_multicast_list(struct net_device *dev); static void et_watchdog(ulong data); static int et_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd); static irqreturn_t et_isr(int irq, void *dev_id, struct pt_regs *ptregs); static void et_dpc(ulong data); static void et_sendup(et_info_t *et, struct sk_buff *skb); /* recognized PCI IDs */ static struct pci_device_id et_id_table[] __devinitdata = { { vendor: PCI_ANY_ID, device: PCI_ANY_ID, subvendor: PCI_ANY_ID, subdevice: PCI_ANY_ID, class: PCI_CLASS_NETWORK_ETHERNET << 8, class_mask: 0xffff00, driver_data: 0, }, { 0, } }; et_info_t *et_g=NULL; MODULE_DEVICE_TABLE(pci, et_id_table); static int __devinit et_probe(struct pci_dev *pdev, const struct pci_device_id *ent) { struct net_device *dev; et_info_t *et; osl_t *osh; char name[128]; int unit = et_found; ET_TRACE(("et%d: et_probe: bus %d slot %d func %d irq %d\n", unit, pdev->bus->number, PCI_SLOT(pdev->devfn), PCI_FUNC(pdev->devfn), pdev->irq)); if (!etc_chipmatch(pdev->vendor, pdev->device)) return -ENODEV; osh = osl_attach(pdev, PCI_BUS, FALSE); ASSERT(osh); pci_set_master(pdev); pci_enable_device(pdev); if (!(dev = (struct net_device *) MALLOC(osh, sizeof(struct net_device)))) { ET_ERROR(("et%d: et_probe: out of memory, malloced %d bytes\n", unit, MALLOCED(osh))); osl_detach(osh); return -ENOMEM; } bzero(dev, sizeof(struct net_device)); if (!init_etherdev(dev, 0)) { ET_ERROR(("et%d: et_probe: init_etherdev() failed\n", unit)); MFREE(osh, dev, sizeof(struct net_device)); osl_detach(osh); return -ENOMEM; } /* allocate private info */ if ((et = (et_info_t*) MALLOC(osh, sizeof(et_info_t))) == NULL) { ET_ERROR(("et%d: et_probe: out of memory, malloced %d bytes\n", unit, MALLOCED(osh))); MFREE(osh, dev, sizeof(et_info_t)); osl_detach(osh); return -ENOMEM; } bzero(et, sizeof(et_info_t)); dev->priv = (void*) et; et->dev = dev; et->pdev = pdev; et->osh = osh; pci_set_drvdata(pdev, et); /* map chip registers (47xx: and sprom) */ dev->base_addr = pci_resource_start(pdev, 0); if ((et->regsva = ioremap_nocache(dev->base_addr, PCI_BAR0_WINSZ)) == NULL) { ET_ERROR(("et%d: ioremap() failed\n", unit)); goto fail; } spin_lock_init(&et->lock); skb_queue_head_init(&et->txq); /* common load-time initialization */ if ((et->etc = etc_attach((void*)et, pdev->vendor, pdev->device, unit, osh, et->regsva)) == NULL) { ET_ERROR(("et%d: etc_attach() failed\n", unit)); goto fail; } bcopy(&et->etc->cur_etheraddr, dev->dev_addr, ETHER_ADDR_LEN); /* init 1 second watchdog timer */ init_timer(&et->timer); et->timer.data = (ulong)dev; et->timer.function = et_watchdog; /* setup the bottom half handler */ tasklet_init(&et->tasklet, et_dpc, (ulong)et); /* register our interrupt handler */ if (request_irq(pdev->irq, et_isr, SA_SHIRQ, dev->name, et)) { ET_ERROR(("et%d: request_irq() failed\n", unit)); goto fail; } dev->irq = pdev->irq; /* add us to the global linked list */ et->next = et_list; et_list = et; /* print hello string */ (*et->etc->chops->longname)(et->etc->ch, name, sizeof(name)); printf("%s: %s %s\n", dev->name, name, EPI_VERSION_STR); /* lastly, enable our entry points */ dev->open = et_open; dev->stop = et_close; dev->hard_start_xmit = et_start; dev->get_stats = et_get_stats; dev->set_mac_address = et_set_mac_address; dev->set_multicast_list = et_set_multicast_list; dev->do_ioctl = et_ioctl; if (register_netdev(dev)) { ET_ERROR(("et%d: register_netdev() failed\n", unit)); goto fail; } et_found++; return (0); fail: et_free(et); return (-ENODEV); } static int et_suspend(struct pci_dev *pdev, u32 state) { et_info_t *et; if ((et = (et_info_t *) pci_get_drvdata(pdev))) { netif_device_detach(et->dev); ET_LOCK(et); et_down(et, 1); ET_UNLOCK(et); } return 0; } static int et_resume(struct pci_dev *pdev) { et_info_t *et; if ((et = (et_info_t *) pci_get_drvdata(pdev))) { ET_LOCK(et); et_up(et); ET_UNLOCK(et); netif_device_attach(et->dev); } return 0; } /* Compatibility routines */ #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 4, 6) static void _et_suspend(struct pci_dev *pdev) { et_suspend(pdev, 0); } static void _et_resume(struct pci_dev *pdev) { et_resume(pdev); } #endif /* LINUX_VERSION_CODE < KERNEL_VERSION(2, 4, 6) */ static void __devexit et_remove(struct pci_dev *pdev) { et_info_t *et; if (!etc_chipmatch(pdev->vendor, pdev->device)) return; et_suspend(pdev, 0); if ((et = (et_info_t *) pci_get_drvdata(pdev))) { et_free(et); pci_set_drvdata(pdev, NULL); } } #define TBUFFER_LEN 32 #define TBUFFER_COUNT 96 static int et_arl_get_info(char *buffer, char **start, off_t offset, int length) { int len=0; int size=0; char tbuffer[TBUFFER_LEN*TBUFFER_COUNT]; if(!et_g || !et_g->etc) return 0; len = sprintf(tbuffer,"[MAC Address] [PO][ST][EXT]\n"); /*XX:XX:XX:XX:XX:XX XX XX XX */ size = etc_arl_dump(et_g->etc, tbuffer+len, TBUFFER_COUNT); len += size; len += sprintf(tbuffer+len,"\n"); //printk("arl_get_info start %x %x %x\n", (int)offset, length, len); strncpy(buffer, tbuffer, len+1); //printk("*** test buffer %s. ***\n", buffer); if(offset>len) offset = len; *start = buffer + offset; /* Start of wanted data */ if(offset+length>len) length = len-offset; //printk("arl_get_info %x %x\n", (int)offset, length); //printk("\n%s\n", tbuffer); return length; } static struct pci_driver et_pci_driver = { name: "et", probe: et_probe, #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 4, 6) suspend: _et_suspend, resume: _et_resume, #else suspend: et_suspend, resume: et_resume, #endif /* LINUX_VERSION_CODE < KERNEL_VERSION(2, 4, 6) */ remove: __devexit_p(et_remove), id_table: et_id_table, }; static int __init et_module_init(void) { proc_net_create ("arl", 0, et_arl_get_info); return pci_module_init(&et_pci_driver); } static void __exit et_module_exit(void) { pci_unregister_driver(&et_pci_driver); } module_init(et_module_init); module_exit(et_module_exit); static void et_free(et_info_t *et) { et_info_t **prev; osl_t *osh; if (et == NULL) return; ET_TRACE(("et: et_free\n")); if (et->dev && et->dev->irq) free_irq(et->dev->irq, et); if (et->dev) { unregister_netdev(et->dev); MFREE(et->osh, et->dev, sizeof(struct net_device)); et->dev = NULL; } /* free common resources */ if (et->etc) { etc_detach(et->etc); et->etc = NULL; } /* * unregister_netdev() calls get_stats() which may read chip registers * so we cannot unmap the chip registers until after calling unregister_netdev() . */ if (et->regsva) { iounmap((void*)et->regsva); et->regsva = NULL; } /* remove us from the global linked list */ for (prev = &et_list; *prev; prev = &(*prev)->next) if (*prev == et) { *prev = et->next; break; } osh = et->osh; MFREE(et->osh, et, sizeof(et_info_t)); ASSERT(MALLOCED(osh) == 0); osl_detach(osh); } static int et_open(struct net_device *dev) { et_info_t *et; et = ET_INFO(dev); et_g = et; ET_TRACE(("et%d: et_open\n", et->etc->unit)); et->etc->promisc = (dev->flags & IFF_PROMISC)? TRUE: FALSE; ET_LOCK(et); et_up(et); ET_UNLOCK(et); OLD_MOD_INC_USE_COUNT; return (0); } static int et_close(struct net_device *dev) { et_info_t *et; et = ET_INFO(dev); et_g = NULL; ET_TRACE(("et%d: et_close\n", et->etc->unit)); et->etc->promisc = FALSE; ET_LOCK(et); et_down(et, 1); ET_UNLOCK(et); OLD_MOD_DEC_USE_COUNT; return (0); } /* * Yeah, queueing the packets on a tx queue instead of throwing them * directly into the descriptor ring in the case of dma is kinda lame, * but this results in a unified transmit path for both dma and pio * and localizes/simplifies the netif_*_queue semantics, too. */ static int et_start(struct sk_buff *skb, struct net_device *dev) { et_info_t *et; et = ET_INFO(dev); ET_TRACE(("et%d: et_start: len %d\n", et->etc->unit, skb->len)); ET_LOG("et%d: et_start: len %d", et->etc->unit, skb->len); ET_LOCK(et); /* put it on the tx queue and call sendnext */ skb_queue_tail(&et->txq, skb); et_sendnext(et); ET_UNLOCK(et); ET_LOG("et%d: et_start ret\n", et->etc->unit, 0); return (0); } static void et_sendnext(et_info_t *et) { etc_info_t *etc; struct sk_buff *skb; void *p; etc = et->etc; ET_TRACE(("et%d: et_sendnext\n", etc->unit)); ET_LOG("et%d: et_sendnext", etc->unit, 0); /* dequeue and send each packet */ #ifdef DMA while (*etc->txavail > 0) { #else while (etc->pioactive == NULL) { #endif /* DMA */ if ((skb = skb_dequeue(&et->txq)) == NULL) break; ET_PRHDR("tx", (struct ether_header*) skb->data, skb->len, etc->unit); ET_PRPKT("txpkt", skb->data, skb->len, etc->unit); /* Convert the packet. */ if ((p = PKTFRMNATIVE(et->osh, skb)) == NULL) { dev_kfree_skb_any(skb); return; } (*etc->chops->tx)(etc->ch, p); etc->txframe++; etc->txbyte += skb->len; } /* stop the queue whenever txq fills */ if ((skb_queue_len(&et->txq) > DATAHIWAT) && !netif_queue_stopped(et->dev)) netif_stop_queue(et->dev); else if (netif_queue_stopped(et->dev) && (skb_queue_len(&et->txq) < (DATAHIWAT/2))) { netif_wake_queue(et->dev); } } void et_init(et_info_t *et) { ET_TRACE(("et%d: et_init\n", et->etc->unit)); ET_LOG("et%d: et_init", et->etc->unit, 0); et_reset(et); etc_init(et->etc); } void et_reset(et_info_t *et) { ET_TRACE(("et%d: et_reset\n", et->etc->unit)); etc_reset(et->etc); /* zap any pending dpc interrupt bits */ et->events = 0; /* dpc will not be rescheduled */ et->resched = 0; } void et_up(et_info_t *et) { etc_info_t *etc; etc = et->etc; if (etc->up) return; ET_TRACE(("et%d: et_up\n", etc->unit)); etc_up(etc); /* schedule one second watchdog timer */ et->timer.expires = jiffies + HZ; add_timer(&et->timer); netif_start_queue(et->dev); } void et_down(et_info_t *et, int reset) { etc_info_t *etc; struct sk_buff *skb; etc = et->etc; ET_TRACE(("et%d: et_down\n", etc->unit)); netif_down(et->dev); netif_stop_queue(et->dev); /* stop watchdog timer */ del_timer(&et->timer); etc_down(etc, reset); /* flush the txq */ while ((skb = skb_dequeue(&et->txq))) dev_kfree_skb_any(skb); /* kill dpc */ ET_UNLOCK(et); tasklet_kill(&et->tasklet); ET_LOCK(et); } /* * These are interrupt on/off entry points. Disable interrupts * during interrupt state transition. */ void et_intrson(et_info_t *et) { unsigned long flags; INT_LOCK(flags); (*et->etc->chops->intrson)(et->etc->ch); INT_UNLOCK(flags); } static void et_watchdog(ulong data) { et_info_t *et; et = ET_INFO((struct net_device*)data); ET_LOCK(et); etc_watchdog(et->etc); /* reschedule one second watchdog timer */ et->timer.expires = jiffies + HZ; add_timer(&et->timer); ET_UNLOCK(et); } #ifdef SIOCETHTOOL static int et_ethtool(et_info_t *et, struct ethtool_cmd *ecmd) { int ret = 0; int speed; struct ethtool_drvinfo *info; ET_LOCK(et); switch (ecmd->cmd) { case ETHTOOL_GSET: ecmd->supported = (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full | SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full | SUPPORTED_Autoneg); ecmd->advertising = ADVERTISED_TP; ecmd->advertising |= (et->etc->advertise & ADV_10HALF) ? ADVERTISED_10baseT_Half : 0; ecmd->advertising |= (et->etc->advertise & ADV_10FULL) ? ADVERTISED_10baseT_Full : 0; ecmd->advertising |= (et->etc->advertise & ADV_100HALF) ? ADVERTISED_100baseT_Half : 0; ecmd->advertising |= (et->etc->advertise & ADV_100FULL) ? ADVERTISED_100baseT_Full : 0; if (et->etc->linkstate) { ecmd->speed = (et->etc->speed == 100) ? SPEED_100 : SPEED_10; ecmd->duplex = (et->etc->duplex == 1) ? DUPLEX_FULL : DUPLEX_HALF; } else { ecmd->speed = 0; ecmd->duplex = 0; } ecmd->port = PORT_TP; ecmd->phy_address = 0; ecmd->transceiver = XCVR_INTERNAL; ecmd->autoneg = (et->etc->forcespeed == ET_AUTO) ? AUTONEG_ENABLE : AUTONEG_DISABLE; ecmd->maxtxpkt = 0; ecmd->maxrxpkt = 0; break; case ETHTOOL_SSET: if (!capable(CAP_NET_ADMIN)) { ret = -EPERM; break; } else if (ecmd->speed == SPEED_10 && ecmd->duplex == DUPLEX_HALF) speed = ET_10HALF; else if (ecmd->speed == SPEED_10 && ecmd->duplex == DUPLEX_FULL) speed = ET_10FULL; else if (ecmd->speed == SPEED_100 && ecmd->duplex == DUPLEX_HALF) speed = ET_100HALF; else if (ecmd->speed == SPEED_100 && ecmd->duplex == DUPLEX_FULL) speed = ET_100FULL; else if (ecmd->autoneg == AUTONEG_ENABLE) speed = ET_AUTO; else { ret = -EINVAL; break; } ret = etc_ioctl(et->etc, ETCSPEED, &speed); break; case ETHTOOL_GDRVINFO: info = (struct ethtool_drvinfo *)ecmd; bzero(info, sizeof(struct ethtool_drvinfo)); info->cmd = ETHTOOL_GDRVINFO; sprintf(info->driver, "et%d", et->etc->unit); strcpy(info->version, EPI_VERSION_STR); break; default: ret = -EINVAL; break; } ET_UNLOCK(et); return (ret); } #endif /* SIOCETHTOOL */ static int et_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) { et_info_t *et; int error; char *buf; int size; bool get, set; et = ET_INFO(dev); ET_TRACE(("et%d: et_ioctl: cmd 0x%x\n", et->etc->unit, cmd)); switch (cmd) { #ifdef SIOCETHTOOL case SIOCETHTOOL: if (((struct ethtool_cmd *)ifr->ifr_data)->cmd == ETHTOOL_GDRVINFO) size = sizeof(struct ethtool_drvinfo); else size = sizeof(struct ethtool_cmd); get = TRUE; set = TRUE; break; #endif /* SIOCETHTOOL */ case SIOCGETCDUMP: size = 4096; get = TRUE; set = FALSE; break; case SIOCGETCPHYRD: case SIOCGETCPHYRD2: case SIOCGETCROBORD: size = sizeof(int) * 2; get = TRUE; set = TRUE; break; case SIOCSETCPHYWR: case SIOCSETCPHYWR2: case SIOCSETCROBOWR: size = sizeof(int) * 2; get = FALSE; set = TRUE; break; default: size = sizeof(int); get = FALSE; set = TRUE; break; } if ((buf = MALLOC(et->osh, size)) == NULL) { ET_ERROR(("et: et_ioctl: out of memory, malloced %d bytes\n", MALLOCED(et->osh))); return (-ENOMEM); } if (set && copy_from_user(buf, ifr->ifr_data, size)) { MFREE(et->osh, buf, size); return (-EFAULT); } switch (cmd) { #ifdef SIOCETHTOOL case SIOCETHTOOL: error = et_ethtool(et, (struct ethtool_cmd*)buf); break; #endif /* SIOCETHTOOL */ default: ET_LOCK(et); error = etc_ioctl(et->etc, cmd - SIOCSETCUP, buf) ? -EINVAL : 0; ET_UNLOCK(et); break; } if (!error && get) error = copy_to_user(ifr->ifr_data, buf, size); MFREE(et->osh, buf, size); return (error); } static struct net_device_stats* et_get_stats(struct net_device *dev) { et_info_t *et; etc_info_t *etc; struct net_device_stats *stats; et = ET_INFO(dev); ET_TRACE(("et%d: et_get_stats\n", et->etc->unit)); ET_LOCK(et); etc = et->etc; stats = &et->stats; bzero(stats, sizeof(struct net_device_stats)); /* refresh stats */ if (et->etc->up) (*etc->chops->statsupd)(etc->ch); /* SWAG */ stats->rx_packets = etc->rxframe; stats->tx_packets = etc->txframe; stats->rx_bytes = etc->rxbyte; stats->tx_bytes = etc->txbyte; stats->rx_errors = etc->rxerror; stats->tx_errors = etc->txerror; stats->collisions = etc->mib.tx_total_cols; stats->rx_length_errors = (etc->mib.rx_oversize_pkts + etc->mib.rx_undersize); stats->rx_over_errors = etc->rxoflo; stats->rx_crc_errors = etc->mib.rx_crc_errs; stats->rx_frame_errors = etc->mib.rx_align_errs; stats->rx_fifo_errors = etc->rxoflo; stats->rx_missed_errors = etc->mib.rx_missed_pkts; stats->tx_fifo_errors = etc->txuflo; ET_UNLOCK(et); return (stats); } static int et_set_mac_address(struct net_device *dev, void *addr) { et_info_t *et; struct sockaddr *sa = (struct sockaddr *) addr; et = ET_INFO(dev); ET_TRACE(("et%d: et_set_mac_address\n", et->etc->unit)); if (et->etc->up) return -EBUSY; bcopy(sa->sa_data, dev->dev_addr, ETHER_ADDR_LEN); bcopy(dev->dev_addr, &et->etc->cur_etheraddr, ETHER_ADDR_LEN); return 0; } static void et_set_multicast_list(struct net_device *dev) { et_info_t *et; etc_info_t *etc; struct dev_mc_list *mclist; int i; et = ET_INFO(dev); etc = et->etc; ET_TRACE(("et%d: et_set_multicast_list\n", etc->unit)); ET_LOCK(et); if (etc->up) { etc->promisc = (dev->flags & IFF_PROMISC)? TRUE: FALSE; etc->allmulti = (dev->flags & IFF_ALLMULTI)? TRUE: FALSE; /* copy the list of multicasts into our private table */ for (i = 0, mclist = dev->mc_list; mclist && (i < dev->mc_count); i++, mclist = mclist->next) { if (i >= MAXMULTILIST) { etc->allmulti = TRUE; i = 0; break; } etc->multicast[i] = *((struct ether_addr*) mclist->dmi_addr); } etc->nmulticast = i; et_init(et); } ET_UNLOCK(et); } static irqreturn_t et_isr(int irq, void *dev_id, struct pt_regs *ptregs) { et_info_t *et; struct chops *chops; void *ch; uint events = 0; et = (et_info_t*) dev_id; chops = et->etc->chops; ch = et->etc->ch; /* guard against shared interrupts */ if (!et->etc->up) goto done; /* get interrupt condition bits */ events = (*chops->getintrevents)(ch, TRUE); /* not for us */ if (!(events & INTR_NEW)) goto done; ET_TRACE(("et%d: et_isr: events 0x%x\n", et->etc->unit, events)); ET_LOG("et%d: et_isr: events 0x%x", et->etc->unit, events); /* disable interrupts */ (*chops->intrsoff)(ch); /* save intstatus bits */ ASSERT(et->events == 0); et->events = events; /* schedule dpc */ ASSERT(et->resched == FALSE); tasklet_schedule(&et->tasklet); done: ET_LOG("et%d: et_isr ret", et->etc->unit, 0); return IRQ_RETVAL(events & INTR_NEW); } static void et_dpc(ulong data) { et_info_t *et; struct chops *chops; void *ch; struct sk_buff *skb; void *p; osl_t *osh; et = (et_info_t*) data; chops = et->etc->chops; ch = et->etc->ch; osh = et->etc->osh; ET_TRACE(("et%d: et_dpc: events 0x%x\n", et->etc->unit, et->events)); ET_LOG("et%d: et_dpc: events 0x%x", et->etc->unit, et->events); ET_LOCK(et); if (!et->etc->up) goto done; /* get interrupt condition bits again when dpc was rescheduled */ if (et->resched) { et->events = (*chops->getintrevents)(ch, FALSE); et->resched = FALSE; } if (et->events & INTR_RX) { uint processed = 0; while ((p = (*chops->rx)(ch))) { skb = PKTTONATIVE(osh, p); et_sendup(et, skb); /* more frames, need to reschedule et_dpc() */ if (++processed >= RXBND) { et->resched = TRUE; break; } } /* post more rx bufs */ (*chops->rxfill)(ch); } if (et->events & INTR_TX) (*chops->txreclaim)(ch, FALSE); /* handle error condtions, if reset required leave interrupts off! */ if (et->events & INTR_ERROR) if ((*chops->errors)(ch)) et_init(et); /* run the tx queue */ if (skb_queue_len(&et->txq) > 0) et_sendnext(et); /* clear this before re-enabling interrupts */ et->events = 0; /* something may bring the driver down */ if (!et->etc->up) { et->resched = FALSE; goto done; } /* there may be frames left, reschedule et_dpc() */ if (et->resched) tasklet_schedule(&et->tasklet); /* re-enable interrupts */ else (*chops->intrson)(ch); done: ET_UNLOCK(et); ET_LOG("et%d: et_dpc ret", et->etc->unit, 0); } void et_sendup(et_info_t *et, struct sk_buff *skb) { etc_info_t *etc; bcmenetrxh_t *rxh; uint16 flags; uchar eabuf[32]; etc = et->etc; /* packet buffer starts with rxhdr */ rxh = (bcmenetrxh_t*) skb->data; /* strip off rxhdr */ skb_pull(skb, HWRXOFF); ET_TRACE(("et%d: et_sendup: %d bytes\n", et->etc->unit, skb->len)); ET_LOG("et%d: et_sendup: len %d", et->etc->unit, skb->len); etc->rxframe++; etc->rxbyte += skb->len; /* eh should now be aligned 2-mod-4 */ ASSERT(((uint)skb->data & 3) == 2); /* strip off crc32 */ skb_trim(skb, skb->len - ETHER_CRC_LEN); ET_PRHDR("rx", (struct ether_header*) skb->data, skb->len, etc->unit); ET_PRPKT("rxpkt", skb->data, skb->len, etc->unit); /* check for reported frame errors */ flags = ltoh16(rxh->flags); if (flags & (RXF_NO | RXF_RXER | RXF_CRC | RXF_OV)) goto err; /* Extract priority from payload and store it out-of-band in skb->priority */ if (et->etc->qos) pktsetprio(skb, TRUE); skb->dev = et->dev; skb->protocol = eth_type_trans(skb, et->dev); /* send it up */ netif_rx(skb); ET_LOG("et%d: et_sendup ret", et->etc->unit, 0); return; err: bcm_ether_ntoa((struct ether_addr*)((struct ether_header*)skb->data)->ether_shost, eabuf); if (flags & RXF_NO) { ET_ERROR(("et%d: rx: crc error (odd nibbles) from %s\n", etc->unit, eabuf)); } if (flags & RXF_RXER) { ET_ERROR(("et%d: rx: symbol error from %s\n", etc->unit, eabuf)); } if ((flags & RXF_CRC) == RXF_CRC) { ET_ERROR(("et%d: rx: crc error from %s\n", etc->unit, eabuf)); } if (flags & RXF_OV) { ET_ERROR(("et%d: rx: fifo overflow\n", etc->unit)); } dev_kfree_skb_any(skb); return; } void et_dump(et_info_t *et, struct bcmstrbuf *b) { bcm_bprintf(b, "et%d: %s %s version %s\n", et->etc->unit, __DATE__, __TIME__, EPI_VERSION_STR); } void et_link_up(et_info_t *et) { ET_ERROR(("et%d: link up (%d%s)\n", et->etc->unit, et->etc->speed, (et->etc->duplex? "FD" : "HD"))); } void et_link_down(et_info_t *et) { ET_ERROR(("et%d: link down\n", et->etc->unit)); } /* * 47XX-specific shared mdc/mdio contortion: * Find the et associated with the same chip as * and coreunit matching . */ void* et_phyfind(et_info_t *et, uint coreunit) { et_info_t *tmp; uint bus, slot; bus = et->pdev->bus->number; slot = PCI_SLOT(et->pdev->devfn); /* walk the list et's */ for (tmp = et_list; tmp; tmp = tmp->next) { if (et->etc == NULL) continue; if (tmp->pdev == NULL) continue; if (tmp->pdev->bus->number != bus) continue; if (tmp->etc->nicmode) if (PCI_SLOT(tmp->pdev->devfn) != slot) continue; if (tmp->etc->coreunit != coreunit) continue; break; } return (tmp); } /* shared phy read entry point */ uint16 et_phyrd(et_info_t *et, uint phyaddr, uint reg) { uint16 val; ET_LOCK(et); val = et->etc->chops->phyrd(et->etc->ch, phyaddr, reg); ET_UNLOCK(et); return (val); } /* shared phy write entry point */ void et_phywr(et_info_t *et, uint phyaddr, uint reg, uint16 val) { ET_LOCK(et); et->etc->chops->phywr(et->etc->ch, phyaddr, reg, val); ET_UNLOCK(et); }