gianfar: Factor out enabling/disabling of hw interrupts
Throughout the code there are places where the controller's hw interrupt sources need to get disabled/enabled (masked/ un-masked) all at once. The recommendation for disabling the interrupts is to clear the ievent first then the imask register (not the other way around). Use the gfar_ints_enable/disable() helpers to make these operations consistent. Signed-off-by: Claudiu Manoil <claudiu.manoil@freescale.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
		
					parent
					
						
							
								532c37bcb7
							
						
					
				
			
			
				commit
				
					
						efeddce7ea
					
				
			
		
					 1 changed files with 30 additions and 30 deletions
				
			
		| 
						 | 
					@ -448,6 +448,29 @@ static const struct net_device_ops gfar_netdev_ops = {
 | 
				
			||||||
#endif
 | 
					#endif
 | 
				
			||||||
};
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					static void gfar_ints_disable(struct gfar_private *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						int i;
 | 
				
			||||||
 | 
						for (i = 0; i < priv->num_grps; i++) {
 | 
				
			||||||
 | 
							struct gfar __iomem *regs = priv->gfargrp[i].regs;
 | 
				
			||||||
 | 
							/* Clear IEVENT */
 | 
				
			||||||
 | 
							gfar_write(®s->ievent, IEVENT_INIT_CLEAR);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
							/* Initialize IMASK */
 | 
				
			||||||
 | 
							gfar_write(®s->imask, IMASK_INIT_CLEAR);
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					static void gfar_ints_enable(struct gfar_private *priv)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						int i;
 | 
				
			||||||
 | 
						for (i = 0; i < priv->num_grps; i++) {
 | 
				
			||||||
 | 
							struct gfar __iomem *regs = priv->gfargrp[i].regs;
 | 
				
			||||||
 | 
							/* Unmask the interrupts we look for */
 | 
				
			||||||
 | 
							gfar_write(®s->imask, IMASK_DEFAULT);
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void lock_rx_qs(struct gfar_private *priv)
 | 
					void lock_rx_qs(struct gfar_private *priv)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	int i;
 | 
						int i;
 | 
				
			||||||
| 
						 | 
					@ -1548,19 +1571,10 @@ static void gfar_configure_serdes(struct net_device *dev)
 | 
				
			||||||
static void init_registers(struct net_device *dev)
 | 
					static void init_registers(struct net_device *dev)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	struct gfar_private *priv = netdev_priv(dev);
 | 
						struct gfar_private *priv = netdev_priv(dev);
 | 
				
			||||||
	struct gfar __iomem *regs = NULL;
 | 
						struct gfar __iomem *regs = priv->gfargrp[0].regs;
 | 
				
			||||||
	int i;
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
	for (i = 0; i < priv->num_grps; i++) {
 | 
						gfar_ints_disable(priv);
 | 
				
			||||||
		regs = priv->gfargrp[i].regs;
 | 
					 | 
				
			||||||
		/* Clear IEVENT */
 | 
					 | 
				
			||||||
		gfar_write(®s->ievent, IEVENT_INIT_CLEAR);
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
		/* Initialize IMASK */
 | 
					 | 
				
			||||||
		gfar_write(®s->imask, IMASK_INIT_CLEAR);
 | 
					 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	regs = priv->gfargrp[0].regs;
 | 
					 | 
				
			||||||
	/* Init hash registers to zero */
 | 
						/* Init hash registers to zero */
 | 
				
			||||||
	gfar_write(®s->igaddr0, 0);
 | 
						gfar_write(®s->igaddr0, 0);
 | 
				
			||||||
	gfar_write(®s->igaddr1, 0);
 | 
						gfar_write(®s->igaddr1, 0);
 | 
				
			||||||
| 
						 | 
					@ -1622,20 +1636,11 @@ static int __gfar_is_rx_idle(struct gfar_private *priv)
 | 
				
			||||||
static void gfar_halt_nodisable(struct net_device *dev)
 | 
					static void gfar_halt_nodisable(struct net_device *dev)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	struct gfar_private *priv = netdev_priv(dev);
 | 
						struct gfar_private *priv = netdev_priv(dev);
 | 
				
			||||||
	struct gfar __iomem *regs = NULL;
 | 
						struct gfar __iomem *regs = priv->gfargrp[0].regs;
 | 
				
			||||||
	u32 tempval;
 | 
						u32 tempval;
 | 
				
			||||||
	int i;
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
	for (i = 0; i < priv->num_grps; i++) {
 | 
						gfar_ints_disable(priv);
 | 
				
			||||||
		regs = priv->gfargrp[i].regs;
 | 
					 | 
				
			||||||
		/* Mask all interrupts */
 | 
					 | 
				
			||||||
		gfar_write(®s->imask, IMASK_INIT_CLEAR);
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
		/* Clear all interrupts */
 | 
					 | 
				
			||||||
		gfar_write(®s->ievent, IEVENT_INIT_CLEAR);
 | 
					 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	regs = priv->gfargrp[0].regs;
 | 
					 | 
				
			||||||
	/* Stop the DMA, and wait for it to stop */
 | 
						/* Stop the DMA, and wait for it to stop */
 | 
				
			||||||
	tempval = gfar_read(®s->dmactrl);
 | 
						tempval = gfar_read(®s->dmactrl);
 | 
				
			||||||
	if ((tempval & (DMACTRL_GRS | DMACTRL_GTS)) !=
 | 
						if ((tempval & (DMACTRL_GRS | DMACTRL_GTS)) !=
 | 
				
			||||||
| 
						 | 
					@ -1823,10 +1828,10 @@ void gfar_start(struct net_device *dev)
 | 
				
			||||||
		/* Clear THLT/RHLT, so that the DMA starts polling now */
 | 
							/* Clear THLT/RHLT, so that the DMA starts polling now */
 | 
				
			||||||
		gfar_write(®s->tstat, priv->gfargrp[i].tstat);
 | 
							gfar_write(®s->tstat, priv->gfargrp[i].tstat);
 | 
				
			||||||
		gfar_write(®s->rstat, priv->gfargrp[i].rstat);
 | 
							gfar_write(®s->rstat, priv->gfargrp[i].rstat);
 | 
				
			||||||
		/* Unmask the interrupts we look for */
 | 
					 | 
				
			||||||
		gfar_write(®s->imask, IMASK_DEFAULT);
 | 
					 | 
				
			||||||
	}
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						gfar_ints_enable(priv);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	dev->trans_start = jiffies; /* prevent tx timeout */
 | 
						dev->trans_start = jiffies; /* prevent tx timeout */
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
| 
						 | 
					@ -1931,15 +1936,10 @@ err_irq_fail:
 | 
				
			||||||
int startup_gfar(struct net_device *ndev)
 | 
					int startup_gfar(struct net_device *ndev)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	struct gfar_private *priv = netdev_priv(ndev);
 | 
						struct gfar_private *priv = netdev_priv(ndev);
 | 
				
			||||||
	struct gfar __iomem *regs = NULL;
 | 
					 | 
				
			||||||
	int err, i, j;
 | 
						int err, i, j;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	for (i = 0; i < priv->num_grps; i++) {
 | 
						gfar_ints_disable(priv);
 | 
				
			||||||
		regs= priv->gfargrp[i].regs;
 | 
					 | 
				
			||||||
		gfar_write(®s->imask, IMASK_INIT_CLEAR);
 | 
					 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
	regs= priv->gfargrp[0].regs;
 | 
					 | 
				
			||||||
	err = gfar_alloc_skb_resources(ndev);
 | 
						err = gfar_alloc_skb_resources(ndev);
 | 
				
			||||||
	if (err)
 | 
						if (err)
 | 
				
			||||||
		return err;
 | 
							return err;
 | 
				
			||||||
| 
						 | 
					
 | 
				
			||||||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue