Loading drivers/net/ethernet/ec_bhf.c +10 −91 Original line number Diff line number Diff line /* * drivers/net/ethernet/beckhoff/ec_bhf.c * drivers/net/ethernet/ec_bhf.c * * Copyright (C) 2014 Darek Marcinkiewicz <reksio@newterm.pl> * Loading @@ -18,9 +18,6 @@ * Those can be found on Bechhoff CX50xx industrial PCs. */ #if 0 #define DEBUG #endif #include <linux/kernel.h> #include <linux/module.h> #include <linux/moduleparam.h> Loading Loading @@ -74,6 +71,8 @@ #define DMA_WINDOW_SIZE_MASK 0xfffffffc #define ETHERCAT_MASTER_ID 0x14 static struct pci_device_id ids[] = { { PCI_DEVICE(0x15ec, 0x5000), }, { 0, } Loading Loading @@ -131,7 +130,6 @@ struct bhf_dma { struct ec_bhf_priv { struct net_device *net_dev; struct pci_dev *dev; void __iomem *io; Loading Loading @@ -162,32 +160,6 @@ struct ec_bhf_priv { #define PRIV_TO_DEV(priv) (&(priv)->dev->dev) #define ETHERCAT_MASTER_ID 0x14 static void ec_bhf_print_status(struct ec_bhf_priv *priv) { struct device *dev = PRIV_TO_DEV(priv); dev_dbg(dev, "Frame error counter: %d\n", ioread8(priv->mac_io + MAC_FRAME_ERR_CNT)); dev_dbg(dev, "RX error counter: %d\n", ioread8(priv->mac_io + MAC_RX_ERR_CNT)); dev_dbg(dev, "CRC error counter: %d\n", ioread8(priv->mac_io + MAC_CRC_ERR_CNT)); dev_dbg(dev, "TX frame counter: %d\n", ioread32(priv->mac_io + MAC_TX_FRAME_CNT)); dev_dbg(dev, "RX frame counter: %d\n", ioread32(priv->mac_io + MAC_RX_FRAME_CNT)); dev_dbg(dev, "TX fifo level: %d\n", ioread8(priv->mac_io + MAC_TX_FIFO_LVL)); dev_dbg(dev, "Dropped frames: %d\n", ioread8(priv->mac_io + MAC_DROPPED_FRMS)); dev_dbg(dev, "Connected with CCAT slot: %d\n", ioread8(priv->mac_io + MAC_CONNECTED_CCAT_FLAG)); dev_dbg(dev, "Link status: %d\n", ioread8(priv->mii_io + MII_LINK_STATUS)); } static void ec_bhf_reset(struct ec_bhf_priv *priv) { iowrite8(0, priv->mac_io + MAC_FRAME_ERR_CNT); Loading @@ -210,8 +182,6 @@ static void ec_bhf_send_packet(struct ec_bhf_priv *priv, struct tx_desc *desc) u32 addr = (u8 *)desc - priv->tx_buf.buf; iowrite32((ALIGN(len, 8) << 24) | addr, priv->fifo_io + FIFO_TX_REG); dev_dbg(PRIV_TO_DEV(priv), "Done sending packet\n"); } static int ec_bhf_desc_sent(struct tx_desc *desc) Loading Loading @@ -244,7 +214,6 @@ static void ec_bhf_add_rx_desc(struct ec_bhf_priv *priv, struct rx_desc *desc) static void ec_bhf_process_rx(struct ec_bhf_priv *priv) { struct rx_desc *desc = &priv->rx_descs[priv->rx_dnext]; struct device *dev = PRIV_TO_DEV(priv); while (ec_bhf_pkt_received(desc)) { int pkt_size = (le16_to_cpu(desc->header.len) & Loading @@ -253,18 +222,14 @@ static void ec_bhf_process_rx(struct ec_bhf_priv *priv) struct sk_buff *skb; skb = netdev_alloc_skb_ip_align(priv->net_dev, pkt_size); dev_dbg(dev, "Received packet, size: %d\n", pkt_size); if (skb) { memcpy(skb_put(skb, pkt_size), data, pkt_size); skb->protocol = eth_type_trans(skb, priv->net_dev); dev_dbg(dev, "Protocol type: %x\n", skb->protocol); priv->stat_rx_bytes += pkt_size; netif_rx(skb); } else { dev_err_ratelimited(dev, dev_err_ratelimited(PRIV_TO_DEV(priv), "Couldn't allocate a skb_buff for a packet of size %u\n", pkt_size); } Loading @@ -276,7 +241,6 @@ static void ec_bhf_process_rx(struct ec_bhf_priv *priv) priv->rx_dnext = (priv->rx_dnext + 1) % priv->rx_dcount; desc = &priv->rx_descs[priv->rx_dnext]; } } static enum hrtimer_restart ec_bhf_timer_fun(struct hrtimer *timer) Loading @@ -299,14 +263,7 @@ static int ec_bhf_setup_offsets(struct ec_bhf_priv *priv) unsigned block_count, i; void __iomem *ec_info; dev_dbg(dev, "Info block:\n"); dev_dbg(dev, "Type of function: %x\n", (unsigned)ioread16(priv->io)); dev_dbg(dev, "Revision of function: %x\n", (unsigned)ioread16(priv->io + INFO_BLOCK_REV)); block_count = ioread8(priv->io + INFO_BLOCK_BLK_CNT); dev_dbg(dev, "Number of function blocks: %x\n", block_count); for (i = 0; i < block_count; i++) { u16 type = ioread16(priv->io + i * INFO_BLOCK_SIZE + INFO_BLOCK_TYPE); Loading @@ -317,29 +274,17 @@ static int ec_bhf_setup_offsets(struct ec_bhf_priv *priv) dev_err(dev, "EtherCAT master with DMA block not found\n"); return -ENODEV; } dev_dbg(dev, "EtherCAT master with DMA block found at pos: %d\n", i); ec_info = priv->io + i * INFO_BLOCK_SIZE; dev_dbg(dev, "EtherCAT master revision: %d\n", ioread16(ec_info + INFO_BLOCK_REV)); priv->tx_dma_chan = ioread8(ec_info + INFO_BLOCK_TX_CHAN); dev_dbg(dev, "EtherCAT master tx dma channel: %d\n", priv->tx_dma_chan); priv->rx_dma_chan = ioread8(ec_info + INFO_BLOCK_RX_CHAN); dev_dbg(dev, "EtherCAT master rx dma channel: %d\n", priv->rx_dma_chan); priv->ec_io = priv->io + ioread32(ec_info + INFO_BLOCK_OFFSET); priv->mii_io = priv->ec_io + ioread32(priv->ec_io + EC_MII_OFFSET); priv->fifo_io = priv->ec_io + ioread32(priv->ec_io + EC_FIFO_OFFSET); priv->mac_io = priv->ec_io + ioread32(priv->ec_io + EC_MAC_OFFSET); dev_dbg(dev, "EtherCAT block addres: %p, fifo address: %p, mii address: %p, mac address: %p\n", priv->ec_io, priv->fifo_io, priv->mii_io, priv->mac_io); return 0; } Loading @@ -350,8 +295,6 @@ static netdev_tx_t ec_bhf_start_xmit(struct sk_buff *skb, struct tx_desc *desc; unsigned len; dev_dbg(PRIV_TO_DEV(priv), "Starting xmit\n"); desc = &priv->tx_descs[priv->tx_dnext]; skb_copy_and_csum_dev(skb, desc->data); Loading @@ -366,15 +309,12 @@ static netdev_tx_t ec_bhf_start_xmit(struct sk_buff *skb, priv->tx_dnext = (priv->tx_dnext + 1) % priv->tx_dcount; if (!ec_bhf_desc_sent(&priv->tx_descs[priv->tx_dnext])) { /* Make sure that update updates to tx_dnext are perceived /* Make sure that updates to tx_dnext are perceived * by timer routine. */ smp_wmb(); netif_stop_queue(net_dev); dev_dbg(PRIV_TO_DEV(priv), "Stopping netif queue\n"); ec_bhf_print_status(priv); } priv->stat_tx_bytes += len; Loading @@ -397,7 +337,6 @@ static int ec_bhf_alloc_dma_mem(struct ec_bhf_priv *priv, mask = ioread32(priv->dma_io + offset); mask &= DMA_WINDOW_SIZE_MASK; dev_dbg(dev, "Read mask %x for channel %d\n", mask, channel); /* We want to allocate a chunk of memory that is: * - aligned to the mask we just read Loading @@ -408,12 +347,10 @@ static int ec_bhf_alloc_dma_mem(struct ec_bhf_priv *priv, buf->len = min_t(int, ~mask + 1, size); buf->alloc_len = 2 * buf->len; dev_dbg(dev, "Allocating %d bytes for channel %d", (int)buf->alloc_len, channel); buf->alloc = dma_alloc_coherent(dev, buf->alloc_len, &buf->alloc_phys, GFP_KERNEL); if (buf->alloc == NULL) { dev_info(dev, "Failed to allocate buffer\n"); dev_err(dev, "Failed to allocate buffer\n"); return -ENOMEM; } Loading @@ -422,8 +359,6 @@ static int ec_bhf_alloc_dma_mem(struct ec_bhf_priv *priv, iowrite32(0, priv->dma_io + offset + 4); iowrite32(buf->buf_phys, priv->dma_io + offset); dev_dbg(dev, "Buffer: %x and read from dev: %x", (unsigned)buf->buf_phys, ioread32(priv->dma_io + offset)); return 0; } Loading Loading @@ -469,8 +404,6 @@ static int ec_bhf_open(struct net_device *net_dev) struct device *dev = PRIV_TO_DEV(priv); int err = 0; dev_info(dev, "Opening device\n"); ec_bhf_reset(priv); err = ec_bhf_alloc_dma_mem(priv, &priv->rx_buf, priv->rx_dma_chan, Loading @@ -481,20 +414,13 @@ static int ec_bhf_open(struct net_device *net_dev) } ec_bhf_setup_rx_descs(priv); dev_info(dev, "RX buffer allocated, address: %x\n", (unsigned)priv->rx_buf.buf_phys); err = ec_bhf_alloc_dma_mem(priv, &priv->tx_buf, priv->tx_dma_chan, FIFO_SIZE * sizeof(struct tx_desc)); if (err) { dev_err(dev, "Failed to allocate tx buffer\n"); goto error_rx_free; } dev_dbg(dev, "TX buffer allocated, addres: %x\n", (unsigned)priv->tx_buf.buf_phys); iowrite8(0, priv->mii_io + MII_MAC_FILT_FLAG); ec_bhf_setup_tx_descs(priv); netif_start_queue(net_dev); Loading @@ -504,10 +430,6 @@ static int ec_bhf_open(struct net_device *net_dev) hrtimer_start(&priv->hrtimer, ktime_set(0, polling_frequency), HRTIMER_MODE_REL); dev_info(PRIV_TO_DEV(priv), "Device open\n"); ec_bhf_print_status(priv); return 0; error_rx_free: Loading Loading @@ -640,9 +562,6 @@ static int ec_bhf_probe(struct pci_dev *dev, const struct pci_device_id *id) memcpy_fromio(net_dev->dev_addr, priv->mii_io + MII_MAC_ADDR, 6); dev_dbg(&dev->dev, "CX5020 Ethercat master address: %pM\n", net_dev->dev_addr); err = register_netdev(net_dev); if (err < 0) goto err_free_net_dev; Loading Loading
drivers/net/ethernet/ec_bhf.c +10 −91 Original line number Diff line number Diff line /* * drivers/net/ethernet/beckhoff/ec_bhf.c * drivers/net/ethernet/ec_bhf.c * * Copyright (C) 2014 Darek Marcinkiewicz <reksio@newterm.pl> * Loading @@ -18,9 +18,6 @@ * Those can be found on Bechhoff CX50xx industrial PCs. */ #if 0 #define DEBUG #endif #include <linux/kernel.h> #include <linux/module.h> #include <linux/moduleparam.h> Loading Loading @@ -74,6 +71,8 @@ #define DMA_WINDOW_SIZE_MASK 0xfffffffc #define ETHERCAT_MASTER_ID 0x14 static struct pci_device_id ids[] = { { PCI_DEVICE(0x15ec, 0x5000), }, { 0, } Loading Loading @@ -131,7 +130,6 @@ struct bhf_dma { struct ec_bhf_priv { struct net_device *net_dev; struct pci_dev *dev; void __iomem *io; Loading Loading @@ -162,32 +160,6 @@ struct ec_bhf_priv { #define PRIV_TO_DEV(priv) (&(priv)->dev->dev) #define ETHERCAT_MASTER_ID 0x14 static void ec_bhf_print_status(struct ec_bhf_priv *priv) { struct device *dev = PRIV_TO_DEV(priv); dev_dbg(dev, "Frame error counter: %d\n", ioread8(priv->mac_io + MAC_FRAME_ERR_CNT)); dev_dbg(dev, "RX error counter: %d\n", ioread8(priv->mac_io + MAC_RX_ERR_CNT)); dev_dbg(dev, "CRC error counter: %d\n", ioread8(priv->mac_io + MAC_CRC_ERR_CNT)); dev_dbg(dev, "TX frame counter: %d\n", ioread32(priv->mac_io + MAC_TX_FRAME_CNT)); dev_dbg(dev, "RX frame counter: %d\n", ioread32(priv->mac_io + MAC_RX_FRAME_CNT)); dev_dbg(dev, "TX fifo level: %d\n", ioread8(priv->mac_io + MAC_TX_FIFO_LVL)); dev_dbg(dev, "Dropped frames: %d\n", ioread8(priv->mac_io + MAC_DROPPED_FRMS)); dev_dbg(dev, "Connected with CCAT slot: %d\n", ioread8(priv->mac_io + MAC_CONNECTED_CCAT_FLAG)); dev_dbg(dev, "Link status: %d\n", ioread8(priv->mii_io + MII_LINK_STATUS)); } static void ec_bhf_reset(struct ec_bhf_priv *priv) { iowrite8(0, priv->mac_io + MAC_FRAME_ERR_CNT); Loading @@ -210,8 +182,6 @@ static void ec_bhf_send_packet(struct ec_bhf_priv *priv, struct tx_desc *desc) u32 addr = (u8 *)desc - priv->tx_buf.buf; iowrite32((ALIGN(len, 8) << 24) | addr, priv->fifo_io + FIFO_TX_REG); dev_dbg(PRIV_TO_DEV(priv), "Done sending packet\n"); } static int ec_bhf_desc_sent(struct tx_desc *desc) Loading Loading @@ -244,7 +214,6 @@ static void ec_bhf_add_rx_desc(struct ec_bhf_priv *priv, struct rx_desc *desc) static void ec_bhf_process_rx(struct ec_bhf_priv *priv) { struct rx_desc *desc = &priv->rx_descs[priv->rx_dnext]; struct device *dev = PRIV_TO_DEV(priv); while (ec_bhf_pkt_received(desc)) { int pkt_size = (le16_to_cpu(desc->header.len) & Loading @@ -253,18 +222,14 @@ static void ec_bhf_process_rx(struct ec_bhf_priv *priv) struct sk_buff *skb; skb = netdev_alloc_skb_ip_align(priv->net_dev, pkt_size); dev_dbg(dev, "Received packet, size: %d\n", pkt_size); if (skb) { memcpy(skb_put(skb, pkt_size), data, pkt_size); skb->protocol = eth_type_trans(skb, priv->net_dev); dev_dbg(dev, "Protocol type: %x\n", skb->protocol); priv->stat_rx_bytes += pkt_size; netif_rx(skb); } else { dev_err_ratelimited(dev, dev_err_ratelimited(PRIV_TO_DEV(priv), "Couldn't allocate a skb_buff for a packet of size %u\n", pkt_size); } Loading @@ -276,7 +241,6 @@ static void ec_bhf_process_rx(struct ec_bhf_priv *priv) priv->rx_dnext = (priv->rx_dnext + 1) % priv->rx_dcount; desc = &priv->rx_descs[priv->rx_dnext]; } } static enum hrtimer_restart ec_bhf_timer_fun(struct hrtimer *timer) Loading @@ -299,14 +263,7 @@ static int ec_bhf_setup_offsets(struct ec_bhf_priv *priv) unsigned block_count, i; void __iomem *ec_info; dev_dbg(dev, "Info block:\n"); dev_dbg(dev, "Type of function: %x\n", (unsigned)ioread16(priv->io)); dev_dbg(dev, "Revision of function: %x\n", (unsigned)ioread16(priv->io + INFO_BLOCK_REV)); block_count = ioread8(priv->io + INFO_BLOCK_BLK_CNT); dev_dbg(dev, "Number of function blocks: %x\n", block_count); for (i = 0; i < block_count; i++) { u16 type = ioread16(priv->io + i * INFO_BLOCK_SIZE + INFO_BLOCK_TYPE); Loading @@ -317,29 +274,17 @@ static int ec_bhf_setup_offsets(struct ec_bhf_priv *priv) dev_err(dev, "EtherCAT master with DMA block not found\n"); return -ENODEV; } dev_dbg(dev, "EtherCAT master with DMA block found at pos: %d\n", i); ec_info = priv->io + i * INFO_BLOCK_SIZE; dev_dbg(dev, "EtherCAT master revision: %d\n", ioread16(ec_info + INFO_BLOCK_REV)); priv->tx_dma_chan = ioread8(ec_info + INFO_BLOCK_TX_CHAN); dev_dbg(dev, "EtherCAT master tx dma channel: %d\n", priv->tx_dma_chan); priv->rx_dma_chan = ioread8(ec_info + INFO_BLOCK_RX_CHAN); dev_dbg(dev, "EtherCAT master rx dma channel: %d\n", priv->rx_dma_chan); priv->ec_io = priv->io + ioread32(ec_info + INFO_BLOCK_OFFSET); priv->mii_io = priv->ec_io + ioread32(priv->ec_io + EC_MII_OFFSET); priv->fifo_io = priv->ec_io + ioread32(priv->ec_io + EC_FIFO_OFFSET); priv->mac_io = priv->ec_io + ioread32(priv->ec_io + EC_MAC_OFFSET); dev_dbg(dev, "EtherCAT block addres: %p, fifo address: %p, mii address: %p, mac address: %p\n", priv->ec_io, priv->fifo_io, priv->mii_io, priv->mac_io); return 0; } Loading @@ -350,8 +295,6 @@ static netdev_tx_t ec_bhf_start_xmit(struct sk_buff *skb, struct tx_desc *desc; unsigned len; dev_dbg(PRIV_TO_DEV(priv), "Starting xmit\n"); desc = &priv->tx_descs[priv->tx_dnext]; skb_copy_and_csum_dev(skb, desc->data); Loading @@ -366,15 +309,12 @@ static netdev_tx_t ec_bhf_start_xmit(struct sk_buff *skb, priv->tx_dnext = (priv->tx_dnext + 1) % priv->tx_dcount; if (!ec_bhf_desc_sent(&priv->tx_descs[priv->tx_dnext])) { /* Make sure that update updates to tx_dnext are perceived /* Make sure that updates to tx_dnext are perceived * by timer routine. */ smp_wmb(); netif_stop_queue(net_dev); dev_dbg(PRIV_TO_DEV(priv), "Stopping netif queue\n"); ec_bhf_print_status(priv); } priv->stat_tx_bytes += len; Loading @@ -397,7 +337,6 @@ static int ec_bhf_alloc_dma_mem(struct ec_bhf_priv *priv, mask = ioread32(priv->dma_io + offset); mask &= DMA_WINDOW_SIZE_MASK; dev_dbg(dev, "Read mask %x for channel %d\n", mask, channel); /* We want to allocate a chunk of memory that is: * - aligned to the mask we just read Loading @@ -408,12 +347,10 @@ static int ec_bhf_alloc_dma_mem(struct ec_bhf_priv *priv, buf->len = min_t(int, ~mask + 1, size); buf->alloc_len = 2 * buf->len; dev_dbg(dev, "Allocating %d bytes for channel %d", (int)buf->alloc_len, channel); buf->alloc = dma_alloc_coherent(dev, buf->alloc_len, &buf->alloc_phys, GFP_KERNEL); if (buf->alloc == NULL) { dev_info(dev, "Failed to allocate buffer\n"); dev_err(dev, "Failed to allocate buffer\n"); return -ENOMEM; } Loading @@ -422,8 +359,6 @@ static int ec_bhf_alloc_dma_mem(struct ec_bhf_priv *priv, iowrite32(0, priv->dma_io + offset + 4); iowrite32(buf->buf_phys, priv->dma_io + offset); dev_dbg(dev, "Buffer: %x and read from dev: %x", (unsigned)buf->buf_phys, ioread32(priv->dma_io + offset)); return 0; } Loading Loading @@ -469,8 +404,6 @@ static int ec_bhf_open(struct net_device *net_dev) struct device *dev = PRIV_TO_DEV(priv); int err = 0; dev_info(dev, "Opening device\n"); ec_bhf_reset(priv); err = ec_bhf_alloc_dma_mem(priv, &priv->rx_buf, priv->rx_dma_chan, Loading @@ -481,20 +414,13 @@ static int ec_bhf_open(struct net_device *net_dev) } ec_bhf_setup_rx_descs(priv); dev_info(dev, "RX buffer allocated, address: %x\n", (unsigned)priv->rx_buf.buf_phys); err = ec_bhf_alloc_dma_mem(priv, &priv->tx_buf, priv->tx_dma_chan, FIFO_SIZE * sizeof(struct tx_desc)); if (err) { dev_err(dev, "Failed to allocate tx buffer\n"); goto error_rx_free; } dev_dbg(dev, "TX buffer allocated, addres: %x\n", (unsigned)priv->tx_buf.buf_phys); iowrite8(0, priv->mii_io + MII_MAC_FILT_FLAG); ec_bhf_setup_tx_descs(priv); netif_start_queue(net_dev); Loading @@ -504,10 +430,6 @@ static int ec_bhf_open(struct net_device *net_dev) hrtimer_start(&priv->hrtimer, ktime_set(0, polling_frequency), HRTIMER_MODE_REL); dev_info(PRIV_TO_DEV(priv), "Device open\n"); ec_bhf_print_status(priv); return 0; error_rx_free: Loading Loading @@ -640,9 +562,6 @@ static int ec_bhf_probe(struct pci_dev *dev, const struct pci_device_id *id) memcpy_fromio(net_dev->dev_addr, priv->mii_io + MII_MAC_ADDR, 6); dev_dbg(&dev->dev, "CX5020 Ethercat master address: %pM\n", net_dev->dev_addr); err = register_netdev(net_dev); if (err < 0) goto err_free_net_dev; Loading