|
@@ -565,22 +565,6 @@ static void gfar_ints_enable(struct gfar_private *priv)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
-static void lock_tx_qs(struct gfar_private *priv)
|
|
|
-{
|
|
|
- int i;
|
|
|
-
|
|
|
- for (i = 0; i < priv->num_tx_queues; i++)
|
|
|
- spin_lock(&priv->tx_queue[i]->txlock);
|
|
|
-}
|
|
|
-
|
|
|
-static void unlock_tx_qs(struct gfar_private *priv)
|
|
|
-{
|
|
|
- int i;
|
|
|
-
|
|
|
- for (i = 0; i < priv->num_tx_queues; i++)
|
|
|
- spin_unlock(&priv->tx_queue[i]->txlock);
|
|
|
-}
|
|
|
-
|
|
|
static int gfar_alloc_tx_queues(struct gfar_private *priv)
|
|
|
{
|
|
|
int i;
|
|
@@ -1376,7 +1360,6 @@ static int gfar_probe(struct platform_device *ofdev)
|
|
|
priv->dev = &ofdev->dev;
|
|
|
SET_NETDEV_DEV(dev, &ofdev->dev);
|
|
|
|
|
|
- spin_lock_init(&priv->bflock);
|
|
|
INIT_WORK(&priv->reset_task, gfar_reset_task);
|
|
|
|
|
|
platform_set_drvdata(ofdev, priv);
|
|
@@ -1470,9 +1453,8 @@ static int gfar_probe(struct platform_device *ofdev)
|
|
|
goto register_fail;
|
|
|
}
|
|
|
|
|
|
- device_init_wakeup(&dev->dev,
|
|
|
- priv->device_flags &
|
|
|
- FSL_GIANFAR_DEV_HAS_MAGIC_PACKET);
|
|
|
+ device_set_wakeup_capable(&dev->dev, priv->device_flags &
|
|
|
+ FSL_GIANFAR_DEV_HAS_MAGIC_PACKET);
|
|
|
|
|
|
/* fill out IRQ number and name fields */
|
|
|
for (i = 0; i < priv->num_grps; i++) {
|
|
@@ -1540,48 +1522,37 @@ static int gfar_suspend(struct device *dev)
|
|
|
struct gfar_private *priv = dev_get_drvdata(dev);
|
|
|
struct net_device *ndev = priv->ndev;
|
|
|
struct gfar __iomem *regs = priv->gfargrp[0].regs;
|
|
|
- unsigned long flags;
|
|
|
u32 tempval;
|
|
|
-
|
|
|
int magic_packet = priv->wol_en &&
|
|
|
(priv->device_flags &
|
|
|
FSL_GIANFAR_DEV_HAS_MAGIC_PACKET);
|
|
|
|
|
|
+ if (!netif_running(ndev))
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ disable_napi(priv);
|
|
|
+ netif_tx_lock(ndev);
|
|
|
netif_device_detach(ndev);
|
|
|
+ netif_tx_unlock(ndev);
|
|
|
|
|
|
- if (netif_running(ndev)) {
|
|
|
+ gfar_halt(priv);
|
|
|
|
|
|
- local_irq_save(flags);
|
|
|
- lock_tx_qs(priv);
|
|
|
+ if (magic_packet) {
|
|
|
+ /* Enable interrupt on Magic Packet */
|
|
|
+ gfar_write(®s->imask, IMASK_MAG);
|
|
|
|
|
|
- gfar_halt_nodisable(priv);
|
|
|
+ /* Enable Magic Packet mode */
|
|
|
+ tempval = gfar_read(®s->maccfg2);
|
|
|
+ tempval |= MACCFG2_MPEN;
|
|
|
+ gfar_write(®s->maccfg2, tempval);
|
|
|
|
|
|
- /* Disable Tx, and Rx if wake-on-LAN is disabled. */
|
|
|
+ /* re-enable the Rx block */
|
|
|
tempval = gfar_read(®s->maccfg1);
|
|
|
-
|
|
|
- tempval &= ~MACCFG1_TX_EN;
|
|
|
-
|
|
|
- if (!magic_packet)
|
|
|
- tempval &= ~MACCFG1_RX_EN;
|
|
|
-
|
|
|
+ tempval |= MACCFG1_RX_EN;
|
|
|
gfar_write(®s->maccfg1, tempval);
|
|
|
|
|
|
- unlock_tx_qs(priv);
|
|
|
- local_irq_restore(flags);
|
|
|
-
|
|
|
- disable_napi(priv);
|
|
|
-
|
|
|
- if (magic_packet) {
|
|
|
- /* Enable interrupt on Magic Packet */
|
|
|
- gfar_write(®s->imask, IMASK_MAG);
|
|
|
-
|
|
|
- /* Enable Magic Packet mode */
|
|
|
- tempval = gfar_read(®s->maccfg2);
|
|
|
- tempval |= MACCFG2_MPEN;
|
|
|
- gfar_write(®s->maccfg2, tempval);
|
|
|
- } else {
|
|
|
- phy_stop(priv->phydev);
|
|
|
- }
|
|
|
+ } else {
|
|
|
+ phy_stop(priv->phydev);
|
|
|
}
|
|
|
|
|
|
return 0;
|
|
@@ -1592,37 +1563,26 @@ static int gfar_resume(struct device *dev)
|
|
|
struct gfar_private *priv = dev_get_drvdata(dev);
|
|
|
struct net_device *ndev = priv->ndev;
|
|
|
struct gfar __iomem *regs = priv->gfargrp[0].regs;
|
|
|
- unsigned long flags;
|
|
|
u32 tempval;
|
|
|
int magic_packet = priv->wol_en &&
|
|
|
(priv->device_flags &
|
|
|
FSL_GIANFAR_DEV_HAS_MAGIC_PACKET);
|
|
|
|
|
|
- if (!netif_running(ndev)) {
|
|
|
- netif_device_attach(ndev);
|
|
|
+ if (!netif_running(ndev))
|
|
|
return 0;
|
|
|
- }
|
|
|
|
|
|
- if (!magic_packet && priv->phydev)
|
|
|
+ if (magic_packet) {
|
|
|
+ /* Disable Magic Packet mode */
|
|
|
+ tempval = gfar_read(®s->maccfg2);
|
|
|
+ tempval &= ~MACCFG2_MPEN;
|
|
|
+ gfar_write(®s->maccfg2, tempval);
|
|
|
+ } else {
|
|
|
phy_start(priv->phydev);
|
|
|
-
|
|
|
- /* Disable Magic Packet mode, in case something
|
|
|
- * else woke us up.
|
|
|
- */
|
|
|
- local_irq_save(flags);
|
|
|
- lock_tx_qs(priv);
|
|
|
-
|
|
|
- tempval = gfar_read(®s->maccfg2);
|
|
|
- tempval &= ~MACCFG2_MPEN;
|
|
|
- gfar_write(®s->maccfg2, tempval);
|
|
|
+ }
|
|
|
|
|
|
gfar_start(priv);
|
|
|
|
|
|
- unlock_tx_qs(priv);
|
|
|
- local_irq_restore(flags);
|
|
|
-
|
|
|
netif_device_attach(ndev);
|
|
|
-
|
|
|
enable_napi(priv);
|
|
|
|
|
|
return 0;
|
|
@@ -2045,7 +2005,8 @@ static int register_grp_irqs(struct gfar_priv_grp *grp)
|
|
|
/* Install our interrupt handlers for Error,
|
|
|
* Transmit, and Receive
|
|
|
*/
|
|
|
- err = request_irq(gfar_irq(grp, ER)->irq, gfar_error, 0,
|
|
|
+ err = request_irq(gfar_irq(grp, ER)->irq, gfar_error,
|
|
|
+ IRQF_NO_SUSPEND,
|
|
|
gfar_irq(grp, ER)->name, grp);
|
|
|
if (err < 0) {
|
|
|
netif_err(priv, intr, dev, "Can't get IRQ %d\n",
|
|
@@ -2068,7 +2029,8 @@ static int register_grp_irqs(struct gfar_priv_grp *grp)
|
|
|
goto rx_irq_fail;
|
|
|
}
|
|
|
} else {
|
|
|
- err = request_irq(gfar_irq(grp, TX)->irq, gfar_interrupt, 0,
|
|
|
+ err = request_irq(gfar_irq(grp, TX)->irq, gfar_interrupt,
|
|
|
+ IRQF_NO_SUSPEND,
|
|
|
gfar_irq(grp, TX)->name, grp);
|
|
|
if (err < 0) {
|
|
|
netif_err(priv, intr, dev, "Can't get IRQ %d\n",
|
|
@@ -2169,8 +2131,6 @@ static int gfar_enet_open(struct net_device *dev)
|
|
|
if (err)
|
|
|
return err;
|
|
|
|
|
|
- device_set_wakeup_enable(&dev->dev, priv->wol_en);
|
|
|
-
|
|
|
return err;
|
|
|
}
|
|
|
|