From patchwork Thu Jul 29 23:58:24 2010 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Joe Perches X-Patchwork-Id: 60318 X-Patchwork-Delegate: davem@davemloft.net Return-Path: X-Original-To: patchwork-incoming@ozlabs.org Delivered-To: patchwork-incoming@ozlabs.org Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 1A5E21007D5 for ; Fri, 30 Jul 2010 09:59:31 +1000 (EST) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1757366Ab0G2X6a (ORCPT ); Thu, 29 Jul 2010 19:58:30 -0400 Received: from mail.perches.com ([173.55.12.10]:2173 "EHLO mail.perches.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1756963Ab0G2X62 (ORCPT ); Thu, 29 Jul 2010 19:58:28 -0400 Received: from Joe-Laptop.home (Joe-Laptop.home [192.168.1.151]) by mail.perches.com (Postfix) with ESMTP id 2F4562436D; Thu, 29 Jul 2010 16:58:20 -0700 (PDT) From: Joe Perches To: Michael Hennerich Cc: Mike Frysinger , uclinux-dist-devel , netdev@vger.kernel.org, linux-kernel@vger.kernel.org Subject: [PATCH net-next 3/3] drivers/net/bfin_mac.c: Misc function cleanups, neatening Date: Thu, 29 Jul 2010 16:58:24 -0700 Message-Id: X-Mailer: git-send-email 1.7.2.19.g9a302 In-Reply-To: References: Sender: netdev-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org Use new bfin_alloc_skb to centralize skb allocations Add and use get_mac_addr function Neaten bfin_mac_init Neaten bfin_mac_hard_start_xmit Signed-off-by: Joe Perches --- drivers/net/bfin_mac.c | 93 ++++++++++++++++++++++++++--------------------- 1 files changed, 51 insertions(+), 42 deletions(-) diff --git a/drivers/net/bfin_mac.c b/drivers/net/bfin_mac.c index a1d8119..68afb2a 100644 --- a/drivers/net/bfin_mac.c +++ b/drivers/net/bfin_mac.c @@ -81,6 +81,26 @@ static u16 pin_req[] = P_RMII0; static u16 pin_req[] = P_MII0; #endif +static struct sk_buff *bfin_alloc_skb(void) +{ + /* allocate a new skb */ + struct sk_buff *new_skb = dev_alloc_skb(PKT_BUF_SZ + NET_IP_ALIGN); + + if (!new_skb) + return NULL; + + skb_reserve(new_skb, NET_IP_ALIGN); + /* + * Invalidate the data cache of skb->data range + * when it is write back cache to prevent overwriting + * the new data from DMA. + */ + blackfin_dcache_invalidate_range((unsigned long)new_skb->head, + (unsigned long)new_skb->end); + + return new_skb; +} + static void desc_list_free(void) { struct net_dma_desc_rx *r; @@ -193,18 +213,12 @@ static int desc_list_init(void) struct dma_descriptor *b = &(r->desc_b); /* allocate a new skb for next time receive */ - new_skb = dev_alloc_skb(PKT_BUF_SZ + NET_IP_ALIGN); + new_skb = bfin_alloc_skb(); if (!new_skb) { pr_notice("init: low on mem - packet dropped\n"); goto init_error; } - skb_reserve(new_skb, NET_IP_ALIGN); - /* Invalidate the data cache of skb->data range when it is - * write back cache. - * It will prevent overwriting the new data from DMA - */ - blackfin_dcache_invalidate_range((unsigned long)new_skb->head, - (unsigned long)new_skb->end); + r->skb = new_skb; /* @@ -598,6 +612,16 @@ void setup_system_regs(struct net_device *dev) bfin_write_DMA1_Y_MODIFY(0); } +/* Grab the MAC address in the MAC */ +static void get_mac_addr(u8 *mac_addr) +{ + __le32 addr_low = cpu_to_le32(bfin_read_EMAC_ADDRLO()); + __le16 addr_hi = cpu_to_le16((u16)bfin_read_EMAC_ADDRHI()); + + memcpy(mac_addr, &addr_low, 4); + memcpy(mac_addr + 4, &addr_hi, 2); +} + static void setup_mac_addr(u8 *mac_addr) { u32 addr_low = le32_to_cpu(*(__le32 *)&mac_addr[0]); @@ -994,15 +1018,17 @@ static void tx_reclaim_skb_timeout(unsigned long lp) static int bfin_mac_hard_start_xmit(struct sk_buff *skb, struct net_device *dev) { struct bfin_mac_local *lp = netdev_priv(dev); - u16 *data; u32 data_align = (unsigned long)(skb->data) & 0x3; + unsigned long buf_start; + unsigned long buf_len; union skb_shared_tx *shtx = skb_tx(skb); current_tx_ptr->skb = skb; if (data_align == 0x2) { /* move skb->data to current_tx_ptr payload */ - data = (u16 *)(skb->data) - 1; + u16 *data = (u16 *)(skb->data) - 1; + *data = (u16)(skb->len); /* * When transmitting an Ethernet packet, the PTP_TSYNC module @@ -1014,23 +1040,21 @@ static int bfin_mac_hard_start_xmit(struct sk_buff *skb, struct net_device *dev) if (shtx->hardware) *data |= 0x1000; - current_tx_ptr->desc_a.start_addr = (u32)data; - /* this is important! */ - blackfin_dcache_flush_range((u32)data, - (u32)((u8 *)data + skb->len + 4)); + buf_start = (unsigned long)data; + buf_len = skb->len + 4; } else { *((u16 *)(current_tx_ptr->packet)) = (u16)(skb->len); /* enable timestamping for the sent packet */ if (shtx->hardware) *((u16 *)(current_tx_ptr->packet)) |= 0x1000; - memcpy((u8 *)(current_tx_ptr->packet + 2), skb->data, - skb->len); - current_tx_ptr->desc_a.start_addr = - (u32)current_tx_ptr->packet; - blackfin_dcache_flush_range( - (u32)current_tx_ptr->packet, - (u32)(current_tx_ptr->packet + skb->len + 2)); + memcpy(current_tx_ptr->packet + 2, skb->data, skb->len); + + buf_start = (unsigned long)current_tx_ptr->packet; + buf_len = skb->len + 2; } + current_tx_ptr->desc_a.start_addr = buf_start; + /* this is important! */ + blackfin_dcache_flush_range(buf_start, buf_start + buf_len); /* * Make sure the internal data buffers in the core are drained @@ -1095,20 +1119,12 @@ static void bfin_mac_rx(struct net_device *dev) /* allocate a new skb for next time receive */ skb = current_rx_ptr->skb; - new_skb = dev_alloc_skb(PKT_BUF_SZ + NET_IP_ALIGN); + new_skb = bfin_alloc_skb(); if (!new_skb) { pr_notice("rx: low on mem - packet dropped\n"); dev->stats.rx_dropped++; goto out; } - /* reserve 2 bytes for RXDWA padding */ - skb_reserve(new_skb, NET_IP_ALIGN); - /* - * Invalidate the data cache of skb->data range when it is write back - * cache. It will prevent overwriting the new data from DMA - */ - blackfin_dcache_invalidate_range((unsigned long)new_skb->head, - (unsigned long)new_skb->end); current_rx_ptr->skb = new_skb; current_rx_ptr->desc_a.start_addr = (unsigned long)new_skb->data - 2; @@ -1475,14 +1491,10 @@ static int __devinit bfin_mac_probe(struct platform_device *pdev) lp = netdev_priv(ndev); lp->ndev = ndev; - /* Grab the MAC address in the MAC */ - *(__le32 *)(&(ndev->dev_addr[0])) = - cpu_to_le32(bfin_read_EMAC_ADDRLO()); - *(__le16 *)(&(ndev->dev_addr[4])) = - cpu_to_le16((u16)bfin_read_EMAC_ADDRHI()); + get_mac_addr(ndev->dev_addr); /* probe mac */ - /*todo: how to proble? which is revision_register */ + /* todo: how to probe? which is revision_register */ bfin_write_EMAC_ADDRLO(0x12345678); if (bfin_read_EMAC_ADDRLO() != 0x12345678) { dev_err(&pdev->dev, "Cannot detect Blackfin on-chip ethernet MAC controller!\n"); @@ -1718,12 +1730,9 @@ static struct platform_driver bfin_mac_driver = { static int __init bfin_mac_init(void) { - int ret; - - ret = platform_driver_register(&bfin_mii_bus_driver); - if (!ret) - return platform_driver_register(&bfin_mac_driver); - return -ENODEV; + if (platform_driver_register(&bfin_mii_bus_driver)) + return -ENODEV; + return platform_driver_register(&bfin_mac_driver); } module_init(bfin_mac_init);