Commit 3c773dba authored by Heyi Guo's avatar Heyi Guo Committed by David S. Miller
Browse files

drivers/net/ftgmac100: adjust code place for function call dependency 



This is to prepare for ftgmac100_adjust_link() to call
ftgmac100_reset() directly. Only code places are changed.

Signed-off-by: default avatarHeyi Guo <guoheyi@linux.alibaba.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 4f1e7285

drivers/net/ethernet/faraday/ftgmac100.c

+111 −111
Original line number Diff line number Diff line
@@ -989,117 +989,6 @@ static int ftgmac100_alloc_rx_buffers(struct ftgmac100 *priv) 
	return 0;

}



static void ftgmac100_adjust_link(struct net_device *netdev)

{

	struct ftgmac100 *priv = netdev_priv(netdev);

	struct phy_device *phydev = netdev->phydev;

	bool tx_pause, rx_pause;

	int new_speed;



	/* We store "no link" as speed 0 */

	if (!phydev->link)

		new_speed = 0;

	else

		new_speed = phydev->speed;



	/* Grab pause settings from PHY if configured to do so */

	if (priv->aneg_pause) {

		rx_pause = tx_pause = phydev->pause;

		if (phydev->asym_pause)

			tx_pause = !rx_pause;

	} else {

		rx_pause = priv->rx_pause;

		tx_pause = priv->tx_pause;

	}



	/* Link hasn't changed, do nothing */

	if (phydev->speed == priv->cur_speed &&

	    phydev->duplex == priv->cur_duplex &&

	    rx_pause == priv->rx_pause &&

	    tx_pause == priv->tx_pause)

		return;



	/* Print status if we have a link or we had one and just lost it,

	 * don't print otherwise.

	 */

	if (new_speed || priv->cur_speed)

		phy_print_status(phydev);



	priv->cur_speed = new_speed;

	priv->cur_duplex = phydev->duplex;

	priv->rx_pause = rx_pause;

	priv->tx_pause = tx_pause;



	/* Link is down, do nothing else */

	if (!new_speed)

		return;



	/* Disable all interrupts */

	iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);



	/* Reset the adapter asynchronously */

	schedule_work(&priv->reset_task);

}



static int ftgmac100_mii_probe(struct net_device *netdev)

{

	struct ftgmac100 *priv = netdev_priv(netdev);

	struct platform_device *pdev = to_platform_device(priv->dev);

	struct device_node *np = pdev->dev.of_node;

	struct phy_device *phydev;

	phy_interface_t phy_intf;

	int err;



	/* Default to RGMII. It's a gigabit part after all */

	err = of_get_phy_mode(np, &phy_intf);

	if (err)

		phy_intf = PHY_INTERFACE_MODE_RGMII;



	/* Aspeed only supports these. I don't know about other IP

	 * block vendors so I'm going to just let them through for

	 * now. Note that this is only a warning if for some obscure

	 * reason the DT really means to lie about it or it's a newer

	 * part we don't know about.

	 *

	 * On the Aspeed SoC there are additionally straps and SCU

	 * control bits that could tell us what the interface is

	 * (or allow us to configure it while the IP block is held

	 * in reset). For now I chose to keep this driver away from

	 * those SoC specific bits and assume the device-tree is

	 * right and the SCU has been configured properly by pinmux

	 * or the firmware.

	 */

	if (priv->is_aspeed && !(phy_interface_mode_is_rgmii(phy_intf))) {

		netdev_warn(netdev,

			    "Unsupported PHY mode %s !\n",

			    phy_modes(phy_intf));

	}



	phydev = phy_find_first(priv->mii_bus);

	if (!phydev) {

		netdev_info(netdev, "%s: no PHY found\n", netdev->name);

		return -ENODEV;

	}



	phydev = phy_connect(netdev, phydev_name(phydev),

			     &ftgmac100_adjust_link, phy_intf);



	if (IS_ERR(phydev)) {

		netdev_err(netdev, "%s: Could not attach to PHY\n", netdev->name);

		return PTR_ERR(phydev);

	}



	/* Indicate that we support PAUSE frames (see comment in

	 * Documentation/networking/phy.rst)

	 */

	phy_support_asym_pause(phydev);



	/* Display what we found */

	phy_attached_info(phydev);



	return 0;

}



static int ftgmac100_mdiobus_read(struct mii_bus *bus, int phy_addr, int regnum)

{

	struct net_device *netdev = bus->priv;
@@ -1465,6 +1354,117 @@ static void ftgmac100_reset_task(struct work_struct *work) 
	ftgmac100_reset(priv);

}



static void ftgmac100_adjust_link(struct net_device *netdev)

{

	struct ftgmac100 *priv = netdev_priv(netdev);

	struct phy_device *phydev = netdev->phydev;

	bool tx_pause, rx_pause;

	int new_speed;



	/* We store "no link" as speed 0 */

	if (!phydev->link)

		new_speed = 0;

	else

		new_speed = phydev->speed;



	/* Grab pause settings from PHY if configured to do so */

	if (priv->aneg_pause) {

		rx_pause = tx_pause = phydev->pause;

		if (phydev->asym_pause)

			tx_pause = !rx_pause;

	} else {

		rx_pause = priv->rx_pause;

		tx_pause = priv->tx_pause;

	}



	/* Link hasn't changed, do nothing */

	if (phydev->speed == priv->cur_speed &&

	    phydev->duplex == priv->cur_duplex &&

	    rx_pause == priv->rx_pause &&

	    tx_pause == priv->tx_pause)

		return;



	/* Print status if we have a link or we had one and just lost it,

	 * don't print otherwise.

	 */

	if (new_speed || priv->cur_speed)

		phy_print_status(phydev);



	priv->cur_speed = new_speed;

	priv->cur_duplex = phydev->duplex;

	priv->rx_pause = rx_pause;

	priv->tx_pause = tx_pause;



	/* Link is down, do nothing else */

	if (!new_speed)

		return;



	/* Disable all interrupts */

	iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);



	/* Reset the adapter asynchronously */

	schedule_work(&priv->reset_task);

}



static int ftgmac100_mii_probe(struct net_device *netdev)

{

	struct ftgmac100 *priv = netdev_priv(netdev);

	struct platform_device *pdev = to_platform_device(priv->dev);

	struct device_node *np = pdev->dev.of_node;

	struct phy_device *phydev;

	phy_interface_t phy_intf;

	int err;



	/* Default to RGMII. It's a gigabit part after all */

	err = of_get_phy_mode(np, &phy_intf);

	if (err)

		phy_intf = PHY_INTERFACE_MODE_RGMII;



	/* Aspeed only supports these. I don't know about other IP

	 * block vendors so I'm going to just let them through for

	 * now. Note that this is only a warning if for some obscure

	 * reason the DT really means to lie about it or it's a newer

	 * part we don't know about.

	 *

	 * On the Aspeed SoC there are additionally straps and SCU

	 * control bits that could tell us what the interface is

	 * (or allow us to configure it while the IP block is held

	 * in reset). For now I chose to keep this driver away from

	 * those SoC specific bits and assume the device-tree is

	 * right and the SCU has been configured properly by pinmux

	 * or the firmware.

	 */

	if (priv->is_aspeed && !(phy_interface_mode_is_rgmii(phy_intf))) {

		netdev_warn(netdev,

			    "Unsupported PHY mode %s !\n",

			    phy_modes(phy_intf));

	}



	phydev = phy_find_first(priv->mii_bus);

	if (!phydev) {

		netdev_info(netdev, "%s: no PHY found\n", netdev->name);

		return -ENODEV;

	}



	phydev = phy_connect(netdev, phydev_name(phydev),

			     &ftgmac100_adjust_link, phy_intf);



	if (IS_ERR(phydev)) {

		netdev_err(netdev, "%s: Could not attach to PHY\n", netdev->name);

		return PTR_ERR(phydev);

	}



	/* Indicate that we support PAUSE frames (see comment in

	 * Documentation/networking/phy.rst)

	 */

	phy_support_asym_pause(phydev);



	/* Display what we found */

	phy_attached_info(phydev);



	return 0;

}



static int ftgmac100_open(struct net_device *netdev)

{

	struct ftgmac100 *priv = netdev_priv(netdev);