| /* | |
| * SuperH Ethernet device driver | |
| * | |
| * Copyright (C) 2006-2008 Nobuhiro Iwamatsu | |
| * Copyright (C) 2008 Renesas Solutions Corp. | |
| * | |
| * This program is free software; you can redistribute it and/or modify it | |
| * under the terms and conditions of the GNU General Public License, | |
| * version 2, as published by the Free Software Foundation. | |
| * | |
| * This program is distributed in the hope it will be useful, but WITHOUT | |
| * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
| * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
| * more details. | |
| * You should have received a copy of the GNU General Public License along with | |
| * this program; if not, write to the Free Software Foundation, Inc., | |
| * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. | |
| * | |
| * The full GNU General Public License is included in this distribution in | |
| * the file called "COPYING". | |
| */ | |
| #include <linux/init.h> | |
| #include <linux/dma-mapping.h> | |
| #include <linux/etherdevice.h> | |
| #include <linux/delay.h> | |
| #include <linux/platform_device.h> | |
| #include <linux/mdio-bitbang.h> | |
| #include <linux/netdevice.h> | |
| #include <linux/phy.h> | |
| #include <linux/cache.h> | |
| #include <linux/io.h> | |
| #include "sh_eth.h" | |
| /* CPU <-> EDMAC endian convert */ | |
| static inline __u32 cpu_to_edmac(struct sh_eth_private *mdp, u32 x) | |
| { | |
| switch (mdp->edmac_endian) { | |
| case EDMAC_LITTLE_ENDIAN: | |
| return cpu_to_le32(x); | |
| case EDMAC_BIG_ENDIAN: | |
| return cpu_to_be32(x); | |
| } | |
| return x; | |
| } | |
| static inline __u32 edmac_to_cpu(struct sh_eth_private *mdp, u32 x) | |
| { | |
| switch (mdp->edmac_endian) { | |
| case EDMAC_LITTLE_ENDIAN: | |
| return le32_to_cpu(x); | |
| case EDMAC_BIG_ENDIAN: | |
| return be32_to_cpu(x); | |
| } | |
| return x; | |
| } | |
| /* | |
| * Program the hardware MAC address from dev->dev_addr. | |
| */ | |
| static void update_mac_address(struct net_device *ndev) | |
| { | |
| u32 ioaddr = ndev->base_addr; | |
| ctrl_outl((ndev->dev_addr[0] << 24) | (ndev->dev_addr[1] << 16) | | |
| (ndev->dev_addr[2] << 8) | (ndev->dev_addr[3]), | |
| ioaddr + MAHR); | |
| ctrl_outl((ndev->dev_addr[4] << 8) | (ndev->dev_addr[5]), | |
| ioaddr + MALR); | |
| } | |
| /* | |
| * Get MAC address from SuperH MAC address register | |
| * | |
| * SuperH's Ethernet device doesn't have 'ROM' to MAC address. | |
| * This driver get MAC address that use by bootloader(U-boot or sh-ipl+g). | |
| * When you want use this device, you must set MAC address in bootloader. | |
| * | |
| */ | |
| static void read_mac_address(struct net_device *ndev) | |
| { | |
| u32 ioaddr = ndev->base_addr; | |
| ndev->dev_addr[0] = (ctrl_inl(ioaddr + MAHR) >> 24); | |
| ndev->dev_addr[1] = (ctrl_inl(ioaddr + MAHR) >> 16) & 0xFF; | |
| ndev->dev_addr[2] = (ctrl_inl(ioaddr + MAHR) >> 8) & 0xFF; | |
| ndev->dev_addr[3] = (ctrl_inl(ioaddr + MAHR) & 0xFF); | |
| ndev->dev_addr[4] = (ctrl_inl(ioaddr + MALR) >> 8) & 0xFF; | |
| ndev->dev_addr[5] = (ctrl_inl(ioaddr + MALR) & 0xFF); | |
| } | |
| struct bb_info { | |
| struct mdiobb_ctrl ctrl; | |
| u32 addr; | |
| u32 mmd_msk;/* MMD */ | |
| u32 mdo_msk; | |
| u32 mdi_msk; | |
| u32 mdc_msk; | |
| }; | |
| /* PHY bit set */ | |
| static void bb_set(u32 addr, u32 msk) | |
| { | |
| ctrl_outl(ctrl_inl(addr) | msk, addr); | |
| } | |
| /* PHY bit clear */ | |
| static void bb_clr(u32 addr, u32 msk) | |
| { | |
| ctrl_outl((ctrl_inl(addr) & ~msk), addr); | |
| } | |
| /* PHY bit read */ | |
| static int bb_read(u32 addr, u32 msk) | |
| { | |
| return (ctrl_inl(addr) & msk) != 0; | |
| } | |
| /* Data I/O pin control */ | |
| static void sh_mmd_ctrl(struct mdiobb_ctrl *ctrl, int bit) | |
| { | |
| struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl); | |
| if (bit) | |
| bb_set(bitbang->addr, bitbang->mmd_msk); | |
| else | |
| bb_clr(bitbang->addr, bitbang->mmd_msk); | |
| } | |
| /* Set bit data*/ | |
| static void sh_set_mdio(struct mdiobb_ctrl *ctrl, int bit) | |
| { | |
| struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl); | |
| if (bit) | |
| bb_set(bitbang->addr, bitbang->mdo_msk); | |
| else | |
| bb_clr(bitbang->addr, bitbang->mdo_msk); | |
| } | |
| /* Get bit data*/ | |
| static int sh_get_mdio(struct mdiobb_ctrl *ctrl) | |
| { | |
| struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl); | |
| return bb_read(bitbang->addr, bitbang->mdi_msk); | |
| } | |
| /* MDC pin control */ | |
| static void sh_mdc_ctrl(struct mdiobb_ctrl *ctrl, int bit) | |
| { | |
| struct bb_info *bitbang = container_of(ctrl, struct bb_info, ctrl); | |
| if (bit) | |
| bb_set(bitbang->addr, bitbang->mdc_msk); | |
| else | |
| bb_clr(bitbang->addr, bitbang->mdc_msk); | |
| } | |
| /* mdio bus control struct */ | |
| static struct mdiobb_ops bb_ops = { | |
| .owner = THIS_MODULE, | |
| .set_mdc = sh_mdc_ctrl, | |
| .set_mdio_dir = sh_mmd_ctrl, | |
| .set_mdio_data = sh_set_mdio, | |
| .get_mdio_data = sh_get_mdio, | |
| }; | |
| /* Chip Reset */ | |
| static void sh_eth_reset(struct net_device *ndev) | |
| { | |
| u32 ioaddr = ndev->base_addr; | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| int cnt = 100; | |
| ctrl_outl(EDSR_ENALL, ioaddr + EDSR); | |
| ctrl_outl(ctrl_inl(ioaddr + EDMR) | EDMR_SRST, ioaddr + EDMR); | |
| while (cnt > 0) { | |
| if (!(ctrl_inl(ioaddr + EDMR) & 0x3)) | |
| break; | |
| mdelay(1); | |
| cnt--; | |
| } | |
| if (cnt < 0) | |
| printk(KERN_ERR "Device reset fail\n"); | |
| /* Table Init */ | |
| ctrl_outl(0x0, ioaddr + TDLAR); | |
| ctrl_outl(0x0, ioaddr + TDFAR); | |
| ctrl_outl(0x0, ioaddr + TDFXR); | |
| ctrl_outl(0x0, ioaddr + TDFFR); | |
| ctrl_outl(0x0, ioaddr + RDLAR); | |
| ctrl_outl(0x0, ioaddr + RDFAR); | |
| ctrl_outl(0x0, ioaddr + RDFXR); | |
| ctrl_outl(0x0, ioaddr + RDFFR); | |
| #else | |
| ctrl_outl(ctrl_inl(ioaddr + EDMR) | EDMR_SRST, ioaddr + EDMR); | |
| mdelay(3); | |
| ctrl_outl(ctrl_inl(ioaddr + EDMR) & ~EDMR_SRST, ioaddr + EDMR); | |
| #endif | |
| } | |
| /* free skb and descriptor buffer */ | |
| static void sh_eth_ring_free(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| int i; | |
| /* Free Rx skb ringbuffer */ | |
| if (mdp->rx_skbuff) { | |
| for (i = 0; i < RX_RING_SIZE; i++) { | |
| if (mdp->rx_skbuff[i]) | |
| dev_kfree_skb(mdp->rx_skbuff[i]); | |
| } | |
| } | |
| kfree(mdp->rx_skbuff); | |
| /* Free Tx skb ringbuffer */ | |
| if (mdp->tx_skbuff) { | |
| for (i = 0; i < TX_RING_SIZE; i++) { | |
| if (mdp->tx_skbuff[i]) | |
| dev_kfree_skb(mdp->tx_skbuff[i]); | |
| } | |
| } | |
| kfree(mdp->tx_skbuff); | |
| } | |
| /* format skb and descriptor buffer */ | |
| static void sh_eth_ring_format(struct net_device *ndev) | |
| { | |
| u32 ioaddr = ndev->base_addr, reserve = 0; | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| int i; | |
| struct sk_buff *skb; | |
| struct sh_eth_rxdesc *rxdesc = NULL; | |
| struct sh_eth_txdesc *txdesc = NULL; | |
| int rx_ringsize = sizeof(*rxdesc) * RX_RING_SIZE; | |
| int tx_ringsize = sizeof(*txdesc) * TX_RING_SIZE; | |
| mdp->cur_rx = mdp->cur_tx = 0; | |
| mdp->dirty_rx = mdp->dirty_tx = 0; | |
| memset(mdp->rx_ring, 0, rx_ringsize); | |
| /* build Rx ring buffer */ | |
| for (i = 0; i < RX_RING_SIZE; i++) { | |
| /* skb */ | |
| mdp->rx_skbuff[i] = NULL; | |
| skb = dev_alloc_skb(mdp->rx_buf_sz); | |
| mdp->rx_skbuff[i] = skb; | |
| if (skb == NULL) | |
| break; | |
| skb->dev = ndev; /* Mark as being used by this device. */ | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| reserve = SH7763_SKB_ALIGN | |
| - ((uint32_t)skb->data & (SH7763_SKB_ALIGN-1)); | |
| if (reserve) | |
| skb_reserve(skb, reserve); | |
| #else | |
| skb_reserve(skb, RX_OFFSET); | |
| #endif | |
| /* RX descriptor */ | |
| rxdesc = &mdp->rx_ring[i]; | |
| rxdesc->addr = (u32)skb->data & ~0x3UL; | |
| rxdesc->status = cpu_to_edmac(mdp, RD_RACT | RD_RFP); | |
| /* The size of the buffer is 16 byte boundary. */ | |
| rxdesc->buffer_length = (mdp->rx_buf_sz + 16) & ~0x0F; | |
| /* Rx descriptor address set */ | |
| if (i == 0) { | |
| ctrl_outl((u32)rxdesc, ioaddr + RDLAR); | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| ctrl_outl((u32)rxdesc, ioaddr + RDFAR); | |
| #endif | |
| } | |
| } | |
| /* Rx descriptor address set */ | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| ctrl_outl((u32)rxdesc, ioaddr + RDFXR); | |
| ctrl_outl(0x1, ioaddr + RDFFR); | |
| #endif | |
| mdp->dirty_rx = (u32) (i - RX_RING_SIZE); | |
| /* Mark the last entry as wrapping the ring. */ | |
| rxdesc->status |= cpu_to_edmac(mdp, RD_RDEL); | |
| memset(mdp->tx_ring, 0, tx_ringsize); | |
| /* build Tx ring buffer */ | |
| for (i = 0; i < TX_RING_SIZE; i++) { | |
| mdp->tx_skbuff[i] = NULL; | |
| txdesc = &mdp->tx_ring[i]; | |
| txdesc->status = cpu_to_edmac(mdp, TD_TFP); | |
| txdesc->buffer_length = 0; | |
| if (i == 0) { | |
| /* Tx descriptor address set */ | |
| ctrl_outl((u32)txdesc, ioaddr + TDLAR); | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| ctrl_outl((u32)txdesc, ioaddr + TDFAR); | |
| #endif | |
| } | |
| } | |
| /* Tx descriptor address set */ | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| ctrl_outl((u32)txdesc, ioaddr + TDFXR); | |
| ctrl_outl(0x1, ioaddr + TDFFR); | |
| #endif | |
| txdesc->status |= cpu_to_edmac(mdp, TD_TDLE); | |
| } | |
| /* Get skb and descriptor buffer */ | |
| static int sh_eth_ring_init(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| int rx_ringsize, tx_ringsize, ret = 0; | |
| /* | |
| * +26 gets the maximum ethernet encapsulation, +7 & ~7 because the | |
| * card needs room to do 8 byte alignment, +2 so we can reserve | |
| * the first 2 bytes, and +16 gets room for the status word from the | |
| * card. | |
| */ | |
| mdp->rx_buf_sz = (ndev->mtu <= 1492 ? PKT_BUF_SZ : | |
| (((ndev->mtu + 26 + 7) & ~7) + 2 + 16)); | |
| /* Allocate RX and TX skb rings */ | |
| mdp->rx_skbuff = kmalloc(sizeof(*mdp->rx_skbuff) * RX_RING_SIZE, | |
| GFP_KERNEL); | |
| if (!mdp->rx_skbuff) { | |
| printk(KERN_ERR "%s: Cannot allocate Rx skb\n", ndev->name); | |
| ret = -ENOMEM; | |
| return ret; | |
| } | |
| mdp->tx_skbuff = kmalloc(sizeof(*mdp->tx_skbuff) * TX_RING_SIZE, | |
| GFP_KERNEL); | |
| if (!mdp->tx_skbuff) { | |
| printk(KERN_ERR "%s: Cannot allocate Tx skb\n", ndev->name); | |
| ret = -ENOMEM; | |
| goto skb_ring_free; | |
| } | |
| /* Allocate all Rx descriptors. */ | |
| rx_ringsize = sizeof(struct sh_eth_rxdesc) * RX_RING_SIZE; | |
| mdp->rx_ring = dma_alloc_coherent(NULL, rx_ringsize, &mdp->rx_desc_dma, | |
| GFP_KERNEL); | |
| if (!mdp->rx_ring) { | |
| printk(KERN_ERR "%s: Cannot allocate Rx Ring (size %d bytes)\n", | |
| ndev->name, rx_ringsize); | |
| ret = -ENOMEM; | |
| goto desc_ring_free; | |
| } | |
| mdp->dirty_rx = 0; | |
| /* Allocate all Tx descriptors. */ | |
| tx_ringsize = sizeof(struct sh_eth_txdesc) * TX_RING_SIZE; | |
| mdp->tx_ring = dma_alloc_coherent(NULL, tx_ringsize, &mdp->tx_desc_dma, | |
| GFP_KERNEL); | |
| if (!mdp->tx_ring) { | |
| printk(KERN_ERR "%s: Cannot allocate Tx Ring (size %d bytes)\n", | |
| ndev->name, tx_ringsize); | |
| ret = -ENOMEM; | |
| goto desc_ring_free; | |
| } | |
| return ret; | |
| desc_ring_free: | |
| /* free DMA buffer */ | |
| dma_free_coherent(NULL, rx_ringsize, mdp->rx_ring, mdp->rx_desc_dma); | |
| skb_ring_free: | |
| /* Free Rx and Tx skb ring buffer */ | |
| sh_eth_ring_free(ndev); | |
| return ret; | |
| } | |
| static int sh_eth_dev_init(struct net_device *ndev) | |
| { | |
| int ret = 0; | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| u32 ioaddr = ndev->base_addr; | |
| u_int32_t rx_int_var, tx_int_var; | |
| u32 val; | |
| /* Soft Reset */ | |
| sh_eth_reset(ndev); | |
| /* Descriptor format */ | |
| sh_eth_ring_format(ndev); | |
| ctrl_outl(RPADIR_INIT, ioaddr + RPADIR); | |
| /* all sh_eth int mask */ | |
| ctrl_outl(0, ioaddr + EESIPR); | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| ctrl_outl(EDMR_EL, ioaddr + EDMR); | |
| #else | |
| ctrl_outl(0, ioaddr + EDMR); /* Endian change */ | |
| #endif | |
| /* FIFO size set */ | |
| ctrl_outl((FIFO_SIZE_T | FIFO_SIZE_R), ioaddr + FDR); | |
| ctrl_outl(0, ioaddr + TFTR); | |
| /* Frame recv control */ | |
| ctrl_outl(0, ioaddr + RMCR); | |
| rx_int_var = mdp->rx_int_var = DESC_I_RINT8 | DESC_I_RINT5; | |
| tx_int_var = mdp->tx_int_var = DESC_I_TINT2; | |
| ctrl_outl(rx_int_var | tx_int_var, ioaddr + TRSCER); | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| /* Burst sycle set */ | |
| ctrl_outl(0x800, ioaddr + BCULR); | |
| #endif | |
| ctrl_outl((FIFO_F_D_RFF | FIFO_F_D_RFD), ioaddr + FCFTR); | |
| #if !defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| ctrl_outl(0, ioaddr + TRIMD); | |
| #endif | |
| /* Recv frame limit set register */ | |
| ctrl_outl(RFLR_VALUE, ioaddr + RFLR); | |
| ctrl_outl(ctrl_inl(ioaddr + EESR), ioaddr + EESR); | |
| ctrl_outl((DMAC_M_RFRMER | DMAC_M_ECI | 0x003fffff), ioaddr + EESIPR); | |
| /* PAUSE Prohibition */ | |
| val = (ctrl_inl(ioaddr + ECMR) & ECMR_DM) | | |
| ECMR_ZPF | (mdp->duplex ? ECMR_DM : 0) | ECMR_TE | ECMR_RE; | |
| ctrl_outl(val, ioaddr + ECMR); | |
| /* E-MAC Status Register clear */ | |
| ctrl_outl(ECSR_INIT, ioaddr + ECSR); | |
| /* E-MAC Interrupt Enable register */ | |
| ctrl_outl(ECSIPR_INIT, ioaddr + ECSIPR); | |
| /* Set MAC address */ | |
| update_mac_address(ndev); | |
| /* mask reset */ | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7710) || defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| ctrl_outl(APR_AP, ioaddr + APR); | |
| ctrl_outl(MPR_MP, ioaddr + MPR); | |
| ctrl_outl(TPAUSER_UNLIMITED, ioaddr + TPAUSER); | |
| #endif | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7710) | |
| ctrl_outl(BCFR_UNLIMITED, ioaddr + BCFR); | |
| #endif | |
| /* Setting the Rx mode will start the Rx process. */ | |
| ctrl_outl(EDRRR_R, ioaddr + EDRRR); | |
| netif_start_queue(ndev); | |
| return ret; | |
| } | |
| /* free Tx skb function */ | |
| static int sh_eth_txfree(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| struct sh_eth_txdesc *txdesc; | |
| int freeNum = 0; | |
| int entry = 0; | |
| for (; mdp->cur_tx - mdp->dirty_tx > 0; mdp->dirty_tx++) { | |
| entry = mdp->dirty_tx % TX_RING_SIZE; | |
| txdesc = &mdp->tx_ring[entry]; | |
| if (txdesc->status & cpu_to_edmac(mdp, TD_TACT)) | |
| break; | |
| /* Free the original skb. */ | |
| if (mdp->tx_skbuff[entry]) { | |
| dev_kfree_skb_irq(mdp->tx_skbuff[entry]); | |
| mdp->tx_skbuff[entry] = NULL; | |
| freeNum++; | |
| } | |
| txdesc->status = cpu_to_edmac(mdp, TD_TFP); | |
| if (entry >= TX_RING_SIZE - 1) | |
| txdesc->status |= cpu_to_edmac(mdp, TD_TDLE); | |
| mdp->stats.tx_packets++; | |
| mdp->stats.tx_bytes += txdesc->buffer_length; | |
| } | |
| return freeNum; | |
| } | |
| /* Packet receive function */ | |
| static int sh_eth_rx(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| struct sh_eth_rxdesc *rxdesc; | |
| int entry = mdp->cur_rx % RX_RING_SIZE; | |
| int boguscnt = (mdp->dirty_rx + RX_RING_SIZE) - mdp->cur_rx; | |
| struct sk_buff *skb; | |
| u16 pkt_len = 0; | |
| u32 desc_status, reserve = 0; | |
| rxdesc = &mdp->rx_ring[entry]; | |
| while (!(rxdesc->status & cpu_to_edmac(mdp, RD_RACT))) { | |
| desc_status = edmac_to_cpu(mdp, rxdesc->status); | |
| pkt_len = rxdesc->frame_length; | |
| if (--boguscnt < 0) | |
| break; | |
| if (!(desc_status & RDFEND)) | |
| mdp->stats.rx_length_errors++; | |
| if (desc_status & (RD_RFS1 | RD_RFS2 | RD_RFS3 | RD_RFS4 | | |
| RD_RFS5 | RD_RFS6 | RD_RFS10)) { | |
| mdp->stats.rx_errors++; | |
| if (desc_status & RD_RFS1) | |
| mdp->stats.rx_crc_errors++; | |
| if (desc_status & RD_RFS2) | |
| mdp->stats.rx_frame_errors++; | |
| if (desc_status & RD_RFS3) | |
| mdp->stats.rx_length_errors++; | |
| if (desc_status & RD_RFS4) | |
| mdp->stats.rx_length_errors++; | |
| if (desc_status & RD_RFS6) | |
| mdp->stats.rx_missed_errors++; | |
| if (desc_status & RD_RFS10) | |
| mdp->stats.rx_over_errors++; | |
| } else { | |
| swaps((char *)(rxdesc->addr & ~0x3), pkt_len + 2); | |
| skb = mdp->rx_skbuff[entry]; | |
| mdp->rx_skbuff[entry] = NULL; | |
| skb_put(skb, pkt_len); | |
| skb->protocol = eth_type_trans(skb, ndev); | |
| netif_rx(skb); | |
| mdp->stats.rx_packets++; | |
| mdp->stats.rx_bytes += pkt_len; | |
| } | |
| rxdesc->status |= cpu_to_edmac(mdp, RD_RACT); | |
| entry = (++mdp->cur_rx) % RX_RING_SIZE; | |
| } | |
| /* Refill the Rx ring buffers. */ | |
| for (; mdp->cur_rx - mdp->dirty_rx > 0; mdp->dirty_rx++) { | |
| entry = mdp->dirty_rx % RX_RING_SIZE; | |
| rxdesc = &mdp->rx_ring[entry]; | |
| /* The size of the buffer is 16 byte boundary. */ | |
| rxdesc->buffer_length = (mdp->rx_buf_sz + 16) & ~0x0F; | |
| if (mdp->rx_skbuff[entry] == NULL) { | |
| skb = dev_alloc_skb(mdp->rx_buf_sz); | |
| mdp->rx_skbuff[entry] = skb; | |
| if (skb == NULL) | |
| break; /* Better luck next round. */ | |
| skb->dev = ndev; | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| reserve = SH7763_SKB_ALIGN | |
| - ((uint32_t)skb->data & (SH7763_SKB_ALIGN-1)); | |
| if (reserve) | |
| skb_reserve(skb, reserve); | |
| #else | |
| skb_reserve(skb, RX_OFFSET); | |
| #endif | |
| skb->ip_summed = CHECKSUM_NONE; | |
| rxdesc->addr = (u32)skb->data & ~0x3UL; | |
| } | |
| if (entry >= RX_RING_SIZE - 1) | |
| rxdesc->status |= | |
| cpu_to_edmac(mdp, RD_RACT | RD_RFP | RD_RDEL); | |
| else | |
| rxdesc->status |= | |
| cpu_to_edmac(mdp, RD_RACT | RD_RFP); | |
| } | |
| /* Restart Rx engine if stopped. */ | |
| /* If we don't need to check status, don't. -KDU */ | |
| if (!(ctrl_inl(ndev->base_addr + EDRRR) & EDRRR_R)) | |
| ctrl_outl(EDRRR_R, ndev->base_addr + EDRRR); | |
| return 0; | |
| } | |
| /* error control function */ | |
| static void sh_eth_error(struct net_device *ndev, int intr_status) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| u32 ioaddr = ndev->base_addr; | |
| u32 felic_stat; | |
| if (intr_status & EESR_ECI) { | |
| felic_stat = ctrl_inl(ioaddr + ECSR); | |
| ctrl_outl(felic_stat, ioaddr + ECSR); /* clear int */ | |
| if (felic_stat & ECSR_ICD) | |
| mdp->stats.tx_carrier_errors++; | |
| if (felic_stat & ECSR_LCHNG) { | |
| /* Link Changed */ | |
| u32 link_stat = (ctrl_inl(ioaddr + PSR)); | |
| if (!(link_stat & PHY_ST_LINK)) { | |
| /* Link Down : disable tx and rx */ | |
| ctrl_outl(ctrl_inl(ioaddr + ECMR) & | |
| ~(ECMR_RE | ECMR_TE), ioaddr + ECMR); | |
| } else { | |
| /* Link Up */ | |
| ctrl_outl(ctrl_inl(ioaddr + EESIPR) & | |
| ~DMAC_M_ECI, ioaddr + EESIPR); | |
| /*clear int */ | |
| ctrl_outl(ctrl_inl(ioaddr + ECSR), | |
| ioaddr + ECSR); | |
| ctrl_outl(ctrl_inl(ioaddr + EESIPR) | | |
| DMAC_M_ECI, ioaddr + EESIPR); | |
| /* enable tx and rx */ | |
| ctrl_outl(ctrl_inl(ioaddr + ECMR) | | |
| (ECMR_RE | ECMR_TE), ioaddr + ECMR); | |
| } | |
| } | |
| } | |
| if (intr_status & EESR_TWB) { | |
| /* Write buck end. unused write back interrupt */ | |
| if (intr_status & EESR_TABT) /* Transmit Abort int */ | |
| mdp->stats.tx_aborted_errors++; | |
| } | |
| if (intr_status & EESR_RABT) { | |
| /* Receive Abort int */ | |
| if (intr_status & EESR_RFRMER) { | |
| /* Receive Frame Overflow int */ | |
| mdp->stats.rx_frame_errors++; | |
| printk(KERN_ERR "Receive Frame Overflow\n"); | |
| } | |
| } | |
| #if !defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| if (intr_status & EESR_ADE) { | |
| if (intr_status & EESR_TDE) { | |
| if (intr_status & EESR_TFE) | |
| mdp->stats.tx_fifo_errors++; | |
| } | |
| } | |
| #endif | |
| if (intr_status & EESR_RDE) { | |
| /* Receive Descriptor Empty int */ | |
| mdp->stats.rx_over_errors++; | |
| if (ctrl_inl(ioaddr + EDRRR) ^ EDRRR_R) | |
| ctrl_outl(EDRRR_R, ioaddr + EDRRR); | |
| printk(KERN_ERR "Receive Descriptor Empty\n"); | |
| } | |
| if (intr_status & EESR_RFE) { | |
| /* Receive FIFO Overflow int */ | |
| mdp->stats.rx_fifo_errors++; | |
| printk(KERN_ERR "Receive FIFO Overflow\n"); | |
| } | |
| if (intr_status & (EESR_TWB | EESR_TABT | | |
| #if !defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| EESR_ADE | | |
| #endif | |
| EESR_TDE | EESR_TFE)) { | |
| /* Tx error */ | |
| u32 edtrr = ctrl_inl(ndev->base_addr + EDTRR); | |
| /* dmesg */ | |
| printk(KERN_ERR "%s:TX error. status=%8.8x cur_tx=%8.8x ", | |
| ndev->name, intr_status, mdp->cur_tx); | |
| printk(KERN_ERR "dirty_tx=%8.8x state=%8.8x EDTRR=%8.8x.\n", | |
| mdp->dirty_tx, (u32) ndev->state, edtrr); | |
| /* dirty buffer free */ | |
| sh_eth_txfree(ndev); | |
| /* SH7712 BUG */ | |
| if (edtrr ^ EDTRR_TRNS) { | |
| /* tx dma start */ | |
| ctrl_outl(EDTRR_TRNS, ndev->base_addr + EDTRR); | |
| } | |
| /* wakeup */ | |
| netif_wake_queue(ndev); | |
| } | |
| } | |
| static irqreturn_t sh_eth_interrupt(int irq, void *netdev) | |
| { | |
| struct net_device *ndev = netdev; | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| irqreturn_t ret = IRQ_NONE; | |
| u32 ioaddr, boguscnt = RX_RING_SIZE; | |
| u32 intr_status = 0; | |
| ioaddr = ndev->base_addr; | |
| spin_lock(&mdp->lock); | |
| /* Get interrpt stat */ | |
| intr_status = ctrl_inl(ioaddr + EESR); | |
| /* Clear interrupt */ | |
| if (intr_status & (EESR_FRC | EESR_RMAF | EESR_RRF | | |
| EESR_RTLF | EESR_RTSF | EESR_PRE | EESR_CERF | | |
| TX_CHECK | EESR_ERR_CHECK)) { | |
| ctrl_outl(intr_status, ioaddr + EESR); | |
| ret = IRQ_HANDLED; | |
| } else | |
| goto other_irq; | |
| if (intr_status & (EESR_FRC | /* Frame recv*/ | |
| EESR_RMAF | /* Multi cast address recv*/ | |
| EESR_RRF | /* Bit frame recv */ | |
| EESR_RTLF | /* Long frame recv*/ | |
| EESR_RTSF | /* short frame recv */ | |
| EESR_PRE | /* PHY-LSI recv error */ | |
| EESR_CERF)){ /* recv frame CRC error */ | |
| sh_eth_rx(ndev); | |
| } | |
| /* Tx Check */ | |
| if (intr_status & TX_CHECK) { | |
| sh_eth_txfree(ndev); | |
| netif_wake_queue(ndev); | |
| } | |
| if (intr_status & EESR_ERR_CHECK) | |
| sh_eth_error(ndev, intr_status); | |
| if (--boguscnt < 0) { | |
| printk(KERN_WARNING | |
| "%s: Too much work at interrupt, status=0x%4.4x.\n", | |
| ndev->name, intr_status); | |
| } | |
| other_irq: | |
| spin_unlock(&mdp->lock); | |
| return ret; | |
| } | |
| static void sh_eth_timer(unsigned long data) | |
| { | |
| struct net_device *ndev = (struct net_device *)data; | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| mod_timer(&mdp->timer, jiffies + (10 * HZ)); | |
| } | |
| /* PHY state control function */ | |
| static void sh_eth_adjust_link(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| struct phy_device *phydev = mdp->phydev; | |
| u32 ioaddr = ndev->base_addr; | |
| int new_state = 0; | |
| if (phydev->link != PHY_DOWN) { | |
| if (phydev->duplex != mdp->duplex) { | |
| new_state = 1; | |
| mdp->duplex = phydev->duplex; | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| if (mdp->duplex) { /* FULL */ | |
| ctrl_outl(ctrl_inl(ioaddr + ECMR) | ECMR_DM, | |
| ioaddr + ECMR); | |
| } else { /* Half */ | |
| ctrl_outl(ctrl_inl(ioaddr + ECMR) & ~ECMR_DM, | |
| ioaddr + ECMR); | |
| } | |
| #endif | |
| } | |
| if (phydev->speed != mdp->speed) { | |
| new_state = 1; | |
| mdp->speed = phydev->speed; | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| switch (mdp->speed) { | |
| case 10: /* 10BASE */ | |
| ctrl_outl(GECMR_10, ioaddr + GECMR); break; | |
| case 100:/* 100BASE */ | |
| ctrl_outl(GECMR_100, ioaddr + GECMR); break; | |
| case 1000: /* 1000BASE */ | |
| ctrl_outl(GECMR_1000, ioaddr + GECMR); break; | |
| default: | |
| break; | |
| } | |
| #endif | |
| } | |
| if (mdp->link == PHY_DOWN) { | |
| ctrl_outl((ctrl_inl(ioaddr + ECMR) & ~ECMR_TXF) | |
| | ECMR_DM, ioaddr + ECMR); | |
| new_state = 1; | |
| mdp->link = phydev->link; | |
| } | |
| } else if (mdp->link) { | |
| new_state = 1; | |
| mdp->link = PHY_DOWN; | |
| mdp->speed = 0; | |
| mdp->duplex = -1; | |
| } | |
| if (new_state) | |
| phy_print_status(phydev); | |
| } | |
| /* PHY init function */ | |
| static int sh_eth_phy_init(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| char phy_id[BUS_ID_SIZE]; | |
| struct phy_device *phydev = NULL; | |
| snprintf(phy_id, sizeof(phy_id), PHY_ID_FMT, | |
| mdp->mii_bus->id , mdp->phy_id); | |
| mdp->link = PHY_DOWN; | |
| mdp->speed = 0; | |
| mdp->duplex = -1; | |
| /* Try connect to PHY */ | |
| phydev = phy_connect(ndev, phy_id, &sh_eth_adjust_link, | |
| 0, PHY_INTERFACE_MODE_MII); | |
| if (IS_ERR(phydev)) { | |
| dev_err(&ndev->dev, "phy_connect failed\n"); | |
| return PTR_ERR(phydev); | |
| } | |
| dev_info(&ndev->dev, "attached phy %i to driver %s\n", | |
| phydev->addr, phydev->drv->name); | |
| mdp->phydev = phydev; | |
| return 0; | |
| } | |
| /* PHY control start function */ | |
| static int sh_eth_phy_start(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| int ret; | |
| ret = sh_eth_phy_init(ndev); | |
| if (ret) | |
| return ret; | |
| /* reset phy - this also wakes it from PDOWN */ | |
| phy_write(mdp->phydev, MII_BMCR, BMCR_RESET); | |
| phy_start(mdp->phydev); | |
| return 0; | |
| } | |
| /* network device open function */ | |
| static int sh_eth_open(struct net_device *ndev) | |
| { | |
| int ret = 0; | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| ret = request_irq(ndev->irq, &sh_eth_interrupt, | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) || defined(CONFIG_CPU_SUBTYPE_SH7764) | |
| IRQF_SHARED, | |
| #else | |
| 0, | |
| #endif | |
| ndev->name, ndev); | |
| if (ret) { | |
| printk(KERN_ERR "Can not assign IRQ number to %s\n", CARDNAME); | |
| return ret; | |
| } | |
| /* Descriptor set */ | |
| ret = sh_eth_ring_init(ndev); | |
| if (ret) | |
| goto out_free_irq; | |
| /* device init */ | |
| ret = sh_eth_dev_init(ndev); | |
| if (ret) | |
| goto out_free_irq; | |
| /* PHY control start*/ | |
| ret = sh_eth_phy_start(ndev); | |
| if (ret) | |
| goto out_free_irq; | |
| /* Set the timer to check for link beat. */ | |
| init_timer(&mdp->timer); | |
| mdp->timer.expires = (jiffies + (24 * HZ)) / 10;/* 2.4 sec. */ | |
| setup_timer(&mdp->timer, sh_eth_timer, (unsigned long)ndev); | |
| return ret; | |
| out_free_irq: | |
| free_irq(ndev->irq, ndev); | |
| return ret; | |
| } | |
| /* Timeout function */ | |
| static void sh_eth_tx_timeout(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| u32 ioaddr = ndev->base_addr; | |
| struct sh_eth_rxdesc *rxdesc; | |
| int i; | |
| netif_stop_queue(ndev); | |
| /* worning message out. */ | |
| printk(KERN_WARNING "%s: transmit timed out, status %8.8x," | |
| " resetting...\n", ndev->name, (int)ctrl_inl(ioaddr + EESR)); | |
| /* tx_errors count up */ | |
| mdp->stats.tx_errors++; | |
| /* timer off */ | |
| del_timer_sync(&mdp->timer); | |
| /* Free all the skbuffs in the Rx queue. */ | |
| for (i = 0; i < RX_RING_SIZE; i++) { | |
| rxdesc = &mdp->rx_ring[i]; | |
| rxdesc->status = 0; | |
| rxdesc->addr = 0xBADF00D0; | |
| if (mdp->rx_skbuff[i]) | |
| dev_kfree_skb(mdp->rx_skbuff[i]); | |
| mdp->rx_skbuff[i] = NULL; | |
| } | |
| for (i = 0; i < TX_RING_SIZE; i++) { | |
| if (mdp->tx_skbuff[i]) | |
| dev_kfree_skb(mdp->tx_skbuff[i]); | |
| mdp->tx_skbuff[i] = NULL; | |
| } | |
| /* device init */ | |
| sh_eth_dev_init(ndev); | |
| /* timer on */ | |
| mdp->timer.expires = (jiffies + (24 * HZ)) / 10;/* 2.4 sec. */ | |
| add_timer(&mdp->timer); | |
| } | |
| /* Packet transmit function */ | |
| static int sh_eth_start_xmit(struct sk_buff *skb, struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| struct sh_eth_txdesc *txdesc; | |
| u32 entry; | |
| unsigned long flags; | |
| spin_lock_irqsave(&mdp->lock, flags); | |
| if ((mdp->cur_tx - mdp->dirty_tx) >= (TX_RING_SIZE - 4)) { | |
| if (!sh_eth_txfree(ndev)) { | |
| netif_stop_queue(ndev); | |
| spin_unlock_irqrestore(&mdp->lock, flags); | |
| return 1; | |
| } | |
| } | |
| spin_unlock_irqrestore(&mdp->lock, flags); | |
| entry = mdp->cur_tx % TX_RING_SIZE; | |
| mdp->tx_skbuff[entry] = skb; | |
| txdesc = &mdp->tx_ring[entry]; | |
| txdesc->addr = (u32)(skb->data); | |
| /* soft swap. */ | |
| swaps((char *)(txdesc->addr & ~0x3), skb->len + 2); | |
| /* write back */ | |
| __flush_purge_region(skb->data, skb->len); | |
| if (skb->len < ETHERSMALL) | |
| txdesc->buffer_length = ETHERSMALL; | |
| else | |
| txdesc->buffer_length = skb->len; | |
| if (entry >= TX_RING_SIZE - 1) | |
| txdesc->status |= cpu_to_edmac(mdp, TD_TACT | TD_TDLE); | |
| else | |
| txdesc->status |= cpu_to_edmac(mdp, TD_TACT); | |
| mdp->cur_tx++; | |
| if (!(ctrl_inl(ndev->base_addr + EDTRR) & EDTRR_TRNS)) | |
| ctrl_outl(EDTRR_TRNS, ndev->base_addr + EDTRR); | |
| ndev->trans_start = jiffies; | |
| return 0; | |
| } | |
| /* device close function */ | |
| static int sh_eth_close(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| u32 ioaddr = ndev->base_addr; | |
| int ringsize; | |
| netif_stop_queue(ndev); | |
| /* Disable interrupts by clearing the interrupt mask. */ | |
| ctrl_outl(0x0000, ioaddr + EESIPR); | |
| /* Stop the chip's Tx and Rx processes. */ | |
| ctrl_outl(0, ioaddr + EDTRR); | |
| ctrl_outl(0, ioaddr + EDRRR); | |
| /* PHY Disconnect */ | |
| if (mdp->phydev) { | |
| phy_stop(mdp->phydev); | |
| phy_disconnect(mdp->phydev); | |
| } | |
| free_irq(ndev->irq, ndev); | |
| del_timer_sync(&mdp->timer); | |
| /* Free all the skbuffs in the Rx queue. */ | |
| sh_eth_ring_free(ndev); | |
| /* free DMA buffer */ | |
| ringsize = sizeof(struct sh_eth_rxdesc) * RX_RING_SIZE; | |
| dma_free_coherent(NULL, ringsize, mdp->rx_ring, mdp->rx_desc_dma); | |
| /* free DMA buffer */ | |
| ringsize = sizeof(struct sh_eth_txdesc) * TX_RING_SIZE; | |
| dma_free_coherent(NULL, ringsize, mdp->tx_ring, mdp->tx_desc_dma); | |
| return 0; | |
| } | |
| static struct net_device_stats *sh_eth_get_stats(struct net_device *ndev) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| u32 ioaddr = ndev->base_addr; | |
| mdp->stats.tx_dropped += ctrl_inl(ioaddr + TROCR); | |
| ctrl_outl(0, ioaddr + TROCR); /* (write clear) */ | |
| mdp->stats.collisions += ctrl_inl(ioaddr + CDCR); | |
| ctrl_outl(0, ioaddr + CDCR); /* (write clear) */ | |
| mdp->stats.tx_carrier_errors += ctrl_inl(ioaddr + LCCR); | |
| ctrl_outl(0, ioaddr + LCCR); /* (write clear) */ | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| mdp->stats.tx_carrier_errors += ctrl_inl(ioaddr + CERCR);/* CERCR */ | |
| ctrl_outl(0, ioaddr + CERCR); /* (write clear) */ | |
| mdp->stats.tx_carrier_errors += ctrl_inl(ioaddr + CEECR);/* CEECR */ | |
| ctrl_outl(0, ioaddr + CEECR); /* (write clear) */ | |
| #else | |
| mdp->stats.tx_carrier_errors += ctrl_inl(ioaddr + CNDCR); | |
| ctrl_outl(0, ioaddr + CNDCR); /* (write clear) */ | |
| #endif | |
| return &mdp->stats; | |
| } | |
| /* ioctl to device funciotn*/ | |
| static int sh_eth_do_ioctl(struct net_device *ndev, struct ifreq *rq, | |
| int cmd) | |
| { | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| struct phy_device *phydev = mdp->phydev; | |
| if (!netif_running(ndev)) | |
| return -EINVAL; | |
| if (!phydev) | |
| return -ENODEV; | |
| return phy_mii_ioctl(phydev, if_mii(rq), cmd); | |
| } | |
| /* Multicast reception directions set */ | |
| static void sh_eth_set_multicast_list(struct net_device *ndev) | |
| { | |
| u32 ioaddr = ndev->base_addr; | |
| if (ndev->flags & IFF_PROMISC) { | |
| /* Set promiscuous. */ | |
| ctrl_outl((ctrl_inl(ioaddr + ECMR) & ~ECMR_MCT) | ECMR_PRM, | |
| ioaddr + ECMR); | |
| } else { | |
| /* Normal, unicast/broadcast-only mode. */ | |
| ctrl_outl((ctrl_inl(ioaddr + ECMR) & ~ECMR_PRM) | ECMR_MCT, | |
| ioaddr + ECMR); | |
| } | |
| } | |
| /* SuperH's TSU register init function */ | |
| static void sh_eth_tsu_init(u32 ioaddr) | |
| { | |
| ctrl_outl(0, ioaddr + TSU_FWEN0); /* Disable forward(0->1) */ | |
| ctrl_outl(0, ioaddr + TSU_FWEN1); /* Disable forward(1->0) */ | |
| ctrl_outl(0, ioaddr + TSU_FCM); /* forward fifo 3k-3k */ | |
| ctrl_outl(0xc, ioaddr + TSU_BSYSL0); | |
| ctrl_outl(0xc, ioaddr + TSU_BSYSL1); | |
| ctrl_outl(0, ioaddr + TSU_PRISL0); | |
| ctrl_outl(0, ioaddr + TSU_PRISL1); | |
| ctrl_outl(0, ioaddr + TSU_FWSL0); | |
| ctrl_outl(0, ioaddr + TSU_FWSL1); | |
| ctrl_outl(TSU_FWSLC_POSTENU | TSU_FWSLC_POSTENL, ioaddr + TSU_FWSLC); | |
| #if defined(CONFIG_CPU_SUBTYPE_SH7763) | |
| ctrl_outl(0, ioaddr + TSU_QTAG0); /* Disable QTAG(0->1) */ | |
| ctrl_outl(0, ioaddr + TSU_QTAG1); /* Disable QTAG(1->0) */ | |
| #else | |
| ctrl_outl(0, ioaddr + TSU_QTAGM0); /* Disable QTAG(0->1) */ | |
| ctrl_outl(0, ioaddr + TSU_QTAGM1); /* Disable QTAG(1->0) */ | |
| #endif | |
| ctrl_outl(0, ioaddr + TSU_FWSR); /* all interrupt status clear */ | |
| ctrl_outl(0, ioaddr + TSU_FWINMK); /* Disable all interrupt */ | |
| ctrl_outl(0, ioaddr + TSU_TEN); /* Disable all CAM entry */ | |
| ctrl_outl(0, ioaddr + TSU_POST1); /* Disable CAM entry [ 0- 7] */ | |
| ctrl_outl(0, ioaddr + TSU_POST2); /* Disable CAM entry [ 8-15] */ | |
| ctrl_outl(0, ioaddr + TSU_POST3); /* Disable CAM entry [16-23] */ | |
| ctrl_outl(0, ioaddr + TSU_POST4); /* Disable CAM entry [24-31] */ | |
| } | |
| /* MDIO bus release function */ | |
| static int sh_mdio_release(struct net_device *ndev) | |
| { | |
| struct mii_bus *bus = dev_get_drvdata(&ndev->dev); | |
| /* unregister mdio bus */ | |
| mdiobus_unregister(bus); | |
| /* remove mdio bus info from net_device */ | |
| dev_set_drvdata(&ndev->dev, NULL); | |
| /* free bitbang info */ | |
| free_mdio_bitbang(bus); | |
| return 0; | |
| } | |
| /* MDIO bus init function */ | |
| static int sh_mdio_init(struct net_device *ndev, int id) | |
| { | |
| int ret, i; | |
| struct bb_info *bitbang; | |
| struct sh_eth_private *mdp = netdev_priv(ndev); | |
| /* create bit control struct for PHY */ | |
| bitbang = kzalloc(sizeof(struct bb_info), GFP_KERNEL); | |
| if (!bitbang) { | |
| ret = -ENOMEM; | |
| goto out; | |
| } | |
| /* bitbang init */ | |
| bitbang->addr = ndev->base_addr + PIR; | |
| bitbang->mdi_msk = 0x08; | |
| bitbang->mdo_msk = 0x04; | |
| bitbang->mmd_msk = 0x02;/* MMD */ | |
| bitbang->mdc_msk = 0x01; | |
| bitbang->ctrl.ops = &bb_ops; | |
| /* MII contorller setting */ | |
| mdp->mii_bus = alloc_mdio_bitbang(&bitbang->ctrl); | |
| if (!mdp->mii_bus) { | |
| ret = -ENOMEM; | |
| goto out_free_bitbang; | |
| } | |
| /* Hook up MII support for ethtool */ | |
| mdp->mii_bus->name = "sh_mii"; | |
| mdp->mii_bus->parent = &ndev->dev; | |
| snprintf(mdp->mii_bus->id, MII_BUS_ID_SIZE, "%x", id); | |
| /* PHY IRQ */ | |
| mdp->mii_bus->irq = kmalloc(sizeof(int)*PHY_MAX_ADDR, GFP_KERNEL); | |
| if (!mdp->mii_bus->irq) { | |
| ret = -ENOMEM; | |
| goto out_free_bus; | |
| } | |
| for (i = 0; i < PHY_MAX_ADDR; i++) | |
| mdp->mii_bus->irq[i] = PHY_POLL; | |
| /* regist mdio bus */ | |
| ret = mdiobus_register(mdp->mii_bus); | |
| if (ret) | |
| goto out_free_irq; | |
| dev_set_drvdata(&ndev->dev, mdp->mii_bus); | |
| return 0; | |
| out_free_irq: | |
| kfree(mdp->mii_bus->irq); | |
| out_free_bus: | |
| free_mdio_bitbang(mdp->mii_bus); | |
| out_free_bitbang: | |
| kfree(bitbang); | |
| out: | |
| return ret; | |
| } | |
| static int sh_eth_drv_probe(struct platform_device *pdev) | |
| { | |
| int ret, i, devno = 0; | |
| struct resource *res; | |
| struct net_device *ndev = NULL; | |
| struct sh_eth_private *mdp; | |
| struct sh_eth_plat_data *pd; | |
| /* get base addr */ | |
| res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
| if (unlikely(res == NULL)) { | |
| dev_err(&pdev->dev, "invalid resource\n"); | |
| ret = -EINVAL; | |
| goto out; | |
| } | |
| ndev = alloc_etherdev(sizeof(struct sh_eth_private)); | |
| if (!ndev) { | |
| printk(KERN_ERR "%s: could not allocate device.\n", CARDNAME); | |
| ret = -ENOMEM; | |
| goto out; | |
| } | |
| /* The sh Ether-specific entries in the device structure. */ | |
| ndev->base_addr = res->start; | |
| devno = pdev->id; | |
| if (devno < 0) | |
| devno = 0; | |
| ndev->dma = -1; | |
| ret = platform_get_irq(pdev, 0); | |
| if (ret < 0) { | |
| ret = -ENODEV; | |
| goto out_release; | |
| } | |
| ndev->irq = ret; | |
| SET_NETDEV_DEV(ndev, &pdev->dev); | |
| /* Fill in the fields of the device structure with ethernet values. */ | |
| ether_setup(ndev); | |
| mdp = netdev_priv(ndev); | |
| spin_lock_init(&mdp->lock); | |
| pd = (struct sh_eth_plat_data *)(pdev->dev.platform_data); | |
| /* get PHY ID */ | |
| mdp->phy_id = pd->phy; | |
| /* EDMAC endian */ | |
| mdp->edmac_endian = pd->edmac_endian; | |
| /* set function */ | |
| ndev->open = sh_eth_open; | |
| ndev->hard_start_xmit = sh_eth_start_xmit; | |
| ndev->stop = sh_eth_close; | |
| ndev->get_stats = sh_eth_get_stats; | |
| ndev->set_multicast_list = sh_eth_set_multicast_list; | |
| ndev->do_ioctl = sh_eth_do_ioctl; | |
| ndev->tx_timeout = sh_eth_tx_timeout; | |
| ndev->watchdog_timeo = TX_TIMEOUT; | |
| mdp->post_rx = POST_RX >> (devno << 1); | |
| mdp->post_fw = POST_FW >> (devno << 1); | |
| /* read and set MAC address */ | |
| read_mac_address(ndev); | |
| /* First device only init */ | |
| if (!devno) { | |
| #if defined(ARSTR) | |
| /* reset device */ | |
| ctrl_outl(ARSTR_ARSTR, ARSTR); | |
| mdelay(1); | |
| #endif | |
| #if defined(SH_TSU_ADDR) | |
| /* TSU init (Init only)*/ | |
| sh_eth_tsu_init(SH_TSU_ADDR); | |
| #endif | |
| } | |
| /* network device register */ | |
| ret = register_netdev(ndev); | |
| if (ret) | |
| goto out_release; | |
| /* mdio bus init */ | |
| ret = sh_mdio_init(ndev, pdev->id); | |
| if (ret) | |
| goto out_unregister; | |
| /* pritnt device infomation */ | |
| printk(KERN_INFO "%s: %s at 0x%x, ", | |
| ndev->name, CARDNAME, (u32) ndev->base_addr); | |
| for (i = 0; i < 5; i++) | |
| printk("%02X:", ndev->dev_addr[i]); | |
| printk("%02X, IRQ %d.\n", ndev->dev_addr[i], ndev->irq); | |
| platform_set_drvdata(pdev, ndev); | |
| return ret; | |
| out_unregister: | |
| unregister_netdev(ndev); | |
| out_release: | |
| /* net_dev free */ | |
| if (ndev) | |
| free_netdev(ndev); | |
| out: | |
| return ret; | |
| } | |
| static int sh_eth_drv_remove(struct platform_device *pdev) | |
| { | |
| struct net_device *ndev = platform_get_drvdata(pdev); | |
| sh_mdio_release(ndev); | |
| unregister_netdev(ndev); | |
| flush_scheduled_work(); | |
| free_netdev(ndev); | |
| platform_set_drvdata(pdev, NULL); | |
| return 0; | |
| } | |
| static struct platform_driver sh_eth_driver = { | |
| .probe = sh_eth_drv_probe, | |
| .remove = sh_eth_drv_remove, | |
| .driver = { | |
| .name = CARDNAME, | |
| }, | |
| }; | |
| static int __init sh_eth_init(void) | |
| { | |
| return platform_driver_register(&sh_eth_driver); | |
| } | |
| static void __exit sh_eth_cleanup(void) | |
| { | |
| platform_driver_unregister(&sh_eth_driver); | |
| } | |
| module_init(sh_eth_init); | |
| module_exit(sh_eth_cleanup); | |
| MODULE_AUTHOR("Nobuhiro Iwamatsu, Yoshihiro Shimoda"); | |
| MODULE_DESCRIPTION("Renesas SuperH Ethernet driver"); | |
| MODULE_LICENSE("GPL v2"); |