Commit 2a369ae0 authored by David S. Miller's avatar David S. Miller

Merge branch 'net-ll_temac-x86_64-support'

Esben Haabendal says:

====================
net: ll_temac: x86_64 support

This patch series adds support for use of ll_temac driver with
platform_data configuration and fixes endianess and 64-bit problems so
that it can be used on x86_64 platform.

A few bugfixes are also included.

Changes since v2:
  - Fixed lp->indirect_mutex initialization regression for OF
    platforms introduced in v2

Changes since v1:
  - Make indirect_mutex specification mandatory when using platform_data
  - Move header to include/linux/platform_data
  - Enable COMPILE_TEST for XILINX_LL_TEMAC
  - Rebased to v5.1-rc7
====================
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parents ac97a359 73f7375d
...@@ -5,7 +5,7 @@ ...@@ -5,7 +5,7 @@
config NET_VENDOR_XILINX config NET_VENDOR_XILINX
bool "Xilinx devices" bool "Xilinx devices"
default y default y
depends on PPC || PPC32 || MICROBLAZE || ARCH_ZYNQ || MIPS depends on PPC || PPC32 || MICROBLAZE || ARCH_ZYNQ || MIPS || X86 || COMPILE_TEST
---help--- ---help---
If you have a network (Ethernet) card belonging to this class, say Y. If you have a network (Ethernet) card belonging to this class, say Y.
...@@ -33,8 +33,7 @@ config XILINX_AXI_EMAC ...@@ -33,8 +33,7 @@ config XILINX_AXI_EMAC
config XILINX_LL_TEMAC config XILINX_LL_TEMAC
tristate "Xilinx LL TEMAC (LocalLink Tri-mode Ethernet MAC) driver" tristate "Xilinx LL TEMAC (LocalLink Tri-mode Ethernet MAC) driver"
depends on (PPC || MICROBLAZE) depends on PPC || MICROBLAZE || X86 || COMPILE_TEST
depends on !64BIT || BROKEN
select PHYLIB select PHYLIB
---help--- ---help---
This driver supports the Xilinx 10/100/1000 LocalLink TEMAC This driver supports the Xilinx 10/100/1000 LocalLink TEMAC
......
...@@ -334,6 +334,9 @@ struct temac_local { ...@@ -334,6 +334,9 @@ struct temac_local {
/* Connection to PHY device */ /* Connection to PHY device */
struct device_node *phy_node; struct device_node *phy_node;
/* For non-device-tree devices */
char phy_name[MII_BUS_ID_SIZE + 3];
phy_interface_t phy_interface;
/* MDIO bus data */ /* MDIO bus data */
struct mii_bus *mii_bus; /* MII bus reference */ struct mii_bus *mii_bus; /* MII bus reference */
...@@ -344,8 +347,10 @@ struct temac_local { ...@@ -344,8 +347,10 @@ struct temac_local {
#ifdef CONFIG_PPC_DCR #ifdef CONFIG_PPC_DCR
dcr_host_t sdma_dcrs; dcr_host_t sdma_dcrs;
#endif #endif
u32 (*dma_in)(struct temac_local *, int); u32 (*temac_ior)(struct temac_local *lp, int offset);
void (*dma_out)(struct temac_local *, int, u32); void (*temac_iow)(struct temac_local *lp, int offset, u32 value);
u32 (*dma_in)(struct temac_local *lp, int reg);
void (*dma_out)(struct temac_local *lp, int reg, u32 value);
int tx_irq; int tx_irq;
int rx_irq; int rx_irq;
...@@ -353,7 +358,10 @@ struct temac_local { ...@@ -353,7 +358,10 @@ struct temac_local {
struct sk_buff **rx_skb; struct sk_buff **rx_skb;
spinlock_t rx_lock; spinlock_t rx_lock;
struct mutex indirect_mutex; /* For synchronization of indirect register access. Must be
* shared mutex between interfaces in same TEMAC block.
*/
struct mutex *indirect_mutex;
u32 options; /* Current options word */ u32 options; /* Current options word */
int last_link; int last_link;
unsigned int temac_features; unsigned int temac_features;
...@@ -367,18 +375,24 @@ struct temac_local { ...@@ -367,18 +375,24 @@ struct temac_local {
int tx_bd_next; int tx_bd_next;
int tx_bd_tail; int tx_bd_tail;
int rx_bd_ci; int rx_bd_ci;
/* DMA channel control setup */
u32 tx_chnl_ctrl;
u32 rx_chnl_ctrl;
}; };
/* Wrappers for temac_ior()/temac_iow() function pointers above */
#define temac_ior(lp, o) ((lp)->temac_ior(lp, o))
#define temac_iow(lp, o, v) ((lp)->temac_iow(lp, o, v))
/* xilinx_temac.c */ /* xilinx_temac.c */
u32 temac_ior(struct temac_local *lp, int offset);
void temac_iow(struct temac_local *lp, int offset, u32 value);
int temac_indirect_busywait(struct temac_local *lp); int temac_indirect_busywait(struct temac_local *lp);
u32 temac_indirect_in32(struct temac_local *lp, int reg); u32 temac_indirect_in32(struct temac_local *lp, int reg);
void temac_indirect_out32(struct temac_local *lp, int reg, u32 value); void temac_indirect_out32(struct temac_local *lp, int reg, u32 value);
/* xilinx_temac_mdio.c */ /* xilinx_temac_mdio.c */
int temac_mdio_setup(struct temac_local *lp, struct device_node *np); int temac_mdio_setup(struct temac_local *lp, struct platform_device *pdev);
void temac_mdio_teardown(struct temac_local *lp); void temac_mdio_teardown(struct temac_local *lp);
#endif /* XILINX_LL_TEMAC_H */ #endif /* XILINX_LL_TEMAC_H */
...@@ -33,6 +33,7 @@ ...@@ -33,6 +33,7 @@
#include <linux/module.h> #include <linux/module.h>
#include <linux/mutex.h> #include <linux/mutex.h>
#include <linux/netdevice.h> #include <linux/netdevice.h>
#include <linux/if_ether.h>
#include <linux/of.h> #include <linux/of.h>
#include <linux/of_device.h> #include <linux/of_device.h>
#include <linux/of_irq.h> #include <linux/of_irq.h>
...@@ -51,6 +52,7 @@ ...@@ -51,6 +52,7 @@
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
#include <linux/dma-mapping.h> #include <linux/dma-mapping.h>
#include <linux/platform_data/xilinx-ll-temac.h>
#include "ll_temac.h" #include "ll_temac.h"
...@@ -61,14 +63,24 @@ ...@@ -61,14 +63,24 @@
* Low level register access functions * Low level register access functions
*/ */
u32 temac_ior(struct temac_local *lp, int offset) u32 _temac_ior_be(struct temac_local *lp, int offset)
{ {
return in_be32(lp->regs + offset); return ioread32be(lp->regs + offset);
} }
void temac_iow(struct temac_local *lp, int offset, u32 value) void _temac_iow_be(struct temac_local *lp, int offset, u32 value)
{ {
out_be32(lp->regs + offset, value); return iowrite32be(value, lp->regs + offset);
}
u32 _temac_ior_le(struct temac_local *lp, int offset)
{
return ioread32(lp->regs + offset);
}
void _temac_iow_le(struct temac_local *lp, int offset, u32 value)
{
return iowrite32(value, lp->regs + offset);
} }
int temac_indirect_busywait(struct temac_local *lp) int temac_indirect_busywait(struct temac_local *lp)
...@@ -80,7 +92,7 @@ int temac_indirect_busywait(struct temac_local *lp) ...@@ -80,7 +92,7 @@ int temac_indirect_busywait(struct temac_local *lp)
WARN_ON(1); WARN_ON(1);
return -ETIMEDOUT; return -ETIMEDOUT;
} }
msleep(1); usleep_range(500, 1000);
} }
return 0; return 0;
} }
...@@ -119,23 +131,35 @@ void temac_indirect_out32(struct temac_local *lp, int reg, u32 value) ...@@ -119,23 +131,35 @@ void temac_indirect_out32(struct temac_local *lp, int reg, u32 value)
} }
/** /**
* temac_dma_in32 - Memory mapped DMA read, this function expects a * temac_dma_in32_* - Memory mapped DMA read, these function expects a
* register input that is based on DCR word addresses which * register input that is based on DCR word addresses which are then
* are then converted to memory mapped byte addresses * converted to memory mapped byte addresses. To be assigned to
* lp->dma_in32.
*/ */
static u32 temac_dma_in32(struct temac_local *lp, int reg) static u32 temac_dma_in32_be(struct temac_local *lp, int reg)
{ {
return in_be32(lp->sdma_regs + (reg << 2)); return ioread32be(lp->sdma_regs + (reg << 2));
}
static u32 temac_dma_in32_le(struct temac_local *lp, int reg)
{
return ioread32(lp->sdma_regs + (reg << 2));
} }
/** /**
* temac_dma_out32 - Memory mapped DMA read, this function expects a * temac_dma_out32_* - Memory mapped DMA read, these function expects
* register input that is based on DCR word addresses which * a register input that is based on DCR word addresses which are then
* are then converted to memory mapped byte addresses * converted to memory mapped byte addresses. To be assigned to
* lp->dma_out32.
*/ */
static void temac_dma_out32(struct temac_local *lp, int reg, u32 value) static void temac_dma_out32_be(struct temac_local *lp, int reg, u32 value)
{
iowrite32be(value, lp->sdma_regs + (reg << 2));
}
static void temac_dma_out32_le(struct temac_local *lp, int reg, u32 value)
{ {
out_be32(lp->sdma_regs + (reg << 2), value); iowrite32(value, lp->sdma_regs + (reg << 2));
} }
/* DMA register access functions can be DCR based or memory mapped. /* DMA register access functions can be DCR based or memory mapped.
...@@ -187,7 +211,7 @@ static int temac_dcr_setup(struct temac_local *lp, struct platform_device *op, ...@@ -187,7 +211,7 @@ static int temac_dcr_setup(struct temac_local *lp, struct platform_device *op,
/* /*
* temac_dcr_setup - This is a stub for when DCR is not supported, * temac_dcr_setup - This is a stub for when DCR is not supported,
* such as with MicroBlaze * such as with MicroBlaze and x86
*/ */
static int temac_dcr_setup(struct temac_local *lp, struct platform_device *op, static int temac_dcr_setup(struct temac_local *lp, struct platform_device *op,
struct device_node *np) struct device_node *np)
...@@ -225,7 +249,6 @@ static void temac_dma_bd_release(struct net_device *ndev) ...@@ -225,7 +249,6 @@ static void temac_dma_bd_release(struct net_device *ndev)
dma_free_coherent(ndev->dev.parent, dma_free_coherent(ndev->dev.parent,
sizeof(*lp->tx_bd_v) * TX_BD_NUM, sizeof(*lp->tx_bd_v) * TX_BD_NUM,
lp->tx_bd_v, lp->tx_bd_p); lp->tx_bd_v, lp->tx_bd_p);
kfree(lp->rx_skb);
} }
/** /**
...@@ -235,9 +258,11 @@ static int temac_dma_bd_init(struct net_device *ndev) ...@@ -235,9 +258,11 @@ static int temac_dma_bd_init(struct net_device *ndev)
{ {
struct temac_local *lp = netdev_priv(ndev); struct temac_local *lp = netdev_priv(ndev);
struct sk_buff *skb; struct sk_buff *skb;
dma_addr_t skb_dma_addr;
int i; int i;
lp->rx_skb = kcalloc(RX_BD_NUM, sizeof(*lp->rx_skb), GFP_KERNEL); lp->rx_skb = devm_kcalloc(&ndev->dev, RX_BD_NUM, sizeof(*lp->rx_skb),
GFP_KERNEL);
if (!lp->rx_skb) if (!lp->rx_skb)
goto out; goto out;
...@@ -256,13 +281,13 @@ static int temac_dma_bd_init(struct net_device *ndev) ...@@ -256,13 +281,13 @@ static int temac_dma_bd_init(struct net_device *ndev)
goto out; goto out;
for (i = 0; i < TX_BD_NUM; i++) { for (i = 0; i < TX_BD_NUM; i++) {
lp->tx_bd_v[i].next = lp->tx_bd_p + lp->tx_bd_v[i].next = cpu_to_be32(lp->tx_bd_p
sizeof(*lp->tx_bd_v) * ((i + 1) % TX_BD_NUM); + sizeof(*lp->tx_bd_v) * ((i + 1) % TX_BD_NUM));
} }
for (i = 0; i < RX_BD_NUM; i++) { for (i = 0; i < RX_BD_NUM; i++) {
lp->rx_bd_v[i].next = lp->rx_bd_p + lp->rx_bd_v[i].next = cpu_to_be32(lp->rx_bd_p
sizeof(*lp->rx_bd_v) * ((i + 1) % RX_BD_NUM); + sizeof(*lp->rx_bd_v) * ((i + 1) % RX_BD_NUM));
skb = netdev_alloc_skb_ip_align(ndev, skb = netdev_alloc_skb_ip_align(ndev,
XTE_MAX_JUMBO_FRAME_SIZE); XTE_MAX_JUMBO_FRAME_SIZE);
...@@ -271,31 +296,23 @@ static int temac_dma_bd_init(struct net_device *ndev) ...@@ -271,31 +296,23 @@ static int temac_dma_bd_init(struct net_device *ndev)
lp->rx_skb[i] = skb; lp->rx_skb[i] = skb;
/* returns physical address of skb->data */ /* returns physical address of skb->data */
lp->rx_bd_v[i].phys = dma_map_single(ndev->dev.parent, skb_dma_addr = dma_map_single(ndev->dev.parent, skb->data,
skb->data,
XTE_MAX_JUMBO_FRAME_SIZE, XTE_MAX_JUMBO_FRAME_SIZE,
DMA_FROM_DEVICE); DMA_FROM_DEVICE);
lp->rx_bd_v[i].len = XTE_MAX_JUMBO_FRAME_SIZE; lp->rx_bd_v[i].phys = cpu_to_be32(skb_dma_addr);
lp->rx_bd_v[i].app0 = STS_CTRL_APP0_IRQONEND; lp->rx_bd_v[i].len = cpu_to_be32(XTE_MAX_JUMBO_FRAME_SIZE);
lp->rx_bd_v[i].app0 = cpu_to_be32(STS_CTRL_APP0_IRQONEND);
} }
lp->dma_out(lp, TX_CHNL_CTRL, 0x10220400 | /* Configure DMA channel (irq setup) */
CHNL_CTRL_IRQ_EN | lp->dma_out(lp, TX_CHNL_CTRL, lp->tx_chnl_ctrl |
CHNL_CTRL_IRQ_DLY_EN | 0x00000400 | // Use 1 Bit Wide Counters. Currently Not Used!
CHNL_CTRL_IRQ_COAL_EN); CHNL_CTRL_IRQ_EN | CHNL_CTRL_IRQ_ERR_EN |
/* 0x10220483 */ CHNL_CTRL_IRQ_DLY_EN | CHNL_CTRL_IRQ_COAL_EN);
/* 0x00100483 */ lp->dma_out(lp, RX_CHNL_CTRL, lp->rx_chnl_ctrl |
lp->dma_out(lp, RX_CHNL_CTRL, 0xff070000 | CHNL_CTRL_IRQ_IOE |
CHNL_CTRL_IRQ_EN | CHNL_CTRL_IRQ_EN | CHNL_CTRL_IRQ_ERR_EN |
CHNL_CTRL_IRQ_DLY_EN | CHNL_CTRL_IRQ_DLY_EN | CHNL_CTRL_IRQ_COAL_EN);
CHNL_CTRL_IRQ_COAL_EN |
CHNL_CTRL_IRQ_IOE);
/* 0xff010283 */
lp->dma_out(lp, RX_CURDESC_PTR, lp->rx_bd_p);
lp->dma_out(lp, RX_TAILDESC_PTR,
lp->rx_bd_p + (sizeof(*lp->rx_bd_v) * (RX_BD_NUM - 1)));
lp->dma_out(lp, TX_CURDESC_PTR, lp->tx_bd_p);
/* Init descriptor indexes */ /* Init descriptor indexes */
lp->tx_bd_ci = 0; lp->tx_bd_ci = 0;
...@@ -303,6 +320,15 @@ static int temac_dma_bd_init(struct net_device *ndev) ...@@ -303,6 +320,15 @@ static int temac_dma_bd_init(struct net_device *ndev)
lp->tx_bd_tail = 0; lp->tx_bd_tail = 0;
lp->rx_bd_ci = 0; lp->rx_bd_ci = 0;
/* Enable RX DMA transfers */
wmb();
lp->dma_out(lp, RX_CURDESC_PTR, lp->rx_bd_p);
lp->dma_out(lp, RX_TAILDESC_PTR,
lp->rx_bd_p + (sizeof(*lp->rx_bd_v) * (RX_BD_NUM - 1)));
/* Prepare for TX DMA transfer */
lp->dma_out(lp, TX_CURDESC_PTR, lp->tx_bd_p);
return 0; return 0;
out: out:
...@@ -319,7 +345,7 @@ static void temac_do_set_mac_address(struct net_device *ndev) ...@@ -319,7 +345,7 @@ static void temac_do_set_mac_address(struct net_device *ndev)
struct temac_local *lp = netdev_priv(ndev); struct temac_local *lp = netdev_priv(ndev);
/* set up unicast MAC address filter set its mac address */ /* set up unicast MAC address filter set its mac address */
mutex_lock(&lp->indirect_mutex); mutex_lock(lp->indirect_mutex);
temac_indirect_out32(lp, XTE_UAW0_OFFSET, temac_indirect_out32(lp, XTE_UAW0_OFFSET,
(ndev->dev_addr[0]) | (ndev->dev_addr[0]) |
(ndev->dev_addr[1] << 8) | (ndev->dev_addr[1] << 8) |
...@@ -330,7 +356,7 @@ static void temac_do_set_mac_address(struct net_device *ndev) ...@@ -330,7 +356,7 @@ static void temac_do_set_mac_address(struct net_device *ndev)
temac_indirect_out32(lp, XTE_UAW1_OFFSET, temac_indirect_out32(lp, XTE_UAW1_OFFSET,
(ndev->dev_addr[4] & 0x000000ff) | (ndev->dev_addr[4] & 0x000000ff) |
(ndev->dev_addr[5] << 8)); (ndev->dev_addr[5] << 8));
mutex_unlock(&lp->indirect_mutex); mutex_unlock(lp->indirect_mutex);
} }
static int temac_init_mac_address(struct net_device *ndev, const void *address) static int temac_init_mac_address(struct net_device *ndev, const void *address)
...@@ -359,7 +385,7 @@ static void temac_set_multicast_list(struct net_device *ndev) ...@@ -359,7 +385,7 @@ static void temac_set_multicast_list(struct net_device *ndev)
u32 multi_addr_msw, multi_addr_lsw, val; u32 multi_addr_msw, multi_addr_lsw, val;
int i; int i;
mutex_lock(&lp->indirect_mutex); mutex_lock(lp->indirect_mutex);
if (ndev->flags & (IFF_ALLMULTI | IFF_PROMISC) || if (ndev->flags & (IFF_ALLMULTI | IFF_PROMISC) ||
netdev_mc_count(ndev) > MULTICAST_CAM_TABLE_NUM) { netdev_mc_count(ndev) > MULTICAST_CAM_TABLE_NUM) {
/* /*
...@@ -398,7 +424,7 @@ static void temac_set_multicast_list(struct net_device *ndev) ...@@ -398,7 +424,7 @@ static void temac_set_multicast_list(struct net_device *ndev)
temac_indirect_out32(lp, XTE_MAW1_OFFSET, 0); temac_indirect_out32(lp, XTE_MAW1_OFFSET, 0);
dev_info(&ndev->dev, "Promiscuous mode disabled.\n"); dev_info(&ndev->dev, "Promiscuous mode disabled.\n");
} }
mutex_unlock(&lp->indirect_mutex); mutex_unlock(lp->indirect_mutex);
} }
static struct temac_option { static struct temac_option {
...@@ -490,7 +516,7 @@ static u32 temac_setoptions(struct net_device *ndev, u32 options) ...@@ -490,7 +516,7 @@ static u32 temac_setoptions(struct net_device *ndev, u32 options)
struct temac_option *tp = &temac_options[0]; struct temac_option *tp = &temac_options[0];
int reg; int reg;
mutex_lock(&lp->indirect_mutex); mutex_lock(lp->indirect_mutex);
while (tp->opt) { while (tp->opt) {
reg = temac_indirect_in32(lp, tp->reg) & ~tp->m_or; reg = temac_indirect_in32(lp, tp->reg) & ~tp->m_or;
if (options & tp->opt) if (options & tp->opt)
...@@ -499,7 +525,7 @@ static u32 temac_setoptions(struct net_device *ndev, u32 options) ...@@ -499,7 +525,7 @@ static u32 temac_setoptions(struct net_device *ndev, u32 options)
tp++; tp++;
} }
lp->options |= options; lp->options |= options;
mutex_unlock(&lp->indirect_mutex); mutex_unlock(lp->indirect_mutex);
return 0; return 0;
} }
...@@ -518,7 +544,7 @@ static void temac_device_reset(struct net_device *ndev) ...@@ -518,7 +544,7 @@ static void temac_device_reset(struct net_device *ndev)
dev_dbg(&ndev->dev, "%s()\n", __func__); dev_dbg(&ndev->dev, "%s()\n", __func__);
mutex_lock(&lp->indirect_mutex); mutex_lock(lp->indirect_mutex);
/* Reset the receiver and wait for it to finish reset */ /* Reset the receiver and wait for it to finish reset */
temac_indirect_out32(lp, XTE_RXC1_OFFSET, XTE_RXC1_RXRST_MASK); temac_indirect_out32(lp, XTE_RXC1_OFFSET, XTE_RXC1_RXRST_MASK);
timeout = 1000; timeout = 1000;
...@@ -570,7 +596,7 @@ static void temac_device_reset(struct net_device *ndev) ...@@ -570,7 +596,7 @@ static void temac_device_reset(struct net_device *ndev)
temac_indirect_out32(lp, XTE_TXC_OFFSET, 0); temac_indirect_out32(lp, XTE_TXC_OFFSET, 0);
temac_indirect_out32(lp, XTE_FCC_OFFSET, XTE_FCC_RXFLO_MASK); temac_indirect_out32(lp, XTE_FCC_OFFSET, XTE_FCC_RXFLO_MASK);
mutex_unlock(&lp->indirect_mutex); mutex_unlock(lp->indirect_mutex);
/* Sync default options with HW /* Sync default options with HW
* but leave receiver and transmitter disabled. */ * but leave receiver and transmitter disabled. */
...@@ -598,7 +624,7 @@ static void temac_adjust_link(struct net_device *ndev) ...@@ -598,7 +624,7 @@ static void temac_adjust_link(struct net_device *ndev)
/* hash together the state values to decide if something has changed */ /* hash together the state values to decide if something has changed */
link_state = phy->speed | (phy->duplex << 1) | phy->link; link_state = phy->speed | (phy->duplex << 1) | phy->link;
mutex_lock(&lp->indirect_mutex); mutex_lock(lp->indirect_mutex);
if (lp->last_link != link_state) { if (lp->last_link != link_state) {
mii_speed = temac_indirect_in32(lp, XTE_EMCFG_OFFSET); mii_speed = temac_indirect_in32(lp, XTE_EMCFG_OFFSET);
mii_speed &= ~XTE_EMCFG_LINKSPD_MASK; mii_speed &= ~XTE_EMCFG_LINKSPD_MASK;
...@@ -614,23 +640,52 @@ static void temac_adjust_link(struct net_device *ndev) ...@@ -614,23 +640,52 @@ static void temac_adjust_link(struct net_device *ndev)
lp->last_link = link_state; lp->last_link = link_state;
phy_print_status(phy); phy_print_status(phy);
} }
mutex_unlock(&lp->indirect_mutex); mutex_unlock(lp->indirect_mutex);
} }
#ifdef CONFIG_64BIT
void ptr_to_txbd(void *p, struct cdmac_bd *bd)
{
bd->app3 = (u32)(((u64)p) >> 32);
bd->app4 = (u32)((u64)p & 0xFFFFFFFF);
}
void *ptr_from_txbd(struct cdmac_bd *bd)
{
return (void *)(((u64)(bd->app3) << 32) | bd->app4);
}
#else
void ptr_to_txbd(void *p, struct cmdac_bd *bd)
{
bd->app4 = (u32)p;
}
void *ptr_from_txbd(struct cdmac_bd *bd)
{
return (void *)(bd->app4);
}
#endif
static void temac_start_xmit_done(struct net_device *ndev) static void temac_start_xmit_done(struct net_device *ndev)
{ {
struct temac_local *lp = netdev_priv(ndev); struct temac_local *lp = netdev_priv(ndev);
struct cdmac_bd *cur_p; struct cdmac_bd *cur_p;
unsigned int stat = 0; unsigned int stat = 0;
struct sk_buff *skb;
cur_p = &lp->tx_bd_v[lp->tx_bd_ci]; cur_p = &lp->tx_bd_v[lp->tx_bd_ci];
stat = cur_p->app0; stat = be32_to_cpu(cur_p->app0);
while (stat & STS_CTRL_APP0_CMPLT) { while (stat & STS_CTRL_APP0_CMPLT) {
dma_unmap_single(ndev->dev.parent, cur_p->phys, cur_p->len, dma_unmap_single(ndev->dev.parent, be32_to_cpu(cur_p->phys),
DMA_TO_DEVICE); be32_to_cpu(cur_p->len), DMA_TO_DEVICE);
if (cur_p->app4) skb = (struct sk_buff *)ptr_from_txbd(cur_p);
dev_consume_skb_irq((struct sk_buff *)cur_p->app4); if (skb)
dev_consume_skb_irq(skb);
cur_p->app0 = 0; cur_p->app0 = 0;
cur_p->app1 = 0; cur_p->app1 = 0;
cur_p->app2 = 0; cur_p->app2 = 0;
...@@ -638,14 +693,14 @@ static void temac_start_xmit_done(struct net_device *ndev) ...@@ -638,14 +693,14 @@ static void temac_start_xmit_done(struct net_device *ndev)
cur_p->app4 = 0; cur_p->app4 = 0;
ndev->stats.tx_packets++; ndev->stats.tx_packets++;
ndev->stats.tx_bytes += cur_p->len; ndev->stats.tx_bytes += be32_to_cpu(cur_p->len);
lp->tx_bd_ci++; lp->tx_bd_ci++;
if (lp->tx_bd_ci >= TX_BD_NUM) if (lp->tx_bd_ci >= TX_BD_NUM)
lp->tx_bd_ci = 0; lp->tx_bd_ci = 0;
cur_p = &lp->tx_bd_v[lp->tx_bd_ci]; cur_p = &lp->tx_bd_v[lp->tx_bd_ci];
stat = cur_p->app0; stat = be32_to_cpu(cur_p->app0);
} }
netif_wake_queue(ndev); netif_wake_queue(ndev);
...@@ -679,7 +734,7 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev) ...@@ -679,7 +734,7 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev)
{ {
struct temac_local *lp = netdev_priv(ndev); struct temac_local *lp = netdev_priv(ndev);
struct cdmac_bd *cur_p; struct cdmac_bd *cur_p;
dma_addr_t start_p, tail_p; dma_addr_t start_p, tail_p, skb_dma_addr;
int ii; int ii;
unsigned long num_frag; unsigned long num_frag;
skb_frag_t *frag; skb_frag_t *frag;
...@@ -689,7 +744,7 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev) ...@@ -689,7 +744,7 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev)
start_p = lp->tx_bd_p + sizeof(*lp->tx_bd_v) * lp->tx_bd_tail; start_p = lp->tx_bd_p + sizeof(*lp->tx_bd_v) * lp->tx_bd_tail;
cur_p = &lp->tx_bd_v[lp->tx_bd_tail]; cur_p = &lp->tx_bd_v[lp->tx_bd_tail];
if (temac_check_tx_bd_space(lp, num_frag)) { if (temac_check_tx_bd_space(lp, num_frag + 1)) {
if (!netif_queue_stopped(ndev)) if (!netif_queue_stopped(ndev))
netif_stop_queue(ndev); netif_stop_queue(ndev);
return NETDEV_TX_BUSY; return NETDEV_TX_BUSY;
...@@ -700,16 +755,18 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev) ...@@ -700,16 +755,18 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev)
unsigned int csum_start_off = skb_checksum_start_offset(skb); unsigned int csum_start_off = skb_checksum_start_offset(skb);
unsigned int csum_index_off = csum_start_off + skb->csum_offset; unsigned int csum_index_off = csum_start_off + skb->csum_offset;
cur_p->app0 |= 1; /* TX Checksum Enabled */ cur_p->app0 |= cpu_to_be32(0x000001); /* TX Checksum Enabled */
cur_p->app1 = (csum_start_off << 16) | csum_index_off; cur_p->app1 = cpu_to_be32((csum_start_off << 16)
| csum_index_off);
cur_p->app2 = 0; /* initial checksum seed */ cur_p->app2 = 0; /* initial checksum seed */
} }
cur_p->app0 |= STS_CTRL_APP0_SOP; cur_p->app0 |= cpu_to_be32(STS_CTRL_APP0_SOP);
cur_p->len = skb_headlen(skb); skb_dma_addr = dma_map_single(ndev->dev.parent, skb->data,
cur_p->phys = dma_map_single(ndev->dev.parent, skb->data,
skb_headlen(skb), DMA_TO_DEVICE); skb_headlen(skb), DMA_TO_DEVICE);
cur_p->app4 = (unsigned long)skb; cur_p->len = cpu_to_be32(skb_headlen(skb));
cur_p->phys = cpu_to_be32(skb_dma_addr);
ptr_to_txbd((void *)skb, cur_p);
for (ii = 0; ii < num_frag; ii++) { for (ii = 0; ii < num_frag; ii++) {
lp->tx_bd_tail++; lp->tx_bd_tail++;
...@@ -717,14 +774,16 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev) ...@@ -717,14 +774,16 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev)
lp->tx_bd_tail = 0; lp->tx_bd_tail = 0;
cur_p = &lp->tx_bd_v[lp->tx_bd_tail]; cur_p = &lp->tx_bd_v[lp->tx_bd_tail];
cur_p->phys = dma_map_single(ndev->dev.parent, skb_dma_addr = dma_map_single(ndev->dev.parent,
skb_frag_address(frag), skb_frag_address(frag),
skb_frag_size(frag), DMA_TO_DEVICE); skb_frag_size(frag),
cur_p->len = skb_frag_size(frag); DMA_TO_DEVICE);
cur_p->phys = cpu_to_be32(skb_dma_addr);
cur_p->len = cpu_to_be32(skb_frag_size(frag));
cur_p->app0 = 0; cur_p->app0 = 0;
frag++; frag++;
} }
cur_p->app0 |= STS_CTRL_APP0_EOP; cur_p->app0 |= cpu_to_be32(STS_CTRL_APP0_EOP);
tail_p = lp->tx_bd_p + sizeof(*lp->tx_bd_v) * lp->tx_bd_tail; tail_p = lp->tx_bd_p + sizeof(*lp->tx_bd_v) * lp->tx_bd_tail;
lp->tx_bd_tail++; lp->tx_bd_tail++;
...@@ -734,6 +793,7 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev) ...@@ -734,6 +793,7 @@ temac_start_xmit(struct sk_buff *skb, struct net_device *ndev)
skb_tx_timestamp(skb); skb_tx_timestamp(skb);
/* Kick off the transfer */ /* Kick off the transfer */
wmb();
lp->dma_out(lp, TX_TAILDESC_PTR, tail_p); /* DMA start */ lp->dma_out(lp, TX_TAILDESC_PTR, tail_p); /* DMA start */
return NETDEV_TX_OK; return NETDEV_TX_OK;
...@@ -746,7 +806,7 @@ static void ll_temac_recv(struct net_device *ndev) ...@@ -746,7 +806,7 @@ static void ll_temac_recv(struct net_device *ndev)
struct sk_buff *skb, *new_skb; struct sk_buff *skb, *new_skb;
unsigned int bdstat; unsigned int bdstat;
struct cdmac_bd *cur_p; struct cdmac_bd *cur_p;
dma_addr_t tail_p; dma_addr_t tail_p, skb_dma_addr;
int length; int length;
unsigned long flags; unsigned long flags;
...@@ -755,14 +815,14 @@ static void ll_temac_recv(struct net_device *ndev) ...@@ -755,14 +815,14 @@ static void ll_temac_recv(struct net_device *ndev)
tail_p = lp->rx_bd_p + sizeof(*lp->rx_bd_v) * lp->rx_bd_ci; tail_p = lp->rx_bd_p + sizeof(*lp->rx_bd_v) * lp->rx_bd_ci;
cur_p = &lp->rx_bd_v[lp->rx_bd_ci]; cur_p = &lp->rx_bd_v[lp->rx_bd_ci];
bdstat = cur_p->app0; bdstat = be32_to_cpu(cur_p->app0);
while ((bdstat & STS_CTRL_APP0_CMPLT)) { while ((bdstat & STS_CTRL_APP0_CMPLT)) {
skb = lp->rx_skb[lp->rx_bd_ci]; skb = lp->rx_skb[lp->rx_bd_ci];
length = cur_p->app4 & 0x3FFF; length = be32_to_cpu(cur_p->app4) & 0x3FFF;
dma_unmap_single(ndev->dev.parent, cur_p->phys, length, dma_unmap_single(ndev->dev.parent, be32_to_cpu(cur_p->phys),
DMA_FROM_DEVICE); XTE_MAX_JUMBO_FRAME_SIZE, DMA_FROM_DEVICE);
skb_put(skb, length); skb_put(skb, length);
skb->protocol = eth_type_trans(skb, ndev); skb->protocol = eth_type_trans(skb, ndev);
...@@ -773,7 +833,12 @@ static void ll_temac_recv(struct net_device *ndev) ...@@ -773,7 +833,12 @@ static void ll_temac_recv(struct net_device *ndev)
(skb->protocol == htons(ETH_P_IP)) && (skb->protocol == htons(ETH_P_IP)) &&
(skb->len > 64)) { (skb->len > 64)) {
skb->csum = cur_p->app3 & 0xFFFF; /* Convert from device endianness (be32) to cpu
* endiannes, and if necessary swap the bytes
* (back) for proper IP checksum byte order
* (be16).
*/
skb->csum = htons(be32_to_cpu(cur_p->app3) & 0xFFFF);
skb->ip_summed = CHECKSUM_COMPLETE; skb->ip_summed = CHECKSUM_COMPLETE;
} }
...@@ -790,11 +855,12 @@ static void ll_temac_recv(struct net_device *ndev) ...@@ -790,11 +855,12 @@ static void ll_temac_recv(struct net_device *ndev)
return; return;
} }
cur_p->app0 = STS_CTRL_APP0_IRQONEND; cur_p->app0 = cpu_to_be32(STS_CTRL_APP0_IRQONEND);
cur_p->phys = dma_map_single(ndev->dev.parent, new_skb->data, skb_dma_addr = dma_map_single(ndev->dev.parent, new_skb->data,
XTE_MAX_JUMBO_FRAME_SIZE, XTE_MAX_JUMBO_FRAME_SIZE,
DMA_FROM_DEVICE); DMA_FROM_DEVICE);
cur_p->len = XTE_MAX_JUMBO_FRAME_SIZE; cur_p->phys = cpu_to_be32(skb_dma_addr);
cur_p->len = cpu_to_be32(XTE_MAX_JUMBO_FRAME_SIZE);
lp->rx_skb[lp->rx_bd_ci] = new_skb; lp->rx_skb[lp->rx_bd_ci] = new_skb;
lp->rx_bd_ci++; lp->rx_bd_ci++;
...@@ -802,7 +868,7 @@ static void ll_temac_recv(struct net_device *ndev) ...@@ -802,7 +868,7 @@ static void ll_temac_recv(struct net_device *ndev)
lp->rx_bd_ci = 0; lp->rx_bd_ci = 0;
cur_p = &lp->rx_bd_v[lp->rx_bd_ci]; cur_p = &lp->rx_bd_v[lp->rx_bd_ci];
bdstat = cur_p->app0; bdstat = be32_to_cpu(cur_p->app0);
} }
lp->dma_out(lp, RX_TAILDESC_PTR, tail_p); lp->dma_out(lp, RX_TAILDESC_PTR, tail_p);
...@@ -857,7 +923,14 @@ static int temac_open(struct net_device *ndev) ...@@ -857,7 +923,14 @@ static int temac_open(struct net_device *ndev)
dev_err(lp->dev, "of_phy_connect() failed\n"); dev_err(lp->dev, "of_phy_connect() failed\n");
return -ENODEV; return -ENODEV;
} }
phy_start(phydev);
} else if (strlen(lp->phy_name) > 0) {
phydev = phy_connect(lp->ndev, lp->phy_name, temac_adjust_link,
lp->phy_interface);
if (!phydev) {
dev_err(lp->dev, "phy_connect() failed\n");
return -ENODEV;
}
phy_start(phydev); phy_start(phydev);
} }
...@@ -977,22 +1050,25 @@ static const struct ethtool_ops temac_ethtool_ops = { ...@@ -977,22 +1050,25 @@ static const struct ethtool_ops temac_ethtool_ops = {
.set_link_ksettings = phy_ethtool_set_link_ksettings, .set_link_ksettings = phy_ethtool_set_link_ksettings,
}; };
static int temac_of_probe(struct platform_device *op) static int temac_probe(struct platform_device *pdev)
{ {
struct device_node *np; struct ll_temac_platform_data *pdata = dev_get_platdata(&pdev->dev);
struct device_node *temac_np = dev_of_node(&pdev->dev), *dma_np;
struct temac_local *lp; struct temac_local *lp;
struct net_device *ndev; struct net_device *ndev;
struct resource *res;
const void *addr; const void *addr;
__be32 *p; __be32 *p;
bool little_endian;
int rc = 0; int rc = 0;
/* Init network device structure */ /* Init network device structure */
ndev = alloc_etherdev(sizeof(*lp)); ndev = devm_alloc_etherdev(&pdev->dev, sizeof(*lp));
if (!ndev) if (!ndev)
return -ENOMEM; return -ENOMEM;
platform_set_drvdata(op, ndev); platform_set_drvdata(pdev, ndev);
SET_NETDEV_DEV(ndev, &op->dev); SET_NETDEV_DEV(ndev, &pdev->dev);
ndev->flags &= ~IFF_MULTICAST; /* clear multicast */ ndev->flags &= ~IFF_MULTICAST; /* clear multicast */
ndev->features = NETIF_F_SG; ndev->features = NETIF_F_SG;
ndev->netdev_ops = &temac_netdev_ops; ndev->netdev_ops = &temac_netdev_ops;
...@@ -1014,89 +1090,196 @@ static int temac_of_probe(struct platform_device *op) ...@@ -1014,89 +1090,196 @@ static int temac_of_probe(struct platform_device *op)
/* setup temac private info structure */ /* setup temac private info structure */
lp = netdev_priv(ndev); lp = netdev_priv(ndev);
lp->ndev = ndev; lp->ndev = ndev;
lp->dev = &op->dev; lp->dev = &pdev->dev;
lp->options = XTE_OPTION_DEFAULTS; lp->options = XTE_OPTION_DEFAULTS;
spin_lock_init(&lp->rx_lock); spin_lock_init(&lp->rx_lock);
mutex_init(&lp->indirect_mutex);
/* Setup mutex for synchronization of indirect register access */
if (pdata) {
if (!pdata->indirect_mutex) {
dev_err(&pdev->dev,
"indirect_mutex missing in platform_data\n");
return -EINVAL;
}
lp->indirect_mutex = pdata->indirect_mutex;
} else {
lp->indirect_mutex = devm_kmalloc(&pdev->dev,
sizeof(*lp->indirect_mutex),
GFP_KERNEL);
mutex_init(lp->indirect_mutex);
}
/* map device registers */ /* map device registers */
lp->regs = of_iomap(op->dev.of_node, 0); res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
if (!lp->regs) { lp->regs = devm_ioremap_nocache(&pdev->dev, res->start,
dev_err(&op->dev, "could not map temac regs.\n"); resource_size(res));
rc = -ENOMEM; if (IS_ERR(lp->regs)) {
goto nodev; dev_err(&pdev->dev, "could not map TEMAC registers\n");
return PTR_ERR(lp->regs);
}
/* Select register access functions with the specified
* endianness mode. Default for OF devices is big-endian.
*/
little_endian = false;
if (temac_np) {
if (of_get_property(temac_np, "little-endian", NULL))
little_endian = true;
} else if (pdata) {
little_endian = pdata->reg_little_endian;
}
if (little_endian) {
lp->temac_ior = _temac_ior_le;
lp->temac_iow = _temac_iow_le;
} else {
lp->temac_ior = _temac_ior_be;
lp->temac_iow = _temac_iow_be;
} }
/* Setup checksum offload, but default to off if not specified */ /* Setup checksum offload, but default to off if not specified */
lp->temac_features = 0; lp->temac_features = 0;
p = (__be32 *)of_get_property(op->dev.of_node, "xlnx,txcsum", NULL); if (temac_np) {
if (p && be32_to_cpu(*p)) { p = (__be32 *)of_get_property(temac_np, "xlnx,txcsum", NULL);
if (p && be32_to_cpu(*p))
lp->temac_features |= TEMAC_FEATURE_TX_CSUM; lp->temac_features |= TEMAC_FEATURE_TX_CSUM;
/* Can checksum TCP/UDP over IPv4. */ p = (__be32 *)of_get_property(temac_np, "xlnx,rxcsum", NULL);
ndev->features |= NETIF_F_IP_CSUM;
}
p = (__be32 *)of_get_property(op->dev.of_node, "xlnx,rxcsum", NULL);
if (p && be32_to_cpu(*p)) if (p && be32_to_cpu(*p))
lp->temac_features |= TEMAC_FEATURE_RX_CSUM; lp->temac_features |= TEMAC_FEATURE_RX_CSUM;
} else if (pdata) {
/* Find the DMA node, map the DMA registers, and decode the DMA IRQs */ if (pdata->txcsum)
np = of_parse_phandle(op->dev.of_node, "llink-connected", 0); lp->temac_features |= TEMAC_FEATURE_TX_CSUM;
if (!np) { if (pdata->rxcsum)
dev_err(&op->dev, "could not find DMA node\n"); lp->temac_features |= TEMAC_FEATURE_RX_CSUM;
rc = -ENODEV;
goto err_iounmap;
} }
if (lp->temac_features & TEMAC_FEATURE_TX_CSUM)
/* Can checksum TCP/UDP over IPv4. */
ndev->features |= NETIF_F_IP_CSUM;
/* Setup the DMA register accesses, could be DCR or memory mapped */ /* Setup LocalLink DMA */
if (temac_dcr_setup(lp, op, np)) { if (temac_np) {
/* Find the DMA node, map the DMA registers, and
* decode the DMA IRQs.
*/
dma_np = of_parse_phandle(temac_np, "llink-connected", 0);
if (!dma_np) {
dev_err(&pdev->dev, "could not find DMA node\n");
return -ENODEV;
}
/* Setup the DMA register accesses, could be DCR or
* memory mapped.
*/
if (temac_dcr_setup(lp, pdev, dma_np)) {
/* no DCR in the device tree, try non-DCR */ /* no DCR in the device tree, try non-DCR */
lp->sdma_regs = of_iomap(np, 0); lp->sdma_regs = devm_of_iomap(&pdev->dev, dma_np, 0,
if (lp->sdma_regs) { NULL);
lp->dma_in = temac_dma_in32; if (IS_ERR(lp->sdma_regs)) {
lp->dma_out = temac_dma_out32; dev_err(&pdev->dev,
dev_dbg(&op->dev, "MEM base: %p\n", lp->sdma_regs); "unable to map DMA registers\n");
of_node_put(dma_np);
return PTR_ERR(lp->sdma_regs);
}
if (of_get_property(dma_np, "little-endian", NULL)) {
lp->dma_in = temac_dma_in32_le;
lp->dma_out = temac_dma_out32_le;
} else { } else {
dev_err(&op->dev, "unable to map DMA registers\n"); lp->dma_in = temac_dma_in32_be;
of_node_put(np); lp->dma_out = temac_dma_out32_be;
goto err_iounmap;
} }
dev_dbg(&pdev->dev, "MEM base: %p\n", lp->sdma_regs);
} }
lp->rx_irq = irq_of_parse_and_map(np, 0); /* Get DMA RX and TX interrupts */
lp->tx_irq = irq_of_parse_and_map(np, 1); lp->rx_irq = irq_of_parse_and_map(dma_np, 0);
lp->tx_irq = irq_of_parse_and_map(dma_np, 1);
of_node_put(np); /* Finished with the DMA node; drop the reference */ /* Use defaults for IRQ delay/coalescing setup. These
* are configuration values, so does not belong in
* device-tree.
*/
lp->tx_chnl_ctrl = 0x10220000;
lp->rx_chnl_ctrl = 0xff070000;
/* Finished with the DMA node; drop the reference */
of_node_put(dma_np);
} else if (pdata) {
/* 2nd memory resource specifies DMA registers */
res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
lp->sdma_regs = devm_ioremap_nocache(&pdev->dev, res->start,
resource_size(res));
if (IS_ERR(lp->sdma_regs)) {
dev_err(&pdev->dev,
"could not map DMA registers\n");
return PTR_ERR(lp->sdma_regs);
}
if (pdata->dma_little_endian) {
lp->dma_in = temac_dma_in32_le;
lp->dma_out = temac_dma_out32_le;
} else {
lp->dma_in = temac_dma_in32_be;
lp->dma_out = temac_dma_out32_be;
}
if (!lp->rx_irq || !lp->tx_irq) { /* Get DMA RX and TX interrupts */
dev_err(&op->dev, "could not determine irqs\n"); lp->rx_irq = platform_get_irq(pdev, 0);
rc = -ENOMEM; lp->tx_irq = platform_get_irq(pdev, 1);
goto err_iounmap_2;
/* IRQ delay/coalescing setup */
if (pdata->tx_irq_timeout || pdata->tx_irq_count)
lp->tx_chnl_ctrl = (pdata->tx_irq_timeout << 24) |
(pdata->tx_irq_count << 16);
else
lp->tx_chnl_ctrl = 0x10220000;
if (pdata->rx_irq_timeout || pdata->rx_irq_count)
lp->rx_chnl_ctrl = (pdata->rx_irq_timeout << 24) |
(pdata->rx_irq_count << 16);
else
lp->rx_chnl_ctrl = 0xff070000;
} }
/* Error handle returned DMA RX and TX interrupts */
if (lp->rx_irq < 0) {
if (lp->rx_irq != -EPROBE_DEFER)
dev_err(&pdev->dev, "could not get DMA RX irq\n");
return lp->rx_irq;
}
if (lp->tx_irq < 0) {
if (lp->tx_irq != -EPROBE_DEFER)
dev_err(&pdev->dev, "could not get DMA TX irq\n");
return lp->tx_irq;
}
if (temac_np) {
/* Retrieve the MAC address */ /* Retrieve the MAC address */
addr = of_get_mac_address(op->dev.of_node); addr = of_get_mac_address(temac_np);
if (!addr) { if (!addr) {
dev_err(&op->dev, "could not find MAC address\n"); dev_err(&pdev->dev, "could not find MAC address\n");
rc = -ENODEV; return -ENODEV;
goto err_iounmap_2;
} }
temac_init_mac_address(ndev, addr); temac_init_mac_address(ndev, addr);
} else if (pdata) {
temac_init_mac_address(ndev, pdata->mac_addr);
}
rc = temac_mdio_setup(lp, op->dev.of_node); rc = temac_mdio_setup(lp, pdev);
if (rc) if (rc)
dev_warn(&op->dev, "error registering MDIO bus\n"); dev_warn(&pdev->dev, "error registering MDIO bus\n");
lp->phy_node = of_parse_phandle(op->dev.of_node, "phy-handle", 0); if (temac_np) {
lp->phy_node = of_parse_phandle(temac_np, "phy-handle", 0);
if (lp->phy_node) if (lp->phy_node)
dev_dbg(lp->dev, "using PHY node %pOF (%p)\n", np, np); dev_dbg(lp->dev, "using PHY node %pOF\n", temac_np);
} else if (pdata) {
snprintf(lp->phy_name, sizeof(lp->phy_name),
PHY_ID_FMT, lp->mii_bus->id, pdata->phy_addr);
lp->phy_interface = pdata->phy_interface;
}
/* Add the device attributes */ /* Add the device attributes */
rc = sysfs_create_group(&lp->dev->kobj, &temac_attr_group); rc = sysfs_create_group(&lp->dev->kobj, &temac_attr_group);
if (rc) { if (rc) {
dev_err(lp->dev, "Error creating sysfs files\n"); dev_err(lp->dev, "Error creating sysfs files\n");
goto err_iounmap_2; goto err_sysfs_create;
} }
rc = register_netdev(lp->ndev); rc = register_netdev(lp->ndev);
...@@ -1107,33 +1290,25 @@ static int temac_of_probe(struct platform_device *op) ...@@ -1107,33 +1290,25 @@ static int temac_of_probe(struct platform_device *op)
return 0; return 0;
err_register_ndev: err_register_ndev:
sysfs_remove_group(&lp->dev->kobj, &temac_attr_group); sysfs_remove_group(&lp->dev->kobj, &temac_attr_group);
err_iounmap_2: err_sysfs_create:
if (lp->sdma_regs) if (lp->phy_node)
iounmap(lp->sdma_regs); of_node_put(lp->phy_node);
err_iounmap: temac_mdio_teardown(lp);
iounmap(lp->regs);
nodev:
free_netdev(ndev);
ndev = NULL;
return rc; return rc;
} }
static int temac_of_remove(struct platform_device *op) static int temac_remove(struct platform_device *pdev)
{ {
struct net_device *ndev = platform_get_drvdata(op); struct net_device *ndev = platform_get_drvdata(pdev);
struct temac_local *lp = netdev_priv(ndev); struct temac_local *lp = netdev_priv(ndev);
temac_mdio_teardown(lp);
unregister_netdev(ndev); unregister_netdev(ndev);
sysfs_remove_group(&lp->dev->kobj, &temac_attr_group); sysfs_remove_group(&lp->dev->kobj, &temac_attr_group);
if (lp->phy_node)
of_node_put(lp->phy_node); of_node_put(lp->phy_node);
lp->phy_node = NULL; temac_mdio_teardown(lp);
iounmap(lp->regs);
if (lp->sdma_regs)
iounmap(lp->sdma_regs);
free_netdev(ndev);
return 0; return 0;
} }
...@@ -1146,16 +1321,16 @@ static const struct of_device_id temac_of_match[] = { ...@@ -1146,16 +1321,16 @@ static const struct of_device_id temac_of_match[] = {
}; };
MODULE_DEVICE_TABLE(of, temac_of_match); MODULE_DEVICE_TABLE(of, temac_of_match);
static struct platform_driver temac_of_driver = { static struct platform_driver temac_driver = {
.probe = temac_of_probe, .probe = temac_probe,
.remove = temac_of_remove, .remove = temac_remove,
.driver = { .driver = {
.name = "xilinx_temac", .name = "xilinx_temac",
.of_match_table = temac_of_match, .of_match_table = temac_of_match,
}, },
}; };
module_platform_driver(temac_of_driver); module_platform_driver(temac_driver);
MODULE_DESCRIPTION("Xilinx LL_TEMAC Ethernet driver"); MODULE_DESCRIPTION("Xilinx LL_TEMAC Ethernet driver");
MODULE_AUTHOR("Yoshio Kashiwagi"); MODULE_AUTHOR("Yoshio Kashiwagi");
......
...@@ -14,6 +14,7 @@ ...@@ -14,6 +14,7 @@
#include <linux/of_address.h> #include <linux/of_address.h>
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/of_mdio.h> #include <linux/of_mdio.h>
#include <linux/platform_data/xilinx-ll-temac.h>
#include "ll_temac.h" #include "ll_temac.h"
...@@ -28,10 +29,10 @@ static int temac_mdio_read(struct mii_bus *bus, int phy_id, int reg) ...@@ -28,10 +29,10 @@ static int temac_mdio_read(struct mii_bus *bus, int phy_id, int reg)
/* Write the PHY address to the MIIM Access Initiator register. /* Write the PHY address to the MIIM Access Initiator register.
* When the transfer completes, the PHY register value will appear * When the transfer completes, the PHY register value will appear
* in the LSW0 register */ * in the LSW0 register */
mutex_lock(&lp->indirect_mutex); mutex_lock(lp->indirect_mutex);
temac_iow(lp, XTE_LSW0_OFFSET, (phy_id << 5) | reg); temac_iow(lp, XTE_LSW0_OFFSET, (phy_id << 5) | reg);
rc = temac_indirect_in32(lp, XTE_MIIMAI_OFFSET); rc = temac_indirect_in32(lp, XTE_MIIMAI_OFFSET);
mutex_unlock(&lp->indirect_mutex); mutex_unlock(lp->indirect_mutex);
dev_dbg(lp->dev, "temac_mdio_read(phy_id=%i, reg=%x) == %x\n", dev_dbg(lp->dev, "temac_mdio_read(phy_id=%i, reg=%x) == %x\n",
phy_id, reg, rc); phy_id, reg, rc);
...@@ -49,25 +50,34 @@ static int temac_mdio_write(struct mii_bus *bus, int phy_id, int reg, u16 val) ...@@ -49,25 +50,34 @@ static int temac_mdio_write(struct mii_bus *bus, int phy_id, int reg, u16 val)
/* First write the desired value into the write data register /* First write the desired value into the write data register
* and then write the address into the access initiator register * and then write the address into the access initiator register
*/ */
mutex_lock(&lp->indirect_mutex); mutex_lock(lp->indirect_mutex);
temac_indirect_out32(lp, XTE_MGTDR_OFFSET, val); temac_indirect_out32(lp, XTE_MGTDR_OFFSET, val);
temac_indirect_out32(lp, XTE_MIIMAI_OFFSET, (phy_id << 5) | reg); temac_indirect_out32(lp, XTE_MIIMAI_OFFSET, (phy_id << 5) | reg);
mutex_unlock(&lp->indirect_mutex); mutex_unlock(lp->indirect_mutex);
return 0; return 0;
} }
int temac_mdio_setup(struct temac_local *lp, struct device_node *np) int temac_mdio_setup(struct temac_local *lp, struct platform_device *pdev)
{ {
struct ll_temac_platform_data *pdata = dev_get_platdata(&pdev->dev);
struct device_node *np = dev_of_node(&pdev->dev);
struct mii_bus *bus; struct mii_bus *bus;
u32 bus_hz; u32 bus_hz;
int clk_div; int clk_div;
int rc; int rc;
struct resource res; struct resource res;
/* Get MDIO bus frequency (if specified) */
bus_hz = 0;
if (np)
of_property_read_u32(np, "clock-frequency", &bus_hz);
else if (pdata)
bus_hz = pdata->mdio_clk_freq;
/* Calculate a reasonable divisor for the clock rate */ /* Calculate a reasonable divisor for the clock rate */
clk_div = 0x3f; /* worst-case default setting */ clk_div = 0x3f; /* worst-case default setting */
if (of_property_read_u32(np, "clock-frequency", &bus_hz) == 0) { if (bus_hz != 0) {
clk_div = bus_hz / (2500 * 1000 * 2) - 1; clk_div = bus_hz / (2500 * 1000 * 2) - 1;
if (clk_div < 1) if (clk_div < 1)
clk_div = 1; clk_div = 1;
...@@ -77,17 +87,23 @@ int temac_mdio_setup(struct temac_local *lp, struct device_node *np) ...@@ -77,17 +87,23 @@ int temac_mdio_setup(struct temac_local *lp, struct device_node *np)
/* Enable the MDIO bus by asserting the enable bit and writing /* Enable the MDIO bus by asserting the enable bit and writing
* in the clock config */ * in the clock config */
mutex_lock(&lp->indirect_mutex); mutex_lock(lp->indirect_mutex);
temac_indirect_out32(lp, XTE_MC_OFFSET, 1 << 6 | clk_div); temac_indirect_out32(lp, XTE_MC_OFFSET, 1 << 6 | clk_div);
mutex_unlock(&lp->indirect_mutex); mutex_unlock(lp->indirect_mutex);
bus = mdiobus_alloc(); bus = devm_mdiobus_alloc(&pdev->dev);
if (!bus) if (!bus)
return -ENOMEM; return -ENOMEM;
if (np) {
of_address_to_resource(np, 0, &res); of_address_to_resource(np, 0, &res);
snprintf(bus->id, MII_BUS_ID_SIZE, "%.8llx", snprintf(bus->id, MII_BUS_ID_SIZE, "%.8llx",
(unsigned long long)res.start); (unsigned long long)res.start);
} else if (pdata && pdata->mdio_bus_id >= 0) {
snprintf(bus->id, MII_BUS_ID_SIZE, "%.8llx",
pdata->mdio_bus_id);
}
bus->priv = lp; bus->priv = lp;
bus->name = "Xilinx TEMAC MDIO"; bus->name = "Xilinx TEMAC MDIO";
bus->read = temac_mdio_read; bus->read = temac_mdio_read;
...@@ -98,23 +114,16 @@ int temac_mdio_setup(struct temac_local *lp, struct device_node *np) ...@@ -98,23 +114,16 @@ int temac_mdio_setup(struct temac_local *lp, struct device_node *np)
rc = of_mdiobus_register(bus, np); rc = of_mdiobus_register(bus, np);
if (rc) if (rc)
goto err_register; return rc;
mutex_lock(&lp->indirect_mutex); mutex_lock(lp->indirect_mutex);
dev_dbg(lp->dev, "MDIO bus registered; MC:%x\n", dev_dbg(lp->dev, "MDIO bus registered; MC:%x\n",
temac_indirect_in32(lp, XTE_MC_OFFSET)); temac_indirect_in32(lp, XTE_MC_OFFSET));
mutex_unlock(&lp->indirect_mutex); mutex_unlock(lp->indirect_mutex);
return 0; return 0;
err_register:
mdiobus_free(bus);
return rc;
} }
void temac_mdio_teardown(struct temac_local *lp) void temac_mdio_teardown(struct temac_local *lp)
{ {
mdiobus_unregister(lp->mii_bus); mdiobus_unregister(lp->mii_bus);
mdiobus_free(lp->mii_bus);
lp->mii_bus = NULL;
} }
/* SPDX-License-Identifier: GPL-2.0 */
#ifndef __LINUX_XILINX_LL_TEMAC_H
#define __LINUX_XILINX_LL_TEMAC_H
#include <linux/if_ether.h>
#include <linux/phy.h>
struct ll_temac_platform_data {
bool txcsum; /* Enable/disable TX checksum */
bool rxcsum; /* Enable/disable RX checksum */
u8 mac_addr[ETH_ALEN]; /* MAC address (6 bytes) */
/* Clock frequency for input to MDIO clock generator */
u32 mdio_clk_freq;
unsigned long long mdio_bus_id; /* Unique id for MDIO bus */
int phy_addr; /* Address of the PHY to connect to */
phy_interface_t phy_interface; /* PHY interface mode */
bool reg_little_endian; /* Little endian TEMAC register access */
bool dma_little_endian; /* Little endian DMA register access */
/* Pre-initialized mutex to use for synchronizing indirect
* register access. When using both interfaces of a single
* TEMAC IP block, the same mutex should be passed here, as
* they share the same DCR bus bridge.
*/
struct mutex *indirect_mutex;
/* DMA channel control setup */
u8 tx_irq_timeout; /* TX Interrupt Delay Time-out */
u8 tx_irq_count; /* TX Interrupt Coalescing Threshold Count */
u8 rx_irq_timeout; /* RX Interrupt Delay Time-out */
u8 rx_irq_count; /* RX Interrupt Coalescing Threshold Count */
};
#endif /* __LINUX_XILINX_LL_TEMAC_H */
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment