sb1250-mac.c

来自「linux 内核源代码」· C语言 代码 · 共 2,649 行 · 第 1/5 页

C
2,649 行
字号
	for (idx = 1; idx < MAC_ADDR_COUNT; idx++) {		port = sc->sbm_base + R_MAC_ADDR_BASE+(idx*sizeof(uint64_t));		__raw_writeq(0, port);	}	for (idx = 0; idx < MAC_HASH_COUNT; idx++) {		port = sc->sbm_base + R_MAC_HASH_BASE+(idx*sizeof(uint64_t));		__raw_writeq(0, port);	}	/*	 * Clear the filter to say we don't want any multicasts.	 */	reg = __raw_readq(sc->sbm_rxfilter);	reg &= ~(M_MAC_MCAST_INV | M_MAC_MCAST_EN);	__raw_writeq(reg, sc->sbm_rxfilter);	if (dev->flags & IFF_ALLMULTI) {		/*		 * Enable ALL multicasts.  Do this by inverting the		 * multicast enable bit.		 */		reg = __raw_readq(sc->sbm_rxfilter);		reg |= (M_MAC_MCAST_INV | M_MAC_MCAST_EN);		__raw_writeq(reg, sc->sbm_rxfilter);		return;	}	/*	 * Progam new multicast entries.  For now, only use the	 * perfect filter.  In the future we'll need to use the	 * hash filter if the perfect filter overflows	 */	/* XXX only using perfect filter for now, need to use hash	 * XXX if the table overflows */	idx = 1;		/* skip station address */	mclist = dev->mc_list;	while (mclist && (idx < MAC_ADDR_COUNT)) {		reg = sbmac_addr2reg(mclist->dmi_addr);		port = sc->sbm_base + R_MAC_ADDR_BASE+(idx * sizeof(uint64_t));		__raw_writeq(reg, port);		idx++;		mclist = mclist->next;	}	/*	 * Enable the "accept multicast bits" if we programmed at least one	 * multicast.	 */	if (idx > 1) {		reg = __raw_readq(sc->sbm_rxfilter);		reg |= M_MAC_MCAST_EN;		__raw_writeq(reg, sc->sbm_rxfilter);	}}#if defined(SBMAC_ETH0_HWADDR) || defined(SBMAC_ETH1_HWADDR) || defined(SBMAC_ETH2_HWADDR) || defined(SBMAC_ETH3_HWADDR)/********************************************************************** *  SBMAC_PARSE_XDIGIT(str) * *  Parse a hex digit, returning its value * *  Input parameters: *  	   str - character * *  Return value: *  	   hex value, or -1 if invalid ********************************************************************* */static int sbmac_parse_xdigit(char str){	int digit;	if ((str >= '0') && (str <= '9'))		digit = str - '0';	else if ((str >= 'a') && (str <= 'f'))		digit = str - 'a' + 10;	else if ((str >= 'A') && (str <= 'F'))		digit = str - 'A' + 10;	else		return -1;	return digit;}/********************************************************************** *  SBMAC_PARSE_HWADDR(str,hwaddr) * *  Convert a string in the form xx:xx:xx:xx:xx:xx into a 6-byte *  Ethernet address. * *  Input parameters: *  	   str - string *  	   hwaddr - pointer to hardware address * *  Return value: *  	   0 if ok, else -1 ********************************************************************* */static int sbmac_parse_hwaddr(char *str, unsigned char *hwaddr){	int digit1,digit2;	int idx = 6;	while (*str && (idx > 0)) {		digit1 = sbmac_parse_xdigit(*str);		if (digit1 < 0)			return -1;		str++;		if (!*str)			return -1;		if ((*str == ':') || (*str == '-')) {			digit2 = digit1;			digit1 = 0;		}		else {			digit2 = sbmac_parse_xdigit(*str);			if (digit2 < 0)				return -1;			str++;		}		*hwaddr++ = (digit1 << 4) | digit2;		idx--;		if (*str == '-')			str++;		if (*str == ':')			str++;	}	return 0;}#endifstatic int sb1250_change_mtu(struct net_device *_dev, int new_mtu){	if (new_mtu >  ENET_PACKET_SIZE)		return -EINVAL;	_dev->mtu = new_mtu;	pr_info("changing the mtu to %d\n", new_mtu);	return 0;}/********************************************************************** *  SBMAC_INIT(dev) * *  Attach routine - init hardware and hook ourselves into linux * *  Input parameters: *  	   dev - net_device structure * *  Return value: *  	   status ********************************************************************* */static int sbmac_init(struct platform_device *pldev, long long base){	struct net_device *dev = pldev->dev.driver_data;	int idx = pldev->id;	struct sbmac_softc *sc = netdev_priv(dev);	unsigned char *eaddr;	uint64_t ea_reg;	int i;	int err;	DECLARE_MAC_BUF(mac);	sc->sbm_dev = dev;	sc->sbe_idx = idx;	eaddr = sc->sbm_hwaddr;	/*	 * Read the ethernet address.  The firwmare left this programmed	 * for us in the ethernet address register for each mac.	 */	ea_reg = __raw_readq(sc->sbm_base + R_MAC_ETHERNET_ADDR);	__raw_writeq(0, sc->sbm_base + R_MAC_ETHERNET_ADDR);	for (i = 0; i < 6; i++) {		eaddr[i] = (uint8_t) (ea_reg & 0xFF);		ea_reg >>= 8;	}	for (i = 0; i < 6; i++) {		dev->dev_addr[i] = eaddr[i];	}	/*	 * Init packet size	 */	sc->sbm_buffersize = ENET_PACKET_SIZE + SMP_CACHE_BYTES * 2 + ETHER_ALIGN;	/*	 * Initialize context (get pointers to registers and stuff), then	 * allocate the memory for the descriptor tables.	 */	sbmac_initctx(sc);	/*	 * Set up Linux device callins	 */	spin_lock_init(&(sc->sbm_lock));	dev->open               = sbmac_open;	dev->hard_start_xmit    = sbmac_start_tx;	dev->stop               = sbmac_close;	dev->set_multicast_list = sbmac_set_rx_mode;	dev->do_ioctl           = sbmac_mii_ioctl;	dev->tx_timeout         = sbmac_tx_timeout;	dev->watchdog_timeo     = TX_TIMEOUT;	netif_napi_add(dev, &sc->napi, sbmac_poll, 16);	dev->change_mtu         = sb1250_change_mtu;#ifdef CONFIG_NET_POLL_CONTROLLER	dev->poll_controller = sbmac_netpoll;#endif	dev->irq		= UNIT_INT(idx);	/* This is needed for PASS2 for Rx H/W checksum feature */	sbmac_set_iphdr_offset(sc);	err = register_netdev(dev);	if (err) {		printk(KERN_ERR "%s.%d: unable to register netdev\n",		       sbmac_string, idx);		sbmac_uninitctx(sc);		return err;	}	pr_info("%s.%d: registered as %s\n", sbmac_string, idx, dev->name);	if (sc->rx_hw_checksum == ENABLE)		pr_info("%s: enabling TCP rcv checksum\n", dev->name);	/*	 * Display Ethernet address (this is called during the config	 * process so we need to finish off the config message that	 * was being displayed)	 */	pr_info("%s: SiByte Ethernet at 0x%08Lx, address: %s\n",	       dev->name, base, print_mac(mac, eaddr));	sc->mii_bus.name = sbmac_mdio_string;	sc->mii_bus.id = idx;	sc->mii_bus.priv = sc;	sc->mii_bus.read = sbmac_mii_read;	sc->mii_bus.write = sbmac_mii_write;	sc->mii_bus.irq = sc->phy_irq;	for (i = 0; i < PHY_MAX_ADDR; ++i)		sc->mii_bus.irq[i] = SBMAC_PHY_INT;	sc->mii_bus.dev = &pldev->dev;	dev_set_drvdata(&pldev->dev, &sc->mii_bus);	return 0;}static int sbmac_open(struct net_device *dev){	struct sbmac_softc *sc = netdev_priv(dev);	int err;	if (debug > 1)		pr_debug("%s: sbmac_open() irq %d.\n", dev->name, dev->irq);	/*	 * map/route interrupt (clear status first, in case something	 * weird is pending; we haven't initialized the mac registers	 * yet)	 */	__raw_readq(sc->sbm_isr);	err = request_irq(dev->irq, &sbmac_intr, IRQF_SHARED, dev->name, dev);	if (err) {		printk(KERN_ERR "%s: unable to get IRQ %d\n", dev->name,		       dev->irq);		goto out_err;	}	/*	 * Probe PHY address	 */	err = mdiobus_register(&sc->mii_bus);	if (err) {		printk(KERN_ERR "%s: unable to register MDIO bus\n",		       dev->name);		goto out_unirq;	}	sc->sbm_speed = sbmac_speed_none;	sc->sbm_duplex = sbmac_duplex_none;	sc->sbm_fc = sbmac_fc_none;	sc->sbm_pause = -1;	sc->sbm_link = 0;	/*	 * Attach to the PHY	 */	err = sbmac_mii_probe(dev);	if (err)		goto out_unregister;	/*	 * Turn on the channel	 */	sbmac_set_channel_state(sc,sbmac_state_on);	netif_start_queue(dev);	sbmac_set_rx_mode(dev);	phy_start(sc->phy_dev);	napi_enable(&sc->napi);	return 0;out_unregister:	mdiobus_unregister(&sc->mii_bus);out_unirq:	free_irq(dev->irq, dev);out_err:	return err;}static int sbmac_mii_probe(struct net_device *dev){	struct sbmac_softc *sc = netdev_priv(dev);	struct phy_device *phy_dev;	int i;	for (i = 0; i < PHY_MAX_ADDR; i++) {		phy_dev = sc->mii_bus.phy_map[i];		if (phy_dev)			break;	}	if (!phy_dev) {		printk(KERN_ERR "%s: no PHY found\n", dev->name);		return -ENXIO;	}	phy_dev = phy_connect(dev, phy_dev->dev.bus_id, &sbmac_mii_poll, 0,			      PHY_INTERFACE_MODE_GMII);	if (IS_ERR(phy_dev)) {		printk(KERN_ERR "%s: could not attach to PHY\n", dev->name);		return PTR_ERR(phy_dev);	}	/* Remove any features not supported by the controller */	phy_dev->supported &= SUPPORTED_10baseT_Half |			      SUPPORTED_10baseT_Full |			      SUPPORTED_100baseT_Half |			      SUPPORTED_100baseT_Full |			      SUPPORTED_1000baseT_Half |			      SUPPORTED_1000baseT_Full |			      SUPPORTED_Autoneg |			      SUPPORTED_MII |			      SUPPORTED_Pause |			      SUPPORTED_Asym_Pause;	phy_dev->advertising = phy_dev->supported;	pr_info("%s: attached PHY driver [%s] (mii_bus:phy_addr=%s, irq=%d)\n",		dev->name, phy_dev->drv->name,		phy_dev->dev.bus_id, phy_dev->irq);	sc->phy_dev = phy_dev;	return 0;}static void sbmac_mii_poll(struct net_device *dev){	struct sbmac_softc *sc = netdev_priv(dev);	struct phy_device *phy_dev = sc->phy_dev;	unsigned long flags;	enum sbmac_fc fc;	int link_chg, speed_chg, duplex_chg, pause_chg, fc_chg;	link_chg = (sc->sbm_link != phy_dev->link);	speed_chg = (sc->sbm_speed != phy_dev->speed);	duplex_chg = (sc->sbm_duplex != phy_dev->duplex);	pause_chg = (sc->sbm_pause != phy_dev->pause);	if (!link_chg && !speed_chg && !duplex_chg && !pause_chg)		return;					/* Hmmm... */	if (!phy_dev->link) {		if (link_chg) {			sc->sbm_link = phy_dev->link;			sc->sbm_speed = sbmac_speed_none;			sc->sbm_duplex = sbmac_duplex_none;			sc->sbm_fc = sbmac_fc_disabled;			sc->sbm_pause = -1;			pr_info("%s: link unavailable\n", dev->name);		}		return;	}	if (phy_dev->duplex == DUPLEX_FULL) {		if (phy_dev->pause)			fc = sbmac_fc_frame;		else			fc = sbmac_fc_disabled;	} else		fc = sbmac_fc_collision;	fc_chg = (sc->sbm_fc != fc);	pr_info("%s: link available: %dbase-%cD\n", dev->name, phy_dev->speed,		phy_dev->duplex == DUPLEX_FULL ? 'F' : 'H');	spin_lock_irqsave(&sc->sbm_lock, flags);	sc->sbm_speed = phy_dev->speed;	sc->sbm_duplex = phy_dev->duplex;	sc->sbm_fc = fc;	sc->sbm_pause = phy_dev->pause;	sc->sbm_link = phy_dev->link;	if ((speed_chg || duplex_chg || fc_chg) &&	    sc->sbm_state != sbmac_state_off) {		/*		 * something changed, restart the channel		 */		if (debug > 1)			pr_debug("%s: restarting channel "				 "because PHY state changed\n", dev->name);		sbmac_channel_stop(sc);		sbmac_channel_start(sc);	}	spin_unlock_irqrestore(&sc->sbm_lock, flags);}static void sbmac_tx_timeout (struct net_device *dev){	struct sbmac_softc *sc = netdev_priv(dev);	spin_lock_irq (&sc->sbm_lock);	dev->trans_start = jiffies;	dev->stats.tx_errors++;	spin_unlock_irq (&sc->sbm_lock);	printk (KERN_WARNING "%s: Transmit timed out\n",dev->name);}static void sbmac_set_rx_mode(struct net_device *dev){	unsigned long flags;	struct sbmac_softc *sc = netdev_priv(dev);	spin_lock_irqsave(&sc->sbm_lock, flags);	if ((dev->flags ^ sc->sbm_devflags) & IFF_PROMISC) {		/*		 * Promiscuous changed.		 */		if (dev->flags & IFF_PROMISC) {			sbmac_promiscuous_mode(sc,1);		}		else {			sbmac_promiscuous_mode(sc,0);		}	}	spin_unlock_irqrestore(&sc->sbm_lock, flags);	/*	 * Program the multicasts.  Do this every time.	 */	sbmac_setmulti(sc);}static int sbmac_mii_ioctl(struct net_device *dev, struct ifreq *rq, int cmd){	struct sbmac_softc *sc = netdev_priv(dev);	if (!netif_running(dev) || !sc->phy_dev)		return -EINVAL;	return phy_mii_ioctl(sc->phy_dev, if_mii(rq), cmd);}static int sbmac_close(struct net_device *dev){	struct sbmac_softc *sc = netdev_priv(dev);	napi_disable(&sc->napi);	phy_stop(sc->phy_dev);	sbmac_set_channel_state(sc, sbmac_state_off);	netif_stop_queue(dev);	if (debug > 1)		pr_debug("%s: Shutting down ethercard\n", dev->name);	phy_disconnect(sc->phy_dev);	sc->phy_dev = NULL;	mdiobus_unregister(&sc->mii_bus);	free_irq(dev-

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?