Commit f14f5c11 authored by Esben Haabendal's avatar Esben Haabendal Committed by David S. Miller

net: ll_temac: Support indirect_mutex share within TEMAC IP

Indirect register access goes through a DCR bus bridge, which
allows only one outstanding transaction.  And to make matters
worse, each TEMAC IP block contains two Ethernet interfaces, and
although they seem to have separate registers for indirect access,
they actually share the registers.  Or to be more specific, MSW, LSW
and CTL registers are physically shared between Ethernet interfaces
in same TEMAC IP, with RDY register being (almost) specificic to
the Ethernet interface.  The 0x10000 bit in RDY reflects combined
bus ready state though.

So we need to take care to synchronize not only within a single
device, but also between devices in same TEMAC IP.

This commit allows to do that with legacy platform devices.

For OF devices, the xlnx,compound parent of the temac node should be
used to find siblings, and setup a shared indirect_mutex between them.
I will leave this work to somebody else, as I don't have hardware to
test that.  No regression is introduced by that, as before this commit
using two Ethernet interfaces in same TEMAC block is simply broken.
Signed-off-by: default avatarEsben Haabendal <esben@geanix.com>
Reviewed-by: default avatarAndrew Lunn <andrew@lunn.ch>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 2c02c37e
...@@ -358,7 +358,10 @@ struct temac_local { ...@@ -358,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;
......
...@@ -344,7 +344,7 @@ static void temac_do_set_mac_address(struct net_device *ndev) ...@@ -344,7 +344,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) |
...@@ -355,7 +355,7 @@ static void temac_do_set_mac_address(struct net_device *ndev) ...@@ -355,7 +355,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)
...@@ -384,7 +384,7 @@ static void temac_set_multicast_list(struct net_device *ndev) ...@@ -384,7 +384,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) {
/* /*
...@@ -423,7 +423,7 @@ static void temac_set_multicast_list(struct net_device *ndev) ...@@ -423,7 +423,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 {
...@@ -515,7 +515,7 @@ static u32 temac_setoptions(struct net_device *ndev, u32 options) ...@@ -515,7 +515,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)
...@@ -524,7 +524,7 @@ static u32 temac_setoptions(struct net_device *ndev, u32 options) ...@@ -524,7 +524,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;
} }
...@@ -543,7 +543,7 @@ static void temac_device_reset(struct net_device *ndev) ...@@ -543,7 +543,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;
...@@ -595,7 +595,7 @@ static void temac_device_reset(struct net_device *ndev) ...@@ -595,7 +595,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. */
...@@ -623,7 +623,7 @@ static void temac_adjust_link(struct net_device *ndev) ...@@ -623,7 +623,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;
...@@ -639,7 +639,7 @@ static void temac_adjust_link(struct net_device *ndev) ...@@ -639,7 +639,7 @@ 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 #ifdef CONFIG_64BIT
...@@ -1091,7 +1091,21 @@ static int temac_probe(struct platform_device *pdev) ...@@ -1091,7 +1091,21 @@ static int temac_probe(struct platform_device *pdev)
lp->dev = &pdev->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 */
res = platform_get_resource(pdev, IORESOURCE_MEM, 0); res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
......
...@@ -29,10 +29,10 @@ static int temac_mdio_read(struct mii_bus *bus, int phy_id, int reg) ...@@ -29,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);
...@@ -50,10 +50,10 @@ static int temac_mdio_write(struct mii_bus *bus, int phy_id, int reg, u16 val) ...@@ -50,10 +50,10 @@ 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;
} }
...@@ -87,9 +87,9 @@ int temac_mdio_setup(struct temac_local *lp, struct platform_device *pdev) ...@@ -87,9 +87,9 @@ int temac_mdio_setup(struct temac_local *lp, struct platform_device *pdev)
/* 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 = devm_mdiobus_alloc(&pdev->dev); bus = devm_mdiobus_alloc(&pdev->dev);
if (!bus) if (!bus)
...@@ -116,10 +116,10 @@ int temac_mdio_setup(struct temac_local *lp, struct platform_device *pdev) ...@@ -116,10 +116,10 @@ int temac_mdio_setup(struct temac_local *lp, struct platform_device *pdev)
if (rc) if (rc)
return rc; 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;
} }
......
...@@ -16,6 +16,12 @@ struct ll_temac_platform_data { ...@@ -16,6 +16,12 @@ struct ll_temac_platform_data {
phy_interface_t phy_interface; /* PHY interface mode */ phy_interface_t phy_interface; /* PHY interface mode */
bool reg_little_endian; /* Little endian TEMAC register access */ bool reg_little_endian; /* Little endian TEMAC register access */
bool dma_little_endian; /* Little endian DMA 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;
}; };
#endif /* __LINUX_XILINX_LL_TEMAC_H */ #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