static int lpc_eth_poll(struct napi_struct *napi, int budget)
{
struct netdata_local *pldat = container_of(napi,
struct netdata_local, napi);
struct net_device *ndev = pldat->ndev;
int rx_done = 0;
struct netdev_queue *txq = netdev_get_tx_queue(ndev, 0);
__netif_tx_lock(txq, smp_processor_id());
__lpc_handle_xmit(ndev);
__netif_tx_unlock(txq);
rx_done = __lpc_handle_recv(ndev, budget);
if (rx_done < budget) {
napi_complete(napi);
lpc_eth_enable_int(pldat->net_base);
}
return rx_done;
}
static inline void
dma_xmit_clean(struct net_device *dev, END_DEVICE *ei_local)
{
struct netdev_queue *txq;
int cpu, clean_done = 0;
u32 cpu_ptr, dma_ptr, cpu_idx;
#if defined (CONFIG_RAETH_BQL)
u32 bytes_sent_ge1 = 0;
#if defined (CONFIG_PSEUDO_SUPPORT)
u32 bytes_sent_ge2 = 0;
#endif
#endif
spin_lock(&ei_local->page_lock);
cpu_ptr = sysRegRead(QTX_CRX_PTR);
dma_ptr = sysRegRead(QTX_DRX_PTR);
/* get current CPU TXD index */
cpu_idx = get_txd_offset(ei_local, cpu_ptr);
while (cpu_ptr != dma_ptr) {
struct QDMA_txdesc *txd;
struct sk_buff *skb;
txd = &ei_local->txd_pool[cpu_idx];
/* check TXD not owned by DMA */
if (!(ACCESS_ONCE(txd->txd_info3) & TX3_QDMA_OWN))
break;
/* hold next TXD ptr */
cpu_ptr = ACCESS_ONCE(txd->txd_info2);
/* release current TXD */
put_free_txd(ei_local, cpu_idx);
/* get next TXD index */
cpu_idx = get_txd_offset(ei_local, cpu_ptr);
/* free skb */
skb = ei_local->txd_buff[cpu_idx];
if (skb) {
#if defined (CONFIG_RAETH_BQL)
#if defined (CONFIG_PSEUDO_SUPPORT)
if (skb->dev == ei_local->PseudoDev)
bytes_sent_ge2 += skb->len;
else
#endif
bytes_sent_ge1 += skb->len;
#endif
ei_local->txd_buff[cpu_idx] = NULL;
dev_kfree_skb(skb);
}
clean_done++;
/* prevent infinity loop when something wrong */
if (clean_done > (NUM_TX_DESC-4))
break;
}
if (clean_done)
sysRegWrite(QTX_CRX_PTR, cpu_ptr);
spin_unlock(&ei_local->page_lock);
if (!clean_done)
return;
cpu = smp_processor_id();
if (netif_running(dev)) {
txq = netdev_get_tx_queue(dev, 0);
__netif_tx_lock(txq, cpu);
#if defined (CONFIG_RAETH_BQL)
netdev_tx_completed_queue(txq, 0, bytes_sent_ge1);
#endif
if (netif_tx_queue_stopped(txq))
netif_tx_wake_queue(txq);
__netif_tx_unlock(txq);
}
#if defined (CONFIG_PSEUDO_SUPPORT)
if (netif_running(ei_local->PseudoDev)) {
txq = netdev_get_tx_queue(ei_local->PseudoDev, 0);
__netif_tx_lock(txq, cpu);
#if defined (CONFIG_RAETH_BQL)
netdev_tx_completed_queue(txq, 0, bytes_sent_ge2);
#endif
if (netif_tx_queue_stopped(txq))
netif_tx_wake_queue(txq);
__netif_tx_unlock(txq);
}
#endif
}
static inline void
dma_xmit_clean(struct net_device *dev, END_DEVICE *ei_local)
{
struct netdev_queue *txq;
int cpu, clean_done = 0;
u32 txd_free_idx;
#if defined (CONFIG_RAETH_BQL)
u32 bytes_sent_ge1 = 0;
#if defined (CONFIG_PSEUDO_SUPPORT)
u32 bytes_sent_ge2 = 0;
#endif
#endif
spin_lock(&ei_local->page_lock);
txd_free_idx = ei_local->txd_free_idx;
while (clean_done < (NUM_TX_DESC-2)) {
struct PDMA_txdesc *txd;
struct sk_buff *skb;
skb = ei_local->txd_buff[txd_free_idx];
if (!skb)
break;
txd = &ei_local->txd_ring[txd_free_idx];
/* check TXD not owned by DMA */
if (!(ACCESS_ONCE(txd->txd_info2) & TX2_DMA_DONE))
break;
if (skb != (struct sk_buff *)0xFFFFFFFF) {
#if defined (CONFIG_RAETH_BQL)
#if defined (CONFIG_PSEUDO_SUPPORT)
if (skb->dev == ei_local->PseudoDev)
bytes_sent_ge2 += skb->len;
else
#endif
bytes_sent_ge1 += skb->len;
#endif
dev_kfree_skb(skb);
}
ei_local->txd_buff[txd_free_idx] = NULL;
txd_free_idx = (txd_free_idx + 1) % NUM_TX_DESC;
clean_done++;
}
if (ei_local->txd_free_idx != txd_free_idx)
ei_local->txd_free_idx = txd_free_idx;
spin_unlock(&ei_local->page_lock);
if (!clean_done)
return;
cpu = smp_processor_id();
if (netif_running(dev)) {
txq = netdev_get_tx_queue(dev, 0);
__netif_tx_lock(txq, cpu);
#if defined (CONFIG_RAETH_BQL)
netdev_tx_completed_queue(txq, 0, bytes_sent_ge1);
#endif
if (netif_tx_queue_stopped(txq))
netif_tx_wake_queue(txq);
__netif_tx_unlock(txq);
}
#if defined (CONFIG_PSEUDO_SUPPORT)
if (netif_running(ei_local->PseudoDev)) {
txq = netdev_get_tx_queue(ei_local->PseudoDev, 0);
__netif_tx_lock(txq, cpu);
#if defined (CONFIG_RAETH_BQL)
netdev_tx_completed_queue(txq, 0, bytes_sent_ge2);
#endif
if (netif_tx_queue_stopped(txq))
netif_tx_wake_queue(txq);
__netif_tx_unlock(txq);
}
#endif
}
