Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 2839038b authored by Nicolas Ferre's avatar Nicolas Ferre
Browse files

net/at91_ether: use gpio_is_valid for phy IRQ line



Use the generic gpiolib gpio_is_valid() function to test
if the phy IRQ line GPIO is actually provided.

For non-connected or non-existing phy IRQ lines, -EINVAL
value is used for phy_irq_pin field of struct at91_eth_data.

Signed-off-by: default avatarNicolas Ferre <nicolas.ferre@atmel.com>
Acked-by: default avatarJean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
Acked-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 0d4f99d8
Loading
Loading
Loading
Loading
+13 −10
Original line number Diff line number Diff line
@@ -256,8 +256,7 @@ static void enable_phyirq(struct net_device *dev)
	unsigned int dsintr, irq_number;
	int status;

	irq_number = lp->board_data.phy_irq_pin;
	if (!irq_number) {
	if (!gpio_is_valid(lp->board_data.phy_irq_pin)) {
		/*
		 * PHY doesn't have an IRQ pin (RTL8201, DP83847, AC101L),
		 * or board does not have it connected.
@@ -266,6 +265,7 @@ static void enable_phyirq(struct net_device *dev)
		return;
	}

	irq_number = lp->board_data.phy_irq_pin;
	status = request_irq(irq_number, at91ether_phy_interrupt, 0, dev->name, dev);
	if (status) {
		printk(KERN_ERR "at91_ether: PHY IRQ %d request failed - status %d!\n", irq_number, status);
@@ -320,8 +320,7 @@ static void disable_phyirq(struct net_device *dev)
	unsigned int dsintr;
	unsigned int irq_number;

	irq_number = lp->board_data.phy_irq_pin;
	if (!irq_number) {
	if (!gpio_is_valid(lp->board_data.phy_irq_pin)) {
		del_timer_sync(&lp->check_timer);
		return;
	}
@@ -366,6 +365,7 @@ static void disable_phyirq(struct net_device *dev)
	disable_mdi();
	spin_unlock_irq(&lp->lock);

	irq_number = lp->board_data.phy_irq_pin;
	free_irq(irq_number, dev);			/* Free interrupt handler */
}

@@ -1078,7 +1078,7 @@ static int __init at91ether_setup(unsigned long phy_type, unsigned short phy_add
	netif_carrier_off(dev);		/* will be enabled in open() */

	/* If board has no PHY IRQ, use a timer to poll the PHY */
	if (!lp->board_data.phy_irq_pin) {
	if (!gpio_is_valid(lp->board_data.phy_irq_pin)) {
		init_timer(&lp->check_timer);
		lp->check_timer.data = (unsigned long)dev;
		lp->check_timer.function = at91ether_check_link;
@@ -1170,7 +1170,8 @@ static int __devexit at91ether_remove(struct platform_device *pdev)
	struct net_device *dev = platform_get_drvdata(pdev);
	struct at91_private *lp = netdev_priv(dev);

	if (lp->board_data.phy_irq_pin >= 32)
	if (gpio_is_valid(lp->board_data.phy_irq_pin) &&
	    lp->board_data.phy_irq_pin >= 32)
		gpio_free(lp->board_data.phy_irq_pin);

	unregister_netdev(dev);
@@ -1189,11 +1190,12 @@ static int at91ether_suspend(struct platform_device *pdev, pm_message_t mesg)
{
	struct net_device *net_dev = platform_get_drvdata(pdev);
	struct at91_private *lp = netdev_priv(net_dev);
	int phy_irq = lp->board_data.phy_irq_pin;

	if (netif_running(net_dev)) {
		if (phy_irq)
		if (gpio_is_valid(lp->board_data.phy_irq_pin)) {
			int phy_irq = lp->board_data.phy_irq_pin;
			disable_irq(phy_irq);
		}

		netif_stop_queue(net_dev);
		netif_device_detach(net_dev);
@@ -1207,7 +1209,6 @@ static int at91ether_resume(struct platform_device *pdev)
{
	struct net_device *net_dev = platform_get_drvdata(pdev);
	struct at91_private *lp = netdev_priv(net_dev);
	int phy_irq = lp->board_data.phy_irq_pin;

	if (netif_running(net_dev)) {
		clk_enable(lp->ether_clk);
@@ -1215,9 +1216,11 @@ static int at91ether_resume(struct platform_device *pdev)
		netif_device_attach(net_dev);
		netif_start_queue(net_dev);

		if (phy_irq)
		if (gpio_is_valid(lp->board_data.phy_irq_pin)) {
			int phy_irq = lp->board_data.phy_irq_pin;
			enable_irq(phy_irq);
		}
	}
	return 0;
}